1 // SPDX-License-Identifier: MIT
8 #include "pistorm-dev.h"
9 #include "pistorm-dev-enums.h"
10 #include "platforms/platforms.h"
11 #include "gpio/ps_protocol.h"
12 #include "platforms/amiga/rtg/rtg.h"
13 #include "platforms/amiga/piscsi/piscsi.h"
14 #include "platforms/amiga/net/pi-net.h"
16 #include <linux/reboot.h>
17 #include <sys/reboot.h>
19 #define DEBUG_PISTORM_DEVICE
21 #ifdef DEBUG_PISTORM_DEVICE
24 #define PIDEV_SWREV 0x0105
26 static const char *op_type_names[4] = {
36 extern uint32_t pistorm_dev_base;
37 extern uint32_t do_reset;
39 extern void adjust_ranges_amiga(struct emulator_config *cfg);
40 extern uint8_t rtg_enabled, rtg_on, pinet_enabled, piscsi_enabled, load_new_config, end_signal;
41 extern struct emulator_config *cfg;
43 char cfg_filename[256] = "default.cfg";
46 static uint8_t pi_byte[8];
47 static uint16_t pi_word[4];
48 static uint32_t pi_longword[4];
49 static uint32_t pi_string[4];
51 static uint32_t pi_dbg_val[4];
52 static uint32_t pi_dbg_string[4];
54 static uint32_t pi_cmd_result = 0, shutdown_confirm = 0xFFFFFFFF;
56 int32_t grab_amiga_string(uint32_t addr, uint8_t *dest, uint32_t str_max_len) {
57 int32_t r = get_mapped_item_by_address(cfg, addr);
61 DEBUG("[GRAB_AMIGA_STRING] No mapped range found for address $%.8X. Grabbing string data over the bus.\n", addr);
63 dest[index] = read8(addr + index);
65 } while (dest[index - 1] != 0x00 && index < str_max_len);
68 uint8_t *src = cfg->map_data[r] + (addr - cfg->map_offset[r]);
70 dest[index] = src[index];
72 } while (dest[index - 1] != 0x00 && index < str_max_len);
74 if (index == str_max_len) {
75 memset(dest, 0x00, str_max_len + 1);
78 DEBUG("[GRAB_AMIGA_STRING] Grabbed string: %s\n", dest);
79 return (int32_t)strlen((const char*)dest);
82 char *get_pistorm_devcfg_filename() {
86 void set_pistorm_devcfg_filename(char *filename) {
87 strcpy(cfg_filename, filename);
90 void handle_pistorm_dev_write(uint32_t addr_, uint32_t val, uint8_t type) {
91 uint32_t addr = (addr_ & 0xFFFF);
95 // Output debug message based on value written and data in val/str registers.
97 case PI_DBG_VAL1: case PI_DBG_VAL2: case PI_DBG_VAL3: case PI_DBG_VAL4:
98 case PI_DBG_VAL5: case PI_DBG_VAL6: case PI_DBG_VAL7: case PI_DBG_VAL8:
99 DEBUG("[PISTORM-DEV] Set DEBUG VALUE %d to %d ($%.8X)\n", (addr - PI_DBG_VAL1) / 4, val, val);
100 pi_dbg_val[(addr - PI_DBG_VAL1) / 4] = val;
102 case PI_DBG_STR1: case PI_DBG_STR2: case PI_DBG_STR3: case PI_DBG_STR4:
103 DEBUG("[PISTORM-DEV] Set DEBUG STRING POINTER %d to $%.8X\n", (addr - PI_DBG_STR1) / 4, val);
104 pi_dbg_string[(addr - PI_DBG_STR1) / 4] = val;
107 case PI_BYTE1: case PI_BYTE2: case PI_BYTE3: case PI_BYTE4:
108 case PI_BYTE5: case PI_BYTE6: case PI_BYTE7: case PI_BYTE8:
109 DEBUG("[PISTORM-DEV] Set BYTE %d to %d ($%.2X)\n", addr - PI_BYTE1, (val & 0xFF), (val & 0xFF));
110 pi_byte[addr - PI_BYTE1] = (val & 0xFF);
112 case PI_WORD1: case PI_WORD2: case PI_WORD3: case PI_WORD4:
113 DEBUG("[PISTORM-DEV] Set WORD %d to %d ($%.4X)\n", (addr - PI_WORD1) / 2, (val & 0xFFFF), (val & 0xFFFF));
114 pi_word[(addr - PI_WORD1) / 2] = (val & 0xFFFF);
116 case PI_LONGWORD1: case PI_LONGWORD2: case PI_LONGWORD3: case PI_LONGWORD4:
117 DEBUG("[PISTORM-DEV] Set LONGWORD %d to %d ($%.8X)\n", (addr - PI_LONGWORD1) / 4, val, val);
118 pi_longword[(addr - PI_LONGWORD1) / 4] = val;
120 case PI_STR1: case PI_STR2: case PI_STR3: case PI_STR4:
121 DEBUG("[PISTORM-DEV] Set STRING POINTER %d to $%.8X\n", (addr - PI_STR1) / 4, val);
122 pi_string[(addr - PI_STR1) / 4] = val;
125 case PI_CMD_RTGSTATUS:
126 DEBUG("[PISTORM-DEV] Write to RTGSTATUS: %d\n", val);
127 if (val == 1 && !rtg_enabled) {
130 pi_cmd_result = PI_RES_OK;
131 } else if (val == 0 && rtg_enabled) {
135 pi_cmd_result = PI_RES_OK;
137 // Refuse to disable RTG if it's currently in use.
138 pi_cmd_result = PI_RES_FAILED;
141 pi_cmd_result = PI_RES_NOCHANGE;
143 adjust_ranges_amiga(cfg);
145 case PI_CMD_NETSTATUS:
146 DEBUG("[PISTORM-DEV] Write to NETSTATUS: %d\n", val);
147 if (val == 1 && !pinet_enabled) {
150 pi_cmd_result = PI_RES_OK;
151 } else if (val == 0 && pinet_enabled) {
154 pi_cmd_result = PI_RES_OK;
156 pi_cmd_result = PI_RES_NOCHANGE;
158 adjust_ranges_amiga(cfg);
160 case PI_CMD_PISCSI_CTRL:
161 DEBUG("[PISTORM-DEV] Write to PISCSI_CTRL: ");
163 case PISCSI_CTRL_DISABLE:
165 if (piscsi_enabled) {
168 // Probably not OK... depends on if you booted from floppy, I guess.
169 pi_cmd_result = PI_RES_OK;
171 pi_cmd_result = PI_RES_NOCHANGE;
174 case PISCSI_CTRL_ENABLE:
176 if (!piscsi_enabled) {
179 piscsi_refresh_drives();
180 pi_cmd_result = PI_RES_OK;
182 pi_cmd_result = PI_RES_NOCHANGE;
185 case PISCSI_CTRL_MAP:
187 if (pi_string[0] == 0 || grab_amiga_string(pi_string[0], (uint8_t *)tmp_string, 255) == -1) {
188 printf("[PISTORM-DEV] Failed to grab string for PISCSI drive filename. Aborting.\n");
189 pi_cmd_result = PI_RES_FAILED;
191 FILE *tmp = fopen(tmp_string, "rb");
193 printf("[PISTORM-DEV] Failed to open file %s for PISCSI drive mapping. Aborting.\n", cfg_filename);
194 pi_cmd_result = PI_RES_FILENOTFOUND;
197 printf("[PISTORM-DEV] Attempting to map file %s as PISCSI drive %d...\n", cfg_filename, pi_word[0]);
198 piscsi_unmap_drive(pi_word[0]);
199 piscsi_map_drive(tmp_string, pi_word[0]);
200 pi_cmd_result = PI_RES_OK;
205 case PISCSI_CTRL_UNMAP:
207 if (pi_word[0] > 7) {
208 printf("[PISTORM-DEV] Invalid drive ID %d for PISCSI unmap command.", pi_word[0]);
209 pi_cmd_result = PI_RES_INVALIDVALUE;
211 if (piscsi_get_dev(pi_word[0])->fd != -1) {
212 piscsi_unmap_drive(pi_word[0]);
213 pi_cmd_result = PI_RES_OK;
215 pi_cmd_result = PI_RES_NOCHANGE;
219 case PISCSI_CTRL_EJECT:
220 DEBUG("EJECT (NYI)\n");
221 pi_cmd_result = PI_RES_NOCHANGE;
223 case PISCSI_CTRL_INSERT:
224 DEBUG("INSERT (NYI)\n");
225 pi_cmd_result = PI_RES_NOCHANGE;
228 DEBUG("UNKNOWN/UNHANDLED. Aborting.\n");
229 pi_cmd_result = PI_RES_INVALIDVALUE;
232 adjust_ranges_amiga(cfg);
236 DEBUG("[PISTORM-DEV] Write to KICKROM.\n");
237 if (pi_string[0] == 0 || grab_amiga_string(pi_string[0], (uint8_t *)tmp_string, 255) == -1) {
238 printf("[PISTORM-DEV] Failed to grab string KICKROM filename. Aborting.\n");
239 pi_cmd_result = PI_RES_FAILED;
241 FILE *tmp = fopen(tmp_string, "rb");
243 printf("[PISTORM-DEV] Failed to open file %s for KICKROM mapping. Aborting.\n", cfg_filename);
244 pi_cmd_result = PI_RES_FILENOTFOUND;
247 if (get_named_mapped_item(cfg, "kickstart") != -1) {
248 uint32_t index = get_named_mapped_item(cfg, "kickstart");
249 free(cfg->map_data[index]);
250 free(cfg->map_id[index]);
251 cfg->map_type[index] = MAPTYPE_NONE;
252 // Dirty hack, I am sleepy and lazy.
253 add_mapping(cfg, MAPTYPE_ROM, cfg->map_offset[index], cfg->map_size[index], 0, tmp_string, "kickstart");
254 pi_cmd_result = PI_RES_OK;
257 printf ("[PISTORM-DEV] Could not find mapped range 'kickstart', cannot remap KICKROM.\n");
258 pi_cmd_result = PI_RES_FAILED;
262 adjust_ranges_amiga(cfg);
266 DEBUG("[PISTORM-DEV] Write to EXTROM.\n");
267 if (pi_string[0] == 0 || grab_amiga_string(pi_string[0], (uint8_t *)tmp_string, 255) == -1) {
268 printf("[PISTORM-DEV] Failed to grab string EXTROM filename. Aborting.\n");
269 pi_cmd_result = PI_RES_FAILED;
271 FILE *tmp = fopen(tmp_string, "rb");
273 printf("[PISTORM-DEV] Failed to open file %s for EXTROM mapping. Aborting.\n", cfg_filename);
274 pi_cmd_result = PI_RES_FILENOTFOUND;
277 if (get_named_mapped_item(cfg, "extended") != -1) {
278 uint32_t index = get_named_mapped_item(cfg, "extended");
279 free(cfg->map_data[index]);
280 free(cfg->map_id[index]);
281 cfg->map_type[index] = MAPTYPE_NONE;
282 // Dirty hack, I am tired and lazy.
283 add_mapping(cfg, MAPTYPE_ROM, cfg->map_offset[index], cfg->map_size[index], 0, tmp_string, "extended");
284 pi_cmd_result = PI_RES_OK;
287 printf ("[PISTORM-DEV] Could not find mapped range 'extrom', cannot remap EXTROM.\n");
288 pi_cmd_result = PI_RES_FAILED;
292 adjust_ranges_amiga(cfg);
297 DEBUG("[PISTORM-DEV] System reset called, code %d\n", (val & 0xFFFF));
300 case PI_CMD_SHUTDOWN:
301 DEBUG("[PISTORM-DEV] Shutdown requested. Confirm by replying with return value to CONFIRMSHUTDOWN.\n");
302 shutdown_confirm = rand() % 0xFFFF;
303 pi_cmd_result = shutdown_confirm;
305 case PI_CMD_CONFIRMSHUTDOWN:
306 if (val != shutdown_confirm) {
307 DEBUG("[PISTORM-DEV] Attempted shutdown with wrong shutdown confirm value. Not shutting down.\n");
308 shutdown_confirm = 0xFFFFFFFF;
309 pi_cmd_result = PI_RES_FAILED;
311 printf("[PISTORM-DEV] Shutting down the PiStorm. Good night, fight well, until we meet again.\n");
312 reboot(LINUX_REBOOT_CMD_POWER_OFF);
313 pi_cmd_result = PI_RES_OK;
317 case PI_CMD_SWITCHCONFIG:
318 DEBUG("[PISTORM-DEV] Config switch called, command: ");
322 if (pi_string[0] == 0 || grab_amiga_string(pi_string[0], (uint8_t *)cfg_filename, 255) == -1) {
323 printf("[PISTORM-DEV] Failed to grab string for CONFIG filename. Aborting.\n");
324 pi_cmd_result = PI_RES_FAILED;
326 FILE *tmp = fopen(cfg_filename, "rb");
328 printf("[PISTORM-DEV] Failed to open CONFIG file %s for reading. Aborting.\n", cfg_filename);
329 pi_cmd_result = PI_RES_FILENOTFOUND;
332 printf("[PISTORM-DEV] Attempting to load config file %s...\n", cfg_filename);
333 load_new_config = val + 1;
334 pi_cmd_result = PI_RES_OK;
341 printf("[PISTORM-DEV] Reloading current config file (%s)...\n", cfg_filename);
342 load_new_config = val + 1;
346 printf("[PISTORM-DEV] Loading default.cfg...\n");
347 load_new_config = val + 1;
350 DEBUG("UNKNOWN/UNHANDLED. Command ignored.\n");
351 pi_cmd_result = PI_RES_INVALIDVALUE;
356 DEBUG("[PISTORM-DEV] WARN: Unhandled %s register write to %.4X: %d\n", op_type_names[type], addr - pistorm_dev_base, val);
357 pi_cmd_result = PI_RES_INVALIDCMD;
362 uint32_t handle_pistorm_dev_read(uint32_t addr_, uint8_t type) {
363 uint32_t addr = (addr_ & 0xFFFF);
367 // Probably replace this with some read from the CPLD to get a simple hardware revision.
368 DEBUG("[PISTORM-DEV] %s Read from HWREV\n", op_type_names[type]);
369 return 0x0101; // 1.1
372 DEBUG("[PISTORM-DEV] %s Read from SWREV\n", op_type_names[type]);
375 case PI_CMD_RTGSTATUS:
376 DEBUG("[PISTORM-DEV] %s Read from RTGSTATUS\n", op_type_names[type]);
377 return (rtg_on << 1) | rtg_enabled;
379 case PI_CMD_NETSTATUS:
380 DEBUG("[PISTORM-DEV] %s Read from NETSTATUS\n", op_type_names[type]);
381 return pinet_enabled;
383 case PI_CMD_PISCSI_CTRL:
384 DEBUG("[PISTORM-DEV] %s Read from PISCSI_CTRL\n", op_type_names[type]);
385 return piscsi_enabled;
388 case PI_DBG_VAL1: case PI_DBG_VAL2: case PI_DBG_VAL3: case PI_DBG_VAL4:
389 case PI_DBG_VAL5: case PI_DBG_VAL6: case PI_DBG_VAL7: case PI_DBG_VAL8:
390 DEBUG("[PISTORM-DEV] Read DEBUG VALUE %d (%d / $%.8X)\n", (addr - PI_DBG_VAL1) / 4, pi_dbg_val[(addr - PI_DBG_VAL1) / 4], pi_dbg_val[(addr - PI_DBG_VAL1) / 4]);
391 return pi_dbg_val[(addr - PI_DBG_VAL1) / 4];
394 case PI_BYTE1: case PI_BYTE2: case PI_BYTE3: case PI_BYTE4:
395 case PI_BYTE5: case PI_BYTE6: case PI_BYTE7: case PI_BYTE8:
396 DEBUG("[PISTORM-DEV] Read BYTE %d (%d / $%.2X)\n", addr - PI_BYTE1, pi_byte[addr - PI_BYTE1], pi_byte[addr - PI_BYTE1]);
397 return pi_byte[addr - PI_BYTE1];
399 case PI_WORD1: case PI_WORD2: case PI_WORD3: case PI_WORD4:
400 DEBUG("[PISTORM-DEV] Read WORD %d (%d / $%.4X)\n", (addr - PI_WORD1) / 2, pi_word[(addr - PI_WORD1) / 2], pi_word[(addr - PI_WORD1) / 2]);
401 return pi_word[(addr - PI_WORD1) / 2];
403 case PI_LONGWORD1: case PI_LONGWORD2: case PI_LONGWORD3: case PI_LONGWORD4:
404 DEBUG("[PISTORM-DEV] Read LONGWORD %d (%d / $%.8X)\n", (addr - PI_LONGWORD1) / 4, pi_longword[(addr - PI_LONGWORD1) / 4], pi_longword[(addr - PI_LONGWORD1) / 4]);
405 return pi_longword[(addr - PI_LONGWORD1) / 4];
409 DEBUG("[PISTORM-DEV] %s Read from CMDRESULT\n", op_type_names[type]);
410 return pi_cmd_result;
414 DEBUG("[PISTORM-DEV] WARN: Unhandled %s register read from %.4X\n", op_type_names[type], addr - pistorm_dev_base);