]>
Commit | Line | Data |
---|---|---|
1 | /* | |
2 | * (C) Copyright 2015,2016 Leo C. <erbl259-lmu@yahoo.de> | |
3 | * | |
4 | * SPDX-License-Identifier: GPL-2.0 | |
5 | */ | |
6 | ||
7 | /* | |
8 | * See CP/M 3 System Manual, Appendix D: CPM3.SYS File Format | |
9 | */ | |
10 | ||
11 | #include "cmd_loadcpm3.h" | |
12 | #include <ctype.h> | |
13 | ||
14 | #include "env.h" | |
15 | #include "ff.h" | |
16 | #include "eval_arg.h" | |
17 | #include "con-utils.h" | |
18 | #include "z80-if.h" | |
19 | #include "debug.h" | |
20 | ||
21 | ||
22 | #define RS 128 /* CP/M record size */ | |
23 | ||
24 | #define FSIZE_t DWORD | |
25 | ||
26 | /* | |
27 | * Load Routine | |
28 | * | |
29 | * Input: addr = Page Address of load top | |
30 | * len = Length in pages of module to read | |
31 | * | |
32 | */ | |
33 | int load(FIL *File, uint32_t addr, uint8_t len) | |
34 | { | |
35 | uint8_t buffer[RS]; | |
36 | unsigned int br; /* bytes read */ | |
37 | int res; | |
38 | ||
39 | len *= 2; /* length in records of module */ | |
40 | //debug("## load: addr: 0x%.4X, records: 0x%.4X, (%u)\n", addr, len, len); | |
41 | ||
42 | for (; len; len--) { | |
43 | addr -= RS; | |
44 | res = f_read(File, buffer, RS, &br); | |
45 | if (res || br != RS) { | |
46 | return 1; | |
47 | } | |
48 | ||
49 | if (!(z80_bus_cmd(Request) & ZST_ACQUIRED)) { | |
50 | my_puts_P(PSTR("Bus timeout\n")); | |
51 | return 2; | |
52 | } | |
53 | z80_write_block(buffer, addr, RS); | |
54 | z80_bus_cmd(Release); | |
55 | //debug("## written: 0x%.4X\n", addr); | |
56 | } | |
57 | ||
58 | return 0; | |
59 | } | |
60 | ||
61 | #pragma GCC diagnostic ignored "-Wmaybe-uninitialized" | |
62 | ||
63 | command_ret_t do_loadcpm3(cmd_tbl_t *cmdtp, uint_fast8_t flag, int argc, char * const argv[]) | |
64 | { | |
65 | uint16_t mem_top; | |
66 | uint8_t res_len; | |
67 | uint16_t bank_top; | |
68 | uint8_t bank_len; | |
69 | uint16_t osentry_addr = 0; | |
70 | uint32_t common_base = 0; | |
71 | uint32_t banked_base; | |
72 | char *fname; | |
73 | FIL File; | |
74 | char default_fname[] = CONFIG_CPM3_SYSFILE; | |
75 | unsigned int br; /* bytes read */ | |
76 | uint8_t buffer[RS]; | |
77 | int res; | |
78 | ||
79 | (void) cmdtp; (void) flag; | |
80 | ||
81 | ||
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); | |
86 | ||
87 | if (argc > 3) | |
88 | banked_base = eval_arg(argv[3], NULL); | |
89 | if (argc > 2) | |
90 | common_base = eval_arg(argv[2], NULL); | |
91 | ||
92 | fname = getenv_str(PSTR(ENV_CPM3_SYSFILE)); | |
93 | if (argc > 1) { | |
94 | fname = argv[1]; | |
95 | } | |
96 | if (fname == NULL || *fname == '\0') | |
97 | fname = default_fname; | |
98 | ||
99 | res = f_open(&File, fname, FA_READ ); | |
100 | if (res) { | |
101 | printf_P(PSTR("Error: failed to open '%s'\n"), fname); | |
102 | return CMD_RET_FAILURE; | |
103 | } | |
104 | ||
105 | printf_P(PSTR("Loading: '%s'...\n"), fname); | |
106 | ||
107 | /* read the load record */ | |
108 | res = f_read(&File, buffer, RS, &br); | |
109 | if (res || br != RS) | |
110 | goto out; | |
111 | ||
112 | mem_top = buffer[0] << 8; | |
113 | res_len = buffer[1]; | |
114 | bank_top = buffer[2] << 8; | |
115 | bank_len = buffer[3]; | |
116 | osentry_addr = buffer[4] + (buffer[5] << 8); | |
117 | ||
118 | /* read display info */ | |
119 | res = f_read(&File, buffer, RS, &br); | |
120 | if (res || br != RS) | |
121 | goto out; | |
122 | ||
123 | /* print the info */ | |
124 | buffer[RS-1] = '$'; | |
125 | uint8_t *p = memchr(buffer, '$', RS); | |
126 | *p = '\0'; | |
127 | my_puts((char *)buffer); | |
128 | ||
129 | if (common_base == 0) { | |
130 | /* read common base | |
131 | * http://www.seasip.info/Cpm/scb.html | |
132 | */ | |
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)) || | |
137 | (br != 2) || | |
138 | (res = f_lseek(&File, cur_pos))) | |
139 | goto out; | |
140 | common_base = (uint16_t) buffer[0] + (buffer[1] << 8); | |
141 | setenv_hex(PSTR(ENV_CPM3_COMMON_BASE), common_base); | |
142 | } | |
143 | ||
144 | setenv_hex(PSTR(ENV_CPM3_SCB), mem_top - ((res_len - (6 - 1)) << 8) + common_base); | |
145 | ||
146 | /* Main System Load */ | |
147 | ||
148 | /* Load Common Portion of System */ | |
149 | if ((res = load(&File, common_base + mem_top, res_len)) != 0) | |
150 | goto out; | |
151 | ||
152 | /* Load Banked Portion of System */ | |
153 | res = load(&File, banked_base + bank_top, bank_len); | |
154 | ||
155 | out: | |
156 | f_close(&File); | |
157 | ||
158 | if (res) { | |
159 | printf_P(PSTR("Error: failed to read '%s'\n"), fname); | |
160 | return CMD_RET_FAILURE; | |
161 | } else { | |
162 | if (res_len != 0) { | |
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); | |
168 | } | |
169 | z80_bus_cmd(Release); | |
170 | if (banked_base + osentry_addr > 0xffff) | |
171 | osentry_addr = 0; | |
172 | } | |
173 | setenv_hex(PSTR(ENV_STARTADDRESS), osentry_addr); | |
174 | } | |
175 | printf_P(PSTR("Loaded: Resident: ")); | |
176 | if (res_len != 0) | |
177 | printf_P(PSTR("0x%.5lX-0x%.5lX, "), | |
178 | (common_base + mem_top) - res_len*256, | |
179 | (common_base + mem_top) - 1); | |
180 | else | |
181 | printf_P(PSTR(" - ")); | |
182 | printf_P(PSTR("Banked: ")); | |
183 | if (bank_len != 0) | |
184 | printf_P(PSTR("0x%.5lX-0x%.5lX\n"), | |
185 | (banked_base + bank_top) - bank_len*256, | |
186 | (banked_base + bank_top) - 1); | |
187 | else | |
188 | printf_P(PSTR(" - \n")); | |
189 | ||
190 | return CMD_RET_SUCCESS; | |
191 | } | |
192 | } |