X-Git-Url: http://cloudbase.mooo.com/gitweb/z180-stamp.git/blobdiff_plain/bad2d92d98f9990ee5ccf509c0eafe5b3af9f4dc..35edb766593d019b89a3f40b6d6cdd2b50f18032:/avr/z180-serv.c diff --git a/avr/z180-serv.c b/avr/z180-serv.c index c920326..e0b763f 100644 --- a/avr/z180-serv.c +++ b/avr/z180-serv.c @@ -1,19 +1,17 @@ /* + * (C) Copyright 2014 Leo C. + * + * SPDX-License-Identifier: GPL-2.0+ */ #include "common.h" -//#include -//#include -//#include -//#include -//#include +#include - -#include "debug.h" +#include "background.h" #include "serial.h" #include "z80-if.h" - - +#include "debug.h" +#include "z180-serv.h" /*--------------------------------------------------------------------------*/ @@ -21,11 +19,11 @@ uint8_t z80_get_byte(uint32_t adr) { uint8_t data; - + z80_bus_cmd(Request); - data = z80_read(adr), + data = z80_read(adr); z80_bus_cmd(Release); - + return data; } @@ -53,19 +51,12 @@ uint32_t msg_to_addr(uint8_t *msg) return addr.as32; } -void do_msg_ini_msgfifo(uint8_t subf, int len, uint8_t * msg) -{ - (void)subf; (void)len; - - z80_init_msg_fifo(msg_to_addr(msg)); -} - void do_msg_ini_memfifo(uint8_t subf, int len, uint8_t * msg) { (void)len; - z80_memfifo_init(subf - 1, msg_to_addr(msg)); + z80_memfifo_init(subf, msg_to_addr(msg)); } @@ -81,10 +72,7 @@ void do_msg_char_out(uint8_t subf, int len, uint8_t * msg) const FLASH struct msg_item z80_messages[] = { { 0, /* fct nr. */ - 0, 0, /* sub fct nr. from, to */ - do_msg_ini_msgfifo}, - { 0, - 1, 2, + 1, 3, /* sub fct nr. from, to */ do_msg_ini_memfifo}, { 1, 1, 1, @@ -108,17 +96,19 @@ void do_message(int len, uint8_t *msg) sub_fct = *msg++; len -= 2; - while (fct != z80_messages[i].fct) - ++i; + 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 # */ + } - 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 ) + if (sub_fct >= z80_messages[i].sub_min && + sub_fct <= z80_messages[i].sub_max ) break; ++i; } @@ -149,10 +139,10 @@ void check_msg_fifo(void) static int msglen,idx; static uint8_t buffer[CTRBUF_LEN]; - while (state != 3 && (ch = z80_msg_fifo_getc()) >= 0) { + while ((ch = z80_memfifo_getc(fifo_msgin)) >= 0) { switch (state) { case 0: /* wait for start of message */ - if (ch == 0x81) { + if (ch == 0xAE) { /* TODO: magic number */ msglen = 0; idx = 0; state = 1; @@ -167,36 +157,70 @@ void check_msg_fifo(void) break; case 2: /* get message */ buffer[idx++] = ch; - if (idx == msglen) - state = 3; + if (idx == msglen) { + do_message(msglen, buffer); + state = 0; + } break; } } +} - if (state == 3) { - do_message(msglen, buffer); - state = 0; + +int msg_handling(int state) +{ + uint8_t pending; + + ATOMIC_BLOCK(ATOMIC_FORCEON) { + pending = (Stat & S_MSG_PENDING) != 0; + Stat &= ~S_MSG_PENDING; } + + if (pending) { + switch (state) { + case 0: + z80_bus_cmd(Request); + uint32_t addr = z80_read(0x40) + + ((uint16_t) z80_read(0x41) << 8) + + ((uint32_t) z80_read(0x42) << 16); + z80_bus_cmd(Release); + if (addr != 0) { + z80_memfifo_init(fifo_msgin, addr); + state = 1; + } + break; + case 1: + check_msg_fifo(); + break; + } + } + + return state; } -/*--------------------------------------------------------------------------*/ +static int handle_msg_handling; -#if 0 -void dump_mem(const FLASH uint8_t *addr, uint32_t len) +void setup_z180_serv(void) { - DBG_P(1, "hdrom dump:"); - while (len) { - DBG_P(1, "\n %.5x:", addr); - for (unsigned i = 0; i<16; i++) - DBG_P(1, " %.2x", *addr++); - len -= len > 16 ? 16 : len; - } - DBG_P(1, "\n"); + + handle_msg_handling = bg_register(msg_handling, 0); } -#endif -/*--------------------------------------------------------------------------*/ +void restart_z180_serv(void) +{ + z80_bus_cmd(Request); + z80_write(0x40, 0); + z80_write(0x41, 0); + z80_write(0x42, 0); + z80_bus_cmd(Release); + + for (int i = 0; i < NUM_FIFOS; i++) + z80_memfifo_init(i, 0); + bg_setstat(handle_msg_handling, 0); +} + +/*--------------------------------------------------------------------------*/ const FLASH uint8_t iniprog[] = { 0xAF, // xor a @@ -235,20 +259,15 @@ const FLASH uint8_t test1[] = { 0x21, 0x1E, 0x00, // ld hl,dmclrt ;load DMA registers 0x06, 0x08, // ld b,dmct_e-dmclrt 0x0E, 0x20, // ld c,sar0l - 0xED, 0x93, // otimr + 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, + 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, 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) }; - - - -// check_msg_fifo(); -