pico/cart.c

   1 // This is part of Pico Library\r
   2 \r
   3 // (c) Copyright 2004 Dave, All rights reserved.\r
   4 // (c) Copyright 2006-2007, Grazvydas "notaz" Ignotas\r
   5 // Free for non-commercial use.\r
   6 \r
   7 // For commercial use, separate licencing terms must be obtained.\r
   8 \r
   9 \r
  10 #include "pico_int.h"\r
  11 #include "../zlib/zlib.h"\r
  12 #include "../unzip/unzip.h"\r
  13 #include "../unzip/unzip_stream.h"\r
  14 \r
  15 \r
  16 static int rom_alloc_size;\r
  17 static const char *rom_exts[] = { "bin", "gen", "smd", "iso", "sms", "gg", "sg" };\r
  18 \r
  19 void (*PicoCartUnloadHook)(void);\r
  20 void (*PicoCartMemSetup)(void);\r
  21 \r
  22 void (*PicoCartLoadProgressCB)(int percent) = NULL;\r
  23 void (*PicoCDLoadProgressCB)(const char *fname, int percent) = NULL; // handled in Pico/cd/cd_file.c\r
  24 \r
  25 static void PicoCartDetect(const char *carthw_cfg);\r
  26 \r
  27 /* cso struct */\r
  28 typedef struct _cso_struct\r
  29 {\r
  30   unsigned char in_buff[2*2048];\r
  31   unsigned char out_buff[2048];\r
  32   struct {\r
  33     char          magic[4];\r
  34     unsigned int  unused;\r
  35     unsigned int  total_bytes;\r
  36     unsigned int  total_bytes_high; // ignored here\r
  37     unsigned int  block_size;  // 10h\r
  38     unsigned char ver;\r
  39     unsigned char align;\r
  40     unsigned char reserved[2];\r
  41   } header;\r
  42   unsigned int  fpos_in;  // input file read pointer\r
  43   unsigned int  fpos_out; // pos in virtual decompressed file\r
  44   int block_in_buff;      // block which we have read in in_buff\r
  45   int pad;\r
  46   int index[0];\r
  47 }\r
  48 cso_struct;\r
  49 \r
  50 static int uncompress2(void *dest, int destLen, void *source, int sourceLen)\r
  51 {\r
  52     z_stream stream;\r
  53     int err;\r
  54 \r
  55     stream.next_in = (Bytef*)source;\r
  56     stream.avail_in = (uInt)sourceLen;\r
  57     stream.next_out = dest;\r
  58     stream.avail_out = (uInt)destLen;\r
  59 \r
  60     stream.zalloc = NULL;\r
  61     stream.zfree = NULL;\r
  62 \r
  63     err = inflateInit2(&stream, -15);\r
  64     if (err != Z_OK) return err;\r
  65 \r
  66     err = inflate(&stream, Z_FINISH);\r
  67     if (err != Z_STREAM_END) {\r
  68         inflateEnd(&stream);\r
  69         return err;\r
  70     }\r
  71     //*destLen = stream.total_out;\r
  72 \r
  73     return inflateEnd(&stream);\r
  74 }\r
  75 \r
  76 static const char *get_ext(const char *path)\r
  77 {\r
  78   const char *ext;\r
  79   if (strlen(path) < 4)\r
  80     return ""; // no ext\r
  81 \r
  82   // allow 2 or 3 char extensions for now\r
  83   ext = path + strlen(path) - 2;\r
  84   if (ext[-1] != '.') ext--;\r
  85   if (ext[-1] != '.')\r
  86     return "";\r
  87   return ext;\r
  88 }\r
  89 \r
  90 pm_file *pm_open(const char *path)\r
  91 {\r
  92   pm_file *file = NULL;\r
  93   const char *ext;\r
  94   FILE *f;\r
  95 \r
  96   if (path == NULL)\r
  97     return NULL;\r
  98 \r
  99   ext = get_ext(path);\r
 100   if (strcasecmp(ext, "zip") == 0)\r
 101   {\r
 102     struct zipent *zipentry;\r
 103     gzFile gzf = NULL;\r
 104     ZIP *zipfile;\r
 105     int i;\r
 106 \r
 107     zipfile = openzip(path);\r
 108     if (zipfile != NULL)\r
 109     {\r
 110       /* search for suitable file (right extension or large enough file) */\r
 111       while ((zipentry = readzip(zipfile)) != NULL)\r
 112       {\r
 113         ext = get_ext(zipentry->name);\r
 114 \r
 115         if (zipentry->uncompressed_size >= 32*1024)\r
 116           goto found_rom_zip;\r
 117 \r
 118         for (i = 0; i < sizeof(rom_exts)/sizeof(rom_exts[0]); i++)\r
 119           if (strcasecmp(ext, rom_exts[i]) == 0)\r
 120             goto found_rom_zip;\r
 121       }\r
 122 \r
 123       /* zipfile given, but nothing found suitable for us inside */\r
 124       goto zip_failed;\r
 125 \r
 126 found_rom_zip:\r
 127       /* try to convert to gzip stream, so we could use standard gzio functions from zlib */\r
 128       gzf = zip2gz(zipfile, zipentry);\r
 129       if (gzf == NULL)  goto zip_failed;\r
 130 \r
 131       file = calloc(1, sizeof(*file));\r
 132       if (file == NULL) goto zip_failed;\r
 133       file->file  = zipfile;\r
 134       file->param = gzf;\r
 135       file->size  = zipentry->uncompressed_size;\r
 136       file->type  = PMT_ZIP;\r
 137       strncpy(file->ext, ext, sizeof(file->ext) - 1);\r
 138       return file;\r
 139 \r
 140 zip_failed:\r
 141       if (gzf) {\r
 142         gzclose(gzf);\r
 143         zipfile->fp = NULL; // gzclose() closed it\r
 144       }\r
 145       closezip(zipfile);\r
 146       return NULL;\r
 147     }\r
 148   }\r
 149   else if (strcasecmp(ext, "cso") == 0)\r
 150   {\r
 151     cso_struct *cso = NULL, *tmp = NULL;\r
 152     int size;\r
 153     f = fopen(path, "rb");\r
 154     if (f == NULL)\r
 155       goto cso_failed;\r
 156 \r
 157 #ifndef __EPOC32__\r
 158     /* we use our own buffering */\r
 159     setvbuf(f, NULL, _IONBF, 0);\r
 160 #endif\r
 161 \r
 162     cso = malloc(sizeof(*cso));\r
 163     if (cso == NULL)\r
 164       goto cso_failed;\r
 165 \r
 166     if (fread(&cso->header, 1, sizeof(cso->header), f) != sizeof(cso->header))\r
 167       goto cso_failed;\r
 168 \r
 169     if (strncmp(cso->header.magic, "CISO", 4) != 0) {\r
 170       elprintf(EL_STATUS, "cso: bad header");\r
 171       goto cso_failed;\r
 172     }\r
 173 \r
 174     if (cso->header.block_size != 2048) {\r
 175       elprintf(EL_STATUS, "cso: bad block size (%u)", cso->header.block_size);\r
 176       goto cso_failed;\r
 177     }\r
 178 \r
 179     size = ((cso->header.total_bytes >> 11) + 1)*4 + sizeof(*cso);\r
 180     tmp = realloc(cso, size);\r
 181     if (tmp == NULL)\r
 182       goto cso_failed;\r
 183     cso = tmp;\r
 184     elprintf(EL_STATUS, "allocated %i bytes for CSO struct", size);\r
 185 \r
 186     size -= sizeof(*cso); // index size\r
 187     if (fread(cso->index, 1, size, f) != size) {\r
 188       elprintf(EL_STATUS, "cso: premature EOF");\r
 189       goto cso_failed;\r
 190     }\r
 191 \r
 192     // all ok\r
 193     cso->fpos_in = ftell(f);\r
 194     cso->fpos_out = 0;\r
 195     cso->block_in_buff = -1;\r
 196     file = calloc(1, sizeof(*file));\r
 197     if (file == NULL) goto cso_failed;\r
 198     file->file  = f;\r
 199     file->param = cso;\r
 200     file->size  = cso->header.total_bytes;\r
 201     file->type  = PMT_CSO;\r
 202     return file;\r
 203 \r
 204 cso_failed:\r
 205     if (cso != NULL) free(cso);\r
 206     if (f != NULL) fclose(f);\r
 207     return NULL;\r
 208   }\r
 209 \r
 210   /* not a zip, treat as uncompressed file */\r
 211   f = fopen(path, "rb");\r
 212   if (f == NULL) return NULL;\r
 213 \r
 214   file = calloc(1, sizeof(*file));\r
 215   if (file == NULL) {\r
 216     fclose(f);\r
 217     return NULL;\r
 218   }\r
 219   fseek(f, 0, SEEK_END);\r
 220   file->file  = f;\r
 221   file->param = NULL;\r
 222   file->size  = ftell(f);\r
 223   file->type  = PMT_UNCOMPRESSED;\r
 224   strncpy(file->ext, ext, sizeof(file->ext) - 1);\r
 225   fseek(f, 0, SEEK_SET);\r
 226 \r
 227 #ifndef __EPOC32__ // makes things worse on Symbian\r
 228   if (file->size > 0x400000)\r
 229     /* we use our own buffering */\r
 230     setvbuf(f, NULL, _IONBF, 0);\r
 231 #endif\r
 232 \r
 233   return file;\r
 234 }\r
 235 \r
 236 size_t pm_read(void *ptr, size_t bytes, pm_file *stream)\r
 237 {\r
 238   int ret;\r
 239 \r
 240   if (stream->type == PMT_UNCOMPRESSED)\r
 241   {\r
 242     ret = fread(ptr, 1, bytes, stream->file);\r
 243   }\r
 244   else if (stream->type == PMT_ZIP)\r
 245   {\r
 246     gzFile gf = stream->param;\r
 247     int err;\r
 248     ret = gzread(gf, ptr, bytes);\r
 249     err = gzerror2(gf);\r
 250     if (ret > 0 && (err == Z_DATA_ERROR || err == Z_STREAM_END))\r
 251       /* we must reset stream pointer or else next seek/read fails */\r
 252       gzrewind(gf);\r
 253   }\r
 254   else if (stream->type == PMT_CSO)\r
 255   {\r
 256     cso_struct *cso = stream->param;\r
 257     int read_pos, read_len, out_offs, rret;\r
 258     int block = cso->fpos_out >> 11;\r
 259     int index = cso->index[block];\r
 260     int index_end = cso->index[block+1];\r
 261     unsigned char *out = ptr, *tmp_dst;\r
 262 \r
 263     ret = 0;\r
 264     while (bytes != 0)\r
 265     {\r
 266       out_offs = cso->fpos_out&0x7ff;\r
 267       if (out_offs == 0 && bytes >= 2048)\r
 268            tmp_dst = out;\r
 269       else tmp_dst = cso->out_buff;\r
 270 \r
 271       read_pos = (index&0x7fffffff) << cso->header.align;\r
 272 \r
 273       if (index < 0) {\r
 274         if (read_pos != cso->fpos_in)\r
 275           fseek(stream->file, read_pos, SEEK_SET);\r
 276         rret = fread(tmp_dst, 1, 2048, stream->file);\r
 277         cso->fpos_in = read_pos + rret;\r
 278         if (rret != 2048) break;\r
 279       } else {\r
 280         read_len = (((index_end&0x7fffffff) << cso->header.align) - read_pos) & 0xfff;\r
 281         if (block != cso->block_in_buff)\r
 282         {\r
 283           if (read_pos != cso->fpos_in)\r
 284             fseek(stream->file, read_pos, SEEK_SET);\r
 285           rret = fread(cso->in_buff, 1, read_len, stream->file);\r
 286           cso->fpos_in = read_pos + rret;\r
 287           if (rret != read_len) {\r
 288             elprintf(EL_STATUS, "cso: read failed @ %08x", read_pos);\r
 289             break;\r
 290           }\r
 291           cso->block_in_buff = block;\r
 292         }\r
 293         rret = uncompress2(tmp_dst, 2048, cso->in_buff, read_len);\r
 294         if (rret != 0) {\r
 295           elprintf(EL_STATUS, "cso: uncompress failed @ %08x with %i", read_pos, rret);\r
 296           break;\r
 297         }\r
 298       }\r
 299 \r
 300       rret = 2048;\r
 301       if (out_offs != 0 || bytes < 2048) {\r
 302         //elprintf(EL_STATUS, "cso: unaligned/nonfull @ %08x, offs=%i, len=%u", cso->fpos_out, out_offs, bytes);\r
 303         if (bytes < rret) rret = bytes;\r
 304         if (2048 - out_offs < rret) rret = 2048 - out_offs;\r
 305         memcpy(out, tmp_dst + out_offs, rret);\r
 306       }\r
 307       ret += rret;\r
 308       out += rret;\r
 309       cso->fpos_out += rret;\r
 310       bytes -= rret;\r
 311       block++;\r
 312       index = index_end;\r
 313       index_end = cso->index[block+1];\r
 314     }\r
 315   }\r
 316   else\r
 317     ret = 0;\r
 318 \r
 319   return ret;\r
 320 }\r
 321 \r
 322 int pm_seek(pm_file *stream, long offset, int whence)\r
 323 {\r
 324   if (stream->type == PMT_UNCOMPRESSED)\r
 325   {\r
 326     fseek(stream->file, offset, whence);\r
 327     return ftell(stream->file);\r
 328   }\r
 329   else if (stream->type == PMT_ZIP)\r
 330   {\r
 331     if (PicoMessage != NULL && offset > 6*1024*1024) {\r
 332       long pos = gztell((gzFile) stream->param);\r
 333       if (offset < pos || offset - pos > 6*1024*1024)\r
 334         PicoMessage("Decompressing data...");\r
 335     }\r
 336     return gzseek((gzFile) stream->param, offset, whence);\r
 337   }\r
 338   else if (stream->type == PMT_CSO)\r
 339   {\r
 340     cso_struct *cso = stream->param;\r
 341     switch (whence)\r
 342     {\r
 343       case SEEK_CUR: cso->fpos_out += offset; break;\r
 344       case SEEK_SET: cso->fpos_out  = offset; break;\r
 345       case SEEK_END: cso->fpos_out  = cso->header.total_bytes - offset; break;\r
 346     }\r
 347     return cso->fpos_out;\r
 348   }\r
 349   else\r
 350     return -1;\r
 351 }\r
 352 \r
 353 int pm_close(pm_file *fp)\r
 354 {\r
 355   int ret = 0;\r
 356 \r
 357   if (fp == NULL) return EOF;\r
 358 \r
 359   if (fp->type == PMT_UNCOMPRESSED)\r
 360   {\r
 361     fclose(fp->file);\r
 362   }\r
 363   else if (fp->type == PMT_ZIP)\r
 364   {\r
 365     ZIP *zipfile = fp->file;\r
 366     gzclose((gzFile) fp->param);\r
 367     zipfile->fp = NULL; // gzclose() closed it\r
 368     closezip(zipfile);\r
 369   }\r
 370   else if (fp->type == PMT_CSO)\r
 371   {\r
 372     free(fp->param);\r
 373     fclose(fp->file);\r
 374   }\r
 375   else\r
 376     ret = EOF;\r
 377 \r
 378   free(fp);\r
 379   return ret;\r
 380 }\r
 381 \r
 382 // byteswap, data needs to be int aligned, src can match dst\r
 383 void Byteswap(void *dst, const void *src, int len)\r
 384 {\r
 385   const unsigned int *ps = src;\r
 386   unsigned int *pd = dst;\r
 387   int i, m;\r
 388 \r
 389   if (len < 2)\r
 390     return;\r
 391 \r
 392   m = 0x00ff00ff;\r
 393   for (i = 0; i < len / 4; i++) {\r
 394     unsigned int t = ps[i];\r
 395     pd[i] = ((t & m) << 8) | ((t & ~m) >> 8);\r
 396   }\r
 397 }\r
 398 \r
 399 // Interleve a 16k block and byteswap\r
 400 static int InterleveBlock(unsigned char *dest,unsigned char *src)\r
 401 {\r
 402   int i=0;\r
 403   for (i=0;i<0x2000;i++) dest[(i<<1)  ]=src[       i]; // Odd\r
 404   for (i=0;i<0x2000;i++) dest[(i<<1)+1]=src[0x2000+i]; // Even\r
 405   return 0;\r
 406 }\r
 407 \r
 408 // Decode a SMD file\r
 409 static int DecodeSmd(unsigned char *data,int len)\r
 410 {\r
 411   unsigned char *temp=NULL;\r
 412   int i=0;\r
 413 \r
 414   temp=(unsigned char *)malloc(0x4000);\r
 415   if (temp==NULL) return 1;\r
 416   memset(temp,0,0x4000);\r
 417 \r
 418   // Interleve each 16k block and shift down by 0x200:\r
 419   for (i=0; i+0x4200<=len; i+=0x4000)\r
 420   {\r
 421     InterleveBlock(temp,data+0x200+i); // Interleve 16k to temporary buffer\r
 422     memcpy(data+i,temp,0x4000); // Copy back in\r
 423   }\r
 424 \r
 425   free(temp);\r
 426   return 0;\r
 427 }\r
 428 \r
 429 static unsigned char *PicoCartAlloc(int filesize, int is_sms)\r
 430 {\r
 431   unsigned char *rom;\r
 432 \r
 433   if (is_sms) {\r
 434     // make size power of 2 for easier banking handling\r
 435     int s = 0, tmp = filesize;\r
 436     while ((tmp >>= 1) != 0)\r
 437       s++;\r
 438     if (filesize > (1 << s))\r
 439       s++;\r
 440     rom_alloc_size = 1 << s;\r
 441   }\r
 442   else {\r
 443     // make alloc size at least sizeof(mcd_state),\r
 444     // in case we want to switch to CD mode\r
 445     if (filesize < sizeof(mcd_state))\r
 446       filesize = sizeof(mcd_state);\r
 447 \r
 448     // align to 512K for memhandlers\r
 449     rom_alloc_size = (filesize + 0x7ffff) & ~0x7ffff;\r
 450   }\r
 451 \r
 452   if (rom_alloc_size - filesize < 4)\r
 453     rom_alloc_size += 4; // padding for out-of-bound exec protection\r
 454 \r
 455   // Allocate space for the rom plus padding\r
 456   // use special address for 32x dynarec\r
 457   rom = plat_mmap(0x02000000, rom_alloc_size);\r
 458   return rom;\r
 459 }\r
 460 \r
 461 int PicoCartLoad(pm_file *f,unsigned char **prom,unsigned int *psize,int is_sms)\r
 462 {\r
 463   unsigned char *rom;\r
 464   int size, bytes_read;\r
 465 \r
 466   if (f == NULL)\r
 467     return 1;\r
 468 \r
 469   size = f->size;\r
 470   if (size <= 0) return 1;\r
 471   size = (size+3)&~3; // Round up to a multiple of 4\r
 472 \r
 473   // Allocate space for the rom plus padding\r
 474   rom = PicoCartAlloc(size, is_sms);\r
 475   if (rom == NULL) {\r
 476     elprintf(EL_STATUS, "out of memory (wanted %i)", size);\r
 477     return 2;\r
 478   }\r
 479 \r
 480   if (PicoCartLoadProgressCB != NULL)\r
 481   {\r
 482     // read ROM in blocks, just for fun\r
 483     int ret;\r
 484     unsigned char *p = rom;\r
 485     bytes_read=0;\r
 486     do\r
 487     {\r
 488       int todo = size - bytes_read;\r
 489       if (todo > 256*1024) todo = 256*1024;\r
 490       ret = pm_read(p,todo,f);\r
 491       bytes_read += ret;\r
 492       p += ret;\r
 493       PicoCartLoadProgressCB(bytes_read * 100 / size);\r
 494     }\r
 495     while (ret > 0);\r
 496   }\r
 497   else\r
 498     bytes_read = pm_read(rom,size,f); // Load up the rom\r
 499   if (bytes_read <= 0) {\r
 500     elprintf(EL_STATUS, "read failed");\r
 501     free(rom);\r
 502     return 3;\r
 503   }\r
 504 \r
 505   if (!is_sms)\r
 506   {\r
 507     // maybe we are loading MegaCD BIOS?\r
 508     if (!(PicoAHW & PAHW_MCD) && size == 0x20000 && (!strncmp((char *)rom+0x124, "BOOT", 4) ||\r
 509          !strncmp((char *)rom+0x128, "BOOT", 4))) {\r
 510       PicoAHW |= PAHW_MCD;\r
 511     }\r
 512 \r
 513     // Check for SMD:\r
 514     if (size >= 0x4200 && (size&0x3fff) == 0x200 &&\r
 515         ((rom[0x2280] == 'S' && rom[0x280] == 'E') || (rom[0x280] == 'S' && rom[0x2281] == 'E'))) {\r
 516       elprintf(EL_STATUS, "SMD format detected.");\r
 517       DecodeSmd(rom,size); size-=0x200; // Decode and byteswap SMD\r
 518     }\r
 519     else Byteswap(rom, rom, size); // Just byteswap\r
 520   }\r
 521   else\r
 522   {\r
 523     if (size >= 0x4200 && (size&0x3fff) == 0x200) {\r
 524       elprintf(EL_STATUS, "SMD format detected.");\r
 525       // at least here it's not interleaved\r
 526       size -= 0x200;\r
 527       memmove(rom, rom + 0x200, size);\r
 528     }\r
 529   }\r
 530 \r
 531   if (prom)  *prom = rom;\r
 532   if (psize) *psize = size;\r
 533 \r
 534   return 0;\r
 535 }\r
 536 \r
 537 // Insert a cartridge:\r
 538 int PicoCartInsert(unsigned char *rom, unsigned int romsize, const char *carthw_cfg)\r
 539 {\r
 540   // notaz: add a 68k "jump one op back" opcode to the end of ROM.\r
 541   // This will hang the emu, but will prevent nasty crashes.\r
 542   // note: 4 bytes are padded to every ROM\r
 543   if (rom != NULL)\r
 544     *(unsigned long *)(rom+romsize) = 0xFFFE4EFA; // 4EFA FFFE byteswapped\r
 545 \r
 546   Pico.rom=rom;\r
 547   Pico.romsize=romsize;\r
 548 \r
 549   if (SRam.data) {\r
 550     free(SRam.data);\r
 551     SRam.data = NULL;\r
 552   }\r
 553 \r
 554   if (PicoCartUnloadHook != NULL) {\r
 555     PicoCartUnloadHook();\r
 556     PicoCartUnloadHook = NULL;\r
 557   }\r
 558 \r
 559   PicoAHW &= PAHW_MCD|PAHW_SMS;\r
 560 \r
 561   PicoCartMemSetup = NULL;\r
 562   PicoDmaHook = NULL;\r
 563   PicoResetHook = NULL;\r
 564   PicoLineHook = NULL;\r
 565   PicoLoadStateHook = NULL;\r
 566   carthw_chunks = NULL;\r
 567 \r
 568   if (!(PicoAHW & (PAHW_MCD|PAHW_SMS)))\r
 569     PicoCartDetect(carthw_cfg);\r
 570 \r
 571   // setup correct memory map for loaded ROM\r
 572   switch (PicoAHW) {\r
 573     default:\r
 574       elprintf(EL_STATUS|EL_ANOMALY, "starting in unknown hw configuration: %x", PicoAHW);\r
 575     case 0:\r
 576     case PAHW_SVP:  PicoMemSetup(); break;\r
 577     case PAHW_MCD:  PicoMemSetupCD(); break;\r
 578     case PAHW_PICO: PicoMemSetupPico(); break;\r
 579     case PAHW_SMS:  PicoMemSetupMS(); break;\r
 580   }\r
 581 \r
 582   if (PicoCartMemSetup != NULL)\r
 583     PicoCartMemSetup();\r
 584 \r
 585   if (PicoAHW & PAHW_SMS)\r
 586     PicoPowerMS();\r
 587   else\r
 588     PicoPower();\r
 589 \r
 590   return 0;\r
 591 }\r
 592 \r
 593 void PicoCartUnload(void)\r
 594 {\r
 595   if (PicoCartUnloadHook != NULL) {\r
 596     PicoCartUnloadHook();\r
 597     PicoCartUnloadHook = NULL;\r
 598   }\r
 599 \r
 600   if (PicoAHW & PAHW_32X)\r
 601     PicoUnload32x();\r
 602 \r
 603   if (Pico.rom != NULL) {\r
 604     SekFinishIdleDet();\r
 605     plat_munmap(Pico.rom, rom_alloc_size);\r
 606     Pico.rom = NULL;\r
 607   }\r
 608 }\r
 609 \r
 610 static unsigned int rom_crc32(void)\r
 611 {\r
 612   unsigned int crc;\r
 613   elprintf(EL_STATUS, "caclulating CRC32..");\r
 614 \r
 615   // have to unbyteswap for calculation..\r
 616   Byteswap(Pico.rom, Pico.rom, Pico.romsize);\r
 617   crc = crc32(0, Pico.rom, Pico.romsize);\r
 618   Byteswap(Pico.rom, Pico.rom, Pico.romsize);\r
 619   return crc;\r
 620 }\r
 621 \r
 622 static int rom_strcmp(int rom_offset, const char *s1)\r
 623 {\r
 624   int i, len = strlen(s1);\r
 625   const char *s_rom = (const char *)Pico.rom;\r
 626   for (i = 0; i < len; i++)\r
 627     if (s1[i] != s_rom[(i + rom_offset) ^ 1])\r
 628       return 1;\r
 629   return 0;\r
 630 }\r
 631 \r
 632 static unsigned int rom_read32(int addr)\r
 633 {\r
 634   unsigned short *m = (unsigned short *)(Pico.rom + addr);\r
 635   return (m[0] << 16) | m[1];\r
 636 }\r
 637 \r
 638 static char *sskip(char *s)\r
 639 {\r
 640   while (*s && isspace_(*s))\r
 641     s++;\r
 642   return s;\r
 643 }\r
 644 \r
 645 static void rstrip(char *s)\r
 646 {\r
 647   char *p;\r
 648   for (p = s + strlen(s) - 1; p >= s; p--)\r
 649     if (isspace_(*p))\r
 650       *p = 0;\r
 651 }\r
 652 \r
 653 static int parse_3_vals(char *p, int *val0, int *val1, int *val2)\r
 654 {\r
 655   char *r;\r
 656   *val0 = strtoul(p, &r, 0);\r
 657   if (r == p)\r
 658     goto bad;\r
 659   p = sskip(r);\r
 660   if (*p++ != ',')\r
 661     goto bad;\r
 662   *val1 = strtoul(p, &r, 0);\r
 663   if (r == p)\r
 664     goto bad;\r
 665   p = sskip(r);\r
 666   if (*p++ != ',')\r
 667     goto bad;\r
 668   *val2 = strtoul(p, &r, 0);\r
 669   if (r == p)\r
 670     goto bad;\r
 671 \r
 672   return 1;\r
 673 bad:\r
 674   return 0;\r
 675 }\r
 676 \r
 677 static int is_expr(const char *expr, char **pr)\r
 678 {\r
 679   int len = strlen(expr);\r
 680   char *p = *pr;\r
 681 \r
 682   if (strncmp(expr, p, len) != 0)\r
 683     return 0;\r
 684   p = sskip(p + len);\r
 685   if (*p != '=')\r
 686     return 0; // wrong or malformed\r
 687 \r
 688   *pr = sskip(p + 1);\r
 689   return 1;\r
 690 }\r
 691 \r
 692 static void parse_carthw(const char *carthw_cfg, int *fill_sram)\r
 693 {\r
 694   int line = 0, any_checks_passed = 0, skip_sect = 0;\r
 695   int tmp, rom_crc = 0;\r
 696   char buff[256], *p, *r;\r
 697   FILE *f;\r
 698 \r
 699   f = fopen(carthw_cfg, "r");\r
 700   if (f == NULL) {\r
 701     elprintf(EL_STATUS, "couldn't open carthw.cfg!");\r
 702     return;\r
 703   }\r
 704 \r
 705   while ((p = fgets(buff, sizeof(buff), f)))\r
 706   {\r
 707     line++;\r
 708     p = sskip(p);\r
 709     if (*p == 0 || *p == '#')\r
 710       continue;\r
 711 \r
 712     if (*p == '[') {\r
 713       any_checks_passed = 0;\r
 714       skip_sect = 0;\r
 715       continue;\r
 716     }\r
 717     \r
 718     if (skip_sect)\r
 719       continue;\r
 720 \r
 721     /* look for checks */\r
 722     if (is_expr("check_str", &p))\r
 723     {\r
 724       int offs;\r
 725       offs = strtoul(p, &r, 0);\r
 726       if (offs < 0 || offs > Pico.romsize) {\r
 727         elprintf(EL_STATUS, "carthw:%d: check_str offs out of range: %d\n", line, offs);\r
 728         goto bad;\r
 729       }\r
 730       p = sskip(r);\r
 731       if (*p != ',')\r
 732         goto bad;\r
 733       p = sskip(p + 1);\r
 734       if (*p != '"')\r
 735         goto bad;\r
 736       p++;\r
 737       r = strchr(p, '"');\r
 738       if (r == NULL)\r
 739         goto bad;\r
 740       *r = 0;\r
 741 \r
 742       if (rom_strcmp(offs, p) == 0)\r
 743         any_checks_passed = 1;\r
 744       else\r
 745         skip_sect = 1;\r
 746       continue;\r
 747     }\r
 748     else if (is_expr("check_size_gt", &p))\r
 749     {\r
 750       int size;\r
 751       size = strtoul(p, &r, 0);\r
 752       if (r == p || size < 0)\r
 753         goto bad;\r
 754 \r
 755       if (Pico.romsize > size)\r
 756         any_checks_passed = 1;\r
 757       else\r
 758         skip_sect = 1;\r
 759       continue;\r
 760     }\r
 761     else if (is_expr("check_csum", &p))\r
 762     {\r
 763       int csum;\r
 764       csum = strtoul(p, &r, 0);\r
 765       if (r == p || (csum & 0xffff0000))\r
 766         goto bad;\r
 767 \r
 768       if (csum == (rom_read32(0x18c) & 0xffff))\r
 769         any_checks_passed = 1;\r
 770       else\r
 771         skip_sect = 1;\r
 772       continue;\r
 773     }\r
 774     else if (is_expr("check_crc32", &p))\r
 775     {\r
 776       unsigned int crc;\r
 777       crc = strtoul(p, &r, 0);\r
 778       if (r == p)\r
 779         goto bad;\r
 780 \r
 781       if (rom_crc == 0)\r
 782         rom_crc = rom_crc32();\r
 783       if (crc == rom_crc)\r
 784         any_checks_passed = 1;\r
 785       else\r
 786         skip_sect = 1;\r
 787       continue;\r
 788     }\r
 789 \r
 790     /* now time for actions */\r
 791     if (is_expr("hw", &p)) {\r
 792       if (!any_checks_passed)\r
 793         goto no_checks;\r
 794       rstrip(p);\r
 795 \r
 796       if      (strcmp(p, "svp") == 0)\r
 797         PicoSVPStartup();\r
 798       else if (strcmp(p, "pico") == 0)\r
 799         PicoInitPico();\r
 800       else if (strcmp(p, "prot") == 0)\r
 801         carthw_sprot_startup();\r
 802       else if (strcmp(p, "ssf2_mapper") == 0)\r
 803         carthw_ssf2_startup();\r
 804       else if (strcmp(p, "x_in_1_mapper") == 0)\r
 805         carthw_Xin1_startup();\r
 806       else if (strcmp(p, "realtec_mapper") == 0)\r
 807         carthw_realtec_startup();\r
 808       else if (strcmp(p, "radica_mapper") == 0)\r
 809         carthw_radica_startup();\r
 810       else if (strcmp(p, "prot_lk3") == 0)\r
 811         carthw_prot_lk3_startup();\r
 812       else {\r
 813         elprintf(EL_STATUS, "carthw:%d: unsupported mapper: %s", line, p);\r
 814         skip_sect = 1;\r
 815       }\r
 816       continue;\r
 817     }\r
 818     if (is_expr("sram_range", &p)) {\r
 819       int start, end;\r
 820 \r
 821       if (!any_checks_passed)\r
 822         goto no_checks;\r
 823       rstrip(p);\r
 824 \r
 825       start = strtoul(p, &r, 0);\r
 826       if (r == p)\r
 827         goto bad;\r
 828       p = sskip(r);\r
 829       if (*p != ',')\r
 830         goto bad;\r
 831       p = sskip(p + 1);\r
 832       end = strtoul(p, &r, 0);\r
 833       if (r == p)\r
 834         goto bad;\r
 835       if (((start | end) & 0xff000000) || start > end) {\r
 836         elprintf(EL_STATUS, "carthw:%d: bad sram_range: %08x - %08x", line, start, end);\r
 837         goto bad_nomsg;\r
 838       }\r
 839       SRam.start = start;\r
 840       SRam.end = end;\r
 841       continue;\r
 842     }\r
 843     else if (is_expr("prop", &p)) {\r
 844       if (!any_checks_passed)\r
 845         goto no_checks;\r
 846       rstrip(p);\r
 847 \r
 848       if      (strcmp(p, "no_sram") == 0)\r
 849         SRam.flags &= ~SRF_ENABLED;\r
 850       else if (strcmp(p, "no_eeprom") == 0)\r
 851         SRam.flags &= ~SRF_EEPROM;\r
 852       else if (strcmp(p, "filled_sram") == 0)\r
 853         *fill_sram = 1;\r
 854       else {\r
 855         elprintf(EL_STATUS, "carthw:%d: unsupported prop: %s", line, p);\r
 856         goto bad_nomsg;\r
 857       }\r
 858       continue;\r
 859     }\r
 860     else if (is_expr("eeprom_type", &p)) {\r
 861       int type;\r
 862       if (!any_checks_passed)\r
 863         goto no_checks;\r
 864       rstrip(p);\r
 865 \r
 866       type = strtoul(p, &r, 0);\r
 867       if (r == p || type < 0)\r
 868         goto bad;\r
 869       SRam.eeprom_type = type;\r
 870       SRam.flags |= SRF_EEPROM;\r
 871       continue;\r
 872     }\r
 873     else if (is_expr("eeprom_lines", &p)) {\r
 874       int scl, sda_in, sda_out;\r
 875       if (!any_checks_passed)\r
 876         goto no_checks;\r
 877       rstrip(p);\r
 878 \r
 879       if (!parse_3_vals(p, &scl, &sda_in, &sda_out))\r
 880         goto bad;\r
 881       if (scl < 0 || scl > 15 || sda_in < 0 || sda_in > 15 ||\r
 882           sda_out < 0 || sda_out > 15)\r
 883         goto bad;\r
 884 \r
 885       SRam.eeprom_bit_cl = scl;\r
 886       SRam.eeprom_bit_in = sda_in;\r
 887       SRam.eeprom_bit_out= sda_out;\r
 888       continue;\r
 889     }\r
 890     else if ((tmp = is_expr("prot_ro_value16", &p)) || is_expr("prot_rw_value16", &p)) {\r
 891       int addr, mask, val;\r
 892       if (!any_checks_passed)\r
 893         goto no_checks;\r
 894       rstrip(p);\r
 895 \r
 896       if (!parse_3_vals(p, &addr, &mask, &val))\r
 897         goto bad;\r
 898 \r
 899       carthw_sprot_new_location(addr, mask, val, tmp ? 1 : 0);\r
 900       continue;\r
 901     }\r
 902 \r
 903 \r
 904 bad:\r
 905     elprintf(EL_STATUS, "carthw:%d: unrecognized expression: %s", line, buff);\r
 906 bad_nomsg:\r
 907     skip_sect = 1;\r
 908     continue;\r
 909 \r
 910 no_checks:\r
 911     elprintf(EL_STATUS, "carthw:%d: command without any checks before it: %s", line, buff);\r
 912     skip_sect = 1;\r
 913     continue;\r
 914   }\r
 915   fclose(f);\r
 916 }\r
 917 \r
 918 /*\r
 919  * various cart-specific things, which can't be handled by generic code\r
 920  */\r
 921 static void PicoCartDetect(const char *carthw_cfg)\r
 922 {\r
 923   int fill_sram = 0;\r
 924 \r
 925   memset(&SRam, 0, sizeof(SRam));\r
 926   if (Pico.rom[0x1B1] == 'R' && Pico.rom[0x1B0] == 'A')\r
 927   {\r
 928     SRam.start =  rom_read32(0x1B4) & ~0xff000001; // align\r
 929     SRam.end   = (rom_read32(0x1B8) & ~0xff000000) | 1;\r
 930     if (Pico.rom[0x1B2] & 0x40)\r
 931       // EEPROM\r
 932       SRam.flags |= SRF_EEPROM;\r
 933     SRam.flags |= SRF_ENABLED;\r
 934   }\r
 935   if (SRam.end == 0 || SRam.start > SRam.end)\r
 936   {\r
 937     // some games may have bad headers, like S&K and Sonic3\r
 938     // note: majority games use 0x200000 as starting address, but there are some which\r
 939     // use something else (0x300000 by HardBall '95). Luckily they have good headers.\r
 940     SRam.start = 0x200000;\r
 941     SRam.end   = 0x203FFF;\r
 942     SRam.flags |= SRF_ENABLED;\r
 943   }\r
 944 \r
 945   // set EEPROM defaults, in case it gets detected\r
 946   SRam.eeprom_type   = 0; // 7bit (24C01)\r
 947   SRam.eeprom_bit_cl = 1;\r
 948   SRam.eeprom_bit_in = 0;\r
 949   SRam.eeprom_bit_out= 0;\r
 950 \r
 951   if (carthw_cfg != NULL)\r
 952     parse_carthw(carthw_cfg, &fill_sram);\r
 953 \r
 954   if (SRam.flags & SRF_ENABLED)\r
 955   {\r
 956     if (SRam.flags & SRF_EEPROM)\r
 957       SRam.size = 0x2000;\r
 958     else\r
 959       SRam.size = SRam.end - SRam.start + 1;\r
 960 \r
 961     SRam.data = calloc(SRam.size, 1);\r
 962     if (SRam.data == NULL)\r
 963       SRam.flags &= ~SRF_ENABLED;\r
 964 \r
 965     if (SRam.eeprom_type == 1)  // 1 == 0 in PD EEPROM code\r
 966       SRam.eeprom_type = 0;\r
 967   }\r
 968 \r
 969   if ((SRam.flags & SRF_ENABLED) && fill_sram)\r
 970   {\r
 971     elprintf(EL_STATUS, "SRAM fill");\r
 972     memset(SRam.data, 0xff, SRam.size);\r
 973   }\r
 974 \r
 975   // Unusual region 'code'\r
 976   if (rom_strcmp(0x1f0, "EUROPE") == 0 || rom_strcmp(0x1f0, "Europe") == 0)\r
 977     *(int *) (Pico.rom + 0x1f0) = 0x20204520;\r
 978 }\r
 979 \r