This source file includes following definitions.
- spytask
- CreateTask_spytask
- boot
- CreateTask_my
- sub_FF00038C_my
- sub_FF00116C_my
- sub_FF00421C_my
- sub_FF00AE5C_my
- sub_FF01A018_my
- task_Startup_my
- taskcreatePhySw_my
- init_file_modules_task
- JogDial_task_my
1
2
3
4 #include "lolevel.h"
5 #include "platform.h"
6 #include "core.h"
7 #include "dryos31.h"
8
9 #define offsetof(TYPE, MEMBER) ((int) &((TYPE *)0)->MEMBER)
10
11 const char * const new_sa = &_end;
12
13
14 extern volatile int jogdial_stopped;
15 void JogDial_task_my(void);
16
17 extern void task_CaptSeq();
18 extern void task_InitFileModules();
19 extern void task_RotaryEncoder();
20 extern void task_MovieRecord();
21 extern void task_ExpDrv();
22 extern void task_FileWrite();
23
24
25
26
27 void spytask(long ua, long ub, long uc, long ud, long ue, long uf)
28 {
29 (void)ua; (void)ub; (void)uc; (void)ud; (void)ue; (void)uf;
30 core_spytask();
31 }
32
33
34
35
36 void CreateTask_spytask()
37 {
38 _CreateTask("SpyTask", 0x19, 0x2000, spytask, 0);
39 }
40
41
42
43
44 short *jog_position;
45
46
47
48
49
50
51
52
53
54 void __attribute__((naked,noinline)) boot() {
55 asm volatile (
56 " LDR R1, =0xC0410000 \n"
57 " MOV R0, #0 \n"
58 " STR R0, [R1] \n"
59 " MOV R1, #0x78 \n"
60 " MCR p15, 0, R1, c1, c0 \n"
61 " MOV R1, #0 \n"
62 " MCR p15, 0, R1, c7, c10, 4 \n"
63 " MCR p15, 0, R1, c7, c5 \n"
64 " MCR p15, 0, R1, c7, c6 \n"
65 " MOV R0, #0x3D \n"
66 " MCR p15, 0, R0, c6, c0 \n"
67 " MOV R0, #0xC000002F \n"
68 " MCR p15, 0, R0, c6, c1 \n"
69 " MOV R0, #0x37 \n"
70 " MCR p15, 0, R0, c6, c2 \n"
71 " MOV R0, #0x40000037 \n"
72 " MCR p15, 0, R0, c6, c3 \n"
73 " MOV R0, #0x80000017 \n"
74 " MCR p15, 0, R0, c6, c4 \n"
75 " LDR R0, =0xFF00002F \n"
76 " MCR p15, 0, R0, c6, c5 \n"
77 " LDR R0, =0xD000002B \n"
78 " MCR p15, 0, R0, c6, c7 \n"
79 " MOV R0, #0x34 \n"
80 " MCR p15, 0, R0, c2, c0 \n"
81 " MOV R0, #0x34 \n"
82 " MCR p15, 0, R0, c2, c0, 1 \n"
83 " MOV R0, #0x34 \n"
84 " MCR p15, 0, R0, c3, c0 \n"
85 " LDR R0, =0x33333330 \n"
86 " MCR p15, 0, R0, c5, c0, 2 \n"
87 " LDR R0, =0x33333330 \n"
88 " MCR p15, 0, R0, c5, c0, 3 \n"
89 " MRC p15, 0, R0, c1, c0 \n"
90 " ORR R0, R0, #0x1000 \n"
91 " ORR R0, R0, #4 \n"
92 " ORR R0, R0, #1 \n"
93 " MCR p15, 0, R0, c1, c0 \n"
94 " MOV R1, #0x80000006 \n"
95 " MCR p15, 0, R1, c9, c1 \n"
96 " MOV R1, #6 \n"
97 " MCR p15, 0, R1, c9, c1, 1 \n"
98 " MRC p15, 0, R1, c1, c0 \n"
99 " ORR R1, R1, #0x50000 \n"
100 " MCR p15, 0, R1, c1, c0 \n"
101 " LDR R2, =0xC0200000 \n"
102 " MOV R1, #1 \n"
103 " STR R1, [R2, #0x10C] \n"
104 " MOV R1, #0xFF \n"
105 " STR R1, [R2, #0xC] \n"
106 " STR R1, [R2, #0x1C] \n"
107 " STR R1, [R2, #0x2C] \n"
108 " STR R1, [R2, #0x3C] \n"
109 " STR R1, [R2, #0x4C] \n"
110 " STR R1, [R2, #0x5C] \n"
111 " STR R1, [R2, #0x6C] \n"
112 " STR R1, [R2, #0x7C] \n"
113 " STR R1, [R2, #0x8C] \n"
114 " STR R1, [R2, #0x9C] \n"
115 " STR R1, [R2, #0xAC] \n"
116 " STR R1, [R2, #0xBC] \n"
117 " STR R1, [R2, #0xCC] \n"
118 " STR R1, [R2, #0xDC] \n"
119 " STR R1, [R2, #0xEC] \n"
120 " STR R1, [R2, #0xFC] \n"
121 " LDR R1, =0xC0400008 \n"
122 " LDR R2, =0x430005 \n"
123 " STR R2, [R1] \n"
124 " MOV R1, #1 \n"
125 " LDR R2, =0xC0243100 \n"
126 " STR R2, [R1] \n"
127 " LDR R2, =0xC0242010 \n"
128 " LDR R1, [R2] \n"
129 " ORR R1, R1, #1 \n"
130 " STR R1, [R2] \n"
131 " LDR R0, =0xFF746AC8 \n"
132 " LDR R1, =0x685000 \n"
133 " LDR R3, =0x6946B4 \n"
134
135 "loc_FF000144:\n"
136 " CMP R1, R3 \n"
137 " LDRCC R2, [R0], #4 \n"
138 " STRCC R2, [R1], #4 \n"
139 " BCC loc_FF000144 \n"
140 " LDR R0, =0xFF731694 \n"
141 " LDR R1, =0x1900 \n"
142 " LDR R3, =0x16D34 \n"
143
144 "loc_FF000160:\n"
145 " CMP R1, R3 \n"
146 " LDRCC R2, [R0], #4 \n"
147 " STRCC R2, [R1], #4 \n"
148 " BCC loc_FF000160 \n"
149 " LDR R1, =0x1B3DD4 \n"
150 " MOV R2, #0 \n"
151
152 "loc_FF000178:\n"
153 " CMP R3, R1 \n"
154 " STRCC R2, [R3], #4 \n"
155 " BCC loc_FF000178 \n"
156
157
158
159
160
161 " LDR R0, =patch_CreateTask\n"
162 " LDM R0, {R1,R2}\n"
163 " LDR R0, =hook_CreateTask\n"
164 " STM R0, {R1,R2}\n"
165
166 " B sub_FF00038C_my \n"
167
168 "patch_CreateTask:\n"
169 " LDR PC, [PC,#-0x4]\n"
170 " .long CreateTask_my\n"
171 );
172 }
173
174
175
176 void __attribute__((naked,noinline)) CreateTask_my() {
177 asm volatile (
178 " STMFD SP!, {R0}\n"
179
180
181
182 " LDR R0, =task_CaptSeq\n"
183 " CMP R0, R3\n"
184 " LDREQ R3, =capt_seq_task\n"
185 " BEQ exitHook\n"
186
187
188 " LDR R0, =task_ExpDrv\n"
189 " CMP R0, R3\n"
190 " LDREQ R3, =exp_drv_task\n"
191 " BEQ exitHook\n"
192
193
194 " LDR R0, =task_FileWrite\n"
195 " CMP R0, R3\n"
196 " LDREQ R3, =filewritetask\n"
197 " BEQ exitHook\n"
198
199
200 " LDR R0, =task_RotaryEncoder\n"
201 " CMP R0, R3\n"
202 " LDREQ R3, =JogDial_task_my\n"
203 " BEQ exitHook\n"
204
205
206 " LDR R0, =task_MovieRecord\n"
207 " CMP R0, R3\n"
208 " LDREQ R3, =movie_record_task\n"
209 " BEQ exitHook\n"
210
211
212 " LDR R0, =task_InitFileModules\n"
213 " CMP R0, R3\n"
214 " LDREQ R3, =init_file_modules_task\n"
215
216 "exitHook:\n"
217
218 " LDMFD SP!, {R0}\n"
219
220 " STMFD SP!, {R1-R9,LR} \n"
221 " MOV R4, R0 \n"
222 " LDR PC, =0x0068AB94 \n"
223 );
224 }
225
226
227
228 void __attribute__((naked,noinline)) sub_FF00038C_my() {
229
230 if ( (*(int*)0xC022F48C & 0x800000) )
231 *(int*)(0x2E0C+0x8) = 0x200000;
232 else
233 *(int*)(0x2E0C+0x8) = 0x100000;
234
235 asm volatile (
236 " LDR R0, =0xFF000404 \n"
237 " MOV R1, #0 \n"
238 " LDR R3, =0xFF00043C \n"
239
240 "loc_FF000398:\n"
241 " CMP R0, R3 \n"
242 " LDRCC R2, [R0], #4 \n"
243 " STRCC R2, [R1], #4 \n"
244 " BCC loc_FF000398 \n"
245 " LDR R0, =0xFF00043C \n"
246 " MOV R1, #0x4B0 \n"
247 " LDR R3, =0xFF000624 \n"
248
249 "loc_FF0003B4:\n"
250 " CMP R0, R3 \n"
251 " LDRCC R2, [R0], #4 \n"
252 " STRCC R2, [R1], #4 \n"
253 " BCC loc_FF0003B4 \n"
254 " MOV R0, #0xD2 \n"
255 " MSR CPSR_cxsf, R0 \n"
256 " MOV SP, #0x1000 \n"
257 " MOV R0, #0xD3 \n"
258 " MSR CPSR_cxsf, R0 \n"
259 " MOV SP, #0x1000 \n"
260 " LDR R0, =0x698 \n"
261 " LDR R2, =0xEEEEEEEE \n"
262 " MOV R3, #0x1000 \n"
263
264 "loc_FF0003E8:\n"
265 " CMP R0, R3 \n"
266 " STRCC R2, [R0], #4 \n"
267 " BCC loc_FF0003E8 \n"
268 " BL sub_FF00116C_my \n"
269 );
270 }
271
272
273
274 void __attribute__((naked,noinline)) sub_FF00116C_my() {
275 asm volatile (
276 " STR LR, [SP, #-4]! \n"
277 " SUB SP, SP, #0x74 \n"
278 " MOV R1, #0x74 \n"
279 " MOV R0, SP \n"
280 " BL sub_00690440 \n"
281 " MOV R0, #0x67000 \n"
282 " STR R0, [SP, #4] \n"
283
284 #if defined(CHDK_NOT_IN_CANON_HEAP)
285 " LDR R0, =0x1B3DD4 \n"
286 #else
287 " LDR R0, =new_sa\n"
288 " LDR R0, [R0]\n"
289 #endif
290
291 " LDR R2, =0x55D440 \n"
292 " STR R0, [SP, #8] \n"
293 " SUB R0, R2, R0 \n"
294 " STR R0, [SP, #0xC] \n"
295 " MOV R0, #0x22 \n"
296 " STR R0, [SP, #0x18] \n"
297 " MOV R0, #0x7C \n"
298 " STR R0, [SP, #0x1C] \n"
299 " LDR R1, =0x565C00 \n"
300 " LDR R0, =0x1CD \n"
301 " STR R1, [SP] \n"
302 " STR R0, [SP, #0x20] \n"
303 " MOV R0, #0x96 \n"
304 " STR R2, [SP, #0x10] \n"
305 " STR R1, [SP, #0x14] \n"
306 " STR R0, [SP, #0x24] \n"
307 " STR R0, [SP, #0x28] \n"
308 " MOV R0, #0x64 \n"
309 " STR R0, [SP, #0x2C] \n"
310 " MOV R0, #0 \n"
311 " STR R0, [SP, #0x30] \n"
312 " STR R0, [SP, #0x34] \n"
313 " MOV R0, #0x10 \n"
314 " STR R0, [SP, #0x5C] \n"
315 " MOV R0, #0x800 \n"
316 " STR R0, [SP, #0x60] \n"
317 " MOV R0, #0xA0 \n"
318 " STR R0, [SP, #0x64] \n"
319 " MOV R0, #0x280 \n"
320 " STR R0, [SP, #0x68] \n"
321 " LDR R1, =sub_FF00421C_my \n"
322 " MOV R2, #0 \n"
323 " MOV R0, SP \n"
324 " BL sub_006867E8 \n"
325 " ADD SP, SP, #0x74 \n"
326 " LDR PC, [SP], #4 \n"
327 );
328 }
329
330
331
332 void __attribute__((naked,noinline)) sub_FF00421C_my() {
333 asm volatile (
334 " STMFD SP!, {R4,LR} \n"
335 " BL sub_FF000AE8 \n"
336 " BL sub_FF005358 \n"
337 " CMP R0, #0 \n"
338 " LDRLT R0, =0xFF004330 /*'dmSetup'*/ \n"
339 " BLLT _err_init_task \n"
340 " BL sub_FF003E54 \n"
341 " CMP R0, #0 \n"
342 " LDRLT R0, =0xFF004338 /*'termDriverInit'*/ \n"
343 " BLLT _err_init_task \n"
344 " LDR R0, =0xFF004348 /*'/_term'*/ \n"
345 " BL sub_FF003F3C \n"
346 " CMP R0, #0 \n"
347 " LDRLT R0, =0xFF004350 /*'termDeviceCreate'*/ \n"
348 " BLLT _err_init_task \n"
349 " LDR R0, =0xFF004348 /*'/_term'*/ \n"
350 " BL sub_FF00295C \n"
351 " CMP R0, #0 \n"
352 " LDRLT R0, =0xFF004364 /*'stdioSetup'*/ \n"
353 " BLLT _err_init_task \n"
354 " BL sub_FF004CF4 \n"
355 " CMP R0, #0 \n"
356 " LDRLT R0, =0xFF004370 /*'stdlibSetup'*/ \n"
357 " BLLT _err_init_task \n"
358 " BL sub_FF00165C \n"
359 " CMP R0, #0 \n"
360 " LDRLT R0, =0xFF00437C /*'armlib_setup'*/ \n"
361 " BLLT _err_init_task \n"
362 " LDMFD SP!, {R4,LR} \n"
363 " B sub_FF00AE5C_my \n"
364 );
365 }
366
367
368
369 void __attribute__((naked,noinline)) sub_FF00AE5C_my() {
370 asm volatile (
371 " STMFD SP!, {R3,LR} \n"
372 " BL sub_FF022240 \n"
373 " CMP R0, #0 \n"
374 " BNE loc_FF00AE7C \n"
375 " BL sub_FF01BB6C /*_IsNormalCameraMode_FW*/ \n"
376 " CMP R0, #0 \n"
377 " MOVNE R0, #1 \n"
378 " BNE loc_FF00AE80 \n"
379
380 "loc_FF00AE7C:\n"
381 " MOV R0, #0 \n"
382
383 "loc_FF00AE80:\n"
384 " BL sub_FF01A018_my \n"
385 " CMP R0, #0 \n"
386 " BNE loc_FF00AEA0 \n"
387 " BL sub_FF0193AC \n"
388 " LDR R1, =0x83DC00 \n"
389 " MOV R0, #0x54 \n"
390 " BL sub_FF020808 \n"
391
392 "loc_FF00AE9C:\n"
393 " B loc_FF00AE9C \n"
394
395 "loc_FF00AEA0:\n"
396 " BL sub_0068C314 \n"
397 " LDR R1, =0x5CE000 \n"
398 " MOV R0, #0 \n"
399 " BL sub_FF020604 \n"
400 " BL sub_0068C52C /*_EnableDispatch*/ \n"
401 " MOV R3, #0 \n"
402 " STR R3, [SP] \n"
403 " LDR R3, =task_Startup_my \n"
404 " MOV R2, #0 \n"
405 " MOV R1, #0x19 \n"
406 " LDR R0, =0xFF00AEE4 /*'Startup'*/ \n"
407 " BL _CreateTask \n"
408 " MOV R0, #0 \n"
409 " LDMFD SP!, {R3,PC} \n"
410 );
411 }
412
413
414
415 void __attribute__((naked,noinline)) sub_FF01A018_my() {
416 asm volatile (
417 " STMFD SP!, {R4-R6,LR} \n"
418 " MOV R6, R0 \n"
419
420 " MOV R0, #0x4B \n"
421 " BL sub_FF020818 \n"
422 " MOV R4, #1 \n"
423 " BIC R5, R4, R0 \n"
424 " MOV R0, #0x4C \n"
425 " BL sub_FF020818 \n"
426 " CMP R6, #0 \n"
427 " BIC R4, R4, R0 \n"
428 " BEQ loc_FF01A050 \n"
429 " ORRS R0, R5, R4 \n"
430 " LDMEQFD SP!, {R4-R6,PC} \n"
431
432 "loc_FF01A050:\n"
433 " BL sub_FF022240 \n"
434 " MOV R2, R0 \n"
435 " MOV R3, #0 \n"
436 " MOV R1, R4 \n"
437 " MOV R0, R5 \n"
438
439
440 " MOV R0, #1 \n"
441 " LDMFD SP!, {R4-R6,PC} \n"
442 );
443 }
444
445
446
447 void __attribute__((naked,noinline)) task_Startup_my() {
448 asm volatile (
449 " STMFD SP!, {R4,LR} \n"
450 " BL sub_FF00485C \n"
451 " BL sub_FF01B190 \n"
452 " BL sub_FF0192D0 \n"
453
454 " BL sub_FF022474 \n"
455
456 " BL sub_FF0225E0 \n"
457 " BL sub_FF0227AC \n"
458
459 " BL sub_FF0224A4 \n"
460 " BL sub_FF020538 \n"
461 " BL sub_FF0227B4 \n"
462 " BL CreateTask_spytask\n"
463 " BL taskcreatePhySw_my \n"
464 " BL sub_FF01DA78 \n"
465 " BL sub_FF0AF590 \n"
466 " BL sub_FF016E50 \n"
467 " BL sub_FF018C38 \n"
468 " BL sub_FF022000 \n"
469 " BL sub_FF019284 \n"
470 " BL sub_FF018BD4 \n"
471
472 " BL sub_FF017AFC \n"
473 " BL sub_FF018B98 \n"
474 " LDMFD SP!, {R4,LR} \n"
475 " B sub_FF004998 \n"
476 );
477 }
478
479
480
481 void __attribute__((naked,noinline)) taskcreatePhySw_my() {
482 asm volatile (
483 " STMFD SP!, {R3-R5,LR} \n"
484 " LDR R4, =0x1D64 \n"
485 " LDR R0, [R4, #4] \n"
486 " CMP R0, #0 \n"
487 " BNE loc_FF019EF4 \n"
488 " MOV R3, #0 \n"
489 " STR R3, [SP] \n"
490 " LDR R3, =mykbd_task \n"
491 " MOV R2, #0x2000 \n"
492 " MOV R1, #0x17 \n"
493 " LDR R0, =0xFF01A168 /*'PhySw'*/ \n"
494 " BL sub_0068AF04 /*_CreateTaskStrictly*/ \n"
495 " STR R0, [R4, #4] \n"
496
497 "loc_FF019EF4:\n"
498 " BL sub_FF05DF88 \n"
499 " BL sub_FF09948C \n"
500 " BL sub_FF01BABC /*_IsFactoryMode_FW*/ \n"
501 " CMP R0, #0 \n"
502 " BNE loc_FF019F14 \n"
503 " LDR R1, =0x3AE98 \n"
504 " MOV R0, #0 \n"
505 " BL sub_FF0993F8 /*_OpLog.Start_FW*/ \n"
506
507 "loc_FF019F14:\n"
508 " LDMFD SP!, {R3-R5,PC} \n"
509 );
510 }
511
512
513
514 void __attribute__((naked,noinline)) init_file_modules_task() {
515 asm volatile (
516 " STMFD SP!, {R4-R6,LR} \n"
517 " BL sub_FF09BA04 \n"
518 " LDR R5, =0x5006 \n"
519 " MOVS R4, R0 \n"
520 " MOVNE R1, #0 \n"
521 " MOVNE R0, R5 \n"
522 " BLNE _PostLogicalEventToUI \n"
523 " BL sub_FF09BA30 \n"
524 " BL core_spytask_can_start\n"
525 " CMP R4, #0 \n"
526 " LDMNEFD SP!, {R4-R6,PC} \n"
527 " MOV R0, R5 \n"
528 " LDMFD SP!, {R4-R6,LR} \n"
529 " MOV R1, #0 \n"
530 " B _PostLogicalEventToUI \n"
531 );
532 }
533
534
535
536 void __attribute__((naked,noinline)) JogDial_task_my() {
537 asm volatile (
538 " STMFD SP!, {R4-R11,LR} \n"
539 " SUB SP, SP, #0x1C \n"
540 " BL sub_FF05DFF4 \n"
541 " LDR R12, =0x2E30 \n"
542 " LDR R6, =0xFF49E790 \n"
543 " MOV R0, #0 \n"
544 " ADD R10, SP, #8 \n"
545 " ADD R9, SP, #0xC \n"
546
547
548 " LDR R2, =jog_position \n"
549 " STR R9, [R2] \n"
550
551 "loc_FF05DC7C:\n"
552 " ADD R2, SP, #0x14 \n"
553 " MOV R1, #0 \n"
554 " ADD R4, R2, R0, LSL#1 \n"
555 " ADD R3, SP, #0x10 \n"
556 " STRH R1, [R4] \n"
557 " ADD R4, R3, R0, LSL#1 \n"
558 " STRH R1, [R4] \n"
559 " STR R1, [R9, R0, LSL#2] \n"
560 " STR R1, [R10, R0, LSL#2] \n"
561 " ADD R0, R0, #1 \n"
562 " CMP R0, #1 \n"
563 " BLT loc_FF05DC7C \n"
564
565 "loc_FF05DCAC:\n"
566 " LDR R0, =0x2E30 \n"
567 " MOV R2, #0 \n"
568 " LDR R0, [R0, #8] \n"
569 " MOV R1, SP \n"
570 " BL sub_0068BDE0 /*_ReceiveMessageQueue*/ \n"
571 " CMP R0, #0 \n"
572 " LDRNE R1, =0x20B \n"
573 " LDRNE R0, =0xFF05DF0C /*'RotaryEncoder.c'*/ \n"
574 " BLNE _DebugAssert \n"
575 " LDR R0, [SP] \n"
576 " AND R4, R0, #0xFF \n"
577 " AND R0, R0, #0xFF00 \n"
578 " CMP R0, #0x100 \n"
579 " BEQ loc_FF05DD1C \n"
580 " CMP R0, #0x200 \n"
581 " BEQ loc_FF05DD54 \n"
582 " CMP R0, #0x300 \n"
583 " BEQ loc_FF05DF58 \n"
584 " CMP R0, #0x400 \n"
585 " BNE loc_FF05DCAC \n"
586 " CMP R4, #0 \n"
587 " LDRNE R1, =0x285 \n"
588 " LDRNE R0, =0xFF05DF0C /*'RotaryEncoder.c'*/ \n"
589 " BLNE _DebugAssert \n"
590 " RSB R0, R4, R4, LSL#3 \n"
591 " LDR R0, [R6, R0, LSL#2] \n"
592
593 "loc_FF05DD14:\n"
594 " BL sub_FF05DFD8 \n"
595 " B loc_FF05DCAC \n"
596
597 "loc_FF05DD1C:\n"
598
599 "labelA:\n"
600 " LDR R0, =jogdial_stopped\n"
601 " LDR R0, [R0]\n"
602 " CMP R0, #1\n"
603 " BNE labelB\n"
604 " MOV R0, #40\n"
605 " BL _SleepTask\n"
606 " B labelA\n"
607 "labelB:\n"
608
609 " LDR R0, =0x2E3C \n"
610 " LDR R0, [R0, R4, LSL#2] \n"
611 " BL sub_FF020DF4 /*_CancelTimer*/ \n"
612 " LDR R2, =0xFF05DBA8 \n"
613 " ORR R3, R4, #0x200 \n"
614 " MOV R1, R2 \n"
615 " MOV R0, #0x28 \n"
616 " BL sub_FF020D10 /*_SetTimerAfter*/ \n"
617 " TST R0, #1 \n"
618 " CMPNE R0, #0x15 \n"
619 " STR R0, [R10, R4, LSL#2] \n"
620 " BEQ loc_FF05DCAC \n"
621 " LDR R1, =0x21D \n"
622 " B loc_FF05DEF8 \n"
623
624 "loc_FF05DD54:\n"
625 " RSB R5, R4, R4, LSL#3 \n"
626 " LDR R0, [R6, R5, LSL#2] \n"
627 " LDR R1, =0xC0240000 \n"
628 " ADD R0, R1, R0, LSL#8 \n"
629 " LDR R0, [R0, #0x104] \n"
630 " MOV R1, R0, ASR#16 \n"
631 " ADD R0, SP, #0x14 \n"
632 " ADD R11, R0, R4, LSL#1 \n"
633 " ADD R0, SP, #0x10 \n"
634 " ADD R0, R0, R4, LSL#1 \n"
635 " STRH R1, [R11] \n"
636 " STR R0, [SP, #0x18] \n"
637 " LDRSH R3, [R0] \n"
638 " SUB R2, R1, R3 \n"
639 " CMP R2, #0 \n"
640 " BNE loc_FF05DDD8 \n"
641 " LDR R0, [R9, R4, LSL#2] \n"
642 " CMP R0, #0 \n"
643 " BEQ loc_FF05DEB4 \n"
644 " LDR R7, =0x2E3C \n"
645 " LDR R0, [R7, R4, LSL#2] \n"
646 " BL sub_FF020DF4 /*_CancelTimer*/ \n"
647 " LDR R2, =0xFF05DBB4 \n"
648 " ORR R3, R4, #0x300 \n"
649 " MOV R1, R2 \n"
650 " MOV R0, #0x1F4 \n"
651 " BL sub_FF020D10 /*_SetTimerAfter*/ \n"
652 " TST R0, #1 \n"
653 " CMPNE R0, #0x15 \n"
654 " STR R0, [R7, R4, LSL#2] \n"
655 " BEQ loc_FF05DEB4 \n"
656 " LDR R1, =0x236 \n"
657 " B loc_FF05DEAC \n"
658
659 "loc_FF05DDD8:\n"
660 " MOV R0, R2 \n"
661 " RSBLT R0, R0, #0 \n"
662 " MOVLE R7, #0 \n"
663 " MOVGT R7, #1 \n"
664 " CMP R0, #0xFF \n"
665 " BLS loc_FF05DE14 \n"
666 " LDR R0, =0x7FFF \n"
667 " CMP R2, #0 \n"
668 " SUBLE R0, R0, R3 \n"
669 " ADDLE R0, R0, R1 \n"
670 " SUBGT R0, R0, R1 \n"
671 " ADDGT R0, R0, R3 \n"
672 " MVN R1, #0x8000 \n"
673 " SUB R0, R0, R1 \n"
674 " EOR R7, R7, #1 \n"
675
676 "loc_FF05DE14:\n"
677 " STR R0, [SP, #4] \n"
678 " LDR R0, [R9, R4, LSL#2] \n"
679 " CMP R0, #0 \n"
680 " ADDEQ R0, R6, R5, LSL#2 \n"
681 " LDREQ R0, [R0, #8] \n"
682 " BEQ loc_FF05DE4C \n"
683 " ADD R8, R6, R5, LSL#2 \n"
684 " ADD R1, R8, R7, LSL#2 \n"
685 " LDR R1, [R1, #0x10] \n"
686 " CMP R1, R0 \n"
687 " BEQ loc_FF05DE50 \n"
688 " LDR R0, [R8, #0xC] \n"
689 " BL sub_FF019F18 \n"
690 " LDR R0, [R8, #8] \n"
691
692 "loc_FF05DE4C:\n"
693 " BL sub_FF019F18 \n"
694
695 "loc_FF05DE50:\n"
696 " ADD R0, R6, R5, LSL#2 \n"
697 " ADD R7, R0, R7, LSL#2 \n"
698 " LDR R0, [R7, #0x10] \n"
699 " LDR R1, [SP, #4] \n"
700 " BL sub_FF019F28 \n"
701 " LDR R0, [R7, #0x10] \n"
702 " LDR R7, =0x2E3C \n"
703 " STR R0, [R9, R4, LSL#2] \n"
704 " LDRH R1, [R11] \n"
705 " LDR R0, [SP, #0x18] \n"
706 " STRH R1, [R0] \n"
707 " LDR R0, [R7, R4, LSL#2] \n"
708 " BL sub_FF020DF4 /*_CancelTimer*/ \n"
709 " LDR R2, =0xFF05DBB4 \n"
710 " ORR R3, R4, #0x300 \n"
711 " MOV R1, R2 \n"
712 " MOV R0, #0x1F4 \n"
713 " BL sub_FF020D10 /*_SetTimerAfter*/ \n"
714 " TST R0, #1 \n"
715 " CMPNE R0, #0x15 \n"
716 " STR R0, [R7, R4, LSL#2] \n"
717 " BEQ loc_FF05DEB4 \n"
718 " LDR R1, =0x267 \n"
719
720 "loc_FF05DEAC:\n"
721 " LDR R0, =0xFF05DF0C /*'RotaryEncoder.c'*/ \n"
722 " BL _DebugAssert \n"
723
724 "loc_FF05DEB4:\n"
725 " ADD R0, R6, R5, LSL#2 \n"
726 " LDR R0, [R0, #0x18] \n"
727 " CMP R0, #1 \n"
728 " BNE loc_FF05DF50 \n"
729 " LDR R0, =0x2E30 \n"
730 " LDR R0, [R0, #0x10] \n"
731 " CMP R0, #0 \n"
732 " BEQ loc_FF05DF50 \n"
733 " LDR R2, =0xFF05DBA8 \n"
734 " ORR R3, R4, #0x400 \n"
735 " MOV R1, R2 \n"
736 " BL sub_FF020D10 /*_SetTimerAfter*/ \n"
737 " TST R0, #1 \n"
738 " CMPNE R0, #0x15 \n"
739 " STR R0, [R10, R4, LSL#2] \n"
740 " BEQ loc_FF05DCAC \n"
741 " LDR R1, =0x26E \n"
742
743 "loc_FF05DEF8:\n"
744 " LDR R0, =0xFF05DF0C /*'RotaryEncoder.c'*/ \n"
745 " BL _DebugAssert \n"
746 " B loc_FF05DCAC \n"
747
748 "loc_FF05DF50:\n"
749 " LDR R0, [R6, R5, LSL#2] \n"
750 " B loc_FF05DD14 \n"
751
752 "loc_FF05DF58:\n"
753 " LDR R0, [R9, R4, LSL#2] \n"
754 " CMP R0, #0 \n"
755 " MOVEQ R1, #0x278 \n"
756 " LDREQ R0, =0xFF05DF0C /*'RotaryEncoder.c'*/ \n"
757 " BLEQ _DebugAssert \n"
758 " RSB R0, R4, R4, LSL#3 \n"
759 " ADD R0, R6, R0, LSL#2 \n"
760 " LDR R0, [R0, #0xC] \n"
761 " BL sub_FF019F18 \n"
762 " MOV R0, #0 \n"
763 " STR R0, [R9, R4, LSL#2] \n"
764 " B loc_FF05DCAC \n"
765 );
766 }