git.sesse.net Git - pistorm/blob - platforms/amiga/pistorm-dev/pistorm-dev.c

   1 // SPDX-License-Identifier: MIT
   2
   3 #include <stdio.h>
   4 #include <stdlib.h>
   5 #include <string.h>
   6 #include <time.h>
   7
   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"
  15
  16 #include <linux/reboot.h>
  17 #include <sys/reboot.h>
  18
  19 #define DEBUG_PISTORM_DEVICE
  20
  21 #ifdef DEBUG_PISTORM_DEVICE
  22 #define DEBUG printf
  23
  24 #define PIDEV_SWREV 0x0105
  25
  26 static const char *op_type_names[4] = {
  27     "BYTE",
  28     "WORD",
  29     "LONGWORD",
  30     "MEM",
  31 };
  32 #else
  33 #define DEBUG(...)
  34 #endif
  35
  36 extern uint32_t pistorm_dev_base;
  37 extern uint32_t do_reset;
  38
  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;
  42
  43 char cfg_filename[256] = "default.cfg";
  44 char tmp_string[256];
  45
  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];
  50
  51 static uint32_t pi_dbg_val[4];
  52 static uint32_t pi_dbg_string[4];
  53
  54 static uint32_t pi_cmd_result = 0, shutdown_confirm = 0xFFFFFFFF;
  55
  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);
  58     uint32_t index = 0;
  59
  60     if (r == -1) {
  61         DEBUG("[GRAB_AMIGA_STRING] No mapped range found for address $%.8X. Grabbing string data over the bus.\n", addr);
  62         do {
  63             dest[index] = read8(addr + index);
  64             index++;
  65         } while (dest[index - 1] != 0x00 && index < str_max_len);
  66     }
  67     else {
  68         uint8_t *src = cfg->map_data[r] + (addr - cfg->map_offset[r]);
  69         do {
  70             dest[index] = src[index];
  71             index++;
  72         } while (dest[index - 1] != 0x00 && index < str_max_len);
  73     }
  74     if (index == str_max_len) {
  75         memset(dest, 0x00, str_max_len + 1);
  76         return -1;
  77     }
  78     DEBUG("[GRAB_AMIGA_STRING] Grabbed string: %s\n", dest);
  79     return (int32_t)strlen((const char*)dest);
  80 }
  81
  82 char *get_pistorm_devcfg_filename() {
  83     return cfg_filename;
  84 }
  85
  86 void set_pistorm_devcfg_filename(char *filename) {
  87     strcpy(cfg_filename, filename);
  88 }
  89
  90 void handle_pistorm_dev_write(uint32_t addr_, uint32_t val, uint8_t type) {
  91     uint32_t addr = (addr_ & 0xFFFF);
  92
  93     switch((addr)) {
  94         case PI_DBG_MSG:
  95             // Output debug message based on value written and data in val/str registers.
  96             break;
  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;
 101             break;
 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;
 105             break;
 106
 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);
 111             break;
 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);
 115             break;
 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;
 119             break;
 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;
 123             break;
 124
 125         case PI_CMD_RTGSTATUS:
 126             DEBUG("[PISTORM-DEV] Write to RTGSTATUS: %d\n", val);
 127             if (val == 1 && !rtg_enabled) {
 128                 init_rtg_data();
 129                 rtg_enabled = 1;
 130                 pi_cmd_result = PI_RES_OK;
 131             } else if (val == 0 && rtg_enabled) {
 132                 if (!rtg_on) {
 133                     shutdown_rtg();
 134                     rtg_enabled = 0;
 135                     pi_cmd_result = PI_RES_OK;
 136                 } else {
 137                     // Refuse to disable RTG if it's currently in use.
 138                     pi_cmd_result = PI_RES_FAILED;
 139                 }
 140             } else {
 141                 pi_cmd_result = PI_RES_NOCHANGE;
 142             }
 143             adjust_ranges_amiga(cfg);
 144             break;
 145         case PI_CMD_NETSTATUS:
 146             DEBUG("[PISTORM-DEV] Write to NETSTATUS: %d\n", val);
 147             if (val == 1 && !pinet_enabled) {
 148                 pinet_init(NULL);
 149                 pinet_enabled = 1;
 150                 pi_cmd_result = PI_RES_OK;
 151             } else if (val == 0 && pinet_enabled) {
 152                 pinet_shutdown();
 153                 pinet_enabled = 0;
 154                 pi_cmd_result = PI_RES_OK;
 155             } else {
 156                 pi_cmd_result = PI_RES_NOCHANGE;
 157             }
 158             adjust_ranges_amiga(cfg);
 159             break;
 160         case PI_CMD_PISCSI_CTRL:
 161             DEBUG("[PISTORM-DEV] Write to PISCSI_CTRL: ");
 162             switch(val) {
 163                 case PISCSI_CTRL_DISABLE:
 164                     DEBUG("DISABLE\n");
 165                     if (piscsi_enabled) {
 166                         piscsi_shutdown();
 167                         piscsi_enabled = 0;
 168                         // Probably not OK... depends on if you booted from floppy, I guess.
 169                         pi_cmd_result = PI_RES_OK;
 170                     } else {
 171                         pi_cmd_result = PI_RES_NOCHANGE;
 172                     }
 173                     break;
 174                 case PISCSI_CTRL_ENABLE:
 175                     DEBUG("ENABLE\n");
 176                     if (!piscsi_enabled) {
 177                         piscsi_init();
 178                         piscsi_enabled = 1;
 179                         piscsi_refresh_drives();
 180                         pi_cmd_result = PI_RES_OK;
 181                     } else {
 182                         pi_cmd_result = PI_RES_NOCHANGE;
 183                     }
 184                     break;
 185                 case PISCSI_CTRL_MAP:
 186                     DEBUG("MAP\n");
 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;
 190                     } else {
 191                         FILE *tmp = fopen(tmp_string, "rb");
 192                         if (tmp == NULL) {
 193                             printf("[PISTORM-DEV] Failed to open file %s for PISCSI drive mapping. Aborting.\n", cfg_filename);
 194                             pi_cmd_result = PI_RES_FILENOTFOUND;
 195                         } else {
 196                             fclose(tmp);
 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;
 201                         }
 202                     }
 203                     pi_string[0] = 0;
 204                     break;
 205                 case PISCSI_CTRL_UNMAP:
 206                     DEBUG("UNMAP\n");
 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;
 210                     } else {
 211                         if (piscsi_get_dev(pi_word[0])->fd != -1) {
 212                             piscsi_unmap_drive(pi_word[0]);
 213                             pi_cmd_result = PI_RES_OK;
 214                         } else {
 215                             pi_cmd_result = PI_RES_NOCHANGE;
 216                         }
 217                     }
 218                     break;
 219                 case PISCSI_CTRL_EJECT:
 220                     DEBUG("EJECT (NYI)\n");
 221                     pi_cmd_result = PI_RES_NOCHANGE;
 222                     break;
 223                 case PISCSI_CTRL_INSERT:
 224                     DEBUG("INSERT (NYI)\n");
 225                     pi_cmd_result = PI_RES_NOCHANGE;
 226                     break;
 227                 default:
 228                     DEBUG("UNKNOWN/UNHANDLED. Aborting.\n");
 229                     pi_cmd_result = PI_RES_INVALIDVALUE;
 230                     break;
 231             }
 232             adjust_ranges_amiga(cfg);
 233             break;
 234
 235         case PI_CMD_KICKROM:
 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;
 240             } else {
 241                 FILE *tmp = fopen(tmp_string, "rb");
 242                 if (tmp == NULL) {
 243                     printf("[PISTORM-DEV] Failed to open file %s for KICKROM mapping. Aborting.\n", cfg_filename);
 244                     pi_cmd_result = PI_RES_FILENOTFOUND;
 245                 } else {
 246                     fclose(tmp);
 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;
 255                         do_reset = 1;
 256                     } else {
 257                         printf ("[PISTORM-DEV] Could not find mapped range 'kickstart', cannot remap KICKROM.\n");
 258                         pi_cmd_result = PI_RES_FAILED;
 259                     }
 260                 }
 261             }
 262             adjust_ranges_amiga(cfg);
 263             pi_string[0] = 0;
 264             break;
 265         case PI_CMD_EXTROM:
 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;
 270             } else {
 271                 FILE *tmp = fopen(tmp_string, "rb");
 272                 if (tmp == NULL) {
 273                     printf("[PISTORM-DEV] Failed to open file %s for EXTROM mapping. Aborting.\n", cfg_filename);
 274                     pi_cmd_result = PI_RES_FILENOTFOUND;
 275                 } else {
 276                     fclose(tmp);
 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;
 285                         do_reset = 1;
 286                     } else {
 287                         printf ("[PISTORM-DEV] Could not find mapped range 'extrom', cannot remap EXTROM.\n");
 288                         pi_cmd_result = PI_RES_FAILED;
 289                     }
 290                 }
 291             }
 292             adjust_ranges_amiga(cfg);
 293             pi_string[0] = 0;
 294             break;
 295
 296         case PI_CMD_RESET:
 297             DEBUG("[PISTORM-DEV] System reset called, code %d\n", (val & 0xFFFF));
 298             do_reset = 1;
 299             break;
 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;
 304             break;
 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;
 310             } else {
 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;
 314                 end_signal = 1;
 315             }
 316             break;
 317         case PI_CMD_SWITCHCONFIG:
 318             DEBUG("[PISTORM-DEV] Config switch called, command: ");
 319             switch (val) {
 320                 case PICFG_LOAD:
 321                     DEBUG("LOAD\n");
 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;
 325                     } else {
 326                         FILE *tmp = fopen(cfg_filename, "rb");
 327                         if (tmp == NULL) {
 328                             printf("[PISTORM-DEV] Failed to open CONFIG file %s for reading. Aborting.\n", cfg_filename);
 329                             pi_cmd_result = PI_RES_FILENOTFOUND;
 330                         } else {
 331                             fclose(tmp);
 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;
 335                         }
 336                     }
 337                     pi_string[0] = 0;
 338                     break;
 339                 case PICFG_RELOAD:
 340                     DEBUG("RELOAD\n");
 341                     printf("[PISTORM-DEV] Reloading current config file (%s)...\n", cfg_filename);
 342                     load_new_config = val + 1;
 343                     break;
 344                 case PICFG_DEFAULT:
 345                     DEBUG("DEFAULT\n");
 346                     printf("[PISTORM-DEV] Loading default.cfg...\n");
 347                     load_new_config = val + 1;
 348                     break;
 349                 default:
 350                     DEBUG("UNKNOWN/UNHANDLED. Command ignored.\n");
 351                     pi_cmd_result = PI_RES_INVALIDVALUE;
 352                     break;
 353             }
 354             break;
 355         default:
 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;
 358             break;
 359     }
 360 }
 361
 362 uint32_t handle_pistorm_dev_read(uint32_t addr_, uint8_t type) {
 363     uint32_t addr = (addr_ & 0xFFFF);
 364
 365     switch((addr)) {
 366         case PI_CMD_HWREV:
 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
 370             break;
 371         case PI_CMD_SWREV:
 372             DEBUG("[PISTORM-DEV] %s Read from SWREV\n", op_type_names[type]);
 373             return PIDEV_SWREV;
 374             break;
 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;
 378             break;
 379         case PI_CMD_NETSTATUS:
 380             DEBUG("[PISTORM-DEV] %s Read from NETSTATUS\n", op_type_names[type]);
 381             return pinet_enabled;
 382             break;
 383         case PI_CMD_PISCSI_CTRL:
 384             DEBUG("[PISTORM-DEV] %s Read from PISCSI_CTRL\n", op_type_names[type]);
 385             return piscsi_enabled;
 386             break;
 387
 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];
 392             break;
 393
 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];
 398             break;
 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];
 402             break;
 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];
 406             break;
 407
 408         case PI_CMDRESULT:
 409             DEBUG("[PISTORM-DEV] %s Read from CMDRESULT\n", op_type_names[type]);
 410             return pi_cmd_result;
 411             break;
 412
 413         default:
 414             DEBUG("[PISTORM-DEV] WARN: Unhandled %s register read from %.4X\n", op_type_names[type], addr - pistorm_dev_base);
 415             break;
 416     }
 417     return 0;
 418 }