]>
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
, uint32_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_addr
= 0;
67 uint32_t common_base
, banked_base
;
70 /* TODO: put CONFIG_CPM3_SYSFILE in flash */
71 char default_fname
[] = CONFIG_CPM3_SYSFILE
;
72 unsigned int br
; /* bytes read */
76 (void) cmdtp
; (void) flag
;
79 common_base
= getenv_ulong(PSTR(ENV_CPM3_COMMON_BASE
), 16,
80 CONFIG_CPM3_COMMON_BASE
);
81 banked_base
= getenv_ulong(PSTR(ENV_CPM3_BANKED_BASE
), 16,
82 CONFIG_CPM3_BANKED_BASE
);
85 banked_base
= strtoul(argv
[3], NULL
, 16);
87 common_base
= strtoul(argv
[2], NULL
, 16);
89 fname
= getenv(PSTR(ENV_CPM3_SYSFILE
));
93 if (fname
== NULL
|| *fname
== '\0')
94 fname
= default_fname
;
96 res
= f_open(&File
, fname
, FA_READ
);
98 printf_P(PSTR("Error: failed to open '%s'\n"), fname
);
99 return CMD_RET_FAILURE
;
102 printf_P(PSTR("Loading: '%s'...\n"), fname
);
104 /* read the load record */
105 res
= f_read(&File
, buffer
, RS
, &br
);
109 mem_top
= buffer
[0] << 8;
111 bank_top
= buffer
[2] << 8;
112 bank_len
= buffer
[3];
113 osentry_addr
= buffer
[4] + (buffer
[5] << 8);
115 /* read display info */
116 res
= f_read(&File
, buffer
, RS
, &br
);
122 uint8_t *p
= memchr(buffer
, '$', RS
);
124 my_puts((char *)buffer
);
126 /* Main System Load */
128 /* Load Common Portion of System */
129 if ((res
= load(&File
, common_base
+ mem_top
, res_len
)) != 0)
132 /* Load Banked Portion of System */
133 res
= load(&File
, banked_base
+ bank_top
, bank_len
);
139 printf_P(PSTR("Error: failed to read '%s'\n"), fname
);
140 return CMD_RET_FAILURE
;
143 if (osentry_addr
+ common_base
> 0xffff) {
144 z80_bus_cmd(Request
);
145 if (z80_read(osentry_addr
+ common_base
) == 0xc3) {
146 osentry_addr
= z80_read(osentry_addr
+common_base
+1) +
147 (z80_read(osentry_addr
+ common_base
+2) << 8);
149 z80_bus_cmd(Release
);
150 if (banked_base
+ osentry_addr
> 0xffff)
153 setenv_hex(PSTR(ENV_STARTADDRESS
), osentry_addr
);
155 printf_P(PSTR("Loaded: Resident: "));
157 printf_P(PSTR("0x%.5lX-0x%.5lX, "),
158 (common_base
+ mem_top
) - res_len
*256,
159 (common_base
+ mem_top
) - 1);
161 printf_P(PSTR(" - "));
162 printf_P(PSTR("Banked: "));
164 printf_P(PSTR("0x%.5lX-0x%.5lX\n"),
165 (banked_base
+ bank_top
) - bank_len
*256,
166 (banked_base
+ bank_top
) - 1);
168 printf_P(PSTR(" - \n"));
170 return CMD_RET_SUCCESS
;