ac212c4a0a
from code-licensing into j1939 Reviewed-on: erickahmed/j1939_logger#13
27717 lines
1.0 MiB
Plaintext
27717 lines
1.0 MiB
Plaintext
|
|
can_logger.elf: file format elf32-littlearm
|
|
|
|
Sections:
|
|
Idx Name Size VMA LMA File off Algn
|
|
0 .isr_vector 00000188 08000000 08000000 00001000 2**0
|
|
CONTENTS, ALLOC, LOAD, READONLY, DATA
|
|
1 .text 00009f1c 08000190 08000190 00001190 2**4
|
|
CONTENTS, ALLOC, LOAD, READONLY, CODE
|
|
2 .rodata 00000214 0800a0ac 0800a0ac 0000b0ac 2**2
|
|
CONTENTS, ALLOC, LOAD, READONLY, DATA
|
|
3 .ARM.extab 00000000 0800a2c0 0800a2c0 0000c078 2**0
|
|
CONTENTS, READONLY
|
|
4 .ARM 00000008 0800a2c0 0800a2c0 0000b2c0 2**2
|
|
CONTENTS, ALLOC, LOAD, READONLY, DATA
|
|
5 .preinit_array 00000000 0800a2c8 0800a2c8 0000c078 2**0
|
|
CONTENTS, ALLOC, LOAD, DATA
|
|
6 .init_array 00000004 0800a2c8 0800a2c8 0000b2c8 2**2
|
|
CONTENTS, ALLOC, LOAD, READONLY, DATA
|
|
7 .fini_array 00000004 0800a2cc 0800a2cc 0000b2cc 2**2
|
|
CONTENTS, ALLOC, LOAD, READONLY, DATA
|
|
8 .data 00000078 20000000 0800a2d0 0000c000 2**2
|
|
CONTENTS, ALLOC, LOAD, DATA
|
|
9 .ccmram 00000000 10000000 10000000 0000c078 2**0
|
|
CONTENTS
|
|
10 .bss 00004dd8 20000078 20000078 0000c078 2**2
|
|
ALLOC
|
|
11 ._user_heap_stack 00000600 20004e50 20004e50 0000c078 2**0
|
|
ALLOC
|
|
12 .ARM.attributes 00000030 00000000 00000000 0000c078 2**0
|
|
CONTENTS, READONLY
|
|
13 .debug_info 0001baa1 00000000 00000000 0000c0a8 2**0
|
|
CONTENTS, READONLY, DEBUGGING, OCTETS
|
|
14 .debug_abbrev 00003dfb 00000000 00000000 00027b49 2**0
|
|
CONTENTS, READONLY, DEBUGGING, OCTETS
|
|
15 .debug_aranges 00001780 00000000 00000000 0002b948 2**3
|
|
CONTENTS, READONLY, DEBUGGING, OCTETS
|
|
16 .debug_rnglists 00001226 00000000 00000000 0002d0c8 2**0
|
|
CONTENTS, READONLY, DEBUGGING, OCTETS
|
|
17 .debug_macro 00022ab1 00000000 00000000 0002e2ee 2**0
|
|
CONTENTS, READONLY, DEBUGGING, OCTETS
|
|
18 .debug_line 0001dba5 00000000 00000000 00050d9f 2**0
|
|
CONTENTS, READONLY, DEBUGGING, OCTETS
|
|
19 .debug_str 000d1f03 00000000 00000000 0006e944 2**0
|
|
CONTENTS, READONLY, DEBUGGING, OCTETS
|
|
20 .comment 00000043 00000000 00000000 00140847 2**0
|
|
CONTENTS, READONLY
|
|
21 .debug_frame 000061e8 00000000 00000000 0014088c 2**2
|
|
CONTENTS, READONLY, DEBUGGING, OCTETS
|
|
22 .debug_line_str 00000055 00000000 00000000 00146a74 2**0
|
|
CONTENTS, READONLY, DEBUGGING, OCTETS
|
|
|
|
Disassembly of section .text:
|
|
|
|
08000190 <__do_global_dtors_aux>:
|
|
8000190: b510 push {r4, lr}
|
|
8000192: 4c05 ldr r4, [pc, #20] @ (80001a8 <__do_global_dtors_aux+0x18>)
|
|
8000194: 7823 ldrb r3, [r4, #0]
|
|
8000196: b933 cbnz r3, 80001a6 <__do_global_dtors_aux+0x16>
|
|
8000198: 4b04 ldr r3, [pc, #16] @ (80001ac <__do_global_dtors_aux+0x1c>)
|
|
800019a: b113 cbz r3, 80001a2 <__do_global_dtors_aux+0x12>
|
|
800019c: 4804 ldr r0, [pc, #16] @ (80001b0 <__do_global_dtors_aux+0x20>)
|
|
800019e: f3af 8000 nop.w
|
|
80001a2: 2301 movs r3, #1
|
|
80001a4: 7023 strb r3, [r4, #0]
|
|
80001a6: bd10 pop {r4, pc}
|
|
80001a8: 20000078 .word 0x20000078
|
|
80001ac: 00000000 .word 0x00000000
|
|
80001b0: 0800a094 .word 0x0800a094
|
|
|
|
080001b4 <frame_dummy>:
|
|
80001b4: b508 push {r3, lr}
|
|
80001b6: 4b03 ldr r3, [pc, #12] @ (80001c4 <frame_dummy+0x10>)
|
|
80001b8: b11b cbz r3, 80001c2 <frame_dummy+0xe>
|
|
80001ba: 4903 ldr r1, [pc, #12] @ (80001c8 <frame_dummy+0x14>)
|
|
80001bc: 4803 ldr r0, [pc, #12] @ (80001cc <frame_dummy+0x18>)
|
|
80001be: f3af 8000 nop.w
|
|
80001c2: bd08 pop {r3, pc}
|
|
80001c4: 00000000 .word 0x00000000
|
|
80001c8: 2000007c .word 0x2000007c
|
|
80001cc: 0800a094 .word 0x0800a094
|
|
|
|
080001d0 <__aeabi_uldivmod>:
|
|
80001d0: b953 cbnz r3, 80001e8 <__aeabi_uldivmod+0x18>
|
|
80001d2: b94a cbnz r2, 80001e8 <__aeabi_uldivmod+0x18>
|
|
80001d4: 2900 cmp r1, #0
|
|
80001d6: bf08 it eq
|
|
80001d8: 2800 cmpeq r0, #0
|
|
80001da: bf1c itt ne
|
|
80001dc: f04f 31ff movne.w r1, #4294967295 @ 0xffffffff
|
|
80001e0: f04f 30ff movne.w r0, #4294967295 @ 0xffffffff
|
|
80001e4: f000 b988 b.w 80004f8 <__aeabi_idiv0>
|
|
80001e8: f1ad 0c08 sub.w ip, sp, #8
|
|
80001ec: e96d ce04 strd ip, lr, [sp, #-16]!
|
|
80001f0: f000 f806 bl 8000200 <__udivmoddi4>
|
|
80001f4: f8dd e004 ldr.w lr, [sp, #4]
|
|
80001f8: e9dd 2302 ldrd r2, r3, [sp, #8]
|
|
80001fc: b004 add sp, #16
|
|
80001fe: 4770 bx lr
|
|
|
|
08000200 <__udivmoddi4>:
|
|
8000200: e92d 47f0 stmdb sp!, {r4, r5, r6, r7, r8, r9, sl, lr}
|
|
8000204: 9d08 ldr r5, [sp, #32]
|
|
8000206: 460f mov r7, r1
|
|
8000208: 4604 mov r4, r0
|
|
800020a: 468c mov ip, r1
|
|
800020c: 2b00 cmp r3, #0
|
|
800020e: d148 bne.n 80002a2 <__udivmoddi4+0xa2>
|
|
8000210: 428a cmp r2, r1
|
|
8000212: 4616 mov r6, r2
|
|
8000214: d961 bls.n 80002da <__udivmoddi4+0xda>
|
|
8000216: fab2 f382 clz r3, r2
|
|
800021a: b14b cbz r3, 8000230 <__udivmoddi4+0x30>
|
|
800021c: f1c3 0220 rsb r2, r3, #32
|
|
8000220: fa01 fc03 lsl.w ip, r1, r3
|
|
8000224: fa20 f202 lsr.w r2, r0, r2
|
|
8000228: 409e lsls r6, r3
|
|
800022a: ea42 0c0c orr.w ip, r2, ip
|
|
800022e: 409c lsls r4, r3
|
|
8000230: ea4f 4e16 mov.w lr, r6, lsr #16
|
|
8000234: b2b7 uxth r7, r6
|
|
8000236: fbbc f1fe udiv r1, ip, lr
|
|
800023a: 0c22 lsrs r2, r4, #16
|
|
800023c: fb0e cc11 mls ip, lr, r1, ip
|
|
8000240: ea42 420c orr.w r2, r2, ip, lsl #16
|
|
8000244: fb01 f007 mul.w r0, r1, r7
|
|
8000248: 4290 cmp r0, r2
|
|
800024a: d909 bls.n 8000260 <__udivmoddi4+0x60>
|
|
800024c: 18b2 adds r2, r6, r2
|
|
800024e: f101 3cff add.w ip, r1, #4294967295 @ 0xffffffff
|
|
8000252: f080 80ee bcs.w 8000432 <__udivmoddi4+0x232>
|
|
8000256: 4290 cmp r0, r2
|
|
8000258: f240 80eb bls.w 8000432 <__udivmoddi4+0x232>
|
|
800025c: 3902 subs r1, #2
|
|
800025e: 4432 add r2, r6
|
|
8000260: 1a12 subs r2, r2, r0
|
|
8000262: b2a4 uxth r4, r4
|
|
8000264: fbb2 f0fe udiv r0, r2, lr
|
|
8000268: fb0e 2210 mls r2, lr, r0, r2
|
|
800026c: ea44 4402 orr.w r4, r4, r2, lsl #16
|
|
8000270: fb00 f707 mul.w r7, r0, r7
|
|
8000274: 42a7 cmp r7, r4
|
|
8000276: d909 bls.n 800028c <__udivmoddi4+0x8c>
|
|
8000278: 1934 adds r4, r6, r4
|
|
800027a: f100 32ff add.w r2, r0, #4294967295 @ 0xffffffff
|
|
800027e: f080 80da bcs.w 8000436 <__udivmoddi4+0x236>
|
|
8000282: 42a7 cmp r7, r4
|
|
8000284: f240 80d7 bls.w 8000436 <__udivmoddi4+0x236>
|
|
8000288: 4434 add r4, r6
|
|
800028a: 3802 subs r0, #2
|
|
800028c: ea40 4001 orr.w r0, r0, r1, lsl #16
|
|
8000290: 1be4 subs r4, r4, r7
|
|
8000292: 2100 movs r1, #0
|
|
8000294: b11d cbz r5, 800029e <__udivmoddi4+0x9e>
|
|
8000296: 40dc lsrs r4, r3
|
|
8000298: 2300 movs r3, #0
|
|
800029a: e9c5 4300 strd r4, r3, [r5]
|
|
800029e: e8bd 87f0 ldmia.w sp!, {r4, r5, r6, r7, r8, r9, sl, pc}
|
|
80002a2: 428b cmp r3, r1
|
|
80002a4: d906 bls.n 80002b4 <__udivmoddi4+0xb4>
|
|
80002a6: b10d cbz r5, 80002ac <__udivmoddi4+0xac>
|
|
80002a8: e9c5 0100 strd r0, r1, [r5]
|
|
80002ac: 2100 movs r1, #0
|
|
80002ae: 4608 mov r0, r1
|
|
80002b0: e8bd 87f0 ldmia.w sp!, {r4, r5, r6, r7, r8, r9, sl, pc}
|
|
80002b4: fab3 f183 clz r1, r3
|
|
80002b8: 2900 cmp r1, #0
|
|
80002ba: d148 bne.n 800034e <__udivmoddi4+0x14e>
|
|
80002bc: 42bb cmp r3, r7
|
|
80002be: d302 bcc.n 80002c6 <__udivmoddi4+0xc6>
|
|
80002c0: 4282 cmp r2, r0
|
|
80002c2: f200 8107 bhi.w 80004d4 <__udivmoddi4+0x2d4>
|
|
80002c6: 1a84 subs r4, r0, r2
|
|
80002c8: eb67 0203 sbc.w r2, r7, r3
|
|
80002cc: 2001 movs r0, #1
|
|
80002ce: 4694 mov ip, r2
|
|
80002d0: 2d00 cmp r5, #0
|
|
80002d2: d0e4 beq.n 800029e <__udivmoddi4+0x9e>
|
|
80002d4: e9c5 4c00 strd r4, ip, [r5]
|
|
80002d8: e7e1 b.n 800029e <__udivmoddi4+0x9e>
|
|
80002da: 2a00 cmp r2, #0
|
|
80002dc: f000 8092 beq.w 8000404 <__udivmoddi4+0x204>
|
|
80002e0: fab2 f382 clz r3, r2
|
|
80002e4: 2b00 cmp r3, #0
|
|
80002e6: f040 80a8 bne.w 800043a <__udivmoddi4+0x23a>
|
|
80002ea: 1a8a subs r2, r1, r2
|
|
80002ec: ea4f 4e16 mov.w lr, r6, lsr #16
|
|
80002f0: fa1f fc86 uxth.w ip, r6
|
|
80002f4: 2101 movs r1, #1
|
|
80002f6: 0c20 lsrs r0, r4, #16
|
|
80002f8: fbb2 f7fe udiv r7, r2, lr
|
|
80002fc: fb0e 2217 mls r2, lr, r7, r2
|
|
8000300: ea40 4202 orr.w r2, r0, r2, lsl #16
|
|
8000304: fb0c f007 mul.w r0, ip, r7
|
|
8000308: 4290 cmp r0, r2
|
|
800030a: d907 bls.n 800031c <__udivmoddi4+0x11c>
|
|
800030c: 18b2 adds r2, r6, r2
|
|
800030e: f107 38ff add.w r8, r7, #4294967295 @ 0xffffffff
|
|
8000312: d202 bcs.n 800031a <__udivmoddi4+0x11a>
|
|
8000314: 4290 cmp r0, r2
|
|
8000316: f200 80e2 bhi.w 80004de <__udivmoddi4+0x2de>
|
|
800031a: 4647 mov r7, r8
|
|
800031c: 1a12 subs r2, r2, r0
|
|
800031e: b2a4 uxth r4, r4
|
|
8000320: fbb2 f0fe udiv r0, r2, lr
|
|
8000324: fb0e 2210 mls r2, lr, r0, r2
|
|
8000328: ea44 4402 orr.w r4, r4, r2, lsl #16
|
|
800032c: fb0c fc00 mul.w ip, ip, r0
|
|
8000330: 45a4 cmp ip, r4
|
|
8000332: d907 bls.n 8000344 <__udivmoddi4+0x144>
|
|
8000334: 1934 adds r4, r6, r4
|
|
8000336: f100 32ff add.w r2, r0, #4294967295 @ 0xffffffff
|
|
800033a: d202 bcs.n 8000342 <__udivmoddi4+0x142>
|
|
800033c: 45a4 cmp ip, r4
|
|
800033e: f200 80cb bhi.w 80004d8 <__udivmoddi4+0x2d8>
|
|
8000342: 4610 mov r0, r2
|
|
8000344: eba4 040c sub.w r4, r4, ip
|
|
8000348: ea40 4007 orr.w r0, r0, r7, lsl #16
|
|
800034c: e7a2 b.n 8000294 <__udivmoddi4+0x94>
|
|
800034e: f1c1 0620 rsb r6, r1, #32
|
|
8000352: 408b lsls r3, r1
|
|
8000354: fa22 fc06 lsr.w ip, r2, r6
|
|
8000358: ea4c 0c03 orr.w ip, ip, r3
|
|
800035c: fa07 f401 lsl.w r4, r7, r1
|
|
8000360: fa20 f306 lsr.w r3, r0, r6
|
|
8000364: 40f7 lsrs r7, r6
|
|
8000366: ea4f 491c mov.w r9, ip, lsr #16
|
|
800036a: 4323 orrs r3, r4
|
|
800036c: fa00 f801 lsl.w r8, r0, r1
|
|
8000370: fa1f fe8c uxth.w lr, ip
|
|
8000374: fbb7 f0f9 udiv r0, r7, r9
|
|
8000378: 0c1c lsrs r4, r3, #16
|
|
800037a: fb09 7710 mls r7, r9, r0, r7
|
|
800037e: ea44 4407 orr.w r4, r4, r7, lsl #16
|
|
8000382: fb00 f70e mul.w r7, r0, lr
|
|
8000386: 42a7 cmp r7, r4
|
|
8000388: fa02 f201 lsl.w r2, r2, r1
|
|
800038c: d90a bls.n 80003a4 <__udivmoddi4+0x1a4>
|
|
800038e: eb1c 0404 adds.w r4, ip, r4
|
|
8000392: f100 3aff add.w sl, r0, #4294967295 @ 0xffffffff
|
|
8000396: f080 809b bcs.w 80004d0 <__udivmoddi4+0x2d0>
|
|
800039a: 42a7 cmp r7, r4
|
|
800039c: f240 8098 bls.w 80004d0 <__udivmoddi4+0x2d0>
|
|
80003a0: 3802 subs r0, #2
|
|
80003a2: 4464 add r4, ip
|
|
80003a4: 1be4 subs r4, r4, r7
|
|
80003a6: b29f uxth r7, r3
|
|
80003a8: fbb4 f3f9 udiv r3, r4, r9
|
|
80003ac: fb09 4413 mls r4, r9, r3, r4
|
|
80003b0: ea47 4404 orr.w r4, r7, r4, lsl #16
|
|
80003b4: fb03 fe0e mul.w lr, r3, lr
|
|
80003b8: 45a6 cmp lr, r4
|
|
80003ba: d909 bls.n 80003d0 <__udivmoddi4+0x1d0>
|
|
80003bc: eb1c 0404 adds.w r4, ip, r4
|
|
80003c0: f103 37ff add.w r7, r3, #4294967295 @ 0xffffffff
|
|
80003c4: f080 8082 bcs.w 80004cc <__udivmoddi4+0x2cc>
|
|
80003c8: 45a6 cmp lr, r4
|
|
80003ca: d97f bls.n 80004cc <__udivmoddi4+0x2cc>
|
|
80003cc: 3b02 subs r3, #2
|
|
80003ce: 4464 add r4, ip
|
|
80003d0: ea43 4000 orr.w r0, r3, r0, lsl #16
|
|
80003d4: eba4 040e sub.w r4, r4, lr
|
|
80003d8: fba0 e702 umull lr, r7, r0, r2
|
|
80003dc: 42bc cmp r4, r7
|
|
80003de: 4673 mov r3, lr
|
|
80003e0: 46b9 mov r9, r7
|
|
80003e2: d363 bcc.n 80004ac <__udivmoddi4+0x2ac>
|
|
80003e4: d060 beq.n 80004a8 <__udivmoddi4+0x2a8>
|
|
80003e6: b15d cbz r5, 8000400 <__udivmoddi4+0x200>
|
|
80003e8: ebb8 0203 subs.w r2, r8, r3
|
|
80003ec: eb64 0409 sbc.w r4, r4, r9
|
|
80003f0: fa04 f606 lsl.w r6, r4, r6
|
|
80003f4: fa22 f301 lsr.w r3, r2, r1
|
|
80003f8: 431e orrs r6, r3
|
|
80003fa: 40cc lsrs r4, r1
|
|
80003fc: e9c5 6400 strd r6, r4, [r5]
|
|
8000400: 2100 movs r1, #0
|
|
8000402: e74c b.n 800029e <__udivmoddi4+0x9e>
|
|
8000404: 0862 lsrs r2, r4, #1
|
|
8000406: 0848 lsrs r0, r1, #1
|
|
8000408: ea42 71c1 orr.w r1, r2, r1, lsl #31
|
|
800040c: 0c0b lsrs r3, r1, #16
|
|
800040e: ea43 4300 orr.w r3, r3, r0, lsl #16
|
|
8000412: b28a uxth r2, r1
|
|
8000414: ea42 4203 orr.w r2, r2, r3, lsl #16
|
|
8000418: fbb3 f1f6 udiv r1, r3, r6
|
|
800041c: 07e4 lsls r4, r4, #31
|
|
800041e: 46b4 mov ip, r6
|
|
8000420: 4637 mov r7, r6
|
|
8000422: 46b6 mov lr, r6
|
|
8000424: 231f movs r3, #31
|
|
8000426: fbb0 f0f6 udiv r0, r0, r6
|
|
800042a: 1bd2 subs r2, r2, r7
|
|
800042c: ea41 4100 orr.w r1, r1, r0, lsl #16
|
|
8000430: e761 b.n 80002f6 <__udivmoddi4+0xf6>
|
|
8000432: 4661 mov r1, ip
|
|
8000434: e714 b.n 8000260 <__udivmoddi4+0x60>
|
|
8000436: 4610 mov r0, r2
|
|
8000438: e728 b.n 800028c <__udivmoddi4+0x8c>
|
|
800043a: f1c3 0120 rsb r1, r3, #32
|
|
800043e: fa20 f201 lsr.w r2, r0, r1
|
|
8000442: 409e lsls r6, r3
|
|
8000444: fa27 f101 lsr.w r1, r7, r1
|
|
8000448: 409f lsls r7, r3
|
|
800044a: 433a orrs r2, r7
|
|
800044c: ea4f 4e16 mov.w lr, r6, lsr #16
|
|
8000450: fa1f fc86 uxth.w ip, r6
|
|
8000454: fbb1 f7fe udiv r7, r1, lr
|
|
8000458: fb0e 1017 mls r0, lr, r7, r1
|
|
800045c: 0c11 lsrs r1, r2, #16
|
|
800045e: ea41 4100 orr.w r1, r1, r0, lsl #16
|
|
8000462: fb07 f80c mul.w r8, r7, ip
|
|
8000466: 4588 cmp r8, r1
|
|
8000468: fa04 f403 lsl.w r4, r4, r3
|
|
800046c: d93a bls.n 80004e4 <__udivmoddi4+0x2e4>
|
|
800046e: 1871 adds r1, r6, r1
|
|
8000470: f107 30ff add.w r0, r7, #4294967295 @ 0xffffffff
|
|
8000474: d201 bcs.n 800047a <__udivmoddi4+0x27a>
|
|
8000476: 4588 cmp r8, r1
|
|
8000478: d81f bhi.n 80004ba <__udivmoddi4+0x2ba>
|
|
800047a: eba1 0108 sub.w r1, r1, r8
|
|
800047e: fbb1 f8fe udiv r8, r1, lr
|
|
8000482: fb08 f70c mul.w r7, r8, ip
|
|
8000486: fb0e 1118 mls r1, lr, r8, r1
|
|
800048a: b292 uxth r2, r2
|
|
800048c: ea42 4201 orr.w r2, r2, r1, lsl #16
|
|
8000490: 42ba cmp r2, r7
|
|
8000492: d22f bcs.n 80004f4 <__udivmoddi4+0x2f4>
|
|
8000494: 18b2 adds r2, r6, r2
|
|
8000496: f108 31ff add.w r1, r8, #4294967295 @ 0xffffffff
|
|
800049a: d2c6 bcs.n 800042a <__udivmoddi4+0x22a>
|
|
800049c: 42ba cmp r2, r7
|
|
800049e: d2c4 bcs.n 800042a <__udivmoddi4+0x22a>
|
|
80004a0: f1a8 0102 sub.w r1, r8, #2
|
|
80004a4: 4432 add r2, r6
|
|
80004a6: e7c0 b.n 800042a <__udivmoddi4+0x22a>
|
|
80004a8: 45f0 cmp r8, lr
|
|
80004aa: d29c bcs.n 80003e6 <__udivmoddi4+0x1e6>
|
|
80004ac: ebbe 0302 subs.w r3, lr, r2
|
|
80004b0: eb67 070c sbc.w r7, r7, ip
|
|
80004b4: 3801 subs r0, #1
|
|
80004b6: 46b9 mov r9, r7
|
|
80004b8: e795 b.n 80003e6 <__udivmoddi4+0x1e6>
|
|
80004ba: eba6 0808 sub.w r8, r6, r8
|
|
80004be: 4441 add r1, r8
|
|
80004c0: 1eb8 subs r0, r7, #2
|
|
80004c2: fbb1 f8fe udiv r8, r1, lr
|
|
80004c6: fb08 f70c mul.w r7, r8, ip
|
|
80004ca: e7dc b.n 8000486 <__udivmoddi4+0x286>
|
|
80004cc: 463b mov r3, r7
|
|
80004ce: e77f b.n 80003d0 <__udivmoddi4+0x1d0>
|
|
80004d0: 4650 mov r0, sl
|
|
80004d2: e767 b.n 80003a4 <__udivmoddi4+0x1a4>
|
|
80004d4: 4608 mov r0, r1
|
|
80004d6: e6fb b.n 80002d0 <__udivmoddi4+0xd0>
|
|
80004d8: 4434 add r4, r6
|
|
80004da: 3802 subs r0, #2
|
|
80004dc: e732 b.n 8000344 <__udivmoddi4+0x144>
|
|
80004de: 3f02 subs r7, #2
|
|
80004e0: 4432 add r2, r6
|
|
80004e2: e71b b.n 800031c <__udivmoddi4+0x11c>
|
|
80004e4: eba1 0108 sub.w r1, r1, r8
|
|
80004e8: 4638 mov r0, r7
|
|
80004ea: fbb1 f8fe udiv r8, r1, lr
|
|
80004ee: fb08 f70c mul.w r7, r8, ip
|
|
80004f2: e7c8 b.n 8000486 <__udivmoddi4+0x286>
|
|
80004f4: 4641 mov r1, r8
|
|
80004f6: e798 b.n 800042a <__udivmoddi4+0x22a>
|
|
|
|
080004f8 <__aeabi_idiv0>:
|
|
80004f8: 4770 bx lr
|
|
80004fa: bf00 nop
|
|
|
|
080004fc <CAN_Logger_Init>:
|
|
* @brief Initialize CAN bus logger.
|
|
* @param argument: hcan1, hcan2
|
|
* @retval None
|
|
*/
|
|
void CAN_Logger_Init(CAN_HandleTypeDef *hcan1, CAN_HandleTypeDef *hcan2)
|
|
{
|
|
80004fc: b580 push {r7, lr}
|
|
80004fe: b08c sub sp, #48 @ 0x30
|
|
8000500: af00 add r7, sp, #0
|
|
8000502: 6078 str r0, [r7, #4]
|
|
8000504: 6039 str r1, [r7, #0]
|
|
CAN_FilterTypeDef filter = {0};
|
|
8000506: f107 0308 add.w r3, r7, #8
|
|
800050a: 2228 movs r2, #40 @ 0x28
|
|
800050c: 2100 movs r1, #0
|
|
800050e: 4618 mov r0, r3
|
|
8000510: f009 fcde bl 8009ed0 <memset>
|
|
filter.FilterMode = CAN_FILTERMODE_IDMASK;
|
|
8000514: 2300 movs r3, #0
|
|
8000516: 623b str r3, [r7, #32]
|
|
filter.FilterScale = CAN_FILTERSCALE_32BIT;
|
|
8000518: 2301 movs r3, #1
|
|
800051a: 627b str r3, [r7, #36] @ 0x24
|
|
filter.FilterIdHigh = 0x0000;
|
|
800051c: 2300 movs r3, #0
|
|
800051e: 60bb str r3, [r7, #8]
|
|
filter.FilterMaskIdHigh = 0x0000;
|
|
8000520: 2300 movs r3, #0
|
|
8000522: 613b str r3, [r7, #16]
|
|
filter.FilterIdLow = 0x0000;
|
|
8000524: 2300 movs r3, #0
|
|
8000526: 60fb str r3, [r7, #12]
|
|
filter.FilterMaskIdLow = 0x0000;
|
|
8000528: 2300 movs r3, #0
|
|
800052a: 617b str r3, [r7, #20]
|
|
filter.FilterFIFOAssignment = CAN_FILTER_FIFO0;
|
|
800052c: 2300 movs r3, #0
|
|
800052e: 61bb str r3, [r7, #24]
|
|
filter.FilterActivation = ENABLE;
|
|
8000530: 2301 movs r3, #1
|
|
8000532: 62bb str r3, [r7, #40] @ 0x28
|
|
filter.SlaveStartFilterBank = 14;
|
|
8000534: 230e movs r3, #14
|
|
8000536: 62fb str r3, [r7, #44] @ 0x2c
|
|
|
|
filter.FilterBank = 0;
|
|
8000538: 2300 movs r3, #0
|
|
800053a: 61fb str r3, [r7, #28]
|
|
if (HAL_CAN_ConfigFilter(hcan1, &filter) != HAL_OK) Error_Handler();
|
|
800053c: f107 0308 add.w r3, r7, #8
|
|
8000540: 4619 mov r1, r3
|
|
8000542: 6878 ldr r0, [r7, #4]
|
|
8000544: f001 fa12 bl 800196c <HAL_CAN_ConfigFilter>
|
|
8000548: 4603 mov r3, r0
|
|
800054a: 2b00 cmp r3, #0
|
|
800054c: d001 beq.n 8000552 <CAN_Logger_Init+0x56>
|
|
800054e: f000 fbb1 bl 8000cb4 <Error_Handler>
|
|
filter.FilterBank = 14;
|
|
8000552: 230e movs r3, #14
|
|
8000554: 61fb str r3, [r7, #28]
|
|
if (HAL_CAN_ConfigFilter(hcan2, &filter) != HAL_OK) Error_Handler();
|
|
8000556: f107 0308 add.w r3, r7, #8
|
|
800055a: 4619 mov r1, r3
|
|
800055c: 6838 ldr r0, [r7, #0]
|
|
800055e: f001 fa05 bl 800196c <HAL_CAN_ConfigFilter>
|
|
8000562: 4603 mov r3, r0
|
|
8000564: 2b00 cmp r3, #0
|
|
8000566: d001 beq.n 800056c <CAN_Logger_Init+0x70>
|
|
8000568: f000 fba4 bl 8000cb4 <Error_Handler>
|
|
|
|
if (HAL_CAN_Start(hcan1) != HAL_OK) Error_Handler();
|
|
800056c: 6878 ldr r0, [r7, #4]
|
|
800056e: f001 fb49 bl 8001c04 <HAL_CAN_Start>
|
|
8000572: 4603 mov r3, r0
|
|
8000574: 2b00 cmp r3, #0
|
|
8000576: d001 beq.n 800057c <CAN_Logger_Init+0x80>
|
|
8000578: f000 fb9c bl 8000cb4 <Error_Handler>
|
|
if (HAL_CAN_Start(hcan2) != HAL_OK) Error_Handler();
|
|
800057c: 6838 ldr r0, [r7, #0]
|
|
800057e: f001 fb41 bl 8001c04 <HAL_CAN_Start>
|
|
8000582: 4603 mov r3, r0
|
|
8000584: 2b00 cmp r3, #0
|
|
8000586: d001 beq.n 800058c <CAN_Logger_Init+0x90>
|
|
8000588: f000 fb94 bl 8000cb4 <Error_Handler>
|
|
|
|
if (HAL_CAN_ActivateNotification(hcan1, CAN_IT_RX_FIFO0_MSG_PENDING) != HAL_OK) Error_Handler();
|
|
800058c: 2102 movs r1, #2
|
|
800058e: 6878 ldr r0, [r7, #4]
|
|
8000590: f001 fcaa bl 8001ee8 <HAL_CAN_ActivateNotification>
|
|
8000594: 4603 mov r3, r0
|
|
8000596: 2b00 cmp r3, #0
|
|
8000598: d001 beq.n 800059e <CAN_Logger_Init+0xa2>
|
|
800059a: f000 fb8b bl 8000cb4 <Error_Handler>
|
|
if (HAL_CAN_ActivateNotification(hcan2, CAN_IT_RX_FIFO0_MSG_PENDING) != HAL_OK) Error_Handler();
|
|
800059e: 2102 movs r1, #2
|
|
80005a0: 6838 ldr r0, [r7, #0]
|
|
80005a2: f001 fca1 bl 8001ee8 <HAL_CAN_ActivateNotification>
|
|
80005a6: 4603 mov r3, r0
|
|
80005a8: 2b00 cmp r3, #0
|
|
80005aa: d001 beq.n 80005b0 <CAN_Logger_Init+0xb4>
|
|
80005ac: f000 fb82 bl 8000cb4 <Error_Handler>
|
|
}
|
|
80005b0: bf00 nop
|
|
80005b2: 3730 adds r7, #48 @ 0x30
|
|
80005b4: 46bd mov sp, r7
|
|
80005b6: bd80 pop {r7, pc}
|
|
|
|
080005b8 <HAL_CAN_RxFifo0MsgPendingCallback>:
|
|
* @brief ISR for CAN message pending in FIFO0
|
|
* @param argument: Can handle hcan (hcan1 or hcan2)
|
|
* @retval None
|
|
*/
|
|
void HAL_CAN_RxFifo0MsgPendingCallback(CAN_HandleTypeDef *hcan)
|
|
{
|
|
80005b8: b580 push {r7, lr}
|
|
80005ba: b090 sub sp, #64 @ 0x40
|
|
80005bc: af00 add r7, sp, #0
|
|
80005be: 6078 str r0, [r7, #4]
|
|
/* CODE BEGIN */
|
|
CanMessage_t message;
|
|
CAN_RxHeaderTypeDef rxHeader;
|
|
uint8_t data[8];
|
|
|
|
if (HAL_CAN_GetRxMessage(hcan, CAN_RX_FIFO0, &rxHeader, data) != HAL_OK) Error_Handler();
|
|
80005c0: f107 0308 add.w r3, r7, #8
|
|
80005c4: f107 0210 add.w r2, r7, #16
|
|
80005c8: 2100 movs r1, #0
|
|
80005ca: 6878 ldr r0, [r7, #4]
|
|
80005cc: f001 fb5e bl 8001c8c <HAL_CAN_GetRxMessage>
|
|
80005d0: 4603 mov r3, r0
|
|
80005d2: 2b00 cmp r3, #0
|
|
80005d4: d001 beq.n 80005da <HAL_CAN_RxFifo0MsgPendingCallback+0x22>
|
|
80005d6: f000 fb6d bl 8000cb4 <Error_Handler>
|
|
|
|
message.id = rxHeader.ExtId;
|
|
80005da: 697b ldr r3, [r7, #20]
|
|
80005dc: 62fb str r3, [r7, #44] @ 0x2c
|
|
message.dlc = rxHeader.DLC;
|
|
80005de: 6a3b ldr r3, [r7, #32]
|
|
80005e0: b2db uxtb r3, r3
|
|
80005e2: f887 3038 strb.w r3, [r7, #56] @ 0x38
|
|
message.isExtended = (rxHeader.IDE == CAN_ID_EXT);
|
|
80005e6: 69bb ldr r3, [r7, #24]
|
|
80005e8: 2b04 cmp r3, #4
|
|
80005ea: bf0c ite eq
|
|
80005ec: 2301 moveq r3, #1
|
|
80005ee: 2300 movne r3, #0
|
|
80005f0: b2db uxtb r3, r3
|
|
80005f2: f887 3039 strb.w r3, [r7, #57] @ 0x39
|
|
memcpy(message.payload, data, rxHeader.DLC);
|
|
80005f6: 6a3a ldr r2, [r7, #32]
|
|
80005f8: f107 0108 add.w r1, r7, #8
|
|
80005fc: f107 032c add.w r3, r7, #44 @ 0x2c
|
|
8000600: 3304 adds r3, #4
|
|
8000602: 4618 mov r0, r3
|
|
8000604: f009 fcee bl 8009fe4 <memcpy>
|
|
|
|
osMessageQueueId_t queue = (hcan->Instance == CAN1) ? xCAN1RxQueue : xCAN2RxQueue;
|
|
8000608: 687b ldr r3, [r7, #4]
|
|
800060a: 681b ldr r3, [r3, #0]
|
|
800060c: 4a09 ldr r2, [pc, #36] @ (8000634 <HAL_CAN_RxFifo0MsgPendingCallback+0x7c>)
|
|
800060e: 4293 cmp r3, r2
|
|
8000610: d102 bne.n 8000618 <HAL_CAN_RxFifo0MsgPendingCallback+0x60>
|
|
8000612: 4b09 ldr r3, [pc, #36] @ (8000638 <HAL_CAN_RxFifo0MsgPendingCallback+0x80>)
|
|
8000614: 681b ldr r3, [r3, #0]
|
|
8000616: e001 b.n 800061c <HAL_CAN_RxFifo0MsgPendingCallback+0x64>
|
|
8000618: 4b08 ldr r3, [pc, #32] @ (800063c <HAL_CAN_RxFifo0MsgPendingCallback+0x84>)
|
|
800061a: 681b ldr r3, [r3, #0]
|
|
800061c: 63fb str r3, [r7, #60] @ 0x3c
|
|
if (osMessageQueuePut(queue, &message, 0U, 0U) != osOK)
|
|
800061e: f107 012c add.w r1, r7, #44 @ 0x2c
|
|
8000622: 2300 movs r3, #0
|
|
8000624: 2200 movs r2, #0
|
|
8000626: 6bf8 ldr r0, [r7, #60] @ 0x3c
|
|
8000628: f006 fa14 bl 8006a54 <osMessageQueuePut>
|
|
// TODO: better handling: flash error_led on osTimeout, call Error_Handler() when other errors
|
|
|
|
// send errors like queue full via UART
|
|
}
|
|
/* CODE END */
|
|
}
|
|
800062c: bf00 nop
|
|
800062e: 3740 adds r7, #64 @ 0x40
|
|
8000630: 46bd mov sp, r7
|
|
8000632: bd80 pop {r7, pc}
|
|
8000634: 40006400 .word 0x40006400
|
|
8000638: 200002c8 .word 0x200002c8
|
|
800063c: 200002cc .word 0x200002cc
|
|
|
|
08000640 <vCANLoggerListen>:
|
|
* @brief Log incoming CAN bus traffic in FIFO buffer
|
|
* @param argument: Not used
|
|
* @retval None
|
|
*/
|
|
void vCANLoggerListen(void *argument)
|
|
{
|
|
8000640: b580 push {r7, lr}
|
|
8000642: b088 sub sp, #32
|
|
8000644: af00 add r7, sp, #0
|
|
8000646: 6078 str r0, [r7, #4]
|
|
/* CODE BEGIN */
|
|
CAN_HandleTypeDef *hcan = (CAN_HandleTypeDef*)argument;
|
|
8000648: 687b ldr r3, [r7, #4]
|
|
800064a: 61fb str r3, [r7, #28]
|
|
osMessageQueueId_t queue;
|
|
CanMessage_t message;
|
|
|
|
queue = (hcan->Instance == CAN1) ? xCAN1RxQueue : xCAN2RxQueue;
|
|
800064c: 69fb ldr r3, [r7, #28]
|
|
800064e: 681b ldr r3, [r3, #0]
|
|
8000650: 4a10 ldr r2, [pc, #64] @ (8000694 <vCANLoggerListen+0x54>)
|
|
8000652: 4293 cmp r3, r2
|
|
8000654: d102 bne.n 800065c <vCANLoggerListen+0x1c>
|
|
8000656: 4b10 ldr r3, [pc, #64] @ (8000698 <vCANLoggerListen+0x58>)
|
|
8000658: 681b ldr r3, [r3, #0]
|
|
800065a: e001 b.n 8000660 <vCANLoggerListen+0x20>
|
|
800065c: 4b0f ldr r3, [pc, #60] @ (800069c <vCANLoggerListen+0x5c>)
|
|
800065e: 681b ldr r3, [r3, #0]
|
|
8000660: 61bb str r3, [r7, #24]
|
|
|
|
for (;;)
|
|
{
|
|
if (osMessageQueueGet(queue, &message, NULL, osWaitForever) == osOK)
|
|
8000662: f107 0108 add.w r1, r7, #8
|
|
8000666: f04f 33ff mov.w r3, #4294967295 @ 0xffffffff
|
|
800066a: 2200 movs r2, #0
|
|
800066c: 69b8 ldr r0, [r7, #24]
|
|
800066e: f006 fa51 bl 8006b14 <osMessageQueueGet>
|
|
8000672: 4603 mov r3, r0
|
|
8000674: 2b00 cmp r3, #0
|
|
8000676: d1f4 bne.n 8000662 <vCANLoggerListen+0x22>
|
|
{
|
|
osSemaphoreRelease( (hcan->Instance == CAN1) ? xSemaphoreCAN1 : xSemaphoreCAN2 );
|
|
8000678: 69fb ldr r3, [r7, #28]
|
|
800067a: 681b ldr r3, [r3, #0]
|
|
800067c: 4a05 ldr r2, [pc, #20] @ (8000694 <vCANLoggerListen+0x54>)
|
|
800067e: 4293 cmp r3, r2
|
|
8000680: d102 bne.n 8000688 <vCANLoggerListen+0x48>
|
|
8000682: 4b07 ldr r3, [pc, #28] @ (80006a0 <vCANLoggerListen+0x60>)
|
|
8000684: 681b ldr r3, [r3, #0]
|
|
8000686: e001 b.n 800068c <vCANLoggerListen+0x4c>
|
|
8000688: 4b06 ldr r3, [pc, #24] @ (80006a4 <vCANLoggerListen+0x64>)
|
|
800068a: 681b ldr r3, [r3, #0]
|
|
800068c: 4618 mov r0, r3
|
|
800068e: f006 f929 bl 80068e4 <osSemaphoreRelease>
|
|
if (osMessageQueueGet(queue, &message, NULL, osWaitForever) == osOK)
|
|
8000692: e7e6 b.n 8000662 <vCANLoggerListen+0x22>
|
|
8000694: 40006400 .word 0x40006400
|
|
8000698: 200002c8 .word 0x200002c8
|
|
800069c: 200002cc .word 0x200002cc
|
|
80006a0: 200002b8 .word 0x200002b8
|
|
80006a4: 200002bc .word 0x200002bc
|
|
|
|
080006a8 <vLEDHeartbeat>:
|
|
* @brief Blink a LED in heartbeat mode when CAN traffic is detected
|
|
* @param argument: LED GPIO (port and pin)
|
|
* @retval None
|
|
*/
|
|
void vLEDHeartbeat(void *argument)
|
|
{
|
|
80006a8: b580 push {r7, lr}
|
|
80006aa: b084 sub sp, #16
|
|
80006ac: af00 add r7, sp, #0
|
|
80006ae: 6078 str r0, [r7, #4]
|
|
/* CODE BEGIN */
|
|
LEDContext *context = (LEDContext*)argument;
|
|
80006b0: 687b ldr r3, [r7, #4]
|
|
80006b2: 60fb str r3, [r7, #12]
|
|
|
|
if (osSemaphoreAcquire(context->semaphore, 0U) == osOK)
|
|
80006b4: 68fb ldr r3, [r7, #12]
|
|
80006b6: 685b ldr r3, [r3, #4]
|
|
80006b8: 2100 movs r1, #0
|
|
80006ba: 4618 mov r0, r3
|
|
80006bc: f006 f8c0 bl 8006840 <osSemaphoreAcquire>
|
|
80006c0: 4603 mov r3, r0
|
|
80006c2: 2b00 cmp r3, #0
|
|
80006c4: d110 bne.n 80006e8 <vLEDHeartbeat+0x40>
|
|
{
|
|
HAL_GPIO_WritePin(context->led->port, context->led->pin, GPIO_PIN_SET);
|
|
80006c6: 68fb ldr r3, [r7, #12]
|
|
80006c8: 681b ldr r3, [r3, #0]
|
|
80006ca: 6818 ldr r0, [r3, #0]
|
|
80006cc: 68fb ldr r3, [r7, #12]
|
|
80006ce: 681b ldr r3, [r3, #0]
|
|
80006d0: 889b ldrh r3, [r3, #4]
|
|
80006d2: 2201 movs r2, #1
|
|
80006d4: 4619 mov r1, r3
|
|
80006d6: f002 fd43 bl 8003160 <HAL_GPIO_WritePin>
|
|
osTimerStart(context->timer, 25U);
|
|
80006da: 68fb ldr r3, [r7, #12]
|
|
80006dc: 689b ldr r3, [r3, #8]
|
|
80006de: 2119 movs r1, #25
|
|
80006e0: 4618 mov r0, r3
|
|
80006e2: f005 fff5 bl 80066d0 <osTimerStart>
|
|
else
|
|
{
|
|
HAL_GPIO_WritePin(context->led->port, context->led->pin, GPIO_PIN_RESET);
|
|
}
|
|
/* CODE END */
|
|
}
|
|
80006e6: e009 b.n 80006fc <vLEDHeartbeat+0x54>
|
|
HAL_GPIO_WritePin(context->led->port, context->led->pin, GPIO_PIN_RESET);
|
|
80006e8: 68fb ldr r3, [r7, #12]
|
|
80006ea: 681b ldr r3, [r3, #0]
|
|
80006ec: 6818 ldr r0, [r3, #0]
|
|
80006ee: 68fb ldr r3, [r7, #12]
|
|
80006f0: 681b ldr r3, [r3, #0]
|
|
80006f2: 889b ldrh r3, [r3, #4]
|
|
80006f4: 2200 movs r2, #0
|
|
80006f6: 4619 mov r1, r3
|
|
80006f8: f002 fd32 bl 8003160 <HAL_GPIO_WritePin>
|
|
}
|
|
80006fc: bf00 nop
|
|
80006fe: 3710 adds r7, #16
|
|
8000700: 46bd mov sp, r7
|
|
8000702: bd80 pop {r7, pc}
|
|
|
|
08000704 <main>:
|
|
/**
|
|
* @brief The application entry point.
|
|
* @retval int
|
|
*/
|
|
int main(void)
|
|
{
|
|
8000704: b580 push {r7, lr}
|
|
8000706: b094 sub sp, #80 @ 0x50
|
|
8000708: af00 add r7, sp, #0
|
|
/* USER CODE END 1 */
|
|
|
|
/* MCU Configuration--------------------------------------------------------*/
|
|
|
|
/* Reset of all peripherals, Initializes the Flash interface and the Systick. */
|
|
HAL_Init();
|
|
800070a: f000 fe5f bl 80013cc <HAL_Init>
|
|
/* USER CODE BEGIN Init */
|
|
|
|
/* USER CODE END Init */
|
|
|
|
/* Configure the system clock */
|
|
SystemClock_Config();
|
|
800070e: f000 f8e7 bl 80008e0 <SystemClock_Config>
|
|
/* USER CODE BEGIN SysInit */
|
|
|
|
/* USER CODE END SysInit */
|
|
|
|
/* Initialize all configured peripherals */
|
|
MX_GPIO_Init();
|
|
8000712: f000 fa17 bl 8000b44 <MX_GPIO_Init>
|
|
MX_DMA_Init();
|
|
8000716: f000 f9ed bl 8000af4 <MX_DMA_Init>
|
|
MX_CAN1_Init();
|
|
800071a: f000 f94b bl 80009b4 <MX_CAN1_Init>
|
|
MX_CAN2_Init();
|
|
800071e: f000 f981 bl 8000a24 <MX_CAN2_Init>
|
|
MX_SDIO_SD_Init();
|
|
8000722: f000 f9b7 bl 8000a94 <MX_SDIO_SD_Init>
|
|
|
|
/* USER CODE BEGIN 2 */
|
|
CAN_Logger_Init(&hcan1, &hcan2);
|
|
8000726: 495e ldr r1, [pc, #376] @ (80008a0 <main+0x19c>)
|
|
8000728: 485e ldr r0, [pc, #376] @ (80008a4 <main+0x1a0>)
|
|
800072a: f7ff fee7 bl 80004fc <CAN_Logger_Init>
|
|
/* USER CODE END 2 */
|
|
|
|
/* Init scheduler */
|
|
osKernelInitialize();
|
|
800072e: f005 fe61 bl 80063f4 <osKernelInitialize>
|
|
|
|
/* USER CODE BEGIN RTOS_TASKS */
|
|
osThreadId_t xCAN1rx;
|
|
const osThreadAttr_t CAN1rxAttributes = {
|
|
8000732: f107 0324 add.w r3, r7, #36 @ 0x24
|
|
8000736: 2224 movs r2, #36 @ 0x24
|
|
8000738: 2100 movs r1, #0
|
|
800073a: 4618 mov r0, r3
|
|
800073c: f009 fbc8 bl 8009ed0 <memset>
|
|
8000740: 4b59 ldr r3, [pc, #356] @ (80008a8 <main+0x1a4>)
|
|
8000742: 627b str r3, [r7, #36] @ 0x24
|
|
8000744: f44f 7300 mov.w r3, #512 @ 0x200
|
|
8000748: 63bb str r3, [r7, #56] @ 0x38
|
|
800074a: 2331 movs r3, #49 @ 0x31
|
|
800074c: 63fb str r3, [r7, #60] @ 0x3c
|
|
.name = "CAN1rx",
|
|
.stack_size = 128 * 4,
|
|
.priority = (osPriority_t) osPriorityRealtime1,
|
|
};
|
|
osThreadId_t xCAN2rx;
|
|
const osThreadAttr_t CAN2rxAttributes = {
|
|
800074e: 463b mov r3, r7
|
|
8000750: 2224 movs r2, #36 @ 0x24
|
|
8000752: 2100 movs r1, #0
|
|
8000754: 4618 mov r0, r3
|
|
8000756: f009 fbbb bl 8009ed0 <memset>
|
|
800075a: 4b54 ldr r3, [pc, #336] @ (80008ac <main+0x1a8>)
|
|
800075c: 603b str r3, [r7, #0]
|
|
800075e: f44f 7300 mov.w r3, #512 @ 0x200
|
|
8000762: 617b str r3, [r7, #20]
|
|
8000764: 2330 movs r3, #48 @ 0x30
|
|
8000766: 61bb str r3, [r7, #24]
|
|
/* USER CODE BEGIN RTOS_MUTEX */
|
|
/* add mutexes, ... */
|
|
/* USER CODE END RTOS_MUTEX */
|
|
|
|
/* USER CODE BEGIN RTOS_SEMAPHORES */
|
|
xSemaphoreCAN1 = osSemaphoreNew(10, 0, NULL);
|
|
8000768: 2200 movs r2, #0
|
|
800076a: 2100 movs r1, #0
|
|
800076c: 200a movs r0, #10
|
|
800076e: f005 ffdd bl 800672c <osSemaphoreNew>
|
|
8000772: 4603 mov r3, r0
|
|
8000774: 4a4e ldr r2, [pc, #312] @ (80008b0 <main+0x1ac>)
|
|
8000776: 6013 str r3, [r2, #0]
|
|
xSemaphoreCAN2 = osSemaphoreNew(10, 0, NULL);
|
|
8000778: 2200 movs r2, #0
|
|
800077a: 2100 movs r1, #0
|
|
800077c: 200a movs r0, #10
|
|
800077e: f005 ffd5 bl 800672c <osSemaphoreNew>
|
|
8000782: 4603 mov r3, r0
|
|
8000784: 4a4b ldr r2, [pc, #300] @ (80008b4 <main+0x1b0>)
|
|
8000786: 6013 str r3, [r2, #0]
|
|
|
|
if (xSemaphoreCAN1 == NULL || xSemaphoreCAN2 == NULL) Error_Handler();
|
|
8000788: 4b49 ldr r3, [pc, #292] @ (80008b0 <main+0x1ac>)
|
|
800078a: 681b ldr r3, [r3, #0]
|
|
800078c: 2b00 cmp r3, #0
|
|
800078e: d003 beq.n 8000798 <main+0x94>
|
|
8000790: 4b48 ldr r3, [pc, #288] @ (80008b4 <main+0x1b0>)
|
|
8000792: 681b ldr r3, [r3, #0]
|
|
8000794: 2b00 cmp r3, #0
|
|
8000796: d101 bne.n 800079c <main+0x98>
|
|
8000798: f000 fa8c bl 8000cb4 <Error_Handler>
|
|
|
|
ledContextCAN1.led = &led_can1;
|
|
800079c: 4b46 ldr r3, [pc, #280] @ (80008b8 <main+0x1b4>)
|
|
800079e: 4a47 ldr r2, [pc, #284] @ (80008bc <main+0x1b8>)
|
|
80007a0: 601a str r2, [r3, #0]
|
|
ledContextCAN1.semaphore = xSemaphoreCAN1;
|
|
80007a2: 4b43 ldr r3, [pc, #268] @ (80008b0 <main+0x1ac>)
|
|
80007a4: 681b ldr r3, [r3, #0]
|
|
80007a6: 4a44 ldr r2, [pc, #272] @ (80008b8 <main+0x1b4>)
|
|
80007a8: 6053 str r3, [r2, #4]
|
|
ledContextCAN2.led = &led_can2;
|
|
80007aa: 4b45 ldr r3, [pc, #276] @ (80008c0 <main+0x1bc>)
|
|
80007ac: 4a45 ldr r2, [pc, #276] @ (80008c4 <main+0x1c0>)
|
|
80007ae: 601a str r2, [r3, #0]
|
|
ledContextCAN2.semaphore = xSemaphoreCAN2;
|
|
80007b0: 4b40 ldr r3, [pc, #256] @ (80008b4 <main+0x1b0>)
|
|
80007b2: 681b ldr r3, [r3, #0]
|
|
80007b4: 4a42 ldr r2, [pc, #264] @ (80008c0 <main+0x1bc>)
|
|
80007b6: 6053 str r3, [r2, #4]
|
|
/* USER CODE END RTOS_SEMAPHORES */
|
|
|
|
/* USER CODE BEGIN RTOS_TIMERS */
|
|
xHeartbeatTimerCAN1 = osTimerNew(vLEDHeartbeat, osTimerOnce, &ledContextCAN1, NULL);
|
|
80007b8: 2300 movs r3, #0
|
|
80007ba: 4a3f ldr r2, [pc, #252] @ (80008b8 <main+0x1b4>)
|
|
80007bc: 2100 movs r1, #0
|
|
80007be: 4842 ldr r0, [pc, #264] @ (80008c8 <main+0x1c4>)
|
|
80007c0: f005 ff0a bl 80065d8 <osTimerNew>
|
|
80007c4: 4603 mov r3, r0
|
|
80007c6: 4a41 ldr r2, [pc, #260] @ (80008cc <main+0x1c8>)
|
|
80007c8: 6013 str r3, [r2, #0]
|
|
xHeartbeatTimerCAN2 = osTimerNew(vLEDHeartbeat, osTimerOnce, &ledContextCAN2, NULL);
|
|
80007ca: 2300 movs r3, #0
|
|
80007cc: 4a3c ldr r2, [pc, #240] @ (80008c0 <main+0x1bc>)
|
|
80007ce: 2100 movs r1, #0
|
|
80007d0: 483d ldr r0, [pc, #244] @ (80008c8 <main+0x1c4>)
|
|
80007d2: f005 ff01 bl 80065d8 <osTimerNew>
|
|
80007d6: 4603 mov r3, r0
|
|
80007d8: 4a3d ldr r2, [pc, #244] @ (80008d0 <main+0x1cc>)
|
|
80007da: 6013 str r3, [r2, #0]
|
|
|
|
osTimerStart(xHeartbeatTimerCAN1, 25U);
|
|
80007dc: 4b3b ldr r3, [pc, #236] @ (80008cc <main+0x1c8>)
|
|
80007de: 681b ldr r3, [r3, #0]
|
|
80007e0: 2119 movs r1, #25
|
|
80007e2: 4618 mov r0, r3
|
|
80007e4: f005 ff74 bl 80066d0 <osTimerStart>
|
|
osTimerStart(xHeartbeatTimerCAN2, 25U);
|
|
80007e8: 4b39 ldr r3, [pc, #228] @ (80008d0 <main+0x1cc>)
|
|
80007ea: 681b ldr r3, [r3, #0]
|
|
80007ec: 2119 movs r1, #25
|
|
80007ee: 4618 mov r0, r3
|
|
80007f0: f005 ff6e bl 80066d0 <osTimerStart>
|
|
|
|
if (xHeartbeatTimerCAN1 == NULL || xHeartbeatTimerCAN2 == NULL) Error_Handler();
|
|
80007f4: 4b35 ldr r3, [pc, #212] @ (80008cc <main+0x1c8>)
|
|
80007f6: 681b ldr r3, [r3, #0]
|
|
80007f8: 2b00 cmp r3, #0
|
|
80007fa: d003 beq.n 8000804 <main+0x100>
|
|
80007fc: 4b34 ldr r3, [pc, #208] @ (80008d0 <main+0x1cc>)
|
|
80007fe: 681b ldr r3, [r3, #0]
|
|
8000800: 2b00 cmp r3, #0
|
|
8000802: d101 bne.n 8000808 <main+0x104>
|
|
8000804: f000 fa56 bl 8000cb4 <Error_Handler>
|
|
|
|
ledContextCAN1.timer = xHeartbeatTimerCAN1;
|
|
8000808: 4b30 ldr r3, [pc, #192] @ (80008cc <main+0x1c8>)
|
|
800080a: 681b ldr r3, [r3, #0]
|
|
800080c: 4a2a ldr r2, [pc, #168] @ (80008b8 <main+0x1b4>)
|
|
800080e: 6093 str r3, [r2, #8]
|
|
ledContextCAN2.timer = xHeartbeatTimerCAN2;
|
|
8000810: 4b2f ldr r3, [pc, #188] @ (80008d0 <main+0x1cc>)
|
|
8000812: 681b ldr r3, [r3, #0]
|
|
8000814: 4a2a ldr r2, [pc, #168] @ (80008c0 <main+0x1bc>)
|
|
8000816: 6093 str r3, [r2, #8]
|
|
/* USER CODE END RTOS_TIMERS */
|
|
|
|
/* USER CODE BEGIN RTOS_QUEUES */
|
|
xCAN1RxQueue = osMessageQueueNew(32, sizeof(CanMessage_t), NULL);
|
|
8000818: 2200 movs r2, #0
|
|
800081a: 2110 movs r1, #16
|
|
800081c: 2020 movs r0, #32
|
|
800081e: f006 f8a5 bl 800696c <osMessageQueueNew>
|
|
8000822: 4603 mov r3, r0
|
|
8000824: 4a2b ldr r2, [pc, #172] @ (80008d4 <main+0x1d0>)
|
|
8000826: 6013 str r3, [r2, #0]
|
|
xCAN2RxQueue = osMessageQueueNew(32, sizeof(CanMessage_t), NULL);
|
|
8000828: 2200 movs r2, #0
|
|
800082a: 2110 movs r1, #16
|
|
800082c: 2020 movs r0, #32
|
|
800082e: f006 f89d bl 800696c <osMessageQueueNew>
|
|
8000832: 4603 mov r3, r0
|
|
8000834: 4a28 ldr r2, [pc, #160] @ (80008d8 <main+0x1d4>)
|
|
8000836: 6013 str r3, [r2, #0]
|
|
|
|
if (xCAN1RxQueue == NULL || xCAN2RxQueue == NULL) Error_Handler();
|
|
8000838: 4b26 ldr r3, [pc, #152] @ (80008d4 <main+0x1d0>)
|
|
800083a: 681b ldr r3, [r3, #0]
|
|
800083c: 2b00 cmp r3, #0
|
|
800083e: d003 beq.n 8000848 <main+0x144>
|
|
8000840: 4b25 ldr r3, [pc, #148] @ (80008d8 <main+0x1d4>)
|
|
8000842: 681b ldr r3, [r3, #0]
|
|
8000844: 2b00 cmp r3, #0
|
|
8000846: d101 bne.n 800084c <main+0x148>
|
|
8000848: f000 fa34 bl 8000cb4 <Error_Handler>
|
|
/* USER CODE END RTOS_QUEUES */
|
|
|
|
/* USER CODE BEGIN RTOS_THREADS */
|
|
xCAN1rx = osThreadNew(vCANLoggerListen, &hcan1, &CAN1rxAttributes);
|
|
800084c: f107 0324 add.w r3, r7, #36 @ 0x24
|
|
8000850: 461a mov r2, r3
|
|
8000852: 4914 ldr r1, [pc, #80] @ (80008a4 <main+0x1a0>)
|
|
8000854: 4821 ldr r0, [pc, #132] @ (80008dc <main+0x1d8>)
|
|
8000856: f005 fe17 bl 8006488 <osThreadNew>
|
|
800085a: 64f8 str r0, [r7, #76] @ 0x4c
|
|
xCAN2rx = osThreadNew(vCANLoggerListen, &hcan2, &CAN2rxAttributes);
|
|
800085c: 463b mov r3, r7
|
|
800085e: 461a mov r2, r3
|
|
8000860: 490f ldr r1, [pc, #60] @ (80008a0 <main+0x19c>)
|
|
8000862: 481e ldr r0, [pc, #120] @ (80008dc <main+0x1d8>)
|
|
8000864: f005 fe10 bl 8006488 <osThreadNew>
|
|
8000868: 64b8 str r0, [r7, #72] @ 0x48
|
|
/* USER CODE BEGIN RTOS_EVENTS */
|
|
/* add events, ... */
|
|
/* USER CODE END RTOS_EVENTS */
|
|
|
|
/* USER CODE BEGIN 3 */
|
|
ledContextCAN1.led = &led_can1;
|
|
800086a: 4b13 ldr r3, [pc, #76] @ (80008b8 <main+0x1b4>)
|
|
800086c: 4a13 ldr r2, [pc, #76] @ (80008bc <main+0x1b8>)
|
|
800086e: 601a str r2, [r3, #0]
|
|
ledContextCAN1.semaphore = xSemaphoreCAN1;
|
|
8000870: 4b0f ldr r3, [pc, #60] @ (80008b0 <main+0x1ac>)
|
|
8000872: 681b ldr r3, [r3, #0]
|
|
8000874: 4a10 ldr r2, [pc, #64] @ (80008b8 <main+0x1b4>)
|
|
8000876: 6053 str r3, [r2, #4]
|
|
ledContextCAN1.timer = xHeartbeatTimerCAN1;
|
|
8000878: 4b14 ldr r3, [pc, #80] @ (80008cc <main+0x1c8>)
|
|
800087a: 681b ldr r3, [r3, #0]
|
|
800087c: 4a0e ldr r2, [pc, #56] @ (80008b8 <main+0x1b4>)
|
|
800087e: 6093 str r3, [r2, #8]
|
|
|
|
ledContextCAN2.led = &led_can2;
|
|
8000880: 4b0f ldr r3, [pc, #60] @ (80008c0 <main+0x1bc>)
|
|
8000882: 4a10 ldr r2, [pc, #64] @ (80008c4 <main+0x1c0>)
|
|
8000884: 601a str r2, [r3, #0]
|
|
ledContextCAN2.semaphore = xSemaphoreCAN2;
|
|
8000886: 4b0b ldr r3, [pc, #44] @ (80008b4 <main+0x1b0>)
|
|
8000888: 681b ldr r3, [r3, #0]
|
|
800088a: 4a0d ldr r2, [pc, #52] @ (80008c0 <main+0x1bc>)
|
|
800088c: 6053 str r3, [r2, #4]
|
|
ledContextCAN2.timer = xHeartbeatTimerCAN2;
|
|
800088e: 4b10 ldr r3, [pc, #64] @ (80008d0 <main+0x1cc>)
|
|
8000890: 681b ldr r3, [r3, #0]
|
|
8000892: 4a0b ldr r2, [pc, #44] @ (80008c0 <main+0x1bc>)
|
|
8000894: 6093 str r3, [r2, #8]
|
|
/* USER CODE END 3 */
|
|
|
|
/* Start scheduler */
|
|
osKernelStart();
|
|
8000896: f005 fdd1 bl 800643c <osKernelStart>
|
|
|
|
/* We should never get here as control is now taken by the scheduler */
|
|
|
|
/* Infinite loop */
|
|
/* USER CODE BEGIN WHILE */
|
|
while (1)
|
|
800089a: bf00 nop
|
|
800089c: e7fd b.n 800089a <main+0x196>
|
|
800089e: bf00 nop
|
|
80008a0: 200000f8 .word 0x200000f8
|
|
80008a4: 20000094 .word 0x20000094
|
|
80008a8: 0800a0ac .word 0x0800a0ac
|
|
80008ac: 0800a0b4 .word 0x0800a0b4
|
|
80008b0: 200002b8 .word 0x200002b8
|
|
80008b4: 200002bc .word 0x200002bc
|
|
80008b8: 200002a0 .word 0x200002a0
|
|
80008bc: 20000000 .word 0x20000000
|
|
80008c0: 200002ac .word 0x200002ac
|
|
80008c4: 20000008 .word 0x20000008
|
|
80008c8: 080006a9 .word 0x080006a9
|
|
80008cc: 200002c0 .word 0x200002c0
|
|
80008d0: 200002c4 .word 0x200002c4
|
|
80008d4: 200002c8 .word 0x200002c8
|
|
80008d8: 200002cc .word 0x200002cc
|
|
80008dc: 08000641 .word 0x08000641
|
|
|
|
080008e0 <SystemClock_Config>:
|
|
/**
|
|
* @brief System Clock Configuration
|
|
* @retval None
|
|
*/
|
|
void SystemClock_Config(void)
|
|
{
|
|
80008e0: b580 push {r7, lr}
|
|
80008e2: b094 sub sp, #80 @ 0x50
|
|
80008e4: af00 add r7, sp, #0
|
|
RCC_OscInitTypeDef RCC_OscInitStruct = {0};
|
|
80008e6: f107 0320 add.w r3, r7, #32
|
|
80008ea: 2230 movs r2, #48 @ 0x30
|
|
80008ec: 2100 movs r1, #0
|
|
80008ee: 4618 mov r0, r3
|
|
80008f0: f009 faee bl 8009ed0 <memset>
|
|
RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};
|
|
80008f4: f107 030c add.w r3, r7, #12
|
|
80008f8: 2200 movs r2, #0
|
|
80008fa: 601a str r2, [r3, #0]
|
|
80008fc: 605a str r2, [r3, #4]
|
|
80008fe: 609a str r2, [r3, #8]
|
|
8000900: 60da str r2, [r3, #12]
|
|
8000902: 611a str r2, [r3, #16]
|
|
|
|
/** Configure the main internal regulator output voltage
|
|
*/
|
|
__HAL_RCC_PWR_CLK_ENABLE();
|
|
8000904: 2300 movs r3, #0
|
|
8000906: 60bb str r3, [r7, #8]
|
|
8000908: 4b28 ldr r3, [pc, #160] @ (80009ac <SystemClock_Config+0xcc>)
|
|
800090a: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
800090c: 4a27 ldr r2, [pc, #156] @ (80009ac <SystemClock_Config+0xcc>)
|
|
800090e: f043 5380 orr.w r3, r3, #268435456 @ 0x10000000
|
|
8000912: 6413 str r3, [r2, #64] @ 0x40
|
|
8000914: 4b25 ldr r3, [pc, #148] @ (80009ac <SystemClock_Config+0xcc>)
|
|
8000916: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
8000918: f003 5380 and.w r3, r3, #268435456 @ 0x10000000
|
|
800091c: 60bb str r3, [r7, #8]
|
|
800091e: 68bb ldr r3, [r7, #8]
|
|
__HAL_PWR_VOLTAGESCALING_CONFIG(PWR_REGULATOR_VOLTAGE_SCALE1);
|
|
8000920: 2300 movs r3, #0
|
|
8000922: 607b str r3, [r7, #4]
|
|
8000924: 4b22 ldr r3, [pc, #136] @ (80009b0 <SystemClock_Config+0xd0>)
|
|
8000926: 681b ldr r3, [r3, #0]
|
|
8000928: 4a21 ldr r2, [pc, #132] @ (80009b0 <SystemClock_Config+0xd0>)
|
|
800092a: f443 4380 orr.w r3, r3, #16384 @ 0x4000
|
|
800092e: 6013 str r3, [r2, #0]
|
|
8000930: 4b1f ldr r3, [pc, #124] @ (80009b0 <SystemClock_Config+0xd0>)
|
|
8000932: 681b ldr r3, [r3, #0]
|
|
8000934: f403 4380 and.w r3, r3, #16384 @ 0x4000
|
|
8000938: 607b str r3, [r7, #4]
|
|
800093a: 687b ldr r3, [r7, #4]
|
|
|
|
/** Initializes the RCC Oscillators according to the specified parameters
|
|
* in the RCC_OscInitTypeDef structure.
|
|
*/
|
|
RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSI;
|
|
800093c: 2302 movs r3, #2
|
|
800093e: 623b str r3, [r7, #32]
|
|
RCC_OscInitStruct.HSIState = RCC_HSI_ON;
|
|
8000940: 2301 movs r3, #1
|
|
8000942: 62fb str r3, [r7, #44] @ 0x2c
|
|
RCC_OscInitStruct.HSICalibrationValue = RCC_HSICALIBRATION_DEFAULT;
|
|
8000944: 2310 movs r3, #16
|
|
8000946: 633b str r3, [r7, #48] @ 0x30
|
|
RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
|
|
8000948: 2302 movs r3, #2
|
|
800094a: 63bb str r3, [r7, #56] @ 0x38
|
|
RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSI;
|
|
800094c: 2300 movs r3, #0
|
|
800094e: 63fb str r3, [r7, #60] @ 0x3c
|
|
RCC_OscInitStruct.PLL.PLLM = 16;
|
|
8000950: 2310 movs r3, #16
|
|
8000952: 643b str r3, [r7, #64] @ 0x40
|
|
RCC_OscInitStruct.PLL.PLLN = 336;
|
|
8000954: f44f 73a8 mov.w r3, #336 @ 0x150
|
|
8000958: 647b str r3, [r7, #68] @ 0x44
|
|
RCC_OscInitStruct.PLL.PLLP = RCC_PLLP_DIV2;
|
|
800095a: 2302 movs r3, #2
|
|
800095c: 64bb str r3, [r7, #72] @ 0x48
|
|
RCC_OscInitStruct.PLL.PLLQ = 7;
|
|
800095e: 2307 movs r3, #7
|
|
8000960: 64fb str r3, [r7, #76] @ 0x4c
|
|
if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
|
|
8000962: f107 0320 add.w r3, r7, #32
|
|
8000966: 4618 mov r0, r3
|
|
8000968: f002 fc48 bl 80031fc <HAL_RCC_OscConfig>
|
|
800096c: 4603 mov r3, r0
|
|
800096e: 2b00 cmp r3, #0
|
|
8000970: d001 beq.n 8000976 <SystemClock_Config+0x96>
|
|
{
|
|
Error_Handler();
|
|
8000972: f000 f99f bl 8000cb4 <Error_Handler>
|
|
}
|
|
|
|
/** Initializes the CPU, AHB and APB buses clocks
|
|
*/
|
|
RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK|RCC_CLOCKTYPE_SYSCLK
|
|
8000976: 230f movs r3, #15
|
|
8000978: 60fb str r3, [r7, #12]
|
|
|RCC_CLOCKTYPE_PCLK1|RCC_CLOCKTYPE_PCLK2;
|
|
RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
|
|
800097a: 2302 movs r3, #2
|
|
800097c: 613b str r3, [r7, #16]
|
|
RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
|
|
800097e: 2300 movs r3, #0
|
|
8000980: 617b str r3, [r7, #20]
|
|
RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV4;
|
|
8000982: f44f 53a0 mov.w r3, #5120 @ 0x1400
|
|
8000986: 61bb str r3, [r7, #24]
|
|
RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV4;
|
|
8000988: f44f 53a0 mov.w r3, #5120 @ 0x1400
|
|
800098c: 61fb str r3, [r7, #28]
|
|
|
|
if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_5) != HAL_OK)
|
|
800098e: f107 030c add.w r3, r7, #12
|
|
8000992: 2105 movs r1, #5
|
|
8000994: 4618 mov r0, r3
|
|
8000996: f002 ff5d bl 8003854 <HAL_RCC_ClockConfig>
|
|
800099a: 4603 mov r3, r0
|
|
800099c: 2b00 cmp r3, #0
|
|
800099e: d001 beq.n 80009a4 <SystemClock_Config+0xc4>
|
|
{
|
|
Error_Handler();
|
|
80009a0: f000 f988 bl 8000cb4 <Error_Handler>
|
|
}
|
|
}
|
|
80009a4: bf00 nop
|
|
80009a6: 3750 adds r7, #80 @ 0x50
|
|
80009a8: 46bd mov sp, r7
|
|
80009aa: bd80 pop {r7, pc}
|
|
80009ac: 40023800 .word 0x40023800
|
|
80009b0: 40007000 .word 0x40007000
|
|
|
|
080009b4 <MX_CAN1_Init>:
|
|
* @brief CAN1 Initialization Function
|
|
* @param None
|
|
* @retval None
|
|
*/
|
|
static void MX_CAN1_Init(void)
|
|
{
|
|
80009b4: b580 push {r7, lr}
|
|
80009b6: af00 add r7, sp, #0
|
|
/* USER CODE END CAN1_Init 0 */
|
|
|
|
/* USER CODE BEGIN CAN1_Init 1 */
|
|
|
|
/* USER CODE END CAN1_Init 1 */
|
|
hcan1.Instance = CAN1;
|
|
80009b8: 4b18 ldr r3, [pc, #96] @ (8000a1c <MX_CAN1_Init+0x68>)
|
|
80009ba: 4a19 ldr r2, [pc, #100] @ (8000a20 <MX_CAN1_Init+0x6c>)
|
|
80009bc: 601a str r2, [r3, #0]
|
|
hcan1.Init.Prescaler = 4;
|
|
80009be: 4b17 ldr r3, [pc, #92] @ (8000a1c <MX_CAN1_Init+0x68>)
|
|
80009c0: 2204 movs r2, #4
|
|
80009c2: 605a str r2, [r3, #4]
|
|
hcan1.Init.Mode = CAN_MODE_SILENT;
|
|
80009c4: 4b15 ldr r3, [pc, #84] @ (8000a1c <MX_CAN1_Init+0x68>)
|
|
80009c6: f04f 4200 mov.w r2, #2147483648 @ 0x80000000
|
|
80009ca: 609a str r2, [r3, #8]
|
|
hcan1.Init.SyncJumpWidth = CAN_SJW_1TQ;
|
|
80009cc: 4b13 ldr r3, [pc, #76] @ (8000a1c <MX_CAN1_Init+0x68>)
|
|
80009ce: 2200 movs r2, #0
|
|
80009d0: 60da str r2, [r3, #12]
|
|
hcan1.Init.TimeSeg1 = CAN_BS1_16TQ;
|
|
80009d2: 4b12 ldr r3, [pc, #72] @ (8000a1c <MX_CAN1_Init+0x68>)
|
|
80009d4: f44f 2270 mov.w r2, #983040 @ 0xf0000
|
|
80009d8: 611a str r2, [r3, #16]
|
|
hcan1.Init.TimeSeg2 = CAN_BS2_4TQ;
|
|
80009da: 4b10 ldr r3, [pc, #64] @ (8000a1c <MX_CAN1_Init+0x68>)
|
|
80009dc: f44f 1240 mov.w r2, #3145728 @ 0x300000
|
|
80009e0: 615a str r2, [r3, #20]
|
|
hcan1.Init.TimeTriggeredMode = DISABLE;
|
|
80009e2: 4b0e ldr r3, [pc, #56] @ (8000a1c <MX_CAN1_Init+0x68>)
|
|
80009e4: 2200 movs r2, #0
|
|
80009e6: 761a strb r2, [r3, #24]
|
|
hcan1.Init.AutoBusOff = DISABLE;
|
|
80009e8: 4b0c ldr r3, [pc, #48] @ (8000a1c <MX_CAN1_Init+0x68>)
|
|
80009ea: 2200 movs r2, #0
|
|
80009ec: 765a strb r2, [r3, #25]
|
|
hcan1.Init.AutoWakeUp = ENABLE;
|
|
80009ee: 4b0b ldr r3, [pc, #44] @ (8000a1c <MX_CAN1_Init+0x68>)
|
|
80009f0: 2201 movs r2, #1
|
|
80009f2: 769a strb r2, [r3, #26]
|
|
hcan1.Init.AutoRetransmission = DISABLE;
|
|
80009f4: 4b09 ldr r3, [pc, #36] @ (8000a1c <MX_CAN1_Init+0x68>)
|
|
80009f6: 2200 movs r2, #0
|
|
80009f8: 76da strb r2, [r3, #27]
|
|
hcan1.Init.ReceiveFifoLocked = DISABLE;
|
|
80009fa: 4b08 ldr r3, [pc, #32] @ (8000a1c <MX_CAN1_Init+0x68>)
|
|
80009fc: 2200 movs r2, #0
|
|
80009fe: 771a strb r2, [r3, #28]
|
|
hcan1.Init.TransmitFifoPriority = DISABLE;
|
|
8000a00: 4b06 ldr r3, [pc, #24] @ (8000a1c <MX_CAN1_Init+0x68>)
|
|
8000a02: 2200 movs r2, #0
|
|
8000a04: 775a strb r2, [r3, #29]
|
|
if (HAL_CAN_Init(&hcan1) != HAL_OK)
|
|
8000a06: 4805 ldr r0, [pc, #20] @ (8000a1c <MX_CAN1_Init+0x68>)
|
|
8000a08: f000 fd46 bl 8001498 <HAL_CAN_Init>
|
|
8000a0c: 4603 mov r3, r0
|
|
8000a0e: 2b00 cmp r3, #0
|
|
8000a10: d001 beq.n 8000a16 <MX_CAN1_Init+0x62>
|
|
{
|
|
Error_Handler();
|
|
8000a12: f000 f94f bl 8000cb4 <Error_Handler>
|
|
}
|
|
/* USER CODE BEGIN CAN1_Init 2 */
|
|
|
|
/* USER CODE END CAN1_Init 2 */
|
|
|
|
}
|
|
8000a16: bf00 nop
|
|
8000a18: bd80 pop {r7, pc}
|
|
8000a1a: bf00 nop
|
|
8000a1c: 20000094 .word 0x20000094
|
|
8000a20: 40006400 .word 0x40006400
|
|
|
|
08000a24 <MX_CAN2_Init>:
|
|
* @brief CAN2 Initialization Function
|
|
* @param None
|
|
* @retval None
|
|
*/
|
|
static void MX_CAN2_Init(void)
|
|
{
|
|
8000a24: b580 push {r7, lr}
|
|
8000a26: af00 add r7, sp, #0
|
|
/* USER CODE END CAN2_Init 0 */
|
|
|
|
/* USER CODE BEGIN CAN2_Init 1 */
|
|
|
|
/* USER CODE END CAN2_Init 1 */
|
|
hcan2.Instance = CAN2;
|
|
8000a28: 4b18 ldr r3, [pc, #96] @ (8000a8c <MX_CAN2_Init+0x68>)
|
|
8000a2a: 4a19 ldr r2, [pc, #100] @ (8000a90 <MX_CAN2_Init+0x6c>)
|
|
8000a2c: 601a str r2, [r3, #0]
|
|
hcan2.Init.Prescaler = 8;
|
|
8000a2e: 4b17 ldr r3, [pc, #92] @ (8000a8c <MX_CAN2_Init+0x68>)
|
|
8000a30: 2208 movs r2, #8
|
|
8000a32: 605a str r2, [r3, #4]
|
|
hcan2.Init.Mode = CAN_MODE_SILENT;
|
|
8000a34: 4b15 ldr r3, [pc, #84] @ (8000a8c <MX_CAN2_Init+0x68>)
|
|
8000a36: f04f 4200 mov.w r2, #2147483648 @ 0x80000000
|
|
8000a3a: 609a str r2, [r3, #8]
|
|
hcan2.Init.SyncJumpWidth = CAN_SJW_1TQ;
|
|
8000a3c: 4b13 ldr r3, [pc, #76] @ (8000a8c <MX_CAN2_Init+0x68>)
|
|
8000a3e: 2200 movs r2, #0
|
|
8000a40: 60da str r2, [r3, #12]
|
|
hcan2.Init.TimeSeg1 = CAN_BS1_16TQ;
|
|
8000a42: 4b12 ldr r3, [pc, #72] @ (8000a8c <MX_CAN2_Init+0x68>)
|
|
8000a44: f44f 2270 mov.w r2, #983040 @ 0xf0000
|
|
8000a48: 611a str r2, [r3, #16]
|
|
hcan2.Init.TimeSeg2 = CAN_BS2_4TQ;
|
|
8000a4a: 4b10 ldr r3, [pc, #64] @ (8000a8c <MX_CAN2_Init+0x68>)
|
|
8000a4c: f44f 1240 mov.w r2, #3145728 @ 0x300000
|
|
8000a50: 615a str r2, [r3, #20]
|
|
hcan2.Init.TimeTriggeredMode = DISABLE;
|
|
8000a52: 4b0e ldr r3, [pc, #56] @ (8000a8c <MX_CAN2_Init+0x68>)
|
|
8000a54: 2200 movs r2, #0
|
|
8000a56: 761a strb r2, [r3, #24]
|
|
hcan2.Init.AutoBusOff = DISABLE;
|
|
8000a58: 4b0c ldr r3, [pc, #48] @ (8000a8c <MX_CAN2_Init+0x68>)
|
|
8000a5a: 2200 movs r2, #0
|
|
8000a5c: 765a strb r2, [r3, #25]
|
|
hcan2.Init.AutoWakeUp = ENABLE;
|
|
8000a5e: 4b0b ldr r3, [pc, #44] @ (8000a8c <MX_CAN2_Init+0x68>)
|
|
8000a60: 2201 movs r2, #1
|
|
8000a62: 769a strb r2, [r3, #26]
|
|
hcan2.Init.AutoRetransmission = DISABLE;
|
|
8000a64: 4b09 ldr r3, [pc, #36] @ (8000a8c <MX_CAN2_Init+0x68>)
|
|
8000a66: 2200 movs r2, #0
|
|
8000a68: 76da strb r2, [r3, #27]
|
|
hcan2.Init.ReceiveFifoLocked = DISABLE;
|
|
8000a6a: 4b08 ldr r3, [pc, #32] @ (8000a8c <MX_CAN2_Init+0x68>)
|
|
8000a6c: 2200 movs r2, #0
|
|
8000a6e: 771a strb r2, [r3, #28]
|
|
hcan2.Init.TransmitFifoPriority = DISABLE;
|
|
8000a70: 4b06 ldr r3, [pc, #24] @ (8000a8c <MX_CAN2_Init+0x68>)
|
|
8000a72: 2200 movs r2, #0
|
|
8000a74: 775a strb r2, [r3, #29]
|
|
if (HAL_CAN_Init(&hcan2) != HAL_OK)
|
|
8000a76: 4805 ldr r0, [pc, #20] @ (8000a8c <MX_CAN2_Init+0x68>)
|
|
8000a78: f000 fd0e bl 8001498 <HAL_CAN_Init>
|
|
8000a7c: 4603 mov r3, r0
|
|
8000a7e: 2b00 cmp r3, #0
|
|
8000a80: d001 beq.n 8000a86 <MX_CAN2_Init+0x62>
|
|
{
|
|
Error_Handler();
|
|
8000a82: f000 f917 bl 8000cb4 <Error_Handler>
|
|
}
|
|
/* USER CODE BEGIN CAN2_Init 2 */
|
|
|
|
/* USER CODE END CAN2_Init 2 */
|
|
|
|
}
|
|
8000a86: bf00 nop
|
|
8000a88: bd80 pop {r7, pc}
|
|
8000a8a: bf00 nop
|
|
8000a8c: 200000f8 .word 0x200000f8
|
|
8000a90: 40006800 .word 0x40006800
|
|
|
|
08000a94 <MX_SDIO_SD_Init>:
|
|
* @brief SDIO Initialization Function
|
|
* @param None
|
|
* @retval None
|
|
*/
|
|
static void MX_SDIO_SD_Init(void)
|
|
{
|
|
8000a94: b580 push {r7, lr}
|
|
8000a96: af00 add r7, sp, #0
|
|
/* USER CODE END SDIO_Init 0 */
|
|
|
|
/* USER CODE BEGIN SDIO_Init 1 */
|
|
|
|
/* USER CODE END SDIO_Init 1 */
|
|
hsd.Instance = SDIO;
|
|
8000a98: 4b14 ldr r3, [pc, #80] @ (8000aec <MX_SDIO_SD_Init+0x58>)
|
|
8000a9a: 4a15 ldr r2, [pc, #84] @ (8000af0 <MX_SDIO_SD_Init+0x5c>)
|
|
8000a9c: 601a str r2, [r3, #0]
|
|
hsd.Init.ClockEdge = SDIO_CLOCK_EDGE_RISING;
|
|
8000a9e: 4b13 ldr r3, [pc, #76] @ (8000aec <MX_SDIO_SD_Init+0x58>)
|
|
8000aa0: 2200 movs r2, #0
|
|
8000aa2: 605a str r2, [r3, #4]
|
|
hsd.Init.ClockBypass = SDIO_CLOCK_BYPASS_DISABLE;
|
|
8000aa4: 4b11 ldr r3, [pc, #68] @ (8000aec <MX_SDIO_SD_Init+0x58>)
|
|
8000aa6: 2200 movs r2, #0
|
|
8000aa8: 609a str r2, [r3, #8]
|
|
hsd.Init.ClockPowerSave = SDIO_CLOCK_POWER_SAVE_DISABLE;
|
|
8000aaa: 4b10 ldr r3, [pc, #64] @ (8000aec <MX_SDIO_SD_Init+0x58>)
|
|
8000aac: 2200 movs r2, #0
|
|
8000aae: 60da str r2, [r3, #12]
|
|
hsd.Init.BusWide = SDIO_BUS_WIDE_1B;
|
|
8000ab0: 4b0e ldr r3, [pc, #56] @ (8000aec <MX_SDIO_SD_Init+0x58>)
|
|
8000ab2: 2200 movs r2, #0
|
|
8000ab4: 611a str r2, [r3, #16]
|
|
hsd.Init.HardwareFlowControl = SDIO_HARDWARE_FLOW_CONTROL_DISABLE;
|
|
8000ab6: 4b0d ldr r3, [pc, #52] @ (8000aec <MX_SDIO_SD_Init+0x58>)
|
|
8000ab8: 2200 movs r2, #0
|
|
8000aba: 615a str r2, [r3, #20]
|
|
hsd.Init.ClockDiv = 0;
|
|
8000abc: 4b0b ldr r3, [pc, #44] @ (8000aec <MX_SDIO_SD_Init+0x58>)
|
|
8000abe: 2200 movs r2, #0
|
|
8000ac0: 619a str r2, [r3, #24]
|
|
if (HAL_SD_Init(&hsd) != HAL_OK)
|
|
8000ac2: 480a ldr r0, [pc, #40] @ (8000aec <MX_SDIO_SD_Init+0x58>)
|
|
8000ac4: f003 f96a bl 8003d9c <HAL_SD_Init>
|
|
8000ac8: 4603 mov r3, r0
|
|
8000aca: 2b00 cmp r3, #0
|
|
8000acc: d001 beq.n 8000ad2 <MX_SDIO_SD_Init+0x3e>
|
|
{
|
|
Error_Handler();
|
|
8000ace: f000 f8f1 bl 8000cb4 <Error_Handler>
|
|
}
|
|
if (HAL_SD_ConfigWideBusOperation(&hsd, SDIO_BUS_WIDE_4B) != HAL_OK)
|
|
8000ad2: f44f 6100 mov.w r1, #2048 @ 0x800
|
|
8000ad6: 4805 ldr r0, [pc, #20] @ (8000aec <MX_SDIO_SD_Init+0x58>)
|
|
8000ad8: f003 fdbc bl 8004654 <HAL_SD_ConfigWideBusOperation>
|
|
8000adc: 4603 mov r3, r0
|
|
8000ade: 2b00 cmp r3, #0
|
|
8000ae0: d001 beq.n 8000ae6 <MX_SDIO_SD_Init+0x52>
|
|
{
|
|
Error_Handler();
|
|
8000ae2: f000 f8e7 bl 8000cb4 <Error_Handler>
|
|
}
|
|
/* USER CODE BEGIN SDIO_Init 2 */
|
|
|
|
/* USER CODE END SDIO_Init 2 */
|
|
|
|
}
|
|
8000ae6: bf00 nop
|
|
8000ae8: bd80 pop {r7, pc}
|
|
8000aea: bf00 nop
|
|
8000aec: 2000015c .word 0x2000015c
|
|
8000af0: 40012c00 .word 0x40012c00
|
|
|
|
08000af4 <MX_DMA_Init>:
|
|
|
|
/**
|
|
* Enable DMA controller clock
|
|
*/
|
|
static void MX_DMA_Init(void)
|
|
{
|
|
8000af4: b580 push {r7, lr}
|
|
8000af6: b082 sub sp, #8
|
|
8000af8: af00 add r7, sp, #0
|
|
|
|
/* DMA controller clock enable */
|
|
__HAL_RCC_DMA2_CLK_ENABLE();
|
|
8000afa: 2300 movs r3, #0
|
|
8000afc: 607b str r3, [r7, #4]
|
|
8000afe: 4b10 ldr r3, [pc, #64] @ (8000b40 <MX_DMA_Init+0x4c>)
|
|
8000b00: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
8000b02: 4a0f ldr r2, [pc, #60] @ (8000b40 <MX_DMA_Init+0x4c>)
|
|
8000b04: f443 0380 orr.w r3, r3, #4194304 @ 0x400000
|
|
8000b08: 6313 str r3, [r2, #48] @ 0x30
|
|
8000b0a: 4b0d ldr r3, [pc, #52] @ (8000b40 <MX_DMA_Init+0x4c>)
|
|
8000b0c: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
8000b0e: f403 0380 and.w r3, r3, #4194304 @ 0x400000
|
|
8000b12: 607b str r3, [r7, #4]
|
|
8000b14: 687b ldr r3, [r7, #4]
|
|
|
|
/* DMA interrupt init */
|
|
/* DMA2_Stream3_IRQn interrupt configuration */
|
|
HAL_NVIC_SetPriority(DMA2_Stream3_IRQn, 5, 0);
|
|
8000b16: 2200 movs r2, #0
|
|
8000b18: 2105 movs r1, #5
|
|
8000b1a: 203b movs r0, #59 @ 0x3b
|
|
8000b1c: f001 fb90 bl 8002240 <HAL_NVIC_SetPriority>
|
|
HAL_NVIC_EnableIRQ(DMA2_Stream3_IRQn);
|
|
8000b20: 203b movs r0, #59 @ 0x3b
|
|
8000b22: f001 fbb9 bl 8002298 <HAL_NVIC_EnableIRQ>
|
|
/* DMA2_Stream6_IRQn interrupt configuration */
|
|
HAL_NVIC_SetPriority(DMA2_Stream6_IRQn, 5, 0);
|
|
8000b26: 2200 movs r2, #0
|
|
8000b28: 2105 movs r1, #5
|
|
8000b2a: 2045 movs r0, #69 @ 0x45
|
|
8000b2c: f001 fb88 bl 8002240 <HAL_NVIC_SetPriority>
|
|
HAL_NVIC_EnableIRQ(DMA2_Stream6_IRQn);
|
|
8000b30: 2045 movs r0, #69 @ 0x45
|
|
8000b32: f001 fbb1 bl 8002298 <HAL_NVIC_EnableIRQ>
|
|
|
|
}
|
|
8000b36: bf00 nop
|
|
8000b38: 3708 adds r7, #8
|
|
8000b3a: 46bd mov sp, r7
|
|
8000b3c: bd80 pop {r7, pc}
|
|
8000b3e: bf00 nop
|
|
8000b40: 40023800 .word 0x40023800
|
|
|
|
08000b44 <MX_GPIO_Init>:
|
|
* @brief GPIO Initialization Function
|
|
* @param None
|
|
* @retval None
|
|
*/
|
|
static void MX_GPIO_Init(void)
|
|
{
|
|
8000b44: b580 push {r7, lr}
|
|
8000b46: b08a sub sp, #40 @ 0x28
|
|
8000b48: af00 add r7, sp, #0
|
|
GPIO_InitTypeDef GPIO_InitStruct = {0};
|
|
8000b4a: f107 0314 add.w r3, r7, #20
|
|
8000b4e: 2200 movs r2, #0
|
|
8000b50: 601a str r2, [r3, #0]
|
|
8000b52: 605a str r2, [r3, #4]
|
|
8000b54: 609a str r2, [r3, #8]
|
|
8000b56: 60da str r2, [r3, #12]
|
|
8000b58: 611a str r2, [r3, #16]
|
|
/* USER CODE BEGIN MX_GPIO_Init_1 */
|
|
|
|
/* USER CODE END MX_GPIO_Init_1 */
|
|
|
|
/* GPIO Ports Clock Enable */
|
|
__HAL_RCC_GPIOC_CLK_ENABLE();
|
|
8000b5a: 2300 movs r3, #0
|
|
8000b5c: 613b str r3, [r7, #16]
|
|
8000b5e: 4b47 ldr r3, [pc, #284] @ (8000c7c <MX_GPIO_Init+0x138>)
|
|
8000b60: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
8000b62: 4a46 ldr r2, [pc, #280] @ (8000c7c <MX_GPIO_Init+0x138>)
|
|
8000b64: f043 0304 orr.w r3, r3, #4
|
|
8000b68: 6313 str r3, [r2, #48] @ 0x30
|
|
8000b6a: 4b44 ldr r3, [pc, #272] @ (8000c7c <MX_GPIO_Init+0x138>)
|
|
8000b6c: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
8000b6e: f003 0304 and.w r3, r3, #4
|
|
8000b72: 613b str r3, [r7, #16]
|
|
8000b74: 693b ldr r3, [r7, #16]
|
|
__HAL_RCC_GPIOH_CLK_ENABLE();
|
|
8000b76: 2300 movs r3, #0
|
|
8000b78: 60fb str r3, [r7, #12]
|
|
8000b7a: 4b40 ldr r3, [pc, #256] @ (8000c7c <MX_GPIO_Init+0x138>)
|
|
8000b7c: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
8000b7e: 4a3f ldr r2, [pc, #252] @ (8000c7c <MX_GPIO_Init+0x138>)
|
|
8000b80: f043 0380 orr.w r3, r3, #128 @ 0x80
|
|
8000b84: 6313 str r3, [r2, #48] @ 0x30
|
|
8000b86: 4b3d ldr r3, [pc, #244] @ (8000c7c <MX_GPIO_Init+0x138>)
|
|
8000b88: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
8000b8a: f003 0380 and.w r3, r3, #128 @ 0x80
|
|
8000b8e: 60fb str r3, [r7, #12]
|
|
8000b90: 68fb ldr r3, [r7, #12]
|
|
__HAL_RCC_GPIOA_CLK_ENABLE();
|
|
8000b92: 2300 movs r3, #0
|
|
8000b94: 60bb str r3, [r7, #8]
|
|
8000b96: 4b39 ldr r3, [pc, #228] @ (8000c7c <MX_GPIO_Init+0x138>)
|
|
8000b98: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
8000b9a: 4a38 ldr r2, [pc, #224] @ (8000c7c <MX_GPIO_Init+0x138>)
|
|
8000b9c: f043 0301 orr.w r3, r3, #1
|
|
8000ba0: 6313 str r3, [r2, #48] @ 0x30
|
|
8000ba2: 4b36 ldr r3, [pc, #216] @ (8000c7c <MX_GPIO_Init+0x138>)
|
|
8000ba4: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
8000ba6: f003 0301 and.w r3, r3, #1
|
|
8000baa: 60bb str r3, [r7, #8]
|
|
8000bac: 68bb ldr r3, [r7, #8]
|
|
__HAL_RCC_GPIOB_CLK_ENABLE();
|
|
8000bae: 2300 movs r3, #0
|
|
8000bb0: 607b str r3, [r7, #4]
|
|
8000bb2: 4b32 ldr r3, [pc, #200] @ (8000c7c <MX_GPIO_Init+0x138>)
|
|
8000bb4: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
8000bb6: 4a31 ldr r2, [pc, #196] @ (8000c7c <MX_GPIO_Init+0x138>)
|
|
8000bb8: f043 0302 orr.w r3, r3, #2
|
|
8000bbc: 6313 str r3, [r2, #48] @ 0x30
|
|
8000bbe: 4b2f ldr r3, [pc, #188] @ (8000c7c <MX_GPIO_Init+0x138>)
|
|
8000bc0: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
8000bc2: f003 0302 and.w r3, r3, #2
|
|
8000bc6: 607b str r3, [r7, #4]
|
|
8000bc8: 687b ldr r3, [r7, #4]
|
|
__HAL_RCC_GPIOD_CLK_ENABLE();
|
|
8000bca: 2300 movs r3, #0
|
|
8000bcc: 603b str r3, [r7, #0]
|
|
8000bce: 4b2b ldr r3, [pc, #172] @ (8000c7c <MX_GPIO_Init+0x138>)
|
|
8000bd0: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
8000bd2: 4a2a ldr r2, [pc, #168] @ (8000c7c <MX_GPIO_Init+0x138>)
|
|
8000bd4: f043 0308 orr.w r3, r3, #8
|
|
8000bd8: 6313 str r3, [r2, #48] @ 0x30
|
|
8000bda: 4b28 ldr r3, [pc, #160] @ (8000c7c <MX_GPIO_Init+0x138>)
|
|
8000bdc: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
8000bde: f003 0308 and.w r3, r3, #8
|
|
8000be2: 603b str r3, [r7, #0]
|
|
8000be4: 683b ldr r3, [r7, #0]
|
|
|
|
/*Configure GPIO pin Output Level */
|
|
HAL_GPIO_WritePin(GPIOB, GPIO_PIN_3|GPIO_PIN_4|GPIO_PIN_5, GPIO_PIN_RESET);
|
|
8000be6: 2200 movs r2, #0
|
|
8000be8: 2138 movs r1, #56 @ 0x38
|
|
8000bea: 4825 ldr r0, [pc, #148] @ (8000c80 <MX_GPIO_Init+0x13c>)
|
|
8000bec: f002 fab8 bl 8003160 <HAL_GPIO_WritePin>
|
|
|
|
/*Configure GPIO pins : PC13 PC14 PC15 PC0
|
|
PC1 PC2 PC3 PC4
|
|
PC5 PC6 PC7 */
|
|
GPIO_InitStruct.Pin = GPIO_PIN_13|GPIO_PIN_14|GPIO_PIN_15|GPIO_PIN_0
|
|
8000bf0: f24e 03ff movw r3, #57599 @ 0xe0ff
|
|
8000bf4: 617b str r3, [r7, #20]
|
|
|GPIO_PIN_1|GPIO_PIN_2|GPIO_PIN_3|GPIO_PIN_4
|
|
|GPIO_PIN_5|GPIO_PIN_6|GPIO_PIN_7;
|
|
GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
|
|
8000bf6: 2303 movs r3, #3
|
|
8000bf8: 61bb str r3, [r7, #24]
|
|
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
8000bfa: 2300 movs r3, #0
|
|
8000bfc: 61fb str r3, [r7, #28]
|
|
HAL_GPIO_Init(GPIOC, &GPIO_InitStruct);
|
|
8000bfe: f107 0314 add.w r3, r7, #20
|
|
8000c02: 4619 mov r1, r3
|
|
8000c04: 481f ldr r0, [pc, #124] @ (8000c84 <MX_GPIO_Init+0x140>)
|
|
8000c06: f001 ffd7 bl 8002bb8 <HAL_GPIO_Init>
|
|
|
|
/*Configure GPIO pins : PH0 PH1 */
|
|
GPIO_InitStruct.Pin = GPIO_PIN_0|GPIO_PIN_1;
|
|
8000c0a: 2303 movs r3, #3
|
|
8000c0c: 617b str r3, [r7, #20]
|
|
GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
|
|
8000c0e: 2303 movs r3, #3
|
|
8000c10: 61bb str r3, [r7, #24]
|
|
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
8000c12: 2300 movs r3, #0
|
|
8000c14: 61fb str r3, [r7, #28]
|
|
HAL_GPIO_Init(GPIOH, &GPIO_InitStruct);
|
|
8000c16: f107 0314 add.w r3, r7, #20
|
|
8000c1a: 4619 mov r1, r3
|
|
8000c1c: 481a ldr r0, [pc, #104] @ (8000c88 <MX_GPIO_Init+0x144>)
|
|
8000c1e: f001 ffcb bl 8002bb8 <HAL_GPIO_Init>
|
|
|
|
/*Configure GPIO pins : PA0 PA1 PA2 PA3
|
|
PA4 PA5 PA6 PA7
|
|
PA8 PA9 PA10 PA11
|
|
PA12 PA13 PA14 PA15 */
|
|
GPIO_InitStruct.Pin = GPIO_PIN_0|GPIO_PIN_1|GPIO_PIN_2|GPIO_PIN_3
|
|
8000c22: f64f 73ff movw r3, #65535 @ 0xffff
|
|
8000c26: 617b str r3, [r7, #20]
|
|
|GPIO_PIN_4|GPIO_PIN_5|GPIO_PIN_6|GPIO_PIN_7
|
|
|GPIO_PIN_8|GPIO_PIN_9|GPIO_PIN_10|GPIO_PIN_11
|
|
|GPIO_PIN_12|GPIO_PIN_13|GPIO_PIN_14|GPIO_PIN_15;
|
|
GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
|
|
8000c28: 2303 movs r3, #3
|
|
8000c2a: 61bb str r3, [r7, #24]
|
|
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
8000c2c: 2300 movs r3, #0
|
|
8000c2e: 61fb str r3, [r7, #28]
|
|
HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
|
|
8000c30: f107 0314 add.w r3, r7, #20
|
|
8000c34: 4619 mov r1, r3
|
|
8000c36: 4815 ldr r0, [pc, #84] @ (8000c8c <MX_GPIO_Init+0x148>)
|
|
8000c38: f001 ffbe bl 8002bb8 <HAL_GPIO_Init>
|
|
|
|
/*Configure GPIO pins : PB0 PB1 PB2 PB10
|
|
PB11 PB14 PB15 PB6
|
|
PB7 */
|
|
GPIO_InitStruct.Pin = GPIO_PIN_0|GPIO_PIN_1|GPIO_PIN_2|GPIO_PIN_10
|
|
8000c3c: f64c 43c7 movw r3, #52423 @ 0xccc7
|
|
8000c40: 617b str r3, [r7, #20]
|
|
|GPIO_PIN_11|GPIO_PIN_14|GPIO_PIN_15|GPIO_PIN_6
|
|
|GPIO_PIN_7;
|
|
GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
|
|
8000c42: 2303 movs r3, #3
|
|
8000c44: 61bb str r3, [r7, #24]
|
|
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
8000c46: 2300 movs r3, #0
|
|
8000c48: 61fb str r3, [r7, #28]
|
|
HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
|
|
8000c4a: f107 0314 add.w r3, r7, #20
|
|
8000c4e: 4619 mov r1, r3
|
|
8000c50: 480b ldr r0, [pc, #44] @ (8000c80 <MX_GPIO_Init+0x13c>)
|
|
8000c52: f001 ffb1 bl 8002bb8 <HAL_GPIO_Init>
|
|
|
|
/*Configure GPIO pins : PB3 PB4 PB5 */
|
|
GPIO_InitStruct.Pin = GPIO_PIN_3|GPIO_PIN_4|GPIO_PIN_5;
|
|
8000c56: 2338 movs r3, #56 @ 0x38
|
|
8000c58: 617b str r3, [r7, #20]
|
|
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
8000c5a: 2301 movs r3, #1
|
|
8000c5c: 61bb str r3, [r7, #24]
|
|
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
8000c5e: 2300 movs r3, #0
|
|
8000c60: 61fb str r3, [r7, #28]
|
|
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
|
8000c62: 2300 movs r3, #0
|
|
8000c64: 623b str r3, [r7, #32]
|
|
HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
|
|
8000c66: f107 0314 add.w r3, r7, #20
|
|
8000c6a: 4619 mov r1, r3
|
|
8000c6c: 4804 ldr r0, [pc, #16] @ (8000c80 <MX_GPIO_Init+0x13c>)
|
|
8000c6e: f001 ffa3 bl 8002bb8 <HAL_GPIO_Init>
|
|
|
|
/* USER CODE BEGIN MX_GPIO_Init_2 */
|
|
|
|
/* USER CODE END MX_GPIO_Init_2 */
|
|
}
|
|
8000c72: bf00 nop
|
|
8000c74: 3728 adds r7, #40 @ 0x28
|
|
8000c76: 46bd mov sp, r7
|
|
8000c78: bd80 pop {r7, pc}
|
|
8000c7a: bf00 nop
|
|
8000c7c: 40023800 .word 0x40023800
|
|
8000c80: 40020400 .word 0x40020400
|
|
8000c84: 40020800 .word 0x40020800
|
|
8000c88: 40021c00 .word 0x40021c00
|
|
8000c8c: 40020000 .word 0x40020000
|
|
|
|
08000c90 <HAL_TIM_PeriodElapsedCallback>:
|
|
* a global variable "uwTick" used as application time base.
|
|
* @param htim : TIM handle
|
|
* @retval None
|
|
*/
|
|
void HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef *htim)
|
|
{
|
|
8000c90: b580 push {r7, lr}
|
|
8000c92: b082 sub sp, #8
|
|
8000c94: af00 add r7, sp, #0
|
|
8000c96: 6078 str r0, [r7, #4]
|
|
/* USER CODE BEGIN Callback 0 */
|
|
|
|
/* USER CODE END Callback 0 */
|
|
if (htim->Instance == TIM6)
|
|
8000c98: 687b ldr r3, [r7, #4]
|
|
8000c9a: 681b ldr r3, [r3, #0]
|
|
8000c9c: 4a04 ldr r2, [pc, #16] @ (8000cb0 <HAL_TIM_PeriodElapsedCallback+0x20>)
|
|
8000c9e: 4293 cmp r3, r2
|
|
8000ca0: d101 bne.n 8000ca6 <HAL_TIM_PeriodElapsedCallback+0x16>
|
|
{
|
|
HAL_IncTick();
|
|
8000ca2: f000 fbb5 bl 8001410 <HAL_IncTick>
|
|
}
|
|
/* USER CODE BEGIN Callback 1 */
|
|
|
|
/* USER CODE END Callback 1 */
|
|
}
|
|
8000ca6: bf00 nop
|
|
8000ca8: 3708 adds r7, #8
|
|
8000caa: 46bd mov sp, r7
|
|
8000cac: bd80 pop {r7, pc}
|
|
8000cae: bf00 nop
|
|
8000cb0: 40001000 .word 0x40001000
|
|
|
|
08000cb4 <Error_Handler>:
|
|
/**
|
|
* @brief This function is executed in case of error occurrence.
|
|
* @retval None
|
|
*/
|
|
void Error_Handler(void)
|
|
{
|
|
8000cb4: b580 push {r7, lr}
|
|
8000cb6: b082 sub sp, #8
|
|
8000cb8: af00 add r7, sp, #0
|
|
\details Disables IRQ interrupts by setting special-purpose register PRIMASK.
|
|
Can only be executed in Privileged modes.
|
|
*/
|
|
__STATIC_FORCEINLINE void __disable_irq(void)
|
|
{
|
|
__ASM volatile ("cpsid i" : : : "memory");
|
|
8000cba: b672 cpsid i
|
|
}
|
|
8000cbc: bf00 nop
|
|
//TODO: check if it is necessary to stop FreeRTOS
|
|
|
|
uint32_t error_code_can1;
|
|
uint32_t error_code_can2;
|
|
|
|
if (HAL_CAN_GetState(&hcan1) != HAL_CAN_STATE_READY) error_code_can1 = HAL_CAN_GetError(&hcan1);
|
|
8000cbe: 4818 ldr r0, [pc, #96] @ (8000d20 <Error_Handler+0x6c>)
|
|
8000cc0: f001 f9bc bl 800203c <HAL_CAN_GetState>
|
|
8000cc4: 4603 mov r3, r0
|
|
8000cc6: 2b01 cmp r3, #1
|
|
8000cc8: d003 beq.n 8000cd2 <Error_Handler+0x1e>
|
|
8000cca: 4815 ldr r0, [pc, #84] @ (8000d20 <Error_Handler+0x6c>)
|
|
8000ccc: f001 f9de bl 800208c <HAL_CAN_GetError>
|
|
8000cd0: 6078 str r0, [r7, #4]
|
|
if (HAL_CAN_GetState(&hcan2) != HAL_CAN_STATE_READY) error_code_can2 = HAL_CAN_GetError(&hcan2);
|
|
8000cd2: 4814 ldr r0, [pc, #80] @ (8000d24 <Error_Handler+0x70>)
|
|
8000cd4: f001 f9b2 bl 800203c <HAL_CAN_GetState>
|
|
8000cd8: 4603 mov r3, r0
|
|
8000cda: 2b01 cmp r3, #1
|
|
8000cdc: d003 beq.n 8000ce6 <Error_Handler+0x32>
|
|
8000cde: 4811 ldr r0, [pc, #68] @ (8000d24 <Error_Handler+0x70>)
|
|
8000ce0: f001 f9d4 bl 800208c <HAL_CAN_GetError>
|
|
8000ce4: 6038 str r0, [r7, #0]
|
|
|
|
// TODO: write error to SD and/or serial
|
|
|
|
HAL_GPIO_WritePin(led_can1.port, led_can1.pin, GPIO_PIN_RESET);
|
|
8000ce6: 4b10 ldr r3, [pc, #64] @ (8000d28 <Error_Handler+0x74>)
|
|
8000ce8: 681b ldr r3, [r3, #0]
|
|
8000cea: 4a0f ldr r2, [pc, #60] @ (8000d28 <Error_Handler+0x74>)
|
|
8000cec: 8891 ldrh r1, [r2, #4]
|
|
8000cee: 2200 movs r2, #0
|
|
8000cf0: 4618 mov r0, r3
|
|
8000cf2: f002 fa35 bl 8003160 <HAL_GPIO_WritePin>
|
|
HAL_GPIO_WritePin(led_can2.port, led_can2.pin, GPIO_PIN_RESET);
|
|
8000cf6: 4b0d ldr r3, [pc, #52] @ (8000d2c <Error_Handler+0x78>)
|
|
8000cf8: 681b ldr r3, [r3, #0]
|
|
8000cfa: 4a0c ldr r2, [pc, #48] @ (8000d2c <Error_Handler+0x78>)
|
|
8000cfc: 8891 ldrh r1, [r2, #4]
|
|
8000cfe: 2200 movs r2, #0
|
|
8000d00: 4618 mov r0, r3
|
|
8000d02: f002 fa2d bl 8003160 <HAL_GPIO_WritePin>
|
|
|
|
while (1)
|
|
{
|
|
HAL_GPIO_TogglePin(led_error.port, led_error.pin);
|
|
8000d06: 4b0a ldr r3, [pc, #40] @ (8000d30 <Error_Handler+0x7c>)
|
|
8000d08: 681b ldr r3, [r3, #0]
|
|
8000d0a: 4a09 ldr r2, [pc, #36] @ (8000d30 <Error_Handler+0x7c>)
|
|
8000d0c: 8892 ldrh r2, [r2, #4]
|
|
8000d0e: 4611 mov r1, r2
|
|
8000d10: 4618 mov r0, r3
|
|
8000d12: f002 fa51 bl 80031b8 <HAL_GPIO_TogglePin>
|
|
HAL_Delay(250);
|
|
8000d16: 20fa movs r0, #250 @ 0xfa
|
|
8000d18: f000 fb9a bl 8001450 <HAL_Delay>
|
|
HAL_GPIO_TogglePin(led_error.port, led_error.pin);
|
|
8000d1c: bf00 nop
|
|
8000d1e: e7f2 b.n 8000d06 <Error_Handler+0x52>
|
|
8000d20: 20000094 .word 0x20000094
|
|
8000d24: 200000f8 .word 0x200000f8
|
|
8000d28: 20000000 .word 0x20000000
|
|
8000d2c: 20000008 .word 0x20000008
|
|
8000d30: 20000010 .word 0x20000010
|
|
|
|
08000d34 <assert_failed>:
|
|
* @param file: pointer to the source file name
|
|
* @param line: assert_param error line source number
|
|
* @retval None
|
|
*/
|
|
void assert_failed(uint8_t *file, uint32_t line)
|
|
{
|
|
8000d34: b480 push {r7}
|
|
8000d36: b083 sub sp, #12
|
|
8000d38: af00 add r7, sp, #0
|
|
8000d3a: 6078 str r0, [r7, #4]
|
|
8000d3c: 6039 str r1, [r7, #0]
|
|
/* USER CODE BEGIN 6 */
|
|
/* User can add his own implementation to report the file name and line number,
|
|
ex: printf("Wrong parameters value: file %s on line %d\r\n", file, line) */
|
|
/* USER CODE END 6 */
|
|
}
|
|
8000d3e: bf00 nop
|
|
8000d40: 370c adds r7, #12
|
|
8000d42: 46bd mov sp, r7
|
|
8000d44: f85d 7b04 ldr.w r7, [sp], #4
|
|
8000d48: 4770 bx lr
|
|
...
|
|
|
|
08000d4c <HAL_MspInit>:
|
|
/* USER CODE END 0 */
|
|
/**
|
|
* Initializes the Global MSP.
|
|
*/
|
|
void HAL_MspInit(void)
|
|
{
|
|
8000d4c: b580 push {r7, lr}
|
|
8000d4e: b082 sub sp, #8
|
|
8000d50: af00 add r7, sp, #0
|
|
|
|
/* USER CODE BEGIN MspInit 0 */
|
|
|
|
/* USER CODE END MspInit 0 */
|
|
|
|
__HAL_RCC_SYSCFG_CLK_ENABLE();
|
|
8000d52: 2300 movs r3, #0
|
|
8000d54: 607b str r3, [r7, #4]
|
|
8000d56: 4b12 ldr r3, [pc, #72] @ (8000da0 <HAL_MspInit+0x54>)
|
|
8000d58: 6c5b ldr r3, [r3, #68] @ 0x44
|
|
8000d5a: 4a11 ldr r2, [pc, #68] @ (8000da0 <HAL_MspInit+0x54>)
|
|
8000d5c: f443 4380 orr.w r3, r3, #16384 @ 0x4000
|
|
8000d60: 6453 str r3, [r2, #68] @ 0x44
|
|
8000d62: 4b0f ldr r3, [pc, #60] @ (8000da0 <HAL_MspInit+0x54>)
|
|
8000d64: 6c5b ldr r3, [r3, #68] @ 0x44
|
|
8000d66: f403 4380 and.w r3, r3, #16384 @ 0x4000
|
|
8000d6a: 607b str r3, [r7, #4]
|
|
8000d6c: 687b ldr r3, [r7, #4]
|
|
__HAL_RCC_PWR_CLK_ENABLE();
|
|
8000d6e: 2300 movs r3, #0
|
|
8000d70: 603b str r3, [r7, #0]
|
|
8000d72: 4b0b ldr r3, [pc, #44] @ (8000da0 <HAL_MspInit+0x54>)
|
|
8000d74: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
8000d76: 4a0a ldr r2, [pc, #40] @ (8000da0 <HAL_MspInit+0x54>)
|
|
8000d78: f043 5380 orr.w r3, r3, #268435456 @ 0x10000000
|
|
8000d7c: 6413 str r3, [r2, #64] @ 0x40
|
|
8000d7e: 4b08 ldr r3, [pc, #32] @ (8000da0 <HAL_MspInit+0x54>)
|
|
8000d80: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
8000d82: f003 5380 and.w r3, r3, #268435456 @ 0x10000000
|
|
8000d86: 603b str r3, [r7, #0]
|
|
8000d88: 683b ldr r3, [r7, #0]
|
|
|
|
/* System interrupt init*/
|
|
/* PendSV_IRQn interrupt configuration */
|
|
HAL_NVIC_SetPriority(PendSV_IRQn, 15, 0);
|
|
8000d8a: 2200 movs r2, #0
|
|
8000d8c: 210f movs r1, #15
|
|
8000d8e: f06f 0001 mvn.w r0, #1
|
|
8000d92: f001 fa55 bl 8002240 <HAL_NVIC_SetPriority>
|
|
|
|
/* USER CODE BEGIN MspInit 1 */
|
|
|
|
/* USER CODE END MspInit 1 */
|
|
}
|
|
8000d96: bf00 nop
|
|
8000d98: 3708 adds r7, #8
|
|
8000d9a: 46bd mov sp, r7
|
|
8000d9c: bd80 pop {r7, pc}
|
|
8000d9e: bf00 nop
|
|
8000da0: 40023800 .word 0x40023800
|
|
|
|
08000da4 <HAL_CAN_MspInit>:
|
|
* This function configures the hardware resources used in this example
|
|
* @param hcan: CAN handle pointer
|
|
* @retval None
|
|
*/
|
|
void HAL_CAN_MspInit(CAN_HandleTypeDef* hcan)
|
|
{
|
|
8000da4: b580 push {r7, lr}
|
|
8000da6: b08c sub sp, #48 @ 0x30
|
|
8000da8: af00 add r7, sp, #0
|
|
8000daa: 6078 str r0, [r7, #4]
|
|
GPIO_InitTypeDef GPIO_InitStruct = {0};
|
|
8000dac: f107 031c add.w r3, r7, #28
|
|
8000db0: 2200 movs r2, #0
|
|
8000db2: 601a str r2, [r3, #0]
|
|
8000db4: 605a str r2, [r3, #4]
|
|
8000db6: 609a str r2, [r3, #8]
|
|
8000db8: 60da str r2, [r3, #12]
|
|
8000dba: 611a str r2, [r3, #16]
|
|
if(hcan->Instance==CAN1)
|
|
8000dbc: 687b ldr r3, [r7, #4]
|
|
8000dbe: 681b ldr r3, [r3, #0]
|
|
8000dc0: 4a43 ldr r2, [pc, #268] @ (8000ed0 <HAL_CAN_MspInit+0x12c>)
|
|
8000dc2: 4293 cmp r3, r2
|
|
8000dc4: d136 bne.n 8000e34 <HAL_CAN_MspInit+0x90>
|
|
{
|
|
/* USER CODE BEGIN CAN1_MspInit 0 */
|
|
|
|
/* USER CODE END CAN1_MspInit 0 */
|
|
/* Peripheral clock enable */
|
|
HAL_RCC_CAN1_CLK_ENABLED++;
|
|
8000dc6: 4b43 ldr r3, [pc, #268] @ (8000ed4 <HAL_CAN_MspInit+0x130>)
|
|
8000dc8: 681b ldr r3, [r3, #0]
|
|
8000dca: 3301 adds r3, #1
|
|
8000dcc: 4a41 ldr r2, [pc, #260] @ (8000ed4 <HAL_CAN_MspInit+0x130>)
|
|
8000dce: 6013 str r3, [r2, #0]
|
|
if(HAL_RCC_CAN1_CLK_ENABLED==1){
|
|
8000dd0: 4b40 ldr r3, [pc, #256] @ (8000ed4 <HAL_CAN_MspInit+0x130>)
|
|
8000dd2: 681b ldr r3, [r3, #0]
|
|
8000dd4: 2b01 cmp r3, #1
|
|
8000dd6: d10d bne.n 8000df4 <HAL_CAN_MspInit+0x50>
|
|
__HAL_RCC_CAN1_CLK_ENABLE();
|
|
8000dd8: 2300 movs r3, #0
|
|
8000dda: 61bb str r3, [r7, #24]
|
|
8000ddc: 4b3e ldr r3, [pc, #248] @ (8000ed8 <HAL_CAN_MspInit+0x134>)
|
|
8000dde: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
8000de0: 4a3d ldr r2, [pc, #244] @ (8000ed8 <HAL_CAN_MspInit+0x134>)
|
|
8000de2: f043 7300 orr.w r3, r3, #33554432 @ 0x2000000
|
|
8000de6: 6413 str r3, [r2, #64] @ 0x40
|
|
8000de8: 4b3b ldr r3, [pc, #236] @ (8000ed8 <HAL_CAN_MspInit+0x134>)
|
|
8000dea: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
8000dec: f003 7300 and.w r3, r3, #33554432 @ 0x2000000
|
|
8000df0: 61bb str r3, [r7, #24]
|
|
8000df2: 69bb ldr r3, [r7, #24]
|
|
}
|
|
|
|
__HAL_RCC_GPIOB_CLK_ENABLE();
|
|
8000df4: 2300 movs r3, #0
|
|
8000df6: 617b str r3, [r7, #20]
|
|
8000df8: 4b37 ldr r3, [pc, #220] @ (8000ed8 <HAL_CAN_MspInit+0x134>)
|
|
8000dfa: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
8000dfc: 4a36 ldr r2, [pc, #216] @ (8000ed8 <HAL_CAN_MspInit+0x134>)
|
|
8000dfe: f043 0302 orr.w r3, r3, #2
|
|
8000e02: 6313 str r3, [r2, #48] @ 0x30
|
|
8000e04: 4b34 ldr r3, [pc, #208] @ (8000ed8 <HAL_CAN_MspInit+0x134>)
|
|
8000e06: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
8000e08: f003 0302 and.w r3, r3, #2
|
|
8000e0c: 617b str r3, [r7, #20]
|
|
8000e0e: 697b ldr r3, [r7, #20]
|
|
/**CAN1 GPIO Configuration
|
|
PB8 ------> CAN1_RX
|
|
PB9 ------> CAN1_TX
|
|
*/
|
|
GPIO_InitStruct.Pin = GPIO_PIN_8|GPIO_PIN_9;
|
|
8000e10: f44f 7340 mov.w r3, #768 @ 0x300
|
|
8000e14: 61fb str r3, [r7, #28]
|
|
GPIO_InitStruct.Mode = GPIO_MODE_AF_PP;
|
|
8000e16: 2302 movs r3, #2
|
|
8000e18: 623b str r3, [r7, #32]
|
|
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
8000e1a: 2300 movs r3, #0
|
|
8000e1c: 627b str r3, [r7, #36] @ 0x24
|
|
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_VERY_HIGH;
|
|
8000e1e: 2303 movs r3, #3
|
|
8000e20: 62bb str r3, [r7, #40] @ 0x28
|
|
GPIO_InitStruct.Alternate = GPIO_AF9_CAN1;
|
|
8000e22: 2309 movs r3, #9
|
|
8000e24: 62fb str r3, [r7, #44] @ 0x2c
|
|
HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
|
|
8000e26: f107 031c add.w r3, r7, #28
|
|
8000e2a: 4619 mov r1, r3
|
|
8000e2c: 482b ldr r0, [pc, #172] @ (8000edc <HAL_CAN_MspInit+0x138>)
|
|
8000e2e: f001 fec3 bl 8002bb8 <HAL_GPIO_Init>
|
|
/* USER CODE BEGIN CAN2_MspInit 1 */
|
|
|
|
/* USER CODE END CAN2_MspInit 1 */
|
|
}
|
|
|
|
}
|
|
8000e32: e048 b.n 8000ec6 <HAL_CAN_MspInit+0x122>
|
|
else if(hcan->Instance==CAN2)
|
|
8000e34: 687b ldr r3, [r7, #4]
|
|
8000e36: 681b ldr r3, [r3, #0]
|
|
8000e38: 4a29 ldr r2, [pc, #164] @ (8000ee0 <HAL_CAN_MspInit+0x13c>)
|
|
8000e3a: 4293 cmp r3, r2
|
|
8000e3c: d143 bne.n 8000ec6 <HAL_CAN_MspInit+0x122>
|
|
__HAL_RCC_CAN2_CLK_ENABLE();
|
|
8000e3e: 2300 movs r3, #0
|
|
8000e40: 613b str r3, [r7, #16]
|
|
8000e42: 4b25 ldr r3, [pc, #148] @ (8000ed8 <HAL_CAN_MspInit+0x134>)
|
|
8000e44: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
8000e46: 4a24 ldr r2, [pc, #144] @ (8000ed8 <HAL_CAN_MspInit+0x134>)
|
|
8000e48: f043 6380 orr.w r3, r3, #67108864 @ 0x4000000
|
|
8000e4c: 6413 str r3, [r2, #64] @ 0x40
|
|
8000e4e: 4b22 ldr r3, [pc, #136] @ (8000ed8 <HAL_CAN_MspInit+0x134>)
|
|
8000e50: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
8000e52: f003 6380 and.w r3, r3, #67108864 @ 0x4000000
|
|
8000e56: 613b str r3, [r7, #16]
|
|
8000e58: 693b ldr r3, [r7, #16]
|
|
HAL_RCC_CAN1_CLK_ENABLED++;
|
|
8000e5a: 4b1e ldr r3, [pc, #120] @ (8000ed4 <HAL_CAN_MspInit+0x130>)
|
|
8000e5c: 681b ldr r3, [r3, #0]
|
|
8000e5e: 3301 adds r3, #1
|
|
8000e60: 4a1c ldr r2, [pc, #112] @ (8000ed4 <HAL_CAN_MspInit+0x130>)
|
|
8000e62: 6013 str r3, [r2, #0]
|
|
if(HAL_RCC_CAN1_CLK_ENABLED==1){
|
|
8000e64: 4b1b ldr r3, [pc, #108] @ (8000ed4 <HAL_CAN_MspInit+0x130>)
|
|
8000e66: 681b ldr r3, [r3, #0]
|
|
8000e68: 2b01 cmp r3, #1
|
|
8000e6a: d10d bne.n 8000e88 <HAL_CAN_MspInit+0xe4>
|
|
__HAL_RCC_CAN1_CLK_ENABLE();
|
|
8000e6c: 2300 movs r3, #0
|
|
8000e6e: 60fb str r3, [r7, #12]
|
|
8000e70: 4b19 ldr r3, [pc, #100] @ (8000ed8 <HAL_CAN_MspInit+0x134>)
|
|
8000e72: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
8000e74: 4a18 ldr r2, [pc, #96] @ (8000ed8 <HAL_CAN_MspInit+0x134>)
|
|
8000e76: f043 7300 orr.w r3, r3, #33554432 @ 0x2000000
|
|
8000e7a: 6413 str r3, [r2, #64] @ 0x40
|
|
8000e7c: 4b16 ldr r3, [pc, #88] @ (8000ed8 <HAL_CAN_MspInit+0x134>)
|
|
8000e7e: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
8000e80: f003 7300 and.w r3, r3, #33554432 @ 0x2000000
|
|
8000e84: 60fb str r3, [r7, #12]
|
|
8000e86: 68fb ldr r3, [r7, #12]
|
|
__HAL_RCC_GPIOB_CLK_ENABLE();
|
|
8000e88: 2300 movs r3, #0
|
|
8000e8a: 60bb str r3, [r7, #8]
|
|
8000e8c: 4b12 ldr r3, [pc, #72] @ (8000ed8 <HAL_CAN_MspInit+0x134>)
|
|
8000e8e: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
8000e90: 4a11 ldr r2, [pc, #68] @ (8000ed8 <HAL_CAN_MspInit+0x134>)
|
|
8000e92: f043 0302 orr.w r3, r3, #2
|
|
8000e96: 6313 str r3, [r2, #48] @ 0x30
|
|
8000e98: 4b0f ldr r3, [pc, #60] @ (8000ed8 <HAL_CAN_MspInit+0x134>)
|
|
8000e9a: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
8000e9c: f003 0302 and.w r3, r3, #2
|
|
8000ea0: 60bb str r3, [r7, #8]
|
|
8000ea2: 68bb ldr r3, [r7, #8]
|
|
GPIO_InitStruct.Pin = GPIO_PIN_12|GPIO_PIN_13;
|
|
8000ea4: f44f 5340 mov.w r3, #12288 @ 0x3000
|
|
8000ea8: 61fb str r3, [r7, #28]
|
|
GPIO_InitStruct.Mode = GPIO_MODE_AF_PP;
|
|
8000eaa: 2302 movs r3, #2
|
|
8000eac: 623b str r3, [r7, #32]
|
|
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
8000eae: 2300 movs r3, #0
|
|
8000eb0: 627b str r3, [r7, #36] @ 0x24
|
|
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_VERY_HIGH;
|
|
8000eb2: 2303 movs r3, #3
|
|
8000eb4: 62bb str r3, [r7, #40] @ 0x28
|
|
GPIO_InitStruct.Alternate = GPIO_AF9_CAN2;
|
|
8000eb6: 2309 movs r3, #9
|
|
8000eb8: 62fb str r3, [r7, #44] @ 0x2c
|
|
HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
|
|
8000eba: f107 031c add.w r3, r7, #28
|
|
8000ebe: 4619 mov r1, r3
|
|
8000ec0: 4806 ldr r0, [pc, #24] @ (8000edc <HAL_CAN_MspInit+0x138>)
|
|
8000ec2: f001 fe79 bl 8002bb8 <HAL_GPIO_Init>
|
|
}
|
|
8000ec6: bf00 nop
|
|
8000ec8: 3730 adds r7, #48 @ 0x30
|
|
8000eca: 46bd mov sp, r7
|
|
8000ecc: bd80 pop {r7, pc}
|
|
8000ece: bf00 nop
|
|
8000ed0: 40006400 .word 0x40006400
|
|
8000ed4: 200002d0 .word 0x200002d0
|
|
8000ed8: 40023800 .word 0x40023800
|
|
8000edc: 40020400 .word 0x40020400
|
|
8000ee0: 40006800 .word 0x40006800
|
|
|
|
08000ee4 <HAL_SD_MspInit>:
|
|
* This function configures the hardware resources used in this example
|
|
* @param hsd: SD handle pointer
|
|
* @retval None
|
|
*/
|
|
void HAL_SD_MspInit(SD_HandleTypeDef* hsd)
|
|
{
|
|
8000ee4: b580 push {r7, lr}
|
|
8000ee6: b08a sub sp, #40 @ 0x28
|
|
8000ee8: af00 add r7, sp, #0
|
|
8000eea: 6078 str r0, [r7, #4]
|
|
GPIO_InitTypeDef GPIO_InitStruct = {0};
|
|
8000eec: f107 0314 add.w r3, r7, #20
|
|
8000ef0: 2200 movs r2, #0
|
|
8000ef2: 601a str r2, [r3, #0]
|
|
8000ef4: 605a str r2, [r3, #4]
|
|
8000ef6: 609a str r2, [r3, #8]
|
|
8000ef8: 60da str r2, [r3, #12]
|
|
8000efa: 611a str r2, [r3, #16]
|
|
if(hsd->Instance==SDIO)
|
|
8000efc: 687b ldr r3, [r7, #4]
|
|
8000efe: 681b ldr r3, [r3, #0]
|
|
8000f00: 4a68 ldr r2, [pc, #416] @ (80010a4 <HAL_SD_MspInit+0x1c0>)
|
|
8000f02: 4293 cmp r3, r2
|
|
8000f04: f040 80c9 bne.w 800109a <HAL_SD_MspInit+0x1b6>
|
|
{
|
|
/* USER CODE BEGIN SDIO_MspInit 0 */
|
|
|
|
/* USER CODE END SDIO_MspInit 0 */
|
|
/* Peripheral clock enable */
|
|
__HAL_RCC_SDIO_CLK_ENABLE();
|
|
8000f08: 2300 movs r3, #0
|
|
8000f0a: 613b str r3, [r7, #16]
|
|
8000f0c: 4b66 ldr r3, [pc, #408] @ (80010a8 <HAL_SD_MspInit+0x1c4>)
|
|
8000f0e: 6c5b ldr r3, [r3, #68] @ 0x44
|
|
8000f10: 4a65 ldr r2, [pc, #404] @ (80010a8 <HAL_SD_MspInit+0x1c4>)
|
|
8000f12: f443 6300 orr.w r3, r3, #2048 @ 0x800
|
|
8000f16: 6453 str r3, [r2, #68] @ 0x44
|
|
8000f18: 4b63 ldr r3, [pc, #396] @ (80010a8 <HAL_SD_MspInit+0x1c4>)
|
|
8000f1a: 6c5b ldr r3, [r3, #68] @ 0x44
|
|
8000f1c: f403 6300 and.w r3, r3, #2048 @ 0x800
|
|
8000f20: 613b str r3, [r7, #16]
|
|
8000f22: 693b ldr r3, [r7, #16]
|
|
|
|
__HAL_RCC_GPIOC_CLK_ENABLE();
|
|
8000f24: 2300 movs r3, #0
|
|
8000f26: 60fb str r3, [r7, #12]
|
|
8000f28: 4b5f ldr r3, [pc, #380] @ (80010a8 <HAL_SD_MspInit+0x1c4>)
|
|
8000f2a: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
8000f2c: 4a5e ldr r2, [pc, #376] @ (80010a8 <HAL_SD_MspInit+0x1c4>)
|
|
8000f2e: f043 0304 orr.w r3, r3, #4
|
|
8000f32: 6313 str r3, [r2, #48] @ 0x30
|
|
8000f34: 4b5c ldr r3, [pc, #368] @ (80010a8 <HAL_SD_MspInit+0x1c4>)
|
|
8000f36: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
8000f38: f003 0304 and.w r3, r3, #4
|
|
8000f3c: 60fb str r3, [r7, #12]
|
|
8000f3e: 68fb ldr r3, [r7, #12]
|
|
__HAL_RCC_GPIOD_CLK_ENABLE();
|
|
8000f40: 2300 movs r3, #0
|
|
8000f42: 60bb str r3, [r7, #8]
|
|
8000f44: 4b58 ldr r3, [pc, #352] @ (80010a8 <HAL_SD_MspInit+0x1c4>)
|
|
8000f46: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
8000f48: 4a57 ldr r2, [pc, #348] @ (80010a8 <HAL_SD_MspInit+0x1c4>)
|
|
8000f4a: f043 0308 orr.w r3, r3, #8
|
|
8000f4e: 6313 str r3, [r2, #48] @ 0x30
|
|
8000f50: 4b55 ldr r3, [pc, #340] @ (80010a8 <HAL_SD_MspInit+0x1c4>)
|
|
8000f52: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
8000f54: f003 0308 and.w r3, r3, #8
|
|
8000f58: 60bb str r3, [r7, #8]
|
|
8000f5a: 68bb ldr r3, [r7, #8]
|
|
PC10 ------> SDIO_D2
|
|
PC11 ------> SDIO_D3
|
|
PC12 ------> SDIO_CK
|
|
PD2 ------> SDIO_CMD
|
|
*/
|
|
GPIO_InitStruct.Pin = GPIO_PIN_8|GPIO_PIN_9|GPIO_PIN_10|GPIO_PIN_11
|
|
8000f5c: f44f 53f8 mov.w r3, #7936 @ 0x1f00
|
|
8000f60: 617b str r3, [r7, #20]
|
|
|GPIO_PIN_12;
|
|
GPIO_InitStruct.Mode = GPIO_MODE_AF_PP;
|
|
8000f62: 2302 movs r3, #2
|
|
8000f64: 61bb str r3, [r7, #24]
|
|
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
8000f66: 2300 movs r3, #0
|
|
8000f68: 61fb str r3, [r7, #28]
|
|
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_VERY_HIGH;
|
|
8000f6a: 2303 movs r3, #3
|
|
8000f6c: 623b str r3, [r7, #32]
|
|
GPIO_InitStruct.Alternate = GPIO_AF12_SDIO;
|
|
8000f6e: 230c movs r3, #12
|
|
8000f70: 627b str r3, [r7, #36] @ 0x24
|
|
HAL_GPIO_Init(GPIOC, &GPIO_InitStruct);
|
|
8000f72: f107 0314 add.w r3, r7, #20
|
|
8000f76: 4619 mov r1, r3
|
|
8000f78: 484c ldr r0, [pc, #304] @ (80010ac <HAL_SD_MspInit+0x1c8>)
|
|
8000f7a: f001 fe1d bl 8002bb8 <HAL_GPIO_Init>
|
|
|
|
GPIO_InitStruct.Pin = GPIO_PIN_2;
|
|
8000f7e: 2304 movs r3, #4
|
|
8000f80: 617b str r3, [r7, #20]
|
|
GPIO_InitStruct.Mode = GPIO_MODE_AF_PP;
|
|
8000f82: 2302 movs r3, #2
|
|
8000f84: 61bb str r3, [r7, #24]
|
|
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
8000f86: 2300 movs r3, #0
|
|
8000f88: 61fb str r3, [r7, #28]
|
|
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_VERY_HIGH;
|
|
8000f8a: 2303 movs r3, #3
|
|
8000f8c: 623b str r3, [r7, #32]
|
|
GPIO_InitStruct.Alternate = GPIO_AF12_SDIO;
|
|
8000f8e: 230c movs r3, #12
|
|
8000f90: 627b str r3, [r7, #36] @ 0x24
|
|
HAL_GPIO_Init(GPIOD, &GPIO_InitStruct);
|
|
8000f92: f107 0314 add.w r3, r7, #20
|
|
8000f96: 4619 mov r1, r3
|
|
8000f98: 4845 ldr r0, [pc, #276] @ (80010b0 <HAL_SD_MspInit+0x1cc>)
|
|
8000f9a: f001 fe0d bl 8002bb8 <HAL_GPIO_Init>
|
|
|
|
/* SDIO DMA Init */
|
|
/* SDIO_RX Init */
|
|
hdma_sdio_rx.Instance = DMA2_Stream3;
|
|
8000f9e: 4b45 ldr r3, [pc, #276] @ (80010b4 <HAL_SD_MspInit+0x1d0>)
|
|
8000fa0: 4a45 ldr r2, [pc, #276] @ (80010b8 <HAL_SD_MspInit+0x1d4>)
|
|
8000fa2: 601a str r2, [r3, #0]
|
|
hdma_sdio_rx.Init.Channel = DMA_CHANNEL_4;
|
|
8000fa4: 4b43 ldr r3, [pc, #268] @ (80010b4 <HAL_SD_MspInit+0x1d0>)
|
|
8000fa6: f04f 6200 mov.w r2, #134217728 @ 0x8000000
|
|
8000faa: 605a str r2, [r3, #4]
|
|
hdma_sdio_rx.Init.Direction = DMA_PERIPH_TO_MEMORY;
|
|
8000fac: 4b41 ldr r3, [pc, #260] @ (80010b4 <HAL_SD_MspInit+0x1d0>)
|
|
8000fae: 2200 movs r2, #0
|
|
8000fb0: 609a str r2, [r3, #8]
|
|
hdma_sdio_rx.Init.PeriphInc = DMA_PINC_DISABLE;
|
|
8000fb2: 4b40 ldr r3, [pc, #256] @ (80010b4 <HAL_SD_MspInit+0x1d0>)
|
|
8000fb4: 2200 movs r2, #0
|
|
8000fb6: 60da str r2, [r3, #12]
|
|
hdma_sdio_rx.Init.MemInc = DMA_MINC_ENABLE;
|
|
8000fb8: 4b3e ldr r3, [pc, #248] @ (80010b4 <HAL_SD_MspInit+0x1d0>)
|
|
8000fba: f44f 6280 mov.w r2, #1024 @ 0x400
|
|
8000fbe: 611a str r2, [r3, #16]
|
|
hdma_sdio_rx.Init.PeriphDataAlignment = DMA_PDATAALIGN_WORD;
|
|
8000fc0: 4b3c ldr r3, [pc, #240] @ (80010b4 <HAL_SD_MspInit+0x1d0>)
|
|
8000fc2: f44f 5280 mov.w r2, #4096 @ 0x1000
|
|
8000fc6: 615a str r2, [r3, #20]
|
|
hdma_sdio_rx.Init.MemDataAlignment = DMA_MDATAALIGN_WORD;
|
|
8000fc8: 4b3a ldr r3, [pc, #232] @ (80010b4 <HAL_SD_MspInit+0x1d0>)
|
|
8000fca: f44f 4280 mov.w r2, #16384 @ 0x4000
|
|
8000fce: 619a str r2, [r3, #24]
|
|
hdma_sdio_rx.Init.Mode = DMA_PFCTRL;
|
|
8000fd0: 4b38 ldr r3, [pc, #224] @ (80010b4 <HAL_SD_MspInit+0x1d0>)
|
|
8000fd2: 2220 movs r2, #32
|
|
8000fd4: 61da str r2, [r3, #28]
|
|
hdma_sdio_rx.Init.Priority = DMA_PRIORITY_LOW;
|
|
8000fd6: 4b37 ldr r3, [pc, #220] @ (80010b4 <HAL_SD_MspInit+0x1d0>)
|
|
8000fd8: 2200 movs r2, #0
|
|
8000fda: 621a str r2, [r3, #32]
|
|
hdma_sdio_rx.Init.FIFOMode = DMA_FIFOMODE_ENABLE;
|
|
8000fdc: 4b35 ldr r3, [pc, #212] @ (80010b4 <HAL_SD_MspInit+0x1d0>)
|
|
8000fde: 2204 movs r2, #4
|
|
8000fe0: 625a str r2, [r3, #36] @ 0x24
|
|
hdma_sdio_rx.Init.FIFOThreshold = DMA_FIFO_THRESHOLD_FULL;
|
|
8000fe2: 4b34 ldr r3, [pc, #208] @ (80010b4 <HAL_SD_MspInit+0x1d0>)
|
|
8000fe4: 2203 movs r2, #3
|
|
8000fe6: 629a str r2, [r3, #40] @ 0x28
|
|
hdma_sdio_rx.Init.MemBurst = DMA_MBURST_INC4;
|
|
8000fe8: 4b32 ldr r3, [pc, #200] @ (80010b4 <HAL_SD_MspInit+0x1d0>)
|
|
8000fea: f44f 0200 mov.w r2, #8388608 @ 0x800000
|
|
8000fee: 62da str r2, [r3, #44] @ 0x2c
|
|
hdma_sdio_rx.Init.PeriphBurst = DMA_PBURST_INC4;
|
|
8000ff0: 4b30 ldr r3, [pc, #192] @ (80010b4 <HAL_SD_MspInit+0x1d0>)
|
|
8000ff2: f44f 1200 mov.w r2, #2097152 @ 0x200000
|
|
8000ff6: 631a str r2, [r3, #48] @ 0x30
|
|
if (HAL_DMA_Init(&hdma_sdio_rx) != HAL_OK)
|
|
8000ff8: 482e ldr r0, [pc, #184] @ (80010b4 <HAL_SD_MspInit+0x1d0>)
|
|
8000ffa: f001 f965 bl 80022c8 <HAL_DMA_Init>
|
|
8000ffe: 4603 mov r3, r0
|
|
8001000: 2b00 cmp r3, #0
|
|
8001002: d001 beq.n 8001008 <HAL_SD_MspInit+0x124>
|
|
{
|
|
Error_Handler();
|
|
8001004: f7ff fe56 bl 8000cb4 <Error_Handler>
|
|
}
|
|
|
|
__HAL_LINKDMA(hsd,hdmarx,hdma_sdio_rx);
|
|
8001008: 687b ldr r3, [r7, #4]
|
|
800100a: 4a2a ldr r2, [pc, #168] @ (80010b4 <HAL_SD_MspInit+0x1d0>)
|
|
800100c: 641a str r2, [r3, #64] @ 0x40
|
|
800100e: 4a29 ldr r2, [pc, #164] @ (80010b4 <HAL_SD_MspInit+0x1d0>)
|
|
8001010: 687b ldr r3, [r7, #4]
|
|
8001012: 6393 str r3, [r2, #56] @ 0x38
|
|
|
|
/* SDIO_TX Init */
|
|
hdma_sdio_tx.Instance = DMA2_Stream6;
|
|
8001014: 4b29 ldr r3, [pc, #164] @ (80010bc <HAL_SD_MspInit+0x1d8>)
|
|
8001016: 4a2a ldr r2, [pc, #168] @ (80010c0 <HAL_SD_MspInit+0x1dc>)
|
|
8001018: 601a str r2, [r3, #0]
|
|
hdma_sdio_tx.Init.Channel = DMA_CHANNEL_4;
|
|
800101a: 4b28 ldr r3, [pc, #160] @ (80010bc <HAL_SD_MspInit+0x1d8>)
|
|
800101c: f04f 6200 mov.w r2, #134217728 @ 0x8000000
|
|
8001020: 605a str r2, [r3, #4]
|
|
hdma_sdio_tx.Init.Direction = DMA_MEMORY_TO_PERIPH;
|
|
8001022: 4b26 ldr r3, [pc, #152] @ (80010bc <HAL_SD_MspInit+0x1d8>)
|
|
8001024: 2240 movs r2, #64 @ 0x40
|
|
8001026: 609a str r2, [r3, #8]
|
|
hdma_sdio_tx.Init.PeriphInc = DMA_PINC_DISABLE;
|
|
8001028: 4b24 ldr r3, [pc, #144] @ (80010bc <HAL_SD_MspInit+0x1d8>)
|
|
800102a: 2200 movs r2, #0
|
|
800102c: 60da str r2, [r3, #12]
|
|
hdma_sdio_tx.Init.MemInc = DMA_MINC_ENABLE;
|
|
800102e: 4b23 ldr r3, [pc, #140] @ (80010bc <HAL_SD_MspInit+0x1d8>)
|
|
8001030: f44f 6280 mov.w r2, #1024 @ 0x400
|
|
8001034: 611a str r2, [r3, #16]
|
|
hdma_sdio_tx.Init.PeriphDataAlignment = DMA_PDATAALIGN_WORD;
|
|
8001036: 4b21 ldr r3, [pc, #132] @ (80010bc <HAL_SD_MspInit+0x1d8>)
|
|
8001038: f44f 5280 mov.w r2, #4096 @ 0x1000
|
|
800103c: 615a str r2, [r3, #20]
|
|
hdma_sdio_tx.Init.MemDataAlignment = DMA_MDATAALIGN_WORD;
|
|
800103e: 4b1f ldr r3, [pc, #124] @ (80010bc <HAL_SD_MspInit+0x1d8>)
|
|
8001040: f44f 4280 mov.w r2, #16384 @ 0x4000
|
|
8001044: 619a str r2, [r3, #24]
|
|
hdma_sdio_tx.Init.Mode = DMA_PFCTRL;
|
|
8001046: 4b1d ldr r3, [pc, #116] @ (80010bc <HAL_SD_MspInit+0x1d8>)
|
|
8001048: 2220 movs r2, #32
|
|
800104a: 61da str r2, [r3, #28]
|
|
hdma_sdio_tx.Init.Priority = DMA_PRIORITY_LOW;
|
|
800104c: 4b1b ldr r3, [pc, #108] @ (80010bc <HAL_SD_MspInit+0x1d8>)
|
|
800104e: 2200 movs r2, #0
|
|
8001050: 621a str r2, [r3, #32]
|
|
hdma_sdio_tx.Init.FIFOMode = DMA_FIFOMODE_ENABLE;
|
|
8001052: 4b1a ldr r3, [pc, #104] @ (80010bc <HAL_SD_MspInit+0x1d8>)
|
|
8001054: 2204 movs r2, #4
|
|
8001056: 625a str r2, [r3, #36] @ 0x24
|
|
hdma_sdio_tx.Init.FIFOThreshold = DMA_FIFO_THRESHOLD_FULL;
|
|
8001058: 4b18 ldr r3, [pc, #96] @ (80010bc <HAL_SD_MspInit+0x1d8>)
|
|
800105a: 2203 movs r2, #3
|
|
800105c: 629a str r2, [r3, #40] @ 0x28
|
|
hdma_sdio_tx.Init.MemBurst = DMA_MBURST_INC4;
|
|
800105e: 4b17 ldr r3, [pc, #92] @ (80010bc <HAL_SD_MspInit+0x1d8>)
|
|
8001060: f44f 0200 mov.w r2, #8388608 @ 0x800000
|
|
8001064: 62da str r2, [r3, #44] @ 0x2c
|
|
hdma_sdio_tx.Init.PeriphBurst = DMA_PBURST_INC4;
|
|
8001066: 4b15 ldr r3, [pc, #84] @ (80010bc <HAL_SD_MspInit+0x1d8>)
|
|
8001068: f44f 1200 mov.w r2, #2097152 @ 0x200000
|
|
800106c: 631a str r2, [r3, #48] @ 0x30
|
|
if (HAL_DMA_Init(&hdma_sdio_tx) != HAL_OK)
|
|
800106e: 4813 ldr r0, [pc, #76] @ (80010bc <HAL_SD_MspInit+0x1d8>)
|
|
8001070: f001 f92a bl 80022c8 <HAL_DMA_Init>
|
|
8001074: 4603 mov r3, r0
|
|
8001076: 2b00 cmp r3, #0
|
|
8001078: d001 beq.n 800107e <HAL_SD_MspInit+0x19a>
|
|
{
|
|
Error_Handler();
|
|
800107a: f7ff fe1b bl 8000cb4 <Error_Handler>
|
|
}
|
|
|
|
__HAL_LINKDMA(hsd,hdmatx,hdma_sdio_tx);
|
|
800107e: 687b ldr r3, [r7, #4]
|
|
8001080: 4a0e ldr r2, [pc, #56] @ (80010bc <HAL_SD_MspInit+0x1d8>)
|
|
8001082: 63da str r2, [r3, #60] @ 0x3c
|
|
8001084: 4a0d ldr r2, [pc, #52] @ (80010bc <HAL_SD_MspInit+0x1d8>)
|
|
8001086: 687b ldr r3, [r7, #4]
|
|
8001088: 6393 str r3, [r2, #56] @ 0x38
|
|
|
|
/* SDIO interrupt Init */
|
|
HAL_NVIC_SetPriority(SDIO_IRQn, 5, 0);
|
|
800108a: 2200 movs r2, #0
|
|
800108c: 2105 movs r1, #5
|
|
800108e: 2031 movs r0, #49 @ 0x31
|
|
8001090: f001 f8d6 bl 8002240 <HAL_NVIC_SetPriority>
|
|
HAL_NVIC_EnableIRQ(SDIO_IRQn);
|
|
8001094: 2031 movs r0, #49 @ 0x31
|
|
8001096: f001 f8ff bl 8002298 <HAL_NVIC_EnableIRQ>
|
|
|
|
/* USER CODE END SDIO_MspInit 1 */
|
|
|
|
}
|
|
|
|
}
|
|
800109a: bf00 nop
|
|
800109c: 3728 adds r7, #40 @ 0x28
|
|
800109e: 46bd mov sp, r7
|
|
80010a0: bd80 pop {r7, pc}
|
|
80010a2: bf00 nop
|
|
80010a4: 40012c00 .word 0x40012c00
|
|
80010a8: 40023800 .word 0x40023800
|
|
80010ac: 40020800 .word 0x40020800
|
|
80010b0: 40020c00 .word 0x40020c00
|
|
80010b4: 200001e0 .word 0x200001e0
|
|
80010b8: 40026458 .word 0x40026458
|
|
80010bc: 20000240 .word 0x20000240
|
|
80010c0: 400264a0 .word 0x400264a0
|
|
|
|
080010c4 <HAL_InitTick>:
|
|
* reset by HAL_Init() or at any time when clock is configured, by HAL_RCC_ClockConfig().
|
|
* @param TickPriority: Tick interrupt priority.
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_InitTick(uint32_t TickPriority)
|
|
{
|
|
80010c4: b580 push {r7, lr}
|
|
80010c6: b08e sub sp, #56 @ 0x38
|
|
80010c8: af00 add r7, sp, #0
|
|
80010ca: 6078 str r0, [r7, #4]
|
|
RCC_ClkInitTypeDef clkconfig;
|
|
uint32_t uwTimclock, uwAPB1Prescaler = 0U;
|
|
80010cc: 2300 movs r3, #0
|
|
80010ce: 62fb str r3, [r7, #44] @ 0x2c
|
|
|
|
uint32_t uwPrescalerValue = 0U;
|
|
80010d0: 2300 movs r3, #0
|
|
80010d2: 62bb str r3, [r7, #40] @ 0x28
|
|
uint32_t pFLatency;
|
|
|
|
HAL_StatusTypeDef status;
|
|
|
|
/* Enable TIM6 clock */
|
|
__HAL_RCC_TIM6_CLK_ENABLE();
|
|
80010d4: 2300 movs r3, #0
|
|
80010d6: 60fb str r3, [r7, #12]
|
|
80010d8: 4b33 ldr r3, [pc, #204] @ (80011a8 <HAL_InitTick+0xe4>)
|
|
80010da: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
80010dc: 4a32 ldr r2, [pc, #200] @ (80011a8 <HAL_InitTick+0xe4>)
|
|
80010de: f043 0310 orr.w r3, r3, #16
|
|
80010e2: 6413 str r3, [r2, #64] @ 0x40
|
|
80010e4: 4b30 ldr r3, [pc, #192] @ (80011a8 <HAL_InitTick+0xe4>)
|
|
80010e6: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
80010e8: f003 0310 and.w r3, r3, #16
|
|
80010ec: 60fb str r3, [r7, #12]
|
|
80010ee: 68fb ldr r3, [r7, #12]
|
|
|
|
/* Get clock configuration */
|
|
HAL_RCC_GetClockConfig(&clkconfig, &pFLatency);
|
|
80010f0: f107 0210 add.w r2, r7, #16
|
|
80010f4: f107 0314 add.w r3, r7, #20
|
|
80010f8: 4611 mov r1, r2
|
|
80010fa: 4618 mov r0, r3
|
|
80010fc: f002 fe1c bl 8003d38 <HAL_RCC_GetClockConfig>
|
|
|
|
/* Get APB1 prescaler */
|
|
uwAPB1Prescaler = clkconfig.APB1CLKDivider;
|
|
8001100: 6a3b ldr r3, [r7, #32]
|
|
8001102: 62fb str r3, [r7, #44] @ 0x2c
|
|
/* Compute TIM6 clock */
|
|
if (uwAPB1Prescaler == RCC_HCLK_DIV1)
|
|
8001104: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
8001106: 2b00 cmp r3, #0
|
|
8001108: d103 bne.n 8001112 <HAL_InitTick+0x4e>
|
|
{
|
|
uwTimclock = HAL_RCC_GetPCLK1Freq();
|
|
800110a: f002 fe01 bl 8003d10 <HAL_RCC_GetPCLK1Freq>
|
|
800110e: 6378 str r0, [r7, #52] @ 0x34
|
|
8001110: e004 b.n 800111c <HAL_InitTick+0x58>
|
|
}
|
|
else
|
|
{
|
|
uwTimclock = 2UL * HAL_RCC_GetPCLK1Freq();
|
|
8001112: f002 fdfd bl 8003d10 <HAL_RCC_GetPCLK1Freq>
|
|
8001116: 4603 mov r3, r0
|
|
8001118: 005b lsls r3, r3, #1
|
|
800111a: 637b str r3, [r7, #52] @ 0x34
|
|
}
|
|
|
|
/* Compute the prescaler value to have TIM6 counter clock equal to 1MHz */
|
|
uwPrescalerValue = (uint32_t) ((uwTimclock / 1000000U) - 1U);
|
|
800111c: 6b7b ldr r3, [r7, #52] @ 0x34
|
|
800111e: 4a23 ldr r2, [pc, #140] @ (80011ac <HAL_InitTick+0xe8>)
|
|
8001120: fba2 2303 umull r2, r3, r2, r3
|
|
8001124: 0c9b lsrs r3, r3, #18
|
|
8001126: 3b01 subs r3, #1
|
|
8001128: 62bb str r3, [r7, #40] @ 0x28
|
|
|
|
/* Initialize TIM6 */
|
|
htim6.Instance = TIM6;
|
|
800112a: 4b21 ldr r3, [pc, #132] @ (80011b0 <HAL_InitTick+0xec>)
|
|
800112c: 4a21 ldr r2, [pc, #132] @ (80011b4 <HAL_InitTick+0xf0>)
|
|
800112e: 601a str r2, [r3, #0]
|
|
* Period = [(TIM6CLK/1000) - 1]. to have a (1/1000) s time base.
|
|
* Prescaler = (uwTimclock/1000000 - 1) to have a 1MHz counter clock.
|
|
* ClockDivision = 0
|
|
* Counter direction = Up
|
|
*/
|
|
htim6.Init.Period = (1000000U / 1000U) - 1U;
|
|
8001130: 4b1f ldr r3, [pc, #124] @ (80011b0 <HAL_InitTick+0xec>)
|
|
8001132: f240 32e7 movw r2, #999 @ 0x3e7
|
|
8001136: 60da str r2, [r3, #12]
|
|
htim6.Init.Prescaler = uwPrescalerValue;
|
|
8001138: 4a1d ldr r2, [pc, #116] @ (80011b0 <HAL_InitTick+0xec>)
|
|
800113a: 6abb ldr r3, [r7, #40] @ 0x28
|
|
800113c: 6053 str r3, [r2, #4]
|
|
htim6.Init.ClockDivision = 0;
|
|
800113e: 4b1c ldr r3, [pc, #112] @ (80011b0 <HAL_InitTick+0xec>)
|
|
8001140: 2200 movs r2, #0
|
|
8001142: 611a str r2, [r3, #16]
|
|
htim6.Init.CounterMode = TIM_COUNTERMODE_UP;
|
|
8001144: 4b1a ldr r3, [pc, #104] @ (80011b0 <HAL_InitTick+0xec>)
|
|
8001146: 2200 movs r2, #0
|
|
8001148: 609a str r2, [r3, #8]
|
|
htim6.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
|
|
800114a: 4b19 ldr r3, [pc, #100] @ (80011b0 <HAL_InitTick+0xec>)
|
|
800114c: 2200 movs r2, #0
|
|
800114e: 619a str r2, [r3, #24]
|
|
|
|
status = HAL_TIM_Base_Init(&htim6);
|
|
8001150: 4817 ldr r0, [pc, #92] @ (80011b0 <HAL_InitTick+0xec>)
|
|
8001152: f003 ff53 bl 8004ffc <HAL_TIM_Base_Init>
|
|
8001156: 4603 mov r3, r0
|
|
8001158: f887 3033 strb.w r3, [r7, #51] @ 0x33
|
|
if (status == HAL_OK)
|
|
800115c: f897 3033 ldrb.w r3, [r7, #51] @ 0x33
|
|
8001160: 2b00 cmp r3, #0
|
|
8001162: d11b bne.n 800119c <HAL_InitTick+0xd8>
|
|
{
|
|
|
|
/* Start the TIM time Base generation in interrupt mode */
|
|
status = HAL_TIM_Base_Start_IT(&htim6);
|
|
8001164: 4812 ldr r0, [pc, #72] @ (80011b0 <HAL_InitTick+0xec>)
|
|
8001166: f004 f86f bl 8005248 <HAL_TIM_Base_Start_IT>
|
|
800116a: 4603 mov r3, r0
|
|
800116c: f887 3033 strb.w r3, [r7, #51] @ 0x33
|
|
if (status == HAL_OK)
|
|
8001170: f897 3033 ldrb.w r3, [r7, #51] @ 0x33
|
|
8001174: 2b00 cmp r3, #0
|
|
8001176: d111 bne.n 800119c <HAL_InitTick+0xd8>
|
|
{
|
|
/* Enable the TIM6 global Interrupt */
|
|
HAL_NVIC_EnableIRQ(TIM6_DAC_IRQn);
|
|
8001178: 2036 movs r0, #54 @ 0x36
|
|
800117a: f001 f88d bl 8002298 <HAL_NVIC_EnableIRQ>
|
|
/* Configure the SysTick IRQ priority */
|
|
if (TickPriority < (1UL << __NVIC_PRIO_BITS))
|
|
800117e: 687b ldr r3, [r7, #4]
|
|
8001180: 2b0f cmp r3, #15
|
|
8001182: d808 bhi.n 8001196 <HAL_InitTick+0xd2>
|
|
{
|
|
/* Configure the TIM IRQ priority */
|
|
HAL_NVIC_SetPriority(TIM6_DAC_IRQn, TickPriority, 0U);
|
|
8001184: 2200 movs r2, #0
|
|
8001186: 6879 ldr r1, [r7, #4]
|
|
8001188: 2036 movs r0, #54 @ 0x36
|
|
800118a: f001 f859 bl 8002240 <HAL_NVIC_SetPriority>
|
|
uwTickPrio = TickPriority;
|
|
800118e: 4a0a ldr r2, [pc, #40] @ (80011b8 <HAL_InitTick+0xf4>)
|
|
8001190: 687b ldr r3, [r7, #4]
|
|
8001192: 6013 str r3, [r2, #0]
|
|
8001194: e002 b.n 800119c <HAL_InitTick+0xd8>
|
|
}
|
|
else
|
|
{
|
|
status = HAL_ERROR;
|
|
8001196: 2301 movs r3, #1
|
|
8001198: f887 3033 strb.w r3, [r7, #51] @ 0x33
|
|
}
|
|
}
|
|
}
|
|
|
|
/* Return function status */
|
|
return status;
|
|
800119c: f897 3033 ldrb.w r3, [r7, #51] @ 0x33
|
|
}
|
|
80011a0: 4618 mov r0, r3
|
|
80011a2: 3738 adds r7, #56 @ 0x38
|
|
80011a4: 46bd mov sp, r7
|
|
80011a6: bd80 pop {r7, pc}
|
|
80011a8: 40023800 .word 0x40023800
|
|
80011ac: 431bde83 .word 0x431bde83
|
|
80011b0: 200002d4 .word 0x200002d4
|
|
80011b4: 40001000 .word 0x40001000
|
|
80011b8: 2000001c .word 0x2000001c
|
|
|
|
080011bc <NMI_Handler>:
|
|
/******************************************************************************/
|
|
/**
|
|
* @brief This function handles Non maskable interrupt.
|
|
*/
|
|
void NMI_Handler(void)
|
|
{
|
|
80011bc: b480 push {r7}
|
|
80011be: af00 add r7, sp, #0
|
|
/* USER CODE BEGIN NonMaskableInt_IRQn 0 */
|
|
|
|
/* USER CODE END NonMaskableInt_IRQn 0 */
|
|
/* USER CODE BEGIN NonMaskableInt_IRQn 1 */
|
|
while (1)
|
|
80011c0: bf00 nop
|
|
80011c2: e7fd b.n 80011c0 <NMI_Handler+0x4>
|
|
|
|
080011c4 <HardFault_Handler>:
|
|
|
|
/**
|
|
* @brief This function handles Hard fault interrupt.
|
|
*/
|
|
void HardFault_Handler(void)
|
|
{
|
|
80011c4: b480 push {r7}
|
|
80011c6: af00 add r7, sp, #0
|
|
/* USER CODE BEGIN HardFault_IRQn 0 */
|
|
|
|
/* USER CODE END HardFault_IRQn 0 */
|
|
while (1)
|
|
80011c8: bf00 nop
|
|
80011ca: e7fd b.n 80011c8 <HardFault_Handler+0x4>
|
|
|
|
080011cc <MemManage_Handler>:
|
|
|
|
/**
|
|
* @brief This function handles Memory management fault.
|
|
*/
|
|
void MemManage_Handler(void)
|
|
{
|
|
80011cc: b480 push {r7}
|
|
80011ce: af00 add r7, sp, #0
|
|
/* USER CODE BEGIN MemoryManagement_IRQn 0 */
|
|
|
|
/* USER CODE END MemoryManagement_IRQn 0 */
|
|
while (1)
|
|
80011d0: bf00 nop
|
|
80011d2: e7fd b.n 80011d0 <MemManage_Handler+0x4>
|
|
|
|
080011d4 <BusFault_Handler>:
|
|
|
|
/**
|
|
* @brief This function handles Pre-fetch fault, memory access fault.
|
|
*/
|
|
void BusFault_Handler(void)
|
|
{
|
|
80011d4: b480 push {r7}
|
|
80011d6: af00 add r7, sp, #0
|
|
/* USER CODE BEGIN BusFault_IRQn 0 */
|
|
|
|
/* USER CODE END BusFault_IRQn 0 */
|
|
while (1)
|
|
80011d8: bf00 nop
|
|
80011da: e7fd b.n 80011d8 <BusFault_Handler+0x4>
|
|
|
|
080011dc <UsageFault_Handler>:
|
|
|
|
/**
|
|
* @brief This function handles Undefined instruction or illegal state.
|
|
*/
|
|
void UsageFault_Handler(void)
|
|
{
|
|
80011dc: b480 push {r7}
|
|
80011de: af00 add r7, sp, #0
|
|
/* USER CODE BEGIN UsageFault_IRQn 0 */
|
|
|
|
/* USER CODE END UsageFault_IRQn 0 */
|
|
while (1)
|
|
80011e0: bf00 nop
|
|
80011e2: e7fd b.n 80011e0 <UsageFault_Handler+0x4>
|
|
|
|
080011e4 <DebugMon_Handler>:
|
|
|
|
/**
|
|
* @brief This function handles Debug monitor.
|
|
*/
|
|
void DebugMon_Handler(void)
|
|
{
|
|
80011e4: b480 push {r7}
|
|
80011e6: af00 add r7, sp, #0
|
|
|
|
/* USER CODE END DebugMonitor_IRQn 0 */
|
|
/* USER CODE BEGIN DebugMonitor_IRQn 1 */
|
|
|
|
/* USER CODE END DebugMonitor_IRQn 1 */
|
|
}
|
|
80011e8: bf00 nop
|
|
80011ea: 46bd mov sp, r7
|
|
80011ec: f85d 7b04 ldr.w r7, [sp], #4
|
|
80011f0: 4770 bx lr
|
|
...
|
|
|
|
080011f4 <SDIO_IRQHandler>:
|
|
|
|
/**
|
|
* @brief This function handles SDIO global interrupt.
|
|
*/
|
|
void SDIO_IRQHandler(void)
|
|
{
|
|
80011f4: b580 push {r7, lr}
|
|
80011f6: af00 add r7, sp, #0
|
|
/* USER CODE BEGIN SDIO_IRQn 0 */
|
|
|
|
/* USER CODE END SDIO_IRQn 0 */
|
|
HAL_SD_IRQHandler(&hsd);
|
|
80011f8: 4802 ldr r0, [pc, #8] @ (8001204 <SDIO_IRQHandler+0x10>)
|
|
80011fa: f002 fed9 bl 8003fb0 <HAL_SD_IRQHandler>
|
|
/* USER CODE BEGIN SDIO_IRQn 1 */
|
|
|
|
/* USER CODE END SDIO_IRQn 1 */
|
|
}
|
|
80011fe: bf00 nop
|
|
8001200: bd80 pop {r7, pc}
|
|
8001202: bf00 nop
|
|
8001204: 2000015c .word 0x2000015c
|
|
|
|
08001208 <TIM6_DAC_IRQHandler>:
|
|
|
|
/**
|
|
* @brief This function handles TIM6 global interrupt, DAC1 and DAC2 underrun error interrupts.
|
|
*/
|
|
void TIM6_DAC_IRQHandler(void)
|
|
{
|
|
8001208: b580 push {r7, lr}
|
|
800120a: af00 add r7, sp, #0
|
|
/* USER CODE BEGIN TIM6_DAC_IRQn 0 */
|
|
|
|
/* USER CODE END TIM6_DAC_IRQn 0 */
|
|
HAL_TIM_IRQHandler(&htim6);
|
|
800120c: 4802 ldr r0, [pc, #8] @ (8001218 <TIM6_DAC_IRQHandler+0x10>)
|
|
800120e: f004 f8e1 bl 80053d4 <HAL_TIM_IRQHandler>
|
|
/* USER CODE BEGIN TIM6_DAC_IRQn 1 */
|
|
|
|
/* USER CODE END TIM6_DAC_IRQn 1 */
|
|
}
|
|
8001212: bf00 nop
|
|
8001214: bd80 pop {r7, pc}
|
|
8001216: bf00 nop
|
|
8001218: 200002d4 .word 0x200002d4
|
|
|
|
0800121c <DMA2_Stream3_IRQHandler>:
|
|
|
|
/**
|
|
* @brief This function handles DMA2 stream3 global interrupt.
|
|
*/
|
|
void DMA2_Stream3_IRQHandler(void)
|
|
{
|
|
800121c: b580 push {r7, lr}
|
|
800121e: af00 add r7, sp, #0
|
|
/* USER CODE BEGIN DMA2_Stream3_IRQn 0 */
|
|
|
|
/* USER CODE END DMA2_Stream3_IRQn 0 */
|
|
HAL_DMA_IRQHandler(&hdma_sdio_rx);
|
|
8001220: 4802 ldr r0, [pc, #8] @ (800122c <DMA2_Stream3_IRQHandler+0x10>)
|
|
8001222: f001 fa8d bl 8002740 <HAL_DMA_IRQHandler>
|
|
/* USER CODE BEGIN DMA2_Stream3_IRQn 1 */
|
|
|
|
/* USER CODE END DMA2_Stream3_IRQn 1 */
|
|
}
|
|
8001226: bf00 nop
|
|
8001228: bd80 pop {r7, pc}
|
|
800122a: bf00 nop
|
|
800122c: 200001e0 .word 0x200001e0
|
|
|
|
08001230 <DMA2_Stream6_IRQHandler>:
|
|
|
|
/**
|
|
* @brief This function handles DMA2 stream6 global interrupt.
|
|
*/
|
|
void DMA2_Stream6_IRQHandler(void)
|
|
{
|
|
8001230: b580 push {r7, lr}
|
|
8001232: af00 add r7, sp, #0
|
|
/* USER CODE BEGIN DMA2_Stream6_IRQn 0 */
|
|
|
|
/* USER CODE END DMA2_Stream6_IRQn 0 */
|
|
HAL_DMA_IRQHandler(&hdma_sdio_tx);
|
|
8001234: 4802 ldr r0, [pc, #8] @ (8001240 <DMA2_Stream6_IRQHandler+0x10>)
|
|
8001236: f001 fa83 bl 8002740 <HAL_DMA_IRQHandler>
|
|
/* USER CODE BEGIN DMA2_Stream6_IRQn 1 */
|
|
|
|
/* USER CODE END DMA2_Stream6_IRQn 1 */
|
|
}
|
|
800123a: bf00 nop
|
|
800123c: bd80 pop {r7, pc}
|
|
800123e: bf00 nop
|
|
8001240: 20000240 .word 0x20000240
|
|
|
|
08001244 <SystemInit>:
|
|
* configuration.
|
|
* @param None
|
|
* @retval None
|
|
*/
|
|
void SystemInit(void)
|
|
{
|
|
8001244: b480 push {r7}
|
|
8001246: af00 add r7, sp, #0
|
|
/* FPU settings ------------------------------------------------------------*/
|
|
#if (__FPU_PRESENT == 1) && (__FPU_USED == 1)
|
|
SCB->CPACR |= ((3UL << 10*2)|(3UL << 11*2)); /* set CP10 and CP11 Full Access */
|
|
8001248: 4b06 ldr r3, [pc, #24] @ (8001264 <SystemInit+0x20>)
|
|
800124a: f8d3 3088 ldr.w r3, [r3, #136] @ 0x88
|
|
800124e: 4a05 ldr r2, [pc, #20] @ (8001264 <SystemInit+0x20>)
|
|
8001250: f443 0370 orr.w r3, r3, #15728640 @ 0xf00000
|
|
8001254: f8c2 3088 str.w r3, [r2, #136] @ 0x88
|
|
|
|
/* Configure the Vector Table location -------------------------------------*/
|
|
#if defined(USER_VECT_TAB_ADDRESS)
|
|
SCB->VTOR = VECT_TAB_BASE_ADDRESS | VECT_TAB_OFFSET; /* Vector Table Relocation in Internal SRAM */
|
|
#endif /* USER_VECT_TAB_ADDRESS */
|
|
}
|
|
8001258: bf00 nop
|
|
800125a: 46bd mov sp, r7
|
|
800125c: f85d 7b04 ldr.w r7, [sp], #4
|
|
8001260: 4770 bx lr
|
|
8001262: bf00 nop
|
|
8001264: e000ed00 .word 0xe000ed00
|
|
|
|
08001268 <Reset_Handler>:
|
|
|
|
.section .text.Reset_Handler
|
|
.weak Reset_Handler
|
|
.type Reset_Handler, %function
|
|
Reset_Handler:
|
|
ldr sp, =_estack /* set stack pointer */
|
|
8001268: f8df d034 ldr.w sp, [pc, #52] @ 80012a0 <LoopFillZerobss+0xe>
|
|
|
|
/* Call the clock system initialization function.*/
|
|
bl SystemInit
|
|
800126c: f7ff ffea bl 8001244 <SystemInit>
|
|
|
|
/* Copy the data segment initializers from flash to SRAM */
|
|
ldr r0, =_sdata
|
|
8001270: 480c ldr r0, [pc, #48] @ (80012a4 <LoopFillZerobss+0x12>)
|
|
ldr r1, =_edata
|
|
8001272: 490d ldr r1, [pc, #52] @ (80012a8 <LoopFillZerobss+0x16>)
|
|
ldr r2, =_sidata
|
|
8001274: 4a0d ldr r2, [pc, #52] @ (80012ac <LoopFillZerobss+0x1a>)
|
|
movs r3, #0
|
|
8001276: 2300 movs r3, #0
|
|
b LoopCopyDataInit
|
|
8001278: e002 b.n 8001280 <LoopCopyDataInit>
|
|
|
|
0800127a <CopyDataInit>:
|
|
|
|
CopyDataInit:
|
|
ldr r4, [r2, r3]
|
|
800127a: 58d4 ldr r4, [r2, r3]
|
|
str r4, [r0, r3]
|
|
800127c: 50c4 str r4, [r0, r3]
|
|
adds r3, r3, #4
|
|
800127e: 3304 adds r3, #4
|
|
|
|
08001280 <LoopCopyDataInit>:
|
|
|
|
LoopCopyDataInit:
|
|
adds r4, r0, r3
|
|
8001280: 18c4 adds r4, r0, r3
|
|
cmp r4, r1
|
|
8001282: 428c cmp r4, r1
|
|
bcc CopyDataInit
|
|
8001284: d3f9 bcc.n 800127a <CopyDataInit>
|
|
|
|
/* Zero fill the bss segment. */
|
|
ldr r2, =_sbss
|
|
8001286: 4a0a ldr r2, [pc, #40] @ (80012b0 <LoopFillZerobss+0x1e>)
|
|
ldr r4, =_ebss
|
|
8001288: 4c0a ldr r4, [pc, #40] @ (80012b4 <LoopFillZerobss+0x22>)
|
|
movs r3, #0
|
|
800128a: 2300 movs r3, #0
|
|
b LoopFillZerobss
|
|
800128c: e001 b.n 8001292 <LoopFillZerobss>
|
|
|
|
0800128e <FillZerobss>:
|
|
|
|
FillZerobss:
|
|
str r3, [r2]
|
|
800128e: 6013 str r3, [r2, #0]
|
|
adds r2, r2, #4
|
|
8001290: 3204 adds r2, #4
|
|
|
|
08001292 <LoopFillZerobss>:
|
|
|
|
LoopFillZerobss:
|
|
cmp r2, r4
|
|
8001292: 42a2 cmp r2, r4
|
|
bcc FillZerobss
|
|
8001294: d3fb bcc.n 800128e <FillZerobss>
|
|
|
|
/* Call static constructors */
|
|
bl __libc_init_array
|
|
8001296: f008 fe23 bl 8009ee0 <__libc_init_array>
|
|
/* Call the application's entry point.*/
|
|
bl main
|
|
800129a: f7ff fa33 bl 8000704 <main>
|
|
bx lr
|
|
800129e: 4770 bx lr
|
|
ldr sp, =_estack /* set stack pointer */
|
|
80012a0: 20020000 .word 0x20020000
|
|
ldr r0, =_sdata
|
|
80012a4: 20000000 .word 0x20000000
|
|
ldr r1, =_edata
|
|
80012a8: 20000078 .word 0x20000078
|
|
ldr r2, =_sidata
|
|
80012ac: 0800a2d0 .word 0x0800a2d0
|
|
ldr r2, =_sbss
|
|
80012b0: 20000078 .word 0x20000078
|
|
ldr r4, =_ebss
|
|
80012b4: 20004e50 .word 0x20004e50
|
|
|
|
080012b8 <ADC_IRQHandler>:
|
|
* @retval None
|
|
*/
|
|
.section .text.Default_Handler,"ax",%progbits
|
|
Default_Handler:
|
|
Infinite_Loop:
|
|
b Infinite_Loop
|
|
80012b8: e7fe b.n 80012b8 <ADC_IRQHandler>
|
|
|
|
080012ba <stm32_lock_acquire>:
|
|
/**
|
|
* @brief Acquire STM32 lock
|
|
* @param lock The lock to acquire
|
|
*/
|
|
static inline void stm32_lock_acquire(LockingData_t *lock)
|
|
{
|
|
80012ba: b580 push {r7, lr}
|
|
80012bc: b084 sub sp, #16
|
|
80012be: af00 add r7, sp, #0
|
|
80012c0: 6078 str r0, [r7, #4]
|
|
STM32_LOCK_BLOCK_IF_NULL_ARGUMENT(lock);
|
|
80012c2: 687b ldr r3, [r7, #4]
|
|
80012c4: 2b00 cmp r3, #0
|
|
80012c6: d105 bne.n 80012d4 <stm32_lock_acquire+0x1a>
|
|
__ASM volatile ("cpsid i" : : : "memory");
|
|
80012c8: b672 cpsid i
|
|
}
|
|
80012ca: bf00 nop
|
|
80012cc: f7ff fcf2 bl 8000cb4 <Error_Handler>
|
|
80012d0: bf00 nop
|
|
80012d2: e7fd b.n 80012d0 <stm32_lock_acquire+0x16>
|
|
STM32_LOCK_ASSERT_VALID_NESTING_LEVEL(lock);
|
|
80012d4: 687b ldr r3, [r7, #4]
|
|
80012d6: 7a1b ldrb r3, [r3, #8]
|
|
80012d8: 2b01 cmp r3, #1
|
|
80012da: d905 bls.n 80012e8 <stm32_lock_acquire+0x2e>
|
|
__ASM volatile ("cpsid i" : : : "memory");
|
|
80012dc: b672 cpsid i
|
|
}
|
|
80012de: bf00 nop
|
|
80012e0: f7ff fce8 bl 8000cb4 <Error_Handler>
|
|
80012e4: bf00 nop
|
|
80012e6: e7fd b.n 80012e4 <stm32_lock_acquire+0x2a>
|
|
lock->basepri[lock->nesting_level++] = taskENTER_CRITICAL_FROM_ISR();
|
|
80012e8: 687b ldr r3, [r7, #4]
|
|
80012ea: 7a1b ldrb r3, [r3, #8]
|
|
80012ec: 1c5a adds r2, r3, #1
|
|
80012ee: b2d1 uxtb r1, r2
|
|
80012f0: 687a ldr r2, [r7, #4]
|
|
80012f2: 7211 strb r1, [r2, #8]
|
|
80012f4: 4619 mov r1, r3
|
|
|
|
portFORCE_INLINE static uint32_t ulPortRaiseBASEPRI( void )
|
|
{
|
|
uint32_t ulOriginalBASEPRI, ulNewBASEPRI;
|
|
|
|
__asm volatile
|
|
80012f6: f3ef 8211 mrs r2, BASEPRI
|
|
80012fa: f04f 0350 mov.w r3, #80 @ 0x50
|
|
80012fe: f383 8811 msr BASEPRI, r3
|
|
8001302: f3bf 8f6f isb sy
|
|
8001306: f3bf 8f4f dsb sy
|
|
800130a: 60fa str r2, [r7, #12]
|
|
800130c: 60bb str r3, [r7, #8]
|
|
:"=r" (ulOriginalBASEPRI), "=r" (ulNewBASEPRI) : "i" ( configMAX_SYSCALL_INTERRUPT_PRIORITY ) : "memory"
|
|
);
|
|
|
|
/* This return will not be reached but is necessary to prevent compiler
|
|
warnings. */
|
|
return ulOriginalBASEPRI;
|
|
800130e: 68fa ldr r2, [r7, #12]
|
|
8001310: 687b ldr r3, [r7, #4]
|
|
8001312: f843 2021 str.w r2, [r3, r1, lsl #2]
|
|
}
|
|
8001316: bf00 nop
|
|
8001318: 3710 adds r7, #16
|
|
800131a: 46bd mov sp, r7
|
|
800131c: bd80 pop {r7, pc}
|
|
|
|
0800131e <stm32_lock_release>:
|
|
/**
|
|
* @brief Release STM32 lock
|
|
* @param lock The lock to release
|
|
*/
|
|
static inline void stm32_lock_release(LockingData_t *lock)
|
|
{
|
|
800131e: b580 push {r7, lr}
|
|
8001320: b084 sub sp, #16
|
|
8001322: af00 add r7, sp, #0
|
|
8001324: 6078 str r0, [r7, #4]
|
|
STM32_LOCK_BLOCK_IF_NULL_ARGUMENT(lock);
|
|
8001326: 687b ldr r3, [r7, #4]
|
|
8001328: 2b00 cmp r3, #0
|
|
800132a: d105 bne.n 8001338 <stm32_lock_release+0x1a>
|
|
__ASM volatile ("cpsid i" : : : "memory");
|
|
800132c: b672 cpsid i
|
|
}
|
|
800132e: bf00 nop
|
|
8001330: f7ff fcc0 bl 8000cb4 <Error_Handler>
|
|
8001334: bf00 nop
|
|
8001336: e7fd b.n 8001334 <stm32_lock_release+0x16>
|
|
lock->nesting_level--;
|
|
8001338: 687b ldr r3, [r7, #4]
|
|
800133a: 7a1b ldrb r3, [r3, #8]
|
|
800133c: 3b01 subs r3, #1
|
|
800133e: b2da uxtb r2, r3
|
|
8001340: 687b ldr r3, [r7, #4]
|
|
8001342: 721a strb r2, [r3, #8]
|
|
STM32_LOCK_ASSERT_VALID_NESTING_LEVEL(lock);
|
|
8001344: 687b ldr r3, [r7, #4]
|
|
8001346: 7a1b ldrb r3, [r3, #8]
|
|
8001348: 2b01 cmp r3, #1
|
|
800134a: d905 bls.n 8001358 <stm32_lock_release+0x3a>
|
|
__ASM volatile ("cpsid i" : : : "memory");
|
|
800134c: b672 cpsid i
|
|
}
|
|
800134e: bf00 nop
|
|
8001350: f7ff fcb0 bl 8000cb4 <Error_Handler>
|
|
8001354: bf00 nop
|
|
8001356: e7fd b.n 8001354 <stm32_lock_release+0x36>
|
|
taskEXIT_CRITICAL_FROM_ISR(lock->basepri[lock->nesting_level]);
|
|
8001358: 687b ldr r3, [r7, #4]
|
|
800135a: 7a1b ldrb r3, [r3, #8]
|
|
800135c: 461a mov r2, r3
|
|
800135e: 687b ldr r3, [r7, #4]
|
|
8001360: f853 3022 ldr.w r3, [r3, r2, lsl #2]
|
|
8001364: 60fb str r3, [r7, #12]
|
|
}
|
|
/*-----------------------------------------------------------*/
|
|
|
|
portFORCE_INLINE static void vPortSetBASEPRI( uint32_t ulNewMaskValue )
|
|
{
|
|
__asm volatile
|
|
8001366: 68fb ldr r3, [r7, #12]
|
|
8001368: f383 8811 msr BASEPRI, r3
|
|
(
|
|
" msr basepri, %0 " :: "r" ( ulNewMaskValue ) : "memory"
|
|
);
|
|
}
|
|
800136c: bf00 nop
|
|
}
|
|
800136e: bf00 nop
|
|
8001370: 3710 adds r7, #16
|
|
8001372: 46bd mov sp, r7
|
|
8001374: bd80 pop {r7, pc}
|
|
|
|
08001376 <__retarget_lock_acquire_recursive>:
|
|
/**
|
|
* @brief Acquire recursive lock
|
|
* @param lock The lock
|
|
*/
|
|
void __retarget_lock_acquire_recursive(_LOCK_T lock)
|
|
{
|
|
8001376: b580 push {r7, lr}
|
|
8001378: b082 sub sp, #8
|
|
800137a: af00 add r7, sp, #0
|
|
800137c: 6078 str r0, [r7, #4]
|
|
STM32_LOCK_BLOCK_IF_NULL_ARGUMENT(lock);
|
|
800137e: 687b ldr r3, [r7, #4]
|
|
8001380: 2b00 cmp r3, #0
|
|
8001382: d105 bne.n 8001390 <__retarget_lock_acquire_recursive+0x1a>
|
|
__ASM volatile ("cpsid i" : : : "memory");
|
|
8001384: b672 cpsid i
|
|
}
|
|
8001386: bf00 nop
|
|
8001388: f7ff fc94 bl 8000cb4 <Error_Handler>
|
|
800138c: bf00 nop
|
|
800138e: e7fd b.n 800138c <__retarget_lock_acquire_recursive+0x16>
|
|
stm32_lock_acquire(STM32_LOCK_PARAMETER(lock));
|
|
8001390: 687b ldr r3, [r7, #4]
|
|
8001392: 4618 mov r0, r3
|
|
8001394: f7ff ff91 bl 80012ba <stm32_lock_acquire>
|
|
}
|
|
8001398: bf00 nop
|
|
800139a: 3708 adds r7, #8
|
|
800139c: 46bd mov sp, r7
|
|
800139e: bd80 pop {r7, pc}
|
|
|
|
080013a0 <__retarget_lock_release_recursive>:
|
|
/**
|
|
* @brief Release recursive lock
|
|
* @param lock The lock
|
|
*/
|
|
void __retarget_lock_release_recursive(_LOCK_T lock)
|
|
{
|
|
80013a0: b580 push {r7, lr}
|
|
80013a2: b082 sub sp, #8
|
|
80013a4: af00 add r7, sp, #0
|
|
80013a6: 6078 str r0, [r7, #4]
|
|
STM32_LOCK_BLOCK_IF_NULL_ARGUMENT(lock);
|
|
80013a8: 687b ldr r3, [r7, #4]
|
|
80013aa: 2b00 cmp r3, #0
|
|
80013ac: d105 bne.n 80013ba <__retarget_lock_release_recursive+0x1a>
|
|
__ASM volatile ("cpsid i" : : : "memory");
|
|
80013ae: b672 cpsid i
|
|
}
|
|
80013b0: bf00 nop
|
|
80013b2: f7ff fc7f bl 8000cb4 <Error_Handler>
|
|
80013b6: bf00 nop
|
|
80013b8: e7fd b.n 80013b6 <__retarget_lock_release_recursive+0x16>
|
|
stm32_lock_release(STM32_LOCK_PARAMETER(lock));
|
|
80013ba: 687b ldr r3, [r7, #4]
|
|
80013bc: 4618 mov r0, r3
|
|
80013be: f7ff ffae bl 800131e <stm32_lock_release>
|
|
}
|
|
80013c2: bf00 nop
|
|
80013c4: 3708 adds r7, #8
|
|
80013c6: 46bd mov sp, r7
|
|
80013c8: bd80 pop {r7, pc}
|
|
...
|
|
|
|
080013cc <HAL_Init>:
|
|
* need to ensure that the SysTick time base is always set to 1 millisecond
|
|
* to have correct HAL operation.
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_Init(void)
|
|
{
|
|
80013cc: b580 push {r7, lr}
|
|
80013ce: af00 add r7, sp, #0
|
|
/* Configure Flash prefetch, Instruction cache, Data cache */
|
|
#if (INSTRUCTION_CACHE_ENABLE != 0U)
|
|
__HAL_FLASH_INSTRUCTION_CACHE_ENABLE();
|
|
80013d0: 4b0e ldr r3, [pc, #56] @ (800140c <HAL_Init+0x40>)
|
|
80013d2: 681b ldr r3, [r3, #0]
|
|
80013d4: 4a0d ldr r2, [pc, #52] @ (800140c <HAL_Init+0x40>)
|
|
80013d6: f443 7300 orr.w r3, r3, #512 @ 0x200
|
|
80013da: 6013 str r3, [r2, #0]
|
|
#endif /* INSTRUCTION_CACHE_ENABLE */
|
|
|
|
#if (DATA_CACHE_ENABLE != 0U)
|
|
__HAL_FLASH_DATA_CACHE_ENABLE();
|
|
80013dc: 4b0b ldr r3, [pc, #44] @ (800140c <HAL_Init+0x40>)
|
|
80013de: 681b ldr r3, [r3, #0]
|
|
80013e0: 4a0a ldr r2, [pc, #40] @ (800140c <HAL_Init+0x40>)
|
|
80013e2: f443 6380 orr.w r3, r3, #1024 @ 0x400
|
|
80013e6: 6013 str r3, [r2, #0]
|
|
#endif /* DATA_CACHE_ENABLE */
|
|
|
|
#if (PREFETCH_ENABLE != 0U)
|
|
__HAL_FLASH_PREFETCH_BUFFER_ENABLE();
|
|
80013e8: 4b08 ldr r3, [pc, #32] @ (800140c <HAL_Init+0x40>)
|
|
80013ea: 681b ldr r3, [r3, #0]
|
|
80013ec: 4a07 ldr r2, [pc, #28] @ (800140c <HAL_Init+0x40>)
|
|
80013ee: f443 7380 orr.w r3, r3, #256 @ 0x100
|
|
80013f2: 6013 str r3, [r2, #0]
|
|
#endif /* PREFETCH_ENABLE */
|
|
|
|
/* Set Interrupt Group Priority */
|
|
HAL_NVIC_SetPriorityGrouping(NVIC_PRIORITYGROUP_4);
|
|
80013f4: 2003 movs r0, #3
|
|
80013f6: f000 ff03 bl 8002200 <HAL_NVIC_SetPriorityGrouping>
|
|
|
|
/* Use systick as time base source and configure 1ms tick (default clock after Reset is HSI) */
|
|
HAL_InitTick(TICK_INT_PRIORITY);
|
|
80013fa: 200f movs r0, #15
|
|
80013fc: f7ff fe62 bl 80010c4 <HAL_InitTick>
|
|
|
|
/* Init the low level hardware */
|
|
HAL_MspInit();
|
|
8001400: f7ff fca4 bl 8000d4c <HAL_MspInit>
|
|
|
|
/* Return function status */
|
|
return HAL_OK;
|
|
8001404: 2300 movs r3, #0
|
|
}
|
|
8001406: 4618 mov r0, r3
|
|
8001408: bd80 pop {r7, pc}
|
|
800140a: bf00 nop
|
|
800140c: 40023c00 .word 0x40023c00
|
|
|
|
08001410 <HAL_IncTick>:
|
|
* @note This function is declared as __weak to be overwritten in case of other
|
|
* implementations in user file.
|
|
* @retval None
|
|
*/
|
|
__weak void HAL_IncTick(void)
|
|
{
|
|
8001410: b480 push {r7}
|
|
8001412: af00 add r7, sp, #0
|
|
uwTick += uwTickFreq;
|
|
8001414: 4b06 ldr r3, [pc, #24] @ (8001430 <HAL_IncTick+0x20>)
|
|
8001416: 781b ldrb r3, [r3, #0]
|
|
8001418: 461a mov r2, r3
|
|
800141a: 4b06 ldr r3, [pc, #24] @ (8001434 <HAL_IncTick+0x24>)
|
|
800141c: 681b ldr r3, [r3, #0]
|
|
800141e: 4413 add r3, r2
|
|
8001420: 4a04 ldr r2, [pc, #16] @ (8001434 <HAL_IncTick+0x24>)
|
|
8001422: 6013 str r3, [r2, #0]
|
|
}
|
|
8001424: bf00 nop
|
|
8001426: 46bd mov sp, r7
|
|
8001428: f85d 7b04 ldr.w r7, [sp], #4
|
|
800142c: 4770 bx lr
|
|
800142e: bf00 nop
|
|
8001430: 20000020 .word 0x20000020
|
|
8001434: 20000328 .word 0x20000328
|
|
|
|
08001438 <HAL_GetTick>:
|
|
* @note This function is declared as __weak to be overwritten in case of other
|
|
* implementations in user file.
|
|
* @retval tick value
|
|
*/
|
|
__weak uint32_t HAL_GetTick(void)
|
|
{
|
|
8001438: b480 push {r7}
|
|
800143a: af00 add r7, sp, #0
|
|
return uwTick;
|
|
800143c: 4b03 ldr r3, [pc, #12] @ (800144c <HAL_GetTick+0x14>)
|
|
800143e: 681b ldr r3, [r3, #0]
|
|
}
|
|
8001440: 4618 mov r0, r3
|
|
8001442: 46bd mov sp, r7
|
|
8001444: f85d 7b04 ldr.w r7, [sp], #4
|
|
8001448: 4770 bx lr
|
|
800144a: bf00 nop
|
|
800144c: 20000328 .word 0x20000328
|
|
|
|
08001450 <HAL_Delay>:
|
|
* implementations in user file.
|
|
* @param Delay specifies the delay time length, in milliseconds.
|
|
* @retval None
|
|
*/
|
|
__weak void HAL_Delay(uint32_t Delay)
|
|
{
|
|
8001450: b580 push {r7, lr}
|
|
8001452: b084 sub sp, #16
|
|
8001454: af00 add r7, sp, #0
|
|
8001456: 6078 str r0, [r7, #4]
|
|
uint32_t tickstart = HAL_GetTick();
|
|
8001458: f7ff ffee bl 8001438 <HAL_GetTick>
|
|
800145c: 60b8 str r0, [r7, #8]
|
|
uint32_t wait = Delay;
|
|
800145e: 687b ldr r3, [r7, #4]
|
|
8001460: 60fb str r3, [r7, #12]
|
|
|
|
/* Add a freq to guarantee minimum wait */
|
|
if (wait < HAL_MAX_DELAY)
|
|
8001462: 68fb ldr r3, [r7, #12]
|
|
8001464: f1b3 3fff cmp.w r3, #4294967295 @ 0xffffffff
|
|
8001468: d005 beq.n 8001476 <HAL_Delay+0x26>
|
|
{
|
|
wait += (uint32_t)(uwTickFreq);
|
|
800146a: 4b0a ldr r3, [pc, #40] @ (8001494 <HAL_Delay+0x44>)
|
|
800146c: 781b ldrb r3, [r3, #0]
|
|
800146e: 461a mov r2, r3
|
|
8001470: 68fb ldr r3, [r7, #12]
|
|
8001472: 4413 add r3, r2
|
|
8001474: 60fb str r3, [r7, #12]
|
|
}
|
|
|
|
while((HAL_GetTick() - tickstart) < wait)
|
|
8001476: bf00 nop
|
|
8001478: f7ff ffde bl 8001438 <HAL_GetTick>
|
|
800147c: 4602 mov r2, r0
|
|
800147e: 68bb ldr r3, [r7, #8]
|
|
8001480: 1ad3 subs r3, r2, r3
|
|
8001482: 68fa ldr r2, [r7, #12]
|
|
8001484: 429a cmp r2, r3
|
|
8001486: d8f7 bhi.n 8001478 <HAL_Delay+0x28>
|
|
{
|
|
}
|
|
}
|
|
8001488: bf00 nop
|
|
800148a: bf00 nop
|
|
800148c: 3710 adds r7, #16
|
|
800148e: 46bd mov sp, r7
|
|
8001490: bd80 pop {r7, pc}
|
|
8001492: bf00 nop
|
|
8001494: 20000020 .word 0x20000020
|
|
|
|
08001498 <HAL_CAN_Init>:
|
|
* @param hcan pointer to a CAN_HandleTypeDef structure that contains
|
|
* the configuration information for the specified CAN.
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_CAN_Init(CAN_HandleTypeDef *hcan)
|
|
{
|
|
8001498: b580 push {r7, lr}
|
|
800149a: b084 sub sp, #16
|
|
800149c: af00 add r7, sp, #0
|
|
800149e: 6078 str r0, [r7, #4]
|
|
uint32_t tickstart;
|
|
|
|
/* Check CAN handle */
|
|
if (hcan == NULL)
|
|
80014a0: 687b ldr r3, [r7, #4]
|
|
80014a2: 2b00 cmp r3, #0
|
|
80014a4: d101 bne.n 80014aa <HAL_CAN_Init+0x12>
|
|
{
|
|
return HAL_ERROR;
|
|
80014a6: 2301 movs r3, #1
|
|
80014a8: e243 b.n 8001932 <HAL_CAN_Init+0x49a>
|
|
}
|
|
|
|
/* Check the parameters */
|
|
assert_param(IS_CAN_ALL_INSTANCE(hcan->Instance));
|
|
80014aa: 687b ldr r3, [r7, #4]
|
|
80014ac: 681b ldr r3, [r3, #0]
|
|
80014ae: 4a93 ldr r2, [pc, #588] @ (80016fc <HAL_CAN_Init+0x264>)
|
|
80014b0: 4293 cmp r3, r2
|
|
80014b2: d009 beq.n 80014c8 <HAL_CAN_Init+0x30>
|
|
80014b4: 687b ldr r3, [r7, #4]
|
|
80014b6: 681b ldr r3, [r3, #0]
|
|
80014b8: 4a91 ldr r2, [pc, #580] @ (8001700 <HAL_CAN_Init+0x268>)
|
|
80014ba: 4293 cmp r3, r2
|
|
80014bc: d004 beq.n 80014c8 <HAL_CAN_Init+0x30>
|
|
80014be: f44f 718f mov.w r1, #286 @ 0x11e
|
|
80014c2: 4890 ldr r0, [pc, #576] @ (8001704 <HAL_CAN_Init+0x26c>)
|
|
80014c4: f7ff fc36 bl 8000d34 <assert_failed>
|
|
assert_param(IS_FUNCTIONAL_STATE(hcan->Init.TimeTriggeredMode));
|
|
80014c8: 687b ldr r3, [r7, #4]
|
|
80014ca: 7e1b ldrb r3, [r3, #24]
|
|
80014cc: 2b00 cmp r3, #0
|
|
80014ce: d008 beq.n 80014e2 <HAL_CAN_Init+0x4a>
|
|
80014d0: 687b ldr r3, [r7, #4]
|
|
80014d2: 7e1b ldrb r3, [r3, #24]
|
|
80014d4: 2b01 cmp r3, #1
|
|
80014d6: d004 beq.n 80014e2 <HAL_CAN_Init+0x4a>
|
|
80014d8: f240 111f movw r1, #287 @ 0x11f
|
|
80014dc: 4889 ldr r0, [pc, #548] @ (8001704 <HAL_CAN_Init+0x26c>)
|
|
80014de: f7ff fc29 bl 8000d34 <assert_failed>
|
|
assert_param(IS_FUNCTIONAL_STATE(hcan->Init.AutoBusOff));
|
|
80014e2: 687b ldr r3, [r7, #4]
|
|
80014e4: 7e5b ldrb r3, [r3, #25]
|
|
80014e6: 2b00 cmp r3, #0
|
|
80014e8: d008 beq.n 80014fc <HAL_CAN_Init+0x64>
|
|
80014ea: 687b ldr r3, [r7, #4]
|
|
80014ec: 7e5b ldrb r3, [r3, #25]
|
|
80014ee: 2b01 cmp r3, #1
|
|
80014f0: d004 beq.n 80014fc <HAL_CAN_Init+0x64>
|
|
80014f2: f44f 7190 mov.w r1, #288 @ 0x120
|
|
80014f6: 4883 ldr r0, [pc, #524] @ (8001704 <HAL_CAN_Init+0x26c>)
|
|
80014f8: f7ff fc1c bl 8000d34 <assert_failed>
|
|
assert_param(IS_FUNCTIONAL_STATE(hcan->Init.AutoWakeUp));
|
|
80014fc: 687b ldr r3, [r7, #4]
|
|
80014fe: 7e9b ldrb r3, [r3, #26]
|
|
8001500: 2b00 cmp r3, #0
|
|
8001502: d008 beq.n 8001516 <HAL_CAN_Init+0x7e>
|
|
8001504: 687b ldr r3, [r7, #4]
|
|
8001506: 7e9b ldrb r3, [r3, #26]
|
|
8001508: 2b01 cmp r3, #1
|
|
800150a: d004 beq.n 8001516 <HAL_CAN_Init+0x7e>
|
|
800150c: f240 1121 movw r1, #289 @ 0x121
|
|
8001510: 487c ldr r0, [pc, #496] @ (8001704 <HAL_CAN_Init+0x26c>)
|
|
8001512: f7ff fc0f bl 8000d34 <assert_failed>
|
|
assert_param(IS_FUNCTIONAL_STATE(hcan->Init.AutoRetransmission));
|
|
8001516: 687b ldr r3, [r7, #4]
|
|
8001518: 7edb ldrb r3, [r3, #27]
|
|
800151a: 2b00 cmp r3, #0
|
|
800151c: d008 beq.n 8001530 <HAL_CAN_Init+0x98>
|
|
800151e: 687b ldr r3, [r7, #4]
|
|
8001520: 7edb ldrb r3, [r3, #27]
|
|
8001522: 2b01 cmp r3, #1
|
|
8001524: d004 beq.n 8001530 <HAL_CAN_Init+0x98>
|
|
8001526: f44f 7191 mov.w r1, #290 @ 0x122
|
|
800152a: 4876 ldr r0, [pc, #472] @ (8001704 <HAL_CAN_Init+0x26c>)
|
|
800152c: f7ff fc02 bl 8000d34 <assert_failed>
|
|
assert_param(IS_FUNCTIONAL_STATE(hcan->Init.ReceiveFifoLocked));
|
|
8001530: 687b ldr r3, [r7, #4]
|
|
8001532: 7f1b ldrb r3, [r3, #28]
|
|
8001534: 2b00 cmp r3, #0
|
|
8001536: d008 beq.n 800154a <HAL_CAN_Init+0xb2>
|
|
8001538: 687b ldr r3, [r7, #4]
|
|
800153a: 7f1b ldrb r3, [r3, #28]
|
|
800153c: 2b01 cmp r3, #1
|
|
800153e: d004 beq.n 800154a <HAL_CAN_Init+0xb2>
|
|
8001540: f240 1123 movw r1, #291 @ 0x123
|
|
8001544: 486f ldr r0, [pc, #444] @ (8001704 <HAL_CAN_Init+0x26c>)
|
|
8001546: f7ff fbf5 bl 8000d34 <assert_failed>
|
|
assert_param(IS_FUNCTIONAL_STATE(hcan->Init.TransmitFifoPriority));
|
|
800154a: 687b ldr r3, [r7, #4]
|
|
800154c: 7f5b ldrb r3, [r3, #29]
|
|
800154e: 2b00 cmp r3, #0
|
|
8001550: d008 beq.n 8001564 <HAL_CAN_Init+0xcc>
|
|
8001552: 687b ldr r3, [r7, #4]
|
|
8001554: 7f5b ldrb r3, [r3, #29]
|
|
8001556: 2b01 cmp r3, #1
|
|
8001558: d004 beq.n 8001564 <HAL_CAN_Init+0xcc>
|
|
800155a: f44f 7192 mov.w r1, #292 @ 0x124
|
|
800155e: 4869 ldr r0, [pc, #420] @ (8001704 <HAL_CAN_Init+0x26c>)
|
|
8001560: f7ff fbe8 bl 8000d34 <assert_failed>
|
|
assert_param(IS_CAN_MODE(hcan->Init.Mode));
|
|
8001564: 687b ldr r3, [r7, #4]
|
|
8001566: 689b ldr r3, [r3, #8]
|
|
8001568: 2b00 cmp r3, #0
|
|
800156a: d013 beq.n 8001594 <HAL_CAN_Init+0xfc>
|
|
800156c: 687b ldr r3, [r7, #4]
|
|
800156e: 689b ldr r3, [r3, #8]
|
|
8001570: f1b3 4f80 cmp.w r3, #1073741824 @ 0x40000000
|
|
8001574: d00e beq.n 8001594 <HAL_CAN_Init+0xfc>
|
|
8001576: 687b ldr r3, [r7, #4]
|
|
8001578: 689b ldr r3, [r3, #8]
|
|
800157a: f1b3 4f00 cmp.w r3, #2147483648 @ 0x80000000
|
|
800157e: d009 beq.n 8001594 <HAL_CAN_Init+0xfc>
|
|
8001580: 687b ldr r3, [r7, #4]
|
|
8001582: 689b ldr r3, [r3, #8]
|
|
8001584: f1b3 4f40 cmp.w r3, #3221225472 @ 0xc0000000
|
|
8001588: d004 beq.n 8001594 <HAL_CAN_Init+0xfc>
|
|
800158a: f240 1125 movw r1, #293 @ 0x125
|
|
800158e: 485d ldr r0, [pc, #372] @ (8001704 <HAL_CAN_Init+0x26c>)
|
|
8001590: f7ff fbd0 bl 8000d34 <assert_failed>
|
|
assert_param(IS_CAN_SJW(hcan->Init.SyncJumpWidth));
|
|
8001594: 687b ldr r3, [r7, #4]
|
|
8001596: 68db ldr r3, [r3, #12]
|
|
8001598: 2b00 cmp r3, #0
|
|
800159a: d013 beq.n 80015c4 <HAL_CAN_Init+0x12c>
|
|
800159c: 687b ldr r3, [r7, #4]
|
|
800159e: 68db ldr r3, [r3, #12]
|
|
80015a0: f1b3 7f80 cmp.w r3, #16777216 @ 0x1000000
|
|
80015a4: d00e beq.n 80015c4 <HAL_CAN_Init+0x12c>
|
|
80015a6: 687b ldr r3, [r7, #4]
|
|
80015a8: 68db ldr r3, [r3, #12]
|
|
80015aa: f1b3 7f00 cmp.w r3, #33554432 @ 0x2000000
|
|
80015ae: d009 beq.n 80015c4 <HAL_CAN_Init+0x12c>
|
|
80015b0: 687b ldr r3, [r7, #4]
|
|
80015b2: 68db ldr r3, [r3, #12]
|
|
80015b4: f1b3 7f40 cmp.w r3, #50331648 @ 0x3000000
|
|
80015b8: d004 beq.n 80015c4 <HAL_CAN_Init+0x12c>
|
|
80015ba: f44f 7193 mov.w r1, #294 @ 0x126
|
|
80015be: 4851 ldr r0, [pc, #324] @ (8001704 <HAL_CAN_Init+0x26c>)
|
|
80015c0: f7ff fbb8 bl 8000d34 <assert_failed>
|
|
assert_param(IS_CAN_BS1(hcan->Init.TimeSeg1));
|
|
80015c4: 687b ldr r3, [r7, #4]
|
|
80015c6: 691b ldr r3, [r3, #16]
|
|
80015c8: 2b00 cmp r3, #0
|
|
80015ca: d04f beq.n 800166c <HAL_CAN_Init+0x1d4>
|
|
80015cc: 687b ldr r3, [r7, #4]
|
|
80015ce: 691b ldr r3, [r3, #16]
|
|
80015d0: f5b3 3f80 cmp.w r3, #65536 @ 0x10000
|
|
80015d4: d04a beq.n 800166c <HAL_CAN_Init+0x1d4>
|
|
80015d6: 687b ldr r3, [r7, #4]
|
|
80015d8: 691b ldr r3, [r3, #16]
|
|
80015da: f5b3 3f00 cmp.w r3, #131072 @ 0x20000
|
|
80015de: d045 beq.n 800166c <HAL_CAN_Init+0x1d4>
|
|
80015e0: 687b ldr r3, [r7, #4]
|
|
80015e2: 691b ldr r3, [r3, #16]
|
|
80015e4: f5b3 3f40 cmp.w r3, #196608 @ 0x30000
|
|
80015e8: d040 beq.n 800166c <HAL_CAN_Init+0x1d4>
|
|
80015ea: 687b ldr r3, [r7, #4]
|
|
80015ec: 691b ldr r3, [r3, #16]
|
|
80015ee: f5b3 2f80 cmp.w r3, #262144 @ 0x40000
|
|
80015f2: d03b beq.n 800166c <HAL_CAN_Init+0x1d4>
|
|
80015f4: 687b ldr r3, [r7, #4]
|
|
80015f6: 691b ldr r3, [r3, #16]
|
|
80015f8: f5b3 2fa0 cmp.w r3, #327680 @ 0x50000
|
|
80015fc: d036 beq.n 800166c <HAL_CAN_Init+0x1d4>
|
|
80015fe: 687b ldr r3, [r7, #4]
|
|
8001600: 691b ldr r3, [r3, #16]
|
|
8001602: f5b3 2fc0 cmp.w r3, #393216 @ 0x60000
|
|
8001606: d031 beq.n 800166c <HAL_CAN_Init+0x1d4>
|
|
8001608: 687b ldr r3, [r7, #4]
|
|
800160a: 691b ldr r3, [r3, #16]
|
|
800160c: f5b3 2fe0 cmp.w r3, #458752 @ 0x70000
|
|
8001610: d02c beq.n 800166c <HAL_CAN_Init+0x1d4>
|
|
8001612: 687b ldr r3, [r7, #4]
|
|
8001614: 691b ldr r3, [r3, #16]
|
|
8001616: f5b3 2f00 cmp.w r3, #524288 @ 0x80000
|
|
800161a: d027 beq.n 800166c <HAL_CAN_Init+0x1d4>
|
|
800161c: 687b ldr r3, [r7, #4]
|
|
800161e: 691b ldr r3, [r3, #16]
|
|
8001620: f5b3 2f10 cmp.w r3, #589824 @ 0x90000
|
|
8001624: d022 beq.n 800166c <HAL_CAN_Init+0x1d4>
|
|
8001626: 687b ldr r3, [r7, #4]
|
|
8001628: 691b ldr r3, [r3, #16]
|
|
800162a: f5b3 2f20 cmp.w r3, #655360 @ 0xa0000
|
|
800162e: d01d beq.n 800166c <HAL_CAN_Init+0x1d4>
|
|
8001630: 687b ldr r3, [r7, #4]
|
|
8001632: 691b ldr r3, [r3, #16]
|
|
8001634: f5b3 2f30 cmp.w r3, #720896 @ 0xb0000
|
|
8001638: d018 beq.n 800166c <HAL_CAN_Init+0x1d4>
|
|
800163a: 687b ldr r3, [r7, #4]
|
|
800163c: 691b ldr r3, [r3, #16]
|
|
800163e: f5b3 2f40 cmp.w r3, #786432 @ 0xc0000
|
|
8001642: d013 beq.n 800166c <HAL_CAN_Init+0x1d4>
|
|
8001644: 687b ldr r3, [r7, #4]
|
|
8001646: 691b ldr r3, [r3, #16]
|
|
8001648: f5b3 2f50 cmp.w r3, #851968 @ 0xd0000
|
|
800164c: d00e beq.n 800166c <HAL_CAN_Init+0x1d4>
|
|
800164e: 687b ldr r3, [r7, #4]
|
|
8001650: 691b ldr r3, [r3, #16]
|
|
8001652: f5b3 2f60 cmp.w r3, #917504 @ 0xe0000
|
|
8001656: d009 beq.n 800166c <HAL_CAN_Init+0x1d4>
|
|
8001658: 687b ldr r3, [r7, #4]
|
|
800165a: 691b ldr r3, [r3, #16]
|
|
800165c: f5b3 2f70 cmp.w r3, #983040 @ 0xf0000
|
|
8001660: d004 beq.n 800166c <HAL_CAN_Init+0x1d4>
|
|
8001662: f240 1127 movw r1, #295 @ 0x127
|
|
8001666: 4827 ldr r0, [pc, #156] @ (8001704 <HAL_CAN_Init+0x26c>)
|
|
8001668: f7ff fb64 bl 8000d34 <assert_failed>
|
|
assert_param(IS_CAN_BS2(hcan->Init.TimeSeg2));
|
|
800166c: 687b ldr r3, [r7, #4]
|
|
800166e: 695b ldr r3, [r3, #20]
|
|
8001670: 2b00 cmp r3, #0
|
|
8001672: d027 beq.n 80016c4 <HAL_CAN_Init+0x22c>
|
|
8001674: 687b ldr r3, [r7, #4]
|
|
8001676: 695b ldr r3, [r3, #20]
|
|
8001678: f5b3 1f80 cmp.w r3, #1048576 @ 0x100000
|
|
800167c: d022 beq.n 80016c4 <HAL_CAN_Init+0x22c>
|
|
800167e: 687b ldr r3, [r7, #4]
|
|
8001680: 695b ldr r3, [r3, #20]
|
|
8001682: f5b3 1f00 cmp.w r3, #2097152 @ 0x200000
|
|
8001686: d01d beq.n 80016c4 <HAL_CAN_Init+0x22c>
|
|
8001688: 687b ldr r3, [r7, #4]
|
|
800168a: 695b ldr r3, [r3, #20]
|
|
800168c: f5b3 1f40 cmp.w r3, #3145728 @ 0x300000
|
|
8001690: d018 beq.n 80016c4 <HAL_CAN_Init+0x22c>
|
|
8001692: 687b ldr r3, [r7, #4]
|
|
8001694: 695b ldr r3, [r3, #20]
|
|
8001696: f5b3 0f80 cmp.w r3, #4194304 @ 0x400000
|
|
800169a: d013 beq.n 80016c4 <HAL_CAN_Init+0x22c>
|
|
800169c: 687b ldr r3, [r7, #4]
|
|
800169e: 695b ldr r3, [r3, #20]
|
|
80016a0: f5b3 0fa0 cmp.w r3, #5242880 @ 0x500000
|
|
80016a4: d00e beq.n 80016c4 <HAL_CAN_Init+0x22c>
|
|
80016a6: 687b ldr r3, [r7, #4]
|
|
80016a8: 695b ldr r3, [r3, #20]
|
|
80016aa: f5b3 0fc0 cmp.w r3, #6291456 @ 0x600000
|
|
80016ae: d009 beq.n 80016c4 <HAL_CAN_Init+0x22c>
|
|
80016b0: 687b ldr r3, [r7, #4]
|
|
80016b2: 695b ldr r3, [r3, #20]
|
|
80016b4: f5b3 0fe0 cmp.w r3, #7340032 @ 0x700000
|
|
80016b8: d004 beq.n 80016c4 <HAL_CAN_Init+0x22c>
|
|
80016ba: f44f 7194 mov.w r1, #296 @ 0x128
|
|
80016be: 4811 ldr r0, [pc, #68] @ (8001704 <HAL_CAN_Init+0x26c>)
|
|
80016c0: f7ff fb38 bl 8000d34 <assert_failed>
|
|
assert_param(IS_CAN_PRESCALER(hcan->Init.Prescaler));
|
|
80016c4: 687b ldr r3, [r7, #4]
|
|
80016c6: 685b ldr r3, [r3, #4]
|
|
80016c8: 2b00 cmp r3, #0
|
|
80016ca: d004 beq.n 80016d6 <HAL_CAN_Init+0x23e>
|
|
80016cc: 687b ldr r3, [r7, #4]
|
|
80016ce: 685b ldr r3, [r3, #4]
|
|
80016d0: f5b3 6f80 cmp.w r3, #1024 @ 0x400
|
|
80016d4: d904 bls.n 80016e0 <HAL_CAN_Init+0x248>
|
|
80016d6: f240 1129 movw r1, #297 @ 0x129
|
|
80016da: 480a ldr r0, [pc, #40] @ (8001704 <HAL_CAN_Init+0x26c>)
|
|
80016dc: f7ff fb2a bl 8000d34 <assert_failed>
|
|
|
|
#if USE_HAL_CAN_REGISTER_CALLBACKS == 1
|
|
if (hcan->State == HAL_CAN_STATE_RESET)
|
|
80016e0: 687b ldr r3, [r7, #4]
|
|
80016e2: f893 3020 ldrb.w r3, [r3, #32]
|
|
80016e6: b2db uxtb r3, r3
|
|
80016e8: 2b00 cmp r3, #0
|
|
80016ea: d13d bne.n 8001768 <HAL_CAN_Init+0x2d0>
|
|
{
|
|
/* Reset callbacks to legacy functions */
|
|
hcan->RxFifo0MsgPendingCallback = HAL_CAN_RxFifo0MsgPendingCallback; /* Legacy weak RxFifo0MsgPendingCallback */
|
|
80016ec: 687b ldr r3, [r7, #4]
|
|
80016ee: 4a06 ldr r2, [pc, #24] @ (8001708 <HAL_CAN_Init+0x270>)
|
|
80016f0: 641a str r2, [r3, #64] @ 0x40
|
|
hcan->RxFifo0FullCallback = HAL_CAN_RxFifo0FullCallback; /* Legacy weak RxFifo0FullCallback */
|
|
80016f2: 687b ldr r3, [r7, #4]
|
|
80016f4: 4a05 ldr r2, [pc, #20] @ (800170c <HAL_CAN_Init+0x274>)
|
|
80016f6: 645a str r2, [r3, #68] @ 0x44
|
|
80016f8: e00a b.n 8001710 <HAL_CAN_Init+0x278>
|
|
80016fa: bf00 nop
|
|
80016fc: 40006400 .word 0x40006400
|
|
8001700: 40006800 .word 0x40006800
|
|
8001704: 0800a0bc .word 0x0800a0bc
|
|
8001708: 080005b9 .word 0x080005b9
|
|
800170c: 08001fc5 .word 0x08001fc5
|
|
hcan->RxFifo1MsgPendingCallback = HAL_CAN_RxFifo1MsgPendingCallback; /* Legacy weak RxFifo1MsgPendingCallback */
|
|
8001710: 687b ldr r3, [r7, #4]
|
|
8001712: 4a8a ldr r2, [pc, #552] @ (800193c <HAL_CAN_Init+0x4a4>)
|
|
8001714: 649a str r2, [r3, #72] @ 0x48
|
|
hcan->RxFifo1FullCallback = HAL_CAN_RxFifo1FullCallback; /* Legacy weak RxFifo1FullCallback */
|
|
8001716: 687b ldr r3, [r7, #4]
|
|
8001718: 4a89 ldr r2, [pc, #548] @ (8001940 <HAL_CAN_Init+0x4a8>)
|
|
800171a: 64da str r2, [r3, #76] @ 0x4c
|
|
hcan->TxMailbox0CompleteCallback = HAL_CAN_TxMailbox0CompleteCallback; /* Legacy weak TxMailbox0CompleteCallback */
|
|
800171c: 687b ldr r3, [r7, #4]
|
|
800171e: 4a89 ldr r2, [pc, #548] @ (8001944 <HAL_CAN_Init+0x4ac>)
|
|
8001720: 629a str r2, [r3, #40] @ 0x28
|
|
hcan->TxMailbox1CompleteCallback = HAL_CAN_TxMailbox1CompleteCallback; /* Legacy weak TxMailbox1CompleteCallback */
|
|
8001722: 687b ldr r3, [r7, #4]
|
|
8001724: 4a88 ldr r2, [pc, #544] @ (8001948 <HAL_CAN_Init+0x4b0>)
|
|
8001726: 62da str r2, [r3, #44] @ 0x2c
|
|
hcan->TxMailbox2CompleteCallback = HAL_CAN_TxMailbox2CompleteCallback; /* Legacy weak TxMailbox2CompleteCallback */
|
|
8001728: 687b ldr r3, [r7, #4]
|
|
800172a: 4a88 ldr r2, [pc, #544] @ (800194c <HAL_CAN_Init+0x4b4>)
|
|
800172c: 631a str r2, [r3, #48] @ 0x30
|
|
hcan->TxMailbox0AbortCallback = HAL_CAN_TxMailbox0AbortCallback; /* Legacy weak TxMailbox0AbortCallback */
|
|
800172e: 687b ldr r3, [r7, #4]
|
|
8001730: 4a87 ldr r2, [pc, #540] @ (8001950 <HAL_CAN_Init+0x4b8>)
|
|
8001732: 635a str r2, [r3, #52] @ 0x34
|
|
hcan->TxMailbox1AbortCallback = HAL_CAN_TxMailbox1AbortCallback; /* Legacy weak TxMailbox1AbortCallback */
|
|
8001734: 687b ldr r3, [r7, #4]
|
|
8001736: 4a87 ldr r2, [pc, #540] @ (8001954 <HAL_CAN_Init+0x4bc>)
|
|
8001738: 639a str r2, [r3, #56] @ 0x38
|
|
hcan->TxMailbox2AbortCallback = HAL_CAN_TxMailbox2AbortCallback; /* Legacy weak TxMailbox2AbortCallback */
|
|
800173a: 687b ldr r3, [r7, #4]
|
|
800173c: 4a86 ldr r2, [pc, #536] @ (8001958 <HAL_CAN_Init+0x4c0>)
|
|
800173e: 63da str r2, [r3, #60] @ 0x3c
|
|
hcan->SleepCallback = HAL_CAN_SleepCallback; /* Legacy weak SleepCallback */
|
|
8001740: 687b ldr r3, [r7, #4]
|
|
8001742: 4a86 ldr r2, [pc, #536] @ (800195c <HAL_CAN_Init+0x4c4>)
|
|
8001744: 651a str r2, [r3, #80] @ 0x50
|
|
hcan->WakeUpFromRxMsgCallback = HAL_CAN_WakeUpFromRxMsgCallback; /* Legacy weak WakeUpFromRxMsgCallback */
|
|
8001746: 687b ldr r3, [r7, #4]
|
|
8001748: 4a85 ldr r2, [pc, #532] @ (8001960 <HAL_CAN_Init+0x4c8>)
|
|
800174a: 655a str r2, [r3, #84] @ 0x54
|
|
hcan->ErrorCallback = HAL_CAN_ErrorCallback; /* Legacy weak ErrorCallback */
|
|
800174c: 687b ldr r3, [r7, #4]
|
|
800174e: 4a85 ldr r2, [pc, #532] @ (8001964 <HAL_CAN_Init+0x4cc>)
|
|
8001750: 659a str r2, [r3, #88] @ 0x58
|
|
|
|
if (hcan->MspInitCallback == NULL)
|
|
8001752: 687b ldr r3, [r7, #4]
|
|
8001754: 6ddb ldr r3, [r3, #92] @ 0x5c
|
|
8001756: 2b00 cmp r3, #0
|
|
8001758: d102 bne.n 8001760 <HAL_CAN_Init+0x2c8>
|
|
{
|
|
hcan->MspInitCallback = HAL_CAN_MspInit; /* Legacy weak MspInit */
|
|
800175a: 687b ldr r3, [r7, #4]
|
|
800175c: 4a82 ldr r2, [pc, #520] @ (8001968 <HAL_CAN_Init+0x4d0>)
|
|
800175e: 65da str r2, [r3, #92] @ 0x5c
|
|
}
|
|
|
|
/* Init the low level hardware: CLOCK, NVIC */
|
|
hcan->MspInitCallback(hcan);
|
|
8001760: 687b ldr r3, [r7, #4]
|
|
8001762: 6ddb ldr r3, [r3, #92] @ 0x5c
|
|
8001764: 6878 ldr r0, [r7, #4]
|
|
8001766: 4798 blx r3
|
|
HAL_CAN_MspInit(hcan);
|
|
}
|
|
#endif /* USE_HAL_CAN_REGISTER_CALLBACKS */
|
|
|
|
/* Request initialisation */
|
|
SET_BIT(hcan->Instance->MCR, CAN_MCR_INRQ);
|
|
8001768: 687b ldr r3, [r7, #4]
|
|
800176a: 681b ldr r3, [r3, #0]
|
|
800176c: 681a ldr r2, [r3, #0]
|
|
800176e: 687b ldr r3, [r7, #4]
|
|
8001770: 681b ldr r3, [r3, #0]
|
|
8001772: f042 0201 orr.w r2, r2, #1
|
|
8001776: 601a str r2, [r3, #0]
|
|
|
|
/* Get tick */
|
|
tickstart = HAL_GetTick();
|
|
8001778: f7ff fe5e bl 8001438 <HAL_GetTick>
|
|
800177c: 60f8 str r0, [r7, #12]
|
|
|
|
/* Wait initialisation acknowledge */
|
|
while ((hcan->Instance->MSR & CAN_MSR_INAK) == 0U)
|
|
800177e: e012 b.n 80017a6 <HAL_CAN_Init+0x30e>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > CAN_TIMEOUT_VALUE)
|
|
8001780: f7ff fe5a bl 8001438 <HAL_GetTick>
|
|
8001784: 4602 mov r2, r0
|
|
8001786: 68fb ldr r3, [r7, #12]
|
|
8001788: 1ad3 subs r3, r2, r3
|
|
800178a: 2b0a cmp r3, #10
|
|
800178c: d90b bls.n 80017a6 <HAL_CAN_Init+0x30e>
|
|
{
|
|
/* Update error code */
|
|
hcan->ErrorCode |= HAL_CAN_ERROR_TIMEOUT;
|
|
800178e: 687b ldr r3, [r7, #4]
|
|
8001790: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
8001792: f443 3200 orr.w r2, r3, #131072 @ 0x20000
|
|
8001796: 687b ldr r3, [r7, #4]
|
|
8001798: 625a str r2, [r3, #36] @ 0x24
|
|
|
|
/* Change CAN state */
|
|
hcan->State = HAL_CAN_STATE_ERROR;
|
|
800179a: 687b ldr r3, [r7, #4]
|
|
800179c: 2205 movs r2, #5
|
|
800179e: f883 2020 strb.w r2, [r3, #32]
|
|
|
|
return HAL_ERROR;
|
|
80017a2: 2301 movs r3, #1
|
|
80017a4: e0c5 b.n 8001932 <HAL_CAN_Init+0x49a>
|
|
while ((hcan->Instance->MSR & CAN_MSR_INAK) == 0U)
|
|
80017a6: 687b ldr r3, [r7, #4]
|
|
80017a8: 681b ldr r3, [r3, #0]
|
|
80017aa: 685b ldr r3, [r3, #4]
|
|
80017ac: f003 0301 and.w r3, r3, #1
|
|
80017b0: 2b00 cmp r3, #0
|
|
80017b2: d0e5 beq.n 8001780 <HAL_CAN_Init+0x2e8>
|
|
}
|
|
}
|
|
|
|
/* Exit from sleep mode */
|
|
CLEAR_BIT(hcan->Instance->MCR, CAN_MCR_SLEEP);
|
|
80017b4: 687b ldr r3, [r7, #4]
|
|
80017b6: 681b ldr r3, [r3, #0]
|
|
80017b8: 681a ldr r2, [r3, #0]
|
|
80017ba: 687b ldr r3, [r7, #4]
|
|
80017bc: 681b ldr r3, [r3, #0]
|
|
80017be: f022 0202 bic.w r2, r2, #2
|
|
80017c2: 601a str r2, [r3, #0]
|
|
|
|
/* Get tick */
|
|
tickstart = HAL_GetTick();
|
|
80017c4: f7ff fe38 bl 8001438 <HAL_GetTick>
|
|
80017c8: 60f8 str r0, [r7, #12]
|
|
|
|
/* Check Sleep mode leave acknowledge */
|
|
while ((hcan->Instance->MSR & CAN_MSR_SLAK) != 0U)
|
|
80017ca: e012 b.n 80017f2 <HAL_CAN_Init+0x35a>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > CAN_TIMEOUT_VALUE)
|
|
80017cc: f7ff fe34 bl 8001438 <HAL_GetTick>
|
|
80017d0: 4602 mov r2, r0
|
|
80017d2: 68fb ldr r3, [r7, #12]
|
|
80017d4: 1ad3 subs r3, r2, r3
|
|
80017d6: 2b0a cmp r3, #10
|
|
80017d8: d90b bls.n 80017f2 <HAL_CAN_Init+0x35a>
|
|
{
|
|
/* Update error code */
|
|
hcan->ErrorCode |= HAL_CAN_ERROR_TIMEOUT;
|
|
80017da: 687b ldr r3, [r7, #4]
|
|
80017dc: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
80017de: f443 3200 orr.w r2, r3, #131072 @ 0x20000
|
|
80017e2: 687b ldr r3, [r7, #4]
|
|
80017e4: 625a str r2, [r3, #36] @ 0x24
|
|
|
|
/* Change CAN state */
|
|
hcan->State = HAL_CAN_STATE_ERROR;
|
|
80017e6: 687b ldr r3, [r7, #4]
|
|
80017e8: 2205 movs r2, #5
|
|
80017ea: f883 2020 strb.w r2, [r3, #32]
|
|
|
|
return HAL_ERROR;
|
|
80017ee: 2301 movs r3, #1
|
|
80017f0: e09f b.n 8001932 <HAL_CAN_Init+0x49a>
|
|
while ((hcan->Instance->MSR & CAN_MSR_SLAK) != 0U)
|
|
80017f2: 687b ldr r3, [r7, #4]
|
|
80017f4: 681b ldr r3, [r3, #0]
|
|
80017f6: 685b ldr r3, [r3, #4]
|
|
80017f8: f003 0302 and.w r3, r3, #2
|
|
80017fc: 2b00 cmp r3, #0
|
|
80017fe: d1e5 bne.n 80017cc <HAL_CAN_Init+0x334>
|
|
}
|
|
}
|
|
|
|
/* Set the time triggered communication mode */
|
|
if (hcan->Init.TimeTriggeredMode == ENABLE)
|
|
8001800: 687b ldr r3, [r7, #4]
|
|
8001802: 7e1b ldrb r3, [r3, #24]
|
|
8001804: 2b01 cmp r3, #1
|
|
8001806: d108 bne.n 800181a <HAL_CAN_Init+0x382>
|
|
{
|
|
SET_BIT(hcan->Instance->MCR, CAN_MCR_TTCM);
|
|
8001808: 687b ldr r3, [r7, #4]
|
|
800180a: 681b ldr r3, [r3, #0]
|
|
800180c: 681a ldr r2, [r3, #0]
|
|
800180e: 687b ldr r3, [r7, #4]
|
|
8001810: 681b ldr r3, [r3, #0]
|
|
8001812: f042 0280 orr.w r2, r2, #128 @ 0x80
|
|
8001816: 601a str r2, [r3, #0]
|
|
8001818: e007 b.n 800182a <HAL_CAN_Init+0x392>
|
|
}
|
|
else
|
|
{
|
|
CLEAR_BIT(hcan->Instance->MCR, CAN_MCR_TTCM);
|
|
800181a: 687b ldr r3, [r7, #4]
|
|
800181c: 681b ldr r3, [r3, #0]
|
|
800181e: 681a ldr r2, [r3, #0]
|
|
8001820: 687b ldr r3, [r7, #4]
|
|
8001822: 681b ldr r3, [r3, #0]
|
|
8001824: f022 0280 bic.w r2, r2, #128 @ 0x80
|
|
8001828: 601a str r2, [r3, #0]
|
|
}
|
|
|
|
/* Set the automatic bus-off management */
|
|
if (hcan->Init.AutoBusOff == ENABLE)
|
|
800182a: 687b ldr r3, [r7, #4]
|
|
800182c: 7e5b ldrb r3, [r3, #25]
|
|
800182e: 2b01 cmp r3, #1
|
|
8001830: d108 bne.n 8001844 <HAL_CAN_Init+0x3ac>
|
|
{
|
|
SET_BIT(hcan->Instance->MCR, CAN_MCR_ABOM);
|
|
8001832: 687b ldr r3, [r7, #4]
|
|
8001834: 681b ldr r3, [r3, #0]
|
|
8001836: 681a ldr r2, [r3, #0]
|
|
8001838: 687b ldr r3, [r7, #4]
|
|
800183a: 681b ldr r3, [r3, #0]
|
|
800183c: f042 0240 orr.w r2, r2, #64 @ 0x40
|
|
8001840: 601a str r2, [r3, #0]
|
|
8001842: e007 b.n 8001854 <HAL_CAN_Init+0x3bc>
|
|
}
|
|
else
|
|
{
|
|
CLEAR_BIT(hcan->Instance->MCR, CAN_MCR_ABOM);
|
|
8001844: 687b ldr r3, [r7, #4]
|
|
8001846: 681b ldr r3, [r3, #0]
|
|
8001848: 681a ldr r2, [r3, #0]
|
|
800184a: 687b ldr r3, [r7, #4]
|
|
800184c: 681b ldr r3, [r3, #0]
|
|
800184e: f022 0240 bic.w r2, r2, #64 @ 0x40
|
|
8001852: 601a str r2, [r3, #0]
|
|
}
|
|
|
|
/* Set the automatic wake-up mode */
|
|
if (hcan->Init.AutoWakeUp == ENABLE)
|
|
8001854: 687b ldr r3, [r7, #4]
|
|
8001856: 7e9b ldrb r3, [r3, #26]
|
|
8001858: 2b01 cmp r3, #1
|
|
800185a: d108 bne.n 800186e <HAL_CAN_Init+0x3d6>
|
|
{
|
|
SET_BIT(hcan->Instance->MCR, CAN_MCR_AWUM);
|
|
800185c: 687b ldr r3, [r7, #4]
|
|
800185e: 681b ldr r3, [r3, #0]
|
|
8001860: 681a ldr r2, [r3, #0]
|
|
8001862: 687b ldr r3, [r7, #4]
|
|
8001864: 681b ldr r3, [r3, #0]
|
|
8001866: f042 0220 orr.w r2, r2, #32
|
|
800186a: 601a str r2, [r3, #0]
|
|
800186c: e007 b.n 800187e <HAL_CAN_Init+0x3e6>
|
|
}
|
|
else
|
|
{
|
|
CLEAR_BIT(hcan->Instance->MCR, CAN_MCR_AWUM);
|
|
800186e: 687b ldr r3, [r7, #4]
|
|
8001870: 681b ldr r3, [r3, #0]
|
|
8001872: 681a ldr r2, [r3, #0]
|
|
8001874: 687b ldr r3, [r7, #4]
|
|
8001876: 681b ldr r3, [r3, #0]
|
|
8001878: f022 0220 bic.w r2, r2, #32
|
|
800187c: 601a str r2, [r3, #0]
|
|
}
|
|
|
|
/* Set the automatic retransmission */
|
|
if (hcan->Init.AutoRetransmission == ENABLE)
|
|
800187e: 687b ldr r3, [r7, #4]
|
|
8001880: 7edb ldrb r3, [r3, #27]
|
|
8001882: 2b01 cmp r3, #1
|
|
8001884: d108 bne.n 8001898 <HAL_CAN_Init+0x400>
|
|
{
|
|
CLEAR_BIT(hcan->Instance->MCR, CAN_MCR_NART);
|
|
8001886: 687b ldr r3, [r7, #4]
|
|
8001888: 681b ldr r3, [r3, #0]
|
|
800188a: 681a ldr r2, [r3, #0]
|
|
800188c: 687b ldr r3, [r7, #4]
|
|
800188e: 681b ldr r3, [r3, #0]
|
|
8001890: f022 0210 bic.w r2, r2, #16
|
|
8001894: 601a str r2, [r3, #0]
|
|
8001896: e007 b.n 80018a8 <HAL_CAN_Init+0x410>
|
|
}
|
|
else
|
|
{
|
|
SET_BIT(hcan->Instance->MCR, CAN_MCR_NART);
|
|
8001898: 687b ldr r3, [r7, #4]
|
|
800189a: 681b ldr r3, [r3, #0]
|
|
800189c: 681a ldr r2, [r3, #0]
|
|
800189e: 687b ldr r3, [r7, #4]
|
|
80018a0: 681b ldr r3, [r3, #0]
|
|
80018a2: f042 0210 orr.w r2, r2, #16
|
|
80018a6: 601a str r2, [r3, #0]
|
|
}
|
|
|
|
/* Set the receive FIFO locked mode */
|
|
if (hcan->Init.ReceiveFifoLocked == ENABLE)
|
|
80018a8: 687b ldr r3, [r7, #4]
|
|
80018aa: 7f1b ldrb r3, [r3, #28]
|
|
80018ac: 2b01 cmp r3, #1
|
|
80018ae: d108 bne.n 80018c2 <HAL_CAN_Init+0x42a>
|
|
{
|
|
SET_BIT(hcan->Instance->MCR, CAN_MCR_RFLM);
|
|
80018b0: 687b ldr r3, [r7, #4]
|
|
80018b2: 681b ldr r3, [r3, #0]
|
|
80018b4: 681a ldr r2, [r3, #0]
|
|
80018b6: 687b ldr r3, [r7, #4]
|
|
80018b8: 681b ldr r3, [r3, #0]
|
|
80018ba: f042 0208 orr.w r2, r2, #8
|
|
80018be: 601a str r2, [r3, #0]
|
|
80018c0: e007 b.n 80018d2 <HAL_CAN_Init+0x43a>
|
|
}
|
|
else
|
|
{
|
|
CLEAR_BIT(hcan->Instance->MCR, CAN_MCR_RFLM);
|
|
80018c2: 687b ldr r3, [r7, #4]
|
|
80018c4: 681b ldr r3, [r3, #0]
|
|
80018c6: 681a ldr r2, [r3, #0]
|
|
80018c8: 687b ldr r3, [r7, #4]
|
|
80018ca: 681b ldr r3, [r3, #0]
|
|
80018cc: f022 0208 bic.w r2, r2, #8
|
|
80018d0: 601a str r2, [r3, #0]
|
|
}
|
|
|
|
/* Set the transmit FIFO priority */
|
|
if (hcan->Init.TransmitFifoPriority == ENABLE)
|
|
80018d2: 687b ldr r3, [r7, #4]
|
|
80018d4: 7f5b ldrb r3, [r3, #29]
|
|
80018d6: 2b01 cmp r3, #1
|
|
80018d8: d108 bne.n 80018ec <HAL_CAN_Init+0x454>
|
|
{
|
|
SET_BIT(hcan->Instance->MCR, CAN_MCR_TXFP);
|
|
80018da: 687b ldr r3, [r7, #4]
|
|
80018dc: 681b ldr r3, [r3, #0]
|
|
80018de: 681a ldr r2, [r3, #0]
|
|
80018e0: 687b ldr r3, [r7, #4]
|
|
80018e2: 681b ldr r3, [r3, #0]
|
|
80018e4: f042 0204 orr.w r2, r2, #4
|
|
80018e8: 601a str r2, [r3, #0]
|
|
80018ea: e007 b.n 80018fc <HAL_CAN_Init+0x464>
|
|
}
|
|
else
|
|
{
|
|
CLEAR_BIT(hcan->Instance->MCR, CAN_MCR_TXFP);
|
|
80018ec: 687b ldr r3, [r7, #4]
|
|
80018ee: 681b ldr r3, [r3, #0]
|
|
80018f0: 681a ldr r2, [r3, #0]
|
|
80018f2: 687b ldr r3, [r7, #4]
|
|
80018f4: 681b ldr r3, [r3, #0]
|
|
80018f6: f022 0204 bic.w r2, r2, #4
|
|
80018fa: 601a str r2, [r3, #0]
|
|
}
|
|
|
|
/* Set the bit timing register */
|
|
WRITE_REG(hcan->Instance->BTR, (uint32_t)(hcan->Init.Mode |
|
|
80018fc: 687b ldr r3, [r7, #4]
|
|
80018fe: 689a ldr r2, [r3, #8]
|
|
8001900: 687b ldr r3, [r7, #4]
|
|
8001902: 68db ldr r3, [r3, #12]
|
|
8001904: 431a orrs r2, r3
|
|
8001906: 687b ldr r3, [r7, #4]
|
|
8001908: 691b ldr r3, [r3, #16]
|
|
800190a: 431a orrs r2, r3
|
|
800190c: 687b ldr r3, [r7, #4]
|
|
800190e: 695b ldr r3, [r3, #20]
|
|
8001910: ea42 0103 orr.w r1, r2, r3
|
|
8001914: 687b ldr r3, [r7, #4]
|
|
8001916: 685b ldr r3, [r3, #4]
|
|
8001918: 1e5a subs r2, r3, #1
|
|
800191a: 687b ldr r3, [r7, #4]
|
|
800191c: 681b ldr r3, [r3, #0]
|
|
800191e: 430a orrs r2, r1
|
|
8001920: 61da str r2, [r3, #28]
|
|
hcan->Init.TimeSeg1 |
|
|
hcan->Init.TimeSeg2 |
|
|
(hcan->Init.Prescaler - 1U)));
|
|
|
|
/* Initialize the error code */
|
|
hcan->ErrorCode = HAL_CAN_ERROR_NONE;
|
|
8001922: 687b ldr r3, [r7, #4]
|
|
8001924: 2200 movs r2, #0
|
|
8001926: 625a str r2, [r3, #36] @ 0x24
|
|
|
|
/* Initialize the CAN state */
|
|
hcan->State = HAL_CAN_STATE_READY;
|
|
8001928: 687b ldr r3, [r7, #4]
|
|
800192a: 2201 movs r2, #1
|
|
800192c: f883 2020 strb.w r2, [r3, #32]
|
|
|
|
/* Return function status */
|
|
return HAL_OK;
|
|
8001930: 2300 movs r3, #0
|
|
}
|
|
8001932: 4618 mov r0, r3
|
|
8001934: 3710 adds r7, #16
|
|
8001936: 46bd mov sp, r7
|
|
8001938: bd80 pop {r7, pc}
|
|
800193a: bf00 nop
|
|
800193c: 08001fd9 .word 0x08001fd9
|
|
8001940: 08001fed .word 0x08001fed
|
|
8001944: 08001f4d .word 0x08001f4d
|
|
8001948: 08001f61 .word 0x08001f61
|
|
800194c: 08001f75 .word 0x08001f75
|
|
8001950: 08001f89 .word 0x08001f89
|
|
8001954: 08001f9d .word 0x08001f9d
|
|
8001958: 08001fb1 .word 0x08001fb1
|
|
800195c: 08002001 .word 0x08002001
|
|
8001960: 08002015 .word 0x08002015
|
|
8001964: 08002029 .word 0x08002029
|
|
8001968: 08000da5 .word 0x08000da5
|
|
|
|
0800196c <HAL_CAN_ConfigFilter>:
|
|
* @param sFilterConfig pointer to a CAN_FilterTypeDef structure that
|
|
* contains the filter configuration information.
|
|
* @retval None
|
|
*/
|
|
HAL_StatusTypeDef HAL_CAN_ConfigFilter(CAN_HandleTypeDef *hcan, const CAN_FilterTypeDef *sFilterConfig)
|
|
{
|
|
800196c: b580 push {r7, lr}
|
|
800196e: b086 sub sp, #24
|
|
8001970: af00 add r7, sp, #0
|
|
8001972: 6078 str r0, [r7, #4]
|
|
8001974: 6039 str r1, [r7, #0]
|
|
uint32_t filternbrbitpos;
|
|
CAN_TypeDef *can_ip;
|
|
HAL_CAN_StateTypeDef state = hcan->State;
|
|
8001976: 687b ldr r3, [r7, #4]
|
|
8001978: f893 3020 ldrb.w r3, [r3, #32]
|
|
800197c: 75fb strb r3, [r7, #23]
|
|
|
|
if ((state == HAL_CAN_STATE_READY) ||
|
|
800197e: 7dfb ldrb r3, [r7, #23]
|
|
8001980: 2b01 cmp r3, #1
|
|
8001982: d003 beq.n 800198c <HAL_CAN_ConfigFilter+0x20>
|
|
8001984: 7dfb ldrb r3, [r7, #23]
|
|
8001986: 2b02 cmp r3, #2
|
|
8001988: f040 812c bne.w 8001be4 <HAL_CAN_ConfigFilter+0x278>
|
|
(state == HAL_CAN_STATE_LISTENING))
|
|
{
|
|
/* Check the parameters */
|
|
assert_param(IS_CAN_FILTER_ID_HALFWORD(sFilterConfig->FilterIdHigh));
|
|
800198c: 683b ldr r3, [r7, #0]
|
|
800198e: 681b ldr r3, [r3, #0]
|
|
8001990: f5b3 3f80 cmp.w r3, #65536 @ 0x10000
|
|
8001994: d304 bcc.n 80019a0 <HAL_CAN_ConfigFilter+0x34>
|
|
8001996: f240 3152 movw r1, #850 @ 0x352
|
|
800199a: 4898 ldr r0, [pc, #608] @ (8001bfc <HAL_CAN_ConfigFilter+0x290>)
|
|
800199c: f7ff f9ca bl 8000d34 <assert_failed>
|
|
assert_param(IS_CAN_FILTER_ID_HALFWORD(sFilterConfig->FilterIdLow));
|
|
80019a0: 683b ldr r3, [r7, #0]
|
|
80019a2: 685b ldr r3, [r3, #4]
|
|
80019a4: f5b3 3f80 cmp.w r3, #65536 @ 0x10000
|
|
80019a8: d304 bcc.n 80019b4 <HAL_CAN_ConfigFilter+0x48>
|
|
80019aa: f240 3153 movw r1, #851 @ 0x353
|
|
80019ae: 4893 ldr r0, [pc, #588] @ (8001bfc <HAL_CAN_ConfigFilter+0x290>)
|
|
80019b0: f7ff f9c0 bl 8000d34 <assert_failed>
|
|
assert_param(IS_CAN_FILTER_ID_HALFWORD(sFilterConfig->FilterMaskIdHigh));
|
|
80019b4: 683b ldr r3, [r7, #0]
|
|
80019b6: 689b ldr r3, [r3, #8]
|
|
80019b8: f5b3 3f80 cmp.w r3, #65536 @ 0x10000
|
|
80019bc: d304 bcc.n 80019c8 <HAL_CAN_ConfigFilter+0x5c>
|
|
80019be: f44f 7155 mov.w r1, #852 @ 0x354
|
|
80019c2: 488e ldr r0, [pc, #568] @ (8001bfc <HAL_CAN_ConfigFilter+0x290>)
|
|
80019c4: f7ff f9b6 bl 8000d34 <assert_failed>
|
|
assert_param(IS_CAN_FILTER_ID_HALFWORD(sFilterConfig->FilterMaskIdLow));
|
|
80019c8: 683b ldr r3, [r7, #0]
|
|
80019ca: 68db ldr r3, [r3, #12]
|
|
80019cc: f5b3 3f80 cmp.w r3, #65536 @ 0x10000
|
|
80019d0: d304 bcc.n 80019dc <HAL_CAN_ConfigFilter+0x70>
|
|
80019d2: f240 3155 movw r1, #853 @ 0x355
|
|
80019d6: 4889 ldr r0, [pc, #548] @ (8001bfc <HAL_CAN_ConfigFilter+0x290>)
|
|
80019d8: f7ff f9ac bl 8000d34 <assert_failed>
|
|
assert_param(IS_CAN_FILTER_MODE(sFilterConfig->FilterMode));
|
|
80019dc: 683b ldr r3, [r7, #0]
|
|
80019de: 699b ldr r3, [r3, #24]
|
|
80019e0: 2b00 cmp r3, #0
|
|
80019e2: d008 beq.n 80019f6 <HAL_CAN_ConfigFilter+0x8a>
|
|
80019e4: 683b ldr r3, [r7, #0]
|
|
80019e6: 699b ldr r3, [r3, #24]
|
|
80019e8: 2b01 cmp r3, #1
|
|
80019ea: d004 beq.n 80019f6 <HAL_CAN_ConfigFilter+0x8a>
|
|
80019ec: f240 3156 movw r1, #854 @ 0x356
|
|
80019f0: 4882 ldr r0, [pc, #520] @ (8001bfc <HAL_CAN_ConfigFilter+0x290>)
|
|
80019f2: f7ff f99f bl 8000d34 <assert_failed>
|
|
assert_param(IS_CAN_FILTER_SCALE(sFilterConfig->FilterScale));
|
|
80019f6: 683b ldr r3, [r7, #0]
|
|
80019f8: 69db ldr r3, [r3, #28]
|
|
80019fa: 2b00 cmp r3, #0
|
|
80019fc: d008 beq.n 8001a10 <HAL_CAN_ConfigFilter+0xa4>
|
|
80019fe: 683b ldr r3, [r7, #0]
|
|
8001a00: 69db ldr r3, [r3, #28]
|
|
8001a02: 2b01 cmp r3, #1
|
|
8001a04: d004 beq.n 8001a10 <HAL_CAN_ConfigFilter+0xa4>
|
|
8001a06: f240 3157 movw r1, #855 @ 0x357
|
|
8001a0a: 487c ldr r0, [pc, #496] @ (8001bfc <HAL_CAN_ConfigFilter+0x290>)
|
|
8001a0c: f7ff f992 bl 8000d34 <assert_failed>
|
|
assert_param(IS_CAN_FILTER_FIFO(sFilterConfig->FilterFIFOAssignment));
|
|
8001a10: 683b ldr r3, [r7, #0]
|
|
8001a12: 691b ldr r3, [r3, #16]
|
|
8001a14: 2b00 cmp r3, #0
|
|
8001a16: d008 beq.n 8001a2a <HAL_CAN_ConfigFilter+0xbe>
|
|
8001a18: 683b ldr r3, [r7, #0]
|
|
8001a1a: 691b ldr r3, [r3, #16]
|
|
8001a1c: 2b01 cmp r3, #1
|
|
8001a1e: d004 beq.n 8001a2a <HAL_CAN_ConfigFilter+0xbe>
|
|
8001a20: f44f 7156 mov.w r1, #856 @ 0x358
|
|
8001a24: 4875 ldr r0, [pc, #468] @ (8001bfc <HAL_CAN_ConfigFilter+0x290>)
|
|
8001a26: f7ff f985 bl 8000d34 <assert_failed>
|
|
assert_param(IS_CAN_FILTER_ACTIVATION(sFilterConfig->FilterActivation));
|
|
8001a2a: 683b ldr r3, [r7, #0]
|
|
8001a2c: 6a1b ldr r3, [r3, #32]
|
|
8001a2e: 2b00 cmp r3, #0
|
|
8001a30: d008 beq.n 8001a44 <HAL_CAN_ConfigFilter+0xd8>
|
|
8001a32: 683b ldr r3, [r7, #0]
|
|
8001a34: 6a1b ldr r3, [r3, #32]
|
|
8001a36: 2b01 cmp r3, #1
|
|
8001a38: d004 beq.n 8001a44 <HAL_CAN_ConfigFilter+0xd8>
|
|
8001a3a: f240 3159 movw r1, #857 @ 0x359
|
|
8001a3e: 486f ldr r0, [pc, #444] @ (8001bfc <HAL_CAN_ConfigFilter+0x290>)
|
|
8001a40: f7ff f978 bl 8000d34 <assert_failed>
|
|
assert_param(IS_CAN_FILTER_BANK_DUAL(sFilterConfig->SlaveStartFilterBank));
|
|
}
|
|
#elif defined(CAN2)
|
|
/* CAN1 and CAN2 are dual instances with 28 common filters banks */
|
|
/* Select master instance to access the filter banks */
|
|
can_ip = CAN1;
|
|
8001a44: 4b6e ldr r3, [pc, #440] @ (8001c00 <HAL_CAN_ConfigFilter+0x294>)
|
|
8001a46: 613b str r3, [r7, #16]
|
|
|
|
/* Check the parameters */
|
|
assert_param(IS_CAN_FILTER_BANK_DUAL(sFilterConfig->FilterBank));
|
|
8001a48: 683b ldr r3, [r7, #0]
|
|
8001a4a: 695b ldr r3, [r3, #20]
|
|
8001a4c: 2b1b cmp r3, #27
|
|
8001a4e: d904 bls.n 8001a5a <HAL_CAN_ConfigFilter+0xee>
|
|
8001a50: f240 3175 movw r1, #885 @ 0x375
|
|
8001a54: 4869 ldr r0, [pc, #420] @ (8001bfc <HAL_CAN_ConfigFilter+0x290>)
|
|
8001a56: f7ff f96d bl 8000d34 <assert_failed>
|
|
assert_param(IS_CAN_FILTER_BANK_DUAL(sFilterConfig->SlaveStartFilterBank));
|
|
8001a5a: 683b ldr r3, [r7, #0]
|
|
8001a5c: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
8001a5e: 2b1b cmp r3, #27
|
|
8001a60: d904 bls.n 8001a6c <HAL_CAN_ConfigFilter+0x100>
|
|
8001a62: f240 3176 movw r1, #886 @ 0x376
|
|
8001a66: 4865 ldr r0, [pc, #404] @ (8001bfc <HAL_CAN_ConfigFilter+0x290>)
|
|
8001a68: f7ff f964 bl 8000d34 <assert_failed>
|
|
/* Check the parameters */
|
|
assert_param(IS_CAN_FILTER_BANK_SINGLE(sFilterConfig->FilterBank));
|
|
#endif /* CAN3 */
|
|
|
|
/* Initialisation mode for the filter */
|
|
SET_BIT(can_ip->FMR, CAN_FMR_FINIT);
|
|
8001a6c: 693b ldr r3, [r7, #16]
|
|
8001a6e: f8d3 3200 ldr.w r3, [r3, #512] @ 0x200
|
|
8001a72: f043 0201 orr.w r2, r3, #1
|
|
8001a76: 693b ldr r3, [r7, #16]
|
|
8001a78: f8c3 2200 str.w r2, [r3, #512] @ 0x200
|
|
SET_BIT(can_ip->FMR, sFilterConfig->SlaveStartFilterBank << CAN_FMR_CAN2SB_Pos);
|
|
}
|
|
|
|
#elif defined(CAN2)
|
|
/* Select the start filter number of CAN2 slave instance */
|
|
CLEAR_BIT(can_ip->FMR, CAN_FMR_CAN2SB);
|
|
8001a7c: 693b ldr r3, [r7, #16]
|
|
8001a7e: f8d3 3200 ldr.w r3, [r3, #512] @ 0x200
|
|
8001a82: f423 527c bic.w r2, r3, #16128 @ 0x3f00
|
|
8001a86: 693b ldr r3, [r7, #16]
|
|
8001a88: f8c3 2200 str.w r2, [r3, #512] @ 0x200
|
|
SET_BIT(can_ip->FMR, sFilterConfig->SlaveStartFilterBank << CAN_FMR_CAN2SB_Pos);
|
|
8001a8c: 693b ldr r3, [r7, #16]
|
|
8001a8e: f8d3 2200 ldr.w r2, [r3, #512] @ 0x200
|
|
8001a92: 683b ldr r3, [r7, #0]
|
|
8001a94: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
8001a96: 021b lsls r3, r3, #8
|
|
8001a98: 431a orrs r2, r3
|
|
8001a9a: 693b ldr r3, [r7, #16]
|
|
8001a9c: f8c3 2200 str.w r2, [r3, #512] @ 0x200
|
|
|
|
#endif /* CAN3 */
|
|
/* Convert filter number into bit position */
|
|
filternbrbitpos = (uint32_t)1 << (sFilterConfig->FilterBank & 0x1FU);
|
|
8001aa0: 683b ldr r3, [r7, #0]
|
|
8001aa2: 695b ldr r3, [r3, #20]
|
|
8001aa4: f003 031f and.w r3, r3, #31
|
|
8001aa8: 2201 movs r2, #1
|
|
8001aaa: fa02 f303 lsl.w r3, r2, r3
|
|
8001aae: 60fb str r3, [r7, #12]
|
|
|
|
/* Filter Deactivation */
|
|
CLEAR_BIT(can_ip->FA1R, filternbrbitpos);
|
|
8001ab0: 693b ldr r3, [r7, #16]
|
|
8001ab2: f8d3 221c ldr.w r2, [r3, #540] @ 0x21c
|
|
8001ab6: 68fb ldr r3, [r7, #12]
|
|
8001ab8: 43db mvns r3, r3
|
|
8001aba: 401a ands r2, r3
|
|
8001abc: 693b ldr r3, [r7, #16]
|
|
8001abe: f8c3 221c str.w r2, [r3, #540] @ 0x21c
|
|
|
|
/* Filter Scale */
|
|
if (sFilterConfig->FilterScale == CAN_FILTERSCALE_16BIT)
|
|
8001ac2: 683b ldr r3, [r7, #0]
|
|
8001ac4: 69db ldr r3, [r3, #28]
|
|
8001ac6: 2b00 cmp r3, #0
|
|
8001ac8: d123 bne.n 8001b12 <HAL_CAN_ConfigFilter+0x1a6>
|
|
{
|
|
/* 16-bit scale for the filter */
|
|
CLEAR_BIT(can_ip->FS1R, filternbrbitpos);
|
|
8001aca: 693b ldr r3, [r7, #16]
|
|
8001acc: f8d3 220c ldr.w r2, [r3, #524] @ 0x20c
|
|
8001ad0: 68fb ldr r3, [r7, #12]
|
|
8001ad2: 43db mvns r3, r3
|
|
8001ad4: 401a ands r2, r3
|
|
8001ad6: 693b ldr r3, [r7, #16]
|
|
8001ad8: f8c3 220c str.w r2, [r3, #524] @ 0x20c
|
|
|
|
/* First 16-bit identifier and First 16-bit mask */
|
|
/* Or First 16-bit identifier and Second 16-bit identifier */
|
|
can_ip->sFilterRegister[sFilterConfig->FilterBank].FR1 =
|
|
((0x0000FFFFU & (uint32_t)sFilterConfig->FilterMaskIdLow) << 16U) |
|
|
8001adc: 683b ldr r3, [r7, #0]
|
|
8001ade: 68db ldr r3, [r3, #12]
|
|
8001ae0: 0419 lsls r1, r3, #16
|
|
(0x0000FFFFU & (uint32_t)sFilterConfig->FilterIdLow);
|
|
8001ae2: 683b ldr r3, [r7, #0]
|
|
8001ae4: 685b ldr r3, [r3, #4]
|
|
8001ae6: b29b uxth r3, r3
|
|
can_ip->sFilterRegister[sFilterConfig->FilterBank].FR1 =
|
|
8001ae8: 683a ldr r2, [r7, #0]
|
|
8001aea: 6952 ldr r2, [r2, #20]
|
|
((0x0000FFFFU & (uint32_t)sFilterConfig->FilterMaskIdLow) << 16U) |
|
|
8001aec: 4319 orrs r1, r3
|
|
can_ip->sFilterRegister[sFilterConfig->FilterBank].FR1 =
|
|
8001aee: 693b ldr r3, [r7, #16]
|
|
8001af0: 3248 adds r2, #72 @ 0x48
|
|
8001af2: f843 1032 str.w r1, [r3, r2, lsl #3]
|
|
|
|
/* Second 16-bit identifier and Second 16-bit mask */
|
|
/* Or Third 16-bit identifier and Fourth 16-bit identifier */
|
|
can_ip->sFilterRegister[sFilterConfig->FilterBank].FR2 =
|
|
((0x0000FFFFU & (uint32_t)sFilterConfig->FilterMaskIdHigh) << 16U) |
|
|
8001af6: 683b ldr r3, [r7, #0]
|
|
8001af8: 689b ldr r3, [r3, #8]
|
|
8001afa: 0419 lsls r1, r3, #16
|
|
(0x0000FFFFU & (uint32_t)sFilterConfig->FilterIdHigh);
|
|
8001afc: 683b ldr r3, [r7, #0]
|
|
8001afe: 681b ldr r3, [r3, #0]
|
|
8001b00: b29a uxth r2, r3
|
|
can_ip->sFilterRegister[sFilterConfig->FilterBank].FR2 =
|
|
8001b02: 683b ldr r3, [r7, #0]
|
|
8001b04: 695b ldr r3, [r3, #20]
|
|
((0x0000FFFFU & (uint32_t)sFilterConfig->FilterMaskIdHigh) << 16U) |
|
|
8001b06: 430a orrs r2, r1
|
|
can_ip->sFilterRegister[sFilterConfig->FilterBank].FR2 =
|
|
8001b08: 6939 ldr r1, [r7, #16]
|
|
8001b0a: 3348 adds r3, #72 @ 0x48
|
|
8001b0c: 00db lsls r3, r3, #3
|
|
8001b0e: 440b add r3, r1
|
|
8001b10: 605a str r2, [r3, #4]
|
|
}
|
|
|
|
if (sFilterConfig->FilterScale == CAN_FILTERSCALE_32BIT)
|
|
8001b12: 683b ldr r3, [r7, #0]
|
|
8001b14: 69db ldr r3, [r3, #28]
|
|
8001b16: 2b01 cmp r3, #1
|
|
8001b18: d122 bne.n 8001b60 <HAL_CAN_ConfigFilter+0x1f4>
|
|
{
|
|
/* 32-bit scale for the filter */
|
|
SET_BIT(can_ip->FS1R, filternbrbitpos);
|
|
8001b1a: 693b ldr r3, [r7, #16]
|
|
8001b1c: f8d3 220c ldr.w r2, [r3, #524] @ 0x20c
|
|
8001b20: 68fb ldr r3, [r7, #12]
|
|
8001b22: 431a orrs r2, r3
|
|
8001b24: 693b ldr r3, [r7, #16]
|
|
8001b26: f8c3 220c str.w r2, [r3, #524] @ 0x20c
|
|
|
|
/* 32-bit identifier or First 32-bit identifier */
|
|
can_ip->sFilterRegister[sFilterConfig->FilterBank].FR1 =
|
|
((0x0000FFFFU & (uint32_t)sFilterConfig->FilterIdHigh) << 16U) |
|
|
8001b2a: 683b ldr r3, [r7, #0]
|
|
8001b2c: 681b ldr r3, [r3, #0]
|
|
8001b2e: 0419 lsls r1, r3, #16
|
|
(0x0000FFFFU & (uint32_t)sFilterConfig->FilterIdLow);
|
|
8001b30: 683b ldr r3, [r7, #0]
|
|
8001b32: 685b ldr r3, [r3, #4]
|
|
8001b34: b29b uxth r3, r3
|
|
can_ip->sFilterRegister[sFilterConfig->FilterBank].FR1 =
|
|
8001b36: 683a ldr r2, [r7, #0]
|
|
8001b38: 6952 ldr r2, [r2, #20]
|
|
((0x0000FFFFU & (uint32_t)sFilterConfig->FilterIdHigh) << 16U) |
|
|
8001b3a: 4319 orrs r1, r3
|
|
can_ip->sFilterRegister[sFilterConfig->FilterBank].FR1 =
|
|
8001b3c: 693b ldr r3, [r7, #16]
|
|
8001b3e: 3248 adds r2, #72 @ 0x48
|
|
8001b40: f843 1032 str.w r1, [r3, r2, lsl #3]
|
|
|
|
/* 32-bit mask or Second 32-bit identifier */
|
|
can_ip->sFilterRegister[sFilterConfig->FilterBank].FR2 =
|
|
((0x0000FFFFU & (uint32_t)sFilterConfig->FilterMaskIdHigh) << 16U) |
|
|
8001b44: 683b ldr r3, [r7, #0]
|
|
8001b46: 689b ldr r3, [r3, #8]
|
|
8001b48: 0419 lsls r1, r3, #16
|
|
(0x0000FFFFU & (uint32_t)sFilterConfig->FilterMaskIdLow);
|
|
8001b4a: 683b ldr r3, [r7, #0]
|
|
8001b4c: 68db ldr r3, [r3, #12]
|
|
8001b4e: b29a uxth r2, r3
|
|
can_ip->sFilterRegister[sFilterConfig->FilterBank].FR2 =
|
|
8001b50: 683b ldr r3, [r7, #0]
|
|
8001b52: 695b ldr r3, [r3, #20]
|
|
((0x0000FFFFU & (uint32_t)sFilterConfig->FilterMaskIdHigh) << 16U) |
|
|
8001b54: 430a orrs r2, r1
|
|
can_ip->sFilterRegister[sFilterConfig->FilterBank].FR2 =
|
|
8001b56: 6939 ldr r1, [r7, #16]
|
|
8001b58: 3348 adds r3, #72 @ 0x48
|
|
8001b5a: 00db lsls r3, r3, #3
|
|
8001b5c: 440b add r3, r1
|
|
8001b5e: 605a str r2, [r3, #4]
|
|
}
|
|
|
|
/* Filter Mode */
|
|
if (sFilterConfig->FilterMode == CAN_FILTERMODE_IDMASK)
|
|
8001b60: 683b ldr r3, [r7, #0]
|
|
8001b62: 699b ldr r3, [r3, #24]
|
|
8001b64: 2b00 cmp r3, #0
|
|
8001b66: d109 bne.n 8001b7c <HAL_CAN_ConfigFilter+0x210>
|
|
{
|
|
/* Id/Mask mode for the filter*/
|
|
CLEAR_BIT(can_ip->FM1R, filternbrbitpos);
|
|
8001b68: 693b ldr r3, [r7, #16]
|
|
8001b6a: f8d3 2204 ldr.w r2, [r3, #516] @ 0x204
|
|
8001b6e: 68fb ldr r3, [r7, #12]
|
|
8001b70: 43db mvns r3, r3
|
|
8001b72: 401a ands r2, r3
|
|
8001b74: 693b ldr r3, [r7, #16]
|
|
8001b76: f8c3 2204 str.w r2, [r3, #516] @ 0x204
|
|
8001b7a: e007 b.n 8001b8c <HAL_CAN_ConfigFilter+0x220>
|
|
}
|
|
else /* CAN_FilterInitStruct->CAN_FilterMode == CAN_FilterMode_IdList */
|
|
{
|
|
/* Identifier list mode for the filter*/
|
|
SET_BIT(can_ip->FM1R, filternbrbitpos);
|
|
8001b7c: 693b ldr r3, [r7, #16]
|
|
8001b7e: f8d3 2204 ldr.w r2, [r3, #516] @ 0x204
|
|
8001b82: 68fb ldr r3, [r7, #12]
|
|
8001b84: 431a orrs r2, r3
|
|
8001b86: 693b ldr r3, [r7, #16]
|
|
8001b88: f8c3 2204 str.w r2, [r3, #516] @ 0x204
|
|
}
|
|
|
|
/* Filter FIFO assignment */
|
|
if (sFilterConfig->FilterFIFOAssignment == CAN_FILTER_FIFO0)
|
|
8001b8c: 683b ldr r3, [r7, #0]
|
|
8001b8e: 691b ldr r3, [r3, #16]
|
|
8001b90: 2b00 cmp r3, #0
|
|
8001b92: d109 bne.n 8001ba8 <HAL_CAN_ConfigFilter+0x23c>
|
|
{
|
|
/* FIFO 0 assignation for the filter */
|
|
CLEAR_BIT(can_ip->FFA1R, filternbrbitpos);
|
|
8001b94: 693b ldr r3, [r7, #16]
|
|
8001b96: f8d3 2214 ldr.w r2, [r3, #532] @ 0x214
|
|
8001b9a: 68fb ldr r3, [r7, #12]
|
|
8001b9c: 43db mvns r3, r3
|
|
8001b9e: 401a ands r2, r3
|
|
8001ba0: 693b ldr r3, [r7, #16]
|
|
8001ba2: f8c3 2214 str.w r2, [r3, #532] @ 0x214
|
|
8001ba6: e007 b.n 8001bb8 <HAL_CAN_ConfigFilter+0x24c>
|
|
}
|
|
else
|
|
{
|
|
/* FIFO 1 assignation for the filter */
|
|
SET_BIT(can_ip->FFA1R, filternbrbitpos);
|
|
8001ba8: 693b ldr r3, [r7, #16]
|
|
8001baa: f8d3 2214 ldr.w r2, [r3, #532] @ 0x214
|
|
8001bae: 68fb ldr r3, [r7, #12]
|
|
8001bb0: 431a orrs r2, r3
|
|
8001bb2: 693b ldr r3, [r7, #16]
|
|
8001bb4: f8c3 2214 str.w r2, [r3, #532] @ 0x214
|
|
}
|
|
|
|
/* Filter activation */
|
|
if (sFilterConfig->FilterActivation == CAN_FILTER_ENABLE)
|
|
8001bb8: 683b ldr r3, [r7, #0]
|
|
8001bba: 6a1b ldr r3, [r3, #32]
|
|
8001bbc: 2b01 cmp r3, #1
|
|
8001bbe: d107 bne.n 8001bd0 <HAL_CAN_ConfigFilter+0x264>
|
|
{
|
|
SET_BIT(can_ip->FA1R, filternbrbitpos);
|
|
8001bc0: 693b ldr r3, [r7, #16]
|
|
8001bc2: f8d3 221c ldr.w r2, [r3, #540] @ 0x21c
|
|
8001bc6: 68fb ldr r3, [r7, #12]
|
|
8001bc8: 431a orrs r2, r3
|
|
8001bca: 693b ldr r3, [r7, #16]
|
|
8001bcc: f8c3 221c str.w r2, [r3, #540] @ 0x21c
|
|
}
|
|
|
|
/* Leave the initialisation mode for the filter */
|
|
CLEAR_BIT(can_ip->FMR, CAN_FMR_FINIT);
|
|
8001bd0: 693b ldr r3, [r7, #16]
|
|
8001bd2: f8d3 3200 ldr.w r3, [r3, #512] @ 0x200
|
|
8001bd6: f023 0201 bic.w r2, r3, #1
|
|
8001bda: 693b ldr r3, [r7, #16]
|
|
8001bdc: f8c3 2200 str.w r2, [r3, #512] @ 0x200
|
|
|
|
/* Return function status */
|
|
return HAL_OK;
|
|
8001be0: 2300 movs r3, #0
|
|
8001be2: e006 b.n 8001bf2 <HAL_CAN_ConfigFilter+0x286>
|
|
}
|
|
else
|
|
{
|
|
/* Update error code */
|
|
hcan->ErrorCode |= HAL_CAN_ERROR_NOT_INITIALIZED;
|
|
8001be4: 687b ldr r3, [r7, #4]
|
|
8001be6: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
8001be8: f443 2280 orr.w r2, r3, #262144 @ 0x40000
|
|
8001bec: 687b ldr r3, [r7, #4]
|
|
8001bee: 625a str r2, [r3, #36] @ 0x24
|
|
|
|
return HAL_ERROR;
|
|
8001bf0: 2301 movs r3, #1
|
|
}
|
|
}
|
|
8001bf2: 4618 mov r0, r3
|
|
8001bf4: 3718 adds r7, #24
|
|
8001bf6: 46bd mov sp, r7
|
|
8001bf8: bd80 pop {r7, pc}
|
|
8001bfa: bf00 nop
|
|
8001bfc: 0800a0bc .word 0x0800a0bc
|
|
8001c00: 40006400 .word 0x40006400
|
|
|
|
08001c04 <HAL_CAN_Start>:
|
|
* @param hcan pointer to an CAN_HandleTypeDef structure that contains
|
|
* the configuration information for the specified CAN.
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_CAN_Start(CAN_HandleTypeDef *hcan)
|
|
{
|
|
8001c04: b580 push {r7, lr}
|
|
8001c06: b084 sub sp, #16
|
|
8001c08: af00 add r7, sp, #0
|
|
8001c0a: 6078 str r0, [r7, #4]
|
|
uint32_t tickstart;
|
|
|
|
if (hcan->State == HAL_CAN_STATE_READY)
|
|
8001c0c: 687b ldr r3, [r7, #4]
|
|
8001c0e: f893 3020 ldrb.w r3, [r3, #32]
|
|
8001c12: b2db uxtb r3, r3
|
|
8001c14: 2b01 cmp r3, #1
|
|
8001c16: d12e bne.n 8001c76 <HAL_CAN_Start+0x72>
|
|
{
|
|
/* Change CAN peripheral state */
|
|
hcan->State = HAL_CAN_STATE_LISTENING;
|
|
8001c18: 687b ldr r3, [r7, #4]
|
|
8001c1a: 2202 movs r2, #2
|
|
8001c1c: f883 2020 strb.w r2, [r3, #32]
|
|
|
|
/* Request leave initialisation */
|
|
CLEAR_BIT(hcan->Instance->MCR, CAN_MCR_INRQ);
|
|
8001c20: 687b ldr r3, [r7, #4]
|
|
8001c22: 681b ldr r3, [r3, #0]
|
|
8001c24: 681a ldr r2, [r3, #0]
|
|
8001c26: 687b ldr r3, [r7, #4]
|
|
8001c28: 681b ldr r3, [r3, #0]
|
|
8001c2a: f022 0201 bic.w r2, r2, #1
|
|
8001c2e: 601a str r2, [r3, #0]
|
|
|
|
/* Get tick */
|
|
tickstart = HAL_GetTick();
|
|
8001c30: f7ff fc02 bl 8001438 <HAL_GetTick>
|
|
8001c34: 60f8 str r0, [r7, #12]
|
|
|
|
/* Wait the acknowledge */
|
|
while ((hcan->Instance->MSR & CAN_MSR_INAK) != 0U)
|
|
8001c36: e012 b.n 8001c5e <HAL_CAN_Start+0x5a>
|
|
{
|
|
/* Check for the Timeout */
|
|
if ((HAL_GetTick() - tickstart) > CAN_TIMEOUT_VALUE)
|
|
8001c38: f7ff fbfe bl 8001438 <HAL_GetTick>
|
|
8001c3c: 4602 mov r2, r0
|
|
8001c3e: 68fb ldr r3, [r7, #12]
|
|
8001c40: 1ad3 subs r3, r2, r3
|
|
8001c42: 2b0a cmp r3, #10
|
|
8001c44: d90b bls.n 8001c5e <HAL_CAN_Start+0x5a>
|
|
{
|
|
/* Update error code */
|
|
hcan->ErrorCode |= HAL_CAN_ERROR_TIMEOUT;
|
|
8001c46: 687b ldr r3, [r7, #4]
|
|
8001c48: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
8001c4a: f443 3200 orr.w r2, r3, #131072 @ 0x20000
|
|
8001c4e: 687b ldr r3, [r7, #4]
|
|
8001c50: 625a str r2, [r3, #36] @ 0x24
|
|
|
|
/* Change CAN state */
|
|
hcan->State = HAL_CAN_STATE_ERROR;
|
|
8001c52: 687b ldr r3, [r7, #4]
|
|
8001c54: 2205 movs r2, #5
|
|
8001c56: f883 2020 strb.w r2, [r3, #32]
|
|
|
|
return HAL_ERROR;
|
|
8001c5a: 2301 movs r3, #1
|
|
8001c5c: e012 b.n 8001c84 <HAL_CAN_Start+0x80>
|
|
while ((hcan->Instance->MSR & CAN_MSR_INAK) != 0U)
|
|
8001c5e: 687b ldr r3, [r7, #4]
|
|
8001c60: 681b ldr r3, [r3, #0]
|
|
8001c62: 685b ldr r3, [r3, #4]
|
|
8001c64: f003 0301 and.w r3, r3, #1
|
|
8001c68: 2b00 cmp r3, #0
|
|
8001c6a: d1e5 bne.n 8001c38 <HAL_CAN_Start+0x34>
|
|
}
|
|
}
|
|
|
|
/* Reset the CAN ErrorCode */
|
|
hcan->ErrorCode = HAL_CAN_ERROR_NONE;
|
|
8001c6c: 687b ldr r3, [r7, #4]
|
|
8001c6e: 2200 movs r2, #0
|
|
8001c70: 625a str r2, [r3, #36] @ 0x24
|
|
|
|
/* Return function status */
|
|
return HAL_OK;
|
|
8001c72: 2300 movs r3, #0
|
|
8001c74: e006 b.n 8001c84 <HAL_CAN_Start+0x80>
|
|
}
|
|
else
|
|
{
|
|
/* Update error code */
|
|
hcan->ErrorCode |= HAL_CAN_ERROR_NOT_READY;
|
|
8001c76: 687b ldr r3, [r7, #4]
|
|
8001c78: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
8001c7a: f443 2200 orr.w r2, r3, #524288 @ 0x80000
|
|
8001c7e: 687b ldr r3, [r7, #4]
|
|
8001c80: 625a str r2, [r3, #36] @ 0x24
|
|
|
|
return HAL_ERROR;
|
|
8001c82: 2301 movs r3, #1
|
|
}
|
|
}
|
|
8001c84: 4618 mov r0, r3
|
|
8001c86: 3710 adds r7, #16
|
|
8001c88: 46bd mov sp, r7
|
|
8001c8a: bd80 pop {r7, pc}
|
|
|
|
08001c8c <HAL_CAN_GetRxMessage>:
|
|
* @param aData array where the payload of the Rx frame will be stored.
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_CAN_GetRxMessage(CAN_HandleTypeDef *hcan, uint32_t RxFifo,
|
|
CAN_RxHeaderTypeDef *pHeader, uint8_t aData[])
|
|
{
|
|
8001c8c: b580 push {r7, lr}
|
|
8001c8e: b086 sub sp, #24
|
|
8001c90: af00 add r7, sp, #0
|
|
8001c92: 60f8 str r0, [r7, #12]
|
|
8001c94: 60b9 str r1, [r7, #8]
|
|
8001c96: 607a str r2, [r7, #4]
|
|
8001c98: 603b str r3, [r7, #0]
|
|
HAL_CAN_StateTypeDef state = hcan->State;
|
|
8001c9a: 68fb ldr r3, [r7, #12]
|
|
8001c9c: f893 3020 ldrb.w r3, [r3, #32]
|
|
8001ca0: 75fb strb r3, [r7, #23]
|
|
|
|
assert_param(IS_CAN_RX_FIFO(RxFifo));
|
|
8001ca2: 68bb ldr r3, [r7, #8]
|
|
8001ca4: 2b00 cmp r3, #0
|
|
8001ca6: d007 beq.n 8001cb8 <HAL_CAN_GetRxMessage+0x2c>
|
|
8001ca8: 68bb ldr r3, [r7, #8]
|
|
8001caa: 2b01 cmp r3, #1
|
|
8001cac: d004 beq.n 8001cb8 <HAL_CAN_GetRxMessage+0x2c>
|
|
8001cae: f240 51eb movw r1, #1515 @ 0x5eb
|
|
8001cb2: 488c ldr r0, [pc, #560] @ (8001ee4 <HAL_CAN_GetRxMessage+0x258>)
|
|
8001cb4: f7ff f83e bl 8000d34 <assert_failed>
|
|
|
|
if ((state == HAL_CAN_STATE_READY) ||
|
|
8001cb8: 7dfb ldrb r3, [r7, #23]
|
|
8001cba: 2b01 cmp r3, #1
|
|
8001cbc: d003 beq.n 8001cc6 <HAL_CAN_GetRxMessage+0x3a>
|
|
8001cbe: 7dfb ldrb r3, [r7, #23]
|
|
8001cc0: 2b02 cmp r3, #2
|
|
8001cc2: f040 8103 bne.w 8001ecc <HAL_CAN_GetRxMessage+0x240>
|
|
(state == HAL_CAN_STATE_LISTENING))
|
|
{
|
|
/* Check the Rx FIFO */
|
|
if (RxFifo == CAN_RX_FIFO0) /* Rx element is assigned to Rx FIFO 0 */
|
|
8001cc6: 68bb ldr r3, [r7, #8]
|
|
8001cc8: 2b00 cmp r3, #0
|
|
8001cca: d10e bne.n 8001cea <HAL_CAN_GetRxMessage+0x5e>
|
|
{
|
|
/* Check that the Rx FIFO 0 is not empty */
|
|
if ((hcan->Instance->RF0R & CAN_RF0R_FMP0) == 0U)
|
|
8001ccc: 68fb ldr r3, [r7, #12]
|
|
8001cce: 681b ldr r3, [r3, #0]
|
|
8001cd0: 68db ldr r3, [r3, #12]
|
|
8001cd2: f003 0303 and.w r3, r3, #3
|
|
8001cd6: 2b00 cmp r3, #0
|
|
8001cd8: d116 bne.n 8001d08 <HAL_CAN_GetRxMessage+0x7c>
|
|
{
|
|
/* Update error code */
|
|
hcan->ErrorCode |= HAL_CAN_ERROR_PARAM;
|
|
8001cda: 68fb ldr r3, [r7, #12]
|
|
8001cdc: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
8001cde: f443 1200 orr.w r2, r3, #2097152 @ 0x200000
|
|
8001ce2: 68fb ldr r3, [r7, #12]
|
|
8001ce4: 625a str r2, [r3, #36] @ 0x24
|
|
|
|
return HAL_ERROR;
|
|
8001ce6: 2301 movs r3, #1
|
|
8001ce8: e0f7 b.n 8001eda <HAL_CAN_GetRxMessage+0x24e>
|
|
}
|
|
}
|
|
else /* Rx element is assigned to Rx FIFO 1 */
|
|
{
|
|
/* Check that the Rx FIFO 1 is not empty */
|
|
if ((hcan->Instance->RF1R & CAN_RF1R_FMP1) == 0U)
|
|
8001cea: 68fb ldr r3, [r7, #12]
|
|
8001cec: 681b ldr r3, [r3, #0]
|
|
8001cee: 691b ldr r3, [r3, #16]
|
|
8001cf0: f003 0303 and.w r3, r3, #3
|
|
8001cf4: 2b00 cmp r3, #0
|
|
8001cf6: d107 bne.n 8001d08 <HAL_CAN_GetRxMessage+0x7c>
|
|
{
|
|
/* Update error code */
|
|
hcan->ErrorCode |= HAL_CAN_ERROR_PARAM;
|
|
8001cf8: 68fb ldr r3, [r7, #12]
|
|
8001cfa: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
8001cfc: f443 1200 orr.w r2, r3, #2097152 @ 0x200000
|
|
8001d00: 68fb ldr r3, [r7, #12]
|
|
8001d02: 625a str r2, [r3, #36] @ 0x24
|
|
|
|
return HAL_ERROR;
|
|
8001d04: 2301 movs r3, #1
|
|
8001d06: e0e8 b.n 8001eda <HAL_CAN_GetRxMessage+0x24e>
|
|
}
|
|
}
|
|
|
|
/* Get the header */
|
|
pHeader->IDE = CAN_RI0R_IDE & hcan->Instance->sFIFOMailBox[RxFifo].RIR;
|
|
8001d08: 68fb ldr r3, [r7, #12]
|
|
8001d0a: 681a ldr r2, [r3, #0]
|
|
8001d0c: 68bb ldr r3, [r7, #8]
|
|
8001d0e: 331b adds r3, #27
|
|
8001d10: 011b lsls r3, r3, #4
|
|
8001d12: 4413 add r3, r2
|
|
8001d14: 681b ldr r3, [r3, #0]
|
|
8001d16: f003 0204 and.w r2, r3, #4
|
|
8001d1a: 687b ldr r3, [r7, #4]
|
|
8001d1c: 609a str r2, [r3, #8]
|
|
if (pHeader->IDE == CAN_ID_STD)
|
|
8001d1e: 687b ldr r3, [r7, #4]
|
|
8001d20: 689b ldr r3, [r3, #8]
|
|
8001d22: 2b00 cmp r3, #0
|
|
8001d24: d10c bne.n 8001d40 <HAL_CAN_GetRxMessage+0xb4>
|
|
{
|
|
pHeader->StdId = (CAN_RI0R_STID & hcan->Instance->sFIFOMailBox[RxFifo].RIR) >> CAN_TI0R_STID_Pos;
|
|
8001d26: 68fb ldr r3, [r7, #12]
|
|
8001d28: 681a ldr r2, [r3, #0]
|
|
8001d2a: 68bb ldr r3, [r7, #8]
|
|
8001d2c: 331b adds r3, #27
|
|
8001d2e: 011b lsls r3, r3, #4
|
|
8001d30: 4413 add r3, r2
|
|
8001d32: 681b ldr r3, [r3, #0]
|
|
8001d34: 0d5b lsrs r3, r3, #21
|
|
8001d36: f3c3 020a ubfx r2, r3, #0, #11
|
|
8001d3a: 687b ldr r3, [r7, #4]
|
|
8001d3c: 601a str r2, [r3, #0]
|
|
8001d3e: e00b b.n 8001d58 <HAL_CAN_GetRxMessage+0xcc>
|
|
}
|
|
else
|
|
{
|
|
pHeader->ExtId = ((CAN_RI0R_EXID | CAN_RI0R_STID) &
|
|
hcan->Instance->sFIFOMailBox[RxFifo].RIR) >> CAN_RI0R_EXID_Pos;
|
|
8001d40: 68fb ldr r3, [r7, #12]
|
|
8001d42: 681a ldr r2, [r3, #0]
|
|
8001d44: 68bb ldr r3, [r7, #8]
|
|
8001d46: 331b adds r3, #27
|
|
8001d48: 011b lsls r3, r3, #4
|
|
8001d4a: 4413 add r3, r2
|
|
8001d4c: 681b ldr r3, [r3, #0]
|
|
8001d4e: 08db lsrs r3, r3, #3
|
|
8001d50: f023 4260 bic.w r2, r3, #3758096384 @ 0xe0000000
|
|
pHeader->ExtId = ((CAN_RI0R_EXID | CAN_RI0R_STID) &
|
|
8001d54: 687b ldr r3, [r7, #4]
|
|
8001d56: 605a str r2, [r3, #4]
|
|
}
|
|
pHeader->RTR = (CAN_RI0R_RTR & hcan->Instance->sFIFOMailBox[RxFifo].RIR);
|
|
8001d58: 68fb ldr r3, [r7, #12]
|
|
8001d5a: 681a ldr r2, [r3, #0]
|
|
8001d5c: 68bb ldr r3, [r7, #8]
|
|
8001d5e: 331b adds r3, #27
|
|
8001d60: 011b lsls r3, r3, #4
|
|
8001d62: 4413 add r3, r2
|
|
8001d64: 681b ldr r3, [r3, #0]
|
|
8001d66: f003 0202 and.w r2, r3, #2
|
|
8001d6a: 687b ldr r3, [r7, #4]
|
|
8001d6c: 60da str r2, [r3, #12]
|
|
if (((CAN_RDT0R_DLC & hcan->Instance->sFIFOMailBox[RxFifo].RDTR) >> CAN_RDT0R_DLC_Pos) >= 8U)
|
|
8001d6e: 68fb ldr r3, [r7, #12]
|
|
8001d70: 681a ldr r2, [r3, #0]
|
|
8001d72: 68bb ldr r3, [r7, #8]
|
|
8001d74: 331b adds r3, #27
|
|
8001d76: 011b lsls r3, r3, #4
|
|
8001d78: 4413 add r3, r2
|
|
8001d7a: 3304 adds r3, #4
|
|
8001d7c: 681b ldr r3, [r3, #0]
|
|
8001d7e: f003 0308 and.w r3, r3, #8
|
|
8001d82: 2b00 cmp r3, #0
|
|
8001d84: d003 beq.n 8001d8e <HAL_CAN_GetRxMessage+0x102>
|
|
{
|
|
/* Truncate DLC to 8 if received field is over range */
|
|
pHeader->DLC = 8U;
|
|
8001d86: 687b ldr r3, [r7, #4]
|
|
8001d88: 2208 movs r2, #8
|
|
8001d8a: 611a str r2, [r3, #16]
|
|
8001d8c: e00b b.n 8001da6 <HAL_CAN_GetRxMessage+0x11a>
|
|
}
|
|
else
|
|
{
|
|
pHeader->DLC = (CAN_RDT0R_DLC & hcan->Instance->sFIFOMailBox[RxFifo].RDTR) >> CAN_RDT0R_DLC_Pos;
|
|
8001d8e: 68fb ldr r3, [r7, #12]
|
|
8001d90: 681a ldr r2, [r3, #0]
|
|
8001d92: 68bb ldr r3, [r7, #8]
|
|
8001d94: 331b adds r3, #27
|
|
8001d96: 011b lsls r3, r3, #4
|
|
8001d98: 4413 add r3, r2
|
|
8001d9a: 3304 adds r3, #4
|
|
8001d9c: 681b ldr r3, [r3, #0]
|
|
8001d9e: f003 020f and.w r2, r3, #15
|
|
8001da2: 687b ldr r3, [r7, #4]
|
|
8001da4: 611a str r2, [r3, #16]
|
|
}
|
|
pHeader->FilterMatchIndex = (CAN_RDT0R_FMI & hcan->Instance->sFIFOMailBox[RxFifo].RDTR) >> CAN_RDT0R_FMI_Pos;
|
|
8001da6: 68fb ldr r3, [r7, #12]
|
|
8001da8: 681a ldr r2, [r3, #0]
|
|
8001daa: 68bb ldr r3, [r7, #8]
|
|
8001dac: 331b adds r3, #27
|
|
8001dae: 011b lsls r3, r3, #4
|
|
8001db0: 4413 add r3, r2
|
|
8001db2: 3304 adds r3, #4
|
|
8001db4: 681b ldr r3, [r3, #0]
|
|
8001db6: 0a1b lsrs r3, r3, #8
|
|
8001db8: b2da uxtb r2, r3
|
|
8001dba: 687b ldr r3, [r7, #4]
|
|
8001dbc: 619a str r2, [r3, #24]
|
|
pHeader->Timestamp = (CAN_RDT0R_TIME & hcan->Instance->sFIFOMailBox[RxFifo].RDTR) >> CAN_RDT0R_TIME_Pos;
|
|
8001dbe: 68fb ldr r3, [r7, #12]
|
|
8001dc0: 681a ldr r2, [r3, #0]
|
|
8001dc2: 68bb ldr r3, [r7, #8]
|
|
8001dc4: 331b adds r3, #27
|
|
8001dc6: 011b lsls r3, r3, #4
|
|
8001dc8: 4413 add r3, r2
|
|
8001dca: 3304 adds r3, #4
|
|
8001dcc: 681b ldr r3, [r3, #0]
|
|
8001dce: 0c1b lsrs r3, r3, #16
|
|
8001dd0: b29a uxth r2, r3
|
|
8001dd2: 687b ldr r3, [r7, #4]
|
|
8001dd4: 615a str r2, [r3, #20]
|
|
|
|
/* Get the data */
|
|
aData[0] = (uint8_t)((CAN_RDL0R_DATA0 & hcan->Instance->sFIFOMailBox[RxFifo].RDLR) >> CAN_RDL0R_DATA0_Pos);
|
|
8001dd6: 68fb ldr r3, [r7, #12]
|
|
8001dd8: 681a ldr r2, [r3, #0]
|
|
8001dda: 68bb ldr r3, [r7, #8]
|
|
8001ddc: 011b lsls r3, r3, #4
|
|
8001dde: 4413 add r3, r2
|
|
8001de0: f503 73dc add.w r3, r3, #440 @ 0x1b8
|
|
8001de4: 681b ldr r3, [r3, #0]
|
|
8001de6: b2da uxtb r2, r3
|
|
8001de8: 683b ldr r3, [r7, #0]
|
|
8001dea: 701a strb r2, [r3, #0]
|
|
aData[1] = (uint8_t)((CAN_RDL0R_DATA1 & hcan->Instance->sFIFOMailBox[RxFifo].RDLR) >> CAN_RDL0R_DATA1_Pos);
|
|
8001dec: 68fb ldr r3, [r7, #12]
|
|
8001dee: 681a ldr r2, [r3, #0]
|
|
8001df0: 68bb ldr r3, [r7, #8]
|
|
8001df2: 011b lsls r3, r3, #4
|
|
8001df4: 4413 add r3, r2
|
|
8001df6: f503 73dc add.w r3, r3, #440 @ 0x1b8
|
|
8001dfa: 681b ldr r3, [r3, #0]
|
|
8001dfc: 0a1a lsrs r2, r3, #8
|
|
8001dfe: 683b ldr r3, [r7, #0]
|
|
8001e00: 3301 adds r3, #1
|
|
8001e02: b2d2 uxtb r2, r2
|
|
8001e04: 701a strb r2, [r3, #0]
|
|
aData[2] = (uint8_t)((CAN_RDL0R_DATA2 & hcan->Instance->sFIFOMailBox[RxFifo].RDLR) >> CAN_RDL0R_DATA2_Pos);
|
|
8001e06: 68fb ldr r3, [r7, #12]
|
|
8001e08: 681a ldr r2, [r3, #0]
|
|
8001e0a: 68bb ldr r3, [r7, #8]
|
|
8001e0c: 011b lsls r3, r3, #4
|
|
8001e0e: 4413 add r3, r2
|
|
8001e10: f503 73dc add.w r3, r3, #440 @ 0x1b8
|
|
8001e14: 681b ldr r3, [r3, #0]
|
|
8001e16: 0c1a lsrs r2, r3, #16
|
|
8001e18: 683b ldr r3, [r7, #0]
|
|
8001e1a: 3302 adds r3, #2
|
|
8001e1c: b2d2 uxtb r2, r2
|
|
8001e1e: 701a strb r2, [r3, #0]
|
|
aData[3] = (uint8_t)((CAN_RDL0R_DATA3 & hcan->Instance->sFIFOMailBox[RxFifo].RDLR) >> CAN_RDL0R_DATA3_Pos);
|
|
8001e20: 68fb ldr r3, [r7, #12]
|
|
8001e22: 681a ldr r2, [r3, #0]
|
|
8001e24: 68bb ldr r3, [r7, #8]
|
|
8001e26: 011b lsls r3, r3, #4
|
|
8001e28: 4413 add r3, r2
|
|
8001e2a: f503 73dc add.w r3, r3, #440 @ 0x1b8
|
|
8001e2e: 681b ldr r3, [r3, #0]
|
|
8001e30: 0e1a lsrs r2, r3, #24
|
|
8001e32: 683b ldr r3, [r7, #0]
|
|
8001e34: 3303 adds r3, #3
|
|
8001e36: b2d2 uxtb r2, r2
|
|
8001e38: 701a strb r2, [r3, #0]
|
|
aData[4] = (uint8_t)((CAN_RDH0R_DATA4 & hcan->Instance->sFIFOMailBox[RxFifo].RDHR) >> CAN_RDH0R_DATA4_Pos);
|
|
8001e3a: 68fb ldr r3, [r7, #12]
|
|
8001e3c: 681a ldr r2, [r3, #0]
|
|
8001e3e: 68bb ldr r3, [r7, #8]
|
|
8001e40: 011b lsls r3, r3, #4
|
|
8001e42: 4413 add r3, r2
|
|
8001e44: f503 73de add.w r3, r3, #444 @ 0x1bc
|
|
8001e48: 681a ldr r2, [r3, #0]
|
|
8001e4a: 683b ldr r3, [r7, #0]
|
|
8001e4c: 3304 adds r3, #4
|
|
8001e4e: b2d2 uxtb r2, r2
|
|
8001e50: 701a strb r2, [r3, #0]
|
|
aData[5] = (uint8_t)((CAN_RDH0R_DATA5 & hcan->Instance->sFIFOMailBox[RxFifo].RDHR) >> CAN_RDH0R_DATA5_Pos);
|
|
8001e52: 68fb ldr r3, [r7, #12]
|
|
8001e54: 681a ldr r2, [r3, #0]
|
|
8001e56: 68bb ldr r3, [r7, #8]
|
|
8001e58: 011b lsls r3, r3, #4
|
|
8001e5a: 4413 add r3, r2
|
|
8001e5c: f503 73de add.w r3, r3, #444 @ 0x1bc
|
|
8001e60: 681b ldr r3, [r3, #0]
|
|
8001e62: 0a1a lsrs r2, r3, #8
|
|
8001e64: 683b ldr r3, [r7, #0]
|
|
8001e66: 3305 adds r3, #5
|
|
8001e68: b2d2 uxtb r2, r2
|
|
8001e6a: 701a strb r2, [r3, #0]
|
|
aData[6] = (uint8_t)((CAN_RDH0R_DATA6 & hcan->Instance->sFIFOMailBox[RxFifo].RDHR) >> CAN_RDH0R_DATA6_Pos);
|
|
8001e6c: 68fb ldr r3, [r7, #12]
|
|
8001e6e: 681a ldr r2, [r3, #0]
|
|
8001e70: 68bb ldr r3, [r7, #8]
|
|
8001e72: 011b lsls r3, r3, #4
|
|
8001e74: 4413 add r3, r2
|
|
8001e76: f503 73de add.w r3, r3, #444 @ 0x1bc
|
|
8001e7a: 681b ldr r3, [r3, #0]
|
|
8001e7c: 0c1a lsrs r2, r3, #16
|
|
8001e7e: 683b ldr r3, [r7, #0]
|
|
8001e80: 3306 adds r3, #6
|
|
8001e82: b2d2 uxtb r2, r2
|
|
8001e84: 701a strb r2, [r3, #0]
|
|
aData[7] = (uint8_t)((CAN_RDH0R_DATA7 & hcan->Instance->sFIFOMailBox[RxFifo].RDHR) >> CAN_RDH0R_DATA7_Pos);
|
|
8001e86: 68fb ldr r3, [r7, #12]
|
|
8001e88: 681a ldr r2, [r3, #0]
|
|
8001e8a: 68bb ldr r3, [r7, #8]
|
|
8001e8c: 011b lsls r3, r3, #4
|
|
8001e8e: 4413 add r3, r2
|
|
8001e90: f503 73de add.w r3, r3, #444 @ 0x1bc
|
|
8001e94: 681b ldr r3, [r3, #0]
|
|
8001e96: 0e1a lsrs r2, r3, #24
|
|
8001e98: 683b ldr r3, [r7, #0]
|
|
8001e9a: 3307 adds r3, #7
|
|
8001e9c: b2d2 uxtb r2, r2
|
|
8001e9e: 701a strb r2, [r3, #0]
|
|
|
|
/* Release the FIFO */
|
|
if (RxFifo == CAN_RX_FIFO0) /* Rx element is assigned to Rx FIFO 0 */
|
|
8001ea0: 68bb ldr r3, [r7, #8]
|
|
8001ea2: 2b00 cmp r3, #0
|
|
8001ea4: d108 bne.n 8001eb8 <HAL_CAN_GetRxMessage+0x22c>
|
|
{
|
|
/* Release RX FIFO 0 */
|
|
SET_BIT(hcan->Instance->RF0R, CAN_RF0R_RFOM0);
|
|
8001ea6: 68fb ldr r3, [r7, #12]
|
|
8001ea8: 681b ldr r3, [r3, #0]
|
|
8001eaa: 68da ldr r2, [r3, #12]
|
|
8001eac: 68fb ldr r3, [r7, #12]
|
|
8001eae: 681b ldr r3, [r3, #0]
|
|
8001eb0: f042 0220 orr.w r2, r2, #32
|
|
8001eb4: 60da str r2, [r3, #12]
|
|
8001eb6: e007 b.n 8001ec8 <HAL_CAN_GetRxMessage+0x23c>
|
|
}
|
|
else /* Rx element is assigned to Rx FIFO 1 */
|
|
{
|
|
/* Release RX FIFO 1 */
|
|
SET_BIT(hcan->Instance->RF1R, CAN_RF1R_RFOM1);
|
|
8001eb8: 68fb ldr r3, [r7, #12]
|
|
8001eba: 681b ldr r3, [r3, #0]
|
|
8001ebc: 691a ldr r2, [r3, #16]
|
|
8001ebe: 68fb ldr r3, [r7, #12]
|
|
8001ec0: 681b ldr r3, [r3, #0]
|
|
8001ec2: f042 0220 orr.w r2, r2, #32
|
|
8001ec6: 611a str r2, [r3, #16]
|
|
}
|
|
|
|
/* Return function status */
|
|
return HAL_OK;
|
|
8001ec8: 2300 movs r3, #0
|
|
8001eca: e006 b.n 8001eda <HAL_CAN_GetRxMessage+0x24e>
|
|
}
|
|
else
|
|
{
|
|
/* Update error code */
|
|
hcan->ErrorCode |= HAL_CAN_ERROR_NOT_INITIALIZED;
|
|
8001ecc: 68fb ldr r3, [r7, #12]
|
|
8001ece: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
8001ed0: f443 2280 orr.w r2, r3, #262144 @ 0x40000
|
|
8001ed4: 68fb ldr r3, [r7, #12]
|
|
8001ed6: 625a str r2, [r3, #36] @ 0x24
|
|
|
|
return HAL_ERROR;
|
|
8001ed8: 2301 movs r3, #1
|
|
}
|
|
}
|
|
8001eda: 4618 mov r0, r3
|
|
8001edc: 3718 adds r7, #24
|
|
8001ede: 46bd mov sp, r7
|
|
8001ee0: bd80 pop {r7, pc}
|
|
8001ee2: bf00 nop
|
|
8001ee4: 0800a0bc .word 0x0800a0bc
|
|
|
|
08001ee8 <HAL_CAN_ActivateNotification>:
|
|
* @param ActiveITs indicates which interrupts will be enabled.
|
|
* This parameter can be any combination of @arg CAN_Interrupts.
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_CAN_ActivateNotification(CAN_HandleTypeDef *hcan, uint32_t ActiveITs)
|
|
{
|
|
8001ee8: b580 push {r7, lr}
|
|
8001eea: b084 sub sp, #16
|
|
8001eec: af00 add r7, sp, #0
|
|
8001eee: 6078 str r0, [r7, #4]
|
|
8001ef0: 6039 str r1, [r7, #0]
|
|
HAL_CAN_StateTypeDef state = hcan->State;
|
|
8001ef2: 687b ldr r3, [r7, #4]
|
|
8001ef4: f893 3020 ldrb.w r3, [r3, #32]
|
|
8001ef8: 73fb strb r3, [r7, #15]
|
|
|
|
/* Check function parameters */
|
|
assert_param(IS_CAN_IT(ActiveITs));
|
|
8001efa: 683b ldr r3, [r7, #0]
|
|
8001efc: 4a11 ldr r2, [pc, #68] @ (8001f44 <HAL_CAN_ActivateNotification+0x5c>)
|
|
8001efe: 4293 cmp r3, r2
|
|
8001f00: d904 bls.n 8001f0c <HAL_CAN_ActivateNotification+0x24>
|
|
8001f02: f240 6184 movw r1, #1668 @ 0x684
|
|
8001f06: 4810 ldr r0, [pc, #64] @ (8001f48 <HAL_CAN_ActivateNotification+0x60>)
|
|
8001f08: f7fe ff14 bl 8000d34 <assert_failed>
|
|
|
|
if ((state == HAL_CAN_STATE_READY) ||
|
|
8001f0c: 7bfb ldrb r3, [r7, #15]
|
|
8001f0e: 2b01 cmp r3, #1
|
|
8001f10: d002 beq.n 8001f18 <HAL_CAN_ActivateNotification+0x30>
|
|
8001f12: 7bfb ldrb r3, [r7, #15]
|
|
8001f14: 2b02 cmp r3, #2
|
|
8001f16: d109 bne.n 8001f2c <HAL_CAN_ActivateNotification+0x44>
|
|
(state == HAL_CAN_STATE_LISTENING))
|
|
{
|
|
/* Enable the selected interrupts */
|
|
__HAL_CAN_ENABLE_IT(hcan, ActiveITs);
|
|
8001f18: 687b ldr r3, [r7, #4]
|
|
8001f1a: 681b ldr r3, [r3, #0]
|
|
8001f1c: 6959 ldr r1, [r3, #20]
|
|
8001f1e: 687b ldr r3, [r7, #4]
|
|
8001f20: 681b ldr r3, [r3, #0]
|
|
8001f22: 683a ldr r2, [r7, #0]
|
|
8001f24: 430a orrs r2, r1
|
|
8001f26: 615a str r2, [r3, #20]
|
|
|
|
/* Return function status */
|
|
return HAL_OK;
|
|
8001f28: 2300 movs r3, #0
|
|
8001f2a: e006 b.n 8001f3a <HAL_CAN_ActivateNotification+0x52>
|
|
}
|
|
else
|
|
{
|
|
/* Update error code */
|
|
hcan->ErrorCode |= HAL_CAN_ERROR_NOT_INITIALIZED;
|
|
8001f2c: 687b ldr r3, [r7, #4]
|
|
8001f2e: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
8001f30: f443 2280 orr.w r2, r3, #262144 @ 0x40000
|
|
8001f34: 687b ldr r3, [r7, #4]
|
|
8001f36: 625a str r2, [r3, #36] @ 0x24
|
|
|
|
return HAL_ERROR;
|
|
8001f38: 2301 movs r3, #1
|
|
}
|
|
}
|
|
8001f3a: 4618 mov r0, r3
|
|
8001f3c: 3710 adds r7, #16
|
|
8001f3e: 46bd mov sp, r7
|
|
8001f40: bd80 pop {r7, pc}
|
|
8001f42: bf00 nop
|
|
8001f44: 00038f7f .word 0x00038f7f
|
|
8001f48: 0800a0bc .word 0x0800a0bc
|
|
|
|
08001f4c <HAL_CAN_TxMailbox0CompleteCallback>:
|
|
* @param hcan pointer to a CAN_HandleTypeDef structure that contains
|
|
* the configuration information for the specified CAN.
|
|
* @retval None
|
|
*/
|
|
__weak void HAL_CAN_TxMailbox0CompleteCallback(CAN_HandleTypeDef *hcan)
|
|
{
|
|
8001f4c: b480 push {r7}
|
|
8001f4e: b083 sub sp, #12
|
|
8001f50: af00 add r7, sp, #0
|
|
8001f52: 6078 str r0, [r7, #4]
|
|
|
|
/* NOTE : This function Should not be modified, when the callback is needed,
|
|
the HAL_CAN_TxMailbox0CompleteCallback could be implemented in the
|
|
user file
|
|
*/
|
|
}
|
|
8001f54: bf00 nop
|
|
8001f56: 370c adds r7, #12
|
|
8001f58: 46bd mov sp, r7
|
|
8001f5a: f85d 7b04 ldr.w r7, [sp], #4
|
|
8001f5e: 4770 bx lr
|
|
|
|
08001f60 <HAL_CAN_TxMailbox1CompleteCallback>:
|
|
* @param hcan pointer to a CAN_HandleTypeDef structure that contains
|
|
* the configuration information for the specified CAN.
|
|
* @retval None
|
|
*/
|
|
__weak void HAL_CAN_TxMailbox1CompleteCallback(CAN_HandleTypeDef *hcan)
|
|
{
|
|
8001f60: b480 push {r7}
|
|
8001f62: b083 sub sp, #12
|
|
8001f64: af00 add r7, sp, #0
|
|
8001f66: 6078 str r0, [r7, #4]
|
|
|
|
/* NOTE : This function Should not be modified, when the callback is needed,
|
|
the HAL_CAN_TxMailbox1CompleteCallback could be implemented in the
|
|
user file
|
|
*/
|
|
}
|
|
8001f68: bf00 nop
|
|
8001f6a: 370c adds r7, #12
|
|
8001f6c: 46bd mov sp, r7
|
|
8001f6e: f85d 7b04 ldr.w r7, [sp], #4
|
|
8001f72: 4770 bx lr
|
|
|
|
08001f74 <HAL_CAN_TxMailbox2CompleteCallback>:
|
|
* @param hcan pointer to a CAN_HandleTypeDef structure that contains
|
|
* the configuration information for the specified CAN.
|
|
* @retval None
|
|
*/
|
|
__weak void HAL_CAN_TxMailbox2CompleteCallback(CAN_HandleTypeDef *hcan)
|
|
{
|
|
8001f74: b480 push {r7}
|
|
8001f76: b083 sub sp, #12
|
|
8001f78: af00 add r7, sp, #0
|
|
8001f7a: 6078 str r0, [r7, #4]
|
|
|
|
/* NOTE : This function Should not be modified, when the callback is needed,
|
|
the HAL_CAN_TxMailbox2CompleteCallback could be implemented in the
|
|
user file
|
|
*/
|
|
}
|
|
8001f7c: bf00 nop
|
|
8001f7e: 370c adds r7, #12
|
|
8001f80: 46bd mov sp, r7
|
|
8001f82: f85d 7b04 ldr.w r7, [sp], #4
|
|
8001f86: 4770 bx lr
|
|
|
|
08001f88 <HAL_CAN_TxMailbox0AbortCallback>:
|
|
* @param hcan pointer to an CAN_HandleTypeDef structure that contains
|
|
* the configuration information for the specified CAN.
|
|
* @retval None
|
|
*/
|
|
__weak void HAL_CAN_TxMailbox0AbortCallback(CAN_HandleTypeDef *hcan)
|
|
{
|
|
8001f88: b480 push {r7}
|
|
8001f8a: b083 sub sp, #12
|
|
8001f8c: af00 add r7, sp, #0
|
|
8001f8e: 6078 str r0, [r7, #4]
|
|
|
|
/* NOTE : This function Should not be modified, when the callback is needed,
|
|
the HAL_CAN_TxMailbox0AbortCallback could be implemented in the
|
|
user file
|
|
*/
|
|
}
|
|
8001f90: bf00 nop
|
|
8001f92: 370c adds r7, #12
|
|
8001f94: 46bd mov sp, r7
|
|
8001f96: f85d 7b04 ldr.w r7, [sp], #4
|
|
8001f9a: 4770 bx lr
|
|
|
|
08001f9c <HAL_CAN_TxMailbox1AbortCallback>:
|
|
* @param hcan pointer to an CAN_HandleTypeDef structure that contains
|
|
* the configuration information for the specified CAN.
|
|
* @retval None
|
|
*/
|
|
__weak void HAL_CAN_TxMailbox1AbortCallback(CAN_HandleTypeDef *hcan)
|
|
{
|
|
8001f9c: b480 push {r7}
|
|
8001f9e: b083 sub sp, #12
|
|
8001fa0: af00 add r7, sp, #0
|
|
8001fa2: 6078 str r0, [r7, #4]
|
|
|
|
/* NOTE : This function Should not be modified, when the callback is needed,
|
|
the HAL_CAN_TxMailbox1AbortCallback could be implemented in the
|
|
user file
|
|
*/
|
|
}
|
|
8001fa4: bf00 nop
|
|
8001fa6: 370c adds r7, #12
|
|
8001fa8: 46bd mov sp, r7
|
|
8001faa: f85d 7b04 ldr.w r7, [sp], #4
|
|
8001fae: 4770 bx lr
|
|
|
|
08001fb0 <HAL_CAN_TxMailbox2AbortCallback>:
|
|
* @param hcan pointer to an CAN_HandleTypeDef structure that contains
|
|
* the configuration information for the specified CAN.
|
|
* @retval None
|
|
*/
|
|
__weak void HAL_CAN_TxMailbox2AbortCallback(CAN_HandleTypeDef *hcan)
|
|
{
|
|
8001fb0: b480 push {r7}
|
|
8001fb2: b083 sub sp, #12
|
|
8001fb4: af00 add r7, sp, #0
|
|
8001fb6: 6078 str r0, [r7, #4]
|
|
|
|
/* NOTE : This function Should not be modified, when the callback is needed,
|
|
the HAL_CAN_TxMailbox2AbortCallback could be implemented in the
|
|
user file
|
|
*/
|
|
}
|
|
8001fb8: bf00 nop
|
|
8001fba: 370c adds r7, #12
|
|
8001fbc: 46bd mov sp, r7
|
|
8001fbe: f85d 7b04 ldr.w r7, [sp], #4
|
|
8001fc2: 4770 bx lr
|
|
|
|
08001fc4 <HAL_CAN_RxFifo0FullCallback>:
|
|
* @param hcan pointer to a CAN_HandleTypeDef structure that contains
|
|
* the configuration information for the specified CAN.
|
|
* @retval None
|
|
*/
|
|
__weak void HAL_CAN_RxFifo0FullCallback(CAN_HandleTypeDef *hcan)
|
|
{
|
|
8001fc4: b480 push {r7}
|
|
8001fc6: b083 sub sp, #12
|
|
8001fc8: af00 add r7, sp, #0
|
|
8001fca: 6078 str r0, [r7, #4]
|
|
|
|
/* NOTE : This function Should not be modified, when the callback is needed,
|
|
the HAL_CAN_RxFifo0FullCallback could be implemented in the user
|
|
file
|
|
*/
|
|
}
|
|
8001fcc: bf00 nop
|
|
8001fce: 370c adds r7, #12
|
|
8001fd0: 46bd mov sp, r7
|
|
8001fd2: f85d 7b04 ldr.w r7, [sp], #4
|
|
8001fd6: 4770 bx lr
|
|
|
|
08001fd8 <HAL_CAN_RxFifo1MsgPendingCallback>:
|
|
* @param hcan pointer to a CAN_HandleTypeDef structure that contains
|
|
* the configuration information for the specified CAN.
|
|
* @retval None
|
|
*/
|
|
__weak void HAL_CAN_RxFifo1MsgPendingCallback(CAN_HandleTypeDef *hcan)
|
|
{
|
|
8001fd8: b480 push {r7}
|
|
8001fda: b083 sub sp, #12
|
|
8001fdc: af00 add r7, sp, #0
|
|
8001fde: 6078 str r0, [r7, #4]
|
|
|
|
/* NOTE : This function Should not be modified, when the callback is needed,
|
|
the HAL_CAN_RxFifo1MsgPendingCallback could be implemented in the
|
|
user file
|
|
*/
|
|
}
|
|
8001fe0: bf00 nop
|
|
8001fe2: 370c adds r7, #12
|
|
8001fe4: 46bd mov sp, r7
|
|
8001fe6: f85d 7b04 ldr.w r7, [sp], #4
|
|
8001fea: 4770 bx lr
|
|
|
|
08001fec <HAL_CAN_RxFifo1FullCallback>:
|
|
* @param hcan pointer to a CAN_HandleTypeDef structure that contains
|
|
* the configuration information for the specified CAN.
|
|
* @retval None
|
|
*/
|
|
__weak void HAL_CAN_RxFifo1FullCallback(CAN_HandleTypeDef *hcan)
|
|
{
|
|
8001fec: b480 push {r7}
|
|
8001fee: b083 sub sp, #12
|
|
8001ff0: af00 add r7, sp, #0
|
|
8001ff2: 6078 str r0, [r7, #4]
|
|
|
|
/* NOTE : This function Should not be modified, when the callback is needed,
|
|
the HAL_CAN_RxFifo1FullCallback could be implemented in the user
|
|
file
|
|
*/
|
|
}
|
|
8001ff4: bf00 nop
|
|
8001ff6: 370c adds r7, #12
|
|
8001ff8: 46bd mov sp, r7
|
|
8001ffa: f85d 7b04 ldr.w r7, [sp], #4
|
|
8001ffe: 4770 bx lr
|
|
|
|
08002000 <HAL_CAN_SleepCallback>:
|
|
* @param hcan pointer to a CAN_HandleTypeDef structure that contains
|
|
* the configuration information for the specified CAN.
|
|
* @retval None
|
|
*/
|
|
__weak void HAL_CAN_SleepCallback(CAN_HandleTypeDef *hcan)
|
|
{
|
|
8002000: b480 push {r7}
|
|
8002002: b083 sub sp, #12
|
|
8002004: af00 add r7, sp, #0
|
|
8002006: 6078 str r0, [r7, #4]
|
|
UNUSED(hcan);
|
|
|
|
/* NOTE : This function Should not be modified, when the callback is needed,
|
|
the HAL_CAN_SleepCallback could be implemented in the user file
|
|
*/
|
|
}
|
|
8002008: bf00 nop
|
|
800200a: 370c adds r7, #12
|
|
800200c: 46bd mov sp, r7
|
|
800200e: f85d 7b04 ldr.w r7, [sp], #4
|
|
8002012: 4770 bx lr
|
|
|
|
08002014 <HAL_CAN_WakeUpFromRxMsgCallback>:
|
|
* @param hcan pointer to a CAN_HandleTypeDef structure that contains
|
|
* the configuration information for the specified CAN.
|
|
* @retval None
|
|
*/
|
|
__weak void HAL_CAN_WakeUpFromRxMsgCallback(CAN_HandleTypeDef *hcan)
|
|
{
|
|
8002014: b480 push {r7}
|
|
8002016: b083 sub sp, #12
|
|
8002018: af00 add r7, sp, #0
|
|
800201a: 6078 str r0, [r7, #4]
|
|
|
|
/* NOTE : This function Should not be modified, when the callback is needed,
|
|
the HAL_CAN_WakeUpFromRxMsgCallback could be implemented in the
|
|
user file
|
|
*/
|
|
}
|
|
800201c: bf00 nop
|
|
800201e: 370c adds r7, #12
|
|
8002020: 46bd mov sp, r7
|
|
8002022: f85d 7b04 ldr.w r7, [sp], #4
|
|
8002026: 4770 bx lr
|
|
|
|
08002028 <HAL_CAN_ErrorCallback>:
|
|
* @param hcan pointer to a CAN_HandleTypeDef structure that contains
|
|
* the configuration information for the specified CAN.
|
|
* @retval None
|
|
*/
|
|
__weak void HAL_CAN_ErrorCallback(CAN_HandleTypeDef *hcan)
|
|
{
|
|
8002028: b480 push {r7}
|
|
800202a: b083 sub sp, #12
|
|
800202c: af00 add r7, sp, #0
|
|
800202e: 6078 str r0, [r7, #4]
|
|
UNUSED(hcan);
|
|
|
|
/* NOTE : This function Should not be modified, when the callback is needed,
|
|
the HAL_CAN_ErrorCallback could be implemented in the user file
|
|
*/
|
|
}
|
|
8002030: bf00 nop
|
|
8002032: 370c adds r7, #12
|
|
8002034: 46bd mov sp, r7
|
|
8002036: f85d 7b04 ldr.w r7, [sp], #4
|
|
800203a: 4770 bx lr
|
|
|
|
0800203c <HAL_CAN_GetState>:
|
|
* @param hcan pointer to a CAN_HandleTypeDef structure that contains
|
|
* the configuration information for the specified CAN.
|
|
* @retval HAL state
|
|
*/
|
|
HAL_CAN_StateTypeDef HAL_CAN_GetState(const CAN_HandleTypeDef *hcan)
|
|
{
|
|
800203c: b480 push {r7}
|
|
800203e: b085 sub sp, #20
|
|
8002040: af00 add r7, sp, #0
|
|
8002042: 6078 str r0, [r7, #4]
|
|
HAL_CAN_StateTypeDef state = hcan->State;
|
|
8002044: 687b ldr r3, [r7, #4]
|
|
8002046: f893 3020 ldrb.w r3, [r3, #32]
|
|
800204a: 73fb strb r3, [r7, #15]
|
|
|
|
if ((state == HAL_CAN_STATE_READY) ||
|
|
800204c: 7bfb ldrb r3, [r7, #15]
|
|
800204e: 2b01 cmp r3, #1
|
|
8002050: d002 beq.n 8002058 <HAL_CAN_GetState+0x1c>
|
|
8002052: 7bfb ldrb r3, [r7, #15]
|
|
8002054: 2b02 cmp r3, #2
|
|
8002056: d112 bne.n 800207e <HAL_CAN_GetState+0x42>
|
|
(state == HAL_CAN_STATE_LISTENING))
|
|
{
|
|
/* Check sleep mode acknowledge flag */
|
|
if ((hcan->Instance->MSR & CAN_MSR_SLAK) != 0U)
|
|
8002058: 687b ldr r3, [r7, #4]
|
|
800205a: 681b ldr r3, [r3, #0]
|
|
800205c: 685b ldr r3, [r3, #4]
|
|
800205e: f003 0302 and.w r3, r3, #2
|
|
8002062: 2b00 cmp r3, #0
|
|
8002064: d002 beq.n 800206c <HAL_CAN_GetState+0x30>
|
|
{
|
|
/* Sleep mode is active */
|
|
state = HAL_CAN_STATE_SLEEP_ACTIVE;
|
|
8002066: 2304 movs r3, #4
|
|
8002068: 73fb strb r3, [r7, #15]
|
|
800206a: e008 b.n 800207e <HAL_CAN_GetState+0x42>
|
|
}
|
|
/* Check sleep mode request flag */
|
|
else if ((hcan->Instance->MCR & CAN_MCR_SLEEP) != 0U)
|
|
800206c: 687b ldr r3, [r7, #4]
|
|
800206e: 681b ldr r3, [r3, #0]
|
|
8002070: 681b ldr r3, [r3, #0]
|
|
8002072: f003 0302 and.w r3, r3, #2
|
|
8002076: 2b00 cmp r3, #0
|
|
8002078: d001 beq.n 800207e <HAL_CAN_GetState+0x42>
|
|
{
|
|
/* Sleep mode request is pending */
|
|
state = HAL_CAN_STATE_SLEEP_PENDING;
|
|
800207a: 2303 movs r3, #3
|
|
800207c: 73fb strb r3, [r7, #15]
|
|
/* Neither sleep mode request nor sleep mode acknowledge */
|
|
}
|
|
}
|
|
|
|
/* Return CAN state */
|
|
return state;
|
|
800207e: 7bfb ldrb r3, [r7, #15]
|
|
}
|
|
8002080: 4618 mov r0, r3
|
|
8002082: 3714 adds r7, #20
|
|
8002084: 46bd mov sp, r7
|
|
8002086: f85d 7b04 ldr.w r7, [sp], #4
|
|
800208a: 4770 bx lr
|
|
|
|
0800208c <HAL_CAN_GetError>:
|
|
* @param hcan pointer to a CAN_HandleTypeDef structure that contains
|
|
* the configuration information for the specified CAN.
|
|
* @retval CAN Error Code
|
|
*/
|
|
uint32_t HAL_CAN_GetError(const CAN_HandleTypeDef *hcan)
|
|
{
|
|
800208c: b480 push {r7}
|
|
800208e: b083 sub sp, #12
|
|
8002090: af00 add r7, sp, #0
|
|
8002092: 6078 str r0, [r7, #4]
|
|
/* Return CAN error code */
|
|
return hcan->ErrorCode;
|
|
8002094: 687b ldr r3, [r7, #4]
|
|
8002096: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
}
|
|
8002098: 4618 mov r0, r3
|
|
800209a: 370c adds r7, #12
|
|
800209c: 46bd mov sp, r7
|
|
800209e: f85d 7b04 ldr.w r7, [sp], #4
|
|
80020a2: 4770 bx lr
|
|
|
|
080020a4 <__NVIC_SetPriorityGrouping>:
|
|
In case of a conflict between priority grouping and available
|
|
priority bits (__NVIC_PRIO_BITS), the smallest possible priority group is set.
|
|
\param [in] PriorityGroup Priority grouping field.
|
|
*/
|
|
__STATIC_INLINE void __NVIC_SetPriorityGrouping(uint32_t PriorityGroup)
|
|
{
|
|
80020a4: b480 push {r7}
|
|
80020a6: b085 sub sp, #20
|
|
80020a8: af00 add r7, sp, #0
|
|
80020aa: 6078 str r0, [r7, #4]
|
|
uint32_t reg_value;
|
|
uint32_t PriorityGroupTmp = (PriorityGroup & (uint32_t)0x07UL); /* only values 0..7 are used */
|
|
80020ac: 687b ldr r3, [r7, #4]
|
|
80020ae: f003 0307 and.w r3, r3, #7
|
|
80020b2: 60fb str r3, [r7, #12]
|
|
|
|
reg_value = SCB->AIRCR; /* read old register configuration */
|
|
80020b4: 4b0c ldr r3, [pc, #48] @ (80020e8 <__NVIC_SetPriorityGrouping+0x44>)
|
|
80020b6: 68db ldr r3, [r3, #12]
|
|
80020b8: 60bb str r3, [r7, #8]
|
|
reg_value &= ~((uint32_t)(SCB_AIRCR_VECTKEY_Msk | SCB_AIRCR_PRIGROUP_Msk)); /* clear bits to change */
|
|
80020ba: 68ba ldr r2, [r7, #8]
|
|
80020bc: f64f 03ff movw r3, #63743 @ 0xf8ff
|
|
80020c0: 4013 ands r3, r2
|
|
80020c2: 60bb str r3, [r7, #8]
|
|
reg_value = (reg_value |
|
|
((uint32_t)0x5FAUL << SCB_AIRCR_VECTKEY_Pos) |
|
|
(PriorityGroupTmp << SCB_AIRCR_PRIGROUP_Pos) ); /* Insert write key and priority group */
|
|
80020c4: 68fb ldr r3, [r7, #12]
|
|
80020c6: 021a lsls r2, r3, #8
|
|
((uint32_t)0x5FAUL << SCB_AIRCR_VECTKEY_Pos) |
|
|
80020c8: 68bb ldr r3, [r7, #8]
|
|
80020ca: 4313 orrs r3, r2
|
|
reg_value = (reg_value |
|
|
80020cc: f043 63bf orr.w r3, r3, #100139008 @ 0x5f80000
|
|
80020d0: f443 3300 orr.w r3, r3, #131072 @ 0x20000
|
|
80020d4: 60bb str r3, [r7, #8]
|
|
SCB->AIRCR = reg_value;
|
|
80020d6: 4a04 ldr r2, [pc, #16] @ (80020e8 <__NVIC_SetPriorityGrouping+0x44>)
|
|
80020d8: 68bb ldr r3, [r7, #8]
|
|
80020da: 60d3 str r3, [r2, #12]
|
|
}
|
|
80020dc: bf00 nop
|
|
80020de: 3714 adds r7, #20
|
|
80020e0: 46bd mov sp, r7
|
|
80020e2: f85d 7b04 ldr.w r7, [sp], #4
|
|
80020e6: 4770 bx lr
|
|
80020e8: e000ed00 .word 0xe000ed00
|
|
|
|
080020ec <__NVIC_GetPriorityGrouping>:
|
|
\brief Get Priority Grouping
|
|
\details Reads the priority grouping field from the NVIC Interrupt Controller.
|
|
\return Priority grouping field (SCB->AIRCR [10:8] PRIGROUP field).
|
|
*/
|
|
__STATIC_INLINE uint32_t __NVIC_GetPriorityGrouping(void)
|
|
{
|
|
80020ec: b480 push {r7}
|
|
80020ee: af00 add r7, sp, #0
|
|
return ((uint32_t)((SCB->AIRCR & SCB_AIRCR_PRIGROUP_Msk) >> SCB_AIRCR_PRIGROUP_Pos));
|
|
80020f0: 4b04 ldr r3, [pc, #16] @ (8002104 <__NVIC_GetPriorityGrouping+0x18>)
|
|
80020f2: 68db ldr r3, [r3, #12]
|
|
80020f4: 0a1b lsrs r3, r3, #8
|
|
80020f6: f003 0307 and.w r3, r3, #7
|
|
}
|
|
80020fa: 4618 mov r0, r3
|
|
80020fc: 46bd mov sp, r7
|
|
80020fe: f85d 7b04 ldr.w r7, [sp], #4
|
|
8002102: 4770 bx lr
|
|
8002104: e000ed00 .word 0xe000ed00
|
|
|
|
08002108 <__NVIC_EnableIRQ>:
|
|
\details Enables a device specific interrupt in the NVIC interrupt controller.
|
|
\param [in] IRQn Device specific interrupt number.
|
|
\note IRQn must not be negative.
|
|
*/
|
|
__STATIC_INLINE void __NVIC_EnableIRQ(IRQn_Type IRQn)
|
|
{
|
|
8002108: b480 push {r7}
|
|
800210a: b083 sub sp, #12
|
|
800210c: af00 add r7, sp, #0
|
|
800210e: 4603 mov r3, r0
|
|
8002110: 71fb strb r3, [r7, #7]
|
|
if ((int32_t)(IRQn) >= 0)
|
|
8002112: f997 3007 ldrsb.w r3, [r7, #7]
|
|
8002116: 2b00 cmp r3, #0
|
|
8002118: db0b blt.n 8002132 <__NVIC_EnableIRQ+0x2a>
|
|
{
|
|
__COMPILER_BARRIER();
|
|
NVIC->ISER[(((uint32_t)IRQn) >> 5UL)] = (uint32_t)(1UL << (((uint32_t)IRQn) & 0x1FUL));
|
|
800211a: 79fb ldrb r3, [r7, #7]
|
|
800211c: f003 021f and.w r2, r3, #31
|
|
8002120: 4907 ldr r1, [pc, #28] @ (8002140 <__NVIC_EnableIRQ+0x38>)
|
|
8002122: f997 3007 ldrsb.w r3, [r7, #7]
|
|
8002126: 095b lsrs r3, r3, #5
|
|
8002128: 2001 movs r0, #1
|
|
800212a: fa00 f202 lsl.w r2, r0, r2
|
|
800212e: f841 2023 str.w r2, [r1, r3, lsl #2]
|
|
__COMPILER_BARRIER();
|
|
}
|
|
}
|
|
8002132: bf00 nop
|
|
8002134: 370c adds r7, #12
|
|
8002136: 46bd mov sp, r7
|
|
8002138: f85d 7b04 ldr.w r7, [sp], #4
|
|
800213c: 4770 bx lr
|
|
800213e: bf00 nop
|
|
8002140: e000e100 .word 0xe000e100
|
|
|
|
08002144 <__NVIC_SetPriority>:
|
|
\param [in] IRQn Interrupt number.
|
|
\param [in] priority Priority to set.
|
|
\note The priority cannot be set for every processor exception.
|
|
*/
|
|
__STATIC_INLINE void __NVIC_SetPriority(IRQn_Type IRQn, uint32_t priority)
|
|
{
|
|
8002144: b480 push {r7}
|
|
8002146: b083 sub sp, #12
|
|
8002148: af00 add r7, sp, #0
|
|
800214a: 4603 mov r3, r0
|
|
800214c: 6039 str r1, [r7, #0]
|
|
800214e: 71fb strb r3, [r7, #7]
|
|
if ((int32_t)(IRQn) >= 0)
|
|
8002150: f997 3007 ldrsb.w r3, [r7, #7]
|
|
8002154: 2b00 cmp r3, #0
|
|
8002156: db0a blt.n 800216e <__NVIC_SetPriority+0x2a>
|
|
{
|
|
NVIC->IP[((uint32_t)IRQn)] = (uint8_t)((priority << (8U - __NVIC_PRIO_BITS)) & (uint32_t)0xFFUL);
|
|
8002158: 683b ldr r3, [r7, #0]
|
|
800215a: b2da uxtb r2, r3
|
|
800215c: 490c ldr r1, [pc, #48] @ (8002190 <__NVIC_SetPriority+0x4c>)
|
|
800215e: f997 3007 ldrsb.w r3, [r7, #7]
|
|
8002162: 0112 lsls r2, r2, #4
|
|
8002164: b2d2 uxtb r2, r2
|
|
8002166: 440b add r3, r1
|
|
8002168: f883 2300 strb.w r2, [r3, #768] @ 0x300
|
|
}
|
|
else
|
|
{
|
|
SCB->SHP[(((uint32_t)IRQn) & 0xFUL)-4UL] = (uint8_t)((priority << (8U - __NVIC_PRIO_BITS)) & (uint32_t)0xFFUL);
|
|
}
|
|
}
|
|
800216c: e00a b.n 8002184 <__NVIC_SetPriority+0x40>
|
|
SCB->SHP[(((uint32_t)IRQn) & 0xFUL)-4UL] = (uint8_t)((priority << (8U - __NVIC_PRIO_BITS)) & (uint32_t)0xFFUL);
|
|
800216e: 683b ldr r3, [r7, #0]
|
|
8002170: b2da uxtb r2, r3
|
|
8002172: 4908 ldr r1, [pc, #32] @ (8002194 <__NVIC_SetPriority+0x50>)
|
|
8002174: 79fb ldrb r3, [r7, #7]
|
|
8002176: f003 030f and.w r3, r3, #15
|
|
800217a: 3b04 subs r3, #4
|
|
800217c: 0112 lsls r2, r2, #4
|
|
800217e: b2d2 uxtb r2, r2
|
|
8002180: 440b add r3, r1
|
|
8002182: 761a strb r2, [r3, #24]
|
|
}
|
|
8002184: bf00 nop
|
|
8002186: 370c adds r7, #12
|
|
8002188: 46bd mov sp, r7
|
|
800218a: f85d 7b04 ldr.w r7, [sp], #4
|
|
800218e: 4770 bx lr
|
|
8002190: e000e100 .word 0xe000e100
|
|
8002194: e000ed00 .word 0xe000ed00
|
|
|
|
08002198 <NVIC_EncodePriority>:
|
|
\param [in] PreemptPriority Preemptive priority value (starting from 0).
|
|
\param [in] SubPriority Subpriority value (starting from 0).
|
|
\return Encoded priority. Value can be used in the function \ref NVIC_SetPriority().
|
|
*/
|
|
__STATIC_INLINE uint32_t NVIC_EncodePriority (uint32_t PriorityGroup, uint32_t PreemptPriority, uint32_t SubPriority)
|
|
{
|
|
8002198: b480 push {r7}
|
|
800219a: b089 sub sp, #36 @ 0x24
|
|
800219c: af00 add r7, sp, #0
|
|
800219e: 60f8 str r0, [r7, #12]
|
|
80021a0: 60b9 str r1, [r7, #8]
|
|
80021a2: 607a str r2, [r7, #4]
|
|
uint32_t PriorityGroupTmp = (PriorityGroup & (uint32_t)0x07UL); /* only values 0..7 are used */
|
|
80021a4: 68fb ldr r3, [r7, #12]
|
|
80021a6: f003 0307 and.w r3, r3, #7
|
|
80021aa: 61fb str r3, [r7, #28]
|
|
uint32_t PreemptPriorityBits;
|
|
uint32_t SubPriorityBits;
|
|
|
|
PreemptPriorityBits = ((7UL - PriorityGroupTmp) > (uint32_t)(__NVIC_PRIO_BITS)) ? (uint32_t)(__NVIC_PRIO_BITS) : (uint32_t)(7UL - PriorityGroupTmp);
|
|
80021ac: 69fb ldr r3, [r7, #28]
|
|
80021ae: f1c3 0307 rsb r3, r3, #7
|
|
80021b2: 2b04 cmp r3, #4
|
|
80021b4: bf28 it cs
|
|
80021b6: 2304 movcs r3, #4
|
|
80021b8: 61bb str r3, [r7, #24]
|
|
SubPriorityBits = ((PriorityGroupTmp + (uint32_t)(__NVIC_PRIO_BITS)) < (uint32_t)7UL) ? (uint32_t)0UL : (uint32_t)((PriorityGroupTmp - 7UL) + (uint32_t)(__NVIC_PRIO_BITS));
|
|
80021ba: 69fb ldr r3, [r7, #28]
|
|
80021bc: 3304 adds r3, #4
|
|
80021be: 2b06 cmp r3, #6
|
|
80021c0: d902 bls.n 80021c8 <NVIC_EncodePriority+0x30>
|
|
80021c2: 69fb ldr r3, [r7, #28]
|
|
80021c4: 3b03 subs r3, #3
|
|
80021c6: e000 b.n 80021ca <NVIC_EncodePriority+0x32>
|
|
80021c8: 2300 movs r3, #0
|
|
80021ca: 617b str r3, [r7, #20]
|
|
|
|
return (
|
|
((PreemptPriority & (uint32_t)((1UL << (PreemptPriorityBits)) - 1UL)) << SubPriorityBits) |
|
|
80021cc: f04f 32ff mov.w r2, #4294967295 @ 0xffffffff
|
|
80021d0: 69bb ldr r3, [r7, #24]
|
|
80021d2: fa02 f303 lsl.w r3, r2, r3
|
|
80021d6: 43da mvns r2, r3
|
|
80021d8: 68bb ldr r3, [r7, #8]
|
|
80021da: 401a ands r2, r3
|
|
80021dc: 697b ldr r3, [r7, #20]
|
|
80021de: 409a lsls r2, r3
|
|
((SubPriority & (uint32_t)((1UL << (SubPriorityBits )) - 1UL)))
|
|
80021e0: f04f 31ff mov.w r1, #4294967295 @ 0xffffffff
|
|
80021e4: 697b ldr r3, [r7, #20]
|
|
80021e6: fa01 f303 lsl.w r3, r1, r3
|
|
80021ea: 43d9 mvns r1, r3
|
|
80021ec: 687b ldr r3, [r7, #4]
|
|
80021ee: 400b ands r3, r1
|
|
((PreemptPriority & (uint32_t)((1UL << (PreemptPriorityBits)) - 1UL)) << SubPriorityBits) |
|
|
80021f0: 4313 orrs r3, r2
|
|
);
|
|
}
|
|
80021f2: 4618 mov r0, r3
|
|
80021f4: 3724 adds r7, #36 @ 0x24
|
|
80021f6: 46bd mov sp, r7
|
|
80021f8: f85d 7b04 ldr.w r7, [sp], #4
|
|
80021fc: 4770 bx lr
|
|
...
|
|
|
|
08002200 <HAL_NVIC_SetPriorityGrouping>:
|
|
* @note When the NVIC_PriorityGroup_0 is selected, IRQ preemption is no more possible.
|
|
* The pending IRQ priority will be managed only by the subpriority.
|
|
* @retval None
|
|
*/
|
|
void HAL_NVIC_SetPriorityGrouping(uint32_t PriorityGroup)
|
|
{
|
|
8002200: b580 push {r7, lr}
|
|
8002202: b082 sub sp, #8
|
|
8002204: af00 add r7, sp, #0
|
|
8002206: 6078 str r0, [r7, #4]
|
|
/* Check the parameters */
|
|
assert_param(IS_NVIC_PRIORITY_GROUP(PriorityGroup));
|
|
8002208: 687b ldr r3, [r7, #4]
|
|
800220a: 2b07 cmp r3, #7
|
|
800220c: d00f beq.n 800222e <HAL_NVIC_SetPriorityGrouping+0x2e>
|
|
800220e: 687b ldr r3, [r7, #4]
|
|
8002210: 2b06 cmp r3, #6
|
|
8002212: d00c beq.n 800222e <HAL_NVIC_SetPriorityGrouping+0x2e>
|
|
8002214: 687b ldr r3, [r7, #4]
|
|
8002216: 2b05 cmp r3, #5
|
|
8002218: d009 beq.n 800222e <HAL_NVIC_SetPriorityGrouping+0x2e>
|
|
800221a: 687b ldr r3, [r7, #4]
|
|
800221c: 2b04 cmp r3, #4
|
|
800221e: d006 beq.n 800222e <HAL_NVIC_SetPriorityGrouping+0x2e>
|
|
8002220: 687b ldr r3, [r7, #4]
|
|
8002222: 2b03 cmp r3, #3
|
|
8002224: d003 beq.n 800222e <HAL_NVIC_SetPriorityGrouping+0x2e>
|
|
8002226: 2190 movs r1, #144 @ 0x90
|
|
8002228: 4804 ldr r0, [pc, #16] @ (800223c <HAL_NVIC_SetPriorityGrouping+0x3c>)
|
|
800222a: f7fe fd83 bl 8000d34 <assert_failed>
|
|
|
|
/* Set the PRIGROUP[10:8] bits according to the PriorityGroup parameter value */
|
|
NVIC_SetPriorityGrouping(PriorityGroup);
|
|
800222e: 6878 ldr r0, [r7, #4]
|
|
8002230: f7ff ff38 bl 80020a4 <__NVIC_SetPriorityGrouping>
|
|
}
|
|
8002234: bf00 nop
|
|
8002236: 3708 adds r7, #8
|
|
8002238: 46bd mov sp, r7
|
|
800223a: bd80 pop {r7, pc}
|
|
800223c: 0800a0f4 .word 0x0800a0f4
|
|
|
|
08002240 <HAL_NVIC_SetPriority>:
|
|
* This parameter can be a value between 0 and 15
|
|
* A lower priority value indicates a higher priority.
|
|
* @retval None
|
|
*/
|
|
void HAL_NVIC_SetPriority(IRQn_Type IRQn, uint32_t PreemptPriority, uint32_t SubPriority)
|
|
{
|
|
8002240: b580 push {r7, lr}
|
|
8002242: b086 sub sp, #24
|
|
8002244: af00 add r7, sp, #0
|
|
8002246: 4603 mov r3, r0
|
|
8002248: 60b9 str r1, [r7, #8]
|
|
800224a: 607a str r2, [r7, #4]
|
|
800224c: 73fb strb r3, [r7, #15]
|
|
uint32_t prioritygroup = 0x00U;
|
|
800224e: 2300 movs r3, #0
|
|
8002250: 617b str r3, [r7, #20]
|
|
|
|
/* Check the parameters */
|
|
assert_param(IS_NVIC_SUB_PRIORITY(SubPriority));
|
|
8002252: 687b ldr r3, [r7, #4]
|
|
8002254: 2b0f cmp r3, #15
|
|
8002256: d903 bls.n 8002260 <HAL_NVIC_SetPriority+0x20>
|
|
8002258: 21a8 movs r1, #168 @ 0xa8
|
|
800225a: 480e ldr r0, [pc, #56] @ (8002294 <HAL_NVIC_SetPriority+0x54>)
|
|
800225c: f7fe fd6a bl 8000d34 <assert_failed>
|
|
assert_param(IS_NVIC_PREEMPTION_PRIORITY(PreemptPriority));
|
|
8002260: 68bb ldr r3, [r7, #8]
|
|
8002262: 2b0f cmp r3, #15
|
|
8002264: d903 bls.n 800226e <HAL_NVIC_SetPriority+0x2e>
|
|
8002266: 21a9 movs r1, #169 @ 0xa9
|
|
8002268: 480a ldr r0, [pc, #40] @ (8002294 <HAL_NVIC_SetPriority+0x54>)
|
|
800226a: f7fe fd63 bl 8000d34 <assert_failed>
|
|
|
|
prioritygroup = NVIC_GetPriorityGrouping();
|
|
800226e: f7ff ff3d bl 80020ec <__NVIC_GetPriorityGrouping>
|
|
8002272: 6178 str r0, [r7, #20]
|
|
|
|
NVIC_SetPriority(IRQn, NVIC_EncodePriority(prioritygroup, PreemptPriority, SubPriority));
|
|
8002274: 687a ldr r2, [r7, #4]
|
|
8002276: 68b9 ldr r1, [r7, #8]
|
|
8002278: 6978 ldr r0, [r7, #20]
|
|
800227a: f7ff ff8d bl 8002198 <NVIC_EncodePriority>
|
|
800227e: 4602 mov r2, r0
|
|
8002280: f997 300f ldrsb.w r3, [r7, #15]
|
|
8002284: 4611 mov r1, r2
|
|
8002286: 4618 mov r0, r3
|
|
8002288: f7ff ff5c bl 8002144 <__NVIC_SetPriority>
|
|
}
|
|
800228c: bf00 nop
|
|
800228e: 3718 adds r7, #24
|
|
8002290: 46bd mov sp, r7
|
|
8002292: bd80 pop {r7, pc}
|
|
8002294: 0800a0f4 .word 0x0800a0f4
|
|
|
|
08002298 <HAL_NVIC_EnableIRQ>:
|
|
* This parameter can be an enumerator of IRQn_Type enumeration
|
|
* (For the complete STM32 Devices IRQ Channels list, please refer to the appropriate CMSIS device file (stm32f4xxxx.h))
|
|
* @retval None
|
|
*/
|
|
void HAL_NVIC_EnableIRQ(IRQn_Type IRQn)
|
|
{
|
|
8002298: b580 push {r7, lr}
|
|
800229a: b082 sub sp, #8
|
|
800229c: af00 add r7, sp, #0
|
|
800229e: 4603 mov r3, r0
|
|
80022a0: 71fb strb r3, [r7, #7]
|
|
/* Check the parameters */
|
|
assert_param(IS_NVIC_DEVICE_IRQ(IRQn));
|
|
80022a2: f997 3007 ldrsb.w r3, [r7, #7]
|
|
80022a6: 2b00 cmp r3, #0
|
|
80022a8: da03 bge.n 80022b2 <HAL_NVIC_EnableIRQ+0x1a>
|
|
80022aa: 21bc movs r1, #188 @ 0xbc
|
|
80022ac: 4805 ldr r0, [pc, #20] @ (80022c4 <HAL_NVIC_EnableIRQ+0x2c>)
|
|
80022ae: f7fe fd41 bl 8000d34 <assert_failed>
|
|
|
|
/* Enable interrupt */
|
|
NVIC_EnableIRQ(IRQn);
|
|
80022b2: f997 3007 ldrsb.w r3, [r7, #7]
|
|
80022b6: 4618 mov r0, r3
|
|
80022b8: f7ff ff26 bl 8002108 <__NVIC_EnableIRQ>
|
|
}
|
|
80022bc: bf00 nop
|
|
80022be: 3708 adds r7, #8
|
|
80022c0: 46bd mov sp, r7
|
|
80022c2: bd80 pop {r7, pc}
|
|
80022c4: 0800a0f4 .word 0x0800a0f4
|
|
|
|
080022c8 <HAL_DMA_Init>:
|
|
* @param hdma Pointer to a DMA_HandleTypeDef structure that contains
|
|
* the configuration information for the specified DMA Stream.
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_DMA_Init(DMA_HandleTypeDef *hdma)
|
|
{
|
|
80022c8: b580 push {r7, lr}
|
|
80022ca: b086 sub sp, #24
|
|
80022cc: af00 add r7, sp, #0
|
|
80022ce: 6078 str r0, [r7, #4]
|
|
uint32_t tmp = 0U;
|
|
80022d0: 2300 movs r3, #0
|
|
80022d2: 617b str r3, [r7, #20]
|
|
uint32_t tickstart = HAL_GetTick();
|
|
80022d4: f7ff f8b0 bl 8001438 <HAL_GetTick>
|
|
80022d8: 6138 str r0, [r7, #16]
|
|
DMA_Base_Registers *regs;
|
|
|
|
/* Check the DMA peripheral state */
|
|
if(hdma == NULL)
|
|
80022da: 687b ldr r3, [r7, #4]
|
|
80022dc: 2b00 cmp r3, #0
|
|
80022de: d101 bne.n 80022e4 <HAL_DMA_Init+0x1c>
|
|
{
|
|
return HAL_ERROR;
|
|
80022e0: 2301 movs r3, #1
|
|
80022e2: e203 b.n 80026ec <HAL_DMA_Init+0x424>
|
|
}
|
|
|
|
/* Check the parameters */
|
|
assert_param(IS_DMA_STREAM_ALL_INSTANCE(hdma->Instance));
|
|
80022e4: 687b ldr r3, [r7, #4]
|
|
80022e6: 681b ldr r3, [r3, #0]
|
|
80022e8: 4a8b ldr r2, [pc, #556] @ (8002518 <HAL_DMA_Init+0x250>)
|
|
80022ea: 4293 cmp r3, r2
|
|
80022ec: d04e beq.n 800238c <HAL_DMA_Init+0xc4>
|
|
80022ee: 687b ldr r3, [r7, #4]
|
|
80022f0: 681b ldr r3, [r3, #0]
|
|
80022f2: 4a8a ldr r2, [pc, #552] @ (800251c <HAL_DMA_Init+0x254>)
|
|
80022f4: 4293 cmp r3, r2
|
|
80022f6: d049 beq.n 800238c <HAL_DMA_Init+0xc4>
|
|
80022f8: 687b ldr r3, [r7, #4]
|
|
80022fa: 681b ldr r3, [r3, #0]
|
|
80022fc: 4a88 ldr r2, [pc, #544] @ (8002520 <HAL_DMA_Init+0x258>)
|
|
80022fe: 4293 cmp r3, r2
|
|
8002300: d044 beq.n 800238c <HAL_DMA_Init+0xc4>
|
|
8002302: 687b ldr r3, [r7, #4]
|
|
8002304: 681b ldr r3, [r3, #0]
|
|
8002306: 4a87 ldr r2, [pc, #540] @ (8002524 <HAL_DMA_Init+0x25c>)
|
|
8002308: 4293 cmp r3, r2
|
|
800230a: d03f beq.n 800238c <HAL_DMA_Init+0xc4>
|
|
800230c: 687b ldr r3, [r7, #4]
|
|
800230e: 681b ldr r3, [r3, #0]
|
|
8002310: 4a85 ldr r2, [pc, #532] @ (8002528 <HAL_DMA_Init+0x260>)
|
|
8002312: 4293 cmp r3, r2
|
|
8002314: d03a beq.n 800238c <HAL_DMA_Init+0xc4>
|
|
8002316: 687b ldr r3, [r7, #4]
|
|
8002318: 681b ldr r3, [r3, #0]
|
|
800231a: 4a84 ldr r2, [pc, #528] @ (800252c <HAL_DMA_Init+0x264>)
|
|
800231c: 4293 cmp r3, r2
|
|
800231e: d035 beq.n 800238c <HAL_DMA_Init+0xc4>
|
|
8002320: 687b ldr r3, [r7, #4]
|
|
8002322: 681b ldr r3, [r3, #0]
|
|
8002324: 4a82 ldr r2, [pc, #520] @ (8002530 <HAL_DMA_Init+0x268>)
|
|
8002326: 4293 cmp r3, r2
|
|
8002328: d030 beq.n 800238c <HAL_DMA_Init+0xc4>
|
|
800232a: 687b ldr r3, [r7, #4]
|
|
800232c: 681b ldr r3, [r3, #0]
|
|
800232e: 4a81 ldr r2, [pc, #516] @ (8002534 <HAL_DMA_Init+0x26c>)
|
|
8002330: 4293 cmp r3, r2
|
|
8002332: d02b beq.n 800238c <HAL_DMA_Init+0xc4>
|
|
8002334: 687b ldr r3, [r7, #4]
|
|
8002336: 681b ldr r3, [r3, #0]
|
|
8002338: 4a7f ldr r2, [pc, #508] @ (8002538 <HAL_DMA_Init+0x270>)
|
|
800233a: 4293 cmp r3, r2
|
|
800233c: d026 beq.n 800238c <HAL_DMA_Init+0xc4>
|
|
800233e: 687b ldr r3, [r7, #4]
|
|
8002340: 681b ldr r3, [r3, #0]
|
|
8002342: 4a7e ldr r2, [pc, #504] @ (800253c <HAL_DMA_Init+0x274>)
|
|
8002344: 4293 cmp r3, r2
|
|
8002346: d021 beq.n 800238c <HAL_DMA_Init+0xc4>
|
|
8002348: 687b ldr r3, [r7, #4]
|
|
800234a: 681b ldr r3, [r3, #0]
|
|
800234c: 4a7c ldr r2, [pc, #496] @ (8002540 <HAL_DMA_Init+0x278>)
|
|
800234e: 4293 cmp r3, r2
|
|
8002350: d01c beq.n 800238c <HAL_DMA_Init+0xc4>
|
|
8002352: 687b ldr r3, [r7, #4]
|
|
8002354: 681b ldr r3, [r3, #0]
|
|
8002356: 4a7b ldr r2, [pc, #492] @ (8002544 <HAL_DMA_Init+0x27c>)
|
|
8002358: 4293 cmp r3, r2
|
|
800235a: d017 beq.n 800238c <HAL_DMA_Init+0xc4>
|
|
800235c: 687b ldr r3, [r7, #4]
|
|
800235e: 681b ldr r3, [r3, #0]
|
|
8002360: 4a79 ldr r2, [pc, #484] @ (8002548 <HAL_DMA_Init+0x280>)
|
|
8002362: 4293 cmp r3, r2
|
|
8002364: d012 beq.n 800238c <HAL_DMA_Init+0xc4>
|
|
8002366: 687b ldr r3, [r7, #4]
|
|
8002368: 681b ldr r3, [r3, #0]
|
|
800236a: 4a78 ldr r2, [pc, #480] @ (800254c <HAL_DMA_Init+0x284>)
|
|
800236c: 4293 cmp r3, r2
|
|
800236e: d00d beq.n 800238c <HAL_DMA_Init+0xc4>
|
|
8002370: 687b ldr r3, [r7, #4]
|
|
8002372: 681b ldr r3, [r3, #0]
|
|
8002374: 4a76 ldr r2, [pc, #472] @ (8002550 <HAL_DMA_Init+0x288>)
|
|
8002376: 4293 cmp r3, r2
|
|
8002378: d008 beq.n 800238c <HAL_DMA_Init+0xc4>
|
|
800237a: 687b ldr r3, [r7, #4]
|
|
800237c: 681b ldr r3, [r3, #0]
|
|
800237e: 4a75 ldr r2, [pc, #468] @ (8002554 <HAL_DMA_Init+0x28c>)
|
|
8002380: 4293 cmp r3, r2
|
|
8002382: d003 beq.n 800238c <HAL_DMA_Init+0xc4>
|
|
8002384: 21b7 movs r1, #183 @ 0xb7
|
|
8002386: 4874 ldr r0, [pc, #464] @ (8002558 <HAL_DMA_Init+0x290>)
|
|
8002388: f7fe fcd4 bl 8000d34 <assert_failed>
|
|
assert_param(IS_DMA_CHANNEL(hdma->Init.Channel));
|
|
800238c: 687b ldr r3, [r7, #4]
|
|
800238e: 685b ldr r3, [r3, #4]
|
|
8002390: 2b00 cmp r3, #0
|
|
8002392: d026 beq.n 80023e2 <HAL_DMA_Init+0x11a>
|
|
8002394: 687b ldr r3, [r7, #4]
|
|
8002396: 685b ldr r3, [r3, #4]
|
|
8002398: f1b3 7f00 cmp.w r3, #33554432 @ 0x2000000
|
|
800239c: d021 beq.n 80023e2 <HAL_DMA_Init+0x11a>
|
|
800239e: 687b ldr r3, [r7, #4]
|
|
80023a0: 685b ldr r3, [r3, #4]
|
|
80023a2: f1b3 6f80 cmp.w r3, #67108864 @ 0x4000000
|
|
80023a6: d01c beq.n 80023e2 <HAL_DMA_Init+0x11a>
|
|
80023a8: 687b ldr r3, [r7, #4]
|
|
80023aa: 685b ldr r3, [r3, #4]
|
|
80023ac: f1b3 6fc0 cmp.w r3, #100663296 @ 0x6000000
|
|
80023b0: d017 beq.n 80023e2 <HAL_DMA_Init+0x11a>
|
|
80023b2: 687b ldr r3, [r7, #4]
|
|
80023b4: 685b ldr r3, [r3, #4]
|
|
80023b6: f1b3 6f00 cmp.w r3, #134217728 @ 0x8000000
|
|
80023ba: d012 beq.n 80023e2 <HAL_DMA_Init+0x11a>
|
|
80023bc: 687b ldr r3, [r7, #4]
|
|
80023be: 685b ldr r3, [r3, #4]
|
|
80023c0: f1b3 6f20 cmp.w r3, #167772160 @ 0xa000000
|
|
80023c4: d00d beq.n 80023e2 <HAL_DMA_Init+0x11a>
|
|
80023c6: 687b ldr r3, [r7, #4]
|
|
80023c8: 685b ldr r3, [r3, #4]
|
|
80023ca: f1b3 6f40 cmp.w r3, #201326592 @ 0xc000000
|
|
80023ce: d008 beq.n 80023e2 <HAL_DMA_Init+0x11a>
|
|
80023d0: 687b ldr r3, [r7, #4]
|
|
80023d2: 685b ldr r3, [r3, #4]
|
|
80023d4: f1b3 6f60 cmp.w r3, #234881024 @ 0xe000000
|
|
80023d8: d003 beq.n 80023e2 <HAL_DMA_Init+0x11a>
|
|
80023da: 21b8 movs r1, #184 @ 0xb8
|
|
80023dc: 485e ldr r0, [pc, #376] @ (8002558 <HAL_DMA_Init+0x290>)
|
|
80023de: f7fe fca9 bl 8000d34 <assert_failed>
|
|
assert_param(IS_DMA_DIRECTION(hdma->Init.Direction));
|
|
80023e2: 687b ldr r3, [r7, #4]
|
|
80023e4: 689b ldr r3, [r3, #8]
|
|
80023e6: 2b00 cmp r3, #0
|
|
80023e8: d00b beq.n 8002402 <HAL_DMA_Init+0x13a>
|
|
80023ea: 687b ldr r3, [r7, #4]
|
|
80023ec: 689b ldr r3, [r3, #8]
|
|
80023ee: 2b40 cmp r3, #64 @ 0x40
|
|
80023f0: d007 beq.n 8002402 <HAL_DMA_Init+0x13a>
|
|
80023f2: 687b ldr r3, [r7, #4]
|
|
80023f4: 689b ldr r3, [r3, #8]
|
|
80023f6: 2b80 cmp r3, #128 @ 0x80
|
|
80023f8: d003 beq.n 8002402 <HAL_DMA_Init+0x13a>
|
|
80023fa: 21b9 movs r1, #185 @ 0xb9
|
|
80023fc: 4856 ldr r0, [pc, #344] @ (8002558 <HAL_DMA_Init+0x290>)
|
|
80023fe: f7fe fc99 bl 8000d34 <assert_failed>
|
|
assert_param(IS_DMA_PERIPHERAL_INC_STATE(hdma->Init.PeriphInc));
|
|
8002402: 687b ldr r3, [r7, #4]
|
|
8002404: 68db ldr r3, [r3, #12]
|
|
8002406: f5b3 7f00 cmp.w r3, #512 @ 0x200
|
|
800240a: d007 beq.n 800241c <HAL_DMA_Init+0x154>
|
|
800240c: 687b ldr r3, [r7, #4]
|
|
800240e: 68db ldr r3, [r3, #12]
|
|
8002410: 2b00 cmp r3, #0
|
|
8002412: d003 beq.n 800241c <HAL_DMA_Init+0x154>
|
|
8002414: 21ba movs r1, #186 @ 0xba
|
|
8002416: 4850 ldr r0, [pc, #320] @ (8002558 <HAL_DMA_Init+0x290>)
|
|
8002418: f7fe fc8c bl 8000d34 <assert_failed>
|
|
assert_param(IS_DMA_MEMORY_INC_STATE(hdma->Init.MemInc));
|
|
800241c: 687b ldr r3, [r7, #4]
|
|
800241e: 691b ldr r3, [r3, #16]
|
|
8002420: f5b3 6f80 cmp.w r3, #1024 @ 0x400
|
|
8002424: d007 beq.n 8002436 <HAL_DMA_Init+0x16e>
|
|
8002426: 687b ldr r3, [r7, #4]
|
|
8002428: 691b ldr r3, [r3, #16]
|
|
800242a: 2b00 cmp r3, #0
|
|
800242c: d003 beq.n 8002436 <HAL_DMA_Init+0x16e>
|
|
800242e: 21bb movs r1, #187 @ 0xbb
|
|
8002430: 4849 ldr r0, [pc, #292] @ (8002558 <HAL_DMA_Init+0x290>)
|
|
8002432: f7fe fc7f bl 8000d34 <assert_failed>
|
|
assert_param(IS_DMA_PERIPHERAL_DATA_SIZE(hdma->Init.PeriphDataAlignment));
|
|
8002436: 687b ldr r3, [r7, #4]
|
|
8002438: 695b ldr r3, [r3, #20]
|
|
800243a: 2b00 cmp r3, #0
|
|
800243c: d00d beq.n 800245a <HAL_DMA_Init+0x192>
|
|
800243e: 687b ldr r3, [r7, #4]
|
|
8002440: 695b ldr r3, [r3, #20]
|
|
8002442: f5b3 6f00 cmp.w r3, #2048 @ 0x800
|
|
8002446: d008 beq.n 800245a <HAL_DMA_Init+0x192>
|
|
8002448: 687b ldr r3, [r7, #4]
|
|
800244a: 695b ldr r3, [r3, #20]
|
|
800244c: f5b3 5f80 cmp.w r3, #4096 @ 0x1000
|
|
8002450: d003 beq.n 800245a <HAL_DMA_Init+0x192>
|
|
8002452: 21bc movs r1, #188 @ 0xbc
|
|
8002454: 4840 ldr r0, [pc, #256] @ (8002558 <HAL_DMA_Init+0x290>)
|
|
8002456: f7fe fc6d bl 8000d34 <assert_failed>
|
|
assert_param(IS_DMA_MEMORY_DATA_SIZE(hdma->Init.MemDataAlignment));
|
|
800245a: 687b ldr r3, [r7, #4]
|
|
800245c: 699b ldr r3, [r3, #24]
|
|
800245e: 2b00 cmp r3, #0
|
|
8002460: d00d beq.n 800247e <HAL_DMA_Init+0x1b6>
|
|
8002462: 687b ldr r3, [r7, #4]
|
|
8002464: 699b ldr r3, [r3, #24]
|
|
8002466: f5b3 5f00 cmp.w r3, #8192 @ 0x2000
|
|
800246a: d008 beq.n 800247e <HAL_DMA_Init+0x1b6>
|
|
800246c: 687b ldr r3, [r7, #4]
|
|
800246e: 699b ldr r3, [r3, #24]
|
|
8002470: f5b3 4f80 cmp.w r3, #16384 @ 0x4000
|
|
8002474: d003 beq.n 800247e <HAL_DMA_Init+0x1b6>
|
|
8002476: 21bd movs r1, #189 @ 0xbd
|
|
8002478: 4837 ldr r0, [pc, #220] @ (8002558 <HAL_DMA_Init+0x290>)
|
|
800247a: f7fe fc5b bl 8000d34 <assert_failed>
|
|
assert_param(IS_DMA_MODE(hdma->Init.Mode));
|
|
800247e: 687b ldr r3, [r7, #4]
|
|
8002480: 69db ldr r3, [r3, #28]
|
|
8002482: 2b00 cmp r3, #0
|
|
8002484: d00c beq.n 80024a0 <HAL_DMA_Init+0x1d8>
|
|
8002486: 687b ldr r3, [r7, #4]
|
|
8002488: 69db ldr r3, [r3, #28]
|
|
800248a: f5b3 7f80 cmp.w r3, #256 @ 0x100
|
|
800248e: d007 beq.n 80024a0 <HAL_DMA_Init+0x1d8>
|
|
8002490: 687b ldr r3, [r7, #4]
|
|
8002492: 69db ldr r3, [r3, #28]
|
|
8002494: 2b20 cmp r3, #32
|
|
8002496: d003 beq.n 80024a0 <HAL_DMA_Init+0x1d8>
|
|
8002498: 21be movs r1, #190 @ 0xbe
|
|
800249a: 482f ldr r0, [pc, #188] @ (8002558 <HAL_DMA_Init+0x290>)
|
|
800249c: f7fe fc4a bl 8000d34 <assert_failed>
|
|
assert_param(IS_DMA_PRIORITY(hdma->Init.Priority));
|
|
80024a0: 687b ldr r3, [r7, #4]
|
|
80024a2: 6a1b ldr r3, [r3, #32]
|
|
80024a4: 2b00 cmp r3, #0
|
|
80024a6: d012 beq.n 80024ce <HAL_DMA_Init+0x206>
|
|
80024a8: 687b ldr r3, [r7, #4]
|
|
80024aa: 6a1b ldr r3, [r3, #32]
|
|
80024ac: f5b3 3f80 cmp.w r3, #65536 @ 0x10000
|
|
80024b0: d00d beq.n 80024ce <HAL_DMA_Init+0x206>
|
|
80024b2: 687b ldr r3, [r7, #4]
|
|
80024b4: 6a1b ldr r3, [r3, #32]
|
|
80024b6: f5b3 3f00 cmp.w r3, #131072 @ 0x20000
|
|
80024ba: d008 beq.n 80024ce <HAL_DMA_Init+0x206>
|
|
80024bc: 687b ldr r3, [r7, #4]
|
|
80024be: 6a1b ldr r3, [r3, #32]
|
|
80024c0: f5b3 3f40 cmp.w r3, #196608 @ 0x30000
|
|
80024c4: d003 beq.n 80024ce <HAL_DMA_Init+0x206>
|
|
80024c6: 21bf movs r1, #191 @ 0xbf
|
|
80024c8: 4823 ldr r0, [pc, #140] @ (8002558 <HAL_DMA_Init+0x290>)
|
|
80024ca: f7fe fc33 bl 8000d34 <assert_failed>
|
|
assert_param(IS_DMA_FIFO_MODE_STATE(hdma->Init.FIFOMode));
|
|
80024ce: 687b ldr r3, [r7, #4]
|
|
80024d0: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
80024d2: 2b00 cmp r3, #0
|
|
80024d4: d007 beq.n 80024e6 <HAL_DMA_Init+0x21e>
|
|
80024d6: 687b ldr r3, [r7, #4]
|
|
80024d8: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
80024da: 2b04 cmp r3, #4
|
|
80024dc: d003 beq.n 80024e6 <HAL_DMA_Init+0x21e>
|
|
80024de: 21c0 movs r1, #192 @ 0xc0
|
|
80024e0: 481d ldr r0, [pc, #116] @ (8002558 <HAL_DMA_Init+0x290>)
|
|
80024e2: f7fe fc27 bl 8000d34 <assert_failed>
|
|
/* Check the memory burst, peripheral burst and FIFO threshold parameters only
|
|
when FIFO mode is enabled */
|
|
if(hdma->Init.FIFOMode != DMA_FIFOMODE_DISABLE)
|
|
80024e6: 687b ldr r3, [r7, #4]
|
|
80024e8: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
80024ea: 2b00 cmp r3, #0
|
|
80024ec: d064 beq.n 80025b8 <HAL_DMA_Init+0x2f0>
|
|
{
|
|
assert_param(IS_DMA_FIFO_THRESHOLD(hdma->Init.FIFOThreshold));
|
|
80024ee: 687b ldr r3, [r7, #4]
|
|
80024f0: 6a9b ldr r3, [r3, #40] @ 0x28
|
|
80024f2: 2b00 cmp r3, #0
|
|
80024f4: d032 beq.n 800255c <HAL_DMA_Init+0x294>
|
|
80024f6: 687b ldr r3, [r7, #4]
|
|
80024f8: 6a9b ldr r3, [r3, #40] @ 0x28
|
|
80024fa: 2b01 cmp r3, #1
|
|
80024fc: d02e beq.n 800255c <HAL_DMA_Init+0x294>
|
|
80024fe: 687b ldr r3, [r7, #4]
|
|
8002500: 6a9b ldr r3, [r3, #40] @ 0x28
|
|
8002502: 2b02 cmp r3, #2
|
|
8002504: d02a beq.n 800255c <HAL_DMA_Init+0x294>
|
|
8002506: 687b ldr r3, [r7, #4]
|
|
8002508: 6a9b ldr r3, [r3, #40] @ 0x28
|
|
800250a: 2b03 cmp r3, #3
|
|
800250c: d026 beq.n 800255c <HAL_DMA_Init+0x294>
|
|
800250e: 21c5 movs r1, #197 @ 0xc5
|
|
8002510: 4811 ldr r0, [pc, #68] @ (8002558 <HAL_DMA_Init+0x290>)
|
|
8002512: f7fe fc0f bl 8000d34 <assert_failed>
|
|
8002516: e021 b.n 800255c <HAL_DMA_Init+0x294>
|
|
8002518: 40026010 .word 0x40026010
|
|
800251c: 40026028 .word 0x40026028
|
|
8002520: 40026040 .word 0x40026040
|
|
8002524: 40026058 .word 0x40026058
|
|
8002528: 40026070 .word 0x40026070
|
|
800252c: 40026088 .word 0x40026088
|
|
8002530: 400260a0 .word 0x400260a0
|
|
8002534: 400260b8 .word 0x400260b8
|
|
8002538: 40026410 .word 0x40026410
|
|
800253c: 40026428 .word 0x40026428
|
|
8002540: 40026440 .word 0x40026440
|
|
8002544: 40026458 .word 0x40026458
|
|
8002548: 40026470 .word 0x40026470
|
|
800254c: 40026488 .word 0x40026488
|
|
8002550: 400264a0 .word 0x400264a0
|
|
8002554: 400264b8 .word 0x400264b8
|
|
8002558: 0800a130 .word 0x0800a130
|
|
assert_param(IS_DMA_MEMORY_BURST(hdma->Init.MemBurst));
|
|
800255c: 687b ldr r3, [r7, #4]
|
|
800255e: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
8002560: 2b00 cmp r3, #0
|
|
8002562: d012 beq.n 800258a <HAL_DMA_Init+0x2c2>
|
|
8002564: 687b ldr r3, [r7, #4]
|
|
8002566: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
8002568: f5b3 0f00 cmp.w r3, #8388608 @ 0x800000
|
|
800256c: d00d beq.n 800258a <HAL_DMA_Init+0x2c2>
|
|
800256e: 687b ldr r3, [r7, #4]
|
|
8002570: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
8002572: f1b3 7f80 cmp.w r3, #16777216 @ 0x1000000
|
|
8002576: d008 beq.n 800258a <HAL_DMA_Init+0x2c2>
|
|
8002578: 687b ldr r3, [r7, #4]
|
|
800257a: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
800257c: f1b3 7fc0 cmp.w r3, #25165824 @ 0x1800000
|
|
8002580: d003 beq.n 800258a <HAL_DMA_Init+0x2c2>
|
|
8002582: 21c6 movs r1, #198 @ 0xc6
|
|
8002584: 485b ldr r0, [pc, #364] @ (80026f4 <HAL_DMA_Init+0x42c>)
|
|
8002586: f7fe fbd5 bl 8000d34 <assert_failed>
|
|
assert_param(IS_DMA_PERIPHERAL_BURST(hdma->Init.PeriphBurst));
|
|
800258a: 687b ldr r3, [r7, #4]
|
|
800258c: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
800258e: 2b00 cmp r3, #0
|
|
8002590: d012 beq.n 80025b8 <HAL_DMA_Init+0x2f0>
|
|
8002592: 687b ldr r3, [r7, #4]
|
|
8002594: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
8002596: f5b3 1f00 cmp.w r3, #2097152 @ 0x200000
|
|
800259a: d00d beq.n 80025b8 <HAL_DMA_Init+0x2f0>
|
|
800259c: 687b ldr r3, [r7, #4]
|
|
800259e: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
80025a0: f5b3 0f80 cmp.w r3, #4194304 @ 0x400000
|
|
80025a4: d008 beq.n 80025b8 <HAL_DMA_Init+0x2f0>
|
|
80025a6: 687b ldr r3, [r7, #4]
|
|
80025a8: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
80025aa: f5b3 0fc0 cmp.w r3, #6291456 @ 0x600000
|
|
80025ae: d003 beq.n 80025b8 <HAL_DMA_Init+0x2f0>
|
|
80025b0: 21c7 movs r1, #199 @ 0xc7
|
|
80025b2: 4850 ldr r0, [pc, #320] @ (80026f4 <HAL_DMA_Init+0x42c>)
|
|
80025b4: f7fe fbbe bl 8000d34 <assert_failed>
|
|
}
|
|
|
|
/* Change DMA peripheral state */
|
|
hdma->State = HAL_DMA_STATE_BUSY;
|
|
80025b8: 687b ldr r3, [r7, #4]
|
|
80025ba: 2202 movs r2, #2
|
|
80025bc: f883 2035 strb.w r2, [r3, #53] @ 0x35
|
|
|
|
/* Allocate lock resource */
|
|
__HAL_UNLOCK(hdma);
|
|
80025c0: 687b ldr r3, [r7, #4]
|
|
80025c2: 2200 movs r2, #0
|
|
80025c4: f883 2034 strb.w r2, [r3, #52] @ 0x34
|
|
|
|
/* Disable the peripheral */
|
|
__HAL_DMA_DISABLE(hdma);
|
|
80025c8: 687b ldr r3, [r7, #4]
|
|
80025ca: 681b ldr r3, [r3, #0]
|
|
80025cc: 681a ldr r2, [r3, #0]
|
|
80025ce: 687b ldr r3, [r7, #4]
|
|
80025d0: 681b ldr r3, [r3, #0]
|
|
80025d2: f022 0201 bic.w r2, r2, #1
|
|
80025d6: 601a str r2, [r3, #0]
|
|
|
|
/* Check if the DMA Stream is effectively disabled */
|
|
while((hdma->Instance->CR & DMA_SxCR_EN) != RESET)
|
|
80025d8: e00f b.n 80025fa <HAL_DMA_Init+0x332>
|
|
{
|
|
/* Check for the Timeout */
|
|
if((HAL_GetTick() - tickstart ) > HAL_TIMEOUT_DMA_ABORT)
|
|
80025da: f7fe ff2d bl 8001438 <HAL_GetTick>
|
|
80025de: 4602 mov r2, r0
|
|
80025e0: 693b ldr r3, [r7, #16]
|
|
80025e2: 1ad3 subs r3, r2, r3
|
|
80025e4: 2b05 cmp r3, #5
|
|
80025e6: d908 bls.n 80025fa <HAL_DMA_Init+0x332>
|
|
{
|
|
/* Update error code */
|
|
hdma->ErrorCode = HAL_DMA_ERROR_TIMEOUT;
|
|
80025e8: 687b ldr r3, [r7, #4]
|
|
80025ea: 2220 movs r2, #32
|
|
80025ec: 655a str r2, [r3, #84] @ 0x54
|
|
|
|
/* Change the DMA state */
|
|
hdma->State = HAL_DMA_STATE_TIMEOUT;
|
|
80025ee: 687b ldr r3, [r7, #4]
|
|
80025f0: 2203 movs r2, #3
|
|
80025f2: f883 2035 strb.w r2, [r3, #53] @ 0x35
|
|
|
|
return HAL_TIMEOUT;
|
|
80025f6: 2303 movs r3, #3
|
|
80025f8: e078 b.n 80026ec <HAL_DMA_Init+0x424>
|
|
while((hdma->Instance->CR & DMA_SxCR_EN) != RESET)
|
|
80025fa: 687b ldr r3, [r7, #4]
|
|
80025fc: 681b ldr r3, [r3, #0]
|
|
80025fe: 681b ldr r3, [r3, #0]
|
|
8002600: f003 0301 and.w r3, r3, #1
|
|
8002604: 2b00 cmp r3, #0
|
|
8002606: d1e8 bne.n 80025da <HAL_DMA_Init+0x312>
|
|
}
|
|
}
|
|
|
|
/* Get the CR register value */
|
|
tmp = hdma->Instance->CR;
|
|
8002608: 687b ldr r3, [r7, #4]
|
|
800260a: 681b ldr r3, [r3, #0]
|
|
800260c: 681b ldr r3, [r3, #0]
|
|
800260e: 617b str r3, [r7, #20]
|
|
|
|
/* Clear CHSEL, MBURST, PBURST, PL, MSIZE, PSIZE, MINC, PINC, CIRC, DIR, CT and DBM bits */
|
|
tmp &= ((uint32_t)~(DMA_SxCR_CHSEL | DMA_SxCR_MBURST | DMA_SxCR_PBURST | \
|
|
8002610: 697a ldr r2, [r7, #20]
|
|
8002612: 4b39 ldr r3, [pc, #228] @ (80026f8 <HAL_DMA_Init+0x430>)
|
|
8002614: 4013 ands r3, r2
|
|
8002616: 617b str r3, [r7, #20]
|
|
DMA_SxCR_PL | DMA_SxCR_MSIZE | DMA_SxCR_PSIZE | \
|
|
DMA_SxCR_MINC | DMA_SxCR_PINC | DMA_SxCR_CIRC | \
|
|
DMA_SxCR_DIR | DMA_SxCR_CT | DMA_SxCR_DBM));
|
|
|
|
/* Prepare the DMA Stream configuration */
|
|
tmp |= hdma->Init.Channel | hdma->Init.Direction |
|
|
8002618: 687b ldr r3, [r7, #4]
|
|
800261a: 685a ldr r2, [r3, #4]
|
|
800261c: 687b ldr r3, [r7, #4]
|
|
800261e: 689b ldr r3, [r3, #8]
|
|
8002620: 431a orrs r2, r3
|
|
hdma->Init.PeriphInc | hdma->Init.MemInc |
|
|
8002622: 687b ldr r3, [r7, #4]
|
|
8002624: 68db ldr r3, [r3, #12]
|
|
tmp |= hdma->Init.Channel | hdma->Init.Direction |
|
|
8002626: 431a orrs r2, r3
|
|
hdma->Init.PeriphInc | hdma->Init.MemInc |
|
|
8002628: 687b ldr r3, [r7, #4]
|
|
800262a: 691b ldr r3, [r3, #16]
|
|
800262c: 431a orrs r2, r3
|
|
hdma->Init.PeriphDataAlignment | hdma->Init.MemDataAlignment |
|
|
800262e: 687b ldr r3, [r7, #4]
|
|
8002630: 695b ldr r3, [r3, #20]
|
|
hdma->Init.PeriphInc | hdma->Init.MemInc |
|
|
8002632: 431a orrs r2, r3
|
|
hdma->Init.PeriphDataAlignment | hdma->Init.MemDataAlignment |
|
|
8002634: 687b ldr r3, [r7, #4]
|
|
8002636: 699b ldr r3, [r3, #24]
|
|
8002638: 431a orrs r2, r3
|
|
hdma->Init.Mode | hdma->Init.Priority;
|
|
800263a: 687b ldr r3, [r7, #4]
|
|
800263c: 69db ldr r3, [r3, #28]
|
|
hdma->Init.PeriphDataAlignment | hdma->Init.MemDataAlignment |
|
|
800263e: 431a orrs r2, r3
|
|
hdma->Init.Mode | hdma->Init.Priority;
|
|
8002640: 687b ldr r3, [r7, #4]
|
|
8002642: 6a1b ldr r3, [r3, #32]
|
|
8002644: 4313 orrs r3, r2
|
|
tmp |= hdma->Init.Channel | hdma->Init.Direction |
|
|
8002646: 697a ldr r2, [r7, #20]
|
|
8002648: 4313 orrs r3, r2
|
|
800264a: 617b str r3, [r7, #20]
|
|
|
|
/* the Memory burst and peripheral burst are not used when the FIFO is disabled */
|
|
if(hdma->Init.FIFOMode == DMA_FIFOMODE_ENABLE)
|
|
800264c: 687b ldr r3, [r7, #4]
|
|
800264e: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
8002650: 2b04 cmp r3, #4
|
|
8002652: d107 bne.n 8002664 <HAL_DMA_Init+0x39c>
|
|
{
|
|
/* Get memory burst and peripheral burst */
|
|
tmp |= hdma->Init.MemBurst | hdma->Init.PeriphBurst;
|
|
8002654: 687b ldr r3, [r7, #4]
|
|
8002656: 6ada ldr r2, [r3, #44] @ 0x2c
|
|
8002658: 687b ldr r3, [r7, #4]
|
|
800265a: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
800265c: 4313 orrs r3, r2
|
|
800265e: 697a ldr r2, [r7, #20]
|
|
8002660: 4313 orrs r3, r2
|
|
8002662: 617b str r3, [r7, #20]
|
|
}
|
|
|
|
/* Write to DMA Stream CR register */
|
|
hdma->Instance->CR = tmp;
|
|
8002664: 687b ldr r3, [r7, #4]
|
|
8002666: 681b ldr r3, [r3, #0]
|
|
8002668: 697a ldr r2, [r7, #20]
|
|
800266a: 601a str r2, [r3, #0]
|
|
|
|
/* Get the FCR register value */
|
|
tmp = hdma->Instance->FCR;
|
|
800266c: 687b ldr r3, [r7, #4]
|
|
800266e: 681b ldr r3, [r3, #0]
|
|
8002670: 695b ldr r3, [r3, #20]
|
|
8002672: 617b str r3, [r7, #20]
|
|
|
|
/* Clear Direct mode and FIFO threshold bits */
|
|
tmp &= (uint32_t)~(DMA_SxFCR_DMDIS | DMA_SxFCR_FTH);
|
|
8002674: 697b ldr r3, [r7, #20]
|
|
8002676: f023 0307 bic.w r3, r3, #7
|
|
800267a: 617b str r3, [r7, #20]
|
|
|
|
/* Prepare the DMA Stream FIFO configuration */
|
|
tmp |= hdma->Init.FIFOMode;
|
|
800267c: 687b ldr r3, [r7, #4]
|
|
800267e: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
8002680: 697a ldr r2, [r7, #20]
|
|
8002682: 4313 orrs r3, r2
|
|
8002684: 617b str r3, [r7, #20]
|
|
|
|
/* The FIFO threshold is not used when the FIFO mode is disabled */
|
|
if(hdma->Init.FIFOMode == DMA_FIFOMODE_ENABLE)
|
|
8002686: 687b ldr r3, [r7, #4]
|
|
8002688: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
800268a: 2b04 cmp r3, #4
|
|
800268c: d117 bne.n 80026be <HAL_DMA_Init+0x3f6>
|
|
{
|
|
/* Get the FIFO threshold */
|
|
tmp |= hdma->Init.FIFOThreshold;
|
|
800268e: 687b ldr r3, [r7, #4]
|
|
8002690: 6a9b ldr r3, [r3, #40] @ 0x28
|
|
8002692: 697a ldr r2, [r7, #20]
|
|
8002694: 4313 orrs r3, r2
|
|
8002696: 617b str r3, [r7, #20]
|
|
|
|
/* Check compatibility between FIFO threshold level and size of the memory burst */
|
|
/* for INCR4, INCR8, INCR16 bursts */
|
|
if (hdma->Init.MemBurst != DMA_MBURST_SINGLE)
|
|
8002698: 687b ldr r3, [r7, #4]
|
|
800269a: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
800269c: 2b00 cmp r3, #0
|
|
800269e: d00e beq.n 80026be <HAL_DMA_Init+0x3f6>
|
|
{
|
|
if (DMA_CheckFifoParam(hdma) != HAL_OK)
|
|
80026a0: 6878 ldr r0, [r7, #4]
|
|
80026a2: f000 fa0d bl 8002ac0 <DMA_CheckFifoParam>
|
|
80026a6: 4603 mov r3, r0
|
|
80026a8: 2b00 cmp r3, #0
|
|
80026aa: d008 beq.n 80026be <HAL_DMA_Init+0x3f6>
|
|
{
|
|
/* Update error code */
|
|
hdma->ErrorCode = HAL_DMA_ERROR_PARAM;
|
|
80026ac: 687b ldr r3, [r7, #4]
|
|
80026ae: 2240 movs r2, #64 @ 0x40
|
|
80026b0: 655a str r2, [r3, #84] @ 0x54
|
|
|
|
/* Change the DMA state */
|
|
hdma->State = HAL_DMA_STATE_READY;
|
|
80026b2: 687b ldr r3, [r7, #4]
|
|
80026b4: 2201 movs r2, #1
|
|
80026b6: f883 2035 strb.w r2, [r3, #53] @ 0x35
|
|
|
|
return HAL_ERROR;
|
|
80026ba: 2301 movs r3, #1
|
|
80026bc: e016 b.n 80026ec <HAL_DMA_Init+0x424>
|
|
}
|
|
}
|
|
}
|
|
|
|
/* Write to DMA Stream FCR */
|
|
hdma->Instance->FCR = tmp;
|
|
80026be: 687b ldr r3, [r7, #4]
|
|
80026c0: 681b ldr r3, [r3, #0]
|
|
80026c2: 697a ldr r2, [r7, #20]
|
|
80026c4: 615a str r2, [r3, #20]
|
|
|
|
/* Initialize StreamBaseAddress and StreamIndex parameters to be used to calculate
|
|
DMA steam Base Address needed by HAL_DMA_IRQHandler() and HAL_DMA_PollForTransfer() */
|
|
regs = (DMA_Base_Registers *)DMA_CalcBaseAndBitshift(hdma);
|
|
80026c6: 6878 ldr r0, [r7, #4]
|
|
80026c8: f000 f9c4 bl 8002a54 <DMA_CalcBaseAndBitshift>
|
|
80026cc: 4603 mov r3, r0
|
|
80026ce: 60fb str r3, [r7, #12]
|
|
|
|
/* Clear all interrupt flags */
|
|
regs->IFCR = 0x3FU << hdma->StreamIndex;
|
|
80026d0: 687b ldr r3, [r7, #4]
|
|
80026d2: 6ddb ldr r3, [r3, #92] @ 0x5c
|
|
80026d4: 223f movs r2, #63 @ 0x3f
|
|
80026d6: 409a lsls r2, r3
|
|
80026d8: 68fb ldr r3, [r7, #12]
|
|
80026da: 609a str r2, [r3, #8]
|
|
|
|
/* Initialize the error code */
|
|
hdma->ErrorCode = HAL_DMA_ERROR_NONE;
|
|
80026dc: 687b ldr r3, [r7, #4]
|
|
80026de: 2200 movs r2, #0
|
|
80026e0: 655a str r2, [r3, #84] @ 0x54
|
|
|
|
/* Initialize the DMA state */
|
|
hdma->State = HAL_DMA_STATE_READY;
|
|
80026e2: 687b ldr r3, [r7, #4]
|
|
80026e4: 2201 movs r2, #1
|
|
80026e6: f883 2035 strb.w r2, [r3, #53] @ 0x35
|
|
|
|
return HAL_OK;
|
|
80026ea: 2300 movs r3, #0
|
|
}
|
|
80026ec: 4618 mov r0, r3
|
|
80026ee: 3718 adds r7, #24
|
|
80026f0: 46bd mov sp, r7
|
|
80026f2: bd80 pop {r7, pc}
|
|
80026f4: 0800a130 .word 0x0800a130
|
|
80026f8: f010803f .word 0xf010803f
|
|
|
|
080026fc <HAL_DMA_Abort_IT>:
|
|
* @param hdma pointer to a DMA_HandleTypeDef structure that contains
|
|
* the configuration information for the specified DMA Stream.
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_DMA_Abort_IT(DMA_HandleTypeDef *hdma)
|
|
{
|
|
80026fc: b480 push {r7}
|
|
80026fe: b083 sub sp, #12
|
|
8002700: af00 add r7, sp, #0
|
|
8002702: 6078 str r0, [r7, #4]
|
|
if(hdma->State != HAL_DMA_STATE_BUSY)
|
|
8002704: 687b ldr r3, [r7, #4]
|
|
8002706: f893 3035 ldrb.w r3, [r3, #53] @ 0x35
|
|
800270a: b2db uxtb r3, r3
|
|
800270c: 2b02 cmp r3, #2
|
|
800270e: d004 beq.n 800271a <HAL_DMA_Abort_IT+0x1e>
|
|
{
|
|
hdma->ErrorCode = HAL_DMA_ERROR_NO_XFER;
|
|
8002710: 687b ldr r3, [r7, #4]
|
|
8002712: 2280 movs r2, #128 @ 0x80
|
|
8002714: 655a str r2, [r3, #84] @ 0x54
|
|
return HAL_ERROR;
|
|
8002716: 2301 movs r3, #1
|
|
8002718: e00c b.n 8002734 <HAL_DMA_Abort_IT+0x38>
|
|
}
|
|
else
|
|
{
|
|
/* Set Abort State */
|
|
hdma->State = HAL_DMA_STATE_ABORT;
|
|
800271a: 687b ldr r3, [r7, #4]
|
|
800271c: 2205 movs r2, #5
|
|
800271e: f883 2035 strb.w r2, [r3, #53] @ 0x35
|
|
|
|
/* Disable the stream */
|
|
__HAL_DMA_DISABLE(hdma);
|
|
8002722: 687b ldr r3, [r7, #4]
|
|
8002724: 681b ldr r3, [r3, #0]
|
|
8002726: 681a ldr r2, [r3, #0]
|
|
8002728: 687b ldr r3, [r7, #4]
|
|
800272a: 681b ldr r3, [r3, #0]
|
|
800272c: f022 0201 bic.w r2, r2, #1
|
|
8002730: 601a str r2, [r3, #0]
|
|
}
|
|
|
|
return HAL_OK;
|
|
8002732: 2300 movs r3, #0
|
|
}
|
|
8002734: 4618 mov r0, r3
|
|
8002736: 370c adds r7, #12
|
|
8002738: 46bd mov sp, r7
|
|
800273a: f85d 7b04 ldr.w r7, [sp], #4
|
|
800273e: 4770 bx lr
|
|
|
|
08002740 <HAL_DMA_IRQHandler>:
|
|
* @param hdma pointer to a DMA_HandleTypeDef structure that contains
|
|
* the configuration information for the specified DMA Stream.
|
|
* @retval None
|
|
*/
|
|
void HAL_DMA_IRQHandler(DMA_HandleTypeDef *hdma)
|
|
{
|
|
8002740: b580 push {r7, lr}
|
|
8002742: b086 sub sp, #24
|
|
8002744: af00 add r7, sp, #0
|
|
8002746: 6078 str r0, [r7, #4]
|
|
uint32_t tmpisr;
|
|
__IO uint32_t count = 0U;
|
|
8002748: 2300 movs r3, #0
|
|
800274a: 60bb str r3, [r7, #8]
|
|
uint32_t timeout = SystemCoreClock / 9600U;
|
|
800274c: 4b8e ldr r3, [pc, #568] @ (8002988 <HAL_DMA_IRQHandler+0x248>)
|
|
800274e: 681b ldr r3, [r3, #0]
|
|
8002750: 4a8e ldr r2, [pc, #568] @ (800298c <HAL_DMA_IRQHandler+0x24c>)
|
|
8002752: fba2 2303 umull r2, r3, r2, r3
|
|
8002756: 0a9b lsrs r3, r3, #10
|
|
8002758: 617b str r3, [r7, #20]
|
|
|
|
/* calculate DMA base and stream number */
|
|
DMA_Base_Registers *regs = (DMA_Base_Registers *)hdma->StreamBaseAddress;
|
|
800275a: 687b ldr r3, [r7, #4]
|
|
800275c: 6d9b ldr r3, [r3, #88] @ 0x58
|
|
800275e: 613b str r3, [r7, #16]
|
|
|
|
tmpisr = regs->ISR;
|
|
8002760: 693b ldr r3, [r7, #16]
|
|
8002762: 681b ldr r3, [r3, #0]
|
|
8002764: 60fb str r3, [r7, #12]
|
|
|
|
/* Transfer Error Interrupt management ***************************************/
|
|
if ((tmpisr & (DMA_FLAG_TEIF0_4 << hdma->StreamIndex)) != RESET)
|
|
8002766: 687b ldr r3, [r7, #4]
|
|
8002768: 6ddb ldr r3, [r3, #92] @ 0x5c
|
|
800276a: 2208 movs r2, #8
|
|
800276c: 409a lsls r2, r3
|
|
800276e: 68fb ldr r3, [r7, #12]
|
|
8002770: 4013 ands r3, r2
|
|
8002772: 2b00 cmp r3, #0
|
|
8002774: d01a beq.n 80027ac <HAL_DMA_IRQHandler+0x6c>
|
|
{
|
|
if(__HAL_DMA_GET_IT_SOURCE(hdma, DMA_IT_TE) != RESET)
|
|
8002776: 687b ldr r3, [r7, #4]
|
|
8002778: 681b ldr r3, [r3, #0]
|
|
800277a: 681b ldr r3, [r3, #0]
|
|
800277c: f003 0304 and.w r3, r3, #4
|
|
8002780: 2b00 cmp r3, #0
|
|
8002782: d013 beq.n 80027ac <HAL_DMA_IRQHandler+0x6c>
|
|
{
|
|
/* Disable the transfer error interrupt */
|
|
hdma->Instance->CR &= ~(DMA_IT_TE);
|
|
8002784: 687b ldr r3, [r7, #4]
|
|
8002786: 681b ldr r3, [r3, #0]
|
|
8002788: 681a ldr r2, [r3, #0]
|
|
800278a: 687b ldr r3, [r7, #4]
|
|
800278c: 681b ldr r3, [r3, #0]
|
|
800278e: f022 0204 bic.w r2, r2, #4
|
|
8002792: 601a str r2, [r3, #0]
|
|
|
|
/* Clear the transfer error flag */
|
|
regs->IFCR = DMA_FLAG_TEIF0_4 << hdma->StreamIndex;
|
|
8002794: 687b ldr r3, [r7, #4]
|
|
8002796: 6ddb ldr r3, [r3, #92] @ 0x5c
|
|
8002798: 2208 movs r2, #8
|
|
800279a: 409a lsls r2, r3
|
|
800279c: 693b ldr r3, [r7, #16]
|
|
800279e: 609a str r2, [r3, #8]
|
|
|
|
/* Update error code */
|
|
hdma->ErrorCode |= HAL_DMA_ERROR_TE;
|
|
80027a0: 687b ldr r3, [r7, #4]
|
|
80027a2: 6d5b ldr r3, [r3, #84] @ 0x54
|
|
80027a4: f043 0201 orr.w r2, r3, #1
|
|
80027a8: 687b ldr r3, [r7, #4]
|
|
80027aa: 655a str r2, [r3, #84] @ 0x54
|
|
}
|
|
}
|
|
/* FIFO Error Interrupt management ******************************************/
|
|
if ((tmpisr & (DMA_FLAG_FEIF0_4 << hdma->StreamIndex)) != RESET)
|
|
80027ac: 687b ldr r3, [r7, #4]
|
|
80027ae: 6ddb ldr r3, [r3, #92] @ 0x5c
|
|
80027b0: 2201 movs r2, #1
|
|
80027b2: 409a lsls r2, r3
|
|
80027b4: 68fb ldr r3, [r7, #12]
|
|
80027b6: 4013 ands r3, r2
|
|
80027b8: 2b00 cmp r3, #0
|
|
80027ba: d012 beq.n 80027e2 <HAL_DMA_IRQHandler+0xa2>
|
|
{
|
|
if(__HAL_DMA_GET_IT_SOURCE(hdma, DMA_IT_FE) != RESET)
|
|
80027bc: 687b ldr r3, [r7, #4]
|
|
80027be: 681b ldr r3, [r3, #0]
|
|
80027c0: 695b ldr r3, [r3, #20]
|
|
80027c2: f003 0380 and.w r3, r3, #128 @ 0x80
|
|
80027c6: 2b00 cmp r3, #0
|
|
80027c8: d00b beq.n 80027e2 <HAL_DMA_IRQHandler+0xa2>
|
|
{
|
|
/* Clear the FIFO error flag */
|
|
regs->IFCR = DMA_FLAG_FEIF0_4 << hdma->StreamIndex;
|
|
80027ca: 687b ldr r3, [r7, #4]
|
|
80027cc: 6ddb ldr r3, [r3, #92] @ 0x5c
|
|
80027ce: 2201 movs r2, #1
|
|
80027d0: 409a lsls r2, r3
|
|
80027d2: 693b ldr r3, [r7, #16]
|
|
80027d4: 609a str r2, [r3, #8]
|
|
|
|
/* Update error code */
|
|
hdma->ErrorCode |= HAL_DMA_ERROR_FE;
|
|
80027d6: 687b ldr r3, [r7, #4]
|
|
80027d8: 6d5b ldr r3, [r3, #84] @ 0x54
|
|
80027da: f043 0202 orr.w r2, r3, #2
|
|
80027de: 687b ldr r3, [r7, #4]
|
|
80027e0: 655a str r2, [r3, #84] @ 0x54
|
|
}
|
|
}
|
|
/* Direct Mode Error Interrupt management ***********************************/
|
|
if ((tmpisr & (DMA_FLAG_DMEIF0_4 << hdma->StreamIndex)) != RESET)
|
|
80027e2: 687b ldr r3, [r7, #4]
|
|
80027e4: 6ddb ldr r3, [r3, #92] @ 0x5c
|
|
80027e6: 2204 movs r2, #4
|
|
80027e8: 409a lsls r2, r3
|
|
80027ea: 68fb ldr r3, [r7, #12]
|
|
80027ec: 4013 ands r3, r2
|
|
80027ee: 2b00 cmp r3, #0
|
|
80027f0: d012 beq.n 8002818 <HAL_DMA_IRQHandler+0xd8>
|
|
{
|
|
if(__HAL_DMA_GET_IT_SOURCE(hdma, DMA_IT_DME) != RESET)
|
|
80027f2: 687b ldr r3, [r7, #4]
|
|
80027f4: 681b ldr r3, [r3, #0]
|
|
80027f6: 681b ldr r3, [r3, #0]
|
|
80027f8: f003 0302 and.w r3, r3, #2
|
|
80027fc: 2b00 cmp r3, #0
|
|
80027fe: d00b beq.n 8002818 <HAL_DMA_IRQHandler+0xd8>
|
|
{
|
|
/* Clear the direct mode error flag */
|
|
regs->IFCR = DMA_FLAG_DMEIF0_4 << hdma->StreamIndex;
|
|
8002800: 687b ldr r3, [r7, #4]
|
|
8002802: 6ddb ldr r3, [r3, #92] @ 0x5c
|
|
8002804: 2204 movs r2, #4
|
|
8002806: 409a lsls r2, r3
|
|
8002808: 693b ldr r3, [r7, #16]
|
|
800280a: 609a str r2, [r3, #8]
|
|
|
|
/* Update error code */
|
|
hdma->ErrorCode |= HAL_DMA_ERROR_DME;
|
|
800280c: 687b ldr r3, [r7, #4]
|
|
800280e: 6d5b ldr r3, [r3, #84] @ 0x54
|
|
8002810: f043 0204 orr.w r2, r3, #4
|
|
8002814: 687b ldr r3, [r7, #4]
|
|
8002816: 655a str r2, [r3, #84] @ 0x54
|
|
}
|
|
}
|
|
/* Half Transfer Complete Interrupt management ******************************/
|
|
if ((tmpisr & (DMA_FLAG_HTIF0_4 << hdma->StreamIndex)) != RESET)
|
|
8002818: 687b ldr r3, [r7, #4]
|
|
800281a: 6ddb ldr r3, [r3, #92] @ 0x5c
|
|
800281c: 2210 movs r2, #16
|
|
800281e: 409a lsls r2, r3
|
|
8002820: 68fb ldr r3, [r7, #12]
|
|
8002822: 4013 ands r3, r2
|
|
8002824: 2b00 cmp r3, #0
|
|
8002826: d043 beq.n 80028b0 <HAL_DMA_IRQHandler+0x170>
|
|
{
|
|
if(__HAL_DMA_GET_IT_SOURCE(hdma, DMA_IT_HT) != RESET)
|
|
8002828: 687b ldr r3, [r7, #4]
|
|
800282a: 681b ldr r3, [r3, #0]
|
|
800282c: 681b ldr r3, [r3, #0]
|
|
800282e: f003 0308 and.w r3, r3, #8
|
|
8002832: 2b00 cmp r3, #0
|
|
8002834: d03c beq.n 80028b0 <HAL_DMA_IRQHandler+0x170>
|
|
{
|
|
/* Clear the half transfer complete flag */
|
|
regs->IFCR = DMA_FLAG_HTIF0_4 << hdma->StreamIndex;
|
|
8002836: 687b ldr r3, [r7, #4]
|
|
8002838: 6ddb ldr r3, [r3, #92] @ 0x5c
|
|
800283a: 2210 movs r2, #16
|
|
800283c: 409a lsls r2, r3
|
|
800283e: 693b ldr r3, [r7, #16]
|
|
8002840: 609a str r2, [r3, #8]
|
|
|
|
/* Multi_Buffering mode enabled */
|
|
if(((hdma->Instance->CR) & (uint32_t)(DMA_SxCR_DBM)) != RESET)
|
|
8002842: 687b ldr r3, [r7, #4]
|
|
8002844: 681b ldr r3, [r3, #0]
|
|
8002846: 681b ldr r3, [r3, #0]
|
|
8002848: f403 2380 and.w r3, r3, #262144 @ 0x40000
|
|
800284c: 2b00 cmp r3, #0
|
|
800284e: d018 beq.n 8002882 <HAL_DMA_IRQHandler+0x142>
|
|
{
|
|
/* Current memory buffer used is Memory 0 */
|
|
if((hdma->Instance->CR & DMA_SxCR_CT) == RESET)
|
|
8002850: 687b ldr r3, [r7, #4]
|
|
8002852: 681b ldr r3, [r3, #0]
|
|
8002854: 681b ldr r3, [r3, #0]
|
|
8002856: f403 2300 and.w r3, r3, #524288 @ 0x80000
|
|
800285a: 2b00 cmp r3, #0
|
|
800285c: d108 bne.n 8002870 <HAL_DMA_IRQHandler+0x130>
|
|
{
|
|
if(hdma->XferHalfCpltCallback != NULL)
|
|
800285e: 687b ldr r3, [r7, #4]
|
|
8002860: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
8002862: 2b00 cmp r3, #0
|
|
8002864: d024 beq.n 80028b0 <HAL_DMA_IRQHandler+0x170>
|
|
{
|
|
/* Half transfer callback */
|
|
hdma->XferHalfCpltCallback(hdma);
|
|
8002866: 687b ldr r3, [r7, #4]
|
|
8002868: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
800286a: 6878 ldr r0, [r7, #4]
|
|
800286c: 4798 blx r3
|
|
800286e: e01f b.n 80028b0 <HAL_DMA_IRQHandler+0x170>
|
|
}
|
|
}
|
|
/* Current memory buffer used is Memory 1 */
|
|
else
|
|
{
|
|
if(hdma->XferM1HalfCpltCallback != NULL)
|
|
8002870: 687b ldr r3, [r7, #4]
|
|
8002872: 6c9b ldr r3, [r3, #72] @ 0x48
|
|
8002874: 2b00 cmp r3, #0
|
|
8002876: d01b beq.n 80028b0 <HAL_DMA_IRQHandler+0x170>
|
|
{
|
|
/* Half transfer callback */
|
|
hdma->XferM1HalfCpltCallback(hdma);
|
|
8002878: 687b ldr r3, [r7, #4]
|
|
800287a: 6c9b ldr r3, [r3, #72] @ 0x48
|
|
800287c: 6878 ldr r0, [r7, #4]
|
|
800287e: 4798 blx r3
|
|
8002880: e016 b.n 80028b0 <HAL_DMA_IRQHandler+0x170>
|
|
}
|
|
}
|
|
else
|
|
{
|
|
/* Disable the half transfer interrupt if the DMA mode is not CIRCULAR */
|
|
if((hdma->Instance->CR & DMA_SxCR_CIRC) == RESET)
|
|
8002882: 687b ldr r3, [r7, #4]
|
|
8002884: 681b ldr r3, [r3, #0]
|
|
8002886: 681b ldr r3, [r3, #0]
|
|
8002888: f403 7380 and.w r3, r3, #256 @ 0x100
|
|
800288c: 2b00 cmp r3, #0
|
|
800288e: d107 bne.n 80028a0 <HAL_DMA_IRQHandler+0x160>
|
|
{
|
|
/* Disable the half transfer interrupt */
|
|
hdma->Instance->CR &= ~(DMA_IT_HT);
|
|
8002890: 687b ldr r3, [r7, #4]
|
|
8002892: 681b ldr r3, [r3, #0]
|
|
8002894: 681a ldr r2, [r3, #0]
|
|
8002896: 687b ldr r3, [r7, #4]
|
|
8002898: 681b ldr r3, [r3, #0]
|
|
800289a: f022 0208 bic.w r2, r2, #8
|
|
800289e: 601a str r2, [r3, #0]
|
|
}
|
|
|
|
if(hdma->XferHalfCpltCallback != NULL)
|
|
80028a0: 687b ldr r3, [r7, #4]
|
|
80028a2: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
80028a4: 2b00 cmp r3, #0
|
|
80028a6: d003 beq.n 80028b0 <HAL_DMA_IRQHandler+0x170>
|
|
{
|
|
/* Half transfer callback */
|
|
hdma->XferHalfCpltCallback(hdma);
|
|
80028a8: 687b ldr r3, [r7, #4]
|
|
80028aa: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
80028ac: 6878 ldr r0, [r7, #4]
|
|
80028ae: 4798 blx r3
|
|
}
|
|
}
|
|
}
|
|
}
|
|
/* Transfer Complete Interrupt management ***********************************/
|
|
if ((tmpisr & (DMA_FLAG_TCIF0_4 << hdma->StreamIndex)) != RESET)
|
|
80028b0: 687b ldr r3, [r7, #4]
|
|
80028b2: 6ddb ldr r3, [r3, #92] @ 0x5c
|
|
80028b4: 2220 movs r2, #32
|
|
80028b6: 409a lsls r2, r3
|
|
80028b8: 68fb ldr r3, [r7, #12]
|
|
80028ba: 4013 ands r3, r2
|
|
80028bc: 2b00 cmp r3, #0
|
|
80028be: f000 808f beq.w 80029e0 <HAL_DMA_IRQHandler+0x2a0>
|
|
{
|
|
if(__HAL_DMA_GET_IT_SOURCE(hdma, DMA_IT_TC) != RESET)
|
|
80028c2: 687b ldr r3, [r7, #4]
|
|
80028c4: 681b ldr r3, [r3, #0]
|
|
80028c6: 681b ldr r3, [r3, #0]
|
|
80028c8: f003 0310 and.w r3, r3, #16
|
|
80028cc: 2b00 cmp r3, #0
|
|
80028ce: f000 8087 beq.w 80029e0 <HAL_DMA_IRQHandler+0x2a0>
|
|
{
|
|
/* Clear the transfer complete flag */
|
|
regs->IFCR = DMA_FLAG_TCIF0_4 << hdma->StreamIndex;
|
|
80028d2: 687b ldr r3, [r7, #4]
|
|
80028d4: 6ddb ldr r3, [r3, #92] @ 0x5c
|
|
80028d6: 2220 movs r2, #32
|
|
80028d8: 409a lsls r2, r3
|
|
80028da: 693b ldr r3, [r7, #16]
|
|
80028dc: 609a str r2, [r3, #8]
|
|
|
|
if(HAL_DMA_STATE_ABORT == hdma->State)
|
|
80028de: 687b ldr r3, [r7, #4]
|
|
80028e0: f893 3035 ldrb.w r3, [r3, #53] @ 0x35
|
|
80028e4: b2db uxtb r3, r3
|
|
80028e6: 2b05 cmp r3, #5
|
|
80028e8: d136 bne.n 8002958 <HAL_DMA_IRQHandler+0x218>
|
|
{
|
|
/* Disable all the transfer interrupts */
|
|
hdma->Instance->CR &= ~(DMA_IT_TC | DMA_IT_TE | DMA_IT_DME);
|
|
80028ea: 687b ldr r3, [r7, #4]
|
|
80028ec: 681b ldr r3, [r3, #0]
|
|
80028ee: 681a ldr r2, [r3, #0]
|
|
80028f0: 687b ldr r3, [r7, #4]
|
|
80028f2: 681b ldr r3, [r3, #0]
|
|
80028f4: f022 0216 bic.w r2, r2, #22
|
|
80028f8: 601a str r2, [r3, #0]
|
|
hdma->Instance->FCR &= ~(DMA_IT_FE);
|
|
80028fa: 687b ldr r3, [r7, #4]
|
|
80028fc: 681b ldr r3, [r3, #0]
|
|
80028fe: 695a ldr r2, [r3, #20]
|
|
8002900: 687b ldr r3, [r7, #4]
|
|
8002902: 681b ldr r3, [r3, #0]
|
|
8002904: f022 0280 bic.w r2, r2, #128 @ 0x80
|
|
8002908: 615a str r2, [r3, #20]
|
|
|
|
if((hdma->XferHalfCpltCallback != NULL) || (hdma->XferM1HalfCpltCallback != NULL))
|
|
800290a: 687b ldr r3, [r7, #4]
|
|
800290c: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
800290e: 2b00 cmp r3, #0
|
|
8002910: d103 bne.n 800291a <HAL_DMA_IRQHandler+0x1da>
|
|
8002912: 687b ldr r3, [r7, #4]
|
|
8002914: 6c9b ldr r3, [r3, #72] @ 0x48
|
|
8002916: 2b00 cmp r3, #0
|
|
8002918: d007 beq.n 800292a <HAL_DMA_IRQHandler+0x1ea>
|
|
{
|
|
hdma->Instance->CR &= ~(DMA_IT_HT);
|
|
800291a: 687b ldr r3, [r7, #4]
|
|
800291c: 681b ldr r3, [r3, #0]
|
|
800291e: 681a ldr r2, [r3, #0]
|
|
8002920: 687b ldr r3, [r7, #4]
|
|
8002922: 681b ldr r3, [r3, #0]
|
|
8002924: f022 0208 bic.w r2, r2, #8
|
|
8002928: 601a str r2, [r3, #0]
|
|
}
|
|
|
|
/* Clear all interrupt flags at correct offset within the register */
|
|
regs->IFCR = 0x3FU << hdma->StreamIndex;
|
|
800292a: 687b ldr r3, [r7, #4]
|
|
800292c: 6ddb ldr r3, [r3, #92] @ 0x5c
|
|
800292e: 223f movs r2, #63 @ 0x3f
|
|
8002930: 409a lsls r2, r3
|
|
8002932: 693b ldr r3, [r7, #16]
|
|
8002934: 609a str r2, [r3, #8]
|
|
|
|
/* Change the DMA state */
|
|
hdma->State = HAL_DMA_STATE_READY;
|
|
8002936: 687b ldr r3, [r7, #4]
|
|
8002938: 2201 movs r2, #1
|
|
800293a: f883 2035 strb.w r2, [r3, #53] @ 0x35
|
|
|
|
/* Process Unlocked */
|
|
__HAL_UNLOCK(hdma);
|
|
800293e: 687b ldr r3, [r7, #4]
|
|
8002940: 2200 movs r2, #0
|
|
8002942: f883 2034 strb.w r2, [r3, #52] @ 0x34
|
|
|
|
if(hdma->XferAbortCallback != NULL)
|
|
8002946: 687b ldr r3, [r7, #4]
|
|
8002948: 6d1b ldr r3, [r3, #80] @ 0x50
|
|
800294a: 2b00 cmp r3, #0
|
|
800294c: d07e beq.n 8002a4c <HAL_DMA_IRQHandler+0x30c>
|
|
{
|
|
hdma->XferAbortCallback(hdma);
|
|
800294e: 687b ldr r3, [r7, #4]
|
|
8002950: 6d1b ldr r3, [r3, #80] @ 0x50
|
|
8002952: 6878 ldr r0, [r7, #4]
|
|
8002954: 4798 blx r3
|
|
}
|
|
return;
|
|
8002956: e079 b.n 8002a4c <HAL_DMA_IRQHandler+0x30c>
|
|
}
|
|
|
|
if(((hdma->Instance->CR) & (uint32_t)(DMA_SxCR_DBM)) != RESET)
|
|
8002958: 687b ldr r3, [r7, #4]
|
|
800295a: 681b ldr r3, [r3, #0]
|
|
800295c: 681b ldr r3, [r3, #0]
|
|
800295e: f403 2380 and.w r3, r3, #262144 @ 0x40000
|
|
8002962: 2b00 cmp r3, #0
|
|
8002964: d01d beq.n 80029a2 <HAL_DMA_IRQHandler+0x262>
|
|
{
|
|
/* Current memory buffer used is Memory 0 */
|
|
if((hdma->Instance->CR & DMA_SxCR_CT) == RESET)
|
|
8002966: 687b ldr r3, [r7, #4]
|
|
8002968: 681b ldr r3, [r3, #0]
|
|
800296a: 681b ldr r3, [r3, #0]
|
|
800296c: f403 2300 and.w r3, r3, #524288 @ 0x80000
|
|
8002970: 2b00 cmp r3, #0
|
|
8002972: d10d bne.n 8002990 <HAL_DMA_IRQHandler+0x250>
|
|
{
|
|
if(hdma->XferM1CpltCallback != NULL)
|
|
8002974: 687b ldr r3, [r7, #4]
|
|
8002976: 6c5b ldr r3, [r3, #68] @ 0x44
|
|
8002978: 2b00 cmp r3, #0
|
|
800297a: d031 beq.n 80029e0 <HAL_DMA_IRQHandler+0x2a0>
|
|
{
|
|
/* Transfer complete Callback for memory1 */
|
|
hdma->XferM1CpltCallback(hdma);
|
|
800297c: 687b ldr r3, [r7, #4]
|
|
800297e: 6c5b ldr r3, [r3, #68] @ 0x44
|
|
8002980: 6878 ldr r0, [r7, #4]
|
|
8002982: 4798 blx r3
|
|
8002984: e02c b.n 80029e0 <HAL_DMA_IRQHandler+0x2a0>
|
|
8002986: bf00 nop
|
|
8002988: 20000018 .word 0x20000018
|
|
800298c: 1b4e81b5 .word 0x1b4e81b5
|
|
}
|
|
}
|
|
/* Current memory buffer used is Memory 1 */
|
|
else
|
|
{
|
|
if(hdma->XferCpltCallback != NULL)
|
|
8002990: 687b ldr r3, [r7, #4]
|
|
8002992: 6bdb ldr r3, [r3, #60] @ 0x3c
|
|
8002994: 2b00 cmp r3, #0
|
|
8002996: d023 beq.n 80029e0 <HAL_DMA_IRQHandler+0x2a0>
|
|
{
|
|
/* Transfer complete Callback for memory0 */
|
|
hdma->XferCpltCallback(hdma);
|
|
8002998: 687b ldr r3, [r7, #4]
|
|
800299a: 6bdb ldr r3, [r3, #60] @ 0x3c
|
|
800299c: 6878 ldr r0, [r7, #4]
|
|
800299e: 4798 blx r3
|
|
80029a0: e01e b.n 80029e0 <HAL_DMA_IRQHandler+0x2a0>
|
|
}
|
|
}
|
|
/* Disable the transfer complete interrupt if the DMA mode is not CIRCULAR */
|
|
else
|
|
{
|
|
if((hdma->Instance->CR & DMA_SxCR_CIRC) == RESET)
|
|
80029a2: 687b ldr r3, [r7, #4]
|
|
80029a4: 681b ldr r3, [r3, #0]
|
|
80029a6: 681b ldr r3, [r3, #0]
|
|
80029a8: f403 7380 and.w r3, r3, #256 @ 0x100
|
|
80029ac: 2b00 cmp r3, #0
|
|
80029ae: d10f bne.n 80029d0 <HAL_DMA_IRQHandler+0x290>
|
|
{
|
|
/* Disable the transfer complete interrupt */
|
|
hdma->Instance->CR &= ~(DMA_IT_TC);
|
|
80029b0: 687b ldr r3, [r7, #4]
|
|
80029b2: 681b ldr r3, [r3, #0]
|
|
80029b4: 681a ldr r2, [r3, #0]
|
|
80029b6: 687b ldr r3, [r7, #4]
|
|
80029b8: 681b ldr r3, [r3, #0]
|
|
80029ba: f022 0210 bic.w r2, r2, #16
|
|
80029be: 601a str r2, [r3, #0]
|
|
|
|
/* Change the DMA state */
|
|
hdma->State = HAL_DMA_STATE_READY;
|
|
80029c0: 687b ldr r3, [r7, #4]
|
|
80029c2: 2201 movs r2, #1
|
|
80029c4: f883 2035 strb.w r2, [r3, #53] @ 0x35
|
|
|
|
/* Process Unlocked */
|
|
__HAL_UNLOCK(hdma);
|
|
80029c8: 687b ldr r3, [r7, #4]
|
|
80029ca: 2200 movs r2, #0
|
|
80029cc: f883 2034 strb.w r2, [r3, #52] @ 0x34
|
|
}
|
|
|
|
if(hdma->XferCpltCallback != NULL)
|
|
80029d0: 687b ldr r3, [r7, #4]
|
|
80029d2: 6bdb ldr r3, [r3, #60] @ 0x3c
|
|
80029d4: 2b00 cmp r3, #0
|
|
80029d6: d003 beq.n 80029e0 <HAL_DMA_IRQHandler+0x2a0>
|
|
{
|
|
/* Transfer complete callback */
|
|
hdma->XferCpltCallback(hdma);
|
|
80029d8: 687b ldr r3, [r7, #4]
|
|
80029da: 6bdb ldr r3, [r3, #60] @ 0x3c
|
|
80029dc: 6878 ldr r0, [r7, #4]
|
|
80029de: 4798 blx r3
|
|
}
|
|
}
|
|
}
|
|
|
|
/* manage error case */
|
|
if(hdma->ErrorCode != HAL_DMA_ERROR_NONE)
|
|
80029e0: 687b ldr r3, [r7, #4]
|
|
80029e2: 6d5b ldr r3, [r3, #84] @ 0x54
|
|
80029e4: 2b00 cmp r3, #0
|
|
80029e6: d032 beq.n 8002a4e <HAL_DMA_IRQHandler+0x30e>
|
|
{
|
|
if((hdma->ErrorCode & HAL_DMA_ERROR_TE) != RESET)
|
|
80029e8: 687b ldr r3, [r7, #4]
|
|
80029ea: 6d5b ldr r3, [r3, #84] @ 0x54
|
|
80029ec: f003 0301 and.w r3, r3, #1
|
|
80029f0: 2b00 cmp r3, #0
|
|
80029f2: d022 beq.n 8002a3a <HAL_DMA_IRQHandler+0x2fa>
|
|
{
|
|
hdma->State = HAL_DMA_STATE_ABORT;
|
|
80029f4: 687b ldr r3, [r7, #4]
|
|
80029f6: 2205 movs r2, #5
|
|
80029f8: f883 2035 strb.w r2, [r3, #53] @ 0x35
|
|
|
|
/* Disable the stream */
|
|
__HAL_DMA_DISABLE(hdma);
|
|
80029fc: 687b ldr r3, [r7, #4]
|
|
80029fe: 681b ldr r3, [r3, #0]
|
|
8002a00: 681a ldr r2, [r3, #0]
|
|
8002a02: 687b ldr r3, [r7, #4]
|
|
8002a04: 681b ldr r3, [r3, #0]
|
|
8002a06: f022 0201 bic.w r2, r2, #1
|
|
8002a0a: 601a str r2, [r3, #0]
|
|
|
|
do
|
|
{
|
|
if (++count > timeout)
|
|
8002a0c: 68bb ldr r3, [r7, #8]
|
|
8002a0e: 3301 adds r3, #1
|
|
8002a10: 60bb str r3, [r7, #8]
|
|
8002a12: 697a ldr r2, [r7, #20]
|
|
8002a14: 429a cmp r2, r3
|
|
8002a16: d307 bcc.n 8002a28 <HAL_DMA_IRQHandler+0x2e8>
|
|
{
|
|
break;
|
|
}
|
|
}
|
|
while((hdma->Instance->CR & DMA_SxCR_EN) != RESET);
|
|
8002a18: 687b ldr r3, [r7, #4]
|
|
8002a1a: 681b ldr r3, [r3, #0]
|
|
8002a1c: 681b ldr r3, [r3, #0]
|
|
8002a1e: f003 0301 and.w r3, r3, #1
|
|
8002a22: 2b00 cmp r3, #0
|
|
8002a24: d1f2 bne.n 8002a0c <HAL_DMA_IRQHandler+0x2cc>
|
|
8002a26: e000 b.n 8002a2a <HAL_DMA_IRQHandler+0x2ea>
|
|
break;
|
|
8002a28: bf00 nop
|
|
|
|
/* Change the DMA state */
|
|
hdma->State = HAL_DMA_STATE_READY;
|
|
8002a2a: 687b ldr r3, [r7, #4]
|
|
8002a2c: 2201 movs r2, #1
|
|
8002a2e: f883 2035 strb.w r2, [r3, #53] @ 0x35
|
|
|
|
/* Process Unlocked */
|
|
__HAL_UNLOCK(hdma);
|
|
8002a32: 687b ldr r3, [r7, #4]
|
|
8002a34: 2200 movs r2, #0
|
|
8002a36: f883 2034 strb.w r2, [r3, #52] @ 0x34
|
|
}
|
|
|
|
if(hdma->XferErrorCallback != NULL)
|
|
8002a3a: 687b ldr r3, [r7, #4]
|
|
8002a3c: 6cdb ldr r3, [r3, #76] @ 0x4c
|
|
8002a3e: 2b00 cmp r3, #0
|
|
8002a40: d005 beq.n 8002a4e <HAL_DMA_IRQHandler+0x30e>
|
|
{
|
|
/* Transfer error callback */
|
|
hdma->XferErrorCallback(hdma);
|
|
8002a42: 687b ldr r3, [r7, #4]
|
|
8002a44: 6cdb ldr r3, [r3, #76] @ 0x4c
|
|
8002a46: 6878 ldr r0, [r7, #4]
|
|
8002a48: 4798 blx r3
|
|
8002a4a: e000 b.n 8002a4e <HAL_DMA_IRQHandler+0x30e>
|
|
return;
|
|
8002a4c: bf00 nop
|
|
}
|
|
}
|
|
}
|
|
8002a4e: 3718 adds r7, #24
|
|
8002a50: 46bd mov sp, r7
|
|
8002a52: bd80 pop {r7, pc}
|
|
|
|
08002a54 <DMA_CalcBaseAndBitshift>:
|
|
* @param hdma pointer to a DMA_HandleTypeDef structure that contains
|
|
* the configuration information for the specified DMA Stream.
|
|
* @retval Stream base address
|
|
*/
|
|
static uint32_t DMA_CalcBaseAndBitshift(DMA_HandleTypeDef *hdma)
|
|
{
|
|
8002a54: b480 push {r7}
|
|
8002a56: b085 sub sp, #20
|
|
8002a58: af00 add r7, sp, #0
|
|
8002a5a: 6078 str r0, [r7, #4]
|
|
uint32_t stream_number = (((uint32_t)hdma->Instance & 0xFFU) - 16U) / 24U;
|
|
8002a5c: 687b ldr r3, [r7, #4]
|
|
8002a5e: 681b ldr r3, [r3, #0]
|
|
8002a60: b2db uxtb r3, r3
|
|
8002a62: 3b10 subs r3, #16
|
|
8002a64: 4a14 ldr r2, [pc, #80] @ (8002ab8 <DMA_CalcBaseAndBitshift+0x64>)
|
|
8002a66: fba2 2303 umull r2, r3, r2, r3
|
|
8002a6a: 091b lsrs r3, r3, #4
|
|
8002a6c: 60fb str r3, [r7, #12]
|
|
|
|
/* lookup table for necessary bitshift of flags within status registers */
|
|
static const uint8_t flagBitshiftOffset[8U] = {0U, 6U, 16U, 22U, 0U, 6U, 16U, 22U};
|
|
hdma->StreamIndex = flagBitshiftOffset[stream_number];
|
|
8002a6e: 4a13 ldr r2, [pc, #76] @ (8002abc <DMA_CalcBaseAndBitshift+0x68>)
|
|
8002a70: 68fb ldr r3, [r7, #12]
|
|
8002a72: 4413 add r3, r2
|
|
8002a74: 781b ldrb r3, [r3, #0]
|
|
8002a76: 461a mov r2, r3
|
|
8002a78: 687b ldr r3, [r7, #4]
|
|
8002a7a: 65da str r2, [r3, #92] @ 0x5c
|
|
|
|
if (stream_number > 3U)
|
|
8002a7c: 68fb ldr r3, [r7, #12]
|
|
8002a7e: 2b03 cmp r3, #3
|
|
8002a80: d909 bls.n 8002a96 <DMA_CalcBaseAndBitshift+0x42>
|
|
{
|
|
/* return pointer to HISR and HIFCR */
|
|
hdma->StreamBaseAddress = (((uint32_t)hdma->Instance & (uint32_t)(~0x3FFU)) + 4U);
|
|
8002a82: 687b ldr r3, [r7, #4]
|
|
8002a84: 681b ldr r3, [r3, #0]
|
|
8002a86: f423 737f bic.w r3, r3, #1020 @ 0x3fc
|
|
8002a8a: f023 0303 bic.w r3, r3, #3
|
|
8002a8e: 1d1a adds r2, r3, #4
|
|
8002a90: 687b ldr r3, [r7, #4]
|
|
8002a92: 659a str r2, [r3, #88] @ 0x58
|
|
8002a94: e007 b.n 8002aa6 <DMA_CalcBaseAndBitshift+0x52>
|
|
}
|
|
else
|
|
{
|
|
/* return pointer to LISR and LIFCR */
|
|
hdma->StreamBaseAddress = ((uint32_t)hdma->Instance & (uint32_t)(~0x3FFU));
|
|
8002a96: 687b ldr r3, [r7, #4]
|
|
8002a98: 681b ldr r3, [r3, #0]
|
|
8002a9a: f423 737f bic.w r3, r3, #1020 @ 0x3fc
|
|
8002a9e: f023 0303 bic.w r3, r3, #3
|
|
8002aa2: 687a ldr r2, [r7, #4]
|
|
8002aa4: 6593 str r3, [r2, #88] @ 0x58
|
|
}
|
|
|
|
return hdma->StreamBaseAddress;
|
|
8002aa6: 687b ldr r3, [r7, #4]
|
|
8002aa8: 6d9b ldr r3, [r3, #88] @ 0x58
|
|
}
|
|
8002aaa: 4618 mov r0, r3
|
|
8002aac: 3714 adds r7, #20
|
|
8002aae: 46bd mov sp, r7
|
|
8002ab0: f85d 7b04 ldr.w r7, [sp], #4
|
|
8002ab4: 4770 bx lr
|
|
8002ab6: bf00 nop
|
|
8002ab8: aaaaaaab .word 0xaaaaaaab
|
|
8002abc: 0800a2b8 .word 0x0800a2b8
|
|
|
|
08002ac0 <DMA_CheckFifoParam>:
|
|
* @param hdma pointer to a DMA_HandleTypeDef structure that contains
|
|
* the configuration information for the specified DMA Stream.
|
|
* @retval HAL status
|
|
*/
|
|
static HAL_StatusTypeDef DMA_CheckFifoParam(DMA_HandleTypeDef *hdma)
|
|
{
|
|
8002ac0: b480 push {r7}
|
|
8002ac2: b085 sub sp, #20
|
|
8002ac4: af00 add r7, sp, #0
|
|
8002ac6: 6078 str r0, [r7, #4]
|
|
HAL_StatusTypeDef status = HAL_OK;
|
|
8002ac8: 2300 movs r3, #0
|
|
8002aca: 73fb strb r3, [r7, #15]
|
|
uint32_t tmp = hdma->Init.FIFOThreshold;
|
|
8002acc: 687b ldr r3, [r7, #4]
|
|
8002ace: 6a9b ldr r3, [r3, #40] @ 0x28
|
|
8002ad0: 60bb str r3, [r7, #8]
|
|
|
|
/* Memory Data size equal to Byte */
|
|
if(hdma->Init.MemDataAlignment == DMA_MDATAALIGN_BYTE)
|
|
8002ad2: 687b ldr r3, [r7, #4]
|
|
8002ad4: 699b ldr r3, [r3, #24]
|
|
8002ad6: 2b00 cmp r3, #0
|
|
8002ad8: d11f bne.n 8002b1a <DMA_CheckFifoParam+0x5a>
|
|
{
|
|
switch (tmp)
|
|
8002ada: 68bb ldr r3, [r7, #8]
|
|
8002adc: 2b03 cmp r3, #3
|
|
8002ade: d856 bhi.n 8002b8e <DMA_CheckFifoParam+0xce>
|
|
8002ae0: a201 add r2, pc, #4 @ (adr r2, 8002ae8 <DMA_CheckFifoParam+0x28>)
|
|
8002ae2: f852 f023 ldr.w pc, [r2, r3, lsl #2]
|
|
8002ae6: bf00 nop
|
|
8002ae8: 08002af9 .word 0x08002af9
|
|
8002aec: 08002b0b .word 0x08002b0b
|
|
8002af0: 08002af9 .word 0x08002af9
|
|
8002af4: 08002b8f .word 0x08002b8f
|
|
{
|
|
case DMA_FIFO_THRESHOLD_1QUARTERFULL:
|
|
case DMA_FIFO_THRESHOLD_3QUARTERSFULL:
|
|
if ((hdma->Init.MemBurst & DMA_SxCR_MBURST_1) == DMA_SxCR_MBURST_1)
|
|
8002af8: 687b ldr r3, [r7, #4]
|
|
8002afa: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
8002afc: f003 7380 and.w r3, r3, #16777216 @ 0x1000000
|
|
8002b00: 2b00 cmp r3, #0
|
|
8002b02: d046 beq.n 8002b92 <DMA_CheckFifoParam+0xd2>
|
|
{
|
|
status = HAL_ERROR;
|
|
8002b04: 2301 movs r3, #1
|
|
8002b06: 73fb strb r3, [r7, #15]
|
|
}
|
|
break;
|
|
8002b08: e043 b.n 8002b92 <DMA_CheckFifoParam+0xd2>
|
|
case DMA_FIFO_THRESHOLD_HALFFULL:
|
|
if (hdma->Init.MemBurst == DMA_MBURST_INC16)
|
|
8002b0a: 687b ldr r3, [r7, #4]
|
|
8002b0c: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
8002b0e: f1b3 7fc0 cmp.w r3, #25165824 @ 0x1800000
|
|
8002b12: d140 bne.n 8002b96 <DMA_CheckFifoParam+0xd6>
|
|
{
|
|
status = HAL_ERROR;
|
|
8002b14: 2301 movs r3, #1
|
|
8002b16: 73fb strb r3, [r7, #15]
|
|
}
|
|
break;
|
|
8002b18: e03d b.n 8002b96 <DMA_CheckFifoParam+0xd6>
|
|
break;
|
|
}
|
|
}
|
|
|
|
/* Memory Data size equal to Half-Word */
|
|
else if (hdma->Init.MemDataAlignment == DMA_MDATAALIGN_HALFWORD)
|
|
8002b1a: 687b ldr r3, [r7, #4]
|
|
8002b1c: 699b ldr r3, [r3, #24]
|
|
8002b1e: f5b3 5f00 cmp.w r3, #8192 @ 0x2000
|
|
8002b22: d121 bne.n 8002b68 <DMA_CheckFifoParam+0xa8>
|
|
{
|
|
switch (tmp)
|
|
8002b24: 68bb ldr r3, [r7, #8]
|
|
8002b26: 2b03 cmp r3, #3
|
|
8002b28: d837 bhi.n 8002b9a <DMA_CheckFifoParam+0xda>
|
|
8002b2a: a201 add r2, pc, #4 @ (adr r2, 8002b30 <DMA_CheckFifoParam+0x70>)
|
|
8002b2c: f852 f023 ldr.w pc, [r2, r3, lsl #2]
|
|
8002b30: 08002b41 .word 0x08002b41
|
|
8002b34: 08002b47 .word 0x08002b47
|
|
8002b38: 08002b41 .word 0x08002b41
|
|
8002b3c: 08002b59 .word 0x08002b59
|
|
{
|
|
case DMA_FIFO_THRESHOLD_1QUARTERFULL:
|
|
case DMA_FIFO_THRESHOLD_3QUARTERSFULL:
|
|
status = HAL_ERROR;
|
|
8002b40: 2301 movs r3, #1
|
|
8002b42: 73fb strb r3, [r7, #15]
|
|
break;
|
|
8002b44: e030 b.n 8002ba8 <DMA_CheckFifoParam+0xe8>
|
|
case DMA_FIFO_THRESHOLD_HALFFULL:
|
|
if ((hdma->Init.MemBurst & DMA_SxCR_MBURST_1) == DMA_SxCR_MBURST_1)
|
|
8002b46: 687b ldr r3, [r7, #4]
|
|
8002b48: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
8002b4a: f003 7380 and.w r3, r3, #16777216 @ 0x1000000
|
|
8002b4e: 2b00 cmp r3, #0
|
|
8002b50: d025 beq.n 8002b9e <DMA_CheckFifoParam+0xde>
|
|
{
|
|
status = HAL_ERROR;
|
|
8002b52: 2301 movs r3, #1
|
|
8002b54: 73fb strb r3, [r7, #15]
|
|
}
|
|
break;
|
|
8002b56: e022 b.n 8002b9e <DMA_CheckFifoParam+0xde>
|
|
case DMA_FIFO_THRESHOLD_FULL:
|
|
if (hdma->Init.MemBurst == DMA_MBURST_INC16)
|
|
8002b58: 687b ldr r3, [r7, #4]
|
|
8002b5a: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
8002b5c: f1b3 7fc0 cmp.w r3, #25165824 @ 0x1800000
|
|
8002b60: d11f bne.n 8002ba2 <DMA_CheckFifoParam+0xe2>
|
|
{
|
|
status = HAL_ERROR;
|
|
8002b62: 2301 movs r3, #1
|
|
8002b64: 73fb strb r3, [r7, #15]
|
|
}
|
|
break;
|
|
8002b66: e01c b.n 8002ba2 <DMA_CheckFifoParam+0xe2>
|
|
}
|
|
|
|
/* Memory Data size equal to Word */
|
|
else
|
|
{
|
|
switch (tmp)
|
|
8002b68: 68bb ldr r3, [r7, #8]
|
|
8002b6a: 2b02 cmp r3, #2
|
|
8002b6c: d903 bls.n 8002b76 <DMA_CheckFifoParam+0xb6>
|
|
8002b6e: 68bb ldr r3, [r7, #8]
|
|
8002b70: 2b03 cmp r3, #3
|
|
8002b72: d003 beq.n 8002b7c <DMA_CheckFifoParam+0xbc>
|
|
{
|
|
status = HAL_ERROR;
|
|
}
|
|
break;
|
|
default:
|
|
break;
|
|
8002b74: e018 b.n 8002ba8 <DMA_CheckFifoParam+0xe8>
|
|
status = HAL_ERROR;
|
|
8002b76: 2301 movs r3, #1
|
|
8002b78: 73fb strb r3, [r7, #15]
|
|
break;
|
|
8002b7a: e015 b.n 8002ba8 <DMA_CheckFifoParam+0xe8>
|
|
if ((hdma->Init.MemBurst & DMA_SxCR_MBURST_1) == DMA_SxCR_MBURST_1)
|
|
8002b7c: 687b ldr r3, [r7, #4]
|
|
8002b7e: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
8002b80: f003 7380 and.w r3, r3, #16777216 @ 0x1000000
|
|
8002b84: 2b00 cmp r3, #0
|
|
8002b86: d00e beq.n 8002ba6 <DMA_CheckFifoParam+0xe6>
|
|
status = HAL_ERROR;
|
|
8002b88: 2301 movs r3, #1
|
|
8002b8a: 73fb strb r3, [r7, #15]
|
|
break;
|
|
8002b8c: e00b b.n 8002ba6 <DMA_CheckFifoParam+0xe6>
|
|
break;
|
|
8002b8e: bf00 nop
|
|
8002b90: e00a b.n 8002ba8 <DMA_CheckFifoParam+0xe8>
|
|
break;
|
|
8002b92: bf00 nop
|
|
8002b94: e008 b.n 8002ba8 <DMA_CheckFifoParam+0xe8>
|
|
break;
|
|
8002b96: bf00 nop
|
|
8002b98: e006 b.n 8002ba8 <DMA_CheckFifoParam+0xe8>
|
|
break;
|
|
8002b9a: bf00 nop
|
|
8002b9c: e004 b.n 8002ba8 <DMA_CheckFifoParam+0xe8>
|
|
break;
|
|
8002b9e: bf00 nop
|
|
8002ba0: e002 b.n 8002ba8 <DMA_CheckFifoParam+0xe8>
|
|
break;
|
|
8002ba2: bf00 nop
|
|
8002ba4: e000 b.n 8002ba8 <DMA_CheckFifoParam+0xe8>
|
|
break;
|
|
8002ba6: bf00 nop
|
|
}
|
|
}
|
|
|
|
return status;
|
|
8002ba8: 7bfb ldrb r3, [r7, #15]
|
|
}
|
|
8002baa: 4618 mov r0, r3
|
|
8002bac: 3714 adds r7, #20
|
|
8002bae: 46bd mov sp, r7
|
|
8002bb0: f85d 7b04 ldr.w r7, [sp], #4
|
|
8002bb4: 4770 bx lr
|
|
8002bb6: bf00 nop
|
|
|
|
08002bb8 <HAL_GPIO_Init>:
|
|
* @param GPIO_Init pointer to a GPIO_InitTypeDef structure that contains
|
|
* the configuration information for the specified GPIO peripheral.
|
|
* @retval None
|
|
*/
|
|
void HAL_GPIO_Init(GPIO_TypeDef *GPIOx, GPIO_InitTypeDef *GPIO_Init)
|
|
{
|
|
8002bb8: b580 push {r7, lr}
|
|
8002bba: b088 sub sp, #32
|
|
8002bbc: af00 add r7, sp, #0
|
|
8002bbe: 6078 str r0, [r7, #4]
|
|
8002bc0: 6039 str r1, [r7, #0]
|
|
uint32_t position;
|
|
uint32_t ioposition = 0x00U;
|
|
8002bc2: 2300 movs r3, #0
|
|
8002bc4: 617b str r3, [r7, #20]
|
|
uint32_t iocurrent = 0x00U;
|
|
8002bc6: 2300 movs r3, #0
|
|
8002bc8: 613b str r3, [r7, #16]
|
|
uint32_t temp = 0x00U;
|
|
8002bca: 2300 movs r3, #0
|
|
8002bcc: 61bb str r3, [r7, #24]
|
|
|
|
/* Check the parameters */
|
|
assert_param(IS_GPIO_ALL_INSTANCE(GPIOx));
|
|
8002bce: 687b ldr r3, [r7, #4]
|
|
8002bd0: 4a38 ldr r2, [pc, #224] @ (8002cb4 <HAL_GPIO_Init+0xfc>)
|
|
8002bd2: 4293 cmp r3, r2
|
|
8002bd4: d023 beq.n 8002c1e <HAL_GPIO_Init+0x66>
|
|
8002bd6: 687b ldr r3, [r7, #4]
|
|
8002bd8: 4a37 ldr r2, [pc, #220] @ (8002cb8 <HAL_GPIO_Init+0x100>)
|
|
8002bda: 4293 cmp r3, r2
|
|
8002bdc: d01f beq.n 8002c1e <HAL_GPIO_Init+0x66>
|
|
8002bde: 687b ldr r3, [r7, #4]
|
|
8002be0: 4a36 ldr r2, [pc, #216] @ (8002cbc <HAL_GPIO_Init+0x104>)
|
|
8002be2: 4293 cmp r3, r2
|
|
8002be4: d01b beq.n 8002c1e <HAL_GPIO_Init+0x66>
|
|
8002be6: 687b ldr r3, [r7, #4]
|
|
8002be8: 4a35 ldr r2, [pc, #212] @ (8002cc0 <HAL_GPIO_Init+0x108>)
|
|
8002bea: 4293 cmp r3, r2
|
|
8002bec: d017 beq.n 8002c1e <HAL_GPIO_Init+0x66>
|
|
8002bee: 687b ldr r3, [r7, #4]
|
|
8002bf0: 4a34 ldr r2, [pc, #208] @ (8002cc4 <HAL_GPIO_Init+0x10c>)
|
|
8002bf2: 4293 cmp r3, r2
|
|
8002bf4: d013 beq.n 8002c1e <HAL_GPIO_Init+0x66>
|
|
8002bf6: 687b ldr r3, [r7, #4]
|
|
8002bf8: 4a33 ldr r2, [pc, #204] @ (8002cc8 <HAL_GPIO_Init+0x110>)
|
|
8002bfa: 4293 cmp r3, r2
|
|
8002bfc: d00f beq.n 8002c1e <HAL_GPIO_Init+0x66>
|
|
8002bfe: 687b ldr r3, [r7, #4]
|
|
8002c00: 4a32 ldr r2, [pc, #200] @ (8002ccc <HAL_GPIO_Init+0x114>)
|
|
8002c02: 4293 cmp r3, r2
|
|
8002c04: d00b beq.n 8002c1e <HAL_GPIO_Init+0x66>
|
|
8002c06: 687b ldr r3, [r7, #4]
|
|
8002c08: 4a31 ldr r2, [pc, #196] @ (8002cd0 <HAL_GPIO_Init+0x118>)
|
|
8002c0a: 4293 cmp r3, r2
|
|
8002c0c: d007 beq.n 8002c1e <HAL_GPIO_Init+0x66>
|
|
8002c0e: 687b ldr r3, [r7, #4]
|
|
8002c10: 4a30 ldr r2, [pc, #192] @ (8002cd4 <HAL_GPIO_Init+0x11c>)
|
|
8002c12: 4293 cmp r3, r2
|
|
8002c14: d003 beq.n 8002c1e <HAL_GPIO_Init+0x66>
|
|
8002c16: 21ac movs r1, #172 @ 0xac
|
|
8002c18: 482f ldr r0, [pc, #188] @ (8002cd8 <HAL_GPIO_Init+0x120>)
|
|
8002c1a: f7fe f88b bl 8000d34 <assert_failed>
|
|
assert_param(IS_GPIO_PIN(GPIO_Init->Pin));
|
|
8002c1e: 683b ldr r3, [r7, #0]
|
|
8002c20: 681b ldr r3, [r3, #0]
|
|
8002c22: b29b uxth r3, r3
|
|
8002c24: 2b00 cmp r3, #0
|
|
8002c26: d004 beq.n 8002c32 <HAL_GPIO_Init+0x7a>
|
|
8002c28: 683b ldr r3, [r7, #0]
|
|
8002c2a: 681b ldr r3, [r3, #0]
|
|
8002c2c: f5b3 3f80 cmp.w r3, #65536 @ 0x10000
|
|
8002c30: d303 bcc.n 8002c3a <HAL_GPIO_Init+0x82>
|
|
8002c32: 21ad movs r1, #173 @ 0xad
|
|
8002c34: 4828 ldr r0, [pc, #160] @ (8002cd8 <HAL_GPIO_Init+0x120>)
|
|
8002c36: f7fe f87d bl 8000d34 <assert_failed>
|
|
assert_param(IS_GPIO_MODE(GPIO_Init->Mode));
|
|
8002c3a: 683b ldr r3, [r7, #0]
|
|
8002c3c: 685b ldr r3, [r3, #4]
|
|
8002c3e: 2b00 cmp r3, #0
|
|
8002c40: d035 beq.n 8002cae <HAL_GPIO_Init+0xf6>
|
|
8002c42: 683b ldr r3, [r7, #0]
|
|
8002c44: 685b ldr r3, [r3, #4]
|
|
8002c46: 2b01 cmp r3, #1
|
|
8002c48: d031 beq.n 8002cae <HAL_GPIO_Init+0xf6>
|
|
8002c4a: 683b ldr r3, [r7, #0]
|
|
8002c4c: 685b ldr r3, [r3, #4]
|
|
8002c4e: 2b11 cmp r3, #17
|
|
8002c50: d02d beq.n 8002cae <HAL_GPIO_Init+0xf6>
|
|
8002c52: 683b ldr r3, [r7, #0]
|
|
8002c54: 685b ldr r3, [r3, #4]
|
|
8002c56: 2b02 cmp r3, #2
|
|
8002c58: d029 beq.n 8002cae <HAL_GPIO_Init+0xf6>
|
|
8002c5a: 683b ldr r3, [r7, #0]
|
|
8002c5c: 685b ldr r3, [r3, #4]
|
|
8002c5e: 2b12 cmp r3, #18
|
|
8002c60: d025 beq.n 8002cae <HAL_GPIO_Init+0xf6>
|
|
8002c62: 683b ldr r3, [r7, #0]
|
|
8002c64: 685b ldr r3, [r3, #4]
|
|
8002c66: f5b3 1f88 cmp.w r3, #1114112 @ 0x110000
|
|
8002c6a: d020 beq.n 8002cae <HAL_GPIO_Init+0xf6>
|
|
8002c6c: 683b ldr r3, [r7, #0]
|
|
8002c6e: 685b ldr r3, [r3, #4]
|
|
8002c70: f5b3 1f04 cmp.w r3, #2162688 @ 0x210000
|
|
8002c74: d01b beq.n 8002cae <HAL_GPIO_Init+0xf6>
|
|
8002c76: 683b ldr r3, [r7, #0]
|
|
8002c78: 685b ldr r3, [r3, #4]
|
|
8002c7a: f5b3 1f44 cmp.w r3, #3211264 @ 0x310000
|
|
8002c7e: d016 beq.n 8002cae <HAL_GPIO_Init+0xf6>
|
|
8002c80: 683b ldr r3, [r7, #0]
|
|
8002c82: 685b ldr r3, [r3, #4]
|
|
8002c84: f5b3 1f90 cmp.w r3, #1179648 @ 0x120000
|
|
8002c88: d011 beq.n 8002cae <HAL_GPIO_Init+0xf6>
|
|
8002c8a: 683b ldr r3, [r7, #0]
|
|
8002c8c: 685b ldr r3, [r3, #4]
|
|
8002c8e: f5b3 1f08 cmp.w r3, #2228224 @ 0x220000
|
|
8002c92: d00c beq.n 8002cae <HAL_GPIO_Init+0xf6>
|
|
8002c94: 683b ldr r3, [r7, #0]
|
|
8002c96: 685b ldr r3, [r3, #4]
|
|
8002c98: f5b3 1f48 cmp.w r3, #3276800 @ 0x320000
|
|
8002c9c: d007 beq.n 8002cae <HAL_GPIO_Init+0xf6>
|
|
8002c9e: 683b ldr r3, [r7, #0]
|
|
8002ca0: 685b ldr r3, [r3, #4]
|
|
8002ca2: 2b03 cmp r3, #3
|
|
8002ca4: d003 beq.n 8002cae <HAL_GPIO_Init+0xf6>
|
|
8002ca6: 21ae movs r1, #174 @ 0xae
|
|
8002ca8: 480b ldr r0, [pc, #44] @ (8002cd8 <HAL_GPIO_Init+0x120>)
|
|
8002caa: f7fe f843 bl 8000d34 <assert_failed>
|
|
|
|
/* Configure the port pins */
|
|
for(position = 0U; position < GPIO_NUMBER; position++)
|
|
8002cae: 2300 movs r3, #0
|
|
8002cb0: 61fb str r3, [r7, #28]
|
|
8002cb2: e235 b.n 8003120 <HAL_GPIO_Init+0x568>
|
|
8002cb4: 40020000 .word 0x40020000
|
|
8002cb8: 40020400 .word 0x40020400
|
|
8002cbc: 40020800 .word 0x40020800
|
|
8002cc0: 40020c00 .word 0x40020c00
|
|
8002cc4: 40021000 .word 0x40021000
|
|
8002cc8: 40021400 .word 0x40021400
|
|
8002ccc: 40021800 .word 0x40021800
|
|
8002cd0: 40021c00 .word 0x40021c00
|
|
8002cd4: 40022000 .word 0x40022000
|
|
8002cd8: 0800a168 .word 0x0800a168
|
|
{
|
|
/* Get the IO position */
|
|
ioposition = 0x01U << position;
|
|
8002cdc: 2201 movs r2, #1
|
|
8002cde: 69fb ldr r3, [r7, #28]
|
|
8002ce0: fa02 f303 lsl.w r3, r2, r3
|
|
8002ce4: 617b str r3, [r7, #20]
|
|
/* Get the current IO position */
|
|
iocurrent = (uint32_t)(GPIO_Init->Pin) & ioposition;
|
|
8002ce6: 683b ldr r3, [r7, #0]
|
|
8002ce8: 681b ldr r3, [r3, #0]
|
|
8002cea: 697a ldr r2, [r7, #20]
|
|
8002cec: 4013 ands r3, r2
|
|
8002cee: 613b str r3, [r7, #16]
|
|
|
|
if(iocurrent == ioposition)
|
|
8002cf0: 693a ldr r2, [r7, #16]
|
|
8002cf2: 697b ldr r3, [r7, #20]
|
|
8002cf4: 429a cmp r2, r3
|
|
8002cf6: f040 8210 bne.w 800311a <HAL_GPIO_Init+0x562>
|
|
{
|
|
/*--------------------- GPIO Mode Configuration ------------------------*/
|
|
/* In case of Output or Alternate function mode selection */
|
|
if(((GPIO_Init->Mode & GPIO_MODE) == MODE_OUTPUT) || \
|
|
8002cfa: 683b ldr r3, [r7, #0]
|
|
8002cfc: 685b ldr r3, [r3, #4]
|
|
8002cfe: f003 0303 and.w r3, r3, #3
|
|
8002d02: 2b01 cmp r3, #1
|
|
8002d04: d005 beq.n 8002d12 <HAL_GPIO_Init+0x15a>
|
|
(GPIO_Init->Mode & GPIO_MODE) == MODE_AF)
|
|
8002d06: 683b ldr r3, [r7, #0]
|
|
8002d08: 685b ldr r3, [r3, #4]
|
|
8002d0a: f003 0303 and.w r3, r3, #3
|
|
if(((GPIO_Init->Mode & GPIO_MODE) == MODE_OUTPUT) || \
|
|
8002d0e: 2b02 cmp r3, #2
|
|
8002d10: d144 bne.n 8002d9c <HAL_GPIO_Init+0x1e4>
|
|
{
|
|
/* Check the Speed parameter */
|
|
assert_param(IS_GPIO_SPEED(GPIO_Init->Speed));
|
|
8002d12: 683b ldr r3, [r7, #0]
|
|
8002d14: 68db ldr r3, [r3, #12]
|
|
8002d16: 2b00 cmp r3, #0
|
|
8002d18: d00f beq.n 8002d3a <HAL_GPIO_Init+0x182>
|
|
8002d1a: 683b ldr r3, [r7, #0]
|
|
8002d1c: 68db ldr r3, [r3, #12]
|
|
8002d1e: 2b01 cmp r3, #1
|
|
8002d20: d00b beq.n 8002d3a <HAL_GPIO_Init+0x182>
|
|
8002d22: 683b ldr r3, [r7, #0]
|
|
8002d24: 68db ldr r3, [r3, #12]
|
|
8002d26: 2b02 cmp r3, #2
|
|
8002d28: d007 beq.n 8002d3a <HAL_GPIO_Init+0x182>
|
|
8002d2a: 683b ldr r3, [r7, #0]
|
|
8002d2c: 68db ldr r3, [r3, #12]
|
|
8002d2e: 2b03 cmp r3, #3
|
|
8002d30: d003 beq.n 8002d3a <HAL_GPIO_Init+0x182>
|
|
8002d32: 21c0 movs r1, #192 @ 0xc0
|
|
8002d34: 488d ldr r0, [pc, #564] @ (8002f6c <HAL_GPIO_Init+0x3b4>)
|
|
8002d36: f7fd fffd bl 8000d34 <assert_failed>
|
|
/* Configure the IO Speed */
|
|
temp = GPIOx->OSPEEDR;
|
|
8002d3a: 687b ldr r3, [r7, #4]
|
|
8002d3c: 689b ldr r3, [r3, #8]
|
|
8002d3e: 61bb str r3, [r7, #24]
|
|
temp &= ~(GPIO_OSPEEDER_OSPEEDR0 << (position * 2U));
|
|
8002d40: 69fb ldr r3, [r7, #28]
|
|
8002d42: 005b lsls r3, r3, #1
|
|
8002d44: 2203 movs r2, #3
|
|
8002d46: fa02 f303 lsl.w r3, r2, r3
|
|
8002d4a: 43db mvns r3, r3
|
|
8002d4c: 69ba ldr r2, [r7, #24]
|
|
8002d4e: 4013 ands r3, r2
|
|
8002d50: 61bb str r3, [r7, #24]
|
|
temp |= (GPIO_Init->Speed << (position * 2U));
|
|
8002d52: 683b ldr r3, [r7, #0]
|
|
8002d54: 68da ldr r2, [r3, #12]
|
|
8002d56: 69fb ldr r3, [r7, #28]
|
|
8002d58: 005b lsls r3, r3, #1
|
|
8002d5a: fa02 f303 lsl.w r3, r2, r3
|
|
8002d5e: 69ba ldr r2, [r7, #24]
|
|
8002d60: 4313 orrs r3, r2
|
|
8002d62: 61bb str r3, [r7, #24]
|
|
GPIOx->OSPEEDR = temp;
|
|
8002d64: 687b ldr r3, [r7, #4]
|
|
8002d66: 69ba ldr r2, [r7, #24]
|
|
8002d68: 609a str r2, [r3, #8]
|
|
|
|
/* Configure the IO Output Type */
|
|
temp = GPIOx->OTYPER;
|
|
8002d6a: 687b ldr r3, [r7, #4]
|
|
8002d6c: 685b ldr r3, [r3, #4]
|
|
8002d6e: 61bb str r3, [r7, #24]
|
|
temp &= ~(GPIO_OTYPER_OT_0 << position) ;
|
|
8002d70: 2201 movs r2, #1
|
|
8002d72: 69fb ldr r3, [r7, #28]
|
|
8002d74: fa02 f303 lsl.w r3, r2, r3
|
|
8002d78: 43db mvns r3, r3
|
|
8002d7a: 69ba ldr r2, [r7, #24]
|
|
8002d7c: 4013 ands r3, r2
|
|
8002d7e: 61bb str r3, [r7, #24]
|
|
temp |= (((GPIO_Init->Mode & OUTPUT_TYPE) >> OUTPUT_TYPE_Pos) << position);
|
|
8002d80: 683b ldr r3, [r7, #0]
|
|
8002d82: 685b ldr r3, [r3, #4]
|
|
8002d84: 091b lsrs r3, r3, #4
|
|
8002d86: f003 0201 and.w r2, r3, #1
|
|
8002d8a: 69fb ldr r3, [r7, #28]
|
|
8002d8c: fa02 f303 lsl.w r3, r2, r3
|
|
8002d90: 69ba ldr r2, [r7, #24]
|
|
8002d92: 4313 orrs r3, r2
|
|
8002d94: 61bb str r3, [r7, #24]
|
|
GPIOx->OTYPER = temp;
|
|
8002d96: 687b ldr r3, [r7, #4]
|
|
8002d98: 69ba ldr r2, [r7, #24]
|
|
8002d9a: 605a str r2, [r3, #4]
|
|
}
|
|
|
|
if((GPIO_Init->Mode & GPIO_MODE) != MODE_ANALOG)
|
|
8002d9c: 683b ldr r3, [r7, #0]
|
|
8002d9e: 685b ldr r3, [r3, #4]
|
|
8002da0: f003 0303 and.w r3, r3, #3
|
|
8002da4: 2b03 cmp r3, #3
|
|
8002da6: d027 beq.n 8002df8 <HAL_GPIO_Init+0x240>
|
|
{
|
|
/* Check the parameters */
|
|
assert_param(IS_GPIO_PULL(GPIO_Init->Pull));
|
|
8002da8: 683b ldr r3, [r7, #0]
|
|
8002daa: 689b ldr r3, [r3, #8]
|
|
8002dac: 2b00 cmp r3, #0
|
|
8002dae: d00b beq.n 8002dc8 <HAL_GPIO_Init+0x210>
|
|
8002db0: 683b ldr r3, [r7, #0]
|
|
8002db2: 689b ldr r3, [r3, #8]
|
|
8002db4: 2b01 cmp r3, #1
|
|
8002db6: d007 beq.n 8002dc8 <HAL_GPIO_Init+0x210>
|
|
8002db8: 683b ldr r3, [r7, #0]
|
|
8002dba: 689b ldr r3, [r3, #8]
|
|
8002dbc: 2b02 cmp r3, #2
|
|
8002dbe: d003 beq.n 8002dc8 <HAL_GPIO_Init+0x210>
|
|
8002dc0: 21d1 movs r1, #209 @ 0xd1
|
|
8002dc2: 486a ldr r0, [pc, #424] @ (8002f6c <HAL_GPIO_Init+0x3b4>)
|
|
8002dc4: f7fd ffb6 bl 8000d34 <assert_failed>
|
|
|
|
/* Activate the Pull-up or Pull down resistor for the current IO */
|
|
temp = GPIOx->PUPDR;
|
|
8002dc8: 687b ldr r3, [r7, #4]
|
|
8002dca: 68db ldr r3, [r3, #12]
|
|
8002dcc: 61bb str r3, [r7, #24]
|
|
temp &= ~(GPIO_PUPDR_PUPDR0 << (position * 2U));
|
|
8002dce: 69fb ldr r3, [r7, #28]
|
|
8002dd0: 005b lsls r3, r3, #1
|
|
8002dd2: 2203 movs r2, #3
|
|
8002dd4: fa02 f303 lsl.w r3, r2, r3
|
|
8002dd8: 43db mvns r3, r3
|
|
8002dda: 69ba ldr r2, [r7, #24]
|
|
8002ddc: 4013 ands r3, r2
|
|
8002dde: 61bb str r3, [r7, #24]
|
|
temp |= ((GPIO_Init->Pull) << (position * 2U));
|
|
8002de0: 683b ldr r3, [r7, #0]
|
|
8002de2: 689a ldr r2, [r3, #8]
|
|
8002de4: 69fb ldr r3, [r7, #28]
|
|
8002de6: 005b lsls r3, r3, #1
|
|
8002de8: fa02 f303 lsl.w r3, r2, r3
|
|
8002dec: 69ba ldr r2, [r7, #24]
|
|
8002dee: 4313 orrs r3, r2
|
|
8002df0: 61bb str r3, [r7, #24]
|
|
GPIOx->PUPDR = temp;
|
|
8002df2: 687b ldr r3, [r7, #4]
|
|
8002df4: 69ba ldr r2, [r7, #24]
|
|
8002df6: 60da str r2, [r3, #12]
|
|
}
|
|
|
|
/* In case of Alternate function mode selection */
|
|
if((GPIO_Init->Mode & GPIO_MODE) == MODE_AF)
|
|
8002df8: 683b ldr r3, [r7, #0]
|
|
8002dfa: 685b ldr r3, [r3, #4]
|
|
8002dfc: f003 0303 and.w r3, r3, #3
|
|
8002e00: 2b02 cmp r3, #2
|
|
8002e02: f040 80b5 bne.w 8002f70 <HAL_GPIO_Init+0x3b8>
|
|
{
|
|
/* Check the Alternate function parameter */
|
|
assert_param(IS_GPIO_AF(GPIO_Init->Alternate));
|
|
8002e06: 683b ldr r3, [r7, #0]
|
|
8002e08: 691b ldr r3, [r3, #16]
|
|
8002e0a: 2b00 cmp r3, #0
|
|
8002e0c: f000 8089 beq.w 8002f22 <HAL_GPIO_Init+0x36a>
|
|
8002e10: 683b ldr r3, [r7, #0]
|
|
8002e12: 691b ldr r3, [r3, #16]
|
|
8002e14: 2b09 cmp r3, #9
|
|
8002e16: f000 8084 beq.w 8002f22 <HAL_GPIO_Init+0x36a>
|
|
8002e1a: 683b ldr r3, [r7, #0]
|
|
8002e1c: 691b ldr r3, [r3, #16]
|
|
8002e1e: 2b00 cmp r3, #0
|
|
8002e20: d07f beq.n 8002f22 <HAL_GPIO_Init+0x36a>
|
|
8002e22: 683b ldr r3, [r7, #0]
|
|
8002e24: 691b ldr r3, [r3, #16]
|
|
8002e26: 2b00 cmp r3, #0
|
|
8002e28: d07b beq.n 8002f22 <HAL_GPIO_Init+0x36a>
|
|
8002e2a: 683b ldr r3, [r7, #0]
|
|
8002e2c: 691b ldr r3, [r3, #16]
|
|
8002e2e: 2b00 cmp r3, #0
|
|
8002e30: d077 beq.n 8002f22 <HAL_GPIO_Init+0x36a>
|
|
8002e32: 683b ldr r3, [r7, #0]
|
|
8002e34: 691b ldr r3, [r3, #16]
|
|
8002e36: 2b00 cmp r3, #0
|
|
8002e38: d073 beq.n 8002f22 <HAL_GPIO_Init+0x36a>
|
|
8002e3a: 683b ldr r3, [r7, #0]
|
|
8002e3c: 691b ldr r3, [r3, #16]
|
|
8002e3e: 2b01 cmp r3, #1
|
|
8002e40: d06f beq.n 8002f22 <HAL_GPIO_Init+0x36a>
|
|
8002e42: 683b ldr r3, [r7, #0]
|
|
8002e44: 691b ldr r3, [r3, #16]
|
|
8002e46: 2b01 cmp r3, #1
|
|
8002e48: d06b beq.n 8002f22 <HAL_GPIO_Init+0x36a>
|
|
8002e4a: 683b ldr r3, [r7, #0]
|
|
8002e4c: 691b ldr r3, [r3, #16]
|
|
8002e4e: 2b02 cmp r3, #2
|
|
8002e50: d067 beq.n 8002f22 <HAL_GPIO_Init+0x36a>
|
|
8002e52: 683b ldr r3, [r7, #0]
|
|
8002e54: 691b ldr r3, [r3, #16]
|
|
8002e56: 2b02 cmp r3, #2
|
|
8002e58: d063 beq.n 8002f22 <HAL_GPIO_Init+0x36a>
|
|
8002e5a: 683b ldr r3, [r7, #0]
|
|
8002e5c: 691b ldr r3, [r3, #16]
|
|
8002e5e: 2b02 cmp r3, #2
|
|
8002e60: d05f beq.n 8002f22 <HAL_GPIO_Init+0x36a>
|
|
8002e62: 683b ldr r3, [r7, #0]
|
|
8002e64: 691b ldr r3, [r3, #16]
|
|
8002e66: 2b03 cmp r3, #3
|
|
8002e68: d05b beq.n 8002f22 <HAL_GPIO_Init+0x36a>
|
|
8002e6a: 683b ldr r3, [r7, #0]
|
|
8002e6c: 691b ldr r3, [r3, #16]
|
|
8002e6e: 2b04 cmp r3, #4
|
|
8002e70: d057 beq.n 8002f22 <HAL_GPIO_Init+0x36a>
|
|
8002e72: 683b ldr r3, [r7, #0]
|
|
8002e74: 691b ldr r3, [r3, #16]
|
|
8002e76: 2b04 cmp r3, #4
|
|
8002e78: d053 beq.n 8002f22 <HAL_GPIO_Init+0x36a>
|
|
8002e7a: 683b ldr r3, [r7, #0]
|
|
8002e7c: 691b ldr r3, [r3, #16]
|
|
8002e7e: 2b04 cmp r3, #4
|
|
8002e80: d04f beq.n 8002f22 <HAL_GPIO_Init+0x36a>
|
|
8002e82: 683b ldr r3, [r7, #0]
|
|
8002e84: 691b ldr r3, [r3, #16]
|
|
8002e86: 2b05 cmp r3, #5
|
|
8002e88: d04b beq.n 8002f22 <HAL_GPIO_Init+0x36a>
|
|
8002e8a: 683b ldr r3, [r7, #0]
|
|
8002e8c: 691b ldr r3, [r3, #16]
|
|
8002e8e: 2b05 cmp r3, #5
|
|
8002e90: d047 beq.n 8002f22 <HAL_GPIO_Init+0x36a>
|
|
8002e92: 683b ldr r3, [r7, #0]
|
|
8002e94: 691b ldr r3, [r3, #16]
|
|
8002e96: 2b09 cmp r3, #9
|
|
8002e98: d043 beq.n 8002f22 <HAL_GPIO_Init+0x36a>
|
|
8002e9a: 683b ldr r3, [r7, #0]
|
|
8002e9c: 691b ldr r3, [r3, #16]
|
|
8002e9e: 2b06 cmp r3, #6
|
|
8002ea0: d03f beq.n 8002f22 <HAL_GPIO_Init+0x36a>
|
|
8002ea2: 683b ldr r3, [r7, #0]
|
|
8002ea4: 691b ldr r3, [r3, #16]
|
|
8002ea6: 2b09 cmp r3, #9
|
|
8002ea8: d03b beq.n 8002f22 <HAL_GPIO_Init+0x36a>
|
|
8002eaa: 683b ldr r3, [r7, #0]
|
|
8002eac: 691b ldr r3, [r3, #16]
|
|
8002eae: 2b07 cmp r3, #7
|
|
8002eb0: d037 beq.n 8002f22 <HAL_GPIO_Init+0x36a>
|
|
8002eb2: 683b ldr r3, [r7, #0]
|
|
8002eb4: 691b ldr r3, [r3, #16]
|
|
8002eb6: 2b07 cmp r3, #7
|
|
8002eb8: d033 beq.n 8002f22 <HAL_GPIO_Init+0x36a>
|
|
8002eba: 683b ldr r3, [r7, #0]
|
|
8002ebc: 691b ldr r3, [r3, #16]
|
|
8002ebe: 2b07 cmp r3, #7
|
|
8002ec0: d02f beq.n 8002f22 <HAL_GPIO_Init+0x36a>
|
|
8002ec2: 683b ldr r3, [r7, #0]
|
|
8002ec4: 691b ldr r3, [r3, #16]
|
|
8002ec6: 2b08 cmp r3, #8
|
|
8002ec8: d02b beq.n 8002f22 <HAL_GPIO_Init+0x36a>
|
|
8002eca: 683b ldr r3, [r7, #0]
|
|
8002ecc: 691b ldr r3, [r3, #16]
|
|
8002ece: 2b08 cmp r3, #8
|
|
8002ed0: d027 beq.n 8002f22 <HAL_GPIO_Init+0x36a>
|
|
8002ed2: 683b ldr r3, [r7, #0]
|
|
8002ed4: 691b ldr r3, [r3, #16]
|
|
8002ed6: 2b08 cmp r3, #8
|
|
8002ed8: d023 beq.n 8002f22 <HAL_GPIO_Init+0x36a>
|
|
8002eda: 683b ldr r3, [r7, #0]
|
|
8002edc: 691b ldr r3, [r3, #16]
|
|
8002ede: 2b09 cmp r3, #9
|
|
8002ee0: d01f beq.n 8002f22 <HAL_GPIO_Init+0x36a>
|
|
8002ee2: 683b ldr r3, [r7, #0]
|
|
8002ee4: 691b ldr r3, [r3, #16]
|
|
8002ee6: 2b09 cmp r3, #9
|
|
8002ee8: d01b beq.n 8002f22 <HAL_GPIO_Init+0x36a>
|
|
8002eea: 683b ldr r3, [r7, #0]
|
|
8002eec: 691b ldr r3, [r3, #16]
|
|
8002eee: 2b0a cmp r3, #10
|
|
8002ef0: d017 beq.n 8002f22 <HAL_GPIO_Init+0x36a>
|
|
8002ef2: 683b ldr r3, [r7, #0]
|
|
8002ef4: 691b ldr r3, [r3, #16]
|
|
8002ef6: 2b0a cmp r3, #10
|
|
8002ef8: d013 beq.n 8002f22 <HAL_GPIO_Init+0x36a>
|
|
8002efa: 683b ldr r3, [r7, #0]
|
|
8002efc: 691b ldr r3, [r3, #16]
|
|
8002efe: 2b0c cmp r3, #12
|
|
8002f00: d00f beq.n 8002f22 <HAL_GPIO_Init+0x36a>
|
|
8002f02: 683b ldr r3, [r7, #0]
|
|
8002f04: 691b ldr r3, [r3, #16]
|
|
8002f06: 2b0c cmp r3, #12
|
|
8002f08: d00b beq.n 8002f22 <HAL_GPIO_Init+0x36a>
|
|
8002f0a: 683b ldr r3, [r7, #0]
|
|
8002f0c: 691b ldr r3, [r3, #16]
|
|
8002f0e: 2b0c cmp r3, #12
|
|
8002f10: d007 beq.n 8002f22 <HAL_GPIO_Init+0x36a>
|
|
8002f12: 683b ldr r3, [r7, #0]
|
|
8002f14: 691b ldr r3, [r3, #16]
|
|
8002f16: 2b0f cmp r3, #15
|
|
8002f18: d003 beq.n 8002f22 <HAL_GPIO_Init+0x36a>
|
|
8002f1a: 21de movs r1, #222 @ 0xde
|
|
8002f1c: 4813 ldr r0, [pc, #76] @ (8002f6c <HAL_GPIO_Init+0x3b4>)
|
|
8002f1e: f7fd ff09 bl 8000d34 <assert_failed>
|
|
/* Configure Alternate function mapped with the current IO */
|
|
temp = GPIOx->AFR[position >> 3U];
|
|
8002f22: 69fb ldr r3, [r7, #28]
|
|
8002f24: 08da lsrs r2, r3, #3
|
|
8002f26: 687b ldr r3, [r7, #4]
|
|
8002f28: 3208 adds r2, #8
|
|
8002f2a: f853 3022 ldr.w r3, [r3, r2, lsl #2]
|
|
8002f2e: 61bb str r3, [r7, #24]
|
|
temp &= ~(0xFU << ((uint32_t)(position & 0x07U) * 4U)) ;
|
|
8002f30: 69fb ldr r3, [r7, #28]
|
|
8002f32: f003 0307 and.w r3, r3, #7
|
|
8002f36: 009b lsls r3, r3, #2
|
|
8002f38: 220f movs r2, #15
|
|
8002f3a: fa02 f303 lsl.w r3, r2, r3
|
|
8002f3e: 43db mvns r3, r3
|
|
8002f40: 69ba ldr r2, [r7, #24]
|
|
8002f42: 4013 ands r3, r2
|
|
8002f44: 61bb str r3, [r7, #24]
|
|
temp |= ((uint32_t)(GPIO_Init->Alternate) << (((uint32_t)position & 0x07U) * 4U));
|
|
8002f46: 683b ldr r3, [r7, #0]
|
|
8002f48: 691a ldr r2, [r3, #16]
|
|
8002f4a: 69fb ldr r3, [r7, #28]
|
|
8002f4c: f003 0307 and.w r3, r3, #7
|
|
8002f50: 009b lsls r3, r3, #2
|
|
8002f52: fa02 f303 lsl.w r3, r2, r3
|
|
8002f56: 69ba ldr r2, [r7, #24]
|
|
8002f58: 4313 orrs r3, r2
|
|
8002f5a: 61bb str r3, [r7, #24]
|
|
GPIOx->AFR[position >> 3U] = temp;
|
|
8002f5c: 69fb ldr r3, [r7, #28]
|
|
8002f5e: 08da lsrs r2, r3, #3
|
|
8002f60: 687b ldr r3, [r7, #4]
|
|
8002f62: 3208 adds r2, #8
|
|
8002f64: 69b9 ldr r1, [r7, #24]
|
|
8002f66: f843 1022 str.w r1, [r3, r2, lsl #2]
|
|
8002f6a: e001 b.n 8002f70 <HAL_GPIO_Init+0x3b8>
|
|
8002f6c: 0800a168 .word 0x0800a168
|
|
}
|
|
|
|
/* Configure IO Direction mode (Input, Output, Alternate or Analog) */
|
|
temp = GPIOx->MODER;
|
|
8002f70: 687b ldr r3, [r7, #4]
|
|
8002f72: 681b ldr r3, [r3, #0]
|
|
8002f74: 61bb str r3, [r7, #24]
|
|
temp &= ~(GPIO_MODER_MODER0 << (position * 2U));
|
|
8002f76: 69fb ldr r3, [r7, #28]
|
|
8002f78: 005b lsls r3, r3, #1
|
|
8002f7a: 2203 movs r2, #3
|
|
8002f7c: fa02 f303 lsl.w r3, r2, r3
|
|
8002f80: 43db mvns r3, r3
|
|
8002f82: 69ba ldr r2, [r7, #24]
|
|
8002f84: 4013 ands r3, r2
|
|
8002f86: 61bb str r3, [r7, #24]
|
|
temp |= ((GPIO_Init->Mode & GPIO_MODE) << (position * 2U));
|
|
8002f88: 683b ldr r3, [r7, #0]
|
|
8002f8a: 685b ldr r3, [r3, #4]
|
|
8002f8c: f003 0203 and.w r2, r3, #3
|
|
8002f90: 69fb ldr r3, [r7, #28]
|
|
8002f92: 005b lsls r3, r3, #1
|
|
8002f94: fa02 f303 lsl.w r3, r2, r3
|
|
8002f98: 69ba ldr r2, [r7, #24]
|
|
8002f9a: 4313 orrs r3, r2
|
|
8002f9c: 61bb str r3, [r7, #24]
|
|
GPIOx->MODER = temp;
|
|
8002f9e: 687b ldr r3, [r7, #4]
|
|
8002fa0: 69ba ldr r2, [r7, #24]
|
|
8002fa2: 601a str r2, [r3, #0]
|
|
|
|
/*--------------------- EXTI Mode Configuration ------------------------*/
|
|
/* Configure the External Interrupt or event for the current IO */
|
|
if((GPIO_Init->Mode & EXTI_MODE) != 0x00U)
|
|
8002fa4: 683b ldr r3, [r7, #0]
|
|
8002fa6: 685b ldr r3, [r3, #4]
|
|
8002fa8: f403 3340 and.w r3, r3, #196608 @ 0x30000
|
|
8002fac: 2b00 cmp r3, #0
|
|
8002fae: f000 80b4 beq.w 800311a <HAL_GPIO_Init+0x562>
|
|
{
|
|
/* Enable SYSCFG Clock */
|
|
__HAL_RCC_SYSCFG_CLK_ENABLE();
|
|
8002fb2: 2300 movs r3, #0
|
|
8002fb4: 60fb str r3, [r7, #12]
|
|
8002fb6: 4b5f ldr r3, [pc, #380] @ (8003134 <HAL_GPIO_Init+0x57c>)
|
|
8002fb8: 6c5b ldr r3, [r3, #68] @ 0x44
|
|
8002fba: 4a5e ldr r2, [pc, #376] @ (8003134 <HAL_GPIO_Init+0x57c>)
|
|
8002fbc: f443 4380 orr.w r3, r3, #16384 @ 0x4000
|
|
8002fc0: 6453 str r3, [r2, #68] @ 0x44
|
|
8002fc2: 4b5c ldr r3, [pc, #368] @ (8003134 <HAL_GPIO_Init+0x57c>)
|
|
8002fc4: 6c5b ldr r3, [r3, #68] @ 0x44
|
|
8002fc6: f403 4380 and.w r3, r3, #16384 @ 0x4000
|
|
8002fca: 60fb str r3, [r7, #12]
|
|
8002fcc: 68fb ldr r3, [r7, #12]
|
|
|
|
temp = SYSCFG->EXTICR[position >> 2U];
|
|
8002fce: 4a5a ldr r2, [pc, #360] @ (8003138 <HAL_GPIO_Init+0x580>)
|
|
8002fd0: 69fb ldr r3, [r7, #28]
|
|
8002fd2: 089b lsrs r3, r3, #2
|
|
8002fd4: 3302 adds r3, #2
|
|
8002fd6: f852 3023 ldr.w r3, [r2, r3, lsl #2]
|
|
8002fda: 61bb str r3, [r7, #24]
|
|
temp &= ~(0x0FU << (4U * (position & 0x03U)));
|
|
8002fdc: 69fb ldr r3, [r7, #28]
|
|
8002fde: f003 0303 and.w r3, r3, #3
|
|
8002fe2: 009b lsls r3, r3, #2
|
|
8002fe4: 220f movs r2, #15
|
|
8002fe6: fa02 f303 lsl.w r3, r2, r3
|
|
8002fea: 43db mvns r3, r3
|
|
8002fec: 69ba ldr r2, [r7, #24]
|
|
8002fee: 4013 ands r3, r2
|
|
8002ff0: 61bb str r3, [r7, #24]
|
|
temp |= ((uint32_t)(GPIO_GET_INDEX(GPIOx)) << (4U * (position & 0x03U)));
|
|
8002ff2: 687b ldr r3, [r7, #4]
|
|
8002ff4: 4a51 ldr r2, [pc, #324] @ (800313c <HAL_GPIO_Init+0x584>)
|
|
8002ff6: 4293 cmp r3, r2
|
|
8002ff8: d02b beq.n 8003052 <HAL_GPIO_Init+0x49a>
|
|
8002ffa: 687b ldr r3, [r7, #4]
|
|
8002ffc: 4a50 ldr r2, [pc, #320] @ (8003140 <HAL_GPIO_Init+0x588>)
|
|
8002ffe: 4293 cmp r3, r2
|
|
8003000: d025 beq.n 800304e <HAL_GPIO_Init+0x496>
|
|
8003002: 687b ldr r3, [r7, #4]
|
|
8003004: 4a4f ldr r2, [pc, #316] @ (8003144 <HAL_GPIO_Init+0x58c>)
|
|
8003006: 4293 cmp r3, r2
|
|
8003008: d01f beq.n 800304a <HAL_GPIO_Init+0x492>
|
|
800300a: 687b ldr r3, [r7, #4]
|
|
800300c: 4a4e ldr r2, [pc, #312] @ (8003148 <HAL_GPIO_Init+0x590>)
|
|
800300e: 4293 cmp r3, r2
|
|
8003010: d019 beq.n 8003046 <HAL_GPIO_Init+0x48e>
|
|
8003012: 687b ldr r3, [r7, #4]
|
|
8003014: 4a4d ldr r2, [pc, #308] @ (800314c <HAL_GPIO_Init+0x594>)
|
|
8003016: 4293 cmp r3, r2
|
|
8003018: d013 beq.n 8003042 <HAL_GPIO_Init+0x48a>
|
|
800301a: 687b ldr r3, [r7, #4]
|
|
800301c: 4a4c ldr r2, [pc, #304] @ (8003150 <HAL_GPIO_Init+0x598>)
|
|
800301e: 4293 cmp r3, r2
|
|
8003020: d00d beq.n 800303e <HAL_GPIO_Init+0x486>
|
|
8003022: 687b ldr r3, [r7, #4]
|
|
8003024: 4a4b ldr r2, [pc, #300] @ (8003154 <HAL_GPIO_Init+0x59c>)
|
|
8003026: 4293 cmp r3, r2
|
|
8003028: d007 beq.n 800303a <HAL_GPIO_Init+0x482>
|
|
800302a: 687b ldr r3, [r7, #4]
|
|
800302c: 4a4a ldr r2, [pc, #296] @ (8003158 <HAL_GPIO_Init+0x5a0>)
|
|
800302e: 4293 cmp r3, r2
|
|
8003030: d101 bne.n 8003036 <HAL_GPIO_Init+0x47e>
|
|
8003032: 2307 movs r3, #7
|
|
8003034: e00e b.n 8003054 <HAL_GPIO_Init+0x49c>
|
|
8003036: 2308 movs r3, #8
|
|
8003038: e00c b.n 8003054 <HAL_GPIO_Init+0x49c>
|
|
800303a: 2306 movs r3, #6
|
|
800303c: e00a b.n 8003054 <HAL_GPIO_Init+0x49c>
|
|
800303e: 2305 movs r3, #5
|
|
8003040: e008 b.n 8003054 <HAL_GPIO_Init+0x49c>
|
|
8003042: 2304 movs r3, #4
|
|
8003044: e006 b.n 8003054 <HAL_GPIO_Init+0x49c>
|
|
8003046: 2303 movs r3, #3
|
|
8003048: e004 b.n 8003054 <HAL_GPIO_Init+0x49c>
|
|
800304a: 2302 movs r3, #2
|
|
800304c: e002 b.n 8003054 <HAL_GPIO_Init+0x49c>
|
|
800304e: 2301 movs r3, #1
|
|
8003050: e000 b.n 8003054 <HAL_GPIO_Init+0x49c>
|
|
8003052: 2300 movs r3, #0
|
|
8003054: 69fa ldr r2, [r7, #28]
|
|
8003056: f002 0203 and.w r2, r2, #3
|
|
800305a: 0092 lsls r2, r2, #2
|
|
800305c: 4093 lsls r3, r2
|
|
800305e: 69ba ldr r2, [r7, #24]
|
|
8003060: 4313 orrs r3, r2
|
|
8003062: 61bb str r3, [r7, #24]
|
|
SYSCFG->EXTICR[position >> 2U] = temp;
|
|
8003064: 4934 ldr r1, [pc, #208] @ (8003138 <HAL_GPIO_Init+0x580>)
|
|
8003066: 69fb ldr r3, [r7, #28]
|
|
8003068: 089b lsrs r3, r3, #2
|
|
800306a: 3302 adds r3, #2
|
|
800306c: 69ba ldr r2, [r7, #24]
|
|
800306e: f841 2023 str.w r2, [r1, r3, lsl #2]
|
|
|
|
/* Clear Rising Falling edge configuration */
|
|
temp = EXTI->RTSR;
|
|
8003072: 4b3a ldr r3, [pc, #232] @ (800315c <HAL_GPIO_Init+0x5a4>)
|
|
8003074: 689b ldr r3, [r3, #8]
|
|
8003076: 61bb str r3, [r7, #24]
|
|
temp &= ~((uint32_t)iocurrent);
|
|
8003078: 693b ldr r3, [r7, #16]
|
|
800307a: 43db mvns r3, r3
|
|
800307c: 69ba ldr r2, [r7, #24]
|
|
800307e: 4013 ands r3, r2
|
|
8003080: 61bb str r3, [r7, #24]
|
|
if((GPIO_Init->Mode & TRIGGER_RISING) != 0x00U)
|
|
8003082: 683b ldr r3, [r7, #0]
|
|
8003084: 685b ldr r3, [r3, #4]
|
|
8003086: f403 1380 and.w r3, r3, #1048576 @ 0x100000
|
|
800308a: 2b00 cmp r3, #0
|
|
800308c: d003 beq.n 8003096 <HAL_GPIO_Init+0x4de>
|
|
{
|
|
temp |= iocurrent;
|
|
800308e: 69ba ldr r2, [r7, #24]
|
|
8003090: 693b ldr r3, [r7, #16]
|
|
8003092: 4313 orrs r3, r2
|
|
8003094: 61bb str r3, [r7, #24]
|
|
}
|
|
EXTI->RTSR = temp;
|
|
8003096: 4a31 ldr r2, [pc, #196] @ (800315c <HAL_GPIO_Init+0x5a4>)
|
|
8003098: 69bb ldr r3, [r7, #24]
|
|
800309a: 6093 str r3, [r2, #8]
|
|
|
|
temp = EXTI->FTSR;
|
|
800309c: 4b2f ldr r3, [pc, #188] @ (800315c <HAL_GPIO_Init+0x5a4>)
|
|
800309e: 68db ldr r3, [r3, #12]
|
|
80030a0: 61bb str r3, [r7, #24]
|
|
temp &= ~((uint32_t)iocurrent);
|
|
80030a2: 693b ldr r3, [r7, #16]
|
|
80030a4: 43db mvns r3, r3
|
|
80030a6: 69ba ldr r2, [r7, #24]
|
|
80030a8: 4013 ands r3, r2
|
|
80030aa: 61bb str r3, [r7, #24]
|
|
if((GPIO_Init->Mode & TRIGGER_FALLING) != 0x00U)
|
|
80030ac: 683b ldr r3, [r7, #0]
|
|
80030ae: 685b ldr r3, [r3, #4]
|
|
80030b0: f403 1300 and.w r3, r3, #2097152 @ 0x200000
|
|
80030b4: 2b00 cmp r3, #0
|
|
80030b6: d003 beq.n 80030c0 <HAL_GPIO_Init+0x508>
|
|
{
|
|
temp |= iocurrent;
|
|
80030b8: 69ba ldr r2, [r7, #24]
|
|
80030ba: 693b ldr r3, [r7, #16]
|
|
80030bc: 4313 orrs r3, r2
|
|
80030be: 61bb str r3, [r7, #24]
|
|
}
|
|
EXTI->FTSR = temp;
|
|
80030c0: 4a26 ldr r2, [pc, #152] @ (800315c <HAL_GPIO_Init+0x5a4>)
|
|
80030c2: 69bb ldr r3, [r7, #24]
|
|
80030c4: 60d3 str r3, [r2, #12]
|
|
|
|
temp = EXTI->EMR;
|
|
80030c6: 4b25 ldr r3, [pc, #148] @ (800315c <HAL_GPIO_Init+0x5a4>)
|
|
80030c8: 685b ldr r3, [r3, #4]
|
|
80030ca: 61bb str r3, [r7, #24]
|
|
temp &= ~((uint32_t)iocurrent);
|
|
80030cc: 693b ldr r3, [r7, #16]
|
|
80030ce: 43db mvns r3, r3
|
|
80030d0: 69ba ldr r2, [r7, #24]
|
|
80030d2: 4013 ands r3, r2
|
|
80030d4: 61bb str r3, [r7, #24]
|
|
if((GPIO_Init->Mode & EXTI_EVT) != 0x00U)
|
|
80030d6: 683b ldr r3, [r7, #0]
|
|
80030d8: 685b ldr r3, [r3, #4]
|
|
80030da: f403 3300 and.w r3, r3, #131072 @ 0x20000
|
|
80030de: 2b00 cmp r3, #0
|
|
80030e0: d003 beq.n 80030ea <HAL_GPIO_Init+0x532>
|
|
{
|
|
temp |= iocurrent;
|
|
80030e2: 69ba ldr r2, [r7, #24]
|
|
80030e4: 693b ldr r3, [r7, #16]
|
|
80030e6: 4313 orrs r3, r2
|
|
80030e8: 61bb str r3, [r7, #24]
|
|
}
|
|
EXTI->EMR = temp;
|
|
80030ea: 4a1c ldr r2, [pc, #112] @ (800315c <HAL_GPIO_Init+0x5a4>)
|
|
80030ec: 69bb ldr r3, [r7, #24]
|
|
80030ee: 6053 str r3, [r2, #4]
|
|
|
|
/* Clear EXTI line configuration */
|
|
temp = EXTI->IMR;
|
|
80030f0: 4b1a ldr r3, [pc, #104] @ (800315c <HAL_GPIO_Init+0x5a4>)
|
|
80030f2: 681b ldr r3, [r3, #0]
|
|
80030f4: 61bb str r3, [r7, #24]
|
|
temp &= ~((uint32_t)iocurrent);
|
|
80030f6: 693b ldr r3, [r7, #16]
|
|
80030f8: 43db mvns r3, r3
|
|
80030fa: 69ba ldr r2, [r7, #24]
|
|
80030fc: 4013 ands r3, r2
|
|
80030fe: 61bb str r3, [r7, #24]
|
|
if((GPIO_Init->Mode & EXTI_IT) != 0x00U)
|
|
8003100: 683b ldr r3, [r7, #0]
|
|
8003102: 685b ldr r3, [r3, #4]
|
|
8003104: f403 3380 and.w r3, r3, #65536 @ 0x10000
|
|
8003108: 2b00 cmp r3, #0
|
|
800310a: d003 beq.n 8003114 <HAL_GPIO_Init+0x55c>
|
|
{
|
|
temp |= iocurrent;
|
|
800310c: 69ba ldr r2, [r7, #24]
|
|
800310e: 693b ldr r3, [r7, #16]
|
|
8003110: 4313 orrs r3, r2
|
|
8003112: 61bb str r3, [r7, #24]
|
|
}
|
|
EXTI->IMR = temp;
|
|
8003114: 4a11 ldr r2, [pc, #68] @ (800315c <HAL_GPIO_Init+0x5a4>)
|
|
8003116: 69bb ldr r3, [r7, #24]
|
|
8003118: 6013 str r3, [r2, #0]
|
|
for(position = 0U; position < GPIO_NUMBER; position++)
|
|
800311a: 69fb ldr r3, [r7, #28]
|
|
800311c: 3301 adds r3, #1
|
|
800311e: 61fb str r3, [r7, #28]
|
|
8003120: 69fb ldr r3, [r7, #28]
|
|
8003122: 2b0f cmp r3, #15
|
|
8003124: f67f adda bls.w 8002cdc <HAL_GPIO_Init+0x124>
|
|
}
|
|
}
|
|
}
|
|
}
|
|
8003128: bf00 nop
|
|
800312a: bf00 nop
|
|
800312c: 3720 adds r7, #32
|
|
800312e: 46bd mov sp, r7
|
|
8003130: bd80 pop {r7, pc}
|
|
8003132: bf00 nop
|
|
8003134: 40023800 .word 0x40023800
|
|
8003138: 40013800 .word 0x40013800
|
|
800313c: 40020000 .word 0x40020000
|
|
8003140: 40020400 .word 0x40020400
|
|
8003144: 40020800 .word 0x40020800
|
|
8003148: 40020c00 .word 0x40020c00
|
|
800314c: 40021000 .word 0x40021000
|
|
8003150: 40021400 .word 0x40021400
|
|
8003154: 40021800 .word 0x40021800
|
|
8003158: 40021c00 .word 0x40021c00
|
|
800315c: 40013c00 .word 0x40013c00
|
|
|
|
08003160 <HAL_GPIO_WritePin>:
|
|
* @arg GPIO_PIN_RESET: to clear the port pin
|
|
* @arg GPIO_PIN_SET: to set the port pin
|
|
* @retval None
|
|
*/
|
|
void HAL_GPIO_WritePin(GPIO_TypeDef* GPIOx, uint16_t GPIO_Pin, GPIO_PinState PinState)
|
|
{
|
|
8003160: b580 push {r7, lr}
|
|
8003162: b082 sub sp, #8
|
|
8003164: af00 add r7, sp, #0
|
|
8003166: 6078 str r0, [r7, #4]
|
|
8003168: 460b mov r3, r1
|
|
800316a: 807b strh r3, [r7, #2]
|
|
800316c: 4613 mov r3, r2
|
|
800316e: 707b strb r3, [r7, #1]
|
|
/* Check the parameters */
|
|
assert_param(IS_GPIO_PIN(GPIO_Pin));
|
|
8003170: 887b ldrh r3, [r7, #2]
|
|
8003172: 2b00 cmp r3, #0
|
|
8003174: d104 bne.n 8003180 <HAL_GPIO_WritePin+0x20>
|
|
8003176: f240 119d movw r1, #413 @ 0x19d
|
|
800317a: 480e ldr r0, [pc, #56] @ (80031b4 <HAL_GPIO_WritePin+0x54>)
|
|
800317c: f7fd fdda bl 8000d34 <assert_failed>
|
|
assert_param(IS_GPIO_PIN_ACTION(PinState));
|
|
8003180: 787b ldrb r3, [r7, #1]
|
|
8003182: 2b00 cmp r3, #0
|
|
8003184: d007 beq.n 8003196 <HAL_GPIO_WritePin+0x36>
|
|
8003186: 787b ldrb r3, [r7, #1]
|
|
8003188: 2b01 cmp r3, #1
|
|
800318a: d004 beq.n 8003196 <HAL_GPIO_WritePin+0x36>
|
|
800318c: f44f 71cf mov.w r1, #414 @ 0x19e
|
|
8003190: 4808 ldr r0, [pc, #32] @ (80031b4 <HAL_GPIO_WritePin+0x54>)
|
|
8003192: f7fd fdcf bl 8000d34 <assert_failed>
|
|
|
|
if(PinState != GPIO_PIN_RESET)
|
|
8003196: 787b ldrb r3, [r7, #1]
|
|
8003198: 2b00 cmp r3, #0
|
|
800319a: d003 beq.n 80031a4 <HAL_GPIO_WritePin+0x44>
|
|
{
|
|
GPIOx->BSRR = GPIO_Pin;
|
|
800319c: 887a ldrh r2, [r7, #2]
|
|
800319e: 687b ldr r3, [r7, #4]
|
|
80031a0: 619a str r2, [r3, #24]
|
|
}
|
|
else
|
|
{
|
|
GPIOx->BSRR = (uint32_t)GPIO_Pin << 16U;
|
|
}
|
|
}
|
|
80031a2: e003 b.n 80031ac <HAL_GPIO_WritePin+0x4c>
|
|
GPIOx->BSRR = (uint32_t)GPIO_Pin << 16U;
|
|
80031a4: 887b ldrh r3, [r7, #2]
|
|
80031a6: 041a lsls r2, r3, #16
|
|
80031a8: 687b ldr r3, [r7, #4]
|
|
80031aa: 619a str r2, [r3, #24]
|
|
}
|
|
80031ac: bf00 nop
|
|
80031ae: 3708 adds r7, #8
|
|
80031b0: 46bd mov sp, r7
|
|
80031b2: bd80 pop {r7, pc}
|
|
80031b4: 0800a168 .word 0x0800a168
|
|
|
|
080031b8 <HAL_GPIO_TogglePin>:
|
|
* x can be (A..I) to select the GPIO peripheral for STM32F40XX and STM32F427X devices.
|
|
* @param GPIO_Pin Specifies the pins to be toggled.
|
|
* @retval None
|
|
*/
|
|
void HAL_GPIO_TogglePin(GPIO_TypeDef* GPIOx, uint16_t GPIO_Pin)
|
|
{
|
|
80031b8: b580 push {r7, lr}
|
|
80031ba: b084 sub sp, #16
|
|
80031bc: af00 add r7, sp, #0
|
|
80031be: 6078 str r0, [r7, #4]
|
|
80031c0: 460b mov r3, r1
|
|
80031c2: 807b strh r3, [r7, #2]
|
|
uint32_t odr;
|
|
|
|
/* Check the parameters */
|
|
assert_param(IS_GPIO_PIN(GPIO_Pin));
|
|
80031c4: 887b ldrh r3, [r7, #2]
|
|
80031c6: 2b00 cmp r3, #0
|
|
80031c8: d104 bne.n 80031d4 <HAL_GPIO_TogglePin+0x1c>
|
|
80031ca: f44f 71db mov.w r1, #438 @ 0x1b6
|
|
80031ce: 480a ldr r0, [pc, #40] @ (80031f8 <HAL_GPIO_TogglePin+0x40>)
|
|
80031d0: f7fd fdb0 bl 8000d34 <assert_failed>
|
|
|
|
/* get current Output Data Register value */
|
|
odr = GPIOx->ODR;
|
|
80031d4: 687b ldr r3, [r7, #4]
|
|
80031d6: 695b ldr r3, [r3, #20]
|
|
80031d8: 60fb str r3, [r7, #12]
|
|
|
|
/* Set selected pins that were at low level, and reset ones that were high */
|
|
GPIOx->BSRR = ((odr & GPIO_Pin) << GPIO_NUMBER) | (~odr & GPIO_Pin);
|
|
80031da: 887a ldrh r2, [r7, #2]
|
|
80031dc: 68fb ldr r3, [r7, #12]
|
|
80031de: 4013 ands r3, r2
|
|
80031e0: 041a lsls r2, r3, #16
|
|
80031e2: 68fb ldr r3, [r7, #12]
|
|
80031e4: 43d9 mvns r1, r3
|
|
80031e6: 887b ldrh r3, [r7, #2]
|
|
80031e8: 400b ands r3, r1
|
|
80031ea: 431a orrs r2, r3
|
|
80031ec: 687b ldr r3, [r7, #4]
|
|
80031ee: 619a str r2, [r3, #24]
|
|
}
|
|
80031f0: bf00 nop
|
|
80031f2: 3710 adds r7, #16
|
|
80031f4: 46bd mov sp, r7
|
|
80031f6: bd80 pop {r7, pc}
|
|
80031f8: 0800a168 .word 0x0800a168
|
|
|
|
080031fc <HAL_RCC_OscConfig>:
|
|
* supported by this API. User should request a transition to HSE Off
|
|
* first and then HSE On or HSE Bypass.
|
|
* @retval HAL status
|
|
*/
|
|
__weak HAL_StatusTypeDef HAL_RCC_OscConfig(const RCC_OscInitTypeDef *RCC_OscInitStruct)
|
|
{
|
|
80031fc: b580 push {r7, lr}
|
|
80031fe: b086 sub sp, #24
|
|
8003200: af00 add r7, sp, #0
|
|
8003202: 6078 str r0, [r7, #4]
|
|
uint32_t tickstart;
|
|
uint32_t pll_config;
|
|
/* Check Null pointer */
|
|
if (RCC_OscInitStruct == NULL)
|
|
8003204: 687b ldr r3, [r7, #4]
|
|
8003206: 2b00 cmp r3, #0
|
|
8003208: d101 bne.n 800320e <HAL_RCC_OscConfig+0x12>
|
|
{
|
|
return HAL_ERROR;
|
|
800320a: 2301 movs r3, #1
|
|
800320c: e318 b.n 8003840 <HAL_RCC_OscConfig+0x644>
|
|
}
|
|
|
|
/* Check the parameters */
|
|
assert_param(IS_RCC_OSCILLATORTYPE(RCC_OscInitStruct->OscillatorType));
|
|
800320e: 687b ldr r3, [r7, #4]
|
|
8003210: 681b ldr r3, [r3, #0]
|
|
8003212: 2b0f cmp r3, #15
|
|
8003214: d903 bls.n 800321e <HAL_RCC_OscConfig+0x22>
|
|
8003216: 21e6 movs r1, #230 @ 0xe6
|
|
8003218: 4897 ldr r0, [pc, #604] @ (8003478 <HAL_RCC_OscConfig+0x27c>)
|
|
800321a: f7fd fd8b bl 8000d34 <assert_failed>
|
|
/*------------------------------- HSE Configuration ------------------------*/
|
|
if (((RCC_OscInitStruct->OscillatorType) & RCC_OSCILLATORTYPE_HSE) == RCC_OSCILLATORTYPE_HSE)
|
|
800321e: 687b ldr r3, [r7, #4]
|
|
8003220: 681b ldr r3, [r3, #0]
|
|
8003222: f003 0301 and.w r3, r3, #1
|
|
8003226: 2b00 cmp r3, #0
|
|
8003228: f000 8088 beq.w 800333c <HAL_RCC_OscConfig+0x140>
|
|
{
|
|
/* Check the parameters */
|
|
assert_param(IS_RCC_HSE(RCC_OscInitStruct->HSEState));
|
|
800322c: 687b ldr r3, [r7, #4]
|
|
800322e: 685b ldr r3, [r3, #4]
|
|
8003230: 2b00 cmp r3, #0
|
|
8003232: d00d beq.n 8003250 <HAL_RCC_OscConfig+0x54>
|
|
8003234: 687b ldr r3, [r7, #4]
|
|
8003236: 685b ldr r3, [r3, #4]
|
|
8003238: f5b3 3f80 cmp.w r3, #65536 @ 0x10000
|
|
800323c: d008 beq.n 8003250 <HAL_RCC_OscConfig+0x54>
|
|
800323e: 687b ldr r3, [r7, #4]
|
|
8003240: 685b ldr r3, [r3, #4]
|
|
8003242: f5b3 2fa0 cmp.w r3, #327680 @ 0x50000
|
|
8003246: d003 beq.n 8003250 <HAL_RCC_OscConfig+0x54>
|
|
8003248: 21eb movs r1, #235 @ 0xeb
|
|
800324a: 488b ldr r0, [pc, #556] @ (8003478 <HAL_RCC_OscConfig+0x27c>)
|
|
800324c: f7fd fd72 bl 8000d34 <assert_failed>
|
|
/* When the HSE is used as system clock or clock source for PLL in these cases HSE will not disabled */
|
|
if ((__HAL_RCC_GET_SYSCLK_SOURCE() == RCC_CFGR_SWS_HSE) || \
|
|
8003250: 4b8a ldr r3, [pc, #552] @ (800347c <HAL_RCC_OscConfig+0x280>)
|
|
8003252: 689b ldr r3, [r3, #8]
|
|
8003254: f003 030c and.w r3, r3, #12
|
|
8003258: 2b04 cmp r3, #4
|
|
800325a: d00c beq.n 8003276 <HAL_RCC_OscConfig+0x7a>
|
|
((__HAL_RCC_GET_SYSCLK_SOURCE() == RCC_CFGR_SWS_PLL) && ((RCC->PLLCFGR & RCC_PLLCFGR_PLLSRC) == RCC_PLLCFGR_PLLSRC_HSE)))
|
|
800325c: 4b87 ldr r3, [pc, #540] @ (800347c <HAL_RCC_OscConfig+0x280>)
|
|
800325e: 689b ldr r3, [r3, #8]
|
|
8003260: f003 030c and.w r3, r3, #12
|
|
if ((__HAL_RCC_GET_SYSCLK_SOURCE() == RCC_CFGR_SWS_HSE) || \
|
|
8003264: 2b08 cmp r3, #8
|
|
8003266: d112 bne.n 800328e <HAL_RCC_OscConfig+0x92>
|
|
((__HAL_RCC_GET_SYSCLK_SOURCE() == RCC_CFGR_SWS_PLL) && ((RCC->PLLCFGR & RCC_PLLCFGR_PLLSRC) == RCC_PLLCFGR_PLLSRC_HSE)))
|
|
8003268: 4b84 ldr r3, [pc, #528] @ (800347c <HAL_RCC_OscConfig+0x280>)
|
|
800326a: 685b ldr r3, [r3, #4]
|
|
800326c: f403 0380 and.w r3, r3, #4194304 @ 0x400000
|
|
8003270: f5b3 0f80 cmp.w r3, #4194304 @ 0x400000
|
|
8003274: d10b bne.n 800328e <HAL_RCC_OscConfig+0x92>
|
|
{
|
|
if ((__HAL_RCC_GET_FLAG(RCC_FLAG_HSERDY) != RESET) && (RCC_OscInitStruct->HSEState == RCC_HSE_OFF))
|
|
8003276: 4b81 ldr r3, [pc, #516] @ (800347c <HAL_RCC_OscConfig+0x280>)
|
|
8003278: 681b ldr r3, [r3, #0]
|
|
800327a: f403 3300 and.w r3, r3, #131072 @ 0x20000
|
|
800327e: 2b00 cmp r3, #0
|
|
8003280: d05b beq.n 800333a <HAL_RCC_OscConfig+0x13e>
|
|
8003282: 687b ldr r3, [r7, #4]
|
|
8003284: 685b ldr r3, [r3, #4]
|
|
8003286: 2b00 cmp r3, #0
|
|
8003288: d157 bne.n 800333a <HAL_RCC_OscConfig+0x13e>
|
|
{
|
|
return HAL_ERROR;
|
|
800328a: 2301 movs r3, #1
|
|
800328c: e2d8 b.n 8003840 <HAL_RCC_OscConfig+0x644>
|
|
}
|
|
}
|
|
else
|
|
{
|
|
/* Set the new HSE configuration ---------------------------------------*/
|
|
__HAL_RCC_HSE_CONFIG(RCC_OscInitStruct->HSEState);
|
|
800328e: 687b ldr r3, [r7, #4]
|
|
8003290: 685b ldr r3, [r3, #4]
|
|
8003292: f5b3 3f80 cmp.w r3, #65536 @ 0x10000
|
|
8003296: d106 bne.n 80032a6 <HAL_RCC_OscConfig+0xaa>
|
|
8003298: 4b78 ldr r3, [pc, #480] @ (800347c <HAL_RCC_OscConfig+0x280>)
|
|
800329a: 681b ldr r3, [r3, #0]
|
|
800329c: 4a77 ldr r2, [pc, #476] @ (800347c <HAL_RCC_OscConfig+0x280>)
|
|
800329e: f443 3380 orr.w r3, r3, #65536 @ 0x10000
|
|
80032a2: 6013 str r3, [r2, #0]
|
|
80032a4: e01d b.n 80032e2 <HAL_RCC_OscConfig+0xe6>
|
|
80032a6: 687b ldr r3, [r7, #4]
|
|
80032a8: 685b ldr r3, [r3, #4]
|
|
80032aa: f5b3 2fa0 cmp.w r3, #327680 @ 0x50000
|
|
80032ae: d10c bne.n 80032ca <HAL_RCC_OscConfig+0xce>
|
|
80032b0: 4b72 ldr r3, [pc, #456] @ (800347c <HAL_RCC_OscConfig+0x280>)
|
|
80032b2: 681b ldr r3, [r3, #0]
|
|
80032b4: 4a71 ldr r2, [pc, #452] @ (800347c <HAL_RCC_OscConfig+0x280>)
|
|
80032b6: f443 2380 orr.w r3, r3, #262144 @ 0x40000
|
|
80032ba: 6013 str r3, [r2, #0]
|
|
80032bc: 4b6f ldr r3, [pc, #444] @ (800347c <HAL_RCC_OscConfig+0x280>)
|
|
80032be: 681b ldr r3, [r3, #0]
|
|
80032c0: 4a6e ldr r2, [pc, #440] @ (800347c <HAL_RCC_OscConfig+0x280>)
|
|
80032c2: f443 3380 orr.w r3, r3, #65536 @ 0x10000
|
|
80032c6: 6013 str r3, [r2, #0]
|
|
80032c8: e00b b.n 80032e2 <HAL_RCC_OscConfig+0xe6>
|
|
80032ca: 4b6c ldr r3, [pc, #432] @ (800347c <HAL_RCC_OscConfig+0x280>)
|
|
80032cc: 681b ldr r3, [r3, #0]
|
|
80032ce: 4a6b ldr r2, [pc, #428] @ (800347c <HAL_RCC_OscConfig+0x280>)
|
|
80032d0: f423 3380 bic.w r3, r3, #65536 @ 0x10000
|
|
80032d4: 6013 str r3, [r2, #0]
|
|
80032d6: 4b69 ldr r3, [pc, #420] @ (800347c <HAL_RCC_OscConfig+0x280>)
|
|
80032d8: 681b ldr r3, [r3, #0]
|
|
80032da: 4a68 ldr r2, [pc, #416] @ (800347c <HAL_RCC_OscConfig+0x280>)
|
|
80032dc: f423 2380 bic.w r3, r3, #262144 @ 0x40000
|
|
80032e0: 6013 str r3, [r2, #0]
|
|
|
|
/* Check the HSE State */
|
|
if ((RCC_OscInitStruct->HSEState) != RCC_HSE_OFF)
|
|
80032e2: 687b ldr r3, [r7, #4]
|
|
80032e4: 685b ldr r3, [r3, #4]
|
|
80032e6: 2b00 cmp r3, #0
|
|
80032e8: d013 beq.n 8003312 <HAL_RCC_OscConfig+0x116>
|
|
{
|
|
/* Get Start Tick */
|
|
tickstart = HAL_GetTick();
|
|
80032ea: f7fe f8a5 bl 8001438 <HAL_GetTick>
|
|
80032ee: 6138 str r0, [r7, #16]
|
|
|
|
/* Wait till HSE is ready */
|
|
while (__HAL_RCC_GET_FLAG(RCC_FLAG_HSERDY) == RESET)
|
|
80032f0: e008 b.n 8003304 <HAL_RCC_OscConfig+0x108>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > HSE_TIMEOUT_VALUE)
|
|
80032f2: f7fe f8a1 bl 8001438 <HAL_GetTick>
|
|
80032f6: 4602 mov r2, r0
|
|
80032f8: 693b ldr r3, [r7, #16]
|
|
80032fa: 1ad3 subs r3, r2, r3
|
|
80032fc: 2b64 cmp r3, #100 @ 0x64
|
|
80032fe: d901 bls.n 8003304 <HAL_RCC_OscConfig+0x108>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
8003300: 2303 movs r3, #3
|
|
8003302: e29d b.n 8003840 <HAL_RCC_OscConfig+0x644>
|
|
while (__HAL_RCC_GET_FLAG(RCC_FLAG_HSERDY) == RESET)
|
|
8003304: 4b5d ldr r3, [pc, #372] @ (800347c <HAL_RCC_OscConfig+0x280>)
|
|
8003306: 681b ldr r3, [r3, #0]
|
|
8003308: f403 3300 and.w r3, r3, #131072 @ 0x20000
|
|
800330c: 2b00 cmp r3, #0
|
|
800330e: d0f0 beq.n 80032f2 <HAL_RCC_OscConfig+0xf6>
|
|
8003310: e014 b.n 800333c <HAL_RCC_OscConfig+0x140>
|
|
}
|
|
}
|
|
else
|
|
{
|
|
/* Get Start Tick */
|
|
tickstart = HAL_GetTick();
|
|
8003312: f7fe f891 bl 8001438 <HAL_GetTick>
|
|
8003316: 6138 str r0, [r7, #16]
|
|
|
|
/* Wait till HSE is bypassed or disabled */
|
|
while (__HAL_RCC_GET_FLAG(RCC_FLAG_HSERDY) != RESET)
|
|
8003318: e008 b.n 800332c <HAL_RCC_OscConfig+0x130>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > HSE_TIMEOUT_VALUE)
|
|
800331a: f7fe f88d bl 8001438 <HAL_GetTick>
|
|
800331e: 4602 mov r2, r0
|
|
8003320: 693b ldr r3, [r7, #16]
|
|
8003322: 1ad3 subs r3, r2, r3
|
|
8003324: 2b64 cmp r3, #100 @ 0x64
|
|
8003326: d901 bls.n 800332c <HAL_RCC_OscConfig+0x130>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
8003328: 2303 movs r3, #3
|
|
800332a: e289 b.n 8003840 <HAL_RCC_OscConfig+0x644>
|
|
while (__HAL_RCC_GET_FLAG(RCC_FLAG_HSERDY) != RESET)
|
|
800332c: 4b53 ldr r3, [pc, #332] @ (800347c <HAL_RCC_OscConfig+0x280>)
|
|
800332e: 681b ldr r3, [r3, #0]
|
|
8003330: f403 3300 and.w r3, r3, #131072 @ 0x20000
|
|
8003334: 2b00 cmp r3, #0
|
|
8003336: d1f0 bne.n 800331a <HAL_RCC_OscConfig+0x11e>
|
|
8003338: e000 b.n 800333c <HAL_RCC_OscConfig+0x140>
|
|
if ((__HAL_RCC_GET_FLAG(RCC_FLAG_HSERDY) != RESET) && (RCC_OscInitStruct->HSEState == RCC_HSE_OFF))
|
|
800333a: bf00 nop
|
|
}
|
|
}
|
|
}
|
|
}
|
|
/*----------------------------- HSI Configuration --------------------------*/
|
|
if (((RCC_OscInitStruct->OscillatorType) & RCC_OSCILLATORTYPE_HSI) == RCC_OSCILLATORTYPE_HSI)
|
|
800333c: 687b ldr r3, [r7, #4]
|
|
800333e: 681b ldr r3, [r3, #0]
|
|
8003340: f003 0302 and.w r3, r3, #2
|
|
8003344: 2b00 cmp r3, #0
|
|
8003346: d079 beq.n 800343c <HAL_RCC_OscConfig+0x240>
|
|
{
|
|
/* Check the parameters */
|
|
assert_param(IS_RCC_HSI(RCC_OscInitStruct->HSIState));
|
|
8003348: 687b ldr r3, [r7, #4]
|
|
800334a: 68db ldr r3, [r3, #12]
|
|
800334c: 2b00 cmp r3, #0
|
|
800334e: d008 beq.n 8003362 <HAL_RCC_OscConfig+0x166>
|
|
8003350: 687b ldr r3, [r7, #4]
|
|
8003352: 68db ldr r3, [r3, #12]
|
|
8003354: 2b01 cmp r3, #1
|
|
8003356: d004 beq.n 8003362 <HAL_RCC_OscConfig+0x166>
|
|
8003358: f240 111d movw r1, #285 @ 0x11d
|
|
800335c: 4846 ldr r0, [pc, #280] @ (8003478 <HAL_RCC_OscConfig+0x27c>)
|
|
800335e: f7fd fce9 bl 8000d34 <assert_failed>
|
|
assert_param(IS_RCC_CALIBRATION_VALUE(RCC_OscInitStruct->HSICalibrationValue));
|
|
8003362: 687b ldr r3, [r7, #4]
|
|
8003364: 691b ldr r3, [r3, #16]
|
|
8003366: 2b1f cmp r3, #31
|
|
8003368: d904 bls.n 8003374 <HAL_RCC_OscConfig+0x178>
|
|
800336a: f44f 718f mov.w r1, #286 @ 0x11e
|
|
800336e: 4842 ldr r0, [pc, #264] @ (8003478 <HAL_RCC_OscConfig+0x27c>)
|
|
8003370: f7fd fce0 bl 8000d34 <assert_failed>
|
|
|
|
/* Check if HSI is used as system clock or as PLL source when PLL is selected as system clock */
|
|
if ((__HAL_RCC_GET_SYSCLK_SOURCE() == RCC_CFGR_SWS_HSI) || \
|
|
8003374: 4b41 ldr r3, [pc, #260] @ (800347c <HAL_RCC_OscConfig+0x280>)
|
|
8003376: 689b ldr r3, [r3, #8]
|
|
8003378: f003 030c and.w r3, r3, #12
|
|
800337c: 2b00 cmp r3, #0
|
|
800337e: d00b beq.n 8003398 <HAL_RCC_OscConfig+0x19c>
|
|
((__HAL_RCC_GET_SYSCLK_SOURCE() == RCC_CFGR_SWS_PLL) && ((RCC->PLLCFGR & RCC_PLLCFGR_PLLSRC) == RCC_PLLCFGR_PLLSRC_HSI)))
|
|
8003380: 4b3e ldr r3, [pc, #248] @ (800347c <HAL_RCC_OscConfig+0x280>)
|
|
8003382: 689b ldr r3, [r3, #8]
|
|
8003384: f003 030c and.w r3, r3, #12
|
|
if ((__HAL_RCC_GET_SYSCLK_SOURCE() == RCC_CFGR_SWS_HSI) || \
|
|
8003388: 2b08 cmp r3, #8
|
|
800338a: d11c bne.n 80033c6 <HAL_RCC_OscConfig+0x1ca>
|
|
((__HAL_RCC_GET_SYSCLK_SOURCE() == RCC_CFGR_SWS_PLL) && ((RCC->PLLCFGR & RCC_PLLCFGR_PLLSRC) == RCC_PLLCFGR_PLLSRC_HSI)))
|
|
800338c: 4b3b ldr r3, [pc, #236] @ (800347c <HAL_RCC_OscConfig+0x280>)
|
|
800338e: 685b ldr r3, [r3, #4]
|
|
8003390: f403 0380 and.w r3, r3, #4194304 @ 0x400000
|
|
8003394: 2b00 cmp r3, #0
|
|
8003396: d116 bne.n 80033c6 <HAL_RCC_OscConfig+0x1ca>
|
|
{
|
|
/* When HSI is used as system clock it will not disabled */
|
|
if ((__HAL_RCC_GET_FLAG(RCC_FLAG_HSIRDY) != RESET) && (RCC_OscInitStruct->HSIState != RCC_HSI_ON))
|
|
8003398: 4b38 ldr r3, [pc, #224] @ (800347c <HAL_RCC_OscConfig+0x280>)
|
|
800339a: 681b ldr r3, [r3, #0]
|
|
800339c: f003 0302 and.w r3, r3, #2
|
|
80033a0: 2b00 cmp r3, #0
|
|
80033a2: d005 beq.n 80033b0 <HAL_RCC_OscConfig+0x1b4>
|
|
80033a4: 687b ldr r3, [r7, #4]
|
|
80033a6: 68db ldr r3, [r3, #12]
|
|
80033a8: 2b01 cmp r3, #1
|
|
80033aa: d001 beq.n 80033b0 <HAL_RCC_OscConfig+0x1b4>
|
|
{
|
|
return HAL_ERROR;
|
|
80033ac: 2301 movs r3, #1
|
|
80033ae: e247 b.n 8003840 <HAL_RCC_OscConfig+0x644>
|
|
}
|
|
/* Otherwise, just the calibration is allowed */
|
|
else
|
|
{
|
|
/* Adjusts the Internal High Speed oscillator (HSI) calibration value.*/
|
|
__HAL_RCC_HSI_CALIBRATIONVALUE_ADJUST(RCC_OscInitStruct->HSICalibrationValue);
|
|
80033b0: 4b32 ldr r3, [pc, #200] @ (800347c <HAL_RCC_OscConfig+0x280>)
|
|
80033b2: 681b ldr r3, [r3, #0]
|
|
80033b4: f023 02f8 bic.w r2, r3, #248 @ 0xf8
|
|
80033b8: 687b ldr r3, [r7, #4]
|
|
80033ba: 691b ldr r3, [r3, #16]
|
|
80033bc: 00db lsls r3, r3, #3
|
|
80033be: 492f ldr r1, [pc, #188] @ (800347c <HAL_RCC_OscConfig+0x280>)
|
|
80033c0: 4313 orrs r3, r2
|
|
80033c2: 600b str r3, [r1, #0]
|
|
if ((__HAL_RCC_GET_FLAG(RCC_FLAG_HSIRDY) != RESET) && (RCC_OscInitStruct->HSIState != RCC_HSI_ON))
|
|
80033c4: e03a b.n 800343c <HAL_RCC_OscConfig+0x240>
|
|
}
|
|
}
|
|
else
|
|
{
|
|
/* Check the HSI State */
|
|
if ((RCC_OscInitStruct->HSIState) != RCC_HSI_OFF)
|
|
80033c6: 687b ldr r3, [r7, #4]
|
|
80033c8: 68db ldr r3, [r3, #12]
|
|
80033ca: 2b00 cmp r3, #0
|
|
80033cc: d020 beq.n 8003410 <HAL_RCC_OscConfig+0x214>
|
|
{
|
|
/* Enable the Internal High Speed oscillator (HSI). */
|
|
__HAL_RCC_HSI_ENABLE();
|
|
80033ce: 4b2c ldr r3, [pc, #176] @ (8003480 <HAL_RCC_OscConfig+0x284>)
|
|
80033d0: 2201 movs r2, #1
|
|
80033d2: 601a str r2, [r3, #0]
|
|
|
|
/* Get Start Tick*/
|
|
tickstart = HAL_GetTick();
|
|
80033d4: f7fe f830 bl 8001438 <HAL_GetTick>
|
|
80033d8: 6138 str r0, [r7, #16]
|
|
|
|
/* Wait till HSI is ready */
|
|
while (__HAL_RCC_GET_FLAG(RCC_FLAG_HSIRDY) == RESET)
|
|
80033da: e008 b.n 80033ee <HAL_RCC_OscConfig+0x1f2>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > HSI_TIMEOUT_VALUE)
|
|
80033dc: f7fe f82c bl 8001438 <HAL_GetTick>
|
|
80033e0: 4602 mov r2, r0
|
|
80033e2: 693b ldr r3, [r7, #16]
|
|
80033e4: 1ad3 subs r3, r2, r3
|
|
80033e6: 2b02 cmp r3, #2
|
|
80033e8: d901 bls.n 80033ee <HAL_RCC_OscConfig+0x1f2>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
80033ea: 2303 movs r3, #3
|
|
80033ec: e228 b.n 8003840 <HAL_RCC_OscConfig+0x644>
|
|
while (__HAL_RCC_GET_FLAG(RCC_FLAG_HSIRDY) == RESET)
|
|
80033ee: 4b23 ldr r3, [pc, #140] @ (800347c <HAL_RCC_OscConfig+0x280>)
|
|
80033f0: 681b ldr r3, [r3, #0]
|
|
80033f2: f003 0302 and.w r3, r3, #2
|
|
80033f6: 2b00 cmp r3, #0
|
|
80033f8: d0f0 beq.n 80033dc <HAL_RCC_OscConfig+0x1e0>
|
|
}
|
|
}
|
|
|
|
/* Adjusts the Internal High Speed oscillator (HSI) calibration value. */
|
|
__HAL_RCC_HSI_CALIBRATIONVALUE_ADJUST(RCC_OscInitStruct->HSICalibrationValue);
|
|
80033fa: 4b20 ldr r3, [pc, #128] @ (800347c <HAL_RCC_OscConfig+0x280>)
|
|
80033fc: 681b ldr r3, [r3, #0]
|
|
80033fe: f023 02f8 bic.w r2, r3, #248 @ 0xf8
|
|
8003402: 687b ldr r3, [r7, #4]
|
|
8003404: 691b ldr r3, [r3, #16]
|
|
8003406: 00db lsls r3, r3, #3
|
|
8003408: 491c ldr r1, [pc, #112] @ (800347c <HAL_RCC_OscConfig+0x280>)
|
|
800340a: 4313 orrs r3, r2
|
|
800340c: 600b str r3, [r1, #0]
|
|
800340e: e015 b.n 800343c <HAL_RCC_OscConfig+0x240>
|
|
}
|
|
else
|
|
{
|
|
/* Disable the Internal High Speed oscillator (HSI). */
|
|
__HAL_RCC_HSI_DISABLE();
|
|
8003410: 4b1b ldr r3, [pc, #108] @ (8003480 <HAL_RCC_OscConfig+0x284>)
|
|
8003412: 2200 movs r2, #0
|
|
8003414: 601a str r2, [r3, #0]
|
|
|
|
/* Get Start Tick*/
|
|
tickstart = HAL_GetTick();
|
|
8003416: f7fe f80f bl 8001438 <HAL_GetTick>
|
|
800341a: 6138 str r0, [r7, #16]
|
|
|
|
/* Wait till HSI is ready */
|
|
while (__HAL_RCC_GET_FLAG(RCC_FLAG_HSIRDY) != RESET)
|
|
800341c: e008 b.n 8003430 <HAL_RCC_OscConfig+0x234>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > HSI_TIMEOUT_VALUE)
|
|
800341e: f7fe f80b bl 8001438 <HAL_GetTick>
|
|
8003422: 4602 mov r2, r0
|
|
8003424: 693b ldr r3, [r7, #16]
|
|
8003426: 1ad3 subs r3, r2, r3
|
|
8003428: 2b02 cmp r3, #2
|
|
800342a: d901 bls.n 8003430 <HAL_RCC_OscConfig+0x234>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
800342c: 2303 movs r3, #3
|
|
800342e: e207 b.n 8003840 <HAL_RCC_OscConfig+0x644>
|
|
while (__HAL_RCC_GET_FLAG(RCC_FLAG_HSIRDY) != RESET)
|
|
8003430: 4b12 ldr r3, [pc, #72] @ (800347c <HAL_RCC_OscConfig+0x280>)
|
|
8003432: 681b ldr r3, [r3, #0]
|
|
8003434: f003 0302 and.w r3, r3, #2
|
|
8003438: 2b00 cmp r3, #0
|
|
800343a: d1f0 bne.n 800341e <HAL_RCC_OscConfig+0x222>
|
|
}
|
|
}
|
|
}
|
|
}
|
|
/*------------------------------ LSI Configuration -------------------------*/
|
|
if (((RCC_OscInitStruct->OscillatorType) & RCC_OSCILLATORTYPE_LSI) == RCC_OSCILLATORTYPE_LSI)
|
|
800343c: 687b ldr r3, [r7, #4]
|
|
800343e: 681b ldr r3, [r3, #0]
|
|
8003440: f003 0308 and.w r3, r3, #8
|
|
8003444: 2b00 cmp r3, #0
|
|
8003446: d045 beq.n 80034d4 <HAL_RCC_OscConfig+0x2d8>
|
|
{
|
|
/* Check the parameters */
|
|
assert_param(IS_RCC_LSI(RCC_OscInitStruct->LSIState));
|
|
8003448: 687b ldr r3, [r7, #4]
|
|
800344a: 695b ldr r3, [r3, #20]
|
|
800344c: 2b00 cmp r3, #0
|
|
800344e: d008 beq.n 8003462 <HAL_RCC_OscConfig+0x266>
|
|
8003450: 687b ldr r3, [r7, #4]
|
|
8003452: 695b ldr r3, [r3, #20]
|
|
8003454: 2b01 cmp r3, #1
|
|
8003456: d004 beq.n 8003462 <HAL_RCC_OscConfig+0x266>
|
|
8003458: f44f 71af mov.w r1, #350 @ 0x15e
|
|
800345c: 4806 ldr r0, [pc, #24] @ (8003478 <HAL_RCC_OscConfig+0x27c>)
|
|
800345e: f7fd fc69 bl 8000d34 <assert_failed>
|
|
|
|
/* Check the LSI State */
|
|
if ((RCC_OscInitStruct->LSIState) != RCC_LSI_OFF)
|
|
8003462: 687b ldr r3, [r7, #4]
|
|
8003464: 695b ldr r3, [r3, #20]
|
|
8003466: 2b00 cmp r3, #0
|
|
8003468: d01e beq.n 80034a8 <HAL_RCC_OscConfig+0x2ac>
|
|
{
|
|
/* Enable the Internal Low Speed oscillator (LSI). */
|
|
__HAL_RCC_LSI_ENABLE();
|
|
800346a: 4b06 ldr r3, [pc, #24] @ (8003484 <HAL_RCC_OscConfig+0x288>)
|
|
800346c: 2201 movs r2, #1
|
|
800346e: 601a str r2, [r3, #0]
|
|
|
|
/* Get Start Tick*/
|
|
tickstart = HAL_GetTick();
|
|
8003470: f7fd ffe2 bl 8001438 <HAL_GetTick>
|
|
8003474: 6138 str r0, [r7, #16]
|
|
|
|
/* Wait till LSI is ready */
|
|
while (__HAL_RCC_GET_FLAG(RCC_FLAG_LSIRDY) == RESET)
|
|
8003476: e010 b.n 800349a <HAL_RCC_OscConfig+0x29e>
|
|
8003478: 0800a1a4 .word 0x0800a1a4
|
|
800347c: 40023800 .word 0x40023800
|
|
8003480: 42470000 .word 0x42470000
|
|
8003484: 42470e80 .word 0x42470e80
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > LSI_TIMEOUT_VALUE)
|
|
8003488: f7fd ffd6 bl 8001438 <HAL_GetTick>
|
|
800348c: 4602 mov r2, r0
|
|
800348e: 693b ldr r3, [r7, #16]
|
|
8003490: 1ad3 subs r3, r2, r3
|
|
8003492: 2b02 cmp r3, #2
|
|
8003494: d901 bls.n 800349a <HAL_RCC_OscConfig+0x29e>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
8003496: 2303 movs r3, #3
|
|
8003498: e1d2 b.n 8003840 <HAL_RCC_OscConfig+0x644>
|
|
while (__HAL_RCC_GET_FLAG(RCC_FLAG_LSIRDY) == RESET)
|
|
800349a: 4b5e ldr r3, [pc, #376] @ (8003614 <HAL_RCC_OscConfig+0x418>)
|
|
800349c: 6f5b ldr r3, [r3, #116] @ 0x74
|
|
800349e: f003 0302 and.w r3, r3, #2
|
|
80034a2: 2b00 cmp r3, #0
|
|
80034a4: d0f0 beq.n 8003488 <HAL_RCC_OscConfig+0x28c>
|
|
80034a6: e015 b.n 80034d4 <HAL_RCC_OscConfig+0x2d8>
|
|
}
|
|
}
|
|
else
|
|
{
|
|
/* Disable the Internal Low Speed oscillator (LSI). */
|
|
__HAL_RCC_LSI_DISABLE();
|
|
80034a8: 4b5b ldr r3, [pc, #364] @ (8003618 <HAL_RCC_OscConfig+0x41c>)
|
|
80034aa: 2200 movs r2, #0
|
|
80034ac: 601a str r2, [r3, #0]
|
|
|
|
/* Get Start Tick */
|
|
tickstart = HAL_GetTick();
|
|
80034ae: f7fd ffc3 bl 8001438 <HAL_GetTick>
|
|
80034b2: 6138 str r0, [r7, #16]
|
|
|
|
/* Wait till LSI is ready */
|
|
while (__HAL_RCC_GET_FLAG(RCC_FLAG_LSIRDY) != RESET)
|
|
80034b4: e008 b.n 80034c8 <HAL_RCC_OscConfig+0x2cc>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > LSI_TIMEOUT_VALUE)
|
|
80034b6: f7fd ffbf bl 8001438 <HAL_GetTick>
|
|
80034ba: 4602 mov r2, r0
|
|
80034bc: 693b ldr r3, [r7, #16]
|
|
80034be: 1ad3 subs r3, r2, r3
|
|
80034c0: 2b02 cmp r3, #2
|
|
80034c2: d901 bls.n 80034c8 <HAL_RCC_OscConfig+0x2cc>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
80034c4: 2303 movs r3, #3
|
|
80034c6: e1bb b.n 8003840 <HAL_RCC_OscConfig+0x644>
|
|
while (__HAL_RCC_GET_FLAG(RCC_FLAG_LSIRDY) != RESET)
|
|
80034c8: 4b52 ldr r3, [pc, #328] @ (8003614 <HAL_RCC_OscConfig+0x418>)
|
|
80034ca: 6f5b ldr r3, [r3, #116] @ 0x74
|
|
80034cc: f003 0302 and.w r3, r3, #2
|
|
80034d0: 2b00 cmp r3, #0
|
|
80034d2: d1f0 bne.n 80034b6 <HAL_RCC_OscConfig+0x2ba>
|
|
}
|
|
}
|
|
}
|
|
}
|
|
/*------------------------------ LSE Configuration -------------------------*/
|
|
if (((RCC_OscInitStruct->OscillatorType) & RCC_OSCILLATORTYPE_LSE) == RCC_OSCILLATORTYPE_LSE)
|
|
80034d4: 687b ldr r3, [r7, #4]
|
|
80034d6: 681b ldr r3, [r3, #0]
|
|
80034d8: f003 0304 and.w r3, r3, #4
|
|
80034dc: 2b00 cmp r3, #0
|
|
80034de: f000 80b0 beq.w 8003642 <HAL_RCC_OscConfig+0x446>
|
|
{
|
|
FlagStatus pwrclkchanged = RESET;
|
|
80034e2: 2300 movs r3, #0
|
|
80034e4: 75fb strb r3, [r7, #23]
|
|
|
|
/* Check the parameters */
|
|
assert_param(IS_RCC_LSE(RCC_OscInitStruct->LSEState));
|
|
80034e6: 687b ldr r3, [r7, #4]
|
|
80034e8: 689b ldr r3, [r3, #8]
|
|
80034ea: 2b00 cmp r3, #0
|
|
80034ec: d00c beq.n 8003508 <HAL_RCC_OscConfig+0x30c>
|
|
80034ee: 687b ldr r3, [r7, #4]
|
|
80034f0: 689b ldr r3, [r3, #8]
|
|
80034f2: 2b01 cmp r3, #1
|
|
80034f4: d008 beq.n 8003508 <HAL_RCC_OscConfig+0x30c>
|
|
80034f6: 687b ldr r3, [r7, #4]
|
|
80034f8: 689b ldr r3, [r3, #8]
|
|
80034fa: 2b05 cmp r3, #5
|
|
80034fc: d004 beq.n 8003508 <HAL_RCC_OscConfig+0x30c>
|
|
80034fe: f44f 71c5 mov.w r1, #394 @ 0x18a
|
|
8003502: 4846 ldr r0, [pc, #280] @ (800361c <HAL_RCC_OscConfig+0x420>)
|
|
8003504: f7fd fc16 bl 8000d34 <assert_failed>
|
|
|
|
/* Update LSE configuration in Backup Domain control register */
|
|
/* Requires to enable write access to Backup Domain of necessary */
|
|
if (__HAL_RCC_PWR_IS_CLK_DISABLED())
|
|
8003508: 4b42 ldr r3, [pc, #264] @ (8003614 <HAL_RCC_OscConfig+0x418>)
|
|
800350a: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
800350c: f003 5380 and.w r3, r3, #268435456 @ 0x10000000
|
|
8003510: 2b00 cmp r3, #0
|
|
8003512: d10f bne.n 8003534 <HAL_RCC_OscConfig+0x338>
|
|
{
|
|
__HAL_RCC_PWR_CLK_ENABLE();
|
|
8003514: 2300 movs r3, #0
|
|
8003516: 60bb str r3, [r7, #8]
|
|
8003518: 4b3e ldr r3, [pc, #248] @ (8003614 <HAL_RCC_OscConfig+0x418>)
|
|
800351a: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
800351c: 4a3d ldr r2, [pc, #244] @ (8003614 <HAL_RCC_OscConfig+0x418>)
|
|
800351e: f043 5380 orr.w r3, r3, #268435456 @ 0x10000000
|
|
8003522: 6413 str r3, [r2, #64] @ 0x40
|
|
8003524: 4b3b ldr r3, [pc, #236] @ (8003614 <HAL_RCC_OscConfig+0x418>)
|
|
8003526: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
8003528: f003 5380 and.w r3, r3, #268435456 @ 0x10000000
|
|
800352c: 60bb str r3, [r7, #8]
|
|
800352e: 68bb ldr r3, [r7, #8]
|
|
pwrclkchanged = SET;
|
|
8003530: 2301 movs r3, #1
|
|
8003532: 75fb strb r3, [r7, #23]
|
|
}
|
|
|
|
if (HAL_IS_BIT_CLR(PWR->CR, PWR_CR_DBP))
|
|
8003534: 4b3a ldr r3, [pc, #232] @ (8003620 <HAL_RCC_OscConfig+0x424>)
|
|
8003536: 681b ldr r3, [r3, #0]
|
|
8003538: f403 7380 and.w r3, r3, #256 @ 0x100
|
|
800353c: 2b00 cmp r3, #0
|
|
800353e: d118 bne.n 8003572 <HAL_RCC_OscConfig+0x376>
|
|
{
|
|
/* Enable write access to Backup domain */
|
|
SET_BIT(PWR->CR, PWR_CR_DBP);
|
|
8003540: 4b37 ldr r3, [pc, #220] @ (8003620 <HAL_RCC_OscConfig+0x424>)
|
|
8003542: 681b ldr r3, [r3, #0]
|
|
8003544: 4a36 ldr r2, [pc, #216] @ (8003620 <HAL_RCC_OscConfig+0x424>)
|
|
8003546: f443 7380 orr.w r3, r3, #256 @ 0x100
|
|
800354a: 6013 str r3, [r2, #0]
|
|
|
|
/* Wait for Backup domain Write protection disable */
|
|
tickstart = HAL_GetTick();
|
|
800354c: f7fd ff74 bl 8001438 <HAL_GetTick>
|
|
8003550: 6138 str r0, [r7, #16]
|
|
|
|
while (HAL_IS_BIT_CLR(PWR->CR, PWR_CR_DBP))
|
|
8003552: e008 b.n 8003566 <HAL_RCC_OscConfig+0x36a>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > RCC_DBP_TIMEOUT_VALUE)
|
|
8003554: f7fd ff70 bl 8001438 <HAL_GetTick>
|
|
8003558: 4602 mov r2, r0
|
|
800355a: 693b ldr r3, [r7, #16]
|
|
800355c: 1ad3 subs r3, r2, r3
|
|
800355e: 2b02 cmp r3, #2
|
|
8003560: d901 bls.n 8003566 <HAL_RCC_OscConfig+0x36a>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
8003562: 2303 movs r3, #3
|
|
8003564: e16c b.n 8003840 <HAL_RCC_OscConfig+0x644>
|
|
while (HAL_IS_BIT_CLR(PWR->CR, PWR_CR_DBP))
|
|
8003566: 4b2e ldr r3, [pc, #184] @ (8003620 <HAL_RCC_OscConfig+0x424>)
|
|
8003568: 681b ldr r3, [r3, #0]
|
|
800356a: f403 7380 and.w r3, r3, #256 @ 0x100
|
|
800356e: 2b00 cmp r3, #0
|
|
8003570: d0f0 beq.n 8003554 <HAL_RCC_OscConfig+0x358>
|
|
}
|
|
}
|
|
}
|
|
|
|
/* Set the new LSE configuration -----------------------------------------*/
|
|
__HAL_RCC_LSE_CONFIG(RCC_OscInitStruct->LSEState);
|
|
8003572: 687b ldr r3, [r7, #4]
|
|
8003574: 689b ldr r3, [r3, #8]
|
|
8003576: 2b01 cmp r3, #1
|
|
8003578: d106 bne.n 8003588 <HAL_RCC_OscConfig+0x38c>
|
|
800357a: 4b26 ldr r3, [pc, #152] @ (8003614 <HAL_RCC_OscConfig+0x418>)
|
|
800357c: 6f1b ldr r3, [r3, #112] @ 0x70
|
|
800357e: 4a25 ldr r2, [pc, #148] @ (8003614 <HAL_RCC_OscConfig+0x418>)
|
|
8003580: f043 0301 orr.w r3, r3, #1
|
|
8003584: 6713 str r3, [r2, #112] @ 0x70
|
|
8003586: e01c b.n 80035c2 <HAL_RCC_OscConfig+0x3c6>
|
|
8003588: 687b ldr r3, [r7, #4]
|
|
800358a: 689b ldr r3, [r3, #8]
|
|
800358c: 2b05 cmp r3, #5
|
|
800358e: d10c bne.n 80035aa <HAL_RCC_OscConfig+0x3ae>
|
|
8003590: 4b20 ldr r3, [pc, #128] @ (8003614 <HAL_RCC_OscConfig+0x418>)
|
|
8003592: 6f1b ldr r3, [r3, #112] @ 0x70
|
|
8003594: 4a1f ldr r2, [pc, #124] @ (8003614 <HAL_RCC_OscConfig+0x418>)
|
|
8003596: f043 0304 orr.w r3, r3, #4
|
|
800359a: 6713 str r3, [r2, #112] @ 0x70
|
|
800359c: 4b1d ldr r3, [pc, #116] @ (8003614 <HAL_RCC_OscConfig+0x418>)
|
|
800359e: 6f1b ldr r3, [r3, #112] @ 0x70
|
|
80035a0: 4a1c ldr r2, [pc, #112] @ (8003614 <HAL_RCC_OscConfig+0x418>)
|
|
80035a2: f043 0301 orr.w r3, r3, #1
|
|
80035a6: 6713 str r3, [r2, #112] @ 0x70
|
|
80035a8: e00b b.n 80035c2 <HAL_RCC_OscConfig+0x3c6>
|
|
80035aa: 4b1a ldr r3, [pc, #104] @ (8003614 <HAL_RCC_OscConfig+0x418>)
|
|
80035ac: 6f1b ldr r3, [r3, #112] @ 0x70
|
|
80035ae: 4a19 ldr r2, [pc, #100] @ (8003614 <HAL_RCC_OscConfig+0x418>)
|
|
80035b0: f023 0301 bic.w r3, r3, #1
|
|
80035b4: 6713 str r3, [r2, #112] @ 0x70
|
|
80035b6: 4b17 ldr r3, [pc, #92] @ (8003614 <HAL_RCC_OscConfig+0x418>)
|
|
80035b8: 6f1b ldr r3, [r3, #112] @ 0x70
|
|
80035ba: 4a16 ldr r2, [pc, #88] @ (8003614 <HAL_RCC_OscConfig+0x418>)
|
|
80035bc: f023 0304 bic.w r3, r3, #4
|
|
80035c0: 6713 str r3, [r2, #112] @ 0x70
|
|
/* Check the LSE State */
|
|
if ((RCC_OscInitStruct->LSEState) != RCC_LSE_OFF)
|
|
80035c2: 687b ldr r3, [r7, #4]
|
|
80035c4: 689b ldr r3, [r3, #8]
|
|
80035c6: 2b00 cmp r3, #0
|
|
80035c8: d015 beq.n 80035f6 <HAL_RCC_OscConfig+0x3fa>
|
|
{
|
|
/* Get Start Tick*/
|
|
tickstart = HAL_GetTick();
|
|
80035ca: f7fd ff35 bl 8001438 <HAL_GetTick>
|
|
80035ce: 6138 str r0, [r7, #16]
|
|
|
|
/* Wait till LSE is ready */
|
|
while (__HAL_RCC_GET_FLAG(RCC_FLAG_LSERDY) == RESET)
|
|
80035d0: e00a b.n 80035e8 <HAL_RCC_OscConfig+0x3ec>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > RCC_LSE_TIMEOUT_VALUE)
|
|
80035d2: f7fd ff31 bl 8001438 <HAL_GetTick>
|
|
80035d6: 4602 mov r2, r0
|
|
80035d8: 693b ldr r3, [r7, #16]
|
|
80035da: 1ad3 subs r3, r2, r3
|
|
80035dc: f241 3288 movw r2, #5000 @ 0x1388
|
|
80035e0: 4293 cmp r3, r2
|
|
80035e2: d901 bls.n 80035e8 <HAL_RCC_OscConfig+0x3ec>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
80035e4: 2303 movs r3, #3
|
|
80035e6: e12b b.n 8003840 <HAL_RCC_OscConfig+0x644>
|
|
while (__HAL_RCC_GET_FLAG(RCC_FLAG_LSERDY) == RESET)
|
|
80035e8: 4b0a ldr r3, [pc, #40] @ (8003614 <HAL_RCC_OscConfig+0x418>)
|
|
80035ea: 6f1b ldr r3, [r3, #112] @ 0x70
|
|
80035ec: f003 0302 and.w r3, r3, #2
|
|
80035f0: 2b00 cmp r3, #0
|
|
80035f2: d0ee beq.n 80035d2 <HAL_RCC_OscConfig+0x3d6>
|
|
80035f4: e01c b.n 8003630 <HAL_RCC_OscConfig+0x434>
|
|
}
|
|
}
|
|
else
|
|
{
|
|
/* Get Start Tick */
|
|
tickstart = HAL_GetTick();
|
|
80035f6: f7fd ff1f bl 8001438 <HAL_GetTick>
|
|
80035fa: 6138 str r0, [r7, #16]
|
|
|
|
/* Wait till LSE is ready */
|
|
while (__HAL_RCC_GET_FLAG(RCC_FLAG_LSERDY) != RESET)
|
|
80035fc: e012 b.n 8003624 <HAL_RCC_OscConfig+0x428>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > RCC_LSE_TIMEOUT_VALUE)
|
|
80035fe: f7fd ff1b bl 8001438 <HAL_GetTick>
|
|
8003602: 4602 mov r2, r0
|
|
8003604: 693b ldr r3, [r7, #16]
|
|
8003606: 1ad3 subs r3, r2, r3
|
|
8003608: f241 3288 movw r2, #5000 @ 0x1388
|
|
800360c: 4293 cmp r3, r2
|
|
800360e: d909 bls.n 8003624 <HAL_RCC_OscConfig+0x428>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
8003610: 2303 movs r3, #3
|
|
8003612: e115 b.n 8003840 <HAL_RCC_OscConfig+0x644>
|
|
8003614: 40023800 .word 0x40023800
|
|
8003618: 42470e80 .word 0x42470e80
|
|
800361c: 0800a1a4 .word 0x0800a1a4
|
|
8003620: 40007000 .word 0x40007000
|
|
while (__HAL_RCC_GET_FLAG(RCC_FLAG_LSERDY) != RESET)
|
|
8003624: 4b88 ldr r3, [pc, #544] @ (8003848 <HAL_RCC_OscConfig+0x64c>)
|
|
8003626: 6f1b ldr r3, [r3, #112] @ 0x70
|
|
8003628: f003 0302 and.w r3, r3, #2
|
|
800362c: 2b00 cmp r3, #0
|
|
800362e: d1e6 bne.n 80035fe <HAL_RCC_OscConfig+0x402>
|
|
}
|
|
}
|
|
}
|
|
|
|
/* Restore clock configuration if changed */
|
|
if (pwrclkchanged == SET)
|
|
8003630: 7dfb ldrb r3, [r7, #23]
|
|
8003632: 2b01 cmp r3, #1
|
|
8003634: d105 bne.n 8003642 <HAL_RCC_OscConfig+0x446>
|
|
{
|
|
__HAL_RCC_PWR_CLK_DISABLE();
|
|
8003636: 4b84 ldr r3, [pc, #528] @ (8003848 <HAL_RCC_OscConfig+0x64c>)
|
|
8003638: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
800363a: 4a83 ldr r2, [pc, #524] @ (8003848 <HAL_RCC_OscConfig+0x64c>)
|
|
800363c: f023 5380 bic.w r3, r3, #268435456 @ 0x10000000
|
|
8003640: 6413 str r3, [r2, #64] @ 0x40
|
|
}
|
|
}
|
|
/*-------------------------------- PLL Configuration -----------------------*/
|
|
/* Check the parameters */
|
|
assert_param(IS_RCC_PLL(RCC_OscInitStruct->PLL.PLLState));
|
|
8003642: 687b ldr r3, [r7, #4]
|
|
8003644: 699b ldr r3, [r3, #24]
|
|
8003646: 2b00 cmp r3, #0
|
|
8003648: d00c beq.n 8003664 <HAL_RCC_OscConfig+0x468>
|
|
800364a: 687b ldr r3, [r7, #4]
|
|
800364c: 699b ldr r3, [r3, #24]
|
|
800364e: 2b01 cmp r3, #1
|
|
8003650: d008 beq.n 8003664 <HAL_RCC_OscConfig+0x468>
|
|
8003652: 687b ldr r3, [r7, #4]
|
|
8003654: 699b ldr r3, [r3, #24]
|
|
8003656: 2b02 cmp r3, #2
|
|
8003658: d004 beq.n 8003664 <HAL_RCC_OscConfig+0x468>
|
|
800365a: f240 11cd movw r1, #461 @ 0x1cd
|
|
800365e: 487b ldr r0, [pc, #492] @ (800384c <HAL_RCC_OscConfig+0x650>)
|
|
8003660: f7fd fb68 bl 8000d34 <assert_failed>
|
|
if ((RCC_OscInitStruct->PLL.PLLState) != RCC_PLL_NONE)
|
|
8003664: 687b ldr r3, [r7, #4]
|
|
8003666: 699b ldr r3, [r3, #24]
|
|
8003668: 2b00 cmp r3, #0
|
|
800366a: f000 80e8 beq.w 800383e <HAL_RCC_OscConfig+0x642>
|
|
{
|
|
/* Check if the PLL is used as system clock or not */
|
|
if (__HAL_RCC_GET_SYSCLK_SOURCE() != RCC_CFGR_SWS_PLL)
|
|
800366e: 4b76 ldr r3, [pc, #472] @ (8003848 <HAL_RCC_OscConfig+0x64c>)
|
|
8003670: 689b ldr r3, [r3, #8]
|
|
8003672: f003 030c and.w r3, r3, #12
|
|
8003676: 2b08 cmp r3, #8
|
|
8003678: f000 80a9 beq.w 80037ce <HAL_RCC_OscConfig+0x5d2>
|
|
{
|
|
if ((RCC_OscInitStruct->PLL.PLLState) == RCC_PLL_ON)
|
|
800367c: 687b ldr r3, [r7, #4]
|
|
800367e: 699b ldr r3, [r3, #24]
|
|
8003680: 2b02 cmp r3, #2
|
|
8003682: f040 808d bne.w 80037a0 <HAL_RCC_OscConfig+0x5a4>
|
|
{
|
|
/* Check the parameters */
|
|
assert_param(IS_RCC_PLLSOURCE(RCC_OscInitStruct->PLL.PLLSource));
|
|
8003686: 687b ldr r3, [r7, #4]
|
|
8003688: 69db ldr r3, [r3, #28]
|
|
800368a: 2b00 cmp r3, #0
|
|
800368c: d009 beq.n 80036a2 <HAL_RCC_OscConfig+0x4a6>
|
|
800368e: 687b ldr r3, [r7, #4]
|
|
8003690: 69db ldr r3, [r3, #28]
|
|
8003692: f5b3 0f80 cmp.w r3, #4194304 @ 0x400000
|
|
8003696: d004 beq.n 80036a2 <HAL_RCC_OscConfig+0x4a6>
|
|
8003698: f44f 71eb mov.w r1, #470 @ 0x1d6
|
|
800369c: 486b ldr r0, [pc, #428] @ (800384c <HAL_RCC_OscConfig+0x650>)
|
|
800369e: f7fd fb49 bl 8000d34 <assert_failed>
|
|
assert_param(IS_RCC_PLLM_VALUE(RCC_OscInitStruct->PLL.PLLM));
|
|
80036a2: 687b ldr r3, [r7, #4]
|
|
80036a4: 6a1b ldr r3, [r3, #32]
|
|
80036a6: 2b01 cmp r3, #1
|
|
80036a8: d903 bls.n 80036b2 <HAL_RCC_OscConfig+0x4b6>
|
|
80036aa: 687b ldr r3, [r7, #4]
|
|
80036ac: 6a1b ldr r3, [r3, #32]
|
|
80036ae: 2b3f cmp r3, #63 @ 0x3f
|
|
80036b0: d904 bls.n 80036bc <HAL_RCC_OscConfig+0x4c0>
|
|
80036b2: f240 11d7 movw r1, #471 @ 0x1d7
|
|
80036b6: 4865 ldr r0, [pc, #404] @ (800384c <HAL_RCC_OscConfig+0x650>)
|
|
80036b8: f7fd fb3c bl 8000d34 <assert_failed>
|
|
assert_param(IS_RCC_PLLN_VALUE(RCC_OscInitStruct->PLL.PLLN));
|
|
80036bc: 687b ldr r3, [r7, #4]
|
|
80036be: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
80036c0: 2b31 cmp r3, #49 @ 0x31
|
|
80036c2: d904 bls.n 80036ce <HAL_RCC_OscConfig+0x4d2>
|
|
80036c4: 687b ldr r3, [r7, #4]
|
|
80036c6: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
80036c8: f5b3 7fd8 cmp.w r3, #432 @ 0x1b0
|
|
80036cc: d904 bls.n 80036d8 <HAL_RCC_OscConfig+0x4dc>
|
|
80036ce: f44f 71ec mov.w r1, #472 @ 0x1d8
|
|
80036d2: 485e ldr r0, [pc, #376] @ (800384c <HAL_RCC_OscConfig+0x650>)
|
|
80036d4: f7fd fb2e bl 8000d34 <assert_failed>
|
|
assert_param(IS_RCC_PLLP_VALUE(RCC_OscInitStruct->PLL.PLLP));
|
|
80036d8: 687b ldr r3, [r7, #4]
|
|
80036da: 6a9b ldr r3, [r3, #40] @ 0x28
|
|
80036dc: 2b02 cmp r3, #2
|
|
80036de: d010 beq.n 8003702 <HAL_RCC_OscConfig+0x506>
|
|
80036e0: 687b ldr r3, [r7, #4]
|
|
80036e2: 6a9b ldr r3, [r3, #40] @ 0x28
|
|
80036e4: 2b04 cmp r3, #4
|
|
80036e6: d00c beq.n 8003702 <HAL_RCC_OscConfig+0x506>
|
|
80036e8: 687b ldr r3, [r7, #4]
|
|
80036ea: 6a9b ldr r3, [r3, #40] @ 0x28
|
|
80036ec: 2b06 cmp r3, #6
|
|
80036ee: d008 beq.n 8003702 <HAL_RCC_OscConfig+0x506>
|
|
80036f0: 687b ldr r3, [r7, #4]
|
|
80036f2: 6a9b ldr r3, [r3, #40] @ 0x28
|
|
80036f4: 2b08 cmp r3, #8
|
|
80036f6: d004 beq.n 8003702 <HAL_RCC_OscConfig+0x506>
|
|
80036f8: f240 11d9 movw r1, #473 @ 0x1d9
|
|
80036fc: 4853 ldr r0, [pc, #332] @ (800384c <HAL_RCC_OscConfig+0x650>)
|
|
80036fe: f7fd fb19 bl 8000d34 <assert_failed>
|
|
assert_param(IS_RCC_PLLQ_VALUE(RCC_OscInitStruct->PLL.PLLQ));
|
|
8003702: 687b ldr r3, [r7, #4]
|
|
8003704: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
8003706: 2b01 cmp r3, #1
|
|
8003708: d903 bls.n 8003712 <HAL_RCC_OscConfig+0x516>
|
|
800370a: 687b ldr r3, [r7, #4]
|
|
800370c: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
800370e: 2b0f cmp r3, #15
|
|
8003710: d904 bls.n 800371c <HAL_RCC_OscConfig+0x520>
|
|
8003712: f44f 71ed mov.w r1, #474 @ 0x1da
|
|
8003716: 484d ldr r0, [pc, #308] @ (800384c <HAL_RCC_OscConfig+0x650>)
|
|
8003718: f7fd fb0c bl 8000d34 <assert_failed>
|
|
|
|
/* Disable the main PLL. */
|
|
__HAL_RCC_PLL_DISABLE();
|
|
800371c: 4b4c ldr r3, [pc, #304] @ (8003850 <HAL_RCC_OscConfig+0x654>)
|
|
800371e: 2200 movs r2, #0
|
|
8003720: 601a str r2, [r3, #0]
|
|
|
|
/* Get Start Tick */
|
|
tickstart = HAL_GetTick();
|
|
8003722: f7fd fe89 bl 8001438 <HAL_GetTick>
|
|
8003726: 6138 str r0, [r7, #16]
|
|
|
|
/* Wait till PLL is disabled */
|
|
while (__HAL_RCC_GET_FLAG(RCC_FLAG_PLLRDY) != RESET)
|
|
8003728: e008 b.n 800373c <HAL_RCC_OscConfig+0x540>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > PLL_TIMEOUT_VALUE)
|
|
800372a: f7fd fe85 bl 8001438 <HAL_GetTick>
|
|
800372e: 4602 mov r2, r0
|
|
8003730: 693b ldr r3, [r7, #16]
|
|
8003732: 1ad3 subs r3, r2, r3
|
|
8003734: 2b02 cmp r3, #2
|
|
8003736: d901 bls.n 800373c <HAL_RCC_OscConfig+0x540>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
8003738: 2303 movs r3, #3
|
|
800373a: e081 b.n 8003840 <HAL_RCC_OscConfig+0x644>
|
|
while (__HAL_RCC_GET_FLAG(RCC_FLAG_PLLRDY) != RESET)
|
|
800373c: 4b42 ldr r3, [pc, #264] @ (8003848 <HAL_RCC_OscConfig+0x64c>)
|
|
800373e: 681b ldr r3, [r3, #0]
|
|
8003740: f003 7300 and.w r3, r3, #33554432 @ 0x2000000
|
|
8003744: 2b00 cmp r3, #0
|
|
8003746: d1f0 bne.n 800372a <HAL_RCC_OscConfig+0x52e>
|
|
}
|
|
}
|
|
|
|
/* Configure the main PLL clock source, multiplication and division factors. */
|
|
WRITE_REG(RCC->PLLCFGR, (RCC_OscInitStruct->PLL.PLLSource | \
|
|
8003748: 687b ldr r3, [r7, #4]
|
|
800374a: 69da ldr r2, [r3, #28]
|
|
800374c: 687b ldr r3, [r7, #4]
|
|
800374e: 6a1b ldr r3, [r3, #32]
|
|
8003750: 431a orrs r2, r3
|
|
8003752: 687b ldr r3, [r7, #4]
|
|
8003754: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
8003756: 019b lsls r3, r3, #6
|
|
8003758: 431a orrs r2, r3
|
|
800375a: 687b ldr r3, [r7, #4]
|
|
800375c: 6a9b ldr r3, [r3, #40] @ 0x28
|
|
800375e: 085b lsrs r3, r3, #1
|
|
8003760: 3b01 subs r3, #1
|
|
8003762: 041b lsls r3, r3, #16
|
|
8003764: 431a orrs r2, r3
|
|
8003766: 687b ldr r3, [r7, #4]
|
|
8003768: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
800376a: 061b lsls r3, r3, #24
|
|
800376c: 4936 ldr r1, [pc, #216] @ (8003848 <HAL_RCC_OscConfig+0x64c>)
|
|
800376e: 4313 orrs r3, r2
|
|
8003770: 604b str r3, [r1, #4]
|
|
RCC_OscInitStruct->PLL.PLLM | \
|
|
(RCC_OscInitStruct->PLL.PLLN << RCC_PLLCFGR_PLLN_Pos) | \
|
|
(((RCC_OscInitStruct->PLL.PLLP >> 1U) - 1U) << RCC_PLLCFGR_PLLP_Pos) | \
|
|
(RCC_OscInitStruct->PLL.PLLQ << RCC_PLLCFGR_PLLQ_Pos)));
|
|
/* Enable the main PLL. */
|
|
__HAL_RCC_PLL_ENABLE();
|
|
8003772: 4b37 ldr r3, [pc, #220] @ (8003850 <HAL_RCC_OscConfig+0x654>)
|
|
8003774: 2201 movs r2, #1
|
|
8003776: 601a str r2, [r3, #0]
|
|
|
|
/* Get Start Tick */
|
|
tickstart = HAL_GetTick();
|
|
8003778: f7fd fe5e bl 8001438 <HAL_GetTick>
|
|
800377c: 6138 str r0, [r7, #16]
|
|
|
|
/* Wait till PLL is ready */
|
|
while (__HAL_RCC_GET_FLAG(RCC_FLAG_PLLRDY) == RESET)
|
|
800377e: e008 b.n 8003792 <HAL_RCC_OscConfig+0x596>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > PLL_TIMEOUT_VALUE)
|
|
8003780: f7fd fe5a bl 8001438 <HAL_GetTick>
|
|
8003784: 4602 mov r2, r0
|
|
8003786: 693b ldr r3, [r7, #16]
|
|
8003788: 1ad3 subs r3, r2, r3
|
|
800378a: 2b02 cmp r3, #2
|
|
800378c: d901 bls.n 8003792 <HAL_RCC_OscConfig+0x596>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
800378e: 2303 movs r3, #3
|
|
8003790: e056 b.n 8003840 <HAL_RCC_OscConfig+0x644>
|
|
while (__HAL_RCC_GET_FLAG(RCC_FLAG_PLLRDY) == RESET)
|
|
8003792: 4b2d ldr r3, [pc, #180] @ (8003848 <HAL_RCC_OscConfig+0x64c>)
|
|
8003794: 681b ldr r3, [r3, #0]
|
|
8003796: f003 7300 and.w r3, r3, #33554432 @ 0x2000000
|
|
800379a: 2b00 cmp r3, #0
|
|
800379c: d0f0 beq.n 8003780 <HAL_RCC_OscConfig+0x584>
|
|
800379e: e04e b.n 800383e <HAL_RCC_OscConfig+0x642>
|
|
}
|
|
}
|
|
else
|
|
{
|
|
/* Disable the main PLL. */
|
|
__HAL_RCC_PLL_DISABLE();
|
|
80037a0: 4b2b ldr r3, [pc, #172] @ (8003850 <HAL_RCC_OscConfig+0x654>)
|
|
80037a2: 2200 movs r2, #0
|
|
80037a4: 601a str r2, [r3, #0]
|
|
|
|
/* Get Start Tick */
|
|
tickstart = HAL_GetTick();
|
|
80037a6: f7fd fe47 bl 8001438 <HAL_GetTick>
|
|
80037aa: 6138 str r0, [r7, #16]
|
|
|
|
/* Wait till PLL is disabled */
|
|
while (__HAL_RCC_GET_FLAG(RCC_FLAG_PLLRDY) != RESET)
|
|
80037ac: e008 b.n 80037c0 <HAL_RCC_OscConfig+0x5c4>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > PLL_TIMEOUT_VALUE)
|
|
80037ae: f7fd fe43 bl 8001438 <HAL_GetTick>
|
|
80037b2: 4602 mov r2, r0
|
|
80037b4: 693b ldr r3, [r7, #16]
|
|
80037b6: 1ad3 subs r3, r2, r3
|
|
80037b8: 2b02 cmp r3, #2
|
|
80037ba: d901 bls.n 80037c0 <HAL_RCC_OscConfig+0x5c4>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
80037bc: 2303 movs r3, #3
|
|
80037be: e03f b.n 8003840 <HAL_RCC_OscConfig+0x644>
|
|
while (__HAL_RCC_GET_FLAG(RCC_FLAG_PLLRDY) != RESET)
|
|
80037c0: 4b21 ldr r3, [pc, #132] @ (8003848 <HAL_RCC_OscConfig+0x64c>)
|
|
80037c2: 681b ldr r3, [r3, #0]
|
|
80037c4: f003 7300 and.w r3, r3, #33554432 @ 0x2000000
|
|
80037c8: 2b00 cmp r3, #0
|
|
80037ca: d1f0 bne.n 80037ae <HAL_RCC_OscConfig+0x5b2>
|
|
80037cc: e037 b.n 800383e <HAL_RCC_OscConfig+0x642>
|
|
}
|
|
}
|
|
else
|
|
{
|
|
/* Check if there is a request to disable the PLL used as System clock source */
|
|
if ((RCC_OscInitStruct->PLL.PLLState) == RCC_PLL_OFF)
|
|
80037ce: 687b ldr r3, [r7, #4]
|
|
80037d0: 699b ldr r3, [r3, #24]
|
|
80037d2: 2b01 cmp r3, #1
|
|
80037d4: d101 bne.n 80037da <HAL_RCC_OscConfig+0x5de>
|
|
{
|
|
return HAL_ERROR;
|
|
80037d6: 2301 movs r3, #1
|
|
80037d8: e032 b.n 8003840 <HAL_RCC_OscConfig+0x644>
|
|
}
|
|
else
|
|
{
|
|
/* Do not return HAL_ERROR if request repeats the current configuration */
|
|
pll_config = RCC->PLLCFGR;
|
|
80037da: 4b1b ldr r3, [pc, #108] @ (8003848 <HAL_RCC_OscConfig+0x64c>)
|
|
80037dc: 685b ldr r3, [r3, #4]
|
|
80037de: 60fb str r3, [r7, #12]
|
|
(READ_BIT(pll_config, RCC_PLLCFGR_PLLN) != (RCC_OscInitStruct->PLL.PLLN) << RCC_PLLCFGR_PLLN_Pos) ||
|
|
(READ_BIT(pll_config, RCC_PLLCFGR_PLLP) != (((RCC_OscInitStruct->PLL.PLLP >> 1U) - 1U)) << RCC_PLLCFGR_PLLP_Pos) ||
|
|
(READ_BIT(pll_config, RCC_PLLCFGR_PLLQ) != (RCC_OscInitStruct->PLL.PLLQ << RCC_PLLCFGR_PLLQ_Pos)) ||
|
|
(READ_BIT(pll_config, RCC_PLLCFGR_PLLR) != (RCC_OscInitStruct->PLL.PLLR << RCC_PLLCFGR_PLLR_Pos)))
|
|
#else
|
|
if (((RCC_OscInitStruct->PLL.PLLState) == RCC_PLL_OFF) ||
|
|
80037e0: 687b ldr r3, [r7, #4]
|
|
80037e2: 699b ldr r3, [r3, #24]
|
|
80037e4: 2b01 cmp r3, #1
|
|
80037e6: d028 beq.n 800383a <HAL_RCC_OscConfig+0x63e>
|
|
(READ_BIT(pll_config, RCC_PLLCFGR_PLLSRC) != RCC_OscInitStruct->PLL.PLLSource) ||
|
|
80037e8: 68fb ldr r3, [r7, #12]
|
|
80037ea: f403 0280 and.w r2, r3, #4194304 @ 0x400000
|
|
80037ee: 687b ldr r3, [r7, #4]
|
|
80037f0: 69db ldr r3, [r3, #28]
|
|
if (((RCC_OscInitStruct->PLL.PLLState) == RCC_PLL_OFF) ||
|
|
80037f2: 429a cmp r2, r3
|
|
80037f4: d121 bne.n 800383a <HAL_RCC_OscConfig+0x63e>
|
|
(READ_BIT(pll_config, RCC_PLLCFGR_PLLM) != (RCC_OscInitStruct->PLL.PLLM) << RCC_PLLCFGR_PLLM_Pos) ||
|
|
80037f6: 68fb ldr r3, [r7, #12]
|
|
80037f8: f003 023f and.w r2, r3, #63 @ 0x3f
|
|
80037fc: 687b ldr r3, [r7, #4]
|
|
80037fe: 6a1b ldr r3, [r3, #32]
|
|
(READ_BIT(pll_config, RCC_PLLCFGR_PLLSRC) != RCC_OscInitStruct->PLL.PLLSource) ||
|
|
8003800: 429a cmp r2, r3
|
|
8003802: d11a bne.n 800383a <HAL_RCC_OscConfig+0x63e>
|
|
(READ_BIT(pll_config, RCC_PLLCFGR_PLLN) != (RCC_OscInitStruct->PLL.PLLN) << RCC_PLLCFGR_PLLN_Pos) ||
|
|
8003804: 68fa ldr r2, [r7, #12]
|
|
8003806: f647 73c0 movw r3, #32704 @ 0x7fc0
|
|
800380a: 4013 ands r3, r2
|
|
800380c: 687a ldr r2, [r7, #4]
|
|
800380e: 6a52 ldr r2, [r2, #36] @ 0x24
|
|
8003810: 0192 lsls r2, r2, #6
|
|
(READ_BIT(pll_config, RCC_PLLCFGR_PLLM) != (RCC_OscInitStruct->PLL.PLLM) << RCC_PLLCFGR_PLLM_Pos) ||
|
|
8003812: 4293 cmp r3, r2
|
|
8003814: d111 bne.n 800383a <HAL_RCC_OscConfig+0x63e>
|
|
(READ_BIT(pll_config, RCC_PLLCFGR_PLLP) != (((RCC_OscInitStruct->PLL.PLLP >> 1U) - 1U)) << RCC_PLLCFGR_PLLP_Pos) ||
|
|
8003816: 68fb ldr r3, [r7, #12]
|
|
8003818: f403 3240 and.w r2, r3, #196608 @ 0x30000
|
|
800381c: 687b ldr r3, [r7, #4]
|
|
800381e: 6a9b ldr r3, [r3, #40] @ 0x28
|
|
8003820: 085b lsrs r3, r3, #1
|
|
8003822: 3b01 subs r3, #1
|
|
8003824: 041b lsls r3, r3, #16
|
|
(READ_BIT(pll_config, RCC_PLLCFGR_PLLN) != (RCC_OscInitStruct->PLL.PLLN) << RCC_PLLCFGR_PLLN_Pos) ||
|
|
8003826: 429a cmp r2, r3
|
|
8003828: d107 bne.n 800383a <HAL_RCC_OscConfig+0x63e>
|
|
(READ_BIT(pll_config, RCC_PLLCFGR_PLLQ) != (RCC_OscInitStruct->PLL.PLLQ << RCC_PLLCFGR_PLLQ_Pos)))
|
|
800382a: 68fb ldr r3, [r7, #12]
|
|
800382c: f003 6270 and.w r2, r3, #251658240 @ 0xf000000
|
|
8003830: 687b ldr r3, [r7, #4]
|
|
8003832: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
8003834: 061b lsls r3, r3, #24
|
|
(READ_BIT(pll_config, RCC_PLLCFGR_PLLP) != (((RCC_OscInitStruct->PLL.PLLP >> 1U) - 1U)) << RCC_PLLCFGR_PLLP_Pos) ||
|
|
8003836: 429a cmp r2, r3
|
|
8003838: d001 beq.n 800383e <HAL_RCC_OscConfig+0x642>
|
|
#endif /* RCC_PLLCFGR_PLLR */
|
|
{
|
|
return HAL_ERROR;
|
|
800383a: 2301 movs r3, #1
|
|
800383c: e000 b.n 8003840 <HAL_RCC_OscConfig+0x644>
|
|
}
|
|
}
|
|
}
|
|
}
|
|
return HAL_OK;
|
|
800383e: 2300 movs r3, #0
|
|
}
|
|
8003840: 4618 mov r0, r3
|
|
8003842: 3718 adds r7, #24
|
|
8003844: 46bd mov sp, r7
|
|
8003846: bd80 pop {r7, pc}
|
|
8003848: 40023800 .word 0x40023800
|
|
800384c: 0800a1a4 .word 0x0800a1a4
|
|
8003850: 42470060 .word 0x42470060
|
|
|
|
08003854 <HAL_RCC_ClockConfig>:
|
|
* HPRE[3:0] bits to ensure that HCLK not exceed the maximum allowed frequency
|
|
* (for more details refer to section above "Initialization/de-initialization functions")
|
|
* @retval None
|
|
*/
|
|
HAL_StatusTypeDef HAL_RCC_ClockConfig(const RCC_ClkInitTypeDef *RCC_ClkInitStruct, uint32_t FLatency)
|
|
{
|
|
8003854: b580 push {r7, lr}
|
|
8003856: b084 sub sp, #16
|
|
8003858: af00 add r7, sp, #0
|
|
800385a: 6078 str r0, [r7, #4]
|
|
800385c: 6039 str r1, [r7, #0]
|
|
uint32_t tickstart;
|
|
|
|
/* Check Null pointer */
|
|
if (RCC_ClkInitStruct == NULL)
|
|
800385e: 687b ldr r3, [r7, #4]
|
|
8003860: 2b00 cmp r3, #0
|
|
8003862: d101 bne.n 8003868 <HAL_RCC_ClockConfig+0x14>
|
|
{
|
|
return HAL_ERROR;
|
|
8003864: 2301 movs r3, #1
|
|
8003866: e174 b.n 8003b52 <HAL_RCC_ClockConfig+0x2fe>
|
|
}
|
|
|
|
/* Check the parameters */
|
|
assert_param(IS_RCC_CLOCKTYPE(RCC_ClkInitStruct->ClockType));
|
|
8003868: 687b ldr r3, [r7, #4]
|
|
800386a: 681b ldr r3, [r3, #0]
|
|
800386c: 2b00 cmp r3, #0
|
|
800386e: d003 beq.n 8003878 <HAL_RCC_ClockConfig+0x24>
|
|
8003870: 687b ldr r3, [r7, #4]
|
|
8003872: 681b ldr r3, [r3, #0]
|
|
8003874: 2b0f cmp r3, #15
|
|
8003876: d904 bls.n 8003882 <HAL_RCC_ClockConfig+0x2e>
|
|
8003878: f240 215a movw r1, #602 @ 0x25a
|
|
800387c: 487b ldr r0, [pc, #492] @ (8003a6c <HAL_RCC_ClockConfig+0x218>)
|
|
800387e: f7fd fa59 bl 8000d34 <assert_failed>
|
|
assert_param(IS_FLASH_LATENCY(FLatency));
|
|
8003882: 683b ldr r3, [r7, #0]
|
|
8003884: 2b00 cmp r3, #0
|
|
8003886: d019 beq.n 80038bc <HAL_RCC_ClockConfig+0x68>
|
|
8003888: 683b ldr r3, [r7, #0]
|
|
800388a: 2b01 cmp r3, #1
|
|
800388c: d016 beq.n 80038bc <HAL_RCC_ClockConfig+0x68>
|
|
800388e: 683b ldr r3, [r7, #0]
|
|
8003890: 2b02 cmp r3, #2
|
|
8003892: d013 beq.n 80038bc <HAL_RCC_ClockConfig+0x68>
|
|
8003894: 683b ldr r3, [r7, #0]
|
|
8003896: 2b03 cmp r3, #3
|
|
8003898: d010 beq.n 80038bc <HAL_RCC_ClockConfig+0x68>
|
|
800389a: 683b ldr r3, [r7, #0]
|
|
800389c: 2b04 cmp r3, #4
|
|
800389e: d00d beq.n 80038bc <HAL_RCC_ClockConfig+0x68>
|
|
80038a0: 683b ldr r3, [r7, #0]
|
|
80038a2: 2b05 cmp r3, #5
|
|
80038a4: d00a beq.n 80038bc <HAL_RCC_ClockConfig+0x68>
|
|
80038a6: 683b ldr r3, [r7, #0]
|
|
80038a8: 2b06 cmp r3, #6
|
|
80038aa: d007 beq.n 80038bc <HAL_RCC_ClockConfig+0x68>
|
|
80038ac: 683b ldr r3, [r7, #0]
|
|
80038ae: 2b07 cmp r3, #7
|
|
80038b0: d004 beq.n 80038bc <HAL_RCC_ClockConfig+0x68>
|
|
80038b2: f240 215b movw r1, #603 @ 0x25b
|
|
80038b6: 486d ldr r0, [pc, #436] @ (8003a6c <HAL_RCC_ClockConfig+0x218>)
|
|
80038b8: f7fd fa3c bl 8000d34 <assert_failed>
|
|
/* To correctly read data from FLASH memory, the number of wait states (LATENCY)
|
|
must be correctly programmed according to the frequency of the CPU clock
|
|
(HCLK) and the supply voltage of the device. */
|
|
|
|
/* Increasing the number of wait states because of higher CPU frequency */
|
|
if (FLatency > __HAL_FLASH_GET_LATENCY())
|
|
80038bc: 4b6c ldr r3, [pc, #432] @ (8003a70 <HAL_RCC_ClockConfig+0x21c>)
|
|
80038be: 681b ldr r3, [r3, #0]
|
|
80038c0: f003 0307 and.w r3, r3, #7
|
|
80038c4: 683a ldr r2, [r7, #0]
|
|
80038c6: 429a cmp r2, r3
|
|
80038c8: d90c bls.n 80038e4 <HAL_RCC_ClockConfig+0x90>
|
|
{
|
|
/* Program the new number of wait states to the LATENCY bits in the FLASH_ACR register */
|
|
__HAL_FLASH_SET_LATENCY(FLatency);
|
|
80038ca: 4b69 ldr r3, [pc, #420] @ (8003a70 <HAL_RCC_ClockConfig+0x21c>)
|
|
80038cc: 683a ldr r2, [r7, #0]
|
|
80038ce: b2d2 uxtb r2, r2
|
|
80038d0: 701a strb r2, [r3, #0]
|
|
|
|
/* Check that the new number of wait states is taken into account to access the Flash
|
|
memory by reading the FLASH_ACR register */
|
|
if (__HAL_FLASH_GET_LATENCY() != FLatency)
|
|
80038d2: 4b67 ldr r3, [pc, #412] @ (8003a70 <HAL_RCC_ClockConfig+0x21c>)
|
|
80038d4: 681b ldr r3, [r3, #0]
|
|
80038d6: f003 0307 and.w r3, r3, #7
|
|
80038da: 683a ldr r2, [r7, #0]
|
|
80038dc: 429a cmp r2, r3
|
|
80038de: d001 beq.n 80038e4 <HAL_RCC_ClockConfig+0x90>
|
|
{
|
|
return HAL_ERROR;
|
|
80038e0: 2301 movs r3, #1
|
|
80038e2: e136 b.n 8003b52 <HAL_RCC_ClockConfig+0x2fe>
|
|
}
|
|
}
|
|
|
|
/*-------------------------- HCLK Configuration --------------------------*/
|
|
if (((RCC_ClkInitStruct->ClockType) & RCC_CLOCKTYPE_HCLK) == RCC_CLOCKTYPE_HCLK)
|
|
80038e4: 687b ldr r3, [r7, #4]
|
|
80038e6: 681b ldr r3, [r3, #0]
|
|
80038e8: f003 0302 and.w r3, r3, #2
|
|
80038ec: 2b00 cmp r3, #0
|
|
80038ee: d049 beq.n 8003984 <HAL_RCC_ClockConfig+0x130>
|
|
{
|
|
/* Set the highest APBx dividers in order to ensure that we do not go through
|
|
a non-spec phase whatever we decrease or increase HCLK. */
|
|
if (((RCC_ClkInitStruct->ClockType) & RCC_CLOCKTYPE_PCLK1) == RCC_CLOCKTYPE_PCLK1)
|
|
80038f0: 687b ldr r3, [r7, #4]
|
|
80038f2: 681b ldr r3, [r3, #0]
|
|
80038f4: f003 0304 and.w r3, r3, #4
|
|
80038f8: 2b00 cmp r3, #0
|
|
80038fa: d005 beq.n 8003908 <HAL_RCC_ClockConfig+0xb4>
|
|
{
|
|
MODIFY_REG(RCC->CFGR, RCC_CFGR_PPRE1, RCC_HCLK_DIV16);
|
|
80038fc: 4b5d ldr r3, [pc, #372] @ (8003a74 <HAL_RCC_ClockConfig+0x220>)
|
|
80038fe: 689b ldr r3, [r3, #8]
|
|
8003900: 4a5c ldr r2, [pc, #368] @ (8003a74 <HAL_RCC_ClockConfig+0x220>)
|
|
8003902: f443 53e0 orr.w r3, r3, #7168 @ 0x1c00
|
|
8003906: 6093 str r3, [r2, #8]
|
|
}
|
|
|
|
if (((RCC_ClkInitStruct->ClockType) & RCC_CLOCKTYPE_PCLK2) == RCC_CLOCKTYPE_PCLK2)
|
|
8003908: 687b ldr r3, [r7, #4]
|
|
800390a: 681b ldr r3, [r3, #0]
|
|
800390c: f003 0308 and.w r3, r3, #8
|
|
8003910: 2b00 cmp r3, #0
|
|
8003912: d005 beq.n 8003920 <HAL_RCC_ClockConfig+0xcc>
|
|
{
|
|
MODIFY_REG(RCC->CFGR, RCC_CFGR_PPRE2, (RCC_HCLK_DIV16 << 3));
|
|
8003914: 4b57 ldr r3, [pc, #348] @ (8003a74 <HAL_RCC_ClockConfig+0x220>)
|
|
8003916: 689b ldr r3, [r3, #8]
|
|
8003918: 4a56 ldr r2, [pc, #344] @ (8003a74 <HAL_RCC_ClockConfig+0x220>)
|
|
800391a: f443 4360 orr.w r3, r3, #57344 @ 0xe000
|
|
800391e: 6093 str r3, [r2, #8]
|
|
}
|
|
|
|
assert_param(IS_RCC_HCLK(RCC_ClkInitStruct->AHBCLKDivider));
|
|
8003920: 687b ldr r3, [r7, #4]
|
|
8003922: 689b ldr r3, [r3, #8]
|
|
8003924: 2b00 cmp r3, #0
|
|
8003926: d024 beq.n 8003972 <HAL_RCC_ClockConfig+0x11e>
|
|
8003928: 687b ldr r3, [r7, #4]
|
|
800392a: 689b ldr r3, [r3, #8]
|
|
800392c: 2b80 cmp r3, #128 @ 0x80
|
|
800392e: d020 beq.n 8003972 <HAL_RCC_ClockConfig+0x11e>
|
|
8003930: 687b ldr r3, [r7, #4]
|
|
8003932: 689b ldr r3, [r3, #8]
|
|
8003934: 2b90 cmp r3, #144 @ 0x90
|
|
8003936: d01c beq.n 8003972 <HAL_RCC_ClockConfig+0x11e>
|
|
8003938: 687b ldr r3, [r7, #4]
|
|
800393a: 689b ldr r3, [r3, #8]
|
|
800393c: 2ba0 cmp r3, #160 @ 0xa0
|
|
800393e: d018 beq.n 8003972 <HAL_RCC_ClockConfig+0x11e>
|
|
8003940: 687b ldr r3, [r7, #4]
|
|
8003942: 689b ldr r3, [r3, #8]
|
|
8003944: 2bb0 cmp r3, #176 @ 0xb0
|
|
8003946: d014 beq.n 8003972 <HAL_RCC_ClockConfig+0x11e>
|
|
8003948: 687b ldr r3, [r7, #4]
|
|
800394a: 689b ldr r3, [r3, #8]
|
|
800394c: 2bc0 cmp r3, #192 @ 0xc0
|
|
800394e: d010 beq.n 8003972 <HAL_RCC_ClockConfig+0x11e>
|
|
8003950: 687b ldr r3, [r7, #4]
|
|
8003952: 689b ldr r3, [r3, #8]
|
|
8003954: 2bd0 cmp r3, #208 @ 0xd0
|
|
8003956: d00c beq.n 8003972 <HAL_RCC_ClockConfig+0x11e>
|
|
8003958: 687b ldr r3, [r7, #4]
|
|
800395a: 689b ldr r3, [r3, #8]
|
|
800395c: 2be0 cmp r3, #224 @ 0xe0
|
|
800395e: d008 beq.n 8003972 <HAL_RCC_ClockConfig+0x11e>
|
|
8003960: 687b ldr r3, [r7, #4]
|
|
8003962: 689b ldr r3, [r3, #8]
|
|
8003964: 2bf0 cmp r3, #240 @ 0xf0
|
|
8003966: d004 beq.n 8003972 <HAL_RCC_ClockConfig+0x11e>
|
|
8003968: f240 217e movw r1, #638 @ 0x27e
|
|
800396c: 483f ldr r0, [pc, #252] @ (8003a6c <HAL_RCC_ClockConfig+0x218>)
|
|
800396e: f7fd f9e1 bl 8000d34 <assert_failed>
|
|
MODIFY_REG(RCC->CFGR, RCC_CFGR_HPRE, RCC_ClkInitStruct->AHBCLKDivider);
|
|
8003972: 4b40 ldr r3, [pc, #256] @ (8003a74 <HAL_RCC_ClockConfig+0x220>)
|
|
8003974: 689b ldr r3, [r3, #8]
|
|
8003976: f023 02f0 bic.w r2, r3, #240 @ 0xf0
|
|
800397a: 687b ldr r3, [r7, #4]
|
|
800397c: 689b ldr r3, [r3, #8]
|
|
800397e: 493d ldr r1, [pc, #244] @ (8003a74 <HAL_RCC_ClockConfig+0x220>)
|
|
8003980: 4313 orrs r3, r2
|
|
8003982: 608b str r3, [r1, #8]
|
|
}
|
|
|
|
/*------------------------- SYSCLK Configuration ---------------------------*/
|
|
if (((RCC_ClkInitStruct->ClockType) & RCC_CLOCKTYPE_SYSCLK) == RCC_CLOCKTYPE_SYSCLK)
|
|
8003984: 687b ldr r3, [r7, #4]
|
|
8003986: 681b ldr r3, [r3, #0]
|
|
8003988: f003 0301 and.w r3, r3, #1
|
|
800398c: 2b00 cmp r3, #0
|
|
800398e: d059 beq.n 8003a44 <HAL_RCC_ClockConfig+0x1f0>
|
|
{
|
|
assert_param(IS_RCC_SYSCLKSOURCE(RCC_ClkInitStruct->SYSCLKSource));
|
|
8003990: 687b ldr r3, [r7, #4]
|
|
8003992: 685b ldr r3, [r3, #4]
|
|
8003994: 2b00 cmp r3, #0
|
|
8003996: d010 beq.n 80039ba <HAL_RCC_ClockConfig+0x166>
|
|
8003998: 687b ldr r3, [r7, #4]
|
|
800399a: 685b ldr r3, [r3, #4]
|
|
800399c: 2b01 cmp r3, #1
|
|
800399e: d00c beq.n 80039ba <HAL_RCC_ClockConfig+0x166>
|
|
80039a0: 687b ldr r3, [r7, #4]
|
|
80039a2: 685b ldr r3, [r3, #4]
|
|
80039a4: 2b02 cmp r3, #2
|
|
80039a6: d008 beq.n 80039ba <HAL_RCC_ClockConfig+0x166>
|
|
80039a8: 687b ldr r3, [r7, #4]
|
|
80039aa: 685b ldr r3, [r3, #4]
|
|
80039ac: 2b03 cmp r3, #3
|
|
80039ae: d004 beq.n 80039ba <HAL_RCC_ClockConfig+0x166>
|
|
80039b0: f240 2185 movw r1, #645 @ 0x285
|
|
80039b4: 482d ldr r0, [pc, #180] @ (8003a6c <HAL_RCC_ClockConfig+0x218>)
|
|
80039b6: f7fd f9bd bl 8000d34 <assert_failed>
|
|
|
|
/* HSE is selected as System Clock Source */
|
|
if (RCC_ClkInitStruct->SYSCLKSource == RCC_SYSCLKSOURCE_HSE)
|
|
80039ba: 687b ldr r3, [r7, #4]
|
|
80039bc: 685b ldr r3, [r3, #4]
|
|
80039be: 2b01 cmp r3, #1
|
|
80039c0: d107 bne.n 80039d2 <HAL_RCC_ClockConfig+0x17e>
|
|
{
|
|
/* Check the HSE ready flag */
|
|
if (__HAL_RCC_GET_FLAG(RCC_FLAG_HSERDY) == RESET)
|
|
80039c2: 4b2c ldr r3, [pc, #176] @ (8003a74 <HAL_RCC_ClockConfig+0x220>)
|
|
80039c4: 681b ldr r3, [r3, #0]
|
|
80039c6: f403 3300 and.w r3, r3, #131072 @ 0x20000
|
|
80039ca: 2b00 cmp r3, #0
|
|
80039cc: d119 bne.n 8003a02 <HAL_RCC_ClockConfig+0x1ae>
|
|
{
|
|
return HAL_ERROR;
|
|
80039ce: 2301 movs r3, #1
|
|
80039d0: e0bf b.n 8003b52 <HAL_RCC_ClockConfig+0x2fe>
|
|
}
|
|
}
|
|
/* PLL is selected as System Clock Source */
|
|
else if ((RCC_ClkInitStruct->SYSCLKSource == RCC_SYSCLKSOURCE_PLLCLK) ||
|
|
80039d2: 687b ldr r3, [r7, #4]
|
|
80039d4: 685b ldr r3, [r3, #4]
|
|
80039d6: 2b02 cmp r3, #2
|
|
80039d8: d003 beq.n 80039e2 <HAL_RCC_ClockConfig+0x18e>
|
|
(RCC_ClkInitStruct->SYSCLKSource == RCC_SYSCLKSOURCE_PLLRCLK))
|
|
80039da: 687b ldr r3, [r7, #4]
|
|
80039dc: 685b ldr r3, [r3, #4]
|
|
else if ((RCC_ClkInitStruct->SYSCLKSource == RCC_SYSCLKSOURCE_PLLCLK) ||
|
|
80039de: 2b03 cmp r3, #3
|
|
80039e0: d107 bne.n 80039f2 <HAL_RCC_ClockConfig+0x19e>
|
|
{
|
|
/* Check the PLL ready flag */
|
|
if (__HAL_RCC_GET_FLAG(RCC_FLAG_PLLRDY) == RESET)
|
|
80039e2: 4b24 ldr r3, [pc, #144] @ (8003a74 <HAL_RCC_ClockConfig+0x220>)
|
|
80039e4: 681b ldr r3, [r3, #0]
|
|
80039e6: f003 7300 and.w r3, r3, #33554432 @ 0x2000000
|
|
80039ea: 2b00 cmp r3, #0
|
|
80039ec: d109 bne.n 8003a02 <HAL_RCC_ClockConfig+0x1ae>
|
|
{
|
|
return HAL_ERROR;
|
|
80039ee: 2301 movs r3, #1
|
|
80039f0: e0af b.n 8003b52 <HAL_RCC_ClockConfig+0x2fe>
|
|
}
|
|
/* HSI is selected as System Clock Source */
|
|
else
|
|
{
|
|
/* Check the HSI ready flag */
|
|
if (__HAL_RCC_GET_FLAG(RCC_FLAG_HSIRDY) == RESET)
|
|
80039f2: 4b20 ldr r3, [pc, #128] @ (8003a74 <HAL_RCC_ClockConfig+0x220>)
|
|
80039f4: 681b ldr r3, [r3, #0]
|
|
80039f6: f003 0302 and.w r3, r3, #2
|
|
80039fa: 2b00 cmp r3, #0
|
|
80039fc: d101 bne.n 8003a02 <HAL_RCC_ClockConfig+0x1ae>
|
|
{
|
|
return HAL_ERROR;
|
|
80039fe: 2301 movs r3, #1
|
|
8003a00: e0a7 b.n 8003b52 <HAL_RCC_ClockConfig+0x2fe>
|
|
}
|
|
}
|
|
|
|
__HAL_RCC_SYSCLK_CONFIG(RCC_ClkInitStruct->SYSCLKSource);
|
|
8003a02: 4b1c ldr r3, [pc, #112] @ (8003a74 <HAL_RCC_ClockConfig+0x220>)
|
|
8003a04: 689b ldr r3, [r3, #8]
|
|
8003a06: f023 0203 bic.w r2, r3, #3
|
|
8003a0a: 687b ldr r3, [r7, #4]
|
|
8003a0c: 685b ldr r3, [r3, #4]
|
|
8003a0e: 4919 ldr r1, [pc, #100] @ (8003a74 <HAL_RCC_ClockConfig+0x220>)
|
|
8003a10: 4313 orrs r3, r2
|
|
8003a12: 608b str r3, [r1, #8]
|
|
|
|
/* Get Start Tick */
|
|
tickstart = HAL_GetTick();
|
|
8003a14: f7fd fd10 bl 8001438 <HAL_GetTick>
|
|
8003a18: 60f8 str r0, [r7, #12]
|
|
|
|
while (__HAL_RCC_GET_SYSCLK_SOURCE() != (RCC_ClkInitStruct->SYSCLKSource << RCC_CFGR_SWS_Pos))
|
|
8003a1a: e00a b.n 8003a32 <HAL_RCC_ClockConfig+0x1de>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > CLOCKSWITCH_TIMEOUT_VALUE)
|
|
8003a1c: f7fd fd0c bl 8001438 <HAL_GetTick>
|
|
8003a20: 4602 mov r2, r0
|
|
8003a22: 68fb ldr r3, [r7, #12]
|
|
8003a24: 1ad3 subs r3, r2, r3
|
|
8003a26: f241 3288 movw r2, #5000 @ 0x1388
|
|
8003a2a: 4293 cmp r3, r2
|
|
8003a2c: d901 bls.n 8003a32 <HAL_RCC_ClockConfig+0x1de>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
8003a2e: 2303 movs r3, #3
|
|
8003a30: e08f b.n 8003b52 <HAL_RCC_ClockConfig+0x2fe>
|
|
while (__HAL_RCC_GET_SYSCLK_SOURCE() != (RCC_ClkInitStruct->SYSCLKSource << RCC_CFGR_SWS_Pos))
|
|
8003a32: 4b10 ldr r3, [pc, #64] @ (8003a74 <HAL_RCC_ClockConfig+0x220>)
|
|
8003a34: 689b ldr r3, [r3, #8]
|
|
8003a36: f003 020c and.w r2, r3, #12
|
|
8003a3a: 687b ldr r3, [r7, #4]
|
|
8003a3c: 685b ldr r3, [r3, #4]
|
|
8003a3e: 009b lsls r3, r3, #2
|
|
8003a40: 429a cmp r2, r3
|
|
8003a42: d1eb bne.n 8003a1c <HAL_RCC_ClockConfig+0x1c8>
|
|
}
|
|
}
|
|
}
|
|
|
|
/* Decreasing the number of wait states because of lower CPU frequency */
|
|
if (FLatency < __HAL_FLASH_GET_LATENCY())
|
|
8003a44: 4b0a ldr r3, [pc, #40] @ (8003a70 <HAL_RCC_ClockConfig+0x21c>)
|
|
8003a46: 681b ldr r3, [r3, #0]
|
|
8003a48: f003 0307 and.w r3, r3, #7
|
|
8003a4c: 683a ldr r2, [r7, #0]
|
|
8003a4e: 429a cmp r2, r3
|
|
8003a50: d212 bcs.n 8003a78 <HAL_RCC_ClockConfig+0x224>
|
|
{
|
|
/* Program the new number of wait states to the LATENCY bits in the FLASH_ACR register */
|
|
__HAL_FLASH_SET_LATENCY(FLatency);
|
|
8003a52: 4b07 ldr r3, [pc, #28] @ (8003a70 <HAL_RCC_ClockConfig+0x21c>)
|
|
8003a54: 683a ldr r2, [r7, #0]
|
|
8003a56: b2d2 uxtb r2, r2
|
|
8003a58: 701a strb r2, [r3, #0]
|
|
|
|
/* Check that the new number of wait states is taken into account to access the Flash
|
|
memory by reading the FLASH_ACR register */
|
|
if (__HAL_FLASH_GET_LATENCY() != FLatency)
|
|
8003a5a: 4b05 ldr r3, [pc, #20] @ (8003a70 <HAL_RCC_ClockConfig+0x21c>)
|
|
8003a5c: 681b ldr r3, [r3, #0]
|
|
8003a5e: f003 0307 and.w r3, r3, #7
|
|
8003a62: 683a ldr r2, [r7, #0]
|
|
8003a64: 429a cmp r2, r3
|
|
8003a66: d007 beq.n 8003a78 <HAL_RCC_ClockConfig+0x224>
|
|
{
|
|
return HAL_ERROR;
|
|
8003a68: 2301 movs r3, #1
|
|
8003a6a: e072 b.n 8003b52 <HAL_RCC_ClockConfig+0x2fe>
|
|
8003a6c: 0800a1a4 .word 0x0800a1a4
|
|
8003a70: 40023c00 .word 0x40023c00
|
|
8003a74: 40023800 .word 0x40023800
|
|
}
|
|
}
|
|
|
|
/*-------------------------- PCLK1 Configuration ---------------------------*/
|
|
if (((RCC_ClkInitStruct->ClockType) & RCC_CLOCKTYPE_PCLK1) == RCC_CLOCKTYPE_PCLK1)
|
|
8003a78: 687b ldr r3, [r7, #4]
|
|
8003a7a: 681b ldr r3, [r3, #0]
|
|
8003a7c: f003 0304 and.w r3, r3, #4
|
|
8003a80: 2b00 cmp r3, #0
|
|
8003a82: d025 beq.n 8003ad0 <HAL_RCC_ClockConfig+0x27c>
|
|
{
|
|
assert_param(IS_RCC_PCLK(RCC_ClkInitStruct->APB1CLKDivider));
|
|
8003a84: 687b ldr r3, [r7, #4]
|
|
8003a86: 68db ldr r3, [r3, #12]
|
|
8003a88: 2b00 cmp r3, #0
|
|
8003a8a: d018 beq.n 8003abe <HAL_RCC_ClockConfig+0x26a>
|
|
8003a8c: 687b ldr r3, [r7, #4]
|
|
8003a8e: 68db ldr r3, [r3, #12]
|
|
8003a90: f5b3 5f80 cmp.w r3, #4096 @ 0x1000
|
|
8003a94: d013 beq.n 8003abe <HAL_RCC_ClockConfig+0x26a>
|
|
8003a96: 687b ldr r3, [r7, #4]
|
|
8003a98: 68db ldr r3, [r3, #12]
|
|
8003a9a: f5b3 5fa0 cmp.w r3, #5120 @ 0x1400
|
|
8003a9e: d00e beq.n 8003abe <HAL_RCC_ClockConfig+0x26a>
|
|
8003aa0: 687b ldr r3, [r7, #4]
|
|
8003aa2: 68db ldr r3, [r3, #12]
|
|
8003aa4: f5b3 5fc0 cmp.w r3, #6144 @ 0x1800
|
|
8003aa8: d009 beq.n 8003abe <HAL_RCC_ClockConfig+0x26a>
|
|
8003aaa: 687b ldr r3, [r7, #4]
|
|
8003aac: 68db ldr r3, [r3, #12]
|
|
8003aae: f5b3 5fe0 cmp.w r3, #7168 @ 0x1c00
|
|
8003ab2: d004 beq.n 8003abe <HAL_RCC_ClockConfig+0x26a>
|
|
8003ab4: f240 21c3 movw r1, #707 @ 0x2c3
|
|
8003ab8: 4828 ldr r0, [pc, #160] @ (8003b5c <HAL_RCC_ClockConfig+0x308>)
|
|
8003aba: f7fd f93b bl 8000d34 <assert_failed>
|
|
MODIFY_REG(RCC->CFGR, RCC_CFGR_PPRE1, RCC_ClkInitStruct->APB1CLKDivider);
|
|
8003abe: 4b28 ldr r3, [pc, #160] @ (8003b60 <HAL_RCC_ClockConfig+0x30c>)
|
|
8003ac0: 689b ldr r3, [r3, #8]
|
|
8003ac2: f423 52e0 bic.w r2, r3, #7168 @ 0x1c00
|
|
8003ac6: 687b ldr r3, [r7, #4]
|
|
8003ac8: 68db ldr r3, [r3, #12]
|
|
8003aca: 4925 ldr r1, [pc, #148] @ (8003b60 <HAL_RCC_ClockConfig+0x30c>)
|
|
8003acc: 4313 orrs r3, r2
|
|
8003ace: 608b str r3, [r1, #8]
|
|
}
|
|
|
|
/*-------------------------- PCLK2 Configuration ---------------------------*/
|
|
if (((RCC_ClkInitStruct->ClockType) & RCC_CLOCKTYPE_PCLK2) == RCC_CLOCKTYPE_PCLK2)
|
|
8003ad0: 687b ldr r3, [r7, #4]
|
|
8003ad2: 681b ldr r3, [r3, #0]
|
|
8003ad4: f003 0308 and.w r3, r3, #8
|
|
8003ad8: 2b00 cmp r3, #0
|
|
8003ada: d026 beq.n 8003b2a <HAL_RCC_ClockConfig+0x2d6>
|
|
{
|
|
assert_param(IS_RCC_PCLK(RCC_ClkInitStruct->APB2CLKDivider));
|
|
8003adc: 687b ldr r3, [r7, #4]
|
|
8003ade: 691b ldr r3, [r3, #16]
|
|
8003ae0: 2b00 cmp r3, #0
|
|
8003ae2: d018 beq.n 8003b16 <HAL_RCC_ClockConfig+0x2c2>
|
|
8003ae4: 687b ldr r3, [r7, #4]
|
|
8003ae6: 691b ldr r3, [r3, #16]
|
|
8003ae8: f5b3 5f80 cmp.w r3, #4096 @ 0x1000
|
|
8003aec: d013 beq.n 8003b16 <HAL_RCC_ClockConfig+0x2c2>
|
|
8003aee: 687b ldr r3, [r7, #4]
|
|
8003af0: 691b ldr r3, [r3, #16]
|
|
8003af2: f5b3 5fa0 cmp.w r3, #5120 @ 0x1400
|
|
8003af6: d00e beq.n 8003b16 <HAL_RCC_ClockConfig+0x2c2>
|
|
8003af8: 687b ldr r3, [r7, #4]
|
|
8003afa: 691b ldr r3, [r3, #16]
|
|
8003afc: f5b3 5fc0 cmp.w r3, #6144 @ 0x1800
|
|
8003b00: d009 beq.n 8003b16 <HAL_RCC_ClockConfig+0x2c2>
|
|
8003b02: 687b ldr r3, [r7, #4]
|
|
8003b04: 691b ldr r3, [r3, #16]
|
|
8003b06: f5b3 5fe0 cmp.w r3, #7168 @ 0x1c00
|
|
8003b0a: d004 beq.n 8003b16 <HAL_RCC_ClockConfig+0x2c2>
|
|
8003b0c: f240 21ca movw r1, #714 @ 0x2ca
|
|
8003b10: 4812 ldr r0, [pc, #72] @ (8003b5c <HAL_RCC_ClockConfig+0x308>)
|
|
8003b12: f7fd f90f bl 8000d34 <assert_failed>
|
|
MODIFY_REG(RCC->CFGR, RCC_CFGR_PPRE2, ((RCC_ClkInitStruct->APB2CLKDivider) << 3U));
|
|
8003b16: 4b12 ldr r3, [pc, #72] @ (8003b60 <HAL_RCC_ClockConfig+0x30c>)
|
|
8003b18: 689b ldr r3, [r3, #8]
|
|
8003b1a: f423 4260 bic.w r2, r3, #57344 @ 0xe000
|
|
8003b1e: 687b ldr r3, [r7, #4]
|
|
8003b20: 691b ldr r3, [r3, #16]
|
|
8003b22: 00db lsls r3, r3, #3
|
|
8003b24: 490e ldr r1, [pc, #56] @ (8003b60 <HAL_RCC_ClockConfig+0x30c>)
|
|
8003b26: 4313 orrs r3, r2
|
|
8003b28: 608b str r3, [r1, #8]
|
|
}
|
|
|
|
/* Update the SystemCoreClock global variable */
|
|
SystemCoreClock = HAL_RCC_GetSysClockFreq() >> AHBPrescTable[(RCC->CFGR & RCC_CFGR_HPRE) >> RCC_CFGR_HPRE_Pos];
|
|
8003b2a: f000 f821 bl 8003b70 <HAL_RCC_GetSysClockFreq>
|
|
8003b2e: 4602 mov r2, r0
|
|
8003b30: 4b0b ldr r3, [pc, #44] @ (8003b60 <HAL_RCC_ClockConfig+0x30c>)
|
|
8003b32: 689b ldr r3, [r3, #8]
|
|
8003b34: 091b lsrs r3, r3, #4
|
|
8003b36: f003 030f and.w r3, r3, #15
|
|
8003b3a: 490a ldr r1, [pc, #40] @ (8003b64 <HAL_RCC_ClockConfig+0x310>)
|
|
8003b3c: 5ccb ldrb r3, [r1, r3]
|
|
8003b3e: fa22 f303 lsr.w r3, r2, r3
|
|
8003b42: 4a09 ldr r2, [pc, #36] @ (8003b68 <HAL_RCC_ClockConfig+0x314>)
|
|
8003b44: 6013 str r3, [r2, #0]
|
|
|
|
/* Configure the source of time base considering new system clocks settings */
|
|
HAL_InitTick(uwTickPrio);
|
|
8003b46: 4b09 ldr r3, [pc, #36] @ (8003b6c <HAL_RCC_ClockConfig+0x318>)
|
|
8003b48: 681b ldr r3, [r3, #0]
|
|
8003b4a: 4618 mov r0, r3
|
|
8003b4c: f7fd faba bl 80010c4 <HAL_InitTick>
|
|
|
|
return HAL_OK;
|
|
8003b50: 2300 movs r3, #0
|
|
}
|
|
8003b52: 4618 mov r0, r3
|
|
8003b54: 3710 adds r7, #16
|
|
8003b56: 46bd mov sp, r7
|
|
8003b58: bd80 pop {r7, pc}
|
|
8003b5a: bf00 nop
|
|
8003b5c: 0800a1a4 .word 0x0800a1a4
|
|
8003b60: 40023800 .word 0x40023800
|
|
8003b64: 0800a2a0 .word 0x0800a2a0
|
|
8003b68: 20000018 .word 0x20000018
|
|
8003b6c: 2000001c .word 0x2000001c
|
|
|
|
08003b70 <HAL_RCC_GetSysClockFreq>:
|
|
*
|
|
*
|
|
* @retval SYSCLK frequency
|
|
*/
|
|
__weak uint32_t HAL_RCC_GetSysClockFreq(void)
|
|
{
|
|
8003b70: e92d 4fb0 stmdb sp!, {r4, r5, r7, r8, r9, sl, fp, lr}
|
|
8003b74: b090 sub sp, #64 @ 0x40
|
|
8003b76: af00 add r7, sp, #0
|
|
uint32_t pllm = 0U;
|
|
8003b78: 2300 movs r3, #0
|
|
8003b7a: 637b str r3, [r7, #52] @ 0x34
|
|
uint32_t pllvco = 0U;
|
|
8003b7c: 2300 movs r3, #0
|
|
8003b7e: 63fb str r3, [r7, #60] @ 0x3c
|
|
uint32_t pllp = 0U;
|
|
8003b80: 2300 movs r3, #0
|
|
8003b82: 633b str r3, [r7, #48] @ 0x30
|
|
uint32_t sysclockfreq = 0U;
|
|
8003b84: 2300 movs r3, #0
|
|
8003b86: 63bb str r3, [r7, #56] @ 0x38
|
|
|
|
/* Get SYSCLK source -------------------------------------------------------*/
|
|
switch (RCC->CFGR & RCC_CFGR_SWS)
|
|
8003b88: 4b58 ldr r3, [pc, #352] @ (8003cec <HAL_RCC_GetSysClockFreq+0x17c>)
|
|
8003b8a: 689b ldr r3, [r3, #8]
|
|
8003b8c: f003 030c and.w r3, r3, #12
|
|
8003b90: 2b08 cmp r3, #8
|
|
8003b92: d00d beq.n 8003bb0 <HAL_RCC_GetSysClockFreq+0x40>
|
|
8003b94: 2b08 cmp r3, #8
|
|
8003b96: f200 80a0 bhi.w 8003cda <HAL_RCC_GetSysClockFreq+0x16a>
|
|
8003b9a: 2b00 cmp r3, #0
|
|
8003b9c: d002 beq.n 8003ba4 <HAL_RCC_GetSysClockFreq+0x34>
|
|
8003b9e: 2b04 cmp r3, #4
|
|
8003ba0: d003 beq.n 8003baa <HAL_RCC_GetSysClockFreq+0x3a>
|
|
8003ba2: e09a b.n 8003cda <HAL_RCC_GetSysClockFreq+0x16a>
|
|
{
|
|
case RCC_CFGR_SWS_HSI: /* HSI used as system clock source */
|
|
{
|
|
sysclockfreq = HSI_VALUE;
|
|
8003ba4: 4b52 ldr r3, [pc, #328] @ (8003cf0 <HAL_RCC_GetSysClockFreq+0x180>)
|
|
8003ba6: 63bb str r3, [r7, #56] @ 0x38
|
|
break;
|
|
8003ba8: e09a b.n 8003ce0 <HAL_RCC_GetSysClockFreq+0x170>
|
|
}
|
|
case RCC_CFGR_SWS_HSE: /* HSE used as system clock source */
|
|
{
|
|
sysclockfreq = HSE_VALUE;
|
|
8003baa: 4b52 ldr r3, [pc, #328] @ (8003cf4 <HAL_RCC_GetSysClockFreq+0x184>)
|
|
8003bac: 63bb str r3, [r7, #56] @ 0x38
|
|
break;
|
|
8003bae: e097 b.n 8003ce0 <HAL_RCC_GetSysClockFreq+0x170>
|
|
}
|
|
case RCC_CFGR_SWS_PLL: /* PLL used as system clock source */
|
|
{
|
|
/* PLL_VCO = (HSE_VALUE or HSI_VALUE / PLLM) * PLLN
|
|
SYSCLK = PLL_VCO / PLLP */
|
|
pllm = RCC->PLLCFGR & RCC_PLLCFGR_PLLM;
|
|
8003bb0: 4b4e ldr r3, [pc, #312] @ (8003cec <HAL_RCC_GetSysClockFreq+0x17c>)
|
|
8003bb2: 685b ldr r3, [r3, #4]
|
|
8003bb4: f003 033f and.w r3, r3, #63 @ 0x3f
|
|
8003bb8: 637b str r3, [r7, #52] @ 0x34
|
|
if (__HAL_RCC_GET_PLL_OSCSOURCE() != RCC_PLLSOURCE_HSI)
|
|
8003bba: 4b4c ldr r3, [pc, #304] @ (8003cec <HAL_RCC_GetSysClockFreq+0x17c>)
|
|
8003bbc: 685b ldr r3, [r3, #4]
|
|
8003bbe: f403 0380 and.w r3, r3, #4194304 @ 0x400000
|
|
8003bc2: 2b00 cmp r3, #0
|
|
8003bc4: d027 beq.n 8003c16 <HAL_RCC_GetSysClockFreq+0xa6>
|
|
{
|
|
/* HSE used as PLL clock source */
|
|
pllvco = (uint32_t)((((uint64_t) HSE_VALUE * ((uint64_t)((RCC->PLLCFGR & RCC_PLLCFGR_PLLN) >> RCC_PLLCFGR_PLLN_Pos)))) / (uint64_t)pllm);
|
|
8003bc6: 4b49 ldr r3, [pc, #292] @ (8003cec <HAL_RCC_GetSysClockFreq+0x17c>)
|
|
8003bc8: 685b ldr r3, [r3, #4]
|
|
8003bca: 099b lsrs r3, r3, #6
|
|
8003bcc: 2200 movs r2, #0
|
|
8003bce: 623b str r3, [r7, #32]
|
|
8003bd0: 627a str r2, [r7, #36] @ 0x24
|
|
8003bd2: 6a3b ldr r3, [r7, #32]
|
|
8003bd4: f3c3 0008 ubfx r0, r3, #0, #9
|
|
8003bd8: 2100 movs r1, #0
|
|
8003bda: 4b46 ldr r3, [pc, #280] @ (8003cf4 <HAL_RCC_GetSysClockFreq+0x184>)
|
|
8003bdc: fb03 f201 mul.w r2, r3, r1
|
|
8003be0: 2300 movs r3, #0
|
|
8003be2: fb00 f303 mul.w r3, r0, r3
|
|
8003be6: 4413 add r3, r2
|
|
8003be8: 4a42 ldr r2, [pc, #264] @ (8003cf4 <HAL_RCC_GetSysClockFreq+0x184>)
|
|
8003bea: fba0 2102 umull r2, r1, r0, r2
|
|
8003bee: 62f9 str r1, [r7, #44] @ 0x2c
|
|
8003bf0: 62ba str r2, [r7, #40] @ 0x28
|
|
8003bf2: 6afa ldr r2, [r7, #44] @ 0x2c
|
|
8003bf4: 4413 add r3, r2
|
|
8003bf6: 62fb str r3, [r7, #44] @ 0x2c
|
|
8003bf8: 6b7b ldr r3, [r7, #52] @ 0x34
|
|
8003bfa: 2200 movs r2, #0
|
|
8003bfc: 61bb str r3, [r7, #24]
|
|
8003bfe: 61fa str r2, [r7, #28]
|
|
8003c00: e9d7 2306 ldrd r2, r3, [r7, #24]
|
|
8003c04: e9d7 010a ldrd r0, r1, [r7, #40] @ 0x28
|
|
8003c08: f7fc fae2 bl 80001d0 <__aeabi_uldivmod>
|
|
8003c0c: 4602 mov r2, r0
|
|
8003c0e: 460b mov r3, r1
|
|
8003c10: 4613 mov r3, r2
|
|
8003c12: 63fb str r3, [r7, #60] @ 0x3c
|
|
8003c14: e053 b.n 8003cbe <HAL_RCC_GetSysClockFreq+0x14e>
|
|
}
|
|
else
|
|
{
|
|
/* HSI used as PLL clock source */
|
|
pllvco = (uint32_t)((((uint64_t) HSI_VALUE * ((uint64_t)((RCC->PLLCFGR & RCC_PLLCFGR_PLLN) >> RCC_PLLCFGR_PLLN_Pos)))) / (uint64_t)pllm);
|
|
8003c16: 4b35 ldr r3, [pc, #212] @ (8003cec <HAL_RCC_GetSysClockFreq+0x17c>)
|
|
8003c18: 685b ldr r3, [r3, #4]
|
|
8003c1a: 099b lsrs r3, r3, #6
|
|
8003c1c: 2200 movs r2, #0
|
|
8003c1e: 613b str r3, [r7, #16]
|
|
8003c20: 617a str r2, [r7, #20]
|
|
8003c22: 693b ldr r3, [r7, #16]
|
|
8003c24: f3c3 0a08 ubfx sl, r3, #0, #9
|
|
8003c28: f04f 0b00 mov.w fp, #0
|
|
8003c2c: 4652 mov r2, sl
|
|
8003c2e: 465b mov r3, fp
|
|
8003c30: f04f 0000 mov.w r0, #0
|
|
8003c34: f04f 0100 mov.w r1, #0
|
|
8003c38: 0159 lsls r1, r3, #5
|
|
8003c3a: ea41 61d2 orr.w r1, r1, r2, lsr #27
|
|
8003c3e: 0150 lsls r0, r2, #5
|
|
8003c40: 4602 mov r2, r0
|
|
8003c42: 460b mov r3, r1
|
|
8003c44: ebb2 080a subs.w r8, r2, sl
|
|
8003c48: eb63 090b sbc.w r9, r3, fp
|
|
8003c4c: f04f 0200 mov.w r2, #0
|
|
8003c50: f04f 0300 mov.w r3, #0
|
|
8003c54: ea4f 1389 mov.w r3, r9, lsl #6
|
|
8003c58: ea43 6398 orr.w r3, r3, r8, lsr #26
|
|
8003c5c: ea4f 1288 mov.w r2, r8, lsl #6
|
|
8003c60: ebb2 0408 subs.w r4, r2, r8
|
|
8003c64: eb63 0509 sbc.w r5, r3, r9
|
|
8003c68: f04f 0200 mov.w r2, #0
|
|
8003c6c: f04f 0300 mov.w r3, #0
|
|
8003c70: 00eb lsls r3, r5, #3
|
|
8003c72: ea43 7354 orr.w r3, r3, r4, lsr #29
|
|
8003c76: 00e2 lsls r2, r4, #3
|
|
8003c78: 4614 mov r4, r2
|
|
8003c7a: 461d mov r5, r3
|
|
8003c7c: eb14 030a adds.w r3, r4, sl
|
|
8003c80: 603b str r3, [r7, #0]
|
|
8003c82: eb45 030b adc.w r3, r5, fp
|
|
8003c86: 607b str r3, [r7, #4]
|
|
8003c88: f04f 0200 mov.w r2, #0
|
|
8003c8c: f04f 0300 mov.w r3, #0
|
|
8003c90: e9d7 4500 ldrd r4, r5, [r7]
|
|
8003c94: 4629 mov r1, r5
|
|
8003c96: 028b lsls r3, r1, #10
|
|
8003c98: 4621 mov r1, r4
|
|
8003c9a: ea43 5391 orr.w r3, r3, r1, lsr #22
|
|
8003c9e: 4621 mov r1, r4
|
|
8003ca0: 028a lsls r2, r1, #10
|
|
8003ca2: 4610 mov r0, r2
|
|
8003ca4: 4619 mov r1, r3
|
|
8003ca6: 6b7b ldr r3, [r7, #52] @ 0x34
|
|
8003ca8: 2200 movs r2, #0
|
|
8003caa: 60bb str r3, [r7, #8]
|
|
8003cac: 60fa str r2, [r7, #12]
|
|
8003cae: e9d7 2302 ldrd r2, r3, [r7, #8]
|
|
8003cb2: f7fc fa8d bl 80001d0 <__aeabi_uldivmod>
|
|
8003cb6: 4602 mov r2, r0
|
|
8003cb8: 460b mov r3, r1
|
|
8003cba: 4613 mov r3, r2
|
|
8003cbc: 63fb str r3, [r7, #60] @ 0x3c
|
|
}
|
|
pllp = ((((RCC->PLLCFGR & RCC_PLLCFGR_PLLP) >> RCC_PLLCFGR_PLLP_Pos) + 1U) * 2U);
|
|
8003cbe: 4b0b ldr r3, [pc, #44] @ (8003cec <HAL_RCC_GetSysClockFreq+0x17c>)
|
|
8003cc0: 685b ldr r3, [r3, #4]
|
|
8003cc2: 0c1b lsrs r3, r3, #16
|
|
8003cc4: f003 0303 and.w r3, r3, #3
|
|
8003cc8: 3301 adds r3, #1
|
|
8003cca: 005b lsls r3, r3, #1
|
|
8003ccc: 633b str r3, [r7, #48] @ 0x30
|
|
|
|
sysclockfreq = pllvco / pllp;
|
|
8003cce: 6bfa ldr r2, [r7, #60] @ 0x3c
|
|
8003cd0: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
8003cd2: fbb2 f3f3 udiv r3, r2, r3
|
|
8003cd6: 63bb str r3, [r7, #56] @ 0x38
|
|
break;
|
|
8003cd8: e002 b.n 8003ce0 <HAL_RCC_GetSysClockFreq+0x170>
|
|
}
|
|
default:
|
|
{
|
|
sysclockfreq = HSI_VALUE;
|
|
8003cda: 4b05 ldr r3, [pc, #20] @ (8003cf0 <HAL_RCC_GetSysClockFreq+0x180>)
|
|
8003cdc: 63bb str r3, [r7, #56] @ 0x38
|
|
break;
|
|
8003cde: bf00 nop
|
|
}
|
|
}
|
|
return sysclockfreq;
|
|
8003ce0: 6bbb ldr r3, [r7, #56] @ 0x38
|
|
}
|
|
8003ce2: 4618 mov r0, r3
|
|
8003ce4: 3740 adds r7, #64 @ 0x40
|
|
8003ce6: 46bd mov sp, r7
|
|
8003ce8: e8bd 8fb0 ldmia.w sp!, {r4, r5, r7, r8, r9, sl, fp, pc}
|
|
8003cec: 40023800 .word 0x40023800
|
|
8003cf0: 00f42400 .word 0x00f42400
|
|
8003cf4: 017d7840 .word 0x017d7840
|
|
|
|
08003cf8 <HAL_RCC_GetHCLKFreq>:
|
|
* @note The SystemCoreClock CMSIS variable is used to store System Clock Frequency
|
|
* and updated within this function
|
|
* @retval HCLK frequency
|
|
*/
|
|
uint32_t HAL_RCC_GetHCLKFreq(void)
|
|
{
|
|
8003cf8: b480 push {r7}
|
|
8003cfa: af00 add r7, sp, #0
|
|
return SystemCoreClock;
|
|
8003cfc: 4b03 ldr r3, [pc, #12] @ (8003d0c <HAL_RCC_GetHCLKFreq+0x14>)
|
|
8003cfe: 681b ldr r3, [r3, #0]
|
|
}
|
|
8003d00: 4618 mov r0, r3
|
|
8003d02: 46bd mov sp, r7
|
|
8003d04: f85d 7b04 ldr.w r7, [sp], #4
|
|
8003d08: 4770 bx lr
|
|
8003d0a: bf00 nop
|
|
8003d0c: 20000018 .word 0x20000018
|
|
|
|
08003d10 <HAL_RCC_GetPCLK1Freq>:
|
|
* @note Each time PCLK1 changes, this function must be called to update the
|
|
* right PCLK1 value. Otherwise, any configuration based on this function will be incorrect.
|
|
* @retval PCLK1 frequency
|
|
*/
|
|
uint32_t HAL_RCC_GetPCLK1Freq(void)
|
|
{
|
|
8003d10: b580 push {r7, lr}
|
|
8003d12: af00 add r7, sp, #0
|
|
/* Get HCLK source and Compute PCLK1 frequency ---------------------------*/
|
|
return (HAL_RCC_GetHCLKFreq() >> APBPrescTable[(RCC->CFGR & RCC_CFGR_PPRE1) >> RCC_CFGR_PPRE1_Pos]);
|
|
8003d14: f7ff fff0 bl 8003cf8 <HAL_RCC_GetHCLKFreq>
|
|
8003d18: 4602 mov r2, r0
|
|
8003d1a: 4b05 ldr r3, [pc, #20] @ (8003d30 <HAL_RCC_GetPCLK1Freq+0x20>)
|
|
8003d1c: 689b ldr r3, [r3, #8]
|
|
8003d1e: 0a9b lsrs r3, r3, #10
|
|
8003d20: f003 0307 and.w r3, r3, #7
|
|
8003d24: 4903 ldr r1, [pc, #12] @ (8003d34 <HAL_RCC_GetPCLK1Freq+0x24>)
|
|
8003d26: 5ccb ldrb r3, [r1, r3]
|
|
8003d28: fa22 f303 lsr.w r3, r2, r3
|
|
}
|
|
8003d2c: 4618 mov r0, r3
|
|
8003d2e: bd80 pop {r7, pc}
|
|
8003d30: 40023800 .word 0x40023800
|
|
8003d34: 0800a2b0 .word 0x0800a2b0
|
|
|
|
08003d38 <HAL_RCC_GetClockConfig>:
|
|
* will be configured.
|
|
* @param pFLatency Pointer on the Flash Latency.
|
|
* @retval None
|
|
*/
|
|
void HAL_RCC_GetClockConfig(RCC_ClkInitTypeDef *RCC_ClkInitStruct, uint32_t *pFLatency)
|
|
{
|
|
8003d38: b480 push {r7}
|
|
8003d3a: b083 sub sp, #12
|
|
8003d3c: af00 add r7, sp, #0
|
|
8003d3e: 6078 str r0, [r7, #4]
|
|
8003d40: 6039 str r1, [r7, #0]
|
|
/* Set all possible values for the Clock type parameter --------------------*/
|
|
RCC_ClkInitStruct->ClockType = RCC_CLOCKTYPE_SYSCLK | RCC_CLOCKTYPE_HCLK | RCC_CLOCKTYPE_PCLK1 | RCC_CLOCKTYPE_PCLK2;
|
|
8003d42: 687b ldr r3, [r7, #4]
|
|
8003d44: 220f movs r2, #15
|
|
8003d46: 601a str r2, [r3, #0]
|
|
|
|
/* Get the SYSCLK configuration --------------------------------------------*/
|
|
RCC_ClkInitStruct->SYSCLKSource = (uint32_t)(RCC->CFGR & RCC_CFGR_SW);
|
|
8003d48: 4b12 ldr r3, [pc, #72] @ (8003d94 <HAL_RCC_GetClockConfig+0x5c>)
|
|
8003d4a: 689b ldr r3, [r3, #8]
|
|
8003d4c: f003 0203 and.w r2, r3, #3
|
|
8003d50: 687b ldr r3, [r7, #4]
|
|
8003d52: 605a str r2, [r3, #4]
|
|
|
|
/* Get the HCLK configuration ----------------------------------------------*/
|
|
RCC_ClkInitStruct->AHBCLKDivider = (uint32_t)(RCC->CFGR & RCC_CFGR_HPRE);
|
|
8003d54: 4b0f ldr r3, [pc, #60] @ (8003d94 <HAL_RCC_GetClockConfig+0x5c>)
|
|
8003d56: 689b ldr r3, [r3, #8]
|
|
8003d58: f003 02f0 and.w r2, r3, #240 @ 0xf0
|
|
8003d5c: 687b ldr r3, [r7, #4]
|
|
8003d5e: 609a str r2, [r3, #8]
|
|
|
|
/* Get the APB1 configuration ----------------------------------------------*/
|
|
RCC_ClkInitStruct->APB1CLKDivider = (uint32_t)(RCC->CFGR & RCC_CFGR_PPRE1);
|
|
8003d60: 4b0c ldr r3, [pc, #48] @ (8003d94 <HAL_RCC_GetClockConfig+0x5c>)
|
|
8003d62: 689b ldr r3, [r3, #8]
|
|
8003d64: f403 52e0 and.w r2, r3, #7168 @ 0x1c00
|
|
8003d68: 687b ldr r3, [r7, #4]
|
|
8003d6a: 60da str r2, [r3, #12]
|
|
|
|
/* Get the APB2 configuration ----------------------------------------------*/
|
|
RCC_ClkInitStruct->APB2CLKDivider = (uint32_t)((RCC->CFGR & RCC_CFGR_PPRE2) >> 3U);
|
|
8003d6c: 4b09 ldr r3, [pc, #36] @ (8003d94 <HAL_RCC_GetClockConfig+0x5c>)
|
|
8003d6e: 689b ldr r3, [r3, #8]
|
|
8003d70: 08db lsrs r3, r3, #3
|
|
8003d72: f403 52e0 and.w r2, r3, #7168 @ 0x1c00
|
|
8003d76: 687b ldr r3, [r7, #4]
|
|
8003d78: 611a str r2, [r3, #16]
|
|
|
|
/* Get the Flash Wait State (Latency) configuration ------------------------*/
|
|
*pFLatency = (uint32_t)(FLASH->ACR & FLASH_ACR_LATENCY);
|
|
8003d7a: 4b07 ldr r3, [pc, #28] @ (8003d98 <HAL_RCC_GetClockConfig+0x60>)
|
|
8003d7c: 681b ldr r3, [r3, #0]
|
|
8003d7e: f003 0207 and.w r2, r3, #7
|
|
8003d82: 683b ldr r3, [r7, #0]
|
|
8003d84: 601a str r2, [r3, #0]
|
|
}
|
|
8003d86: bf00 nop
|
|
8003d88: 370c adds r7, #12
|
|
8003d8a: 46bd mov sp, r7
|
|
8003d8c: f85d 7b04 ldr.w r7, [sp], #4
|
|
8003d90: 4770 bx lr
|
|
8003d92: bf00 nop
|
|
8003d94: 40023800 .word 0x40023800
|
|
8003d98: 40023c00 .word 0x40023c00
|
|
|
|
08003d9c <HAL_SD_Init>:
|
|
SD_HandleTypeDef and create the associated handle.
|
|
* @param hsd: Pointer to the SD handle
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_SD_Init(SD_HandleTypeDef *hsd)
|
|
{
|
|
8003d9c: b580 push {r7, lr}
|
|
8003d9e: b082 sub sp, #8
|
|
8003da0: af00 add r7, sp, #0
|
|
8003da2: 6078 str r0, [r7, #4]
|
|
/* Check the SD handle allocation */
|
|
if(hsd == NULL)
|
|
8003da4: 687b ldr r3, [r7, #4]
|
|
8003da6: 2b00 cmp r3, #0
|
|
8003da8: d101 bne.n 8003dae <HAL_SD_Init+0x12>
|
|
{
|
|
return HAL_ERROR;
|
|
8003daa: 2301 movs r3, #1
|
|
8003dac: e080 b.n 8003eb0 <HAL_SD_Init+0x114>
|
|
}
|
|
|
|
/* Check the parameters */
|
|
assert_param(IS_SDIO_ALL_INSTANCE(hsd->Instance));
|
|
8003dae: 687b ldr r3, [r7, #4]
|
|
8003db0: 681b ldr r3, [r3, #0]
|
|
8003db2: 4a41 ldr r2, [pc, #260] @ (8003eb8 <HAL_SD_Init+0x11c>)
|
|
8003db4: 4293 cmp r3, r2
|
|
8003db6: d004 beq.n 8003dc2 <HAL_SD_Init+0x26>
|
|
8003db8: f44f 71ac mov.w r1, #344 @ 0x158
|
|
8003dbc: 483f ldr r0, [pc, #252] @ (8003ebc <HAL_SD_Init+0x120>)
|
|
8003dbe: f7fc ffb9 bl 8000d34 <assert_failed>
|
|
assert_param(IS_SDIO_CLOCK_EDGE(hsd->Init.ClockEdge));
|
|
8003dc2: 687b ldr r3, [r7, #4]
|
|
8003dc4: 685b ldr r3, [r3, #4]
|
|
8003dc6: 2b00 cmp r3, #0
|
|
8003dc8: d009 beq.n 8003dde <HAL_SD_Init+0x42>
|
|
8003dca: 687b ldr r3, [r7, #4]
|
|
8003dcc: 685b ldr r3, [r3, #4]
|
|
8003dce: f5b3 5f00 cmp.w r3, #8192 @ 0x2000
|
|
8003dd2: d004 beq.n 8003dde <HAL_SD_Init+0x42>
|
|
8003dd4: f240 1159 movw r1, #345 @ 0x159
|
|
8003dd8: 4838 ldr r0, [pc, #224] @ (8003ebc <HAL_SD_Init+0x120>)
|
|
8003dda: f7fc ffab bl 8000d34 <assert_failed>
|
|
assert_param(IS_SDIO_CLOCK_BYPASS(hsd->Init.ClockBypass));
|
|
8003dde: 687b ldr r3, [r7, #4]
|
|
8003de0: 689b ldr r3, [r3, #8]
|
|
8003de2: 2b00 cmp r3, #0
|
|
8003de4: d009 beq.n 8003dfa <HAL_SD_Init+0x5e>
|
|
8003de6: 687b ldr r3, [r7, #4]
|
|
8003de8: 689b ldr r3, [r3, #8]
|
|
8003dea: f5b3 6f80 cmp.w r3, #1024 @ 0x400
|
|
8003dee: d004 beq.n 8003dfa <HAL_SD_Init+0x5e>
|
|
8003df0: f44f 71ad mov.w r1, #346 @ 0x15a
|
|
8003df4: 4831 ldr r0, [pc, #196] @ (8003ebc <HAL_SD_Init+0x120>)
|
|
8003df6: f7fc ff9d bl 8000d34 <assert_failed>
|
|
assert_param(IS_SDIO_CLOCK_POWER_SAVE(hsd->Init.ClockPowerSave));
|
|
8003dfa: 687b ldr r3, [r7, #4]
|
|
8003dfc: 68db ldr r3, [r3, #12]
|
|
8003dfe: 2b00 cmp r3, #0
|
|
8003e00: d009 beq.n 8003e16 <HAL_SD_Init+0x7a>
|
|
8003e02: 687b ldr r3, [r7, #4]
|
|
8003e04: 68db ldr r3, [r3, #12]
|
|
8003e06: f5b3 7f00 cmp.w r3, #512 @ 0x200
|
|
8003e0a: d004 beq.n 8003e16 <HAL_SD_Init+0x7a>
|
|
8003e0c: f240 115b movw r1, #347 @ 0x15b
|
|
8003e10: 482a ldr r0, [pc, #168] @ (8003ebc <HAL_SD_Init+0x120>)
|
|
8003e12: f7fc ff8f bl 8000d34 <assert_failed>
|
|
assert_param(IS_SDIO_BUS_WIDE(hsd->Init.BusWide));
|
|
8003e16: 687b ldr r3, [r7, #4]
|
|
8003e18: 691b ldr r3, [r3, #16]
|
|
8003e1a: 2b00 cmp r3, #0
|
|
8003e1c: d00e beq.n 8003e3c <HAL_SD_Init+0xa0>
|
|
8003e1e: 687b ldr r3, [r7, #4]
|
|
8003e20: 691b ldr r3, [r3, #16]
|
|
8003e22: f5b3 6f00 cmp.w r3, #2048 @ 0x800
|
|
8003e26: d009 beq.n 8003e3c <HAL_SD_Init+0xa0>
|
|
8003e28: 687b ldr r3, [r7, #4]
|
|
8003e2a: 691b ldr r3, [r3, #16]
|
|
8003e2c: f5b3 5f80 cmp.w r3, #4096 @ 0x1000
|
|
8003e30: d004 beq.n 8003e3c <HAL_SD_Init+0xa0>
|
|
8003e32: f44f 71ae mov.w r1, #348 @ 0x15c
|
|
8003e36: 4821 ldr r0, [pc, #132] @ (8003ebc <HAL_SD_Init+0x120>)
|
|
8003e38: f7fc ff7c bl 8000d34 <assert_failed>
|
|
assert_param(IS_SDIO_HARDWARE_FLOW_CONTROL(hsd->Init.HardwareFlowControl));
|
|
8003e3c: 687b ldr r3, [r7, #4]
|
|
8003e3e: 695b ldr r3, [r3, #20]
|
|
8003e40: 2b00 cmp r3, #0
|
|
8003e42: d009 beq.n 8003e58 <HAL_SD_Init+0xbc>
|
|
8003e44: 687b ldr r3, [r7, #4]
|
|
8003e46: 695b ldr r3, [r3, #20]
|
|
8003e48: f5b3 4f80 cmp.w r3, #16384 @ 0x4000
|
|
8003e4c: d004 beq.n 8003e58 <HAL_SD_Init+0xbc>
|
|
8003e4e: f240 115d movw r1, #349 @ 0x15d
|
|
8003e52: 481a ldr r0, [pc, #104] @ (8003ebc <HAL_SD_Init+0x120>)
|
|
8003e54: f7fc ff6e bl 8000d34 <assert_failed>
|
|
assert_param(IS_SDIO_CLKDIV(hsd->Init.ClockDiv));
|
|
8003e58: 687b ldr r3, [r7, #4]
|
|
8003e5a: 699b ldr r3, [r3, #24]
|
|
8003e5c: 2bff cmp r3, #255 @ 0xff
|
|
8003e5e: d904 bls.n 8003e6a <HAL_SD_Init+0xce>
|
|
8003e60: f44f 71af mov.w r1, #350 @ 0x15e
|
|
8003e64: 4815 ldr r0, [pc, #84] @ (8003ebc <HAL_SD_Init+0x120>)
|
|
8003e66: f7fc ff65 bl 8000d34 <assert_failed>
|
|
|
|
if(hsd->State == HAL_SD_STATE_RESET)
|
|
8003e6a: 687b ldr r3, [r7, #4]
|
|
8003e6c: f893 3034 ldrb.w r3, [r3, #52] @ 0x34
|
|
8003e70: b2db uxtb r3, r3
|
|
8003e72: 2b00 cmp r3, #0
|
|
8003e74: d105 bne.n 8003e82 <HAL_SD_Init+0xe6>
|
|
{
|
|
/* Allocate lock resource and initialize it */
|
|
hsd->Lock = HAL_UNLOCKED;
|
|
8003e76: 687b ldr r3, [r7, #4]
|
|
8003e78: 2200 movs r2, #0
|
|
8003e7a: 771a strb r2, [r3, #28]
|
|
|
|
/* Init the low level hardware */
|
|
hsd->MspInitCallback(hsd);
|
|
#else
|
|
/* Init the low level hardware : GPIO, CLOCK, CORTEX...etc */
|
|
HAL_SD_MspInit(hsd);
|
|
8003e7c: 6878 ldr r0, [r7, #4]
|
|
8003e7e: f7fd f831 bl 8000ee4 <HAL_SD_MspInit>
|
|
#endif /* USE_HAL_SD_REGISTER_CALLBACKS */
|
|
}
|
|
|
|
hsd->State = HAL_SD_STATE_BUSY;
|
|
8003e82: 687b ldr r3, [r7, #4]
|
|
8003e84: 2203 movs r2, #3
|
|
8003e86: f883 2034 strb.w r2, [r3, #52] @ 0x34
|
|
|
|
/* Initialize the Card parameters */
|
|
if (HAL_SD_InitCard(hsd) != HAL_OK)
|
|
8003e8a: 6878 ldr r0, [r7, #4]
|
|
8003e8c: f000 f818 bl 8003ec0 <HAL_SD_InitCard>
|
|
8003e90: 4603 mov r3, r0
|
|
8003e92: 2b00 cmp r3, #0
|
|
8003e94: d001 beq.n 8003e9a <HAL_SD_Init+0xfe>
|
|
{
|
|
return HAL_ERROR;
|
|
8003e96: 2301 movs r3, #1
|
|
8003e98: e00a b.n 8003eb0 <HAL_SD_Init+0x114>
|
|
}
|
|
|
|
/* Initialize the error code */
|
|
hsd->ErrorCode = HAL_SD_ERROR_NONE;
|
|
8003e9a: 687b ldr r3, [r7, #4]
|
|
8003e9c: 2200 movs r2, #0
|
|
8003e9e: 639a str r2, [r3, #56] @ 0x38
|
|
|
|
/* Initialize the SD operation */
|
|
hsd->Context = SD_CONTEXT_NONE;
|
|
8003ea0: 687b ldr r3, [r7, #4]
|
|
8003ea2: 2200 movs r2, #0
|
|
8003ea4: 631a str r2, [r3, #48] @ 0x30
|
|
|
|
/* Initialize the SD state */
|
|
hsd->State = HAL_SD_STATE_READY;
|
|
8003ea6: 687b ldr r3, [r7, #4]
|
|
8003ea8: 2201 movs r2, #1
|
|
8003eaa: f883 2034 strb.w r2, [r3, #52] @ 0x34
|
|
|
|
return HAL_OK;
|
|
8003eae: 2300 movs r3, #0
|
|
}
|
|
8003eb0: 4618 mov r0, r3
|
|
8003eb2: 3708 adds r7, #8
|
|
8003eb4: 46bd mov sp, r7
|
|
8003eb6: bd80 pop {r7, pc}
|
|
8003eb8: 40012c00 .word 0x40012c00
|
|
8003ebc: 0800a1dc .word 0x0800a1dc
|
|
|
|
08003ec0 <HAL_SD_InitCard>:
|
|
* @note This function initializes the SD card. It could be used when a card
|
|
re-initialization is needed.
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_SD_InitCard(SD_HandleTypeDef *hsd)
|
|
{
|
|
8003ec0: b5b0 push {r4, r5, r7, lr}
|
|
8003ec2: b08e sub sp, #56 @ 0x38
|
|
8003ec4: af04 add r7, sp, #16
|
|
8003ec6: 6078 str r0, [r7, #4]
|
|
uint32_t errorstate;
|
|
SD_InitTypeDef Init;
|
|
|
|
/* Default SDIO peripheral configuration for SD card initialization */
|
|
Init.ClockEdge = SDIO_CLOCK_EDGE_RISING;
|
|
8003ec8: 2300 movs r3, #0
|
|
8003eca: 60fb str r3, [r7, #12]
|
|
Init.ClockBypass = SDIO_CLOCK_BYPASS_DISABLE;
|
|
8003ecc: 2300 movs r3, #0
|
|
8003ece: 613b str r3, [r7, #16]
|
|
Init.ClockPowerSave = SDIO_CLOCK_POWER_SAVE_DISABLE;
|
|
8003ed0: 2300 movs r3, #0
|
|
8003ed2: 617b str r3, [r7, #20]
|
|
Init.BusWide = SDIO_BUS_WIDE_1B;
|
|
8003ed4: 2300 movs r3, #0
|
|
8003ed6: 61bb str r3, [r7, #24]
|
|
Init.HardwareFlowControl = SDIO_HARDWARE_FLOW_CONTROL_DISABLE;
|
|
8003ed8: 2300 movs r3, #0
|
|
8003eda: 61fb str r3, [r7, #28]
|
|
Init.ClockDiv = SDIO_INIT_CLK_DIV;
|
|
8003edc: 2376 movs r3, #118 @ 0x76
|
|
8003ede: 623b str r3, [r7, #32]
|
|
|
|
/* Initialize SDIO peripheral interface with default configuration */
|
|
SDIO_Init(hsd->Instance, Init);
|
|
8003ee0: 687b ldr r3, [r7, #4]
|
|
8003ee2: 681d ldr r5, [r3, #0]
|
|
8003ee4: 466c mov r4, sp
|
|
8003ee6: f107 0318 add.w r3, r7, #24
|
|
8003eea: e893 0007 ldmia.w r3, {r0, r1, r2}
|
|
8003eee: e884 0007 stmia.w r4, {r0, r1, r2}
|
|
8003ef2: f107 030c add.w r3, r7, #12
|
|
8003ef6: cb0e ldmia r3, {r1, r2, r3}
|
|
8003ef8: 4628 mov r0, r5
|
|
8003efa: f001 fc3d bl 8005778 <SDIO_Init>
|
|
|
|
/* Disable SDIO Clock */
|
|
__HAL_SD_DISABLE(hsd);
|
|
8003efe: 4b2a ldr r3, [pc, #168] @ (8003fa8 <HAL_SD_InitCard+0xe8>)
|
|
8003f00: 2200 movs r2, #0
|
|
8003f02: 601a str r2, [r3, #0]
|
|
|
|
/* Set Power State to ON */
|
|
(void)SDIO_PowerState_ON(hsd->Instance);
|
|
8003f04: 687b ldr r3, [r7, #4]
|
|
8003f06: 681b ldr r3, [r3, #0]
|
|
8003f08: 4618 mov r0, r3
|
|
8003f0a: f001 fccd bl 80058a8 <SDIO_PowerState_ON>
|
|
|
|
/* Enable SDIO Clock */
|
|
__HAL_SD_ENABLE(hsd);
|
|
8003f0e: 4b26 ldr r3, [pc, #152] @ (8003fa8 <HAL_SD_InitCard+0xe8>)
|
|
8003f10: 2201 movs r2, #1
|
|
8003f12: 601a str r2, [r3, #0]
|
|
|
|
/* Required power up waiting time before starting the SD initialization sequence */
|
|
HAL_Delay(2);
|
|
8003f14: 2002 movs r0, #2
|
|
8003f16: f7fd fa9b bl 8001450 <HAL_Delay>
|
|
|
|
/* Identify card operating voltage */
|
|
errorstate = SD_PowerON(hsd);
|
|
8003f1a: 6878 ldr r0, [r7, #4]
|
|
8003f1c: f000 fda2 bl 8004a64 <SD_PowerON>
|
|
8003f20: 6278 str r0, [r7, #36] @ 0x24
|
|
if(errorstate != HAL_SD_ERROR_NONE)
|
|
8003f22: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8003f24: 2b00 cmp r3, #0
|
|
8003f26: d00b beq.n 8003f40 <HAL_SD_InitCard+0x80>
|
|
{
|
|
hsd->State = HAL_SD_STATE_READY;
|
|
8003f28: 687b ldr r3, [r7, #4]
|
|
8003f2a: 2201 movs r2, #1
|
|
8003f2c: f883 2034 strb.w r2, [r3, #52] @ 0x34
|
|
hsd->ErrorCode |= errorstate;
|
|
8003f30: 687b ldr r3, [r7, #4]
|
|
8003f32: 6b9a ldr r2, [r3, #56] @ 0x38
|
|
8003f34: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8003f36: 431a orrs r2, r3
|
|
8003f38: 687b ldr r3, [r7, #4]
|
|
8003f3a: 639a str r2, [r3, #56] @ 0x38
|
|
return HAL_ERROR;
|
|
8003f3c: 2301 movs r3, #1
|
|
8003f3e: e02e b.n 8003f9e <HAL_SD_InitCard+0xde>
|
|
}
|
|
|
|
/* Card initialization */
|
|
errorstate = SD_InitCard(hsd);
|
|
8003f40: 6878 ldr r0, [r7, #4]
|
|
8003f42: f000 fcc1 bl 80048c8 <SD_InitCard>
|
|
8003f46: 6278 str r0, [r7, #36] @ 0x24
|
|
if(errorstate != HAL_SD_ERROR_NONE)
|
|
8003f48: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8003f4a: 2b00 cmp r3, #0
|
|
8003f4c: d00b beq.n 8003f66 <HAL_SD_InitCard+0xa6>
|
|
{
|
|
hsd->State = HAL_SD_STATE_READY;
|
|
8003f4e: 687b ldr r3, [r7, #4]
|
|
8003f50: 2201 movs r2, #1
|
|
8003f52: f883 2034 strb.w r2, [r3, #52] @ 0x34
|
|
hsd->ErrorCode |= errorstate;
|
|
8003f56: 687b ldr r3, [r7, #4]
|
|
8003f58: 6b9a ldr r2, [r3, #56] @ 0x38
|
|
8003f5a: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8003f5c: 431a orrs r2, r3
|
|
8003f5e: 687b ldr r3, [r7, #4]
|
|
8003f60: 639a str r2, [r3, #56] @ 0x38
|
|
return HAL_ERROR;
|
|
8003f62: 2301 movs r3, #1
|
|
8003f64: e01b b.n 8003f9e <HAL_SD_InitCard+0xde>
|
|
}
|
|
|
|
/* Set Block Size for Card */
|
|
errorstate = SDMMC_CmdBlockLength(hsd->Instance, BLOCKSIZE);
|
|
8003f66: 687b ldr r3, [r7, #4]
|
|
8003f68: 681b ldr r3, [r3, #0]
|
|
8003f6a: f44f 7100 mov.w r1, #512 @ 0x200
|
|
8003f6e: 4618 mov r0, r3
|
|
8003f70: f001 fdec bl 8005b4c <SDMMC_CmdBlockLength>
|
|
8003f74: 6278 str r0, [r7, #36] @ 0x24
|
|
if(errorstate != HAL_SD_ERROR_NONE)
|
|
8003f76: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8003f78: 2b00 cmp r3, #0
|
|
8003f7a: d00f beq.n 8003f9c <HAL_SD_InitCard+0xdc>
|
|
{
|
|
/* Clear all the static flags */
|
|
__HAL_SD_CLEAR_FLAG(hsd, SDIO_STATIC_FLAGS);
|
|
8003f7c: 687b ldr r3, [r7, #4]
|
|
8003f7e: 681b ldr r3, [r3, #0]
|
|
8003f80: 4a0a ldr r2, [pc, #40] @ (8003fac <HAL_SD_InitCard+0xec>)
|
|
8003f82: 639a str r2, [r3, #56] @ 0x38
|
|
hsd->ErrorCode |= errorstate;
|
|
8003f84: 687b ldr r3, [r7, #4]
|
|
8003f86: 6b9a ldr r2, [r3, #56] @ 0x38
|
|
8003f88: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8003f8a: 431a orrs r2, r3
|
|
8003f8c: 687b ldr r3, [r7, #4]
|
|
8003f8e: 639a str r2, [r3, #56] @ 0x38
|
|
hsd->State = HAL_SD_STATE_READY;
|
|
8003f90: 687b ldr r3, [r7, #4]
|
|
8003f92: 2201 movs r2, #1
|
|
8003f94: f883 2034 strb.w r2, [r3, #52] @ 0x34
|
|
return HAL_ERROR;
|
|
8003f98: 2301 movs r3, #1
|
|
8003f9a: e000 b.n 8003f9e <HAL_SD_InitCard+0xde>
|
|
}
|
|
|
|
return HAL_OK;
|
|
8003f9c: 2300 movs r3, #0
|
|
}
|
|
8003f9e: 4618 mov r0, r3
|
|
8003fa0: 3728 adds r7, #40 @ 0x28
|
|
8003fa2: 46bd mov sp, r7
|
|
8003fa4: bdb0 pop {r4, r5, r7, pc}
|
|
8003fa6: bf00 nop
|
|
8003fa8: 422580a0 .word 0x422580a0
|
|
8003fac: 004005ff .word 0x004005ff
|
|
|
|
08003fb0 <HAL_SD_IRQHandler>:
|
|
* @brief This function handles SD card interrupt request.
|
|
* @param hsd: Pointer to SD handle
|
|
* @retval None
|
|
*/
|
|
void HAL_SD_IRQHandler(SD_HandleTypeDef *hsd)
|
|
{
|
|
8003fb0: b580 push {r7, lr}
|
|
8003fb2: b084 sub sp, #16
|
|
8003fb4: af00 add r7, sp, #0
|
|
8003fb6: 6078 str r0, [r7, #4]
|
|
uint32_t errorstate;
|
|
uint32_t context = hsd->Context;
|
|
8003fb8: 687b ldr r3, [r7, #4]
|
|
8003fba: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
8003fbc: 60fb str r3, [r7, #12]
|
|
|
|
/* Check for SDIO interrupt flags */
|
|
if((__HAL_SD_GET_FLAG(hsd, SDIO_FLAG_RXFIFOHF) != RESET) && ((context & SD_CONTEXT_IT) != 0U))
|
|
8003fbe: 687b ldr r3, [r7, #4]
|
|
8003fc0: 681b ldr r3, [r3, #0]
|
|
8003fc2: 6b5b ldr r3, [r3, #52] @ 0x34
|
|
8003fc4: f403 4300 and.w r3, r3, #32768 @ 0x8000
|
|
8003fc8: 2b00 cmp r3, #0
|
|
8003fca: d008 beq.n 8003fde <HAL_SD_IRQHandler+0x2e>
|
|
8003fcc: 68fb ldr r3, [r7, #12]
|
|
8003fce: f003 0308 and.w r3, r3, #8
|
|
8003fd2: 2b00 cmp r3, #0
|
|
8003fd4: d003 beq.n 8003fde <HAL_SD_IRQHandler+0x2e>
|
|
{
|
|
SD_Read_IT(hsd);
|
|
8003fd6: 6878 ldr r0, [r7, #4]
|
|
8003fd8: f000 ff6a bl 8004eb0 <SD_Read_IT>
|
|
8003fdc: e165 b.n 80042aa <HAL_SD_IRQHandler+0x2fa>
|
|
}
|
|
|
|
else if(__HAL_SD_GET_FLAG(hsd, SDIO_FLAG_DATAEND) != RESET)
|
|
8003fde: 687b ldr r3, [r7, #4]
|
|
8003fe0: 681b ldr r3, [r3, #0]
|
|
8003fe2: 6b5b ldr r3, [r3, #52] @ 0x34
|
|
8003fe4: f403 7380 and.w r3, r3, #256 @ 0x100
|
|
8003fe8: 2b00 cmp r3, #0
|
|
8003fea: f000 808f beq.w 800410c <HAL_SD_IRQHandler+0x15c>
|
|
{
|
|
__HAL_SD_CLEAR_FLAG(hsd, SDIO_FLAG_DATAEND);
|
|
8003fee: 687b ldr r3, [r7, #4]
|
|
8003ff0: 681b ldr r3, [r3, #0]
|
|
8003ff2: f44f 7280 mov.w r2, #256 @ 0x100
|
|
8003ff6: 639a str r2, [r3, #56] @ 0x38
|
|
|
|
#if defined(SDIO_STA_STBITERR)
|
|
__HAL_SD_DISABLE_IT(hsd, SDIO_IT_DATAEND | SDIO_IT_DCRCFAIL | SDIO_IT_DTIMEOUT|\
|
|
8003ff8: 687b ldr r3, [r7, #4]
|
|
8003ffa: 681b ldr r3, [r3, #0]
|
|
8003ffc: 6bdb ldr r3, [r3, #60] @ 0x3c
|
|
8003ffe: 687a ldr r2, [r7, #4]
|
|
8004000: 6812 ldr r2, [r2, #0]
|
|
8004002: f423 4343 bic.w r3, r3, #49920 @ 0xc300
|
|
8004006: f023 033a bic.w r3, r3, #58 @ 0x3a
|
|
800400a: 63d3 str r3, [r2, #60] @ 0x3c
|
|
__HAL_SD_DISABLE_IT(hsd, SDIO_IT_DATAEND | SDIO_IT_DCRCFAIL | SDIO_IT_DTIMEOUT|\
|
|
SDIO_IT_TXUNDERR | SDIO_IT_RXOVERR | SDIO_IT_TXFIFOHE |\
|
|
SDIO_IT_RXFIFOHF);
|
|
#endif /* SDIO_STA_STBITERR */
|
|
|
|
hsd->Instance->DCTRL &= ~(SDIO_DCTRL_DTEN);
|
|
800400c: 687b ldr r3, [r7, #4]
|
|
800400e: 681b ldr r3, [r3, #0]
|
|
8004010: 6ada ldr r2, [r3, #44] @ 0x2c
|
|
8004012: 687b ldr r3, [r7, #4]
|
|
8004014: 681b ldr r3, [r3, #0]
|
|
8004016: f022 0201 bic.w r2, r2, #1
|
|
800401a: 62da str r2, [r3, #44] @ 0x2c
|
|
|
|
if((context & SD_CONTEXT_IT) != 0U)
|
|
800401c: 68fb ldr r3, [r7, #12]
|
|
800401e: f003 0308 and.w r3, r3, #8
|
|
8004022: 2b00 cmp r3, #0
|
|
8004024: d039 beq.n 800409a <HAL_SD_IRQHandler+0xea>
|
|
{
|
|
if(((context & SD_CONTEXT_READ_MULTIPLE_BLOCK) != 0U) || ((context & SD_CONTEXT_WRITE_MULTIPLE_BLOCK) != 0U))
|
|
8004026: 68fb ldr r3, [r7, #12]
|
|
8004028: f003 0302 and.w r3, r3, #2
|
|
800402c: 2b00 cmp r3, #0
|
|
800402e: d104 bne.n 800403a <HAL_SD_IRQHandler+0x8a>
|
|
8004030: 68fb ldr r3, [r7, #12]
|
|
8004032: f003 0320 and.w r3, r3, #32
|
|
8004036: 2b00 cmp r3, #0
|
|
8004038: d011 beq.n 800405e <HAL_SD_IRQHandler+0xae>
|
|
{
|
|
errorstate = SDMMC_CmdStopTransfer(hsd->Instance);
|
|
800403a: 687b ldr r3, [r7, #4]
|
|
800403c: 681b ldr r3, [r3, #0]
|
|
800403e: 4618 mov r0, r3
|
|
8004040: f001 fda6 bl 8005b90 <SDMMC_CmdStopTransfer>
|
|
8004044: 60b8 str r0, [r7, #8]
|
|
if(errorstate != HAL_SD_ERROR_NONE)
|
|
8004046: 68bb ldr r3, [r7, #8]
|
|
8004048: 2b00 cmp r3, #0
|
|
800404a: d008 beq.n 800405e <HAL_SD_IRQHandler+0xae>
|
|
{
|
|
hsd->ErrorCode |= errorstate;
|
|
800404c: 687b ldr r3, [r7, #4]
|
|
800404e: 6b9a ldr r2, [r3, #56] @ 0x38
|
|
8004050: 68bb ldr r3, [r7, #8]
|
|
8004052: 431a orrs r2, r3
|
|
8004054: 687b ldr r3, [r7, #4]
|
|
8004056: 639a str r2, [r3, #56] @ 0x38
|
|
#if defined (USE_HAL_SD_REGISTER_CALLBACKS) && (USE_HAL_SD_REGISTER_CALLBACKS == 1U)
|
|
hsd->ErrorCallback(hsd);
|
|
#else
|
|
HAL_SD_ErrorCallback(hsd);
|
|
8004058: 6878 ldr r0, [r7, #4]
|
|
800405a: f000 f943 bl 80042e4 <HAL_SD_ErrorCallback>
|
|
#endif /* USE_HAL_SD_REGISTER_CALLBACKS */
|
|
}
|
|
}
|
|
|
|
/* Clear all the static flags */
|
|
__HAL_SD_CLEAR_FLAG(hsd, SDIO_STATIC_DATA_FLAGS);
|
|
800405e: 687b ldr r3, [r7, #4]
|
|
8004060: 681b ldr r3, [r3, #0]
|
|
8004062: f240 523a movw r2, #1338 @ 0x53a
|
|
8004066: 639a str r2, [r3, #56] @ 0x38
|
|
|
|
hsd->State = HAL_SD_STATE_READY;
|
|
8004068: 687b ldr r3, [r7, #4]
|
|
800406a: 2201 movs r2, #1
|
|
800406c: f883 2034 strb.w r2, [r3, #52] @ 0x34
|
|
hsd->Context = SD_CONTEXT_NONE;
|
|
8004070: 687b ldr r3, [r7, #4]
|
|
8004072: 2200 movs r2, #0
|
|
8004074: 631a str r2, [r3, #48] @ 0x30
|
|
if(((context & SD_CONTEXT_READ_SINGLE_BLOCK) != 0U) || ((context & SD_CONTEXT_READ_MULTIPLE_BLOCK) != 0U))
|
|
8004076: 68fb ldr r3, [r7, #12]
|
|
8004078: f003 0301 and.w r3, r3, #1
|
|
800407c: 2b00 cmp r3, #0
|
|
800407e: d104 bne.n 800408a <HAL_SD_IRQHandler+0xda>
|
|
8004080: 68fb ldr r3, [r7, #12]
|
|
8004082: f003 0302 and.w r3, r3, #2
|
|
8004086: 2b00 cmp r3, #0
|
|
8004088: d003 beq.n 8004092 <HAL_SD_IRQHandler+0xe2>
|
|
{
|
|
#if defined (USE_HAL_SD_REGISTER_CALLBACKS) && (USE_HAL_SD_REGISTER_CALLBACKS == 1U)
|
|
hsd->RxCpltCallback(hsd);
|
|
#else
|
|
HAL_SD_RxCpltCallback(hsd);
|
|
800408a: 6878 ldr r0, [r7, #4]
|
|
800408c: f000 f920 bl 80042d0 <HAL_SD_RxCpltCallback>
|
|
8004090: e10b b.n 80042aa <HAL_SD_IRQHandler+0x2fa>
|
|
else
|
|
{
|
|
#if defined (USE_HAL_SD_REGISTER_CALLBACKS) && (USE_HAL_SD_REGISTER_CALLBACKS == 1U)
|
|
hsd->TxCpltCallback(hsd);
|
|
#else
|
|
HAL_SD_TxCpltCallback(hsd);
|
|
8004092: 6878 ldr r0, [r7, #4]
|
|
8004094: f000 f912 bl 80042bc <HAL_SD_TxCpltCallback>
|
|
}
|
|
else
|
|
{
|
|
/* Nothing to do */
|
|
}
|
|
}
|
|
8004098: e107 b.n 80042aa <HAL_SD_IRQHandler+0x2fa>
|
|
else if((context & SD_CONTEXT_DMA) != 0U)
|
|
800409a: 68fb ldr r3, [r7, #12]
|
|
800409c: f003 0380 and.w r3, r3, #128 @ 0x80
|
|
80040a0: 2b00 cmp r3, #0
|
|
80040a2: f000 8102 beq.w 80042aa <HAL_SD_IRQHandler+0x2fa>
|
|
if((context & SD_CONTEXT_WRITE_MULTIPLE_BLOCK) != 0U)
|
|
80040a6: 68fb ldr r3, [r7, #12]
|
|
80040a8: f003 0320 and.w r3, r3, #32
|
|
80040ac: 2b00 cmp r3, #0
|
|
80040ae: d011 beq.n 80040d4 <HAL_SD_IRQHandler+0x124>
|
|
errorstate = SDMMC_CmdStopTransfer(hsd->Instance);
|
|
80040b0: 687b ldr r3, [r7, #4]
|
|
80040b2: 681b ldr r3, [r3, #0]
|
|
80040b4: 4618 mov r0, r3
|
|
80040b6: f001 fd6b bl 8005b90 <SDMMC_CmdStopTransfer>
|
|
80040ba: 60b8 str r0, [r7, #8]
|
|
if(errorstate != HAL_SD_ERROR_NONE)
|
|
80040bc: 68bb ldr r3, [r7, #8]
|
|
80040be: 2b00 cmp r3, #0
|
|
80040c0: d008 beq.n 80040d4 <HAL_SD_IRQHandler+0x124>
|
|
hsd->ErrorCode |= errorstate;
|
|
80040c2: 687b ldr r3, [r7, #4]
|
|
80040c4: 6b9a ldr r2, [r3, #56] @ 0x38
|
|
80040c6: 68bb ldr r3, [r7, #8]
|
|
80040c8: 431a orrs r2, r3
|
|
80040ca: 687b ldr r3, [r7, #4]
|
|
80040cc: 639a str r2, [r3, #56] @ 0x38
|
|
HAL_SD_ErrorCallback(hsd);
|
|
80040ce: 6878 ldr r0, [r7, #4]
|
|
80040d0: f000 f908 bl 80042e4 <HAL_SD_ErrorCallback>
|
|
if(((context & SD_CONTEXT_READ_SINGLE_BLOCK) == 0U) && ((context & SD_CONTEXT_READ_MULTIPLE_BLOCK) == 0U))
|
|
80040d4: 68fb ldr r3, [r7, #12]
|
|
80040d6: f003 0301 and.w r3, r3, #1
|
|
80040da: 2b00 cmp r3, #0
|
|
80040dc: f040 80e5 bne.w 80042aa <HAL_SD_IRQHandler+0x2fa>
|
|
80040e0: 68fb ldr r3, [r7, #12]
|
|
80040e2: f003 0302 and.w r3, r3, #2
|
|
80040e6: 2b00 cmp r3, #0
|
|
80040e8: f040 80df bne.w 80042aa <HAL_SD_IRQHandler+0x2fa>
|
|
hsd->Instance->DCTRL &= (uint32_t)~((uint32_t)SDIO_DCTRL_DMAEN);
|
|
80040ec: 687b ldr r3, [r7, #4]
|
|
80040ee: 681b ldr r3, [r3, #0]
|
|
80040f0: 6ada ldr r2, [r3, #44] @ 0x2c
|
|
80040f2: 687b ldr r3, [r7, #4]
|
|
80040f4: 681b ldr r3, [r3, #0]
|
|
80040f6: f022 0208 bic.w r2, r2, #8
|
|
80040fa: 62da str r2, [r3, #44] @ 0x2c
|
|
hsd->State = HAL_SD_STATE_READY;
|
|
80040fc: 687b ldr r3, [r7, #4]
|
|
80040fe: 2201 movs r2, #1
|
|
8004100: f883 2034 strb.w r2, [r3, #52] @ 0x34
|
|
HAL_SD_TxCpltCallback(hsd);
|
|
8004104: 6878 ldr r0, [r7, #4]
|
|
8004106: f000 f8d9 bl 80042bc <HAL_SD_TxCpltCallback>
|
|
}
|
|
800410a: e0ce b.n 80042aa <HAL_SD_IRQHandler+0x2fa>
|
|
else if((__HAL_SD_GET_FLAG(hsd, SDIO_FLAG_TXFIFOHE) != RESET) && ((context & SD_CONTEXT_IT) != 0U))
|
|
800410c: 687b ldr r3, [r7, #4]
|
|
800410e: 681b ldr r3, [r3, #0]
|
|
8004110: 6b5b ldr r3, [r3, #52] @ 0x34
|
|
8004112: f403 4380 and.w r3, r3, #16384 @ 0x4000
|
|
8004116: 2b00 cmp r3, #0
|
|
8004118: d008 beq.n 800412c <HAL_SD_IRQHandler+0x17c>
|
|
800411a: 68fb ldr r3, [r7, #12]
|
|
800411c: f003 0308 and.w r3, r3, #8
|
|
8004120: 2b00 cmp r3, #0
|
|
8004122: d003 beq.n 800412c <HAL_SD_IRQHandler+0x17c>
|
|
SD_Write_IT(hsd);
|
|
8004124: 6878 ldr r0, [r7, #4]
|
|
8004126: f000 ff14 bl 8004f52 <SD_Write_IT>
|
|
800412a: e0be b.n 80042aa <HAL_SD_IRQHandler+0x2fa>
|
|
else if(__HAL_SD_GET_FLAG(hsd, SDIO_FLAG_DCRCFAIL | SDIO_FLAG_DTIMEOUT | SDIO_FLAG_RXOVERR | SDIO_FLAG_TXUNDERR | SDIO_FLAG_STBITERR) != RESET)
|
|
800412c: 687b ldr r3, [r7, #4]
|
|
800412e: 681b ldr r3, [r3, #0]
|
|
8004130: 6b5a ldr r2, [r3, #52] @ 0x34
|
|
8004132: f240 233a movw r3, #570 @ 0x23a
|
|
8004136: 4013 ands r3, r2
|
|
8004138: 2b00 cmp r3, #0
|
|
800413a: f000 80b6 beq.w 80042aa <HAL_SD_IRQHandler+0x2fa>
|
|
if(__HAL_SD_GET_FLAG(hsd, SDIO_FLAG_DCRCFAIL) != RESET)
|
|
800413e: 687b ldr r3, [r7, #4]
|
|
8004140: 681b ldr r3, [r3, #0]
|
|
8004142: 6b5b ldr r3, [r3, #52] @ 0x34
|
|
8004144: f003 0302 and.w r3, r3, #2
|
|
8004148: 2b00 cmp r3, #0
|
|
800414a: d005 beq.n 8004158 <HAL_SD_IRQHandler+0x1a8>
|
|
hsd->ErrorCode |= HAL_SD_ERROR_DATA_CRC_FAIL;
|
|
800414c: 687b ldr r3, [r7, #4]
|
|
800414e: 6b9b ldr r3, [r3, #56] @ 0x38
|
|
8004150: f043 0202 orr.w r2, r3, #2
|
|
8004154: 687b ldr r3, [r7, #4]
|
|
8004156: 639a str r2, [r3, #56] @ 0x38
|
|
if(__HAL_SD_GET_FLAG(hsd, SDIO_FLAG_DTIMEOUT) != RESET)
|
|
8004158: 687b ldr r3, [r7, #4]
|
|
800415a: 681b ldr r3, [r3, #0]
|
|
800415c: 6b5b ldr r3, [r3, #52] @ 0x34
|
|
800415e: f003 0308 and.w r3, r3, #8
|
|
8004162: 2b00 cmp r3, #0
|
|
8004164: d005 beq.n 8004172 <HAL_SD_IRQHandler+0x1c2>
|
|
hsd->ErrorCode |= HAL_SD_ERROR_DATA_TIMEOUT;
|
|
8004166: 687b ldr r3, [r7, #4]
|
|
8004168: 6b9b ldr r3, [r3, #56] @ 0x38
|
|
800416a: f043 0208 orr.w r2, r3, #8
|
|
800416e: 687b ldr r3, [r7, #4]
|
|
8004170: 639a str r2, [r3, #56] @ 0x38
|
|
if(__HAL_SD_GET_FLAG(hsd, SDIO_FLAG_RXOVERR) != RESET)
|
|
8004172: 687b ldr r3, [r7, #4]
|
|
8004174: 681b ldr r3, [r3, #0]
|
|
8004176: 6b5b ldr r3, [r3, #52] @ 0x34
|
|
8004178: f003 0320 and.w r3, r3, #32
|
|
800417c: 2b00 cmp r3, #0
|
|
800417e: d005 beq.n 800418c <HAL_SD_IRQHandler+0x1dc>
|
|
hsd->ErrorCode |= HAL_SD_ERROR_RX_OVERRUN;
|
|
8004180: 687b ldr r3, [r7, #4]
|
|
8004182: 6b9b ldr r3, [r3, #56] @ 0x38
|
|
8004184: f043 0220 orr.w r2, r3, #32
|
|
8004188: 687b ldr r3, [r7, #4]
|
|
800418a: 639a str r2, [r3, #56] @ 0x38
|
|
if(__HAL_SD_GET_FLAG(hsd, SDIO_FLAG_TXUNDERR) != RESET)
|
|
800418c: 687b ldr r3, [r7, #4]
|
|
800418e: 681b ldr r3, [r3, #0]
|
|
8004190: 6b5b ldr r3, [r3, #52] @ 0x34
|
|
8004192: f003 0310 and.w r3, r3, #16
|
|
8004196: 2b00 cmp r3, #0
|
|
8004198: d005 beq.n 80041a6 <HAL_SD_IRQHandler+0x1f6>
|
|
hsd->ErrorCode |= HAL_SD_ERROR_TX_UNDERRUN;
|
|
800419a: 687b ldr r3, [r7, #4]
|
|
800419c: 6b9b ldr r3, [r3, #56] @ 0x38
|
|
800419e: f043 0210 orr.w r2, r3, #16
|
|
80041a2: 687b ldr r3, [r7, #4]
|
|
80041a4: 639a str r2, [r3, #56] @ 0x38
|
|
if(__HAL_SD_GET_FLAG(hsd, SDIO_FLAG_STBITERR) != RESET)
|
|
80041a6: 687b ldr r3, [r7, #4]
|
|
80041a8: 681b ldr r3, [r3, #0]
|
|
80041aa: 6b5b ldr r3, [r3, #52] @ 0x34
|
|
80041ac: f403 7300 and.w r3, r3, #512 @ 0x200
|
|
80041b0: 2b00 cmp r3, #0
|
|
80041b2: d005 beq.n 80041c0 <HAL_SD_IRQHandler+0x210>
|
|
hsd->ErrorCode |= HAL_SD_ERROR_DATA_TIMEOUT;
|
|
80041b4: 687b ldr r3, [r7, #4]
|
|
80041b6: 6b9b ldr r3, [r3, #56] @ 0x38
|
|
80041b8: f043 0208 orr.w r2, r3, #8
|
|
80041bc: 687b ldr r3, [r7, #4]
|
|
80041be: 639a str r2, [r3, #56] @ 0x38
|
|
__HAL_SD_CLEAR_FLAG(hsd, SDIO_STATIC_DATA_FLAGS | SDIO_FLAG_STBITERR);
|
|
80041c0: 687b ldr r3, [r7, #4]
|
|
80041c2: 681b ldr r3, [r3, #0]
|
|
80041c4: f240 723a movw r2, #1850 @ 0x73a
|
|
80041c8: 639a str r2, [r3, #56] @ 0x38
|
|
__HAL_SD_DISABLE_IT(hsd, SDIO_IT_DATAEND | SDIO_IT_DCRCFAIL | SDIO_IT_DTIMEOUT|\
|
|
80041ca: 687b ldr r3, [r7, #4]
|
|
80041cc: 681b ldr r3, [r3, #0]
|
|
80041ce: 6bdb ldr r3, [r3, #60] @ 0x3c
|
|
80041d0: 687a ldr r2, [r7, #4]
|
|
80041d2: 6812 ldr r2, [r2, #0]
|
|
80041d4: f423 734e bic.w r3, r3, #824 @ 0x338
|
|
80041d8: f023 0302 bic.w r3, r3, #2
|
|
80041dc: 63d3 str r3, [r2, #60] @ 0x3c
|
|
hsd->ErrorCode |= SDMMC_CmdStopTransfer(hsd->Instance);
|
|
80041de: 687b ldr r3, [r7, #4]
|
|
80041e0: 681b ldr r3, [r3, #0]
|
|
80041e2: 4618 mov r0, r3
|
|
80041e4: f001 fcd4 bl 8005b90 <SDMMC_CmdStopTransfer>
|
|
80041e8: 4602 mov r2, r0
|
|
80041ea: 687b ldr r3, [r7, #4]
|
|
80041ec: 6b9b ldr r3, [r3, #56] @ 0x38
|
|
80041ee: 431a orrs r2, r3
|
|
80041f0: 687b ldr r3, [r7, #4]
|
|
80041f2: 639a str r2, [r3, #56] @ 0x38
|
|
if((context & SD_CONTEXT_IT) != 0U)
|
|
80041f4: 68fb ldr r3, [r7, #12]
|
|
80041f6: f003 0308 and.w r3, r3, #8
|
|
80041fa: 2b00 cmp r3, #0
|
|
80041fc: d00a beq.n 8004214 <HAL_SD_IRQHandler+0x264>
|
|
hsd->State = HAL_SD_STATE_READY;
|
|
80041fe: 687b ldr r3, [r7, #4]
|
|
8004200: 2201 movs r2, #1
|
|
8004202: f883 2034 strb.w r2, [r3, #52] @ 0x34
|
|
hsd->Context = SD_CONTEXT_NONE;
|
|
8004206: 687b ldr r3, [r7, #4]
|
|
8004208: 2200 movs r2, #0
|
|
800420a: 631a str r2, [r3, #48] @ 0x30
|
|
HAL_SD_ErrorCallback(hsd);
|
|
800420c: 6878 ldr r0, [r7, #4]
|
|
800420e: f000 f869 bl 80042e4 <HAL_SD_ErrorCallback>
|
|
}
|
|
8004212: e04a b.n 80042aa <HAL_SD_IRQHandler+0x2fa>
|
|
else if((context & SD_CONTEXT_DMA) != 0U)
|
|
8004214: 68fb ldr r3, [r7, #12]
|
|
8004216: f003 0380 and.w r3, r3, #128 @ 0x80
|
|
800421a: 2b00 cmp r3, #0
|
|
800421c: d045 beq.n 80042aa <HAL_SD_IRQHandler+0x2fa>
|
|
if(((context & SD_CONTEXT_WRITE_SINGLE_BLOCK) != 0U) || ((context & SD_CONTEXT_WRITE_MULTIPLE_BLOCK) != 0U))
|
|
800421e: 68fb ldr r3, [r7, #12]
|
|
8004220: f003 0310 and.w r3, r3, #16
|
|
8004224: 2b00 cmp r3, #0
|
|
8004226: d104 bne.n 8004232 <HAL_SD_IRQHandler+0x282>
|
|
8004228: 68fb ldr r3, [r7, #12]
|
|
800422a: f003 0320 and.w r3, r3, #32
|
|
800422e: 2b00 cmp r3, #0
|
|
8004230: d011 beq.n 8004256 <HAL_SD_IRQHandler+0x2a6>
|
|
hsd->hdmatx->XferAbortCallback = SD_DMATxAbort;
|
|
8004232: 687b ldr r3, [r7, #4]
|
|
8004234: 6bdb ldr r3, [r3, #60] @ 0x3c
|
|
8004236: 4a1f ldr r2, [pc, #124] @ (80042b4 <HAL_SD_IRQHandler+0x304>)
|
|
8004238: 651a str r2, [r3, #80] @ 0x50
|
|
if(HAL_DMA_Abort_IT(hsd->hdmatx) != HAL_OK)
|
|
800423a: 687b ldr r3, [r7, #4]
|
|
800423c: 6bdb ldr r3, [r3, #60] @ 0x3c
|
|
800423e: 4618 mov r0, r3
|
|
8004240: f7fe fa5c bl 80026fc <HAL_DMA_Abort_IT>
|
|
8004244: 4603 mov r3, r0
|
|
8004246: 2b00 cmp r3, #0
|
|
8004248: d02f beq.n 80042aa <HAL_SD_IRQHandler+0x2fa>
|
|
SD_DMATxAbort(hsd->hdmatx);
|
|
800424a: 687b ldr r3, [r7, #4]
|
|
800424c: 6bdb ldr r3, [r3, #60] @ 0x3c
|
|
800424e: 4618 mov r0, r3
|
|
8004250: f000 facc bl 80047ec <SD_DMATxAbort>
|
|
if(HAL_DMA_Abort_IT(hsd->hdmatx) != HAL_OK)
|
|
8004254: e029 b.n 80042aa <HAL_SD_IRQHandler+0x2fa>
|
|
else if(((context & SD_CONTEXT_READ_SINGLE_BLOCK) != 0U) || ((context & SD_CONTEXT_READ_MULTIPLE_BLOCK) != 0U))
|
|
8004256: 68fb ldr r3, [r7, #12]
|
|
8004258: f003 0301 and.w r3, r3, #1
|
|
800425c: 2b00 cmp r3, #0
|
|
800425e: d104 bne.n 800426a <HAL_SD_IRQHandler+0x2ba>
|
|
8004260: 68fb ldr r3, [r7, #12]
|
|
8004262: f003 0302 and.w r3, r3, #2
|
|
8004266: 2b00 cmp r3, #0
|
|
8004268: d011 beq.n 800428e <HAL_SD_IRQHandler+0x2de>
|
|
hsd->hdmarx->XferAbortCallback = SD_DMARxAbort;
|
|
800426a: 687b ldr r3, [r7, #4]
|
|
800426c: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
800426e: 4a12 ldr r2, [pc, #72] @ (80042b8 <HAL_SD_IRQHandler+0x308>)
|
|
8004270: 651a str r2, [r3, #80] @ 0x50
|
|
if(HAL_DMA_Abort_IT(hsd->hdmarx) != HAL_OK)
|
|
8004272: 687b ldr r3, [r7, #4]
|
|
8004274: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
8004276: 4618 mov r0, r3
|
|
8004278: f7fe fa40 bl 80026fc <HAL_DMA_Abort_IT>
|
|
800427c: 4603 mov r3, r0
|
|
800427e: 2b00 cmp r3, #0
|
|
8004280: d013 beq.n 80042aa <HAL_SD_IRQHandler+0x2fa>
|
|
SD_DMARxAbort(hsd->hdmarx);
|
|
8004282: 687b ldr r3, [r7, #4]
|
|
8004284: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
8004286: 4618 mov r0, r3
|
|
8004288: f000 fae7 bl 800485a <SD_DMARxAbort>
|
|
if(HAL_DMA_Abort_IT(hsd->hdmarx) != HAL_OK)
|
|
800428c: e00d b.n 80042aa <HAL_SD_IRQHandler+0x2fa>
|
|
hsd->ErrorCode = HAL_SD_ERROR_NONE;
|
|
800428e: 687b ldr r3, [r7, #4]
|
|
8004290: 2200 movs r2, #0
|
|
8004292: 639a str r2, [r3, #56] @ 0x38
|
|
hsd->State = HAL_SD_STATE_READY;
|
|
8004294: 687b ldr r3, [r7, #4]
|
|
8004296: 2201 movs r2, #1
|
|
8004298: f883 2034 strb.w r2, [r3, #52] @ 0x34
|
|
hsd->Context = SD_CONTEXT_NONE;
|
|
800429c: 687b ldr r3, [r7, #4]
|
|
800429e: 2200 movs r2, #0
|
|
80042a0: 631a str r2, [r3, #48] @ 0x30
|
|
HAL_SD_AbortCallback(hsd);
|
|
80042a2: 6878 ldr r0, [r7, #4]
|
|
80042a4: f000 f828 bl 80042f8 <HAL_SD_AbortCallback>
|
|
}
|
|
80042a8: e7ff b.n 80042aa <HAL_SD_IRQHandler+0x2fa>
|
|
80042aa: bf00 nop
|
|
80042ac: 3710 adds r7, #16
|
|
80042ae: 46bd mov sp, r7
|
|
80042b0: bd80 pop {r7, pc}
|
|
80042b2: bf00 nop
|
|
80042b4: 080047ed .word 0x080047ed
|
|
80042b8: 0800485b .word 0x0800485b
|
|
|
|
080042bc <HAL_SD_TxCpltCallback>:
|
|
* @brief Tx Transfer completed callbacks
|
|
* @param hsd: Pointer to SD handle
|
|
* @retval None
|
|
*/
|
|
__weak void HAL_SD_TxCpltCallback(SD_HandleTypeDef *hsd)
|
|
{
|
|
80042bc: b480 push {r7}
|
|
80042be: b083 sub sp, #12
|
|
80042c0: af00 add r7, sp, #0
|
|
80042c2: 6078 str r0, [r7, #4]
|
|
UNUSED(hsd);
|
|
|
|
/* NOTE : This function should not be modified, when the callback is needed,
|
|
the HAL_SD_TxCpltCallback can be implemented in the user file
|
|
*/
|
|
}
|
|
80042c4: bf00 nop
|
|
80042c6: 370c adds r7, #12
|
|
80042c8: 46bd mov sp, r7
|
|
80042ca: f85d 7b04 ldr.w r7, [sp], #4
|
|
80042ce: 4770 bx lr
|
|
|
|
080042d0 <HAL_SD_RxCpltCallback>:
|
|
* @brief Rx Transfer completed callbacks
|
|
* @param hsd: Pointer SD handle
|
|
* @retval None
|
|
*/
|
|
__weak void HAL_SD_RxCpltCallback(SD_HandleTypeDef *hsd)
|
|
{
|
|
80042d0: b480 push {r7}
|
|
80042d2: b083 sub sp, #12
|
|
80042d4: af00 add r7, sp, #0
|
|
80042d6: 6078 str r0, [r7, #4]
|
|
UNUSED(hsd);
|
|
|
|
/* NOTE : This function should not be modified, when the callback is needed,
|
|
the HAL_SD_RxCpltCallback can be implemented in the user file
|
|
*/
|
|
}
|
|
80042d8: bf00 nop
|
|
80042da: 370c adds r7, #12
|
|
80042dc: 46bd mov sp, r7
|
|
80042de: f85d 7b04 ldr.w r7, [sp], #4
|
|
80042e2: 4770 bx lr
|
|
|
|
080042e4 <HAL_SD_ErrorCallback>:
|
|
* @brief SD error callbacks
|
|
* @param hsd: Pointer SD handle
|
|
* @retval None
|
|
*/
|
|
__weak void HAL_SD_ErrorCallback(SD_HandleTypeDef *hsd)
|
|
{
|
|
80042e4: b480 push {r7}
|
|
80042e6: b083 sub sp, #12
|
|
80042e8: af00 add r7, sp, #0
|
|
80042ea: 6078 str r0, [r7, #4]
|
|
UNUSED(hsd);
|
|
|
|
/* NOTE : This function should not be modified, when the callback is needed,
|
|
the HAL_SD_ErrorCallback can be implemented in the user file
|
|
*/
|
|
}
|
|
80042ec: bf00 nop
|
|
80042ee: 370c adds r7, #12
|
|
80042f0: 46bd mov sp, r7
|
|
80042f2: f85d 7b04 ldr.w r7, [sp], #4
|
|
80042f6: 4770 bx lr
|
|
|
|
080042f8 <HAL_SD_AbortCallback>:
|
|
* @brief SD Abort callbacks
|
|
* @param hsd: Pointer SD handle
|
|
* @retval None
|
|
*/
|
|
__weak void HAL_SD_AbortCallback(SD_HandleTypeDef *hsd)
|
|
{
|
|
80042f8: b480 push {r7}
|
|
80042fa: b083 sub sp, #12
|
|
80042fc: af00 add r7, sp, #0
|
|
80042fe: 6078 str r0, [r7, #4]
|
|
UNUSED(hsd);
|
|
|
|
/* NOTE : This function should not be modified, when the callback is needed,
|
|
the HAL_SD_AbortCallback can be implemented in the user file
|
|
*/
|
|
}
|
|
8004300: bf00 nop
|
|
8004302: 370c adds r7, #12
|
|
8004304: 46bd mov sp, r7
|
|
8004306: f85d 7b04 ldr.w r7, [sp], #4
|
|
800430a: 4770 bx lr
|
|
|
|
0800430c <HAL_SD_GetCardCSD>:
|
|
* @param pCSD: Pointer to a HAL_SD_CardCSDTypeDef structure that
|
|
* contains all CSD register parameters
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_SD_GetCardCSD(SD_HandleTypeDef *hsd, HAL_SD_CardCSDTypeDef *pCSD)
|
|
{
|
|
800430c: b480 push {r7}
|
|
800430e: b083 sub sp, #12
|
|
8004310: af00 add r7, sp, #0
|
|
8004312: 6078 str r0, [r7, #4]
|
|
8004314: 6039 str r1, [r7, #0]
|
|
pCSD->CSDStruct = (uint8_t)((hsd->CSD[0] & 0xC0000000U) >> 30U);
|
|
8004316: 687b ldr r3, [r7, #4]
|
|
8004318: 6e5b ldr r3, [r3, #100] @ 0x64
|
|
800431a: 0f9b lsrs r3, r3, #30
|
|
800431c: b2da uxtb r2, r3
|
|
800431e: 683b ldr r3, [r7, #0]
|
|
8004320: 701a strb r2, [r3, #0]
|
|
|
|
pCSD->SysSpecVersion = (uint8_t)((hsd->CSD[0] & 0x3C000000U) >> 26U);
|
|
8004322: 687b ldr r3, [r7, #4]
|
|
8004324: 6e5b ldr r3, [r3, #100] @ 0x64
|
|
8004326: 0e9b lsrs r3, r3, #26
|
|
8004328: b2db uxtb r3, r3
|
|
800432a: f003 030f and.w r3, r3, #15
|
|
800432e: b2da uxtb r2, r3
|
|
8004330: 683b ldr r3, [r7, #0]
|
|
8004332: 705a strb r2, [r3, #1]
|
|
|
|
pCSD->Reserved1 = (uint8_t)((hsd->CSD[0] & 0x03000000U) >> 24U);
|
|
8004334: 687b ldr r3, [r7, #4]
|
|
8004336: 6e5b ldr r3, [r3, #100] @ 0x64
|
|
8004338: 0e1b lsrs r3, r3, #24
|
|
800433a: b2db uxtb r3, r3
|
|
800433c: f003 0303 and.w r3, r3, #3
|
|
8004340: b2da uxtb r2, r3
|
|
8004342: 683b ldr r3, [r7, #0]
|
|
8004344: 709a strb r2, [r3, #2]
|
|
|
|
pCSD->TAAC = (uint8_t)((hsd->CSD[0] & 0x00FF0000U) >> 16U);
|
|
8004346: 687b ldr r3, [r7, #4]
|
|
8004348: 6e5b ldr r3, [r3, #100] @ 0x64
|
|
800434a: 0c1b lsrs r3, r3, #16
|
|
800434c: b2da uxtb r2, r3
|
|
800434e: 683b ldr r3, [r7, #0]
|
|
8004350: 70da strb r2, [r3, #3]
|
|
|
|
pCSD->NSAC = (uint8_t)((hsd->CSD[0] & 0x0000FF00U) >> 8U);
|
|
8004352: 687b ldr r3, [r7, #4]
|
|
8004354: 6e5b ldr r3, [r3, #100] @ 0x64
|
|
8004356: 0a1b lsrs r3, r3, #8
|
|
8004358: b2da uxtb r2, r3
|
|
800435a: 683b ldr r3, [r7, #0]
|
|
800435c: 711a strb r2, [r3, #4]
|
|
|
|
pCSD->MaxBusClkFrec = (uint8_t)(hsd->CSD[0] & 0x000000FFU);
|
|
800435e: 687b ldr r3, [r7, #4]
|
|
8004360: 6e5b ldr r3, [r3, #100] @ 0x64
|
|
8004362: b2da uxtb r2, r3
|
|
8004364: 683b ldr r3, [r7, #0]
|
|
8004366: 715a strb r2, [r3, #5]
|
|
|
|
pCSD->CardComdClasses = (uint16_t)((hsd->CSD[1] & 0xFFF00000U) >> 20U);
|
|
8004368: 687b ldr r3, [r7, #4]
|
|
800436a: 6e9b ldr r3, [r3, #104] @ 0x68
|
|
800436c: 0d1b lsrs r3, r3, #20
|
|
800436e: b29a uxth r2, r3
|
|
8004370: 683b ldr r3, [r7, #0]
|
|
8004372: 80da strh r2, [r3, #6]
|
|
|
|
pCSD->RdBlockLen = (uint8_t)((hsd->CSD[1] & 0x000F0000U) >> 16U);
|
|
8004374: 687b ldr r3, [r7, #4]
|
|
8004376: 6e9b ldr r3, [r3, #104] @ 0x68
|
|
8004378: 0c1b lsrs r3, r3, #16
|
|
800437a: b2db uxtb r3, r3
|
|
800437c: f003 030f and.w r3, r3, #15
|
|
8004380: b2da uxtb r2, r3
|
|
8004382: 683b ldr r3, [r7, #0]
|
|
8004384: 721a strb r2, [r3, #8]
|
|
|
|
pCSD->PartBlockRead = (uint8_t)((hsd->CSD[1] & 0x00008000U) >> 15U);
|
|
8004386: 687b ldr r3, [r7, #4]
|
|
8004388: 6e9b ldr r3, [r3, #104] @ 0x68
|
|
800438a: 0bdb lsrs r3, r3, #15
|
|
800438c: b2db uxtb r3, r3
|
|
800438e: f003 0301 and.w r3, r3, #1
|
|
8004392: b2da uxtb r2, r3
|
|
8004394: 683b ldr r3, [r7, #0]
|
|
8004396: 725a strb r2, [r3, #9]
|
|
|
|
pCSD->WrBlockMisalign = (uint8_t)((hsd->CSD[1] & 0x00004000U) >> 14U);
|
|
8004398: 687b ldr r3, [r7, #4]
|
|
800439a: 6e9b ldr r3, [r3, #104] @ 0x68
|
|
800439c: 0b9b lsrs r3, r3, #14
|
|
800439e: b2db uxtb r3, r3
|
|
80043a0: f003 0301 and.w r3, r3, #1
|
|
80043a4: b2da uxtb r2, r3
|
|
80043a6: 683b ldr r3, [r7, #0]
|
|
80043a8: 729a strb r2, [r3, #10]
|
|
|
|
pCSD->RdBlockMisalign = (uint8_t)((hsd->CSD[1] & 0x00002000U) >> 13U);
|
|
80043aa: 687b ldr r3, [r7, #4]
|
|
80043ac: 6e9b ldr r3, [r3, #104] @ 0x68
|
|
80043ae: 0b5b lsrs r3, r3, #13
|
|
80043b0: b2db uxtb r3, r3
|
|
80043b2: f003 0301 and.w r3, r3, #1
|
|
80043b6: b2da uxtb r2, r3
|
|
80043b8: 683b ldr r3, [r7, #0]
|
|
80043ba: 72da strb r2, [r3, #11]
|
|
|
|
pCSD->DSRImpl = (uint8_t)((hsd->CSD[1] & 0x00001000U) >> 12U);
|
|
80043bc: 687b ldr r3, [r7, #4]
|
|
80043be: 6e9b ldr r3, [r3, #104] @ 0x68
|
|
80043c0: 0b1b lsrs r3, r3, #12
|
|
80043c2: b2db uxtb r3, r3
|
|
80043c4: f003 0301 and.w r3, r3, #1
|
|
80043c8: b2da uxtb r2, r3
|
|
80043ca: 683b ldr r3, [r7, #0]
|
|
80043cc: 731a strb r2, [r3, #12]
|
|
|
|
pCSD->Reserved2 = 0U; /*!< Reserved */
|
|
80043ce: 683b ldr r3, [r7, #0]
|
|
80043d0: 2200 movs r2, #0
|
|
80043d2: 735a strb r2, [r3, #13]
|
|
|
|
if(hsd->SdCard.CardType == CARD_SDSC)
|
|
80043d4: 687b ldr r3, [r7, #4]
|
|
80043d6: 6c5b ldr r3, [r3, #68] @ 0x44
|
|
80043d8: 2b00 cmp r3, #0
|
|
80043da: d163 bne.n 80044a4 <HAL_SD_GetCardCSD+0x198>
|
|
{
|
|
pCSD->DeviceSize = (((hsd->CSD[1] & 0x000003FFU) << 2U) | ((hsd->CSD[2] & 0xC0000000U) >> 30U));
|
|
80043dc: 687b ldr r3, [r7, #4]
|
|
80043de: 6e9b ldr r3, [r3, #104] @ 0x68
|
|
80043e0: 009a lsls r2, r3, #2
|
|
80043e2: f640 73fc movw r3, #4092 @ 0xffc
|
|
80043e6: 4013 ands r3, r2
|
|
80043e8: 687a ldr r2, [r7, #4]
|
|
80043ea: 6ed2 ldr r2, [r2, #108] @ 0x6c
|
|
80043ec: 0f92 lsrs r2, r2, #30
|
|
80043ee: 431a orrs r2, r3
|
|
80043f0: 683b ldr r3, [r7, #0]
|
|
80043f2: 611a str r2, [r3, #16]
|
|
|
|
pCSD->MaxRdCurrentVDDMin = (uint8_t)((hsd->CSD[2] & 0x38000000U) >> 27U);
|
|
80043f4: 687b ldr r3, [r7, #4]
|
|
80043f6: 6edb ldr r3, [r3, #108] @ 0x6c
|
|
80043f8: 0edb lsrs r3, r3, #27
|
|
80043fa: b2db uxtb r3, r3
|
|
80043fc: f003 0307 and.w r3, r3, #7
|
|
8004400: b2da uxtb r2, r3
|
|
8004402: 683b ldr r3, [r7, #0]
|
|
8004404: 751a strb r2, [r3, #20]
|
|
|
|
pCSD->MaxRdCurrentVDDMax = (uint8_t)((hsd->CSD[2] & 0x07000000U) >> 24U);
|
|
8004406: 687b ldr r3, [r7, #4]
|
|
8004408: 6edb ldr r3, [r3, #108] @ 0x6c
|
|
800440a: 0e1b lsrs r3, r3, #24
|
|
800440c: b2db uxtb r3, r3
|
|
800440e: f003 0307 and.w r3, r3, #7
|
|
8004412: b2da uxtb r2, r3
|
|
8004414: 683b ldr r3, [r7, #0]
|
|
8004416: 755a strb r2, [r3, #21]
|
|
|
|
pCSD->MaxWrCurrentVDDMin = (uint8_t)((hsd->CSD[2] & 0x00E00000U) >> 21U);
|
|
8004418: 687b ldr r3, [r7, #4]
|
|
800441a: 6edb ldr r3, [r3, #108] @ 0x6c
|
|
800441c: 0d5b lsrs r3, r3, #21
|
|
800441e: b2db uxtb r3, r3
|
|
8004420: f003 0307 and.w r3, r3, #7
|
|
8004424: b2da uxtb r2, r3
|
|
8004426: 683b ldr r3, [r7, #0]
|
|
8004428: 759a strb r2, [r3, #22]
|
|
|
|
pCSD->MaxWrCurrentVDDMax = (uint8_t)((hsd->CSD[2] & 0x001C0000U) >> 18U);
|
|
800442a: 687b ldr r3, [r7, #4]
|
|
800442c: 6edb ldr r3, [r3, #108] @ 0x6c
|
|
800442e: 0c9b lsrs r3, r3, #18
|
|
8004430: b2db uxtb r3, r3
|
|
8004432: f003 0307 and.w r3, r3, #7
|
|
8004436: b2da uxtb r2, r3
|
|
8004438: 683b ldr r3, [r7, #0]
|
|
800443a: 75da strb r2, [r3, #23]
|
|
|
|
pCSD->DeviceSizeMul = (uint8_t)((hsd->CSD[2] & 0x00038000U) >> 15U);
|
|
800443c: 687b ldr r3, [r7, #4]
|
|
800443e: 6edb ldr r3, [r3, #108] @ 0x6c
|
|
8004440: 0bdb lsrs r3, r3, #15
|
|
8004442: b2db uxtb r3, r3
|
|
8004444: f003 0307 and.w r3, r3, #7
|
|
8004448: b2da uxtb r2, r3
|
|
800444a: 683b ldr r3, [r7, #0]
|
|
800444c: 761a strb r2, [r3, #24]
|
|
|
|
hsd->SdCard.BlockNbr = (pCSD->DeviceSize + 1U) ;
|
|
800444e: 683b ldr r3, [r7, #0]
|
|
8004450: 691b ldr r3, [r3, #16]
|
|
8004452: 1c5a adds r2, r3, #1
|
|
8004454: 687b ldr r3, [r7, #4]
|
|
8004456: 655a str r2, [r3, #84] @ 0x54
|
|
hsd->SdCard.BlockNbr *= (1UL << ((pCSD->DeviceSizeMul & 0x07U) + 2U));
|
|
8004458: 683b ldr r3, [r7, #0]
|
|
800445a: 7e1b ldrb r3, [r3, #24]
|
|
800445c: b2db uxtb r3, r3
|
|
800445e: f003 0307 and.w r3, r3, #7
|
|
8004462: 3302 adds r3, #2
|
|
8004464: 2201 movs r2, #1
|
|
8004466: fa02 f303 lsl.w r3, r2, r3
|
|
800446a: 687a ldr r2, [r7, #4]
|
|
800446c: 6d52 ldr r2, [r2, #84] @ 0x54
|
|
800446e: fb03 f202 mul.w r2, r3, r2
|
|
8004472: 687b ldr r3, [r7, #4]
|
|
8004474: 655a str r2, [r3, #84] @ 0x54
|
|
hsd->SdCard.BlockSize = (1UL << (pCSD->RdBlockLen & 0x0FU));
|
|
8004476: 683b ldr r3, [r7, #0]
|
|
8004478: 7a1b ldrb r3, [r3, #8]
|
|
800447a: b2db uxtb r3, r3
|
|
800447c: f003 030f and.w r3, r3, #15
|
|
8004480: 2201 movs r2, #1
|
|
8004482: 409a lsls r2, r3
|
|
8004484: 687b ldr r3, [r7, #4]
|
|
8004486: 659a str r2, [r3, #88] @ 0x58
|
|
|
|
hsd->SdCard.LogBlockNbr = (hsd->SdCard.BlockNbr) * ((hsd->SdCard.BlockSize) / 512U);
|
|
8004488: 687b ldr r3, [r7, #4]
|
|
800448a: 6d5b ldr r3, [r3, #84] @ 0x54
|
|
800448c: 687a ldr r2, [r7, #4]
|
|
800448e: 6d92 ldr r2, [r2, #88] @ 0x58
|
|
8004490: 0a52 lsrs r2, r2, #9
|
|
8004492: fb03 f202 mul.w r2, r3, r2
|
|
8004496: 687b ldr r3, [r7, #4]
|
|
8004498: 65da str r2, [r3, #92] @ 0x5c
|
|
hsd->SdCard.LogBlockSize = 512U;
|
|
800449a: 687b ldr r3, [r7, #4]
|
|
800449c: f44f 7200 mov.w r2, #512 @ 0x200
|
|
80044a0: 661a str r2, [r3, #96] @ 0x60
|
|
80044a2: e031 b.n 8004508 <HAL_SD_GetCardCSD+0x1fc>
|
|
}
|
|
else if(hsd->SdCard.CardType == CARD_SDHC_SDXC)
|
|
80044a4: 687b ldr r3, [r7, #4]
|
|
80044a6: 6c5b ldr r3, [r3, #68] @ 0x44
|
|
80044a8: 2b01 cmp r3, #1
|
|
80044aa: d11d bne.n 80044e8 <HAL_SD_GetCardCSD+0x1dc>
|
|
{
|
|
/* Byte 7 */
|
|
pCSD->DeviceSize = (((hsd->CSD[1] & 0x0000003FU) << 16U) | ((hsd->CSD[2] & 0xFFFF0000U) >> 16U));
|
|
80044ac: 687b ldr r3, [r7, #4]
|
|
80044ae: 6e9b ldr r3, [r3, #104] @ 0x68
|
|
80044b0: 041b lsls r3, r3, #16
|
|
80044b2: f403 127c and.w r2, r3, #4128768 @ 0x3f0000
|
|
80044b6: 687b ldr r3, [r7, #4]
|
|
80044b8: 6edb ldr r3, [r3, #108] @ 0x6c
|
|
80044ba: 0c1b lsrs r3, r3, #16
|
|
80044bc: 431a orrs r2, r3
|
|
80044be: 683b ldr r3, [r7, #0]
|
|
80044c0: 611a str r2, [r3, #16]
|
|
|
|
hsd->SdCard.BlockNbr = ((pCSD->DeviceSize + 1U) * 1024U);
|
|
80044c2: 683b ldr r3, [r7, #0]
|
|
80044c4: 691b ldr r3, [r3, #16]
|
|
80044c6: 3301 adds r3, #1
|
|
80044c8: 029a lsls r2, r3, #10
|
|
80044ca: 687b ldr r3, [r7, #4]
|
|
80044cc: 655a str r2, [r3, #84] @ 0x54
|
|
hsd->SdCard.LogBlockNbr = hsd->SdCard.BlockNbr;
|
|
80044ce: 687b ldr r3, [r7, #4]
|
|
80044d0: 6d5a ldr r2, [r3, #84] @ 0x54
|
|
80044d2: 687b ldr r3, [r7, #4]
|
|
80044d4: 65da str r2, [r3, #92] @ 0x5c
|
|
hsd->SdCard.BlockSize = 512U;
|
|
80044d6: 687b ldr r3, [r7, #4]
|
|
80044d8: f44f 7200 mov.w r2, #512 @ 0x200
|
|
80044dc: 659a str r2, [r3, #88] @ 0x58
|
|
hsd->SdCard.LogBlockSize = hsd->SdCard.BlockSize;
|
|
80044de: 687b ldr r3, [r7, #4]
|
|
80044e0: 6d9a ldr r2, [r3, #88] @ 0x58
|
|
80044e2: 687b ldr r3, [r7, #4]
|
|
80044e4: 661a str r2, [r3, #96] @ 0x60
|
|
80044e6: e00f b.n 8004508 <HAL_SD_GetCardCSD+0x1fc>
|
|
}
|
|
else
|
|
{
|
|
/* Clear all the static flags */
|
|
__HAL_SD_CLEAR_FLAG(hsd, SDIO_STATIC_FLAGS);
|
|
80044e8: 687b ldr r3, [r7, #4]
|
|
80044ea: 681b ldr r3, [r3, #0]
|
|
80044ec: 4a58 ldr r2, [pc, #352] @ (8004650 <HAL_SD_GetCardCSD+0x344>)
|
|
80044ee: 639a str r2, [r3, #56] @ 0x38
|
|
hsd->ErrorCode |= HAL_SD_ERROR_UNSUPPORTED_FEATURE;
|
|
80044f0: 687b ldr r3, [r7, #4]
|
|
80044f2: 6b9b ldr r3, [r3, #56] @ 0x38
|
|
80044f4: f043 5280 orr.w r2, r3, #268435456 @ 0x10000000
|
|
80044f8: 687b ldr r3, [r7, #4]
|
|
80044fa: 639a str r2, [r3, #56] @ 0x38
|
|
hsd->State = HAL_SD_STATE_READY;
|
|
80044fc: 687b ldr r3, [r7, #4]
|
|
80044fe: 2201 movs r2, #1
|
|
8004500: f883 2034 strb.w r2, [r3, #52] @ 0x34
|
|
return HAL_ERROR;
|
|
8004504: 2301 movs r3, #1
|
|
8004506: e09d b.n 8004644 <HAL_SD_GetCardCSD+0x338>
|
|
}
|
|
|
|
pCSD->EraseGrSize = (uint8_t)((hsd->CSD[2] & 0x00004000U) >> 14U);
|
|
8004508: 687b ldr r3, [r7, #4]
|
|
800450a: 6edb ldr r3, [r3, #108] @ 0x6c
|
|
800450c: 0b9b lsrs r3, r3, #14
|
|
800450e: b2db uxtb r3, r3
|
|
8004510: f003 0301 and.w r3, r3, #1
|
|
8004514: b2da uxtb r2, r3
|
|
8004516: 683b ldr r3, [r7, #0]
|
|
8004518: 765a strb r2, [r3, #25]
|
|
|
|
pCSD->EraseGrMul = (uint8_t)((hsd->CSD[2] & 0x00003F80U) >> 7U);
|
|
800451a: 687b ldr r3, [r7, #4]
|
|
800451c: 6edb ldr r3, [r3, #108] @ 0x6c
|
|
800451e: 09db lsrs r3, r3, #7
|
|
8004520: b2db uxtb r3, r3
|
|
8004522: f003 037f and.w r3, r3, #127 @ 0x7f
|
|
8004526: b2da uxtb r2, r3
|
|
8004528: 683b ldr r3, [r7, #0]
|
|
800452a: 769a strb r2, [r3, #26]
|
|
|
|
pCSD->WrProtectGrSize = (uint8_t)(hsd->CSD[2] & 0x0000007FU);
|
|
800452c: 687b ldr r3, [r7, #4]
|
|
800452e: 6edb ldr r3, [r3, #108] @ 0x6c
|
|
8004530: b2db uxtb r3, r3
|
|
8004532: f003 037f and.w r3, r3, #127 @ 0x7f
|
|
8004536: b2da uxtb r2, r3
|
|
8004538: 683b ldr r3, [r7, #0]
|
|
800453a: 76da strb r2, [r3, #27]
|
|
|
|
pCSD->WrProtectGrEnable = (uint8_t)((hsd->CSD[3] & 0x80000000U) >> 31U);
|
|
800453c: 687b ldr r3, [r7, #4]
|
|
800453e: 6f1b ldr r3, [r3, #112] @ 0x70
|
|
8004540: 0fdb lsrs r3, r3, #31
|
|
8004542: b2da uxtb r2, r3
|
|
8004544: 683b ldr r3, [r7, #0]
|
|
8004546: 771a strb r2, [r3, #28]
|
|
|
|
pCSD->ManDeflECC = (uint8_t)((hsd->CSD[3] & 0x60000000U) >> 29U);
|
|
8004548: 687b ldr r3, [r7, #4]
|
|
800454a: 6f1b ldr r3, [r3, #112] @ 0x70
|
|
800454c: 0f5b lsrs r3, r3, #29
|
|
800454e: b2db uxtb r3, r3
|
|
8004550: f003 0303 and.w r3, r3, #3
|
|
8004554: b2da uxtb r2, r3
|
|
8004556: 683b ldr r3, [r7, #0]
|
|
8004558: 775a strb r2, [r3, #29]
|
|
|
|
pCSD->WrSpeedFact = (uint8_t)((hsd->CSD[3] & 0x1C000000U) >> 26U);
|
|
800455a: 687b ldr r3, [r7, #4]
|
|
800455c: 6f1b ldr r3, [r3, #112] @ 0x70
|
|
800455e: 0e9b lsrs r3, r3, #26
|
|
8004560: b2db uxtb r3, r3
|
|
8004562: f003 0307 and.w r3, r3, #7
|
|
8004566: b2da uxtb r2, r3
|
|
8004568: 683b ldr r3, [r7, #0]
|
|
800456a: 779a strb r2, [r3, #30]
|
|
|
|
pCSD->MaxWrBlockLen= (uint8_t)((hsd->CSD[3] & 0x03C00000U) >> 22U);
|
|
800456c: 687b ldr r3, [r7, #4]
|
|
800456e: 6f1b ldr r3, [r3, #112] @ 0x70
|
|
8004570: 0d9b lsrs r3, r3, #22
|
|
8004572: b2db uxtb r3, r3
|
|
8004574: f003 030f and.w r3, r3, #15
|
|
8004578: b2da uxtb r2, r3
|
|
800457a: 683b ldr r3, [r7, #0]
|
|
800457c: 77da strb r2, [r3, #31]
|
|
|
|
pCSD->WriteBlockPaPartial = (uint8_t)((hsd->CSD[3] & 0x00200000U) >> 21U);
|
|
800457e: 687b ldr r3, [r7, #4]
|
|
8004580: 6f1b ldr r3, [r3, #112] @ 0x70
|
|
8004582: 0d5b lsrs r3, r3, #21
|
|
8004584: b2db uxtb r3, r3
|
|
8004586: f003 0301 and.w r3, r3, #1
|
|
800458a: b2da uxtb r2, r3
|
|
800458c: 683b ldr r3, [r7, #0]
|
|
800458e: f883 2020 strb.w r2, [r3, #32]
|
|
|
|
pCSD->Reserved3 = 0;
|
|
8004592: 683b ldr r3, [r7, #0]
|
|
8004594: 2200 movs r2, #0
|
|
8004596: f883 2021 strb.w r2, [r3, #33] @ 0x21
|
|
|
|
pCSD->ContentProtectAppli = (uint8_t)((hsd->CSD[3] & 0x00010000U) >> 16U);
|
|
800459a: 687b ldr r3, [r7, #4]
|
|
800459c: 6f1b ldr r3, [r3, #112] @ 0x70
|
|
800459e: 0c1b lsrs r3, r3, #16
|
|
80045a0: b2db uxtb r3, r3
|
|
80045a2: f003 0301 and.w r3, r3, #1
|
|
80045a6: b2da uxtb r2, r3
|
|
80045a8: 683b ldr r3, [r7, #0]
|
|
80045aa: f883 2022 strb.w r2, [r3, #34] @ 0x22
|
|
|
|
pCSD->FileFormatGroup = (uint8_t)((hsd->CSD[3] & 0x00008000U) >> 15U);
|
|
80045ae: 687b ldr r3, [r7, #4]
|
|
80045b0: 6f1b ldr r3, [r3, #112] @ 0x70
|
|
80045b2: 0bdb lsrs r3, r3, #15
|
|
80045b4: b2db uxtb r3, r3
|
|
80045b6: f003 0301 and.w r3, r3, #1
|
|
80045ba: b2da uxtb r2, r3
|
|
80045bc: 683b ldr r3, [r7, #0]
|
|
80045be: f883 2023 strb.w r2, [r3, #35] @ 0x23
|
|
|
|
pCSD->CopyFlag = (uint8_t)((hsd->CSD[3] & 0x00004000U) >> 14U);
|
|
80045c2: 687b ldr r3, [r7, #4]
|
|
80045c4: 6f1b ldr r3, [r3, #112] @ 0x70
|
|
80045c6: 0b9b lsrs r3, r3, #14
|
|
80045c8: b2db uxtb r3, r3
|
|
80045ca: f003 0301 and.w r3, r3, #1
|
|
80045ce: b2da uxtb r2, r3
|
|
80045d0: 683b ldr r3, [r7, #0]
|
|
80045d2: f883 2024 strb.w r2, [r3, #36] @ 0x24
|
|
|
|
pCSD->PermWrProtect = (uint8_t)((hsd->CSD[3] & 0x00002000U) >> 13U);
|
|
80045d6: 687b ldr r3, [r7, #4]
|
|
80045d8: 6f1b ldr r3, [r3, #112] @ 0x70
|
|
80045da: 0b5b lsrs r3, r3, #13
|
|
80045dc: b2db uxtb r3, r3
|
|
80045de: f003 0301 and.w r3, r3, #1
|
|
80045e2: b2da uxtb r2, r3
|
|
80045e4: 683b ldr r3, [r7, #0]
|
|
80045e6: f883 2025 strb.w r2, [r3, #37] @ 0x25
|
|
|
|
pCSD->TempWrProtect = (uint8_t)((hsd->CSD[3] & 0x00001000U) >> 12U);
|
|
80045ea: 687b ldr r3, [r7, #4]
|
|
80045ec: 6f1b ldr r3, [r3, #112] @ 0x70
|
|
80045ee: 0b1b lsrs r3, r3, #12
|
|
80045f0: b2db uxtb r3, r3
|
|
80045f2: f003 0301 and.w r3, r3, #1
|
|
80045f6: b2da uxtb r2, r3
|
|
80045f8: 683b ldr r3, [r7, #0]
|
|
80045fa: f883 2026 strb.w r2, [r3, #38] @ 0x26
|
|
|
|
pCSD->FileFormat = (uint8_t)((hsd->CSD[3] & 0x00000C00U) >> 10U);
|
|
80045fe: 687b ldr r3, [r7, #4]
|
|
8004600: 6f1b ldr r3, [r3, #112] @ 0x70
|
|
8004602: 0a9b lsrs r3, r3, #10
|
|
8004604: b2db uxtb r3, r3
|
|
8004606: f003 0303 and.w r3, r3, #3
|
|
800460a: b2da uxtb r2, r3
|
|
800460c: 683b ldr r3, [r7, #0]
|
|
800460e: f883 2027 strb.w r2, [r3, #39] @ 0x27
|
|
|
|
pCSD->ECC= (uint8_t)((hsd->CSD[3] & 0x00000300U) >> 8U);
|
|
8004612: 687b ldr r3, [r7, #4]
|
|
8004614: 6f1b ldr r3, [r3, #112] @ 0x70
|
|
8004616: 0a1b lsrs r3, r3, #8
|
|
8004618: b2db uxtb r3, r3
|
|
800461a: f003 0303 and.w r3, r3, #3
|
|
800461e: b2da uxtb r2, r3
|
|
8004620: 683b ldr r3, [r7, #0]
|
|
8004622: f883 2028 strb.w r2, [r3, #40] @ 0x28
|
|
|
|
pCSD->CSD_CRC = (uint8_t)((hsd->CSD[3] & 0x000000FEU) >> 1U);
|
|
8004626: 687b ldr r3, [r7, #4]
|
|
8004628: 6f1b ldr r3, [r3, #112] @ 0x70
|
|
800462a: 085b lsrs r3, r3, #1
|
|
800462c: b2db uxtb r3, r3
|
|
800462e: f003 037f and.w r3, r3, #127 @ 0x7f
|
|
8004632: b2da uxtb r2, r3
|
|
8004634: 683b ldr r3, [r7, #0]
|
|
8004636: f883 2029 strb.w r2, [r3, #41] @ 0x29
|
|
|
|
pCSD->Reserved4 = 1;
|
|
800463a: 683b ldr r3, [r7, #0]
|
|
800463c: 2201 movs r2, #1
|
|
800463e: f883 202a strb.w r2, [r3, #42] @ 0x2a
|
|
|
|
return HAL_OK;
|
|
8004642: 2300 movs r3, #0
|
|
}
|
|
8004644: 4618 mov r0, r3
|
|
8004646: 370c adds r7, #12
|
|
8004648: 46bd mov sp, r7
|
|
800464a: f85d 7b04 ldr.w r7, [sp], #4
|
|
800464e: 4770 bx lr
|
|
8004650: 004005ff .word 0x004005ff
|
|
|
|
08004654 <HAL_SD_ConfigWideBusOperation>:
|
|
* @arg SDIO_BUS_WIDE_4B: 4-bit data transfer
|
|
* @arg SDIO_BUS_WIDE_1B: 1-bit data transfer
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_SD_ConfigWideBusOperation(SD_HandleTypeDef *hsd, uint32_t WideMode)
|
|
{
|
|
8004654: b5b0 push {r4, r5, r7, lr}
|
|
8004656: b08e sub sp, #56 @ 0x38
|
|
8004658: af04 add r7, sp, #16
|
|
800465a: 6078 str r0, [r7, #4]
|
|
800465c: 6039 str r1, [r7, #0]
|
|
SDIO_InitTypeDef Init;
|
|
uint32_t errorstate;
|
|
HAL_StatusTypeDef status = HAL_OK;
|
|
800465e: 2300 movs r3, #0
|
|
8004660: f887 3027 strb.w r3, [r7, #39] @ 0x27
|
|
|
|
/* Check the parameters */
|
|
assert_param(IS_SDIO_BUS_WIDE(WideMode));
|
|
8004664: 683b ldr r3, [r7, #0]
|
|
8004666: 2b00 cmp r3, #0
|
|
8004668: d00c beq.n 8004684 <HAL_SD_ConfigWideBusOperation+0x30>
|
|
800466a: 683b ldr r3, [r7, #0]
|
|
800466c: f5b3 6f00 cmp.w r3, #2048 @ 0x800
|
|
8004670: d008 beq.n 8004684 <HAL_SD_ConfigWideBusOperation+0x30>
|
|
8004672: 683b ldr r3, [r7, #0]
|
|
8004674: f5b3 5f80 cmp.w r3, #4096 @ 0x1000
|
|
8004678: d004 beq.n 8004684 <HAL_SD_ConfigWideBusOperation+0x30>
|
|
800467a: f640 01c7 movw r1, #2247 @ 0x8c7
|
|
800467e: 4849 ldr r0, [pc, #292] @ (80047a4 <HAL_SD_ConfigWideBusOperation+0x150>)
|
|
8004680: f7fc fb58 bl 8000d34 <assert_failed>
|
|
|
|
/* Change State */
|
|
hsd->State = HAL_SD_STATE_BUSY;
|
|
8004684: 687b ldr r3, [r7, #4]
|
|
8004686: 2203 movs r2, #3
|
|
8004688: f883 2034 strb.w r2, [r3, #52] @ 0x34
|
|
|
|
if(hsd->SdCard.CardType != CARD_SECURED)
|
|
800468c: 687b ldr r3, [r7, #4]
|
|
800468e: 6c5b ldr r3, [r3, #68] @ 0x44
|
|
8004690: 2b03 cmp r3, #3
|
|
8004692: d02e beq.n 80046f2 <HAL_SD_ConfigWideBusOperation+0x9e>
|
|
{
|
|
if(WideMode == SDIO_BUS_WIDE_8B)
|
|
8004694: 683b ldr r3, [r7, #0]
|
|
8004696: f5b3 5f80 cmp.w r3, #4096 @ 0x1000
|
|
800469a: d106 bne.n 80046aa <HAL_SD_ConfigWideBusOperation+0x56>
|
|
{
|
|
hsd->ErrorCode |= HAL_SD_ERROR_UNSUPPORTED_FEATURE;
|
|
800469c: 687b ldr r3, [r7, #4]
|
|
800469e: 6b9b ldr r3, [r3, #56] @ 0x38
|
|
80046a0: f043 5280 orr.w r2, r3, #268435456 @ 0x10000000
|
|
80046a4: 687b ldr r3, [r7, #4]
|
|
80046a6: 639a str r2, [r3, #56] @ 0x38
|
|
80046a8: e029 b.n 80046fe <HAL_SD_ConfigWideBusOperation+0xaa>
|
|
}
|
|
else if(WideMode == SDIO_BUS_WIDE_4B)
|
|
80046aa: 683b ldr r3, [r7, #0]
|
|
80046ac: f5b3 6f00 cmp.w r3, #2048 @ 0x800
|
|
80046b0: d10a bne.n 80046c8 <HAL_SD_ConfigWideBusOperation+0x74>
|
|
{
|
|
errorstate = SD_WideBus_Enable(hsd);
|
|
80046b2: 6878 ldr r0, [r7, #4]
|
|
80046b4: f000 fa8c bl 8004bd0 <SD_WideBus_Enable>
|
|
80046b8: 6238 str r0, [r7, #32]
|
|
|
|
hsd->ErrorCode |= errorstate;
|
|
80046ba: 687b ldr r3, [r7, #4]
|
|
80046bc: 6b9a ldr r2, [r3, #56] @ 0x38
|
|
80046be: 6a3b ldr r3, [r7, #32]
|
|
80046c0: 431a orrs r2, r3
|
|
80046c2: 687b ldr r3, [r7, #4]
|
|
80046c4: 639a str r2, [r3, #56] @ 0x38
|
|
80046c6: e01a b.n 80046fe <HAL_SD_ConfigWideBusOperation+0xaa>
|
|
}
|
|
else if(WideMode == SDIO_BUS_WIDE_1B)
|
|
80046c8: 683b ldr r3, [r7, #0]
|
|
80046ca: 2b00 cmp r3, #0
|
|
80046cc: d10a bne.n 80046e4 <HAL_SD_ConfigWideBusOperation+0x90>
|
|
{
|
|
errorstate = SD_WideBus_Disable(hsd);
|
|
80046ce: 6878 ldr r0, [r7, #4]
|
|
80046d0: f000 fac9 bl 8004c66 <SD_WideBus_Disable>
|
|
80046d4: 6238 str r0, [r7, #32]
|
|
|
|
hsd->ErrorCode |= errorstate;
|
|
80046d6: 687b ldr r3, [r7, #4]
|
|
80046d8: 6b9a ldr r2, [r3, #56] @ 0x38
|
|
80046da: 6a3b ldr r3, [r7, #32]
|
|
80046dc: 431a orrs r2, r3
|
|
80046de: 687b ldr r3, [r7, #4]
|
|
80046e0: 639a str r2, [r3, #56] @ 0x38
|
|
80046e2: e00c b.n 80046fe <HAL_SD_ConfigWideBusOperation+0xaa>
|
|
}
|
|
else
|
|
{
|
|
/* WideMode is not a valid argument*/
|
|
hsd->ErrorCode |= HAL_SD_ERROR_PARAM;
|
|
80046e4: 687b ldr r3, [r7, #4]
|
|
80046e6: 6b9b ldr r3, [r3, #56] @ 0x38
|
|
80046e8: f043 6200 orr.w r2, r3, #134217728 @ 0x8000000
|
|
80046ec: 687b ldr r3, [r7, #4]
|
|
80046ee: 639a str r2, [r3, #56] @ 0x38
|
|
80046f0: e005 b.n 80046fe <HAL_SD_ConfigWideBusOperation+0xaa>
|
|
}
|
|
}
|
|
else
|
|
{
|
|
/* MMC Card does not support this feature */
|
|
hsd->ErrorCode |= HAL_SD_ERROR_UNSUPPORTED_FEATURE;
|
|
80046f2: 687b ldr r3, [r7, #4]
|
|
80046f4: 6b9b ldr r3, [r3, #56] @ 0x38
|
|
80046f6: f043 5280 orr.w r2, r3, #268435456 @ 0x10000000
|
|
80046fa: 687b ldr r3, [r7, #4]
|
|
80046fc: 639a str r2, [r3, #56] @ 0x38
|
|
}
|
|
|
|
if(hsd->ErrorCode != HAL_SD_ERROR_NONE)
|
|
80046fe: 687b ldr r3, [r7, #4]
|
|
8004700: 6b9b ldr r3, [r3, #56] @ 0x38
|
|
8004702: 2b00 cmp r3, #0
|
|
8004704: d00b beq.n 800471e <HAL_SD_ConfigWideBusOperation+0xca>
|
|
{
|
|
/* Clear all the static flags */
|
|
__HAL_SD_CLEAR_FLAG(hsd, SDIO_STATIC_FLAGS);
|
|
8004706: 687b ldr r3, [r7, #4]
|
|
8004708: 681b ldr r3, [r3, #0]
|
|
800470a: 4a27 ldr r2, [pc, #156] @ (80047a8 <HAL_SD_ConfigWideBusOperation+0x154>)
|
|
800470c: 639a str r2, [r3, #56] @ 0x38
|
|
hsd->State = HAL_SD_STATE_READY;
|
|
800470e: 687b ldr r3, [r7, #4]
|
|
8004710: 2201 movs r2, #1
|
|
8004712: f883 2034 strb.w r2, [r3, #52] @ 0x34
|
|
status = HAL_ERROR;
|
|
8004716: 2301 movs r3, #1
|
|
8004718: f887 3027 strb.w r3, [r7, #39] @ 0x27
|
|
800471c: e01f b.n 800475e <HAL_SD_ConfigWideBusOperation+0x10a>
|
|
}
|
|
else
|
|
{
|
|
/* Configure the SDIO peripheral */
|
|
Init.ClockEdge = hsd->Init.ClockEdge;
|
|
800471e: 687b ldr r3, [r7, #4]
|
|
8004720: 685b ldr r3, [r3, #4]
|
|
8004722: 60bb str r3, [r7, #8]
|
|
Init.ClockBypass = hsd->Init.ClockBypass;
|
|
8004724: 687b ldr r3, [r7, #4]
|
|
8004726: 689b ldr r3, [r3, #8]
|
|
8004728: 60fb str r3, [r7, #12]
|
|
Init.ClockPowerSave = hsd->Init.ClockPowerSave;
|
|
800472a: 687b ldr r3, [r7, #4]
|
|
800472c: 68db ldr r3, [r3, #12]
|
|
800472e: 613b str r3, [r7, #16]
|
|
Init.BusWide = WideMode;
|
|
8004730: 683b ldr r3, [r7, #0]
|
|
8004732: 617b str r3, [r7, #20]
|
|
Init.HardwareFlowControl = hsd->Init.HardwareFlowControl;
|
|
8004734: 687b ldr r3, [r7, #4]
|
|
8004736: 695b ldr r3, [r3, #20]
|
|
8004738: 61bb str r3, [r7, #24]
|
|
Init.ClockDiv = hsd->Init.ClockDiv;
|
|
800473a: 687b ldr r3, [r7, #4]
|
|
800473c: 699b ldr r3, [r3, #24]
|
|
800473e: 61fb str r3, [r7, #28]
|
|
(void)SDIO_Init(hsd->Instance, Init);
|
|
8004740: 687b ldr r3, [r7, #4]
|
|
8004742: 681d ldr r5, [r3, #0]
|
|
8004744: 466c mov r4, sp
|
|
8004746: f107 0314 add.w r3, r7, #20
|
|
800474a: e893 0007 ldmia.w r3, {r0, r1, r2}
|
|
800474e: e884 0007 stmia.w r4, {r0, r1, r2}
|
|
8004752: f107 0308 add.w r3, r7, #8
|
|
8004756: cb0e ldmia r3, {r1, r2, r3}
|
|
8004758: 4628 mov r0, r5
|
|
800475a: f001 f80d bl 8005778 <SDIO_Init>
|
|
}
|
|
|
|
/* Set Block Size for Card */
|
|
errorstate = SDMMC_CmdBlockLength(hsd->Instance, BLOCKSIZE);
|
|
800475e: 687b ldr r3, [r7, #4]
|
|
8004760: 681b ldr r3, [r3, #0]
|
|
8004762: f44f 7100 mov.w r1, #512 @ 0x200
|
|
8004766: 4618 mov r0, r3
|
|
8004768: f001 f9f0 bl 8005b4c <SDMMC_CmdBlockLength>
|
|
800476c: 6238 str r0, [r7, #32]
|
|
if(errorstate != HAL_SD_ERROR_NONE)
|
|
800476e: 6a3b ldr r3, [r7, #32]
|
|
8004770: 2b00 cmp r3, #0
|
|
8004772: d00c beq.n 800478e <HAL_SD_ConfigWideBusOperation+0x13a>
|
|
{
|
|
/* Clear all the static flags */
|
|
__HAL_SD_CLEAR_FLAG(hsd, SDIO_STATIC_FLAGS);
|
|
8004774: 687b ldr r3, [r7, #4]
|
|
8004776: 681b ldr r3, [r3, #0]
|
|
8004778: 4a0b ldr r2, [pc, #44] @ (80047a8 <HAL_SD_ConfigWideBusOperation+0x154>)
|
|
800477a: 639a str r2, [r3, #56] @ 0x38
|
|
hsd->ErrorCode |= errorstate;
|
|
800477c: 687b ldr r3, [r7, #4]
|
|
800477e: 6b9a ldr r2, [r3, #56] @ 0x38
|
|
8004780: 6a3b ldr r3, [r7, #32]
|
|
8004782: 431a orrs r2, r3
|
|
8004784: 687b ldr r3, [r7, #4]
|
|
8004786: 639a str r2, [r3, #56] @ 0x38
|
|
status = HAL_ERROR;
|
|
8004788: 2301 movs r3, #1
|
|
800478a: f887 3027 strb.w r3, [r7, #39] @ 0x27
|
|
}
|
|
|
|
/* Change State */
|
|
hsd->State = HAL_SD_STATE_READY;
|
|
800478e: 687b ldr r3, [r7, #4]
|
|
8004790: 2201 movs r2, #1
|
|
8004792: f883 2034 strb.w r2, [r3, #52] @ 0x34
|
|
|
|
return status;
|
|
8004796: f897 3027 ldrb.w r3, [r7, #39] @ 0x27
|
|
}
|
|
800479a: 4618 mov r0, r3
|
|
800479c: 3728 adds r7, #40 @ 0x28
|
|
800479e: 46bd mov sp, r7
|
|
80047a0: bdb0 pop {r4, r5, r7, pc}
|
|
80047a2: bf00 nop
|
|
80047a4: 0800a1dc .word 0x0800a1dc
|
|
80047a8: 004005ff .word 0x004005ff
|
|
|
|
080047ac <HAL_SD_GetCardState>:
|
|
* @brief Gets the current sd card data state.
|
|
* @param hsd: pointer to SD handle
|
|
* @retval Card state
|
|
*/
|
|
HAL_SD_CardStateTypeDef HAL_SD_GetCardState(SD_HandleTypeDef *hsd)
|
|
{
|
|
80047ac: b580 push {r7, lr}
|
|
80047ae: b086 sub sp, #24
|
|
80047b0: af00 add r7, sp, #0
|
|
80047b2: 6078 str r0, [r7, #4]
|
|
uint32_t cardstate;
|
|
uint32_t errorstate;
|
|
uint32_t resp1 = 0;
|
|
80047b4: 2300 movs r3, #0
|
|
80047b6: 60fb str r3, [r7, #12]
|
|
|
|
errorstate = SD_SendStatus(hsd, &resp1);
|
|
80047b8: f107 030c add.w r3, r7, #12
|
|
80047bc: 4619 mov r1, r3
|
|
80047be: 6878 ldr r0, [r7, #4]
|
|
80047c0: f000 f9de bl 8004b80 <SD_SendStatus>
|
|
80047c4: 6178 str r0, [r7, #20]
|
|
if(errorstate != HAL_SD_ERROR_NONE)
|
|
80047c6: 697b ldr r3, [r7, #20]
|
|
80047c8: 2b00 cmp r3, #0
|
|
80047ca: d005 beq.n 80047d8 <HAL_SD_GetCardState+0x2c>
|
|
{
|
|
hsd->ErrorCode |= errorstate;
|
|
80047cc: 687b ldr r3, [r7, #4]
|
|
80047ce: 6b9a ldr r2, [r3, #56] @ 0x38
|
|
80047d0: 697b ldr r3, [r7, #20]
|
|
80047d2: 431a orrs r2, r3
|
|
80047d4: 687b ldr r3, [r7, #4]
|
|
80047d6: 639a str r2, [r3, #56] @ 0x38
|
|
}
|
|
|
|
cardstate = ((resp1 >> 9U) & 0x0FU);
|
|
80047d8: 68fb ldr r3, [r7, #12]
|
|
80047da: 0a5b lsrs r3, r3, #9
|
|
80047dc: f003 030f and.w r3, r3, #15
|
|
80047e0: 613b str r3, [r7, #16]
|
|
|
|
return (HAL_SD_CardStateTypeDef)cardstate;
|
|
80047e2: 693b ldr r3, [r7, #16]
|
|
}
|
|
80047e4: 4618 mov r0, r3
|
|
80047e6: 3718 adds r7, #24
|
|
80047e8: 46bd mov sp, r7
|
|
80047ea: bd80 pop {r7, pc}
|
|
|
|
080047ec <SD_DMATxAbort>:
|
|
* @brief DMA SD Tx Abort callback
|
|
* @param hdma: DMA handle
|
|
* @retval None
|
|
*/
|
|
static void SD_DMATxAbort(DMA_HandleTypeDef *hdma)
|
|
{
|
|
80047ec: b580 push {r7, lr}
|
|
80047ee: b084 sub sp, #16
|
|
80047f0: af00 add r7, sp, #0
|
|
80047f2: 6078 str r0, [r7, #4]
|
|
SD_HandleTypeDef* hsd = (SD_HandleTypeDef* )(hdma->Parent);
|
|
80047f4: 687b ldr r3, [r7, #4]
|
|
80047f6: 6b9b ldr r3, [r3, #56] @ 0x38
|
|
80047f8: 60fb str r3, [r7, #12]
|
|
HAL_SD_CardStateTypeDef CardState;
|
|
|
|
/* Clear All flags */
|
|
__HAL_SD_CLEAR_FLAG(hsd, SDIO_STATIC_DATA_FLAGS);
|
|
80047fa: 68fb ldr r3, [r7, #12]
|
|
80047fc: 681b ldr r3, [r3, #0]
|
|
80047fe: f240 523a movw r2, #1338 @ 0x53a
|
|
8004802: 639a str r2, [r3, #56] @ 0x38
|
|
|
|
CardState = HAL_SD_GetCardState(hsd);
|
|
8004804: 68f8 ldr r0, [r7, #12]
|
|
8004806: f7ff ffd1 bl 80047ac <HAL_SD_GetCardState>
|
|
800480a: 60b8 str r0, [r7, #8]
|
|
hsd->State = HAL_SD_STATE_READY;
|
|
800480c: 68fb ldr r3, [r7, #12]
|
|
800480e: 2201 movs r2, #1
|
|
8004810: f883 2034 strb.w r2, [r3, #52] @ 0x34
|
|
hsd->Context = SD_CONTEXT_NONE;
|
|
8004814: 68fb ldr r3, [r7, #12]
|
|
8004816: 2200 movs r2, #0
|
|
8004818: 631a str r2, [r3, #48] @ 0x30
|
|
if((CardState == HAL_SD_CARD_RECEIVING) || (CardState == HAL_SD_CARD_SENDING))
|
|
800481a: 68bb ldr r3, [r7, #8]
|
|
800481c: 2b06 cmp r3, #6
|
|
800481e: d002 beq.n 8004826 <SD_DMATxAbort+0x3a>
|
|
8004820: 68bb ldr r3, [r7, #8]
|
|
8004822: 2b05 cmp r3, #5
|
|
8004824: d10a bne.n 800483c <SD_DMATxAbort+0x50>
|
|
{
|
|
hsd->ErrorCode |= SDMMC_CmdStopTransfer(hsd->Instance);
|
|
8004826: 68fb ldr r3, [r7, #12]
|
|
8004828: 681b ldr r3, [r3, #0]
|
|
800482a: 4618 mov r0, r3
|
|
800482c: f001 f9b0 bl 8005b90 <SDMMC_CmdStopTransfer>
|
|
8004830: 4602 mov r2, r0
|
|
8004832: 68fb ldr r3, [r7, #12]
|
|
8004834: 6b9b ldr r3, [r3, #56] @ 0x38
|
|
8004836: 431a orrs r2, r3
|
|
8004838: 68fb ldr r3, [r7, #12]
|
|
800483a: 639a str r2, [r3, #56] @ 0x38
|
|
}
|
|
|
|
if(hsd->ErrorCode == HAL_SD_ERROR_NONE)
|
|
800483c: 68fb ldr r3, [r7, #12]
|
|
800483e: 6b9b ldr r3, [r3, #56] @ 0x38
|
|
8004840: 2b00 cmp r3, #0
|
|
8004842: d103 bne.n 800484c <SD_DMATxAbort+0x60>
|
|
{
|
|
#if (USE_HAL_SD_REGISTER_CALLBACKS == 1)
|
|
hsd->AbortCpltCallback(hsd);
|
|
#else
|
|
HAL_SD_AbortCallback(hsd);
|
|
8004844: 68f8 ldr r0, [r7, #12]
|
|
8004846: f7ff fd57 bl 80042f8 <HAL_SD_AbortCallback>
|
|
hsd->ErrorCallback(hsd);
|
|
#else
|
|
HAL_SD_ErrorCallback(hsd);
|
|
#endif
|
|
}
|
|
}
|
|
800484a: e002 b.n 8004852 <SD_DMATxAbort+0x66>
|
|
HAL_SD_ErrorCallback(hsd);
|
|
800484c: 68f8 ldr r0, [r7, #12]
|
|
800484e: f7ff fd49 bl 80042e4 <HAL_SD_ErrorCallback>
|
|
}
|
|
8004852: bf00 nop
|
|
8004854: 3710 adds r7, #16
|
|
8004856: 46bd mov sp, r7
|
|
8004858: bd80 pop {r7, pc}
|
|
|
|
0800485a <SD_DMARxAbort>:
|
|
* @brief DMA SD Rx Abort callback
|
|
* @param hdma: DMA handle
|
|
* @retval None
|
|
*/
|
|
static void SD_DMARxAbort(DMA_HandleTypeDef *hdma)
|
|
{
|
|
800485a: b580 push {r7, lr}
|
|
800485c: b084 sub sp, #16
|
|
800485e: af00 add r7, sp, #0
|
|
8004860: 6078 str r0, [r7, #4]
|
|
SD_HandleTypeDef* hsd = (SD_HandleTypeDef* )(hdma->Parent);
|
|
8004862: 687b ldr r3, [r7, #4]
|
|
8004864: 6b9b ldr r3, [r3, #56] @ 0x38
|
|
8004866: 60fb str r3, [r7, #12]
|
|
HAL_SD_CardStateTypeDef CardState;
|
|
|
|
/* Clear All flags */
|
|
__HAL_SD_CLEAR_FLAG(hsd, SDIO_STATIC_DATA_FLAGS);
|
|
8004868: 68fb ldr r3, [r7, #12]
|
|
800486a: 681b ldr r3, [r3, #0]
|
|
800486c: f240 523a movw r2, #1338 @ 0x53a
|
|
8004870: 639a str r2, [r3, #56] @ 0x38
|
|
|
|
CardState = HAL_SD_GetCardState(hsd);
|
|
8004872: 68f8 ldr r0, [r7, #12]
|
|
8004874: f7ff ff9a bl 80047ac <HAL_SD_GetCardState>
|
|
8004878: 60b8 str r0, [r7, #8]
|
|
hsd->State = HAL_SD_STATE_READY;
|
|
800487a: 68fb ldr r3, [r7, #12]
|
|
800487c: 2201 movs r2, #1
|
|
800487e: f883 2034 strb.w r2, [r3, #52] @ 0x34
|
|
hsd->Context = SD_CONTEXT_NONE;
|
|
8004882: 68fb ldr r3, [r7, #12]
|
|
8004884: 2200 movs r2, #0
|
|
8004886: 631a str r2, [r3, #48] @ 0x30
|
|
if((CardState == HAL_SD_CARD_RECEIVING) || (CardState == HAL_SD_CARD_SENDING))
|
|
8004888: 68bb ldr r3, [r7, #8]
|
|
800488a: 2b06 cmp r3, #6
|
|
800488c: d002 beq.n 8004894 <SD_DMARxAbort+0x3a>
|
|
800488e: 68bb ldr r3, [r7, #8]
|
|
8004890: 2b05 cmp r3, #5
|
|
8004892: d10a bne.n 80048aa <SD_DMARxAbort+0x50>
|
|
{
|
|
hsd->ErrorCode |= SDMMC_CmdStopTransfer(hsd->Instance);
|
|
8004894: 68fb ldr r3, [r7, #12]
|
|
8004896: 681b ldr r3, [r3, #0]
|
|
8004898: 4618 mov r0, r3
|
|
800489a: f001 f979 bl 8005b90 <SDMMC_CmdStopTransfer>
|
|
800489e: 4602 mov r2, r0
|
|
80048a0: 68fb ldr r3, [r7, #12]
|
|
80048a2: 6b9b ldr r3, [r3, #56] @ 0x38
|
|
80048a4: 431a orrs r2, r3
|
|
80048a6: 68fb ldr r3, [r7, #12]
|
|
80048a8: 639a str r2, [r3, #56] @ 0x38
|
|
}
|
|
|
|
if(hsd->ErrorCode == HAL_SD_ERROR_NONE)
|
|
80048aa: 68fb ldr r3, [r7, #12]
|
|
80048ac: 6b9b ldr r3, [r3, #56] @ 0x38
|
|
80048ae: 2b00 cmp r3, #0
|
|
80048b0: d103 bne.n 80048ba <SD_DMARxAbort+0x60>
|
|
{
|
|
#if (USE_HAL_SD_REGISTER_CALLBACKS == 1)
|
|
hsd->AbortCpltCallback(hsd);
|
|
#else
|
|
HAL_SD_AbortCallback(hsd);
|
|
80048b2: 68f8 ldr r0, [r7, #12]
|
|
80048b4: f7ff fd20 bl 80042f8 <HAL_SD_AbortCallback>
|
|
hsd->ErrorCallback(hsd);
|
|
#else
|
|
HAL_SD_ErrorCallback(hsd);
|
|
#endif
|
|
}
|
|
}
|
|
80048b8: e002 b.n 80048c0 <SD_DMARxAbort+0x66>
|
|
HAL_SD_ErrorCallback(hsd);
|
|
80048ba: 68f8 ldr r0, [r7, #12]
|
|
80048bc: f7ff fd12 bl 80042e4 <HAL_SD_ErrorCallback>
|
|
}
|
|
80048c0: bf00 nop
|
|
80048c2: 3710 adds r7, #16
|
|
80048c4: 46bd mov sp, r7
|
|
80048c6: bd80 pop {r7, pc}
|
|
|
|
080048c8 <SD_InitCard>:
|
|
* @brief Initializes the sd card.
|
|
* @param hsd: Pointer to SD handle
|
|
* @retval SD Card error state
|
|
*/
|
|
static uint32_t SD_InitCard(SD_HandleTypeDef *hsd)
|
|
{
|
|
80048c8: b5b0 push {r4, r5, r7, lr}
|
|
80048ca: b094 sub sp, #80 @ 0x50
|
|
80048cc: af04 add r7, sp, #16
|
|
80048ce: 6078 str r0, [r7, #4]
|
|
HAL_SD_CardCSDTypeDef CSD;
|
|
uint32_t errorstate;
|
|
uint16_t sd_rca = 1U;
|
|
80048d0: 2301 movs r3, #1
|
|
80048d2: 81fb strh r3, [r7, #14]
|
|
|
|
/* Check the power State */
|
|
if(SDIO_GetPowerState(hsd->Instance) == 0U)
|
|
80048d4: 687b ldr r3, [r7, #4]
|
|
80048d6: 681b ldr r3, [r3, #0]
|
|
80048d8: 4618 mov r0, r3
|
|
80048da: f000 fff3 bl 80058c4 <SDIO_GetPowerState>
|
|
80048de: 4603 mov r3, r0
|
|
80048e0: 2b00 cmp r3, #0
|
|
80048e2: d102 bne.n 80048ea <SD_InitCard+0x22>
|
|
{
|
|
/* Power off */
|
|
return HAL_SD_ERROR_REQUEST_NOT_APPLICABLE;
|
|
80048e4: f04f 6380 mov.w r3, #67108864 @ 0x4000000
|
|
80048e8: e0b8 b.n 8004a5c <SD_InitCard+0x194>
|
|
}
|
|
|
|
if(hsd->SdCard.CardType != CARD_SECURED)
|
|
80048ea: 687b ldr r3, [r7, #4]
|
|
80048ec: 6c5b ldr r3, [r3, #68] @ 0x44
|
|
80048ee: 2b03 cmp r3, #3
|
|
80048f0: d02f beq.n 8004952 <SD_InitCard+0x8a>
|
|
{
|
|
/* Send CMD2 ALL_SEND_CID */
|
|
errorstate = SDMMC_CmdSendCID(hsd->Instance);
|
|
80048f2: 687b ldr r3, [r7, #4]
|
|
80048f4: 681b ldr r3, [r3, #0]
|
|
80048f6: 4618 mov r0, r3
|
|
80048f8: f001 fa54 bl 8005da4 <SDMMC_CmdSendCID>
|
|
80048fc: 63f8 str r0, [r7, #60] @ 0x3c
|
|
if(errorstate != HAL_SD_ERROR_NONE)
|
|
80048fe: 6bfb ldr r3, [r7, #60] @ 0x3c
|
|
8004900: 2b00 cmp r3, #0
|
|
8004902: d001 beq.n 8004908 <SD_InitCard+0x40>
|
|
{
|
|
return errorstate;
|
|
8004904: 6bfb ldr r3, [r7, #60] @ 0x3c
|
|
8004906: e0a9 b.n 8004a5c <SD_InitCard+0x194>
|
|
}
|
|
else
|
|
{
|
|
/* Get Card identification number data */
|
|
hsd->CID[0U] = SDIO_GetResponse(hsd->Instance, SDIO_RESP1);
|
|
8004908: 687b ldr r3, [r7, #4]
|
|
800490a: 681b ldr r3, [r3, #0]
|
|
800490c: 2100 movs r1, #0
|
|
800490e: 4618 mov r0, r3
|
|
8004910: f001 f85a bl 80059c8 <SDIO_GetResponse>
|
|
8004914: 4602 mov r2, r0
|
|
8004916: 687b ldr r3, [r7, #4]
|
|
8004918: 675a str r2, [r3, #116] @ 0x74
|
|
hsd->CID[1U] = SDIO_GetResponse(hsd->Instance, SDIO_RESP2);
|
|
800491a: 687b ldr r3, [r7, #4]
|
|
800491c: 681b ldr r3, [r3, #0]
|
|
800491e: 2104 movs r1, #4
|
|
8004920: 4618 mov r0, r3
|
|
8004922: f001 f851 bl 80059c8 <SDIO_GetResponse>
|
|
8004926: 4602 mov r2, r0
|
|
8004928: 687b ldr r3, [r7, #4]
|
|
800492a: 679a str r2, [r3, #120] @ 0x78
|
|
hsd->CID[2U] = SDIO_GetResponse(hsd->Instance, SDIO_RESP3);
|
|
800492c: 687b ldr r3, [r7, #4]
|
|
800492e: 681b ldr r3, [r3, #0]
|
|
8004930: 2108 movs r1, #8
|
|
8004932: 4618 mov r0, r3
|
|
8004934: f001 f848 bl 80059c8 <SDIO_GetResponse>
|
|
8004938: 4602 mov r2, r0
|
|
800493a: 687b ldr r3, [r7, #4]
|
|
800493c: 67da str r2, [r3, #124] @ 0x7c
|
|
hsd->CID[3U] = SDIO_GetResponse(hsd->Instance, SDIO_RESP4);
|
|
800493e: 687b ldr r3, [r7, #4]
|
|
8004940: 681b ldr r3, [r3, #0]
|
|
8004942: 210c movs r1, #12
|
|
8004944: 4618 mov r0, r3
|
|
8004946: f001 f83f bl 80059c8 <SDIO_GetResponse>
|
|
800494a: 4602 mov r2, r0
|
|
800494c: 687b ldr r3, [r7, #4]
|
|
800494e: f8c3 2080 str.w r2, [r3, #128] @ 0x80
|
|
}
|
|
}
|
|
|
|
if(hsd->SdCard.CardType != CARD_SECURED)
|
|
8004952: 687b ldr r3, [r7, #4]
|
|
8004954: 6c5b ldr r3, [r3, #68] @ 0x44
|
|
8004956: 2b03 cmp r3, #3
|
|
8004958: d00d beq.n 8004976 <SD_InitCard+0xae>
|
|
{
|
|
/* Send CMD3 SET_REL_ADDR with argument 0 */
|
|
/* SD Card publishes its RCA. */
|
|
errorstate = SDMMC_CmdSetRelAdd(hsd->Instance, &sd_rca);
|
|
800495a: 687b ldr r3, [r7, #4]
|
|
800495c: 681b ldr r3, [r3, #0]
|
|
800495e: f107 020e add.w r2, r7, #14
|
|
8004962: 4611 mov r1, r2
|
|
8004964: 4618 mov r0, r3
|
|
8004966: f001 fa5a bl 8005e1e <SDMMC_CmdSetRelAdd>
|
|
800496a: 63f8 str r0, [r7, #60] @ 0x3c
|
|
if(errorstate != HAL_SD_ERROR_NONE)
|
|
800496c: 6bfb ldr r3, [r7, #60] @ 0x3c
|
|
800496e: 2b00 cmp r3, #0
|
|
8004970: d001 beq.n 8004976 <SD_InitCard+0xae>
|
|
{
|
|
return errorstate;
|
|
8004972: 6bfb ldr r3, [r7, #60] @ 0x3c
|
|
8004974: e072 b.n 8004a5c <SD_InitCard+0x194>
|
|
}
|
|
}
|
|
if(hsd->SdCard.CardType != CARD_SECURED)
|
|
8004976: 687b ldr r3, [r7, #4]
|
|
8004978: 6c5b ldr r3, [r3, #68] @ 0x44
|
|
800497a: 2b03 cmp r3, #3
|
|
800497c: d036 beq.n 80049ec <SD_InitCard+0x124>
|
|
{
|
|
/* Get the SD card RCA */
|
|
hsd->SdCard.RelCardAdd = sd_rca;
|
|
800497e: 89fb ldrh r3, [r7, #14]
|
|
8004980: 461a mov r2, r3
|
|
8004982: 687b ldr r3, [r7, #4]
|
|
8004984: 651a str r2, [r3, #80] @ 0x50
|
|
|
|
/* Send CMD9 SEND_CSD with argument as card's RCA */
|
|
errorstate = SDMMC_CmdSendCSD(hsd->Instance, (uint32_t)(hsd->SdCard.RelCardAdd << 16U));
|
|
8004986: 687b ldr r3, [r7, #4]
|
|
8004988: 681a ldr r2, [r3, #0]
|
|
800498a: 687b ldr r3, [r7, #4]
|
|
800498c: 6d1b ldr r3, [r3, #80] @ 0x50
|
|
800498e: 041b lsls r3, r3, #16
|
|
8004990: 4619 mov r1, r3
|
|
8004992: 4610 mov r0, r2
|
|
8004994: f001 fa24 bl 8005de0 <SDMMC_CmdSendCSD>
|
|
8004998: 63f8 str r0, [r7, #60] @ 0x3c
|
|
if(errorstate != HAL_SD_ERROR_NONE)
|
|
800499a: 6bfb ldr r3, [r7, #60] @ 0x3c
|
|
800499c: 2b00 cmp r3, #0
|
|
800499e: d001 beq.n 80049a4 <SD_InitCard+0xdc>
|
|
{
|
|
return errorstate;
|
|
80049a0: 6bfb ldr r3, [r7, #60] @ 0x3c
|
|
80049a2: e05b b.n 8004a5c <SD_InitCard+0x194>
|
|
}
|
|
else
|
|
{
|
|
/* Get Card Specific Data */
|
|
hsd->CSD[0U] = SDIO_GetResponse(hsd->Instance, SDIO_RESP1);
|
|
80049a4: 687b ldr r3, [r7, #4]
|
|
80049a6: 681b ldr r3, [r3, #0]
|
|
80049a8: 2100 movs r1, #0
|
|
80049aa: 4618 mov r0, r3
|
|
80049ac: f001 f80c bl 80059c8 <SDIO_GetResponse>
|
|
80049b0: 4602 mov r2, r0
|
|
80049b2: 687b ldr r3, [r7, #4]
|
|
80049b4: 665a str r2, [r3, #100] @ 0x64
|
|
hsd->CSD[1U] = SDIO_GetResponse(hsd->Instance, SDIO_RESP2);
|
|
80049b6: 687b ldr r3, [r7, #4]
|
|
80049b8: 681b ldr r3, [r3, #0]
|
|
80049ba: 2104 movs r1, #4
|
|
80049bc: 4618 mov r0, r3
|
|
80049be: f001 f803 bl 80059c8 <SDIO_GetResponse>
|
|
80049c2: 4602 mov r2, r0
|
|
80049c4: 687b ldr r3, [r7, #4]
|
|
80049c6: 669a str r2, [r3, #104] @ 0x68
|
|
hsd->CSD[2U] = SDIO_GetResponse(hsd->Instance, SDIO_RESP3);
|
|
80049c8: 687b ldr r3, [r7, #4]
|
|
80049ca: 681b ldr r3, [r3, #0]
|
|
80049cc: 2108 movs r1, #8
|
|
80049ce: 4618 mov r0, r3
|
|
80049d0: f000 fffa bl 80059c8 <SDIO_GetResponse>
|
|
80049d4: 4602 mov r2, r0
|
|
80049d6: 687b ldr r3, [r7, #4]
|
|
80049d8: 66da str r2, [r3, #108] @ 0x6c
|
|
hsd->CSD[3U] = SDIO_GetResponse(hsd->Instance, SDIO_RESP4);
|
|
80049da: 687b ldr r3, [r7, #4]
|
|
80049dc: 681b ldr r3, [r3, #0]
|
|
80049de: 210c movs r1, #12
|
|
80049e0: 4618 mov r0, r3
|
|
80049e2: f000 fff1 bl 80059c8 <SDIO_GetResponse>
|
|
80049e6: 4602 mov r2, r0
|
|
80049e8: 687b ldr r3, [r7, #4]
|
|
80049ea: 671a str r2, [r3, #112] @ 0x70
|
|
}
|
|
}
|
|
|
|
/* Get the Card Class */
|
|
hsd->SdCard.Class = (SDIO_GetResponse(hsd->Instance, SDIO_RESP2) >> 20U);
|
|
80049ec: 687b ldr r3, [r7, #4]
|
|
80049ee: 681b ldr r3, [r3, #0]
|
|
80049f0: 2104 movs r1, #4
|
|
80049f2: 4618 mov r0, r3
|
|
80049f4: f000 ffe8 bl 80059c8 <SDIO_GetResponse>
|
|
80049f8: 4603 mov r3, r0
|
|
80049fa: 0d1a lsrs r2, r3, #20
|
|
80049fc: 687b ldr r3, [r7, #4]
|
|
80049fe: 64da str r2, [r3, #76] @ 0x4c
|
|
|
|
/* Get CSD parameters */
|
|
if (HAL_SD_GetCardCSD(hsd, &CSD) != HAL_OK)
|
|
8004a00: f107 0310 add.w r3, r7, #16
|
|
8004a04: 4619 mov r1, r3
|
|
8004a06: 6878 ldr r0, [r7, #4]
|
|
8004a08: f7ff fc80 bl 800430c <HAL_SD_GetCardCSD>
|
|
8004a0c: 4603 mov r3, r0
|
|
8004a0e: 2b00 cmp r3, #0
|
|
8004a10: d002 beq.n 8004a18 <SD_InitCard+0x150>
|
|
{
|
|
return HAL_SD_ERROR_UNSUPPORTED_FEATURE;
|
|
8004a12: f04f 5380 mov.w r3, #268435456 @ 0x10000000
|
|
8004a16: e021 b.n 8004a5c <SD_InitCard+0x194>
|
|
}
|
|
|
|
/* Select the Card */
|
|
errorstate = SDMMC_CmdSelDesel(hsd->Instance, (uint32_t)(((uint32_t)hsd->SdCard.RelCardAdd) << 16U));
|
|
8004a18: 687b ldr r3, [r7, #4]
|
|
8004a1a: 6819 ldr r1, [r3, #0]
|
|
8004a1c: 687b ldr r3, [r7, #4]
|
|
8004a1e: 6d1b ldr r3, [r3, #80] @ 0x50
|
|
8004a20: 041b lsls r3, r3, #16
|
|
8004a22: 2200 movs r2, #0
|
|
8004a24: 461c mov r4, r3
|
|
8004a26: 4615 mov r5, r2
|
|
8004a28: 4622 mov r2, r4
|
|
8004a2a: 462b mov r3, r5
|
|
8004a2c: 4608 mov r0, r1
|
|
8004a2e: f001 f8d1 bl 8005bd4 <SDMMC_CmdSelDesel>
|
|
8004a32: 63f8 str r0, [r7, #60] @ 0x3c
|
|
if(errorstate != HAL_SD_ERROR_NONE)
|
|
8004a34: 6bfb ldr r3, [r7, #60] @ 0x3c
|
|
8004a36: 2b00 cmp r3, #0
|
|
8004a38: d001 beq.n 8004a3e <SD_InitCard+0x176>
|
|
{
|
|
return errorstate;
|
|
8004a3a: 6bfb ldr r3, [r7, #60] @ 0x3c
|
|
8004a3c: e00e b.n 8004a5c <SD_InitCard+0x194>
|
|
}
|
|
|
|
/* Configure SDIO peripheral interface */
|
|
(void)SDIO_Init(hsd->Instance, hsd->Init);
|
|
8004a3e: 687b ldr r3, [r7, #4]
|
|
8004a40: 681d ldr r5, [r3, #0]
|
|
8004a42: 687b ldr r3, [r7, #4]
|
|
8004a44: 466c mov r4, sp
|
|
8004a46: f103 0210 add.w r2, r3, #16
|
|
8004a4a: ca07 ldmia r2, {r0, r1, r2}
|
|
8004a4c: e884 0007 stmia.w r4, {r0, r1, r2}
|
|
8004a50: 3304 adds r3, #4
|
|
8004a52: cb0e ldmia r3, {r1, r2, r3}
|
|
8004a54: 4628 mov r0, r5
|
|
8004a56: f000 fe8f bl 8005778 <SDIO_Init>
|
|
|
|
/* All cards are initialized */
|
|
return HAL_SD_ERROR_NONE;
|
|
8004a5a: 2300 movs r3, #0
|
|
}
|
|
8004a5c: 4618 mov r0, r3
|
|
8004a5e: 3740 adds r7, #64 @ 0x40
|
|
8004a60: 46bd mov sp, r7
|
|
8004a62: bdb0 pop {r4, r5, r7, pc}
|
|
|
|
08004a64 <SD_PowerON>:
|
|
* in the SD handle.
|
|
* @param hsd: Pointer to SD handle
|
|
* @retval error state
|
|
*/
|
|
static uint32_t SD_PowerON(SD_HandleTypeDef *hsd)
|
|
{
|
|
8004a64: b580 push {r7, lr}
|
|
8004a66: b086 sub sp, #24
|
|
8004a68: af00 add r7, sp, #0
|
|
8004a6a: 6078 str r0, [r7, #4]
|
|
__IO uint32_t count = 0U;
|
|
8004a6c: 2300 movs r3, #0
|
|
8004a6e: 60bb str r3, [r7, #8]
|
|
uint32_t response = 0U, validvoltage = 0U;
|
|
8004a70: 2300 movs r3, #0
|
|
8004a72: 617b str r3, [r7, #20]
|
|
8004a74: 2300 movs r3, #0
|
|
8004a76: 613b str r3, [r7, #16]
|
|
uint32_t errorstate;
|
|
|
|
/* CMD0: GO_IDLE_STATE */
|
|
errorstate = SDMMC_CmdGoIdleState(hsd->Instance);
|
|
8004a78: 687b ldr r3, [r7, #4]
|
|
8004a7a: 681b ldr r3, [r3, #0]
|
|
8004a7c: 4618 mov r0, r3
|
|
8004a7e: f001 f8cc bl 8005c1a <SDMMC_CmdGoIdleState>
|
|
8004a82: 60f8 str r0, [r7, #12]
|
|
if(errorstate != HAL_SD_ERROR_NONE)
|
|
8004a84: 68fb ldr r3, [r7, #12]
|
|
8004a86: 2b00 cmp r3, #0
|
|
8004a88: d001 beq.n 8004a8e <SD_PowerON+0x2a>
|
|
{
|
|
return errorstate;
|
|
8004a8a: 68fb ldr r3, [r7, #12]
|
|
8004a8c: e072 b.n 8004b74 <SD_PowerON+0x110>
|
|
}
|
|
|
|
/* CMD8: SEND_IF_COND: Command available only on V2.0 cards */
|
|
errorstate = SDMMC_CmdOperCond(hsd->Instance);
|
|
8004a8e: 687b ldr r3, [r7, #4]
|
|
8004a90: 681b ldr r3, [r3, #0]
|
|
8004a92: 4618 mov r0, r3
|
|
8004a94: f001 f8df bl 8005c56 <SDMMC_CmdOperCond>
|
|
8004a98: 60f8 str r0, [r7, #12]
|
|
if(errorstate != HAL_SD_ERROR_NONE)
|
|
8004a9a: 68fb ldr r3, [r7, #12]
|
|
8004a9c: 2b00 cmp r3, #0
|
|
8004a9e: d00d beq.n 8004abc <SD_PowerON+0x58>
|
|
{
|
|
hsd->SdCard.CardVersion = CARD_V1_X;
|
|
8004aa0: 687b ldr r3, [r7, #4]
|
|
8004aa2: 2200 movs r2, #0
|
|
8004aa4: 649a str r2, [r3, #72] @ 0x48
|
|
/* CMD0: GO_IDLE_STATE */
|
|
errorstate = SDMMC_CmdGoIdleState(hsd->Instance);
|
|
8004aa6: 687b ldr r3, [r7, #4]
|
|
8004aa8: 681b ldr r3, [r3, #0]
|
|
8004aaa: 4618 mov r0, r3
|
|
8004aac: f001 f8b5 bl 8005c1a <SDMMC_CmdGoIdleState>
|
|
8004ab0: 60f8 str r0, [r7, #12]
|
|
if(errorstate != HAL_SD_ERROR_NONE)
|
|
8004ab2: 68fb ldr r3, [r7, #12]
|
|
8004ab4: 2b00 cmp r3, #0
|
|
8004ab6: d004 beq.n 8004ac2 <SD_PowerON+0x5e>
|
|
{
|
|
return errorstate;
|
|
8004ab8: 68fb ldr r3, [r7, #12]
|
|
8004aba: e05b b.n 8004b74 <SD_PowerON+0x110>
|
|
}
|
|
|
|
}
|
|
else
|
|
{
|
|
hsd->SdCard.CardVersion = CARD_V2_X;
|
|
8004abc: 687b ldr r3, [r7, #4]
|
|
8004abe: 2201 movs r2, #1
|
|
8004ac0: 649a str r2, [r3, #72] @ 0x48
|
|
}
|
|
|
|
if( hsd->SdCard.CardVersion == CARD_V2_X)
|
|
8004ac2: 687b ldr r3, [r7, #4]
|
|
8004ac4: 6c9b ldr r3, [r3, #72] @ 0x48
|
|
8004ac6: 2b01 cmp r3, #1
|
|
8004ac8: d137 bne.n 8004b3a <SD_PowerON+0xd6>
|
|
{
|
|
/* SEND CMD55 APP_CMD with RCA as 0 */
|
|
errorstate = SDMMC_CmdAppCommand(hsd->Instance, 0);
|
|
8004aca: 687b ldr r3, [r7, #4]
|
|
8004acc: 681b ldr r3, [r3, #0]
|
|
8004ace: 2100 movs r1, #0
|
|
8004ad0: 4618 mov r0, r3
|
|
8004ad2: f001 f8df bl 8005c94 <SDMMC_CmdAppCommand>
|
|
8004ad6: 60f8 str r0, [r7, #12]
|
|
if(errorstate != HAL_SD_ERROR_NONE)
|
|
8004ad8: 68fb ldr r3, [r7, #12]
|
|
8004ada: 2b00 cmp r3, #0
|
|
8004adc: d02d beq.n 8004b3a <SD_PowerON+0xd6>
|
|
{
|
|
return HAL_SD_ERROR_UNSUPPORTED_FEATURE;
|
|
8004ade: f04f 5380 mov.w r3, #268435456 @ 0x10000000
|
|
8004ae2: e047 b.n 8004b74 <SD_PowerON+0x110>
|
|
/* SD CARD */
|
|
/* Send ACMD41 SD_APP_OP_COND with Argument 0x80100000 */
|
|
while((count < SDMMC_MAX_VOLT_TRIAL) && (validvoltage == 0U))
|
|
{
|
|
/* SEND CMD55 APP_CMD with RCA as 0 */
|
|
errorstate = SDMMC_CmdAppCommand(hsd->Instance, 0);
|
|
8004ae4: 687b ldr r3, [r7, #4]
|
|
8004ae6: 681b ldr r3, [r3, #0]
|
|
8004ae8: 2100 movs r1, #0
|
|
8004aea: 4618 mov r0, r3
|
|
8004aec: f001 f8d2 bl 8005c94 <SDMMC_CmdAppCommand>
|
|
8004af0: 60f8 str r0, [r7, #12]
|
|
if(errorstate != HAL_SD_ERROR_NONE)
|
|
8004af2: 68fb ldr r3, [r7, #12]
|
|
8004af4: 2b00 cmp r3, #0
|
|
8004af6: d001 beq.n 8004afc <SD_PowerON+0x98>
|
|
{
|
|
return errorstate;
|
|
8004af8: 68fb ldr r3, [r7, #12]
|
|
8004afa: e03b b.n 8004b74 <SD_PowerON+0x110>
|
|
}
|
|
|
|
/* Send CMD41 */
|
|
errorstate = SDMMC_CmdAppOperCommand(hsd->Instance, SDMMC_VOLTAGE_WINDOW_SD | SDMMC_HIGH_CAPACITY | SD_SWITCH_1_8V_CAPACITY);
|
|
8004afc: 687b ldr r3, [r7, #4]
|
|
8004afe: 681b ldr r3, [r3, #0]
|
|
8004b00: 491e ldr r1, [pc, #120] @ (8004b7c <SD_PowerON+0x118>)
|
|
8004b02: 4618 mov r0, r3
|
|
8004b04: f001 f8e8 bl 8005cd8 <SDMMC_CmdAppOperCommand>
|
|
8004b08: 60f8 str r0, [r7, #12]
|
|
if(errorstate != HAL_SD_ERROR_NONE)
|
|
8004b0a: 68fb ldr r3, [r7, #12]
|
|
8004b0c: 2b00 cmp r3, #0
|
|
8004b0e: d002 beq.n 8004b16 <SD_PowerON+0xb2>
|
|
{
|
|
return HAL_SD_ERROR_UNSUPPORTED_FEATURE;
|
|
8004b10: f04f 5380 mov.w r3, #268435456 @ 0x10000000
|
|
8004b14: e02e b.n 8004b74 <SD_PowerON+0x110>
|
|
}
|
|
|
|
/* Get command response */
|
|
response = SDIO_GetResponse(hsd->Instance, SDIO_RESP1);
|
|
8004b16: 687b ldr r3, [r7, #4]
|
|
8004b18: 681b ldr r3, [r3, #0]
|
|
8004b1a: 2100 movs r1, #0
|
|
8004b1c: 4618 mov r0, r3
|
|
8004b1e: f000 ff53 bl 80059c8 <SDIO_GetResponse>
|
|
8004b22: 6178 str r0, [r7, #20]
|
|
|
|
/* Get operating voltage*/
|
|
validvoltage = (((response >> 31U) == 1U) ? 1U : 0U);
|
|
8004b24: 697b ldr r3, [r7, #20]
|
|
8004b26: 0fdb lsrs r3, r3, #31
|
|
8004b28: 2b01 cmp r3, #1
|
|
8004b2a: d101 bne.n 8004b30 <SD_PowerON+0xcc>
|
|
8004b2c: 2301 movs r3, #1
|
|
8004b2e: e000 b.n 8004b32 <SD_PowerON+0xce>
|
|
8004b30: 2300 movs r3, #0
|
|
8004b32: 613b str r3, [r7, #16]
|
|
|
|
count++;
|
|
8004b34: 68bb ldr r3, [r7, #8]
|
|
8004b36: 3301 adds r3, #1
|
|
8004b38: 60bb str r3, [r7, #8]
|
|
while((count < SDMMC_MAX_VOLT_TRIAL) && (validvoltage == 0U))
|
|
8004b3a: 68bb ldr r3, [r7, #8]
|
|
8004b3c: f64f 72fe movw r2, #65534 @ 0xfffe
|
|
8004b40: 4293 cmp r3, r2
|
|
8004b42: d802 bhi.n 8004b4a <SD_PowerON+0xe6>
|
|
8004b44: 693b ldr r3, [r7, #16]
|
|
8004b46: 2b00 cmp r3, #0
|
|
8004b48: d0cc beq.n 8004ae4 <SD_PowerON+0x80>
|
|
}
|
|
|
|
if(count >= SDMMC_MAX_VOLT_TRIAL)
|
|
8004b4a: 68bb ldr r3, [r7, #8]
|
|
8004b4c: f64f 72fe movw r2, #65534 @ 0xfffe
|
|
8004b50: 4293 cmp r3, r2
|
|
8004b52: d902 bls.n 8004b5a <SD_PowerON+0xf6>
|
|
{
|
|
return HAL_SD_ERROR_INVALID_VOLTRANGE;
|
|
8004b54: f04f 7380 mov.w r3, #16777216 @ 0x1000000
|
|
8004b58: e00c b.n 8004b74 <SD_PowerON+0x110>
|
|
}
|
|
|
|
if((response & SDMMC_HIGH_CAPACITY) == SDMMC_HIGH_CAPACITY) /* (response &= SD_HIGH_CAPACITY) */
|
|
8004b5a: 697b ldr r3, [r7, #20]
|
|
8004b5c: f003 4380 and.w r3, r3, #1073741824 @ 0x40000000
|
|
8004b60: 2b00 cmp r3, #0
|
|
8004b62: d003 beq.n 8004b6c <SD_PowerON+0x108>
|
|
{
|
|
hsd->SdCard.CardType = CARD_SDHC_SDXC;
|
|
8004b64: 687b ldr r3, [r7, #4]
|
|
8004b66: 2201 movs r2, #1
|
|
8004b68: 645a str r2, [r3, #68] @ 0x44
|
|
8004b6a: e002 b.n 8004b72 <SD_PowerON+0x10e>
|
|
}
|
|
else
|
|
{
|
|
hsd->SdCard.CardType = CARD_SDSC;
|
|
8004b6c: 687b ldr r3, [r7, #4]
|
|
8004b6e: 2200 movs r2, #0
|
|
8004b70: 645a str r2, [r3, #68] @ 0x44
|
|
}
|
|
|
|
|
|
return HAL_SD_ERROR_NONE;
|
|
8004b72: 2300 movs r3, #0
|
|
}
|
|
8004b74: 4618 mov r0, r3
|
|
8004b76: 3718 adds r7, #24
|
|
8004b78: 46bd mov sp, r7
|
|
8004b7a: bd80 pop {r7, pc}
|
|
8004b7c: c1100000 .word 0xc1100000
|
|
|
|
08004b80 <SD_SendStatus>:
|
|
* @param pCardStatus: pointer to the buffer that will contain the SD card
|
|
* status (Card Status register)
|
|
* @retval error state
|
|
*/
|
|
static uint32_t SD_SendStatus(SD_HandleTypeDef *hsd, uint32_t *pCardStatus)
|
|
{
|
|
8004b80: b580 push {r7, lr}
|
|
8004b82: b084 sub sp, #16
|
|
8004b84: af00 add r7, sp, #0
|
|
8004b86: 6078 str r0, [r7, #4]
|
|
8004b88: 6039 str r1, [r7, #0]
|
|
uint32_t errorstate;
|
|
|
|
if(pCardStatus == NULL)
|
|
8004b8a: 683b ldr r3, [r7, #0]
|
|
8004b8c: 2b00 cmp r3, #0
|
|
8004b8e: d102 bne.n 8004b96 <SD_SendStatus+0x16>
|
|
{
|
|
return HAL_SD_ERROR_PARAM;
|
|
8004b90: f04f 6300 mov.w r3, #134217728 @ 0x8000000
|
|
8004b94: e018 b.n 8004bc8 <SD_SendStatus+0x48>
|
|
}
|
|
|
|
/* Send Status command */
|
|
errorstate = SDMMC_CmdSendStatus(hsd->Instance, (uint32_t)(hsd->SdCard.RelCardAdd << 16U));
|
|
8004b96: 687b ldr r3, [r7, #4]
|
|
8004b98: 681a ldr r2, [r3, #0]
|
|
8004b9a: 687b ldr r3, [r7, #4]
|
|
8004b9c: 6d1b ldr r3, [r3, #80] @ 0x50
|
|
8004b9e: 041b lsls r3, r3, #16
|
|
8004ba0: 4619 mov r1, r3
|
|
8004ba2: 4610 mov r0, r2
|
|
8004ba4: f001 f95c bl 8005e60 <SDMMC_CmdSendStatus>
|
|
8004ba8: 60f8 str r0, [r7, #12]
|
|
if(errorstate != HAL_SD_ERROR_NONE)
|
|
8004baa: 68fb ldr r3, [r7, #12]
|
|
8004bac: 2b00 cmp r3, #0
|
|
8004bae: d001 beq.n 8004bb4 <SD_SendStatus+0x34>
|
|
{
|
|
return errorstate;
|
|
8004bb0: 68fb ldr r3, [r7, #12]
|
|
8004bb2: e009 b.n 8004bc8 <SD_SendStatus+0x48>
|
|
}
|
|
|
|
/* Get SD card status */
|
|
*pCardStatus = SDIO_GetResponse(hsd->Instance, SDIO_RESP1);
|
|
8004bb4: 687b ldr r3, [r7, #4]
|
|
8004bb6: 681b ldr r3, [r3, #0]
|
|
8004bb8: 2100 movs r1, #0
|
|
8004bba: 4618 mov r0, r3
|
|
8004bbc: f000 ff04 bl 80059c8 <SDIO_GetResponse>
|
|
8004bc0: 4602 mov r2, r0
|
|
8004bc2: 683b ldr r3, [r7, #0]
|
|
8004bc4: 601a str r2, [r3, #0]
|
|
|
|
return HAL_SD_ERROR_NONE;
|
|
8004bc6: 2300 movs r3, #0
|
|
}
|
|
8004bc8: 4618 mov r0, r3
|
|
8004bca: 3710 adds r7, #16
|
|
8004bcc: 46bd mov sp, r7
|
|
8004bce: bd80 pop {r7, pc}
|
|
|
|
08004bd0 <SD_WideBus_Enable>:
|
|
* @brief Enables the SDIO wide bus mode.
|
|
* @param hsd: pointer to SD handle
|
|
* @retval error state
|
|
*/
|
|
static uint32_t SD_WideBus_Enable(SD_HandleTypeDef *hsd)
|
|
{
|
|
8004bd0: b580 push {r7, lr}
|
|
8004bd2: b086 sub sp, #24
|
|
8004bd4: af00 add r7, sp, #0
|
|
8004bd6: 6078 str r0, [r7, #4]
|
|
uint32_t scr[2U] = {0U, 0U};
|
|
8004bd8: 2300 movs r3, #0
|
|
8004bda: 60fb str r3, [r7, #12]
|
|
8004bdc: 2300 movs r3, #0
|
|
8004bde: 613b str r3, [r7, #16]
|
|
uint32_t errorstate;
|
|
|
|
if((SDIO_GetResponse(hsd->Instance, SDIO_RESP1) & SDMMC_CARD_LOCKED) == SDMMC_CARD_LOCKED)
|
|
8004be0: 687b ldr r3, [r7, #4]
|
|
8004be2: 681b ldr r3, [r3, #0]
|
|
8004be4: 2100 movs r1, #0
|
|
8004be6: 4618 mov r0, r3
|
|
8004be8: f000 feee bl 80059c8 <SDIO_GetResponse>
|
|
8004bec: 4603 mov r3, r0
|
|
8004bee: f003 7300 and.w r3, r3, #33554432 @ 0x2000000
|
|
8004bf2: f1b3 7f00 cmp.w r3, #33554432 @ 0x2000000
|
|
8004bf6: d102 bne.n 8004bfe <SD_WideBus_Enable+0x2e>
|
|
{
|
|
return HAL_SD_ERROR_LOCK_UNLOCK_FAILED;
|
|
8004bf8: f44f 6300 mov.w r3, #2048 @ 0x800
|
|
8004bfc: e02f b.n 8004c5e <SD_WideBus_Enable+0x8e>
|
|
}
|
|
|
|
/* Get SCR Register */
|
|
errorstate = SD_FindSCR(hsd, scr);
|
|
8004bfe: f107 030c add.w r3, r7, #12
|
|
8004c02: 4619 mov r1, r3
|
|
8004c04: 6878 ldr r0, [r7, #4]
|
|
8004c06: f000 f879 bl 8004cfc <SD_FindSCR>
|
|
8004c0a: 6178 str r0, [r7, #20]
|
|
if(errorstate != HAL_SD_ERROR_NONE)
|
|
8004c0c: 697b ldr r3, [r7, #20]
|
|
8004c0e: 2b00 cmp r3, #0
|
|
8004c10: d001 beq.n 8004c16 <SD_WideBus_Enable+0x46>
|
|
{
|
|
return errorstate;
|
|
8004c12: 697b ldr r3, [r7, #20]
|
|
8004c14: e023 b.n 8004c5e <SD_WideBus_Enable+0x8e>
|
|
}
|
|
|
|
/* If requested card supports wide bus operation */
|
|
if((scr[1U] & SDMMC_WIDE_BUS_SUPPORT) != SDMMC_ALLZERO)
|
|
8004c16: 693b ldr r3, [r7, #16]
|
|
8004c18: f403 2380 and.w r3, r3, #262144 @ 0x40000
|
|
8004c1c: 2b00 cmp r3, #0
|
|
8004c1e: d01c beq.n 8004c5a <SD_WideBus_Enable+0x8a>
|
|
{
|
|
/* Send CMD55 APP_CMD with argument as card's RCA.*/
|
|
errorstate = SDMMC_CmdAppCommand(hsd->Instance, (uint32_t)(hsd->SdCard.RelCardAdd << 16U));
|
|
8004c20: 687b ldr r3, [r7, #4]
|
|
8004c22: 681a ldr r2, [r3, #0]
|
|
8004c24: 687b ldr r3, [r7, #4]
|
|
8004c26: 6d1b ldr r3, [r3, #80] @ 0x50
|
|
8004c28: 041b lsls r3, r3, #16
|
|
8004c2a: 4619 mov r1, r3
|
|
8004c2c: 4610 mov r0, r2
|
|
8004c2e: f001 f831 bl 8005c94 <SDMMC_CmdAppCommand>
|
|
8004c32: 6178 str r0, [r7, #20]
|
|
if(errorstate != HAL_SD_ERROR_NONE)
|
|
8004c34: 697b ldr r3, [r7, #20]
|
|
8004c36: 2b00 cmp r3, #0
|
|
8004c38: d001 beq.n 8004c3e <SD_WideBus_Enable+0x6e>
|
|
{
|
|
return errorstate;
|
|
8004c3a: 697b ldr r3, [r7, #20]
|
|
8004c3c: e00f b.n 8004c5e <SD_WideBus_Enable+0x8e>
|
|
}
|
|
|
|
/* Send ACMD6 APP_CMD with argument as 2 for wide bus mode */
|
|
errorstate = SDMMC_CmdBusWidth(hsd->Instance, 2U);
|
|
8004c3e: 687b ldr r3, [r7, #4]
|
|
8004c40: 681b ldr r3, [r3, #0]
|
|
8004c42: 2102 movs r1, #2
|
|
8004c44: 4618 mov r0, r3
|
|
8004c46: f001 f86a bl 8005d1e <SDMMC_CmdBusWidth>
|
|
8004c4a: 6178 str r0, [r7, #20]
|
|
if(errorstate != HAL_SD_ERROR_NONE)
|
|
8004c4c: 697b ldr r3, [r7, #20]
|
|
8004c4e: 2b00 cmp r3, #0
|
|
8004c50: d001 beq.n 8004c56 <SD_WideBus_Enable+0x86>
|
|
{
|
|
return errorstate;
|
|
8004c52: 697b ldr r3, [r7, #20]
|
|
8004c54: e003 b.n 8004c5e <SD_WideBus_Enable+0x8e>
|
|
}
|
|
|
|
return HAL_SD_ERROR_NONE;
|
|
8004c56: 2300 movs r3, #0
|
|
8004c58: e001 b.n 8004c5e <SD_WideBus_Enable+0x8e>
|
|
}
|
|
else
|
|
{
|
|
return HAL_SD_ERROR_REQUEST_NOT_APPLICABLE;
|
|
8004c5a: f04f 6380 mov.w r3, #67108864 @ 0x4000000
|
|
}
|
|
}
|
|
8004c5e: 4618 mov r0, r3
|
|
8004c60: 3718 adds r7, #24
|
|
8004c62: 46bd mov sp, r7
|
|
8004c64: bd80 pop {r7, pc}
|
|
|
|
08004c66 <SD_WideBus_Disable>:
|
|
* @brief Disables the SDIO wide bus mode.
|
|
* @param hsd: Pointer to SD handle
|
|
* @retval error state
|
|
*/
|
|
static uint32_t SD_WideBus_Disable(SD_HandleTypeDef *hsd)
|
|
{
|
|
8004c66: b580 push {r7, lr}
|
|
8004c68: b086 sub sp, #24
|
|
8004c6a: af00 add r7, sp, #0
|
|
8004c6c: 6078 str r0, [r7, #4]
|
|
uint32_t scr[2U] = {0U, 0U};
|
|
8004c6e: 2300 movs r3, #0
|
|
8004c70: 60fb str r3, [r7, #12]
|
|
8004c72: 2300 movs r3, #0
|
|
8004c74: 613b str r3, [r7, #16]
|
|
uint32_t errorstate;
|
|
|
|
if((SDIO_GetResponse(hsd->Instance, SDIO_RESP1) & SDMMC_CARD_LOCKED) == SDMMC_CARD_LOCKED)
|
|
8004c76: 687b ldr r3, [r7, #4]
|
|
8004c78: 681b ldr r3, [r3, #0]
|
|
8004c7a: 2100 movs r1, #0
|
|
8004c7c: 4618 mov r0, r3
|
|
8004c7e: f000 fea3 bl 80059c8 <SDIO_GetResponse>
|
|
8004c82: 4603 mov r3, r0
|
|
8004c84: f003 7300 and.w r3, r3, #33554432 @ 0x2000000
|
|
8004c88: f1b3 7f00 cmp.w r3, #33554432 @ 0x2000000
|
|
8004c8c: d102 bne.n 8004c94 <SD_WideBus_Disable+0x2e>
|
|
{
|
|
return HAL_SD_ERROR_LOCK_UNLOCK_FAILED;
|
|
8004c8e: f44f 6300 mov.w r3, #2048 @ 0x800
|
|
8004c92: e02f b.n 8004cf4 <SD_WideBus_Disable+0x8e>
|
|
}
|
|
|
|
/* Get SCR Register */
|
|
errorstate = SD_FindSCR(hsd, scr);
|
|
8004c94: f107 030c add.w r3, r7, #12
|
|
8004c98: 4619 mov r1, r3
|
|
8004c9a: 6878 ldr r0, [r7, #4]
|
|
8004c9c: f000 f82e bl 8004cfc <SD_FindSCR>
|
|
8004ca0: 6178 str r0, [r7, #20]
|
|
if(errorstate != HAL_SD_ERROR_NONE)
|
|
8004ca2: 697b ldr r3, [r7, #20]
|
|
8004ca4: 2b00 cmp r3, #0
|
|
8004ca6: d001 beq.n 8004cac <SD_WideBus_Disable+0x46>
|
|
{
|
|
return errorstate;
|
|
8004ca8: 697b ldr r3, [r7, #20]
|
|
8004caa: e023 b.n 8004cf4 <SD_WideBus_Disable+0x8e>
|
|
}
|
|
|
|
/* If requested card supports 1 bit mode operation */
|
|
if((scr[1U] & SDMMC_SINGLE_BUS_SUPPORT) != SDMMC_ALLZERO)
|
|
8004cac: 693b ldr r3, [r7, #16]
|
|
8004cae: f403 3380 and.w r3, r3, #65536 @ 0x10000
|
|
8004cb2: 2b00 cmp r3, #0
|
|
8004cb4: d01c beq.n 8004cf0 <SD_WideBus_Disable+0x8a>
|
|
{
|
|
/* Send CMD55 APP_CMD with argument as card's RCA */
|
|
errorstate = SDMMC_CmdAppCommand(hsd->Instance, (uint32_t)(hsd->SdCard.RelCardAdd << 16U));
|
|
8004cb6: 687b ldr r3, [r7, #4]
|
|
8004cb8: 681a ldr r2, [r3, #0]
|
|
8004cba: 687b ldr r3, [r7, #4]
|
|
8004cbc: 6d1b ldr r3, [r3, #80] @ 0x50
|
|
8004cbe: 041b lsls r3, r3, #16
|
|
8004cc0: 4619 mov r1, r3
|
|
8004cc2: 4610 mov r0, r2
|
|
8004cc4: f000 ffe6 bl 8005c94 <SDMMC_CmdAppCommand>
|
|
8004cc8: 6178 str r0, [r7, #20]
|
|
if(errorstate != HAL_SD_ERROR_NONE)
|
|
8004cca: 697b ldr r3, [r7, #20]
|
|
8004ccc: 2b00 cmp r3, #0
|
|
8004cce: d001 beq.n 8004cd4 <SD_WideBus_Disable+0x6e>
|
|
{
|
|
return errorstate;
|
|
8004cd0: 697b ldr r3, [r7, #20]
|
|
8004cd2: e00f b.n 8004cf4 <SD_WideBus_Disable+0x8e>
|
|
}
|
|
|
|
/* Send ACMD6 APP_CMD with argument as 0 for single bus mode */
|
|
errorstate = SDMMC_CmdBusWidth(hsd->Instance, 0U);
|
|
8004cd4: 687b ldr r3, [r7, #4]
|
|
8004cd6: 681b ldr r3, [r3, #0]
|
|
8004cd8: 2100 movs r1, #0
|
|
8004cda: 4618 mov r0, r3
|
|
8004cdc: f001 f81f bl 8005d1e <SDMMC_CmdBusWidth>
|
|
8004ce0: 6178 str r0, [r7, #20]
|
|
if(errorstate != HAL_SD_ERROR_NONE)
|
|
8004ce2: 697b ldr r3, [r7, #20]
|
|
8004ce4: 2b00 cmp r3, #0
|
|
8004ce6: d001 beq.n 8004cec <SD_WideBus_Disable+0x86>
|
|
{
|
|
return errorstate;
|
|
8004ce8: 697b ldr r3, [r7, #20]
|
|
8004cea: e003 b.n 8004cf4 <SD_WideBus_Disable+0x8e>
|
|
}
|
|
|
|
return HAL_SD_ERROR_NONE;
|
|
8004cec: 2300 movs r3, #0
|
|
8004cee: e001 b.n 8004cf4 <SD_WideBus_Disable+0x8e>
|
|
}
|
|
else
|
|
{
|
|
return HAL_SD_ERROR_REQUEST_NOT_APPLICABLE;
|
|
8004cf0: f04f 6380 mov.w r3, #67108864 @ 0x4000000
|
|
}
|
|
}
|
|
8004cf4: 4618 mov r0, r3
|
|
8004cf6: 3718 adds r7, #24
|
|
8004cf8: 46bd mov sp, r7
|
|
8004cfa: bd80 pop {r7, pc}
|
|
|
|
08004cfc <SD_FindSCR>:
|
|
* @param hsd: Pointer to SD handle
|
|
* @param pSCR: pointer to the buffer that will contain the SCR value
|
|
* @retval error state
|
|
*/
|
|
static uint32_t SD_FindSCR(SD_HandleTypeDef *hsd, uint32_t *pSCR)
|
|
{
|
|
8004cfc: b590 push {r4, r7, lr}
|
|
8004cfe: b08f sub sp, #60 @ 0x3c
|
|
8004d00: af00 add r7, sp, #0
|
|
8004d02: 6078 str r0, [r7, #4]
|
|
8004d04: 6039 str r1, [r7, #0]
|
|
SDIO_DataInitTypeDef config;
|
|
uint32_t errorstate;
|
|
uint32_t tickstart = HAL_GetTick();
|
|
8004d06: f7fc fb97 bl 8001438 <HAL_GetTick>
|
|
8004d0a: 6338 str r0, [r7, #48] @ 0x30
|
|
uint32_t index = 0U;
|
|
8004d0c: 2300 movs r3, #0
|
|
8004d0e: 637b str r3, [r7, #52] @ 0x34
|
|
uint32_t tempscr[2U] = {0U, 0U};
|
|
8004d10: 2300 movs r3, #0
|
|
8004d12: 60bb str r3, [r7, #8]
|
|
8004d14: 2300 movs r3, #0
|
|
8004d16: 60fb str r3, [r7, #12]
|
|
uint32_t *scr = pSCR;
|
|
8004d18: 683b ldr r3, [r7, #0]
|
|
8004d1a: 62fb str r3, [r7, #44] @ 0x2c
|
|
|
|
/* Set Block Size To 8 Bytes */
|
|
errorstate = SDMMC_CmdBlockLength(hsd->Instance, 8U);
|
|
8004d1c: 687b ldr r3, [r7, #4]
|
|
8004d1e: 681b ldr r3, [r3, #0]
|
|
8004d20: 2108 movs r1, #8
|
|
8004d22: 4618 mov r0, r3
|
|
8004d24: f000 ff12 bl 8005b4c <SDMMC_CmdBlockLength>
|
|
8004d28: 62b8 str r0, [r7, #40] @ 0x28
|
|
if(errorstate != HAL_SD_ERROR_NONE)
|
|
8004d2a: 6abb ldr r3, [r7, #40] @ 0x28
|
|
8004d2c: 2b00 cmp r3, #0
|
|
8004d2e: d001 beq.n 8004d34 <SD_FindSCR+0x38>
|
|
{
|
|
return errorstate;
|
|
8004d30: 6abb ldr r3, [r7, #40] @ 0x28
|
|
8004d32: e0b9 b.n 8004ea8 <SD_FindSCR+0x1ac>
|
|
}
|
|
|
|
/* Send CMD55 APP_CMD with argument as card's RCA */
|
|
errorstate = SDMMC_CmdAppCommand(hsd->Instance, (uint32_t)((hsd->SdCard.RelCardAdd) << 16U));
|
|
8004d34: 687b ldr r3, [r7, #4]
|
|
8004d36: 681a ldr r2, [r3, #0]
|
|
8004d38: 687b ldr r3, [r7, #4]
|
|
8004d3a: 6d1b ldr r3, [r3, #80] @ 0x50
|
|
8004d3c: 041b lsls r3, r3, #16
|
|
8004d3e: 4619 mov r1, r3
|
|
8004d40: 4610 mov r0, r2
|
|
8004d42: f000 ffa7 bl 8005c94 <SDMMC_CmdAppCommand>
|
|
8004d46: 62b8 str r0, [r7, #40] @ 0x28
|
|
if(errorstate != HAL_SD_ERROR_NONE)
|
|
8004d48: 6abb ldr r3, [r7, #40] @ 0x28
|
|
8004d4a: 2b00 cmp r3, #0
|
|
8004d4c: d001 beq.n 8004d52 <SD_FindSCR+0x56>
|
|
{
|
|
return errorstate;
|
|
8004d4e: 6abb ldr r3, [r7, #40] @ 0x28
|
|
8004d50: e0aa b.n 8004ea8 <SD_FindSCR+0x1ac>
|
|
}
|
|
|
|
config.DataTimeOut = SDMMC_DATATIMEOUT;
|
|
8004d52: f04f 33ff mov.w r3, #4294967295 @ 0xffffffff
|
|
8004d56: 613b str r3, [r7, #16]
|
|
config.DataLength = 8U;
|
|
8004d58: 2308 movs r3, #8
|
|
8004d5a: 617b str r3, [r7, #20]
|
|
config.DataBlockSize = SDIO_DATABLOCK_SIZE_8B;
|
|
8004d5c: 2330 movs r3, #48 @ 0x30
|
|
8004d5e: 61bb str r3, [r7, #24]
|
|
config.TransferDir = SDIO_TRANSFER_DIR_TO_SDIO;
|
|
8004d60: 2302 movs r3, #2
|
|
8004d62: 61fb str r3, [r7, #28]
|
|
config.TransferMode = SDIO_TRANSFER_MODE_BLOCK;
|
|
8004d64: 2300 movs r3, #0
|
|
8004d66: 623b str r3, [r7, #32]
|
|
config.DPSM = SDIO_DPSM_ENABLE;
|
|
8004d68: 2301 movs r3, #1
|
|
8004d6a: 627b str r3, [r7, #36] @ 0x24
|
|
(void)SDIO_ConfigData(hsd->Instance, &config);
|
|
8004d6c: 687b ldr r3, [r7, #4]
|
|
8004d6e: 681b ldr r3, [r3, #0]
|
|
8004d70: f107 0210 add.w r2, r7, #16
|
|
8004d74: 4611 mov r1, r2
|
|
8004d76: 4618 mov r0, r3
|
|
8004d78: f000 fe4a bl 8005a10 <SDIO_ConfigData>
|
|
|
|
/* Send ACMD51 SD_APP_SEND_SCR with argument as 0 */
|
|
errorstate = SDMMC_CmdSendSCR(hsd->Instance);
|
|
8004d7c: 687b ldr r3, [r7, #4]
|
|
8004d7e: 681b ldr r3, [r3, #0]
|
|
8004d80: 4618 mov r0, r3
|
|
8004d82: f000 ffee bl 8005d62 <SDMMC_CmdSendSCR>
|
|
8004d86: 62b8 str r0, [r7, #40] @ 0x28
|
|
if(errorstate != HAL_SD_ERROR_NONE)
|
|
8004d88: 6abb ldr r3, [r7, #40] @ 0x28
|
|
8004d8a: 2b00 cmp r3, #0
|
|
8004d8c: d02a beq.n 8004de4 <SD_FindSCR+0xe8>
|
|
{
|
|
return errorstate;
|
|
8004d8e: 6abb ldr r3, [r7, #40] @ 0x28
|
|
8004d90: e08a b.n 8004ea8 <SD_FindSCR+0x1ac>
|
|
}
|
|
|
|
while(!__HAL_SD_GET_FLAG(hsd, SDIO_FLAG_RXOVERR | SDIO_FLAG_DCRCFAIL | SDIO_FLAG_DTIMEOUT))
|
|
{
|
|
if(__HAL_SD_GET_FLAG(hsd, SDIO_FLAG_RXDAVL))
|
|
8004d92: 687b ldr r3, [r7, #4]
|
|
8004d94: 681b ldr r3, [r3, #0]
|
|
8004d96: 6b5b ldr r3, [r3, #52] @ 0x34
|
|
8004d98: f403 1300 and.w r3, r3, #2097152 @ 0x200000
|
|
8004d9c: 2b00 cmp r3, #0
|
|
8004d9e: d00f beq.n 8004dc0 <SD_FindSCR+0xc4>
|
|
{
|
|
*(tempscr + index) = SDIO_ReadFIFO(hsd->Instance);
|
|
8004da0: 687b ldr r3, [r7, #4]
|
|
8004da2: 6819 ldr r1, [r3, #0]
|
|
8004da4: 6b7b ldr r3, [r7, #52] @ 0x34
|
|
8004da6: 009b lsls r3, r3, #2
|
|
8004da8: f107 0208 add.w r2, r7, #8
|
|
8004dac: 18d4 adds r4, r2, r3
|
|
8004dae: 4608 mov r0, r1
|
|
8004db0: f000 fd5c bl 800586c <SDIO_ReadFIFO>
|
|
8004db4: 4603 mov r3, r0
|
|
8004db6: 6023 str r3, [r4, #0]
|
|
index++;
|
|
8004db8: 6b7b ldr r3, [r7, #52] @ 0x34
|
|
8004dba: 3301 adds r3, #1
|
|
8004dbc: 637b str r3, [r7, #52] @ 0x34
|
|
8004dbe: e006 b.n 8004dce <SD_FindSCR+0xd2>
|
|
}
|
|
else if(!__HAL_SD_GET_FLAG(hsd, SDIO_FLAG_RXACT))
|
|
8004dc0: 687b ldr r3, [r7, #4]
|
|
8004dc2: 681b ldr r3, [r3, #0]
|
|
8004dc4: 6b5b ldr r3, [r3, #52] @ 0x34
|
|
8004dc6: f403 5300 and.w r3, r3, #8192 @ 0x2000
|
|
8004dca: 2b00 cmp r3, #0
|
|
8004dcc: d012 beq.n 8004df4 <SD_FindSCR+0xf8>
|
|
{
|
|
break;
|
|
}
|
|
|
|
if((HAL_GetTick() - tickstart) >= SDMMC_SWDATATIMEOUT)
|
|
8004dce: f7fc fb33 bl 8001438 <HAL_GetTick>
|
|
8004dd2: 4602 mov r2, r0
|
|
8004dd4: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
8004dd6: 1ad3 subs r3, r2, r3
|
|
8004dd8: f1b3 3fff cmp.w r3, #4294967295 @ 0xffffffff
|
|
8004ddc: d102 bne.n 8004de4 <SD_FindSCR+0xe8>
|
|
{
|
|
return HAL_SD_ERROR_TIMEOUT;
|
|
8004dde: f04f 4300 mov.w r3, #2147483648 @ 0x80000000
|
|
8004de2: e061 b.n 8004ea8 <SD_FindSCR+0x1ac>
|
|
while(!__HAL_SD_GET_FLAG(hsd, SDIO_FLAG_RXOVERR | SDIO_FLAG_DCRCFAIL | SDIO_FLAG_DTIMEOUT))
|
|
8004de4: 687b ldr r3, [r7, #4]
|
|
8004de6: 681b ldr r3, [r3, #0]
|
|
8004de8: 6b5b ldr r3, [r3, #52] @ 0x34
|
|
8004dea: f003 032a and.w r3, r3, #42 @ 0x2a
|
|
8004dee: 2b00 cmp r3, #0
|
|
8004df0: d0cf beq.n 8004d92 <SD_FindSCR+0x96>
|
|
8004df2: e000 b.n 8004df6 <SD_FindSCR+0xfa>
|
|
break;
|
|
8004df4: bf00 nop
|
|
}
|
|
}
|
|
|
|
#if defined(SDIO_STA_STBITERR)
|
|
if(__HAL_SD_GET_FLAG(hsd, SDIO_FLAG_DTIMEOUT) || (__HAL_SD_GET_FLAG(hsd, SDIO_FLAG_STBITERR)))
|
|
8004df6: 687b ldr r3, [r7, #4]
|
|
8004df8: 681b ldr r3, [r3, #0]
|
|
8004dfa: 6b5b ldr r3, [r3, #52] @ 0x34
|
|
8004dfc: f003 0308 and.w r3, r3, #8
|
|
8004e00: 2b00 cmp r3, #0
|
|
8004e02: d106 bne.n 8004e12 <SD_FindSCR+0x116>
|
|
8004e04: 687b ldr r3, [r7, #4]
|
|
8004e06: 681b ldr r3, [r3, #0]
|
|
8004e08: 6b5b ldr r3, [r3, #52] @ 0x34
|
|
8004e0a: f403 7300 and.w r3, r3, #512 @ 0x200
|
|
8004e0e: 2b00 cmp r3, #0
|
|
8004e10: d005 beq.n 8004e1e <SD_FindSCR+0x122>
|
|
#else /* SDIO_STA_STBITERR not defined */
|
|
if(__HAL_SD_GET_FLAG(hsd, SDIO_FLAG_DTIMEOUT))
|
|
#endif /* SDIO_STA_STBITERR */
|
|
{
|
|
__HAL_SD_CLEAR_FLAG(hsd, SDIO_FLAG_DTIMEOUT);
|
|
8004e12: 687b ldr r3, [r7, #4]
|
|
8004e14: 681b ldr r3, [r3, #0]
|
|
8004e16: 2208 movs r2, #8
|
|
8004e18: 639a str r2, [r3, #56] @ 0x38
|
|
|
|
return HAL_SD_ERROR_DATA_TIMEOUT;
|
|
8004e1a: 2308 movs r3, #8
|
|
8004e1c: e044 b.n 8004ea8 <SD_FindSCR+0x1ac>
|
|
}
|
|
else if(__HAL_SD_GET_FLAG(hsd, SDIO_FLAG_DCRCFAIL))
|
|
8004e1e: 687b ldr r3, [r7, #4]
|
|
8004e20: 681b ldr r3, [r3, #0]
|
|
8004e22: 6b5b ldr r3, [r3, #52] @ 0x34
|
|
8004e24: f003 0302 and.w r3, r3, #2
|
|
8004e28: 2b00 cmp r3, #0
|
|
8004e2a: d005 beq.n 8004e38 <SD_FindSCR+0x13c>
|
|
{
|
|
__HAL_SD_CLEAR_FLAG(hsd, SDIO_FLAG_DCRCFAIL);
|
|
8004e2c: 687b ldr r3, [r7, #4]
|
|
8004e2e: 681b ldr r3, [r3, #0]
|
|
8004e30: 2202 movs r2, #2
|
|
8004e32: 639a str r2, [r3, #56] @ 0x38
|
|
|
|
return HAL_SD_ERROR_DATA_CRC_FAIL;
|
|
8004e34: 2302 movs r3, #2
|
|
8004e36: e037 b.n 8004ea8 <SD_FindSCR+0x1ac>
|
|
}
|
|
else if(__HAL_SD_GET_FLAG(hsd, SDIO_FLAG_RXOVERR))
|
|
8004e38: 687b ldr r3, [r7, #4]
|
|
8004e3a: 681b ldr r3, [r3, #0]
|
|
8004e3c: 6b5b ldr r3, [r3, #52] @ 0x34
|
|
8004e3e: f003 0320 and.w r3, r3, #32
|
|
8004e42: 2b00 cmp r3, #0
|
|
8004e44: d005 beq.n 8004e52 <SD_FindSCR+0x156>
|
|
{
|
|
__HAL_SD_CLEAR_FLAG(hsd, SDIO_FLAG_RXOVERR);
|
|
8004e46: 687b ldr r3, [r7, #4]
|
|
8004e48: 681b ldr r3, [r3, #0]
|
|
8004e4a: 2220 movs r2, #32
|
|
8004e4c: 639a str r2, [r3, #56] @ 0x38
|
|
|
|
return HAL_SD_ERROR_RX_OVERRUN;
|
|
8004e4e: 2320 movs r3, #32
|
|
8004e50: e02a b.n 8004ea8 <SD_FindSCR+0x1ac>
|
|
}
|
|
else
|
|
{
|
|
/* No error flag set */
|
|
/* Clear all the static flags */
|
|
__HAL_SD_CLEAR_FLAG(hsd, SDIO_STATIC_DATA_FLAGS);
|
|
8004e52: 687b ldr r3, [r7, #4]
|
|
8004e54: 681b ldr r3, [r3, #0]
|
|
8004e56: f240 523a movw r2, #1338 @ 0x53a
|
|
8004e5a: 639a str r2, [r3, #56] @ 0x38
|
|
|
|
*scr = (((tempscr[1] & SDMMC_0TO7BITS) << 24) | ((tempscr[1] & SDMMC_8TO15BITS) << 8) |\
|
|
8004e5c: 68fb ldr r3, [r7, #12]
|
|
8004e5e: 061a lsls r2, r3, #24
|
|
8004e60: 68fb ldr r3, [r7, #12]
|
|
8004e62: 021b lsls r3, r3, #8
|
|
8004e64: f403 037f and.w r3, r3, #16711680 @ 0xff0000
|
|
8004e68: 431a orrs r2, r3
|
|
((tempscr[1] & SDMMC_16TO23BITS) >> 8) | ((tempscr[1] & SDMMC_24TO31BITS) >> 24));
|
|
8004e6a: 68fb ldr r3, [r7, #12]
|
|
8004e6c: 0a1b lsrs r3, r3, #8
|
|
8004e6e: f403 437f and.w r3, r3, #65280 @ 0xff00
|
|
*scr = (((tempscr[1] & SDMMC_0TO7BITS) << 24) | ((tempscr[1] & SDMMC_8TO15BITS) << 8) |\
|
|
8004e72: 431a orrs r2, r3
|
|
((tempscr[1] & SDMMC_16TO23BITS) >> 8) | ((tempscr[1] & SDMMC_24TO31BITS) >> 24));
|
|
8004e74: 68fb ldr r3, [r7, #12]
|
|
8004e76: 0e1b lsrs r3, r3, #24
|
|
8004e78: 431a orrs r2, r3
|
|
*scr = (((tempscr[1] & SDMMC_0TO7BITS) << 24) | ((tempscr[1] & SDMMC_8TO15BITS) << 8) |\
|
|
8004e7a: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
8004e7c: 601a str r2, [r3, #0]
|
|
scr++;
|
|
8004e7e: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
8004e80: 3304 adds r3, #4
|
|
8004e82: 62fb str r3, [r7, #44] @ 0x2c
|
|
*scr = (((tempscr[0] & SDMMC_0TO7BITS) << 24) | ((tempscr[0] & SDMMC_8TO15BITS) << 8) |\
|
|
8004e84: 68bb ldr r3, [r7, #8]
|
|
8004e86: 061a lsls r2, r3, #24
|
|
8004e88: 68bb ldr r3, [r7, #8]
|
|
8004e8a: 021b lsls r3, r3, #8
|
|
8004e8c: f403 037f and.w r3, r3, #16711680 @ 0xff0000
|
|
8004e90: 431a orrs r2, r3
|
|
((tempscr[0] & SDMMC_16TO23BITS) >> 8) | ((tempscr[0] & SDMMC_24TO31BITS) >> 24));
|
|
8004e92: 68bb ldr r3, [r7, #8]
|
|
8004e94: 0a1b lsrs r3, r3, #8
|
|
8004e96: f403 437f and.w r3, r3, #65280 @ 0xff00
|
|
*scr = (((tempscr[0] & SDMMC_0TO7BITS) << 24) | ((tempscr[0] & SDMMC_8TO15BITS) << 8) |\
|
|
8004e9a: 431a orrs r2, r3
|
|
((tempscr[0] & SDMMC_16TO23BITS) >> 8) | ((tempscr[0] & SDMMC_24TO31BITS) >> 24));
|
|
8004e9c: 68bb ldr r3, [r7, #8]
|
|
8004e9e: 0e1b lsrs r3, r3, #24
|
|
8004ea0: 431a orrs r2, r3
|
|
*scr = (((tempscr[0] & SDMMC_0TO7BITS) << 24) | ((tempscr[0] & SDMMC_8TO15BITS) << 8) |\
|
|
8004ea2: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
8004ea4: 601a str r2, [r3, #0]
|
|
|
|
}
|
|
|
|
return HAL_SD_ERROR_NONE;
|
|
8004ea6: 2300 movs r3, #0
|
|
}
|
|
8004ea8: 4618 mov r0, r3
|
|
8004eaa: 373c adds r7, #60 @ 0x3c
|
|
8004eac: 46bd mov sp, r7
|
|
8004eae: bd90 pop {r4, r7, pc}
|
|
|
|
08004eb0 <SD_Read_IT>:
|
|
* @param hsd: pointer to a SD_HandleTypeDef structure that contains
|
|
* the configuration information.
|
|
* @retval None
|
|
*/
|
|
static void SD_Read_IT(SD_HandleTypeDef *hsd)
|
|
{
|
|
8004eb0: b580 push {r7, lr}
|
|
8004eb2: b086 sub sp, #24
|
|
8004eb4: af00 add r7, sp, #0
|
|
8004eb6: 6078 str r0, [r7, #4]
|
|
uint32_t count, data, dataremaining;
|
|
uint8_t* tmp;
|
|
|
|
tmp = hsd->pRxBuffPtr;
|
|
8004eb8: 687b ldr r3, [r7, #4]
|
|
8004eba: 6a9b ldr r3, [r3, #40] @ 0x28
|
|
8004ebc: 60fb str r3, [r7, #12]
|
|
dataremaining = hsd->RxXferSize;
|
|
8004ebe: 687b ldr r3, [r7, #4]
|
|
8004ec0: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
8004ec2: 613b str r3, [r7, #16]
|
|
|
|
if (dataremaining > 0U)
|
|
8004ec4: 693b ldr r3, [r7, #16]
|
|
8004ec6: 2b00 cmp r3, #0
|
|
8004ec8: d03f beq.n 8004f4a <SD_Read_IT+0x9a>
|
|
{
|
|
/* Read data from SDIO Rx FIFO */
|
|
for(count = 0U; count < 8U; count++)
|
|
8004eca: 2300 movs r3, #0
|
|
8004ecc: 617b str r3, [r7, #20]
|
|
8004ece: e033 b.n 8004f38 <SD_Read_IT+0x88>
|
|
{
|
|
data = SDIO_ReadFIFO(hsd->Instance);
|
|
8004ed0: 687b ldr r3, [r7, #4]
|
|
8004ed2: 681b ldr r3, [r3, #0]
|
|
8004ed4: 4618 mov r0, r3
|
|
8004ed6: f000 fcc9 bl 800586c <SDIO_ReadFIFO>
|
|
8004eda: 60b8 str r0, [r7, #8]
|
|
*tmp = (uint8_t)(data & 0xFFU);
|
|
8004edc: 68bb ldr r3, [r7, #8]
|
|
8004ede: b2da uxtb r2, r3
|
|
8004ee0: 68fb ldr r3, [r7, #12]
|
|
8004ee2: 701a strb r2, [r3, #0]
|
|
tmp++;
|
|
8004ee4: 68fb ldr r3, [r7, #12]
|
|
8004ee6: 3301 adds r3, #1
|
|
8004ee8: 60fb str r3, [r7, #12]
|
|
dataremaining--;
|
|
8004eea: 693b ldr r3, [r7, #16]
|
|
8004eec: 3b01 subs r3, #1
|
|
8004eee: 613b str r3, [r7, #16]
|
|
*tmp = (uint8_t)((data >> 8U) & 0xFFU);
|
|
8004ef0: 68bb ldr r3, [r7, #8]
|
|
8004ef2: 0a1b lsrs r3, r3, #8
|
|
8004ef4: b2da uxtb r2, r3
|
|
8004ef6: 68fb ldr r3, [r7, #12]
|
|
8004ef8: 701a strb r2, [r3, #0]
|
|
tmp++;
|
|
8004efa: 68fb ldr r3, [r7, #12]
|
|
8004efc: 3301 adds r3, #1
|
|
8004efe: 60fb str r3, [r7, #12]
|
|
dataremaining--;
|
|
8004f00: 693b ldr r3, [r7, #16]
|
|
8004f02: 3b01 subs r3, #1
|
|
8004f04: 613b str r3, [r7, #16]
|
|
*tmp = (uint8_t)((data >> 16U) & 0xFFU);
|
|
8004f06: 68bb ldr r3, [r7, #8]
|
|
8004f08: 0c1b lsrs r3, r3, #16
|
|
8004f0a: b2da uxtb r2, r3
|
|
8004f0c: 68fb ldr r3, [r7, #12]
|
|
8004f0e: 701a strb r2, [r3, #0]
|
|
tmp++;
|
|
8004f10: 68fb ldr r3, [r7, #12]
|
|
8004f12: 3301 adds r3, #1
|
|
8004f14: 60fb str r3, [r7, #12]
|
|
dataremaining--;
|
|
8004f16: 693b ldr r3, [r7, #16]
|
|
8004f18: 3b01 subs r3, #1
|
|
8004f1a: 613b str r3, [r7, #16]
|
|
*tmp = (uint8_t)((data >> 24U) & 0xFFU);
|
|
8004f1c: 68bb ldr r3, [r7, #8]
|
|
8004f1e: 0e1b lsrs r3, r3, #24
|
|
8004f20: b2da uxtb r2, r3
|
|
8004f22: 68fb ldr r3, [r7, #12]
|
|
8004f24: 701a strb r2, [r3, #0]
|
|
tmp++;
|
|
8004f26: 68fb ldr r3, [r7, #12]
|
|
8004f28: 3301 adds r3, #1
|
|
8004f2a: 60fb str r3, [r7, #12]
|
|
dataremaining--;
|
|
8004f2c: 693b ldr r3, [r7, #16]
|
|
8004f2e: 3b01 subs r3, #1
|
|
8004f30: 613b str r3, [r7, #16]
|
|
for(count = 0U; count < 8U; count++)
|
|
8004f32: 697b ldr r3, [r7, #20]
|
|
8004f34: 3301 adds r3, #1
|
|
8004f36: 617b str r3, [r7, #20]
|
|
8004f38: 697b ldr r3, [r7, #20]
|
|
8004f3a: 2b07 cmp r3, #7
|
|
8004f3c: d9c8 bls.n 8004ed0 <SD_Read_IT+0x20>
|
|
}
|
|
|
|
hsd->pRxBuffPtr = tmp;
|
|
8004f3e: 687b ldr r3, [r7, #4]
|
|
8004f40: 68fa ldr r2, [r7, #12]
|
|
8004f42: 629a str r2, [r3, #40] @ 0x28
|
|
hsd->RxXferSize = dataremaining;
|
|
8004f44: 687b ldr r3, [r7, #4]
|
|
8004f46: 693a ldr r2, [r7, #16]
|
|
8004f48: 62da str r2, [r3, #44] @ 0x2c
|
|
}
|
|
}
|
|
8004f4a: bf00 nop
|
|
8004f4c: 3718 adds r7, #24
|
|
8004f4e: 46bd mov sp, r7
|
|
8004f50: bd80 pop {r7, pc}
|
|
|
|
08004f52 <SD_Write_IT>:
|
|
* @param hsd: pointer to a SD_HandleTypeDef structure that contains
|
|
* the configuration information.
|
|
* @retval None
|
|
*/
|
|
static void SD_Write_IT(SD_HandleTypeDef *hsd)
|
|
{
|
|
8004f52: b580 push {r7, lr}
|
|
8004f54: b086 sub sp, #24
|
|
8004f56: af00 add r7, sp, #0
|
|
8004f58: 6078 str r0, [r7, #4]
|
|
uint32_t count, data, dataremaining;
|
|
uint8_t* tmp;
|
|
|
|
tmp = hsd->pTxBuffPtr;
|
|
8004f5a: 687b ldr r3, [r7, #4]
|
|
8004f5c: 6a1b ldr r3, [r3, #32]
|
|
8004f5e: 60fb str r3, [r7, #12]
|
|
dataremaining = hsd->TxXferSize;
|
|
8004f60: 687b ldr r3, [r7, #4]
|
|
8004f62: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
8004f64: 613b str r3, [r7, #16]
|
|
|
|
if (dataremaining > 0U)
|
|
8004f66: 693b ldr r3, [r7, #16]
|
|
8004f68: 2b00 cmp r3, #0
|
|
8004f6a: d043 beq.n 8004ff4 <SD_Write_IT+0xa2>
|
|
{
|
|
/* Write data to SDIO Tx FIFO */
|
|
for(count = 0U; count < 8U; count++)
|
|
8004f6c: 2300 movs r3, #0
|
|
8004f6e: 617b str r3, [r7, #20]
|
|
8004f70: e037 b.n 8004fe2 <SD_Write_IT+0x90>
|
|
{
|
|
data = (uint32_t)(*tmp);
|
|
8004f72: 68fb ldr r3, [r7, #12]
|
|
8004f74: 781b ldrb r3, [r3, #0]
|
|
8004f76: 60bb str r3, [r7, #8]
|
|
tmp++;
|
|
8004f78: 68fb ldr r3, [r7, #12]
|
|
8004f7a: 3301 adds r3, #1
|
|
8004f7c: 60fb str r3, [r7, #12]
|
|
dataremaining--;
|
|
8004f7e: 693b ldr r3, [r7, #16]
|
|
8004f80: 3b01 subs r3, #1
|
|
8004f82: 613b str r3, [r7, #16]
|
|
data |= ((uint32_t)(*tmp) << 8U);
|
|
8004f84: 68fb ldr r3, [r7, #12]
|
|
8004f86: 781b ldrb r3, [r3, #0]
|
|
8004f88: 021a lsls r2, r3, #8
|
|
8004f8a: 68bb ldr r3, [r7, #8]
|
|
8004f8c: 4313 orrs r3, r2
|
|
8004f8e: 60bb str r3, [r7, #8]
|
|
tmp++;
|
|
8004f90: 68fb ldr r3, [r7, #12]
|
|
8004f92: 3301 adds r3, #1
|
|
8004f94: 60fb str r3, [r7, #12]
|
|
dataremaining--;
|
|
8004f96: 693b ldr r3, [r7, #16]
|
|
8004f98: 3b01 subs r3, #1
|
|
8004f9a: 613b str r3, [r7, #16]
|
|
data |= ((uint32_t)(*tmp) << 16U);
|
|
8004f9c: 68fb ldr r3, [r7, #12]
|
|
8004f9e: 781b ldrb r3, [r3, #0]
|
|
8004fa0: 041a lsls r2, r3, #16
|
|
8004fa2: 68bb ldr r3, [r7, #8]
|
|
8004fa4: 4313 orrs r3, r2
|
|
8004fa6: 60bb str r3, [r7, #8]
|
|
tmp++;
|
|
8004fa8: 68fb ldr r3, [r7, #12]
|
|
8004faa: 3301 adds r3, #1
|
|
8004fac: 60fb str r3, [r7, #12]
|
|
dataremaining--;
|
|
8004fae: 693b ldr r3, [r7, #16]
|
|
8004fb0: 3b01 subs r3, #1
|
|
8004fb2: 613b str r3, [r7, #16]
|
|
data |= ((uint32_t)(*tmp) << 24U);
|
|
8004fb4: 68fb ldr r3, [r7, #12]
|
|
8004fb6: 781b ldrb r3, [r3, #0]
|
|
8004fb8: 061a lsls r2, r3, #24
|
|
8004fba: 68bb ldr r3, [r7, #8]
|
|
8004fbc: 4313 orrs r3, r2
|
|
8004fbe: 60bb str r3, [r7, #8]
|
|
tmp++;
|
|
8004fc0: 68fb ldr r3, [r7, #12]
|
|
8004fc2: 3301 adds r3, #1
|
|
8004fc4: 60fb str r3, [r7, #12]
|
|
dataremaining--;
|
|
8004fc6: 693b ldr r3, [r7, #16]
|
|
8004fc8: 3b01 subs r3, #1
|
|
8004fca: 613b str r3, [r7, #16]
|
|
(void)SDIO_WriteFIFO(hsd->Instance, &data);
|
|
8004fcc: 687b ldr r3, [r7, #4]
|
|
8004fce: 681b ldr r3, [r3, #0]
|
|
8004fd0: f107 0208 add.w r2, r7, #8
|
|
8004fd4: 4611 mov r1, r2
|
|
8004fd6: 4618 mov r0, r3
|
|
8004fd8: f000 fc55 bl 8005886 <SDIO_WriteFIFO>
|
|
for(count = 0U; count < 8U; count++)
|
|
8004fdc: 697b ldr r3, [r7, #20]
|
|
8004fde: 3301 adds r3, #1
|
|
8004fe0: 617b str r3, [r7, #20]
|
|
8004fe2: 697b ldr r3, [r7, #20]
|
|
8004fe4: 2b07 cmp r3, #7
|
|
8004fe6: d9c4 bls.n 8004f72 <SD_Write_IT+0x20>
|
|
}
|
|
|
|
hsd->pTxBuffPtr = tmp;
|
|
8004fe8: 687b ldr r3, [r7, #4]
|
|
8004fea: 68fa ldr r2, [r7, #12]
|
|
8004fec: 621a str r2, [r3, #32]
|
|
hsd->TxXferSize = dataremaining;
|
|
8004fee: 687b ldr r3, [r7, #4]
|
|
8004ff0: 693a ldr r2, [r7, #16]
|
|
8004ff2: 625a str r2, [r3, #36] @ 0x24
|
|
}
|
|
}
|
|
8004ff4: bf00 nop
|
|
8004ff6: 3718 adds r7, #24
|
|
8004ff8: 46bd mov sp, r7
|
|
8004ffa: bd80 pop {r7, pc}
|
|
|
|
08004ffc <HAL_TIM_Base_Init>:
|
|
* Ex: call @ref HAL_TIM_Base_DeInit() before HAL_TIM_Base_Init()
|
|
* @param htim TIM Base handle
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_TIM_Base_Init(TIM_HandleTypeDef *htim)
|
|
{
|
|
8004ffc: b580 push {r7, lr}
|
|
8004ffe: b082 sub sp, #8
|
|
8005000: af00 add r7, sp, #0
|
|
8005002: 6078 str r0, [r7, #4]
|
|
/* Check the TIM handle allocation */
|
|
if (htim == NULL)
|
|
8005004: 687b ldr r3, [r7, #4]
|
|
8005006: 2b00 cmp r3, #0
|
|
8005008: d101 bne.n 800500e <HAL_TIM_Base_Init+0x12>
|
|
{
|
|
return HAL_ERROR;
|
|
800500a: 2301 movs r3, #1
|
|
800500c: e0f2 b.n 80051f4 <HAL_TIM_Base_Init+0x1f8>
|
|
}
|
|
|
|
/* Check the parameters */
|
|
assert_param(IS_TIM_INSTANCE(htim->Instance));
|
|
800500e: 687b ldr r3, [r7, #4]
|
|
8005010: 681b ldr r3, [r3, #0]
|
|
8005012: 4a7a ldr r2, [pc, #488] @ (80051fc <HAL_TIM_Base_Init+0x200>)
|
|
8005014: 4293 cmp r3, r2
|
|
8005016: d045 beq.n 80050a4 <HAL_TIM_Base_Init+0xa8>
|
|
8005018: 687b ldr r3, [r7, #4]
|
|
800501a: 681b ldr r3, [r3, #0]
|
|
800501c: f1b3 4f80 cmp.w r3, #1073741824 @ 0x40000000
|
|
8005020: d040 beq.n 80050a4 <HAL_TIM_Base_Init+0xa8>
|
|
8005022: 687b ldr r3, [r7, #4]
|
|
8005024: 681b ldr r3, [r3, #0]
|
|
8005026: 4a76 ldr r2, [pc, #472] @ (8005200 <HAL_TIM_Base_Init+0x204>)
|
|
8005028: 4293 cmp r3, r2
|
|
800502a: d03b beq.n 80050a4 <HAL_TIM_Base_Init+0xa8>
|
|
800502c: 687b ldr r3, [r7, #4]
|
|
800502e: 681b ldr r3, [r3, #0]
|
|
8005030: 4a74 ldr r2, [pc, #464] @ (8005204 <HAL_TIM_Base_Init+0x208>)
|
|
8005032: 4293 cmp r3, r2
|
|
8005034: d036 beq.n 80050a4 <HAL_TIM_Base_Init+0xa8>
|
|
8005036: 687b ldr r3, [r7, #4]
|
|
8005038: 681b ldr r3, [r3, #0]
|
|
800503a: 4a73 ldr r2, [pc, #460] @ (8005208 <HAL_TIM_Base_Init+0x20c>)
|
|
800503c: 4293 cmp r3, r2
|
|
800503e: d031 beq.n 80050a4 <HAL_TIM_Base_Init+0xa8>
|
|
8005040: 687b ldr r3, [r7, #4]
|
|
8005042: 681b ldr r3, [r3, #0]
|
|
8005044: 4a71 ldr r2, [pc, #452] @ (800520c <HAL_TIM_Base_Init+0x210>)
|
|
8005046: 4293 cmp r3, r2
|
|
8005048: d02c beq.n 80050a4 <HAL_TIM_Base_Init+0xa8>
|
|
800504a: 687b ldr r3, [r7, #4]
|
|
800504c: 681b ldr r3, [r3, #0]
|
|
800504e: 4a70 ldr r2, [pc, #448] @ (8005210 <HAL_TIM_Base_Init+0x214>)
|
|
8005050: 4293 cmp r3, r2
|
|
8005052: d027 beq.n 80050a4 <HAL_TIM_Base_Init+0xa8>
|
|
8005054: 687b ldr r3, [r7, #4]
|
|
8005056: 681b ldr r3, [r3, #0]
|
|
8005058: 4a6e ldr r2, [pc, #440] @ (8005214 <HAL_TIM_Base_Init+0x218>)
|
|
800505a: 4293 cmp r3, r2
|
|
800505c: d022 beq.n 80050a4 <HAL_TIM_Base_Init+0xa8>
|
|
800505e: 687b ldr r3, [r7, #4]
|
|
8005060: 681b ldr r3, [r3, #0]
|
|
8005062: 4a6d ldr r2, [pc, #436] @ (8005218 <HAL_TIM_Base_Init+0x21c>)
|
|
8005064: 4293 cmp r3, r2
|
|
8005066: d01d beq.n 80050a4 <HAL_TIM_Base_Init+0xa8>
|
|
8005068: 687b ldr r3, [r7, #4]
|
|
800506a: 681b ldr r3, [r3, #0]
|
|
800506c: 4a6b ldr r2, [pc, #428] @ (800521c <HAL_TIM_Base_Init+0x220>)
|
|
800506e: 4293 cmp r3, r2
|
|
8005070: d018 beq.n 80050a4 <HAL_TIM_Base_Init+0xa8>
|
|
8005072: 687b ldr r3, [r7, #4]
|
|
8005074: 681b ldr r3, [r3, #0]
|
|
8005076: 4a6a ldr r2, [pc, #424] @ (8005220 <HAL_TIM_Base_Init+0x224>)
|
|
8005078: 4293 cmp r3, r2
|
|
800507a: d013 beq.n 80050a4 <HAL_TIM_Base_Init+0xa8>
|
|
800507c: 687b ldr r3, [r7, #4]
|
|
800507e: 681b ldr r3, [r3, #0]
|
|
8005080: 4a68 ldr r2, [pc, #416] @ (8005224 <HAL_TIM_Base_Init+0x228>)
|
|
8005082: 4293 cmp r3, r2
|
|
8005084: d00e beq.n 80050a4 <HAL_TIM_Base_Init+0xa8>
|
|
8005086: 687b ldr r3, [r7, #4]
|
|
8005088: 681b ldr r3, [r3, #0]
|
|
800508a: 4a67 ldr r2, [pc, #412] @ (8005228 <HAL_TIM_Base_Init+0x22c>)
|
|
800508c: 4293 cmp r3, r2
|
|
800508e: d009 beq.n 80050a4 <HAL_TIM_Base_Init+0xa8>
|
|
8005090: 687b ldr r3, [r7, #4]
|
|
8005092: 681b ldr r3, [r3, #0]
|
|
8005094: 4a65 ldr r2, [pc, #404] @ (800522c <HAL_TIM_Base_Init+0x230>)
|
|
8005096: 4293 cmp r3, r2
|
|
8005098: d004 beq.n 80050a4 <HAL_TIM_Base_Init+0xa8>
|
|
800509a: f240 1113 movw r1, #275 @ 0x113
|
|
800509e: 4864 ldr r0, [pc, #400] @ (8005230 <HAL_TIM_Base_Init+0x234>)
|
|
80050a0: f7fb fe48 bl 8000d34 <assert_failed>
|
|
assert_param(IS_TIM_COUNTER_MODE(htim->Init.CounterMode));
|
|
80050a4: 687b ldr r3, [r7, #4]
|
|
80050a6: 689b ldr r3, [r3, #8]
|
|
80050a8: 2b00 cmp r3, #0
|
|
80050aa: d014 beq.n 80050d6 <HAL_TIM_Base_Init+0xda>
|
|
80050ac: 687b ldr r3, [r7, #4]
|
|
80050ae: 689b ldr r3, [r3, #8]
|
|
80050b0: 2b10 cmp r3, #16
|
|
80050b2: d010 beq.n 80050d6 <HAL_TIM_Base_Init+0xda>
|
|
80050b4: 687b ldr r3, [r7, #4]
|
|
80050b6: 689b ldr r3, [r3, #8]
|
|
80050b8: 2b20 cmp r3, #32
|
|
80050ba: d00c beq.n 80050d6 <HAL_TIM_Base_Init+0xda>
|
|
80050bc: 687b ldr r3, [r7, #4]
|
|
80050be: 689b ldr r3, [r3, #8]
|
|
80050c0: 2b40 cmp r3, #64 @ 0x40
|
|
80050c2: d008 beq.n 80050d6 <HAL_TIM_Base_Init+0xda>
|
|
80050c4: 687b ldr r3, [r7, #4]
|
|
80050c6: 689b ldr r3, [r3, #8]
|
|
80050c8: 2b60 cmp r3, #96 @ 0x60
|
|
80050ca: d004 beq.n 80050d6 <HAL_TIM_Base_Init+0xda>
|
|
80050cc: f44f 718a mov.w r1, #276 @ 0x114
|
|
80050d0: 4857 ldr r0, [pc, #348] @ (8005230 <HAL_TIM_Base_Init+0x234>)
|
|
80050d2: f7fb fe2f bl 8000d34 <assert_failed>
|
|
assert_param(IS_TIM_CLOCKDIVISION_DIV(htim->Init.ClockDivision));
|
|
80050d6: 687b ldr r3, [r7, #4]
|
|
80050d8: 691b ldr r3, [r3, #16]
|
|
80050da: 2b00 cmp r3, #0
|
|
80050dc: d00e beq.n 80050fc <HAL_TIM_Base_Init+0x100>
|
|
80050de: 687b ldr r3, [r7, #4]
|
|
80050e0: 691b ldr r3, [r3, #16]
|
|
80050e2: f5b3 7f80 cmp.w r3, #256 @ 0x100
|
|
80050e6: d009 beq.n 80050fc <HAL_TIM_Base_Init+0x100>
|
|
80050e8: 687b ldr r3, [r7, #4]
|
|
80050ea: 691b ldr r3, [r3, #16]
|
|
80050ec: f5b3 7f00 cmp.w r3, #512 @ 0x200
|
|
80050f0: d004 beq.n 80050fc <HAL_TIM_Base_Init+0x100>
|
|
80050f2: f240 1115 movw r1, #277 @ 0x115
|
|
80050f6: 484e ldr r0, [pc, #312] @ (8005230 <HAL_TIM_Base_Init+0x234>)
|
|
80050f8: f7fb fe1c bl 8000d34 <assert_failed>
|
|
assert_param(IS_TIM_PERIOD(htim, htim->Init.Period));
|
|
80050fc: 687b ldr r3, [r7, #4]
|
|
80050fe: 681b ldr r3, [r3, #0]
|
|
8005100: f1b3 4f80 cmp.w r3, #1073741824 @ 0x40000000
|
|
8005104: d004 beq.n 8005110 <HAL_TIM_Base_Init+0x114>
|
|
8005106: 687b ldr r3, [r7, #4]
|
|
8005108: 681b ldr r3, [r3, #0]
|
|
800510a: 4a3f ldr r2, [pc, #252] @ (8005208 <HAL_TIM_Base_Init+0x20c>)
|
|
800510c: 4293 cmp r3, r2
|
|
800510e: d101 bne.n 8005114 <HAL_TIM_Base_Init+0x118>
|
|
8005110: 2301 movs r3, #1
|
|
8005112: e000 b.n 8005116 <HAL_TIM_Base_Init+0x11a>
|
|
8005114: 2300 movs r3, #0
|
|
8005116: 2b00 cmp r3, #0
|
|
8005118: d10f bne.n 800513a <HAL_TIM_Base_Init+0x13e>
|
|
800511a: 687b ldr r3, [r7, #4]
|
|
800511c: 68db ldr r3, [r3, #12]
|
|
800511e: 2b00 cmp r3, #0
|
|
8005120: d006 beq.n 8005130 <HAL_TIM_Base_Init+0x134>
|
|
8005122: 687b ldr r3, [r7, #4]
|
|
8005124: 68db ldr r3, [r3, #12]
|
|
8005126: f5b3 3f80 cmp.w r3, #65536 @ 0x10000
|
|
800512a: d201 bcs.n 8005130 <HAL_TIM_Base_Init+0x134>
|
|
800512c: 2301 movs r3, #1
|
|
800512e: e000 b.n 8005132 <HAL_TIM_Base_Init+0x136>
|
|
8005130: 2300 movs r3, #0
|
|
8005132: f003 0301 and.w r3, r3, #1
|
|
8005136: b2db uxtb r3, r3
|
|
8005138: e006 b.n 8005148 <HAL_TIM_Base_Init+0x14c>
|
|
800513a: 687b ldr r3, [r7, #4]
|
|
800513c: 68db ldr r3, [r3, #12]
|
|
800513e: 2b00 cmp r3, #0
|
|
8005140: bf14 ite ne
|
|
8005142: 2301 movne r3, #1
|
|
8005144: 2300 moveq r3, #0
|
|
8005146: b2db uxtb r3, r3
|
|
8005148: 2b00 cmp r3, #0
|
|
800514a: d104 bne.n 8005156 <HAL_TIM_Base_Init+0x15a>
|
|
800514c: f44f 718b mov.w r1, #278 @ 0x116
|
|
8005150: 4837 ldr r0, [pc, #220] @ (8005230 <HAL_TIM_Base_Init+0x234>)
|
|
8005152: f7fb fdef bl 8000d34 <assert_failed>
|
|
assert_param(IS_TIM_AUTORELOAD_PRELOAD(htim->Init.AutoReloadPreload));
|
|
8005156: 687b ldr r3, [r7, #4]
|
|
8005158: 699b ldr r3, [r3, #24]
|
|
800515a: 2b00 cmp r3, #0
|
|
800515c: d008 beq.n 8005170 <HAL_TIM_Base_Init+0x174>
|
|
800515e: 687b ldr r3, [r7, #4]
|
|
8005160: 699b ldr r3, [r3, #24]
|
|
8005162: 2b80 cmp r3, #128 @ 0x80
|
|
8005164: d004 beq.n 8005170 <HAL_TIM_Base_Init+0x174>
|
|
8005166: f240 1117 movw r1, #279 @ 0x117
|
|
800516a: 4831 ldr r0, [pc, #196] @ (8005230 <HAL_TIM_Base_Init+0x234>)
|
|
800516c: f7fb fde2 bl 8000d34 <assert_failed>
|
|
|
|
if (htim->State == HAL_TIM_STATE_RESET)
|
|
8005170: 687b ldr r3, [r7, #4]
|
|
8005172: f893 303d ldrb.w r3, [r3, #61] @ 0x3d
|
|
8005176: b2db uxtb r3, r3
|
|
8005178: 2b00 cmp r3, #0
|
|
800517a: d106 bne.n 800518a <HAL_TIM_Base_Init+0x18e>
|
|
{
|
|
/* Allocate lock resource and initialize it */
|
|
htim->Lock = HAL_UNLOCKED;
|
|
800517c: 687b ldr r3, [r7, #4]
|
|
800517e: 2200 movs r2, #0
|
|
8005180: f883 203c strb.w r2, [r3, #60] @ 0x3c
|
|
}
|
|
/* Init the low level hardware : GPIO, CLOCK, NVIC */
|
|
htim->Base_MspInitCallback(htim);
|
|
#else
|
|
/* Init the low level hardware : GPIO, CLOCK, NVIC */
|
|
HAL_TIM_Base_MspInit(htim);
|
|
8005184: 6878 ldr r0, [r7, #4]
|
|
8005186: f000 f855 bl 8005234 <HAL_TIM_Base_MspInit>
|
|
#endif /* USE_HAL_TIM_REGISTER_CALLBACKS */
|
|
}
|
|
|
|
/* Set the TIM state */
|
|
htim->State = HAL_TIM_STATE_BUSY;
|
|
800518a: 687b ldr r3, [r7, #4]
|
|
800518c: 2202 movs r2, #2
|
|
800518e: f883 203d strb.w r2, [r3, #61] @ 0x3d
|
|
|
|
/* Set the Time Base configuration */
|
|
TIM_Base_SetConfig(htim->Instance, &htim->Init);
|
|
8005192: 687b ldr r3, [r7, #4]
|
|
8005194: 681a ldr r2, [r3, #0]
|
|
8005196: 687b ldr r3, [r7, #4]
|
|
8005198: 3304 adds r3, #4
|
|
800519a: 4619 mov r1, r3
|
|
800519c: 4610 mov r0, r2
|
|
800519e: f000 fa31 bl 8005604 <TIM_Base_SetConfig>
|
|
|
|
/* Initialize the DMA burst operation state */
|
|
htim->DMABurstState = HAL_DMA_BURST_STATE_READY;
|
|
80051a2: 687b ldr r3, [r7, #4]
|
|
80051a4: 2201 movs r2, #1
|
|
80051a6: f883 2046 strb.w r2, [r3, #70] @ 0x46
|
|
|
|
/* Initialize the TIM channels state */
|
|
TIM_CHANNEL_STATE_SET_ALL(htim, HAL_TIM_CHANNEL_STATE_READY);
|
|
80051aa: 687b ldr r3, [r7, #4]
|
|
80051ac: 2201 movs r2, #1
|
|
80051ae: f883 203e strb.w r2, [r3, #62] @ 0x3e
|
|
80051b2: 687b ldr r3, [r7, #4]
|
|
80051b4: 2201 movs r2, #1
|
|
80051b6: f883 203f strb.w r2, [r3, #63] @ 0x3f
|
|
80051ba: 687b ldr r3, [r7, #4]
|
|
80051bc: 2201 movs r2, #1
|
|
80051be: f883 2040 strb.w r2, [r3, #64] @ 0x40
|
|
80051c2: 687b ldr r3, [r7, #4]
|
|
80051c4: 2201 movs r2, #1
|
|
80051c6: f883 2041 strb.w r2, [r3, #65] @ 0x41
|
|
TIM_CHANNEL_N_STATE_SET_ALL(htim, HAL_TIM_CHANNEL_STATE_READY);
|
|
80051ca: 687b ldr r3, [r7, #4]
|
|
80051cc: 2201 movs r2, #1
|
|
80051ce: f883 2042 strb.w r2, [r3, #66] @ 0x42
|
|
80051d2: 687b ldr r3, [r7, #4]
|
|
80051d4: 2201 movs r2, #1
|
|
80051d6: f883 2043 strb.w r2, [r3, #67] @ 0x43
|
|
80051da: 687b ldr r3, [r7, #4]
|
|
80051dc: 2201 movs r2, #1
|
|
80051de: f883 2044 strb.w r2, [r3, #68] @ 0x44
|
|
80051e2: 687b ldr r3, [r7, #4]
|
|
80051e4: 2201 movs r2, #1
|
|
80051e6: f883 2045 strb.w r2, [r3, #69] @ 0x45
|
|
|
|
/* Initialize the TIM state*/
|
|
htim->State = HAL_TIM_STATE_READY;
|
|
80051ea: 687b ldr r3, [r7, #4]
|
|
80051ec: 2201 movs r2, #1
|
|
80051ee: f883 203d strb.w r2, [r3, #61] @ 0x3d
|
|
|
|
return HAL_OK;
|
|
80051f2: 2300 movs r3, #0
|
|
}
|
|
80051f4: 4618 mov r0, r3
|
|
80051f6: 3708 adds r7, #8
|
|
80051f8: 46bd mov sp, r7
|
|
80051fa: bd80 pop {r7, pc}
|
|
80051fc: 40010000 .word 0x40010000
|
|
8005200: 40000400 .word 0x40000400
|
|
8005204: 40000800 .word 0x40000800
|
|
8005208: 40000c00 .word 0x40000c00
|
|
800520c: 40001000 .word 0x40001000
|
|
8005210: 40001400 .word 0x40001400
|
|
8005214: 40010400 .word 0x40010400
|
|
8005218: 40014000 .word 0x40014000
|
|
800521c: 40014400 .word 0x40014400
|
|
8005220: 40014800 .word 0x40014800
|
|
8005224: 40001800 .word 0x40001800
|
|
8005228: 40001c00 .word 0x40001c00
|
|
800522c: 40002000 .word 0x40002000
|
|
8005230: 0800a214 .word 0x0800a214
|
|
|
|
08005234 <HAL_TIM_Base_MspInit>:
|
|
* @brief Initializes the TIM Base MSP.
|
|
* @param htim TIM Base handle
|
|
* @retval None
|
|
*/
|
|
__weak void HAL_TIM_Base_MspInit(TIM_HandleTypeDef *htim)
|
|
{
|
|
8005234: b480 push {r7}
|
|
8005236: b083 sub sp, #12
|
|
8005238: af00 add r7, sp, #0
|
|
800523a: 6078 str r0, [r7, #4]
|
|
UNUSED(htim);
|
|
|
|
/* NOTE : This function should not be modified, when the callback is needed,
|
|
the HAL_TIM_Base_MspInit could be implemented in the user file
|
|
*/
|
|
}
|
|
800523c: bf00 nop
|
|
800523e: 370c adds r7, #12
|
|
8005240: 46bd mov sp, r7
|
|
8005242: f85d 7b04 ldr.w r7, [sp], #4
|
|
8005246: 4770 bx lr
|
|
|
|
08005248 <HAL_TIM_Base_Start_IT>:
|
|
* @brief Starts the TIM Base generation in interrupt mode.
|
|
* @param htim TIM Base handle
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_TIM_Base_Start_IT(TIM_HandleTypeDef *htim)
|
|
{
|
|
8005248: b580 push {r7, lr}
|
|
800524a: b084 sub sp, #16
|
|
800524c: af00 add r7, sp, #0
|
|
800524e: 6078 str r0, [r7, #4]
|
|
uint32_t tmpsmcr;
|
|
|
|
/* Check the parameters */
|
|
assert_param(IS_TIM_INSTANCE(htim->Instance));
|
|
8005250: 687b ldr r3, [r7, #4]
|
|
8005252: 681b ldr r3, [r3, #0]
|
|
8005254: 4a51 ldr r2, [pc, #324] @ (800539c <HAL_TIM_Base_Start_IT+0x154>)
|
|
8005256: 4293 cmp r3, r2
|
|
8005258: d045 beq.n 80052e6 <HAL_TIM_Base_Start_IT+0x9e>
|
|
800525a: 687b ldr r3, [r7, #4]
|
|
800525c: 681b ldr r3, [r3, #0]
|
|
800525e: f1b3 4f80 cmp.w r3, #1073741824 @ 0x40000000
|
|
8005262: d040 beq.n 80052e6 <HAL_TIM_Base_Start_IT+0x9e>
|
|
8005264: 687b ldr r3, [r7, #4]
|
|
8005266: 681b ldr r3, [r3, #0]
|
|
8005268: 4a4d ldr r2, [pc, #308] @ (80053a0 <HAL_TIM_Base_Start_IT+0x158>)
|
|
800526a: 4293 cmp r3, r2
|
|
800526c: d03b beq.n 80052e6 <HAL_TIM_Base_Start_IT+0x9e>
|
|
800526e: 687b ldr r3, [r7, #4]
|
|
8005270: 681b ldr r3, [r3, #0]
|
|
8005272: 4a4c ldr r2, [pc, #304] @ (80053a4 <HAL_TIM_Base_Start_IT+0x15c>)
|
|
8005274: 4293 cmp r3, r2
|
|
8005276: d036 beq.n 80052e6 <HAL_TIM_Base_Start_IT+0x9e>
|
|
8005278: 687b ldr r3, [r7, #4]
|
|
800527a: 681b ldr r3, [r3, #0]
|
|
800527c: 4a4a ldr r2, [pc, #296] @ (80053a8 <HAL_TIM_Base_Start_IT+0x160>)
|
|
800527e: 4293 cmp r3, r2
|
|
8005280: d031 beq.n 80052e6 <HAL_TIM_Base_Start_IT+0x9e>
|
|
8005282: 687b ldr r3, [r7, #4]
|
|
8005284: 681b ldr r3, [r3, #0]
|
|
8005286: 4a49 ldr r2, [pc, #292] @ (80053ac <HAL_TIM_Base_Start_IT+0x164>)
|
|
8005288: 4293 cmp r3, r2
|
|
800528a: d02c beq.n 80052e6 <HAL_TIM_Base_Start_IT+0x9e>
|
|
800528c: 687b ldr r3, [r7, #4]
|
|
800528e: 681b ldr r3, [r3, #0]
|
|
8005290: 4a47 ldr r2, [pc, #284] @ (80053b0 <HAL_TIM_Base_Start_IT+0x168>)
|
|
8005292: 4293 cmp r3, r2
|
|
8005294: d027 beq.n 80052e6 <HAL_TIM_Base_Start_IT+0x9e>
|
|
8005296: 687b ldr r3, [r7, #4]
|
|
8005298: 681b ldr r3, [r3, #0]
|
|
800529a: 4a46 ldr r2, [pc, #280] @ (80053b4 <HAL_TIM_Base_Start_IT+0x16c>)
|
|
800529c: 4293 cmp r3, r2
|
|
800529e: d022 beq.n 80052e6 <HAL_TIM_Base_Start_IT+0x9e>
|
|
80052a0: 687b ldr r3, [r7, #4]
|
|
80052a2: 681b ldr r3, [r3, #0]
|
|
80052a4: 4a44 ldr r2, [pc, #272] @ (80053b8 <HAL_TIM_Base_Start_IT+0x170>)
|
|
80052a6: 4293 cmp r3, r2
|
|
80052a8: d01d beq.n 80052e6 <HAL_TIM_Base_Start_IT+0x9e>
|
|
80052aa: 687b ldr r3, [r7, #4]
|
|
80052ac: 681b ldr r3, [r3, #0]
|
|
80052ae: 4a43 ldr r2, [pc, #268] @ (80053bc <HAL_TIM_Base_Start_IT+0x174>)
|
|
80052b0: 4293 cmp r3, r2
|
|
80052b2: d018 beq.n 80052e6 <HAL_TIM_Base_Start_IT+0x9e>
|
|
80052b4: 687b ldr r3, [r7, #4]
|
|
80052b6: 681b ldr r3, [r3, #0]
|
|
80052b8: 4a41 ldr r2, [pc, #260] @ (80053c0 <HAL_TIM_Base_Start_IT+0x178>)
|
|
80052ba: 4293 cmp r3, r2
|
|
80052bc: d013 beq.n 80052e6 <HAL_TIM_Base_Start_IT+0x9e>
|
|
80052be: 687b ldr r3, [r7, #4]
|
|
80052c0: 681b ldr r3, [r3, #0]
|
|
80052c2: 4a40 ldr r2, [pc, #256] @ (80053c4 <HAL_TIM_Base_Start_IT+0x17c>)
|
|
80052c4: 4293 cmp r3, r2
|
|
80052c6: d00e beq.n 80052e6 <HAL_TIM_Base_Start_IT+0x9e>
|
|
80052c8: 687b ldr r3, [r7, #4]
|
|
80052ca: 681b ldr r3, [r3, #0]
|
|
80052cc: 4a3e ldr r2, [pc, #248] @ (80053c8 <HAL_TIM_Base_Start_IT+0x180>)
|
|
80052ce: 4293 cmp r3, r2
|
|
80052d0: d009 beq.n 80052e6 <HAL_TIM_Base_Start_IT+0x9e>
|
|
80052d2: 687b ldr r3, [r7, #4]
|
|
80052d4: 681b ldr r3, [r3, #0]
|
|
80052d6: 4a3d ldr r2, [pc, #244] @ (80053cc <HAL_TIM_Base_Start_IT+0x184>)
|
|
80052d8: 4293 cmp r3, r2
|
|
80052da: d004 beq.n 80052e6 <HAL_TIM_Base_Start_IT+0x9e>
|
|
80052dc: f44f 71e8 mov.w r1, #464 @ 0x1d0
|
|
80052e0: 483b ldr r0, [pc, #236] @ (80053d0 <HAL_TIM_Base_Start_IT+0x188>)
|
|
80052e2: f7fb fd27 bl 8000d34 <assert_failed>
|
|
|
|
/* Check the TIM state */
|
|
if (htim->State != HAL_TIM_STATE_READY)
|
|
80052e6: 687b ldr r3, [r7, #4]
|
|
80052e8: f893 303d ldrb.w r3, [r3, #61] @ 0x3d
|
|
80052ec: b2db uxtb r3, r3
|
|
80052ee: 2b01 cmp r3, #1
|
|
80052f0: d001 beq.n 80052f6 <HAL_TIM_Base_Start_IT+0xae>
|
|
{
|
|
return HAL_ERROR;
|
|
80052f2: 2301 movs r3, #1
|
|
80052f4: e04e b.n 8005394 <HAL_TIM_Base_Start_IT+0x14c>
|
|
}
|
|
|
|
/* Set the TIM state */
|
|
htim->State = HAL_TIM_STATE_BUSY;
|
|
80052f6: 687b ldr r3, [r7, #4]
|
|
80052f8: 2202 movs r2, #2
|
|
80052fa: f883 203d strb.w r2, [r3, #61] @ 0x3d
|
|
|
|
/* Enable the TIM Update interrupt */
|
|
__HAL_TIM_ENABLE_IT(htim, TIM_IT_UPDATE);
|
|
80052fe: 687b ldr r3, [r7, #4]
|
|
8005300: 681b ldr r3, [r3, #0]
|
|
8005302: 68da ldr r2, [r3, #12]
|
|
8005304: 687b ldr r3, [r7, #4]
|
|
8005306: 681b ldr r3, [r3, #0]
|
|
8005308: f042 0201 orr.w r2, r2, #1
|
|
800530c: 60da str r2, [r3, #12]
|
|
|
|
/* Enable the Peripheral, except in trigger mode where enable is automatically done with trigger */
|
|
if (IS_TIM_SLAVE_INSTANCE(htim->Instance))
|
|
800530e: 687b ldr r3, [r7, #4]
|
|
8005310: 681b ldr r3, [r3, #0]
|
|
8005312: 4a22 ldr r2, [pc, #136] @ (800539c <HAL_TIM_Base_Start_IT+0x154>)
|
|
8005314: 4293 cmp r3, r2
|
|
8005316: d022 beq.n 800535e <HAL_TIM_Base_Start_IT+0x116>
|
|
8005318: 687b ldr r3, [r7, #4]
|
|
800531a: 681b ldr r3, [r3, #0]
|
|
800531c: f1b3 4f80 cmp.w r3, #1073741824 @ 0x40000000
|
|
8005320: d01d beq.n 800535e <HAL_TIM_Base_Start_IT+0x116>
|
|
8005322: 687b ldr r3, [r7, #4]
|
|
8005324: 681b ldr r3, [r3, #0]
|
|
8005326: 4a1e ldr r2, [pc, #120] @ (80053a0 <HAL_TIM_Base_Start_IT+0x158>)
|
|
8005328: 4293 cmp r3, r2
|
|
800532a: d018 beq.n 800535e <HAL_TIM_Base_Start_IT+0x116>
|
|
800532c: 687b ldr r3, [r7, #4]
|
|
800532e: 681b ldr r3, [r3, #0]
|
|
8005330: 4a1c ldr r2, [pc, #112] @ (80053a4 <HAL_TIM_Base_Start_IT+0x15c>)
|
|
8005332: 4293 cmp r3, r2
|
|
8005334: d013 beq.n 800535e <HAL_TIM_Base_Start_IT+0x116>
|
|
8005336: 687b ldr r3, [r7, #4]
|
|
8005338: 681b ldr r3, [r3, #0]
|
|
800533a: 4a1b ldr r2, [pc, #108] @ (80053a8 <HAL_TIM_Base_Start_IT+0x160>)
|
|
800533c: 4293 cmp r3, r2
|
|
800533e: d00e beq.n 800535e <HAL_TIM_Base_Start_IT+0x116>
|
|
8005340: 687b ldr r3, [r7, #4]
|
|
8005342: 681b ldr r3, [r3, #0]
|
|
8005344: 4a1b ldr r2, [pc, #108] @ (80053b4 <HAL_TIM_Base_Start_IT+0x16c>)
|
|
8005346: 4293 cmp r3, r2
|
|
8005348: d009 beq.n 800535e <HAL_TIM_Base_Start_IT+0x116>
|
|
800534a: 687b ldr r3, [r7, #4]
|
|
800534c: 681b ldr r3, [r3, #0]
|
|
800534e: 4a1a ldr r2, [pc, #104] @ (80053b8 <HAL_TIM_Base_Start_IT+0x170>)
|
|
8005350: 4293 cmp r3, r2
|
|
8005352: d004 beq.n 800535e <HAL_TIM_Base_Start_IT+0x116>
|
|
8005354: 687b ldr r3, [r7, #4]
|
|
8005356: 681b ldr r3, [r3, #0]
|
|
8005358: 4a1a ldr r2, [pc, #104] @ (80053c4 <HAL_TIM_Base_Start_IT+0x17c>)
|
|
800535a: 4293 cmp r3, r2
|
|
800535c: d111 bne.n 8005382 <HAL_TIM_Base_Start_IT+0x13a>
|
|
{
|
|
tmpsmcr = htim->Instance->SMCR & TIM_SMCR_SMS;
|
|
800535e: 687b ldr r3, [r7, #4]
|
|
8005360: 681b ldr r3, [r3, #0]
|
|
8005362: 689b ldr r3, [r3, #8]
|
|
8005364: f003 0307 and.w r3, r3, #7
|
|
8005368: 60fb str r3, [r7, #12]
|
|
if (!IS_TIM_SLAVEMODE_TRIGGER_ENABLED(tmpsmcr))
|
|
800536a: 68fb ldr r3, [r7, #12]
|
|
800536c: 2b06 cmp r3, #6
|
|
800536e: d010 beq.n 8005392 <HAL_TIM_Base_Start_IT+0x14a>
|
|
{
|
|
__HAL_TIM_ENABLE(htim);
|
|
8005370: 687b ldr r3, [r7, #4]
|
|
8005372: 681b ldr r3, [r3, #0]
|
|
8005374: 681a ldr r2, [r3, #0]
|
|
8005376: 687b ldr r3, [r7, #4]
|
|
8005378: 681b ldr r3, [r3, #0]
|
|
800537a: f042 0201 orr.w r2, r2, #1
|
|
800537e: 601a str r2, [r3, #0]
|
|
if (!IS_TIM_SLAVEMODE_TRIGGER_ENABLED(tmpsmcr))
|
|
8005380: e007 b.n 8005392 <HAL_TIM_Base_Start_IT+0x14a>
|
|
}
|
|
}
|
|
else
|
|
{
|
|
__HAL_TIM_ENABLE(htim);
|
|
8005382: 687b ldr r3, [r7, #4]
|
|
8005384: 681b ldr r3, [r3, #0]
|
|
8005386: 681a ldr r2, [r3, #0]
|
|
8005388: 687b ldr r3, [r7, #4]
|
|
800538a: 681b ldr r3, [r3, #0]
|
|
800538c: f042 0201 orr.w r2, r2, #1
|
|
8005390: 601a str r2, [r3, #0]
|
|
}
|
|
|
|
/* Return function status */
|
|
return HAL_OK;
|
|
8005392: 2300 movs r3, #0
|
|
}
|
|
8005394: 4618 mov r0, r3
|
|
8005396: 3710 adds r7, #16
|
|
8005398: 46bd mov sp, r7
|
|
800539a: bd80 pop {r7, pc}
|
|
800539c: 40010000 .word 0x40010000
|
|
80053a0: 40000400 .word 0x40000400
|
|
80053a4: 40000800 .word 0x40000800
|
|
80053a8: 40000c00 .word 0x40000c00
|
|
80053ac: 40001000 .word 0x40001000
|
|
80053b0: 40001400 .word 0x40001400
|
|
80053b4: 40010400 .word 0x40010400
|
|
80053b8: 40014000 .word 0x40014000
|
|
80053bc: 40014400 .word 0x40014400
|
|
80053c0: 40014800 .word 0x40014800
|
|
80053c4: 40001800 .word 0x40001800
|
|
80053c8: 40001c00 .word 0x40001c00
|
|
80053cc: 40002000 .word 0x40002000
|
|
80053d0: 0800a214 .word 0x0800a214
|
|
|
|
080053d4 <HAL_TIM_IRQHandler>:
|
|
* @brief This function handles TIM interrupts requests.
|
|
* @param htim TIM handle
|
|
* @retval None
|
|
*/
|
|
void HAL_TIM_IRQHandler(TIM_HandleTypeDef *htim)
|
|
{
|
|
80053d4: b580 push {r7, lr}
|
|
80053d6: b084 sub sp, #16
|
|
80053d8: af00 add r7, sp, #0
|
|
80053da: 6078 str r0, [r7, #4]
|
|
uint32_t itsource = htim->Instance->DIER;
|
|
80053dc: 687b ldr r3, [r7, #4]
|
|
80053de: 681b ldr r3, [r3, #0]
|
|
80053e0: 68db ldr r3, [r3, #12]
|
|
80053e2: 60fb str r3, [r7, #12]
|
|
uint32_t itflag = htim->Instance->SR;
|
|
80053e4: 687b ldr r3, [r7, #4]
|
|
80053e6: 681b ldr r3, [r3, #0]
|
|
80053e8: 691b ldr r3, [r3, #16]
|
|
80053ea: 60bb str r3, [r7, #8]
|
|
|
|
/* Capture compare 1 event */
|
|
if ((itflag & (TIM_FLAG_CC1)) == (TIM_FLAG_CC1))
|
|
80053ec: 68bb ldr r3, [r7, #8]
|
|
80053ee: f003 0302 and.w r3, r3, #2
|
|
80053f2: 2b00 cmp r3, #0
|
|
80053f4: d020 beq.n 8005438 <HAL_TIM_IRQHandler+0x64>
|
|
{
|
|
if ((itsource & (TIM_IT_CC1)) == (TIM_IT_CC1))
|
|
80053f6: 68fb ldr r3, [r7, #12]
|
|
80053f8: f003 0302 and.w r3, r3, #2
|
|
80053fc: 2b00 cmp r3, #0
|
|
80053fe: d01b beq.n 8005438 <HAL_TIM_IRQHandler+0x64>
|
|
{
|
|
{
|
|
__HAL_TIM_CLEAR_FLAG(htim, TIM_FLAG_CC1);
|
|
8005400: 687b ldr r3, [r7, #4]
|
|
8005402: 681b ldr r3, [r3, #0]
|
|
8005404: f06f 0202 mvn.w r2, #2
|
|
8005408: 611a str r2, [r3, #16]
|
|
htim->Channel = HAL_TIM_ACTIVE_CHANNEL_1;
|
|
800540a: 687b ldr r3, [r7, #4]
|
|
800540c: 2201 movs r2, #1
|
|
800540e: 771a strb r2, [r3, #28]
|
|
|
|
/* Input capture event */
|
|
if ((htim->Instance->CCMR1 & TIM_CCMR1_CC1S) != 0x00U)
|
|
8005410: 687b ldr r3, [r7, #4]
|
|
8005412: 681b ldr r3, [r3, #0]
|
|
8005414: 699b ldr r3, [r3, #24]
|
|
8005416: f003 0303 and.w r3, r3, #3
|
|
800541a: 2b00 cmp r3, #0
|
|
800541c: d003 beq.n 8005426 <HAL_TIM_IRQHandler+0x52>
|
|
{
|
|
#if (USE_HAL_TIM_REGISTER_CALLBACKS == 1)
|
|
htim->IC_CaptureCallback(htim);
|
|
#else
|
|
HAL_TIM_IC_CaptureCallback(htim);
|
|
800541e: 6878 ldr r0, [r7, #4]
|
|
8005420: f000 f8d2 bl 80055c8 <HAL_TIM_IC_CaptureCallback>
|
|
8005424: e005 b.n 8005432 <HAL_TIM_IRQHandler+0x5e>
|
|
{
|
|
#if (USE_HAL_TIM_REGISTER_CALLBACKS == 1)
|
|
htim->OC_DelayElapsedCallback(htim);
|
|
htim->PWM_PulseFinishedCallback(htim);
|
|
#else
|
|
HAL_TIM_OC_DelayElapsedCallback(htim);
|
|
8005426: 6878 ldr r0, [r7, #4]
|
|
8005428: f000 f8c4 bl 80055b4 <HAL_TIM_OC_DelayElapsedCallback>
|
|
HAL_TIM_PWM_PulseFinishedCallback(htim);
|
|
800542c: 6878 ldr r0, [r7, #4]
|
|
800542e: f000 f8d5 bl 80055dc <HAL_TIM_PWM_PulseFinishedCallback>
|
|
#endif /* USE_HAL_TIM_REGISTER_CALLBACKS */
|
|
}
|
|
htim->Channel = HAL_TIM_ACTIVE_CHANNEL_CLEARED;
|
|
8005432: 687b ldr r3, [r7, #4]
|
|
8005434: 2200 movs r2, #0
|
|
8005436: 771a strb r2, [r3, #28]
|
|
}
|
|
}
|
|
}
|
|
/* Capture compare 2 event */
|
|
if ((itflag & (TIM_FLAG_CC2)) == (TIM_FLAG_CC2))
|
|
8005438: 68bb ldr r3, [r7, #8]
|
|
800543a: f003 0304 and.w r3, r3, #4
|
|
800543e: 2b00 cmp r3, #0
|
|
8005440: d020 beq.n 8005484 <HAL_TIM_IRQHandler+0xb0>
|
|
{
|
|
if ((itsource & (TIM_IT_CC2)) == (TIM_IT_CC2))
|
|
8005442: 68fb ldr r3, [r7, #12]
|
|
8005444: f003 0304 and.w r3, r3, #4
|
|
8005448: 2b00 cmp r3, #0
|
|
800544a: d01b beq.n 8005484 <HAL_TIM_IRQHandler+0xb0>
|
|
{
|
|
__HAL_TIM_CLEAR_FLAG(htim, TIM_FLAG_CC2);
|
|
800544c: 687b ldr r3, [r7, #4]
|
|
800544e: 681b ldr r3, [r3, #0]
|
|
8005450: f06f 0204 mvn.w r2, #4
|
|
8005454: 611a str r2, [r3, #16]
|
|
htim->Channel = HAL_TIM_ACTIVE_CHANNEL_2;
|
|
8005456: 687b ldr r3, [r7, #4]
|
|
8005458: 2202 movs r2, #2
|
|
800545a: 771a strb r2, [r3, #28]
|
|
/* Input capture event */
|
|
if ((htim->Instance->CCMR1 & TIM_CCMR1_CC2S) != 0x00U)
|
|
800545c: 687b ldr r3, [r7, #4]
|
|
800545e: 681b ldr r3, [r3, #0]
|
|
8005460: 699b ldr r3, [r3, #24]
|
|
8005462: f403 7340 and.w r3, r3, #768 @ 0x300
|
|
8005466: 2b00 cmp r3, #0
|
|
8005468: d003 beq.n 8005472 <HAL_TIM_IRQHandler+0x9e>
|
|
{
|
|
#if (USE_HAL_TIM_REGISTER_CALLBACKS == 1)
|
|
htim->IC_CaptureCallback(htim);
|
|
#else
|
|
HAL_TIM_IC_CaptureCallback(htim);
|
|
800546a: 6878 ldr r0, [r7, #4]
|
|
800546c: f000 f8ac bl 80055c8 <HAL_TIM_IC_CaptureCallback>
|
|
8005470: e005 b.n 800547e <HAL_TIM_IRQHandler+0xaa>
|
|
{
|
|
#if (USE_HAL_TIM_REGISTER_CALLBACKS == 1)
|
|
htim->OC_DelayElapsedCallback(htim);
|
|
htim->PWM_PulseFinishedCallback(htim);
|
|
#else
|
|
HAL_TIM_OC_DelayElapsedCallback(htim);
|
|
8005472: 6878 ldr r0, [r7, #4]
|
|
8005474: f000 f89e bl 80055b4 <HAL_TIM_OC_DelayElapsedCallback>
|
|
HAL_TIM_PWM_PulseFinishedCallback(htim);
|
|
8005478: 6878 ldr r0, [r7, #4]
|
|
800547a: f000 f8af bl 80055dc <HAL_TIM_PWM_PulseFinishedCallback>
|
|
#endif /* USE_HAL_TIM_REGISTER_CALLBACKS */
|
|
}
|
|
htim->Channel = HAL_TIM_ACTIVE_CHANNEL_CLEARED;
|
|
800547e: 687b ldr r3, [r7, #4]
|
|
8005480: 2200 movs r2, #0
|
|
8005482: 771a strb r2, [r3, #28]
|
|
}
|
|
}
|
|
/* Capture compare 3 event */
|
|
if ((itflag & (TIM_FLAG_CC3)) == (TIM_FLAG_CC3))
|
|
8005484: 68bb ldr r3, [r7, #8]
|
|
8005486: f003 0308 and.w r3, r3, #8
|
|
800548a: 2b00 cmp r3, #0
|
|
800548c: d020 beq.n 80054d0 <HAL_TIM_IRQHandler+0xfc>
|
|
{
|
|
if ((itsource & (TIM_IT_CC3)) == (TIM_IT_CC3))
|
|
800548e: 68fb ldr r3, [r7, #12]
|
|
8005490: f003 0308 and.w r3, r3, #8
|
|
8005494: 2b00 cmp r3, #0
|
|
8005496: d01b beq.n 80054d0 <HAL_TIM_IRQHandler+0xfc>
|
|
{
|
|
__HAL_TIM_CLEAR_FLAG(htim, TIM_FLAG_CC3);
|
|
8005498: 687b ldr r3, [r7, #4]
|
|
800549a: 681b ldr r3, [r3, #0]
|
|
800549c: f06f 0208 mvn.w r2, #8
|
|
80054a0: 611a str r2, [r3, #16]
|
|
htim->Channel = HAL_TIM_ACTIVE_CHANNEL_3;
|
|
80054a2: 687b ldr r3, [r7, #4]
|
|
80054a4: 2204 movs r2, #4
|
|
80054a6: 771a strb r2, [r3, #28]
|
|
/* Input capture event */
|
|
if ((htim->Instance->CCMR2 & TIM_CCMR2_CC3S) != 0x00U)
|
|
80054a8: 687b ldr r3, [r7, #4]
|
|
80054aa: 681b ldr r3, [r3, #0]
|
|
80054ac: 69db ldr r3, [r3, #28]
|
|
80054ae: f003 0303 and.w r3, r3, #3
|
|
80054b2: 2b00 cmp r3, #0
|
|
80054b4: d003 beq.n 80054be <HAL_TIM_IRQHandler+0xea>
|
|
{
|
|
#if (USE_HAL_TIM_REGISTER_CALLBACKS == 1)
|
|
htim->IC_CaptureCallback(htim);
|
|
#else
|
|
HAL_TIM_IC_CaptureCallback(htim);
|
|
80054b6: 6878 ldr r0, [r7, #4]
|
|
80054b8: f000 f886 bl 80055c8 <HAL_TIM_IC_CaptureCallback>
|
|
80054bc: e005 b.n 80054ca <HAL_TIM_IRQHandler+0xf6>
|
|
{
|
|
#if (USE_HAL_TIM_REGISTER_CALLBACKS == 1)
|
|
htim->OC_DelayElapsedCallback(htim);
|
|
htim->PWM_PulseFinishedCallback(htim);
|
|
#else
|
|
HAL_TIM_OC_DelayElapsedCallback(htim);
|
|
80054be: 6878 ldr r0, [r7, #4]
|
|
80054c0: f000 f878 bl 80055b4 <HAL_TIM_OC_DelayElapsedCallback>
|
|
HAL_TIM_PWM_PulseFinishedCallback(htim);
|
|
80054c4: 6878 ldr r0, [r7, #4]
|
|
80054c6: f000 f889 bl 80055dc <HAL_TIM_PWM_PulseFinishedCallback>
|
|
#endif /* USE_HAL_TIM_REGISTER_CALLBACKS */
|
|
}
|
|
htim->Channel = HAL_TIM_ACTIVE_CHANNEL_CLEARED;
|
|
80054ca: 687b ldr r3, [r7, #4]
|
|
80054cc: 2200 movs r2, #0
|
|
80054ce: 771a strb r2, [r3, #28]
|
|
}
|
|
}
|
|
/* Capture compare 4 event */
|
|
if ((itflag & (TIM_FLAG_CC4)) == (TIM_FLAG_CC4))
|
|
80054d0: 68bb ldr r3, [r7, #8]
|
|
80054d2: f003 0310 and.w r3, r3, #16
|
|
80054d6: 2b00 cmp r3, #0
|
|
80054d8: d020 beq.n 800551c <HAL_TIM_IRQHandler+0x148>
|
|
{
|
|
if ((itsource & (TIM_IT_CC4)) == (TIM_IT_CC4))
|
|
80054da: 68fb ldr r3, [r7, #12]
|
|
80054dc: f003 0310 and.w r3, r3, #16
|
|
80054e0: 2b00 cmp r3, #0
|
|
80054e2: d01b beq.n 800551c <HAL_TIM_IRQHandler+0x148>
|
|
{
|
|
__HAL_TIM_CLEAR_FLAG(htim, TIM_FLAG_CC4);
|
|
80054e4: 687b ldr r3, [r7, #4]
|
|
80054e6: 681b ldr r3, [r3, #0]
|
|
80054e8: f06f 0210 mvn.w r2, #16
|
|
80054ec: 611a str r2, [r3, #16]
|
|
htim->Channel = HAL_TIM_ACTIVE_CHANNEL_4;
|
|
80054ee: 687b ldr r3, [r7, #4]
|
|
80054f0: 2208 movs r2, #8
|
|
80054f2: 771a strb r2, [r3, #28]
|
|
/* Input capture event */
|
|
if ((htim->Instance->CCMR2 & TIM_CCMR2_CC4S) != 0x00U)
|
|
80054f4: 687b ldr r3, [r7, #4]
|
|
80054f6: 681b ldr r3, [r3, #0]
|
|
80054f8: 69db ldr r3, [r3, #28]
|
|
80054fa: f403 7340 and.w r3, r3, #768 @ 0x300
|
|
80054fe: 2b00 cmp r3, #0
|
|
8005500: d003 beq.n 800550a <HAL_TIM_IRQHandler+0x136>
|
|
{
|
|
#if (USE_HAL_TIM_REGISTER_CALLBACKS == 1)
|
|
htim->IC_CaptureCallback(htim);
|
|
#else
|
|
HAL_TIM_IC_CaptureCallback(htim);
|
|
8005502: 6878 ldr r0, [r7, #4]
|
|
8005504: f000 f860 bl 80055c8 <HAL_TIM_IC_CaptureCallback>
|
|
8005508: e005 b.n 8005516 <HAL_TIM_IRQHandler+0x142>
|
|
{
|
|
#if (USE_HAL_TIM_REGISTER_CALLBACKS == 1)
|
|
htim->OC_DelayElapsedCallback(htim);
|
|
htim->PWM_PulseFinishedCallback(htim);
|
|
#else
|
|
HAL_TIM_OC_DelayElapsedCallback(htim);
|
|
800550a: 6878 ldr r0, [r7, #4]
|
|
800550c: f000 f852 bl 80055b4 <HAL_TIM_OC_DelayElapsedCallback>
|
|
HAL_TIM_PWM_PulseFinishedCallback(htim);
|
|
8005510: 6878 ldr r0, [r7, #4]
|
|
8005512: f000 f863 bl 80055dc <HAL_TIM_PWM_PulseFinishedCallback>
|
|
#endif /* USE_HAL_TIM_REGISTER_CALLBACKS */
|
|
}
|
|
htim->Channel = HAL_TIM_ACTIVE_CHANNEL_CLEARED;
|
|
8005516: 687b ldr r3, [r7, #4]
|
|
8005518: 2200 movs r2, #0
|
|
800551a: 771a strb r2, [r3, #28]
|
|
}
|
|
}
|
|
/* TIM Update event */
|
|
if ((itflag & (TIM_FLAG_UPDATE)) == (TIM_FLAG_UPDATE))
|
|
800551c: 68bb ldr r3, [r7, #8]
|
|
800551e: f003 0301 and.w r3, r3, #1
|
|
8005522: 2b00 cmp r3, #0
|
|
8005524: d00c beq.n 8005540 <HAL_TIM_IRQHandler+0x16c>
|
|
{
|
|
if ((itsource & (TIM_IT_UPDATE)) == (TIM_IT_UPDATE))
|
|
8005526: 68fb ldr r3, [r7, #12]
|
|
8005528: f003 0301 and.w r3, r3, #1
|
|
800552c: 2b00 cmp r3, #0
|
|
800552e: d007 beq.n 8005540 <HAL_TIM_IRQHandler+0x16c>
|
|
{
|
|
__HAL_TIM_CLEAR_FLAG(htim, TIM_FLAG_UPDATE);
|
|
8005530: 687b ldr r3, [r7, #4]
|
|
8005532: 681b ldr r3, [r3, #0]
|
|
8005534: f06f 0201 mvn.w r2, #1
|
|
8005538: 611a str r2, [r3, #16]
|
|
#if (USE_HAL_TIM_REGISTER_CALLBACKS == 1)
|
|
htim->PeriodElapsedCallback(htim);
|
|
#else
|
|
HAL_TIM_PeriodElapsedCallback(htim);
|
|
800553a: 6878 ldr r0, [r7, #4]
|
|
800553c: f7fb fba8 bl 8000c90 <HAL_TIM_PeriodElapsedCallback>
|
|
#endif /* USE_HAL_TIM_REGISTER_CALLBACKS */
|
|
}
|
|
}
|
|
/* TIM Break input event */
|
|
if ((itflag & (TIM_FLAG_BREAK)) == (TIM_FLAG_BREAK))
|
|
8005540: 68bb ldr r3, [r7, #8]
|
|
8005542: f003 0380 and.w r3, r3, #128 @ 0x80
|
|
8005546: 2b00 cmp r3, #0
|
|
8005548: d00c beq.n 8005564 <HAL_TIM_IRQHandler+0x190>
|
|
{
|
|
if ((itsource & (TIM_IT_BREAK)) == (TIM_IT_BREAK))
|
|
800554a: 68fb ldr r3, [r7, #12]
|
|
800554c: f003 0380 and.w r3, r3, #128 @ 0x80
|
|
8005550: 2b00 cmp r3, #0
|
|
8005552: d007 beq.n 8005564 <HAL_TIM_IRQHandler+0x190>
|
|
{
|
|
__HAL_TIM_CLEAR_FLAG(htim, TIM_FLAG_BREAK);
|
|
8005554: 687b ldr r3, [r7, #4]
|
|
8005556: 681b ldr r3, [r3, #0]
|
|
8005558: f06f 0280 mvn.w r2, #128 @ 0x80
|
|
800555c: 611a str r2, [r3, #16]
|
|
#if (USE_HAL_TIM_REGISTER_CALLBACKS == 1)
|
|
htim->BreakCallback(htim);
|
|
#else
|
|
HAL_TIMEx_BreakCallback(htim);
|
|
800555e: 6878 ldr r0, [r7, #4]
|
|
8005560: f000 f900 bl 8005764 <HAL_TIMEx_BreakCallback>
|
|
#endif /* USE_HAL_TIM_REGISTER_CALLBACKS */
|
|
}
|
|
}
|
|
/* TIM Trigger detection event */
|
|
if ((itflag & (TIM_FLAG_TRIGGER)) == (TIM_FLAG_TRIGGER))
|
|
8005564: 68bb ldr r3, [r7, #8]
|
|
8005566: f003 0340 and.w r3, r3, #64 @ 0x40
|
|
800556a: 2b00 cmp r3, #0
|
|
800556c: d00c beq.n 8005588 <HAL_TIM_IRQHandler+0x1b4>
|
|
{
|
|
if ((itsource & (TIM_IT_TRIGGER)) == (TIM_IT_TRIGGER))
|
|
800556e: 68fb ldr r3, [r7, #12]
|
|
8005570: f003 0340 and.w r3, r3, #64 @ 0x40
|
|
8005574: 2b00 cmp r3, #0
|
|
8005576: d007 beq.n 8005588 <HAL_TIM_IRQHandler+0x1b4>
|
|
{
|
|
__HAL_TIM_CLEAR_FLAG(htim, TIM_FLAG_TRIGGER);
|
|
8005578: 687b ldr r3, [r7, #4]
|
|
800557a: 681b ldr r3, [r3, #0]
|
|
800557c: f06f 0240 mvn.w r2, #64 @ 0x40
|
|
8005580: 611a str r2, [r3, #16]
|
|
#if (USE_HAL_TIM_REGISTER_CALLBACKS == 1)
|
|
htim->TriggerCallback(htim);
|
|
#else
|
|
HAL_TIM_TriggerCallback(htim);
|
|
8005582: 6878 ldr r0, [r7, #4]
|
|
8005584: f000 f834 bl 80055f0 <HAL_TIM_TriggerCallback>
|
|
#endif /* USE_HAL_TIM_REGISTER_CALLBACKS */
|
|
}
|
|
}
|
|
/* TIM commutation event */
|
|
if ((itflag & (TIM_FLAG_COM)) == (TIM_FLAG_COM))
|
|
8005588: 68bb ldr r3, [r7, #8]
|
|
800558a: f003 0320 and.w r3, r3, #32
|
|
800558e: 2b00 cmp r3, #0
|
|
8005590: d00c beq.n 80055ac <HAL_TIM_IRQHandler+0x1d8>
|
|
{
|
|
if ((itsource & (TIM_IT_COM)) == (TIM_IT_COM))
|
|
8005592: 68fb ldr r3, [r7, #12]
|
|
8005594: f003 0320 and.w r3, r3, #32
|
|
8005598: 2b00 cmp r3, #0
|
|
800559a: d007 beq.n 80055ac <HAL_TIM_IRQHandler+0x1d8>
|
|
{
|
|
__HAL_TIM_CLEAR_FLAG(htim, TIM_FLAG_COM);
|
|
800559c: 687b ldr r3, [r7, #4]
|
|
800559e: 681b ldr r3, [r3, #0]
|
|
80055a0: f06f 0220 mvn.w r2, #32
|
|
80055a4: 611a str r2, [r3, #16]
|
|
#if (USE_HAL_TIM_REGISTER_CALLBACKS == 1)
|
|
htim->CommutationCallback(htim);
|
|
#else
|
|
HAL_TIMEx_CommutCallback(htim);
|
|
80055a6: 6878 ldr r0, [r7, #4]
|
|
80055a8: f000 f8d2 bl 8005750 <HAL_TIMEx_CommutCallback>
|
|
#endif /* USE_HAL_TIM_REGISTER_CALLBACKS */
|
|
}
|
|
}
|
|
}
|
|
80055ac: bf00 nop
|
|
80055ae: 3710 adds r7, #16
|
|
80055b0: 46bd mov sp, r7
|
|
80055b2: bd80 pop {r7, pc}
|
|
|
|
080055b4 <HAL_TIM_OC_DelayElapsedCallback>:
|
|
* @brief Output Compare callback in non-blocking mode
|
|
* @param htim TIM OC handle
|
|
* @retval None
|
|
*/
|
|
__weak void HAL_TIM_OC_DelayElapsedCallback(TIM_HandleTypeDef *htim)
|
|
{
|
|
80055b4: b480 push {r7}
|
|
80055b6: b083 sub sp, #12
|
|
80055b8: af00 add r7, sp, #0
|
|
80055ba: 6078 str r0, [r7, #4]
|
|
UNUSED(htim);
|
|
|
|
/* NOTE : This function should not be modified, when the callback is needed,
|
|
the HAL_TIM_OC_DelayElapsedCallback could be implemented in the user file
|
|
*/
|
|
}
|
|
80055bc: bf00 nop
|
|
80055be: 370c adds r7, #12
|
|
80055c0: 46bd mov sp, r7
|
|
80055c2: f85d 7b04 ldr.w r7, [sp], #4
|
|
80055c6: 4770 bx lr
|
|
|
|
080055c8 <HAL_TIM_IC_CaptureCallback>:
|
|
* @brief Input Capture callback in non-blocking mode
|
|
* @param htim TIM IC handle
|
|
* @retval None
|
|
*/
|
|
__weak void HAL_TIM_IC_CaptureCallback(TIM_HandleTypeDef *htim)
|
|
{
|
|
80055c8: b480 push {r7}
|
|
80055ca: b083 sub sp, #12
|
|
80055cc: af00 add r7, sp, #0
|
|
80055ce: 6078 str r0, [r7, #4]
|
|
UNUSED(htim);
|
|
|
|
/* NOTE : This function should not be modified, when the callback is needed,
|
|
the HAL_TIM_IC_CaptureCallback could be implemented in the user file
|
|
*/
|
|
}
|
|
80055d0: bf00 nop
|
|
80055d2: 370c adds r7, #12
|
|
80055d4: 46bd mov sp, r7
|
|
80055d6: f85d 7b04 ldr.w r7, [sp], #4
|
|
80055da: 4770 bx lr
|
|
|
|
080055dc <HAL_TIM_PWM_PulseFinishedCallback>:
|
|
* @brief PWM Pulse finished callback in non-blocking mode
|
|
* @param htim TIM handle
|
|
* @retval None
|
|
*/
|
|
__weak void HAL_TIM_PWM_PulseFinishedCallback(TIM_HandleTypeDef *htim)
|
|
{
|
|
80055dc: b480 push {r7}
|
|
80055de: b083 sub sp, #12
|
|
80055e0: af00 add r7, sp, #0
|
|
80055e2: 6078 str r0, [r7, #4]
|
|
UNUSED(htim);
|
|
|
|
/* NOTE : This function should not be modified, when the callback is needed,
|
|
the HAL_TIM_PWM_PulseFinishedCallback could be implemented in the user file
|
|
*/
|
|
}
|
|
80055e4: bf00 nop
|
|
80055e6: 370c adds r7, #12
|
|
80055e8: 46bd mov sp, r7
|
|
80055ea: f85d 7b04 ldr.w r7, [sp], #4
|
|
80055ee: 4770 bx lr
|
|
|
|
080055f0 <HAL_TIM_TriggerCallback>:
|
|
* @brief Hall Trigger detection callback in non-blocking mode
|
|
* @param htim TIM handle
|
|
* @retval None
|
|
*/
|
|
__weak void HAL_TIM_TriggerCallback(TIM_HandleTypeDef *htim)
|
|
{
|
|
80055f0: b480 push {r7}
|
|
80055f2: b083 sub sp, #12
|
|
80055f4: af00 add r7, sp, #0
|
|
80055f6: 6078 str r0, [r7, #4]
|
|
UNUSED(htim);
|
|
|
|
/* NOTE : This function should not be modified, when the callback is needed,
|
|
the HAL_TIM_TriggerCallback could be implemented in the user file
|
|
*/
|
|
}
|
|
80055f8: bf00 nop
|
|
80055fa: 370c adds r7, #12
|
|
80055fc: 46bd mov sp, r7
|
|
80055fe: f85d 7b04 ldr.w r7, [sp], #4
|
|
8005602: 4770 bx lr
|
|
|
|
08005604 <TIM_Base_SetConfig>:
|
|
* @param TIMx TIM peripheral
|
|
* @param Structure TIM Base configuration structure
|
|
* @retval None
|
|
*/
|
|
void TIM_Base_SetConfig(TIM_TypeDef *TIMx, const TIM_Base_InitTypeDef *Structure)
|
|
{
|
|
8005604: b480 push {r7}
|
|
8005606: b085 sub sp, #20
|
|
8005608: af00 add r7, sp, #0
|
|
800560a: 6078 str r0, [r7, #4]
|
|
800560c: 6039 str r1, [r7, #0]
|
|
uint32_t tmpcr1;
|
|
tmpcr1 = TIMx->CR1;
|
|
800560e: 687b ldr r3, [r7, #4]
|
|
8005610: 681b ldr r3, [r3, #0]
|
|
8005612: 60fb str r3, [r7, #12]
|
|
|
|
/* Set TIM Time Base Unit parameters ---------------------------------------*/
|
|
if (IS_TIM_COUNTER_MODE_SELECT_INSTANCE(TIMx))
|
|
8005614: 687b ldr r3, [r7, #4]
|
|
8005616: 4a43 ldr r2, [pc, #268] @ (8005724 <TIM_Base_SetConfig+0x120>)
|
|
8005618: 4293 cmp r3, r2
|
|
800561a: d013 beq.n 8005644 <TIM_Base_SetConfig+0x40>
|
|
800561c: 687b ldr r3, [r7, #4]
|
|
800561e: f1b3 4f80 cmp.w r3, #1073741824 @ 0x40000000
|
|
8005622: d00f beq.n 8005644 <TIM_Base_SetConfig+0x40>
|
|
8005624: 687b ldr r3, [r7, #4]
|
|
8005626: 4a40 ldr r2, [pc, #256] @ (8005728 <TIM_Base_SetConfig+0x124>)
|
|
8005628: 4293 cmp r3, r2
|
|
800562a: d00b beq.n 8005644 <TIM_Base_SetConfig+0x40>
|
|
800562c: 687b ldr r3, [r7, #4]
|
|
800562e: 4a3f ldr r2, [pc, #252] @ (800572c <TIM_Base_SetConfig+0x128>)
|
|
8005630: 4293 cmp r3, r2
|
|
8005632: d007 beq.n 8005644 <TIM_Base_SetConfig+0x40>
|
|
8005634: 687b ldr r3, [r7, #4]
|
|
8005636: 4a3e ldr r2, [pc, #248] @ (8005730 <TIM_Base_SetConfig+0x12c>)
|
|
8005638: 4293 cmp r3, r2
|
|
800563a: d003 beq.n 8005644 <TIM_Base_SetConfig+0x40>
|
|
800563c: 687b ldr r3, [r7, #4]
|
|
800563e: 4a3d ldr r2, [pc, #244] @ (8005734 <TIM_Base_SetConfig+0x130>)
|
|
8005640: 4293 cmp r3, r2
|
|
8005642: d108 bne.n 8005656 <TIM_Base_SetConfig+0x52>
|
|
{
|
|
/* Select the Counter Mode */
|
|
tmpcr1 &= ~(TIM_CR1_DIR | TIM_CR1_CMS);
|
|
8005644: 68fb ldr r3, [r7, #12]
|
|
8005646: f023 0370 bic.w r3, r3, #112 @ 0x70
|
|
800564a: 60fb str r3, [r7, #12]
|
|
tmpcr1 |= Structure->CounterMode;
|
|
800564c: 683b ldr r3, [r7, #0]
|
|
800564e: 685b ldr r3, [r3, #4]
|
|
8005650: 68fa ldr r2, [r7, #12]
|
|
8005652: 4313 orrs r3, r2
|
|
8005654: 60fb str r3, [r7, #12]
|
|
}
|
|
|
|
if (IS_TIM_CLOCK_DIVISION_INSTANCE(TIMx))
|
|
8005656: 687b ldr r3, [r7, #4]
|
|
8005658: 4a32 ldr r2, [pc, #200] @ (8005724 <TIM_Base_SetConfig+0x120>)
|
|
800565a: 4293 cmp r3, r2
|
|
800565c: d02b beq.n 80056b6 <TIM_Base_SetConfig+0xb2>
|
|
800565e: 687b ldr r3, [r7, #4]
|
|
8005660: f1b3 4f80 cmp.w r3, #1073741824 @ 0x40000000
|
|
8005664: d027 beq.n 80056b6 <TIM_Base_SetConfig+0xb2>
|
|
8005666: 687b ldr r3, [r7, #4]
|
|
8005668: 4a2f ldr r2, [pc, #188] @ (8005728 <TIM_Base_SetConfig+0x124>)
|
|
800566a: 4293 cmp r3, r2
|
|
800566c: d023 beq.n 80056b6 <TIM_Base_SetConfig+0xb2>
|
|
800566e: 687b ldr r3, [r7, #4]
|
|
8005670: 4a2e ldr r2, [pc, #184] @ (800572c <TIM_Base_SetConfig+0x128>)
|
|
8005672: 4293 cmp r3, r2
|
|
8005674: d01f beq.n 80056b6 <TIM_Base_SetConfig+0xb2>
|
|
8005676: 687b ldr r3, [r7, #4]
|
|
8005678: 4a2d ldr r2, [pc, #180] @ (8005730 <TIM_Base_SetConfig+0x12c>)
|
|
800567a: 4293 cmp r3, r2
|
|
800567c: d01b beq.n 80056b6 <TIM_Base_SetConfig+0xb2>
|
|
800567e: 687b ldr r3, [r7, #4]
|
|
8005680: 4a2c ldr r2, [pc, #176] @ (8005734 <TIM_Base_SetConfig+0x130>)
|
|
8005682: 4293 cmp r3, r2
|
|
8005684: d017 beq.n 80056b6 <TIM_Base_SetConfig+0xb2>
|
|
8005686: 687b ldr r3, [r7, #4]
|
|
8005688: 4a2b ldr r2, [pc, #172] @ (8005738 <TIM_Base_SetConfig+0x134>)
|
|
800568a: 4293 cmp r3, r2
|
|
800568c: d013 beq.n 80056b6 <TIM_Base_SetConfig+0xb2>
|
|
800568e: 687b ldr r3, [r7, #4]
|
|
8005690: 4a2a ldr r2, [pc, #168] @ (800573c <TIM_Base_SetConfig+0x138>)
|
|
8005692: 4293 cmp r3, r2
|
|
8005694: d00f beq.n 80056b6 <TIM_Base_SetConfig+0xb2>
|
|
8005696: 687b ldr r3, [r7, #4]
|
|
8005698: 4a29 ldr r2, [pc, #164] @ (8005740 <TIM_Base_SetConfig+0x13c>)
|
|
800569a: 4293 cmp r3, r2
|
|
800569c: d00b beq.n 80056b6 <TIM_Base_SetConfig+0xb2>
|
|
800569e: 687b ldr r3, [r7, #4]
|
|
80056a0: 4a28 ldr r2, [pc, #160] @ (8005744 <TIM_Base_SetConfig+0x140>)
|
|
80056a2: 4293 cmp r3, r2
|
|
80056a4: d007 beq.n 80056b6 <TIM_Base_SetConfig+0xb2>
|
|
80056a6: 687b ldr r3, [r7, #4]
|
|
80056a8: 4a27 ldr r2, [pc, #156] @ (8005748 <TIM_Base_SetConfig+0x144>)
|
|
80056aa: 4293 cmp r3, r2
|
|
80056ac: d003 beq.n 80056b6 <TIM_Base_SetConfig+0xb2>
|
|
80056ae: 687b ldr r3, [r7, #4]
|
|
80056b0: 4a26 ldr r2, [pc, #152] @ (800574c <TIM_Base_SetConfig+0x148>)
|
|
80056b2: 4293 cmp r3, r2
|
|
80056b4: d108 bne.n 80056c8 <TIM_Base_SetConfig+0xc4>
|
|
{
|
|
/* Set the clock division */
|
|
tmpcr1 &= ~TIM_CR1_CKD;
|
|
80056b6: 68fb ldr r3, [r7, #12]
|
|
80056b8: f423 7340 bic.w r3, r3, #768 @ 0x300
|
|
80056bc: 60fb str r3, [r7, #12]
|
|
tmpcr1 |= (uint32_t)Structure->ClockDivision;
|
|
80056be: 683b ldr r3, [r7, #0]
|
|
80056c0: 68db ldr r3, [r3, #12]
|
|
80056c2: 68fa ldr r2, [r7, #12]
|
|
80056c4: 4313 orrs r3, r2
|
|
80056c6: 60fb str r3, [r7, #12]
|
|
}
|
|
|
|
/* Set the auto-reload preload */
|
|
MODIFY_REG(tmpcr1, TIM_CR1_ARPE, Structure->AutoReloadPreload);
|
|
80056c8: 68fb ldr r3, [r7, #12]
|
|
80056ca: f023 0280 bic.w r2, r3, #128 @ 0x80
|
|
80056ce: 683b ldr r3, [r7, #0]
|
|
80056d0: 695b ldr r3, [r3, #20]
|
|
80056d2: 4313 orrs r3, r2
|
|
80056d4: 60fb str r3, [r7, #12]
|
|
|
|
/* Set the Autoreload value */
|
|
TIMx->ARR = (uint32_t)Structure->Period ;
|
|
80056d6: 683b ldr r3, [r7, #0]
|
|
80056d8: 689a ldr r2, [r3, #8]
|
|
80056da: 687b ldr r3, [r7, #4]
|
|
80056dc: 62da str r2, [r3, #44] @ 0x2c
|
|
|
|
/* Set the Prescaler value */
|
|
TIMx->PSC = Structure->Prescaler;
|
|
80056de: 683b ldr r3, [r7, #0]
|
|
80056e0: 681a ldr r2, [r3, #0]
|
|
80056e2: 687b ldr r3, [r7, #4]
|
|
80056e4: 629a str r2, [r3, #40] @ 0x28
|
|
|
|
if (IS_TIM_REPETITION_COUNTER_INSTANCE(TIMx))
|
|
80056e6: 687b ldr r3, [r7, #4]
|
|
80056e8: 4a0e ldr r2, [pc, #56] @ (8005724 <TIM_Base_SetConfig+0x120>)
|
|
80056ea: 4293 cmp r3, r2
|
|
80056ec: d003 beq.n 80056f6 <TIM_Base_SetConfig+0xf2>
|
|
80056ee: 687b ldr r3, [r7, #4]
|
|
80056f0: 4a10 ldr r2, [pc, #64] @ (8005734 <TIM_Base_SetConfig+0x130>)
|
|
80056f2: 4293 cmp r3, r2
|
|
80056f4: d103 bne.n 80056fe <TIM_Base_SetConfig+0xfa>
|
|
{
|
|
/* Set the Repetition Counter value */
|
|
TIMx->RCR = Structure->RepetitionCounter;
|
|
80056f6: 683b ldr r3, [r7, #0]
|
|
80056f8: 691a ldr r2, [r3, #16]
|
|
80056fa: 687b ldr r3, [r7, #4]
|
|
80056fc: 631a str r2, [r3, #48] @ 0x30
|
|
}
|
|
|
|
/* Disable Update Event (UEV) with Update Generation (UG)
|
|
by changing Update Request Source (URS) to avoid Update flag (UIF) */
|
|
SET_BIT(TIMx->CR1, TIM_CR1_URS);
|
|
80056fe: 687b ldr r3, [r7, #4]
|
|
8005700: 681b ldr r3, [r3, #0]
|
|
8005702: f043 0204 orr.w r2, r3, #4
|
|
8005706: 687b ldr r3, [r7, #4]
|
|
8005708: 601a str r2, [r3, #0]
|
|
|
|
/* Generate an update event to reload the Prescaler
|
|
and the repetition counter (only for advanced timer) value immediately */
|
|
TIMx->EGR = TIM_EGR_UG;
|
|
800570a: 687b ldr r3, [r7, #4]
|
|
800570c: 2201 movs r2, #1
|
|
800570e: 615a str r2, [r3, #20]
|
|
|
|
TIMx->CR1 = tmpcr1;
|
|
8005710: 687b ldr r3, [r7, #4]
|
|
8005712: 68fa ldr r2, [r7, #12]
|
|
8005714: 601a str r2, [r3, #0]
|
|
}
|
|
8005716: bf00 nop
|
|
8005718: 3714 adds r7, #20
|
|
800571a: 46bd mov sp, r7
|
|
800571c: f85d 7b04 ldr.w r7, [sp], #4
|
|
8005720: 4770 bx lr
|
|
8005722: bf00 nop
|
|
8005724: 40010000 .word 0x40010000
|
|
8005728: 40000400 .word 0x40000400
|
|
800572c: 40000800 .word 0x40000800
|
|
8005730: 40000c00 .word 0x40000c00
|
|
8005734: 40010400 .word 0x40010400
|
|
8005738: 40014000 .word 0x40014000
|
|
800573c: 40014400 .word 0x40014400
|
|
8005740: 40014800 .word 0x40014800
|
|
8005744: 40001800 .word 0x40001800
|
|
8005748: 40001c00 .word 0x40001c00
|
|
800574c: 40002000 .word 0x40002000
|
|
|
|
08005750 <HAL_TIMEx_CommutCallback>:
|
|
* @brief Commutation callback in non-blocking mode
|
|
* @param htim TIM handle
|
|
* @retval None
|
|
*/
|
|
__weak void HAL_TIMEx_CommutCallback(TIM_HandleTypeDef *htim)
|
|
{
|
|
8005750: b480 push {r7}
|
|
8005752: b083 sub sp, #12
|
|
8005754: af00 add r7, sp, #0
|
|
8005756: 6078 str r0, [r7, #4]
|
|
UNUSED(htim);
|
|
|
|
/* NOTE : This function should not be modified, when the callback is needed,
|
|
the HAL_TIMEx_CommutCallback could be implemented in the user file
|
|
*/
|
|
}
|
|
8005758: bf00 nop
|
|
800575a: 370c adds r7, #12
|
|
800575c: 46bd mov sp, r7
|
|
800575e: f85d 7b04 ldr.w r7, [sp], #4
|
|
8005762: 4770 bx lr
|
|
|
|
08005764 <HAL_TIMEx_BreakCallback>:
|
|
* @brief Break detection callback in non-blocking mode
|
|
* @param htim TIM handle
|
|
* @retval None
|
|
*/
|
|
__weak void HAL_TIMEx_BreakCallback(TIM_HandleTypeDef *htim)
|
|
{
|
|
8005764: b480 push {r7}
|
|
8005766: b083 sub sp, #12
|
|
8005768: af00 add r7, sp, #0
|
|
800576a: 6078 str r0, [r7, #4]
|
|
UNUSED(htim);
|
|
|
|
/* NOTE : This function should not be modified, when the callback is needed,
|
|
the HAL_TIMEx_BreakCallback could be implemented in the user file
|
|
*/
|
|
}
|
|
800576c: bf00 nop
|
|
800576e: 370c adds r7, #12
|
|
8005770: 46bd mov sp, r7
|
|
8005772: f85d 7b04 ldr.w r7, [sp], #4
|
|
8005776: 4770 bx lr
|
|
|
|
08005778 <SDIO_Init>:
|
|
* @param SDIOx: Pointer to SDMMC register base
|
|
* @param Init: SDMMC initialization structure
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef SDIO_Init(SDIO_TypeDef *SDIOx, SDIO_InitTypeDef Init)
|
|
{
|
|
8005778: b084 sub sp, #16
|
|
800577a: b580 push {r7, lr}
|
|
800577c: b084 sub sp, #16
|
|
800577e: af00 add r7, sp, #0
|
|
8005780: 6078 str r0, [r7, #4]
|
|
8005782: f107 001c add.w r0, r7, #28
|
|
8005786: e880 000e stmia.w r0, {r1, r2, r3}
|
|
uint32_t tmpreg = 0;
|
|
800578a: 2300 movs r3, #0
|
|
800578c: 60fb str r3, [r7, #12]
|
|
|
|
/* Check the parameters */
|
|
assert_param(IS_SDIO_ALL_INSTANCE(SDIOx));
|
|
800578e: 687b ldr r3, [r7, #4]
|
|
8005790: 4a34 ldr r2, [pc, #208] @ (8005864 <SDIO_Init+0xec>)
|
|
8005792: 4293 cmp r3, r2
|
|
8005794: d003 beq.n 800579e <SDIO_Init+0x26>
|
|
8005796: 21d4 movs r1, #212 @ 0xd4
|
|
8005798: 4833 ldr r0, [pc, #204] @ (8005868 <SDIO_Init+0xf0>)
|
|
800579a: f7fb facb bl 8000d34 <assert_failed>
|
|
assert_param(IS_SDIO_CLOCK_EDGE(Init.ClockEdge));
|
|
800579e: 69fb ldr r3, [r7, #28]
|
|
80057a0: 2b00 cmp r3, #0
|
|
80057a2: d007 beq.n 80057b4 <SDIO_Init+0x3c>
|
|
80057a4: 69fb ldr r3, [r7, #28]
|
|
80057a6: f5b3 5f00 cmp.w r3, #8192 @ 0x2000
|
|
80057aa: d003 beq.n 80057b4 <SDIO_Init+0x3c>
|
|
80057ac: 21d5 movs r1, #213 @ 0xd5
|
|
80057ae: 482e ldr r0, [pc, #184] @ (8005868 <SDIO_Init+0xf0>)
|
|
80057b0: f7fb fac0 bl 8000d34 <assert_failed>
|
|
assert_param(IS_SDIO_CLOCK_BYPASS(Init.ClockBypass));
|
|
80057b4: 6a3b ldr r3, [r7, #32]
|
|
80057b6: 2b00 cmp r3, #0
|
|
80057b8: d007 beq.n 80057ca <SDIO_Init+0x52>
|
|
80057ba: 6a3b ldr r3, [r7, #32]
|
|
80057bc: f5b3 6f80 cmp.w r3, #1024 @ 0x400
|
|
80057c0: d003 beq.n 80057ca <SDIO_Init+0x52>
|
|
80057c2: 21d6 movs r1, #214 @ 0xd6
|
|
80057c4: 4828 ldr r0, [pc, #160] @ (8005868 <SDIO_Init+0xf0>)
|
|
80057c6: f7fb fab5 bl 8000d34 <assert_failed>
|
|
assert_param(IS_SDIO_CLOCK_POWER_SAVE(Init.ClockPowerSave));
|
|
80057ca: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
80057cc: 2b00 cmp r3, #0
|
|
80057ce: d007 beq.n 80057e0 <SDIO_Init+0x68>
|
|
80057d0: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
80057d2: f5b3 7f00 cmp.w r3, #512 @ 0x200
|
|
80057d6: d003 beq.n 80057e0 <SDIO_Init+0x68>
|
|
80057d8: 21d7 movs r1, #215 @ 0xd7
|
|
80057da: 4823 ldr r0, [pc, #140] @ (8005868 <SDIO_Init+0xf0>)
|
|
80057dc: f7fb faaa bl 8000d34 <assert_failed>
|
|
assert_param(IS_SDIO_BUS_WIDE(Init.BusWide));
|
|
80057e0: 6abb ldr r3, [r7, #40] @ 0x28
|
|
80057e2: 2b00 cmp r3, #0
|
|
80057e4: d00b beq.n 80057fe <SDIO_Init+0x86>
|
|
80057e6: 6abb ldr r3, [r7, #40] @ 0x28
|
|
80057e8: f5b3 6f00 cmp.w r3, #2048 @ 0x800
|
|
80057ec: d007 beq.n 80057fe <SDIO_Init+0x86>
|
|
80057ee: 6abb ldr r3, [r7, #40] @ 0x28
|
|
80057f0: f5b3 5f80 cmp.w r3, #4096 @ 0x1000
|
|
80057f4: d003 beq.n 80057fe <SDIO_Init+0x86>
|
|
80057f6: 21d8 movs r1, #216 @ 0xd8
|
|
80057f8: 481b ldr r0, [pc, #108] @ (8005868 <SDIO_Init+0xf0>)
|
|
80057fa: f7fb fa9b bl 8000d34 <assert_failed>
|
|
assert_param(IS_SDIO_HARDWARE_FLOW_CONTROL(Init.HardwareFlowControl));
|
|
80057fe: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
8005800: 2b00 cmp r3, #0
|
|
8005802: d007 beq.n 8005814 <SDIO_Init+0x9c>
|
|
8005804: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
8005806: f5b3 4f80 cmp.w r3, #16384 @ 0x4000
|
|
800580a: d003 beq.n 8005814 <SDIO_Init+0x9c>
|
|
800580c: 21d9 movs r1, #217 @ 0xd9
|
|
800580e: 4816 ldr r0, [pc, #88] @ (8005868 <SDIO_Init+0xf0>)
|
|
8005810: f7fb fa90 bl 8000d34 <assert_failed>
|
|
assert_param(IS_SDIO_CLKDIV(Init.ClockDiv));
|
|
8005814: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
8005816: 2bff cmp r3, #255 @ 0xff
|
|
8005818: d903 bls.n 8005822 <SDIO_Init+0xaa>
|
|
800581a: 21da movs r1, #218 @ 0xda
|
|
800581c: 4812 ldr r0, [pc, #72] @ (8005868 <SDIO_Init+0xf0>)
|
|
800581e: f7fb fa89 bl 8000d34 <assert_failed>
|
|
|
|
/* Set SDMMC configuration parameters */
|
|
tmpreg |= (Init.ClockEdge |\
|
|
8005822: 69fa ldr r2, [r7, #28]
|
|
Init.ClockBypass |\
|
|
8005824: 6a3b ldr r3, [r7, #32]
|
|
tmpreg |= (Init.ClockEdge |\
|
|
8005826: 431a orrs r2, r3
|
|
Init.ClockPowerSave |\
|
|
8005828: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
Init.ClockBypass |\
|
|
800582a: 431a orrs r2, r3
|
|
Init.BusWide |\
|
|
800582c: 6abb ldr r3, [r7, #40] @ 0x28
|
|
Init.ClockPowerSave |\
|
|
800582e: 431a orrs r2, r3
|
|
Init.HardwareFlowControl |\
|
|
8005830: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
Init.BusWide |\
|
|
8005832: 431a orrs r2, r3
|
|
Init.ClockDiv
|
|
8005834: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
Init.HardwareFlowControl |\
|
|
8005836: 4313 orrs r3, r2
|
|
tmpreg |= (Init.ClockEdge |\
|
|
8005838: 68fa ldr r2, [r7, #12]
|
|
800583a: 4313 orrs r3, r2
|
|
800583c: 60fb str r3, [r7, #12]
|
|
);
|
|
|
|
/* Write to SDMMC CLKCR */
|
|
MODIFY_REG(SDIOx->CLKCR, CLKCR_CLEAR_MASK, tmpreg);
|
|
800583e: 687b ldr r3, [r7, #4]
|
|
8005840: 685b ldr r3, [r3, #4]
|
|
8005842: f423 43fd bic.w r3, r3, #32384 @ 0x7e80
|
|
8005846: f023 037f bic.w r3, r3, #127 @ 0x7f
|
|
800584a: 68fa ldr r2, [r7, #12]
|
|
800584c: 431a orrs r2, r3
|
|
800584e: 687b ldr r3, [r7, #4]
|
|
8005850: 605a str r2, [r3, #4]
|
|
|
|
return HAL_OK;
|
|
8005852: 2300 movs r3, #0
|
|
}
|
|
8005854: 4618 mov r0, r3
|
|
8005856: 3710 adds r7, #16
|
|
8005858: 46bd mov sp, r7
|
|
800585a: e8bd 4080 ldmia.w sp!, {r7, lr}
|
|
800585e: b004 add sp, #16
|
|
8005860: 4770 bx lr
|
|
8005862: bf00 nop
|
|
8005864: 40012c00 .word 0x40012c00
|
|
8005868: 0800a24c .word 0x0800a24c
|
|
|
|
0800586c <SDIO_ReadFIFO>:
|
|
* @brief Read data (word) from Rx FIFO in blocking mode (polling)
|
|
* @param SDIOx: Pointer to SDMMC register base
|
|
* @retval HAL status
|
|
*/
|
|
uint32_t SDIO_ReadFIFO(SDIO_TypeDef *SDIOx)
|
|
{
|
|
800586c: b480 push {r7}
|
|
800586e: b083 sub sp, #12
|
|
8005870: af00 add r7, sp, #0
|
|
8005872: 6078 str r0, [r7, #4]
|
|
/* Read data from Rx FIFO */
|
|
return (SDIOx->FIFO);
|
|
8005874: 687b ldr r3, [r7, #4]
|
|
8005876: f8d3 3080 ldr.w r3, [r3, #128] @ 0x80
|
|
}
|
|
800587a: 4618 mov r0, r3
|
|
800587c: 370c adds r7, #12
|
|
800587e: 46bd mov sp, r7
|
|
8005880: f85d 7b04 ldr.w r7, [sp], #4
|
|
8005884: 4770 bx lr
|
|
|
|
08005886 <SDIO_WriteFIFO>:
|
|
* @param SDIOx: Pointer to SDMMC register base
|
|
* @param pWriteData: pointer to data to write
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef SDIO_WriteFIFO(SDIO_TypeDef *SDIOx, uint32_t *pWriteData)
|
|
{
|
|
8005886: b480 push {r7}
|
|
8005888: b083 sub sp, #12
|
|
800588a: af00 add r7, sp, #0
|
|
800588c: 6078 str r0, [r7, #4]
|
|
800588e: 6039 str r1, [r7, #0]
|
|
/* Write data to FIFO */
|
|
SDIOx->FIFO = *pWriteData;
|
|
8005890: 683b ldr r3, [r7, #0]
|
|
8005892: 681a ldr r2, [r3, #0]
|
|
8005894: 687b ldr r3, [r7, #4]
|
|
8005896: f8c3 2080 str.w r2, [r3, #128] @ 0x80
|
|
|
|
return HAL_OK;
|
|
800589a: 2300 movs r3, #0
|
|
}
|
|
800589c: 4618 mov r0, r3
|
|
800589e: 370c adds r7, #12
|
|
80058a0: 46bd mov sp, r7
|
|
80058a2: f85d 7b04 ldr.w r7, [sp], #4
|
|
80058a6: 4770 bx lr
|
|
|
|
080058a8 <SDIO_PowerState_ON>:
|
|
* @brief Set SDMMC Power state to ON.
|
|
* @param SDIOx: Pointer to SDMMC register base
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef SDIO_PowerState_ON(SDIO_TypeDef *SDIOx)
|
|
{
|
|
80058a8: b480 push {r7}
|
|
80058aa: b083 sub sp, #12
|
|
80058ac: af00 add r7, sp, #0
|
|
80058ae: 6078 str r0, [r7, #4]
|
|
/* Set power state to ON */
|
|
SDIOx->POWER = SDIO_POWER_PWRCTRL;
|
|
80058b0: 687b ldr r3, [r7, #4]
|
|
80058b2: 2203 movs r2, #3
|
|
80058b4: 601a str r2, [r3, #0]
|
|
|
|
return HAL_OK;
|
|
80058b6: 2300 movs r3, #0
|
|
}
|
|
80058b8: 4618 mov r0, r3
|
|
80058ba: 370c adds r7, #12
|
|
80058bc: 46bd mov sp, r7
|
|
80058be: f85d 7b04 ldr.w r7, [sp], #4
|
|
80058c2: 4770 bx lr
|
|
|
|
080058c4 <SDIO_GetPowerState>:
|
|
* - 0x00: Power OFF
|
|
* - 0x02: Power UP
|
|
* - 0x03: Power ON
|
|
*/
|
|
uint32_t SDIO_GetPowerState(SDIO_TypeDef *SDIOx)
|
|
{
|
|
80058c4: b480 push {r7}
|
|
80058c6: b083 sub sp, #12
|
|
80058c8: af00 add r7, sp, #0
|
|
80058ca: 6078 str r0, [r7, #4]
|
|
return (SDIOx->POWER & SDIO_POWER_PWRCTRL);
|
|
80058cc: 687b ldr r3, [r7, #4]
|
|
80058ce: 681b ldr r3, [r3, #0]
|
|
80058d0: f003 0303 and.w r3, r3, #3
|
|
}
|
|
80058d4: 4618 mov r0, r3
|
|
80058d6: 370c adds r7, #12
|
|
80058d8: 46bd mov sp, r7
|
|
80058da: f85d 7b04 ldr.w r7, [sp], #4
|
|
80058de: 4770 bx lr
|
|
|
|
080058e0 <SDIO_SendCommand>:
|
|
* @param Command: pointer to a SDIO_CmdInitTypeDef structure that contains
|
|
* the configuration information for the SDMMC command
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef SDIO_SendCommand(SDIO_TypeDef *SDIOx, SDIO_CmdInitTypeDef *Command)
|
|
{
|
|
80058e0: b580 push {r7, lr}
|
|
80058e2: b084 sub sp, #16
|
|
80058e4: af00 add r7, sp, #0
|
|
80058e6: 6078 str r0, [r7, #4]
|
|
80058e8: 6039 str r1, [r7, #0]
|
|
uint32_t tmpreg = 0;
|
|
80058ea: 2300 movs r3, #0
|
|
80058ec: 60fb str r3, [r7, #12]
|
|
|
|
/* Check the parameters */
|
|
assert_param(IS_SDIO_CMD_INDEX(Command->CmdIndex));
|
|
80058ee: 683b ldr r3, [r7, #0]
|
|
80058f0: 685b ldr r3, [r3, #4]
|
|
80058f2: 2b3f cmp r3, #63 @ 0x3f
|
|
80058f4: d904 bls.n 8005900 <SDIO_SendCommand+0x20>
|
|
80058f6: f44f 71b0 mov.w r1, #352 @ 0x160
|
|
80058fa: 482b ldr r0, [pc, #172] @ (80059a8 <SDIO_SendCommand+0xc8>)
|
|
80058fc: f7fb fa1a bl 8000d34 <assert_failed>
|
|
assert_param(IS_SDIO_RESPONSE(Command->Response));
|
|
8005900: 683b ldr r3, [r7, #0]
|
|
8005902: 689b ldr r3, [r3, #8]
|
|
8005904: 2b00 cmp r3, #0
|
|
8005906: d00c beq.n 8005922 <SDIO_SendCommand+0x42>
|
|
8005908: 683b ldr r3, [r7, #0]
|
|
800590a: 689b ldr r3, [r3, #8]
|
|
800590c: 2b40 cmp r3, #64 @ 0x40
|
|
800590e: d008 beq.n 8005922 <SDIO_SendCommand+0x42>
|
|
8005910: 683b ldr r3, [r7, #0]
|
|
8005912: 689b ldr r3, [r3, #8]
|
|
8005914: 2bc0 cmp r3, #192 @ 0xc0
|
|
8005916: d004 beq.n 8005922 <SDIO_SendCommand+0x42>
|
|
8005918: f240 1161 movw r1, #353 @ 0x161
|
|
800591c: 4822 ldr r0, [pc, #136] @ (80059a8 <SDIO_SendCommand+0xc8>)
|
|
800591e: f7fb fa09 bl 8000d34 <assert_failed>
|
|
assert_param(IS_SDIO_WAIT(Command->WaitForInterrupt));
|
|
8005922: 683b ldr r3, [r7, #0]
|
|
8005924: 68db ldr r3, [r3, #12]
|
|
8005926: 2b00 cmp r3, #0
|
|
8005928: d00e beq.n 8005948 <SDIO_SendCommand+0x68>
|
|
800592a: 683b ldr r3, [r7, #0]
|
|
800592c: 68db ldr r3, [r3, #12]
|
|
800592e: f5b3 7f80 cmp.w r3, #256 @ 0x100
|
|
8005932: d009 beq.n 8005948 <SDIO_SendCommand+0x68>
|
|
8005934: 683b ldr r3, [r7, #0]
|
|
8005936: 68db ldr r3, [r3, #12]
|
|
8005938: f5b3 7f00 cmp.w r3, #512 @ 0x200
|
|
800593c: d004 beq.n 8005948 <SDIO_SendCommand+0x68>
|
|
800593e: f44f 71b1 mov.w r1, #354 @ 0x162
|
|
8005942: 4819 ldr r0, [pc, #100] @ (80059a8 <SDIO_SendCommand+0xc8>)
|
|
8005944: f7fb f9f6 bl 8000d34 <assert_failed>
|
|
assert_param(IS_SDIO_CPSM(Command->CPSM));
|
|
8005948: 683b ldr r3, [r7, #0]
|
|
800594a: 691b ldr r3, [r3, #16]
|
|
800594c: 2b00 cmp r3, #0
|
|
800594e: d009 beq.n 8005964 <SDIO_SendCommand+0x84>
|
|
8005950: 683b ldr r3, [r7, #0]
|
|
8005952: 691b ldr r3, [r3, #16]
|
|
8005954: f5b3 6f80 cmp.w r3, #1024 @ 0x400
|
|
8005958: d004 beq.n 8005964 <SDIO_SendCommand+0x84>
|
|
800595a: f240 1163 movw r1, #355 @ 0x163
|
|
800595e: 4812 ldr r0, [pc, #72] @ (80059a8 <SDIO_SendCommand+0xc8>)
|
|
8005960: f7fb f9e8 bl 8000d34 <assert_failed>
|
|
|
|
/* Set the SDMMC Argument value */
|
|
SDIOx->ARG = Command->Argument;
|
|
8005964: 683b ldr r3, [r7, #0]
|
|
8005966: 681a ldr r2, [r3, #0]
|
|
8005968: 687b ldr r3, [r7, #4]
|
|
800596a: 609a str r2, [r3, #8]
|
|
|
|
/* Set SDMMC command parameters */
|
|
tmpreg |= (uint32_t)(Command->CmdIndex |\
|
|
800596c: 683b ldr r3, [r7, #0]
|
|
800596e: 685a ldr r2, [r3, #4]
|
|
Command->Response |\
|
|
8005970: 683b ldr r3, [r7, #0]
|
|
8005972: 689b ldr r3, [r3, #8]
|
|
tmpreg |= (uint32_t)(Command->CmdIndex |\
|
|
8005974: 431a orrs r2, r3
|
|
Command->WaitForInterrupt |\
|
|
8005976: 683b ldr r3, [r7, #0]
|
|
8005978: 68db ldr r3, [r3, #12]
|
|
Command->Response |\
|
|
800597a: 431a orrs r2, r3
|
|
Command->CPSM);
|
|
800597c: 683b ldr r3, [r7, #0]
|
|
800597e: 691b ldr r3, [r3, #16]
|
|
Command->WaitForInterrupt |\
|
|
8005980: 4313 orrs r3, r2
|
|
tmpreg |= (uint32_t)(Command->CmdIndex |\
|
|
8005982: 68fa ldr r2, [r7, #12]
|
|
8005984: 4313 orrs r3, r2
|
|
8005986: 60fb str r3, [r7, #12]
|
|
|
|
/* Write to SDMMC CMD register */
|
|
MODIFY_REG(SDIOx->CMD, CMD_CLEAR_MASK, tmpreg);
|
|
8005988: 687b ldr r3, [r7, #4]
|
|
800598a: 68db ldr r3, [r3, #12]
|
|
800598c: f423 637f bic.w r3, r3, #4080 @ 0xff0
|
|
8005990: f023 030f bic.w r3, r3, #15
|
|
8005994: 68fa ldr r2, [r7, #12]
|
|
8005996: 431a orrs r2, r3
|
|
8005998: 687b ldr r3, [r7, #4]
|
|
800599a: 60da str r2, [r3, #12]
|
|
|
|
return HAL_OK;
|
|
800599c: 2300 movs r3, #0
|
|
}
|
|
800599e: 4618 mov r0, r3
|
|
80059a0: 3710 adds r7, #16
|
|
80059a2: 46bd mov sp, r7
|
|
80059a4: bd80 pop {r7, pc}
|
|
80059a6: bf00 nop
|
|
80059a8: 0800a24c .word 0x0800a24c
|
|
|
|
080059ac <SDIO_GetCommandResponse>:
|
|
* @brief Return the command index of last command for which response received
|
|
* @param SDIOx: Pointer to SDMMC register base
|
|
* @retval Command index of the last command response received
|
|
*/
|
|
uint8_t SDIO_GetCommandResponse(SDIO_TypeDef *SDIOx)
|
|
{
|
|
80059ac: b480 push {r7}
|
|
80059ae: b083 sub sp, #12
|
|
80059b0: af00 add r7, sp, #0
|
|
80059b2: 6078 str r0, [r7, #4]
|
|
return (uint8_t)(SDIOx->RESPCMD);
|
|
80059b4: 687b ldr r3, [r7, #4]
|
|
80059b6: 691b ldr r3, [r3, #16]
|
|
80059b8: b2db uxtb r3, r3
|
|
}
|
|
80059ba: 4618 mov r0, r3
|
|
80059bc: 370c adds r7, #12
|
|
80059be: 46bd mov sp, r7
|
|
80059c0: f85d 7b04 ldr.w r7, [sp], #4
|
|
80059c4: 4770 bx lr
|
|
...
|
|
|
|
080059c8 <SDIO_GetResponse>:
|
|
* @arg SDIO_RESP3: Response Register 3
|
|
* @arg SDIO_RESP4: Response Register 4
|
|
* @retval The Corresponding response register value
|
|
*/
|
|
uint32_t SDIO_GetResponse(SDIO_TypeDef *SDIOx, uint32_t Response)
|
|
{
|
|
80059c8: b580 push {r7, lr}
|
|
80059ca: b084 sub sp, #16
|
|
80059cc: af00 add r7, sp, #0
|
|
80059ce: 6078 str r0, [r7, #4]
|
|
80059d0: 6039 str r1, [r7, #0]
|
|
uint32_t tmp;
|
|
|
|
/* Check the parameters */
|
|
assert_param(IS_SDIO_RESP(Response));
|
|
80059d2: 683b ldr r3, [r7, #0]
|
|
80059d4: 2b00 cmp r3, #0
|
|
80059d6: d00d beq.n 80059f4 <SDIO_GetResponse+0x2c>
|
|
80059d8: 683b ldr r3, [r7, #0]
|
|
80059da: 2b04 cmp r3, #4
|
|
80059dc: d00a beq.n 80059f4 <SDIO_GetResponse+0x2c>
|
|
80059de: 683b ldr r3, [r7, #0]
|
|
80059e0: 2b08 cmp r3, #8
|
|
80059e2: d007 beq.n 80059f4 <SDIO_GetResponse+0x2c>
|
|
80059e4: 683b ldr r3, [r7, #0]
|
|
80059e6: 2b0c cmp r3, #12
|
|
80059e8: d004 beq.n 80059f4 <SDIO_GetResponse+0x2c>
|
|
80059ea: f240 118f movw r1, #399 @ 0x18f
|
|
80059ee: 4807 ldr r0, [pc, #28] @ (8005a0c <SDIO_GetResponse+0x44>)
|
|
80059f0: f7fb f9a0 bl 8000d34 <assert_failed>
|
|
|
|
/* Get the response */
|
|
tmp = (uint32_t)(&(SDIOx->RESP1)) + Response;
|
|
80059f4: 687b ldr r3, [r7, #4]
|
|
80059f6: 3314 adds r3, #20
|
|
80059f8: 461a mov r2, r3
|
|
80059fa: 683b ldr r3, [r7, #0]
|
|
80059fc: 4413 add r3, r2
|
|
80059fe: 60fb str r3, [r7, #12]
|
|
|
|
return (*(__IO uint32_t *) tmp);
|
|
8005a00: 68fb ldr r3, [r7, #12]
|
|
8005a02: 681b ldr r3, [r3, #0]
|
|
}
|
|
8005a04: 4618 mov r0, r3
|
|
8005a06: 3710 adds r7, #16
|
|
8005a08: 46bd mov sp, r7
|
|
8005a0a: bd80 pop {r7, pc}
|
|
8005a0c: 0800a24c .word 0x0800a24c
|
|
|
|
08005a10 <SDIO_ConfigData>:
|
|
* @param Data : pointer to a SDIO_DataInitTypeDef structure
|
|
* that contains the configuration information for the SDMMC data.
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef SDIO_ConfigData(SDIO_TypeDef *SDIOx, SDIO_DataInitTypeDef* Data)
|
|
{
|
|
8005a10: b580 push {r7, lr}
|
|
8005a12: b084 sub sp, #16
|
|
8005a14: af00 add r7, sp, #0
|
|
8005a16: 6078 str r0, [r7, #4]
|
|
8005a18: 6039 str r1, [r7, #0]
|
|
uint32_t tmpreg = 0;
|
|
8005a1a: 2300 movs r3, #0
|
|
8005a1c: 60fb str r3, [r7, #12]
|
|
|
|
/* Check the parameters */
|
|
assert_param(IS_SDIO_DATA_LENGTH(Data->DataLength));
|
|
8005a1e: 683b ldr r3, [r7, #0]
|
|
8005a20: 685b ldr r3, [r3, #4]
|
|
8005a22: f1b3 7f00 cmp.w r3, #33554432 @ 0x2000000
|
|
8005a26: d304 bcc.n 8005a32 <SDIO_ConfigData+0x22>
|
|
8005a28: f44f 71d2 mov.w r1, #420 @ 0x1a4
|
|
8005a2c: 4846 ldr r0, [pc, #280] @ (8005b48 <SDIO_ConfigData+0x138>)
|
|
8005a2e: f7fb f981 bl 8000d34 <assert_failed>
|
|
assert_param(IS_SDIO_BLOCK_SIZE(Data->DataBlockSize));
|
|
8005a32: 683b ldr r3, [r7, #0]
|
|
8005a34: 689b ldr r3, [r3, #8]
|
|
8005a36: 2b00 cmp r3, #0
|
|
8005a38: d03c beq.n 8005ab4 <SDIO_ConfigData+0xa4>
|
|
8005a3a: 683b ldr r3, [r7, #0]
|
|
8005a3c: 689b ldr r3, [r3, #8]
|
|
8005a3e: 2b10 cmp r3, #16
|
|
8005a40: d038 beq.n 8005ab4 <SDIO_ConfigData+0xa4>
|
|
8005a42: 683b ldr r3, [r7, #0]
|
|
8005a44: 689b ldr r3, [r3, #8]
|
|
8005a46: 2b20 cmp r3, #32
|
|
8005a48: d034 beq.n 8005ab4 <SDIO_ConfigData+0xa4>
|
|
8005a4a: 683b ldr r3, [r7, #0]
|
|
8005a4c: 689b ldr r3, [r3, #8]
|
|
8005a4e: 2b30 cmp r3, #48 @ 0x30
|
|
8005a50: d030 beq.n 8005ab4 <SDIO_ConfigData+0xa4>
|
|
8005a52: 683b ldr r3, [r7, #0]
|
|
8005a54: 689b ldr r3, [r3, #8]
|
|
8005a56: 2b40 cmp r3, #64 @ 0x40
|
|
8005a58: d02c beq.n 8005ab4 <SDIO_ConfigData+0xa4>
|
|
8005a5a: 683b ldr r3, [r7, #0]
|
|
8005a5c: 689b ldr r3, [r3, #8]
|
|
8005a5e: 2b50 cmp r3, #80 @ 0x50
|
|
8005a60: d028 beq.n 8005ab4 <SDIO_ConfigData+0xa4>
|
|
8005a62: 683b ldr r3, [r7, #0]
|
|
8005a64: 689b ldr r3, [r3, #8]
|
|
8005a66: 2b60 cmp r3, #96 @ 0x60
|
|
8005a68: d024 beq.n 8005ab4 <SDIO_ConfigData+0xa4>
|
|
8005a6a: 683b ldr r3, [r7, #0]
|
|
8005a6c: 689b ldr r3, [r3, #8]
|
|
8005a6e: 2b70 cmp r3, #112 @ 0x70
|
|
8005a70: d020 beq.n 8005ab4 <SDIO_ConfigData+0xa4>
|
|
8005a72: 683b ldr r3, [r7, #0]
|
|
8005a74: 689b ldr r3, [r3, #8]
|
|
8005a76: 2b80 cmp r3, #128 @ 0x80
|
|
8005a78: d01c beq.n 8005ab4 <SDIO_ConfigData+0xa4>
|
|
8005a7a: 683b ldr r3, [r7, #0]
|
|
8005a7c: 689b ldr r3, [r3, #8]
|
|
8005a7e: 2b90 cmp r3, #144 @ 0x90
|
|
8005a80: d018 beq.n 8005ab4 <SDIO_ConfigData+0xa4>
|
|
8005a82: 683b ldr r3, [r7, #0]
|
|
8005a84: 689b ldr r3, [r3, #8]
|
|
8005a86: 2ba0 cmp r3, #160 @ 0xa0
|
|
8005a88: d014 beq.n 8005ab4 <SDIO_ConfigData+0xa4>
|
|
8005a8a: 683b ldr r3, [r7, #0]
|
|
8005a8c: 689b ldr r3, [r3, #8]
|
|
8005a8e: 2bb0 cmp r3, #176 @ 0xb0
|
|
8005a90: d010 beq.n 8005ab4 <SDIO_ConfigData+0xa4>
|
|
8005a92: 683b ldr r3, [r7, #0]
|
|
8005a94: 689b ldr r3, [r3, #8]
|
|
8005a96: 2bc0 cmp r3, #192 @ 0xc0
|
|
8005a98: d00c beq.n 8005ab4 <SDIO_ConfigData+0xa4>
|
|
8005a9a: 683b ldr r3, [r7, #0]
|
|
8005a9c: 689b ldr r3, [r3, #8]
|
|
8005a9e: 2bd0 cmp r3, #208 @ 0xd0
|
|
8005aa0: d008 beq.n 8005ab4 <SDIO_ConfigData+0xa4>
|
|
8005aa2: 683b ldr r3, [r7, #0]
|
|
8005aa4: 689b ldr r3, [r3, #8]
|
|
8005aa6: 2be0 cmp r3, #224 @ 0xe0
|
|
8005aa8: d004 beq.n 8005ab4 <SDIO_ConfigData+0xa4>
|
|
8005aaa: f240 11a5 movw r1, #421 @ 0x1a5
|
|
8005aae: 4826 ldr r0, [pc, #152] @ (8005b48 <SDIO_ConfigData+0x138>)
|
|
8005ab0: f7fb f940 bl 8000d34 <assert_failed>
|
|
assert_param(IS_SDIO_TRANSFER_DIR(Data->TransferDir));
|
|
8005ab4: 683b ldr r3, [r7, #0]
|
|
8005ab6: 68db ldr r3, [r3, #12]
|
|
8005ab8: 2b00 cmp r3, #0
|
|
8005aba: d008 beq.n 8005ace <SDIO_ConfigData+0xbe>
|
|
8005abc: 683b ldr r3, [r7, #0]
|
|
8005abe: 68db ldr r3, [r3, #12]
|
|
8005ac0: 2b02 cmp r3, #2
|
|
8005ac2: d004 beq.n 8005ace <SDIO_ConfigData+0xbe>
|
|
8005ac4: f44f 71d3 mov.w r1, #422 @ 0x1a6
|
|
8005ac8: 481f ldr r0, [pc, #124] @ (8005b48 <SDIO_ConfigData+0x138>)
|
|
8005aca: f7fb f933 bl 8000d34 <assert_failed>
|
|
assert_param(IS_SDIO_TRANSFER_MODE(Data->TransferMode));
|
|
8005ace: 683b ldr r3, [r7, #0]
|
|
8005ad0: 691b ldr r3, [r3, #16]
|
|
8005ad2: 2b00 cmp r3, #0
|
|
8005ad4: d008 beq.n 8005ae8 <SDIO_ConfigData+0xd8>
|
|
8005ad6: 683b ldr r3, [r7, #0]
|
|
8005ad8: 691b ldr r3, [r3, #16]
|
|
8005ada: 2b04 cmp r3, #4
|
|
8005adc: d004 beq.n 8005ae8 <SDIO_ConfigData+0xd8>
|
|
8005ade: f240 11a7 movw r1, #423 @ 0x1a7
|
|
8005ae2: 4819 ldr r0, [pc, #100] @ (8005b48 <SDIO_ConfigData+0x138>)
|
|
8005ae4: f7fb f926 bl 8000d34 <assert_failed>
|
|
assert_param(IS_SDIO_DPSM(Data->DPSM));
|
|
8005ae8: 683b ldr r3, [r7, #0]
|
|
8005aea: 695b ldr r3, [r3, #20]
|
|
8005aec: 2b00 cmp r3, #0
|
|
8005aee: d008 beq.n 8005b02 <SDIO_ConfigData+0xf2>
|
|
8005af0: 683b ldr r3, [r7, #0]
|
|
8005af2: 695b ldr r3, [r3, #20]
|
|
8005af4: 2b01 cmp r3, #1
|
|
8005af6: d004 beq.n 8005b02 <SDIO_ConfigData+0xf2>
|
|
8005af8: f44f 71d4 mov.w r1, #424 @ 0x1a8
|
|
8005afc: 4812 ldr r0, [pc, #72] @ (8005b48 <SDIO_ConfigData+0x138>)
|
|
8005afe: f7fb f919 bl 8000d34 <assert_failed>
|
|
|
|
/* Set the SDMMC Data TimeOut value */
|
|
SDIOx->DTIMER = Data->DataTimeOut;
|
|
8005b02: 683b ldr r3, [r7, #0]
|
|
8005b04: 681a ldr r2, [r3, #0]
|
|
8005b06: 687b ldr r3, [r7, #4]
|
|
8005b08: 625a str r2, [r3, #36] @ 0x24
|
|
|
|
/* Set the SDMMC DataLength value */
|
|
SDIOx->DLEN = Data->DataLength;
|
|
8005b0a: 683b ldr r3, [r7, #0]
|
|
8005b0c: 685a ldr r2, [r3, #4]
|
|
8005b0e: 687b ldr r3, [r7, #4]
|
|
8005b10: 629a str r2, [r3, #40] @ 0x28
|
|
|
|
/* Set the SDMMC data configuration parameters */
|
|
tmpreg |= (uint32_t)(Data->DataBlockSize |\
|
|
8005b12: 683b ldr r3, [r7, #0]
|
|
8005b14: 689a ldr r2, [r3, #8]
|
|
Data->TransferDir |\
|
|
8005b16: 683b ldr r3, [r7, #0]
|
|
8005b18: 68db ldr r3, [r3, #12]
|
|
tmpreg |= (uint32_t)(Data->DataBlockSize |\
|
|
8005b1a: 431a orrs r2, r3
|
|
Data->TransferMode |\
|
|
8005b1c: 683b ldr r3, [r7, #0]
|
|
8005b1e: 691b ldr r3, [r3, #16]
|
|
Data->TransferDir |\
|
|
8005b20: 431a orrs r2, r3
|
|
Data->DPSM);
|
|
8005b22: 683b ldr r3, [r7, #0]
|
|
8005b24: 695b ldr r3, [r3, #20]
|
|
Data->TransferMode |\
|
|
8005b26: 4313 orrs r3, r2
|
|
tmpreg |= (uint32_t)(Data->DataBlockSize |\
|
|
8005b28: 68fa ldr r2, [r7, #12]
|
|
8005b2a: 4313 orrs r3, r2
|
|
8005b2c: 60fb str r3, [r7, #12]
|
|
|
|
/* Write to SDMMC DCTRL */
|
|
MODIFY_REG(SDIOx->DCTRL, DCTRL_CLEAR_MASK, tmpreg);
|
|
8005b2e: 687b ldr r3, [r7, #4]
|
|
8005b30: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
8005b32: f023 02f7 bic.w r2, r3, #247 @ 0xf7
|
|
8005b36: 68fb ldr r3, [r7, #12]
|
|
8005b38: 431a orrs r2, r3
|
|
8005b3a: 687b ldr r3, [r7, #4]
|
|
8005b3c: 62da str r2, [r3, #44] @ 0x2c
|
|
|
|
return HAL_OK;
|
|
8005b3e: 2300 movs r3, #0
|
|
|
|
}
|
|
8005b40: 4618 mov r0, r3
|
|
8005b42: 3710 adds r7, #16
|
|
8005b44: 46bd mov sp, r7
|
|
8005b46: bd80 pop {r7, pc}
|
|
8005b48: 0800a24c .word 0x0800a24c
|
|
|
|
08005b4c <SDMMC_CmdBlockLength>:
|
|
* @brief Send the Data Block Length command and check the response
|
|
* @param SDIOx: Pointer to SDIO register base
|
|
* @retval HAL status
|
|
*/
|
|
uint32_t SDMMC_CmdBlockLength(SDIO_TypeDef *SDIOx, uint32_t BlockSize)
|
|
{
|
|
8005b4c: b580 push {r7, lr}
|
|
8005b4e: b088 sub sp, #32
|
|
8005b50: af00 add r7, sp, #0
|
|
8005b52: 6078 str r0, [r7, #4]
|
|
8005b54: 6039 str r1, [r7, #0]
|
|
SDIO_CmdInitTypeDef sdmmc_cmdinit;
|
|
uint32_t errorstate;
|
|
|
|
/* Set Block Size for Card */
|
|
sdmmc_cmdinit.Argument = (uint32_t)BlockSize;
|
|
8005b56: 683b ldr r3, [r7, #0]
|
|
8005b58: 60bb str r3, [r7, #8]
|
|
sdmmc_cmdinit.CmdIndex = SDMMC_CMD_SET_BLOCKLEN;
|
|
8005b5a: 2310 movs r3, #16
|
|
8005b5c: 60fb str r3, [r7, #12]
|
|
sdmmc_cmdinit.Response = SDIO_RESPONSE_SHORT;
|
|
8005b5e: 2340 movs r3, #64 @ 0x40
|
|
8005b60: 613b str r3, [r7, #16]
|
|
sdmmc_cmdinit.WaitForInterrupt = SDIO_WAIT_NO;
|
|
8005b62: 2300 movs r3, #0
|
|
8005b64: 617b str r3, [r7, #20]
|
|
sdmmc_cmdinit.CPSM = SDIO_CPSM_ENABLE;
|
|
8005b66: f44f 6380 mov.w r3, #1024 @ 0x400
|
|
8005b6a: 61bb str r3, [r7, #24]
|
|
(void)SDIO_SendCommand(SDIOx, &sdmmc_cmdinit);
|
|
8005b6c: f107 0308 add.w r3, r7, #8
|
|
8005b70: 4619 mov r1, r3
|
|
8005b72: 6878 ldr r0, [r7, #4]
|
|
8005b74: f7ff feb4 bl 80058e0 <SDIO_SendCommand>
|
|
|
|
/* Check for error conditions */
|
|
errorstate = SDMMC_GetCmdResp1(SDIOx, SDMMC_CMD_SET_BLOCKLEN, SDIO_CMDTIMEOUT);
|
|
8005b78: f241 3288 movw r2, #5000 @ 0x1388
|
|
8005b7c: 2110 movs r1, #16
|
|
8005b7e: 6878 ldr r0, [r7, #4]
|
|
8005b80: f000 f990 bl 8005ea4 <SDMMC_GetCmdResp1>
|
|
8005b84: 61f8 str r0, [r7, #28]
|
|
|
|
return errorstate;
|
|
8005b86: 69fb ldr r3, [r7, #28]
|
|
}
|
|
8005b88: 4618 mov r0, r3
|
|
8005b8a: 3720 adds r7, #32
|
|
8005b8c: 46bd mov sp, r7
|
|
8005b8e: bd80 pop {r7, pc}
|
|
|
|
08005b90 <SDMMC_CmdStopTransfer>:
|
|
* @brief Send the Stop Transfer command and check the response.
|
|
* @param SDIOx: Pointer to SDIO register base
|
|
* @retval HAL status
|
|
*/
|
|
uint32_t SDMMC_CmdStopTransfer(SDIO_TypeDef *SDIOx)
|
|
{
|
|
8005b90: b580 push {r7, lr}
|
|
8005b92: b088 sub sp, #32
|
|
8005b94: af00 add r7, sp, #0
|
|
8005b96: 6078 str r0, [r7, #4]
|
|
SDIO_CmdInitTypeDef sdmmc_cmdinit;
|
|
uint32_t errorstate;
|
|
|
|
/* Send CMD12 STOP_TRANSMISSION */
|
|
sdmmc_cmdinit.Argument = 0U;
|
|
8005b98: 2300 movs r3, #0
|
|
8005b9a: 60bb str r3, [r7, #8]
|
|
sdmmc_cmdinit.CmdIndex = SDMMC_CMD_STOP_TRANSMISSION;
|
|
8005b9c: 230c movs r3, #12
|
|
8005b9e: 60fb str r3, [r7, #12]
|
|
sdmmc_cmdinit.Response = SDIO_RESPONSE_SHORT;
|
|
8005ba0: 2340 movs r3, #64 @ 0x40
|
|
8005ba2: 613b str r3, [r7, #16]
|
|
sdmmc_cmdinit.WaitForInterrupt = SDIO_WAIT_NO;
|
|
8005ba4: 2300 movs r3, #0
|
|
8005ba6: 617b str r3, [r7, #20]
|
|
sdmmc_cmdinit.CPSM = SDIO_CPSM_ENABLE;
|
|
8005ba8: f44f 6380 mov.w r3, #1024 @ 0x400
|
|
8005bac: 61bb str r3, [r7, #24]
|
|
(void)SDIO_SendCommand(SDIOx, &sdmmc_cmdinit);
|
|
8005bae: f107 0308 add.w r3, r7, #8
|
|
8005bb2: 4619 mov r1, r3
|
|
8005bb4: 6878 ldr r0, [r7, #4]
|
|
8005bb6: f7ff fe93 bl 80058e0 <SDIO_SendCommand>
|
|
|
|
/* Check for error conditions */
|
|
errorstate = SDMMC_GetCmdResp1(SDIOx, SDMMC_CMD_STOP_TRANSMISSION, SDIO_STOPTRANSFERTIMEOUT);
|
|
8005bba: 4a05 ldr r2, [pc, #20] @ (8005bd0 <SDMMC_CmdStopTransfer+0x40>)
|
|
8005bbc: 210c movs r1, #12
|
|
8005bbe: 6878 ldr r0, [r7, #4]
|
|
8005bc0: f000 f970 bl 8005ea4 <SDMMC_GetCmdResp1>
|
|
8005bc4: 61f8 str r0, [r7, #28]
|
|
|
|
return errorstate;
|
|
8005bc6: 69fb ldr r3, [r7, #28]
|
|
}
|
|
8005bc8: 4618 mov r0, r3
|
|
8005bca: 3720 adds r7, #32
|
|
8005bcc: 46bd mov sp, r7
|
|
8005bce: bd80 pop {r7, pc}
|
|
8005bd0: 05f5e100 .word 0x05f5e100
|
|
|
|
08005bd4 <SDMMC_CmdSelDesel>:
|
|
* @param SDIOx: Pointer to SDIO register base
|
|
* @param addr: Address of the card to be selected
|
|
* @retval HAL status
|
|
*/
|
|
uint32_t SDMMC_CmdSelDesel(SDIO_TypeDef *SDIOx, uint64_t Addr)
|
|
{
|
|
8005bd4: b580 push {r7, lr}
|
|
8005bd6: b08a sub sp, #40 @ 0x28
|
|
8005bd8: af00 add r7, sp, #0
|
|
8005bda: 60f8 str r0, [r7, #12]
|
|
8005bdc: e9c7 2300 strd r2, r3, [r7]
|
|
SDIO_CmdInitTypeDef sdmmc_cmdinit;
|
|
uint32_t errorstate;
|
|
|
|
/* Send CMD7 SDMMC_SEL_DESEL_CARD */
|
|
sdmmc_cmdinit.Argument = (uint32_t)Addr;
|
|
8005be0: 683b ldr r3, [r7, #0]
|
|
8005be2: 613b str r3, [r7, #16]
|
|
sdmmc_cmdinit.CmdIndex = SDMMC_CMD_SEL_DESEL_CARD;
|
|
8005be4: 2307 movs r3, #7
|
|
8005be6: 617b str r3, [r7, #20]
|
|
sdmmc_cmdinit.Response = SDIO_RESPONSE_SHORT;
|
|
8005be8: 2340 movs r3, #64 @ 0x40
|
|
8005bea: 61bb str r3, [r7, #24]
|
|
sdmmc_cmdinit.WaitForInterrupt = SDIO_WAIT_NO;
|
|
8005bec: 2300 movs r3, #0
|
|
8005bee: 61fb str r3, [r7, #28]
|
|
sdmmc_cmdinit.CPSM = SDIO_CPSM_ENABLE;
|
|
8005bf0: f44f 6380 mov.w r3, #1024 @ 0x400
|
|
8005bf4: 623b str r3, [r7, #32]
|
|
(void)SDIO_SendCommand(SDIOx, &sdmmc_cmdinit);
|
|
8005bf6: f107 0310 add.w r3, r7, #16
|
|
8005bfa: 4619 mov r1, r3
|
|
8005bfc: 68f8 ldr r0, [r7, #12]
|
|
8005bfe: f7ff fe6f bl 80058e0 <SDIO_SendCommand>
|
|
|
|
/* Check for error conditions */
|
|
errorstate = SDMMC_GetCmdResp1(SDIOx, SDMMC_CMD_SEL_DESEL_CARD, SDIO_CMDTIMEOUT);
|
|
8005c02: f241 3288 movw r2, #5000 @ 0x1388
|
|
8005c06: 2107 movs r1, #7
|
|
8005c08: 68f8 ldr r0, [r7, #12]
|
|
8005c0a: f000 f94b bl 8005ea4 <SDMMC_GetCmdResp1>
|
|
8005c0e: 6278 str r0, [r7, #36] @ 0x24
|
|
|
|
return errorstate;
|
|
8005c10: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
}
|
|
8005c12: 4618 mov r0, r3
|
|
8005c14: 3728 adds r7, #40 @ 0x28
|
|
8005c16: 46bd mov sp, r7
|
|
8005c18: bd80 pop {r7, pc}
|
|
|
|
08005c1a <SDMMC_CmdGoIdleState>:
|
|
* @brief Send the Go Idle State command and check the response.
|
|
* @param SDIOx: Pointer to SDIO register base
|
|
* @retval HAL status
|
|
*/
|
|
uint32_t SDMMC_CmdGoIdleState(SDIO_TypeDef *SDIOx)
|
|
{
|
|
8005c1a: b580 push {r7, lr}
|
|
8005c1c: b088 sub sp, #32
|
|
8005c1e: af00 add r7, sp, #0
|
|
8005c20: 6078 str r0, [r7, #4]
|
|
SDIO_CmdInitTypeDef sdmmc_cmdinit;
|
|
uint32_t errorstate;
|
|
|
|
sdmmc_cmdinit.Argument = 0U;
|
|
8005c22: 2300 movs r3, #0
|
|
8005c24: 60bb str r3, [r7, #8]
|
|
sdmmc_cmdinit.CmdIndex = SDMMC_CMD_GO_IDLE_STATE;
|
|
8005c26: 2300 movs r3, #0
|
|
8005c28: 60fb str r3, [r7, #12]
|
|
sdmmc_cmdinit.Response = SDIO_RESPONSE_NO;
|
|
8005c2a: 2300 movs r3, #0
|
|
8005c2c: 613b str r3, [r7, #16]
|
|
sdmmc_cmdinit.WaitForInterrupt = SDIO_WAIT_NO;
|
|
8005c2e: 2300 movs r3, #0
|
|
8005c30: 617b str r3, [r7, #20]
|
|
sdmmc_cmdinit.CPSM = SDIO_CPSM_ENABLE;
|
|
8005c32: f44f 6380 mov.w r3, #1024 @ 0x400
|
|
8005c36: 61bb str r3, [r7, #24]
|
|
(void)SDIO_SendCommand(SDIOx, &sdmmc_cmdinit);
|
|
8005c38: f107 0308 add.w r3, r7, #8
|
|
8005c3c: 4619 mov r1, r3
|
|
8005c3e: 6878 ldr r0, [r7, #4]
|
|
8005c40: f7ff fe4e bl 80058e0 <SDIO_SendCommand>
|
|
|
|
/* Check for error conditions */
|
|
errorstate = SDMMC_GetCmdError(SDIOx);
|
|
8005c44: 6878 ldr r0, [r7, #4]
|
|
8005c46: f000 fb65 bl 8006314 <SDMMC_GetCmdError>
|
|
8005c4a: 61f8 str r0, [r7, #28]
|
|
|
|
return errorstate;
|
|
8005c4c: 69fb ldr r3, [r7, #28]
|
|
}
|
|
8005c4e: 4618 mov r0, r3
|
|
8005c50: 3720 adds r7, #32
|
|
8005c52: 46bd mov sp, r7
|
|
8005c54: bd80 pop {r7, pc}
|
|
|
|
08005c56 <SDMMC_CmdOperCond>:
|
|
* @brief Send the Operating Condition command and check the response.
|
|
* @param SDIOx: Pointer to SDIO register base
|
|
* @retval HAL status
|
|
*/
|
|
uint32_t SDMMC_CmdOperCond(SDIO_TypeDef *SDIOx)
|
|
{
|
|
8005c56: b580 push {r7, lr}
|
|
8005c58: b088 sub sp, #32
|
|
8005c5a: af00 add r7, sp, #0
|
|
8005c5c: 6078 str r0, [r7, #4]
|
|
/* Send CMD8 to verify SD card interface operating condition */
|
|
/* Argument: - [31:12]: Reserved (shall be set to '0')
|
|
- [11:8]: Supply Voltage (VHS) 0x1 (Range: 2.7-3.6 V)
|
|
- [7:0]: Check Pattern (recommended 0xAA) */
|
|
/* CMD Response: R7 */
|
|
sdmmc_cmdinit.Argument = SDMMC_CHECK_PATTERN;
|
|
8005c5e: f44f 73d5 mov.w r3, #426 @ 0x1aa
|
|
8005c62: 60bb str r3, [r7, #8]
|
|
sdmmc_cmdinit.CmdIndex = SDMMC_CMD_HS_SEND_EXT_CSD;
|
|
8005c64: 2308 movs r3, #8
|
|
8005c66: 60fb str r3, [r7, #12]
|
|
sdmmc_cmdinit.Response = SDIO_RESPONSE_SHORT;
|
|
8005c68: 2340 movs r3, #64 @ 0x40
|
|
8005c6a: 613b str r3, [r7, #16]
|
|
sdmmc_cmdinit.WaitForInterrupt = SDIO_WAIT_NO;
|
|
8005c6c: 2300 movs r3, #0
|
|
8005c6e: 617b str r3, [r7, #20]
|
|
sdmmc_cmdinit.CPSM = SDIO_CPSM_ENABLE;
|
|
8005c70: f44f 6380 mov.w r3, #1024 @ 0x400
|
|
8005c74: 61bb str r3, [r7, #24]
|
|
(void)SDIO_SendCommand(SDIOx, &sdmmc_cmdinit);
|
|
8005c76: f107 0308 add.w r3, r7, #8
|
|
8005c7a: 4619 mov r1, r3
|
|
8005c7c: 6878 ldr r0, [r7, #4]
|
|
8005c7e: f7ff fe2f bl 80058e0 <SDIO_SendCommand>
|
|
|
|
/* Check for error conditions */
|
|
errorstate = SDMMC_GetCmdResp7(SDIOx);
|
|
8005c82: 6878 ldr r0, [r7, #4]
|
|
8005c84: f000 faf8 bl 8006278 <SDMMC_GetCmdResp7>
|
|
8005c88: 61f8 str r0, [r7, #28]
|
|
|
|
return errorstate;
|
|
8005c8a: 69fb ldr r3, [r7, #28]
|
|
}
|
|
8005c8c: 4618 mov r0, r3
|
|
8005c8e: 3720 adds r7, #32
|
|
8005c90: 46bd mov sp, r7
|
|
8005c92: bd80 pop {r7, pc}
|
|
|
|
08005c94 <SDMMC_CmdAppCommand>:
|
|
* @param SDIOx: Pointer to SDIO register base
|
|
* @param Argument: Command Argument
|
|
* @retval HAL status
|
|
*/
|
|
uint32_t SDMMC_CmdAppCommand(SDIO_TypeDef *SDIOx, uint32_t Argument)
|
|
{
|
|
8005c94: b580 push {r7, lr}
|
|
8005c96: b088 sub sp, #32
|
|
8005c98: af00 add r7, sp, #0
|
|
8005c9a: 6078 str r0, [r7, #4]
|
|
8005c9c: 6039 str r1, [r7, #0]
|
|
SDIO_CmdInitTypeDef sdmmc_cmdinit;
|
|
uint32_t errorstate;
|
|
|
|
sdmmc_cmdinit.Argument = (uint32_t)Argument;
|
|
8005c9e: 683b ldr r3, [r7, #0]
|
|
8005ca0: 60bb str r3, [r7, #8]
|
|
sdmmc_cmdinit.CmdIndex = SDMMC_CMD_APP_CMD;
|
|
8005ca2: 2337 movs r3, #55 @ 0x37
|
|
8005ca4: 60fb str r3, [r7, #12]
|
|
sdmmc_cmdinit.Response = SDIO_RESPONSE_SHORT;
|
|
8005ca6: 2340 movs r3, #64 @ 0x40
|
|
8005ca8: 613b str r3, [r7, #16]
|
|
sdmmc_cmdinit.WaitForInterrupt = SDIO_WAIT_NO;
|
|
8005caa: 2300 movs r3, #0
|
|
8005cac: 617b str r3, [r7, #20]
|
|
sdmmc_cmdinit.CPSM = SDIO_CPSM_ENABLE;
|
|
8005cae: f44f 6380 mov.w r3, #1024 @ 0x400
|
|
8005cb2: 61bb str r3, [r7, #24]
|
|
(void)SDIO_SendCommand(SDIOx, &sdmmc_cmdinit);
|
|
8005cb4: f107 0308 add.w r3, r7, #8
|
|
8005cb8: 4619 mov r1, r3
|
|
8005cba: 6878 ldr r0, [r7, #4]
|
|
8005cbc: f7ff fe10 bl 80058e0 <SDIO_SendCommand>
|
|
|
|
/* Check for error conditions */
|
|
/* If there is a HAL_ERROR, it is a MMC card, else
|
|
it is a SD card: SD card 2.0 (voltage range mismatch)
|
|
or SD card 1.x */
|
|
errorstate = SDMMC_GetCmdResp1(SDIOx, SDMMC_CMD_APP_CMD, SDIO_CMDTIMEOUT);
|
|
8005cc0: f241 3288 movw r2, #5000 @ 0x1388
|
|
8005cc4: 2137 movs r1, #55 @ 0x37
|
|
8005cc6: 6878 ldr r0, [r7, #4]
|
|
8005cc8: f000 f8ec bl 8005ea4 <SDMMC_GetCmdResp1>
|
|
8005ccc: 61f8 str r0, [r7, #28]
|
|
|
|
return errorstate;
|
|
8005cce: 69fb ldr r3, [r7, #28]
|
|
}
|
|
8005cd0: 4618 mov r0, r3
|
|
8005cd2: 3720 adds r7, #32
|
|
8005cd4: 46bd mov sp, r7
|
|
8005cd6: bd80 pop {r7, pc}
|
|
|
|
08005cd8 <SDMMC_CmdAppOperCommand>:
|
|
* @param SDIOx: Pointer to SDIO register base
|
|
* @param Argument: Command Argument
|
|
* @retval HAL status
|
|
*/
|
|
uint32_t SDMMC_CmdAppOperCommand(SDIO_TypeDef *SDIOx, uint32_t Argument)
|
|
{
|
|
8005cd8: b580 push {r7, lr}
|
|
8005cda: b088 sub sp, #32
|
|
8005cdc: af00 add r7, sp, #0
|
|
8005cde: 6078 str r0, [r7, #4]
|
|
8005ce0: 6039 str r1, [r7, #0]
|
|
SDIO_CmdInitTypeDef sdmmc_cmdinit;
|
|
uint32_t errorstate;
|
|
|
|
sdmmc_cmdinit.Argument = SDMMC_VOLTAGE_WINDOW_SD | Argument;
|
|
8005ce2: 683b ldr r3, [r7, #0]
|
|
8005ce4: f043 4300 orr.w r3, r3, #2147483648 @ 0x80000000
|
|
8005ce8: f443 1380 orr.w r3, r3, #1048576 @ 0x100000
|
|
8005cec: 60bb str r3, [r7, #8]
|
|
sdmmc_cmdinit.CmdIndex = SDMMC_CMD_SD_APP_OP_COND;
|
|
8005cee: 2329 movs r3, #41 @ 0x29
|
|
8005cf0: 60fb str r3, [r7, #12]
|
|
sdmmc_cmdinit.Response = SDIO_RESPONSE_SHORT;
|
|
8005cf2: 2340 movs r3, #64 @ 0x40
|
|
8005cf4: 613b str r3, [r7, #16]
|
|
sdmmc_cmdinit.WaitForInterrupt = SDIO_WAIT_NO;
|
|
8005cf6: 2300 movs r3, #0
|
|
8005cf8: 617b str r3, [r7, #20]
|
|
sdmmc_cmdinit.CPSM = SDIO_CPSM_ENABLE;
|
|
8005cfa: f44f 6380 mov.w r3, #1024 @ 0x400
|
|
8005cfe: 61bb str r3, [r7, #24]
|
|
(void)SDIO_SendCommand(SDIOx, &sdmmc_cmdinit);
|
|
8005d00: f107 0308 add.w r3, r7, #8
|
|
8005d04: 4619 mov r1, r3
|
|
8005d06: 6878 ldr r0, [r7, #4]
|
|
8005d08: f7ff fdea bl 80058e0 <SDIO_SendCommand>
|
|
|
|
/* Check for error conditions */
|
|
errorstate = SDMMC_GetCmdResp3(SDIOx);
|
|
8005d0c: 6878 ldr r0, [r7, #4]
|
|
8005d0e: f000 f9ff bl 8006110 <SDMMC_GetCmdResp3>
|
|
8005d12: 61f8 str r0, [r7, #28]
|
|
|
|
return errorstate;
|
|
8005d14: 69fb ldr r3, [r7, #28]
|
|
}
|
|
8005d16: 4618 mov r0, r3
|
|
8005d18: 3720 adds r7, #32
|
|
8005d1a: 46bd mov sp, r7
|
|
8005d1c: bd80 pop {r7, pc}
|
|
|
|
08005d1e <SDMMC_CmdBusWidth>:
|
|
* @param SDIOx: Pointer to SDIO register base
|
|
* @param BusWidth: BusWidth
|
|
* @retval HAL status
|
|
*/
|
|
uint32_t SDMMC_CmdBusWidth(SDIO_TypeDef *SDIOx, uint32_t BusWidth)
|
|
{
|
|
8005d1e: b580 push {r7, lr}
|
|
8005d20: b088 sub sp, #32
|
|
8005d22: af00 add r7, sp, #0
|
|
8005d24: 6078 str r0, [r7, #4]
|
|
8005d26: 6039 str r1, [r7, #0]
|
|
SDIO_CmdInitTypeDef sdmmc_cmdinit;
|
|
uint32_t errorstate;
|
|
|
|
sdmmc_cmdinit.Argument = (uint32_t)BusWidth;
|
|
8005d28: 683b ldr r3, [r7, #0]
|
|
8005d2a: 60bb str r3, [r7, #8]
|
|
sdmmc_cmdinit.CmdIndex = SDMMC_CMD_APP_SD_SET_BUSWIDTH;
|
|
8005d2c: 2306 movs r3, #6
|
|
8005d2e: 60fb str r3, [r7, #12]
|
|
sdmmc_cmdinit.Response = SDIO_RESPONSE_SHORT;
|
|
8005d30: 2340 movs r3, #64 @ 0x40
|
|
8005d32: 613b str r3, [r7, #16]
|
|
sdmmc_cmdinit.WaitForInterrupt = SDIO_WAIT_NO;
|
|
8005d34: 2300 movs r3, #0
|
|
8005d36: 617b str r3, [r7, #20]
|
|
sdmmc_cmdinit.CPSM = SDIO_CPSM_ENABLE;
|
|
8005d38: f44f 6380 mov.w r3, #1024 @ 0x400
|
|
8005d3c: 61bb str r3, [r7, #24]
|
|
(void)SDIO_SendCommand(SDIOx, &sdmmc_cmdinit);
|
|
8005d3e: f107 0308 add.w r3, r7, #8
|
|
8005d42: 4619 mov r1, r3
|
|
8005d44: 6878 ldr r0, [r7, #4]
|
|
8005d46: f7ff fdcb bl 80058e0 <SDIO_SendCommand>
|
|
|
|
/* Check for error conditions */
|
|
errorstate = SDMMC_GetCmdResp1(SDIOx, SDMMC_CMD_APP_SD_SET_BUSWIDTH, SDIO_CMDTIMEOUT);
|
|
8005d4a: f241 3288 movw r2, #5000 @ 0x1388
|
|
8005d4e: 2106 movs r1, #6
|
|
8005d50: 6878 ldr r0, [r7, #4]
|
|
8005d52: f000 f8a7 bl 8005ea4 <SDMMC_GetCmdResp1>
|
|
8005d56: 61f8 str r0, [r7, #28]
|
|
|
|
return errorstate;
|
|
8005d58: 69fb ldr r3, [r7, #28]
|
|
}
|
|
8005d5a: 4618 mov r0, r3
|
|
8005d5c: 3720 adds r7, #32
|
|
8005d5e: 46bd mov sp, r7
|
|
8005d60: bd80 pop {r7, pc}
|
|
|
|
08005d62 <SDMMC_CmdSendSCR>:
|
|
* @brief Send the Send SCR command and check the response.
|
|
* @param SDIOx: Pointer to SDIO register base
|
|
* @retval HAL status
|
|
*/
|
|
uint32_t SDMMC_CmdSendSCR(SDIO_TypeDef *SDIOx)
|
|
{
|
|
8005d62: b580 push {r7, lr}
|
|
8005d64: b088 sub sp, #32
|
|
8005d66: af00 add r7, sp, #0
|
|
8005d68: 6078 str r0, [r7, #4]
|
|
SDIO_CmdInitTypeDef sdmmc_cmdinit;
|
|
uint32_t errorstate;
|
|
|
|
/* Send CMD51 SD_APP_SEND_SCR */
|
|
sdmmc_cmdinit.Argument = 0U;
|
|
8005d6a: 2300 movs r3, #0
|
|
8005d6c: 60bb str r3, [r7, #8]
|
|
sdmmc_cmdinit.CmdIndex = SDMMC_CMD_SD_APP_SEND_SCR;
|
|
8005d6e: 2333 movs r3, #51 @ 0x33
|
|
8005d70: 60fb str r3, [r7, #12]
|
|
sdmmc_cmdinit.Response = SDIO_RESPONSE_SHORT;
|
|
8005d72: 2340 movs r3, #64 @ 0x40
|
|
8005d74: 613b str r3, [r7, #16]
|
|
sdmmc_cmdinit.WaitForInterrupt = SDIO_WAIT_NO;
|
|
8005d76: 2300 movs r3, #0
|
|
8005d78: 617b str r3, [r7, #20]
|
|
sdmmc_cmdinit.CPSM = SDIO_CPSM_ENABLE;
|
|
8005d7a: f44f 6380 mov.w r3, #1024 @ 0x400
|
|
8005d7e: 61bb str r3, [r7, #24]
|
|
(void)SDIO_SendCommand(SDIOx, &sdmmc_cmdinit);
|
|
8005d80: f107 0308 add.w r3, r7, #8
|
|
8005d84: 4619 mov r1, r3
|
|
8005d86: 6878 ldr r0, [r7, #4]
|
|
8005d88: f7ff fdaa bl 80058e0 <SDIO_SendCommand>
|
|
|
|
/* Check for error conditions */
|
|
errorstate = SDMMC_GetCmdResp1(SDIOx, SDMMC_CMD_SD_APP_SEND_SCR, SDIO_CMDTIMEOUT);
|
|
8005d8c: f241 3288 movw r2, #5000 @ 0x1388
|
|
8005d90: 2133 movs r1, #51 @ 0x33
|
|
8005d92: 6878 ldr r0, [r7, #4]
|
|
8005d94: f000 f886 bl 8005ea4 <SDMMC_GetCmdResp1>
|
|
8005d98: 61f8 str r0, [r7, #28]
|
|
|
|
return errorstate;
|
|
8005d9a: 69fb ldr r3, [r7, #28]
|
|
}
|
|
8005d9c: 4618 mov r0, r3
|
|
8005d9e: 3720 adds r7, #32
|
|
8005da0: 46bd mov sp, r7
|
|
8005da2: bd80 pop {r7, pc}
|
|
|
|
08005da4 <SDMMC_CmdSendCID>:
|
|
* @brief Send the Send CID command and check the response.
|
|
* @param SDIOx: Pointer to SDIO register base
|
|
* @retval HAL status
|
|
*/
|
|
uint32_t SDMMC_CmdSendCID(SDIO_TypeDef *SDIOx)
|
|
{
|
|
8005da4: b580 push {r7, lr}
|
|
8005da6: b088 sub sp, #32
|
|
8005da8: af00 add r7, sp, #0
|
|
8005daa: 6078 str r0, [r7, #4]
|
|
SDIO_CmdInitTypeDef sdmmc_cmdinit;
|
|
uint32_t errorstate;
|
|
|
|
/* Send CMD2 ALL_SEND_CID */
|
|
sdmmc_cmdinit.Argument = 0U;
|
|
8005dac: 2300 movs r3, #0
|
|
8005dae: 60bb str r3, [r7, #8]
|
|
sdmmc_cmdinit.CmdIndex = SDMMC_CMD_ALL_SEND_CID;
|
|
8005db0: 2302 movs r3, #2
|
|
8005db2: 60fb str r3, [r7, #12]
|
|
sdmmc_cmdinit.Response = SDIO_RESPONSE_LONG;
|
|
8005db4: 23c0 movs r3, #192 @ 0xc0
|
|
8005db6: 613b str r3, [r7, #16]
|
|
sdmmc_cmdinit.WaitForInterrupt = SDIO_WAIT_NO;
|
|
8005db8: 2300 movs r3, #0
|
|
8005dba: 617b str r3, [r7, #20]
|
|
sdmmc_cmdinit.CPSM = SDIO_CPSM_ENABLE;
|
|
8005dbc: f44f 6380 mov.w r3, #1024 @ 0x400
|
|
8005dc0: 61bb str r3, [r7, #24]
|
|
(void)SDIO_SendCommand(SDIOx, &sdmmc_cmdinit);
|
|
8005dc2: f107 0308 add.w r3, r7, #8
|
|
8005dc6: 4619 mov r1, r3
|
|
8005dc8: 6878 ldr r0, [r7, #4]
|
|
8005dca: f7ff fd89 bl 80058e0 <SDIO_SendCommand>
|
|
|
|
/* Check for error conditions */
|
|
errorstate = SDMMC_GetCmdResp2(SDIOx);
|
|
8005dce: 6878 ldr r0, [r7, #4]
|
|
8005dd0: f000 f956 bl 8006080 <SDMMC_GetCmdResp2>
|
|
8005dd4: 61f8 str r0, [r7, #28]
|
|
|
|
return errorstate;
|
|
8005dd6: 69fb ldr r3, [r7, #28]
|
|
}
|
|
8005dd8: 4618 mov r0, r3
|
|
8005dda: 3720 adds r7, #32
|
|
8005ddc: 46bd mov sp, r7
|
|
8005dde: bd80 pop {r7, pc}
|
|
|
|
08005de0 <SDMMC_CmdSendCSD>:
|
|
* @param SDIOx: Pointer to SDIO register base
|
|
* @param Argument: Command Argument
|
|
* @retval HAL status
|
|
*/
|
|
uint32_t SDMMC_CmdSendCSD(SDIO_TypeDef *SDIOx, uint32_t Argument)
|
|
{
|
|
8005de0: b580 push {r7, lr}
|
|
8005de2: b088 sub sp, #32
|
|
8005de4: af00 add r7, sp, #0
|
|
8005de6: 6078 str r0, [r7, #4]
|
|
8005de8: 6039 str r1, [r7, #0]
|
|
SDIO_CmdInitTypeDef sdmmc_cmdinit;
|
|
uint32_t errorstate;
|
|
|
|
/* Send CMD9 SEND_CSD */
|
|
sdmmc_cmdinit.Argument = Argument;
|
|
8005dea: 683b ldr r3, [r7, #0]
|
|
8005dec: 60bb str r3, [r7, #8]
|
|
sdmmc_cmdinit.CmdIndex = SDMMC_CMD_SEND_CSD;
|
|
8005dee: 2309 movs r3, #9
|
|
8005df0: 60fb str r3, [r7, #12]
|
|
sdmmc_cmdinit.Response = SDIO_RESPONSE_LONG;
|
|
8005df2: 23c0 movs r3, #192 @ 0xc0
|
|
8005df4: 613b str r3, [r7, #16]
|
|
sdmmc_cmdinit.WaitForInterrupt = SDIO_WAIT_NO;
|
|
8005df6: 2300 movs r3, #0
|
|
8005df8: 617b str r3, [r7, #20]
|
|
sdmmc_cmdinit.CPSM = SDIO_CPSM_ENABLE;
|
|
8005dfa: f44f 6380 mov.w r3, #1024 @ 0x400
|
|
8005dfe: 61bb str r3, [r7, #24]
|
|
(void)SDIO_SendCommand(SDIOx, &sdmmc_cmdinit);
|
|
8005e00: f107 0308 add.w r3, r7, #8
|
|
8005e04: 4619 mov r1, r3
|
|
8005e06: 6878 ldr r0, [r7, #4]
|
|
8005e08: f7ff fd6a bl 80058e0 <SDIO_SendCommand>
|
|
|
|
/* Check for error conditions */
|
|
errorstate = SDMMC_GetCmdResp2(SDIOx);
|
|
8005e0c: 6878 ldr r0, [r7, #4]
|
|
8005e0e: f000 f937 bl 8006080 <SDMMC_GetCmdResp2>
|
|
8005e12: 61f8 str r0, [r7, #28]
|
|
|
|
return errorstate;
|
|
8005e14: 69fb ldr r3, [r7, #28]
|
|
}
|
|
8005e16: 4618 mov r0, r3
|
|
8005e18: 3720 adds r7, #32
|
|
8005e1a: 46bd mov sp, r7
|
|
8005e1c: bd80 pop {r7, pc}
|
|
|
|
08005e1e <SDMMC_CmdSetRelAdd>:
|
|
* @param SDIOx: Pointer to SDIO register base
|
|
* @param pRCA: Card RCA
|
|
* @retval HAL status
|
|
*/
|
|
uint32_t SDMMC_CmdSetRelAdd(SDIO_TypeDef *SDIOx, uint16_t *pRCA)
|
|
{
|
|
8005e1e: b580 push {r7, lr}
|
|
8005e20: b088 sub sp, #32
|
|
8005e22: af00 add r7, sp, #0
|
|
8005e24: 6078 str r0, [r7, #4]
|
|
8005e26: 6039 str r1, [r7, #0]
|
|
SDIO_CmdInitTypeDef sdmmc_cmdinit;
|
|
uint32_t errorstate;
|
|
|
|
/* Send CMD3 SD_CMD_SET_REL_ADDR */
|
|
sdmmc_cmdinit.Argument = 0U;
|
|
8005e28: 2300 movs r3, #0
|
|
8005e2a: 60bb str r3, [r7, #8]
|
|
sdmmc_cmdinit.CmdIndex = SDMMC_CMD_SET_REL_ADDR;
|
|
8005e2c: 2303 movs r3, #3
|
|
8005e2e: 60fb str r3, [r7, #12]
|
|
sdmmc_cmdinit.Response = SDIO_RESPONSE_SHORT;
|
|
8005e30: 2340 movs r3, #64 @ 0x40
|
|
8005e32: 613b str r3, [r7, #16]
|
|
sdmmc_cmdinit.WaitForInterrupt = SDIO_WAIT_NO;
|
|
8005e34: 2300 movs r3, #0
|
|
8005e36: 617b str r3, [r7, #20]
|
|
sdmmc_cmdinit.CPSM = SDIO_CPSM_ENABLE;
|
|
8005e38: f44f 6380 mov.w r3, #1024 @ 0x400
|
|
8005e3c: 61bb str r3, [r7, #24]
|
|
(void)SDIO_SendCommand(SDIOx, &sdmmc_cmdinit);
|
|
8005e3e: f107 0308 add.w r3, r7, #8
|
|
8005e42: 4619 mov r1, r3
|
|
8005e44: 6878 ldr r0, [r7, #4]
|
|
8005e46: f7ff fd4b bl 80058e0 <SDIO_SendCommand>
|
|
|
|
/* Check for error conditions */
|
|
errorstate = SDMMC_GetCmdResp6(SDIOx, SDMMC_CMD_SET_REL_ADDR, pRCA);
|
|
8005e4a: 683a ldr r2, [r7, #0]
|
|
8005e4c: 2103 movs r1, #3
|
|
8005e4e: 6878 ldr r0, [r7, #4]
|
|
8005e50: f000 f99c bl 800618c <SDMMC_GetCmdResp6>
|
|
8005e54: 61f8 str r0, [r7, #28]
|
|
|
|
return errorstate;
|
|
8005e56: 69fb ldr r3, [r7, #28]
|
|
}
|
|
8005e58: 4618 mov r0, r3
|
|
8005e5a: 3720 adds r7, #32
|
|
8005e5c: 46bd mov sp, r7
|
|
8005e5e: bd80 pop {r7, pc}
|
|
|
|
08005e60 <SDMMC_CmdSendStatus>:
|
|
* @param SDIOx: Pointer to SDIO register base
|
|
* @param Argument: Command Argument
|
|
* @retval HAL status
|
|
*/
|
|
uint32_t SDMMC_CmdSendStatus(SDIO_TypeDef *SDIOx, uint32_t Argument)
|
|
{
|
|
8005e60: b580 push {r7, lr}
|
|
8005e62: b088 sub sp, #32
|
|
8005e64: af00 add r7, sp, #0
|
|
8005e66: 6078 str r0, [r7, #4]
|
|
8005e68: 6039 str r1, [r7, #0]
|
|
SDIO_CmdInitTypeDef sdmmc_cmdinit;
|
|
uint32_t errorstate;
|
|
|
|
sdmmc_cmdinit.Argument = Argument;
|
|
8005e6a: 683b ldr r3, [r7, #0]
|
|
8005e6c: 60bb str r3, [r7, #8]
|
|
sdmmc_cmdinit.CmdIndex = SDMMC_CMD_SEND_STATUS;
|
|
8005e6e: 230d movs r3, #13
|
|
8005e70: 60fb str r3, [r7, #12]
|
|
sdmmc_cmdinit.Response = SDIO_RESPONSE_SHORT;
|
|
8005e72: 2340 movs r3, #64 @ 0x40
|
|
8005e74: 613b str r3, [r7, #16]
|
|
sdmmc_cmdinit.WaitForInterrupt = SDIO_WAIT_NO;
|
|
8005e76: 2300 movs r3, #0
|
|
8005e78: 617b str r3, [r7, #20]
|
|
sdmmc_cmdinit.CPSM = SDIO_CPSM_ENABLE;
|
|
8005e7a: f44f 6380 mov.w r3, #1024 @ 0x400
|
|
8005e7e: 61bb str r3, [r7, #24]
|
|
(void)SDIO_SendCommand(SDIOx, &sdmmc_cmdinit);
|
|
8005e80: f107 0308 add.w r3, r7, #8
|
|
8005e84: 4619 mov r1, r3
|
|
8005e86: 6878 ldr r0, [r7, #4]
|
|
8005e88: f7ff fd2a bl 80058e0 <SDIO_SendCommand>
|
|
|
|
/* Check for error conditions */
|
|
errorstate = SDMMC_GetCmdResp1(SDIOx, SDMMC_CMD_SEND_STATUS, SDIO_CMDTIMEOUT);
|
|
8005e8c: f241 3288 movw r2, #5000 @ 0x1388
|
|
8005e90: 210d movs r1, #13
|
|
8005e92: 6878 ldr r0, [r7, #4]
|
|
8005e94: f000 f806 bl 8005ea4 <SDMMC_GetCmdResp1>
|
|
8005e98: 61f8 str r0, [r7, #28]
|
|
|
|
return errorstate;
|
|
8005e9a: 69fb ldr r3, [r7, #28]
|
|
}
|
|
8005e9c: 4618 mov r0, r3
|
|
8005e9e: 3720 adds r7, #32
|
|
8005ea0: 46bd mov sp, r7
|
|
8005ea2: bd80 pop {r7, pc}
|
|
|
|
08005ea4 <SDMMC_GetCmdResp1>:
|
|
* @param SDIOx Pointer to SDMMC register base
|
|
* @param SD_CMD: The sent command index
|
|
* @retval SD Card error state
|
|
*/
|
|
uint32_t SDMMC_GetCmdResp1(SDIO_TypeDef *SDIOx, uint8_t SD_CMD, uint32_t Timeout)
|
|
{
|
|
8005ea4: b580 push {r7, lr}
|
|
8005ea6: b088 sub sp, #32
|
|
8005ea8: af00 add r7, sp, #0
|
|
8005eaa: 60f8 str r0, [r7, #12]
|
|
8005eac: 460b mov r3, r1
|
|
8005eae: 607a str r2, [r7, #4]
|
|
8005eb0: 72fb strb r3, [r7, #11]
|
|
uint32_t response_r1;
|
|
uint32_t sta_reg;
|
|
|
|
/* 8 is the number of required instructions cycles for the below loop statement.
|
|
The Timeout is expressed in ms */
|
|
uint32_t count = Timeout * (SystemCoreClock / 8U /1000U);
|
|
8005eb2: 4b70 ldr r3, [pc, #448] @ (8006074 <SDMMC_GetCmdResp1+0x1d0>)
|
|
8005eb4: 681b ldr r3, [r3, #0]
|
|
8005eb6: 4a70 ldr r2, [pc, #448] @ (8006078 <SDMMC_GetCmdResp1+0x1d4>)
|
|
8005eb8: fba2 2303 umull r2, r3, r2, r3
|
|
8005ebc: 0a5a lsrs r2, r3, #9
|
|
8005ebe: 687b ldr r3, [r7, #4]
|
|
8005ec0: fb02 f303 mul.w r3, r2, r3
|
|
8005ec4: 61fb str r3, [r7, #28]
|
|
|
|
do
|
|
{
|
|
if (count-- == 0U)
|
|
8005ec6: 69fb ldr r3, [r7, #28]
|
|
8005ec8: 1e5a subs r2, r3, #1
|
|
8005eca: 61fa str r2, [r7, #28]
|
|
8005ecc: 2b00 cmp r3, #0
|
|
8005ece: d102 bne.n 8005ed6 <SDMMC_GetCmdResp1+0x32>
|
|
{
|
|
return SDMMC_ERROR_TIMEOUT;
|
|
8005ed0: f04f 4300 mov.w r3, #2147483648 @ 0x80000000
|
|
8005ed4: e0c9 b.n 800606a <SDMMC_GetCmdResp1+0x1c6>
|
|
}
|
|
sta_reg = SDIOx->STA;
|
|
8005ed6: 68fb ldr r3, [r7, #12]
|
|
8005ed8: 6b5b ldr r3, [r3, #52] @ 0x34
|
|
8005eda: 61bb str r3, [r7, #24]
|
|
}while(((sta_reg & (SDIO_FLAG_CCRCFAIL | SDIO_FLAG_CMDREND | SDIO_FLAG_CTIMEOUT)) == 0U) ||
|
|
8005edc: 69bb ldr r3, [r7, #24]
|
|
8005ede: f003 0345 and.w r3, r3, #69 @ 0x45
|
|
8005ee2: 2b00 cmp r3, #0
|
|
8005ee4: d0ef beq.n 8005ec6 <SDMMC_GetCmdResp1+0x22>
|
|
((sta_reg & SDIO_FLAG_CMDACT) != 0U ));
|
|
8005ee6: 69bb ldr r3, [r7, #24]
|
|
8005ee8: f403 6300 and.w r3, r3, #2048 @ 0x800
|
|
}while(((sta_reg & (SDIO_FLAG_CCRCFAIL | SDIO_FLAG_CMDREND | SDIO_FLAG_CTIMEOUT)) == 0U) ||
|
|
8005eec: 2b00 cmp r3, #0
|
|
8005eee: d1ea bne.n 8005ec6 <SDMMC_GetCmdResp1+0x22>
|
|
|
|
if(__SDIO_GET_FLAG(SDIOx, SDIO_FLAG_CTIMEOUT))
|
|
8005ef0: 68fb ldr r3, [r7, #12]
|
|
8005ef2: 6b5b ldr r3, [r3, #52] @ 0x34
|
|
8005ef4: f003 0304 and.w r3, r3, #4
|
|
8005ef8: 2b00 cmp r3, #0
|
|
8005efa: d004 beq.n 8005f06 <SDMMC_GetCmdResp1+0x62>
|
|
{
|
|
__SDIO_CLEAR_FLAG(SDIOx, SDIO_FLAG_CTIMEOUT);
|
|
8005efc: 68fb ldr r3, [r7, #12]
|
|
8005efe: 2204 movs r2, #4
|
|
8005f00: 639a str r2, [r3, #56] @ 0x38
|
|
|
|
return SDMMC_ERROR_CMD_RSP_TIMEOUT;
|
|
8005f02: 2304 movs r3, #4
|
|
8005f04: e0b1 b.n 800606a <SDMMC_GetCmdResp1+0x1c6>
|
|
}
|
|
else if(__SDIO_GET_FLAG(SDIOx, SDIO_FLAG_CCRCFAIL))
|
|
8005f06: 68fb ldr r3, [r7, #12]
|
|
8005f08: 6b5b ldr r3, [r3, #52] @ 0x34
|
|
8005f0a: f003 0301 and.w r3, r3, #1
|
|
8005f0e: 2b00 cmp r3, #0
|
|
8005f10: d004 beq.n 8005f1c <SDMMC_GetCmdResp1+0x78>
|
|
{
|
|
__SDIO_CLEAR_FLAG(SDIOx, SDIO_FLAG_CCRCFAIL);
|
|
8005f12: 68fb ldr r3, [r7, #12]
|
|
8005f14: 2201 movs r2, #1
|
|
8005f16: 639a str r2, [r3, #56] @ 0x38
|
|
|
|
return SDMMC_ERROR_CMD_CRC_FAIL;
|
|
8005f18: 2301 movs r3, #1
|
|
8005f1a: e0a6 b.n 800606a <SDMMC_GetCmdResp1+0x1c6>
|
|
{
|
|
/* Nothing to do */
|
|
}
|
|
|
|
/* Clear all the static flags */
|
|
__SDIO_CLEAR_FLAG(SDIOx, SDIO_STATIC_CMD_FLAGS);
|
|
8005f1c: 68fb ldr r3, [r7, #12]
|
|
8005f1e: 22c5 movs r2, #197 @ 0xc5
|
|
8005f20: 639a str r2, [r3, #56] @ 0x38
|
|
|
|
/* Check response received is of desired command */
|
|
if(SDIO_GetCommandResponse(SDIOx) != SD_CMD)
|
|
8005f22: 68f8 ldr r0, [r7, #12]
|
|
8005f24: f7ff fd42 bl 80059ac <SDIO_GetCommandResponse>
|
|
8005f28: 4603 mov r3, r0
|
|
8005f2a: 461a mov r2, r3
|
|
8005f2c: 7afb ldrb r3, [r7, #11]
|
|
8005f2e: 4293 cmp r3, r2
|
|
8005f30: d001 beq.n 8005f36 <SDMMC_GetCmdResp1+0x92>
|
|
{
|
|
return SDMMC_ERROR_CMD_CRC_FAIL;
|
|
8005f32: 2301 movs r3, #1
|
|
8005f34: e099 b.n 800606a <SDMMC_GetCmdResp1+0x1c6>
|
|
}
|
|
|
|
/* We have received response, retrieve it for analysis */
|
|
response_r1 = SDIO_GetResponse(SDIOx, SDIO_RESP1);
|
|
8005f36: 2100 movs r1, #0
|
|
8005f38: 68f8 ldr r0, [r7, #12]
|
|
8005f3a: f7ff fd45 bl 80059c8 <SDIO_GetResponse>
|
|
8005f3e: 6178 str r0, [r7, #20]
|
|
|
|
if((response_r1 & SDMMC_OCR_ERRORBITS) == SDMMC_ALLZERO)
|
|
8005f40: 697a ldr r2, [r7, #20]
|
|
8005f42: 4b4e ldr r3, [pc, #312] @ (800607c <SDMMC_GetCmdResp1+0x1d8>)
|
|
8005f44: 4013 ands r3, r2
|
|
8005f46: 2b00 cmp r3, #0
|
|
8005f48: d101 bne.n 8005f4e <SDMMC_GetCmdResp1+0xaa>
|
|
{
|
|
return SDMMC_ERROR_NONE;
|
|
8005f4a: 2300 movs r3, #0
|
|
8005f4c: e08d b.n 800606a <SDMMC_GetCmdResp1+0x1c6>
|
|
}
|
|
else if((response_r1 & SDMMC_OCR_ADDR_OUT_OF_RANGE) == SDMMC_OCR_ADDR_OUT_OF_RANGE)
|
|
8005f4e: 697b ldr r3, [r7, #20]
|
|
8005f50: 2b00 cmp r3, #0
|
|
8005f52: da02 bge.n 8005f5a <SDMMC_GetCmdResp1+0xb6>
|
|
{
|
|
return SDMMC_ERROR_ADDR_OUT_OF_RANGE;
|
|
8005f54: f04f 7300 mov.w r3, #33554432 @ 0x2000000
|
|
8005f58: e087 b.n 800606a <SDMMC_GetCmdResp1+0x1c6>
|
|
}
|
|
else if((response_r1 & SDMMC_OCR_ADDR_MISALIGNED) == SDMMC_OCR_ADDR_MISALIGNED)
|
|
8005f5a: 697b ldr r3, [r7, #20]
|
|
8005f5c: f003 4380 and.w r3, r3, #1073741824 @ 0x40000000
|
|
8005f60: 2b00 cmp r3, #0
|
|
8005f62: d001 beq.n 8005f68 <SDMMC_GetCmdResp1+0xc4>
|
|
{
|
|
return SDMMC_ERROR_ADDR_MISALIGNED;
|
|
8005f64: 2340 movs r3, #64 @ 0x40
|
|
8005f66: e080 b.n 800606a <SDMMC_GetCmdResp1+0x1c6>
|
|
}
|
|
else if((response_r1 & SDMMC_OCR_BLOCK_LEN_ERR) == SDMMC_OCR_BLOCK_LEN_ERR)
|
|
8005f68: 697b ldr r3, [r7, #20]
|
|
8005f6a: f003 5300 and.w r3, r3, #536870912 @ 0x20000000
|
|
8005f6e: 2b00 cmp r3, #0
|
|
8005f70: d001 beq.n 8005f76 <SDMMC_GetCmdResp1+0xd2>
|
|
{
|
|
return SDMMC_ERROR_BLOCK_LEN_ERR;
|
|
8005f72: 2380 movs r3, #128 @ 0x80
|
|
8005f74: e079 b.n 800606a <SDMMC_GetCmdResp1+0x1c6>
|
|
}
|
|
else if((response_r1 & SDMMC_OCR_ERASE_SEQ_ERR) == SDMMC_OCR_ERASE_SEQ_ERR)
|
|
8005f76: 697b ldr r3, [r7, #20]
|
|
8005f78: f003 5380 and.w r3, r3, #268435456 @ 0x10000000
|
|
8005f7c: 2b00 cmp r3, #0
|
|
8005f7e: d002 beq.n 8005f86 <SDMMC_GetCmdResp1+0xe2>
|
|
{
|
|
return SDMMC_ERROR_ERASE_SEQ_ERR;
|
|
8005f80: f44f 7380 mov.w r3, #256 @ 0x100
|
|
8005f84: e071 b.n 800606a <SDMMC_GetCmdResp1+0x1c6>
|
|
}
|
|
else if((response_r1 & SDMMC_OCR_BAD_ERASE_PARAM) == SDMMC_OCR_BAD_ERASE_PARAM)
|
|
8005f86: 697b ldr r3, [r7, #20]
|
|
8005f88: f003 6300 and.w r3, r3, #134217728 @ 0x8000000
|
|
8005f8c: 2b00 cmp r3, #0
|
|
8005f8e: d002 beq.n 8005f96 <SDMMC_GetCmdResp1+0xf2>
|
|
{
|
|
return SDMMC_ERROR_BAD_ERASE_PARAM;
|
|
8005f90: f44f 7300 mov.w r3, #512 @ 0x200
|
|
8005f94: e069 b.n 800606a <SDMMC_GetCmdResp1+0x1c6>
|
|
}
|
|
else if((response_r1 & SDMMC_OCR_WRITE_PROT_VIOLATION) == SDMMC_OCR_WRITE_PROT_VIOLATION)
|
|
8005f96: 697b ldr r3, [r7, #20]
|
|
8005f98: f003 6380 and.w r3, r3, #67108864 @ 0x4000000
|
|
8005f9c: 2b00 cmp r3, #0
|
|
8005f9e: d002 beq.n 8005fa6 <SDMMC_GetCmdResp1+0x102>
|
|
{
|
|
return SDMMC_ERROR_WRITE_PROT_VIOLATION;
|
|
8005fa0: f44f 6380 mov.w r3, #1024 @ 0x400
|
|
8005fa4: e061 b.n 800606a <SDMMC_GetCmdResp1+0x1c6>
|
|
}
|
|
else if((response_r1 & SDMMC_OCR_LOCK_UNLOCK_FAILED) == SDMMC_OCR_LOCK_UNLOCK_FAILED)
|
|
8005fa6: 697b ldr r3, [r7, #20]
|
|
8005fa8: f003 7380 and.w r3, r3, #16777216 @ 0x1000000
|
|
8005fac: 2b00 cmp r3, #0
|
|
8005fae: d002 beq.n 8005fb6 <SDMMC_GetCmdResp1+0x112>
|
|
{
|
|
return SDMMC_ERROR_LOCK_UNLOCK_FAILED;
|
|
8005fb0: f44f 6300 mov.w r3, #2048 @ 0x800
|
|
8005fb4: e059 b.n 800606a <SDMMC_GetCmdResp1+0x1c6>
|
|
}
|
|
else if((response_r1 & SDMMC_OCR_COM_CRC_FAILED) == SDMMC_OCR_COM_CRC_FAILED)
|
|
8005fb6: 697b ldr r3, [r7, #20]
|
|
8005fb8: f403 0300 and.w r3, r3, #8388608 @ 0x800000
|
|
8005fbc: 2b00 cmp r3, #0
|
|
8005fbe: d002 beq.n 8005fc6 <SDMMC_GetCmdResp1+0x122>
|
|
{
|
|
return SDMMC_ERROR_COM_CRC_FAILED;
|
|
8005fc0: f44f 5380 mov.w r3, #4096 @ 0x1000
|
|
8005fc4: e051 b.n 800606a <SDMMC_GetCmdResp1+0x1c6>
|
|
}
|
|
else if((response_r1 & SDMMC_OCR_ILLEGAL_CMD) == SDMMC_OCR_ILLEGAL_CMD)
|
|
8005fc6: 697b ldr r3, [r7, #20]
|
|
8005fc8: f403 0380 and.w r3, r3, #4194304 @ 0x400000
|
|
8005fcc: 2b00 cmp r3, #0
|
|
8005fce: d002 beq.n 8005fd6 <SDMMC_GetCmdResp1+0x132>
|
|
{
|
|
return SDMMC_ERROR_ILLEGAL_CMD;
|
|
8005fd0: f44f 5300 mov.w r3, #8192 @ 0x2000
|
|
8005fd4: e049 b.n 800606a <SDMMC_GetCmdResp1+0x1c6>
|
|
}
|
|
else if((response_r1 & SDMMC_OCR_CARD_ECC_FAILED) == SDMMC_OCR_CARD_ECC_FAILED)
|
|
8005fd6: 697b ldr r3, [r7, #20]
|
|
8005fd8: f403 1300 and.w r3, r3, #2097152 @ 0x200000
|
|
8005fdc: 2b00 cmp r3, #0
|
|
8005fde: d002 beq.n 8005fe6 <SDMMC_GetCmdResp1+0x142>
|
|
{
|
|
return SDMMC_ERROR_CARD_ECC_FAILED;
|
|
8005fe0: f44f 4380 mov.w r3, #16384 @ 0x4000
|
|
8005fe4: e041 b.n 800606a <SDMMC_GetCmdResp1+0x1c6>
|
|
}
|
|
else if((response_r1 & SDMMC_OCR_CC_ERROR) == SDMMC_OCR_CC_ERROR)
|
|
8005fe6: 697b ldr r3, [r7, #20]
|
|
8005fe8: f403 1380 and.w r3, r3, #1048576 @ 0x100000
|
|
8005fec: 2b00 cmp r3, #0
|
|
8005fee: d002 beq.n 8005ff6 <SDMMC_GetCmdResp1+0x152>
|
|
{
|
|
return SDMMC_ERROR_CC_ERR;
|
|
8005ff0: f44f 4300 mov.w r3, #32768 @ 0x8000
|
|
8005ff4: e039 b.n 800606a <SDMMC_GetCmdResp1+0x1c6>
|
|
}
|
|
else if((response_r1 & SDMMC_OCR_STREAM_READ_UNDERRUN) == SDMMC_OCR_STREAM_READ_UNDERRUN)
|
|
8005ff6: 697b ldr r3, [r7, #20]
|
|
8005ff8: f403 2380 and.w r3, r3, #262144 @ 0x40000
|
|
8005ffc: 2b00 cmp r3, #0
|
|
8005ffe: d002 beq.n 8006006 <SDMMC_GetCmdResp1+0x162>
|
|
{
|
|
return SDMMC_ERROR_STREAM_READ_UNDERRUN;
|
|
8006000: f44f 3300 mov.w r3, #131072 @ 0x20000
|
|
8006004: e031 b.n 800606a <SDMMC_GetCmdResp1+0x1c6>
|
|
}
|
|
else if((response_r1 & SDMMC_OCR_STREAM_WRITE_OVERRUN) == SDMMC_OCR_STREAM_WRITE_OVERRUN)
|
|
8006006: 697b ldr r3, [r7, #20]
|
|
8006008: f403 3300 and.w r3, r3, #131072 @ 0x20000
|
|
800600c: 2b00 cmp r3, #0
|
|
800600e: d002 beq.n 8006016 <SDMMC_GetCmdResp1+0x172>
|
|
{
|
|
return SDMMC_ERROR_STREAM_WRITE_OVERRUN;
|
|
8006010: f44f 2380 mov.w r3, #262144 @ 0x40000
|
|
8006014: e029 b.n 800606a <SDMMC_GetCmdResp1+0x1c6>
|
|
}
|
|
else if((response_r1 & SDMMC_OCR_CID_CSD_OVERWRITE) == SDMMC_OCR_CID_CSD_OVERWRITE)
|
|
8006016: 697b ldr r3, [r7, #20]
|
|
8006018: f403 3380 and.w r3, r3, #65536 @ 0x10000
|
|
800601c: 2b00 cmp r3, #0
|
|
800601e: d002 beq.n 8006026 <SDMMC_GetCmdResp1+0x182>
|
|
{
|
|
return SDMMC_ERROR_CID_CSD_OVERWRITE;
|
|
8006020: f44f 2300 mov.w r3, #524288 @ 0x80000
|
|
8006024: e021 b.n 800606a <SDMMC_GetCmdResp1+0x1c6>
|
|
}
|
|
else if((response_r1 & SDMMC_OCR_WP_ERASE_SKIP) == SDMMC_OCR_WP_ERASE_SKIP)
|
|
8006026: 697b ldr r3, [r7, #20]
|
|
8006028: f403 4300 and.w r3, r3, #32768 @ 0x8000
|
|
800602c: 2b00 cmp r3, #0
|
|
800602e: d002 beq.n 8006036 <SDMMC_GetCmdResp1+0x192>
|
|
{
|
|
return SDMMC_ERROR_WP_ERASE_SKIP;
|
|
8006030: f44f 1380 mov.w r3, #1048576 @ 0x100000
|
|
8006034: e019 b.n 800606a <SDMMC_GetCmdResp1+0x1c6>
|
|
}
|
|
else if((response_r1 & SDMMC_OCR_CARD_ECC_DISABLED) == SDMMC_OCR_CARD_ECC_DISABLED)
|
|
8006036: 697b ldr r3, [r7, #20]
|
|
8006038: f403 4380 and.w r3, r3, #16384 @ 0x4000
|
|
800603c: 2b00 cmp r3, #0
|
|
800603e: d002 beq.n 8006046 <SDMMC_GetCmdResp1+0x1a2>
|
|
{
|
|
return SDMMC_ERROR_CARD_ECC_DISABLED;
|
|
8006040: f44f 1300 mov.w r3, #2097152 @ 0x200000
|
|
8006044: e011 b.n 800606a <SDMMC_GetCmdResp1+0x1c6>
|
|
}
|
|
else if((response_r1 & SDMMC_OCR_ERASE_RESET) == SDMMC_OCR_ERASE_RESET)
|
|
8006046: 697b ldr r3, [r7, #20]
|
|
8006048: f403 5300 and.w r3, r3, #8192 @ 0x2000
|
|
800604c: 2b00 cmp r3, #0
|
|
800604e: d002 beq.n 8006056 <SDMMC_GetCmdResp1+0x1b2>
|
|
{
|
|
return SDMMC_ERROR_ERASE_RESET;
|
|
8006050: f44f 0380 mov.w r3, #4194304 @ 0x400000
|
|
8006054: e009 b.n 800606a <SDMMC_GetCmdResp1+0x1c6>
|
|
}
|
|
else if((response_r1 & SDMMC_OCR_AKE_SEQ_ERROR) == SDMMC_OCR_AKE_SEQ_ERROR)
|
|
8006056: 697b ldr r3, [r7, #20]
|
|
8006058: f003 0308 and.w r3, r3, #8
|
|
800605c: 2b00 cmp r3, #0
|
|
800605e: d002 beq.n 8006066 <SDMMC_GetCmdResp1+0x1c2>
|
|
{
|
|
return SDMMC_ERROR_AKE_SEQ_ERR;
|
|
8006060: f44f 0300 mov.w r3, #8388608 @ 0x800000
|
|
8006064: e001 b.n 800606a <SDMMC_GetCmdResp1+0x1c6>
|
|
}
|
|
else
|
|
{
|
|
return SDMMC_ERROR_GENERAL_UNKNOWN_ERR;
|
|
8006066: f44f 3380 mov.w r3, #65536 @ 0x10000
|
|
}
|
|
}
|
|
800606a: 4618 mov r0, r3
|
|
800606c: 3720 adds r7, #32
|
|
800606e: 46bd mov sp, r7
|
|
8006070: bd80 pop {r7, pc}
|
|
8006072: bf00 nop
|
|
8006074: 20000018 .word 0x20000018
|
|
8006078: 10624dd3 .word 0x10624dd3
|
|
800607c: fdffe008 .word 0xfdffe008
|
|
|
|
08006080 <SDMMC_GetCmdResp2>:
|
|
* @brief Checks for error conditions for R2 (CID or CSD) response.
|
|
* @param SDIOx Pointer to SDMMC register base
|
|
* @retval SD Card error state
|
|
*/
|
|
uint32_t SDMMC_GetCmdResp2(SDIO_TypeDef *SDIOx)
|
|
{
|
|
8006080: b480 push {r7}
|
|
8006082: b085 sub sp, #20
|
|
8006084: af00 add r7, sp, #0
|
|
8006086: 6078 str r0, [r7, #4]
|
|
uint32_t sta_reg;
|
|
/* 8 is the number of required instructions cycles for the below loop statement.
|
|
The SDIO_CMDTIMEOUT is expressed in ms */
|
|
uint32_t count = SDIO_CMDTIMEOUT * (SystemCoreClock / 8U /1000U);
|
|
8006088: 4b1f ldr r3, [pc, #124] @ (8006108 <SDMMC_GetCmdResp2+0x88>)
|
|
800608a: 681b ldr r3, [r3, #0]
|
|
800608c: 4a1f ldr r2, [pc, #124] @ (800610c <SDMMC_GetCmdResp2+0x8c>)
|
|
800608e: fba2 2303 umull r2, r3, r2, r3
|
|
8006092: 0a5b lsrs r3, r3, #9
|
|
8006094: f241 3288 movw r2, #5000 @ 0x1388
|
|
8006098: fb02 f303 mul.w r3, r2, r3
|
|
800609c: 60fb str r3, [r7, #12]
|
|
|
|
do
|
|
{
|
|
if (count-- == 0U)
|
|
800609e: 68fb ldr r3, [r7, #12]
|
|
80060a0: 1e5a subs r2, r3, #1
|
|
80060a2: 60fa str r2, [r7, #12]
|
|
80060a4: 2b00 cmp r3, #0
|
|
80060a6: d102 bne.n 80060ae <SDMMC_GetCmdResp2+0x2e>
|
|
{
|
|
return SDMMC_ERROR_TIMEOUT;
|
|
80060a8: f04f 4300 mov.w r3, #2147483648 @ 0x80000000
|
|
80060ac: e026 b.n 80060fc <SDMMC_GetCmdResp2+0x7c>
|
|
}
|
|
sta_reg = SDIOx->STA;
|
|
80060ae: 687b ldr r3, [r7, #4]
|
|
80060b0: 6b5b ldr r3, [r3, #52] @ 0x34
|
|
80060b2: 60bb str r3, [r7, #8]
|
|
}while(((sta_reg & (SDIO_FLAG_CCRCFAIL | SDIO_FLAG_CMDREND | SDIO_FLAG_CTIMEOUT)) == 0U) ||
|
|
80060b4: 68bb ldr r3, [r7, #8]
|
|
80060b6: f003 0345 and.w r3, r3, #69 @ 0x45
|
|
80060ba: 2b00 cmp r3, #0
|
|
80060bc: d0ef beq.n 800609e <SDMMC_GetCmdResp2+0x1e>
|
|
((sta_reg & SDIO_FLAG_CMDACT) != 0U ));
|
|
80060be: 68bb ldr r3, [r7, #8]
|
|
80060c0: f403 6300 and.w r3, r3, #2048 @ 0x800
|
|
}while(((sta_reg & (SDIO_FLAG_CCRCFAIL | SDIO_FLAG_CMDREND | SDIO_FLAG_CTIMEOUT)) == 0U) ||
|
|
80060c4: 2b00 cmp r3, #0
|
|
80060c6: d1ea bne.n 800609e <SDMMC_GetCmdResp2+0x1e>
|
|
|
|
if (__SDIO_GET_FLAG(SDIOx, SDIO_FLAG_CTIMEOUT))
|
|
80060c8: 687b ldr r3, [r7, #4]
|
|
80060ca: 6b5b ldr r3, [r3, #52] @ 0x34
|
|
80060cc: f003 0304 and.w r3, r3, #4
|
|
80060d0: 2b00 cmp r3, #0
|
|
80060d2: d004 beq.n 80060de <SDMMC_GetCmdResp2+0x5e>
|
|
{
|
|
__SDIO_CLEAR_FLAG(SDIOx, SDIO_FLAG_CTIMEOUT);
|
|
80060d4: 687b ldr r3, [r7, #4]
|
|
80060d6: 2204 movs r2, #4
|
|
80060d8: 639a str r2, [r3, #56] @ 0x38
|
|
|
|
return SDMMC_ERROR_CMD_RSP_TIMEOUT;
|
|
80060da: 2304 movs r3, #4
|
|
80060dc: e00e b.n 80060fc <SDMMC_GetCmdResp2+0x7c>
|
|
}
|
|
else if (__SDIO_GET_FLAG(SDIOx, SDIO_FLAG_CCRCFAIL))
|
|
80060de: 687b ldr r3, [r7, #4]
|
|
80060e0: 6b5b ldr r3, [r3, #52] @ 0x34
|
|
80060e2: f003 0301 and.w r3, r3, #1
|
|
80060e6: 2b00 cmp r3, #0
|
|
80060e8: d004 beq.n 80060f4 <SDMMC_GetCmdResp2+0x74>
|
|
{
|
|
__SDIO_CLEAR_FLAG(SDIOx, SDIO_FLAG_CCRCFAIL);
|
|
80060ea: 687b ldr r3, [r7, #4]
|
|
80060ec: 2201 movs r2, #1
|
|
80060ee: 639a str r2, [r3, #56] @ 0x38
|
|
|
|
return SDMMC_ERROR_CMD_CRC_FAIL;
|
|
80060f0: 2301 movs r3, #1
|
|
80060f2: e003 b.n 80060fc <SDMMC_GetCmdResp2+0x7c>
|
|
}
|
|
else
|
|
{
|
|
/* No error flag set */
|
|
/* Clear all the static flags */
|
|
__SDIO_CLEAR_FLAG(SDIOx, SDIO_STATIC_CMD_FLAGS);
|
|
80060f4: 687b ldr r3, [r7, #4]
|
|
80060f6: 22c5 movs r2, #197 @ 0xc5
|
|
80060f8: 639a str r2, [r3, #56] @ 0x38
|
|
}
|
|
|
|
return SDMMC_ERROR_NONE;
|
|
80060fa: 2300 movs r3, #0
|
|
}
|
|
80060fc: 4618 mov r0, r3
|
|
80060fe: 3714 adds r7, #20
|
|
8006100: 46bd mov sp, r7
|
|
8006102: f85d 7b04 ldr.w r7, [sp], #4
|
|
8006106: 4770 bx lr
|
|
8006108: 20000018 .word 0x20000018
|
|
800610c: 10624dd3 .word 0x10624dd3
|
|
|
|
08006110 <SDMMC_GetCmdResp3>:
|
|
* @brief Checks for error conditions for R3 (OCR) response.
|
|
* @param SDIOx Pointer to SDMMC register base
|
|
* @retval SD Card error state
|
|
*/
|
|
uint32_t SDMMC_GetCmdResp3(SDIO_TypeDef *SDIOx)
|
|
{
|
|
8006110: b480 push {r7}
|
|
8006112: b085 sub sp, #20
|
|
8006114: af00 add r7, sp, #0
|
|
8006116: 6078 str r0, [r7, #4]
|
|
uint32_t sta_reg;
|
|
/* 8 is the number of required instructions cycles for the below loop statement.
|
|
The SDIO_CMDTIMEOUT is expressed in ms */
|
|
uint32_t count = SDIO_CMDTIMEOUT * (SystemCoreClock / 8U /1000U);
|
|
8006118: 4b1a ldr r3, [pc, #104] @ (8006184 <SDMMC_GetCmdResp3+0x74>)
|
|
800611a: 681b ldr r3, [r3, #0]
|
|
800611c: 4a1a ldr r2, [pc, #104] @ (8006188 <SDMMC_GetCmdResp3+0x78>)
|
|
800611e: fba2 2303 umull r2, r3, r2, r3
|
|
8006122: 0a5b lsrs r3, r3, #9
|
|
8006124: f241 3288 movw r2, #5000 @ 0x1388
|
|
8006128: fb02 f303 mul.w r3, r2, r3
|
|
800612c: 60fb str r3, [r7, #12]
|
|
|
|
do
|
|
{
|
|
if (count-- == 0U)
|
|
800612e: 68fb ldr r3, [r7, #12]
|
|
8006130: 1e5a subs r2, r3, #1
|
|
8006132: 60fa str r2, [r7, #12]
|
|
8006134: 2b00 cmp r3, #0
|
|
8006136: d102 bne.n 800613e <SDMMC_GetCmdResp3+0x2e>
|
|
{
|
|
return SDMMC_ERROR_TIMEOUT;
|
|
8006138: f04f 4300 mov.w r3, #2147483648 @ 0x80000000
|
|
800613c: e01b b.n 8006176 <SDMMC_GetCmdResp3+0x66>
|
|
}
|
|
sta_reg = SDIOx->STA;
|
|
800613e: 687b ldr r3, [r7, #4]
|
|
8006140: 6b5b ldr r3, [r3, #52] @ 0x34
|
|
8006142: 60bb str r3, [r7, #8]
|
|
}while(((sta_reg & (SDIO_FLAG_CCRCFAIL | SDIO_FLAG_CMDREND | SDIO_FLAG_CTIMEOUT)) == 0U) ||
|
|
8006144: 68bb ldr r3, [r7, #8]
|
|
8006146: f003 0345 and.w r3, r3, #69 @ 0x45
|
|
800614a: 2b00 cmp r3, #0
|
|
800614c: d0ef beq.n 800612e <SDMMC_GetCmdResp3+0x1e>
|
|
((sta_reg & SDIO_FLAG_CMDACT) != 0U ));
|
|
800614e: 68bb ldr r3, [r7, #8]
|
|
8006150: f403 6300 and.w r3, r3, #2048 @ 0x800
|
|
}while(((sta_reg & (SDIO_FLAG_CCRCFAIL | SDIO_FLAG_CMDREND | SDIO_FLAG_CTIMEOUT)) == 0U) ||
|
|
8006154: 2b00 cmp r3, #0
|
|
8006156: d1ea bne.n 800612e <SDMMC_GetCmdResp3+0x1e>
|
|
|
|
if(__SDIO_GET_FLAG(SDIOx, SDIO_FLAG_CTIMEOUT))
|
|
8006158: 687b ldr r3, [r7, #4]
|
|
800615a: 6b5b ldr r3, [r3, #52] @ 0x34
|
|
800615c: f003 0304 and.w r3, r3, #4
|
|
8006160: 2b00 cmp r3, #0
|
|
8006162: d004 beq.n 800616e <SDMMC_GetCmdResp3+0x5e>
|
|
{
|
|
__SDIO_CLEAR_FLAG(SDIOx, SDIO_FLAG_CTIMEOUT);
|
|
8006164: 687b ldr r3, [r7, #4]
|
|
8006166: 2204 movs r2, #4
|
|
8006168: 639a str r2, [r3, #56] @ 0x38
|
|
|
|
return SDMMC_ERROR_CMD_RSP_TIMEOUT;
|
|
800616a: 2304 movs r3, #4
|
|
800616c: e003 b.n 8006176 <SDMMC_GetCmdResp3+0x66>
|
|
}
|
|
else
|
|
{
|
|
/* Clear all the static flags */
|
|
__SDIO_CLEAR_FLAG(SDIOx, SDIO_STATIC_CMD_FLAGS);
|
|
800616e: 687b ldr r3, [r7, #4]
|
|
8006170: 22c5 movs r2, #197 @ 0xc5
|
|
8006172: 639a str r2, [r3, #56] @ 0x38
|
|
}
|
|
|
|
return SDMMC_ERROR_NONE;
|
|
8006174: 2300 movs r3, #0
|
|
}
|
|
8006176: 4618 mov r0, r3
|
|
8006178: 3714 adds r7, #20
|
|
800617a: 46bd mov sp, r7
|
|
800617c: f85d 7b04 ldr.w r7, [sp], #4
|
|
8006180: 4770 bx lr
|
|
8006182: bf00 nop
|
|
8006184: 20000018 .word 0x20000018
|
|
8006188: 10624dd3 .word 0x10624dd3
|
|
|
|
0800618c <SDMMC_GetCmdResp6>:
|
|
* @param pRCA: Pointer to the variable that will contain the SD card relative
|
|
* address RCA
|
|
* @retval SD Card error state
|
|
*/
|
|
uint32_t SDMMC_GetCmdResp6(SDIO_TypeDef *SDIOx, uint8_t SD_CMD, uint16_t *pRCA)
|
|
{
|
|
800618c: b580 push {r7, lr}
|
|
800618e: b088 sub sp, #32
|
|
8006190: af00 add r7, sp, #0
|
|
8006192: 60f8 str r0, [r7, #12]
|
|
8006194: 460b mov r3, r1
|
|
8006196: 607a str r2, [r7, #4]
|
|
8006198: 72fb strb r3, [r7, #11]
|
|
uint32_t response_r1;
|
|
uint32_t sta_reg;
|
|
|
|
/* 8 is the number of required instructions cycles for the below loop statement.
|
|
The SDIO_CMDTIMEOUT is expressed in ms */
|
|
uint32_t count = SDIO_CMDTIMEOUT * (SystemCoreClock / 8U /1000U);
|
|
800619a: 4b35 ldr r3, [pc, #212] @ (8006270 <SDMMC_GetCmdResp6+0xe4>)
|
|
800619c: 681b ldr r3, [r3, #0]
|
|
800619e: 4a35 ldr r2, [pc, #212] @ (8006274 <SDMMC_GetCmdResp6+0xe8>)
|
|
80061a0: fba2 2303 umull r2, r3, r2, r3
|
|
80061a4: 0a5b lsrs r3, r3, #9
|
|
80061a6: f241 3288 movw r2, #5000 @ 0x1388
|
|
80061aa: fb02 f303 mul.w r3, r2, r3
|
|
80061ae: 61fb str r3, [r7, #28]
|
|
|
|
do
|
|
{
|
|
if (count-- == 0U)
|
|
80061b0: 69fb ldr r3, [r7, #28]
|
|
80061b2: 1e5a subs r2, r3, #1
|
|
80061b4: 61fa str r2, [r7, #28]
|
|
80061b6: 2b00 cmp r3, #0
|
|
80061b8: d102 bne.n 80061c0 <SDMMC_GetCmdResp6+0x34>
|
|
{
|
|
return SDMMC_ERROR_TIMEOUT;
|
|
80061ba: f04f 4300 mov.w r3, #2147483648 @ 0x80000000
|
|
80061be: e052 b.n 8006266 <SDMMC_GetCmdResp6+0xda>
|
|
}
|
|
sta_reg = SDIOx->STA;
|
|
80061c0: 68fb ldr r3, [r7, #12]
|
|
80061c2: 6b5b ldr r3, [r3, #52] @ 0x34
|
|
80061c4: 61bb str r3, [r7, #24]
|
|
}while(((sta_reg & (SDIO_FLAG_CCRCFAIL | SDIO_FLAG_CMDREND | SDIO_FLAG_CTIMEOUT)) == 0U) ||
|
|
80061c6: 69bb ldr r3, [r7, #24]
|
|
80061c8: f003 0345 and.w r3, r3, #69 @ 0x45
|
|
80061cc: 2b00 cmp r3, #0
|
|
80061ce: d0ef beq.n 80061b0 <SDMMC_GetCmdResp6+0x24>
|
|
((sta_reg & SDIO_FLAG_CMDACT) != 0U ));
|
|
80061d0: 69bb ldr r3, [r7, #24]
|
|
80061d2: f403 6300 and.w r3, r3, #2048 @ 0x800
|
|
}while(((sta_reg & (SDIO_FLAG_CCRCFAIL | SDIO_FLAG_CMDREND | SDIO_FLAG_CTIMEOUT)) == 0U) ||
|
|
80061d6: 2b00 cmp r3, #0
|
|
80061d8: d1ea bne.n 80061b0 <SDMMC_GetCmdResp6+0x24>
|
|
|
|
if(__SDIO_GET_FLAG(SDIOx, SDIO_FLAG_CTIMEOUT))
|
|
80061da: 68fb ldr r3, [r7, #12]
|
|
80061dc: 6b5b ldr r3, [r3, #52] @ 0x34
|
|
80061de: f003 0304 and.w r3, r3, #4
|
|
80061e2: 2b00 cmp r3, #0
|
|
80061e4: d004 beq.n 80061f0 <SDMMC_GetCmdResp6+0x64>
|
|
{
|
|
__SDIO_CLEAR_FLAG(SDIOx, SDIO_FLAG_CTIMEOUT);
|
|
80061e6: 68fb ldr r3, [r7, #12]
|
|
80061e8: 2204 movs r2, #4
|
|
80061ea: 639a str r2, [r3, #56] @ 0x38
|
|
|
|
return SDMMC_ERROR_CMD_RSP_TIMEOUT;
|
|
80061ec: 2304 movs r3, #4
|
|
80061ee: e03a b.n 8006266 <SDMMC_GetCmdResp6+0xda>
|
|
}
|
|
else if(__SDIO_GET_FLAG(SDIOx, SDIO_FLAG_CCRCFAIL))
|
|
80061f0: 68fb ldr r3, [r7, #12]
|
|
80061f2: 6b5b ldr r3, [r3, #52] @ 0x34
|
|
80061f4: f003 0301 and.w r3, r3, #1
|
|
80061f8: 2b00 cmp r3, #0
|
|
80061fa: d004 beq.n 8006206 <SDMMC_GetCmdResp6+0x7a>
|
|
{
|
|
__SDIO_CLEAR_FLAG(SDIOx, SDIO_FLAG_CCRCFAIL);
|
|
80061fc: 68fb ldr r3, [r7, #12]
|
|
80061fe: 2201 movs r2, #1
|
|
8006200: 639a str r2, [r3, #56] @ 0x38
|
|
|
|
return SDMMC_ERROR_CMD_CRC_FAIL;
|
|
8006202: 2301 movs r3, #1
|
|
8006204: e02f b.n 8006266 <SDMMC_GetCmdResp6+0xda>
|
|
{
|
|
/* Nothing to do */
|
|
}
|
|
|
|
/* Check response received is of desired command */
|
|
if(SDIO_GetCommandResponse(SDIOx) != SD_CMD)
|
|
8006206: 68f8 ldr r0, [r7, #12]
|
|
8006208: f7ff fbd0 bl 80059ac <SDIO_GetCommandResponse>
|
|
800620c: 4603 mov r3, r0
|
|
800620e: 461a mov r2, r3
|
|
8006210: 7afb ldrb r3, [r7, #11]
|
|
8006212: 4293 cmp r3, r2
|
|
8006214: d001 beq.n 800621a <SDMMC_GetCmdResp6+0x8e>
|
|
{
|
|
return SDMMC_ERROR_CMD_CRC_FAIL;
|
|
8006216: 2301 movs r3, #1
|
|
8006218: e025 b.n 8006266 <SDMMC_GetCmdResp6+0xda>
|
|
}
|
|
|
|
/* Clear all the static flags */
|
|
__SDIO_CLEAR_FLAG(SDIOx, SDIO_STATIC_CMD_FLAGS);
|
|
800621a: 68fb ldr r3, [r7, #12]
|
|
800621c: 22c5 movs r2, #197 @ 0xc5
|
|
800621e: 639a str r2, [r3, #56] @ 0x38
|
|
|
|
/* We have received response, retrieve it. */
|
|
response_r1 = SDIO_GetResponse(SDIOx, SDIO_RESP1);
|
|
8006220: 2100 movs r1, #0
|
|
8006222: 68f8 ldr r0, [r7, #12]
|
|
8006224: f7ff fbd0 bl 80059c8 <SDIO_GetResponse>
|
|
8006228: 6178 str r0, [r7, #20]
|
|
|
|
if((response_r1 & (SDMMC_R6_GENERAL_UNKNOWN_ERROR | SDMMC_R6_ILLEGAL_CMD | SDMMC_R6_COM_CRC_FAILED)) == SDMMC_ALLZERO)
|
|
800622a: 697b ldr r3, [r7, #20]
|
|
800622c: f403 4360 and.w r3, r3, #57344 @ 0xe000
|
|
8006230: 2b00 cmp r3, #0
|
|
8006232: d106 bne.n 8006242 <SDMMC_GetCmdResp6+0xb6>
|
|
{
|
|
*pRCA = (uint16_t) (response_r1 >> 16);
|
|
8006234: 697b ldr r3, [r7, #20]
|
|
8006236: 0c1b lsrs r3, r3, #16
|
|
8006238: b29a uxth r2, r3
|
|
800623a: 687b ldr r3, [r7, #4]
|
|
800623c: 801a strh r2, [r3, #0]
|
|
|
|
return SDMMC_ERROR_NONE;
|
|
800623e: 2300 movs r3, #0
|
|
8006240: e011 b.n 8006266 <SDMMC_GetCmdResp6+0xda>
|
|
}
|
|
else if((response_r1 & SDMMC_R6_ILLEGAL_CMD) == SDMMC_R6_ILLEGAL_CMD)
|
|
8006242: 697b ldr r3, [r7, #20]
|
|
8006244: f403 4380 and.w r3, r3, #16384 @ 0x4000
|
|
8006248: 2b00 cmp r3, #0
|
|
800624a: d002 beq.n 8006252 <SDMMC_GetCmdResp6+0xc6>
|
|
{
|
|
return SDMMC_ERROR_ILLEGAL_CMD;
|
|
800624c: f44f 5300 mov.w r3, #8192 @ 0x2000
|
|
8006250: e009 b.n 8006266 <SDMMC_GetCmdResp6+0xda>
|
|
}
|
|
else if((response_r1 & SDMMC_R6_COM_CRC_FAILED) == SDMMC_R6_COM_CRC_FAILED)
|
|
8006252: 697b ldr r3, [r7, #20]
|
|
8006254: f403 4300 and.w r3, r3, #32768 @ 0x8000
|
|
8006258: 2b00 cmp r3, #0
|
|
800625a: d002 beq.n 8006262 <SDMMC_GetCmdResp6+0xd6>
|
|
{
|
|
return SDMMC_ERROR_COM_CRC_FAILED;
|
|
800625c: f44f 5380 mov.w r3, #4096 @ 0x1000
|
|
8006260: e001 b.n 8006266 <SDMMC_GetCmdResp6+0xda>
|
|
}
|
|
else
|
|
{
|
|
return SDMMC_ERROR_GENERAL_UNKNOWN_ERR;
|
|
8006262: f44f 3380 mov.w r3, #65536 @ 0x10000
|
|
}
|
|
}
|
|
8006266: 4618 mov r0, r3
|
|
8006268: 3720 adds r7, #32
|
|
800626a: 46bd mov sp, r7
|
|
800626c: bd80 pop {r7, pc}
|
|
800626e: bf00 nop
|
|
8006270: 20000018 .word 0x20000018
|
|
8006274: 10624dd3 .word 0x10624dd3
|
|
|
|
08006278 <SDMMC_GetCmdResp7>:
|
|
* @brief Checks for error conditions for R7 response.
|
|
* @param SDIOx Pointer to SDMMC register base
|
|
* @retval SD Card error state
|
|
*/
|
|
uint32_t SDMMC_GetCmdResp7(SDIO_TypeDef *SDIOx)
|
|
{
|
|
8006278: b480 push {r7}
|
|
800627a: b085 sub sp, #20
|
|
800627c: af00 add r7, sp, #0
|
|
800627e: 6078 str r0, [r7, #4]
|
|
uint32_t sta_reg;
|
|
/* 8 is the number of required instructions cycles for the below loop statement.
|
|
The SDIO_CMDTIMEOUT is expressed in ms */
|
|
uint32_t count = SDIO_CMDTIMEOUT * (SystemCoreClock / 8U /1000U);
|
|
8006280: 4b22 ldr r3, [pc, #136] @ (800630c <SDMMC_GetCmdResp7+0x94>)
|
|
8006282: 681b ldr r3, [r3, #0]
|
|
8006284: 4a22 ldr r2, [pc, #136] @ (8006310 <SDMMC_GetCmdResp7+0x98>)
|
|
8006286: fba2 2303 umull r2, r3, r2, r3
|
|
800628a: 0a5b lsrs r3, r3, #9
|
|
800628c: f241 3288 movw r2, #5000 @ 0x1388
|
|
8006290: fb02 f303 mul.w r3, r2, r3
|
|
8006294: 60fb str r3, [r7, #12]
|
|
|
|
do
|
|
{
|
|
if (count-- == 0U)
|
|
8006296: 68fb ldr r3, [r7, #12]
|
|
8006298: 1e5a subs r2, r3, #1
|
|
800629a: 60fa str r2, [r7, #12]
|
|
800629c: 2b00 cmp r3, #0
|
|
800629e: d102 bne.n 80062a6 <SDMMC_GetCmdResp7+0x2e>
|
|
{
|
|
return SDMMC_ERROR_TIMEOUT;
|
|
80062a0: f04f 4300 mov.w r3, #2147483648 @ 0x80000000
|
|
80062a4: e02c b.n 8006300 <SDMMC_GetCmdResp7+0x88>
|
|
}
|
|
sta_reg = SDIOx->STA;
|
|
80062a6: 687b ldr r3, [r7, #4]
|
|
80062a8: 6b5b ldr r3, [r3, #52] @ 0x34
|
|
80062aa: 60bb str r3, [r7, #8]
|
|
}while(((sta_reg & (SDIO_FLAG_CCRCFAIL | SDIO_FLAG_CMDREND | SDIO_FLAG_CTIMEOUT)) == 0U) ||
|
|
80062ac: 68bb ldr r3, [r7, #8]
|
|
80062ae: f003 0345 and.w r3, r3, #69 @ 0x45
|
|
80062b2: 2b00 cmp r3, #0
|
|
80062b4: d0ef beq.n 8006296 <SDMMC_GetCmdResp7+0x1e>
|
|
((sta_reg & SDIO_FLAG_CMDACT) != 0U ));
|
|
80062b6: 68bb ldr r3, [r7, #8]
|
|
80062b8: f403 6300 and.w r3, r3, #2048 @ 0x800
|
|
}while(((sta_reg & (SDIO_FLAG_CCRCFAIL | SDIO_FLAG_CMDREND | SDIO_FLAG_CTIMEOUT)) == 0U) ||
|
|
80062bc: 2b00 cmp r3, #0
|
|
80062be: d1ea bne.n 8006296 <SDMMC_GetCmdResp7+0x1e>
|
|
|
|
if(__SDIO_GET_FLAG(SDIOx, SDIO_FLAG_CTIMEOUT))
|
|
80062c0: 687b ldr r3, [r7, #4]
|
|
80062c2: 6b5b ldr r3, [r3, #52] @ 0x34
|
|
80062c4: f003 0304 and.w r3, r3, #4
|
|
80062c8: 2b00 cmp r3, #0
|
|
80062ca: d004 beq.n 80062d6 <SDMMC_GetCmdResp7+0x5e>
|
|
{
|
|
/* Card is SD V2.0 compliant */
|
|
__SDIO_CLEAR_FLAG(SDIOx, SDIO_FLAG_CTIMEOUT);
|
|
80062cc: 687b ldr r3, [r7, #4]
|
|
80062ce: 2204 movs r2, #4
|
|
80062d0: 639a str r2, [r3, #56] @ 0x38
|
|
|
|
return SDMMC_ERROR_CMD_RSP_TIMEOUT;
|
|
80062d2: 2304 movs r3, #4
|
|
80062d4: e014 b.n 8006300 <SDMMC_GetCmdResp7+0x88>
|
|
}
|
|
else if(__SDIO_GET_FLAG(SDIOx, SDIO_FLAG_CCRCFAIL))
|
|
80062d6: 687b ldr r3, [r7, #4]
|
|
80062d8: 6b5b ldr r3, [r3, #52] @ 0x34
|
|
80062da: f003 0301 and.w r3, r3, #1
|
|
80062de: 2b00 cmp r3, #0
|
|
80062e0: d004 beq.n 80062ec <SDMMC_GetCmdResp7+0x74>
|
|
{
|
|
/* Card is SD V2.0 compliant */
|
|
__SDIO_CLEAR_FLAG(SDIOx, SDIO_FLAG_CCRCFAIL);
|
|
80062e2: 687b ldr r3, [r7, #4]
|
|
80062e4: 2201 movs r2, #1
|
|
80062e6: 639a str r2, [r3, #56] @ 0x38
|
|
|
|
return SDMMC_ERROR_CMD_CRC_FAIL;
|
|
80062e8: 2301 movs r3, #1
|
|
80062ea: e009 b.n 8006300 <SDMMC_GetCmdResp7+0x88>
|
|
else
|
|
{
|
|
/* Nothing to do */
|
|
}
|
|
|
|
if(__SDIO_GET_FLAG(SDIOx, SDIO_FLAG_CMDREND))
|
|
80062ec: 687b ldr r3, [r7, #4]
|
|
80062ee: 6b5b ldr r3, [r3, #52] @ 0x34
|
|
80062f0: f003 0340 and.w r3, r3, #64 @ 0x40
|
|
80062f4: 2b00 cmp r3, #0
|
|
80062f6: d002 beq.n 80062fe <SDMMC_GetCmdResp7+0x86>
|
|
{
|
|
/* Card is SD V2.0 compliant */
|
|
__SDIO_CLEAR_FLAG(SDIOx, SDIO_FLAG_CMDREND);
|
|
80062f8: 687b ldr r3, [r7, #4]
|
|
80062fa: 2240 movs r2, #64 @ 0x40
|
|
80062fc: 639a str r2, [r3, #56] @ 0x38
|
|
}
|
|
|
|
return SDMMC_ERROR_NONE;
|
|
80062fe: 2300 movs r3, #0
|
|
|
|
}
|
|
8006300: 4618 mov r0, r3
|
|
8006302: 3714 adds r7, #20
|
|
8006304: 46bd mov sp, r7
|
|
8006306: f85d 7b04 ldr.w r7, [sp], #4
|
|
800630a: 4770 bx lr
|
|
800630c: 20000018 .word 0x20000018
|
|
8006310: 10624dd3 .word 0x10624dd3
|
|
|
|
08006314 <SDMMC_GetCmdError>:
|
|
* @brief Checks for error conditions for CMD0.
|
|
* @param SDIOx Pointer to SDMMC register base
|
|
* @retval SD Card error state
|
|
*/
|
|
static uint32_t SDMMC_GetCmdError(SDIO_TypeDef *SDIOx)
|
|
{
|
|
8006314: b480 push {r7}
|
|
8006316: b085 sub sp, #20
|
|
8006318: af00 add r7, sp, #0
|
|
800631a: 6078 str r0, [r7, #4]
|
|
/* 8 is the number of required instructions cycles for the below loop statement.
|
|
The SDIO_CMDTIMEOUT is expressed in ms */
|
|
uint32_t count = SDIO_CMDTIMEOUT * (SystemCoreClock / 8U /1000U);
|
|
800631c: 4b11 ldr r3, [pc, #68] @ (8006364 <SDMMC_GetCmdError+0x50>)
|
|
800631e: 681b ldr r3, [r3, #0]
|
|
8006320: 4a11 ldr r2, [pc, #68] @ (8006368 <SDMMC_GetCmdError+0x54>)
|
|
8006322: fba2 2303 umull r2, r3, r2, r3
|
|
8006326: 0a5b lsrs r3, r3, #9
|
|
8006328: f241 3288 movw r2, #5000 @ 0x1388
|
|
800632c: fb02 f303 mul.w r3, r2, r3
|
|
8006330: 60fb str r3, [r7, #12]
|
|
|
|
do
|
|
{
|
|
if (count-- == 0U)
|
|
8006332: 68fb ldr r3, [r7, #12]
|
|
8006334: 1e5a subs r2, r3, #1
|
|
8006336: 60fa str r2, [r7, #12]
|
|
8006338: 2b00 cmp r3, #0
|
|
800633a: d102 bne.n 8006342 <SDMMC_GetCmdError+0x2e>
|
|
{
|
|
return SDMMC_ERROR_TIMEOUT;
|
|
800633c: f04f 4300 mov.w r3, #2147483648 @ 0x80000000
|
|
8006340: e009 b.n 8006356 <SDMMC_GetCmdError+0x42>
|
|
}
|
|
|
|
}while(!__SDIO_GET_FLAG(SDIOx, SDIO_FLAG_CMDSENT));
|
|
8006342: 687b ldr r3, [r7, #4]
|
|
8006344: 6b5b ldr r3, [r3, #52] @ 0x34
|
|
8006346: f003 0380 and.w r3, r3, #128 @ 0x80
|
|
800634a: 2b00 cmp r3, #0
|
|
800634c: d0f1 beq.n 8006332 <SDMMC_GetCmdError+0x1e>
|
|
|
|
/* Clear all the static flags */
|
|
__SDIO_CLEAR_FLAG(SDIOx, SDIO_STATIC_CMD_FLAGS);
|
|
800634e: 687b ldr r3, [r7, #4]
|
|
8006350: 22c5 movs r2, #197 @ 0xc5
|
|
8006352: 639a str r2, [r3, #56] @ 0x38
|
|
|
|
return SDMMC_ERROR_NONE;
|
|
8006354: 2300 movs r3, #0
|
|
}
|
|
8006356: 4618 mov r0, r3
|
|
8006358: 3714 adds r7, #20
|
|
800635a: 46bd mov sp, r7
|
|
800635c: f85d 7b04 ldr.w r7, [sp], #4
|
|
8006360: 4770 bx lr
|
|
8006362: bf00 nop
|
|
8006364: 20000018 .word 0x20000018
|
|
8006368: 10624dd3 .word 0x10624dd3
|
|
|
|
0800636c <__NVIC_SetPriority>:
|
|
{
|
|
800636c: b480 push {r7}
|
|
800636e: b083 sub sp, #12
|
|
8006370: af00 add r7, sp, #0
|
|
8006372: 4603 mov r3, r0
|
|
8006374: 6039 str r1, [r7, #0]
|
|
8006376: 71fb strb r3, [r7, #7]
|
|
if ((int32_t)(IRQn) >= 0)
|
|
8006378: f997 3007 ldrsb.w r3, [r7, #7]
|
|
800637c: 2b00 cmp r3, #0
|
|
800637e: db0a blt.n 8006396 <__NVIC_SetPriority+0x2a>
|
|
NVIC->IP[((uint32_t)IRQn)] = (uint8_t)((priority << (8U - __NVIC_PRIO_BITS)) & (uint32_t)0xFFUL);
|
|
8006380: 683b ldr r3, [r7, #0]
|
|
8006382: b2da uxtb r2, r3
|
|
8006384: 490c ldr r1, [pc, #48] @ (80063b8 <__NVIC_SetPriority+0x4c>)
|
|
8006386: f997 3007 ldrsb.w r3, [r7, #7]
|
|
800638a: 0112 lsls r2, r2, #4
|
|
800638c: b2d2 uxtb r2, r2
|
|
800638e: 440b add r3, r1
|
|
8006390: f883 2300 strb.w r2, [r3, #768] @ 0x300
|
|
}
|
|
8006394: e00a b.n 80063ac <__NVIC_SetPriority+0x40>
|
|
SCB->SHP[(((uint32_t)IRQn) & 0xFUL)-4UL] = (uint8_t)((priority << (8U - __NVIC_PRIO_BITS)) & (uint32_t)0xFFUL);
|
|
8006396: 683b ldr r3, [r7, #0]
|
|
8006398: b2da uxtb r2, r3
|
|
800639a: 4908 ldr r1, [pc, #32] @ (80063bc <__NVIC_SetPriority+0x50>)
|
|
800639c: 79fb ldrb r3, [r7, #7]
|
|
800639e: f003 030f and.w r3, r3, #15
|
|
80063a2: 3b04 subs r3, #4
|
|
80063a4: 0112 lsls r2, r2, #4
|
|
80063a6: b2d2 uxtb r2, r2
|
|
80063a8: 440b add r3, r1
|
|
80063aa: 761a strb r2, [r3, #24]
|
|
}
|
|
80063ac: bf00 nop
|
|
80063ae: 370c adds r7, #12
|
|
80063b0: 46bd mov sp, r7
|
|
80063b2: f85d 7b04 ldr.w r7, [sp], #4
|
|
80063b6: 4770 bx lr
|
|
80063b8: e000e100 .word 0xe000e100
|
|
80063bc: e000ed00 .word 0xe000ed00
|
|
|
|
080063c0 <SysTick_Handler>:
|
|
|
|
/*
|
|
SysTick handler implementation that also clears overflow flag.
|
|
*/
|
|
#if (USE_CUSTOM_SYSTICK_HANDLER_IMPLEMENTATION == 0)
|
|
void SysTick_Handler (void) {
|
|
80063c0: b580 push {r7, lr}
|
|
80063c2: af00 add r7, sp, #0
|
|
/* Clear overflow flag */
|
|
SysTick->CTRL;
|
|
80063c4: 4b05 ldr r3, [pc, #20] @ (80063dc <SysTick_Handler+0x1c>)
|
|
80063c6: 681b ldr r3, [r3, #0]
|
|
|
|
if (xTaskGetSchedulerState() != taskSCHEDULER_NOT_STARTED) {
|
|
80063c8: f002 fb38 bl 8008a3c <xTaskGetSchedulerState>
|
|
80063cc: 4603 mov r3, r0
|
|
80063ce: 2b01 cmp r3, #1
|
|
80063d0: d001 beq.n 80063d6 <SysTick_Handler+0x16>
|
|
/* Call tick handler */
|
|
xPortSysTickHandler();
|
|
80063d2: f003 faf1 bl 80099b8 <xPortSysTickHandler>
|
|
}
|
|
}
|
|
80063d6: bf00 nop
|
|
80063d8: bd80 pop {r7, pc}
|
|
80063da: bf00 nop
|
|
80063dc: e000e010 .word 0xe000e010
|
|
|
|
080063e0 <SVC_Setup>:
|
|
#endif /* SysTick */
|
|
|
|
/*
|
|
Setup SVC to reset value.
|
|
*/
|
|
__STATIC_INLINE void SVC_Setup (void) {
|
|
80063e0: b580 push {r7, lr}
|
|
80063e2: af00 add r7, sp, #0
|
|
#if (__ARM_ARCH_7A__ == 0U)
|
|
/* Service Call interrupt might be configured before kernel start */
|
|
/* and when its priority is lower or equal to BASEPRI, svc intruction */
|
|
/* causes a Hard Fault. */
|
|
NVIC_SetPriority (SVCall_IRQ_NBR, 0U);
|
|
80063e4: 2100 movs r1, #0
|
|
80063e6: f06f 0004 mvn.w r0, #4
|
|
80063ea: f7ff ffbf bl 800636c <__NVIC_SetPriority>
|
|
#endif
|
|
}
|
|
80063ee: bf00 nop
|
|
80063f0: bd80 pop {r7, pc}
|
|
...
|
|
|
|
080063f4 <osKernelInitialize>:
|
|
static uint32_t OS_Tick_GetOverflow (void);
|
|
/* Get OS Tick interval */
|
|
static uint32_t OS_Tick_GetInterval (void);
|
|
/*---------------------------------------------------------------------------*/
|
|
|
|
osStatus_t osKernelInitialize (void) {
|
|
80063f4: b480 push {r7}
|
|
80063f6: b083 sub sp, #12
|
|
80063f8: af00 add r7, sp, #0
|
|
*/
|
|
__STATIC_FORCEINLINE uint32_t __get_IPSR(void)
|
|
{
|
|
uint32_t result;
|
|
|
|
__ASM volatile ("MRS %0, ipsr" : "=r" (result) );
|
|
80063fa: f3ef 8305 mrs r3, IPSR
|
|
80063fe: 603b str r3, [r7, #0]
|
|
return(result);
|
|
8006400: 683b ldr r3, [r7, #0]
|
|
osStatus_t stat;
|
|
|
|
if (IS_IRQ()) {
|
|
8006402: 2b00 cmp r3, #0
|
|
8006404: d003 beq.n 800640e <osKernelInitialize+0x1a>
|
|
stat = osErrorISR;
|
|
8006406: f06f 0305 mvn.w r3, #5
|
|
800640a: 607b str r3, [r7, #4]
|
|
800640c: e00c b.n 8006428 <osKernelInitialize+0x34>
|
|
}
|
|
else {
|
|
if (KernelState == osKernelInactive) {
|
|
800640e: 4b0a ldr r3, [pc, #40] @ (8006438 <osKernelInitialize+0x44>)
|
|
8006410: 681b ldr r3, [r3, #0]
|
|
8006412: 2b00 cmp r3, #0
|
|
8006414: d105 bne.n 8006422 <osKernelInitialize+0x2e>
|
|
EvrFreeRTOSSetup(0U);
|
|
#endif
|
|
#if defined(USE_FreeRTOS_HEAP_5) && (HEAP_5_REGION_SETUP == 1)
|
|
vPortDefineHeapRegions (configHEAP_5_REGIONS);
|
|
#endif
|
|
KernelState = osKernelReady;
|
|
8006416: 4b08 ldr r3, [pc, #32] @ (8006438 <osKernelInitialize+0x44>)
|
|
8006418: 2201 movs r2, #1
|
|
800641a: 601a str r2, [r3, #0]
|
|
stat = osOK;
|
|
800641c: 2300 movs r3, #0
|
|
800641e: 607b str r3, [r7, #4]
|
|
8006420: e002 b.n 8006428 <osKernelInitialize+0x34>
|
|
} else {
|
|
stat = osError;
|
|
8006422: f04f 33ff mov.w r3, #4294967295 @ 0xffffffff
|
|
8006426: 607b str r3, [r7, #4]
|
|
}
|
|
}
|
|
|
|
return (stat);
|
|
8006428: 687b ldr r3, [r7, #4]
|
|
}
|
|
800642a: 4618 mov r0, r3
|
|
800642c: 370c adds r7, #12
|
|
800642e: 46bd mov sp, r7
|
|
8006430: f85d 7b04 ldr.w r7, [sp], #4
|
|
8006434: 4770 bx lr
|
|
8006436: bf00 nop
|
|
8006438: 2000032c .word 0x2000032c
|
|
|
|
0800643c <osKernelStart>:
|
|
}
|
|
|
|
return (state);
|
|
}
|
|
|
|
osStatus_t osKernelStart (void) {
|
|
800643c: b580 push {r7, lr}
|
|
800643e: b082 sub sp, #8
|
|
8006440: af00 add r7, sp, #0
|
|
__ASM volatile ("MRS %0, ipsr" : "=r" (result) );
|
|
8006442: f3ef 8305 mrs r3, IPSR
|
|
8006446: 603b str r3, [r7, #0]
|
|
return(result);
|
|
8006448: 683b ldr r3, [r7, #0]
|
|
osStatus_t stat;
|
|
|
|
if (IS_IRQ()) {
|
|
800644a: 2b00 cmp r3, #0
|
|
800644c: d003 beq.n 8006456 <osKernelStart+0x1a>
|
|
stat = osErrorISR;
|
|
800644e: f06f 0305 mvn.w r3, #5
|
|
8006452: 607b str r3, [r7, #4]
|
|
8006454: e010 b.n 8006478 <osKernelStart+0x3c>
|
|
}
|
|
else {
|
|
if (KernelState == osKernelReady) {
|
|
8006456: 4b0b ldr r3, [pc, #44] @ (8006484 <osKernelStart+0x48>)
|
|
8006458: 681b ldr r3, [r3, #0]
|
|
800645a: 2b01 cmp r3, #1
|
|
800645c: d109 bne.n 8006472 <osKernelStart+0x36>
|
|
/* Ensure SVC priority is at the reset value */
|
|
SVC_Setup();
|
|
800645e: f7ff ffbf bl 80063e0 <SVC_Setup>
|
|
/* Change state to enable IRQ masking check */
|
|
KernelState = osKernelRunning;
|
|
8006462: 4b08 ldr r3, [pc, #32] @ (8006484 <osKernelStart+0x48>)
|
|
8006464: 2202 movs r2, #2
|
|
8006466: 601a str r2, [r3, #0]
|
|
/* Start the kernel scheduler */
|
|
vTaskStartScheduler();
|
|
8006468: f001 fe84 bl 8008174 <vTaskStartScheduler>
|
|
stat = osOK;
|
|
800646c: 2300 movs r3, #0
|
|
800646e: 607b str r3, [r7, #4]
|
|
8006470: e002 b.n 8006478 <osKernelStart+0x3c>
|
|
} else {
|
|
stat = osError;
|
|
8006472: f04f 33ff mov.w r3, #4294967295 @ 0xffffffff
|
|
8006476: 607b str r3, [r7, #4]
|
|
}
|
|
}
|
|
|
|
return (stat);
|
|
8006478: 687b ldr r3, [r7, #4]
|
|
}
|
|
800647a: 4618 mov r0, r3
|
|
800647c: 3708 adds r7, #8
|
|
800647e: 46bd mov sp, r7
|
|
8006480: bd80 pop {r7, pc}
|
|
8006482: bf00 nop
|
|
8006484: 2000032c .word 0x2000032c
|
|
|
|
08006488 <osThreadNew>:
|
|
return (configCPU_CLOCK_HZ);
|
|
}
|
|
|
|
/*---------------------------------------------------------------------------*/
|
|
|
|
osThreadId_t osThreadNew (osThreadFunc_t func, void *argument, const osThreadAttr_t *attr) {
|
|
8006488: b580 push {r7, lr}
|
|
800648a: b08e sub sp, #56 @ 0x38
|
|
800648c: af04 add r7, sp, #16
|
|
800648e: 60f8 str r0, [r7, #12]
|
|
8006490: 60b9 str r1, [r7, #8]
|
|
8006492: 607a str r2, [r7, #4]
|
|
uint32_t stack;
|
|
TaskHandle_t hTask;
|
|
UBaseType_t prio;
|
|
int32_t mem;
|
|
|
|
hTask = NULL;
|
|
8006494: 2300 movs r3, #0
|
|
8006496: 613b str r3, [r7, #16]
|
|
__ASM volatile ("MRS %0, ipsr" : "=r" (result) );
|
|
8006498: f3ef 8305 mrs r3, IPSR
|
|
800649c: 617b str r3, [r7, #20]
|
|
return(result);
|
|
800649e: 697b ldr r3, [r7, #20]
|
|
|
|
if (!IS_IRQ() && (func != NULL)) {
|
|
80064a0: 2b00 cmp r3, #0
|
|
80064a2: d17e bne.n 80065a2 <osThreadNew+0x11a>
|
|
80064a4: 68fb ldr r3, [r7, #12]
|
|
80064a6: 2b00 cmp r3, #0
|
|
80064a8: d07b beq.n 80065a2 <osThreadNew+0x11a>
|
|
stack = configMINIMAL_STACK_SIZE;
|
|
80064aa: 2380 movs r3, #128 @ 0x80
|
|
80064ac: 623b str r3, [r7, #32]
|
|
prio = (UBaseType_t)osPriorityNormal;
|
|
80064ae: 2318 movs r3, #24
|
|
80064b0: 61fb str r3, [r7, #28]
|
|
|
|
name = NULL;
|
|
80064b2: 2300 movs r3, #0
|
|
80064b4: 627b str r3, [r7, #36] @ 0x24
|
|
mem = -1;
|
|
80064b6: f04f 33ff mov.w r3, #4294967295 @ 0xffffffff
|
|
80064ba: 61bb str r3, [r7, #24]
|
|
|
|
if (attr != NULL) {
|
|
80064bc: 687b ldr r3, [r7, #4]
|
|
80064be: 2b00 cmp r3, #0
|
|
80064c0: d045 beq.n 800654e <osThreadNew+0xc6>
|
|
if (attr->name != NULL) {
|
|
80064c2: 687b ldr r3, [r7, #4]
|
|
80064c4: 681b ldr r3, [r3, #0]
|
|
80064c6: 2b00 cmp r3, #0
|
|
80064c8: d002 beq.n 80064d0 <osThreadNew+0x48>
|
|
name = attr->name;
|
|
80064ca: 687b ldr r3, [r7, #4]
|
|
80064cc: 681b ldr r3, [r3, #0]
|
|
80064ce: 627b str r3, [r7, #36] @ 0x24
|
|
}
|
|
if (attr->priority != osPriorityNone) {
|
|
80064d0: 687b ldr r3, [r7, #4]
|
|
80064d2: 699b ldr r3, [r3, #24]
|
|
80064d4: 2b00 cmp r3, #0
|
|
80064d6: d002 beq.n 80064de <osThreadNew+0x56>
|
|
prio = (UBaseType_t)attr->priority;
|
|
80064d8: 687b ldr r3, [r7, #4]
|
|
80064da: 699b ldr r3, [r3, #24]
|
|
80064dc: 61fb str r3, [r7, #28]
|
|
}
|
|
|
|
if ((prio < osPriorityIdle) || (prio > osPriorityISR) || ((attr->attr_bits & osThreadJoinable) == osThreadJoinable)) {
|
|
80064de: 69fb ldr r3, [r7, #28]
|
|
80064e0: 2b00 cmp r3, #0
|
|
80064e2: d008 beq.n 80064f6 <osThreadNew+0x6e>
|
|
80064e4: 69fb ldr r3, [r7, #28]
|
|
80064e6: 2b38 cmp r3, #56 @ 0x38
|
|
80064e8: d805 bhi.n 80064f6 <osThreadNew+0x6e>
|
|
80064ea: 687b ldr r3, [r7, #4]
|
|
80064ec: 685b ldr r3, [r3, #4]
|
|
80064ee: f003 0301 and.w r3, r3, #1
|
|
80064f2: 2b00 cmp r3, #0
|
|
80064f4: d001 beq.n 80064fa <osThreadNew+0x72>
|
|
return (NULL);
|
|
80064f6: 2300 movs r3, #0
|
|
80064f8: e054 b.n 80065a4 <osThreadNew+0x11c>
|
|
}
|
|
|
|
if (attr->stack_size > 0U) {
|
|
80064fa: 687b ldr r3, [r7, #4]
|
|
80064fc: 695b ldr r3, [r3, #20]
|
|
80064fe: 2b00 cmp r3, #0
|
|
8006500: d003 beq.n 800650a <osThreadNew+0x82>
|
|
/* In FreeRTOS stack is not in bytes, but in sizeof(StackType_t) which is 4 on ARM ports. */
|
|
/* Stack size should be therefore 4 byte aligned in order to avoid division caused side effects */
|
|
stack = attr->stack_size / sizeof(StackType_t);
|
|
8006502: 687b ldr r3, [r7, #4]
|
|
8006504: 695b ldr r3, [r3, #20]
|
|
8006506: 089b lsrs r3, r3, #2
|
|
8006508: 623b str r3, [r7, #32]
|
|
}
|
|
|
|
if ((attr->cb_mem != NULL) && (attr->cb_size >= sizeof(StaticTask_t)) &&
|
|
800650a: 687b ldr r3, [r7, #4]
|
|
800650c: 689b ldr r3, [r3, #8]
|
|
800650e: 2b00 cmp r3, #0
|
|
8006510: d00e beq.n 8006530 <osThreadNew+0xa8>
|
|
8006512: 687b ldr r3, [r7, #4]
|
|
8006514: 68db ldr r3, [r3, #12]
|
|
8006516: 2ba7 cmp r3, #167 @ 0xa7
|
|
8006518: d90a bls.n 8006530 <osThreadNew+0xa8>
|
|
(attr->stack_mem != NULL) && (attr->stack_size > 0U)) {
|
|
800651a: 687b ldr r3, [r7, #4]
|
|
800651c: 691b ldr r3, [r3, #16]
|
|
if ((attr->cb_mem != NULL) && (attr->cb_size >= sizeof(StaticTask_t)) &&
|
|
800651e: 2b00 cmp r3, #0
|
|
8006520: d006 beq.n 8006530 <osThreadNew+0xa8>
|
|
(attr->stack_mem != NULL) && (attr->stack_size > 0U)) {
|
|
8006522: 687b ldr r3, [r7, #4]
|
|
8006524: 695b ldr r3, [r3, #20]
|
|
8006526: 2b00 cmp r3, #0
|
|
8006528: d002 beq.n 8006530 <osThreadNew+0xa8>
|
|
mem = 1;
|
|
800652a: 2301 movs r3, #1
|
|
800652c: 61bb str r3, [r7, #24]
|
|
800652e: e010 b.n 8006552 <osThreadNew+0xca>
|
|
}
|
|
else {
|
|
if ((attr->cb_mem == NULL) && (attr->cb_size == 0U) && (attr->stack_mem == NULL)) {
|
|
8006530: 687b ldr r3, [r7, #4]
|
|
8006532: 689b ldr r3, [r3, #8]
|
|
8006534: 2b00 cmp r3, #0
|
|
8006536: d10c bne.n 8006552 <osThreadNew+0xca>
|
|
8006538: 687b ldr r3, [r7, #4]
|
|
800653a: 68db ldr r3, [r3, #12]
|
|
800653c: 2b00 cmp r3, #0
|
|
800653e: d108 bne.n 8006552 <osThreadNew+0xca>
|
|
8006540: 687b ldr r3, [r7, #4]
|
|
8006542: 691b ldr r3, [r3, #16]
|
|
8006544: 2b00 cmp r3, #0
|
|
8006546: d104 bne.n 8006552 <osThreadNew+0xca>
|
|
mem = 0;
|
|
8006548: 2300 movs r3, #0
|
|
800654a: 61bb str r3, [r7, #24]
|
|
800654c: e001 b.n 8006552 <osThreadNew+0xca>
|
|
}
|
|
}
|
|
}
|
|
else {
|
|
mem = 0;
|
|
800654e: 2300 movs r3, #0
|
|
8006550: 61bb str r3, [r7, #24]
|
|
}
|
|
|
|
if (mem == 1) {
|
|
8006552: 69bb ldr r3, [r7, #24]
|
|
8006554: 2b01 cmp r3, #1
|
|
8006556: d110 bne.n 800657a <osThreadNew+0xf2>
|
|
#if (configSUPPORT_STATIC_ALLOCATION == 1)
|
|
hTask = xTaskCreateStatic ((TaskFunction_t)func, name, stack, argument, prio, (StackType_t *)attr->stack_mem,
|
|
8006558: 687b ldr r3, [r7, #4]
|
|
800655a: 691b ldr r3, [r3, #16]
|
|
(StaticTask_t *)attr->cb_mem);
|
|
800655c: 687a ldr r2, [r7, #4]
|
|
800655e: 6892 ldr r2, [r2, #8]
|
|
hTask = xTaskCreateStatic ((TaskFunction_t)func, name, stack, argument, prio, (StackType_t *)attr->stack_mem,
|
|
8006560: 9202 str r2, [sp, #8]
|
|
8006562: 9301 str r3, [sp, #4]
|
|
8006564: 69fb ldr r3, [r7, #28]
|
|
8006566: 9300 str r3, [sp, #0]
|
|
8006568: 68bb ldr r3, [r7, #8]
|
|
800656a: 6a3a ldr r2, [r7, #32]
|
|
800656c: 6a79 ldr r1, [r7, #36] @ 0x24
|
|
800656e: 68f8 ldr r0, [r7, #12]
|
|
8006570: f001 fc42 bl 8007df8 <xTaskCreateStatic>
|
|
8006574: 4603 mov r3, r0
|
|
8006576: 613b str r3, [r7, #16]
|
|
8006578: e013 b.n 80065a2 <osThreadNew+0x11a>
|
|
#endif
|
|
}
|
|
else {
|
|
if (mem == 0) {
|
|
800657a: 69bb ldr r3, [r7, #24]
|
|
800657c: 2b00 cmp r3, #0
|
|
800657e: d110 bne.n 80065a2 <osThreadNew+0x11a>
|
|
#if (configSUPPORT_DYNAMIC_ALLOCATION == 1)
|
|
if (xTaskCreate ((TaskFunction_t)func, name, (uint16_t)stack, argument, prio, &hTask) != pdPASS) {
|
|
8006580: 6a3b ldr r3, [r7, #32]
|
|
8006582: b29a uxth r2, r3
|
|
8006584: f107 0310 add.w r3, r7, #16
|
|
8006588: 9301 str r3, [sp, #4]
|
|
800658a: 69fb ldr r3, [r7, #28]
|
|
800658c: 9300 str r3, [sp, #0]
|
|
800658e: 68bb ldr r3, [r7, #8]
|
|
8006590: 6a79 ldr r1, [r7, #36] @ 0x24
|
|
8006592: 68f8 ldr r0, [r7, #12]
|
|
8006594: f001 fc90 bl 8007eb8 <xTaskCreate>
|
|
8006598: 4603 mov r3, r0
|
|
800659a: 2b01 cmp r3, #1
|
|
800659c: d001 beq.n 80065a2 <osThreadNew+0x11a>
|
|
hTask = NULL;
|
|
800659e: 2300 movs r3, #0
|
|
80065a0: 613b str r3, [r7, #16]
|
|
#endif
|
|
}
|
|
}
|
|
}
|
|
|
|
return ((osThreadId_t)hTask);
|
|
80065a2: 693b ldr r3, [r7, #16]
|
|
}
|
|
80065a4: 4618 mov r0, r3
|
|
80065a6: 3728 adds r7, #40 @ 0x28
|
|
80065a8: 46bd mov sp, r7
|
|
80065aa: bd80 pop {r7, pc}
|
|
|
|
080065ac <TimerCallback>:
|
|
}
|
|
|
|
/*---------------------------------------------------------------------------*/
|
|
#if (configUSE_OS2_TIMER == 1)
|
|
|
|
static void TimerCallback (TimerHandle_t hTimer) {
|
|
80065ac: b580 push {r7, lr}
|
|
80065ae: b084 sub sp, #16
|
|
80065b0: af00 add r7, sp, #0
|
|
80065b2: 6078 str r0, [r7, #4]
|
|
TimerCallback_t *callb;
|
|
|
|
callb = (TimerCallback_t *)pvTimerGetTimerID (hTimer);
|
|
80065b4: 6878 ldr r0, [r7, #4]
|
|
80065b6: f003 f81b bl 80095f0 <pvTimerGetTimerID>
|
|
80065ba: 60f8 str r0, [r7, #12]
|
|
|
|
if (callb != NULL) {
|
|
80065bc: 68fb ldr r3, [r7, #12]
|
|
80065be: 2b00 cmp r3, #0
|
|
80065c0: d005 beq.n 80065ce <TimerCallback+0x22>
|
|
callb->func (callb->arg);
|
|
80065c2: 68fb ldr r3, [r7, #12]
|
|
80065c4: 681b ldr r3, [r3, #0]
|
|
80065c6: 68fa ldr r2, [r7, #12]
|
|
80065c8: 6852 ldr r2, [r2, #4]
|
|
80065ca: 4610 mov r0, r2
|
|
80065cc: 4798 blx r3
|
|
}
|
|
}
|
|
80065ce: bf00 nop
|
|
80065d0: 3710 adds r7, #16
|
|
80065d2: 46bd mov sp, r7
|
|
80065d4: bd80 pop {r7, pc}
|
|
...
|
|
|
|
080065d8 <osTimerNew>:
|
|
|
|
osTimerId_t osTimerNew (osTimerFunc_t func, osTimerType_t type, void *argument, const osTimerAttr_t *attr) {
|
|
80065d8: b580 push {r7, lr}
|
|
80065da: b08c sub sp, #48 @ 0x30
|
|
80065dc: af02 add r7, sp, #8
|
|
80065de: 60f8 str r0, [r7, #12]
|
|
80065e0: 607a str r2, [r7, #4]
|
|
80065e2: 603b str r3, [r7, #0]
|
|
80065e4: 460b mov r3, r1
|
|
80065e6: 72fb strb r3, [r7, #11]
|
|
TimerHandle_t hTimer;
|
|
TimerCallback_t *callb;
|
|
UBaseType_t reload;
|
|
int32_t mem;
|
|
|
|
hTimer = NULL;
|
|
80065e8: 2300 movs r3, #0
|
|
80065ea: 623b str r3, [r7, #32]
|
|
__ASM volatile ("MRS %0, ipsr" : "=r" (result) );
|
|
80065ec: f3ef 8305 mrs r3, IPSR
|
|
80065f0: 613b str r3, [r7, #16]
|
|
return(result);
|
|
80065f2: 693b ldr r3, [r7, #16]
|
|
|
|
if (!IS_IRQ() && (func != NULL)) {
|
|
80065f4: 2b00 cmp r3, #0
|
|
80065f6: d163 bne.n 80066c0 <osTimerNew+0xe8>
|
|
80065f8: 68fb ldr r3, [r7, #12]
|
|
80065fa: 2b00 cmp r3, #0
|
|
80065fc: d060 beq.n 80066c0 <osTimerNew+0xe8>
|
|
/* Allocate memory to store callback function and argument */
|
|
callb = pvPortMalloc (sizeof(TimerCallback_t));
|
|
80065fe: 2008 movs r0, #8
|
|
8006600: f003 fa6c bl 8009adc <pvPortMalloc>
|
|
8006604: 6178 str r0, [r7, #20]
|
|
|
|
if (callb != NULL) {
|
|
8006606: 697b ldr r3, [r7, #20]
|
|
8006608: 2b00 cmp r3, #0
|
|
800660a: d059 beq.n 80066c0 <osTimerNew+0xe8>
|
|
callb->func = func;
|
|
800660c: 697b ldr r3, [r7, #20]
|
|
800660e: 68fa ldr r2, [r7, #12]
|
|
8006610: 601a str r2, [r3, #0]
|
|
callb->arg = argument;
|
|
8006612: 697b ldr r3, [r7, #20]
|
|
8006614: 687a ldr r2, [r7, #4]
|
|
8006616: 605a str r2, [r3, #4]
|
|
|
|
if (type == osTimerOnce) {
|
|
8006618: 7afb ldrb r3, [r7, #11]
|
|
800661a: 2b00 cmp r3, #0
|
|
800661c: d102 bne.n 8006624 <osTimerNew+0x4c>
|
|
reload = pdFALSE;
|
|
800661e: 2300 movs r3, #0
|
|
8006620: 61fb str r3, [r7, #28]
|
|
8006622: e001 b.n 8006628 <osTimerNew+0x50>
|
|
} else {
|
|
reload = pdTRUE;
|
|
8006624: 2301 movs r3, #1
|
|
8006626: 61fb str r3, [r7, #28]
|
|
}
|
|
|
|
mem = -1;
|
|
8006628: f04f 33ff mov.w r3, #4294967295 @ 0xffffffff
|
|
800662c: 61bb str r3, [r7, #24]
|
|
name = NULL;
|
|
800662e: 2300 movs r3, #0
|
|
8006630: 627b str r3, [r7, #36] @ 0x24
|
|
|
|
if (attr != NULL) {
|
|
8006632: 683b ldr r3, [r7, #0]
|
|
8006634: 2b00 cmp r3, #0
|
|
8006636: d01c beq.n 8006672 <osTimerNew+0x9a>
|
|
if (attr->name != NULL) {
|
|
8006638: 683b ldr r3, [r7, #0]
|
|
800663a: 681b ldr r3, [r3, #0]
|
|
800663c: 2b00 cmp r3, #0
|
|
800663e: d002 beq.n 8006646 <osTimerNew+0x6e>
|
|
name = attr->name;
|
|
8006640: 683b ldr r3, [r7, #0]
|
|
8006642: 681b ldr r3, [r3, #0]
|
|
8006644: 627b str r3, [r7, #36] @ 0x24
|
|
}
|
|
|
|
if ((attr->cb_mem != NULL) && (attr->cb_size >= sizeof(StaticTimer_t))) {
|
|
8006646: 683b ldr r3, [r7, #0]
|
|
8006648: 689b ldr r3, [r3, #8]
|
|
800664a: 2b00 cmp r3, #0
|
|
800664c: d006 beq.n 800665c <osTimerNew+0x84>
|
|
800664e: 683b ldr r3, [r7, #0]
|
|
8006650: 68db ldr r3, [r3, #12]
|
|
8006652: 2b2b cmp r3, #43 @ 0x2b
|
|
8006654: d902 bls.n 800665c <osTimerNew+0x84>
|
|
mem = 1;
|
|
8006656: 2301 movs r3, #1
|
|
8006658: 61bb str r3, [r7, #24]
|
|
800665a: e00c b.n 8006676 <osTimerNew+0x9e>
|
|
}
|
|
else {
|
|
if ((attr->cb_mem == NULL) && (attr->cb_size == 0U)) {
|
|
800665c: 683b ldr r3, [r7, #0]
|
|
800665e: 689b ldr r3, [r3, #8]
|
|
8006660: 2b00 cmp r3, #0
|
|
8006662: d108 bne.n 8006676 <osTimerNew+0x9e>
|
|
8006664: 683b ldr r3, [r7, #0]
|
|
8006666: 68db ldr r3, [r3, #12]
|
|
8006668: 2b00 cmp r3, #0
|
|
800666a: d104 bne.n 8006676 <osTimerNew+0x9e>
|
|
mem = 0;
|
|
800666c: 2300 movs r3, #0
|
|
800666e: 61bb str r3, [r7, #24]
|
|
8006670: e001 b.n 8006676 <osTimerNew+0x9e>
|
|
}
|
|
}
|
|
}
|
|
else {
|
|
mem = 0;
|
|
8006672: 2300 movs r3, #0
|
|
8006674: 61bb str r3, [r7, #24]
|
|
}
|
|
|
|
if (mem == 1) {
|
|
8006676: 69bb ldr r3, [r7, #24]
|
|
8006678: 2b01 cmp r3, #1
|
|
800667a: d10c bne.n 8006696 <osTimerNew+0xbe>
|
|
#if (configSUPPORT_STATIC_ALLOCATION == 1)
|
|
hTimer = xTimerCreateStatic (name, 1, reload, callb, TimerCallback, (StaticTimer_t *)attr->cb_mem);
|
|
800667c: 683b ldr r3, [r7, #0]
|
|
800667e: 689b ldr r3, [r3, #8]
|
|
8006680: 9301 str r3, [sp, #4]
|
|
8006682: 4b12 ldr r3, [pc, #72] @ (80066cc <osTimerNew+0xf4>)
|
|
8006684: 9300 str r3, [sp, #0]
|
|
8006686: 697b ldr r3, [r7, #20]
|
|
8006688: 69fa ldr r2, [r7, #28]
|
|
800668a: 2101 movs r1, #1
|
|
800668c: 6a78 ldr r0, [r7, #36] @ 0x24
|
|
800668e: f002 fc22 bl 8008ed6 <xTimerCreateStatic>
|
|
8006692: 6238 str r0, [r7, #32]
|
|
8006694: e00b b.n 80066ae <osTimerNew+0xd6>
|
|
#endif
|
|
}
|
|
else {
|
|
if (mem == 0) {
|
|
8006696: 69bb ldr r3, [r7, #24]
|
|
8006698: 2b00 cmp r3, #0
|
|
800669a: d108 bne.n 80066ae <osTimerNew+0xd6>
|
|
#if (configSUPPORT_DYNAMIC_ALLOCATION == 1)
|
|
hTimer = xTimerCreate (name, 1, reload, callb, TimerCallback);
|
|
800669c: 4b0b ldr r3, [pc, #44] @ (80066cc <osTimerNew+0xf4>)
|
|
800669e: 9300 str r3, [sp, #0]
|
|
80066a0: 697b ldr r3, [r7, #20]
|
|
80066a2: 69fa ldr r2, [r7, #28]
|
|
80066a4: 2101 movs r1, #1
|
|
80066a6: 6a78 ldr r0, [r7, #36] @ 0x24
|
|
80066a8: f002 fbf4 bl 8008e94 <xTimerCreate>
|
|
80066ac: 6238 str r0, [r7, #32]
|
|
#endif
|
|
}
|
|
}
|
|
|
|
if ((hTimer == NULL) && (callb != NULL)) {
|
|
80066ae: 6a3b ldr r3, [r7, #32]
|
|
80066b0: 2b00 cmp r3, #0
|
|
80066b2: d105 bne.n 80066c0 <osTimerNew+0xe8>
|
|
80066b4: 697b ldr r3, [r7, #20]
|
|
80066b6: 2b00 cmp r3, #0
|
|
80066b8: d002 beq.n 80066c0 <osTimerNew+0xe8>
|
|
vPortFree (callb);
|
|
80066ba: 6978 ldr r0, [r7, #20]
|
|
80066bc: f003 fadc bl 8009c78 <vPortFree>
|
|
}
|
|
}
|
|
}
|
|
|
|
return ((osTimerId_t)hTimer);
|
|
80066c0: 6a3b ldr r3, [r7, #32]
|
|
}
|
|
80066c2: 4618 mov r0, r3
|
|
80066c4: 3728 adds r7, #40 @ 0x28
|
|
80066c6: 46bd mov sp, r7
|
|
80066c8: bd80 pop {r7, pc}
|
|
80066ca: bf00 nop
|
|
80066cc: 080065ad .word 0x080065ad
|
|
|
|
080066d0 <osTimerStart>:
|
|
}
|
|
|
|
return (p);
|
|
}
|
|
|
|
osStatus_t osTimerStart (osTimerId_t timer_id, uint32_t ticks) {
|
|
80066d0: b580 push {r7, lr}
|
|
80066d2: b088 sub sp, #32
|
|
80066d4: af02 add r7, sp, #8
|
|
80066d6: 6078 str r0, [r7, #4]
|
|
80066d8: 6039 str r1, [r7, #0]
|
|
TimerHandle_t hTimer = (TimerHandle_t)timer_id;
|
|
80066da: 687b ldr r3, [r7, #4]
|
|
80066dc: 613b str r3, [r7, #16]
|
|
__ASM volatile ("MRS %0, ipsr" : "=r" (result) );
|
|
80066de: f3ef 8305 mrs r3, IPSR
|
|
80066e2: 60fb str r3, [r7, #12]
|
|
return(result);
|
|
80066e4: 68fb ldr r3, [r7, #12]
|
|
osStatus_t stat;
|
|
|
|
if (IS_IRQ()) {
|
|
80066e6: 2b00 cmp r3, #0
|
|
80066e8: d003 beq.n 80066f2 <osTimerStart+0x22>
|
|
stat = osErrorISR;
|
|
80066ea: f06f 0305 mvn.w r3, #5
|
|
80066ee: 617b str r3, [r7, #20]
|
|
80066f0: e017 b.n 8006722 <osTimerStart+0x52>
|
|
}
|
|
else if (hTimer == NULL) {
|
|
80066f2: 693b ldr r3, [r7, #16]
|
|
80066f4: 2b00 cmp r3, #0
|
|
80066f6: d103 bne.n 8006700 <osTimerStart+0x30>
|
|
stat = osErrorParameter;
|
|
80066f8: f06f 0303 mvn.w r3, #3
|
|
80066fc: 617b str r3, [r7, #20]
|
|
80066fe: e010 b.n 8006722 <osTimerStart+0x52>
|
|
}
|
|
else {
|
|
if (xTimerChangePeriod (hTimer, ticks, 0) == pdPASS) {
|
|
8006700: 2300 movs r3, #0
|
|
8006702: 9300 str r3, [sp, #0]
|
|
8006704: 2300 movs r3, #0
|
|
8006706: 683a ldr r2, [r7, #0]
|
|
8006708: 2104 movs r1, #4
|
|
800670a: 6938 ldr r0, [r7, #16]
|
|
800670c: f002 fc60 bl 8008fd0 <xTimerGenericCommand>
|
|
8006710: 4603 mov r3, r0
|
|
8006712: 2b01 cmp r3, #1
|
|
8006714: d102 bne.n 800671c <osTimerStart+0x4c>
|
|
stat = osOK;
|
|
8006716: 2300 movs r3, #0
|
|
8006718: 617b str r3, [r7, #20]
|
|
800671a: e002 b.n 8006722 <osTimerStart+0x52>
|
|
} else {
|
|
stat = osErrorResource;
|
|
800671c: f06f 0302 mvn.w r3, #2
|
|
8006720: 617b str r3, [r7, #20]
|
|
}
|
|
}
|
|
|
|
return (stat);
|
|
8006722: 697b ldr r3, [r7, #20]
|
|
}
|
|
8006724: 4618 mov r0, r3
|
|
8006726: 3718 adds r7, #24
|
|
8006728: 46bd mov sp, r7
|
|
800672a: bd80 pop {r7, pc}
|
|
|
|
0800672c <osSemaphoreNew>:
|
|
}
|
|
#endif /* (configUSE_OS2_MUTEX == 1) */
|
|
|
|
/*---------------------------------------------------------------------------*/
|
|
|
|
osSemaphoreId_t osSemaphoreNew (uint32_t max_count, uint32_t initial_count, const osSemaphoreAttr_t *attr) {
|
|
800672c: b580 push {r7, lr}
|
|
800672e: b08a sub sp, #40 @ 0x28
|
|
8006730: af02 add r7, sp, #8
|
|
8006732: 60f8 str r0, [r7, #12]
|
|
8006734: 60b9 str r1, [r7, #8]
|
|
8006736: 607a str r2, [r7, #4]
|
|
int32_t mem;
|
|
#if (configQUEUE_REGISTRY_SIZE > 0)
|
|
const char *name;
|
|
#endif
|
|
|
|
hSemaphore = NULL;
|
|
8006738: 2300 movs r3, #0
|
|
800673a: 61fb str r3, [r7, #28]
|
|
__ASM volatile ("MRS %0, ipsr" : "=r" (result) );
|
|
800673c: f3ef 8305 mrs r3, IPSR
|
|
8006740: 613b str r3, [r7, #16]
|
|
return(result);
|
|
8006742: 693b ldr r3, [r7, #16]
|
|
|
|
if (!IS_IRQ() && (max_count > 0U) && (initial_count <= max_count)) {
|
|
8006744: 2b00 cmp r3, #0
|
|
8006746: d175 bne.n 8006834 <osSemaphoreNew+0x108>
|
|
8006748: 68fb ldr r3, [r7, #12]
|
|
800674a: 2b00 cmp r3, #0
|
|
800674c: d072 beq.n 8006834 <osSemaphoreNew+0x108>
|
|
800674e: 68ba ldr r2, [r7, #8]
|
|
8006750: 68fb ldr r3, [r7, #12]
|
|
8006752: 429a cmp r2, r3
|
|
8006754: d86e bhi.n 8006834 <osSemaphoreNew+0x108>
|
|
mem = -1;
|
|
8006756: f04f 33ff mov.w r3, #4294967295 @ 0xffffffff
|
|
800675a: 61bb str r3, [r7, #24]
|
|
|
|
if (attr != NULL) {
|
|
800675c: 687b ldr r3, [r7, #4]
|
|
800675e: 2b00 cmp r3, #0
|
|
8006760: d015 beq.n 800678e <osSemaphoreNew+0x62>
|
|
if ((attr->cb_mem != NULL) && (attr->cb_size >= sizeof(StaticSemaphore_t))) {
|
|
8006762: 687b ldr r3, [r7, #4]
|
|
8006764: 689b ldr r3, [r3, #8]
|
|
8006766: 2b00 cmp r3, #0
|
|
8006768: d006 beq.n 8006778 <osSemaphoreNew+0x4c>
|
|
800676a: 687b ldr r3, [r7, #4]
|
|
800676c: 68db ldr r3, [r3, #12]
|
|
800676e: 2b4f cmp r3, #79 @ 0x4f
|
|
8006770: d902 bls.n 8006778 <osSemaphoreNew+0x4c>
|
|
mem = 1;
|
|
8006772: 2301 movs r3, #1
|
|
8006774: 61bb str r3, [r7, #24]
|
|
8006776: e00c b.n 8006792 <osSemaphoreNew+0x66>
|
|
}
|
|
else {
|
|
if ((attr->cb_mem == NULL) && (attr->cb_size == 0U)) {
|
|
8006778: 687b ldr r3, [r7, #4]
|
|
800677a: 689b ldr r3, [r3, #8]
|
|
800677c: 2b00 cmp r3, #0
|
|
800677e: d108 bne.n 8006792 <osSemaphoreNew+0x66>
|
|
8006780: 687b ldr r3, [r7, #4]
|
|
8006782: 68db ldr r3, [r3, #12]
|
|
8006784: 2b00 cmp r3, #0
|
|
8006786: d104 bne.n 8006792 <osSemaphoreNew+0x66>
|
|
mem = 0;
|
|
8006788: 2300 movs r3, #0
|
|
800678a: 61bb str r3, [r7, #24]
|
|
800678c: e001 b.n 8006792 <osSemaphoreNew+0x66>
|
|
}
|
|
}
|
|
}
|
|
else {
|
|
mem = 0;
|
|
800678e: 2300 movs r3, #0
|
|
8006790: 61bb str r3, [r7, #24]
|
|
}
|
|
|
|
if (mem != -1) {
|
|
8006792: 69bb ldr r3, [r7, #24]
|
|
8006794: f1b3 3fff cmp.w r3, #4294967295 @ 0xffffffff
|
|
8006798: d04c beq.n 8006834 <osSemaphoreNew+0x108>
|
|
if (max_count == 1U) {
|
|
800679a: 68fb ldr r3, [r7, #12]
|
|
800679c: 2b01 cmp r3, #1
|
|
800679e: d128 bne.n 80067f2 <osSemaphoreNew+0xc6>
|
|
if (mem == 1) {
|
|
80067a0: 69bb ldr r3, [r7, #24]
|
|
80067a2: 2b01 cmp r3, #1
|
|
80067a4: d10a bne.n 80067bc <osSemaphoreNew+0x90>
|
|
#if (configSUPPORT_STATIC_ALLOCATION == 1)
|
|
hSemaphore = xSemaphoreCreateBinaryStatic ((StaticSemaphore_t *)attr->cb_mem);
|
|
80067a6: 687b ldr r3, [r7, #4]
|
|
80067a8: 689b ldr r3, [r3, #8]
|
|
80067aa: 2203 movs r2, #3
|
|
80067ac: 9200 str r2, [sp, #0]
|
|
80067ae: 2200 movs r2, #0
|
|
80067b0: 2100 movs r1, #0
|
|
80067b2: 2001 movs r0, #1
|
|
80067b4: f000 fb5e bl 8006e74 <xQueueGenericCreateStatic>
|
|
80067b8: 61f8 str r0, [r7, #28]
|
|
80067ba: e005 b.n 80067c8 <osSemaphoreNew+0x9c>
|
|
#endif
|
|
}
|
|
else {
|
|
#if (configSUPPORT_DYNAMIC_ALLOCATION == 1)
|
|
hSemaphore = xSemaphoreCreateBinary();
|
|
80067bc: 2203 movs r2, #3
|
|
80067be: 2100 movs r1, #0
|
|
80067c0: 2001 movs r0, #1
|
|
80067c2: f000 fbd4 bl 8006f6e <xQueueGenericCreate>
|
|
80067c6: 61f8 str r0, [r7, #28]
|
|
#endif
|
|
}
|
|
|
|
if ((hSemaphore != NULL) && (initial_count != 0U)) {
|
|
80067c8: 69fb ldr r3, [r7, #28]
|
|
80067ca: 2b00 cmp r3, #0
|
|
80067cc: d022 beq.n 8006814 <osSemaphoreNew+0xe8>
|
|
80067ce: 68bb ldr r3, [r7, #8]
|
|
80067d0: 2b00 cmp r3, #0
|
|
80067d2: d01f beq.n 8006814 <osSemaphoreNew+0xe8>
|
|
if (xSemaphoreGive (hSemaphore) != pdPASS) {
|
|
80067d4: 2300 movs r3, #0
|
|
80067d6: 2200 movs r2, #0
|
|
80067d8: 2100 movs r1, #0
|
|
80067da: 69f8 ldr r0, [r7, #28]
|
|
80067dc: f000 fc94 bl 8007108 <xQueueGenericSend>
|
|
80067e0: 4603 mov r3, r0
|
|
80067e2: 2b01 cmp r3, #1
|
|
80067e4: d016 beq.n 8006814 <osSemaphoreNew+0xe8>
|
|
vSemaphoreDelete (hSemaphore);
|
|
80067e6: 69f8 ldr r0, [r7, #28]
|
|
80067e8: f001 f932 bl 8007a50 <vQueueDelete>
|
|
hSemaphore = NULL;
|
|
80067ec: 2300 movs r3, #0
|
|
80067ee: 61fb str r3, [r7, #28]
|
|
80067f0: e010 b.n 8006814 <osSemaphoreNew+0xe8>
|
|
}
|
|
}
|
|
}
|
|
else {
|
|
if (mem == 1) {
|
|
80067f2: 69bb ldr r3, [r7, #24]
|
|
80067f4: 2b01 cmp r3, #1
|
|
80067f6: d108 bne.n 800680a <osSemaphoreNew+0xde>
|
|
#if (configSUPPORT_STATIC_ALLOCATION == 1)
|
|
hSemaphore = xSemaphoreCreateCountingStatic (max_count, initial_count, (StaticSemaphore_t *)attr->cb_mem);
|
|
80067f8: 687b ldr r3, [r7, #4]
|
|
80067fa: 689b ldr r3, [r3, #8]
|
|
80067fc: 461a mov r2, r3
|
|
80067fe: 68b9 ldr r1, [r7, #8]
|
|
8006800: 68f8 ldr r0, [r7, #12]
|
|
8006802: f000 fc12 bl 800702a <xQueueCreateCountingSemaphoreStatic>
|
|
8006806: 61f8 str r0, [r7, #28]
|
|
8006808: e004 b.n 8006814 <osSemaphoreNew+0xe8>
|
|
#endif
|
|
}
|
|
else {
|
|
#if (configSUPPORT_DYNAMIC_ALLOCATION == 1)
|
|
hSemaphore = xSemaphoreCreateCounting (max_count, initial_count);
|
|
800680a: 68b9 ldr r1, [r7, #8]
|
|
800680c: 68f8 ldr r0, [r7, #12]
|
|
800680e: f000 fc45 bl 800709c <xQueueCreateCountingSemaphore>
|
|
8006812: 61f8 str r0, [r7, #28]
|
|
#endif
|
|
}
|
|
}
|
|
|
|
#if (configQUEUE_REGISTRY_SIZE > 0)
|
|
if (hSemaphore != NULL) {
|
|
8006814: 69fb ldr r3, [r7, #28]
|
|
8006816: 2b00 cmp r3, #0
|
|
8006818: d00c beq.n 8006834 <osSemaphoreNew+0x108>
|
|
if (attr != NULL) {
|
|
800681a: 687b ldr r3, [r7, #4]
|
|
800681c: 2b00 cmp r3, #0
|
|
800681e: d003 beq.n 8006828 <osSemaphoreNew+0xfc>
|
|
name = attr->name;
|
|
8006820: 687b ldr r3, [r7, #4]
|
|
8006822: 681b ldr r3, [r3, #0]
|
|
8006824: 617b str r3, [r7, #20]
|
|
8006826: e001 b.n 800682c <osSemaphoreNew+0x100>
|
|
} else {
|
|
name = NULL;
|
|
8006828: 2300 movs r3, #0
|
|
800682a: 617b str r3, [r7, #20]
|
|
}
|
|
vQueueAddToRegistry (hSemaphore, name);
|
|
800682c: 6979 ldr r1, [r7, #20]
|
|
800682e: 69f8 ldr r0, [r7, #28]
|
|
8006830: f001 fa5a bl 8007ce8 <vQueueAddToRegistry>
|
|
}
|
|
#endif
|
|
}
|
|
}
|
|
|
|
return ((osSemaphoreId_t)hSemaphore);
|
|
8006834: 69fb ldr r3, [r7, #28]
|
|
}
|
|
8006836: 4618 mov r0, r3
|
|
8006838: 3720 adds r7, #32
|
|
800683a: 46bd mov sp, r7
|
|
800683c: bd80 pop {r7, pc}
|
|
...
|
|
|
|
08006840 <osSemaphoreAcquire>:
|
|
|
|
osStatus_t osSemaphoreAcquire (osSemaphoreId_t semaphore_id, uint32_t timeout) {
|
|
8006840: b580 push {r7, lr}
|
|
8006842: b086 sub sp, #24
|
|
8006844: af00 add r7, sp, #0
|
|
8006846: 6078 str r0, [r7, #4]
|
|
8006848: 6039 str r1, [r7, #0]
|
|
SemaphoreHandle_t hSemaphore = (SemaphoreHandle_t)semaphore_id;
|
|
800684a: 687b ldr r3, [r7, #4]
|
|
800684c: 613b str r3, [r7, #16]
|
|
osStatus_t stat;
|
|
BaseType_t yield;
|
|
|
|
stat = osOK;
|
|
800684e: 2300 movs r3, #0
|
|
8006850: 617b str r3, [r7, #20]
|
|
|
|
if (hSemaphore == NULL) {
|
|
8006852: 693b ldr r3, [r7, #16]
|
|
8006854: 2b00 cmp r3, #0
|
|
8006856: d103 bne.n 8006860 <osSemaphoreAcquire+0x20>
|
|
stat = osErrorParameter;
|
|
8006858: f06f 0303 mvn.w r3, #3
|
|
800685c: 617b str r3, [r7, #20]
|
|
800685e: e039 b.n 80068d4 <osSemaphoreAcquire+0x94>
|
|
__ASM volatile ("MRS %0, ipsr" : "=r" (result) );
|
|
8006860: f3ef 8305 mrs r3, IPSR
|
|
8006864: 60fb str r3, [r7, #12]
|
|
return(result);
|
|
8006866: 68fb ldr r3, [r7, #12]
|
|
}
|
|
else if (IS_IRQ()) {
|
|
8006868: 2b00 cmp r3, #0
|
|
800686a: d022 beq.n 80068b2 <osSemaphoreAcquire+0x72>
|
|
if (timeout != 0U) {
|
|
800686c: 683b ldr r3, [r7, #0]
|
|
800686e: 2b00 cmp r3, #0
|
|
8006870: d003 beq.n 800687a <osSemaphoreAcquire+0x3a>
|
|
stat = osErrorParameter;
|
|
8006872: f06f 0303 mvn.w r3, #3
|
|
8006876: 617b str r3, [r7, #20]
|
|
8006878: e02c b.n 80068d4 <osSemaphoreAcquire+0x94>
|
|
}
|
|
else {
|
|
yield = pdFALSE;
|
|
800687a: 2300 movs r3, #0
|
|
800687c: 60bb str r3, [r7, #8]
|
|
|
|
if (xSemaphoreTakeFromISR (hSemaphore, &yield) != pdPASS) {
|
|
800687e: f107 0308 add.w r3, r7, #8
|
|
8006882: 461a mov r2, r3
|
|
8006884: 2100 movs r1, #0
|
|
8006886: 6938 ldr r0, [r7, #16]
|
|
8006888: f001 f860 bl 800794c <xQueueReceiveFromISR>
|
|
800688c: 4603 mov r3, r0
|
|
800688e: 2b01 cmp r3, #1
|
|
8006890: d003 beq.n 800689a <osSemaphoreAcquire+0x5a>
|
|
stat = osErrorResource;
|
|
8006892: f06f 0302 mvn.w r3, #2
|
|
8006896: 617b str r3, [r7, #20]
|
|
8006898: e01c b.n 80068d4 <osSemaphoreAcquire+0x94>
|
|
} else {
|
|
portYIELD_FROM_ISR (yield);
|
|
800689a: 68bb ldr r3, [r7, #8]
|
|
800689c: 2b00 cmp r3, #0
|
|
800689e: d019 beq.n 80068d4 <osSemaphoreAcquire+0x94>
|
|
80068a0: 4b0f ldr r3, [pc, #60] @ (80068e0 <osSemaphoreAcquire+0xa0>)
|
|
80068a2: f04f 5280 mov.w r2, #268435456 @ 0x10000000
|
|
80068a6: 601a str r2, [r3, #0]
|
|
80068a8: f3bf 8f4f dsb sy
|
|
80068ac: f3bf 8f6f isb sy
|
|
80068b0: e010 b.n 80068d4 <osSemaphoreAcquire+0x94>
|
|
}
|
|
}
|
|
}
|
|
else {
|
|
if (xSemaphoreTake (hSemaphore, (TickType_t)timeout) != pdPASS) {
|
|
80068b2: 6839 ldr r1, [r7, #0]
|
|
80068b4: 6938 ldr r0, [r7, #16]
|
|
80068b6: f000 ff39 bl 800772c <xQueueSemaphoreTake>
|
|
80068ba: 4603 mov r3, r0
|
|
80068bc: 2b01 cmp r3, #1
|
|
80068be: d009 beq.n 80068d4 <osSemaphoreAcquire+0x94>
|
|
if (timeout != 0U) {
|
|
80068c0: 683b ldr r3, [r7, #0]
|
|
80068c2: 2b00 cmp r3, #0
|
|
80068c4: d003 beq.n 80068ce <osSemaphoreAcquire+0x8e>
|
|
stat = osErrorTimeout;
|
|
80068c6: f06f 0301 mvn.w r3, #1
|
|
80068ca: 617b str r3, [r7, #20]
|
|
80068cc: e002 b.n 80068d4 <osSemaphoreAcquire+0x94>
|
|
} else {
|
|
stat = osErrorResource;
|
|
80068ce: f06f 0302 mvn.w r3, #2
|
|
80068d2: 617b str r3, [r7, #20]
|
|
}
|
|
}
|
|
}
|
|
|
|
return (stat);
|
|
80068d4: 697b ldr r3, [r7, #20]
|
|
}
|
|
80068d6: 4618 mov r0, r3
|
|
80068d8: 3718 adds r7, #24
|
|
80068da: 46bd mov sp, r7
|
|
80068dc: bd80 pop {r7, pc}
|
|
80068de: bf00 nop
|
|
80068e0: e000ed04 .word 0xe000ed04
|
|
|
|
080068e4 <osSemaphoreRelease>:
|
|
|
|
osStatus_t osSemaphoreRelease (osSemaphoreId_t semaphore_id) {
|
|
80068e4: b580 push {r7, lr}
|
|
80068e6: b086 sub sp, #24
|
|
80068e8: af00 add r7, sp, #0
|
|
80068ea: 6078 str r0, [r7, #4]
|
|
SemaphoreHandle_t hSemaphore = (SemaphoreHandle_t)semaphore_id;
|
|
80068ec: 687b ldr r3, [r7, #4]
|
|
80068ee: 613b str r3, [r7, #16]
|
|
osStatus_t stat;
|
|
BaseType_t yield;
|
|
|
|
stat = osOK;
|
|
80068f0: 2300 movs r3, #0
|
|
80068f2: 617b str r3, [r7, #20]
|
|
|
|
if (hSemaphore == NULL) {
|
|
80068f4: 693b ldr r3, [r7, #16]
|
|
80068f6: 2b00 cmp r3, #0
|
|
80068f8: d103 bne.n 8006902 <osSemaphoreRelease+0x1e>
|
|
stat = osErrorParameter;
|
|
80068fa: f06f 0303 mvn.w r3, #3
|
|
80068fe: 617b str r3, [r7, #20]
|
|
8006900: e02c b.n 800695c <osSemaphoreRelease+0x78>
|
|
__ASM volatile ("MRS %0, ipsr" : "=r" (result) );
|
|
8006902: f3ef 8305 mrs r3, IPSR
|
|
8006906: 60fb str r3, [r7, #12]
|
|
return(result);
|
|
8006908: 68fb ldr r3, [r7, #12]
|
|
}
|
|
else if (IS_IRQ()) {
|
|
800690a: 2b00 cmp r3, #0
|
|
800690c: d01a beq.n 8006944 <osSemaphoreRelease+0x60>
|
|
yield = pdFALSE;
|
|
800690e: 2300 movs r3, #0
|
|
8006910: 60bb str r3, [r7, #8]
|
|
|
|
if (xSemaphoreGiveFromISR (hSemaphore, &yield) != pdTRUE) {
|
|
8006912: f107 0308 add.w r3, r7, #8
|
|
8006916: 4619 mov r1, r3
|
|
8006918: 6938 ldr r0, [r7, #16]
|
|
800691a: f000 fd95 bl 8007448 <xQueueGiveFromISR>
|
|
800691e: 4603 mov r3, r0
|
|
8006920: 2b01 cmp r3, #1
|
|
8006922: d003 beq.n 800692c <osSemaphoreRelease+0x48>
|
|
stat = osErrorResource;
|
|
8006924: f06f 0302 mvn.w r3, #2
|
|
8006928: 617b str r3, [r7, #20]
|
|
800692a: e017 b.n 800695c <osSemaphoreRelease+0x78>
|
|
} else {
|
|
portYIELD_FROM_ISR (yield);
|
|
800692c: 68bb ldr r3, [r7, #8]
|
|
800692e: 2b00 cmp r3, #0
|
|
8006930: d014 beq.n 800695c <osSemaphoreRelease+0x78>
|
|
8006932: 4b0d ldr r3, [pc, #52] @ (8006968 <osSemaphoreRelease+0x84>)
|
|
8006934: f04f 5280 mov.w r2, #268435456 @ 0x10000000
|
|
8006938: 601a str r2, [r3, #0]
|
|
800693a: f3bf 8f4f dsb sy
|
|
800693e: f3bf 8f6f isb sy
|
|
8006942: e00b b.n 800695c <osSemaphoreRelease+0x78>
|
|
}
|
|
}
|
|
else {
|
|
if (xSemaphoreGive (hSemaphore) != pdPASS) {
|
|
8006944: 2300 movs r3, #0
|
|
8006946: 2200 movs r2, #0
|
|
8006948: 2100 movs r1, #0
|
|
800694a: 6938 ldr r0, [r7, #16]
|
|
800694c: f000 fbdc bl 8007108 <xQueueGenericSend>
|
|
8006950: 4603 mov r3, r0
|
|
8006952: 2b01 cmp r3, #1
|
|
8006954: d002 beq.n 800695c <osSemaphoreRelease+0x78>
|
|
stat = osErrorResource;
|
|
8006956: f06f 0302 mvn.w r3, #2
|
|
800695a: 617b str r3, [r7, #20]
|
|
}
|
|
}
|
|
|
|
return (stat);
|
|
800695c: 697b ldr r3, [r7, #20]
|
|
}
|
|
800695e: 4618 mov r0, r3
|
|
8006960: 3718 adds r7, #24
|
|
8006962: 46bd mov sp, r7
|
|
8006964: bd80 pop {r7, pc}
|
|
8006966: bf00 nop
|
|
8006968: e000ed04 .word 0xe000ed04
|
|
|
|
0800696c <osMessageQueueNew>:
|
|
return (stat);
|
|
}
|
|
|
|
/*---------------------------------------------------------------------------*/
|
|
|
|
osMessageQueueId_t osMessageQueueNew (uint32_t msg_count, uint32_t msg_size, const osMessageQueueAttr_t *attr) {
|
|
800696c: b580 push {r7, lr}
|
|
800696e: b08a sub sp, #40 @ 0x28
|
|
8006970: af02 add r7, sp, #8
|
|
8006972: 60f8 str r0, [r7, #12]
|
|
8006974: 60b9 str r1, [r7, #8]
|
|
8006976: 607a str r2, [r7, #4]
|
|
int32_t mem;
|
|
#if (configQUEUE_REGISTRY_SIZE > 0)
|
|
const char *name;
|
|
#endif
|
|
|
|
hQueue = NULL;
|
|
8006978: 2300 movs r3, #0
|
|
800697a: 61fb str r3, [r7, #28]
|
|
__ASM volatile ("MRS %0, ipsr" : "=r" (result) );
|
|
800697c: f3ef 8305 mrs r3, IPSR
|
|
8006980: 613b str r3, [r7, #16]
|
|
return(result);
|
|
8006982: 693b ldr r3, [r7, #16]
|
|
|
|
if (!IS_IRQ() && (msg_count > 0U) && (msg_size > 0U)) {
|
|
8006984: 2b00 cmp r3, #0
|
|
8006986: d15f bne.n 8006a48 <osMessageQueueNew+0xdc>
|
|
8006988: 68fb ldr r3, [r7, #12]
|
|
800698a: 2b00 cmp r3, #0
|
|
800698c: d05c beq.n 8006a48 <osMessageQueueNew+0xdc>
|
|
800698e: 68bb ldr r3, [r7, #8]
|
|
8006990: 2b00 cmp r3, #0
|
|
8006992: d059 beq.n 8006a48 <osMessageQueueNew+0xdc>
|
|
mem = -1;
|
|
8006994: f04f 33ff mov.w r3, #4294967295 @ 0xffffffff
|
|
8006998: 61bb str r3, [r7, #24]
|
|
|
|
if (attr != NULL) {
|
|
800699a: 687b ldr r3, [r7, #4]
|
|
800699c: 2b00 cmp r3, #0
|
|
800699e: d029 beq.n 80069f4 <osMessageQueueNew+0x88>
|
|
if ((attr->cb_mem != NULL) && (attr->cb_size >= sizeof(StaticQueue_t)) &&
|
|
80069a0: 687b ldr r3, [r7, #4]
|
|
80069a2: 689b ldr r3, [r3, #8]
|
|
80069a4: 2b00 cmp r3, #0
|
|
80069a6: d012 beq.n 80069ce <osMessageQueueNew+0x62>
|
|
80069a8: 687b ldr r3, [r7, #4]
|
|
80069aa: 68db ldr r3, [r3, #12]
|
|
80069ac: 2b4f cmp r3, #79 @ 0x4f
|
|
80069ae: d90e bls.n 80069ce <osMessageQueueNew+0x62>
|
|
(attr->mq_mem != NULL) && (attr->mq_size >= (msg_count * msg_size))) {
|
|
80069b0: 687b ldr r3, [r7, #4]
|
|
80069b2: 691b ldr r3, [r3, #16]
|
|
if ((attr->cb_mem != NULL) && (attr->cb_size >= sizeof(StaticQueue_t)) &&
|
|
80069b4: 2b00 cmp r3, #0
|
|
80069b6: d00a beq.n 80069ce <osMessageQueueNew+0x62>
|
|
(attr->mq_mem != NULL) && (attr->mq_size >= (msg_count * msg_size))) {
|
|
80069b8: 687b ldr r3, [r7, #4]
|
|
80069ba: 695a ldr r2, [r3, #20]
|
|
80069bc: 68fb ldr r3, [r7, #12]
|
|
80069be: 68b9 ldr r1, [r7, #8]
|
|
80069c0: fb01 f303 mul.w r3, r1, r3
|
|
80069c4: 429a cmp r2, r3
|
|
80069c6: d302 bcc.n 80069ce <osMessageQueueNew+0x62>
|
|
mem = 1;
|
|
80069c8: 2301 movs r3, #1
|
|
80069ca: 61bb str r3, [r7, #24]
|
|
80069cc: e014 b.n 80069f8 <osMessageQueueNew+0x8c>
|
|
}
|
|
else {
|
|
if ((attr->cb_mem == NULL) && (attr->cb_size == 0U) &&
|
|
80069ce: 687b ldr r3, [r7, #4]
|
|
80069d0: 689b ldr r3, [r3, #8]
|
|
80069d2: 2b00 cmp r3, #0
|
|
80069d4: d110 bne.n 80069f8 <osMessageQueueNew+0x8c>
|
|
80069d6: 687b ldr r3, [r7, #4]
|
|
80069d8: 68db ldr r3, [r3, #12]
|
|
80069da: 2b00 cmp r3, #0
|
|
80069dc: d10c bne.n 80069f8 <osMessageQueueNew+0x8c>
|
|
(attr->mq_mem == NULL) && (attr->mq_size == 0U)) {
|
|
80069de: 687b ldr r3, [r7, #4]
|
|
80069e0: 691b ldr r3, [r3, #16]
|
|
if ((attr->cb_mem == NULL) && (attr->cb_size == 0U) &&
|
|
80069e2: 2b00 cmp r3, #0
|
|
80069e4: d108 bne.n 80069f8 <osMessageQueueNew+0x8c>
|
|
(attr->mq_mem == NULL) && (attr->mq_size == 0U)) {
|
|
80069e6: 687b ldr r3, [r7, #4]
|
|
80069e8: 695b ldr r3, [r3, #20]
|
|
80069ea: 2b00 cmp r3, #0
|
|
80069ec: d104 bne.n 80069f8 <osMessageQueueNew+0x8c>
|
|
mem = 0;
|
|
80069ee: 2300 movs r3, #0
|
|
80069f0: 61bb str r3, [r7, #24]
|
|
80069f2: e001 b.n 80069f8 <osMessageQueueNew+0x8c>
|
|
}
|
|
}
|
|
}
|
|
else {
|
|
mem = 0;
|
|
80069f4: 2300 movs r3, #0
|
|
80069f6: 61bb str r3, [r7, #24]
|
|
}
|
|
|
|
if (mem == 1) {
|
|
80069f8: 69bb ldr r3, [r7, #24]
|
|
80069fa: 2b01 cmp r3, #1
|
|
80069fc: d10b bne.n 8006a16 <osMessageQueueNew+0xaa>
|
|
#if (configSUPPORT_STATIC_ALLOCATION == 1)
|
|
hQueue = xQueueCreateStatic (msg_count, msg_size, attr->mq_mem, attr->cb_mem);
|
|
80069fe: 687b ldr r3, [r7, #4]
|
|
8006a00: 691a ldr r2, [r3, #16]
|
|
8006a02: 687b ldr r3, [r7, #4]
|
|
8006a04: 689b ldr r3, [r3, #8]
|
|
8006a06: 2100 movs r1, #0
|
|
8006a08: 9100 str r1, [sp, #0]
|
|
8006a0a: 68b9 ldr r1, [r7, #8]
|
|
8006a0c: 68f8 ldr r0, [r7, #12]
|
|
8006a0e: f000 fa31 bl 8006e74 <xQueueGenericCreateStatic>
|
|
8006a12: 61f8 str r0, [r7, #28]
|
|
8006a14: e008 b.n 8006a28 <osMessageQueueNew+0xbc>
|
|
#endif
|
|
}
|
|
else {
|
|
if (mem == 0) {
|
|
8006a16: 69bb ldr r3, [r7, #24]
|
|
8006a18: 2b00 cmp r3, #0
|
|
8006a1a: d105 bne.n 8006a28 <osMessageQueueNew+0xbc>
|
|
#if (configSUPPORT_DYNAMIC_ALLOCATION == 1)
|
|
hQueue = xQueueCreate (msg_count, msg_size);
|
|
8006a1c: 2200 movs r2, #0
|
|
8006a1e: 68b9 ldr r1, [r7, #8]
|
|
8006a20: 68f8 ldr r0, [r7, #12]
|
|
8006a22: f000 faa4 bl 8006f6e <xQueueGenericCreate>
|
|
8006a26: 61f8 str r0, [r7, #28]
|
|
#endif
|
|
}
|
|
}
|
|
|
|
#if (configQUEUE_REGISTRY_SIZE > 0)
|
|
if (hQueue != NULL) {
|
|
8006a28: 69fb ldr r3, [r7, #28]
|
|
8006a2a: 2b00 cmp r3, #0
|
|
8006a2c: d00c beq.n 8006a48 <osMessageQueueNew+0xdc>
|
|
if (attr != NULL) {
|
|
8006a2e: 687b ldr r3, [r7, #4]
|
|
8006a30: 2b00 cmp r3, #0
|
|
8006a32: d003 beq.n 8006a3c <osMessageQueueNew+0xd0>
|
|
name = attr->name;
|
|
8006a34: 687b ldr r3, [r7, #4]
|
|
8006a36: 681b ldr r3, [r3, #0]
|
|
8006a38: 617b str r3, [r7, #20]
|
|
8006a3a: e001 b.n 8006a40 <osMessageQueueNew+0xd4>
|
|
} else {
|
|
name = NULL;
|
|
8006a3c: 2300 movs r3, #0
|
|
8006a3e: 617b str r3, [r7, #20]
|
|
}
|
|
vQueueAddToRegistry (hQueue, name);
|
|
8006a40: 6979 ldr r1, [r7, #20]
|
|
8006a42: 69f8 ldr r0, [r7, #28]
|
|
8006a44: f001 f950 bl 8007ce8 <vQueueAddToRegistry>
|
|
}
|
|
#endif
|
|
|
|
}
|
|
|
|
return ((osMessageQueueId_t)hQueue);
|
|
8006a48: 69fb ldr r3, [r7, #28]
|
|
}
|
|
8006a4a: 4618 mov r0, r3
|
|
8006a4c: 3720 adds r7, #32
|
|
8006a4e: 46bd mov sp, r7
|
|
8006a50: bd80 pop {r7, pc}
|
|
...
|
|
|
|
08006a54 <osMessageQueuePut>:
|
|
|
|
osStatus_t osMessageQueuePut (osMessageQueueId_t mq_id, const void *msg_ptr, uint8_t msg_prio, uint32_t timeout) {
|
|
8006a54: b580 push {r7, lr}
|
|
8006a56: b088 sub sp, #32
|
|
8006a58: af00 add r7, sp, #0
|
|
8006a5a: 60f8 str r0, [r7, #12]
|
|
8006a5c: 60b9 str r1, [r7, #8]
|
|
8006a5e: 603b str r3, [r7, #0]
|
|
8006a60: 4613 mov r3, r2
|
|
8006a62: 71fb strb r3, [r7, #7]
|
|
QueueHandle_t hQueue = (QueueHandle_t)mq_id;
|
|
8006a64: 68fb ldr r3, [r7, #12]
|
|
8006a66: 61bb str r3, [r7, #24]
|
|
osStatus_t stat;
|
|
BaseType_t yield;
|
|
|
|
(void)msg_prio; /* Message priority is ignored */
|
|
|
|
stat = osOK;
|
|
8006a68: 2300 movs r3, #0
|
|
8006a6a: 61fb str r3, [r7, #28]
|
|
__ASM volatile ("MRS %0, ipsr" : "=r" (result) );
|
|
8006a6c: f3ef 8305 mrs r3, IPSR
|
|
8006a70: 617b str r3, [r7, #20]
|
|
return(result);
|
|
8006a72: 697b ldr r3, [r7, #20]
|
|
|
|
if (IS_IRQ()) {
|
|
8006a74: 2b00 cmp r3, #0
|
|
8006a76: d028 beq.n 8006aca <osMessageQueuePut+0x76>
|
|
if ((hQueue == NULL) || (msg_ptr == NULL) || (timeout != 0U)) {
|
|
8006a78: 69bb ldr r3, [r7, #24]
|
|
8006a7a: 2b00 cmp r3, #0
|
|
8006a7c: d005 beq.n 8006a8a <osMessageQueuePut+0x36>
|
|
8006a7e: 68bb ldr r3, [r7, #8]
|
|
8006a80: 2b00 cmp r3, #0
|
|
8006a82: d002 beq.n 8006a8a <osMessageQueuePut+0x36>
|
|
8006a84: 683b ldr r3, [r7, #0]
|
|
8006a86: 2b00 cmp r3, #0
|
|
8006a88: d003 beq.n 8006a92 <osMessageQueuePut+0x3e>
|
|
stat = osErrorParameter;
|
|
8006a8a: f06f 0303 mvn.w r3, #3
|
|
8006a8e: 61fb str r3, [r7, #28]
|
|
8006a90: e038 b.n 8006b04 <osMessageQueuePut+0xb0>
|
|
}
|
|
else {
|
|
yield = pdFALSE;
|
|
8006a92: 2300 movs r3, #0
|
|
8006a94: 613b str r3, [r7, #16]
|
|
|
|
if (xQueueSendToBackFromISR (hQueue, msg_ptr, &yield) != pdTRUE) {
|
|
8006a96: f107 0210 add.w r2, r7, #16
|
|
8006a9a: 2300 movs r3, #0
|
|
8006a9c: 68b9 ldr r1, [r7, #8]
|
|
8006a9e: 69b8 ldr r0, [r7, #24]
|
|
8006aa0: f000 fc34 bl 800730c <xQueueGenericSendFromISR>
|
|
8006aa4: 4603 mov r3, r0
|
|
8006aa6: 2b01 cmp r3, #1
|
|
8006aa8: d003 beq.n 8006ab2 <osMessageQueuePut+0x5e>
|
|
stat = osErrorResource;
|
|
8006aaa: f06f 0302 mvn.w r3, #2
|
|
8006aae: 61fb str r3, [r7, #28]
|
|
8006ab0: e028 b.n 8006b04 <osMessageQueuePut+0xb0>
|
|
} else {
|
|
portYIELD_FROM_ISR (yield);
|
|
8006ab2: 693b ldr r3, [r7, #16]
|
|
8006ab4: 2b00 cmp r3, #0
|
|
8006ab6: d025 beq.n 8006b04 <osMessageQueuePut+0xb0>
|
|
8006ab8: 4b15 ldr r3, [pc, #84] @ (8006b10 <osMessageQueuePut+0xbc>)
|
|
8006aba: f04f 5280 mov.w r2, #268435456 @ 0x10000000
|
|
8006abe: 601a str r2, [r3, #0]
|
|
8006ac0: f3bf 8f4f dsb sy
|
|
8006ac4: f3bf 8f6f isb sy
|
|
8006ac8: e01c b.n 8006b04 <osMessageQueuePut+0xb0>
|
|
}
|
|
}
|
|
}
|
|
else {
|
|
if ((hQueue == NULL) || (msg_ptr == NULL)) {
|
|
8006aca: 69bb ldr r3, [r7, #24]
|
|
8006acc: 2b00 cmp r3, #0
|
|
8006ace: d002 beq.n 8006ad6 <osMessageQueuePut+0x82>
|
|
8006ad0: 68bb ldr r3, [r7, #8]
|
|
8006ad2: 2b00 cmp r3, #0
|
|
8006ad4: d103 bne.n 8006ade <osMessageQueuePut+0x8a>
|
|
stat = osErrorParameter;
|
|
8006ad6: f06f 0303 mvn.w r3, #3
|
|
8006ada: 61fb str r3, [r7, #28]
|
|
8006adc: e012 b.n 8006b04 <osMessageQueuePut+0xb0>
|
|
}
|
|
else {
|
|
if (xQueueSendToBack (hQueue, msg_ptr, (TickType_t)timeout) != pdPASS) {
|
|
8006ade: 2300 movs r3, #0
|
|
8006ae0: 683a ldr r2, [r7, #0]
|
|
8006ae2: 68b9 ldr r1, [r7, #8]
|
|
8006ae4: 69b8 ldr r0, [r7, #24]
|
|
8006ae6: f000 fb0f bl 8007108 <xQueueGenericSend>
|
|
8006aea: 4603 mov r3, r0
|
|
8006aec: 2b01 cmp r3, #1
|
|
8006aee: d009 beq.n 8006b04 <osMessageQueuePut+0xb0>
|
|
if (timeout != 0U) {
|
|
8006af0: 683b ldr r3, [r7, #0]
|
|
8006af2: 2b00 cmp r3, #0
|
|
8006af4: d003 beq.n 8006afe <osMessageQueuePut+0xaa>
|
|
stat = osErrorTimeout;
|
|
8006af6: f06f 0301 mvn.w r3, #1
|
|
8006afa: 61fb str r3, [r7, #28]
|
|
8006afc: e002 b.n 8006b04 <osMessageQueuePut+0xb0>
|
|
} else {
|
|
stat = osErrorResource;
|
|
8006afe: f06f 0302 mvn.w r3, #2
|
|
8006b02: 61fb str r3, [r7, #28]
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
return (stat);
|
|
8006b04: 69fb ldr r3, [r7, #28]
|
|
}
|
|
8006b06: 4618 mov r0, r3
|
|
8006b08: 3720 adds r7, #32
|
|
8006b0a: 46bd mov sp, r7
|
|
8006b0c: bd80 pop {r7, pc}
|
|
8006b0e: bf00 nop
|
|
8006b10: e000ed04 .word 0xe000ed04
|
|
|
|
08006b14 <osMessageQueueGet>:
|
|
|
|
osStatus_t osMessageQueueGet (osMessageQueueId_t mq_id, void *msg_ptr, uint8_t *msg_prio, uint32_t timeout) {
|
|
8006b14: b580 push {r7, lr}
|
|
8006b16: b088 sub sp, #32
|
|
8006b18: af00 add r7, sp, #0
|
|
8006b1a: 60f8 str r0, [r7, #12]
|
|
8006b1c: 60b9 str r1, [r7, #8]
|
|
8006b1e: 607a str r2, [r7, #4]
|
|
8006b20: 603b str r3, [r7, #0]
|
|
QueueHandle_t hQueue = (QueueHandle_t)mq_id;
|
|
8006b22: 68fb ldr r3, [r7, #12]
|
|
8006b24: 61bb str r3, [r7, #24]
|
|
osStatus_t stat;
|
|
BaseType_t yield;
|
|
|
|
(void)msg_prio; /* Message priority is ignored */
|
|
|
|
stat = osOK;
|
|
8006b26: 2300 movs r3, #0
|
|
8006b28: 61fb str r3, [r7, #28]
|
|
__ASM volatile ("MRS %0, ipsr" : "=r" (result) );
|
|
8006b2a: f3ef 8305 mrs r3, IPSR
|
|
8006b2e: 617b str r3, [r7, #20]
|
|
return(result);
|
|
8006b30: 697b ldr r3, [r7, #20]
|
|
|
|
if (IS_IRQ()) {
|
|
8006b32: 2b00 cmp r3, #0
|
|
8006b34: d028 beq.n 8006b88 <osMessageQueueGet+0x74>
|
|
if ((hQueue == NULL) || (msg_ptr == NULL) || (timeout != 0U)) {
|
|
8006b36: 69bb ldr r3, [r7, #24]
|
|
8006b38: 2b00 cmp r3, #0
|
|
8006b3a: d005 beq.n 8006b48 <osMessageQueueGet+0x34>
|
|
8006b3c: 68bb ldr r3, [r7, #8]
|
|
8006b3e: 2b00 cmp r3, #0
|
|
8006b40: d002 beq.n 8006b48 <osMessageQueueGet+0x34>
|
|
8006b42: 683b ldr r3, [r7, #0]
|
|
8006b44: 2b00 cmp r3, #0
|
|
8006b46: d003 beq.n 8006b50 <osMessageQueueGet+0x3c>
|
|
stat = osErrorParameter;
|
|
8006b48: f06f 0303 mvn.w r3, #3
|
|
8006b4c: 61fb str r3, [r7, #28]
|
|
8006b4e: e037 b.n 8006bc0 <osMessageQueueGet+0xac>
|
|
}
|
|
else {
|
|
yield = pdFALSE;
|
|
8006b50: 2300 movs r3, #0
|
|
8006b52: 613b str r3, [r7, #16]
|
|
|
|
if (xQueueReceiveFromISR (hQueue, msg_ptr, &yield) != pdPASS) {
|
|
8006b54: f107 0310 add.w r3, r7, #16
|
|
8006b58: 461a mov r2, r3
|
|
8006b5a: 68b9 ldr r1, [r7, #8]
|
|
8006b5c: 69b8 ldr r0, [r7, #24]
|
|
8006b5e: f000 fef5 bl 800794c <xQueueReceiveFromISR>
|
|
8006b62: 4603 mov r3, r0
|
|
8006b64: 2b01 cmp r3, #1
|
|
8006b66: d003 beq.n 8006b70 <osMessageQueueGet+0x5c>
|
|
stat = osErrorResource;
|
|
8006b68: f06f 0302 mvn.w r3, #2
|
|
8006b6c: 61fb str r3, [r7, #28]
|
|
8006b6e: e027 b.n 8006bc0 <osMessageQueueGet+0xac>
|
|
} else {
|
|
portYIELD_FROM_ISR (yield);
|
|
8006b70: 693b ldr r3, [r7, #16]
|
|
8006b72: 2b00 cmp r3, #0
|
|
8006b74: d024 beq.n 8006bc0 <osMessageQueueGet+0xac>
|
|
8006b76: 4b15 ldr r3, [pc, #84] @ (8006bcc <osMessageQueueGet+0xb8>)
|
|
8006b78: f04f 5280 mov.w r2, #268435456 @ 0x10000000
|
|
8006b7c: 601a str r2, [r3, #0]
|
|
8006b7e: f3bf 8f4f dsb sy
|
|
8006b82: f3bf 8f6f isb sy
|
|
8006b86: e01b b.n 8006bc0 <osMessageQueueGet+0xac>
|
|
}
|
|
}
|
|
}
|
|
else {
|
|
if ((hQueue == NULL) || (msg_ptr == NULL)) {
|
|
8006b88: 69bb ldr r3, [r7, #24]
|
|
8006b8a: 2b00 cmp r3, #0
|
|
8006b8c: d002 beq.n 8006b94 <osMessageQueueGet+0x80>
|
|
8006b8e: 68bb ldr r3, [r7, #8]
|
|
8006b90: 2b00 cmp r3, #0
|
|
8006b92: d103 bne.n 8006b9c <osMessageQueueGet+0x88>
|
|
stat = osErrorParameter;
|
|
8006b94: f06f 0303 mvn.w r3, #3
|
|
8006b98: 61fb str r3, [r7, #28]
|
|
8006b9a: e011 b.n 8006bc0 <osMessageQueueGet+0xac>
|
|
}
|
|
else {
|
|
if (xQueueReceive (hQueue, msg_ptr, (TickType_t)timeout) != pdPASS) {
|
|
8006b9c: 683a ldr r2, [r7, #0]
|
|
8006b9e: 68b9 ldr r1, [r7, #8]
|
|
8006ba0: 69b8 ldr r0, [r7, #24]
|
|
8006ba2: f000 fce1 bl 8007568 <xQueueReceive>
|
|
8006ba6: 4603 mov r3, r0
|
|
8006ba8: 2b01 cmp r3, #1
|
|
8006baa: d009 beq.n 8006bc0 <osMessageQueueGet+0xac>
|
|
if (timeout != 0U) {
|
|
8006bac: 683b ldr r3, [r7, #0]
|
|
8006bae: 2b00 cmp r3, #0
|
|
8006bb0: d003 beq.n 8006bba <osMessageQueueGet+0xa6>
|
|
stat = osErrorTimeout;
|
|
8006bb2: f06f 0301 mvn.w r3, #1
|
|
8006bb6: 61fb str r3, [r7, #28]
|
|
8006bb8: e002 b.n 8006bc0 <osMessageQueueGet+0xac>
|
|
} else {
|
|
stat = osErrorResource;
|
|
8006bba: f06f 0302 mvn.w r3, #2
|
|
8006bbe: 61fb str r3, [r7, #28]
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
return (stat);
|
|
8006bc0: 69fb ldr r3, [r7, #28]
|
|
}
|
|
8006bc2: 4618 mov r0, r3
|
|
8006bc4: 3720 adds r7, #32
|
|
8006bc6: 46bd mov sp, r7
|
|
8006bc8: bd80 pop {r7, pc}
|
|
8006bca: bf00 nop
|
|
8006bcc: e000ed04 .word 0xe000ed04
|
|
|
|
08006bd0 <vApplicationGetIdleTaskMemory>:
|
|
|
|
/*
|
|
vApplicationGetIdleTaskMemory gets called when configSUPPORT_STATIC_ALLOCATION
|
|
equals to 1 and is required for static memory allocation support.
|
|
*/
|
|
__WEAK void vApplicationGetIdleTaskMemory (StaticTask_t **ppxIdleTaskTCBBuffer, StackType_t **ppxIdleTaskStackBuffer, uint32_t *pulIdleTaskStackSize) {
|
|
8006bd0: b480 push {r7}
|
|
8006bd2: b085 sub sp, #20
|
|
8006bd4: af00 add r7, sp, #0
|
|
8006bd6: 60f8 str r0, [r7, #12]
|
|
8006bd8: 60b9 str r1, [r7, #8]
|
|
8006bda: 607a str r2, [r7, #4]
|
|
/* Idle task control block and stack */
|
|
static StaticTask_t Idle_TCB;
|
|
static StackType_t Idle_Stack[configMINIMAL_STACK_SIZE];
|
|
|
|
*ppxIdleTaskTCBBuffer = &Idle_TCB;
|
|
8006bdc: 68fb ldr r3, [r7, #12]
|
|
8006bde: 4a07 ldr r2, [pc, #28] @ (8006bfc <vApplicationGetIdleTaskMemory+0x2c>)
|
|
8006be0: 601a str r2, [r3, #0]
|
|
*ppxIdleTaskStackBuffer = &Idle_Stack[0];
|
|
8006be2: 68bb ldr r3, [r7, #8]
|
|
8006be4: 4a06 ldr r2, [pc, #24] @ (8006c00 <vApplicationGetIdleTaskMemory+0x30>)
|
|
8006be6: 601a str r2, [r3, #0]
|
|
*pulIdleTaskStackSize = (uint32_t)configMINIMAL_STACK_SIZE;
|
|
8006be8: 687b ldr r3, [r7, #4]
|
|
8006bea: 2280 movs r2, #128 @ 0x80
|
|
8006bec: 601a str r2, [r3, #0]
|
|
}
|
|
8006bee: bf00 nop
|
|
8006bf0: 3714 adds r7, #20
|
|
8006bf2: 46bd mov sp, r7
|
|
8006bf4: f85d 7b04 ldr.w r7, [sp], #4
|
|
8006bf8: 4770 bx lr
|
|
8006bfa: bf00 nop
|
|
8006bfc: 20000330 .word 0x20000330
|
|
8006c00: 200003d8 .word 0x200003d8
|
|
|
|
08006c04 <vApplicationGetTimerTaskMemory>:
|
|
|
|
/*
|
|
vApplicationGetTimerTaskMemory gets called when configSUPPORT_STATIC_ALLOCATION
|
|
equals to 1 and is required for static memory allocation support.
|
|
*/
|
|
__WEAK void vApplicationGetTimerTaskMemory (StaticTask_t **ppxTimerTaskTCBBuffer, StackType_t **ppxTimerTaskStackBuffer, uint32_t *pulTimerTaskStackSize) {
|
|
8006c04: b480 push {r7}
|
|
8006c06: b085 sub sp, #20
|
|
8006c08: af00 add r7, sp, #0
|
|
8006c0a: 60f8 str r0, [r7, #12]
|
|
8006c0c: 60b9 str r1, [r7, #8]
|
|
8006c0e: 607a str r2, [r7, #4]
|
|
/* Timer task control block and stack */
|
|
static StaticTask_t Timer_TCB;
|
|
static StackType_t Timer_Stack[configTIMER_TASK_STACK_DEPTH];
|
|
|
|
*ppxTimerTaskTCBBuffer = &Timer_TCB;
|
|
8006c10: 68fb ldr r3, [r7, #12]
|
|
8006c12: 4a07 ldr r2, [pc, #28] @ (8006c30 <vApplicationGetTimerTaskMemory+0x2c>)
|
|
8006c14: 601a str r2, [r3, #0]
|
|
*ppxTimerTaskStackBuffer = &Timer_Stack[0];
|
|
8006c16: 68bb ldr r3, [r7, #8]
|
|
8006c18: 4a06 ldr r2, [pc, #24] @ (8006c34 <vApplicationGetTimerTaskMemory+0x30>)
|
|
8006c1a: 601a str r2, [r3, #0]
|
|
*pulTimerTaskStackSize = (uint32_t)configTIMER_TASK_STACK_DEPTH;
|
|
8006c1c: 687b ldr r3, [r7, #4]
|
|
8006c1e: f44f 7280 mov.w r2, #256 @ 0x100
|
|
8006c22: 601a str r2, [r3, #0]
|
|
}
|
|
8006c24: bf00 nop
|
|
8006c26: 3714 adds r7, #20
|
|
8006c28: 46bd mov sp, r7
|
|
8006c2a: f85d 7b04 ldr.w r7, [sp], #4
|
|
8006c2e: 4770 bx lr
|
|
8006c30: 200005d8 .word 0x200005d8
|
|
8006c34: 20000680 .word 0x20000680
|
|
|
|
08006c38 <vListInitialise>:
|
|
/*-----------------------------------------------------------
|
|
* PUBLIC LIST API documented in list.h
|
|
*----------------------------------------------------------*/
|
|
|
|
void vListInitialise( List_t * const pxList )
|
|
{
|
|
8006c38: b480 push {r7}
|
|
8006c3a: b083 sub sp, #12
|
|
8006c3c: af00 add r7, sp, #0
|
|
8006c3e: 6078 str r0, [r7, #4]
|
|
/* The list structure contains a list item which is used to mark the
|
|
end of the list. To initialise the list the list end is inserted
|
|
as the only list entry. */
|
|
pxList->pxIndex = ( ListItem_t * ) &( pxList->xListEnd ); /*lint !e826 !e740 !e9087 The mini list structure is used as the list end to save RAM. This is checked and valid. */
|
|
8006c40: 687b ldr r3, [r7, #4]
|
|
8006c42: f103 0208 add.w r2, r3, #8
|
|
8006c46: 687b ldr r3, [r7, #4]
|
|
8006c48: 605a str r2, [r3, #4]
|
|
|
|
/* The list end value is the highest possible value in the list to
|
|
ensure it remains at the end of the list. */
|
|
pxList->xListEnd.xItemValue = portMAX_DELAY;
|
|
8006c4a: 687b ldr r3, [r7, #4]
|
|
8006c4c: f04f 32ff mov.w r2, #4294967295 @ 0xffffffff
|
|
8006c50: 609a str r2, [r3, #8]
|
|
|
|
/* The list end next and previous pointers point to itself so we know
|
|
when the list is empty. */
|
|
pxList->xListEnd.pxNext = ( ListItem_t * ) &( pxList->xListEnd ); /*lint !e826 !e740 !e9087 The mini list structure is used as the list end to save RAM. This is checked and valid. */
|
|
8006c52: 687b ldr r3, [r7, #4]
|
|
8006c54: f103 0208 add.w r2, r3, #8
|
|
8006c58: 687b ldr r3, [r7, #4]
|
|
8006c5a: 60da str r2, [r3, #12]
|
|
pxList->xListEnd.pxPrevious = ( ListItem_t * ) &( pxList->xListEnd );/*lint !e826 !e740 !e9087 The mini list structure is used as the list end to save RAM. This is checked and valid. */
|
|
8006c5c: 687b ldr r3, [r7, #4]
|
|
8006c5e: f103 0208 add.w r2, r3, #8
|
|
8006c62: 687b ldr r3, [r7, #4]
|
|
8006c64: 611a str r2, [r3, #16]
|
|
|
|
pxList->uxNumberOfItems = ( UBaseType_t ) 0U;
|
|
8006c66: 687b ldr r3, [r7, #4]
|
|
8006c68: 2200 movs r2, #0
|
|
8006c6a: 601a str r2, [r3, #0]
|
|
|
|
/* Write known values into the list if
|
|
configUSE_LIST_DATA_INTEGRITY_CHECK_BYTES is set to 1. */
|
|
listSET_LIST_INTEGRITY_CHECK_1_VALUE( pxList );
|
|
listSET_LIST_INTEGRITY_CHECK_2_VALUE( pxList );
|
|
}
|
|
8006c6c: bf00 nop
|
|
8006c6e: 370c adds r7, #12
|
|
8006c70: 46bd mov sp, r7
|
|
8006c72: f85d 7b04 ldr.w r7, [sp], #4
|
|
8006c76: 4770 bx lr
|
|
|
|
08006c78 <vListInitialiseItem>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
void vListInitialiseItem( ListItem_t * const pxItem )
|
|
{
|
|
8006c78: b480 push {r7}
|
|
8006c7a: b083 sub sp, #12
|
|
8006c7c: af00 add r7, sp, #0
|
|
8006c7e: 6078 str r0, [r7, #4]
|
|
/* Make sure the list item is not recorded as being on a list. */
|
|
pxItem->pxContainer = NULL;
|
|
8006c80: 687b ldr r3, [r7, #4]
|
|
8006c82: 2200 movs r2, #0
|
|
8006c84: 611a str r2, [r3, #16]
|
|
|
|
/* Write known values into the list item if
|
|
configUSE_LIST_DATA_INTEGRITY_CHECK_BYTES is set to 1. */
|
|
listSET_FIRST_LIST_ITEM_INTEGRITY_CHECK_VALUE( pxItem );
|
|
listSET_SECOND_LIST_ITEM_INTEGRITY_CHECK_VALUE( pxItem );
|
|
}
|
|
8006c86: bf00 nop
|
|
8006c88: 370c adds r7, #12
|
|
8006c8a: 46bd mov sp, r7
|
|
8006c8c: f85d 7b04 ldr.w r7, [sp], #4
|
|
8006c90: 4770 bx lr
|
|
|
|
08006c92 <vListInsertEnd>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
void vListInsertEnd( List_t * const pxList, ListItem_t * const pxNewListItem )
|
|
{
|
|
8006c92: b480 push {r7}
|
|
8006c94: b085 sub sp, #20
|
|
8006c96: af00 add r7, sp, #0
|
|
8006c98: 6078 str r0, [r7, #4]
|
|
8006c9a: 6039 str r1, [r7, #0]
|
|
ListItem_t * const pxIndex = pxList->pxIndex;
|
|
8006c9c: 687b ldr r3, [r7, #4]
|
|
8006c9e: 685b ldr r3, [r3, #4]
|
|
8006ca0: 60fb str r3, [r7, #12]
|
|
listTEST_LIST_ITEM_INTEGRITY( pxNewListItem );
|
|
|
|
/* Insert a new list item into pxList, but rather than sort the list,
|
|
makes the new list item the last item to be removed by a call to
|
|
listGET_OWNER_OF_NEXT_ENTRY(). */
|
|
pxNewListItem->pxNext = pxIndex;
|
|
8006ca2: 683b ldr r3, [r7, #0]
|
|
8006ca4: 68fa ldr r2, [r7, #12]
|
|
8006ca6: 605a str r2, [r3, #4]
|
|
pxNewListItem->pxPrevious = pxIndex->pxPrevious;
|
|
8006ca8: 68fb ldr r3, [r7, #12]
|
|
8006caa: 689a ldr r2, [r3, #8]
|
|
8006cac: 683b ldr r3, [r7, #0]
|
|
8006cae: 609a str r2, [r3, #8]
|
|
|
|
/* Only used during decision coverage testing. */
|
|
mtCOVERAGE_TEST_DELAY();
|
|
|
|
pxIndex->pxPrevious->pxNext = pxNewListItem;
|
|
8006cb0: 68fb ldr r3, [r7, #12]
|
|
8006cb2: 689b ldr r3, [r3, #8]
|
|
8006cb4: 683a ldr r2, [r7, #0]
|
|
8006cb6: 605a str r2, [r3, #4]
|
|
pxIndex->pxPrevious = pxNewListItem;
|
|
8006cb8: 68fb ldr r3, [r7, #12]
|
|
8006cba: 683a ldr r2, [r7, #0]
|
|
8006cbc: 609a str r2, [r3, #8]
|
|
|
|
/* Remember which list the item is in. */
|
|
pxNewListItem->pxContainer = pxList;
|
|
8006cbe: 683b ldr r3, [r7, #0]
|
|
8006cc0: 687a ldr r2, [r7, #4]
|
|
8006cc2: 611a str r2, [r3, #16]
|
|
|
|
( pxList->uxNumberOfItems )++;
|
|
8006cc4: 687b ldr r3, [r7, #4]
|
|
8006cc6: 681b ldr r3, [r3, #0]
|
|
8006cc8: 1c5a adds r2, r3, #1
|
|
8006cca: 687b ldr r3, [r7, #4]
|
|
8006ccc: 601a str r2, [r3, #0]
|
|
}
|
|
8006cce: bf00 nop
|
|
8006cd0: 3714 adds r7, #20
|
|
8006cd2: 46bd mov sp, r7
|
|
8006cd4: f85d 7b04 ldr.w r7, [sp], #4
|
|
8006cd8: 4770 bx lr
|
|
|
|
08006cda <vListInsert>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
void vListInsert( List_t * const pxList, ListItem_t * const pxNewListItem )
|
|
{
|
|
8006cda: b480 push {r7}
|
|
8006cdc: b085 sub sp, #20
|
|
8006cde: af00 add r7, sp, #0
|
|
8006ce0: 6078 str r0, [r7, #4]
|
|
8006ce2: 6039 str r1, [r7, #0]
|
|
ListItem_t *pxIterator;
|
|
const TickType_t xValueOfInsertion = pxNewListItem->xItemValue;
|
|
8006ce4: 683b ldr r3, [r7, #0]
|
|
8006ce6: 681b ldr r3, [r3, #0]
|
|
8006ce8: 60bb str r3, [r7, #8]
|
|
new list item should be placed after it. This ensures that TCBs which are
|
|
stored in ready lists (all of which have the same xItemValue value) get a
|
|
share of the CPU. However, if the xItemValue is the same as the back marker
|
|
the iteration loop below will not end. Therefore the value is checked
|
|
first, and the algorithm slightly modified if necessary. */
|
|
if( xValueOfInsertion == portMAX_DELAY )
|
|
8006cea: 68bb ldr r3, [r7, #8]
|
|
8006cec: f1b3 3fff cmp.w r3, #4294967295 @ 0xffffffff
|
|
8006cf0: d103 bne.n 8006cfa <vListInsert+0x20>
|
|
{
|
|
pxIterator = pxList->xListEnd.pxPrevious;
|
|
8006cf2: 687b ldr r3, [r7, #4]
|
|
8006cf4: 691b ldr r3, [r3, #16]
|
|
8006cf6: 60fb str r3, [r7, #12]
|
|
8006cf8: e00c b.n 8006d14 <vListInsert+0x3a>
|
|
4) Using a queue or semaphore before it has been initialised or
|
|
before the scheduler has been started (are interrupts firing
|
|
before vTaskStartScheduler() has been called?).
|
|
**********************************************************************/
|
|
|
|
for( pxIterator = ( ListItem_t * ) &( pxList->xListEnd ); pxIterator->pxNext->xItemValue <= xValueOfInsertion; pxIterator = pxIterator->pxNext ) /*lint !e826 !e740 !e9087 The mini list structure is used as the list end to save RAM. This is checked and valid. *//*lint !e440 The iterator moves to a different value, not xValueOfInsertion. */
|
|
8006cfa: 687b ldr r3, [r7, #4]
|
|
8006cfc: 3308 adds r3, #8
|
|
8006cfe: 60fb str r3, [r7, #12]
|
|
8006d00: e002 b.n 8006d08 <vListInsert+0x2e>
|
|
8006d02: 68fb ldr r3, [r7, #12]
|
|
8006d04: 685b ldr r3, [r3, #4]
|
|
8006d06: 60fb str r3, [r7, #12]
|
|
8006d08: 68fb ldr r3, [r7, #12]
|
|
8006d0a: 685b ldr r3, [r3, #4]
|
|
8006d0c: 681b ldr r3, [r3, #0]
|
|
8006d0e: 68ba ldr r2, [r7, #8]
|
|
8006d10: 429a cmp r2, r3
|
|
8006d12: d2f6 bcs.n 8006d02 <vListInsert+0x28>
|
|
/* There is nothing to do here, just iterating to the wanted
|
|
insertion position. */
|
|
}
|
|
}
|
|
|
|
pxNewListItem->pxNext = pxIterator->pxNext;
|
|
8006d14: 68fb ldr r3, [r7, #12]
|
|
8006d16: 685a ldr r2, [r3, #4]
|
|
8006d18: 683b ldr r3, [r7, #0]
|
|
8006d1a: 605a str r2, [r3, #4]
|
|
pxNewListItem->pxNext->pxPrevious = pxNewListItem;
|
|
8006d1c: 683b ldr r3, [r7, #0]
|
|
8006d1e: 685b ldr r3, [r3, #4]
|
|
8006d20: 683a ldr r2, [r7, #0]
|
|
8006d22: 609a str r2, [r3, #8]
|
|
pxNewListItem->pxPrevious = pxIterator;
|
|
8006d24: 683b ldr r3, [r7, #0]
|
|
8006d26: 68fa ldr r2, [r7, #12]
|
|
8006d28: 609a str r2, [r3, #8]
|
|
pxIterator->pxNext = pxNewListItem;
|
|
8006d2a: 68fb ldr r3, [r7, #12]
|
|
8006d2c: 683a ldr r2, [r7, #0]
|
|
8006d2e: 605a str r2, [r3, #4]
|
|
|
|
/* Remember which list the item is in. This allows fast removal of the
|
|
item later. */
|
|
pxNewListItem->pxContainer = pxList;
|
|
8006d30: 683b ldr r3, [r7, #0]
|
|
8006d32: 687a ldr r2, [r7, #4]
|
|
8006d34: 611a str r2, [r3, #16]
|
|
|
|
( pxList->uxNumberOfItems )++;
|
|
8006d36: 687b ldr r3, [r7, #4]
|
|
8006d38: 681b ldr r3, [r3, #0]
|
|
8006d3a: 1c5a adds r2, r3, #1
|
|
8006d3c: 687b ldr r3, [r7, #4]
|
|
8006d3e: 601a str r2, [r3, #0]
|
|
}
|
|
8006d40: bf00 nop
|
|
8006d42: 3714 adds r7, #20
|
|
8006d44: 46bd mov sp, r7
|
|
8006d46: f85d 7b04 ldr.w r7, [sp], #4
|
|
8006d4a: 4770 bx lr
|
|
|
|
08006d4c <uxListRemove>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
UBaseType_t uxListRemove( ListItem_t * const pxItemToRemove )
|
|
{
|
|
8006d4c: b480 push {r7}
|
|
8006d4e: b085 sub sp, #20
|
|
8006d50: af00 add r7, sp, #0
|
|
8006d52: 6078 str r0, [r7, #4]
|
|
/* The list item knows which list it is in. Obtain the list from the list
|
|
item. */
|
|
List_t * const pxList = pxItemToRemove->pxContainer;
|
|
8006d54: 687b ldr r3, [r7, #4]
|
|
8006d56: 691b ldr r3, [r3, #16]
|
|
8006d58: 60fb str r3, [r7, #12]
|
|
|
|
pxItemToRemove->pxNext->pxPrevious = pxItemToRemove->pxPrevious;
|
|
8006d5a: 687b ldr r3, [r7, #4]
|
|
8006d5c: 685b ldr r3, [r3, #4]
|
|
8006d5e: 687a ldr r2, [r7, #4]
|
|
8006d60: 6892 ldr r2, [r2, #8]
|
|
8006d62: 609a str r2, [r3, #8]
|
|
pxItemToRemove->pxPrevious->pxNext = pxItemToRemove->pxNext;
|
|
8006d64: 687b ldr r3, [r7, #4]
|
|
8006d66: 689b ldr r3, [r3, #8]
|
|
8006d68: 687a ldr r2, [r7, #4]
|
|
8006d6a: 6852 ldr r2, [r2, #4]
|
|
8006d6c: 605a str r2, [r3, #4]
|
|
|
|
/* Only used during decision coverage testing. */
|
|
mtCOVERAGE_TEST_DELAY();
|
|
|
|
/* Make sure the index is left pointing to a valid item. */
|
|
if( pxList->pxIndex == pxItemToRemove )
|
|
8006d6e: 68fb ldr r3, [r7, #12]
|
|
8006d70: 685b ldr r3, [r3, #4]
|
|
8006d72: 687a ldr r2, [r7, #4]
|
|
8006d74: 429a cmp r2, r3
|
|
8006d76: d103 bne.n 8006d80 <uxListRemove+0x34>
|
|
{
|
|
pxList->pxIndex = pxItemToRemove->pxPrevious;
|
|
8006d78: 687b ldr r3, [r7, #4]
|
|
8006d7a: 689a ldr r2, [r3, #8]
|
|
8006d7c: 68fb ldr r3, [r7, #12]
|
|
8006d7e: 605a str r2, [r3, #4]
|
|
else
|
|
{
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
|
|
pxItemToRemove->pxContainer = NULL;
|
|
8006d80: 687b ldr r3, [r7, #4]
|
|
8006d82: 2200 movs r2, #0
|
|
8006d84: 611a str r2, [r3, #16]
|
|
( pxList->uxNumberOfItems )--;
|
|
8006d86: 68fb ldr r3, [r7, #12]
|
|
8006d88: 681b ldr r3, [r3, #0]
|
|
8006d8a: 1e5a subs r2, r3, #1
|
|
8006d8c: 68fb ldr r3, [r7, #12]
|
|
8006d8e: 601a str r2, [r3, #0]
|
|
|
|
return pxList->uxNumberOfItems;
|
|
8006d90: 68fb ldr r3, [r7, #12]
|
|
8006d92: 681b ldr r3, [r3, #0]
|
|
}
|
|
8006d94: 4618 mov r0, r3
|
|
8006d96: 3714 adds r7, #20
|
|
8006d98: 46bd mov sp, r7
|
|
8006d9a: f85d 7b04 ldr.w r7, [sp], #4
|
|
8006d9e: 4770 bx lr
|
|
|
|
08006da0 <xQueueGenericReset>:
|
|
} \
|
|
taskEXIT_CRITICAL()
|
|
/*-----------------------------------------------------------*/
|
|
|
|
BaseType_t xQueueGenericReset( QueueHandle_t xQueue, BaseType_t xNewQueue )
|
|
{
|
|
8006da0: b580 push {r7, lr}
|
|
8006da2: b084 sub sp, #16
|
|
8006da4: af00 add r7, sp, #0
|
|
8006da6: 6078 str r0, [r7, #4]
|
|
8006da8: 6039 str r1, [r7, #0]
|
|
Queue_t * const pxQueue = xQueue;
|
|
8006daa: 687b ldr r3, [r7, #4]
|
|
8006dac: 60fb str r3, [r7, #12]
|
|
|
|
configASSERT( pxQueue );
|
|
8006dae: 68fb ldr r3, [r7, #12]
|
|
8006db0: 2b00 cmp r3, #0
|
|
8006db2: d10b bne.n 8006dcc <xQueueGenericReset+0x2c>
|
|
__asm volatile
|
|
8006db4: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8006db8: f383 8811 msr BASEPRI, r3
|
|
8006dbc: f3bf 8f6f isb sy
|
|
8006dc0: f3bf 8f4f dsb sy
|
|
8006dc4: 60bb str r3, [r7, #8]
|
|
}
|
|
8006dc6: bf00 nop
|
|
8006dc8: bf00 nop
|
|
8006dca: e7fd b.n 8006dc8 <xQueueGenericReset+0x28>
|
|
|
|
taskENTER_CRITICAL();
|
|
8006dcc: f002 fd64 bl 8009898 <vPortEnterCritical>
|
|
{
|
|
pxQueue->u.xQueue.pcTail = pxQueue->pcHead + ( pxQueue->uxLength * pxQueue->uxItemSize ); /*lint !e9016 Pointer arithmetic allowed on char types, especially when it assists conveying intent. */
|
|
8006dd0: 68fb ldr r3, [r7, #12]
|
|
8006dd2: 681a ldr r2, [r3, #0]
|
|
8006dd4: 68fb ldr r3, [r7, #12]
|
|
8006dd6: 6bdb ldr r3, [r3, #60] @ 0x3c
|
|
8006dd8: 68f9 ldr r1, [r7, #12]
|
|
8006dda: 6c09 ldr r1, [r1, #64] @ 0x40
|
|
8006ddc: fb01 f303 mul.w r3, r1, r3
|
|
8006de0: 441a add r2, r3
|
|
8006de2: 68fb ldr r3, [r7, #12]
|
|
8006de4: 609a str r2, [r3, #8]
|
|
pxQueue->uxMessagesWaiting = ( UBaseType_t ) 0U;
|
|
8006de6: 68fb ldr r3, [r7, #12]
|
|
8006de8: 2200 movs r2, #0
|
|
8006dea: 639a str r2, [r3, #56] @ 0x38
|
|
pxQueue->pcWriteTo = pxQueue->pcHead;
|
|
8006dec: 68fb ldr r3, [r7, #12]
|
|
8006dee: 681a ldr r2, [r3, #0]
|
|
8006df0: 68fb ldr r3, [r7, #12]
|
|
8006df2: 605a str r2, [r3, #4]
|
|
pxQueue->u.xQueue.pcReadFrom = pxQueue->pcHead + ( ( pxQueue->uxLength - 1U ) * pxQueue->uxItemSize ); /*lint !e9016 Pointer arithmetic allowed on char types, especially when it assists conveying intent. */
|
|
8006df4: 68fb ldr r3, [r7, #12]
|
|
8006df6: 681a ldr r2, [r3, #0]
|
|
8006df8: 68fb ldr r3, [r7, #12]
|
|
8006dfa: 6bdb ldr r3, [r3, #60] @ 0x3c
|
|
8006dfc: 3b01 subs r3, #1
|
|
8006dfe: 68f9 ldr r1, [r7, #12]
|
|
8006e00: 6c09 ldr r1, [r1, #64] @ 0x40
|
|
8006e02: fb01 f303 mul.w r3, r1, r3
|
|
8006e06: 441a add r2, r3
|
|
8006e08: 68fb ldr r3, [r7, #12]
|
|
8006e0a: 60da str r2, [r3, #12]
|
|
pxQueue->cRxLock = queueUNLOCKED;
|
|
8006e0c: 68fb ldr r3, [r7, #12]
|
|
8006e0e: 22ff movs r2, #255 @ 0xff
|
|
8006e10: f883 2044 strb.w r2, [r3, #68] @ 0x44
|
|
pxQueue->cTxLock = queueUNLOCKED;
|
|
8006e14: 68fb ldr r3, [r7, #12]
|
|
8006e16: 22ff movs r2, #255 @ 0xff
|
|
8006e18: f883 2045 strb.w r2, [r3, #69] @ 0x45
|
|
|
|
if( xNewQueue == pdFALSE )
|
|
8006e1c: 683b ldr r3, [r7, #0]
|
|
8006e1e: 2b00 cmp r3, #0
|
|
8006e20: d114 bne.n 8006e4c <xQueueGenericReset+0xac>
|
|
/* If there are tasks blocked waiting to read from the queue, then
|
|
the tasks will remain blocked as after this function exits the queue
|
|
will still be empty. If there are tasks blocked waiting to write to
|
|
the queue, then one should be unblocked as after this function exits
|
|
it will be possible to write to it. */
|
|
if( listLIST_IS_EMPTY( &( pxQueue->xTasksWaitingToSend ) ) == pdFALSE )
|
|
8006e22: 68fb ldr r3, [r7, #12]
|
|
8006e24: 691b ldr r3, [r3, #16]
|
|
8006e26: 2b00 cmp r3, #0
|
|
8006e28: d01a beq.n 8006e60 <xQueueGenericReset+0xc0>
|
|
{
|
|
if( xTaskRemoveFromEventList( &( pxQueue->xTasksWaitingToSend ) ) != pdFALSE )
|
|
8006e2a: 68fb ldr r3, [r7, #12]
|
|
8006e2c: 3310 adds r3, #16
|
|
8006e2e: 4618 mov r0, r3
|
|
8006e30: f001 fc3e bl 80086b0 <xTaskRemoveFromEventList>
|
|
8006e34: 4603 mov r3, r0
|
|
8006e36: 2b00 cmp r3, #0
|
|
8006e38: d012 beq.n 8006e60 <xQueueGenericReset+0xc0>
|
|
{
|
|
queueYIELD_IF_USING_PREEMPTION();
|
|
8006e3a: 4b0d ldr r3, [pc, #52] @ (8006e70 <xQueueGenericReset+0xd0>)
|
|
8006e3c: f04f 5280 mov.w r2, #268435456 @ 0x10000000
|
|
8006e40: 601a str r2, [r3, #0]
|
|
8006e42: f3bf 8f4f dsb sy
|
|
8006e46: f3bf 8f6f isb sy
|
|
8006e4a: e009 b.n 8006e60 <xQueueGenericReset+0xc0>
|
|
}
|
|
}
|
|
else
|
|
{
|
|
/* Ensure the event queues start in the correct state. */
|
|
vListInitialise( &( pxQueue->xTasksWaitingToSend ) );
|
|
8006e4c: 68fb ldr r3, [r7, #12]
|
|
8006e4e: 3310 adds r3, #16
|
|
8006e50: 4618 mov r0, r3
|
|
8006e52: f7ff fef1 bl 8006c38 <vListInitialise>
|
|
vListInitialise( &( pxQueue->xTasksWaitingToReceive ) );
|
|
8006e56: 68fb ldr r3, [r7, #12]
|
|
8006e58: 3324 adds r3, #36 @ 0x24
|
|
8006e5a: 4618 mov r0, r3
|
|
8006e5c: f7ff feec bl 8006c38 <vListInitialise>
|
|
}
|
|
}
|
|
taskEXIT_CRITICAL();
|
|
8006e60: f002 fd4c bl 80098fc <vPortExitCritical>
|
|
|
|
/* A value is returned for calling semantic consistency with previous
|
|
versions. */
|
|
return pdPASS;
|
|
8006e64: 2301 movs r3, #1
|
|
}
|
|
8006e66: 4618 mov r0, r3
|
|
8006e68: 3710 adds r7, #16
|
|
8006e6a: 46bd mov sp, r7
|
|
8006e6c: bd80 pop {r7, pc}
|
|
8006e6e: bf00 nop
|
|
8006e70: e000ed04 .word 0xe000ed04
|
|
|
|
08006e74 <xQueueGenericCreateStatic>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
#if( configSUPPORT_STATIC_ALLOCATION == 1 )
|
|
|
|
QueueHandle_t xQueueGenericCreateStatic( const UBaseType_t uxQueueLength, const UBaseType_t uxItemSize, uint8_t *pucQueueStorage, StaticQueue_t *pxStaticQueue, const uint8_t ucQueueType )
|
|
{
|
|
8006e74: b580 push {r7, lr}
|
|
8006e76: b08e sub sp, #56 @ 0x38
|
|
8006e78: af02 add r7, sp, #8
|
|
8006e7a: 60f8 str r0, [r7, #12]
|
|
8006e7c: 60b9 str r1, [r7, #8]
|
|
8006e7e: 607a str r2, [r7, #4]
|
|
8006e80: 603b str r3, [r7, #0]
|
|
Queue_t *pxNewQueue;
|
|
|
|
configASSERT( uxQueueLength > ( UBaseType_t ) 0 );
|
|
8006e82: 68fb ldr r3, [r7, #12]
|
|
8006e84: 2b00 cmp r3, #0
|
|
8006e86: d10b bne.n 8006ea0 <xQueueGenericCreateStatic+0x2c>
|
|
__asm volatile
|
|
8006e88: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8006e8c: f383 8811 msr BASEPRI, r3
|
|
8006e90: f3bf 8f6f isb sy
|
|
8006e94: f3bf 8f4f dsb sy
|
|
8006e98: 62bb str r3, [r7, #40] @ 0x28
|
|
}
|
|
8006e9a: bf00 nop
|
|
8006e9c: bf00 nop
|
|
8006e9e: e7fd b.n 8006e9c <xQueueGenericCreateStatic+0x28>
|
|
|
|
/* The StaticQueue_t structure and the queue storage area must be
|
|
supplied. */
|
|
configASSERT( pxStaticQueue != NULL );
|
|
8006ea0: 683b ldr r3, [r7, #0]
|
|
8006ea2: 2b00 cmp r3, #0
|
|
8006ea4: d10b bne.n 8006ebe <xQueueGenericCreateStatic+0x4a>
|
|
__asm volatile
|
|
8006ea6: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8006eaa: f383 8811 msr BASEPRI, r3
|
|
8006eae: f3bf 8f6f isb sy
|
|
8006eb2: f3bf 8f4f dsb sy
|
|
8006eb6: 627b str r3, [r7, #36] @ 0x24
|
|
}
|
|
8006eb8: bf00 nop
|
|
8006eba: bf00 nop
|
|
8006ebc: e7fd b.n 8006eba <xQueueGenericCreateStatic+0x46>
|
|
|
|
/* A queue storage area should be provided if the item size is not 0, and
|
|
should not be provided if the item size is 0. */
|
|
configASSERT( !( ( pucQueueStorage != NULL ) && ( uxItemSize == 0 ) ) );
|
|
8006ebe: 687b ldr r3, [r7, #4]
|
|
8006ec0: 2b00 cmp r3, #0
|
|
8006ec2: d002 beq.n 8006eca <xQueueGenericCreateStatic+0x56>
|
|
8006ec4: 68bb ldr r3, [r7, #8]
|
|
8006ec6: 2b00 cmp r3, #0
|
|
8006ec8: d001 beq.n 8006ece <xQueueGenericCreateStatic+0x5a>
|
|
8006eca: 2301 movs r3, #1
|
|
8006ecc: e000 b.n 8006ed0 <xQueueGenericCreateStatic+0x5c>
|
|
8006ece: 2300 movs r3, #0
|
|
8006ed0: 2b00 cmp r3, #0
|
|
8006ed2: d10b bne.n 8006eec <xQueueGenericCreateStatic+0x78>
|
|
__asm volatile
|
|
8006ed4: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8006ed8: f383 8811 msr BASEPRI, r3
|
|
8006edc: f3bf 8f6f isb sy
|
|
8006ee0: f3bf 8f4f dsb sy
|
|
8006ee4: 623b str r3, [r7, #32]
|
|
}
|
|
8006ee6: bf00 nop
|
|
8006ee8: bf00 nop
|
|
8006eea: e7fd b.n 8006ee8 <xQueueGenericCreateStatic+0x74>
|
|
configASSERT( !( ( pucQueueStorage == NULL ) && ( uxItemSize != 0 ) ) );
|
|
8006eec: 687b ldr r3, [r7, #4]
|
|
8006eee: 2b00 cmp r3, #0
|
|
8006ef0: d102 bne.n 8006ef8 <xQueueGenericCreateStatic+0x84>
|
|
8006ef2: 68bb ldr r3, [r7, #8]
|
|
8006ef4: 2b00 cmp r3, #0
|
|
8006ef6: d101 bne.n 8006efc <xQueueGenericCreateStatic+0x88>
|
|
8006ef8: 2301 movs r3, #1
|
|
8006efa: e000 b.n 8006efe <xQueueGenericCreateStatic+0x8a>
|
|
8006efc: 2300 movs r3, #0
|
|
8006efe: 2b00 cmp r3, #0
|
|
8006f00: d10b bne.n 8006f1a <xQueueGenericCreateStatic+0xa6>
|
|
__asm volatile
|
|
8006f02: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8006f06: f383 8811 msr BASEPRI, r3
|
|
8006f0a: f3bf 8f6f isb sy
|
|
8006f0e: f3bf 8f4f dsb sy
|
|
8006f12: 61fb str r3, [r7, #28]
|
|
}
|
|
8006f14: bf00 nop
|
|
8006f16: bf00 nop
|
|
8006f18: e7fd b.n 8006f16 <xQueueGenericCreateStatic+0xa2>
|
|
#if( configASSERT_DEFINED == 1 )
|
|
{
|
|
/* Sanity check that the size of the structure used to declare a
|
|
variable of type StaticQueue_t or StaticSemaphore_t equals the size of
|
|
the real queue and semaphore structures. */
|
|
volatile size_t xSize = sizeof( StaticQueue_t );
|
|
8006f1a: 2350 movs r3, #80 @ 0x50
|
|
8006f1c: 617b str r3, [r7, #20]
|
|
configASSERT( xSize == sizeof( Queue_t ) );
|
|
8006f1e: 697b ldr r3, [r7, #20]
|
|
8006f20: 2b50 cmp r3, #80 @ 0x50
|
|
8006f22: d00b beq.n 8006f3c <xQueueGenericCreateStatic+0xc8>
|
|
__asm volatile
|
|
8006f24: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8006f28: f383 8811 msr BASEPRI, r3
|
|
8006f2c: f3bf 8f6f isb sy
|
|
8006f30: f3bf 8f4f dsb sy
|
|
8006f34: 61bb str r3, [r7, #24]
|
|
}
|
|
8006f36: bf00 nop
|
|
8006f38: bf00 nop
|
|
8006f3a: e7fd b.n 8006f38 <xQueueGenericCreateStatic+0xc4>
|
|
( void ) xSize; /* Keeps lint quiet when configASSERT() is not defined. */
|
|
8006f3c: 697b ldr r3, [r7, #20]
|
|
#endif /* configASSERT_DEFINED */
|
|
|
|
/* The address of a statically allocated queue was passed in, use it.
|
|
The address of a statically allocated storage area was also passed in
|
|
but is already set. */
|
|
pxNewQueue = ( Queue_t * ) pxStaticQueue; /*lint !e740 !e9087 Unusual cast is ok as the structures are designed to have the same alignment, and the size is checked by an assert. */
|
|
8006f3e: 683b ldr r3, [r7, #0]
|
|
8006f40: 62fb str r3, [r7, #44] @ 0x2c
|
|
|
|
if( pxNewQueue != NULL )
|
|
8006f42: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
8006f44: 2b00 cmp r3, #0
|
|
8006f46: d00d beq.n 8006f64 <xQueueGenericCreateStatic+0xf0>
|
|
#if( configSUPPORT_DYNAMIC_ALLOCATION == 1 )
|
|
{
|
|
/* Queues can be allocated wither statically or dynamically, so
|
|
note this queue was allocated statically in case the queue is
|
|
later deleted. */
|
|
pxNewQueue->ucStaticallyAllocated = pdTRUE;
|
|
8006f48: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
8006f4a: 2201 movs r2, #1
|
|
8006f4c: f883 2046 strb.w r2, [r3, #70] @ 0x46
|
|
}
|
|
#endif /* configSUPPORT_DYNAMIC_ALLOCATION */
|
|
|
|
prvInitialiseNewQueue( uxQueueLength, uxItemSize, pucQueueStorage, ucQueueType, pxNewQueue );
|
|
8006f50: f897 2038 ldrb.w r2, [r7, #56] @ 0x38
|
|
8006f54: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
8006f56: 9300 str r3, [sp, #0]
|
|
8006f58: 4613 mov r3, r2
|
|
8006f5a: 687a ldr r2, [r7, #4]
|
|
8006f5c: 68b9 ldr r1, [r7, #8]
|
|
8006f5e: 68f8 ldr r0, [r7, #12]
|
|
8006f60: f000 f840 bl 8006fe4 <prvInitialiseNewQueue>
|
|
{
|
|
traceQUEUE_CREATE_FAILED( ucQueueType );
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
|
|
return pxNewQueue;
|
|
8006f64: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
}
|
|
8006f66: 4618 mov r0, r3
|
|
8006f68: 3730 adds r7, #48 @ 0x30
|
|
8006f6a: 46bd mov sp, r7
|
|
8006f6c: bd80 pop {r7, pc}
|
|
|
|
08006f6e <xQueueGenericCreate>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
#if( configSUPPORT_DYNAMIC_ALLOCATION == 1 )
|
|
|
|
QueueHandle_t xQueueGenericCreate( const UBaseType_t uxQueueLength, const UBaseType_t uxItemSize, const uint8_t ucQueueType )
|
|
{
|
|
8006f6e: b580 push {r7, lr}
|
|
8006f70: b08a sub sp, #40 @ 0x28
|
|
8006f72: af02 add r7, sp, #8
|
|
8006f74: 60f8 str r0, [r7, #12]
|
|
8006f76: 60b9 str r1, [r7, #8]
|
|
8006f78: 4613 mov r3, r2
|
|
8006f7a: 71fb strb r3, [r7, #7]
|
|
Queue_t *pxNewQueue;
|
|
size_t xQueueSizeInBytes;
|
|
uint8_t *pucQueueStorage;
|
|
|
|
configASSERT( uxQueueLength > ( UBaseType_t ) 0 );
|
|
8006f7c: 68fb ldr r3, [r7, #12]
|
|
8006f7e: 2b00 cmp r3, #0
|
|
8006f80: d10b bne.n 8006f9a <xQueueGenericCreate+0x2c>
|
|
__asm volatile
|
|
8006f82: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8006f86: f383 8811 msr BASEPRI, r3
|
|
8006f8a: f3bf 8f6f isb sy
|
|
8006f8e: f3bf 8f4f dsb sy
|
|
8006f92: 613b str r3, [r7, #16]
|
|
}
|
|
8006f94: bf00 nop
|
|
8006f96: bf00 nop
|
|
8006f98: e7fd b.n 8006f96 <xQueueGenericCreate+0x28>
|
|
|
|
/* Allocate enough space to hold the maximum number of items that
|
|
can be in the queue at any time. It is valid for uxItemSize to be
|
|
zero in the case the queue is used as a semaphore. */
|
|
xQueueSizeInBytes = ( size_t ) ( uxQueueLength * uxItemSize ); /*lint !e961 MISRA exception as the casts are only redundant for some ports. */
|
|
8006f9a: 68fb ldr r3, [r7, #12]
|
|
8006f9c: 68ba ldr r2, [r7, #8]
|
|
8006f9e: fb02 f303 mul.w r3, r2, r3
|
|
8006fa2: 61fb str r3, [r7, #28]
|
|
alignment requirements of the Queue_t structure - which in this case
|
|
is an int8_t *. Therefore, whenever the stack alignment requirements
|
|
are greater than or equal to the pointer to char requirements the cast
|
|
is safe. In other cases alignment requirements are not strict (one or
|
|
two bytes). */
|
|
pxNewQueue = ( Queue_t * ) pvPortMalloc( sizeof( Queue_t ) + xQueueSizeInBytes ); /*lint !e9087 !e9079 see comment above. */
|
|
8006fa4: 69fb ldr r3, [r7, #28]
|
|
8006fa6: 3350 adds r3, #80 @ 0x50
|
|
8006fa8: 4618 mov r0, r3
|
|
8006faa: f002 fd97 bl 8009adc <pvPortMalloc>
|
|
8006fae: 61b8 str r0, [r7, #24]
|
|
|
|
if( pxNewQueue != NULL )
|
|
8006fb0: 69bb ldr r3, [r7, #24]
|
|
8006fb2: 2b00 cmp r3, #0
|
|
8006fb4: d011 beq.n 8006fda <xQueueGenericCreate+0x6c>
|
|
{
|
|
/* Jump past the queue structure to find the location of the queue
|
|
storage area. */
|
|
pucQueueStorage = ( uint8_t * ) pxNewQueue;
|
|
8006fb6: 69bb ldr r3, [r7, #24]
|
|
8006fb8: 617b str r3, [r7, #20]
|
|
pucQueueStorage += sizeof( Queue_t ); /*lint !e9016 Pointer arithmetic allowed on char types, especially when it assists conveying intent. */
|
|
8006fba: 697b ldr r3, [r7, #20]
|
|
8006fbc: 3350 adds r3, #80 @ 0x50
|
|
8006fbe: 617b str r3, [r7, #20]
|
|
#if( configSUPPORT_STATIC_ALLOCATION == 1 )
|
|
{
|
|
/* Queues can be created either statically or dynamically, so
|
|
note this task was created dynamically in case it is later
|
|
deleted. */
|
|
pxNewQueue->ucStaticallyAllocated = pdFALSE;
|
|
8006fc0: 69bb ldr r3, [r7, #24]
|
|
8006fc2: 2200 movs r2, #0
|
|
8006fc4: f883 2046 strb.w r2, [r3, #70] @ 0x46
|
|
}
|
|
#endif /* configSUPPORT_STATIC_ALLOCATION */
|
|
|
|
prvInitialiseNewQueue( uxQueueLength, uxItemSize, pucQueueStorage, ucQueueType, pxNewQueue );
|
|
8006fc8: 79fa ldrb r2, [r7, #7]
|
|
8006fca: 69bb ldr r3, [r7, #24]
|
|
8006fcc: 9300 str r3, [sp, #0]
|
|
8006fce: 4613 mov r3, r2
|
|
8006fd0: 697a ldr r2, [r7, #20]
|
|
8006fd2: 68b9 ldr r1, [r7, #8]
|
|
8006fd4: 68f8 ldr r0, [r7, #12]
|
|
8006fd6: f000 f805 bl 8006fe4 <prvInitialiseNewQueue>
|
|
{
|
|
traceQUEUE_CREATE_FAILED( ucQueueType );
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
|
|
return pxNewQueue;
|
|
8006fda: 69bb ldr r3, [r7, #24]
|
|
}
|
|
8006fdc: 4618 mov r0, r3
|
|
8006fde: 3720 adds r7, #32
|
|
8006fe0: 46bd mov sp, r7
|
|
8006fe2: bd80 pop {r7, pc}
|
|
|
|
08006fe4 <prvInitialiseNewQueue>:
|
|
|
|
#endif /* configSUPPORT_STATIC_ALLOCATION */
|
|
/*-----------------------------------------------------------*/
|
|
|
|
static void prvInitialiseNewQueue( const UBaseType_t uxQueueLength, const UBaseType_t uxItemSize, uint8_t *pucQueueStorage, const uint8_t ucQueueType, Queue_t *pxNewQueue )
|
|
{
|
|
8006fe4: b580 push {r7, lr}
|
|
8006fe6: b084 sub sp, #16
|
|
8006fe8: af00 add r7, sp, #0
|
|
8006fea: 60f8 str r0, [r7, #12]
|
|
8006fec: 60b9 str r1, [r7, #8]
|
|
8006fee: 607a str r2, [r7, #4]
|
|
8006ff0: 70fb strb r3, [r7, #3]
|
|
/* Remove compiler warnings about unused parameters should
|
|
configUSE_TRACE_FACILITY not be set to 1. */
|
|
( void ) ucQueueType;
|
|
|
|
if( uxItemSize == ( UBaseType_t ) 0 )
|
|
8006ff2: 68bb ldr r3, [r7, #8]
|
|
8006ff4: 2b00 cmp r3, #0
|
|
8006ff6: d103 bne.n 8007000 <prvInitialiseNewQueue+0x1c>
|
|
{
|
|
/* No RAM was allocated for the queue storage area, but PC head cannot
|
|
be set to NULL because NULL is used as a key to say the queue is used as
|
|
a mutex. Therefore just set pcHead to point to the queue as a benign
|
|
value that is known to be within the memory map. */
|
|
pxNewQueue->pcHead = ( int8_t * ) pxNewQueue;
|
|
8006ff8: 69bb ldr r3, [r7, #24]
|
|
8006ffa: 69ba ldr r2, [r7, #24]
|
|
8006ffc: 601a str r2, [r3, #0]
|
|
8006ffe: e002 b.n 8007006 <prvInitialiseNewQueue+0x22>
|
|
}
|
|
else
|
|
{
|
|
/* Set the head to the start of the queue storage area. */
|
|
pxNewQueue->pcHead = ( int8_t * ) pucQueueStorage;
|
|
8007000: 69bb ldr r3, [r7, #24]
|
|
8007002: 687a ldr r2, [r7, #4]
|
|
8007004: 601a str r2, [r3, #0]
|
|
}
|
|
|
|
/* Initialise the queue members as described where the queue type is
|
|
defined. */
|
|
pxNewQueue->uxLength = uxQueueLength;
|
|
8007006: 69bb ldr r3, [r7, #24]
|
|
8007008: 68fa ldr r2, [r7, #12]
|
|
800700a: 63da str r2, [r3, #60] @ 0x3c
|
|
pxNewQueue->uxItemSize = uxItemSize;
|
|
800700c: 69bb ldr r3, [r7, #24]
|
|
800700e: 68ba ldr r2, [r7, #8]
|
|
8007010: 641a str r2, [r3, #64] @ 0x40
|
|
( void ) xQueueGenericReset( pxNewQueue, pdTRUE );
|
|
8007012: 2101 movs r1, #1
|
|
8007014: 69b8 ldr r0, [r7, #24]
|
|
8007016: f7ff fec3 bl 8006da0 <xQueueGenericReset>
|
|
|
|
#if ( configUSE_TRACE_FACILITY == 1 )
|
|
{
|
|
pxNewQueue->ucQueueType = ucQueueType;
|
|
800701a: 69bb ldr r3, [r7, #24]
|
|
800701c: 78fa ldrb r2, [r7, #3]
|
|
800701e: f883 204c strb.w r2, [r3, #76] @ 0x4c
|
|
pxNewQueue->pxQueueSetContainer = NULL;
|
|
}
|
|
#endif /* configUSE_QUEUE_SETS */
|
|
|
|
traceQUEUE_CREATE( pxNewQueue );
|
|
}
|
|
8007022: bf00 nop
|
|
8007024: 3710 adds r7, #16
|
|
8007026: 46bd mov sp, r7
|
|
8007028: bd80 pop {r7, pc}
|
|
|
|
0800702a <xQueueCreateCountingSemaphoreStatic>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
#if( ( configUSE_COUNTING_SEMAPHORES == 1 ) && ( configSUPPORT_STATIC_ALLOCATION == 1 ) )
|
|
|
|
QueueHandle_t xQueueCreateCountingSemaphoreStatic( const UBaseType_t uxMaxCount, const UBaseType_t uxInitialCount, StaticQueue_t *pxStaticQueue )
|
|
{
|
|
800702a: b580 push {r7, lr}
|
|
800702c: b08a sub sp, #40 @ 0x28
|
|
800702e: af02 add r7, sp, #8
|
|
8007030: 60f8 str r0, [r7, #12]
|
|
8007032: 60b9 str r1, [r7, #8]
|
|
8007034: 607a str r2, [r7, #4]
|
|
QueueHandle_t xHandle;
|
|
|
|
configASSERT( uxMaxCount != 0 );
|
|
8007036: 68fb ldr r3, [r7, #12]
|
|
8007038: 2b00 cmp r3, #0
|
|
800703a: d10b bne.n 8007054 <xQueueCreateCountingSemaphoreStatic+0x2a>
|
|
__asm volatile
|
|
800703c: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8007040: f383 8811 msr BASEPRI, r3
|
|
8007044: f3bf 8f6f isb sy
|
|
8007048: f3bf 8f4f dsb sy
|
|
800704c: 61bb str r3, [r7, #24]
|
|
}
|
|
800704e: bf00 nop
|
|
8007050: bf00 nop
|
|
8007052: e7fd b.n 8007050 <xQueueCreateCountingSemaphoreStatic+0x26>
|
|
configASSERT( uxInitialCount <= uxMaxCount );
|
|
8007054: 68ba ldr r2, [r7, #8]
|
|
8007056: 68fb ldr r3, [r7, #12]
|
|
8007058: 429a cmp r2, r3
|
|
800705a: d90b bls.n 8007074 <xQueueCreateCountingSemaphoreStatic+0x4a>
|
|
__asm volatile
|
|
800705c: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8007060: f383 8811 msr BASEPRI, r3
|
|
8007064: f3bf 8f6f isb sy
|
|
8007068: f3bf 8f4f dsb sy
|
|
800706c: 617b str r3, [r7, #20]
|
|
}
|
|
800706e: bf00 nop
|
|
8007070: bf00 nop
|
|
8007072: e7fd b.n 8007070 <xQueueCreateCountingSemaphoreStatic+0x46>
|
|
|
|
xHandle = xQueueGenericCreateStatic( uxMaxCount, queueSEMAPHORE_QUEUE_ITEM_LENGTH, NULL, pxStaticQueue, queueQUEUE_TYPE_COUNTING_SEMAPHORE );
|
|
8007074: 2302 movs r3, #2
|
|
8007076: 9300 str r3, [sp, #0]
|
|
8007078: 687b ldr r3, [r7, #4]
|
|
800707a: 2200 movs r2, #0
|
|
800707c: 2100 movs r1, #0
|
|
800707e: 68f8 ldr r0, [r7, #12]
|
|
8007080: f7ff fef8 bl 8006e74 <xQueueGenericCreateStatic>
|
|
8007084: 61f8 str r0, [r7, #28]
|
|
|
|
if( xHandle != NULL )
|
|
8007086: 69fb ldr r3, [r7, #28]
|
|
8007088: 2b00 cmp r3, #0
|
|
800708a: d002 beq.n 8007092 <xQueueCreateCountingSemaphoreStatic+0x68>
|
|
{
|
|
( ( Queue_t * ) xHandle )->uxMessagesWaiting = uxInitialCount;
|
|
800708c: 69fb ldr r3, [r7, #28]
|
|
800708e: 68ba ldr r2, [r7, #8]
|
|
8007090: 639a str r2, [r3, #56] @ 0x38
|
|
else
|
|
{
|
|
traceCREATE_COUNTING_SEMAPHORE_FAILED();
|
|
}
|
|
|
|
return xHandle;
|
|
8007092: 69fb ldr r3, [r7, #28]
|
|
}
|
|
8007094: 4618 mov r0, r3
|
|
8007096: 3720 adds r7, #32
|
|
8007098: 46bd mov sp, r7
|
|
800709a: bd80 pop {r7, pc}
|
|
|
|
0800709c <xQueueCreateCountingSemaphore>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
#if( ( configUSE_COUNTING_SEMAPHORES == 1 ) && ( configSUPPORT_DYNAMIC_ALLOCATION == 1 ) )
|
|
|
|
QueueHandle_t xQueueCreateCountingSemaphore( const UBaseType_t uxMaxCount, const UBaseType_t uxInitialCount )
|
|
{
|
|
800709c: b580 push {r7, lr}
|
|
800709e: b086 sub sp, #24
|
|
80070a0: af00 add r7, sp, #0
|
|
80070a2: 6078 str r0, [r7, #4]
|
|
80070a4: 6039 str r1, [r7, #0]
|
|
QueueHandle_t xHandle;
|
|
|
|
configASSERT( uxMaxCount != 0 );
|
|
80070a6: 687b ldr r3, [r7, #4]
|
|
80070a8: 2b00 cmp r3, #0
|
|
80070aa: d10b bne.n 80070c4 <xQueueCreateCountingSemaphore+0x28>
|
|
__asm volatile
|
|
80070ac: f04f 0350 mov.w r3, #80 @ 0x50
|
|
80070b0: f383 8811 msr BASEPRI, r3
|
|
80070b4: f3bf 8f6f isb sy
|
|
80070b8: f3bf 8f4f dsb sy
|
|
80070bc: 613b str r3, [r7, #16]
|
|
}
|
|
80070be: bf00 nop
|
|
80070c0: bf00 nop
|
|
80070c2: e7fd b.n 80070c0 <xQueueCreateCountingSemaphore+0x24>
|
|
configASSERT( uxInitialCount <= uxMaxCount );
|
|
80070c4: 683a ldr r2, [r7, #0]
|
|
80070c6: 687b ldr r3, [r7, #4]
|
|
80070c8: 429a cmp r2, r3
|
|
80070ca: d90b bls.n 80070e4 <xQueueCreateCountingSemaphore+0x48>
|
|
__asm volatile
|
|
80070cc: f04f 0350 mov.w r3, #80 @ 0x50
|
|
80070d0: f383 8811 msr BASEPRI, r3
|
|
80070d4: f3bf 8f6f isb sy
|
|
80070d8: f3bf 8f4f dsb sy
|
|
80070dc: 60fb str r3, [r7, #12]
|
|
}
|
|
80070de: bf00 nop
|
|
80070e0: bf00 nop
|
|
80070e2: e7fd b.n 80070e0 <xQueueCreateCountingSemaphore+0x44>
|
|
|
|
xHandle = xQueueGenericCreate( uxMaxCount, queueSEMAPHORE_QUEUE_ITEM_LENGTH, queueQUEUE_TYPE_COUNTING_SEMAPHORE );
|
|
80070e4: 2202 movs r2, #2
|
|
80070e6: 2100 movs r1, #0
|
|
80070e8: 6878 ldr r0, [r7, #4]
|
|
80070ea: f7ff ff40 bl 8006f6e <xQueueGenericCreate>
|
|
80070ee: 6178 str r0, [r7, #20]
|
|
|
|
if( xHandle != NULL )
|
|
80070f0: 697b ldr r3, [r7, #20]
|
|
80070f2: 2b00 cmp r3, #0
|
|
80070f4: d002 beq.n 80070fc <xQueueCreateCountingSemaphore+0x60>
|
|
{
|
|
( ( Queue_t * ) xHandle )->uxMessagesWaiting = uxInitialCount;
|
|
80070f6: 697b ldr r3, [r7, #20]
|
|
80070f8: 683a ldr r2, [r7, #0]
|
|
80070fa: 639a str r2, [r3, #56] @ 0x38
|
|
else
|
|
{
|
|
traceCREATE_COUNTING_SEMAPHORE_FAILED();
|
|
}
|
|
|
|
return xHandle;
|
|
80070fc: 697b ldr r3, [r7, #20]
|
|
}
|
|
80070fe: 4618 mov r0, r3
|
|
8007100: 3718 adds r7, #24
|
|
8007102: 46bd mov sp, r7
|
|
8007104: bd80 pop {r7, pc}
|
|
...
|
|
|
|
08007108 <xQueueGenericSend>:
|
|
|
|
#endif /* ( ( configUSE_COUNTING_SEMAPHORES == 1 ) && ( configSUPPORT_DYNAMIC_ALLOCATION == 1 ) ) */
|
|
/*-----------------------------------------------------------*/
|
|
|
|
BaseType_t xQueueGenericSend( QueueHandle_t xQueue, const void * const pvItemToQueue, TickType_t xTicksToWait, const BaseType_t xCopyPosition )
|
|
{
|
|
8007108: b580 push {r7, lr}
|
|
800710a: b08e sub sp, #56 @ 0x38
|
|
800710c: af00 add r7, sp, #0
|
|
800710e: 60f8 str r0, [r7, #12]
|
|
8007110: 60b9 str r1, [r7, #8]
|
|
8007112: 607a str r2, [r7, #4]
|
|
8007114: 603b str r3, [r7, #0]
|
|
BaseType_t xEntryTimeSet = pdFALSE, xYieldRequired;
|
|
8007116: 2300 movs r3, #0
|
|
8007118: 637b str r3, [r7, #52] @ 0x34
|
|
TimeOut_t xTimeOut;
|
|
Queue_t * const pxQueue = xQueue;
|
|
800711a: 68fb ldr r3, [r7, #12]
|
|
800711c: 633b str r3, [r7, #48] @ 0x30
|
|
|
|
configASSERT( pxQueue );
|
|
800711e: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
8007120: 2b00 cmp r3, #0
|
|
8007122: d10b bne.n 800713c <xQueueGenericSend+0x34>
|
|
__asm volatile
|
|
8007124: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8007128: f383 8811 msr BASEPRI, r3
|
|
800712c: f3bf 8f6f isb sy
|
|
8007130: f3bf 8f4f dsb sy
|
|
8007134: 62bb str r3, [r7, #40] @ 0x28
|
|
}
|
|
8007136: bf00 nop
|
|
8007138: bf00 nop
|
|
800713a: e7fd b.n 8007138 <xQueueGenericSend+0x30>
|
|
configASSERT( !( ( pvItemToQueue == NULL ) && ( pxQueue->uxItemSize != ( UBaseType_t ) 0U ) ) );
|
|
800713c: 68bb ldr r3, [r7, #8]
|
|
800713e: 2b00 cmp r3, #0
|
|
8007140: d103 bne.n 800714a <xQueueGenericSend+0x42>
|
|
8007142: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
8007144: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
8007146: 2b00 cmp r3, #0
|
|
8007148: d101 bne.n 800714e <xQueueGenericSend+0x46>
|
|
800714a: 2301 movs r3, #1
|
|
800714c: e000 b.n 8007150 <xQueueGenericSend+0x48>
|
|
800714e: 2300 movs r3, #0
|
|
8007150: 2b00 cmp r3, #0
|
|
8007152: d10b bne.n 800716c <xQueueGenericSend+0x64>
|
|
__asm volatile
|
|
8007154: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8007158: f383 8811 msr BASEPRI, r3
|
|
800715c: f3bf 8f6f isb sy
|
|
8007160: f3bf 8f4f dsb sy
|
|
8007164: 627b str r3, [r7, #36] @ 0x24
|
|
}
|
|
8007166: bf00 nop
|
|
8007168: bf00 nop
|
|
800716a: e7fd b.n 8007168 <xQueueGenericSend+0x60>
|
|
configASSERT( !( ( xCopyPosition == queueOVERWRITE ) && ( pxQueue->uxLength != 1 ) ) );
|
|
800716c: 683b ldr r3, [r7, #0]
|
|
800716e: 2b02 cmp r3, #2
|
|
8007170: d103 bne.n 800717a <xQueueGenericSend+0x72>
|
|
8007172: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
8007174: 6bdb ldr r3, [r3, #60] @ 0x3c
|
|
8007176: 2b01 cmp r3, #1
|
|
8007178: d101 bne.n 800717e <xQueueGenericSend+0x76>
|
|
800717a: 2301 movs r3, #1
|
|
800717c: e000 b.n 8007180 <xQueueGenericSend+0x78>
|
|
800717e: 2300 movs r3, #0
|
|
8007180: 2b00 cmp r3, #0
|
|
8007182: d10b bne.n 800719c <xQueueGenericSend+0x94>
|
|
__asm volatile
|
|
8007184: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8007188: f383 8811 msr BASEPRI, r3
|
|
800718c: f3bf 8f6f isb sy
|
|
8007190: f3bf 8f4f dsb sy
|
|
8007194: 623b str r3, [r7, #32]
|
|
}
|
|
8007196: bf00 nop
|
|
8007198: bf00 nop
|
|
800719a: e7fd b.n 8007198 <xQueueGenericSend+0x90>
|
|
#if ( ( INCLUDE_xTaskGetSchedulerState == 1 ) || ( configUSE_TIMERS == 1 ) )
|
|
{
|
|
configASSERT( !( ( xTaskGetSchedulerState() == taskSCHEDULER_SUSPENDED ) && ( xTicksToWait != 0 ) ) );
|
|
800719c: f001 fc4e bl 8008a3c <xTaskGetSchedulerState>
|
|
80071a0: 4603 mov r3, r0
|
|
80071a2: 2b00 cmp r3, #0
|
|
80071a4: d102 bne.n 80071ac <xQueueGenericSend+0xa4>
|
|
80071a6: 687b ldr r3, [r7, #4]
|
|
80071a8: 2b00 cmp r3, #0
|
|
80071aa: d101 bne.n 80071b0 <xQueueGenericSend+0xa8>
|
|
80071ac: 2301 movs r3, #1
|
|
80071ae: e000 b.n 80071b2 <xQueueGenericSend+0xaa>
|
|
80071b0: 2300 movs r3, #0
|
|
80071b2: 2b00 cmp r3, #0
|
|
80071b4: d10b bne.n 80071ce <xQueueGenericSend+0xc6>
|
|
__asm volatile
|
|
80071b6: f04f 0350 mov.w r3, #80 @ 0x50
|
|
80071ba: f383 8811 msr BASEPRI, r3
|
|
80071be: f3bf 8f6f isb sy
|
|
80071c2: f3bf 8f4f dsb sy
|
|
80071c6: 61fb str r3, [r7, #28]
|
|
}
|
|
80071c8: bf00 nop
|
|
80071ca: bf00 nop
|
|
80071cc: e7fd b.n 80071ca <xQueueGenericSend+0xc2>
|
|
/*lint -save -e904 This function relaxes the coding standard somewhat to
|
|
allow return statements within the function itself. This is done in the
|
|
interest of execution time efficiency. */
|
|
for( ;; )
|
|
{
|
|
taskENTER_CRITICAL();
|
|
80071ce: f002 fb63 bl 8009898 <vPortEnterCritical>
|
|
{
|
|
/* Is there room on the queue now? The running task must be the
|
|
highest priority task wanting to access the queue. If the head item
|
|
in the queue is to be overwritten then it does not matter if the
|
|
queue is full. */
|
|
if( ( pxQueue->uxMessagesWaiting < pxQueue->uxLength ) || ( xCopyPosition == queueOVERWRITE ) )
|
|
80071d2: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
80071d4: 6b9a ldr r2, [r3, #56] @ 0x38
|
|
80071d6: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
80071d8: 6bdb ldr r3, [r3, #60] @ 0x3c
|
|
80071da: 429a cmp r2, r3
|
|
80071dc: d302 bcc.n 80071e4 <xQueueGenericSend+0xdc>
|
|
80071de: 683b ldr r3, [r7, #0]
|
|
80071e0: 2b02 cmp r3, #2
|
|
80071e2: d129 bne.n 8007238 <xQueueGenericSend+0x130>
|
|
}
|
|
}
|
|
}
|
|
#else /* configUSE_QUEUE_SETS */
|
|
{
|
|
xYieldRequired = prvCopyDataToQueue( pxQueue, pvItemToQueue, xCopyPosition );
|
|
80071e4: 683a ldr r2, [r7, #0]
|
|
80071e6: 68b9 ldr r1, [r7, #8]
|
|
80071e8: 6b38 ldr r0, [r7, #48] @ 0x30
|
|
80071ea: f000 fc6d bl 8007ac8 <prvCopyDataToQueue>
|
|
80071ee: 62f8 str r0, [r7, #44] @ 0x2c
|
|
|
|
/* If there was a task waiting for data to arrive on the
|
|
queue then unblock it now. */
|
|
if( listLIST_IS_EMPTY( &( pxQueue->xTasksWaitingToReceive ) ) == pdFALSE )
|
|
80071f0: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
80071f2: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
80071f4: 2b00 cmp r3, #0
|
|
80071f6: d010 beq.n 800721a <xQueueGenericSend+0x112>
|
|
{
|
|
if( xTaskRemoveFromEventList( &( pxQueue->xTasksWaitingToReceive ) ) != pdFALSE )
|
|
80071f8: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
80071fa: 3324 adds r3, #36 @ 0x24
|
|
80071fc: 4618 mov r0, r3
|
|
80071fe: f001 fa57 bl 80086b0 <xTaskRemoveFromEventList>
|
|
8007202: 4603 mov r3, r0
|
|
8007204: 2b00 cmp r3, #0
|
|
8007206: d013 beq.n 8007230 <xQueueGenericSend+0x128>
|
|
{
|
|
/* The unblocked task has a priority higher than
|
|
our own so yield immediately. Yes it is ok to do
|
|
this from within the critical section - the kernel
|
|
takes care of that. */
|
|
queueYIELD_IF_USING_PREEMPTION();
|
|
8007208: 4b3f ldr r3, [pc, #252] @ (8007308 <xQueueGenericSend+0x200>)
|
|
800720a: f04f 5280 mov.w r2, #268435456 @ 0x10000000
|
|
800720e: 601a str r2, [r3, #0]
|
|
8007210: f3bf 8f4f dsb sy
|
|
8007214: f3bf 8f6f isb sy
|
|
8007218: e00a b.n 8007230 <xQueueGenericSend+0x128>
|
|
else
|
|
{
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
}
|
|
else if( xYieldRequired != pdFALSE )
|
|
800721a: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
800721c: 2b00 cmp r3, #0
|
|
800721e: d007 beq.n 8007230 <xQueueGenericSend+0x128>
|
|
{
|
|
/* This path is a special case that will only get
|
|
executed if the task was holding multiple mutexes and
|
|
the mutexes were given back in an order that is
|
|
different to that in which they were taken. */
|
|
queueYIELD_IF_USING_PREEMPTION();
|
|
8007220: 4b39 ldr r3, [pc, #228] @ (8007308 <xQueueGenericSend+0x200>)
|
|
8007222: f04f 5280 mov.w r2, #268435456 @ 0x10000000
|
|
8007226: 601a str r2, [r3, #0]
|
|
8007228: f3bf 8f4f dsb sy
|
|
800722c: f3bf 8f6f isb sy
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
}
|
|
#endif /* configUSE_QUEUE_SETS */
|
|
|
|
taskEXIT_CRITICAL();
|
|
8007230: f002 fb64 bl 80098fc <vPortExitCritical>
|
|
return pdPASS;
|
|
8007234: 2301 movs r3, #1
|
|
8007236: e063 b.n 8007300 <xQueueGenericSend+0x1f8>
|
|
}
|
|
else
|
|
{
|
|
if( xTicksToWait == ( TickType_t ) 0 )
|
|
8007238: 687b ldr r3, [r7, #4]
|
|
800723a: 2b00 cmp r3, #0
|
|
800723c: d103 bne.n 8007246 <xQueueGenericSend+0x13e>
|
|
{
|
|
/* The queue was full and no block time is specified (or
|
|
the block time has expired) so leave now. */
|
|
taskEXIT_CRITICAL();
|
|
800723e: f002 fb5d bl 80098fc <vPortExitCritical>
|
|
|
|
/* Return to the original privilege level before exiting
|
|
the function. */
|
|
traceQUEUE_SEND_FAILED( pxQueue );
|
|
return errQUEUE_FULL;
|
|
8007242: 2300 movs r3, #0
|
|
8007244: e05c b.n 8007300 <xQueueGenericSend+0x1f8>
|
|
}
|
|
else if( xEntryTimeSet == pdFALSE )
|
|
8007246: 6b7b ldr r3, [r7, #52] @ 0x34
|
|
8007248: 2b00 cmp r3, #0
|
|
800724a: d106 bne.n 800725a <xQueueGenericSend+0x152>
|
|
{
|
|
/* The queue was full and a block time was specified so
|
|
configure the timeout structure. */
|
|
vTaskInternalSetTimeOutState( &xTimeOut );
|
|
800724c: f107 0314 add.w r3, r7, #20
|
|
8007250: 4618 mov r0, r3
|
|
8007252: f001 fa91 bl 8008778 <vTaskInternalSetTimeOutState>
|
|
xEntryTimeSet = pdTRUE;
|
|
8007256: 2301 movs r3, #1
|
|
8007258: 637b str r3, [r7, #52] @ 0x34
|
|
/* Entry time was already set. */
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
}
|
|
}
|
|
taskEXIT_CRITICAL();
|
|
800725a: f002 fb4f bl 80098fc <vPortExitCritical>
|
|
|
|
/* Interrupts and other tasks can send to and receive from the queue
|
|
now the critical section has been exited. */
|
|
|
|
vTaskSuspendAll();
|
|
800725e: f000 fff9 bl 8008254 <vTaskSuspendAll>
|
|
prvLockQueue( pxQueue );
|
|
8007262: f002 fb19 bl 8009898 <vPortEnterCritical>
|
|
8007266: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
8007268: f893 3044 ldrb.w r3, [r3, #68] @ 0x44
|
|
800726c: b25b sxtb r3, r3
|
|
800726e: f1b3 3fff cmp.w r3, #4294967295 @ 0xffffffff
|
|
8007272: d103 bne.n 800727c <xQueueGenericSend+0x174>
|
|
8007274: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
8007276: 2200 movs r2, #0
|
|
8007278: f883 2044 strb.w r2, [r3, #68] @ 0x44
|
|
800727c: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
800727e: f893 3045 ldrb.w r3, [r3, #69] @ 0x45
|
|
8007282: b25b sxtb r3, r3
|
|
8007284: f1b3 3fff cmp.w r3, #4294967295 @ 0xffffffff
|
|
8007288: d103 bne.n 8007292 <xQueueGenericSend+0x18a>
|
|
800728a: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
800728c: 2200 movs r2, #0
|
|
800728e: f883 2045 strb.w r2, [r3, #69] @ 0x45
|
|
8007292: f002 fb33 bl 80098fc <vPortExitCritical>
|
|
|
|
/* Update the timeout state to see if it has expired yet. */
|
|
if( xTaskCheckForTimeOut( &xTimeOut, &xTicksToWait ) == pdFALSE )
|
|
8007296: 1d3a adds r2, r7, #4
|
|
8007298: f107 0314 add.w r3, r7, #20
|
|
800729c: 4611 mov r1, r2
|
|
800729e: 4618 mov r0, r3
|
|
80072a0: f001 fa80 bl 80087a4 <xTaskCheckForTimeOut>
|
|
80072a4: 4603 mov r3, r0
|
|
80072a6: 2b00 cmp r3, #0
|
|
80072a8: d124 bne.n 80072f4 <xQueueGenericSend+0x1ec>
|
|
{
|
|
if( prvIsQueueFull( pxQueue ) != pdFALSE )
|
|
80072aa: 6b38 ldr r0, [r7, #48] @ 0x30
|
|
80072ac: f000 fd04 bl 8007cb8 <prvIsQueueFull>
|
|
80072b0: 4603 mov r3, r0
|
|
80072b2: 2b00 cmp r3, #0
|
|
80072b4: d018 beq.n 80072e8 <xQueueGenericSend+0x1e0>
|
|
{
|
|
traceBLOCKING_ON_QUEUE_SEND( pxQueue );
|
|
vTaskPlaceOnEventList( &( pxQueue->xTasksWaitingToSend ), xTicksToWait );
|
|
80072b6: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
80072b8: 3310 adds r3, #16
|
|
80072ba: 687a ldr r2, [r7, #4]
|
|
80072bc: 4611 mov r1, r2
|
|
80072be: 4618 mov r0, r3
|
|
80072c0: f001 f9a4 bl 800860c <vTaskPlaceOnEventList>
|
|
/* Unlocking the queue means queue events can effect the
|
|
event list. It is possible that interrupts occurring now
|
|
remove this task from the event list again - but as the
|
|
scheduler is suspended the task will go onto the pending
|
|
ready last instead of the actual ready list. */
|
|
prvUnlockQueue( pxQueue );
|
|
80072c4: 6b38 ldr r0, [r7, #48] @ 0x30
|
|
80072c6: f000 fc8f bl 8007be8 <prvUnlockQueue>
|
|
/* Resuming the scheduler will move tasks from the pending
|
|
ready list into the ready list - so it is feasible that this
|
|
task is already in a ready list before it yields - in which
|
|
case the yield will not cause a context switch unless there
|
|
is also a higher priority task in the pending ready list. */
|
|
if( xTaskResumeAll() == pdFALSE )
|
|
80072ca: f000 ffd1 bl 8008270 <xTaskResumeAll>
|
|
80072ce: 4603 mov r3, r0
|
|
80072d0: 2b00 cmp r3, #0
|
|
80072d2: f47f af7c bne.w 80071ce <xQueueGenericSend+0xc6>
|
|
{
|
|
portYIELD_WITHIN_API();
|
|
80072d6: 4b0c ldr r3, [pc, #48] @ (8007308 <xQueueGenericSend+0x200>)
|
|
80072d8: f04f 5280 mov.w r2, #268435456 @ 0x10000000
|
|
80072dc: 601a str r2, [r3, #0]
|
|
80072de: f3bf 8f4f dsb sy
|
|
80072e2: f3bf 8f6f isb sy
|
|
80072e6: e772 b.n 80071ce <xQueueGenericSend+0xc6>
|
|
}
|
|
}
|
|
else
|
|
{
|
|
/* Try again. */
|
|
prvUnlockQueue( pxQueue );
|
|
80072e8: 6b38 ldr r0, [r7, #48] @ 0x30
|
|
80072ea: f000 fc7d bl 8007be8 <prvUnlockQueue>
|
|
( void ) xTaskResumeAll();
|
|
80072ee: f000 ffbf bl 8008270 <xTaskResumeAll>
|
|
80072f2: e76c b.n 80071ce <xQueueGenericSend+0xc6>
|
|
}
|
|
}
|
|
else
|
|
{
|
|
/* The timeout has expired. */
|
|
prvUnlockQueue( pxQueue );
|
|
80072f4: 6b38 ldr r0, [r7, #48] @ 0x30
|
|
80072f6: f000 fc77 bl 8007be8 <prvUnlockQueue>
|
|
( void ) xTaskResumeAll();
|
|
80072fa: f000 ffb9 bl 8008270 <xTaskResumeAll>
|
|
|
|
traceQUEUE_SEND_FAILED( pxQueue );
|
|
return errQUEUE_FULL;
|
|
80072fe: 2300 movs r3, #0
|
|
}
|
|
} /*lint -restore */
|
|
}
|
|
8007300: 4618 mov r0, r3
|
|
8007302: 3738 adds r7, #56 @ 0x38
|
|
8007304: 46bd mov sp, r7
|
|
8007306: bd80 pop {r7, pc}
|
|
8007308: e000ed04 .word 0xe000ed04
|
|
|
|
0800730c <xQueueGenericSendFromISR>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
BaseType_t xQueueGenericSendFromISR( QueueHandle_t xQueue, const void * const pvItemToQueue, BaseType_t * const pxHigherPriorityTaskWoken, const BaseType_t xCopyPosition )
|
|
{
|
|
800730c: b580 push {r7, lr}
|
|
800730e: b090 sub sp, #64 @ 0x40
|
|
8007310: af00 add r7, sp, #0
|
|
8007312: 60f8 str r0, [r7, #12]
|
|
8007314: 60b9 str r1, [r7, #8]
|
|
8007316: 607a str r2, [r7, #4]
|
|
8007318: 603b str r3, [r7, #0]
|
|
BaseType_t xReturn;
|
|
UBaseType_t uxSavedInterruptStatus;
|
|
Queue_t * const pxQueue = xQueue;
|
|
800731a: 68fb ldr r3, [r7, #12]
|
|
800731c: 63bb str r3, [r7, #56] @ 0x38
|
|
|
|
configASSERT( pxQueue );
|
|
800731e: 6bbb ldr r3, [r7, #56] @ 0x38
|
|
8007320: 2b00 cmp r3, #0
|
|
8007322: d10b bne.n 800733c <xQueueGenericSendFromISR+0x30>
|
|
__asm volatile
|
|
8007324: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8007328: f383 8811 msr BASEPRI, r3
|
|
800732c: f3bf 8f6f isb sy
|
|
8007330: f3bf 8f4f dsb sy
|
|
8007334: 62bb str r3, [r7, #40] @ 0x28
|
|
}
|
|
8007336: bf00 nop
|
|
8007338: bf00 nop
|
|
800733a: e7fd b.n 8007338 <xQueueGenericSendFromISR+0x2c>
|
|
configASSERT( !( ( pvItemToQueue == NULL ) && ( pxQueue->uxItemSize != ( UBaseType_t ) 0U ) ) );
|
|
800733c: 68bb ldr r3, [r7, #8]
|
|
800733e: 2b00 cmp r3, #0
|
|
8007340: d103 bne.n 800734a <xQueueGenericSendFromISR+0x3e>
|
|
8007342: 6bbb ldr r3, [r7, #56] @ 0x38
|
|
8007344: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
8007346: 2b00 cmp r3, #0
|
|
8007348: d101 bne.n 800734e <xQueueGenericSendFromISR+0x42>
|
|
800734a: 2301 movs r3, #1
|
|
800734c: e000 b.n 8007350 <xQueueGenericSendFromISR+0x44>
|
|
800734e: 2300 movs r3, #0
|
|
8007350: 2b00 cmp r3, #0
|
|
8007352: d10b bne.n 800736c <xQueueGenericSendFromISR+0x60>
|
|
__asm volatile
|
|
8007354: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8007358: f383 8811 msr BASEPRI, r3
|
|
800735c: f3bf 8f6f isb sy
|
|
8007360: f3bf 8f4f dsb sy
|
|
8007364: 627b str r3, [r7, #36] @ 0x24
|
|
}
|
|
8007366: bf00 nop
|
|
8007368: bf00 nop
|
|
800736a: e7fd b.n 8007368 <xQueueGenericSendFromISR+0x5c>
|
|
configASSERT( !( ( xCopyPosition == queueOVERWRITE ) && ( pxQueue->uxLength != 1 ) ) );
|
|
800736c: 683b ldr r3, [r7, #0]
|
|
800736e: 2b02 cmp r3, #2
|
|
8007370: d103 bne.n 800737a <xQueueGenericSendFromISR+0x6e>
|
|
8007372: 6bbb ldr r3, [r7, #56] @ 0x38
|
|
8007374: 6bdb ldr r3, [r3, #60] @ 0x3c
|
|
8007376: 2b01 cmp r3, #1
|
|
8007378: d101 bne.n 800737e <xQueueGenericSendFromISR+0x72>
|
|
800737a: 2301 movs r3, #1
|
|
800737c: e000 b.n 8007380 <xQueueGenericSendFromISR+0x74>
|
|
800737e: 2300 movs r3, #0
|
|
8007380: 2b00 cmp r3, #0
|
|
8007382: d10b bne.n 800739c <xQueueGenericSendFromISR+0x90>
|
|
__asm volatile
|
|
8007384: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8007388: f383 8811 msr BASEPRI, r3
|
|
800738c: f3bf 8f6f isb sy
|
|
8007390: f3bf 8f4f dsb sy
|
|
8007394: 623b str r3, [r7, #32]
|
|
}
|
|
8007396: bf00 nop
|
|
8007398: bf00 nop
|
|
800739a: e7fd b.n 8007398 <xQueueGenericSendFromISR+0x8c>
|
|
that have been assigned a priority at or (logically) below the maximum
|
|
system call interrupt priority. FreeRTOS maintains a separate interrupt
|
|
safe API to ensure interrupt entry is as fast and as simple as possible.
|
|
More information (albeit Cortex-M specific) is provided on the following
|
|
link: http://www.freertos.org/RTOS-Cortex-M3-M4.html */
|
|
portASSERT_IF_INTERRUPT_PRIORITY_INVALID();
|
|
800739c: f002 fb5c bl 8009a58 <vPortValidateInterruptPriority>
|
|
__asm volatile
|
|
80073a0: f3ef 8211 mrs r2, BASEPRI
|
|
80073a4: f04f 0350 mov.w r3, #80 @ 0x50
|
|
80073a8: f383 8811 msr BASEPRI, r3
|
|
80073ac: f3bf 8f6f isb sy
|
|
80073b0: f3bf 8f4f dsb sy
|
|
80073b4: 61fa str r2, [r7, #28]
|
|
80073b6: 61bb str r3, [r7, #24]
|
|
return ulOriginalBASEPRI;
|
|
80073b8: 69fb ldr r3, [r7, #28]
|
|
/* Similar to xQueueGenericSend, except without blocking if there is no room
|
|
in the queue. Also don't directly wake a task that was blocked on a queue
|
|
read, instead return a flag to say whether a context switch is required or
|
|
not (i.e. has a task with a higher priority than us been woken by this
|
|
post). */
|
|
uxSavedInterruptStatus = portSET_INTERRUPT_MASK_FROM_ISR();
|
|
80073ba: 637b str r3, [r7, #52] @ 0x34
|
|
{
|
|
if( ( pxQueue->uxMessagesWaiting < pxQueue->uxLength ) || ( xCopyPosition == queueOVERWRITE ) )
|
|
80073bc: 6bbb ldr r3, [r7, #56] @ 0x38
|
|
80073be: 6b9a ldr r2, [r3, #56] @ 0x38
|
|
80073c0: 6bbb ldr r3, [r7, #56] @ 0x38
|
|
80073c2: 6bdb ldr r3, [r3, #60] @ 0x3c
|
|
80073c4: 429a cmp r2, r3
|
|
80073c6: d302 bcc.n 80073ce <xQueueGenericSendFromISR+0xc2>
|
|
80073c8: 683b ldr r3, [r7, #0]
|
|
80073ca: 2b02 cmp r3, #2
|
|
80073cc: d12f bne.n 800742e <xQueueGenericSendFromISR+0x122>
|
|
{
|
|
const int8_t cTxLock = pxQueue->cTxLock;
|
|
80073ce: 6bbb ldr r3, [r7, #56] @ 0x38
|
|
80073d0: f893 3045 ldrb.w r3, [r3, #69] @ 0x45
|
|
80073d4: f887 3033 strb.w r3, [r7, #51] @ 0x33
|
|
const UBaseType_t uxPreviousMessagesWaiting = pxQueue->uxMessagesWaiting;
|
|
80073d8: 6bbb ldr r3, [r7, #56] @ 0x38
|
|
80073da: 6b9b ldr r3, [r3, #56] @ 0x38
|
|
80073dc: 62fb str r3, [r7, #44] @ 0x2c
|
|
/* Semaphores use xQueueGiveFromISR(), so pxQueue will not be a
|
|
semaphore or mutex. That means prvCopyDataToQueue() cannot result
|
|
in a task disinheriting a priority and prvCopyDataToQueue() can be
|
|
called here even though the disinherit function does not check if
|
|
the scheduler is suspended before accessing the ready lists. */
|
|
( void ) prvCopyDataToQueue( pxQueue, pvItemToQueue, xCopyPosition );
|
|
80073de: 683a ldr r2, [r7, #0]
|
|
80073e0: 68b9 ldr r1, [r7, #8]
|
|
80073e2: 6bb8 ldr r0, [r7, #56] @ 0x38
|
|
80073e4: f000 fb70 bl 8007ac8 <prvCopyDataToQueue>
|
|
|
|
/* The event list is not altered if the queue is locked. This will
|
|
be done when the queue is unlocked later. */
|
|
if( cTxLock == queueUNLOCKED )
|
|
80073e8: f997 3033 ldrsb.w r3, [r7, #51] @ 0x33
|
|
80073ec: f1b3 3fff cmp.w r3, #4294967295 @ 0xffffffff
|
|
80073f0: d112 bne.n 8007418 <xQueueGenericSendFromISR+0x10c>
|
|
}
|
|
}
|
|
}
|
|
#else /* configUSE_QUEUE_SETS */
|
|
{
|
|
if( listLIST_IS_EMPTY( &( pxQueue->xTasksWaitingToReceive ) ) == pdFALSE )
|
|
80073f2: 6bbb ldr r3, [r7, #56] @ 0x38
|
|
80073f4: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
80073f6: 2b00 cmp r3, #0
|
|
80073f8: d016 beq.n 8007428 <xQueueGenericSendFromISR+0x11c>
|
|
{
|
|
if( xTaskRemoveFromEventList( &( pxQueue->xTasksWaitingToReceive ) ) != pdFALSE )
|
|
80073fa: 6bbb ldr r3, [r7, #56] @ 0x38
|
|
80073fc: 3324 adds r3, #36 @ 0x24
|
|
80073fe: 4618 mov r0, r3
|
|
8007400: f001 f956 bl 80086b0 <xTaskRemoveFromEventList>
|
|
8007404: 4603 mov r3, r0
|
|
8007406: 2b00 cmp r3, #0
|
|
8007408: d00e beq.n 8007428 <xQueueGenericSendFromISR+0x11c>
|
|
{
|
|
/* The task waiting has a higher priority so record that a
|
|
context switch is required. */
|
|
if( pxHigherPriorityTaskWoken != NULL )
|
|
800740a: 687b ldr r3, [r7, #4]
|
|
800740c: 2b00 cmp r3, #0
|
|
800740e: d00b beq.n 8007428 <xQueueGenericSendFromISR+0x11c>
|
|
{
|
|
*pxHigherPriorityTaskWoken = pdTRUE;
|
|
8007410: 687b ldr r3, [r7, #4]
|
|
8007412: 2201 movs r2, #1
|
|
8007414: 601a str r2, [r3, #0]
|
|
8007416: e007 b.n 8007428 <xQueueGenericSendFromISR+0x11c>
|
|
}
|
|
else
|
|
{
|
|
/* Increment the lock count so the task that unlocks the queue
|
|
knows that data was posted while it was locked. */
|
|
pxQueue->cTxLock = ( int8_t ) ( cTxLock + 1 );
|
|
8007418: f897 3033 ldrb.w r3, [r7, #51] @ 0x33
|
|
800741c: 3301 adds r3, #1
|
|
800741e: b2db uxtb r3, r3
|
|
8007420: b25a sxtb r2, r3
|
|
8007422: 6bbb ldr r3, [r7, #56] @ 0x38
|
|
8007424: f883 2045 strb.w r2, [r3, #69] @ 0x45
|
|
}
|
|
|
|
xReturn = pdPASS;
|
|
8007428: 2301 movs r3, #1
|
|
800742a: 63fb str r3, [r7, #60] @ 0x3c
|
|
{
|
|
800742c: e001 b.n 8007432 <xQueueGenericSendFromISR+0x126>
|
|
}
|
|
else
|
|
{
|
|
traceQUEUE_SEND_FROM_ISR_FAILED( pxQueue );
|
|
xReturn = errQUEUE_FULL;
|
|
800742e: 2300 movs r3, #0
|
|
8007430: 63fb str r3, [r7, #60] @ 0x3c
|
|
8007432: 6b7b ldr r3, [r7, #52] @ 0x34
|
|
8007434: 617b str r3, [r7, #20]
|
|
__asm volatile
|
|
8007436: 697b ldr r3, [r7, #20]
|
|
8007438: f383 8811 msr BASEPRI, r3
|
|
}
|
|
800743c: bf00 nop
|
|
}
|
|
}
|
|
portCLEAR_INTERRUPT_MASK_FROM_ISR( uxSavedInterruptStatus );
|
|
|
|
return xReturn;
|
|
800743e: 6bfb ldr r3, [r7, #60] @ 0x3c
|
|
}
|
|
8007440: 4618 mov r0, r3
|
|
8007442: 3740 adds r7, #64 @ 0x40
|
|
8007444: 46bd mov sp, r7
|
|
8007446: bd80 pop {r7, pc}
|
|
|
|
08007448 <xQueueGiveFromISR>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
BaseType_t xQueueGiveFromISR( QueueHandle_t xQueue, BaseType_t * const pxHigherPriorityTaskWoken )
|
|
{
|
|
8007448: b580 push {r7, lr}
|
|
800744a: b08e sub sp, #56 @ 0x38
|
|
800744c: af00 add r7, sp, #0
|
|
800744e: 6078 str r0, [r7, #4]
|
|
8007450: 6039 str r1, [r7, #0]
|
|
BaseType_t xReturn;
|
|
UBaseType_t uxSavedInterruptStatus;
|
|
Queue_t * const pxQueue = xQueue;
|
|
8007452: 687b ldr r3, [r7, #4]
|
|
8007454: 633b str r3, [r7, #48] @ 0x30
|
|
item size is 0. Don't directly wake a task that was blocked on a queue
|
|
read, instead return a flag to say whether a context switch is required or
|
|
not (i.e. has a task with a higher priority than us been woken by this
|
|
post). */
|
|
|
|
configASSERT( pxQueue );
|
|
8007456: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
8007458: 2b00 cmp r3, #0
|
|
800745a: d10b bne.n 8007474 <xQueueGiveFromISR+0x2c>
|
|
__asm volatile
|
|
800745c: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8007460: f383 8811 msr BASEPRI, r3
|
|
8007464: f3bf 8f6f isb sy
|
|
8007468: f3bf 8f4f dsb sy
|
|
800746c: 623b str r3, [r7, #32]
|
|
}
|
|
800746e: bf00 nop
|
|
8007470: bf00 nop
|
|
8007472: e7fd b.n 8007470 <xQueueGiveFromISR+0x28>
|
|
|
|
/* xQueueGenericSendFromISR() should be used instead of xQueueGiveFromISR()
|
|
if the item size is not 0. */
|
|
configASSERT( pxQueue->uxItemSize == 0 );
|
|
8007474: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
8007476: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
8007478: 2b00 cmp r3, #0
|
|
800747a: d00b beq.n 8007494 <xQueueGiveFromISR+0x4c>
|
|
__asm volatile
|
|
800747c: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8007480: f383 8811 msr BASEPRI, r3
|
|
8007484: f3bf 8f6f isb sy
|
|
8007488: f3bf 8f4f dsb sy
|
|
800748c: 61fb str r3, [r7, #28]
|
|
}
|
|
800748e: bf00 nop
|
|
8007490: bf00 nop
|
|
8007492: e7fd b.n 8007490 <xQueueGiveFromISR+0x48>
|
|
|
|
/* Normally a mutex would not be given from an interrupt, especially if
|
|
there is a mutex holder, as priority inheritance makes no sense for an
|
|
interrupts, only tasks. */
|
|
configASSERT( !( ( pxQueue->uxQueueType == queueQUEUE_IS_MUTEX ) && ( pxQueue->u.xSemaphore.xMutexHolder != NULL ) ) );
|
|
8007494: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
8007496: 681b ldr r3, [r3, #0]
|
|
8007498: 2b00 cmp r3, #0
|
|
800749a: d103 bne.n 80074a4 <xQueueGiveFromISR+0x5c>
|
|
800749c: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
800749e: 689b ldr r3, [r3, #8]
|
|
80074a0: 2b00 cmp r3, #0
|
|
80074a2: d101 bne.n 80074a8 <xQueueGiveFromISR+0x60>
|
|
80074a4: 2301 movs r3, #1
|
|
80074a6: e000 b.n 80074aa <xQueueGiveFromISR+0x62>
|
|
80074a8: 2300 movs r3, #0
|
|
80074aa: 2b00 cmp r3, #0
|
|
80074ac: d10b bne.n 80074c6 <xQueueGiveFromISR+0x7e>
|
|
__asm volatile
|
|
80074ae: f04f 0350 mov.w r3, #80 @ 0x50
|
|
80074b2: f383 8811 msr BASEPRI, r3
|
|
80074b6: f3bf 8f6f isb sy
|
|
80074ba: f3bf 8f4f dsb sy
|
|
80074be: 61bb str r3, [r7, #24]
|
|
}
|
|
80074c0: bf00 nop
|
|
80074c2: bf00 nop
|
|
80074c4: e7fd b.n 80074c2 <xQueueGiveFromISR+0x7a>
|
|
that have been assigned a priority at or (logically) below the maximum
|
|
system call interrupt priority. FreeRTOS maintains a separate interrupt
|
|
safe API to ensure interrupt entry is as fast and as simple as possible.
|
|
More information (albeit Cortex-M specific) is provided on the following
|
|
link: http://www.freertos.org/RTOS-Cortex-M3-M4.html */
|
|
portASSERT_IF_INTERRUPT_PRIORITY_INVALID();
|
|
80074c6: f002 fac7 bl 8009a58 <vPortValidateInterruptPriority>
|
|
__asm volatile
|
|
80074ca: f3ef 8211 mrs r2, BASEPRI
|
|
80074ce: f04f 0350 mov.w r3, #80 @ 0x50
|
|
80074d2: f383 8811 msr BASEPRI, r3
|
|
80074d6: f3bf 8f6f isb sy
|
|
80074da: f3bf 8f4f dsb sy
|
|
80074de: 617a str r2, [r7, #20]
|
|
80074e0: 613b str r3, [r7, #16]
|
|
return ulOriginalBASEPRI;
|
|
80074e2: 697b ldr r3, [r7, #20]
|
|
|
|
uxSavedInterruptStatus = portSET_INTERRUPT_MASK_FROM_ISR();
|
|
80074e4: 62fb str r3, [r7, #44] @ 0x2c
|
|
{
|
|
const UBaseType_t uxMessagesWaiting = pxQueue->uxMessagesWaiting;
|
|
80074e6: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
80074e8: 6b9b ldr r3, [r3, #56] @ 0x38
|
|
80074ea: 62bb str r3, [r7, #40] @ 0x28
|
|
|
|
/* When the queue is used to implement a semaphore no data is ever
|
|
moved through the queue but it is still valid to see if the queue 'has
|
|
space'. */
|
|
if( uxMessagesWaiting < pxQueue->uxLength )
|
|
80074ec: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
80074ee: 6bdb ldr r3, [r3, #60] @ 0x3c
|
|
80074f0: 6aba ldr r2, [r7, #40] @ 0x28
|
|
80074f2: 429a cmp r2, r3
|
|
80074f4: d22b bcs.n 800754e <xQueueGiveFromISR+0x106>
|
|
{
|
|
const int8_t cTxLock = pxQueue->cTxLock;
|
|
80074f6: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
80074f8: f893 3045 ldrb.w r3, [r3, #69] @ 0x45
|
|
80074fc: f887 3027 strb.w r3, [r7, #39] @ 0x27
|
|
holder - and if there is a mutex holder then the mutex cannot be
|
|
given from an ISR. As this is the ISR version of the function it
|
|
can be assumed there is no mutex holder and no need to determine if
|
|
priority disinheritance is needed. Simply increase the count of
|
|
messages (semaphores) available. */
|
|
pxQueue->uxMessagesWaiting = uxMessagesWaiting + ( UBaseType_t ) 1;
|
|
8007500: 6abb ldr r3, [r7, #40] @ 0x28
|
|
8007502: 1c5a adds r2, r3, #1
|
|
8007504: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
8007506: 639a str r2, [r3, #56] @ 0x38
|
|
|
|
/* The event list is not altered if the queue is locked. This will
|
|
be done when the queue is unlocked later. */
|
|
if( cTxLock == queueUNLOCKED )
|
|
8007508: f997 3027 ldrsb.w r3, [r7, #39] @ 0x27
|
|
800750c: f1b3 3fff cmp.w r3, #4294967295 @ 0xffffffff
|
|
8007510: d112 bne.n 8007538 <xQueueGiveFromISR+0xf0>
|
|
}
|
|
}
|
|
}
|
|
#else /* configUSE_QUEUE_SETS */
|
|
{
|
|
if( listLIST_IS_EMPTY( &( pxQueue->xTasksWaitingToReceive ) ) == pdFALSE )
|
|
8007512: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
8007514: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
8007516: 2b00 cmp r3, #0
|
|
8007518: d016 beq.n 8007548 <xQueueGiveFromISR+0x100>
|
|
{
|
|
if( xTaskRemoveFromEventList( &( pxQueue->xTasksWaitingToReceive ) ) != pdFALSE )
|
|
800751a: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
800751c: 3324 adds r3, #36 @ 0x24
|
|
800751e: 4618 mov r0, r3
|
|
8007520: f001 f8c6 bl 80086b0 <xTaskRemoveFromEventList>
|
|
8007524: 4603 mov r3, r0
|
|
8007526: 2b00 cmp r3, #0
|
|
8007528: d00e beq.n 8007548 <xQueueGiveFromISR+0x100>
|
|
{
|
|
/* The task waiting has a higher priority so record that a
|
|
context switch is required. */
|
|
if( pxHigherPriorityTaskWoken != NULL )
|
|
800752a: 683b ldr r3, [r7, #0]
|
|
800752c: 2b00 cmp r3, #0
|
|
800752e: d00b beq.n 8007548 <xQueueGiveFromISR+0x100>
|
|
{
|
|
*pxHigherPriorityTaskWoken = pdTRUE;
|
|
8007530: 683b ldr r3, [r7, #0]
|
|
8007532: 2201 movs r2, #1
|
|
8007534: 601a str r2, [r3, #0]
|
|
8007536: e007 b.n 8007548 <xQueueGiveFromISR+0x100>
|
|
}
|
|
else
|
|
{
|
|
/* Increment the lock count so the task that unlocks the queue
|
|
knows that data was posted while it was locked. */
|
|
pxQueue->cTxLock = ( int8_t ) ( cTxLock + 1 );
|
|
8007538: f897 3027 ldrb.w r3, [r7, #39] @ 0x27
|
|
800753c: 3301 adds r3, #1
|
|
800753e: b2db uxtb r3, r3
|
|
8007540: b25a sxtb r2, r3
|
|
8007542: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
8007544: f883 2045 strb.w r2, [r3, #69] @ 0x45
|
|
}
|
|
|
|
xReturn = pdPASS;
|
|
8007548: 2301 movs r3, #1
|
|
800754a: 637b str r3, [r7, #52] @ 0x34
|
|
800754c: e001 b.n 8007552 <xQueueGiveFromISR+0x10a>
|
|
}
|
|
else
|
|
{
|
|
traceQUEUE_SEND_FROM_ISR_FAILED( pxQueue );
|
|
xReturn = errQUEUE_FULL;
|
|
800754e: 2300 movs r3, #0
|
|
8007550: 637b str r3, [r7, #52] @ 0x34
|
|
8007552: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
8007554: 60fb str r3, [r7, #12]
|
|
__asm volatile
|
|
8007556: 68fb ldr r3, [r7, #12]
|
|
8007558: f383 8811 msr BASEPRI, r3
|
|
}
|
|
800755c: bf00 nop
|
|
}
|
|
}
|
|
portCLEAR_INTERRUPT_MASK_FROM_ISR( uxSavedInterruptStatus );
|
|
|
|
return xReturn;
|
|
800755e: 6b7b ldr r3, [r7, #52] @ 0x34
|
|
}
|
|
8007560: 4618 mov r0, r3
|
|
8007562: 3738 adds r7, #56 @ 0x38
|
|
8007564: 46bd mov sp, r7
|
|
8007566: bd80 pop {r7, pc}
|
|
|
|
08007568 <xQueueReceive>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
BaseType_t xQueueReceive( QueueHandle_t xQueue, void * const pvBuffer, TickType_t xTicksToWait )
|
|
{
|
|
8007568: b580 push {r7, lr}
|
|
800756a: b08c sub sp, #48 @ 0x30
|
|
800756c: af00 add r7, sp, #0
|
|
800756e: 60f8 str r0, [r7, #12]
|
|
8007570: 60b9 str r1, [r7, #8]
|
|
8007572: 607a str r2, [r7, #4]
|
|
BaseType_t xEntryTimeSet = pdFALSE;
|
|
8007574: 2300 movs r3, #0
|
|
8007576: 62fb str r3, [r7, #44] @ 0x2c
|
|
TimeOut_t xTimeOut;
|
|
Queue_t * const pxQueue = xQueue;
|
|
8007578: 68fb ldr r3, [r7, #12]
|
|
800757a: 62bb str r3, [r7, #40] @ 0x28
|
|
|
|
/* Check the pointer is not NULL. */
|
|
configASSERT( ( pxQueue ) );
|
|
800757c: 6abb ldr r3, [r7, #40] @ 0x28
|
|
800757e: 2b00 cmp r3, #0
|
|
8007580: d10b bne.n 800759a <xQueueReceive+0x32>
|
|
__asm volatile
|
|
8007582: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8007586: f383 8811 msr BASEPRI, r3
|
|
800758a: f3bf 8f6f isb sy
|
|
800758e: f3bf 8f4f dsb sy
|
|
8007592: 623b str r3, [r7, #32]
|
|
}
|
|
8007594: bf00 nop
|
|
8007596: bf00 nop
|
|
8007598: e7fd b.n 8007596 <xQueueReceive+0x2e>
|
|
|
|
/* The buffer into which data is received can only be NULL if the data size
|
|
is zero (so no data is copied into the buffer. */
|
|
configASSERT( !( ( ( pvBuffer ) == NULL ) && ( ( pxQueue )->uxItemSize != ( UBaseType_t ) 0U ) ) );
|
|
800759a: 68bb ldr r3, [r7, #8]
|
|
800759c: 2b00 cmp r3, #0
|
|
800759e: d103 bne.n 80075a8 <xQueueReceive+0x40>
|
|
80075a0: 6abb ldr r3, [r7, #40] @ 0x28
|
|
80075a2: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
80075a4: 2b00 cmp r3, #0
|
|
80075a6: d101 bne.n 80075ac <xQueueReceive+0x44>
|
|
80075a8: 2301 movs r3, #1
|
|
80075aa: e000 b.n 80075ae <xQueueReceive+0x46>
|
|
80075ac: 2300 movs r3, #0
|
|
80075ae: 2b00 cmp r3, #0
|
|
80075b0: d10b bne.n 80075ca <xQueueReceive+0x62>
|
|
__asm volatile
|
|
80075b2: f04f 0350 mov.w r3, #80 @ 0x50
|
|
80075b6: f383 8811 msr BASEPRI, r3
|
|
80075ba: f3bf 8f6f isb sy
|
|
80075be: f3bf 8f4f dsb sy
|
|
80075c2: 61fb str r3, [r7, #28]
|
|
}
|
|
80075c4: bf00 nop
|
|
80075c6: bf00 nop
|
|
80075c8: e7fd b.n 80075c6 <xQueueReceive+0x5e>
|
|
|
|
/* Cannot block if the scheduler is suspended. */
|
|
#if ( ( INCLUDE_xTaskGetSchedulerState == 1 ) || ( configUSE_TIMERS == 1 ) )
|
|
{
|
|
configASSERT( !( ( xTaskGetSchedulerState() == taskSCHEDULER_SUSPENDED ) && ( xTicksToWait != 0 ) ) );
|
|
80075ca: f001 fa37 bl 8008a3c <xTaskGetSchedulerState>
|
|
80075ce: 4603 mov r3, r0
|
|
80075d0: 2b00 cmp r3, #0
|
|
80075d2: d102 bne.n 80075da <xQueueReceive+0x72>
|
|
80075d4: 687b ldr r3, [r7, #4]
|
|
80075d6: 2b00 cmp r3, #0
|
|
80075d8: d101 bne.n 80075de <xQueueReceive+0x76>
|
|
80075da: 2301 movs r3, #1
|
|
80075dc: e000 b.n 80075e0 <xQueueReceive+0x78>
|
|
80075de: 2300 movs r3, #0
|
|
80075e0: 2b00 cmp r3, #0
|
|
80075e2: d10b bne.n 80075fc <xQueueReceive+0x94>
|
|
__asm volatile
|
|
80075e4: f04f 0350 mov.w r3, #80 @ 0x50
|
|
80075e8: f383 8811 msr BASEPRI, r3
|
|
80075ec: f3bf 8f6f isb sy
|
|
80075f0: f3bf 8f4f dsb sy
|
|
80075f4: 61bb str r3, [r7, #24]
|
|
}
|
|
80075f6: bf00 nop
|
|
80075f8: bf00 nop
|
|
80075fa: e7fd b.n 80075f8 <xQueueReceive+0x90>
|
|
/*lint -save -e904 This function relaxes the coding standard somewhat to
|
|
allow return statements within the function itself. This is done in the
|
|
interest of execution time efficiency. */
|
|
for( ;; )
|
|
{
|
|
taskENTER_CRITICAL();
|
|
80075fc: f002 f94c bl 8009898 <vPortEnterCritical>
|
|
{
|
|
const UBaseType_t uxMessagesWaiting = pxQueue->uxMessagesWaiting;
|
|
8007600: 6abb ldr r3, [r7, #40] @ 0x28
|
|
8007602: 6b9b ldr r3, [r3, #56] @ 0x38
|
|
8007604: 627b str r3, [r7, #36] @ 0x24
|
|
|
|
/* Is there data in the queue now? To be running the calling task
|
|
must be the highest priority task wanting to access the queue. */
|
|
if( uxMessagesWaiting > ( UBaseType_t ) 0 )
|
|
8007606: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8007608: 2b00 cmp r3, #0
|
|
800760a: d01f beq.n 800764c <xQueueReceive+0xe4>
|
|
{
|
|
/* Data available, remove one item. */
|
|
prvCopyDataFromQueue( pxQueue, pvBuffer );
|
|
800760c: 68b9 ldr r1, [r7, #8]
|
|
800760e: 6ab8 ldr r0, [r7, #40] @ 0x28
|
|
8007610: f000 fac4 bl 8007b9c <prvCopyDataFromQueue>
|
|
traceQUEUE_RECEIVE( pxQueue );
|
|
pxQueue->uxMessagesWaiting = uxMessagesWaiting - ( UBaseType_t ) 1;
|
|
8007614: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8007616: 1e5a subs r2, r3, #1
|
|
8007618: 6abb ldr r3, [r7, #40] @ 0x28
|
|
800761a: 639a str r2, [r3, #56] @ 0x38
|
|
|
|
/* There is now space in the queue, were any tasks waiting to
|
|
post to the queue? If so, unblock the highest priority waiting
|
|
task. */
|
|
if( listLIST_IS_EMPTY( &( pxQueue->xTasksWaitingToSend ) ) == pdFALSE )
|
|
800761c: 6abb ldr r3, [r7, #40] @ 0x28
|
|
800761e: 691b ldr r3, [r3, #16]
|
|
8007620: 2b00 cmp r3, #0
|
|
8007622: d00f beq.n 8007644 <xQueueReceive+0xdc>
|
|
{
|
|
if( xTaskRemoveFromEventList( &( pxQueue->xTasksWaitingToSend ) ) != pdFALSE )
|
|
8007624: 6abb ldr r3, [r7, #40] @ 0x28
|
|
8007626: 3310 adds r3, #16
|
|
8007628: 4618 mov r0, r3
|
|
800762a: f001 f841 bl 80086b0 <xTaskRemoveFromEventList>
|
|
800762e: 4603 mov r3, r0
|
|
8007630: 2b00 cmp r3, #0
|
|
8007632: d007 beq.n 8007644 <xQueueReceive+0xdc>
|
|
{
|
|
queueYIELD_IF_USING_PREEMPTION();
|
|
8007634: 4b3c ldr r3, [pc, #240] @ (8007728 <xQueueReceive+0x1c0>)
|
|
8007636: f04f 5280 mov.w r2, #268435456 @ 0x10000000
|
|
800763a: 601a str r2, [r3, #0]
|
|
800763c: f3bf 8f4f dsb sy
|
|
8007640: f3bf 8f6f isb sy
|
|
else
|
|
{
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
|
|
taskEXIT_CRITICAL();
|
|
8007644: f002 f95a bl 80098fc <vPortExitCritical>
|
|
return pdPASS;
|
|
8007648: 2301 movs r3, #1
|
|
800764a: e069 b.n 8007720 <xQueueReceive+0x1b8>
|
|
}
|
|
else
|
|
{
|
|
if( xTicksToWait == ( TickType_t ) 0 )
|
|
800764c: 687b ldr r3, [r7, #4]
|
|
800764e: 2b00 cmp r3, #0
|
|
8007650: d103 bne.n 800765a <xQueueReceive+0xf2>
|
|
{
|
|
/* The queue was empty and no block time is specified (or
|
|
the block time has expired) so leave now. */
|
|
taskEXIT_CRITICAL();
|
|
8007652: f002 f953 bl 80098fc <vPortExitCritical>
|
|
traceQUEUE_RECEIVE_FAILED( pxQueue );
|
|
return errQUEUE_EMPTY;
|
|
8007656: 2300 movs r3, #0
|
|
8007658: e062 b.n 8007720 <xQueueReceive+0x1b8>
|
|
}
|
|
else if( xEntryTimeSet == pdFALSE )
|
|
800765a: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
800765c: 2b00 cmp r3, #0
|
|
800765e: d106 bne.n 800766e <xQueueReceive+0x106>
|
|
{
|
|
/* The queue was empty and a block time was specified so
|
|
configure the timeout structure. */
|
|
vTaskInternalSetTimeOutState( &xTimeOut );
|
|
8007660: f107 0310 add.w r3, r7, #16
|
|
8007664: 4618 mov r0, r3
|
|
8007666: f001 f887 bl 8008778 <vTaskInternalSetTimeOutState>
|
|
xEntryTimeSet = pdTRUE;
|
|
800766a: 2301 movs r3, #1
|
|
800766c: 62fb str r3, [r7, #44] @ 0x2c
|
|
/* Entry time was already set. */
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
}
|
|
}
|
|
taskEXIT_CRITICAL();
|
|
800766e: f002 f945 bl 80098fc <vPortExitCritical>
|
|
|
|
/* Interrupts and other tasks can send to and receive from the queue
|
|
now the critical section has been exited. */
|
|
|
|
vTaskSuspendAll();
|
|
8007672: f000 fdef bl 8008254 <vTaskSuspendAll>
|
|
prvLockQueue( pxQueue );
|
|
8007676: f002 f90f bl 8009898 <vPortEnterCritical>
|
|
800767a: 6abb ldr r3, [r7, #40] @ 0x28
|
|
800767c: f893 3044 ldrb.w r3, [r3, #68] @ 0x44
|
|
8007680: b25b sxtb r3, r3
|
|
8007682: f1b3 3fff cmp.w r3, #4294967295 @ 0xffffffff
|
|
8007686: d103 bne.n 8007690 <xQueueReceive+0x128>
|
|
8007688: 6abb ldr r3, [r7, #40] @ 0x28
|
|
800768a: 2200 movs r2, #0
|
|
800768c: f883 2044 strb.w r2, [r3, #68] @ 0x44
|
|
8007690: 6abb ldr r3, [r7, #40] @ 0x28
|
|
8007692: f893 3045 ldrb.w r3, [r3, #69] @ 0x45
|
|
8007696: b25b sxtb r3, r3
|
|
8007698: f1b3 3fff cmp.w r3, #4294967295 @ 0xffffffff
|
|
800769c: d103 bne.n 80076a6 <xQueueReceive+0x13e>
|
|
800769e: 6abb ldr r3, [r7, #40] @ 0x28
|
|
80076a0: 2200 movs r2, #0
|
|
80076a2: f883 2045 strb.w r2, [r3, #69] @ 0x45
|
|
80076a6: f002 f929 bl 80098fc <vPortExitCritical>
|
|
|
|
/* Update the timeout state to see if it has expired yet. */
|
|
if( xTaskCheckForTimeOut( &xTimeOut, &xTicksToWait ) == pdFALSE )
|
|
80076aa: 1d3a adds r2, r7, #4
|
|
80076ac: f107 0310 add.w r3, r7, #16
|
|
80076b0: 4611 mov r1, r2
|
|
80076b2: 4618 mov r0, r3
|
|
80076b4: f001 f876 bl 80087a4 <xTaskCheckForTimeOut>
|
|
80076b8: 4603 mov r3, r0
|
|
80076ba: 2b00 cmp r3, #0
|
|
80076bc: d123 bne.n 8007706 <xQueueReceive+0x19e>
|
|
{
|
|
/* The timeout has not expired. If the queue is still empty place
|
|
the task on the list of tasks waiting to receive from the queue. */
|
|
if( prvIsQueueEmpty( pxQueue ) != pdFALSE )
|
|
80076be: 6ab8 ldr r0, [r7, #40] @ 0x28
|
|
80076c0: f000 fae4 bl 8007c8c <prvIsQueueEmpty>
|
|
80076c4: 4603 mov r3, r0
|
|
80076c6: 2b00 cmp r3, #0
|
|
80076c8: d017 beq.n 80076fa <xQueueReceive+0x192>
|
|
{
|
|
traceBLOCKING_ON_QUEUE_RECEIVE( pxQueue );
|
|
vTaskPlaceOnEventList( &( pxQueue->xTasksWaitingToReceive ), xTicksToWait );
|
|
80076ca: 6abb ldr r3, [r7, #40] @ 0x28
|
|
80076cc: 3324 adds r3, #36 @ 0x24
|
|
80076ce: 687a ldr r2, [r7, #4]
|
|
80076d0: 4611 mov r1, r2
|
|
80076d2: 4618 mov r0, r3
|
|
80076d4: f000 ff9a bl 800860c <vTaskPlaceOnEventList>
|
|
prvUnlockQueue( pxQueue );
|
|
80076d8: 6ab8 ldr r0, [r7, #40] @ 0x28
|
|
80076da: f000 fa85 bl 8007be8 <prvUnlockQueue>
|
|
if( xTaskResumeAll() == pdFALSE )
|
|
80076de: f000 fdc7 bl 8008270 <xTaskResumeAll>
|
|
80076e2: 4603 mov r3, r0
|
|
80076e4: 2b00 cmp r3, #0
|
|
80076e6: d189 bne.n 80075fc <xQueueReceive+0x94>
|
|
{
|
|
portYIELD_WITHIN_API();
|
|
80076e8: 4b0f ldr r3, [pc, #60] @ (8007728 <xQueueReceive+0x1c0>)
|
|
80076ea: f04f 5280 mov.w r2, #268435456 @ 0x10000000
|
|
80076ee: 601a str r2, [r3, #0]
|
|
80076f0: f3bf 8f4f dsb sy
|
|
80076f4: f3bf 8f6f isb sy
|
|
80076f8: e780 b.n 80075fc <xQueueReceive+0x94>
|
|
}
|
|
else
|
|
{
|
|
/* The queue contains data again. Loop back to try and read the
|
|
data. */
|
|
prvUnlockQueue( pxQueue );
|
|
80076fa: 6ab8 ldr r0, [r7, #40] @ 0x28
|
|
80076fc: f000 fa74 bl 8007be8 <prvUnlockQueue>
|
|
( void ) xTaskResumeAll();
|
|
8007700: f000 fdb6 bl 8008270 <xTaskResumeAll>
|
|
8007704: e77a b.n 80075fc <xQueueReceive+0x94>
|
|
}
|
|
else
|
|
{
|
|
/* Timed out. If there is no data in the queue exit, otherwise loop
|
|
back and attempt to read the data. */
|
|
prvUnlockQueue( pxQueue );
|
|
8007706: 6ab8 ldr r0, [r7, #40] @ 0x28
|
|
8007708: f000 fa6e bl 8007be8 <prvUnlockQueue>
|
|
( void ) xTaskResumeAll();
|
|
800770c: f000 fdb0 bl 8008270 <xTaskResumeAll>
|
|
|
|
if( prvIsQueueEmpty( pxQueue ) != pdFALSE )
|
|
8007710: 6ab8 ldr r0, [r7, #40] @ 0x28
|
|
8007712: f000 fabb bl 8007c8c <prvIsQueueEmpty>
|
|
8007716: 4603 mov r3, r0
|
|
8007718: 2b00 cmp r3, #0
|
|
800771a: f43f af6f beq.w 80075fc <xQueueReceive+0x94>
|
|
{
|
|
traceQUEUE_RECEIVE_FAILED( pxQueue );
|
|
return errQUEUE_EMPTY;
|
|
800771e: 2300 movs r3, #0
|
|
{
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
}
|
|
} /*lint -restore */
|
|
}
|
|
8007720: 4618 mov r0, r3
|
|
8007722: 3730 adds r7, #48 @ 0x30
|
|
8007724: 46bd mov sp, r7
|
|
8007726: bd80 pop {r7, pc}
|
|
8007728: e000ed04 .word 0xe000ed04
|
|
|
|
0800772c <xQueueSemaphoreTake>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
BaseType_t xQueueSemaphoreTake( QueueHandle_t xQueue, TickType_t xTicksToWait )
|
|
{
|
|
800772c: b580 push {r7, lr}
|
|
800772e: b08e sub sp, #56 @ 0x38
|
|
8007730: af00 add r7, sp, #0
|
|
8007732: 6078 str r0, [r7, #4]
|
|
8007734: 6039 str r1, [r7, #0]
|
|
BaseType_t xEntryTimeSet = pdFALSE;
|
|
8007736: 2300 movs r3, #0
|
|
8007738: 637b str r3, [r7, #52] @ 0x34
|
|
TimeOut_t xTimeOut;
|
|
Queue_t * const pxQueue = xQueue;
|
|
800773a: 687b ldr r3, [r7, #4]
|
|
800773c: 62fb str r3, [r7, #44] @ 0x2c
|
|
|
|
#if( configUSE_MUTEXES == 1 )
|
|
BaseType_t xInheritanceOccurred = pdFALSE;
|
|
800773e: 2300 movs r3, #0
|
|
8007740: 633b str r3, [r7, #48] @ 0x30
|
|
#endif
|
|
|
|
/* Check the queue pointer is not NULL. */
|
|
configASSERT( ( pxQueue ) );
|
|
8007742: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
8007744: 2b00 cmp r3, #0
|
|
8007746: d10b bne.n 8007760 <xQueueSemaphoreTake+0x34>
|
|
__asm volatile
|
|
8007748: f04f 0350 mov.w r3, #80 @ 0x50
|
|
800774c: f383 8811 msr BASEPRI, r3
|
|
8007750: f3bf 8f6f isb sy
|
|
8007754: f3bf 8f4f dsb sy
|
|
8007758: 623b str r3, [r7, #32]
|
|
}
|
|
800775a: bf00 nop
|
|
800775c: bf00 nop
|
|
800775e: e7fd b.n 800775c <xQueueSemaphoreTake+0x30>
|
|
|
|
/* Check this really is a semaphore, in which case the item size will be
|
|
0. */
|
|
configASSERT( pxQueue->uxItemSize == 0 );
|
|
8007760: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
8007762: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
8007764: 2b00 cmp r3, #0
|
|
8007766: d00b beq.n 8007780 <xQueueSemaphoreTake+0x54>
|
|
__asm volatile
|
|
8007768: f04f 0350 mov.w r3, #80 @ 0x50
|
|
800776c: f383 8811 msr BASEPRI, r3
|
|
8007770: f3bf 8f6f isb sy
|
|
8007774: f3bf 8f4f dsb sy
|
|
8007778: 61fb str r3, [r7, #28]
|
|
}
|
|
800777a: bf00 nop
|
|
800777c: bf00 nop
|
|
800777e: e7fd b.n 800777c <xQueueSemaphoreTake+0x50>
|
|
|
|
/* Cannot block if the scheduler is suspended. */
|
|
#if ( ( INCLUDE_xTaskGetSchedulerState == 1 ) || ( configUSE_TIMERS == 1 ) )
|
|
{
|
|
configASSERT( !( ( xTaskGetSchedulerState() == taskSCHEDULER_SUSPENDED ) && ( xTicksToWait != 0 ) ) );
|
|
8007780: f001 f95c bl 8008a3c <xTaskGetSchedulerState>
|
|
8007784: 4603 mov r3, r0
|
|
8007786: 2b00 cmp r3, #0
|
|
8007788: d102 bne.n 8007790 <xQueueSemaphoreTake+0x64>
|
|
800778a: 683b ldr r3, [r7, #0]
|
|
800778c: 2b00 cmp r3, #0
|
|
800778e: d101 bne.n 8007794 <xQueueSemaphoreTake+0x68>
|
|
8007790: 2301 movs r3, #1
|
|
8007792: e000 b.n 8007796 <xQueueSemaphoreTake+0x6a>
|
|
8007794: 2300 movs r3, #0
|
|
8007796: 2b00 cmp r3, #0
|
|
8007798: d10b bne.n 80077b2 <xQueueSemaphoreTake+0x86>
|
|
__asm volatile
|
|
800779a: f04f 0350 mov.w r3, #80 @ 0x50
|
|
800779e: f383 8811 msr BASEPRI, r3
|
|
80077a2: f3bf 8f6f isb sy
|
|
80077a6: f3bf 8f4f dsb sy
|
|
80077aa: 61bb str r3, [r7, #24]
|
|
}
|
|
80077ac: bf00 nop
|
|
80077ae: bf00 nop
|
|
80077b0: e7fd b.n 80077ae <xQueueSemaphoreTake+0x82>
|
|
/*lint -save -e904 This function relaxes the coding standard somewhat to allow return
|
|
statements within the function itself. This is done in the interest
|
|
of execution time efficiency. */
|
|
for( ;; )
|
|
{
|
|
taskENTER_CRITICAL();
|
|
80077b2: f002 f871 bl 8009898 <vPortEnterCritical>
|
|
{
|
|
/* Semaphores are queues with an item size of 0, and where the
|
|
number of messages in the queue is the semaphore's count value. */
|
|
const UBaseType_t uxSemaphoreCount = pxQueue->uxMessagesWaiting;
|
|
80077b6: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
80077b8: 6b9b ldr r3, [r3, #56] @ 0x38
|
|
80077ba: 62bb str r3, [r7, #40] @ 0x28
|
|
|
|
/* Is there data in the queue now? To be running the calling task
|
|
must be the highest priority task wanting to access the queue. */
|
|
if( uxSemaphoreCount > ( UBaseType_t ) 0 )
|
|
80077bc: 6abb ldr r3, [r7, #40] @ 0x28
|
|
80077be: 2b00 cmp r3, #0
|
|
80077c0: d024 beq.n 800780c <xQueueSemaphoreTake+0xe0>
|
|
{
|
|
traceQUEUE_RECEIVE( pxQueue );
|
|
|
|
/* Semaphores are queues with a data size of zero and where the
|
|
messages waiting is the semaphore's count. Reduce the count. */
|
|
pxQueue->uxMessagesWaiting = uxSemaphoreCount - ( UBaseType_t ) 1;
|
|
80077c2: 6abb ldr r3, [r7, #40] @ 0x28
|
|
80077c4: 1e5a subs r2, r3, #1
|
|
80077c6: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
80077c8: 639a str r2, [r3, #56] @ 0x38
|
|
|
|
#if ( configUSE_MUTEXES == 1 )
|
|
{
|
|
if( pxQueue->uxQueueType == queueQUEUE_IS_MUTEX )
|
|
80077ca: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
80077cc: 681b ldr r3, [r3, #0]
|
|
80077ce: 2b00 cmp r3, #0
|
|
80077d0: d104 bne.n 80077dc <xQueueSemaphoreTake+0xb0>
|
|
{
|
|
/* Record the information required to implement
|
|
priority inheritance should it become necessary. */
|
|
pxQueue->u.xSemaphore.xMutexHolder = pvTaskIncrementMutexHeldCount();
|
|
80077d2: f001 faad bl 8008d30 <pvTaskIncrementMutexHeldCount>
|
|
80077d6: 4602 mov r2, r0
|
|
80077d8: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
80077da: 609a str r2, [r3, #8]
|
|
}
|
|
#endif /* configUSE_MUTEXES */
|
|
|
|
/* Check to see if other tasks are blocked waiting to give the
|
|
semaphore, and if so, unblock the highest priority such task. */
|
|
if( listLIST_IS_EMPTY( &( pxQueue->xTasksWaitingToSend ) ) == pdFALSE )
|
|
80077dc: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
80077de: 691b ldr r3, [r3, #16]
|
|
80077e0: 2b00 cmp r3, #0
|
|
80077e2: d00f beq.n 8007804 <xQueueSemaphoreTake+0xd8>
|
|
{
|
|
if( xTaskRemoveFromEventList( &( pxQueue->xTasksWaitingToSend ) ) != pdFALSE )
|
|
80077e4: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
80077e6: 3310 adds r3, #16
|
|
80077e8: 4618 mov r0, r3
|
|
80077ea: f000 ff61 bl 80086b0 <xTaskRemoveFromEventList>
|
|
80077ee: 4603 mov r3, r0
|
|
80077f0: 2b00 cmp r3, #0
|
|
80077f2: d007 beq.n 8007804 <xQueueSemaphoreTake+0xd8>
|
|
{
|
|
queueYIELD_IF_USING_PREEMPTION();
|
|
80077f4: 4b54 ldr r3, [pc, #336] @ (8007948 <xQueueSemaphoreTake+0x21c>)
|
|
80077f6: f04f 5280 mov.w r2, #268435456 @ 0x10000000
|
|
80077fa: 601a str r2, [r3, #0]
|
|
80077fc: f3bf 8f4f dsb sy
|
|
8007800: f3bf 8f6f isb sy
|
|
else
|
|
{
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
|
|
taskEXIT_CRITICAL();
|
|
8007804: f002 f87a bl 80098fc <vPortExitCritical>
|
|
return pdPASS;
|
|
8007808: 2301 movs r3, #1
|
|
800780a: e098 b.n 800793e <xQueueSemaphoreTake+0x212>
|
|
}
|
|
else
|
|
{
|
|
if( xTicksToWait == ( TickType_t ) 0 )
|
|
800780c: 683b ldr r3, [r7, #0]
|
|
800780e: 2b00 cmp r3, #0
|
|
8007810: d112 bne.n 8007838 <xQueueSemaphoreTake+0x10c>
|
|
/* For inheritance to have occurred there must have been an
|
|
initial timeout, and an adjusted timeout cannot become 0, as
|
|
if it were 0 the function would have exited. */
|
|
#if( configUSE_MUTEXES == 1 )
|
|
{
|
|
configASSERT( xInheritanceOccurred == pdFALSE );
|
|
8007812: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
8007814: 2b00 cmp r3, #0
|
|
8007816: d00b beq.n 8007830 <xQueueSemaphoreTake+0x104>
|
|
__asm volatile
|
|
8007818: f04f 0350 mov.w r3, #80 @ 0x50
|
|
800781c: f383 8811 msr BASEPRI, r3
|
|
8007820: f3bf 8f6f isb sy
|
|
8007824: f3bf 8f4f dsb sy
|
|
8007828: 617b str r3, [r7, #20]
|
|
}
|
|
800782a: bf00 nop
|
|
800782c: bf00 nop
|
|
800782e: e7fd b.n 800782c <xQueueSemaphoreTake+0x100>
|
|
}
|
|
#endif /* configUSE_MUTEXES */
|
|
|
|
/* The semaphore count was 0 and no block time is specified
|
|
(or the block time has expired) so exit now. */
|
|
taskEXIT_CRITICAL();
|
|
8007830: f002 f864 bl 80098fc <vPortExitCritical>
|
|
traceQUEUE_RECEIVE_FAILED( pxQueue );
|
|
return errQUEUE_EMPTY;
|
|
8007834: 2300 movs r3, #0
|
|
8007836: e082 b.n 800793e <xQueueSemaphoreTake+0x212>
|
|
}
|
|
else if( xEntryTimeSet == pdFALSE )
|
|
8007838: 6b7b ldr r3, [r7, #52] @ 0x34
|
|
800783a: 2b00 cmp r3, #0
|
|
800783c: d106 bne.n 800784c <xQueueSemaphoreTake+0x120>
|
|
{
|
|
/* The semaphore count was 0 and a block time was specified
|
|
so configure the timeout structure ready to block. */
|
|
vTaskInternalSetTimeOutState( &xTimeOut );
|
|
800783e: f107 030c add.w r3, r7, #12
|
|
8007842: 4618 mov r0, r3
|
|
8007844: f000 ff98 bl 8008778 <vTaskInternalSetTimeOutState>
|
|
xEntryTimeSet = pdTRUE;
|
|
8007848: 2301 movs r3, #1
|
|
800784a: 637b str r3, [r7, #52] @ 0x34
|
|
/* Entry time was already set. */
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
}
|
|
}
|
|
taskEXIT_CRITICAL();
|
|
800784c: f002 f856 bl 80098fc <vPortExitCritical>
|
|
|
|
/* Interrupts and other tasks can give to and take from the semaphore
|
|
now the critical section has been exited. */
|
|
|
|
vTaskSuspendAll();
|
|
8007850: f000 fd00 bl 8008254 <vTaskSuspendAll>
|
|
prvLockQueue( pxQueue );
|
|
8007854: f002 f820 bl 8009898 <vPortEnterCritical>
|
|
8007858: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
800785a: f893 3044 ldrb.w r3, [r3, #68] @ 0x44
|
|
800785e: b25b sxtb r3, r3
|
|
8007860: f1b3 3fff cmp.w r3, #4294967295 @ 0xffffffff
|
|
8007864: d103 bne.n 800786e <xQueueSemaphoreTake+0x142>
|
|
8007866: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
8007868: 2200 movs r2, #0
|
|
800786a: f883 2044 strb.w r2, [r3, #68] @ 0x44
|
|
800786e: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
8007870: f893 3045 ldrb.w r3, [r3, #69] @ 0x45
|
|
8007874: b25b sxtb r3, r3
|
|
8007876: f1b3 3fff cmp.w r3, #4294967295 @ 0xffffffff
|
|
800787a: d103 bne.n 8007884 <xQueueSemaphoreTake+0x158>
|
|
800787c: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
800787e: 2200 movs r2, #0
|
|
8007880: f883 2045 strb.w r2, [r3, #69] @ 0x45
|
|
8007884: f002 f83a bl 80098fc <vPortExitCritical>
|
|
|
|
/* Update the timeout state to see if it has expired yet. */
|
|
if( xTaskCheckForTimeOut( &xTimeOut, &xTicksToWait ) == pdFALSE )
|
|
8007888: 463a mov r2, r7
|
|
800788a: f107 030c add.w r3, r7, #12
|
|
800788e: 4611 mov r1, r2
|
|
8007890: 4618 mov r0, r3
|
|
8007892: f000 ff87 bl 80087a4 <xTaskCheckForTimeOut>
|
|
8007896: 4603 mov r3, r0
|
|
8007898: 2b00 cmp r3, #0
|
|
800789a: d132 bne.n 8007902 <xQueueSemaphoreTake+0x1d6>
|
|
{
|
|
/* A block time is specified and not expired. If the semaphore
|
|
count is 0 then enter the Blocked state to wait for a semaphore to
|
|
become available. As semaphores are implemented with queues the
|
|
queue being empty is equivalent to the semaphore count being 0. */
|
|
if( prvIsQueueEmpty( pxQueue ) != pdFALSE )
|
|
800789c: 6af8 ldr r0, [r7, #44] @ 0x2c
|
|
800789e: f000 f9f5 bl 8007c8c <prvIsQueueEmpty>
|
|
80078a2: 4603 mov r3, r0
|
|
80078a4: 2b00 cmp r3, #0
|
|
80078a6: d026 beq.n 80078f6 <xQueueSemaphoreTake+0x1ca>
|
|
{
|
|
traceBLOCKING_ON_QUEUE_RECEIVE( pxQueue );
|
|
|
|
#if ( configUSE_MUTEXES == 1 )
|
|
{
|
|
if( pxQueue->uxQueueType == queueQUEUE_IS_MUTEX )
|
|
80078a8: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
80078aa: 681b ldr r3, [r3, #0]
|
|
80078ac: 2b00 cmp r3, #0
|
|
80078ae: d109 bne.n 80078c4 <xQueueSemaphoreTake+0x198>
|
|
{
|
|
taskENTER_CRITICAL();
|
|
80078b0: f001 fff2 bl 8009898 <vPortEnterCritical>
|
|
{
|
|
xInheritanceOccurred = xTaskPriorityInherit( pxQueue->u.xSemaphore.xMutexHolder );
|
|
80078b4: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
80078b6: 689b ldr r3, [r3, #8]
|
|
80078b8: 4618 mov r0, r3
|
|
80078ba: f001 f8dd bl 8008a78 <xTaskPriorityInherit>
|
|
80078be: 6338 str r0, [r7, #48] @ 0x30
|
|
}
|
|
taskEXIT_CRITICAL();
|
|
80078c0: f002 f81c bl 80098fc <vPortExitCritical>
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
}
|
|
#endif
|
|
|
|
vTaskPlaceOnEventList( &( pxQueue->xTasksWaitingToReceive ), xTicksToWait );
|
|
80078c4: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
80078c6: 3324 adds r3, #36 @ 0x24
|
|
80078c8: 683a ldr r2, [r7, #0]
|
|
80078ca: 4611 mov r1, r2
|
|
80078cc: 4618 mov r0, r3
|
|
80078ce: f000 fe9d bl 800860c <vTaskPlaceOnEventList>
|
|
prvUnlockQueue( pxQueue );
|
|
80078d2: 6af8 ldr r0, [r7, #44] @ 0x2c
|
|
80078d4: f000 f988 bl 8007be8 <prvUnlockQueue>
|
|
if( xTaskResumeAll() == pdFALSE )
|
|
80078d8: f000 fcca bl 8008270 <xTaskResumeAll>
|
|
80078dc: 4603 mov r3, r0
|
|
80078de: 2b00 cmp r3, #0
|
|
80078e0: f47f af67 bne.w 80077b2 <xQueueSemaphoreTake+0x86>
|
|
{
|
|
portYIELD_WITHIN_API();
|
|
80078e4: 4b18 ldr r3, [pc, #96] @ (8007948 <xQueueSemaphoreTake+0x21c>)
|
|
80078e6: f04f 5280 mov.w r2, #268435456 @ 0x10000000
|
|
80078ea: 601a str r2, [r3, #0]
|
|
80078ec: f3bf 8f4f dsb sy
|
|
80078f0: f3bf 8f6f isb sy
|
|
80078f4: e75d b.n 80077b2 <xQueueSemaphoreTake+0x86>
|
|
}
|
|
else
|
|
{
|
|
/* There was no timeout and the semaphore count was not 0, so
|
|
attempt to take the semaphore again. */
|
|
prvUnlockQueue( pxQueue );
|
|
80078f6: 6af8 ldr r0, [r7, #44] @ 0x2c
|
|
80078f8: f000 f976 bl 8007be8 <prvUnlockQueue>
|
|
( void ) xTaskResumeAll();
|
|
80078fc: f000 fcb8 bl 8008270 <xTaskResumeAll>
|
|
8007900: e757 b.n 80077b2 <xQueueSemaphoreTake+0x86>
|
|
}
|
|
}
|
|
else
|
|
{
|
|
/* Timed out. */
|
|
prvUnlockQueue( pxQueue );
|
|
8007902: 6af8 ldr r0, [r7, #44] @ 0x2c
|
|
8007904: f000 f970 bl 8007be8 <prvUnlockQueue>
|
|
( void ) xTaskResumeAll();
|
|
8007908: f000 fcb2 bl 8008270 <xTaskResumeAll>
|
|
|
|
/* If the semaphore count is 0 exit now as the timeout has
|
|
expired. Otherwise return to attempt to take the semaphore that is
|
|
known to be available. As semaphores are implemented by queues the
|
|
queue being empty is equivalent to the semaphore count being 0. */
|
|
if( prvIsQueueEmpty( pxQueue ) != pdFALSE )
|
|
800790c: 6af8 ldr r0, [r7, #44] @ 0x2c
|
|
800790e: f000 f9bd bl 8007c8c <prvIsQueueEmpty>
|
|
8007912: 4603 mov r3, r0
|
|
8007914: 2b00 cmp r3, #0
|
|
8007916: f43f af4c beq.w 80077b2 <xQueueSemaphoreTake+0x86>
|
|
#if ( configUSE_MUTEXES == 1 )
|
|
{
|
|
/* xInheritanceOccurred could only have be set if
|
|
pxQueue->uxQueueType == queueQUEUE_IS_MUTEX so no need to
|
|
test the mutex type again to check it is actually a mutex. */
|
|
if( xInheritanceOccurred != pdFALSE )
|
|
800791a: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
800791c: 2b00 cmp r3, #0
|
|
800791e: d00d beq.n 800793c <xQueueSemaphoreTake+0x210>
|
|
{
|
|
taskENTER_CRITICAL();
|
|
8007920: f001 ffba bl 8009898 <vPortEnterCritical>
|
|
/* This task blocking on the mutex caused another
|
|
task to inherit this task's priority. Now this task
|
|
has timed out the priority should be disinherited
|
|
again, but only as low as the next highest priority
|
|
task that is waiting for the same mutex. */
|
|
uxHighestWaitingPriority = prvGetDisinheritPriorityAfterTimeout( pxQueue );
|
|
8007924: 6af8 ldr r0, [r7, #44] @ 0x2c
|
|
8007926: f000 f8b7 bl 8007a98 <prvGetDisinheritPriorityAfterTimeout>
|
|
800792a: 6278 str r0, [r7, #36] @ 0x24
|
|
vTaskPriorityDisinheritAfterTimeout( pxQueue->u.xSemaphore.xMutexHolder, uxHighestWaitingPriority );
|
|
800792c: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
800792e: 689b ldr r3, [r3, #8]
|
|
8007930: 6a79 ldr r1, [r7, #36] @ 0x24
|
|
8007932: 4618 mov r0, r3
|
|
8007934: f001 f978 bl 8008c28 <vTaskPriorityDisinheritAfterTimeout>
|
|
}
|
|
taskEXIT_CRITICAL();
|
|
8007938: f001 ffe0 bl 80098fc <vPortExitCritical>
|
|
}
|
|
}
|
|
#endif /* configUSE_MUTEXES */
|
|
|
|
traceQUEUE_RECEIVE_FAILED( pxQueue );
|
|
return errQUEUE_EMPTY;
|
|
800793c: 2300 movs r3, #0
|
|
{
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
}
|
|
} /*lint -restore */
|
|
}
|
|
800793e: 4618 mov r0, r3
|
|
8007940: 3738 adds r7, #56 @ 0x38
|
|
8007942: 46bd mov sp, r7
|
|
8007944: bd80 pop {r7, pc}
|
|
8007946: bf00 nop
|
|
8007948: e000ed04 .word 0xe000ed04
|
|
|
|
0800794c <xQueueReceiveFromISR>:
|
|
} /*lint -restore */
|
|
}
|
|
/*-----------------------------------------------------------*/
|
|
|
|
BaseType_t xQueueReceiveFromISR( QueueHandle_t xQueue, void * const pvBuffer, BaseType_t * const pxHigherPriorityTaskWoken )
|
|
{
|
|
800794c: b580 push {r7, lr}
|
|
800794e: b08e sub sp, #56 @ 0x38
|
|
8007950: af00 add r7, sp, #0
|
|
8007952: 60f8 str r0, [r7, #12]
|
|
8007954: 60b9 str r1, [r7, #8]
|
|
8007956: 607a str r2, [r7, #4]
|
|
BaseType_t xReturn;
|
|
UBaseType_t uxSavedInterruptStatus;
|
|
Queue_t * const pxQueue = xQueue;
|
|
8007958: 68fb ldr r3, [r7, #12]
|
|
800795a: 633b str r3, [r7, #48] @ 0x30
|
|
|
|
configASSERT( pxQueue );
|
|
800795c: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
800795e: 2b00 cmp r3, #0
|
|
8007960: d10b bne.n 800797a <xQueueReceiveFromISR+0x2e>
|
|
__asm volatile
|
|
8007962: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8007966: f383 8811 msr BASEPRI, r3
|
|
800796a: f3bf 8f6f isb sy
|
|
800796e: f3bf 8f4f dsb sy
|
|
8007972: 623b str r3, [r7, #32]
|
|
}
|
|
8007974: bf00 nop
|
|
8007976: bf00 nop
|
|
8007978: e7fd b.n 8007976 <xQueueReceiveFromISR+0x2a>
|
|
configASSERT( !( ( pvBuffer == NULL ) && ( pxQueue->uxItemSize != ( UBaseType_t ) 0U ) ) );
|
|
800797a: 68bb ldr r3, [r7, #8]
|
|
800797c: 2b00 cmp r3, #0
|
|
800797e: d103 bne.n 8007988 <xQueueReceiveFromISR+0x3c>
|
|
8007980: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
8007982: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
8007984: 2b00 cmp r3, #0
|
|
8007986: d101 bne.n 800798c <xQueueReceiveFromISR+0x40>
|
|
8007988: 2301 movs r3, #1
|
|
800798a: e000 b.n 800798e <xQueueReceiveFromISR+0x42>
|
|
800798c: 2300 movs r3, #0
|
|
800798e: 2b00 cmp r3, #0
|
|
8007990: d10b bne.n 80079aa <xQueueReceiveFromISR+0x5e>
|
|
__asm volatile
|
|
8007992: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8007996: f383 8811 msr BASEPRI, r3
|
|
800799a: f3bf 8f6f isb sy
|
|
800799e: f3bf 8f4f dsb sy
|
|
80079a2: 61fb str r3, [r7, #28]
|
|
}
|
|
80079a4: bf00 nop
|
|
80079a6: bf00 nop
|
|
80079a8: e7fd b.n 80079a6 <xQueueReceiveFromISR+0x5a>
|
|
that have been assigned a priority at or (logically) below the maximum
|
|
system call interrupt priority. FreeRTOS maintains a separate interrupt
|
|
safe API to ensure interrupt entry is as fast and as simple as possible.
|
|
More information (albeit Cortex-M specific) is provided on the following
|
|
link: http://www.freertos.org/RTOS-Cortex-M3-M4.html */
|
|
portASSERT_IF_INTERRUPT_PRIORITY_INVALID();
|
|
80079aa: f002 f855 bl 8009a58 <vPortValidateInterruptPriority>
|
|
__asm volatile
|
|
80079ae: f3ef 8211 mrs r2, BASEPRI
|
|
80079b2: f04f 0350 mov.w r3, #80 @ 0x50
|
|
80079b6: f383 8811 msr BASEPRI, r3
|
|
80079ba: f3bf 8f6f isb sy
|
|
80079be: f3bf 8f4f dsb sy
|
|
80079c2: 61ba str r2, [r7, #24]
|
|
80079c4: 617b str r3, [r7, #20]
|
|
return ulOriginalBASEPRI;
|
|
80079c6: 69bb ldr r3, [r7, #24]
|
|
|
|
uxSavedInterruptStatus = portSET_INTERRUPT_MASK_FROM_ISR();
|
|
80079c8: 62fb str r3, [r7, #44] @ 0x2c
|
|
{
|
|
const UBaseType_t uxMessagesWaiting = pxQueue->uxMessagesWaiting;
|
|
80079ca: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
80079cc: 6b9b ldr r3, [r3, #56] @ 0x38
|
|
80079ce: 62bb str r3, [r7, #40] @ 0x28
|
|
|
|
/* Cannot block in an ISR, so check there is data available. */
|
|
if( uxMessagesWaiting > ( UBaseType_t ) 0 )
|
|
80079d0: 6abb ldr r3, [r7, #40] @ 0x28
|
|
80079d2: 2b00 cmp r3, #0
|
|
80079d4: d02f beq.n 8007a36 <xQueueReceiveFromISR+0xea>
|
|
{
|
|
const int8_t cRxLock = pxQueue->cRxLock;
|
|
80079d6: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
80079d8: f893 3044 ldrb.w r3, [r3, #68] @ 0x44
|
|
80079dc: f887 3027 strb.w r3, [r7, #39] @ 0x27
|
|
|
|
traceQUEUE_RECEIVE_FROM_ISR( pxQueue );
|
|
|
|
prvCopyDataFromQueue( pxQueue, pvBuffer );
|
|
80079e0: 68b9 ldr r1, [r7, #8]
|
|
80079e2: 6b38 ldr r0, [r7, #48] @ 0x30
|
|
80079e4: f000 f8da bl 8007b9c <prvCopyDataFromQueue>
|
|
pxQueue->uxMessagesWaiting = uxMessagesWaiting - ( UBaseType_t ) 1;
|
|
80079e8: 6abb ldr r3, [r7, #40] @ 0x28
|
|
80079ea: 1e5a subs r2, r3, #1
|
|
80079ec: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
80079ee: 639a str r2, [r3, #56] @ 0x38
|
|
|
|
/* If the queue is locked the event list will not be modified.
|
|
Instead update the lock count so the task that unlocks the queue
|
|
will know that an ISR has removed data while the queue was
|
|
locked. */
|
|
if( cRxLock == queueUNLOCKED )
|
|
80079f0: f997 3027 ldrsb.w r3, [r7, #39] @ 0x27
|
|
80079f4: f1b3 3fff cmp.w r3, #4294967295 @ 0xffffffff
|
|
80079f8: d112 bne.n 8007a20 <xQueueReceiveFromISR+0xd4>
|
|
{
|
|
if( listLIST_IS_EMPTY( &( pxQueue->xTasksWaitingToSend ) ) == pdFALSE )
|
|
80079fa: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
80079fc: 691b ldr r3, [r3, #16]
|
|
80079fe: 2b00 cmp r3, #0
|
|
8007a00: d016 beq.n 8007a30 <xQueueReceiveFromISR+0xe4>
|
|
{
|
|
if( xTaskRemoveFromEventList( &( pxQueue->xTasksWaitingToSend ) ) != pdFALSE )
|
|
8007a02: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
8007a04: 3310 adds r3, #16
|
|
8007a06: 4618 mov r0, r3
|
|
8007a08: f000 fe52 bl 80086b0 <xTaskRemoveFromEventList>
|
|
8007a0c: 4603 mov r3, r0
|
|
8007a0e: 2b00 cmp r3, #0
|
|
8007a10: d00e beq.n 8007a30 <xQueueReceiveFromISR+0xe4>
|
|
{
|
|
/* The task waiting has a higher priority than us so
|
|
force a context switch. */
|
|
if( pxHigherPriorityTaskWoken != NULL )
|
|
8007a12: 687b ldr r3, [r7, #4]
|
|
8007a14: 2b00 cmp r3, #0
|
|
8007a16: d00b beq.n 8007a30 <xQueueReceiveFromISR+0xe4>
|
|
{
|
|
*pxHigherPriorityTaskWoken = pdTRUE;
|
|
8007a18: 687b ldr r3, [r7, #4]
|
|
8007a1a: 2201 movs r2, #1
|
|
8007a1c: 601a str r2, [r3, #0]
|
|
8007a1e: e007 b.n 8007a30 <xQueueReceiveFromISR+0xe4>
|
|
}
|
|
else
|
|
{
|
|
/* Increment the lock count so the task that unlocks the queue
|
|
knows that data was removed while it was locked. */
|
|
pxQueue->cRxLock = ( int8_t ) ( cRxLock + 1 );
|
|
8007a20: f897 3027 ldrb.w r3, [r7, #39] @ 0x27
|
|
8007a24: 3301 adds r3, #1
|
|
8007a26: b2db uxtb r3, r3
|
|
8007a28: b25a sxtb r2, r3
|
|
8007a2a: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
8007a2c: f883 2044 strb.w r2, [r3, #68] @ 0x44
|
|
}
|
|
|
|
xReturn = pdPASS;
|
|
8007a30: 2301 movs r3, #1
|
|
8007a32: 637b str r3, [r7, #52] @ 0x34
|
|
8007a34: e001 b.n 8007a3a <xQueueReceiveFromISR+0xee>
|
|
}
|
|
else
|
|
{
|
|
xReturn = pdFAIL;
|
|
8007a36: 2300 movs r3, #0
|
|
8007a38: 637b str r3, [r7, #52] @ 0x34
|
|
8007a3a: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
8007a3c: 613b str r3, [r7, #16]
|
|
__asm volatile
|
|
8007a3e: 693b ldr r3, [r7, #16]
|
|
8007a40: f383 8811 msr BASEPRI, r3
|
|
}
|
|
8007a44: bf00 nop
|
|
traceQUEUE_RECEIVE_FROM_ISR_FAILED( pxQueue );
|
|
}
|
|
}
|
|
portCLEAR_INTERRUPT_MASK_FROM_ISR( uxSavedInterruptStatus );
|
|
|
|
return xReturn;
|
|
8007a46: 6b7b ldr r3, [r7, #52] @ 0x34
|
|
}
|
|
8007a48: 4618 mov r0, r3
|
|
8007a4a: 3738 adds r7, #56 @ 0x38
|
|
8007a4c: 46bd mov sp, r7
|
|
8007a4e: bd80 pop {r7, pc}
|
|
|
|
08007a50 <vQueueDelete>:
|
|
return uxReturn;
|
|
} /*lint !e818 Pointer cannot be declared const as xQueue is a typedef not pointer. */
|
|
/*-----------------------------------------------------------*/
|
|
|
|
void vQueueDelete( QueueHandle_t xQueue )
|
|
{
|
|
8007a50: b580 push {r7, lr}
|
|
8007a52: b084 sub sp, #16
|
|
8007a54: af00 add r7, sp, #0
|
|
8007a56: 6078 str r0, [r7, #4]
|
|
Queue_t * const pxQueue = xQueue;
|
|
8007a58: 687b ldr r3, [r7, #4]
|
|
8007a5a: 60fb str r3, [r7, #12]
|
|
|
|
configASSERT( pxQueue );
|
|
8007a5c: 68fb ldr r3, [r7, #12]
|
|
8007a5e: 2b00 cmp r3, #0
|
|
8007a60: d10b bne.n 8007a7a <vQueueDelete+0x2a>
|
|
__asm volatile
|
|
8007a62: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8007a66: f383 8811 msr BASEPRI, r3
|
|
8007a6a: f3bf 8f6f isb sy
|
|
8007a6e: f3bf 8f4f dsb sy
|
|
8007a72: 60bb str r3, [r7, #8]
|
|
}
|
|
8007a74: bf00 nop
|
|
8007a76: bf00 nop
|
|
8007a78: e7fd b.n 8007a76 <vQueueDelete+0x26>
|
|
traceQUEUE_DELETE( pxQueue );
|
|
|
|
#if ( configQUEUE_REGISTRY_SIZE > 0 )
|
|
{
|
|
vQueueUnregisterQueue( pxQueue );
|
|
8007a7a: 68f8 ldr r0, [r7, #12]
|
|
8007a7c: f000 f95e bl 8007d3c <vQueueUnregisterQueue>
|
|
}
|
|
#elif( ( configSUPPORT_DYNAMIC_ALLOCATION == 1 ) && ( configSUPPORT_STATIC_ALLOCATION == 1 ) )
|
|
{
|
|
/* The queue could have been allocated statically or dynamically, so
|
|
check before attempting to free the memory. */
|
|
if( pxQueue->ucStaticallyAllocated == ( uint8_t ) pdFALSE )
|
|
8007a80: 68fb ldr r3, [r7, #12]
|
|
8007a82: f893 3046 ldrb.w r3, [r3, #70] @ 0x46
|
|
8007a86: 2b00 cmp r3, #0
|
|
8007a88: d102 bne.n 8007a90 <vQueueDelete+0x40>
|
|
{
|
|
vPortFree( pxQueue );
|
|
8007a8a: 68f8 ldr r0, [r7, #12]
|
|
8007a8c: f002 f8f4 bl 8009c78 <vPortFree>
|
|
/* The queue must have been statically allocated, so is not going to be
|
|
deleted. Avoid compiler warnings about the unused parameter. */
|
|
( void ) pxQueue;
|
|
}
|
|
#endif /* configSUPPORT_DYNAMIC_ALLOCATION */
|
|
}
|
|
8007a90: bf00 nop
|
|
8007a92: 3710 adds r7, #16
|
|
8007a94: 46bd mov sp, r7
|
|
8007a96: bd80 pop {r7, pc}
|
|
|
|
08007a98 <prvGetDisinheritPriorityAfterTimeout>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
#if( configUSE_MUTEXES == 1 )
|
|
|
|
static UBaseType_t prvGetDisinheritPriorityAfterTimeout( const Queue_t * const pxQueue )
|
|
{
|
|
8007a98: b480 push {r7}
|
|
8007a9a: b085 sub sp, #20
|
|
8007a9c: af00 add r7, sp, #0
|
|
8007a9e: 6078 str r0, [r7, #4]
|
|
priority, but the waiting task times out, then the holder should
|
|
disinherit the priority - but only down to the highest priority of any
|
|
other tasks that are waiting for the same mutex. For this purpose,
|
|
return the priority of the highest priority task that is waiting for the
|
|
mutex. */
|
|
if( listCURRENT_LIST_LENGTH( &( pxQueue->xTasksWaitingToReceive ) ) > 0U )
|
|
8007aa0: 687b ldr r3, [r7, #4]
|
|
8007aa2: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
8007aa4: 2b00 cmp r3, #0
|
|
8007aa6: d006 beq.n 8007ab6 <prvGetDisinheritPriorityAfterTimeout+0x1e>
|
|
{
|
|
uxHighestPriorityOfWaitingTasks = ( UBaseType_t ) configMAX_PRIORITIES - ( UBaseType_t ) listGET_ITEM_VALUE_OF_HEAD_ENTRY( &( pxQueue->xTasksWaitingToReceive ) );
|
|
8007aa8: 687b ldr r3, [r7, #4]
|
|
8007aaa: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
8007aac: 681b ldr r3, [r3, #0]
|
|
8007aae: f1c3 0338 rsb r3, r3, #56 @ 0x38
|
|
8007ab2: 60fb str r3, [r7, #12]
|
|
8007ab4: e001 b.n 8007aba <prvGetDisinheritPriorityAfterTimeout+0x22>
|
|
}
|
|
else
|
|
{
|
|
uxHighestPriorityOfWaitingTasks = tskIDLE_PRIORITY;
|
|
8007ab6: 2300 movs r3, #0
|
|
8007ab8: 60fb str r3, [r7, #12]
|
|
}
|
|
|
|
return uxHighestPriorityOfWaitingTasks;
|
|
8007aba: 68fb ldr r3, [r7, #12]
|
|
}
|
|
8007abc: 4618 mov r0, r3
|
|
8007abe: 3714 adds r7, #20
|
|
8007ac0: 46bd mov sp, r7
|
|
8007ac2: f85d 7b04 ldr.w r7, [sp], #4
|
|
8007ac6: 4770 bx lr
|
|
|
|
08007ac8 <prvCopyDataToQueue>:
|
|
|
|
#endif /* configUSE_MUTEXES */
|
|
/*-----------------------------------------------------------*/
|
|
|
|
static BaseType_t prvCopyDataToQueue( Queue_t * const pxQueue, const void *pvItemToQueue, const BaseType_t xPosition )
|
|
{
|
|
8007ac8: b580 push {r7, lr}
|
|
8007aca: b086 sub sp, #24
|
|
8007acc: af00 add r7, sp, #0
|
|
8007ace: 60f8 str r0, [r7, #12]
|
|
8007ad0: 60b9 str r1, [r7, #8]
|
|
8007ad2: 607a str r2, [r7, #4]
|
|
BaseType_t xReturn = pdFALSE;
|
|
8007ad4: 2300 movs r3, #0
|
|
8007ad6: 617b str r3, [r7, #20]
|
|
UBaseType_t uxMessagesWaiting;
|
|
|
|
/* This function is called from a critical section. */
|
|
|
|
uxMessagesWaiting = pxQueue->uxMessagesWaiting;
|
|
8007ad8: 68fb ldr r3, [r7, #12]
|
|
8007ada: 6b9b ldr r3, [r3, #56] @ 0x38
|
|
8007adc: 613b str r3, [r7, #16]
|
|
|
|
if( pxQueue->uxItemSize == ( UBaseType_t ) 0 )
|
|
8007ade: 68fb ldr r3, [r7, #12]
|
|
8007ae0: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
8007ae2: 2b00 cmp r3, #0
|
|
8007ae4: d10d bne.n 8007b02 <prvCopyDataToQueue+0x3a>
|
|
{
|
|
#if ( configUSE_MUTEXES == 1 )
|
|
{
|
|
if( pxQueue->uxQueueType == queueQUEUE_IS_MUTEX )
|
|
8007ae6: 68fb ldr r3, [r7, #12]
|
|
8007ae8: 681b ldr r3, [r3, #0]
|
|
8007aea: 2b00 cmp r3, #0
|
|
8007aec: d14d bne.n 8007b8a <prvCopyDataToQueue+0xc2>
|
|
{
|
|
/* The mutex is no longer being held. */
|
|
xReturn = xTaskPriorityDisinherit( pxQueue->u.xSemaphore.xMutexHolder );
|
|
8007aee: 68fb ldr r3, [r7, #12]
|
|
8007af0: 689b ldr r3, [r3, #8]
|
|
8007af2: 4618 mov r0, r3
|
|
8007af4: f001 f828 bl 8008b48 <xTaskPriorityDisinherit>
|
|
8007af8: 6178 str r0, [r7, #20]
|
|
pxQueue->u.xSemaphore.xMutexHolder = NULL;
|
|
8007afa: 68fb ldr r3, [r7, #12]
|
|
8007afc: 2200 movs r2, #0
|
|
8007afe: 609a str r2, [r3, #8]
|
|
8007b00: e043 b.n 8007b8a <prvCopyDataToQueue+0xc2>
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
}
|
|
#endif /* configUSE_MUTEXES */
|
|
}
|
|
else if( xPosition == queueSEND_TO_BACK )
|
|
8007b02: 687b ldr r3, [r7, #4]
|
|
8007b04: 2b00 cmp r3, #0
|
|
8007b06: d119 bne.n 8007b3c <prvCopyDataToQueue+0x74>
|
|
{
|
|
( void ) memcpy( ( void * ) pxQueue->pcWriteTo, pvItemToQueue, ( size_t ) pxQueue->uxItemSize ); /*lint !e961 !e418 !e9087 MISRA exception as the casts are only redundant for some ports, plus previous logic ensures a null pointer can only be passed to memcpy() if the copy size is 0. Cast to void required by function signature and safe as no alignment requirement and copy length specified in bytes. */
|
|
8007b08: 68fb ldr r3, [r7, #12]
|
|
8007b0a: 6858 ldr r0, [r3, #4]
|
|
8007b0c: 68fb ldr r3, [r7, #12]
|
|
8007b0e: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
8007b10: 461a mov r2, r3
|
|
8007b12: 68b9 ldr r1, [r7, #8]
|
|
8007b14: f002 fa66 bl 8009fe4 <memcpy>
|
|
pxQueue->pcWriteTo += pxQueue->uxItemSize; /*lint !e9016 Pointer arithmetic on char types ok, especially in this use case where it is the clearest way of conveying intent. */
|
|
8007b18: 68fb ldr r3, [r7, #12]
|
|
8007b1a: 685a ldr r2, [r3, #4]
|
|
8007b1c: 68fb ldr r3, [r7, #12]
|
|
8007b1e: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
8007b20: 441a add r2, r3
|
|
8007b22: 68fb ldr r3, [r7, #12]
|
|
8007b24: 605a str r2, [r3, #4]
|
|
if( pxQueue->pcWriteTo >= pxQueue->u.xQueue.pcTail ) /*lint !e946 MISRA exception justified as comparison of pointers is the cleanest solution. */
|
|
8007b26: 68fb ldr r3, [r7, #12]
|
|
8007b28: 685a ldr r2, [r3, #4]
|
|
8007b2a: 68fb ldr r3, [r7, #12]
|
|
8007b2c: 689b ldr r3, [r3, #8]
|
|
8007b2e: 429a cmp r2, r3
|
|
8007b30: d32b bcc.n 8007b8a <prvCopyDataToQueue+0xc2>
|
|
{
|
|
pxQueue->pcWriteTo = pxQueue->pcHead;
|
|
8007b32: 68fb ldr r3, [r7, #12]
|
|
8007b34: 681a ldr r2, [r3, #0]
|
|
8007b36: 68fb ldr r3, [r7, #12]
|
|
8007b38: 605a str r2, [r3, #4]
|
|
8007b3a: e026 b.n 8007b8a <prvCopyDataToQueue+0xc2>
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
}
|
|
else
|
|
{
|
|
( void ) memcpy( ( void * ) pxQueue->u.xQueue.pcReadFrom, pvItemToQueue, ( size_t ) pxQueue->uxItemSize ); /*lint !e961 !e9087 !e418 MISRA exception as the casts are only redundant for some ports. Cast to void required by function signature and safe as no alignment requirement and copy length specified in bytes. Assert checks null pointer only used when length is 0. */
|
|
8007b3c: 68fb ldr r3, [r7, #12]
|
|
8007b3e: 68d8 ldr r0, [r3, #12]
|
|
8007b40: 68fb ldr r3, [r7, #12]
|
|
8007b42: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
8007b44: 461a mov r2, r3
|
|
8007b46: 68b9 ldr r1, [r7, #8]
|
|
8007b48: f002 fa4c bl 8009fe4 <memcpy>
|
|
pxQueue->u.xQueue.pcReadFrom -= pxQueue->uxItemSize;
|
|
8007b4c: 68fb ldr r3, [r7, #12]
|
|
8007b4e: 68da ldr r2, [r3, #12]
|
|
8007b50: 68fb ldr r3, [r7, #12]
|
|
8007b52: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
8007b54: 425b negs r3, r3
|
|
8007b56: 441a add r2, r3
|
|
8007b58: 68fb ldr r3, [r7, #12]
|
|
8007b5a: 60da str r2, [r3, #12]
|
|
if( pxQueue->u.xQueue.pcReadFrom < pxQueue->pcHead ) /*lint !e946 MISRA exception justified as comparison of pointers is the cleanest solution. */
|
|
8007b5c: 68fb ldr r3, [r7, #12]
|
|
8007b5e: 68da ldr r2, [r3, #12]
|
|
8007b60: 68fb ldr r3, [r7, #12]
|
|
8007b62: 681b ldr r3, [r3, #0]
|
|
8007b64: 429a cmp r2, r3
|
|
8007b66: d207 bcs.n 8007b78 <prvCopyDataToQueue+0xb0>
|
|
{
|
|
pxQueue->u.xQueue.pcReadFrom = ( pxQueue->u.xQueue.pcTail - pxQueue->uxItemSize );
|
|
8007b68: 68fb ldr r3, [r7, #12]
|
|
8007b6a: 689a ldr r2, [r3, #8]
|
|
8007b6c: 68fb ldr r3, [r7, #12]
|
|
8007b6e: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
8007b70: 425b negs r3, r3
|
|
8007b72: 441a add r2, r3
|
|
8007b74: 68fb ldr r3, [r7, #12]
|
|
8007b76: 60da str r2, [r3, #12]
|
|
else
|
|
{
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
|
|
if( xPosition == queueOVERWRITE )
|
|
8007b78: 687b ldr r3, [r7, #4]
|
|
8007b7a: 2b02 cmp r3, #2
|
|
8007b7c: d105 bne.n 8007b8a <prvCopyDataToQueue+0xc2>
|
|
{
|
|
if( uxMessagesWaiting > ( UBaseType_t ) 0 )
|
|
8007b7e: 693b ldr r3, [r7, #16]
|
|
8007b80: 2b00 cmp r3, #0
|
|
8007b82: d002 beq.n 8007b8a <prvCopyDataToQueue+0xc2>
|
|
{
|
|
/* An item is not being added but overwritten, so subtract
|
|
one from the recorded number of items in the queue so when
|
|
one is added again below the number of recorded items remains
|
|
correct. */
|
|
--uxMessagesWaiting;
|
|
8007b84: 693b ldr r3, [r7, #16]
|
|
8007b86: 3b01 subs r3, #1
|
|
8007b88: 613b str r3, [r7, #16]
|
|
{
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
}
|
|
|
|
pxQueue->uxMessagesWaiting = uxMessagesWaiting + ( UBaseType_t ) 1;
|
|
8007b8a: 693b ldr r3, [r7, #16]
|
|
8007b8c: 1c5a adds r2, r3, #1
|
|
8007b8e: 68fb ldr r3, [r7, #12]
|
|
8007b90: 639a str r2, [r3, #56] @ 0x38
|
|
|
|
return xReturn;
|
|
8007b92: 697b ldr r3, [r7, #20]
|
|
}
|
|
8007b94: 4618 mov r0, r3
|
|
8007b96: 3718 adds r7, #24
|
|
8007b98: 46bd mov sp, r7
|
|
8007b9a: bd80 pop {r7, pc}
|
|
|
|
08007b9c <prvCopyDataFromQueue>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
static void prvCopyDataFromQueue( Queue_t * const pxQueue, void * const pvBuffer )
|
|
{
|
|
8007b9c: b580 push {r7, lr}
|
|
8007b9e: b082 sub sp, #8
|
|
8007ba0: af00 add r7, sp, #0
|
|
8007ba2: 6078 str r0, [r7, #4]
|
|
8007ba4: 6039 str r1, [r7, #0]
|
|
if( pxQueue->uxItemSize != ( UBaseType_t ) 0 )
|
|
8007ba6: 687b ldr r3, [r7, #4]
|
|
8007ba8: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
8007baa: 2b00 cmp r3, #0
|
|
8007bac: d018 beq.n 8007be0 <prvCopyDataFromQueue+0x44>
|
|
{
|
|
pxQueue->u.xQueue.pcReadFrom += pxQueue->uxItemSize; /*lint !e9016 Pointer arithmetic on char types ok, especially in this use case where it is the clearest way of conveying intent. */
|
|
8007bae: 687b ldr r3, [r7, #4]
|
|
8007bb0: 68da ldr r2, [r3, #12]
|
|
8007bb2: 687b ldr r3, [r7, #4]
|
|
8007bb4: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
8007bb6: 441a add r2, r3
|
|
8007bb8: 687b ldr r3, [r7, #4]
|
|
8007bba: 60da str r2, [r3, #12]
|
|
if( pxQueue->u.xQueue.pcReadFrom >= pxQueue->u.xQueue.pcTail ) /*lint !e946 MISRA exception justified as use of the relational operator is the cleanest solutions. */
|
|
8007bbc: 687b ldr r3, [r7, #4]
|
|
8007bbe: 68da ldr r2, [r3, #12]
|
|
8007bc0: 687b ldr r3, [r7, #4]
|
|
8007bc2: 689b ldr r3, [r3, #8]
|
|
8007bc4: 429a cmp r2, r3
|
|
8007bc6: d303 bcc.n 8007bd0 <prvCopyDataFromQueue+0x34>
|
|
{
|
|
pxQueue->u.xQueue.pcReadFrom = pxQueue->pcHead;
|
|
8007bc8: 687b ldr r3, [r7, #4]
|
|
8007bca: 681a ldr r2, [r3, #0]
|
|
8007bcc: 687b ldr r3, [r7, #4]
|
|
8007bce: 60da str r2, [r3, #12]
|
|
}
|
|
else
|
|
{
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
( void ) memcpy( ( void * ) pvBuffer, ( void * ) pxQueue->u.xQueue.pcReadFrom, ( size_t ) pxQueue->uxItemSize ); /*lint !e961 !e418 !e9087 MISRA exception as the casts are only redundant for some ports. Also previous logic ensures a null pointer can only be passed to memcpy() when the count is 0. Cast to void required by function signature and safe as no alignment requirement and copy length specified in bytes. */
|
|
8007bd0: 687b ldr r3, [r7, #4]
|
|
8007bd2: 68d9 ldr r1, [r3, #12]
|
|
8007bd4: 687b ldr r3, [r7, #4]
|
|
8007bd6: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
8007bd8: 461a mov r2, r3
|
|
8007bda: 6838 ldr r0, [r7, #0]
|
|
8007bdc: f002 fa02 bl 8009fe4 <memcpy>
|
|
}
|
|
}
|
|
8007be0: bf00 nop
|
|
8007be2: 3708 adds r7, #8
|
|
8007be4: 46bd mov sp, r7
|
|
8007be6: bd80 pop {r7, pc}
|
|
|
|
08007be8 <prvUnlockQueue>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
static void prvUnlockQueue( Queue_t * const pxQueue )
|
|
{
|
|
8007be8: b580 push {r7, lr}
|
|
8007bea: b084 sub sp, #16
|
|
8007bec: af00 add r7, sp, #0
|
|
8007bee: 6078 str r0, [r7, #4]
|
|
|
|
/* The lock counts contains the number of extra data items placed or
|
|
removed from the queue while the queue was locked. When a queue is
|
|
locked items can be added or removed, but the event lists cannot be
|
|
updated. */
|
|
taskENTER_CRITICAL();
|
|
8007bf0: f001 fe52 bl 8009898 <vPortEnterCritical>
|
|
{
|
|
int8_t cTxLock = pxQueue->cTxLock;
|
|
8007bf4: 687b ldr r3, [r7, #4]
|
|
8007bf6: f893 3045 ldrb.w r3, [r3, #69] @ 0x45
|
|
8007bfa: 73fb strb r3, [r7, #15]
|
|
|
|
/* See if data was added to the queue while it was locked. */
|
|
while( cTxLock > queueLOCKED_UNMODIFIED )
|
|
8007bfc: e011 b.n 8007c22 <prvUnlockQueue+0x3a>
|
|
}
|
|
#else /* configUSE_QUEUE_SETS */
|
|
{
|
|
/* Tasks that are removed from the event list will get added to
|
|
the pending ready list as the scheduler is still suspended. */
|
|
if( listLIST_IS_EMPTY( &( pxQueue->xTasksWaitingToReceive ) ) == pdFALSE )
|
|
8007bfe: 687b ldr r3, [r7, #4]
|
|
8007c00: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
8007c02: 2b00 cmp r3, #0
|
|
8007c04: d012 beq.n 8007c2c <prvUnlockQueue+0x44>
|
|
{
|
|
if( xTaskRemoveFromEventList( &( pxQueue->xTasksWaitingToReceive ) ) != pdFALSE )
|
|
8007c06: 687b ldr r3, [r7, #4]
|
|
8007c08: 3324 adds r3, #36 @ 0x24
|
|
8007c0a: 4618 mov r0, r3
|
|
8007c0c: f000 fd50 bl 80086b0 <xTaskRemoveFromEventList>
|
|
8007c10: 4603 mov r3, r0
|
|
8007c12: 2b00 cmp r3, #0
|
|
8007c14: d001 beq.n 8007c1a <prvUnlockQueue+0x32>
|
|
{
|
|
/* The task waiting has a higher priority so record that
|
|
a context switch is required. */
|
|
vTaskMissedYield();
|
|
8007c16: f000 fe29 bl 800886c <vTaskMissedYield>
|
|
break;
|
|
}
|
|
}
|
|
#endif /* configUSE_QUEUE_SETS */
|
|
|
|
--cTxLock;
|
|
8007c1a: 7bfb ldrb r3, [r7, #15]
|
|
8007c1c: 3b01 subs r3, #1
|
|
8007c1e: b2db uxtb r3, r3
|
|
8007c20: 73fb strb r3, [r7, #15]
|
|
while( cTxLock > queueLOCKED_UNMODIFIED )
|
|
8007c22: f997 300f ldrsb.w r3, [r7, #15]
|
|
8007c26: 2b00 cmp r3, #0
|
|
8007c28: dce9 bgt.n 8007bfe <prvUnlockQueue+0x16>
|
|
8007c2a: e000 b.n 8007c2e <prvUnlockQueue+0x46>
|
|
break;
|
|
8007c2c: bf00 nop
|
|
}
|
|
|
|
pxQueue->cTxLock = queueUNLOCKED;
|
|
8007c2e: 687b ldr r3, [r7, #4]
|
|
8007c30: 22ff movs r2, #255 @ 0xff
|
|
8007c32: f883 2045 strb.w r2, [r3, #69] @ 0x45
|
|
}
|
|
taskEXIT_CRITICAL();
|
|
8007c36: f001 fe61 bl 80098fc <vPortExitCritical>
|
|
|
|
/* Do the same for the Rx lock. */
|
|
taskENTER_CRITICAL();
|
|
8007c3a: f001 fe2d bl 8009898 <vPortEnterCritical>
|
|
{
|
|
int8_t cRxLock = pxQueue->cRxLock;
|
|
8007c3e: 687b ldr r3, [r7, #4]
|
|
8007c40: f893 3044 ldrb.w r3, [r3, #68] @ 0x44
|
|
8007c44: 73bb strb r3, [r7, #14]
|
|
|
|
while( cRxLock > queueLOCKED_UNMODIFIED )
|
|
8007c46: e011 b.n 8007c6c <prvUnlockQueue+0x84>
|
|
{
|
|
if( listLIST_IS_EMPTY( &( pxQueue->xTasksWaitingToSend ) ) == pdFALSE )
|
|
8007c48: 687b ldr r3, [r7, #4]
|
|
8007c4a: 691b ldr r3, [r3, #16]
|
|
8007c4c: 2b00 cmp r3, #0
|
|
8007c4e: d012 beq.n 8007c76 <prvUnlockQueue+0x8e>
|
|
{
|
|
if( xTaskRemoveFromEventList( &( pxQueue->xTasksWaitingToSend ) ) != pdFALSE )
|
|
8007c50: 687b ldr r3, [r7, #4]
|
|
8007c52: 3310 adds r3, #16
|
|
8007c54: 4618 mov r0, r3
|
|
8007c56: f000 fd2b bl 80086b0 <xTaskRemoveFromEventList>
|
|
8007c5a: 4603 mov r3, r0
|
|
8007c5c: 2b00 cmp r3, #0
|
|
8007c5e: d001 beq.n 8007c64 <prvUnlockQueue+0x7c>
|
|
{
|
|
vTaskMissedYield();
|
|
8007c60: f000 fe04 bl 800886c <vTaskMissedYield>
|
|
else
|
|
{
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
|
|
--cRxLock;
|
|
8007c64: 7bbb ldrb r3, [r7, #14]
|
|
8007c66: 3b01 subs r3, #1
|
|
8007c68: b2db uxtb r3, r3
|
|
8007c6a: 73bb strb r3, [r7, #14]
|
|
while( cRxLock > queueLOCKED_UNMODIFIED )
|
|
8007c6c: f997 300e ldrsb.w r3, [r7, #14]
|
|
8007c70: 2b00 cmp r3, #0
|
|
8007c72: dce9 bgt.n 8007c48 <prvUnlockQueue+0x60>
|
|
8007c74: e000 b.n 8007c78 <prvUnlockQueue+0x90>
|
|
}
|
|
else
|
|
{
|
|
break;
|
|
8007c76: bf00 nop
|
|
}
|
|
}
|
|
|
|
pxQueue->cRxLock = queueUNLOCKED;
|
|
8007c78: 687b ldr r3, [r7, #4]
|
|
8007c7a: 22ff movs r2, #255 @ 0xff
|
|
8007c7c: f883 2044 strb.w r2, [r3, #68] @ 0x44
|
|
}
|
|
taskEXIT_CRITICAL();
|
|
8007c80: f001 fe3c bl 80098fc <vPortExitCritical>
|
|
}
|
|
8007c84: bf00 nop
|
|
8007c86: 3710 adds r7, #16
|
|
8007c88: 46bd mov sp, r7
|
|
8007c8a: bd80 pop {r7, pc}
|
|
|
|
08007c8c <prvIsQueueEmpty>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
static BaseType_t prvIsQueueEmpty( const Queue_t *pxQueue )
|
|
{
|
|
8007c8c: b580 push {r7, lr}
|
|
8007c8e: b084 sub sp, #16
|
|
8007c90: af00 add r7, sp, #0
|
|
8007c92: 6078 str r0, [r7, #4]
|
|
BaseType_t xReturn;
|
|
|
|
taskENTER_CRITICAL();
|
|
8007c94: f001 fe00 bl 8009898 <vPortEnterCritical>
|
|
{
|
|
if( pxQueue->uxMessagesWaiting == ( UBaseType_t ) 0 )
|
|
8007c98: 687b ldr r3, [r7, #4]
|
|
8007c9a: 6b9b ldr r3, [r3, #56] @ 0x38
|
|
8007c9c: 2b00 cmp r3, #0
|
|
8007c9e: d102 bne.n 8007ca6 <prvIsQueueEmpty+0x1a>
|
|
{
|
|
xReturn = pdTRUE;
|
|
8007ca0: 2301 movs r3, #1
|
|
8007ca2: 60fb str r3, [r7, #12]
|
|
8007ca4: e001 b.n 8007caa <prvIsQueueEmpty+0x1e>
|
|
}
|
|
else
|
|
{
|
|
xReturn = pdFALSE;
|
|
8007ca6: 2300 movs r3, #0
|
|
8007ca8: 60fb str r3, [r7, #12]
|
|
}
|
|
}
|
|
taskEXIT_CRITICAL();
|
|
8007caa: f001 fe27 bl 80098fc <vPortExitCritical>
|
|
|
|
return xReturn;
|
|
8007cae: 68fb ldr r3, [r7, #12]
|
|
}
|
|
8007cb0: 4618 mov r0, r3
|
|
8007cb2: 3710 adds r7, #16
|
|
8007cb4: 46bd mov sp, r7
|
|
8007cb6: bd80 pop {r7, pc}
|
|
|
|
08007cb8 <prvIsQueueFull>:
|
|
return xReturn;
|
|
} /*lint !e818 xQueue could not be pointer to const because it is a typedef. */
|
|
/*-----------------------------------------------------------*/
|
|
|
|
static BaseType_t prvIsQueueFull( const Queue_t *pxQueue )
|
|
{
|
|
8007cb8: b580 push {r7, lr}
|
|
8007cba: b084 sub sp, #16
|
|
8007cbc: af00 add r7, sp, #0
|
|
8007cbe: 6078 str r0, [r7, #4]
|
|
BaseType_t xReturn;
|
|
|
|
taskENTER_CRITICAL();
|
|
8007cc0: f001 fdea bl 8009898 <vPortEnterCritical>
|
|
{
|
|
if( pxQueue->uxMessagesWaiting == pxQueue->uxLength )
|
|
8007cc4: 687b ldr r3, [r7, #4]
|
|
8007cc6: 6b9a ldr r2, [r3, #56] @ 0x38
|
|
8007cc8: 687b ldr r3, [r7, #4]
|
|
8007cca: 6bdb ldr r3, [r3, #60] @ 0x3c
|
|
8007ccc: 429a cmp r2, r3
|
|
8007cce: d102 bne.n 8007cd6 <prvIsQueueFull+0x1e>
|
|
{
|
|
xReturn = pdTRUE;
|
|
8007cd0: 2301 movs r3, #1
|
|
8007cd2: 60fb str r3, [r7, #12]
|
|
8007cd4: e001 b.n 8007cda <prvIsQueueFull+0x22>
|
|
}
|
|
else
|
|
{
|
|
xReturn = pdFALSE;
|
|
8007cd6: 2300 movs r3, #0
|
|
8007cd8: 60fb str r3, [r7, #12]
|
|
}
|
|
}
|
|
taskEXIT_CRITICAL();
|
|
8007cda: f001 fe0f bl 80098fc <vPortExitCritical>
|
|
|
|
return xReturn;
|
|
8007cde: 68fb ldr r3, [r7, #12]
|
|
}
|
|
8007ce0: 4618 mov r0, r3
|
|
8007ce2: 3710 adds r7, #16
|
|
8007ce4: 46bd mov sp, r7
|
|
8007ce6: bd80 pop {r7, pc}
|
|
|
|
08007ce8 <vQueueAddToRegistry>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
#if ( configQUEUE_REGISTRY_SIZE > 0 )
|
|
|
|
void vQueueAddToRegistry( QueueHandle_t xQueue, const char *pcQueueName ) /*lint !e971 Unqualified char types are allowed for strings and single characters only. */
|
|
{
|
|
8007ce8: b480 push {r7}
|
|
8007cea: b085 sub sp, #20
|
|
8007cec: af00 add r7, sp, #0
|
|
8007cee: 6078 str r0, [r7, #4]
|
|
8007cf0: 6039 str r1, [r7, #0]
|
|
UBaseType_t ux;
|
|
|
|
/* See if there is an empty space in the registry. A NULL name denotes
|
|
a free slot. */
|
|
for( ux = ( UBaseType_t ) 0U; ux < ( UBaseType_t ) configQUEUE_REGISTRY_SIZE; ux++ )
|
|
8007cf2: 2300 movs r3, #0
|
|
8007cf4: 60fb str r3, [r7, #12]
|
|
8007cf6: e014 b.n 8007d22 <vQueueAddToRegistry+0x3a>
|
|
{
|
|
if( xQueueRegistry[ ux ].pcQueueName == NULL )
|
|
8007cf8: 4a0f ldr r2, [pc, #60] @ (8007d38 <vQueueAddToRegistry+0x50>)
|
|
8007cfa: 68fb ldr r3, [r7, #12]
|
|
8007cfc: f852 3033 ldr.w r3, [r2, r3, lsl #3]
|
|
8007d00: 2b00 cmp r3, #0
|
|
8007d02: d10b bne.n 8007d1c <vQueueAddToRegistry+0x34>
|
|
{
|
|
/* Store the information on this queue. */
|
|
xQueueRegistry[ ux ].pcQueueName = pcQueueName;
|
|
8007d04: 490c ldr r1, [pc, #48] @ (8007d38 <vQueueAddToRegistry+0x50>)
|
|
8007d06: 68fb ldr r3, [r7, #12]
|
|
8007d08: 683a ldr r2, [r7, #0]
|
|
8007d0a: f841 2033 str.w r2, [r1, r3, lsl #3]
|
|
xQueueRegistry[ ux ].xHandle = xQueue;
|
|
8007d0e: 4a0a ldr r2, [pc, #40] @ (8007d38 <vQueueAddToRegistry+0x50>)
|
|
8007d10: 68fb ldr r3, [r7, #12]
|
|
8007d12: 00db lsls r3, r3, #3
|
|
8007d14: 4413 add r3, r2
|
|
8007d16: 687a ldr r2, [r7, #4]
|
|
8007d18: 605a str r2, [r3, #4]
|
|
|
|
traceQUEUE_REGISTRY_ADD( xQueue, pcQueueName );
|
|
break;
|
|
8007d1a: e006 b.n 8007d2a <vQueueAddToRegistry+0x42>
|
|
for( ux = ( UBaseType_t ) 0U; ux < ( UBaseType_t ) configQUEUE_REGISTRY_SIZE; ux++ )
|
|
8007d1c: 68fb ldr r3, [r7, #12]
|
|
8007d1e: 3301 adds r3, #1
|
|
8007d20: 60fb str r3, [r7, #12]
|
|
8007d22: 68fb ldr r3, [r7, #12]
|
|
8007d24: 2b07 cmp r3, #7
|
|
8007d26: d9e7 bls.n 8007cf8 <vQueueAddToRegistry+0x10>
|
|
else
|
|
{
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
}
|
|
}
|
|
8007d28: bf00 nop
|
|
8007d2a: bf00 nop
|
|
8007d2c: 3714 adds r7, #20
|
|
8007d2e: 46bd mov sp, r7
|
|
8007d30: f85d 7b04 ldr.w r7, [sp], #4
|
|
8007d34: 4770 bx lr
|
|
8007d36: bf00 nop
|
|
8007d38: 20000a80 .word 0x20000a80
|
|
|
|
08007d3c <vQueueUnregisterQueue>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
#if ( configQUEUE_REGISTRY_SIZE > 0 )
|
|
|
|
void vQueueUnregisterQueue( QueueHandle_t xQueue )
|
|
{
|
|
8007d3c: b480 push {r7}
|
|
8007d3e: b085 sub sp, #20
|
|
8007d40: af00 add r7, sp, #0
|
|
8007d42: 6078 str r0, [r7, #4]
|
|
UBaseType_t ux;
|
|
|
|
/* See if the handle of the queue being unregistered in actually in the
|
|
registry. */
|
|
for( ux = ( UBaseType_t ) 0U; ux < ( UBaseType_t ) configQUEUE_REGISTRY_SIZE; ux++ )
|
|
8007d44: 2300 movs r3, #0
|
|
8007d46: 60fb str r3, [r7, #12]
|
|
8007d48: e016 b.n 8007d78 <vQueueUnregisterQueue+0x3c>
|
|
{
|
|
if( xQueueRegistry[ ux ].xHandle == xQueue )
|
|
8007d4a: 4a10 ldr r2, [pc, #64] @ (8007d8c <vQueueUnregisterQueue+0x50>)
|
|
8007d4c: 68fb ldr r3, [r7, #12]
|
|
8007d4e: 00db lsls r3, r3, #3
|
|
8007d50: 4413 add r3, r2
|
|
8007d52: 685b ldr r3, [r3, #4]
|
|
8007d54: 687a ldr r2, [r7, #4]
|
|
8007d56: 429a cmp r2, r3
|
|
8007d58: d10b bne.n 8007d72 <vQueueUnregisterQueue+0x36>
|
|
{
|
|
/* Set the name to NULL to show that this slot if free again. */
|
|
xQueueRegistry[ ux ].pcQueueName = NULL;
|
|
8007d5a: 4a0c ldr r2, [pc, #48] @ (8007d8c <vQueueUnregisterQueue+0x50>)
|
|
8007d5c: 68fb ldr r3, [r7, #12]
|
|
8007d5e: 2100 movs r1, #0
|
|
8007d60: f842 1033 str.w r1, [r2, r3, lsl #3]
|
|
|
|
/* Set the handle to NULL to ensure the same queue handle cannot
|
|
appear in the registry twice if it is added, removed, then
|
|
added again. */
|
|
xQueueRegistry[ ux ].xHandle = ( QueueHandle_t ) 0;
|
|
8007d64: 4a09 ldr r2, [pc, #36] @ (8007d8c <vQueueUnregisterQueue+0x50>)
|
|
8007d66: 68fb ldr r3, [r7, #12]
|
|
8007d68: 00db lsls r3, r3, #3
|
|
8007d6a: 4413 add r3, r2
|
|
8007d6c: 2200 movs r2, #0
|
|
8007d6e: 605a str r2, [r3, #4]
|
|
break;
|
|
8007d70: e006 b.n 8007d80 <vQueueUnregisterQueue+0x44>
|
|
for( ux = ( UBaseType_t ) 0U; ux < ( UBaseType_t ) configQUEUE_REGISTRY_SIZE; ux++ )
|
|
8007d72: 68fb ldr r3, [r7, #12]
|
|
8007d74: 3301 adds r3, #1
|
|
8007d76: 60fb str r3, [r7, #12]
|
|
8007d78: 68fb ldr r3, [r7, #12]
|
|
8007d7a: 2b07 cmp r3, #7
|
|
8007d7c: d9e5 bls.n 8007d4a <vQueueUnregisterQueue+0xe>
|
|
{
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
}
|
|
|
|
} /*lint !e818 xQueue could not be pointer to const because it is a typedef. */
|
|
8007d7e: bf00 nop
|
|
8007d80: bf00 nop
|
|
8007d82: 3714 adds r7, #20
|
|
8007d84: 46bd mov sp, r7
|
|
8007d86: f85d 7b04 ldr.w r7, [sp], #4
|
|
8007d8a: 4770 bx lr
|
|
8007d8c: 20000a80 .word 0x20000a80
|
|
|
|
08007d90 <vQueueWaitForMessageRestricted>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
#if ( configUSE_TIMERS == 1 )
|
|
|
|
void vQueueWaitForMessageRestricted( QueueHandle_t xQueue, TickType_t xTicksToWait, const BaseType_t xWaitIndefinitely )
|
|
{
|
|
8007d90: b580 push {r7, lr}
|
|
8007d92: b086 sub sp, #24
|
|
8007d94: af00 add r7, sp, #0
|
|
8007d96: 60f8 str r0, [r7, #12]
|
|
8007d98: 60b9 str r1, [r7, #8]
|
|
8007d9a: 607a str r2, [r7, #4]
|
|
Queue_t * const pxQueue = xQueue;
|
|
8007d9c: 68fb ldr r3, [r7, #12]
|
|
8007d9e: 617b str r3, [r7, #20]
|
|
will not actually cause the task to block, just place it on a blocked
|
|
list. It will not block until the scheduler is unlocked - at which
|
|
time a yield will be performed. If an item is added to the queue while
|
|
the queue is locked, and the calling task blocks on the queue, then the
|
|
calling task will be immediately unblocked when the queue is unlocked. */
|
|
prvLockQueue( pxQueue );
|
|
8007da0: f001 fd7a bl 8009898 <vPortEnterCritical>
|
|
8007da4: 697b ldr r3, [r7, #20]
|
|
8007da6: f893 3044 ldrb.w r3, [r3, #68] @ 0x44
|
|
8007daa: b25b sxtb r3, r3
|
|
8007dac: f1b3 3fff cmp.w r3, #4294967295 @ 0xffffffff
|
|
8007db0: d103 bne.n 8007dba <vQueueWaitForMessageRestricted+0x2a>
|
|
8007db2: 697b ldr r3, [r7, #20]
|
|
8007db4: 2200 movs r2, #0
|
|
8007db6: f883 2044 strb.w r2, [r3, #68] @ 0x44
|
|
8007dba: 697b ldr r3, [r7, #20]
|
|
8007dbc: f893 3045 ldrb.w r3, [r3, #69] @ 0x45
|
|
8007dc0: b25b sxtb r3, r3
|
|
8007dc2: f1b3 3fff cmp.w r3, #4294967295 @ 0xffffffff
|
|
8007dc6: d103 bne.n 8007dd0 <vQueueWaitForMessageRestricted+0x40>
|
|
8007dc8: 697b ldr r3, [r7, #20]
|
|
8007dca: 2200 movs r2, #0
|
|
8007dcc: f883 2045 strb.w r2, [r3, #69] @ 0x45
|
|
8007dd0: f001 fd94 bl 80098fc <vPortExitCritical>
|
|
if( pxQueue->uxMessagesWaiting == ( UBaseType_t ) 0U )
|
|
8007dd4: 697b ldr r3, [r7, #20]
|
|
8007dd6: 6b9b ldr r3, [r3, #56] @ 0x38
|
|
8007dd8: 2b00 cmp r3, #0
|
|
8007dda: d106 bne.n 8007dea <vQueueWaitForMessageRestricted+0x5a>
|
|
{
|
|
/* There is nothing in the queue, block for the specified period. */
|
|
vTaskPlaceOnEventListRestricted( &( pxQueue->xTasksWaitingToReceive ), xTicksToWait, xWaitIndefinitely );
|
|
8007ddc: 697b ldr r3, [r7, #20]
|
|
8007dde: 3324 adds r3, #36 @ 0x24
|
|
8007de0: 687a ldr r2, [r7, #4]
|
|
8007de2: 68b9 ldr r1, [r7, #8]
|
|
8007de4: 4618 mov r0, r3
|
|
8007de6: f000 fc37 bl 8008658 <vTaskPlaceOnEventListRestricted>
|
|
}
|
|
else
|
|
{
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
prvUnlockQueue( pxQueue );
|
|
8007dea: 6978 ldr r0, [r7, #20]
|
|
8007dec: f7ff fefc bl 8007be8 <prvUnlockQueue>
|
|
}
|
|
8007df0: bf00 nop
|
|
8007df2: 3718 adds r7, #24
|
|
8007df4: 46bd mov sp, r7
|
|
8007df6: bd80 pop {r7, pc}
|
|
|
|
08007df8 <xTaskCreateStatic>:
|
|
const uint32_t ulStackDepth,
|
|
void * const pvParameters,
|
|
UBaseType_t uxPriority,
|
|
StackType_t * const puxStackBuffer,
|
|
StaticTask_t * const pxTaskBuffer )
|
|
{
|
|
8007df8: b580 push {r7, lr}
|
|
8007dfa: b08e sub sp, #56 @ 0x38
|
|
8007dfc: af04 add r7, sp, #16
|
|
8007dfe: 60f8 str r0, [r7, #12]
|
|
8007e00: 60b9 str r1, [r7, #8]
|
|
8007e02: 607a str r2, [r7, #4]
|
|
8007e04: 603b str r3, [r7, #0]
|
|
TCB_t *pxNewTCB;
|
|
TaskHandle_t xReturn;
|
|
|
|
configASSERT( puxStackBuffer != NULL );
|
|
8007e06: 6b7b ldr r3, [r7, #52] @ 0x34
|
|
8007e08: 2b00 cmp r3, #0
|
|
8007e0a: d10b bne.n 8007e24 <xTaskCreateStatic+0x2c>
|
|
__asm volatile
|
|
8007e0c: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8007e10: f383 8811 msr BASEPRI, r3
|
|
8007e14: f3bf 8f6f isb sy
|
|
8007e18: f3bf 8f4f dsb sy
|
|
8007e1c: 623b str r3, [r7, #32]
|
|
}
|
|
8007e1e: bf00 nop
|
|
8007e20: bf00 nop
|
|
8007e22: e7fd b.n 8007e20 <xTaskCreateStatic+0x28>
|
|
configASSERT( pxTaskBuffer != NULL );
|
|
8007e24: 6bbb ldr r3, [r7, #56] @ 0x38
|
|
8007e26: 2b00 cmp r3, #0
|
|
8007e28: d10b bne.n 8007e42 <xTaskCreateStatic+0x4a>
|
|
__asm volatile
|
|
8007e2a: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8007e2e: f383 8811 msr BASEPRI, r3
|
|
8007e32: f3bf 8f6f isb sy
|
|
8007e36: f3bf 8f4f dsb sy
|
|
8007e3a: 61fb str r3, [r7, #28]
|
|
}
|
|
8007e3c: bf00 nop
|
|
8007e3e: bf00 nop
|
|
8007e40: e7fd b.n 8007e3e <xTaskCreateStatic+0x46>
|
|
#if( configASSERT_DEFINED == 1 )
|
|
{
|
|
/* Sanity check that the size of the structure used to declare a
|
|
variable of type StaticTask_t equals the size of the real task
|
|
structure. */
|
|
volatile size_t xSize = sizeof( StaticTask_t );
|
|
8007e42: 23a8 movs r3, #168 @ 0xa8
|
|
8007e44: 613b str r3, [r7, #16]
|
|
configASSERT( xSize == sizeof( TCB_t ) );
|
|
8007e46: 693b ldr r3, [r7, #16]
|
|
8007e48: 2ba8 cmp r3, #168 @ 0xa8
|
|
8007e4a: d00b beq.n 8007e64 <xTaskCreateStatic+0x6c>
|
|
__asm volatile
|
|
8007e4c: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8007e50: f383 8811 msr BASEPRI, r3
|
|
8007e54: f3bf 8f6f isb sy
|
|
8007e58: f3bf 8f4f dsb sy
|
|
8007e5c: 61bb str r3, [r7, #24]
|
|
}
|
|
8007e5e: bf00 nop
|
|
8007e60: bf00 nop
|
|
8007e62: e7fd b.n 8007e60 <xTaskCreateStatic+0x68>
|
|
( void ) xSize; /* Prevent lint warning when configASSERT() is not used. */
|
|
8007e64: 693b ldr r3, [r7, #16]
|
|
}
|
|
#endif /* configASSERT_DEFINED */
|
|
|
|
|
|
if( ( pxTaskBuffer != NULL ) && ( puxStackBuffer != NULL ) )
|
|
8007e66: 6bbb ldr r3, [r7, #56] @ 0x38
|
|
8007e68: 2b00 cmp r3, #0
|
|
8007e6a: d01e beq.n 8007eaa <xTaskCreateStatic+0xb2>
|
|
8007e6c: 6b7b ldr r3, [r7, #52] @ 0x34
|
|
8007e6e: 2b00 cmp r3, #0
|
|
8007e70: d01b beq.n 8007eaa <xTaskCreateStatic+0xb2>
|
|
{
|
|
/* The memory used for the task's TCB and stack are passed into this
|
|
function - use them. */
|
|
pxNewTCB = ( TCB_t * ) pxTaskBuffer; /*lint !e740 !e9087 Unusual cast is ok as the structures are designed to have the same alignment, and the size is checked by an assert. */
|
|
8007e72: 6bbb ldr r3, [r7, #56] @ 0x38
|
|
8007e74: 627b str r3, [r7, #36] @ 0x24
|
|
pxNewTCB->pxStack = ( StackType_t * ) puxStackBuffer;
|
|
8007e76: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8007e78: 6b7a ldr r2, [r7, #52] @ 0x34
|
|
8007e7a: 631a str r2, [r3, #48] @ 0x30
|
|
|
|
#if( tskSTATIC_AND_DYNAMIC_ALLOCATION_POSSIBLE != 0 ) /*lint !e731 !e9029 Macro has been consolidated for readability reasons. */
|
|
{
|
|
/* Tasks can be created statically or dynamically, so note this
|
|
task was created statically in case the task is later deleted. */
|
|
pxNewTCB->ucStaticallyAllocated = tskSTATICALLY_ALLOCATED_STACK_AND_TCB;
|
|
8007e7c: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8007e7e: 2202 movs r2, #2
|
|
8007e80: f883 20a5 strb.w r2, [r3, #165] @ 0xa5
|
|
}
|
|
#endif /* tskSTATIC_AND_DYNAMIC_ALLOCATION_POSSIBLE */
|
|
|
|
prvInitialiseNewTask( pxTaskCode, pcName, ulStackDepth, pvParameters, uxPriority, &xReturn, pxNewTCB, NULL );
|
|
8007e84: 2300 movs r3, #0
|
|
8007e86: 9303 str r3, [sp, #12]
|
|
8007e88: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8007e8a: 9302 str r3, [sp, #8]
|
|
8007e8c: f107 0314 add.w r3, r7, #20
|
|
8007e90: 9301 str r3, [sp, #4]
|
|
8007e92: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
8007e94: 9300 str r3, [sp, #0]
|
|
8007e96: 683b ldr r3, [r7, #0]
|
|
8007e98: 687a ldr r2, [r7, #4]
|
|
8007e9a: 68b9 ldr r1, [r7, #8]
|
|
8007e9c: 68f8 ldr r0, [r7, #12]
|
|
8007e9e: f000 f851 bl 8007f44 <prvInitialiseNewTask>
|
|
prvAddNewTaskToReadyList( pxNewTCB );
|
|
8007ea2: 6a78 ldr r0, [r7, #36] @ 0x24
|
|
8007ea4: f000 f8f6 bl 8008094 <prvAddNewTaskToReadyList>
|
|
8007ea8: e001 b.n 8007eae <xTaskCreateStatic+0xb6>
|
|
}
|
|
else
|
|
{
|
|
xReturn = NULL;
|
|
8007eaa: 2300 movs r3, #0
|
|
8007eac: 617b str r3, [r7, #20]
|
|
}
|
|
|
|
return xReturn;
|
|
8007eae: 697b ldr r3, [r7, #20]
|
|
}
|
|
8007eb0: 4618 mov r0, r3
|
|
8007eb2: 3728 adds r7, #40 @ 0x28
|
|
8007eb4: 46bd mov sp, r7
|
|
8007eb6: bd80 pop {r7, pc}
|
|
|
|
08007eb8 <xTaskCreate>:
|
|
const char * const pcName, /*lint !e971 Unqualified char types are allowed for strings and single characters only. */
|
|
const configSTACK_DEPTH_TYPE usStackDepth,
|
|
void * const pvParameters,
|
|
UBaseType_t uxPriority,
|
|
TaskHandle_t * const pxCreatedTask )
|
|
{
|
|
8007eb8: b580 push {r7, lr}
|
|
8007eba: b08c sub sp, #48 @ 0x30
|
|
8007ebc: af04 add r7, sp, #16
|
|
8007ebe: 60f8 str r0, [r7, #12]
|
|
8007ec0: 60b9 str r1, [r7, #8]
|
|
8007ec2: 603b str r3, [r7, #0]
|
|
8007ec4: 4613 mov r3, r2
|
|
8007ec6: 80fb strh r3, [r7, #6]
|
|
#else /* portSTACK_GROWTH */
|
|
{
|
|
StackType_t *pxStack;
|
|
|
|
/* Allocate space for the stack used by the task being created. */
|
|
pxStack = pvPortMalloc( ( ( ( size_t ) usStackDepth ) * sizeof( StackType_t ) ) ); /*lint !e9079 All values returned by pvPortMalloc() have at least the alignment required by the MCU's stack and this allocation is the stack. */
|
|
8007ec8: 88fb ldrh r3, [r7, #6]
|
|
8007eca: 009b lsls r3, r3, #2
|
|
8007ecc: 4618 mov r0, r3
|
|
8007ece: f001 fe05 bl 8009adc <pvPortMalloc>
|
|
8007ed2: 6178 str r0, [r7, #20]
|
|
|
|
if( pxStack != NULL )
|
|
8007ed4: 697b ldr r3, [r7, #20]
|
|
8007ed6: 2b00 cmp r3, #0
|
|
8007ed8: d00e beq.n 8007ef8 <xTaskCreate+0x40>
|
|
{
|
|
/* Allocate space for the TCB. */
|
|
pxNewTCB = ( TCB_t * ) pvPortMalloc( sizeof( TCB_t ) ); /*lint !e9087 !e9079 All values returned by pvPortMalloc() have at least the alignment required by the MCU's stack, and the first member of TCB_t is always a pointer to the task's stack. */
|
|
8007eda: 20a8 movs r0, #168 @ 0xa8
|
|
8007edc: f001 fdfe bl 8009adc <pvPortMalloc>
|
|
8007ee0: 61f8 str r0, [r7, #28]
|
|
|
|
if( pxNewTCB != NULL )
|
|
8007ee2: 69fb ldr r3, [r7, #28]
|
|
8007ee4: 2b00 cmp r3, #0
|
|
8007ee6: d003 beq.n 8007ef0 <xTaskCreate+0x38>
|
|
{
|
|
/* Store the stack location in the TCB. */
|
|
pxNewTCB->pxStack = pxStack;
|
|
8007ee8: 69fb ldr r3, [r7, #28]
|
|
8007eea: 697a ldr r2, [r7, #20]
|
|
8007eec: 631a str r2, [r3, #48] @ 0x30
|
|
8007eee: e005 b.n 8007efc <xTaskCreate+0x44>
|
|
}
|
|
else
|
|
{
|
|
/* The stack cannot be used as the TCB was not created. Free
|
|
it again. */
|
|
vPortFree( pxStack );
|
|
8007ef0: 6978 ldr r0, [r7, #20]
|
|
8007ef2: f001 fec1 bl 8009c78 <vPortFree>
|
|
8007ef6: e001 b.n 8007efc <xTaskCreate+0x44>
|
|
}
|
|
}
|
|
else
|
|
{
|
|
pxNewTCB = NULL;
|
|
8007ef8: 2300 movs r3, #0
|
|
8007efa: 61fb str r3, [r7, #28]
|
|
}
|
|
}
|
|
#endif /* portSTACK_GROWTH */
|
|
|
|
if( pxNewTCB != NULL )
|
|
8007efc: 69fb ldr r3, [r7, #28]
|
|
8007efe: 2b00 cmp r3, #0
|
|
8007f00: d017 beq.n 8007f32 <xTaskCreate+0x7a>
|
|
{
|
|
#if( tskSTATIC_AND_DYNAMIC_ALLOCATION_POSSIBLE != 0 ) /*lint !e9029 !e731 Macro has been consolidated for readability reasons. */
|
|
{
|
|
/* Tasks can be created statically or dynamically, so note this
|
|
task was created dynamically in case it is later deleted. */
|
|
pxNewTCB->ucStaticallyAllocated = tskDYNAMICALLY_ALLOCATED_STACK_AND_TCB;
|
|
8007f02: 69fb ldr r3, [r7, #28]
|
|
8007f04: 2200 movs r2, #0
|
|
8007f06: f883 20a5 strb.w r2, [r3, #165] @ 0xa5
|
|
}
|
|
#endif /* tskSTATIC_AND_DYNAMIC_ALLOCATION_POSSIBLE */
|
|
|
|
prvInitialiseNewTask( pxTaskCode, pcName, ( uint32_t ) usStackDepth, pvParameters, uxPriority, pxCreatedTask, pxNewTCB, NULL );
|
|
8007f0a: 88fa ldrh r2, [r7, #6]
|
|
8007f0c: 2300 movs r3, #0
|
|
8007f0e: 9303 str r3, [sp, #12]
|
|
8007f10: 69fb ldr r3, [r7, #28]
|
|
8007f12: 9302 str r3, [sp, #8]
|
|
8007f14: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
8007f16: 9301 str r3, [sp, #4]
|
|
8007f18: 6abb ldr r3, [r7, #40] @ 0x28
|
|
8007f1a: 9300 str r3, [sp, #0]
|
|
8007f1c: 683b ldr r3, [r7, #0]
|
|
8007f1e: 68b9 ldr r1, [r7, #8]
|
|
8007f20: 68f8 ldr r0, [r7, #12]
|
|
8007f22: f000 f80f bl 8007f44 <prvInitialiseNewTask>
|
|
prvAddNewTaskToReadyList( pxNewTCB );
|
|
8007f26: 69f8 ldr r0, [r7, #28]
|
|
8007f28: f000 f8b4 bl 8008094 <prvAddNewTaskToReadyList>
|
|
xReturn = pdPASS;
|
|
8007f2c: 2301 movs r3, #1
|
|
8007f2e: 61bb str r3, [r7, #24]
|
|
8007f30: e002 b.n 8007f38 <xTaskCreate+0x80>
|
|
}
|
|
else
|
|
{
|
|
xReturn = errCOULD_NOT_ALLOCATE_REQUIRED_MEMORY;
|
|
8007f32: f04f 33ff mov.w r3, #4294967295 @ 0xffffffff
|
|
8007f36: 61bb str r3, [r7, #24]
|
|
}
|
|
|
|
return xReturn;
|
|
8007f38: 69bb ldr r3, [r7, #24]
|
|
}
|
|
8007f3a: 4618 mov r0, r3
|
|
8007f3c: 3720 adds r7, #32
|
|
8007f3e: 46bd mov sp, r7
|
|
8007f40: bd80 pop {r7, pc}
|
|
...
|
|
|
|
08007f44 <prvInitialiseNewTask>:
|
|
void * const pvParameters,
|
|
UBaseType_t uxPriority,
|
|
TaskHandle_t * const pxCreatedTask,
|
|
TCB_t *pxNewTCB,
|
|
const MemoryRegion_t * const xRegions )
|
|
{
|
|
8007f44: b580 push {r7, lr}
|
|
8007f46: b088 sub sp, #32
|
|
8007f48: af00 add r7, sp, #0
|
|
8007f4a: 60f8 str r0, [r7, #12]
|
|
8007f4c: 60b9 str r1, [r7, #8]
|
|
8007f4e: 607a str r2, [r7, #4]
|
|
8007f50: 603b str r3, [r7, #0]
|
|
|
|
/* Avoid dependency on memset() if it is not required. */
|
|
#if( tskSET_NEW_STACKS_TO_KNOWN_VALUE == 1 )
|
|
{
|
|
/* Fill the stack with a known value to assist debugging. */
|
|
( void ) memset( pxNewTCB->pxStack, ( int ) tskSTACK_FILL_BYTE, ( size_t ) ulStackDepth * sizeof( StackType_t ) );
|
|
8007f52: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
8007f54: 6b18 ldr r0, [r3, #48] @ 0x30
|
|
8007f56: 687b ldr r3, [r7, #4]
|
|
8007f58: 009b lsls r3, r3, #2
|
|
8007f5a: 461a mov r2, r3
|
|
8007f5c: 21a5 movs r1, #165 @ 0xa5
|
|
8007f5e: f001 ffb7 bl 8009ed0 <memset>
|
|
grows from high memory to low (as per the 80x86) or vice versa.
|
|
portSTACK_GROWTH is used to make the result positive or negative as required
|
|
by the port. */
|
|
#if( portSTACK_GROWTH < 0 )
|
|
{
|
|
pxTopOfStack = &( pxNewTCB->pxStack[ ulStackDepth - ( uint32_t ) 1 ] );
|
|
8007f62: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
8007f64: 6b1a ldr r2, [r3, #48] @ 0x30
|
|
8007f66: 687b ldr r3, [r7, #4]
|
|
8007f68: f103 4380 add.w r3, r3, #1073741824 @ 0x40000000
|
|
8007f6c: 3b01 subs r3, #1
|
|
8007f6e: 009b lsls r3, r3, #2
|
|
8007f70: 4413 add r3, r2
|
|
8007f72: 61bb str r3, [r7, #24]
|
|
pxTopOfStack = ( StackType_t * ) ( ( ( portPOINTER_SIZE_TYPE ) pxTopOfStack ) & ( ~( ( portPOINTER_SIZE_TYPE ) portBYTE_ALIGNMENT_MASK ) ) ); /*lint !e923 !e9033 !e9078 MISRA exception. Avoiding casts between pointers and integers is not practical. Size differences accounted for using portPOINTER_SIZE_TYPE type. Checked by assert(). */
|
|
8007f74: 69bb ldr r3, [r7, #24]
|
|
8007f76: f023 0307 bic.w r3, r3, #7
|
|
8007f7a: 61bb str r3, [r7, #24]
|
|
|
|
/* Check the alignment of the calculated top of stack is correct. */
|
|
configASSERT( ( ( ( portPOINTER_SIZE_TYPE ) pxTopOfStack & ( portPOINTER_SIZE_TYPE ) portBYTE_ALIGNMENT_MASK ) == 0UL ) );
|
|
8007f7c: 69bb ldr r3, [r7, #24]
|
|
8007f7e: f003 0307 and.w r3, r3, #7
|
|
8007f82: 2b00 cmp r3, #0
|
|
8007f84: d00b beq.n 8007f9e <prvInitialiseNewTask+0x5a>
|
|
__asm volatile
|
|
8007f86: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8007f8a: f383 8811 msr BASEPRI, r3
|
|
8007f8e: f3bf 8f6f isb sy
|
|
8007f92: f3bf 8f4f dsb sy
|
|
8007f96: 617b str r3, [r7, #20]
|
|
}
|
|
8007f98: bf00 nop
|
|
8007f9a: bf00 nop
|
|
8007f9c: e7fd b.n 8007f9a <prvInitialiseNewTask+0x56>
|
|
pxNewTCB->pxEndOfStack = pxNewTCB->pxStack + ( ulStackDepth - ( uint32_t ) 1 );
|
|
}
|
|
#endif /* portSTACK_GROWTH */
|
|
|
|
/* Store the task name in the TCB. */
|
|
if( pcName != NULL )
|
|
8007f9e: 68bb ldr r3, [r7, #8]
|
|
8007fa0: 2b00 cmp r3, #0
|
|
8007fa2: d01f beq.n 8007fe4 <prvInitialiseNewTask+0xa0>
|
|
{
|
|
for( x = ( UBaseType_t ) 0; x < ( UBaseType_t ) configMAX_TASK_NAME_LEN; x++ )
|
|
8007fa4: 2300 movs r3, #0
|
|
8007fa6: 61fb str r3, [r7, #28]
|
|
8007fa8: e012 b.n 8007fd0 <prvInitialiseNewTask+0x8c>
|
|
{
|
|
pxNewTCB->pcTaskName[ x ] = pcName[ x ];
|
|
8007faa: 68ba ldr r2, [r7, #8]
|
|
8007fac: 69fb ldr r3, [r7, #28]
|
|
8007fae: 4413 add r3, r2
|
|
8007fb0: 7819 ldrb r1, [r3, #0]
|
|
8007fb2: 6b3a ldr r2, [r7, #48] @ 0x30
|
|
8007fb4: 69fb ldr r3, [r7, #28]
|
|
8007fb6: 4413 add r3, r2
|
|
8007fb8: 3334 adds r3, #52 @ 0x34
|
|
8007fba: 460a mov r2, r1
|
|
8007fbc: 701a strb r2, [r3, #0]
|
|
|
|
/* Don't copy all configMAX_TASK_NAME_LEN if the string is shorter than
|
|
configMAX_TASK_NAME_LEN characters just in case the memory after the
|
|
string is not accessible (extremely unlikely). */
|
|
if( pcName[ x ] == ( char ) 0x00 )
|
|
8007fbe: 68ba ldr r2, [r7, #8]
|
|
8007fc0: 69fb ldr r3, [r7, #28]
|
|
8007fc2: 4413 add r3, r2
|
|
8007fc4: 781b ldrb r3, [r3, #0]
|
|
8007fc6: 2b00 cmp r3, #0
|
|
8007fc8: d006 beq.n 8007fd8 <prvInitialiseNewTask+0x94>
|
|
for( x = ( UBaseType_t ) 0; x < ( UBaseType_t ) configMAX_TASK_NAME_LEN; x++ )
|
|
8007fca: 69fb ldr r3, [r7, #28]
|
|
8007fcc: 3301 adds r3, #1
|
|
8007fce: 61fb str r3, [r7, #28]
|
|
8007fd0: 69fb ldr r3, [r7, #28]
|
|
8007fd2: 2b0f cmp r3, #15
|
|
8007fd4: d9e9 bls.n 8007faa <prvInitialiseNewTask+0x66>
|
|
8007fd6: e000 b.n 8007fda <prvInitialiseNewTask+0x96>
|
|
{
|
|
break;
|
|
8007fd8: bf00 nop
|
|
}
|
|
}
|
|
|
|
/* Ensure the name string is terminated in the case that the string length
|
|
was greater or equal to configMAX_TASK_NAME_LEN. */
|
|
pxNewTCB->pcTaskName[ configMAX_TASK_NAME_LEN - 1 ] = '\0';
|
|
8007fda: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
8007fdc: 2200 movs r2, #0
|
|
8007fde: f883 2043 strb.w r2, [r3, #67] @ 0x43
|
|
8007fe2: e003 b.n 8007fec <prvInitialiseNewTask+0xa8>
|
|
}
|
|
else
|
|
{
|
|
/* The task has not been given a name, so just ensure there is a NULL
|
|
terminator when it is read out. */
|
|
pxNewTCB->pcTaskName[ 0 ] = 0x00;
|
|
8007fe4: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
8007fe6: 2200 movs r2, #0
|
|
8007fe8: f883 2034 strb.w r2, [r3, #52] @ 0x34
|
|
}
|
|
|
|
/* This is used as an array index so must ensure it's not too large. First
|
|
remove the privilege bit if one is present. */
|
|
if( uxPriority >= ( UBaseType_t ) configMAX_PRIORITIES )
|
|
8007fec: 6abb ldr r3, [r7, #40] @ 0x28
|
|
8007fee: 2b37 cmp r3, #55 @ 0x37
|
|
8007ff0: d901 bls.n 8007ff6 <prvInitialiseNewTask+0xb2>
|
|
{
|
|
uxPriority = ( UBaseType_t ) configMAX_PRIORITIES - ( UBaseType_t ) 1U;
|
|
8007ff2: 2337 movs r3, #55 @ 0x37
|
|
8007ff4: 62bb str r3, [r7, #40] @ 0x28
|
|
else
|
|
{
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
|
|
pxNewTCB->uxPriority = uxPriority;
|
|
8007ff6: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
8007ff8: 6aba ldr r2, [r7, #40] @ 0x28
|
|
8007ffa: 62da str r2, [r3, #44] @ 0x2c
|
|
#if ( configUSE_MUTEXES == 1 )
|
|
{
|
|
pxNewTCB->uxBasePriority = uxPriority;
|
|
8007ffc: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
8007ffe: 6aba ldr r2, [r7, #40] @ 0x28
|
|
8008000: 64da str r2, [r3, #76] @ 0x4c
|
|
pxNewTCB->uxMutexesHeld = 0;
|
|
8008002: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
8008004: 2200 movs r2, #0
|
|
8008006: 651a str r2, [r3, #80] @ 0x50
|
|
}
|
|
#endif /* configUSE_MUTEXES */
|
|
|
|
vListInitialiseItem( &( pxNewTCB->xStateListItem ) );
|
|
8008008: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
800800a: 3304 adds r3, #4
|
|
800800c: 4618 mov r0, r3
|
|
800800e: f7fe fe33 bl 8006c78 <vListInitialiseItem>
|
|
vListInitialiseItem( &( pxNewTCB->xEventListItem ) );
|
|
8008012: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
8008014: 3318 adds r3, #24
|
|
8008016: 4618 mov r0, r3
|
|
8008018: f7fe fe2e bl 8006c78 <vListInitialiseItem>
|
|
|
|
/* Set the pxNewTCB as a link back from the ListItem_t. This is so we can get
|
|
back to the containing TCB from a generic item in a list. */
|
|
listSET_LIST_ITEM_OWNER( &( pxNewTCB->xStateListItem ), pxNewTCB );
|
|
800801c: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
800801e: 6b3a ldr r2, [r7, #48] @ 0x30
|
|
8008020: 611a str r2, [r3, #16]
|
|
|
|
/* Event lists are always in priority order. */
|
|
listSET_LIST_ITEM_VALUE( &( pxNewTCB->xEventListItem ), ( TickType_t ) configMAX_PRIORITIES - ( TickType_t ) uxPriority ); /*lint !e961 MISRA exception as the casts are only redundant for some ports. */
|
|
8008022: 6abb ldr r3, [r7, #40] @ 0x28
|
|
8008024: f1c3 0238 rsb r2, r3, #56 @ 0x38
|
|
8008028: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
800802a: 619a str r2, [r3, #24]
|
|
listSET_LIST_ITEM_OWNER( &( pxNewTCB->xEventListItem ), pxNewTCB );
|
|
800802c: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
800802e: 6b3a ldr r2, [r7, #48] @ 0x30
|
|
8008030: 625a str r2, [r3, #36] @ 0x24
|
|
}
|
|
#endif
|
|
|
|
#if ( configUSE_TASK_NOTIFICATIONS == 1 )
|
|
{
|
|
pxNewTCB->ulNotifiedValue = 0;
|
|
8008032: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
8008034: 2200 movs r2, #0
|
|
8008036: f8c3 20a0 str.w r2, [r3, #160] @ 0xa0
|
|
pxNewTCB->ucNotifyState = taskNOT_WAITING_NOTIFICATION;
|
|
800803a: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
800803c: 2200 movs r2, #0
|
|
800803e: f883 20a4 strb.w r2, [r3, #164] @ 0xa4
|
|
#if ( configUSE_NEWLIB_REENTRANT == 1 )
|
|
{
|
|
/* Initialise this task's Newlib reent structure.
|
|
See the third party link http://www.nadler.com/embedded/newlibAndFreeRTOS.html
|
|
for additional information. */
|
|
_REENT_INIT_PTR( ( &( pxNewTCB->xNewLib_reent ) ) );
|
|
8008042: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
8008044: 3354 adds r3, #84 @ 0x54
|
|
8008046: 224c movs r2, #76 @ 0x4c
|
|
8008048: 2100 movs r1, #0
|
|
800804a: 4618 mov r0, r3
|
|
800804c: f001 ff40 bl 8009ed0 <memset>
|
|
8008050: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
8008052: 4a0d ldr r2, [pc, #52] @ (8008088 <prvInitialiseNewTask+0x144>)
|
|
8008054: 659a str r2, [r3, #88] @ 0x58
|
|
8008056: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
8008058: 4a0c ldr r2, [pc, #48] @ (800808c <prvInitialiseNewTask+0x148>)
|
|
800805a: 65da str r2, [r3, #92] @ 0x5c
|
|
800805c: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
800805e: 4a0c ldr r2, [pc, #48] @ (8008090 <prvInitialiseNewTask+0x14c>)
|
|
8008060: 661a str r2, [r3, #96] @ 0x60
|
|
}
|
|
#endif /* portSTACK_GROWTH */
|
|
}
|
|
#else /* portHAS_STACK_OVERFLOW_CHECKING */
|
|
{
|
|
pxNewTCB->pxTopOfStack = pxPortInitialiseStack( pxTopOfStack, pxTaskCode, pvParameters );
|
|
8008062: 683a ldr r2, [r7, #0]
|
|
8008064: 68f9 ldr r1, [r7, #12]
|
|
8008066: 69b8 ldr r0, [r7, #24]
|
|
8008068: f001 fae4 bl 8009634 <pxPortInitialiseStack>
|
|
800806c: 4602 mov r2, r0
|
|
800806e: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
8008070: 601a str r2, [r3, #0]
|
|
}
|
|
#endif /* portHAS_STACK_OVERFLOW_CHECKING */
|
|
}
|
|
#endif /* portUSING_MPU_WRAPPERS */
|
|
|
|
if( pxCreatedTask != NULL )
|
|
8008072: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
8008074: 2b00 cmp r3, #0
|
|
8008076: d002 beq.n 800807e <prvInitialiseNewTask+0x13a>
|
|
{
|
|
/* Pass the handle out in an anonymous way. The handle can be used to
|
|
change the created task's priority, delete the created task, etc.*/
|
|
*pxCreatedTask = ( TaskHandle_t ) pxNewTCB;
|
|
8008078: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
800807a: 6b3a ldr r2, [r7, #48] @ 0x30
|
|
800807c: 601a str r2, [r3, #0]
|
|
}
|
|
else
|
|
{
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
}
|
|
800807e: bf00 nop
|
|
8008080: 3720 adds r7, #32
|
|
8008082: 46bd mov sp, r7
|
|
8008084: bd80 pop {r7, pc}
|
|
8008086: bf00 nop
|
|
8008088: 20004d18 .word 0x20004d18
|
|
800808c: 20004d80 .word 0x20004d80
|
|
8008090: 20004de8 .word 0x20004de8
|
|
|
|
08008094 <prvAddNewTaskToReadyList>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
static void prvAddNewTaskToReadyList( TCB_t *pxNewTCB )
|
|
{
|
|
8008094: b580 push {r7, lr}
|
|
8008096: b082 sub sp, #8
|
|
8008098: af00 add r7, sp, #0
|
|
800809a: 6078 str r0, [r7, #4]
|
|
/* Ensure interrupts don't access the task lists while the lists are being
|
|
updated. */
|
|
taskENTER_CRITICAL();
|
|
800809c: f001 fbfc bl 8009898 <vPortEnterCritical>
|
|
{
|
|
uxCurrentNumberOfTasks++;
|
|
80080a0: 4b2d ldr r3, [pc, #180] @ (8008158 <prvAddNewTaskToReadyList+0xc4>)
|
|
80080a2: 681b ldr r3, [r3, #0]
|
|
80080a4: 3301 adds r3, #1
|
|
80080a6: 4a2c ldr r2, [pc, #176] @ (8008158 <prvAddNewTaskToReadyList+0xc4>)
|
|
80080a8: 6013 str r3, [r2, #0]
|
|
if( pxCurrentTCB == NULL )
|
|
80080aa: 4b2c ldr r3, [pc, #176] @ (800815c <prvAddNewTaskToReadyList+0xc8>)
|
|
80080ac: 681b ldr r3, [r3, #0]
|
|
80080ae: 2b00 cmp r3, #0
|
|
80080b0: d109 bne.n 80080c6 <prvAddNewTaskToReadyList+0x32>
|
|
{
|
|
/* There are no other tasks, or all the other tasks are in
|
|
the suspended state - make this the current task. */
|
|
pxCurrentTCB = pxNewTCB;
|
|
80080b2: 4a2a ldr r2, [pc, #168] @ (800815c <prvAddNewTaskToReadyList+0xc8>)
|
|
80080b4: 687b ldr r3, [r7, #4]
|
|
80080b6: 6013 str r3, [r2, #0]
|
|
|
|
if( uxCurrentNumberOfTasks == ( UBaseType_t ) 1 )
|
|
80080b8: 4b27 ldr r3, [pc, #156] @ (8008158 <prvAddNewTaskToReadyList+0xc4>)
|
|
80080ba: 681b ldr r3, [r3, #0]
|
|
80080bc: 2b01 cmp r3, #1
|
|
80080be: d110 bne.n 80080e2 <prvAddNewTaskToReadyList+0x4e>
|
|
{
|
|
/* This is the first task to be created so do the preliminary
|
|
initialisation required. We will not recover if this call
|
|
fails, but we will report the failure. */
|
|
prvInitialiseTaskLists();
|
|
80080c0: f000 fbf8 bl 80088b4 <prvInitialiseTaskLists>
|
|
80080c4: e00d b.n 80080e2 <prvAddNewTaskToReadyList+0x4e>
|
|
else
|
|
{
|
|
/* If the scheduler is not already running, make this task the
|
|
current task if it is the highest priority task to be created
|
|
so far. */
|
|
if( xSchedulerRunning == pdFALSE )
|
|
80080c6: 4b26 ldr r3, [pc, #152] @ (8008160 <prvAddNewTaskToReadyList+0xcc>)
|
|
80080c8: 681b ldr r3, [r3, #0]
|
|
80080ca: 2b00 cmp r3, #0
|
|
80080cc: d109 bne.n 80080e2 <prvAddNewTaskToReadyList+0x4e>
|
|
{
|
|
if( pxCurrentTCB->uxPriority <= pxNewTCB->uxPriority )
|
|
80080ce: 4b23 ldr r3, [pc, #140] @ (800815c <prvAddNewTaskToReadyList+0xc8>)
|
|
80080d0: 681b ldr r3, [r3, #0]
|
|
80080d2: 6ada ldr r2, [r3, #44] @ 0x2c
|
|
80080d4: 687b ldr r3, [r7, #4]
|
|
80080d6: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
80080d8: 429a cmp r2, r3
|
|
80080da: d802 bhi.n 80080e2 <prvAddNewTaskToReadyList+0x4e>
|
|
{
|
|
pxCurrentTCB = pxNewTCB;
|
|
80080dc: 4a1f ldr r2, [pc, #124] @ (800815c <prvAddNewTaskToReadyList+0xc8>)
|
|
80080de: 687b ldr r3, [r7, #4]
|
|
80080e0: 6013 str r3, [r2, #0]
|
|
{
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
}
|
|
|
|
uxTaskNumber++;
|
|
80080e2: 4b20 ldr r3, [pc, #128] @ (8008164 <prvAddNewTaskToReadyList+0xd0>)
|
|
80080e4: 681b ldr r3, [r3, #0]
|
|
80080e6: 3301 adds r3, #1
|
|
80080e8: 4a1e ldr r2, [pc, #120] @ (8008164 <prvAddNewTaskToReadyList+0xd0>)
|
|
80080ea: 6013 str r3, [r2, #0]
|
|
|
|
#if ( configUSE_TRACE_FACILITY == 1 )
|
|
{
|
|
/* Add a counter into the TCB for tracing only. */
|
|
pxNewTCB->uxTCBNumber = uxTaskNumber;
|
|
80080ec: 4b1d ldr r3, [pc, #116] @ (8008164 <prvAddNewTaskToReadyList+0xd0>)
|
|
80080ee: 681a ldr r2, [r3, #0]
|
|
80080f0: 687b ldr r3, [r7, #4]
|
|
80080f2: 645a str r2, [r3, #68] @ 0x44
|
|
}
|
|
#endif /* configUSE_TRACE_FACILITY */
|
|
traceTASK_CREATE( pxNewTCB );
|
|
|
|
prvAddTaskToReadyList( pxNewTCB );
|
|
80080f4: 687b ldr r3, [r7, #4]
|
|
80080f6: 6ada ldr r2, [r3, #44] @ 0x2c
|
|
80080f8: 4b1b ldr r3, [pc, #108] @ (8008168 <prvAddNewTaskToReadyList+0xd4>)
|
|
80080fa: 681b ldr r3, [r3, #0]
|
|
80080fc: 429a cmp r2, r3
|
|
80080fe: d903 bls.n 8008108 <prvAddNewTaskToReadyList+0x74>
|
|
8008100: 687b ldr r3, [r7, #4]
|
|
8008102: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
8008104: 4a18 ldr r2, [pc, #96] @ (8008168 <prvAddNewTaskToReadyList+0xd4>)
|
|
8008106: 6013 str r3, [r2, #0]
|
|
8008108: 687b ldr r3, [r7, #4]
|
|
800810a: 6ada ldr r2, [r3, #44] @ 0x2c
|
|
800810c: 4613 mov r3, r2
|
|
800810e: 009b lsls r3, r3, #2
|
|
8008110: 4413 add r3, r2
|
|
8008112: 009b lsls r3, r3, #2
|
|
8008114: 4a15 ldr r2, [pc, #84] @ (800816c <prvAddNewTaskToReadyList+0xd8>)
|
|
8008116: 441a add r2, r3
|
|
8008118: 687b ldr r3, [r7, #4]
|
|
800811a: 3304 adds r3, #4
|
|
800811c: 4619 mov r1, r3
|
|
800811e: 4610 mov r0, r2
|
|
8008120: f7fe fdb7 bl 8006c92 <vListInsertEnd>
|
|
|
|
portSETUP_TCB( pxNewTCB );
|
|
}
|
|
taskEXIT_CRITICAL();
|
|
8008124: f001 fbea bl 80098fc <vPortExitCritical>
|
|
|
|
if( xSchedulerRunning != pdFALSE )
|
|
8008128: 4b0d ldr r3, [pc, #52] @ (8008160 <prvAddNewTaskToReadyList+0xcc>)
|
|
800812a: 681b ldr r3, [r3, #0]
|
|
800812c: 2b00 cmp r3, #0
|
|
800812e: d00e beq.n 800814e <prvAddNewTaskToReadyList+0xba>
|
|
{
|
|
/* If the created task is of a higher priority than the current task
|
|
then it should run now. */
|
|
if( pxCurrentTCB->uxPriority < pxNewTCB->uxPriority )
|
|
8008130: 4b0a ldr r3, [pc, #40] @ (800815c <prvAddNewTaskToReadyList+0xc8>)
|
|
8008132: 681b ldr r3, [r3, #0]
|
|
8008134: 6ada ldr r2, [r3, #44] @ 0x2c
|
|
8008136: 687b ldr r3, [r7, #4]
|
|
8008138: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
800813a: 429a cmp r2, r3
|
|
800813c: d207 bcs.n 800814e <prvAddNewTaskToReadyList+0xba>
|
|
{
|
|
taskYIELD_IF_USING_PREEMPTION();
|
|
800813e: 4b0c ldr r3, [pc, #48] @ (8008170 <prvAddNewTaskToReadyList+0xdc>)
|
|
8008140: f04f 5280 mov.w r2, #268435456 @ 0x10000000
|
|
8008144: 601a str r2, [r3, #0]
|
|
8008146: f3bf 8f4f dsb sy
|
|
800814a: f3bf 8f6f isb sy
|
|
}
|
|
else
|
|
{
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
}
|
|
800814e: bf00 nop
|
|
8008150: 3708 adds r7, #8
|
|
8008152: 46bd mov sp, r7
|
|
8008154: bd80 pop {r7, pc}
|
|
8008156: bf00 nop
|
|
8008158: 20000f94 .word 0x20000f94
|
|
800815c: 20000ac0 .word 0x20000ac0
|
|
8008160: 20000fa0 .word 0x20000fa0
|
|
8008164: 20000fb0 .word 0x20000fb0
|
|
8008168: 20000f9c .word 0x20000f9c
|
|
800816c: 20000ac4 .word 0x20000ac4
|
|
8008170: e000ed04 .word 0xe000ed04
|
|
|
|
08008174 <vTaskStartScheduler>:
|
|
|
|
#endif /* ( ( INCLUDE_xTaskResumeFromISR == 1 ) && ( INCLUDE_vTaskSuspend == 1 ) ) */
|
|
/*-----------------------------------------------------------*/
|
|
|
|
void vTaskStartScheduler( void )
|
|
{
|
|
8008174: b580 push {r7, lr}
|
|
8008176: b08a sub sp, #40 @ 0x28
|
|
8008178: af04 add r7, sp, #16
|
|
BaseType_t xReturn;
|
|
|
|
/* Add the idle task at the lowest priority. */
|
|
#if( configSUPPORT_STATIC_ALLOCATION == 1 )
|
|
{
|
|
StaticTask_t *pxIdleTaskTCBBuffer = NULL;
|
|
800817a: 2300 movs r3, #0
|
|
800817c: 60bb str r3, [r7, #8]
|
|
StackType_t *pxIdleTaskStackBuffer = NULL;
|
|
800817e: 2300 movs r3, #0
|
|
8008180: 607b str r3, [r7, #4]
|
|
uint32_t ulIdleTaskStackSize;
|
|
|
|
/* The Idle task is created using user provided RAM - obtain the
|
|
address of the RAM then create the idle task. */
|
|
vApplicationGetIdleTaskMemory( &pxIdleTaskTCBBuffer, &pxIdleTaskStackBuffer, &ulIdleTaskStackSize );
|
|
8008182: 463a mov r2, r7
|
|
8008184: 1d39 adds r1, r7, #4
|
|
8008186: f107 0308 add.w r3, r7, #8
|
|
800818a: 4618 mov r0, r3
|
|
800818c: f7fe fd20 bl 8006bd0 <vApplicationGetIdleTaskMemory>
|
|
xIdleTaskHandle = xTaskCreateStatic( prvIdleTask,
|
|
8008190: 6839 ldr r1, [r7, #0]
|
|
8008192: 687b ldr r3, [r7, #4]
|
|
8008194: 68ba ldr r2, [r7, #8]
|
|
8008196: 9202 str r2, [sp, #8]
|
|
8008198: 9301 str r3, [sp, #4]
|
|
800819a: 2300 movs r3, #0
|
|
800819c: 9300 str r3, [sp, #0]
|
|
800819e: 2300 movs r3, #0
|
|
80081a0: 460a mov r2, r1
|
|
80081a2: 4924 ldr r1, [pc, #144] @ (8008234 <vTaskStartScheduler+0xc0>)
|
|
80081a4: 4824 ldr r0, [pc, #144] @ (8008238 <vTaskStartScheduler+0xc4>)
|
|
80081a6: f7ff fe27 bl 8007df8 <xTaskCreateStatic>
|
|
80081aa: 4603 mov r3, r0
|
|
80081ac: 4a23 ldr r2, [pc, #140] @ (800823c <vTaskStartScheduler+0xc8>)
|
|
80081ae: 6013 str r3, [r2, #0]
|
|
( void * ) NULL, /*lint !e961. The cast is not redundant for all compilers. */
|
|
portPRIVILEGE_BIT, /* In effect ( tskIDLE_PRIORITY | portPRIVILEGE_BIT ), but tskIDLE_PRIORITY is zero. */
|
|
pxIdleTaskStackBuffer,
|
|
pxIdleTaskTCBBuffer ); /*lint !e961 MISRA exception, justified as it is not a redundant explicit cast to all supported compilers. */
|
|
|
|
if( xIdleTaskHandle != NULL )
|
|
80081b0: 4b22 ldr r3, [pc, #136] @ (800823c <vTaskStartScheduler+0xc8>)
|
|
80081b2: 681b ldr r3, [r3, #0]
|
|
80081b4: 2b00 cmp r3, #0
|
|
80081b6: d002 beq.n 80081be <vTaskStartScheduler+0x4a>
|
|
{
|
|
xReturn = pdPASS;
|
|
80081b8: 2301 movs r3, #1
|
|
80081ba: 617b str r3, [r7, #20]
|
|
80081bc: e001 b.n 80081c2 <vTaskStartScheduler+0x4e>
|
|
}
|
|
else
|
|
{
|
|
xReturn = pdFAIL;
|
|
80081be: 2300 movs r3, #0
|
|
80081c0: 617b str r3, [r7, #20]
|
|
}
|
|
#endif /* configSUPPORT_STATIC_ALLOCATION */
|
|
|
|
#if ( configUSE_TIMERS == 1 )
|
|
{
|
|
if( xReturn == pdPASS )
|
|
80081c2: 697b ldr r3, [r7, #20]
|
|
80081c4: 2b01 cmp r3, #1
|
|
80081c6: d102 bne.n 80081ce <vTaskStartScheduler+0x5a>
|
|
{
|
|
xReturn = xTimerCreateTimerTask();
|
|
80081c8: f000 fe1a bl 8008e00 <xTimerCreateTimerTask>
|
|
80081cc: 6178 str r0, [r7, #20]
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
}
|
|
#endif /* configUSE_TIMERS */
|
|
|
|
if( xReturn == pdPASS )
|
|
80081ce: 697b ldr r3, [r7, #20]
|
|
80081d0: 2b01 cmp r3, #1
|
|
80081d2: d11b bne.n 800820c <vTaskStartScheduler+0x98>
|
|
__asm volatile
|
|
80081d4: f04f 0350 mov.w r3, #80 @ 0x50
|
|
80081d8: f383 8811 msr BASEPRI, r3
|
|
80081dc: f3bf 8f6f isb sy
|
|
80081e0: f3bf 8f4f dsb sy
|
|
80081e4: 613b str r3, [r7, #16]
|
|
}
|
|
80081e6: bf00 nop
|
|
{
|
|
/* Switch Newlib's _impure_ptr variable to point to the _reent
|
|
structure specific to the task that will run first.
|
|
See the third party link http://www.nadler.com/embedded/newlibAndFreeRTOS.html
|
|
for additional information. */
|
|
_impure_ptr = &( pxCurrentTCB->xNewLib_reent );
|
|
80081e8: 4b15 ldr r3, [pc, #84] @ (8008240 <vTaskStartScheduler+0xcc>)
|
|
80081ea: 681b ldr r3, [r3, #0]
|
|
80081ec: 3354 adds r3, #84 @ 0x54
|
|
80081ee: 4a15 ldr r2, [pc, #84] @ (8008244 <vTaskStartScheduler+0xd0>)
|
|
80081f0: 6013 str r3, [r2, #0]
|
|
}
|
|
#endif /* configUSE_NEWLIB_REENTRANT */
|
|
|
|
xNextTaskUnblockTime = portMAX_DELAY;
|
|
80081f2: 4b15 ldr r3, [pc, #84] @ (8008248 <vTaskStartScheduler+0xd4>)
|
|
80081f4: f04f 32ff mov.w r2, #4294967295 @ 0xffffffff
|
|
80081f8: 601a str r2, [r3, #0]
|
|
xSchedulerRunning = pdTRUE;
|
|
80081fa: 4b14 ldr r3, [pc, #80] @ (800824c <vTaskStartScheduler+0xd8>)
|
|
80081fc: 2201 movs r2, #1
|
|
80081fe: 601a str r2, [r3, #0]
|
|
xTickCount = ( TickType_t ) configINITIAL_TICK_COUNT;
|
|
8008200: 4b13 ldr r3, [pc, #76] @ (8008250 <vTaskStartScheduler+0xdc>)
|
|
8008202: 2200 movs r2, #0
|
|
8008204: 601a str r2, [r3, #0]
|
|
|
|
traceTASK_SWITCHED_IN();
|
|
|
|
/* Setting up the timer tick is hardware specific and thus in the
|
|
portable interface. */
|
|
if( xPortStartScheduler() != pdFALSE )
|
|
8008206: f001 faa3 bl 8009750 <xPortStartScheduler>
|
|
}
|
|
|
|
/* Prevent compiler warnings if INCLUDE_xTaskGetIdleTaskHandle is set to 0,
|
|
meaning xIdleTaskHandle is not used anywhere else. */
|
|
( void ) xIdleTaskHandle;
|
|
}
|
|
800820a: e00f b.n 800822c <vTaskStartScheduler+0xb8>
|
|
configASSERT( xReturn != errCOULD_NOT_ALLOCATE_REQUIRED_MEMORY );
|
|
800820c: 697b ldr r3, [r7, #20]
|
|
800820e: f1b3 3fff cmp.w r3, #4294967295 @ 0xffffffff
|
|
8008212: d10b bne.n 800822c <vTaskStartScheduler+0xb8>
|
|
__asm volatile
|
|
8008214: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8008218: f383 8811 msr BASEPRI, r3
|
|
800821c: f3bf 8f6f isb sy
|
|
8008220: f3bf 8f4f dsb sy
|
|
8008224: 60fb str r3, [r7, #12]
|
|
}
|
|
8008226: bf00 nop
|
|
8008228: bf00 nop
|
|
800822a: e7fd b.n 8008228 <vTaskStartScheduler+0xb4>
|
|
}
|
|
800822c: bf00 nop
|
|
800822e: 3718 adds r7, #24
|
|
8008230: 46bd mov sp, r7
|
|
8008232: bd80 pop {r7, pc}
|
|
8008234: 0800a288 .word 0x0800a288
|
|
8008238: 08008885 .word 0x08008885
|
|
800823c: 20000fb8 .word 0x20000fb8
|
|
8008240: 20000ac0 .word 0x20000ac0
|
|
8008244: 20000028 .word 0x20000028
|
|
8008248: 20000fb4 .word 0x20000fb4
|
|
800824c: 20000fa0 .word 0x20000fa0
|
|
8008250: 20000f98 .word 0x20000f98
|
|
|
|
08008254 <vTaskSuspendAll>:
|
|
vPortEndScheduler();
|
|
}
|
|
/*----------------------------------------------------------*/
|
|
|
|
void vTaskSuspendAll( void )
|
|
{
|
|
8008254: b480 push {r7}
|
|
8008256: af00 add r7, sp, #0
|
|
do not otherwise exhibit real time behaviour. */
|
|
portSOFTWARE_BARRIER();
|
|
|
|
/* The scheduler is suspended if uxSchedulerSuspended is non-zero. An increment
|
|
is used to allow calls to vTaskSuspendAll() to nest. */
|
|
++uxSchedulerSuspended;
|
|
8008258: 4b04 ldr r3, [pc, #16] @ (800826c <vTaskSuspendAll+0x18>)
|
|
800825a: 681b ldr r3, [r3, #0]
|
|
800825c: 3301 adds r3, #1
|
|
800825e: 4a03 ldr r2, [pc, #12] @ (800826c <vTaskSuspendAll+0x18>)
|
|
8008260: 6013 str r3, [r2, #0]
|
|
|
|
/* Enforces ordering for ports and optimised compilers that may otherwise place
|
|
the above increment elsewhere. */
|
|
portMEMORY_BARRIER();
|
|
}
|
|
8008262: bf00 nop
|
|
8008264: 46bd mov sp, r7
|
|
8008266: f85d 7b04 ldr.w r7, [sp], #4
|
|
800826a: 4770 bx lr
|
|
800826c: 20000fbc .word 0x20000fbc
|
|
|
|
08008270 <xTaskResumeAll>:
|
|
|
|
#endif /* configUSE_TICKLESS_IDLE */
|
|
/*----------------------------------------------------------*/
|
|
|
|
BaseType_t xTaskResumeAll( void )
|
|
{
|
|
8008270: b580 push {r7, lr}
|
|
8008272: b084 sub sp, #16
|
|
8008274: af00 add r7, sp, #0
|
|
TCB_t *pxTCB = NULL;
|
|
8008276: 2300 movs r3, #0
|
|
8008278: 60fb str r3, [r7, #12]
|
|
BaseType_t xAlreadyYielded = pdFALSE;
|
|
800827a: 2300 movs r3, #0
|
|
800827c: 60bb str r3, [r7, #8]
|
|
|
|
/* If uxSchedulerSuspended is zero then this function does not match a
|
|
previous call to vTaskSuspendAll(). */
|
|
configASSERT( uxSchedulerSuspended );
|
|
800827e: 4b42 ldr r3, [pc, #264] @ (8008388 <xTaskResumeAll+0x118>)
|
|
8008280: 681b ldr r3, [r3, #0]
|
|
8008282: 2b00 cmp r3, #0
|
|
8008284: d10b bne.n 800829e <xTaskResumeAll+0x2e>
|
|
__asm volatile
|
|
8008286: f04f 0350 mov.w r3, #80 @ 0x50
|
|
800828a: f383 8811 msr BASEPRI, r3
|
|
800828e: f3bf 8f6f isb sy
|
|
8008292: f3bf 8f4f dsb sy
|
|
8008296: 603b str r3, [r7, #0]
|
|
}
|
|
8008298: bf00 nop
|
|
800829a: bf00 nop
|
|
800829c: e7fd b.n 800829a <xTaskResumeAll+0x2a>
|
|
/* It is possible that an ISR caused a task to be removed from an event
|
|
list while the scheduler was suspended. If this was the case then the
|
|
removed task will have been added to the xPendingReadyList. Once the
|
|
scheduler has been resumed it is safe to move all the pending ready
|
|
tasks from this list into their appropriate ready list. */
|
|
taskENTER_CRITICAL();
|
|
800829e: f001 fafb bl 8009898 <vPortEnterCritical>
|
|
{
|
|
--uxSchedulerSuspended;
|
|
80082a2: 4b39 ldr r3, [pc, #228] @ (8008388 <xTaskResumeAll+0x118>)
|
|
80082a4: 681b ldr r3, [r3, #0]
|
|
80082a6: 3b01 subs r3, #1
|
|
80082a8: 4a37 ldr r2, [pc, #220] @ (8008388 <xTaskResumeAll+0x118>)
|
|
80082aa: 6013 str r3, [r2, #0]
|
|
|
|
if( uxSchedulerSuspended == ( UBaseType_t ) pdFALSE )
|
|
80082ac: 4b36 ldr r3, [pc, #216] @ (8008388 <xTaskResumeAll+0x118>)
|
|
80082ae: 681b ldr r3, [r3, #0]
|
|
80082b0: 2b00 cmp r3, #0
|
|
80082b2: d162 bne.n 800837a <xTaskResumeAll+0x10a>
|
|
{
|
|
if( uxCurrentNumberOfTasks > ( UBaseType_t ) 0U )
|
|
80082b4: 4b35 ldr r3, [pc, #212] @ (800838c <xTaskResumeAll+0x11c>)
|
|
80082b6: 681b ldr r3, [r3, #0]
|
|
80082b8: 2b00 cmp r3, #0
|
|
80082ba: d05e beq.n 800837a <xTaskResumeAll+0x10a>
|
|
{
|
|
/* Move any readied tasks from the pending list into the
|
|
appropriate ready list. */
|
|
while( listLIST_IS_EMPTY( &xPendingReadyList ) == pdFALSE )
|
|
80082bc: e02f b.n 800831e <xTaskResumeAll+0xae>
|
|
{
|
|
pxTCB = listGET_OWNER_OF_HEAD_ENTRY( ( &xPendingReadyList ) ); /*lint !e9079 void * is used as this macro is used with timers and co-routines too. Alignment is known to be fine as the type of the pointer stored and retrieved is the same. */
|
|
80082be: 4b34 ldr r3, [pc, #208] @ (8008390 <xTaskResumeAll+0x120>)
|
|
80082c0: 68db ldr r3, [r3, #12]
|
|
80082c2: 68db ldr r3, [r3, #12]
|
|
80082c4: 60fb str r3, [r7, #12]
|
|
( void ) uxListRemove( &( pxTCB->xEventListItem ) );
|
|
80082c6: 68fb ldr r3, [r7, #12]
|
|
80082c8: 3318 adds r3, #24
|
|
80082ca: 4618 mov r0, r3
|
|
80082cc: f7fe fd3e bl 8006d4c <uxListRemove>
|
|
( void ) uxListRemove( &( pxTCB->xStateListItem ) );
|
|
80082d0: 68fb ldr r3, [r7, #12]
|
|
80082d2: 3304 adds r3, #4
|
|
80082d4: 4618 mov r0, r3
|
|
80082d6: f7fe fd39 bl 8006d4c <uxListRemove>
|
|
prvAddTaskToReadyList( pxTCB );
|
|
80082da: 68fb ldr r3, [r7, #12]
|
|
80082dc: 6ada ldr r2, [r3, #44] @ 0x2c
|
|
80082de: 4b2d ldr r3, [pc, #180] @ (8008394 <xTaskResumeAll+0x124>)
|
|
80082e0: 681b ldr r3, [r3, #0]
|
|
80082e2: 429a cmp r2, r3
|
|
80082e4: d903 bls.n 80082ee <xTaskResumeAll+0x7e>
|
|
80082e6: 68fb ldr r3, [r7, #12]
|
|
80082e8: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
80082ea: 4a2a ldr r2, [pc, #168] @ (8008394 <xTaskResumeAll+0x124>)
|
|
80082ec: 6013 str r3, [r2, #0]
|
|
80082ee: 68fb ldr r3, [r7, #12]
|
|
80082f0: 6ada ldr r2, [r3, #44] @ 0x2c
|
|
80082f2: 4613 mov r3, r2
|
|
80082f4: 009b lsls r3, r3, #2
|
|
80082f6: 4413 add r3, r2
|
|
80082f8: 009b lsls r3, r3, #2
|
|
80082fa: 4a27 ldr r2, [pc, #156] @ (8008398 <xTaskResumeAll+0x128>)
|
|
80082fc: 441a add r2, r3
|
|
80082fe: 68fb ldr r3, [r7, #12]
|
|
8008300: 3304 adds r3, #4
|
|
8008302: 4619 mov r1, r3
|
|
8008304: 4610 mov r0, r2
|
|
8008306: f7fe fcc4 bl 8006c92 <vListInsertEnd>
|
|
|
|
/* If the moved task has a priority higher than the current
|
|
task then a yield must be performed. */
|
|
if( pxTCB->uxPriority >= pxCurrentTCB->uxPriority )
|
|
800830a: 68fb ldr r3, [r7, #12]
|
|
800830c: 6ada ldr r2, [r3, #44] @ 0x2c
|
|
800830e: 4b23 ldr r3, [pc, #140] @ (800839c <xTaskResumeAll+0x12c>)
|
|
8008310: 681b ldr r3, [r3, #0]
|
|
8008312: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
8008314: 429a cmp r2, r3
|
|
8008316: d302 bcc.n 800831e <xTaskResumeAll+0xae>
|
|
{
|
|
xYieldPending = pdTRUE;
|
|
8008318: 4b21 ldr r3, [pc, #132] @ (80083a0 <xTaskResumeAll+0x130>)
|
|
800831a: 2201 movs r2, #1
|
|
800831c: 601a str r2, [r3, #0]
|
|
while( listLIST_IS_EMPTY( &xPendingReadyList ) == pdFALSE )
|
|
800831e: 4b1c ldr r3, [pc, #112] @ (8008390 <xTaskResumeAll+0x120>)
|
|
8008320: 681b ldr r3, [r3, #0]
|
|
8008322: 2b00 cmp r3, #0
|
|
8008324: d1cb bne.n 80082be <xTaskResumeAll+0x4e>
|
|
{
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
}
|
|
|
|
if( pxTCB != NULL )
|
|
8008326: 68fb ldr r3, [r7, #12]
|
|
8008328: 2b00 cmp r3, #0
|
|
800832a: d001 beq.n 8008330 <xTaskResumeAll+0xc0>
|
|
which may have prevented the next unblock time from being
|
|
re-calculated, in which case re-calculate it now. Mainly
|
|
important for low power tickless implementations, where
|
|
this can prevent an unnecessary exit from low power
|
|
state. */
|
|
prvResetNextTaskUnblockTime();
|
|
800832c: f000 fb66 bl 80089fc <prvResetNextTaskUnblockTime>
|
|
/* If any ticks occurred while the scheduler was suspended then
|
|
they should be processed now. This ensures the tick count does
|
|
not slip, and that any delayed tasks are resumed at the correct
|
|
time. */
|
|
{
|
|
TickType_t xPendedCounts = xPendedTicks; /* Non-volatile copy. */
|
|
8008330: 4b1c ldr r3, [pc, #112] @ (80083a4 <xTaskResumeAll+0x134>)
|
|
8008332: 681b ldr r3, [r3, #0]
|
|
8008334: 607b str r3, [r7, #4]
|
|
|
|
if( xPendedCounts > ( TickType_t ) 0U )
|
|
8008336: 687b ldr r3, [r7, #4]
|
|
8008338: 2b00 cmp r3, #0
|
|
800833a: d010 beq.n 800835e <xTaskResumeAll+0xee>
|
|
{
|
|
do
|
|
{
|
|
if( xTaskIncrementTick() != pdFALSE )
|
|
800833c: f000 f846 bl 80083cc <xTaskIncrementTick>
|
|
8008340: 4603 mov r3, r0
|
|
8008342: 2b00 cmp r3, #0
|
|
8008344: d002 beq.n 800834c <xTaskResumeAll+0xdc>
|
|
{
|
|
xYieldPending = pdTRUE;
|
|
8008346: 4b16 ldr r3, [pc, #88] @ (80083a0 <xTaskResumeAll+0x130>)
|
|
8008348: 2201 movs r2, #1
|
|
800834a: 601a str r2, [r3, #0]
|
|
}
|
|
else
|
|
{
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
--xPendedCounts;
|
|
800834c: 687b ldr r3, [r7, #4]
|
|
800834e: 3b01 subs r3, #1
|
|
8008350: 607b str r3, [r7, #4]
|
|
} while( xPendedCounts > ( TickType_t ) 0U );
|
|
8008352: 687b ldr r3, [r7, #4]
|
|
8008354: 2b00 cmp r3, #0
|
|
8008356: d1f1 bne.n 800833c <xTaskResumeAll+0xcc>
|
|
|
|
xPendedTicks = 0;
|
|
8008358: 4b12 ldr r3, [pc, #72] @ (80083a4 <xTaskResumeAll+0x134>)
|
|
800835a: 2200 movs r2, #0
|
|
800835c: 601a str r2, [r3, #0]
|
|
{
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
}
|
|
|
|
if( xYieldPending != pdFALSE )
|
|
800835e: 4b10 ldr r3, [pc, #64] @ (80083a0 <xTaskResumeAll+0x130>)
|
|
8008360: 681b ldr r3, [r3, #0]
|
|
8008362: 2b00 cmp r3, #0
|
|
8008364: d009 beq.n 800837a <xTaskResumeAll+0x10a>
|
|
{
|
|
#if( configUSE_PREEMPTION != 0 )
|
|
{
|
|
xAlreadyYielded = pdTRUE;
|
|
8008366: 2301 movs r3, #1
|
|
8008368: 60bb str r3, [r7, #8]
|
|
}
|
|
#endif
|
|
taskYIELD_IF_USING_PREEMPTION();
|
|
800836a: 4b0f ldr r3, [pc, #60] @ (80083a8 <xTaskResumeAll+0x138>)
|
|
800836c: f04f 5280 mov.w r2, #268435456 @ 0x10000000
|
|
8008370: 601a str r2, [r3, #0]
|
|
8008372: f3bf 8f4f dsb sy
|
|
8008376: f3bf 8f6f isb sy
|
|
else
|
|
{
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
}
|
|
taskEXIT_CRITICAL();
|
|
800837a: f001 fabf bl 80098fc <vPortExitCritical>
|
|
|
|
return xAlreadyYielded;
|
|
800837e: 68bb ldr r3, [r7, #8]
|
|
}
|
|
8008380: 4618 mov r0, r3
|
|
8008382: 3710 adds r7, #16
|
|
8008384: 46bd mov sp, r7
|
|
8008386: bd80 pop {r7, pc}
|
|
8008388: 20000fbc .word 0x20000fbc
|
|
800838c: 20000f94 .word 0x20000f94
|
|
8008390: 20000f54 .word 0x20000f54
|
|
8008394: 20000f9c .word 0x20000f9c
|
|
8008398: 20000ac4 .word 0x20000ac4
|
|
800839c: 20000ac0 .word 0x20000ac0
|
|
80083a0: 20000fa8 .word 0x20000fa8
|
|
80083a4: 20000fa4 .word 0x20000fa4
|
|
80083a8: e000ed04 .word 0xe000ed04
|
|
|
|
080083ac <xTaskGetTickCount>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
TickType_t xTaskGetTickCount( void )
|
|
{
|
|
80083ac: b480 push {r7}
|
|
80083ae: b083 sub sp, #12
|
|
80083b0: af00 add r7, sp, #0
|
|
TickType_t xTicks;
|
|
|
|
/* Critical section required if running on a 16 bit processor. */
|
|
portTICK_TYPE_ENTER_CRITICAL();
|
|
{
|
|
xTicks = xTickCount;
|
|
80083b2: 4b05 ldr r3, [pc, #20] @ (80083c8 <xTaskGetTickCount+0x1c>)
|
|
80083b4: 681b ldr r3, [r3, #0]
|
|
80083b6: 607b str r3, [r7, #4]
|
|
}
|
|
portTICK_TYPE_EXIT_CRITICAL();
|
|
|
|
return xTicks;
|
|
80083b8: 687b ldr r3, [r7, #4]
|
|
}
|
|
80083ba: 4618 mov r0, r3
|
|
80083bc: 370c adds r7, #12
|
|
80083be: 46bd mov sp, r7
|
|
80083c0: f85d 7b04 ldr.w r7, [sp], #4
|
|
80083c4: 4770 bx lr
|
|
80083c6: bf00 nop
|
|
80083c8: 20000f98 .word 0x20000f98
|
|
|
|
080083cc <xTaskIncrementTick>:
|
|
|
|
#endif /* INCLUDE_xTaskAbortDelay */
|
|
/*----------------------------------------------------------*/
|
|
|
|
BaseType_t xTaskIncrementTick( void )
|
|
{
|
|
80083cc: b580 push {r7, lr}
|
|
80083ce: b086 sub sp, #24
|
|
80083d0: af00 add r7, sp, #0
|
|
TCB_t * pxTCB;
|
|
TickType_t xItemValue;
|
|
BaseType_t xSwitchRequired = pdFALSE;
|
|
80083d2: 2300 movs r3, #0
|
|
80083d4: 617b str r3, [r7, #20]
|
|
|
|
/* Called by the portable layer each time a tick interrupt occurs.
|
|
Increments the tick then checks to see if the new tick value will cause any
|
|
tasks to be unblocked. */
|
|
traceTASK_INCREMENT_TICK( xTickCount );
|
|
if( uxSchedulerSuspended == ( UBaseType_t ) pdFALSE )
|
|
80083d6: 4b4f ldr r3, [pc, #316] @ (8008514 <xTaskIncrementTick+0x148>)
|
|
80083d8: 681b ldr r3, [r3, #0]
|
|
80083da: 2b00 cmp r3, #0
|
|
80083dc: f040 8090 bne.w 8008500 <xTaskIncrementTick+0x134>
|
|
{
|
|
/* Minor optimisation. The tick count cannot change in this
|
|
block. */
|
|
const TickType_t xConstTickCount = xTickCount + ( TickType_t ) 1;
|
|
80083e0: 4b4d ldr r3, [pc, #308] @ (8008518 <xTaskIncrementTick+0x14c>)
|
|
80083e2: 681b ldr r3, [r3, #0]
|
|
80083e4: 3301 adds r3, #1
|
|
80083e6: 613b str r3, [r7, #16]
|
|
|
|
/* Increment the RTOS tick, switching the delayed and overflowed
|
|
delayed lists if it wraps to 0. */
|
|
xTickCount = xConstTickCount;
|
|
80083e8: 4a4b ldr r2, [pc, #300] @ (8008518 <xTaskIncrementTick+0x14c>)
|
|
80083ea: 693b ldr r3, [r7, #16]
|
|
80083ec: 6013 str r3, [r2, #0]
|
|
|
|
if( xConstTickCount == ( TickType_t ) 0U ) /*lint !e774 'if' does not always evaluate to false as it is looking for an overflow. */
|
|
80083ee: 693b ldr r3, [r7, #16]
|
|
80083f0: 2b00 cmp r3, #0
|
|
80083f2: d121 bne.n 8008438 <xTaskIncrementTick+0x6c>
|
|
{
|
|
taskSWITCH_DELAYED_LISTS();
|
|
80083f4: 4b49 ldr r3, [pc, #292] @ (800851c <xTaskIncrementTick+0x150>)
|
|
80083f6: 681b ldr r3, [r3, #0]
|
|
80083f8: 681b ldr r3, [r3, #0]
|
|
80083fa: 2b00 cmp r3, #0
|
|
80083fc: d00b beq.n 8008416 <xTaskIncrementTick+0x4a>
|
|
__asm volatile
|
|
80083fe: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8008402: f383 8811 msr BASEPRI, r3
|
|
8008406: f3bf 8f6f isb sy
|
|
800840a: f3bf 8f4f dsb sy
|
|
800840e: 603b str r3, [r7, #0]
|
|
}
|
|
8008410: bf00 nop
|
|
8008412: bf00 nop
|
|
8008414: e7fd b.n 8008412 <xTaskIncrementTick+0x46>
|
|
8008416: 4b41 ldr r3, [pc, #260] @ (800851c <xTaskIncrementTick+0x150>)
|
|
8008418: 681b ldr r3, [r3, #0]
|
|
800841a: 60fb str r3, [r7, #12]
|
|
800841c: 4b40 ldr r3, [pc, #256] @ (8008520 <xTaskIncrementTick+0x154>)
|
|
800841e: 681b ldr r3, [r3, #0]
|
|
8008420: 4a3e ldr r2, [pc, #248] @ (800851c <xTaskIncrementTick+0x150>)
|
|
8008422: 6013 str r3, [r2, #0]
|
|
8008424: 4a3e ldr r2, [pc, #248] @ (8008520 <xTaskIncrementTick+0x154>)
|
|
8008426: 68fb ldr r3, [r7, #12]
|
|
8008428: 6013 str r3, [r2, #0]
|
|
800842a: 4b3e ldr r3, [pc, #248] @ (8008524 <xTaskIncrementTick+0x158>)
|
|
800842c: 681b ldr r3, [r3, #0]
|
|
800842e: 3301 adds r3, #1
|
|
8008430: 4a3c ldr r2, [pc, #240] @ (8008524 <xTaskIncrementTick+0x158>)
|
|
8008432: 6013 str r3, [r2, #0]
|
|
8008434: f000 fae2 bl 80089fc <prvResetNextTaskUnblockTime>
|
|
|
|
/* See if this tick has made a timeout expire. Tasks are stored in
|
|
the queue in the order of their wake time - meaning once one task
|
|
has been found whose block time has not expired there is no need to
|
|
look any further down the list. */
|
|
if( xConstTickCount >= xNextTaskUnblockTime )
|
|
8008438: 4b3b ldr r3, [pc, #236] @ (8008528 <xTaskIncrementTick+0x15c>)
|
|
800843a: 681b ldr r3, [r3, #0]
|
|
800843c: 693a ldr r2, [r7, #16]
|
|
800843e: 429a cmp r2, r3
|
|
8008440: d349 bcc.n 80084d6 <xTaskIncrementTick+0x10a>
|
|
{
|
|
for( ;; )
|
|
{
|
|
if( listLIST_IS_EMPTY( pxDelayedTaskList ) != pdFALSE )
|
|
8008442: 4b36 ldr r3, [pc, #216] @ (800851c <xTaskIncrementTick+0x150>)
|
|
8008444: 681b ldr r3, [r3, #0]
|
|
8008446: 681b ldr r3, [r3, #0]
|
|
8008448: 2b00 cmp r3, #0
|
|
800844a: d104 bne.n 8008456 <xTaskIncrementTick+0x8a>
|
|
/* The delayed list is empty. Set xNextTaskUnblockTime
|
|
to the maximum possible value so it is extremely
|
|
unlikely that the
|
|
if( xTickCount >= xNextTaskUnblockTime ) test will pass
|
|
next time through. */
|
|
xNextTaskUnblockTime = portMAX_DELAY; /*lint !e961 MISRA exception as the casts are only redundant for some ports. */
|
|
800844c: 4b36 ldr r3, [pc, #216] @ (8008528 <xTaskIncrementTick+0x15c>)
|
|
800844e: f04f 32ff mov.w r2, #4294967295 @ 0xffffffff
|
|
8008452: 601a str r2, [r3, #0]
|
|
break;
|
|
8008454: e03f b.n 80084d6 <xTaskIncrementTick+0x10a>
|
|
{
|
|
/* The delayed list is not empty, get the value of the
|
|
item at the head of the delayed list. This is the time
|
|
at which the task at the head of the delayed list must
|
|
be removed from the Blocked state. */
|
|
pxTCB = listGET_OWNER_OF_HEAD_ENTRY( pxDelayedTaskList ); /*lint !e9079 void * is used as this macro is used with timers and co-routines too. Alignment is known to be fine as the type of the pointer stored and retrieved is the same. */
|
|
8008456: 4b31 ldr r3, [pc, #196] @ (800851c <xTaskIncrementTick+0x150>)
|
|
8008458: 681b ldr r3, [r3, #0]
|
|
800845a: 68db ldr r3, [r3, #12]
|
|
800845c: 68db ldr r3, [r3, #12]
|
|
800845e: 60bb str r3, [r7, #8]
|
|
xItemValue = listGET_LIST_ITEM_VALUE( &( pxTCB->xStateListItem ) );
|
|
8008460: 68bb ldr r3, [r7, #8]
|
|
8008462: 685b ldr r3, [r3, #4]
|
|
8008464: 607b str r3, [r7, #4]
|
|
|
|
if( xConstTickCount < xItemValue )
|
|
8008466: 693a ldr r2, [r7, #16]
|
|
8008468: 687b ldr r3, [r7, #4]
|
|
800846a: 429a cmp r2, r3
|
|
800846c: d203 bcs.n 8008476 <xTaskIncrementTick+0xaa>
|
|
/* It is not time to unblock this item yet, but the
|
|
item value is the time at which the task at the head
|
|
of the blocked list must be removed from the Blocked
|
|
state - so record the item value in
|
|
xNextTaskUnblockTime. */
|
|
xNextTaskUnblockTime = xItemValue;
|
|
800846e: 4a2e ldr r2, [pc, #184] @ (8008528 <xTaskIncrementTick+0x15c>)
|
|
8008470: 687b ldr r3, [r7, #4]
|
|
8008472: 6013 str r3, [r2, #0]
|
|
break; /*lint !e9011 Code structure here is deedmed easier to understand with multiple breaks. */
|
|
8008474: e02f b.n 80084d6 <xTaskIncrementTick+0x10a>
|
|
{
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
|
|
/* It is time to remove the item from the Blocked state. */
|
|
( void ) uxListRemove( &( pxTCB->xStateListItem ) );
|
|
8008476: 68bb ldr r3, [r7, #8]
|
|
8008478: 3304 adds r3, #4
|
|
800847a: 4618 mov r0, r3
|
|
800847c: f7fe fc66 bl 8006d4c <uxListRemove>
|
|
|
|
/* Is the task waiting on an event also? If so remove
|
|
it from the event list. */
|
|
if( listLIST_ITEM_CONTAINER( &( pxTCB->xEventListItem ) ) != NULL )
|
|
8008480: 68bb ldr r3, [r7, #8]
|
|
8008482: 6a9b ldr r3, [r3, #40] @ 0x28
|
|
8008484: 2b00 cmp r3, #0
|
|
8008486: d004 beq.n 8008492 <xTaskIncrementTick+0xc6>
|
|
{
|
|
( void ) uxListRemove( &( pxTCB->xEventListItem ) );
|
|
8008488: 68bb ldr r3, [r7, #8]
|
|
800848a: 3318 adds r3, #24
|
|
800848c: 4618 mov r0, r3
|
|
800848e: f7fe fc5d bl 8006d4c <uxListRemove>
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
|
|
/* Place the unblocked task into the appropriate ready
|
|
list. */
|
|
prvAddTaskToReadyList( pxTCB );
|
|
8008492: 68bb ldr r3, [r7, #8]
|
|
8008494: 6ada ldr r2, [r3, #44] @ 0x2c
|
|
8008496: 4b25 ldr r3, [pc, #148] @ (800852c <xTaskIncrementTick+0x160>)
|
|
8008498: 681b ldr r3, [r3, #0]
|
|
800849a: 429a cmp r2, r3
|
|
800849c: d903 bls.n 80084a6 <xTaskIncrementTick+0xda>
|
|
800849e: 68bb ldr r3, [r7, #8]
|
|
80084a0: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
80084a2: 4a22 ldr r2, [pc, #136] @ (800852c <xTaskIncrementTick+0x160>)
|
|
80084a4: 6013 str r3, [r2, #0]
|
|
80084a6: 68bb ldr r3, [r7, #8]
|
|
80084a8: 6ada ldr r2, [r3, #44] @ 0x2c
|
|
80084aa: 4613 mov r3, r2
|
|
80084ac: 009b lsls r3, r3, #2
|
|
80084ae: 4413 add r3, r2
|
|
80084b0: 009b lsls r3, r3, #2
|
|
80084b2: 4a1f ldr r2, [pc, #124] @ (8008530 <xTaskIncrementTick+0x164>)
|
|
80084b4: 441a add r2, r3
|
|
80084b6: 68bb ldr r3, [r7, #8]
|
|
80084b8: 3304 adds r3, #4
|
|
80084ba: 4619 mov r1, r3
|
|
80084bc: 4610 mov r0, r2
|
|
80084be: f7fe fbe8 bl 8006c92 <vListInsertEnd>
|
|
{
|
|
/* Preemption is on, but a context switch should
|
|
only be performed if the unblocked task has a
|
|
priority that is equal to or higher than the
|
|
currently executing task. */
|
|
if( pxTCB->uxPriority >= pxCurrentTCB->uxPriority )
|
|
80084c2: 68bb ldr r3, [r7, #8]
|
|
80084c4: 6ada ldr r2, [r3, #44] @ 0x2c
|
|
80084c6: 4b1b ldr r3, [pc, #108] @ (8008534 <xTaskIncrementTick+0x168>)
|
|
80084c8: 681b ldr r3, [r3, #0]
|
|
80084ca: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
80084cc: 429a cmp r2, r3
|
|
80084ce: d3b8 bcc.n 8008442 <xTaskIncrementTick+0x76>
|
|
{
|
|
xSwitchRequired = pdTRUE;
|
|
80084d0: 2301 movs r3, #1
|
|
80084d2: 617b str r3, [r7, #20]
|
|
if( listLIST_IS_EMPTY( pxDelayedTaskList ) != pdFALSE )
|
|
80084d4: e7b5 b.n 8008442 <xTaskIncrementTick+0x76>
|
|
/* Tasks of equal priority to the currently running task will share
|
|
processing time (time slice) if preemption is on, and the application
|
|
writer has not explicitly turned time slicing off. */
|
|
#if ( ( configUSE_PREEMPTION == 1 ) && ( configUSE_TIME_SLICING == 1 ) )
|
|
{
|
|
if( listCURRENT_LIST_LENGTH( &( pxReadyTasksLists[ pxCurrentTCB->uxPriority ] ) ) > ( UBaseType_t ) 1 )
|
|
80084d6: 4b17 ldr r3, [pc, #92] @ (8008534 <xTaskIncrementTick+0x168>)
|
|
80084d8: 681b ldr r3, [r3, #0]
|
|
80084da: 6ada ldr r2, [r3, #44] @ 0x2c
|
|
80084dc: 4914 ldr r1, [pc, #80] @ (8008530 <xTaskIncrementTick+0x164>)
|
|
80084de: 4613 mov r3, r2
|
|
80084e0: 009b lsls r3, r3, #2
|
|
80084e2: 4413 add r3, r2
|
|
80084e4: 009b lsls r3, r3, #2
|
|
80084e6: 440b add r3, r1
|
|
80084e8: 681b ldr r3, [r3, #0]
|
|
80084ea: 2b01 cmp r3, #1
|
|
80084ec: d901 bls.n 80084f2 <xTaskIncrementTick+0x126>
|
|
{
|
|
xSwitchRequired = pdTRUE;
|
|
80084ee: 2301 movs r3, #1
|
|
80084f0: 617b str r3, [r7, #20]
|
|
}
|
|
#endif /* configUSE_TICK_HOOK */
|
|
|
|
#if ( configUSE_PREEMPTION == 1 )
|
|
{
|
|
if( xYieldPending != pdFALSE )
|
|
80084f2: 4b11 ldr r3, [pc, #68] @ (8008538 <xTaskIncrementTick+0x16c>)
|
|
80084f4: 681b ldr r3, [r3, #0]
|
|
80084f6: 2b00 cmp r3, #0
|
|
80084f8: d007 beq.n 800850a <xTaskIncrementTick+0x13e>
|
|
{
|
|
xSwitchRequired = pdTRUE;
|
|
80084fa: 2301 movs r3, #1
|
|
80084fc: 617b str r3, [r7, #20]
|
|
80084fe: e004 b.n 800850a <xTaskIncrementTick+0x13e>
|
|
}
|
|
#endif /* configUSE_PREEMPTION */
|
|
}
|
|
else
|
|
{
|
|
++xPendedTicks;
|
|
8008500: 4b0e ldr r3, [pc, #56] @ (800853c <xTaskIncrementTick+0x170>)
|
|
8008502: 681b ldr r3, [r3, #0]
|
|
8008504: 3301 adds r3, #1
|
|
8008506: 4a0d ldr r2, [pc, #52] @ (800853c <xTaskIncrementTick+0x170>)
|
|
8008508: 6013 str r3, [r2, #0]
|
|
vApplicationTickHook();
|
|
}
|
|
#endif
|
|
}
|
|
|
|
return xSwitchRequired;
|
|
800850a: 697b ldr r3, [r7, #20]
|
|
}
|
|
800850c: 4618 mov r0, r3
|
|
800850e: 3718 adds r7, #24
|
|
8008510: 46bd mov sp, r7
|
|
8008512: bd80 pop {r7, pc}
|
|
8008514: 20000fbc .word 0x20000fbc
|
|
8008518: 20000f98 .word 0x20000f98
|
|
800851c: 20000f4c .word 0x20000f4c
|
|
8008520: 20000f50 .word 0x20000f50
|
|
8008524: 20000fac .word 0x20000fac
|
|
8008528: 20000fb4 .word 0x20000fb4
|
|
800852c: 20000f9c .word 0x20000f9c
|
|
8008530: 20000ac4 .word 0x20000ac4
|
|
8008534: 20000ac0 .word 0x20000ac0
|
|
8008538: 20000fa8 .word 0x20000fa8
|
|
800853c: 20000fa4 .word 0x20000fa4
|
|
|
|
08008540 <vTaskSwitchContext>:
|
|
|
|
#endif /* configUSE_APPLICATION_TASK_TAG */
|
|
/*-----------------------------------------------------------*/
|
|
|
|
void vTaskSwitchContext( void )
|
|
{
|
|
8008540: b480 push {r7}
|
|
8008542: b085 sub sp, #20
|
|
8008544: af00 add r7, sp, #0
|
|
if( uxSchedulerSuspended != ( UBaseType_t ) pdFALSE )
|
|
8008546: 4b2b ldr r3, [pc, #172] @ (80085f4 <vTaskSwitchContext+0xb4>)
|
|
8008548: 681b ldr r3, [r3, #0]
|
|
800854a: 2b00 cmp r3, #0
|
|
800854c: d003 beq.n 8008556 <vTaskSwitchContext+0x16>
|
|
{
|
|
/* The scheduler is currently suspended - do not allow a context
|
|
switch. */
|
|
xYieldPending = pdTRUE;
|
|
800854e: 4b2a ldr r3, [pc, #168] @ (80085f8 <vTaskSwitchContext+0xb8>)
|
|
8008550: 2201 movs r2, #1
|
|
8008552: 601a str r2, [r3, #0]
|
|
for additional information. */
|
|
_impure_ptr = &( pxCurrentTCB->xNewLib_reent );
|
|
}
|
|
#endif /* configUSE_NEWLIB_REENTRANT */
|
|
}
|
|
}
|
|
8008554: e047 b.n 80085e6 <vTaskSwitchContext+0xa6>
|
|
xYieldPending = pdFALSE;
|
|
8008556: 4b28 ldr r3, [pc, #160] @ (80085f8 <vTaskSwitchContext+0xb8>)
|
|
8008558: 2200 movs r2, #0
|
|
800855a: 601a str r2, [r3, #0]
|
|
taskSELECT_HIGHEST_PRIORITY_TASK(); /*lint !e9079 void * is used as this macro is used with timers and co-routines too. Alignment is known to be fine as the type of the pointer stored and retrieved is the same. */
|
|
800855c: 4b27 ldr r3, [pc, #156] @ (80085fc <vTaskSwitchContext+0xbc>)
|
|
800855e: 681b ldr r3, [r3, #0]
|
|
8008560: 60fb str r3, [r7, #12]
|
|
8008562: e011 b.n 8008588 <vTaskSwitchContext+0x48>
|
|
8008564: 68fb ldr r3, [r7, #12]
|
|
8008566: 2b00 cmp r3, #0
|
|
8008568: d10b bne.n 8008582 <vTaskSwitchContext+0x42>
|
|
__asm volatile
|
|
800856a: f04f 0350 mov.w r3, #80 @ 0x50
|
|
800856e: f383 8811 msr BASEPRI, r3
|
|
8008572: f3bf 8f6f isb sy
|
|
8008576: f3bf 8f4f dsb sy
|
|
800857a: 607b str r3, [r7, #4]
|
|
}
|
|
800857c: bf00 nop
|
|
800857e: bf00 nop
|
|
8008580: e7fd b.n 800857e <vTaskSwitchContext+0x3e>
|
|
8008582: 68fb ldr r3, [r7, #12]
|
|
8008584: 3b01 subs r3, #1
|
|
8008586: 60fb str r3, [r7, #12]
|
|
8008588: 491d ldr r1, [pc, #116] @ (8008600 <vTaskSwitchContext+0xc0>)
|
|
800858a: 68fa ldr r2, [r7, #12]
|
|
800858c: 4613 mov r3, r2
|
|
800858e: 009b lsls r3, r3, #2
|
|
8008590: 4413 add r3, r2
|
|
8008592: 009b lsls r3, r3, #2
|
|
8008594: 440b add r3, r1
|
|
8008596: 681b ldr r3, [r3, #0]
|
|
8008598: 2b00 cmp r3, #0
|
|
800859a: d0e3 beq.n 8008564 <vTaskSwitchContext+0x24>
|
|
800859c: 68fa ldr r2, [r7, #12]
|
|
800859e: 4613 mov r3, r2
|
|
80085a0: 009b lsls r3, r3, #2
|
|
80085a2: 4413 add r3, r2
|
|
80085a4: 009b lsls r3, r3, #2
|
|
80085a6: 4a16 ldr r2, [pc, #88] @ (8008600 <vTaskSwitchContext+0xc0>)
|
|
80085a8: 4413 add r3, r2
|
|
80085aa: 60bb str r3, [r7, #8]
|
|
80085ac: 68bb ldr r3, [r7, #8]
|
|
80085ae: 685b ldr r3, [r3, #4]
|
|
80085b0: 685a ldr r2, [r3, #4]
|
|
80085b2: 68bb ldr r3, [r7, #8]
|
|
80085b4: 605a str r2, [r3, #4]
|
|
80085b6: 68bb ldr r3, [r7, #8]
|
|
80085b8: 685a ldr r2, [r3, #4]
|
|
80085ba: 68bb ldr r3, [r7, #8]
|
|
80085bc: 3308 adds r3, #8
|
|
80085be: 429a cmp r2, r3
|
|
80085c0: d104 bne.n 80085cc <vTaskSwitchContext+0x8c>
|
|
80085c2: 68bb ldr r3, [r7, #8]
|
|
80085c4: 685b ldr r3, [r3, #4]
|
|
80085c6: 685a ldr r2, [r3, #4]
|
|
80085c8: 68bb ldr r3, [r7, #8]
|
|
80085ca: 605a str r2, [r3, #4]
|
|
80085cc: 68bb ldr r3, [r7, #8]
|
|
80085ce: 685b ldr r3, [r3, #4]
|
|
80085d0: 68db ldr r3, [r3, #12]
|
|
80085d2: 4a0c ldr r2, [pc, #48] @ (8008604 <vTaskSwitchContext+0xc4>)
|
|
80085d4: 6013 str r3, [r2, #0]
|
|
80085d6: 4a09 ldr r2, [pc, #36] @ (80085fc <vTaskSwitchContext+0xbc>)
|
|
80085d8: 68fb ldr r3, [r7, #12]
|
|
80085da: 6013 str r3, [r2, #0]
|
|
_impure_ptr = &( pxCurrentTCB->xNewLib_reent );
|
|
80085dc: 4b09 ldr r3, [pc, #36] @ (8008604 <vTaskSwitchContext+0xc4>)
|
|
80085de: 681b ldr r3, [r3, #0]
|
|
80085e0: 3354 adds r3, #84 @ 0x54
|
|
80085e2: 4a09 ldr r2, [pc, #36] @ (8008608 <vTaskSwitchContext+0xc8>)
|
|
80085e4: 6013 str r3, [r2, #0]
|
|
}
|
|
80085e6: bf00 nop
|
|
80085e8: 3714 adds r7, #20
|
|
80085ea: 46bd mov sp, r7
|
|
80085ec: f85d 7b04 ldr.w r7, [sp], #4
|
|
80085f0: 4770 bx lr
|
|
80085f2: bf00 nop
|
|
80085f4: 20000fbc .word 0x20000fbc
|
|
80085f8: 20000fa8 .word 0x20000fa8
|
|
80085fc: 20000f9c .word 0x20000f9c
|
|
8008600: 20000ac4 .word 0x20000ac4
|
|
8008604: 20000ac0 .word 0x20000ac0
|
|
8008608: 20000028 .word 0x20000028
|
|
|
|
0800860c <vTaskPlaceOnEventList>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
void vTaskPlaceOnEventList( List_t * const pxEventList, const TickType_t xTicksToWait )
|
|
{
|
|
800860c: b580 push {r7, lr}
|
|
800860e: b084 sub sp, #16
|
|
8008610: af00 add r7, sp, #0
|
|
8008612: 6078 str r0, [r7, #4]
|
|
8008614: 6039 str r1, [r7, #0]
|
|
configASSERT( pxEventList );
|
|
8008616: 687b ldr r3, [r7, #4]
|
|
8008618: 2b00 cmp r3, #0
|
|
800861a: d10b bne.n 8008634 <vTaskPlaceOnEventList+0x28>
|
|
__asm volatile
|
|
800861c: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8008620: f383 8811 msr BASEPRI, r3
|
|
8008624: f3bf 8f6f isb sy
|
|
8008628: f3bf 8f4f dsb sy
|
|
800862c: 60fb str r3, [r7, #12]
|
|
}
|
|
800862e: bf00 nop
|
|
8008630: bf00 nop
|
|
8008632: e7fd b.n 8008630 <vTaskPlaceOnEventList+0x24>
|
|
|
|
/* Place the event list item of the TCB in the appropriate event list.
|
|
This is placed in the list in priority order so the highest priority task
|
|
is the first to be woken by the event. The queue that contains the event
|
|
list is locked, preventing simultaneous access from interrupts. */
|
|
vListInsert( pxEventList, &( pxCurrentTCB->xEventListItem ) );
|
|
8008634: 4b07 ldr r3, [pc, #28] @ (8008654 <vTaskPlaceOnEventList+0x48>)
|
|
8008636: 681b ldr r3, [r3, #0]
|
|
8008638: 3318 adds r3, #24
|
|
800863a: 4619 mov r1, r3
|
|
800863c: 6878 ldr r0, [r7, #4]
|
|
800863e: f7fe fb4c bl 8006cda <vListInsert>
|
|
|
|
prvAddCurrentTaskToDelayedList( xTicksToWait, pdTRUE );
|
|
8008642: 2101 movs r1, #1
|
|
8008644: 6838 ldr r0, [r7, #0]
|
|
8008646: f000 fb87 bl 8008d58 <prvAddCurrentTaskToDelayedList>
|
|
}
|
|
800864a: bf00 nop
|
|
800864c: 3710 adds r7, #16
|
|
800864e: 46bd mov sp, r7
|
|
8008650: bd80 pop {r7, pc}
|
|
8008652: bf00 nop
|
|
8008654: 20000ac0 .word 0x20000ac0
|
|
|
|
08008658 <vTaskPlaceOnEventListRestricted>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
#if( configUSE_TIMERS == 1 )
|
|
|
|
void vTaskPlaceOnEventListRestricted( List_t * const pxEventList, TickType_t xTicksToWait, const BaseType_t xWaitIndefinitely )
|
|
{
|
|
8008658: b580 push {r7, lr}
|
|
800865a: b086 sub sp, #24
|
|
800865c: af00 add r7, sp, #0
|
|
800865e: 60f8 str r0, [r7, #12]
|
|
8008660: 60b9 str r1, [r7, #8]
|
|
8008662: 607a str r2, [r7, #4]
|
|
configASSERT( pxEventList );
|
|
8008664: 68fb ldr r3, [r7, #12]
|
|
8008666: 2b00 cmp r3, #0
|
|
8008668: d10b bne.n 8008682 <vTaskPlaceOnEventListRestricted+0x2a>
|
|
__asm volatile
|
|
800866a: f04f 0350 mov.w r3, #80 @ 0x50
|
|
800866e: f383 8811 msr BASEPRI, r3
|
|
8008672: f3bf 8f6f isb sy
|
|
8008676: f3bf 8f4f dsb sy
|
|
800867a: 617b str r3, [r7, #20]
|
|
}
|
|
800867c: bf00 nop
|
|
800867e: bf00 nop
|
|
8008680: e7fd b.n 800867e <vTaskPlaceOnEventListRestricted+0x26>
|
|
|
|
/* Place the event list item of the TCB in the appropriate event list.
|
|
In this case it is assume that this is the only task that is going to
|
|
be waiting on this event list, so the faster vListInsertEnd() function
|
|
can be used in place of vListInsert. */
|
|
vListInsertEnd( pxEventList, &( pxCurrentTCB->xEventListItem ) );
|
|
8008682: 4b0a ldr r3, [pc, #40] @ (80086ac <vTaskPlaceOnEventListRestricted+0x54>)
|
|
8008684: 681b ldr r3, [r3, #0]
|
|
8008686: 3318 adds r3, #24
|
|
8008688: 4619 mov r1, r3
|
|
800868a: 68f8 ldr r0, [r7, #12]
|
|
800868c: f7fe fb01 bl 8006c92 <vListInsertEnd>
|
|
|
|
/* If the task should block indefinitely then set the block time to a
|
|
value that will be recognised as an indefinite delay inside the
|
|
prvAddCurrentTaskToDelayedList() function. */
|
|
if( xWaitIndefinitely != pdFALSE )
|
|
8008690: 687b ldr r3, [r7, #4]
|
|
8008692: 2b00 cmp r3, #0
|
|
8008694: d002 beq.n 800869c <vTaskPlaceOnEventListRestricted+0x44>
|
|
{
|
|
xTicksToWait = portMAX_DELAY;
|
|
8008696: f04f 33ff mov.w r3, #4294967295 @ 0xffffffff
|
|
800869a: 60bb str r3, [r7, #8]
|
|
}
|
|
|
|
traceTASK_DELAY_UNTIL( ( xTickCount + xTicksToWait ) );
|
|
prvAddCurrentTaskToDelayedList( xTicksToWait, xWaitIndefinitely );
|
|
800869c: 6879 ldr r1, [r7, #4]
|
|
800869e: 68b8 ldr r0, [r7, #8]
|
|
80086a0: f000 fb5a bl 8008d58 <prvAddCurrentTaskToDelayedList>
|
|
}
|
|
80086a4: bf00 nop
|
|
80086a6: 3718 adds r7, #24
|
|
80086a8: 46bd mov sp, r7
|
|
80086aa: bd80 pop {r7, pc}
|
|
80086ac: 20000ac0 .word 0x20000ac0
|
|
|
|
080086b0 <xTaskRemoveFromEventList>:
|
|
|
|
#endif /* configUSE_TIMERS */
|
|
/*-----------------------------------------------------------*/
|
|
|
|
BaseType_t xTaskRemoveFromEventList( const List_t * const pxEventList )
|
|
{
|
|
80086b0: b580 push {r7, lr}
|
|
80086b2: b086 sub sp, #24
|
|
80086b4: af00 add r7, sp, #0
|
|
80086b6: 6078 str r0, [r7, #4]
|
|
get called - the lock count on the queue will get modified instead. This
|
|
means exclusive access to the event list is guaranteed here.
|
|
|
|
This function assumes that a check has already been made to ensure that
|
|
pxEventList is not empty. */
|
|
pxUnblockedTCB = listGET_OWNER_OF_HEAD_ENTRY( pxEventList ); /*lint !e9079 void * is used as this macro is used with timers and co-routines too. Alignment is known to be fine as the type of the pointer stored and retrieved is the same. */
|
|
80086b8: 687b ldr r3, [r7, #4]
|
|
80086ba: 68db ldr r3, [r3, #12]
|
|
80086bc: 68db ldr r3, [r3, #12]
|
|
80086be: 613b str r3, [r7, #16]
|
|
configASSERT( pxUnblockedTCB );
|
|
80086c0: 693b ldr r3, [r7, #16]
|
|
80086c2: 2b00 cmp r3, #0
|
|
80086c4: d10b bne.n 80086de <xTaskRemoveFromEventList+0x2e>
|
|
__asm volatile
|
|
80086c6: f04f 0350 mov.w r3, #80 @ 0x50
|
|
80086ca: f383 8811 msr BASEPRI, r3
|
|
80086ce: f3bf 8f6f isb sy
|
|
80086d2: f3bf 8f4f dsb sy
|
|
80086d6: 60fb str r3, [r7, #12]
|
|
}
|
|
80086d8: bf00 nop
|
|
80086da: bf00 nop
|
|
80086dc: e7fd b.n 80086da <xTaskRemoveFromEventList+0x2a>
|
|
( void ) uxListRemove( &( pxUnblockedTCB->xEventListItem ) );
|
|
80086de: 693b ldr r3, [r7, #16]
|
|
80086e0: 3318 adds r3, #24
|
|
80086e2: 4618 mov r0, r3
|
|
80086e4: f7fe fb32 bl 8006d4c <uxListRemove>
|
|
|
|
if( uxSchedulerSuspended == ( UBaseType_t ) pdFALSE )
|
|
80086e8: 4b1d ldr r3, [pc, #116] @ (8008760 <xTaskRemoveFromEventList+0xb0>)
|
|
80086ea: 681b ldr r3, [r3, #0]
|
|
80086ec: 2b00 cmp r3, #0
|
|
80086ee: d11d bne.n 800872c <xTaskRemoveFromEventList+0x7c>
|
|
{
|
|
( void ) uxListRemove( &( pxUnblockedTCB->xStateListItem ) );
|
|
80086f0: 693b ldr r3, [r7, #16]
|
|
80086f2: 3304 adds r3, #4
|
|
80086f4: 4618 mov r0, r3
|
|
80086f6: f7fe fb29 bl 8006d4c <uxListRemove>
|
|
prvAddTaskToReadyList( pxUnblockedTCB );
|
|
80086fa: 693b ldr r3, [r7, #16]
|
|
80086fc: 6ada ldr r2, [r3, #44] @ 0x2c
|
|
80086fe: 4b19 ldr r3, [pc, #100] @ (8008764 <xTaskRemoveFromEventList+0xb4>)
|
|
8008700: 681b ldr r3, [r3, #0]
|
|
8008702: 429a cmp r2, r3
|
|
8008704: d903 bls.n 800870e <xTaskRemoveFromEventList+0x5e>
|
|
8008706: 693b ldr r3, [r7, #16]
|
|
8008708: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
800870a: 4a16 ldr r2, [pc, #88] @ (8008764 <xTaskRemoveFromEventList+0xb4>)
|
|
800870c: 6013 str r3, [r2, #0]
|
|
800870e: 693b ldr r3, [r7, #16]
|
|
8008710: 6ada ldr r2, [r3, #44] @ 0x2c
|
|
8008712: 4613 mov r3, r2
|
|
8008714: 009b lsls r3, r3, #2
|
|
8008716: 4413 add r3, r2
|
|
8008718: 009b lsls r3, r3, #2
|
|
800871a: 4a13 ldr r2, [pc, #76] @ (8008768 <xTaskRemoveFromEventList+0xb8>)
|
|
800871c: 441a add r2, r3
|
|
800871e: 693b ldr r3, [r7, #16]
|
|
8008720: 3304 adds r3, #4
|
|
8008722: 4619 mov r1, r3
|
|
8008724: 4610 mov r0, r2
|
|
8008726: f7fe fab4 bl 8006c92 <vListInsertEnd>
|
|
800872a: e005 b.n 8008738 <xTaskRemoveFromEventList+0x88>
|
|
}
|
|
else
|
|
{
|
|
/* The delayed and ready lists cannot be accessed, so hold this task
|
|
pending until the scheduler is resumed. */
|
|
vListInsertEnd( &( xPendingReadyList ), &( pxUnblockedTCB->xEventListItem ) );
|
|
800872c: 693b ldr r3, [r7, #16]
|
|
800872e: 3318 adds r3, #24
|
|
8008730: 4619 mov r1, r3
|
|
8008732: 480e ldr r0, [pc, #56] @ (800876c <xTaskRemoveFromEventList+0xbc>)
|
|
8008734: f7fe faad bl 8006c92 <vListInsertEnd>
|
|
}
|
|
|
|
if( pxUnblockedTCB->uxPriority > pxCurrentTCB->uxPriority )
|
|
8008738: 693b ldr r3, [r7, #16]
|
|
800873a: 6ada ldr r2, [r3, #44] @ 0x2c
|
|
800873c: 4b0c ldr r3, [pc, #48] @ (8008770 <xTaskRemoveFromEventList+0xc0>)
|
|
800873e: 681b ldr r3, [r3, #0]
|
|
8008740: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
8008742: 429a cmp r2, r3
|
|
8008744: d905 bls.n 8008752 <xTaskRemoveFromEventList+0xa2>
|
|
{
|
|
/* Return true if the task removed from the event list has a higher
|
|
priority than the calling task. This allows the calling task to know if
|
|
it should force a context switch now. */
|
|
xReturn = pdTRUE;
|
|
8008746: 2301 movs r3, #1
|
|
8008748: 617b str r3, [r7, #20]
|
|
|
|
/* Mark that a yield is pending in case the user is not using the
|
|
"xHigherPriorityTaskWoken" parameter to an ISR safe FreeRTOS function. */
|
|
xYieldPending = pdTRUE;
|
|
800874a: 4b0a ldr r3, [pc, #40] @ (8008774 <xTaskRemoveFromEventList+0xc4>)
|
|
800874c: 2201 movs r2, #1
|
|
800874e: 601a str r2, [r3, #0]
|
|
8008750: e001 b.n 8008756 <xTaskRemoveFromEventList+0xa6>
|
|
}
|
|
else
|
|
{
|
|
xReturn = pdFALSE;
|
|
8008752: 2300 movs r3, #0
|
|
8008754: 617b str r3, [r7, #20]
|
|
}
|
|
|
|
return xReturn;
|
|
8008756: 697b ldr r3, [r7, #20]
|
|
}
|
|
8008758: 4618 mov r0, r3
|
|
800875a: 3718 adds r7, #24
|
|
800875c: 46bd mov sp, r7
|
|
800875e: bd80 pop {r7, pc}
|
|
8008760: 20000fbc .word 0x20000fbc
|
|
8008764: 20000f9c .word 0x20000f9c
|
|
8008768: 20000ac4 .word 0x20000ac4
|
|
800876c: 20000f54 .word 0x20000f54
|
|
8008770: 20000ac0 .word 0x20000ac0
|
|
8008774: 20000fa8 .word 0x20000fa8
|
|
|
|
08008778 <vTaskInternalSetTimeOutState>:
|
|
taskEXIT_CRITICAL();
|
|
}
|
|
/*-----------------------------------------------------------*/
|
|
|
|
void vTaskInternalSetTimeOutState( TimeOut_t * const pxTimeOut )
|
|
{
|
|
8008778: b480 push {r7}
|
|
800877a: b083 sub sp, #12
|
|
800877c: af00 add r7, sp, #0
|
|
800877e: 6078 str r0, [r7, #4]
|
|
/* For internal use only as it does not use a critical section. */
|
|
pxTimeOut->xOverflowCount = xNumOfOverflows;
|
|
8008780: 4b06 ldr r3, [pc, #24] @ (800879c <vTaskInternalSetTimeOutState+0x24>)
|
|
8008782: 681a ldr r2, [r3, #0]
|
|
8008784: 687b ldr r3, [r7, #4]
|
|
8008786: 601a str r2, [r3, #0]
|
|
pxTimeOut->xTimeOnEntering = xTickCount;
|
|
8008788: 4b05 ldr r3, [pc, #20] @ (80087a0 <vTaskInternalSetTimeOutState+0x28>)
|
|
800878a: 681a ldr r2, [r3, #0]
|
|
800878c: 687b ldr r3, [r7, #4]
|
|
800878e: 605a str r2, [r3, #4]
|
|
}
|
|
8008790: bf00 nop
|
|
8008792: 370c adds r7, #12
|
|
8008794: 46bd mov sp, r7
|
|
8008796: f85d 7b04 ldr.w r7, [sp], #4
|
|
800879a: 4770 bx lr
|
|
800879c: 20000fac .word 0x20000fac
|
|
80087a0: 20000f98 .word 0x20000f98
|
|
|
|
080087a4 <xTaskCheckForTimeOut>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
BaseType_t xTaskCheckForTimeOut( TimeOut_t * const pxTimeOut, TickType_t * const pxTicksToWait )
|
|
{
|
|
80087a4: b580 push {r7, lr}
|
|
80087a6: b088 sub sp, #32
|
|
80087a8: af00 add r7, sp, #0
|
|
80087aa: 6078 str r0, [r7, #4]
|
|
80087ac: 6039 str r1, [r7, #0]
|
|
BaseType_t xReturn;
|
|
|
|
configASSERT( pxTimeOut );
|
|
80087ae: 687b ldr r3, [r7, #4]
|
|
80087b0: 2b00 cmp r3, #0
|
|
80087b2: d10b bne.n 80087cc <xTaskCheckForTimeOut+0x28>
|
|
__asm volatile
|
|
80087b4: f04f 0350 mov.w r3, #80 @ 0x50
|
|
80087b8: f383 8811 msr BASEPRI, r3
|
|
80087bc: f3bf 8f6f isb sy
|
|
80087c0: f3bf 8f4f dsb sy
|
|
80087c4: 613b str r3, [r7, #16]
|
|
}
|
|
80087c6: bf00 nop
|
|
80087c8: bf00 nop
|
|
80087ca: e7fd b.n 80087c8 <xTaskCheckForTimeOut+0x24>
|
|
configASSERT( pxTicksToWait );
|
|
80087cc: 683b ldr r3, [r7, #0]
|
|
80087ce: 2b00 cmp r3, #0
|
|
80087d0: d10b bne.n 80087ea <xTaskCheckForTimeOut+0x46>
|
|
__asm volatile
|
|
80087d2: f04f 0350 mov.w r3, #80 @ 0x50
|
|
80087d6: f383 8811 msr BASEPRI, r3
|
|
80087da: f3bf 8f6f isb sy
|
|
80087de: f3bf 8f4f dsb sy
|
|
80087e2: 60fb str r3, [r7, #12]
|
|
}
|
|
80087e4: bf00 nop
|
|
80087e6: bf00 nop
|
|
80087e8: e7fd b.n 80087e6 <xTaskCheckForTimeOut+0x42>
|
|
|
|
taskENTER_CRITICAL();
|
|
80087ea: f001 f855 bl 8009898 <vPortEnterCritical>
|
|
{
|
|
/* Minor optimisation. The tick count cannot change in this block. */
|
|
const TickType_t xConstTickCount = xTickCount;
|
|
80087ee: 4b1d ldr r3, [pc, #116] @ (8008864 <xTaskCheckForTimeOut+0xc0>)
|
|
80087f0: 681b ldr r3, [r3, #0]
|
|
80087f2: 61bb str r3, [r7, #24]
|
|
const TickType_t xElapsedTime = xConstTickCount - pxTimeOut->xTimeOnEntering;
|
|
80087f4: 687b ldr r3, [r7, #4]
|
|
80087f6: 685b ldr r3, [r3, #4]
|
|
80087f8: 69ba ldr r2, [r7, #24]
|
|
80087fa: 1ad3 subs r3, r2, r3
|
|
80087fc: 617b str r3, [r7, #20]
|
|
}
|
|
else
|
|
#endif
|
|
|
|
#if ( INCLUDE_vTaskSuspend == 1 )
|
|
if( *pxTicksToWait == portMAX_DELAY )
|
|
80087fe: 683b ldr r3, [r7, #0]
|
|
8008800: 681b ldr r3, [r3, #0]
|
|
8008802: f1b3 3fff cmp.w r3, #4294967295 @ 0xffffffff
|
|
8008806: d102 bne.n 800880e <xTaskCheckForTimeOut+0x6a>
|
|
{
|
|
/* If INCLUDE_vTaskSuspend is set to 1 and the block time
|
|
specified is the maximum block time then the task should block
|
|
indefinitely, and therefore never time out. */
|
|
xReturn = pdFALSE;
|
|
8008808: 2300 movs r3, #0
|
|
800880a: 61fb str r3, [r7, #28]
|
|
800880c: e023 b.n 8008856 <xTaskCheckForTimeOut+0xb2>
|
|
}
|
|
else
|
|
#endif
|
|
|
|
if( ( xNumOfOverflows != pxTimeOut->xOverflowCount ) && ( xConstTickCount >= pxTimeOut->xTimeOnEntering ) ) /*lint !e525 Indentation preferred as is to make code within pre-processor directives clearer. */
|
|
800880e: 687b ldr r3, [r7, #4]
|
|
8008810: 681a ldr r2, [r3, #0]
|
|
8008812: 4b15 ldr r3, [pc, #84] @ (8008868 <xTaskCheckForTimeOut+0xc4>)
|
|
8008814: 681b ldr r3, [r3, #0]
|
|
8008816: 429a cmp r2, r3
|
|
8008818: d007 beq.n 800882a <xTaskCheckForTimeOut+0x86>
|
|
800881a: 687b ldr r3, [r7, #4]
|
|
800881c: 685b ldr r3, [r3, #4]
|
|
800881e: 69ba ldr r2, [r7, #24]
|
|
8008820: 429a cmp r2, r3
|
|
8008822: d302 bcc.n 800882a <xTaskCheckForTimeOut+0x86>
|
|
/* The tick count is greater than the time at which
|
|
vTaskSetTimeout() was called, but has also overflowed since
|
|
vTaskSetTimeOut() was called. It must have wrapped all the way
|
|
around and gone past again. This passed since vTaskSetTimeout()
|
|
was called. */
|
|
xReturn = pdTRUE;
|
|
8008824: 2301 movs r3, #1
|
|
8008826: 61fb str r3, [r7, #28]
|
|
8008828: e015 b.n 8008856 <xTaskCheckForTimeOut+0xb2>
|
|
}
|
|
else if( xElapsedTime < *pxTicksToWait ) /*lint !e961 Explicit casting is only redundant with some compilers, whereas others require it to prevent integer conversion errors. */
|
|
800882a: 683b ldr r3, [r7, #0]
|
|
800882c: 681b ldr r3, [r3, #0]
|
|
800882e: 697a ldr r2, [r7, #20]
|
|
8008830: 429a cmp r2, r3
|
|
8008832: d20b bcs.n 800884c <xTaskCheckForTimeOut+0xa8>
|
|
{
|
|
/* Not a genuine timeout. Adjust parameters for time remaining. */
|
|
*pxTicksToWait -= xElapsedTime;
|
|
8008834: 683b ldr r3, [r7, #0]
|
|
8008836: 681a ldr r2, [r3, #0]
|
|
8008838: 697b ldr r3, [r7, #20]
|
|
800883a: 1ad2 subs r2, r2, r3
|
|
800883c: 683b ldr r3, [r7, #0]
|
|
800883e: 601a str r2, [r3, #0]
|
|
vTaskInternalSetTimeOutState( pxTimeOut );
|
|
8008840: 6878 ldr r0, [r7, #4]
|
|
8008842: f7ff ff99 bl 8008778 <vTaskInternalSetTimeOutState>
|
|
xReturn = pdFALSE;
|
|
8008846: 2300 movs r3, #0
|
|
8008848: 61fb str r3, [r7, #28]
|
|
800884a: e004 b.n 8008856 <xTaskCheckForTimeOut+0xb2>
|
|
}
|
|
else
|
|
{
|
|
*pxTicksToWait = 0;
|
|
800884c: 683b ldr r3, [r7, #0]
|
|
800884e: 2200 movs r2, #0
|
|
8008850: 601a str r2, [r3, #0]
|
|
xReturn = pdTRUE;
|
|
8008852: 2301 movs r3, #1
|
|
8008854: 61fb str r3, [r7, #28]
|
|
}
|
|
}
|
|
taskEXIT_CRITICAL();
|
|
8008856: f001 f851 bl 80098fc <vPortExitCritical>
|
|
|
|
return xReturn;
|
|
800885a: 69fb ldr r3, [r7, #28]
|
|
}
|
|
800885c: 4618 mov r0, r3
|
|
800885e: 3720 adds r7, #32
|
|
8008860: 46bd mov sp, r7
|
|
8008862: bd80 pop {r7, pc}
|
|
8008864: 20000f98 .word 0x20000f98
|
|
8008868: 20000fac .word 0x20000fac
|
|
|
|
0800886c <vTaskMissedYield>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
void vTaskMissedYield( void )
|
|
{
|
|
800886c: b480 push {r7}
|
|
800886e: af00 add r7, sp, #0
|
|
xYieldPending = pdTRUE;
|
|
8008870: 4b03 ldr r3, [pc, #12] @ (8008880 <vTaskMissedYield+0x14>)
|
|
8008872: 2201 movs r2, #1
|
|
8008874: 601a str r2, [r3, #0]
|
|
}
|
|
8008876: bf00 nop
|
|
8008878: 46bd mov sp, r7
|
|
800887a: f85d 7b04 ldr.w r7, [sp], #4
|
|
800887e: 4770 bx lr
|
|
8008880: 20000fa8 .word 0x20000fa8
|
|
|
|
08008884 <prvIdleTask>:
|
|
*
|
|
* void prvIdleTask( void *pvParameters );
|
|
*
|
|
*/
|
|
static portTASK_FUNCTION( prvIdleTask, pvParameters )
|
|
{
|
|
8008884: b580 push {r7, lr}
|
|
8008886: b082 sub sp, #8
|
|
8008888: af00 add r7, sp, #0
|
|
800888a: 6078 str r0, [r7, #4]
|
|
|
|
for( ;; )
|
|
{
|
|
/* See if any tasks have deleted themselves - if so then the idle task
|
|
is responsible for freeing the deleted task's TCB and stack. */
|
|
prvCheckTasksWaitingTermination();
|
|
800888c: f000 f852 bl 8008934 <prvCheckTasksWaitingTermination>
|
|
|
|
A critical region is not required here as we are just reading from
|
|
the list, and an occasional incorrect value will not matter. If
|
|
the ready list at the idle priority contains more than one task
|
|
then a task other than the idle task is ready to execute. */
|
|
if( listCURRENT_LIST_LENGTH( &( pxReadyTasksLists[ tskIDLE_PRIORITY ] ) ) > ( UBaseType_t ) 1 )
|
|
8008890: 4b06 ldr r3, [pc, #24] @ (80088ac <prvIdleTask+0x28>)
|
|
8008892: 681b ldr r3, [r3, #0]
|
|
8008894: 2b01 cmp r3, #1
|
|
8008896: d9f9 bls.n 800888c <prvIdleTask+0x8>
|
|
{
|
|
taskYIELD();
|
|
8008898: 4b05 ldr r3, [pc, #20] @ (80088b0 <prvIdleTask+0x2c>)
|
|
800889a: f04f 5280 mov.w r2, #268435456 @ 0x10000000
|
|
800889e: 601a str r2, [r3, #0]
|
|
80088a0: f3bf 8f4f dsb sy
|
|
80088a4: f3bf 8f6f isb sy
|
|
prvCheckTasksWaitingTermination();
|
|
80088a8: e7f0 b.n 800888c <prvIdleTask+0x8>
|
|
80088aa: bf00 nop
|
|
80088ac: 20000ac4 .word 0x20000ac4
|
|
80088b0: e000ed04 .word 0xe000ed04
|
|
|
|
080088b4 <prvInitialiseTaskLists>:
|
|
|
|
#endif /* portUSING_MPU_WRAPPERS */
|
|
/*-----------------------------------------------------------*/
|
|
|
|
static void prvInitialiseTaskLists( void )
|
|
{
|
|
80088b4: b580 push {r7, lr}
|
|
80088b6: b082 sub sp, #8
|
|
80088b8: af00 add r7, sp, #0
|
|
UBaseType_t uxPriority;
|
|
|
|
for( uxPriority = ( UBaseType_t ) 0U; uxPriority < ( UBaseType_t ) configMAX_PRIORITIES; uxPriority++ )
|
|
80088ba: 2300 movs r3, #0
|
|
80088bc: 607b str r3, [r7, #4]
|
|
80088be: e00c b.n 80088da <prvInitialiseTaskLists+0x26>
|
|
{
|
|
vListInitialise( &( pxReadyTasksLists[ uxPriority ] ) );
|
|
80088c0: 687a ldr r2, [r7, #4]
|
|
80088c2: 4613 mov r3, r2
|
|
80088c4: 009b lsls r3, r3, #2
|
|
80088c6: 4413 add r3, r2
|
|
80088c8: 009b lsls r3, r3, #2
|
|
80088ca: 4a12 ldr r2, [pc, #72] @ (8008914 <prvInitialiseTaskLists+0x60>)
|
|
80088cc: 4413 add r3, r2
|
|
80088ce: 4618 mov r0, r3
|
|
80088d0: f7fe f9b2 bl 8006c38 <vListInitialise>
|
|
for( uxPriority = ( UBaseType_t ) 0U; uxPriority < ( UBaseType_t ) configMAX_PRIORITIES; uxPriority++ )
|
|
80088d4: 687b ldr r3, [r7, #4]
|
|
80088d6: 3301 adds r3, #1
|
|
80088d8: 607b str r3, [r7, #4]
|
|
80088da: 687b ldr r3, [r7, #4]
|
|
80088dc: 2b37 cmp r3, #55 @ 0x37
|
|
80088de: d9ef bls.n 80088c0 <prvInitialiseTaskLists+0xc>
|
|
}
|
|
|
|
vListInitialise( &xDelayedTaskList1 );
|
|
80088e0: 480d ldr r0, [pc, #52] @ (8008918 <prvInitialiseTaskLists+0x64>)
|
|
80088e2: f7fe f9a9 bl 8006c38 <vListInitialise>
|
|
vListInitialise( &xDelayedTaskList2 );
|
|
80088e6: 480d ldr r0, [pc, #52] @ (800891c <prvInitialiseTaskLists+0x68>)
|
|
80088e8: f7fe f9a6 bl 8006c38 <vListInitialise>
|
|
vListInitialise( &xPendingReadyList );
|
|
80088ec: 480c ldr r0, [pc, #48] @ (8008920 <prvInitialiseTaskLists+0x6c>)
|
|
80088ee: f7fe f9a3 bl 8006c38 <vListInitialise>
|
|
|
|
#if ( INCLUDE_vTaskDelete == 1 )
|
|
{
|
|
vListInitialise( &xTasksWaitingTermination );
|
|
80088f2: 480c ldr r0, [pc, #48] @ (8008924 <prvInitialiseTaskLists+0x70>)
|
|
80088f4: f7fe f9a0 bl 8006c38 <vListInitialise>
|
|
}
|
|
#endif /* INCLUDE_vTaskDelete */
|
|
|
|
#if ( INCLUDE_vTaskSuspend == 1 )
|
|
{
|
|
vListInitialise( &xSuspendedTaskList );
|
|
80088f8: 480b ldr r0, [pc, #44] @ (8008928 <prvInitialiseTaskLists+0x74>)
|
|
80088fa: f7fe f99d bl 8006c38 <vListInitialise>
|
|
}
|
|
#endif /* INCLUDE_vTaskSuspend */
|
|
|
|
/* Start with pxDelayedTaskList using list1 and the pxOverflowDelayedTaskList
|
|
using list2. */
|
|
pxDelayedTaskList = &xDelayedTaskList1;
|
|
80088fe: 4b0b ldr r3, [pc, #44] @ (800892c <prvInitialiseTaskLists+0x78>)
|
|
8008900: 4a05 ldr r2, [pc, #20] @ (8008918 <prvInitialiseTaskLists+0x64>)
|
|
8008902: 601a str r2, [r3, #0]
|
|
pxOverflowDelayedTaskList = &xDelayedTaskList2;
|
|
8008904: 4b0a ldr r3, [pc, #40] @ (8008930 <prvInitialiseTaskLists+0x7c>)
|
|
8008906: 4a05 ldr r2, [pc, #20] @ (800891c <prvInitialiseTaskLists+0x68>)
|
|
8008908: 601a str r2, [r3, #0]
|
|
}
|
|
800890a: bf00 nop
|
|
800890c: 3708 adds r7, #8
|
|
800890e: 46bd mov sp, r7
|
|
8008910: bd80 pop {r7, pc}
|
|
8008912: bf00 nop
|
|
8008914: 20000ac4 .word 0x20000ac4
|
|
8008918: 20000f24 .word 0x20000f24
|
|
800891c: 20000f38 .word 0x20000f38
|
|
8008920: 20000f54 .word 0x20000f54
|
|
8008924: 20000f68 .word 0x20000f68
|
|
8008928: 20000f80 .word 0x20000f80
|
|
800892c: 20000f4c .word 0x20000f4c
|
|
8008930: 20000f50 .word 0x20000f50
|
|
|
|
08008934 <prvCheckTasksWaitingTermination>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
static void prvCheckTasksWaitingTermination( void )
|
|
{
|
|
8008934: b580 push {r7, lr}
|
|
8008936: b082 sub sp, #8
|
|
8008938: af00 add r7, sp, #0
|
|
{
|
|
TCB_t *pxTCB;
|
|
|
|
/* uxDeletedTasksWaitingCleanUp is used to prevent taskENTER_CRITICAL()
|
|
being called too often in the idle task. */
|
|
while( uxDeletedTasksWaitingCleanUp > ( UBaseType_t ) 0U )
|
|
800893a: e019 b.n 8008970 <prvCheckTasksWaitingTermination+0x3c>
|
|
{
|
|
taskENTER_CRITICAL();
|
|
800893c: f000 ffac bl 8009898 <vPortEnterCritical>
|
|
{
|
|
pxTCB = listGET_OWNER_OF_HEAD_ENTRY( ( &xTasksWaitingTermination ) ); /*lint !e9079 void * is used as this macro is used with timers and co-routines too. Alignment is known to be fine as the type of the pointer stored and retrieved is the same. */
|
|
8008940: 4b10 ldr r3, [pc, #64] @ (8008984 <prvCheckTasksWaitingTermination+0x50>)
|
|
8008942: 68db ldr r3, [r3, #12]
|
|
8008944: 68db ldr r3, [r3, #12]
|
|
8008946: 607b str r3, [r7, #4]
|
|
( void ) uxListRemove( &( pxTCB->xStateListItem ) );
|
|
8008948: 687b ldr r3, [r7, #4]
|
|
800894a: 3304 adds r3, #4
|
|
800894c: 4618 mov r0, r3
|
|
800894e: f7fe f9fd bl 8006d4c <uxListRemove>
|
|
--uxCurrentNumberOfTasks;
|
|
8008952: 4b0d ldr r3, [pc, #52] @ (8008988 <prvCheckTasksWaitingTermination+0x54>)
|
|
8008954: 681b ldr r3, [r3, #0]
|
|
8008956: 3b01 subs r3, #1
|
|
8008958: 4a0b ldr r2, [pc, #44] @ (8008988 <prvCheckTasksWaitingTermination+0x54>)
|
|
800895a: 6013 str r3, [r2, #0]
|
|
--uxDeletedTasksWaitingCleanUp;
|
|
800895c: 4b0b ldr r3, [pc, #44] @ (800898c <prvCheckTasksWaitingTermination+0x58>)
|
|
800895e: 681b ldr r3, [r3, #0]
|
|
8008960: 3b01 subs r3, #1
|
|
8008962: 4a0a ldr r2, [pc, #40] @ (800898c <prvCheckTasksWaitingTermination+0x58>)
|
|
8008964: 6013 str r3, [r2, #0]
|
|
}
|
|
taskEXIT_CRITICAL();
|
|
8008966: f000 ffc9 bl 80098fc <vPortExitCritical>
|
|
|
|
prvDeleteTCB( pxTCB );
|
|
800896a: 6878 ldr r0, [r7, #4]
|
|
800896c: f000 f810 bl 8008990 <prvDeleteTCB>
|
|
while( uxDeletedTasksWaitingCleanUp > ( UBaseType_t ) 0U )
|
|
8008970: 4b06 ldr r3, [pc, #24] @ (800898c <prvCheckTasksWaitingTermination+0x58>)
|
|
8008972: 681b ldr r3, [r3, #0]
|
|
8008974: 2b00 cmp r3, #0
|
|
8008976: d1e1 bne.n 800893c <prvCheckTasksWaitingTermination+0x8>
|
|
}
|
|
}
|
|
#endif /* INCLUDE_vTaskDelete */
|
|
}
|
|
8008978: bf00 nop
|
|
800897a: bf00 nop
|
|
800897c: 3708 adds r7, #8
|
|
800897e: 46bd mov sp, r7
|
|
8008980: bd80 pop {r7, pc}
|
|
8008982: bf00 nop
|
|
8008984: 20000f68 .word 0x20000f68
|
|
8008988: 20000f94 .word 0x20000f94
|
|
800898c: 20000f7c .word 0x20000f7c
|
|
|
|
08008990 <prvDeleteTCB>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
#if ( INCLUDE_vTaskDelete == 1 )
|
|
|
|
static void prvDeleteTCB( TCB_t *pxTCB )
|
|
{
|
|
8008990: b580 push {r7, lr}
|
|
8008992: b084 sub sp, #16
|
|
8008994: af00 add r7, sp, #0
|
|
8008996: 6078 str r0, [r7, #4]
|
|
to the task to free any memory allocated at the application level.
|
|
See the third party link http://www.nadler.com/embedded/newlibAndFreeRTOS.html
|
|
for additional information. */
|
|
#if ( configUSE_NEWLIB_REENTRANT == 1 )
|
|
{
|
|
_reclaim_reent( &( pxTCB->xNewLib_reent ) );
|
|
8008998: 687b ldr r3, [r7, #4]
|
|
800899a: 3354 adds r3, #84 @ 0x54
|
|
800899c: 4618 mov r0, r3
|
|
800899e: f001 fac3 bl 8009f28 <_reclaim_reent>
|
|
#elif( tskSTATIC_AND_DYNAMIC_ALLOCATION_POSSIBLE != 0 ) /*lint !e731 !e9029 Macro has been consolidated for readability reasons. */
|
|
{
|
|
/* The task could have been allocated statically or dynamically, so
|
|
check what was statically allocated before trying to free the
|
|
memory. */
|
|
if( pxTCB->ucStaticallyAllocated == tskDYNAMICALLY_ALLOCATED_STACK_AND_TCB )
|
|
80089a2: 687b ldr r3, [r7, #4]
|
|
80089a4: f893 30a5 ldrb.w r3, [r3, #165] @ 0xa5
|
|
80089a8: 2b00 cmp r3, #0
|
|
80089aa: d108 bne.n 80089be <prvDeleteTCB+0x2e>
|
|
{
|
|
/* Both the stack and TCB were allocated dynamically, so both
|
|
must be freed. */
|
|
vPortFree( pxTCB->pxStack );
|
|
80089ac: 687b ldr r3, [r7, #4]
|
|
80089ae: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
80089b0: 4618 mov r0, r3
|
|
80089b2: f001 f961 bl 8009c78 <vPortFree>
|
|
vPortFree( pxTCB );
|
|
80089b6: 6878 ldr r0, [r7, #4]
|
|
80089b8: f001 f95e bl 8009c78 <vPortFree>
|
|
configASSERT( pxTCB->ucStaticallyAllocated == tskSTATICALLY_ALLOCATED_STACK_AND_TCB );
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
}
|
|
#endif /* configSUPPORT_DYNAMIC_ALLOCATION */
|
|
}
|
|
80089bc: e019 b.n 80089f2 <prvDeleteTCB+0x62>
|
|
else if( pxTCB->ucStaticallyAllocated == tskSTATICALLY_ALLOCATED_STACK_ONLY )
|
|
80089be: 687b ldr r3, [r7, #4]
|
|
80089c0: f893 30a5 ldrb.w r3, [r3, #165] @ 0xa5
|
|
80089c4: 2b01 cmp r3, #1
|
|
80089c6: d103 bne.n 80089d0 <prvDeleteTCB+0x40>
|
|
vPortFree( pxTCB );
|
|
80089c8: 6878 ldr r0, [r7, #4]
|
|
80089ca: f001 f955 bl 8009c78 <vPortFree>
|
|
}
|
|
80089ce: e010 b.n 80089f2 <prvDeleteTCB+0x62>
|
|
configASSERT( pxTCB->ucStaticallyAllocated == tskSTATICALLY_ALLOCATED_STACK_AND_TCB );
|
|
80089d0: 687b ldr r3, [r7, #4]
|
|
80089d2: f893 30a5 ldrb.w r3, [r3, #165] @ 0xa5
|
|
80089d6: 2b02 cmp r3, #2
|
|
80089d8: d00b beq.n 80089f2 <prvDeleteTCB+0x62>
|
|
__asm volatile
|
|
80089da: f04f 0350 mov.w r3, #80 @ 0x50
|
|
80089de: f383 8811 msr BASEPRI, r3
|
|
80089e2: f3bf 8f6f isb sy
|
|
80089e6: f3bf 8f4f dsb sy
|
|
80089ea: 60fb str r3, [r7, #12]
|
|
}
|
|
80089ec: bf00 nop
|
|
80089ee: bf00 nop
|
|
80089f0: e7fd b.n 80089ee <prvDeleteTCB+0x5e>
|
|
}
|
|
80089f2: bf00 nop
|
|
80089f4: 3710 adds r7, #16
|
|
80089f6: 46bd mov sp, r7
|
|
80089f8: bd80 pop {r7, pc}
|
|
...
|
|
|
|
080089fc <prvResetNextTaskUnblockTime>:
|
|
|
|
#endif /* INCLUDE_vTaskDelete */
|
|
/*-----------------------------------------------------------*/
|
|
|
|
static void prvResetNextTaskUnblockTime( void )
|
|
{
|
|
80089fc: b480 push {r7}
|
|
80089fe: b083 sub sp, #12
|
|
8008a00: af00 add r7, sp, #0
|
|
TCB_t *pxTCB;
|
|
|
|
if( listLIST_IS_EMPTY( pxDelayedTaskList ) != pdFALSE )
|
|
8008a02: 4b0c ldr r3, [pc, #48] @ (8008a34 <prvResetNextTaskUnblockTime+0x38>)
|
|
8008a04: 681b ldr r3, [r3, #0]
|
|
8008a06: 681b ldr r3, [r3, #0]
|
|
8008a08: 2b00 cmp r3, #0
|
|
8008a0a: d104 bne.n 8008a16 <prvResetNextTaskUnblockTime+0x1a>
|
|
{
|
|
/* The new current delayed list is empty. Set xNextTaskUnblockTime to
|
|
the maximum possible value so it is extremely unlikely that the
|
|
if( xTickCount >= xNextTaskUnblockTime ) test will pass until
|
|
there is an item in the delayed list. */
|
|
xNextTaskUnblockTime = portMAX_DELAY;
|
|
8008a0c: 4b0a ldr r3, [pc, #40] @ (8008a38 <prvResetNextTaskUnblockTime+0x3c>)
|
|
8008a0e: f04f 32ff mov.w r2, #4294967295 @ 0xffffffff
|
|
8008a12: 601a str r2, [r3, #0]
|
|
which the task at the head of the delayed list should be removed
|
|
from the Blocked state. */
|
|
( pxTCB ) = listGET_OWNER_OF_HEAD_ENTRY( pxDelayedTaskList ); /*lint !e9079 void * is used as this macro is used with timers and co-routines too. Alignment is known to be fine as the type of the pointer stored and retrieved is the same. */
|
|
xNextTaskUnblockTime = listGET_LIST_ITEM_VALUE( &( ( pxTCB )->xStateListItem ) );
|
|
}
|
|
}
|
|
8008a14: e008 b.n 8008a28 <prvResetNextTaskUnblockTime+0x2c>
|
|
( pxTCB ) = listGET_OWNER_OF_HEAD_ENTRY( pxDelayedTaskList ); /*lint !e9079 void * is used as this macro is used with timers and co-routines too. Alignment is known to be fine as the type of the pointer stored and retrieved is the same. */
|
|
8008a16: 4b07 ldr r3, [pc, #28] @ (8008a34 <prvResetNextTaskUnblockTime+0x38>)
|
|
8008a18: 681b ldr r3, [r3, #0]
|
|
8008a1a: 68db ldr r3, [r3, #12]
|
|
8008a1c: 68db ldr r3, [r3, #12]
|
|
8008a1e: 607b str r3, [r7, #4]
|
|
xNextTaskUnblockTime = listGET_LIST_ITEM_VALUE( &( ( pxTCB )->xStateListItem ) );
|
|
8008a20: 687b ldr r3, [r7, #4]
|
|
8008a22: 685b ldr r3, [r3, #4]
|
|
8008a24: 4a04 ldr r2, [pc, #16] @ (8008a38 <prvResetNextTaskUnblockTime+0x3c>)
|
|
8008a26: 6013 str r3, [r2, #0]
|
|
}
|
|
8008a28: bf00 nop
|
|
8008a2a: 370c adds r7, #12
|
|
8008a2c: 46bd mov sp, r7
|
|
8008a2e: f85d 7b04 ldr.w r7, [sp], #4
|
|
8008a32: 4770 bx lr
|
|
8008a34: 20000f4c .word 0x20000f4c
|
|
8008a38: 20000fb4 .word 0x20000fb4
|
|
|
|
08008a3c <xTaskGetSchedulerState>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
#if ( ( INCLUDE_xTaskGetSchedulerState == 1 ) || ( configUSE_TIMERS == 1 ) )
|
|
|
|
BaseType_t xTaskGetSchedulerState( void )
|
|
{
|
|
8008a3c: b480 push {r7}
|
|
8008a3e: b083 sub sp, #12
|
|
8008a40: af00 add r7, sp, #0
|
|
BaseType_t xReturn;
|
|
|
|
if( xSchedulerRunning == pdFALSE )
|
|
8008a42: 4b0b ldr r3, [pc, #44] @ (8008a70 <xTaskGetSchedulerState+0x34>)
|
|
8008a44: 681b ldr r3, [r3, #0]
|
|
8008a46: 2b00 cmp r3, #0
|
|
8008a48: d102 bne.n 8008a50 <xTaskGetSchedulerState+0x14>
|
|
{
|
|
xReturn = taskSCHEDULER_NOT_STARTED;
|
|
8008a4a: 2301 movs r3, #1
|
|
8008a4c: 607b str r3, [r7, #4]
|
|
8008a4e: e008 b.n 8008a62 <xTaskGetSchedulerState+0x26>
|
|
}
|
|
else
|
|
{
|
|
if( uxSchedulerSuspended == ( UBaseType_t ) pdFALSE )
|
|
8008a50: 4b08 ldr r3, [pc, #32] @ (8008a74 <xTaskGetSchedulerState+0x38>)
|
|
8008a52: 681b ldr r3, [r3, #0]
|
|
8008a54: 2b00 cmp r3, #0
|
|
8008a56: d102 bne.n 8008a5e <xTaskGetSchedulerState+0x22>
|
|
{
|
|
xReturn = taskSCHEDULER_RUNNING;
|
|
8008a58: 2302 movs r3, #2
|
|
8008a5a: 607b str r3, [r7, #4]
|
|
8008a5c: e001 b.n 8008a62 <xTaskGetSchedulerState+0x26>
|
|
}
|
|
else
|
|
{
|
|
xReturn = taskSCHEDULER_SUSPENDED;
|
|
8008a5e: 2300 movs r3, #0
|
|
8008a60: 607b str r3, [r7, #4]
|
|
}
|
|
}
|
|
|
|
return xReturn;
|
|
8008a62: 687b ldr r3, [r7, #4]
|
|
}
|
|
8008a64: 4618 mov r0, r3
|
|
8008a66: 370c adds r7, #12
|
|
8008a68: 46bd mov sp, r7
|
|
8008a6a: f85d 7b04 ldr.w r7, [sp], #4
|
|
8008a6e: 4770 bx lr
|
|
8008a70: 20000fa0 .word 0x20000fa0
|
|
8008a74: 20000fbc .word 0x20000fbc
|
|
|
|
08008a78 <xTaskPriorityInherit>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
#if ( configUSE_MUTEXES == 1 )
|
|
|
|
BaseType_t xTaskPriorityInherit( TaskHandle_t const pxMutexHolder )
|
|
{
|
|
8008a78: b580 push {r7, lr}
|
|
8008a7a: b084 sub sp, #16
|
|
8008a7c: af00 add r7, sp, #0
|
|
8008a7e: 6078 str r0, [r7, #4]
|
|
TCB_t * const pxMutexHolderTCB = pxMutexHolder;
|
|
8008a80: 687b ldr r3, [r7, #4]
|
|
8008a82: 60bb str r3, [r7, #8]
|
|
BaseType_t xReturn = pdFALSE;
|
|
8008a84: 2300 movs r3, #0
|
|
8008a86: 60fb str r3, [r7, #12]
|
|
|
|
/* If the mutex was given back by an interrupt while the queue was
|
|
locked then the mutex holder might now be NULL. _RB_ Is this still
|
|
needed as interrupts can no longer use mutexes? */
|
|
if( pxMutexHolder != NULL )
|
|
8008a88: 687b ldr r3, [r7, #4]
|
|
8008a8a: 2b00 cmp r3, #0
|
|
8008a8c: d051 beq.n 8008b32 <xTaskPriorityInherit+0xba>
|
|
{
|
|
/* If the holder of the mutex has a priority below the priority of
|
|
the task attempting to obtain the mutex then it will temporarily
|
|
inherit the priority of the task attempting to obtain the mutex. */
|
|
if( pxMutexHolderTCB->uxPriority < pxCurrentTCB->uxPriority )
|
|
8008a8e: 68bb ldr r3, [r7, #8]
|
|
8008a90: 6ada ldr r2, [r3, #44] @ 0x2c
|
|
8008a92: 4b2a ldr r3, [pc, #168] @ (8008b3c <xTaskPriorityInherit+0xc4>)
|
|
8008a94: 681b ldr r3, [r3, #0]
|
|
8008a96: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
8008a98: 429a cmp r2, r3
|
|
8008a9a: d241 bcs.n 8008b20 <xTaskPriorityInherit+0xa8>
|
|
{
|
|
/* Adjust the mutex holder state to account for its new
|
|
priority. Only reset the event list item value if the value is
|
|
not being used for anything else. */
|
|
if( ( listGET_LIST_ITEM_VALUE( &( pxMutexHolderTCB->xEventListItem ) ) & taskEVENT_LIST_ITEM_VALUE_IN_USE ) == 0UL )
|
|
8008a9c: 68bb ldr r3, [r7, #8]
|
|
8008a9e: 699b ldr r3, [r3, #24]
|
|
8008aa0: 2b00 cmp r3, #0
|
|
8008aa2: db06 blt.n 8008ab2 <xTaskPriorityInherit+0x3a>
|
|
{
|
|
listSET_LIST_ITEM_VALUE( &( pxMutexHolderTCB->xEventListItem ), ( TickType_t ) configMAX_PRIORITIES - ( TickType_t ) pxCurrentTCB->uxPriority ); /*lint !e961 MISRA exception as the casts are only redundant for some ports. */
|
|
8008aa4: 4b25 ldr r3, [pc, #148] @ (8008b3c <xTaskPriorityInherit+0xc4>)
|
|
8008aa6: 681b ldr r3, [r3, #0]
|
|
8008aa8: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
8008aaa: f1c3 0238 rsb r2, r3, #56 @ 0x38
|
|
8008aae: 68bb ldr r3, [r7, #8]
|
|
8008ab0: 619a str r2, [r3, #24]
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
|
|
/* If the task being modified is in the ready state it will need
|
|
to be moved into a new list. */
|
|
if( listIS_CONTAINED_WITHIN( &( pxReadyTasksLists[ pxMutexHolderTCB->uxPriority ] ), &( pxMutexHolderTCB->xStateListItem ) ) != pdFALSE )
|
|
8008ab2: 68bb ldr r3, [r7, #8]
|
|
8008ab4: 6959 ldr r1, [r3, #20]
|
|
8008ab6: 68bb ldr r3, [r7, #8]
|
|
8008ab8: 6ada ldr r2, [r3, #44] @ 0x2c
|
|
8008aba: 4613 mov r3, r2
|
|
8008abc: 009b lsls r3, r3, #2
|
|
8008abe: 4413 add r3, r2
|
|
8008ac0: 009b lsls r3, r3, #2
|
|
8008ac2: 4a1f ldr r2, [pc, #124] @ (8008b40 <xTaskPriorityInherit+0xc8>)
|
|
8008ac4: 4413 add r3, r2
|
|
8008ac6: 4299 cmp r1, r3
|
|
8008ac8: d122 bne.n 8008b10 <xTaskPriorityInherit+0x98>
|
|
{
|
|
if( uxListRemove( &( pxMutexHolderTCB->xStateListItem ) ) == ( UBaseType_t ) 0 )
|
|
8008aca: 68bb ldr r3, [r7, #8]
|
|
8008acc: 3304 adds r3, #4
|
|
8008ace: 4618 mov r0, r3
|
|
8008ad0: f7fe f93c bl 8006d4c <uxListRemove>
|
|
{
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
|
|
/* Inherit the priority before being moved into the new list. */
|
|
pxMutexHolderTCB->uxPriority = pxCurrentTCB->uxPriority;
|
|
8008ad4: 4b19 ldr r3, [pc, #100] @ (8008b3c <xTaskPriorityInherit+0xc4>)
|
|
8008ad6: 681b ldr r3, [r3, #0]
|
|
8008ad8: 6ada ldr r2, [r3, #44] @ 0x2c
|
|
8008ada: 68bb ldr r3, [r7, #8]
|
|
8008adc: 62da str r2, [r3, #44] @ 0x2c
|
|
prvAddTaskToReadyList( pxMutexHolderTCB );
|
|
8008ade: 68bb ldr r3, [r7, #8]
|
|
8008ae0: 6ada ldr r2, [r3, #44] @ 0x2c
|
|
8008ae2: 4b18 ldr r3, [pc, #96] @ (8008b44 <xTaskPriorityInherit+0xcc>)
|
|
8008ae4: 681b ldr r3, [r3, #0]
|
|
8008ae6: 429a cmp r2, r3
|
|
8008ae8: d903 bls.n 8008af2 <xTaskPriorityInherit+0x7a>
|
|
8008aea: 68bb ldr r3, [r7, #8]
|
|
8008aec: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
8008aee: 4a15 ldr r2, [pc, #84] @ (8008b44 <xTaskPriorityInherit+0xcc>)
|
|
8008af0: 6013 str r3, [r2, #0]
|
|
8008af2: 68bb ldr r3, [r7, #8]
|
|
8008af4: 6ada ldr r2, [r3, #44] @ 0x2c
|
|
8008af6: 4613 mov r3, r2
|
|
8008af8: 009b lsls r3, r3, #2
|
|
8008afa: 4413 add r3, r2
|
|
8008afc: 009b lsls r3, r3, #2
|
|
8008afe: 4a10 ldr r2, [pc, #64] @ (8008b40 <xTaskPriorityInherit+0xc8>)
|
|
8008b00: 441a add r2, r3
|
|
8008b02: 68bb ldr r3, [r7, #8]
|
|
8008b04: 3304 adds r3, #4
|
|
8008b06: 4619 mov r1, r3
|
|
8008b08: 4610 mov r0, r2
|
|
8008b0a: f7fe f8c2 bl 8006c92 <vListInsertEnd>
|
|
8008b0e: e004 b.n 8008b1a <xTaskPriorityInherit+0xa2>
|
|
}
|
|
else
|
|
{
|
|
/* Just inherit the priority. */
|
|
pxMutexHolderTCB->uxPriority = pxCurrentTCB->uxPriority;
|
|
8008b10: 4b0a ldr r3, [pc, #40] @ (8008b3c <xTaskPriorityInherit+0xc4>)
|
|
8008b12: 681b ldr r3, [r3, #0]
|
|
8008b14: 6ada ldr r2, [r3, #44] @ 0x2c
|
|
8008b16: 68bb ldr r3, [r7, #8]
|
|
8008b18: 62da str r2, [r3, #44] @ 0x2c
|
|
}
|
|
|
|
traceTASK_PRIORITY_INHERIT( pxMutexHolderTCB, pxCurrentTCB->uxPriority );
|
|
|
|
/* Inheritance occurred. */
|
|
xReturn = pdTRUE;
|
|
8008b1a: 2301 movs r3, #1
|
|
8008b1c: 60fb str r3, [r7, #12]
|
|
8008b1e: e008 b.n 8008b32 <xTaskPriorityInherit+0xba>
|
|
}
|
|
else
|
|
{
|
|
if( pxMutexHolderTCB->uxBasePriority < pxCurrentTCB->uxPriority )
|
|
8008b20: 68bb ldr r3, [r7, #8]
|
|
8008b22: 6cda ldr r2, [r3, #76] @ 0x4c
|
|
8008b24: 4b05 ldr r3, [pc, #20] @ (8008b3c <xTaskPriorityInherit+0xc4>)
|
|
8008b26: 681b ldr r3, [r3, #0]
|
|
8008b28: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
8008b2a: 429a cmp r2, r3
|
|
8008b2c: d201 bcs.n 8008b32 <xTaskPriorityInherit+0xba>
|
|
current priority of the mutex holder is not lower than the
|
|
priority of the task attempting to take the mutex.
|
|
Therefore the mutex holder must have already inherited a
|
|
priority, but inheritance would have occurred if that had
|
|
not been the case. */
|
|
xReturn = pdTRUE;
|
|
8008b2e: 2301 movs r3, #1
|
|
8008b30: 60fb str r3, [r7, #12]
|
|
else
|
|
{
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
|
|
return xReturn;
|
|
8008b32: 68fb ldr r3, [r7, #12]
|
|
}
|
|
8008b34: 4618 mov r0, r3
|
|
8008b36: 3710 adds r7, #16
|
|
8008b38: 46bd mov sp, r7
|
|
8008b3a: bd80 pop {r7, pc}
|
|
8008b3c: 20000ac0 .word 0x20000ac0
|
|
8008b40: 20000ac4 .word 0x20000ac4
|
|
8008b44: 20000f9c .word 0x20000f9c
|
|
|
|
08008b48 <xTaskPriorityDisinherit>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
#if ( configUSE_MUTEXES == 1 )
|
|
|
|
BaseType_t xTaskPriorityDisinherit( TaskHandle_t const pxMutexHolder )
|
|
{
|
|
8008b48: b580 push {r7, lr}
|
|
8008b4a: b086 sub sp, #24
|
|
8008b4c: af00 add r7, sp, #0
|
|
8008b4e: 6078 str r0, [r7, #4]
|
|
TCB_t * const pxTCB = pxMutexHolder;
|
|
8008b50: 687b ldr r3, [r7, #4]
|
|
8008b52: 613b str r3, [r7, #16]
|
|
BaseType_t xReturn = pdFALSE;
|
|
8008b54: 2300 movs r3, #0
|
|
8008b56: 617b str r3, [r7, #20]
|
|
|
|
if( pxMutexHolder != NULL )
|
|
8008b58: 687b ldr r3, [r7, #4]
|
|
8008b5a: 2b00 cmp r3, #0
|
|
8008b5c: d058 beq.n 8008c10 <xTaskPriorityDisinherit+0xc8>
|
|
{
|
|
/* A task can only have an inherited priority if it holds the mutex.
|
|
If the mutex is held by a task then it cannot be given from an
|
|
interrupt, and if a mutex is given by the holding task then it must
|
|
be the running state task. */
|
|
configASSERT( pxTCB == pxCurrentTCB );
|
|
8008b5e: 4b2f ldr r3, [pc, #188] @ (8008c1c <xTaskPriorityDisinherit+0xd4>)
|
|
8008b60: 681b ldr r3, [r3, #0]
|
|
8008b62: 693a ldr r2, [r7, #16]
|
|
8008b64: 429a cmp r2, r3
|
|
8008b66: d00b beq.n 8008b80 <xTaskPriorityDisinherit+0x38>
|
|
__asm volatile
|
|
8008b68: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8008b6c: f383 8811 msr BASEPRI, r3
|
|
8008b70: f3bf 8f6f isb sy
|
|
8008b74: f3bf 8f4f dsb sy
|
|
8008b78: 60fb str r3, [r7, #12]
|
|
}
|
|
8008b7a: bf00 nop
|
|
8008b7c: bf00 nop
|
|
8008b7e: e7fd b.n 8008b7c <xTaskPriorityDisinherit+0x34>
|
|
configASSERT( pxTCB->uxMutexesHeld );
|
|
8008b80: 693b ldr r3, [r7, #16]
|
|
8008b82: 6d1b ldr r3, [r3, #80] @ 0x50
|
|
8008b84: 2b00 cmp r3, #0
|
|
8008b86: d10b bne.n 8008ba0 <xTaskPriorityDisinherit+0x58>
|
|
__asm volatile
|
|
8008b88: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8008b8c: f383 8811 msr BASEPRI, r3
|
|
8008b90: f3bf 8f6f isb sy
|
|
8008b94: f3bf 8f4f dsb sy
|
|
8008b98: 60bb str r3, [r7, #8]
|
|
}
|
|
8008b9a: bf00 nop
|
|
8008b9c: bf00 nop
|
|
8008b9e: e7fd b.n 8008b9c <xTaskPriorityDisinherit+0x54>
|
|
( pxTCB->uxMutexesHeld )--;
|
|
8008ba0: 693b ldr r3, [r7, #16]
|
|
8008ba2: 6d1b ldr r3, [r3, #80] @ 0x50
|
|
8008ba4: 1e5a subs r2, r3, #1
|
|
8008ba6: 693b ldr r3, [r7, #16]
|
|
8008ba8: 651a str r2, [r3, #80] @ 0x50
|
|
|
|
/* Has the holder of the mutex inherited the priority of another
|
|
task? */
|
|
if( pxTCB->uxPriority != pxTCB->uxBasePriority )
|
|
8008baa: 693b ldr r3, [r7, #16]
|
|
8008bac: 6ada ldr r2, [r3, #44] @ 0x2c
|
|
8008bae: 693b ldr r3, [r7, #16]
|
|
8008bb0: 6cdb ldr r3, [r3, #76] @ 0x4c
|
|
8008bb2: 429a cmp r2, r3
|
|
8008bb4: d02c beq.n 8008c10 <xTaskPriorityDisinherit+0xc8>
|
|
{
|
|
/* Only disinherit if no other mutexes are held. */
|
|
if( pxTCB->uxMutexesHeld == ( UBaseType_t ) 0 )
|
|
8008bb6: 693b ldr r3, [r7, #16]
|
|
8008bb8: 6d1b ldr r3, [r3, #80] @ 0x50
|
|
8008bba: 2b00 cmp r3, #0
|
|
8008bbc: d128 bne.n 8008c10 <xTaskPriorityDisinherit+0xc8>
|
|
/* A task can only have an inherited priority if it holds
|
|
the mutex. If the mutex is held by a task then it cannot be
|
|
given from an interrupt, and if a mutex is given by the
|
|
holding task then it must be the running state task. Remove
|
|
the holding task from the ready/delayed list. */
|
|
if( uxListRemove( &( pxTCB->xStateListItem ) ) == ( UBaseType_t ) 0 )
|
|
8008bbe: 693b ldr r3, [r7, #16]
|
|
8008bc0: 3304 adds r3, #4
|
|
8008bc2: 4618 mov r0, r3
|
|
8008bc4: f7fe f8c2 bl 8006d4c <uxListRemove>
|
|
}
|
|
|
|
/* Disinherit the priority before adding the task into the
|
|
new ready list. */
|
|
traceTASK_PRIORITY_DISINHERIT( pxTCB, pxTCB->uxBasePriority );
|
|
pxTCB->uxPriority = pxTCB->uxBasePriority;
|
|
8008bc8: 693b ldr r3, [r7, #16]
|
|
8008bca: 6cda ldr r2, [r3, #76] @ 0x4c
|
|
8008bcc: 693b ldr r3, [r7, #16]
|
|
8008bce: 62da str r2, [r3, #44] @ 0x2c
|
|
|
|
/* Reset the event list item value. It cannot be in use for
|
|
any other purpose if this task is running, and it must be
|
|
running to give back the mutex. */
|
|
listSET_LIST_ITEM_VALUE( &( pxTCB->xEventListItem ), ( TickType_t ) configMAX_PRIORITIES - ( TickType_t ) pxTCB->uxPriority ); /*lint !e961 MISRA exception as the casts are only redundant for some ports. */
|
|
8008bd0: 693b ldr r3, [r7, #16]
|
|
8008bd2: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
8008bd4: f1c3 0238 rsb r2, r3, #56 @ 0x38
|
|
8008bd8: 693b ldr r3, [r7, #16]
|
|
8008bda: 619a str r2, [r3, #24]
|
|
prvAddTaskToReadyList( pxTCB );
|
|
8008bdc: 693b ldr r3, [r7, #16]
|
|
8008bde: 6ada ldr r2, [r3, #44] @ 0x2c
|
|
8008be0: 4b0f ldr r3, [pc, #60] @ (8008c20 <xTaskPriorityDisinherit+0xd8>)
|
|
8008be2: 681b ldr r3, [r3, #0]
|
|
8008be4: 429a cmp r2, r3
|
|
8008be6: d903 bls.n 8008bf0 <xTaskPriorityDisinherit+0xa8>
|
|
8008be8: 693b ldr r3, [r7, #16]
|
|
8008bea: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
8008bec: 4a0c ldr r2, [pc, #48] @ (8008c20 <xTaskPriorityDisinherit+0xd8>)
|
|
8008bee: 6013 str r3, [r2, #0]
|
|
8008bf0: 693b ldr r3, [r7, #16]
|
|
8008bf2: 6ada ldr r2, [r3, #44] @ 0x2c
|
|
8008bf4: 4613 mov r3, r2
|
|
8008bf6: 009b lsls r3, r3, #2
|
|
8008bf8: 4413 add r3, r2
|
|
8008bfa: 009b lsls r3, r3, #2
|
|
8008bfc: 4a09 ldr r2, [pc, #36] @ (8008c24 <xTaskPriorityDisinherit+0xdc>)
|
|
8008bfe: 441a add r2, r3
|
|
8008c00: 693b ldr r3, [r7, #16]
|
|
8008c02: 3304 adds r3, #4
|
|
8008c04: 4619 mov r1, r3
|
|
8008c06: 4610 mov r0, r2
|
|
8008c08: f7fe f843 bl 8006c92 <vListInsertEnd>
|
|
in an order different to that in which they were taken.
|
|
If a context switch did not occur when the first mutex was
|
|
returned, even if a task was waiting on it, then a context
|
|
switch should occur when the last mutex is returned whether
|
|
a task is waiting on it or not. */
|
|
xReturn = pdTRUE;
|
|
8008c0c: 2301 movs r3, #1
|
|
8008c0e: 617b str r3, [r7, #20]
|
|
else
|
|
{
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
|
|
return xReturn;
|
|
8008c10: 697b ldr r3, [r7, #20]
|
|
}
|
|
8008c12: 4618 mov r0, r3
|
|
8008c14: 3718 adds r7, #24
|
|
8008c16: 46bd mov sp, r7
|
|
8008c18: bd80 pop {r7, pc}
|
|
8008c1a: bf00 nop
|
|
8008c1c: 20000ac0 .word 0x20000ac0
|
|
8008c20: 20000f9c .word 0x20000f9c
|
|
8008c24: 20000ac4 .word 0x20000ac4
|
|
|
|
08008c28 <vTaskPriorityDisinheritAfterTimeout>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
#if ( configUSE_MUTEXES == 1 )
|
|
|
|
void vTaskPriorityDisinheritAfterTimeout( TaskHandle_t const pxMutexHolder, UBaseType_t uxHighestPriorityWaitingTask )
|
|
{
|
|
8008c28: b580 push {r7, lr}
|
|
8008c2a: b088 sub sp, #32
|
|
8008c2c: af00 add r7, sp, #0
|
|
8008c2e: 6078 str r0, [r7, #4]
|
|
8008c30: 6039 str r1, [r7, #0]
|
|
TCB_t * const pxTCB = pxMutexHolder;
|
|
8008c32: 687b ldr r3, [r7, #4]
|
|
8008c34: 61bb str r3, [r7, #24]
|
|
UBaseType_t uxPriorityUsedOnEntry, uxPriorityToUse;
|
|
const UBaseType_t uxOnlyOneMutexHeld = ( UBaseType_t ) 1;
|
|
8008c36: 2301 movs r3, #1
|
|
8008c38: 617b str r3, [r7, #20]
|
|
|
|
if( pxMutexHolder != NULL )
|
|
8008c3a: 687b ldr r3, [r7, #4]
|
|
8008c3c: 2b00 cmp r3, #0
|
|
8008c3e: d06c beq.n 8008d1a <vTaskPriorityDisinheritAfterTimeout+0xf2>
|
|
{
|
|
/* If pxMutexHolder is not NULL then the holder must hold at least
|
|
one mutex. */
|
|
configASSERT( pxTCB->uxMutexesHeld );
|
|
8008c40: 69bb ldr r3, [r7, #24]
|
|
8008c42: 6d1b ldr r3, [r3, #80] @ 0x50
|
|
8008c44: 2b00 cmp r3, #0
|
|
8008c46: d10b bne.n 8008c60 <vTaskPriorityDisinheritAfterTimeout+0x38>
|
|
__asm volatile
|
|
8008c48: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8008c4c: f383 8811 msr BASEPRI, r3
|
|
8008c50: f3bf 8f6f isb sy
|
|
8008c54: f3bf 8f4f dsb sy
|
|
8008c58: 60fb str r3, [r7, #12]
|
|
}
|
|
8008c5a: bf00 nop
|
|
8008c5c: bf00 nop
|
|
8008c5e: e7fd b.n 8008c5c <vTaskPriorityDisinheritAfterTimeout+0x34>
|
|
|
|
/* Determine the priority to which the priority of the task that
|
|
holds the mutex should be set. This will be the greater of the
|
|
holding task's base priority and the priority of the highest
|
|
priority task that is waiting to obtain the mutex. */
|
|
if( pxTCB->uxBasePriority < uxHighestPriorityWaitingTask )
|
|
8008c60: 69bb ldr r3, [r7, #24]
|
|
8008c62: 6cdb ldr r3, [r3, #76] @ 0x4c
|
|
8008c64: 683a ldr r2, [r7, #0]
|
|
8008c66: 429a cmp r2, r3
|
|
8008c68: d902 bls.n 8008c70 <vTaskPriorityDisinheritAfterTimeout+0x48>
|
|
{
|
|
uxPriorityToUse = uxHighestPriorityWaitingTask;
|
|
8008c6a: 683b ldr r3, [r7, #0]
|
|
8008c6c: 61fb str r3, [r7, #28]
|
|
8008c6e: e002 b.n 8008c76 <vTaskPriorityDisinheritAfterTimeout+0x4e>
|
|
}
|
|
else
|
|
{
|
|
uxPriorityToUse = pxTCB->uxBasePriority;
|
|
8008c70: 69bb ldr r3, [r7, #24]
|
|
8008c72: 6cdb ldr r3, [r3, #76] @ 0x4c
|
|
8008c74: 61fb str r3, [r7, #28]
|
|
}
|
|
|
|
/* Does the priority need to change? */
|
|
if( pxTCB->uxPriority != uxPriorityToUse )
|
|
8008c76: 69bb ldr r3, [r7, #24]
|
|
8008c78: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
8008c7a: 69fa ldr r2, [r7, #28]
|
|
8008c7c: 429a cmp r2, r3
|
|
8008c7e: d04c beq.n 8008d1a <vTaskPriorityDisinheritAfterTimeout+0xf2>
|
|
{
|
|
/* Only disinherit if no other mutexes are held. This is a
|
|
simplification in the priority inheritance implementation. If
|
|
the task that holds the mutex is also holding other mutexes then
|
|
the other mutexes may have caused the priority inheritance. */
|
|
if( pxTCB->uxMutexesHeld == uxOnlyOneMutexHeld )
|
|
8008c80: 69bb ldr r3, [r7, #24]
|
|
8008c82: 6d1b ldr r3, [r3, #80] @ 0x50
|
|
8008c84: 697a ldr r2, [r7, #20]
|
|
8008c86: 429a cmp r2, r3
|
|
8008c88: d147 bne.n 8008d1a <vTaskPriorityDisinheritAfterTimeout+0xf2>
|
|
{
|
|
/* If a task has timed out because it already holds the
|
|
mutex it was trying to obtain then it cannot of inherited
|
|
its own priority. */
|
|
configASSERT( pxTCB != pxCurrentTCB );
|
|
8008c8a: 4b26 ldr r3, [pc, #152] @ (8008d24 <vTaskPriorityDisinheritAfterTimeout+0xfc>)
|
|
8008c8c: 681b ldr r3, [r3, #0]
|
|
8008c8e: 69ba ldr r2, [r7, #24]
|
|
8008c90: 429a cmp r2, r3
|
|
8008c92: d10b bne.n 8008cac <vTaskPriorityDisinheritAfterTimeout+0x84>
|
|
__asm volatile
|
|
8008c94: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8008c98: f383 8811 msr BASEPRI, r3
|
|
8008c9c: f3bf 8f6f isb sy
|
|
8008ca0: f3bf 8f4f dsb sy
|
|
8008ca4: 60bb str r3, [r7, #8]
|
|
}
|
|
8008ca6: bf00 nop
|
|
8008ca8: bf00 nop
|
|
8008caa: e7fd b.n 8008ca8 <vTaskPriorityDisinheritAfterTimeout+0x80>
|
|
|
|
/* Disinherit the priority, remembering the previous
|
|
priority to facilitate determining the subject task's
|
|
state. */
|
|
traceTASK_PRIORITY_DISINHERIT( pxTCB, pxTCB->uxBasePriority );
|
|
uxPriorityUsedOnEntry = pxTCB->uxPriority;
|
|
8008cac: 69bb ldr r3, [r7, #24]
|
|
8008cae: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
8008cb0: 613b str r3, [r7, #16]
|
|
pxTCB->uxPriority = uxPriorityToUse;
|
|
8008cb2: 69bb ldr r3, [r7, #24]
|
|
8008cb4: 69fa ldr r2, [r7, #28]
|
|
8008cb6: 62da str r2, [r3, #44] @ 0x2c
|
|
|
|
/* Only reset the event list item value if the value is not
|
|
being used for anything else. */
|
|
if( ( listGET_LIST_ITEM_VALUE( &( pxTCB->xEventListItem ) ) & taskEVENT_LIST_ITEM_VALUE_IN_USE ) == 0UL )
|
|
8008cb8: 69bb ldr r3, [r7, #24]
|
|
8008cba: 699b ldr r3, [r3, #24]
|
|
8008cbc: 2b00 cmp r3, #0
|
|
8008cbe: db04 blt.n 8008cca <vTaskPriorityDisinheritAfterTimeout+0xa2>
|
|
{
|
|
listSET_LIST_ITEM_VALUE( &( pxTCB->xEventListItem ), ( TickType_t ) configMAX_PRIORITIES - ( TickType_t ) uxPriorityToUse ); /*lint !e961 MISRA exception as the casts are only redundant for some ports. */
|
|
8008cc0: 69fb ldr r3, [r7, #28]
|
|
8008cc2: f1c3 0238 rsb r2, r3, #56 @ 0x38
|
|
8008cc6: 69bb ldr r3, [r7, #24]
|
|
8008cc8: 619a str r2, [r3, #24]
|
|
then the task that holds the mutex could be in either the
|
|
Ready, Blocked or Suspended states. Only remove the task
|
|
from its current state list if it is in the Ready state as
|
|
the task's priority is going to change and there is one
|
|
Ready list per priority. */
|
|
if( listIS_CONTAINED_WITHIN( &( pxReadyTasksLists[ uxPriorityUsedOnEntry ] ), &( pxTCB->xStateListItem ) ) != pdFALSE )
|
|
8008cca: 69bb ldr r3, [r7, #24]
|
|
8008ccc: 6959 ldr r1, [r3, #20]
|
|
8008cce: 693a ldr r2, [r7, #16]
|
|
8008cd0: 4613 mov r3, r2
|
|
8008cd2: 009b lsls r3, r3, #2
|
|
8008cd4: 4413 add r3, r2
|
|
8008cd6: 009b lsls r3, r3, #2
|
|
8008cd8: 4a13 ldr r2, [pc, #76] @ (8008d28 <vTaskPriorityDisinheritAfterTimeout+0x100>)
|
|
8008cda: 4413 add r3, r2
|
|
8008cdc: 4299 cmp r1, r3
|
|
8008cde: d11c bne.n 8008d1a <vTaskPriorityDisinheritAfterTimeout+0xf2>
|
|
{
|
|
if( uxListRemove( &( pxTCB->xStateListItem ) ) == ( UBaseType_t ) 0 )
|
|
8008ce0: 69bb ldr r3, [r7, #24]
|
|
8008ce2: 3304 adds r3, #4
|
|
8008ce4: 4618 mov r0, r3
|
|
8008ce6: f7fe f831 bl 8006d4c <uxListRemove>
|
|
else
|
|
{
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
|
|
prvAddTaskToReadyList( pxTCB );
|
|
8008cea: 69bb ldr r3, [r7, #24]
|
|
8008cec: 6ada ldr r2, [r3, #44] @ 0x2c
|
|
8008cee: 4b0f ldr r3, [pc, #60] @ (8008d2c <vTaskPriorityDisinheritAfterTimeout+0x104>)
|
|
8008cf0: 681b ldr r3, [r3, #0]
|
|
8008cf2: 429a cmp r2, r3
|
|
8008cf4: d903 bls.n 8008cfe <vTaskPriorityDisinheritAfterTimeout+0xd6>
|
|
8008cf6: 69bb ldr r3, [r7, #24]
|
|
8008cf8: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
8008cfa: 4a0c ldr r2, [pc, #48] @ (8008d2c <vTaskPriorityDisinheritAfterTimeout+0x104>)
|
|
8008cfc: 6013 str r3, [r2, #0]
|
|
8008cfe: 69bb ldr r3, [r7, #24]
|
|
8008d00: 6ada ldr r2, [r3, #44] @ 0x2c
|
|
8008d02: 4613 mov r3, r2
|
|
8008d04: 009b lsls r3, r3, #2
|
|
8008d06: 4413 add r3, r2
|
|
8008d08: 009b lsls r3, r3, #2
|
|
8008d0a: 4a07 ldr r2, [pc, #28] @ (8008d28 <vTaskPriorityDisinheritAfterTimeout+0x100>)
|
|
8008d0c: 441a add r2, r3
|
|
8008d0e: 69bb ldr r3, [r7, #24]
|
|
8008d10: 3304 adds r3, #4
|
|
8008d12: 4619 mov r1, r3
|
|
8008d14: 4610 mov r0, r2
|
|
8008d16: f7fd ffbc bl 8006c92 <vListInsertEnd>
|
|
}
|
|
else
|
|
{
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
}
|
|
8008d1a: bf00 nop
|
|
8008d1c: 3720 adds r7, #32
|
|
8008d1e: 46bd mov sp, r7
|
|
8008d20: bd80 pop {r7, pc}
|
|
8008d22: bf00 nop
|
|
8008d24: 20000ac0 .word 0x20000ac0
|
|
8008d28: 20000ac4 .word 0x20000ac4
|
|
8008d2c: 20000f9c .word 0x20000f9c
|
|
|
|
08008d30 <pvTaskIncrementMutexHeldCount>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
#if ( configUSE_MUTEXES == 1 )
|
|
|
|
TaskHandle_t pvTaskIncrementMutexHeldCount( void )
|
|
{
|
|
8008d30: b480 push {r7}
|
|
8008d32: af00 add r7, sp, #0
|
|
/* If xSemaphoreCreateMutex() is called before any tasks have been created
|
|
then pxCurrentTCB will be NULL. */
|
|
if( pxCurrentTCB != NULL )
|
|
8008d34: 4b07 ldr r3, [pc, #28] @ (8008d54 <pvTaskIncrementMutexHeldCount+0x24>)
|
|
8008d36: 681b ldr r3, [r3, #0]
|
|
8008d38: 2b00 cmp r3, #0
|
|
8008d3a: d004 beq.n 8008d46 <pvTaskIncrementMutexHeldCount+0x16>
|
|
{
|
|
( pxCurrentTCB->uxMutexesHeld )++;
|
|
8008d3c: 4b05 ldr r3, [pc, #20] @ (8008d54 <pvTaskIncrementMutexHeldCount+0x24>)
|
|
8008d3e: 681b ldr r3, [r3, #0]
|
|
8008d40: 6d1a ldr r2, [r3, #80] @ 0x50
|
|
8008d42: 3201 adds r2, #1
|
|
8008d44: 651a str r2, [r3, #80] @ 0x50
|
|
}
|
|
|
|
return pxCurrentTCB;
|
|
8008d46: 4b03 ldr r3, [pc, #12] @ (8008d54 <pvTaskIncrementMutexHeldCount+0x24>)
|
|
8008d48: 681b ldr r3, [r3, #0]
|
|
}
|
|
8008d4a: 4618 mov r0, r3
|
|
8008d4c: 46bd mov sp, r7
|
|
8008d4e: f85d 7b04 ldr.w r7, [sp], #4
|
|
8008d52: 4770 bx lr
|
|
8008d54: 20000ac0 .word 0x20000ac0
|
|
|
|
08008d58 <prvAddCurrentTaskToDelayedList>:
|
|
|
|
#endif
|
|
/*-----------------------------------------------------------*/
|
|
|
|
static void prvAddCurrentTaskToDelayedList( TickType_t xTicksToWait, const BaseType_t xCanBlockIndefinitely )
|
|
{
|
|
8008d58: b580 push {r7, lr}
|
|
8008d5a: b084 sub sp, #16
|
|
8008d5c: af00 add r7, sp, #0
|
|
8008d5e: 6078 str r0, [r7, #4]
|
|
8008d60: 6039 str r1, [r7, #0]
|
|
TickType_t xTimeToWake;
|
|
const TickType_t xConstTickCount = xTickCount;
|
|
8008d62: 4b21 ldr r3, [pc, #132] @ (8008de8 <prvAddCurrentTaskToDelayedList+0x90>)
|
|
8008d64: 681b ldr r3, [r3, #0]
|
|
8008d66: 60fb str r3, [r7, #12]
|
|
}
|
|
#endif
|
|
|
|
/* Remove the task from the ready list before adding it to the blocked list
|
|
as the same list item is used for both lists. */
|
|
if( uxListRemove( &( pxCurrentTCB->xStateListItem ) ) == ( UBaseType_t ) 0 )
|
|
8008d68: 4b20 ldr r3, [pc, #128] @ (8008dec <prvAddCurrentTaskToDelayedList+0x94>)
|
|
8008d6a: 681b ldr r3, [r3, #0]
|
|
8008d6c: 3304 adds r3, #4
|
|
8008d6e: 4618 mov r0, r3
|
|
8008d70: f7fd ffec bl 8006d4c <uxListRemove>
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
|
|
#if ( INCLUDE_vTaskSuspend == 1 )
|
|
{
|
|
if( ( xTicksToWait == portMAX_DELAY ) && ( xCanBlockIndefinitely != pdFALSE ) )
|
|
8008d74: 687b ldr r3, [r7, #4]
|
|
8008d76: f1b3 3fff cmp.w r3, #4294967295 @ 0xffffffff
|
|
8008d7a: d10a bne.n 8008d92 <prvAddCurrentTaskToDelayedList+0x3a>
|
|
8008d7c: 683b ldr r3, [r7, #0]
|
|
8008d7e: 2b00 cmp r3, #0
|
|
8008d80: d007 beq.n 8008d92 <prvAddCurrentTaskToDelayedList+0x3a>
|
|
{
|
|
/* Add the task to the suspended task list instead of a delayed task
|
|
list to ensure it is not woken by a timing event. It will block
|
|
indefinitely. */
|
|
vListInsertEnd( &xSuspendedTaskList, &( pxCurrentTCB->xStateListItem ) );
|
|
8008d82: 4b1a ldr r3, [pc, #104] @ (8008dec <prvAddCurrentTaskToDelayedList+0x94>)
|
|
8008d84: 681b ldr r3, [r3, #0]
|
|
8008d86: 3304 adds r3, #4
|
|
8008d88: 4619 mov r1, r3
|
|
8008d8a: 4819 ldr r0, [pc, #100] @ (8008df0 <prvAddCurrentTaskToDelayedList+0x98>)
|
|
8008d8c: f7fd ff81 bl 8006c92 <vListInsertEnd>
|
|
|
|
/* Avoid compiler warning when INCLUDE_vTaskSuspend is not 1. */
|
|
( void ) xCanBlockIndefinitely;
|
|
}
|
|
#endif /* INCLUDE_vTaskSuspend */
|
|
}
|
|
8008d90: e026 b.n 8008de0 <prvAddCurrentTaskToDelayedList+0x88>
|
|
xTimeToWake = xConstTickCount + xTicksToWait;
|
|
8008d92: 68fa ldr r2, [r7, #12]
|
|
8008d94: 687b ldr r3, [r7, #4]
|
|
8008d96: 4413 add r3, r2
|
|
8008d98: 60bb str r3, [r7, #8]
|
|
listSET_LIST_ITEM_VALUE( &( pxCurrentTCB->xStateListItem ), xTimeToWake );
|
|
8008d9a: 4b14 ldr r3, [pc, #80] @ (8008dec <prvAddCurrentTaskToDelayedList+0x94>)
|
|
8008d9c: 681b ldr r3, [r3, #0]
|
|
8008d9e: 68ba ldr r2, [r7, #8]
|
|
8008da0: 605a str r2, [r3, #4]
|
|
if( xTimeToWake < xConstTickCount )
|
|
8008da2: 68ba ldr r2, [r7, #8]
|
|
8008da4: 68fb ldr r3, [r7, #12]
|
|
8008da6: 429a cmp r2, r3
|
|
8008da8: d209 bcs.n 8008dbe <prvAddCurrentTaskToDelayedList+0x66>
|
|
vListInsert( pxOverflowDelayedTaskList, &( pxCurrentTCB->xStateListItem ) );
|
|
8008daa: 4b12 ldr r3, [pc, #72] @ (8008df4 <prvAddCurrentTaskToDelayedList+0x9c>)
|
|
8008dac: 681a ldr r2, [r3, #0]
|
|
8008dae: 4b0f ldr r3, [pc, #60] @ (8008dec <prvAddCurrentTaskToDelayedList+0x94>)
|
|
8008db0: 681b ldr r3, [r3, #0]
|
|
8008db2: 3304 adds r3, #4
|
|
8008db4: 4619 mov r1, r3
|
|
8008db6: 4610 mov r0, r2
|
|
8008db8: f7fd ff8f bl 8006cda <vListInsert>
|
|
}
|
|
8008dbc: e010 b.n 8008de0 <prvAddCurrentTaskToDelayedList+0x88>
|
|
vListInsert( pxDelayedTaskList, &( pxCurrentTCB->xStateListItem ) );
|
|
8008dbe: 4b0e ldr r3, [pc, #56] @ (8008df8 <prvAddCurrentTaskToDelayedList+0xa0>)
|
|
8008dc0: 681a ldr r2, [r3, #0]
|
|
8008dc2: 4b0a ldr r3, [pc, #40] @ (8008dec <prvAddCurrentTaskToDelayedList+0x94>)
|
|
8008dc4: 681b ldr r3, [r3, #0]
|
|
8008dc6: 3304 adds r3, #4
|
|
8008dc8: 4619 mov r1, r3
|
|
8008dca: 4610 mov r0, r2
|
|
8008dcc: f7fd ff85 bl 8006cda <vListInsert>
|
|
if( xTimeToWake < xNextTaskUnblockTime )
|
|
8008dd0: 4b0a ldr r3, [pc, #40] @ (8008dfc <prvAddCurrentTaskToDelayedList+0xa4>)
|
|
8008dd2: 681b ldr r3, [r3, #0]
|
|
8008dd4: 68ba ldr r2, [r7, #8]
|
|
8008dd6: 429a cmp r2, r3
|
|
8008dd8: d202 bcs.n 8008de0 <prvAddCurrentTaskToDelayedList+0x88>
|
|
xNextTaskUnblockTime = xTimeToWake;
|
|
8008dda: 4a08 ldr r2, [pc, #32] @ (8008dfc <prvAddCurrentTaskToDelayedList+0xa4>)
|
|
8008ddc: 68bb ldr r3, [r7, #8]
|
|
8008dde: 6013 str r3, [r2, #0]
|
|
}
|
|
8008de0: bf00 nop
|
|
8008de2: 3710 adds r7, #16
|
|
8008de4: 46bd mov sp, r7
|
|
8008de6: bd80 pop {r7, pc}
|
|
8008de8: 20000f98 .word 0x20000f98
|
|
8008dec: 20000ac0 .word 0x20000ac0
|
|
8008df0: 20000f80 .word 0x20000f80
|
|
8008df4: 20000f50 .word 0x20000f50
|
|
8008df8: 20000f4c .word 0x20000f4c
|
|
8008dfc: 20000fb4 .word 0x20000fb4
|
|
|
|
08008e00 <xTimerCreateTimerTask>:
|
|
TimerCallbackFunction_t pxCallbackFunction,
|
|
Timer_t *pxNewTimer ) PRIVILEGED_FUNCTION;
|
|
/*-----------------------------------------------------------*/
|
|
|
|
BaseType_t xTimerCreateTimerTask( void )
|
|
{
|
|
8008e00: b580 push {r7, lr}
|
|
8008e02: b08a sub sp, #40 @ 0x28
|
|
8008e04: af04 add r7, sp, #16
|
|
BaseType_t xReturn = pdFAIL;
|
|
8008e06: 2300 movs r3, #0
|
|
8008e08: 617b str r3, [r7, #20]
|
|
|
|
/* This function is called when the scheduler is started if
|
|
configUSE_TIMERS is set to 1. Check that the infrastructure used by the
|
|
timer service task has been created/initialised. If timers have already
|
|
been created then the initialisation will already have been performed. */
|
|
prvCheckForValidListAndQueue();
|
|
8008e0a: f000 fbb1 bl 8009570 <prvCheckForValidListAndQueue>
|
|
|
|
if( xTimerQueue != NULL )
|
|
8008e0e: 4b1d ldr r3, [pc, #116] @ (8008e84 <xTimerCreateTimerTask+0x84>)
|
|
8008e10: 681b ldr r3, [r3, #0]
|
|
8008e12: 2b00 cmp r3, #0
|
|
8008e14: d021 beq.n 8008e5a <xTimerCreateTimerTask+0x5a>
|
|
{
|
|
#if( configSUPPORT_STATIC_ALLOCATION == 1 )
|
|
{
|
|
StaticTask_t *pxTimerTaskTCBBuffer = NULL;
|
|
8008e16: 2300 movs r3, #0
|
|
8008e18: 60fb str r3, [r7, #12]
|
|
StackType_t *pxTimerTaskStackBuffer = NULL;
|
|
8008e1a: 2300 movs r3, #0
|
|
8008e1c: 60bb str r3, [r7, #8]
|
|
uint32_t ulTimerTaskStackSize;
|
|
|
|
vApplicationGetTimerTaskMemory( &pxTimerTaskTCBBuffer, &pxTimerTaskStackBuffer, &ulTimerTaskStackSize );
|
|
8008e1e: 1d3a adds r2, r7, #4
|
|
8008e20: f107 0108 add.w r1, r7, #8
|
|
8008e24: f107 030c add.w r3, r7, #12
|
|
8008e28: 4618 mov r0, r3
|
|
8008e2a: f7fd feeb bl 8006c04 <vApplicationGetTimerTaskMemory>
|
|
xTimerTaskHandle = xTaskCreateStatic( prvTimerTask,
|
|
8008e2e: 6879 ldr r1, [r7, #4]
|
|
8008e30: 68bb ldr r3, [r7, #8]
|
|
8008e32: 68fa ldr r2, [r7, #12]
|
|
8008e34: 9202 str r2, [sp, #8]
|
|
8008e36: 9301 str r3, [sp, #4]
|
|
8008e38: 2302 movs r3, #2
|
|
8008e3a: 9300 str r3, [sp, #0]
|
|
8008e3c: 2300 movs r3, #0
|
|
8008e3e: 460a mov r2, r1
|
|
8008e40: 4911 ldr r1, [pc, #68] @ (8008e88 <xTimerCreateTimerTask+0x88>)
|
|
8008e42: 4812 ldr r0, [pc, #72] @ (8008e8c <xTimerCreateTimerTask+0x8c>)
|
|
8008e44: f7fe ffd8 bl 8007df8 <xTaskCreateStatic>
|
|
8008e48: 4603 mov r3, r0
|
|
8008e4a: 4a11 ldr r2, [pc, #68] @ (8008e90 <xTimerCreateTimerTask+0x90>)
|
|
8008e4c: 6013 str r3, [r2, #0]
|
|
NULL,
|
|
( ( UBaseType_t ) configTIMER_TASK_PRIORITY ) | portPRIVILEGE_BIT,
|
|
pxTimerTaskStackBuffer,
|
|
pxTimerTaskTCBBuffer );
|
|
|
|
if( xTimerTaskHandle != NULL )
|
|
8008e4e: 4b10 ldr r3, [pc, #64] @ (8008e90 <xTimerCreateTimerTask+0x90>)
|
|
8008e50: 681b ldr r3, [r3, #0]
|
|
8008e52: 2b00 cmp r3, #0
|
|
8008e54: d001 beq.n 8008e5a <xTimerCreateTimerTask+0x5a>
|
|
{
|
|
xReturn = pdPASS;
|
|
8008e56: 2301 movs r3, #1
|
|
8008e58: 617b str r3, [r7, #20]
|
|
else
|
|
{
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
|
|
configASSERT( xReturn );
|
|
8008e5a: 697b ldr r3, [r7, #20]
|
|
8008e5c: 2b00 cmp r3, #0
|
|
8008e5e: d10b bne.n 8008e78 <xTimerCreateTimerTask+0x78>
|
|
__asm volatile
|
|
8008e60: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8008e64: f383 8811 msr BASEPRI, r3
|
|
8008e68: f3bf 8f6f isb sy
|
|
8008e6c: f3bf 8f4f dsb sy
|
|
8008e70: 613b str r3, [r7, #16]
|
|
}
|
|
8008e72: bf00 nop
|
|
8008e74: bf00 nop
|
|
8008e76: e7fd b.n 8008e74 <xTimerCreateTimerTask+0x74>
|
|
return xReturn;
|
|
8008e78: 697b ldr r3, [r7, #20]
|
|
}
|
|
8008e7a: 4618 mov r0, r3
|
|
8008e7c: 3718 adds r7, #24
|
|
8008e7e: 46bd mov sp, r7
|
|
8008e80: bd80 pop {r7, pc}
|
|
8008e82: bf00 nop
|
|
8008e84: 20000ff0 .word 0x20000ff0
|
|
8008e88: 0800a290 .word 0x0800a290
|
|
8008e8c: 08009109 .word 0x08009109
|
|
8008e90: 20000ff4 .word 0x20000ff4
|
|
|
|
08008e94 <xTimerCreate>:
|
|
TimerHandle_t xTimerCreate( const char * const pcTimerName, /*lint !e971 Unqualified char types are allowed for strings and single characters only. */
|
|
const TickType_t xTimerPeriodInTicks,
|
|
const UBaseType_t uxAutoReload,
|
|
void * const pvTimerID,
|
|
TimerCallbackFunction_t pxCallbackFunction )
|
|
{
|
|
8008e94: b580 push {r7, lr}
|
|
8008e96: b088 sub sp, #32
|
|
8008e98: af02 add r7, sp, #8
|
|
8008e9a: 60f8 str r0, [r7, #12]
|
|
8008e9c: 60b9 str r1, [r7, #8]
|
|
8008e9e: 607a str r2, [r7, #4]
|
|
8008ea0: 603b str r3, [r7, #0]
|
|
Timer_t *pxNewTimer;
|
|
|
|
pxNewTimer = ( Timer_t * ) pvPortMalloc( sizeof( Timer_t ) ); /*lint !e9087 !e9079 All values returned by pvPortMalloc() have at least the alignment required by the MCU's stack, and the first member of Timer_t is always a pointer to the timer's mame. */
|
|
8008ea2: 202c movs r0, #44 @ 0x2c
|
|
8008ea4: f000 fe1a bl 8009adc <pvPortMalloc>
|
|
8008ea8: 6178 str r0, [r7, #20]
|
|
|
|
if( pxNewTimer != NULL )
|
|
8008eaa: 697b ldr r3, [r7, #20]
|
|
8008eac: 2b00 cmp r3, #0
|
|
8008eae: d00d beq.n 8008ecc <xTimerCreate+0x38>
|
|
{
|
|
/* Status is thus far zero as the timer is not created statically
|
|
and has not been started. The auto-reload bit may get set in
|
|
prvInitialiseNewTimer. */
|
|
pxNewTimer->ucStatus = 0x00;
|
|
8008eb0: 697b ldr r3, [r7, #20]
|
|
8008eb2: 2200 movs r2, #0
|
|
8008eb4: f883 2028 strb.w r2, [r3, #40] @ 0x28
|
|
prvInitialiseNewTimer( pcTimerName, xTimerPeriodInTicks, uxAutoReload, pvTimerID, pxCallbackFunction, pxNewTimer );
|
|
8008eb8: 697b ldr r3, [r7, #20]
|
|
8008eba: 9301 str r3, [sp, #4]
|
|
8008ebc: 6a3b ldr r3, [r7, #32]
|
|
8008ebe: 9300 str r3, [sp, #0]
|
|
8008ec0: 683b ldr r3, [r7, #0]
|
|
8008ec2: 687a ldr r2, [r7, #4]
|
|
8008ec4: 68b9 ldr r1, [r7, #8]
|
|
8008ec6: 68f8 ldr r0, [r7, #12]
|
|
8008ec8: f000 f845 bl 8008f56 <prvInitialiseNewTimer>
|
|
}
|
|
|
|
return pxNewTimer;
|
|
8008ecc: 697b ldr r3, [r7, #20]
|
|
}
|
|
8008ece: 4618 mov r0, r3
|
|
8008ed0: 3718 adds r7, #24
|
|
8008ed2: 46bd mov sp, r7
|
|
8008ed4: bd80 pop {r7, pc}
|
|
|
|
08008ed6 <xTimerCreateStatic>:
|
|
const TickType_t xTimerPeriodInTicks,
|
|
const UBaseType_t uxAutoReload,
|
|
void * const pvTimerID,
|
|
TimerCallbackFunction_t pxCallbackFunction,
|
|
StaticTimer_t *pxTimerBuffer )
|
|
{
|
|
8008ed6: b580 push {r7, lr}
|
|
8008ed8: b08a sub sp, #40 @ 0x28
|
|
8008eda: af02 add r7, sp, #8
|
|
8008edc: 60f8 str r0, [r7, #12]
|
|
8008ede: 60b9 str r1, [r7, #8]
|
|
8008ee0: 607a str r2, [r7, #4]
|
|
8008ee2: 603b str r3, [r7, #0]
|
|
#if( configASSERT_DEFINED == 1 )
|
|
{
|
|
/* Sanity check that the size of the structure used to declare a
|
|
variable of type StaticTimer_t equals the size of the real timer
|
|
structure. */
|
|
volatile size_t xSize = sizeof( StaticTimer_t );
|
|
8008ee4: 232c movs r3, #44 @ 0x2c
|
|
8008ee6: 613b str r3, [r7, #16]
|
|
configASSERT( xSize == sizeof( Timer_t ) );
|
|
8008ee8: 693b ldr r3, [r7, #16]
|
|
8008eea: 2b2c cmp r3, #44 @ 0x2c
|
|
8008eec: d00b beq.n 8008f06 <xTimerCreateStatic+0x30>
|
|
__asm volatile
|
|
8008eee: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8008ef2: f383 8811 msr BASEPRI, r3
|
|
8008ef6: f3bf 8f6f isb sy
|
|
8008efa: f3bf 8f4f dsb sy
|
|
8008efe: 61bb str r3, [r7, #24]
|
|
}
|
|
8008f00: bf00 nop
|
|
8008f02: bf00 nop
|
|
8008f04: e7fd b.n 8008f02 <xTimerCreateStatic+0x2c>
|
|
( void ) xSize; /* Keeps lint quiet when configASSERT() is not defined. */
|
|
8008f06: 693b ldr r3, [r7, #16]
|
|
}
|
|
#endif /* configASSERT_DEFINED */
|
|
|
|
/* A pointer to a StaticTimer_t structure MUST be provided, use it. */
|
|
configASSERT( pxTimerBuffer );
|
|
8008f08: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
8008f0a: 2b00 cmp r3, #0
|
|
8008f0c: d10b bne.n 8008f26 <xTimerCreateStatic+0x50>
|
|
__asm volatile
|
|
8008f0e: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8008f12: f383 8811 msr BASEPRI, r3
|
|
8008f16: f3bf 8f6f isb sy
|
|
8008f1a: f3bf 8f4f dsb sy
|
|
8008f1e: 617b str r3, [r7, #20]
|
|
}
|
|
8008f20: bf00 nop
|
|
8008f22: bf00 nop
|
|
8008f24: e7fd b.n 8008f22 <xTimerCreateStatic+0x4c>
|
|
pxNewTimer = ( Timer_t * ) pxTimerBuffer; /*lint !e740 !e9087 StaticTimer_t is a pointer to a Timer_t, so guaranteed to be aligned and sized correctly (checked by an assert()), so this is safe. */
|
|
8008f26: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
8008f28: 61fb str r3, [r7, #28]
|
|
|
|
if( pxNewTimer != NULL )
|
|
8008f2a: 69fb ldr r3, [r7, #28]
|
|
8008f2c: 2b00 cmp r3, #0
|
|
8008f2e: d00d beq.n 8008f4c <xTimerCreateStatic+0x76>
|
|
{
|
|
/* Timers can be created statically or dynamically so note this
|
|
timer was created statically in case it is later deleted. The
|
|
auto-reload bit may get set in prvInitialiseNewTimer(). */
|
|
pxNewTimer->ucStatus = tmrSTATUS_IS_STATICALLY_ALLOCATED;
|
|
8008f30: 69fb ldr r3, [r7, #28]
|
|
8008f32: 2202 movs r2, #2
|
|
8008f34: f883 2028 strb.w r2, [r3, #40] @ 0x28
|
|
|
|
prvInitialiseNewTimer( pcTimerName, xTimerPeriodInTicks, uxAutoReload, pvTimerID, pxCallbackFunction, pxNewTimer );
|
|
8008f38: 69fb ldr r3, [r7, #28]
|
|
8008f3a: 9301 str r3, [sp, #4]
|
|
8008f3c: 6abb ldr r3, [r7, #40] @ 0x28
|
|
8008f3e: 9300 str r3, [sp, #0]
|
|
8008f40: 683b ldr r3, [r7, #0]
|
|
8008f42: 687a ldr r2, [r7, #4]
|
|
8008f44: 68b9 ldr r1, [r7, #8]
|
|
8008f46: 68f8 ldr r0, [r7, #12]
|
|
8008f48: f000 f805 bl 8008f56 <prvInitialiseNewTimer>
|
|
}
|
|
|
|
return pxNewTimer;
|
|
8008f4c: 69fb ldr r3, [r7, #28]
|
|
}
|
|
8008f4e: 4618 mov r0, r3
|
|
8008f50: 3720 adds r7, #32
|
|
8008f52: 46bd mov sp, r7
|
|
8008f54: bd80 pop {r7, pc}
|
|
|
|
08008f56 <prvInitialiseNewTimer>:
|
|
const TickType_t xTimerPeriodInTicks,
|
|
const UBaseType_t uxAutoReload,
|
|
void * const pvTimerID,
|
|
TimerCallbackFunction_t pxCallbackFunction,
|
|
Timer_t *pxNewTimer )
|
|
{
|
|
8008f56: b580 push {r7, lr}
|
|
8008f58: b086 sub sp, #24
|
|
8008f5a: af00 add r7, sp, #0
|
|
8008f5c: 60f8 str r0, [r7, #12]
|
|
8008f5e: 60b9 str r1, [r7, #8]
|
|
8008f60: 607a str r2, [r7, #4]
|
|
8008f62: 603b str r3, [r7, #0]
|
|
/* 0 is not a valid value for xTimerPeriodInTicks. */
|
|
configASSERT( ( xTimerPeriodInTicks > 0 ) );
|
|
8008f64: 68bb ldr r3, [r7, #8]
|
|
8008f66: 2b00 cmp r3, #0
|
|
8008f68: d10b bne.n 8008f82 <prvInitialiseNewTimer+0x2c>
|
|
__asm volatile
|
|
8008f6a: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8008f6e: f383 8811 msr BASEPRI, r3
|
|
8008f72: f3bf 8f6f isb sy
|
|
8008f76: f3bf 8f4f dsb sy
|
|
8008f7a: 617b str r3, [r7, #20]
|
|
}
|
|
8008f7c: bf00 nop
|
|
8008f7e: bf00 nop
|
|
8008f80: e7fd b.n 8008f7e <prvInitialiseNewTimer+0x28>
|
|
|
|
if( pxNewTimer != NULL )
|
|
8008f82: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8008f84: 2b00 cmp r3, #0
|
|
8008f86: d01e beq.n 8008fc6 <prvInitialiseNewTimer+0x70>
|
|
{
|
|
/* Ensure the infrastructure used by the timer service task has been
|
|
created/initialised. */
|
|
prvCheckForValidListAndQueue();
|
|
8008f88: f000 faf2 bl 8009570 <prvCheckForValidListAndQueue>
|
|
|
|
/* Initialise the timer structure members using the function
|
|
parameters. */
|
|
pxNewTimer->pcTimerName = pcTimerName;
|
|
8008f8c: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8008f8e: 68fa ldr r2, [r7, #12]
|
|
8008f90: 601a str r2, [r3, #0]
|
|
pxNewTimer->xTimerPeriodInTicks = xTimerPeriodInTicks;
|
|
8008f92: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8008f94: 68ba ldr r2, [r7, #8]
|
|
8008f96: 619a str r2, [r3, #24]
|
|
pxNewTimer->pvTimerID = pvTimerID;
|
|
8008f98: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8008f9a: 683a ldr r2, [r7, #0]
|
|
8008f9c: 61da str r2, [r3, #28]
|
|
pxNewTimer->pxCallbackFunction = pxCallbackFunction;
|
|
8008f9e: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8008fa0: 6a3a ldr r2, [r7, #32]
|
|
8008fa2: 621a str r2, [r3, #32]
|
|
vListInitialiseItem( &( pxNewTimer->xTimerListItem ) );
|
|
8008fa4: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8008fa6: 3304 adds r3, #4
|
|
8008fa8: 4618 mov r0, r3
|
|
8008faa: f7fd fe65 bl 8006c78 <vListInitialiseItem>
|
|
if( uxAutoReload != pdFALSE )
|
|
8008fae: 687b ldr r3, [r7, #4]
|
|
8008fb0: 2b00 cmp r3, #0
|
|
8008fb2: d008 beq.n 8008fc6 <prvInitialiseNewTimer+0x70>
|
|
{
|
|
pxNewTimer->ucStatus |= tmrSTATUS_IS_AUTORELOAD;
|
|
8008fb4: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8008fb6: f893 3028 ldrb.w r3, [r3, #40] @ 0x28
|
|
8008fba: f043 0304 orr.w r3, r3, #4
|
|
8008fbe: b2da uxtb r2, r3
|
|
8008fc0: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8008fc2: f883 2028 strb.w r2, [r3, #40] @ 0x28
|
|
}
|
|
traceTIMER_CREATE( pxNewTimer );
|
|
}
|
|
}
|
|
8008fc6: bf00 nop
|
|
8008fc8: 3718 adds r7, #24
|
|
8008fca: 46bd mov sp, r7
|
|
8008fcc: bd80 pop {r7, pc}
|
|
...
|
|
|
|
08008fd0 <xTimerGenericCommand>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
BaseType_t xTimerGenericCommand( TimerHandle_t xTimer, const BaseType_t xCommandID, const TickType_t xOptionalValue, BaseType_t * const pxHigherPriorityTaskWoken, const TickType_t xTicksToWait )
|
|
{
|
|
8008fd0: b580 push {r7, lr}
|
|
8008fd2: b08a sub sp, #40 @ 0x28
|
|
8008fd4: af00 add r7, sp, #0
|
|
8008fd6: 60f8 str r0, [r7, #12]
|
|
8008fd8: 60b9 str r1, [r7, #8]
|
|
8008fda: 607a str r2, [r7, #4]
|
|
8008fdc: 603b str r3, [r7, #0]
|
|
BaseType_t xReturn = pdFAIL;
|
|
8008fde: 2300 movs r3, #0
|
|
8008fe0: 627b str r3, [r7, #36] @ 0x24
|
|
DaemonTaskMessage_t xMessage;
|
|
|
|
configASSERT( xTimer );
|
|
8008fe2: 68fb ldr r3, [r7, #12]
|
|
8008fe4: 2b00 cmp r3, #0
|
|
8008fe6: d10b bne.n 8009000 <xTimerGenericCommand+0x30>
|
|
__asm volatile
|
|
8008fe8: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8008fec: f383 8811 msr BASEPRI, r3
|
|
8008ff0: f3bf 8f6f isb sy
|
|
8008ff4: f3bf 8f4f dsb sy
|
|
8008ff8: 623b str r3, [r7, #32]
|
|
}
|
|
8008ffa: bf00 nop
|
|
8008ffc: bf00 nop
|
|
8008ffe: e7fd b.n 8008ffc <xTimerGenericCommand+0x2c>
|
|
|
|
/* Send a message to the timer service task to perform a particular action
|
|
on a particular timer definition. */
|
|
if( xTimerQueue != NULL )
|
|
8009000: 4b19 ldr r3, [pc, #100] @ (8009068 <xTimerGenericCommand+0x98>)
|
|
8009002: 681b ldr r3, [r3, #0]
|
|
8009004: 2b00 cmp r3, #0
|
|
8009006: d02a beq.n 800905e <xTimerGenericCommand+0x8e>
|
|
{
|
|
/* Send a command to the timer service task to start the xTimer timer. */
|
|
xMessage.xMessageID = xCommandID;
|
|
8009008: 68bb ldr r3, [r7, #8]
|
|
800900a: 613b str r3, [r7, #16]
|
|
xMessage.u.xTimerParameters.xMessageValue = xOptionalValue;
|
|
800900c: 687b ldr r3, [r7, #4]
|
|
800900e: 617b str r3, [r7, #20]
|
|
xMessage.u.xTimerParameters.pxTimer = xTimer;
|
|
8009010: 68fb ldr r3, [r7, #12]
|
|
8009012: 61bb str r3, [r7, #24]
|
|
|
|
if( xCommandID < tmrFIRST_FROM_ISR_COMMAND )
|
|
8009014: 68bb ldr r3, [r7, #8]
|
|
8009016: 2b05 cmp r3, #5
|
|
8009018: dc18 bgt.n 800904c <xTimerGenericCommand+0x7c>
|
|
{
|
|
if( xTaskGetSchedulerState() == taskSCHEDULER_RUNNING )
|
|
800901a: f7ff fd0f bl 8008a3c <xTaskGetSchedulerState>
|
|
800901e: 4603 mov r3, r0
|
|
8009020: 2b02 cmp r3, #2
|
|
8009022: d109 bne.n 8009038 <xTimerGenericCommand+0x68>
|
|
{
|
|
xReturn = xQueueSendToBack( xTimerQueue, &xMessage, xTicksToWait );
|
|
8009024: 4b10 ldr r3, [pc, #64] @ (8009068 <xTimerGenericCommand+0x98>)
|
|
8009026: 6818 ldr r0, [r3, #0]
|
|
8009028: f107 0110 add.w r1, r7, #16
|
|
800902c: 2300 movs r3, #0
|
|
800902e: 6b3a ldr r2, [r7, #48] @ 0x30
|
|
8009030: f7fe f86a bl 8007108 <xQueueGenericSend>
|
|
8009034: 6278 str r0, [r7, #36] @ 0x24
|
|
8009036: e012 b.n 800905e <xTimerGenericCommand+0x8e>
|
|
}
|
|
else
|
|
{
|
|
xReturn = xQueueSendToBack( xTimerQueue, &xMessage, tmrNO_DELAY );
|
|
8009038: 4b0b ldr r3, [pc, #44] @ (8009068 <xTimerGenericCommand+0x98>)
|
|
800903a: 6818 ldr r0, [r3, #0]
|
|
800903c: f107 0110 add.w r1, r7, #16
|
|
8009040: 2300 movs r3, #0
|
|
8009042: 2200 movs r2, #0
|
|
8009044: f7fe f860 bl 8007108 <xQueueGenericSend>
|
|
8009048: 6278 str r0, [r7, #36] @ 0x24
|
|
800904a: e008 b.n 800905e <xTimerGenericCommand+0x8e>
|
|
}
|
|
}
|
|
else
|
|
{
|
|
xReturn = xQueueSendToBackFromISR( xTimerQueue, &xMessage, pxHigherPriorityTaskWoken );
|
|
800904c: 4b06 ldr r3, [pc, #24] @ (8009068 <xTimerGenericCommand+0x98>)
|
|
800904e: 6818 ldr r0, [r3, #0]
|
|
8009050: f107 0110 add.w r1, r7, #16
|
|
8009054: 2300 movs r3, #0
|
|
8009056: 683a ldr r2, [r7, #0]
|
|
8009058: f7fe f958 bl 800730c <xQueueGenericSendFromISR>
|
|
800905c: 6278 str r0, [r7, #36] @ 0x24
|
|
else
|
|
{
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
|
|
return xReturn;
|
|
800905e: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
}
|
|
8009060: 4618 mov r0, r3
|
|
8009062: 3728 adds r7, #40 @ 0x28
|
|
8009064: 46bd mov sp, r7
|
|
8009066: bd80 pop {r7, pc}
|
|
8009068: 20000ff0 .word 0x20000ff0
|
|
|
|
0800906c <prvProcessExpiredTimer>:
|
|
return pxTimer->pcTimerName;
|
|
}
|
|
/*-----------------------------------------------------------*/
|
|
|
|
static void prvProcessExpiredTimer( const TickType_t xNextExpireTime, const TickType_t xTimeNow )
|
|
{
|
|
800906c: b580 push {r7, lr}
|
|
800906e: b088 sub sp, #32
|
|
8009070: af02 add r7, sp, #8
|
|
8009072: 6078 str r0, [r7, #4]
|
|
8009074: 6039 str r1, [r7, #0]
|
|
BaseType_t xResult;
|
|
Timer_t * const pxTimer = ( Timer_t * ) listGET_OWNER_OF_HEAD_ENTRY( pxCurrentTimerList ); /*lint !e9087 !e9079 void * is used as this macro is used with tasks and co-routines too. Alignment is known to be fine as the type of the pointer stored and retrieved is the same. */
|
|
8009076: 4b23 ldr r3, [pc, #140] @ (8009104 <prvProcessExpiredTimer+0x98>)
|
|
8009078: 681b ldr r3, [r3, #0]
|
|
800907a: 68db ldr r3, [r3, #12]
|
|
800907c: 68db ldr r3, [r3, #12]
|
|
800907e: 617b str r3, [r7, #20]
|
|
|
|
/* Remove the timer from the list of active timers. A check has already
|
|
been performed to ensure the list is not empty. */
|
|
( void ) uxListRemove( &( pxTimer->xTimerListItem ) );
|
|
8009080: 697b ldr r3, [r7, #20]
|
|
8009082: 3304 adds r3, #4
|
|
8009084: 4618 mov r0, r3
|
|
8009086: f7fd fe61 bl 8006d4c <uxListRemove>
|
|
traceTIMER_EXPIRED( pxTimer );
|
|
|
|
/* If the timer is an auto-reload timer then calculate the next
|
|
expiry time and re-insert the timer in the list of active timers. */
|
|
if( ( pxTimer->ucStatus & tmrSTATUS_IS_AUTORELOAD ) != 0 )
|
|
800908a: 697b ldr r3, [r7, #20]
|
|
800908c: f893 3028 ldrb.w r3, [r3, #40] @ 0x28
|
|
8009090: f003 0304 and.w r3, r3, #4
|
|
8009094: 2b00 cmp r3, #0
|
|
8009096: d023 beq.n 80090e0 <prvProcessExpiredTimer+0x74>
|
|
{
|
|
/* The timer is inserted into a list using a time relative to anything
|
|
other than the current time. It will therefore be inserted into the
|
|
correct list relative to the time this task thinks it is now. */
|
|
if( prvInsertTimerInActiveList( pxTimer, ( xNextExpireTime + pxTimer->xTimerPeriodInTicks ), xTimeNow, xNextExpireTime ) != pdFALSE )
|
|
8009098: 697b ldr r3, [r7, #20]
|
|
800909a: 699a ldr r2, [r3, #24]
|
|
800909c: 687b ldr r3, [r7, #4]
|
|
800909e: 18d1 adds r1, r2, r3
|
|
80090a0: 687b ldr r3, [r7, #4]
|
|
80090a2: 683a ldr r2, [r7, #0]
|
|
80090a4: 6978 ldr r0, [r7, #20]
|
|
80090a6: f000 f8d5 bl 8009254 <prvInsertTimerInActiveList>
|
|
80090aa: 4603 mov r3, r0
|
|
80090ac: 2b00 cmp r3, #0
|
|
80090ae: d020 beq.n 80090f2 <prvProcessExpiredTimer+0x86>
|
|
{
|
|
/* The timer expired before it was added to the active timer
|
|
list. Reload it now. */
|
|
xResult = xTimerGenericCommand( pxTimer, tmrCOMMAND_START_DONT_TRACE, xNextExpireTime, NULL, tmrNO_DELAY );
|
|
80090b0: 2300 movs r3, #0
|
|
80090b2: 9300 str r3, [sp, #0]
|
|
80090b4: 2300 movs r3, #0
|
|
80090b6: 687a ldr r2, [r7, #4]
|
|
80090b8: 2100 movs r1, #0
|
|
80090ba: 6978 ldr r0, [r7, #20]
|
|
80090bc: f7ff ff88 bl 8008fd0 <xTimerGenericCommand>
|
|
80090c0: 6138 str r0, [r7, #16]
|
|
configASSERT( xResult );
|
|
80090c2: 693b ldr r3, [r7, #16]
|
|
80090c4: 2b00 cmp r3, #0
|
|
80090c6: d114 bne.n 80090f2 <prvProcessExpiredTimer+0x86>
|
|
__asm volatile
|
|
80090c8: f04f 0350 mov.w r3, #80 @ 0x50
|
|
80090cc: f383 8811 msr BASEPRI, r3
|
|
80090d0: f3bf 8f6f isb sy
|
|
80090d4: f3bf 8f4f dsb sy
|
|
80090d8: 60fb str r3, [r7, #12]
|
|
}
|
|
80090da: bf00 nop
|
|
80090dc: bf00 nop
|
|
80090de: e7fd b.n 80090dc <prvProcessExpiredTimer+0x70>
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
}
|
|
else
|
|
{
|
|
pxTimer->ucStatus &= ~tmrSTATUS_IS_ACTIVE;
|
|
80090e0: 697b ldr r3, [r7, #20]
|
|
80090e2: f893 3028 ldrb.w r3, [r3, #40] @ 0x28
|
|
80090e6: f023 0301 bic.w r3, r3, #1
|
|
80090ea: b2da uxtb r2, r3
|
|
80090ec: 697b ldr r3, [r7, #20]
|
|
80090ee: f883 2028 strb.w r2, [r3, #40] @ 0x28
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
|
|
/* Call the timer callback. */
|
|
pxTimer->pxCallbackFunction( ( TimerHandle_t ) pxTimer );
|
|
80090f2: 697b ldr r3, [r7, #20]
|
|
80090f4: 6a1b ldr r3, [r3, #32]
|
|
80090f6: 6978 ldr r0, [r7, #20]
|
|
80090f8: 4798 blx r3
|
|
}
|
|
80090fa: bf00 nop
|
|
80090fc: 3718 adds r7, #24
|
|
80090fe: 46bd mov sp, r7
|
|
8009100: bd80 pop {r7, pc}
|
|
8009102: bf00 nop
|
|
8009104: 20000fe8 .word 0x20000fe8
|
|
|
|
08009108 <prvTimerTask>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
static portTASK_FUNCTION( prvTimerTask, pvParameters )
|
|
{
|
|
8009108: b580 push {r7, lr}
|
|
800910a: b084 sub sp, #16
|
|
800910c: af00 add r7, sp, #0
|
|
800910e: 6078 str r0, [r7, #4]
|
|
|
|
for( ;; )
|
|
{
|
|
/* Query the timers list to see if it contains any timers, and if so,
|
|
obtain the time at which the next timer will expire. */
|
|
xNextExpireTime = prvGetNextExpireTime( &xListWasEmpty );
|
|
8009110: f107 0308 add.w r3, r7, #8
|
|
8009114: 4618 mov r0, r3
|
|
8009116: f000 f859 bl 80091cc <prvGetNextExpireTime>
|
|
800911a: 60f8 str r0, [r7, #12]
|
|
|
|
/* If a timer has expired, process it. Otherwise, block this task
|
|
until either a timer does expire, or a command is received. */
|
|
prvProcessTimerOrBlockTask( xNextExpireTime, xListWasEmpty );
|
|
800911c: 68bb ldr r3, [r7, #8]
|
|
800911e: 4619 mov r1, r3
|
|
8009120: 68f8 ldr r0, [r7, #12]
|
|
8009122: f000 f805 bl 8009130 <prvProcessTimerOrBlockTask>
|
|
|
|
/* Empty the command queue. */
|
|
prvProcessReceivedCommands();
|
|
8009126: f000 f8d7 bl 80092d8 <prvProcessReceivedCommands>
|
|
xNextExpireTime = prvGetNextExpireTime( &xListWasEmpty );
|
|
800912a: bf00 nop
|
|
800912c: e7f0 b.n 8009110 <prvTimerTask+0x8>
|
|
...
|
|
|
|
08009130 <prvProcessTimerOrBlockTask>:
|
|
}
|
|
}
|
|
/*-----------------------------------------------------------*/
|
|
|
|
static void prvProcessTimerOrBlockTask( const TickType_t xNextExpireTime, BaseType_t xListWasEmpty )
|
|
{
|
|
8009130: b580 push {r7, lr}
|
|
8009132: b084 sub sp, #16
|
|
8009134: af00 add r7, sp, #0
|
|
8009136: 6078 str r0, [r7, #4]
|
|
8009138: 6039 str r1, [r7, #0]
|
|
TickType_t xTimeNow;
|
|
BaseType_t xTimerListsWereSwitched;
|
|
|
|
vTaskSuspendAll();
|
|
800913a: f7ff f88b bl 8008254 <vTaskSuspendAll>
|
|
/* Obtain the time now to make an assessment as to whether the timer
|
|
has expired or not. If obtaining the time causes the lists to switch
|
|
then don't process this timer as any timers that remained in the list
|
|
when the lists were switched will have been processed within the
|
|
prvSampleTimeNow() function. */
|
|
xTimeNow = prvSampleTimeNow( &xTimerListsWereSwitched );
|
|
800913e: f107 0308 add.w r3, r7, #8
|
|
8009142: 4618 mov r0, r3
|
|
8009144: f000 f866 bl 8009214 <prvSampleTimeNow>
|
|
8009148: 60f8 str r0, [r7, #12]
|
|
if( xTimerListsWereSwitched == pdFALSE )
|
|
800914a: 68bb ldr r3, [r7, #8]
|
|
800914c: 2b00 cmp r3, #0
|
|
800914e: d130 bne.n 80091b2 <prvProcessTimerOrBlockTask+0x82>
|
|
{
|
|
/* The tick count has not overflowed, has the timer expired? */
|
|
if( ( xListWasEmpty == pdFALSE ) && ( xNextExpireTime <= xTimeNow ) )
|
|
8009150: 683b ldr r3, [r7, #0]
|
|
8009152: 2b00 cmp r3, #0
|
|
8009154: d10a bne.n 800916c <prvProcessTimerOrBlockTask+0x3c>
|
|
8009156: 687a ldr r2, [r7, #4]
|
|
8009158: 68fb ldr r3, [r7, #12]
|
|
800915a: 429a cmp r2, r3
|
|
800915c: d806 bhi.n 800916c <prvProcessTimerOrBlockTask+0x3c>
|
|
{
|
|
( void ) xTaskResumeAll();
|
|
800915e: f7ff f887 bl 8008270 <xTaskResumeAll>
|
|
prvProcessExpiredTimer( xNextExpireTime, xTimeNow );
|
|
8009162: 68f9 ldr r1, [r7, #12]
|
|
8009164: 6878 ldr r0, [r7, #4]
|
|
8009166: f7ff ff81 bl 800906c <prvProcessExpiredTimer>
|
|
else
|
|
{
|
|
( void ) xTaskResumeAll();
|
|
}
|
|
}
|
|
}
|
|
800916a: e024 b.n 80091b6 <prvProcessTimerOrBlockTask+0x86>
|
|
if( xListWasEmpty != pdFALSE )
|
|
800916c: 683b ldr r3, [r7, #0]
|
|
800916e: 2b00 cmp r3, #0
|
|
8009170: d008 beq.n 8009184 <prvProcessTimerOrBlockTask+0x54>
|
|
xListWasEmpty = listLIST_IS_EMPTY( pxOverflowTimerList );
|
|
8009172: 4b13 ldr r3, [pc, #76] @ (80091c0 <prvProcessTimerOrBlockTask+0x90>)
|
|
8009174: 681b ldr r3, [r3, #0]
|
|
8009176: 681b ldr r3, [r3, #0]
|
|
8009178: 2b00 cmp r3, #0
|
|
800917a: d101 bne.n 8009180 <prvProcessTimerOrBlockTask+0x50>
|
|
800917c: 2301 movs r3, #1
|
|
800917e: e000 b.n 8009182 <prvProcessTimerOrBlockTask+0x52>
|
|
8009180: 2300 movs r3, #0
|
|
8009182: 603b str r3, [r7, #0]
|
|
vQueueWaitForMessageRestricted( xTimerQueue, ( xNextExpireTime - xTimeNow ), xListWasEmpty );
|
|
8009184: 4b0f ldr r3, [pc, #60] @ (80091c4 <prvProcessTimerOrBlockTask+0x94>)
|
|
8009186: 6818 ldr r0, [r3, #0]
|
|
8009188: 687a ldr r2, [r7, #4]
|
|
800918a: 68fb ldr r3, [r7, #12]
|
|
800918c: 1ad3 subs r3, r2, r3
|
|
800918e: 683a ldr r2, [r7, #0]
|
|
8009190: 4619 mov r1, r3
|
|
8009192: f7fe fdfd bl 8007d90 <vQueueWaitForMessageRestricted>
|
|
if( xTaskResumeAll() == pdFALSE )
|
|
8009196: f7ff f86b bl 8008270 <xTaskResumeAll>
|
|
800919a: 4603 mov r3, r0
|
|
800919c: 2b00 cmp r3, #0
|
|
800919e: d10a bne.n 80091b6 <prvProcessTimerOrBlockTask+0x86>
|
|
portYIELD_WITHIN_API();
|
|
80091a0: 4b09 ldr r3, [pc, #36] @ (80091c8 <prvProcessTimerOrBlockTask+0x98>)
|
|
80091a2: f04f 5280 mov.w r2, #268435456 @ 0x10000000
|
|
80091a6: 601a str r2, [r3, #0]
|
|
80091a8: f3bf 8f4f dsb sy
|
|
80091ac: f3bf 8f6f isb sy
|
|
}
|
|
80091b0: e001 b.n 80091b6 <prvProcessTimerOrBlockTask+0x86>
|
|
( void ) xTaskResumeAll();
|
|
80091b2: f7ff f85d bl 8008270 <xTaskResumeAll>
|
|
}
|
|
80091b6: bf00 nop
|
|
80091b8: 3710 adds r7, #16
|
|
80091ba: 46bd mov sp, r7
|
|
80091bc: bd80 pop {r7, pc}
|
|
80091be: bf00 nop
|
|
80091c0: 20000fec .word 0x20000fec
|
|
80091c4: 20000ff0 .word 0x20000ff0
|
|
80091c8: e000ed04 .word 0xe000ed04
|
|
|
|
080091cc <prvGetNextExpireTime>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
static TickType_t prvGetNextExpireTime( BaseType_t * const pxListWasEmpty )
|
|
{
|
|
80091cc: b480 push {r7}
|
|
80091ce: b085 sub sp, #20
|
|
80091d0: af00 add r7, sp, #0
|
|
80091d2: 6078 str r0, [r7, #4]
|
|
the timer with the nearest expiry time will expire. If there are no
|
|
active timers then just set the next expire time to 0. That will cause
|
|
this task to unblock when the tick count overflows, at which point the
|
|
timer lists will be switched and the next expiry time can be
|
|
re-assessed. */
|
|
*pxListWasEmpty = listLIST_IS_EMPTY( pxCurrentTimerList );
|
|
80091d4: 4b0e ldr r3, [pc, #56] @ (8009210 <prvGetNextExpireTime+0x44>)
|
|
80091d6: 681b ldr r3, [r3, #0]
|
|
80091d8: 681b ldr r3, [r3, #0]
|
|
80091da: 2b00 cmp r3, #0
|
|
80091dc: d101 bne.n 80091e2 <prvGetNextExpireTime+0x16>
|
|
80091de: 2201 movs r2, #1
|
|
80091e0: e000 b.n 80091e4 <prvGetNextExpireTime+0x18>
|
|
80091e2: 2200 movs r2, #0
|
|
80091e4: 687b ldr r3, [r7, #4]
|
|
80091e6: 601a str r2, [r3, #0]
|
|
if( *pxListWasEmpty == pdFALSE )
|
|
80091e8: 687b ldr r3, [r7, #4]
|
|
80091ea: 681b ldr r3, [r3, #0]
|
|
80091ec: 2b00 cmp r3, #0
|
|
80091ee: d105 bne.n 80091fc <prvGetNextExpireTime+0x30>
|
|
{
|
|
xNextExpireTime = listGET_ITEM_VALUE_OF_HEAD_ENTRY( pxCurrentTimerList );
|
|
80091f0: 4b07 ldr r3, [pc, #28] @ (8009210 <prvGetNextExpireTime+0x44>)
|
|
80091f2: 681b ldr r3, [r3, #0]
|
|
80091f4: 68db ldr r3, [r3, #12]
|
|
80091f6: 681b ldr r3, [r3, #0]
|
|
80091f8: 60fb str r3, [r7, #12]
|
|
80091fa: e001 b.n 8009200 <prvGetNextExpireTime+0x34>
|
|
}
|
|
else
|
|
{
|
|
/* Ensure the task unblocks when the tick count rolls over. */
|
|
xNextExpireTime = ( TickType_t ) 0U;
|
|
80091fc: 2300 movs r3, #0
|
|
80091fe: 60fb str r3, [r7, #12]
|
|
}
|
|
|
|
return xNextExpireTime;
|
|
8009200: 68fb ldr r3, [r7, #12]
|
|
}
|
|
8009202: 4618 mov r0, r3
|
|
8009204: 3714 adds r7, #20
|
|
8009206: 46bd mov sp, r7
|
|
8009208: f85d 7b04 ldr.w r7, [sp], #4
|
|
800920c: 4770 bx lr
|
|
800920e: bf00 nop
|
|
8009210: 20000fe8 .word 0x20000fe8
|
|
|
|
08009214 <prvSampleTimeNow>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
static TickType_t prvSampleTimeNow( BaseType_t * const pxTimerListsWereSwitched )
|
|
{
|
|
8009214: b580 push {r7, lr}
|
|
8009216: b084 sub sp, #16
|
|
8009218: af00 add r7, sp, #0
|
|
800921a: 6078 str r0, [r7, #4]
|
|
TickType_t xTimeNow;
|
|
PRIVILEGED_DATA static TickType_t xLastTime = ( TickType_t ) 0U; /*lint !e956 Variable is only accessible to one task. */
|
|
|
|
xTimeNow = xTaskGetTickCount();
|
|
800921c: f7ff f8c6 bl 80083ac <xTaskGetTickCount>
|
|
8009220: 60f8 str r0, [r7, #12]
|
|
|
|
if( xTimeNow < xLastTime )
|
|
8009222: 4b0b ldr r3, [pc, #44] @ (8009250 <prvSampleTimeNow+0x3c>)
|
|
8009224: 681b ldr r3, [r3, #0]
|
|
8009226: 68fa ldr r2, [r7, #12]
|
|
8009228: 429a cmp r2, r3
|
|
800922a: d205 bcs.n 8009238 <prvSampleTimeNow+0x24>
|
|
{
|
|
prvSwitchTimerLists();
|
|
800922c: f000 f93a bl 80094a4 <prvSwitchTimerLists>
|
|
*pxTimerListsWereSwitched = pdTRUE;
|
|
8009230: 687b ldr r3, [r7, #4]
|
|
8009232: 2201 movs r2, #1
|
|
8009234: 601a str r2, [r3, #0]
|
|
8009236: e002 b.n 800923e <prvSampleTimeNow+0x2a>
|
|
}
|
|
else
|
|
{
|
|
*pxTimerListsWereSwitched = pdFALSE;
|
|
8009238: 687b ldr r3, [r7, #4]
|
|
800923a: 2200 movs r2, #0
|
|
800923c: 601a str r2, [r3, #0]
|
|
}
|
|
|
|
xLastTime = xTimeNow;
|
|
800923e: 4a04 ldr r2, [pc, #16] @ (8009250 <prvSampleTimeNow+0x3c>)
|
|
8009240: 68fb ldr r3, [r7, #12]
|
|
8009242: 6013 str r3, [r2, #0]
|
|
|
|
return xTimeNow;
|
|
8009244: 68fb ldr r3, [r7, #12]
|
|
}
|
|
8009246: 4618 mov r0, r3
|
|
8009248: 3710 adds r7, #16
|
|
800924a: 46bd mov sp, r7
|
|
800924c: bd80 pop {r7, pc}
|
|
800924e: bf00 nop
|
|
8009250: 20000ff8 .word 0x20000ff8
|
|
|
|
08009254 <prvInsertTimerInActiveList>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
static BaseType_t prvInsertTimerInActiveList( Timer_t * const pxTimer, const TickType_t xNextExpiryTime, const TickType_t xTimeNow, const TickType_t xCommandTime )
|
|
{
|
|
8009254: b580 push {r7, lr}
|
|
8009256: b086 sub sp, #24
|
|
8009258: af00 add r7, sp, #0
|
|
800925a: 60f8 str r0, [r7, #12]
|
|
800925c: 60b9 str r1, [r7, #8]
|
|
800925e: 607a str r2, [r7, #4]
|
|
8009260: 603b str r3, [r7, #0]
|
|
BaseType_t xProcessTimerNow = pdFALSE;
|
|
8009262: 2300 movs r3, #0
|
|
8009264: 617b str r3, [r7, #20]
|
|
|
|
listSET_LIST_ITEM_VALUE( &( pxTimer->xTimerListItem ), xNextExpiryTime );
|
|
8009266: 68fb ldr r3, [r7, #12]
|
|
8009268: 68ba ldr r2, [r7, #8]
|
|
800926a: 605a str r2, [r3, #4]
|
|
listSET_LIST_ITEM_OWNER( &( pxTimer->xTimerListItem ), pxTimer );
|
|
800926c: 68fb ldr r3, [r7, #12]
|
|
800926e: 68fa ldr r2, [r7, #12]
|
|
8009270: 611a str r2, [r3, #16]
|
|
|
|
if( xNextExpiryTime <= xTimeNow )
|
|
8009272: 68ba ldr r2, [r7, #8]
|
|
8009274: 687b ldr r3, [r7, #4]
|
|
8009276: 429a cmp r2, r3
|
|
8009278: d812 bhi.n 80092a0 <prvInsertTimerInActiveList+0x4c>
|
|
{
|
|
/* Has the expiry time elapsed between the command to start/reset a
|
|
timer was issued, and the time the command was processed? */
|
|
if( ( ( TickType_t ) ( xTimeNow - xCommandTime ) ) >= pxTimer->xTimerPeriodInTicks ) /*lint !e961 MISRA exception as the casts are only redundant for some ports. */
|
|
800927a: 687a ldr r2, [r7, #4]
|
|
800927c: 683b ldr r3, [r7, #0]
|
|
800927e: 1ad2 subs r2, r2, r3
|
|
8009280: 68fb ldr r3, [r7, #12]
|
|
8009282: 699b ldr r3, [r3, #24]
|
|
8009284: 429a cmp r2, r3
|
|
8009286: d302 bcc.n 800928e <prvInsertTimerInActiveList+0x3a>
|
|
{
|
|
/* The time between a command being issued and the command being
|
|
processed actually exceeds the timers period. */
|
|
xProcessTimerNow = pdTRUE;
|
|
8009288: 2301 movs r3, #1
|
|
800928a: 617b str r3, [r7, #20]
|
|
800928c: e01b b.n 80092c6 <prvInsertTimerInActiveList+0x72>
|
|
}
|
|
else
|
|
{
|
|
vListInsert( pxOverflowTimerList, &( pxTimer->xTimerListItem ) );
|
|
800928e: 4b10 ldr r3, [pc, #64] @ (80092d0 <prvInsertTimerInActiveList+0x7c>)
|
|
8009290: 681a ldr r2, [r3, #0]
|
|
8009292: 68fb ldr r3, [r7, #12]
|
|
8009294: 3304 adds r3, #4
|
|
8009296: 4619 mov r1, r3
|
|
8009298: 4610 mov r0, r2
|
|
800929a: f7fd fd1e bl 8006cda <vListInsert>
|
|
800929e: e012 b.n 80092c6 <prvInsertTimerInActiveList+0x72>
|
|
}
|
|
}
|
|
else
|
|
{
|
|
if( ( xTimeNow < xCommandTime ) && ( xNextExpiryTime >= xCommandTime ) )
|
|
80092a0: 687a ldr r2, [r7, #4]
|
|
80092a2: 683b ldr r3, [r7, #0]
|
|
80092a4: 429a cmp r2, r3
|
|
80092a6: d206 bcs.n 80092b6 <prvInsertTimerInActiveList+0x62>
|
|
80092a8: 68ba ldr r2, [r7, #8]
|
|
80092aa: 683b ldr r3, [r7, #0]
|
|
80092ac: 429a cmp r2, r3
|
|
80092ae: d302 bcc.n 80092b6 <prvInsertTimerInActiveList+0x62>
|
|
{
|
|
/* If, since the command was issued, the tick count has overflowed
|
|
but the expiry time has not, then the timer must have already passed
|
|
its expiry time and should be processed immediately. */
|
|
xProcessTimerNow = pdTRUE;
|
|
80092b0: 2301 movs r3, #1
|
|
80092b2: 617b str r3, [r7, #20]
|
|
80092b4: e007 b.n 80092c6 <prvInsertTimerInActiveList+0x72>
|
|
}
|
|
else
|
|
{
|
|
vListInsert( pxCurrentTimerList, &( pxTimer->xTimerListItem ) );
|
|
80092b6: 4b07 ldr r3, [pc, #28] @ (80092d4 <prvInsertTimerInActiveList+0x80>)
|
|
80092b8: 681a ldr r2, [r3, #0]
|
|
80092ba: 68fb ldr r3, [r7, #12]
|
|
80092bc: 3304 adds r3, #4
|
|
80092be: 4619 mov r1, r3
|
|
80092c0: 4610 mov r0, r2
|
|
80092c2: f7fd fd0a bl 8006cda <vListInsert>
|
|
}
|
|
}
|
|
|
|
return xProcessTimerNow;
|
|
80092c6: 697b ldr r3, [r7, #20]
|
|
}
|
|
80092c8: 4618 mov r0, r3
|
|
80092ca: 3718 adds r7, #24
|
|
80092cc: 46bd mov sp, r7
|
|
80092ce: bd80 pop {r7, pc}
|
|
80092d0: 20000fec .word 0x20000fec
|
|
80092d4: 20000fe8 .word 0x20000fe8
|
|
|
|
080092d8 <prvProcessReceivedCommands>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
static void prvProcessReceivedCommands( void )
|
|
{
|
|
80092d8: b580 push {r7, lr}
|
|
80092da: b08e sub sp, #56 @ 0x38
|
|
80092dc: af02 add r7, sp, #8
|
|
DaemonTaskMessage_t xMessage;
|
|
Timer_t *pxTimer;
|
|
BaseType_t xTimerListsWereSwitched, xResult;
|
|
TickType_t xTimeNow;
|
|
|
|
while( xQueueReceive( xTimerQueue, &xMessage, tmrNO_DELAY ) != pdFAIL ) /*lint !e603 xMessage does not have to be initialised as it is passed out, not in, and it is not used unless xQueueReceive() returns pdTRUE. */
|
|
80092de: e0ce b.n 800947e <prvProcessReceivedCommands+0x1a6>
|
|
{
|
|
#if ( INCLUDE_xTimerPendFunctionCall == 1 )
|
|
{
|
|
/* Negative commands are pended function calls rather than timer
|
|
commands. */
|
|
if( xMessage.xMessageID < ( BaseType_t ) 0 )
|
|
80092e0: 687b ldr r3, [r7, #4]
|
|
80092e2: 2b00 cmp r3, #0
|
|
80092e4: da19 bge.n 800931a <prvProcessReceivedCommands+0x42>
|
|
{
|
|
const CallbackParameters_t * const pxCallback = &( xMessage.u.xCallbackParameters );
|
|
80092e6: 1d3b adds r3, r7, #4
|
|
80092e8: 3304 adds r3, #4
|
|
80092ea: 62fb str r3, [r7, #44] @ 0x2c
|
|
|
|
/* The timer uses the xCallbackParameters member to request a
|
|
callback be executed. Check the callback is not NULL. */
|
|
configASSERT( pxCallback );
|
|
80092ec: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
80092ee: 2b00 cmp r3, #0
|
|
80092f0: d10b bne.n 800930a <prvProcessReceivedCommands+0x32>
|
|
__asm volatile
|
|
80092f2: f04f 0350 mov.w r3, #80 @ 0x50
|
|
80092f6: f383 8811 msr BASEPRI, r3
|
|
80092fa: f3bf 8f6f isb sy
|
|
80092fe: f3bf 8f4f dsb sy
|
|
8009302: 61fb str r3, [r7, #28]
|
|
}
|
|
8009304: bf00 nop
|
|
8009306: bf00 nop
|
|
8009308: e7fd b.n 8009306 <prvProcessReceivedCommands+0x2e>
|
|
|
|
/* Call the function. */
|
|
pxCallback->pxCallbackFunction( pxCallback->pvParameter1, pxCallback->ulParameter2 );
|
|
800930a: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
800930c: 681b ldr r3, [r3, #0]
|
|
800930e: 6afa ldr r2, [r7, #44] @ 0x2c
|
|
8009310: 6850 ldr r0, [r2, #4]
|
|
8009312: 6afa ldr r2, [r7, #44] @ 0x2c
|
|
8009314: 6892 ldr r2, [r2, #8]
|
|
8009316: 4611 mov r1, r2
|
|
8009318: 4798 blx r3
|
|
}
|
|
#endif /* INCLUDE_xTimerPendFunctionCall */
|
|
|
|
/* Commands that are positive are timer commands rather than pended
|
|
function calls. */
|
|
if( xMessage.xMessageID >= ( BaseType_t ) 0 )
|
|
800931a: 687b ldr r3, [r7, #4]
|
|
800931c: 2b00 cmp r3, #0
|
|
800931e: f2c0 80ae blt.w 800947e <prvProcessReceivedCommands+0x1a6>
|
|
{
|
|
/* The messages uses the xTimerParameters member to work on a
|
|
software timer. */
|
|
pxTimer = xMessage.u.xTimerParameters.pxTimer;
|
|
8009322: 68fb ldr r3, [r7, #12]
|
|
8009324: 62bb str r3, [r7, #40] @ 0x28
|
|
|
|
if( listIS_CONTAINED_WITHIN( NULL, &( pxTimer->xTimerListItem ) ) == pdFALSE ) /*lint !e961. The cast is only redundant when NULL is passed into the macro. */
|
|
8009326: 6abb ldr r3, [r7, #40] @ 0x28
|
|
8009328: 695b ldr r3, [r3, #20]
|
|
800932a: 2b00 cmp r3, #0
|
|
800932c: d004 beq.n 8009338 <prvProcessReceivedCommands+0x60>
|
|
{
|
|
/* The timer is in a list, remove it. */
|
|
( void ) uxListRemove( &( pxTimer->xTimerListItem ) );
|
|
800932e: 6abb ldr r3, [r7, #40] @ 0x28
|
|
8009330: 3304 adds r3, #4
|
|
8009332: 4618 mov r0, r3
|
|
8009334: f7fd fd0a bl 8006d4c <uxListRemove>
|
|
it must be present in the function call. prvSampleTimeNow() must be
|
|
called after the message is received from xTimerQueue so there is no
|
|
possibility of a higher priority task adding a message to the message
|
|
queue with a time that is ahead of the timer daemon task (because it
|
|
pre-empted the timer daemon task after the xTimeNow value was set). */
|
|
xTimeNow = prvSampleTimeNow( &xTimerListsWereSwitched );
|
|
8009338: 463b mov r3, r7
|
|
800933a: 4618 mov r0, r3
|
|
800933c: f7ff ff6a bl 8009214 <prvSampleTimeNow>
|
|
8009340: 6278 str r0, [r7, #36] @ 0x24
|
|
|
|
switch( xMessage.xMessageID )
|
|
8009342: 687b ldr r3, [r7, #4]
|
|
8009344: 2b09 cmp r3, #9
|
|
8009346: f200 8097 bhi.w 8009478 <prvProcessReceivedCommands+0x1a0>
|
|
800934a: a201 add r2, pc, #4 @ (adr r2, 8009350 <prvProcessReceivedCommands+0x78>)
|
|
800934c: f852 f023 ldr.w pc, [r2, r3, lsl #2]
|
|
8009350: 08009379 .word 0x08009379
|
|
8009354: 08009379 .word 0x08009379
|
|
8009358: 08009379 .word 0x08009379
|
|
800935c: 080093ef .word 0x080093ef
|
|
8009360: 08009403 .word 0x08009403
|
|
8009364: 0800944f .word 0x0800944f
|
|
8009368: 08009379 .word 0x08009379
|
|
800936c: 08009379 .word 0x08009379
|
|
8009370: 080093ef .word 0x080093ef
|
|
8009374: 08009403 .word 0x08009403
|
|
case tmrCOMMAND_START_FROM_ISR :
|
|
case tmrCOMMAND_RESET :
|
|
case tmrCOMMAND_RESET_FROM_ISR :
|
|
case tmrCOMMAND_START_DONT_TRACE :
|
|
/* Start or restart a timer. */
|
|
pxTimer->ucStatus |= tmrSTATUS_IS_ACTIVE;
|
|
8009378: 6abb ldr r3, [r7, #40] @ 0x28
|
|
800937a: f893 3028 ldrb.w r3, [r3, #40] @ 0x28
|
|
800937e: f043 0301 orr.w r3, r3, #1
|
|
8009382: b2da uxtb r2, r3
|
|
8009384: 6abb ldr r3, [r7, #40] @ 0x28
|
|
8009386: f883 2028 strb.w r2, [r3, #40] @ 0x28
|
|
if( prvInsertTimerInActiveList( pxTimer, xMessage.u.xTimerParameters.xMessageValue + pxTimer->xTimerPeriodInTicks, xTimeNow, xMessage.u.xTimerParameters.xMessageValue ) != pdFALSE )
|
|
800938a: 68ba ldr r2, [r7, #8]
|
|
800938c: 6abb ldr r3, [r7, #40] @ 0x28
|
|
800938e: 699b ldr r3, [r3, #24]
|
|
8009390: 18d1 adds r1, r2, r3
|
|
8009392: 68bb ldr r3, [r7, #8]
|
|
8009394: 6a7a ldr r2, [r7, #36] @ 0x24
|
|
8009396: 6ab8 ldr r0, [r7, #40] @ 0x28
|
|
8009398: f7ff ff5c bl 8009254 <prvInsertTimerInActiveList>
|
|
800939c: 4603 mov r3, r0
|
|
800939e: 2b00 cmp r3, #0
|
|
80093a0: d06c beq.n 800947c <prvProcessReceivedCommands+0x1a4>
|
|
{
|
|
/* The timer expired before it was added to the active
|
|
timer list. Process it now. */
|
|
pxTimer->pxCallbackFunction( ( TimerHandle_t ) pxTimer );
|
|
80093a2: 6abb ldr r3, [r7, #40] @ 0x28
|
|
80093a4: 6a1b ldr r3, [r3, #32]
|
|
80093a6: 6ab8 ldr r0, [r7, #40] @ 0x28
|
|
80093a8: 4798 blx r3
|
|
traceTIMER_EXPIRED( pxTimer );
|
|
|
|
if( ( pxTimer->ucStatus & tmrSTATUS_IS_AUTORELOAD ) != 0 )
|
|
80093aa: 6abb ldr r3, [r7, #40] @ 0x28
|
|
80093ac: f893 3028 ldrb.w r3, [r3, #40] @ 0x28
|
|
80093b0: f003 0304 and.w r3, r3, #4
|
|
80093b4: 2b00 cmp r3, #0
|
|
80093b6: d061 beq.n 800947c <prvProcessReceivedCommands+0x1a4>
|
|
{
|
|
xResult = xTimerGenericCommand( pxTimer, tmrCOMMAND_START_DONT_TRACE, xMessage.u.xTimerParameters.xMessageValue + pxTimer->xTimerPeriodInTicks, NULL, tmrNO_DELAY );
|
|
80093b8: 68ba ldr r2, [r7, #8]
|
|
80093ba: 6abb ldr r3, [r7, #40] @ 0x28
|
|
80093bc: 699b ldr r3, [r3, #24]
|
|
80093be: 441a add r2, r3
|
|
80093c0: 2300 movs r3, #0
|
|
80093c2: 9300 str r3, [sp, #0]
|
|
80093c4: 2300 movs r3, #0
|
|
80093c6: 2100 movs r1, #0
|
|
80093c8: 6ab8 ldr r0, [r7, #40] @ 0x28
|
|
80093ca: f7ff fe01 bl 8008fd0 <xTimerGenericCommand>
|
|
80093ce: 6238 str r0, [r7, #32]
|
|
configASSERT( xResult );
|
|
80093d0: 6a3b ldr r3, [r7, #32]
|
|
80093d2: 2b00 cmp r3, #0
|
|
80093d4: d152 bne.n 800947c <prvProcessReceivedCommands+0x1a4>
|
|
__asm volatile
|
|
80093d6: f04f 0350 mov.w r3, #80 @ 0x50
|
|
80093da: f383 8811 msr BASEPRI, r3
|
|
80093de: f3bf 8f6f isb sy
|
|
80093e2: f3bf 8f4f dsb sy
|
|
80093e6: 61bb str r3, [r7, #24]
|
|
}
|
|
80093e8: bf00 nop
|
|
80093ea: bf00 nop
|
|
80093ec: e7fd b.n 80093ea <prvProcessReceivedCommands+0x112>
|
|
break;
|
|
|
|
case tmrCOMMAND_STOP :
|
|
case tmrCOMMAND_STOP_FROM_ISR :
|
|
/* The timer has already been removed from the active list. */
|
|
pxTimer->ucStatus &= ~tmrSTATUS_IS_ACTIVE;
|
|
80093ee: 6abb ldr r3, [r7, #40] @ 0x28
|
|
80093f0: f893 3028 ldrb.w r3, [r3, #40] @ 0x28
|
|
80093f4: f023 0301 bic.w r3, r3, #1
|
|
80093f8: b2da uxtb r2, r3
|
|
80093fa: 6abb ldr r3, [r7, #40] @ 0x28
|
|
80093fc: f883 2028 strb.w r2, [r3, #40] @ 0x28
|
|
break;
|
|
8009400: e03d b.n 800947e <prvProcessReceivedCommands+0x1a6>
|
|
|
|
case tmrCOMMAND_CHANGE_PERIOD :
|
|
case tmrCOMMAND_CHANGE_PERIOD_FROM_ISR :
|
|
pxTimer->ucStatus |= tmrSTATUS_IS_ACTIVE;
|
|
8009402: 6abb ldr r3, [r7, #40] @ 0x28
|
|
8009404: f893 3028 ldrb.w r3, [r3, #40] @ 0x28
|
|
8009408: f043 0301 orr.w r3, r3, #1
|
|
800940c: b2da uxtb r2, r3
|
|
800940e: 6abb ldr r3, [r7, #40] @ 0x28
|
|
8009410: f883 2028 strb.w r2, [r3, #40] @ 0x28
|
|
pxTimer->xTimerPeriodInTicks = xMessage.u.xTimerParameters.xMessageValue;
|
|
8009414: 68ba ldr r2, [r7, #8]
|
|
8009416: 6abb ldr r3, [r7, #40] @ 0x28
|
|
8009418: 619a str r2, [r3, #24]
|
|
configASSERT( ( pxTimer->xTimerPeriodInTicks > 0 ) );
|
|
800941a: 6abb ldr r3, [r7, #40] @ 0x28
|
|
800941c: 699b ldr r3, [r3, #24]
|
|
800941e: 2b00 cmp r3, #0
|
|
8009420: d10b bne.n 800943a <prvProcessReceivedCommands+0x162>
|
|
__asm volatile
|
|
8009422: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8009426: f383 8811 msr BASEPRI, r3
|
|
800942a: f3bf 8f6f isb sy
|
|
800942e: f3bf 8f4f dsb sy
|
|
8009432: 617b str r3, [r7, #20]
|
|
}
|
|
8009434: bf00 nop
|
|
8009436: bf00 nop
|
|
8009438: e7fd b.n 8009436 <prvProcessReceivedCommands+0x15e>
|
|
be longer or shorter than the old one. The command time is
|
|
therefore set to the current time, and as the period cannot
|
|
be zero the next expiry time can only be in the future,
|
|
meaning (unlike for the xTimerStart() case above) there is
|
|
no fail case that needs to be handled here. */
|
|
( void ) prvInsertTimerInActiveList( pxTimer, ( xTimeNow + pxTimer->xTimerPeriodInTicks ), xTimeNow, xTimeNow );
|
|
800943a: 6abb ldr r3, [r7, #40] @ 0x28
|
|
800943c: 699a ldr r2, [r3, #24]
|
|
800943e: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8009440: 18d1 adds r1, r2, r3
|
|
8009442: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8009444: 6a7a ldr r2, [r7, #36] @ 0x24
|
|
8009446: 6ab8 ldr r0, [r7, #40] @ 0x28
|
|
8009448: f7ff ff04 bl 8009254 <prvInsertTimerInActiveList>
|
|
break;
|
|
800944c: e017 b.n 800947e <prvProcessReceivedCommands+0x1a6>
|
|
#if ( configSUPPORT_DYNAMIC_ALLOCATION == 1 )
|
|
{
|
|
/* The timer has already been removed from the active list,
|
|
just free up the memory if the memory was dynamically
|
|
allocated. */
|
|
if( ( pxTimer->ucStatus & tmrSTATUS_IS_STATICALLY_ALLOCATED ) == ( uint8_t ) 0 )
|
|
800944e: 6abb ldr r3, [r7, #40] @ 0x28
|
|
8009450: f893 3028 ldrb.w r3, [r3, #40] @ 0x28
|
|
8009454: f003 0302 and.w r3, r3, #2
|
|
8009458: 2b00 cmp r3, #0
|
|
800945a: d103 bne.n 8009464 <prvProcessReceivedCommands+0x18c>
|
|
{
|
|
vPortFree( pxTimer );
|
|
800945c: 6ab8 ldr r0, [r7, #40] @ 0x28
|
|
800945e: f000 fc0b bl 8009c78 <vPortFree>
|
|
no need to free the memory - just mark the timer as
|
|
"not active". */
|
|
pxTimer->ucStatus &= ~tmrSTATUS_IS_ACTIVE;
|
|
}
|
|
#endif /* configSUPPORT_DYNAMIC_ALLOCATION */
|
|
break;
|
|
8009462: e00c b.n 800947e <prvProcessReceivedCommands+0x1a6>
|
|
pxTimer->ucStatus &= ~tmrSTATUS_IS_ACTIVE;
|
|
8009464: 6abb ldr r3, [r7, #40] @ 0x28
|
|
8009466: f893 3028 ldrb.w r3, [r3, #40] @ 0x28
|
|
800946a: f023 0301 bic.w r3, r3, #1
|
|
800946e: b2da uxtb r2, r3
|
|
8009470: 6abb ldr r3, [r7, #40] @ 0x28
|
|
8009472: f883 2028 strb.w r2, [r3, #40] @ 0x28
|
|
break;
|
|
8009476: e002 b.n 800947e <prvProcessReceivedCommands+0x1a6>
|
|
|
|
default :
|
|
/* Don't expect to get here. */
|
|
break;
|
|
8009478: bf00 nop
|
|
800947a: e000 b.n 800947e <prvProcessReceivedCommands+0x1a6>
|
|
break;
|
|
800947c: bf00 nop
|
|
while( xQueueReceive( xTimerQueue, &xMessage, tmrNO_DELAY ) != pdFAIL ) /*lint !e603 xMessage does not have to be initialised as it is passed out, not in, and it is not used unless xQueueReceive() returns pdTRUE. */
|
|
800947e: 4b08 ldr r3, [pc, #32] @ (80094a0 <prvProcessReceivedCommands+0x1c8>)
|
|
8009480: 681b ldr r3, [r3, #0]
|
|
8009482: 1d39 adds r1, r7, #4
|
|
8009484: 2200 movs r2, #0
|
|
8009486: 4618 mov r0, r3
|
|
8009488: f7fe f86e bl 8007568 <xQueueReceive>
|
|
800948c: 4603 mov r3, r0
|
|
800948e: 2b00 cmp r3, #0
|
|
8009490: f47f af26 bne.w 80092e0 <prvProcessReceivedCommands+0x8>
|
|
}
|
|
}
|
|
}
|
|
}
|
|
8009494: bf00 nop
|
|
8009496: bf00 nop
|
|
8009498: 3730 adds r7, #48 @ 0x30
|
|
800949a: 46bd mov sp, r7
|
|
800949c: bd80 pop {r7, pc}
|
|
800949e: bf00 nop
|
|
80094a0: 20000ff0 .word 0x20000ff0
|
|
|
|
080094a4 <prvSwitchTimerLists>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
static void prvSwitchTimerLists( void )
|
|
{
|
|
80094a4: b580 push {r7, lr}
|
|
80094a6: b088 sub sp, #32
|
|
80094a8: af02 add r7, sp, #8
|
|
|
|
/* The tick count has overflowed. The timer lists must be switched.
|
|
If there are any timers still referenced from the current timer list
|
|
then they must have expired and should be processed before the lists
|
|
are switched. */
|
|
while( listLIST_IS_EMPTY( pxCurrentTimerList ) == pdFALSE )
|
|
80094aa: e049 b.n 8009540 <prvSwitchTimerLists+0x9c>
|
|
{
|
|
xNextExpireTime = listGET_ITEM_VALUE_OF_HEAD_ENTRY( pxCurrentTimerList );
|
|
80094ac: 4b2e ldr r3, [pc, #184] @ (8009568 <prvSwitchTimerLists+0xc4>)
|
|
80094ae: 681b ldr r3, [r3, #0]
|
|
80094b0: 68db ldr r3, [r3, #12]
|
|
80094b2: 681b ldr r3, [r3, #0]
|
|
80094b4: 613b str r3, [r7, #16]
|
|
|
|
/* Remove the timer from the list. */
|
|
pxTimer = ( Timer_t * ) listGET_OWNER_OF_HEAD_ENTRY( pxCurrentTimerList ); /*lint !e9087 !e9079 void * is used as this macro is used with tasks and co-routines too. Alignment is known to be fine as the type of the pointer stored and retrieved is the same. */
|
|
80094b6: 4b2c ldr r3, [pc, #176] @ (8009568 <prvSwitchTimerLists+0xc4>)
|
|
80094b8: 681b ldr r3, [r3, #0]
|
|
80094ba: 68db ldr r3, [r3, #12]
|
|
80094bc: 68db ldr r3, [r3, #12]
|
|
80094be: 60fb str r3, [r7, #12]
|
|
( void ) uxListRemove( &( pxTimer->xTimerListItem ) );
|
|
80094c0: 68fb ldr r3, [r7, #12]
|
|
80094c2: 3304 adds r3, #4
|
|
80094c4: 4618 mov r0, r3
|
|
80094c6: f7fd fc41 bl 8006d4c <uxListRemove>
|
|
traceTIMER_EXPIRED( pxTimer );
|
|
|
|
/* Execute its callback, then send a command to restart the timer if
|
|
it is an auto-reload timer. It cannot be restarted here as the lists
|
|
have not yet been switched. */
|
|
pxTimer->pxCallbackFunction( ( TimerHandle_t ) pxTimer );
|
|
80094ca: 68fb ldr r3, [r7, #12]
|
|
80094cc: 6a1b ldr r3, [r3, #32]
|
|
80094ce: 68f8 ldr r0, [r7, #12]
|
|
80094d0: 4798 blx r3
|
|
|
|
if( ( pxTimer->ucStatus & tmrSTATUS_IS_AUTORELOAD ) != 0 )
|
|
80094d2: 68fb ldr r3, [r7, #12]
|
|
80094d4: f893 3028 ldrb.w r3, [r3, #40] @ 0x28
|
|
80094d8: f003 0304 and.w r3, r3, #4
|
|
80094dc: 2b00 cmp r3, #0
|
|
80094de: d02f beq.n 8009540 <prvSwitchTimerLists+0x9c>
|
|
the timer going into the same timer list then it has already expired
|
|
and the timer should be re-inserted into the current list so it is
|
|
processed again within this loop. Otherwise a command should be sent
|
|
to restart the timer to ensure it is only inserted into a list after
|
|
the lists have been swapped. */
|
|
xReloadTime = ( xNextExpireTime + pxTimer->xTimerPeriodInTicks );
|
|
80094e0: 68fb ldr r3, [r7, #12]
|
|
80094e2: 699b ldr r3, [r3, #24]
|
|
80094e4: 693a ldr r2, [r7, #16]
|
|
80094e6: 4413 add r3, r2
|
|
80094e8: 60bb str r3, [r7, #8]
|
|
if( xReloadTime > xNextExpireTime )
|
|
80094ea: 68ba ldr r2, [r7, #8]
|
|
80094ec: 693b ldr r3, [r7, #16]
|
|
80094ee: 429a cmp r2, r3
|
|
80094f0: d90e bls.n 8009510 <prvSwitchTimerLists+0x6c>
|
|
{
|
|
listSET_LIST_ITEM_VALUE( &( pxTimer->xTimerListItem ), xReloadTime );
|
|
80094f2: 68fb ldr r3, [r7, #12]
|
|
80094f4: 68ba ldr r2, [r7, #8]
|
|
80094f6: 605a str r2, [r3, #4]
|
|
listSET_LIST_ITEM_OWNER( &( pxTimer->xTimerListItem ), pxTimer );
|
|
80094f8: 68fb ldr r3, [r7, #12]
|
|
80094fa: 68fa ldr r2, [r7, #12]
|
|
80094fc: 611a str r2, [r3, #16]
|
|
vListInsert( pxCurrentTimerList, &( pxTimer->xTimerListItem ) );
|
|
80094fe: 4b1a ldr r3, [pc, #104] @ (8009568 <prvSwitchTimerLists+0xc4>)
|
|
8009500: 681a ldr r2, [r3, #0]
|
|
8009502: 68fb ldr r3, [r7, #12]
|
|
8009504: 3304 adds r3, #4
|
|
8009506: 4619 mov r1, r3
|
|
8009508: 4610 mov r0, r2
|
|
800950a: f7fd fbe6 bl 8006cda <vListInsert>
|
|
800950e: e017 b.n 8009540 <prvSwitchTimerLists+0x9c>
|
|
}
|
|
else
|
|
{
|
|
xResult = xTimerGenericCommand( pxTimer, tmrCOMMAND_START_DONT_TRACE, xNextExpireTime, NULL, tmrNO_DELAY );
|
|
8009510: 2300 movs r3, #0
|
|
8009512: 9300 str r3, [sp, #0]
|
|
8009514: 2300 movs r3, #0
|
|
8009516: 693a ldr r2, [r7, #16]
|
|
8009518: 2100 movs r1, #0
|
|
800951a: 68f8 ldr r0, [r7, #12]
|
|
800951c: f7ff fd58 bl 8008fd0 <xTimerGenericCommand>
|
|
8009520: 6078 str r0, [r7, #4]
|
|
configASSERT( xResult );
|
|
8009522: 687b ldr r3, [r7, #4]
|
|
8009524: 2b00 cmp r3, #0
|
|
8009526: d10b bne.n 8009540 <prvSwitchTimerLists+0x9c>
|
|
__asm volatile
|
|
8009528: f04f 0350 mov.w r3, #80 @ 0x50
|
|
800952c: f383 8811 msr BASEPRI, r3
|
|
8009530: f3bf 8f6f isb sy
|
|
8009534: f3bf 8f4f dsb sy
|
|
8009538: 603b str r3, [r7, #0]
|
|
}
|
|
800953a: bf00 nop
|
|
800953c: bf00 nop
|
|
800953e: e7fd b.n 800953c <prvSwitchTimerLists+0x98>
|
|
while( listLIST_IS_EMPTY( pxCurrentTimerList ) == pdFALSE )
|
|
8009540: 4b09 ldr r3, [pc, #36] @ (8009568 <prvSwitchTimerLists+0xc4>)
|
|
8009542: 681b ldr r3, [r3, #0]
|
|
8009544: 681b ldr r3, [r3, #0]
|
|
8009546: 2b00 cmp r3, #0
|
|
8009548: d1b0 bne.n 80094ac <prvSwitchTimerLists+0x8>
|
|
{
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
}
|
|
|
|
pxTemp = pxCurrentTimerList;
|
|
800954a: 4b07 ldr r3, [pc, #28] @ (8009568 <prvSwitchTimerLists+0xc4>)
|
|
800954c: 681b ldr r3, [r3, #0]
|
|
800954e: 617b str r3, [r7, #20]
|
|
pxCurrentTimerList = pxOverflowTimerList;
|
|
8009550: 4b06 ldr r3, [pc, #24] @ (800956c <prvSwitchTimerLists+0xc8>)
|
|
8009552: 681b ldr r3, [r3, #0]
|
|
8009554: 4a04 ldr r2, [pc, #16] @ (8009568 <prvSwitchTimerLists+0xc4>)
|
|
8009556: 6013 str r3, [r2, #0]
|
|
pxOverflowTimerList = pxTemp;
|
|
8009558: 4a04 ldr r2, [pc, #16] @ (800956c <prvSwitchTimerLists+0xc8>)
|
|
800955a: 697b ldr r3, [r7, #20]
|
|
800955c: 6013 str r3, [r2, #0]
|
|
}
|
|
800955e: bf00 nop
|
|
8009560: 3718 adds r7, #24
|
|
8009562: 46bd mov sp, r7
|
|
8009564: bd80 pop {r7, pc}
|
|
8009566: bf00 nop
|
|
8009568: 20000fe8 .word 0x20000fe8
|
|
800956c: 20000fec .word 0x20000fec
|
|
|
|
08009570 <prvCheckForValidListAndQueue>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
static void prvCheckForValidListAndQueue( void )
|
|
{
|
|
8009570: b580 push {r7, lr}
|
|
8009572: b082 sub sp, #8
|
|
8009574: af02 add r7, sp, #8
|
|
/* Check that the list from which active timers are referenced, and the
|
|
queue used to communicate with the timer service, have been
|
|
initialised. */
|
|
taskENTER_CRITICAL();
|
|
8009576: f000 f98f bl 8009898 <vPortEnterCritical>
|
|
{
|
|
if( xTimerQueue == NULL )
|
|
800957a: 4b15 ldr r3, [pc, #84] @ (80095d0 <prvCheckForValidListAndQueue+0x60>)
|
|
800957c: 681b ldr r3, [r3, #0]
|
|
800957e: 2b00 cmp r3, #0
|
|
8009580: d120 bne.n 80095c4 <prvCheckForValidListAndQueue+0x54>
|
|
{
|
|
vListInitialise( &xActiveTimerList1 );
|
|
8009582: 4814 ldr r0, [pc, #80] @ (80095d4 <prvCheckForValidListAndQueue+0x64>)
|
|
8009584: f7fd fb58 bl 8006c38 <vListInitialise>
|
|
vListInitialise( &xActiveTimerList2 );
|
|
8009588: 4813 ldr r0, [pc, #76] @ (80095d8 <prvCheckForValidListAndQueue+0x68>)
|
|
800958a: f7fd fb55 bl 8006c38 <vListInitialise>
|
|
pxCurrentTimerList = &xActiveTimerList1;
|
|
800958e: 4b13 ldr r3, [pc, #76] @ (80095dc <prvCheckForValidListAndQueue+0x6c>)
|
|
8009590: 4a10 ldr r2, [pc, #64] @ (80095d4 <prvCheckForValidListAndQueue+0x64>)
|
|
8009592: 601a str r2, [r3, #0]
|
|
pxOverflowTimerList = &xActiveTimerList2;
|
|
8009594: 4b12 ldr r3, [pc, #72] @ (80095e0 <prvCheckForValidListAndQueue+0x70>)
|
|
8009596: 4a10 ldr r2, [pc, #64] @ (80095d8 <prvCheckForValidListAndQueue+0x68>)
|
|
8009598: 601a str r2, [r3, #0]
|
|
/* The timer queue is allocated statically in case
|
|
configSUPPORT_DYNAMIC_ALLOCATION is 0. */
|
|
static StaticQueue_t xStaticTimerQueue; /*lint !e956 Ok to declare in this manner to prevent additional conditional compilation guards in other locations. */
|
|
static uint8_t ucStaticTimerQueueStorage[ ( size_t ) configTIMER_QUEUE_LENGTH * sizeof( DaemonTaskMessage_t ) ]; /*lint !e956 Ok to declare in this manner to prevent additional conditional compilation guards in other locations. */
|
|
|
|
xTimerQueue = xQueueCreateStatic( ( UBaseType_t ) configTIMER_QUEUE_LENGTH, ( UBaseType_t ) sizeof( DaemonTaskMessage_t ), &( ucStaticTimerQueueStorage[ 0 ] ), &xStaticTimerQueue );
|
|
800959a: 2300 movs r3, #0
|
|
800959c: 9300 str r3, [sp, #0]
|
|
800959e: 4b11 ldr r3, [pc, #68] @ (80095e4 <prvCheckForValidListAndQueue+0x74>)
|
|
80095a0: 4a11 ldr r2, [pc, #68] @ (80095e8 <prvCheckForValidListAndQueue+0x78>)
|
|
80095a2: 2110 movs r1, #16
|
|
80095a4: 200a movs r0, #10
|
|
80095a6: f7fd fc65 bl 8006e74 <xQueueGenericCreateStatic>
|
|
80095aa: 4603 mov r3, r0
|
|
80095ac: 4a08 ldr r2, [pc, #32] @ (80095d0 <prvCheckForValidListAndQueue+0x60>)
|
|
80095ae: 6013 str r3, [r2, #0]
|
|
}
|
|
#endif
|
|
|
|
#if ( configQUEUE_REGISTRY_SIZE > 0 )
|
|
{
|
|
if( xTimerQueue != NULL )
|
|
80095b0: 4b07 ldr r3, [pc, #28] @ (80095d0 <prvCheckForValidListAndQueue+0x60>)
|
|
80095b2: 681b ldr r3, [r3, #0]
|
|
80095b4: 2b00 cmp r3, #0
|
|
80095b6: d005 beq.n 80095c4 <prvCheckForValidListAndQueue+0x54>
|
|
{
|
|
vQueueAddToRegistry( xTimerQueue, "TmrQ" );
|
|
80095b8: 4b05 ldr r3, [pc, #20] @ (80095d0 <prvCheckForValidListAndQueue+0x60>)
|
|
80095ba: 681b ldr r3, [r3, #0]
|
|
80095bc: 490b ldr r1, [pc, #44] @ (80095ec <prvCheckForValidListAndQueue+0x7c>)
|
|
80095be: 4618 mov r0, r3
|
|
80095c0: f7fe fb92 bl 8007ce8 <vQueueAddToRegistry>
|
|
else
|
|
{
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
}
|
|
taskEXIT_CRITICAL();
|
|
80095c4: f000 f99a bl 80098fc <vPortExitCritical>
|
|
}
|
|
80095c8: bf00 nop
|
|
80095ca: 46bd mov sp, r7
|
|
80095cc: bd80 pop {r7, pc}
|
|
80095ce: bf00 nop
|
|
80095d0: 20000ff0 .word 0x20000ff0
|
|
80095d4: 20000fc0 .word 0x20000fc0
|
|
80095d8: 20000fd4 .word 0x20000fd4
|
|
80095dc: 20000fe8 .word 0x20000fe8
|
|
80095e0: 20000fec .word 0x20000fec
|
|
80095e4: 2000109c .word 0x2000109c
|
|
80095e8: 20000ffc .word 0x20000ffc
|
|
80095ec: 0800a298 .word 0x0800a298
|
|
|
|
080095f0 <pvTimerGetTimerID>:
|
|
return xReturn;
|
|
} /*lint !e818 Can't be pointer to const due to the typedef. */
|
|
/*-----------------------------------------------------------*/
|
|
|
|
void *pvTimerGetTimerID( const TimerHandle_t xTimer )
|
|
{
|
|
80095f0: b580 push {r7, lr}
|
|
80095f2: b086 sub sp, #24
|
|
80095f4: af00 add r7, sp, #0
|
|
80095f6: 6078 str r0, [r7, #4]
|
|
Timer_t * const pxTimer = xTimer;
|
|
80095f8: 687b ldr r3, [r7, #4]
|
|
80095fa: 617b str r3, [r7, #20]
|
|
void *pvReturn;
|
|
|
|
configASSERT( xTimer );
|
|
80095fc: 687b ldr r3, [r7, #4]
|
|
80095fe: 2b00 cmp r3, #0
|
|
8009600: d10b bne.n 800961a <pvTimerGetTimerID+0x2a>
|
|
__asm volatile
|
|
8009602: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8009606: f383 8811 msr BASEPRI, r3
|
|
800960a: f3bf 8f6f isb sy
|
|
800960e: f3bf 8f4f dsb sy
|
|
8009612: 60fb str r3, [r7, #12]
|
|
}
|
|
8009614: bf00 nop
|
|
8009616: bf00 nop
|
|
8009618: e7fd b.n 8009616 <pvTimerGetTimerID+0x26>
|
|
|
|
taskENTER_CRITICAL();
|
|
800961a: f000 f93d bl 8009898 <vPortEnterCritical>
|
|
{
|
|
pvReturn = pxTimer->pvTimerID;
|
|
800961e: 697b ldr r3, [r7, #20]
|
|
8009620: 69db ldr r3, [r3, #28]
|
|
8009622: 613b str r3, [r7, #16]
|
|
}
|
|
taskEXIT_CRITICAL();
|
|
8009624: f000 f96a bl 80098fc <vPortExitCritical>
|
|
|
|
return pvReturn;
|
|
8009628: 693b ldr r3, [r7, #16]
|
|
}
|
|
800962a: 4618 mov r0, r3
|
|
800962c: 3718 adds r7, #24
|
|
800962e: 46bd mov sp, r7
|
|
8009630: bd80 pop {r7, pc}
|
|
...
|
|
|
|
08009634 <pxPortInitialiseStack>:
|
|
|
|
/*
|
|
* See header file for description.
|
|
*/
|
|
StackType_t *pxPortInitialiseStack( StackType_t *pxTopOfStack, TaskFunction_t pxCode, void *pvParameters )
|
|
{
|
|
8009634: b480 push {r7}
|
|
8009636: b085 sub sp, #20
|
|
8009638: af00 add r7, sp, #0
|
|
800963a: 60f8 str r0, [r7, #12]
|
|
800963c: 60b9 str r1, [r7, #8]
|
|
800963e: 607a str r2, [r7, #4]
|
|
/* Simulate the stack frame as it would be created by a context switch
|
|
interrupt. */
|
|
|
|
/* Offset added to account for the way the MCU uses the stack on entry/exit
|
|
of interrupts, and to ensure alignment. */
|
|
pxTopOfStack--;
|
|
8009640: 68fb ldr r3, [r7, #12]
|
|
8009642: 3b04 subs r3, #4
|
|
8009644: 60fb str r3, [r7, #12]
|
|
|
|
*pxTopOfStack = portINITIAL_XPSR; /* xPSR */
|
|
8009646: 68fb ldr r3, [r7, #12]
|
|
8009648: f04f 7280 mov.w r2, #16777216 @ 0x1000000
|
|
800964c: 601a str r2, [r3, #0]
|
|
pxTopOfStack--;
|
|
800964e: 68fb ldr r3, [r7, #12]
|
|
8009650: 3b04 subs r3, #4
|
|
8009652: 60fb str r3, [r7, #12]
|
|
*pxTopOfStack = ( ( StackType_t ) pxCode ) & portSTART_ADDRESS_MASK; /* PC */
|
|
8009654: 68bb ldr r3, [r7, #8]
|
|
8009656: f023 0201 bic.w r2, r3, #1
|
|
800965a: 68fb ldr r3, [r7, #12]
|
|
800965c: 601a str r2, [r3, #0]
|
|
pxTopOfStack--;
|
|
800965e: 68fb ldr r3, [r7, #12]
|
|
8009660: 3b04 subs r3, #4
|
|
8009662: 60fb str r3, [r7, #12]
|
|
*pxTopOfStack = ( StackType_t ) portTASK_RETURN_ADDRESS; /* LR */
|
|
8009664: 4a0c ldr r2, [pc, #48] @ (8009698 <pxPortInitialiseStack+0x64>)
|
|
8009666: 68fb ldr r3, [r7, #12]
|
|
8009668: 601a str r2, [r3, #0]
|
|
|
|
/* Save code space by skipping register initialisation. */
|
|
pxTopOfStack -= 5; /* R12, R3, R2 and R1. */
|
|
800966a: 68fb ldr r3, [r7, #12]
|
|
800966c: 3b14 subs r3, #20
|
|
800966e: 60fb str r3, [r7, #12]
|
|
*pxTopOfStack = ( StackType_t ) pvParameters; /* R0 */
|
|
8009670: 687a ldr r2, [r7, #4]
|
|
8009672: 68fb ldr r3, [r7, #12]
|
|
8009674: 601a str r2, [r3, #0]
|
|
|
|
/* A save method is being used that requires each task to maintain its
|
|
own exec return value. */
|
|
pxTopOfStack--;
|
|
8009676: 68fb ldr r3, [r7, #12]
|
|
8009678: 3b04 subs r3, #4
|
|
800967a: 60fb str r3, [r7, #12]
|
|
*pxTopOfStack = portINITIAL_EXC_RETURN;
|
|
800967c: 68fb ldr r3, [r7, #12]
|
|
800967e: f06f 0202 mvn.w r2, #2
|
|
8009682: 601a str r2, [r3, #0]
|
|
|
|
pxTopOfStack -= 8; /* R11, R10, R9, R8, R7, R6, R5 and R4. */
|
|
8009684: 68fb ldr r3, [r7, #12]
|
|
8009686: 3b20 subs r3, #32
|
|
8009688: 60fb str r3, [r7, #12]
|
|
|
|
return pxTopOfStack;
|
|
800968a: 68fb ldr r3, [r7, #12]
|
|
}
|
|
800968c: 4618 mov r0, r3
|
|
800968e: 3714 adds r7, #20
|
|
8009690: 46bd mov sp, r7
|
|
8009692: f85d 7b04 ldr.w r7, [sp], #4
|
|
8009696: 4770 bx lr
|
|
8009698: 0800969d .word 0x0800969d
|
|
|
|
0800969c <prvTaskExitError>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
static void prvTaskExitError( void )
|
|
{
|
|
800969c: b480 push {r7}
|
|
800969e: b085 sub sp, #20
|
|
80096a0: af00 add r7, sp, #0
|
|
volatile uint32_t ulDummy = 0;
|
|
80096a2: 2300 movs r3, #0
|
|
80096a4: 607b str r3, [r7, #4]
|
|
its caller as there is nothing to return to. If a task wants to exit it
|
|
should instead call vTaskDelete( NULL ).
|
|
|
|
Artificially force an assert() to be triggered if configASSERT() is
|
|
defined, then stop here so application writers can catch the error. */
|
|
configASSERT( uxCriticalNesting == ~0UL );
|
|
80096a6: 4b13 ldr r3, [pc, #76] @ (80096f4 <prvTaskExitError+0x58>)
|
|
80096a8: 681b ldr r3, [r3, #0]
|
|
80096aa: f1b3 3fff cmp.w r3, #4294967295 @ 0xffffffff
|
|
80096ae: d00b beq.n 80096c8 <prvTaskExitError+0x2c>
|
|
__asm volatile
|
|
80096b0: f04f 0350 mov.w r3, #80 @ 0x50
|
|
80096b4: f383 8811 msr BASEPRI, r3
|
|
80096b8: f3bf 8f6f isb sy
|
|
80096bc: f3bf 8f4f dsb sy
|
|
80096c0: 60fb str r3, [r7, #12]
|
|
}
|
|
80096c2: bf00 nop
|
|
80096c4: bf00 nop
|
|
80096c6: e7fd b.n 80096c4 <prvTaskExitError+0x28>
|
|
__asm volatile
|
|
80096c8: f04f 0350 mov.w r3, #80 @ 0x50
|
|
80096cc: f383 8811 msr BASEPRI, r3
|
|
80096d0: f3bf 8f6f isb sy
|
|
80096d4: f3bf 8f4f dsb sy
|
|
80096d8: 60bb str r3, [r7, #8]
|
|
}
|
|
80096da: bf00 nop
|
|
portDISABLE_INTERRUPTS();
|
|
while( ulDummy == 0 )
|
|
80096dc: bf00 nop
|
|
80096de: 687b ldr r3, [r7, #4]
|
|
80096e0: 2b00 cmp r3, #0
|
|
80096e2: d0fc beq.n 80096de <prvTaskExitError+0x42>
|
|
about code appearing after this function is called - making ulDummy
|
|
volatile makes the compiler think the function could return and
|
|
therefore not output an 'unreachable code' warning for code that appears
|
|
after it. */
|
|
}
|
|
}
|
|
80096e4: bf00 nop
|
|
80096e6: bf00 nop
|
|
80096e8: 3714 adds r7, #20
|
|
80096ea: 46bd mov sp, r7
|
|
80096ec: f85d 7b04 ldr.w r7, [sp], #4
|
|
80096f0: 4770 bx lr
|
|
80096f2: bf00 nop
|
|
80096f4: 20000024 .word 0x20000024
|
|
...
|
|
|
|
08009700 <SVC_Handler>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
void vPortSVCHandler( void )
|
|
{
|
|
__asm volatile (
|
|
8009700: 4b07 ldr r3, [pc, #28] @ (8009720 <pxCurrentTCBConst2>)
|
|
8009702: 6819 ldr r1, [r3, #0]
|
|
8009704: 6808 ldr r0, [r1, #0]
|
|
8009706: e8b0 4ff0 ldmia.w r0!, {r4, r5, r6, r7, r8, r9, sl, fp, lr}
|
|
800970a: f380 8809 msr PSP, r0
|
|
800970e: f3bf 8f6f isb sy
|
|
8009712: f04f 0000 mov.w r0, #0
|
|
8009716: f380 8811 msr BASEPRI, r0
|
|
800971a: 4770 bx lr
|
|
800971c: f3af 8000 nop.w
|
|
|
|
08009720 <pxCurrentTCBConst2>:
|
|
8009720: 20000ac0 .word 0x20000ac0
|
|
" bx r14 \n"
|
|
" \n"
|
|
" .align 4 \n"
|
|
"pxCurrentTCBConst2: .word pxCurrentTCB \n"
|
|
);
|
|
}
|
|
8009724: bf00 nop
|
|
8009726: bf00 nop
|
|
|
|
08009728 <prvPortStartFirstTask>:
|
|
{
|
|
/* Start the first task. This also clears the bit that indicates the FPU is
|
|
in use in case the FPU was used before the scheduler was started - which
|
|
would otherwise result in the unnecessary leaving of space in the SVC stack
|
|
for lazy saving of FPU registers. */
|
|
__asm volatile(
|
|
8009728: 4808 ldr r0, [pc, #32] @ (800974c <prvPortStartFirstTask+0x24>)
|
|
800972a: 6800 ldr r0, [r0, #0]
|
|
800972c: 6800 ldr r0, [r0, #0]
|
|
800972e: f380 8808 msr MSP, r0
|
|
8009732: f04f 0000 mov.w r0, #0
|
|
8009736: f380 8814 msr CONTROL, r0
|
|
800973a: b662 cpsie i
|
|
800973c: b661 cpsie f
|
|
800973e: f3bf 8f4f dsb sy
|
|
8009742: f3bf 8f6f isb sy
|
|
8009746: df00 svc 0
|
|
8009748: bf00 nop
|
|
" dsb \n"
|
|
" isb \n"
|
|
" svc 0 \n" /* System call to start first task. */
|
|
" nop \n"
|
|
);
|
|
}
|
|
800974a: bf00 nop
|
|
800974c: e000ed08 .word 0xe000ed08
|
|
|
|
08009750 <xPortStartScheduler>:
|
|
|
|
/*
|
|
* See header file for description.
|
|
*/
|
|
BaseType_t xPortStartScheduler( void )
|
|
{
|
|
8009750: b580 push {r7, lr}
|
|
8009752: b086 sub sp, #24
|
|
8009754: af00 add r7, sp, #0
|
|
configASSERT( configMAX_SYSCALL_INTERRUPT_PRIORITY );
|
|
|
|
/* This port can be used on all revisions of the Cortex-M7 core other than
|
|
the r0p1 parts. r0p1 parts should use the port from the
|
|
/source/portable/GCC/ARM_CM7/r0p1 directory. */
|
|
configASSERT( portCPUID != portCORTEX_M7_r0p1_ID );
|
|
8009756: 4b47 ldr r3, [pc, #284] @ (8009874 <xPortStartScheduler+0x124>)
|
|
8009758: 681b ldr r3, [r3, #0]
|
|
800975a: 4a47 ldr r2, [pc, #284] @ (8009878 <xPortStartScheduler+0x128>)
|
|
800975c: 4293 cmp r3, r2
|
|
800975e: d10b bne.n 8009778 <xPortStartScheduler+0x28>
|
|
__asm volatile
|
|
8009760: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8009764: f383 8811 msr BASEPRI, r3
|
|
8009768: f3bf 8f6f isb sy
|
|
800976c: f3bf 8f4f dsb sy
|
|
8009770: 60fb str r3, [r7, #12]
|
|
}
|
|
8009772: bf00 nop
|
|
8009774: bf00 nop
|
|
8009776: e7fd b.n 8009774 <xPortStartScheduler+0x24>
|
|
configASSERT( portCPUID != portCORTEX_M7_r0p0_ID );
|
|
8009778: 4b3e ldr r3, [pc, #248] @ (8009874 <xPortStartScheduler+0x124>)
|
|
800977a: 681b ldr r3, [r3, #0]
|
|
800977c: 4a3f ldr r2, [pc, #252] @ (800987c <xPortStartScheduler+0x12c>)
|
|
800977e: 4293 cmp r3, r2
|
|
8009780: d10b bne.n 800979a <xPortStartScheduler+0x4a>
|
|
__asm volatile
|
|
8009782: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8009786: f383 8811 msr BASEPRI, r3
|
|
800978a: f3bf 8f6f isb sy
|
|
800978e: f3bf 8f4f dsb sy
|
|
8009792: 613b str r3, [r7, #16]
|
|
}
|
|
8009794: bf00 nop
|
|
8009796: bf00 nop
|
|
8009798: e7fd b.n 8009796 <xPortStartScheduler+0x46>
|
|
|
|
#if( configASSERT_DEFINED == 1 )
|
|
{
|
|
volatile uint32_t ulOriginalPriority;
|
|
volatile uint8_t * const pucFirstUserPriorityRegister = ( volatile uint8_t * const ) ( portNVIC_IP_REGISTERS_OFFSET_16 + portFIRST_USER_INTERRUPT_NUMBER );
|
|
800979a: 4b39 ldr r3, [pc, #228] @ (8009880 <xPortStartScheduler+0x130>)
|
|
800979c: 617b str r3, [r7, #20]
|
|
functions can be called. ISR safe functions are those that end in
|
|
"FromISR". FreeRTOS maintains separate thread and ISR API functions to
|
|
ensure interrupt entry is as fast and simple as possible.
|
|
|
|
Save the interrupt priority value that is about to be clobbered. */
|
|
ulOriginalPriority = *pucFirstUserPriorityRegister;
|
|
800979e: 697b ldr r3, [r7, #20]
|
|
80097a0: 781b ldrb r3, [r3, #0]
|
|
80097a2: b2db uxtb r3, r3
|
|
80097a4: 607b str r3, [r7, #4]
|
|
|
|
/* Determine the number of priority bits available. First write to all
|
|
possible bits. */
|
|
*pucFirstUserPriorityRegister = portMAX_8_BIT_VALUE;
|
|
80097a6: 697b ldr r3, [r7, #20]
|
|
80097a8: 22ff movs r2, #255 @ 0xff
|
|
80097aa: 701a strb r2, [r3, #0]
|
|
|
|
/* Read the value back to see how many bits stuck. */
|
|
ucMaxPriorityValue = *pucFirstUserPriorityRegister;
|
|
80097ac: 697b ldr r3, [r7, #20]
|
|
80097ae: 781b ldrb r3, [r3, #0]
|
|
80097b0: b2db uxtb r3, r3
|
|
80097b2: 70fb strb r3, [r7, #3]
|
|
|
|
/* Use the same mask on the maximum system call priority. */
|
|
ucMaxSysCallPriority = configMAX_SYSCALL_INTERRUPT_PRIORITY & ucMaxPriorityValue;
|
|
80097b4: 78fb ldrb r3, [r7, #3]
|
|
80097b6: b2db uxtb r3, r3
|
|
80097b8: f003 0350 and.w r3, r3, #80 @ 0x50
|
|
80097bc: b2da uxtb r2, r3
|
|
80097be: 4b31 ldr r3, [pc, #196] @ (8009884 <xPortStartScheduler+0x134>)
|
|
80097c0: 701a strb r2, [r3, #0]
|
|
|
|
/* Calculate the maximum acceptable priority group value for the number
|
|
of bits read back. */
|
|
ulMaxPRIGROUPValue = portMAX_PRIGROUP_BITS;
|
|
80097c2: 4b31 ldr r3, [pc, #196] @ (8009888 <xPortStartScheduler+0x138>)
|
|
80097c4: 2207 movs r2, #7
|
|
80097c6: 601a str r2, [r3, #0]
|
|
while( ( ucMaxPriorityValue & portTOP_BIT_OF_BYTE ) == portTOP_BIT_OF_BYTE )
|
|
80097c8: e009 b.n 80097de <xPortStartScheduler+0x8e>
|
|
{
|
|
ulMaxPRIGROUPValue--;
|
|
80097ca: 4b2f ldr r3, [pc, #188] @ (8009888 <xPortStartScheduler+0x138>)
|
|
80097cc: 681b ldr r3, [r3, #0]
|
|
80097ce: 3b01 subs r3, #1
|
|
80097d0: 4a2d ldr r2, [pc, #180] @ (8009888 <xPortStartScheduler+0x138>)
|
|
80097d2: 6013 str r3, [r2, #0]
|
|
ucMaxPriorityValue <<= ( uint8_t ) 0x01;
|
|
80097d4: 78fb ldrb r3, [r7, #3]
|
|
80097d6: b2db uxtb r3, r3
|
|
80097d8: 005b lsls r3, r3, #1
|
|
80097da: b2db uxtb r3, r3
|
|
80097dc: 70fb strb r3, [r7, #3]
|
|
while( ( ucMaxPriorityValue & portTOP_BIT_OF_BYTE ) == portTOP_BIT_OF_BYTE )
|
|
80097de: 78fb ldrb r3, [r7, #3]
|
|
80097e0: b2db uxtb r3, r3
|
|
80097e2: f003 0380 and.w r3, r3, #128 @ 0x80
|
|
80097e6: 2b80 cmp r3, #128 @ 0x80
|
|
80097e8: d0ef beq.n 80097ca <xPortStartScheduler+0x7a>
|
|
#ifdef configPRIO_BITS
|
|
{
|
|
/* Check the FreeRTOS configuration that defines the number of
|
|
priority bits matches the number of priority bits actually queried
|
|
from the hardware. */
|
|
configASSERT( ( portMAX_PRIGROUP_BITS - ulMaxPRIGROUPValue ) == configPRIO_BITS );
|
|
80097ea: 4b27 ldr r3, [pc, #156] @ (8009888 <xPortStartScheduler+0x138>)
|
|
80097ec: 681b ldr r3, [r3, #0]
|
|
80097ee: f1c3 0307 rsb r3, r3, #7
|
|
80097f2: 2b04 cmp r3, #4
|
|
80097f4: d00b beq.n 800980e <xPortStartScheduler+0xbe>
|
|
__asm volatile
|
|
80097f6: f04f 0350 mov.w r3, #80 @ 0x50
|
|
80097fa: f383 8811 msr BASEPRI, r3
|
|
80097fe: f3bf 8f6f isb sy
|
|
8009802: f3bf 8f4f dsb sy
|
|
8009806: 60bb str r3, [r7, #8]
|
|
}
|
|
8009808: bf00 nop
|
|
800980a: bf00 nop
|
|
800980c: e7fd b.n 800980a <xPortStartScheduler+0xba>
|
|
}
|
|
#endif
|
|
|
|
/* Shift the priority group value back to its position within the AIRCR
|
|
register. */
|
|
ulMaxPRIGROUPValue <<= portPRIGROUP_SHIFT;
|
|
800980e: 4b1e ldr r3, [pc, #120] @ (8009888 <xPortStartScheduler+0x138>)
|
|
8009810: 681b ldr r3, [r3, #0]
|
|
8009812: 021b lsls r3, r3, #8
|
|
8009814: 4a1c ldr r2, [pc, #112] @ (8009888 <xPortStartScheduler+0x138>)
|
|
8009816: 6013 str r3, [r2, #0]
|
|
ulMaxPRIGROUPValue &= portPRIORITY_GROUP_MASK;
|
|
8009818: 4b1b ldr r3, [pc, #108] @ (8009888 <xPortStartScheduler+0x138>)
|
|
800981a: 681b ldr r3, [r3, #0]
|
|
800981c: f403 63e0 and.w r3, r3, #1792 @ 0x700
|
|
8009820: 4a19 ldr r2, [pc, #100] @ (8009888 <xPortStartScheduler+0x138>)
|
|
8009822: 6013 str r3, [r2, #0]
|
|
|
|
/* Restore the clobbered interrupt priority register to its original
|
|
value. */
|
|
*pucFirstUserPriorityRegister = ulOriginalPriority;
|
|
8009824: 687b ldr r3, [r7, #4]
|
|
8009826: b2da uxtb r2, r3
|
|
8009828: 697b ldr r3, [r7, #20]
|
|
800982a: 701a strb r2, [r3, #0]
|
|
}
|
|
#endif /* conifgASSERT_DEFINED */
|
|
|
|
/* Make PendSV and SysTick the lowest priority interrupts. */
|
|
portNVIC_SYSPRI2_REG |= portNVIC_PENDSV_PRI;
|
|
800982c: 4b17 ldr r3, [pc, #92] @ (800988c <xPortStartScheduler+0x13c>)
|
|
800982e: 681b ldr r3, [r3, #0]
|
|
8009830: 4a16 ldr r2, [pc, #88] @ (800988c <xPortStartScheduler+0x13c>)
|
|
8009832: f443 0370 orr.w r3, r3, #15728640 @ 0xf00000
|
|
8009836: 6013 str r3, [r2, #0]
|
|
portNVIC_SYSPRI2_REG |= portNVIC_SYSTICK_PRI;
|
|
8009838: 4b14 ldr r3, [pc, #80] @ (800988c <xPortStartScheduler+0x13c>)
|
|
800983a: 681b ldr r3, [r3, #0]
|
|
800983c: 4a13 ldr r2, [pc, #76] @ (800988c <xPortStartScheduler+0x13c>)
|
|
800983e: f043 4370 orr.w r3, r3, #4026531840 @ 0xf0000000
|
|
8009842: 6013 str r3, [r2, #0]
|
|
|
|
/* Start the timer that generates the tick ISR. Interrupts are disabled
|
|
here already. */
|
|
vPortSetupTimerInterrupt();
|
|
8009844: f000 f8da bl 80099fc <vPortSetupTimerInterrupt>
|
|
|
|
/* Initialise the critical nesting count ready for the first task. */
|
|
uxCriticalNesting = 0;
|
|
8009848: 4b11 ldr r3, [pc, #68] @ (8009890 <xPortStartScheduler+0x140>)
|
|
800984a: 2200 movs r2, #0
|
|
800984c: 601a str r2, [r3, #0]
|
|
|
|
/* Ensure the VFP is enabled - it should be anyway. */
|
|
vPortEnableVFP();
|
|
800984e: f000 f8f9 bl 8009a44 <vPortEnableVFP>
|
|
|
|
/* Lazy save always. */
|
|
*( portFPCCR ) |= portASPEN_AND_LSPEN_BITS;
|
|
8009852: 4b10 ldr r3, [pc, #64] @ (8009894 <xPortStartScheduler+0x144>)
|
|
8009854: 681b ldr r3, [r3, #0]
|
|
8009856: 4a0f ldr r2, [pc, #60] @ (8009894 <xPortStartScheduler+0x144>)
|
|
8009858: f043 4340 orr.w r3, r3, #3221225472 @ 0xc0000000
|
|
800985c: 6013 str r3, [r2, #0]
|
|
|
|
/* Start the first task. */
|
|
prvPortStartFirstTask();
|
|
800985e: f7ff ff63 bl 8009728 <prvPortStartFirstTask>
|
|
exit error function to prevent compiler warnings about a static function
|
|
not being called in the case that the application writer overrides this
|
|
functionality by defining configTASK_RETURN_ADDRESS. Call
|
|
vTaskSwitchContext() so link time optimisation does not remove the
|
|
symbol. */
|
|
vTaskSwitchContext();
|
|
8009862: f7fe fe6d bl 8008540 <vTaskSwitchContext>
|
|
prvTaskExitError();
|
|
8009866: f7ff ff19 bl 800969c <prvTaskExitError>
|
|
|
|
/* Should not get here! */
|
|
return 0;
|
|
800986a: 2300 movs r3, #0
|
|
}
|
|
800986c: 4618 mov r0, r3
|
|
800986e: 3718 adds r7, #24
|
|
8009870: 46bd mov sp, r7
|
|
8009872: bd80 pop {r7, pc}
|
|
8009874: e000ed00 .word 0xe000ed00
|
|
8009878: 410fc271 .word 0x410fc271
|
|
800987c: 410fc270 .word 0x410fc270
|
|
8009880: e000e400 .word 0xe000e400
|
|
8009884: 200010ec .word 0x200010ec
|
|
8009888: 200010f0 .word 0x200010f0
|
|
800988c: e000ed20 .word 0xe000ed20
|
|
8009890: 20000024 .word 0x20000024
|
|
8009894: e000ef34 .word 0xe000ef34
|
|
|
|
08009898 <vPortEnterCritical>:
|
|
configASSERT( uxCriticalNesting == 1000UL );
|
|
}
|
|
/*-----------------------------------------------------------*/
|
|
|
|
void vPortEnterCritical( void )
|
|
{
|
|
8009898: b480 push {r7}
|
|
800989a: b083 sub sp, #12
|
|
800989c: af00 add r7, sp, #0
|
|
__asm volatile
|
|
800989e: f04f 0350 mov.w r3, #80 @ 0x50
|
|
80098a2: f383 8811 msr BASEPRI, r3
|
|
80098a6: f3bf 8f6f isb sy
|
|
80098aa: f3bf 8f4f dsb sy
|
|
80098ae: 607b str r3, [r7, #4]
|
|
}
|
|
80098b0: bf00 nop
|
|
portDISABLE_INTERRUPTS();
|
|
uxCriticalNesting++;
|
|
80098b2: 4b10 ldr r3, [pc, #64] @ (80098f4 <vPortEnterCritical+0x5c>)
|
|
80098b4: 681b ldr r3, [r3, #0]
|
|
80098b6: 3301 adds r3, #1
|
|
80098b8: 4a0e ldr r2, [pc, #56] @ (80098f4 <vPortEnterCritical+0x5c>)
|
|
80098ba: 6013 str r3, [r2, #0]
|
|
/* This is not the interrupt safe version of the enter critical function so
|
|
assert() if it is being called from an interrupt context. Only API
|
|
functions that end in "FromISR" can be used in an interrupt. Only assert if
|
|
the critical nesting count is 1 to protect against recursive calls if the
|
|
assert function also uses a critical section. */
|
|
if( uxCriticalNesting == 1 )
|
|
80098bc: 4b0d ldr r3, [pc, #52] @ (80098f4 <vPortEnterCritical+0x5c>)
|
|
80098be: 681b ldr r3, [r3, #0]
|
|
80098c0: 2b01 cmp r3, #1
|
|
80098c2: d110 bne.n 80098e6 <vPortEnterCritical+0x4e>
|
|
{
|
|
configASSERT( ( portNVIC_INT_CTRL_REG & portVECTACTIVE_MASK ) == 0 );
|
|
80098c4: 4b0c ldr r3, [pc, #48] @ (80098f8 <vPortEnterCritical+0x60>)
|
|
80098c6: 681b ldr r3, [r3, #0]
|
|
80098c8: b2db uxtb r3, r3
|
|
80098ca: 2b00 cmp r3, #0
|
|
80098cc: d00b beq.n 80098e6 <vPortEnterCritical+0x4e>
|
|
__asm volatile
|
|
80098ce: f04f 0350 mov.w r3, #80 @ 0x50
|
|
80098d2: f383 8811 msr BASEPRI, r3
|
|
80098d6: f3bf 8f6f isb sy
|
|
80098da: f3bf 8f4f dsb sy
|
|
80098de: 603b str r3, [r7, #0]
|
|
}
|
|
80098e0: bf00 nop
|
|
80098e2: bf00 nop
|
|
80098e4: e7fd b.n 80098e2 <vPortEnterCritical+0x4a>
|
|
}
|
|
}
|
|
80098e6: bf00 nop
|
|
80098e8: 370c adds r7, #12
|
|
80098ea: 46bd mov sp, r7
|
|
80098ec: f85d 7b04 ldr.w r7, [sp], #4
|
|
80098f0: 4770 bx lr
|
|
80098f2: bf00 nop
|
|
80098f4: 20000024 .word 0x20000024
|
|
80098f8: e000ed04 .word 0xe000ed04
|
|
|
|
080098fc <vPortExitCritical>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
void vPortExitCritical( void )
|
|
{
|
|
80098fc: b480 push {r7}
|
|
80098fe: b083 sub sp, #12
|
|
8009900: af00 add r7, sp, #0
|
|
configASSERT( uxCriticalNesting );
|
|
8009902: 4b12 ldr r3, [pc, #72] @ (800994c <vPortExitCritical+0x50>)
|
|
8009904: 681b ldr r3, [r3, #0]
|
|
8009906: 2b00 cmp r3, #0
|
|
8009908: d10b bne.n 8009922 <vPortExitCritical+0x26>
|
|
__asm volatile
|
|
800990a: f04f 0350 mov.w r3, #80 @ 0x50
|
|
800990e: f383 8811 msr BASEPRI, r3
|
|
8009912: f3bf 8f6f isb sy
|
|
8009916: f3bf 8f4f dsb sy
|
|
800991a: 607b str r3, [r7, #4]
|
|
}
|
|
800991c: bf00 nop
|
|
800991e: bf00 nop
|
|
8009920: e7fd b.n 800991e <vPortExitCritical+0x22>
|
|
uxCriticalNesting--;
|
|
8009922: 4b0a ldr r3, [pc, #40] @ (800994c <vPortExitCritical+0x50>)
|
|
8009924: 681b ldr r3, [r3, #0]
|
|
8009926: 3b01 subs r3, #1
|
|
8009928: 4a08 ldr r2, [pc, #32] @ (800994c <vPortExitCritical+0x50>)
|
|
800992a: 6013 str r3, [r2, #0]
|
|
if( uxCriticalNesting == 0 )
|
|
800992c: 4b07 ldr r3, [pc, #28] @ (800994c <vPortExitCritical+0x50>)
|
|
800992e: 681b ldr r3, [r3, #0]
|
|
8009930: 2b00 cmp r3, #0
|
|
8009932: d105 bne.n 8009940 <vPortExitCritical+0x44>
|
|
8009934: 2300 movs r3, #0
|
|
8009936: 603b str r3, [r7, #0]
|
|
__asm volatile
|
|
8009938: 683b ldr r3, [r7, #0]
|
|
800993a: f383 8811 msr BASEPRI, r3
|
|
}
|
|
800993e: bf00 nop
|
|
{
|
|
portENABLE_INTERRUPTS();
|
|
}
|
|
}
|
|
8009940: bf00 nop
|
|
8009942: 370c adds r7, #12
|
|
8009944: 46bd mov sp, r7
|
|
8009946: f85d 7b04 ldr.w r7, [sp], #4
|
|
800994a: 4770 bx lr
|
|
800994c: 20000024 .word 0x20000024
|
|
|
|
08009950 <PendSV_Handler>:
|
|
|
|
void xPortPendSVHandler( void )
|
|
{
|
|
/* This is a naked function. */
|
|
|
|
__asm volatile
|
|
8009950: f3ef 8009 mrs r0, PSP
|
|
8009954: f3bf 8f6f isb sy
|
|
8009958: 4b15 ldr r3, [pc, #84] @ (80099b0 <pxCurrentTCBConst>)
|
|
800995a: 681a ldr r2, [r3, #0]
|
|
800995c: f01e 0f10 tst.w lr, #16
|
|
8009960: bf08 it eq
|
|
8009962: ed20 8a10 vstmdbeq r0!, {s16-s31}
|
|
8009966: e920 4ff0 stmdb r0!, {r4, r5, r6, r7, r8, r9, sl, fp, lr}
|
|
800996a: 6010 str r0, [r2, #0]
|
|
800996c: b409 push {r0, r3}
|
|
800996e: f04f 0050 mov.w r0, #80 @ 0x50
|
|
8009972: f380 8811 msr BASEPRI, r0
|
|
8009976: f3bf 8f4f dsb sy
|
|
800997a: f3bf 8f6f isb sy
|
|
800997e: f7fe fddf bl 8008540 <vTaskSwitchContext>
|
|
8009982: f04f 0000 mov.w r0, #0
|
|
8009986: f380 8811 msr BASEPRI, r0
|
|
800998a: bc09 pop {r0, r3}
|
|
800998c: 6819 ldr r1, [r3, #0]
|
|
800998e: 6808 ldr r0, [r1, #0]
|
|
8009990: e8b0 4ff0 ldmia.w r0!, {r4, r5, r6, r7, r8, r9, sl, fp, lr}
|
|
8009994: f01e 0f10 tst.w lr, #16
|
|
8009998: bf08 it eq
|
|
800999a: ecb0 8a10 vldmiaeq r0!, {s16-s31}
|
|
800999e: f380 8809 msr PSP, r0
|
|
80099a2: f3bf 8f6f isb sy
|
|
80099a6: 4770 bx lr
|
|
80099a8: f3af 8000 nop.w
|
|
80099ac: f3af 8000 nop.w
|
|
|
|
080099b0 <pxCurrentTCBConst>:
|
|
80099b0: 20000ac0 .word 0x20000ac0
|
|
" \n"
|
|
" .align 4 \n"
|
|
"pxCurrentTCBConst: .word pxCurrentTCB \n"
|
|
::"i"(configMAX_SYSCALL_INTERRUPT_PRIORITY)
|
|
);
|
|
}
|
|
80099b4: bf00 nop
|
|
80099b6: bf00 nop
|
|
|
|
080099b8 <xPortSysTickHandler>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
void xPortSysTickHandler( void )
|
|
{
|
|
80099b8: b580 push {r7, lr}
|
|
80099ba: b082 sub sp, #8
|
|
80099bc: af00 add r7, sp, #0
|
|
__asm volatile
|
|
80099be: f04f 0350 mov.w r3, #80 @ 0x50
|
|
80099c2: f383 8811 msr BASEPRI, r3
|
|
80099c6: f3bf 8f6f isb sy
|
|
80099ca: f3bf 8f4f dsb sy
|
|
80099ce: 607b str r3, [r7, #4]
|
|
}
|
|
80099d0: bf00 nop
|
|
save and then restore the interrupt mask value as its value is already
|
|
known. */
|
|
portDISABLE_INTERRUPTS();
|
|
{
|
|
/* Increment the RTOS tick. */
|
|
if( xTaskIncrementTick() != pdFALSE )
|
|
80099d2: f7fe fcfb bl 80083cc <xTaskIncrementTick>
|
|
80099d6: 4603 mov r3, r0
|
|
80099d8: 2b00 cmp r3, #0
|
|
80099da: d003 beq.n 80099e4 <xPortSysTickHandler+0x2c>
|
|
{
|
|
/* A context switch is required. Context switching is performed in
|
|
the PendSV interrupt. Pend the PendSV interrupt. */
|
|
portNVIC_INT_CTRL_REG = portNVIC_PENDSVSET_BIT;
|
|
80099dc: 4b06 ldr r3, [pc, #24] @ (80099f8 <xPortSysTickHandler+0x40>)
|
|
80099de: f04f 5280 mov.w r2, #268435456 @ 0x10000000
|
|
80099e2: 601a str r2, [r3, #0]
|
|
80099e4: 2300 movs r3, #0
|
|
80099e6: 603b str r3, [r7, #0]
|
|
__asm volatile
|
|
80099e8: 683b ldr r3, [r7, #0]
|
|
80099ea: f383 8811 msr BASEPRI, r3
|
|
}
|
|
80099ee: bf00 nop
|
|
}
|
|
}
|
|
portENABLE_INTERRUPTS();
|
|
}
|
|
80099f0: bf00 nop
|
|
80099f2: 3708 adds r7, #8
|
|
80099f4: 46bd mov sp, r7
|
|
80099f6: bd80 pop {r7, pc}
|
|
80099f8: e000ed04 .word 0xe000ed04
|
|
|
|
080099fc <vPortSetupTimerInterrupt>:
|
|
/*
|
|
* Setup the systick timer to generate the tick interrupts at the required
|
|
* frequency.
|
|
*/
|
|
__attribute__(( weak )) void vPortSetupTimerInterrupt( void )
|
|
{
|
|
80099fc: b480 push {r7}
|
|
80099fe: af00 add r7, sp, #0
|
|
ulStoppedTimerCompensation = portMISSED_COUNTS_FACTOR / ( configCPU_CLOCK_HZ / configSYSTICK_CLOCK_HZ );
|
|
}
|
|
#endif /* configUSE_TICKLESS_IDLE */
|
|
|
|
/* Stop and clear the SysTick. */
|
|
portNVIC_SYSTICK_CTRL_REG = 0UL;
|
|
8009a00: 4b0b ldr r3, [pc, #44] @ (8009a30 <vPortSetupTimerInterrupt+0x34>)
|
|
8009a02: 2200 movs r2, #0
|
|
8009a04: 601a str r2, [r3, #0]
|
|
portNVIC_SYSTICK_CURRENT_VALUE_REG = 0UL;
|
|
8009a06: 4b0b ldr r3, [pc, #44] @ (8009a34 <vPortSetupTimerInterrupt+0x38>)
|
|
8009a08: 2200 movs r2, #0
|
|
8009a0a: 601a str r2, [r3, #0]
|
|
|
|
/* Configure SysTick to interrupt at the requested rate. */
|
|
portNVIC_SYSTICK_LOAD_REG = ( configSYSTICK_CLOCK_HZ / configTICK_RATE_HZ ) - 1UL;
|
|
8009a0c: 4b0a ldr r3, [pc, #40] @ (8009a38 <vPortSetupTimerInterrupt+0x3c>)
|
|
8009a0e: 681b ldr r3, [r3, #0]
|
|
8009a10: 4a0a ldr r2, [pc, #40] @ (8009a3c <vPortSetupTimerInterrupt+0x40>)
|
|
8009a12: fba2 2303 umull r2, r3, r2, r3
|
|
8009a16: 099b lsrs r3, r3, #6
|
|
8009a18: 4a09 ldr r2, [pc, #36] @ (8009a40 <vPortSetupTimerInterrupt+0x44>)
|
|
8009a1a: 3b01 subs r3, #1
|
|
8009a1c: 6013 str r3, [r2, #0]
|
|
portNVIC_SYSTICK_CTRL_REG = ( portNVIC_SYSTICK_CLK_BIT | portNVIC_SYSTICK_INT_BIT | portNVIC_SYSTICK_ENABLE_BIT );
|
|
8009a1e: 4b04 ldr r3, [pc, #16] @ (8009a30 <vPortSetupTimerInterrupt+0x34>)
|
|
8009a20: 2207 movs r2, #7
|
|
8009a22: 601a str r2, [r3, #0]
|
|
}
|
|
8009a24: bf00 nop
|
|
8009a26: 46bd mov sp, r7
|
|
8009a28: f85d 7b04 ldr.w r7, [sp], #4
|
|
8009a2c: 4770 bx lr
|
|
8009a2e: bf00 nop
|
|
8009a30: e000e010 .word 0xe000e010
|
|
8009a34: e000e018 .word 0xe000e018
|
|
8009a38: 20000018 .word 0x20000018
|
|
8009a3c: 10624dd3 .word 0x10624dd3
|
|
8009a40: e000e014 .word 0xe000e014
|
|
|
|
08009a44 <vPortEnableVFP>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
/* This is a naked function. */
|
|
static void vPortEnableVFP( void )
|
|
{
|
|
__asm volatile
|
|
8009a44: f8df 000c ldr.w r0, [pc, #12] @ 8009a54 <vPortEnableVFP+0x10>
|
|
8009a48: 6801 ldr r1, [r0, #0]
|
|
8009a4a: f441 0170 orr.w r1, r1, #15728640 @ 0xf00000
|
|
8009a4e: 6001 str r1, [r0, #0]
|
|
8009a50: 4770 bx lr
|
|
" \n"
|
|
" orr r1, r1, #( 0xf << 20 ) \n" /* Enable CP10 and CP11 coprocessors, then save back. */
|
|
" str r1, [r0] \n"
|
|
" bx r14 "
|
|
);
|
|
}
|
|
8009a52: bf00 nop
|
|
8009a54: e000ed88 .word 0xe000ed88
|
|
|
|
08009a58 <vPortValidateInterruptPriority>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
#if( configASSERT_DEFINED == 1 )
|
|
|
|
void vPortValidateInterruptPriority( void )
|
|
{
|
|
8009a58: b480 push {r7}
|
|
8009a5a: b085 sub sp, #20
|
|
8009a5c: af00 add r7, sp, #0
|
|
uint32_t ulCurrentInterrupt;
|
|
uint8_t ucCurrentPriority;
|
|
|
|
/* Obtain the number of the currently executing interrupt. */
|
|
__asm volatile( "mrs %0, ipsr" : "=r"( ulCurrentInterrupt ) :: "memory" );
|
|
8009a5e: f3ef 8305 mrs r3, IPSR
|
|
8009a62: 60fb str r3, [r7, #12]
|
|
|
|
/* Is the interrupt number a user defined interrupt? */
|
|
if( ulCurrentInterrupt >= portFIRST_USER_INTERRUPT_NUMBER )
|
|
8009a64: 68fb ldr r3, [r7, #12]
|
|
8009a66: 2b0f cmp r3, #15
|
|
8009a68: d915 bls.n 8009a96 <vPortValidateInterruptPriority+0x3e>
|
|
{
|
|
/* Look up the interrupt's priority. */
|
|
ucCurrentPriority = pcInterruptPriorityRegisters[ ulCurrentInterrupt ];
|
|
8009a6a: 4a18 ldr r2, [pc, #96] @ (8009acc <vPortValidateInterruptPriority+0x74>)
|
|
8009a6c: 68fb ldr r3, [r7, #12]
|
|
8009a6e: 4413 add r3, r2
|
|
8009a70: 781b ldrb r3, [r3, #0]
|
|
8009a72: 72fb strb r3, [r7, #11]
|
|
interrupt entry is as fast and simple as possible.
|
|
|
|
The following links provide detailed information:
|
|
http://www.freertos.org/RTOS-Cortex-M3-M4.html
|
|
http://www.freertos.org/FAQHelp.html */
|
|
configASSERT( ucCurrentPriority >= ucMaxSysCallPriority );
|
|
8009a74: 4b16 ldr r3, [pc, #88] @ (8009ad0 <vPortValidateInterruptPriority+0x78>)
|
|
8009a76: 781b ldrb r3, [r3, #0]
|
|
8009a78: 7afa ldrb r2, [r7, #11]
|
|
8009a7a: 429a cmp r2, r3
|
|
8009a7c: d20b bcs.n 8009a96 <vPortValidateInterruptPriority+0x3e>
|
|
__asm volatile
|
|
8009a7e: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8009a82: f383 8811 msr BASEPRI, r3
|
|
8009a86: f3bf 8f6f isb sy
|
|
8009a8a: f3bf 8f4f dsb sy
|
|
8009a8e: 607b str r3, [r7, #4]
|
|
}
|
|
8009a90: bf00 nop
|
|
8009a92: bf00 nop
|
|
8009a94: e7fd b.n 8009a92 <vPortValidateInterruptPriority+0x3a>
|
|
configuration then the correct setting can be achieved on all Cortex-M
|
|
devices by calling NVIC_SetPriorityGrouping( 0 ); before starting the
|
|
scheduler. Note however that some vendor specific peripheral libraries
|
|
assume a non-zero priority group setting, in which cases using a value
|
|
of zero will result in unpredictable behaviour. */
|
|
configASSERT( ( portAIRCR_REG & portPRIORITY_GROUP_MASK ) <= ulMaxPRIGROUPValue );
|
|
8009a96: 4b0f ldr r3, [pc, #60] @ (8009ad4 <vPortValidateInterruptPriority+0x7c>)
|
|
8009a98: 681b ldr r3, [r3, #0]
|
|
8009a9a: f403 62e0 and.w r2, r3, #1792 @ 0x700
|
|
8009a9e: 4b0e ldr r3, [pc, #56] @ (8009ad8 <vPortValidateInterruptPriority+0x80>)
|
|
8009aa0: 681b ldr r3, [r3, #0]
|
|
8009aa2: 429a cmp r2, r3
|
|
8009aa4: d90b bls.n 8009abe <vPortValidateInterruptPriority+0x66>
|
|
__asm volatile
|
|
8009aa6: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8009aaa: f383 8811 msr BASEPRI, r3
|
|
8009aae: f3bf 8f6f isb sy
|
|
8009ab2: f3bf 8f4f dsb sy
|
|
8009ab6: 603b str r3, [r7, #0]
|
|
}
|
|
8009ab8: bf00 nop
|
|
8009aba: bf00 nop
|
|
8009abc: e7fd b.n 8009aba <vPortValidateInterruptPriority+0x62>
|
|
}
|
|
8009abe: bf00 nop
|
|
8009ac0: 3714 adds r7, #20
|
|
8009ac2: 46bd mov sp, r7
|
|
8009ac4: f85d 7b04 ldr.w r7, [sp], #4
|
|
8009ac8: 4770 bx lr
|
|
8009aca: bf00 nop
|
|
8009acc: e000e3f0 .word 0xe000e3f0
|
|
8009ad0: 200010ec .word 0x200010ec
|
|
8009ad4: e000ed0c .word 0xe000ed0c
|
|
8009ad8: 200010f0 .word 0x200010f0
|
|
|
|
08009adc <pvPortMalloc>:
|
|
static size_t xBlockAllocatedBit = 0;
|
|
|
|
/*-----------------------------------------------------------*/
|
|
|
|
void *pvPortMalloc( size_t xWantedSize )
|
|
{
|
|
8009adc: b580 push {r7, lr}
|
|
8009ade: b08a sub sp, #40 @ 0x28
|
|
8009ae0: af00 add r7, sp, #0
|
|
8009ae2: 6078 str r0, [r7, #4]
|
|
BlockLink_t *pxBlock, *pxPreviousBlock, *pxNewBlockLink;
|
|
void *pvReturn = NULL;
|
|
8009ae4: 2300 movs r3, #0
|
|
8009ae6: 61fb str r3, [r7, #28]
|
|
|
|
vTaskSuspendAll();
|
|
8009ae8: f7fe fbb4 bl 8008254 <vTaskSuspendAll>
|
|
{
|
|
/* If this is the first call to malloc then the heap will require
|
|
initialisation to setup the list of free blocks. */
|
|
if( pxEnd == NULL )
|
|
8009aec: 4b5c ldr r3, [pc, #368] @ (8009c60 <pvPortMalloc+0x184>)
|
|
8009aee: 681b ldr r3, [r3, #0]
|
|
8009af0: 2b00 cmp r3, #0
|
|
8009af2: d101 bne.n 8009af8 <pvPortMalloc+0x1c>
|
|
{
|
|
prvHeapInit();
|
|
8009af4: f000 f924 bl 8009d40 <prvHeapInit>
|
|
|
|
/* Check the requested block size is not so large that the top bit is
|
|
set. The top bit of the block size member of the BlockLink_t structure
|
|
is used to determine who owns the block - the application or the
|
|
kernel, so it must be free. */
|
|
if( ( xWantedSize & xBlockAllocatedBit ) == 0 )
|
|
8009af8: 4b5a ldr r3, [pc, #360] @ (8009c64 <pvPortMalloc+0x188>)
|
|
8009afa: 681a ldr r2, [r3, #0]
|
|
8009afc: 687b ldr r3, [r7, #4]
|
|
8009afe: 4013 ands r3, r2
|
|
8009b00: 2b00 cmp r3, #0
|
|
8009b02: f040 8095 bne.w 8009c30 <pvPortMalloc+0x154>
|
|
{
|
|
/* The wanted size is increased so it can contain a BlockLink_t
|
|
structure in addition to the requested amount of bytes. */
|
|
if( xWantedSize > 0 )
|
|
8009b06: 687b ldr r3, [r7, #4]
|
|
8009b08: 2b00 cmp r3, #0
|
|
8009b0a: d01e beq.n 8009b4a <pvPortMalloc+0x6e>
|
|
{
|
|
xWantedSize += xHeapStructSize;
|
|
8009b0c: 2208 movs r2, #8
|
|
8009b0e: 687b ldr r3, [r7, #4]
|
|
8009b10: 4413 add r3, r2
|
|
8009b12: 607b str r3, [r7, #4]
|
|
|
|
/* Ensure that blocks are always aligned to the required number
|
|
of bytes. */
|
|
if( ( xWantedSize & portBYTE_ALIGNMENT_MASK ) != 0x00 )
|
|
8009b14: 687b ldr r3, [r7, #4]
|
|
8009b16: f003 0307 and.w r3, r3, #7
|
|
8009b1a: 2b00 cmp r3, #0
|
|
8009b1c: d015 beq.n 8009b4a <pvPortMalloc+0x6e>
|
|
{
|
|
/* Byte alignment required. */
|
|
xWantedSize += ( portBYTE_ALIGNMENT - ( xWantedSize & portBYTE_ALIGNMENT_MASK ) );
|
|
8009b1e: 687b ldr r3, [r7, #4]
|
|
8009b20: f023 0307 bic.w r3, r3, #7
|
|
8009b24: 3308 adds r3, #8
|
|
8009b26: 607b str r3, [r7, #4]
|
|
configASSERT( ( xWantedSize & portBYTE_ALIGNMENT_MASK ) == 0 );
|
|
8009b28: 687b ldr r3, [r7, #4]
|
|
8009b2a: f003 0307 and.w r3, r3, #7
|
|
8009b2e: 2b00 cmp r3, #0
|
|
8009b30: d00b beq.n 8009b4a <pvPortMalloc+0x6e>
|
|
__asm volatile
|
|
8009b32: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8009b36: f383 8811 msr BASEPRI, r3
|
|
8009b3a: f3bf 8f6f isb sy
|
|
8009b3e: f3bf 8f4f dsb sy
|
|
8009b42: 617b str r3, [r7, #20]
|
|
}
|
|
8009b44: bf00 nop
|
|
8009b46: bf00 nop
|
|
8009b48: e7fd b.n 8009b46 <pvPortMalloc+0x6a>
|
|
else
|
|
{
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
|
|
if( ( xWantedSize > 0 ) && ( xWantedSize <= xFreeBytesRemaining ) )
|
|
8009b4a: 687b ldr r3, [r7, #4]
|
|
8009b4c: 2b00 cmp r3, #0
|
|
8009b4e: d06f beq.n 8009c30 <pvPortMalloc+0x154>
|
|
8009b50: 4b45 ldr r3, [pc, #276] @ (8009c68 <pvPortMalloc+0x18c>)
|
|
8009b52: 681b ldr r3, [r3, #0]
|
|
8009b54: 687a ldr r2, [r7, #4]
|
|
8009b56: 429a cmp r2, r3
|
|
8009b58: d86a bhi.n 8009c30 <pvPortMalloc+0x154>
|
|
{
|
|
/* Traverse the list from the start (lowest address) block until
|
|
one of adequate size is found. */
|
|
pxPreviousBlock = &xStart;
|
|
8009b5a: 4b44 ldr r3, [pc, #272] @ (8009c6c <pvPortMalloc+0x190>)
|
|
8009b5c: 623b str r3, [r7, #32]
|
|
pxBlock = xStart.pxNextFreeBlock;
|
|
8009b5e: 4b43 ldr r3, [pc, #268] @ (8009c6c <pvPortMalloc+0x190>)
|
|
8009b60: 681b ldr r3, [r3, #0]
|
|
8009b62: 627b str r3, [r7, #36] @ 0x24
|
|
while( ( pxBlock->xBlockSize < xWantedSize ) && ( pxBlock->pxNextFreeBlock != NULL ) )
|
|
8009b64: e004 b.n 8009b70 <pvPortMalloc+0x94>
|
|
{
|
|
pxPreviousBlock = pxBlock;
|
|
8009b66: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8009b68: 623b str r3, [r7, #32]
|
|
pxBlock = pxBlock->pxNextFreeBlock;
|
|
8009b6a: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8009b6c: 681b ldr r3, [r3, #0]
|
|
8009b6e: 627b str r3, [r7, #36] @ 0x24
|
|
while( ( pxBlock->xBlockSize < xWantedSize ) && ( pxBlock->pxNextFreeBlock != NULL ) )
|
|
8009b70: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8009b72: 685b ldr r3, [r3, #4]
|
|
8009b74: 687a ldr r2, [r7, #4]
|
|
8009b76: 429a cmp r2, r3
|
|
8009b78: d903 bls.n 8009b82 <pvPortMalloc+0xa6>
|
|
8009b7a: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8009b7c: 681b ldr r3, [r3, #0]
|
|
8009b7e: 2b00 cmp r3, #0
|
|
8009b80: d1f1 bne.n 8009b66 <pvPortMalloc+0x8a>
|
|
}
|
|
|
|
/* If the end marker was reached then a block of adequate size
|
|
was not found. */
|
|
if( pxBlock != pxEnd )
|
|
8009b82: 4b37 ldr r3, [pc, #220] @ (8009c60 <pvPortMalloc+0x184>)
|
|
8009b84: 681b ldr r3, [r3, #0]
|
|
8009b86: 6a7a ldr r2, [r7, #36] @ 0x24
|
|
8009b88: 429a cmp r2, r3
|
|
8009b8a: d051 beq.n 8009c30 <pvPortMalloc+0x154>
|
|
{
|
|
/* Return the memory space pointed to - jumping over the
|
|
BlockLink_t structure at its start. */
|
|
pvReturn = ( void * ) ( ( ( uint8_t * ) pxPreviousBlock->pxNextFreeBlock ) + xHeapStructSize );
|
|
8009b8c: 6a3b ldr r3, [r7, #32]
|
|
8009b8e: 681b ldr r3, [r3, #0]
|
|
8009b90: 2208 movs r2, #8
|
|
8009b92: 4413 add r3, r2
|
|
8009b94: 61fb str r3, [r7, #28]
|
|
|
|
/* This block is being returned for use so must be taken out
|
|
of the list of free blocks. */
|
|
pxPreviousBlock->pxNextFreeBlock = pxBlock->pxNextFreeBlock;
|
|
8009b96: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8009b98: 681a ldr r2, [r3, #0]
|
|
8009b9a: 6a3b ldr r3, [r7, #32]
|
|
8009b9c: 601a str r2, [r3, #0]
|
|
|
|
/* If the block is larger than required it can be split into
|
|
two. */
|
|
if( ( pxBlock->xBlockSize - xWantedSize ) > heapMINIMUM_BLOCK_SIZE )
|
|
8009b9e: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8009ba0: 685a ldr r2, [r3, #4]
|
|
8009ba2: 687b ldr r3, [r7, #4]
|
|
8009ba4: 1ad2 subs r2, r2, r3
|
|
8009ba6: 2308 movs r3, #8
|
|
8009ba8: 005b lsls r3, r3, #1
|
|
8009baa: 429a cmp r2, r3
|
|
8009bac: d920 bls.n 8009bf0 <pvPortMalloc+0x114>
|
|
{
|
|
/* This block is to be split into two. Create a new
|
|
block following the number of bytes requested. The void
|
|
cast is used to prevent byte alignment warnings from the
|
|
compiler. */
|
|
pxNewBlockLink = ( void * ) ( ( ( uint8_t * ) pxBlock ) + xWantedSize );
|
|
8009bae: 6a7a ldr r2, [r7, #36] @ 0x24
|
|
8009bb0: 687b ldr r3, [r7, #4]
|
|
8009bb2: 4413 add r3, r2
|
|
8009bb4: 61bb str r3, [r7, #24]
|
|
configASSERT( ( ( ( size_t ) pxNewBlockLink ) & portBYTE_ALIGNMENT_MASK ) == 0 );
|
|
8009bb6: 69bb ldr r3, [r7, #24]
|
|
8009bb8: f003 0307 and.w r3, r3, #7
|
|
8009bbc: 2b00 cmp r3, #0
|
|
8009bbe: d00b beq.n 8009bd8 <pvPortMalloc+0xfc>
|
|
__asm volatile
|
|
8009bc0: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8009bc4: f383 8811 msr BASEPRI, r3
|
|
8009bc8: f3bf 8f6f isb sy
|
|
8009bcc: f3bf 8f4f dsb sy
|
|
8009bd0: 613b str r3, [r7, #16]
|
|
}
|
|
8009bd2: bf00 nop
|
|
8009bd4: bf00 nop
|
|
8009bd6: e7fd b.n 8009bd4 <pvPortMalloc+0xf8>
|
|
|
|
/* Calculate the sizes of two blocks split from the
|
|
single block. */
|
|
pxNewBlockLink->xBlockSize = pxBlock->xBlockSize - xWantedSize;
|
|
8009bd8: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8009bda: 685a ldr r2, [r3, #4]
|
|
8009bdc: 687b ldr r3, [r7, #4]
|
|
8009bde: 1ad2 subs r2, r2, r3
|
|
8009be0: 69bb ldr r3, [r7, #24]
|
|
8009be2: 605a str r2, [r3, #4]
|
|
pxBlock->xBlockSize = xWantedSize;
|
|
8009be4: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8009be6: 687a ldr r2, [r7, #4]
|
|
8009be8: 605a str r2, [r3, #4]
|
|
|
|
/* Insert the new block into the list of free blocks. */
|
|
prvInsertBlockIntoFreeList( pxNewBlockLink );
|
|
8009bea: 69b8 ldr r0, [r7, #24]
|
|
8009bec: f000 f90a bl 8009e04 <prvInsertBlockIntoFreeList>
|
|
else
|
|
{
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
|
|
xFreeBytesRemaining -= pxBlock->xBlockSize;
|
|
8009bf0: 4b1d ldr r3, [pc, #116] @ (8009c68 <pvPortMalloc+0x18c>)
|
|
8009bf2: 681a ldr r2, [r3, #0]
|
|
8009bf4: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8009bf6: 685b ldr r3, [r3, #4]
|
|
8009bf8: 1ad3 subs r3, r2, r3
|
|
8009bfa: 4a1b ldr r2, [pc, #108] @ (8009c68 <pvPortMalloc+0x18c>)
|
|
8009bfc: 6013 str r3, [r2, #0]
|
|
|
|
if( xFreeBytesRemaining < xMinimumEverFreeBytesRemaining )
|
|
8009bfe: 4b1a ldr r3, [pc, #104] @ (8009c68 <pvPortMalloc+0x18c>)
|
|
8009c00: 681a ldr r2, [r3, #0]
|
|
8009c02: 4b1b ldr r3, [pc, #108] @ (8009c70 <pvPortMalloc+0x194>)
|
|
8009c04: 681b ldr r3, [r3, #0]
|
|
8009c06: 429a cmp r2, r3
|
|
8009c08: d203 bcs.n 8009c12 <pvPortMalloc+0x136>
|
|
{
|
|
xMinimumEverFreeBytesRemaining = xFreeBytesRemaining;
|
|
8009c0a: 4b17 ldr r3, [pc, #92] @ (8009c68 <pvPortMalloc+0x18c>)
|
|
8009c0c: 681b ldr r3, [r3, #0]
|
|
8009c0e: 4a18 ldr r2, [pc, #96] @ (8009c70 <pvPortMalloc+0x194>)
|
|
8009c10: 6013 str r3, [r2, #0]
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
|
|
/* The block is being returned - it is allocated and owned
|
|
by the application and has no "next" block. */
|
|
pxBlock->xBlockSize |= xBlockAllocatedBit;
|
|
8009c12: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8009c14: 685a ldr r2, [r3, #4]
|
|
8009c16: 4b13 ldr r3, [pc, #76] @ (8009c64 <pvPortMalloc+0x188>)
|
|
8009c18: 681b ldr r3, [r3, #0]
|
|
8009c1a: 431a orrs r2, r3
|
|
8009c1c: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8009c1e: 605a str r2, [r3, #4]
|
|
pxBlock->pxNextFreeBlock = NULL;
|
|
8009c20: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8009c22: 2200 movs r2, #0
|
|
8009c24: 601a str r2, [r3, #0]
|
|
xNumberOfSuccessfulAllocations++;
|
|
8009c26: 4b13 ldr r3, [pc, #76] @ (8009c74 <pvPortMalloc+0x198>)
|
|
8009c28: 681b ldr r3, [r3, #0]
|
|
8009c2a: 3301 adds r3, #1
|
|
8009c2c: 4a11 ldr r2, [pc, #68] @ (8009c74 <pvPortMalloc+0x198>)
|
|
8009c2e: 6013 str r3, [r2, #0]
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
|
|
traceMALLOC( pvReturn, xWantedSize );
|
|
}
|
|
( void ) xTaskResumeAll();
|
|
8009c30: f7fe fb1e bl 8008270 <xTaskResumeAll>
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
}
|
|
#endif
|
|
|
|
configASSERT( ( ( ( size_t ) pvReturn ) & ( size_t ) portBYTE_ALIGNMENT_MASK ) == 0 );
|
|
8009c34: 69fb ldr r3, [r7, #28]
|
|
8009c36: f003 0307 and.w r3, r3, #7
|
|
8009c3a: 2b00 cmp r3, #0
|
|
8009c3c: d00b beq.n 8009c56 <pvPortMalloc+0x17a>
|
|
__asm volatile
|
|
8009c3e: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8009c42: f383 8811 msr BASEPRI, r3
|
|
8009c46: f3bf 8f6f isb sy
|
|
8009c4a: f3bf 8f4f dsb sy
|
|
8009c4e: 60fb str r3, [r7, #12]
|
|
}
|
|
8009c50: bf00 nop
|
|
8009c52: bf00 nop
|
|
8009c54: e7fd b.n 8009c52 <pvPortMalloc+0x176>
|
|
return pvReturn;
|
|
8009c56: 69fb ldr r3, [r7, #28]
|
|
}
|
|
8009c58: 4618 mov r0, r3
|
|
8009c5a: 3728 adds r7, #40 @ 0x28
|
|
8009c5c: 46bd mov sp, r7
|
|
8009c5e: bd80 pop {r7, pc}
|
|
8009c60: 20004cfc .word 0x20004cfc
|
|
8009c64: 20004d10 .word 0x20004d10
|
|
8009c68: 20004d00 .word 0x20004d00
|
|
8009c6c: 20004cf4 .word 0x20004cf4
|
|
8009c70: 20004d04 .word 0x20004d04
|
|
8009c74: 20004d08 .word 0x20004d08
|
|
|
|
08009c78 <vPortFree>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
void vPortFree( void *pv )
|
|
{
|
|
8009c78: b580 push {r7, lr}
|
|
8009c7a: b086 sub sp, #24
|
|
8009c7c: af00 add r7, sp, #0
|
|
8009c7e: 6078 str r0, [r7, #4]
|
|
uint8_t *puc = ( uint8_t * ) pv;
|
|
8009c80: 687b ldr r3, [r7, #4]
|
|
8009c82: 617b str r3, [r7, #20]
|
|
BlockLink_t *pxLink;
|
|
|
|
if( pv != NULL )
|
|
8009c84: 687b ldr r3, [r7, #4]
|
|
8009c86: 2b00 cmp r3, #0
|
|
8009c88: d04f beq.n 8009d2a <vPortFree+0xb2>
|
|
{
|
|
/* The memory being freed will have an BlockLink_t structure immediately
|
|
before it. */
|
|
puc -= xHeapStructSize;
|
|
8009c8a: 2308 movs r3, #8
|
|
8009c8c: 425b negs r3, r3
|
|
8009c8e: 697a ldr r2, [r7, #20]
|
|
8009c90: 4413 add r3, r2
|
|
8009c92: 617b str r3, [r7, #20]
|
|
|
|
/* This casting is to keep the compiler from issuing warnings. */
|
|
pxLink = ( void * ) puc;
|
|
8009c94: 697b ldr r3, [r7, #20]
|
|
8009c96: 613b str r3, [r7, #16]
|
|
|
|
/* Check the block is actually allocated. */
|
|
configASSERT( ( pxLink->xBlockSize & xBlockAllocatedBit ) != 0 );
|
|
8009c98: 693b ldr r3, [r7, #16]
|
|
8009c9a: 685a ldr r2, [r3, #4]
|
|
8009c9c: 4b25 ldr r3, [pc, #148] @ (8009d34 <vPortFree+0xbc>)
|
|
8009c9e: 681b ldr r3, [r3, #0]
|
|
8009ca0: 4013 ands r3, r2
|
|
8009ca2: 2b00 cmp r3, #0
|
|
8009ca4: d10b bne.n 8009cbe <vPortFree+0x46>
|
|
__asm volatile
|
|
8009ca6: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8009caa: f383 8811 msr BASEPRI, r3
|
|
8009cae: f3bf 8f6f isb sy
|
|
8009cb2: f3bf 8f4f dsb sy
|
|
8009cb6: 60fb str r3, [r7, #12]
|
|
}
|
|
8009cb8: bf00 nop
|
|
8009cba: bf00 nop
|
|
8009cbc: e7fd b.n 8009cba <vPortFree+0x42>
|
|
configASSERT( pxLink->pxNextFreeBlock == NULL );
|
|
8009cbe: 693b ldr r3, [r7, #16]
|
|
8009cc0: 681b ldr r3, [r3, #0]
|
|
8009cc2: 2b00 cmp r3, #0
|
|
8009cc4: d00b beq.n 8009cde <vPortFree+0x66>
|
|
__asm volatile
|
|
8009cc6: f04f 0350 mov.w r3, #80 @ 0x50
|
|
8009cca: f383 8811 msr BASEPRI, r3
|
|
8009cce: f3bf 8f6f isb sy
|
|
8009cd2: f3bf 8f4f dsb sy
|
|
8009cd6: 60bb str r3, [r7, #8]
|
|
}
|
|
8009cd8: bf00 nop
|
|
8009cda: bf00 nop
|
|
8009cdc: e7fd b.n 8009cda <vPortFree+0x62>
|
|
|
|
if( ( pxLink->xBlockSize & xBlockAllocatedBit ) != 0 )
|
|
8009cde: 693b ldr r3, [r7, #16]
|
|
8009ce0: 685a ldr r2, [r3, #4]
|
|
8009ce2: 4b14 ldr r3, [pc, #80] @ (8009d34 <vPortFree+0xbc>)
|
|
8009ce4: 681b ldr r3, [r3, #0]
|
|
8009ce6: 4013 ands r3, r2
|
|
8009ce8: 2b00 cmp r3, #0
|
|
8009cea: d01e beq.n 8009d2a <vPortFree+0xb2>
|
|
{
|
|
if( pxLink->pxNextFreeBlock == NULL )
|
|
8009cec: 693b ldr r3, [r7, #16]
|
|
8009cee: 681b ldr r3, [r3, #0]
|
|
8009cf0: 2b00 cmp r3, #0
|
|
8009cf2: d11a bne.n 8009d2a <vPortFree+0xb2>
|
|
{
|
|
/* The block is being returned to the heap - it is no longer
|
|
allocated. */
|
|
pxLink->xBlockSize &= ~xBlockAllocatedBit;
|
|
8009cf4: 693b ldr r3, [r7, #16]
|
|
8009cf6: 685a ldr r2, [r3, #4]
|
|
8009cf8: 4b0e ldr r3, [pc, #56] @ (8009d34 <vPortFree+0xbc>)
|
|
8009cfa: 681b ldr r3, [r3, #0]
|
|
8009cfc: 43db mvns r3, r3
|
|
8009cfe: 401a ands r2, r3
|
|
8009d00: 693b ldr r3, [r7, #16]
|
|
8009d02: 605a str r2, [r3, #4]
|
|
|
|
vTaskSuspendAll();
|
|
8009d04: f7fe faa6 bl 8008254 <vTaskSuspendAll>
|
|
{
|
|
/* Add this block to the list of free blocks. */
|
|
xFreeBytesRemaining += pxLink->xBlockSize;
|
|
8009d08: 693b ldr r3, [r7, #16]
|
|
8009d0a: 685a ldr r2, [r3, #4]
|
|
8009d0c: 4b0a ldr r3, [pc, #40] @ (8009d38 <vPortFree+0xc0>)
|
|
8009d0e: 681b ldr r3, [r3, #0]
|
|
8009d10: 4413 add r3, r2
|
|
8009d12: 4a09 ldr r2, [pc, #36] @ (8009d38 <vPortFree+0xc0>)
|
|
8009d14: 6013 str r3, [r2, #0]
|
|
traceFREE( pv, pxLink->xBlockSize );
|
|
prvInsertBlockIntoFreeList( ( ( BlockLink_t * ) pxLink ) );
|
|
8009d16: 6938 ldr r0, [r7, #16]
|
|
8009d18: f000 f874 bl 8009e04 <prvInsertBlockIntoFreeList>
|
|
xNumberOfSuccessfulFrees++;
|
|
8009d1c: 4b07 ldr r3, [pc, #28] @ (8009d3c <vPortFree+0xc4>)
|
|
8009d1e: 681b ldr r3, [r3, #0]
|
|
8009d20: 3301 adds r3, #1
|
|
8009d22: 4a06 ldr r2, [pc, #24] @ (8009d3c <vPortFree+0xc4>)
|
|
8009d24: 6013 str r3, [r2, #0]
|
|
}
|
|
( void ) xTaskResumeAll();
|
|
8009d26: f7fe faa3 bl 8008270 <xTaskResumeAll>
|
|
else
|
|
{
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
}
|
|
}
|
|
8009d2a: bf00 nop
|
|
8009d2c: 3718 adds r7, #24
|
|
8009d2e: 46bd mov sp, r7
|
|
8009d30: bd80 pop {r7, pc}
|
|
8009d32: bf00 nop
|
|
8009d34: 20004d10 .word 0x20004d10
|
|
8009d38: 20004d00 .word 0x20004d00
|
|
8009d3c: 20004d0c .word 0x20004d0c
|
|
|
|
08009d40 <prvHeapInit>:
|
|
/* This just exists to keep the linker quiet. */
|
|
}
|
|
/*-----------------------------------------------------------*/
|
|
|
|
static void prvHeapInit( void )
|
|
{
|
|
8009d40: b480 push {r7}
|
|
8009d42: b085 sub sp, #20
|
|
8009d44: af00 add r7, sp, #0
|
|
BlockLink_t *pxFirstFreeBlock;
|
|
uint8_t *pucAlignedHeap;
|
|
size_t uxAddress;
|
|
size_t xTotalHeapSize = configTOTAL_HEAP_SIZE;
|
|
8009d46: f44f 5370 mov.w r3, #15360 @ 0x3c00
|
|
8009d4a: 60bb str r3, [r7, #8]
|
|
|
|
/* Ensure the heap starts on a correctly aligned boundary. */
|
|
uxAddress = ( size_t ) ucHeap;
|
|
8009d4c: 4b27 ldr r3, [pc, #156] @ (8009dec <prvHeapInit+0xac>)
|
|
8009d4e: 60fb str r3, [r7, #12]
|
|
|
|
if( ( uxAddress & portBYTE_ALIGNMENT_MASK ) != 0 )
|
|
8009d50: 68fb ldr r3, [r7, #12]
|
|
8009d52: f003 0307 and.w r3, r3, #7
|
|
8009d56: 2b00 cmp r3, #0
|
|
8009d58: d00c beq.n 8009d74 <prvHeapInit+0x34>
|
|
{
|
|
uxAddress += ( portBYTE_ALIGNMENT - 1 );
|
|
8009d5a: 68fb ldr r3, [r7, #12]
|
|
8009d5c: 3307 adds r3, #7
|
|
8009d5e: 60fb str r3, [r7, #12]
|
|
uxAddress &= ~( ( size_t ) portBYTE_ALIGNMENT_MASK );
|
|
8009d60: 68fb ldr r3, [r7, #12]
|
|
8009d62: f023 0307 bic.w r3, r3, #7
|
|
8009d66: 60fb str r3, [r7, #12]
|
|
xTotalHeapSize -= uxAddress - ( size_t ) ucHeap;
|
|
8009d68: 68ba ldr r2, [r7, #8]
|
|
8009d6a: 68fb ldr r3, [r7, #12]
|
|
8009d6c: 1ad3 subs r3, r2, r3
|
|
8009d6e: 4a1f ldr r2, [pc, #124] @ (8009dec <prvHeapInit+0xac>)
|
|
8009d70: 4413 add r3, r2
|
|
8009d72: 60bb str r3, [r7, #8]
|
|
}
|
|
|
|
pucAlignedHeap = ( uint8_t * ) uxAddress;
|
|
8009d74: 68fb ldr r3, [r7, #12]
|
|
8009d76: 607b str r3, [r7, #4]
|
|
|
|
/* xStart is used to hold a pointer to the first item in the list of free
|
|
blocks. The void cast is used to prevent compiler warnings. */
|
|
xStart.pxNextFreeBlock = ( void * ) pucAlignedHeap;
|
|
8009d78: 4a1d ldr r2, [pc, #116] @ (8009df0 <prvHeapInit+0xb0>)
|
|
8009d7a: 687b ldr r3, [r7, #4]
|
|
8009d7c: 6013 str r3, [r2, #0]
|
|
xStart.xBlockSize = ( size_t ) 0;
|
|
8009d7e: 4b1c ldr r3, [pc, #112] @ (8009df0 <prvHeapInit+0xb0>)
|
|
8009d80: 2200 movs r2, #0
|
|
8009d82: 605a str r2, [r3, #4]
|
|
|
|
/* pxEnd is used to mark the end of the list of free blocks and is inserted
|
|
at the end of the heap space. */
|
|
uxAddress = ( ( size_t ) pucAlignedHeap ) + xTotalHeapSize;
|
|
8009d84: 687b ldr r3, [r7, #4]
|
|
8009d86: 68ba ldr r2, [r7, #8]
|
|
8009d88: 4413 add r3, r2
|
|
8009d8a: 60fb str r3, [r7, #12]
|
|
uxAddress -= xHeapStructSize;
|
|
8009d8c: 2208 movs r2, #8
|
|
8009d8e: 68fb ldr r3, [r7, #12]
|
|
8009d90: 1a9b subs r3, r3, r2
|
|
8009d92: 60fb str r3, [r7, #12]
|
|
uxAddress &= ~( ( size_t ) portBYTE_ALIGNMENT_MASK );
|
|
8009d94: 68fb ldr r3, [r7, #12]
|
|
8009d96: f023 0307 bic.w r3, r3, #7
|
|
8009d9a: 60fb str r3, [r7, #12]
|
|
pxEnd = ( void * ) uxAddress;
|
|
8009d9c: 68fb ldr r3, [r7, #12]
|
|
8009d9e: 4a15 ldr r2, [pc, #84] @ (8009df4 <prvHeapInit+0xb4>)
|
|
8009da0: 6013 str r3, [r2, #0]
|
|
pxEnd->xBlockSize = 0;
|
|
8009da2: 4b14 ldr r3, [pc, #80] @ (8009df4 <prvHeapInit+0xb4>)
|
|
8009da4: 681b ldr r3, [r3, #0]
|
|
8009da6: 2200 movs r2, #0
|
|
8009da8: 605a str r2, [r3, #4]
|
|
pxEnd->pxNextFreeBlock = NULL;
|
|
8009daa: 4b12 ldr r3, [pc, #72] @ (8009df4 <prvHeapInit+0xb4>)
|
|
8009dac: 681b ldr r3, [r3, #0]
|
|
8009dae: 2200 movs r2, #0
|
|
8009db0: 601a str r2, [r3, #0]
|
|
|
|
/* To start with there is a single free block that is sized to take up the
|
|
entire heap space, minus the space taken by pxEnd. */
|
|
pxFirstFreeBlock = ( void * ) pucAlignedHeap;
|
|
8009db2: 687b ldr r3, [r7, #4]
|
|
8009db4: 603b str r3, [r7, #0]
|
|
pxFirstFreeBlock->xBlockSize = uxAddress - ( size_t ) pxFirstFreeBlock;
|
|
8009db6: 683b ldr r3, [r7, #0]
|
|
8009db8: 68fa ldr r2, [r7, #12]
|
|
8009dba: 1ad2 subs r2, r2, r3
|
|
8009dbc: 683b ldr r3, [r7, #0]
|
|
8009dbe: 605a str r2, [r3, #4]
|
|
pxFirstFreeBlock->pxNextFreeBlock = pxEnd;
|
|
8009dc0: 4b0c ldr r3, [pc, #48] @ (8009df4 <prvHeapInit+0xb4>)
|
|
8009dc2: 681a ldr r2, [r3, #0]
|
|
8009dc4: 683b ldr r3, [r7, #0]
|
|
8009dc6: 601a str r2, [r3, #0]
|
|
|
|
/* Only one block exists - and it covers the entire usable heap space. */
|
|
xMinimumEverFreeBytesRemaining = pxFirstFreeBlock->xBlockSize;
|
|
8009dc8: 683b ldr r3, [r7, #0]
|
|
8009dca: 685b ldr r3, [r3, #4]
|
|
8009dcc: 4a0a ldr r2, [pc, #40] @ (8009df8 <prvHeapInit+0xb8>)
|
|
8009dce: 6013 str r3, [r2, #0]
|
|
xFreeBytesRemaining = pxFirstFreeBlock->xBlockSize;
|
|
8009dd0: 683b ldr r3, [r7, #0]
|
|
8009dd2: 685b ldr r3, [r3, #4]
|
|
8009dd4: 4a09 ldr r2, [pc, #36] @ (8009dfc <prvHeapInit+0xbc>)
|
|
8009dd6: 6013 str r3, [r2, #0]
|
|
|
|
/* Work out the position of the top bit in a size_t variable. */
|
|
xBlockAllocatedBit = ( ( size_t ) 1 ) << ( ( sizeof( size_t ) * heapBITS_PER_BYTE ) - 1 );
|
|
8009dd8: 4b09 ldr r3, [pc, #36] @ (8009e00 <prvHeapInit+0xc0>)
|
|
8009dda: f04f 4200 mov.w r2, #2147483648 @ 0x80000000
|
|
8009dde: 601a str r2, [r3, #0]
|
|
}
|
|
8009de0: bf00 nop
|
|
8009de2: 3714 adds r7, #20
|
|
8009de4: 46bd mov sp, r7
|
|
8009de6: f85d 7b04 ldr.w r7, [sp], #4
|
|
8009dea: 4770 bx lr
|
|
8009dec: 200010f4 .word 0x200010f4
|
|
8009df0: 20004cf4 .word 0x20004cf4
|
|
8009df4: 20004cfc .word 0x20004cfc
|
|
8009df8: 20004d04 .word 0x20004d04
|
|
8009dfc: 20004d00 .word 0x20004d00
|
|
8009e00: 20004d10 .word 0x20004d10
|
|
|
|
08009e04 <prvInsertBlockIntoFreeList>:
|
|
/*-----------------------------------------------------------*/
|
|
|
|
static void prvInsertBlockIntoFreeList( BlockLink_t *pxBlockToInsert )
|
|
{
|
|
8009e04: b480 push {r7}
|
|
8009e06: b085 sub sp, #20
|
|
8009e08: af00 add r7, sp, #0
|
|
8009e0a: 6078 str r0, [r7, #4]
|
|
BlockLink_t *pxIterator;
|
|
uint8_t *puc;
|
|
|
|
/* Iterate through the list until a block is found that has a higher address
|
|
than the block being inserted. */
|
|
for( pxIterator = &xStart; pxIterator->pxNextFreeBlock < pxBlockToInsert; pxIterator = pxIterator->pxNextFreeBlock )
|
|
8009e0c: 4b28 ldr r3, [pc, #160] @ (8009eb0 <prvInsertBlockIntoFreeList+0xac>)
|
|
8009e0e: 60fb str r3, [r7, #12]
|
|
8009e10: e002 b.n 8009e18 <prvInsertBlockIntoFreeList+0x14>
|
|
8009e12: 68fb ldr r3, [r7, #12]
|
|
8009e14: 681b ldr r3, [r3, #0]
|
|
8009e16: 60fb str r3, [r7, #12]
|
|
8009e18: 68fb ldr r3, [r7, #12]
|
|
8009e1a: 681b ldr r3, [r3, #0]
|
|
8009e1c: 687a ldr r2, [r7, #4]
|
|
8009e1e: 429a cmp r2, r3
|
|
8009e20: d8f7 bhi.n 8009e12 <prvInsertBlockIntoFreeList+0xe>
|
|
/* Nothing to do here, just iterate to the right position. */
|
|
}
|
|
|
|
/* Do the block being inserted, and the block it is being inserted after
|
|
make a contiguous block of memory? */
|
|
puc = ( uint8_t * ) pxIterator;
|
|
8009e22: 68fb ldr r3, [r7, #12]
|
|
8009e24: 60bb str r3, [r7, #8]
|
|
if( ( puc + pxIterator->xBlockSize ) == ( uint8_t * ) pxBlockToInsert )
|
|
8009e26: 68fb ldr r3, [r7, #12]
|
|
8009e28: 685b ldr r3, [r3, #4]
|
|
8009e2a: 68ba ldr r2, [r7, #8]
|
|
8009e2c: 4413 add r3, r2
|
|
8009e2e: 687a ldr r2, [r7, #4]
|
|
8009e30: 429a cmp r2, r3
|
|
8009e32: d108 bne.n 8009e46 <prvInsertBlockIntoFreeList+0x42>
|
|
{
|
|
pxIterator->xBlockSize += pxBlockToInsert->xBlockSize;
|
|
8009e34: 68fb ldr r3, [r7, #12]
|
|
8009e36: 685a ldr r2, [r3, #4]
|
|
8009e38: 687b ldr r3, [r7, #4]
|
|
8009e3a: 685b ldr r3, [r3, #4]
|
|
8009e3c: 441a add r2, r3
|
|
8009e3e: 68fb ldr r3, [r7, #12]
|
|
8009e40: 605a str r2, [r3, #4]
|
|
pxBlockToInsert = pxIterator;
|
|
8009e42: 68fb ldr r3, [r7, #12]
|
|
8009e44: 607b str r3, [r7, #4]
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
|
|
/* Do the block being inserted, and the block it is being inserted before
|
|
make a contiguous block of memory? */
|
|
puc = ( uint8_t * ) pxBlockToInsert;
|
|
8009e46: 687b ldr r3, [r7, #4]
|
|
8009e48: 60bb str r3, [r7, #8]
|
|
if( ( puc + pxBlockToInsert->xBlockSize ) == ( uint8_t * ) pxIterator->pxNextFreeBlock )
|
|
8009e4a: 687b ldr r3, [r7, #4]
|
|
8009e4c: 685b ldr r3, [r3, #4]
|
|
8009e4e: 68ba ldr r2, [r7, #8]
|
|
8009e50: 441a add r2, r3
|
|
8009e52: 68fb ldr r3, [r7, #12]
|
|
8009e54: 681b ldr r3, [r3, #0]
|
|
8009e56: 429a cmp r2, r3
|
|
8009e58: d118 bne.n 8009e8c <prvInsertBlockIntoFreeList+0x88>
|
|
{
|
|
if( pxIterator->pxNextFreeBlock != pxEnd )
|
|
8009e5a: 68fb ldr r3, [r7, #12]
|
|
8009e5c: 681a ldr r2, [r3, #0]
|
|
8009e5e: 4b15 ldr r3, [pc, #84] @ (8009eb4 <prvInsertBlockIntoFreeList+0xb0>)
|
|
8009e60: 681b ldr r3, [r3, #0]
|
|
8009e62: 429a cmp r2, r3
|
|
8009e64: d00d beq.n 8009e82 <prvInsertBlockIntoFreeList+0x7e>
|
|
{
|
|
/* Form one big block from the two blocks. */
|
|
pxBlockToInsert->xBlockSize += pxIterator->pxNextFreeBlock->xBlockSize;
|
|
8009e66: 687b ldr r3, [r7, #4]
|
|
8009e68: 685a ldr r2, [r3, #4]
|
|
8009e6a: 68fb ldr r3, [r7, #12]
|
|
8009e6c: 681b ldr r3, [r3, #0]
|
|
8009e6e: 685b ldr r3, [r3, #4]
|
|
8009e70: 441a add r2, r3
|
|
8009e72: 687b ldr r3, [r7, #4]
|
|
8009e74: 605a str r2, [r3, #4]
|
|
pxBlockToInsert->pxNextFreeBlock = pxIterator->pxNextFreeBlock->pxNextFreeBlock;
|
|
8009e76: 68fb ldr r3, [r7, #12]
|
|
8009e78: 681b ldr r3, [r3, #0]
|
|
8009e7a: 681a ldr r2, [r3, #0]
|
|
8009e7c: 687b ldr r3, [r7, #4]
|
|
8009e7e: 601a str r2, [r3, #0]
|
|
8009e80: e008 b.n 8009e94 <prvInsertBlockIntoFreeList+0x90>
|
|
}
|
|
else
|
|
{
|
|
pxBlockToInsert->pxNextFreeBlock = pxEnd;
|
|
8009e82: 4b0c ldr r3, [pc, #48] @ (8009eb4 <prvInsertBlockIntoFreeList+0xb0>)
|
|
8009e84: 681a ldr r2, [r3, #0]
|
|
8009e86: 687b ldr r3, [r7, #4]
|
|
8009e88: 601a str r2, [r3, #0]
|
|
8009e8a: e003 b.n 8009e94 <prvInsertBlockIntoFreeList+0x90>
|
|
}
|
|
}
|
|
else
|
|
{
|
|
pxBlockToInsert->pxNextFreeBlock = pxIterator->pxNextFreeBlock;
|
|
8009e8c: 68fb ldr r3, [r7, #12]
|
|
8009e8e: 681a ldr r2, [r3, #0]
|
|
8009e90: 687b ldr r3, [r7, #4]
|
|
8009e92: 601a str r2, [r3, #0]
|
|
|
|
/* If the block being inserted plugged a gab, so was merged with the block
|
|
before and the block after, then it's pxNextFreeBlock pointer will have
|
|
already been set, and should not be set here as that would make it point
|
|
to itself. */
|
|
if( pxIterator != pxBlockToInsert )
|
|
8009e94: 68fa ldr r2, [r7, #12]
|
|
8009e96: 687b ldr r3, [r7, #4]
|
|
8009e98: 429a cmp r2, r3
|
|
8009e9a: d002 beq.n 8009ea2 <prvInsertBlockIntoFreeList+0x9e>
|
|
{
|
|
pxIterator->pxNextFreeBlock = pxBlockToInsert;
|
|
8009e9c: 68fb ldr r3, [r7, #12]
|
|
8009e9e: 687a ldr r2, [r7, #4]
|
|
8009ea0: 601a str r2, [r3, #0]
|
|
}
|
|
else
|
|
{
|
|
mtCOVERAGE_TEST_MARKER();
|
|
}
|
|
}
|
|
8009ea2: bf00 nop
|
|
8009ea4: 3714 adds r7, #20
|
|
8009ea6: 46bd mov sp, r7
|
|
8009ea8: f85d 7b04 ldr.w r7, [sp], #4
|
|
8009eac: 4770 bx lr
|
|
8009eae: bf00 nop
|
|
8009eb0: 20004cf4 .word 0x20004cf4
|
|
8009eb4: 20004cfc .word 0x20004cfc
|
|
|
|
08009eb8 <__malloc_lock>:
|
|
8009eb8: 4801 ldr r0, [pc, #4] @ (8009ec0 <__malloc_lock+0x8>)
|
|
8009eba: f7f7 ba5c b.w 8001376 <__retarget_lock_acquire_recursive>
|
|
8009ebe: bf00 nop
|
|
8009ec0: 2000031c .word 0x2000031c
|
|
|
|
08009ec4 <__malloc_unlock>:
|
|
8009ec4: 4801 ldr r0, [pc, #4] @ (8009ecc <__malloc_unlock+0x8>)
|
|
8009ec6: f7f7 ba6b b.w 80013a0 <__retarget_lock_release_recursive>
|
|
8009eca: bf00 nop
|
|
8009ecc: 2000031c .word 0x2000031c
|
|
|
|
08009ed0 <memset>:
|
|
8009ed0: 4402 add r2, r0
|
|
8009ed2: 4603 mov r3, r0
|
|
8009ed4: 4293 cmp r3, r2
|
|
8009ed6: d100 bne.n 8009eda <memset+0xa>
|
|
8009ed8: 4770 bx lr
|
|
8009eda: f803 1b01 strb.w r1, [r3], #1
|
|
8009ede: e7f9 b.n 8009ed4 <memset+0x4>
|
|
|
|
08009ee0 <__libc_init_array>:
|
|
8009ee0: b570 push {r4, r5, r6, lr}
|
|
8009ee2: 4b0d ldr r3, [pc, #52] @ (8009f18 <__libc_init_array+0x38>)
|
|
8009ee4: 4d0d ldr r5, [pc, #52] @ (8009f1c <__libc_init_array+0x3c>)
|
|
8009ee6: 1b5b subs r3, r3, r5
|
|
8009ee8: 109c asrs r4, r3, #2
|
|
8009eea: 2600 movs r6, #0
|
|
8009eec: 42a6 cmp r6, r4
|
|
8009eee: d109 bne.n 8009f04 <__libc_init_array+0x24>
|
|
8009ef0: f000 f8d0 bl 800a094 <_init>
|
|
8009ef4: 4d0a ldr r5, [pc, #40] @ (8009f20 <__libc_init_array+0x40>)
|
|
8009ef6: 4b0b ldr r3, [pc, #44] @ (8009f24 <__libc_init_array+0x44>)
|
|
8009ef8: 1b5b subs r3, r3, r5
|
|
8009efa: 109c asrs r4, r3, #2
|
|
8009efc: 2600 movs r6, #0
|
|
8009efe: 42a6 cmp r6, r4
|
|
8009f00: d105 bne.n 8009f0e <__libc_init_array+0x2e>
|
|
8009f02: bd70 pop {r4, r5, r6, pc}
|
|
8009f04: f855 3b04 ldr.w r3, [r5], #4
|
|
8009f08: 4798 blx r3
|
|
8009f0a: 3601 adds r6, #1
|
|
8009f0c: e7ee b.n 8009eec <__libc_init_array+0xc>
|
|
8009f0e: f855 3b04 ldr.w r3, [r5], #4
|
|
8009f12: 4798 blx r3
|
|
8009f14: 3601 adds r6, #1
|
|
8009f16: e7f2 b.n 8009efe <__libc_init_array+0x1e>
|
|
8009f18: 0800a2c8 .word 0x0800a2c8
|
|
8009f1c: 0800a2c8 .word 0x0800a2c8
|
|
8009f20: 0800a2c8 .word 0x0800a2c8
|
|
8009f24: 0800a2cc .word 0x0800a2cc
|
|
|
|
08009f28 <_reclaim_reent>:
|
|
8009f28: 4b2d ldr r3, [pc, #180] @ (8009fe0 <_reclaim_reent+0xb8>)
|
|
8009f2a: 681b ldr r3, [r3, #0]
|
|
8009f2c: 4283 cmp r3, r0
|
|
8009f2e: b570 push {r4, r5, r6, lr}
|
|
8009f30: 4604 mov r4, r0
|
|
8009f32: d053 beq.n 8009fdc <_reclaim_reent+0xb4>
|
|
8009f34: 69c3 ldr r3, [r0, #28]
|
|
8009f36: b31b cbz r3, 8009f80 <_reclaim_reent+0x58>
|
|
8009f38: 68db ldr r3, [r3, #12]
|
|
8009f3a: b163 cbz r3, 8009f56 <_reclaim_reent+0x2e>
|
|
8009f3c: 2500 movs r5, #0
|
|
8009f3e: 69e3 ldr r3, [r4, #28]
|
|
8009f40: 68db ldr r3, [r3, #12]
|
|
8009f42: 5959 ldr r1, [r3, r5]
|
|
8009f44: b9b1 cbnz r1, 8009f74 <_reclaim_reent+0x4c>
|
|
8009f46: 3504 adds r5, #4
|
|
8009f48: 2d80 cmp r5, #128 @ 0x80
|
|
8009f4a: d1f8 bne.n 8009f3e <_reclaim_reent+0x16>
|
|
8009f4c: 69e3 ldr r3, [r4, #28]
|
|
8009f4e: 4620 mov r0, r4
|
|
8009f50: 68d9 ldr r1, [r3, #12]
|
|
8009f52: f000 f855 bl 800a000 <_free_r>
|
|
8009f56: 69e3 ldr r3, [r4, #28]
|
|
8009f58: 6819 ldr r1, [r3, #0]
|
|
8009f5a: b111 cbz r1, 8009f62 <_reclaim_reent+0x3a>
|
|
8009f5c: 4620 mov r0, r4
|
|
8009f5e: f000 f84f bl 800a000 <_free_r>
|
|
8009f62: 69e3 ldr r3, [r4, #28]
|
|
8009f64: 689d ldr r5, [r3, #8]
|
|
8009f66: b15d cbz r5, 8009f80 <_reclaim_reent+0x58>
|
|
8009f68: 4629 mov r1, r5
|
|
8009f6a: 4620 mov r0, r4
|
|
8009f6c: 682d ldr r5, [r5, #0]
|
|
8009f6e: f000 f847 bl 800a000 <_free_r>
|
|
8009f72: e7f8 b.n 8009f66 <_reclaim_reent+0x3e>
|
|
8009f74: 680e ldr r6, [r1, #0]
|
|
8009f76: 4620 mov r0, r4
|
|
8009f78: f000 f842 bl 800a000 <_free_r>
|
|
8009f7c: 4631 mov r1, r6
|
|
8009f7e: e7e1 b.n 8009f44 <_reclaim_reent+0x1c>
|
|
8009f80: 6961 ldr r1, [r4, #20]
|
|
8009f82: b111 cbz r1, 8009f8a <_reclaim_reent+0x62>
|
|
8009f84: 4620 mov r0, r4
|
|
8009f86: f000 f83b bl 800a000 <_free_r>
|
|
8009f8a: 69e1 ldr r1, [r4, #28]
|
|
8009f8c: b111 cbz r1, 8009f94 <_reclaim_reent+0x6c>
|
|
8009f8e: 4620 mov r0, r4
|
|
8009f90: f000 f836 bl 800a000 <_free_r>
|
|
8009f94: 6b21 ldr r1, [r4, #48] @ 0x30
|
|
8009f96: b111 cbz r1, 8009f9e <_reclaim_reent+0x76>
|
|
8009f98: 4620 mov r0, r4
|
|
8009f9a: f000 f831 bl 800a000 <_free_r>
|
|
8009f9e: 6b61 ldr r1, [r4, #52] @ 0x34
|
|
8009fa0: b111 cbz r1, 8009fa8 <_reclaim_reent+0x80>
|
|
8009fa2: 4620 mov r0, r4
|
|
8009fa4: f000 f82c bl 800a000 <_free_r>
|
|
8009fa8: 6ba1 ldr r1, [r4, #56] @ 0x38
|
|
8009faa: b111 cbz r1, 8009fb2 <_reclaim_reent+0x8a>
|
|
8009fac: 4620 mov r0, r4
|
|
8009fae: f000 f827 bl 800a000 <_free_r>
|
|
8009fb2: 6ca1 ldr r1, [r4, #72] @ 0x48
|
|
8009fb4: b111 cbz r1, 8009fbc <_reclaim_reent+0x94>
|
|
8009fb6: 4620 mov r0, r4
|
|
8009fb8: f000 f822 bl 800a000 <_free_r>
|
|
8009fbc: 6c61 ldr r1, [r4, #68] @ 0x44
|
|
8009fbe: b111 cbz r1, 8009fc6 <_reclaim_reent+0x9e>
|
|
8009fc0: 4620 mov r0, r4
|
|
8009fc2: f000 f81d bl 800a000 <_free_r>
|
|
8009fc6: 6ae1 ldr r1, [r4, #44] @ 0x2c
|
|
8009fc8: b111 cbz r1, 8009fd0 <_reclaim_reent+0xa8>
|
|
8009fca: 4620 mov r0, r4
|
|
8009fcc: f000 f818 bl 800a000 <_free_r>
|
|
8009fd0: 6a23 ldr r3, [r4, #32]
|
|
8009fd2: b11b cbz r3, 8009fdc <_reclaim_reent+0xb4>
|
|
8009fd4: 4620 mov r0, r4
|
|
8009fd6: e8bd 4070 ldmia.w sp!, {r4, r5, r6, lr}
|
|
8009fda: 4718 bx r3
|
|
8009fdc: bd70 pop {r4, r5, r6, pc}
|
|
8009fde: bf00 nop
|
|
8009fe0: 20000028 .word 0x20000028
|
|
|
|
08009fe4 <memcpy>:
|
|
8009fe4: 440a add r2, r1
|
|
8009fe6: 4291 cmp r1, r2
|
|
8009fe8: f100 33ff add.w r3, r0, #4294967295 @ 0xffffffff
|
|
8009fec: d100 bne.n 8009ff0 <memcpy+0xc>
|
|
8009fee: 4770 bx lr
|
|
8009ff0: b510 push {r4, lr}
|
|
8009ff2: f811 4b01 ldrb.w r4, [r1], #1
|
|
8009ff6: f803 4f01 strb.w r4, [r3, #1]!
|
|
8009ffa: 4291 cmp r1, r2
|
|
8009ffc: d1f9 bne.n 8009ff2 <memcpy+0xe>
|
|
8009ffe: bd10 pop {r4, pc}
|
|
|
|
0800a000 <_free_r>:
|
|
800a000: b538 push {r3, r4, r5, lr}
|
|
800a002: 4605 mov r5, r0
|
|
800a004: 2900 cmp r1, #0
|
|
800a006: d041 beq.n 800a08c <_free_r+0x8c>
|
|
800a008: f851 3c04 ldr.w r3, [r1, #-4]
|
|
800a00c: 1f0c subs r4, r1, #4
|
|
800a00e: 2b00 cmp r3, #0
|
|
800a010: bfb8 it lt
|
|
800a012: 18e4 addlt r4, r4, r3
|
|
800a014: f7ff ff50 bl 8009eb8 <__malloc_lock>
|
|
800a018: 4a1d ldr r2, [pc, #116] @ (800a090 <_free_r+0x90>)
|
|
800a01a: 6813 ldr r3, [r2, #0]
|
|
800a01c: b933 cbnz r3, 800a02c <_free_r+0x2c>
|
|
800a01e: 6063 str r3, [r4, #4]
|
|
800a020: 6014 str r4, [r2, #0]
|
|
800a022: 4628 mov r0, r5
|
|
800a024: e8bd 4038 ldmia.w sp!, {r3, r4, r5, lr}
|
|
800a028: f7ff bf4c b.w 8009ec4 <__malloc_unlock>
|
|
800a02c: 42a3 cmp r3, r4
|
|
800a02e: d908 bls.n 800a042 <_free_r+0x42>
|
|
800a030: 6820 ldr r0, [r4, #0]
|
|
800a032: 1821 adds r1, r4, r0
|
|
800a034: 428b cmp r3, r1
|
|
800a036: bf01 itttt eq
|
|
800a038: 6819 ldreq r1, [r3, #0]
|
|
800a03a: 685b ldreq r3, [r3, #4]
|
|
800a03c: 1809 addeq r1, r1, r0
|
|
800a03e: 6021 streq r1, [r4, #0]
|
|
800a040: e7ed b.n 800a01e <_free_r+0x1e>
|
|
800a042: 461a mov r2, r3
|
|
800a044: 685b ldr r3, [r3, #4]
|
|
800a046: b10b cbz r3, 800a04c <_free_r+0x4c>
|
|
800a048: 42a3 cmp r3, r4
|
|
800a04a: d9fa bls.n 800a042 <_free_r+0x42>
|
|
800a04c: 6811 ldr r1, [r2, #0]
|
|
800a04e: 1850 adds r0, r2, r1
|
|
800a050: 42a0 cmp r0, r4
|
|
800a052: d10b bne.n 800a06c <_free_r+0x6c>
|
|
800a054: 6820 ldr r0, [r4, #0]
|
|
800a056: 4401 add r1, r0
|
|
800a058: 1850 adds r0, r2, r1
|
|
800a05a: 4283 cmp r3, r0
|
|
800a05c: 6011 str r1, [r2, #0]
|
|
800a05e: d1e0 bne.n 800a022 <_free_r+0x22>
|
|
800a060: 6818 ldr r0, [r3, #0]
|
|
800a062: 685b ldr r3, [r3, #4]
|
|
800a064: 6053 str r3, [r2, #4]
|
|
800a066: 4408 add r0, r1
|
|
800a068: 6010 str r0, [r2, #0]
|
|
800a06a: e7da b.n 800a022 <_free_r+0x22>
|
|
800a06c: d902 bls.n 800a074 <_free_r+0x74>
|
|
800a06e: 230c movs r3, #12
|
|
800a070: 602b str r3, [r5, #0]
|
|
800a072: e7d6 b.n 800a022 <_free_r+0x22>
|
|
800a074: 6820 ldr r0, [r4, #0]
|
|
800a076: 1821 adds r1, r4, r0
|
|
800a078: 428b cmp r3, r1
|
|
800a07a: bf04 itt eq
|
|
800a07c: 6819 ldreq r1, [r3, #0]
|
|
800a07e: 685b ldreq r3, [r3, #4]
|
|
800a080: 6063 str r3, [r4, #4]
|
|
800a082: bf04 itt eq
|
|
800a084: 1809 addeq r1, r1, r0
|
|
800a086: 6021 streq r1, [r4, #0]
|
|
800a088: 6054 str r4, [r2, #4]
|
|
800a08a: e7ca b.n 800a022 <_free_r+0x22>
|
|
800a08c: bd38 pop {r3, r4, r5, pc}
|
|
800a08e: bf00 nop
|
|
800a090: 20004d14 .word 0x20004d14
|
|
|
|
0800a094 <_init>:
|
|
800a094: b5f8 push {r3, r4, r5, r6, r7, lr}
|
|
800a096: bf00 nop
|
|
800a098: bcf8 pop {r3, r4, r5, r6, r7}
|
|
800a09a: bc08 pop {r3}
|
|
800a09c: 469e mov lr, r3
|
|
800a09e: 4770 bx lr
|
|
|
|
0800a0a0 <_fini>:
|
|
800a0a0: b5f8 push {r3, r4, r5, r6, r7, lr}
|
|
800a0a2: bf00 nop
|
|
800a0a4: bcf8 pop {r3, r4, r5, r6, r7}
|
|
800a0a6: bc08 pop {r3}
|
|
800a0a8: 469e mov lr, r3
|
|
800a0aa: 4770 bx lr
|