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 static uint32_t pi_ptr[4];
  51
  52 static uint32_t pi_dbg_val[4];
  53 static uint32_t pi_dbg_string[4];
  54
  55 static uint32_t pi_cmd_result = 0, shutdown_confirm = 0xFFFFFFFF;
  56
  57 int32_t grab_amiga_string(uint32_t addr, uint8_t *dest, uint32_t str_max_len) {
  58     int32_t r = get_mapped_item_by_address(cfg, addr);
  59     uint32_t index = 0;
  60
  61     if (r == -1) {
  62         DEBUG("[GRAB_AMIGA_STRING] No mapped range found for address $%.8X. Grabbing string data over the bus.\n", addr);
  63         do {
  64             dest[index] = read8(addr + index);
  65             index++;
  66         } while (dest[index - 1] != 0x00 && index < str_max_len);
  67     }
  68     else {
  69         uint8_t *src = cfg->map_data[r] + (addr - cfg->map_offset[r]);
  70         do {
  71             dest[index] = src[index];
  72             index++;
  73         } while (dest[index - 1] != 0x00 && index < str_max_len);
  74     }
  75     if (index == str_max_len) {
  76         memset(dest, 0x00, str_max_len + 1);
  77         return -1;
  78     }
  79     DEBUG("[GRAB_AMIGA_STRING] Grabbed string: %s\n", dest);
  80     return (int32_t)strlen((const char*)dest);
  81 }
  82
  83 int32_t amiga_transfer_file(uint32_t addr, char *filename) {
  84     FILE *in = fopen(filename, "rb");
  85     if (in == NULL) {
  86         DEBUG("[AMIGA_TRANSFER_FILE] Failed to open file %s for reading.\n", filename);
  87         return -1;
  88     }
  89     fseek(in, 0, SEEK_END);
  90
  91     int32_t r = get_mapped_item_by_address(cfg, addr);
  92     uint32_t filesize = ftell(in);
  93
  94     fseek(in, 0, SEEK_SET);
  95     if (r == -1) {
  96         DEBUG("[GRAB_AMIGA_STRING] No mapped range found for address $%.8X. Transferring file data over the bus.\n", addr);
  97         uint8_t tmp_read = 0;
  98
  99         for (uint32_t i = 0; i < filesize; i++) {
 100             tmp_read = (uint8_t)fgetc(in);
 101             write8(addr + i, tmp_read);
 102         }
 103     } else {
 104         uint8_t *dst = cfg->map_data[r] + (addr - cfg->map_offset[r]);
 105         fread(dst, filesize, 1, in);
 106     }
 107     fclose(in);
 108     DEBUG("[AMIGA_TRANSFER_FILE] Copied %d bytes to address $%.8X.\n", filesize, addr);
 109
 110     return 0;
 111 }
 112
 113 char *get_pistorm_devcfg_filename() {
 114     return cfg_filename;
 115 }
 116
 117 void set_pistorm_devcfg_filename(char *filename) {
 118     strcpy(cfg_filename, filename);
 119 }
 120
 121 void handle_pistorm_dev_write(uint32_t addr_, uint32_t val, uint8_t type) {
 122     uint32_t addr = (addr_ & 0xFFFF);
 123
 124     switch((addr)) {
 125         case PI_DBG_MSG:
 126             // Output debug message based on value written and data in val/str registers.
 127             break;
 128         case PI_DBG_VAL1: case PI_DBG_VAL2: case PI_DBG_VAL3: case PI_DBG_VAL4:
 129         case PI_DBG_VAL5: case PI_DBG_VAL6: case PI_DBG_VAL7: case PI_DBG_VAL8:
 130             DEBUG("[PISTORM-DEV] Set DEBUG VALUE %d to %d ($%.8X)\n", (addr - PI_DBG_VAL1) / 4, val, val);
 131             pi_dbg_val[(addr - PI_DBG_VAL1) / 4] = val;
 132             break;
 133         case PI_DBG_STR1: case PI_DBG_STR2: case PI_DBG_STR3: case PI_DBG_STR4:
 134             DEBUG("[PISTORM-DEV] Set DEBUG STRING POINTER %d to $%.8X\n", (addr - PI_DBG_STR1) / 4, val);
 135             pi_dbg_string[(addr - PI_DBG_STR1) / 4] = val;
 136             break;
 137
 138         case PI_BYTE1: case PI_BYTE2: case PI_BYTE3: case PI_BYTE4:
 139         case PI_BYTE5: case PI_BYTE6: case PI_BYTE7: case PI_BYTE8:
 140             DEBUG("[PISTORM-DEV] Set BYTE %d to %d ($%.2X)\n", addr - PI_BYTE1, (val & 0xFF), (val & 0xFF));
 141             pi_byte[addr - PI_BYTE1] = (val & 0xFF);
 142             break;
 143         case PI_WORD1: case PI_WORD2: case PI_WORD3: case PI_WORD4:
 144             DEBUG("[PISTORM-DEV] Set WORD %d to %d ($%.4X)\n", (addr - PI_WORD1) / 2, (val & 0xFFFF), (val & 0xFFFF));
 145             pi_word[(addr - PI_WORD1) / 2] = (val & 0xFFFF);
 146             break;
 147         case PI_LONGWORD1: case PI_LONGWORD2: case PI_LONGWORD3: case PI_LONGWORD4:
 148             DEBUG("[PISTORM-DEV] Set LONGWORD %d to %d ($%.8X)\n", (addr - PI_LONGWORD1) / 4, val, val);
 149             pi_longword[(addr - PI_LONGWORD1) / 4] = val;
 150             break;
 151         case PI_STR1: case PI_STR2: case PI_STR3: case PI_STR4:
 152             DEBUG("[PISTORM-DEV] Set STRING POINTER %d to $%.8X\n", (addr - PI_STR1) / 4, val);
 153             pi_string[(addr - PI_STR1) / 4] = val;
 154             break;
 155         case PI_PTR1: case PI_PTR2: case PI_PTR3: case PI_PTR4:
 156             DEBUG("[PISTORM-DEV] Set DATA POINTER %d to $%.8X\n", (addr - PI_PTR1) / 4, val);
 157             pi_ptr[(addr - PI_PTR1) / 4] = val;
 158             break;
 159
 160         case PI_CMD_TRANSFERFILE:
 161             DEBUG("[PISTORM-DEV] Write to TRANSFERFILE.\n");
 162             if (pi_string[0] == 0 || grab_amiga_string(pi_string[0], (uint8_t *)tmp_string, 255) == -1)  {
 163                 printf("[PISTORM-DEV] No or invalid filename for TRANSFERFILE. Aborting.\n");
 164                 pi_cmd_result = PI_RES_INVALIDVALUE;
 165             } else if (pi_ptr[0] == 0) {
 166                 printf("[PISTORM-DEV] Null pointer specified for TRANSFERFILE destination. Aborting.\n");
 167                 pi_cmd_result = PI_RES_INVALIDVALUE;
 168             } else {
 169                 if (amiga_transfer_file(pi_ptr[0], tmp_string) == -1) {
 170                     pi_cmd_result = PI_RES_FAILED;
 171                 } else {
 172                     pi_cmd_result = PI_RES_OK;
 173                 }
 174             }
 175             pi_string[0] = 0;
 176             pi_ptr[0] = 0;
 177             break;
 178
 179         case PI_CMD_RTGSTATUS:
 180             DEBUG("[PISTORM-DEV] Write to RTGSTATUS: %d\n", val);
 181             if (val == 1 && !rtg_enabled) {
 182                 init_rtg_data();
 183                 rtg_enabled = 1;
 184                 pi_cmd_result = PI_RES_OK;
 185             } else if (val == 0 && rtg_enabled) {
 186                 if (!rtg_on) {
 187                     shutdown_rtg();
 188                     rtg_enabled = 0;
 189                     pi_cmd_result = PI_RES_OK;
 190                 } else {
 191                     // Refuse to disable RTG if it's currently in use.
 192                     pi_cmd_result = PI_RES_FAILED;
 193                 }
 194             } else {
 195                 pi_cmd_result = PI_RES_NOCHANGE;
 196             }
 197             adjust_ranges_amiga(cfg);
 198             break;
 199         case PI_CMD_NETSTATUS:
 200             DEBUG("[PISTORM-DEV] Write to NETSTATUS: %d\n", val);
 201             if (val == 1 && !pinet_enabled) {
 202                 pinet_init(NULL);
 203                 pinet_enabled = 1;
 204                 pi_cmd_result = PI_RES_OK;
 205             } else if (val == 0 && pinet_enabled) {
 206                 pinet_shutdown();
 207                 pinet_enabled = 0;
 208                 pi_cmd_result = PI_RES_OK;
 209             } else {
 210                 pi_cmd_result = PI_RES_NOCHANGE;
 211             }
 212             adjust_ranges_amiga(cfg);
 213             break;
 214         case PI_CMD_PISCSI_CTRL:
 215             DEBUG("[PISTORM-DEV] Write to PISCSI_CTRL: ");
 216             switch(val) {
 217                 case PISCSI_CTRL_DISABLE:
 218                     DEBUG("DISABLE\n");
 219                     if (piscsi_enabled) {
 220                         piscsi_shutdown();
 221                         piscsi_enabled = 0;
 222                         // Probably not OK... depends on if you booted from floppy, I guess.
 223                         pi_cmd_result = PI_RES_OK;
 224                     } else {
 225                         pi_cmd_result = PI_RES_NOCHANGE;
 226                     }
 227                     break;
 228                 case PISCSI_CTRL_ENABLE:
 229                     DEBUG("ENABLE\n");
 230                     if (!piscsi_enabled) {
 231                         piscsi_init();
 232                         piscsi_enabled = 1;
 233                         piscsi_refresh_drives();
 234                         pi_cmd_result = PI_RES_OK;
 235                     } else {
 236                         pi_cmd_result = PI_RES_NOCHANGE;
 237                     }
 238                     break;
 239                 case PISCSI_CTRL_MAP:
 240                     DEBUG("MAP\n");
 241                     if (pi_string[0] == 0 || grab_amiga_string(pi_string[0], (uint8_t *)tmp_string, 255) == -1)  {
 242                         printf("[PISTORM-DEV] Failed to grab string for PISCSI drive filename. Aborting.\n");
 243                         pi_cmd_result = PI_RES_FAILED;
 244                     } else {
 245                         FILE *tmp = fopen(tmp_string, "rb");
 246                         if (tmp == NULL) {
 247                             printf("[PISTORM-DEV] Failed to open file %s for PISCSI drive mapping. Aborting.\n", tmp_string);
 248                             pi_cmd_result = PI_RES_FILENOTFOUND;
 249                         } else {
 250                             fclose(tmp);
 251                             printf("[PISTORM-DEV] Attempting to map file %s as PISCSI drive %d...\n", tmp_string, pi_word[0]);
 252                             piscsi_unmap_drive(pi_word[0]);
 253                             piscsi_map_drive(tmp_string, pi_word[0]);
 254                             pi_cmd_result = PI_RES_OK;
 255                         }
 256                     }
 257                     pi_string[0] = 0;
 258                     break;
 259                 case PISCSI_CTRL_UNMAP:
 260                     DEBUG("UNMAP\n");
 261                     if (pi_word[0] > 7) {
 262                         printf("[PISTORM-DEV] Invalid drive ID %d for PISCSI unmap command.", pi_word[0]);
 263                         pi_cmd_result = PI_RES_INVALIDVALUE;
 264                     } else {
 265                         if (piscsi_get_dev(pi_word[0])->fd != -1) {
 266                             piscsi_unmap_drive(pi_word[0]);
 267                             pi_cmd_result = PI_RES_OK;
 268                         } else {
 269                             pi_cmd_result = PI_RES_NOCHANGE;
 270                         }
 271                     }
 272                     break;
 273                 case PISCSI_CTRL_EJECT:
 274                     DEBUG("EJECT (NYI)\n");
 275                     pi_cmd_result = PI_RES_NOCHANGE;
 276                     break;
 277                 case PISCSI_CTRL_INSERT:
 278                     DEBUG("INSERT (NYI)\n");
 279                     pi_cmd_result = PI_RES_NOCHANGE;
 280                     break;
 281                 default:
 282                     DEBUG("UNKNOWN/UNHANDLED. Aborting.\n");
 283                     pi_cmd_result = PI_RES_INVALIDVALUE;
 284                     break;
 285             }
 286             adjust_ranges_amiga(cfg);
 287             break;
 288
 289         case PI_CMD_KICKROM:
 290             DEBUG("[PISTORM-DEV] Write to KICKROM.\n");
 291             if (pi_string[0] == 0 || grab_amiga_string(pi_string[0], (uint8_t *)tmp_string, 255) == -1)  {
 292                 printf("[PISTORM-DEV] Failed to grab string KICKROM filename. Aborting.\n");
 293                 pi_cmd_result = PI_RES_FAILED;
 294             } else {
 295                 FILE *tmp = fopen(tmp_string, "rb");
 296                 if (tmp == NULL) {
 297                     printf("[PISTORM-DEV] Failed to open file %s for KICKROM mapping. Aborting.\n", tmp_string);
 298                     pi_cmd_result = PI_RES_FILENOTFOUND;
 299                 } else {
 300                     fclose(tmp);
 301                     if (get_named_mapped_item(cfg, "kickstart") != -1) {
 302                         uint32_t index = get_named_mapped_item(cfg, "kickstart");
 303                         free(cfg->map_data[index]);
 304                         free(cfg->map_id[index]);
 305                         cfg->map_type[index] = MAPTYPE_NONE;
 306                         // Dirty hack, I am sleepy and lazy.
 307                         add_mapping(cfg, MAPTYPE_ROM, cfg->map_offset[index], cfg->map_size[index], 0, tmp_string, "kickstart");
 308                         pi_cmd_result = PI_RES_OK;
 309                         do_reset = 1;
 310                     } else {
 311                         printf ("[PISTORM-DEV] Could not find mapped range 'kickstart', cannot remap KICKROM.\n");
 312                         pi_cmd_result = PI_RES_FAILED;
 313                     }
 314                 }
 315             }
 316             adjust_ranges_amiga(cfg);
 317             pi_string[0] = 0;
 318             break;
 319         case PI_CMD_EXTROM:
 320             DEBUG("[PISTORM-DEV] Write to EXTROM.\n");
 321             if (pi_string[0] == 0 || grab_amiga_string(pi_string[0], (uint8_t *)tmp_string, 255) == -1)  {
 322                 printf("[PISTORM-DEV] Failed to grab string EXTROM filename. Aborting.\n");
 323                 pi_cmd_result = PI_RES_FAILED;
 324             } else {
 325                 FILE *tmp = fopen(tmp_string, "rb");
 326                 if (tmp == NULL) {
 327                     printf("[PISTORM-DEV] Failed to open file %s for EXTROM mapping. Aborting.\n", tmp_string);
 328                     pi_cmd_result = PI_RES_FILENOTFOUND;
 329                 } else {
 330                     fclose(tmp);
 331                     if (get_named_mapped_item(cfg, "extended") != -1) {
 332                         uint32_t index = get_named_mapped_item(cfg, "extended");
 333                         free(cfg->map_data[index]);
 334                         free(cfg->map_id[index]);
 335                         cfg->map_type[index] = MAPTYPE_NONE;
 336                         // Dirty hack, I am tired and lazy.
 337                         add_mapping(cfg, MAPTYPE_ROM, cfg->map_offset[index], cfg->map_size[index], 0, tmp_string, "extended");
 338                         pi_cmd_result = PI_RES_OK;
 339                         do_reset = 1;
 340                     } else {
 341                         printf ("[PISTORM-DEV] Could not find mapped range 'extrom', cannot remap EXTROM.\n");
 342                         pi_cmd_result = PI_RES_FAILED;
 343                     }
 344                 }
 345             }
 346             adjust_ranges_amiga(cfg);
 347             pi_string[0] = 0;
 348             break;
 349
 350         case PI_CMD_RESET:
 351             DEBUG("[PISTORM-DEV] System reset called, code %d\n", (val & 0xFFFF));
 352             do_reset = 1;
 353             break;
 354         case PI_CMD_SHUTDOWN:
 355             DEBUG("[PISTORM-DEV] Shutdown requested. Confirm by replying with return value to CONFIRMSHUTDOWN.\n");
 356             shutdown_confirm = rand() % 0xFFFF;
 357             pi_cmd_result = shutdown_confirm;
 358             break;
 359         case PI_CMD_CONFIRMSHUTDOWN:
 360             if (val != shutdown_confirm) {
 361                 DEBUG("[PISTORM-DEV] Attempted shutdown with wrong shutdown confirm value. Not shutting down.\n");
 362                 shutdown_confirm = 0xFFFFFFFF;
 363                 pi_cmd_result = PI_RES_FAILED;
 364             } else {
 365                 printf("[PISTORM-DEV] Shutting down the PiStorm. Good night, fight well, until we meet again.\n");
 366                 reboot(LINUX_REBOOT_CMD_POWER_OFF);
 367                 pi_cmd_result = PI_RES_OK;
 368                 end_signal = 1;
 369             }
 370             break;
 371         case PI_CMD_SWITCHCONFIG:
 372             DEBUG("[PISTORM-DEV] Config switch called, command: ");
 373             switch (val) {
 374                 case PICFG_LOAD:
 375                     DEBUG("LOAD\n");
 376                     if (pi_string[0] == 0 || grab_amiga_string(pi_string[0], (uint8_t *)cfg_filename, 255) == -1) {
 377                         printf("[PISTORM-DEV] Failed to grab string for CONFIG filename. Aborting.\n");
 378                         pi_cmd_result = PI_RES_FAILED;
 379                     } else {
 380                         FILE *tmp = fopen(cfg_filename, "rb");
 381                         if (tmp == NULL) {
 382                             printf("[PISTORM-DEV] Failed to open CONFIG file %s for reading. Aborting.\n", cfg_filename);
 383                             pi_cmd_result = PI_RES_FILENOTFOUND;
 384                         } else {
 385                             fclose(tmp);
 386                             printf("[PISTORM-DEV] Attempting to load config file %s...\n", cfg_filename);
 387                             load_new_config = val + 1;
 388                             pi_cmd_result = PI_RES_OK;
 389                         }
 390                     }
 391                     pi_string[0] = 0;
 392                     break;
 393                 case PICFG_RELOAD:
 394                     DEBUG("RELOAD\n");
 395                     printf("[PISTORM-DEV] Reloading current config file (%s)...\n", cfg_filename);
 396                     load_new_config = val + 1;
 397                     break;
 398                 case PICFG_DEFAULT:
 399                     DEBUG("DEFAULT\n");
 400                     printf("[PISTORM-DEV] Loading default.cfg...\n");
 401                     load_new_config = val + 1;
 402                     break;
 403                 default:
 404                     DEBUG("UNKNOWN/UNHANDLED. Command ignored.\n");
 405                     pi_cmd_result = PI_RES_INVALIDVALUE;
 406                     break;
 407             }
 408             break;
 409         default:
 410             DEBUG("[PISTORM-DEV] WARN: Unhandled %s register write to %.4X: %d\n", op_type_names[type], addr - pistorm_dev_base, val);
 411             pi_cmd_result = PI_RES_INVALIDCMD;
 412             break;
 413     }
 414 }
 415
 416 uint32_t handle_pistorm_dev_read(uint32_t addr_, uint8_t type) {
 417     uint32_t addr = (addr_ & 0xFFFF);
 418
 419     switch((addr)) {
 420         case PI_CMD_FILESIZE:
 421             DEBUG("[PISTORM-DEV] %s read from FILESIZE.\n", op_type_names[type]);
 422             if (pi_string[0] == 0 || grab_amiga_string(pi_string[0], (uint8_t *)tmp_string, 255) == -1)  {
 423                 DEBUG("[PISTORM-DEV] Failed to grab string for FILESIZE command. Aborting.\n");
 424                 pi_cmd_result = PI_RES_FAILED;
 425                 pi_longword[0] = 0;
 426                 return 0;
 427             } else {
 428                 FILE *tmp = fopen(tmp_string, "rb");
 429                 if (tmp == NULL) {
 430                     DEBUG("[PISTORM-DEV] Failed to open file %s for FILESIZE command. Aborting.\n", tmp_string);
 431                     pi_longword[0] = 0;
 432                     pi_cmd_result = PI_RES_FILENOTFOUND;
 433                 } else {
 434                     fseek(tmp, 0, SEEK_END);
 435                     pi_longword[0] = ftell(tmp);
 436                     DEBUG("[PISTORM-DEV] Returning file size for file %s: %d bytes.\n", tmp_string, pi_longword[0]);
 437                     fclose(tmp);
 438                     pi_cmd_result = PI_RES_OK;
 439                 }
 440             }
 441             pi_string[0] = 0;
 442             return pi_longword[0];
 443             break;
 444
 445         case PI_CMD_HWREV:
 446             // Probably replace this with some read from the CPLD to get a simple hardware revision.
 447             DEBUG("[PISTORM-DEV] %s Read from HWREV\n", op_type_names[type]);
 448             return 0x0101; // 1.1
 449             break;
 450         case PI_CMD_SWREV:
 451             DEBUG("[PISTORM-DEV] %s Read from SWREV\n", op_type_names[type]);
 452             return PIDEV_SWREV;
 453             break;
 454         case PI_CMD_RTGSTATUS:
 455             DEBUG("[PISTORM-DEV] %s Read from RTGSTATUS\n", op_type_names[type]);
 456             return (rtg_on << 1) | rtg_enabled;
 457             break;
 458         case PI_CMD_NETSTATUS:
 459             DEBUG("[PISTORM-DEV] %s Read from NETSTATUS\n", op_type_names[type]);
 460             return pinet_enabled;
 461             break;
 462         case PI_CMD_PISCSI_CTRL:
 463             DEBUG("[PISTORM-DEV] %s Read from PISCSI_CTRL\n", op_type_names[type]);
 464             return piscsi_enabled;
 465             break;
 466
 467         case PI_DBG_VAL1: case PI_DBG_VAL2: case PI_DBG_VAL3: case PI_DBG_VAL4:
 468         case PI_DBG_VAL5: case PI_DBG_VAL6: case PI_DBG_VAL7: case PI_DBG_VAL8:
 469             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]);
 470             return pi_dbg_val[(addr - PI_DBG_VAL1) / 4];
 471             break;
 472
 473         case PI_BYTE1: case PI_BYTE2: case PI_BYTE3: case PI_BYTE4:
 474         case PI_BYTE5: case PI_BYTE6: case PI_BYTE7: case PI_BYTE8:
 475             DEBUG("[PISTORM-DEV] Read BYTE %d (%d / $%.2X)\n", addr - PI_BYTE1, pi_byte[addr - PI_BYTE1], pi_byte[addr - PI_BYTE1]);
 476             return pi_byte[addr - PI_BYTE1];
 477             break;
 478         case PI_WORD1: case PI_WORD2: case PI_WORD3: case PI_WORD4:
 479             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]);
 480             return pi_word[(addr - PI_WORD1) / 2];
 481             break;
 482         case PI_LONGWORD1: case PI_LONGWORD2: case PI_LONGWORD3: case PI_LONGWORD4:
 483             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]);
 484             return pi_longword[(addr - PI_LONGWORD1) / 4];
 485             break;
 486
 487         case PI_CMDRESULT:
 488             DEBUG("[PISTORM-DEV] %s Read from CMDRESULT: %d\n", op_type_names[type], pi_cmd_result);
 489             return pi_cmd_result;
 490             break;
 491
 492         default:
 493             DEBUG("[PISTORM-DEV] WARN: Unhandled %s register read from %.4X\n", op_type_names[type], addr - pistorm_dev_base);
 494             break;
 495     }
 496     return 0;
 497 }