[z180-stamp.git] / avr / z180-serv.c

/*
 * (C) Copyright 2014-2016 Leo C. <erbl259-lmu@yahoo.de>
 *
 * 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 "print-utils.h"
#include "timer.h"
#include "time.h"
#include "bcd.h"
#include "rtc.h"

#define DEBUG_CPM_SDIO	1	/* set to 1 to debug */

#define debug_cpmsd(fmt, args...)		                                            \
	debug_cond(DEBUG_CPM_SDIO, fmt, ##args)


/*--------------------------------------------------------------------------*/

struct msg_item {
	uint8_t fct;
	uint8_t sub_min, sub_max;
	void (*func)(uint8_t, int, uint8_t *);
};

uint32_t msg_to_addr(uint8_t *msg)
{
	union {
		uint32_t as32;
		uint8_t as8[4];
	} addr;

	addr.as8[0] = msg[0];
	addr.as8[1] = msg[1];
	addr.as8[2] = msg[2];
	addr.as8[3] = 0;

	return addr.as32;
}


static int msg_xmit_header(uint8_t func, uint8_t subf, int len)
{
	z80_memfifo_putc(fifo_msgout, 0xAE);
	z80_memfifo_putc(fifo_msgout, len+2);
	z80_memfifo_putc(fifo_msgout, func);
	z80_memfifo_putc(fifo_msgout, subf);

	return 0;
}

int msg_xmit(uint8_t func, uint8_t subf, int len, uint8_t *msg)
{
	msg_xmit_header(func, subf, len);
	while (len--)
		z80_memfifo_putc(fifo_msgout, *msg++);

	return 0;
}

void do_msg_ini_memfifo(uint8_t subf, int len, uint8_t * msg)
{
	(void)len;

	z80_memfifo_init(subf, msg_to_addr(msg));
}


void do_msg_char_out(uint8_t subf, int len, uint8_t * msg)
{
	(void)subf;

	while (len--)
		putchar(*msg++);
}

/* echo message */
void do_msg_echo(uint8_t subf, int len, uint8_t * msg)
{
	(void)subf;

	/* send re-echo */
	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 disk_buffer[CONFIG_CPM_BLOCK_SIZE];
static struct cpm_drive_s drv_table[CONFIG_CPM_MAX_DRIVE];
static int handle_cpm_drv_to;


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 drv)
{
	if (drv < CONFIG_CPM_MAX_DRIVE) {
		struct cpm_drive_s *p = &drv_table[drv];

		debug_cpmsd("##  detach dsk%d: %s\n", drv,
				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;
		}
	}
	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 drv, const char *filename, drv_opt_t options)
{
	int res;

	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;
		}

		p->opt = options & ~DRV_OPT_REATTATCH;

		/* TODO: change options */

	} 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_WRITE | FA_READ);

		if (!res && f_size(&p->fd) < CONFIG_CPM_DISKSIZE) {
			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);
			}
		}
		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) {
					f_sync(&drv_table[i].fd);
					drv_table[i].flags &= ~DRV_FLG_DIRTY;
					debug_cpmsd("## %7lu f_sync: %c:\n", get_timer(0), i + CONFIG_CPM_BASE_DRIVE);
				}
			}
			state = 0;
		}
	}
	return state;
}


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;

	if (rc) {
		debug_cpmsd("###%7lu  error rc: %.02x, res: %d\n", get_timer(0), rc, res);
	}

	msg_xmit(2, subf, sizeof(result_msg), result_msg);
}

/*
 	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)
{
	uint8_t drv;
	struct cpm_drive_s *p;
	FRESULT res = 0;

	(void)subf;

	if (len != 5) {
		return msg_cpm_result(subf, 0x01, res);
	}

	debug_cpmsd("\n## %7lu  login: %c:\n", get_timer(0), msg[1]+CONFIG_CPM_BASE_DRIVE);

	/* Get relative drive number */
	drv = msg[1];
	if ( drv >= CONFIG_CPM_MAX_DRIVE) {
		debug_cpmsd("##           failed: invalid relative drive number '%d'\n", drv);
		return msg_cpm_result(subf, 0x02, res);
	}

	p = &drv_table[drv];
	p->flags &= ~DRV_FLG_OPEN;
	p->dph = ((uint32_t)msg[4] << 16) + ((uint16_t)msg[3] << 8) + msg[2];


	if (p->img_name == NULL) {
		/* no file attached */
		debug_cpmsd("##           failed: no file attached:\n");
		return msg_cpm_result(subf, 0x03, res);
	}

	p->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)
{
	uint8_t drv;
	uint32_t addr;
	uint32_t pos;
	uint8_t secs;
	bool dowrite = (subf == 2);
	FRESULT res = 0;
	uint8_t rc = 0;
	bool buserr = 0;

	if (len != 10) {
		return msg_cpm_result(subf, 0x01, res);
	}

	drv = msg[RDRV];
	if ( drv>= CONFIG_CPM_MAX_DRIVE) {
		return msg_cpm_result(subf, 0x02, res);
	}

	secs = msg[CNT];
	addr = ((uint32_t)msg[ADDR+2] << 16) + ((uint16_t)msg[ADDR+1] << 8) + msg[ADDR];


	/* TODO: tracks per sector from dpb */
	pos = (((uint16_t)(msg[TRK+1] << 8) + msg[TRK]) * 8
			+ ((uint32_t)(msg[SEC+1] << 8) + msg[SEC])) * CONFIG_CPM_BLOCK_SIZE;

	debug_cpmsd("## %7lu cpm_rw: %s %c: trk:%4d, sec: %d, pos: %.8lx, secs: %2d, "
			"addr: %.5lx\n", get_timer(0), dowrite ? "write" : " read",
			msg[RDRV]+CONFIG_CPM_BASE_DRIVE,
			((uint16_t)(msg[TRK+1] << 8) + msg[TRK]), msg[SEC],	pos, msg[CNT], addr);

	if (pos + secs * CONFIG_CPM_BLOCK_SIZE > CONFIG_CPM_DISKSIZE) {
		debug_cpmsd("                   access > DISKSIZE (%.8lx > %.8lx) aborted!\n",
						pos + secs * CONFIG_CPM_BLOCK_SIZE, CONFIG_CPM_DISKSIZE);
		return msg_cpm_result(subf, 0x04, res);
	}

	res = f_lseek(&drv_table[drv].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(&drv_table[drv].fd, disk_buffer, CONFIG_CPM_BLOCK_SIZE, &brw);
		} else {
			res = f_read(&drv_table[drv].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) {
			debug_cpmsd("           short read or write: res: %d, bytes rd/wr: %u\n", res, brw);
			res = 64;
		}
		addr += CONFIG_CPM_BLOCK_SIZE;
	}

	if (dowrite && !res) {
		drv_table[drv].flags |= DRV_FLG_DIRTY;
		bg_setstat(handle_cpm_drv_to, 1);
	}

	if (buserr) {
		debug_cpmsd("Bus timeout\n");
		rc = 0x03;
	}

	/* send  result*/
	msg_cpm_result(subf, rc, res);
}


const FLASH struct msg_item z80_messages[] =
{
	{ 0,			/* fct nr. */
	  1, 3,			/* sub fct nr. from, to */
	  do_msg_ini_memfifo},
	{ 1,
	  1, 1,
	  do_msg_char_out},
	{ 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},

};


void do_message(int len, uint8_t *msg)
{
	uint8_t fct, sub_fct;
	int_fast8_t i = 0;

	if (len >= 2) {
		fct = *msg++;
		sub_fct = *msg++;
		len -= 2;

		while (fct != z80_messages[i].fct) {
			if (z80_messages[i].fct == 0xff) {
				DBG_P(1, "do_message: Unknown function: %i, %i\n",
						fct, sub_fct);
				return; /* TODO: unknown message # */
			}

			++i;
		}

		while (fct == z80_messages[i].fct) {
			if (sub_fct >= z80_messages[i].sub_min &&
					sub_fct <= z80_messages[i].sub_max )
				break;
			++i;
		}

		if (z80_messages[i].fct != fct) {
			DBG_P(1, "do_message: Unknown sub function: %i, %i\n",
					fct, sub_fct);
			return; /* TODO: unknown message sub# */
		}

		(z80_messages[i].func)(sub_fct, len, msg);


	} else {
		/* TODO: error */
		DBG_P(1, "do_message: to few arguments (%i); this shouldn't happen!\n", len);
	}
}


#define CTRBUF_LEN 256

void check_msg_fifo(void)
{
	int ch;
	static int_fast8_t state;
	static int msglen,idx;
	static uint8_t buffer[CTRBUF_LEN];

	while ((ch = z80_memfifo_getc(fifo_msgin)) >= 0) {
		switch (state) {
		case 0:		/* wait for start of message */
			if (ch == 0xAE)	{ /* TODO: magic number */
				msglen = 0;
				idx = 0;
				state = 1;
			}
			break;
		case 1:		/* get msg len */
			if (ch > 0 && ch <= CTRBUF_LEN) {
				msglen = ch;
				state = 2;
			} else
				state = 0;
			break;
		case 2: 	/* get message */
			buffer[idx++] = ch;
			if (idx == msglen) {
				do_message(msglen, buffer);
				state = 0;
			}
			break;
		}
	}
}


int msg_handling(int state)
{
	bool pending;

	ATOMIC_BLOCK(ATOMIC_FORCEON) {
		pending = (Stat & S_MSG_PENDING) != 0;
		Stat &= ~S_MSG_PENDING;
	}

	if (pending) {
		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 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 (fifo_addr != 0) {
				z80_memfifo_init(fifo_msgin, fifo_addr);
				state = 1;
			} else
				state = 0;

		} else {
			check_msg_fifo();
		}
	}

	return state;
}


static int handle_msg_handling;

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_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[] = {
	0xAF,			// xor     a
	0xED, 0x39, 0x36,	// out0    (rcr),a         ;disable  DRAM refresh
	0x3E, 0x30,		// ld      a,030h
	0xED, 0x39, 0x32	//out0    (dcntl),a       ;0 mem, max i/0 wait states
};

const FLASH uint8_t sertest[] = {
	0xAF,              //  	xor	a
	0xED, 0x39, 0x36,  //  	out0	(rcr),a		;disable  DRAM refresh
	0x3E, 0x30,        //  	ld	a,030h
	0xED, 0x39, 0x32,  //  	out0	(dcntl),a	;0 mem, max i/0 wait states
	0x3E, 0x80,        //  	ld	a,M_MPBT		;no MP, PS=10, DR=16, SS=0
	0xED, 0x39, 0x03,  //  	out0	(cntlb1),a
	0x3E, 0x64,        //  	ld	a,M_RE + M_TE + M_MOD2	;
	0xED, 0x39, 0x01,  //  	out0	(cntla1),a
	0x3E, 0x00,        //  	ld	a,0
	0xED, 0x39, 0x05,  //  	out0	(stat1),a	;Enable rx interrupts
	0xED, 0x38, 0x05,  //l0:in0	a,(stat1)
	0xE6, 0x80,        //  	and	80h
	0x28, 0xF9,        //  	jr	z,l0
	0xED, 0x00, 0x09,  //  	in0	b,(rdr1)
	0xED, 0x38, 0x05,  //l1:in0	a,(stat1)
	0xE6, 0x02,        //  	and	02h
	0x28, 0xF9,        //  	jr	z,l1
	0xED, 0x01, 0x07,  //  	out0	(tdr1),b
	0x18, 0xEA,        //  	jr	l0
};

const FLASH uint8_t test1[] = {
	0xAF,              //	xor	a
	0xED, 0x39, 0x36,  //	out0	(rcr),a		;disable  DRAM refresh
	0x3E, 0x30,        //	ld	a,030h
	0xED, 0x39, 0x32,  //	out0	(dcntl),a	;0 mem, max i/0 wait states
	0x21, 0x1E, 0x00,  // 	ld	hl,dmclrt	;load DMA registers
	0x06, 0x08,        //	ld	b,dmct_e-dmclrt
	0x0E, 0x20,        //	ld	c,sar0l
	0xED, 0x93,        //	otimr
	0x3E, 0xC3,        //	ld	a,0c3h		;dst +1, src +1, burst
	0xED, 0x39, 0x31,  //	out0	(dmode),a	;
	0x3E, 0x62,        //	ld	a,062h		;enable dma0,
	0xED, 0x39, 0x30,  //cl_1:	out0	(dstat),a	;copy 64k
	0x18, 0xFB,        //	jr	cl_1		;
	0x00, 0x00,        //dmclrt:	dw	0		;src (inc)
	0x00,              //	db 	0		;src
	0x00, 0x00,        //	dw	0		;dst (inc),
	0x00,              //	db	0		;dst
	0x00, 0x00,        //	dw 	0		;count (64k)
};
#endif
Commit	Line	Data
35edb766	1	/*
1aed7fd5	2	* (C) Copyright 2014-2016 Leo C. <erbl259-lmu@yahoo.de>
35edb766	3	*
ad12f284	4	* SPDX-License-Identifier: GPL-2.0
35edb766 L	5	*/
35edb766 L	6
cb4fb1ed	7	#include "z180-serv.h"
72f58822	8	#include "common.h"
5f7f3586 L	9	#include <stdlib.h>
	10	#include <string.h>
	11	#include <stdbool.h>
89adce76	12	#include <util/atomic.h>
72f58822	13
1aed7fd5	14	#include "config.h"
89adce76	15	#include "background.h"
5f7f3586 L	16	#include "env.h"
5f7f3586 L	17	#include "ff.h"
72f58822 L	18	#include "serial.h"
72f58822 L	19	#include "z80-if.h"
889202c4	20	#include "debug.h"
5f7f3586	21	#include "print-utils.h"
daacc6f9	22	#include "timer.h"
845cbdbd L	23	#include "time.h"
	24	#include "bcd.h"
	25	#include "rtc.h"
7d60b20b	26
cb4fb1ed	27	#define DEBUG_CPM_SDIO 1 /* set to 1 to debug */
7d60b20b L	28
	29	#define debug_cpmsd(fmt, args...) \
	30	debug_cond(DEBUG_CPM_SDIO, fmt, ##args)
	31
	32
72f58822 L	33	/--------------------------------------------------------------------------/
	34
	35	struct msg_item {
	36	uint8_t fct;
	37	uint8_t sub_min, sub_max;
	38	void (func)(uint8_t, int, uint8_t );
	39	};
	40
	41	uint32_t msg_to_addr(uint8_t *msg)
	42	{
	43	union {
	44	uint32_t as32;
	45	uint8_t as8[4];
	46	} addr;
	47
	48	addr.as8[0] = msg[0];
	49	addr.as8[1] = msg[1];
	50	addr.as8[2] = msg[2];
	51	addr.as8[3] = 0;
	52
	53	return addr.as32;
	54	}
	55
72f58822	56
1a2460dc L	57	static int msg_xmit_header(uint8_t func, uint8_t subf, int len)
	58	{
	59	z80_memfifo_putc(fifo_msgout, 0xAE);
	60	z80_memfifo_putc(fifo_msgout, len+2);
	61	z80_memfifo_putc(fifo_msgout, func);
	62	z80_memfifo_putc(fifo_msgout, subf);
	63
	64	return 0;
	65	}
	66
	67	int msg_xmit(uint8_t func, uint8_t subf, int len, uint8_t *msg)
	68	{
	69	msg_xmit_header(func, subf, len);
	70	while (len--)
	71	z80_memfifo_putc(fifo_msgout, *msg++);
	72
	73	return 0;
	74	}
	75
72f58822 L	76	void do_msg_ini_memfifo(uint8_t subf, int len, uint8_t * msg)
	77	{
	78	(void)len;
	79
89adce76	80	z80_memfifo_init(subf, msg_to_addr(msg));
72f58822 L	81	}
	82
	83
	84	void do_msg_char_out(uint8_t subf, int len, uint8_t * msg)
	85	{
	86	(void)subf;
	87
	88	while (len--)
	89	putchar(*msg++);
	90	}
	91
1a2460dc L	92	/* echo message */
	93	void do_msg_echo(uint8_t subf, int len, uint8_t * msg)
	94	{
	95	(void)subf;
	96
	97	/* send re-echo */
	98	msg_xmit(1, 3, len, msg);
	99	}
	100
8590a76b L	101	/* get timer */
	102	void do_msg_get_timer(uint8_t subf, int len, uint8_t * msg)
	103	{
a8eb521f	104	uint32_t time_ms = (len >= 4) ? (uint32_t ) msg : 0;
8590a76b	105
a8eb521f	106	time_ms = get_timer(time_ms);
8590a76b L	107	msg_xmit(3, subf, sizeof(time_ms), (uint8_t *) &time_ms);
	108	}
	109
5f7f3586 L	110	/* ---------------------------------------------------------------------------*/
5f7f3586 L	111
845cbdbd L	112	#define CPM_DAY_OFFSET ((1978-1900) * 365 + 19) /* 19 leap years */
	113
	114	/*
	115	* Convert CP/M time stamp to a broken-down time structure
	116	*
	117	*/
	118	int mk_date_time (int len, uint8_t msg, struct tm tmp)
	119	{
	120	time_t stamp;
	121
	122	if (len != 5)
	123	return -1;
	124
	125	/* days since 2000-01-01 */
	126	long days = msg[3] + (msg[4] << 8) - 8036;
	127
	128	if (days < 0)
	129	return -1;
	130
	131	stamp = days * ONE_DAY;
	132	stamp += bcd2bin(msg[0]);
	133	stamp += bcd2bin(msg[1]) * 60 ;
8d0fad4c	134	stamp += bcd2bin(msg[2]) * 3600L;
845cbdbd L	135	gmtime_r(&stamp, tmp);
	136	return 0;
	137	}
	138
	139	void mk_cpm_time(struct tm *tmp, uint8_t cpm_time[5])
	140	{
	141	uint16_t days = 1;
	142	uint_fast8_t leap=2;
	143
	144	for (int year=78; year < tmp->tm_year; year++) {
	145	days = days + 365 + (leap == 0);
	146	leap = (leap+1)%4;
	147	}
	148	days += tmp->tm_yday;
	149
	150	cpm_time[0] = bin2bcd(tmp->tm_sec);
	151	cpm_time[1] = bin2bcd(tmp->tm_min);
	152	cpm_time[2] = bin2bcd(tmp->tm_hour);
	153	cpm_time[3] = days;
	154	cpm_time[4] = days >> 8;
845cbdbd L	155	}
	156
	157	/* get/set cp/m time */
	158	void do_msg_get_set_time(uint8_t subf, int len, uint8_t * msg)
	159	{
	160	struct tm t;
	161	uint8_t cpm_time[5];
	162	int rc;
	163
	164	memset(cpm_time, 0, ARRAY_SIZE(cpm_time));
	165
	166	switch (subf) {
	167	case 3: /* set date & time */
	168	/* initialize t with current time */
	169	rc = rtc_get (&t);
	170
85046f8c	171	if (rc >= 0) {
845cbdbd L	172	/* insert new date & time */
	173	if (mk_date_time (len, msg, &t) != 0) {
	174	my_puts_P(PSTR("## set_time: Bad date format\n"));
	175	break;
	176	}
	177
	178	time_t time;
	179	time = mk_gmtime(&t);
	180	gmtime_r(&time, &t);
	181
	182	/* and write to RTC */
	183	rc = rtc_set (&t);
	184	if(rc)
	185	my_puts_P(PSTR("## set_time: Set date failed\n"));
	186	} else {
	187	my_puts_P(PSTR("## set_time: Get date failed\n"));
	188	}
	189	/* FALL TROUGH */
	190	case 2: /* get date & time */
	191	rc = rtc_get (&t);
85046f8c L	192	if (rc >= 0) {
	193	time_t time;
	194	time = mk_gmtime(&t);
	195	//mktime(&t);
	196	gmtime_r(&time, &t);
845cbdbd	197
85046f8c L	198	mk_cpm_time(&t, cpm_time);
85046f8c L	199	} else {
845cbdbd	200	my_puts_P(PSTR("## get_time: Get date failed\n"));
845cbdbd	201	}
845cbdbd L	202	break;
	203	}
	204
	205	msg_xmit(3, subf, sizeof(cpm_time), cpm_time);
	206	}
	207
	208	/* ---------------------------------------------------------------------------*/
	209
1aed7fd5 L	210	static uint8_t disk_buffer[CONFIG_CPM_BLOCK_SIZE];
1aed7fd5 L	211	static struct cpm_drive_s drv_table[CONFIG_CPM_MAX_DRIVE];
393b1897 L	212	static int handle_cpm_drv_to;
393b1897 L	213
393b1897	214
cb4fb1ed L	215	int drv_list(void)
	216	{
	217	for (uint8_t i = 0; i < CONFIG_CPM_MAX_DRIVE; i++) {
	218	struct cpm_drive_s * p = &drv_table[i];
	219	if (p->img_name) {
	220	printf_P(PSTR(" dsk%d: %2s %3s attached to %s\n"), i,
	221	p->opt&DRV_OPT_RO ? "RO":"RW", p->opt&DRV_OPT_DEBUG ? "DBG":"",
	222	p->img_name);
	223	}
	224	}
	225	return 0;
	226	}
	227
	228	int drv_detach(uint8_t drv)
	229	{
	230	if (drv < CONFIG_CPM_MAX_DRIVE) {
	231	struct cpm_drive_s *p = &drv_table[drv];
	232
	233	debug_cpmsd("## detach dsk%d: %s\n", drv,
	234	p->img_name ? p->img_name : "-");
	235
	236	if (p->img_name) {
	237	f_close(&p->fd);
cb4fb1ed	238	free(p->img_name);
4122fe90 L	239	p->opt = 0;
4122fe90 L	240	p->flags &= ~DRV_FLG_DIRTY;
cb4fb1ed L	241	p->img_name = NULL;
	242	}
	243	}
	244	return 0;
	245	}
	246
	247	static int drv_find_file_attached(const char *fn)
	248	{
	249	for (uint8_t i = 0; i < CONFIG_CPM_MAX_DRIVE; i++) {
	250	struct cpm_drive_s *p = &drv_table[i];
	251	if (p->img_name && !strcmp(fn, p->img_name)) {
	252	return i;
	253	}
	254	}
	255	return -1;
	256	}
	257
	258	int drv_attach(uint8_t drv, const char *filename, drv_opt_t options)
	259	{
	260	int res;
	261
	262	if (drv >= CONFIG_CPM_MAX_DRIVE)
	263	return AT_RANGE;
	264
	265	struct cpm_drive_s *p = &drv_table[drv];
	266
	267	if (options & DRV_OPT_REATTATCH) {
	268	if (filename) {
	269	return AT_ERROR;
	270	}
	271
	272	if (!p->img_name) {
	273	return AT_NOT;
	274	}
	275
	276	p->opt = options & ~DRV_OPT_REATTATCH;
	277
	278	/* TODO: change options */
	279
	280	} else {
	281
	282	if (p->img_name)
	283	return AT_ALREADY;
	284	if (drv_find_file_attached(filename) >= 0)
	285	return AT_OTHER;
	286
4122fe90	287	p->opt = options;
cb4fb1ed L	288
	289	/* new attachment */
	290
	291	if ((p->img_name = strdup(filename)) == NULL)
	292	return AT_NOMEM;
	293
	294	res = f_open(&p->fd, p->img_name,
	295	FA_WRITE \| FA_READ);
	296
	297	if (!res && f_size(&p->fd) < CONFIG_CPM_DISKSIZE) {
	298	unsigned int bw;
	299
	300	debug_cpmsd(" expanding image file from %ld to %ld\n",
	301	f_size(&p->fd), CONFIG_CPM_DISKSIZE);
	302
	303	res = f_lseek(&p->fd, CONFIG_CPM_DISKSIZE-CONFIG_CPM_BLOCK_SIZE);
	304	if (!res) {
	305	memset(disk_buffer, 0xe5, CONFIG_CPM_BLOCK_SIZE);
	306	res = f_write(&p->fd, disk_buffer, CONFIG_CPM_BLOCK_SIZE, &bw);
	307	if (res \|\| bw < CONFIG_CPM_BLOCK_SIZE) {
	308	debug_cpmsd(" failed! res: %d, bytes written: %u\n", res, bw);
	309	}
4122fe90	310	p->flags \|= DRV_FLG_DIRTY;
cb4fb1ed L	311	bg_setstat(handle_cpm_drv_to, 1);
	312	}
	313	}
	314	if (res) {
	315	drv_detach(drv);
	316	return AT_OPEN;
	317	}
	318	}
	319
	320	return AT_OK;
	321	}
	322
	323
393b1897 L	324	int cpm_drv_to(int state)
	325	{
	326	static uint32_t ts;
	327
	328	switch(state) {
	329	case 0:
	330	break;
	331
	332	case 1:
	333	ts = get_timer(0);
	334	state = 2;
	335	break;
	336
	337	case 2:
	338	if (get_timer(ts) > 1000) {
1aed7fd5	339	for (uint_fast8_t i=0; i < CONFIG_CPM_MAX_DRIVE; i++) {
4122fe90	340	if (drv_table[i].flags & DRV_FLG_DIRTY) {
393b1897	341	f_sync(&drv_table[i].fd);
4122fe90	342	drv_table[i].flags &= ~DRV_FLG_DIRTY;
afc7c4b4	343	debug_cpmsd("## %7lu f_sync: %c:\n", get_timer(0), i + CONFIG_CPM_BASE_DRIVE);
393b1897 L	344	}
	345	}
	346	state = 0;
	347	}
	348	}
	349	return state;
	350	}
	351
	352
	353	void msg_cpm_result(uint8_t subf, uint8_t rc, int res)
	354	{
	355	uint8_t result_msg[3];
	356
	357	if (res)
	358	rc \|= 0x80;
	359
	360	result_msg[0] = rc;
	361	result_msg[1] = res;
	362	result_msg[2] = res >> 8;
	363
	364	if (rc) {
	365	debug_cpmsd("###%7lu error rc: %.02x, res: %d\n", get_timer(0), rc, res);
	366	}
	367
	368	msg_xmit(2, subf, sizeof(result_msg), result_msg);
	369	}
5f7f3586 L	370
	371	/*
	372	db 2 ; disk command
	373	ds 1 ; subcommand (login/read/write)
	374	ds 1 ; @adrv (8 bits) +0
	375	ds 1 ; @rdrv (8 bits) +1
	376	ds 3 ; @xdph (24 bits) +2
	377	*/
	378
	379	void do_msg_cpm_login(uint8_t subf, int len, uint8_t * msg)
	380	{
5f7f3586	381	uint8_t drv;
4122fe90 L	382	struct cpm_drive_s *p;
4122fe90 L	383	FRESULT res = 0;
5f7f3586 L	384
	385	(void)subf;
	386
afc7c4b4	387	if (len != 5) {
393b1897	388	return msg_cpm_result(subf, 0x01, res);
5f7f3586 L	389	}
5f7f3586 L	390
afc7c4b4	391	debug_cpmsd("\n## %7lu login: %c:\n", get_timer(0), msg[1]+CONFIG_CPM_BASE_DRIVE);
5f7f3586	392
afc7c4b4 L	393	/* Get relative drive number */
afc7c4b4 L	394	drv = msg[1];
cb4fb1ed	395	if ( drv >= CONFIG_CPM_MAX_DRIVE) {
4122fe90	396	debug_cpmsd("## failed: invalid relative drive number '%d'\n", drv);
393b1897	397	return msg_cpm_result(subf, 0x02, res);
5f7f3586 L	398	}
5f7f3586 L	399
4122fe90 L	400	p = &drv_table[drv];
	401	p->flags &= ~DRV_FLG_OPEN;
	402	p->dph = ((uint32_t)msg[4] << 16) + ((uint16_t)msg[3] << 8) + msg[2];
cb4fb1ed	403
5f7f3586	404
4122fe90 L	405	if (p->img_name == NULL) {
	406	/* no file attached */
	407	debug_cpmsd("## failed: no file attached:\n");
393b1897	408	return msg_cpm_result(subf, 0x03, res);
5f7f3586 L	409	}
5f7f3586 L	410
4122fe90	411	p->flags \|= DRV_FLG_OPEN;
afc7c4b4	412
5f7f3586	413	/* send result*/
393b1897	414	msg_cpm_result(subf, 0x00, res);
5f7f3586 L	415	}
	416
	417
	418	/*
	419	db 2 ; disk command
	420	ds 1 ; subcommand (login/read/write)
daacc6f9 L	421	ds 1 ; @adrv (8 bits) +0
	422	ds 1 ; @rdrv (8 bits) +1
	423	ds 2 ; @trk (16 bits) +2
	424	ds 2 ; @sect(16 bits) +4
	425	ds 1 ; @cnt (8 bits) +6
5f7f3586 L	426	ds 3 ; phys. transfer addr +7
	427	*/
	428
daacc6f9 L	429	#define ADRV 0
	430	#define RDRV 1
	431	#define TRK 2
	432	#define SEC 4
	433	#define CNT 6
	434	#define ADDR 7
	435
5f7f3586 L	436	void do_msg_cpm_rw(uint8_t subf, int len, uint8_t * msg)
	437	{
	438	uint8_t drv;
	439	uint32_t addr;
	440	uint32_t pos;
7d60b20b	441	uint8_t secs;
5f7f3586 L	442	bool dowrite = (subf == 2);
	443	FRESULT res = 0;
	444	uint8_t rc = 0;
	445	bool buserr = 0;
5f7f3586	446
afc7c4b4	447	if (len != 10) {
393b1897	448	return msg_cpm_result(subf, 0x01, res);
5f7f3586 L	449	}
5f7f3586 L	450
afc7c4b4	451	drv = msg[RDRV];
1aed7fd5	452	if ( drv>= CONFIG_CPM_MAX_DRIVE) {
393b1897	453	return msg_cpm_result(subf, 0x02, res);
5f7f3586 L	454	}
5f7f3586 L	455
7d60b20b	456	secs = msg[CNT];
daacc6f9	457	addr = ((uint32_t)msg[ADDR+2] << 16) + ((uint16_t)msg[ADDR+1] << 8) + msg[ADDR];
5f7f3586	458
5f7f3586	459
daacc6f9 L	460	/* TODO: tracks per sector from dpb */
daacc6f9 L	461	pos = (((uint16_t)(msg[TRK+1] << 8) + msg[TRK]) * 8
1aed7fd5	462	+ ((uint32_t)(msg[SEC+1] << 8) + msg[SEC])) * CONFIG_CPM_BLOCK_SIZE;
5f7f3586	463
7d60b20b L	464	debug_cpmsd("## %7lu cpm_rw: %s %c: trk:%4d, sec: %d, pos: %.8lx, secs: %2d, "
7d60b20b L	465	"addr: %.5lx\n", get_timer(0), dowrite ? "write" : " read",
afc7c4b4 L	466	msg[RDRV]+CONFIG_CPM_BASE_DRIVE,
afc7c4b4 L	467	((uint16_t)(msg[TRK+1] << 8) + msg[TRK]), msg[SEC], pos, msg[CNT], addr);
5f7f3586	468
1aed7fd5 L	469	if (pos + secs * CONFIG_CPM_BLOCK_SIZE > CONFIG_CPM_DISKSIZE) {
	470	debug_cpmsd(" access > DISKSIZE (%.8lx > %.8lx) aborted!\n",
	471	pos + secs * CONFIG_CPM_BLOCK_SIZE, CONFIG_CPM_DISKSIZE);
	472	return msg_cpm_result(subf, 0x04, res);
	473	}
	474
5f7f3586	475	res = f_lseek(&drv_table[drv].fd, pos);
1aed7fd5	476
7d60b20b	477	while (!res && secs--) {
8bbf185e	478	unsigned int brw;
5f7f3586 L	479	if (dowrite) {
	480	if (!(z80_bus_cmd(Request) & ZST_ACQUIRED)) {
	481	buserr = 1;
7d60b20b	482	break;
5f7f3586	483	} else {
1aed7fd5	484	z80_read_block(disk_buffer, addr, CONFIG_CPM_BLOCK_SIZE);
5f7f3586	485	z80_bus_cmd(Release);
5f7f3586	486	}
1aed7fd5	487	res = f_write(&drv_table[drv].fd, disk_buffer, CONFIG_CPM_BLOCK_SIZE, &brw);
5f7f3586	488	} else {
1aed7fd5 L	489	res = f_read(&drv_table[drv].fd, disk_buffer, CONFIG_CPM_BLOCK_SIZE, &brw);
1aed7fd5 L	490	if (res == FR_OK) {
5f7f3586 L	491	if (!(z80_bus_cmd(Request) & ZST_ACQUIRED)) {
5f7f3586 L	492	buserr = 1;
7d60b20b	493	break;
5f7f3586	494	} else {
afc7c4b4	495	z80_write_block(disk_buffer, addr, CONFIG_CPM_BLOCK_SIZE);
5f7f3586 L	496	z80_bus_cmd(Release);
	497	}
	498	}
	499	}
1aed7fd5	500	if (brw != CONFIG_CPM_BLOCK_SIZE) {
afc7c4b4 L	501	debug_cpmsd(" short read or write: res: %d, bytes rd/wr: %u\n", res, brw);
afc7c4b4 L	502	res = 64;
5f7f3586	503	}
1aed7fd5	504	addr += CONFIG_CPM_BLOCK_SIZE;
5f7f3586 L	505	}
5f7f3586 L	506
393b1897	507	if (dowrite && !res) {
4122fe90	508	drv_table[drv].flags \|= DRV_FLG_DIRTY;
393b1897 L	509	bg_setstat(handle_cpm_drv_to, 1);
	510	}
	511
5f7f3586	512	if (buserr) {
7d60b20b	513	debug_cpmsd("Bus timeout\n");
5f7f3586 L	514	rc = 0x03;
5f7f3586 L	515	}
5f7f3586 L	516
5f7f3586 L	517	/* send result*/
393b1897	518	msg_cpm_result(subf, rc, res);
5f7f3586 L	519	}
5f7f3586 L	520
72f58822 L	521
	522	const FLASH struct msg_item z80_messages[] =
	523	{
	524	{ 0, /* fct nr. */
89adce76	525	1, 3, /* sub fct nr. from, to */
72f58822 L	526	do_msg_ini_memfifo},
	527	{ 1,
	528	1, 1,
	529	do_msg_char_out},
1a2460dc L	530	{ 1,
	531	2, 2,
	532	do_msg_echo},
5f7f3586 L	533	{ 2,
	534	0, 0,
	535	do_msg_cpm_login},
	536	{ 2,
	537	1, 2,
	538	do_msg_cpm_rw},
8590a76b L	539	{ 3,
	540	1, 1,
	541	do_msg_get_timer},
845cbdbd L	542	{ 3,
	543	2, 3, /* 2: get, 3: set time and date */
	544	do_msg_get_set_time},
72f58822 L	545	{ 0xff, /* end mark */
	546	0, 0,
	547	0},
	548
	549	};
	550
	551
	552
	553
	554	void do_message(int len, uint8_t *msg)
	555	{
	556	uint8_t fct, sub_fct;
	557	int_fast8_t i = 0;
	558
	559	if (len >= 2) {
	560	fct = *msg++;
	561	sub_fct = *msg++;
	562	len -= 2;
	563
89adce76 L	564	while (fct != z80_messages[i].fct) {
	565	if (z80_messages[i].fct == 0xff) {
	566	DBG_P(1, "do_message: Unknown function: %i, %i\n",
	567	fct, sub_fct);
	568	return; /* TODO: unknown message # */
	569	}
8a7decea	570
72f58822	571	++i;
72f58822 L	572	}
	573
	574	while (fct == z80_messages[i].fct) {
8a7decea	575	if (sub_fct >= z80_messages[i].sub_min &&
89adce76	576	sub_fct <= z80_messages[i].sub_max )
72f58822 L	577	break;
	578	++i;
	579	}
	580
	581	if (z80_messages[i].fct != fct) {
	582	DBG_P(1, "do_message: Unknown sub function: %i, %i\n",
	583	fct, sub_fct);
	584	return; /* TODO: unknown message sub# */
	585	}
	586
	587	(z80_messages[i].func)(sub_fct, len, msg);
	588
	589
	590	} else {
	591	/* TODO: error */
	592	DBG_P(1, "do_message: to few arguments (%i); this shouldn't happen!\n", len);
	593	}
	594	}
	595
	596
	597
	598	#define CTRBUF_LEN 256
	599
	600	void check_msg_fifo(void)
	601	{
	602	int ch;
	603	static int_fast8_t state;
	604	static int msglen,idx;
	605	static uint8_t buffer[CTRBUF_LEN];
	606
89adce76	607	while ((ch = z80_memfifo_getc(fifo_msgin)) >= 0) {
72f58822 L	608	switch (state) {
72f58822 L	609	case 0: /* wait for start of message */
3531528e	610	if (ch == 0xAE) { /* TODO: magic number */
72f58822 L	611	msglen = 0;
	612	idx = 0;
	613	state = 1;
	614	}
	615	break;
	616	case 1: /* get msg len */
	617	if (ch > 0 && ch <= CTRBUF_LEN) {
	618	msglen = ch;
	619	state = 2;
	620	} else
	621	state = 0;
	622	break;
	623	case 2: /* get message */
	624	buffer[idx++] = ch;
89adce76 L	625	if (idx == msglen) {
	626	do_message(msglen, buffer);
	627	state = 0;
	628	}
	629	break;
	630	}
	631	}
	632	}
	633
	634
	635	int msg_handling(int state)
	636	{
50939dec	637	bool pending;
8a7decea L	638
8a7decea L	639	ATOMIC_BLOCK(ATOMIC_FORCEON) {
89adce76 L	640	pending = (Stat & S_MSG_PENDING) != 0;
	641	Stat &= ~S_MSG_PENDING;
	642	}
8a7decea	643
89adce76	644	if (pending) {
215ec4b2 L	645	uint8_t init_request;
	646	z80_bus_cmd(Request);
	647	init_request = z80_read(0x43);
	648	z80_bus_cmd(Release);
	649	if ( init_request != 0) {
8bbf185e	650	/* Get address of fifo 0 */
89adce76	651	z80_bus_cmd(Request);
8bbf185e L	652	uint32_t fifo_addr = z80_read(0x40) +
	653	((uint16_t) z80_read(0x40+1) << 8) +
	654	((uint32_t) z80_read(0x40+2) << 16);
215ec4b2 L	655	z80_write(0x43, 0);
	656	z80_bus_cmd(Release);
	657
	658	if (fifo_addr != 0) {
	659	z80_memfifo_init(fifo_msgin, fifo_addr);
	660	state = 1;
	661	} else
	662	state = 0;
	663
	664	} else {
89adce76	665	check_msg_fifo();
72f58822 L	666	}
	667	}
	668
89adce76 L	669	return state;
89adce76 L	670	}
89adce76 L	671
	672
	673	static int handle_msg_handling;
	674
	675	void setup_z180_serv(void)
	676	{
8a7decea	677
89adce76	678	handle_msg_handling = bg_register(msg_handling, 0);
393b1897	679	handle_cpm_drv_to = bg_register(cpm_drv_to, 0);
72f58822 L	680	}
72f58822 L	681
89adce76 L	682	void restart_z180_serv(void)
	683	{
	684	z80_bus_cmd(Request);
215ec4b2	685	z80_memset(0x40, 0, 4);
89adce76	686	z80_bus_cmd(Release);
8a7decea L	687
	688	for (int i = 0; i < NUM_FIFOS; i++)
	689	z80_memfifo_init(i, 0);
89adce76	690	bg_setstat(handle_msg_handling, 0);
5f7f3586	691
89adce76	692	}
72f58822	693
845cbdbd	694	#if 0
72f58822 L	695	/--------------------------------------------------------------------------/
72f58822 L	696
72f58822 L	697	const FLASH uint8_t iniprog[] = {
	698	0xAF, // xor a
	699	0xED, 0x39, 0x36, // out0 (rcr),a ;disable DRAM refresh
	700	0x3E, 0x30, // ld a,030h
	701	0xED, 0x39, 0x32 //out0 (dcntl),a ;0 mem, max i/0 wait states
	702	};
	703
	704	const FLASH uint8_t sertest[] = {
	705	0xAF, // xor a
	706	0xED, 0x39, 0x36, // out0 (rcr),a ;disable DRAM refresh
	707	0x3E, 0x30, // ld a,030h
	708	0xED, 0x39, 0x32, // out0 (dcntl),a ;0 mem, max i/0 wait states
	709	0x3E, 0x80, // ld a,M_MPBT ;no MP, PS=10, DR=16, SS=0
	710	0xED, 0x39, 0x03, // out0 (cntlb1),a
	711	0x3E, 0x64, // ld a,M_RE + M_TE + M_MOD2 ;
	712	0xED, 0x39, 0x01, // out0 (cntla1),a
	713	0x3E, 0x00, // ld a,0
	714	0xED, 0x39, 0x05, // out0 (stat1),a ;Enable rx interrupts
	715	0xED, 0x38, 0x05, //l0:in0 a,(stat1)
	716	0xE6, 0x80, // and 80h
	717	0x28, 0xF9, // jr z,l0
	718	0xED, 0x00, 0x09, // in0 b,(rdr1)
	719	0xED, 0x38, 0x05, //l1:in0 a,(stat1)
	720	0xE6, 0x02, // and 02h
	721	0x28, 0xF9, // jr z,l1
	722	0xED, 0x01, 0x07, // out0 (tdr1),b
	723	0x18, 0xEA, // jr l0
	724	};
	725
	726	const FLASH uint8_t test1[] = {
	727	0xAF, // xor a
	728	0xED, 0x39, 0x36, // out0 (rcr),a ;disable DRAM refresh
	729	0x3E, 0x30, // ld a,030h
	730	0xED, 0x39, 0x32, // out0 (dcntl),a ;0 mem, max i/0 wait states
	731	0x21, 0x1E, 0x00, // ld hl,dmclrt ;load DMA registers
	732	0x06, 0x08, // ld b,dmct_e-dmclrt
	733	0x0E, 0x20, // ld c,sar0l
8a7decea	734	0xED, 0x93, // otimr
72f58822 L	735	0x3E, 0xC3, // ld a,0c3h ;dst +1, src +1, burst
72f58822 L	736	0xED, 0x39, 0x31, // out0 (dmode),a ;
8a7decea	737	0x3E, 0x62, // ld a,062h ;enable dma0,
72f58822 L	738	0xED, 0x39, 0x30, //cl_1: out0 (dstat),a ;copy 64k
72f58822 L	739	0x18, 0xFB, // jr cl_1 ;
8a7decea	740	0x00, 0x00, //dmclrt: dw 0 ;src (inc)
72f58822 L	741	0x00, // db 0 ;src
	742	0x00, 0x00, // dw 0 ;dst (inc),
	743	0x00, // db 0 ;dst
	744	0x00, 0x00, // dw 0 ;count (64k)
	745	};
845cbdbd	746	#endif