X-Git-Url: http://cloudbase.mooo.com/gitweb/z180-stamp.git/blobdiff_plain/1a2460dcd3bed50d5f2b7ba53e6e21a12935639b..a4f40a904ef9475b007e650c2ac501d16346feb1:/avr/z180-serv.c

diff --git a/avr/z180-serv.c b/avr/z180-serv.c
index ce264ae..d1f52dd 100644
--- a/avr/z180-serv.c
+++ b/avr/z180-serv.c
@@ -1,31 +1,33 @@
 /*
- * (C) Copyright 2014 Leo C. <erbl259-lmu@yahoo.de>
+ * (C) Copyright 2014-2016 Leo C. <erbl259-lmu@yahoo.de>
  *
- * SPDX-License-Identifier:	GPL-2.0+
+ * SPDX-License-Identifier:	GPL-2.0
  */
 
+#include "z180-serv.h"
 #include "common.h"
+#include <stdlib.h>
+#include <string.h>
+#include <stdbool.h>
 #include <util/atomic.h>
 
+#include "config.h"
 #include "background.h"
+#include "env.h"
+#include "ff.h"
 #include "serial.h"
 #include "z80-if.h"
 #include "debug.h"
-#include "z180-serv.h"
+#include "print-utils.h"
+#include "timer.h"
+#include "time.h"
+#include "bcd.h"
+#include "rtc.h"
 
-/*--------------------------------------------------------------------------*/
+#define DEBUG_CPM_SDIO	0	/* set to 1 to debug */
 
-
-uint8_t z80_get_byte(uint32_t adr)
-{
-	uint8_t data;
-
-	z80_bus_cmd(Request);
-	data = z80_read(adr);
-	z80_bus_cmd(Release);
-
-	return data;
-}
+#define debug_cpmsd(fmt, args...)		                                            \
+	debug_cond(DEBUG_CPM_SDIO, fmt, ##args)
 
 
 /*--------------------------------------------------------------------------*/
@@ -96,6 +98,508 @@ void do_msg_echo(uint8_t subf, int len, uint8_t * msg)
 	msg_xmit(1, 3, len, msg);
 }
 
+/* get timer */
+void do_msg_get_timer(uint8_t subf, int len, uint8_t * msg)
+{
+	uint32_t time_ms = (len >= 4) ? *(uint32_t *) msg : 0;
+
+	time_ms = get_timer(time_ms);
+	msg_xmit(3, subf, sizeof(time_ms), (uint8_t *) &time_ms);
+}
+
+/* ---------------------------------------------------------------------------*/
+
+#define CPM_DAY_OFFSET ((1978-1900) * 365 + 19)		/* 19 leap years */
+
+/*
+ * Convert CP/M time stamp to a broken-down time structure
+ *
+ */
+int mk_date_time (int len, uint8_t *msg, struct tm *tmp)
+{
+	time_t stamp;
+
+	if (len != 5)
+		return -1;
+
+	/* days since 2000-01-01 */
+	long days = msg[3] + (msg[4] << 8) - 8036;
+
+	if (days < 0)
+		return -1;
+
+	stamp = days * ONE_DAY;
+	stamp += bcd2bin(msg[0]);
+	stamp += bcd2bin(msg[1]) * 60 ;
+	stamp += bcd2bin(msg[2]) * 3600L;
+	gmtime_r(&stamp, tmp);
+	return 0;
+}
+
+void mk_cpm_time(struct tm *tmp, uint8_t cpm_time[5])
+{
+	uint16_t days = 1;
+	uint_fast8_t leap=2;
+
+	for (int year=78; year < tmp->tm_year; year++) {
+		days = days + 365 + (leap == 0);
+		leap = (leap+1)%4;
+	}
+	days += tmp->tm_yday;
+
+	cpm_time[0] = bin2bcd(tmp->tm_sec);
+	cpm_time[1] = bin2bcd(tmp->tm_min);
+	cpm_time[2] = bin2bcd(tmp->tm_hour);
+	cpm_time[3] = days;
+	cpm_time[4] = days >> 8;
+}
+
+/* get/set cp/m time */
+void do_msg_get_set_time(uint8_t subf, int len, uint8_t * msg)
+{
+	struct tm t;
+	uint8_t cpm_time[5];
+	int rc;
+
+	memset(cpm_time, 0, ARRAY_SIZE(cpm_time));
+
+	switch (subf) {
+	case 3:			/* set date & time */
+		/* initialize t with current time */
+		rc = rtc_get (&t);
+
+		if (rc >= 0) {
+			/* insert new date & time */
+			if (mk_date_time (len, msg, &t) != 0) {
+				my_puts_P(PSTR("## set_time: Bad date format\n"));
+				break;
+			}
+
+			time_t time;
+			time = mk_gmtime(&t);
+			gmtime_r(&time, &t);
+
+			/* and write to RTC */
+			rc = rtc_set (&t);
+			if(rc)
+				my_puts_P(PSTR("## set_time: Set date failed\n"));
+		} else {
+			my_puts_P(PSTR("## set_time: Get date failed\n"));
+		}
+		/* FALL TROUGH */
+	case 2:			/* get date & time */
+		rc = rtc_get (&t);
+		if (rc >= 0) {
+			time_t time;
+			time = mk_gmtime(&t);
+			//mktime(&t);
+			gmtime_r(&time, &t);
+
+			mk_cpm_time(&t, cpm_time);
+		} else {
+			my_puts_P(PSTR("## get_time: Get date failed\n"));
+		}
+		break;
+	}
+
+	msg_xmit(3, subf, sizeof(cpm_time), cpm_time);
+}
+
+/* ---------------------------------------------------------------------------*/
+
+static uint8_t drv;
+static uint8_t disk_buffer[CONFIG_CPM_BLOCK_SIZE];
+static struct cpm_drive_s drv_table[CONFIG_CPM_MAX_DRIVE];
+static int handle_cpm_drv_to;
+
+typedef enum {SINGLE, START, MIDDLE, END} dbgmsg_t;
+
+void drv_debug(dbgmsg_t phase, const FLASH char *const fmt, ...)		                                            \
+{
+	struct cpm_drive_s *dp = &drv_table[drv];
+
+	if (dp->opt & DRV_OPT_DEBUG) {
+
+		va_list ap;
+		va_start (ap, fmt);
+
+		if (phase == SINGLE || phase == START)
+			printf_P(PSTR("# %7lu dsk%d: "), get_timer(0), drv);
+
+		vfprintf_P (stdout, fmt, ap);
+
+		if (phase == SINGLE || phase == END)
+			putc('\n', stdout);
+
+		va_end (ap);
+	}
+}
+
+int drv_list(void)
+{
+	for (uint8_t i = 0; i < CONFIG_CPM_MAX_DRIVE; i++) {
+		struct cpm_drive_s * p = &drv_table[i];
+		if (p->img_name) {
+			printf_P(PSTR("  dsk%d: %2s %3s attached to %s\n"), i,
+					p->opt&DRV_OPT_RO ? "RO":"RW", p->opt&DRV_OPT_DEBUG ? "DBG":"",
+					p->img_name);
+		}
+	}
+	return 0;
+}
+
+int drv_detach(uint8_t unit)
+{
+	drv = unit;
+	if (drv < CONFIG_CPM_MAX_DRIVE) {
+		struct cpm_drive_s *p = &drv_table[drv];
+
+		drv_debug(SINGLE, PSTR("detach from '%s'"), p->img_name ? p->img_name : "-");
+
+		if (p->img_name) {
+			f_close(&p->fd);
+			free(p->img_name);
+			p->opt = 0;
+			p->flags &= ~DRV_FLG_DIRTY;
+			p->img_name = NULL;
+
+			uint32_t scb = getenv_ulong(PSTR(ENV_CPM3_SCB), 16, 0);
+			if (scb && (z80_bus_cmd(Request) & ZST_ACQUIRED)) {
+				z80_write(scb + 0xf0, 0xff);
+				z80_write(p->dph + 11, 0xff);
+				z80_bus_cmd(Release);
+			}
+		}
+	}
+	return 0;
+}
+
+static int drv_find_file_attached(const char *fn)
+{
+	for (uint8_t i = 0; i < CONFIG_CPM_MAX_DRIVE; i++) {
+		struct cpm_drive_s *p = &drv_table[i];
+		if (p->img_name && !strcmp(fn, p->img_name)) {
+			return i;
+		}
+	}
+	return -1;
+}
+
+int drv_attach(uint8_t unit, const char *filename, drv_opt_t options)
+{
+	int res;
+
+	drv = unit;
+	if (drv >= CONFIG_CPM_MAX_DRIVE)
+		return AT_RANGE;
+
+	struct cpm_drive_s *p = &drv_table[drv];
+
+	if (options & DRV_OPT_REATTATCH) {
+		if (filename) {
+			return AT_ERROR;
+		}
+
+		if (!p->img_name) {
+			return AT_NOT;
+		}
+
+		/* change options */
+		if ((p->opt ^ options) & DRV_OPT_RO) {
+			f_close(&p->fd);
+			res = f_open(&p->fd, p->img_name,
+					FA_READ | (options&DRV_OPT_RO ? 0 : FA_WRITE));
+		}
+
+		p->opt = options & ~DRV_OPT_REATTATCH;
+
+	} else {
+
+		if (p->img_name)
+			return AT_ALREADY;
+		if (drv_find_file_attached(filename) >= 0)
+			return AT_OTHER;
+
+		p->opt = options;
+
+		/* new attachment */
+
+		if ((p->img_name = strdup(filename)) == NULL)
+			return AT_NOMEM;
+
+		res = f_open(&p->fd, p->img_name,
+				FA_READ | (options&DRV_OPT_RO ? 0 : FA_WRITE));
+
+		if (!res && f_size(&p->fd) < CONFIG_CPM_DISKSIZE) {
+#if 0
+			unsigned int bw;
+			debug_cpmsd("            expanding image file from %ld to %ld\n",
+					f_size(&p->fd), CONFIG_CPM_DISKSIZE);
+
+			res = f_lseek(&p->fd, CONFIG_CPM_DISKSIZE-CONFIG_CPM_BLOCK_SIZE);
+			if (!res) {
+				memset(disk_buffer, 0xe5, CONFIG_CPM_BLOCK_SIZE);
+				res = f_write(&p->fd, disk_buffer, CONFIG_CPM_BLOCK_SIZE, &bw);
+				if (res || bw < CONFIG_CPM_BLOCK_SIZE) {
+					debug_cpmsd("               failed! res: %d, bytes written: %u\n",	res, bw);
+				}
+				p->flags |= DRV_FLG_DIRTY;
+				bg_setstat(handle_cpm_drv_to, 1);
+			}
+#else
+			drv_debug(SINGLE, PSTR("wrong image file size: %ld, should be %ld"),
+					f_size(&p->fd), CONFIG_CPM_DISKSIZE);
+			res = 64;
+#endif
+		}
+		if (res) {
+			drv_detach(drv);
+			return AT_OPEN;
+		}
+	}
+
+	return AT_OK;
+}
+
+
+int cpm_drv_to(int state)
+{
+	static uint32_t ts;
+
+	switch(state) {
+	case 0:
+		break;
+
+	case 1:
+		ts = get_timer(0);
+		state = 2;
+		break;
+
+	case 2:
+		if (get_timer(ts) > 1000) {
+			for (uint_fast8_t i=0; i < CONFIG_CPM_MAX_DRIVE; i++) {
+				if (drv_table[i].flags & DRV_FLG_DIRTY) {
+					drv_table[i].flags &= ~DRV_FLG_DIRTY;
+					f_sync(&drv_table[i].fd);
+					drv = i;
+					drv_debug(SINGLE, PSTR("f_sync"));
+				}
+			}
+			state = 0;
+		}
+	}
+	return state;
+}
+
+static const FLASH char * const FLASH rc_messages[] = {
+			FSTR("OK"),
+			FSTR("Internal error: wrong message len"),	/* 01 */
+			FSTR("Invalid relative drive #"),			/* 02 */
+			FSTR("Bus timeout"),						/* 03 */
+			FSTR("Access byond disk size"),				/* 04 */
+			FSTR("Write protect"),						/* 05 */
+			FSTR("No media"),							/* 06 */
+			FSTR("R/W address == 0 !!!!"),				/* 07 */
+		};
+
+void msg_cpm_result(uint8_t subf, uint8_t rc, int res)
+{
+	uint8_t result_msg[3];
+
+	if (res)
+		rc |= 0x80;
+
+	result_msg[0] = rc;
+	result_msg[1] = res;
+	result_msg[2] = res >> 8;
+
+	msg_xmit(2, subf, sizeof(result_msg), result_msg);
+
+	if (rc) {
+#if GCC_BUG_61443
+		char msg[40];
+		strncpy_P(msg, rc_messages[rc & 0x7f], sizeof msg -1);
+		drv_debug(END, PSTR(" rc: %.02x/%d, '%s'"),
+					rc, res, msg);
+#else
+		drv_debug(END, PSTR(" rc: %.02x/%d, '%S'"),
+					rc, res, rc_messages[rc & 0x7f]);
+#endif
+	} else
+		drv_debug(END, PSTR(""));
+
+}
+
+/*
+ 	db	2	; disk command
+	ds	1	; subcommand (login/read/write)
+	ds	1	; @adrv (8 bits)	+0
+	ds	1	; @rdrv (8 bits)	+1
+	ds	3	; @xdph (24 bits)	+2
+*/
+
+void do_msg_cpm_login(uint8_t subf, int len, uint8_t * msg)
+{
+	struct cpm_drive_s *dp;
+	FRESULT res = 0;
+
+	(void)subf;
+
+	/* Get relative drive number */
+	drv = msg[1];
+	drv_debug(START, PSTR("login"));
+
+	if (len != 5) {
+		return msg_cpm_result(subf, 0x01, res);
+	}
+
+	if ( drv >= CONFIG_CPM_MAX_DRIVE) {
+		/* invalid relative drive number */
+		return msg_cpm_result(subf, 0x02, res);
+	}
+
+	dp = &drv_table[drv];
+	dp->flags &= ~DRV_FLG_OPEN;
+	dp->dph = ((uint32_t)msg[4] << 16) + ((uint16_t)msg[3] << 8) + msg[2];
+
+	if (dp->img_name == NULL) {
+		/* no file attached */
+		return msg_cpm_result(subf, 0x06, res);
+	}
+
+	f_close(&dp->fd);
+	res = f_open(&dp->fd, dp->img_name,
+			FA_READ | (dp->opt&DRV_OPT_RO ? 0 : FA_WRITE));
+
+	dp->flags |= DRV_FLG_OPEN;
+
+	/* send  result*/
+	msg_cpm_result(subf, 0x00, res);
+}
+
+
+/*
+ 	db	2	; disk command
+	ds	1	; subcommand (login/read/write)
+	ds	1	; @adrv (8 bits)		+0
+	ds	1	; @rdrv (8 bits)		+1
+	ds	2	; @trk (16 bits)		+2
+	ds	2	; @sect(16 bits)		+4
+	ds	1	; @cnt  (8 bits)		+6
+	ds	3	; phys. transfer addr	+7
+*/
+
+#define ADRV	0
+#define RDRV	1
+#define TRK		2
+#define SEC		4
+#define CNT		6
+#define ADDR	7
+
+void do_msg_cpm_rw(uint8_t subf, int len, uint8_t * msg)
+{
+	struct cpm_drive_s *dp;
+	uint32_t addr;
+	uint32_t pos;
+	uint16_t track;
+	uint16_t sec;
+	uint8_t secs;
+	bool dowrite;
+	FRESULT res = 0;
+	uint8_t rc = 0;
+	bool buserr = 0;
+
+	drv = msg[RDRV];
+	dowrite = (subf == 2);
+
+	drv_debug(START, PSTR("%2S"), dowrite ? PSTR("W ") : PSTR(" R"));
+
+	if (len != 10) {
+		return msg_cpm_result(subf, 0x01, res);
+	}
+	if ( drv>= CONFIG_CPM_MAX_DRIVE) {
+		return msg_cpm_result(subf, 0x02, res);
+	}
+
+	dp = &drv_table[drv];
+	track = (uint16_t)(msg[TRK+1] << 8) + msg[TRK];
+	sec  = (uint16_t)(msg[SEC+1] << 8) + msg[SEC];
+	secs = msg[CNT];
+	addr = ((uint32_t)msg[ADDR+2] << 16) + ((uint16_t)msg[ADDR+1] << 8) + msg[ADDR];
+
+	if (dp->img_name == NULL) {
+		/* no media */
+		return msg_cpm_result(subf, 0x06, res);
+	}
+
+	/* TODO: tracks per sector from dpb */
+	pos = (track * 8UL + sec) * CONFIG_CPM_BLOCK_SIZE;
+
+	drv_debug(MIDDLE, PSTR(" T:%4d, S:%2d, cnt:%2d, lba: %.8lx, addr: %.5lx"),
+				track, sec, secs, pos, addr);
+
+	if (addr == 0) {
+		return msg_cpm_result(subf, 0x07, res);
+	}
+
+	if (dowrite && dp->opt & DRV_OPT_RO) {
+		return msg_cpm_result(subf, 0x05, res);
+	}
+
+
+	if (pos + secs * CONFIG_CPM_BLOCK_SIZE > CONFIG_CPM_DISKSIZE) {
+		drv_debug(MIDDLE, PSTR(" access > DISKSIZE:%.8lx!"),
+						CONFIG_CPM_DISKSIZE);
+		return msg_cpm_result(subf, 0x04, res);
+	}
+
+	res = f_lseek(&dp->fd, pos);
+
+	while (!res && secs--) {
+		unsigned int brw;
+		if (dowrite) {
+			if (!(z80_bus_cmd(Request) & ZST_ACQUIRED)) {
+				buserr = 1;
+				break;
+			} else {
+				z80_read_block(disk_buffer, addr, CONFIG_CPM_BLOCK_SIZE);
+				z80_bus_cmd(Release);
+			}
+			res = f_write(&dp->fd, disk_buffer, CONFIG_CPM_BLOCK_SIZE, &brw);
+		} else {
+			res = f_read(&dp->fd, disk_buffer, CONFIG_CPM_BLOCK_SIZE, &brw);
+			if (res == FR_OK) {
+				if (!(z80_bus_cmd(Request) & ZST_ACQUIRED)) {
+					buserr = 1;
+					break;
+				} else {
+					z80_write_block(disk_buffer, addr, CONFIG_CPM_BLOCK_SIZE);
+					z80_bus_cmd(Release);
+				}
+			}
+		}
+		if (brw != CONFIG_CPM_BLOCK_SIZE) {
+			drv_debug(MIDDLE, PSTR(" short rd/wr: res: %d, brw: %u"),
+						res, brw);
+			res = 64;
+		}
+		addr += CONFIG_CPM_BLOCK_SIZE;
+	}
+
+	if (dowrite && !res) {
+		dp->flags |= DRV_FLG_DIRTY;
+		bg_setstat(handle_cpm_drv_to, 1);
+	}
+
+	if (buserr) {
+		/* Bus timeout. how can this happen? */
+		rc = 0x03;
+	}
+
+	/* send  result*/
+	msg_cpm_result(subf, rc, res);
+}
+
 
 const FLASH struct msg_item z80_messages[] =
 {
@@ -108,6 +612,18 @@ const FLASH struct msg_item z80_messages[] =
 	{ 1,
 	  2, 2,
 	  do_msg_echo},
+	{ 2,
+	  0, 0,
+	  do_msg_cpm_login},
+	{ 2,
+	  1, 2,
+	  do_msg_cpm_rw},
+	{ 3,
+	  1, 1,
+	  do_msg_get_timer},
+	{ 3,
+	  2, 3,				/* 2: get, 3: set time and date */
+	  do_msg_get_set_time},
 	{ 0xff,				/* end mark */
 	  0, 0,
 	  0},
@@ -200,7 +716,7 @@ void check_msg_fifo(void)
 
 int msg_handling(int state)
 {
-	uint8_t pending;
+	bool pending;
 
 	ATOMIC_BLOCK(ATOMIC_FORCEON) {
 		pending = (Stat & S_MSG_PENDING) != 0;
@@ -208,21 +724,27 @@ int msg_handling(int state)
 	}
 
 	if (pending) {
-		switch (state) {
-		case 0:			/* need init */
+		uint8_t init_request;
+		z80_bus_cmd(Request);
+		init_request = z80_read(0x43);
+		z80_bus_cmd(Release);
+		if ( init_request != 0) {
+			/* Get address of fifo 0 */
 			z80_bus_cmd(Request);
-			uint32_t addr = z80_read(0x40) +
-				((uint16_t) z80_read(0x41) << 8) +
-				((uint32_t) z80_read(0x42) << 16);
+			uint32_t fifo_addr = z80_read(0x40) +
+						((uint16_t) z80_read(0x40+1) << 8) +
+						((uint32_t) z80_read(0x40+2) << 16);
+			z80_write(0x43, 0);
 			z80_bus_cmd(Release);
-			if (addr != 0) {
-				z80_memfifo_init(fifo_msgin, addr);
+
+			if (fifo_addr != 0) {
+				z80_memfifo_init(fifo_msgin, fifo_addr);
 				state = 1;
-			}
-			break;
-		case 1:			/* awaiting messages */
+			} else
+				state = 0;
+
+		} else {
 			check_msg_fifo();
-			break;
 		}
 	}
 
@@ -236,21 +758,22 @@ void setup_z180_serv(void)
 {
 
 	handle_msg_handling = bg_register(msg_handling, 0);
+	handle_cpm_drv_to = bg_register(cpm_drv_to, 0);
 }
 
 void restart_z180_serv(void)
 {
 	z80_bus_cmd(Request);
-	z80_write(0x40, 0);
-	z80_write(0x41, 0);
-	z80_write(0x42, 0);
+	z80_memset(0x40, 0, 4);
 	z80_bus_cmd(Release);
 
 	for (int i = 0; i < NUM_FIFOS; i++)
 		z80_memfifo_init(i, 0);
 	bg_setstat(handle_msg_handling, 0);
+
 }
 
+#if 0
 /*--------------------------------------------------------------------------*/
 
 const FLASH uint8_t iniprog[] = {
@@ -302,3 +825,4 @@ const FLASH uint8_t test1[] = {
 	0x00,              //	db	0		;dst
 	0x00, 0x00,        //	dw 	0		;count (64k)
 };
+#endif