]>
cloudbase.mooo.com Git - z180-stamp.git/blob - avr/cmd_loadcpm3.c
2 * (C) Copyright 2015,2016 Leo C. <erbl259-lmu@yahoo.de>
4 * SPDX-License-Identifier: GPL-2.0
8 * See CP/M 3 System Manual, Appendix D: CPM3.SYS File Format
11 #include "cmd_loadcpm3.h"
17 #include "con-utils.h"
22 #define RS 128 /* CP/M record size */
29 * Input: addr = Page Address of load top
30 * len = Length in pages of module to read
33 int load(FIL
*File
, uint32_t addr
, uint8_t len
)
36 unsigned int br
; /* bytes read */
39 len
*= 2; /* length in records of module */
40 //debug("## load: addr: 0x%.4X, records: 0x%.4X, (%u)\n", addr, len, len);
44 res
= f_read(File
, buffer
, RS
, &br
);
45 if (res
|| br
!= RS
) {
49 if (!(z80_bus_cmd(Request
) & ZST_ACQUIRED
)) {
50 my_puts_P(PSTR("Bus timeout\n"));
53 z80_write_block(buffer
, addr
, RS
);
55 //debug("## written: 0x%.4X\n", addr);
61 #pragma GCC diagnostic ignored "-Wmaybe-uninitialized"
63 command_ret_t
do_loadcpm3(cmd_tbl_t
*cmdtp
, uint_fast8_t flag
, int argc
, char * const argv
[])
69 uint16_t osentry_addr
= 0;
70 uint32_t common_base
= 0;
74 char default_fname
[] = CONFIG_CPM3_SYSFILE
;
75 unsigned int br
; /* bytes read */
79 (void) cmdtp
; (void) flag
;
82 //common_base = getenv_ulong(PSTR(ENV_CPM3_COMMON_BASE), 16,
83 // CONFIG_CPM3_COMMON_BASE);
84 banked_base
= getenv_ulong(PSTR(ENV_CPM3_BANKED_BASE
), 16,
85 CONFIG_CPM3_BANKED_BASE
);
88 banked_base
= eval_arg(argv
[3], NULL
);
90 common_base
= eval_arg(argv
[2], NULL
);
92 fname
= getenv_str(PSTR(ENV_CPM3_SYSFILE
));
96 if (fname
== NULL
|| *fname
== '\0')
97 fname
= default_fname
;
99 res
= f_open(&File
, fname
, FA_READ
);
101 printf_P(PSTR("Error: failed to open '%s'\n"), fname
);
102 return CMD_RET_FAILURE
;
105 printf_P(PSTR("Loading: '%s'...\n"), fname
);
107 /* read the load record */
108 res
= f_read(&File
, buffer
, RS
, &br
);
112 mem_top
= buffer
[0] << 8;
114 bank_top
= buffer
[2] << 8;
115 bank_len
= buffer
[3];
116 osentry_addr
= buffer
[4] + (buffer
[5] << 8);
118 /* read display info */
119 res
= f_read(&File
, buffer
, RS
, &br
);
125 uint8_t *p
= memchr(buffer
, '$', RS
);
127 my_puts((char *)buffer
);
129 if (common_base
== 0) {
131 * http://www.seasip.info/Cpm/scb.html
133 FSIZE_t common_base_ofs
= ((res_len
- 6) << 8) + 2*RS
+ RS
-7;
134 FSIZE_t cur_pos
= f_tell(&File
);
135 if ((res
= f_lseek(&File
, common_base_ofs
)) ||
136 (res
= f_read(&File
, buffer
, 2, &br
)) ||
138 (res
= f_lseek(&File
, cur_pos
)))
140 common_base
= (uint16_t) buffer
[0] + (buffer
[1] << 8);
141 setenv_hex(PSTR(ENV_CPM3_COMMON_BASE
), common_base
);
144 setenv_hex(PSTR(ENV_CPM3_SCB
), mem_top
- ((res_len
- (6 - 1)) << 8) + common_base
);
146 /* Main System Load */
148 /* Load Common Portion of System */
149 if ((res
= load(&File
, common_base
+ mem_top
, res_len
)) != 0)
152 /* Load Banked Portion of System */
153 res
= load(&File
, banked_base
+ bank_top
, bank_len
);
159 printf_P(PSTR("Error: failed to read '%s'\n"), fname
);
160 return CMD_RET_FAILURE
;
163 if (osentry_addr
+ common_base
> 0xffff) {
164 z80_bus_cmd(Request
);
165 if (z80_read(osentry_addr
+ common_base
) == 0xc3) {
166 osentry_addr
= z80_read(osentry_addr
+common_base
+1) +
167 (z80_read(osentry_addr
+ common_base
+2) << 8);
169 z80_bus_cmd(Release
);
170 if (banked_base
+ osentry_addr
> 0xffff)
173 setenv_hex(PSTR(ENV_STARTADDRESS
), osentry_addr
);
175 printf_P(PSTR("Loaded: Resident: "));
177 printf_P(PSTR("0x%.5lX-0x%.5lX, "),
178 (common_base
+ mem_top
) - res_len
*256,
179 (common_base
+ mem_top
) - 1);
181 printf_P(PSTR(" - "));
182 printf_P(PSTR("Banked: "));
184 printf_P(PSTR("0x%.5lX-0x%.5lX\n"),
185 (banked_base
+ bank_top
) - bank_len
*256,
186 (banked_base
+ bank_top
) - 1);
188 printf_P(PSTR(" - \n"));
190 return CMD_RET_SUCCESS
;