]> cloudbase.mooo.com Git - z180-stamp.git/blame - avr/z180-serv.c
avr/z180-serv.c: Workaround for GCC bug PR61443
[z180-stamp.git] / avr / z180-serv.c
CommitLineData
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 */
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"
17#include "ff.h"
72f58822
L
18#include "serial.h"
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
2ca8d8c7 27#define DEBUG_CPM_SDIO 0 /* 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
35struct msg_item {
36 uint8_t fct;
37 uint8_t sub_min, sub_max;
38 void (*func)(uint8_t, int, uint8_t *);
39};
40
41uint32_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
57static 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
67int 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
76void 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
84void 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 */
93void 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 */
102void 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/* ---------------------------------------------------------------------------*/
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 */
118int 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
139void 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 */
158void 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);
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
78c90027 210static uint8_t drv;
1aed7fd5
L
211static uint8_t disk_buffer[CONFIG_CPM_BLOCK_SIZE];
212static struct cpm_drive_s drv_table[CONFIG_CPM_MAX_DRIVE];
393b1897
L
213static int handle_cpm_drv_to;
214
78c90027 215typedef enum {SINGLE, START, MIDDLE, END} dbgmsg_t;
393b1897 216
78c90027 217void drv_debug(dbgmsg_t phase, const FLASH char *const fmt, ...) \
9461ecf3
L
218{
219 struct cpm_drive_s *dp = &drv_table[drv];
220
221 if (dp->opt & DRV_OPT_DEBUG) {
222
223 va_list ap;
78c90027 224 va_start (ap, fmt);
9461ecf3 225
78c90027
L
226 if (phase == SINGLE || phase == START)
227 printf_P(PSTR("# %7lu dsk%d: "), get_timer(0), drv);
9461ecf3 228
9461ecf3 229 vfprintf_P (stdout, fmt, ap);
9461ecf3 230
78c90027
L
231 if (phase == SINGLE || phase == END)
232 putc('\n', stdout);
233
234 va_end (ap);
9461ecf3
L
235 }
236}
237
cb4fb1ed
L
238int drv_list(void)
239{
240 for (uint8_t i = 0; i < CONFIG_CPM_MAX_DRIVE; i++) {
241 struct cpm_drive_s * p = &drv_table[i];
242 if (p->img_name) {
243 printf_P(PSTR(" dsk%d: %2s %3s attached to %s\n"), i,
244 p->opt&DRV_OPT_RO ? "RO":"RW", p->opt&DRV_OPT_DEBUG ? "DBG":"",
245 p->img_name);
246 }
247 }
248 return 0;
249}
250
78c90027 251int drv_detach(uint8_t unit)
cb4fb1ed 252{
78c90027 253 drv = unit;
cb4fb1ed
L
254 if (drv < CONFIG_CPM_MAX_DRIVE) {
255 struct cpm_drive_s *p = &drv_table[drv];
256
78c90027 257 drv_debug(SINGLE, PSTR("detach from '%s'"), p->img_name ? p->img_name : "-");
cb4fb1ed
L
258
259 if (p->img_name) {
260 f_close(&p->fd);
cb4fb1ed 261 free(p->img_name);
4122fe90
L
262 p->opt = 0;
263 p->flags &= ~DRV_FLG_DIRTY;
cb4fb1ed 264 p->img_name = NULL;
e34ae619 265
3b841cea 266 uint32_t scb = getenv_ulong(PSTR(ENV_CPM3_SCB), 16, 0);
e34ae619
L
267 if (scb && (z80_bus_cmd(Request) & ZST_ACQUIRED)) {
268 z80_write(scb + 0xf0, 0xff);
269 z80_write(p->dph + 11, 0xff);
270 z80_bus_cmd(Release);
271 }
cb4fb1ed
L
272 }
273 }
274 return 0;
275}
276
277static int drv_find_file_attached(const char *fn)
278{
279 for (uint8_t i = 0; i < CONFIG_CPM_MAX_DRIVE; i++) {
280 struct cpm_drive_s *p = &drv_table[i];
281 if (p->img_name && !strcmp(fn, p->img_name)) {
282 return i;
283 }
284 }
285 return -1;
286}
287
78c90027 288int drv_attach(uint8_t unit, const char *filename, drv_opt_t options)
cb4fb1ed
L
289{
290 int res;
291
78c90027 292 drv = unit;
cb4fb1ed
L
293 if (drv >= CONFIG_CPM_MAX_DRIVE)
294 return AT_RANGE;
295
296 struct cpm_drive_s *p = &drv_table[drv];
297
298 if (options & DRV_OPT_REATTATCH) {
299 if (filename) {
300 return AT_ERROR;
301 }
302
303 if (!p->img_name) {
304 return AT_NOT;
305 }
306
9baecc6b
L
307 /* change options */
308 if ((p->opt ^ options) & DRV_OPT_RO) {
309 f_close(&p->fd);
310 res = f_open(&p->fd, p->img_name,
311 FA_READ | (options&DRV_OPT_RO ? 0 : FA_WRITE));
312 }
cb4fb1ed 313
9baecc6b 314 p->opt = options & ~DRV_OPT_REATTATCH;
cb4fb1ed
L
315
316 } else {
317
318 if (p->img_name)
319 return AT_ALREADY;
320 if (drv_find_file_attached(filename) >= 0)
321 return AT_OTHER;
322
4122fe90 323 p->opt = options;
cb4fb1ed
L
324
325 /* new attachment */
326
327 if ((p->img_name = strdup(filename)) == NULL)
328 return AT_NOMEM;
329
330 res = f_open(&p->fd, p->img_name,
9baecc6b 331 FA_READ | (options&DRV_OPT_RO ? 0 : FA_WRITE));
cb4fb1ed
L
332
333 if (!res && f_size(&p->fd) < CONFIG_CPM_DISKSIZE) {
9baecc6b 334#if 0
cb4fb1ed 335 unsigned int bw;
cb4fb1ed
L
336 debug_cpmsd(" expanding image file from %ld to %ld\n",
337 f_size(&p->fd), CONFIG_CPM_DISKSIZE);
338
339 res = f_lseek(&p->fd, CONFIG_CPM_DISKSIZE-CONFIG_CPM_BLOCK_SIZE);
340 if (!res) {
341 memset(disk_buffer, 0xe5, CONFIG_CPM_BLOCK_SIZE);
342 res = f_write(&p->fd, disk_buffer, CONFIG_CPM_BLOCK_SIZE, &bw);
343 if (res || bw < CONFIG_CPM_BLOCK_SIZE) {
344 debug_cpmsd(" failed! res: %d, bytes written: %u\n", res, bw);
345 }
4122fe90 346 p->flags |= DRV_FLG_DIRTY;
cb4fb1ed
L
347 bg_setstat(handle_cpm_drv_to, 1);
348 }
9baecc6b 349#else
78c90027 350 drv_debug(SINGLE, PSTR("wrong image file size: %ld, should be %ld"),
9baecc6b
L
351 f_size(&p->fd), CONFIG_CPM_DISKSIZE);
352 res = 64;
353#endif
cb4fb1ed
L
354 }
355 if (res) {
356 drv_detach(drv);
357 return AT_OPEN;
358 }
359 }
360
361 return AT_OK;
362}
363
364
393b1897
L
365int cpm_drv_to(int state)
366{
367 static uint32_t ts;
368
369 switch(state) {
370 case 0:
371 break;
372
373 case 1:
374 ts = get_timer(0);
375 state = 2;
376 break;
377
378 case 2:
379 if (get_timer(ts) > 1000) {
1aed7fd5 380 for (uint_fast8_t i=0; i < CONFIG_CPM_MAX_DRIVE; i++) {
4122fe90 381 if (drv_table[i].flags & DRV_FLG_DIRTY) {
4122fe90 382 drv_table[i].flags &= ~DRV_FLG_DIRTY;
9461ecf3 383 f_sync(&drv_table[i].fd);
78c90027
L
384 drv = i;
385 drv_debug(SINGLE, PSTR("f_sync"));
393b1897
L
386 }
387 }
388 state = 0;
389 }
390 }
391 return state;
392}
393
78c90027
L
394static const FLASH char * const FLASH rc_messages[] = {
395 FSTR("OK"),
396 FSTR("Internal error: wrong message len"), /* 01 */
397 FSTR("Invalid relative drive #"), /* 02 */
398 FSTR("Bus timeout"), /* 03 */
399 FSTR("Access byond disk size"), /* 04 */
400 FSTR("Write protect"), /* 05 */
401 FSTR("No media"), /* 06 */
910e7206 402 FSTR("R/W address == 0 !!!!"), /* 07 */
78c90027 403 };
393b1897
L
404
405void msg_cpm_result(uint8_t subf, uint8_t rc, int res)
406{
407 uint8_t result_msg[3];
408
409 if (res)
410 rc |= 0x80;
411
412 result_msg[0] = rc;
413 result_msg[1] = res;
414 result_msg[2] = res >> 8;
415
393b1897 416 msg_xmit(2, subf, sizeof(result_msg), result_msg);
78c90027 417
a4f40a90
L
418 if (rc) {
419#if GCC_BUG_61443
420 char msg[40];
421 strncpy_P(msg, rc_messages[rc & 0x7f], sizeof msg -1);
422 drv_debug(END, PSTR(" rc: %.02x/%d, '%s'"),
423 rc, res, msg);
424#else
78c90027
L
425 drv_debug(END, PSTR(" rc: %.02x/%d, '%S'"),
426 rc, res, rc_messages[rc & 0x7f]);
a4f40a90
L
427#endif
428 } else
78c90027
L
429 drv_debug(END, PSTR(""));
430
393b1897 431}
5f7f3586
L
432
433/*
434 db 2 ; disk command
435 ds 1 ; subcommand (login/read/write)
436 ds 1 ; @adrv (8 bits) +0
437 ds 1 ; @rdrv (8 bits) +1
438 ds 3 ; @xdph (24 bits) +2
439*/
440
441void do_msg_cpm_login(uint8_t subf, int len, uint8_t * msg)
442{
9baecc6b 443 struct cpm_drive_s *dp;
4122fe90 444 FRESULT res = 0;
5f7f3586
L
445
446 (void)subf;
447
78c90027
L
448 /* Get relative drive number */
449 drv = msg[1];
450 drv_debug(START, PSTR("login"));
451
afc7c4b4 452 if (len != 5) {
393b1897 453 return msg_cpm_result(subf, 0x01, res);
5f7f3586
L
454 }
455
cb4fb1ed 456 if ( drv >= CONFIG_CPM_MAX_DRIVE) {
78c90027 457 /* invalid relative drive number */
393b1897 458 return msg_cpm_result(subf, 0x02, res);
5f7f3586
L
459 }
460
9baecc6b
L
461 dp = &drv_table[drv];
462 dp->flags &= ~DRV_FLG_OPEN;
463 dp->dph = ((uint32_t)msg[4] << 16) + ((uint16_t)msg[3] << 8) + msg[2];
cb4fb1ed 464
9baecc6b 465 if (dp->img_name == NULL) {
4122fe90 466 /* no file attached */
78c90027 467 return msg_cpm_result(subf, 0x06, res);
5f7f3586
L
468 }
469
019dc5f9
L
470 f_close(&dp->fd);
471 res = f_open(&dp->fd, dp->img_name,
472 FA_READ | (dp->opt&DRV_OPT_RO ? 0 : FA_WRITE));
473
9baecc6b 474 dp->flags |= DRV_FLG_OPEN;
afc7c4b4 475
5f7f3586 476 /* send result*/
393b1897 477 msg_cpm_result(subf, 0x00, res);
5f7f3586
L
478}
479
480
481/*
482 db 2 ; disk command
483 ds 1 ; subcommand (login/read/write)
daacc6f9
L
484 ds 1 ; @adrv (8 bits) +0
485 ds 1 ; @rdrv (8 bits) +1
486 ds 2 ; @trk (16 bits) +2
487 ds 2 ; @sect(16 bits) +4
488 ds 1 ; @cnt (8 bits) +6
5f7f3586
L
489 ds 3 ; phys. transfer addr +7
490*/
491
daacc6f9
L
492#define ADRV 0
493#define RDRV 1
494#define TRK 2
495#define SEC 4
496#define CNT 6
497#define ADDR 7
498
5f7f3586
L
499void do_msg_cpm_rw(uint8_t subf, int len, uint8_t * msg)
500{
9baecc6b 501 struct cpm_drive_s *dp;
5f7f3586
L
502 uint32_t addr;
503 uint32_t pos;
9461ecf3
L
504 uint16_t track;
505 uint16_t sec;
7d60b20b 506 uint8_t secs;
9baecc6b 507 bool dowrite;
5f7f3586
L
508 FRESULT res = 0;
509 uint8_t rc = 0;
510 bool buserr = 0;
5f7f3586 511
78c90027
L
512 drv = msg[RDRV];
513 dowrite = (subf == 2);
514
515 drv_debug(START, PSTR("%2S"), dowrite ? PSTR("W ") : PSTR(" R"));
516
afc7c4b4 517 if (len != 10) {
393b1897 518 return msg_cpm_result(subf, 0x01, res);
5f7f3586 519 }
1aed7fd5 520 if ( drv>= CONFIG_CPM_MAX_DRIVE) {
393b1897 521 return msg_cpm_result(subf, 0x02, res);
5f7f3586
L
522 }
523
9baecc6b 524 dp = &drv_table[drv];
9461ecf3
L
525 track = (uint16_t)(msg[TRK+1] << 8) + msg[TRK];
526 sec = (uint16_t)(msg[SEC+1] << 8) + msg[SEC];
7d60b20b 527 secs = msg[CNT];
daacc6f9 528 addr = ((uint32_t)msg[ADDR+2] << 16) + ((uint16_t)msg[ADDR+1] << 8) + msg[ADDR];
5f7f3586 529
78c90027
L
530 if (dp->img_name == NULL) {
531 /* no media */
532 return msg_cpm_result(subf, 0x06, res);
533 }
5f7f3586 534
daacc6f9 535 /* TODO: tracks per sector from dpb */
9461ecf3 536 pos = (track * 8UL + sec) * CONFIG_CPM_BLOCK_SIZE;
5f7f3586 537
78c90027
L
538 drv_debug(MIDDLE, PSTR(" T:%4d, S:%2d, cnt:%2d, lba: %.8lx, addr: %.5lx"),
539 track, sec, secs, pos, addr);
540
910e7206
L
541 if (addr == 0) {
542 return msg_cpm_result(subf, 0x07, res);
543 }
544
78c90027
L
545 if (dowrite && dp->opt & DRV_OPT_RO) {
546 return msg_cpm_result(subf, 0x05, res);
547 }
548
5f7f3586 549
1aed7fd5 550 if (pos + secs * CONFIG_CPM_BLOCK_SIZE > CONFIG_CPM_DISKSIZE) {
78c90027
L
551 drv_debug(MIDDLE, PSTR(" access > DISKSIZE:%.8lx!"),
552 CONFIG_CPM_DISKSIZE);
1aed7fd5
L
553 return msg_cpm_result(subf, 0x04, res);
554 }
555
9baecc6b 556 res = f_lseek(&dp->fd, pos);
1aed7fd5 557
7d60b20b 558 while (!res && secs--) {
8bbf185e 559 unsigned int brw;
5f7f3586
L
560 if (dowrite) {
561 if (!(z80_bus_cmd(Request) & ZST_ACQUIRED)) {
562 buserr = 1;
7d60b20b 563 break;
5f7f3586 564 } else {
1aed7fd5 565 z80_read_block(disk_buffer, addr, CONFIG_CPM_BLOCK_SIZE);
5f7f3586 566 z80_bus_cmd(Release);
5f7f3586 567 }
9baecc6b 568 res = f_write(&dp->fd, disk_buffer, CONFIG_CPM_BLOCK_SIZE, &brw);
5f7f3586 569 } else {
9baecc6b 570 res = f_read(&dp->fd, disk_buffer, CONFIG_CPM_BLOCK_SIZE, &brw);
1aed7fd5 571 if (res == FR_OK) {
5f7f3586
L
572 if (!(z80_bus_cmd(Request) & ZST_ACQUIRED)) {
573 buserr = 1;
7d60b20b 574 break;
5f7f3586 575 } else {
afc7c4b4 576 z80_write_block(disk_buffer, addr, CONFIG_CPM_BLOCK_SIZE);
5f7f3586
L
577 z80_bus_cmd(Release);
578 }
579 }
580 }
1aed7fd5 581 if (brw != CONFIG_CPM_BLOCK_SIZE) {
78c90027
L
582 drv_debug(MIDDLE, PSTR(" short rd/wr: res: %d, brw: %u"),
583 res, brw);
afc7c4b4 584 res = 64;
5f7f3586 585 }
1aed7fd5 586 addr += CONFIG_CPM_BLOCK_SIZE;
5f7f3586
L
587 }
588
393b1897 589 if (dowrite && !res) {
9baecc6b 590 dp->flags |= DRV_FLG_DIRTY;
393b1897
L
591 bg_setstat(handle_cpm_drv_to, 1);
592 }
593
5f7f3586 594 if (buserr) {
78c90027 595 /* Bus timeout. how can this happen? */
5f7f3586
L
596 rc = 0x03;
597 }
5f7f3586
L
598
599 /* send result*/
393b1897 600 msg_cpm_result(subf, rc, res);
5f7f3586
L
601}
602
72f58822
L
603
604const FLASH struct msg_item z80_messages[] =
605{
606 { 0, /* fct nr. */
89adce76 607 1, 3, /* sub fct nr. from, to */
72f58822
L
608 do_msg_ini_memfifo},
609 { 1,
610 1, 1,
611 do_msg_char_out},
1a2460dc
L
612 { 1,
613 2, 2,
614 do_msg_echo},
5f7f3586
L
615 { 2,
616 0, 0,
617 do_msg_cpm_login},
618 { 2,
619 1, 2,
620 do_msg_cpm_rw},
8590a76b
L
621 { 3,
622 1, 1,
623 do_msg_get_timer},
845cbdbd
L
624 { 3,
625 2, 3, /* 2: get, 3: set time and date */
626 do_msg_get_set_time},
72f58822
L
627 { 0xff, /* end mark */
628 0, 0,
629 0},
630
631};
632
633
634
635
636void do_message(int len, uint8_t *msg)
637{
638 uint8_t fct, sub_fct;
639 int_fast8_t i = 0;
640
641 if (len >= 2) {
642 fct = *msg++;
643 sub_fct = *msg++;
644 len -= 2;
645
89adce76
L
646 while (fct != z80_messages[i].fct) {
647 if (z80_messages[i].fct == 0xff) {
648 DBG_P(1, "do_message: Unknown function: %i, %i\n",
649 fct, sub_fct);
650 return; /* TODO: unknown message # */
651 }
8a7decea 652
72f58822 653 ++i;
72f58822
L
654 }
655
656 while (fct == z80_messages[i].fct) {
8a7decea 657 if (sub_fct >= z80_messages[i].sub_min &&
89adce76 658 sub_fct <= z80_messages[i].sub_max )
72f58822
L
659 break;
660 ++i;
661 }
662
663 if (z80_messages[i].fct != fct) {
664 DBG_P(1, "do_message: Unknown sub function: %i, %i\n",
665 fct, sub_fct);
666 return; /* TODO: unknown message sub# */
667 }
668
669 (z80_messages[i].func)(sub_fct, len, msg);
670
671
672 } else {
673 /* TODO: error */
674 DBG_P(1, "do_message: to few arguments (%i); this shouldn't happen!\n", len);
675 }
676}
677
678
679
680#define CTRBUF_LEN 256
681
682void check_msg_fifo(void)
683{
684 int ch;
685 static int_fast8_t state;
686 static int msglen,idx;
687 static uint8_t buffer[CTRBUF_LEN];
688
89adce76 689 while ((ch = z80_memfifo_getc(fifo_msgin)) >= 0) {
72f58822
L
690 switch (state) {
691 case 0: /* wait for start of message */
3531528e 692 if (ch == 0xAE) { /* TODO: magic number */
72f58822
L
693 msglen = 0;
694 idx = 0;
695 state = 1;
696 }
697 break;
698 case 1: /* get msg len */
699 if (ch > 0 && ch <= CTRBUF_LEN) {
700 msglen = ch;
701 state = 2;
702 } else
703 state = 0;
704 break;
705 case 2: /* get message */
706 buffer[idx++] = ch;
89adce76
L
707 if (idx == msglen) {
708 do_message(msglen, buffer);
709 state = 0;
710 }
711 break;
712 }
713 }
714}
715
716
717int msg_handling(int state)
718{
50939dec 719 bool pending;
8a7decea
L
720
721 ATOMIC_BLOCK(ATOMIC_FORCEON) {
89adce76
L
722 pending = (Stat & S_MSG_PENDING) != 0;
723 Stat &= ~S_MSG_PENDING;
724 }
8a7decea 725
89adce76 726 if (pending) {
215ec4b2
L
727 uint8_t init_request;
728 z80_bus_cmd(Request);
729 init_request = z80_read(0x43);
730 z80_bus_cmd(Release);
731 if ( init_request != 0) {
8bbf185e 732 /* Get address of fifo 0 */
89adce76 733 z80_bus_cmd(Request);
8bbf185e
L
734 uint32_t fifo_addr = z80_read(0x40) +
735 ((uint16_t) z80_read(0x40+1) << 8) +
736 ((uint32_t) z80_read(0x40+2) << 16);
215ec4b2
L
737 z80_write(0x43, 0);
738 z80_bus_cmd(Release);
739
740 if (fifo_addr != 0) {
741 z80_memfifo_init(fifo_msgin, fifo_addr);
742 state = 1;
743 } else
744 state = 0;
745
746 } else {
89adce76 747 check_msg_fifo();
72f58822
L
748 }
749 }
750
89adce76
L
751 return state;
752}
89adce76
L
753
754
755static int handle_msg_handling;
756
757void setup_z180_serv(void)
758{
8a7decea 759
89adce76 760 handle_msg_handling = bg_register(msg_handling, 0);
393b1897 761 handle_cpm_drv_to = bg_register(cpm_drv_to, 0);
72f58822
L
762}
763
89adce76
L
764void restart_z180_serv(void)
765{
766 z80_bus_cmd(Request);
215ec4b2 767 z80_memset(0x40, 0, 4);
89adce76 768 z80_bus_cmd(Release);
8a7decea
L
769
770 for (int i = 0; i < NUM_FIFOS; i++)
771 z80_memfifo_init(i, 0);
89adce76 772 bg_setstat(handle_msg_handling, 0);
5f7f3586 773
89adce76 774}
72f58822 775
845cbdbd 776#if 0
72f58822
L
777/*--------------------------------------------------------------------------*/
778
72f58822
L
779const FLASH uint8_t iniprog[] = {
780 0xAF, // xor a
781 0xED, 0x39, 0x36, // out0 (rcr),a ;disable DRAM refresh
782 0x3E, 0x30, // ld a,030h
783 0xED, 0x39, 0x32 //out0 (dcntl),a ;0 mem, max i/0 wait states
784};
785
786const FLASH uint8_t sertest[] = {
787 0xAF, // xor a
788 0xED, 0x39, 0x36, // out0 (rcr),a ;disable DRAM refresh
789 0x3E, 0x30, // ld a,030h
790 0xED, 0x39, 0x32, // out0 (dcntl),a ;0 mem, max i/0 wait states
791 0x3E, 0x80, // ld a,M_MPBT ;no MP, PS=10, DR=16, SS=0
792 0xED, 0x39, 0x03, // out0 (cntlb1),a
793 0x3E, 0x64, // ld a,M_RE + M_TE + M_MOD2 ;
794 0xED, 0x39, 0x01, // out0 (cntla1),a
795 0x3E, 0x00, // ld a,0
796 0xED, 0x39, 0x05, // out0 (stat1),a ;Enable rx interrupts
797 0xED, 0x38, 0x05, //l0:in0 a,(stat1)
798 0xE6, 0x80, // and 80h
799 0x28, 0xF9, // jr z,l0
800 0xED, 0x00, 0x09, // in0 b,(rdr1)
801 0xED, 0x38, 0x05, //l1:in0 a,(stat1)
802 0xE6, 0x02, // and 02h
803 0x28, 0xF9, // jr z,l1
804 0xED, 0x01, 0x07, // out0 (tdr1),b
805 0x18, 0xEA, // jr l0
806};
807
808const FLASH uint8_t test1[] = {
809 0xAF, // xor a
810 0xED, 0x39, 0x36, // out0 (rcr),a ;disable DRAM refresh
811 0x3E, 0x30, // ld a,030h
812 0xED, 0x39, 0x32, // out0 (dcntl),a ;0 mem, max i/0 wait states
813 0x21, 0x1E, 0x00, // ld hl,dmclrt ;load DMA registers
814 0x06, 0x08, // ld b,dmct_e-dmclrt
815 0x0E, 0x20, // ld c,sar0l
8a7decea 816 0xED, 0x93, // otimr
72f58822
L
817 0x3E, 0xC3, // ld a,0c3h ;dst +1, src +1, burst
818 0xED, 0x39, 0x31, // out0 (dmode),a ;
8a7decea 819 0x3E, 0x62, // ld a,062h ;enable dma0,
72f58822
L
820 0xED, 0x39, 0x30, //cl_1: out0 (dstat),a ;copy 64k
821 0x18, 0xFB, // jr cl_1 ;
8a7decea 822 0x00, 0x00, //dmclrt: dw 0 ;src (inc)
72f58822
L
823 0x00, // db 0 ;src
824 0x00, 0x00, // dw 0 ;dst (inc),
825 0x00, // db 0 ;dst
826 0x00, 0x00, // dw 0 ;count (64k)
827};
845cbdbd 828#endif