#include "z180-serv.h"
#include "common.h"
-#include <stdlib.h>
-#include <string.h>
-#include <stdbool.h>
#include <util/atomic.h>
#include "config.h"
#include "bcd.h"
#include "rtc.h"
-#define DEBUG_CPM_SDIO 1 /* set to 1 to debug */
+#define DEBUG_CPM_SDIO 0 /* set to 1 to debug */
#define debug_cpmsd(fmt, args...) \
debug_cond(DEBUG_CPM_SDIO, fmt, ##args)
/* ---------------------------------------------------------------------------*/
+/* measure f_cpu */
+void do_msg_m_fcpu(uint8_t subf, int len UNUSED, uint8_t * msg)
+{
+ uint32_t freq;
+ uint8_t eimsk_save;
+
+ /* Save state and disable INT5/INT6 */
+ ATOMIC_BLOCK(ATOMIC_FORCEON) {
+ eimsk_save = EIMSK;
+ EIMSK &= ~_BV(INT6);
+ EIMSK &= ~_BV(INT5);
+ }
+ EIFR = _BV(INTF5); /* Reset pending int */
+ z80_bus_cmd(Request);
+ z80_write(0x3f, 0xff);
+ z80_bus_cmd(Release);
+
+ freq = z80_measure_phi(*msg);
+
+ z80_bus_cmd(Request);
+ z80_write(0x3f, 0xff);
+ z80_bus_cmd(Release);
+
+ /* Restore INT5/INT6 */
+ ATOMIC_BLOCK(ATOMIC_FORCEON) {
+ if ((eimsk_save & _BV(INT5)) != 0)
+ EIMSK |= _BV(INT5);
+ if ((eimsk_save & _BV(INT6)) != 0)
+ EIMSK |= _BV(INT6);
+ /* Reset pending int */
+ EIFR = _BV(INTF5);
+ EIFR = _BV(INTF6);
+ }
+
+ msg_xmit(4, subf, sizeof(freq), (uint8_t *) &freq);
+}
+
+/* ---------------------------------------------------------------------------*/
+
#define CPM_DAY_OFFSET ((1978-1900) * 365 + 19) /* 19 leap years */
/*
/* ---------------------------------------------------------------------------*/
+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(uint8_t drv, const FLASH char *const fmt, ...) \
+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);
- printf_P(PSTR("# %7lu dsk%d: "), get_timer(0), drv);
+ if (phase == SINGLE || phase == START)
+ printf_P(PSTR("# %7lu dsk%d: "), get_timer(0), drv);
- va_start (ap, fmt);
vfprintf_P (stdout, fmt, ap);
- va_end (ap);
- putc('\n', stdout);
+ if (phase == SINGLE || phase == END)
+ putc('\n', stdout);
+
+ va_end (ap);
}
}
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":"",
+ printf_P(PSTR(" dsk%d: %2S %3S attached to %s\n"), i,
+ p->opt&DRV_OPT_RO ? PSTR("RO") : PSTR("RW"),
+ p->opt&DRV_OPT_DEBUG ? PSTR("DBG") : PSTR(""),
p->img_name);
}
}
return 0;
}
-int drv_detach(uint8_t drv)
+int drv_detach(uint8_t unit)
{
+ drv = unit;
if (drv < CONFIG_CPM_MAX_DRIVE) {
struct cpm_drive_s *p = &drv_table[drv];
- drv_debug(drv, PSTR("detach from '%s'"), p->img_name ? p->img_name : "-");
+ drv_debug(SINGLE, PSTR("detach from '%s'"), p->img_name ? p->img_name : "-");
if (p->img_name) {
f_close(&p->fd);
p->flags &= ~DRV_FLG_DIRTY;
p->img_name = NULL;
- uint32_t scb = getenv_ulong(ENV_CPM3_SCB, 16, 0);
+ 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);
return -1;
}
-int drv_attach(uint8_t drv, const char *filename, drv_opt_t options)
+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;
+ return EATRANGE;
struct cpm_drive_s *p = &drv_table[drv];
if (options & DRV_OPT_REATTATCH) {
if (filename) {
- return AT_ERROR;
+ return EUNEXPARG;
}
if (!p->img_name) {
- return AT_NOT;
+ return EATNOT;
}
/* change options */
} else {
if (p->img_name)
- return AT_ALREADY;
+ return EATALRDY;
if (drv_find_file_attached(filename) >= 0)
- return AT_OTHER;
+ return EATOTHER;
p->opt = options;
/* new attachment */
if ((p->img_name = strdup(filename)) == NULL)
- return AT_NOMEM;
+ return ENOMEM;
res = f_open(&p->fd, p->img_name,
FA_READ | (options&DRV_OPT_RO ? 0 : FA_WRITE));
bg_setstat(handle_cpm_drv_to, 1);
}
#else
- drv_debug(drv, PSTR("wrong image file size: %ld, should be %ld"),
+ 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 EATOPEN;
}
}
- return AT_OK;
+ return ESUCCESS;
}
if (drv_table[i].flags & DRV_FLG_DIRTY) {
drv_table[i].flags &= ~DRV_FLG_DIRTY;
f_sync(&drv_table[i].fd);
- drv_debug(i, PSTR("f_sync"));
+ 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)
{
result_msg[1] = res;
result_msg[2] = res >> 8;
+ msg_xmit(2, subf, sizeof(result_msg), result_msg);
+
if (rc) {
- debug_cpmsd("###%7lu error rc: %.02x, res: %d\n", get_timer(0), rc, res);
- }
+#if defined(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(""));
- msg_xmit(2, subf, sizeof(result_msg), result_msg);
}
/*
void do_msg_cpm_login(uint8_t subf, int len, uint8_t * msg)
{
- uint8_t drv;
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);
}
- /* Get relative drive number */
- drv = msg[1];
if ( drv >= CONFIG_CPM_MAX_DRIVE) {
- debug_cpmsd("## login failed: invalid relative drive number '%d'\n", drv);
+ /* invalid relative drive number */
return msg_cpm_result(subf, 0x02, res);
}
- drv_debug(drv, PSTR("login"));
-
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 */
- drv_debug(drv, PSTR("login failed: no file attached"));
- return msg_cpm_result(subf, 0x03, res);
+ 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*/
void do_msg_cpm_rw(uint8_t subf, int len, uint8_t * msg)
{
- uint8_t drv;
struct cpm_drive_s *dp;
uint32_t addr;
uint32_t pos;
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);
}
-
- drv = msg[RDRV];
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);
}
- if (subf == 2) {
- dowrite = true;
- if (dp->opt & DRV_OPT_RO) {
- return msg_cpm_result(subf, 0x05, res);
- }
- } else {
- dowrite = false;
- }
+ /* TODO: tracks per sector from dpb */
+ pos = (track * 8UL + sec) * CONFIG_CPM_BLOCK_SIZE;
- 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];
+ 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);
+ }
- /* TODO: tracks per sector from dpb */
- pos = (track * 8UL + sec) * CONFIG_CPM_BLOCK_SIZE;
+ if (dowrite && dp->opt & DRV_OPT_RO) {
+ return msg_cpm_result(subf, 0x05, res);
+ }
- drv_debug(drv, PSTR("%5s trk:%4d, sec: %d, pos: %.8lx, secs: %2d, addr: %.5lx"),
- dowrite ? "write" : " read", track, sec, pos, secs, addr);
if (pos + secs * CONFIG_CPM_BLOCK_SIZE > CONFIG_CPM_DISKSIZE) {
- drv_debug(drv, PSTR("access > DISKSIZE (%.8lx > %.8lx) aborted!"),
- 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);
}
}
}
if (brw != CONFIG_CPM_BLOCK_SIZE) {
- drv_debug(drv, PSTR("short read or write: res: %d, bytes rd/wr: %u"), res, brw);
+ drv_debug(MIDDLE, PSTR(" short rd/wr: res: %d, brw: %u"),
+ res, brw);
res = 64;
}
addr += CONFIG_CPM_BLOCK_SIZE;
}
if (buserr) {
- drv_debug(drv, PSTR("Bus timeout"));
+ /* Bus timeout. how can this happen? */
rc = 0x03;
}
{ 3,
2, 3, /* 2: get, 3: set time and date */
do_msg_get_set_time},
+ { 4,
+ 1, 1,
+ do_msg_m_fcpu},
{ 0xff, /* end mark */
0, 0,
0},
};
-
-
void do_message(int len, uint8_t *msg)
{
uint8_t fct, sub_fct;