]>
cloudbase.mooo.com Git - z180-stamp.git/blob - avr/cmd_loadcpm3.c
2 * (C) Copyright 2015 Leo C. <erbl259-lmu@yahoo.de>
4 * SPDX-License-Identifier: GPL-2.0+
16 #include "con-utils.h"
21 #define RS 128 /* CP/M record size */
26 * Input: addr = Page Address of load top
27 * len = Length in pages of module to read
30 int load(FIL
*File
, uint16_t addr
, uint8_t len
)
33 unsigned int br
; /* bytes read */
36 len
*= 2; /* length in records of module */
37 //debug("## load: addr: 0x%.4X, records: 0x%.4X, (%u)\n", addr, len, len);
41 res
= f_read(File
, buffer
, RS
, &br
);
42 if (res
|| br
!= RS
) {
46 if (!(z80_bus_cmd(Request
) & ZST_ACQUIRED
)) {
47 my_puts_P(PSTR("Bus timeout\n"));
50 z80_write_block(buffer
, addr
, RS
);
52 //debug("## written: 0x%.4X\n", addr);
58 #pragma GCC diagnostic ignored "-Wmaybe-uninitialized"
60 command_ret_t
do_loadcpm3(cmd_tbl_t
*cmdtp
, int flag
, int argc
, char * const argv
[])
66 uint16_t osentry_adr
= 0;
70 /* TODO: put CONFIG_PATH_CPM3SYS in flash */
71 char default_fname
[] = CONFIG_PATH_CPM3SYS
;
72 unsigned int br
; /* bytes read */
76 (void) cmdtp
; (void) flag
;
80 offset
= strtoul(argv
[1], NULL
, 16);
82 fname
= getenv(PSTR(ENV_PATH_CPM3SYS
));
88 if (fname
== NULL
|| *fname
== '\0')
89 fname
= default_fname
;
91 res
= f_open(&File
, fname
, FA_READ
);
93 printf_P(PSTR("Error: failed to open '%s'\n"), fname
);
94 return CMD_RET_FAILURE
;
97 printf_P(PSTR("Loading: '%s'...\n"), fname
);
99 /* read the load record */
100 res
= f_read(&File
, buffer
, RS
, &br
);
104 mem_top
= buffer
[0] << 8;
106 bank_top
= buffer
[2] << 8;
107 bank_len
= buffer
[3];
108 osentry_adr
= buffer
[4] + (buffer
[5] << 8);
110 /* read display info */
111 res
= f_read(&File
, buffer
, RS
, &br
);
117 uint8_t *p
= memchr(buffer
, '$', RS
);
119 my_puts((char *)buffer
);
121 /* Main System Load */
123 /* Load Common Portion of System */
124 if ((res
= load(&File
, mem_top
, res_len
)) != 0)
127 /* Load Banked Portion of System */
128 res
= load(&File
, bank_top
, bank_len
);
134 printf_P(PSTR("Error: failed to read '%s'\n"), fname
);
135 return CMD_RET_FAILURE
;
138 setenv_hex(PSTR(ENV_STARTADDRESS
), osentry_adr
);
139 printf_P(PSTR("Loaded: Resident: "));
141 printf_P(PSTR("0x%.4X-0x%.4X, "), mem_top
-res_len
*256, mem_top
-1);
143 printf_P(PSTR(" - "));
144 printf_P(PSTR("Banked: "));
146 printf_P(PSTR("0x%.4X-0x%.4X\n"), bank_top
-bank_len
*256, bank_top
-1);
148 printf_P(PSTR(" - \n"));
150 return CMD_RET_SUCCESS
;