idle loop hack, psp bugfix, plat debug str
[libpicofe.git] / gp2x / emu.c
1 // (c) Copyright 2006-2007 notaz, All rights reserved.\r
2 // Free for non-commercial use.\r
3 \r
4 // For commercial use, separate licencing terms must be obtained.\r
5 \r
6 #include <stdio.h>\r
7 #include <stdlib.h>\r
8 #include <sys/time.h>\r
9 #include <sys/stat.h>\r
10 #include <sys/types.h>\r
11 #include <linux/limits.h>\r
12 #include <ctype.h>\r
13 #include <unistd.h>\r
14 \r
15 #include <stdarg.h>\r
16 \r
17 #include "emu.h"\r
18 #include "gp2x.h"\r
19 #include "usbjoy.h"\r
20 #include "menu.h"\r
21 #include "../common/arm_utils.h"\r
22 #include "../common/fonts.h"\r
23 #include "../common/emu.h"\r
24 #include "../common/config.h"\r
25 #include "cpuctrl.h"\r
26 \r
27 #include <Pico/PicoInt.h>\r
28 #include <Pico/Patch.h>\r
29 #include <Pico/sound/mix.h>\r
30 #include <zlib/zlib.h>\r
31 \r
32 //#define PFRAMES\r
33 \r
34 #ifdef BENCHMARK\r
35 #define OSD_FPS_X 220\r
36 #else\r
37 #define OSD_FPS_X 260\r
38 #endif\r
39 \r
40 \r
41 int engineState;\r
42 int select_exits = 0;\r
43 \r
44 char romFileName[PATH_MAX];\r
45 \r
46 extern int crashed_940;\r
47 \r
48 static short __attribute__((aligned(4))) sndBuffer[2*44100/50];\r
49 static struct timeval noticeMsgTime = { 0, 0 }; // when started showing\r
50 static int osd_fps_x;\r
51 static int gp2x_old_gamma = 100;\r
52 char noticeMsg[64];                     // notice msg to draw\r
53 unsigned char *PicoDraw2FB = NULL;  // temporary buffer for alt renderer\r
54 int reset_timing = 0;\r
55 \r
56 #define PICO_PEN_ADJUST_X 4\r
57 #define PICO_PEN_ADJUST_Y 2\r
58 static int pico_pen_x = 320/2, pico_pen_y = 240/2;\r
59 \r
60 static void emu_msg_cb(const char *msg);\r
61 static void emu_msg_tray_open(void);\r
62 \r
63 \r
64 void emu_noticeMsgUpdated(void)\r
65 {\r
66         gettimeofday(&noticeMsgTime, 0);\r
67 }\r
68 \r
69 void emu_getMainDir(char *dst, int len)\r
70 {\r
71         extern char **g_argv;\r
72         int j;\r
73 \r
74         strncpy(dst, g_argv[0], len);\r
75         len -= 32; // reserve\r
76         if (len < 0) len = 0;\r
77         dst[len] = 0;\r
78         for (j = strlen(dst); j > 0; j--)\r
79                 if (dst[j] == '/') { dst[j+1] = 0; break; }\r
80 }\r
81 \r
82 void emu_Init(void)\r
83 {\r
84         // make temp buffer for alt renderer\r
85         PicoDraw2FB = malloc((8+320)*(8+240+8));\r
86         if (!PicoDraw2FB)\r
87         {\r
88                 printf("PicoDraw2FB == 0\n");\r
89         }\r
90 \r
91         // make dirs for saves, cfgs, etc.\r
92         mkdir("mds", 0777);\r
93         mkdir("srm", 0777);\r
94         mkdir("brm", 0777);\r
95         mkdir("cfg", 0777);\r
96 \r
97         PicoInit();\r
98         PicoMessage = emu_msg_cb;\r
99         PicoMCDopenTray = emu_msg_tray_open;\r
100         PicoMCDcloseTray = menu_loop_tray;\r
101 }\r
102 \r
103 \r
104 static void scaling_update(void)\r
105 {\r
106         PicoOpt &= ~0x4100;\r
107         switch (currentConfig.scaling) {\r
108                 default: break; // off\r
109                 case 1:  // hw hor\r
110                 case 2:  PicoOpt |=  0x0100; break; // hw hor+vert\r
111                 case 3:  PicoOpt |=  0x4000; break; // sw hor\r
112         }\r
113 }\r
114 \r
115 \r
116 void emu_Deinit(void)\r
117 {\r
118         // save SRAM\r
119         if((currentConfig.EmuOpt & 1) && SRam.changed) {\r
120                 emu_SaveLoadGame(0, 1);\r
121                 SRam.changed = 0;\r
122         }\r
123 \r
124         if (!(currentConfig.EmuOpt & 0x20)) {\r
125                 config_writelrom(PicoConfigFile);\r
126 #ifndef NO_SYNC\r
127                 sync();\r
128 #endif\r
129         }\r
130 \r
131         free(PicoDraw2FB);\r
132 \r
133         PicoExit();\r
134 \r
135         // restore gamma\r
136         if (gp2x_old_gamma != 100)\r
137                 set_gamma(100, 0);\r
138 }\r
139 \r
140 void emu_prepareDefaultConfig(void)\r
141 {\r
142         memset(&defaultConfig, 0, sizeof(defaultConfig));\r
143         defaultConfig.EmuOpt    = 0x9d | 0x00700; // | <- ram_tmng, confirm_save, cd_leds\r
144         defaultConfig.s_PicoOpt = 0x0f | POPT_EXT_FM|POPT_EN_MCD_PCM|POPT_EN_MCD_CDDA|POPT_EN_SVP_DRC|POPT_ACC_SPRITES;\r
145         defaultConfig.s_PsndRate = 44100;\r
146         defaultConfig.s_PicoRegion = 0; // auto\r
147         defaultConfig.s_PicoAutoRgnOrder = 0x184; // US, EU, JP\r
148         defaultConfig.s_PicoCDBuffers = 0;\r
149         defaultConfig.Frameskip = -1; // auto\r
150         defaultConfig.CPUclock = 200;\r
151         defaultConfig.volume = 50;\r
152         defaultConfig.KeyBinds[ 0] = 1<<0; // SACB RLDU\r
153         defaultConfig.KeyBinds[ 4] = 1<<1;\r
154         defaultConfig.KeyBinds[ 2] = 1<<2;\r
155         defaultConfig.KeyBinds[ 6] = 1<<3;\r
156         defaultConfig.KeyBinds[14] = 1<<4;\r
157         defaultConfig.KeyBinds[13] = 1<<5;\r
158         defaultConfig.KeyBinds[12] = 1<<6;\r
159         defaultConfig.KeyBinds[ 8] = 1<<7;\r
160         defaultConfig.KeyBinds[15] = 1<<26; // switch rend\r
161         defaultConfig.KeyBinds[10] = 1<<27; // save state\r
162         defaultConfig.KeyBinds[11] = 1<<28; // load state\r
163         defaultConfig.KeyBinds[23] = 1<<29; // vol up\r
164         defaultConfig.KeyBinds[22] = 1<<30; // vol down\r
165         defaultConfig.gamma = 100;\r
166         defaultConfig.scaling = 0;\r
167         defaultConfig.turbo_rate = 15;\r
168 }\r
169 \r
170 void emu_setDefaultConfig(void)\r
171 {\r
172         memcpy(&currentConfig, &defaultConfig, sizeof(currentConfig));\r
173         PicoOpt = currentConfig.s_PicoOpt;\r
174         PsndRate = currentConfig.s_PsndRate;\r
175         PicoRegionOverride = currentConfig.s_PicoRegion;\r
176         PicoAutoRgnOrder = currentConfig.s_PicoAutoRgnOrder;\r
177         PicoCDBuffers = currentConfig.s_PicoCDBuffers;\r
178 }\r
179 \r
180 void osd_text(int x, int y, const char *text)\r
181 {\r
182         int len = strlen(text)*8;\r
183 \r
184         if ((PicoOpt&0x10)||!(currentConfig.EmuOpt&0x80)) {\r
185                 int *p, i, h;\r
186                 x &= ~3; // align x\r
187                 len = (len+3) >> 2;\r
188                 for (h = 0; h < 8; h++) {\r
189                         p = (int *) ((unsigned char *) gp2x_screen+x+320*(y+h));\r
190                         for (i = len; i; i--, p++) *p = 0xe0e0e0e0;\r
191                 }\r
192                 emu_textOut8(x, y, text);\r
193         } else {\r
194                 int *p, i, h;\r
195                 x &= ~1; // align x\r
196                 len = (len+1) >> 1;\r
197                 for (h = 0; h < 8; h++) {\r
198                         p = (int *) ((unsigned short *) gp2x_screen+x+320*(y+h));\r
199                         for (i = len; i; i--, p++) *p = (*p>>2)&0x39e7;\r
200                 }\r
201                 emu_textOut16(x, y, text);\r
202         }\r
203 }\r
204 \r
205 static void draw_cd_leds(void)\r
206 {\r
207 //      static\r
208         int old_reg;\r
209 //      if (!((Pico_mcd->s68k_regs[0] ^ old_reg) & 3)) return; // no change // mmu hack problems?\r
210         old_reg = Pico_mcd->s68k_regs[0];\r
211 \r
212         if ((PicoOpt&0x10)||!(currentConfig.EmuOpt&0x80)) {\r
213                 // 8-bit modes\r
214                 unsigned int col_g = (old_reg & 2) ? 0xc0c0c0c0 : 0xe0e0e0e0;\r
215                 unsigned int col_r = (old_reg & 1) ? 0xd0d0d0d0 : 0xe0e0e0e0;\r
216                 *(unsigned int *)((char *)gp2x_screen + 320*2+ 4) =\r
217                 *(unsigned int *)((char *)gp2x_screen + 320*3+ 4) =\r
218                 *(unsigned int *)((char *)gp2x_screen + 320*4+ 4) = col_g;\r
219                 *(unsigned int *)((char *)gp2x_screen + 320*2+12) =\r
220                 *(unsigned int *)((char *)gp2x_screen + 320*3+12) =\r
221                 *(unsigned int *)((char *)gp2x_screen + 320*4+12) = col_r;\r
222         } else {\r
223                 // 16-bit modes\r
224                 unsigned int *p = (unsigned int *)((short *)gp2x_screen + 320*2+4);\r
225                 unsigned int col_g = (old_reg & 2) ? 0x06000600 : 0;\r
226                 unsigned int col_r = (old_reg & 1) ? 0xc000c000 : 0;\r
227                 *p++ = col_g; *p++ = col_g; p+=2; *p++ = col_r; *p++ = col_r; p += 320/2 - 12/2;\r
228                 *p++ = col_g; *p++ = col_g; p+=2; *p++ = col_r; *p++ = col_r; p += 320/2 - 12/2;\r
229                 *p++ = col_g; *p++ = col_g; p+=2; *p++ = col_r; *p++ = col_r;\r
230         }\r
231 }\r
232 \r
233 static void draw_pico_ptr(void)\r
234 {\r
235         unsigned short *p = (unsigned short *)gp2x_screen;\r
236 \r
237         // only if pen enabled and for 16bit modes\r
238         if (pico_inp_mode == 0 || (PicoOpt&0x10) || !(currentConfig.EmuOpt&0x80)) return;\r
239 \r
240         if (!(Pico.video.reg[12]&1) && !(PicoOpt&POPT_DIS_32C_BORDER))\r
241                 p += 32;\r
242 \r
243         p += 320 * (pico_pen_y + PICO_PEN_ADJUST_Y);\r
244         p += pico_pen_x + PICO_PEN_ADJUST_X;\r
245         p[0]   ^= 0xffff;\r
246         p[319] ^= 0xffff;\r
247         p[320] ^= 0xffff;\r
248         p[321] ^= 0xffff;\r
249         p[640] ^= 0xffff;\r
250 }\r
251 \r
252 static int EmuScanBegin16(unsigned int num)\r
253 {\r
254         if (!(Pico.video.reg[1]&8)) num += 8;\r
255         DrawLineDest = (unsigned short *) gp2x_screen + 320 * num;\r
256 \r
257         return 0;\r
258 }\r
259 \r
260 static int EmuScanBegin8(unsigned int num)\r
261 {\r
262         if (!(Pico.video.reg[1]&8)) num += 8;\r
263         DrawLineDest = (unsigned char *)  gp2x_screen + 320 * num;\r
264 \r
265         return 0;\r
266 }\r
267 \r
268 int localPal[0x100];\r
269 static void (*vidCpyM2)(void *dest, void *src) = NULL;\r
270 \r
271 static void blit(const char *fps, const char *notice)\r
272 {\r
273         int emu_opt = currentConfig.EmuOpt;\r
274 \r
275         if (PicoOpt&0x10)\r
276         {\r
277                 // 8bit fast renderer\r
278                 if (Pico.m.dirtyPal) {\r
279                         Pico.m.dirtyPal = 0;\r
280                         vidConvCpyRGB32(localPal, Pico.cram, 0x40);\r
281                         // feed new palette to our device\r
282                         gp2x_video_setpalette(localPal, 0x40);\r
283                 }\r
284                 // a hack for VR\r
285                 if (PicoRead16Hook == PicoSVPRead16)\r
286                         memset32((int *)(PicoDraw2FB+328*8+328*223), 0xe0e0e0e0, 328);\r
287                 // do actual copy\r
288                 vidCpyM2((unsigned char *)gp2x_screen+320*8, PicoDraw2FB+328*8);\r
289         }\r
290         else if (!(emu_opt&0x80))\r
291         {\r
292                 // 8bit accurate renderer\r
293                 if (Pico.m.dirtyPal)\r
294                 {\r
295                         int pallen = 0x40;\r
296                         Pico.m.dirtyPal = 0;\r
297                         if (Pico.video.reg[0xC]&8) // shadow/hilight mode\r
298                         {\r
299                                 vidConvCpyRGB32(localPal, Pico.cram, 0x40);\r
300                                 vidConvCpyRGB32sh(localPal+0x40, Pico.cram, 0x40);\r
301                                 vidConvCpyRGB32hi(localPal+0x80, Pico.cram, 0x40);\r
302                                 memcpy32(localPal+0xc0, localPal+0x40, 0x40);\r
303                                 pallen = 0x100;\r
304                         }\r
305                         else if (rendstatus & PDRAW_ACC_SPRITES) {\r
306                                 vidConvCpyRGB32(localPal, Pico.cram, 0x40);\r
307                                 memcpy32(localPal+0x40, localPal, 0x40);\r
308                                 memcpy32(localPal+0x80, localPal, 0x40);\r
309                                 memcpy32(localPal+0xc0, localPal, 0x40);\r
310                                 pallen = 0x100;\r
311                         }\r
312                         else if (rendstatus & PDRAW_SONIC_MODE) { // mid-frame palette changes\r
313                                 vidConvCpyRGB32(localPal, Pico.cram, 0x40);\r
314                                 vidConvCpyRGB32(localPal+0x40, HighPal, 0x40);\r
315                                 vidConvCpyRGB32(localPal+0x80, HighPal+0x40, 0x40);\r
316                                 pallen = 0xc0;\r
317                         }\r
318                         else {\r
319                                 vidConvCpyRGB32(localPal, Pico.cram, 0x40);\r
320                         }\r
321                         if (pallen > 0xc0) {\r
322                                 localPal[0xc0] = 0x0000c000;\r
323                                 localPal[0xd0] = 0x00c00000;\r
324                                 localPal[0xe0] = 0x00000000; // reserved pixels for OSD\r
325                                 localPal[0xf0] = 0x00ffffff;\r
326                         }\r
327                         gp2x_video_setpalette(localPal, pallen);\r
328                 }\r
329         }\r
330 \r
331         if (notice || (emu_opt & 2)) {\r
332                 int h = 232;\r
333                 if (currentConfig.scaling == 2 && !(Pico.video.reg[1]&8)) h -= 8;\r
334                 if (notice) osd_text(4, h, notice);\r
335                 if (emu_opt & 2)\r
336                         osd_text(osd_fps_x, h, fps);\r
337         }\r
338         if ((emu_opt & 0x400) && (PicoAHW & PAHW_MCD))\r
339                 draw_cd_leds();\r
340         if (PicoAHW & PAHW_PICO)\r
341                 draw_pico_ptr();\r
342 \r
343         //gp2x_video_wait_vsync();\r
344         gp2x_video_flip();\r
345 \r
346         if (!(PicoOpt&0x10)) {\r
347                 if (!(Pico.video.reg[1]&8)) {\r
348                         if (currentConfig.EmuOpt&0x80) {\r
349                                 DrawLineDest = (unsigned short *) gp2x_screen + 320*8;\r
350                         } else {\r
351                                 DrawLineDest = (unsigned char  *) gp2x_screen + 320*8;\r
352                         }\r
353                 } else {\r
354                         DrawLineDest = gp2x_screen;\r
355                 }\r
356         }\r
357 }\r
358 \r
359 \r
360 // clears whole screen or just the notice area (in all buffers)\r
361 static void clearArea(int full)\r
362 {\r
363         if ((PicoOpt&0x10)||!(currentConfig.EmuOpt&0x80)) {\r
364                 // 8-bit renderers\r
365                 if (full) gp2x_memset_all_buffers(0, 0xe0, 320*240);\r
366                 else      gp2x_memset_all_buffers(320*232, 0xe0, 320*8);\r
367         } else {\r
368                 // 16bit accurate renderer\r
369                 if (full) gp2x_memset_all_buffers(0, 0, 320*240*2);\r
370                 else      gp2x_memset_all_buffers(320*232*2, 0, 320*8*2);\r
371         }\r
372 }\r
373 \r
374 \r
375 static void vidResetMode(void)\r
376 {\r
377         if (PicoOpt&0x10) {\r
378                 gp2x_video_changemode(8);\r
379         } else if (currentConfig.EmuOpt&0x80) {\r
380                 gp2x_video_changemode(16);\r
381                 PicoDrawSetColorFormat(1);\r
382                 PicoScanBegin = EmuScanBegin16;\r
383         } else {\r
384                 gp2x_video_changemode(8);\r
385                 PicoDrawSetColorFormat(2);\r
386                 PicoScanBegin = EmuScanBegin8;\r
387         }\r
388         if ((PicoOpt&0x10)||!(currentConfig.EmuOpt&0x80)) {\r
389                 // setup pal for 8-bit modes\r
390                 localPal[0xc0] = 0x0000c000; // MCD LEDs\r
391                 localPal[0xd0] = 0x00c00000;\r
392                 localPal[0xe0] = 0x00000000; // reserved pixels for OSD\r
393                 localPal[0xf0] = 0x00ffffff;\r
394                 gp2x_video_setpalette(localPal, 0x100);\r
395                 gp2x_memset_all_buffers(0, 0xe0, 320*240);\r
396                 gp2x_video_flip();\r
397         }\r
398         Pico.m.dirtyPal = 1;\r
399         // reset scaling\r
400         if (currentConfig.scaling == 2 && !(Pico.video.reg[1]&8))\r
401              gp2x_video_RGB_setscaling(8, (PicoOpt&0x100)&&!(Pico.video.reg[12]&1) ? 256 : 320, 224);\r
402         else gp2x_video_RGB_setscaling(0, (PicoOpt&0x100)&&!(Pico.video.reg[12]&1) ? 256 : 320, 240);\r
403 }\r
404 \r
405 \r
406 static void emu_msg_cb(const char *msg)\r
407 {\r
408         if ((PicoOpt&0x10)||!(currentConfig.EmuOpt&0x80)) {\r
409                 // 8-bit renderers\r
410                 gp2x_memset_all_buffers(320*232, 0xe0, 320*8);\r
411                 osd_text(4, 232, msg);\r
412                 gp2x_memcpy_all_buffers((char *)gp2x_screen+320*232, 320*232, 320*8);\r
413         } else {\r
414                 // 16bit accurate renderer\r
415                 gp2x_memset_all_buffers(320*232*2, 0, 320*8*2);\r
416                 osd_text(4, 232, msg);\r
417                 gp2x_memcpy_all_buffers((char *)gp2x_screen+320*232*2, 320*232*2, 320*8*2);\r
418         }\r
419         gettimeofday(&noticeMsgTime, 0);\r
420         noticeMsgTime.tv_sec -= 2;\r
421 \r
422         /* assumption: emu_msg_cb gets called only when something slow is about to happen */\r
423         reset_timing = 1;\r
424 }\r
425 \r
426 static void emu_state_cb(const char *str)\r
427 {\r
428         clearArea(0);\r
429         blit("", str);\r
430 }\r
431 \r
432 static void emu_msg_tray_open(void)\r
433 {\r
434         strcpy(noticeMsg, "CD tray opened");\r
435         gettimeofday(&noticeMsgTime, 0);\r
436 }\r
437 \r
438 static void RunEventsPico(unsigned int events, unsigned int gp2x_keys)\r
439 {\r
440         int ret, px, py, lim_x;\r
441         static int pdown_frames = 0;\r
442 \r
443         emu_RunEventsPico(events);\r
444 \r
445         if (pico_inp_mode == 0) return;\r
446 \r
447         // for F200\r
448         ret = gp2x_touchpad_read(&px, &py);\r
449         if (ret >= 0)\r
450         {\r
451                 if (ret > 35000)\r
452                 {\r
453                         if (pdown_frames++ > 5)\r
454                                 PicoPad[0] |= 0x20;\r
455 \r
456                         pico_pen_x = px;\r
457                         pico_pen_y = py;\r
458                         if (!(Pico.video.reg[12]&1)) {\r
459                                 pico_pen_x -= 32;\r
460                                 if (pico_pen_x <   0) pico_pen_x = 0;\r
461                                 if (pico_pen_x > 248) pico_pen_x = 248;\r
462                         }\r
463                         if (pico_pen_y > 224) pico_pen_y = 224;\r
464                 }\r
465                 else\r
466                         pdown_frames = 0;\r
467 \r
468                 //if (ret == 0)\r
469                 //      PicoPicohw.pen_pos[0] = PicoPicohw.pen_pos[1] = 0x8000;\r
470         }\r
471 \r
472         PicoPad[0] &= ~0x0f; // release UDLR\r
473         if (gp2x_keys & GP2X_UP)    pico_pen_y--;\r
474         if (gp2x_keys & GP2X_DOWN)  pico_pen_y++;\r
475         if (gp2x_keys & GP2X_LEFT)  pico_pen_x--;\r
476         if (gp2x_keys & GP2X_RIGHT) pico_pen_x++;\r
477 \r
478         lim_x = (Pico.video.reg[12]&1) ? 319 : 255;\r
479         if (pico_pen_y < 8) pico_pen_y = 8;\r
480         if (pico_pen_y > 224-PICO_PEN_ADJUST_Y) pico_pen_y = 224-PICO_PEN_ADJUST_Y;\r
481         if (pico_pen_x < 0) pico_pen_x = 0;\r
482         if (pico_pen_x > lim_x-PICO_PEN_ADJUST_X) pico_pen_x = lim_x-PICO_PEN_ADJUST_X;\r
483 \r
484         PicoPicohw.pen_pos[0] = pico_pen_x;\r
485         if (!(Pico.video.reg[12]&1)) PicoPicohw.pen_pos[0] += pico_pen_x/4;\r
486         PicoPicohw.pen_pos[0] += 0x3c;\r
487         PicoPicohw.pen_pos[1] = pico_inp_mode == 1 ? (0x2f8 + pico_pen_y) : (0x1fc + pico_pen_y);\r
488 }\r
489 \r
490 static void update_volume(int has_changed, int is_up)\r
491 {\r
492         static int prev_frame = 0, wait_frames = 0;\r
493         int vol = currentConfig.volume;\r
494 \r
495         if (has_changed)\r
496         {\r
497                 if (vol < 5 && (PicoOpt&8) && prev_frame == Pico.m.frame_count - 1 && wait_frames < 12)\r
498                         wait_frames++;\r
499                 else {\r
500                         if (is_up) {\r
501                                 if (vol < 99) vol++;\r
502                         } else {\r
503                                 if (vol >  0) vol--;\r
504                         }\r
505                         wait_frames = 0;\r
506                         gp2x_sound_volume(vol, vol);\r
507                         currentConfig.volume = vol;\r
508                 }\r
509                 sprintf(noticeMsg, "VOL: %02i", vol);\r
510                 gettimeofday(&noticeMsgTime, 0);\r
511                 prev_frame = Pico.m.frame_count;\r
512         }\r
513 \r
514         // set the right mixer func\r
515         if (!(PicoOpt&8)) return; // just use defaults for mono\r
516         if (vol >= 5)\r
517                 PsndMix_32_to_16l = mix_32_to_16l_stereo;\r
518         else {\r
519                 mix_32_to_16l_level = 5 - vol;\r
520                 PsndMix_32_to_16l = mix_32_to_16l_stereo_lvl;\r
521         }\r
522 }\r
523 \r
524 static void RunEvents(unsigned int which)\r
525 {\r
526         if (which & 0x1800) // save or load (but not both)\r
527         {\r
528                 int do_it = 1;\r
529                 if ( emu_checkSaveFile(state_slot) &&\r
530                                 (( (which & 0x1000) && (currentConfig.EmuOpt & 0x800)) ||   // load\r
531                                  (!(which & 0x1000) && (currentConfig.EmuOpt & 0x200))) ) { // save\r
532                         unsigned long keys;\r
533                         blit("", (which & 0x1000) ? "LOAD STATE? (Y=yes, X=no)" : "OVERWRITE SAVE? (Y=yes, X=no)");\r
534                         while ( !((keys = gp2x_joystick_read(1)) & (GP2X_X|GP2X_Y)) )\r
535                                 usleep(50*1024);\r
536                         if (keys & GP2X_X) do_it = 0;\r
537                         while ( gp2x_joystick_read(1) & (GP2X_X|GP2X_Y) ) // wait for release\r
538                                 usleep(50*1024);\r
539                         clearArea(0);\r
540                 }\r
541                 if (do_it) {\r
542                         osd_text(4, 232, (which & 0x1000) ? "LOADING GAME" : "SAVING GAME");\r
543                         PicoStateProgressCB = emu_state_cb;\r
544                         gp2x_memcpy_all_buffers(gp2x_screen, 0, 320*240*2);\r
545                         emu_SaveLoadGame((which & 0x1000) >> 12, 0);\r
546                         PicoStateProgressCB = NULL;\r
547                 }\r
548 \r
549                 reset_timing = 1;\r
550         }\r
551         if (which & 0x0400) // switch renderer\r
552         {\r
553                 if      (  PicoOpt&0x10)             { PicoOpt&=~0x10; currentConfig.EmuOpt |= 0x80; }\r
554                 else if (!(currentConfig.EmuOpt&0x80)) PicoOpt|= 0x10;\r
555                 else   currentConfig.EmuOpt &= ~0x80;\r
556 \r
557                 vidResetMode();\r
558 \r
559                 if (PicoOpt&0x10) {\r
560                         strcpy(noticeMsg, " 8bit fast renderer");\r
561                 } else if (currentConfig.EmuOpt&0x80) {\r
562                         strcpy(noticeMsg, "16bit accurate renderer");\r
563                 } else {\r
564                         strcpy(noticeMsg, " 8bit accurate renderer");\r
565                 }\r
566 \r
567                 gettimeofday(&noticeMsgTime, 0);\r
568         }\r
569         if (which & 0x0300)\r
570         {\r
571                 if(which&0x0200) {\r
572                         state_slot -= 1;\r
573                         if(state_slot < 0) state_slot = 9;\r
574                 } else {\r
575                         state_slot += 1;\r
576                         if(state_slot > 9) state_slot = 0;\r
577                 }\r
578                 sprintf(noticeMsg, "SAVE SLOT %i [%s]", state_slot, emu_checkSaveFile(state_slot) ? "USED" : "FREE");\r
579                 gettimeofday(&noticeMsgTime, 0);\r
580         }\r
581         if (which & 0x0080) {\r
582                 engineState = PGS_Menu;\r
583         }\r
584 }\r
585 \r
586 static void updateKeys(void)\r
587 {\r
588         unsigned int keys, keys2, allActions[2] = { 0, 0 }, events;\r
589         static unsigned int prevEvents = 0;\r
590         int joy, i;\r
591 \r
592         keys = gp2x_joystick_read(0);\r
593         if (keys & GP2X_SELECT) {\r
594                 engineState = select_exits ? PGS_Quit : PGS_Menu;\r
595                 // wait until select is released, so menu would not resume game\r
596                 while (gp2x_joystick_read(1) & GP2X_SELECT) usleep(50*1000);\r
597         }\r
598 \r
599         keys &= CONFIGURABLE_KEYS;\r
600         keys2 = keys;\r
601 \r
602         for (i = 0; i < 32; i++)\r
603         {\r
604                 if (keys2 & (1 << i))\r
605                 {\r
606                         int pl, acts = currentConfig.KeyBinds[i];\r
607                         if (!acts) continue;\r
608                         pl = (acts >> 16) & 1;\r
609                         if (kb_combo_keys & (1 << i))\r
610                         {\r
611                                 int u = i+1, acts_c = acts & kb_combo_acts;\r
612                                 // let's try to find the other one\r
613                                 if (acts_c) {\r
614                                         for (; u < 32; u++)\r
615                                                 if ( (keys2 & (1 << u)) && (currentConfig.KeyBinds[u] & acts_c) ) {\r
616                                                         allActions[pl] |= acts_c & currentConfig.KeyBinds[u];\r
617                                                         keys2 &= ~((1 << i) | (1 << u));\r
618                                                         break;\r
619                                                 }\r
620                                 }\r
621                                 // add non-combo actions if combo ones were not found\r
622                                 if (!acts_c || u == 32)\r
623                                         allActions[pl] |= acts & ~kb_combo_acts;\r
624                         } else {\r
625                                 allActions[pl] |= acts;\r
626                         }\r
627                 }\r
628         }\r
629 \r
630         // add joy inputs\r
631         if (num_of_joys > 0)\r
632         {\r
633                 gp2x_usbjoy_update();\r
634                 for (joy = 0; joy < num_of_joys; joy++) {\r
635                         int btns = gp2x_usbjoy_check2(joy);\r
636                         for (i = 0; i < 32; i++) {\r
637                                 if (btns & (1 << i)) {\r
638                                         int acts = currentConfig.JoyBinds[joy][i];\r
639                                         int pl = (acts >> 16) & 1;\r
640                                         allActions[pl] |= acts;\r
641                                 }\r
642                         }\r
643                 }\r
644         }\r
645 \r
646         PicoPad[0] = allActions[0] & 0xfff;\r
647         PicoPad[1] = allActions[1] & 0xfff;\r
648 \r
649         if (allActions[0] & 0x7000) emu_DoTurbo(&PicoPad[0], allActions[0]);\r
650         if (allActions[1] & 0x7000) emu_DoTurbo(&PicoPad[1], allActions[1]);\r
651 \r
652         events = (allActions[0] | allActions[1]) >> 16;\r
653 \r
654         // volume is treated in special way and triggered every frame\r
655         if (events & 0x6000)\r
656                 update_volume(1, events & 0x2000);\r
657 \r
658         if ((events ^ prevEvents) & 0x40) {\r
659                 emu_changeFastForward(events & 0x40);\r
660                 update_volume(0, 0);\r
661                 reset_timing = 1;\r
662         }\r
663 \r
664         events &= ~prevEvents;\r
665 \r
666         if (PicoAHW == PAHW_PICO)\r
667                 RunEventsPico(events, keys);\r
668         if (events) RunEvents(events);\r
669         if (movie_data) emu_updateMovie();\r
670 \r
671         prevEvents = (allActions[0] | allActions[1]) >> 16;\r
672 }\r
673 \r
674 \r
675 static void updateSound(int len)\r
676 {\r
677         if (PicoOpt&8) len<<=1;\r
678 \r
679         /* avoid writing audio when lagging behind to prevent audio lag */\r
680         if (PicoSkipFrame != 2)\r
681                 gp2x_sound_write(PsndOut, len<<1);\r
682 }\r
683 \r
684 \r
685 static void SkipFrame(int do_audio)\r
686 {\r
687         PicoSkipFrame=do_audio ? 1 : 2;\r
688         PicoFrame();\r
689         PicoSkipFrame=0;\r
690 }\r
691 \r
692 \r
693 void emu_forcedFrame(int opts)\r
694 {\r
695         int po_old = PicoOpt;\r
696         int eo_old = currentConfig.EmuOpt;\r
697 \r
698         PicoOpt &= ~0x10;\r
699         PicoOpt |= opts|POPT_ACC_SPRITES; // acc_sprites\r
700         currentConfig.EmuOpt |= 0x80;\r
701 \r
702         //vidResetMode();\r
703         PicoDrawSetColorFormat(1);\r
704         PicoScanBegin = EmuScanBegin16;\r
705         Pico.m.dirtyPal = 1;\r
706         PicoFrameDrawOnly();\r
707 \r
708 /*\r
709         if (!(Pico.video.reg[12]&1)) {\r
710                 vidCpyM2 = vidCpyM2_32col;\r
711                 clearArea(1);\r
712         } else  vidCpyM2 = vidCpyM2_40col;\r
713 \r
714         vidCpyM2((unsigned char *)gp2x_screen+320*8, PicoDraw2FB+328*8);\r
715         vidConvCpyRGB32(localPal, Pico.cram, 0x40);\r
716         gp2x_video_setpalette(localPal, 0x40);\r
717 */\r
718         PicoOpt = po_old;\r
719         currentConfig.EmuOpt = eo_old;\r
720 }\r
721 \r
722 void emu_platformDebugCat(char *str)\r
723 {\r
724         // nothing\r
725 }\r
726 \r
727 static void simpleWait(int thissec, int lim_time)\r
728 {\r
729         struct timeval tval;\r
730 \r
731         spend_cycles(1024);\r
732         gettimeofday(&tval, 0);\r
733         if (thissec != tval.tv_sec) tval.tv_usec+=1000000;\r
734 \r
735         while (tval.tv_usec < lim_time)\r
736         {\r
737                 spend_cycles(1024);\r
738                 gettimeofday(&tval, 0);\r
739                 if (thissec != tval.tv_sec) tval.tv_usec+=1000000;\r
740         }\r
741 }\r
742 \r
743 \r
744 #if 0\r
745 static void tga_dump(void)\r
746 {\r
747 #define BYTE unsigned char\r
748 #define WORD unsigned short\r
749         struct\r
750         {\r
751                 BYTE IDLength;        /* 00h  Size of Image ID field */\r
752                 BYTE ColorMapType;    /* 01h  Color map type */\r
753                 BYTE ImageType;       /* 02h  Image type code */\r
754                 WORD CMapStart;       /* 03h  Color map origin */\r
755                 WORD CMapLength;      /* 05h  Color map length */\r
756                 BYTE CMapDepth;       /* 07h  Depth of color map entries */\r
757                 WORD XOffset;         /* 08h  X origin of image */\r
758                 WORD YOffset;         /* 0Ah  Y origin of image */\r
759                 WORD Width;           /* 0Ch  Width of image */\r
760                 WORD Height;          /* 0Eh  Height of image */\r
761                 BYTE PixelDepth;      /* 10h  Image pixel size */\r
762                 BYTE ImageDescriptor; /* 11h  Image descriptor byte */\r
763         } __attribute__((packed)) TGAHEAD;\r
764         static unsigned short oldscr[320*240];\r
765         FILE *f; char name[128]; int i;\r
766 \r
767         memset(&TGAHEAD, 0, sizeof(TGAHEAD));\r
768         TGAHEAD.ImageType = 2;\r
769         TGAHEAD.Width = 320;\r
770         TGAHEAD.Height = 240;\r
771         TGAHEAD.PixelDepth = 16;\r
772         TGAHEAD.ImageDescriptor = 2<<4; // image starts at top-left\r
773 \r
774 #define CONV(X) (((X>>1)&0x7fe0)|(X&0x1f)) // 555?\r
775 \r
776         for (i = 0; i < 320*240; i++)\r
777                 if(oldscr[i] != CONV(((unsigned short *)gp2x_screen)[i])) break;\r
778         if (i < 320*240)\r
779         {\r
780                 for (i = 0; i < 320*240; i++)\r
781                         oldscr[i] = CONV(((unsigned short *)gp2x_screen)[i]);\r
782                 sprintf(name, "%05i.tga", Pico.m.frame_count);\r
783                 f = fopen(name, "wb");\r
784                 if (!f) { printf("!f\n"); exit(1); }\r
785                 fwrite(&TGAHEAD, 1, sizeof(TGAHEAD), f);\r
786                 fwrite(oldscr, 1, 320*240*2, f);\r
787                 fclose(f);\r
788         }\r
789 }\r
790 #endif\r
791 \r
792 \r
793 void emu_Loop(void)\r
794 {\r
795         static int gp2x_old_clock = 200;\r
796         static int PsndRate_old = 0, PicoOpt_old = 0, EmuOpt_old = 0, pal_old = 0;\r
797         char fpsbuff[24]; // fps count c string\r
798         struct timeval tval; // timing\r
799         int pframes_done, pframes_shown, pthissec; // "period" frames, used for sync\r
800         int  frames_done,  frames_shown,  thissec; // actual frames\r
801         int oldmodes = 0, target_fps, target_frametime, lim_time, vsync_offset, i;\r
802         char *notice = 0;\r
803 \r
804         printf("entered emu_Loop()\n");\r
805 \r
806         if (gp2x_old_clock != currentConfig.CPUclock) {\r
807                 printf("changing clock to %i...", currentConfig.CPUclock); fflush(stdout);\r
808                 set_FCLK(currentConfig.CPUclock);\r
809                 gp2x_old_clock = currentConfig.CPUclock;\r
810                 printf(" done\n");\r
811         }\r
812 \r
813         if (gp2x_old_gamma != currentConfig.gamma || (EmuOpt_old&0x1000) != (currentConfig.EmuOpt&0x1000)) {\r
814                 set_gamma(currentConfig.gamma, !!(currentConfig.EmuOpt&0x1000));\r
815                 gp2x_old_gamma = currentConfig.gamma;\r
816                 printf("updated gamma to %i, A_SN's curve: %i\n", currentConfig.gamma, !!(currentConfig.EmuOpt&0x1000));\r
817         }\r
818 \r
819         if ((EmuOpt_old&0x2000) != (currentConfig.EmuOpt&0x2000)) {\r
820                 if (currentConfig.EmuOpt&0x2000)\r
821                      set_LCD_custom_rate(Pico.m.pal ? LCDR_100 : LCDR_120);\r
822                 else unset_LCD_custom_rate();\r
823         }\r
824 \r
825         EmuOpt_old = currentConfig.EmuOpt;\r
826         fpsbuff[0] = 0;\r
827 \r
828         // make sure we are in correct mode\r
829         vidResetMode();\r
830         scaling_update();\r
831         Pico.m.dirtyPal = 1;\r
832         oldmodes = ((Pico.video.reg[12]&1)<<2) ^ 0xc;\r
833         emu_findKeyBindCombos();\r
834 \r
835         // pal/ntsc might have changed, reset related stuff\r
836         target_fps = Pico.m.pal ? 50 : 60;\r
837         target_frametime = 1000000/target_fps;\r
838         reset_timing = 1;\r
839 \r
840         // prepare sound stuff\r
841         if (currentConfig.EmuOpt & 4)\r
842         {\r
843                 int snd_excess_add;\r
844                 if (PsndRate != PsndRate_old || (PicoOpt&0x20b) != (PicoOpt_old&0x20b) || Pico.m.pal != pal_old ||\r
845                                 ((PicoOpt&0x200) && crashed_940)) {\r
846                         PsndRerate(Pico.m.frame_count ? 1 : 0);\r
847                 }\r
848                 snd_excess_add = ((PsndRate - PsndLen*target_fps)<<16) / target_fps;\r
849                 printf("starting audio: %i len: %i (ex: %04x) stereo: %i, pal: %i\n",\r
850                         PsndRate, PsndLen, snd_excess_add, (PicoOpt&8)>>3, Pico.m.pal);\r
851                 gp2x_start_sound(PsndRate, 16, (PicoOpt&8)>>3);\r
852                 gp2x_sound_volume(currentConfig.volume, currentConfig.volume);\r
853                 PicoWriteSound = updateSound;\r
854                 update_volume(0, 0);\r
855                 memset(sndBuffer, 0, sizeof(sndBuffer));\r
856                 PsndOut = sndBuffer;\r
857                 PsndRate_old = PsndRate;\r
858                 PicoOpt_old  = PicoOpt;\r
859                 pal_old = Pico.m.pal;\r
860         } else {\r
861                 PsndOut = NULL;\r
862         }\r
863 \r
864         // prepare CD buffer\r
865         if (PicoAHW & PAHW_MCD) PicoCDBufferInit();\r
866 \r
867         // calc vsync offset to sync timing code with vsync\r
868         if (currentConfig.EmuOpt&0x2000) {\r
869                 gettimeofday(&tval, 0);\r
870                 gp2x_video_wait_vsync();\r
871                 gettimeofday(&tval, 0);\r
872                 vsync_offset = tval.tv_usec;\r
873                 while (vsync_offset >= target_frametime)\r
874                         vsync_offset -= target_frametime;\r
875                 if (!vsync_offset) vsync_offset++;\r
876                 printf("vsync_offset: %i\n", vsync_offset);\r
877         } else\r
878                 vsync_offset = 0;\r
879 \r
880         frames_done = frames_shown = thissec =\r
881         pframes_done = pframes_shown = pthissec = 0;\r
882 \r
883         // loop\r
884         while (engineState == PGS_Running)\r
885         {\r
886                 int modes;\r
887 \r
888                 gettimeofday(&tval, 0);\r
889                 if (reset_timing) {\r
890                         reset_timing = 0;\r
891                         pthissec = tval.tv_sec;\r
892                         pframes_shown = pframes_done = tval.tv_usec/target_frametime;\r
893                 }\r
894 \r
895                 // show notice message?\r
896                 if (noticeMsgTime.tv_sec)\r
897                 {\r
898                         static int noticeMsgSum;\r
899                         if((tval.tv_sec*1000000+tval.tv_usec) - (noticeMsgTime.tv_sec*1000000+noticeMsgTime.tv_usec) > 2000000) { // > 2.0 sec\r
900                                 noticeMsgTime.tv_sec = noticeMsgTime.tv_usec = 0;\r
901                                 clearArea(0);\r
902                                 notice = 0;\r
903                         } else {\r
904                                 int sum = noticeMsg[0]+noticeMsg[1]+noticeMsg[2];\r
905                                 if (sum != noticeMsgSum) { clearArea(0); noticeMsgSum = sum; }\r
906                                 notice = noticeMsg;\r
907                         }\r
908                 }\r
909 \r
910                 // check for mode changes\r
911                 modes = ((Pico.video.reg[12]&1)<<2)|(Pico.video.reg[1]&8);\r
912                 if (modes != oldmodes)\r
913                 {\r
914                         int scalex = 320;\r
915                         osd_fps_x = OSD_FPS_X;\r
916                         if (modes & 4) {\r
917                                 vidCpyM2 = vidCpyM2_40col;\r
918                         } else {\r
919                                 if (PicoOpt & 0x100) {\r
920                                         vidCpyM2 = vidCpyM2_32col_nobord;\r
921                                         scalex = 256;\r
922                                         osd_fps_x = OSD_FPS_X - 64;\r
923                                 } else {\r
924                                         vidCpyM2 = vidCpyM2_32col;\r
925                                 }\r
926                         }\r
927                         if (currentConfig.scaling == 2 && !(modes&8)) // want vertical scaling and game is not in 240 line mode\r
928                              gp2x_video_RGB_setscaling(8, scalex, 224);\r
929                         else gp2x_video_RGB_setscaling(0, scalex, 240);\r
930                         oldmodes = modes;\r
931                         clearArea(1);\r
932                 }\r
933 \r
934                 // second changed?\r
935                 if (thissec != tval.tv_sec)\r
936                 {\r
937 #ifdef BENCHMARK\r
938                         static int bench = 0, bench_fps = 0, bench_fps_s = 0, bfp = 0, bf[4];\r
939                         if (++bench == 10) {\r
940                                 bench = 0;\r
941                                 bench_fps_s = bench_fps;\r
942                                 bf[bfp++ & 3] = bench_fps;\r
943                                 bench_fps = 0;\r
944                         }\r
945                         bench_fps += frames_shown;\r
946                         sprintf(fpsbuff, "%02i/%02i/%02i", frames_shown, bench_fps_s, (bf[0]+bf[1]+bf[2]+bf[3])>>2);\r
947 #else\r
948                         if (currentConfig.EmuOpt & 2) {\r
949                                 sprintf(fpsbuff, "%02i/%02i", frames_shown, frames_done);\r
950                                 if (fpsbuff[5] == 0) { fpsbuff[5] = fpsbuff[6] = ' '; fpsbuff[7] = 0; }\r
951                         }\r
952 #endif\r
953                         frames_shown = frames_done = 0;\r
954                         thissec = tval.tv_sec;\r
955                 }\r
956 #ifdef PFRAMES\r
957                 sprintf(fpsbuff, "%i", Pico.m.frame_count);\r
958 #endif\r
959 \r
960                 if (pthissec != tval.tv_sec)\r
961                 {\r
962                         if (PsndOut == 0 && currentConfig.Frameskip >= 0) {\r
963                                 pframes_done = pframes_shown = 0;\r
964                         } else {\r
965                                 // it is quite common for this implementation to leave 1 fame unfinished\r
966                                 // when second changes, but we don't want buffer to starve.\r
967                                 if(PsndOut && pframes_done < target_fps && pframes_done > target_fps-5) {\r
968                                         updateKeys();\r
969                                         SkipFrame(1); pframes_done++;\r
970                                 }\r
971 \r
972                                 pframes_done  -= target_fps; if (pframes_done  < 0) pframes_done  = 0;\r
973                                 pframes_shown -= target_fps; if (pframes_shown < 0) pframes_shown = 0;\r
974                                 if (pframes_shown > pframes_done) pframes_shown = pframes_done;\r
975                         }\r
976                         pthissec = tval.tv_sec;\r
977                 }\r
978 \r
979                 lim_time = (pframes_done+1) * target_frametime + vsync_offset;\r
980                 if (currentConfig.Frameskip >= 0) // frameskip enabled\r
981                 {\r
982                         for(i = 0; i < currentConfig.Frameskip; i++) {\r
983                                 updateKeys();\r
984                                 SkipFrame(1); pframes_done++; frames_done++;\r
985                                 if (PsndOut && !reset_timing) { // do framelimitting if sound is enabled\r
986                                         gettimeofday(&tval, 0);\r
987                                         if (pthissec != tval.tv_sec) tval.tv_usec+=1000000;\r
988                                         if (tval.tv_usec < lim_time) { // we are too fast\r
989                                                 simpleWait(pthissec, lim_time);\r
990                                         }\r
991                                 }\r
992                                 lim_time += target_frametime;\r
993                         }\r
994                 }\r
995                 else if (tval.tv_usec > lim_time) // auto frameskip\r
996                 {\r
997                         // no time left for this frame - skip\r
998                         if (tval.tv_usec - lim_time >= 300000) {\r
999                                 /* something caused a slowdown for us (disk access? cache flush?)\r
1000                                  * try to recover by resetting timing... */\r
1001                                 reset_timing = 1;\r
1002                                 continue;\r
1003                         }\r
1004                         updateKeys();\r
1005                         SkipFrame(tval.tv_usec < lim_time+target_frametime*2); pframes_done++; frames_done++;\r
1006                         continue;\r
1007                 }\r
1008 \r
1009                 updateKeys();\r
1010                 PicoFrame();\r
1011 \r
1012                 // check time\r
1013                 gettimeofday(&tval, 0);\r
1014                 if (pthissec != tval.tv_sec) tval.tv_usec+=1000000;\r
1015 \r
1016                 if (currentConfig.Frameskip < 0 && tval.tv_usec - lim_time >= 300000) // slowdown detection\r
1017                         reset_timing = 1;\r
1018                 else if (PsndOut != NULL || currentConfig.Frameskip < 0)\r
1019                 {\r
1020                         // sleep or vsync if we are still too fast\r
1021                         // usleep sleeps for ~20ms minimum, so it is not a solution here\r
1022                         if (!reset_timing && tval.tv_usec < lim_time)\r
1023                         {\r
1024                                 // we are too fast\r
1025                                 if (vsync_offset) {\r
1026                                         if (lim_time - tval.tv_usec > target_frametime/2)\r
1027                                                 simpleWait(pthissec, lim_time - target_frametime/4);\r
1028                                         gp2x_video_wait_vsync();\r
1029                                 } else {\r
1030                                         simpleWait(pthissec, lim_time);\r
1031                                 }\r
1032                         }\r
1033                 }\r
1034 \r
1035                 blit(fpsbuff, notice);\r
1036 \r
1037                 pframes_done++; pframes_shown++;\r
1038                  frames_done++;  frames_shown++;\r
1039         }\r
1040 \r
1041         emu_changeFastForward(0);\r
1042 \r
1043         if (PicoAHW & PAHW_MCD) PicoCDBufferFree();\r
1044 \r
1045         // save SRAM\r
1046         if((currentConfig.EmuOpt & 1) && SRam.changed) {\r
1047                 emu_state_cb("Writing SRAM/BRAM..");\r
1048                 emu_SaveLoadGame(0, 1);\r
1049                 SRam.changed = 0;\r
1050         }\r
1051 \r
1052         // if in 8bit mode, generate 16bit image for menu background\r
1053         if ((PicoOpt&0x10) || !(currentConfig.EmuOpt&0x80))\r
1054                 emu_forcedFrame(POPT_EN_SOFTSCALE);\r
1055 }\r
1056 \r
1057 \r
1058 void emu_ResetGame(void)\r
1059 {\r
1060         PicoReset();\r
1061         reset_timing = 1;\r
1062 }\r
1063 \r