1 // SPDX-License-Identifier: MIT
3 #include "pistorm-dev.h"
4 #include "pistorm-dev-enums.h"
5 #include "platforms/platforms.h"
6 #include "gpio/ps_protocol.h"
11 #define DEBUG_PISTORM_DEVICE
13 #ifdef DEBUG_PISTORM_DEVICE
16 #define PIDEV_SWREV 0x0105
18 static const char *op_type_names[4] = {
28 extern uint32_t pistorm_dev_base;
29 extern uint32_t do_reset;
31 extern uint8_t rtg_enabled, rtg_on, pinet_enabled, piscsi_enabled, load_new_config;
32 extern struct emulator_config *cfg;
34 char cfg_filename[256];
36 static uint8_t pi_byte[8];
37 static uint16_t pi_word[4];
38 static uint32_t pi_longword[4];
39 static uint32_t pi_string[4];
41 static uint32_t pi_dbg_val[4];
42 static uint32_t pi_dbg_string[4];
44 static uint32_t pi_cmd_result = 0;
46 int32_t grab_amiga_string(uint32_t addr, uint8_t *dest, uint32_t str_max_len) {
47 int32_t r = get_mapped_item_by_address(cfg, addr);
51 DEBUG("[GRAB_AMIGA_STRING] No mapped range found for address $%.8X. Grabbing string data over the bus.\n", addr);
53 dest[index] = read8(addr + index);
55 } while (dest[index - 1] != 0x00 && index < str_max_len);
58 uint8_t *src = cfg->map_data[r] + (addr - cfg->map_offset[r]);
60 dest[index] = src[index];
62 } while (dest[index - 1] != 0x00 && index < str_max_len);
64 if (index == str_max_len) {
65 memset(dest, 0x00, str_max_len + 1);
68 DEBUG("[GRAB_AMIGA_STRING] Grabbed string: %s\n", dest);
69 return (int32_t)strlen((const char*)dest);
72 char *get_pistorm_devcfg_filename() {
76 void handle_pistorm_dev_write(uint32_t addr_, uint32_t val, uint8_t type) {
77 uint32_t addr = (addr_ & 0xFFFF);
81 // Output debug message based on value written and data in val/str registers.
83 case PI_DBG_VAL1: case PI_DBG_VAL2: case PI_DBG_VAL3: case PI_DBG_VAL4:
84 case PI_DBG_VAL5: case PI_DBG_VAL6: case PI_DBG_VAL7: case PI_DBG_VAL8:
85 DEBUG("[PISTORM-DEV] Set DEBUG VALUE %d to %d ($%.8X)\n", (addr - PI_DBG_VAL1) / 4, val, val);
86 pi_dbg_val[(addr - PI_DBG_VAL1) / 4] = val;
88 case PI_DBG_STR1: case PI_DBG_STR2: case PI_DBG_STR3: case PI_DBG_STR4:
89 DEBUG("[PISTORM-DEV] Set DEBUG STRING POINTER %d to $%.8X\n", (addr - PI_DBG_STR1) / 4, val);
90 pi_dbg_string[(addr - PI_DBG_STR1) / 4] = val;
93 case PI_BYTE1: case PI_BYTE2: case PI_BYTE3: case PI_BYTE4:
94 case PI_BYTE5: case PI_BYTE6: case PI_BYTE7: case PI_BYTE8:
95 DEBUG("[PISTORM-DEV] Set BYTE %d to %d ($%.2X)\n", addr - PI_BYTE1, (val & 0xFF), (val & 0xFF));
96 pi_byte[addr - PI_BYTE1] = (val & 0xFF);
98 case PI_WORD1: case PI_WORD2: case PI_WORD3: case PI_WORD4:
99 DEBUG("[PISTORM-DEV] Set WORD %d to %d ($%.4X)\n", (addr - PI_WORD1) / 2, (val & 0xFFFF), (val & 0xFFFF));
100 pi_word[(addr - PI_WORD1) / 2] = (val & 0xFFFF);
102 case PI_LONGWORD1: case PI_LONGWORD2: case PI_LONGWORD3: case PI_LONGWORD4:
103 DEBUG("[PISTORM-DEV] Set LONGWORD %d to %d ($%.8X)\n", (addr - PI_LONGWORD1) / 4, val, val);
104 pi_longword[(addr - PI_LONGWORD1) / 4] = val;
106 case PI_STR1: case PI_STR2: case PI_STR3: case PI_STR4:
107 DEBUG("[PISTORM-DEV] Set STRING POINTER %d to $%.8X\n", (addr - PI_STR1) / 4, val);
108 pi_string[(addr - PI_STR1) / 4] = val;
112 DEBUG("[PISTORM-DEV] System reset called, code %d\n", (val & 0xFFFF));
115 case PI_CMD_SWITCHCONFIG:
116 DEBUG("[PISTORM-DEV] Config switch called, command: ");
120 if (pi_string[0] == 0 || grab_amiga_string(pi_string[0], (uint8_t *)cfg_filename, 255) == -1) {
121 printf("[PISTORM-DEV] Failed to grab string for config filename. Aborting.\n");
123 FILE *tmp = fopen(cfg_filename, "rb");
125 printf("[PISTORM-DEV] Failed to open config file %s for reading. Aborting.\n", cfg_filename);
127 printf("[PISTORM-DEV] Attempting to load config file %s...\n", cfg_filename);
140 DEBUG("UNKNOWN. Command ignored.\n");
145 DEBUG("[PISTORM-DEV] WARN: Unhandled %s register write to %.4X: %d\n", op_type_names[type], addr - pistorm_dev_base, val);
150 uint32_t handle_pistorm_dev_read(uint32_t addr_, uint8_t type) {
151 uint32_t addr = (addr_ & 0xFFFF);
155 // Probably replace this with some read from the CPLD to get a simple hardware revision.
156 DEBUG("[PISTORM-DEV] %s Read from HWREV\n", op_type_names[type]);
157 return 0x0101; // 1.1
160 DEBUG("[PISTORM-DEV] %s Read from SWREV\n", op_type_names[type]);
163 case PI_CMD_RTGSTATUS:
164 DEBUG("[PISTORM-DEV] %s Read from RTGSTATUS\n", op_type_names[type]);
165 return (rtg_on << 1) | rtg_enabled;
167 case PI_CMD_NETSTATUS:
168 DEBUG("[PISTORM-DEV] %s Read from NETSTATUS\n", op_type_names[type]);
169 return pinet_enabled;
171 case PI_CMD_PISCSI_CTRL:
172 DEBUG("[PISTORM-DEV] %s Read from PISCSI_CTRL\n", op_type_names[type]);
173 return piscsi_enabled;
176 case PI_DBG_VAL1: case PI_DBG_VAL2: case PI_DBG_VAL3: case PI_DBG_VAL4:
177 case PI_DBG_VAL5: case PI_DBG_VAL6: case PI_DBG_VAL7: case PI_DBG_VAL8:
178 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]);
179 return pi_dbg_val[(addr - PI_DBG_VAL1) / 4];
182 case PI_BYTE1: case PI_BYTE2: case PI_BYTE3: case PI_BYTE4:
183 case PI_BYTE5: case PI_BYTE6: case PI_BYTE7: case PI_BYTE8:
184 DEBUG("[PISTORM-DEV] Read BYTE %d (%d / $%.2X)\n", addr - PI_BYTE1, pi_byte[addr - PI_BYTE1], pi_byte[addr - PI_BYTE1]);
185 return pi_byte[addr - PI_BYTE1];
187 case PI_WORD1: case PI_WORD2: case PI_WORD3: case PI_WORD4:
188 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]);
189 return pi_word[(addr - PI_WORD1) / 2];
191 case PI_LONGWORD1: case PI_LONGWORD2: case PI_LONGWORD3: case PI_LONGWORD4:
192 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]);
193 return pi_longword[(addr - PI_LONGWORD1) / 4];
197 DEBUG("[PISTORM-DEV] %s Read from CMDRESULT\n", op_type_names[type]);
198 return pi_cmd_result;
202 DEBUG("[PISTORM-DEV] WARN: Unhandled %s register read from %.4X\n", op_type_names[type], addr - pistorm_dev_base);