15eb0001 |
1 | \r |
2 | #include "PicoInt.h"\r |
3 | \r |
4 | static void Byteswap(unsigned char *data,int len)\r |
5 | {\r |
6 | int i=0;\r |
7 | \r |
8 | if (len<2) return; // Too short\r |
9 | \r |
10 | do\r |
11 | {\r |
12 | unsigned short *pd=(unsigned short *)(data+i);\r |
13 | int value=*pd; // Get 2 bytes\r |
14 | \r |
15 | value=(value<<8)|(value>>8); // Byteswap it\r |
16 | *pd=(unsigned short)value; // Put 2b ytes\r |
17 | i+=2;\r |
18 | } \r |
19 | while (i+2<=len);\r |
20 | }\r |
21 | \r |
22 | // Interleve a 16k block and byteswap\r |
23 | static int InterleveBlock(unsigned char *dest,unsigned char *src)\r |
24 | {\r |
25 | int i=0;\r |
26 | for (i=0;i<0x2000;i++) dest[(i<<1) ]=src[ i]; // Odd\r |
27 | for (i=0;i<0x2000;i++) dest[(i<<1)+1]=src[0x2000+i]; // Even\r |
28 | return 0;\r |
29 | }\r |
30 | \r |
31 | // Decode a SMD file\r |
32 | static int DecodeSmd(unsigned char *data,int len)\r |
33 | {\r |
34 | unsigned char *temp=NULL;\r |
35 | int i=0;\r |
36 | \r |
37 | temp=(unsigned char *)malloc(0x4000);\r |
38 | if (temp==NULL) return 1;\r |
39 | memset(temp,0,0x4000);\r |
40 | \r |
41 | // Interleve each 16k block and shift down by 0x200:\r |
42 | for (i=0; i+0x4200<=len; i+=0x4000)\r |
43 | {\r |
44 | InterleveBlock(temp,data+0x200+i); // Interleve 16k to temporary buffer\r |
45 | memcpy(data+i,temp,0x4000); // Copy back in\r |
46 | }\r |
47 | \r |
48 | free(temp);\r |
49 | return 0;\r |
50 | }\r |
51 | \r |
52 | int PicoCartLoad(FILE *f,unsigned char **prom,unsigned int *psize)\r |
53 | {\r |
54 | unsigned char *rom=NULL; int size=0;\r |
55 | if (f==NULL) return 1;\r |
56 | \r |
57 | fseek(f,0,SEEK_END); size=ftell(f); fseek(f,0,SEEK_SET);\r |
58 | \r |
59 | size=(size+3)&~3; // Round up to a multiple of 4\r |
60 | \r |
61 | // Allocate space for the rom plus padding\r |
62 | rom=(unsigned char *)malloc(size+4);\r |
63 | if (rom==NULL) { fclose(f); return 1; }\r |
64 | memset(rom,0,size+4);\r |
65 | \r |
66 | fread(rom,1,size,f); // Load up the rom\r |
67 | fclose(f);\r |
68 | \r |
69 | // Check for SMD:\r |
70 | if ((size&0x3fff)==0x200) { DecodeSmd(rom,size); size-=0x200; } // Decode and byteswap SMD\r |
71 | else Byteswap(rom,size); // Just byteswap\r |
72 | \r |
73 | if (prom) *prom=rom;\r |
74 | if (psize) *psize=size;\r |
75 | \r |
76 | return 0;\r |
77 | }\r |
78 | \r |
79 | // Insert/remove a cartridge:\r |
80 | int PicoCartInsert(unsigned char *rom,unsigned int romsize)\r |
81 | {\r |
82 | // Make sure movie playing/recording is stopped:\r |
83 | if (PmovFile) fclose(PmovFile);\r |
84 | PmovFile=NULL; PmovAction=0;\r |
85 | \r |
86 | memset(&Pico,0,sizeof(Pico)); // Blank Pico state\r |
87 | Pico.rom=rom;\r |
88 | Pico.romsize=romsize;\r |
89 | PicoReset();\r |
90 | \r |
91 | return 0;\r |
92 | }\r |