+ 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(64*1024);\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
+ PicoIn.AHW = PAHW_SVP;\r
+ else if (strcmp(p, "pico") == 0)\r
+ PicoIn.AHW = PAHW_PICO;\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, "sf001_mapper") == 0)\r
+ carthw_sf001_startup();\r
+ else if (strcmp(p, "sf002_mapper") == 0)\r
+ carthw_sf002_startup();\r
+ else if (strcmp(p, "sf004_mapper") == 0)\r
+ carthw_sf004_startup();\r
+ else if (strcmp(p, "lk3_mapper") == 0)\r
+ carthw_lk3_startup();\r
+ else if (strcmp(p, "smw64_mapper") == 0)\r
+ carthw_smw64_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, "wwfraw_hack") == 0)\r
+ PicoIn.quirks |= PQUIRK_WWFRAW_HACK;\r
+ else if (strcmp(p, "blackthorne_hack") == 0)\r
+ PicoIn.quirks |= PQUIRK_BLACKTHORNE_HACK;\r
+ else if (strcmp(p, "marscheck_hack") == 0)\r
+ PicoIn.quirks |= PQUIRK_MARSCHECK_HACK;\r
+ else if (strcmp(p, "force_6btn") == 0)\r
+ PicoIn.quirks |= PQUIRK_FORCE_6BTN;\r
+ else if (strcmp(p, "no_z80_bus_lock") == 0)\r
+ PicoIn.quirks |= PQUIRK_NO_Z80_BUS_LOCK;\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
notaz.gp2x.de / picodrive.git / blobdiff