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, =0xFFC241C8 \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, =0xFFC180B0 \n"
124 "LDR R1, =0x1900 \n"
125 "LDR R3, =0xDA18 \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, =0x15967C \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, =0x15967C \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 void __attribute__((naked,noinline)) sub_FF81A6A8_my() {
291 asm volatile (
292 "STMFD SP!, {R4,LR} \n"
293 "BL sub_FF82EB0C \n"
294
295 "BL taskcreate_Startup_my \n"
296 "MOV R0, #0 \n"
297 "LDMFD SP!, {R4,PC} \n"
298 );
299 }
300
301
302
303 void __attribute__((naked,noinline)) taskcreate_Startup_my() {
304 asm volatile (
305 "STMFD SP!, {R3-R7,LR} \n"
306 "BL sub_FF835B90 \n"
307 "LDR R6, =0xC0220000 \n"
308 "MOVS R4, R0 \n"
309 "MOV R5, #1 \n"
310 "BNE loc_FF81A70C \n"
311 "BL sub_FF830568 \n"
312 "CMP R0, #0 \n"
313 "BEQ loc_FF81A70C \n"
314 "LDR R0, [R6, #0xFC] \n"
315 "BIC R1, R5, R0 \n"
316 "LDR R0, [R6, #0xF8] \n"
317 "BIC R0, R5, R0 \n"
318 "ORRS R2, R0, R1 \n"
319 "BNE loc_FF81A71C \n"
320 "BL sub_FF82E1C8 \n"
321 "MOV R0, #0x44 \n"
322 "STR R0, [R6, #0x12C] \n"
323 "BL sub_FF82E2E4 \n"
324 "loc_FF81A708:\n"
325 "B loc_FF81A708 \n"
326 "loc_FF81A70C:\n"
327 "LDR R0, [R6, #0xF8] \n"
328 "LDR R1, [R6, #0xFC] \n"
329 "BIC R0, R5, R0 \n"
330 "BIC R1, R5, R1 \n"
331 "loc_FF81A71C:\n"
332 "MOV R3, #0 \n"
333 "MOV R2, R4 \n"
334
335 "BL sub_FF82EB10 \n"
336 "BL sub_003F77E0 \n"
337 "LDR R1, =0x34E000 \n"
338 "MOV R0, #0 \n"
339 "BL sub_FF8341C8 \n"
340 "BL sub_003F79F8 \n"
341 "MOV R3, #0 \n"
342 "STR R3, [SP] \n"
343
344 "LDR R3, =task_Startup_my \n"
345 "MOV R2, #0 \n"
346 "MOV R1, #0x19 \n"
347 "LDR R0, =0xFF81A770 \n"
348 "BL _CreateTask \n"
349 "MOV R0, #0 \n"
350 "LDMFD SP!, {R3-R7,PC} \n"
351 );
352 }
353
354
355
356
357 void __attribute__((naked,noinline)) task_Startup_my( ) {
358 asm volatile (
359 "STMFD SP!, {R4,LR} \n"
360 "BL sub_FF82FC34 \n"
361 "BL sub_FF82DE60 \n"
362 "BL sub_FF835BD8 \n"
363 "BL sub_FF835DC4 \n"
364 "BL sub_FF82CC5C \n"
365 "BL sub_FF82D824 \n"
366
367 "BL sub_FF835F44 \n"
368 "BL sub_FF836110 \n"
369 "BL sub_FF835F08 \n"
370 "BL sub_FF835DF4 \n"
371 "BL sub_FF8340FC \n"
372 "BL sub_FF836118 \n"
373 "BL CreateTask_spytask \n"
374
375 "BL taskcreatePhySw_my \n"
376 "BL sub_FF832390 \n"
377 "BL sub_FF836130 \n"
378 "BL sub_FF82B9D8 \n"
379 "BL sub_FF82C520 \n"
380 "BL sub_FF83594C \n"
381 "BL sub_FF82CB4C \n"
382 "BL sub_FF82C4BC \n"
383 "BL sub_FF835F34 \n"
384 "BL sub_FF836C88 \n"
385 "BL sub_FF82C480 \n"
386 "LDMFD SP!, {R4,LR} \n"
387 "B sub_FF8149E8 \n"
388 );
389 }
390
391
392
393
394 void __attribute__((naked,noinline)) taskcreatePhySw_my( ) {
395 asm volatile (
396 "STMFD SP!, {R3-R5,LR} \n"
397 "LDR R4, =0x1C18 \n"
398 "LDR R0, [R4, #4] \n"
399 "CMP R0, #0 \n"
400 "BNE loc_FF82E9E4 \n"
401 "MOV R3, #0 \n"
402 "STR R3, [SP] \n"
403
404 "LDR R3, =mykbd_task \n"
405
406 "MOV R2, #0x2000 \n"
407 "MOV R1, #0x17 \n"
408 "LDR R0, =0xFF82EC0C \n"
409 "BL sub_003F7A50 \n"
410 "STR R0, [R4, #4] \n"
411 "loc_FF82E9E4:\n"
412 "BL sub_FF880638 \n"
413 "BL sub_FF8304B8 \n"
414 "CMP R0, #0 \n"
415 "BNE loc_FF82EA00 \n"
416 "LDR R1, =0x31BAC \n"
417 "MOV R0, #0 \n"
418 "BL sub_FF8805A8 \n"
419 "loc_FF82EA00:\n"
420 "LDMFD SP!, {R3-R5,PC} \n"
421 );
422 }
423
424 void CreateTask_spytask() {
425
426 _CreateTask("SpyTask", 0x19, 0x2000, core_spytask, 0);
427 };
428
429
430
431 void __attribute__((naked,noinline)) init_file_modules_task() {
432 asm volatile (
433 "STMFD SP!, {R4-R6,LR} \n"
434 "BL sub_FF882BA4 \n"
435 "LDR R5, =0x5006 \n"
436 "MOVS R4, R0 \n"
437 "MOVNE R1, #0 \n"
438 "MOVNE R0, R5 \n"
439 "BLNE _PostLogicalEventToUI \n"
440 "BL sub_FF882BD0 \n"
441 "BL core_spytask_can_start \n"
442 "CMP R4, #0 \n"
443 "LDMNEFD SP!, {R4-R6,PC} \n"
444 "MOV R0, R5 \n"
445 "LDMFD SP!, {R4-R6,LR} \n"
446 "MOV R1, #0 \n"
447 "B _PostLogicalEventToUI \n"
448 );
449 }
450
451 #if 0
452 void __attribute__((naked,noinline)) task_TouchPanel_my( ) {
453 asm volatile (
454 " STMFD SP!, {R3-R7,LR} \n"
455 " MOV R0, #0 \n"
456 " LDR R1, =0xC0221000 \n"
457 " MOV R4, R0 \n"
458 " STR R0, [SP] \n"
459 " MOV R0, #0xB \n"
460 " STR R0, [R1, #0x314] \n"
461 " MOV R0, #0x1C \n"
462 " SUB R1, R1, #0x1E000 \n"
463 " STR R0, [R1, #0x40] \n"
464 " MOV R3, #0 \n"
465 " LDR R2, =0xFF858DD0 \n"
466 " MOV R1, #0x55 \n"
467 " MOV R0, R3 \n"
468 " BL sub_003F67BC \n"
469 " BL sub_FF85966C \n"
470 " LDR R5, =0x25A8 \n"
471 " MOV R1, #0x10 \n"
472 " LDR R0, [R5, #0x20] \n"
473 " BL sub_003FACA0 \n"
474 " MOV R6, #7 \n"
475 "loc_FF859268:\n"
476 " LDR R0, [R5, #0x20] \n"
477 " MOV R2, #0 \n"
478 " MOV R1, #0x17 \n"
479 " BL sub_003FAAC8 \n"
480 " CMP R0, #0 \n"
481 " LDRNE R0, =0xFF858E04 \n"
482 " MOVNE R1, #0x31C \n"
483 " BLNE sub_003F6AFC \n"
484 " LDR R0, [R5, #0x20] \n"
485 " MOV R1, SP \n"
486 " BL sub_003FACD8 \n"
487 " CMP R0, #0 \n"
488 " LDRNE R1, =0x31D \n"
489 " LDRNE R0, =0xFF858E04 \n"
490 " BLNE sub_003F6AFC \n"
491 " LDR R0, [SP] \n"
492 " TST R0, #1 \n"
493 " BEQ loc_FF8592E8 \n"
494 " LDR R0, [R5, #4] \n"
495 " CMP R0, #7 \n"
496 " BEQ loc_FF8592C4 \n"
497 " BL sub_FF87D9D0 \n"
498 " STR R6, [R5, #4] \n"
499 "loc_FF8592C4:\n"
500 " LDR R0, [R5, #0x20] \n"
501 " MOV R1, #5 \n"
502 " BL sub_003FACA0 \n"
503 " BL sub_FF858E2C \n"
504 " MOV R4, #0 \n"
505 " BL sub_FF85966C \n"
506 " LDR R0, [R5, #0x20] \n"
507 " MOV R1, #0x80000000 \n"
508 " BL sub_003FAC6C \n"
509 "loc_FF8592E8:\n"
510 " LDR R0, [SP] \n"
511 " TST R0, #2 \n"
512 " BEQ loc_FF859318 \n"
513 " LDR R0, [R5, #0x20] \n"
514 " MOV R1, #2 \n"
515 " BL sub_003FACA0 \n"
516 " CMP R4, #0 \n"
517 " BNE loc_FF859268 \n"
518 " LDR R0, =0xBB8 \n"
519 " BL sub_FF858C2C \n"
520 " MOV R4, #1 \n"
521 " BL sub_FF859798 \n"
522 "loc_FF859318:\n"
523 " LDR R0, [SP] \n"
524 " TST R0, #0x10 \n"
525 " BEQ loc_FF859360 \n"
526 " LDR R0, [R5, #4] \n"
527 " CMP R0, #7 \n"
528 " BEQ loc_FF859338 \n"
529 " BL sub_FF87D9D0 \n"
530 " STR R6, [R5, #4] \n"
531 "loc_FF859338:\n"
532 " BL sub_FF85966C \n"
533 " LDR R0, [R5, #0x20] \n"
534 " MOV R1, #0x14 \n"
535 " BL sub_003FACA0 \n"
536 " CMP R4, #0 \n"
537 " BEQ loc_FF859268 \n"
538 " BL sub_FF8591CC_my \n"
539 " LDR R0, [R5, #0xC] \n"
540 " CMP R0, #0 \n"
541 " BLNE sub_FF859774 \n"
542 "loc_FF859360:\n"
543 " LDR R0, [SP] \n"
544 " TST R0, #4 \n"
545 " BEQ loc_FF859268 \n"
546 " STR R6, [R5, #4] \n"
547 " LDR R0, [R5, #0x20] \n"
548 " MOV R1, #4 \n"
549 " BL sub_003FACA0 \n"
550 " CMP R4, #0 \n"
551 " BEQ loc_FF859268 \n"
552 " BL sub_FF8591CC_my \n"
553 " LDR R0, [R5, #0xC] \n"
554 " CMP R0, #0 \n"
555 " BLNE sub_FF859774 \n"
556 " B loc_FF859268 \n"
557 );
558 }
559
560 void __attribute__((naked,noinline)) sub_FF8591CC_my( ) {
561 asm volatile (
562 " LDR R1, =0x25A8 \n"
563 " LDR R0, [R1, #0xC] \n"
564 " CMP R0, #0 \n"
565 " BEQ loc_FF8591F8 \n"
566 " CMP R0, #1 \n"
567 " BEQ sub_FF858F90_my \n"
568 " CMP R0, #2 \n"
569 " BEQ sub_FF8590B4_my \n"
570 " LDRNE R1, =0x307 \n"
571 " LDRNE R0, =0xFF858E04 \n"
572 " BNE sub_003F6AFC \n"
573 "loc_FF8591F8:\n"
574 " LDR R0, =0xC0220000 \n"
575 " LDR R0, [R0, #0x2C] \n"
576 " TST R0, #1 \n"
577 " BNE sub_FF859798 \n"
578 " MOV R0, #1 \n"
579 " STR R0, [R1, #0xC] \n"
580 " BX LR \n"
581 );
582 }
583
584
585 void __attribute__((naked,noinline)) sub_FF858F90_my( ) {
586 asm volatile (
587 " STMFD SP!, {R3-R7,LR} \n"
588 " LDR R6, =0xC0220000 \n"
589 " LDR R0, [R6, #0x2C] \n"
590 " TST R0, #1 \n"
591 " BNE loc_FF8590AC \n"
592 " LDR R1, =0x25D4 \n"
593 " MOV R0, #0 \n"
594 " BL sub_FF858C8C \n"
595 " LDR R4, =0x25D4 \n"
596 " LDR R5, =0x3FF \n"
597 " LDRH R0, [R4, #6] \n"
598 " BIC R0, R0, #0x8000 \n"
599 " EOR R2, R5, R0, LSR #5 \n"
600 " LDRH R0, [R4, #4] \n"
601 " BIC R0, R0, #0x8000 \n"
602 " EOR R1, R5, R0, LSR #5 \n"
603 " LDRH R0, [R4, #2] \n"
604 " BIC R0, R0, #0x8000 \n"
605 " EOR R0, R5, R0, LSR #5 \n"
606 " BL sub_FF858DB4 \n"
607 " CMP R0, #0x1F40 \n"
608 " BGT loc_FF859058 \n"
609 " LDR R0, =0x2710 \n"
610 " BL sub_FF858C2C \n"
611 " LDR R0, [R6, #0x2C] \n"
612 " SUB R6, R4, #0x2C \n"
613 " TST R0, #1 \n"
614 " BNE loc_FF85905C \n"
615 " ADD R1, R4, #0 \n"
616 " MOV R0, #0 \n"
617 " BL sub_FF858C8C \n"
618 " LDRH R0, [R4, #6] \n"
619 " BIC R0, R0, #0x8000 \n"
620 " EOR R2, R5, R0, LSR #5 \n"
621 " LDRH R0, [R4, #4] \n"
622 " BIC R0, R0, #0x8000 \n"
623 " EOR R1, R5, R0, LSR #5 \n"
624 " LDRH R0, [R4, #2] \n"
625 " BIC R0, R0, #0x8000 \n"
626 " EOR R0, R5, R0, LSR #5 \n"
627 " BL sub_FF858DB4 \n"
628 " CMP R0, #0x1F40 \n"
629 " BGT loc_FF859058 \n"
630 " BL sub_FF858E74_my \n"
631 " MOV R0, #3 \n"
632 " STR R0, [R6, #0x10] \n"
633 " MOV R0, #2 \n"
634 " STR R0, [R6, #0xC] \n"
635 " MVN R0, #0x8000 \n"
636 " STRH R0, [R4] \n"
637 "loc_FF859058:\n"
638 " LDMFD SP!, {R3-R7,PC} \n"
639 "loc_FF85905C:\n"
640 " LDR R0, [R6, #0x14] \n"
641 " CMP R0, #0 \n"
642 " LDRNE R0, =0xFF8591C4 \n"
643 " BLNE sub_FF8117C8 \n"
644 " LDRH R0, [R4, #6] \n"
645 " BIC R0, R0, #0x8000 \n"
646 " EOR R3, R5, R0, LSR #5 \n"
647 " STR R3, [SP] \n"
648 " LDRH R0, [R4, #4] \n"
649 " LDR R12, [R6, #0x18] \n"
650 " BIC R0, R0, #0x8000 \n"
651 " EOR R3, R5, R0, LSR #5 \n"
652 " LDRH R0, [R4, #2] \n"
653 " BIC R0, R0, #0x8000 \n"
654 " EOR R2, R5, R0, LSR #5 \n"
655 " LDRH R0, [R4] \n"
656 " BIC R0, R0, #0x8000 \n"
657 " EOR R1, R5, R0, LSR #5 \n"
658 " MOV R0, #0 \n"
659 " BLX R12 \n"
660 "loc_FF8590AC:\n"
661 " BL sub_FF858E2C \n"
662 " LDMFD SP!, {R3-R7,PC} \n"
663 );
664 }
665
666
667 void __attribute__((naked,noinline)) sub_FF8590B4_my( ) {
668 asm volatile (
669 "loc_FF8590B4:\n"
670 " STMFD SP!, {R3-R9,LR} \n"
671 " LDR R7, =0xC0220000 \n"
672 " LDR R0, [R7, #0x2C] \n"
673 " LDR R5, =0x25A8 \n"
674 " TST R0, #1 \n"
675 " LDR R0, [R5, #0x10] \n"
676 " LDR R6, =0x2710 \n"
677 " SUB R0, R0, #1 \n"
678 " BEQ loc_FF8590EC \n"
679 " CMP R0, #0 \n"
680 " STR R0, [R5, #0x10] \n"
681 " LDMEQFD SP!, {R3-R9,LR} \n"
682 " BEQ sub_FF858E2C \n"
683 " B loc_FF859110 \n"
684 "loc_FF8590EC:\n"
685 " LDR R4, =0x25D4 \n"
686 " LDR R8, =0x7FFF \n"
687 " MOV R1, #3 \n"
688 " CMP R0, #2 \n"
689 " STR R1, [R5, #0x10] \n"
690 " BCS loc_FF85911C \n"
691 " LDRH R0, [R4] \n"
692 " CMP R0, R8 \n"
693 " BNE loc_FF8591A0 \n"
694 "loc_FF859110:\n"
695 " MOV R0, R6 \n"
696 " LDMFD SP!, {R3-R9,LR} \n"
697 " B sub_FF858C2C \n"
698 "loc_FF85911C:\n"
699 " LDR R1, =0x25D4 \n"
700 " MOV R0, #0 \n"
701 " BL sub_FF858C8C \n"
702 " MOV R0, R6 \n"
703 " BL sub_FF858C2C \n"
704 " LDR R0, [R7, #0x2C] \n"
705 " TST R0, #1 \n"
706 " BEQ loc_FF8591A0 \n"
707 " LDR R0, [R5, #0x14] \n"
708 " CMP R0, #0 \n"
709 " LDRNE R0, =0xFF8591C4 \n"
710 " BLNE sub_FF8117C8 \n"
711 " LDRH R0, [R4, #6] \n"
712 " BIC R1, R0, #0x8000 \n"
713 " LDR R0, =0x3FF \n"
714 " EOR R3, R0, R1, LSR #5 \n"
715 " STR R3, [SP] \n"
716 " LDRH R1, [R4, #4] \n"
717 " LDR R12, [R5, #0x18] \n"
718 " BIC R1, R1, #0x8000 \n"
719 " EOR R3, R0, R1, LSR #5 \n"
720 " LDRH R1, [R4, #2] \n"
721 " BIC R1, R1, #0x8000 \n"
722 " EOR R2, R0, R1, LSR #5 \n"
723 " LDRH R1, [R4] \n"
724 " BIC R1, R1, #0x8000 \n"
725 " EOR R1, R0, R1, LSR #5 \n"
726 " MOV R0, #0 \n"
727 " BLX R12 \n"
728 " LDR R0, [R5, #0x10] \n"
729 " SUB R0, R0, #1 \n"
730 " STR R0, [R5, #0x10] \n"
731 " LDMFD SP!, {R3-R9,PC} \n"
732 "loc_FF8591A0:\n"
733 " BL sub_FF858E74_my \n"
734 " STRH R8, [R4] \n"
735 " LDMFD SP!, {R3-R9,PC} \n"
736 );
737 }
738
739 void __attribute__((naked,noinline)) sub_FF858E74_my( ) {
740 asm volatile (
741 " STMFD SP!, {R4,R5,LR} \n"
742 " BL chdk_process_touch \n"
743 " LDMFD SP!, {R4,R5,LR} \n"
744 " CMP R0, #0 \n"
745 " BXNE LR \n"
746 " LDR PC, =0xFF858E74 \n"
747 );
748 }
749 #endif