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