]>
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
[strlen_P(PSTR(CONFIG_CPM3_SYSFILE
)) + 1];
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
));
93 if (fname
== NULL
|| *fname
== '\0') {
94 strcpy_P(default_fname
, PSTR(CONFIG_CPM3_SYSFILE
));
95 fname
= default_fname
;
101 res
= f_open(&File
, fname
, FA_READ
);
103 printf_P(PSTR("Error: failed to open '%s'\n"), fname
);
104 return CMD_RET_FAILURE
;
107 printf_P(PSTR("Loading: '%s'...\n"), fname
);
109 /* read the load record */
110 res
= f_read(&File
, buffer
, RS
, &br
);
114 mem_top
= buffer
[0] << 8;
116 bank_top
= buffer
[2] << 8;
117 bank_len
= buffer
[3];
118 osentry_addr
= buffer
[4] + (buffer
[5] << 8);
120 /* read display info */
121 res
= f_read(&File
, buffer
, RS
, &br
);
127 uint8_t *p
= memchr(buffer
, '$', RS
);
129 my_puts((char *)buffer
);
131 if (common_base
== 0) {
133 * http://www.seasip.info/Cpm/scb.html
135 FSIZE_t common_base_ofs
= ((res_len
- 6) << 8) + 2*RS
+ RS
-7;
136 FSIZE_t cur_pos
= f_tell(&File
);
137 if ((res
= f_lseek(&File
, common_base_ofs
)) ||
138 (res
= f_read(&File
, buffer
, 2, &br
)) ||
140 (res
= f_lseek(&File
, cur_pos
)))
142 common_base
= (uint16_t) buffer
[0] + (buffer
[1] << 8);
143 setenv_hex(PSTR(ENV_CPM3_COMMON_BASE
), common_base
);
146 setenv_hex(PSTR(ENV_CPM3_SCB
), mem_top
- ((res_len
- (6 - 1)) << 8) + common_base
);
148 /* Main System Load */
150 /* Load Common Portion of System */
151 if ((res
= load(&File
, common_base
+ mem_top
, res_len
)) != 0)
154 /* Load Banked Portion of System */
155 res
= load(&File
, banked_base
+ bank_top
, bank_len
);
161 printf_P(PSTR("Error: failed to read '%s'\n"), fname
);
162 return CMD_RET_FAILURE
;
165 if (osentry_addr
+ common_base
> 0xffff) {
166 z80_bus_cmd(Request
);
167 if (z80_read(osentry_addr
+ common_base
) == 0xc3) {
168 osentry_addr
= z80_read(osentry_addr
+common_base
+1) +
169 (z80_read(osentry_addr
+ common_base
+2) << 8);
171 z80_bus_cmd(Release
);
172 if (banked_base
+ osentry_addr
> 0xffff)
175 setenv_hex(PSTR(ENV_STARTADDRESS
), osentry_addr
);
177 printf_P(PSTR("Loaded: Resident: "));
179 printf_P(PSTR("0x%.5lX-0x%.5lX, "),
180 (common_base
+ mem_top
) - res_len
*256,
181 (common_base
+ mem_top
) - 1);
183 printf_P(PSTR(" - "));
184 printf_P(PSTR("Banked: "));
186 printf_P(PSTR("0x%.5lX-0x%.5lX\n"),
187 (banked_base
+ bank_top
) - bank_len
*256,
188 (banked_base
+ bank_top
) - 1);
190 printf_P(PSTR(" - \n"));
192 return CMD_RET_SUCCESS
;