This source file includes following definitions.
- taskHook
- boot
- sub_FF810380_my
- sub_FF8111D8_my
- sub_FF814288_my
- sub_FF81A6A8_my
- taskcreate_Startup_my
- task_Startup_my
- taskcreatePhySw_my
- CreateTask_spytask
- init_file_modules_task
- task_TouchPanel_my
- sub_FF8591CC_my
- sub_FF858F90_my
- sub_FF8590B4_my
- sub_FF858E74_my
1 #include "lolevel.h"
2 #include "platform.h"
3 #include "core.h"
4 #include "dryos31.h"
5 #define offsetof(TYPE, MEMBER) ((int) &((TYPE *)0)->MEMBER)
6
7 const char * const new_sa = &_end;
8
9 void CreateTask_PhySw();
10 void CreateTask_spytask();
11
12 extern void task_CaptSeq();
13 extern void task_InitFileModules();
14 extern void task_MovieRecord();
15 extern void task_ExpDrv();
16 extern void task_PhySw();
17 extern void task_FileWrite();
18 #if 0
19 extern void task_TouchPanel();
20 void task_TouchPanel_my(void);
21 #endif
22
23 void taskHook(context_t **context) {
24
25 task_t *tcb=(task_t*)((char*)context-offsetof(task_t, context));
26
27 if(tcb->entry == (void*)task_PhySw) tcb->entry = (void*)mykbd_task;
28 if(tcb->entry == (void*)task_CaptSeq) tcb->entry = (void*)capt_seq_task;
29 if(tcb->entry == (void*)task_InitFileModules) tcb->entry = (void*)init_file_modules_task;
30 if(tcb->entry == (void*)task_MovieRecord) tcb->entry = (void*)movie_record_task;
31 if(tcb->entry == (void*)task_ExpDrv) tcb->entry = (void*)exp_drv_task;
32 if(tcb->entry == (void*)task_FileWrite) tcb->entry = (void*)filewritetask;
33 #if 0
34 if(tcb->entry == (void*)task_TouchPanel) tcb->entry = (void*)task_TouchPanel_my;
35 #endif
36 }
37
38
39
40 void __attribute__((naked,noinline)) boot() {
41 asm volatile (
42 "LDR R1, =0xC0410000\n"
43 "MOV R0, #0\n"
44 "STR R0, [R1]\n"
45 "MOV R1, #0x78\n"
46 "MCR p15, 0, R1, c1, c0\n"
47 "MOV R1, #0\n"
48 "MCR p15, 0, R1, c7, c10, 4\n"
49 "MCR p15, 0, R1, c7, c5\n"
50 "MCR p15, 0, R1, c7, c6\n"
51 "MOV R0, #0x3D\n"
52 "MCR p15, 0, R0, c6, c0\n"
53 "MOV R0, #0xC000002F\n"
54 "MCR p15, 0, R0, c6, c1\n"
55 "MOV R0, #0x33\n"
56 "MCR p15, 0, R0, c6, c2\n"
57 "MOV R0, #0x40000033\n"
58 "MCR p15, 0, R0, c6, c3\n"
59 "MOV R0, #0x80000017\n"
60 "MCR p15, 0, R0, c6, c4\n"
61 "LDR R0, =0xFF80002D\n"
62 "MCR p15, 0, R0, c6, c5\n"
63 "MOV R0, #0x34\n"
64 "MCR p15, 0, R0, c2, c0\n"
65 "MOV R0, #0x34\n"
66 "MCR p15, 0, R0, c2, c0, 1\n"
67 "MOV R0, #0x34\n"
68 "MCR p15, 0, R0, c3, c0\n"
69 "LDR R0, =0x3333330\n"
70 "MCR p15, 0, R0, c5, c0, 2\n"
71 "LDR R0, =0x3333330\n"
72 "MCR p15, 0, R0, c5, c0, 3\n"
73 "MRC p15, 0, R0, c1, c0\n"
74 "ORR R0, R0, #0x1000\n"
75 "ORR R0, R0, #4\n"
76 "ORR R0, R0, #1\n"
77 "MCR p15, 0, R0, c1, c0\n"
78 "MOV R1, #0x80000006\n"
79 "MCR p15, 0, R1, c9, c1\n"
80 "MOV R1, #6\n"
81 "MCR p15, 0, R1, c9, c1, 1\n"
82 "MRC p15, 0, R1, c1, c0\n"
83 "ORR R1, R1, #0x50000\n"
84 "MCR p15, 0, R1, c1, c0\n"
85 "LDR R2, =0xC0200000\n"
86 "MOV R1, #1\n"
87 "STR R1, [R2, #0x10C]\n"
88 "MOV R1, #0xFF\n"
89 "STR R1, [R2, #0xC]\n"
90 "STR R1, [R2, #0x1C]\n"
91 "STR R1, [R2, #0x2C]\n"
92 "STR R1, [R2, #0x3C]\n"
93 "STR R1, [R2, #0x4C]\n"
94 "STR R1, [R2, #0x5C]\n"
95 "STR R1, [R2, #0x6C]\n"
96 "STR R1, [R2, #0x7C]\n"
97 "STR R1, [R2, #0x8C]\n"
98 "STR R1, [R2, #0x9C]\n"
99 "STR R1, [R2, #0xAC]\n"
100 "STR R1, [R2, #0xBC]\n"
101 "STR R1, [R2, #0xCC]\n"
102 "STR R1, [R2, #0xDC]\n"
103 "STR R1, [R2, #0xEC]\n"
104 "STR R1, [R2, #0xFC]\n"
105 "LDR R1, =0xC0400008\n"
106 "LDR R2, =0x430005\n"
107 "STR R2, [R1]\n"
108 "MOV R1, #1\n"
109 "LDR R2, =0xC0243100\n"
110 "STR R2, [R1]\n"
111 "LDR R2, =0xC0242010\n"
112 "LDR R1, [R2]\n"
113 "ORR R1, R1, #1\n"
114 "STR R1, [R2]\n"
115 "LDR R0, =0xFFC255D8\n"
116 "LDR R1, =0x3F1000\n"
117 "LDR R3, =0x400654\n"
118 "loc_FF81013C:\n"
119 "CMP R1, R3\n"
120 "LDRCC R2, [R0], #4\n"
121 "STRCC R2, [R1], #4\n"
122 "BCC loc_FF81013C\n"
123 "LDR R0, =0xFFC194A0\n"
124 "LDR R1, =0x1900\n"
125 "LDR R3, =0xDA38\n"
126 "loc_FF810158:\n"
127 "CMP R1, R3\n"
128 "LDRCC R2, [R0], #4\n"
129 "STRCC R2, [R1], #4\n"
130 "BCC loc_FF810158\n"
131 "LDR R1, =0x15969C\n"
132 "MOV R2, #0\n"
133 "loc_FF810170:\n"
134 "CMP R3, R1\n"
135 "STRCC R2, [R3], #4\n"
136 "BCC loc_FF810170\n"
137
138 "B sub_FF810380_my \n"
139 );
140 }
141
142
143
144 void __attribute__((naked,noinline)) sub_FF810380_my() {
145
146
147 *(int*)0x1934=(int)taskHook;
148 *(int*)0x1938=(int)taskHook;
149
150
151
152
153 if ((*(int*) 0xC02200F8) & 1)
154 *(int*)(0x24B8+4) = 0x200000;
155 else
156 *(int*)(0x24B8+4) = 0x100000;
157
158 asm volatile (
159 "LDR R0, =0xFF8103F8\n"
160 "MOV R1, #0\n"
161 "LDR R3, =0xFF810430\n"
162 "loc_FF81038C:\n"
163 "CMP R0, R3\n"
164 "LDRCC R2, [R0], #4\n"
165 "STRCC R2, [R1], #4\n"
166 "BCC loc_FF81038C\n"
167 "LDR R0, =0xFF810430\n"
168 "MOV R1, #0x4B0\n"
169 "LDR R3, =0xFF810644\n"
170 "loc_FF8103A8:\n"
171 "CMP R0, R3\n"
172 "LDRCC R2, [R0], #4\n"
173 "STRCC R2, [R1], #4\n"
174 "BCC loc_FF8103A8\n"
175 "MOV R0, #0xD2\n"
176 "MSR CPSR_cxsf, R0\n"
177 "MOV SP, #0x1000\n"
178 "MOV R0, #0xD3\n"
179 "MSR CPSR_cxsf, R0\n"
180 "MOV SP, #0x1000\n"
181 "LDR R0, =0x6C4\n"
182 "LDR R2, =0xEEEEEEEE\n"
183 "MOV R3, #0x1000\n"
184 "loc_FF8103DC:\n"
185 "CMP R0, R3\n"
186 "STRCC R2, [R0], #4\n"
187 "BCC loc_FF8103DC\n"
188
189 "BL sub_FF8111D8_my \n"
190 );
191 }
192
193
194
195 void __attribute__((naked,noinline)) sub_FF8111D8_my() {
196 asm volatile (
197 "STR LR, [SP, #-4]!\n"
198 "SUB SP, SP, #0x74\n"
199 "MOV R1, #0x74\n"
200 "MOV R0, SP\n"
201 "BL sub_003FC448\n"
202 "MOV R0, #0x57000\n"
203 "STR R0, [SP, #4]\n"
204 #if defined(CHDK_NOT_IN_CANON_HEAP)
205 "LDR R0, =0x15969C\n"
206 #else
207 "LDR R0, =new_sa \n"
208 "LDR R0, [R0] \n"
209 #endif
210 "LDR R2, =0x2ED440\n"
211 "STR R0, [SP, #8]\n"
212 "SUB R0, R2, R0\n"
213 "STR R0, [SP, #0xC]\n"
214 "MOV R0, #0x22\n"
215 "STR R0, [SP, #0x18]\n"
216 "MOV R0, #0x7C\n"
217 "STR R0, [SP, #0x1C]\n"
218 "LDR R1, =0x2F5C00\n"
219 "LDR R0, =0x1CD\n"
220 "STR R1, [SP]\n"
221 "STR R0, [SP, #0x20]\n"
222 "MOV R0, #0x96\n"
223 "STR R2, [SP, #0x10]\n"
224 "STR R1, [SP, #0x14]\n"
225 "STR R0, [SP, #0x24]\n"
226 "STR R0, [SP, #0x28]\n"
227 "MOV R0, #0x64\n"
228 "STR R0, [SP, #0x2C]\n"
229 "MOV R0, #0\n"
230 "STR R0, [SP, #0x30]\n"
231 "STR R0, [SP, #0x34]\n"
232 "MOV R0, #0x10\n"
233 "STR R0, [SP, #0x5C]\n"
234 "MOV R0, #0x800\n"
235 "STR R0, [SP, #0x60]\n"
236 "MOV R0, #0xA0\n"
237 "STR R0, [SP, #0x64]\n"
238 "MOV R0, #0x280\n"
239 "STR R0, [SP, #0x68]\n"
240
241 "LDR R1, =sub_FF814288_my \n"
242 "MOV R2, #0\n"
243 "MOV R0, SP\n"
244 "BL sub_003F2778 \n"
245 "ADD SP, SP, #0x74\n"
246 "LDR PC, [SP], #4\n"
247 );
248 }
249
250
251
252 void __attribute__((naked,noinline)) sub_FF814288_my() {
253 asm volatile (
254 "STMFD SP!, {R4,LR}\n"
255 "BL sub_FF810B50\n"
256 "BL sub_FF815174\n"
257 "CMP R0, #0\n"
258 "LDRLT R0, =0xFF81439C \n"
259 "BLLT _err_init_task \n"
260 "BL sub_FF813EC0\n"
261 "CMP R0, #0\n"
262 "LDRLT R0, =0xFF8143A4 \n"
263 "BLLT _err_init_task \n"
264 "LDR R0, =0xFF8143B4 \n"
265 "BL sub_FF813FA8\n"
266 "CMP R0, #0\n"
267 "LDRLT R0, =0xFF8143BC \n"
268 "BLLT _err_init_task \n"
269 "LDR R0, =0xFF8143B4 \n"
270 "BL sub_FF8129C8\n"
271 "CMP R0, #0\n"
272 "LDRLT R0, =0xFF8143D0 \n"
273 "BLLT _err_init_task \n"
274 "BL sub_FF814B10\n"
275 "CMP R0, #0\n"
276 "LDRLT R0, =0xFF8143DC \n"
277 "BLLT _err_init_task \n"
278 "BL sub_FF8116C8\n"
279 "CMP R0, #0\n"
280 "LDRLT R0, =0xFF8143E8 \n"
281 "BLLT _err_init_task \n"
282 "LDMFD SP!, {R4,LR}\n"
283
284 "B sub_FF81A6A8_my \n"
285 );
286 }
287
288
289
290
291 void __attribute__((naked,noinline)) sub_FF81A6A8_my() {
292 asm volatile (
293 "STMFD SP!, {R4,LR}\n"
294 "BL sub_FF82EB0C\n"
295
296 "BL taskcreate_Startup_my \n"
297 "MOV R0, #0\n"
298 "LDMFD SP!, {R4,PC}\n"
299 );
300 }
301
302
303
304 void __attribute__((naked,noinline)) taskcreate_Startup_my() {
305 asm volatile (
306 "STMFD SP!, {R3-R7,LR}\n"
307 "BL sub_FF835B90\n"
308 "LDR R6, =0xC0220000\n"
309 "MOVS R4, R0\n"
310 "MOV R5, #1\n"
311 "BNE loc_FF81A70C\n"
312 "BL sub_FF830568\n"
313 "CMP R0, #0\n"
314 "BEQ loc_FF81A70C\n"
315 "LDR R0, [R6, #0xFC]\n"
316 "BIC R1, R5, R0\n"
317 "LDR R0, [R6, #0xF8]\n"
318 "BIC R0, R5, R0\n"
319 "ORRS R2, R0, R1\n"
320 "BNE loc_FF81A71C\n"
321 "BL sub_FF82E1C8\n"
322 "MOV R0, #0x44\n"
323 "STR R0, [R6, #0x12C]\n"
324 "BL sub_FF82E2E4\n"
325 "loc_FF81A708:\n"
326 "B loc_FF81A708\n"
327 "loc_FF81A70C:\n"
328 "LDR R0, [R6, #0xF8]\n"
329 "LDR R1, [R6, #0xFC]\n"
330 "BIC R0, R5, R0\n"
331 "BIC R1, R5, R1\n"
332 "loc_FF81A71C:\n"
333 "MOV R3, #0\n"
334 "MOV R2, R4\n"
335
336 "BL sub_FF82EB10\n"
337 "BL sub_003F77E0 \n"
338 "LDR R1, =0x34E000\n"
339 "MOV R0, #0\n"
340 "BL sub_FF8341C8\n"
341 "BL sub_003F79F8 \n"
342 "MOV R3, #0\n"
343 "STR R3, [SP]\n"
344
345 "LDR R3, =task_Startup_my \n"
346 "MOV R2, #0\n"
347 "MOV R1, #0x19\n"
348 "LDR R0, =0xFF81A770\n"
349 "BL _CreateTask \n"
350 "MOV R0, #0\n"
351 "LDMFD SP!, {R3-R7,PC}\n"
352 );
353 }
354
355
356
357
358 void __attribute__((naked,noinline)) task_Startup_my() {
359 asm volatile (
360 "STMFD SP!, {R4,LR}\n"
361 "BL sub_FF8148C8\n"
362 "BL sub_FF82FC34\n"
363 "BL sub_FF82DE60\n"
364 "BL sub_FF835BD8\n"
365 "BL sub_FF835DC4\n"
366 "BL sub_FF82CC5C\n"
367 "BL sub_FF82D824\n"
368
369 "BL sub_FF835F44\n"
370 "BL sub_FF836110\n"
371 "BL sub_FF835F08\n"
372 "BL sub_FF835DF4\n"
373 "BL sub_FF8340FC\n"
374 "BL sub_FF836118\n"
375 "BL CreateTask_spytask \n"
376
377 "BL taskcreatePhySw_my \n"
378 "BL sub_FF832390\n"
379 "BL sub_FF836130\n"
380 "BL sub_FF82B9D8\n"
381 "BL sub_FF82C520\n"
382 "BL sub_FF83594C\n"
383 "BL sub_FF82CB4C\n"
384 "BL sub_FF82C4BC\n"
385 "BL sub_FF835F34\n"
386 "BL sub_FF836C88\n"
387 "BL sub_FF82C480\n"
388 "LDMFD SP!, {R4,LR}\n"
389 "B sub_FF8149E8\n"
390 );
391 }
392
393
394
395
396 void __attribute__((naked,noinline)) taskcreatePhySw_my() {
397 asm volatile (
398 "STMFD SP!, {R3-R5,LR}\n"
399 "LDR R4, =0x1C18\n"
400 "LDR R0, [R4, #4]\n"
401 "CMP R0, #0\n"
402 "BNE loc_FF82E9E4\n"
403 "MOV R3, #0\n"
404 "STR R3, [SP]\n"
405
406 "LDR R3, =mykbd_task \n"
407
408 "MOV R2, #0x2000 \n"
409 "MOV R1, #0x17\n"
410 "LDR R0, =0xFF82EC0C\n"
411 "BL sub_003F7A50\n"
412 "STR R0, [R4, #4]\n"
413 "loc_FF82E9E4:\n"
414 "BL sub_FF880638\n"
415 "BL sub_FF8304B8\n"
416 "CMP R0, #0\n"
417 "BNE loc_FF82EA00\n"
418 "LDR R1, =0x31BCC\n"
419 "MOV R0, #0\n"
420 "BL sub_FF8805A8\n"
421 "loc_FF82EA00:\n"
422 "LDMFD SP!, {R3-R5,PC}\n"
423 );
424 }
425
426 void CreateTask_spytask() {
427
428 _CreateTask("SpyTask", 0x19, 0x2000, core_spytask, 0);
429 };
430
431
432
433 void __attribute__((naked,noinline)) init_file_modules_task( ) {
434 asm volatile (
435 "STMFD SP!, {R4-R6,LR}\n"
436 "BL sub_FF882BA4\n"
437 "LDR R5, =0x5006\n"
438 "MOVS R4, R0\n"
439 "MOVNE R1, #0\n"
440 "MOVNE R0, R5\n"
441 "BLNE _PostLogicalEventToUI \n"
442 "BL sub_FF882BD0\n"
443 "BL core_spytask_can_start \n"
444 "CMP R4, #0\n"
445 "LDMNEFD SP!, {R4-R6,PC}\n"
446 "MOV R0, R5\n"
447 "LDMFD SP!, {R4-R6,LR}\n"
448 "MOV R1, #0\n"
449 "B _PostLogicalEventToUI \n"
450 );
451 }
452
453 #if 0
454 void __attribute__((naked,noinline)) task_TouchPanel_my( ) {
455 asm volatile (
456 " STMFD SP!, {R3-R7,LR} \n"
457 " MOV R0, #0 \n"
458 " LDR R1, =0xC0221000 \n"
459 " MOV R4, R0 \n"
460 " STR R0, [SP] \n"
461 " MOV R0, #0xB \n"
462 " STR R0, [R1, #0x314] \n"
463 " MOV R0, #0x1C \n"
464 " SUB R1, R1, #0x1E000 \n"
465 " STR R0, [R1, #0x40] \n"
466 " MOV R3, #0 \n"
467 " LDR R2, =0xFF858DD0 \n"
468 " MOV R1, #0x55 \n"
469 " MOV R0, R3 \n"
470 " BL sub_003F67BC \n"
471 " BL sub_FF85966C \n"
472 " LDR R5, =0x25A8 \n"
473 " MOV R1, #0x10 \n"
474 " LDR R0, [R5, #0x20] \n"
475 " BL sub_003FACA0 \n"
476 " MOV R6, #7 \n"
477 "loc_FF859268:\n"
478 " LDR R0, [R5, #0x20] \n"
479 " MOV R2, #0 \n"
480 " MOV R1, #0x17 \n"
481 " BL sub_003FAAC8 \n"
482 " CMP R0, #0 \n"
483 " LDRNE R0, =0xFF858E04 \n"
484 " MOVNE R1, #0x31C \n"
485 " BLNE sub_003F6AFC \n"
486 " LDR R0, [R5, #0x20] \n"
487 " MOV R1, SP \n"
488 " BL sub_003FACD8 \n"
489 " CMP R0, #0 \n"
490 " LDRNE R1, =0x31D \n"
491 " LDRNE R0, =0xFF858E04 \n"
492 " BLNE sub_003F6AFC \n"
493 " LDR R0, [SP] \n"
494 " TST R0, #1 \n"
495 " BEQ loc_FF8592E8 \n"
496 " LDR R0, [R5, #4] \n"
497 " CMP R0, #7 \n"
498 " BEQ loc_FF8592C4 \n"
499 " BL sub_FF87D9D0 \n"
500 " STR R6, [R5, #4] \n"
501 "loc_FF8592C4:\n"
502 " LDR R0, [R5, #0x20] \n"
503 " MOV R1, #5 \n"
504 " BL sub_003FACA0 \n"
505 " BL sub_FF858E2C \n"
506 " MOV R4, #0 \n"
507 " BL sub_FF85966C \n"
508 " LDR R0, [R5, #0x20] \n"
509 " MOV R1, #0x80000000 \n"
510 " BL sub_003FAC6C \n"
511 "loc_FF8592E8:\n"
512 " LDR R0, [SP] \n"
513 " TST R0, #2 \n"
514 " BEQ loc_FF859318 \n"
515 " LDR R0, [R5, #0x20] \n"
516 " MOV R1, #2 \n"
517 " BL sub_003FACA0 \n"
518 " CMP R4, #0 \n"
519 " BNE loc_FF859268 \n"
520 " LDR R0, =0xBB8 \n"
521 " BL sub_FF858C2C \n"
522 " MOV R4, #1 \n"
523 " BL sub_FF859798 \n"
524 "loc_FF859318:\n"
525 " LDR R0, [SP] \n"
526 " TST R0, #0x10 \n"
527 " BEQ loc_FF859360 \n"
528 " LDR R0, [R5, #4] \n"
529 " CMP R0, #7 \n"
530 " BEQ loc_FF859338 \n"
531 " BL sub_FF87D9D0 \n"
532 " STR R6, [R5, #4] \n"
533 "loc_FF859338:\n"
534 " BL sub_FF85966C \n"
535 " LDR R0, [R5, #0x20] \n"
536 " MOV R1, #0x14 \n"
537 " BL sub_003FACA0 \n"
538 " CMP R4, #0 \n"
539 " BEQ loc_FF859268 \n"
540 " BL sub_FF8591CC_my \n"
541 " LDR R0, [R5, #0xC] \n"
542 " CMP R0, #0 \n"
543 " BLNE sub_FF859774 \n"
544 "loc_FF859360:\n"
545 " LDR R0, [SP] \n"
546 " TST R0, #4 \n"
547 " BEQ loc_FF859268 \n"
548 " STR R6, [R5, #4] \n"
549 " LDR R0, [R5, #0x20] \n"
550 " MOV R1, #4 \n"
551 " BL sub_003FACA0 \n"
552 " CMP R4, #0 \n"
553 " BEQ loc_FF859268 \n"
554 " BL sub_FF8591CC_my \n"
555 " LDR R0, [R5, #0xC] \n"
556 " CMP R0, #0 \n"
557 " BLNE sub_FF859774 \n"
558 " B loc_FF859268 \n"
559 );
560 }
561
562 void __attribute__((naked,noinline)) sub_FF8591CC_my( ) {
563 asm volatile (
564 " LDR R1, =0x25A8 \n"
565 " LDR R0, [R1, #0xC] \n"
566 " CMP R0, #0 \n"
567 " BEQ loc_FF8591F8 \n"
568 " CMP R0, #1 \n"
569 " BEQ sub_FF858F90_my \n"
570 " CMP R0, #2 \n"
571 " BEQ sub_FF8590B4_my \n"
572 " LDRNE R1, =0x307 \n"
573 " LDRNE R0, =0xFF858E04 \n"
574 " BNE sub_003F6AFC \n"
575 "loc_FF8591F8:\n"
576 " LDR R0, =0xC0220000 \n"
577 " LDR R0, [R0, #0x2C] \n"
578 " TST R0, #1 \n"
579 " BNE sub_FF859798 \n"
580 " MOV R0, #1 \n"
581 " STR R0, [R1, #0xC] \n"
582 " BX LR \n"
583 );
584 }
585
586
587 void __attribute__((naked,noinline)) sub_FF858F90_my( ) {
588 asm volatile (
589 " STMFD SP!, {R3-R7,LR} \n"
590 " LDR R6, =0xC0220000 \n"
591 " LDR R0, [R6, #0x2C] \n"
592 " TST R0, #1 \n"
593 " BNE loc_FF8590AC \n"
594 " LDR R1, =0x25D4 \n"
595 " MOV R0, #0 \n"
596 " BL sub_FF858C8C \n"
597 " LDR R4, =0x25D4 \n"
598 " LDR R5, =0x3FF \n"
599 " LDRH R0, [R4, #6] \n"
600 " BIC R0, R0, #0x8000 \n"
601 " EOR R2, R5, R0, LSR #5 \n"
602 " LDRH R0, [R4, #4] \n"
603 " BIC R0, R0, #0x8000 \n"
604 " EOR R1, R5, R0, LSR #5 \n"
605 " LDRH R0, [R4, #2] \n"
606 " BIC R0, R0, #0x8000 \n"
607 " EOR R0, R5, R0, LSR #5 \n"
608 " BL sub_FF858DB4 \n"
609 " CMP R0, #0x1F40 \n"
610 " BGT loc_FF859058 \n"
611 " LDR R0, =0x2710 \n"
612 " BL sub_FF858C2C \n"
613 " LDR R0, [R6, #0x2C] \n"
614 " SUB R6, R4, #0x2C \n"
615 " TST R0, #1 \n"
616 " BNE loc_FF85905C \n"
617 " ADD R1, R4, #0 \n"
618 " MOV R0, #0 \n"
619 " BL sub_FF858C8C \n"
620 " LDRH R0, [R4, #6] \n"
621 " BIC R0, R0, #0x8000 \n"
622 " EOR R2, R5, R0, LSR #5 \n"
623 " LDRH R0, [R4, #4] \n"
624 " BIC R0, R0, #0x8000 \n"
625 " EOR R1, R5, R0, LSR #5 \n"
626 " LDRH R0, [R4, #2] \n"
627 " BIC R0, R0, #0x8000 \n"
628 " EOR R0, R5, R0, LSR #5 \n"
629 " BL sub_FF858DB4 \n"
630 " CMP R0, #0x1F40 \n"
631 " BGT loc_FF859058 \n"
632 " BL sub_FF858E74_my \n"
633 " MOV R0, #3 \n"
634 " STR R0, [R6, #0x10] \n"
635 " MOV R0, #2 \n"
636 " STR R0, [R6, #0xC] \n"
637 " MVN R0, #0x8000 \n"
638 " STRH R0, [R4] \n"
639 "loc_FF859058:\n"
640 " LDMFD SP!, {R3-R7,PC} \n"
641 "loc_FF85905C:\n"
642 " LDR R0, [R6, #0x14] \n"
643 " CMP R0, #0 \n"
644 " LDRNE R0, =0xFF8591C4 \n"
645 " BLNE sub_FF8117C8 \n"
646 " LDRH R0, [R4, #6] \n"
647 " BIC R0, R0, #0x8000 \n"
648 " EOR R3, R5, R0, LSR #5 \n"
649 " STR R3, [SP] \n"
650 " LDRH R0, [R4, #4] \n"
651 " LDR R12, [R6, #0x18] \n"
652 " BIC R0, R0, #0x8000 \n"
653 " EOR R3, R5, R0, LSR #5 \n"
654 " LDRH R0, [R4, #2] \n"
655 " BIC R0, R0, #0x8000 \n"
656 " EOR R2, R5, R0, LSR #5 \n"
657 " LDRH R0, [R4] \n"
658 " BIC R0, R0, #0x8000 \n"
659 " EOR R1, R5, R0, LSR #5 \n"
660 " MOV R0, #0 \n"
661 " BLX R12 \n"
662 "loc_FF8590AC:\n"
663 " BL sub_FF858E2C \n"
664 " LDMFD SP!, {R3-R7,PC} \n"
665 );
666 }
667
668
669 void __attribute__((naked,noinline)) sub_FF8590B4_my( ) {
670 asm volatile (
671 "loc_FF8590B4:\n"
672 " STMFD SP!, {R3-R9,LR} \n"
673 " LDR R7, =0xC0220000 \n"
674 " LDR R0, [R7, #0x2C] \n"
675 " LDR R5, =0x25A8 \n"
676 " TST R0, #1 \n"
677 " LDR R0, [R5, #0x10] \n"
678 " LDR R6, =0x2710 \n"
679 " SUB R0, R0, #1 \n"
680 " BEQ loc_FF8590EC \n"
681 " CMP R0, #0 \n"
682 " STR R0, [R5, #0x10] \n"
683 " LDMEQFD SP!, {R3-R9,LR} \n"
684 " BEQ sub_FF858E2C \n"
685 " B loc_FF859110 \n"
686 "loc_FF8590EC:\n"
687 " LDR R4, =0x25D4 \n"
688 " LDR R8, =0x7FFF \n"
689 " MOV R1, #3 \n"
690 " CMP R0, #2 \n"
691 " STR R1, [R5, #0x10] \n"
692 " BCS loc_FF85911C \n"
693 " LDRH R0, [R4] \n"
694 " CMP R0, R8 \n"
695 " BNE loc_FF8591A0 \n"
696 "loc_FF859110:\n"
697 " MOV R0, R6 \n"
698 " LDMFD SP!, {R3-R9,LR} \n"
699 " B sub_FF858C2C \n"
700 "loc_FF85911C:\n"
701 " LDR R1, =0x25D4 \n"
702 " MOV R0, #0 \n"
703 " BL sub_FF858C8C \n"
704 " MOV R0, R6 \n"
705 " BL sub_FF858C2C \n"
706 " LDR R0, [R7, #0x2C] \n"
707 " TST R0, #1 \n"
708 " BEQ loc_FF8591A0 \n"
709 " LDR R0, [R5, #0x14] \n"
710 " CMP R0, #0 \n"
711 " LDRNE R0, =0xFF8591C4 \n"
712 " BLNE sub_FF8117C8 \n"
713 " LDRH R0, [R4, #6] \n"
714 " BIC R1, R0, #0x8000 \n"
715 " LDR R0, =0x3FF \n"
716 " EOR R3, R0, R1, LSR #5 \n"
717 " STR R3, [SP] \n"
718 " LDRH R1, [R4, #4] \n"
719 " LDR R12, [R5, #0x18] \n"
720 " BIC R1, R1, #0x8000 \n"
721 " EOR R3, R0, R1, LSR #5 \n"
722 " LDRH R1, [R4, #2] \n"
723 " BIC R1, R1, #0x8000 \n"
724 " EOR R2, R0, R1, LSR #5 \n"
725 " LDRH R1, [R4] \n"
726 " BIC R1, R1, #0x8000 \n"
727 " EOR R1, R0, R1, LSR #5 \n"
728 " MOV R0, #0 \n"
729 " BLX R12 \n"
730 " LDR R0, [R5, #0x10] \n"
731 " SUB R0, R0, #1 \n"
732 " STR R0, [R5, #0x10] \n"
733 " LDMFD SP!, {R3-R9,PC} \n"
734 "loc_FF8591A0:\n"
735 " BL sub_FF858E74_my \n"
736 " STRH R8, [R4] \n"
737 " LDMFD SP!, {R3-R9,PC} \n"
738 );
739 }
740
741 void __attribute__((naked,noinline)) sub_FF858E74_my( ) {
742 asm volatile (
743 " STMFD SP!, {R4,R5,LR} \n"
744 " BL chdk_process_touch \n"
745 " LDMFD SP!, {R4,R5,LR} \n"
746 " CMP R0, #0 \n"
747 " BXNE LR \n"
748 " LDR PC, =0xFF858E74 \n"
749 );
750 }
751 #endif