32x: implement standard/ssf2 mapper

[picodrive.git] / pico / cart.c

/*\r
 * PicoDrive\r
 * (c) Copyright Dave, 2004\r
 * (C) notaz, 2006-2010\r
 *\r
 * This work is licensed under the terms of MAME license.\r
 * See COPYING file in the top-level directory.\r
 */\r
\r
#include "pico_int.h"\r
#include "../cpu/debug.h"\r
#include "../unzip/unzip.h"\r
#include <zlib.h>\r
\r
\r
static int rom_alloc_size;\r
static const char *rom_exts[] = { "bin", "gen", "smd", "iso", "sms", "gg", "sg" };\r
\r
void (*PicoCartUnloadHook)(void);\r
void (*PicoCartMemSetup)(void);\r
\r
void (*PicoCartLoadProgressCB)(int percent) = NULL;\r
void (*PicoCDLoadProgressCB)(const char *fname, int percent) = NULL; // handled in Pico/cd/cd_file.c\r
\r
int PicoGameLoaded;\r
\r
static void PicoCartDetect(const char *carthw_cfg);\r
\r
/* cso struct */\r
typedef struct _cso_struct\r
{\r
  unsigned char in_buff[2*2048];\r
  unsigned char out_buff[2048];\r
  struct {\r
    char          magic[4];\r
    unsigned int  unused;\r
    unsigned int  total_bytes;\r
    unsigned int  total_bytes_high; // ignored here\r
    unsigned int  block_size;  // 10h\r
    unsigned char ver;\r
    unsigned char align;\r
    unsigned char reserved[2];\r
  } header;\r
  unsigned int  fpos_in;  // input file read pointer\r
  unsigned int  fpos_out; // pos in virtual decompressed file\r
  int block_in_buff;      // block which we have read in in_buff\r
  int pad;\r
  int index[0];\r
}\r
cso_struct;\r
\r
static int uncompress_buf(void *dest, int destLen, void *source, int sourceLen)\r
{\r
    z_stream stream;\r
    int err;\r
\r
    stream.next_in = (Bytef*)source;\r
    stream.avail_in = (uInt)sourceLen;\r
    stream.next_out = dest;\r
    stream.avail_out = (uInt)destLen;\r
\r
    stream.zalloc = NULL;\r
    stream.zfree = NULL;\r
\r
    err = inflateInit2(&stream, -15);\r
    if (err != Z_OK) return err;\r
\r
    err = inflate(&stream, Z_FINISH);\r
    if (err != Z_STREAM_END) {\r
        inflateEnd(&stream);\r
        return err;\r
    }\r
    //*destLen = stream.total_out;\r
\r
    return inflateEnd(&stream);\r
}\r
\r
static const char *get_ext(const char *path)\r
{\r
  const char *ext;\r
  if (strlen(path) < 4)\r
    return ""; // no ext\r
\r
  // allow 2 or 3 char extensions for now\r
  ext = path + strlen(path) - 2;\r
  if (ext[-1] != '.') ext--;\r
  if (ext[-1] != '.')\r
    return "";\r
  return ext;\r
}\r
\r
struct zip_file {\r
  pm_file file;\r
  ZIP *zip;\r
  struct zipent *entry;\r
  z_stream stream;\r
  unsigned char inbuf[16384];\r
  long start;\r
  unsigned int pos;\r
};\r
\r
pm_file *pm_open(const char *path)\r
{\r
  pm_file *file = NULL;\r
  const char *ext;\r
  FILE *f;\r
\r
  if (path == NULL)\r
    return NULL;\r
\r
  ext = get_ext(path);\r
  if (strcasecmp(ext, "zip") == 0)\r
  {\r
    struct zip_file *zfile = NULL;\r
    struct zipent *zipentry;\r
    ZIP *zipfile;\r
    int i, ret;\r
\r
    zipfile = openzip(path);\r
    if (zipfile != NULL)\r
    {\r
      /* search for suitable file (right extension or large enough file) */\r
      while ((zipentry = readzip(zipfile)) != NULL)\r
      {\r
        ext = get_ext(zipentry->name);\r
\r
        if (zipentry->uncompressed_size >= 32*1024)\r
          goto found_rom_zip;\r
\r
        for (i = 0; i < sizeof(rom_exts)/sizeof(rom_exts[0]); i++)\r
          if (strcasecmp(ext, rom_exts[i]) == 0)\r
            goto found_rom_zip;\r
      }\r
\r
      /* zipfile given, but nothing found suitable for us inside */\r
      goto zip_failed;\r
\r
found_rom_zip:\r
      zfile = calloc(1, sizeof(*zfile));\r
      if (zfile == NULL)\r
        goto zip_failed;\r
      ret = seekcompresszip(zipfile, zipentry);\r
      if (ret != 0)\r
        goto zip_failed;\r
      ret = inflateInit2(&zfile->stream, -15);\r
      if (ret != Z_OK) {\r
        elprintf(EL_STATUS, "zip: inflateInit2 %d", ret);\r
        goto zip_failed;\r
      }\r
      zfile->zip = zipfile;\r
      zfile->entry = zipentry;\r
      zfile->start = ftell(zipfile->fp);\r
      zfile->file.file = zfile;\r
      zfile->file.size = zipentry->uncompressed_size;\r
      zfile->file.type = PMT_ZIP;\r
      strncpy(zfile->file.ext, ext, sizeof(zfile->file.ext) - 1);\r
      return &zfile->file;\r
\r
zip_failed:\r
      closezip(zipfile);\r
      free(zfile);\r
      return NULL;\r
    }\r
  }\r
  else if (strcasecmp(ext, "cso") == 0)\r
  {\r
    cso_struct *cso = NULL, *tmp = NULL;\r
    int size;\r
    f = fopen(path, "rb");\r
    if (f == NULL)\r
      goto cso_failed;\r
\r
#ifdef __GP2X__\r
    /* we use our own buffering */\r
    setvbuf(f, NULL, _IONBF, 0);\r
#endif\r
\r
    cso = malloc(sizeof(*cso));\r
    if (cso == NULL)\r
      goto cso_failed;\r
\r
    if (fread(&cso->header, 1, sizeof(cso->header), f) != sizeof(cso->header))\r
      goto cso_failed;\r
\r
    if (strncmp(cso->header.magic, "CISO", 4) != 0) {\r
      elprintf(EL_STATUS, "cso: bad header");\r
      goto cso_failed;\r
    }\r
\r
    if (cso->header.block_size != 2048) {\r
      elprintf(EL_STATUS, "cso: bad block size (%u)", cso->header.block_size);\r
      goto cso_failed;\r
    }\r
\r
    size = ((cso->header.total_bytes >> 11) + 1)*4 + sizeof(*cso);\r
    tmp = realloc(cso, size);\r
    if (tmp == NULL)\r
      goto cso_failed;\r
    cso = tmp;\r
    elprintf(EL_STATUS, "allocated %i bytes for CSO struct", size);\r
\r
    size -= sizeof(*cso); // index size\r
    if (fread(cso->index, 1, size, f) != size) {\r
      elprintf(EL_STATUS, "cso: premature EOF");\r
      goto cso_failed;\r
    }\r
\r
    // all ok\r
    cso->fpos_in = ftell(f);\r
    cso->fpos_out = 0;\r
    cso->block_in_buff = -1;\r
    file = calloc(1, sizeof(*file));\r
    if (file == NULL) goto cso_failed;\r
    file->file  = f;\r
    file->param = cso;\r
    file->size  = cso->header.total_bytes;\r
    file->type  = PMT_CSO;\r
    return file;\r
\r
cso_failed:\r
    if (cso != NULL) free(cso);\r
    if (f != NULL) fclose(f);\r
    return NULL;\r
  }\r
\r
  /* not a zip, treat as uncompressed file */\r
  f = fopen(path, "rb");\r
  if (f == NULL) return NULL;\r
\r
  file = calloc(1, sizeof(*file));\r
  if (file == NULL) {\r
    fclose(f);\r
    return NULL;\r
  }\r
  fseek(f, 0, SEEK_END);\r
  file->file  = f;\r
  file->param = NULL;\r
  file->size  = ftell(f);\r
  file->type  = PMT_UNCOMPRESSED;\r
  strncpy(file->ext, ext, sizeof(file->ext) - 1);\r
  fseek(f, 0, SEEK_SET);\r
\r
#ifdef __GP2X__\r
  if (file->size > 0x400000)\r
    /* we use our own buffering */\r
    setvbuf(f, NULL, _IONBF, 0);\r
#endif\r
\r
  return file;\r
}\r
\r
size_t pm_read(void *ptr, size_t bytes, pm_file *stream)\r
{\r
  int ret;\r
\r
  if (stream->type == PMT_UNCOMPRESSED)\r
  {\r
    ret = fread(ptr, 1, bytes, stream->file);\r
  }\r
  else if (stream->type == PMT_ZIP)\r
  {\r
    struct zip_file *z = stream->file;\r
\r
    if (z->entry->compression_method == 0) {\r
      int ret = fread(ptr, 1, bytes, z->zip->fp);\r
      z->pos += ret;\r
      return ret;\r
    }\r
\r
    z->stream.next_out = ptr;\r
    z->stream.avail_out = bytes;\r
    while (z->stream.avail_out != 0) {\r
      if (z->stream.avail_in == 0) {\r
        z->stream.avail_in = fread(z->inbuf, 1, sizeof(z->inbuf), z->zip->fp);\r
        if (z->stream.avail_in == 0)\r
          break;\r
        z->stream.next_in = z->inbuf;\r
      }\r
      ret = inflate(&z->stream, Z_NO_FLUSH);\r
      if (ret == Z_STREAM_END)\r
        break;\r
      if (ret != Z_OK) {\r
        elprintf(EL_STATUS, "zip: inflate: %d", ret);\r
        return 0;\r
      }\r
    }\r
    z->pos += bytes - z->stream.avail_out;\r
    return bytes - z->stream.avail_out;\r
  }\r
  else if (stream->type == PMT_CSO)\r
  {\r
    cso_struct *cso = stream->param;\r
    int read_pos, read_len, out_offs, rret;\r
    int block = cso->fpos_out >> 11;\r
    int index = cso->index[block];\r
    int index_end = cso->index[block+1];\r
    unsigned char *out = ptr, *tmp_dst;\r
\r
    ret = 0;\r
    while (bytes != 0)\r
    {\r
      out_offs = cso->fpos_out&0x7ff;\r
      if (out_offs == 0 && bytes >= 2048)\r
           tmp_dst = out;\r
      else tmp_dst = cso->out_buff;\r
\r
      read_pos = (index&0x7fffffff) << cso->header.align;\r
\r
      if (index < 0) {\r
        if (read_pos != cso->fpos_in)\r
          fseek(stream->file, read_pos, SEEK_SET);\r
        rret = fread(tmp_dst, 1, 2048, stream->file);\r
        cso->fpos_in = read_pos + rret;\r
        if (rret != 2048) break;\r
      } else {\r
        read_len = (((index_end&0x7fffffff) << cso->header.align) - read_pos) & 0xfff;\r
        if (block != cso->block_in_buff)\r
        {\r
          if (read_pos != cso->fpos_in)\r
            fseek(stream->file, read_pos, SEEK_SET);\r
          rret = fread(cso->in_buff, 1, read_len, stream->file);\r
          cso->fpos_in = read_pos + rret;\r
          if (rret != read_len) {\r
            elprintf(EL_STATUS, "cso: read failed @ %08x", read_pos);\r
            break;\r
          }\r
          cso->block_in_buff = block;\r
        }\r
        rret = uncompress_buf(tmp_dst, 2048, cso->in_buff, read_len);\r
        if (rret != 0) {\r
          elprintf(EL_STATUS, "cso: uncompress failed @ %08x with %i", read_pos, rret);\r
          break;\r
        }\r
      }\r
\r
      rret = 2048;\r
      if (out_offs != 0 || bytes < 2048) {\r
        //elprintf(EL_STATUS, "cso: unaligned/nonfull @ %08x, offs=%i, len=%u", cso->fpos_out, out_offs, bytes);\r
        if (bytes < rret) rret = bytes;\r
        if (2048 - out_offs < rret) rret = 2048 - out_offs;\r
        memcpy(out, tmp_dst + out_offs, rret);\r
      }\r
      ret += rret;\r
      out += rret;\r
      cso->fpos_out += rret;\r
      bytes -= rret;\r
      block++;\r
      index = index_end;\r
      index_end = cso->index[block+1];\r
    }\r
  }\r
  else\r
    ret = 0;\r
\r
  return ret;\r
}\r
\r
int pm_seek(pm_file *stream, long offset, int whence)\r
{\r
  if (stream->type == PMT_UNCOMPRESSED)\r
  {\r
    fseek(stream->file, offset, whence);\r
    return ftell(stream->file);\r
  }\r
  else if (stream->type == PMT_ZIP)\r
  {\r
    struct zip_file *z = stream->file;\r
    unsigned int pos = z->pos;\r
    int ret;\r
\r
    switch (whence)\r
    {\r
      case SEEK_CUR: pos += offset; break;\r
      case SEEK_SET: pos  = offset; break;\r
      case SEEK_END: pos  = stream->size - offset; break;\r
    }\r
    if (z->entry->compression_method == 0) {\r
      ret = fseek(z->zip->fp, z->start + pos, SEEK_SET);\r
      if (ret == 0)\r
        return (z->pos = pos);\r
      return -1;\r
    }\r
    offset = pos - z->pos;\r
    if (pos < z->pos) {\r
      // full decompress from the start\r
      fseek(z->zip->fp, z->start, SEEK_SET);\r
      z->stream.avail_in = 0;\r
      z->stream.next_in = z->inbuf;\r
      inflateReset(&z->stream);\r
      z->pos = 0;\r
      offset = pos;\r
    }\r
\r
    if (PicoIn.osdMessage != NULL && offset > 4 * 1024 * 1024)\r
      PicoIn.osdMessage("Decompressing data...");\r
\r
    while (offset > 0) {\r
      char buf[16 * 1024];\r
      size_t l = offset > sizeof(buf) ? sizeof(buf) : offset;\r
      ret = pm_read(buf, l, stream);\r
      if (ret != l)\r
        break;\r
      offset -= l;\r
    }\r
    return z->pos;\r
  }\r
  else if (stream->type == PMT_CSO)\r
  {\r
    cso_struct *cso = stream->param;\r
    switch (whence)\r
    {\r
      case SEEK_CUR: cso->fpos_out += offset; break;\r
      case SEEK_SET: cso->fpos_out  = offset; break;\r
      case SEEK_END: cso->fpos_out  = cso->header.total_bytes - offset; break;\r
    }\r
    return cso->fpos_out;\r
  }\r
  else\r
    return -1;\r
}\r
\r
int pm_close(pm_file *fp)\r
{\r
  int ret = 0;\r
\r
  if (fp == NULL) return EOF;\r
\r
  if (fp->type == PMT_UNCOMPRESSED)\r
  {\r
    fclose(fp->file);\r
  }\r
  else if (fp->type == PMT_ZIP)\r
  {\r
    struct zip_file *z = fp->file;\r
    inflateEnd(&z->stream);\r
    closezip(z->zip);\r
  }\r
  else if (fp->type == PMT_CSO)\r
  {\r
    free(fp->param);\r
    fclose(fp->file);\r
  }\r
  else\r
    ret = EOF;\r
\r
  free(fp);\r
  return ret;\r
}\r
\r
// byteswap, data needs to be int aligned, src can match dst\r
void Byteswap(void *dst, const void *src, int len)\r
{\r
  const unsigned int *ps = src;\r
  unsigned int *pd = dst;\r
  int i, m;\r
\r
  if (len < 2)\r
    return;\r
\r
  m = 0x00ff00ff;\r
  for (i = 0; i < len / 4; i++) {\r
    unsigned int t = ps[i];\r
    pd[i] = ((t & m) << 8) | ((t & ~m) >> 8);\r
  }\r
}\r
\r
// Interleve a 16k block and byteswap\r
static int InterleveBlock(unsigned char *dest,unsigned char *src)\r
{\r
  int i=0;\r
  for (i=0;i<0x2000;i++) dest[(i<<1)  ]=src[       i]; // Odd\r
  for (i=0;i<0x2000;i++) dest[(i<<1)+1]=src[0x2000+i]; // Even\r
  return 0;\r
}\r
\r
// Decode a SMD file\r
static int DecodeSmd(unsigned char *data,int len)\r
{\r
  unsigned char *temp=NULL;\r
  int i=0;\r
\r
  temp=(unsigned char *)malloc(0x4000);\r
  if (temp==NULL) return 1;\r
  memset(temp,0,0x4000);\r
\r
  // Interleve each 16k block and shift down by 0x200:\r
  for (i=0; i+0x4200<=len; i+=0x4000)\r
  {\r
    InterleveBlock(temp,data+0x200+i); // Interleve 16k to temporary buffer\r
    memcpy(data+i,temp,0x4000); // Copy back in\r
  }\r
\r
  free(temp);\r
  return 0;\r
}\r
\r
static unsigned char *PicoCartAlloc(int filesize, int is_sms)\r
{\r
  unsigned char *rom;\r
\r
  if (is_sms) {\r
    // make size power of 2 for easier banking handling\r
    int s = 0, tmp = filesize;\r
    while ((tmp >>= 1) != 0)\r
      s++;\r
    if (filesize > (1 << s))\r
      s++;\r
    rom_alloc_size = 1 << s;\r
    // be sure we can cover all address space\r
    if (rom_alloc_size < 0x10000)\r
      rom_alloc_size = 0x10000;\r
  }\r
  else {\r
    // make alloc size at least sizeof(mcd_state),\r
    // in case we want to switch to CD mode\r
    if (filesize < sizeof(mcd_state))\r
      filesize = sizeof(mcd_state);\r
\r
    // align to 512K for memhandlers\r
    rom_alloc_size = (filesize + 0x7ffff) & ~0x7ffff;\r
  }\r
\r
  if (rom_alloc_size - filesize < 4)\r
    rom_alloc_size += 4; // padding for out-of-bound exec protection\r
\r
  // Allocate space for the rom plus padding\r
  // use special address for 32x dynarec\r
  rom = plat_mmap(0x02000000, rom_alloc_size, 0, 0);\r
  return rom;\r
}\r
\r
int PicoCartLoad(pm_file *f,unsigned char **prom,unsigned int *psize,int is_sms)\r
{\r
  unsigned char *rom;\r
  int size, bytes_read;\r
\r
  if (f == NULL)\r
    return 1;\r
\r
  size = f->size;\r
  if (size <= 0) return 1;\r
  size = (size+3)&~3; // Round up to a multiple of 4\r
\r
  // Allocate space for the rom plus padding\r
  rom = PicoCartAlloc(size, is_sms);\r
  if (rom == NULL) {\r
    elprintf(EL_STATUS, "out of memory (wanted %i)", size);\r
    return 2;\r
  }\r
\r
  if (PicoCartLoadProgressCB != NULL)\r
  {\r
    // read ROM in blocks, just for fun\r
    int ret;\r
    unsigned char *p = rom;\r
    bytes_read=0;\r
    do\r
    {\r
      int todo = size - bytes_read;\r
      if (todo > 256*1024) todo = 256*1024;\r
      ret = pm_read(p,todo,f);\r
      bytes_read += ret;\r
      p += ret;\r
      PicoCartLoadProgressCB(bytes_read * 100 / size);\r
    }\r
    while (ret > 0);\r
  }\r
  else\r
    bytes_read = pm_read(rom,size,f); // Load up the rom\r
  if (bytes_read <= 0) {\r
    elprintf(EL_STATUS, "read failed");\r
    plat_munmap(rom, rom_alloc_size);\r
    return 3;\r
  }\r
\r
  if (!is_sms)\r
  {\r
    // maybe we are loading MegaCD BIOS?\r
    if (!(PicoIn.AHW & PAHW_MCD) && size == 0x20000 && (!strncmp((char *)rom+0x124, "BOOT", 4) ||\r
         !strncmp((char *)rom+0x128, "BOOT", 4))) {\r
      PicoIn.AHW |= PAHW_MCD;\r
    }\r
\r
    // Check for SMD:\r
    if (size >= 0x4200 && (size&0x3fff) == 0x200 &&\r
        ((rom[0x2280] == 'S' && rom[0x280] == 'E') || (rom[0x280] == 'S' && rom[0x2281] == 'E'))) {\r
      elprintf(EL_STATUS, "SMD format detected.");\r
      DecodeSmd(rom,size); size-=0x200; // Decode and byteswap SMD\r
    }\r
    else Byteswap(rom, rom, size); // Just byteswap\r
  }\r
  else\r
  {\r
    if (size >= 0x4200 && (size&0x3fff) == 0x200) {\r
      elprintf(EL_STATUS, "SMD format detected.");\r
      // at least here it's not interleaved\r
      size -= 0x200;\r
      memmove(rom, rom + 0x200, size);\r
    }\r
  }\r
\r
  if (prom)  *prom = rom;\r
  if (psize) *psize = size;\r
\r
  return 0;\r
}\r
\r
// Insert a cartridge:\r
int PicoCartInsert(unsigned char *rom, unsigned int romsize, const char *carthw_cfg)\r
{\r
  // notaz: add a 68k "jump one op back" opcode to the end of ROM.\r
  // This will hang the emu, but will prevent nasty crashes.\r
  // note: 4 bytes are padded to every ROM\r
  if (rom != NULL)\r
    *(unsigned long *)(rom+romsize) = 0xFFFE4EFA; // 4EFA FFFE byteswapped\r
\r
  Pico.rom=rom;\r
  Pico.romsize=romsize;\r
\r
  if (Pico.sv.data) {\r
    free(Pico.sv.data);\r
    Pico.sv.data = NULL;\r
  }\r
\r
  if (PicoCartUnloadHook != NULL) {\r
    PicoCartUnloadHook();\r
    PicoCartUnloadHook = NULL;\r
  }\r
  pdb_cleanup();\r
\r
  PicoIn.AHW &= PAHW_MCD|PAHW_SMS;\r
\r
  PicoCartMemSetup = NULL;\r
  PicoDmaHook = NULL;\r
  PicoResetHook = NULL;\r
  PicoLineHook = NULL;\r
  PicoLoadStateHook = NULL;\r
  carthw_chunks = NULL;\r
\r
  if (!(PicoIn.AHW & (PAHW_MCD|PAHW_SMS)))\r
    PicoCartDetect(carthw_cfg);\r
\r
  // setup correct memory map for loaded ROM\r
  switch (PicoIn.AHW) {\r
    default:\r
      elprintf(EL_STATUS|EL_ANOMALY, "starting in unknown hw configuration: %x", PicoIn.AHW);\r
    case 0:\r
    case PAHW_SVP:  PicoMemSetup(); break;\r
    case PAHW_MCD:  PicoMemSetupCD(); break;\r
    case PAHW_PICO: PicoMemSetupPico(); break;\r
    case PAHW_SMS:  PicoMemSetupMS(); break;\r
  }\r
\r
  if (PicoCartMemSetup != NULL)\r
    PicoCartMemSetup();\r
\r
  if (PicoIn.AHW & PAHW_SMS)\r
    PicoPowerMS();\r
  else\r
    PicoPower();\r
\r
  PicoGameLoaded = 1;\r
  return 0;\r
}\r
\r
int PicoCartResize(int newsize)\r
{\r
  void *tmp = plat_mremap(Pico.rom, rom_alloc_size, newsize);\r
  if (tmp == NULL)\r
    return -1;\r
\r
  Pico.rom = tmp;\r
  rom_alloc_size = newsize;\r
  return 0;\r
}\r
\r
void PicoCartUnload(void)\r
{\r
  if (PicoCartUnloadHook != NULL) {\r
    PicoCartUnloadHook();\r
    PicoCartUnloadHook = NULL;\r
  }\r
\r
  if (PicoIn.AHW & PAHW_32X)\r
    PicoUnload32x();\r
\r
  if (Pico.rom != NULL) {\r
    SekFinishIdleDet();\r
    plat_munmap(Pico.rom, rom_alloc_size);\r
    Pico.rom = NULL;\r
  }\r
  PicoGameLoaded = 0;\r
}\r
\r
static unsigned int rom_crc32(void)\r
{\r
  unsigned int crc;\r
  elprintf(EL_STATUS, "caclulating CRC32..");\r
\r
  // have to unbyteswap for calculation..\r
  Byteswap(Pico.rom, Pico.rom, Pico.romsize);\r
  crc = crc32(0, Pico.rom, Pico.romsize);\r
  Byteswap(Pico.rom, Pico.rom, Pico.romsize);\r
  return crc;\r
}\r
\r
static int rom_strcmp(int rom_offset, const char *s1)\r
{\r
  int i, len = strlen(s1);\r
  const char *s_rom = (const char *)Pico.rom;\r
  if (rom_offset + len > Pico.romsize)\r
    return 0;\r
  for (i = 0; i < len; i++)\r
    if (s1[i] != s_rom[(i + rom_offset) ^ 1])\r
      return 1;\r
  return 0;\r
}\r
\r
static unsigned int rom_read32(int addr)\r
{\r
  unsigned short *m = (unsigned short *)(Pico.rom + addr);\r
  return (m[0] << 16) | m[1];\r
}\r
\r
static char *sskip(char *s)\r
{\r
  while (*s && isspace_(*s))\r
    s++;\r
  return s;\r
}\r
\r
static void rstrip(char *s)\r
{\r
  char *p;\r
  for (p = s + strlen(s) - 1; p >= s; p--)\r
    if (isspace_(*p))\r
      *p = 0;\r
}\r
\r
static int parse_3_vals(char *p, int *val0, int *val1, int *val2)\r
{\r
  char *r;\r
  *val0 = strtoul(p, &r, 0);\r
  if (r == p)\r
    goto bad;\r
  p = sskip(r);\r
  if (*p++ != ',')\r
    goto bad;\r
  *val1 = strtoul(p, &r, 0);\r
  if (r == p)\r
    goto bad;\r
  p = sskip(r);\r
  if (*p++ != ',')\r
    goto bad;\r
  *val2 = strtoul(p, &r, 0);\r
  if (r == p)\r
    goto bad;\r
\r
  return 1;\r
bad:\r
  return 0;\r
}\r
\r
static int is_expr(const char *expr, char **pr)\r
{\r
  int len = strlen(expr);\r
  char *p = *pr;\r
\r
  if (strncmp(expr, p, len) != 0)\r
    return 0;\r
  p = sskip(p + len);\r
  if (*p != '=')\r
    return 0; // wrong or malformed\r
\r
  *pr = sskip(p + 1);\r
  return 1;\r
}\r
\r
#include "carthw_cfg.c"\r
\r
static void parse_carthw(const char *carthw_cfg, int *fill_sram,\r
  int *hw_detected)\r
{\r
  int line = 0, any_checks_passed = 0, skip_sect = 0;\r
  const char *s, *builtin = builtin_carthw_cfg;\r
  int tmp, rom_crc = 0;\r
  char buff[256], *p, *r;\r
  FILE *f;\r
\r
  f = fopen(carthw_cfg, "r");\r
  if (f == NULL)\r
    f = fopen("pico/carthw.cfg", "r");\r
  if (f == NULL)\r
    elprintf(EL_STATUS, "couldn't open carthw.cfg!");\r
\r
  for (;;)\r
  {\r
    if (f != NULL) {\r
      p = fgets(buff, sizeof(buff), f);\r
      if (p == NULL)\r
        break;\r
    }\r
    else {\r
      if (*builtin == 0)\r
        break;\r
      for (s = builtin; *s != 0 && *s != '\n'; s++)\r
        ;\r
      while (*s == '\n')\r
        s++;\r
      tmp = s - builtin;\r
      if (tmp > sizeof(buff) - 1)\r
        tmp = sizeof(buff) - 1;\r
      memcpy(buff, builtin, tmp);\r
      buff[tmp] = 0;\r
      p = buff;\r
      builtin = s;\r
    }\r
\r
    line++;\r
    p = sskip(p);\r
    if (*p == 0 || *p == '#')\r
      continue;\r
\r
    if (*p == '[') {\r
      any_checks_passed = 0;\r
      skip_sect = 0;\r
      continue;\r
    }\r
    \r
    if (skip_sect)\r
      continue;\r
\r
    /* look for checks */\r
    if (is_expr("check_str", &p))\r
    {\r
      int offs;\r
      offs = strtoul(p, &r, 0);\r
      if (offs < 0 || offs > Pico.romsize) {\r
        elprintf(EL_STATUS, "carthw:%d: check_str offs out of range: %d\n", line, offs);\r
	goto bad;\r
      }\r
      p = sskip(r);\r
      if (*p != ',')\r
        goto bad;\r
      p = sskip(p + 1);\r
      if (*p != '"')\r
        goto bad;\r
      p++;\r
      r = strchr(p, '"');\r
      if (r == NULL)\r
        goto bad;\r
      *r = 0;\r
\r
      if (rom_strcmp(offs, p) == 0)\r
        any_checks_passed = 1;\r
      else\r
        skip_sect = 1;\r
      continue;\r
    }\r
    else if (is_expr("check_size_gt", &p))\r
    {\r
      int size;\r
      size = strtoul(p, &r, 0);\r
      if (r == p || size < 0)\r
        goto bad;\r
\r
      if (Pico.romsize > size)\r
        any_checks_passed = 1;\r
      else\r
        skip_sect = 1;\r
      continue;\r
    }\r
    else if (is_expr("check_csum", &p))\r
    {\r
      int csum;\r
      csum = strtoul(p, &r, 0);\r
      if (r == p || (csum & 0xffff0000))\r
        goto bad;\r
\r
      if (csum == (rom_read32(0x18c) & 0xffff))\r
        any_checks_passed = 1;\r
      else\r
        skip_sect = 1;\r
      continue;\r
    }\r
    else if (is_expr("check_crc32", &p))\r
    {\r
      unsigned int crc;\r
      crc = strtoul(p, &r, 0);\r
      if (r == p)\r
        goto bad;\r
\r
      if (rom_crc == 0)\r
        rom_crc = rom_crc32();\r
      if (crc == rom_crc)\r
        any_checks_passed = 1;\r
      else\r
        skip_sect = 1;\r
      continue;\r
    }\r
\r
    /* now time for actions */\r
    if (is_expr("hw", &p)) {\r
      if (!any_checks_passed)\r
        goto no_checks;\r
      *hw_detected = 1;\r
      rstrip(p);\r
\r
      if      (strcmp(p, "svp") == 0)\r
        PicoSVPStartup();\r
      else if (strcmp(p, "pico") == 0)\r
        PicoInitPico();\r
      else if (strcmp(p, "prot") == 0)\r
        carthw_sprot_startup();\r
      else if (strcmp(p, "ssf2_mapper") == 0)\r
        carthw_ssf2_startup();\r
      else if (strcmp(p, "x_in_1_mapper") == 0)\r
        carthw_Xin1_startup();\r
      else if (strcmp(p, "realtec_mapper") == 0)\r
        carthw_realtec_startup();\r
      else if (strcmp(p, "radica_mapper") == 0)\r
        carthw_radica_startup();\r
      else if (strcmp(p, "piersolar_mapper") == 0)\r
        carthw_pier_startup();\r
      else if (strcmp(p, "prot_lk3") == 0)\r
        carthw_prot_lk3_startup();\r
      else {\r
        elprintf(EL_STATUS, "carthw:%d: unsupported mapper: %s", line, p);\r
        skip_sect = 1;\r
        *hw_detected = 0;\r
      }\r
      continue;\r
    }\r
    if (is_expr("sram_range", &p)) {\r
      int start, end;\r
\r
      if (!any_checks_passed)\r
        goto no_checks;\r
      rstrip(p);\r
\r
      start = strtoul(p, &r, 0);\r
      if (r == p)\r
        goto bad;\r
      p = sskip(r);\r
      if (*p != ',')\r
        goto bad;\r
      p = sskip(p + 1);\r
      end = strtoul(p, &r, 0);\r
      if (r == p)\r
        goto bad;\r
      if (((start | end) & 0xff000000) || start > end) {\r
        elprintf(EL_STATUS, "carthw:%d: bad sram_range: %08x - %08x", line, start, end);\r
        goto bad_nomsg;\r
      }\r
      Pico.sv.start = start;\r
      Pico.sv.end = end;\r
      continue;\r
    }\r
    else if (is_expr("prop", &p)) {\r
      if (!any_checks_passed)\r
        goto no_checks;\r
      rstrip(p);\r
\r
      if      (strcmp(p, "no_sram") == 0)\r
        Pico.sv.flags &= ~SRF_ENABLED;\r
      else if (strcmp(p, "no_eeprom") == 0)\r
        Pico.sv.flags &= ~SRF_EEPROM;\r
      else if (strcmp(p, "filled_sram") == 0)\r
        *fill_sram = 1;\r
      else if (strcmp(p, "force_6btn") == 0)\r
        PicoIn.quirks |= PQUIRK_FORCE_6BTN;\r
      else {\r
        elprintf(EL_STATUS, "carthw:%d: unsupported prop: %s", line, p);\r
        goto bad_nomsg;\r
      }\r
      elprintf(EL_STATUS, "game prop: %s", p);\r
      continue;\r
    }\r
    else if (is_expr("eeprom_type", &p)) {\r
      int type;\r
      if (!any_checks_passed)\r
        goto no_checks;\r
      rstrip(p);\r
\r
      type = strtoul(p, &r, 0);\r
      if (r == p || type < 0)\r
        goto bad;\r
      Pico.sv.eeprom_type = type;\r
      Pico.sv.flags |= SRF_EEPROM;\r
      continue;\r
    }\r
    else if (is_expr("eeprom_lines", &p)) {\r
      int scl, sda_in, sda_out;\r
      if (!any_checks_passed)\r
        goto no_checks;\r
      rstrip(p);\r
\r
      if (!parse_3_vals(p, &scl, &sda_in, &sda_out))\r
        goto bad;\r
      if (scl < 0 || scl > 15 || sda_in < 0 || sda_in > 15 ||\r
          sda_out < 0 || sda_out > 15)\r
        goto bad;\r
\r
      Pico.sv.eeprom_bit_cl = scl;\r
      Pico.sv.eeprom_bit_in = sda_in;\r
      Pico.sv.eeprom_bit_out= sda_out;\r
      continue;\r
    }\r
    else if ((tmp = is_expr("prot_ro_value16", &p)) || is_expr("prot_rw_value16", &p)) {\r
      int addr, mask, val;\r
      if (!any_checks_passed)\r
        goto no_checks;\r
      rstrip(p);\r
\r
      if (!parse_3_vals(p, &addr, &mask, &val))\r
        goto bad;\r
\r
      carthw_sprot_new_location(addr, mask, val, tmp ? 1 : 0);\r
      continue;\r
    }\r
\r
\r
bad:\r
    elprintf(EL_STATUS, "carthw:%d: unrecognized expression: %s", line, buff);\r
bad_nomsg:\r
    skip_sect = 1;\r
    continue;\r
\r
no_checks:\r
    elprintf(EL_STATUS, "carthw:%d: command without any checks before it: %s", line, buff);\r
    skip_sect = 1;\r
    continue;\r
  }\r
\r
  if (f != NULL)\r
    fclose(f);\r
}\r
\r
/*\r
 * various cart-specific things, which can't be handled by generic code\r
 */\r
static void PicoCartDetect(const char *carthw_cfg)\r
{\r
  int carthw_detected = 0;\r
  int fill_sram = 0;\r
\r
  memset(&Pico.sv, 0, sizeof(Pico.sv));\r
  if (Pico.rom[0x1B1] == 'R' && Pico.rom[0x1B0] == 'A')\r
  {\r
    Pico.sv.start =  rom_read32(0x1B4) & ~0xff000001; // align\r
    Pico.sv.end   = (rom_read32(0x1B8) & ~0xff000000) | 1;\r
    if (Pico.rom[0x1B2] & 0x40)\r
      // EEPROM\r
      Pico.sv.flags |= SRF_EEPROM;\r
    Pico.sv.flags |= SRF_ENABLED;\r
  }\r
  if (Pico.sv.end == 0 || Pico.sv.start > Pico.sv.end)\r
  {\r
    // some games may have bad headers, like S&K and Sonic3\r
    // note: majority games use 0x200000 as starting address, but there are some which\r
    // use something else (0x300000 by HardBall '95). Luckily they have good headers.\r
    Pico.sv.start = 0x200000;\r
    Pico.sv.end   = 0x203FFF;\r
    Pico.sv.flags |= SRF_ENABLED;\r
  }\r
\r
  // set EEPROM defaults, in case it gets detected\r
  Pico.sv.eeprom_type   = 0; // 7bit (24C01)\r
  Pico.sv.eeprom_bit_cl = 1;\r
  Pico.sv.eeprom_bit_in = 0;\r
  Pico.sv.eeprom_bit_out= 0;\r
\r
  if (carthw_cfg != NULL)\r
    parse_carthw(carthw_cfg, &fill_sram, &carthw_detected);\r
\r
  // assume the standard mapper for large roms\r
  if (!carthw_detected && Pico.romsize > 0x400000)\r
    carthw_ssf2_startup();\r
\r
  if (Pico.sv.flags & SRF_ENABLED)\r
  {\r
    if (Pico.sv.flags & SRF_EEPROM)\r
      Pico.sv.size = 0x2000;\r
    else\r
      Pico.sv.size = Pico.sv.end - Pico.sv.start + 1;\r
\r
    Pico.sv.data = calloc(Pico.sv.size, 1);\r
    if (Pico.sv.data == NULL)\r
      Pico.sv.flags &= ~SRF_ENABLED;\r
\r
    if (Pico.sv.eeprom_type == 1)	// 1 == 0 in PD EEPROM code\r
      Pico.sv.eeprom_type = 0;\r
  }\r
\r
  if ((Pico.sv.flags & SRF_ENABLED) && fill_sram)\r
  {\r
    elprintf(EL_STATUS, "SRAM fill");\r
    memset(Pico.sv.data, 0xff, Pico.sv.size);\r
  }\r
\r
  // Unusual region 'code'\r
  if (rom_strcmp(0x1f0, "EUROPE") == 0 || rom_strcmp(0x1f0, "Europe") == 0)\r
    *(int *) (Pico.rom + 0x1f0) = 0x20204520;\r
}\r
\r
// vim:shiftwidth=2:expandtab\r