41715 lines
1.5 MiB
41715 lines
1.5 MiB
|
|
suffix.elf: file format elf32-littlearm
|
|
|
|
Sections:
|
|
Idx Name Size VMA LMA File off Algn
|
|
0 .isr_vector 00000138 08000000 08000000 00001000 2**0
|
|
CONTENTS, ALLOC, LOAD, READONLY, DATA
|
|
1 .text 0000f744 08000140 08000140 00001140 2**4
|
|
CONTENTS, ALLOC, LOAD, READONLY, CODE
|
|
2 .rodata 00000dc8 0800f884 0800f884 00010884 2**2
|
|
CONTENTS, ALLOC, LOAD, READONLY, DATA
|
|
3 .ARM.extab 00000000 0801064c 0801064c 0001206c 2**0
|
|
CONTENTS, READONLY
|
|
4 .ARM 00000008 0801064c 0801064c 0001164c 2**2
|
|
CONTENTS, ALLOC, LOAD, READONLY, DATA
|
|
5 .preinit_array 00000000 08010654 08010654 0001206c 2**0
|
|
CONTENTS, ALLOC, LOAD, DATA
|
|
6 .init_array 00000004 08010654 08010654 00011654 2**2
|
|
CONTENTS, ALLOC, LOAD, READONLY, DATA
|
|
7 .fini_array 00000004 08010658 08010658 00011658 2**2
|
|
CONTENTS, ALLOC, LOAD, READONLY, DATA
|
|
8 .data 0000006c 20000000 0801065c 00012000 2**2
|
|
CONTENTS, ALLOC, LOAD, DATA
|
|
9 .bss 00001028 2000006c 080106c8 0001206c 2**2
|
|
ALLOC
|
|
10 ._user_heap_stack 00000a04 20001094 080106c8 00012094 2**0
|
|
ALLOC
|
|
11 .ARM.attributes 0000002a 00000000 00000000 0001206c 2**0
|
|
CONTENTS, READONLY
|
|
12 .debug_info 00025c8e 00000000 00000000 00012096 2**0
|
|
CONTENTS, READONLY, DEBUGGING, OCTETS
|
|
13 .debug_abbrev 000068c7 00000000 00000000 00037d24 2**0
|
|
CONTENTS, READONLY, DEBUGGING, OCTETS
|
|
14 .debug_aranges 00002340 00000000 00000000 0003e5f0 2**3
|
|
CONTENTS, READONLY, DEBUGGING, OCTETS
|
|
15 .debug_rnglists 00001a7a 00000000 00000000 00040930 2**0
|
|
CONTENTS, READONLY, DEBUGGING, OCTETS
|
|
16 .debug_macro 0002436a 00000000 00000000 000423aa 2**0
|
|
CONTENTS, READONLY, DEBUGGING, OCTETS
|
|
17 .debug_line 000258f8 00000000 00000000 00066714 2**0
|
|
CONTENTS, READONLY, DEBUGGING, OCTETS
|
|
18 .debug_str 000c7293 00000000 00000000 0008c00c 2**0
|
|
CONTENTS, READONLY, DEBUGGING, OCTETS
|
|
19 .comment 00000043 00000000 00000000 0015329f 2**0
|
|
CONTENTS, READONLY
|
|
20 .debug_frame 00009470 00000000 00000000 001532e4 2**2
|
|
CONTENTS, READONLY, DEBUGGING, OCTETS
|
|
21 .debug_line_str 0000004a 00000000 00000000 0015c754 2**0
|
|
CONTENTS, READONLY, DEBUGGING, OCTETS
|
|
|
|
Disassembly of section .text:
|
|
|
|
08000140 <__do_global_dtors_aux>:
|
|
8000140: b510 push {r4, lr}
|
|
8000142: 4c05 ldr r4, [pc, #20] @ (8000158 <__do_global_dtors_aux+0x18>)
|
|
8000144: 7823 ldrb r3, [r4, #0]
|
|
8000146: b933 cbnz r3, 8000156 <__do_global_dtors_aux+0x16>
|
|
8000148: 4b04 ldr r3, [pc, #16] @ (800015c <__do_global_dtors_aux+0x1c>)
|
|
800014a: b113 cbz r3, 8000152 <__do_global_dtors_aux+0x12>
|
|
800014c: 4804 ldr r0, [pc, #16] @ (8000160 <__do_global_dtors_aux+0x20>)
|
|
800014e: f3af 8000 nop.w
|
|
8000152: 2301 movs r3, #1
|
|
8000154: 7023 strb r3, [r4, #0]
|
|
8000156: bd10 pop {r4, pc}
|
|
8000158: 2000006c .word 0x2000006c
|
|
800015c: 00000000 .word 0x00000000
|
|
8000160: 0800f86c .word 0x0800f86c
|
|
|
|
08000164 <frame_dummy>:
|
|
8000164: b508 push {r3, lr}
|
|
8000166: 4b03 ldr r3, [pc, #12] @ (8000174 <frame_dummy+0x10>)
|
|
8000168: b11b cbz r3, 8000172 <frame_dummy+0xe>
|
|
800016a: 4903 ldr r1, [pc, #12] @ (8000178 <frame_dummy+0x14>)
|
|
800016c: 4803 ldr r0, [pc, #12] @ (800017c <frame_dummy+0x18>)
|
|
800016e: f3af 8000 nop.w
|
|
8000172: bd08 pop {r3, pc}
|
|
8000174: 00000000 .word 0x00000000
|
|
8000178: 20000070 .word 0x20000070
|
|
800017c: 0800f86c .word 0x0800f86c
|
|
|
|
08000180 <strcmp>:
|
|
8000180: f810 2b01 ldrb.w r2, [r0], #1
|
|
8000184: f811 3b01 ldrb.w r3, [r1], #1
|
|
8000188: 2a01 cmp r2, #1
|
|
800018a: bf28 it cs
|
|
800018c: 429a cmpcs r2, r3
|
|
800018e: d0f7 beq.n 8000180 <strcmp>
|
|
8000190: 1ad0 subs r0, r2, r3
|
|
8000192: 4770 bx lr
|
|
|
|
08000194 <strlen>:
|
|
8000194: 4603 mov r3, r0
|
|
8000196: f813 2b01 ldrb.w r2, [r3], #1
|
|
800019a: 2a00 cmp r2, #0
|
|
800019c: d1fb bne.n 8000196 <strlen+0x2>
|
|
800019e: 1a18 subs r0, r3, r0
|
|
80001a0: 3801 subs r0, #1
|
|
80001a2: 4770 bx lr
|
|
...
|
|
|
|
080001b0 <memchr>:
|
|
80001b0: f001 01ff and.w r1, r1, #255 @ 0xff
|
|
80001b4: 2a10 cmp r2, #16
|
|
80001b6: db2b blt.n 8000210 <memchr+0x60>
|
|
80001b8: f010 0f07 tst.w r0, #7
|
|
80001bc: d008 beq.n 80001d0 <memchr+0x20>
|
|
80001be: f810 3b01 ldrb.w r3, [r0], #1
|
|
80001c2: 3a01 subs r2, #1
|
|
80001c4: 428b cmp r3, r1
|
|
80001c6: d02d beq.n 8000224 <memchr+0x74>
|
|
80001c8: f010 0f07 tst.w r0, #7
|
|
80001cc: b342 cbz r2, 8000220 <memchr+0x70>
|
|
80001ce: d1f6 bne.n 80001be <memchr+0xe>
|
|
80001d0: b4f0 push {r4, r5, r6, r7}
|
|
80001d2: ea41 2101 orr.w r1, r1, r1, lsl #8
|
|
80001d6: ea41 4101 orr.w r1, r1, r1, lsl #16
|
|
80001da: f022 0407 bic.w r4, r2, #7
|
|
80001de: f07f 0700 mvns.w r7, #0
|
|
80001e2: 2300 movs r3, #0
|
|
80001e4: e8f0 5602 ldrd r5, r6, [r0], #8
|
|
80001e8: 3c08 subs r4, #8
|
|
80001ea: ea85 0501 eor.w r5, r5, r1
|
|
80001ee: ea86 0601 eor.w r6, r6, r1
|
|
80001f2: fa85 f547 uadd8 r5, r5, r7
|
|
80001f6: faa3 f587 sel r5, r3, r7
|
|
80001fa: fa86 f647 uadd8 r6, r6, r7
|
|
80001fe: faa5 f687 sel r6, r5, r7
|
|
8000202: b98e cbnz r6, 8000228 <memchr+0x78>
|
|
8000204: d1ee bne.n 80001e4 <memchr+0x34>
|
|
8000206: bcf0 pop {r4, r5, r6, r7}
|
|
8000208: f001 01ff and.w r1, r1, #255 @ 0xff
|
|
800020c: f002 0207 and.w r2, r2, #7
|
|
8000210: b132 cbz r2, 8000220 <memchr+0x70>
|
|
8000212: f810 3b01 ldrb.w r3, [r0], #1
|
|
8000216: 3a01 subs r2, #1
|
|
8000218: ea83 0301 eor.w r3, r3, r1
|
|
800021c: b113 cbz r3, 8000224 <memchr+0x74>
|
|
800021e: d1f8 bne.n 8000212 <memchr+0x62>
|
|
8000220: 2000 movs r0, #0
|
|
8000222: 4770 bx lr
|
|
8000224: 3801 subs r0, #1
|
|
8000226: 4770 bx lr
|
|
8000228: 2d00 cmp r5, #0
|
|
800022a: bf06 itte eq
|
|
800022c: 4635 moveq r5, r6
|
|
800022e: 3803 subeq r0, #3
|
|
8000230: 3807 subne r0, #7
|
|
8000232: f015 0f01 tst.w r5, #1
|
|
8000236: d107 bne.n 8000248 <memchr+0x98>
|
|
8000238: 3001 adds r0, #1
|
|
800023a: f415 7f80 tst.w r5, #256 @ 0x100
|
|
800023e: bf02 ittt eq
|
|
8000240: 3001 addeq r0, #1
|
|
8000242: f415 3fc0 tsteq.w r5, #98304 @ 0x18000
|
|
8000246: 3001 addeq r0, #1
|
|
8000248: bcf0 pop {r4, r5, r6, r7}
|
|
800024a: 3801 subs r0, #1
|
|
800024c: 4770 bx lr
|
|
800024e: bf00 nop
|
|
|
|
08000250 <__aeabi_uldivmod>:
|
|
8000250: b953 cbnz r3, 8000268 <__aeabi_uldivmod+0x18>
|
|
8000252: b94a cbnz r2, 8000268 <__aeabi_uldivmod+0x18>
|
|
8000254: 2900 cmp r1, #0
|
|
8000256: bf08 it eq
|
|
8000258: 2800 cmpeq r0, #0
|
|
800025a: bf1c itt ne
|
|
800025c: f04f 31ff movne.w r1, #4294967295 @ 0xffffffff
|
|
8000260: f04f 30ff movne.w r0, #4294967295 @ 0xffffffff
|
|
8000264: f000 b988 b.w 8000578 <__aeabi_idiv0>
|
|
8000268: f1ad 0c08 sub.w ip, sp, #8
|
|
800026c: e96d ce04 strd ip, lr, [sp, #-16]!
|
|
8000270: f000 f806 bl 8000280 <__udivmoddi4>
|
|
8000274: f8dd e004 ldr.w lr, [sp, #4]
|
|
8000278: e9dd 2302 ldrd r2, r3, [sp, #8]
|
|
800027c: b004 add sp, #16
|
|
800027e: 4770 bx lr
|
|
|
|
08000280 <__udivmoddi4>:
|
|
8000280: e92d 47f0 stmdb sp!, {r4, r5, r6, r7, r8, r9, sl, lr}
|
|
8000284: 9d08 ldr r5, [sp, #32]
|
|
8000286: 468e mov lr, r1
|
|
8000288: 4604 mov r4, r0
|
|
800028a: 4688 mov r8, r1
|
|
800028c: 2b00 cmp r3, #0
|
|
800028e: d14a bne.n 8000326 <__udivmoddi4+0xa6>
|
|
8000290: 428a cmp r2, r1
|
|
8000292: 4617 mov r7, r2
|
|
8000294: d962 bls.n 800035c <__udivmoddi4+0xdc>
|
|
8000296: fab2 f682 clz r6, r2
|
|
800029a: b14e cbz r6, 80002b0 <__udivmoddi4+0x30>
|
|
800029c: f1c6 0320 rsb r3, r6, #32
|
|
80002a0: fa01 f806 lsl.w r8, r1, r6
|
|
80002a4: fa20 f303 lsr.w r3, r0, r3
|
|
80002a8: 40b7 lsls r7, r6
|
|
80002aa: ea43 0808 orr.w r8, r3, r8
|
|
80002ae: 40b4 lsls r4, r6
|
|
80002b0: ea4f 4e17 mov.w lr, r7, lsr #16
|
|
80002b4: fa1f fc87 uxth.w ip, r7
|
|
80002b8: fbb8 f1fe udiv r1, r8, lr
|
|
80002bc: 0c23 lsrs r3, r4, #16
|
|
80002be: fb0e 8811 mls r8, lr, r1, r8
|
|
80002c2: ea43 4308 orr.w r3, r3, r8, lsl #16
|
|
80002c6: fb01 f20c mul.w r2, r1, ip
|
|
80002ca: 429a cmp r2, r3
|
|
80002cc: d909 bls.n 80002e2 <__udivmoddi4+0x62>
|
|
80002ce: 18fb adds r3, r7, r3
|
|
80002d0: f101 30ff add.w r0, r1, #4294967295 @ 0xffffffff
|
|
80002d4: f080 80ea bcs.w 80004ac <__udivmoddi4+0x22c>
|
|
80002d8: 429a cmp r2, r3
|
|
80002da: f240 80e7 bls.w 80004ac <__udivmoddi4+0x22c>
|
|
80002de: 3902 subs r1, #2
|
|
80002e0: 443b add r3, r7
|
|
80002e2: 1a9a subs r2, r3, r2
|
|
80002e4: b2a3 uxth r3, r4
|
|
80002e6: fbb2 f0fe udiv r0, r2, lr
|
|
80002ea: fb0e 2210 mls r2, lr, r0, r2
|
|
80002ee: ea43 4302 orr.w r3, r3, r2, lsl #16
|
|
80002f2: fb00 fc0c mul.w ip, r0, ip
|
|
80002f6: 459c cmp ip, r3
|
|
80002f8: d909 bls.n 800030e <__udivmoddi4+0x8e>
|
|
80002fa: 18fb adds r3, r7, r3
|
|
80002fc: f100 32ff add.w r2, r0, #4294967295 @ 0xffffffff
|
|
8000300: f080 80d6 bcs.w 80004b0 <__udivmoddi4+0x230>
|
|
8000304: 459c cmp ip, r3
|
|
8000306: f240 80d3 bls.w 80004b0 <__udivmoddi4+0x230>
|
|
800030a: 443b add r3, r7
|
|
800030c: 3802 subs r0, #2
|
|
800030e: ea40 4001 orr.w r0, r0, r1, lsl #16
|
|
8000312: eba3 030c sub.w r3, r3, ip
|
|
8000316: 2100 movs r1, #0
|
|
8000318: b11d cbz r5, 8000322 <__udivmoddi4+0xa2>
|
|
800031a: 40f3 lsrs r3, r6
|
|
800031c: 2200 movs r2, #0
|
|
800031e: e9c5 3200 strd r3, r2, [r5]
|
|
8000322: e8bd 87f0 ldmia.w sp!, {r4, r5, r6, r7, r8, r9, sl, pc}
|
|
8000326: 428b cmp r3, r1
|
|
8000328: d905 bls.n 8000336 <__udivmoddi4+0xb6>
|
|
800032a: b10d cbz r5, 8000330 <__udivmoddi4+0xb0>
|
|
800032c: e9c5 0100 strd r0, r1, [r5]
|
|
8000330: 2100 movs r1, #0
|
|
8000332: 4608 mov r0, r1
|
|
8000334: e7f5 b.n 8000322 <__udivmoddi4+0xa2>
|
|
8000336: fab3 f183 clz r1, r3
|
|
800033a: 2900 cmp r1, #0
|
|
800033c: d146 bne.n 80003cc <__udivmoddi4+0x14c>
|
|
800033e: 4573 cmp r3, lr
|
|
8000340: d302 bcc.n 8000348 <__udivmoddi4+0xc8>
|
|
8000342: 4282 cmp r2, r0
|
|
8000344: f200 8105 bhi.w 8000552 <__udivmoddi4+0x2d2>
|
|
8000348: 1a84 subs r4, r0, r2
|
|
800034a: eb6e 0203 sbc.w r2, lr, r3
|
|
800034e: 2001 movs r0, #1
|
|
8000350: 4690 mov r8, r2
|
|
8000352: 2d00 cmp r5, #0
|
|
8000354: d0e5 beq.n 8000322 <__udivmoddi4+0xa2>
|
|
8000356: e9c5 4800 strd r4, r8, [r5]
|
|
800035a: e7e2 b.n 8000322 <__udivmoddi4+0xa2>
|
|
800035c: 2a00 cmp r2, #0
|
|
800035e: f000 8090 beq.w 8000482 <__udivmoddi4+0x202>
|
|
8000362: fab2 f682 clz r6, r2
|
|
8000366: 2e00 cmp r6, #0
|
|
8000368: f040 80a4 bne.w 80004b4 <__udivmoddi4+0x234>
|
|
800036c: 1a8a subs r2, r1, r2
|
|
800036e: 0c03 lsrs r3, r0, #16
|
|
8000370: ea4f 4e17 mov.w lr, r7, lsr #16
|
|
8000374: b280 uxth r0, r0
|
|
8000376: b2bc uxth r4, r7
|
|
8000378: 2101 movs r1, #1
|
|
800037a: fbb2 fcfe udiv ip, r2, lr
|
|
800037e: fb0e 221c mls r2, lr, ip, r2
|
|
8000382: ea43 4302 orr.w r3, r3, r2, lsl #16
|
|
8000386: fb04 f20c mul.w r2, r4, ip
|
|
800038a: 429a cmp r2, r3
|
|
800038c: d907 bls.n 800039e <__udivmoddi4+0x11e>
|
|
800038e: 18fb adds r3, r7, r3
|
|
8000390: f10c 38ff add.w r8, ip, #4294967295 @ 0xffffffff
|
|
8000394: d202 bcs.n 800039c <__udivmoddi4+0x11c>
|
|
8000396: 429a cmp r2, r3
|
|
8000398: f200 80e0 bhi.w 800055c <__udivmoddi4+0x2dc>
|
|
800039c: 46c4 mov ip, r8
|
|
800039e: 1a9b subs r3, r3, r2
|
|
80003a0: fbb3 f2fe udiv r2, r3, lr
|
|
80003a4: fb0e 3312 mls r3, lr, r2, r3
|
|
80003a8: ea40 4303 orr.w r3, r0, r3, lsl #16
|
|
80003ac: fb02 f404 mul.w r4, r2, r4
|
|
80003b0: 429c cmp r4, r3
|
|
80003b2: d907 bls.n 80003c4 <__udivmoddi4+0x144>
|
|
80003b4: 18fb adds r3, r7, r3
|
|
80003b6: f102 30ff add.w r0, r2, #4294967295 @ 0xffffffff
|
|
80003ba: d202 bcs.n 80003c2 <__udivmoddi4+0x142>
|
|
80003bc: 429c cmp r4, r3
|
|
80003be: f200 80ca bhi.w 8000556 <__udivmoddi4+0x2d6>
|
|
80003c2: 4602 mov r2, r0
|
|
80003c4: 1b1b subs r3, r3, r4
|
|
80003c6: ea42 400c orr.w r0, r2, ip, lsl #16
|
|
80003ca: e7a5 b.n 8000318 <__udivmoddi4+0x98>
|
|
80003cc: f1c1 0620 rsb r6, r1, #32
|
|
80003d0: 408b lsls r3, r1
|
|
80003d2: fa22 f706 lsr.w r7, r2, r6
|
|
80003d6: 431f orrs r7, r3
|
|
80003d8: fa0e f401 lsl.w r4, lr, r1
|
|
80003dc: fa20 f306 lsr.w r3, r0, r6
|
|
80003e0: fa2e fe06 lsr.w lr, lr, r6
|
|
80003e4: ea4f 4917 mov.w r9, r7, lsr #16
|
|
80003e8: 4323 orrs r3, r4
|
|
80003ea: fa00 f801 lsl.w r8, r0, r1
|
|
80003ee: fa1f fc87 uxth.w ip, r7
|
|
80003f2: fbbe f0f9 udiv r0, lr, r9
|
|
80003f6: 0c1c lsrs r4, r3, #16
|
|
80003f8: fb09 ee10 mls lr, r9, r0, lr
|
|
80003fc: ea44 440e orr.w r4, r4, lr, lsl #16
|
|
8000400: fb00 fe0c mul.w lr, r0, ip
|
|
8000404: 45a6 cmp lr, r4
|
|
8000406: fa02 f201 lsl.w r2, r2, r1
|
|
800040a: d909 bls.n 8000420 <__udivmoddi4+0x1a0>
|
|
800040c: 193c adds r4, r7, r4
|
|
800040e: f100 3aff add.w sl, r0, #4294967295 @ 0xffffffff
|
|
8000412: f080 809c bcs.w 800054e <__udivmoddi4+0x2ce>
|
|
8000416: 45a6 cmp lr, r4
|
|
8000418: f240 8099 bls.w 800054e <__udivmoddi4+0x2ce>
|
|
800041c: 3802 subs r0, #2
|
|
800041e: 443c add r4, r7
|
|
8000420: eba4 040e sub.w r4, r4, lr
|
|
8000424: fa1f fe83 uxth.w lr, r3
|
|
8000428: fbb4 f3f9 udiv r3, r4, r9
|
|
800042c: fb09 4413 mls r4, r9, r3, r4
|
|
8000430: ea4e 4404 orr.w r4, lr, r4, lsl #16
|
|
8000434: fb03 fc0c mul.w ip, r3, ip
|
|
8000438: 45a4 cmp ip, r4
|
|
800043a: d908 bls.n 800044e <__udivmoddi4+0x1ce>
|
|
800043c: 193c adds r4, r7, r4
|
|
800043e: f103 3eff add.w lr, r3, #4294967295 @ 0xffffffff
|
|
8000442: f080 8082 bcs.w 800054a <__udivmoddi4+0x2ca>
|
|
8000446: 45a4 cmp ip, r4
|
|
8000448: d97f bls.n 800054a <__udivmoddi4+0x2ca>
|
|
800044a: 3b02 subs r3, #2
|
|
800044c: 443c add r4, r7
|
|
800044e: ea43 4000 orr.w r0, r3, r0, lsl #16
|
|
8000452: eba4 040c sub.w r4, r4, ip
|
|
8000456: fba0 ec02 umull lr, ip, r0, r2
|
|
800045a: 4564 cmp r4, ip
|
|
800045c: 4673 mov r3, lr
|
|
800045e: 46e1 mov r9, ip
|
|
8000460: d362 bcc.n 8000528 <__udivmoddi4+0x2a8>
|
|
8000462: d05f beq.n 8000524 <__udivmoddi4+0x2a4>
|
|
8000464: b15d cbz r5, 800047e <__udivmoddi4+0x1fe>
|
|
8000466: ebb8 0203 subs.w r2, r8, r3
|
|
800046a: eb64 0409 sbc.w r4, r4, r9
|
|
800046e: fa04 f606 lsl.w r6, r4, r6
|
|
8000472: fa22 f301 lsr.w r3, r2, r1
|
|
8000476: 431e orrs r6, r3
|
|
8000478: 40cc lsrs r4, r1
|
|
800047a: e9c5 6400 strd r6, r4, [r5]
|
|
800047e: 2100 movs r1, #0
|
|
8000480: e74f b.n 8000322 <__udivmoddi4+0xa2>
|
|
8000482: fbb1 fcf2 udiv ip, r1, r2
|
|
8000486: 0c01 lsrs r1, r0, #16
|
|
8000488: ea41 410e orr.w r1, r1, lr, lsl #16
|
|
800048c: b280 uxth r0, r0
|
|
800048e: ea40 4201 orr.w r2, r0, r1, lsl #16
|
|
8000492: 463b mov r3, r7
|
|
8000494: 4638 mov r0, r7
|
|
8000496: 463c mov r4, r7
|
|
8000498: 46b8 mov r8, r7
|
|
800049a: 46be mov lr, r7
|
|
800049c: 2620 movs r6, #32
|
|
800049e: fbb1 f1f7 udiv r1, r1, r7
|
|
80004a2: eba2 0208 sub.w r2, r2, r8
|
|
80004a6: ea41 410c orr.w r1, r1, ip, lsl #16
|
|
80004aa: e766 b.n 800037a <__udivmoddi4+0xfa>
|
|
80004ac: 4601 mov r1, r0
|
|
80004ae: e718 b.n 80002e2 <__udivmoddi4+0x62>
|
|
80004b0: 4610 mov r0, r2
|
|
80004b2: e72c b.n 800030e <__udivmoddi4+0x8e>
|
|
80004b4: f1c6 0220 rsb r2, r6, #32
|
|
80004b8: fa2e f302 lsr.w r3, lr, r2
|
|
80004bc: 40b7 lsls r7, r6
|
|
80004be: 40b1 lsls r1, r6
|
|
80004c0: fa20 f202 lsr.w r2, r0, r2
|
|
80004c4: ea4f 4e17 mov.w lr, r7, lsr #16
|
|
80004c8: 430a orrs r2, r1
|
|
80004ca: fbb3 f8fe udiv r8, r3, lr
|
|
80004ce: b2bc uxth r4, r7
|
|
80004d0: fb0e 3318 mls r3, lr, r8, r3
|
|
80004d4: 0c11 lsrs r1, r2, #16
|
|
80004d6: ea41 4103 orr.w r1, r1, r3, lsl #16
|
|
80004da: fb08 f904 mul.w r9, r8, r4
|
|
80004de: 40b0 lsls r0, r6
|
|
80004e0: 4589 cmp r9, r1
|
|
80004e2: ea4f 4310 mov.w r3, r0, lsr #16
|
|
80004e6: b280 uxth r0, r0
|
|
80004e8: d93e bls.n 8000568 <__udivmoddi4+0x2e8>
|
|
80004ea: 1879 adds r1, r7, r1
|
|
80004ec: f108 3cff add.w ip, r8, #4294967295 @ 0xffffffff
|
|
80004f0: d201 bcs.n 80004f6 <__udivmoddi4+0x276>
|
|
80004f2: 4589 cmp r9, r1
|
|
80004f4: d81f bhi.n 8000536 <__udivmoddi4+0x2b6>
|
|
80004f6: eba1 0109 sub.w r1, r1, r9
|
|
80004fa: fbb1 f9fe udiv r9, r1, lr
|
|
80004fe: fb09 f804 mul.w r8, r9, r4
|
|
8000502: fb0e 1119 mls r1, lr, r9, r1
|
|
8000506: b292 uxth r2, r2
|
|
8000508: ea42 4201 orr.w r2, r2, r1, lsl #16
|
|
800050c: 4542 cmp r2, r8
|
|
800050e: d229 bcs.n 8000564 <__udivmoddi4+0x2e4>
|
|
8000510: 18ba adds r2, r7, r2
|
|
8000512: f109 31ff add.w r1, r9, #4294967295 @ 0xffffffff
|
|
8000516: d2c4 bcs.n 80004a2 <__udivmoddi4+0x222>
|
|
8000518: 4542 cmp r2, r8
|
|
800051a: d2c2 bcs.n 80004a2 <__udivmoddi4+0x222>
|
|
800051c: f1a9 0102 sub.w r1, r9, #2
|
|
8000520: 443a add r2, r7
|
|
8000522: e7be b.n 80004a2 <__udivmoddi4+0x222>
|
|
8000524: 45f0 cmp r8, lr
|
|
8000526: d29d bcs.n 8000464 <__udivmoddi4+0x1e4>
|
|
8000528: ebbe 0302 subs.w r3, lr, r2
|
|
800052c: eb6c 0c07 sbc.w ip, ip, r7
|
|
8000530: 3801 subs r0, #1
|
|
8000532: 46e1 mov r9, ip
|
|
8000534: e796 b.n 8000464 <__udivmoddi4+0x1e4>
|
|
8000536: eba7 0909 sub.w r9, r7, r9
|
|
800053a: 4449 add r1, r9
|
|
800053c: f1a8 0c02 sub.w ip, r8, #2
|
|
8000540: fbb1 f9fe udiv r9, r1, lr
|
|
8000544: fb09 f804 mul.w r8, r9, r4
|
|
8000548: e7db b.n 8000502 <__udivmoddi4+0x282>
|
|
800054a: 4673 mov r3, lr
|
|
800054c: e77f b.n 800044e <__udivmoddi4+0x1ce>
|
|
800054e: 4650 mov r0, sl
|
|
8000550: e766 b.n 8000420 <__udivmoddi4+0x1a0>
|
|
8000552: 4608 mov r0, r1
|
|
8000554: e6fd b.n 8000352 <__udivmoddi4+0xd2>
|
|
8000556: 443b add r3, r7
|
|
8000558: 3a02 subs r2, #2
|
|
800055a: e733 b.n 80003c4 <__udivmoddi4+0x144>
|
|
800055c: f1ac 0c02 sub.w ip, ip, #2
|
|
8000560: 443b add r3, r7
|
|
8000562: e71c b.n 800039e <__udivmoddi4+0x11e>
|
|
8000564: 4649 mov r1, r9
|
|
8000566: e79c b.n 80004a2 <__udivmoddi4+0x222>
|
|
8000568: eba1 0109 sub.w r1, r1, r9
|
|
800056c: 46c4 mov ip, r8
|
|
800056e: fbb1 f9fe udiv r9, r1, lr
|
|
8000572: fb09 f804 mul.w r8, r9, r4
|
|
8000576: e7c4 b.n 8000502 <__udivmoddi4+0x282>
|
|
|
|
08000578 <__aeabi_idiv0>:
|
|
8000578: 4770 bx lr
|
|
800057a: bf00 nop
|
|
|
|
0800057c <LL_AHB1_GRP1_EnableClock>:
|
|
* @arg @ref LL_AHB1_GRP1_PERIPH_DMAMUX1
|
|
* @arg @ref LL_AHB1_GRP1_PERIPH_CRC
|
|
* @retval None
|
|
*/
|
|
__STATIC_INLINE void LL_AHB1_GRP1_EnableClock(uint32_t Periphs)
|
|
{
|
|
800057c: b480 push {r7}
|
|
800057e: b085 sub sp, #20
|
|
8000580: af00 add r7, sp, #0
|
|
8000582: 6078 str r0, [r7, #4]
|
|
__IO uint32_t tmpreg;
|
|
SET_BIT(RCC->AHB1ENR, Periphs);
|
|
8000584: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8000588: 6c9a ldr r2, [r3, #72] @ 0x48
|
|
800058a: f04f 41b0 mov.w r1, #1476395008 @ 0x58000000
|
|
800058e: 687b ldr r3, [r7, #4]
|
|
8000590: 4313 orrs r3, r2
|
|
8000592: 648b str r3, [r1, #72] @ 0x48
|
|
/* Delay after an RCC peripheral clock enabling */
|
|
tmpreg = READ_BIT(RCC->AHB1ENR, Periphs);
|
|
8000594: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8000598: 6c9a ldr r2, [r3, #72] @ 0x48
|
|
800059a: 687b ldr r3, [r7, #4]
|
|
800059c: 4013 ands r3, r2
|
|
800059e: 60fb str r3, [r7, #12]
|
|
(void)tmpreg;
|
|
80005a0: 68fb ldr r3, [r7, #12]
|
|
}
|
|
80005a2: bf00 nop
|
|
80005a4: 3714 adds r7, #20
|
|
80005a6: 46bd mov sp, r7
|
|
80005a8: bc80 pop {r7}
|
|
80005aa: 4770 bx lr
|
|
|
|
080005ac <MX_DMA_Init>:
|
|
|
|
/**
|
|
* Enable DMA controller clock
|
|
*/
|
|
void MX_DMA_Init(void)
|
|
{
|
|
80005ac: b580 push {r7, lr}
|
|
80005ae: af00 add r7, sp, #0
|
|
|
|
/* DMA controller clock enable */
|
|
__HAL_RCC_DMAMUX1_CLK_ENABLE();
|
|
80005b0: 2004 movs r0, #4
|
|
80005b2: f7ff ffe3 bl 800057c <LL_AHB1_GRP1_EnableClock>
|
|
__HAL_RCC_DMA1_CLK_ENABLE();
|
|
80005b6: 2001 movs r0, #1
|
|
80005b8: f7ff ffe0 bl 800057c <LL_AHB1_GRP1_EnableClock>
|
|
|
|
/* DMA interrupt init */
|
|
/* DMA1_Channel5_IRQn interrupt configuration */
|
|
HAL_NVIC_SetPriority(DMA1_Channel5_IRQn, 2, 0);
|
|
80005bc: 2200 movs r2, #0
|
|
80005be: 2102 movs r1, #2
|
|
80005c0: 200f movs r0, #15
|
|
80005c2: f001 fadc bl 8001b7e <HAL_NVIC_SetPriority>
|
|
HAL_NVIC_EnableIRQ(DMA1_Channel5_IRQn);
|
|
80005c6: 200f movs r0, #15
|
|
80005c8: f001 faf3 bl 8001bb2 <HAL_NVIC_EnableIRQ>
|
|
|
|
}
|
|
80005cc: bf00 nop
|
|
80005ce: bd80 pop {r7, pc}
|
|
|
|
080005d0 <LL_AHB2_GRP1_EnableClock>:
|
|
* @arg @ref LL_AHB2_GRP1_PERIPH_GPIOC
|
|
* @arg @ref LL_AHB2_GRP1_PERIPH_GPIOH
|
|
* @retval None
|
|
*/
|
|
__STATIC_INLINE void LL_AHB2_GRP1_EnableClock(uint32_t Periphs)
|
|
{
|
|
80005d0: b480 push {r7}
|
|
80005d2: b085 sub sp, #20
|
|
80005d4: af00 add r7, sp, #0
|
|
80005d6: 6078 str r0, [r7, #4]
|
|
__IO uint32_t tmpreg;
|
|
SET_BIT(RCC->AHB2ENR, Periphs);
|
|
80005d8: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
80005dc: 6cda ldr r2, [r3, #76] @ 0x4c
|
|
80005de: f04f 41b0 mov.w r1, #1476395008 @ 0x58000000
|
|
80005e2: 687b ldr r3, [r7, #4]
|
|
80005e4: 4313 orrs r3, r2
|
|
80005e6: 64cb str r3, [r1, #76] @ 0x4c
|
|
/* Delay after an RCC peripheral clock enabling */
|
|
tmpreg = READ_BIT(RCC->AHB2ENR, Periphs);
|
|
80005e8: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
80005ec: 6cda ldr r2, [r3, #76] @ 0x4c
|
|
80005ee: 687b ldr r3, [r7, #4]
|
|
80005f0: 4013 ands r3, r2
|
|
80005f2: 60fb str r3, [r7, #12]
|
|
(void)tmpreg;
|
|
80005f4: 68fb ldr r3, [r7, #12]
|
|
}
|
|
80005f6: bf00 nop
|
|
80005f8: 3714 adds r7, #20
|
|
80005fa: 46bd mov sp, r7
|
|
80005fc: bc80 pop {r7}
|
|
80005fe: 4770 bx lr
|
|
|
|
08000600 <MX_GPIO_Init>:
|
|
* Output
|
|
* EVENT_OUT
|
|
* EXTI
|
|
*/
|
|
void MX_GPIO_Init(void)
|
|
{
|
|
8000600: b580 push {r7, lr}
|
|
8000602: b086 sub sp, #24
|
|
8000604: af00 add r7, sp, #0
|
|
|
|
GPIO_InitTypeDef GPIO_InitStruct = {0};
|
|
8000606: 1d3b adds r3, r7, #4
|
|
8000608: 2200 movs r2, #0
|
|
800060a: 601a str r2, [r3, #0]
|
|
800060c: 605a str r2, [r3, #4]
|
|
800060e: 609a str r2, [r3, #8]
|
|
8000610: 60da str r2, [r3, #12]
|
|
8000612: 611a str r2, [r3, #16]
|
|
|
|
/* GPIO Ports Clock Enable */
|
|
__HAL_RCC_GPIOB_CLK_ENABLE();
|
|
8000614: 2002 movs r0, #2
|
|
8000616: f7ff ffdb bl 80005d0 <LL_AHB2_GRP1_EnableClock>
|
|
__HAL_RCC_GPIOC_CLK_ENABLE();
|
|
800061a: 2004 movs r0, #4
|
|
800061c: f7ff ffd8 bl 80005d0 <LL_AHB2_GRP1_EnableClock>
|
|
__HAL_RCC_GPIOA_CLK_ENABLE();
|
|
8000620: 2001 movs r0, #1
|
|
8000622: f7ff ffd5 bl 80005d0 <LL_AHB2_GRP1_EnableClock>
|
|
|
|
/*Configure GPIO pin Output Level */
|
|
HAL_GPIO_WritePin(GPIOB, LED1_Pin|LED2_Pin|PROB2_Pin|PROB1_Pin
|
|
8000626: 2200 movs r2, #0
|
|
8000628: f44f 413a mov.w r1, #47616 @ 0xba00
|
|
800062c: 4829 ldr r0, [pc, #164] @ (80006d4 <MX_GPIO_Init+0xd4>)
|
|
800062e: f002 fb4b bl 8002cc8 <HAL_GPIO_WritePin>
|
|
|LED3_Pin, GPIO_PIN_RESET);
|
|
|
|
/*Configure GPIO pins : LED1_Pin LED2_Pin LED3_Pin */
|
|
GPIO_InitStruct.Pin = LED1_Pin|LED2_Pin|LED3_Pin;
|
|
8000632: f44f 430a mov.w r3, #35328 @ 0x8a00
|
|
8000636: 607b str r3, [r7, #4]
|
|
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
8000638: 2301 movs r3, #1
|
|
800063a: 60bb str r3, [r7, #8]
|
|
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
800063c: 2300 movs r3, #0
|
|
800063e: 60fb str r3, [r7, #12]
|
|
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_HIGH;
|
|
8000640: 2302 movs r3, #2
|
|
8000642: 613b str r3, [r7, #16]
|
|
HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
|
|
8000644: 1d3b adds r3, r7, #4
|
|
8000646: 4619 mov r1, r3
|
|
8000648: 4822 ldr r0, [pc, #136] @ (80006d4 <MX_GPIO_Init+0xd4>)
|
|
800064a: f002 f90f bl 800286c <HAL_GPIO_Init>
|
|
|
|
/*Configure GPIO pins : BUT1_Pin BUT2_Pin */
|
|
GPIO_InitStruct.Pin = BUT1_Pin|BUT2_Pin;
|
|
800064e: 2303 movs r3, #3
|
|
8000650: 607b str r3, [r7, #4]
|
|
GPIO_InitStruct.Mode = GPIO_MODE_IT_FALLING;
|
|
8000652: f44f 1304 mov.w r3, #2162688 @ 0x210000
|
|
8000656: 60bb str r3, [r7, #8]
|
|
GPIO_InitStruct.Pull = GPIO_PULLUP;
|
|
8000658: 2301 movs r3, #1
|
|
800065a: 60fb str r3, [r7, #12]
|
|
HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
|
|
800065c: 1d3b adds r3, r7, #4
|
|
800065e: 4619 mov r1, r3
|
|
8000660: f04f 4090 mov.w r0, #1207959552 @ 0x48000000
|
|
8000664: f002 f902 bl 800286c <HAL_GPIO_Init>
|
|
|
|
/*Configure GPIO pins : PROB2_Pin PROB1_Pin */
|
|
GPIO_InitStruct.Pin = PROB2_Pin|PROB1_Pin;
|
|
8000668: f44f 5340 mov.w r3, #12288 @ 0x3000
|
|
800066c: 607b str r3, [r7, #4]
|
|
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
800066e: 2301 movs r3, #1
|
|
8000670: 60bb str r3, [r7, #8]
|
|
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
8000672: 2300 movs r3, #0
|
|
8000674: 60fb str r3, [r7, #12]
|
|
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_VERY_HIGH;
|
|
8000676: 2303 movs r3, #3
|
|
8000678: 613b str r3, [r7, #16]
|
|
HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
|
|
800067a: 1d3b adds r3, r7, #4
|
|
800067c: 4619 mov r1, r3
|
|
800067e: 4815 ldr r0, [pc, #84] @ (80006d4 <MX_GPIO_Init+0xd4>)
|
|
8000680: f002 f8f4 bl 800286c <HAL_GPIO_Init>
|
|
|
|
/*Configure GPIO pin : BUT3_Pin */
|
|
GPIO_InitStruct.Pin = BUT3_Pin;
|
|
8000684: 2340 movs r3, #64 @ 0x40
|
|
8000686: 607b str r3, [r7, #4]
|
|
GPIO_InitStruct.Mode = GPIO_MODE_IT_FALLING;
|
|
8000688: f44f 1304 mov.w r3, #2162688 @ 0x210000
|
|
800068c: 60bb str r3, [r7, #8]
|
|
GPIO_InitStruct.Pull = GPIO_PULLUP;
|
|
800068e: 2301 movs r3, #1
|
|
8000690: 60fb str r3, [r7, #12]
|
|
HAL_GPIO_Init(BUT3_GPIO_Port, &GPIO_InitStruct);
|
|
8000692: 1d3b adds r3, r7, #4
|
|
8000694: 4619 mov r1, r3
|
|
8000696: 4810 ldr r0, [pc, #64] @ (80006d8 <MX_GPIO_Init+0xd8>)
|
|
8000698: f002 f8e8 bl 800286c <HAL_GPIO_Init>
|
|
|
|
/* EXTI interrupt init*/
|
|
HAL_NVIC_SetPriority(EXTI0_IRQn, 0, 0);
|
|
800069c: 2200 movs r2, #0
|
|
800069e: 2100 movs r1, #0
|
|
80006a0: 2006 movs r0, #6
|
|
80006a2: f001 fa6c bl 8001b7e <HAL_NVIC_SetPriority>
|
|
HAL_NVIC_EnableIRQ(EXTI0_IRQn);
|
|
80006a6: 2006 movs r0, #6
|
|
80006a8: f001 fa83 bl 8001bb2 <HAL_NVIC_EnableIRQ>
|
|
|
|
HAL_NVIC_SetPriority(EXTI1_IRQn, 0, 0);
|
|
80006ac: 2200 movs r2, #0
|
|
80006ae: 2100 movs r1, #0
|
|
80006b0: 2007 movs r0, #7
|
|
80006b2: f001 fa64 bl 8001b7e <HAL_NVIC_SetPriority>
|
|
HAL_NVIC_EnableIRQ(EXTI1_IRQn);
|
|
80006b6: 2007 movs r0, #7
|
|
80006b8: f001 fa7b bl 8001bb2 <HAL_NVIC_EnableIRQ>
|
|
|
|
HAL_NVIC_SetPriority(EXTI9_5_IRQn, 0, 0);
|
|
80006bc: 2200 movs r2, #0
|
|
80006be: 2100 movs r1, #0
|
|
80006c0: 2016 movs r0, #22
|
|
80006c2: f001 fa5c bl 8001b7e <HAL_NVIC_SetPriority>
|
|
HAL_NVIC_EnableIRQ(EXTI9_5_IRQn);
|
|
80006c6: 2016 movs r0, #22
|
|
80006c8: f001 fa73 bl 8001bb2 <HAL_NVIC_EnableIRQ>
|
|
|
|
}
|
|
80006cc: bf00 nop
|
|
80006ce: 3718 adds r7, #24
|
|
80006d0: 46bd mov sp, r7
|
|
80006d2: bd80 pop {r7, pc}
|
|
80006d4: 48000400 .word 0x48000400
|
|
80006d8: 48000800 .word 0x48000800
|
|
|
|
080006dc <LL_RCC_LSE_SetDriveCapability>:
|
|
* @arg @ref LL_RCC_LSEDRIVE_MEDIUMHIGH
|
|
* @arg @ref LL_RCC_LSEDRIVE_HIGH
|
|
* @retval None
|
|
*/
|
|
__STATIC_INLINE void LL_RCC_LSE_SetDriveCapability(uint32_t LSEDrive)
|
|
{
|
|
80006dc: b480 push {r7}
|
|
80006de: b083 sub sp, #12
|
|
80006e0: af00 add r7, sp, #0
|
|
80006e2: 6078 str r0, [r7, #4]
|
|
MODIFY_REG(RCC->BDCR, RCC_BDCR_LSEDRV, LSEDrive);
|
|
80006e4: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
80006e8: f8d3 3090 ldr.w r3, [r3, #144] @ 0x90
|
|
80006ec: f023 0218 bic.w r2, r3, #24
|
|
80006f0: f04f 41b0 mov.w r1, #1476395008 @ 0x58000000
|
|
80006f4: 687b ldr r3, [r7, #4]
|
|
80006f6: 4313 orrs r3, r2
|
|
80006f8: f8c1 3090 str.w r3, [r1, #144] @ 0x90
|
|
}
|
|
80006fc: bf00 nop
|
|
80006fe: 370c adds r7, #12
|
|
8000700: 46bd mov sp, r7
|
|
8000702: bc80 pop {r7}
|
|
8000704: 4770 bx lr
|
|
|
|
08000706 <main>:
|
|
/**
|
|
* @brief The application entry point.
|
|
* @retval int
|
|
*/
|
|
int main(void)
|
|
{
|
|
8000706: b580 push {r7, lr}
|
|
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: f001 f911 bl 8001930 <HAL_Init>
|
|
/* USER CODE BEGIN Init */
|
|
|
|
/* USER CODE END Init */
|
|
|
|
/* Configure the system clock */
|
|
SystemClock_Config();
|
|
800070e: f000 f807 bl 8000720 <SystemClock_Config>
|
|
/* USER CODE BEGIN SysInit */
|
|
|
|
/* USER CODE END SysInit */
|
|
|
|
/* Initialize all configured peripherals */
|
|
MX_GPIO_Init();
|
|
8000712: f7ff ff75 bl 8000600 <MX_GPIO_Init>
|
|
MX_SubGHz_Phy_Init();
|
|
8000716: f00b fd81 bl 800c21c <MX_SubGHz_Phy_Init>
|
|
/* Infinite loop */
|
|
/* USER CODE BEGIN WHILE */
|
|
while (1)
|
|
{
|
|
/* USER CODE END WHILE */
|
|
MX_SubGHz_Phy_Process();
|
|
800071a: f00b fd87 bl 800c22c <MX_SubGHz_Phy_Process>
|
|
800071e: e7fc b.n 800071a <main+0x14>
|
|
|
|
08000720 <SystemClock_Config>:
|
|
/**
|
|
* @brief System Clock Configuration
|
|
* @retval None
|
|
*/
|
|
void SystemClock_Config(void)
|
|
{
|
|
8000720: b580 push {r7, lr}
|
|
8000722: b09a sub sp, #104 @ 0x68
|
|
8000724: af00 add r7, sp, #0
|
|
RCC_OscInitTypeDef RCC_OscInitStruct = {0};
|
|
8000726: f107 0320 add.w r3, r7, #32
|
|
800072a: 2248 movs r2, #72 @ 0x48
|
|
800072c: 2100 movs r1, #0
|
|
800072e: 4618 mov r0, r3
|
|
8000730: f00e fc0c bl 800ef4c <memset>
|
|
RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};
|
|
8000734: 1d3b adds r3, r7, #4
|
|
8000736: 2200 movs r2, #0
|
|
8000738: 601a str r2, [r3, #0]
|
|
800073a: 605a str r2, [r3, #4]
|
|
800073c: 609a str r2, [r3, #8]
|
|
800073e: 60da str r2, [r3, #12]
|
|
8000740: 611a str r2, [r3, #16]
|
|
8000742: 615a str r2, [r3, #20]
|
|
8000744: 619a str r2, [r3, #24]
|
|
|
|
/** Configure LSE Drive Capability
|
|
*/
|
|
HAL_PWR_EnableBkUpAccess();
|
|
8000746: f002 faf9 bl 8002d3c <HAL_PWR_EnableBkUpAccess>
|
|
__HAL_RCC_LSEDRIVE_CONFIG(RCC_LSEDRIVE_LOW);
|
|
800074a: 2000 movs r0, #0
|
|
800074c: f7ff ffc6 bl 80006dc <LL_RCC_LSE_SetDriveCapability>
|
|
|
|
/** Configure the main internal regulator output voltage
|
|
*/
|
|
__HAL_PWR_VOLTAGESCALING_CONFIG(PWR_REGULATOR_VOLTAGE_SCALE1);
|
|
8000750: 4b1e ldr r3, [pc, #120] @ (80007cc <SystemClock_Config+0xac>)
|
|
8000752: 681b ldr r3, [r3, #0]
|
|
8000754: f423 63c0 bic.w r3, r3, #1536 @ 0x600
|
|
8000758: 4a1c ldr r2, [pc, #112] @ (80007cc <SystemClock_Config+0xac>)
|
|
800075a: f443 7300 orr.w r3, r3, #512 @ 0x200
|
|
800075e: 6013 str r3, [r2, #0]
|
|
8000760: 4b1a ldr r3, [pc, #104] @ (80007cc <SystemClock_Config+0xac>)
|
|
8000762: 681b ldr r3, [r3, #0]
|
|
8000764: f403 63c0 and.w r3, r3, #1536 @ 0x600
|
|
8000768: 603b str r3, [r7, #0]
|
|
800076a: 683b ldr r3, [r7, #0]
|
|
|
|
/** Initializes the CPU, AHB and APB buses clocks
|
|
*/
|
|
RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_LSE|RCC_OSCILLATORTYPE_MSI;
|
|
800076c: 2324 movs r3, #36 @ 0x24
|
|
800076e: 623b str r3, [r7, #32]
|
|
RCC_OscInitStruct.LSEState = RCC_LSE_ON;
|
|
8000770: 2381 movs r3, #129 @ 0x81
|
|
8000772: 62fb str r3, [r7, #44] @ 0x2c
|
|
RCC_OscInitStruct.MSIState = RCC_MSI_ON;
|
|
8000774: 2301 movs r3, #1
|
|
8000776: 643b str r3, [r7, #64] @ 0x40
|
|
RCC_OscInitStruct.MSICalibrationValue = RCC_MSICALIBRATION_DEFAULT;
|
|
8000778: 2300 movs r3, #0
|
|
800077a: 647b str r3, [r7, #68] @ 0x44
|
|
RCC_OscInitStruct.MSIClockRange = RCC_MSIRANGE_11;
|
|
800077c: 23b0 movs r3, #176 @ 0xb0
|
|
800077e: 64bb str r3, [r7, #72] @ 0x48
|
|
RCC_OscInitStruct.PLL.PLLState = RCC_PLL_NONE;
|
|
8000780: 2300 movs r3, #0
|
|
8000782: 64fb str r3, [r7, #76] @ 0x4c
|
|
if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
|
|
8000784: f107 0320 add.w r3, r7, #32
|
|
8000788: 4618 mov r0, r3
|
|
800078a: f002 fe4b bl 8003424 <HAL_RCC_OscConfig>
|
|
800078e: 4603 mov r3, r0
|
|
8000790: 2b00 cmp r3, #0
|
|
8000792: d001 beq.n 8000798 <SystemClock_Config+0x78>
|
|
{
|
|
Error_Handler();
|
|
8000794: f000 f81c bl 80007d0 <Error_Handler>
|
|
}
|
|
|
|
/** Configure the SYSCLKSource, HCLK, PCLK1 and PCLK2 clocks dividers
|
|
*/
|
|
RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK3|RCC_CLOCKTYPE_HCLK
|
|
8000798: 234f movs r3, #79 @ 0x4f
|
|
800079a: 607b str r3, [r7, #4]
|
|
|RCC_CLOCKTYPE_SYSCLK|RCC_CLOCKTYPE_PCLK1
|
|
|RCC_CLOCKTYPE_PCLK2;
|
|
RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_MSI;
|
|
800079c: 2300 movs r3, #0
|
|
800079e: 60bb str r3, [r7, #8]
|
|
RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
|
|
80007a0: 2300 movs r3, #0
|
|
80007a2: 60fb str r3, [r7, #12]
|
|
RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV1;
|
|
80007a4: 2300 movs r3, #0
|
|
80007a6: 613b str r3, [r7, #16]
|
|
RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;
|
|
80007a8: 2300 movs r3, #0
|
|
80007aa: 617b str r3, [r7, #20]
|
|
RCC_ClkInitStruct.AHBCLK3Divider = RCC_SYSCLK_DIV1;
|
|
80007ac: 2300 movs r3, #0
|
|
80007ae: 61fb str r3, [r7, #28]
|
|
|
|
if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_2) != HAL_OK)
|
|
80007b0: 1d3b adds r3, r7, #4
|
|
80007b2: 2102 movs r1, #2
|
|
80007b4: 4618 mov r0, r3
|
|
80007b6: f003 f9b7 bl 8003b28 <HAL_RCC_ClockConfig>
|
|
80007ba: 4603 mov r3, r0
|
|
80007bc: 2b00 cmp r3, #0
|
|
80007be: d001 beq.n 80007c4 <SystemClock_Config+0xa4>
|
|
{
|
|
Error_Handler();
|
|
80007c0: f000 f806 bl 80007d0 <Error_Handler>
|
|
}
|
|
}
|
|
80007c4: bf00 nop
|
|
80007c6: 3768 adds r7, #104 @ 0x68
|
|
80007c8: 46bd mov sp, r7
|
|
80007ca: bd80 pop {r7, pc}
|
|
80007cc: 58000400 .word 0x58000400
|
|
|
|
080007d0 <Error_Handler>:
|
|
/**
|
|
* @brief This function is executed in case of error occurrence.
|
|
* @retval None
|
|
*/
|
|
void Error_Handler(void)
|
|
{
|
|
80007d0: b480 push {r7}
|
|
80007d2: af00 add r7, sp, #0
|
|
\details Disables IRQ interrupts by setting the I-bit in the CPSR.
|
|
Can only be executed in Privileged modes.
|
|
*/
|
|
__STATIC_FORCEINLINE void __disable_irq(void)
|
|
{
|
|
__ASM volatile ("cpsid i" : : : "memory");
|
|
80007d4: b672 cpsid i
|
|
}
|
|
80007d6: bf00 nop
|
|
/* USER CODE BEGIN Error_Handler_Debug */
|
|
/* User can add his own implementation to report the HAL error return state */
|
|
__disable_irq();
|
|
while (1)
|
|
80007d8: bf00 nop
|
|
80007da: e7fd b.n 80007d8 <Error_Handler+0x8>
|
|
|
|
080007dc <LL_RCC_EnableRTC>:
|
|
* @brief Enable RTC
|
|
* @rmtoll BDCR RTCEN LL_RCC_EnableRTC
|
|
* @retval None
|
|
*/
|
|
__STATIC_INLINE void LL_RCC_EnableRTC(void)
|
|
{
|
|
80007dc: b480 push {r7}
|
|
80007de: af00 add r7, sp, #0
|
|
SET_BIT(RCC->BDCR, RCC_BDCR_RTCEN);
|
|
80007e0: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
80007e4: f8d3 3090 ldr.w r3, [r3, #144] @ 0x90
|
|
80007e8: f04f 42b0 mov.w r2, #1476395008 @ 0x58000000
|
|
80007ec: f443 4300 orr.w r3, r3, #32768 @ 0x8000
|
|
80007f0: f8c2 3090 str.w r3, [r2, #144] @ 0x90
|
|
}
|
|
80007f4: bf00 nop
|
|
80007f6: 46bd mov sp, r7
|
|
80007f8: bc80 pop {r7}
|
|
80007fa: 4770 bx lr
|
|
|
|
080007fc <LL_APB1_GRP1_EnableClock>:
|
|
* @arg @ref LL_APB1_GRP1_PERIPH_DAC
|
|
* @arg @ref LL_APB1_GRP1_PERIPH_LPTIM1
|
|
* @retval None
|
|
*/
|
|
__STATIC_INLINE void LL_APB1_GRP1_EnableClock(uint32_t Periphs)
|
|
{
|
|
80007fc: b480 push {r7}
|
|
80007fe: b085 sub sp, #20
|
|
8000800: af00 add r7, sp, #0
|
|
8000802: 6078 str r0, [r7, #4]
|
|
__IO uint32_t tmpreg;
|
|
SET_BIT(RCC->APB1ENR1, Periphs);
|
|
8000804: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8000808: 6d9a ldr r2, [r3, #88] @ 0x58
|
|
800080a: f04f 41b0 mov.w r1, #1476395008 @ 0x58000000
|
|
800080e: 687b ldr r3, [r7, #4]
|
|
8000810: 4313 orrs r3, r2
|
|
8000812: 658b str r3, [r1, #88] @ 0x58
|
|
/* Delay after an RCC peripheral clock enabling */
|
|
tmpreg = READ_BIT(RCC->APB1ENR1, Periphs);
|
|
8000814: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8000818: 6d9a ldr r2, [r3, #88] @ 0x58
|
|
800081a: 687b ldr r3, [r7, #4]
|
|
800081c: 4013 ands r3, r2
|
|
800081e: 60fb str r3, [r7, #12]
|
|
(void)tmpreg;
|
|
8000820: 68fb ldr r3, [r7, #12]
|
|
}
|
|
8000822: bf00 nop
|
|
8000824: 3714 adds r7, #20
|
|
8000826: 46bd mov sp, r7
|
|
8000828: bc80 pop {r7}
|
|
800082a: 4770 bx lr
|
|
|
|
0800082c <MX_RTC_Init>:
|
|
|
|
RTC_HandleTypeDef hrtc;
|
|
|
|
/* RTC init function */
|
|
void MX_RTC_Init(void)
|
|
{
|
|
800082c: b580 push {r7, lr}
|
|
800082e: b08c sub sp, #48 @ 0x30
|
|
8000830: af00 add r7, sp, #0
|
|
|
|
/* USER CODE BEGIN RTC_Init 0 */
|
|
|
|
/* USER CODE END RTC_Init 0 */
|
|
|
|
RTC_AlarmTypeDef sAlarm = {0};
|
|
8000832: 1d3b adds r3, r7, #4
|
|
8000834: 222c movs r2, #44 @ 0x2c
|
|
8000836: 2100 movs r1, #0
|
|
8000838: 4618 mov r0, r3
|
|
800083a: f00e fb87 bl 800ef4c <memset>
|
|
|
|
/* USER CODE END RTC_Init 1 */
|
|
|
|
/** Initialize RTC Only
|
|
*/
|
|
hrtc.Instance = RTC;
|
|
800083e: 4b22 ldr r3, [pc, #136] @ (80008c8 <MX_RTC_Init+0x9c>)
|
|
8000840: 4a22 ldr r2, [pc, #136] @ (80008cc <MX_RTC_Init+0xa0>)
|
|
8000842: 601a str r2, [r3, #0]
|
|
hrtc.Init.AsynchPrediv = RTC_PREDIV_A;
|
|
8000844: 4b20 ldr r3, [pc, #128] @ (80008c8 <MX_RTC_Init+0x9c>)
|
|
8000846: 221f movs r2, #31
|
|
8000848: 609a str r2, [r3, #8]
|
|
hrtc.Init.OutPut = RTC_OUTPUT_DISABLE;
|
|
800084a: 4b1f ldr r3, [pc, #124] @ (80008c8 <MX_RTC_Init+0x9c>)
|
|
800084c: 2200 movs r2, #0
|
|
800084e: 611a str r2, [r3, #16]
|
|
hrtc.Init.OutPutRemap = RTC_OUTPUT_REMAP_NONE;
|
|
8000850: 4b1d ldr r3, [pc, #116] @ (80008c8 <MX_RTC_Init+0x9c>)
|
|
8000852: 2200 movs r2, #0
|
|
8000854: 615a str r2, [r3, #20]
|
|
hrtc.Init.OutPutPolarity = RTC_OUTPUT_POLARITY_HIGH;
|
|
8000856: 4b1c ldr r3, [pc, #112] @ (80008c8 <MX_RTC_Init+0x9c>)
|
|
8000858: 2200 movs r2, #0
|
|
800085a: 619a str r2, [r3, #24]
|
|
hrtc.Init.OutPutType = RTC_OUTPUT_TYPE_OPENDRAIN;
|
|
800085c: 4b1a ldr r3, [pc, #104] @ (80008c8 <MX_RTC_Init+0x9c>)
|
|
800085e: f04f 4280 mov.w r2, #1073741824 @ 0x40000000
|
|
8000862: 61da str r2, [r3, #28]
|
|
hrtc.Init.OutPutPullUp = RTC_OUTPUT_PULLUP_NONE;
|
|
8000864: 4b18 ldr r3, [pc, #96] @ (80008c8 <MX_RTC_Init+0x9c>)
|
|
8000866: 2200 movs r2, #0
|
|
8000868: 621a str r2, [r3, #32]
|
|
hrtc.Init.BinMode = RTC_BINARY_ONLY;
|
|
800086a: 4b17 ldr r3, [pc, #92] @ (80008c8 <MX_RTC_Init+0x9c>)
|
|
800086c: f44f 7280 mov.w r2, #256 @ 0x100
|
|
8000870: 625a str r2, [r3, #36] @ 0x24
|
|
if (HAL_RTC_Init(&hrtc) != HAL_OK)
|
|
8000872: 4815 ldr r0, [pc, #84] @ (80008c8 <MX_RTC_Init+0x9c>)
|
|
8000874: f003 fe32 bl 80044dc <HAL_RTC_Init>
|
|
8000878: 4603 mov r3, r0
|
|
800087a: 2b00 cmp r3, #0
|
|
800087c: d001 beq.n 8000882 <MX_RTC_Init+0x56>
|
|
{
|
|
Error_Handler();
|
|
800087e: f7ff ffa7 bl 80007d0 <Error_Handler>
|
|
|
|
/* USER CODE END Check_RTC_BKUP */
|
|
|
|
/** Initialize RTC and set the Time and Date
|
|
*/
|
|
if (HAL_RTCEx_SetSSRU_IT(&hrtc) != HAL_OK)
|
|
8000882: 4811 ldr r0, [pc, #68] @ (80008c8 <MX_RTC_Init+0x9c>)
|
|
8000884: f004 f932 bl 8004aec <HAL_RTCEx_SetSSRU_IT>
|
|
8000888: 4603 mov r3, r0
|
|
800088a: 2b00 cmp r3, #0
|
|
800088c: d001 beq.n 8000892 <MX_RTC_Init+0x66>
|
|
{
|
|
Error_Handler();
|
|
800088e: f7ff ff9f bl 80007d0 <Error_Handler>
|
|
}
|
|
|
|
/** Enable the Alarm A
|
|
*/
|
|
sAlarm.BinaryAutoClr = RTC_ALARMSUBSECONDBIN_AUTOCLR_NO;
|
|
8000892: 2300 movs r3, #0
|
|
8000894: 623b str r3, [r7, #32]
|
|
sAlarm.AlarmTime.SubSeconds = 0x0;
|
|
8000896: 2300 movs r3, #0
|
|
8000898: 60bb str r3, [r7, #8]
|
|
sAlarm.AlarmMask = RTC_ALARMMASK_NONE;
|
|
800089a: 2300 movs r3, #0
|
|
800089c: 61bb str r3, [r7, #24]
|
|
sAlarm.AlarmSubSecondMask = RTC_ALARMSUBSECONDBINMASK_NONE;
|
|
800089e: f04f 5300 mov.w r3, #536870912 @ 0x20000000
|
|
80008a2: 61fb str r3, [r7, #28]
|
|
sAlarm.Alarm = RTC_ALARM_A;
|
|
80008a4: f44f 7380 mov.w r3, #256 @ 0x100
|
|
80008a8: 62fb str r3, [r7, #44] @ 0x2c
|
|
if (HAL_RTC_SetAlarm_IT(&hrtc, &sAlarm, 0) != HAL_OK)
|
|
80008aa: 1d3b adds r3, r7, #4
|
|
80008ac: 2200 movs r2, #0
|
|
80008ae: 4619 mov r1, r3
|
|
80008b0: 4805 ldr r0, [pc, #20] @ (80008c8 <MX_RTC_Init+0x9c>)
|
|
80008b2: f003 fe9f bl 80045f4 <HAL_RTC_SetAlarm_IT>
|
|
80008b6: 4603 mov r3, r0
|
|
80008b8: 2b00 cmp r3, #0
|
|
80008ba: d001 beq.n 80008c0 <MX_RTC_Init+0x94>
|
|
{
|
|
Error_Handler();
|
|
80008bc: f7ff ff88 bl 80007d0 <Error_Handler>
|
|
}
|
|
/* USER CODE BEGIN RTC_Init 2 */
|
|
|
|
/* USER CODE END RTC_Init 2 */
|
|
|
|
}
|
|
80008c0: bf00 nop
|
|
80008c2: 3730 adds r7, #48 @ 0x30
|
|
80008c4: 46bd mov sp, r7
|
|
80008c6: bd80 pop {r7, pc}
|
|
80008c8: 20000088 .word 0x20000088
|
|
80008cc: 40002800 .word 0x40002800
|
|
|
|
080008d0 <HAL_RTC_MspInit>:
|
|
|
|
void HAL_RTC_MspInit(RTC_HandleTypeDef* rtcHandle)
|
|
{
|
|
80008d0: b580 push {r7, lr}
|
|
80008d2: b090 sub sp, #64 @ 0x40
|
|
80008d4: af00 add r7, sp, #0
|
|
80008d6: 6078 str r0, [r7, #4]
|
|
|
|
RCC_PeriphCLKInitTypeDef PeriphClkInitStruct = {0};
|
|
80008d8: f107 0308 add.w r3, r7, #8
|
|
80008dc: 2238 movs r2, #56 @ 0x38
|
|
80008de: 2100 movs r1, #0
|
|
80008e0: 4618 mov r0, r3
|
|
80008e2: f00e fb33 bl 800ef4c <memset>
|
|
if(rtcHandle->Instance==RTC)
|
|
80008e6: 687b ldr r3, [r7, #4]
|
|
80008e8: 681b ldr r3, [r3, #0]
|
|
80008ea: 4a16 ldr r2, [pc, #88] @ (8000944 <HAL_RTC_MspInit+0x74>)
|
|
80008ec: 4293 cmp r3, r2
|
|
80008ee: d125 bne.n 800093c <HAL_RTC_MspInit+0x6c>
|
|
|
|
/* USER CODE END RTC_MspInit 0 */
|
|
|
|
/** Initializes the peripherals clocks
|
|
*/
|
|
PeriphClkInitStruct.PeriphClockSelection = RCC_PERIPHCLK_RTC;
|
|
80008f0: f44f 3380 mov.w r3, #65536 @ 0x10000
|
|
80008f4: 60bb str r3, [r7, #8]
|
|
PeriphClkInitStruct.RTCClockSelection = RCC_RTCCLKSOURCE_LSE;
|
|
80008f6: f44f 7380 mov.w r3, #256 @ 0x100
|
|
80008fa: 63fb str r3, [r7, #60] @ 0x3c
|
|
|
|
if (HAL_RCCEx_PeriphCLKConfig(&PeriphClkInitStruct) != HAL_OK)
|
|
80008fc: f107 0308 add.w r3, r7, #8
|
|
8000900: 4618 mov r0, r3
|
|
8000902: f003 fcd1 bl 80042a8 <HAL_RCCEx_PeriphCLKConfig>
|
|
8000906: 4603 mov r3, r0
|
|
8000908: 2b00 cmp r3, #0
|
|
800090a: d001 beq.n 8000910 <HAL_RTC_MspInit+0x40>
|
|
{
|
|
Error_Handler();
|
|
800090c: f7ff ff60 bl 80007d0 <Error_Handler>
|
|
}
|
|
|
|
/* RTC clock enable */
|
|
__HAL_RCC_RTC_ENABLE();
|
|
8000910: f7ff ff64 bl 80007dc <LL_RCC_EnableRTC>
|
|
__HAL_RCC_RTCAPB_CLK_ENABLE();
|
|
8000914: f44f 6080 mov.w r0, #1024 @ 0x400
|
|
8000918: f7ff ff70 bl 80007fc <LL_APB1_GRP1_EnableClock>
|
|
|
|
/* RTC interrupt Init */
|
|
HAL_NVIC_SetPriority(TAMP_STAMP_LSECSS_SSRU_IRQn, 0, 0);
|
|
800091c: 2200 movs r2, #0
|
|
800091e: 2100 movs r1, #0
|
|
8000920: 2002 movs r0, #2
|
|
8000922: f001 f92c bl 8001b7e <HAL_NVIC_SetPriority>
|
|
HAL_NVIC_EnableIRQ(TAMP_STAMP_LSECSS_SSRU_IRQn);
|
|
8000926: 2002 movs r0, #2
|
|
8000928: f001 f943 bl 8001bb2 <HAL_NVIC_EnableIRQ>
|
|
HAL_NVIC_SetPriority(RTC_Alarm_IRQn, 0, 0);
|
|
800092c: 2200 movs r2, #0
|
|
800092e: 2100 movs r1, #0
|
|
8000930: 202a movs r0, #42 @ 0x2a
|
|
8000932: f001 f924 bl 8001b7e <HAL_NVIC_SetPriority>
|
|
HAL_NVIC_EnableIRQ(RTC_Alarm_IRQn);
|
|
8000936: 202a movs r0, #42 @ 0x2a
|
|
8000938: f001 f93b bl 8001bb2 <HAL_NVIC_EnableIRQ>
|
|
/* USER CODE BEGIN RTC_MspInit 1 */
|
|
|
|
/* USER CODE END RTC_MspInit 1 */
|
|
}
|
|
}
|
|
800093c: bf00 nop
|
|
800093e: 3740 adds r7, #64 @ 0x40
|
|
8000940: 46bd mov sp, r7
|
|
8000942: bd80 pop {r7, pc}
|
|
8000944: 40002800 .word 0x40002800
|
|
|
|
08000948 <LL_PWR_ClearFlag_C1STOP_C1STB>:
|
|
* @brief Clear standby and stop flags for CPU1
|
|
* @rmtoll EXTSCR C1CSSF LL_PWR_ClearFlag_C1STOP_C1STB
|
|
* @retval None
|
|
*/
|
|
__STATIC_INLINE void LL_PWR_ClearFlag_C1STOP_C1STB(void)
|
|
{
|
|
8000948: b480 push {r7}
|
|
800094a: af00 add r7, sp, #0
|
|
WRITE_REG(PWR->EXTSCR, PWR_EXTSCR_C1CSSF);
|
|
800094c: 4b03 ldr r3, [pc, #12] @ (800095c <LL_PWR_ClearFlag_C1STOP_C1STB+0x14>)
|
|
800094e: 2201 movs r2, #1
|
|
8000950: f8c3 2088 str.w r2, [r3, #136] @ 0x88
|
|
}
|
|
8000954: bf00 nop
|
|
8000956: 46bd mov sp, r7
|
|
8000958: bc80 pop {r7}
|
|
800095a: 4770 bx lr
|
|
800095c: 58000400 .word 0x58000400
|
|
|
|
08000960 <PWR_EnterOffMode>:
|
|
/* USER CODE END PFP */
|
|
|
|
/* Exported functions --------------------------------------------------------*/
|
|
|
|
void PWR_EnterOffMode(void)
|
|
{
|
|
8000960: b480 push {r7}
|
|
8000962: af00 add r7, sp, #0
|
|
/* USER CODE BEGIN EnterOffMode_1 */
|
|
|
|
/* USER CODE END EnterOffMode_1 */
|
|
}
|
|
8000964: bf00 nop
|
|
8000966: 46bd mov sp, r7
|
|
8000968: bc80 pop {r7}
|
|
800096a: 4770 bx lr
|
|
|
|
0800096c <PWR_ExitOffMode>:
|
|
|
|
void PWR_ExitOffMode(void)
|
|
{
|
|
800096c: b480 push {r7}
|
|
800096e: af00 add r7, sp, #0
|
|
/* USER CODE BEGIN ExitOffMode_1 */
|
|
|
|
/* USER CODE END ExitOffMode_1 */
|
|
}
|
|
8000970: bf00 nop
|
|
8000972: 46bd mov sp, r7
|
|
8000974: bc80 pop {r7}
|
|
8000976: 4770 bx lr
|
|
|
|
08000978 <PWR_EnterStopMode>:
|
|
|
|
void PWR_EnterStopMode(void)
|
|
{
|
|
8000978: b580 push {r7, lr}
|
|
800097a: af00 add r7, sp, #0
|
|
/* USER CODE BEGIN EnterStopMode_1 */
|
|
|
|
/* USER CODE END EnterStopMode_1 */
|
|
HAL_SuspendTick();
|
|
800097c: f000 fff8 bl 8001970 <HAL_SuspendTick>
|
|
/* Clear Status Flag before entering STOP/STANDBY Mode */
|
|
LL_PWR_ClearFlag_C1STOP_C1STB();
|
|
8000980: f7ff ffe2 bl 8000948 <LL_PWR_ClearFlag_C1STOP_C1STB>
|
|
|
|
/* USER CODE BEGIN EnterStopMode_2 */
|
|
|
|
/* USER CODE END EnterStopMode_2 */
|
|
HAL_PWREx_EnterSTOP2Mode(PWR_STOPENTRY_WFI);
|
|
8000984: 2001 movs r0, #1
|
|
8000986: f002 fa6b bl 8002e60 <HAL_PWREx_EnterSTOP2Mode>
|
|
/* USER CODE BEGIN EnterStopMode_3 */
|
|
|
|
/* USER CODE END EnterStopMode_3 */
|
|
}
|
|
800098a: bf00 nop
|
|
800098c: bd80 pop {r7, pc}
|
|
|
|
0800098e <PWR_ExitStopMode>:
|
|
|
|
void PWR_ExitStopMode(void)
|
|
{
|
|
800098e: b580 push {r7, lr}
|
|
8000990: af00 add r7, sp, #0
|
|
/* USER CODE BEGIN ExitStopMode_1 */
|
|
|
|
/* USER CODE END ExitStopMode_1 */
|
|
/* Resume sysTick : work around for debugger problem in dual core */
|
|
HAL_ResumeTick();
|
|
8000992: f000 fffb bl 800198c <HAL_ResumeTick>
|
|
ADC interface
|
|
DAC interface USARTx, TIMx, i2Cx, SPIx
|
|
SRAM ctrls, DMAx, DMAMux, AES, RNG, HSEM */
|
|
|
|
/* Resume not retained USARTx and DMA */
|
|
vcom_Resume();
|
|
8000996: f000 fe47 bl 8001628 <vcom_Resume>
|
|
/* USER CODE BEGIN ExitStopMode_2 */
|
|
|
|
/* USER CODE END ExitStopMode_2 */
|
|
}
|
|
800099a: bf00 nop
|
|
800099c: bd80 pop {r7, pc}
|
|
|
|
0800099e <PWR_EnterSleepMode>:
|
|
|
|
void PWR_EnterSleepMode(void)
|
|
{
|
|
800099e: b580 push {r7, lr}
|
|
80009a0: af00 add r7, sp, #0
|
|
/* USER CODE BEGIN EnterSleepMode_1 */
|
|
|
|
/* USER CODE END EnterSleepMode_1 */
|
|
/* Suspend sysTick */
|
|
HAL_SuspendTick();
|
|
80009a2: f000 ffe5 bl 8001970 <HAL_SuspendTick>
|
|
/* USER CODE BEGIN EnterSleepMode_2 */
|
|
|
|
/* USER CODE END EnterSleepMode_2 */
|
|
HAL_PWR_EnterSLEEPMode(PWR_MAINREGULATOR_ON, PWR_SLEEPENTRY_WFI);
|
|
80009a6: 2101 movs r1, #1
|
|
80009a8: 2000 movs r0, #0
|
|
80009aa: f002 f9d5 bl 8002d58 <HAL_PWR_EnterSLEEPMode>
|
|
/* USER CODE BEGIN EnterSleepMode_3 */
|
|
|
|
/* USER CODE END EnterSleepMode_3 */
|
|
}
|
|
80009ae: bf00 nop
|
|
80009b0: bd80 pop {r7, pc}
|
|
|
|
080009b2 <PWR_ExitSleepMode>:
|
|
|
|
void PWR_ExitSleepMode(void)
|
|
{
|
|
80009b2: b580 push {r7, lr}
|
|
80009b4: af00 add r7, sp, #0
|
|
/* USER CODE BEGIN ExitSleepMode_1 */
|
|
|
|
/* USER CODE END ExitSleepMode_1 */
|
|
/* Resume sysTick */
|
|
HAL_ResumeTick();
|
|
80009b6: f000 ffe9 bl 800198c <HAL_ResumeTick>
|
|
|
|
/* USER CODE BEGIN ExitSleepMode_2 */
|
|
|
|
/* USER CODE END ExitSleepMode_2 */
|
|
}
|
|
80009ba: bf00 nop
|
|
80009bc: bd80 pop {r7, pc}
|
|
|
|
080009be <HAL_MspInit>:
|
|
/* USER CODE END 0 */
|
|
/**
|
|
* Initializes the Global MSP.
|
|
*/
|
|
void HAL_MspInit(void)
|
|
{
|
|
80009be: b480 push {r7}
|
|
80009c0: af00 add r7, sp, #0
|
|
/* System interrupt init*/
|
|
|
|
/* USER CODE BEGIN MspInit 1 */
|
|
|
|
/* USER CODE END MspInit 1 */
|
|
}
|
|
80009c2: bf00 nop
|
|
80009c4: 46bd mov sp, r7
|
|
80009c6: bc80 pop {r7}
|
|
80009c8: 4770 bx lr
|
|
|
|
080009ca <NMI_Handler>:
|
|
/******************************************************************************/
|
|
/**
|
|
* @brief This function handles Non maskable interrupt.
|
|
*/
|
|
void NMI_Handler(void)
|
|
{
|
|
80009ca: b480 push {r7}
|
|
80009cc: 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)
|
|
80009ce: bf00 nop
|
|
80009d0: e7fd b.n 80009ce <NMI_Handler+0x4>
|
|
|
|
080009d2 <HardFault_Handler>:
|
|
|
|
/**
|
|
* @brief This function handles Hard fault interrupt.
|
|
*/
|
|
void HardFault_Handler(void)
|
|
{
|
|
80009d2: b480 push {r7}
|
|
80009d4: af00 add r7, sp, #0
|
|
/* USER CODE BEGIN HardFault_IRQn 0 */
|
|
|
|
/* USER CODE END HardFault_IRQn 0 */
|
|
while (1)
|
|
80009d6: bf00 nop
|
|
80009d8: e7fd b.n 80009d6 <HardFault_Handler+0x4>
|
|
|
|
080009da <MemManage_Handler>:
|
|
|
|
/**
|
|
* @brief This function handles Memory management fault.
|
|
*/
|
|
void MemManage_Handler(void)
|
|
{
|
|
80009da: b480 push {r7}
|
|
80009dc: af00 add r7, sp, #0
|
|
/* USER CODE BEGIN MemoryManagement_IRQn 0 */
|
|
|
|
/* USER CODE END MemoryManagement_IRQn 0 */
|
|
while (1)
|
|
80009de: bf00 nop
|
|
80009e0: e7fd b.n 80009de <MemManage_Handler+0x4>
|
|
|
|
080009e2 <BusFault_Handler>:
|
|
|
|
/**
|
|
* @brief This function handles Prefetch fault, memory access fault.
|
|
*/
|
|
void BusFault_Handler(void)
|
|
{
|
|
80009e2: b480 push {r7}
|
|
80009e4: af00 add r7, sp, #0
|
|
/* USER CODE BEGIN BusFault_IRQn 0 */
|
|
|
|
/* USER CODE END BusFault_IRQn 0 */
|
|
while (1)
|
|
80009e6: bf00 nop
|
|
80009e8: e7fd b.n 80009e6 <BusFault_Handler+0x4>
|
|
|
|
080009ea <UsageFault_Handler>:
|
|
|
|
/**
|
|
* @brief This function handles Undefined instruction or illegal state.
|
|
*/
|
|
void UsageFault_Handler(void)
|
|
{
|
|
80009ea: b480 push {r7}
|
|
80009ec: af00 add r7, sp, #0
|
|
/* USER CODE BEGIN UsageFault_IRQn 0 */
|
|
|
|
/* USER CODE END UsageFault_IRQn 0 */
|
|
while (1)
|
|
80009ee: bf00 nop
|
|
80009f0: e7fd b.n 80009ee <UsageFault_Handler+0x4>
|
|
|
|
080009f2 <SVC_Handler>:
|
|
|
|
/**
|
|
* @brief This function handles System service call via SWI instruction.
|
|
*/
|
|
void SVC_Handler(void)
|
|
{
|
|
80009f2: b480 push {r7}
|
|
80009f4: af00 add r7, sp, #0
|
|
|
|
/* USER CODE END SVCall_IRQn 0 */
|
|
/* USER CODE BEGIN SVCall_IRQn 1 */
|
|
|
|
/* USER CODE END SVCall_IRQn 1 */
|
|
}
|
|
80009f6: bf00 nop
|
|
80009f8: 46bd mov sp, r7
|
|
80009fa: bc80 pop {r7}
|
|
80009fc: 4770 bx lr
|
|
|
|
080009fe <DebugMon_Handler>:
|
|
|
|
/**
|
|
* @brief This function handles Debug monitor.
|
|
*/
|
|
void DebugMon_Handler(void)
|
|
{
|
|
80009fe: b480 push {r7}
|
|
8000a00: af00 add r7, sp, #0
|
|
|
|
/* USER CODE END DebugMonitor_IRQn 0 */
|
|
/* USER CODE BEGIN DebugMonitor_IRQn 1 */
|
|
|
|
/* USER CODE END DebugMonitor_IRQn 1 */
|
|
}
|
|
8000a02: bf00 nop
|
|
8000a04: 46bd mov sp, r7
|
|
8000a06: bc80 pop {r7}
|
|
8000a08: 4770 bx lr
|
|
|
|
08000a0a <PendSV_Handler>:
|
|
|
|
/**
|
|
* @brief This function handles Pendable request for system service.
|
|
*/
|
|
void PendSV_Handler(void)
|
|
{
|
|
8000a0a: b480 push {r7}
|
|
8000a0c: af00 add r7, sp, #0
|
|
|
|
/* USER CODE END PendSV_IRQn 0 */
|
|
/* USER CODE BEGIN PendSV_IRQn 1 */
|
|
|
|
/* USER CODE END PendSV_IRQn 1 */
|
|
}
|
|
8000a0e: bf00 nop
|
|
8000a10: 46bd mov sp, r7
|
|
8000a12: bc80 pop {r7}
|
|
8000a14: 4770 bx lr
|
|
|
|
08000a16 <SysTick_Handler>:
|
|
|
|
/**
|
|
* @brief This function handles System tick timer.
|
|
*/
|
|
void SysTick_Handler(void)
|
|
{
|
|
8000a16: b480 push {r7}
|
|
8000a18: af00 add r7, sp, #0
|
|
|
|
/* USER CODE END SysTick_IRQn 0 */
|
|
/* USER CODE BEGIN SysTick_IRQn 1 */
|
|
|
|
/* USER CODE END SysTick_IRQn 1 */
|
|
}
|
|
8000a1a: bf00 nop
|
|
8000a1c: 46bd mov sp, r7
|
|
8000a1e: bc80 pop {r7}
|
|
8000a20: 4770 bx lr
|
|
...
|
|
|
|
08000a24 <TAMP_STAMP_LSECSS_SSRU_IRQHandler>:
|
|
|
|
/**
|
|
* @brief This function handles RTC Tamper, RTC TimeStamp, LSECSS and RTC SSRU Interrupts.
|
|
*/
|
|
void TAMP_STAMP_LSECSS_SSRU_IRQHandler(void)
|
|
{
|
|
8000a24: b580 push {r7, lr}
|
|
8000a26: af00 add r7, sp, #0
|
|
/* USER CODE BEGIN TAMP_STAMP_LSECSS_SSRU_IRQn 0 */
|
|
|
|
/* USER CODE END TAMP_STAMP_LSECSS_SSRU_IRQn 0 */
|
|
HAL_RTCEx_SSRUIRQHandler(&hrtc);
|
|
8000a28: 4802 ldr r0, [pc, #8] @ (8000a34 <TAMP_STAMP_LSECSS_SSRU_IRQHandler+0x10>)
|
|
8000a2a: f004 f89b bl 8004b64 <HAL_RTCEx_SSRUIRQHandler>
|
|
/* USER CODE BEGIN TAMP_STAMP_LSECSS_SSRU_IRQn 1 */
|
|
|
|
/* USER CODE END TAMP_STAMP_LSECSS_SSRU_IRQn 1 */
|
|
}
|
|
8000a2e: bf00 nop
|
|
8000a30: bd80 pop {r7, pc}
|
|
8000a32: bf00 nop
|
|
8000a34: 20000088 .word 0x20000088
|
|
|
|
08000a38 <EXTI0_IRQHandler>:
|
|
|
|
/**
|
|
* @brief This function handles EXTI Line 0 Interrupt.
|
|
*/
|
|
void EXTI0_IRQHandler(void)
|
|
{
|
|
8000a38: b580 push {r7, lr}
|
|
8000a3a: af00 add r7, sp, #0
|
|
/* USER CODE BEGIN EXTI0_IRQn 0 */
|
|
|
|
/* USER CODE END EXTI0_IRQn 0 */
|
|
HAL_GPIO_EXTI_IRQHandler(BUT1_Pin);
|
|
8000a3c: 2001 movs r0, #1
|
|
8000a3e: f002 f95b bl 8002cf8 <HAL_GPIO_EXTI_IRQHandler>
|
|
/* USER CODE BEGIN EXTI0_IRQn 1 */
|
|
|
|
/* USER CODE END EXTI0_IRQn 1 */
|
|
}
|
|
8000a42: bf00 nop
|
|
8000a44: bd80 pop {r7, pc}
|
|
|
|
08000a46 <EXTI1_IRQHandler>:
|
|
|
|
/**
|
|
* @brief This function handles EXTI Line 1 Interrupt.
|
|
*/
|
|
void EXTI1_IRQHandler(void)
|
|
{
|
|
8000a46: b580 push {r7, lr}
|
|
8000a48: af00 add r7, sp, #0
|
|
/* USER CODE BEGIN EXTI1_IRQn 0 */
|
|
|
|
/* USER CODE END EXTI1_IRQn 0 */
|
|
HAL_GPIO_EXTI_IRQHandler(BUT2_Pin);
|
|
8000a4a: 2002 movs r0, #2
|
|
8000a4c: f002 f954 bl 8002cf8 <HAL_GPIO_EXTI_IRQHandler>
|
|
/* USER CODE BEGIN EXTI1_IRQn 1 */
|
|
|
|
/* USER CODE END EXTI1_IRQn 1 */
|
|
}
|
|
8000a50: bf00 nop
|
|
8000a52: bd80 pop {r7, pc}
|
|
|
|
08000a54 <DMA1_Channel5_IRQHandler>:
|
|
|
|
/**
|
|
* @brief This function handles DMA1 Channel 5 Interrupt.
|
|
*/
|
|
void DMA1_Channel5_IRQHandler(void)
|
|
{
|
|
8000a54: b580 push {r7, lr}
|
|
8000a56: af00 add r7, sp, #0
|
|
/* USER CODE BEGIN DMA1_Channel5_IRQn 0 */
|
|
|
|
/* USER CODE END DMA1_Channel5_IRQn 0 */
|
|
HAL_DMA_IRQHandler(&hdma_usart2_tx);
|
|
8000a58: 4802 ldr r0, [pc, #8] @ (8000a64 <DMA1_Channel5_IRQHandler+0x10>)
|
|
8000a5a: f001 fb41 bl 80020e0 <HAL_DMA_IRQHandler>
|
|
/* USER CODE BEGIN DMA1_Channel5_IRQn 1 */
|
|
|
|
/* USER CODE END DMA1_Channel5_IRQn 1 */
|
|
}
|
|
8000a5e: bf00 nop
|
|
8000a60: bd80 pop {r7, pc}
|
|
8000a62: bf00 nop
|
|
8000a64: 20000170 .word 0x20000170
|
|
|
|
08000a68 <EXTI9_5_IRQHandler>:
|
|
|
|
/**
|
|
* @brief This function handles EXTI Lines [9:5] Interrupt.
|
|
*/
|
|
void EXTI9_5_IRQHandler(void)
|
|
{
|
|
8000a68: b580 push {r7, lr}
|
|
8000a6a: af00 add r7, sp, #0
|
|
/* USER CODE BEGIN EXTI9_5_IRQn 0 */
|
|
|
|
/* USER CODE END EXTI9_5_IRQn 0 */
|
|
HAL_GPIO_EXTI_IRQHandler(BUT3_Pin);
|
|
8000a6c: 2040 movs r0, #64 @ 0x40
|
|
8000a6e: f002 f943 bl 8002cf8 <HAL_GPIO_EXTI_IRQHandler>
|
|
/* USER CODE BEGIN EXTI9_5_IRQn 1 */
|
|
|
|
/* USER CODE END EXTI9_5_IRQn 1 */
|
|
}
|
|
8000a72: bf00 nop
|
|
8000a74: bd80 pop {r7, pc}
|
|
...
|
|
|
|
08000a78 <USART2_IRQHandler>:
|
|
|
|
/**
|
|
* @brief This function handles USART2 Interrupt.
|
|
*/
|
|
void USART2_IRQHandler(void)
|
|
{
|
|
8000a78: b580 push {r7, lr}
|
|
8000a7a: af00 add r7, sp, #0
|
|
/* USER CODE BEGIN USART2_IRQn 0 */
|
|
|
|
/* USER CODE END USART2_IRQn 0 */
|
|
HAL_UART_IRQHandler(&huart2);
|
|
8000a7c: 4802 ldr r0, [pc, #8] @ (8000a88 <USART2_IRQHandler+0x10>)
|
|
8000a7e: f005 f817 bl 8005ab0 <HAL_UART_IRQHandler>
|
|
/* USER CODE BEGIN USART2_IRQn 1 */
|
|
|
|
/* USER CODE END USART2_IRQn 1 */
|
|
}
|
|
8000a82: bf00 nop
|
|
8000a84: bd80 pop {r7, pc}
|
|
8000a86: bf00 nop
|
|
8000a88: 200000dc .word 0x200000dc
|
|
|
|
08000a8c <RTC_Alarm_IRQHandler>:
|
|
|
|
/**
|
|
* @brief This function handles RTC Alarms (A and B) Interrupt.
|
|
*/
|
|
void RTC_Alarm_IRQHandler(void)
|
|
{
|
|
8000a8c: b580 push {r7, lr}
|
|
8000a8e: af00 add r7, sp, #0
|
|
/* USER CODE BEGIN RTC_Alarm_IRQn 0 */
|
|
|
|
/* USER CODE END RTC_Alarm_IRQn 0 */
|
|
HAL_RTC_AlarmIRQHandler(&hrtc);
|
|
8000a90: 4802 ldr r0, [pc, #8] @ (8000a9c <RTC_Alarm_IRQHandler+0x10>)
|
|
8000a92: f003 ff17 bl 80048c4 <HAL_RTC_AlarmIRQHandler>
|
|
/* USER CODE BEGIN RTC_Alarm_IRQn 1 */
|
|
|
|
/* USER CODE END RTC_Alarm_IRQn 1 */
|
|
}
|
|
8000a96: bf00 nop
|
|
8000a98: bd80 pop {r7, pc}
|
|
8000a9a: bf00 nop
|
|
8000a9c: 20000088 .word 0x20000088
|
|
|
|
08000aa0 <SUBGHZ_Radio_IRQHandler>:
|
|
|
|
/**
|
|
* @brief This function handles SUBGHZ Radio Interrupt.
|
|
*/
|
|
void SUBGHZ_Radio_IRQHandler(void)
|
|
{
|
|
8000aa0: b580 push {r7, lr}
|
|
8000aa2: af00 add r7, sp, #0
|
|
/* USER CODE BEGIN SUBGHZ_Radio_IRQn 0 */
|
|
|
|
/* USER CODE END SUBGHZ_Radio_IRQn 0 */
|
|
HAL_SUBGHZ_IRQHandler(&hsubghz);
|
|
8000aa4: 4802 ldr r0, [pc, #8] @ (8000ab0 <SUBGHZ_Radio_IRQHandler+0x10>)
|
|
8000aa6: f004 fbcb bl 8005240 <HAL_SUBGHZ_IRQHandler>
|
|
/* USER CODE BEGIN SUBGHZ_Radio_IRQn 1 */
|
|
|
|
/* USER CODE END SUBGHZ_Radio_IRQn 1 */
|
|
}
|
|
8000aaa: bf00 nop
|
|
8000aac: bd80 pop {r7, pc}
|
|
8000aae: bf00 nop
|
|
8000ab0: 200000c0 .word 0x200000c0
|
|
|
|
08000ab4 <LL_APB3_GRP1_EnableClock>:
|
|
* @param Periphs This parameter can be a combination of the following values:
|
|
* @arg @ref LL_APB3_GRP1_PERIPH_SUBGHZSPI
|
|
* @retval None
|
|
*/
|
|
__STATIC_INLINE void LL_APB3_GRP1_EnableClock(uint32_t Periphs)
|
|
{
|
|
8000ab4: b480 push {r7}
|
|
8000ab6: b085 sub sp, #20
|
|
8000ab8: af00 add r7, sp, #0
|
|
8000aba: 6078 str r0, [r7, #4]
|
|
__IO uint32_t tmpreg;
|
|
SET_BIT(RCC->APB3ENR, Periphs);
|
|
8000abc: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8000ac0: 6e5a ldr r2, [r3, #100] @ 0x64
|
|
8000ac2: f04f 41b0 mov.w r1, #1476395008 @ 0x58000000
|
|
8000ac6: 687b ldr r3, [r7, #4]
|
|
8000ac8: 4313 orrs r3, r2
|
|
8000aca: 664b str r3, [r1, #100] @ 0x64
|
|
/* Delay after an RCC peripheral clock enabling */
|
|
tmpreg = READ_BIT(RCC->APB3ENR, Periphs);
|
|
8000acc: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8000ad0: 6e5a ldr r2, [r3, #100] @ 0x64
|
|
8000ad2: 687b ldr r3, [r7, #4]
|
|
8000ad4: 4013 ands r3, r2
|
|
8000ad6: 60fb str r3, [r7, #12]
|
|
(void)tmpreg;
|
|
8000ad8: 68fb ldr r3, [r7, #12]
|
|
}
|
|
8000ada: bf00 nop
|
|
8000adc: 3714 adds r7, #20
|
|
8000ade: 46bd mov sp, r7
|
|
8000ae0: bc80 pop {r7}
|
|
8000ae2: 4770 bx lr
|
|
|
|
08000ae4 <MX_SUBGHZ_Init>:
|
|
|
|
SUBGHZ_HandleTypeDef hsubghz;
|
|
|
|
/* SUBGHZ init function */
|
|
void MX_SUBGHZ_Init(void)
|
|
{
|
|
8000ae4: b580 push {r7, lr}
|
|
8000ae6: af00 add r7, sp, #0
|
|
/* USER CODE END SUBGHZ_Init 0 */
|
|
|
|
/* USER CODE BEGIN SUBGHZ_Init 1 */
|
|
|
|
/* USER CODE END SUBGHZ_Init 1 */
|
|
hsubghz.Init.BaudratePrescaler = SUBGHZSPI_BAUDRATEPRESCALER_4;
|
|
8000ae8: 4b06 ldr r3, [pc, #24] @ (8000b04 <MX_SUBGHZ_Init+0x20>)
|
|
8000aea: 2208 movs r2, #8
|
|
8000aec: 601a str r2, [r3, #0]
|
|
if (HAL_SUBGHZ_Init(&hsubghz) != HAL_OK)
|
|
8000aee: 4805 ldr r0, [pc, #20] @ (8000b04 <MX_SUBGHZ_Init+0x20>)
|
|
8000af0: f004 f924 bl 8004d3c <HAL_SUBGHZ_Init>
|
|
8000af4: 4603 mov r3, r0
|
|
8000af6: 2b00 cmp r3, #0
|
|
8000af8: d001 beq.n 8000afe <MX_SUBGHZ_Init+0x1a>
|
|
{
|
|
Error_Handler();
|
|
8000afa: f7ff fe69 bl 80007d0 <Error_Handler>
|
|
}
|
|
/* USER CODE BEGIN SUBGHZ_Init 2 */
|
|
|
|
/* USER CODE END SUBGHZ_Init 2 */
|
|
|
|
}
|
|
8000afe: bf00 nop
|
|
8000b00: bd80 pop {r7, pc}
|
|
8000b02: bf00 nop
|
|
8000b04: 200000c0 .word 0x200000c0
|
|
|
|
08000b08 <HAL_SUBGHZ_MspInit>:
|
|
|
|
void HAL_SUBGHZ_MspInit(SUBGHZ_HandleTypeDef* subghzHandle)
|
|
{
|
|
8000b08: b580 push {r7, lr}
|
|
8000b0a: b082 sub sp, #8
|
|
8000b0c: af00 add r7, sp, #0
|
|
8000b0e: 6078 str r0, [r7, #4]
|
|
|
|
/* USER CODE BEGIN SUBGHZ_MspInit 0 */
|
|
|
|
/* USER CODE END SUBGHZ_MspInit 0 */
|
|
/* SUBGHZ clock enable */
|
|
__HAL_RCC_SUBGHZSPI_CLK_ENABLE();
|
|
8000b10: 2001 movs r0, #1
|
|
8000b12: f7ff ffcf bl 8000ab4 <LL_APB3_GRP1_EnableClock>
|
|
|
|
/* SUBGHZ interrupt Init */
|
|
HAL_NVIC_SetPriority(SUBGHZ_Radio_IRQn, 0, 0);
|
|
8000b16: 2200 movs r2, #0
|
|
8000b18: 2100 movs r1, #0
|
|
8000b1a: 2032 movs r0, #50 @ 0x32
|
|
8000b1c: f001 f82f bl 8001b7e <HAL_NVIC_SetPriority>
|
|
HAL_NVIC_EnableIRQ(SUBGHZ_Radio_IRQn);
|
|
8000b20: 2032 movs r0, #50 @ 0x32
|
|
8000b22: f001 f846 bl 8001bb2 <HAL_NVIC_EnableIRQ>
|
|
/* USER CODE BEGIN SUBGHZ_MspInit 1 */
|
|
|
|
/* USER CODE END SUBGHZ_MspInit 1 */
|
|
}
|
|
8000b26: bf00 nop
|
|
8000b28: 3708 adds r7, #8
|
|
8000b2a: 46bd mov sp, r7
|
|
8000b2c: bd80 pop {r7, pc}
|
|
|
|
08000b2e <LL_RCC_SetClkAfterWakeFromStop>:
|
|
{
|
|
8000b2e: b480 push {r7}
|
|
8000b30: b083 sub sp, #12
|
|
8000b32: af00 add r7, sp, #0
|
|
8000b34: 6078 str r0, [r7, #4]
|
|
MODIFY_REG(RCC->CFGR, RCC_CFGR_STOPWUCK, Clock);
|
|
8000b36: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8000b3a: 689b ldr r3, [r3, #8]
|
|
8000b3c: f423 4200 bic.w r2, r3, #32768 @ 0x8000
|
|
8000b40: f04f 41b0 mov.w r1, #1476395008 @ 0x58000000
|
|
8000b44: 687b ldr r3, [r7, #4]
|
|
8000b46: 4313 orrs r3, r2
|
|
8000b48: 608b str r3, [r1, #8]
|
|
}
|
|
8000b4a: bf00 nop
|
|
8000b4c: 370c adds r7, #12
|
|
8000b4e: 46bd mov sp, r7
|
|
8000b50: bc80 pop {r7}
|
|
8000b52: 4770 bx lr
|
|
|
|
08000b54 <SystemApp_Init>:
|
|
|
|
/* USER CODE END PFP */
|
|
|
|
/* Exported functions ---------------------------------------------------------*/
|
|
void SystemApp_Init(void)
|
|
{
|
|
8000b54: b580 push {r7, lr}
|
|
8000b56: af00 add r7, sp, #0
|
|
/* USER CODE BEGIN SystemApp_Init_1 */
|
|
|
|
/* USER CODE END SystemApp_Init_1 */
|
|
|
|
/* Ensure that MSI is wake-up system clock */
|
|
__HAL_RCC_WAKEUPSTOP_CLK_CONFIG(RCC_STOP_WAKEUPCLOCK_MSI);
|
|
8000b58: 2000 movs r0, #0
|
|
8000b5a: f7ff ffe8 bl 8000b2e <LL_RCC_SetClkAfterWakeFromStop>
|
|
|
|
/*Initialize timer and RTC*/
|
|
UTIL_TIMER_Init();
|
|
8000b5e: f00d fb99 bl 800e294 <UTIL_TIMER_Init>
|
|
SYS_TimerInitialisedFlag = 1;
|
|
8000b62: 4b0c ldr r3, [pc, #48] @ (8000b94 <SystemApp_Init+0x40>)
|
|
8000b64: 2201 movs r2, #1
|
|
8000b66: 701a strb r2, [r3, #0]
|
|
/* Initializes the SW probes pins and the monitor RF pins via Alternate Function */
|
|
DBG_Init();
|
|
8000b68: f000 f8ba bl 8000ce0 <DBG_Init>
|
|
|
|
/*Initialize the terminal */
|
|
UTIL_ADV_TRACE_Init();
|
|
8000b6c: f00d fe22 bl 800e7b4 <UTIL_ADV_TRACE_Init>
|
|
UTIL_ADV_TRACE_RegisterTimeStampFunction(TimestampNow);
|
|
8000b70: 4809 ldr r0, [pc, #36] @ (8000b98 <SystemApp_Init+0x44>)
|
|
8000b72: f00d febb bl 800e8ec <UTIL_ADV_TRACE_RegisterTimeStampFunction>
|
|
|
|
/*Set verbose LEVEL*/
|
|
UTIL_ADV_TRACE_SetVerboseLevel(VERBOSE_LEVEL);
|
|
8000b76: 2002 movs r0, #2
|
|
8000b78: f00d fec6 bl 800e908 <UTIL_ADV_TRACE_SetVerboseLevel>
|
|
|
|
/*Init low power manager*/
|
|
UTIL_LPM_Init();
|
|
8000b7c: f00c fe92 bl 800d8a4 <UTIL_LPM_Init>
|
|
/* Disable Stand-by mode */
|
|
UTIL_LPM_SetOffMode((1 << CFG_LPM_APPLI_Id), UTIL_LPM_DISABLE);
|
|
8000b80: 2101 movs r1, #1
|
|
8000b82: 2001 movs r0, #1
|
|
8000b84: f00c fece bl 800d924 <UTIL_LPM_SetOffMode>
|
|
|
|
#if defined (LOW_POWER_DISABLE) && (LOW_POWER_DISABLE == 1)
|
|
/* Disable Stop Mode */
|
|
UTIL_LPM_SetStopMode((1 << CFG_LPM_APPLI_Id), UTIL_LPM_DISABLE);
|
|
8000b88: 2101 movs r1, #1
|
|
8000b8a: 2001 movs r0, #1
|
|
8000b8c: f00c fe9a bl 800d8c4 <UTIL_LPM_SetStopMode>
|
|
#endif /* LOW_POWER_DISABLE */
|
|
|
|
/* USER CODE BEGIN SystemApp_Init_2 */
|
|
|
|
/* USER CODE END SystemApp_Init_2 */
|
|
}
|
|
8000b90: bf00 nop
|
|
8000b92: bd80 pop {r7, pc}
|
|
8000b94: 200000cc .word 0x200000cc
|
|
8000b98: 08000ba9 .word 0x08000ba9
|
|
|
|
08000b9c <UTIL_SEQ_Idle>:
|
|
|
|
/**
|
|
* @brief redefines __weak function in stm32_seq.c such to enter low power
|
|
*/
|
|
void UTIL_SEQ_Idle(void)
|
|
{
|
|
8000b9c: b580 push {r7, lr}
|
|
8000b9e: af00 add r7, sp, #0
|
|
/* USER CODE BEGIN UTIL_SEQ_Idle_1 */
|
|
|
|
/* USER CODE END UTIL_SEQ_Idle_1 */
|
|
UTIL_LPM_EnterLowPower();
|
|
8000ba0: f00c fef0 bl 800d984 <UTIL_LPM_EnterLowPower>
|
|
/* USER CODE BEGIN UTIL_SEQ_Idle_2 */
|
|
|
|
/* USER CODE END UTIL_SEQ_Idle_2 */
|
|
}
|
|
8000ba4: bf00 nop
|
|
8000ba6: bd80 pop {r7, pc}
|
|
|
|
08000ba8 <TimestampNow>:
|
|
/* USER CODE END EF */
|
|
|
|
/* Private functions ---------------------------------------------------------*/
|
|
|
|
static void TimestampNow(uint8_t *buff, uint16_t *size)
|
|
{
|
|
8000ba8: b580 push {r7, lr}
|
|
8000baa: b086 sub sp, #24
|
|
8000bac: af02 add r7, sp, #8
|
|
8000bae: 6078 str r0, [r7, #4]
|
|
8000bb0: 6039 str r1, [r7, #0]
|
|
/* USER CODE BEGIN TimestampNow_1 */
|
|
|
|
/* USER CODE END TimestampNow_1 */
|
|
SysTime_t curtime = SysTimeGet();
|
|
8000bb2: f107 0308 add.w r3, r7, #8
|
|
8000bb6: 4618 mov r0, r3
|
|
8000bb8: f00c ff8e bl 800dad8 <SysTimeGet>
|
|
tiny_snprintf_like((char *)buff, MAX_TS_SIZE, "%ds%03d:", curtime.Seconds, curtime.SubSeconds);
|
|
8000bbc: 68bb ldr r3, [r7, #8]
|
|
8000bbe: f9b7 200c ldrsh.w r2, [r7, #12]
|
|
8000bc2: 9200 str r2, [sp, #0]
|
|
8000bc4: 4a07 ldr r2, [pc, #28] @ (8000be4 <TimestampNow+0x3c>)
|
|
8000bc6: 2110 movs r1, #16
|
|
8000bc8: 6878 ldr r0, [r7, #4]
|
|
8000bca: f000 f81d bl 8000c08 <tiny_snprintf_like>
|
|
*size = strlen((char *)buff);
|
|
8000bce: 6878 ldr r0, [r7, #4]
|
|
8000bd0: f7ff fae0 bl 8000194 <strlen>
|
|
8000bd4: 4603 mov r3, r0
|
|
8000bd6: b29a uxth r2, r3
|
|
8000bd8: 683b ldr r3, [r7, #0]
|
|
8000bda: 801a strh r2, [r3, #0]
|
|
/* USER CODE BEGIN TimestampNow_2 */
|
|
|
|
/* USER CODE END TimestampNow_2 */
|
|
}
|
|
8000bdc: bf00 nop
|
|
8000bde: 3710 adds r7, #16
|
|
8000be0: 46bd mov sp, r7
|
|
8000be2: bd80 pop {r7, pc}
|
|
8000be4: 0800f884 .word 0x0800f884
|
|
|
|
08000be8 <UTIL_ADV_TRACE_PreSendHook>:
|
|
|
|
/* Disable StopMode when traces need to be printed */
|
|
void UTIL_ADV_TRACE_PreSendHook(void)
|
|
{
|
|
8000be8: b580 push {r7, lr}
|
|
8000bea: af00 add r7, sp, #0
|
|
/* USER CODE BEGIN UTIL_ADV_TRACE_PreSendHook_1 */
|
|
|
|
/* USER CODE END UTIL_ADV_TRACE_PreSendHook_1 */
|
|
UTIL_LPM_SetStopMode((1 << CFG_LPM_UART_TX_Id), UTIL_LPM_DISABLE);
|
|
8000bec: 2101 movs r1, #1
|
|
8000bee: 2002 movs r0, #2
|
|
8000bf0: f00c fe68 bl 800d8c4 <UTIL_LPM_SetStopMode>
|
|
/* USER CODE BEGIN UTIL_ADV_TRACE_PreSendHook_2 */
|
|
|
|
/* USER CODE END UTIL_ADV_TRACE_PreSendHook_2 */
|
|
}
|
|
8000bf4: bf00 nop
|
|
8000bf6: bd80 pop {r7, pc}
|
|
|
|
08000bf8 <UTIL_ADV_TRACE_PostSendHook>:
|
|
/* Re-enable StopMode when traces have been printed */
|
|
void UTIL_ADV_TRACE_PostSendHook(void)
|
|
{
|
|
8000bf8: b580 push {r7, lr}
|
|
8000bfa: af00 add r7, sp, #0
|
|
/* USER CODE BEGIN UTIL_LPM_SetStopMode_1 */
|
|
|
|
/* USER CODE END UTIL_LPM_SetStopMode_1 */
|
|
UTIL_LPM_SetStopMode((1 << CFG_LPM_UART_TX_Id), UTIL_LPM_ENABLE);
|
|
8000bfc: 2100 movs r1, #0
|
|
8000bfe: 2002 movs r0, #2
|
|
8000c00: f00c fe60 bl 800d8c4 <UTIL_LPM_SetStopMode>
|
|
/* USER CODE BEGIN UTIL_LPM_SetStopMode_2 */
|
|
|
|
/* USER CODE END UTIL_LPM_SetStopMode_2 */
|
|
}
|
|
8000c04: bf00 nop
|
|
8000c06: bd80 pop {r7, pc}
|
|
|
|
08000c08 <tiny_snprintf_like>:
|
|
|
|
static void tiny_snprintf_like(char *buf, uint32_t maxsize, const char *strFormat, ...)
|
|
{
|
|
8000c08: b40c push {r2, r3}
|
|
8000c0a: b580 push {r7, lr}
|
|
8000c0c: b084 sub sp, #16
|
|
8000c0e: af00 add r7, sp, #0
|
|
8000c10: 6078 str r0, [r7, #4]
|
|
8000c12: 6039 str r1, [r7, #0]
|
|
/* USER CODE BEGIN tiny_snprintf_like_1 */
|
|
|
|
/* USER CODE END tiny_snprintf_like_1 */
|
|
va_list vaArgs;
|
|
va_start(vaArgs, strFormat);
|
|
8000c14: f107 031c add.w r3, r7, #28
|
|
8000c18: 60fb str r3, [r7, #12]
|
|
UTIL_ADV_TRACE_VSNPRINTF(buf, maxsize, strFormat, vaArgs);
|
|
8000c1a: 6839 ldr r1, [r7, #0]
|
|
8000c1c: 68fb ldr r3, [r7, #12]
|
|
8000c1e: 69ba ldr r2, [r7, #24]
|
|
8000c20: 6878 ldr r0, [r7, #4]
|
|
8000c22: f00d f8a5 bl 800dd70 <tiny_vsnprintf_like>
|
|
va_end(vaArgs);
|
|
/* USER CODE BEGIN tiny_snprintf_like_2 */
|
|
|
|
/* USER CODE END tiny_snprintf_like_2 */
|
|
}
|
|
8000c26: bf00 nop
|
|
8000c28: 3710 adds r7, #16
|
|
8000c2a: 46bd mov sp, r7
|
|
8000c2c: e8bd 4080 ldmia.w sp!, {r7, lr}
|
|
8000c30: b002 add sp, #8
|
|
8000c32: 4770 bx lr
|
|
|
|
08000c34 <HAL_InitTick>:
|
|
|
|
/**
|
|
* @note This function overwrites the __weak one from HAL
|
|
*/
|
|
HAL_StatusTypeDef HAL_InitTick(uint32_t TickPriority)
|
|
{
|
|
8000c34: b480 push {r7}
|
|
8000c36: b083 sub sp, #12
|
|
8000c38: af00 add r7, sp, #0
|
|
8000c3a: 6078 str r0, [r7, #4]
|
|
/*Don't enable SysTick if TIMER_IF is based on other counters (e.g. RTC) */
|
|
/* USER CODE BEGIN HAL_InitTick_1 */
|
|
|
|
/* USER CODE END HAL_InitTick_1 */
|
|
return HAL_OK;
|
|
8000c3c: 2300 movs r3, #0
|
|
/* USER CODE BEGIN HAL_InitTick_2 */
|
|
|
|
/* USER CODE END HAL_InitTick_2 */
|
|
}
|
|
8000c3e: 4618 mov r0, r3
|
|
8000c40: 370c adds r7, #12
|
|
8000c42: 46bd mov sp, r7
|
|
8000c44: bc80 pop {r7}
|
|
8000c46: 4770 bx lr
|
|
|
|
08000c48 <HAL_GetTick>:
|
|
|
|
/**
|
|
* @note This function overwrites the __weak one from HAL
|
|
*/
|
|
uint32_t HAL_GetTick(void)
|
|
{
|
|
8000c48: b580 push {r7, lr}
|
|
8000c4a: b082 sub sp, #8
|
|
8000c4c: af00 add r7, sp, #0
|
|
uint32_t ret = 0;
|
|
8000c4e: 2300 movs r3, #0
|
|
8000c50: 607b str r3, [r7, #4]
|
|
/* TIMER_IF can be based on other counter the SysTick e.g. RTC */
|
|
/* USER CODE BEGIN HAL_GetTick_1 */
|
|
|
|
/* USER CODE END HAL_GetTick_1 */
|
|
if (SYS_TimerInitialisedFlag == 0)
|
|
8000c52: 4b06 ldr r3, [pc, #24] @ (8000c6c <HAL_GetTick+0x24>)
|
|
8000c54: 781b ldrb r3, [r3, #0]
|
|
8000c56: 2b00 cmp r3, #0
|
|
8000c58: d002 beq.n 8000c60 <HAL_GetTick+0x18>
|
|
|
|
/* USER CODE END HAL_GetTick_EarlyCall */
|
|
}
|
|
else
|
|
{
|
|
ret = TIMER_IF_GetTimerValue();
|
|
8000c5a: f000 f97b bl 8000f54 <TIMER_IF_GetTimerValue>
|
|
8000c5e: 6078 str r0, [r7, #4]
|
|
}
|
|
/* USER CODE BEGIN HAL_GetTick_2 */
|
|
|
|
/* USER CODE END HAL_GetTick_2 */
|
|
return ret;
|
|
8000c60: 687b ldr r3, [r7, #4]
|
|
}
|
|
8000c62: 4618 mov r0, r3
|
|
8000c64: 3708 adds r7, #8
|
|
8000c66: 46bd mov sp, r7
|
|
8000c68: bd80 pop {r7, pc}
|
|
8000c6a: bf00 nop
|
|
8000c6c: 200000cc .word 0x200000cc
|
|
|
|
08000c70 <HAL_Delay>:
|
|
|
|
/**
|
|
* @note This function overwrites the __weak one from HAL
|
|
*/
|
|
void HAL_Delay(__IO uint32_t Delay)
|
|
{
|
|
8000c70: b580 push {r7, lr}
|
|
8000c72: b082 sub sp, #8
|
|
8000c74: af00 add r7, sp, #0
|
|
8000c76: 6078 str r0, [r7, #4]
|
|
/* TIMER_IF can be based on other counter the SysTick e.g. RTC */
|
|
/* USER CODE BEGIN HAL_Delay_1 */
|
|
|
|
/* USER CODE END HAL_Delay_1 */
|
|
TIMER_IF_DelayMs(Delay);
|
|
8000c78: 687b ldr r3, [r7, #4]
|
|
8000c7a: 4618 mov r0, r3
|
|
8000c7c: f000 f9f1 bl 8001062 <TIMER_IF_DelayMs>
|
|
/* USER CODE BEGIN HAL_Delay_2 */
|
|
|
|
/* USER CODE END HAL_Delay_2 */
|
|
}
|
|
8000c80: bf00 nop
|
|
8000c82: 3708 adds r7, #8
|
|
8000c84: 46bd mov sp, r7
|
|
8000c86: bd80 pop {r7, pc}
|
|
|
|
08000c88 <LL_AHB2_GRP1_EnableClock>:
|
|
{
|
|
8000c88: b480 push {r7}
|
|
8000c8a: b085 sub sp, #20
|
|
8000c8c: af00 add r7, sp, #0
|
|
8000c8e: 6078 str r0, [r7, #4]
|
|
SET_BIT(RCC->AHB2ENR, Periphs);
|
|
8000c90: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8000c94: 6cda ldr r2, [r3, #76] @ 0x4c
|
|
8000c96: f04f 41b0 mov.w r1, #1476395008 @ 0x58000000
|
|
8000c9a: 687b ldr r3, [r7, #4]
|
|
8000c9c: 4313 orrs r3, r2
|
|
8000c9e: 64cb str r3, [r1, #76] @ 0x4c
|
|
tmpreg = READ_BIT(RCC->AHB2ENR, Periphs);
|
|
8000ca0: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8000ca4: 6cda ldr r2, [r3, #76] @ 0x4c
|
|
8000ca6: 687b ldr r3, [r7, #4]
|
|
8000ca8: 4013 ands r3, r2
|
|
8000caa: 60fb str r3, [r7, #12]
|
|
(void)tmpreg;
|
|
8000cac: 68fb ldr r3, [r7, #12]
|
|
}
|
|
8000cae: bf00 nop
|
|
8000cb0: 3714 adds r7, #20
|
|
8000cb2: 46bd mov sp, r7
|
|
8000cb4: bc80 pop {r7}
|
|
8000cb6: 4770 bx lr
|
|
|
|
08000cb8 <LL_EXTI_EnableIT_32_63>:
|
|
* @arg @ref LL_EXTI_LINE_ALL_32_63
|
|
* (*) value not defined in all devices
|
|
* @retval None
|
|
*/
|
|
__STATIC_INLINE void LL_EXTI_EnableIT_32_63(uint32_t ExtiLine)
|
|
{
|
|
8000cb8: b480 push {r7}
|
|
8000cba: b083 sub sp, #12
|
|
8000cbc: af00 add r7, sp, #0
|
|
8000cbe: 6078 str r0, [r7, #4]
|
|
SET_BIT(EXTI->IMR2, ExtiLine);
|
|
8000cc0: 4b06 ldr r3, [pc, #24] @ (8000cdc <LL_EXTI_EnableIT_32_63+0x24>)
|
|
8000cc2: f8d3 2090 ldr.w r2, [r3, #144] @ 0x90
|
|
8000cc6: 4905 ldr r1, [pc, #20] @ (8000cdc <LL_EXTI_EnableIT_32_63+0x24>)
|
|
8000cc8: 687b ldr r3, [r7, #4]
|
|
8000cca: 4313 orrs r3, r2
|
|
8000ccc: f8c1 3090 str.w r3, [r1, #144] @ 0x90
|
|
}
|
|
8000cd0: bf00 nop
|
|
8000cd2: 370c adds r7, #12
|
|
8000cd4: 46bd mov sp, r7
|
|
8000cd6: bc80 pop {r7}
|
|
8000cd8: 4770 bx lr
|
|
8000cda: bf00 nop
|
|
8000cdc: 58000800 .word 0x58000800
|
|
|
|
08000ce0 <DBG_Init>:
|
|
|
|
/**
|
|
* @brief Initializes the SW probes pins and the monitor RF pins via Alternate Function
|
|
*/
|
|
void DBG_Init(void)
|
|
{
|
|
8000ce0: b580 push {r7, lr}
|
|
8000ce2: b086 sub sp, #24
|
|
8000ce4: af00 add r7, sp, #0
|
|
HAL_DBGMCU_DisableDBGSleepMode();
|
|
HAL_DBGMCU_DisableDBGStopMode();
|
|
HAL_DBGMCU_DisableDBGStandbyMode();
|
|
#elif defined (DEBUGGER_ENABLED) && ( DEBUGGER_ENABLED == 1 )
|
|
/*Debug power up request wakeup CBDGPWRUPREQ*/
|
|
LL_EXTI_EnableIT_32_63(LL_EXTI_LINE_46);
|
|
8000ce6: f44f 4080 mov.w r0, #16384 @ 0x4000
|
|
8000cea: f7ff ffe5 bl 8000cb8 <LL_EXTI_EnableIT_32_63>
|
|
/* Disabled HAL_DBGMCU_ */
|
|
HAL_DBGMCU_EnableDBGSleepMode();
|
|
8000cee: f000 fe5b bl 80019a8 <HAL_DBGMCU_EnableDBGSleepMode>
|
|
HAL_DBGMCU_EnableDBGStopMode();
|
|
8000cf2: f000 fe5f bl 80019b4 <HAL_DBGMCU_EnableDBGStopMode>
|
|
HAL_DBGMCU_EnableDBGStandbyMode();
|
|
8000cf6: f000 fe63 bl 80019c0 <HAL_DBGMCU_EnableDBGStandbyMode>
|
|
#elif !defined (DEBUGGER_ENABLED)
|
|
#error "DEBUGGER_ENABLED not defined or out of range <0,1>"
|
|
#endif /* DEBUGGER_OFF */
|
|
|
|
GPIO_InitTypeDef GPIO_InitStruct = {0};
|
|
8000cfa: 1d3b adds r3, r7, #4
|
|
8000cfc: 2200 movs r2, #0
|
|
8000cfe: 601a str r2, [r3, #0]
|
|
8000d00: 605a str r2, [r3, #4]
|
|
8000d02: 609a str r2, [r3, #8]
|
|
8000d04: 60da str r2, [r3, #12]
|
|
8000d06: 611a str r2, [r3, #16]
|
|
|
|
/* Configure the GPIO pin */
|
|
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
|
8000d08: 2301 movs r3, #1
|
|
8000d0a: 60bb str r3, [r7, #8]
|
|
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
8000d0c: 2300 movs r3, #0
|
|
8000d0e: 60fb str r3, [r7, #12]
|
|
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_VERY_HIGH;
|
|
8000d10: 2303 movs r3, #3
|
|
8000d12: 613b str r3, [r7, #16]
|
|
|
|
/* Enable the GPIO Clock */
|
|
PROBE_LINE1_CLK_ENABLE();
|
|
8000d14: 2002 movs r0, #2
|
|
8000d16: f7ff ffb7 bl 8000c88 <LL_AHB2_GRP1_EnableClock>
|
|
PROBE_LINE2_CLK_ENABLE();
|
|
8000d1a: 2002 movs r0, #2
|
|
8000d1c: f7ff ffb4 bl 8000c88 <LL_AHB2_GRP1_EnableClock>
|
|
|
|
GPIO_InitStruct.Pin = PROBE_LINE1_PIN;
|
|
8000d20: f44f 5380 mov.w r3, #4096 @ 0x1000
|
|
8000d24: 607b str r3, [r7, #4]
|
|
HAL_GPIO_Init(PROBE_LINE1_PORT, &GPIO_InitStruct);
|
|
8000d26: 1d3b adds r3, r7, #4
|
|
8000d28: 4619 mov r1, r3
|
|
8000d2a: 480d ldr r0, [pc, #52] @ (8000d60 <DBG_Init+0x80>)
|
|
8000d2c: f001 fd9e bl 800286c <HAL_GPIO_Init>
|
|
GPIO_InitStruct.Pin = PROBE_LINE2_PIN;
|
|
8000d30: f44f 5300 mov.w r3, #8192 @ 0x2000
|
|
8000d34: 607b str r3, [r7, #4]
|
|
HAL_GPIO_Init(PROBE_LINE2_PORT, &GPIO_InitStruct);
|
|
8000d36: 1d3b adds r3, r7, #4
|
|
8000d38: 4619 mov r1, r3
|
|
8000d3a: 4809 ldr r0, [pc, #36] @ (8000d60 <DBG_Init+0x80>)
|
|
8000d3c: f001 fd96 bl 800286c <HAL_GPIO_Init>
|
|
|
|
/* Reset probe Pins */
|
|
HAL_GPIO_WritePin(PROBE_LINE1_PORT, PROBE_LINE1_PIN, GPIO_PIN_RESET);
|
|
8000d40: 2200 movs r2, #0
|
|
8000d42: f44f 5180 mov.w r1, #4096 @ 0x1000
|
|
8000d46: 4806 ldr r0, [pc, #24] @ (8000d60 <DBG_Init+0x80>)
|
|
8000d48: f001 ffbe bl 8002cc8 <HAL_GPIO_WritePin>
|
|
HAL_GPIO_WritePin(PROBE_LINE2_PORT, PROBE_LINE2_PIN, GPIO_PIN_RESET);
|
|
8000d4c: 2200 movs r2, #0
|
|
8000d4e: f44f 5100 mov.w r1, #8192 @ 0x2000
|
|
8000d52: 4803 ldr r0, [pc, #12] @ (8000d60 <DBG_Init+0x80>)
|
|
8000d54: f001 ffb8 bl 8002cc8 <HAL_GPIO_WritePin>
|
|
#endif /* DEBUG_RF_BUSY_ENABLED */
|
|
|
|
/* USER CODE BEGIN DBG_Init_3 */
|
|
|
|
/* USER CODE END DBG_Init_3 */
|
|
}
|
|
8000d58: bf00 nop
|
|
8000d5a: 3718 adds r7, #24
|
|
8000d5c: 46bd mov sp, r7
|
|
8000d5e: bd80 pop {r7, pc}
|
|
8000d60: 48000400 .word 0x48000400
|
|
|
|
08000d64 <_sbrk>:
|
|
*
|
|
* @param incr Memory size
|
|
* @return Pointer to allocated memory
|
|
*/
|
|
void *_sbrk(ptrdiff_t incr)
|
|
{
|
|
8000d64: b580 push {r7, lr}
|
|
8000d66: b086 sub sp, #24
|
|
8000d68: af00 add r7, sp, #0
|
|
8000d6a: 6078 str r0, [r7, #4]
|
|
extern uint8_t _end; /* Symbol defined in the linker script */
|
|
extern uint8_t _estack; /* Symbol defined in the linker script */
|
|
extern uint32_t _Min_Stack_Size; /* Symbol defined in the linker script */
|
|
const uint32_t stack_limit = (uint32_t)&_estack - (uint32_t)&_Min_Stack_Size;
|
|
8000d6c: 4a14 ldr r2, [pc, #80] @ (8000dc0 <_sbrk+0x5c>)
|
|
8000d6e: 4b15 ldr r3, [pc, #84] @ (8000dc4 <_sbrk+0x60>)
|
|
8000d70: 1ad3 subs r3, r2, r3
|
|
8000d72: 617b str r3, [r7, #20]
|
|
const uint8_t *max_heap = (uint8_t *)stack_limit;
|
|
8000d74: 697b ldr r3, [r7, #20]
|
|
8000d76: 613b str r3, [r7, #16]
|
|
uint8_t *prev_heap_end;
|
|
|
|
/* Initialize heap end at first call */
|
|
if (NULL == __sbrk_heap_end)
|
|
8000d78: 4b13 ldr r3, [pc, #76] @ (8000dc8 <_sbrk+0x64>)
|
|
8000d7a: 681b ldr r3, [r3, #0]
|
|
8000d7c: 2b00 cmp r3, #0
|
|
8000d7e: d102 bne.n 8000d86 <_sbrk+0x22>
|
|
{
|
|
__sbrk_heap_end = &_end;
|
|
8000d80: 4b11 ldr r3, [pc, #68] @ (8000dc8 <_sbrk+0x64>)
|
|
8000d82: 4a12 ldr r2, [pc, #72] @ (8000dcc <_sbrk+0x68>)
|
|
8000d84: 601a str r2, [r3, #0]
|
|
}
|
|
|
|
/* Protect heap from growing into the reserved MSP stack */
|
|
if (__sbrk_heap_end + incr > max_heap)
|
|
8000d86: 4b10 ldr r3, [pc, #64] @ (8000dc8 <_sbrk+0x64>)
|
|
8000d88: 681a ldr r2, [r3, #0]
|
|
8000d8a: 687b ldr r3, [r7, #4]
|
|
8000d8c: 4413 add r3, r2
|
|
8000d8e: 693a ldr r2, [r7, #16]
|
|
8000d90: 429a cmp r2, r3
|
|
8000d92: d207 bcs.n 8000da4 <_sbrk+0x40>
|
|
{
|
|
errno = ENOMEM;
|
|
8000d94: f00e f8f4 bl 800ef80 <__errno>
|
|
8000d98: 4603 mov r3, r0
|
|
8000d9a: 220c movs r2, #12
|
|
8000d9c: 601a str r2, [r3, #0]
|
|
return (void *)-1;
|
|
8000d9e: f04f 33ff mov.w r3, #4294967295 @ 0xffffffff
|
|
8000da2: e009 b.n 8000db8 <_sbrk+0x54>
|
|
}
|
|
|
|
prev_heap_end = __sbrk_heap_end;
|
|
8000da4: 4b08 ldr r3, [pc, #32] @ (8000dc8 <_sbrk+0x64>)
|
|
8000da6: 681b ldr r3, [r3, #0]
|
|
8000da8: 60fb str r3, [r7, #12]
|
|
__sbrk_heap_end += incr;
|
|
8000daa: 4b07 ldr r3, [pc, #28] @ (8000dc8 <_sbrk+0x64>)
|
|
8000dac: 681a ldr r2, [r3, #0]
|
|
8000dae: 687b ldr r3, [r7, #4]
|
|
8000db0: 4413 add r3, r2
|
|
8000db2: 4a05 ldr r2, [pc, #20] @ (8000dc8 <_sbrk+0x64>)
|
|
8000db4: 6013 str r3, [r2, #0]
|
|
|
|
return (void *)prev_heap_end;
|
|
8000db6: 68fb ldr r3, [r7, #12]
|
|
}
|
|
8000db8: 4618 mov r0, r3
|
|
8000dba: 3718 adds r7, #24
|
|
8000dbc: 46bd mov sp, r7
|
|
8000dbe: bd80 pop {r7, pc}
|
|
8000dc0: 20010000 .word 0x20010000
|
|
8000dc4: 00000800 .word 0x00000800
|
|
8000dc8: 200000d0 .word 0x200000d0
|
|
8000dcc: 20001098 .word 0x20001098
|
|
|
|
08000dd0 <SystemInit>:
|
|
* @brief Setup the microcontroller system.
|
|
* @param None
|
|
* @retval None
|
|
*/
|
|
void SystemInit(void)
|
|
{
|
|
8000dd0: b480 push {r7}
|
|
8000dd2: af00 add r7, sp, #0
|
|
|
|
/* FPU settings ------------------------------------------------------------*/
|
|
#if (__FPU_PRESENT == 1) && (__FPU_USED == 1)
|
|
SCB->CPACR |= ((3UL << (10UL*2UL))|(3UL << (11UL*2UL))); /* set CP10 and CP11 Full Access */
|
|
#endif
|
|
}
|
|
8000dd4: bf00 nop
|
|
8000dd6: 46bd mov sp, r7
|
|
8000dd8: bc80 pop {r7}
|
|
8000dda: 4770 bx lr
|
|
|
|
08000ddc <LL_RTC_TIME_GetSubSecond>:
|
|
* @param RTCx RTC Instance
|
|
* @retval If binary mode is none, Value between Min_Data=0x0 and Max_Data=0x7FFF
|
|
* else Value between Min_Data=0x0 and Max_Data=0xFFFFFFFF
|
|
*/
|
|
__STATIC_INLINE uint32_t LL_RTC_TIME_GetSubSecond(const RTC_TypeDef *RTCx)
|
|
{
|
|
8000ddc: b480 push {r7}
|
|
8000dde: b083 sub sp, #12
|
|
8000de0: af00 add r7, sp, #0
|
|
8000de2: 6078 str r0, [r7, #4]
|
|
return (uint32_t)(READ_BIT(RTCx->SSR, RTC_SSR_SS));
|
|
8000de4: 687b ldr r3, [r7, #4]
|
|
8000de6: 689b ldr r3, [r3, #8]
|
|
}
|
|
8000de8: 4618 mov r0, r3
|
|
8000dea: 370c adds r7, #12
|
|
8000dec: 46bd mov sp, r7
|
|
8000dee: bc80 pop {r7}
|
|
8000df0: 4770 bx lr
|
|
...
|
|
|
|
08000df4 <TIMER_IF_Init>:
|
|
|
|
/* USER CODE END PFP */
|
|
|
|
/* Exported functions ---------------------------------------------------------*/
|
|
UTIL_TIMER_Status_t TIMER_IF_Init(void)
|
|
{
|
|
8000df4: b580 push {r7, lr}
|
|
8000df6: b082 sub sp, #8
|
|
8000df8: af00 add r7, sp, #0
|
|
UTIL_TIMER_Status_t ret = UTIL_TIMER_OK;
|
|
8000dfa: 2300 movs r3, #0
|
|
8000dfc: 71fb strb r3, [r7, #7]
|
|
/* USER CODE BEGIN TIMER_IF_Init */
|
|
|
|
/* USER CODE END TIMER_IF_Init */
|
|
if (RTC_Initialized == false)
|
|
8000dfe: 4b14 ldr r3, [pc, #80] @ (8000e50 <TIMER_IF_Init+0x5c>)
|
|
8000e00: 781b ldrb r3, [r3, #0]
|
|
8000e02: f083 0301 eor.w r3, r3, #1
|
|
8000e06: b2db uxtb r3, r3
|
|
8000e08: 2b00 cmp r3, #0
|
|
8000e0a: d01b beq.n 8000e44 <TIMER_IF_Init+0x50>
|
|
{
|
|
hrtc.IsEnabled.RtcFeatures = UINT32_MAX;
|
|
8000e0c: 4b11 ldr r3, [pc, #68] @ (8000e54 <TIMER_IF_Init+0x60>)
|
|
8000e0e: f04f 32ff mov.w r2, #4294967295 @ 0xffffffff
|
|
8000e12: 631a str r2, [r3, #48] @ 0x30
|
|
/*Init RTC*/
|
|
MX_RTC_Init();
|
|
8000e14: f7ff fd0a bl 800082c <MX_RTC_Init>
|
|
/*Stop Timer */
|
|
TIMER_IF_StopTimer();
|
|
8000e18: f000 f856 bl 8000ec8 <TIMER_IF_StopTimer>
|
|
/** DeActivate the Alarm A enabled by STM32CubeMX during MX_RTC_Init() */
|
|
HAL_RTC_DeactivateAlarm(&hrtc, RTC_ALARM_A);
|
|
8000e1c: f44f 7180 mov.w r1, #256 @ 0x100
|
|
8000e20: 480c ldr r0, [pc, #48] @ (8000e54 <TIMER_IF_Init+0x60>)
|
|
8000e22: f003 fcf3 bl 800480c <HAL_RTC_DeactivateAlarm>
|
|
/*overload RTC feature enable*/
|
|
hrtc.IsEnabled.RtcFeatures = UINT32_MAX;
|
|
8000e26: 4b0b ldr r3, [pc, #44] @ (8000e54 <TIMER_IF_Init+0x60>)
|
|
8000e28: f04f 32ff mov.w r2, #4294967295 @ 0xffffffff
|
|
8000e2c: 631a str r2, [r3, #48] @ 0x30
|
|
|
|
/*Enable Direct Read of the calendar registers (not through Shadow) */
|
|
HAL_RTCEx_EnableBypassShadow(&hrtc);
|
|
8000e2e: 4809 ldr r0, [pc, #36] @ (8000e54 <TIMER_IF_Init+0x60>)
|
|
8000e30: f003 fe2a bl 8004a88 <HAL_RTCEx_EnableBypassShadow>
|
|
/*Initialize MSB ticks*/
|
|
TIMER_IF_BkUp_Write_MSBticks(0);
|
|
8000e34: 2000 movs r0, #0
|
|
8000e36: f000 f9d3 bl 80011e0 <TIMER_IF_BkUp_Write_MSBticks>
|
|
|
|
TIMER_IF_SetTimerContext();
|
|
8000e3a: f000 f85f bl 8000efc <TIMER_IF_SetTimerContext>
|
|
|
|
/* Register a task to associate to UTIL_TIMER_Irq() interrupt */
|
|
UTIL_TIMER_IRQ_MAP_INIT();
|
|
|
|
RTC_Initialized = true;
|
|
8000e3e: 4b04 ldr r3, [pc, #16] @ (8000e50 <TIMER_IF_Init+0x5c>)
|
|
8000e40: 2201 movs r2, #1
|
|
8000e42: 701a strb r2, [r3, #0]
|
|
}
|
|
|
|
/* USER CODE BEGIN TIMER_IF_Init_Last */
|
|
|
|
/* USER CODE END TIMER_IF_Init_Last */
|
|
return ret;
|
|
8000e44: 79fb ldrb r3, [r7, #7]
|
|
}
|
|
8000e46: 4618 mov r0, r3
|
|
8000e48: 3708 adds r7, #8
|
|
8000e4a: 46bd mov sp, r7
|
|
8000e4c: bd80 pop {r7, pc}
|
|
8000e4e: bf00 nop
|
|
8000e50: 200000d4 .word 0x200000d4
|
|
8000e54: 20000088 .word 0x20000088
|
|
|
|
08000e58 <TIMER_IF_StartTimer>:
|
|
|
|
UTIL_TIMER_Status_t TIMER_IF_StartTimer(uint32_t timeout)
|
|
{
|
|
8000e58: b580 push {r7, lr}
|
|
8000e5a: b08e sub sp, #56 @ 0x38
|
|
8000e5c: af00 add r7, sp, #0
|
|
8000e5e: 6078 str r0, [r7, #4]
|
|
UTIL_TIMER_Status_t ret = UTIL_TIMER_OK;
|
|
8000e60: 2300 movs r3, #0
|
|
8000e62: f887 3037 strb.w r3, [r7, #55] @ 0x37
|
|
/* USER CODE BEGIN TIMER_IF_StartTimer */
|
|
|
|
/* USER CODE END TIMER_IF_StartTimer */
|
|
RTC_AlarmTypeDef sAlarm = {0};
|
|
8000e66: f107 0308 add.w r3, r7, #8
|
|
8000e6a: 222c movs r2, #44 @ 0x2c
|
|
8000e6c: 2100 movs r1, #0
|
|
8000e6e: 4618 mov r0, r3
|
|
8000e70: f00e f86c bl 800ef4c <memset>
|
|
/*Stop timer if one is already started*/
|
|
TIMER_IF_StopTimer();
|
|
8000e74: f000 f828 bl 8000ec8 <TIMER_IF_StopTimer>
|
|
timeout += RtcTimerContext;
|
|
8000e78: 4b11 ldr r3, [pc, #68] @ (8000ec0 <TIMER_IF_StartTimer+0x68>)
|
|
8000e7a: 681b ldr r3, [r3, #0]
|
|
8000e7c: 687a ldr r2, [r7, #4]
|
|
8000e7e: 4413 add r3, r2
|
|
8000e80: 607b str r3, [r7, #4]
|
|
|
|
TIMER_IF_DBG_PRINTF("Start timer: time=%d, alarm=%d\n\r", GetTimerTicks(), timeout);
|
|
/* starts timer*/
|
|
sAlarm.BinaryAutoClr = RTC_ALARMSUBSECONDBIN_AUTOCLR_NO;
|
|
8000e82: 2300 movs r3, #0
|
|
8000e84: 627b str r3, [r7, #36] @ 0x24
|
|
sAlarm.AlarmTime.SubSeconds = UINT32_MAX - timeout;
|
|
8000e86: 687b ldr r3, [r7, #4]
|
|
8000e88: 43db mvns r3, r3
|
|
8000e8a: 60fb str r3, [r7, #12]
|
|
sAlarm.AlarmMask = RTC_ALARMMASK_NONE;
|
|
8000e8c: 2300 movs r3, #0
|
|
8000e8e: 61fb str r3, [r7, #28]
|
|
sAlarm.AlarmSubSecondMask = RTC_ALARMSUBSECONDBINMASK_NONE;
|
|
8000e90: f04f 5300 mov.w r3, #536870912 @ 0x20000000
|
|
8000e94: 623b str r3, [r7, #32]
|
|
sAlarm.Alarm = RTC_ALARM_A;
|
|
8000e96: f44f 7380 mov.w r3, #256 @ 0x100
|
|
8000e9a: 633b str r3, [r7, #48] @ 0x30
|
|
if (HAL_RTC_SetAlarm_IT(&hrtc, &sAlarm, RTC_FORMAT_BCD) != HAL_OK)
|
|
8000e9c: f107 0308 add.w r3, r7, #8
|
|
8000ea0: 2201 movs r2, #1
|
|
8000ea2: 4619 mov r1, r3
|
|
8000ea4: 4807 ldr r0, [pc, #28] @ (8000ec4 <TIMER_IF_StartTimer+0x6c>)
|
|
8000ea6: f003 fba5 bl 80045f4 <HAL_RTC_SetAlarm_IT>
|
|
8000eaa: 4603 mov r3, r0
|
|
8000eac: 2b00 cmp r3, #0
|
|
8000eae: d001 beq.n 8000eb4 <TIMER_IF_StartTimer+0x5c>
|
|
{
|
|
Error_Handler();
|
|
8000eb0: f7ff fc8e bl 80007d0 <Error_Handler>
|
|
}
|
|
/* USER CODE BEGIN TIMER_IF_StartTimer_Last */
|
|
|
|
/* USER CODE END TIMER_IF_StartTimer_Last */
|
|
return ret;
|
|
8000eb4: f897 3037 ldrb.w r3, [r7, #55] @ 0x37
|
|
}
|
|
8000eb8: 4618 mov r0, r3
|
|
8000eba: 3738 adds r7, #56 @ 0x38
|
|
8000ebc: 46bd mov sp, r7
|
|
8000ebe: bd80 pop {r7, pc}
|
|
8000ec0: 200000d8 .word 0x200000d8
|
|
8000ec4: 20000088 .word 0x20000088
|
|
|
|
08000ec8 <TIMER_IF_StopTimer>:
|
|
|
|
UTIL_TIMER_Status_t TIMER_IF_StopTimer(void)
|
|
{
|
|
8000ec8: b580 push {r7, lr}
|
|
8000eca: b082 sub sp, #8
|
|
8000ecc: af00 add r7, sp, #0
|
|
UTIL_TIMER_Status_t ret = UTIL_TIMER_OK;
|
|
8000ece: 2300 movs r3, #0
|
|
8000ed0: 71fb strb r3, [r7, #7]
|
|
/* USER CODE BEGIN TIMER_IF_StopTimer */
|
|
|
|
/* USER CODE END TIMER_IF_StopTimer */
|
|
/* Clear RTC Alarm Flag */
|
|
__HAL_RTC_ALARM_CLEAR_FLAG(&hrtc, RTC_FLAG_ALRAF);
|
|
8000ed2: 4b08 ldr r3, [pc, #32] @ (8000ef4 <TIMER_IF_StopTimer+0x2c>)
|
|
8000ed4: 2201 movs r2, #1
|
|
8000ed6: 65da str r2, [r3, #92] @ 0x5c
|
|
/* Disable the Alarm A interrupt */
|
|
HAL_RTC_DeactivateAlarm(&hrtc, RTC_ALARM_A);
|
|
8000ed8: f44f 7180 mov.w r1, #256 @ 0x100
|
|
8000edc: 4806 ldr r0, [pc, #24] @ (8000ef8 <TIMER_IF_StopTimer+0x30>)
|
|
8000ede: f003 fc95 bl 800480c <HAL_RTC_DeactivateAlarm>
|
|
/*overload RTC feature enable*/
|
|
hrtc.IsEnabled.RtcFeatures = UINT32_MAX;
|
|
8000ee2: 4b05 ldr r3, [pc, #20] @ (8000ef8 <TIMER_IF_StopTimer+0x30>)
|
|
8000ee4: f04f 32ff mov.w r2, #4294967295 @ 0xffffffff
|
|
8000ee8: 631a str r2, [r3, #48] @ 0x30
|
|
/* USER CODE BEGIN TIMER_IF_StopTimer_Last */
|
|
|
|
/* USER CODE END TIMER_IF_StopTimer_Last */
|
|
return ret;
|
|
8000eea: 79fb ldrb r3, [r7, #7]
|
|
}
|
|
8000eec: 4618 mov r0, r3
|
|
8000eee: 3708 adds r7, #8
|
|
8000ef0: 46bd mov sp, r7
|
|
8000ef2: bd80 pop {r7, pc}
|
|
8000ef4: 40002800 .word 0x40002800
|
|
8000ef8: 20000088 .word 0x20000088
|
|
|
|
08000efc <TIMER_IF_SetTimerContext>:
|
|
|
|
uint32_t TIMER_IF_SetTimerContext(void)
|
|
{
|
|
8000efc: b580 push {r7, lr}
|
|
8000efe: af00 add r7, sp, #0
|
|
/*store time context*/
|
|
RtcTimerContext = GetTimerTicks();
|
|
8000f00: f000 f98e bl 8001220 <GetTimerTicks>
|
|
8000f04: 4603 mov r3, r0
|
|
8000f06: 4a03 ldr r2, [pc, #12] @ (8000f14 <TIMER_IF_SetTimerContext+0x18>)
|
|
8000f08: 6013 str r3, [r2, #0]
|
|
|
|
/* USER CODE END TIMER_IF_SetTimerContext */
|
|
|
|
TIMER_IF_DBG_PRINTF("TIMER_IF_SetTimerContext=%d\n\r", RtcTimerContext);
|
|
/*return time context*/
|
|
return RtcTimerContext;
|
|
8000f0a: 4b02 ldr r3, [pc, #8] @ (8000f14 <TIMER_IF_SetTimerContext+0x18>)
|
|
8000f0c: 681b ldr r3, [r3, #0]
|
|
}
|
|
8000f0e: 4618 mov r0, r3
|
|
8000f10: bd80 pop {r7, pc}
|
|
8000f12: bf00 nop
|
|
8000f14: 200000d8 .word 0x200000d8
|
|
|
|
08000f18 <TIMER_IF_GetTimerContext>:
|
|
|
|
uint32_t TIMER_IF_GetTimerContext(void)
|
|
{
|
|
8000f18: b480 push {r7}
|
|
8000f1a: af00 add r7, sp, #0
|
|
|
|
/* USER CODE END TIMER_IF_GetTimerContext */
|
|
|
|
TIMER_IF_DBG_PRINTF("TIMER_IF_GetTimerContext=%d\n\r", RtcTimerContext);
|
|
/*return time context*/
|
|
return RtcTimerContext;
|
|
8000f1c: 4b02 ldr r3, [pc, #8] @ (8000f28 <TIMER_IF_GetTimerContext+0x10>)
|
|
8000f1e: 681b ldr r3, [r3, #0]
|
|
}
|
|
8000f20: 4618 mov r0, r3
|
|
8000f22: 46bd mov sp, r7
|
|
8000f24: bc80 pop {r7}
|
|
8000f26: 4770 bx lr
|
|
8000f28: 200000d8 .word 0x200000d8
|
|
|
|
08000f2c <TIMER_IF_GetTimerElapsedTime>:
|
|
|
|
uint32_t TIMER_IF_GetTimerElapsedTime(void)
|
|
{
|
|
8000f2c: b580 push {r7, lr}
|
|
8000f2e: b082 sub sp, #8
|
|
8000f30: af00 add r7, sp, #0
|
|
uint32_t ret = 0;
|
|
8000f32: 2300 movs r3, #0
|
|
8000f34: 607b str r3, [r7, #4]
|
|
/* USER CODE BEGIN TIMER_IF_GetTimerElapsedTime */
|
|
|
|
/* USER CODE END TIMER_IF_GetTimerElapsedTime */
|
|
ret = ((uint32_t)(GetTimerTicks() - RtcTimerContext));
|
|
8000f36: f000 f973 bl 8001220 <GetTimerTicks>
|
|
8000f3a: 4602 mov r2, r0
|
|
8000f3c: 4b04 ldr r3, [pc, #16] @ (8000f50 <TIMER_IF_GetTimerElapsedTime+0x24>)
|
|
8000f3e: 681b ldr r3, [r3, #0]
|
|
8000f40: 1ad3 subs r3, r2, r3
|
|
8000f42: 607b str r3, [r7, #4]
|
|
/* USER CODE BEGIN TIMER_IF_GetTimerElapsedTime_Last */
|
|
|
|
/* USER CODE END TIMER_IF_GetTimerElapsedTime_Last */
|
|
return ret;
|
|
8000f44: 687b ldr r3, [r7, #4]
|
|
}
|
|
8000f46: 4618 mov r0, r3
|
|
8000f48: 3708 adds r7, #8
|
|
8000f4a: 46bd mov sp, r7
|
|
8000f4c: bd80 pop {r7, pc}
|
|
8000f4e: bf00 nop
|
|
8000f50: 200000d8 .word 0x200000d8
|
|
|
|
08000f54 <TIMER_IF_GetTimerValue>:
|
|
|
|
uint32_t TIMER_IF_GetTimerValue(void)
|
|
{
|
|
8000f54: b580 push {r7, lr}
|
|
8000f56: b082 sub sp, #8
|
|
8000f58: af00 add r7, sp, #0
|
|
uint32_t ret = 0;
|
|
8000f5a: 2300 movs r3, #0
|
|
8000f5c: 607b str r3, [r7, #4]
|
|
/* USER CODE BEGIN TIMER_IF_GetTimerValue */
|
|
|
|
/* USER CODE END TIMER_IF_GetTimerValue */
|
|
if (RTC_Initialized == true)
|
|
8000f5e: 4b06 ldr r3, [pc, #24] @ (8000f78 <TIMER_IF_GetTimerValue+0x24>)
|
|
8000f60: 781b ldrb r3, [r3, #0]
|
|
8000f62: 2b00 cmp r3, #0
|
|
8000f64: d002 beq.n 8000f6c <TIMER_IF_GetTimerValue+0x18>
|
|
{
|
|
ret = GetTimerTicks();
|
|
8000f66: f000 f95b bl 8001220 <GetTimerTicks>
|
|
8000f6a: 6078 str r0, [r7, #4]
|
|
}
|
|
/* USER CODE BEGIN TIMER_IF_GetTimerValue_Last */
|
|
|
|
/* USER CODE END TIMER_IF_GetTimerValue_Last */
|
|
return ret;
|
|
8000f6c: 687b ldr r3, [r7, #4]
|
|
}
|
|
8000f6e: 4618 mov r0, r3
|
|
8000f70: 3708 adds r7, #8
|
|
8000f72: 46bd mov sp, r7
|
|
8000f74: bd80 pop {r7, pc}
|
|
8000f76: bf00 nop
|
|
8000f78: 200000d4 .word 0x200000d4
|
|
|
|
08000f7c <TIMER_IF_GetMinimumTimeout>:
|
|
|
|
uint32_t TIMER_IF_GetMinimumTimeout(void)
|
|
{
|
|
8000f7c: b480 push {r7}
|
|
8000f7e: b083 sub sp, #12
|
|
8000f80: af00 add r7, sp, #0
|
|
uint32_t ret = 0;
|
|
8000f82: 2300 movs r3, #0
|
|
8000f84: 607b str r3, [r7, #4]
|
|
/* USER CODE BEGIN TIMER_IF_GetMinimumTimeout */
|
|
|
|
/* USER CODE END TIMER_IF_GetMinimumTimeout */
|
|
ret = (MIN_ALARM_DELAY);
|
|
8000f86: 2303 movs r3, #3
|
|
8000f88: 607b str r3, [r7, #4]
|
|
/* USER CODE BEGIN TIMER_IF_GetMinimumTimeout_Last */
|
|
|
|
/* USER CODE END TIMER_IF_GetMinimumTimeout_Last */
|
|
return ret;
|
|
8000f8a: 687b ldr r3, [r7, #4]
|
|
}
|
|
8000f8c: 4618 mov r0, r3
|
|
8000f8e: 370c adds r7, #12
|
|
8000f90: 46bd mov sp, r7
|
|
8000f92: bc80 pop {r7}
|
|
8000f94: 4770 bx lr
|
|
|
|
08000f96 <TIMER_IF_Convert_ms2Tick>:
|
|
|
|
uint32_t TIMER_IF_Convert_ms2Tick(uint32_t timeMilliSec)
|
|
{
|
|
8000f96: b5b0 push {r4, r5, r7, lr}
|
|
8000f98: b084 sub sp, #16
|
|
8000f9a: af00 add r7, sp, #0
|
|
8000f9c: 6078 str r0, [r7, #4]
|
|
uint32_t ret = 0;
|
|
8000f9e: 2100 movs r1, #0
|
|
8000fa0: 60f9 str r1, [r7, #12]
|
|
/* USER CODE BEGIN TIMER_IF_Convert_ms2Tick */
|
|
|
|
/* USER CODE END TIMER_IF_Convert_ms2Tick */
|
|
ret = ((uint32_t)((((uint64_t) timeMilliSec) << RTC_N_PREDIV_S) / 1000));
|
|
8000fa2: 6879 ldr r1, [r7, #4]
|
|
8000fa4: 2000 movs r0, #0
|
|
8000fa6: 460a mov r2, r1
|
|
8000fa8: 4603 mov r3, r0
|
|
8000faa: 0d95 lsrs r5, r2, #22
|
|
8000fac: 0294 lsls r4, r2, #10
|
|
8000fae: f44f 727a mov.w r2, #1000 @ 0x3e8
|
|
8000fb2: f04f 0300 mov.w r3, #0
|
|
8000fb6: 4620 mov r0, r4
|
|
8000fb8: 4629 mov r1, r5
|
|
8000fba: f7ff f949 bl 8000250 <__aeabi_uldivmod>
|
|
8000fbe: 4602 mov r2, r0
|
|
8000fc0: 460b mov r3, r1
|
|
8000fc2: 4613 mov r3, r2
|
|
8000fc4: 60fb str r3, [r7, #12]
|
|
/* USER CODE BEGIN TIMER_IF_Convert_ms2Tick_Last */
|
|
|
|
/* USER CODE END TIMER_IF_Convert_ms2Tick_Last */
|
|
return ret;
|
|
8000fc6: 68fb ldr r3, [r7, #12]
|
|
}
|
|
8000fc8: 4618 mov r0, r3
|
|
8000fca: 3710 adds r7, #16
|
|
8000fcc: 46bd mov sp, r7
|
|
8000fce: bdb0 pop {r4, r5, r7, pc}
|
|
|
|
08000fd0 <TIMER_IF_Convert_Tick2ms>:
|
|
|
|
uint32_t TIMER_IF_Convert_Tick2ms(uint32_t tick)
|
|
{
|
|
8000fd0: e92d 0fb0 stmdb sp!, {r4, r5, r7, r8, r9, sl, fp}
|
|
8000fd4: b085 sub sp, #20
|
|
8000fd6: af00 add r7, sp, #0
|
|
8000fd8: 6078 str r0, [r7, #4]
|
|
uint32_t ret = 0;
|
|
8000fda: 2100 movs r1, #0
|
|
8000fdc: 60f9 str r1, [r7, #12]
|
|
/* USER CODE BEGIN TIMER_IF_Convert_Tick2ms */
|
|
|
|
/* USER CODE END TIMER_IF_Convert_Tick2ms */
|
|
ret = ((uint32_t)((((uint64_t)(tick)) * 1000) >> RTC_N_PREDIV_S));
|
|
8000fde: 6879 ldr r1, [r7, #4]
|
|
8000fe0: 2000 movs r0, #0
|
|
8000fe2: 460c mov r4, r1
|
|
8000fe4: 4605 mov r5, r0
|
|
8000fe6: 4620 mov r0, r4
|
|
8000fe8: 4629 mov r1, r5
|
|
8000fea: f04f 0a00 mov.w sl, #0
|
|
8000fee: f04f 0b00 mov.w fp, #0
|
|
8000ff2: ea4f 1b41 mov.w fp, r1, lsl #5
|
|
8000ff6: ea4b 6bd0 orr.w fp, fp, r0, lsr #27
|
|
8000ffa: ea4f 1a40 mov.w sl, r0, lsl #5
|
|
8000ffe: 4650 mov r0, sl
|
|
8001000: 4659 mov r1, fp
|
|
8001002: 1b02 subs r2, r0, r4
|
|
8001004: eb61 0305 sbc.w r3, r1, r5
|
|
8001008: f04f 0000 mov.w r0, #0
|
|
800100c: f04f 0100 mov.w r1, #0
|
|
8001010: 0099 lsls r1, r3, #2
|
|
8001012: ea41 7192 orr.w r1, r1, r2, lsr #30
|
|
8001016: 0090 lsls r0, r2, #2
|
|
8001018: 4602 mov r2, r0
|
|
800101a: 460b mov r3, r1
|
|
800101c: eb12 0804 adds.w r8, r2, r4
|
|
8001020: eb43 0905 adc.w r9, r3, r5
|
|
8001024: f04f 0200 mov.w r2, #0
|
|
8001028: f04f 0300 mov.w r3, #0
|
|
800102c: ea4f 03c9 mov.w r3, r9, lsl #3
|
|
8001030: ea43 7358 orr.w r3, r3, r8, lsr #29
|
|
8001034: ea4f 02c8 mov.w r2, r8, lsl #3
|
|
8001038: 4690 mov r8, r2
|
|
800103a: 4699 mov r9, r3
|
|
800103c: 4640 mov r0, r8
|
|
800103e: 4649 mov r1, r9
|
|
8001040: f04f 0200 mov.w r2, #0
|
|
8001044: f04f 0300 mov.w r3, #0
|
|
8001048: 0a82 lsrs r2, r0, #10
|
|
800104a: ea42 5281 orr.w r2, r2, r1, lsl #22
|
|
800104e: 0a8b lsrs r3, r1, #10
|
|
8001050: 4613 mov r3, r2
|
|
8001052: 60fb str r3, [r7, #12]
|
|
/* USER CODE BEGIN TIMER_IF_Convert_Tick2ms_Last */
|
|
|
|
/* USER CODE END TIMER_IF_Convert_Tick2ms_Last */
|
|
return ret;
|
|
8001054: 68fb ldr r3, [r7, #12]
|
|
}
|
|
8001056: 4618 mov r0, r3
|
|
8001058: 3714 adds r7, #20
|
|
800105a: 46bd mov sp, r7
|
|
800105c: e8bd 0fb0 ldmia.w sp!, {r4, r5, r7, r8, r9, sl, fp}
|
|
8001060: 4770 bx lr
|
|
|
|
08001062 <TIMER_IF_DelayMs>:
|
|
|
|
void TIMER_IF_DelayMs(uint32_t delay)
|
|
{
|
|
8001062: b580 push {r7, lr}
|
|
8001064: b084 sub sp, #16
|
|
8001066: af00 add r7, sp, #0
|
|
8001068: 6078 str r0, [r7, #4]
|
|
/* USER CODE BEGIN TIMER_IF_DelayMs */
|
|
|
|
/* USER CODE END TIMER_IF_DelayMs */
|
|
uint32_t delayTicks = TIMER_IF_Convert_ms2Tick(delay);
|
|
800106a: 6878 ldr r0, [r7, #4]
|
|
800106c: f7ff ff93 bl 8000f96 <TIMER_IF_Convert_ms2Tick>
|
|
8001070: 60f8 str r0, [r7, #12]
|
|
uint32_t timeout = GetTimerTicks();
|
|
8001072: f000 f8d5 bl 8001220 <GetTimerTicks>
|
|
8001076: 60b8 str r0, [r7, #8]
|
|
|
|
/* Wait delay ms */
|
|
while (((GetTimerTicks() - timeout)) < delayTicks)
|
|
8001078: e000 b.n 800107c <TIMER_IF_DelayMs+0x1a>
|
|
{
|
|
__NOP();
|
|
800107a: bf00 nop
|
|
while (((GetTimerTicks() - timeout)) < delayTicks)
|
|
800107c: f000 f8d0 bl 8001220 <GetTimerTicks>
|
|
8001080: 4602 mov r2, r0
|
|
8001082: 68bb ldr r3, [r7, #8]
|
|
8001084: 1ad3 subs r3, r2, r3
|
|
8001086: 68fa ldr r2, [r7, #12]
|
|
8001088: 429a cmp r2, r3
|
|
800108a: d8f6 bhi.n 800107a <TIMER_IF_DelayMs+0x18>
|
|
}
|
|
/* USER CODE BEGIN TIMER_IF_DelayMs_Last */
|
|
|
|
/* USER CODE END TIMER_IF_DelayMs_Last */
|
|
}
|
|
800108c: bf00 nop
|
|
800108e: bf00 nop
|
|
8001090: 3710 adds r7, #16
|
|
8001092: 46bd mov sp, r7
|
|
8001094: bd80 pop {r7, pc}
|
|
|
|
08001096 <HAL_RTC_AlarmAEventCallback>:
|
|
|
|
void HAL_RTC_AlarmAEventCallback(RTC_HandleTypeDef *hrtc)
|
|
{
|
|
8001096: b580 push {r7, lr}
|
|
8001098: b082 sub sp, #8
|
|
800109a: af00 add r7, sp, #0
|
|
800109c: 6078 str r0, [r7, #4]
|
|
/* USER CODE BEGIN HAL_RTC_AlarmAEventCallback */
|
|
|
|
/* USER CODE END HAL_RTC_AlarmAEventCallback */
|
|
UTIL_TIMER_IRQ_MAP_PROCESS();
|
|
800109e: f00d fa47 bl 800e530 <UTIL_TIMER_IRQ_Handler>
|
|
/* USER CODE BEGIN HAL_RTC_AlarmAEventCallback_Last */
|
|
|
|
/* USER CODE END HAL_RTC_AlarmAEventCallback_Last */
|
|
}
|
|
80010a2: bf00 nop
|
|
80010a4: 3708 adds r7, #8
|
|
80010a6: 46bd mov sp, r7
|
|
80010a8: bd80 pop {r7, pc}
|
|
|
|
080010aa <HAL_RTCEx_SSRUEventCallback>:
|
|
|
|
void HAL_RTCEx_SSRUEventCallback(RTC_HandleTypeDef *hrtc)
|
|
{
|
|
80010aa: b580 push {r7, lr}
|
|
80010ac: b084 sub sp, #16
|
|
80010ae: af00 add r7, sp, #0
|
|
80010b0: 6078 str r0, [r7, #4]
|
|
|
|
/* USER CODE END HAL_RTCEx_SSRUEventCallback */
|
|
/*called every 48 days with 1024 ticks per seconds*/
|
|
TIMER_IF_DBG_PRINTF(">>Handler SSRUnderflow at %d\n\r", GetTimerTicks());
|
|
/*Increment MSBticks*/
|
|
uint32_t MSB_ticks = TIMER_IF_BkUp_Read_MSBticks();
|
|
80010b2: f000 f8a5 bl 8001200 <TIMER_IF_BkUp_Read_MSBticks>
|
|
80010b6: 60f8 str r0, [r7, #12]
|
|
TIMER_IF_BkUp_Write_MSBticks(MSB_ticks + 1);
|
|
80010b8: 68fb ldr r3, [r7, #12]
|
|
80010ba: 3301 adds r3, #1
|
|
80010bc: 4618 mov r0, r3
|
|
80010be: f000 f88f bl 80011e0 <TIMER_IF_BkUp_Write_MSBticks>
|
|
/* USER CODE BEGIN HAL_RTCEx_SSRUEventCallback_Last */
|
|
|
|
/* USER CODE END HAL_RTCEx_SSRUEventCallback_Last */
|
|
}
|
|
80010c2: bf00 nop
|
|
80010c4: 3710 adds r7, #16
|
|
80010c6: 46bd mov sp, r7
|
|
80010c8: bd80 pop {r7, pc}
|
|
|
|
080010ca <TIMER_IF_GetTime>:
|
|
|
|
uint32_t TIMER_IF_GetTime(uint16_t *mSeconds)
|
|
{
|
|
80010ca: e92d 4fb0 stmdb sp!, {r4, r5, r7, r8, r9, sl, fp, lr}
|
|
80010ce: b08c sub sp, #48 @ 0x30
|
|
80010d0: af00 add r7, sp, #0
|
|
80010d2: 6178 str r0, [r7, #20]
|
|
uint32_t seconds = 0;
|
|
80010d4: 2300 movs r3, #0
|
|
80010d6: 62fb str r3, [r7, #44] @ 0x2c
|
|
/* USER CODE BEGIN TIMER_IF_GetTime */
|
|
|
|
/* USER CODE END TIMER_IF_GetTime */
|
|
uint64_t ticks;
|
|
uint32_t timerValueLsb = GetTimerTicks();
|
|
80010d8: f000 f8a2 bl 8001220 <GetTimerTicks>
|
|
80010dc: 62b8 str r0, [r7, #40] @ 0x28
|
|
uint32_t timerValueMSB = TIMER_IF_BkUp_Read_MSBticks();
|
|
80010de: f000 f88f bl 8001200 <TIMER_IF_BkUp_Read_MSBticks>
|
|
80010e2: 6278 str r0, [r7, #36] @ 0x24
|
|
|
|
ticks = (((uint64_t) timerValueMSB) << 32) + timerValueLsb;
|
|
80010e4: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
80010e6: 2200 movs r2, #0
|
|
80010e8: 60bb str r3, [r7, #8]
|
|
80010ea: 60fa str r2, [r7, #12]
|
|
80010ec: f04f 0200 mov.w r2, #0
|
|
80010f0: f04f 0300 mov.w r3, #0
|
|
80010f4: 68b9 ldr r1, [r7, #8]
|
|
80010f6: 000b movs r3, r1
|
|
80010f8: 2200 movs r2, #0
|
|
80010fa: 6ab9 ldr r1, [r7, #40] @ 0x28
|
|
80010fc: 2000 movs r0, #0
|
|
80010fe: 460c mov r4, r1
|
|
8001100: 4605 mov r5, r0
|
|
8001102: eb12 0804 adds.w r8, r2, r4
|
|
8001106: eb43 0905 adc.w r9, r3, r5
|
|
800110a: e9c7 8906 strd r8, r9, [r7, #24]
|
|
|
|
seconds = (uint32_t)(ticks >> RTC_N_PREDIV_S);
|
|
800110e: e9d7 0106 ldrd r0, r1, [r7, #24]
|
|
8001112: f04f 0200 mov.w r2, #0
|
|
8001116: f04f 0300 mov.w r3, #0
|
|
800111a: 0a82 lsrs r2, r0, #10
|
|
800111c: ea42 5281 orr.w r2, r2, r1, lsl #22
|
|
8001120: 0a8b lsrs r3, r1, #10
|
|
8001122: 4613 mov r3, r2
|
|
8001124: 62fb str r3, [r7, #44] @ 0x2c
|
|
|
|
ticks = (uint32_t) ticks & RTC_PREDIV_S;
|
|
8001126: 69bb ldr r3, [r7, #24]
|
|
8001128: 2200 movs r2, #0
|
|
800112a: 603b str r3, [r7, #0]
|
|
800112c: 607a str r2, [r7, #4]
|
|
800112e: 683b ldr r3, [r7, #0]
|
|
8001130: f3c3 0a09 ubfx sl, r3, #0, #10
|
|
8001134: f04f 0b00 mov.w fp, #0
|
|
8001138: e9c7 ab06 strd sl, fp, [r7, #24]
|
|
|
|
*mSeconds = TIMER_IF_Convert_Tick2ms(ticks);
|
|
800113c: 69bb ldr r3, [r7, #24]
|
|
800113e: 4618 mov r0, r3
|
|
8001140: f7ff ff46 bl 8000fd0 <TIMER_IF_Convert_Tick2ms>
|
|
8001144: 4603 mov r3, r0
|
|
8001146: b29a uxth r2, r3
|
|
8001148: 697b ldr r3, [r7, #20]
|
|
800114a: 801a strh r2, [r3, #0]
|
|
|
|
/* USER CODE BEGIN TIMER_IF_GetTime_Last */
|
|
|
|
/* USER CODE END TIMER_IF_GetTime_Last */
|
|
return seconds;
|
|
800114c: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
}
|
|
800114e: 4618 mov r0, r3
|
|
8001150: 3730 adds r7, #48 @ 0x30
|
|
8001152: 46bd mov sp, r7
|
|
8001154: e8bd 8fb0 ldmia.w sp!, {r4, r5, r7, r8, r9, sl, fp, pc}
|
|
|
|
08001158 <TIMER_IF_BkUp_Write_Seconds>:
|
|
|
|
void TIMER_IF_BkUp_Write_Seconds(uint32_t Seconds)
|
|
{
|
|
8001158: b580 push {r7, lr}
|
|
800115a: b082 sub sp, #8
|
|
800115c: af00 add r7, sp, #0
|
|
800115e: 6078 str r0, [r7, #4]
|
|
/* USER CODE BEGIN TIMER_IF_BkUp_Write_Seconds */
|
|
|
|
/* USER CODE END TIMER_IF_BkUp_Write_Seconds */
|
|
HAL_RTCEx_BKUPWrite(&hrtc, RTC_BKP_SECONDS, Seconds);
|
|
8001160: 687a ldr r2, [r7, #4]
|
|
8001162: 2100 movs r1, #0
|
|
8001164: 4803 ldr r0, [pc, #12] @ (8001174 <TIMER_IF_BkUp_Write_Seconds+0x1c>)
|
|
8001166: f003 fd21 bl 8004bac <HAL_RTCEx_BKUPWrite>
|
|
/* USER CODE BEGIN TIMER_IF_BkUp_Write_Seconds_Last */
|
|
|
|
/* USER CODE END TIMER_IF_BkUp_Write_Seconds_Last */
|
|
}
|
|
800116a: bf00 nop
|
|
800116c: 3708 adds r7, #8
|
|
800116e: 46bd mov sp, r7
|
|
8001170: bd80 pop {r7, pc}
|
|
8001172: bf00 nop
|
|
8001174: 20000088 .word 0x20000088
|
|
|
|
08001178 <TIMER_IF_BkUp_Write_SubSeconds>:
|
|
|
|
void TIMER_IF_BkUp_Write_SubSeconds(uint32_t SubSeconds)
|
|
{
|
|
8001178: b580 push {r7, lr}
|
|
800117a: b082 sub sp, #8
|
|
800117c: af00 add r7, sp, #0
|
|
800117e: 6078 str r0, [r7, #4]
|
|
/* USER CODE BEGIN TIMER_IF_BkUp_Write_SubSeconds */
|
|
|
|
/* USER CODE END TIMER_IF_BkUp_Write_SubSeconds */
|
|
HAL_RTCEx_BKUPWrite(&hrtc, RTC_BKP_SUBSECONDS, SubSeconds);
|
|
8001180: 687a ldr r2, [r7, #4]
|
|
8001182: 2101 movs r1, #1
|
|
8001184: 4803 ldr r0, [pc, #12] @ (8001194 <TIMER_IF_BkUp_Write_SubSeconds+0x1c>)
|
|
8001186: f003 fd11 bl 8004bac <HAL_RTCEx_BKUPWrite>
|
|
/* USER CODE BEGIN TIMER_IF_BkUp_Write_SubSeconds_Last */
|
|
|
|
/* USER CODE END TIMER_IF_BkUp_Write_SubSeconds_Last */
|
|
}
|
|
800118a: bf00 nop
|
|
800118c: 3708 adds r7, #8
|
|
800118e: 46bd mov sp, r7
|
|
8001190: bd80 pop {r7, pc}
|
|
8001192: bf00 nop
|
|
8001194: 20000088 .word 0x20000088
|
|
|
|
08001198 <TIMER_IF_BkUp_Read_Seconds>:
|
|
|
|
uint32_t TIMER_IF_BkUp_Read_Seconds(void)
|
|
{
|
|
8001198: b580 push {r7, lr}
|
|
800119a: b082 sub sp, #8
|
|
800119c: af00 add r7, sp, #0
|
|
uint32_t ret = 0;
|
|
800119e: 2300 movs r3, #0
|
|
80011a0: 607b str r3, [r7, #4]
|
|
/* USER CODE BEGIN TIMER_IF_BkUp_Read_Seconds */
|
|
|
|
/* USER CODE END TIMER_IF_BkUp_Read_Seconds */
|
|
ret = HAL_RTCEx_BKUPRead(&hrtc, RTC_BKP_SECONDS);
|
|
80011a2: 2100 movs r1, #0
|
|
80011a4: 4804 ldr r0, [pc, #16] @ (80011b8 <TIMER_IF_BkUp_Read_Seconds+0x20>)
|
|
80011a6: f003 fd19 bl 8004bdc <HAL_RTCEx_BKUPRead>
|
|
80011aa: 6078 str r0, [r7, #4]
|
|
/* USER CODE BEGIN TIMER_IF_BkUp_Read_Seconds_Last */
|
|
|
|
/* USER CODE END TIMER_IF_BkUp_Read_Seconds_Last */
|
|
return ret;
|
|
80011ac: 687b ldr r3, [r7, #4]
|
|
}
|
|
80011ae: 4618 mov r0, r3
|
|
80011b0: 3708 adds r7, #8
|
|
80011b2: 46bd mov sp, r7
|
|
80011b4: bd80 pop {r7, pc}
|
|
80011b6: bf00 nop
|
|
80011b8: 20000088 .word 0x20000088
|
|
|
|
080011bc <TIMER_IF_BkUp_Read_SubSeconds>:
|
|
|
|
uint32_t TIMER_IF_BkUp_Read_SubSeconds(void)
|
|
{
|
|
80011bc: b580 push {r7, lr}
|
|
80011be: b082 sub sp, #8
|
|
80011c0: af00 add r7, sp, #0
|
|
uint32_t ret = 0;
|
|
80011c2: 2300 movs r3, #0
|
|
80011c4: 607b str r3, [r7, #4]
|
|
/* USER CODE BEGIN TIMER_IF_BkUp_Read_SubSeconds */
|
|
|
|
/* USER CODE END TIMER_IF_BkUp_Read_SubSeconds */
|
|
ret = HAL_RTCEx_BKUPRead(&hrtc, RTC_BKP_SUBSECONDS);
|
|
80011c6: 2101 movs r1, #1
|
|
80011c8: 4804 ldr r0, [pc, #16] @ (80011dc <TIMER_IF_BkUp_Read_SubSeconds+0x20>)
|
|
80011ca: f003 fd07 bl 8004bdc <HAL_RTCEx_BKUPRead>
|
|
80011ce: 6078 str r0, [r7, #4]
|
|
/* USER CODE BEGIN TIMER_IF_BkUp_Read_SubSeconds_Last */
|
|
|
|
/* USER CODE END TIMER_IF_BkUp_Read_SubSeconds_Last */
|
|
return ret;
|
|
80011d0: 687b ldr r3, [r7, #4]
|
|
}
|
|
80011d2: 4618 mov r0, r3
|
|
80011d4: 3708 adds r7, #8
|
|
80011d6: 46bd mov sp, r7
|
|
80011d8: bd80 pop {r7, pc}
|
|
80011da: bf00 nop
|
|
80011dc: 20000088 .word 0x20000088
|
|
|
|
080011e0 <TIMER_IF_BkUp_Write_MSBticks>:
|
|
|
|
/* USER CODE END EF */
|
|
|
|
/* Private functions ---------------------------------------------------------*/
|
|
static void TIMER_IF_BkUp_Write_MSBticks(uint32_t MSBticks)
|
|
{
|
|
80011e0: b580 push {r7, lr}
|
|
80011e2: b082 sub sp, #8
|
|
80011e4: af00 add r7, sp, #0
|
|
80011e6: 6078 str r0, [r7, #4]
|
|
/* USER CODE BEGIN TIMER_IF_BkUp_Write_MSBticks */
|
|
|
|
/* USER CODE END TIMER_IF_BkUp_Write_MSBticks */
|
|
HAL_RTCEx_BKUPWrite(&hrtc, RTC_BKP_MSBTICKS, MSBticks);
|
|
80011e8: 687a ldr r2, [r7, #4]
|
|
80011ea: 2102 movs r1, #2
|
|
80011ec: 4803 ldr r0, [pc, #12] @ (80011fc <TIMER_IF_BkUp_Write_MSBticks+0x1c>)
|
|
80011ee: f003 fcdd bl 8004bac <HAL_RTCEx_BKUPWrite>
|
|
/* USER CODE BEGIN TIMER_IF_BkUp_Write_MSBticks_Last */
|
|
|
|
/* USER CODE END TIMER_IF_BkUp_Write_MSBticks_Last */
|
|
}
|
|
80011f2: bf00 nop
|
|
80011f4: 3708 adds r7, #8
|
|
80011f6: 46bd mov sp, r7
|
|
80011f8: bd80 pop {r7, pc}
|
|
80011fa: bf00 nop
|
|
80011fc: 20000088 .word 0x20000088
|
|
|
|
08001200 <TIMER_IF_BkUp_Read_MSBticks>:
|
|
|
|
static uint32_t TIMER_IF_BkUp_Read_MSBticks(void)
|
|
{
|
|
8001200: b580 push {r7, lr}
|
|
8001202: b082 sub sp, #8
|
|
8001204: af00 add r7, sp, #0
|
|
/* USER CODE BEGIN TIMER_IF_BkUp_Read_MSBticks */
|
|
|
|
/* USER CODE END TIMER_IF_BkUp_Read_MSBticks */
|
|
uint32_t MSBticks;
|
|
MSBticks = HAL_RTCEx_BKUPRead(&hrtc, RTC_BKP_MSBTICKS);
|
|
8001206: 2102 movs r1, #2
|
|
8001208: 4804 ldr r0, [pc, #16] @ (800121c <TIMER_IF_BkUp_Read_MSBticks+0x1c>)
|
|
800120a: f003 fce7 bl 8004bdc <HAL_RTCEx_BKUPRead>
|
|
800120e: 6078 str r0, [r7, #4]
|
|
return MSBticks;
|
|
8001210: 687b ldr r3, [r7, #4]
|
|
/* USER CODE BEGIN TIMER_IF_BkUp_Read_MSBticks_Last */
|
|
|
|
/* USER CODE END TIMER_IF_BkUp_Read_MSBticks_Last */
|
|
}
|
|
8001212: 4618 mov r0, r3
|
|
8001214: 3708 adds r7, #8
|
|
8001216: 46bd mov sp, r7
|
|
8001218: bd80 pop {r7, pc}
|
|
800121a: bf00 nop
|
|
800121c: 20000088 .word 0x20000088
|
|
|
|
08001220 <GetTimerTicks>:
|
|
|
|
static inline uint32_t GetTimerTicks(void)
|
|
{
|
|
8001220: b580 push {r7, lr}
|
|
8001222: b082 sub sp, #8
|
|
8001224: af00 add r7, sp, #0
|
|
/* USER CODE BEGIN GetTimerTicks */
|
|
|
|
/* USER CODE END GetTimerTicks */
|
|
uint32_t ssr = LL_RTC_TIME_GetSubSecond(RTC);
|
|
8001226: 480b ldr r0, [pc, #44] @ (8001254 <GetTimerTicks+0x34>)
|
|
8001228: f7ff fdd8 bl 8000ddc <LL_RTC_TIME_GetSubSecond>
|
|
800122c: 6078 str r0, [r7, #4]
|
|
/* read twice to make sure value it valid*/
|
|
while (ssr != LL_RTC_TIME_GetSubSecond(RTC))
|
|
800122e: e003 b.n 8001238 <GetTimerTicks+0x18>
|
|
{
|
|
ssr = LL_RTC_TIME_GetSubSecond(RTC);
|
|
8001230: 4808 ldr r0, [pc, #32] @ (8001254 <GetTimerTicks+0x34>)
|
|
8001232: f7ff fdd3 bl 8000ddc <LL_RTC_TIME_GetSubSecond>
|
|
8001236: 6078 str r0, [r7, #4]
|
|
while (ssr != LL_RTC_TIME_GetSubSecond(RTC))
|
|
8001238: 4806 ldr r0, [pc, #24] @ (8001254 <GetTimerTicks+0x34>)
|
|
800123a: f7ff fdcf bl 8000ddc <LL_RTC_TIME_GetSubSecond>
|
|
800123e: 4602 mov r2, r0
|
|
8001240: 687b ldr r3, [r7, #4]
|
|
8001242: 4293 cmp r3, r2
|
|
8001244: d1f4 bne.n 8001230 <GetTimerTicks+0x10>
|
|
}
|
|
return UINT32_MAX - ssr;
|
|
8001246: 687b ldr r3, [r7, #4]
|
|
8001248: 43db mvns r3, r3
|
|
/* USER CODE BEGIN GetTimerTicks_Last */
|
|
|
|
/* USER CODE END GetTimerTicks_Last */
|
|
}
|
|
800124a: 4618 mov r0, r3
|
|
800124c: 3708 adds r7, #8
|
|
800124e: 46bd mov sp, r7
|
|
8001250: bd80 pop {r7, pc}
|
|
8001252: bf00 nop
|
|
8001254: 40002800 .word 0x40002800
|
|
|
|
08001258 <LL_AHB2_GRP1_EnableClock>:
|
|
{
|
|
8001258: b480 push {r7}
|
|
800125a: b085 sub sp, #20
|
|
800125c: af00 add r7, sp, #0
|
|
800125e: 6078 str r0, [r7, #4]
|
|
SET_BIT(RCC->AHB2ENR, Periphs);
|
|
8001260: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8001264: 6cda ldr r2, [r3, #76] @ 0x4c
|
|
8001266: f04f 41b0 mov.w r1, #1476395008 @ 0x58000000
|
|
800126a: 687b ldr r3, [r7, #4]
|
|
800126c: 4313 orrs r3, r2
|
|
800126e: 64cb str r3, [r1, #76] @ 0x4c
|
|
tmpreg = READ_BIT(RCC->AHB2ENR, Periphs);
|
|
8001270: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8001274: 6cda ldr r2, [r3, #76] @ 0x4c
|
|
8001276: 687b ldr r3, [r7, #4]
|
|
8001278: 4013 ands r3, r2
|
|
800127a: 60fb str r3, [r7, #12]
|
|
(void)tmpreg;
|
|
800127c: 68fb ldr r3, [r7, #12]
|
|
}
|
|
800127e: bf00 nop
|
|
8001280: 3714 adds r7, #20
|
|
8001282: 46bd mov sp, r7
|
|
8001284: bc80 pop {r7}
|
|
8001286: 4770 bx lr
|
|
|
|
08001288 <LL_APB1_GRP1_EnableClock>:
|
|
{
|
|
8001288: b480 push {r7}
|
|
800128a: b085 sub sp, #20
|
|
800128c: af00 add r7, sp, #0
|
|
800128e: 6078 str r0, [r7, #4]
|
|
SET_BIT(RCC->APB1ENR1, Periphs);
|
|
8001290: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8001294: 6d9a ldr r2, [r3, #88] @ 0x58
|
|
8001296: f04f 41b0 mov.w r1, #1476395008 @ 0x58000000
|
|
800129a: 687b ldr r3, [r7, #4]
|
|
800129c: 4313 orrs r3, r2
|
|
800129e: 658b str r3, [r1, #88] @ 0x58
|
|
tmpreg = READ_BIT(RCC->APB1ENR1, Periphs);
|
|
80012a0: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
80012a4: 6d9a ldr r2, [r3, #88] @ 0x58
|
|
80012a6: 687b ldr r3, [r7, #4]
|
|
80012a8: 4013 ands r3, r2
|
|
80012aa: 60fb str r3, [r7, #12]
|
|
(void)tmpreg;
|
|
80012ac: 68fb ldr r3, [r7, #12]
|
|
}
|
|
80012ae: bf00 nop
|
|
80012b0: 3714 adds r7, #20
|
|
80012b2: 46bd mov sp, r7
|
|
80012b4: bc80 pop {r7}
|
|
80012b6: 4770 bx lr
|
|
|
|
080012b8 <LL_APB1_GRP1_DisableClock>:
|
|
{
|
|
80012b8: b480 push {r7}
|
|
80012ba: b083 sub sp, #12
|
|
80012bc: af00 add r7, sp, #0
|
|
80012be: 6078 str r0, [r7, #4]
|
|
CLEAR_BIT(RCC->APB1ENR1, Periphs);
|
|
80012c0: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
80012c4: 6d9a ldr r2, [r3, #88] @ 0x58
|
|
80012c6: 687b ldr r3, [r7, #4]
|
|
80012c8: 43db mvns r3, r3
|
|
80012ca: f04f 41b0 mov.w r1, #1476395008 @ 0x58000000
|
|
80012ce: 4013 ands r3, r2
|
|
80012d0: 658b str r3, [r1, #88] @ 0x58
|
|
}
|
|
80012d2: bf00 nop
|
|
80012d4: 370c adds r7, #12
|
|
80012d6: 46bd mov sp, r7
|
|
80012d8: bc80 pop {r7}
|
|
80012da: 4770 bx lr
|
|
|
|
080012dc <MX_USART2_UART_Init>:
|
|
DMA_HandleTypeDef hdma_usart2_tx;
|
|
|
|
/* USART2 init function */
|
|
|
|
void MX_USART2_UART_Init(void)
|
|
{
|
|
80012dc: b580 push {r7, lr}
|
|
80012de: af00 add r7, sp, #0
|
|
/* USER CODE END USART2_Init 0 */
|
|
|
|
/* USER CODE BEGIN USART2_Init 1 */
|
|
|
|
/* USER CODE END USART2_Init 1 */
|
|
huart2.Instance = USART2;
|
|
80012e0: 4b22 ldr r3, [pc, #136] @ (800136c <MX_USART2_UART_Init+0x90>)
|
|
80012e2: 4a23 ldr r2, [pc, #140] @ (8001370 <MX_USART2_UART_Init+0x94>)
|
|
80012e4: 601a str r2, [r3, #0]
|
|
huart2.Init.BaudRate = 115200;
|
|
80012e6: 4b21 ldr r3, [pc, #132] @ (800136c <MX_USART2_UART_Init+0x90>)
|
|
80012e8: f44f 32e1 mov.w r2, #115200 @ 0x1c200
|
|
80012ec: 605a str r2, [r3, #4]
|
|
huart2.Init.WordLength = UART_WORDLENGTH_8B;
|
|
80012ee: 4b1f ldr r3, [pc, #124] @ (800136c <MX_USART2_UART_Init+0x90>)
|
|
80012f0: 2200 movs r2, #0
|
|
80012f2: 609a str r2, [r3, #8]
|
|
huart2.Init.StopBits = UART_STOPBITS_1;
|
|
80012f4: 4b1d ldr r3, [pc, #116] @ (800136c <MX_USART2_UART_Init+0x90>)
|
|
80012f6: 2200 movs r2, #0
|
|
80012f8: 60da str r2, [r3, #12]
|
|
huart2.Init.Parity = UART_PARITY_NONE;
|
|
80012fa: 4b1c ldr r3, [pc, #112] @ (800136c <MX_USART2_UART_Init+0x90>)
|
|
80012fc: 2200 movs r2, #0
|
|
80012fe: 611a str r2, [r3, #16]
|
|
huart2.Init.Mode = UART_MODE_TX_RX;
|
|
8001300: 4b1a ldr r3, [pc, #104] @ (800136c <MX_USART2_UART_Init+0x90>)
|
|
8001302: 220c movs r2, #12
|
|
8001304: 615a str r2, [r3, #20]
|
|
huart2.Init.HwFlowCtl = UART_HWCONTROL_NONE;
|
|
8001306: 4b19 ldr r3, [pc, #100] @ (800136c <MX_USART2_UART_Init+0x90>)
|
|
8001308: 2200 movs r2, #0
|
|
800130a: 619a str r2, [r3, #24]
|
|
huart2.Init.OverSampling = UART_OVERSAMPLING_16;
|
|
800130c: 4b17 ldr r3, [pc, #92] @ (800136c <MX_USART2_UART_Init+0x90>)
|
|
800130e: 2200 movs r2, #0
|
|
8001310: 61da str r2, [r3, #28]
|
|
huart2.Init.OneBitSampling = UART_ONE_BIT_SAMPLE_DISABLE;
|
|
8001312: 4b16 ldr r3, [pc, #88] @ (800136c <MX_USART2_UART_Init+0x90>)
|
|
8001314: 2200 movs r2, #0
|
|
8001316: 621a str r2, [r3, #32]
|
|
huart2.Init.ClockPrescaler = UART_PRESCALER_DIV1;
|
|
8001318: 4b14 ldr r3, [pc, #80] @ (800136c <MX_USART2_UART_Init+0x90>)
|
|
800131a: 2200 movs r2, #0
|
|
800131c: 625a str r2, [r3, #36] @ 0x24
|
|
huart2.AdvancedInit.AdvFeatureInit = UART_ADVFEATURE_NO_INIT;
|
|
800131e: 4b13 ldr r3, [pc, #76] @ (800136c <MX_USART2_UART_Init+0x90>)
|
|
8001320: 2200 movs r2, #0
|
|
8001322: 629a str r2, [r3, #40] @ 0x28
|
|
if (HAL_UART_Init(&huart2) != HAL_OK)
|
|
8001324: 4811 ldr r0, [pc, #68] @ (800136c <MX_USART2_UART_Init+0x90>)
|
|
8001326: f004 f95c bl 80055e2 <HAL_UART_Init>
|
|
800132a: 4603 mov r3, r0
|
|
800132c: 2b00 cmp r3, #0
|
|
800132e: d001 beq.n 8001334 <MX_USART2_UART_Init+0x58>
|
|
{
|
|
Error_Handler();
|
|
8001330: f7ff fa4e bl 80007d0 <Error_Handler>
|
|
}
|
|
if (HAL_UARTEx_SetTxFifoThreshold(&huart2, UART_TXFIFO_THRESHOLD_1_8) != HAL_OK)
|
|
8001334: 2100 movs r1, #0
|
|
8001336: 480d ldr r0, [pc, #52] @ (800136c <MX_USART2_UART_Init+0x90>)
|
|
8001338: f006 fbd7 bl 8007aea <HAL_UARTEx_SetTxFifoThreshold>
|
|
800133c: 4603 mov r3, r0
|
|
800133e: 2b00 cmp r3, #0
|
|
8001340: d001 beq.n 8001346 <MX_USART2_UART_Init+0x6a>
|
|
{
|
|
Error_Handler();
|
|
8001342: f7ff fa45 bl 80007d0 <Error_Handler>
|
|
}
|
|
if (HAL_UARTEx_SetRxFifoThreshold(&huart2, UART_RXFIFO_THRESHOLD_1_8) != HAL_OK)
|
|
8001346: 2100 movs r1, #0
|
|
8001348: 4808 ldr r0, [pc, #32] @ (800136c <MX_USART2_UART_Init+0x90>)
|
|
800134a: f006 fc0c bl 8007b66 <HAL_UARTEx_SetRxFifoThreshold>
|
|
800134e: 4603 mov r3, r0
|
|
8001350: 2b00 cmp r3, #0
|
|
8001352: d001 beq.n 8001358 <MX_USART2_UART_Init+0x7c>
|
|
{
|
|
Error_Handler();
|
|
8001354: f7ff fa3c bl 80007d0 <Error_Handler>
|
|
}
|
|
if (HAL_UARTEx_EnableFifoMode(&huart2) != HAL_OK)
|
|
8001358: 4804 ldr r0, [pc, #16] @ (800136c <MX_USART2_UART_Init+0x90>)
|
|
800135a: f006 fb8b bl 8007a74 <HAL_UARTEx_EnableFifoMode>
|
|
800135e: 4603 mov r3, r0
|
|
8001360: 2b00 cmp r3, #0
|
|
8001362: d001 beq.n 8001368 <MX_USART2_UART_Init+0x8c>
|
|
{
|
|
Error_Handler();
|
|
8001364: f7ff fa34 bl 80007d0 <Error_Handler>
|
|
}
|
|
/* USER CODE BEGIN USART2_Init 2 */
|
|
|
|
/* USER CODE END USART2_Init 2 */
|
|
|
|
}
|
|
8001368: bf00 nop
|
|
800136a: bd80 pop {r7, pc}
|
|
800136c: 200000dc .word 0x200000dc
|
|
8001370: 40004400 .word 0x40004400
|
|
|
|
08001374 <HAL_UART_MspInit>:
|
|
|
|
void HAL_UART_MspInit(UART_HandleTypeDef* uartHandle)
|
|
{
|
|
8001374: b580 push {r7, lr}
|
|
8001376: b096 sub sp, #88 @ 0x58
|
|
8001378: af00 add r7, sp, #0
|
|
800137a: 6078 str r0, [r7, #4]
|
|
|
|
GPIO_InitTypeDef GPIO_InitStruct = {0};
|
|
800137c: f107 0344 add.w r3, r7, #68 @ 0x44
|
|
8001380: 2200 movs r2, #0
|
|
8001382: 601a str r2, [r3, #0]
|
|
8001384: 605a str r2, [r3, #4]
|
|
8001386: 609a str r2, [r3, #8]
|
|
8001388: 60da str r2, [r3, #12]
|
|
800138a: 611a str r2, [r3, #16]
|
|
RCC_PeriphCLKInitTypeDef PeriphClkInitStruct = {0};
|
|
800138c: f107 030c add.w r3, r7, #12
|
|
8001390: 2238 movs r2, #56 @ 0x38
|
|
8001392: 2100 movs r1, #0
|
|
8001394: 4618 mov r0, r3
|
|
8001396: f00d fdd9 bl 800ef4c <memset>
|
|
if(uartHandle->Instance==USART2)
|
|
800139a: 687b ldr r3, [r7, #4]
|
|
800139c: 681b ldr r3, [r3, #0]
|
|
800139e: 4a33 ldr r2, [pc, #204] @ (800146c <HAL_UART_MspInit+0xf8>)
|
|
80013a0: 4293 cmp r3, r2
|
|
80013a2: d15f bne.n 8001464 <HAL_UART_MspInit+0xf0>
|
|
|
|
/* USER CODE END USART2_MspInit 0 */
|
|
|
|
/** Initializes the peripherals clocks
|
|
*/
|
|
PeriphClkInitStruct.PeriphClockSelection = RCC_PERIPHCLK_USART2;
|
|
80013a4: 2302 movs r3, #2
|
|
80013a6: 60fb str r3, [r7, #12]
|
|
PeriphClkInitStruct.Usart2ClockSelection = RCC_USART2CLKSOURCE_SYSCLK;
|
|
80013a8: 4b31 ldr r3, [pc, #196] @ (8001470 <HAL_UART_MspInit+0xfc>)
|
|
80013aa: 617b str r3, [r7, #20]
|
|
if (HAL_RCCEx_PeriphCLKConfig(&PeriphClkInitStruct) != HAL_OK)
|
|
80013ac: f107 030c add.w r3, r7, #12
|
|
80013b0: 4618 mov r0, r3
|
|
80013b2: f002 ff79 bl 80042a8 <HAL_RCCEx_PeriphCLKConfig>
|
|
80013b6: 4603 mov r3, r0
|
|
80013b8: 2b00 cmp r3, #0
|
|
80013ba: d001 beq.n 80013c0 <HAL_UART_MspInit+0x4c>
|
|
{
|
|
Error_Handler();
|
|
80013bc: f7ff fa08 bl 80007d0 <Error_Handler>
|
|
}
|
|
|
|
/* USART2 clock enable */
|
|
__HAL_RCC_USART2_CLK_ENABLE();
|
|
80013c0: f44f 3000 mov.w r0, #131072 @ 0x20000
|
|
80013c4: f7ff ff60 bl 8001288 <LL_APB1_GRP1_EnableClock>
|
|
|
|
__HAL_RCC_GPIOA_CLK_ENABLE();
|
|
80013c8: 2001 movs r0, #1
|
|
80013ca: f7ff ff45 bl 8001258 <LL_AHB2_GRP1_EnableClock>
|
|
/**USART2 GPIO Configuration
|
|
PA3 ------> USART2_RX
|
|
PA2 ------> USART2_TX
|
|
*/
|
|
GPIO_InitStruct.Pin = USARTx_RX_Pin|USARTx_TX_Pin;
|
|
80013ce: 230c movs r3, #12
|
|
80013d0: 647b str r3, [r7, #68] @ 0x44
|
|
GPIO_InitStruct.Mode = GPIO_MODE_AF_PP;
|
|
80013d2: 2302 movs r3, #2
|
|
80013d4: 64bb str r3, [r7, #72] @ 0x48
|
|
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
|
80013d6: 2300 movs r3, #0
|
|
80013d8: 64fb str r3, [r7, #76] @ 0x4c
|
|
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_VERY_HIGH;
|
|
80013da: 2303 movs r3, #3
|
|
80013dc: 653b str r3, [r7, #80] @ 0x50
|
|
GPIO_InitStruct.Alternate = GPIO_AF7_USART2;
|
|
80013de: 2307 movs r3, #7
|
|
80013e0: 657b str r3, [r7, #84] @ 0x54
|
|
HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
|
|
80013e2: f107 0344 add.w r3, r7, #68 @ 0x44
|
|
80013e6: 4619 mov r1, r3
|
|
80013e8: f04f 4090 mov.w r0, #1207959552 @ 0x48000000
|
|
80013ec: f001 fa3e bl 800286c <HAL_GPIO_Init>
|
|
|
|
/* USART2 DMA Init */
|
|
/* USART2_TX Init */
|
|
hdma_usart2_tx.Instance = DMA1_Channel5;
|
|
80013f0: 4b20 ldr r3, [pc, #128] @ (8001474 <HAL_UART_MspInit+0x100>)
|
|
80013f2: 4a21 ldr r2, [pc, #132] @ (8001478 <HAL_UART_MspInit+0x104>)
|
|
80013f4: 601a str r2, [r3, #0]
|
|
hdma_usart2_tx.Init.Request = DMA_REQUEST_USART2_TX;
|
|
80013f6: 4b1f ldr r3, [pc, #124] @ (8001474 <HAL_UART_MspInit+0x100>)
|
|
80013f8: 2214 movs r2, #20
|
|
80013fa: 605a str r2, [r3, #4]
|
|
hdma_usart2_tx.Init.Direction = DMA_MEMORY_TO_PERIPH;
|
|
80013fc: 4b1d ldr r3, [pc, #116] @ (8001474 <HAL_UART_MspInit+0x100>)
|
|
80013fe: 2210 movs r2, #16
|
|
8001400: 609a str r2, [r3, #8]
|
|
hdma_usart2_tx.Init.PeriphInc = DMA_PINC_DISABLE;
|
|
8001402: 4b1c ldr r3, [pc, #112] @ (8001474 <HAL_UART_MspInit+0x100>)
|
|
8001404: 2200 movs r2, #0
|
|
8001406: 60da str r2, [r3, #12]
|
|
hdma_usart2_tx.Init.MemInc = DMA_MINC_ENABLE;
|
|
8001408: 4b1a ldr r3, [pc, #104] @ (8001474 <HAL_UART_MspInit+0x100>)
|
|
800140a: 2280 movs r2, #128 @ 0x80
|
|
800140c: 611a str r2, [r3, #16]
|
|
hdma_usart2_tx.Init.PeriphDataAlignment = DMA_PDATAALIGN_BYTE;
|
|
800140e: 4b19 ldr r3, [pc, #100] @ (8001474 <HAL_UART_MspInit+0x100>)
|
|
8001410: 2200 movs r2, #0
|
|
8001412: 615a str r2, [r3, #20]
|
|
hdma_usart2_tx.Init.MemDataAlignment = DMA_MDATAALIGN_BYTE;
|
|
8001414: 4b17 ldr r3, [pc, #92] @ (8001474 <HAL_UART_MspInit+0x100>)
|
|
8001416: 2200 movs r2, #0
|
|
8001418: 619a str r2, [r3, #24]
|
|
hdma_usart2_tx.Init.Mode = DMA_NORMAL;
|
|
800141a: 4b16 ldr r3, [pc, #88] @ (8001474 <HAL_UART_MspInit+0x100>)
|
|
800141c: 2200 movs r2, #0
|
|
800141e: 61da str r2, [r3, #28]
|
|
hdma_usart2_tx.Init.Priority = DMA_PRIORITY_LOW;
|
|
8001420: 4b14 ldr r3, [pc, #80] @ (8001474 <HAL_UART_MspInit+0x100>)
|
|
8001422: 2200 movs r2, #0
|
|
8001424: 621a str r2, [r3, #32]
|
|
if (HAL_DMA_Init(&hdma_usart2_tx) != HAL_OK)
|
|
8001426: 4813 ldr r0, [pc, #76] @ (8001474 <HAL_UART_MspInit+0x100>)
|
|
8001428: f000 fbe0 bl 8001bec <HAL_DMA_Init>
|
|
800142c: 4603 mov r3, r0
|
|
800142e: 2b00 cmp r3, #0
|
|
8001430: d001 beq.n 8001436 <HAL_UART_MspInit+0xc2>
|
|
{
|
|
Error_Handler();
|
|
8001432: f7ff f9cd bl 80007d0 <Error_Handler>
|
|
}
|
|
|
|
if (HAL_DMA_ConfigChannelAttributes(&hdma_usart2_tx, DMA_CHANNEL_NPRIV) != HAL_OK)
|
|
8001436: 2110 movs r1, #16
|
|
8001438: 480e ldr r0, [pc, #56] @ (8001474 <HAL_UART_MspInit+0x100>)
|
|
800143a: f000 ff22 bl 8002282 <HAL_DMA_ConfigChannelAttributes>
|
|
800143e: 4603 mov r3, r0
|
|
8001440: 2b00 cmp r3, #0
|
|
8001442: d001 beq.n 8001448 <HAL_UART_MspInit+0xd4>
|
|
{
|
|
Error_Handler();
|
|
8001444: f7ff f9c4 bl 80007d0 <Error_Handler>
|
|
}
|
|
|
|
__HAL_LINKDMA(uartHandle,hdmatx,hdma_usart2_tx);
|
|
8001448: 687b ldr r3, [r7, #4]
|
|
800144a: 4a0a ldr r2, [pc, #40] @ (8001474 <HAL_UART_MspInit+0x100>)
|
|
800144c: 67da str r2, [r3, #124] @ 0x7c
|
|
800144e: 4a09 ldr r2, [pc, #36] @ (8001474 <HAL_UART_MspInit+0x100>)
|
|
8001450: 687b ldr r3, [r7, #4]
|
|
8001452: 6293 str r3, [r2, #40] @ 0x28
|
|
|
|
/* USART2 interrupt Init */
|
|
HAL_NVIC_SetPriority(USART2_IRQn, 2, 0);
|
|
8001454: 2200 movs r2, #0
|
|
8001456: 2102 movs r1, #2
|
|
8001458: 2025 movs r0, #37 @ 0x25
|
|
800145a: f000 fb90 bl 8001b7e <HAL_NVIC_SetPriority>
|
|
HAL_NVIC_EnableIRQ(USART2_IRQn);
|
|
800145e: 2025 movs r0, #37 @ 0x25
|
|
8001460: f000 fba7 bl 8001bb2 <HAL_NVIC_EnableIRQ>
|
|
/* USER CODE BEGIN USART2_MspInit 1 */
|
|
|
|
/* USER CODE END USART2_MspInit 1 */
|
|
}
|
|
}
|
|
8001464: bf00 nop
|
|
8001466: 3758 adds r7, #88 @ 0x58
|
|
8001468: 46bd mov sp, r7
|
|
800146a: bd80 pop {r7, pc}
|
|
800146c: 40004400 .word 0x40004400
|
|
8001470: 000c0004 .word 0x000c0004
|
|
8001474: 20000170 .word 0x20000170
|
|
8001478: 40020058 .word 0x40020058
|
|
|
|
0800147c <HAL_UART_MspDeInit>:
|
|
|
|
void HAL_UART_MspDeInit(UART_HandleTypeDef* uartHandle)
|
|
{
|
|
800147c: b580 push {r7, lr}
|
|
800147e: b082 sub sp, #8
|
|
8001480: af00 add r7, sp, #0
|
|
8001482: 6078 str r0, [r7, #4]
|
|
|
|
if(uartHandle->Instance==USART2)
|
|
8001484: 687b ldr r3, [r7, #4]
|
|
8001486: 681b ldr r3, [r3, #0]
|
|
8001488: 4a0b ldr r2, [pc, #44] @ (80014b8 <HAL_UART_MspDeInit+0x3c>)
|
|
800148a: 4293 cmp r3, r2
|
|
800148c: d110 bne.n 80014b0 <HAL_UART_MspDeInit+0x34>
|
|
{
|
|
/* USER CODE BEGIN USART2_MspDeInit 0 */
|
|
|
|
/* USER CODE END USART2_MspDeInit 0 */
|
|
/* Peripheral clock disable */
|
|
__HAL_RCC_USART2_CLK_DISABLE();
|
|
800148e: f44f 3000 mov.w r0, #131072 @ 0x20000
|
|
8001492: f7ff ff11 bl 80012b8 <LL_APB1_GRP1_DisableClock>
|
|
|
|
/**USART2 GPIO Configuration
|
|
PA3 ------> USART2_RX
|
|
PA2 ------> USART2_TX
|
|
*/
|
|
HAL_GPIO_DeInit(GPIOA, USARTx_RX_Pin|USARTx_TX_Pin);
|
|
8001496: 210c movs r1, #12
|
|
8001498: f04f 4090 mov.w r0, #1207959552 @ 0x48000000
|
|
800149c: f001 fb46 bl 8002b2c <HAL_GPIO_DeInit>
|
|
|
|
/* USART2 DMA DeInit */
|
|
HAL_DMA_DeInit(uartHandle->hdmatx);
|
|
80014a0: 687b ldr r3, [r7, #4]
|
|
80014a2: 6fdb ldr r3, [r3, #124] @ 0x7c
|
|
80014a4: 4618 mov r0, r3
|
|
80014a6: f000 fc49 bl 8001d3c <HAL_DMA_DeInit>
|
|
|
|
/* USART2 interrupt Deinit */
|
|
HAL_NVIC_DisableIRQ(USART2_IRQn);
|
|
80014aa: 2025 movs r0, #37 @ 0x25
|
|
80014ac: f000 fb8f bl 8001bce <HAL_NVIC_DisableIRQ>
|
|
/* USER CODE BEGIN USART2_MspDeInit 1 */
|
|
|
|
/* USER CODE END USART2_MspDeInit 1 */
|
|
}
|
|
}
|
|
80014b0: bf00 nop
|
|
80014b2: 3708 adds r7, #8
|
|
80014b4: 46bd mov sp, r7
|
|
80014b6: bd80 pop {r7, pc}
|
|
80014b8: 40004400 .word 0x40004400
|
|
|
|
080014bc <LL_APB1_GRP1_ForceReset>:
|
|
{
|
|
80014bc: b480 push {r7}
|
|
80014be: b083 sub sp, #12
|
|
80014c0: af00 add r7, sp, #0
|
|
80014c2: 6078 str r0, [r7, #4]
|
|
SET_BIT(RCC->APB1RSTR1, Periphs);
|
|
80014c4: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
80014c8: 6b9a ldr r2, [r3, #56] @ 0x38
|
|
80014ca: f04f 41b0 mov.w r1, #1476395008 @ 0x58000000
|
|
80014ce: 687b ldr r3, [r7, #4]
|
|
80014d0: 4313 orrs r3, r2
|
|
80014d2: 638b str r3, [r1, #56] @ 0x38
|
|
}
|
|
80014d4: bf00 nop
|
|
80014d6: 370c adds r7, #12
|
|
80014d8: 46bd mov sp, r7
|
|
80014da: bc80 pop {r7}
|
|
80014dc: 4770 bx lr
|
|
|
|
080014de <LL_APB1_GRP1_ReleaseReset>:
|
|
{
|
|
80014de: b480 push {r7}
|
|
80014e0: b083 sub sp, #12
|
|
80014e2: af00 add r7, sp, #0
|
|
80014e4: 6078 str r0, [r7, #4]
|
|
CLEAR_BIT(RCC->APB1RSTR1, Periphs);
|
|
80014e6: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
80014ea: 6b9a ldr r2, [r3, #56] @ 0x38
|
|
80014ec: 687b ldr r3, [r7, #4]
|
|
80014ee: 43db mvns r3, r3
|
|
80014f0: f04f 41b0 mov.w r1, #1476395008 @ 0x58000000
|
|
80014f4: 4013 ands r3, r2
|
|
80014f6: 638b str r3, [r1, #56] @ 0x38
|
|
}
|
|
80014f8: bf00 nop
|
|
80014fa: 370c adds r7, #12
|
|
80014fc: 46bd mov sp, r7
|
|
80014fe: bc80 pop {r7}
|
|
8001500: 4770 bx lr
|
|
...
|
|
|
|
08001504 <LL_EXTI_EnableIT_0_31>:
|
|
{
|
|
8001504: b480 push {r7}
|
|
8001506: b083 sub sp, #12
|
|
8001508: af00 add r7, sp, #0
|
|
800150a: 6078 str r0, [r7, #4]
|
|
SET_BIT(EXTI->IMR1, ExtiLine);
|
|
800150c: 4b06 ldr r3, [pc, #24] @ (8001528 <LL_EXTI_EnableIT_0_31+0x24>)
|
|
800150e: f8d3 2080 ldr.w r2, [r3, #128] @ 0x80
|
|
8001512: 4905 ldr r1, [pc, #20] @ (8001528 <LL_EXTI_EnableIT_0_31+0x24>)
|
|
8001514: 687b ldr r3, [r7, #4]
|
|
8001516: 4313 orrs r3, r2
|
|
8001518: f8c1 3080 str.w r3, [r1, #128] @ 0x80
|
|
}
|
|
800151c: bf00 nop
|
|
800151e: 370c adds r7, #12
|
|
8001520: 46bd mov sp, r7
|
|
8001522: bc80 pop {r7}
|
|
8001524: 4770 bx lr
|
|
8001526: bf00 nop
|
|
8001528: 58000800 .word 0x58000800
|
|
|
|
0800152c <vcom_Init>:
|
|
/* USER CODE END PFP */
|
|
|
|
/* Exported functions --------------------------------------------------------*/
|
|
|
|
UTIL_ADV_TRACE_Status_t vcom_Init(void (*cb)(void *))
|
|
{
|
|
800152c: b580 push {r7, lr}
|
|
800152e: b082 sub sp, #8
|
|
8001530: af00 add r7, sp, #0
|
|
8001532: 6078 str r0, [r7, #4]
|
|
/* USER CODE BEGIN vcom_Init_1 */
|
|
|
|
/* USER CODE END vcom_Init_1 */
|
|
TxCpltCallback = cb;
|
|
8001534: 4a07 ldr r2, [pc, #28] @ (8001554 <vcom_Init+0x28>)
|
|
8001536: 687b ldr r3, [r7, #4]
|
|
8001538: 6013 str r3, [r2, #0]
|
|
MX_DMA_Init();
|
|
800153a: f7ff f837 bl 80005ac <MX_DMA_Init>
|
|
MX_USART2_UART_Init();
|
|
800153e: f7ff fecd bl 80012dc <MX_USART2_UART_Init>
|
|
LL_EXTI_EnableIT_0_31(LL_EXTI_LINE_27);
|
|
8001542: f04f 6000 mov.w r0, #134217728 @ 0x8000000
|
|
8001546: f7ff ffdd bl 8001504 <LL_EXTI_EnableIT_0_31>
|
|
return UTIL_ADV_TRACE_OK;
|
|
800154a: 2300 movs r3, #0
|
|
/* USER CODE BEGIN vcom_Init_2 */
|
|
|
|
/* USER CODE END vcom_Init_2 */
|
|
}
|
|
800154c: 4618 mov r0, r3
|
|
800154e: 3708 adds r7, #8
|
|
8001550: 46bd mov sp, r7
|
|
8001552: bd80 pop {r7, pc}
|
|
8001554: 200001d4 .word 0x200001d4
|
|
|
|
08001558 <vcom_DeInit>:
|
|
|
|
UTIL_ADV_TRACE_Status_t vcom_DeInit(void)
|
|
{
|
|
8001558: b580 push {r7, lr}
|
|
800155a: af00 add r7, sp, #0
|
|
/* USER CODE BEGIN vcom_DeInit_1 */
|
|
|
|
/* USER CODE END vcom_DeInit_1 */
|
|
/* ##-1- Reset peripherals ################################################## */
|
|
__HAL_RCC_USART2_FORCE_RESET();
|
|
800155c: f44f 3000 mov.w r0, #131072 @ 0x20000
|
|
8001560: f7ff ffac bl 80014bc <LL_APB1_GRP1_ForceReset>
|
|
__HAL_RCC_USART2_RELEASE_RESET();
|
|
8001564: f44f 3000 mov.w r0, #131072 @ 0x20000
|
|
8001568: f7ff ffb9 bl 80014de <LL_APB1_GRP1_ReleaseReset>
|
|
|
|
/* ##-2- MspDeInit ################################################## */
|
|
HAL_UART_MspDeInit(&huart2);
|
|
800156c: 4804 ldr r0, [pc, #16] @ (8001580 <vcom_DeInit+0x28>)
|
|
800156e: f7ff ff85 bl 800147c <HAL_UART_MspDeInit>
|
|
|
|
/* ##-3- Disable the NVIC for DMA ########################################### */
|
|
/* USER CODE BEGIN 1 */
|
|
HAL_NVIC_DisableIRQ(DMA1_Channel5_IRQn);
|
|
8001572: 200f movs r0, #15
|
|
8001574: f000 fb2b bl 8001bce <HAL_NVIC_DisableIRQ>
|
|
|
|
return UTIL_ADV_TRACE_OK;
|
|
8001578: 2300 movs r3, #0
|
|
/* USER CODE END 1 */
|
|
/* USER CODE BEGIN vcom_DeInit_2 */
|
|
|
|
/* USER CODE END vcom_DeInit_2 */
|
|
}
|
|
800157a: 4618 mov r0, r3
|
|
800157c: bd80 pop {r7, pc}
|
|
800157e: bf00 nop
|
|
8001580: 200000dc .word 0x200000dc
|
|
|
|
08001584 <vcom_Trace_DMA>:
|
|
|
|
/* USER CODE END vcom_Trace_2 */
|
|
}
|
|
|
|
UTIL_ADV_TRACE_Status_t vcom_Trace_DMA(uint8_t *p_data, uint16_t size)
|
|
{
|
|
8001584: b580 push {r7, lr}
|
|
8001586: b082 sub sp, #8
|
|
8001588: af00 add r7, sp, #0
|
|
800158a: 6078 str r0, [r7, #4]
|
|
800158c: 460b mov r3, r1
|
|
800158e: 807b strh r3, [r7, #2]
|
|
/* USER CODE BEGIN vcom_Trace_DMA_1 */
|
|
|
|
/* USER CODE END vcom_Trace_DMA_1 */
|
|
HAL_UART_Transmit_DMA(&huart2, p_data, size);
|
|
8001590: 887b ldrh r3, [r7, #2]
|
|
8001592: 461a mov r2, r3
|
|
8001594: 6879 ldr r1, [r7, #4]
|
|
8001596: 4804 ldr r0, [pc, #16] @ (80015a8 <vcom_Trace_DMA+0x24>)
|
|
8001598: f004 f958 bl 800584c <HAL_UART_Transmit_DMA>
|
|
return UTIL_ADV_TRACE_OK;
|
|
800159c: 2300 movs r3, #0
|
|
/* USER CODE BEGIN vcom_Trace_DMA_2 */
|
|
|
|
/* USER CODE END vcom_Trace_DMA_2 */
|
|
}
|
|
800159e: 4618 mov r0, r3
|
|
80015a0: 3708 adds r7, #8
|
|
80015a2: 46bd mov sp, r7
|
|
80015a4: bd80 pop {r7, pc}
|
|
80015a6: bf00 nop
|
|
80015a8: 200000dc .word 0x200000dc
|
|
|
|
080015ac <vcom_ReceiveInit>:
|
|
|
|
UTIL_ADV_TRACE_Status_t vcom_ReceiveInit(void (*RxCb)(uint8_t *rxChar, uint16_t size, uint8_t error))
|
|
{
|
|
80015ac: b580 push {r7, lr}
|
|
80015ae: b084 sub sp, #16
|
|
80015b0: af00 add r7, sp, #0
|
|
80015b2: 6078 str r0, [r7, #4]
|
|
|
|
/* USER CODE END vcom_ReceiveInit_1 */
|
|
UART_WakeUpTypeDef WakeUpSelection;
|
|
|
|
/*record call back*/
|
|
RxCpltCallback = RxCb;
|
|
80015b4: 4a19 ldr r2, [pc, #100] @ (800161c <vcom_ReceiveInit+0x70>)
|
|
80015b6: 687b ldr r3, [r7, #4]
|
|
80015b8: 6013 str r3, [r2, #0]
|
|
|
|
/*Set wakeUp event on start bit*/
|
|
WakeUpSelection.WakeUpEvent = UART_WAKEUP_ON_STARTBIT;
|
|
80015ba: f44f 1300 mov.w r3, #2097152 @ 0x200000
|
|
80015be: 60bb str r3, [r7, #8]
|
|
|
|
HAL_UARTEx_StopModeWakeUpSourceConfig(&huart2, WakeUpSelection);
|
|
80015c0: f107 0308 add.w r3, r7, #8
|
|
80015c4: e893 0006 ldmia.w r3, {r1, r2}
|
|
80015c8: 4815 ldr r0, [pc, #84] @ (8001620 <vcom_ReceiveInit+0x74>)
|
|
80015ca: f006 f9c6 bl 800795a <HAL_UARTEx_StopModeWakeUpSourceConfig>
|
|
|
|
/* Make sure that no UART transfer is on-going */
|
|
while (__HAL_UART_GET_FLAG(&huart2, USART_ISR_BUSY) == SET);
|
|
80015ce: bf00 nop
|
|
80015d0: 4b13 ldr r3, [pc, #76] @ (8001620 <vcom_ReceiveInit+0x74>)
|
|
80015d2: 681b ldr r3, [r3, #0]
|
|
80015d4: 69db ldr r3, [r3, #28]
|
|
80015d6: f403 3380 and.w r3, r3, #65536 @ 0x10000
|
|
80015da: f5b3 3f80 cmp.w r3, #65536 @ 0x10000
|
|
80015de: d0f7 beq.n 80015d0 <vcom_ReceiveInit+0x24>
|
|
|
|
/* Make sure that UART is ready to receive) */
|
|
while (__HAL_UART_GET_FLAG(&huart2, USART_ISR_REACK) == RESET);
|
|
80015e0: bf00 nop
|
|
80015e2: 4b0f ldr r3, [pc, #60] @ (8001620 <vcom_ReceiveInit+0x74>)
|
|
80015e4: 681b ldr r3, [r3, #0]
|
|
80015e6: 69db ldr r3, [r3, #28]
|
|
80015e8: f403 0380 and.w r3, r3, #4194304 @ 0x400000
|
|
80015ec: f5b3 0f80 cmp.w r3, #4194304 @ 0x400000
|
|
80015f0: d1f7 bne.n 80015e2 <vcom_ReceiveInit+0x36>
|
|
|
|
/* Enable USART interrupt */
|
|
__HAL_UART_ENABLE_IT(&huart2, UART_IT_WUF);
|
|
80015f2: 4b0b ldr r3, [pc, #44] @ (8001620 <vcom_ReceiveInit+0x74>)
|
|
80015f4: 681b ldr r3, [r3, #0]
|
|
80015f6: 689a ldr r2, [r3, #8]
|
|
80015f8: 4b09 ldr r3, [pc, #36] @ (8001620 <vcom_ReceiveInit+0x74>)
|
|
80015fa: 681b ldr r3, [r3, #0]
|
|
80015fc: f442 0280 orr.w r2, r2, #4194304 @ 0x400000
|
|
8001600: 609a str r2, [r3, #8]
|
|
|
|
/*Enable wakeup from stop mode*/
|
|
HAL_UARTEx_EnableStopMode(&huart2);
|
|
8001602: 4807 ldr r0, [pc, #28] @ (8001620 <vcom_ReceiveInit+0x74>)
|
|
8001604: f006 fa04 bl 8007a10 <HAL_UARTEx_EnableStopMode>
|
|
|
|
/*Start LPUART receive on IT*/
|
|
HAL_UART_Receive_IT(&huart2, &charRx, 1);
|
|
8001608: 2201 movs r2, #1
|
|
800160a: 4906 ldr r1, [pc, #24] @ (8001624 <vcom_ReceiveInit+0x78>)
|
|
800160c: 4804 ldr r0, [pc, #16] @ (8001620 <vcom_ReceiveInit+0x74>)
|
|
800160e: f004 f8d1 bl 80057b4 <HAL_UART_Receive_IT>
|
|
|
|
return UTIL_ADV_TRACE_OK;
|
|
8001612: 2300 movs r3, #0
|
|
/* USER CODE BEGIN vcom_ReceiveInit_2 */
|
|
|
|
/* USER CODE END vcom_ReceiveInit_2 */
|
|
}
|
|
8001614: 4618 mov r0, r3
|
|
8001616: 3710 adds r7, #16
|
|
8001618: 46bd mov sp, r7
|
|
800161a: bd80 pop {r7, pc}
|
|
800161c: 200001d8 .word 0x200001d8
|
|
8001620: 200000dc .word 0x200000dc
|
|
8001624: 200001d0 .word 0x200001d0
|
|
|
|
08001628 <vcom_Resume>:
|
|
|
|
void vcom_Resume(void)
|
|
{
|
|
8001628: b580 push {r7, lr}
|
|
800162a: af00 add r7, sp, #0
|
|
/* USER CODE BEGIN vcom_Resume_1 */
|
|
|
|
/* USER CODE END vcom_Resume_1 */
|
|
/*to re-enable lost UART settings*/
|
|
if (HAL_UART_Init(&huart2) != HAL_OK)
|
|
800162c: 4808 ldr r0, [pc, #32] @ (8001650 <vcom_Resume+0x28>)
|
|
800162e: f003 ffd8 bl 80055e2 <HAL_UART_Init>
|
|
8001632: 4603 mov r3, r0
|
|
8001634: 2b00 cmp r3, #0
|
|
8001636: d001 beq.n 800163c <vcom_Resume+0x14>
|
|
{
|
|
Error_Handler();
|
|
8001638: f7ff f8ca bl 80007d0 <Error_Handler>
|
|
}
|
|
|
|
/*to re-enable lost DMA settings*/
|
|
if (HAL_DMA_Init(&hdma_usart2_tx) != HAL_OK)
|
|
800163c: 4805 ldr r0, [pc, #20] @ (8001654 <vcom_Resume+0x2c>)
|
|
800163e: f000 fad5 bl 8001bec <HAL_DMA_Init>
|
|
8001642: 4603 mov r3, r0
|
|
8001644: 2b00 cmp r3, #0
|
|
8001646: d001 beq.n 800164c <vcom_Resume+0x24>
|
|
{
|
|
Error_Handler();
|
|
8001648: f7ff f8c2 bl 80007d0 <Error_Handler>
|
|
}
|
|
/* USER CODE BEGIN vcom_Resume_2 */
|
|
|
|
/* USER CODE END vcom_Resume_2 */
|
|
}
|
|
800164c: bf00 nop
|
|
800164e: bd80 pop {r7, pc}
|
|
8001650: 200000dc .word 0x200000dc
|
|
8001654: 20000170 .word 0x20000170
|
|
|
|
08001658 <HAL_UART_TxCpltCallback>:
|
|
|
|
void HAL_UART_TxCpltCallback(UART_HandleTypeDef *huart)
|
|
{
|
|
8001658: b580 push {r7, lr}
|
|
800165a: b082 sub sp, #8
|
|
800165c: af00 add r7, sp, #0
|
|
800165e: 6078 str r0, [r7, #4]
|
|
/* USER CODE BEGIN HAL_UART_TxCpltCallback_1 */
|
|
|
|
/* USER CODE END HAL_UART_TxCpltCallback_1 */
|
|
/* buffer transmission complete*/
|
|
if (huart->Instance == USART2)
|
|
8001660: 687b ldr r3, [r7, #4]
|
|
8001662: 681b ldr r3, [r3, #0]
|
|
8001664: 4a05 ldr r2, [pc, #20] @ (800167c <HAL_UART_TxCpltCallback+0x24>)
|
|
8001666: 4293 cmp r3, r2
|
|
8001668: d103 bne.n 8001672 <HAL_UART_TxCpltCallback+0x1a>
|
|
{
|
|
TxCpltCallback(NULL);
|
|
800166a: 4b05 ldr r3, [pc, #20] @ (8001680 <HAL_UART_TxCpltCallback+0x28>)
|
|
800166c: 681b ldr r3, [r3, #0]
|
|
800166e: 2000 movs r0, #0
|
|
8001670: 4798 blx r3
|
|
}
|
|
/* USER CODE BEGIN HAL_UART_TxCpltCallback_2 */
|
|
|
|
/* USER CODE END HAL_UART_TxCpltCallback_2 */
|
|
}
|
|
8001672: bf00 nop
|
|
8001674: 3708 adds r7, #8
|
|
8001676: 46bd mov sp, r7
|
|
8001678: bd80 pop {r7, pc}
|
|
800167a: bf00 nop
|
|
800167c: 40004400 .word 0x40004400
|
|
8001680: 200001d4 .word 0x200001d4
|
|
|
|
08001684 <HAL_UART_RxCpltCallback>:
|
|
|
|
void HAL_UART_RxCpltCallback(UART_HandleTypeDef *huart)
|
|
{
|
|
8001684: b580 push {r7, lr}
|
|
8001686: b082 sub sp, #8
|
|
8001688: af00 add r7, sp, #0
|
|
800168a: 6078 str r0, [r7, #4]
|
|
/* USER CODE BEGIN HAL_UART_RxCpltCallback_1 */
|
|
|
|
/* USER CODE END HAL_UART_RxCpltCallback_1 */
|
|
if (huart->Instance == USART2)
|
|
800168c: 687b ldr r3, [r7, #4]
|
|
800168e: 681b ldr r3, [r3, #0]
|
|
8001690: 4a0d ldr r2, [pc, #52] @ (80016c8 <HAL_UART_RxCpltCallback+0x44>)
|
|
8001692: 4293 cmp r3, r2
|
|
8001694: d113 bne.n 80016be <HAL_UART_RxCpltCallback+0x3a>
|
|
{
|
|
if ((NULL != RxCpltCallback) && (HAL_UART_ERROR_NONE == huart->ErrorCode))
|
|
8001696: 4b0d ldr r3, [pc, #52] @ (80016cc <HAL_UART_RxCpltCallback+0x48>)
|
|
8001698: 681b ldr r3, [r3, #0]
|
|
800169a: 2b00 cmp r3, #0
|
|
800169c: d00a beq.n 80016b4 <HAL_UART_RxCpltCallback+0x30>
|
|
800169e: 687b ldr r3, [r7, #4]
|
|
80016a0: f8d3 3090 ldr.w r3, [r3, #144] @ 0x90
|
|
80016a4: 2b00 cmp r3, #0
|
|
80016a6: d105 bne.n 80016b4 <HAL_UART_RxCpltCallback+0x30>
|
|
{
|
|
RxCpltCallback(&charRx, 1, 0);
|
|
80016a8: 4b08 ldr r3, [pc, #32] @ (80016cc <HAL_UART_RxCpltCallback+0x48>)
|
|
80016aa: 681b ldr r3, [r3, #0]
|
|
80016ac: 2200 movs r2, #0
|
|
80016ae: 2101 movs r1, #1
|
|
80016b0: 4807 ldr r0, [pc, #28] @ (80016d0 <HAL_UART_RxCpltCallback+0x4c>)
|
|
80016b2: 4798 blx r3
|
|
}
|
|
HAL_UART_Receive_IT(huart, &charRx, 1);
|
|
80016b4: 2201 movs r2, #1
|
|
80016b6: 4906 ldr r1, [pc, #24] @ (80016d0 <HAL_UART_RxCpltCallback+0x4c>)
|
|
80016b8: 6878 ldr r0, [r7, #4]
|
|
80016ba: f004 f87b bl 80057b4 <HAL_UART_Receive_IT>
|
|
}
|
|
/* USER CODE BEGIN HAL_UART_RxCpltCallback_2 */
|
|
|
|
/* USER CODE END HAL_UART_RxCpltCallback_2 */
|
|
}
|
|
80016be: bf00 nop
|
|
80016c0: 3708 adds r7, #8
|
|
80016c2: 46bd mov sp, r7
|
|
80016c4: bd80 pop {r7, pc}
|
|
80016c6: bf00 nop
|
|
80016c8: 40004400 .word 0x40004400
|
|
80016cc: 200001d8 .word 0x200001d8
|
|
80016d0: 200001d0 .word 0x200001d0
|
|
|
|
080016d4 <Reset_Handler>:
|
|
|
|
.section .text.Reset_Handler
|
|
.weak Reset_Handler
|
|
.type Reset_Handler, %function
|
|
Reset_Handler:
|
|
ldr r0, =_estack
|
|
80016d4: 480d ldr r0, [pc, #52] @ (800170c <LoopForever+0x2>)
|
|
mov sp, r0 /* set stack pointer */
|
|
80016d6: 4685 mov sp, r0
|
|
|
|
/* Call the clock system initialization function.*/
|
|
bl SystemInit
|
|
80016d8: f7ff fb7a bl 8000dd0 <SystemInit>
|
|
|
|
/* Copy the data segment initializers from flash to SRAM */
|
|
ldr r0, =_sdata
|
|
80016dc: 480c ldr r0, [pc, #48] @ (8001710 <LoopForever+0x6>)
|
|
ldr r1, =_edata
|
|
80016de: 490d ldr r1, [pc, #52] @ (8001714 <LoopForever+0xa>)
|
|
ldr r2, =_sidata
|
|
80016e0: 4a0d ldr r2, [pc, #52] @ (8001718 <LoopForever+0xe>)
|
|
movs r3, #0
|
|
80016e2: 2300 movs r3, #0
|
|
b LoopCopyDataInit
|
|
80016e4: e002 b.n 80016ec <LoopCopyDataInit>
|
|
|
|
080016e6 <CopyDataInit>:
|
|
|
|
CopyDataInit:
|
|
ldr r4, [r2, r3]
|
|
80016e6: 58d4 ldr r4, [r2, r3]
|
|
str r4, [r0, r3]
|
|
80016e8: 50c4 str r4, [r0, r3]
|
|
adds r3, r3, #4
|
|
80016ea: 3304 adds r3, #4
|
|
|
|
080016ec <LoopCopyDataInit>:
|
|
|
|
LoopCopyDataInit:
|
|
adds r4, r0, r3
|
|
80016ec: 18c4 adds r4, r0, r3
|
|
cmp r4, r1
|
|
80016ee: 428c cmp r4, r1
|
|
bcc CopyDataInit
|
|
80016f0: d3f9 bcc.n 80016e6 <CopyDataInit>
|
|
|
|
/* Zero fill the bss segment. */
|
|
ldr r2, =_sbss
|
|
80016f2: 4a0a ldr r2, [pc, #40] @ (800171c <LoopForever+0x12>)
|
|
ldr r4, =_ebss
|
|
80016f4: 4c0a ldr r4, [pc, #40] @ (8001720 <LoopForever+0x16>)
|
|
movs r3, #0
|
|
80016f6: 2300 movs r3, #0
|
|
b LoopFillZerobss
|
|
80016f8: e001 b.n 80016fe <LoopFillZerobss>
|
|
|
|
080016fa <FillZerobss>:
|
|
|
|
FillZerobss:
|
|
str r3, [r2]
|
|
80016fa: 6013 str r3, [r2, #0]
|
|
adds r2, r2, #4
|
|
80016fc: 3204 adds r2, #4
|
|
|
|
080016fe <LoopFillZerobss>:
|
|
|
|
LoopFillZerobss:
|
|
cmp r2, r4
|
|
80016fe: 42a2 cmp r2, r4
|
|
bcc FillZerobss
|
|
8001700: d3fb bcc.n 80016fa <FillZerobss>
|
|
|
|
/* Call static constructors */
|
|
bl __libc_init_array
|
|
8001702: f00d fc43 bl 800ef8c <__libc_init_array>
|
|
/* Call the application's entry point.*/
|
|
bl main
|
|
8001706: f7fe fffe bl 8000706 <main>
|
|
|
|
0800170a <LoopForever>:
|
|
|
|
LoopForever:
|
|
b LoopForever
|
|
800170a: e7fe b.n 800170a <LoopForever>
|
|
ldr r0, =_estack
|
|
800170c: 20010000 .word 0x20010000
|
|
ldr r0, =_sdata
|
|
8001710: 20000000 .word 0x20000000
|
|
ldr r1, =_edata
|
|
8001714: 2000006c .word 0x2000006c
|
|
ldr r2, =_sidata
|
|
8001718: 0801065c .word 0x0801065c
|
|
ldr r2, =_sbss
|
|
800171c: 2000006c .word 0x2000006c
|
|
ldr r4, =_ebss
|
|
8001720: 20001094 .word 0x20001094
|
|
|
|
08001724 <ADC_IRQHandler>:
|
|
* @retval : None
|
|
*/
|
|
.section .text.Default_Handler,"ax",%progbits
|
|
Default_Handler:
|
|
Infinite_Loop:
|
|
b Infinite_Loop
|
|
8001724: e7fe b.n 8001724 <ADC_IRQHandler>
|
|
|
|
08001726 <LL_AHB2_GRP1_EnableClock>:
|
|
{
|
|
8001726: b480 push {r7}
|
|
8001728: b085 sub sp, #20
|
|
800172a: af00 add r7, sp, #0
|
|
800172c: 6078 str r0, [r7, #4]
|
|
SET_BIT(RCC->AHB2ENR, Periphs);
|
|
800172e: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8001732: 6cda ldr r2, [r3, #76] @ 0x4c
|
|
8001734: f04f 41b0 mov.w r1, #1476395008 @ 0x58000000
|
|
8001738: 687b ldr r3, [r7, #4]
|
|
800173a: 4313 orrs r3, r2
|
|
800173c: 64cb str r3, [r1, #76] @ 0x4c
|
|
tmpreg = READ_BIT(RCC->AHB2ENR, Periphs);
|
|
800173e: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8001742: 6cda ldr r2, [r3, #76] @ 0x4c
|
|
8001744: 687b ldr r3, [r7, #4]
|
|
8001746: 4013 ands r3, r2
|
|
8001748: 60fb str r3, [r7, #12]
|
|
(void)tmpreg;
|
|
800174a: 68fb ldr r3, [r7, #12]
|
|
}
|
|
800174c: bf00 nop
|
|
800174e: 3714 adds r7, #20
|
|
8001750: 46bd mov sp, r7
|
|
8001752: bc80 pop {r7}
|
|
8001754: 4770 bx lr
|
|
...
|
|
|
|
08001758 <BSP_RADIO_Init>:
|
|
/**
|
|
* @brief Init Radio Switch
|
|
* @retval BSP status
|
|
*/
|
|
int32_t BSP_RADIO_Init(void)
|
|
{
|
|
8001758: b580 push {r7, lr}
|
|
800175a: b086 sub sp, #24
|
|
800175c: af00 add r7, sp, #0
|
|
GPIO_InitTypeDef gpio_init_structure = {0};
|
|
800175e: 1d3b adds r3, r7, #4
|
|
8001760: 2200 movs r2, #0
|
|
8001762: 601a str r2, [r3, #0]
|
|
8001764: 605a str r2, [r3, #4]
|
|
8001766: 609a str r2, [r3, #8]
|
|
8001768: 60da str r2, [r3, #12]
|
|
800176a: 611a str r2, [r3, #16]
|
|
|
|
/* Enable the Radio Switch Clock */
|
|
RF_SW_CTRL3_GPIO_CLK_ENABLE();
|
|
800176c: 2004 movs r0, #4
|
|
800176e: f7ff ffda bl 8001726 <LL_AHB2_GRP1_EnableClock>
|
|
|
|
/* Configure the Radio Switch pin */
|
|
gpio_init_structure.Pin = RF_SW_CTRL1_PIN;
|
|
8001772: 2310 movs r3, #16
|
|
8001774: 607b str r3, [r7, #4]
|
|
gpio_init_structure.Mode = GPIO_MODE_OUTPUT_PP;
|
|
8001776: 2301 movs r3, #1
|
|
8001778: 60bb str r3, [r7, #8]
|
|
gpio_init_structure.Pull = GPIO_NOPULL;
|
|
800177a: 2300 movs r3, #0
|
|
800177c: 60fb str r3, [r7, #12]
|
|
gpio_init_structure.Speed = GPIO_SPEED_FREQ_VERY_HIGH;
|
|
800177e: 2303 movs r3, #3
|
|
8001780: 613b str r3, [r7, #16]
|
|
|
|
HAL_GPIO_Init(RF_SW_CTRL1_GPIO_PORT, &gpio_init_structure);
|
|
8001782: 1d3b adds r3, r7, #4
|
|
8001784: 4619 mov r1, r3
|
|
8001786: 4812 ldr r0, [pc, #72] @ (80017d0 <BSP_RADIO_Init+0x78>)
|
|
8001788: f001 f870 bl 800286c <HAL_GPIO_Init>
|
|
|
|
gpio_init_structure.Pin = RF_SW_CTRL2_PIN;
|
|
800178c: 2320 movs r3, #32
|
|
800178e: 607b str r3, [r7, #4]
|
|
HAL_GPIO_Init(RF_SW_CTRL2_GPIO_PORT, &gpio_init_structure);
|
|
8001790: 1d3b adds r3, r7, #4
|
|
8001792: 4619 mov r1, r3
|
|
8001794: 480e ldr r0, [pc, #56] @ (80017d0 <BSP_RADIO_Init+0x78>)
|
|
8001796: f001 f869 bl 800286c <HAL_GPIO_Init>
|
|
|
|
gpio_init_structure.Pin = RF_SW_CTRL3_PIN;
|
|
800179a: 2308 movs r3, #8
|
|
800179c: 607b str r3, [r7, #4]
|
|
HAL_GPIO_Init(RF_SW_CTRL3_GPIO_PORT, &gpio_init_structure);
|
|
800179e: 1d3b adds r3, r7, #4
|
|
80017a0: 4619 mov r1, r3
|
|
80017a2: 480b ldr r0, [pc, #44] @ (80017d0 <BSP_RADIO_Init+0x78>)
|
|
80017a4: f001 f862 bl 800286c <HAL_GPIO_Init>
|
|
|
|
HAL_GPIO_WritePin(RF_SW_CTRL2_GPIO_PORT, RF_SW_CTRL2_PIN, GPIO_PIN_RESET);
|
|
80017a8: 2200 movs r2, #0
|
|
80017aa: 2120 movs r1, #32
|
|
80017ac: 4808 ldr r0, [pc, #32] @ (80017d0 <BSP_RADIO_Init+0x78>)
|
|
80017ae: f001 fa8b bl 8002cc8 <HAL_GPIO_WritePin>
|
|
HAL_GPIO_WritePin(RF_SW_CTRL1_GPIO_PORT, RF_SW_CTRL1_PIN, GPIO_PIN_RESET);
|
|
80017b2: 2200 movs r2, #0
|
|
80017b4: 2110 movs r1, #16
|
|
80017b6: 4806 ldr r0, [pc, #24] @ (80017d0 <BSP_RADIO_Init+0x78>)
|
|
80017b8: f001 fa86 bl 8002cc8 <HAL_GPIO_WritePin>
|
|
HAL_GPIO_WritePin(RF_SW_CTRL3_GPIO_PORT, RF_SW_CTRL3_PIN, GPIO_PIN_RESET);
|
|
80017bc: 2200 movs r2, #0
|
|
80017be: 2108 movs r1, #8
|
|
80017c0: 4803 ldr r0, [pc, #12] @ (80017d0 <BSP_RADIO_Init+0x78>)
|
|
80017c2: f001 fa81 bl 8002cc8 <HAL_GPIO_WritePin>
|
|
|
|
return BSP_ERROR_NONE;
|
|
80017c6: 2300 movs r3, #0
|
|
}
|
|
80017c8: 4618 mov r0, r3
|
|
80017ca: 3718 adds r7, #24
|
|
80017cc: 46bd mov sp, r7
|
|
80017ce: bd80 pop {r7, pc}
|
|
80017d0: 48000800 .word 0x48000800
|
|
|
|
080017d4 <BSP_RADIO_ConfigRFSwitch>:
|
|
* @arg RADIO_SWITCH_RFO_LP
|
|
* @arg RADIO_SWITCH_RFO_HP
|
|
* @retval BSP status
|
|
*/
|
|
int32_t BSP_RADIO_ConfigRFSwitch(BSP_RADIO_Switch_TypeDef Config)
|
|
{
|
|
80017d4: b580 push {r7, lr}
|
|
80017d6: b082 sub sp, #8
|
|
80017d8: af00 add r7, sp, #0
|
|
80017da: 4603 mov r3, r0
|
|
80017dc: 71fb strb r3, [r7, #7]
|
|
switch (Config)
|
|
80017de: 79fb ldrb r3, [r7, #7]
|
|
80017e0: 2b03 cmp r3, #3
|
|
80017e2: d84b bhi.n 800187c <BSP_RADIO_ConfigRFSwitch+0xa8>
|
|
80017e4: a201 add r2, pc, #4 @ (adr r2, 80017ec <BSP_RADIO_ConfigRFSwitch+0x18>)
|
|
80017e6: f852 f023 ldr.w pc, [r2, r3, lsl #2]
|
|
80017ea: bf00 nop
|
|
80017ec: 080017fd .word 0x080017fd
|
|
80017f0: 0800181d .word 0x0800181d
|
|
80017f4: 0800183d .word 0x0800183d
|
|
80017f8: 0800185d .word 0x0800185d
|
|
{
|
|
case RADIO_SWITCH_OFF:
|
|
{
|
|
/* Turn off switch */
|
|
HAL_GPIO_WritePin(RF_SW_CTRL3_GPIO_PORT, RF_SW_CTRL3_PIN, GPIO_PIN_RESET);
|
|
80017fc: 2200 movs r2, #0
|
|
80017fe: 2108 movs r1, #8
|
|
8001800: 4821 ldr r0, [pc, #132] @ (8001888 <BSP_RADIO_ConfigRFSwitch+0xb4>)
|
|
8001802: f001 fa61 bl 8002cc8 <HAL_GPIO_WritePin>
|
|
HAL_GPIO_WritePin(RF_SW_CTRL1_GPIO_PORT, RF_SW_CTRL1_PIN, GPIO_PIN_RESET);
|
|
8001806: 2200 movs r2, #0
|
|
8001808: 2110 movs r1, #16
|
|
800180a: 481f ldr r0, [pc, #124] @ (8001888 <BSP_RADIO_ConfigRFSwitch+0xb4>)
|
|
800180c: f001 fa5c bl 8002cc8 <HAL_GPIO_WritePin>
|
|
HAL_GPIO_WritePin(RF_SW_CTRL2_GPIO_PORT, RF_SW_CTRL2_PIN, GPIO_PIN_RESET);
|
|
8001810: 2200 movs r2, #0
|
|
8001812: 2120 movs r1, #32
|
|
8001814: 481c ldr r0, [pc, #112] @ (8001888 <BSP_RADIO_ConfigRFSwitch+0xb4>)
|
|
8001816: f001 fa57 bl 8002cc8 <HAL_GPIO_WritePin>
|
|
break;
|
|
800181a: e030 b.n 800187e <BSP_RADIO_ConfigRFSwitch+0xaa>
|
|
}
|
|
case RADIO_SWITCH_RX:
|
|
{
|
|
/*Turns On in Rx Mode the RF Switch */
|
|
HAL_GPIO_WritePin(RF_SW_CTRL3_GPIO_PORT, RF_SW_CTRL3_PIN, GPIO_PIN_SET);
|
|
800181c: 2201 movs r2, #1
|
|
800181e: 2108 movs r1, #8
|
|
8001820: 4819 ldr r0, [pc, #100] @ (8001888 <BSP_RADIO_ConfigRFSwitch+0xb4>)
|
|
8001822: f001 fa51 bl 8002cc8 <HAL_GPIO_WritePin>
|
|
HAL_GPIO_WritePin(RF_SW_CTRL1_GPIO_PORT, RF_SW_CTRL1_PIN, GPIO_PIN_SET);
|
|
8001826: 2201 movs r2, #1
|
|
8001828: 2110 movs r1, #16
|
|
800182a: 4817 ldr r0, [pc, #92] @ (8001888 <BSP_RADIO_ConfigRFSwitch+0xb4>)
|
|
800182c: f001 fa4c bl 8002cc8 <HAL_GPIO_WritePin>
|
|
HAL_GPIO_WritePin(RF_SW_CTRL2_GPIO_PORT, RF_SW_CTRL2_PIN, GPIO_PIN_RESET);
|
|
8001830: 2200 movs r2, #0
|
|
8001832: 2120 movs r1, #32
|
|
8001834: 4814 ldr r0, [pc, #80] @ (8001888 <BSP_RADIO_ConfigRFSwitch+0xb4>)
|
|
8001836: f001 fa47 bl 8002cc8 <HAL_GPIO_WritePin>
|
|
break;
|
|
800183a: e020 b.n 800187e <BSP_RADIO_ConfigRFSwitch+0xaa>
|
|
}
|
|
case RADIO_SWITCH_RFO_LP:
|
|
{
|
|
/*Turns On in Tx Low Power the RF Switch */
|
|
HAL_GPIO_WritePin(RF_SW_CTRL3_GPIO_PORT, RF_SW_CTRL3_PIN, GPIO_PIN_SET);
|
|
800183c: 2201 movs r2, #1
|
|
800183e: 2108 movs r1, #8
|
|
8001840: 4811 ldr r0, [pc, #68] @ (8001888 <BSP_RADIO_ConfigRFSwitch+0xb4>)
|
|
8001842: f001 fa41 bl 8002cc8 <HAL_GPIO_WritePin>
|
|
HAL_GPIO_WritePin(RF_SW_CTRL1_GPIO_PORT, RF_SW_CTRL1_PIN, GPIO_PIN_SET);
|
|
8001846: 2201 movs r2, #1
|
|
8001848: 2110 movs r1, #16
|
|
800184a: 480f ldr r0, [pc, #60] @ (8001888 <BSP_RADIO_ConfigRFSwitch+0xb4>)
|
|
800184c: f001 fa3c bl 8002cc8 <HAL_GPIO_WritePin>
|
|
HAL_GPIO_WritePin(RF_SW_CTRL2_GPIO_PORT, RF_SW_CTRL2_PIN, GPIO_PIN_SET);
|
|
8001850: 2201 movs r2, #1
|
|
8001852: 2120 movs r1, #32
|
|
8001854: 480c ldr r0, [pc, #48] @ (8001888 <BSP_RADIO_ConfigRFSwitch+0xb4>)
|
|
8001856: f001 fa37 bl 8002cc8 <HAL_GPIO_WritePin>
|
|
break;
|
|
800185a: e010 b.n 800187e <BSP_RADIO_ConfigRFSwitch+0xaa>
|
|
}
|
|
case RADIO_SWITCH_RFO_HP:
|
|
{
|
|
/*Turns On in Tx High Power the RF Switch */
|
|
HAL_GPIO_WritePin(RF_SW_CTRL3_GPIO_PORT, RF_SW_CTRL3_PIN, GPIO_PIN_SET);
|
|
800185c: 2201 movs r2, #1
|
|
800185e: 2108 movs r1, #8
|
|
8001860: 4809 ldr r0, [pc, #36] @ (8001888 <BSP_RADIO_ConfigRFSwitch+0xb4>)
|
|
8001862: f001 fa31 bl 8002cc8 <HAL_GPIO_WritePin>
|
|
HAL_GPIO_WritePin(RF_SW_CTRL1_GPIO_PORT, RF_SW_CTRL1_PIN, GPIO_PIN_RESET);
|
|
8001866: 2200 movs r2, #0
|
|
8001868: 2110 movs r1, #16
|
|
800186a: 4807 ldr r0, [pc, #28] @ (8001888 <BSP_RADIO_ConfigRFSwitch+0xb4>)
|
|
800186c: f001 fa2c bl 8002cc8 <HAL_GPIO_WritePin>
|
|
HAL_GPIO_WritePin(RF_SW_CTRL2_GPIO_PORT, RF_SW_CTRL2_PIN, GPIO_PIN_SET);
|
|
8001870: 2201 movs r2, #1
|
|
8001872: 2120 movs r1, #32
|
|
8001874: 4804 ldr r0, [pc, #16] @ (8001888 <BSP_RADIO_ConfigRFSwitch+0xb4>)
|
|
8001876: f001 fa27 bl 8002cc8 <HAL_GPIO_WritePin>
|
|
break;
|
|
800187a: e000 b.n 800187e <BSP_RADIO_ConfigRFSwitch+0xaa>
|
|
}
|
|
default:
|
|
break;
|
|
800187c: bf00 nop
|
|
}
|
|
|
|
return BSP_ERROR_NONE;
|
|
800187e: 2300 movs r3, #0
|
|
}
|
|
8001880: 4618 mov r0, r3
|
|
8001882: 3708 adds r7, #8
|
|
8001884: 46bd mov sp, r7
|
|
8001886: bd80 pop {r7, pc}
|
|
8001888: 48000800 .word 0x48000800
|
|
|
|
0800188c <BSP_RADIO_GetTxConfig>:
|
|
* RADIO_CONF_RFO_LP_HP
|
|
* RADIO_CONF_RFO_LP
|
|
* RADIO_CONF_RFO_HP
|
|
*/
|
|
int32_t BSP_RADIO_GetTxConfig(void)
|
|
{
|
|
800188c: b480 push {r7}
|
|
800188e: af00 add r7, sp, #0
|
|
return RADIO_CONF_RFO_LP_HP;
|
|
8001890: 2300 movs r3, #0
|
|
}
|
|
8001892: 4618 mov r0, r3
|
|
8001894: 46bd mov sp, r7
|
|
8001896: bc80 pop {r7}
|
|
8001898: 4770 bx lr
|
|
|
|
0800189a <BSP_RADIO_IsTCXO>:
|
|
* @retval
|
|
* RADIO_CONF_TCXO_NOT_SUPPORTED
|
|
* RADIO_CONF_TCXO_SUPPORTED
|
|
*/
|
|
int32_t BSP_RADIO_IsTCXO(void)
|
|
{
|
|
800189a: b480 push {r7}
|
|
800189c: af00 add r7, sp, #0
|
|
return RADIO_CONF_TCXO_SUPPORTED;
|
|
800189e: 2301 movs r3, #1
|
|
}
|
|
80018a0: 4618 mov r0, r3
|
|
80018a2: 46bd mov sp, r7
|
|
80018a4: bc80 pop {r7}
|
|
80018a6: 4770 bx lr
|
|
|
|
080018a8 <BSP_RADIO_IsDCDC>:
|
|
* @retval
|
|
* RADIO_CONF_DCDC_NOT_SUPPORTED
|
|
* RADIO_CONF_DCDC_SUPPORTED
|
|
*/
|
|
int32_t BSP_RADIO_IsDCDC(void)
|
|
{
|
|
80018a8: b480 push {r7}
|
|
80018aa: af00 add r7, sp, #0
|
|
return RADIO_CONF_DCDC_SUPPORTED;
|
|
80018ac: 2301 movs r3, #1
|
|
}
|
|
80018ae: 4618 mov r0, r3
|
|
80018b0: 46bd mov sp, r7
|
|
80018b2: bc80 pop {r7}
|
|
80018b4: 4770 bx lr
|
|
|
|
080018b6 <BSP_RADIO_GetRFOMaxPowerConfig>:
|
|
* @retval
|
|
* RADIO_CONF_RFO_LP_MAX_15_dBm for LP mode
|
|
* RADIO_CONF_RFO_HP_MAX_22_dBm for HP mode
|
|
*/
|
|
int32_t BSP_RADIO_GetRFOMaxPowerConfig(BSP_RADIO_RFOMaxPowerConfig_TypeDef Config)
|
|
{
|
|
80018b6: b480 push {r7}
|
|
80018b8: b085 sub sp, #20
|
|
80018ba: af00 add r7, sp, #0
|
|
80018bc: 4603 mov r3, r0
|
|
80018be: 71fb strb r3, [r7, #7]
|
|
int32_t ret;
|
|
|
|
if(Config == RADIO_RFO_LP_MAXPOWER)
|
|
80018c0: 79fb ldrb r3, [r7, #7]
|
|
80018c2: 2b00 cmp r3, #0
|
|
80018c4: d102 bne.n 80018cc <BSP_RADIO_GetRFOMaxPowerConfig+0x16>
|
|
{
|
|
ret = RADIO_CONF_RFO_LP_MAX_15_dBm;
|
|
80018c6: 230f movs r3, #15
|
|
80018c8: 60fb str r3, [r7, #12]
|
|
80018ca: e001 b.n 80018d0 <BSP_RADIO_GetRFOMaxPowerConfig+0x1a>
|
|
}
|
|
else
|
|
{
|
|
ret = RADIO_CONF_RFO_HP_MAX_22_dBm;
|
|
80018cc: 2316 movs r3, #22
|
|
80018ce: 60fb str r3, [r7, #12]
|
|
}
|
|
|
|
return ret;
|
|
80018d0: 68fb ldr r3, [r7, #12]
|
|
}
|
|
80018d2: 4618 mov r0, r3
|
|
80018d4: 3714 adds r7, #20
|
|
80018d6: 46bd mov sp, r7
|
|
80018d8: bc80 pop {r7}
|
|
80018da: 4770 bx lr
|
|
|
|
080018dc <LL_DBGMCU_EnableDBGSleepMode>:
|
|
* @brief Enable the CPU1 Debug Module during SLEEP mode
|
|
* @rmtoll DBGMCU_CR DBG_SLEEP LL_DBGMCU_EnableDBGSleepMode
|
|
* @retval None
|
|
*/
|
|
__STATIC_INLINE void LL_DBGMCU_EnableDBGSleepMode(void)
|
|
{
|
|
80018dc: b480 push {r7}
|
|
80018de: af00 add r7, sp, #0
|
|
SET_BIT(DBGMCU->CR, DBGMCU_CR_DBG_SLEEP);
|
|
80018e0: 4b04 ldr r3, [pc, #16] @ (80018f4 <LL_DBGMCU_EnableDBGSleepMode+0x18>)
|
|
80018e2: 685b ldr r3, [r3, #4]
|
|
80018e4: 4a03 ldr r2, [pc, #12] @ (80018f4 <LL_DBGMCU_EnableDBGSleepMode+0x18>)
|
|
80018e6: f043 0301 orr.w r3, r3, #1
|
|
80018ea: 6053 str r3, [r2, #4]
|
|
}
|
|
80018ec: bf00 nop
|
|
80018ee: 46bd mov sp, r7
|
|
80018f0: bc80 pop {r7}
|
|
80018f2: 4770 bx lr
|
|
80018f4: e0042000 .word 0xe0042000
|
|
|
|
080018f8 <LL_DBGMCU_EnableDBGStopMode>:
|
|
* in Stop mode even when this bit is enabled
|
|
* @rmtoll DBGMCU_CR DBG_STOP LL_DBGMCU_EnableDBGStopMode
|
|
* @retval None
|
|
*/
|
|
__STATIC_INLINE void LL_DBGMCU_EnableDBGStopMode(void)
|
|
{
|
|
80018f8: b480 push {r7}
|
|
80018fa: af00 add r7, sp, #0
|
|
SET_BIT(DBGMCU->CR, DBGMCU_CR_DBG_STOP);
|
|
80018fc: 4b04 ldr r3, [pc, #16] @ (8001910 <LL_DBGMCU_EnableDBGStopMode+0x18>)
|
|
80018fe: 685b ldr r3, [r3, #4]
|
|
8001900: 4a03 ldr r2, [pc, #12] @ (8001910 <LL_DBGMCU_EnableDBGStopMode+0x18>)
|
|
8001902: f043 0302 orr.w r3, r3, #2
|
|
8001906: 6053 str r3, [r2, #4]
|
|
}
|
|
8001908: bf00 nop
|
|
800190a: 46bd mov sp, r7
|
|
800190c: bc80 pop {r7}
|
|
800190e: 4770 bx lr
|
|
8001910: e0042000 .word 0xe0042000
|
|
|
|
08001914 <LL_DBGMCU_EnableDBGStandbyMode>:
|
|
* in Standby mode even when this bit is enabled
|
|
* @rmtoll DBGMCU_CR DBG_STANDBY LL_DBGMCU_EnableDBGStandbyMode
|
|
* @retval None
|
|
*/
|
|
__STATIC_INLINE void LL_DBGMCU_EnableDBGStandbyMode(void)
|
|
{
|
|
8001914: b480 push {r7}
|
|
8001916: af00 add r7, sp, #0
|
|
SET_BIT(DBGMCU->CR, DBGMCU_CR_DBG_STANDBY);
|
|
8001918: 4b04 ldr r3, [pc, #16] @ (800192c <LL_DBGMCU_EnableDBGStandbyMode+0x18>)
|
|
800191a: 685b ldr r3, [r3, #4]
|
|
800191c: 4a03 ldr r2, [pc, #12] @ (800192c <LL_DBGMCU_EnableDBGStandbyMode+0x18>)
|
|
800191e: f043 0304 orr.w r3, r3, #4
|
|
8001922: 6053 str r3, [r2, #4]
|
|
}
|
|
8001924: bf00 nop
|
|
8001926: 46bd mov sp, r7
|
|
8001928: bc80 pop {r7}
|
|
800192a: 4770 bx lr
|
|
800192c: e0042000 .word 0xe0042000
|
|
|
|
08001930 <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)
|
|
{
|
|
8001930: b580 push {r7, lr}
|
|
8001932: b082 sub sp, #8
|
|
8001934: af00 add r7, sp, #0
|
|
HAL_StatusTypeDef status = HAL_OK;
|
|
8001936: 2300 movs r3, #0
|
|
8001938: 71fb strb r3, [r7, #7]
|
|
#endif /* PREFETCH_ENABLE */
|
|
|
|
#ifdef CORE_CM0PLUS
|
|
#else
|
|
/* Set Interrupt Group Priority */
|
|
HAL_NVIC_SetPriorityGrouping(NVIC_PRIORITYGROUP_4);
|
|
800193a: 2003 movs r0, #3
|
|
800193c: f000 f914 bl 8001b68 <HAL_NVIC_SetPriorityGrouping>
|
|
|
|
/* Update the SystemCoreClock global variable */
|
|
#if defined(DUAL_CORE) && defined(CORE_CM0PLUS)
|
|
SystemCoreClock = HAL_RCC_GetHCLK2Freq();
|
|
#else
|
|
SystemCoreClock = HAL_RCC_GetHCLKFreq();
|
|
8001940: f002 fad4 bl 8003eec <HAL_RCC_GetHCLKFreq>
|
|
8001944: 4603 mov r3, r0
|
|
8001946: 4a09 ldr r2, [pc, #36] @ (800196c <HAL_Init+0x3c>)
|
|
8001948: 6013 str r3, [r2, #0]
|
|
#endif
|
|
|
|
/* Use SysTick as time base source and configure 1ms tick (default clock after Reset is MSI) */
|
|
if (HAL_InitTick(TICK_INT_PRIORITY) != HAL_OK)
|
|
800194a: 200f movs r0, #15
|
|
800194c: f7ff f972 bl 8000c34 <HAL_InitTick>
|
|
8001950: 4603 mov r3, r0
|
|
8001952: 2b00 cmp r3, #0
|
|
8001954: d002 beq.n 800195c <HAL_Init+0x2c>
|
|
{
|
|
status = HAL_ERROR;
|
|
8001956: 2301 movs r3, #1
|
|
8001958: 71fb strb r3, [r7, #7]
|
|
800195a: e001 b.n 8001960 <HAL_Init+0x30>
|
|
}
|
|
else
|
|
{
|
|
/* Init the low level hardware */
|
|
HAL_MspInit();
|
|
800195c: f7ff f82f bl 80009be <HAL_MspInit>
|
|
}
|
|
|
|
/* Return function status */
|
|
return status;
|
|
8001960: 79fb ldrb r3, [r7, #7]
|
|
}
|
|
8001962: 4618 mov r0, r3
|
|
8001964: 3708 adds r7, #8
|
|
8001966: 46bd mov sp, r7
|
|
8001968: bd80 pop {r7, pc}
|
|
800196a: bf00 nop
|
|
800196c: 20000000 .word 0x20000000
|
|
|
|
08001970 <HAL_SuspendTick>:
|
|
* @note This function is declared as __weak to be overwritten in case of other
|
|
* implementations in user file.
|
|
* @retval None
|
|
*/
|
|
__weak void HAL_SuspendTick(void)
|
|
{
|
|
8001970: b480 push {r7}
|
|
8001972: af00 add r7, sp, #0
|
|
/* Disable SysTick Interrupt */
|
|
CLEAR_BIT(SysTick->CTRL, SysTick_CTRL_TICKINT_Msk);
|
|
8001974: 4b04 ldr r3, [pc, #16] @ (8001988 <HAL_SuspendTick+0x18>)
|
|
8001976: 681b ldr r3, [r3, #0]
|
|
8001978: 4a03 ldr r2, [pc, #12] @ (8001988 <HAL_SuspendTick+0x18>)
|
|
800197a: f023 0302 bic.w r3, r3, #2
|
|
800197e: 6013 str r3, [r2, #0]
|
|
}
|
|
8001980: bf00 nop
|
|
8001982: 46bd mov sp, r7
|
|
8001984: bc80 pop {r7}
|
|
8001986: 4770 bx lr
|
|
8001988: e000e010 .word 0xe000e010
|
|
|
|
0800198c <HAL_ResumeTick>:
|
|
* @note This function is declared as __weak to be overwritten in case of other
|
|
* implementations in user file.
|
|
* @retval None
|
|
*/
|
|
__weak void HAL_ResumeTick(void)
|
|
{
|
|
800198c: b480 push {r7}
|
|
800198e: af00 add r7, sp, #0
|
|
/* Enable SysTick Interrupt */
|
|
SET_BIT(SysTick->CTRL, SysTick_CTRL_TICKINT_Msk);
|
|
8001990: 4b04 ldr r3, [pc, #16] @ (80019a4 <HAL_ResumeTick+0x18>)
|
|
8001992: 681b ldr r3, [r3, #0]
|
|
8001994: 4a03 ldr r2, [pc, #12] @ (80019a4 <HAL_ResumeTick+0x18>)
|
|
8001996: f043 0302 orr.w r3, r3, #2
|
|
800199a: 6013 str r3, [r2, #0]
|
|
}
|
|
800199c: bf00 nop
|
|
800199e: 46bd mov sp, r7
|
|
80019a0: bc80 pop {r7}
|
|
80019a2: 4770 bx lr
|
|
80019a4: e000e010 .word 0xe000e010
|
|
|
|
080019a8 <HAL_DBGMCU_EnableDBGSleepMode>:
|
|
/**
|
|
* @brief Enable the CPU1 Debug Module during SLEEP mode
|
|
* @retval None
|
|
*/
|
|
void HAL_DBGMCU_EnableDBGSleepMode(void)
|
|
{
|
|
80019a8: b580 push {r7, lr}
|
|
80019aa: af00 add r7, sp, #0
|
|
LL_DBGMCU_EnableDBGSleepMode();
|
|
80019ac: f7ff ff96 bl 80018dc <LL_DBGMCU_EnableDBGSleepMode>
|
|
}
|
|
80019b0: bf00 nop
|
|
80019b2: bd80 pop {r7, pc}
|
|
|
|
080019b4 <HAL_DBGMCU_EnableDBGStopMode>:
|
|
* @note This functionality does not influence CPU2 operation, CPU2 cannot be debugged
|
|
* in Stop mode even when this bit is enabled
|
|
* @retval None
|
|
*/
|
|
void HAL_DBGMCU_EnableDBGStopMode(void)
|
|
{
|
|
80019b4: b580 push {r7, lr}
|
|
80019b6: af00 add r7, sp, #0
|
|
LL_DBGMCU_EnableDBGStopMode();
|
|
80019b8: f7ff ff9e bl 80018f8 <LL_DBGMCU_EnableDBGStopMode>
|
|
}
|
|
80019bc: bf00 nop
|
|
80019be: bd80 pop {r7, pc}
|
|
|
|
080019c0 <HAL_DBGMCU_EnableDBGStandbyMode>:
|
|
* @note This functionality does not influence CPU2 operation, CPU2 cannot be debugged
|
|
* in Standby mode even when this bit is enabled
|
|
* @retval None
|
|
*/
|
|
void HAL_DBGMCU_EnableDBGStandbyMode(void)
|
|
{
|
|
80019c0: b580 push {r7, lr}
|
|
80019c2: af00 add r7, sp, #0
|
|
LL_DBGMCU_EnableDBGStandbyMode();
|
|
80019c4: f7ff ffa6 bl 8001914 <LL_DBGMCU_EnableDBGStandbyMode>
|
|
}
|
|
80019c8: bf00 nop
|
|
80019ca: bd80 pop {r7, pc}
|
|
|
|
080019cc <__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)
|
|
{
|
|
80019cc: b480 push {r7}
|
|
80019ce: b085 sub sp, #20
|
|
80019d0: af00 add r7, sp, #0
|
|
80019d2: 6078 str r0, [r7, #4]
|
|
uint32_t reg_value;
|
|
uint32_t PriorityGroupTmp = (PriorityGroup & (uint32_t)0x07UL); /* only values 0..7 are used */
|
|
80019d4: 687b ldr r3, [r7, #4]
|
|
80019d6: f003 0307 and.w r3, r3, #7
|
|
80019da: 60fb str r3, [r7, #12]
|
|
|
|
reg_value = SCB->AIRCR; /* read old register configuration */
|
|
80019dc: 4b0c ldr r3, [pc, #48] @ (8001a10 <__NVIC_SetPriorityGrouping+0x44>)
|
|
80019de: 68db ldr r3, [r3, #12]
|
|
80019e0: 60bb str r3, [r7, #8]
|
|
reg_value &= ~((uint32_t)(SCB_AIRCR_VECTKEY_Msk | SCB_AIRCR_PRIGROUP_Msk)); /* clear bits to change */
|
|
80019e2: 68ba ldr r2, [r7, #8]
|
|
80019e4: f64f 03ff movw r3, #63743 @ 0xf8ff
|
|
80019e8: 4013 ands r3, r2
|
|
80019ea: 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 */
|
|
80019ec: 68fb ldr r3, [r7, #12]
|
|
80019ee: 021a lsls r2, r3, #8
|
|
((uint32_t)0x5FAUL << SCB_AIRCR_VECTKEY_Pos) |
|
|
80019f0: 68bb ldr r3, [r7, #8]
|
|
80019f2: 4313 orrs r3, r2
|
|
reg_value = (reg_value |
|
|
80019f4: f043 63bf orr.w r3, r3, #100139008 @ 0x5f80000
|
|
80019f8: f443 3300 orr.w r3, r3, #131072 @ 0x20000
|
|
80019fc: 60bb str r3, [r7, #8]
|
|
SCB->AIRCR = reg_value;
|
|
80019fe: 4a04 ldr r2, [pc, #16] @ (8001a10 <__NVIC_SetPriorityGrouping+0x44>)
|
|
8001a00: 68bb ldr r3, [r7, #8]
|
|
8001a02: 60d3 str r3, [r2, #12]
|
|
}
|
|
8001a04: bf00 nop
|
|
8001a06: 3714 adds r7, #20
|
|
8001a08: 46bd mov sp, r7
|
|
8001a0a: bc80 pop {r7}
|
|
8001a0c: 4770 bx lr
|
|
8001a0e: bf00 nop
|
|
8001a10: e000ed00 .word 0xe000ed00
|
|
|
|
08001a14 <__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)
|
|
{
|
|
8001a14: b480 push {r7}
|
|
8001a16: af00 add r7, sp, #0
|
|
return ((uint32_t)((SCB->AIRCR & SCB_AIRCR_PRIGROUP_Msk) >> SCB_AIRCR_PRIGROUP_Pos));
|
|
8001a18: 4b04 ldr r3, [pc, #16] @ (8001a2c <__NVIC_GetPriorityGrouping+0x18>)
|
|
8001a1a: 68db ldr r3, [r3, #12]
|
|
8001a1c: 0a1b lsrs r3, r3, #8
|
|
8001a1e: f003 0307 and.w r3, r3, #7
|
|
}
|
|
8001a22: 4618 mov r0, r3
|
|
8001a24: 46bd mov sp, r7
|
|
8001a26: bc80 pop {r7}
|
|
8001a28: 4770 bx lr
|
|
8001a2a: bf00 nop
|
|
8001a2c: e000ed00 .word 0xe000ed00
|
|
|
|
08001a30 <__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)
|
|
{
|
|
8001a30: b480 push {r7}
|
|
8001a32: b083 sub sp, #12
|
|
8001a34: af00 add r7, sp, #0
|
|
8001a36: 4603 mov r3, r0
|
|
8001a38: 71fb strb r3, [r7, #7]
|
|
if ((int32_t)(IRQn) >= 0)
|
|
8001a3a: f997 3007 ldrsb.w r3, [r7, #7]
|
|
8001a3e: 2b00 cmp r3, #0
|
|
8001a40: db0b blt.n 8001a5a <__NVIC_EnableIRQ+0x2a>
|
|
{
|
|
__COMPILER_BARRIER();
|
|
NVIC->ISER[(((uint32_t)IRQn) >> 5UL)] = (uint32_t)(1UL << (((uint32_t)IRQn) & 0x1FUL));
|
|
8001a42: 79fb ldrb r3, [r7, #7]
|
|
8001a44: f003 021f and.w r2, r3, #31
|
|
8001a48: 4906 ldr r1, [pc, #24] @ (8001a64 <__NVIC_EnableIRQ+0x34>)
|
|
8001a4a: f997 3007 ldrsb.w r3, [r7, #7]
|
|
8001a4e: 095b lsrs r3, r3, #5
|
|
8001a50: 2001 movs r0, #1
|
|
8001a52: fa00 f202 lsl.w r2, r0, r2
|
|
8001a56: f841 2023 str.w r2, [r1, r3, lsl #2]
|
|
__COMPILER_BARRIER();
|
|
}
|
|
}
|
|
8001a5a: bf00 nop
|
|
8001a5c: 370c adds r7, #12
|
|
8001a5e: 46bd mov sp, r7
|
|
8001a60: bc80 pop {r7}
|
|
8001a62: 4770 bx lr
|
|
8001a64: e000e100 .word 0xe000e100
|
|
|
|
08001a68 <__NVIC_DisableIRQ>:
|
|
\details Disables 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_DisableIRQ(IRQn_Type IRQn)
|
|
{
|
|
8001a68: b480 push {r7}
|
|
8001a6a: b083 sub sp, #12
|
|
8001a6c: af00 add r7, sp, #0
|
|
8001a6e: 4603 mov r3, r0
|
|
8001a70: 71fb strb r3, [r7, #7]
|
|
if ((int32_t)(IRQn) >= 0)
|
|
8001a72: f997 3007 ldrsb.w r3, [r7, #7]
|
|
8001a76: 2b00 cmp r3, #0
|
|
8001a78: db12 blt.n 8001aa0 <__NVIC_DisableIRQ+0x38>
|
|
{
|
|
NVIC->ICER[(((uint32_t)IRQn) >> 5UL)] = (uint32_t)(1UL << (((uint32_t)IRQn) & 0x1FUL));
|
|
8001a7a: 79fb ldrb r3, [r7, #7]
|
|
8001a7c: f003 021f and.w r2, r3, #31
|
|
8001a80: 490a ldr r1, [pc, #40] @ (8001aac <__NVIC_DisableIRQ+0x44>)
|
|
8001a82: f997 3007 ldrsb.w r3, [r7, #7]
|
|
8001a86: 095b lsrs r3, r3, #5
|
|
8001a88: 2001 movs r0, #1
|
|
8001a8a: fa00 f202 lsl.w r2, r0, r2
|
|
8001a8e: 3320 adds r3, #32
|
|
8001a90: f841 2023 str.w r2, [r1, r3, lsl #2]
|
|
\details Acts as a special kind of Data Memory Barrier.
|
|
It completes when all explicit memory accesses before this instruction complete.
|
|
*/
|
|
__STATIC_FORCEINLINE void __DSB(void)
|
|
{
|
|
__ASM volatile ("dsb 0xF":::"memory");
|
|
8001a94: f3bf 8f4f dsb sy
|
|
}
|
|
8001a98: bf00 nop
|
|
__ASM volatile ("isb 0xF":::"memory");
|
|
8001a9a: f3bf 8f6f isb sy
|
|
}
|
|
8001a9e: bf00 nop
|
|
__DSB();
|
|
__ISB();
|
|
}
|
|
}
|
|
8001aa0: bf00 nop
|
|
8001aa2: 370c adds r7, #12
|
|
8001aa4: 46bd mov sp, r7
|
|
8001aa6: bc80 pop {r7}
|
|
8001aa8: 4770 bx lr
|
|
8001aaa: bf00 nop
|
|
8001aac: e000e100 .word 0xe000e100
|
|
|
|
08001ab0 <__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)
|
|
{
|
|
8001ab0: b480 push {r7}
|
|
8001ab2: b083 sub sp, #12
|
|
8001ab4: af00 add r7, sp, #0
|
|
8001ab6: 4603 mov r3, r0
|
|
8001ab8: 6039 str r1, [r7, #0]
|
|
8001aba: 71fb strb r3, [r7, #7]
|
|
if ((int32_t)(IRQn) >= 0)
|
|
8001abc: f997 3007 ldrsb.w r3, [r7, #7]
|
|
8001ac0: 2b00 cmp r3, #0
|
|
8001ac2: db0a blt.n 8001ada <__NVIC_SetPriority+0x2a>
|
|
{
|
|
NVIC->IP[((uint32_t)IRQn)] = (uint8_t)((priority << (8U - __NVIC_PRIO_BITS)) & (uint32_t)0xFFUL);
|
|
8001ac4: 683b ldr r3, [r7, #0]
|
|
8001ac6: b2da uxtb r2, r3
|
|
8001ac8: 490c ldr r1, [pc, #48] @ (8001afc <__NVIC_SetPriority+0x4c>)
|
|
8001aca: f997 3007 ldrsb.w r3, [r7, #7]
|
|
8001ace: 0112 lsls r2, r2, #4
|
|
8001ad0: b2d2 uxtb r2, r2
|
|
8001ad2: 440b add r3, r1
|
|
8001ad4: 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);
|
|
}
|
|
}
|
|
8001ad8: e00a b.n 8001af0 <__NVIC_SetPriority+0x40>
|
|
SCB->SHP[(((uint32_t)IRQn) & 0xFUL)-4UL] = (uint8_t)((priority << (8U - __NVIC_PRIO_BITS)) & (uint32_t)0xFFUL);
|
|
8001ada: 683b ldr r3, [r7, #0]
|
|
8001adc: b2da uxtb r2, r3
|
|
8001ade: 4908 ldr r1, [pc, #32] @ (8001b00 <__NVIC_SetPriority+0x50>)
|
|
8001ae0: 79fb ldrb r3, [r7, #7]
|
|
8001ae2: f003 030f and.w r3, r3, #15
|
|
8001ae6: 3b04 subs r3, #4
|
|
8001ae8: 0112 lsls r2, r2, #4
|
|
8001aea: b2d2 uxtb r2, r2
|
|
8001aec: 440b add r3, r1
|
|
8001aee: 761a strb r2, [r3, #24]
|
|
}
|
|
8001af0: bf00 nop
|
|
8001af2: 370c adds r7, #12
|
|
8001af4: 46bd mov sp, r7
|
|
8001af6: bc80 pop {r7}
|
|
8001af8: 4770 bx lr
|
|
8001afa: bf00 nop
|
|
8001afc: e000e100 .word 0xe000e100
|
|
8001b00: e000ed00 .word 0xe000ed00
|
|
|
|
08001b04 <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)
|
|
{
|
|
8001b04: b480 push {r7}
|
|
8001b06: b089 sub sp, #36 @ 0x24
|
|
8001b08: af00 add r7, sp, #0
|
|
8001b0a: 60f8 str r0, [r7, #12]
|
|
8001b0c: 60b9 str r1, [r7, #8]
|
|
8001b0e: 607a str r2, [r7, #4]
|
|
uint32_t PriorityGroupTmp = (PriorityGroup & (uint32_t)0x07UL); /* only values 0..7 are used */
|
|
8001b10: 68fb ldr r3, [r7, #12]
|
|
8001b12: f003 0307 and.w r3, r3, #7
|
|
8001b16: 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);
|
|
8001b18: 69fb ldr r3, [r7, #28]
|
|
8001b1a: f1c3 0307 rsb r3, r3, #7
|
|
8001b1e: 2b04 cmp r3, #4
|
|
8001b20: bf28 it cs
|
|
8001b22: 2304 movcs r3, #4
|
|
8001b24: 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));
|
|
8001b26: 69fb ldr r3, [r7, #28]
|
|
8001b28: 3304 adds r3, #4
|
|
8001b2a: 2b06 cmp r3, #6
|
|
8001b2c: d902 bls.n 8001b34 <NVIC_EncodePriority+0x30>
|
|
8001b2e: 69fb ldr r3, [r7, #28]
|
|
8001b30: 3b03 subs r3, #3
|
|
8001b32: e000 b.n 8001b36 <NVIC_EncodePriority+0x32>
|
|
8001b34: 2300 movs r3, #0
|
|
8001b36: 617b str r3, [r7, #20]
|
|
|
|
return (
|
|
((PreemptPriority & (uint32_t)((1UL << (PreemptPriorityBits)) - 1UL)) << SubPriorityBits) |
|
|
8001b38: f04f 32ff mov.w r2, #4294967295 @ 0xffffffff
|
|
8001b3c: 69bb ldr r3, [r7, #24]
|
|
8001b3e: fa02 f303 lsl.w r3, r2, r3
|
|
8001b42: 43da mvns r2, r3
|
|
8001b44: 68bb ldr r3, [r7, #8]
|
|
8001b46: 401a ands r2, r3
|
|
8001b48: 697b ldr r3, [r7, #20]
|
|
8001b4a: 409a lsls r2, r3
|
|
((SubPriority & (uint32_t)((1UL << (SubPriorityBits )) - 1UL)))
|
|
8001b4c: f04f 31ff mov.w r1, #4294967295 @ 0xffffffff
|
|
8001b50: 697b ldr r3, [r7, #20]
|
|
8001b52: fa01 f303 lsl.w r3, r1, r3
|
|
8001b56: 43d9 mvns r1, r3
|
|
8001b58: 687b ldr r3, [r7, #4]
|
|
8001b5a: 400b ands r3, r1
|
|
((PreemptPriority & (uint32_t)((1UL << (PreemptPriorityBits)) - 1UL)) << SubPriorityBits) |
|
|
8001b5c: 4313 orrs r3, r2
|
|
);
|
|
}
|
|
8001b5e: 4618 mov r0, r3
|
|
8001b60: 3724 adds r7, #36 @ 0x24
|
|
8001b62: 46bd mov sp, r7
|
|
8001b64: bc80 pop {r7}
|
|
8001b66: 4770 bx lr
|
|
|
|
08001b68 <HAL_NVIC_SetPriorityGrouping>:
|
|
* @note When the NVIC_PriorityGroup_0 is selected, IRQ pre-emption is no more possible.
|
|
* The pending IRQ priority will be managed only by the subpriority.
|
|
* @retval None
|
|
*/
|
|
void HAL_NVIC_SetPriorityGrouping(uint32_t PriorityGroup)
|
|
{
|
|
8001b68: b580 push {r7, lr}
|
|
8001b6a: b082 sub sp, #8
|
|
8001b6c: af00 add r7, sp, #0
|
|
8001b6e: 6078 str r0, [r7, #4]
|
|
/* Check the parameters */
|
|
assert_param(IS_NVIC_PRIORITY_GROUP(PriorityGroup));
|
|
|
|
/* Set the PRIGROUP[10:8] bits according to the PriorityGroup parameter value */
|
|
NVIC_SetPriorityGrouping(PriorityGroup);
|
|
8001b70: 6878 ldr r0, [r7, #4]
|
|
8001b72: f7ff ff2b bl 80019cc <__NVIC_SetPriorityGrouping>
|
|
}
|
|
8001b76: bf00 nop
|
|
8001b78: 3708 adds r7, #8
|
|
8001b7a: 46bd mov sp, r7
|
|
8001b7c: bd80 pop {r7, pc}
|
|
|
|
08001b7e <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)
|
|
{
|
|
8001b7e: b580 push {r7, lr}
|
|
8001b80: b086 sub sp, #24
|
|
8001b82: af00 add r7, sp, #0
|
|
8001b84: 4603 mov r3, r0
|
|
8001b86: 60b9 str r1, [r7, #8]
|
|
8001b88: 607a str r2, [r7, #4]
|
|
8001b8a: 73fb strb r3, [r7, #15]
|
|
|
|
/* Check the parameters */
|
|
assert_param(IS_NVIC_SUB_PRIORITY(SubPriority));
|
|
assert_param(IS_NVIC_PREEMPTION_PRIORITY(PreemptPriority));
|
|
|
|
prioritygroup = NVIC_GetPriorityGrouping();
|
|
8001b8c: f7ff ff42 bl 8001a14 <__NVIC_GetPriorityGrouping>
|
|
8001b90: 6178 str r0, [r7, #20]
|
|
|
|
NVIC_SetPriority(IRQn, NVIC_EncodePriority(prioritygroup, PreemptPriority, SubPriority));
|
|
8001b92: 687a ldr r2, [r7, #4]
|
|
8001b94: 68b9 ldr r1, [r7, #8]
|
|
8001b96: 6978 ldr r0, [r7, #20]
|
|
8001b98: f7ff ffb4 bl 8001b04 <NVIC_EncodePriority>
|
|
8001b9c: 4602 mov r2, r0
|
|
8001b9e: f997 300f ldrsb.w r3, [r7, #15]
|
|
8001ba2: 4611 mov r1, r2
|
|
8001ba4: 4618 mov r0, r3
|
|
8001ba6: f7ff ff83 bl 8001ab0 <__NVIC_SetPriority>
|
|
}
|
|
8001baa: bf00 nop
|
|
8001bac: 3718 adds r7, #24
|
|
8001bae: 46bd mov sp, r7
|
|
8001bb0: bd80 pop {r7, pc}
|
|
|
|
08001bb2 <HAL_NVIC_EnableIRQ>:
|
|
* (For the complete STM32 Devices IRQ Channels list, please refer
|
|
* to the appropriate CMSIS device file (stm32wlxxxx.h))
|
|
* @retval None
|
|
*/
|
|
void HAL_NVIC_EnableIRQ(IRQn_Type IRQn)
|
|
{
|
|
8001bb2: b580 push {r7, lr}
|
|
8001bb4: b082 sub sp, #8
|
|
8001bb6: af00 add r7, sp, #0
|
|
8001bb8: 4603 mov r3, r0
|
|
8001bba: 71fb strb r3, [r7, #7]
|
|
/* Check the parameters */
|
|
assert_param(IS_NVIC_DEVICE_IRQ(IRQn));
|
|
|
|
/* Enable interrupt */
|
|
NVIC_EnableIRQ(IRQn);
|
|
8001bbc: f997 3007 ldrsb.w r3, [r7, #7]
|
|
8001bc0: 4618 mov r0, r3
|
|
8001bc2: f7ff ff35 bl 8001a30 <__NVIC_EnableIRQ>
|
|
}
|
|
8001bc6: bf00 nop
|
|
8001bc8: 3708 adds r7, #8
|
|
8001bca: 46bd mov sp, r7
|
|
8001bcc: bd80 pop {r7, pc}
|
|
|
|
08001bce <HAL_NVIC_DisableIRQ>:
|
|
* (For the complete STM32 Devices IRQ Channels list, please refer
|
|
* to the appropriate CMSIS device file (stm32wlxxxx.h))
|
|
* @retval None
|
|
*/
|
|
void HAL_NVIC_DisableIRQ(IRQn_Type IRQn)
|
|
{
|
|
8001bce: b580 push {r7, lr}
|
|
8001bd0: b082 sub sp, #8
|
|
8001bd2: af00 add r7, sp, #0
|
|
8001bd4: 4603 mov r3, r0
|
|
8001bd6: 71fb strb r3, [r7, #7]
|
|
/* Check the parameters */
|
|
assert_param(IS_NVIC_DEVICE_IRQ(IRQn));
|
|
|
|
/* Disable interrupt */
|
|
NVIC_DisableIRQ(IRQn);
|
|
8001bd8: f997 3007 ldrsb.w r3, [r7, #7]
|
|
8001bdc: 4618 mov r0, r3
|
|
8001bde: f7ff ff43 bl 8001a68 <__NVIC_DisableIRQ>
|
|
}
|
|
8001be2: bf00 nop
|
|
8001be4: 3708 adds r7, #8
|
|
8001be6: 46bd mov sp, r7
|
|
8001be8: bd80 pop {r7, pc}
|
|
...
|
|
|
|
08001bec <HAL_DMA_Init>:
|
|
* @param hdma Pointer to a DMA_HandleTypeDef structure that contains
|
|
* the configuration information for the specified DMA Channel.
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_DMA_Init(DMA_HandleTypeDef *hdma)
|
|
{
|
|
8001bec: b580 push {r7, lr}
|
|
8001bee: b082 sub sp, #8
|
|
8001bf0: af00 add r7, sp, #0
|
|
8001bf2: 6078 str r0, [r7, #4]
|
|
/* Check the DMA handle allocation */
|
|
if (hdma == NULL)
|
|
8001bf4: 687b ldr r3, [r7, #4]
|
|
8001bf6: 2b00 cmp r3, #0
|
|
8001bf8: d101 bne.n 8001bfe <HAL_DMA_Init+0x12>
|
|
{
|
|
return HAL_ERROR;
|
|
8001bfa: 2301 movs r3, #1
|
|
8001bfc: e08e b.n 8001d1c <HAL_DMA_Init+0x130>
|
|
assert_param(IS_DMA_PRIORITY(hdma->Init.Priority));
|
|
|
|
assert_param(IS_DMA_ALL_REQUEST(hdma->Init.Request));
|
|
|
|
/* Compute the channel index */
|
|
if ((uint32_t)(hdma->Instance) < (uint32_t)(DMA2_Channel1))
|
|
8001bfe: 687b ldr r3, [r7, #4]
|
|
8001c00: 681b ldr r3, [r3, #0]
|
|
8001c02: 461a mov r2, r3
|
|
8001c04: 4b47 ldr r3, [pc, #284] @ (8001d24 <HAL_DMA_Init+0x138>)
|
|
8001c06: 429a cmp r2, r3
|
|
8001c08: d80f bhi.n 8001c2a <HAL_DMA_Init+0x3e>
|
|
{
|
|
/* DMA1 */
|
|
hdma->ChannelIndex = (((uint32_t)hdma->Instance - (uint32_t)DMA1_Channel1) / ((uint32_t)DMA1_Channel2 - (uint32_t)DMA1_Channel1)) << 2U;
|
|
8001c0a: 687b ldr r3, [r7, #4]
|
|
8001c0c: 681b ldr r3, [r3, #0]
|
|
8001c0e: 461a mov r2, r3
|
|
8001c10: 4b45 ldr r3, [pc, #276] @ (8001d28 <HAL_DMA_Init+0x13c>)
|
|
8001c12: 4413 add r3, r2
|
|
8001c14: 4a45 ldr r2, [pc, #276] @ (8001d2c <HAL_DMA_Init+0x140>)
|
|
8001c16: fba2 2303 umull r2, r3, r2, r3
|
|
8001c1a: 091b lsrs r3, r3, #4
|
|
8001c1c: 009a lsls r2, r3, #2
|
|
8001c1e: 687b ldr r3, [r7, #4]
|
|
8001c20: 645a str r2, [r3, #68] @ 0x44
|
|
hdma->DmaBaseAddress = DMA1;
|
|
8001c22: 687b ldr r3, [r7, #4]
|
|
8001c24: 4a42 ldr r2, [pc, #264] @ (8001d30 <HAL_DMA_Init+0x144>)
|
|
8001c26: 641a str r2, [r3, #64] @ 0x40
|
|
8001c28: e00e b.n 8001c48 <HAL_DMA_Init+0x5c>
|
|
}
|
|
else
|
|
{
|
|
/* DMA2 */
|
|
hdma->ChannelIndex = (((uint32_t)hdma->Instance - (uint32_t)DMA2_Channel1) / ((uint32_t)DMA2_Channel2 - (uint32_t)DMA2_Channel1)) << 2U;
|
|
8001c2a: 687b ldr r3, [r7, #4]
|
|
8001c2c: 681b ldr r3, [r3, #0]
|
|
8001c2e: 461a mov r2, r3
|
|
8001c30: 4b40 ldr r3, [pc, #256] @ (8001d34 <HAL_DMA_Init+0x148>)
|
|
8001c32: 4413 add r3, r2
|
|
8001c34: 4a3d ldr r2, [pc, #244] @ (8001d2c <HAL_DMA_Init+0x140>)
|
|
8001c36: fba2 2303 umull r2, r3, r2, r3
|
|
8001c3a: 091b lsrs r3, r3, #4
|
|
8001c3c: 009a lsls r2, r3, #2
|
|
8001c3e: 687b ldr r3, [r7, #4]
|
|
8001c40: 645a str r2, [r3, #68] @ 0x44
|
|
hdma->DmaBaseAddress = DMA2;
|
|
8001c42: 687b ldr r3, [r7, #4]
|
|
8001c44: 4a3c ldr r2, [pc, #240] @ (8001d38 <HAL_DMA_Init+0x14c>)
|
|
8001c46: 641a str r2, [r3, #64] @ 0x40
|
|
}
|
|
|
|
/* Change DMA peripheral state */
|
|
hdma->State = HAL_DMA_STATE_BUSY;
|
|
8001c48: 687b ldr r3, [r7, #4]
|
|
8001c4a: 2202 movs r2, #2
|
|
8001c4c: f883 2025 strb.w r2, [r3, #37] @ 0x25
|
|
|
|
/* Clear PL, MSIZE, PSIZE, MINC, PINC, CIRC, DIR and MEM2MEM bits */
|
|
CLEAR_BIT(hdma->Instance->CCR, (DMA_CCR_PL | DMA_CCR_MSIZE | DMA_CCR_PSIZE | \
|
|
8001c50: 687b ldr r3, [r7, #4]
|
|
8001c52: 681b ldr r3, [r3, #0]
|
|
8001c54: 681b ldr r3, [r3, #0]
|
|
8001c56: 687a ldr r2, [r7, #4]
|
|
8001c58: 6812 ldr r2, [r2, #0]
|
|
8001c5a: f423 43ff bic.w r3, r3, #32640 @ 0x7f80
|
|
8001c5e: f023 0370 bic.w r3, r3, #112 @ 0x70
|
|
8001c62: 6013 str r3, [r2, #0]
|
|
DMA_CCR_MINC | DMA_CCR_PINC | DMA_CCR_CIRC | \
|
|
DMA_CCR_DIR | DMA_CCR_MEM2MEM));
|
|
|
|
/* Set the DMA Channel configuration */
|
|
SET_BIT(hdma->Instance->CCR, (hdma->Init.Direction | \
|
|
8001c64: 687b ldr r3, [r7, #4]
|
|
8001c66: 681b ldr r3, [r3, #0]
|
|
8001c68: 6819 ldr r1, [r3, #0]
|
|
8001c6a: 687b ldr r3, [r7, #4]
|
|
8001c6c: 689a ldr r2, [r3, #8]
|
|
8001c6e: 687b ldr r3, [r7, #4]
|
|
8001c70: 68db ldr r3, [r3, #12]
|
|
8001c72: 431a orrs r2, r3
|
|
8001c74: 687b ldr r3, [r7, #4]
|
|
8001c76: 691b ldr r3, [r3, #16]
|
|
8001c78: 431a orrs r2, r3
|
|
8001c7a: 687b ldr r3, [r7, #4]
|
|
8001c7c: 695b ldr r3, [r3, #20]
|
|
8001c7e: 431a orrs r2, r3
|
|
8001c80: 687b ldr r3, [r7, #4]
|
|
8001c82: 699b ldr r3, [r3, #24]
|
|
8001c84: 431a orrs r2, r3
|
|
8001c86: 687b ldr r3, [r7, #4]
|
|
8001c88: 69db ldr r3, [r3, #28]
|
|
8001c8a: 431a orrs r2, r3
|
|
8001c8c: 687b ldr r3, [r7, #4]
|
|
8001c8e: 6a1b ldr r3, [r3, #32]
|
|
8001c90: 431a orrs r2, r3
|
|
8001c92: 687b ldr r3, [r7, #4]
|
|
8001c94: 681b ldr r3, [r3, #0]
|
|
8001c96: 430a orrs r2, r1
|
|
8001c98: 601a str r2, [r3, #0]
|
|
hdma->Init.Mode | hdma->Init.Priority));
|
|
|
|
/* Initialize parameters for DMAMUX channel :
|
|
DMAmuxChannel, DMAmuxChannelStatus and DMAmuxChannelStatusMask
|
|
*/
|
|
DMA_CalcDMAMUXChannelBaseAndMask(hdma);
|
|
8001c9a: 6878 ldr r0, [r7, #4]
|
|
8001c9c: f000 fb5e bl 800235c <DMA_CalcDMAMUXChannelBaseAndMask>
|
|
|
|
if (hdma->Init.Direction == DMA_MEMORY_TO_MEMORY)
|
|
8001ca0: 687b ldr r3, [r7, #4]
|
|
8001ca2: 689b ldr r3, [r3, #8]
|
|
8001ca4: f5b3 4f80 cmp.w r3, #16384 @ 0x4000
|
|
8001ca8: d102 bne.n 8001cb0 <HAL_DMA_Init+0xc4>
|
|
{
|
|
/* if memory to memory force the request to 0*/
|
|
hdma->Init.Request = DMA_REQUEST_MEM2MEM;
|
|
8001caa: 687b ldr r3, [r7, #4]
|
|
8001cac: 2200 movs r2, #0
|
|
8001cae: 605a str r2, [r3, #4]
|
|
}
|
|
|
|
/* Set peripheral request to DMAMUX channel */
|
|
hdma->DMAmuxChannel->CCR = (hdma->Init.Request & DMAMUX_CxCR_DMAREQ_ID);
|
|
8001cb0: 687b ldr r3, [r7, #4]
|
|
8001cb2: 685a ldr r2, [r3, #4]
|
|
8001cb4: 687b ldr r3, [r7, #4]
|
|
8001cb6: 6c9b ldr r3, [r3, #72] @ 0x48
|
|
8001cb8: f002 027f and.w r2, r2, #127 @ 0x7f
|
|
8001cbc: 601a str r2, [r3, #0]
|
|
|
|
/* Clear the DMAMUX synchro overrun flag */
|
|
hdma->DMAmuxChannelStatus->CFR = hdma->DMAmuxChannelStatusMask;
|
|
8001cbe: 687b ldr r3, [r7, #4]
|
|
8001cc0: 6cdb ldr r3, [r3, #76] @ 0x4c
|
|
8001cc2: 687a ldr r2, [r7, #4]
|
|
8001cc4: 6d12 ldr r2, [r2, #80] @ 0x50
|
|
8001cc6: 605a str r2, [r3, #4]
|
|
|
|
if (((hdma->Init.Request > 0UL) && (hdma->Init.Request <= DMA_REQUEST_GENERATOR3)))
|
|
8001cc8: 687b ldr r3, [r7, #4]
|
|
8001cca: 685b ldr r3, [r3, #4]
|
|
8001ccc: 2b00 cmp r3, #0
|
|
8001cce: d010 beq.n 8001cf2 <HAL_DMA_Init+0x106>
|
|
8001cd0: 687b ldr r3, [r7, #4]
|
|
8001cd2: 685b ldr r3, [r3, #4]
|
|
8001cd4: 2b04 cmp r3, #4
|
|
8001cd6: d80c bhi.n 8001cf2 <HAL_DMA_Init+0x106>
|
|
{
|
|
/* Initialize parameters for DMAMUX request generator :
|
|
DMAmuxRequestGen, DMAmuxRequestGenStatus and DMAmuxRequestGenStatusMask
|
|
*/
|
|
DMA_CalcDMAMUXRequestGenBaseAndMask(hdma);
|
|
8001cd8: 6878 ldr r0, [r7, #4]
|
|
8001cda: f000 fb87 bl 80023ec <DMA_CalcDMAMUXRequestGenBaseAndMask>
|
|
|
|
/* Reset the DMAMUX request generator register*/
|
|
hdma->DMAmuxRequestGen->RGCR = 0U;
|
|
8001cde: 687b ldr r3, [r7, #4]
|
|
8001ce0: 6d5b ldr r3, [r3, #84] @ 0x54
|
|
8001ce2: 2200 movs r2, #0
|
|
8001ce4: 601a str r2, [r3, #0]
|
|
|
|
/* Clear the DMAMUX request generator overrun flag */
|
|
hdma->DMAmuxRequestGenStatus->RGCFR = hdma->DMAmuxRequestGenStatusMask;
|
|
8001ce6: 687b ldr r3, [r7, #4]
|
|
8001ce8: 6d9b ldr r3, [r3, #88] @ 0x58
|
|
8001cea: 687a ldr r2, [r7, #4]
|
|
8001cec: 6dd2 ldr r2, [r2, #92] @ 0x5c
|
|
8001cee: 605a str r2, [r3, #4]
|
|
8001cf0: e008 b.n 8001d04 <HAL_DMA_Init+0x118>
|
|
}
|
|
else
|
|
{
|
|
hdma->DMAmuxRequestGen = NULL;
|
|
8001cf2: 687b ldr r3, [r7, #4]
|
|
8001cf4: 2200 movs r2, #0
|
|
8001cf6: 655a str r2, [r3, #84] @ 0x54
|
|
hdma->DMAmuxRequestGenStatus = NULL;
|
|
8001cf8: 687b ldr r3, [r7, #4]
|
|
8001cfa: 2200 movs r2, #0
|
|
8001cfc: 659a str r2, [r3, #88] @ 0x58
|
|
hdma->DMAmuxRequestGenStatusMask = 0U;
|
|
8001cfe: 687b ldr r3, [r7, #4]
|
|
8001d00: 2200 movs r2, #0
|
|
8001d02: 65da str r2, [r3, #92] @ 0x5c
|
|
}
|
|
|
|
/* Initialize the error code */
|
|
hdma->ErrorCode = HAL_DMA_ERROR_NONE;
|
|
8001d04: 687b ldr r3, [r7, #4]
|
|
8001d06: 2200 movs r2, #0
|
|
8001d08: 63da str r2, [r3, #60] @ 0x3c
|
|
|
|
/* Initialize the DMA state*/
|
|
hdma->State = HAL_DMA_STATE_READY;
|
|
8001d0a: 687b ldr r3, [r7, #4]
|
|
8001d0c: 2201 movs r2, #1
|
|
8001d0e: f883 2025 strb.w r2, [r3, #37] @ 0x25
|
|
|
|
/* Release Lock */
|
|
__HAL_UNLOCK(hdma);
|
|
8001d12: 687b ldr r3, [r7, #4]
|
|
8001d14: 2200 movs r2, #0
|
|
8001d16: f883 2024 strb.w r2, [r3, #36] @ 0x24
|
|
|
|
return HAL_OK;
|
|
8001d1a: 2300 movs r3, #0
|
|
}
|
|
8001d1c: 4618 mov r0, r3
|
|
8001d1e: 3708 adds r7, #8
|
|
8001d20: 46bd mov sp, r7
|
|
8001d22: bd80 pop {r7, pc}
|
|
8001d24: 40020407 .word 0x40020407
|
|
8001d28: bffdfff8 .word 0xbffdfff8
|
|
8001d2c: cccccccd .word 0xcccccccd
|
|
8001d30: 40020000 .word 0x40020000
|
|
8001d34: bffdfbf8 .word 0xbffdfbf8
|
|
8001d38: 40020400 .word 0x40020400
|
|
|
|
08001d3c <HAL_DMA_DeInit>:
|
|
* @param hdma Pointer to a DMA_HandleTypeDef structure that contains
|
|
* the configuration information for the specified DMA Channel.
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_DMA_DeInit(DMA_HandleTypeDef *hdma)
|
|
{
|
|
8001d3c: b580 push {r7, lr}
|
|
8001d3e: b082 sub sp, #8
|
|
8001d40: af00 add r7, sp, #0
|
|
8001d42: 6078 str r0, [r7, #4]
|
|
/* Check the DMA handle allocation */
|
|
if (NULL == hdma)
|
|
8001d44: 687b ldr r3, [r7, #4]
|
|
8001d46: 2b00 cmp r3, #0
|
|
8001d48: d101 bne.n 8001d4e <HAL_DMA_DeInit+0x12>
|
|
{
|
|
return HAL_ERROR;
|
|
8001d4a: 2301 movs r3, #1
|
|
8001d4c: e07b b.n 8001e46 <HAL_DMA_DeInit+0x10a>
|
|
|
|
/* Check the parameters */
|
|
assert_param(IS_DMA_ALL_INSTANCE(hdma->Instance));
|
|
|
|
/* Disable the selected DMA Channelx */
|
|
__HAL_DMA_DISABLE(hdma);
|
|
8001d4e: 687b ldr r3, [r7, #4]
|
|
8001d50: 681b ldr r3, [r3, #0]
|
|
8001d52: 681a ldr r2, [r3, #0]
|
|
8001d54: 687b ldr r3, [r7, #4]
|
|
8001d56: 681b ldr r3, [r3, #0]
|
|
8001d58: f022 0201 bic.w r2, r2, #1
|
|
8001d5c: 601a str r2, [r3, #0]
|
|
|
|
/* Compute the channel index */
|
|
if ((uint32_t)(hdma->Instance) < (uint32_t)(DMA2_Channel1))
|
|
8001d5e: 687b ldr r3, [r7, #4]
|
|
8001d60: 681b ldr r3, [r3, #0]
|
|
8001d62: 461a mov r2, r3
|
|
8001d64: 4b3a ldr r3, [pc, #232] @ (8001e50 <HAL_DMA_DeInit+0x114>)
|
|
8001d66: 429a cmp r2, r3
|
|
8001d68: d80f bhi.n 8001d8a <HAL_DMA_DeInit+0x4e>
|
|
{
|
|
/* DMA1 */
|
|
hdma->ChannelIndex = (((uint32_t)hdma->Instance - (uint32_t)DMA1_Channel1) / ((uint32_t)DMA1_Channel2 - (uint32_t)DMA1_Channel1)) << 2U;
|
|
8001d6a: 687b ldr r3, [r7, #4]
|
|
8001d6c: 681b ldr r3, [r3, #0]
|
|
8001d6e: 461a mov r2, r3
|
|
8001d70: 4b38 ldr r3, [pc, #224] @ (8001e54 <HAL_DMA_DeInit+0x118>)
|
|
8001d72: 4413 add r3, r2
|
|
8001d74: 4a38 ldr r2, [pc, #224] @ (8001e58 <HAL_DMA_DeInit+0x11c>)
|
|
8001d76: fba2 2303 umull r2, r3, r2, r3
|
|
8001d7a: 091b lsrs r3, r3, #4
|
|
8001d7c: 009a lsls r2, r3, #2
|
|
8001d7e: 687b ldr r3, [r7, #4]
|
|
8001d80: 645a str r2, [r3, #68] @ 0x44
|
|
hdma->DmaBaseAddress = DMA1;
|
|
8001d82: 687b ldr r3, [r7, #4]
|
|
8001d84: 4a35 ldr r2, [pc, #212] @ (8001e5c <HAL_DMA_DeInit+0x120>)
|
|
8001d86: 641a str r2, [r3, #64] @ 0x40
|
|
8001d88: e00e b.n 8001da8 <HAL_DMA_DeInit+0x6c>
|
|
}
|
|
else
|
|
{
|
|
/* DMA2 */
|
|
hdma->ChannelIndex = (((uint32_t)hdma->Instance - (uint32_t)DMA2_Channel1) / ((uint32_t)DMA2_Channel2 - (uint32_t)DMA2_Channel1)) << 2U;
|
|
8001d8a: 687b ldr r3, [r7, #4]
|
|
8001d8c: 681b ldr r3, [r3, #0]
|
|
8001d8e: 461a mov r2, r3
|
|
8001d90: 4b33 ldr r3, [pc, #204] @ (8001e60 <HAL_DMA_DeInit+0x124>)
|
|
8001d92: 4413 add r3, r2
|
|
8001d94: 4a30 ldr r2, [pc, #192] @ (8001e58 <HAL_DMA_DeInit+0x11c>)
|
|
8001d96: fba2 2303 umull r2, r3, r2, r3
|
|
8001d9a: 091b lsrs r3, r3, #4
|
|
8001d9c: 009a lsls r2, r3, #2
|
|
8001d9e: 687b ldr r3, [r7, #4]
|
|
8001da0: 645a str r2, [r3, #68] @ 0x44
|
|
hdma->DmaBaseAddress = DMA2;
|
|
8001da2: 687b ldr r3, [r7, #4]
|
|
8001da4: 4a2f ldr r2, [pc, #188] @ (8001e64 <HAL_DMA_DeInit+0x128>)
|
|
8001da6: 641a str r2, [r3, #64] @ 0x40
|
|
}
|
|
|
|
/* Reset DMA Channel control register */
|
|
hdma->Instance->CCR = 0U;
|
|
8001da8: 687b ldr r3, [r7, #4]
|
|
8001daa: 681b ldr r3, [r3, #0]
|
|
8001dac: 2200 movs r2, #0
|
|
8001dae: 601a str r2, [r3, #0]
|
|
|
|
/* Clear all flags */
|
|
hdma->DmaBaseAddress->IFCR = (DMA_ISR_GIF1 << (hdma->ChannelIndex & 0x1CU));
|
|
8001db0: 687b ldr r3, [r7, #4]
|
|
8001db2: 6c5b ldr r3, [r3, #68] @ 0x44
|
|
8001db4: f003 021c and.w r2, r3, #28
|
|
8001db8: 687b ldr r3, [r7, #4]
|
|
8001dba: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
8001dbc: 2101 movs r1, #1
|
|
8001dbe: fa01 f202 lsl.w r2, r1, r2
|
|
8001dc2: 605a str r2, [r3, #4]
|
|
|
|
/* Initialize parameters for DMAMUX channel :
|
|
DMAmuxChannel, DMAmuxChannelStatus and DMAmuxChannelStatusMask */
|
|
|
|
DMA_CalcDMAMUXChannelBaseAndMask(hdma);
|
|
8001dc4: 6878 ldr r0, [r7, #4]
|
|
8001dc6: f000 fac9 bl 800235c <DMA_CalcDMAMUXChannelBaseAndMask>
|
|
|
|
/* Reset the DMAMUX channel that corresponds to the DMA channel */
|
|
hdma->DMAmuxChannel->CCR = 0U;
|
|
8001dca: 687b ldr r3, [r7, #4]
|
|
8001dcc: 6c9b ldr r3, [r3, #72] @ 0x48
|
|
8001dce: 2200 movs r2, #0
|
|
8001dd0: 601a str r2, [r3, #0]
|
|
|
|
/* Clear the DMAMUX synchro overrun flag */
|
|
hdma->DMAmuxChannelStatus->CFR = hdma->DMAmuxChannelStatusMask;
|
|
8001dd2: 687b ldr r3, [r7, #4]
|
|
8001dd4: 6cdb ldr r3, [r3, #76] @ 0x4c
|
|
8001dd6: 687a ldr r2, [r7, #4]
|
|
8001dd8: 6d12 ldr r2, [r2, #80] @ 0x50
|
|
8001dda: 605a str r2, [r3, #4]
|
|
|
|
/* Reset Request generator parameters if any */
|
|
if (((hdma->Init.Request > 0UL) && (hdma->Init.Request <= DMA_REQUEST_GENERATOR3)))
|
|
8001ddc: 687b ldr r3, [r7, #4]
|
|
8001dde: 685b ldr r3, [r3, #4]
|
|
8001de0: 2b00 cmp r3, #0
|
|
8001de2: d00f beq.n 8001e04 <HAL_DMA_DeInit+0xc8>
|
|
8001de4: 687b ldr r3, [r7, #4]
|
|
8001de6: 685b ldr r3, [r3, #4]
|
|
8001de8: 2b04 cmp r3, #4
|
|
8001dea: d80b bhi.n 8001e04 <HAL_DMA_DeInit+0xc8>
|
|
{
|
|
/* Initialize parameters for DMAMUX request generator :
|
|
DMAmuxRequestGen, DMAmuxRequestGenStatus and DMAmuxRequestGenStatusMask
|
|
*/
|
|
DMA_CalcDMAMUXRequestGenBaseAndMask(hdma);
|
|
8001dec: 6878 ldr r0, [r7, #4]
|
|
8001dee: f000 fafd bl 80023ec <DMA_CalcDMAMUXRequestGenBaseAndMask>
|
|
|
|
/* Reset the DMAMUX request generator register*/
|
|
hdma->DMAmuxRequestGen->RGCR = 0U;
|
|
8001df2: 687b ldr r3, [r7, #4]
|
|
8001df4: 6d5b ldr r3, [r3, #84] @ 0x54
|
|
8001df6: 2200 movs r2, #0
|
|
8001df8: 601a str r2, [r3, #0]
|
|
|
|
/* Clear the DMAMUX request generator overrun flag */
|
|
hdma->DMAmuxRequestGenStatus->RGCFR = hdma->DMAmuxRequestGenStatusMask;
|
|
8001dfa: 687b ldr r3, [r7, #4]
|
|
8001dfc: 6d9b ldr r3, [r3, #88] @ 0x58
|
|
8001dfe: 687a ldr r2, [r7, #4]
|
|
8001e00: 6dd2 ldr r2, [r2, #92] @ 0x5c
|
|
8001e02: 605a str r2, [r3, #4]
|
|
}
|
|
|
|
hdma->DMAmuxRequestGen = NULL;
|
|
8001e04: 687b ldr r3, [r7, #4]
|
|
8001e06: 2200 movs r2, #0
|
|
8001e08: 655a str r2, [r3, #84] @ 0x54
|
|
hdma->DMAmuxRequestGenStatus = NULL;
|
|
8001e0a: 687b ldr r3, [r7, #4]
|
|
8001e0c: 2200 movs r2, #0
|
|
8001e0e: 659a str r2, [r3, #88] @ 0x58
|
|
hdma->DMAmuxRequestGenStatusMask = 0U;
|
|
8001e10: 687b ldr r3, [r7, #4]
|
|
8001e12: 2200 movs r2, #0
|
|
8001e14: 65da str r2, [r3, #92] @ 0x5c
|
|
|
|
/* Clean callbacks */
|
|
hdma->XferCpltCallback = NULL;
|
|
8001e16: 687b ldr r3, [r7, #4]
|
|
8001e18: 2200 movs r2, #0
|
|
8001e1a: 62da str r2, [r3, #44] @ 0x2c
|
|
hdma->XferHalfCpltCallback = NULL;
|
|
8001e1c: 687b ldr r3, [r7, #4]
|
|
8001e1e: 2200 movs r2, #0
|
|
8001e20: 631a str r2, [r3, #48] @ 0x30
|
|
hdma->XferErrorCallback = NULL;
|
|
8001e22: 687b ldr r3, [r7, #4]
|
|
8001e24: 2200 movs r2, #0
|
|
8001e26: 635a str r2, [r3, #52] @ 0x34
|
|
hdma->XferAbortCallback = NULL;
|
|
8001e28: 687b ldr r3, [r7, #4]
|
|
8001e2a: 2200 movs r2, #0
|
|
8001e2c: 639a str r2, [r3, #56] @ 0x38
|
|
|
|
/* Initialize the error code */
|
|
hdma->ErrorCode = HAL_DMA_ERROR_NONE;
|
|
8001e2e: 687b ldr r3, [r7, #4]
|
|
8001e30: 2200 movs r2, #0
|
|
8001e32: 63da str r2, [r3, #60] @ 0x3c
|
|
|
|
/* Initialize the DMA state */
|
|
hdma->State = HAL_DMA_STATE_RESET;
|
|
8001e34: 687b ldr r3, [r7, #4]
|
|
8001e36: 2200 movs r2, #0
|
|
8001e38: f883 2025 strb.w r2, [r3, #37] @ 0x25
|
|
|
|
/* Release Lock */
|
|
__HAL_UNLOCK(hdma);
|
|
8001e3c: 687b ldr r3, [r7, #4]
|
|
8001e3e: 2200 movs r2, #0
|
|
8001e40: f883 2024 strb.w r2, [r3, #36] @ 0x24
|
|
|
|
return HAL_OK;
|
|
8001e44: 2300 movs r3, #0
|
|
}
|
|
8001e46: 4618 mov r0, r3
|
|
8001e48: 3708 adds r7, #8
|
|
8001e4a: 46bd mov sp, r7
|
|
8001e4c: bd80 pop {r7, pc}
|
|
8001e4e: bf00 nop
|
|
8001e50: 40020407 .word 0x40020407
|
|
8001e54: bffdfff8 .word 0xbffdfff8
|
|
8001e58: cccccccd .word 0xcccccccd
|
|
8001e5c: 40020000 .word 0x40020000
|
|
8001e60: bffdfbf8 .word 0xbffdfbf8
|
|
8001e64: 40020400 .word 0x40020400
|
|
|
|
08001e68 <HAL_DMA_Start_IT>:
|
|
* @param DataLength The length of data to be transferred from source to destination
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_DMA_Start_IT(DMA_HandleTypeDef *hdma, uint32_t SrcAddress, uint32_t DstAddress,
|
|
uint32_t DataLength)
|
|
{
|
|
8001e68: b580 push {r7, lr}
|
|
8001e6a: b086 sub sp, #24
|
|
8001e6c: af00 add r7, sp, #0
|
|
8001e6e: 60f8 str r0, [r7, #12]
|
|
8001e70: 60b9 str r1, [r7, #8]
|
|
8001e72: 607a str r2, [r7, #4]
|
|
8001e74: 603b str r3, [r7, #0]
|
|
HAL_StatusTypeDef status = HAL_OK;
|
|
8001e76: 2300 movs r3, #0
|
|
8001e78: 75fb strb r3, [r7, #23]
|
|
|
|
/* Check the parameters */
|
|
assert_param(IS_DMA_BUFFER_SIZE(DataLength));
|
|
|
|
/* Process locked */
|
|
__HAL_LOCK(hdma);
|
|
8001e7a: 68fb ldr r3, [r7, #12]
|
|
8001e7c: f893 3024 ldrb.w r3, [r3, #36] @ 0x24
|
|
8001e80: 2b01 cmp r3, #1
|
|
8001e82: d101 bne.n 8001e88 <HAL_DMA_Start_IT+0x20>
|
|
8001e84: 2302 movs r3, #2
|
|
8001e86: e069 b.n 8001f5c <HAL_DMA_Start_IT+0xf4>
|
|
8001e88: 68fb ldr r3, [r7, #12]
|
|
8001e8a: 2201 movs r2, #1
|
|
8001e8c: f883 2024 strb.w r2, [r3, #36] @ 0x24
|
|
|
|
if (hdma->State == HAL_DMA_STATE_READY)
|
|
8001e90: 68fb ldr r3, [r7, #12]
|
|
8001e92: f893 3025 ldrb.w r3, [r3, #37] @ 0x25
|
|
8001e96: b2db uxtb r3, r3
|
|
8001e98: 2b01 cmp r3, #1
|
|
8001e9a: d155 bne.n 8001f48 <HAL_DMA_Start_IT+0xe0>
|
|
{
|
|
/* Change DMA peripheral state */
|
|
hdma->State = HAL_DMA_STATE_BUSY;
|
|
8001e9c: 68fb ldr r3, [r7, #12]
|
|
8001e9e: 2202 movs r2, #2
|
|
8001ea0: f883 2025 strb.w r2, [r3, #37] @ 0x25
|
|
hdma->ErrorCode = HAL_DMA_ERROR_NONE;
|
|
8001ea4: 68fb ldr r3, [r7, #12]
|
|
8001ea6: 2200 movs r2, #0
|
|
8001ea8: 63da str r2, [r3, #60] @ 0x3c
|
|
|
|
/* Disable the peripheral */
|
|
__HAL_DMA_DISABLE(hdma);
|
|
8001eaa: 68fb ldr r3, [r7, #12]
|
|
8001eac: 681b ldr r3, [r3, #0]
|
|
8001eae: 681a ldr r2, [r3, #0]
|
|
8001eb0: 68fb ldr r3, [r7, #12]
|
|
8001eb2: 681b ldr r3, [r3, #0]
|
|
8001eb4: f022 0201 bic.w r2, r2, #1
|
|
8001eb8: 601a str r2, [r3, #0]
|
|
|
|
/* Configure the source, destination address and the data length & clear flags*/
|
|
DMA_SetConfig(hdma, SrcAddress, DstAddress, DataLength);
|
|
8001eba: 683b ldr r3, [r7, #0]
|
|
8001ebc: 687a ldr r2, [r7, #4]
|
|
8001ebe: 68b9 ldr r1, [r7, #8]
|
|
8001ec0: 68f8 ldr r0, [r7, #12]
|
|
8001ec2: f000 fa0d bl 80022e0 <DMA_SetConfig>
|
|
|
|
/* Enable the transfer complete interrupt */
|
|
/* Enable the transfer Error interrupt */
|
|
if (NULL != hdma->XferHalfCpltCallback)
|
|
8001ec6: 68fb ldr r3, [r7, #12]
|
|
8001ec8: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
8001eca: 2b00 cmp r3, #0
|
|
8001ecc: d008 beq.n 8001ee0 <HAL_DMA_Start_IT+0x78>
|
|
{
|
|
/* Enable the Half transfer complete interrupt as well */
|
|
__HAL_DMA_ENABLE_IT(hdma, (DMA_IT_TC | DMA_IT_HT | DMA_IT_TE));
|
|
8001ece: 68fb ldr r3, [r7, #12]
|
|
8001ed0: 681b ldr r3, [r3, #0]
|
|
8001ed2: 681a ldr r2, [r3, #0]
|
|
8001ed4: 68fb ldr r3, [r7, #12]
|
|
8001ed6: 681b ldr r3, [r3, #0]
|
|
8001ed8: f042 020e orr.w r2, r2, #14
|
|
8001edc: 601a str r2, [r3, #0]
|
|
8001ede: e00f b.n 8001f00 <HAL_DMA_Start_IT+0x98>
|
|
}
|
|
else
|
|
{
|
|
__HAL_DMA_DISABLE_IT(hdma, DMA_IT_HT);
|
|
8001ee0: 68fb ldr r3, [r7, #12]
|
|
8001ee2: 681b ldr r3, [r3, #0]
|
|
8001ee4: 681a ldr r2, [r3, #0]
|
|
8001ee6: 68fb ldr r3, [r7, #12]
|
|
8001ee8: 681b ldr r3, [r3, #0]
|
|
8001eea: f022 0204 bic.w r2, r2, #4
|
|
8001eee: 601a str r2, [r3, #0]
|
|
__HAL_DMA_ENABLE_IT(hdma, (DMA_IT_TC | DMA_IT_TE));
|
|
8001ef0: 68fb ldr r3, [r7, #12]
|
|
8001ef2: 681b ldr r3, [r3, #0]
|
|
8001ef4: 681a ldr r2, [r3, #0]
|
|
8001ef6: 68fb ldr r3, [r7, #12]
|
|
8001ef8: 681b ldr r3, [r3, #0]
|
|
8001efa: f042 020a orr.w r2, r2, #10
|
|
8001efe: 601a str r2, [r3, #0]
|
|
}
|
|
|
|
/* Check if DMAMUX Synchronization is enabled*/
|
|
if ((hdma->DMAmuxChannel->CCR & DMAMUX_CxCR_SE) != 0U)
|
|
8001f00: 68fb ldr r3, [r7, #12]
|
|
8001f02: 6c9b ldr r3, [r3, #72] @ 0x48
|
|
8001f04: 681b ldr r3, [r3, #0]
|
|
8001f06: f403 3380 and.w r3, r3, #65536 @ 0x10000
|
|
8001f0a: 2b00 cmp r3, #0
|
|
8001f0c: d007 beq.n 8001f1e <HAL_DMA_Start_IT+0xb6>
|
|
{
|
|
/* Enable DMAMUX sync overrun IT*/
|
|
hdma->DMAmuxChannel->CCR |= DMAMUX_CxCR_SOIE;
|
|
8001f0e: 68fb ldr r3, [r7, #12]
|
|
8001f10: 6c9b ldr r3, [r3, #72] @ 0x48
|
|
8001f12: 681a ldr r2, [r3, #0]
|
|
8001f14: 68fb ldr r3, [r7, #12]
|
|
8001f16: 6c9b ldr r3, [r3, #72] @ 0x48
|
|
8001f18: f442 7280 orr.w r2, r2, #256 @ 0x100
|
|
8001f1c: 601a str r2, [r3, #0]
|
|
}
|
|
|
|
if (hdma->DMAmuxRequestGen != NULL)
|
|
8001f1e: 68fb ldr r3, [r7, #12]
|
|
8001f20: 6d5b ldr r3, [r3, #84] @ 0x54
|
|
8001f22: 2b00 cmp r3, #0
|
|
8001f24: d007 beq.n 8001f36 <HAL_DMA_Start_IT+0xce>
|
|
{
|
|
/* if using DMAMUX request generator, enable the DMAMUX request generator overrun IT*/
|
|
/* enable the request gen overrun IT*/
|
|
hdma->DMAmuxRequestGen->RGCR |= DMAMUX_RGxCR_OIE;
|
|
8001f26: 68fb ldr r3, [r7, #12]
|
|
8001f28: 6d5b ldr r3, [r3, #84] @ 0x54
|
|
8001f2a: 681a ldr r2, [r3, #0]
|
|
8001f2c: 68fb ldr r3, [r7, #12]
|
|
8001f2e: 6d5b ldr r3, [r3, #84] @ 0x54
|
|
8001f30: f442 7280 orr.w r2, r2, #256 @ 0x100
|
|
8001f34: 601a str r2, [r3, #0]
|
|
}
|
|
|
|
/* Enable the Peripheral */
|
|
__HAL_DMA_ENABLE(hdma);
|
|
8001f36: 68fb ldr r3, [r7, #12]
|
|
8001f38: 681b ldr r3, [r3, #0]
|
|
8001f3a: 681a ldr r2, [r3, #0]
|
|
8001f3c: 68fb ldr r3, [r7, #12]
|
|
8001f3e: 681b ldr r3, [r3, #0]
|
|
8001f40: f042 0201 orr.w r2, r2, #1
|
|
8001f44: 601a str r2, [r3, #0]
|
|
8001f46: e008 b.n 8001f5a <HAL_DMA_Start_IT+0xf2>
|
|
}
|
|
else
|
|
{
|
|
/* Change the error code */
|
|
hdma->ErrorCode = HAL_DMA_ERROR_BUSY;
|
|
8001f48: 68fb ldr r3, [r7, #12]
|
|
8001f4a: 2280 movs r2, #128 @ 0x80
|
|
8001f4c: 63da str r2, [r3, #60] @ 0x3c
|
|
|
|
/* Process Unlocked */
|
|
__HAL_UNLOCK(hdma);
|
|
8001f4e: 68fb ldr r3, [r7, #12]
|
|
8001f50: 2200 movs r2, #0
|
|
8001f52: f883 2024 strb.w r2, [r3, #36] @ 0x24
|
|
|
|
/* Return error status */
|
|
status = HAL_ERROR;
|
|
8001f56: 2301 movs r3, #1
|
|
8001f58: 75fb strb r3, [r7, #23]
|
|
}
|
|
|
|
return status;
|
|
8001f5a: 7dfb ldrb r3, [r7, #23]
|
|
}
|
|
8001f5c: 4618 mov r0, r3
|
|
8001f5e: 3718 adds r7, #24
|
|
8001f60: 46bd mov sp, r7
|
|
8001f62: bd80 pop {r7, pc}
|
|
|
|
08001f64 <HAL_DMA_Abort>:
|
|
* @param hdma Pointer to a DMA_HandleTypeDef structure that contains
|
|
* the configuration information for the specified DMA Channel.
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_DMA_Abort(DMA_HandleTypeDef *hdma)
|
|
{
|
|
8001f64: b480 push {r7}
|
|
8001f66: b083 sub sp, #12
|
|
8001f68: af00 add r7, sp, #0
|
|
8001f6a: 6078 str r0, [r7, #4]
|
|
/* Check the DMA peripheral handle */
|
|
if (NULL == hdma)
|
|
8001f6c: 687b ldr r3, [r7, #4]
|
|
8001f6e: 2b00 cmp r3, #0
|
|
8001f70: d101 bne.n 8001f76 <HAL_DMA_Abort+0x12>
|
|
{
|
|
return HAL_ERROR;
|
|
8001f72: 2301 movs r3, #1
|
|
8001f74: e04f b.n 8002016 <HAL_DMA_Abort+0xb2>
|
|
}
|
|
|
|
/* Check the DMA peripheral state */
|
|
if (hdma->State != HAL_DMA_STATE_BUSY)
|
|
8001f76: 687b ldr r3, [r7, #4]
|
|
8001f78: f893 3025 ldrb.w r3, [r3, #37] @ 0x25
|
|
8001f7c: b2db uxtb r3, r3
|
|
8001f7e: 2b02 cmp r3, #2
|
|
8001f80: d008 beq.n 8001f94 <HAL_DMA_Abort+0x30>
|
|
{
|
|
hdma->ErrorCode = HAL_DMA_ERROR_NO_XFER;
|
|
8001f82: 687b ldr r3, [r7, #4]
|
|
8001f84: 2204 movs r2, #4
|
|
8001f86: 63da str r2, [r3, #60] @ 0x3c
|
|
|
|
/* Process Unlocked */
|
|
__HAL_UNLOCK(hdma);
|
|
8001f88: 687b ldr r3, [r7, #4]
|
|
8001f8a: 2200 movs r2, #0
|
|
8001f8c: f883 2024 strb.w r2, [r3, #36] @ 0x24
|
|
|
|
return HAL_ERROR;
|
|
8001f90: 2301 movs r3, #1
|
|
8001f92: e040 b.n 8002016 <HAL_DMA_Abort+0xb2>
|
|
}
|
|
else
|
|
{
|
|
/* Disable the channel */
|
|
__HAL_DMA_DISABLE(hdma);
|
|
8001f94: 687b ldr r3, [r7, #4]
|
|
8001f96: 681b ldr r3, [r3, #0]
|
|
8001f98: 681a ldr r2, [r3, #0]
|
|
8001f9a: 687b ldr r3, [r7, #4]
|
|
8001f9c: 681b ldr r3, [r3, #0]
|
|
8001f9e: f022 0201 bic.w r2, r2, #1
|
|
8001fa2: 601a str r2, [r3, #0]
|
|
|
|
/* Disable DMA IT */
|
|
__HAL_DMA_DISABLE_IT(hdma, (DMA_IT_TC | DMA_IT_HT | DMA_IT_TE));
|
|
8001fa4: 687b ldr r3, [r7, #4]
|
|
8001fa6: 681b ldr r3, [r3, #0]
|
|
8001fa8: 681a ldr r2, [r3, #0]
|
|
8001faa: 687b ldr r3, [r7, #4]
|
|
8001fac: 681b ldr r3, [r3, #0]
|
|
8001fae: f022 020e bic.w r2, r2, #14
|
|
8001fb2: 601a str r2, [r3, #0]
|
|
|
|
/* disable the DMAMUX sync overrun IT*/
|
|
hdma->DMAmuxChannel->CCR &= ~DMAMUX_CxCR_SOIE;
|
|
8001fb4: 687b ldr r3, [r7, #4]
|
|
8001fb6: 6c9b ldr r3, [r3, #72] @ 0x48
|
|
8001fb8: 681a ldr r2, [r3, #0]
|
|
8001fba: 687b ldr r3, [r7, #4]
|
|
8001fbc: 6c9b ldr r3, [r3, #72] @ 0x48
|
|
8001fbe: f422 7280 bic.w r2, r2, #256 @ 0x100
|
|
8001fc2: 601a str r2, [r3, #0]
|
|
|
|
/* Clear all flags */
|
|
hdma->DmaBaseAddress->IFCR = (DMA_ISR_GIF1 << (hdma->ChannelIndex & 0x1CU));
|
|
8001fc4: 687b ldr r3, [r7, #4]
|
|
8001fc6: 6c5b ldr r3, [r3, #68] @ 0x44
|
|
8001fc8: f003 021c and.w r2, r3, #28
|
|
8001fcc: 687b ldr r3, [r7, #4]
|
|
8001fce: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
8001fd0: 2101 movs r1, #1
|
|
8001fd2: fa01 f202 lsl.w r2, r1, r2
|
|
8001fd6: 605a str r2, [r3, #4]
|
|
|
|
/* Clear the DMAMUX synchro overrun flag */
|
|
hdma->DMAmuxChannelStatus->CFR = hdma->DMAmuxChannelStatusMask;
|
|
8001fd8: 687b ldr r3, [r7, #4]
|
|
8001fda: 6cdb ldr r3, [r3, #76] @ 0x4c
|
|
8001fdc: 687a ldr r2, [r7, #4]
|
|
8001fde: 6d12 ldr r2, [r2, #80] @ 0x50
|
|
8001fe0: 605a str r2, [r3, #4]
|
|
|
|
if (hdma->DMAmuxRequestGen != NULL)
|
|
8001fe2: 687b ldr r3, [r7, #4]
|
|
8001fe4: 6d5b ldr r3, [r3, #84] @ 0x54
|
|
8001fe6: 2b00 cmp r3, #0
|
|
8001fe8: d00c beq.n 8002004 <HAL_DMA_Abort+0xa0>
|
|
{
|
|
/* if using DMAMUX request generator, disable the DMAMUX request generator overrun IT*/
|
|
/* disable the request gen overrun IT*/
|
|
hdma->DMAmuxRequestGen->RGCR &= ~DMAMUX_RGxCR_OIE;
|
|
8001fea: 687b ldr r3, [r7, #4]
|
|
8001fec: 6d5b ldr r3, [r3, #84] @ 0x54
|
|
8001fee: 681a ldr r2, [r3, #0]
|
|
8001ff0: 687b ldr r3, [r7, #4]
|
|
8001ff2: 6d5b ldr r3, [r3, #84] @ 0x54
|
|
8001ff4: f422 7280 bic.w r2, r2, #256 @ 0x100
|
|
8001ff8: 601a str r2, [r3, #0]
|
|
|
|
/* Clear the DMAMUX request generator overrun flag */
|
|
hdma->DMAmuxRequestGenStatus->RGCFR = hdma->DMAmuxRequestGenStatusMask;
|
|
8001ffa: 687b ldr r3, [r7, #4]
|
|
8001ffc: 6d9b ldr r3, [r3, #88] @ 0x58
|
|
8001ffe: 687a ldr r2, [r7, #4]
|
|
8002000: 6dd2 ldr r2, [r2, #92] @ 0x5c
|
|
8002002: 605a str r2, [r3, #4]
|
|
}
|
|
|
|
/* Change the DMA state */
|
|
hdma->State = HAL_DMA_STATE_READY;
|
|
8002004: 687b ldr r3, [r7, #4]
|
|
8002006: 2201 movs r2, #1
|
|
8002008: f883 2025 strb.w r2, [r3, #37] @ 0x25
|
|
|
|
/* Process Unlocked */
|
|
__HAL_UNLOCK(hdma);
|
|
800200c: 687b ldr r3, [r7, #4]
|
|
800200e: 2200 movs r2, #0
|
|
8002010: f883 2024 strb.w r2, [r3, #36] @ 0x24
|
|
}
|
|
|
|
return HAL_OK;
|
|
8002014: 2300 movs r3, #0
|
|
}
|
|
8002016: 4618 mov r0, r3
|
|
8002018: 370c adds r7, #12
|
|
800201a: 46bd mov sp, r7
|
|
800201c: bc80 pop {r7}
|
|
800201e: 4770 bx lr
|
|
|
|
08002020 <HAL_DMA_Abort_IT>:
|
|
* @param hdma Pointer to a DMA_HandleTypeDef structure that contains
|
|
* the configuration information for the specified DMA Channel.
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_DMA_Abort_IT(DMA_HandleTypeDef *hdma)
|
|
{
|
|
8002020: b580 push {r7, lr}
|
|
8002022: b084 sub sp, #16
|
|
8002024: af00 add r7, sp, #0
|
|
8002026: 6078 str r0, [r7, #4]
|
|
HAL_StatusTypeDef status = HAL_OK;
|
|
8002028: 2300 movs r3, #0
|
|
800202a: 73fb strb r3, [r7, #15]
|
|
|
|
if (hdma->State != HAL_DMA_STATE_BUSY)
|
|
800202c: 687b ldr r3, [r7, #4]
|
|
800202e: f893 3025 ldrb.w r3, [r3, #37] @ 0x25
|
|
8002032: b2db uxtb r3, r3
|
|
8002034: 2b02 cmp r3, #2
|
|
8002036: d005 beq.n 8002044 <HAL_DMA_Abort_IT+0x24>
|
|
{
|
|
/* no transfer ongoing */
|
|
hdma->ErrorCode = HAL_DMA_ERROR_NO_XFER;
|
|
8002038: 687b ldr r3, [r7, #4]
|
|
800203a: 2204 movs r2, #4
|
|
800203c: 63da str r2, [r3, #60] @ 0x3c
|
|
|
|
status = HAL_ERROR;
|
|
800203e: 2301 movs r3, #1
|
|
8002040: 73fb strb r3, [r7, #15]
|
|
8002042: e047 b.n 80020d4 <HAL_DMA_Abort_IT+0xb4>
|
|
}
|
|
else
|
|
{
|
|
/* Disable the channel */
|
|
__HAL_DMA_DISABLE(hdma);
|
|
8002044: 687b ldr r3, [r7, #4]
|
|
8002046: 681b ldr r3, [r3, #0]
|
|
8002048: 681a ldr r2, [r3, #0]
|
|
800204a: 687b ldr r3, [r7, #4]
|
|
800204c: 681b ldr r3, [r3, #0]
|
|
800204e: f022 0201 bic.w r2, r2, #1
|
|
8002052: 601a str r2, [r3, #0]
|
|
|
|
/* Disable DMA IT */
|
|
__HAL_DMA_DISABLE_IT(hdma, (DMA_IT_TC | DMA_IT_HT | DMA_IT_TE));
|
|
8002054: 687b ldr r3, [r7, #4]
|
|
8002056: 681b ldr r3, [r3, #0]
|
|
8002058: 681a ldr r2, [r3, #0]
|
|
800205a: 687b ldr r3, [r7, #4]
|
|
800205c: 681b ldr r3, [r3, #0]
|
|
800205e: f022 020e bic.w r2, r2, #14
|
|
8002062: 601a str r2, [r3, #0]
|
|
|
|
/* disable the DMAMUX sync overrun IT*/
|
|
hdma->DMAmuxChannel->CCR &= ~DMAMUX_CxCR_SOIE;
|
|
8002064: 687b ldr r3, [r7, #4]
|
|
8002066: 6c9b ldr r3, [r3, #72] @ 0x48
|
|
8002068: 681a ldr r2, [r3, #0]
|
|
800206a: 687b ldr r3, [r7, #4]
|
|
800206c: 6c9b ldr r3, [r3, #72] @ 0x48
|
|
800206e: f422 7280 bic.w r2, r2, #256 @ 0x100
|
|
8002072: 601a str r2, [r3, #0]
|
|
|
|
/* Clear all flags */
|
|
hdma->DmaBaseAddress->IFCR = (DMA_ISR_GIF1 << (hdma->ChannelIndex & 0x1CU));
|
|
8002074: 687b ldr r3, [r7, #4]
|
|
8002076: 6c5b ldr r3, [r3, #68] @ 0x44
|
|
8002078: f003 021c and.w r2, r3, #28
|
|
800207c: 687b ldr r3, [r7, #4]
|
|
800207e: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
8002080: 2101 movs r1, #1
|
|
8002082: fa01 f202 lsl.w r2, r1, r2
|
|
8002086: 605a str r2, [r3, #4]
|
|
|
|
/* Clear the DMAMUX synchro overrun flag */
|
|
hdma->DMAmuxChannelStatus->CFR = hdma->DMAmuxChannelStatusMask;
|
|
8002088: 687b ldr r3, [r7, #4]
|
|
800208a: 6cdb ldr r3, [r3, #76] @ 0x4c
|
|
800208c: 687a ldr r2, [r7, #4]
|
|
800208e: 6d12 ldr r2, [r2, #80] @ 0x50
|
|
8002090: 605a str r2, [r3, #4]
|
|
|
|
if (hdma->DMAmuxRequestGen != NULL)
|
|
8002092: 687b ldr r3, [r7, #4]
|
|
8002094: 6d5b ldr r3, [r3, #84] @ 0x54
|
|
8002096: 2b00 cmp r3, #0
|
|
8002098: d00c beq.n 80020b4 <HAL_DMA_Abort_IT+0x94>
|
|
{
|
|
/* if using DMAMUX request generator, disable the DMAMUX request generator overrun IT*/
|
|
/* disable the request gen overrun IT*/
|
|
hdma->DMAmuxRequestGen->RGCR &= ~DMAMUX_RGxCR_OIE;
|
|
800209a: 687b ldr r3, [r7, #4]
|
|
800209c: 6d5b ldr r3, [r3, #84] @ 0x54
|
|
800209e: 681a ldr r2, [r3, #0]
|
|
80020a0: 687b ldr r3, [r7, #4]
|
|
80020a2: 6d5b ldr r3, [r3, #84] @ 0x54
|
|
80020a4: f422 7280 bic.w r2, r2, #256 @ 0x100
|
|
80020a8: 601a str r2, [r3, #0]
|
|
|
|
/* Clear the DMAMUX request generator overrun flag */
|
|
hdma->DMAmuxRequestGenStatus->RGCFR = hdma->DMAmuxRequestGenStatusMask;
|
|
80020aa: 687b ldr r3, [r7, #4]
|
|
80020ac: 6d9b ldr r3, [r3, #88] @ 0x58
|
|
80020ae: 687a ldr r2, [r7, #4]
|
|
80020b0: 6dd2 ldr r2, [r2, #92] @ 0x5c
|
|
80020b2: 605a str r2, [r3, #4]
|
|
}
|
|
|
|
/* Change the DMA state */
|
|
hdma->State = HAL_DMA_STATE_READY;
|
|
80020b4: 687b ldr r3, [r7, #4]
|
|
80020b6: 2201 movs r2, #1
|
|
80020b8: f883 2025 strb.w r2, [r3, #37] @ 0x25
|
|
|
|
/* Process Unlocked */
|
|
__HAL_UNLOCK(hdma);
|
|
80020bc: 687b ldr r3, [r7, #4]
|
|
80020be: 2200 movs r2, #0
|
|
80020c0: f883 2024 strb.w r2, [r3, #36] @ 0x24
|
|
|
|
/* Call User Abort callback */
|
|
if (hdma->XferAbortCallback != NULL)
|
|
80020c4: 687b ldr r3, [r7, #4]
|
|
80020c6: 6b9b ldr r3, [r3, #56] @ 0x38
|
|
80020c8: 2b00 cmp r3, #0
|
|
80020ca: d003 beq.n 80020d4 <HAL_DMA_Abort_IT+0xb4>
|
|
{
|
|
hdma->XferAbortCallback(hdma);
|
|
80020cc: 687b ldr r3, [r7, #4]
|
|
80020ce: 6b9b ldr r3, [r3, #56] @ 0x38
|
|
80020d0: 6878 ldr r0, [r7, #4]
|
|
80020d2: 4798 blx r3
|
|
}
|
|
}
|
|
return status;
|
|
80020d4: 7bfb ldrb r3, [r7, #15]
|
|
}
|
|
80020d6: 4618 mov r0, r3
|
|
80020d8: 3710 adds r7, #16
|
|
80020da: 46bd mov sp, r7
|
|
80020dc: bd80 pop {r7, pc}
|
|
...
|
|
|
|
080020e0 <HAL_DMA_IRQHandler>:
|
|
* @param hdma Pointer to a DMA_HandleTypeDef structure that contains
|
|
* the configuration information for the specified DMA Channel.
|
|
* @retval None
|
|
*/
|
|
void HAL_DMA_IRQHandler(DMA_HandleTypeDef *hdma)
|
|
{
|
|
80020e0: b580 push {r7, lr}
|
|
80020e2: b084 sub sp, #16
|
|
80020e4: af00 add r7, sp, #0
|
|
80020e6: 6078 str r0, [r7, #4]
|
|
uint32_t flag_it = hdma->DmaBaseAddress->ISR;
|
|
80020e8: 687b ldr r3, [r7, #4]
|
|
80020ea: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
80020ec: 681b ldr r3, [r3, #0]
|
|
80020ee: 60fb str r3, [r7, #12]
|
|
uint32_t source_it = hdma->Instance->CCR;
|
|
80020f0: 687b ldr r3, [r7, #4]
|
|
80020f2: 681b ldr r3, [r3, #0]
|
|
80020f4: 681b ldr r3, [r3, #0]
|
|
80020f6: 60bb str r3, [r7, #8]
|
|
|
|
/* Half Transfer Complete Interrupt management ******************************/
|
|
if (((flag_it & (DMA_FLAG_HT1 << (hdma->ChannelIndex & 0x1CU))) != 0U) && ((source_it & DMA_IT_HT) != 0U))
|
|
80020f8: 687b ldr r3, [r7, #4]
|
|
80020fa: 6c5b ldr r3, [r3, #68] @ 0x44
|
|
80020fc: f003 031c and.w r3, r3, #28
|
|
8002100: 2204 movs r2, #4
|
|
8002102: 409a lsls r2, r3
|
|
8002104: 68fb ldr r3, [r7, #12]
|
|
8002106: 4013 ands r3, r2
|
|
8002108: 2b00 cmp r3, #0
|
|
800210a: d027 beq.n 800215c <HAL_DMA_IRQHandler+0x7c>
|
|
800210c: 68bb ldr r3, [r7, #8]
|
|
800210e: f003 0304 and.w r3, r3, #4
|
|
8002112: 2b00 cmp r3, #0
|
|
8002114: d022 beq.n 800215c <HAL_DMA_IRQHandler+0x7c>
|
|
{
|
|
/* Disable the half transfer interrupt if the DMA mode is not CIRCULAR */
|
|
if ((hdma->Instance->CCR & DMA_CCR_CIRC) == 0U)
|
|
8002116: 687b ldr r3, [r7, #4]
|
|
8002118: 681b ldr r3, [r3, #0]
|
|
800211a: 681b ldr r3, [r3, #0]
|
|
800211c: f003 0320 and.w r3, r3, #32
|
|
8002120: 2b00 cmp r3, #0
|
|
8002122: d107 bne.n 8002134 <HAL_DMA_IRQHandler+0x54>
|
|
{
|
|
/* Disable the half transfer interrupt */
|
|
__HAL_DMA_DISABLE_IT(hdma, DMA_IT_HT);
|
|
8002124: 687b ldr r3, [r7, #4]
|
|
8002126: 681b ldr r3, [r3, #0]
|
|
8002128: 681a ldr r2, [r3, #0]
|
|
800212a: 687b ldr r3, [r7, #4]
|
|
800212c: 681b ldr r3, [r3, #0]
|
|
800212e: f022 0204 bic.w r2, r2, #4
|
|
8002132: 601a str r2, [r3, #0]
|
|
}
|
|
/* Clear the half transfer complete flag */
|
|
hdma->DmaBaseAddress->IFCR = DMA_ISR_HTIF1 << (hdma->ChannelIndex & 0x1CU);
|
|
8002134: 687b ldr r3, [r7, #4]
|
|
8002136: 6c5b ldr r3, [r3, #68] @ 0x44
|
|
8002138: f003 021c and.w r2, r3, #28
|
|
800213c: 687b ldr r3, [r7, #4]
|
|
800213e: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
8002140: 2104 movs r1, #4
|
|
8002142: fa01 f202 lsl.w r2, r1, r2
|
|
8002146: 605a str r2, [r3, #4]
|
|
|
|
/* DMA peripheral state is not updated in Half Transfer */
|
|
/* but in Transfer Complete case */
|
|
|
|
if (hdma->XferHalfCpltCallback != NULL)
|
|
8002148: 687b ldr r3, [r7, #4]
|
|
800214a: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
800214c: 2b00 cmp r3, #0
|
|
800214e: f000 8081 beq.w 8002254 <HAL_DMA_IRQHandler+0x174>
|
|
{
|
|
/* Half transfer callback */
|
|
hdma->XferHalfCpltCallback(hdma);
|
|
8002152: 687b ldr r3, [r7, #4]
|
|
8002154: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
8002156: 6878 ldr r0, [r7, #4]
|
|
8002158: 4798 blx r3
|
|
if (hdma->XferHalfCpltCallback != NULL)
|
|
800215a: e07b b.n 8002254 <HAL_DMA_IRQHandler+0x174>
|
|
}
|
|
}
|
|
|
|
/* Transfer Complete Interrupt management ***********************************/
|
|
else if ((0U != (flag_it & (DMA_FLAG_TC1 << (hdma->ChannelIndex & 0x1CU)))) && (0U != (source_it & DMA_IT_TC)))
|
|
800215c: 687b ldr r3, [r7, #4]
|
|
800215e: 6c5b ldr r3, [r3, #68] @ 0x44
|
|
8002160: f003 031c and.w r3, r3, #28
|
|
8002164: 2202 movs r2, #2
|
|
8002166: 409a lsls r2, r3
|
|
8002168: 68fb ldr r3, [r7, #12]
|
|
800216a: 4013 ands r3, r2
|
|
800216c: 2b00 cmp r3, #0
|
|
800216e: d03d beq.n 80021ec <HAL_DMA_IRQHandler+0x10c>
|
|
8002170: 68bb ldr r3, [r7, #8]
|
|
8002172: f003 0302 and.w r3, r3, #2
|
|
8002176: 2b00 cmp r3, #0
|
|
8002178: d038 beq.n 80021ec <HAL_DMA_IRQHandler+0x10c>
|
|
{
|
|
if ((hdma->Instance->CCR & DMA_CCR_CIRC) == 0U)
|
|
800217a: 687b ldr r3, [r7, #4]
|
|
800217c: 681b ldr r3, [r3, #0]
|
|
800217e: 681b ldr r3, [r3, #0]
|
|
8002180: f003 0320 and.w r3, r3, #32
|
|
8002184: 2b00 cmp r3, #0
|
|
8002186: d10b bne.n 80021a0 <HAL_DMA_IRQHandler+0xc0>
|
|
{
|
|
/* Disable the transfer complete and error interrupt */
|
|
__HAL_DMA_DISABLE_IT(hdma, DMA_IT_TE | DMA_IT_TC);
|
|
8002188: 687b ldr r3, [r7, #4]
|
|
800218a: 681b ldr r3, [r3, #0]
|
|
800218c: 681a ldr r2, [r3, #0]
|
|
800218e: 687b ldr r3, [r7, #4]
|
|
8002190: 681b ldr r3, [r3, #0]
|
|
8002192: f022 020a bic.w r2, r2, #10
|
|
8002196: 601a str r2, [r3, #0]
|
|
|
|
/* Change the DMA state */
|
|
hdma->State = HAL_DMA_STATE_READY;
|
|
8002198: 687b ldr r3, [r7, #4]
|
|
800219a: 2201 movs r2, #1
|
|
800219c: f883 2025 strb.w r2, [r3, #37] @ 0x25
|
|
}
|
|
/* Clear the transfer complete flag */
|
|
__HAL_DMA_CLEAR_FLAG(hdma, (DMA_FLAG_TC1 << (hdma->ChannelIndex & 0x1CU)));
|
|
80021a0: 687b ldr r3, [r7, #4]
|
|
80021a2: 681b ldr r3, [r3, #0]
|
|
80021a4: 461a mov r2, r3
|
|
80021a6: 4b2e ldr r3, [pc, #184] @ (8002260 <HAL_DMA_IRQHandler+0x180>)
|
|
80021a8: 429a cmp r2, r3
|
|
80021aa: d909 bls.n 80021c0 <HAL_DMA_IRQHandler+0xe0>
|
|
80021ac: 687b ldr r3, [r7, #4]
|
|
80021ae: 6c5b ldr r3, [r3, #68] @ 0x44
|
|
80021b0: f003 031c and.w r3, r3, #28
|
|
80021b4: 4a2b ldr r2, [pc, #172] @ (8002264 <HAL_DMA_IRQHandler+0x184>)
|
|
80021b6: 2102 movs r1, #2
|
|
80021b8: fa01 f303 lsl.w r3, r1, r3
|
|
80021bc: 6053 str r3, [r2, #4]
|
|
80021be: e008 b.n 80021d2 <HAL_DMA_IRQHandler+0xf2>
|
|
80021c0: 687b ldr r3, [r7, #4]
|
|
80021c2: 6c5b ldr r3, [r3, #68] @ 0x44
|
|
80021c4: f003 031c and.w r3, r3, #28
|
|
80021c8: 4a27 ldr r2, [pc, #156] @ (8002268 <HAL_DMA_IRQHandler+0x188>)
|
|
80021ca: 2102 movs r1, #2
|
|
80021cc: fa01 f303 lsl.w r3, r1, r3
|
|
80021d0: 6053 str r3, [r2, #4]
|
|
|
|
/* Process Unlocked */
|
|
__HAL_UNLOCK(hdma);
|
|
80021d2: 687b ldr r3, [r7, #4]
|
|
80021d4: 2200 movs r2, #0
|
|
80021d6: f883 2024 strb.w r2, [r3, #36] @ 0x24
|
|
|
|
if (hdma->XferCpltCallback != NULL)
|
|
80021da: 687b ldr r3, [r7, #4]
|
|
80021dc: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
80021de: 2b00 cmp r3, #0
|
|
80021e0: d038 beq.n 8002254 <HAL_DMA_IRQHandler+0x174>
|
|
{
|
|
/* Transfer complete callback */
|
|
hdma->XferCpltCallback(hdma);
|
|
80021e2: 687b ldr r3, [r7, #4]
|
|
80021e4: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
80021e6: 6878 ldr r0, [r7, #4]
|
|
80021e8: 4798 blx r3
|
|
if (hdma->XferCpltCallback != NULL)
|
|
80021ea: e033 b.n 8002254 <HAL_DMA_IRQHandler+0x174>
|
|
}
|
|
}
|
|
|
|
/* Transfer Error Interrupt management **************************************/
|
|
else if (((flag_it & (DMA_FLAG_TE1 << (hdma->ChannelIndex & 0x1CU))) != 0U) && ((source_it & DMA_IT_TE) != 0U))
|
|
80021ec: 687b ldr r3, [r7, #4]
|
|
80021ee: 6c5b ldr r3, [r3, #68] @ 0x44
|
|
80021f0: f003 031c and.w r3, r3, #28
|
|
80021f4: 2208 movs r2, #8
|
|
80021f6: 409a lsls r2, r3
|
|
80021f8: 68fb ldr r3, [r7, #12]
|
|
80021fa: 4013 ands r3, r2
|
|
80021fc: 2b00 cmp r3, #0
|
|
80021fe: d02a beq.n 8002256 <HAL_DMA_IRQHandler+0x176>
|
|
8002200: 68bb ldr r3, [r7, #8]
|
|
8002202: f003 0308 and.w r3, r3, #8
|
|
8002206: 2b00 cmp r3, #0
|
|
8002208: d025 beq.n 8002256 <HAL_DMA_IRQHandler+0x176>
|
|
{
|
|
/* When a DMA transfer error occurs */
|
|
/* A hardware clear of its EN bits is performed */
|
|
/* Disable ALL DMA IT */
|
|
__HAL_DMA_DISABLE_IT(hdma, (DMA_IT_TC | DMA_IT_HT | DMA_IT_TE));
|
|
800220a: 687b ldr r3, [r7, #4]
|
|
800220c: 681b ldr r3, [r3, #0]
|
|
800220e: 681a ldr r2, [r3, #0]
|
|
8002210: 687b ldr r3, [r7, #4]
|
|
8002212: 681b ldr r3, [r3, #0]
|
|
8002214: f022 020e bic.w r2, r2, #14
|
|
8002218: 601a str r2, [r3, #0]
|
|
|
|
/* Clear all flags */
|
|
hdma->DmaBaseAddress->IFCR = (DMA_ISR_GIF1 << (hdma->ChannelIndex & 0x1CU));
|
|
800221a: 687b ldr r3, [r7, #4]
|
|
800221c: 6c5b ldr r3, [r3, #68] @ 0x44
|
|
800221e: f003 021c and.w r2, r3, #28
|
|
8002222: 687b ldr r3, [r7, #4]
|
|
8002224: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
8002226: 2101 movs r1, #1
|
|
8002228: fa01 f202 lsl.w r2, r1, r2
|
|
800222c: 605a str r2, [r3, #4]
|
|
|
|
/* Update error code */
|
|
hdma->ErrorCode = HAL_DMA_ERROR_TE;
|
|
800222e: 687b ldr r3, [r7, #4]
|
|
8002230: 2201 movs r2, #1
|
|
8002232: 63da str r2, [r3, #60] @ 0x3c
|
|
|
|
/* Change the DMA state */
|
|
hdma->State = HAL_DMA_STATE_READY;
|
|
8002234: 687b ldr r3, [r7, #4]
|
|
8002236: 2201 movs r2, #1
|
|
8002238: f883 2025 strb.w r2, [r3, #37] @ 0x25
|
|
|
|
/* Process Unlocked */
|
|
__HAL_UNLOCK(hdma);
|
|
800223c: 687b ldr r3, [r7, #4]
|
|
800223e: 2200 movs r2, #0
|
|
8002240: f883 2024 strb.w r2, [r3, #36] @ 0x24
|
|
|
|
if (hdma->XferErrorCallback != NULL)
|
|
8002244: 687b ldr r3, [r7, #4]
|
|
8002246: 6b5b ldr r3, [r3, #52] @ 0x34
|
|
8002248: 2b00 cmp r3, #0
|
|
800224a: d004 beq.n 8002256 <HAL_DMA_IRQHandler+0x176>
|
|
{
|
|
/* Transfer error callback */
|
|
hdma->XferErrorCallback(hdma);
|
|
800224c: 687b ldr r3, [r7, #4]
|
|
800224e: 6b5b ldr r3, [r3, #52] @ 0x34
|
|
8002250: 6878 ldr r0, [r7, #4]
|
|
8002252: 4798 blx r3
|
|
}
|
|
else
|
|
{
|
|
/* Nothing To Do */
|
|
}
|
|
return;
|
|
8002254: bf00 nop
|
|
8002256: bf00 nop
|
|
}
|
|
8002258: 3710 adds r7, #16
|
|
800225a: 46bd mov sp, r7
|
|
800225c: bd80 pop {r7, pc}
|
|
800225e: bf00 nop
|
|
8002260: 40020080 .word 0x40020080
|
|
8002264: 40020400 .word 0x40020400
|
|
8002268: 40020000 .word 0x40020000
|
|
|
|
0800226c <HAL_DMA_GetError>:
|
|
* @param hdma Pointer to a DMA_HandleTypeDef structure that contains
|
|
* the configuration information for the specified DMA Channel.
|
|
* @retval DMA Error Code
|
|
*/
|
|
uint32_t HAL_DMA_GetError(DMA_HandleTypeDef *hdma)
|
|
{
|
|
800226c: b480 push {r7}
|
|
800226e: b083 sub sp, #12
|
|
8002270: af00 add r7, sp, #0
|
|
8002272: 6078 str r0, [r7, #4]
|
|
/* Return the DMA error code */
|
|
return hdma->ErrorCode;
|
|
8002274: 687b ldr r3, [r7, #4]
|
|
8002276: 6bdb ldr r3, [r3, #60] @ 0x3c
|
|
}
|
|
8002278: 4618 mov r0, r3
|
|
800227a: 370c adds r7, #12
|
|
800227c: 46bd mov sp, r7
|
|
800227e: bc80 pop {r7}
|
|
8002280: 4770 bx lr
|
|
|
|
08002282 <HAL_DMA_ConfigChannelAttributes>:
|
|
* @param ChannelAttributes specifies the DMA channel secure/privilege attributes.
|
|
* This parameter can be a one or a combination of @ref DMA_Channel_Attributes
|
|
* @retval HAL Status
|
|
*/
|
|
HAL_StatusTypeDef HAL_DMA_ConfigChannelAttributes(DMA_HandleTypeDef *hdma, uint32_t ChannelAttributes)
|
|
{
|
|
8002282: b480 push {r7}
|
|
8002284: b085 sub sp, #20
|
|
8002286: af00 add r7, sp, #0
|
|
8002288: 6078 str r0, [r7, #4]
|
|
800228a: 6039 str r1, [r7, #0]
|
|
HAL_StatusTypeDef status = HAL_OK;
|
|
800228c: 2300 movs r3, #0
|
|
800228e: 72fb strb r3, [r7, #11]
|
|
#if defined (CORE_CM0PLUS)
|
|
uint32_t ccr_SECM;
|
|
#endif /* CORE_CM0PLUS */
|
|
|
|
/* Check the DMA peripheral handle */
|
|
if (hdma == NULL)
|
|
8002290: 687b ldr r3, [r7, #4]
|
|
8002292: 2b00 cmp r3, #0
|
|
8002294: d103 bne.n 800229e <HAL_DMA_ConfigChannelAttributes+0x1c>
|
|
{
|
|
status = HAL_ERROR;
|
|
8002296: 2301 movs r3, #1
|
|
8002298: 72fb strb r3, [r7, #11]
|
|
return status;
|
|
800229a: 7afb ldrb r3, [r7, #11]
|
|
800229c: e01b b.n 80022d6 <HAL_DMA_ConfigChannelAttributes+0x54>
|
|
|
|
/* Check the parameters */
|
|
assert_param(IS_DMA_ATTRIBUTES(ChannelAttributes));
|
|
|
|
/* Read CCR register */
|
|
ccr = READ_REG(hdma->Instance->CCR);
|
|
800229e: 687b ldr r3, [r7, #4]
|
|
80022a0: 681b ldr r3, [r3, #0]
|
|
80022a2: 681b ldr r3, [r3, #0]
|
|
80022a4: 60fb str r3, [r7, #12]
|
|
|
|
/* Apply any requested privilege/non-privilege attributes */
|
|
if ((ChannelAttributes & DMA_CHANNEL_ATTR_PRIV_MASK) != 0U)
|
|
80022a6: 683b ldr r3, [r7, #0]
|
|
80022a8: f003 0310 and.w r3, r3, #16
|
|
80022ac: 2b00 cmp r3, #0
|
|
80022ae: d00d beq.n 80022cc <HAL_DMA_ConfigChannelAttributes+0x4a>
|
|
{
|
|
if ((ChannelAttributes & DMA_CCR_PRIV) != 0U)
|
|
80022b0: 683b ldr r3, [r7, #0]
|
|
80022b2: f403 1380 and.w r3, r3, #1048576 @ 0x100000
|
|
80022b6: 2b00 cmp r3, #0
|
|
80022b8: d004 beq.n 80022c4 <HAL_DMA_ConfigChannelAttributes+0x42>
|
|
{
|
|
SET_BIT(ccr, DMA_CCR_PRIV);
|
|
80022ba: 68fb ldr r3, [r7, #12]
|
|
80022bc: f443 1380 orr.w r3, r3, #1048576 @ 0x100000
|
|
80022c0: 60fb str r3, [r7, #12]
|
|
80022c2: e003 b.n 80022cc <HAL_DMA_ConfigChannelAttributes+0x4a>
|
|
}
|
|
else
|
|
{
|
|
CLEAR_BIT(ccr, DMA_CCR_PRIV);
|
|
80022c4: 68fb ldr r3, [r7, #12]
|
|
80022c6: f423 1380 bic.w r3, r3, #1048576 @ 0x100000
|
|
80022ca: 60fb str r3, [r7, #12]
|
|
}
|
|
|
|
#endif /* CORE_CM0PLUS */
|
|
|
|
/* Update CCR Register: PRIV, SECM, SCEC, DSEC bits */
|
|
WRITE_REG(hdma->Instance->CCR, ccr);
|
|
80022cc: 687b ldr r3, [r7, #4]
|
|
80022ce: 681b ldr r3, [r3, #0]
|
|
80022d0: 68fa ldr r2, [r7, #12]
|
|
80022d2: 601a str r2, [r3, #0]
|
|
|
|
return status;
|
|
80022d4: 7afb ldrb r3, [r7, #11]
|
|
}
|
|
80022d6: 4618 mov r0, r3
|
|
80022d8: 3714 adds r7, #20
|
|
80022da: 46bd mov sp, r7
|
|
80022dc: bc80 pop {r7}
|
|
80022de: 4770 bx lr
|
|
|
|
080022e0 <DMA_SetConfig>:
|
|
* @param DstAddress The destination memory Buffer address
|
|
* @param DataLength The length of data to be transferred from source to destination
|
|
* @retval HAL status
|
|
*/
|
|
static void DMA_SetConfig(DMA_HandleTypeDef *hdma, uint32_t SrcAddress, uint32_t DstAddress, uint32_t DataLength)
|
|
{
|
|
80022e0: b480 push {r7}
|
|
80022e2: b085 sub sp, #20
|
|
80022e4: af00 add r7, sp, #0
|
|
80022e6: 60f8 str r0, [r7, #12]
|
|
80022e8: 60b9 str r1, [r7, #8]
|
|
80022ea: 607a str r2, [r7, #4]
|
|
80022ec: 603b str r3, [r7, #0]
|
|
/* Clear the DMAMUX synchro overrun flag */
|
|
hdma->DMAmuxChannelStatus->CFR = hdma->DMAmuxChannelStatusMask;
|
|
80022ee: 68fb ldr r3, [r7, #12]
|
|
80022f0: 6cdb ldr r3, [r3, #76] @ 0x4c
|
|
80022f2: 68fa ldr r2, [r7, #12]
|
|
80022f4: 6d12 ldr r2, [r2, #80] @ 0x50
|
|
80022f6: 605a str r2, [r3, #4]
|
|
|
|
if (hdma->DMAmuxRequestGen != NULL)
|
|
80022f8: 68fb ldr r3, [r7, #12]
|
|
80022fa: 6d5b ldr r3, [r3, #84] @ 0x54
|
|
80022fc: 2b00 cmp r3, #0
|
|
80022fe: d004 beq.n 800230a <DMA_SetConfig+0x2a>
|
|
{
|
|
/* Clear the DMAMUX request generator overrun flag */
|
|
hdma->DMAmuxRequestGenStatus->RGCFR = hdma->DMAmuxRequestGenStatusMask;
|
|
8002300: 68fb ldr r3, [r7, #12]
|
|
8002302: 6d9b ldr r3, [r3, #88] @ 0x58
|
|
8002304: 68fa ldr r2, [r7, #12]
|
|
8002306: 6dd2 ldr r2, [r2, #92] @ 0x5c
|
|
8002308: 605a str r2, [r3, #4]
|
|
}
|
|
|
|
/* Clear all flags */
|
|
hdma->DmaBaseAddress->IFCR = (DMA_ISR_GIF1 << (hdma->ChannelIndex & 0x1CU));
|
|
800230a: 68fb ldr r3, [r7, #12]
|
|
800230c: 6c5b ldr r3, [r3, #68] @ 0x44
|
|
800230e: f003 021c and.w r2, r3, #28
|
|
8002312: 68fb ldr r3, [r7, #12]
|
|
8002314: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
8002316: 2101 movs r1, #1
|
|
8002318: fa01 f202 lsl.w r2, r1, r2
|
|
800231c: 605a str r2, [r3, #4]
|
|
|
|
/* Configure DMA Channel data length */
|
|
hdma->Instance->CNDTR = DataLength;
|
|
800231e: 68fb ldr r3, [r7, #12]
|
|
8002320: 681b ldr r3, [r3, #0]
|
|
8002322: 683a ldr r2, [r7, #0]
|
|
8002324: 605a str r2, [r3, #4]
|
|
|
|
/* Memory to Peripheral */
|
|
if ((hdma->Init.Direction) == DMA_MEMORY_TO_PERIPH)
|
|
8002326: 68fb ldr r3, [r7, #12]
|
|
8002328: 689b ldr r3, [r3, #8]
|
|
800232a: 2b10 cmp r3, #16
|
|
800232c: d108 bne.n 8002340 <DMA_SetConfig+0x60>
|
|
{
|
|
/* Configure DMA Channel destination address */
|
|
hdma->Instance->CPAR = DstAddress;
|
|
800232e: 68fb ldr r3, [r7, #12]
|
|
8002330: 681b ldr r3, [r3, #0]
|
|
8002332: 687a ldr r2, [r7, #4]
|
|
8002334: 609a str r2, [r3, #8]
|
|
|
|
/* Configure DMA Channel source address */
|
|
hdma->Instance->CMAR = SrcAddress;
|
|
8002336: 68fb ldr r3, [r7, #12]
|
|
8002338: 681b ldr r3, [r3, #0]
|
|
800233a: 68ba ldr r2, [r7, #8]
|
|
800233c: 60da str r2, [r3, #12]
|
|
hdma->Instance->CPAR = SrcAddress;
|
|
|
|
/* Configure DMA Channel destination address */
|
|
hdma->Instance->CMAR = DstAddress;
|
|
}
|
|
}
|
|
800233e: e007 b.n 8002350 <DMA_SetConfig+0x70>
|
|
hdma->Instance->CPAR = SrcAddress;
|
|
8002340: 68fb ldr r3, [r7, #12]
|
|
8002342: 681b ldr r3, [r3, #0]
|
|
8002344: 68ba ldr r2, [r7, #8]
|
|
8002346: 609a str r2, [r3, #8]
|
|
hdma->Instance->CMAR = DstAddress;
|
|
8002348: 68fb ldr r3, [r7, #12]
|
|
800234a: 681b ldr r3, [r3, #0]
|
|
800234c: 687a ldr r2, [r7, #4]
|
|
800234e: 60da str r2, [r3, #12]
|
|
}
|
|
8002350: bf00 nop
|
|
8002352: 3714 adds r7, #20
|
|
8002354: 46bd mov sp, r7
|
|
8002356: bc80 pop {r7}
|
|
8002358: 4770 bx lr
|
|
...
|
|
|
|
0800235c <DMA_CalcDMAMUXChannelBaseAndMask>:
|
|
* @param hdma Pointer to a DMA_HandleTypeDef structure that contains
|
|
* the configuration information for the specified DMA Channel.
|
|
* @retval None
|
|
*/
|
|
static void DMA_CalcDMAMUXChannelBaseAndMask(DMA_HandleTypeDef *hdma)
|
|
{
|
|
800235c: b480 push {r7}
|
|
800235e: b085 sub sp, #20
|
|
8002360: af00 add r7, sp, #0
|
|
8002362: 6078 str r0, [r7, #4]
|
|
uint32_t channel_number;
|
|
|
|
/* check if instance is not outside the DMA channel range */
|
|
if ((uint32_t)hdma->Instance < (uint32_t)DMA2_Channel1)
|
|
8002364: 687b ldr r3, [r7, #4]
|
|
8002366: 681b ldr r3, [r3, #0]
|
|
8002368: 461a mov r2, r3
|
|
800236a: 4b1c ldr r3, [pc, #112] @ (80023dc <DMA_CalcDMAMUXChannelBaseAndMask+0x80>)
|
|
800236c: 429a cmp r2, r3
|
|
800236e: d813 bhi.n 8002398 <DMA_CalcDMAMUXChannelBaseAndMask+0x3c>
|
|
{
|
|
/* DMA1 */
|
|
/* Associate a DMA Channel to a DMAMUX channel */
|
|
hdma->DMAmuxChannel = (DMAMUX1_Channel0 + (hdma->ChannelIndex >> 2U));
|
|
8002370: 687b ldr r3, [r7, #4]
|
|
8002372: 6c5b ldr r3, [r3, #68] @ 0x44
|
|
8002374: 089b lsrs r3, r3, #2
|
|
8002376: 009b lsls r3, r3, #2
|
|
8002378: f103 4380 add.w r3, r3, #1073741824 @ 0x40000000
|
|
800237c: f503 3302 add.w r3, r3, #133120 @ 0x20800
|
|
8002380: 687a ldr r2, [r7, #4]
|
|
8002382: 6493 str r3, [r2, #72] @ 0x48
|
|
|
|
/* Prepare channel_number used for DMAmuxChannelStatusMask computation */
|
|
channel_number = (((uint32_t)hdma->Instance & 0xFFU) - 8U) / 20U;
|
|
8002384: 687b ldr r3, [r7, #4]
|
|
8002386: 681b ldr r3, [r3, #0]
|
|
8002388: b2db uxtb r3, r3
|
|
800238a: 3b08 subs r3, #8
|
|
800238c: 4a14 ldr r2, [pc, #80] @ (80023e0 <DMA_CalcDMAMUXChannelBaseAndMask+0x84>)
|
|
800238e: fba2 2303 umull r2, r3, r2, r3
|
|
8002392: 091b lsrs r3, r3, #4
|
|
8002394: 60fb str r3, [r7, #12]
|
|
8002396: e011 b.n 80023bc <DMA_CalcDMAMUXChannelBaseAndMask+0x60>
|
|
}
|
|
else
|
|
{
|
|
/* DMA2 */
|
|
/* Associate a DMA Channel to a DMAMUX channel */
|
|
hdma->DMAmuxChannel = (DMAMUX1_Channel7 + (hdma->ChannelIndex >> 2U));
|
|
8002398: 687b ldr r3, [r7, #4]
|
|
800239a: 6c5b ldr r3, [r3, #68] @ 0x44
|
|
800239c: 089b lsrs r3, r3, #2
|
|
800239e: 009a lsls r2, r3, #2
|
|
80023a0: 4b10 ldr r3, [pc, #64] @ (80023e4 <DMA_CalcDMAMUXChannelBaseAndMask+0x88>)
|
|
80023a2: 4413 add r3, r2
|
|
80023a4: 687a ldr r2, [r7, #4]
|
|
80023a6: 6493 str r3, [r2, #72] @ 0x48
|
|
|
|
/* Prepare channel_number used for DMAmuxChannelStatusMask computation */
|
|
channel_number = (((((uint32_t)hdma->Instance & 0xFFU) - 8U) / 20U) + 7U);
|
|
80023a8: 687b ldr r3, [r7, #4]
|
|
80023aa: 681b ldr r3, [r3, #0]
|
|
80023ac: b2db uxtb r3, r3
|
|
80023ae: 3b08 subs r3, #8
|
|
80023b0: 4a0b ldr r2, [pc, #44] @ (80023e0 <DMA_CalcDMAMUXChannelBaseAndMask+0x84>)
|
|
80023b2: fba2 2303 umull r2, r3, r2, r3
|
|
80023b6: 091b lsrs r3, r3, #4
|
|
80023b8: 3307 adds r3, #7
|
|
80023ba: 60fb str r3, [r7, #12]
|
|
}
|
|
|
|
/* Initialize the field DMAmuxChannelStatus to DMAMUX1_ChannelStatus base */
|
|
hdma->DMAmuxChannelStatus = DMAMUX1_ChannelStatus;
|
|
80023bc: 687b ldr r3, [r7, #4]
|
|
80023be: 4a0a ldr r2, [pc, #40] @ (80023e8 <DMA_CalcDMAMUXChannelBaseAndMask+0x8c>)
|
|
80023c0: 64da str r2, [r3, #76] @ 0x4c
|
|
|
|
/* Initialize the field DMAmuxChannelStatusMask with the corresponding index of the DMAMUX channel selected for the current ChannelIndex */
|
|
hdma->DMAmuxChannelStatusMask = 1UL << (channel_number & 0x1FU);
|
|
80023c2: 68fb ldr r3, [r7, #12]
|
|
80023c4: f003 031f and.w r3, r3, #31
|
|
80023c8: 2201 movs r2, #1
|
|
80023ca: 409a lsls r2, r3
|
|
80023cc: 687b ldr r3, [r7, #4]
|
|
80023ce: 651a str r2, [r3, #80] @ 0x50
|
|
}
|
|
80023d0: bf00 nop
|
|
80023d2: 3714 adds r7, #20
|
|
80023d4: 46bd mov sp, r7
|
|
80023d6: bc80 pop {r7}
|
|
80023d8: 4770 bx lr
|
|
80023da: bf00 nop
|
|
80023dc: 40020407 .word 0x40020407
|
|
80023e0: cccccccd .word 0xcccccccd
|
|
80023e4: 4002081c .word 0x4002081c
|
|
80023e8: 40020880 .word 0x40020880
|
|
|
|
080023ec <DMA_CalcDMAMUXRequestGenBaseAndMask>:
|
|
* the configuration information for the specified DMA Channel.
|
|
* @retval None
|
|
*/
|
|
|
|
static void DMA_CalcDMAMUXRequestGenBaseAndMask(DMA_HandleTypeDef *hdma)
|
|
{
|
|
80023ec: b480 push {r7}
|
|
80023ee: b085 sub sp, #20
|
|
80023f0: af00 add r7, sp, #0
|
|
80023f2: 6078 str r0, [r7, #4]
|
|
uint32_t request = hdma->Init.Request & DMAMUX_CxCR_DMAREQ_ID;
|
|
80023f4: 687b ldr r3, [r7, #4]
|
|
80023f6: 685b ldr r3, [r3, #4]
|
|
80023f8: f003 037f and.w r3, r3, #127 @ 0x7f
|
|
80023fc: 60fb str r3, [r7, #12]
|
|
|
|
/* DMA Channels are connected to DMAMUX1 request generator blocks*/
|
|
hdma->DMAmuxRequestGen = (DMAMUX_RequestGen_TypeDef *)((uint32_t)(((uint32_t)DMAMUX1_RequestGenerator0) + ((request - 1U) * 4U)));
|
|
80023fe: 68fa ldr r2, [r7, #12]
|
|
8002400: 4b0a ldr r3, [pc, #40] @ (800242c <DMA_CalcDMAMUXRequestGenBaseAndMask+0x40>)
|
|
8002402: 4413 add r3, r2
|
|
8002404: 009b lsls r3, r3, #2
|
|
8002406: 461a mov r2, r3
|
|
8002408: 687b ldr r3, [r7, #4]
|
|
800240a: 655a str r2, [r3, #84] @ 0x54
|
|
|
|
hdma->DMAmuxRequestGenStatus = DMAMUX1_RequestGenStatus;
|
|
800240c: 687b ldr r3, [r7, #4]
|
|
800240e: 4a08 ldr r2, [pc, #32] @ (8002430 <DMA_CalcDMAMUXRequestGenBaseAndMask+0x44>)
|
|
8002410: 659a str r2, [r3, #88] @ 0x58
|
|
|
|
/* here "Request" is either DMA_REQUEST_GENERATOR0 to DMA_REQUEST_GENERATOR3, i.e. <= 4*/
|
|
hdma->DMAmuxRequestGenStatusMask = 1UL << ((request - 1U) & 0x3U);
|
|
8002412: 68fb ldr r3, [r7, #12]
|
|
8002414: 3b01 subs r3, #1
|
|
8002416: f003 0303 and.w r3, r3, #3
|
|
800241a: 2201 movs r2, #1
|
|
800241c: 409a lsls r2, r3
|
|
800241e: 687b ldr r3, [r7, #4]
|
|
8002420: 65da str r2, [r3, #92] @ 0x5c
|
|
}
|
|
8002422: bf00 nop
|
|
8002424: 3714 adds r7, #20
|
|
8002426: 46bd mov sp, r7
|
|
8002428: bc80 pop {r7}
|
|
800242a: 4770 bx lr
|
|
800242c: 1000823f .word 0x1000823f
|
|
8002430: 40020940 .word 0x40020940
|
|
|
|
08002434 <HAL_FLASH_Program>:
|
|
* are stored the data for the row fast program.
|
|
*
|
|
* @retval HAL_StatusTypeDef HAL Status
|
|
*/
|
|
HAL_StatusTypeDef HAL_FLASH_Program(uint32_t TypeProgram, uint32_t Address, uint64_t Data)
|
|
{
|
|
8002434: b580 push {r7, lr}
|
|
8002436: b086 sub sp, #24
|
|
8002438: af00 add r7, sp, #0
|
|
800243a: 60f8 str r0, [r7, #12]
|
|
800243c: 60b9 str r1, [r7, #8]
|
|
800243e: e9c7 2300 strd r2, r3, [r7]
|
|
assert_param(IS_FLASH_TYPEPROGRAM(TypeProgram));
|
|
assert_param(IS_ADDR_ALIGNED_64BITS(Address));
|
|
assert_param(IS_FLASH_PROGRAM_ADDRESS(Address));
|
|
|
|
/* Process Locked */
|
|
__HAL_LOCK(&pFlash);
|
|
8002442: 4b1c ldr r3, [pc, #112] @ (80024b4 <HAL_FLASH_Program+0x80>)
|
|
8002444: 781b ldrb r3, [r3, #0]
|
|
8002446: 2b01 cmp r3, #1
|
|
8002448: d101 bne.n 800244e <HAL_FLASH_Program+0x1a>
|
|
800244a: 2302 movs r3, #2
|
|
800244c: e02d b.n 80024aa <HAL_FLASH_Program+0x76>
|
|
800244e: 4b19 ldr r3, [pc, #100] @ (80024b4 <HAL_FLASH_Program+0x80>)
|
|
8002450: 2201 movs r2, #1
|
|
8002452: 701a strb r2, [r3, #0]
|
|
|
|
/* Reset error code */
|
|
pFlash.ErrorCode = HAL_FLASH_ERROR_NONE;
|
|
8002454: 4b17 ldr r3, [pc, #92] @ (80024b4 <HAL_FLASH_Program+0x80>)
|
|
8002456: 2200 movs r2, #0
|
|
8002458: 605a str r2, [r3, #4]
|
|
|
|
/* Verify that next operation can be proceed */
|
|
status = FLASH_WaitForLastOperation(FLASH_TIMEOUT_VALUE);
|
|
800245a: f44f 707a mov.w r0, #1000 @ 0x3e8
|
|
800245e: f000 f869 bl 8002534 <FLASH_WaitForLastOperation>
|
|
8002462: 4603 mov r3, r0
|
|
8002464: 75fb strb r3, [r7, #23]
|
|
|
|
if (status == HAL_OK)
|
|
8002466: 7dfb ldrb r3, [r7, #23]
|
|
8002468: 2b00 cmp r3, #0
|
|
800246a: d11a bne.n 80024a2 <HAL_FLASH_Program+0x6e>
|
|
{
|
|
if (TypeProgram == FLASH_TYPEPROGRAM_DOUBLEWORD)
|
|
800246c: 68fb ldr r3, [r7, #12]
|
|
800246e: 2b01 cmp r3, #1
|
|
8002470: d105 bne.n 800247e <HAL_FLASH_Program+0x4a>
|
|
{
|
|
/* Check the parameters */
|
|
assert_param(IS_FLASH_PROGRAM_ADDRESS(Address));
|
|
|
|
/* Program double-word (64-bit) at a specified address */
|
|
FLASH_Program_DoubleWord(Address, Data);
|
|
8002472: e9d7 2300 ldrd r2, r3, [r7]
|
|
8002476: 68b8 ldr r0, [r7, #8]
|
|
8002478: f000 f8be bl 80025f8 <FLASH_Program_DoubleWord>
|
|
800247c: e004 b.n 8002488 <HAL_FLASH_Program+0x54>
|
|
{
|
|
/* Check the parameters */
|
|
assert_param(IS_FLASH_FAST_PROGRAM_ADDRESS(Address));
|
|
|
|
/* Fast program a 32 double-word (64-bit) row at a specified address */
|
|
FLASH_Program_Fast(Address, (uint32_t)Data);
|
|
800247e: 683b ldr r3, [r7, #0]
|
|
8002480: 4619 mov r1, r3
|
|
8002482: 68b8 ldr r0, [r7, #8]
|
|
8002484: f000 f8de bl 8002644 <FLASH_Program_Fast>
|
|
}
|
|
|
|
/* Wait for last operation to be completed */
|
|
status = FLASH_WaitForLastOperation(FLASH_TIMEOUT_VALUE);
|
|
8002488: f44f 707a mov.w r0, #1000 @ 0x3e8
|
|
800248c: f000 f852 bl 8002534 <FLASH_WaitForLastOperation>
|
|
8002490: 4603 mov r3, r0
|
|
8002492: 75fb strb r3, [r7, #23]
|
|
|
|
/* If the program operation is completed, disable the PG or FSTPG Bit */
|
|
#ifdef CORE_CM0PLUS
|
|
CLEAR_BIT(FLASH->C2CR, TypeProgram);
|
|
#else
|
|
CLEAR_BIT(FLASH->CR, TypeProgram);
|
|
8002494: 4b08 ldr r3, [pc, #32] @ (80024b8 <HAL_FLASH_Program+0x84>)
|
|
8002496: 695a ldr r2, [r3, #20]
|
|
8002498: 68fb ldr r3, [r7, #12]
|
|
800249a: 43db mvns r3, r3
|
|
800249c: 4906 ldr r1, [pc, #24] @ (80024b8 <HAL_FLASH_Program+0x84>)
|
|
800249e: 4013 ands r3, r2
|
|
80024a0: 614b str r3, [r1, #20]
|
|
#endif
|
|
}
|
|
|
|
/* Process Unlocked */
|
|
__HAL_UNLOCK(&pFlash);
|
|
80024a2: 4b04 ldr r3, [pc, #16] @ (80024b4 <HAL_FLASH_Program+0x80>)
|
|
80024a4: 2200 movs r2, #0
|
|
80024a6: 701a strb r2, [r3, #0]
|
|
|
|
/* return status */
|
|
return status;
|
|
80024a8: 7dfb ldrb r3, [r7, #23]
|
|
}
|
|
80024aa: 4618 mov r0, r3
|
|
80024ac: 3718 adds r7, #24
|
|
80024ae: 46bd mov sp, r7
|
|
80024b0: bd80 pop {r7, pc}
|
|
80024b2: bf00 nop
|
|
80024b4: 200001dc .word 0x200001dc
|
|
80024b8: 58004000 .word 0x58004000
|
|
|
|
080024bc <HAL_FLASH_Unlock>:
|
|
/**
|
|
* @brief Unlock the FLASH control register access.
|
|
* @retval HAL Status
|
|
*/
|
|
HAL_StatusTypeDef HAL_FLASH_Unlock(void)
|
|
{
|
|
80024bc: b480 push {r7}
|
|
80024be: b083 sub sp, #12
|
|
80024c0: af00 add r7, sp, #0
|
|
HAL_StatusTypeDef status = HAL_OK;
|
|
80024c2: 2300 movs r3, #0
|
|
80024c4: 71fb strb r3, [r7, #7]
|
|
|
|
if (READ_BIT(FLASH->CR, FLASH_CR_LOCK) != 0U)
|
|
80024c6: 4b0b ldr r3, [pc, #44] @ (80024f4 <HAL_FLASH_Unlock+0x38>)
|
|
80024c8: 695b ldr r3, [r3, #20]
|
|
80024ca: 2b00 cmp r3, #0
|
|
80024cc: da0b bge.n 80024e6 <HAL_FLASH_Unlock+0x2a>
|
|
{
|
|
/* Authorize the FLASH Registers access */
|
|
WRITE_REG(FLASH->KEYR, FLASH_KEY1);
|
|
80024ce: 4b09 ldr r3, [pc, #36] @ (80024f4 <HAL_FLASH_Unlock+0x38>)
|
|
80024d0: 4a09 ldr r2, [pc, #36] @ (80024f8 <HAL_FLASH_Unlock+0x3c>)
|
|
80024d2: 609a str r2, [r3, #8]
|
|
WRITE_REG(FLASH->KEYR, FLASH_KEY2);
|
|
80024d4: 4b07 ldr r3, [pc, #28] @ (80024f4 <HAL_FLASH_Unlock+0x38>)
|
|
80024d6: 4a09 ldr r2, [pc, #36] @ (80024fc <HAL_FLASH_Unlock+0x40>)
|
|
80024d8: 609a str r2, [r3, #8]
|
|
|
|
/* verify Flash is unlock */
|
|
if (READ_BIT(FLASH->CR, FLASH_CR_LOCK) != 0U)
|
|
80024da: 4b06 ldr r3, [pc, #24] @ (80024f4 <HAL_FLASH_Unlock+0x38>)
|
|
80024dc: 695b ldr r3, [r3, #20]
|
|
80024de: 2b00 cmp r3, #0
|
|
80024e0: da01 bge.n 80024e6 <HAL_FLASH_Unlock+0x2a>
|
|
{
|
|
status = HAL_ERROR;
|
|
80024e2: 2301 movs r3, #1
|
|
80024e4: 71fb strb r3, [r7, #7]
|
|
}
|
|
}
|
|
|
|
return status;
|
|
80024e6: 79fb ldrb r3, [r7, #7]
|
|
}
|
|
80024e8: 4618 mov r0, r3
|
|
80024ea: 370c adds r7, #12
|
|
80024ec: 46bd mov sp, r7
|
|
80024ee: bc80 pop {r7}
|
|
80024f0: 4770 bx lr
|
|
80024f2: bf00 nop
|
|
80024f4: 58004000 .word 0x58004000
|
|
80024f8: 45670123 .word 0x45670123
|
|
80024fc: cdef89ab .word 0xcdef89ab
|
|
|
|
08002500 <HAL_FLASH_Lock>:
|
|
/**
|
|
* @brief Lock the FLASH control register access.
|
|
* @retval HAL Status
|
|
*/
|
|
HAL_StatusTypeDef HAL_FLASH_Lock(void)
|
|
{
|
|
8002500: b480 push {r7}
|
|
8002502: b083 sub sp, #12
|
|
8002504: af00 add r7, sp, #0
|
|
HAL_StatusTypeDef status = HAL_OK;
|
|
8002506: 2300 movs r3, #0
|
|
8002508: 71fb strb r3, [r7, #7]
|
|
|
|
/* Set the LOCK Bit to lock the FLASH Registers access */
|
|
/* @Note The lock and unlock procedure is done only using CR registers even from CPU2 */
|
|
SET_BIT(FLASH->CR, FLASH_CR_LOCK);
|
|
800250a: 4b09 ldr r3, [pc, #36] @ (8002530 <HAL_FLASH_Lock+0x30>)
|
|
800250c: 695b ldr r3, [r3, #20]
|
|
800250e: 4a08 ldr r2, [pc, #32] @ (8002530 <HAL_FLASH_Lock+0x30>)
|
|
8002510: f043 4300 orr.w r3, r3, #2147483648 @ 0x80000000
|
|
8002514: 6153 str r3, [r2, #20]
|
|
|
|
/* verify Flash is locked */
|
|
if (READ_BIT(FLASH->CR, FLASH_CR_LOCK) == 0U)
|
|
8002516: 4b06 ldr r3, [pc, #24] @ (8002530 <HAL_FLASH_Lock+0x30>)
|
|
8002518: 695b ldr r3, [r3, #20]
|
|
800251a: 2b00 cmp r3, #0
|
|
800251c: db01 blt.n 8002522 <HAL_FLASH_Lock+0x22>
|
|
{
|
|
status = HAL_ERROR;
|
|
800251e: 2301 movs r3, #1
|
|
8002520: 71fb strb r3, [r7, #7]
|
|
}
|
|
|
|
return status;
|
|
8002522: 79fb ldrb r3, [r7, #7]
|
|
}
|
|
8002524: 4618 mov r0, r3
|
|
8002526: 370c adds r7, #12
|
|
8002528: 46bd mov sp, r7
|
|
800252a: bc80 pop {r7}
|
|
800252c: 4770 bx lr
|
|
800252e: bf00 nop
|
|
8002530: 58004000 .word 0x58004000
|
|
|
|
08002534 <FLASH_WaitForLastOperation>:
|
|
* @brief Wait for a FLASH operation to complete.
|
|
* @param Timeout Maximum flash operation timeout
|
|
* @retval HAL_StatusTypeDef HAL Status
|
|
*/
|
|
HAL_StatusTypeDef FLASH_WaitForLastOperation(uint32_t Timeout)
|
|
{
|
|
8002534: b580 push {r7, lr}
|
|
8002536: b084 sub sp, #16
|
|
8002538: af00 add r7, sp, #0
|
|
800253a: 6078 str r0, [r7, #4]
|
|
uint32_t error;
|
|
uint32_t tickstart = HAL_GetTick();
|
|
800253c: f7fe fb84 bl 8000c48 <HAL_GetTick>
|
|
8002540: 60f8 str r0, [r7, #12]
|
|
|
|
/* Wait for the FLASH operation to complete by polling on BUSY flag to be reset.
|
|
Even if the FLASH operation fails, the BUSY flag will be reset and an error
|
|
flag will be set */
|
|
while (__HAL_FLASH_GET_FLAG(FLASH_FLAG_BSY))
|
|
8002542: e009 b.n 8002558 <FLASH_WaitForLastOperation+0x24>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) >= Timeout)
|
|
8002544: f7fe fb80 bl 8000c48 <HAL_GetTick>
|
|
8002548: 4602 mov r2, r0
|
|
800254a: 68fb ldr r3, [r7, #12]
|
|
800254c: 1ad3 subs r3, r2, r3
|
|
800254e: 687a ldr r2, [r7, #4]
|
|
8002550: 429a cmp r2, r3
|
|
8002552: d801 bhi.n 8002558 <FLASH_WaitForLastOperation+0x24>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
8002554: 2303 movs r3, #3
|
|
8002556: e046 b.n 80025e6 <FLASH_WaitForLastOperation+0xb2>
|
|
while (__HAL_FLASH_GET_FLAG(FLASH_FLAG_BSY))
|
|
8002558: 4b25 ldr r3, [pc, #148] @ (80025f0 <FLASH_WaitForLastOperation+0xbc>)
|
|
800255a: 691b ldr r3, [r3, #16]
|
|
800255c: f403 3380 and.w r3, r3, #65536 @ 0x10000
|
|
8002560: f5b3 3f80 cmp.w r3, #65536 @ 0x10000
|
|
8002564: d0ee beq.n 8002544 <FLASH_WaitForLastOperation+0x10>
|
|
/* check flash errors. Only ECC correction can be checked here as ECCD
|
|
generates NMI */
|
|
#ifdef CORE_CM0PLUS
|
|
error = FLASH->C2SR;
|
|
#else
|
|
error = FLASH->SR;
|
|
8002566: 4b22 ldr r3, [pc, #136] @ (80025f0 <FLASH_WaitForLastOperation+0xbc>)
|
|
8002568: 691b ldr r3, [r3, #16]
|
|
800256a: 60bb str r3, [r7, #8]
|
|
#endif
|
|
|
|
/* Check FLASH End of Operation flag */
|
|
if ((error & FLASH_FLAG_EOP) != 0U)
|
|
800256c: 68bb ldr r3, [r7, #8]
|
|
800256e: f003 0301 and.w r3, r3, #1
|
|
8002572: 2b00 cmp r3, #0
|
|
8002574: d002 beq.n 800257c <FLASH_WaitForLastOperation+0x48>
|
|
{
|
|
/* Clear FLASH End of Operation pending bit */
|
|
__HAL_FLASH_CLEAR_FLAG(FLASH_FLAG_EOP);
|
|
8002576: 4b1e ldr r3, [pc, #120] @ (80025f0 <FLASH_WaitForLastOperation+0xbc>)
|
|
8002578: 2201 movs r2, #1
|
|
800257a: 611a str r2, [r3, #16]
|
|
}
|
|
|
|
/* Now update error variable to only error value */
|
|
error &= FLASH_FLAG_SR_ERRORS;
|
|
800257c: 68ba ldr r2, [r7, #8]
|
|
800257e: f24c 33fa movw r3, #50170 @ 0xc3fa
|
|
8002582: 4013 ands r3, r2
|
|
8002584: 60bb str r3, [r7, #8]
|
|
|
|
/* clear error flags */
|
|
__HAL_FLASH_CLEAR_FLAG(error);
|
|
8002586: 68bb ldr r3, [r7, #8]
|
|
8002588: f1b3 4f80 cmp.w r3, #1073741824 @ 0x40000000
|
|
800258c: d307 bcc.n 800259e <FLASH_WaitForLastOperation+0x6a>
|
|
800258e: 4b18 ldr r3, [pc, #96] @ (80025f0 <FLASH_WaitForLastOperation+0xbc>)
|
|
8002590: 699a ldr r2, [r3, #24]
|
|
8002592: 68bb ldr r3, [r7, #8]
|
|
8002594: f003 4340 and.w r3, r3, #3221225472 @ 0xc0000000
|
|
8002598: 4915 ldr r1, [pc, #84] @ (80025f0 <FLASH_WaitForLastOperation+0xbc>)
|
|
800259a: 4313 orrs r3, r2
|
|
800259c: 618b str r3, [r1, #24]
|
|
800259e: 68bb ldr r3, [r7, #8]
|
|
80025a0: f023 4340 bic.w r3, r3, #3221225472 @ 0xc0000000
|
|
80025a4: 2b00 cmp r3, #0
|
|
80025a6: d004 beq.n 80025b2 <FLASH_WaitForLastOperation+0x7e>
|
|
80025a8: 4a11 ldr r2, [pc, #68] @ (80025f0 <FLASH_WaitForLastOperation+0xbc>)
|
|
80025aa: 68bb ldr r3, [r7, #8]
|
|
80025ac: f023 4340 bic.w r3, r3, #3221225472 @ 0xc0000000
|
|
80025b0: 6113 str r3, [r2, #16]
|
|
|
|
if (error != 0U)
|
|
80025b2: 68bb ldr r3, [r7, #8]
|
|
80025b4: 2b00 cmp r3, #0
|
|
80025b6: d00e beq.n 80025d6 <FLASH_WaitForLastOperation+0xa2>
|
|
{
|
|
/*Save the error code*/
|
|
pFlash.ErrorCode = error;
|
|
80025b8: 4a0e ldr r2, [pc, #56] @ (80025f4 <FLASH_WaitForLastOperation+0xc0>)
|
|
80025ba: 68bb ldr r3, [r7, #8]
|
|
80025bc: 6053 str r3, [r2, #4]
|
|
|
|
return HAL_ERROR;
|
|
80025be: 2301 movs r3, #1
|
|
80025c0: e011 b.n 80025e6 <FLASH_WaitForLastOperation+0xb2>
|
|
}
|
|
|
|
/* Wait for control register to be written */
|
|
while (__HAL_FLASH_GET_FLAG(FLASH_FLAG_CFGBSY))
|
|
{
|
|
if ((HAL_GetTick() - tickstart) >= Timeout)
|
|
80025c2: f7fe fb41 bl 8000c48 <HAL_GetTick>
|
|
80025c6: 4602 mov r2, r0
|
|
80025c8: 68fb ldr r3, [r7, #12]
|
|
80025ca: 1ad3 subs r3, r2, r3
|
|
80025cc: 687a ldr r2, [r7, #4]
|
|
80025ce: 429a cmp r2, r3
|
|
80025d0: d801 bhi.n 80025d6 <FLASH_WaitForLastOperation+0xa2>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
80025d2: 2303 movs r3, #3
|
|
80025d4: e007 b.n 80025e6 <FLASH_WaitForLastOperation+0xb2>
|
|
while (__HAL_FLASH_GET_FLAG(FLASH_FLAG_CFGBSY))
|
|
80025d6: 4b06 ldr r3, [pc, #24] @ (80025f0 <FLASH_WaitForLastOperation+0xbc>)
|
|
80025d8: 691b ldr r3, [r3, #16]
|
|
80025da: f403 2380 and.w r3, r3, #262144 @ 0x40000
|
|
80025de: f5b3 2f80 cmp.w r3, #262144 @ 0x40000
|
|
80025e2: d0ee beq.n 80025c2 <FLASH_WaitForLastOperation+0x8e>
|
|
}
|
|
}
|
|
|
|
return HAL_OK;
|
|
80025e4: 2300 movs r3, #0
|
|
}
|
|
80025e6: 4618 mov r0, r3
|
|
80025e8: 3710 adds r7, #16
|
|
80025ea: 46bd mov sp, r7
|
|
80025ec: bd80 pop {r7, pc}
|
|
80025ee: bf00 nop
|
|
80025f0: 58004000 .word 0x58004000
|
|
80025f4: 200001dc .word 0x200001dc
|
|
|
|
080025f8 <FLASH_Program_DoubleWord>:
|
|
* @param Address Specifies the address to be programmed.
|
|
* @param Data Specifies the data to be programmed.
|
|
* @retval None
|
|
*/
|
|
static void FLASH_Program_DoubleWord(uint32_t Address, uint64_t Data)
|
|
{
|
|
80025f8: b480 push {r7}
|
|
80025fa: b085 sub sp, #20
|
|
80025fc: af00 add r7, sp, #0
|
|
80025fe: 60f8 str r0, [r7, #12]
|
|
8002600: e9c7 2300 strd r2, r3, [r7]
|
|
#ifdef CORE_CM0PLUS
|
|
/* Set PG bit */
|
|
SET_BIT(FLASH->C2CR, FLASH_CR_PG);
|
|
#else
|
|
/* Set PG bit */
|
|
SET_BIT(FLASH->CR, FLASH_CR_PG);
|
|
8002604: 4b0e ldr r3, [pc, #56] @ (8002640 <FLASH_Program_DoubleWord+0x48>)
|
|
8002606: 695b ldr r3, [r3, #20]
|
|
8002608: 4a0d ldr r2, [pc, #52] @ (8002640 <FLASH_Program_DoubleWord+0x48>)
|
|
800260a: f043 0301 orr.w r3, r3, #1
|
|
800260e: 6153 str r3, [r2, #20]
|
|
#endif
|
|
|
|
/* Program first word */
|
|
*(uint32_t *)Address = (uint32_t)Data;
|
|
8002610: 68fb ldr r3, [r7, #12]
|
|
8002612: 683a ldr r2, [r7, #0]
|
|
8002614: 601a str r2, [r3, #0]
|
|
__ASM volatile ("isb 0xF":::"memory");
|
|
8002616: f3bf 8f6f isb sy
|
|
}
|
|
800261a: bf00 nop
|
|
/* Barrier to ensure programming is performed in 2 steps, in right order
|
|
(independently of compiler optimization behavior) */
|
|
__ISB();
|
|
|
|
/* Program second word */
|
|
*(uint32_t *)(Address + 4U) = (uint32_t)(Data >> 32U);
|
|
800261c: e9d7 0100 ldrd r0, r1, [r7]
|
|
8002620: f04f 0200 mov.w r2, #0
|
|
8002624: f04f 0300 mov.w r3, #0
|
|
8002628: 000a movs r2, r1
|
|
800262a: 2300 movs r3, #0
|
|
800262c: 68f9 ldr r1, [r7, #12]
|
|
800262e: 3104 adds r1, #4
|
|
8002630: 4613 mov r3, r2
|
|
8002632: 600b str r3, [r1, #0]
|
|
}
|
|
8002634: bf00 nop
|
|
8002636: 3714 adds r7, #20
|
|
8002638: 46bd mov sp, r7
|
|
800263a: bc80 pop {r7}
|
|
800263c: 4770 bx lr
|
|
800263e: bf00 nop
|
|
8002640: 58004000 .word 0x58004000
|
|
|
|
08002644 <FLASH_Program_Fast>:
|
|
#ifdef CORE_CM0PLUS
|
|
static __RAM_FUNC void FLASH_Program_Fast(uint32_t Address, uint32_t DataAddress)
|
|
#else
|
|
static void FLASH_Program_Fast(uint32_t Address, uint32_t DataAddress)
|
|
#endif
|
|
{
|
|
8002644: b480 push {r7}
|
|
8002646: b089 sub sp, #36 @ 0x24
|
|
8002648: af00 add r7, sp, #0
|
|
800264a: 6078 str r0, [r7, #4]
|
|
800264c: 6039 str r1, [r7, #0]
|
|
uint8_t row_index = (2 * FLASH_NB_DOUBLE_WORDS_IN_ROW);
|
|
800264e: 2340 movs r3, #64 @ 0x40
|
|
8002650: 77fb strb r3, [r7, #31]
|
|
__IO uint32_t *dest_addr = (__IO uint32_t *)Address;
|
|
8002652: 687b ldr r3, [r7, #4]
|
|
8002654: 61bb str r3, [r7, #24]
|
|
__IO uint32_t *src_addr = (__IO uint32_t *)DataAddress;
|
|
8002656: 683b ldr r3, [r7, #0]
|
|
8002658: 617b str r3, [r7, #20]
|
|
|
|
/* Set FSTPG bit */
|
|
#ifdef CORE_CM0PLUS
|
|
SET_BIT(FLASH->C2CR, FLASH_CR_FSTPG);
|
|
#else
|
|
SET_BIT(FLASH->CR, FLASH_CR_FSTPG);
|
|
800265a: 4b18 ldr r3, [pc, #96] @ (80026bc <FLASH_Program_Fast+0x78>)
|
|
800265c: 695b ldr r3, [r3, #20]
|
|
800265e: 4a17 ldr r2, [pc, #92] @ (80026bc <FLASH_Program_Fast+0x78>)
|
|
8002660: f443 2380 orr.w r3, r3, #262144 @ 0x40000
|
|
8002664: 6153 str r3, [r2, #20]
|
|
__ASM volatile ("MRS %0, primask" : "=r" (result) :: "memory");
|
|
8002666: f3ef 8310 mrs r3, PRIMASK
|
|
800266a: 60fb str r3, [r7, #12]
|
|
return(result);
|
|
800266c: 68fb ldr r3, [r7, #12]
|
|
#endif
|
|
|
|
/* Enter critical section: row programming should not be longer than 7 ms */
|
|
primask_bit = __get_PRIMASK();
|
|
800266e: 613b str r3, [r7, #16]
|
|
__ASM volatile ("cpsid i" : : : "memory");
|
|
8002670: b672 cpsid i
|
|
}
|
|
8002672: bf00 nop
|
|
__disable_irq();
|
|
|
|
/* Program the double word of the row */
|
|
do
|
|
{
|
|
*dest_addr = *src_addr;
|
|
8002674: 697b ldr r3, [r7, #20]
|
|
8002676: 681a ldr r2, [r3, #0]
|
|
8002678: 69bb ldr r3, [r7, #24]
|
|
800267a: 601a str r2, [r3, #0]
|
|
dest_addr++;
|
|
800267c: 69bb ldr r3, [r7, #24]
|
|
800267e: 3304 adds r3, #4
|
|
8002680: 61bb str r3, [r7, #24]
|
|
src_addr++;
|
|
8002682: 697b ldr r3, [r7, #20]
|
|
8002684: 3304 adds r3, #4
|
|
8002686: 617b str r3, [r7, #20]
|
|
row_index--;
|
|
8002688: 7ffb ldrb r3, [r7, #31]
|
|
800268a: 3b01 subs r3, #1
|
|
800268c: 77fb strb r3, [r7, #31]
|
|
} while (row_index != 0U);
|
|
800268e: 7ffb ldrb r3, [r7, #31]
|
|
8002690: 2b00 cmp r3, #0
|
|
8002692: d1ef bne.n 8002674 <FLASH_Program_Fast+0x30>
|
|
|
|
/* wait for BSY in order to be sure that flash operation is ended before
|
|
allowing prefetch in flash. Timeout does not return status, as it will
|
|
be anyway done later */
|
|
while (__HAL_FLASH_GET_FLAG(FLASH_FLAG_BSY) != 0U)
|
|
8002694: bf00 nop
|
|
8002696: 4b09 ldr r3, [pc, #36] @ (80026bc <FLASH_Program_Fast+0x78>)
|
|
8002698: 691b ldr r3, [r3, #16]
|
|
800269a: f403 3380 and.w r3, r3, #65536 @ 0x10000
|
|
800269e: f5b3 3f80 cmp.w r3, #65536 @ 0x10000
|
|
80026a2: d0f8 beq.n 8002696 <FLASH_Program_Fast+0x52>
|
|
80026a4: 693b ldr r3, [r7, #16]
|
|
80026a6: 60bb str r3, [r7, #8]
|
|
__ASM volatile ("MSR primask, %0" : : "r" (priMask) : "memory");
|
|
80026a8: 68bb ldr r3, [r7, #8]
|
|
80026aa: f383 8810 msr PRIMASK, r3
|
|
}
|
|
80026ae: bf00 nop
|
|
{
|
|
}
|
|
|
|
/* Exit critical section: restore previous priority mask */
|
|
__set_PRIMASK(primask_bit);
|
|
}
|
|
80026b0: bf00 nop
|
|
80026b2: 3724 adds r7, #36 @ 0x24
|
|
80026b4: 46bd mov sp, r7
|
|
80026b6: bc80 pop {r7}
|
|
80026b8: 4770 bx lr
|
|
80026ba: bf00 nop
|
|
80026bc: 58004000 .word 0x58004000
|
|
|
|
080026c0 <HAL_FLASHEx_Erase>:
|
|
* information on faulty page in case of error (0xFFFFFFFF means that all
|
|
* the pages have been correctly erased)
|
|
* @retval HAL Status
|
|
*/
|
|
HAL_StatusTypeDef HAL_FLASHEx_Erase(const FLASH_EraseInitTypeDef *pEraseInit, uint32_t *PageError)
|
|
{
|
|
80026c0: b580 push {r7, lr}
|
|
80026c2: b084 sub sp, #16
|
|
80026c4: af00 add r7, sp, #0
|
|
80026c6: 6078 str r0, [r7, #4]
|
|
80026c8: 6039 str r1, [r7, #0]
|
|
|
|
/* Check the parameters */
|
|
assert_param(IS_FLASH_TYPEERASE(pEraseInit->TypeErase));
|
|
|
|
/* Process Locked */
|
|
__HAL_LOCK(&pFlash);
|
|
80026ca: 4b28 ldr r3, [pc, #160] @ (800276c <HAL_FLASHEx_Erase+0xac>)
|
|
80026cc: 781b ldrb r3, [r3, #0]
|
|
80026ce: 2b01 cmp r3, #1
|
|
80026d0: d101 bne.n 80026d6 <HAL_FLASHEx_Erase+0x16>
|
|
80026d2: 2302 movs r3, #2
|
|
80026d4: e046 b.n 8002764 <HAL_FLASHEx_Erase+0xa4>
|
|
80026d6: 4b25 ldr r3, [pc, #148] @ (800276c <HAL_FLASHEx_Erase+0xac>)
|
|
80026d8: 2201 movs r2, #1
|
|
80026da: 701a strb r2, [r3, #0]
|
|
|
|
/* Reset error code */
|
|
pFlash.ErrorCode = HAL_FLASH_ERROR_NONE;
|
|
80026dc: 4b23 ldr r3, [pc, #140] @ (800276c <HAL_FLASHEx_Erase+0xac>)
|
|
80026de: 2200 movs r2, #0
|
|
80026e0: 605a str r2, [r3, #4]
|
|
|
|
/* Verify that next operation can be proceed */
|
|
status = FLASH_WaitForLastOperation(FLASH_TIMEOUT_VALUE);
|
|
80026e2: f44f 707a mov.w r0, #1000 @ 0x3e8
|
|
80026e6: f7ff ff25 bl 8002534 <FLASH_WaitForLastOperation>
|
|
80026ea: 4603 mov r3, r0
|
|
80026ec: 73fb strb r3, [r7, #15]
|
|
|
|
if (status == HAL_OK)
|
|
80026ee: 7bfb ldrb r3, [r7, #15]
|
|
80026f0: 2b00 cmp r3, #0
|
|
80026f2: d133 bne.n 800275c <HAL_FLASHEx_Erase+0x9c>
|
|
{
|
|
if (pEraseInit->TypeErase == FLASH_TYPEERASE_MASSERASE)
|
|
80026f4: 687b ldr r3, [r7, #4]
|
|
80026f6: 681b ldr r3, [r3, #0]
|
|
80026f8: 2b04 cmp r3, #4
|
|
80026fa: d108 bne.n 800270e <HAL_FLASHEx_Erase+0x4e>
|
|
{
|
|
/* Mass erase to be done */
|
|
FLASH_MassErase();
|
|
80026fc: f000 f838 bl 8002770 <FLASH_MassErase>
|
|
|
|
/* Wait for last operation to be completed */
|
|
status = FLASH_WaitForLastOperation(FLASH_TIMEOUT_VALUE);
|
|
8002700: f44f 707a mov.w r0, #1000 @ 0x3e8
|
|
8002704: f7ff ff16 bl 8002534 <FLASH_WaitForLastOperation>
|
|
8002708: 4603 mov r3, r0
|
|
800270a: 73fb strb r3, [r7, #15]
|
|
800270c: e024 b.n 8002758 <HAL_FLASHEx_Erase+0x98>
|
|
/* If operation is completed or interrupted, no need to clear the Mass Erase Bit */
|
|
}
|
|
else
|
|
{
|
|
/*Initialization of PageError variable*/
|
|
*PageError = 0xFFFFFFFFU;
|
|
800270e: 683b ldr r3, [r7, #0]
|
|
8002710: f04f 32ff mov.w r2, #4294967295 @ 0xffffffff
|
|
8002714: 601a str r2, [r3, #0]
|
|
|
|
for (index = pEraseInit->Page; index < (pEraseInit->Page + pEraseInit->NbPages); index++)
|
|
8002716: 687b ldr r3, [r7, #4]
|
|
8002718: 685b ldr r3, [r3, #4]
|
|
800271a: 60bb str r3, [r7, #8]
|
|
800271c: e012 b.n 8002744 <HAL_FLASHEx_Erase+0x84>
|
|
{
|
|
/* Start erase page */
|
|
FLASH_PageErase(index);
|
|
800271e: 68b8 ldr r0, [r7, #8]
|
|
8002720: f000 f836 bl 8002790 <FLASH_PageErase>
|
|
|
|
/* Wait for last operation to be completed */
|
|
status = FLASH_WaitForLastOperation(FLASH_TIMEOUT_VALUE);
|
|
8002724: f44f 707a mov.w r0, #1000 @ 0x3e8
|
|
8002728: f7ff ff04 bl 8002534 <FLASH_WaitForLastOperation>
|
|
800272c: 4603 mov r3, r0
|
|
800272e: 73fb strb r3, [r7, #15]
|
|
|
|
if (status != HAL_OK)
|
|
8002730: 7bfb ldrb r3, [r7, #15]
|
|
8002732: 2b00 cmp r3, #0
|
|
8002734: d003 beq.n 800273e <HAL_FLASHEx_Erase+0x7e>
|
|
{
|
|
/* In case of error, stop erase procedure and return the faulty address */
|
|
*PageError = index;
|
|
8002736: 683b ldr r3, [r7, #0]
|
|
8002738: 68ba ldr r2, [r7, #8]
|
|
800273a: 601a str r2, [r3, #0]
|
|
break;
|
|
800273c: e00a b.n 8002754 <HAL_FLASHEx_Erase+0x94>
|
|
for (index = pEraseInit->Page; index < (pEraseInit->Page + pEraseInit->NbPages); index++)
|
|
800273e: 68bb ldr r3, [r7, #8]
|
|
8002740: 3301 adds r3, #1
|
|
8002742: 60bb str r3, [r7, #8]
|
|
8002744: 687b ldr r3, [r7, #4]
|
|
8002746: 685a ldr r2, [r3, #4]
|
|
8002748: 687b ldr r3, [r7, #4]
|
|
800274a: 689b ldr r3, [r3, #8]
|
|
800274c: 4413 add r3, r2
|
|
800274e: 68ba ldr r2, [r7, #8]
|
|
8002750: 429a cmp r2, r3
|
|
8002752: d3e4 bcc.n 800271e <HAL_FLASHEx_Erase+0x5e>
|
|
}
|
|
}
|
|
|
|
/* If operation is completed or interrupted, disable the Page Erase Bit */
|
|
FLASH_AcknowledgePageErase();
|
|
8002754: f000 f87a bl 800284c <FLASH_AcknowledgePageErase>
|
|
}
|
|
|
|
/* Flush the caches to be sure of the data consistency */
|
|
FLASH_FlushCaches();
|
|
8002758: f000 f832 bl 80027c0 <FLASH_FlushCaches>
|
|
}
|
|
|
|
/* Process Unlocked */
|
|
__HAL_UNLOCK(&pFlash);
|
|
800275c: 4b03 ldr r3, [pc, #12] @ (800276c <HAL_FLASHEx_Erase+0xac>)
|
|
800275e: 2200 movs r2, #0
|
|
8002760: 701a strb r2, [r3, #0]
|
|
|
|
return status;
|
|
8002762: 7bfb ldrb r3, [r7, #15]
|
|
}
|
|
8002764: 4618 mov r0, r3
|
|
8002766: 3710 adds r7, #16
|
|
8002768: 46bd mov sp, r7
|
|
800276a: bd80 pop {r7, pc}
|
|
800276c: 200001dc .word 0x200001dc
|
|
|
|
08002770 <FLASH_MassErase>:
|
|
/**
|
|
* @brief Mass erase of FLASH memory.
|
|
* @retval None
|
|
*/
|
|
static void FLASH_MassErase(void)
|
|
{
|
|
8002770: b480 push {r7}
|
|
8002772: af00 add r7, sp, #0
|
|
/* Set the Mass Erase Bit and start bit */
|
|
#ifdef CORE_CM0PLUS
|
|
SET_BIT(FLASH->C2CR, (FLASH_CR_MER | FLASH_CR_STRT));
|
|
#else
|
|
SET_BIT(FLASH->CR, (FLASH_CR_MER | FLASH_CR_STRT));
|
|
8002774: 4b05 ldr r3, [pc, #20] @ (800278c <FLASH_MassErase+0x1c>)
|
|
8002776: 695b ldr r3, [r3, #20]
|
|
8002778: 4a04 ldr r2, [pc, #16] @ (800278c <FLASH_MassErase+0x1c>)
|
|
800277a: f443 3380 orr.w r3, r3, #65536 @ 0x10000
|
|
800277e: f043 0304 orr.w r3, r3, #4
|
|
8002782: 6153 str r3, [r2, #20]
|
|
#endif
|
|
}
|
|
8002784: bf00 nop
|
|
8002786: 46bd mov sp, r7
|
|
8002788: bc80 pop {r7}
|
|
800278a: 4770 bx lr
|
|
800278c: 58004000 .word 0x58004000
|
|
|
|
08002790 <FLASH_PageErase>:
|
|
* @param Page FLASH page to erase
|
|
* This parameter must be a value between 0 and (max number of pages in Flash - 1)
|
|
* @retval None
|
|
*/
|
|
void FLASH_PageErase(uint32_t Page)
|
|
{
|
|
8002790: b480 push {r7}
|
|
8002792: b083 sub sp, #12
|
|
8002794: af00 add r7, sp, #0
|
|
8002796: 6078 str r0, [r7, #4]
|
|
|
|
/* Proceed to erase the page */
|
|
#ifdef CORE_CM0PLUS
|
|
MODIFY_REG(FLASH->C2CR, FLASH_CR_PNB, ((Page << FLASH_CR_PNB_Pos) | FLASH_CR_PER | FLASH_CR_STRT));
|
|
#else
|
|
MODIFY_REG(FLASH->CR, FLASH_CR_PNB, ((Page << FLASH_CR_PNB_Pos) | FLASH_CR_PER | FLASH_CR_STRT));
|
|
8002798: 4b08 ldr r3, [pc, #32] @ (80027bc <FLASH_PageErase+0x2c>)
|
|
800279a: 695b ldr r3, [r3, #20]
|
|
800279c: f423 727e bic.w r2, r3, #1016 @ 0x3f8
|
|
80027a0: 687b ldr r3, [r7, #4]
|
|
80027a2: 00db lsls r3, r3, #3
|
|
80027a4: 4313 orrs r3, r2
|
|
80027a6: 4a05 ldr r2, [pc, #20] @ (80027bc <FLASH_PageErase+0x2c>)
|
|
80027a8: f443 3380 orr.w r3, r3, #65536 @ 0x10000
|
|
80027ac: f043 0302 orr.w r3, r3, #2
|
|
80027b0: 6153 str r3, [r2, #20]
|
|
#endif
|
|
}
|
|
80027b2: bf00 nop
|
|
80027b4: 370c adds r7, #12
|
|
80027b6: 46bd mov sp, r7
|
|
80027b8: bc80 pop {r7}
|
|
80027ba: 4770 bx lr
|
|
80027bc: 58004000 .word 0x58004000
|
|
|
|
080027c0 <FLASH_FlushCaches>:
|
|
/**
|
|
* @brief Flush the instruction and data caches.
|
|
* @retval None
|
|
*/
|
|
void FLASH_FlushCaches(void)
|
|
{
|
|
80027c0: b480 push {r7}
|
|
80027c2: af00 add r7, sp, #0
|
|
/* Flush instruction cache */
|
|
if (READ_BIT(FLASH->ACR, FLASH_ACR_ICEN) == FLASH_ACR_ICEN)
|
|
80027c4: 4b20 ldr r3, [pc, #128] @ (8002848 <FLASH_FlushCaches+0x88>)
|
|
80027c6: 681b ldr r3, [r3, #0]
|
|
80027c8: f403 7300 and.w r3, r3, #512 @ 0x200
|
|
80027cc: f5b3 7f00 cmp.w r3, #512 @ 0x200
|
|
80027d0: d117 bne.n 8002802 <FLASH_FlushCaches+0x42>
|
|
{
|
|
/* Disable instruction cache */
|
|
__HAL_FLASH_INSTRUCTION_CACHE_DISABLE();
|
|
80027d2: 4b1d ldr r3, [pc, #116] @ (8002848 <FLASH_FlushCaches+0x88>)
|
|
80027d4: 681b ldr r3, [r3, #0]
|
|
80027d6: 4a1c ldr r2, [pc, #112] @ (8002848 <FLASH_FlushCaches+0x88>)
|
|
80027d8: f423 7300 bic.w r3, r3, #512 @ 0x200
|
|
80027dc: 6013 str r3, [r2, #0]
|
|
/* Reset instruction cache */
|
|
__HAL_FLASH_INSTRUCTION_CACHE_RESET();
|
|
80027de: 4b1a ldr r3, [pc, #104] @ (8002848 <FLASH_FlushCaches+0x88>)
|
|
80027e0: 681b ldr r3, [r3, #0]
|
|
80027e2: 4a19 ldr r2, [pc, #100] @ (8002848 <FLASH_FlushCaches+0x88>)
|
|
80027e4: f443 6300 orr.w r3, r3, #2048 @ 0x800
|
|
80027e8: 6013 str r3, [r2, #0]
|
|
80027ea: 4b17 ldr r3, [pc, #92] @ (8002848 <FLASH_FlushCaches+0x88>)
|
|
80027ec: 681b ldr r3, [r3, #0]
|
|
80027ee: 4a16 ldr r2, [pc, #88] @ (8002848 <FLASH_FlushCaches+0x88>)
|
|
80027f0: f423 6300 bic.w r3, r3, #2048 @ 0x800
|
|
80027f4: 6013 str r3, [r2, #0]
|
|
/* Enable instruction cache */
|
|
__HAL_FLASH_INSTRUCTION_CACHE_ENABLE();
|
|
80027f6: 4b14 ldr r3, [pc, #80] @ (8002848 <FLASH_FlushCaches+0x88>)
|
|
80027f8: 681b ldr r3, [r3, #0]
|
|
80027fa: 4a13 ldr r2, [pc, #76] @ (8002848 <FLASH_FlushCaches+0x88>)
|
|
80027fc: f443 7300 orr.w r3, r3, #512 @ 0x200
|
|
8002800: 6013 str r3, [r2, #0]
|
|
}
|
|
|
|
#ifdef CORE_CM0PLUS
|
|
#else
|
|
/* Flush data cache */
|
|
if (READ_BIT(FLASH->ACR, FLASH_ACR_DCEN) == FLASH_ACR_DCEN)
|
|
8002802: 4b11 ldr r3, [pc, #68] @ (8002848 <FLASH_FlushCaches+0x88>)
|
|
8002804: 681b ldr r3, [r3, #0]
|
|
8002806: f403 6380 and.w r3, r3, #1024 @ 0x400
|
|
800280a: f5b3 6f80 cmp.w r3, #1024 @ 0x400
|
|
800280e: d117 bne.n 8002840 <FLASH_FlushCaches+0x80>
|
|
{
|
|
/* Disable data cache */
|
|
__HAL_FLASH_DATA_CACHE_DISABLE();
|
|
8002810: 4b0d ldr r3, [pc, #52] @ (8002848 <FLASH_FlushCaches+0x88>)
|
|
8002812: 681b ldr r3, [r3, #0]
|
|
8002814: 4a0c ldr r2, [pc, #48] @ (8002848 <FLASH_FlushCaches+0x88>)
|
|
8002816: f423 6380 bic.w r3, r3, #1024 @ 0x400
|
|
800281a: 6013 str r3, [r2, #0]
|
|
/* Reset data cache */
|
|
__HAL_FLASH_DATA_CACHE_RESET();
|
|
800281c: 4b0a ldr r3, [pc, #40] @ (8002848 <FLASH_FlushCaches+0x88>)
|
|
800281e: 681b ldr r3, [r3, #0]
|
|
8002820: 4a09 ldr r2, [pc, #36] @ (8002848 <FLASH_FlushCaches+0x88>)
|
|
8002822: f443 5380 orr.w r3, r3, #4096 @ 0x1000
|
|
8002826: 6013 str r3, [r2, #0]
|
|
8002828: 4b07 ldr r3, [pc, #28] @ (8002848 <FLASH_FlushCaches+0x88>)
|
|
800282a: 681b ldr r3, [r3, #0]
|
|
800282c: 4a06 ldr r2, [pc, #24] @ (8002848 <FLASH_FlushCaches+0x88>)
|
|
800282e: f423 5380 bic.w r3, r3, #4096 @ 0x1000
|
|
8002832: 6013 str r3, [r2, #0]
|
|
/* Enable data cache */
|
|
__HAL_FLASH_DATA_CACHE_ENABLE();
|
|
8002834: 4b04 ldr r3, [pc, #16] @ (8002848 <FLASH_FlushCaches+0x88>)
|
|
8002836: 681b ldr r3, [r3, #0]
|
|
8002838: 4a03 ldr r2, [pc, #12] @ (8002848 <FLASH_FlushCaches+0x88>)
|
|
800283a: f443 6380 orr.w r3, r3, #1024 @ 0x400
|
|
800283e: 6013 str r3, [r2, #0]
|
|
}
|
|
#endif
|
|
}
|
|
8002840: bf00 nop
|
|
8002842: 46bd mov sp, r7
|
|
8002844: bc80 pop {r7}
|
|
8002846: 4770 bx lr
|
|
8002848: 58004000 .word 0x58004000
|
|
|
|
0800284c <FLASH_AcknowledgePageErase>:
|
|
/**
|
|
* @brief Acknlowldge the page erase operation.
|
|
* @retval None
|
|
*/
|
|
static void FLASH_AcknowledgePageErase(void)
|
|
{
|
|
800284c: b480 push {r7}
|
|
800284e: af00 add r7, sp, #0
|
|
#ifdef CORE_CM0PLUS
|
|
CLEAR_BIT(FLASH->C2CR, (FLASH_CR_PER | FLASH_CR_PNB));
|
|
#else
|
|
CLEAR_BIT(FLASH->CR, (FLASH_CR_PER | FLASH_CR_PNB));
|
|
8002850: 4b05 ldr r3, [pc, #20] @ (8002868 <FLASH_AcknowledgePageErase+0x1c>)
|
|
8002852: 695b ldr r3, [r3, #20]
|
|
8002854: 4a04 ldr r2, [pc, #16] @ (8002868 <FLASH_AcknowledgePageErase+0x1c>)
|
|
8002856: f423 737e bic.w r3, r3, #1016 @ 0x3f8
|
|
800285a: f023 0302 bic.w r3, r3, #2
|
|
800285e: 6153 str r3, [r2, #20]
|
|
#endif
|
|
}
|
|
8002860: bf00 nop
|
|
8002862: 46bd mov sp, r7
|
|
8002864: bc80 pop {r7}
|
|
8002866: 4770 bx lr
|
|
8002868: 58004000 .word 0x58004000
|
|
|
|
0800286c <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, const GPIO_InitTypeDef *GPIO_Init)
|
|
{
|
|
800286c: b480 push {r7}
|
|
800286e: b087 sub sp, #28
|
|
8002870: af00 add r7, sp, #0
|
|
8002872: 6078 str r0, [r7, #4]
|
|
8002874: 6039 str r1, [r7, #0]
|
|
uint32_t position = 0x00u;
|
|
8002876: 2300 movs r3, #0
|
|
8002878: 617b str r3, [r7, #20]
|
|
assert_param(IS_GPIO_PIN(GPIO_Init->Pin));
|
|
assert_param(IS_GPIO_MODE(GPIO_Init->Mode));
|
|
assert_param(IS_GPIO_PULL(GPIO_Init->Pull));
|
|
|
|
/* Configure the port pins */
|
|
while (((GPIO_Init->Pin) >> position) != 0x00u)
|
|
800287a: e140 b.n 8002afe <HAL_GPIO_Init+0x292>
|
|
{
|
|
/* Get current io position */
|
|
iocurrent = (GPIO_Init->Pin) & (1uL << position);
|
|
800287c: 683b ldr r3, [r7, #0]
|
|
800287e: 681a ldr r2, [r3, #0]
|
|
8002880: 2101 movs r1, #1
|
|
8002882: 697b ldr r3, [r7, #20]
|
|
8002884: fa01 f303 lsl.w r3, r1, r3
|
|
8002888: 4013 ands r3, r2
|
|
800288a: 60fb str r3, [r7, #12]
|
|
|
|
if (iocurrent != 0x00u)
|
|
800288c: 68fb ldr r3, [r7, #12]
|
|
800288e: 2b00 cmp r3, #0
|
|
8002890: f000 8132 beq.w 8002af8 <HAL_GPIO_Init+0x28c>
|
|
{
|
|
/*--------------------- GPIO Mode Configuration ------------------------*/
|
|
/* In case of Output or Alternate function mode selection */
|
|
if (((GPIO_Init->Mode & GPIO_MODE) == MODE_OUTPUT) || ((GPIO_Init->Mode & GPIO_MODE) == MODE_AF))
|
|
8002894: 683b ldr r3, [r7, #0]
|
|
8002896: 685b ldr r3, [r3, #4]
|
|
8002898: f003 0303 and.w r3, r3, #3
|
|
800289c: 2b01 cmp r3, #1
|
|
800289e: d005 beq.n 80028ac <HAL_GPIO_Init+0x40>
|
|
80028a0: 683b ldr r3, [r7, #0]
|
|
80028a2: 685b ldr r3, [r3, #4]
|
|
80028a4: f003 0303 and.w r3, r3, #3
|
|
80028a8: 2b02 cmp r3, #2
|
|
80028aa: d130 bne.n 800290e <HAL_GPIO_Init+0xa2>
|
|
{
|
|
/* Check the Speed parameter */
|
|
assert_param(IS_GPIO_SPEED(GPIO_Init->Speed));
|
|
/* Configure the IO Speed */
|
|
temp = GPIOx->OSPEEDR;
|
|
80028ac: 687b ldr r3, [r7, #4]
|
|
80028ae: 689b ldr r3, [r3, #8]
|
|
80028b0: 613b str r3, [r7, #16]
|
|
temp &= ~(GPIO_OSPEEDR_OSPEED0 << (position * 2U));
|
|
80028b2: 697b ldr r3, [r7, #20]
|
|
80028b4: 005b lsls r3, r3, #1
|
|
80028b6: 2203 movs r2, #3
|
|
80028b8: fa02 f303 lsl.w r3, r2, r3
|
|
80028bc: 43db mvns r3, r3
|
|
80028be: 693a ldr r2, [r7, #16]
|
|
80028c0: 4013 ands r3, r2
|
|
80028c2: 613b str r3, [r7, #16]
|
|
temp |= (GPIO_Init->Speed << (position * 2U));
|
|
80028c4: 683b ldr r3, [r7, #0]
|
|
80028c6: 68da ldr r2, [r3, #12]
|
|
80028c8: 697b ldr r3, [r7, #20]
|
|
80028ca: 005b lsls r3, r3, #1
|
|
80028cc: fa02 f303 lsl.w r3, r2, r3
|
|
80028d0: 693a ldr r2, [r7, #16]
|
|
80028d2: 4313 orrs r3, r2
|
|
80028d4: 613b str r3, [r7, #16]
|
|
GPIOx->OSPEEDR = temp;
|
|
80028d6: 687b ldr r3, [r7, #4]
|
|
80028d8: 693a ldr r2, [r7, #16]
|
|
80028da: 609a str r2, [r3, #8]
|
|
|
|
/* Configure the IO Output Type */
|
|
temp = GPIOx->OTYPER;
|
|
80028dc: 687b ldr r3, [r7, #4]
|
|
80028de: 685b ldr r3, [r3, #4]
|
|
80028e0: 613b str r3, [r7, #16]
|
|
temp &= ~(GPIO_OTYPER_OT0 << position) ;
|
|
80028e2: 2201 movs r2, #1
|
|
80028e4: 697b ldr r3, [r7, #20]
|
|
80028e6: fa02 f303 lsl.w r3, r2, r3
|
|
80028ea: 43db mvns r3, r3
|
|
80028ec: 693a ldr r2, [r7, #16]
|
|
80028ee: 4013 ands r3, r2
|
|
80028f0: 613b str r3, [r7, #16]
|
|
temp |= (((GPIO_Init->Mode & OUTPUT_TYPE) >> OUTPUT_TYPE_Pos) << position);
|
|
80028f2: 683b ldr r3, [r7, #0]
|
|
80028f4: 685b ldr r3, [r3, #4]
|
|
80028f6: 091b lsrs r3, r3, #4
|
|
80028f8: f003 0201 and.w r2, r3, #1
|
|
80028fc: 697b ldr r3, [r7, #20]
|
|
80028fe: fa02 f303 lsl.w r3, r2, r3
|
|
8002902: 693a ldr r2, [r7, #16]
|
|
8002904: 4313 orrs r3, r2
|
|
8002906: 613b str r3, [r7, #16]
|
|
GPIOx->OTYPER = temp;
|
|
8002908: 687b ldr r3, [r7, #4]
|
|
800290a: 693a ldr r2, [r7, #16]
|
|
800290c: 605a str r2, [r3, #4]
|
|
}
|
|
|
|
/* Activate the Pull-up or Pull down resistor for the current IO */
|
|
if ((GPIO_Init->Mode & GPIO_MODE) != MODE_ANALOG)
|
|
800290e: 683b ldr r3, [r7, #0]
|
|
8002910: 685b ldr r3, [r3, #4]
|
|
8002912: f003 0303 and.w r3, r3, #3
|
|
8002916: 2b03 cmp r3, #3
|
|
8002918: d017 beq.n 800294a <HAL_GPIO_Init+0xde>
|
|
{
|
|
temp = GPIOx->PUPDR;
|
|
800291a: 687b ldr r3, [r7, #4]
|
|
800291c: 68db ldr r3, [r3, #12]
|
|
800291e: 613b str r3, [r7, #16]
|
|
temp &= ~(GPIO_PUPDR_PUPD0 << (position * 2U));
|
|
8002920: 697b ldr r3, [r7, #20]
|
|
8002922: 005b lsls r3, r3, #1
|
|
8002924: 2203 movs r2, #3
|
|
8002926: fa02 f303 lsl.w r3, r2, r3
|
|
800292a: 43db mvns r3, r3
|
|
800292c: 693a ldr r2, [r7, #16]
|
|
800292e: 4013 ands r3, r2
|
|
8002930: 613b str r3, [r7, #16]
|
|
temp |= ((GPIO_Init->Pull) << (position * 2U));
|
|
8002932: 683b ldr r3, [r7, #0]
|
|
8002934: 689a ldr r2, [r3, #8]
|
|
8002936: 697b ldr r3, [r7, #20]
|
|
8002938: 005b lsls r3, r3, #1
|
|
800293a: fa02 f303 lsl.w r3, r2, r3
|
|
800293e: 693a ldr r2, [r7, #16]
|
|
8002940: 4313 orrs r3, r2
|
|
8002942: 613b str r3, [r7, #16]
|
|
GPIOx->PUPDR = temp;
|
|
8002944: 687b ldr r3, [r7, #4]
|
|
8002946: 693a ldr r2, [r7, #16]
|
|
8002948: 60da str r2, [r3, #12]
|
|
}
|
|
|
|
/* In case of Alternate function mode selection */
|
|
if ((GPIO_Init->Mode & GPIO_MODE) == MODE_AF)
|
|
800294a: 683b ldr r3, [r7, #0]
|
|
800294c: 685b ldr r3, [r3, #4]
|
|
800294e: f003 0303 and.w r3, r3, #3
|
|
8002952: 2b02 cmp r3, #2
|
|
8002954: d123 bne.n 800299e <HAL_GPIO_Init+0x132>
|
|
/* Check the Alternate function parameters */
|
|
assert_param(IS_GPIO_AF_INSTANCE(GPIOx));
|
|
assert_param(IS_GPIO_AF(GPIO_Init->Alternate));
|
|
|
|
/* Configure Alternate function mapped with the current IO */
|
|
temp = GPIOx->AFR[position >> 3U];
|
|
8002956: 697b ldr r3, [r7, #20]
|
|
8002958: 08da lsrs r2, r3, #3
|
|
800295a: 687b ldr r3, [r7, #4]
|
|
800295c: 3208 adds r2, #8
|
|
800295e: f853 3022 ldr.w r3, [r3, r2, lsl #2]
|
|
8002962: 613b str r3, [r7, #16]
|
|
temp &= ~(0xFU << ((position & 0x07U) * 4U));
|
|
8002964: 697b ldr r3, [r7, #20]
|
|
8002966: f003 0307 and.w r3, r3, #7
|
|
800296a: 009b lsls r3, r3, #2
|
|
800296c: 220f movs r2, #15
|
|
800296e: fa02 f303 lsl.w r3, r2, r3
|
|
8002972: 43db mvns r3, r3
|
|
8002974: 693a ldr r2, [r7, #16]
|
|
8002976: 4013 ands r3, r2
|
|
8002978: 613b str r3, [r7, #16]
|
|
temp |= ((GPIO_Init->Alternate) << ((position & 0x07U) * 4U));
|
|
800297a: 683b ldr r3, [r7, #0]
|
|
800297c: 691a ldr r2, [r3, #16]
|
|
800297e: 697b ldr r3, [r7, #20]
|
|
8002980: f003 0307 and.w r3, r3, #7
|
|
8002984: 009b lsls r3, r3, #2
|
|
8002986: fa02 f303 lsl.w r3, r2, r3
|
|
800298a: 693a ldr r2, [r7, #16]
|
|
800298c: 4313 orrs r3, r2
|
|
800298e: 613b str r3, [r7, #16]
|
|
GPIOx->AFR[position >> 3u] = temp;
|
|
8002990: 697b ldr r3, [r7, #20]
|
|
8002992: 08da lsrs r2, r3, #3
|
|
8002994: 687b ldr r3, [r7, #4]
|
|
8002996: 3208 adds r2, #8
|
|
8002998: 6939 ldr r1, [r7, #16]
|
|
800299a: f843 1022 str.w r1, [r3, r2, lsl #2]
|
|
}
|
|
|
|
/* Configure IO Direction mode (Input, Output, Alternate or Analog) */
|
|
temp = GPIOx->MODER;
|
|
800299e: 687b ldr r3, [r7, #4]
|
|
80029a0: 681b ldr r3, [r3, #0]
|
|
80029a2: 613b str r3, [r7, #16]
|
|
temp &= ~(GPIO_MODER_MODE0 << (position * 2U));
|
|
80029a4: 697b ldr r3, [r7, #20]
|
|
80029a6: 005b lsls r3, r3, #1
|
|
80029a8: 2203 movs r2, #3
|
|
80029aa: fa02 f303 lsl.w r3, r2, r3
|
|
80029ae: 43db mvns r3, r3
|
|
80029b0: 693a ldr r2, [r7, #16]
|
|
80029b2: 4013 ands r3, r2
|
|
80029b4: 613b str r3, [r7, #16]
|
|
temp |= ((GPIO_Init->Mode & GPIO_MODE) << (position * 2U));
|
|
80029b6: 683b ldr r3, [r7, #0]
|
|
80029b8: 685b ldr r3, [r3, #4]
|
|
80029ba: f003 0203 and.w r2, r3, #3
|
|
80029be: 697b ldr r3, [r7, #20]
|
|
80029c0: 005b lsls r3, r3, #1
|
|
80029c2: fa02 f303 lsl.w r3, r2, r3
|
|
80029c6: 693a ldr r2, [r7, #16]
|
|
80029c8: 4313 orrs r3, r2
|
|
80029ca: 613b str r3, [r7, #16]
|
|
GPIOx->MODER = temp;
|
|
80029cc: 687b ldr r3, [r7, #4]
|
|
80029ce: 693a ldr r2, [r7, #16]
|
|
80029d0: 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)
|
|
80029d2: 683b ldr r3, [r7, #0]
|
|
80029d4: 685b ldr r3, [r3, #4]
|
|
80029d6: f403 3340 and.w r3, r3, #196608 @ 0x30000
|
|
80029da: 2b00 cmp r3, #0
|
|
80029dc: f000 808c beq.w 8002af8 <HAL_GPIO_Init+0x28c>
|
|
{
|
|
temp = SYSCFG->EXTICR[position >> 2u];
|
|
80029e0: 4a4e ldr r2, [pc, #312] @ (8002b1c <HAL_GPIO_Init+0x2b0>)
|
|
80029e2: 697b ldr r3, [r7, #20]
|
|
80029e4: 089b lsrs r3, r3, #2
|
|
80029e6: 3302 adds r3, #2
|
|
80029e8: f852 3023 ldr.w r3, [r2, r3, lsl #2]
|
|
80029ec: 613b str r3, [r7, #16]
|
|
temp &= ~(0x07uL << (4U * (position & 0x03U)));
|
|
80029ee: 697b ldr r3, [r7, #20]
|
|
80029f0: f003 0303 and.w r3, r3, #3
|
|
80029f4: 009b lsls r3, r3, #2
|
|
80029f6: 2207 movs r2, #7
|
|
80029f8: fa02 f303 lsl.w r3, r2, r3
|
|
80029fc: 43db mvns r3, r3
|
|
80029fe: 693a ldr r2, [r7, #16]
|
|
8002a00: 4013 ands r3, r2
|
|
8002a02: 613b str r3, [r7, #16]
|
|
temp |= (GPIO_GET_INDEX(GPIOx) << (4U * (position & 0x03U)));
|
|
8002a04: 687b ldr r3, [r7, #4]
|
|
8002a06: f1b3 4f90 cmp.w r3, #1207959552 @ 0x48000000
|
|
8002a0a: d00d beq.n 8002a28 <HAL_GPIO_Init+0x1bc>
|
|
8002a0c: 687b ldr r3, [r7, #4]
|
|
8002a0e: 4a44 ldr r2, [pc, #272] @ (8002b20 <HAL_GPIO_Init+0x2b4>)
|
|
8002a10: 4293 cmp r3, r2
|
|
8002a12: d007 beq.n 8002a24 <HAL_GPIO_Init+0x1b8>
|
|
8002a14: 687b ldr r3, [r7, #4]
|
|
8002a16: 4a43 ldr r2, [pc, #268] @ (8002b24 <HAL_GPIO_Init+0x2b8>)
|
|
8002a18: 4293 cmp r3, r2
|
|
8002a1a: d101 bne.n 8002a20 <HAL_GPIO_Init+0x1b4>
|
|
8002a1c: 2302 movs r3, #2
|
|
8002a1e: e004 b.n 8002a2a <HAL_GPIO_Init+0x1be>
|
|
8002a20: 2307 movs r3, #7
|
|
8002a22: e002 b.n 8002a2a <HAL_GPIO_Init+0x1be>
|
|
8002a24: 2301 movs r3, #1
|
|
8002a26: e000 b.n 8002a2a <HAL_GPIO_Init+0x1be>
|
|
8002a28: 2300 movs r3, #0
|
|
8002a2a: 697a ldr r2, [r7, #20]
|
|
8002a2c: f002 0203 and.w r2, r2, #3
|
|
8002a30: 0092 lsls r2, r2, #2
|
|
8002a32: 4093 lsls r3, r2
|
|
8002a34: 693a ldr r2, [r7, #16]
|
|
8002a36: 4313 orrs r3, r2
|
|
8002a38: 613b str r3, [r7, #16]
|
|
SYSCFG->EXTICR[position >> 2u] = temp;
|
|
8002a3a: 4938 ldr r1, [pc, #224] @ (8002b1c <HAL_GPIO_Init+0x2b0>)
|
|
8002a3c: 697b ldr r3, [r7, #20]
|
|
8002a3e: 089b lsrs r3, r3, #2
|
|
8002a40: 3302 adds r3, #2
|
|
8002a42: 693a ldr r2, [r7, #16]
|
|
8002a44: f841 2023 str.w r2, [r1, r3, lsl #2]
|
|
|
|
/* Clear Rising Falling edge configuration */
|
|
temp = EXTI->RTSR1;
|
|
8002a48: 4b37 ldr r3, [pc, #220] @ (8002b28 <HAL_GPIO_Init+0x2bc>)
|
|
8002a4a: 681b ldr r3, [r3, #0]
|
|
8002a4c: 613b str r3, [r7, #16]
|
|
temp &= ~(iocurrent);
|
|
8002a4e: 68fb ldr r3, [r7, #12]
|
|
8002a50: 43db mvns r3, r3
|
|
8002a52: 693a ldr r2, [r7, #16]
|
|
8002a54: 4013 ands r3, r2
|
|
8002a56: 613b str r3, [r7, #16]
|
|
if ((GPIO_Init->Mode & TRIGGER_RISING) != 0x00u)
|
|
8002a58: 683b ldr r3, [r7, #0]
|
|
8002a5a: 685b ldr r3, [r3, #4]
|
|
8002a5c: f403 1380 and.w r3, r3, #1048576 @ 0x100000
|
|
8002a60: 2b00 cmp r3, #0
|
|
8002a62: d003 beq.n 8002a6c <HAL_GPIO_Init+0x200>
|
|
{
|
|
temp |= iocurrent;
|
|
8002a64: 693a ldr r2, [r7, #16]
|
|
8002a66: 68fb ldr r3, [r7, #12]
|
|
8002a68: 4313 orrs r3, r2
|
|
8002a6a: 613b str r3, [r7, #16]
|
|
}
|
|
EXTI->RTSR1 = temp;
|
|
8002a6c: 4a2e ldr r2, [pc, #184] @ (8002b28 <HAL_GPIO_Init+0x2bc>)
|
|
8002a6e: 693b ldr r3, [r7, #16]
|
|
8002a70: 6013 str r3, [r2, #0]
|
|
|
|
temp = EXTI->FTSR1;
|
|
8002a72: 4b2d ldr r3, [pc, #180] @ (8002b28 <HAL_GPIO_Init+0x2bc>)
|
|
8002a74: 685b ldr r3, [r3, #4]
|
|
8002a76: 613b str r3, [r7, #16]
|
|
temp &= ~(iocurrent);
|
|
8002a78: 68fb ldr r3, [r7, #12]
|
|
8002a7a: 43db mvns r3, r3
|
|
8002a7c: 693a ldr r2, [r7, #16]
|
|
8002a7e: 4013 ands r3, r2
|
|
8002a80: 613b str r3, [r7, #16]
|
|
if ((GPIO_Init->Mode & TRIGGER_FALLING) != 0x00u)
|
|
8002a82: 683b ldr r3, [r7, #0]
|
|
8002a84: 685b ldr r3, [r3, #4]
|
|
8002a86: f403 1300 and.w r3, r3, #2097152 @ 0x200000
|
|
8002a8a: 2b00 cmp r3, #0
|
|
8002a8c: d003 beq.n 8002a96 <HAL_GPIO_Init+0x22a>
|
|
{
|
|
temp |= iocurrent;
|
|
8002a8e: 693a ldr r2, [r7, #16]
|
|
8002a90: 68fb ldr r3, [r7, #12]
|
|
8002a92: 4313 orrs r3, r2
|
|
8002a94: 613b str r3, [r7, #16]
|
|
}
|
|
EXTI->FTSR1 = temp;
|
|
8002a96: 4a24 ldr r2, [pc, #144] @ (8002b28 <HAL_GPIO_Init+0x2bc>)
|
|
8002a98: 693b ldr r3, [r7, #16]
|
|
8002a9a: 6053 str r3, [r2, #4]
|
|
|
|
/* Clear EXTI line configuration */
|
|
#ifdef CORE_CM0PLUS
|
|
temp = EXTI->C2IMR1;
|
|
#else
|
|
temp = EXTI->IMR1;
|
|
8002a9c: 4b22 ldr r3, [pc, #136] @ (8002b28 <HAL_GPIO_Init+0x2bc>)
|
|
8002a9e: f8d3 3080 ldr.w r3, [r3, #128] @ 0x80
|
|
8002aa2: 613b str r3, [r7, #16]
|
|
#endif /* CORE_CM0PLUS */
|
|
temp &= ~(iocurrent);
|
|
8002aa4: 68fb ldr r3, [r7, #12]
|
|
8002aa6: 43db mvns r3, r3
|
|
8002aa8: 693a ldr r2, [r7, #16]
|
|
8002aaa: 4013 ands r3, r2
|
|
8002aac: 613b str r3, [r7, #16]
|
|
if ((GPIO_Init->Mode & EXTI_IT) != 0x00u)
|
|
8002aae: 683b ldr r3, [r7, #0]
|
|
8002ab0: 685b ldr r3, [r3, #4]
|
|
8002ab2: f403 3380 and.w r3, r3, #65536 @ 0x10000
|
|
8002ab6: 2b00 cmp r3, #0
|
|
8002ab8: d003 beq.n 8002ac2 <HAL_GPIO_Init+0x256>
|
|
{
|
|
temp |= iocurrent;
|
|
8002aba: 693a ldr r2, [r7, #16]
|
|
8002abc: 68fb ldr r3, [r7, #12]
|
|
8002abe: 4313 orrs r3, r2
|
|
8002ac0: 613b str r3, [r7, #16]
|
|
}
|
|
#ifdef CORE_CM0PLUS
|
|
EXTI->C2IMR1 = temp;
|
|
#else
|
|
EXTI->IMR1 = temp;
|
|
8002ac2: 4a19 ldr r2, [pc, #100] @ (8002b28 <HAL_GPIO_Init+0x2bc>)
|
|
8002ac4: 693b ldr r3, [r7, #16]
|
|
8002ac6: f8c2 3080 str.w r3, [r2, #128] @ 0x80
|
|
#endif /* CORE_CM0PLUS */
|
|
|
|
#ifdef CORE_CM0PLUS
|
|
temp = EXTI->C2EMR1;
|
|
#else
|
|
temp = EXTI->EMR1;
|
|
8002aca: 4b17 ldr r3, [pc, #92] @ (8002b28 <HAL_GPIO_Init+0x2bc>)
|
|
8002acc: f8d3 3084 ldr.w r3, [r3, #132] @ 0x84
|
|
8002ad0: 613b str r3, [r7, #16]
|
|
#endif /* CORE_CM0PLUS */
|
|
temp &= ~(iocurrent);
|
|
8002ad2: 68fb ldr r3, [r7, #12]
|
|
8002ad4: 43db mvns r3, r3
|
|
8002ad6: 693a ldr r2, [r7, #16]
|
|
8002ad8: 4013 ands r3, r2
|
|
8002ada: 613b str r3, [r7, #16]
|
|
if ((GPIO_Init->Mode & EXTI_EVT) != 0x00u)
|
|
8002adc: 683b ldr r3, [r7, #0]
|
|
8002ade: 685b ldr r3, [r3, #4]
|
|
8002ae0: f403 3300 and.w r3, r3, #131072 @ 0x20000
|
|
8002ae4: 2b00 cmp r3, #0
|
|
8002ae6: d003 beq.n 8002af0 <HAL_GPIO_Init+0x284>
|
|
{
|
|
temp |= iocurrent;
|
|
8002ae8: 693a ldr r2, [r7, #16]
|
|
8002aea: 68fb ldr r3, [r7, #12]
|
|
8002aec: 4313 orrs r3, r2
|
|
8002aee: 613b str r3, [r7, #16]
|
|
}
|
|
#ifdef CORE_CM0PLUS
|
|
EXTI->C2EMR1 = temp;
|
|
#else
|
|
EXTI->EMR1 = temp;
|
|
8002af0: 4a0d ldr r2, [pc, #52] @ (8002b28 <HAL_GPIO_Init+0x2bc>)
|
|
8002af2: 693b ldr r3, [r7, #16]
|
|
8002af4: f8c2 3084 str.w r3, [r2, #132] @ 0x84
|
|
#endif /* CORE_CM0PLUS */
|
|
}
|
|
}
|
|
|
|
position++;
|
|
8002af8: 697b ldr r3, [r7, #20]
|
|
8002afa: 3301 adds r3, #1
|
|
8002afc: 617b str r3, [r7, #20]
|
|
while (((GPIO_Init->Pin) >> position) != 0x00u)
|
|
8002afe: 683b ldr r3, [r7, #0]
|
|
8002b00: 681a ldr r2, [r3, #0]
|
|
8002b02: 697b ldr r3, [r7, #20]
|
|
8002b04: fa22 f303 lsr.w r3, r2, r3
|
|
8002b08: 2b00 cmp r3, #0
|
|
8002b0a: f47f aeb7 bne.w 800287c <HAL_GPIO_Init+0x10>
|
|
}
|
|
}
|
|
8002b0e: bf00 nop
|
|
8002b10: bf00 nop
|
|
8002b12: 371c adds r7, #28
|
|
8002b14: 46bd mov sp, r7
|
|
8002b16: bc80 pop {r7}
|
|
8002b18: 4770 bx lr
|
|
8002b1a: bf00 nop
|
|
8002b1c: 40010000 .word 0x40010000
|
|
8002b20: 48000400 .word 0x48000400
|
|
8002b24: 48000800 .word 0x48000800
|
|
8002b28: 58000800 .word 0x58000800
|
|
|
|
08002b2c <HAL_GPIO_DeInit>:
|
|
* @param GPIO_Pin specifies the port bit to be written.
|
|
* This parameter can be any combination of GPIO_PIN_x where x can be (0..15).
|
|
* @retval None
|
|
*/
|
|
void HAL_GPIO_DeInit(GPIO_TypeDef *GPIOx, uint32_t GPIO_Pin)
|
|
{
|
|
8002b2c: b480 push {r7}
|
|
8002b2e: b087 sub sp, #28
|
|
8002b30: af00 add r7, sp, #0
|
|
8002b32: 6078 str r0, [r7, #4]
|
|
8002b34: 6039 str r1, [r7, #0]
|
|
uint32_t position = 0x00u;
|
|
8002b36: 2300 movs r3, #0
|
|
8002b38: 617b str r3, [r7, #20]
|
|
/* Check the parameters */
|
|
assert_param(IS_GPIO_ALL_INSTANCE(GPIOx));
|
|
assert_param(IS_GPIO_PIN(GPIO_Pin));
|
|
|
|
/* Configure the port pins */
|
|
while ((GPIO_Pin >> position) != 0x00u)
|
|
8002b3a: e0af b.n 8002c9c <HAL_GPIO_DeInit+0x170>
|
|
{
|
|
/* Get current io position */
|
|
iocurrent = (GPIO_Pin) & (1uL << position);
|
|
8002b3c: 2201 movs r2, #1
|
|
8002b3e: 697b ldr r3, [r7, #20]
|
|
8002b40: fa02 f303 lsl.w r3, r2, r3
|
|
8002b44: 683a ldr r2, [r7, #0]
|
|
8002b46: 4013 ands r3, r2
|
|
8002b48: 613b str r3, [r7, #16]
|
|
|
|
if (iocurrent != 0x00u)
|
|
8002b4a: 693b ldr r3, [r7, #16]
|
|
8002b4c: 2b00 cmp r3, #0
|
|
8002b4e: f000 80a2 beq.w 8002c96 <HAL_GPIO_DeInit+0x16a>
|
|
{
|
|
/*------------------------- EXTI Mode Configuration --------------------*/
|
|
/* Clear the External Interrupt or Event for the current IO */
|
|
|
|
tmp = SYSCFG->EXTICR[position >> 2u];
|
|
8002b52: 4a59 ldr r2, [pc, #356] @ (8002cb8 <HAL_GPIO_DeInit+0x18c>)
|
|
8002b54: 697b ldr r3, [r7, #20]
|
|
8002b56: 089b lsrs r3, r3, #2
|
|
8002b58: 3302 adds r3, #2
|
|
8002b5a: f852 3023 ldr.w r3, [r2, r3, lsl #2]
|
|
8002b5e: 60fb str r3, [r7, #12]
|
|
tmp &= (0x07uL << (4U * (position & 0x03U)));
|
|
8002b60: 697b ldr r3, [r7, #20]
|
|
8002b62: f003 0303 and.w r3, r3, #3
|
|
8002b66: 009b lsls r3, r3, #2
|
|
8002b68: 2207 movs r2, #7
|
|
8002b6a: fa02 f303 lsl.w r3, r2, r3
|
|
8002b6e: 68fa ldr r2, [r7, #12]
|
|
8002b70: 4013 ands r3, r2
|
|
8002b72: 60fb str r3, [r7, #12]
|
|
if (tmp == (GPIO_GET_INDEX(GPIOx) << (4U * (position & 0x03U))))
|
|
8002b74: 687b ldr r3, [r7, #4]
|
|
8002b76: f1b3 4f90 cmp.w r3, #1207959552 @ 0x48000000
|
|
8002b7a: d00d beq.n 8002b98 <HAL_GPIO_DeInit+0x6c>
|
|
8002b7c: 687b ldr r3, [r7, #4]
|
|
8002b7e: 4a4f ldr r2, [pc, #316] @ (8002cbc <HAL_GPIO_DeInit+0x190>)
|
|
8002b80: 4293 cmp r3, r2
|
|
8002b82: d007 beq.n 8002b94 <HAL_GPIO_DeInit+0x68>
|
|
8002b84: 687b ldr r3, [r7, #4]
|
|
8002b86: 4a4e ldr r2, [pc, #312] @ (8002cc0 <HAL_GPIO_DeInit+0x194>)
|
|
8002b88: 4293 cmp r3, r2
|
|
8002b8a: d101 bne.n 8002b90 <HAL_GPIO_DeInit+0x64>
|
|
8002b8c: 2302 movs r3, #2
|
|
8002b8e: e004 b.n 8002b9a <HAL_GPIO_DeInit+0x6e>
|
|
8002b90: 2307 movs r3, #7
|
|
8002b92: e002 b.n 8002b9a <HAL_GPIO_DeInit+0x6e>
|
|
8002b94: 2301 movs r3, #1
|
|
8002b96: e000 b.n 8002b9a <HAL_GPIO_DeInit+0x6e>
|
|
8002b98: 2300 movs r3, #0
|
|
8002b9a: 697a ldr r2, [r7, #20]
|
|
8002b9c: f002 0203 and.w r2, r2, #3
|
|
8002ba0: 0092 lsls r2, r2, #2
|
|
8002ba2: 4093 lsls r3, r2
|
|
8002ba4: 68fa ldr r2, [r7, #12]
|
|
8002ba6: 429a cmp r2, r3
|
|
8002ba8: d136 bne.n 8002c18 <HAL_GPIO_DeInit+0xec>
|
|
/* Clear EXTI line configuration */
|
|
#ifdef CORE_CM0PLUS
|
|
EXTI->C2IMR1 &= ~(iocurrent);
|
|
EXTI->C2EMR1 &= ~(iocurrent);
|
|
#else
|
|
EXTI->IMR1 &= ~(iocurrent);
|
|
8002baa: 4b46 ldr r3, [pc, #280] @ (8002cc4 <HAL_GPIO_DeInit+0x198>)
|
|
8002bac: f8d3 2080 ldr.w r2, [r3, #128] @ 0x80
|
|
8002bb0: 693b ldr r3, [r7, #16]
|
|
8002bb2: 43db mvns r3, r3
|
|
8002bb4: 4943 ldr r1, [pc, #268] @ (8002cc4 <HAL_GPIO_DeInit+0x198>)
|
|
8002bb6: 4013 ands r3, r2
|
|
8002bb8: f8c1 3080 str.w r3, [r1, #128] @ 0x80
|
|
EXTI->EMR1 &= ~(iocurrent);
|
|
8002bbc: 4b41 ldr r3, [pc, #260] @ (8002cc4 <HAL_GPIO_DeInit+0x198>)
|
|
8002bbe: f8d3 2084 ldr.w r2, [r3, #132] @ 0x84
|
|
8002bc2: 693b ldr r3, [r7, #16]
|
|
8002bc4: 43db mvns r3, r3
|
|
8002bc6: 493f ldr r1, [pc, #252] @ (8002cc4 <HAL_GPIO_DeInit+0x198>)
|
|
8002bc8: 4013 ands r3, r2
|
|
8002bca: f8c1 3084 str.w r3, [r1, #132] @ 0x84
|
|
#endif /* CORE_CM0PLUS */
|
|
|
|
/* Clear Rising Falling edge configuration */
|
|
EXTI->RTSR1 &= ~(iocurrent);
|
|
8002bce: 4b3d ldr r3, [pc, #244] @ (8002cc4 <HAL_GPIO_DeInit+0x198>)
|
|
8002bd0: 681a ldr r2, [r3, #0]
|
|
8002bd2: 693b ldr r3, [r7, #16]
|
|
8002bd4: 43db mvns r3, r3
|
|
8002bd6: 493b ldr r1, [pc, #236] @ (8002cc4 <HAL_GPIO_DeInit+0x198>)
|
|
8002bd8: 4013 ands r3, r2
|
|
8002bda: 600b str r3, [r1, #0]
|
|
EXTI->FTSR1 &= ~(iocurrent);
|
|
8002bdc: 4b39 ldr r3, [pc, #228] @ (8002cc4 <HAL_GPIO_DeInit+0x198>)
|
|
8002bde: 685a ldr r2, [r3, #4]
|
|
8002be0: 693b ldr r3, [r7, #16]
|
|
8002be2: 43db mvns r3, r3
|
|
8002be4: 4937 ldr r1, [pc, #220] @ (8002cc4 <HAL_GPIO_DeInit+0x198>)
|
|
8002be6: 4013 ands r3, r2
|
|
8002be8: 604b str r3, [r1, #4]
|
|
|
|
/* Clear EXTICR configuration */
|
|
tmp = 0x07uL << (4u * (position & 0x03U));
|
|
8002bea: 697b ldr r3, [r7, #20]
|
|
8002bec: f003 0303 and.w r3, r3, #3
|
|
8002bf0: 009b lsls r3, r3, #2
|
|
8002bf2: 2207 movs r2, #7
|
|
8002bf4: fa02 f303 lsl.w r3, r2, r3
|
|
8002bf8: 60fb str r3, [r7, #12]
|
|
SYSCFG->EXTICR[position >> 2u] &= ~tmp;
|
|
8002bfa: 4a2f ldr r2, [pc, #188] @ (8002cb8 <HAL_GPIO_DeInit+0x18c>)
|
|
8002bfc: 697b ldr r3, [r7, #20]
|
|
8002bfe: 089b lsrs r3, r3, #2
|
|
8002c00: 3302 adds r3, #2
|
|
8002c02: f852 1023 ldr.w r1, [r2, r3, lsl #2]
|
|
8002c06: 68fb ldr r3, [r7, #12]
|
|
8002c08: 43da mvns r2, r3
|
|
8002c0a: 482b ldr r0, [pc, #172] @ (8002cb8 <HAL_GPIO_DeInit+0x18c>)
|
|
8002c0c: 697b ldr r3, [r7, #20]
|
|
8002c0e: 089b lsrs r3, r3, #2
|
|
8002c10: 400a ands r2, r1
|
|
8002c12: 3302 adds r3, #2
|
|
8002c14: f840 2023 str.w r2, [r0, r3, lsl #2]
|
|
}
|
|
|
|
/*------------------------- GPIO Mode Configuration --------------------*/
|
|
/* Configure IO in Analog Mode */
|
|
GPIOx->MODER |= (GPIO_MODER_MODE0 << (position * 2U));
|
|
8002c18: 687b ldr r3, [r7, #4]
|
|
8002c1a: 681a ldr r2, [r3, #0]
|
|
8002c1c: 697b ldr r3, [r7, #20]
|
|
8002c1e: 005b lsls r3, r3, #1
|
|
8002c20: 2103 movs r1, #3
|
|
8002c22: fa01 f303 lsl.w r3, r1, r3
|
|
8002c26: 431a orrs r2, r3
|
|
8002c28: 687b ldr r3, [r7, #4]
|
|
8002c2a: 601a str r2, [r3, #0]
|
|
|
|
/* Configure the default Alternate Function in current IO */
|
|
GPIOx->AFR[position >> 3U] &= ~(0xFU << ((position & 0x07U) * 4U)) ;
|
|
8002c2c: 697b ldr r3, [r7, #20]
|
|
8002c2e: 08da lsrs r2, r3, #3
|
|
8002c30: 687b ldr r3, [r7, #4]
|
|
8002c32: 3208 adds r2, #8
|
|
8002c34: f853 1022 ldr.w r1, [r3, r2, lsl #2]
|
|
8002c38: 697b ldr r3, [r7, #20]
|
|
8002c3a: f003 0307 and.w r3, r3, #7
|
|
8002c3e: 009b lsls r3, r3, #2
|
|
8002c40: 220f movs r2, #15
|
|
8002c42: fa02 f303 lsl.w r3, r2, r3
|
|
8002c46: 43db mvns r3, r3
|
|
8002c48: 697a ldr r2, [r7, #20]
|
|
8002c4a: 08d2 lsrs r2, r2, #3
|
|
8002c4c: 4019 ands r1, r3
|
|
8002c4e: 687b ldr r3, [r7, #4]
|
|
8002c50: 3208 adds r2, #8
|
|
8002c52: f843 1022 str.w r1, [r3, r2, lsl #2]
|
|
|
|
/* Configure the default value for IO Speed */
|
|
GPIOx->OSPEEDR &= ~(GPIO_OSPEEDR_OSPEED0 << (position * 2U));
|
|
8002c56: 687b ldr r3, [r7, #4]
|
|
8002c58: 689a ldr r2, [r3, #8]
|
|
8002c5a: 697b ldr r3, [r7, #20]
|
|
8002c5c: 005b lsls r3, r3, #1
|
|
8002c5e: 2103 movs r1, #3
|
|
8002c60: fa01 f303 lsl.w r3, r1, r3
|
|
8002c64: 43db mvns r3, r3
|
|
8002c66: 401a ands r2, r3
|
|
8002c68: 687b ldr r3, [r7, #4]
|
|
8002c6a: 609a str r2, [r3, #8]
|
|
|
|
/* Configure the default value IO Output Type */
|
|
GPIOx->OTYPER &= ~(GPIO_OTYPER_OT0 << position) ;
|
|
8002c6c: 687b ldr r3, [r7, #4]
|
|
8002c6e: 685a ldr r2, [r3, #4]
|
|
8002c70: 2101 movs r1, #1
|
|
8002c72: 697b ldr r3, [r7, #20]
|
|
8002c74: fa01 f303 lsl.w r3, r1, r3
|
|
8002c78: 43db mvns r3, r3
|
|
8002c7a: 401a ands r2, r3
|
|
8002c7c: 687b ldr r3, [r7, #4]
|
|
8002c7e: 605a str r2, [r3, #4]
|
|
|
|
/* Deactivate the Pull-up and Pull-down resistor for the current IO */
|
|
GPIOx->PUPDR &= ~(GPIO_PUPDR_PUPD0 << (position * 2U));
|
|
8002c80: 687b ldr r3, [r7, #4]
|
|
8002c82: 68da ldr r2, [r3, #12]
|
|
8002c84: 697b ldr r3, [r7, #20]
|
|
8002c86: 005b lsls r3, r3, #1
|
|
8002c88: 2103 movs r1, #3
|
|
8002c8a: fa01 f303 lsl.w r3, r1, r3
|
|
8002c8e: 43db mvns r3, r3
|
|
8002c90: 401a ands r2, r3
|
|
8002c92: 687b ldr r3, [r7, #4]
|
|
8002c94: 60da str r2, [r3, #12]
|
|
}
|
|
|
|
position++;
|
|
8002c96: 697b ldr r3, [r7, #20]
|
|
8002c98: 3301 adds r3, #1
|
|
8002c9a: 617b str r3, [r7, #20]
|
|
while ((GPIO_Pin >> position) != 0x00u)
|
|
8002c9c: 683a ldr r2, [r7, #0]
|
|
8002c9e: 697b ldr r3, [r7, #20]
|
|
8002ca0: fa22 f303 lsr.w r3, r2, r3
|
|
8002ca4: 2b00 cmp r3, #0
|
|
8002ca6: f47f af49 bne.w 8002b3c <HAL_GPIO_DeInit+0x10>
|
|
}
|
|
}
|
|
8002caa: bf00 nop
|
|
8002cac: bf00 nop
|
|
8002cae: 371c adds r7, #28
|
|
8002cb0: 46bd mov sp, r7
|
|
8002cb2: bc80 pop {r7}
|
|
8002cb4: 4770 bx lr
|
|
8002cb6: bf00 nop
|
|
8002cb8: 40010000 .word 0x40010000
|
|
8002cbc: 48000400 .word 0x48000400
|
|
8002cc0: 48000800 .word 0x48000800
|
|
8002cc4: 58000800 .word 0x58000800
|
|
|
|
08002cc8 <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)
|
|
{
|
|
8002cc8: b480 push {r7}
|
|
8002cca: b083 sub sp, #12
|
|
8002ccc: af00 add r7, sp, #0
|
|
8002cce: 6078 str r0, [r7, #4]
|
|
8002cd0: 460b mov r3, r1
|
|
8002cd2: 807b strh r3, [r7, #2]
|
|
8002cd4: 4613 mov r3, r2
|
|
8002cd6: 707b strb r3, [r7, #1]
|
|
/* Check the parameters */
|
|
assert_param(IS_GPIO_PIN(GPIO_Pin));
|
|
assert_param(IS_GPIO_PIN_ACTION(PinState));
|
|
|
|
if (PinState != GPIO_PIN_RESET)
|
|
8002cd8: 787b ldrb r3, [r7, #1]
|
|
8002cda: 2b00 cmp r3, #0
|
|
8002cdc: d003 beq.n 8002ce6 <HAL_GPIO_WritePin+0x1e>
|
|
{
|
|
GPIOx->BSRR = (uint32_t)GPIO_Pin;
|
|
8002cde: 887a ldrh r2, [r7, #2]
|
|
8002ce0: 687b ldr r3, [r7, #4]
|
|
8002ce2: 619a str r2, [r3, #24]
|
|
}
|
|
else
|
|
{
|
|
GPIOx->BRR = (uint32_t)GPIO_Pin;
|
|
}
|
|
}
|
|
8002ce4: e002 b.n 8002cec <HAL_GPIO_WritePin+0x24>
|
|
GPIOx->BRR = (uint32_t)GPIO_Pin;
|
|
8002ce6: 887a ldrh r2, [r7, #2]
|
|
8002ce8: 687b ldr r3, [r7, #4]
|
|
8002cea: 629a str r2, [r3, #40] @ 0x28
|
|
}
|
|
8002cec: bf00 nop
|
|
8002cee: 370c adds r7, #12
|
|
8002cf0: 46bd mov sp, r7
|
|
8002cf2: bc80 pop {r7}
|
|
8002cf4: 4770 bx lr
|
|
...
|
|
|
|
08002cf8 <HAL_GPIO_EXTI_IRQHandler>:
|
|
* @brief Handle EXTI interrupt request.
|
|
* @param GPIO_Pin Specifies the port pin connected to corresponding EXTI line.
|
|
* @retval None
|
|
*/
|
|
void HAL_GPIO_EXTI_IRQHandler(uint16_t GPIO_Pin)
|
|
{
|
|
8002cf8: b580 push {r7, lr}
|
|
8002cfa: b082 sub sp, #8
|
|
8002cfc: af00 add r7, sp, #0
|
|
8002cfe: 4603 mov r3, r0
|
|
8002d00: 80fb strh r3, [r7, #6]
|
|
/* EXTI line interrupt detected */
|
|
if (__HAL_GPIO_EXTI_GET_IT(GPIO_Pin) != 0x00u)
|
|
8002d02: 4b08 ldr r3, [pc, #32] @ (8002d24 <HAL_GPIO_EXTI_IRQHandler+0x2c>)
|
|
8002d04: 68da ldr r2, [r3, #12]
|
|
8002d06: 88fb ldrh r3, [r7, #6]
|
|
8002d08: 4013 ands r3, r2
|
|
8002d0a: 2b00 cmp r3, #0
|
|
8002d0c: d006 beq.n 8002d1c <HAL_GPIO_EXTI_IRQHandler+0x24>
|
|
{
|
|
__HAL_GPIO_EXTI_CLEAR_IT(GPIO_Pin);
|
|
8002d0e: 4a05 ldr r2, [pc, #20] @ (8002d24 <HAL_GPIO_EXTI_IRQHandler+0x2c>)
|
|
8002d10: 88fb ldrh r3, [r7, #6]
|
|
8002d12: 60d3 str r3, [r2, #12]
|
|
HAL_GPIO_EXTI_Callback(GPIO_Pin);
|
|
8002d14: 88fb ldrh r3, [r7, #6]
|
|
8002d16: 4618 mov r0, r3
|
|
8002d18: f000 f806 bl 8002d28 <HAL_GPIO_EXTI_Callback>
|
|
}
|
|
}
|
|
8002d1c: bf00 nop
|
|
8002d1e: 3708 adds r7, #8
|
|
8002d20: 46bd mov sp, r7
|
|
8002d22: bd80 pop {r7, pc}
|
|
8002d24: 58000800 .word 0x58000800
|
|
|
|
08002d28 <HAL_GPIO_EXTI_Callback>:
|
|
* @brief EXTI line detection callback.
|
|
* @param GPIO_Pin Specifies the port pin connected to corresponding EXTI line.
|
|
* @retval None
|
|
*/
|
|
__weak void HAL_GPIO_EXTI_Callback(uint16_t GPIO_Pin)
|
|
{
|
|
8002d28: b480 push {r7}
|
|
8002d2a: b083 sub sp, #12
|
|
8002d2c: af00 add r7, sp, #0
|
|
8002d2e: 4603 mov r3, r0
|
|
8002d30: 80fb strh r3, [r7, #6]
|
|
UNUSED(GPIO_Pin);
|
|
|
|
/* NOTE: This function should not be modified, when the callback is needed,
|
|
the HAL_GPIO_EXTI_Callback could be implemented in the user file
|
|
*/
|
|
}
|
|
8002d32: bf00 nop
|
|
8002d34: 370c adds r7, #12
|
|
8002d36: 46bd mov sp, r7
|
|
8002d38: bc80 pop {r7}
|
|
8002d3a: 4770 bx lr
|
|
|
|
08002d3c <HAL_PWR_EnableBkUpAccess>:
|
|
* @note LSEON bit that switches on and off the LSE crystal belongs as well to the
|
|
* backup domain.
|
|
* @retval None
|
|
*/
|
|
void HAL_PWR_EnableBkUpAccess(void)
|
|
{
|
|
8002d3c: b480 push {r7}
|
|
8002d3e: af00 add r7, sp, #0
|
|
SET_BIT(PWR->CR1, PWR_CR1_DBP);
|
|
8002d40: 4b04 ldr r3, [pc, #16] @ (8002d54 <HAL_PWR_EnableBkUpAccess+0x18>)
|
|
8002d42: 681b ldr r3, [r3, #0]
|
|
8002d44: 4a03 ldr r2, [pc, #12] @ (8002d54 <HAL_PWR_EnableBkUpAccess+0x18>)
|
|
8002d46: f443 7380 orr.w r3, r3, #256 @ 0x100
|
|
8002d4a: 6013 str r3, [r2, #0]
|
|
}
|
|
8002d4c: bf00 nop
|
|
8002d4e: 46bd mov sp, r7
|
|
8002d50: bc80 pop {r7}
|
|
8002d52: 4770 bx lr
|
|
8002d54: 58000400 .word 0x58000400
|
|
|
|
08002d58 <HAL_PWR_EnterSLEEPMode>:
|
|
* @note When WFI entry is used, tick interrupt have to be disabled if not desired as
|
|
* the interrupt wake up source.
|
|
* @retval None
|
|
*/
|
|
void HAL_PWR_EnterSLEEPMode(uint32_t Regulator, uint8_t SLEEPEntry)
|
|
{
|
|
8002d58: b580 push {r7, lr}
|
|
8002d5a: b082 sub sp, #8
|
|
8002d5c: af00 add r7, sp, #0
|
|
8002d5e: 6078 str r0, [r7, #4]
|
|
8002d60: 460b mov r3, r1
|
|
8002d62: 70fb strb r3, [r7, #3]
|
|
/* Check the parameters */
|
|
assert_param(IS_PWR_REGULATOR(Regulator));
|
|
assert_param(IS_PWR_SLEEP_ENTRY(SLEEPEntry));
|
|
|
|
/* Set Regulator parameter */
|
|
if (Regulator == PWR_MAINREGULATOR_ON)
|
|
8002d64: 687b ldr r3, [r7, #4]
|
|
8002d66: 2b00 cmp r3, #0
|
|
8002d68: d10c bne.n 8002d84 <HAL_PWR_EnterSLEEPMode+0x2c>
|
|
{
|
|
/* If in low-power run mode at this point, exit it */
|
|
if (HAL_IS_BIT_SET(PWR->SR2, (PWR_SR2_REGLPF)))
|
|
8002d6a: 4b13 ldr r3, [pc, #76] @ (8002db8 <HAL_PWR_EnterSLEEPMode+0x60>)
|
|
8002d6c: 695b ldr r3, [r3, #20]
|
|
8002d6e: f403 7300 and.w r3, r3, #512 @ 0x200
|
|
8002d72: f5b3 7f00 cmp.w r3, #512 @ 0x200
|
|
8002d76: d10d bne.n 8002d94 <HAL_PWR_EnterSLEEPMode+0x3c>
|
|
{
|
|
if (HAL_PWREx_DisableLowPowerRunMode() != HAL_OK)
|
|
8002d78: f000 f83c bl 8002df4 <HAL_PWREx_DisableLowPowerRunMode>
|
|
8002d7c: 4603 mov r3, r0
|
|
8002d7e: 2b00 cmp r3, #0
|
|
8002d80: d008 beq.n 8002d94 <HAL_PWR_EnterSLEEPMode+0x3c>
|
|
{
|
|
return ;
|
|
8002d82: e015 b.n 8002db0 <HAL_PWR_EnterSLEEPMode+0x58>
|
|
}
|
|
else
|
|
{
|
|
/* If in run mode, first move to low-power run mode.
|
|
The system clock frequency must be below 2 MHz at this point. */
|
|
if (HAL_IS_BIT_CLR(PWR->SR2, (PWR_SR2_REGLPF)))
|
|
8002d84: 4b0c ldr r3, [pc, #48] @ (8002db8 <HAL_PWR_EnterSLEEPMode+0x60>)
|
|
8002d86: 695b ldr r3, [r3, #20]
|
|
8002d88: f403 7300 and.w r3, r3, #512 @ 0x200
|
|
8002d8c: 2b00 cmp r3, #0
|
|
8002d8e: d101 bne.n 8002d94 <HAL_PWR_EnterSLEEPMode+0x3c>
|
|
{
|
|
HAL_PWREx_EnableLowPowerRunMode();
|
|
8002d90: f000 f822 bl 8002dd8 <HAL_PWREx_EnableLowPowerRunMode>
|
|
}
|
|
}
|
|
|
|
/* Clear SLEEPDEEP bit of Cortex System Control Register */
|
|
CLEAR_BIT(SCB->SCR, ((uint32_t)SCB_SCR_SLEEPDEEP_Msk));
|
|
8002d94: 4b09 ldr r3, [pc, #36] @ (8002dbc <HAL_PWR_EnterSLEEPMode+0x64>)
|
|
8002d96: 691b ldr r3, [r3, #16]
|
|
8002d98: 4a08 ldr r2, [pc, #32] @ (8002dbc <HAL_PWR_EnterSLEEPMode+0x64>)
|
|
8002d9a: f023 0304 bic.w r3, r3, #4
|
|
8002d9e: 6113 str r3, [r2, #16]
|
|
|
|
/* Select SLEEP mode entry -------------------------------------------------*/
|
|
if (SLEEPEntry == PWR_SLEEPENTRY_WFI)
|
|
8002da0: 78fb ldrb r3, [r7, #3]
|
|
8002da2: 2b01 cmp r3, #1
|
|
8002da4: d101 bne.n 8002daa <HAL_PWR_EnterSLEEPMode+0x52>
|
|
{
|
|
/* Request Wait For Interrupt */
|
|
__WFI();
|
|
8002da6: bf30 wfi
|
|
8002da8: e002 b.n 8002db0 <HAL_PWR_EnterSLEEPMode+0x58>
|
|
}
|
|
else
|
|
{
|
|
/* Request Wait For Event */
|
|
__SEV();
|
|
8002daa: bf40 sev
|
|
__WFE();
|
|
8002dac: bf20 wfe
|
|
__WFE();
|
|
8002dae: bf20 wfe
|
|
}
|
|
}
|
|
8002db0: 3708 adds r7, #8
|
|
8002db2: 46bd mov sp, r7
|
|
8002db4: bd80 pop {r7, pc}
|
|
8002db6: bf00 nop
|
|
8002db8: 58000400 .word 0x58000400
|
|
8002dbc: e000ed00 .word 0xe000ed00
|
|
|
|
08002dc0 <HAL_PWREx_GetVoltageRange>:
|
|
/**
|
|
* @brief Return Voltage Scaling Range.
|
|
* @retval VOS bit field (PWR_REGULATOR_VOLTAGE_SCALE1 or PWPWR_REGULATOR_VOLTAGE_SCALE2)
|
|
*/
|
|
uint32_t HAL_PWREx_GetVoltageRange(void)
|
|
{
|
|
8002dc0: b480 push {r7}
|
|
8002dc2: af00 add r7, sp, #0
|
|
return (PWR->CR1 & PWR_CR1_VOS);
|
|
8002dc4: 4b03 ldr r3, [pc, #12] @ (8002dd4 <HAL_PWREx_GetVoltageRange+0x14>)
|
|
8002dc6: 681b ldr r3, [r3, #0]
|
|
8002dc8: f403 63c0 and.w r3, r3, #1536 @ 0x600
|
|
}
|
|
8002dcc: 4618 mov r0, r3
|
|
8002dce: 46bd mov sp, r7
|
|
8002dd0: bc80 pop {r7}
|
|
8002dd2: 4770 bx lr
|
|
8002dd4: 58000400 .word 0x58000400
|
|
|
|
08002dd8 <HAL_PWREx_EnableLowPowerRunMode>:
|
|
* @note In Low-power Run mode, all I/O pins keep the same state as in Run mode.
|
|
* @note Clock frequency must be reduced below 2 MHz.
|
|
* @retval None
|
|
*/
|
|
void HAL_PWREx_EnableLowPowerRunMode(void)
|
|
{
|
|
8002dd8: b480 push {r7}
|
|
8002dda: af00 add r7, sp, #0
|
|
/* Set Regulator parameter */
|
|
SET_BIT(PWR->CR1, PWR_CR1_LPR);
|
|
8002ddc: 4b04 ldr r3, [pc, #16] @ (8002df0 <HAL_PWREx_EnableLowPowerRunMode+0x18>)
|
|
8002dde: 681b ldr r3, [r3, #0]
|
|
8002de0: 4a03 ldr r2, [pc, #12] @ (8002df0 <HAL_PWREx_EnableLowPowerRunMode+0x18>)
|
|
8002de2: f443 4380 orr.w r3, r3, #16384 @ 0x4000
|
|
8002de6: 6013 str r3, [r2, #0]
|
|
}
|
|
8002de8: bf00 nop
|
|
8002dea: 46bd mov sp, r7
|
|
8002dec: bc80 pop {r7}
|
|
8002dee: 4770 bx lr
|
|
8002df0: 58000400 .word 0x58000400
|
|
|
|
08002df4 <HAL_PWREx_DisableLowPowerRunMode>:
|
|
* returns HAL_TIMEOUT status). The system clock frequency can then be
|
|
* increased above 2 MHz.
|
|
* @retval HAL Status
|
|
*/
|
|
HAL_StatusTypeDef HAL_PWREx_DisableLowPowerRunMode(void)
|
|
{
|
|
8002df4: b480 push {r7}
|
|
8002df6: b083 sub sp, #12
|
|
8002df8: af00 add r7, sp, #0
|
|
uint32_t wait_loop_index;
|
|
|
|
/* Clear LPR bit */
|
|
CLEAR_BIT(PWR->CR1, PWR_CR1_LPR);
|
|
8002dfa: 4b16 ldr r3, [pc, #88] @ (8002e54 <HAL_PWREx_DisableLowPowerRunMode+0x60>)
|
|
8002dfc: 681b ldr r3, [r3, #0]
|
|
8002dfe: 4a15 ldr r2, [pc, #84] @ (8002e54 <HAL_PWREx_DisableLowPowerRunMode+0x60>)
|
|
8002e00: f423 4380 bic.w r3, r3, #16384 @ 0x4000
|
|
8002e04: 6013 str r3, [r2, #0]
|
|
|
|
/* Wait until REGLPF is reset */
|
|
wait_loop_index = ((PWR_FLAG_SETTING_DELAY_US * SystemCoreClock) / 1000000UL);
|
|
8002e06: 4b14 ldr r3, [pc, #80] @ (8002e58 <HAL_PWREx_DisableLowPowerRunMode+0x64>)
|
|
8002e08: 681b ldr r3, [r3, #0]
|
|
8002e0a: 2232 movs r2, #50 @ 0x32
|
|
8002e0c: fb02 f303 mul.w r3, r2, r3
|
|
8002e10: 4a12 ldr r2, [pc, #72] @ (8002e5c <HAL_PWREx_DisableLowPowerRunMode+0x68>)
|
|
8002e12: fba2 2303 umull r2, r3, r2, r3
|
|
8002e16: 0c9b lsrs r3, r3, #18
|
|
8002e18: 607b str r3, [r7, #4]
|
|
while ((HAL_IS_BIT_SET(PWR->SR2, PWR_SR2_REGLPF)) && (wait_loop_index != 0U))
|
|
8002e1a: e002 b.n 8002e22 <HAL_PWREx_DisableLowPowerRunMode+0x2e>
|
|
{
|
|
wait_loop_index--;
|
|
8002e1c: 687b ldr r3, [r7, #4]
|
|
8002e1e: 3b01 subs r3, #1
|
|
8002e20: 607b str r3, [r7, #4]
|
|
while ((HAL_IS_BIT_SET(PWR->SR2, PWR_SR2_REGLPF)) && (wait_loop_index != 0U))
|
|
8002e22: 4b0c ldr r3, [pc, #48] @ (8002e54 <HAL_PWREx_DisableLowPowerRunMode+0x60>)
|
|
8002e24: 695b ldr r3, [r3, #20]
|
|
8002e26: f403 7300 and.w r3, r3, #512 @ 0x200
|
|
8002e2a: f5b3 7f00 cmp.w r3, #512 @ 0x200
|
|
8002e2e: d102 bne.n 8002e36 <HAL_PWREx_DisableLowPowerRunMode+0x42>
|
|
8002e30: 687b ldr r3, [r7, #4]
|
|
8002e32: 2b00 cmp r3, #0
|
|
8002e34: d1f2 bne.n 8002e1c <HAL_PWREx_DisableLowPowerRunMode+0x28>
|
|
}
|
|
if (HAL_IS_BIT_SET(PWR->SR2, (PWR_SR2_REGLPF)))
|
|
8002e36: 4b07 ldr r3, [pc, #28] @ (8002e54 <HAL_PWREx_DisableLowPowerRunMode+0x60>)
|
|
8002e38: 695b ldr r3, [r3, #20]
|
|
8002e3a: f403 7300 and.w r3, r3, #512 @ 0x200
|
|
8002e3e: f5b3 7f00 cmp.w r3, #512 @ 0x200
|
|
8002e42: d101 bne.n 8002e48 <HAL_PWREx_DisableLowPowerRunMode+0x54>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
8002e44: 2303 movs r3, #3
|
|
8002e46: e000 b.n 8002e4a <HAL_PWREx_DisableLowPowerRunMode+0x56>
|
|
}
|
|
|
|
return HAL_OK;
|
|
8002e48: 2300 movs r3, #0
|
|
}
|
|
8002e4a: 4618 mov r0, r3
|
|
8002e4c: 370c adds r7, #12
|
|
8002e4e: 46bd mov sp, r7
|
|
8002e50: bc80 pop {r7}
|
|
8002e52: 4770 bx lr
|
|
8002e54: 58000400 .word 0x58000400
|
|
8002e58: 20000000 .word 0x20000000
|
|
8002e5c: 431bde83 .word 0x431bde83
|
|
|
|
08002e60 <HAL_PWREx_EnterSTOP2Mode>:
|
|
* @arg @ref PWR_STOPENTRY_WFI Enter Stop mode with WFI instruction
|
|
* @arg @ref PWR_STOPENTRY_WFE Enter Stop mode with WFE instruction
|
|
* @retval None
|
|
*/
|
|
void HAL_PWREx_EnterSTOP2Mode(uint8_t STOPEntry)
|
|
{
|
|
8002e60: b480 push {r7}
|
|
8002e62: b083 sub sp, #12
|
|
8002e64: af00 add r7, sp, #0
|
|
8002e66: 4603 mov r3, r0
|
|
8002e68: 71fb strb r3, [r7, #7]
|
|
#ifdef CORE_CM0PLUS
|
|
/* Set Stop mode 2 */
|
|
MODIFY_REG(PWR->C2CR1, PWR_C2CR1_LPMS, PWR_LOWPOWERMODE_STOP2);
|
|
#else
|
|
/* Set Stop mode 2 */
|
|
MODIFY_REG(PWR->CR1, PWR_CR1_LPMS, PWR_LOWPOWERMODE_STOP2);
|
|
8002e6a: 4b10 ldr r3, [pc, #64] @ (8002eac <HAL_PWREx_EnterSTOP2Mode+0x4c>)
|
|
8002e6c: 681b ldr r3, [r3, #0]
|
|
8002e6e: f023 0307 bic.w r3, r3, #7
|
|
8002e72: 4a0e ldr r2, [pc, #56] @ (8002eac <HAL_PWREx_EnterSTOP2Mode+0x4c>)
|
|
8002e74: f043 0302 orr.w r3, r3, #2
|
|
8002e78: 6013 str r3, [r2, #0]
|
|
#endif /* CORE_CM0PLUS */
|
|
|
|
/* Set SLEEPDEEP bit of Cortex System Control Register */
|
|
SET_BIT(SCB->SCR, ((uint32_t)SCB_SCR_SLEEPDEEP_Msk));
|
|
8002e7a: 4b0d ldr r3, [pc, #52] @ (8002eb0 <HAL_PWREx_EnterSTOP2Mode+0x50>)
|
|
8002e7c: 691b ldr r3, [r3, #16]
|
|
8002e7e: 4a0c ldr r2, [pc, #48] @ (8002eb0 <HAL_PWREx_EnterSTOP2Mode+0x50>)
|
|
8002e80: f043 0304 orr.w r3, r3, #4
|
|
8002e84: 6113 str r3, [r2, #16]
|
|
|
|
/* Select Stop mode entry --------------------------------------------------*/
|
|
if (STOPEntry == PWR_STOPENTRY_WFI)
|
|
8002e86: 79fb ldrb r3, [r7, #7]
|
|
8002e88: 2b01 cmp r3, #1
|
|
8002e8a: d101 bne.n 8002e90 <HAL_PWREx_EnterSTOP2Mode+0x30>
|
|
{
|
|
/* Request Wait For Interrupt */
|
|
__WFI();
|
|
8002e8c: bf30 wfi
|
|
8002e8e: e002 b.n 8002e96 <HAL_PWREx_EnterSTOP2Mode+0x36>
|
|
}
|
|
else
|
|
{
|
|
/* Request Wait For Event */
|
|
__SEV();
|
|
8002e90: bf40 sev
|
|
__WFE();
|
|
8002e92: bf20 wfe
|
|
__WFE();
|
|
8002e94: bf20 wfe
|
|
}
|
|
|
|
/* Reset SLEEPDEEP bit of Cortex System Control Register */
|
|
CLEAR_BIT(SCB->SCR, ((uint32_t)SCB_SCR_SLEEPDEEP_Msk));
|
|
8002e96: 4b06 ldr r3, [pc, #24] @ (8002eb0 <HAL_PWREx_EnterSTOP2Mode+0x50>)
|
|
8002e98: 691b ldr r3, [r3, #16]
|
|
8002e9a: 4a05 ldr r2, [pc, #20] @ (8002eb0 <HAL_PWREx_EnterSTOP2Mode+0x50>)
|
|
8002e9c: f023 0304 bic.w r3, r3, #4
|
|
8002ea0: 6113 str r3, [r2, #16]
|
|
}
|
|
8002ea2: bf00 nop
|
|
8002ea4: 370c adds r7, #12
|
|
8002ea6: 46bd mov sp, r7
|
|
8002ea8: bc80 pop {r7}
|
|
8002eaa: 4770 bx lr
|
|
8002eac: 58000400 .word 0x58000400
|
|
8002eb0: e000ed00 .word 0xe000ed00
|
|
|
|
08002eb4 <LL_PWR_IsEnabledBkUpAccess>:
|
|
{
|
|
8002eb4: b480 push {r7}
|
|
8002eb6: af00 add r7, sp, #0
|
|
return ((READ_BIT(PWR->CR1, PWR_CR1_DBP) == (PWR_CR1_DBP)) ? 1UL : 0UL);
|
|
8002eb8: 4b06 ldr r3, [pc, #24] @ (8002ed4 <LL_PWR_IsEnabledBkUpAccess+0x20>)
|
|
8002eba: 681b ldr r3, [r3, #0]
|
|
8002ebc: f403 7380 and.w r3, r3, #256 @ 0x100
|
|
8002ec0: f5b3 7f80 cmp.w r3, #256 @ 0x100
|
|
8002ec4: d101 bne.n 8002eca <LL_PWR_IsEnabledBkUpAccess+0x16>
|
|
8002ec6: 2301 movs r3, #1
|
|
8002ec8: e000 b.n 8002ecc <LL_PWR_IsEnabledBkUpAccess+0x18>
|
|
8002eca: 2300 movs r3, #0
|
|
}
|
|
8002ecc: 4618 mov r0, r3
|
|
8002ece: 46bd mov sp, r7
|
|
8002ed0: bc80 pop {r7}
|
|
8002ed2: 4770 bx lr
|
|
8002ed4: 58000400 .word 0x58000400
|
|
|
|
08002ed8 <LL_RCC_HSE_EnableTcxo>:
|
|
{
|
|
8002ed8: b480 push {r7}
|
|
8002eda: af00 add r7, sp, #0
|
|
SET_BIT(RCC->CR, RCC_CR_HSEBYPPWR);
|
|
8002edc: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8002ee0: 681b ldr r3, [r3, #0]
|
|
8002ee2: f04f 42b0 mov.w r2, #1476395008 @ 0x58000000
|
|
8002ee6: f443 1300 orr.w r3, r3, #2097152 @ 0x200000
|
|
8002eea: 6013 str r3, [r2, #0]
|
|
}
|
|
8002eec: bf00 nop
|
|
8002eee: 46bd mov sp, r7
|
|
8002ef0: bc80 pop {r7}
|
|
8002ef2: 4770 bx lr
|
|
|
|
08002ef4 <LL_RCC_HSE_DisableTcxo>:
|
|
{
|
|
8002ef4: b480 push {r7}
|
|
8002ef6: af00 add r7, sp, #0
|
|
CLEAR_BIT(RCC->CR, RCC_CR_HSEBYPPWR);
|
|
8002ef8: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8002efc: 681b ldr r3, [r3, #0]
|
|
8002efe: f04f 42b0 mov.w r2, #1476395008 @ 0x58000000
|
|
8002f02: f423 1300 bic.w r3, r3, #2097152 @ 0x200000
|
|
8002f06: 6013 str r3, [r2, #0]
|
|
}
|
|
8002f08: bf00 nop
|
|
8002f0a: 46bd mov sp, r7
|
|
8002f0c: bc80 pop {r7}
|
|
8002f0e: 4770 bx lr
|
|
|
|
08002f10 <LL_RCC_HSE_IsEnabledDiv2>:
|
|
{
|
|
8002f10: b480 push {r7}
|
|
8002f12: af00 add r7, sp, #0
|
|
return ((READ_BIT(RCC->CR, RCC_CR_HSEPRE) == (RCC_CR_HSEPRE)) ? 1UL : 0UL);
|
|
8002f14: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8002f18: 681b ldr r3, [r3, #0]
|
|
8002f1a: f403 1380 and.w r3, r3, #1048576 @ 0x100000
|
|
8002f1e: f5b3 1f80 cmp.w r3, #1048576 @ 0x100000
|
|
8002f22: d101 bne.n 8002f28 <LL_RCC_HSE_IsEnabledDiv2+0x18>
|
|
8002f24: 2301 movs r3, #1
|
|
8002f26: e000 b.n 8002f2a <LL_RCC_HSE_IsEnabledDiv2+0x1a>
|
|
8002f28: 2300 movs r3, #0
|
|
}
|
|
8002f2a: 4618 mov r0, r3
|
|
8002f2c: 46bd mov sp, r7
|
|
8002f2e: bc80 pop {r7}
|
|
8002f30: 4770 bx lr
|
|
|
|
08002f32 <LL_RCC_HSE_Enable>:
|
|
{
|
|
8002f32: b480 push {r7}
|
|
8002f34: af00 add r7, sp, #0
|
|
SET_BIT(RCC->CR, RCC_CR_HSEON);
|
|
8002f36: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8002f3a: 681b ldr r3, [r3, #0]
|
|
8002f3c: f04f 42b0 mov.w r2, #1476395008 @ 0x58000000
|
|
8002f40: f443 3380 orr.w r3, r3, #65536 @ 0x10000
|
|
8002f44: 6013 str r3, [r2, #0]
|
|
}
|
|
8002f46: bf00 nop
|
|
8002f48: 46bd mov sp, r7
|
|
8002f4a: bc80 pop {r7}
|
|
8002f4c: 4770 bx lr
|
|
|
|
08002f4e <LL_RCC_HSE_Disable>:
|
|
{
|
|
8002f4e: b480 push {r7}
|
|
8002f50: af00 add r7, sp, #0
|
|
CLEAR_BIT(RCC->CR, RCC_CR_HSEON);
|
|
8002f52: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8002f56: 681b ldr r3, [r3, #0]
|
|
8002f58: f04f 42b0 mov.w r2, #1476395008 @ 0x58000000
|
|
8002f5c: f423 3380 bic.w r3, r3, #65536 @ 0x10000
|
|
8002f60: 6013 str r3, [r2, #0]
|
|
}
|
|
8002f62: bf00 nop
|
|
8002f64: 46bd mov sp, r7
|
|
8002f66: bc80 pop {r7}
|
|
8002f68: 4770 bx lr
|
|
|
|
08002f6a <LL_RCC_HSE_IsReady>:
|
|
{
|
|
8002f6a: b480 push {r7}
|
|
8002f6c: af00 add r7, sp, #0
|
|
return ((READ_BIT(RCC->CR, RCC_CR_HSERDY) == (RCC_CR_HSERDY)) ? 1UL : 0UL);
|
|
8002f6e: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8002f72: 681b ldr r3, [r3, #0]
|
|
8002f74: f403 3300 and.w r3, r3, #131072 @ 0x20000
|
|
8002f78: f5b3 3f00 cmp.w r3, #131072 @ 0x20000
|
|
8002f7c: d101 bne.n 8002f82 <LL_RCC_HSE_IsReady+0x18>
|
|
8002f7e: 2301 movs r3, #1
|
|
8002f80: e000 b.n 8002f84 <LL_RCC_HSE_IsReady+0x1a>
|
|
8002f82: 2300 movs r3, #0
|
|
}
|
|
8002f84: 4618 mov r0, r3
|
|
8002f86: 46bd mov sp, r7
|
|
8002f88: bc80 pop {r7}
|
|
8002f8a: 4770 bx lr
|
|
|
|
08002f8c <LL_RCC_HSI_Enable>:
|
|
{
|
|
8002f8c: b480 push {r7}
|
|
8002f8e: af00 add r7, sp, #0
|
|
SET_BIT(RCC->CR, RCC_CR_HSION);
|
|
8002f90: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8002f94: 681b ldr r3, [r3, #0]
|
|
8002f96: f04f 42b0 mov.w r2, #1476395008 @ 0x58000000
|
|
8002f9a: f443 7380 orr.w r3, r3, #256 @ 0x100
|
|
8002f9e: 6013 str r3, [r2, #0]
|
|
}
|
|
8002fa0: bf00 nop
|
|
8002fa2: 46bd mov sp, r7
|
|
8002fa4: bc80 pop {r7}
|
|
8002fa6: 4770 bx lr
|
|
|
|
08002fa8 <LL_RCC_HSI_Disable>:
|
|
{
|
|
8002fa8: b480 push {r7}
|
|
8002faa: af00 add r7, sp, #0
|
|
CLEAR_BIT(RCC->CR, RCC_CR_HSION);
|
|
8002fac: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8002fb0: 681b ldr r3, [r3, #0]
|
|
8002fb2: f04f 42b0 mov.w r2, #1476395008 @ 0x58000000
|
|
8002fb6: f423 7380 bic.w r3, r3, #256 @ 0x100
|
|
8002fba: 6013 str r3, [r2, #0]
|
|
}
|
|
8002fbc: bf00 nop
|
|
8002fbe: 46bd mov sp, r7
|
|
8002fc0: bc80 pop {r7}
|
|
8002fc2: 4770 bx lr
|
|
|
|
08002fc4 <LL_RCC_HSI_IsReady>:
|
|
{
|
|
8002fc4: b480 push {r7}
|
|
8002fc6: af00 add r7, sp, #0
|
|
return ((READ_BIT(RCC->CR, RCC_CR_HSIRDY) == (RCC_CR_HSIRDY)) ? 1UL : 0UL);
|
|
8002fc8: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8002fcc: 681b ldr r3, [r3, #0]
|
|
8002fce: f403 6380 and.w r3, r3, #1024 @ 0x400
|
|
8002fd2: f5b3 6f80 cmp.w r3, #1024 @ 0x400
|
|
8002fd6: d101 bne.n 8002fdc <LL_RCC_HSI_IsReady+0x18>
|
|
8002fd8: 2301 movs r3, #1
|
|
8002fda: e000 b.n 8002fde <LL_RCC_HSI_IsReady+0x1a>
|
|
8002fdc: 2300 movs r3, #0
|
|
}
|
|
8002fde: 4618 mov r0, r3
|
|
8002fe0: 46bd mov sp, r7
|
|
8002fe2: bc80 pop {r7}
|
|
8002fe4: 4770 bx lr
|
|
|
|
08002fe6 <LL_RCC_HSI_SetCalibTrimming>:
|
|
{
|
|
8002fe6: b480 push {r7}
|
|
8002fe8: b083 sub sp, #12
|
|
8002fea: af00 add r7, sp, #0
|
|
8002fec: 6078 str r0, [r7, #4]
|
|
MODIFY_REG(RCC->ICSCR, RCC_ICSCR_HSITRIM, Value << RCC_ICSCR_HSITRIM_Pos);
|
|
8002fee: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8002ff2: 685b ldr r3, [r3, #4]
|
|
8002ff4: f023 42fe bic.w r2, r3, #2130706432 @ 0x7f000000
|
|
8002ff8: 687b ldr r3, [r7, #4]
|
|
8002ffa: 061b lsls r3, r3, #24
|
|
8002ffc: f04f 41b0 mov.w r1, #1476395008 @ 0x58000000
|
|
8003000: 4313 orrs r3, r2
|
|
8003002: 604b str r3, [r1, #4]
|
|
}
|
|
8003004: bf00 nop
|
|
8003006: 370c adds r7, #12
|
|
8003008: 46bd mov sp, r7
|
|
800300a: bc80 pop {r7}
|
|
800300c: 4770 bx lr
|
|
|
|
0800300e <LL_RCC_LSE_IsReady>:
|
|
{
|
|
800300e: b480 push {r7}
|
|
8003010: af00 add r7, sp, #0
|
|
return ((READ_BIT(RCC->BDCR, RCC_BDCR_LSERDY) == (RCC_BDCR_LSERDY)) ? 1UL : 0UL);
|
|
8003012: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8003016: f8d3 3090 ldr.w r3, [r3, #144] @ 0x90
|
|
800301a: f003 0302 and.w r3, r3, #2
|
|
800301e: 2b02 cmp r3, #2
|
|
8003020: d101 bne.n 8003026 <LL_RCC_LSE_IsReady+0x18>
|
|
8003022: 2301 movs r3, #1
|
|
8003024: e000 b.n 8003028 <LL_RCC_LSE_IsReady+0x1a>
|
|
8003026: 2300 movs r3, #0
|
|
}
|
|
8003028: 4618 mov r0, r3
|
|
800302a: 46bd mov sp, r7
|
|
800302c: bc80 pop {r7}
|
|
800302e: 4770 bx lr
|
|
|
|
08003030 <LL_RCC_LSI_Enable>:
|
|
{
|
|
8003030: b480 push {r7}
|
|
8003032: af00 add r7, sp, #0
|
|
SET_BIT(RCC->CSR, RCC_CSR_LSION);
|
|
8003034: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8003038: f8d3 3094 ldr.w r3, [r3, #148] @ 0x94
|
|
800303c: f04f 42b0 mov.w r2, #1476395008 @ 0x58000000
|
|
8003040: f043 0301 orr.w r3, r3, #1
|
|
8003044: f8c2 3094 str.w r3, [r2, #148] @ 0x94
|
|
}
|
|
8003048: bf00 nop
|
|
800304a: 46bd mov sp, r7
|
|
800304c: bc80 pop {r7}
|
|
800304e: 4770 bx lr
|
|
|
|
08003050 <LL_RCC_LSI_Disable>:
|
|
{
|
|
8003050: b480 push {r7}
|
|
8003052: af00 add r7, sp, #0
|
|
CLEAR_BIT(RCC->CSR, RCC_CSR_LSION);
|
|
8003054: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8003058: f8d3 3094 ldr.w r3, [r3, #148] @ 0x94
|
|
800305c: f04f 42b0 mov.w r2, #1476395008 @ 0x58000000
|
|
8003060: f023 0301 bic.w r3, r3, #1
|
|
8003064: f8c2 3094 str.w r3, [r2, #148] @ 0x94
|
|
}
|
|
8003068: bf00 nop
|
|
800306a: 46bd mov sp, r7
|
|
800306c: bc80 pop {r7}
|
|
800306e: 4770 bx lr
|
|
|
|
08003070 <LL_RCC_LSI_IsReady>:
|
|
{
|
|
8003070: b480 push {r7}
|
|
8003072: af00 add r7, sp, #0
|
|
return ((READ_BIT(RCC->CSR, RCC_CSR_LSIRDY) == (RCC_CSR_LSIRDY)) ? 1UL : 0UL);
|
|
8003074: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8003078: f8d3 3094 ldr.w r3, [r3, #148] @ 0x94
|
|
800307c: f003 0302 and.w r3, r3, #2
|
|
8003080: 2b02 cmp r3, #2
|
|
8003082: d101 bne.n 8003088 <LL_RCC_LSI_IsReady+0x18>
|
|
8003084: 2301 movs r3, #1
|
|
8003086: e000 b.n 800308a <LL_RCC_LSI_IsReady+0x1a>
|
|
8003088: 2300 movs r3, #0
|
|
}
|
|
800308a: 4618 mov r0, r3
|
|
800308c: 46bd mov sp, r7
|
|
800308e: bc80 pop {r7}
|
|
8003090: 4770 bx lr
|
|
|
|
08003092 <LL_RCC_MSI_Enable>:
|
|
{
|
|
8003092: b480 push {r7}
|
|
8003094: af00 add r7, sp, #0
|
|
SET_BIT(RCC->CR, RCC_CR_MSION);
|
|
8003096: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
800309a: 681b ldr r3, [r3, #0]
|
|
800309c: f04f 42b0 mov.w r2, #1476395008 @ 0x58000000
|
|
80030a0: f043 0301 orr.w r3, r3, #1
|
|
80030a4: 6013 str r3, [r2, #0]
|
|
}
|
|
80030a6: bf00 nop
|
|
80030a8: 46bd mov sp, r7
|
|
80030aa: bc80 pop {r7}
|
|
80030ac: 4770 bx lr
|
|
|
|
080030ae <LL_RCC_MSI_Disable>:
|
|
{
|
|
80030ae: b480 push {r7}
|
|
80030b0: af00 add r7, sp, #0
|
|
CLEAR_BIT(RCC->CR, RCC_CR_MSION);
|
|
80030b2: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
80030b6: 681b ldr r3, [r3, #0]
|
|
80030b8: f04f 42b0 mov.w r2, #1476395008 @ 0x58000000
|
|
80030bc: f023 0301 bic.w r3, r3, #1
|
|
80030c0: 6013 str r3, [r2, #0]
|
|
}
|
|
80030c2: bf00 nop
|
|
80030c4: 46bd mov sp, r7
|
|
80030c6: bc80 pop {r7}
|
|
80030c8: 4770 bx lr
|
|
|
|
080030ca <LL_RCC_MSI_IsReady>:
|
|
{
|
|
80030ca: b480 push {r7}
|
|
80030cc: af00 add r7, sp, #0
|
|
return ((READ_BIT(RCC->CR, RCC_CR_MSIRDY) == (RCC_CR_MSIRDY)) ? 1UL : 0UL);
|
|
80030ce: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
80030d2: 681b ldr r3, [r3, #0]
|
|
80030d4: f003 0302 and.w r3, r3, #2
|
|
80030d8: 2b02 cmp r3, #2
|
|
80030da: d101 bne.n 80030e0 <LL_RCC_MSI_IsReady+0x16>
|
|
80030dc: 2301 movs r3, #1
|
|
80030de: e000 b.n 80030e2 <LL_RCC_MSI_IsReady+0x18>
|
|
80030e0: 2300 movs r3, #0
|
|
}
|
|
80030e2: 4618 mov r0, r3
|
|
80030e4: 46bd mov sp, r7
|
|
80030e6: bc80 pop {r7}
|
|
80030e8: 4770 bx lr
|
|
|
|
080030ea <LL_RCC_MSI_IsEnabledRangeSelect>:
|
|
{
|
|
80030ea: b480 push {r7}
|
|
80030ec: af00 add r7, sp, #0
|
|
return ((READ_BIT(RCC->CR, RCC_CR_MSIRGSEL) == (RCC_CR_MSIRGSEL)) ? 1UL : 0UL);
|
|
80030ee: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
80030f2: 681b ldr r3, [r3, #0]
|
|
80030f4: f003 0308 and.w r3, r3, #8
|
|
80030f8: 2b08 cmp r3, #8
|
|
80030fa: d101 bne.n 8003100 <LL_RCC_MSI_IsEnabledRangeSelect+0x16>
|
|
80030fc: 2301 movs r3, #1
|
|
80030fe: e000 b.n 8003102 <LL_RCC_MSI_IsEnabledRangeSelect+0x18>
|
|
8003100: 2300 movs r3, #0
|
|
}
|
|
8003102: 4618 mov r0, r3
|
|
8003104: 46bd mov sp, r7
|
|
8003106: bc80 pop {r7}
|
|
8003108: 4770 bx lr
|
|
|
|
0800310a <LL_RCC_MSI_GetRange>:
|
|
{
|
|
800310a: b480 push {r7}
|
|
800310c: af00 add r7, sp, #0
|
|
return (uint32_t)(READ_BIT(RCC->CR, RCC_CR_MSIRANGE));
|
|
800310e: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8003112: 681b ldr r3, [r3, #0]
|
|
8003114: f003 03f0 and.w r3, r3, #240 @ 0xf0
|
|
}
|
|
8003118: 4618 mov r0, r3
|
|
800311a: 46bd mov sp, r7
|
|
800311c: bc80 pop {r7}
|
|
800311e: 4770 bx lr
|
|
|
|
08003120 <LL_RCC_MSI_GetRangeAfterStandby>:
|
|
{
|
|
8003120: b480 push {r7}
|
|
8003122: af00 add r7, sp, #0
|
|
return (uint32_t)(READ_BIT(RCC->CSR, RCC_CSR_MSISRANGE));
|
|
8003124: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8003128: f8d3 3094 ldr.w r3, [r3, #148] @ 0x94
|
|
800312c: f403 6370 and.w r3, r3, #3840 @ 0xf00
|
|
}
|
|
8003130: 4618 mov r0, r3
|
|
8003132: 46bd mov sp, r7
|
|
8003134: bc80 pop {r7}
|
|
8003136: 4770 bx lr
|
|
|
|
08003138 <LL_RCC_MSI_SetCalibTrimming>:
|
|
{
|
|
8003138: b480 push {r7}
|
|
800313a: b083 sub sp, #12
|
|
800313c: af00 add r7, sp, #0
|
|
800313e: 6078 str r0, [r7, #4]
|
|
MODIFY_REG(RCC->ICSCR, RCC_ICSCR_MSITRIM, Value << RCC_ICSCR_MSITRIM_Pos);
|
|
8003140: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8003144: 685b ldr r3, [r3, #4]
|
|
8003146: f423 427f bic.w r2, r3, #65280 @ 0xff00
|
|
800314a: 687b ldr r3, [r7, #4]
|
|
800314c: 021b lsls r3, r3, #8
|
|
800314e: f04f 41b0 mov.w r1, #1476395008 @ 0x58000000
|
|
8003152: 4313 orrs r3, r2
|
|
8003154: 604b str r3, [r1, #4]
|
|
}
|
|
8003156: bf00 nop
|
|
8003158: 370c adds r7, #12
|
|
800315a: 46bd mov sp, r7
|
|
800315c: bc80 pop {r7}
|
|
800315e: 4770 bx lr
|
|
|
|
08003160 <LL_RCC_SetSysClkSource>:
|
|
{
|
|
8003160: b480 push {r7}
|
|
8003162: b083 sub sp, #12
|
|
8003164: af00 add r7, sp, #0
|
|
8003166: 6078 str r0, [r7, #4]
|
|
MODIFY_REG(RCC->CFGR, RCC_CFGR_SW, Source);
|
|
8003168: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
800316c: 689b ldr r3, [r3, #8]
|
|
800316e: f023 0203 bic.w r2, r3, #3
|
|
8003172: f04f 41b0 mov.w r1, #1476395008 @ 0x58000000
|
|
8003176: 687b ldr r3, [r7, #4]
|
|
8003178: 4313 orrs r3, r2
|
|
800317a: 608b str r3, [r1, #8]
|
|
}
|
|
800317c: bf00 nop
|
|
800317e: 370c adds r7, #12
|
|
8003180: 46bd mov sp, r7
|
|
8003182: bc80 pop {r7}
|
|
8003184: 4770 bx lr
|
|
|
|
08003186 <LL_RCC_GetSysClkSource>:
|
|
{
|
|
8003186: b480 push {r7}
|
|
8003188: af00 add r7, sp, #0
|
|
return (uint32_t)(READ_BIT(RCC->CFGR, RCC_CFGR_SWS));
|
|
800318a: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
800318e: 689b ldr r3, [r3, #8]
|
|
8003190: f003 030c and.w r3, r3, #12
|
|
}
|
|
8003194: 4618 mov r0, r3
|
|
8003196: 46bd mov sp, r7
|
|
8003198: bc80 pop {r7}
|
|
800319a: 4770 bx lr
|
|
|
|
0800319c <LL_RCC_SetAHBPrescaler>:
|
|
{
|
|
800319c: b480 push {r7}
|
|
800319e: b083 sub sp, #12
|
|
80031a0: af00 add r7, sp, #0
|
|
80031a2: 6078 str r0, [r7, #4]
|
|
MODIFY_REG(RCC->CFGR, RCC_CFGR_HPRE, Prescaler);
|
|
80031a4: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
80031a8: 689b ldr r3, [r3, #8]
|
|
80031aa: f023 02f0 bic.w r2, r3, #240 @ 0xf0
|
|
80031ae: f04f 41b0 mov.w r1, #1476395008 @ 0x58000000
|
|
80031b2: 687b ldr r3, [r7, #4]
|
|
80031b4: 4313 orrs r3, r2
|
|
80031b6: 608b str r3, [r1, #8]
|
|
}
|
|
80031b8: bf00 nop
|
|
80031ba: 370c adds r7, #12
|
|
80031bc: 46bd mov sp, r7
|
|
80031be: bc80 pop {r7}
|
|
80031c0: 4770 bx lr
|
|
|
|
080031c2 <LL_C2_RCC_SetAHBPrescaler>:
|
|
{
|
|
80031c2: b480 push {r7}
|
|
80031c4: b083 sub sp, #12
|
|
80031c6: af00 add r7, sp, #0
|
|
80031c8: 6078 str r0, [r7, #4]
|
|
MODIFY_REG(RCC->EXTCFGR, RCC_EXTCFGR_C2HPRE, Prescaler);
|
|
80031ca: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
80031ce: f8d3 3108 ldr.w r3, [r3, #264] @ 0x108
|
|
80031d2: f023 02f0 bic.w r2, r3, #240 @ 0xf0
|
|
80031d6: f04f 41b0 mov.w r1, #1476395008 @ 0x58000000
|
|
80031da: 687b ldr r3, [r7, #4]
|
|
80031dc: 4313 orrs r3, r2
|
|
80031de: f8c1 3108 str.w r3, [r1, #264] @ 0x108
|
|
}
|
|
80031e2: bf00 nop
|
|
80031e4: 370c adds r7, #12
|
|
80031e6: 46bd mov sp, r7
|
|
80031e8: bc80 pop {r7}
|
|
80031ea: 4770 bx lr
|
|
|
|
080031ec <LL_RCC_SetAHB3Prescaler>:
|
|
{
|
|
80031ec: b480 push {r7}
|
|
80031ee: b083 sub sp, #12
|
|
80031f0: af00 add r7, sp, #0
|
|
80031f2: 6078 str r0, [r7, #4]
|
|
MODIFY_REG(RCC->EXTCFGR, RCC_EXTCFGR_SHDHPRE, Prescaler >> 4);
|
|
80031f4: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
80031f8: f8d3 3108 ldr.w r3, [r3, #264] @ 0x108
|
|
80031fc: f023 020f bic.w r2, r3, #15
|
|
8003200: 687b ldr r3, [r7, #4]
|
|
8003202: 091b lsrs r3, r3, #4
|
|
8003204: f04f 41b0 mov.w r1, #1476395008 @ 0x58000000
|
|
8003208: 4313 orrs r3, r2
|
|
800320a: f8c1 3108 str.w r3, [r1, #264] @ 0x108
|
|
}
|
|
800320e: bf00 nop
|
|
8003210: 370c adds r7, #12
|
|
8003212: 46bd mov sp, r7
|
|
8003214: bc80 pop {r7}
|
|
8003216: 4770 bx lr
|
|
|
|
08003218 <LL_RCC_SetAPB1Prescaler>:
|
|
{
|
|
8003218: b480 push {r7}
|
|
800321a: b083 sub sp, #12
|
|
800321c: af00 add r7, sp, #0
|
|
800321e: 6078 str r0, [r7, #4]
|
|
MODIFY_REG(RCC->CFGR, RCC_CFGR_PPRE1, Prescaler);
|
|
8003220: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8003224: 689b ldr r3, [r3, #8]
|
|
8003226: f423 62e0 bic.w r2, r3, #1792 @ 0x700
|
|
800322a: f04f 41b0 mov.w r1, #1476395008 @ 0x58000000
|
|
800322e: 687b ldr r3, [r7, #4]
|
|
8003230: 4313 orrs r3, r2
|
|
8003232: 608b str r3, [r1, #8]
|
|
}
|
|
8003234: bf00 nop
|
|
8003236: 370c adds r7, #12
|
|
8003238: 46bd mov sp, r7
|
|
800323a: bc80 pop {r7}
|
|
800323c: 4770 bx lr
|
|
|
|
0800323e <LL_RCC_SetAPB2Prescaler>:
|
|
{
|
|
800323e: b480 push {r7}
|
|
8003240: b083 sub sp, #12
|
|
8003242: af00 add r7, sp, #0
|
|
8003244: 6078 str r0, [r7, #4]
|
|
MODIFY_REG(RCC->CFGR, RCC_CFGR_PPRE2, Prescaler);
|
|
8003246: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
800324a: 689b ldr r3, [r3, #8]
|
|
800324c: f423 5260 bic.w r2, r3, #14336 @ 0x3800
|
|
8003250: f04f 41b0 mov.w r1, #1476395008 @ 0x58000000
|
|
8003254: 687b ldr r3, [r7, #4]
|
|
8003256: 4313 orrs r3, r2
|
|
8003258: 608b str r3, [r1, #8]
|
|
}
|
|
800325a: bf00 nop
|
|
800325c: 370c adds r7, #12
|
|
800325e: 46bd mov sp, r7
|
|
8003260: bc80 pop {r7}
|
|
8003262: 4770 bx lr
|
|
|
|
08003264 <LL_RCC_GetAHBPrescaler>:
|
|
{
|
|
8003264: b480 push {r7}
|
|
8003266: af00 add r7, sp, #0
|
|
return (uint32_t)(READ_BIT(RCC->CFGR, RCC_CFGR_HPRE));
|
|
8003268: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
800326c: 689b ldr r3, [r3, #8]
|
|
800326e: f003 03f0 and.w r3, r3, #240 @ 0xf0
|
|
}
|
|
8003272: 4618 mov r0, r3
|
|
8003274: 46bd mov sp, r7
|
|
8003276: bc80 pop {r7}
|
|
8003278: 4770 bx lr
|
|
|
|
0800327a <LL_RCC_GetAHB3Prescaler>:
|
|
{
|
|
800327a: b480 push {r7}
|
|
800327c: af00 add r7, sp, #0
|
|
return (uint32_t)(READ_BIT(RCC->EXTCFGR, RCC_EXTCFGR_SHDHPRE) << 4);
|
|
800327e: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8003282: f8d3 3108 ldr.w r3, [r3, #264] @ 0x108
|
|
8003286: 011b lsls r3, r3, #4
|
|
8003288: f003 03f0 and.w r3, r3, #240 @ 0xf0
|
|
}
|
|
800328c: 4618 mov r0, r3
|
|
800328e: 46bd mov sp, r7
|
|
8003290: bc80 pop {r7}
|
|
8003292: 4770 bx lr
|
|
|
|
08003294 <LL_RCC_GetAPB1Prescaler>:
|
|
{
|
|
8003294: b480 push {r7}
|
|
8003296: af00 add r7, sp, #0
|
|
return (uint32_t)(READ_BIT(RCC->CFGR, RCC_CFGR_PPRE1));
|
|
8003298: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
800329c: 689b ldr r3, [r3, #8]
|
|
800329e: f403 63e0 and.w r3, r3, #1792 @ 0x700
|
|
}
|
|
80032a2: 4618 mov r0, r3
|
|
80032a4: 46bd mov sp, r7
|
|
80032a6: bc80 pop {r7}
|
|
80032a8: 4770 bx lr
|
|
|
|
080032aa <LL_RCC_GetAPB2Prescaler>:
|
|
{
|
|
80032aa: b480 push {r7}
|
|
80032ac: af00 add r7, sp, #0
|
|
return (uint32_t)(READ_BIT(RCC->CFGR, RCC_CFGR_PPRE2));
|
|
80032ae: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
80032b2: 689b ldr r3, [r3, #8]
|
|
80032b4: f403 5360 and.w r3, r3, #14336 @ 0x3800
|
|
}
|
|
80032b8: 4618 mov r0, r3
|
|
80032ba: 46bd mov sp, r7
|
|
80032bc: bc80 pop {r7}
|
|
80032be: 4770 bx lr
|
|
|
|
080032c0 <LL_RCC_PLL_Enable>:
|
|
* @brief Enable PLL
|
|
* @rmtoll CR PLLON LL_RCC_PLL_Enable
|
|
* @retval None
|
|
*/
|
|
__STATIC_INLINE void LL_RCC_PLL_Enable(void)
|
|
{
|
|
80032c0: b480 push {r7}
|
|
80032c2: af00 add r7, sp, #0
|
|
SET_BIT(RCC->CR, RCC_CR_PLLON);
|
|
80032c4: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
80032c8: 681b ldr r3, [r3, #0]
|
|
80032ca: f04f 42b0 mov.w r2, #1476395008 @ 0x58000000
|
|
80032ce: f043 7380 orr.w r3, r3, #16777216 @ 0x1000000
|
|
80032d2: 6013 str r3, [r2, #0]
|
|
}
|
|
80032d4: bf00 nop
|
|
80032d6: 46bd mov sp, r7
|
|
80032d8: bc80 pop {r7}
|
|
80032da: 4770 bx lr
|
|
|
|
080032dc <LL_RCC_PLL_Disable>:
|
|
* @note Cannot be disabled if the PLL clock is used as the system clock
|
|
* @rmtoll CR PLLON LL_RCC_PLL_Disable
|
|
* @retval None
|
|
*/
|
|
__STATIC_INLINE void LL_RCC_PLL_Disable(void)
|
|
{
|
|
80032dc: b480 push {r7}
|
|
80032de: af00 add r7, sp, #0
|
|
CLEAR_BIT(RCC->CR, RCC_CR_PLLON);
|
|
80032e0: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
80032e4: 681b ldr r3, [r3, #0]
|
|
80032e6: f04f 42b0 mov.w r2, #1476395008 @ 0x58000000
|
|
80032ea: f023 7380 bic.w r3, r3, #16777216 @ 0x1000000
|
|
80032ee: 6013 str r3, [r2, #0]
|
|
}
|
|
80032f0: bf00 nop
|
|
80032f2: 46bd mov sp, r7
|
|
80032f4: bc80 pop {r7}
|
|
80032f6: 4770 bx lr
|
|
|
|
080032f8 <LL_RCC_PLL_IsReady>:
|
|
* @brief Check if PLL Ready
|
|
* @rmtoll CR PLLRDY LL_RCC_PLL_IsReady
|
|
* @retval State of bit (1 or 0).
|
|
*/
|
|
__STATIC_INLINE uint32_t LL_RCC_PLL_IsReady(void)
|
|
{
|
|
80032f8: b480 push {r7}
|
|
80032fa: af00 add r7, sp, #0
|
|
return ((READ_BIT(RCC->CR, RCC_CR_PLLRDY) == (RCC_CR_PLLRDY)) ? 1UL : 0UL);
|
|
80032fc: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8003300: 681b ldr r3, [r3, #0]
|
|
8003302: f003 7300 and.w r3, r3, #33554432 @ 0x2000000
|
|
8003306: f1b3 7f00 cmp.w r3, #33554432 @ 0x2000000
|
|
800330a: d101 bne.n 8003310 <LL_RCC_PLL_IsReady+0x18>
|
|
800330c: 2301 movs r3, #1
|
|
800330e: e000 b.n 8003312 <LL_RCC_PLL_IsReady+0x1a>
|
|
8003310: 2300 movs r3, #0
|
|
}
|
|
8003312: 4618 mov r0, r3
|
|
8003314: 46bd mov sp, r7
|
|
8003316: bc80 pop {r7}
|
|
8003318: 4770 bx lr
|
|
|
|
0800331a <LL_RCC_PLL_GetN>:
|
|
* @brief Get Main PLL multiplication factor for VCO
|
|
* @rmtoll PLLCFGR PLLN LL_RCC_PLL_GetN
|
|
* @retval Between 6 and 127
|
|
*/
|
|
__STATIC_INLINE uint32_t LL_RCC_PLL_GetN(void)
|
|
{
|
|
800331a: b480 push {r7}
|
|
800331c: af00 add r7, sp, #0
|
|
return (uint32_t)(READ_BIT(RCC->PLLCFGR, RCC_PLLCFGR_PLLN) >> RCC_PLLCFGR_PLLN_Pos);
|
|
800331e: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8003322: 68db ldr r3, [r3, #12]
|
|
8003324: 0a1b lsrs r3, r3, #8
|
|
8003326: f003 037f and.w r3, r3, #127 @ 0x7f
|
|
}
|
|
800332a: 4618 mov r0, r3
|
|
800332c: 46bd mov sp, r7
|
|
800332e: bc80 pop {r7}
|
|
8003330: 4770 bx lr
|
|
|
|
08003332 <LL_RCC_PLL_GetR>:
|
|
* @arg @ref LL_RCC_PLLR_DIV_6
|
|
* @arg @ref LL_RCC_PLLR_DIV_7
|
|
* @arg @ref LL_RCC_PLLR_DIV_8
|
|
*/
|
|
__STATIC_INLINE uint32_t LL_RCC_PLL_GetR(void)
|
|
{
|
|
8003332: b480 push {r7}
|
|
8003334: af00 add r7, sp, #0
|
|
return (uint32_t)(READ_BIT(RCC->PLLCFGR, RCC_PLLCFGR_PLLR));
|
|
8003336: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
800333a: 68db ldr r3, [r3, #12]
|
|
800333c: f003 4360 and.w r3, r3, #3758096384 @ 0xe0000000
|
|
}
|
|
8003340: 4618 mov r0, r3
|
|
8003342: 46bd mov sp, r7
|
|
8003344: bc80 pop {r7}
|
|
8003346: 4770 bx lr
|
|
|
|
08003348 <LL_RCC_PLL_GetDivider>:
|
|
* @arg @ref LL_RCC_PLLM_DIV_6
|
|
* @arg @ref LL_RCC_PLLM_DIV_7
|
|
* @arg @ref LL_RCC_PLLM_DIV_8
|
|
*/
|
|
__STATIC_INLINE uint32_t LL_RCC_PLL_GetDivider(void)
|
|
{
|
|
8003348: b480 push {r7}
|
|
800334a: af00 add r7, sp, #0
|
|
return (uint32_t)(READ_BIT(RCC->PLLCFGR, RCC_PLLCFGR_PLLM));
|
|
800334c: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8003350: 68db ldr r3, [r3, #12]
|
|
8003352: f003 0370 and.w r3, r3, #112 @ 0x70
|
|
}
|
|
8003356: 4618 mov r0, r3
|
|
8003358: 46bd mov sp, r7
|
|
800335a: bc80 pop {r7}
|
|
800335c: 4770 bx lr
|
|
|
|
0800335e <LL_RCC_PLL_GetMainSource>:
|
|
* @arg @ref LL_RCC_PLLSOURCE_MSI
|
|
* @arg @ref LL_RCC_PLLSOURCE_HSI
|
|
* @arg @ref LL_RCC_PLLSOURCE_HSE
|
|
*/
|
|
__STATIC_INLINE uint32_t LL_RCC_PLL_GetMainSource(void)
|
|
{
|
|
800335e: b480 push {r7}
|
|
8003360: af00 add r7, sp, #0
|
|
return (uint32_t)(READ_BIT(RCC->PLLCFGR, RCC_PLLCFGR_PLLSRC));
|
|
8003362: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8003366: 68db ldr r3, [r3, #12]
|
|
8003368: f003 0303 and.w r3, r3, #3
|
|
}
|
|
800336c: 4618 mov r0, r3
|
|
800336e: 46bd mov sp, r7
|
|
8003370: bc80 pop {r7}
|
|
8003372: 4770 bx lr
|
|
|
|
08003374 <LL_RCC_IsActiveFlag_HPRE>:
|
|
* @brief Check if HCLK1 prescaler flag value has been applied or not
|
|
* @rmtoll CFGR HPREF LL_RCC_IsActiveFlag_HPRE
|
|
* @retval State of bit (1 or 0).
|
|
*/
|
|
__STATIC_INLINE uint32_t LL_RCC_IsActiveFlag_HPRE(void)
|
|
{
|
|
8003374: b480 push {r7}
|
|
8003376: af00 add r7, sp, #0
|
|
return ((READ_BIT(RCC->CFGR, RCC_CFGR_HPREF) == (RCC_CFGR_HPREF)) ? 1UL : 0UL);
|
|
8003378: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
800337c: 689b ldr r3, [r3, #8]
|
|
800337e: f403 3380 and.w r3, r3, #65536 @ 0x10000
|
|
8003382: f5b3 3f80 cmp.w r3, #65536 @ 0x10000
|
|
8003386: d101 bne.n 800338c <LL_RCC_IsActiveFlag_HPRE+0x18>
|
|
8003388: 2301 movs r3, #1
|
|
800338a: e000 b.n 800338e <LL_RCC_IsActiveFlag_HPRE+0x1a>
|
|
800338c: 2300 movs r3, #0
|
|
}
|
|
800338e: 4618 mov r0, r3
|
|
8003390: 46bd mov sp, r7
|
|
8003392: bc80 pop {r7}
|
|
8003394: 4770 bx lr
|
|
|
|
08003396 <LL_RCC_IsActiveFlag_C2HPRE>:
|
|
* @brief Check if HCLK2 prescaler flag value has been applied or not
|
|
* @rmtoll EXTCFGR C2HPREF LL_RCC_IsActiveFlag_C2HPRE
|
|
* @retval State of bit (1 or 0).
|
|
*/
|
|
__STATIC_INLINE uint32_t LL_RCC_IsActiveFlag_C2HPRE(void)
|
|
{
|
|
8003396: b480 push {r7}
|
|
8003398: af00 add r7, sp, #0
|
|
return ((READ_BIT(RCC->EXTCFGR, RCC_EXTCFGR_C2HPREF) == (RCC_EXTCFGR_C2HPREF)) ? 1UL : 0UL);
|
|
800339a: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
800339e: f8d3 3108 ldr.w r3, [r3, #264] @ 0x108
|
|
80033a2: f403 3300 and.w r3, r3, #131072 @ 0x20000
|
|
80033a6: f5b3 3f00 cmp.w r3, #131072 @ 0x20000
|
|
80033aa: d101 bne.n 80033b0 <LL_RCC_IsActiveFlag_C2HPRE+0x1a>
|
|
80033ac: 2301 movs r3, #1
|
|
80033ae: e000 b.n 80033b2 <LL_RCC_IsActiveFlag_C2HPRE+0x1c>
|
|
80033b0: 2300 movs r3, #0
|
|
}
|
|
80033b2: 4618 mov r0, r3
|
|
80033b4: 46bd mov sp, r7
|
|
80033b6: bc80 pop {r7}
|
|
80033b8: 4770 bx lr
|
|
|
|
080033ba <LL_RCC_IsActiveFlag_SHDHPRE>:
|
|
* @brief Check if HCLK3 prescaler flag value has been applied or not
|
|
* @rmtoll EXTCFGR SHDHPREF LL_RCC_IsActiveFlag_SHDHPRE
|
|
* @retval State of bit (1 or 0).
|
|
*/
|
|
__STATIC_INLINE uint32_t LL_RCC_IsActiveFlag_SHDHPRE(void)
|
|
{
|
|
80033ba: b480 push {r7}
|
|
80033bc: af00 add r7, sp, #0
|
|
return ((READ_BIT(RCC->EXTCFGR, RCC_EXTCFGR_SHDHPREF) == (RCC_EXTCFGR_SHDHPREF)) ? 1UL : 0UL);
|
|
80033be: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
80033c2: f8d3 3108 ldr.w r3, [r3, #264] @ 0x108
|
|
80033c6: f403 3380 and.w r3, r3, #65536 @ 0x10000
|
|
80033ca: f5b3 3f80 cmp.w r3, #65536 @ 0x10000
|
|
80033ce: d101 bne.n 80033d4 <LL_RCC_IsActiveFlag_SHDHPRE+0x1a>
|
|
80033d0: 2301 movs r3, #1
|
|
80033d2: e000 b.n 80033d6 <LL_RCC_IsActiveFlag_SHDHPRE+0x1c>
|
|
80033d4: 2300 movs r3, #0
|
|
}
|
|
80033d6: 4618 mov r0, r3
|
|
80033d8: 46bd mov sp, r7
|
|
80033da: bc80 pop {r7}
|
|
80033dc: 4770 bx lr
|
|
|
|
080033de <LL_RCC_IsActiveFlag_PPRE1>:
|
|
* @brief Check if PLCK1 prescaler flag value has been applied or not
|
|
* @rmtoll CFGR PPRE1F LL_RCC_IsActiveFlag_PPRE1
|
|
* @retval State of bit (1 or 0).
|
|
*/
|
|
__STATIC_INLINE uint32_t LL_RCC_IsActiveFlag_PPRE1(void)
|
|
{
|
|
80033de: b480 push {r7}
|
|
80033e0: af00 add r7, sp, #0
|
|
return ((READ_BIT(RCC->CFGR, RCC_CFGR_PPRE1F) == (RCC_CFGR_PPRE1F)) ? 1UL : 0UL);
|
|
80033e2: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
80033e6: 689b ldr r3, [r3, #8]
|
|
80033e8: f403 3300 and.w r3, r3, #131072 @ 0x20000
|
|
80033ec: f5b3 3f00 cmp.w r3, #131072 @ 0x20000
|
|
80033f0: d101 bne.n 80033f6 <LL_RCC_IsActiveFlag_PPRE1+0x18>
|
|
80033f2: 2301 movs r3, #1
|
|
80033f4: e000 b.n 80033f8 <LL_RCC_IsActiveFlag_PPRE1+0x1a>
|
|
80033f6: 2300 movs r3, #0
|
|
}
|
|
80033f8: 4618 mov r0, r3
|
|
80033fa: 46bd mov sp, r7
|
|
80033fc: bc80 pop {r7}
|
|
80033fe: 4770 bx lr
|
|
|
|
08003400 <LL_RCC_IsActiveFlag_PPRE2>:
|
|
* @brief Check if PLCK2 prescaler flag value has been applied or not
|
|
* @rmtoll CFGR PPRE2F LL_RCC_IsActiveFlag_PPRE2
|
|
* @retval State of bit (1 or 0).
|
|
*/
|
|
__STATIC_INLINE uint32_t LL_RCC_IsActiveFlag_PPRE2(void)
|
|
{
|
|
8003400: b480 push {r7}
|
|
8003402: af00 add r7, sp, #0
|
|
return ((READ_BIT(RCC->CFGR, RCC_CFGR_PPRE2F) == (RCC_CFGR_PPRE2F)) ? 1UL : 0UL);
|
|
8003404: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8003408: 689b ldr r3, [r3, #8]
|
|
800340a: f403 2380 and.w r3, r3, #262144 @ 0x40000
|
|
800340e: f5b3 2f80 cmp.w r3, #262144 @ 0x40000
|
|
8003412: d101 bne.n 8003418 <LL_RCC_IsActiveFlag_PPRE2+0x18>
|
|
8003414: 2301 movs r3, #1
|
|
8003416: e000 b.n 800341a <LL_RCC_IsActiveFlag_PPRE2+0x1a>
|
|
8003418: 2300 movs r3, #0
|
|
}
|
|
800341a: 4618 mov r0, r3
|
|
800341c: 46bd mov sp, r7
|
|
800341e: bc80 pop {r7}
|
|
8003420: 4770 bx lr
|
|
...
|
|
|
|
08003424 <HAL_RCC_OscConfig>:
|
|
* contains the configuration information for the RCC Oscillators.
|
|
* @note The PLL is not disabled when used as system clock.
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_RCC_OscConfig(RCC_OscInitTypeDef *RCC_OscInitStruct)
|
|
{
|
|
8003424: b580 push {r7, lr}
|
|
8003426: b088 sub sp, #32
|
|
8003428: af00 add r7, sp, #0
|
|
800342a: 6078 str r0, [r7, #4]
|
|
uint32_t sysclk_source;
|
|
uint32_t pll_config;
|
|
HAL_StatusTypeDef status;
|
|
|
|
/* Check Null pointer */
|
|
if (RCC_OscInitStruct == NULL)
|
|
800342c: 687b ldr r3, [r7, #4]
|
|
800342e: 2b00 cmp r3, #0
|
|
8003430: d101 bne.n 8003436 <HAL_RCC_OscConfig+0x12>
|
|
{
|
|
return HAL_ERROR;
|
|
8003432: 2301 movs r3, #1
|
|
8003434: e36f b.n 8003b16 <HAL_RCC_OscConfig+0x6f2>
|
|
}
|
|
|
|
/* Check the parameters */
|
|
assert_param(IS_RCC_OSCILLATORTYPE(RCC_OscInitStruct->OscillatorType));
|
|
|
|
sysclk_source = __HAL_RCC_GET_SYSCLK_SOURCE();
|
|
8003436: f7ff fea6 bl 8003186 <LL_RCC_GetSysClkSource>
|
|
800343a: 61f8 str r0, [r7, #28]
|
|
pll_config = __HAL_RCC_GET_PLL_OSCSOURCE();
|
|
800343c: f7ff ff8f bl 800335e <LL_RCC_PLL_GetMainSource>
|
|
8003440: 61b8 str r0, [r7, #24]
|
|
|
|
/*----------------------------- MSI Configuration --------------------------*/
|
|
if (((RCC_OscInitStruct->OscillatorType) & RCC_OSCILLATORTYPE_MSI) == RCC_OSCILLATORTYPE_MSI)
|
|
8003442: 687b ldr r3, [r7, #4]
|
|
8003444: 681b ldr r3, [r3, #0]
|
|
8003446: f003 0320 and.w r3, r3, #32
|
|
800344a: 2b00 cmp r3, #0
|
|
800344c: f000 80c4 beq.w 80035d8 <HAL_RCC_OscConfig+0x1b4>
|
|
assert_param(IS_RCC_MSI(RCC_OscInitStruct->MSIState));
|
|
assert_param(IS_RCC_MSI_CALIBRATION_VALUE(RCC_OscInitStruct->MSICalibrationValue));
|
|
assert_param(IS_RCC_MSI_CLOCK_RANGE(RCC_OscInitStruct->MSIClockRange));
|
|
|
|
/* When the MSI is used as system clock it will not be disabled */
|
|
if ((sysclk_source == RCC_SYSCLKSOURCE_STATUS_MSI) ||
|
|
8003450: 69fb ldr r3, [r7, #28]
|
|
8003452: 2b00 cmp r3, #0
|
|
8003454: d005 beq.n 8003462 <HAL_RCC_OscConfig+0x3e>
|
|
8003456: 69fb ldr r3, [r7, #28]
|
|
8003458: 2b0c cmp r3, #12
|
|
800345a: d176 bne.n 800354a <HAL_RCC_OscConfig+0x126>
|
|
((sysclk_source == RCC_SYSCLKSOURCE_STATUS_PLLCLK) && (pll_config == RCC_PLLSOURCE_MSI)))
|
|
800345c: 69bb ldr r3, [r7, #24]
|
|
800345e: 2b01 cmp r3, #1
|
|
8003460: d173 bne.n 800354a <HAL_RCC_OscConfig+0x126>
|
|
{
|
|
if (RCC_OscInitStruct->MSIState == RCC_MSI_OFF)
|
|
8003462: 687b ldr r3, [r7, #4]
|
|
8003464: 6a1b ldr r3, [r3, #32]
|
|
8003466: 2b00 cmp r3, #0
|
|
8003468: d101 bne.n 800346e <HAL_RCC_OscConfig+0x4a>
|
|
{
|
|
return HAL_ERROR;
|
|
800346a: 2301 movs r3, #1
|
|
800346c: e353 b.n 8003b16 <HAL_RCC_OscConfig+0x6f2>
|
|
else
|
|
{
|
|
/* To correctly read data from FLASH memory, the number of wait states (LATENCY)
|
|
must be correctly programmed according to the frequency of the AHB3 clock
|
|
and the supply voltage of the device. */
|
|
if (RCC_OscInitStruct->MSIClockRange > __HAL_RCC_GET_MSI_RANGE())
|
|
800346e: 687b ldr r3, [r7, #4]
|
|
8003470: 6a9a ldr r2, [r3, #40] @ 0x28
|
|
8003472: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8003476: 681b ldr r3, [r3, #0]
|
|
8003478: f003 0308 and.w r3, r3, #8
|
|
800347c: 2b00 cmp r3, #0
|
|
800347e: d005 beq.n 800348c <HAL_RCC_OscConfig+0x68>
|
|
8003480: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8003484: 681b ldr r3, [r3, #0]
|
|
8003486: f003 03f0 and.w r3, r3, #240 @ 0xf0
|
|
800348a: e006 b.n 800349a <HAL_RCC_OscConfig+0x76>
|
|
800348c: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8003490: f8d3 3094 ldr.w r3, [r3, #148] @ 0x94
|
|
8003494: 091b lsrs r3, r3, #4
|
|
8003496: f003 03f0 and.w r3, r3, #240 @ 0xf0
|
|
800349a: 4293 cmp r3, r2
|
|
800349c: d222 bcs.n 80034e4 <HAL_RCC_OscConfig+0xc0>
|
|
{
|
|
/* First increase number of wait states update if necessary */
|
|
if (RCC_SetFlashLatencyFromMSIRange(RCC_OscInitStruct->MSIClockRange) != HAL_OK)
|
|
800349e: 687b ldr r3, [r7, #4]
|
|
80034a0: 6a9b ldr r3, [r3, #40] @ 0x28
|
|
80034a2: 4618 mov r0, r3
|
|
80034a4: f000 fd5a bl 8003f5c <RCC_SetFlashLatencyFromMSIRange>
|
|
80034a8: 4603 mov r3, r0
|
|
80034aa: 2b00 cmp r3, #0
|
|
80034ac: d001 beq.n 80034b2 <HAL_RCC_OscConfig+0x8e>
|
|
{
|
|
return HAL_ERROR;
|
|
80034ae: 2301 movs r3, #1
|
|
80034b0: e331 b.n 8003b16 <HAL_RCC_OscConfig+0x6f2>
|
|
}
|
|
|
|
/* Selects the Multiple Speed oscillator (MSI) clock range .*/
|
|
__HAL_RCC_MSI_RANGE_CONFIG(RCC_OscInitStruct->MSIClockRange);
|
|
80034b2: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
80034b6: 681b ldr r3, [r3, #0]
|
|
80034b8: f04f 42b0 mov.w r2, #1476395008 @ 0x58000000
|
|
80034bc: f043 0308 orr.w r3, r3, #8
|
|
80034c0: 6013 str r3, [r2, #0]
|
|
80034c2: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
80034c6: 681b ldr r3, [r3, #0]
|
|
80034c8: f023 02f0 bic.w r2, r3, #240 @ 0xf0
|
|
80034cc: 687b ldr r3, [r7, #4]
|
|
80034ce: 6a9b ldr r3, [r3, #40] @ 0x28
|
|
80034d0: f04f 41b0 mov.w r1, #1476395008 @ 0x58000000
|
|
80034d4: 4313 orrs r3, r2
|
|
80034d6: 600b str r3, [r1, #0]
|
|
/* Adjusts the Multiple Speed oscillator (MSI) calibration value.*/
|
|
__HAL_RCC_MSI_CALIBRATIONVALUE_ADJUST(RCC_OscInitStruct->MSICalibrationValue);
|
|
80034d8: 687b ldr r3, [r7, #4]
|
|
80034da: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
80034dc: 4618 mov r0, r3
|
|
80034de: f7ff fe2b bl 8003138 <LL_RCC_MSI_SetCalibTrimming>
|
|
80034e2: e021 b.n 8003528 <HAL_RCC_OscConfig+0x104>
|
|
}
|
|
else
|
|
{
|
|
/* Else, keep current flash latency while decreasing applies */
|
|
/* Selects the Multiple Speed oscillator (MSI) clock range. */
|
|
__HAL_RCC_MSI_RANGE_CONFIG(RCC_OscInitStruct->MSIClockRange);
|
|
80034e4: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
80034e8: 681b ldr r3, [r3, #0]
|
|
80034ea: f04f 42b0 mov.w r2, #1476395008 @ 0x58000000
|
|
80034ee: f043 0308 orr.w r3, r3, #8
|
|
80034f2: 6013 str r3, [r2, #0]
|
|
80034f4: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
80034f8: 681b ldr r3, [r3, #0]
|
|
80034fa: f023 02f0 bic.w r2, r3, #240 @ 0xf0
|
|
80034fe: 687b ldr r3, [r7, #4]
|
|
8003500: 6a9b ldr r3, [r3, #40] @ 0x28
|
|
8003502: f04f 41b0 mov.w r1, #1476395008 @ 0x58000000
|
|
8003506: 4313 orrs r3, r2
|
|
8003508: 600b str r3, [r1, #0]
|
|
/* Adjusts the Multiple Speed oscillator (MSI) calibration value.*/
|
|
__HAL_RCC_MSI_CALIBRATIONVALUE_ADJUST(RCC_OscInitStruct->MSICalibrationValue);
|
|
800350a: 687b ldr r3, [r7, #4]
|
|
800350c: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
800350e: 4618 mov r0, r3
|
|
8003510: f7ff fe12 bl 8003138 <LL_RCC_MSI_SetCalibTrimming>
|
|
|
|
/* Decrease number of wait states update if necessary */
|
|
if (RCC_SetFlashLatencyFromMSIRange(RCC_OscInitStruct->MSIClockRange) != HAL_OK)
|
|
8003514: 687b ldr r3, [r7, #4]
|
|
8003516: 6a9b ldr r3, [r3, #40] @ 0x28
|
|
8003518: 4618 mov r0, r3
|
|
800351a: f000 fd1f bl 8003f5c <RCC_SetFlashLatencyFromMSIRange>
|
|
800351e: 4603 mov r3, r0
|
|
8003520: 2b00 cmp r3, #0
|
|
8003522: d001 beq.n 8003528 <HAL_RCC_OscConfig+0x104>
|
|
{
|
|
return HAL_ERROR;
|
|
8003524: 2301 movs r3, #1
|
|
8003526: e2f6 b.n 8003b16 <HAL_RCC_OscConfig+0x6f2>
|
|
}
|
|
}
|
|
|
|
/* Update the SystemCoreClock global variable */
|
|
SystemCoreClock = HAL_RCC_GetHCLKFreq();
|
|
8003528: f000 fce0 bl 8003eec <HAL_RCC_GetHCLKFreq>
|
|
800352c: 4603 mov r3, r0
|
|
800352e: 4aa7 ldr r2, [pc, #668] @ (80037cc <HAL_RCC_OscConfig+0x3a8>)
|
|
8003530: 6013 str r3, [r2, #0]
|
|
|
|
/* Configure the source of time base considering new system clocks settings */
|
|
status = HAL_InitTick(uwTickPrio);
|
|
8003532: 4ba7 ldr r3, [pc, #668] @ (80037d0 <HAL_RCC_OscConfig+0x3ac>)
|
|
8003534: 681b ldr r3, [r3, #0]
|
|
8003536: 4618 mov r0, r3
|
|
8003538: f7fd fb7c bl 8000c34 <HAL_InitTick>
|
|
800353c: 4603 mov r3, r0
|
|
800353e: 74fb strb r3, [r7, #19]
|
|
if (status != HAL_OK)
|
|
8003540: 7cfb ldrb r3, [r7, #19]
|
|
8003542: 2b00 cmp r3, #0
|
|
8003544: d047 beq.n 80035d6 <HAL_RCC_OscConfig+0x1b2>
|
|
{
|
|
return status;
|
|
8003546: 7cfb ldrb r3, [r7, #19]
|
|
8003548: e2e5 b.n 8003b16 <HAL_RCC_OscConfig+0x6f2>
|
|
}
|
|
}
|
|
else
|
|
{
|
|
/* Check the MSI State */
|
|
if (RCC_OscInitStruct->MSIState != RCC_MSI_OFF)
|
|
800354a: 687b ldr r3, [r7, #4]
|
|
800354c: 6a1b ldr r3, [r3, #32]
|
|
800354e: 2b00 cmp r3, #0
|
|
8003550: d02c beq.n 80035ac <HAL_RCC_OscConfig+0x188>
|
|
{
|
|
/* Enable the Internal High Speed oscillator (MSI). */
|
|
__HAL_RCC_MSI_ENABLE();
|
|
8003552: f7ff fd9e bl 8003092 <LL_RCC_MSI_Enable>
|
|
|
|
/* Get timeout */
|
|
tickstart = HAL_GetTick();
|
|
8003556: f7fd fb77 bl 8000c48 <HAL_GetTick>
|
|
800355a: 6178 str r0, [r7, #20]
|
|
|
|
/* Wait till MSI is ready */
|
|
while (LL_RCC_MSI_IsReady() == 0U)
|
|
800355c: e008 b.n 8003570 <HAL_RCC_OscConfig+0x14c>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > MSI_TIMEOUT_VALUE)
|
|
800355e: f7fd fb73 bl 8000c48 <HAL_GetTick>
|
|
8003562: 4602 mov r2, r0
|
|
8003564: 697b ldr r3, [r7, #20]
|
|
8003566: 1ad3 subs r3, r2, r3
|
|
8003568: 2b02 cmp r3, #2
|
|
800356a: d901 bls.n 8003570 <HAL_RCC_OscConfig+0x14c>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
800356c: 2303 movs r3, #3
|
|
800356e: e2d2 b.n 8003b16 <HAL_RCC_OscConfig+0x6f2>
|
|
while (LL_RCC_MSI_IsReady() == 0U)
|
|
8003570: f7ff fdab bl 80030ca <LL_RCC_MSI_IsReady>
|
|
8003574: 4603 mov r3, r0
|
|
8003576: 2b00 cmp r3, #0
|
|
8003578: d0f1 beq.n 800355e <HAL_RCC_OscConfig+0x13a>
|
|
}
|
|
}
|
|
|
|
/* Selects the Multiple Speed oscillator (MSI) clock range. */
|
|
__HAL_RCC_MSI_RANGE_CONFIG(RCC_OscInitStruct->MSIClockRange);
|
|
800357a: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
800357e: 681b ldr r3, [r3, #0]
|
|
8003580: f04f 42b0 mov.w r2, #1476395008 @ 0x58000000
|
|
8003584: f043 0308 orr.w r3, r3, #8
|
|
8003588: 6013 str r3, [r2, #0]
|
|
800358a: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
800358e: 681b ldr r3, [r3, #0]
|
|
8003590: f023 02f0 bic.w r2, r3, #240 @ 0xf0
|
|
8003594: 687b ldr r3, [r7, #4]
|
|
8003596: 6a9b ldr r3, [r3, #40] @ 0x28
|
|
8003598: f04f 41b0 mov.w r1, #1476395008 @ 0x58000000
|
|
800359c: 4313 orrs r3, r2
|
|
800359e: 600b str r3, [r1, #0]
|
|
/* Adjusts the Multiple Speed oscillator (MSI) calibration value. */
|
|
__HAL_RCC_MSI_CALIBRATIONVALUE_ADJUST(RCC_OscInitStruct->MSICalibrationValue);
|
|
80035a0: 687b ldr r3, [r7, #4]
|
|
80035a2: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
80035a4: 4618 mov r0, r3
|
|
80035a6: f7ff fdc7 bl 8003138 <LL_RCC_MSI_SetCalibTrimming>
|
|
80035aa: e015 b.n 80035d8 <HAL_RCC_OscConfig+0x1b4>
|
|
|
|
}
|
|
else
|
|
{
|
|
/* Disable the Internal High Speed oscillator (MSI). */
|
|
__HAL_RCC_MSI_DISABLE();
|
|
80035ac: f7ff fd7f bl 80030ae <LL_RCC_MSI_Disable>
|
|
|
|
/* Get timeout */
|
|
tickstart = HAL_GetTick();
|
|
80035b0: f7fd fb4a bl 8000c48 <HAL_GetTick>
|
|
80035b4: 6178 str r0, [r7, #20]
|
|
|
|
/* Wait till MSI is disabled */
|
|
while (LL_RCC_MSI_IsReady() != 0U)
|
|
80035b6: e008 b.n 80035ca <HAL_RCC_OscConfig+0x1a6>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > MSI_TIMEOUT_VALUE)
|
|
80035b8: f7fd fb46 bl 8000c48 <HAL_GetTick>
|
|
80035bc: 4602 mov r2, r0
|
|
80035be: 697b ldr r3, [r7, #20]
|
|
80035c0: 1ad3 subs r3, r2, r3
|
|
80035c2: 2b02 cmp r3, #2
|
|
80035c4: d901 bls.n 80035ca <HAL_RCC_OscConfig+0x1a6>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
80035c6: 2303 movs r3, #3
|
|
80035c8: e2a5 b.n 8003b16 <HAL_RCC_OscConfig+0x6f2>
|
|
while (LL_RCC_MSI_IsReady() != 0U)
|
|
80035ca: f7ff fd7e bl 80030ca <LL_RCC_MSI_IsReady>
|
|
80035ce: 4603 mov r3, r0
|
|
80035d0: 2b00 cmp r3, #0
|
|
80035d2: d1f1 bne.n 80035b8 <HAL_RCC_OscConfig+0x194>
|
|
80035d4: e000 b.n 80035d8 <HAL_RCC_OscConfig+0x1b4>
|
|
if (RCC_OscInitStruct->MSIState == RCC_MSI_OFF)
|
|
80035d6: bf00 nop
|
|
}
|
|
}
|
|
}
|
|
|
|
/*------------------------------- HSE Configuration ------------------------*/
|
|
if (((RCC_OscInitStruct->OscillatorType) & RCC_OSCILLATORTYPE_HSE) == RCC_OSCILLATORTYPE_HSE)
|
|
80035d8: 687b ldr r3, [r7, #4]
|
|
80035da: 681b ldr r3, [r3, #0]
|
|
80035dc: f003 0301 and.w r3, r3, #1
|
|
80035e0: 2b00 cmp r3, #0
|
|
80035e2: d058 beq.n 8003696 <HAL_RCC_OscConfig+0x272>
|
|
{
|
|
/* Check the parameters */
|
|
assert_param(IS_RCC_HSE(RCC_OscInitStruct->HSEState));
|
|
|
|
/* When the HSE is used as system clock or clock source for PLL in these cases it is not allowed to be disabled */
|
|
if ((sysclk_source == RCC_SYSCLKSOURCE_STATUS_HSE) ||
|
|
80035e4: 69fb ldr r3, [r7, #28]
|
|
80035e6: 2b08 cmp r3, #8
|
|
80035e8: d005 beq.n 80035f6 <HAL_RCC_OscConfig+0x1d2>
|
|
80035ea: 69fb ldr r3, [r7, #28]
|
|
80035ec: 2b0c cmp r3, #12
|
|
80035ee: d108 bne.n 8003602 <HAL_RCC_OscConfig+0x1de>
|
|
((sysclk_source == RCC_SYSCLKSOURCE_STATUS_PLLCLK) && (pll_config == RCC_PLLSOURCE_HSE)))
|
|
80035f0: 69bb ldr r3, [r7, #24]
|
|
80035f2: 2b03 cmp r3, #3
|
|
80035f4: d105 bne.n 8003602 <HAL_RCC_OscConfig+0x1de>
|
|
{
|
|
if (RCC_OscInitStruct->HSEState == RCC_HSE_OFF)
|
|
80035f6: 687b ldr r3, [r7, #4]
|
|
80035f8: 685b ldr r3, [r3, #4]
|
|
80035fa: 2b00 cmp r3, #0
|
|
80035fc: d14b bne.n 8003696 <HAL_RCC_OscConfig+0x272>
|
|
{
|
|
return HAL_ERROR;
|
|
80035fe: 2301 movs r3, #1
|
|
8003600: e289 b.n 8003b16 <HAL_RCC_OscConfig+0x6f2>
|
|
/* Set the new HSE configuration ---------------------------------------*/
|
|
/* Check HSE division factor */
|
|
assert_param(IS_RCC_HSEDIV(RCC_OscInitStruct->HSEDiv));
|
|
|
|
/* Set HSE division factor */
|
|
MODIFY_REG(RCC->CR, RCC_CR_HSEPRE, RCC_OscInitStruct->HSEDiv);
|
|
8003602: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8003606: 681b ldr r3, [r3, #0]
|
|
8003608: f423 1280 bic.w r2, r3, #1048576 @ 0x100000
|
|
800360c: 687b ldr r3, [r7, #4]
|
|
800360e: 689b ldr r3, [r3, #8]
|
|
8003610: f04f 41b0 mov.w r1, #1476395008 @ 0x58000000
|
|
8003614: 4313 orrs r3, r2
|
|
8003616: 600b str r3, [r1, #0]
|
|
|
|
__HAL_RCC_HSE_CONFIG(RCC_OscInitStruct->HSEState);
|
|
8003618: 687b ldr r3, [r7, #4]
|
|
800361a: 685b ldr r3, [r3, #4]
|
|
800361c: f5b3 3f80 cmp.w r3, #65536 @ 0x10000
|
|
8003620: d102 bne.n 8003628 <HAL_RCC_OscConfig+0x204>
|
|
8003622: f7ff fc86 bl 8002f32 <LL_RCC_HSE_Enable>
|
|
8003626: e00d b.n 8003644 <HAL_RCC_OscConfig+0x220>
|
|
8003628: 687b ldr r3, [r7, #4]
|
|
800362a: 685b ldr r3, [r3, #4]
|
|
800362c: f5b3 1f04 cmp.w r3, #2162688 @ 0x210000
|
|
8003630: d104 bne.n 800363c <HAL_RCC_OscConfig+0x218>
|
|
8003632: f7ff fc51 bl 8002ed8 <LL_RCC_HSE_EnableTcxo>
|
|
8003636: f7ff fc7c bl 8002f32 <LL_RCC_HSE_Enable>
|
|
800363a: e003 b.n 8003644 <HAL_RCC_OscConfig+0x220>
|
|
800363c: f7ff fc87 bl 8002f4e <LL_RCC_HSE_Disable>
|
|
8003640: f7ff fc58 bl 8002ef4 <LL_RCC_HSE_DisableTcxo>
|
|
|
|
/* Check the HSE State */
|
|
if (RCC_OscInitStruct->HSEState != RCC_HSE_OFF)
|
|
8003644: 687b ldr r3, [r7, #4]
|
|
8003646: 685b ldr r3, [r3, #4]
|
|
8003648: 2b00 cmp r3, #0
|
|
800364a: d012 beq.n 8003672 <HAL_RCC_OscConfig+0x24e>
|
|
{
|
|
/* Get Start Tick */
|
|
tickstart = HAL_GetTick();
|
|
800364c: f7fd fafc bl 8000c48 <HAL_GetTick>
|
|
8003650: 6178 str r0, [r7, #20]
|
|
|
|
/* Wait till HSE is ready */
|
|
while (LL_RCC_HSE_IsReady() == 0U)
|
|
8003652: e008 b.n 8003666 <HAL_RCC_OscConfig+0x242>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > HSE_TIMEOUT_VALUE)
|
|
8003654: f7fd faf8 bl 8000c48 <HAL_GetTick>
|
|
8003658: 4602 mov r2, r0
|
|
800365a: 697b ldr r3, [r7, #20]
|
|
800365c: 1ad3 subs r3, r2, r3
|
|
800365e: 2b64 cmp r3, #100 @ 0x64
|
|
8003660: d901 bls.n 8003666 <HAL_RCC_OscConfig+0x242>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
8003662: 2303 movs r3, #3
|
|
8003664: e257 b.n 8003b16 <HAL_RCC_OscConfig+0x6f2>
|
|
while (LL_RCC_HSE_IsReady() == 0U)
|
|
8003666: f7ff fc80 bl 8002f6a <LL_RCC_HSE_IsReady>
|
|
800366a: 4603 mov r3, r0
|
|
800366c: 2b00 cmp r3, #0
|
|
800366e: d0f1 beq.n 8003654 <HAL_RCC_OscConfig+0x230>
|
|
8003670: e011 b.n 8003696 <HAL_RCC_OscConfig+0x272>
|
|
}
|
|
}
|
|
else
|
|
{
|
|
/* Get Start Tick */
|
|
tickstart = HAL_GetTick();
|
|
8003672: f7fd fae9 bl 8000c48 <HAL_GetTick>
|
|
8003676: 6178 str r0, [r7, #20]
|
|
|
|
/* Wait till HSE is disabled */
|
|
while (LL_RCC_HSE_IsReady() != 0U)
|
|
8003678: e008 b.n 800368c <HAL_RCC_OscConfig+0x268>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > HSE_TIMEOUT_VALUE)
|
|
800367a: f7fd fae5 bl 8000c48 <HAL_GetTick>
|
|
800367e: 4602 mov r2, r0
|
|
8003680: 697b ldr r3, [r7, #20]
|
|
8003682: 1ad3 subs r3, r2, r3
|
|
8003684: 2b64 cmp r3, #100 @ 0x64
|
|
8003686: d901 bls.n 800368c <HAL_RCC_OscConfig+0x268>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
8003688: 2303 movs r3, #3
|
|
800368a: e244 b.n 8003b16 <HAL_RCC_OscConfig+0x6f2>
|
|
while (LL_RCC_HSE_IsReady() != 0U)
|
|
800368c: f7ff fc6d bl 8002f6a <LL_RCC_HSE_IsReady>
|
|
8003690: 4603 mov r3, r0
|
|
8003692: 2b00 cmp r3, #0
|
|
8003694: d1f1 bne.n 800367a <HAL_RCC_OscConfig+0x256>
|
|
}
|
|
}
|
|
}
|
|
|
|
/*----------------------------- HSI Configuration --------------------------*/
|
|
if (((RCC_OscInitStruct->OscillatorType) & RCC_OSCILLATORTYPE_HSI) == RCC_OSCILLATORTYPE_HSI)
|
|
8003696: 687b ldr r3, [r7, #4]
|
|
8003698: 681b ldr r3, [r3, #0]
|
|
800369a: f003 0302 and.w r3, r3, #2
|
|
800369e: 2b00 cmp r3, #0
|
|
80036a0: d046 beq.n 8003730 <HAL_RCC_OscConfig+0x30c>
|
|
/* Check the parameters */
|
|
assert_param(IS_RCC_HSI(RCC_OscInitStruct->HSIState));
|
|
assert_param(IS_RCC_HSI_CALIBRATION_VALUE(RCC_OscInitStruct->HSICalibrationValue));
|
|
|
|
/* Check if HSI is used as system clock or as PLL source when PLL is selected as system clock */
|
|
if ((sysclk_source == RCC_SYSCLKSOURCE_STATUS_HSI) ||
|
|
80036a2: 69fb ldr r3, [r7, #28]
|
|
80036a4: 2b04 cmp r3, #4
|
|
80036a6: d005 beq.n 80036b4 <HAL_RCC_OscConfig+0x290>
|
|
80036a8: 69fb ldr r3, [r7, #28]
|
|
80036aa: 2b0c cmp r3, #12
|
|
80036ac: d10e bne.n 80036cc <HAL_RCC_OscConfig+0x2a8>
|
|
((sysclk_source == RCC_SYSCLKSOURCE_STATUS_PLLCLK) && (pll_config == RCC_PLLSOURCE_HSI)))
|
|
80036ae: 69bb ldr r3, [r7, #24]
|
|
80036b0: 2b02 cmp r3, #2
|
|
80036b2: d10b bne.n 80036cc <HAL_RCC_OscConfig+0x2a8>
|
|
{
|
|
/* When HSI is used as system clock it will not be disabled */
|
|
if (RCC_OscInitStruct->HSIState == RCC_HSI_OFF)
|
|
80036b4: 687b ldr r3, [r7, #4]
|
|
80036b6: 691b ldr r3, [r3, #16]
|
|
80036b8: 2b00 cmp r3, #0
|
|
80036ba: d101 bne.n 80036c0 <HAL_RCC_OscConfig+0x29c>
|
|
{
|
|
return HAL_ERROR;
|
|
80036bc: 2301 movs r3, #1
|
|
80036be: e22a b.n 8003b16 <HAL_RCC_OscConfig+0x6f2>
|
|
}
|
|
/* Otherwise, just the calibration is allowed */
|
|
else
|
|
{
|
|
/* Adjusts the Internal High Speed oscillator (HSI) calibration value. */
|
|
__HAL_RCC_HSI_CALIBRATIONVALUE_ADJUST(RCC_OscInitStruct->HSICalibrationValue);
|
|
80036c0: 687b ldr r3, [r7, #4]
|
|
80036c2: 695b ldr r3, [r3, #20]
|
|
80036c4: 4618 mov r0, r3
|
|
80036c6: f7ff fc8e bl 8002fe6 <LL_RCC_HSI_SetCalibTrimming>
|
|
if (RCC_OscInitStruct->HSIState == RCC_HSI_OFF)
|
|
80036ca: e031 b.n 8003730 <HAL_RCC_OscConfig+0x30c>
|
|
}
|
|
}
|
|
else
|
|
{
|
|
/* Check the HSI State */
|
|
if (RCC_OscInitStruct->HSIState != RCC_HSI_OFF)
|
|
80036cc: 687b ldr r3, [r7, #4]
|
|
80036ce: 691b ldr r3, [r3, #16]
|
|
80036d0: 2b00 cmp r3, #0
|
|
80036d2: d019 beq.n 8003708 <HAL_RCC_OscConfig+0x2e4>
|
|
{
|
|
/* Enable the Internal High Speed oscillator (HSI). */
|
|
__HAL_RCC_HSI_ENABLE();
|
|
80036d4: f7ff fc5a bl 8002f8c <LL_RCC_HSI_Enable>
|
|
|
|
/* Get Start Tick*/
|
|
tickstart = HAL_GetTick();
|
|
80036d8: f7fd fab6 bl 8000c48 <HAL_GetTick>
|
|
80036dc: 6178 str r0, [r7, #20]
|
|
|
|
/* Wait till HSI is ready */
|
|
while (LL_RCC_HSI_IsReady() == 0U)
|
|
80036de: e008 b.n 80036f2 <HAL_RCC_OscConfig+0x2ce>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > HSI_TIMEOUT_VALUE)
|
|
80036e0: f7fd fab2 bl 8000c48 <HAL_GetTick>
|
|
80036e4: 4602 mov r2, r0
|
|
80036e6: 697b ldr r3, [r7, #20]
|
|
80036e8: 1ad3 subs r3, r2, r3
|
|
80036ea: 2b02 cmp r3, #2
|
|
80036ec: d901 bls.n 80036f2 <HAL_RCC_OscConfig+0x2ce>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
80036ee: 2303 movs r3, #3
|
|
80036f0: e211 b.n 8003b16 <HAL_RCC_OscConfig+0x6f2>
|
|
while (LL_RCC_HSI_IsReady() == 0U)
|
|
80036f2: f7ff fc67 bl 8002fc4 <LL_RCC_HSI_IsReady>
|
|
80036f6: 4603 mov r3, r0
|
|
80036f8: 2b00 cmp r3, #0
|
|
80036fa: d0f1 beq.n 80036e0 <HAL_RCC_OscConfig+0x2bc>
|
|
}
|
|
}
|
|
|
|
/* Adjusts the Internal High Speed oscillator (HSI) calibration value. */
|
|
__HAL_RCC_HSI_CALIBRATIONVALUE_ADJUST(RCC_OscInitStruct->HSICalibrationValue);
|
|
80036fc: 687b ldr r3, [r7, #4]
|
|
80036fe: 695b ldr r3, [r3, #20]
|
|
8003700: 4618 mov r0, r3
|
|
8003702: f7ff fc70 bl 8002fe6 <LL_RCC_HSI_SetCalibTrimming>
|
|
8003706: e013 b.n 8003730 <HAL_RCC_OscConfig+0x30c>
|
|
}
|
|
else
|
|
{
|
|
/* Disable the Internal High Speed oscillator (HSI). */
|
|
__HAL_RCC_HSI_DISABLE();
|
|
8003708: f7ff fc4e bl 8002fa8 <LL_RCC_HSI_Disable>
|
|
|
|
/* Get Start Tick*/
|
|
tickstart = HAL_GetTick();
|
|
800370c: f7fd fa9c bl 8000c48 <HAL_GetTick>
|
|
8003710: 6178 str r0, [r7, #20]
|
|
|
|
/* Wait till HSI is disabled */
|
|
while (LL_RCC_HSI_IsReady() != 0U)
|
|
8003712: e008 b.n 8003726 <HAL_RCC_OscConfig+0x302>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > HSI_TIMEOUT_VALUE)
|
|
8003714: f7fd fa98 bl 8000c48 <HAL_GetTick>
|
|
8003718: 4602 mov r2, r0
|
|
800371a: 697b ldr r3, [r7, #20]
|
|
800371c: 1ad3 subs r3, r2, r3
|
|
800371e: 2b02 cmp r3, #2
|
|
8003720: d901 bls.n 8003726 <HAL_RCC_OscConfig+0x302>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
8003722: 2303 movs r3, #3
|
|
8003724: e1f7 b.n 8003b16 <HAL_RCC_OscConfig+0x6f2>
|
|
while (LL_RCC_HSI_IsReady() != 0U)
|
|
8003726: f7ff fc4d bl 8002fc4 <LL_RCC_HSI_IsReady>
|
|
800372a: 4603 mov r3, r0
|
|
800372c: 2b00 cmp r3, #0
|
|
800372e: d1f1 bne.n 8003714 <HAL_RCC_OscConfig+0x2f0>
|
|
}
|
|
}
|
|
}
|
|
|
|
/*------------------------------ LSI Configuration -------------------------*/
|
|
if (((RCC_OscInitStruct->OscillatorType) & RCC_OSCILLATORTYPE_LSI) == RCC_OSCILLATORTYPE_LSI)
|
|
8003730: 687b ldr r3, [r7, #4]
|
|
8003732: 681b ldr r3, [r3, #0]
|
|
8003734: f003 0308 and.w r3, r3, #8
|
|
8003738: 2b00 cmp r3, #0
|
|
800373a: d06e beq.n 800381a <HAL_RCC_OscConfig+0x3f6>
|
|
{
|
|
/* Check the parameters */
|
|
assert_param(IS_RCC_LSI(RCC_OscInitStruct->LSIState));
|
|
|
|
/* Check the LSI State */
|
|
if (RCC_OscInitStruct->LSIState != RCC_LSI_OFF)
|
|
800373c: 687b ldr r3, [r7, #4]
|
|
800373e: 699b ldr r3, [r3, #24]
|
|
8003740: 2b00 cmp r3, #0
|
|
8003742: d056 beq.n 80037f2 <HAL_RCC_OscConfig+0x3ce>
|
|
{
|
|
uint32_t csr_temp = RCC->CSR;
|
|
8003744: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8003748: f8d3 3094 ldr.w r3, [r3, #148] @ 0x94
|
|
800374c: 60fb str r3, [r7, #12]
|
|
|
|
/* Check LSI division factor */
|
|
assert_param(IS_RCC_LSIDIV(RCC_OscInitStruct->LSIDiv));
|
|
|
|
if (RCC_OscInitStruct->LSIDiv != (csr_temp & RCC_CSR_LSIPRE))
|
|
800374e: 687b ldr r3, [r7, #4]
|
|
8003750: 69da ldr r2, [r3, #28]
|
|
8003752: 68fb ldr r3, [r7, #12]
|
|
8003754: f003 0310 and.w r3, r3, #16
|
|
8003758: 429a cmp r2, r3
|
|
800375a: d031 beq.n 80037c0 <HAL_RCC_OscConfig+0x39c>
|
|
{
|
|
if (((csr_temp & RCC_CSR_LSIRDY) == RCC_CSR_LSIRDY) && \
|
|
800375c: 68fb ldr r3, [r7, #12]
|
|
800375e: f003 0302 and.w r3, r3, #2
|
|
8003762: 2b00 cmp r3, #0
|
|
8003764: d006 beq.n 8003774 <HAL_RCC_OscConfig+0x350>
|
|
((csr_temp & RCC_CSR_LSION) != RCC_CSR_LSION))
|
|
8003766: 68fb ldr r3, [r7, #12]
|
|
8003768: f003 0301 and.w r3, r3, #1
|
|
if (((csr_temp & RCC_CSR_LSIRDY) == RCC_CSR_LSIRDY) && \
|
|
800376c: 2b00 cmp r3, #0
|
|
800376e: d101 bne.n 8003774 <HAL_RCC_OscConfig+0x350>
|
|
{
|
|
/* If LSIRDY is set while LSION is not enabled,
|
|
LSIPRE can't be updated */
|
|
return HAL_ERROR;
|
|
8003770: 2301 movs r3, #1
|
|
8003772: e1d0 b.n 8003b16 <HAL_RCC_OscConfig+0x6f2>
|
|
}
|
|
|
|
/* Turn off LSI before changing RCC_CSR_LSIPRE */
|
|
if ((csr_temp & RCC_CSR_LSION) == RCC_CSR_LSION)
|
|
8003774: 68fb ldr r3, [r7, #12]
|
|
8003776: f003 0301 and.w r3, r3, #1
|
|
800377a: 2b00 cmp r3, #0
|
|
800377c: d013 beq.n 80037a6 <HAL_RCC_OscConfig+0x382>
|
|
{
|
|
__HAL_RCC_LSI_DISABLE();
|
|
800377e: f7ff fc67 bl 8003050 <LL_RCC_LSI_Disable>
|
|
|
|
/* Get Start Tick*/
|
|
tickstart = HAL_GetTick();
|
|
8003782: f7fd fa61 bl 8000c48 <HAL_GetTick>
|
|
8003786: 6178 str r0, [r7, #20]
|
|
|
|
/* Wait till LSI is disabled */
|
|
while (LL_RCC_LSI_IsReady() != 0U)
|
|
8003788: e008 b.n 800379c <HAL_RCC_OscConfig+0x378>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > LSI_TIMEOUT_VALUE)
|
|
800378a: f7fd fa5d bl 8000c48 <HAL_GetTick>
|
|
800378e: 4602 mov r2, r0
|
|
8003790: 697b ldr r3, [r7, #20]
|
|
8003792: 1ad3 subs r3, r2, r3
|
|
8003794: 2b11 cmp r3, #17
|
|
8003796: d901 bls.n 800379c <HAL_RCC_OscConfig+0x378>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
8003798: 2303 movs r3, #3
|
|
800379a: e1bc b.n 8003b16 <HAL_RCC_OscConfig+0x6f2>
|
|
while (LL_RCC_LSI_IsReady() != 0U)
|
|
800379c: f7ff fc68 bl 8003070 <LL_RCC_LSI_IsReady>
|
|
80037a0: 4603 mov r3, r0
|
|
80037a2: 2b00 cmp r3, #0
|
|
80037a4: d1f1 bne.n 800378a <HAL_RCC_OscConfig+0x366>
|
|
}
|
|
}
|
|
}
|
|
|
|
/* Set LSI division factor */
|
|
MODIFY_REG(RCC->CSR, RCC_CSR_LSIPRE, RCC_OscInitStruct->LSIDiv);
|
|
80037a6: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
80037aa: f8d3 3094 ldr.w r3, [r3, #148] @ 0x94
|
|
80037ae: f023 0210 bic.w r2, r3, #16
|
|
80037b2: 687b ldr r3, [r7, #4]
|
|
80037b4: 69db ldr r3, [r3, #28]
|
|
80037b6: f04f 41b0 mov.w r1, #1476395008 @ 0x58000000
|
|
80037ba: 4313 orrs r3, r2
|
|
80037bc: f8c1 3094 str.w r3, [r1, #148] @ 0x94
|
|
}
|
|
|
|
/* Enable the Internal Low Speed oscillator (LSI). */
|
|
__HAL_RCC_LSI_ENABLE();
|
|
80037c0: f7ff fc36 bl 8003030 <LL_RCC_LSI_Enable>
|
|
|
|
/* Get Start Tick */
|
|
tickstart = HAL_GetTick();
|
|
80037c4: f7fd fa40 bl 8000c48 <HAL_GetTick>
|
|
80037c8: 6178 str r0, [r7, #20]
|
|
|
|
/* Wait till LSI is ready */
|
|
while (LL_RCC_LSI_IsReady() == 0U)
|
|
80037ca: e00c b.n 80037e6 <HAL_RCC_OscConfig+0x3c2>
|
|
80037cc: 20000000 .word 0x20000000
|
|
80037d0: 20000004 .word 0x20000004
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > LSI_TIMEOUT_VALUE)
|
|
80037d4: f7fd fa38 bl 8000c48 <HAL_GetTick>
|
|
80037d8: 4602 mov r2, r0
|
|
80037da: 697b ldr r3, [r7, #20]
|
|
80037dc: 1ad3 subs r3, r2, r3
|
|
80037de: 2b11 cmp r3, #17
|
|
80037e0: d901 bls.n 80037e6 <HAL_RCC_OscConfig+0x3c2>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
80037e2: 2303 movs r3, #3
|
|
80037e4: e197 b.n 8003b16 <HAL_RCC_OscConfig+0x6f2>
|
|
while (LL_RCC_LSI_IsReady() == 0U)
|
|
80037e6: f7ff fc43 bl 8003070 <LL_RCC_LSI_IsReady>
|
|
80037ea: 4603 mov r3, r0
|
|
80037ec: 2b00 cmp r3, #0
|
|
80037ee: d0f1 beq.n 80037d4 <HAL_RCC_OscConfig+0x3b0>
|
|
80037f0: e013 b.n 800381a <HAL_RCC_OscConfig+0x3f6>
|
|
}
|
|
}
|
|
else
|
|
{
|
|
/* Disable the Internal Low Speed oscillator (LSI). */
|
|
__HAL_RCC_LSI_DISABLE();
|
|
80037f2: f7ff fc2d bl 8003050 <LL_RCC_LSI_Disable>
|
|
|
|
/* Get Start Tick */
|
|
tickstart = HAL_GetTick();
|
|
80037f6: f7fd fa27 bl 8000c48 <HAL_GetTick>
|
|
80037fa: 6178 str r0, [r7, #20]
|
|
|
|
/* Wait till LSI is disabled */
|
|
while (LL_RCC_LSI_IsReady() != 0U)
|
|
80037fc: e008 b.n 8003810 <HAL_RCC_OscConfig+0x3ec>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > LSI_TIMEOUT_VALUE)
|
|
80037fe: f7fd fa23 bl 8000c48 <HAL_GetTick>
|
|
8003802: 4602 mov r2, r0
|
|
8003804: 697b ldr r3, [r7, #20]
|
|
8003806: 1ad3 subs r3, r2, r3
|
|
8003808: 2b11 cmp r3, #17
|
|
800380a: d901 bls.n 8003810 <HAL_RCC_OscConfig+0x3ec>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
800380c: 2303 movs r3, #3
|
|
800380e: e182 b.n 8003b16 <HAL_RCC_OscConfig+0x6f2>
|
|
while (LL_RCC_LSI_IsReady() != 0U)
|
|
8003810: f7ff fc2e bl 8003070 <LL_RCC_LSI_IsReady>
|
|
8003814: 4603 mov r3, r0
|
|
8003816: 2b00 cmp r3, #0
|
|
8003818: d1f1 bne.n 80037fe <HAL_RCC_OscConfig+0x3da>
|
|
}
|
|
}
|
|
}
|
|
|
|
/*------------------------------ LSE Configuration -------------------------*/
|
|
if (((RCC_OscInitStruct->OscillatorType) & RCC_OSCILLATORTYPE_LSE) == RCC_OSCILLATORTYPE_LSE)
|
|
800381a: 687b ldr r3, [r7, #4]
|
|
800381c: 681b ldr r3, [r3, #0]
|
|
800381e: f003 0304 and.w r3, r3, #4
|
|
8003822: 2b00 cmp r3, #0
|
|
8003824: f000 80d8 beq.w 80039d8 <HAL_RCC_OscConfig+0x5b4>
|
|
assert_param(IS_RCC_LSE(RCC_OscInitStruct->LSEState));
|
|
|
|
/* Update LSE configuration in Backup Domain control register */
|
|
/* Requires to enable write access to Backup Domain of necessary */
|
|
|
|
if (LL_PWR_IsEnabledBkUpAccess() == 0U)
|
|
8003828: f7ff fb44 bl 8002eb4 <LL_PWR_IsEnabledBkUpAccess>
|
|
800382c: 4603 mov r3, r0
|
|
800382e: 2b00 cmp r3, #0
|
|
8003830: d113 bne.n 800385a <HAL_RCC_OscConfig+0x436>
|
|
{
|
|
/* Enable write access to Backup domain */
|
|
HAL_PWR_EnableBkUpAccess();
|
|
8003832: f7ff fa83 bl 8002d3c <HAL_PWR_EnableBkUpAccess>
|
|
|
|
/* Wait for Backup domain Write protection disable */
|
|
tickstart = HAL_GetTick();
|
|
8003836: f7fd fa07 bl 8000c48 <HAL_GetTick>
|
|
800383a: 6178 str r0, [r7, #20]
|
|
|
|
while (LL_PWR_IsEnabledBkUpAccess() == 0U)
|
|
800383c: e008 b.n 8003850 <HAL_RCC_OscConfig+0x42c>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > RCC_DBP_TIMEOUT_VALUE)
|
|
800383e: f7fd fa03 bl 8000c48 <HAL_GetTick>
|
|
8003842: 4602 mov r2, r0
|
|
8003844: 697b ldr r3, [r7, #20]
|
|
8003846: 1ad3 subs r3, r2, r3
|
|
8003848: 2b02 cmp r3, #2
|
|
800384a: d901 bls.n 8003850 <HAL_RCC_OscConfig+0x42c>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
800384c: 2303 movs r3, #3
|
|
800384e: e162 b.n 8003b16 <HAL_RCC_OscConfig+0x6f2>
|
|
while (LL_PWR_IsEnabledBkUpAccess() == 0U)
|
|
8003850: f7ff fb30 bl 8002eb4 <LL_PWR_IsEnabledBkUpAccess>
|
|
8003854: 4603 mov r3, r0
|
|
8003856: 2b00 cmp r3, #0
|
|
8003858: d0f1 beq.n 800383e <HAL_RCC_OscConfig+0x41a>
|
|
}
|
|
}
|
|
}
|
|
|
|
/* Set the new LSE configuration -----------------------------------------*/
|
|
if (RCC_OscInitStruct->LSEState != RCC_LSE_OFF)
|
|
800385a: 687b ldr r3, [r7, #4]
|
|
800385c: 68db ldr r3, [r3, #12]
|
|
800385e: 2b00 cmp r3, #0
|
|
8003860: d07b beq.n 800395a <HAL_RCC_OscConfig+0x536>
|
|
{
|
|
/* Enable LSE bypasss (if requested) */
|
|
if ((RCC_OscInitStruct->LSEState == RCC_LSE_BYPASS)
|
|
8003862: 687b ldr r3, [r7, #4]
|
|
8003864: 68db ldr r3, [r3, #12]
|
|
8003866: 2b85 cmp r3, #133 @ 0x85
|
|
8003868: d003 beq.n 8003872 <HAL_RCC_OscConfig+0x44e>
|
|
|| (RCC_OscInitStruct->LSEState == RCC_LSE_BYPASS_RTC_ONLY))
|
|
800386a: 687b ldr r3, [r7, #4]
|
|
800386c: 68db ldr r3, [r3, #12]
|
|
800386e: 2b05 cmp r3, #5
|
|
8003870: d109 bne.n 8003886 <HAL_RCC_OscConfig+0x462>
|
|
{
|
|
/* LSE oscillator bypass enable */
|
|
SET_BIT(RCC->BDCR, RCC_BDCR_LSEBYP);
|
|
8003872: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8003876: f8d3 3090 ldr.w r3, [r3, #144] @ 0x90
|
|
800387a: f04f 42b0 mov.w r2, #1476395008 @ 0x58000000
|
|
800387e: f043 0304 orr.w r3, r3, #4
|
|
8003882: f8c2 3090 str.w r3, [r2, #144] @ 0x90
|
|
}
|
|
|
|
/* Get Start Tick */
|
|
tickstart = HAL_GetTick();
|
|
8003886: f7fd f9df bl 8000c48 <HAL_GetTick>
|
|
800388a: 6178 str r0, [r7, #20]
|
|
|
|
/* LSE oscillator enable */
|
|
SET_BIT(RCC->BDCR, RCC_BDCR_LSEON);
|
|
800388c: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8003890: f8d3 3090 ldr.w r3, [r3, #144] @ 0x90
|
|
8003894: f04f 42b0 mov.w r2, #1476395008 @ 0x58000000
|
|
8003898: f043 0301 orr.w r3, r3, #1
|
|
800389c: f8c2 3090 str.w r3, [r2, #144] @ 0x90
|
|
|
|
/* Wait till LSE is ready */
|
|
while (LL_RCC_LSE_IsReady() == 0U)
|
|
80038a0: e00a b.n 80038b8 <HAL_RCC_OscConfig+0x494>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > RCC_LSE_TIMEOUT_VALUE)
|
|
80038a2: f7fd f9d1 bl 8000c48 <HAL_GetTick>
|
|
80038a6: 4602 mov r2, r0
|
|
80038a8: 697b ldr r3, [r7, #20]
|
|
80038aa: 1ad3 subs r3, r2, r3
|
|
80038ac: f241 3288 movw r2, #5000 @ 0x1388
|
|
80038b0: 4293 cmp r3, r2
|
|
80038b2: d901 bls.n 80038b8 <HAL_RCC_OscConfig+0x494>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
80038b4: 2303 movs r3, #3
|
|
80038b6: e12e b.n 8003b16 <HAL_RCC_OscConfig+0x6f2>
|
|
while (LL_RCC_LSE_IsReady() == 0U)
|
|
80038b8: f7ff fba9 bl 800300e <LL_RCC_LSE_IsReady>
|
|
80038bc: 4603 mov r3, r0
|
|
80038be: 2b00 cmp r3, #0
|
|
80038c0: d0ef beq.n 80038a2 <HAL_RCC_OscConfig+0x47e>
|
|
}
|
|
}
|
|
|
|
/* Enable LSE system clock (if requested) */
|
|
if ((RCC_OscInitStruct->LSEState == RCC_LSE_ON)
|
|
80038c2: 687b ldr r3, [r7, #4]
|
|
80038c4: 68db ldr r3, [r3, #12]
|
|
80038c6: 2b81 cmp r3, #129 @ 0x81
|
|
80038c8: d003 beq.n 80038d2 <HAL_RCC_OscConfig+0x4ae>
|
|
|| (RCC_OscInitStruct->LSEState == RCC_LSE_BYPASS))
|
|
80038ca: 687b ldr r3, [r7, #4]
|
|
80038cc: 68db ldr r3, [r3, #12]
|
|
80038ce: 2b85 cmp r3, #133 @ 0x85
|
|
80038d0: d121 bne.n 8003916 <HAL_RCC_OscConfig+0x4f2>
|
|
{
|
|
/* Get Start Tick */
|
|
tickstart = HAL_GetTick();
|
|
80038d2: f7fd f9b9 bl 8000c48 <HAL_GetTick>
|
|
80038d6: 6178 str r0, [r7, #20]
|
|
|
|
SET_BIT(RCC->BDCR, RCC_BDCR_LSESYSEN);
|
|
80038d8: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
80038dc: f8d3 3090 ldr.w r3, [r3, #144] @ 0x90
|
|
80038e0: f04f 42b0 mov.w r2, #1476395008 @ 0x58000000
|
|
80038e4: f043 0380 orr.w r3, r3, #128 @ 0x80
|
|
80038e8: f8c2 3090 str.w r3, [r2, #144] @ 0x90
|
|
|
|
/* Wait till LSESYS is ready */
|
|
while (READ_BIT(RCC->BDCR, RCC_BDCR_LSESYSRDY) == 0U)
|
|
80038ec: e00a b.n 8003904 <HAL_RCC_OscConfig+0x4e0>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > RCC_LSE_TIMEOUT_VALUE)
|
|
80038ee: f7fd f9ab bl 8000c48 <HAL_GetTick>
|
|
80038f2: 4602 mov r2, r0
|
|
80038f4: 697b ldr r3, [r7, #20]
|
|
80038f6: 1ad3 subs r3, r2, r3
|
|
80038f8: f241 3288 movw r2, #5000 @ 0x1388
|
|
80038fc: 4293 cmp r3, r2
|
|
80038fe: d901 bls.n 8003904 <HAL_RCC_OscConfig+0x4e0>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
8003900: 2303 movs r3, #3
|
|
8003902: e108 b.n 8003b16 <HAL_RCC_OscConfig+0x6f2>
|
|
while (READ_BIT(RCC->BDCR, RCC_BDCR_LSESYSRDY) == 0U)
|
|
8003904: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8003908: f8d3 3090 ldr.w r3, [r3, #144] @ 0x90
|
|
800390c: f403 6300 and.w r3, r3, #2048 @ 0x800
|
|
8003910: 2b00 cmp r3, #0
|
|
8003912: d0ec beq.n 80038ee <HAL_RCC_OscConfig+0x4ca>
|
|
if ((RCC_OscInitStruct->LSEState == RCC_LSE_ON)
|
|
8003914: e060 b.n 80039d8 <HAL_RCC_OscConfig+0x5b4>
|
|
}
|
|
}
|
|
else
|
|
{
|
|
/* Get Start Tick */
|
|
tickstart = HAL_GetTick();
|
|
8003916: f7fd f997 bl 8000c48 <HAL_GetTick>
|
|
800391a: 6178 str r0, [r7, #20]
|
|
|
|
CLEAR_BIT(RCC->BDCR, RCC_BDCR_LSESYSEN);
|
|
800391c: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8003920: f8d3 3090 ldr.w r3, [r3, #144] @ 0x90
|
|
8003924: f04f 42b0 mov.w r2, #1476395008 @ 0x58000000
|
|
8003928: f023 0380 bic.w r3, r3, #128 @ 0x80
|
|
800392c: f8c2 3090 str.w r3, [r2, #144] @ 0x90
|
|
|
|
/* Wait till LSESYSRDY is cleared */
|
|
while (READ_BIT(RCC->BDCR, RCC_BDCR_LSESYSRDY) != 0U)
|
|
8003930: e00a b.n 8003948 <HAL_RCC_OscConfig+0x524>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > RCC_LSE_TIMEOUT_VALUE)
|
|
8003932: f7fd f989 bl 8000c48 <HAL_GetTick>
|
|
8003936: 4602 mov r2, r0
|
|
8003938: 697b ldr r3, [r7, #20]
|
|
800393a: 1ad3 subs r3, r2, r3
|
|
800393c: f241 3288 movw r2, #5000 @ 0x1388
|
|
8003940: 4293 cmp r3, r2
|
|
8003942: d901 bls.n 8003948 <HAL_RCC_OscConfig+0x524>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
8003944: 2303 movs r3, #3
|
|
8003946: e0e6 b.n 8003b16 <HAL_RCC_OscConfig+0x6f2>
|
|
while (READ_BIT(RCC->BDCR, RCC_BDCR_LSESYSRDY) != 0U)
|
|
8003948: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
800394c: f8d3 3090 ldr.w r3, [r3, #144] @ 0x90
|
|
8003950: f403 6300 and.w r3, r3, #2048 @ 0x800
|
|
8003954: 2b00 cmp r3, #0
|
|
8003956: d1ec bne.n 8003932 <HAL_RCC_OscConfig+0x50e>
|
|
8003958: e03e b.n 80039d8 <HAL_RCC_OscConfig+0x5b4>
|
|
}
|
|
}
|
|
else
|
|
{
|
|
/* Get Start Tick */
|
|
tickstart = HAL_GetTick();
|
|
800395a: f7fd f975 bl 8000c48 <HAL_GetTick>
|
|
800395e: 6178 str r0, [r7, #20]
|
|
|
|
CLEAR_BIT(RCC->BDCR, RCC_BDCR_LSESYSEN);
|
|
8003960: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8003964: f8d3 3090 ldr.w r3, [r3, #144] @ 0x90
|
|
8003968: f04f 42b0 mov.w r2, #1476395008 @ 0x58000000
|
|
800396c: f023 0380 bic.w r3, r3, #128 @ 0x80
|
|
8003970: f8c2 3090 str.w r3, [r2, #144] @ 0x90
|
|
|
|
/* Wait till LSESYSRDY is cleared */
|
|
while (READ_BIT(RCC->BDCR, RCC_BDCR_LSESYSRDY) != 0U)
|
|
8003974: e00a b.n 800398c <HAL_RCC_OscConfig+0x568>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > RCC_LSE_TIMEOUT_VALUE)
|
|
8003976: f7fd f967 bl 8000c48 <HAL_GetTick>
|
|
800397a: 4602 mov r2, r0
|
|
800397c: 697b ldr r3, [r7, #20]
|
|
800397e: 1ad3 subs r3, r2, r3
|
|
8003980: f241 3288 movw r2, #5000 @ 0x1388
|
|
8003984: 4293 cmp r3, r2
|
|
8003986: d901 bls.n 800398c <HAL_RCC_OscConfig+0x568>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
8003988: 2303 movs r3, #3
|
|
800398a: e0c4 b.n 8003b16 <HAL_RCC_OscConfig+0x6f2>
|
|
while (READ_BIT(RCC->BDCR, RCC_BDCR_LSESYSRDY) != 0U)
|
|
800398c: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8003990: f8d3 3090 ldr.w r3, [r3, #144] @ 0x90
|
|
8003994: f403 6300 and.w r3, r3, #2048 @ 0x800
|
|
8003998: 2b00 cmp r3, #0
|
|
800399a: d1ec bne.n 8003976 <HAL_RCC_OscConfig+0x552>
|
|
}
|
|
}
|
|
|
|
/* Get Start Tick */
|
|
tickstart = HAL_GetTick();
|
|
800399c: f7fd f954 bl 8000c48 <HAL_GetTick>
|
|
80039a0: 6178 str r0, [r7, #20]
|
|
|
|
/* LSE oscillator disable */
|
|
CLEAR_BIT(RCC->BDCR, RCC_BDCR_LSEON);
|
|
80039a2: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
80039a6: f8d3 3090 ldr.w r3, [r3, #144] @ 0x90
|
|
80039aa: f04f 42b0 mov.w r2, #1476395008 @ 0x58000000
|
|
80039ae: f023 0301 bic.w r3, r3, #1
|
|
80039b2: f8c2 3090 str.w r3, [r2, #144] @ 0x90
|
|
|
|
/* Wait till LSE is disabled */
|
|
while (LL_RCC_LSE_IsReady() != 0U)
|
|
80039b6: e00a b.n 80039ce <HAL_RCC_OscConfig+0x5aa>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > RCC_LSE_TIMEOUT_VALUE)
|
|
80039b8: f7fd f946 bl 8000c48 <HAL_GetTick>
|
|
80039bc: 4602 mov r2, r0
|
|
80039be: 697b ldr r3, [r7, #20]
|
|
80039c0: 1ad3 subs r3, r2, r3
|
|
80039c2: f241 3288 movw r2, #5000 @ 0x1388
|
|
80039c6: 4293 cmp r3, r2
|
|
80039c8: d901 bls.n 80039ce <HAL_RCC_OscConfig+0x5aa>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
80039ca: 2303 movs r3, #3
|
|
80039cc: e0a3 b.n 8003b16 <HAL_RCC_OscConfig+0x6f2>
|
|
while (LL_RCC_LSE_IsReady() != 0U)
|
|
80039ce: f7ff fb1e bl 800300e <LL_RCC_LSE_IsReady>
|
|
80039d2: 4603 mov r3, r0
|
|
80039d4: 2b00 cmp r3, #0
|
|
80039d6: d1ef bne.n 80039b8 <HAL_RCC_OscConfig+0x594>
|
|
|
|
/*-------------------------------- PLL Configuration -----------------------*/
|
|
/* Check the parameters */
|
|
assert_param(IS_RCC_PLL(RCC_OscInitStruct->PLL.PLLState));
|
|
|
|
if (RCC_OscInitStruct->PLL.PLLState != RCC_PLL_NONE)
|
|
80039d8: 687b ldr r3, [r7, #4]
|
|
80039da: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
80039dc: 2b00 cmp r3, #0
|
|
80039de: f000 8099 beq.w 8003b14 <HAL_RCC_OscConfig+0x6f0>
|
|
{
|
|
/* Check if the PLL is used as system clock or not */
|
|
if (sysclk_source != RCC_SYSCLKSOURCE_STATUS_PLLCLK)
|
|
80039e2: 69fb ldr r3, [r7, #28]
|
|
80039e4: 2b0c cmp r3, #12
|
|
80039e6: d06c beq.n 8003ac2 <HAL_RCC_OscConfig+0x69e>
|
|
{
|
|
if (RCC_OscInitStruct->PLL.PLLState == RCC_PLL_ON)
|
|
80039e8: 687b ldr r3, [r7, #4]
|
|
80039ea: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
80039ec: 2b02 cmp r3, #2
|
|
80039ee: d14b bne.n 8003a88 <HAL_RCC_OscConfig+0x664>
|
|
assert_param(IS_RCC_PLLP_VALUE(RCC_OscInitStruct->PLL.PLLP));
|
|
assert_param(IS_RCC_PLLQ_VALUE(RCC_OscInitStruct->PLL.PLLQ));
|
|
assert_param(IS_RCC_PLLR_VALUE(RCC_OscInitStruct->PLL.PLLR));
|
|
|
|
/* Disable the main PLL. */
|
|
__HAL_RCC_PLL_DISABLE();
|
|
80039f0: f7ff fc74 bl 80032dc <LL_RCC_PLL_Disable>
|
|
|
|
/* Get Start Tick */
|
|
tickstart = HAL_GetTick();
|
|
80039f4: f7fd f928 bl 8000c48 <HAL_GetTick>
|
|
80039f8: 6178 str r0, [r7, #20]
|
|
|
|
/* Wait till PLL is ready */
|
|
while (LL_RCC_PLL_IsReady() != 0U)
|
|
80039fa: e008 b.n 8003a0e <HAL_RCC_OscConfig+0x5ea>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > PLL_TIMEOUT_VALUE)
|
|
80039fc: f7fd f924 bl 8000c48 <HAL_GetTick>
|
|
8003a00: 4602 mov r2, r0
|
|
8003a02: 697b ldr r3, [r7, #20]
|
|
8003a04: 1ad3 subs r3, r2, r3
|
|
8003a06: 2b0a cmp r3, #10
|
|
8003a08: d901 bls.n 8003a0e <HAL_RCC_OscConfig+0x5ea>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
8003a0a: 2303 movs r3, #3
|
|
8003a0c: e083 b.n 8003b16 <HAL_RCC_OscConfig+0x6f2>
|
|
while (LL_RCC_PLL_IsReady() != 0U)
|
|
8003a0e: f7ff fc73 bl 80032f8 <LL_RCC_PLL_IsReady>
|
|
8003a12: 4603 mov r3, r0
|
|
8003a14: 2b00 cmp r3, #0
|
|
8003a16: d1f1 bne.n 80039fc <HAL_RCC_OscConfig+0x5d8>
|
|
}
|
|
}
|
|
|
|
/* Configure the main PLL clock source, multiplication and division factors. */
|
|
__HAL_RCC_PLL_CONFIG(RCC_OscInitStruct->PLL.PLLSource,
|
|
8003a18: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8003a1c: 68da ldr r2, [r3, #12]
|
|
8003a1e: 4b40 ldr r3, [pc, #256] @ (8003b20 <HAL_RCC_OscConfig+0x6fc>)
|
|
8003a20: 4013 ands r3, r2
|
|
8003a22: 687a ldr r2, [r7, #4]
|
|
8003a24: 6b11 ldr r1, [r2, #48] @ 0x30
|
|
8003a26: 687a ldr r2, [r7, #4]
|
|
8003a28: 6b52 ldr r2, [r2, #52] @ 0x34
|
|
8003a2a: 4311 orrs r1, r2
|
|
8003a2c: 687a ldr r2, [r7, #4]
|
|
8003a2e: 6b92 ldr r2, [r2, #56] @ 0x38
|
|
8003a30: 0212 lsls r2, r2, #8
|
|
8003a32: 4311 orrs r1, r2
|
|
8003a34: 687a ldr r2, [r7, #4]
|
|
8003a36: 6bd2 ldr r2, [r2, #60] @ 0x3c
|
|
8003a38: 4311 orrs r1, r2
|
|
8003a3a: 687a ldr r2, [r7, #4]
|
|
8003a3c: 6c12 ldr r2, [r2, #64] @ 0x40
|
|
8003a3e: 4311 orrs r1, r2
|
|
8003a40: 687a ldr r2, [r7, #4]
|
|
8003a42: 6c52 ldr r2, [r2, #68] @ 0x44
|
|
8003a44: 430a orrs r2, r1
|
|
8003a46: f04f 41b0 mov.w r1, #1476395008 @ 0x58000000
|
|
8003a4a: 4313 orrs r3, r2
|
|
8003a4c: 60cb str r3, [r1, #12]
|
|
RCC_OscInitStruct->PLL.PLLP,
|
|
RCC_OscInitStruct->PLL.PLLQ,
|
|
RCC_OscInitStruct->PLL.PLLR);
|
|
|
|
/* Enable the main PLL. */
|
|
__HAL_RCC_PLL_ENABLE();
|
|
8003a4e: f7ff fc37 bl 80032c0 <LL_RCC_PLL_Enable>
|
|
|
|
/* Enable PLL System Clock output. */
|
|
__HAL_RCC_PLLCLKOUT_ENABLE(RCC_PLL_SYSCLK);
|
|
8003a52: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8003a56: 68db ldr r3, [r3, #12]
|
|
8003a58: f04f 42b0 mov.w r2, #1476395008 @ 0x58000000
|
|
8003a5c: f043 5380 orr.w r3, r3, #268435456 @ 0x10000000
|
|
8003a60: 60d3 str r3, [r2, #12]
|
|
|
|
/* Get Start Tick */
|
|
tickstart = HAL_GetTick();
|
|
8003a62: f7fd f8f1 bl 8000c48 <HAL_GetTick>
|
|
8003a66: 6178 str r0, [r7, #20]
|
|
|
|
/* Wait till PLL is ready */
|
|
while (LL_RCC_PLL_IsReady() == 0U)
|
|
8003a68: e008 b.n 8003a7c <HAL_RCC_OscConfig+0x658>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > PLL_TIMEOUT_VALUE)
|
|
8003a6a: f7fd f8ed bl 8000c48 <HAL_GetTick>
|
|
8003a6e: 4602 mov r2, r0
|
|
8003a70: 697b ldr r3, [r7, #20]
|
|
8003a72: 1ad3 subs r3, r2, r3
|
|
8003a74: 2b0a cmp r3, #10
|
|
8003a76: d901 bls.n 8003a7c <HAL_RCC_OscConfig+0x658>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
8003a78: 2303 movs r3, #3
|
|
8003a7a: e04c b.n 8003b16 <HAL_RCC_OscConfig+0x6f2>
|
|
while (LL_RCC_PLL_IsReady() == 0U)
|
|
8003a7c: f7ff fc3c bl 80032f8 <LL_RCC_PLL_IsReady>
|
|
8003a80: 4603 mov r3, r0
|
|
8003a82: 2b00 cmp r3, #0
|
|
8003a84: d0f1 beq.n 8003a6a <HAL_RCC_OscConfig+0x646>
|
|
8003a86: e045 b.n 8003b14 <HAL_RCC_OscConfig+0x6f0>
|
|
}
|
|
}
|
|
else
|
|
{
|
|
/* Disable the main PLL. */
|
|
__HAL_RCC_PLL_DISABLE();
|
|
8003a88: f7ff fc28 bl 80032dc <LL_RCC_PLL_Disable>
|
|
|
|
/* Get Start Tick */
|
|
tickstart = HAL_GetTick();
|
|
8003a8c: f7fd f8dc bl 8000c48 <HAL_GetTick>
|
|
8003a90: 6178 str r0, [r7, #20]
|
|
|
|
/* Wait till PLL is disabled */
|
|
while (LL_RCC_PLL_IsReady() != 0U)
|
|
8003a92: e008 b.n 8003aa6 <HAL_RCC_OscConfig+0x682>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > PLL_TIMEOUT_VALUE)
|
|
8003a94: f7fd f8d8 bl 8000c48 <HAL_GetTick>
|
|
8003a98: 4602 mov r2, r0
|
|
8003a9a: 697b ldr r3, [r7, #20]
|
|
8003a9c: 1ad3 subs r3, r2, r3
|
|
8003a9e: 2b0a cmp r3, #10
|
|
8003aa0: d901 bls.n 8003aa6 <HAL_RCC_OscConfig+0x682>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
8003aa2: 2303 movs r3, #3
|
|
8003aa4: e037 b.n 8003b16 <HAL_RCC_OscConfig+0x6f2>
|
|
while (LL_RCC_PLL_IsReady() != 0U)
|
|
8003aa6: f7ff fc27 bl 80032f8 <LL_RCC_PLL_IsReady>
|
|
8003aaa: 4603 mov r3, r0
|
|
8003aac: 2b00 cmp r3, #0
|
|
8003aae: d1f1 bne.n 8003a94 <HAL_RCC_OscConfig+0x670>
|
|
}
|
|
}
|
|
|
|
/* Disable the PLL source and outputs to save power when PLL is off */
|
|
CLEAR_BIT(RCC->PLLCFGR, (RCC_PLLCFGR_PLLSRC | RCC_PLLCFGR_PLLPEN | RCC_PLLCFGR_PLLQEN | RCC_PLLCFGR_PLLREN));
|
|
8003ab0: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8003ab4: 68da ldr r2, [r3, #12]
|
|
8003ab6: f04f 41b0 mov.w r1, #1476395008 @ 0x58000000
|
|
8003aba: 4b1a ldr r3, [pc, #104] @ (8003b24 <HAL_RCC_OscConfig+0x700>)
|
|
8003abc: 4013 ands r3, r2
|
|
8003abe: 60cb str r3, [r1, #12]
|
|
8003ac0: e028 b.n 8003b14 <HAL_RCC_OscConfig+0x6f0>
|
|
}
|
|
}
|
|
else
|
|
{
|
|
/* Check if there is a request to disable the PLL used as System clock source */
|
|
if ((RCC_OscInitStruct->PLL.PLLState) == RCC_PLL_OFF)
|
|
8003ac2: 687b ldr r3, [r7, #4]
|
|
8003ac4: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
8003ac6: 2b01 cmp r3, #1
|
|
8003ac8: d101 bne.n 8003ace <HAL_RCC_OscConfig+0x6aa>
|
|
{
|
|
return HAL_ERROR;
|
|
8003aca: 2301 movs r3, #1
|
|
8003acc: e023 b.n 8003b16 <HAL_RCC_OscConfig+0x6f2>
|
|
}
|
|
else
|
|
{
|
|
/* Do not return HAL_ERROR if request repeats the current configuration */
|
|
pll_config = RCC->PLLCFGR;
|
|
8003ace: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8003ad2: 68db ldr r3, [r3, #12]
|
|
8003ad4: 61bb str r3, [r7, #24]
|
|
if ((READ_BIT(pll_config, RCC_PLLCFGR_PLLSRC) != RCC_OscInitStruct->PLL.PLLSource)
|
|
8003ad6: 69bb ldr r3, [r7, #24]
|
|
8003ad8: f003 0203 and.w r2, r3, #3
|
|
8003adc: 687b ldr r3, [r7, #4]
|
|
8003ade: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
8003ae0: 429a cmp r2, r3
|
|
8003ae2: d115 bne.n 8003b10 <HAL_RCC_OscConfig+0x6ec>
|
|
|| (READ_BIT(pll_config, RCC_PLLCFGR_PLLM) != RCC_OscInitStruct->PLL.PLLM)
|
|
8003ae4: 69bb ldr r3, [r7, #24]
|
|
8003ae6: f003 0270 and.w r2, r3, #112 @ 0x70
|
|
8003aea: 687b ldr r3, [r7, #4]
|
|
8003aec: 6b5b ldr r3, [r3, #52] @ 0x34
|
|
8003aee: 429a cmp r2, r3
|
|
8003af0: d10e bne.n 8003b10 <HAL_RCC_OscConfig+0x6ec>
|
|
|| (READ_BIT(pll_config, RCC_PLLCFGR_PLLN) != (RCC_OscInitStruct->PLL.PLLN << RCC_PLLCFGR_PLLN_Pos))
|
|
8003af2: 69bb ldr r3, [r7, #24]
|
|
8003af4: f403 42fe and.w r2, r3, #32512 @ 0x7f00
|
|
8003af8: 687b ldr r3, [r7, #4]
|
|
8003afa: 6b9b ldr r3, [r3, #56] @ 0x38
|
|
8003afc: 021b lsls r3, r3, #8
|
|
8003afe: 429a cmp r2, r3
|
|
8003b00: d106 bne.n 8003b10 <HAL_RCC_OscConfig+0x6ec>
|
|
|| (READ_BIT(pll_config, RCC_PLLCFGR_PLLR) != RCC_OscInitStruct->PLL.PLLR))
|
|
8003b02: 69bb ldr r3, [r7, #24]
|
|
8003b04: f003 4260 and.w r2, r3, #3758096384 @ 0xe0000000
|
|
8003b08: 687b ldr r3, [r7, #4]
|
|
8003b0a: 6c5b ldr r3, [r3, #68] @ 0x44
|
|
8003b0c: 429a cmp r2, r3
|
|
8003b0e: d001 beq.n 8003b14 <HAL_RCC_OscConfig+0x6f0>
|
|
{
|
|
return HAL_ERROR;
|
|
8003b10: 2301 movs r3, #1
|
|
8003b12: e000 b.n 8003b16 <HAL_RCC_OscConfig+0x6f2>
|
|
}
|
|
}
|
|
}
|
|
}
|
|
return HAL_OK;
|
|
8003b14: 2300 movs r3, #0
|
|
}
|
|
8003b16: 4618 mov r0, r3
|
|
8003b18: 3720 adds r7, #32
|
|
8003b1a: 46bd mov sp, r7
|
|
8003b1c: bd80 pop {r7, pc}
|
|
8003b1e: bf00 nop
|
|
8003b20: 11c1808c .word 0x11c1808c
|
|
8003b24: eefefffc .word 0xeefefffc
|
|
|
|
08003b28 <HAL_RCC_ClockConfig>:
|
|
* HPRE[3:0] bits to ensure that HCLK1 not exceed the maximum allowed frequency
|
|
* (for more details refer to section above "Initialization/de-initialization functions")
|
|
* @retval None
|
|
*/
|
|
HAL_StatusTypeDef HAL_RCC_ClockConfig(RCC_ClkInitTypeDef *RCC_ClkInitStruct, uint32_t FLatency)
|
|
{
|
|
8003b28: b580 push {r7, lr}
|
|
8003b2a: b084 sub sp, #16
|
|
8003b2c: af00 add r7, sp, #0
|
|
8003b2e: 6078 str r0, [r7, #4]
|
|
8003b30: 6039 str r1, [r7, #0]
|
|
uint32_t tickstart;
|
|
|
|
/* Check Null pointer */
|
|
if (RCC_ClkInitStruct == NULL)
|
|
8003b32: 687b ldr r3, [r7, #4]
|
|
8003b34: 2b00 cmp r3, #0
|
|
8003b36: d101 bne.n 8003b3c <HAL_RCC_ClockConfig+0x14>
|
|
{
|
|
return HAL_ERROR;
|
|
8003b38: 2301 movs r3, #1
|
|
8003b3a: e12c b.n 8003d96 <HAL_RCC_ClockConfig+0x26e>
|
|
/* To correctly read data from FLASH memory, the number of wait states (LATENCY)
|
|
must be correctly programmed according to the frequency of the FLASH clock
|
|
(HCLK3) and the supply voltage of the device. */
|
|
|
|
/* Increasing the number of wait states because of higher CPU frequency */
|
|
if (FLatency > __HAL_FLASH_GET_LATENCY())
|
|
8003b3c: 4b98 ldr r3, [pc, #608] @ (8003da0 <HAL_RCC_ClockConfig+0x278>)
|
|
8003b3e: 681b ldr r3, [r3, #0]
|
|
8003b40: f003 0307 and.w r3, r3, #7
|
|
8003b44: 683a ldr r2, [r7, #0]
|
|
8003b46: 429a cmp r2, r3
|
|
8003b48: d91b bls.n 8003b82 <HAL_RCC_ClockConfig+0x5a>
|
|
{
|
|
/* Program the new number of wait states to the LATENCY bits in the FLASH_ACR register */
|
|
__HAL_FLASH_SET_LATENCY(FLatency);
|
|
8003b4a: 4b95 ldr r3, [pc, #596] @ (8003da0 <HAL_RCC_ClockConfig+0x278>)
|
|
8003b4c: 681b ldr r3, [r3, #0]
|
|
8003b4e: f023 0207 bic.w r2, r3, #7
|
|
8003b52: 4993 ldr r1, [pc, #588] @ (8003da0 <HAL_RCC_ClockConfig+0x278>)
|
|
8003b54: 683b ldr r3, [r7, #0]
|
|
8003b56: 4313 orrs r3, r2
|
|
8003b58: 600b str r3, [r1, #0]
|
|
|
|
/* Get Start Tick */
|
|
tickstart = HAL_GetTick();
|
|
8003b5a: f7fd f875 bl 8000c48 <HAL_GetTick>
|
|
8003b5e: 60f8 str r0, [r7, #12]
|
|
|
|
/* Check that the new number of wait states is taken into account to access the Flash
|
|
memory by reading the FLASH_ACR register */
|
|
while (__HAL_FLASH_GET_LATENCY() != FLatency)
|
|
8003b60: e008 b.n 8003b74 <HAL_RCC_ClockConfig+0x4c>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > LATENCY_TIMEOUT_VALUE)
|
|
8003b62: f7fd f871 bl 8000c48 <HAL_GetTick>
|
|
8003b66: 4602 mov r2, r0
|
|
8003b68: 68fb ldr r3, [r7, #12]
|
|
8003b6a: 1ad3 subs r3, r2, r3
|
|
8003b6c: 2b02 cmp r3, #2
|
|
8003b6e: d901 bls.n 8003b74 <HAL_RCC_ClockConfig+0x4c>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
8003b70: 2303 movs r3, #3
|
|
8003b72: e110 b.n 8003d96 <HAL_RCC_ClockConfig+0x26e>
|
|
while (__HAL_FLASH_GET_LATENCY() != FLatency)
|
|
8003b74: 4b8a ldr r3, [pc, #552] @ (8003da0 <HAL_RCC_ClockConfig+0x278>)
|
|
8003b76: 681b ldr r3, [r3, #0]
|
|
8003b78: f003 0307 and.w r3, r3, #7
|
|
8003b7c: 683a ldr r2, [r7, #0]
|
|
8003b7e: 429a cmp r2, r3
|
|
8003b80: d1ef bne.n 8003b62 <HAL_RCC_ClockConfig+0x3a>
|
|
}
|
|
}
|
|
}
|
|
|
|
/*-------------------------- HCLK1 Configuration ---------------------------*/
|
|
if (((RCC_ClkInitStruct->ClockType) & RCC_CLOCKTYPE_HCLK) == RCC_CLOCKTYPE_HCLK)
|
|
8003b82: 687b ldr r3, [r7, #4]
|
|
8003b84: 681b ldr r3, [r3, #0]
|
|
8003b86: f003 0302 and.w r3, r3, #2
|
|
8003b8a: 2b00 cmp r3, #0
|
|
8003b8c: d016 beq.n 8003bbc <HAL_RCC_ClockConfig+0x94>
|
|
{
|
|
assert_param(IS_RCC_HCLKx(RCC_ClkInitStruct->AHBCLKDivider));
|
|
LL_RCC_SetAHBPrescaler(RCC_ClkInitStruct->AHBCLKDivider);
|
|
8003b8e: 687b ldr r3, [r7, #4]
|
|
8003b90: 689b ldr r3, [r3, #8]
|
|
8003b92: 4618 mov r0, r3
|
|
8003b94: f7ff fb02 bl 800319c <LL_RCC_SetAHBPrescaler>
|
|
|
|
/* HCLK1 prescaler flag when value applied */
|
|
tickstart = HAL_GetTick();
|
|
8003b98: f7fd f856 bl 8000c48 <HAL_GetTick>
|
|
8003b9c: 60f8 str r0, [r7, #12]
|
|
while (LL_RCC_IsActiveFlag_HPRE() == 0U)
|
|
8003b9e: e008 b.n 8003bb2 <HAL_RCC_ClockConfig+0x8a>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > PRESCALER_TIMEOUT_VALUE)
|
|
8003ba0: f7fd f852 bl 8000c48 <HAL_GetTick>
|
|
8003ba4: 4602 mov r2, r0
|
|
8003ba6: 68fb ldr r3, [r7, #12]
|
|
8003ba8: 1ad3 subs r3, r2, r3
|
|
8003baa: 2b02 cmp r3, #2
|
|
8003bac: d901 bls.n 8003bb2 <HAL_RCC_ClockConfig+0x8a>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
8003bae: 2303 movs r3, #3
|
|
8003bb0: e0f1 b.n 8003d96 <HAL_RCC_ClockConfig+0x26e>
|
|
while (LL_RCC_IsActiveFlag_HPRE() == 0U)
|
|
8003bb2: f7ff fbdf bl 8003374 <LL_RCC_IsActiveFlag_HPRE>
|
|
8003bb6: 4603 mov r3, r0
|
|
8003bb8: 2b00 cmp r3, #0
|
|
8003bba: d0f1 beq.n 8003ba0 <HAL_RCC_ClockConfig+0x78>
|
|
}
|
|
}
|
|
|
|
#if defined(DUAL_CORE)
|
|
/*-------------------------- HCLK2 Configuration ---------------------------*/
|
|
if (((RCC_ClkInitStruct->ClockType) & RCC_CLOCKTYPE_HCLK2) == RCC_CLOCKTYPE_HCLK2)
|
|
8003bbc: 687b ldr r3, [r7, #4]
|
|
8003bbe: 681b ldr r3, [r3, #0]
|
|
8003bc0: f003 0320 and.w r3, r3, #32
|
|
8003bc4: 2b00 cmp r3, #0
|
|
8003bc6: d016 beq.n 8003bf6 <HAL_RCC_ClockConfig+0xce>
|
|
{
|
|
assert_param(IS_RCC_HCLKx(RCC_ClkInitStruct->AHBCLK2Divider));
|
|
LL_C2_RCC_SetAHBPrescaler(RCC_ClkInitStruct->AHBCLK2Divider);
|
|
8003bc8: 687b ldr r3, [r7, #4]
|
|
8003bca: 695b ldr r3, [r3, #20]
|
|
8003bcc: 4618 mov r0, r3
|
|
8003bce: f7ff faf8 bl 80031c2 <LL_C2_RCC_SetAHBPrescaler>
|
|
|
|
/* HCLK2 prescaler flag when value applied */
|
|
tickstart = HAL_GetTick();
|
|
8003bd2: f7fd f839 bl 8000c48 <HAL_GetTick>
|
|
8003bd6: 60f8 str r0, [r7, #12]
|
|
while (LL_RCC_IsActiveFlag_C2HPRE() == 0U)
|
|
8003bd8: e008 b.n 8003bec <HAL_RCC_ClockConfig+0xc4>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > PRESCALER_TIMEOUT_VALUE)
|
|
8003bda: f7fd f835 bl 8000c48 <HAL_GetTick>
|
|
8003bde: 4602 mov r2, r0
|
|
8003be0: 68fb ldr r3, [r7, #12]
|
|
8003be2: 1ad3 subs r3, r2, r3
|
|
8003be4: 2b02 cmp r3, #2
|
|
8003be6: d901 bls.n 8003bec <HAL_RCC_ClockConfig+0xc4>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
8003be8: 2303 movs r3, #3
|
|
8003bea: e0d4 b.n 8003d96 <HAL_RCC_ClockConfig+0x26e>
|
|
while (LL_RCC_IsActiveFlag_C2HPRE() == 0U)
|
|
8003bec: f7ff fbd3 bl 8003396 <LL_RCC_IsActiveFlag_C2HPRE>
|
|
8003bf0: 4603 mov r3, r0
|
|
8003bf2: 2b00 cmp r3, #0
|
|
8003bf4: d0f1 beq.n 8003bda <HAL_RCC_ClockConfig+0xb2>
|
|
}
|
|
}
|
|
#endif /* DUAL_CORE */
|
|
|
|
/*-------------------------- HCLK3 Configuration ---------------------------*/
|
|
if (((RCC_ClkInitStruct->ClockType) & RCC_CLOCKTYPE_HCLK3) == RCC_CLOCKTYPE_HCLK3)
|
|
8003bf6: 687b ldr r3, [r7, #4]
|
|
8003bf8: 681b ldr r3, [r3, #0]
|
|
8003bfa: f003 0340 and.w r3, r3, #64 @ 0x40
|
|
8003bfe: 2b00 cmp r3, #0
|
|
8003c00: d016 beq.n 8003c30 <HAL_RCC_ClockConfig+0x108>
|
|
{
|
|
assert_param(IS_RCC_HCLKx(RCC_ClkInitStruct->AHBCLK3Divider));
|
|
LL_RCC_SetAHB3Prescaler(RCC_ClkInitStruct->AHBCLK3Divider);
|
|
8003c02: 687b ldr r3, [r7, #4]
|
|
8003c04: 699b ldr r3, [r3, #24]
|
|
8003c06: 4618 mov r0, r3
|
|
8003c08: f7ff faf0 bl 80031ec <LL_RCC_SetAHB3Prescaler>
|
|
|
|
/* AHB shared prescaler flag when value applied */
|
|
tickstart = HAL_GetTick();
|
|
8003c0c: f7fd f81c bl 8000c48 <HAL_GetTick>
|
|
8003c10: 60f8 str r0, [r7, #12]
|
|
while (LL_RCC_IsActiveFlag_SHDHPRE() == 0U)
|
|
8003c12: e008 b.n 8003c26 <HAL_RCC_ClockConfig+0xfe>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > PRESCALER_TIMEOUT_VALUE)
|
|
8003c14: f7fd f818 bl 8000c48 <HAL_GetTick>
|
|
8003c18: 4602 mov r2, r0
|
|
8003c1a: 68fb ldr r3, [r7, #12]
|
|
8003c1c: 1ad3 subs r3, r2, r3
|
|
8003c1e: 2b02 cmp r3, #2
|
|
8003c20: d901 bls.n 8003c26 <HAL_RCC_ClockConfig+0xfe>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
8003c22: 2303 movs r3, #3
|
|
8003c24: e0b7 b.n 8003d96 <HAL_RCC_ClockConfig+0x26e>
|
|
while (LL_RCC_IsActiveFlag_SHDHPRE() == 0U)
|
|
8003c26: f7ff fbc8 bl 80033ba <LL_RCC_IsActiveFlag_SHDHPRE>
|
|
8003c2a: 4603 mov r3, r0
|
|
8003c2c: 2b00 cmp r3, #0
|
|
8003c2e: d0f1 beq.n 8003c14 <HAL_RCC_ClockConfig+0xec>
|
|
}
|
|
}
|
|
}
|
|
|
|
/*-------------------------- PCLK1 Configuration ---------------------------*/
|
|
if (((RCC_ClkInitStruct->ClockType) & RCC_CLOCKTYPE_PCLK1) == RCC_CLOCKTYPE_PCLK1)
|
|
8003c30: 687b ldr r3, [r7, #4]
|
|
8003c32: 681b ldr r3, [r3, #0]
|
|
8003c34: f003 0304 and.w r3, r3, #4
|
|
8003c38: 2b00 cmp r3, #0
|
|
8003c3a: d016 beq.n 8003c6a <HAL_RCC_ClockConfig+0x142>
|
|
{
|
|
assert_param(IS_RCC_PCLKx(RCC_ClkInitStruct->APB1CLKDivider));
|
|
LL_RCC_SetAPB1Prescaler(RCC_ClkInitStruct->APB1CLKDivider);
|
|
8003c3c: 687b ldr r3, [r7, #4]
|
|
8003c3e: 68db ldr r3, [r3, #12]
|
|
8003c40: 4618 mov r0, r3
|
|
8003c42: f7ff fae9 bl 8003218 <LL_RCC_SetAPB1Prescaler>
|
|
|
|
/* APB1 prescaler flag when value applied */
|
|
tickstart = HAL_GetTick();
|
|
8003c46: f7fc ffff bl 8000c48 <HAL_GetTick>
|
|
8003c4a: 60f8 str r0, [r7, #12]
|
|
while (LL_RCC_IsActiveFlag_PPRE1() == 0U)
|
|
8003c4c: e008 b.n 8003c60 <HAL_RCC_ClockConfig+0x138>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > PRESCALER_TIMEOUT_VALUE)
|
|
8003c4e: f7fc fffb bl 8000c48 <HAL_GetTick>
|
|
8003c52: 4602 mov r2, r0
|
|
8003c54: 68fb ldr r3, [r7, #12]
|
|
8003c56: 1ad3 subs r3, r2, r3
|
|
8003c58: 2b02 cmp r3, #2
|
|
8003c5a: d901 bls.n 8003c60 <HAL_RCC_ClockConfig+0x138>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
8003c5c: 2303 movs r3, #3
|
|
8003c5e: e09a b.n 8003d96 <HAL_RCC_ClockConfig+0x26e>
|
|
while (LL_RCC_IsActiveFlag_PPRE1() == 0U)
|
|
8003c60: f7ff fbbd bl 80033de <LL_RCC_IsActiveFlag_PPRE1>
|
|
8003c64: 4603 mov r3, r0
|
|
8003c66: 2b00 cmp r3, #0
|
|
8003c68: d0f1 beq.n 8003c4e <HAL_RCC_ClockConfig+0x126>
|
|
}
|
|
}
|
|
}
|
|
|
|
/*-------------------------- PCLK2 Configuration ---------------------------*/
|
|
if (((RCC_ClkInitStruct->ClockType) & RCC_CLOCKTYPE_PCLK2) == RCC_CLOCKTYPE_PCLK2)
|
|
8003c6a: 687b ldr r3, [r7, #4]
|
|
8003c6c: 681b ldr r3, [r3, #0]
|
|
8003c6e: f003 0308 and.w r3, r3, #8
|
|
8003c72: 2b00 cmp r3, #0
|
|
8003c74: d017 beq.n 8003ca6 <HAL_RCC_ClockConfig+0x17e>
|
|
{
|
|
assert_param(IS_RCC_PCLKx(RCC_ClkInitStruct->APB2CLKDivider));
|
|
LL_RCC_SetAPB2Prescaler((RCC_ClkInitStruct->APB2CLKDivider) << 3U);
|
|
8003c76: 687b ldr r3, [r7, #4]
|
|
8003c78: 691b ldr r3, [r3, #16]
|
|
8003c7a: 00db lsls r3, r3, #3
|
|
8003c7c: 4618 mov r0, r3
|
|
8003c7e: f7ff fade bl 800323e <LL_RCC_SetAPB2Prescaler>
|
|
|
|
/* APB2 prescaler flag when value applied */
|
|
tickstart = HAL_GetTick();
|
|
8003c82: f7fc ffe1 bl 8000c48 <HAL_GetTick>
|
|
8003c86: 60f8 str r0, [r7, #12]
|
|
while (LL_RCC_IsActiveFlag_PPRE2() == 0U)
|
|
8003c88: e008 b.n 8003c9c <HAL_RCC_ClockConfig+0x174>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > PRESCALER_TIMEOUT_VALUE)
|
|
8003c8a: f7fc ffdd bl 8000c48 <HAL_GetTick>
|
|
8003c8e: 4602 mov r2, r0
|
|
8003c90: 68fb ldr r3, [r7, #12]
|
|
8003c92: 1ad3 subs r3, r2, r3
|
|
8003c94: 2b02 cmp r3, #2
|
|
8003c96: d901 bls.n 8003c9c <HAL_RCC_ClockConfig+0x174>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
8003c98: 2303 movs r3, #3
|
|
8003c9a: e07c b.n 8003d96 <HAL_RCC_ClockConfig+0x26e>
|
|
while (LL_RCC_IsActiveFlag_PPRE2() == 0U)
|
|
8003c9c: f7ff fbb0 bl 8003400 <LL_RCC_IsActiveFlag_PPRE2>
|
|
8003ca0: 4603 mov r3, r0
|
|
8003ca2: 2b00 cmp r3, #0
|
|
8003ca4: d0f1 beq.n 8003c8a <HAL_RCC_ClockConfig+0x162>
|
|
}
|
|
}
|
|
}
|
|
|
|
/*------------------------- SYSCLK Configuration ---------------------------*/
|
|
if (((RCC_ClkInitStruct->ClockType) & RCC_CLOCKTYPE_SYSCLK) == RCC_CLOCKTYPE_SYSCLK)
|
|
8003ca6: 687b ldr r3, [r7, #4]
|
|
8003ca8: 681b ldr r3, [r3, #0]
|
|
8003caa: f003 0301 and.w r3, r3, #1
|
|
8003cae: 2b00 cmp r3, #0
|
|
8003cb0: d043 beq.n 8003d3a <HAL_RCC_ClockConfig+0x212>
|
|
{
|
|
assert_param(IS_RCC_SYSCLKSOURCE(RCC_ClkInitStruct->SYSCLKSource));
|
|
|
|
/* HSE is selected as System Clock Source */
|
|
if (RCC_ClkInitStruct->SYSCLKSource == RCC_SYSCLKSOURCE_HSE)
|
|
8003cb2: 687b ldr r3, [r7, #4]
|
|
8003cb4: 685b ldr r3, [r3, #4]
|
|
8003cb6: 2b02 cmp r3, #2
|
|
8003cb8: d106 bne.n 8003cc8 <HAL_RCC_ClockConfig+0x1a0>
|
|
{
|
|
/* Check the HSE ready flag */
|
|
if (LL_RCC_HSE_IsReady() == 0U)
|
|
8003cba: f7ff f956 bl 8002f6a <LL_RCC_HSE_IsReady>
|
|
8003cbe: 4603 mov r3, r0
|
|
8003cc0: 2b00 cmp r3, #0
|
|
8003cc2: d11e bne.n 8003d02 <HAL_RCC_ClockConfig+0x1da>
|
|
{
|
|
return HAL_ERROR;
|
|
8003cc4: 2301 movs r3, #1
|
|
8003cc6: e066 b.n 8003d96 <HAL_RCC_ClockConfig+0x26e>
|
|
}
|
|
}
|
|
/* PLL is selected as System Clock Source */
|
|
else if (RCC_ClkInitStruct->SYSCLKSource == RCC_SYSCLKSOURCE_PLLCLK)
|
|
8003cc8: 687b ldr r3, [r7, #4]
|
|
8003cca: 685b ldr r3, [r3, #4]
|
|
8003ccc: 2b03 cmp r3, #3
|
|
8003cce: d106 bne.n 8003cde <HAL_RCC_ClockConfig+0x1b6>
|
|
{
|
|
/* Check the PLL ready flag */
|
|
if (LL_RCC_PLL_IsReady() == 0U)
|
|
8003cd0: f7ff fb12 bl 80032f8 <LL_RCC_PLL_IsReady>
|
|
8003cd4: 4603 mov r3, r0
|
|
8003cd6: 2b00 cmp r3, #0
|
|
8003cd8: d113 bne.n 8003d02 <HAL_RCC_ClockConfig+0x1da>
|
|
{
|
|
return HAL_ERROR;
|
|
8003cda: 2301 movs r3, #1
|
|
8003cdc: e05b b.n 8003d96 <HAL_RCC_ClockConfig+0x26e>
|
|
}
|
|
}
|
|
/* MSI is selected as System Clock Source */
|
|
else if (RCC_ClkInitStruct->SYSCLKSource == RCC_SYSCLKSOURCE_MSI)
|
|
8003cde: 687b ldr r3, [r7, #4]
|
|
8003ce0: 685b ldr r3, [r3, #4]
|
|
8003ce2: 2b00 cmp r3, #0
|
|
8003ce4: d106 bne.n 8003cf4 <HAL_RCC_ClockConfig+0x1cc>
|
|
{
|
|
/* Check the MSI ready flag */
|
|
if (LL_RCC_MSI_IsReady() == 0U)
|
|
8003ce6: f7ff f9f0 bl 80030ca <LL_RCC_MSI_IsReady>
|
|
8003cea: 4603 mov r3, r0
|
|
8003cec: 2b00 cmp r3, #0
|
|
8003cee: d108 bne.n 8003d02 <HAL_RCC_ClockConfig+0x1da>
|
|
{
|
|
return HAL_ERROR;
|
|
8003cf0: 2301 movs r3, #1
|
|
8003cf2: e050 b.n 8003d96 <HAL_RCC_ClockConfig+0x26e>
|
|
}
|
|
/* HSI is selected as System Clock Source */
|
|
else
|
|
{
|
|
/* Check the HSI ready flag */
|
|
if (LL_RCC_HSI_IsReady() == 0U)
|
|
8003cf4: f7ff f966 bl 8002fc4 <LL_RCC_HSI_IsReady>
|
|
8003cf8: 4603 mov r3, r0
|
|
8003cfa: 2b00 cmp r3, #0
|
|
8003cfc: d101 bne.n 8003d02 <HAL_RCC_ClockConfig+0x1da>
|
|
{
|
|
return HAL_ERROR;
|
|
8003cfe: 2301 movs r3, #1
|
|
8003d00: e049 b.n 8003d96 <HAL_RCC_ClockConfig+0x26e>
|
|
}
|
|
|
|
}
|
|
|
|
/* apply system clock switch */
|
|
LL_RCC_SetSysClkSource(RCC_ClkInitStruct->SYSCLKSource);
|
|
8003d02: 687b ldr r3, [r7, #4]
|
|
8003d04: 685b ldr r3, [r3, #4]
|
|
8003d06: 4618 mov r0, r3
|
|
8003d08: f7ff fa2a bl 8003160 <LL_RCC_SetSysClkSource>
|
|
|
|
/* Get Start Tick */
|
|
tickstart = HAL_GetTick();
|
|
8003d0c: f7fc ff9c bl 8000c48 <HAL_GetTick>
|
|
8003d10: 60f8 str r0, [r7, #12]
|
|
|
|
/* check system clock source switch status */
|
|
while (__HAL_RCC_GET_SYSCLK_SOURCE() != (RCC_ClkInitStruct->SYSCLKSource << RCC_CFGR_SWS_Pos))
|
|
8003d12: e00a b.n 8003d2a <HAL_RCC_ClockConfig+0x202>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > CLOCKSWITCH_TIMEOUT_VALUE)
|
|
8003d14: f7fc ff98 bl 8000c48 <HAL_GetTick>
|
|
8003d18: 4602 mov r2, r0
|
|
8003d1a: 68fb ldr r3, [r7, #12]
|
|
8003d1c: 1ad3 subs r3, r2, r3
|
|
8003d1e: f241 3288 movw r2, #5000 @ 0x1388
|
|
8003d22: 4293 cmp r3, r2
|
|
8003d24: d901 bls.n 8003d2a <HAL_RCC_ClockConfig+0x202>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
8003d26: 2303 movs r3, #3
|
|
8003d28: e035 b.n 8003d96 <HAL_RCC_ClockConfig+0x26e>
|
|
while (__HAL_RCC_GET_SYSCLK_SOURCE() != (RCC_ClkInitStruct->SYSCLKSource << RCC_CFGR_SWS_Pos))
|
|
8003d2a: f7ff fa2c bl 8003186 <LL_RCC_GetSysClkSource>
|
|
8003d2e: 4602 mov r2, r0
|
|
8003d30: 687b ldr r3, [r7, #4]
|
|
8003d32: 685b ldr r3, [r3, #4]
|
|
8003d34: 009b lsls r3, r3, #2
|
|
8003d36: 429a cmp r2, r3
|
|
8003d38: d1ec bne.n 8003d14 <HAL_RCC_ClockConfig+0x1ec>
|
|
}
|
|
}
|
|
}
|
|
|
|
/* Decreasing the number of wait states because of lower CPU frequency */
|
|
if (FLatency < __HAL_FLASH_GET_LATENCY())
|
|
8003d3a: 4b19 ldr r3, [pc, #100] @ (8003da0 <HAL_RCC_ClockConfig+0x278>)
|
|
8003d3c: 681b ldr r3, [r3, #0]
|
|
8003d3e: f003 0307 and.w r3, r3, #7
|
|
8003d42: 683a ldr r2, [r7, #0]
|
|
8003d44: 429a cmp r2, r3
|
|
8003d46: d21b bcs.n 8003d80 <HAL_RCC_ClockConfig+0x258>
|
|
{
|
|
/* Program the new number of wait states to the LATENCY bits in the FLASH_ACR register */
|
|
__HAL_FLASH_SET_LATENCY(FLatency);
|
|
8003d48: 4b15 ldr r3, [pc, #84] @ (8003da0 <HAL_RCC_ClockConfig+0x278>)
|
|
8003d4a: 681b ldr r3, [r3, #0]
|
|
8003d4c: f023 0207 bic.w r2, r3, #7
|
|
8003d50: 4913 ldr r1, [pc, #76] @ (8003da0 <HAL_RCC_ClockConfig+0x278>)
|
|
8003d52: 683b ldr r3, [r7, #0]
|
|
8003d54: 4313 orrs r3, r2
|
|
8003d56: 600b str r3, [r1, #0]
|
|
|
|
/* Get Start Tick */
|
|
tickstart = HAL_GetTick();
|
|
8003d58: f7fc ff76 bl 8000c48 <HAL_GetTick>
|
|
8003d5c: 60f8 str r0, [r7, #12]
|
|
|
|
/* Check that the new number of wait states is taken into account to access the Flash
|
|
memory by reading the FLASH_ACR register */
|
|
while (__HAL_FLASH_GET_LATENCY() != FLatency)
|
|
8003d5e: e008 b.n 8003d72 <HAL_RCC_ClockConfig+0x24a>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > LATENCY_TIMEOUT_VALUE)
|
|
8003d60: f7fc ff72 bl 8000c48 <HAL_GetTick>
|
|
8003d64: 4602 mov r2, r0
|
|
8003d66: 68fb ldr r3, [r7, #12]
|
|
8003d68: 1ad3 subs r3, r2, r3
|
|
8003d6a: 2b02 cmp r3, #2
|
|
8003d6c: d901 bls.n 8003d72 <HAL_RCC_ClockConfig+0x24a>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
8003d6e: 2303 movs r3, #3
|
|
8003d70: e011 b.n 8003d96 <HAL_RCC_ClockConfig+0x26e>
|
|
while (__HAL_FLASH_GET_LATENCY() != FLatency)
|
|
8003d72: 4b0b ldr r3, [pc, #44] @ (8003da0 <HAL_RCC_ClockConfig+0x278>)
|
|
8003d74: 681b ldr r3, [r3, #0]
|
|
8003d76: f003 0307 and.w r3, r3, #7
|
|
8003d7a: 683a ldr r2, [r7, #0]
|
|
8003d7c: 429a cmp r2, r3
|
|
8003d7e: d1ef bne.n 8003d60 <HAL_RCC_ClockConfig+0x238>
|
|
}
|
|
|
|
/*--------------------------------------------------------------------------*/
|
|
|
|
/* Update the SystemCoreClock global variable */
|
|
SystemCoreClock = HAL_RCC_GetHCLKFreq();
|
|
8003d80: f000 f8b4 bl 8003eec <HAL_RCC_GetHCLKFreq>
|
|
8003d84: 4603 mov r3, r0
|
|
8003d86: 4a07 ldr r2, [pc, #28] @ (8003da4 <HAL_RCC_ClockConfig+0x27c>)
|
|
8003d88: 6013 str r3, [r2, #0]
|
|
|
|
/* Configure the source of time base considering new system clocks settings */
|
|
return HAL_InitTick(uwTickPrio);
|
|
8003d8a: 4b07 ldr r3, [pc, #28] @ (8003da8 <HAL_RCC_ClockConfig+0x280>)
|
|
8003d8c: 681b ldr r3, [r3, #0]
|
|
8003d8e: 4618 mov r0, r3
|
|
8003d90: f7fc ff50 bl 8000c34 <HAL_InitTick>
|
|
8003d94: 4603 mov r3, r0
|
|
}
|
|
8003d96: 4618 mov r0, r3
|
|
8003d98: 3710 adds r7, #16
|
|
8003d9a: 46bd mov sp, r7
|
|
8003d9c: bd80 pop {r7, pc}
|
|
8003d9e: bf00 nop
|
|
8003da0: 58004000 .word 0x58004000
|
|
8003da4: 20000000 .word 0x20000000
|
|
8003da8: 20000004 .word 0x20000004
|
|
|
|
08003dac <HAL_RCC_GetSysClockFreq>:
|
|
*
|
|
*
|
|
* @retval SYSCLK frequency
|
|
*/
|
|
uint32_t HAL_RCC_GetSysClockFreq(void)
|
|
{
|
|
8003dac: b590 push {r4, r7, lr}
|
|
8003dae: b087 sub sp, #28
|
|
8003db0: af00 add r7, sp, #0
|
|
uint32_t sysclk_source;
|
|
uint32_t pllsource;
|
|
uint32_t sysclockfreq = 0U;
|
|
8003db2: 2300 movs r3, #0
|
|
8003db4: 617b str r3, [r7, #20]
|
|
uint32_t msifreq = 0U;
|
|
8003db6: 2300 movs r3, #0
|
|
8003db8: 613b str r3, [r7, #16]
|
|
uint32_t pllinputfreq;
|
|
|
|
sysclk_source = __HAL_RCC_GET_SYSCLK_SOURCE();
|
|
8003dba: f7ff f9e4 bl 8003186 <LL_RCC_GetSysClkSource>
|
|
8003dbe: 60b8 str r0, [r7, #8]
|
|
pllsource = __HAL_RCC_GET_PLL_OSCSOURCE();
|
|
8003dc0: f7ff facd bl 800335e <LL_RCC_PLL_GetMainSource>
|
|
8003dc4: 6078 str r0, [r7, #4]
|
|
|
|
if ((sysclk_source == RCC_SYSCLKSOURCE_STATUS_MSI) ||
|
|
8003dc6: 68bb ldr r3, [r7, #8]
|
|
8003dc8: 2b00 cmp r3, #0
|
|
8003dca: d005 beq.n 8003dd8 <HAL_RCC_GetSysClockFreq+0x2c>
|
|
8003dcc: 68bb ldr r3, [r7, #8]
|
|
8003dce: 2b0c cmp r3, #12
|
|
8003dd0: d139 bne.n 8003e46 <HAL_RCC_GetSysClockFreq+0x9a>
|
|
((sysclk_source == RCC_SYSCLKSOURCE_STATUS_PLLCLK) && (pllsource == RCC_PLLSOURCE_MSI)))
|
|
8003dd2: 687b ldr r3, [r7, #4]
|
|
8003dd4: 2b01 cmp r3, #1
|
|
8003dd6: d136 bne.n 8003e46 <HAL_RCC_GetSysClockFreq+0x9a>
|
|
{
|
|
/* MSI or PLL with MSI source used as system clock source */
|
|
/* Retrieve MSI frequency range in Hz */
|
|
msifreq = __LL_RCC_CALC_MSI_FREQ(LL_RCC_MSI_IsEnabledRangeSelect(),
|
|
8003dd8: f7ff f987 bl 80030ea <LL_RCC_MSI_IsEnabledRangeSelect>
|
|
8003ddc: 4603 mov r3, r0
|
|
8003dde: 2b00 cmp r3, #0
|
|
8003de0: d115 bne.n 8003e0e <HAL_RCC_GetSysClockFreq+0x62>
|
|
8003de2: f7ff f982 bl 80030ea <LL_RCC_MSI_IsEnabledRangeSelect>
|
|
8003de6: 4603 mov r3, r0
|
|
8003de8: 2b01 cmp r3, #1
|
|
8003dea: d106 bne.n 8003dfa <HAL_RCC_GetSysClockFreq+0x4e>
|
|
8003dec: f7ff f98d bl 800310a <LL_RCC_MSI_GetRange>
|
|
8003df0: 4603 mov r3, r0
|
|
8003df2: 0a1b lsrs r3, r3, #8
|
|
8003df4: f003 030f and.w r3, r3, #15
|
|
8003df8: e005 b.n 8003e06 <HAL_RCC_GetSysClockFreq+0x5a>
|
|
8003dfa: f7ff f991 bl 8003120 <LL_RCC_MSI_GetRangeAfterStandby>
|
|
8003dfe: 4603 mov r3, r0
|
|
8003e00: 0a1b lsrs r3, r3, #8
|
|
8003e02: f003 030f and.w r3, r3, #15
|
|
8003e06: 4a36 ldr r2, [pc, #216] @ (8003ee0 <HAL_RCC_GetSysClockFreq+0x134>)
|
|
8003e08: f852 3023 ldr.w r3, [r2, r3, lsl #2]
|
|
8003e0c: e014 b.n 8003e38 <HAL_RCC_GetSysClockFreq+0x8c>
|
|
8003e0e: f7ff f96c bl 80030ea <LL_RCC_MSI_IsEnabledRangeSelect>
|
|
8003e12: 4603 mov r3, r0
|
|
8003e14: 2b01 cmp r3, #1
|
|
8003e16: d106 bne.n 8003e26 <HAL_RCC_GetSysClockFreq+0x7a>
|
|
8003e18: f7ff f977 bl 800310a <LL_RCC_MSI_GetRange>
|
|
8003e1c: 4603 mov r3, r0
|
|
8003e1e: 091b lsrs r3, r3, #4
|
|
8003e20: f003 030f and.w r3, r3, #15
|
|
8003e24: e005 b.n 8003e32 <HAL_RCC_GetSysClockFreq+0x86>
|
|
8003e26: f7ff f97b bl 8003120 <LL_RCC_MSI_GetRangeAfterStandby>
|
|
8003e2a: 4603 mov r3, r0
|
|
8003e2c: 091b lsrs r3, r3, #4
|
|
8003e2e: f003 030f and.w r3, r3, #15
|
|
8003e32: 4a2b ldr r2, [pc, #172] @ (8003ee0 <HAL_RCC_GetSysClockFreq+0x134>)
|
|
8003e34: f852 3023 ldr.w r3, [r2, r3, lsl #2]
|
|
8003e38: 613b str r3, [r7, #16]
|
|
((LL_RCC_MSI_IsEnabledRangeSelect() == 1U) ?
|
|
LL_RCC_MSI_GetRange() :
|
|
LL_RCC_MSI_GetRangeAfterStandby()));
|
|
|
|
/* Get SYSCLK source */
|
|
if (sysclk_source == RCC_SYSCLKSOURCE_STATUS_MSI)
|
|
8003e3a: 68bb ldr r3, [r7, #8]
|
|
8003e3c: 2b00 cmp r3, #0
|
|
8003e3e: d115 bne.n 8003e6c <HAL_RCC_GetSysClockFreq+0xc0>
|
|
{
|
|
/* MSI used as system clock source */
|
|
sysclockfreq = msifreq;
|
|
8003e40: 693b ldr r3, [r7, #16]
|
|
8003e42: 617b str r3, [r7, #20]
|
|
if (sysclk_source == RCC_SYSCLKSOURCE_STATUS_MSI)
|
|
8003e44: e012 b.n 8003e6c <HAL_RCC_GetSysClockFreq+0xc0>
|
|
}
|
|
}
|
|
else if (sysclk_source == RCC_SYSCLKSOURCE_STATUS_HSI)
|
|
8003e46: 68bb ldr r3, [r7, #8]
|
|
8003e48: 2b04 cmp r3, #4
|
|
8003e4a: d102 bne.n 8003e52 <HAL_RCC_GetSysClockFreq+0xa6>
|
|
{
|
|
/* HSI used as system clock source */
|
|
sysclockfreq = HSI_VALUE;
|
|
8003e4c: 4b25 ldr r3, [pc, #148] @ (8003ee4 <HAL_RCC_GetSysClockFreq+0x138>)
|
|
8003e4e: 617b str r3, [r7, #20]
|
|
8003e50: e00c b.n 8003e6c <HAL_RCC_GetSysClockFreq+0xc0>
|
|
}
|
|
else if (sysclk_source == RCC_SYSCLKSOURCE_STATUS_HSE)
|
|
8003e52: 68bb ldr r3, [r7, #8]
|
|
8003e54: 2b08 cmp r3, #8
|
|
8003e56: d109 bne.n 8003e6c <HAL_RCC_GetSysClockFreq+0xc0>
|
|
{
|
|
/* HSE used as system clock source */
|
|
if (LL_RCC_HSE_IsEnabledDiv2() == 1U)
|
|
8003e58: f7ff f85a bl 8002f10 <LL_RCC_HSE_IsEnabledDiv2>
|
|
8003e5c: 4603 mov r3, r0
|
|
8003e5e: 2b01 cmp r3, #1
|
|
8003e60: d102 bne.n 8003e68 <HAL_RCC_GetSysClockFreq+0xbc>
|
|
{
|
|
sysclockfreq = HSE_VALUE / 2U;
|
|
8003e62: 4b20 ldr r3, [pc, #128] @ (8003ee4 <HAL_RCC_GetSysClockFreq+0x138>)
|
|
8003e64: 617b str r3, [r7, #20]
|
|
8003e66: e001 b.n 8003e6c <HAL_RCC_GetSysClockFreq+0xc0>
|
|
}
|
|
else
|
|
{
|
|
sysclockfreq = HSE_VALUE;
|
|
8003e68: 4b1f ldr r3, [pc, #124] @ (8003ee8 <HAL_RCC_GetSysClockFreq+0x13c>)
|
|
8003e6a: 617b str r3, [r7, #20]
|
|
else
|
|
{
|
|
/* Nothing to do */
|
|
}
|
|
|
|
if (__HAL_RCC_GET_SYSCLK_SOURCE() == RCC_SYSCLKSOURCE_STATUS_PLLCLK)
|
|
8003e6c: f7ff f98b bl 8003186 <LL_RCC_GetSysClkSource>
|
|
8003e70: 4603 mov r3, r0
|
|
8003e72: 2b0c cmp r3, #12
|
|
8003e74: d12f bne.n 8003ed6 <HAL_RCC_GetSysClockFreq+0x12a>
|
|
{
|
|
/* PLL used as system clock source */
|
|
pllsource = LL_RCC_PLL_GetMainSource();
|
|
8003e76: f7ff fa72 bl 800335e <LL_RCC_PLL_GetMainSource>
|
|
8003e7a: 6078 str r0, [r7, #4]
|
|
|
|
switch (pllsource)
|
|
8003e7c: 687b ldr r3, [r7, #4]
|
|
8003e7e: 2b02 cmp r3, #2
|
|
8003e80: d003 beq.n 8003e8a <HAL_RCC_GetSysClockFreq+0xde>
|
|
8003e82: 687b ldr r3, [r7, #4]
|
|
8003e84: 2b03 cmp r3, #3
|
|
8003e86: d003 beq.n 8003e90 <HAL_RCC_GetSysClockFreq+0xe4>
|
|
8003e88: e00d b.n 8003ea6 <HAL_RCC_GetSysClockFreq+0xfa>
|
|
{
|
|
case RCC_PLLSOURCE_HSI: /* HSI used as PLL clock source */
|
|
pllinputfreq = HSI_VALUE;
|
|
8003e8a: 4b16 ldr r3, [pc, #88] @ (8003ee4 <HAL_RCC_GetSysClockFreq+0x138>)
|
|
8003e8c: 60fb str r3, [r7, #12]
|
|
break;
|
|
8003e8e: e00d b.n 8003eac <HAL_RCC_GetSysClockFreq+0x100>
|
|
case RCC_PLLSOURCE_HSE: /* HSE used as PLL clock source */
|
|
if (LL_RCC_HSE_IsEnabledDiv2() == 1U)
|
|
8003e90: f7ff f83e bl 8002f10 <LL_RCC_HSE_IsEnabledDiv2>
|
|
8003e94: 4603 mov r3, r0
|
|
8003e96: 2b01 cmp r3, #1
|
|
8003e98: d102 bne.n 8003ea0 <HAL_RCC_GetSysClockFreq+0xf4>
|
|
{
|
|
pllinputfreq = HSE_VALUE / 2U;
|
|
8003e9a: 4b12 ldr r3, [pc, #72] @ (8003ee4 <HAL_RCC_GetSysClockFreq+0x138>)
|
|
8003e9c: 60fb str r3, [r7, #12]
|
|
}
|
|
else
|
|
{
|
|
pllinputfreq = HSE_VALUE;
|
|
}
|
|
break;
|
|
8003e9e: e005 b.n 8003eac <HAL_RCC_GetSysClockFreq+0x100>
|
|
pllinputfreq = HSE_VALUE;
|
|
8003ea0: 4b11 ldr r3, [pc, #68] @ (8003ee8 <HAL_RCC_GetSysClockFreq+0x13c>)
|
|
8003ea2: 60fb str r3, [r7, #12]
|
|
break;
|
|
8003ea4: e002 b.n 8003eac <HAL_RCC_GetSysClockFreq+0x100>
|
|
case RCC_PLLSOURCE_MSI: /* MSI used as PLL clock source */
|
|
default:
|
|
pllinputfreq = msifreq;
|
|
8003ea6: 693b ldr r3, [r7, #16]
|
|
8003ea8: 60fb str r3, [r7, #12]
|
|
break;
|
|
8003eaa: bf00 nop
|
|
}
|
|
sysclockfreq = __LL_RCC_CALC_PLLCLK_FREQ(pllinputfreq, LL_RCC_PLL_GetDivider(),
|
|
8003eac: f7ff fa35 bl 800331a <LL_RCC_PLL_GetN>
|
|
8003eb0: 4602 mov r2, r0
|
|
8003eb2: 68fb ldr r3, [r7, #12]
|
|
8003eb4: fb03 f402 mul.w r4, r3, r2
|
|
8003eb8: f7ff fa46 bl 8003348 <LL_RCC_PLL_GetDivider>
|
|
8003ebc: 4603 mov r3, r0
|
|
8003ebe: 091b lsrs r3, r3, #4
|
|
8003ec0: 3301 adds r3, #1
|
|
8003ec2: fbb4 f4f3 udiv r4, r4, r3
|
|
8003ec6: f7ff fa34 bl 8003332 <LL_RCC_PLL_GetR>
|
|
8003eca: 4603 mov r3, r0
|
|
8003ecc: 0f5b lsrs r3, r3, #29
|
|
8003ece: 3301 adds r3, #1
|
|
8003ed0: fbb4 f3f3 udiv r3, r4, r3
|
|
8003ed4: 617b str r3, [r7, #20]
|
|
LL_RCC_PLL_GetN(), LL_RCC_PLL_GetR());
|
|
}
|
|
|
|
return sysclockfreq;
|
|
8003ed6: 697b ldr r3, [r7, #20]
|
|
}
|
|
8003ed8: 4618 mov r0, r3
|
|
8003eda: 371c adds r7, #28
|
|
8003edc: 46bd mov sp, r7
|
|
8003ede: bd90 pop {r4, r7, pc}
|
|
8003ee0: 0801030c .word 0x0801030c
|
|
8003ee4: 00f42400 .word 0x00f42400
|
|
8003ee8: 01e84800 .word 0x01e84800
|
|
|
|
08003eec <HAL_RCC_GetHCLKFreq>:
|
|
/**
|
|
* @brief Return the HCLK frequency.
|
|
* @retval HCLK frequency in Hz
|
|
*/
|
|
uint32_t HAL_RCC_GetHCLKFreq(void)
|
|
{
|
|
8003eec: b598 push {r3, r4, r7, lr}
|
|
8003eee: af00 add r7, sp, #0
|
|
/* Get SysClock and Compute HCLK1 frequency --------------------------------*/
|
|
return ((uint32_t)(__LL_RCC_CALC_HCLK1_FREQ(HAL_RCC_GetSysClockFreq(), LL_RCC_GetAHBPrescaler())));
|
|
8003ef0: f7ff ff5c bl 8003dac <HAL_RCC_GetSysClockFreq>
|
|
8003ef4: 4604 mov r4, r0
|
|
8003ef6: f7ff f9b5 bl 8003264 <LL_RCC_GetAHBPrescaler>
|
|
8003efa: 4603 mov r3, r0
|
|
8003efc: 091b lsrs r3, r3, #4
|
|
8003efe: f003 030f and.w r3, r3, #15
|
|
8003f02: 4a03 ldr r2, [pc, #12] @ (8003f10 <HAL_RCC_GetHCLKFreq+0x24>)
|
|
8003f04: f852 3023 ldr.w r3, [r2, r3, lsl #2]
|
|
8003f08: fbb4 f3f3 udiv r3, r4, r3
|
|
}
|
|
8003f0c: 4618 mov r0, r3
|
|
8003f0e: bd98 pop {r3, r4, r7, pc}
|
|
8003f10: 080102ac .word 0x080102ac
|
|
|
|
08003f14 <HAL_RCC_GetPCLK1Freq>:
|
|
/**
|
|
* @brief Return the PCLK1 frequency.
|
|
* @retval PCLK1 frequency in Hz
|
|
*/
|
|
uint32_t HAL_RCC_GetPCLK1Freq(void)
|
|
{
|
|
8003f14: b598 push {r3, r4, r7, lr}
|
|
8003f16: af00 add r7, sp, #0
|
|
/* Get HCLK source and Compute PCLK1 frequency -----------------------------*/
|
|
return ((uint32_t)(__LL_RCC_CALC_PCLK1_FREQ(HAL_RCC_GetHCLKFreq(), LL_RCC_GetAPB1Prescaler())));
|
|
8003f18: f7ff ffe8 bl 8003eec <HAL_RCC_GetHCLKFreq>
|
|
8003f1c: 4604 mov r4, r0
|
|
8003f1e: f7ff f9b9 bl 8003294 <LL_RCC_GetAPB1Prescaler>
|
|
8003f22: 4603 mov r3, r0
|
|
8003f24: 0a1b lsrs r3, r3, #8
|
|
8003f26: 4a03 ldr r2, [pc, #12] @ (8003f34 <HAL_RCC_GetPCLK1Freq+0x20>)
|
|
8003f28: f852 3023 ldr.w r3, [r2, r3, lsl #2]
|
|
8003f2c: fa24 f303 lsr.w r3, r4, r3
|
|
}
|
|
8003f30: 4618 mov r0, r3
|
|
8003f32: bd98 pop {r3, r4, r7, pc}
|
|
8003f34: 080102ec .word 0x080102ec
|
|
|
|
08003f38 <HAL_RCC_GetPCLK2Freq>:
|
|
/**
|
|
* @brief Return the PCLK2 frequency.
|
|
* @retval PCLK2 frequency in Hz
|
|
*/
|
|
uint32_t HAL_RCC_GetPCLK2Freq(void)
|
|
{
|
|
8003f38: b598 push {r3, r4, r7, lr}
|
|
8003f3a: af00 add r7, sp, #0
|
|
/* Get HCLK source and Compute PCLK2 frequency -----------------------------*/
|
|
return ((uint32_t)(__LL_RCC_CALC_PCLK2_FREQ(HAL_RCC_GetHCLKFreq(), LL_RCC_GetAPB2Prescaler())));
|
|
8003f3c: f7ff ffd6 bl 8003eec <HAL_RCC_GetHCLKFreq>
|
|
8003f40: 4604 mov r4, r0
|
|
8003f42: f7ff f9b2 bl 80032aa <LL_RCC_GetAPB2Prescaler>
|
|
8003f46: 4603 mov r3, r0
|
|
8003f48: 0adb lsrs r3, r3, #11
|
|
8003f4a: 4a03 ldr r2, [pc, #12] @ (8003f58 <HAL_RCC_GetPCLK2Freq+0x20>)
|
|
8003f4c: f852 3023 ldr.w r3, [r2, r3, lsl #2]
|
|
8003f50: fa24 f303 lsr.w r3, r4, r3
|
|
}
|
|
8003f54: 4618 mov r0, r3
|
|
8003f56: bd98 pop {r3, r4, r7, pc}
|
|
8003f58: 080102ec .word 0x080102ec
|
|
|
|
08003f5c <RCC_SetFlashLatencyFromMSIRange>:
|
|
voltage range.
|
|
* @param MSI_Range MSI range value from @ref RCC_MSIRANGE_0 to @ref RCC_MSIRANGE_11
|
|
* @retval HAL status
|
|
*/
|
|
static HAL_StatusTypeDef RCC_SetFlashLatencyFromMSIRange(uint32_t MSI_Range)
|
|
{
|
|
8003f5c: b590 push {r4, r7, lr}
|
|
8003f5e: b085 sub sp, #20
|
|
8003f60: af00 add r7, sp, #0
|
|
8003f62: 6078 str r0, [r7, #4]
|
|
uint32_t flash_clksrcfreq;
|
|
uint32_t msifreq;
|
|
|
|
/* MSI frequency range in Hz */
|
|
msifreq = __LL_RCC_CALC_MSI_FREQ(LL_RCC_MSIRANGESEL_RUN, MSI_Range);
|
|
8003f64: 687b ldr r3, [r7, #4]
|
|
8003f66: 091b lsrs r3, r3, #4
|
|
8003f68: f003 030f and.w r3, r3, #15
|
|
8003f6c: 4a10 ldr r2, [pc, #64] @ (8003fb0 <RCC_SetFlashLatencyFromMSIRange+0x54>)
|
|
8003f6e: f852 3023 ldr.w r3, [r2, r3, lsl #2]
|
|
8003f72: 60fb str r3, [r7, #12]
|
|
flash_clksrcfreq = __LL_RCC_CALC_HCLK3_FREQ(msifreq, LL_RCC_GetAHB3Prescaler());
|
|
8003f74: f7ff f981 bl 800327a <LL_RCC_GetAHB3Prescaler>
|
|
8003f78: 4603 mov r3, r0
|
|
8003f7a: 091b lsrs r3, r3, #4
|
|
8003f7c: f003 030f and.w r3, r3, #15
|
|
8003f80: 4a0c ldr r2, [pc, #48] @ (8003fb4 <RCC_SetFlashLatencyFromMSIRange+0x58>)
|
|
8003f82: f852 3023 ldr.w r3, [r2, r3, lsl #2]
|
|
8003f86: 68fa ldr r2, [r7, #12]
|
|
8003f88: fbb2 f3f3 udiv r3, r2, r3
|
|
8003f8c: 60bb str r3, [r7, #8]
|
|
|
|
return RCC_SetFlashLatency((flash_clksrcfreq / MEGA_HZ), HAL_PWREx_GetVoltageRange());
|
|
8003f8e: 68bb ldr r3, [r7, #8]
|
|
8003f90: 4a09 ldr r2, [pc, #36] @ (8003fb8 <RCC_SetFlashLatencyFromMSIRange+0x5c>)
|
|
8003f92: fba2 2303 umull r2, r3, r2, r3
|
|
8003f96: 0c9c lsrs r4, r3, #18
|
|
8003f98: f7fe ff12 bl 8002dc0 <HAL_PWREx_GetVoltageRange>
|
|
8003f9c: 4603 mov r3, r0
|
|
8003f9e: 4619 mov r1, r3
|
|
8003fa0: 4620 mov r0, r4
|
|
8003fa2: f000 f80b bl 8003fbc <RCC_SetFlashLatency>
|
|
8003fa6: 4603 mov r3, r0
|
|
}
|
|
8003fa8: 4618 mov r0, r3
|
|
8003faa: 3714 adds r7, #20
|
|
8003fac: 46bd mov sp, r7
|
|
8003fae: bd90 pop {r4, r7, pc}
|
|
8003fb0: 0801030c .word 0x0801030c
|
|
8003fb4: 080102ac .word 0x080102ac
|
|
8003fb8: 431bde83 .word 0x431bde83
|
|
|
|
08003fbc <RCC_SetFlashLatency>:
|
|
* @arg PWR_REGULATOR_VOLTAGE_SCALE1 Regulator voltage output range 1 mode
|
|
* @arg PWR_REGULATOR_VOLTAGE_SCALE2 Regulator voltage output range 2 mode
|
|
* @retval HAL status
|
|
*/
|
|
static HAL_StatusTypeDef RCC_SetFlashLatency(uint32_t Flash_ClkSrcFreq, uint32_t VCORE_Voltage)
|
|
{
|
|
8003fbc: b580 push {r7, lr}
|
|
8003fbe: b08e sub sp, #56 @ 0x38
|
|
8003fc0: af00 add r7, sp, #0
|
|
8003fc2: 6078 str r0, [r7, #4]
|
|
8003fc4: 6039 str r1, [r7, #0]
|
|
/* Flash Clock source (HCLK3) range in MHz for VCORE range1 */
|
|
const uint16_t FLASH_CLK_SRC_RANGE_VOS1[] = {18, 36, 48};
|
|
8003fc6: 4a3a ldr r2, [pc, #232] @ (80040b0 <RCC_SetFlashLatency+0xf4>)
|
|
8003fc8: f107 0320 add.w r3, r7, #32
|
|
8003fcc: e892 0003 ldmia.w r2, {r0, r1}
|
|
8003fd0: 6018 str r0, [r3, #0]
|
|
8003fd2: 3304 adds r3, #4
|
|
8003fd4: 8019 strh r1, [r3, #0]
|
|
|
|
/* Flash Clock source (HCLK3) range in MHz for VCORE range2 */
|
|
const uint16_t FLASH_CLK_SRC_RANGE_VOS2[] = {6, 12, 16};
|
|
8003fd6: 4a37 ldr r2, [pc, #220] @ (80040b4 <RCC_SetFlashLatency+0xf8>)
|
|
8003fd8: f107 0318 add.w r3, r7, #24
|
|
8003fdc: e892 0003 ldmia.w r2, {r0, r1}
|
|
8003fe0: 6018 str r0, [r3, #0]
|
|
8003fe2: 3304 adds r3, #4
|
|
8003fe4: 8019 strh r1, [r3, #0]
|
|
|
|
/* Flash Latency range */
|
|
const uint32_t FLASH_LATENCY_RANGE[] = {FLASH_LATENCY_0, FLASH_LATENCY_1, FLASH_LATENCY_2};
|
|
8003fe6: 4a34 ldr r2, [pc, #208] @ (80040b8 <RCC_SetFlashLatency+0xfc>)
|
|
8003fe8: f107 030c add.w r3, r7, #12
|
|
8003fec: ca07 ldmia r2, {r0, r1, r2}
|
|
8003fee: e883 0007 stmia.w r3, {r0, r1, r2}
|
|
|
|
uint32_t latency = FLASH_LATENCY_0; /* default value 0WS */
|
|
8003ff2: 2300 movs r3, #0
|
|
8003ff4: 637b str r3, [r7, #52] @ 0x34
|
|
uint32_t tickstart;
|
|
|
|
if (VCORE_Voltage == PWR_REGULATOR_VOLTAGE_SCALE1)
|
|
8003ff6: 683b ldr r3, [r7, #0]
|
|
8003ff8: f5b3 7f00 cmp.w r3, #512 @ 0x200
|
|
8003ffc: d11b bne.n 8004036 <RCC_SetFlashLatency+0x7a>
|
|
{
|
|
for (uint32_t index = 0; index < __COUNTOF(FLASH_CLK_SRC_RANGE_VOS1); index++)
|
|
8003ffe: 2300 movs r3, #0
|
|
8004000: 633b str r3, [r7, #48] @ 0x30
|
|
8004002: e014 b.n 800402e <RCC_SetFlashLatency+0x72>
|
|
{
|
|
if (Flash_ClkSrcFreq <= FLASH_CLK_SRC_RANGE_VOS1[index])
|
|
8004004: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
8004006: 005b lsls r3, r3, #1
|
|
8004008: 3338 adds r3, #56 @ 0x38
|
|
800400a: 443b add r3, r7
|
|
800400c: f833 3c18 ldrh.w r3, [r3, #-24]
|
|
8004010: 461a mov r2, r3
|
|
8004012: 687b ldr r3, [r7, #4]
|
|
8004014: 4293 cmp r3, r2
|
|
8004016: d807 bhi.n 8004028 <RCC_SetFlashLatency+0x6c>
|
|
{
|
|
latency = FLASH_LATENCY_RANGE[index];
|
|
8004018: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
800401a: 009b lsls r3, r3, #2
|
|
800401c: 3338 adds r3, #56 @ 0x38
|
|
800401e: 443b add r3, r7
|
|
8004020: f853 3c2c ldr.w r3, [r3, #-44]
|
|
8004024: 637b str r3, [r7, #52] @ 0x34
|
|
break;
|
|
8004026: e021 b.n 800406c <RCC_SetFlashLatency+0xb0>
|
|
for (uint32_t index = 0; index < __COUNTOF(FLASH_CLK_SRC_RANGE_VOS1); index++)
|
|
8004028: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
800402a: 3301 adds r3, #1
|
|
800402c: 633b str r3, [r7, #48] @ 0x30
|
|
800402e: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
8004030: 2b02 cmp r3, #2
|
|
8004032: d9e7 bls.n 8004004 <RCC_SetFlashLatency+0x48>
|
|
8004034: e01a b.n 800406c <RCC_SetFlashLatency+0xb0>
|
|
}
|
|
}
|
|
}
|
|
else /* PWR_REGULATOR_VOLTAGE_SCALE2 */
|
|
{
|
|
for (uint32_t index = 0; index < __COUNTOF(FLASH_CLK_SRC_RANGE_VOS2); index++)
|
|
8004036: 2300 movs r3, #0
|
|
8004038: 62fb str r3, [r7, #44] @ 0x2c
|
|
800403a: e014 b.n 8004066 <RCC_SetFlashLatency+0xaa>
|
|
{
|
|
if (Flash_ClkSrcFreq <= FLASH_CLK_SRC_RANGE_VOS2[index])
|
|
800403c: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
800403e: 005b lsls r3, r3, #1
|
|
8004040: 3338 adds r3, #56 @ 0x38
|
|
8004042: 443b add r3, r7
|
|
8004044: f833 3c20 ldrh.w r3, [r3, #-32]
|
|
8004048: 461a mov r2, r3
|
|
800404a: 687b ldr r3, [r7, #4]
|
|
800404c: 4293 cmp r3, r2
|
|
800404e: d807 bhi.n 8004060 <RCC_SetFlashLatency+0xa4>
|
|
{
|
|
latency = FLASH_LATENCY_RANGE[index];
|
|
8004050: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
8004052: 009b lsls r3, r3, #2
|
|
8004054: 3338 adds r3, #56 @ 0x38
|
|
8004056: 443b add r3, r7
|
|
8004058: f853 3c2c ldr.w r3, [r3, #-44]
|
|
800405c: 637b str r3, [r7, #52] @ 0x34
|
|
break;
|
|
800405e: e005 b.n 800406c <RCC_SetFlashLatency+0xb0>
|
|
for (uint32_t index = 0; index < __COUNTOF(FLASH_CLK_SRC_RANGE_VOS2); index++)
|
|
8004060: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
8004062: 3301 adds r3, #1
|
|
8004064: 62fb str r3, [r7, #44] @ 0x2c
|
|
8004066: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
8004068: 2b02 cmp r3, #2
|
|
800406a: d9e7 bls.n 800403c <RCC_SetFlashLatency+0x80>
|
|
}
|
|
}
|
|
}
|
|
|
|
__HAL_FLASH_SET_LATENCY(latency);
|
|
800406c: 4b13 ldr r3, [pc, #76] @ (80040bc <RCC_SetFlashLatency+0x100>)
|
|
800406e: 681b ldr r3, [r3, #0]
|
|
8004070: f023 0207 bic.w r2, r3, #7
|
|
8004074: 4911 ldr r1, [pc, #68] @ (80040bc <RCC_SetFlashLatency+0x100>)
|
|
8004076: 6b7b ldr r3, [r7, #52] @ 0x34
|
|
8004078: 4313 orrs r3, r2
|
|
800407a: 600b str r3, [r1, #0]
|
|
|
|
/* Get Start Tick*/
|
|
tickstart = HAL_GetTick();
|
|
800407c: f7fc fde4 bl 8000c48 <HAL_GetTick>
|
|
8004080: 62b8 str r0, [r7, #40] @ 0x28
|
|
|
|
/* Check that the new number of wait states is taken into account to access the Flash
|
|
memory by reading the FLASH_ACR register */
|
|
while (__HAL_FLASH_GET_LATENCY() != latency)
|
|
8004082: e008 b.n 8004096 <RCC_SetFlashLatency+0xda>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > LATENCY_TIMEOUT_VALUE)
|
|
8004084: f7fc fde0 bl 8000c48 <HAL_GetTick>
|
|
8004088: 4602 mov r2, r0
|
|
800408a: 6abb ldr r3, [r7, #40] @ 0x28
|
|
800408c: 1ad3 subs r3, r2, r3
|
|
800408e: 2b02 cmp r3, #2
|
|
8004090: d901 bls.n 8004096 <RCC_SetFlashLatency+0xda>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
8004092: 2303 movs r3, #3
|
|
8004094: e007 b.n 80040a6 <RCC_SetFlashLatency+0xea>
|
|
while (__HAL_FLASH_GET_LATENCY() != latency)
|
|
8004096: 4b09 ldr r3, [pc, #36] @ (80040bc <RCC_SetFlashLatency+0x100>)
|
|
8004098: 681b ldr r3, [r3, #0]
|
|
800409a: f003 0307 and.w r3, r3, #7
|
|
800409e: 6b7a ldr r2, [r7, #52] @ 0x34
|
|
80040a0: 429a cmp r2, r3
|
|
80040a2: d1ef bne.n 8004084 <RCC_SetFlashLatency+0xc8>
|
|
}
|
|
}
|
|
return HAL_OK;
|
|
80040a4: 2300 movs r3, #0
|
|
}
|
|
80040a6: 4618 mov r0, r3
|
|
80040a8: 3738 adds r7, #56 @ 0x38
|
|
80040aa: 46bd mov sp, r7
|
|
80040ac: bd80 pop {r7, pc}
|
|
80040ae: bf00 nop
|
|
80040b0: 0800f890 .word 0x0800f890
|
|
80040b4: 0800f898 .word 0x0800f898
|
|
80040b8: 0800f8a0 .word 0x0800f8a0
|
|
80040bc: 58004000 .word 0x58004000
|
|
|
|
080040c0 <LL_RCC_LSE_IsReady>:
|
|
{
|
|
80040c0: b480 push {r7}
|
|
80040c2: af00 add r7, sp, #0
|
|
return ((READ_BIT(RCC->BDCR, RCC_BDCR_LSERDY) == (RCC_BDCR_LSERDY)) ? 1UL : 0UL);
|
|
80040c4: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
80040c8: f8d3 3090 ldr.w r3, [r3, #144] @ 0x90
|
|
80040cc: f003 0302 and.w r3, r3, #2
|
|
80040d0: 2b02 cmp r3, #2
|
|
80040d2: d101 bne.n 80040d8 <LL_RCC_LSE_IsReady+0x18>
|
|
80040d4: 2301 movs r3, #1
|
|
80040d6: e000 b.n 80040da <LL_RCC_LSE_IsReady+0x1a>
|
|
80040d8: 2300 movs r3, #0
|
|
}
|
|
80040da: 4618 mov r0, r3
|
|
80040dc: 46bd mov sp, r7
|
|
80040de: bc80 pop {r7}
|
|
80040e0: 4770 bx lr
|
|
|
|
080040e2 <LL_RCC_SetUSARTClockSource>:
|
|
{
|
|
80040e2: b480 push {r7}
|
|
80040e4: b083 sub sp, #12
|
|
80040e6: af00 add r7, sp, #0
|
|
80040e8: 6078 str r0, [r7, #4]
|
|
MODIFY_REG(RCC->CCIPR, (USARTxSource >> 16), (USARTxSource & 0x0000FFFFU));
|
|
80040ea: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
80040ee: f8d3 2088 ldr.w r2, [r3, #136] @ 0x88
|
|
80040f2: 687b ldr r3, [r7, #4]
|
|
80040f4: 0c1b lsrs r3, r3, #16
|
|
80040f6: 43db mvns r3, r3
|
|
80040f8: 401a ands r2, r3
|
|
80040fa: 687b ldr r3, [r7, #4]
|
|
80040fc: b29b uxth r3, r3
|
|
80040fe: f04f 41b0 mov.w r1, #1476395008 @ 0x58000000
|
|
8004102: 4313 orrs r3, r2
|
|
8004104: f8c1 3088 str.w r3, [r1, #136] @ 0x88
|
|
}
|
|
8004108: bf00 nop
|
|
800410a: 370c adds r7, #12
|
|
800410c: 46bd mov sp, r7
|
|
800410e: bc80 pop {r7}
|
|
8004110: 4770 bx lr
|
|
|
|
08004112 <LL_RCC_SetI2SClockSource>:
|
|
{
|
|
8004112: b480 push {r7}
|
|
8004114: b083 sub sp, #12
|
|
8004116: af00 add r7, sp, #0
|
|
8004118: 6078 str r0, [r7, #4]
|
|
MODIFY_REG(RCC->CCIPR, RCC_CCIPR_I2S2SEL, I2SxSource);
|
|
800411a: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
800411e: f8d3 3088 ldr.w r3, [r3, #136] @ 0x88
|
|
8004122: f423 7240 bic.w r2, r3, #768 @ 0x300
|
|
8004126: f04f 41b0 mov.w r1, #1476395008 @ 0x58000000
|
|
800412a: 687b ldr r3, [r7, #4]
|
|
800412c: 4313 orrs r3, r2
|
|
800412e: f8c1 3088 str.w r3, [r1, #136] @ 0x88
|
|
}
|
|
8004132: bf00 nop
|
|
8004134: 370c adds r7, #12
|
|
8004136: 46bd mov sp, r7
|
|
8004138: bc80 pop {r7}
|
|
800413a: 4770 bx lr
|
|
|
|
0800413c <LL_RCC_SetLPUARTClockSource>:
|
|
{
|
|
800413c: b480 push {r7}
|
|
800413e: b083 sub sp, #12
|
|
8004140: af00 add r7, sp, #0
|
|
8004142: 6078 str r0, [r7, #4]
|
|
MODIFY_REG(RCC->CCIPR, RCC_CCIPR_LPUART1SEL, LPUARTxSource);
|
|
8004144: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8004148: f8d3 3088 ldr.w r3, [r3, #136] @ 0x88
|
|
800414c: f423 6240 bic.w r2, r3, #3072 @ 0xc00
|
|
8004150: f04f 41b0 mov.w r1, #1476395008 @ 0x58000000
|
|
8004154: 687b ldr r3, [r7, #4]
|
|
8004156: 4313 orrs r3, r2
|
|
8004158: f8c1 3088 str.w r3, [r1, #136] @ 0x88
|
|
}
|
|
800415c: bf00 nop
|
|
800415e: 370c adds r7, #12
|
|
8004160: 46bd mov sp, r7
|
|
8004162: bc80 pop {r7}
|
|
8004164: 4770 bx lr
|
|
|
|
08004166 <LL_RCC_SetI2CClockSource>:
|
|
{
|
|
8004166: b480 push {r7}
|
|
8004168: b083 sub sp, #12
|
|
800416a: af00 add r7, sp, #0
|
|
800416c: 6078 str r0, [r7, #4]
|
|
MODIFY_REG(RCC->CCIPR, ((I2CxSource >> 4) & 0x000FF000U), ((I2CxSource << 4) & 0x000FF000U));
|
|
800416e: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8004172: f8d3 2088 ldr.w r2, [r3, #136] @ 0x88
|
|
8004176: 687b ldr r3, [r7, #4]
|
|
8004178: 091b lsrs r3, r3, #4
|
|
800417a: f403 237f and.w r3, r3, #1044480 @ 0xff000
|
|
800417e: 43db mvns r3, r3
|
|
8004180: 401a ands r2, r3
|
|
8004182: 687b ldr r3, [r7, #4]
|
|
8004184: 011b lsls r3, r3, #4
|
|
8004186: f403 237f and.w r3, r3, #1044480 @ 0xff000
|
|
800418a: f04f 41b0 mov.w r1, #1476395008 @ 0x58000000
|
|
800418e: 4313 orrs r3, r2
|
|
8004190: f8c1 3088 str.w r3, [r1, #136] @ 0x88
|
|
}
|
|
8004194: bf00 nop
|
|
8004196: 370c adds r7, #12
|
|
8004198: 46bd mov sp, r7
|
|
800419a: bc80 pop {r7}
|
|
800419c: 4770 bx lr
|
|
|
|
0800419e <LL_RCC_SetLPTIMClockSource>:
|
|
{
|
|
800419e: b480 push {r7}
|
|
80041a0: b083 sub sp, #12
|
|
80041a2: af00 add r7, sp, #0
|
|
80041a4: 6078 str r0, [r7, #4]
|
|
MODIFY_REG(RCC->CCIPR, (LPTIMxSource & 0xFFFF0000U), (LPTIMxSource << 16));
|
|
80041a6: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
80041aa: f8d3 2088 ldr.w r2, [r3, #136] @ 0x88
|
|
80041ae: 687b ldr r3, [r7, #4]
|
|
80041b0: 0c1b lsrs r3, r3, #16
|
|
80041b2: 041b lsls r3, r3, #16
|
|
80041b4: 43db mvns r3, r3
|
|
80041b6: 401a ands r2, r3
|
|
80041b8: 687b ldr r3, [r7, #4]
|
|
80041ba: 041b lsls r3, r3, #16
|
|
80041bc: f04f 41b0 mov.w r1, #1476395008 @ 0x58000000
|
|
80041c0: 4313 orrs r3, r2
|
|
80041c2: f8c1 3088 str.w r3, [r1, #136] @ 0x88
|
|
}
|
|
80041c6: bf00 nop
|
|
80041c8: 370c adds r7, #12
|
|
80041ca: 46bd mov sp, r7
|
|
80041cc: bc80 pop {r7}
|
|
80041ce: 4770 bx lr
|
|
|
|
080041d0 <LL_RCC_SetRNGClockSource>:
|
|
{
|
|
80041d0: b480 push {r7}
|
|
80041d2: b083 sub sp, #12
|
|
80041d4: af00 add r7, sp, #0
|
|
80041d6: 6078 str r0, [r7, #4]
|
|
MODIFY_REG(RCC->CCIPR, RCC_CCIPR_RNGSEL, RNGxSource);
|
|
80041d8: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
80041dc: f8d3 3088 ldr.w r3, [r3, #136] @ 0x88
|
|
80041e0: f023 4240 bic.w r2, r3, #3221225472 @ 0xc0000000
|
|
80041e4: f04f 41b0 mov.w r1, #1476395008 @ 0x58000000
|
|
80041e8: 687b ldr r3, [r7, #4]
|
|
80041ea: 4313 orrs r3, r2
|
|
80041ec: f8c1 3088 str.w r3, [r1, #136] @ 0x88
|
|
}
|
|
80041f0: bf00 nop
|
|
80041f2: 370c adds r7, #12
|
|
80041f4: 46bd mov sp, r7
|
|
80041f6: bc80 pop {r7}
|
|
80041f8: 4770 bx lr
|
|
|
|
080041fa <LL_RCC_SetADCClockSource>:
|
|
{
|
|
80041fa: b480 push {r7}
|
|
80041fc: b083 sub sp, #12
|
|
80041fe: af00 add r7, sp, #0
|
|
8004200: 6078 str r0, [r7, #4]
|
|
MODIFY_REG(RCC->CCIPR, RCC_CCIPR_ADCSEL, ADCxSource);
|
|
8004202: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8004206: f8d3 3088 ldr.w r3, [r3, #136] @ 0x88
|
|
800420a: f023 5240 bic.w r2, r3, #805306368 @ 0x30000000
|
|
800420e: f04f 41b0 mov.w r1, #1476395008 @ 0x58000000
|
|
8004212: 687b ldr r3, [r7, #4]
|
|
8004214: 4313 orrs r3, r2
|
|
8004216: f8c1 3088 str.w r3, [r1, #136] @ 0x88
|
|
}
|
|
800421a: bf00 nop
|
|
800421c: 370c adds r7, #12
|
|
800421e: 46bd mov sp, r7
|
|
8004220: bc80 pop {r7}
|
|
8004222: 4770 bx lr
|
|
|
|
08004224 <LL_RCC_SetRTCClockSource>:
|
|
{
|
|
8004224: b480 push {r7}
|
|
8004226: b083 sub sp, #12
|
|
8004228: af00 add r7, sp, #0
|
|
800422a: 6078 str r0, [r7, #4]
|
|
MODIFY_REG(RCC->BDCR, RCC_BDCR_RTCSEL, Source);
|
|
800422c: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8004230: f8d3 3090 ldr.w r3, [r3, #144] @ 0x90
|
|
8004234: f423 7240 bic.w r2, r3, #768 @ 0x300
|
|
8004238: f04f 41b0 mov.w r1, #1476395008 @ 0x58000000
|
|
800423c: 687b ldr r3, [r7, #4]
|
|
800423e: 4313 orrs r3, r2
|
|
8004240: f8c1 3090 str.w r3, [r1, #144] @ 0x90
|
|
}
|
|
8004244: bf00 nop
|
|
8004246: 370c adds r7, #12
|
|
8004248: 46bd mov sp, r7
|
|
800424a: bc80 pop {r7}
|
|
800424c: 4770 bx lr
|
|
|
|
0800424e <LL_RCC_GetRTCClockSource>:
|
|
{
|
|
800424e: b480 push {r7}
|
|
8004250: af00 add r7, sp, #0
|
|
return (uint32_t)(READ_BIT(RCC->BDCR, RCC_BDCR_RTCSEL));
|
|
8004252: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8004256: f8d3 3090 ldr.w r3, [r3, #144] @ 0x90
|
|
800425a: f403 7340 and.w r3, r3, #768 @ 0x300
|
|
}
|
|
800425e: 4618 mov r0, r3
|
|
8004260: 46bd mov sp, r7
|
|
8004262: bc80 pop {r7}
|
|
8004264: 4770 bx lr
|
|
|
|
08004266 <LL_RCC_ForceBackupDomainReset>:
|
|
{
|
|
8004266: b480 push {r7}
|
|
8004268: af00 add r7, sp, #0
|
|
SET_BIT(RCC->BDCR, RCC_BDCR_BDRST);
|
|
800426a: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
800426e: f8d3 3090 ldr.w r3, [r3, #144] @ 0x90
|
|
8004272: f04f 42b0 mov.w r2, #1476395008 @ 0x58000000
|
|
8004276: f443 3380 orr.w r3, r3, #65536 @ 0x10000
|
|
800427a: f8c2 3090 str.w r3, [r2, #144] @ 0x90
|
|
}
|
|
800427e: bf00 nop
|
|
8004280: 46bd mov sp, r7
|
|
8004282: bc80 pop {r7}
|
|
8004284: 4770 bx lr
|
|
|
|
08004286 <LL_RCC_ReleaseBackupDomainReset>:
|
|
{
|
|
8004286: b480 push {r7}
|
|
8004288: af00 add r7, sp, #0
|
|
CLEAR_BIT(RCC->BDCR, RCC_BDCR_BDRST);
|
|
800428a: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
800428e: f8d3 3090 ldr.w r3, [r3, #144] @ 0x90
|
|
8004292: f04f 42b0 mov.w r2, #1476395008 @ 0x58000000
|
|
8004296: f423 3380 bic.w r3, r3, #65536 @ 0x10000
|
|
800429a: f8c2 3090 str.w r3, [r2, #144] @ 0x90
|
|
}
|
|
800429e: bf00 nop
|
|
80042a0: 46bd mov sp, r7
|
|
80042a2: bc80 pop {r7}
|
|
80042a4: 4770 bx lr
|
|
...
|
|
|
|
080042a8 <HAL_RCCEx_PeriphCLKConfig>:
|
|
* the RTC clock source: in this case the access to Backup domain is enabled.
|
|
*
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_RCCEx_PeriphCLKConfig(RCC_PeriphCLKInitTypeDef *PeriphClkInit)
|
|
{
|
|
80042a8: b580 push {r7, lr}
|
|
80042aa: b086 sub sp, #24
|
|
80042ac: af00 add r7, sp, #0
|
|
80042ae: 6078 str r0, [r7, #4]
|
|
uint32_t tmpregister = 0;
|
|
80042b0: 2300 movs r3, #0
|
|
80042b2: 617b str r3, [r7, #20]
|
|
uint32_t tickstart;
|
|
HAL_StatusTypeDef ret = HAL_OK; /* Intermediate status */
|
|
80042b4: 2300 movs r3, #0
|
|
80042b6: 74fb strb r3, [r7, #19]
|
|
HAL_StatusTypeDef status = HAL_OK; /* Final status */
|
|
80042b8: 2300 movs r3, #0
|
|
80042ba: 74bb strb r3, [r7, #18]
|
|
|
|
/* Check the parameters */
|
|
assert_param(IS_RCC_PERIPHCLOCK(PeriphClkInit->PeriphClockSelection));
|
|
|
|
/*-------------------------- RTC clock source configuration ----------------------*/
|
|
if ((PeriphClkInit->PeriphClockSelection & RCC_PERIPHCLK_RTC) == RCC_PERIPHCLK_RTC)
|
|
80042bc: 687b ldr r3, [r7, #4]
|
|
80042be: 681b ldr r3, [r3, #0]
|
|
80042c0: f403 3380 and.w r3, r3, #65536 @ 0x10000
|
|
80042c4: 2b00 cmp r3, #0
|
|
80042c6: d058 beq.n 800437a <HAL_RCCEx_PeriphCLKConfig+0xd2>
|
|
/* Check for RTC Parameters used to output RTCCLK */
|
|
assert_param(IS_RCC_RTCCLKSOURCE(PeriphClkInit->RTCClockSelection));
|
|
|
|
|
|
/* Enable write access to Backup domain */
|
|
HAL_PWR_EnableBkUpAccess();
|
|
80042c8: f7fe fd38 bl 8002d3c <HAL_PWR_EnableBkUpAccess>
|
|
|
|
/* Wait for Backup domain Write protection disable */
|
|
tickstart = HAL_GetTick();
|
|
80042cc: f7fc fcbc bl 8000c48 <HAL_GetTick>
|
|
80042d0: 60f8 str r0, [r7, #12]
|
|
|
|
while (!(READ_BIT(PWR->CR1, PWR_CR1_DBP) == (PWR_CR1_DBP)))
|
|
80042d2: e009 b.n 80042e8 <HAL_RCCEx_PeriphCLKConfig+0x40>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > RCC_DBP_TIMEOUT_VALUE)
|
|
80042d4: f7fc fcb8 bl 8000c48 <HAL_GetTick>
|
|
80042d8: 4602 mov r2, r0
|
|
80042da: 68fb ldr r3, [r7, #12]
|
|
80042dc: 1ad3 subs r3, r2, r3
|
|
80042de: 2b02 cmp r3, #2
|
|
80042e0: d902 bls.n 80042e8 <HAL_RCCEx_PeriphCLKConfig+0x40>
|
|
{
|
|
ret = HAL_TIMEOUT;
|
|
80042e2: 2303 movs r3, #3
|
|
80042e4: 74fb strb r3, [r7, #19]
|
|
break;
|
|
80042e6: e006 b.n 80042f6 <HAL_RCCEx_PeriphCLKConfig+0x4e>
|
|
while (!(READ_BIT(PWR->CR1, PWR_CR1_DBP) == (PWR_CR1_DBP)))
|
|
80042e8: 4b7b ldr r3, [pc, #492] @ (80044d8 <HAL_RCCEx_PeriphCLKConfig+0x230>)
|
|
80042ea: 681b ldr r3, [r3, #0]
|
|
80042ec: f403 7380 and.w r3, r3, #256 @ 0x100
|
|
80042f0: f5b3 7f80 cmp.w r3, #256 @ 0x100
|
|
80042f4: d1ee bne.n 80042d4 <HAL_RCCEx_PeriphCLKConfig+0x2c>
|
|
}
|
|
}
|
|
|
|
if (ret == HAL_OK)
|
|
80042f6: 7cfb ldrb r3, [r7, #19]
|
|
80042f8: 2b00 cmp r3, #0
|
|
80042fa: d13c bne.n 8004376 <HAL_RCCEx_PeriphCLKConfig+0xce>
|
|
{
|
|
/* Reset the Backup domain only if the RTC Clock source selection is modified */
|
|
if (LL_RCC_GetRTCClockSource() != PeriphClkInit->RTCClockSelection)
|
|
80042fc: f7ff ffa7 bl 800424e <LL_RCC_GetRTCClockSource>
|
|
8004300: 4602 mov r2, r0
|
|
8004302: 687b ldr r3, [r7, #4]
|
|
8004304: 6b5b ldr r3, [r3, #52] @ 0x34
|
|
8004306: 429a cmp r2, r3
|
|
8004308: d00f beq.n 800432a <HAL_RCCEx_PeriphCLKConfig+0x82>
|
|
{
|
|
/* Store the content of BDCR register before the reset of Backup Domain */
|
|
tmpregister = READ_BIT(RCC->BDCR, ~(RCC_BDCR_RTCSEL));
|
|
800430a: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
800430e: f8d3 3090 ldr.w r3, [r3, #144] @ 0x90
|
|
8004312: f423 7340 bic.w r3, r3, #768 @ 0x300
|
|
8004316: 617b str r3, [r7, #20]
|
|
|
|
/* RTC Clock selection can be changed only if the Backup Domain is reset */
|
|
__HAL_RCC_BACKUPRESET_FORCE();
|
|
8004318: f7ff ffa5 bl 8004266 <LL_RCC_ForceBackupDomainReset>
|
|
__HAL_RCC_BACKUPRESET_RELEASE();
|
|
800431c: f7ff ffb3 bl 8004286 <LL_RCC_ReleaseBackupDomainReset>
|
|
|
|
/* Restore the Content of BDCR register */
|
|
RCC->BDCR = tmpregister;
|
|
8004320: f04f 42b0 mov.w r2, #1476395008 @ 0x58000000
|
|
8004324: 697b ldr r3, [r7, #20]
|
|
8004326: f8c2 3090 str.w r3, [r2, #144] @ 0x90
|
|
}
|
|
|
|
/* Wait for LSE reactivation if LSE was enable prior to Backup Domain reset */
|
|
if (HAL_IS_BIT_SET(tmpregister, RCC_BDCR_LSERDY))
|
|
800432a: 697b ldr r3, [r7, #20]
|
|
800432c: f003 0302 and.w r3, r3, #2
|
|
8004330: 2b00 cmp r3, #0
|
|
8004332: d014 beq.n 800435e <HAL_RCCEx_PeriphCLKConfig+0xb6>
|
|
{
|
|
/* Get Start Tick*/
|
|
tickstart = HAL_GetTick();
|
|
8004334: f7fc fc88 bl 8000c48 <HAL_GetTick>
|
|
8004338: 60f8 str r0, [r7, #12]
|
|
|
|
/* Wait till LSE is ready */
|
|
while (LL_RCC_LSE_IsReady() != 1U)
|
|
800433a: e00b b.n 8004354 <HAL_RCCEx_PeriphCLKConfig+0xac>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > RCC_LSE_TIMEOUT_VALUE)
|
|
800433c: f7fc fc84 bl 8000c48 <HAL_GetTick>
|
|
8004340: 4602 mov r2, r0
|
|
8004342: 68fb ldr r3, [r7, #12]
|
|
8004344: 1ad3 subs r3, r2, r3
|
|
8004346: f241 3288 movw r2, #5000 @ 0x1388
|
|
800434a: 4293 cmp r3, r2
|
|
800434c: d902 bls.n 8004354 <HAL_RCCEx_PeriphCLKConfig+0xac>
|
|
{
|
|
ret = HAL_TIMEOUT;
|
|
800434e: 2303 movs r3, #3
|
|
8004350: 74fb strb r3, [r7, #19]
|
|
break;
|
|
8004352: e004 b.n 800435e <HAL_RCCEx_PeriphCLKConfig+0xb6>
|
|
while (LL_RCC_LSE_IsReady() != 1U)
|
|
8004354: f7ff feb4 bl 80040c0 <LL_RCC_LSE_IsReady>
|
|
8004358: 4603 mov r3, r0
|
|
800435a: 2b01 cmp r3, #1
|
|
800435c: d1ee bne.n 800433c <HAL_RCCEx_PeriphCLKConfig+0x94>
|
|
}
|
|
}
|
|
}
|
|
|
|
if (ret == HAL_OK)
|
|
800435e: 7cfb ldrb r3, [r7, #19]
|
|
8004360: 2b00 cmp r3, #0
|
|
8004362: d105 bne.n 8004370 <HAL_RCCEx_PeriphCLKConfig+0xc8>
|
|
{
|
|
/* Apply new RTC clock source selection */
|
|
__HAL_RCC_RTC_CONFIG(PeriphClkInit->RTCClockSelection);
|
|
8004364: 687b ldr r3, [r7, #4]
|
|
8004366: 6b5b ldr r3, [r3, #52] @ 0x34
|
|
8004368: 4618 mov r0, r3
|
|
800436a: f7ff ff5b bl 8004224 <LL_RCC_SetRTCClockSource>
|
|
800436e: e004 b.n 800437a <HAL_RCCEx_PeriphCLKConfig+0xd2>
|
|
}
|
|
else
|
|
{
|
|
/* set overall return value */
|
|
status = ret;
|
|
8004370: 7cfb ldrb r3, [r7, #19]
|
|
8004372: 74bb strb r3, [r7, #18]
|
|
8004374: e001 b.n 800437a <HAL_RCCEx_PeriphCLKConfig+0xd2>
|
|
}
|
|
}
|
|
else
|
|
{
|
|
/* set overall return value */
|
|
status = ret;
|
|
8004376: 7cfb ldrb r3, [r7, #19]
|
|
8004378: 74bb strb r3, [r7, #18]
|
|
}
|
|
|
|
}
|
|
|
|
/*-------------------- USART1 clock source configuration -------------------*/
|
|
if (((PeriphClkInit->PeriphClockSelection) & RCC_PERIPHCLK_USART1) == RCC_PERIPHCLK_USART1)
|
|
800437a: 687b ldr r3, [r7, #4]
|
|
800437c: 681b ldr r3, [r3, #0]
|
|
800437e: f003 0301 and.w r3, r3, #1
|
|
8004382: 2b00 cmp r3, #0
|
|
8004384: d004 beq.n 8004390 <HAL_RCCEx_PeriphCLKConfig+0xe8>
|
|
{
|
|
/* Check the parameters */
|
|
assert_param(IS_RCC_USART1CLKSOURCE(PeriphClkInit->Usart1ClockSelection));
|
|
|
|
/* Configure the USART1 clock source */
|
|
__HAL_RCC_USART1_CONFIG(PeriphClkInit->Usart1ClockSelection);
|
|
8004386: 687b ldr r3, [r7, #4]
|
|
8004388: 685b ldr r3, [r3, #4]
|
|
800438a: 4618 mov r0, r3
|
|
800438c: f7ff fea9 bl 80040e2 <LL_RCC_SetUSARTClockSource>
|
|
}
|
|
|
|
/*-------------------- USART2 clock source configuration -------------------*/
|
|
if (((PeriphClkInit->PeriphClockSelection) & RCC_PERIPHCLK_USART2) == RCC_PERIPHCLK_USART2)
|
|
8004390: 687b ldr r3, [r7, #4]
|
|
8004392: 681b ldr r3, [r3, #0]
|
|
8004394: f003 0302 and.w r3, r3, #2
|
|
8004398: 2b00 cmp r3, #0
|
|
800439a: d004 beq.n 80043a6 <HAL_RCCEx_PeriphCLKConfig+0xfe>
|
|
{
|
|
/* Check the parameters */
|
|
assert_param(IS_RCC_USART2CLKSOURCE(PeriphClkInit->Usart2ClockSelection));
|
|
|
|
/* Configure the USART2 clock source */
|
|
__HAL_RCC_USART2_CONFIG(PeriphClkInit->Usart2ClockSelection);
|
|
800439c: 687b ldr r3, [r7, #4]
|
|
800439e: 689b ldr r3, [r3, #8]
|
|
80043a0: 4618 mov r0, r3
|
|
80043a2: f7ff fe9e bl 80040e2 <LL_RCC_SetUSARTClockSource>
|
|
}
|
|
|
|
/*-------------------- LPUART1 clock source configuration ------------------*/
|
|
if (((PeriphClkInit->PeriphClockSelection) & RCC_PERIPHCLK_LPUART1) == RCC_PERIPHCLK_LPUART1)
|
|
80043a6: 687b ldr r3, [r7, #4]
|
|
80043a8: 681b ldr r3, [r3, #0]
|
|
80043aa: f003 0320 and.w r3, r3, #32
|
|
80043ae: 2b00 cmp r3, #0
|
|
80043b0: d004 beq.n 80043bc <HAL_RCCEx_PeriphCLKConfig+0x114>
|
|
{
|
|
/* Check the parameters */
|
|
assert_param(IS_RCC_LPUART1CLKSOURCE(PeriphClkInit->Lpuart1ClockSelection));
|
|
|
|
/* Configure the LPUAR1 clock source */
|
|
__HAL_RCC_LPUART1_CONFIG(PeriphClkInit->Lpuart1ClockSelection);
|
|
80043b2: 687b ldr r3, [r7, #4]
|
|
80043b4: 691b ldr r3, [r3, #16]
|
|
80043b6: 4618 mov r0, r3
|
|
80043b8: f7ff fec0 bl 800413c <LL_RCC_SetLPUARTClockSource>
|
|
}
|
|
|
|
/*-------------------- LPTIM1 clock source configuration -------------------*/
|
|
if (((PeriphClkInit->PeriphClockSelection) & RCC_PERIPHCLK_LPTIM1) == (RCC_PERIPHCLK_LPTIM1))
|
|
80043bc: 687b ldr r3, [r7, #4]
|
|
80043be: 681b ldr r3, [r3, #0]
|
|
80043c0: f403 7300 and.w r3, r3, #512 @ 0x200
|
|
80043c4: 2b00 cmp r3, #0
|
|
80043c6: d004 beq.n 80043d2 <HAL_RCCEx_PeriphCLKConfig+0x12a>
|
|
{
|
|
/* Check the parameters */
|
|
assert_param(IS_RCC_LPTIM1CLKSOURCE(PeriphClkInit->Lptim1ClockSelection));
|
|
|
|
/* Configure the LPTIM1 clock source */
|
|
__HAL_RCC_LPTIM1_CONFIG(PeriphClkInit->Lptim1ClockSelection);
|
|
80043c8: 687b ldr r3, [r7, #4]
|
|
80043ca: 6a1b ldr r3, [r3, #32]
|
|
80043cc: 4618 mov r0, r3
|
|
80043ce: f7ff fee6 bl 800419e <LL_RCC_SetLPTIMClockSource>
|
|
}
|
|
|
|
/*-------------------- LPTIM2 clock source configuration -------------------*/
|
|
if (((PeriphClkInit->PeriphClockSelection) & RCC_PERIPHCLK_LPTIM2) == (RCC_PERIPHCLK_LPTIM2))
|
|
80043d2: 687b ldr r3, [r7, #4]
|
|
80043d4: 681b ldr r3, [r3, #0]
|
|
80043d6: f403 6380 and.w r3, r3, #1024 @ 0x400
|
|
80043da: 2b00 cmp r3, #0
|
|
80043dc: d004 beq.n 80043e8 <HAL_RCCEx_PeriphCLKConfig+0x140>
|
|
{
|
|
/* Check the parameters */
|
|
assert_param(IS_RCC_LPTIM2CLKSOURCE(PeriphClkInit->Lptim2ClockSelection));
|
|
|
|
/* Configure the LPTIM2 clock source */
|
|
__HAL_RCC_LPTIM2_CONFIG(PeriphClkInit->Lptim2ClockSelection);
|
|
80043de: 687b ldr r3, [r7, #4]
|
|
80043e0: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
80043e2: 4618 mov r0, r3
|
|
80043e4: f7ff fedb bl 800419e <LL_RCC_SetLPTIMClockSource>
|
|
}
|
|
|
|
/*-------------------- LPTIM3 clock source configuration -------------------*/
|
|
if (((PeriphClkInit->PeriphClockSelection) & RCC_PERIPHCLK_LPTIM3) == (RCC_PERIPHCLK_LPTIM3))
|
|
80043e8: 687b ldr r3, [r7, #4]
|
|
80043ea: 681b ldr r3, [r3, #0]
|
|
80043ec: f403 6300 and.w r3, r3, #2048 @ 0x800
|
|
80043f0: 2b00 cmp r3, #0
|
|
80043f2: d004 beq.n 80043fe <HAL_RCCEx_PeriphCLKConfig+0x156>
|
|
{
|
|
/* Check the parameters */
|
|
assert_param(IS_RCC_LPTIM3CLKSOURCE(PeriphClkInit->Lptim3ClockSelection));
|
|
|
|
/* Configure the LPTIM3 clock source */
|
|
__HAL_RCC_LPTIM3_CONFIG(PeriphClkInit->Lptim3ClockSelection);
|
|
80043f4: 687b ldr r3, [r7, #4]
|
|
80043f6: 6a9b ldr r3, [r3, #40] @ 0x28
|
|
80043f8: 4618 mov r0, r3
|
|
80043fa: f7ff fed0 bl 800419e <LL_RCC_SetLPTIMClockSource>
|
|
}
|
|
|
|
/*-------------------- I2C1 clock source configuration ---------------------*/
|
|
if (((PeriphClkInit->PeriphClockSelection) & RCC_PERIPHCLK_I2C1) == RCC_PERIPHCLK_I2C1)
|
|
80043fe: 687b ldr r3, [r7, #4]
|
|
8004400: 681b ldr r3, [r3, #0]
|
|
8004402: f003 0340 and.w r3, r3, #64 @ 0x40
|
|
8004406: 2b00 cmp r3, #0
|
|
8004408: d004 beq.n 8004414 <HAL_RCCEx_PeriphCLKConfig+0x16c>
|
|
{
|
|
/* Check the parameters */
|
|
assert_param(IS_RCC_I2C1CLKSOURCE(PeriphClkInit->I2c1ClockSelection));
|
|
|
|
/* Configure the I2C1 clock source */
|
|
__HAL_RCC_I2C1_CONFIG(PeriphClkInit->I2c1ClockSelection);
|
|
800440a: 687b ldr r3, [r7, #4]
|
|
800440c: 695b ldr r3, [r3, #20]
|
|
800440e: 4618 mov r0, r3
|
|
8004410: f7ff fea9 bl 8004166 <LL_RCC_SetI2CClockSource>
|
|
}
|
|
|
|
/*-------------------- I2C2 clock source configuration ---------------------*/
|
|
if (((PeriphClkInit->PeriphClockSelection) & RCC_PERIPHCLK_I2C2) == RCC_PERIPHCLK_I2C2)
|
|
8004414: 687b ldr r3, [r7, #4]
|
|
8004416: 681b ldr r3, [r3, #0]
|
|
8004418: f003 0380 and.w r3, r3, #128 @ 0x80
|
|
800441c: 2b00 cmp r3, #0
|
|
800441e: d004 beq.n 800442a <HAL_RCCEx_PeriphCLKConfig+0x182>
|
|
{
|
|
/* Check the parameters */
|
|
assert_param(IS_RCC_I2C2CLKSOURCE(PeriphClkInit->I2c2ClockSelection));
|
|
|
|
/* Configure the I2C2 clock source */
|
|
__HAL_RCC_I2C2_CONFIG(PeriphClkInit->I2c2ClockSelection);
|
|
8004420: 687b ldr r3, [r7, #4]
|
|
8004422: 699b ldr r3, [r3, #24]
|
|
8004424: 4618 mov r0, r3
|
|
8004426: f7ff fe9e bl 8004166 <LL_RCC_SetI2CClockSource>
|
|
}
|
|
|
|
/*-------------------- I2C3 clock source configuration ---------------------*/
|
|
if (((PeriphClkInit->PeriphClockSelection) & RCC_PERIPHCLK_I2C3) == RCC_PERIPHCLK_I2C3)
|
|
800442a: 687b ldr r3, [r7, #4]
|
|
800442c: 681b ldr r3, [r3, #0]
|
|
800442e: f403 7380 and.w r3, r3, #256 @ 0x100
|
|
8004432: 2b00 cmp r3, #0
|
|
8004434: d004 beq.n 8004440 <HAL_RCCEx_PeriphCLKConfig+0x198>
|
|
{
|
|
/* Check the parameters */
|
|
assert_param(IS_RCC_I2C3CLKSOURCE(PeriphClkInit->I2c3ClockSelection));
|
|
|
|
/* Configure the I2C3 clock source */
|
|
__HAL_RCC_I2C3_CONFIG(PeriphClkInit->I2c3ClockSelection);
|
|
8004436: 687b ldr r3, [r7, #4]
|
|
8004438: 69db ldr r3, [r3, #28]
|
|
800443a: 4618 mov r0, r3
|
|
800443c: f7ff fe93 bl 8004166 <LL_RCC_SetI2CClockSource>
|
|
}
|
|
|
|
/*-------------------- I2S2 clock source configuration ---------------------*/
|
|
if (((PeriphClkInit->PeriphClockSelection) & RCC_PERIPHCLK_I2S2) == (RCC_PERIPHCLK_I2S2))
|
|
8004440: 687b ldr r3, [r7, #4]
|
|
8004442: 681b ldr r3, [r3, #0]
|
|
8004444: f003 0310 and.w r3, r3, #16
|
|
8004448: 2b00 cmp r3, #0
|
|
800444a: d011 beq.n 8004470 <HAL_RCCEx_PeriphCLKConfig+0x1c8>
|
|
{
|
|
/* Check the parameters */
|
|
assert_param(IS_RCC_I2S2CLKSOURCE(PeriphClkInit->I2s2ClockSelection));
|
|
|
|
/* Configure the I2S2 clock source */
|
|
__HAL_RCC_I2S2_CONFIG(PeriphClkInit->I2s2ClockSelection);
|
|
800444c: 687b ldr r3, [r7, #4]
|
|
800444e: 68db ldr r3, [r3, #12]
|
|
8004450: 4618 mov r0, r3
|
|
8004452: f7ff fe5e bl 8004112 <LL_RCC_SetI2SClockSource>
|
|
|
|
if (PeriphClkInit->I2s2ClockSelection == RCC_I2S2CLKSOURCE_PLL)
|
|
8004456: 687b ldr r3, [r7, #4]
|
|
8004458: 68db ldr r3, [r3, #12]
|
|
800445a: f5b3 7f80 cmp.w r3, #256 @ 0x100
|
|
800445e: d107 bne.n 8004470 <HAL_RCCEx_PeriphCLKConfig+0x1c8>
|
|
{
|
|
/* Enable RCC_PLL_I2S2CLK output */
|
|
__HAL_RCC_PLLCLKOUT_ENABLE(RCC_PLL_I2S2CLK);
|
|
8004460: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8004464: 68db ldr r3, [r3, #12]
|
|
8004466: f04f 42b0 mov.w r2, #1476395008 @ 0x58000000
|
|
800446a: f043 7380 orr.w r3, r3, #16777216 @ 0x1000000
|
|
800446e: 60d3 str r3, [r2, #12]
|
|
}
|
|
}
|
|
|
|
/*-------------------- RNG clock source configuration ----------------------*/
|
|
if (((PeriphClkInit->PeriphClockSelection) & RCC_PERIPHCLK_RNG) == (RCC_PERIPHCLK_RNG))
|
|
8004470: 687b ldr r3, [r7, #4]
|
|
8004472: 681b ldr r3, [r3, #0]
|
|
8004474: f403 4300 and.w r3, r3, #32768 @ 0x8000
|
|
8004478: 2b00 cmp r3, #0
|
|
800447a: d010 beq.n 800449e <HAL_RCCEx_PeriphCLKConfig+0x1f6>
|
|
{
|
|
assert_param(IS_RCC_RNGCLKSOURCE(PeriphClkInit->RngClockSelection));
|
|
__HAL_RCC_RNG_CONFIG(PeriphClkInit->RngClockSelection);
|
|
800447c: 687b ldr r3, [r7, #4]
|
|
800447e: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
8004480: 4618 mov r0, r3
|
|
8004482: f7ff fea5 bl 80041d0 <LL_RCC_SetRNGClockSource>
|
|
|
|
if (PeriphClkInit->RngClockSelection == RCC_RNGCLKSOURCE_PLL)
|
|
8004486: 687b ldr r3, [r7, #4]
|
|
8004488: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
800448a: 2b00 cmp r3, #0
|
|
800448c: d107 bne.n 800449e <HAL_RCCEx_PeriphCLKConfig+0x1f6>
|
|
{
|
|
/* Enable RCC_PLL_RNGCLK output */
|
|
__HAL_RCC_PLLCLKOUT_ENABLE(RCC_PLL_RNGCLK);
|
|
800448e: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8004492: 68db ldr r3, [r3, #12]
|
|
8004494: f04f 42b0 mov.w r2, #1476395008 @ 0x58000000
|
|
8004498: f043 7380 orr.w r3, r3, #16777216 @ 0x1000000
|
|
800449c: 60d3 str r3, [r2, #12]
|
|
}
|
|
}
|
|
|
|
/*-------------------- ADC clock source configuration ----------------------*/
|
|
if (((PeriphClkInit->PeriphClockSelection) & RCC_PERIPHCLK_ADC) == RCC_PERIPHCLK_ADC)
|
|
800449e: 687b ldr r3, [r7, #4]
|
|
80044a0: 681b ldr r3, [r3, #0]
|
|
80044a2: f403 4380 and.w r3, r3, #16384 @ 0x4000
|
|
80044a6: 2b00 cmp r3, #0
|
|
80044a8: d011 beq.n 80044ce <HAL_RCCEx_PeriphCLKConfig+0x226>
|
|
{
|
|
/* Check the parameters */
|
|
assert_param(IS_RCC_ADCCLKSOURCE(PeriphClkInit->AdcClockSelection));
|
|
|
|
/* Configure the ADC interface clock source */
|
|
__HAL_RCC_ADC_CONFIG(PeriphClkInit->AdcClockSelection);
|
|
80044aa: 687b ldr r3, [r7, #4]
|
|
80044ac: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
80044ae: 4618 mov r0, r3
|
|
80044b0: f7ff fea3 bl 80041fa <LL_RCC_SetADCClockSource>
|
|
|
|
if (PeriphClkInit->AdcClockSelection == RCC_ADCCLKSOURCE_PLL)
|
|
80044b4: 687b ldr r3, [r7, #4]
|
|
80044b6: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
80044b8: f1b3 5f00 cmp.w r3, #536870912 @ 0x20000000
|
|
80044bc: d107 bne.n 80044ce <HAL_RCCEx_PeriphCLKConfig+0x226>
|
|
{
|
|
/* Enable RCC_PLL_RNGCLK output */
|
|
__HAL_RCC_PLLCLKOUT_ENABLE(RCC_PLL_ADCCLK);
|
|
80044be: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
80044c2: 68db ldr r3, [r3, #12]
|
|
80044c4: f04f 42b0 mov.w r2, #1476395008 @ 0x58000000
|
|
80044c8: f443 3380 orr.w r3, r3, #65536 @ 0x10000
|
|
80044cc: 60d3 str r3, [r2, #12]
|
|
}
|
|
}
|
|
|
|
return status;
|
|
80044ce: 7cbb ldrb r3, [r7, #18]
|
|
}
|
|
80044d0: 4618 mov r0, r3
|
|
80044d2: 3718 adds r7, #24
|
|
80044d4: 46bd mov sp, r7
|
|
80044d6: bd80 pop {r7, pc}
|
|
80044d8: 58000400 .word 0x58000400
|
|
|
|
080044dc <HAL_RTC_Init>:
|
|
* @brief Initialize the RTC peripheral
|
|
* @param hrtc RTC handle
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_RTC_Init(RTC_HandleTypeDef *hrtc)
|
|
{
|
|
80044dc: b580 push {r7, lr}
|
|
80044de: b084 sub sp, #16
|
|
80044e0: af00 add r7, sp, #0
|
|
80044e2: 6078 str r0, [r7, #4]
|
|
HAL_StatusTypeDef status = HAL_ERROR;
|
|
80044e4: 2301 movs r3, #1
|
|
80044e6: 73fb strb r3, [r7, #15]
|
|
|
|
/* Check the RTC peripheral state */
|
|
if (hrtc != NULL)
|
|
80044e8: 687b ldr r3, [r7, #4]
|
|
80044ea: 2b00 cmp r3, #0
|
|
80044ec: d07b beq.n 80045e6 <HAL_RTC_Init+0x10a>
|
|
{
|
|
hrtc->MspDeInitCallback = HAL_RTC_MspDeInit;
|
|
}
|
|
}
|
|
#else
|
|
if (hrtc->State == HAL_RTC_STATE_RESET)
|
|
80044ee: 687b ldr r3, [r7, #4]
|
|
80044f0: f893 302d ldrb.w r3, [r3, #45] @ 0x2d
|
|
80044f4: b2db uxtb r3, r3
|
|
80044f6: 2b00 cmp r3, #0
|
|
80044f8: d106 bne.n 8004508 <HAL_RTC_Init+0x2c>
|
|
{
|
|
/* Allocate lock resource and initialize it */
|
|
hrtc->Lock = HAL_UNLOCKED;
|
|
80044fa: 687b ldr r3, [r7, #4]
|
|
80044fc: 2200 movs r2, #0
|
|
80044fe: f883 202c strb.w r2, [r3, #44] @ 0x2c
|
|
|
|
/* Initialize RTC MSP */
|
|
HAL_RTC_MspInit(hrtc);
|
|
8004502: 6878 ldr r0, [r7, #4]
|
|
8004504: f7fc f9e4 bl 80008d0 <HAL_RTC_MspInit>
|
|
}
|
|
#endif /* (USE_HAL_RTC_REGISTER_CALLBACKS) */
|
|
|
|
/* Set RTC state */
|
|
hrtc->State = HAL_RTC_STATE_BUSY;
|
|
8004508: 687b ldr r3, [r7, #4]
|
|
800450a: 2202 movs r2, #2
|
|
800450c: f883 202d strb.w r2, [r3, #45] @ 0x2d
|
|
|
|
/* Check whether the calendar needs to be initialized */
|
|
if (__HAL_RTC_IS_CALENDAR_INITIALIZED(hrtc) == 0U)
|
|
8004510: 4b37 ldr r3, [pc, #220] @ (80045f0 <HAL_RTC_Init+0x114>)
|
|
8004512: 68db ldr r3, [r3, #12]
|
|
8004514: f003 0310 and.w r3, r3, #16
|
|
8004518: 2b10 cmp r3, #16
|
|
800451a: d05b beq.n 80045d4 <HAL_RTC_Init+0xf8>
|
|
{
|
|
/* Check that the RTC mode is not 'binary only' */
|
|
if (__HAL_RTC_GET_BINARY_MODE(hrtc) != RTC_BINARY_ONLY)
|
|
800451c: 4b34 ldr r3, [pc, #208] @ (80045f0 <HAL_RTC_Init+0x114>)
|
|
800451e: 68db ldr r3, [r3, #12]
|
|
8004520: f403 7340 and.w r3, r3, #768 @ 0x300
|
|
8004524: f5b3 7f80 cmp.w r3, #256 @ 0x100
|
|
8004528: d051 beq.n 80045ce <HAL_RTC_Init+0xf2>
|
|
{
|
|
/* Disable the write protection for RTC registers */
|
|
__HAL_RTC_WRITEPROTECTION_DISABLE(hrtc);
|
|
800452a: 4b31 ldr r3, [pc, #196] @ (80045f0 <HAL_RTC_Init+0x114>)
|
|
800452c: 22ca movs r2, #202 @ 0xca
|
|
800452e: 625a str r2, [r3, #36] @ 0x24
|
|
8004530: 4b2f ldr r3, [pc, #188] @ (80045f0 <HAL_RTC_Init+0x114>)
|
|
8004532: 2253 movs r2, #83 @ 0x53
|
|
8004534: 625a str r2, [r3, #36] @ 0x24
|
|
|
|
/* Enter Initialization mode */
|
|
status = RTC_EnterInitMode(hrtc);
|
|
8004536: 6878 ldr r0, [r7, #4]
|
|
8004538: f000 fa14 bl 8004964 <RTC_EnterInitMode>
|
|
800453c: 4603 mov r3, r0
|
|
800453e: 73fb strb r3, [r7, #15]
|
|
|
|
if (status == HAL_OK)
|
|
8004540: 7bfb ldrb r3, [r7, #15]
|
|
8004542: 2b00 cmp r3, #0
|
|
8004544: d13f bne.n 80045c6 <HAL_RTC_Init+0xea>
|
|
{
|
|
/* Clear RTC_CR FMT, OSEL and POL Bits */
|
|
CLEAR_BIT(RTC->CR, (RTC_CR_FMT | RTC_CR_POL | RTC_CR_OSEL | RTC_CR_TAMPOE));
|
|
8004546: 4b2a ldr r3, [pc, #168] @ (80045f0 <HAL_RTC_Init+0x114>)
|
|
8004548: 699b ldr r3, [r3, #24]
|
|
800454a: 4a29 ldr r2, [pc, #164] @ (80045f0 <HAL_RTC_Init+0x114>)
|
|
800454c: f023 638e bic.w r3, r3, #74448896 @ 0x4700000
|
|
8004550: f023 0340 bic.w r3, r3, #64 @ 0x40
|
|
8004554: 6193 str r3, [r2, #24]
|
|
/* Set RTC_CR register */
|
|
SET_BIT(RTC->CR, (hrtc->Init.HourFormat | hrtc->Init.OutPut | hrtc->Init.OutPutPolarity));
|
|
8004556: 4b26 ldr r3, [pc, #152] @ (80045f0 <HAL_RTC_Init+0x114>)
|
|
8004558: 699a ldr r2, [r3, #24]
|
|
800455a: 687b ldr r3, [r7, #4]
|
|
800455c: 6859 ldr r1, [r3, #4]
|
|
800455e: 687b ldr r3, [r7, #4]
|
|
8004560: 691b ldr r3, [r3, #16]
|
|
8004562: 4319 orrs r1, r3
|
|
8004564: 687b ldr r3, [r7, #4]
|
|
8004566: 699b ldr r3, [r3, #24]
|
|
8004568: 430b orrs r3, r1
|
|
800456a: 4921 ldr r1, [pc, #132] @ (80045f0 <HAL_RTC_Init+0x114>)
|
|
800456c: 4313 orrs r3, r2
|
|
800456e: 618b str r3, [r1, #24]
|
|
|
|
/* Configure the RTC PRER */
|
|
WRITE_REG(RTC->PRER, ((hrtc->Init.SynchPrediv) | (hrtc->Init.AsynchPrediv << RTC_PRER_PREDIV_A_Pos)));
|
|
8004570: 687b ldr r3, [r7, #4]
|
|
8004572: 68da ldr r2, [r3, #12]
|
|
8004574: 687b ldr r3, [r7, #4]
|
|
8004576: 689b ldr r3, [r3, #8]
|
|
8004578: 041b lsls r3, r3, #16
|
|
800457a: 491d ldr r1, [pc, #116] @ (80045f0 <HAL_RTC_Init+0x114>)
|
|
800457c: 4313 orrs r3, r2
|
|
800457e: 610b str r3, [r1, #16]
|
|
|
|
/* Configure the Binary mode */
|
|
MODIFY_REG(RTC->ICSR, RTC_ICSR_BIN | RTC_ICSR_BCDU, hrtc->Init.BinMode | hrtc->Init.BinMixBcdU);
|
|
8004580: 4b1b ldr r3, [pc, #108] @ (80045f0 <HAL_RTC_Init+0x114>)
|
|
8004582: 68db ldr r3, [r3, #12]
|
|
8004584: f423 52f8 bic.w r2, r3, #7936 @ 0x1f00
|
|
8004588: 687b ldr r3, [r7, #4]
|
|
800458a: 6a59 ldr r1, [r3, #36] @ 0x24
|
|
800458c: 687b ldr r3, [r7, #4]
|
|
800458e: 6a9b ldr r3, [r3, #40] @ 0x28
|
|
8004590: 430b orrs r3, r1
|
|
8004592: 4917 ldr r1, [pc, #92] @ (80045f0 <HAL_RTC_Init+0x114>)
|
|
8004594: 4313 orrs r3, r2
|
|
8004596: 60cb str r3, [r1, #12]
|
|
|
|
/* Exit Initialization mode */
|
|
status = RTC_ExitInitMode(hrtc);
|
|
8004598: 6878 ldr r0, [r7, #4]
|
|
800459a: f000 fa17 bl 80049cc <RTC_ExitInitMode>
|
|
800459e: 4603 mov r3, r0
|
|
80045a0: 73fb strb r3, [r7, #15]
|
|
|
|
if (status == HAL_OK)
|
|
80045a2: 7bfb ldrb r3, [r7, #15]
|
|
80045a4: 2b00 cmp r3, #0
|
|
80045a6: d10e bne.n 80045c6 <HAL_RTC_Init+0xea>
|
|
{
|
|
MODIFY_REG(RTC->CR, \
|
|
80045a8: 4b11 ldr r3, [pc, #68] @ (80045f0 <HAL_RTC_Init+0x114>)
|
|
80045aa: 699b ldr r3, [r3, #24]
|
|
80045ac: f023 4260 bic.w r2, r3, #3758096384 @ 0xe0000000
|
|
80045b0: 687b ldr r3, [r7, #4]
|
|
80045b2: 6a19 ldr r1, [r3, #32]
|
|
80045b4: 687b ldr r3, [r7, #4]
|
|
80045b6: 69db ldr r3, [r3, #28]
|
|
80045b8: 4319 orrs r1, r3
|
|
80045ba: 687b ldr r3, [r7, #4]
|
|
80045bc: 695b ldr r3, [r3, #20]
|
|
80045be: 430b orrs r3, r1
|
|
80045c0: 490b ldr r1, [pc, #44] @ (80045f0 <HAL_RTC_Init+0x114>)
|
|
80045c2: 4313 orrs r3, r2
|
|
80045c4: 618b str r3, [r1, #24]
|
|
hrtc->Init.OutPutPullUp | hrtc->Init.OutPutType | hrtc->Init.OutPutRemap);
|
|
}
|
|
}
|
|
|
|
/* Enable the write protection for RTC registers */
|
|
__HAL_RTC_WRITEPROTECTION_ENABLE(hrtc);
|
|
80045c6: 4b0a ldr r3, [pc, #40] @ (80045f0 <HAL_RTC_Init+0x114>)
|
|
80045c8: 22ff movs r2, #255 @ 0xff
|
|
80045ca: 625a str r2, [r3, #36] @ 0x24
|
|
80045cc: e004 b.n 80045d8 <HAL_RTC_Init+0xfc>
|
|
}
|
|
else
|
|
{
|
|
/* The calendar does not need to be initialized as the 'binary only' mode is selected */
|
|
status = HAL_OK;
|
|
80045ce: 2300 movs r3, #0
|
|
80045d0: 73fb strb r3, [r7, #15]
|
|
80045d2: e001 b.n 80045d8 <HAL_RTC_Init+0xfc>
|
|
}
|
|
}
|
|
else
|
|
{
|
|
/* The calendar is already initialized */
|
|
status = HAL_OK;
|
|
80045d4: 2300 movs r3, #0
|
|
80045d6: 73fb strb r3, [r7, #15]
|
|
}
|
|
|
|
if (status == HAL_OK)
|
|
80045d8: 7bfb ldrb r3, [r7, #15]
|
|
80045da: 2b00 cmp r3, #0
|
|
80045dc: d103 bne.n 80045e6 <HAL_RTC_Init+0x10a>
|
|
{
|
|
hrtc->State = HAL_RTC_STATE_READY;
|
|
80045de: 687b ldr r3, [r7, #4]
|
|
80045e0: 2201 movs r2, #1
|
|
80045e2: f883 202d strb.w r2, [r3, #45] @ 0x2d
|
|
}
|
|
}
|
|
|
|
return status;
|
|
80045e6: 7bfb ldrb r3, [r7, #15]
|
|
}
|
|
80045e8: 4618 mov r0, r3
|
|
80045ea: 3710 adds r7, #16
|
|
80045ec: 46bd mov sp, r7
|
|
80045ee: bd80 pop {r7, pc}
|
|
80045f0: 40002800 .word 0x40002800
|
|
|
|
080045f4 <HAL_RTC_SetAlarm_IT>:
|
|
* @arg RTC_FORMAT_BIN: Binary format
|
|
* @arg RTC_FORMAT_BCD: BCD format
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_RTC_SetAlarm_IT(RTC_HandleTypeDef *hrtc, RTC_AlarmTypeDef *sAlarm, uint32_t Format)
|
|
{
|
|
80045f4: b590 push {r4, r7, lr}
|
|
80045f6: b087 sub sp, #28
|
|
80045f8: af00 add r7, sp, #0
|
|
80045fa: 60f8 str r0, [r7, #12]
|
|
80045fc: 60b9 str r1, [r7, #8]
|
|
80045fe: 607a str r2, [r7, #4]
|
|
uint32_t tmpreg = 0;
|
|
8004600: 2300 movs r3, #0
|
|
8004602: 617b str r3, [r7, #20]
|
|
uint32_t binaryMode;
|
|
|
|
/* Process Locked */
|
|
__HAL_LOCK(hrtc);
|
|
8004604: 68fb ldr r3, [r7, #12]
|
|
8004606: f893 302c ldrb.w r3, [r3, #44] @ 0x2c
|
|
800460a: 2b01 cmp r3, #1
|
|
800460c: d101 bne.n 8004612 <HAL_RTC_SetAlarm_IT+0x1e>
|
|
800460e: 2302 movs r3, #2
|
|
8004610: e0f3 b.n 80047fa <HAL_RTC_SetAlarm_IT+0x206>
|
|
8004612: 68fb ldr r3, [r7, #12]
|
|
8004614: 2201 movs r2, #1
|
|
8004616: f883 202c strb.w r2, [r3, #44] @ 0x2c
|
|
hrtc->State = HAL_RTC_STATE_BUSY;
|
|
800461a: 68fb ldr r3, [r7, #12]
|
|
800461c: 2202 movs r2, #2
|
|
800461e: f883 202d strb.w r2, [r3, #45] @ 0x2d
|
|
RTC_ICSR_BCDU) >> RTC_ICSR_BCDU_Pos)));
|
|
}
|
|
#endif /* USE_FULL_ASSERT */
|
|
|
|
/* Get Binary mode (32-bit free-running counter configuration) */
|
|
binaryMode = READ_BIT(RTC->ICSR, RTC_ICSR_BIN);
|
|
8004622: 4b78 ldr r3, [pc, #480] @ (8004804 <HAL_RTC_SetAlarm_IT+0x210>)
|
|
8004624: 68db ldr r3, [r3, #12]
|
|
8004626: f403 7340 and.w r3, r3, #768 @ 0x300
|
|
800462a: 613b str r3, [r7, #16]
|
|
|
|
if (binaryMode != RTC_BINARY_ONLY)
|
|
800462c: 693b ldr r3, [r7, #16]
|
|
800462e: f5b3 7f80 cmp.w r3, #256 @ 0x100
|
|
8004632: d06a beq.n 800470a <HAL_RTC_SetAlarm_IT+0x116>
|
|
{
|
|
if (Format == RTC_FORMAT_BIN)
|
|
8004634: 687b ldr r3, [r7, #4]
|
|
8004636: 2b00 cmp r3, #0
|
|
8004638: d13a bne.n 80046b0 <HAL_RTC_SetAlarm_IT+0xbc>
|
|
{
|
|
if (READ_BIT(RTC->CR, RTC_CR_FMT) != 0U)
|
|
800463a: 4b72 ldr r3, [pc, #456] @ (8004804 <HAL_RTC_SetAlarm_IT+0x210>)
|
|
800463c: 699b ldr r3, [r3, #24]
|
|
800463e: f003 0340 and.w r3, r3, #64 @ 0x40
|
|
8004642: 2b00 cmp r3, #0
|
|
8004644: d102 bne.n 800464c <HAL_RTC_SetAlarm_IT+0x58>
|
|
assert_param(IS_RTC_HOUR12(sAlarm->AlarmTime.Hours));
|
|
assert_param(IS_RTC_HOURFORMAT12(sAlarm->AlarmTime.TimeFormat));
|
|
}
|
|
else
|
|
{
|
|
sAlarm->AlarmTime.TimeFormat = 0x00U;
|
|
8004646: 68bb ldr r3, [r7, #8]
|
|
8004648: 2200 movs r2, #0
|
|
800464a: 70da strb r2, [r3, #3]
|
|
assert_param(IS_RTC_HOUR24(sAlarm->AlarmTime.Hours));
|
|
}
|
|
assert_param(IS_RTC_MINUTES(sAlarm->AlarmTime.Minutes));
|
|
assert_param(IS_RTC_SECONDS(sAlarm->AlarmTime.Seconds));
|
|
|
|
if (sAlarm->AlarmMask != RTC_ALARMMASK_DATEWEEKDAY)
|
|
800464c: 68bb ldr r3, [r7, #8]
|
|
800464e: 695b ldr r3, [r3, #20]
|
|
8004650: f1b3 4f00 cmp.w r3, #2147483648 @ 0x80000000
|
|
{
|
|
assert_param(IS_RTC_ALARM_DATE_WEEKDAY_WEEKDAY(sAlarm->AlarmDateWeekDay));
|
|
}
|
|
}
|
|
|
|
tmpreg = (((uint32_t)RTC_ByteToBcd2(sAlarm->AlarmTime.Hours) << RTC_ALRMAR_HU_Pos) | \
|
|
8004654: 68bb ldr r3, [r7, #8]
|
|
8004656: 781b ldrb r3, [r3, #0]
|
|
8004658: 4618 mov r0, r3
|
|
800465a: f000 f9f5 bl 8004a48 <RTC_ByteToBcd2>
|
|
800465e: 4603 mov r3, r0
|
|
8004660: 041c lsls r4, r3, #16
|
|
((uint32_t)RTC_ByteToBcd2(sAlarm->AlarmTime.Minutes) << RTC_ALRMAR_MNU_Pos) | \
|
|
8004662: 68bb ldr r3, [r7, #8]
|
|
8004664: 785b ldrb r3, [r3, #1]
|
|
8004666: 4618 mov r0, r3
|
|
8004668: f000 f9ee bl 8004a48 <RTC_ByteToBcd2>
|
|
800466c: 4603 mov r3, r0
|
|
800466e: 021b lsls r3, r3, #8
|
|
tmpreg = (((uint32_t)RTC_ByteToBcd2(sAlarm->AlarmTime.Hours) << RTC_ALRMAR_HU_Pos) | \
|
|
8004670: 431c orrs r4, r3
|
|
((uint32_t)RTC_ByteToBcd2(sAlarm->AlarmTime.Seconds) << RTC_ALRMAR_SU_Pos) | \
|
|
8004672: 68bb ldr r3, [r7, #8]
|
|
8004674: 789b ldrb r3, [r3, #2]
|
|
8004676: 4618 mov r0, r3
|
|
8004678: f000 f9e6 bl 8004a48 <RTC_ByteToBcd2>
|
|
800467c: 4603 mov r3, r0
|
|
((uint32_t)RTC_ByteToBcd2(sAlarm->AlarmTime.Minutes) << RTC_ALRMAR_MNU_Pos) | \
|
|
800467e: ea44 0203 orr.w r2, r4, r3
|
|
((uint32_t)(sAlarm->AlarmTime.TimeFormat) << RTC_ALRMAR_PM_Pos) | \
|
|
8004682: 68bb ldr r3, [r7, #8]
|
|
8004684: 78db ldrb r3, [r3, #3]
|
|
8004686: 059b lsls r3, r3, #22
|
|
((uint32_t)RTC_ByteToBcd2(sAlarm->AlarmTime.Seconds) << RTC_ALRMAR_SU_Pos) | \
|
|
8004688: ea42 0403 orr.w r4, r2, r3
|
|
((uint32_t)RTC_ByteToBcd2(sAlarm->AlarmDateWeekDay) << RTC_ALRMAR_DU_Pos) | \
|
|
800468c: 68bb ldr r3, [r7, #8]
|
|
800468e: f893 3024 ldrb.w r3, [r3, #36] @ 0x24
|
|
8004692: 4618 mov r0, r3
|
|
8004694: f000 f9d8 bl 8004a48 <RTC_ByteToBcd2>
|
|
8004698: 4603 mov r3, r0
|
|
800469a: 061b lsls r3, r3, #24
|
|
((uint32_t)(sAlarm->AlarmTime.TimeFormat) << RTC_ALRMAR_PM_Pos) | \
|
|
800469c: ea44 0203 orr.w r2, r4, r3
|
|
((uint32_t)sAlarm->AlarmDateWeekDaySel) | \
|
|
80046a0: 68bb ldr r3, [r7, #8]
|
|
80046a2: 6a1b ldr r3, [r3, #32]
|
|
((uint32_t)RTC_ByteToBcd2(sAlarm->AlarmDateWeekDay) << RTC_ALRMAR_DU_Pos) | \
|
|
80046a4: 431a orrs r2, r3
|
|
((uint32_t)sAlarm->AlarmMask));
|
|
80046a6: 68bb ldr r3, [r7, #8]
|
|
80046a8: 695b ldr r3, [r3, #20]
|
|
tmpreg = (((uint32_t)RTC_ByteToBcd2(sAlarm->AlarmTime.Hours) << RTC_ALRMAR_HU_Pos) | \
|
|
80046aa: 4313 orrs r3, r2
|
|
80046ac: 617b str r3, [r7, #20]
|
|
80046ae: e02c b.n 800470a <HAL_RTC_SetAlarm_IT+0x116>
|
|
}
|
|
else /* Format BCD */
|
|
{
|
|
if (sAlarm->AlarmMask != RTC_ALARMMASK_ALL)
|
|
80046b0: 68bb ldr r3, [r7, #8]
|
|
80046b2: 695b ldr r3, [r3, #20]
|
|
80046b4: f1b3 3f80 cmp.w r3, #2155905152 @ 0x80808080
|
|
80046b8: d00d beq.n 80046d6 <HAL_RTC_SetAlarm_IT+0xe2>
|
|
{
|
|
if (sAlarm->AlarmMask != RTC_ALARMMASK_HOURS)
|
|
80046ba: 68bb ldr r3, [r7, #8]
|
|
80046bc: 695b ldr r3, [r3, #20]
|
|
80046be: f5b3 0f00 cmp.w r3, #8388608 @ 0x800000
|
|
80046c2: d008 beq.n 80046d6 <HAL_RTC_SetAlarm_IT+0xe2>
|
|
{
|
|
if (READ_BIT(RTC->CR, RTC_CR_FMT) != 0U)
|
|
80046c4: 4b4f ldr r3, [pc, #316] @ (8004804 <HAL_RTC_SetAlarm_IT+0x210>)
|
|
80046c6: 699b ldr r3, [r3, #24]
|
|
80046c8: f003 0340 and.w r3, r3, #64 @ 0x40
|
|
80046cc: 2b00 cmp r3, #0
|
|
80046ce: d102 bne.n 80046d6 <HAL_RTC_SetAlarm_IT+0xe2>
|
|
assert_param(IS_RTC_HOUR12(RTC_Bcd2ToByte(sAlarm->AlarmTime.Hours)));
|
|
assert_param(IS_RTC_HOURFORMAT12(sAlarm->AlarmTime.TimeFormat));
|
|
}
|
|
else
|
|
{
|
|
sAlarm->AlarmTime.TimeFormat = 0x00U;
|
|
80046d0: 68bb ldr r3, [r7, #8]
|
|
80046d2: 2200 movs r2, #0
|
|
80046d4: 70da strb r2, [r3, #3]
|
|
{
|
|
assert_param(IS_RTC_ALARM_DATE_WEEKDAY_WEEKDAY(RTC_Bcd2ToByte(sAlarm->AlarmDateWeekDay)));
|
|
}
|
|
}
|
|
#endif /* USE_FULL_ASSERT */
|
|
tmpreg = (((uint32_t)(sAlarm->AlarmTime.Hours) << RTC_ALRMAR_HU_Pos) | \
|
|
80046d6: 68bb ldr r3, [r7, #8]
|
|
80046d8: 781b ldrb r3, [r3, #0]
|
|
80046da: 041a lsls r2, r3, #16
|
|
((uint32_t)(sAlarm->AlarmTime.Minutes) << RTC_ALRMAR_MNU_Pos) | \
|
|
80046dc: 68bb ldr r3, [r7, #8]
|
|
80046de: 785b ldrb r3, [r3, #1]
|
|
80046e0: 021b lsls r3, r3, #8
|
|
tmpreg = (((uint32_t)(sAlarm->AlarmTime.Hours) << RTC_ALRMAR_HU_Pos) | \
|
|
80046e2: 4313 orrs r3, r2
|
|
((uint32_t)(sAlarm->AlarmTime.Seconds) << RTC_ALRMAR_SU_Pos) | \
|
|
80046e4: 68ba ldr r2, [r7, #8]
|
|
80046e6: 7892 ldrb r2, [r2, #2]
|
|
((uint32_t)(sAlarm->AlarmTime.Minutes) << RTC_ALRMAR_MNU_Pos) | \
|
|
80046e8: 431a orrs r2, r3
|
|
((uint32_t)(sAlarm->AlarmTime.TimeFormat) << RTC_ALRMAR_PM_Pos) | \
|
|
80046ea: 68bb ldr r3, [r7, #8]
|
|
80046ec: 78db ldrb r3, [r3, #3]
|
|
80046ee: 059b lsls r3, r3, #22
|
|
((uint32_t)(sAlarm->AlarmTime.Seconds) << RTC_ALRMAR_SU_Pos) | \
|
|
80046f0: 431a orrs r2, r3
|
|
((uint32_t)(sAlarm->AlarmDateWeekDay) << RTC_ALRMAR_DU_Pos) | \
|
|
80046f2: 68bb ldr r3, [r7, #8]
|
|
80046f4: f893 3024 ldrb.w r3, [r3, #36] @ 0x24
|
|
80046f8: 061b lsls r3, r3, #24
|
|
((uint32_t)(sAlarm->AlarmTime.TimeFormat) << RTC_ALRMAR_PM_Pos) | \
|
|
80046fa: 431a orrs r2, r3
|
|
((uint32_t)sAlarm->AlarmDateWeekDaySel) | \
|
|
80046fc: 68bb ldr r3, [r7, #8]
|
|
80046fe: 6a1b ldr r3, [r3, #32]
|
|
((uint32_t)(sAlarm->AlarmDateWeekDay) << RTC_ALRMAR_DU_Pos) | \
|
|
8004700: 431a orrs r2, r3
|
|
((uint32_t)sAlarm->AlarmMask));
|
|
8004702: 68bb ldr r3, [r7, #8]
|
|
8004704: 695b ldr r3, [r3, #20]
|
|
tmpreg = (((uint32_t)(sAlarm->AlarmTime.Hours) << RTC_ALRMAR_HU_Pos) | \
|
|
8004706: 4313 orrs r3, r2
|
|
8004708: 617b str r3, [r7, #20]
|
|
|
|
}
|
|
}
|
|
|
|
/* Disable the write protection for RTC registers */
|
|
__HAL_RTC_WRITEPROTECTION_DISABLE(hrtc);
|
|
800470a: 4b3e ldr r3, [pc, #248] @ (8004804 <HAL_RTC_SetAlarm_IT+0x210>)
|
|
800470c: 22ca movs r2, #202 @ 0xca
|
|
800470e: 625a str r2, [r3, #36] @ 0x24
|
|
8004710: 4b3c ldr r3, [pc, #240] @ (8004804 <HAL_RTC_SetAlarm_IT+0x210>)
|
|
8004712: 2253 movs r2, #83 @ 0x53
|
|
8004714: 625a str r2, [r3, #36] @ 0x24
|
|
|
|
/* Configure the Alarm register */
|
|
if (sAlarm->Alarm == RTC_ALARM_A)
|
|
8004716: 68bb ldr r3, [r7, #8]
|
|
8004718: 6a9b ldr r3, [r3, #40] @ 0x28
|
|
800471a: f5b3 7f80 cmp.w r3, #256 @ 0x100
|
|
800471e: d12c bne.n 800477a <HAL_RTC_SetAlarm_IT+0x186>
|
|
{
|
|
/* Disable the Alarm A interrupt */
|
|
CLEAR_BIT(RTC->CR, RTC_CR_ALRAE | RTC_CR_ALRAIE);
|
|
8004720: 4b38 ldr r3, [pc, #224] @ (8004804 <HAL_RTC_SetAlarm_IT+0x210>)
|
|
8004722: 699b ldr r3, [r3, #24]
|
|
8004724: 4a37 ldr r2, [pc, #220] @ (8004804 <HAL_RTC_SetAlarm_IT+0x210>)
|
|
8004726: f423 5388 bic.w r3, r3, #4352 @ 0x1100
|
|
800472a: 6193 str r3, [r2, #24]
|
|
/* Clear flag alarm A */
|
|
WRITE_REG(RTC->SCR, RTC_SCR_CALRAF);
|
|
800472c: 4b35 ldr r3, [pc, #212] @ (8004804 <HAL_RTC_SetAlarm_IT+0x210>)
|
|
800472e: 2201 movs r2, #1
|
|
8004730: 65da str r2, [r3, #92] @ 0x5c
|
|
|
|
if (binaryMode == RTC_BINARY_ONLY)
|
|
8004732: 693b ldr r3, [r7, #16]
|
|
8004734: f5b3 7f80 cmp.w r3, #256 @ 0x100
|
|
8004738: d107 bne.n 800474a <HAL_RTC_SetAlarm_IT+0x156>
|
|
{
|
|
RTC->ALRMASSR = sAlarm->AlarmSubSecondMask | sAlarm->BinaryAutoClr;
|
|
800473a: 68bb ldr r3, [r7, #8]
|
|
800473c: 699a ldr r2, [r3, #24]
|
|
800473e: 68bb ldr r3, [r7, #8]
|
|
8004740: 69db ldr r3, [r3, #28]
|
|
8004742: 4930 ldr r1, [pc, #192] @ (8004804 <HAL_RTC_SetAlarm_IT+0x210>)
|
|
8004744: 4313 orrs r3, r2
|
|
8004746: 644b str r3, [r1, #68] @ 0x44
|
|
8004748: e006 b.n 8004758 <HAL_RTC_SetAlarm_IT+0x164>
|
|
}
|
|
else
|
|
{
|
|
WRITE_REG(RTC->ALRMAR, tmpreg);
|
|
800474a: 4a2e ldr r2, [pc, #184] @ (8004804 <HAL_RTC_SetAlarm_IT+0x210>)
|
|
800474c: 697b ldr r3, [r7, #20]
|
|
800474e: 6413 str r3, [r2, #64] @ 0x40
|
|
WRITE_REG(RTC->ALRMASSR, sAlarm->AlarmSubSecondMask);
|
|
8004750: 4a2c ldr r2, [pc, #176] @ (8004804 <HAL_RTC_SetAlarm_IT+0x210>)
|
|
8004752: 68bb ldr r3, [r7, #8]
|
|
8004754: 699b ldr r3, [r3, #24]
|
|
8004756: 6453 str r3, [r2, #68] @ 0x44
|
|
}
|
|
|
|
WRITE_REG(RTC->ALRABINR, sAlarm->AlarmTime.SubSeconds);
|
|
8004758: 4a2a ldr r2, [pc, #168] @ (8004804 <HAL_RTC_SetAlarm_IT+0x210>)
|
|
800475a: 68bb ldr r3, [r7, #8]
|
|
800475c: 685b ldr r3, [r3, #4]
|
|
800475e: 6713 str r3, [r2, #112] @ 0x70
|
|
|
|
/* Store in the handle the Alarm A enabled */
|
|
SET_BIT(hrtc->IsEnabled.RtcFeatures, RTC_MISR_ALRAMF);
|
|
8004760: 68fb ldr r3, [r7, #12]
|
|
8004762: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
8004764: f043 0201 orr.w r2, r3, #1
|
|
8004768: 68fb ldr r3, [r7, #12]
|
|
800476a: 631a str r2, [r3, #48] @ 0x30
|
|
|
|
/* Configure the Alarm interrupt */
|
|
SET_BIT(RTC->CR, RTC_CR_ALRAE | RTC_CR_ALRAIE);
|
|
800476c: 4b25 ldr r3, [pc, #148] @ (8004804 <HAL_RTC_SetAlarm_IT+0x210>)
|
|
800476e: 699b ldr r3, [r3, #24]
|
|
8004770: 4a24 ldr r2, [pc, #144] @ (8004804 <HAL_RTC_SetAlarm_IT+0x210>)
|
|
8004772: f443 5388 orr.w r3, r3, #4352 @ 0x1100
|
|
8004776: 6193 str r3, [r2, #24]
|
|
8004778: e02b b.n 80047d2 <HAL_RTC_SetAlarm_IT+0x1de>
|
|
}
|
|
else
|
|
{
|
|
/* Disable the Alarm B interrupt */
|
|
CLEAR_BIT(RTC->CR, RTC_CR_ALRBE | RTC_CR_ALRBIE);
|
|
800477a: 4b22 ldr r3, [pc, #136] @ (8004804 <HAL_RTC_SetAlarm_IT+0x210>)
|
|
800477c: 699b ldr r3, [r3, #24]
|
|
800477e: 4a21 ldr r2, [pc, #132] @ (8004804 <HAL_RTC_SetAlarm_IT+0x210>)
|
|
8004780: f423 5308 bic.w r3, r3, #8704 @ 0x2200
|
|
8004784: 6193 str r3, [r2, #24]
|
|
/* Clear flag alarm B */
|
|
WRITE_REG(RTC->SCR, RTC_SCR_CALRBF);
|
|
8004786: 4b1f ldr r3, [pc, #124] @ (8004804 <HAL_RTC_SetAlarm_IT+0x210>)
|
|
8004788: 2202 movs r2, #2
|
|
800478a: 65da str r2, [r3, #92] @ 0x5c
|
|
|
|
if (binaryMode == RTC_BINARY_ONLY)
|
|
800478c: 693b ldr r3, [r7, #16]
|
|
800478e: f5b3 7f80 cmp.w r3, #256 @ 0x100
|
|
8004792: d107 bne.n 80047a4 <HAL_RTC_SetAlarm_IT+0x1b0>
|
|
{
|
|
WRITE_REG(RTC->ALRMBSSR, sAlarm->AlarmSubSecondMask | sAlarm->BinaryAutoClr);
|
|
8004794: 68bb ldr r3, [r7, #8]
|
|
8004796: 699a ldr r2, [r3, #24]
|
|
8004798: 68bb ldr r3, [r7, #8]
|
|
800479a: 69db ldr r3, [r3, #28]
|
|
800479c: 4919 ldr r1, [pc, #100] @ (8004804 <HAL_RTC_SetAlarm_IT+0x210>)
|
|
800479e: 4313 orrs r3, r2
|
|
80047a0: 64cb str r3, [r1, #76] @ 0x4c
|
|
80047a2: e006 b.n 80047b2 <HAL_RTC_SetAlarm_IT+0x1be>
|
|
}
|
|
else
|
|
{
|
|
WRITE_REG(RTC->ALRMBR, tmpreg);
|
|
80047a4: 4a17 ldr r2, [pc, #92] @ (8004804 <HAL_RTC_SetAlarm_IT+0x210>)
|
|
80047a6: 697b ldr r3, [r7, #20]
|
|
80047a8: 6493 str r3, [r2, #72] @ 0x48
|
|
WRITE_REG(RTC->ALRMBSSR, sAlarm->AlarmSubSecondMask);
|
|
80047aa: 4a16 ldr r2, [pc, #88] @ (8004804 <HAL_RTC_SetAlarm_IT+0x210>)
|
|
80047ac: 68bb ldr r3, [r7, #8]
|
|
80047ae: 699b ldr r3, [r3, #24]
|
|
80047b0: 64d3 str r3, [r2, #76] @ 0x4c
|
|
}
|
|
|
|
WRITE_REG(RTC->ALRBBINR, sAlarm->AlarmTime.SubSeconds);
|
|
80047b2: 4a14 ldr r2, [pc, #80] @ (8004804 <HAL_RTC_SetAlarm_IT+0x210>)
|
|
80047b4: 68bb ldr r3, [r7, #8]
|
|
80047b6: 685b ldr r3, [r3, #4]
|
|
80047b8: 6753 str r3, [r2, #116] @ 0x74
|
|
|
|
/* Store in the handle the Alarm B enabled */
|
|
SET_BIT(hrtc->IsEnabled.RtcFeatures, RTC_MISR_ALRBMF);
|
|
80047ba: 68fb ldr r3, [r7, #12]
|
|
80047bc: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
80047be: f043 0202 orr.w r2, r3, #2
|
|
80047c2: 68fb ldr r3, [r7, #12]
|
|
80047c4: 631a str r2, [r3, #48] @ 0x30
|
|
|
|
/* Configure the Alarm interrupt */
|
|
SET_BIT(RTC->CR, RTC_CR_ALRBE | RTC_CR_ALRBIE);
|
|
80047c6: 4b0f ldr r3, [pc, #60] @ (8004804 <HAL_RTC_SetAlarm_IT+0x210>)
|
|
80047c8: 699b ldr r3, [r3, #24]
|
|
80047ca: 4a0e ldr r2, [pc, #56] @ (8004804 <HAL_RTC_SetAlarm_IT+0x210>)
|
|
80047cc: f443 5308 orr.w r3, r3, #8704 @ 0x2200
|
|
80047d0: 6193 str r3, [r2, #24]
|
|
}
|
|
|
|
/* RTC Alarm Interrupt Configuration: EXTI configuration */
|
|
__HAL_RTC_ALARM_EXTI_ENABLE_IT();
|
|
80047d2: 4b0d ldr r3, [pc, #52] @ (8004808 <HAL_RTC_SetAlarm_IT+0x214>)
|
|
80047d4: f8d3 3080 ldr.w r3, [r3, #128] @ 0x80
|
|
80047d8: 4a0b ldr r2, [pc, #44] @ (8004808 <HAL_RTC_SetAlarm_IT+0x214>)
|
|
80047da: f443 3300 orr.w r3, r3, #131072 @ 0x20000
|
|
80047de: f8c2 3080 str.w r3, [r2, #128] @ 0x80
|
|
|
|
/* Enable the write protection for RTC registers */
|
|
__HAL_RTC_WRITEPROTECTION_ENABLE(hrtc);
|
|
80047e2: 4b08 ldr r3, [pc, #32] @ (8004804 <HAL_RTC_SetAlarm_IT+0x210>)
|
|
80047e4: 22ff movs r2, #255 @ 0xff
|
|
80047e6: 625a str r2, [r3, #36] @ 0x24
|
|
|
|
hrtc->State = HAL_RTC_STATE_READY;
|
|
80047e8: 68fb ldr r3, [r7, #12]
|
|
80047ea: 2201 movs r2, #1
|
|
80047ec: f883 202d strb.w r2, [r3, #45] @ 0x2d
|
|
|
|
/* Process Unlocked */
|
|
__HAL_UNLOCK(hrtc);
|
|
80047f0: 68fb ldr r3, [r7, #12]
|
|
80047f2: 2200 movs r2, #0
|
|
80047f4: f883 202c strb.w r2, [r3, #44] @ 0x2c
|
|
|
|
return HAL_OK;
|
|
80047f8: 2300 movs r3, #0
|
|
}
|
|
80047fa: 4618 mov r0, r3
|
|
80047fc: 371c adds r7, #28
|
|
80047fe: 46bd mov sp, r7
|
|
8004800: bd90 pop {r4, r7, pc}
|
|
8004802: bf00 nop
|
|
8004804: 40002800 .word 0x40002800
|
|
8004808: 58000800 .word 0x58000800
|
|
|
|
0800480c <HAL_RTC_DeactivateAlarm>:
|
|
* @arg RTC_ALARM_A: AlarmA
|
|
* @arg RTC_ALARM_B: AlarmB
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_RTC_DeactivateAlarm(RTC_HandleTypeDef *hrtc, uint32_t Alarm)
|
|
{
|
|
800480c: b480 push {r7}
|
|
800480e: b083 sub sp, #12
|
|
8004810: af00 add r7, sp, #0
|
|
8004812: 6078 str r0, [r7, #4]
|
|
8004814: 6039 str r1, [r7, #0]
|
|
/* Check the parameters */
|
|
assert_param(IS_RTC_ALARM(Alarm));
|
|
|
|
/* Process Locked */
|
|
__HAL_LOCK(hrtc);
|
|
8004816: 687b ldr r3, [r7, #4]
|
|
8004818: f893 302c ldrb.w r3, [r3, #44] @ 0x2c
|
|
800481c: 2b01 cmp r3, #1
|
|
800481e: d101 bne.n 8004824 <HAL_RTC_DeactivateAlarm+0x18>
|
|
8004820: 2302 movs r3, #2
|
|
8004822: e048 b.n 80048b6 <HAL_RTC_DeactivateAlarm+0xaa>
|
|
8004824: 687b ldr r3, [r7, #4]
|
|
8004826: 2201 movs r2, #1
|
|
8004828: f883 202c strb.w r2, [r3, #44] @ 0x2c
|
|
|
|
hrtc->State = HAL_RTC_STATE_BUSY;
|
|
800482c: 687b ldr r3, [r7, #4]
|
|
800482e: 2202 movs r2, #2
|
|
8004830: f883 202d strb.w r2, [r3, #45] @ 0x2d
|
|
|
|
/* Disable the write protection for RTC registers */
|
|
__HAL_RTC_WRITEPROTECTION_DISABLE(hrtc);
|
|
8004834: 4b22 ldr r3, [pc, #136] @ (80048c0 <HAL_RTC_DeactivateAlarm+0xb4>)
|
|
8004836: 22ca movs r2, #202 @ 0xca
|
|
8004838: 625a str r2, [r3, #36] @ 0x24
|
|
800483a: 4b21 ldr r3, [pc, #132] @ (80048c0 <HAL_RTC_DeactivateAlarm+0xb4>)
|
|
800483c: 2253 movs r2, #83 @ 0x53
|
|
800483e: 625a str r2, [r3, #36] @ 0x24
|
|
|
|
if (Alarm == RTC_ALARM_A)
|
|
8004840: 683b ldr r3, [r7, #0]
|
|
8004842: f5b3 7f80 cmp.w r3, #256 @ 0x100
|
|
8004846: d115 bne.n 8004874 <HAL_RTC_DeactivateAlarm+0x68>
|
|
{
|
|
/* AlarmA, In case of interrupt mode is used, the interrupt source must disabled */
|
|
CLEAR_BIT(RTC->CR, RTC_CR_ALRAE | RTC_CR_ALRAIE);
|
|
8004848: 4b1d ldr r3, [pc, #116] @ (80048c0 <HAL_RTC_DeactivateAlarm+0xb4>)
|
|
800484a: 699b ldr r3, [r3, #24]
|
|
800484c: 4a1c ldr r2, [pc, #112] @ (80048c0 <HAL_RTC_DeactivateAlarm+0xb4>)
|
|
800484e: f423 5388 bic.w r3, r3, #4352 @ 0x1100
|
|
8004852: 6193 str r3, [r2, #24]
|
|
|
|
/* AlarmA, Clear SSCLR */
|
|
CLEAR_BIT(RTC->ALRMASSR, RTC_ALRMASSR_SSCLR);
|
|
8004854: 4b1a ldr r3, [pc, #104] @ (80048c0 <HAL_RTC_DeactivateAlarm+0xb4>)
|
|
8004856: 6c5b ldr r3, [r3, #68] @ 0x44
|
|
8004858: 4a19 ldr r2, [pc, #100] @ (80048c0 <HAL_RTC_DeactivateAlarm+0xb4>)
|
|
800485a: f023 4300 bic.w r3, r3, #2147483648 @ 0x80000000
|
|
800485e: 6453 str r3, [r2, #68] @ 0x44
|
|
|
|
/* Store in the handle the Alarm A disabled */
|
|
CLEAR_BIT(hrtc->IsEnabled.RtcFeatures, RTC_MISR_ALRAMF);
|
|
8004860: 687b ldr r3, [r7, #4]
|
|
8004862: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
8004864: f023 0201 bic.w r2, r3, #1
|
|
8004868: 687b ldr r3, [r7, #4]
|
|
800486a: 631a str r2, [r3, #48] @ 0x30
|
|
|
|
/* Clear AlarmA flag */
|
|
WRITE_REG(RTC->SCR, RTC_SCR_CALRAF);
|
|
800486c: 4b14 ldr r3, [pc, #80] @ (80048c0 <HAL_RTC_DeactivateAlarm+0xb4>)
|
|
800486e: 2201 movs r2, #1
|
|
8004870: 65da str r2, [r3, #92] @ 0x5c
|
|
8004872: e014 b.n 800489e <HAL_RTC_DeactivateAlarm+0x92>
|
|
}
|
|
else
|
|
{
|
|
/* AlarmB, In case of interrupt mode is used, the interrupt source must disabled */
|
|
CLEAR_BIT(RTC->CR, RTC_CR_ALRBE | RTC_CR_ALRBIE);
|
|
8004874: 4b12 ldr r3, [pc, #72] @ (80048c0 <HAL_RTC_DeactivateAlarm+0xb4>)
|
|
8004876: 699b ldr r3, [r3, #24]
|
|
8004878: 4a11 ldr r2, [pc, #68] @ (80048c0 <HAL_RTC_DeactivateAlarm+0xb4>)
|
|
800487a: f423 5308 bic.w r3, r3, #8704 @ 0x2200
|
|
800487e: 6193 str r3, [r2, #24]
|
|
|
|
/* AlarmB, Clear SSCLR */
|
|
CLEAR_BIT(RTC->ALRMBSSR, RTC_ALRMBSSR_SSCLR);
|
|
8004880: 4b0f ldr r3, [pc, #60] @ (80048c0 <HAL_RTC_DeactivateAlarm+0xb4>)
|
|
8004882: 6cdb ldr r3, [r3, #76] @ 0x4c
|
|
8004884: 4a0e ldr r2, [pc, #56] @ (80048c0 <HAL_RTC_DeactivateAlarm+0xb4>)
|
|
8004886: f023 4300 bic.w r3, r3, #2147483648 @ 0x80000000
|
|
800488a: 64d3 str r3, [r2, #76] @ 0x4c
|
|
|
|
/* Store in the handle the Alarm B disabled */
|
|
CLEAR_BIT(hrtc->IsEnabled.RtcFeatures, RTC_MISR_ALRBMF);
|
|
800488c: 687b ldr r3, [r7, #4]
|
|
800488e: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
8004890: f023 0202 bic.w r2, r3, #2
|
|
8004894: 687b ldr r3, [r7, #4]
|
|
8004896: 631a str r2, [r3, #48] @ 0x30
|
|
|
|
/* Clear AlarmB flag */
|
|
WRITE_REG(RTC->SCR, RTC_SCR_CALRBF);
|
|
8004898: 4b09 ldr r3, [pc, #36] @ (80048c0 <HAL_RTC_DeactivateAlarm+0xb4>)
|
|
800489a: 2202 movs r2, #2
|
|
800489c: 65da str r2, [r3, #92] @ 0x5c
|
|
}
|
|
|
|
/* Enable the write protection for RTC registers */
|
|
__HAL_RTC_WRITEPROTECTION_ENABLE(hrtc);
|
|
800489e: 4b08 ldr r3, [pc, #32] @ (80048c0 <HAL_RTC_DeactivateAlarm+0xb4>)
|
|
80048a0: 22ff movs r2, #255 @ 0xff
|
|
80048a2: 625a str r2, [r3, #36] @ 0x24
|
|
|
|
hrtc->State = HAL_RTC_STATE_READY;
|
|
80048a4: 687b ldr r3, [r7, #4]
|
|
80048a6: 2201 movs r2, #1
|
|
80048a8: f883 202d strb.w r2, [r3, #45] @ 0x2d
|
|
|
|
/* Process Unlocked */
|
|
__HAL_UNLOCK(hrtc);
|
|
80048ac: 687b ldr r3, [r7, #4]
|
|
80048ae: 2200 movs r2, #0
|
|
80048b0: f883 202c strb.w r2, [r3, #44] @ 0x2c
|
|
|
|
return HAL_OK;
|
|
80048b4: 2300 movs r3, #0
|
|
}
|
|
80048b6: 4618 mov r0, r3
|
|
80048b8: 370c adds r7, #12
|
|
80048ba: 46bd mov sp, r7
|
|
80048bc: bc80 pop {r7}
|
|
80048be: 4770 bx lr
|
|
80048c0: 40002800 .word 0x40002800
|
|
|
|
080048c4 <HAL_RTC_AlarmIRQHandler>:
|
|
* @brief Handle Alarm interrupt request.
|
|
* @param hrtc RTC handle
|
|
* @retval None
|
|
*/
|
|
void HAL_RTC_AlarmIRQHandler(RTC_HandleTypeDef *hrtc)
|
|
{
|
|
80048c4: b580 push {r7, lr}
|
|
80048c6: b084 sub sp, #16
|
|
80048c8: af00 add r7, sp, #0
|
|
80048ca: 6078 str r0, [r7, #4]
|
|
uint32_t tmp = READ_REG(RTC->MISR) & READ_REG(hrtc->IsEnabled.RtcFeatures);
|
|
80048cc: 4b11 ldr r3, [pc, #68] @ (8004914 <HAL_RTC_AlarmIRQHandler+0x50>)
|
|
80048ce: 6d5a ldr r2, [r3, #84] @ 0x54
|
|
80048d0: 687b ldr r3, [r7, #4]
|
|
80048d2: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
80048d4: 4013 ands r3, r2
|
|
80048d6: 60fb str r3, [r7, #12]
|
|
|
|
if ((tmp & RTC_MISR_ALRAMF) != 0U)
|
|
80048d8: 68fb ldr r3, [r7, #12]
|
|
80048da: f003 0301 and.w r3, r3, #1
|
|
80048de: 2b00 cmp r3, #0
|
|
80048e0: d005 beq.n 80048ee <HAL_RTC_AlarmIRQHandler+0x2a>
|
|
{
|
|
/* Clear the AlarmA interrupt pending bit */
|
|
WRITE_REG(RTC->SCR, RTC_SCR_CALRAF);
|
|
80048e2: 4b0c ldr r3, [pc, #48] @ (8004914 <HAL_RTC_AlarmIRQHandler+0x50>)
|
|
80048e4: 2201 movs r2, #1
|
|
80048e6: 65da str r2, [r3, #92] @ 0x5c
|
|
|
|
#if (USE_HAL_RTC_REGISTER_CALLBACKS == 1)
|
|
/* Call Compare Match registered Callback */
|
|
hrtc->AlarmAEventCallback(hrtc);
|
|
#else
|
|
HAL_RTC_AlarmAEventCallback(hrtc);
|
|
80048e8: 6878 ldr r0, [r7, #4]
|
|
80048ea: f7fc fbd4 bl 8001096 <HAL_RTC_AlarmAEventCallback>
|
|
#endif /* USE_HAL_RTC_REGISTER_CALLBACKS */
|
|
}
|
|
|
|
if ((tmp & RTC_MISR_ALRBMF) != 0U)
|
|
80048ee: 68fb ldr r3, [r7, #12]
|
|
80048f0: f003 0302 and.w r3, r3, #2
|
|
80048f4: 2b00 cmp r3, #0
|
|
80048f6: d005 beq.n 8004904 <HAL_RTC_AlarmIRQHandler+0x40>
|
|
{
|
|
/* Clear the AlarmB interrupt pending bit */
|
|
WRITE_REG(RTC->SCR, RTC_SCR_CALRBF);
|
|
80048f8: 4b06 ldr r3, [pc, #24] @ (8004914 <HAL_RTC_AlarmIRQHandler+0x50>)
|
|
80048fa: 2202 movs r2, #2
|
|
80048fc: 65da str r2, [r3, #92] @ 0x5c
|
|
|
|
#if (USE_HAL_RTC_REGISTER_CALLBACKS == 1)
|
|
/* Call Compare Match registered Callback */
|
|
hrtc->AlarmBEventCallback(hrtc);
|
|
#else
|
|
HAL_RTCEx_AlarmBEventCallback(hrtc);
|
|
80048fe: 6878 ldr r0, [r7, #4]
|
|
8004900: f000 f94a bl 8004b98 <HAL_RTCEx_AlarmBEventCallback>
|
|
#endif /* USE_HAL_RTC_REGISTER_CALLBACKS */
|
|
}
|
|
|
|
/* Change RTC state */
|
|
hrtc->State = HAL_RTC_STATE_READY;
|
|
8004904: 687b ldr r3, [r7, #4]
|
|
8004906: 2201 movs r2, #1
|
|
8004908: f883 202d strb.w r2, [r3, #45] @ 0x2d
|
|
}
|
|
800490c: bf00 nop
|
|
800490e: 3710 adds r7, #16
|
|
8004910: 46bd mov sp, r7
|
|
8004912: bd80 pop {r7, pc}
|
|
8004914: 40002800 .word 0x40002800
|
|
|
|
08004918 <HAL_RTC_WaitForSynchro>:
|
|
* correctly copied into the RTC_TR and RTC_DR shadow registers.
|
|
* @param hrtc RTC handle
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_RTC_WaitForSynchro(const RTC_HandleTypeDef *hrtc)
|
|
{
|
|
8004918: b580 push {r7, lr}
|
|
800491a: b084 sub sp, #16
|
|
800491c: af00 add r7, sp, #0
|
|
800491e: 6078 str r0, [r7, #4]
|
|
uint32_t tickstart;
|
|
|
|
UNUSED(hrtc);
|
|
/* Clear RSF flag */
|
|
CLEAR_BIT(RTC->ICSR, RTC_ICSR_RSF);
|
|
8004920: 4b0f ldr r3, [pc, #60] @ (8004960 <HAL_RTC_WaitForSynchro+0x48>)
|
|
8004922: 68db ldr r3, [r3, #12]
|
|
8004924: 4a0e ldr r2, [pc, #56] @ (8004960 <HAL_RTC_WaitForSynchro+0x48>)
|
|
8004926: f023 0320 bic.w r3, r3, #32
|
|
800492a: 60d3 str r3, [r2, #12]
|
|
|
|
tickstart = HAL_GetTick();
|
|
800492c: f7fc f98c bl 8000c48 <HAL_GetTick>
|
|
8004930: 60f8 str r0, [r7, #12]
|
|
|
|
/* Wait the registers to be synchronised */
|
|
while (READ_BIT(RTC->ICSR, RTC_ICSR_RSF) == 0U)
|
|
8004932: e009 b.n 8004948 <HAL_RTC_WaitForSynchro+0x30>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > RTC_TIMEOUT_VALUE)
|
|
8004934: f7fc f988 bl 8000c48 <HAL_GetTick>
|
|
8004938: 4602 mov r2, r0
|
|
800493a: 68fb ldr r3, [r7, #12]
|
|
800493c: 1ad3 subs r3, r2, r3
|
|
800493e: f5b3 7f7a cmp.w r3, #1000 @ 0x3e8
|
|
8004942: d901 bls.n 8004948 <HAL_RTC_WaitForSynchro+0x30>
|
|
{
|
|
return HAL_TIMEOUT;
|
|
8004944: 2303 movs r3, #3
|
|
8004946: e006 b.n 8004956 <HAL_RTC_WaitForSynchro+0x3e>
|
|
while (READ_BIT(RTC->ICSR, RTC_ICSR_RSF) == 0U)
|
|
8004948: 4b05 ldr r3, [pc, #20] @ (8004960 <HAL_RTC_WaitForSynchro+0x48>)
|
|
800494a: 68db ldr r3, [r3, #12]
|
|
800494c: f003 0320 and.w r3, r3, #32
|
|
8004950: 2b00 cmp r3, #0
|
|
8004952: d0ef beq.n 8004934 <HAL_RTC_WaitForSynchro+0x1c>
|
|
}
|
|
}
|
|
|
|
return HAL_OK;
|
|
8004954: 2300 movs r3, #0
|
|
}
|
|
8004956: 4618 mov r0, r3
|
|
8004958: 3710 adds r7, #16
|
|
800495a: 46bd mov sp, r7
|
|
800495c: bd80 pop {r7, pc}
|
|
800495e: bf00 nop
|
|
8004960: 40002800 .word 0x40002800
|
|
|
|
08004964 <RTC_EnterInitMode>:
|
|
* __HAL_RTC_WRITEPROTECTION_DISABLE() before calling this function.
|
|
* @param hrtc RTC handle
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef RTC_EnterInitMode(RTC_HandleTypeDef *hrtc)
|
|
{
|
|
8004964: b580 push {r7, lr}
|
|
8004966: b084 sub sp, #16
|
|
8004968: af00 add r7, sp, #0
|
|
800496a: 6078 str r0, [r7, #4]
|
|
uint32_t tickstart;
|
|
HAL_StatusTypeDef status = HAL_OK;
|
|
800496c: 2300 movs r3, #0
|
|
800496e: 73fb strb r3, [r7, #15]
|
|
|
|
UNUSED(hrtc);
|
|
/* Check if the Initialization mode is set */
|
|
if (READ_BIT(RTC->ICSR, RTC_ICSR_INITF) == 0U)
|
|
8004970: 4b15 ldr r3, [pc, #84] @ (80049c8 <RTC_EnterInitMode+0x64>)
|
|
8004972: 68db ldr r3, [r3, #12]
|
|
8004974: f003 0340 and.w r3, r3, #64 @ 0x40
|
|
8004978: 2b00 cmp r3, #0
|
|
800497a: d120 bne.n 80049be <RTC_EnterInitMode+0x5a>
|
|
{
|
|
/* Set the Initialization mode */
|
|
SET_BIT(RTC->ICSR, RTC_ICSR_INIT);
|
|
800497c: 4b12 ldr r3, [pc, #72] @ (80049c8 <RTC_EnterInitMode+0x64>)
|
|
800497e: 68db ldr r3, [r3, #12]
|
|
8004980: 4a11 ldr r2, [pc, #68] @ (80049c8 <RTC_EnterInitMode+0x64>)
|
|
8004982: f043 0380 orr.w r3, r3, #128 @ 0x80
|
|
8004986: 60d3 str r3, [r2, #12]
|
|
|
|
tickstart = HAL_GetTick();
|
|
8004988: f7fc f95e bl 8000c48 <HAL_GetTick>
|
|
800498c: 60b8 str r0, [r7, #8]
|
|
/* Wait till RTC is in INIT state and if Time out is reached exit */
|
|
while ((READ_BIT(RTC->ICSR, RTC_ICSR_INITF) == 0U) && (status != HAL_TIMEOUT))
|
|
800498e: e00d b.n 80049ac <RTC_EnterInitMode+0x48>
|
|
{
|
|
if ((HAL_GetTick() - tickstart) > RTC_TIMEOUT_VALUE)
|
|
8004990: f7fc f95a bl 8000c48 <HAL_GetTick>
|
|
8004994: 4602 mov r2, r0
|
|
8004996: 68bb ldr r3, [r7, #8]
|
|
8004998: 1ad3 subs r3, r2, r3
|
|
800499a: f5b3 7f7a cmp.w r3, #1000 @ 0x3e8
|
|
800499e: d905 bls.n 80049ac <RTC_EnterInitMode+0x48>
|
|
{
|
|
status = HAL_TIMEOUT;
|
|
80049a0: 2303 movs r3, #3
|
|
80049a2: 73fb strb r3, [r7, #15]
|
|
hrtc->State = HAL_RTC_STATE_TIMEOUT;
|
|
80049a4: 687b ldr r3, [r7, #4]
|
|
80049a6: 2203 movs r2, #3
|
|
80049a8: f883 202d strb.w r2, [r3, #45] @ 0x2d
|
|
while ((READ_BIT(RTC->ICSR, RTC_ICSR_INITF) == 0U) && (status != HAL_TIMEOUT))
|
|
80049ac: 4b06 ldr r3, [pc, #24] @ (80049c8 <RTC_EnterInitMode+0x64>)
|
|
80049ae: 68db ldr r3, [r3, #12]
|
|
80049b0: f003 0340 and.w r3, r3, #64 @ 0x40
|
|
80049b4: 2b00 cmp r3, #0
|
|
80049b6: d102 bne.n 80049be <RTC_EnterInitMode+0x5a>
|
|
80049b8: 7bfb ldrb r3, [r7, #15]
|
|
80049ba: 2b03 cmp r3, #3
|
|
80049bc: d1e8 bne.n 8004990 <RTC_EnterInitMode+0x2c>
|
|
}
|
|
}
|
|
}
|
|
|
|
return status;
|
|
80049be: 7bfb ldrb r3, [r7, #15]
|
|
}
|
|
80049c0: 4618 mov r0, r3
|
|
80049c2: 3710 adds r7, #16
|
|
80049c4: 46bd mov sp, r7
|
|
80049c6: bd80 pop {r7, pc}
|
|
80049c8: 40002800 .word 0x40002800
|
|
|
|
080049cc <RTC_ExitInitMode>:
|
|
* @brief Exit the RTC Initialization mode.
|
|
* @param hrtc RTC handle
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef RTC_ExitInitMode(RTC_HandleTypeDef *hrtc)
|
|
{
|
|
80049cc: b580 push {r7, lr}
|
|
80049ce: b084 sub sp, #16
|
|
80049d0: af00 add r7, sp, #0
|
|
80049d2: 6078 str r0, [r7, #4]
|
|
HAL_StatusTypeDef status = HAL_OK;
|
|
80049d4: 2300 movs r3, #0
|
|
80049d6: 73fb strb r3, [r7, #15]
|
|
|
|
/* Exit Initialization mode */
|
|
CLEAR_BIT(RTC->ICSR, RTC_ICSR_INIT);
|
|
80049d8: 4b1a ldr r3, [pc, #104] @ (8004a44 <RTC_ExitInitMode+0x78>)
|
|
80049da: 68db ldr r3, [r3, #12]
|
|
80049dc: 4a19 ldr r2, [pc, #100] @ (8004a44 <RTC_ExitInitMode+0x78>)
|
|
80049de: f023 0380 bic.w r3, r3, #128 @ 0x80
|
|
80049e2: 60d3 str r3, [r2, #12]
|
|
|
|
/* If CR_BYPSHAD bit = 0, wait for synchro */
|
|
if (READ_BIT(RTC->CR, RTC_CR_BYPSHAD) == 0U)
|
|
80049e4: 4b17 ldr r3, [pc, #92] @ (8004a44 <RTC_ExitInitMode+0x78>)
|
|
80049e6: 699b ldr r3, [r3, #24]
|
|
80049e8: f003 0320 and.w r3, r3, #32
|
|
80049ec: 2b00 cmp r3, #0
|
|
80049ee: d10c bne.n 8004a0a <RTC_ExitInitMode+0x3e>
|
|
{
|
|
if (HAL_RTC_WaitForSynchro(hrtc) != HAL_OK)
|
|
80049f0: 6878 ldr r0, [r7, #4]
|
|
80049f2: f7ff ff91 bl 8004918 <HAL_RTC_WaitForSynchro>
|
|
80049f6: 4603 mov r3, r0
|
|
80049f8: 2b00 cmp r3, #0
|
|
80049fa: d01e beq.n 8004a3a <RTC_ExitInitMode+0x6e>
|
|
{
|
|
hrtc->State = HAL_RTC_STATE_TIMEOUT;
|
|
80049fc: 687b ldr r3, [r7, #4]
|
|
80049fe: 2203 movs r2, #3
|
|
8004a00: f883 202d strb.w r2, [r3, #45] @ 0x2d
|
|
status = HAL_TIMEOUT;
|
|
8004a04: 2303 movs r3, #3
|
|
8004a06: 73fb strb r3, [r7, #15]
|
|
8004a08: e017 b.n 8004a3a <RTC_ExitInitMode+0x6e>
|
|
}
|
|
}
|
|
else /* WA 2.9.6 Calendar initialization may fail in case of consecutive INIT mode entry. */
|
|
{
|
|
/* Clear BYPSHAD bit */
|
|
CLEAR_BIT(RTC->CR, RTC_CR_BYPSHAD);
|
|
8004a0a: 4b0e ldr r3, [pc, #56] @ (8004a44 <RTC_ExitInitMode+0x78>)
|
|
8004a0c: 699b ldr r3, [r3, #24]
|
|
8004a0e: 4a0d ldr r2, [pc, #52] @ (8004a44 <RTC_ExitInitMode+0x78>)
|
|
8004a10: f023 0320 bic.w r3, r3, #32
|
|
8004a14: 6193 str r3, [r2, #24]
|
|
if (HAL_RTC_WaitForSynchro(hrtc) != HAL_OK)
|
|
8004a16: 6878 ldr r0, [r7, #4]
|
|
8004a18: f7ff ff7e bl 8004918 <HAL_RTC_WaitForSynchro>
|
|
8004a1c: 4603 mov r3, r0
|
|
8004a1e: 2b00 cmp r3, #0
|
|
8004a20: d005 beq.n 8004a2e <RTC_ExitInitMode+0x62>
|
|
{
|
|
hrtc->State = HAL_RTC_STATE_TIMEOUT;
|
|
8004a22: 687b ldr r3, [r7, #4]
|
|
8004a24: 2203 movs r2, #3
|
|
8004a26: f883 202d strb.w r2, [r3, #45] @ 0x2d
|
|
status = HAL_TIMEOUT;
|
|
8004a2a: 2303 movs r3, #3
|
|
8004a2c: 73fb strb r3, [r7, #15]
|
|
}
|
|
/* Restore BYPSHAD bit */
|
|
SET_BIT(RTC->CR, RTC_CR_BYPSHAD);
|
|
8004a2e: 4b05 ldr r3, [pc, #20] @ (8004a44 <RTC_ExitInitMode+0x78>)
|
|
8004a30: 699b ldr r3, [r3, #24]
|
|
8004a32: 4a04 ldr r2, [pc, #16] @ (8004a44 <RTC_ExitInitMode+0x78>)
|
|
8004a34: f043 0320 orr.w r3, r3, #32
|
|
8004a38: 6193 str r3, [r2, #24]
|
|
}
|
|
|
|
return status;
|
|
8004a3a: 7bfb ldrb r3, [r7, #15]
|
|
}
|
|
8004a3c: 4618 mov r0, r3
|
|
8004a3e: 3710 adds r7, #16
|
|
8004a40: 46bd mov sp, r7
|
|
8004a42: bd80 pop {r7, pc}
|
|
8004a44: 40002800 .word 0x40002800
|
|
|
|
08004a48 <RTC_ByteToBcd2>:
|
|
* @brief Convert a 2 digit decimal to BCD format.
|
|
* @param Value Byte to be converted
|
|
* @retval Converted byte
|
|
*/
|
|
uint8_t RTC_ByteToBcd2(uint8_t Value)
|
|
{
|
|
8004a48: b480 push {r7}
|
|
8004a4a: b085 sub sp, #20
|
|
8004a4c: af00 add r7, sp, #0
|
|
8004a4e: 4603 mov r3, r0
|
|
8004a50: 71fb strb r3, [r7, #7]
|
|
uint32_t bcdhigh = 0U;
|
|
8004a52: 2300 movs r3, #0
|
|
8004a54: 60fb str r3, [r7, #12]
|
|
uint8_t tmp_Value = Value;
|
|
8004a56: 79fb ldrb r3, [r7, #7]
|
|
8004a58: 72fb strb r3, [r7, #11]
|
|
|
|
while (tmp_Value >= 10U)
|
|
8004a5a: e005 b.n 8004a68 <RTC_ByteToBcd2+0x20>
|
|
{
|
|
bcdhigh++;
|
|
8004a5c: 68fb ldr r3, [r7, #12]
|
|
8004a5e: 3301 adds r3, #1
|
|
8004a60: 60fb str r3, [r7, #12]
|
|
tmp_Value -= 10U;
|
|
8004a62: 7afb ldrb r3, [r7, #11]
|
|
8004a64: 3b0a subs r3, #10
|
|
8004a66: 72fb strb r3, [r7, #11]
|
|
while (tmp_Value >= 10U)
|
|
8004a68: 7afb ldrb r3, [r7, #11]
|
|
8004a6a: 2b09 cmp r3, #9
|
|
8004a6c: d8f6 bhi.n 8004a5c <RTC_ByteToBcd2+0x14>
|
|
}
|
|
|
|
return ((uint8_t)(bcdhigh << 4U) | tmp_Value);
|
|
8004a6e: 68fb ldr r3, [r7, #12]
|
|
8004a70: b2db uxtb r3, r3
|
|
8004a72: 011b lsls r3, r3, #4
|
|
8004a74: b2da uxtb r2, r3
|
|
8004a76: 7afb ldrb r3, [r7, #11]
|
|
8004a78: 4313 orrs r3, r2
|
|
8004a7a: b2db uxtb r3, r3
|
|
}
|
|
8004a7c: 4618 mov r0, r3
|
|
8004a7e: 3714 adds r7, #20
|
|
8004a80: 46bd mov sp, r7
|
|
8004a82: bc80 pop {r7}
|
|
8004a84: 4770 bx lr
|
|
...
|
|
|
|
08004a88 <HAL_RTCEx_EnableBypassShadow>:
|
|
* directly from the Calendar counter.
|
|
* @param hrtc RTC handle
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_RTCEx_EnableBypassShadow(RTC_HandleTypeDef *hrtc)
|
|
{
|
|
8004a88: b480 push {r7}
|
|
8004a8a: b083 sub sp, #12
|
|
8004a8c: af00 add r7, sp, #0
|
|
8004a8e: 6078 str r0, [r7, #4]
|
|
/* Process Locked */
|
|
__HAL_LOCK(hrtc);
|
|
8004a90: 687b ldr r3, [r7, #4]
|
|
8004a92: f893 302c ldrb.w r3, [r3, #44] @ 0x2c
|
|
8004a96: 2b01 cmp r3, #1
|
|
8004a98: d101 bne.n 8004a9e <HAL_RTCEx_EnableBypassShadow+0x16>
|
|
8004a9a: 2302 movs r3, #2
|
|
8004a9c: e01f b.n 8004ade <HAL_RTCEx_EnableBypassShadow+0x56>
|
|
8004a9e: 687b ldr r3, [r7, #4]
|
|
8004aa0: 2201 movs r2, #1
|
|
8004aa2: f883 202c strb.w r2, [r3, #44] @ 0x2c
|
|
|
|
hrtc->State = HAL_RTC_STATE_BUSY;
|
|
8004aa6: 687b ldr r3, [r7, #4]
|
|
8004aa8: 2202 movs r2, #2
|
|
8004aaa: f883 202d strb.w r2, [r3, #45] @ 0x2d
|
|
|
|
/* Disable the write protection for RTC registers */
|
|
__HAL_RTC_WRITEPROTECTION_DISABLE(hrtc);
|
|
8004aae: 4b0e ldr r3, [pc, #56] @ (8004ae8 <HAL_RTCEx_EnableBypassShadow+0x60>)
|
|
8004ab0: 22ca movs r2, #202 @ 0xca
|
|
8004ab2: 625a str r2, [r3, #36] @ 0x24
|
|
8004ab4: 4b0c ldr r3, [pc, #48] @ (8004ae8 <HAL_RTCEx_EnableBypassShadow+0x60>)
|
|
8004ab6: 2253 movs r2, #83 @ 0x53
|
|
8004ab8: 625a str r2, [r3, #36] @ 0x24
|
|
|
|
/* Set the BYPSHAD bit */
|
|
SET_BIT(RTC->CR, RTC_CR_BYPSHAD);
|
|
8004aba: 4b0b ldr r3, [pc, #44] @ (8004ae8 <HAL_RTCEx_EnableBypassShadow+0x60>)
|
|
8004abc: 699b ldr r3, [r3, #24]
|
|
8004abe: 4a0a ldr r2, [pc, #40] @ (8004ae8 <HAL_RTCEx_EnableBypassShadow+0x60>)
|
|
8004ac0: f043 0320 orr.w r3, r3, #32
|
|
8004ac4: 6193 str r3, [r2, #24]
|
|
|
|
/* Enable the write protection for RTC registers */
|
|
__HAL_RTC_WRITEPROTECTION_ENABLE(hrtc);
|
|
8004ac6: 4b08 ldr r3, [pc, #32] @ (8004ae8 <HAL_RTCEx_EnableBypassShadow+0x60>)
|
|
8004ac8: 22ff movs r2, #255 @ 0xff
|
|
8004aca: 625a str r2, [r3, #36] @ 0x24
|
|
|
|
/* Change RTC state */
|
|
hrtc->State = HAL_RTC_STATE_READY;
|
|
8004acc: 687b ldr r3, [r7, #4]
|
|
8004ace: 2201 movs r2, #1
|
|
8004ad0: f883 202d strb.w r2, [r3, #45] @ 0x2d
|
|
|
|
/* Process Unlocked */
|
|
__HAL_UNLOCK(hrtc);
|
|
8004ad4: 687b ldr r3, [r7, #4]
|
|
8004ad6: 2200 movs r2, #0
|
|
8004ad8: f883 202c strb.w r2, [r3, #44] @ 0x2c
|
|
|
|
return HAL_OK;
|
|
8004adc: 2300 movs r3, #0
|
|
}
|
|
8004ade: 4618 mov r0, r3
|
|
8004ae0: 370c adds r7, #12
|
|
8004ae2: 46bd mov sp, r7
|
|
8004ae4: bc80 pop {r7}
|
|
8004ae6: 4770 bx lr
|
|
8004ae8: 40002800 .word 0x40002800
|
|
|
|
08004aec <HAL_RTCEx_SetSSRU_IT>:
|
|
* @brief Set SSR Underflow detection with Interrupt.
|
|
* @param hrtc RTC handle
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_RTCEx_SetSSRU_IT(RTC_HandleTypeDef *hrtc)
|
|
{
|
|
8004aec: b480 push {r7}
|
|
8004aee: b083 sub sp, #12
|
|
8004af0: af00 add r7, sp, #0
|
|
8004af2: 6078 str r0, [r7, #4]
|
|
/* Process Locked */
|
|
__HAL_LOCK(hrtc);
|
|
8004af4: 687b ldr r3, [r7, #4]
|
|
8004af6: f893 302c ldrb.w r3, [r3, #44] @ 0x2c
|
|
8004afa: 2b01 cmp r3, #1
|
|
8004afc: d101 bne.n 8004b02 <HAL_RTCEx_SetSSRU_IT+0x16>
|
|
8004afe: 2302 movs r3, #2
|
|
8004b00: e027 b.n 8004b52 <HAL_RTCEx_SetSSRU_IT+0x66>
|
|
8004b02: 687b ldr r3, [r7, #4]
|
|
8004b04: 2201 movs r2, #1
|
|
8004b06: f883 202c strb.w r2, [r3, #44] @ 0x2c
|
|
|
|
hrtc->State = HAL_RTC_STATE_BUSY;
|
|
8004b0a: 687b ldr r3, [r7, #4]
|
|
8004b0c: 2202 movs r2, #2
|
|
8004b0e: f883 202d strb.w r2, [r3, #45] @ 0x2d
|
|
|
|
/* Disable the write protection for RTC registers */
|
|
__HAL_RTC_WRITEPROTECTION_DISABLE(hrtc);
|
|
8004b12: 4b12 ldr r3, [pc, #72] @ (8004b5c <HAL_RTCEx_SetSSRU_IT+0x70>)
|
|
8004b14: 22ca movs r2, #202 @ 0xca
|
|
8004b16: 625a str r2, [r3, #36] @ 0x24
|
|
8004b18: 4b10 ldr r3, [pc, #64] @ (8004b5c <HAL_RTCEx_SetSSRU_IT+0x70>)
|
|
8004b1a: 2253 movs r2, #83 @ 0x53
|
|
8004b1c: 625a str r2, [r3, #36] @ 0x24
|
|
|
|
/* Enable IT SSRU */
|
|
__HAL_RTC_SSRU_ENABLE_IT(hrtc, RTC_IT_SSRU);
|
|
8004b1e: 4b0f ldr r3, [pc, #60] @ (8004b5c <HAL_RTCEx_SetSSRU_IT+0x70>)
|
|
8004b20: 699b ldr r3, [r3, #24]
|
|
8004b22: 4a0e ldr r2, [pc, #56] @ (8004b5c <HAL_RTCEx_SetSSRU_IT+0x70>)
|
|
8004b24: f043 0380 orr.w r3, r3, #128 @ 0x80
|
|
8004b28: 6193 str r3, [r2, #24]
|
|
|
|
/* RTC SSRU Interrupt Configuration: EXTI configuration */
|
|
__HAL_RTC_SSRU_EXTI_ENABLE_IT();
|
|
8004b2a: 4b0d ldr r3, [pc, #52] @ (8004b60 <HAL_RTCEx_SetSSRU_IT+0x74>)
|
|
8004b2c: f8d3 3080 ldr.w r3, [r3, #128] @ 0x80
|
|
8004b30: 4a0b ldr r2, [pc, #44] @ (8004b60 <HAL_RTCEx_SetSSRU_IT+0x74>)
|
|
8004b32: f443 2380 orr.w r3, r3, #262144 @ 0x40000
|
|
8004b36: f8c2 3080 str.w r3, [r2, #128] @ 0x80
|
|
|
|
/* Enable the write protection for RTC registers */
|
|
__HAL_RTC_WRITEPROTECTION_ENABLE(hrtc);
|
|
8004b3a: 4b08 ldr r3, [pc, #32] @ (8004b5c <HAL_RTCEx_SetSSRU_IT+0x70>)
|
|
8004b3c: 22ff movs r2, #255 @ 0xff
|
|
8004b3e: 625a str r2, [r3, #36] @ 0x24
|
|
|
|
hrtc->State = HAL_RTC_STATE_READY;
|
|
8004b40: 687b ldr r3, [r7, #4]
|
|
8004b42: 2201 movs r2, #1
|
|
8004b44: f883 202d strb.w r2, [r3, #45] @ 0x2d
|
|
|
|
/* Process Unlocked */
|
|
__HAL_UNLOCK(hrtc);
|
|
8004b48: 687b ldr r3, [r7, #4]
|
|
8004b4a: 2200 movs r2, #0
|
|
8004b4c: f883 202c strb.w r2, [r3, #44] @ 0x2c
|
|
|
|
return HAL_OK;
|
|
8004b50: 2300 movs r3, #0
|
|
}
|
|
8004b52: 4618 mov r0, r3
|
|
8004b54: 370c adds r7, #12
|
|
8004b56: 46bd mov sp, r7
|
|
8004b58: bc80 pop {r7}
|
|
8004b5a: 4770 bx lr
|
|
8004b5c: 40002800 .word 0x40002800
|
|
8004b60: 58000800 .word 0x58000800
|
|
|
|
08004b64 <HAL_RTCEx_SSRUIRQHandler>:
|
|
* @brief Handle SSR underflow interrupt request.
|
|
* @param hrtc RTC handle
|
|
* @retval None
|
|
*/
|
|
void HAL_RTCEx_SSRUIRQHandler(RTC_HandleTypeDef *hrtc)
|
|
{
|
|
8004b64: b580 push {r7, lr}
|
|
8004b66: b082 sub sp, #8
|
|
8004b68: af00 add r7, sp, #0
|
|
8004b6a: 6078 str r0, [r7, #4]
|
|
if ((RTC->MISR & RTC_MISR_SSRUMF) != 0u)
|
|
8004b6c: 4b09 ldr r3, [pc, #36] @ (8004b94 <HAL_RTCEx_SSRUIRQHandler+0x30>)
|
|
8004b6e: 6d5b ldr r3, [r3, #84] @ 0x54
|
|
8004b70: f003 0340 and.w r3, r3, #64 @ 0x40
|
|
8004b74: 2b00 cmp r3, #0
|
|
8004b76: d005 beq.n 8004b84 <HAL_RTCEx_SSRUIRQHandler+0x20>
|
|
{
|
|
/* Immediately clear flags */
|
|
RTC->SCR = RTC_SCR_CSSRUF;
|
|
8004b78: 4b06 ldr r3, [pc, #24] @ (8004b94 <HAL_RTCEx_SSRUIRQHandler+0x30>)
|
|
8004b7a: 2240 movs r2, #64 @ 0x40
|
|
8004b7c: 65da str r2, [r3, #92] @ 0x5c
|
|
/* SSRU callback */
|
|
#if (USE_HAL_RTC_REGISTER_CALLBACKS == 1)
|
|
/* Call SSRUEvent registered Callback */
|
|
hrtc->SSRUEventCallback(hrtc);
|
|
#else
|
|
HAL_RTCEx_SSRUEventCallback(hrtc);
|
|
8004b7e: 6878 ldr r0, [r7, #4]
|
|
8004b80: f7fc fa93 bl 80010aa <HAL_RTCEx_SSRUEventCallback>
|
|
#endif /* USE_HAL_RTC_REGISTER_CALLBACKS */
|
|
}
|
|
|
|
/* Change RTC state */
|
|
hrtc->State = HAL_RTC_STATE_READY;
|
|
8004b84: 687b ldr r3, [r7, #4]
|
|
8004b86: 2201 movs r2, #1
|
|
8004b88: f883 202d strb.w r2, [r3, #45] @ 0x2d
|
|
}
|
|
8004b8c: bf00 nop
|
|
8004b8e: 3708 adds r7, #8
|
|
8004b90: 46bd mov sp, r7
|
|
8004b92: bd80 pop {r7, pc}
|
|
8004b94: 40002800 .word 0x40002800
|
|
|
|
08004b98 <HAL_RTCEx_AlarmBEventCallback>:
|
|
* @brief Alarm B callback.
|
|
* @param hrtc RTC handle
|
|
* @retval None
|
|
*/
|
|
__weak void HAL_RTCEx_AlarmBEventCallback(RTC_HandleTypeDef *hrtc)
|
|
{
|
|
8004b98: b480 push {r7}
|
|
8004b9a: b083 sub sp, #12
|
|
8004b9c: af00 add r7, sp, #0
|
|
8004b9e: 6078 str r0, [r7, #4]
|
|
UNUSED(hrtc);
|
|
|
|
/* NOTE : This function should not be modified, when the callback is needed,
|
|
the HAL_RTCEx_AlarmBEventCallback could be implemented in the user file
|
|
*/
|
|
}
|
|
8004ba0: bf00 nop
|
|
8004ba2: 370c adds r7, #12
|
|
8004ba4: 46bd mov sp, r7
|
|
8004ba6: bc80 pop {r7}
|
|
8004ba8: 4770 bx lr
|
|
...
|
|
|
|
08004bac <HAL_RTCEx_BKUPWrite>:
|
|
* This parameter can be RTC_BKP_DRx where x can be from 0 to RTC_BACKUP_NB
|
|
* @param Data Data to be written in the specified Backup data register.
|
|
* @retval None
|
|
*/
|
|
void HAL_RTCEx_BKUPWrite(RTC_HandleTypeDef *hrtc, uint32_t BackupRegister, uint32_t Data)
|
|
{
|
|
8004bac: b480 push {r7}
|
|
8004bae: b087 sub sp, #28
|
|
8004bb0: af00 add r7, sp, #0
|
|
8004bb2: 60f8 str r0, [r7, #12]
|
|
8004bb4: 60b9 str r1, [r7, #8]
|
|
8004bb6: 607a str r2, [r7, #4]
|
|
|
|
UNUSED(hrtc);
|
|
/* Check the parameters */
|
|
assert_param(IS_RTC_BKP(BackupRegister));
|
|
|
|
tmp = (uint32_t) &(TAMP->BKP0R);
|
|
8004bb8: 4b07 ldr r3, [pc, #28] @ (8004bd8 <HAL_RTCEx_BKUPWrite+0x2c>)
|
|
8004bba: 617b str r3, [r7, #20]
|
|
tmp += (BackupRegister * 4U);
|
|
8004bbc: 68bb ldr r3, [r7, #8]
|
|
8004bbe: 009b lsls r3, r3, #2
|
|
8004bc0: 697a ldr r2, [r7, #20]
|
|
8004bc2: 4413 add r3, r2
|
|
8004bc4: 617b str r3, [r7, #20]
|
|
|
|
/* Write the specified register */
|
|
*(__IO uint32_t *)tmp = (uint32_t)Data;
|
|
8004bc6: 697b ldr r3, [r7, #20]
|
|
8004bc8: 687a ldr r2, [r7, #4]
|
|
8004bca: 601a str r2, [r3, #0]
|
|
}
|
|
8004bcc: bf00 nop
|
|
8004bce: 371c adds r7, #28
|
|
8004bd0: 46bd mov sp, r7
|
|
8004bd2: bc80 pop {r7}
|
|
8004bd4: 4770 bx lr
|
|
8004bd6: bf00 nop
|
|
8004bd8: 4000b100 .word 0x4000b100
|
|
|
|
08004bdc <HAL_RTCEx_BKUPRead>:
|
|
* @param BackupRegister RTC Backup data Register number.
|
|
* This parameter can be RTC_BKP_DRx where x can be from 0 to RTC_BACKUP_NB
|
|
* @retval Read value
|
|
*/
|
|
uint32_t HAL_RTCEx_BKUPRead(RTC_HandleTypeDef *hrtc, uint32_t BackupRegister)
|
|
{
|
|
8004bdc: b480 push {r7}
|
|
8004bde: b085 sub sp, #20
|
|
8004be0: af00 add r7, sp, #0
|
|
8004be2: 6078 str r0, [r7, #4]
|
|
8004be4: 6039 str r1, [r7, #0]
|
|
|
|
UNUSED(hrtc);
|
|
/* Check the parameters */
|
|
assert_param(IS_RTC_BKP(BackupRegister));
|
|
|
|
tmp = (uint32_t) &(TAMP->BKP0R);
|
|
8004be6: 4b07 ldr r3, [pc, #28] @ (8004c04 <HAL_RTCEx_BKUPRead+0x28>)
|
|
8004be8: 60fb str r3, [r7, #12]
|
|
tmp += (BackupRegister * 4U);
|
|
8004bea: 683b ldr r3, [r7, #0]
|
|
8004bec: 009b lsls r3, r3, #2
|
|
8004bee: 68fa ldr r2, [r7, #12]
|
|
8004bf0: 4413 add r3, r2
|
|
8004bf2: 60fb str r3, [r7, #12]
|
|
|
|
/* Read the specified register */
|
|
return (*(__IO uint32_t *)tmp);
|
|
8004bf4: 68fb ldr r3, [r7, #12]
|
|
8004bf6: 681b ldr r3, [r3, #0]
|
|
}
|
|
8004bf8: 4618 mov r0, r3
|
|
8004bfa: 3714 adds r7, #20
|
|
8004bfc: 46bd mov sp, r7
|
|
8004bfe: bc80 pop {r7}
|
|
8004c00: 4770 bx lr
|
|
8004c02: bf00 nop
|
|
8004c04: 4000b100 .word 0x4000b100
|
|
|
|
08004c08 <LL_PWR_SetRadioBusyTrigger>:
|
|
{
|
|
8004c08: b480 push {r7}
|
|
8004c0a: b083 sub sp, #12
|
|
8004c0c: af00 add r7, sp, #0
|
|
8004c0e: 6078 str r0, [r7, #4]
|
|
MODIFY_REG(PWR->CR3, PWR_CR3_EWRFBUSY, RadioBusyTrigger);
|
|
8004c10: 4b06 ldr r3, [pc, #24] @ (8004c2c <LL_PWR_SetRadioBusyTrigger+0x24>)
|
|
8004c12: 689b ldr r3, [r3, #8]
|
|
8004c14: f423 6200 bic.w r2, r3, #2048 @ 0x800
|
|
8004c18: 4904 ldr r1, [pc, #16] @ (8004c2c <LL_PWR_SetRadioBusyTrigger+0x24>)
|
|
8004c1a: 687b ldr r3, [r7, #4]
|
|
8004c1c: 4313 orrs r3, r2
|
|
8004c1e: 608b str r3, [r1, #8]
|
|
}
|
|
8004c20: bf00 nop
|
|
8004c22: 370c adds r7, #12
|
|
8004c24: 46bd mov sp, r7
|
|
8004c26: bc80 pop {r7}
|
|
8004c28: 4770 bx lr
|
|
8004c2a: bf00 nop
|
|
8004c2c: 58000400 .word 0x58000400
|
|
|
|
08004c30 <LL_PWR_UnselectSUBGHZSPI_NSS>:
|
|
{
|
|
8004c30: b480 push {r7}
|
|
8004c32: af00 add r7, sp, #0
|
|
SET_BIT(PWR->SUBGHZSPICR, PWR_SUBGHZSPICR_NSS);
|
|
8004c34: 4b05 ldr r3, [pc, #20] @ (8004c4c <LL_PWR_UnselectSUBGHZSPI_NSS+0x1c>)
|
|
8004c36: f8d3 3090 ldr.w r3, [r3, #144] @ 0x90
|
|
8004c3a: 4a04 ldr r2, [pc, #16] @ (8004c4c <LL_PWR_UnselectSUBGHZSPI_NSS+0x1c>)
|
|
8004c3c: f443 4300 orr.w r3, r3, #32768 @ 0x8000
|
|
8004c40: f8c2 3090 str.w r3, [r2, #144] @ 0x90
|
|
}
|
|
8004c44: bf00 nop
|
|
8004c46: 46bd mov sp, r7
|
|
8004c48: bc80 pop {r7}
|
|
8004c4a: 4770 bx lr
|
|
8004c4c: 58000400 .word 0x58000400
|
|
|
|
08004c50 <LL_PWR_SelectSUBGHZSPI_NSS>:
|
|
{
|
|
8004c50: b480 push {r7}
|
|
8004c52: af00 add r7, sp, #0
|
|
CLEAR_BIT(PWR->SUBGHZSPICR, PWR_SUBGHZSPICR_NSS);
|
|
8004c54: 4b05 ldr r3, [pc, #20] @ (8004c6c <LL_PWR_SelectSUBGHZSPI_NSS+0x1c>)
|
|
8004c56: f8d3 3090 ldr.w r3, [r3, #144] @ 0x90
|
|
8004c5a: 4a04 ldr r2, [pc, #16] @ (8004c6c <LL_PWR_SelectSUBGHZSPI_NSS+0x1c>)
|
|
8004c5c: f423 4300 bic.w r3, r3, #32768 @ 0x8000
|
|
8004c60: f8c2 3090 str.w r3, [r2, #144] @ 0x90
|
|
}
|
|
8004c64: bf00 nop
|
|
8004c66: 46bd mov sp, r7
|
|
8004c68: bc80 pop {r7}
|
|
8004c6a: 4770 bx lr
|
|
8004c6c: 58000400 .word 0x58000400
|
|
|
|
08004c70 <LL_PWR_ClearFlag_RFBUSY>:
|
|
{
|
|
8004c70: b480 push {r7}
|
|
8004c72: af00 add r7, sp, #0
|
|
WRITE_REG(PWR->SCR, PWR_SCR_CWRFBUSYF);
|
|
8004c74: 4b03 ldr r3, [pc, #12] @ (8004c84 <LL_PWR_ClearFlag_RFBUSY+0x14>)
|
|
8004c76: f44f 6200 mov.w r2, #2048 @ 0x800
|
|
8004c7a: 619a str r2, [r3, #24]
|
|
}
|
|
8004c7c: bf00 nop
|
|
8004c7e: 46bd mov sp, r7
|
|
8004c80: bc80 pop {r7}
|
|
8004c82: 4770 bx lr
|
|
8004c84: 58000400 .word 0x58000400
|
|
|
|
08004c88 <LL_PWR_IsActiveFlag_RFBUSYS>:
|
|
{
|
|
8004c88: b480 push {r7}
|
|
8004c8a: af00 add r7, sp, #0
|
|
return ((READ_BIT(PWR->SR2, PWR_SR2_RFBUSYS) == (PWR_SR2_RFBUSYS)) ? 1UL : 0UL);
|
|
8004c8c: 4b06 ldr r3, [pc, #24] @ (8004ca8 <LL_PWR_IsActiveFlag_RFBUSYS+0x20>)
|
|
8004c8e: 695b ldr r3, [r3, #20]
|
|
8004c90: f003 0302 and.w r3, r3, #2
|
|
8004c94: 2b02 cmp r3, #2
|
|
8004c96: d101 bne.n 8004c9c <LL_PWR_IsActiveFlag_RFBUSYS+0x14>
|
|
8004c98: 2301 movs r3, #1
|
|
8004c9a: e000 b.n 8004c9e <LL_PWR_IsActiveFlag_RFBUSYS+0x16>
|
|
8004c9c: 2300 movs r3, #0
|
|
}
|
|
8004c9e: 4618 mov r0, r3
|
|
8004ca0: 46bd mov sp, r7
|
|
8004ca2: bc80 pop {r7}
|
|
8004ca4: 4770 bx lr
|
|
8004ca6: bf00 nop
|
|
8004ca8: 58000400 .word 0x58000400
|
|
|
|
08004cac <LL_PWR_IsActiveFlag_RFBUSYMS>:
|
|
{
|
|
8004cac: b480 push {r7}
|
|
8004cae: af00 add r7, sp, #0
|
|
return ((READ_BIT(PWR->SR2, PWR_SR2_RFBUSYMS) == (PWR_SR2_RFBUSYMS)) ? 1UL : 0UL);
|
|
8004cb0: 4b06 ldr r3, [pc, #24] @ (8004ccc <LL_PWR_IsActiveFlag_RFBUSYMS+0x20>)
|
|
8004cb2: 695b ldr r3, [r3, #20]
|
|
8004cb4: f003 0304 and.w r3, r3, #4
|
|
8004cb8: 2b04 cmp r3, #4
|
|
8004cba: d101 bne.n 8004cc0 <LL_PWR_IsActiveFlag_RFBUSYMS+0x14>
|
|
8004cbc: 2301 movs r3, #1
|
|
8004cbe: e000 b.n 8004cc2 <LL_PWR_IsActiveFlag_RFBUSYMS+0x16>
|
|
8004cc0: 2300 movs r3, #0
|
|
}
|
|
8004cc2: 4618 mov r0, r3
|
|
8004cc4: 46bd mov sp, r7
|
|
8004cc6: bc80 pop {r7}
|
|
8004cc8: 4770 bx lr
|
|
8004cca: bf00 nop
|
|
8004ccc: 58000400 .word 0x58000400
|
|
|
|
08004cd0 <LL_RCC_RF_DisableReset>:
|
|
{
|
|
8004cd0: b480 push {r7}
|
|
8004cd2: af00 add r7, sp, #0
|
|
CLEAR_BIT(RCC->CSR, RCC_CSR_RFRST);
|
|
8004cd4: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8004cd8: f8d3 3094 ldr.w r3, [r3, #148] @ 0x94
|
|
8004cdc: f04f 42b0 mov.w r2, #1476395008 @ 0x58000000
|
|
8004ce0: f423 4300 bic.w r3, r3, #32768 @ 0x8000
|
|
8004ce4: f8c2 3094 str.w r3, [r2, #148] @ 0x94
|
|
}
|
|
8004ce8: bf00 nop
|
|
8004cea: 46bd mov sp, r7
|
|
8004cec: bc80 pop {r7}
|
|
8004cee: 4770 bx lr
|
|
|
|
08004cf0 <LL_RCC_IsRFUnderReset>:
|
|
{
|
|
8004cf0: b480 push {r7}
|
|
8004cf2: af00 add r7, sp, #0
|
|
return ((READ_BIT(RCC->CSR, RCC_CSR_RFRSTF) == (RCC_CSR_RFRSTF)) ? 1UL : 0UL);
|
|
8004cf4: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
8004cf8: f8d3 3094 ldr.w r3, [r3, #148] @ 0x94
|
|
8004cfc: f403 4380 and.w r3, r3, #16384 @ 0x4000
|
|
8004d00: f5b3 4f80 cmp.w r3, #16384 @ 0x4000
|
|
8004d04: d101 bne.n 8004d0a <LL_RCC_IsRFUnderReset+0x1a>
|
|
8004d06: 2301 movs r3, #1
|
|
8004d08: e000 b.n 8004d0c <LL_RCC_IsRFUnderReset+0x1c>
|
|
8004d0a: 2300 movs r3, #0
|
|
}
|
|
8004d0c: 4618 mov r0, r3
|
|
8004d0e: 46bd mov sp, r7
|
|
8004d10: bc80 pop {r7}
|
|
8004d12: 4770 bx lr
|
|
|
|
08004d14 <LL_EXTI_EnableIT_32_63>:
|
|
{
|
|
8004d14: b480 push {r7}
|
|
8004d16: b083 sub sp, #12
|
|
8004d18: af00 add r7, sp, #0
|
|
8004d1a: 6078 str r0, [r7, #4]
|
|
SET_BIT(EXTI->IMR2, ExtiLine);
|
|
8004d1c: 4b06 ldr r3, [pc, #24] @ (8004d38 <LL_EXTI_EnableIT_32_63+0x24>)
|
|
8004d1e: f8d3 2090 ldr.w r2, [r3, #144] @ 0x90
|
|
8004d22: 4905 ldr r1, [pc, #20] @ (8004d38 <LL_EXTI_EnableIT_32_63+0x24>)
|
|
8004d24: 687b ldr r3, [r7, #4]
|
|
8004d26: 4313 orrs r3, r2
|
|
8004d28: f8c1 3090 str.w r3, [r1, #144] @ 0x90
|
|
}
|
|
8004d2c: bf00 nop
|
|
8004d2e: 370c adds r7, #12
|
|
8004d30: 46bd mov sp, r7
|
|
8004d32: bc80 pop {r7}
|
|
8004d34: 4770 bx lr
|
|
8004d36: bf00 nop
|
|
8004d38: 58000800 .word 0x58000800
|
|
|
|
08004d3c <HAL_SUBGHZ_Init>:
|
|
* set the state to HAL_SUBGHZ_STATE_RESET_RF_READY with __HAL_SUBGHZ_RESET_HANDLE_STATE_RF_READY
|
|
* to avoid the reset of Radio peripheral.
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_SUBGHZ_Init(SUBGHZ_HandleTypeDef *hsubghz)
|
|
{
|
|
8004d3c: b580 push {r7, lr}
|
|
8004d3e: b084 sub sp, #16
|
|
8004d40: af00 add r7, sp, #0
|
|
8004d42: 6078 str r0, [r7, #4]
|
|
HAL_StatusTypeDef status;
|
|
__IO uint32_t count;
|
|
HAL_SUBGHZ_StateTypeDef subghz_state;
|
|
|
|
/* Check the hsubghz handle allocation */
|
|
if (hsubghz == NULL)
|
|
8004d44: 687b ldr r3, [r7, #4]
|
|
8004d46: 2b00 cmp r3, #0
|
|
8004d48: d103 bne.n 8004d52 <HAL_SUBGHZ_Init+0x16>
|
|
{
|
|
status = HAL_ERROR;
|
|
8004d4a: 2301 movs r3, #1
|
|
8004d4c: 73fb strb r3, [r7, #15]
|
|
return status;
|
|
8004d4e: 7bfb ldrb r3, [r7, #15]
|
|
8004d50: e052 b.n 8004df8 <HAL_SUBGHZ_Init+0xbc>
|
|
}
|
|
else
|
|
{
|
|
status = HAL_OK;
|
|
8004d52: 2300 movs r3, #0
|
|
8004d54: 73fb strb r3, [r7, #15]
|
|
}
|
|
|
|
assert_param(IS_SUBGHZSPI_BAUDRATE_PRESCALER(hsubghz->Init.BaudratePrescaler));
|
|
|
|
subghz_state = hsubghz->State;
|
|
8004d56: 687b ldr r3, [r7, #4]
|
|
8004d58: 799b ldrb r3, [r3, #6]
|
|
8004d5a: 73bb strb r3, [r7, #14]
|
|
if ((subghz_state == HAL_SUBGHZ_STATE_RESET) ||
|
|
8004d5c: 7bbb ldrb r3, [r7, #14]
|
|
8004d5e: 2b00 cmp r3, #0
|
|
8004d60: d002 beq.n 8004d68 <HAL_SUBGHZ_Init+0x2c>
|
|
8004d62: 7bbb ldrb r3, [r7, #14]
|
|
8004d64: 2b03 cmp r3, #3
|
|
8004d66: d109 bne.n 8004d7c <HAL_SUBGHZ_Init+0x40>
|
|
(subghz_state == HAL_SUBGHZ_STATE_RESET_RF_READY))
|
|
{
|
|
/* Allocate lock resource and initialize it */
|
|
hsubghz->Lock = HAL_UNLOCKED;
|
|
8004d68: 687b ldr r3, [r7, #4]
|
|
8004d6a: 2200 movs r2, #0
|
|
8004d6c: 715a strb r2, [r3, #5]
|
|
|
|
/* Init the low level hardware : GPIO, CLOCK, NVIC... */
|
|
hsubghz->MspInitCallback(hsubghz);
|
|
#else
|
|
/* Init the low level hardware : GPIO, CLOCK, NVIC... */
|
|
HAL_SUBGHZ_MspInit(hsubghz);
|
|
8004d6e: 6878 ldr r0, [r7, #4]
|
|
8004d70: f7fb feca bl 8000b08 <HAL_SUBGHZ_MspInit>
|
|
#if defined(CORE_CM0PLUS)
|
|
/* Enable EXTI 44 : Radio IRQ ITs for CPU2 */
|
|
LL_C2_EXTI_EnableIT_32_63(LL_EXTI_LINE_44);
|
|
#else
|
|
/* Enable EXTI 44 : Radio IRQ ITs for CPU1 */
|
|
LL_EXTI_EnableIT_32_63(LL_EXTI_LINE_44);
|
|
8004d74: f44f 5080 mov.w r0, #4096 @ 0x1000
|
|
8004d78: f7ff ffcc bl 8004d14 <LL_EXTI_EnableIT_32_63>
|
|
#endif /* CORE_CM0PLUS */
|
|
}
|
|
|
|
if (subghz_state == HAL_SUBGHZ_STATE_RESET)
|
|
8004d7c: 7bbb ldrb r3, [r7, #14]
|
|
8004d7e: 2b00 cmp r3, #0
|
|
8004d80: d126 bne.n 8004dd0 <HAL_SUBGHZ_Init+0x94>
|
|
{
|
|
/* Reinitialize Radio peripheral only if SUBGHZ is in full RESET state */
|
|
hsubghz->State = HAL_SUBGHZ_STATE_BUSY;
|
|
8004d82: 687b ldr r3, [r7, #4]
|
|
8004d84: 2202 movs r2, #2
|
|
8004d86: 719a strb r2, [r3, #6]
|
|
|
|
/* De-asserts the reset signal of the Radio peripheral */
|
|
LL_RCC_RF_DisableReset();
|
|
8004d88: f7ff ffa2 bl 8004cd0 <LL_RCC_RF_DisableReset>
|
|
|
|
/* Verify that Radio in reset status flag is set */
|
|
count = SUBGHZ_DEFAULT_TIMEOUT * SUBGHZ_DEFAULT_LOOP_TIME;
|
|
8004d8c: 4b1c ldr r3, [pc, #112] @ (8004e00 <HAL_SUBGHZ_Init+0xc4>)
|
|
8004d8e: 681a ldr r2, [r3, #0]
|
|
8004d90: 4613 mov r3, r2
|
|
8004d92: 00db lsls r3, r3, #3
|
|
8004d94: 1a9b subs r3, r3, r2
|
|
8004d96: 009b lsls r3, r3, #2
|
|
8004d98: 0cdb lsrs r3, r3, #19
|
|
8004d9a: 2264 movs r2, #100 @ 0x64
|
|
8004d9c: fb02 f303 mul.w r3, r2, r3
|
|
8004da0: 60bb str r3, [r7, #8]
|
|
|
|
do
|
|
{
|
|
if (count == 0U)
|
|
8004da2: 68bb ldr r3, [r7, #8]
|
|
8004da4: 2b00 cmp r3, #0
|
|
8004da6: d105 bne.n 8004db4 <HAL_SUBGHZ_Init+0x78>
|
|
{
|
|
status = HAL_ERROR;
|
|
8004da8: 2301 movs r3, #1
|
|
8004daa: 73fb strb r3, [r7, #15]
|
|
hsubghz->ErrorCode = HAL_SUBGHZ_ERROR_TIMEOUT;
|
|
8004dac: 687b ldr r3, [r7, #4]
|
|
8004dae: 2201 movs r2, #1
|
|
8004db0: 609a str r2, [r3, #8]
|
|
break;
|
|
8004db2: e007 b.n 8004dc4 <HAL_SUBGHZ_Init+0x88>
|
|
}
|
|
count--;
|
|
8004db4: 68bb ldr r3, [r7, #8]
|
|
8004db6: 3b01 subs r3, #1
|
|
8004db8: 60bb str r3, [r7, #8]
|
|
} while (LL_RCC_IsRFUnderReset() != 0UL);
|
|
8004dba: f7ff ff99 bl 8004cf0 <LL_RCC_IsRFUnderReset>
|
|
8004dbe: 4603 mov r3, r0
|
|
8004dc0: 2b00 cmp r3, #0
|
|
8004dc2: d1ee bne.n 8004da2 <HAL_SUBGHZ_Init+0x66>
|
|
|
|
/* Asserts the reset signal of the Radio peripheral */
|
|
LL_PWR_UnselectSUBGHZSPI_NSS();
|
|
8004dc4: f7ff ff34 bl 8004c30 <LL_PWR_UnselectSUBGHZSPI_NSS>
|
|
#if defined(CORE_CM0PLUS)
|
|
/* Enable wakeup signal of the Radio peripheral */
|
|
LL_C2_PWR_SetRadioBusyTrigger(LL_PWR_RADIO_BUSY_TRIGGER_WU_IT);
|
|
#else
|
|
/* Enable wakeup signal of the Radio peripheral */
|
|
LL_PWR_SetRadioBusyTrigger(LL_PWR_RADIO_BUSY_TRIGGER_WU_IT);
|
|
8004dc8: f44f 6000 mov.w r0, #2048 @ 0x800
|
|
8004dcc: f7ff ff1c bl 8004c08 <LL_PWR_SetRadioBusyTrigger>
|
|
#endif /* CORE_CM0PLUS */
|
|
}
|
|
|
|
/* Clear Pending Flag */
|
|
LL_PWR_ClearFlag_RFBUSY();
|
|
8004dd0: f7ff ff4e bl 8004c70 <LL_PWR_ClearFlag_RFBUSY>
|
|
|
|
if (status == HAL_OK)
|
|
8004dd4: 7bfb ldrb r3, [r7, #15]
|
|
8004dd6: 2b00 cmp r3, #0
|
|
8004dd8: d10a bne.n 8004df0 <HAL_SUBGHZ_Init+0xb4>
|
|
{
|
|
/* Initialize SUBGHZSPI Peripheral */
|
|
SUBGHZSPI_Init(hsubghz->Init.BaudratePrescaler);
|
|
8004dda: 687b ldr r3, [r7, #4]
|
|
8004ddc: 681b ldr r3, [r3, #0]
|
|
8004dde: 4618 mov r0, r3
|
|
8004de0: f000 fac2 bl 8005368 <SUBGHZSPI_Init>
|
|
|
|
hsubghz->DeepSleep = SUBGHZ_DEEP_SLEEP_ENABLE;
|
|
8004de4: 687b ldr r3, [r7, #4]
|
|
8004de6: 2201 movs r2, #1
|
|
8004de8: 711a strb r2, [r3, #4]
|
|
hsubghz->ErrorCode = HAL_SUBGHZ_ERROR_NONE;
|
|
8004dea: 687b ldr r3, [r7, #4]
|
|
8004dec: 2200 movs r2, #0
|
|
8004dee: 609a str r2, [r3, #8]
|
|
}
|
|
|
|
hsubghz->State = HAL_SUBGHZ_STATE_READY;
|
|
8004df0: 687b ldr r3, [r7, #4]
|
|
8004df2: 2201 movs r2, #1
|
|
8004df4: 719a strb r2, [r3, #6]
|
|
|
|
return status;
|
|
8004df6: 7bfb ldrb r3, [r7, #15]
|
|
}
|
|
8004df8: 4618 mov r0, r3
|
|
8004dfa: 3710 adds r7, #16
|
|
8004dfc: 46bd mov sp, r7
|
|
8004dfe: bd80 pop {r7, pc}
|
|
8004e00: 20000000 .word 0x20000000
|
|
|
|
08004e04 <HAL_SUBGHZ_WriteRegisters>:
|
|
*/
|
|
HAL_StatusTypeDef HAL_SUBGHZ_WriteRegisters(SUBGHZ_HandleTypeDef *hsubghz,
|
|
uint16_t Address,
|
|
uint8_t *pBuffer,
|
|
uint16_t Size)
|
|
{
|
|
8004e04: b580 push {r7, lr}
|
|
8004e06: b086 sub sp, #24
|
|
8004e08: af00 add r7, sp, #0
|
|
8004e0a: 60f8 str r0, [r7, #12]
|
|
8004e0c: 607a str r2, [r7, #4]
|
|
8004e0e: 461a mov r2, r3
|
|
8004e10: 460b mov r3, r1
|
|
8004e12: 817b strh r3, [r7, #10]
|
|
8004e14: 4613 mov r3, r2
|
|
8004e16: 813b strh r3, [r7, #8]
|
|
HAL_StatusTypeDef status;
|
|
|
|
if (hsubghz->State == HAL_SUBGHZ_STATE_READY)
|
|
8004e18: 68fb ldr r3, [r7, #12]
|
|
8004e1a: 799b ldrb r3, [r3, #6]
|
|
8004e1c: b2db uxtb r3, r3
|
|
8004e1e: 2b01 cmp r3, #1
|
|
8004e20: d14a bne.n 8004eb8 <HAL_SUBGHZ_WriteRegisters+0xb4>
|
|
{
|
|
/* Process Locked */
|
|
__HAL_LOCK(hsubghz);
|
|
8004e22: 68fb ldr r3, [r7, #12]
|
|
8004e24: 795b ldrb r3, [r3, #5]
|
|
8004e26: 2b01 cmp r3, #1
|
|
8004e28: d101 bne.n 8004e2e <HAL_SUBGHZ_WriteRegisters+0x2a>
|
|
8004e2a: 2302 movs r3, #2
|
|
8004e2c: e045 b.n 8004eba <HAL_SUBGHZ_WriteRegisters+0xb6>
|
|
8004e2e: 68fb ldr r3, [r7, #12]
|
|
8004e30: 2201 movs r2, #1
|
|
8004e32: 715a strb r2, [r3, #5]
|
|
|
|
hsubghz->State = HAL_SUBGHZ_STATE_BUSY;
|
|
8004e34: 68fb ldr r3, [r7, #12]
|
|
8004e36: 2202 movs r2, #2
|
|
8004e38: 719a strb r2, [r3, #6]
|
|
|
|
(void)SUBGHZ_CheckDeviceReady(hsubghz);
|
|
8004e3a: 68f8 ldr r0, [r7, #12]
|
|
8004e3c: f000 fb62 bl 8005504 <SUBGHZ_CheckDeviceReady>
|
|
|
|
/* NSS = 0 */
|
|
LL_PWR_SelectSUBGHZSPI_NSS();
|
|
8004e40: f7ff ff06 bl 8004c50 <LL_PWR_SelectSUBGHZSPI_NSS>
|
|
|
|
(void)SUBGHZSPI_Transmit(hsubghz, SUBGHZ_RADIO_WRITE_REGISTER);
|
|
8004e44: 210d movs r1, #13
|
|
8004e46: 68f8 ldr r0, [r7, #12]
|
|
8004e48: f000 faae bl 80053a8 <SUBGHZSPI_Transmit>
|
|
(void)SUBGHZSPI_Transmit(hsubghz, (uint8_t)((Address & 0xFF00U) >> 8U));
|
|
8004e4c: 897b ldrh r3, [r7, #10]
|
|
8004e4e: 0a1b lsrs r3, r3, #8
|
|
8004e50: b29b uxth r3, r3
|
|
8004e52: b2db uxtb r3, r3
|
|
8004e54: 4619 mov r1, r3
|
|
8004e56: 68f8 ldr r0, [r7, #12]
|
|
8004e58: f000 faa6 bl 80053a8 <SUBGHZSPI_Transmit>
|
|
(void)SUBGHZSPI_Transmit(hsubghz, (uint8_t)(Address & 0x00FFU));
|
|
8004e5c: 897b ldrh r3, [r7, #10]
|
|
8004e5e: b2db uxtb r3, r3
|
|
8004e60: 4619 mov r1, r3
|
|
8004e62: 68f8 ldr r0, [r7, #12]
|
|
8004e64: f000 faa0 bl 80053a8 <SUBGHZSPI_Transmit>
|
|
|
|
for (uint16_t i = 0U; i < Size; i++)
|
|
8004e68: 2300 movs r3, #0
|
|
8004e6a: 82bb strh r3, [r7, #20]
|
|
8004e6c: e00a b.n 8004e84 <HAL_SUBGHZ_WriteRegisters+0x80>
|
|
{
|
|
(void)SUBGHZSPI_Transmit(hsubghz, pBuffer[i]);
|
|
8004e6e: 8abb ldrh r3, [r7, #20]
|
|
8004e70: 687a ldr r2, [r7, #4]
|
|
8004e72: 4413 add r3, r2
|
|
8004e74: 781b ldrb r3, [r3, #0]
|
|
8004e76: 4619 mov r1, r3
|
|
8004e78: 68f8 ldr r0, [r7, #12]
|
|
8004e7a: f000 fa95 bl 80053a8 <SUBGHZSPI_Transmit>
|
|
for (uint16_t i = 0U; i < Size; i++)
|
|
8004e7e: 8abb ldrh r3, [r7, #20]
|
|
8004e80: 3301 adds r3, #1
|
|
8004e82: 82bb strh r3, [r7, #20]
|
|
8004e84: 8aba ldrh r2, [r7, #20]
|
|
8004e86: 893b ldrh r3, [r7, #8]
|
|
8004e88: 429a cmp r2, r3
|
|
8004e8a: d3f0 bcc.n 8004e6e <HAL_SUBGHZ_WriteRegisters+0x6a>
|
|
}
|
|
|
|
/* NSS = 1 */
|
|
LL_PWR_UnselectSUBGHZSPI_NSS();
|
|
8004e8c: f7ff fed0 bl 8004c30 <LL_PWR_UnselectSUBGHZSPI_NSS>
|
|
|
|
(void)SUBGHZ_WaitOnBusy(hsubghz);
|
|
8004e90: 68f8 ldr r0, [r7, #12]
|
|
8004e92: f000 fb57 bl 8005544 <SUBGHZ_WaitOnBusy>
|
|
|
|
if (hsubghz->ErrorCode != HAL_SUBGHZ_ERROR_NONE)
|
|
8004e96: 68fb ldr r3, [r7, #12]
|
|
8004e98: 689b ldr r3, [r3, #8]
|
|
8004e9a: 2b00 cmp r3, #0
|
|
8004e9c: d002 beq.n 8004ea4 <HAL_SUBGHZ_WriteRegisters+0xa0>
|
|
{
|
|
status = HAL_ERROR;
|
|
8004e9e: 2301 movs r3, #1
|
|
8004ea0: 75fb strb r3, [r7, #23]
|
|
8004ea2: e001 b.n 8004ea8 <HAL_SUBGHZ_WriteRegisters+0xa4>
|
|
}
|
|
else
|
|
{
|
|
status = HAL_OK;
|
|
8004ea4: 2300 movs r3, #0
|
|
8004ea6: 75fb strb r3, [r7, #23]
|
|
}
|
|
|
|
hsubghz->State = HAL_SUBGHZ_STATE_READY;
|
|
8004ea8: 68fb ldr r3, [r7, #12]
|
|
8004eaa: 2201 movs r2, #1
|
|
8004eac: 719a strb r2, [r3, #6]
|
|
|
|
/* Process Unlocked */
|
|
__HAL_UNLOCK(hsubghz);
|
|
8004eae: 68fb ldr r3, [r7, #12]
|
|
8004eb0: 2200 movs r2, #0
|
|
8004eb2: 715a strb r2, [r3, #5]
|
|
|
|
return status;
|
|
8004eb4: 7dfb ldrb r3, [r7, #23]
|
|
8004eb6: e000 b.n 8004eba <HAL_SUBGHZ_WriteRegisters+0xb6>
|
|
}
|
|
else
|
|
{
|
|
return HAL_BUSY;
|
|
8004eb8: 2302 movs r3, #2
|
|
}
|
|
}
|
|
8004eba: 4618 mov r0, r3
|
|
8004ebc: 3718 adds r7, #24
|
|
8004ebe: 46bd mov sp, r7
|
|
8004ec0: bd80 pop {r7, pc}
|
|
|
|
08004ec2 <HAL_SUBGHZ_ReadRegisters>:
|
|
*/
|
|
HAL_StatusTypeDef HAL_SUBGHZ_ReadRegisters(SUBGHZ_HandleTypeDef *hsubghz,
|
|
uint16_t Address,
|
|
uint8_t *pBuffer,
|
|
uint16_t Size)
|
|
{
|
|
8004ec2: b580 push {r7, lr}
|
|
8004ec4: b088 sub sp, #32
|
|
8004ec6: af00 add r7, sp, #0
|
|
8004ec8: 60f8 str r0, [r7, #12]
|
|
8004eca: 607a str r2, [r7, #4]
|
|
8004ecc: 461a mov r2, r3
|
|
8004ece: 460b mov r3, r1
|
|
8004ed0: 817b strh r3, [r7, #10]
|
|
8004ed2: 4613 mov r3, r2
|
|
8004ed4: 813b strh r3, [r7, #8]
|
|
HAL_StatusTypeDef status;
|
|
uint8_t *pData = pBuffer;
|
|
8004ed6: 687b ldr r3, [r7, #4]
|
|
8004ed8: 61bb str r3, [r7, #24]
|
|
|
|
if (hsubghz->State == HAL_SUBGHZ_STATE_READY)
|
|
8004eda: 68fb ldr r3, [r7, #12]
|
|
8004edc: 799b ldrb r3, [r3, #6]
|
|
8004ede: b2db uxtb r3, r3
|
|
8004ee0: 2b01 cmp r3, #1
|
|
8004ee2: d14a bne.n 8004f7a <HAL_SUBGHZ_ReadRegisters+0xb8>
|
|
{
|
|
/* Process Locked */
|
|
__HAL_LOCK(hsubghz);
|
|
8004ee4: 68fb ldr r3, [r7, #12]
|
|
8004ee6: 795b ldrb r3, [r3, #5]
|
|
8004ee8: 2b01 cmp r3, #1
|
|
8004eea: d101 bne.n 8004ef0 <HAL_SUBGHZ_ReadRegisters+0x2e>
|
|
8004eec: 2302 movs r3, #2
|
|
8004eee: e045 b.n 8004f7c <HAL_SUBGHZ_ReadRegisters+0xba>
|
|
8004ef0: 68fb ldr r3, [r7, #12]
|
|
8004ef2: 2201 movs r2, #1
|
|
8004ef4: 715a strb r2, [r3, #5]
|
|
|
|
(void)SUBGHZ_CheckDeviceReady(hsubghz);
|
|
8004ef6: 68f8 ldr r0, [r7, #12]
|
|
8004ef8: f000 fb04 bl 8005504 <SUBGHZ_CheckDeviceReady>
|
|
|
|
/* NSS = 0 */
|
|
LL_PWR_SelectSUBGHZSPI_NSS();
|
|
8004efc: f7ff fea8 bl 8004c50 <LL_PWR_SelectSUBGHZSPI_NSS>
|
|
|
|
(void)SUBGHZSPI_Transmit(hsubghz, SUBGHZ_RADIO_READ_REGISTER);
|
|
8004f00: 211d movs r1, #29
|
|
8004f02: 68f8 ldr r0, [r7, #12]
|
|
8004f04: f000 fa50 bl 80053a8 <SUBGHZSPI_Transmit>
|
|
(void)SUBGHZSPI_Transmit(hsubghz, (uint8_t)((Address & 0xFF00U) >> 8U));
|
|
8004f08: 897b ldrh r3, [r7, #10]
|
|
8004f0a: 0a1b lsrs r3, r3, #8
|
|
8004f0c: b29b uxth r3, r3
|
|
8004f0e: b2db uxtb r3, r3
|
|
8004f10: 4619 mov r1, r3
|
|
8004f12: 68f8 ldr r0, [r7, #12]
|
|
8004f14: f000 fa48 bl 80053a8 <SUBGHZSPI_Transmit>
|
|
(void)SUBGHZSPI_Transmit(hsubghz, (uint8_t)(Address & 0x00FFU));
|
|
8004f18: 897b ldrh r3, [r7, #10]
|
|
8004f1a: b2db uxtb r3, r3
|
|
8004f1c: 4619 mov r1, r3
|
|
8004f1e: 68f8 ldr r0, [r7, #12]
|
|
8004f20: f000 fa42 bl 80053a8 <SUBGHZSPI_Transmit>
|
|
(void)SUBGHZSPI_Transmit(hsubghz, 0U);
|
|
8004f24: 2100 movs r1, #0
|
|
8004f26: 68f8 ldr r0, [r7, #12]
|
|
8004f28: f000 fa3e bl 80053a8 <SUBGHZSPI_Transmit>
|
|
|
|
for (uint16_t i = 0U; i < Size; i++)
|
|
8004f2c: 2300 movs r3, #0
|
|
8004f2e: 82fb strh r3, [r7, #22]
|
|
8004f30: e009 b.n 8004f46 <HAL_SUBGHZ_ReadRegisters+0x84>
|
|
{
|
|
(void)SUBGHZSPI_Receive(hsubghz, (pData));
|
|
8004f32: 69b9 ldr r1, [r7, #24]
|
|
8004f34: 68f8 ldr r0, [r7, #12]
|
|
8004f36: f000 fa8d bl 8005454 <SUBGHZSPI_Receive>
|
|
pData++;
|
|
8004f3a: 69bb ldr r3, [r7, #24]
|
|
8004f3c: 3301 adds r3, #1
|
|
8004f3e: 61bb str r3, [r7, #24]
|
|
for (uint16_t i = 0U; i < Size; i++)
|
|
8004f40: 8afb ldrh r3, [r7, #22]
|
|
8004f42: 3301 adds r3, #1
|
|
8004f44: 82fb strh r3, [r7, #22]
|
|
8004f46: 8afa ldrh r2, [r7, #22]
|
|
8004f48: 893b ldrh r3, [r7, #8]
|
|
8004f4a: 429a cmp r2, r3
|
|
8004f4c: d3f1 bcc.n 8004f32 <HAL_SUBGHZ_ReadRegisters+0x70>
|
|
}
|
|
|
|
/* NSS = 1 */
|
|
LL_PWR_UnselectSUBGHZSPI_NSS();
|
|
8004f4e: f7ff fe6f bl 8004c30 <LL_PWR_UnselectSUBGHZSPI_NSS>
|
|
|
|
(void)SUBGHZ_WaitOnBusy(hsubghz);
|
|
8004f52: 68f8 ldr r0, [r7, #12]
|
|
8004f54: f000 faf6 bl 8005544 <SUBGHZ_WaitOnBusy>
|
|
|
|
if (hsubghz->ErrorCode != HAL_SUBGHZ_ERROR_NONE)
|
|
8004f58: 68fb ldr r3, [r7, #12]
|
|
8004f5a: 689b ldr r3, [r3, #8]
|
|
8004f5c: 2b00 cmp r3, #0
|
|
8004f5e: d002 beq.n 8004f66 <HAL_SUBGHZ_ReadRegisters+0xa4>
|
|
{
|
|
status = HAL_ERROR;
|
|
8004f60: 2301 movs r3, #1
|
|
8004f62: 77fb strb r3, [r7, #31]
|
|
8004f64: e001 b.n 8004f6a <HAL_SUBGHZ_ReadRegisters+0xa8>
|
|
}
|
|
else
|
|
{
|
|
status = HAL_OK;
|
|
8004f66: 2300 movs r3, #0
|
|
8004f68: 77fb strb r3, [r7, #31]
|
|
}
|
|
|
|
hsubghz->State = HAL_SUBGHZ_STATE_READY;
|
|
8004f6a: 68fb ldr r3, [r7, #12]
|
|
8004f6c: 2201 movs r2, #1
|
|
8004f6e: 719a strb r2, [r3, #6]
|
|
|
|
/* Process Unlocked */
|
|
__HAL_UNLOCK(hsubghz);
|
|
8004f70: 68fb ldr r3, [r7, #12]
|
|
8004f72: 2200 movs r2, #0
|
|
8004f74: 715a strb r2, [r3, #5]
|
|
|
|
return status;
|
|
8004f76: 7ffb ldrb r3, [r7, #31]
|
|
8004f78: e000 b.n 8004f7c <HAL_SUBGHZ_ReadRegisters+0xba>
|
|
}
|
|
else
|
|
{
|
|
return HAL_BUSY;
|
|
8004f7a: 2302 movs r3, #2
|
|
}
|
|
}
|
|
8004f7c: 4618 mov r0, r3
|
|
8004f7e: 3720 adds r7, #32
|
|
8004f80: 46bd mov sp, r7
|
|
8004f82: bd80 pop {r7, pc}
|
|
|
|
08004f84 <HAL_SUBGHZ_ExecSetCmd>:
|
|
*/
|
|
HAL_StatusTypeDef HAL_SUBGHZ_ExecSetCmd(SUBGHZ_HandleTypeDef *hsubghz,
|
|
SUBGHZ_RadioSetCmd_t Command,
|
|
uint8_t *pBuffer,
|
|
uint16_t Size)
|
|
{
|
|
8004f84: b580 push {r7, lr}
|
|
8004f86: b086 sub sp, #24
|
|
8004f88: af00 add r7, sp, #0
|
|
8004f8a: 60f8 str r0, [r7, #12]
|
|
8004f8c: 607a str r2, [r7, #4]
|
|
8004f8e: 461a mov r2, r3
|
|
8004f90: 460b mov r3, r1
|
|
8004f92: 72fb strb r3, [r7, #11]
|
|
8004f94: 4613 mov r3, r2
|
|
8004f96: 813b strh r3, [r7, #8]
|
|
HAL_StatusTypeDef status;
|
|
|
|
/* LORA Modulation not available on STM32WLx4xx devices */
|
|
assert_param(IS_SUBGHZ_MODULATION_SUPPORTED(Command, pBuffer[0U]));
|
|
|
|
if (hsubghz->State == HAL_SUBGHZ_STATE_READY)
|
|
8004f98: 68fb ldr r3, [r7, #12]
|
|
8004f9a: 799b ldrb r3, [r3, #6]
|
|
8004f9c: b2db uxtb r3, r3
|
|
8004f9e: 2b01 cmp r3, #1
|
|
8004fa0: d14a bne.n 8005038 <HAL_SUBGHZ_ExecSetCmd+0xb4>
|
|
{
|
|
/* Process Locked */
|
|
__HAL_LOCK(hsubghz);
|
|
8004fa2: 68fb ldr r3, [r7, #12]
|
|
8004fa4: 795b ldrb r3, [r3, #5]
|
|
8004fa6: 2b01 cmp r3, #1
|
|
8004fa8: d101 bne.n 8004fae <HAL_SUBGHZ_ExecSetCmd+0x2a>
|
|
8004faa: 2302 movs r3, #2
|
|
8004fac: e045 b.n 800503a <HAL_SUBGHZ_ExecSetCmd+0xb6>
|
|
8004fae: 68fb ldr r3, [r7, #12]
|
|
8004fb0: 2201 movs r2, #1
|
|
8004fb2: 715a strb r2, [r3, #5]
|
|
|
|
/* Need to wakeup Radio if already in Sleep at startup */
|
|
(void)SUBGHZ_CheckDeviceReady(hsubghz);
|
|
8004fb4: 68f8 ldr r0, [r7, #12]
|
|
8004fb6: f000 faa5 bl 8005504 <SUBGHZ_CheckDeviceReady>
|
|
|
|
if ((Command == RADIO_SET_SLEEP) || (Command == RADIO_SET_RXDUTYCYCLE))
|
|
8004fba: 7afb ldrb r3, [r7, #11]
|
|
8004fbc: 2b84 cmp r3, #132 @ 0x84
|
|
8004fbe: d002 beq.n 8004fc6 <HAL_SUBGHZ_ExecSetCmd+0x42>
|
|
8004fc0: 7afb ldrb r3, [r7, #11]
|
|
8004fc2: 2b94 cmp r3, #148 @ 0x94
|
|
8004fc4: d103 bne.n 8004fce <HAL_SUBGHZ_ExecSetCmd+0x4a>
|
|
{
|
|
hsubghz->DeepSleep = SUBGHZ_DEEP_SLEEP_ENABLE;
|
|
8004fc6: 68fb ldr r3, [r7, #12]
|
|
8004fc8: 2201 movs r2, #1
|
|
8004fca: 711a strb r2, [r3, #4]
|
|
8004fcc: e002 b.n 8004fd4 <HAL_SUBGHZ_ExecSetCmd+0x50>
|
|
}
|
|
else
|
|
{
|
|
hsubghz->DeepSleep = SUBGHZ_DEEP_SLEEP_DISABLE;
|
|
8004fce: 68fb ldr r3, [r7, #12]
|
|
8004fd0: 2200 movs r2, #0
|
|
8004fd2: 711a strb r2, [r3, #4]
|
|
}
|
|
|
|
/* NSS = 0 */
|
|
LL_PWR_SelectSUBGHZSPI_NSS();
|
|
8004fd4: f7ff fe3c bl 8004c50 <LL_PWR_SelectSUBGHZSPI_NSS>
|
|
|
|
(void)SUBGHZSPI_Transmit(hsubghz, (uint8_t)Command);
|
|
8004fd8: 7afb ldrb r3, [r7, #11]
|
|
8004fda: 4619 mov r1, r3
|
|
8004fdc: 68f8 ldr r0, [r7, #12]
|
|
8004fde: f000 f9e3 bl 80053a8 <SUBGHZSPI_Transmit>
|
|
|
|
for (uint16_t i = 0U; i < Size; i++)
|
|
8004fe2: 2300 movs r3, #0
|
|
8004fe4: 82bb strh r3, [r7, #20]
|
|
8004fe6: e00a b.n 8004ffe <HAL_SUBGHZ_ExecSetCmd+0x7a>
|
|
{
|
|
(void)SUBGHZSPI_Transmit(hsubghz, pBuffer[i]);
|
|
8004fe8: 8abb ldrh r3, [r7, #20]
|
|
8004fea: 687a ldr r2, [r7, #4]
|
|
8004fec: 4413 add r3, r2
|
|
8004fee: 781b ldrb r3, [r3, #0]
|
|
8004ff0: 4619 mov r1, r3
|
|
8004ff2: 68f8 ldr r0, [r7, #12]
|
|
8004ff4: f000 f9d8 bl 80053a8 <SUBGHZSPI_Transmit>
|
|
for (uint16_t i = 0U; i < Size; i++)
|
|
8004ff8: 8abb ldrh r3, [r7, #20]
|
|
8004ffa: 3301 adds r3, #1
|
|
8004ffc: 82bb strh r3, [r7, #20]
|
|
8004ffe: 8aba ldrh r2, [r7, #20]
|
|
8005000: 893b ldrh r3, [r7, #8]
|
|
8005002: 429a cmp r2, r3
|
|
8005004: d3f0 bcc.n 8004fe8 <HAL_SUBGHZ_ExecSetCmd+0x64>
|
|
}
|
|
|
|
/* NSS = 1 */
|
|
LL_PWR_UnselectSUBGHZSPI_NSS();
|
|
8005006: f7ff fe13 bl 8004c30 <LL_PWR_UnselectSUBGHZSPI_NSS>
|
|
|
|
if (Command != RADIO_SET_SLEEP)
|
|
800500a: 7afb ldrb r3, [r7, #11]
|
|
800500c: 2b84 cmp r3, #132 @ 0x84
|
|
800500e: d002 beq.n 8005016 <HAL_SUBGHZ_ExecSetCmd+0x92>
|
|
{
|
|
(void)SUBGHZ_WaitOnBusy(hsubghz);
|
|
8005010: 68f8 ldr r0, [r7, #12]
|
|
8005012: f000 fa97 bl 8005544 <SUBGHZ_WaitOnBusy>
|
|
}
|
|
|
|
if (hsubghz->ErrorCode != HAL_SUBGHZ_ERROR_NONE)
|
|
8005016: 68fb ldr r3, [r7, #12]
|
|
8005018: 689b ldr r3, [r3, #8]
|
|
800501a: 2b00 cmp r3, #0
|
|
800501c: d002 beq.n 8005024 <HAL_SUBGHZ_ExecSetCmd+0xa0>
|
|
{
|
|
status = HAL_ERROR;
|
|
800501e: 2301 movs r3, #1
|
|
8005020: 75fb strb r3, [r7, #23]
|
|
8005022: e001 b.n 8005028 <HAL_SUBGHZ_ExecSetCmd+0xa4>
|
|
}
|
|
else
|
|
{
|
|
status = HAL_OK;
|
|
8005024: 2300 movs r3, #0
|
|
8005026: 75fb strb r3, [r7, #23]
|
|
}
|
|
|
|
hsubghz->State = HAL_SUBGHZ_STATE_READY;
|
|
8005028: 68fb ldr r3, [r7, #12]
|
|
800502a: 2201 movs r2, #1
|
|
800502c: 719a strb r2, [r3, #6]
|
|
|
|
/* Process Unlocked */
|
|
__HAL_UNLOCK(hsubghz);
|
|
800502e: 68fb ldr r3, [r7, #12]
|
|
8005030: 2200 movs r2, #0
|
|
8005032: 715a strb r2, [r3, #5]
|
|
|
|
return status;
|
|
8005034: 7dfb ldrb r3, [r7, #23]
|
|
8005036: e000 b.n 800503a <HAL_SUBGHZ_ExecSetCmd+0xb6>
|
|
}
|
|
else
|
|
{
|
|
return HAL_BUSY;
|
|
8005038: 2302 movs r3, #2
|
|
}
|
|
}
|
|
800503a: 4618 mov r0, r3
|
|
800503c: 3718 adds r7, #24
|
|
800503e: 46bd mov sp, r7
|
|
8005040: bd80 pop {r7, pc}
|
|
|
|
08005042 <HAL_SUBGHZ_ExecGetCmd>:
|
|
*/
|
|
HAL_StatusTypeDef HAL_SUBGHZ_ExecGetCmd(SUBGHZ_HandleTypeDef *hsubghz,
|
|
SUBGHZ_RadioGetCmd_t Command,
|
|
uint8_t *pBuffer,
|
|
uint16_t Size)
|
|
{
|
|
8005042: b580 push {r7, lr}
|
|
8005044: b088 sub sp, #32
|
|
8005046: af00 add r7, sp, #0
|
|
8005048: 60f8 str r0, [r7, #12]
|
|
800504a: 607a str r2, [r7, #4]
|
|
800504c: 461a mov r2, r3
|
|
800504e: 460b mov r3, r1
|
|
8005050: 72fb strb r3, [r7, #11]
|
|
8005052: 4613 mov r3, r2
|
|
8005054: 813b strh r3, [r7, #8]
|
|
HAL_StatusTypeDef status;
|
|
uint8_t *pData = pBuffer;
|
|
8005056: 687b ldr r3, [r7, #4]
|
|
8005058: 61bb str r3, [r7, #24]
|
|
|
|
if (hsubghz->State == HAL_SUBGHZ_STATE_READY)
|
|
800505a: 68fb ldr r3, [r7, #12]
|
|
800505c: 799b ldrb r3, [r3, #6]
|
|
800505e: b2db uxtb r3, r3
|
|
8005060: 2b01 cmp r3, #1
|
|
8005062: d13d bne.n 80050e0 <HAL_SUBGHZ_ExecGetCmd+0x9e>
|
|
{
|
|
/* Process Locked */
|
|
__HAL_LOCK(hsubghz);
|
|
8005064: 68fb ldr r3, [r7, #12]
|
|
8005066: 795b ldrb r3, [r3, #5]
|
|
8005068: 2b01 cmp r3, #1
|
|
800506a: d101 bne.n 8005070 <HAL_SUBGHZ_ExecGetCmd+0x2e>
|
|
800506c: 2302 movs r3, #2
|
|
800506e: e038 b.n 80050e2 <HAL_SUBGHZ_ExecGetCmd+0xa0>
|
|
8005070: 68fb ldr r3, [r7, #12]
|
|
8005072: 2201 movs r2, #1
|
|
8005074: 715a strb r2, [r3, #5]
|
|
|
|
(void)SUBGHZ_CheckDeviceReady(hsubghz);
|
|
8005076: 68f8 ldr r0, [r7, #12]
|
|
8005078: f000 fa44 bl 8005504 <SUBGHZ_CheckDeviceReady>
|
|
|
|
/* NSS = 0 */
|
|
LL_PWR_SelectSUBGHZSPI_NSS();
|
|
800507c: f7ff fde8 bl 8004c50 <LL_PWR_SelectSUBGHZSPI_NSS>
|
|
|
|
(void)SUBGHZSPI_Transmit(hsubghz, (uint8_t)Command);
|
|
8005080: 7afb ldrb r3, [r7, #11]
|
|
8005082: 4619 mov r1, r3
|
|
8005084: 68f8 ldr r0, [r7, #12]
|
|
8005086: f000 f98f bl 80053a8 <SUBGHZSPI_Transmit>
|
|
|
|
/* Use to flush the Status (First byte) receive from SUBGHZ as not use */
|
|
(void)SUBGHZSPI_Transmit(hsubghz, 0x00U);
|
|
800508a: 2100 movs r1, #0
|
|
800508c: 68f8 ldr r0, [r7, #12]
|
|
800508e: f000 f98b bl 80053a8 <SUBGHZSPI_Transmit>
|
|
|
|
for (uint16_t i = 0U; i < Size; i++)
|
|
8005092: 2300 movs r3, #0
|
|
8005094: 82fb strh r3, [r7, #22]
|
|
8005096: e009 b.n 80050ac <HAL_SUBGHZ_ExecGetCmd+0x6a>
|
|
{
|
|
(void)SUBGHZSPI_Receive(hsubghz, (pData));
|
|
8005098: 69b9 ldr r1, [r7, #24]
|
|
800509a: 68f8 ldr r0, [r7, #12]
|
|
800509c: f000 f9da bl 8005454 <SUBGHZSPI_Receive>
|
|
pData++;
|
|
80050a0: 69bb ldr r3, [r7, #24]
|
|
80050a2: 3301 adds r3, #1
|
|
80050a4: 61bb str r3, [r7, #24]
|
|
for (uint16_t i = 0U; i < Size; i++)
|
|
80050a6: 8afb ldrh r3, [r7, #22]
|
|
80050a8: 3301 adds r3, #1
|
|
80050aa: 82fb strh r3, [r7, #22]
|
|
80050ac: 8afa ldrh r2, [r7, #22]
|
|
80050ae: 893b ldrh r3, [r7, #8]
|
|
80050b0: 429a cmp r2, r3
|
|
80050b2: d3f1 bcc.n 8005098 <HAL_SUBGHZ_ExecGetCmd+0x56>
|
|
}
|
|
|
|
/* NSS = 1 */
|
|
LL_PWR_UnselectSUBGHZSPI_NSS();
|
|
80050b4: f7ff fdbc bl 8004c30 <LL_PWR_UnselectSUBGHZSPI_NSS>
|
|
|
|
(void)SUBGHZ_WaitOnBusy(hsubghz);
|
|
80050b8: 68f8 ldr r0, [r7, #12]
|
|
80050ba: f000 fa43 bl 8005544 <SUBGHZ_WaitOnBusy>
|
|
|
|
if (hsubghz->ErrorCode != HAL_SUBGHZ_ERROR_NONE)
|
|
80050be: 68fb ldr r3, [r7, #12]
|
|
80050c0: 689b ldr r3, [r3, #8]
|
|
80050c2: 2b00 cmp r3, #0
|
|
80050c4: d002 beq.n 80050cc <HAL_SUBGHZ_ExecGetCmd+0x8a>
|
|
{
|
|
status = HAL_ERROR;
|
|
80050c6: 2301 movs r3, #1
|
|
80050c8: 77fb strb r3, [r7, #31]
|
|
80050ca: e001 b.n 80050d0 <HAL_SUBGHZ_ExecGetCmd+0x8e>
|
|
}
|
|
else
|
|
{
|
|
status = HAL_OK;
|
|
80050cc: 2300 movs r3, #0
|
|
80050ce: 77fb strb r3, [r7, #31]
|
|
}
|
|
|
|
hsubghz->State = HAL_SUBGHZ_STATE_READY;
|
|
80050d0: 68fb ldr r3, [r7, #12]
|
|
80050d2: 2201 movs r2, #1
|
|
80050d4: 719a strb r2, [r3, #6]
|
|
|
|
/* Process Unlocked */
|
|
__HAL_UNLOCK(hsubghz);
|
|
80050d6: 68fb ldr r3, [r7, #12]
|
|
80050d8: 2200 movs r2, #0
|
|
80050da: 715a strb r2, [r3, #5]
|
|
|
|
return status;
|
|
80050dc: 7ffb ldrb r3, [r7, #31]
|
|
80050de: e000 b.n 80050e2 <HAL_SUBGHZ_ExecGetCmd+0xa0>
|
|
}
|
|
else
|
|
{
|
|
return HAL_BUSY;
|
|
80050e0: 2302 movs r3, #2
|
|
}
|
|
}
|
|
80050e2: 4618 mov r0, r3
|
|
80050e4: 3720 adds r7, #32
|
|
80050e6: 46bd mov sp, r7
|
|
80050e8: bd80 pop {r7, pc}
|
|
|
|
080050ea <HAL_SUBGHZ_WriteBuffer>:
|
|
*/
|
|
HAL_StatusTypeDef HAL_SUBGHZ_WriteBuffer(SUBGHZ_HandleTypeDef *hsubghz,
|
|
uint8_t Offset,
|
|
uint8_t *pBuffer,
|
|
uint16_t Size)
|
|
{
|
|
80050ea: b580 push {r7, lr}
|
|
80050ec: b086 sub sp, #24
|
|
80050ee: af00 add r7, sp, #0
|
|
80050f0: 60f8 str r0, [r7, #12]
|
|
80050f2: 607a str r2, [r7, #4]
|
|
80050f4: 461a mov r2, r3
|
|
80050f6: 460b mov r3, r1
|
|
80050f8: 72fb strb r3, [r7, #11]
|
|
80050fa: 4613 mov r3, r2
|
|
80050fc: 813b strh r3, [r7, #8]
|
|
HAL_StatusTypeDef status;
|
|
|
|
if (hsubghz->State == HAL_SUBGHZ_STATE_READY)
|
|
80050fe: 68fb ldr r3, [r7, #12]
|
|
8005100: 799b ldrb r3, [r3, #6]
|
|
8005102: b2db uxtb r3, r3
|
|
8005104: 2b01 cmp r3, #1
|
|
8005106: d13e bne.n 8005186 <HAL_SUBGHZ_WriteBuffer+0x9c>
|
|
{
|
|
/* Process Locked */
|
|
__HAL_LOCK(hsubghz);
|
|
8005108: 68fb ldr r3, [r7, #12]
|
|
800510a: 795b ldrb r3, [r3, #5]
|
|
800510c: 2b01 cmp r3, #1
|
|
800510e: d101 bne.n 8005114 <HAL_SUBGHZ_WriteBuffer+0x2a>
|
|
8005110: 2302 movs r3, #2
|
|
8005112: e039 b.n 8005188 <HAL_SUBGHZ_WriteBuffer+0x9e>
|
|
8005114: 68fb ldr r3, [r7, #12]
|
|
8005116: 2201 movs r2, #1
|
|
8005118: 715a strb r2, [r3, #5]
|
|
|
|
(void)SUBGHZ_CheckDeviceReady(hsubghz);
|
|
800511a: 68f8 ldr r0, [r7, #12]
|
|
800511c: f000 f9f2 bl 8005504 <SUBGHZ_CheckDeviceReady>
|
|
|
|
/* NSS = 0 */
|
|
LL_PWR_SelectSUBGHZSPI_NSS();
|
|
8005120: f7ff fd96 bl 8004c50 <LL_PWR_SelectSUBGHZSPI_NSS>
|
|
|
|
(void)SUBGHZSPI_Transmit(hsubghz, SUBGHZ_RADIO_WRITE_BUFFER);
|
|
8005124: 210e movs r1, #14
|
|
8005126: 68f8 ldr r0, [r7, #12]
|
|
8005128: f000 f93e bl 80053a8 <SUBGHZSPI_Transmit>
|
|
(void)SUBGHZSPI_Transmit(hsubghz, Offset);
|
|
800512c: 7afb ldrb r3, [r7, #11]
|
|
800512e: 4619 mov r1, r3
|
|
8005130: 68f8 ldr r0, [r7, #12]
|
|
8005132: f000 f939 bl 80053a8 <SUBGHZSPI_Transmit>
|
|
|
|
for (uint16_t i = 0U; i < Size; i++)
|
|
8005136: 2300 movs r3, #0
|
|
8005138: 82bb strh r3, [r7, #20]
|
|
800513a: e00a b.n 8005152 <HAL_SUBGHZ_WriteBuffer+0x68>
|
|
{
|
|
(void)SUBGHZSPI_Transmit(hsubghz, pBuffer[i]);
|
|
800513c: 8abb ldrh r3, [r7, #20]
|
|
800513e: 687a ldr r2, [r7, #4]
|
|
8005140: 4413 add r3, r2
|
|
8005142: 781b ldrb r3, [r3, #0]
|
|
8005144: 4619 mov r1, r3
|
|
8005146: 68f8 ldr r0, [r7, #12]
|
|
8005148: f000 f92e bl 80053a8 <SUBGHZSPI_Transmit>
|
|
for (uint16_t i = 0U; i < Size; i++)
|
|
800514c: 8abb ldrh r3, [r7, #20]
|
|
800514e: 3301 adds r3, #1
|
|
8005150: 82bb strh r3, [r7, #20]
|
|
8005152: 8aba ldrh r2, [r7, #20]
|
|
8005154: 893b ldrh r3, [r7, #8]
|
|
8005156: 429a cmp r2, r3
|
|
8005158: d3f0 bcc.n 800513c <HAL_SUBGHZ_WriteBuffer+0x52>
|
|
}
|
|
/* NSS = 1 */
|
|
LL_PWR_UnselectSUBGHZSPI_NSS();
|
|
800515a: f7ff fd69 bl 8004c30 <LL_PWR_UnselectSUBGHZSPI_NSS>
|
|
|
|
(void)SUBGHZ_WaitOnBusy(hsubghz);
|
|
800515e: 68f8 ldr r0, [r7, #12]
|
|
8005160: f000 f9f0 bl 8005544 <SUBGHZ_WaitOnBusy>
|
|
|
|
if (hsubghz->ErrorCode != HAL_SUBGHZ_ERROR_NONE)
|
|
8005164: 68fb ldr r3, [r7, #12]
|
|
8005166: 689b ldr r3, [r3, #8]
|
|
8005168: 2b00 cmp r3, #0
|
|
800516a: d002 beq.n 8005172 <HAL_SUBGHZ_WriteBuffer+0x88>
|
|
{
|
|
status = HAL_ERROR;
|
|
800516c: 2301 movs r3, #1
|
|
800516e: 75fb strb r3, [r7, #23]
|
|
8005170: e001 b.n 8005176 <HAL_SUBGHZ_WriteBuffer+0x8c>
|
|
}
|
|
else
|
|
{
|
|
status = HAL_OK;
|
|
8005172: 2300 movs r3, #0
|
|
8005174: 75fb strb r3, [r7, #23]
|
|
}
|
|
|
|
hsubghz->State = HAL_SUBGHZ_STATE_READY;
|
|
8005176: 68fb ldr r3, [r7, #12]
|
|
8005178: 2201 movs r2, #1
|
|
800517a: 719a strb r2, [r3, #6]
|
|
|
|
/* Process Unlocked */
|
|
__HAL_UNLOCK(hsubghz);
|
|
800517c: 68fb ldr r3, [r7, #12]
|
|
800517e: 2200 movs r2, #0
|
|
8005180: 715a strb r2, [r3, #5]
|
|
|
|
return status;
|
|
8005182: 7dfb ldrb r3, [r7, #23]
|
|
8005184: e000 b.n 8005188 <HAL_SUBGHZ_WriteBuffer+0x9e>
|
|
}
|
|
else
|
|
{
|
|
return HAL_BUSY;
|
|
8005186: 2302 movs r3, #2
|
|
}
|
|
}
|
|
8005188: 4618 mov r0, r3
|
|
800518a: 3718 adds r7, #24
|
|
800518c: 46bd mov sp, r7
|
|
800518e: bd80 pop {r7, pc}
|
|
|
|
08005190 <HAL_SUBGHZ_ReadBuffer>:
|
|
*/
|
|
HAL_StatusTypeDef HAL_SUBGHZ_ReadBuffer(SUBGHZ_HandleTypeDef *hsubghz,
|
|
uint8_t Offset,
|
|
uint8_t *pBuffer,
|
|
uint16_t Size)
|
|
{
|
|
8005190: b580 push {r7, lr}
|
|
8005192: b088 sub sp, #32
|
|
8005194: af00 add r7, sp, #0
|
|
8005196: 60f8 str r0, [r7, #12]
|
|
8005198: 607a str r2, [r7, #4]
|
|
800519a: 461a mov r2, r3
|
|
800519c: 460b mov r3, r1
|
|
800519e: 72fb strb r3, [r7, #11]
|
|
80051a0: 4613 mov r3, r2
|
|
80051a2: 813b strh r3, [r7, #8]
|
|
HAL_StatusTypeDef status;
|
|
uint8_t *pData = pBuffer;
|
|
80051a4: 687b ldr r3, [r7, #4]
|
|
80051a6: 61bb str r3, [r7, #24]
|
|
|
|
if (hsubghz->State == HAL_SUBGHZ_STATE_READY)
|
|
80051a8: 68fb ldr r3, [r7, #12]
|
|
80051aa: 799b ldrb r3, [r3, #6]
|
|
80051ac: b2db uxtb r3, r3
|
|
80051ae: 2b01 cmp r3, #1
|
|
80051b0: d141 bne.n 8005236 <HAL_SUBGHZ_ReadBuffer+0xa6>
|
|
{
|
|
/* Process Locked */
|
|
__HAL_LOCK(hsubghz);
|
|
80051b2: 68fb ldr r3, [r7, #12]
|
|
80051b4: 795b ldrb r3, [r3, #5]
|
|
80051b6: 2b01 cmp r3, #1
|
|
80051b8: d101 bne.n 80051be <HAL_SUBGHZ_ReadBuffer+0x2e>
|
|
80051ba: 2302 movs r3, #2
|
|
80051bc: e03c b.n 8005238 <HAL_SUBGHZ_ReadBuffer+0xa8>
|
|
80051be: 68fb ldr r3, [r7, #12]
|
|
80051c0: 2201 movs r2, #1
|
|
80051c2: 715a strb r2, [r3, #5]
|
|
|
|
(void)SUBGHZ_CheckDeviceReady(hsubghz);
|
|
80051c4: 68f8 ldr r0, [r7, #12]
|
|
80051c6: f000 f99d bl 8005504 <SUBGHZ_CheckDeviceReady>
|
|
|
|
/* NSS = 0 */
|
|
LL_PWR_SelectSUBGHZSPI_NSS();
|
|
80051ca: f7ff fd41 bl 8004c50 <LL_PWR_SelectSUBGHZSPI_NSS>
|
|
|
|
(void)SUBGHZSPI_Transmit(hsubghz, SUBGHZ_RADIO_READ_BUFFER);
|
|
80051ce: 211e movs r1, #30
|
|
80051d0: 68f8 ldr r0, [r7, #12]
|
|
80051d2: f000 f8e9 bl 80053a8 <SUBGHZSPI_Transmit>
|
|
(void)SUBGHZSPI_Transmit(hsubghz, Offset);
|
|
80051d6: 7afb ldrb r3, [r7, #11]
|
|
80051d8: 4619 mov r1, r3
|
|
80051da: 68f8 ldr r0, [r7, #12]
|
|
80051dc: f000 f8e4 bl 80053a8 <SUBGHZSPI_Transmit>
|
|
(void)SUBGHZSPI_Transmit(hsubghz, 0x00U);
|
|
80051e0: 2100 movs r1, #0
|
|
80051e2: 68f8 ldr r0, [r7, #12]
|
|
80051e4: f000 f8e0 bl 80053a8 <SUBGHZSPI_Transmit>
|
|
|
|
for (uint16_t i = 0U; i < Size; i++)
|
|
80051e8: 2300 movs r3, #0
|
|
80051ea: 82fb strh r3, [r7, #22]
|
|
80051ec: e009 b.n 8005202 <HAL_SUBGHZ_ReadBuffer+0x72>
|
|
{
|
|
(void)SUBGHZSPI_Receive(hsubghz, (pData));
|
|
80051ee: 69b9 ldr r1, [r7, #24]
|
|
80051f0: 68f8 ldr r0, [r7, #12]
|
|
80051f2: f000 f92f bl 8005454 <SUBGHZSPI_Receive>
|
|
pData++;
|
|
80051f6: 69bb ldr r3, [r7, #24]
|
|
80051f8: 3301 adds r3, #1
|
|
80051fa: 61bb str r3, [r7, #24]
|
|
for (uint16_t i = 0U; i < Size; i++)
|
|
80051fc: 8afb ldrh r3, [r7, #22]
|
|
80051fe: 3301 adds r3, #1
|
|
8005200: 82fb strh r3, [r7, #22]
|
|
8005202: 8afa ldrh r2, [r7, #22]
|
|
8005204: 893b ldrh r3, [r7, #8]
|
|
8005206: 429a cmp r2, r3
|
|
8005208: d3f1 bcc.n 80051ee <HAL_SUBGHZ_ReadBuffer+0x5e>
|
|
}
|
|
|
|
/* NSS = 1 */
|
|
LL_PWR_UnselectSUBGHZSPI_NSS();
|
|
800520a: f7ff fd11 bl 8004c30 <LL_PWR_UnselectSUBGHZSPI_NSS>
|
|
|
|
(void)SUBGHZ_WaitOnBusy(hsubghz);
|
|
800520e: 68f8 ldr r0, [r7, #12]
|
|
8005210: f000 f998 bl 8005544 <SUBGHZ_WaitOnBusy>
|
|
|
|
if (hsubghz->ErrorCode != HAL_SUBGHZ_ERROR_NONE)
|
|
8005214: 68fb ldr r3, [r7, #12]
|
|
8005216: 689b ldr r3, [r3, #8]
|
|
8005218: 2b00 cmp r3, #0
|
|
800521a: d002 beq.n 8005222 <HAL_SUBGHZ_ReadBuffer+0x92>
|
|
{
|
|
status = HAL_ERROR;
|
|
800521c: 2301 movs r3, #1
|
|
800521e: 77fb strb r3, [r7, #31]
|
|
8005220: e001 b.n 8005226 <HAL_SUBGHZ_ReadBuffer+0x96>
|
|
}
|
|
else
|
|
{
|
|
status = HAL_OK;
|
|
8005222: 2300 movs r3, #0
|
|
8005224: 77fb strb r3, [r7, #31]
|
|
}
|
|
|
|
hsubghz->State = HAL_SUBGHZ_STATE_READY;
|
|
8005226: 68fb ldr r3, [r7, #12]
|
|
8005228: 2201 movs r2, #1
|
|
800522a: 719a strb r2, [r3, #6]
|
|
|
|
/* Process Unlocked */
|
|
__HAL_UNLOCK(hsubghz);
|
|
800522c: 68fb ldr r3, [r7, #12]
|
|
800522e: 2200 movs r2, #0
|
|
8005230: 715a strb r2, [r3, #5]
|
|
|
|
return status;
|
|
8005232: 7ffb ldrb r3, [r7, #31]
|
|
8005234: e000 b.n 8005238 <HAL_SUBGHZ_ReadBuffer+0xa8>
|
|
}
|
|
else
|
|
{
|
|
return HAL_BUSY;
|
|
8005236: 2302 movs r3, #2
|
|
}
|
|
}
|
|
8005238: 4618 mov r0, r3
|
|
800523a: 3720 adds r7, #32
|
|
800523c: 46bd mov sp, r7
|
|
800523e: bd80 pop {r7, pc}
|
|
|
|
08005240 <HAL_SUBGHZ_IRQHandler>:
|
|
* @param hsubghz pointer to a SUBGHZ_HandleTypeDef structure that contains
|
|
* the configuration information for the specified SUBGHZ module.
|
|
* @retval None
|
|
*/
|
|
void HAL_SUBGHZ_IRQHandler(SUBGHZ_HandleTypeDef *hsubghz)
|
|
{
|
|
8005240: b580 push {r7, lr}
|
|
8005242: b084 sub sp, #16
|
|
8005244: af00 add r7, sp, #0
|
|
8005246: 6078 str r0, [r7, #4]
|
|
uint8_t tmpisr[2U] = {0U};
|
|
8005248: 2300 movs r3, #0
|
|
800524a: 81bb strh r3, [r7, #12]
|
|
uint16_t itsource;
|
|
|
|
/* Retrieve Interrupts from SUBGHZ Irq Register */
|
|
(void)HAL_SUBGHZ_ExecGetCmd(hsubghz, RADIO_GET_IRQSTATUS, tmpisr, 2U);
|
|
800524c: f107 020c add.w r2, r7, #12
|
|
8005250: 2302 movs r3, #2
|
|
8005252: 2112 movs r1, #18
|
|
8005254: 6878 ldr r0, [r7, #4]
|
|
8005256: f7ff fef4 bl 8005042 <HAL_SUBGHZ_ExecGetCmd>
|
|
itsource = tmpisr[0U];
|
|
800525a: 7b3b ldrb r3, [r7, #12]
|
|
800525c: 81fb strh r3, [r7, #14]
|
|
itsource = (itsource << 8U) | tmpisr[1U];
|
|
800525e: f9b7 300e ldrsh.w r3, [r7, #14]
|
|
8005262: 021b lsls r3, r3, #8
|
|
8005264: b21a sxth r2, r3
|
|
8005266: 7b7b ldrb r3, [r7, #13]
|
|
8005268: b21b sxth r3, r3
|
|
800526a: 4313 orrs r3, r2
|
|
800526c: b21b sxth r3, r3
|
|
800526e: 81fb strh r3, [r7, #14]
|
|
|
|
/* Clear SUBGHZ Irq Register */
|
|
(void)HAL_SUBGHZ_ExecSetCmd(hsubghz, RADIO_CLR_IRQSTATUS, tmpisr, 2U);
|
|
8005270: f107 020c add.w r2, r7, #12
|
|
8005274: 2302 movs r3, #2
|
|
8005276: 2102 movs r1, #2
|
|
8005278: 6878 ldr r0, [r7, #4]
|
|
800527a: f7ff fe83 bl 8004f84 <HAL_SUBGHZ_ExecSetCmd>
|
|
|
|
/* Packet transmission completed Interrupt */
|
|
if (SUBGHZ_CHECK_IT_SOURCE(itsource, SUBGHZ_IT_TX_CPLT) != RESET)
|
|
800527e: 89fb ldrh r3, [r7, #14]
|
|
8005280: f003 0301 and.w r3, r3, #1
|
|
8005284: 2b00 cmp r3, #0
|
|
8005286: d002 beq.n 800528e <HAL_SUBGHZ_IRQHandler+0x4e>
|
|
{
|
|
#if (USE_HAL_SUBGHZ_REGISTER_CALLBACKS == 1U)
|
|
hsubghz->TxCpltCallback(hsubghz);
|
|
#else
|
|
HAL_SUBGHZ_TxCpltCallback(hsubghz);
|
|
8005288: 6878 ldr r0, [r7, #4]
|
|
800528a: f005 fdcd bl 800ae28 <HAL_SUBGHZ_TxCpltCallback>
|
|
#endif /* USE_HAL_SUBGHZ_REGISTER_CALLBACKS */
|
|
}
|
|
|
|
/* Packet received Interrupt */
|
|
if ((SUBGHZ_CHECK_IT_SOURCE(itsource, SUBGHZ_IT_RX_CPLT) != RESET))
|
|
800528e: 89fb ldrh r3, [r7, #14]
|
|
8005290: 085b lsrs r3, r3, #1
|
|
8005292: f003 0301 and.w r3, r3, #1
|
|
8005296: 2b00 cmp r3, #0
|
|
8005298: d00e beq.n 80052b8 <HAL_SUBGHZ_IRQHandler+0x78>
|
|
{
|
|
if (SUBGHZ_CHECK_IT_SOURCE(itsource, SUBGHZ_IT_CRC_ERROR) != RESET)
|
|
800529a: 89fb ldrh r3, [r7, #14]
|
|
800529c: 099b lsrs r3, r3, #6
|
|
800529e: f003 0301 and.w r3, r3, #1
|
|
80052a2: 2b00 cmp r3, #0
|
|
80052a4: d005 beq.n 80052b2 <HAL_SUBGHZ_IRQHandler+0x72>
|
|
{
|
|
hsubghz->ErrorCode |= HAL_SUBGHZ_ERROR_CRC_MISMATCH;
|
|
80052a6: 687b ldr r3, [r7, #4]
|
|
80052a8: 689b ldr r3, [r3, #8]
|
|
80052aa: f043 0204 orr.w r2, r3, #4
|
|
80052ae: 687b ldr r3, [r7, #4]
|
|
80052b0: 609a str r2, [r3, #8]
|
|
}
|
|
#if (USE_HAL_SUBGHZ_REGISTER_CALLBACKS == 1U)
|
|
hsubghz->RxCpltCallback(hsubghz);
|
|
#else
|
|
HAL_SUBGHZ_RxCpltCallback(hsubghz);
|
|
80052b2: 6878 ldr r0, [r7, #4]
|
|
80052b4: f005 fdc6 bl 800ae44 <HAL_SUBGHZ_RxCpltCallback>
|
|
#endif /* USE_HAL_SUBGHZ_REGISTER_CALLBACKS */
|
|
}
|
|
|
|
/* Preamble Detected Interrupt */
|
|
if (SUBGHZ_CHECK_IT_SOURCE(itsource, SUBGHZ_IT_PREAMBLE_DETECTED) != RESET)
|
|
80052b8: 89fb ldrh r3, [r7, #14]
|
|
80052ba: 089b lsrs r3, r3, #2
|
|
80052bc: f003 0301 and.w r3, r3, #1
|
|
80052c0: 2b00 cmp r3, #0
|
|
80052c2: d002 beq.n 80052ca <HAL_SUBGHZ_IRQHandler+0x8a>
|
|
{
|
|
#if (USE_HAL_SUBGHZ_REGISTER_CALLBACKS == 1U)
|
|
hsubghz->PreambleDetectedCallback(hsubghz);
|
|
#else
|
|
HAL_SUBGHZ_PreambleDetectedCallback(hsubghz);
|
|
80052c4: 6878 ldr r0, [r7, #4]
|
|
80052c6: f005 fe15 bl 800aef4 <HAL_SUBGHZ_PreambleDetectedCallback>
|
|
#endif /* USE_HAL_SUBGHZ_REGISTER_CALLBACKS */
|
|
}
|
|
|
|
/* Valid sync word detected Interrupt */
|
|
if (SUBGHZ_CHECK_IT_SOURCE(itsource, SUBGHZ_IT_SYNCWORD_VALID) != RESET)
|
|
80052ca: 89fb ldrh r3, [r7, #14]
|
|
80052cc: 08db lsrs r3, r3, #3
|
|
80052ce: f003 0301 and.w r3, r3, #1
|
|
80052d2: 2b00 cmp r3, #0
|
|
80052d4: d002 beq.n 80052dc <HAL_SUBGHZ_IRQHandler+0x9c>
|
|
{
|
|
#if (USE_HAL_SUBGHZ_REGISTER_CALLBACKS == 1U)
|
|
hsubghz->SyncWordValidCallback(hsubghz);
|
|
#else
|
|
HAL_SUBGHZ_SyncWordValidCallback(hsubghz);
|
|
80052d6: 6878 ldr r0, [r7, #4]
|
|
80052d8: f005 fe1a bl 800af10 <HAL_SUBGHZ_SyncWordValidCallback>
|
|
#endif /* USE_HAL_SUBGHZ_REGISTER_CALLBACKS */
|
|
}
|
|
|
|
/* Valid LoRa header received Interrupt */
|
|
if (SUBGHZ_CHECK_IT_SOURCE(itsource, SUBGHZ_IT_HEADER_VALID) != RESET)
|
|
80052dc: 89fb ldrh r3, [r7, #14]
|
|
80052de: 091b lsrs r3, r3, #4
|
|
80052e0: f003 0301 and.w r3, r3, #1
|
|
80052e4: 2b00 cmp r3, #0
|
|
80052e6: d002 beq.n 80052ee <HAL_SUBGHZ_IRQHandler+0xae>
|
|
{
|
|
#if (USE_HAL_SUBGHZ_REGISTER_CALLBACKS == 1U)
|
|
hsubghz->HeaderValidCallback(hsubghz);
|
|
#else
|
|
HAL_SUBGHZ_HeaderValidCallback(hsubghz);
|
|
80052e8: 6878 ldr r0, [r7, #4]
|
|
80052ea: f005 fe1f bl 800af2c <HAL_SUBGHZ_HeaderValidCallback>
|
|
#endif /* USE_HAL_SUBGHZ_REGISTER_CALLBACKS */
|
|
}
|
|
|
|
/* LoRa header CRC error Interrupt */
|
|
if (SUBGHZ_CHECK_IT_SOURCE(itsource, SUBGHZ_IT_HEADER_ERROR) != RESET)
|
|
80052ee: 89fb ldrh r3, [r7, #14]
|
|
80052f0: 095b lsrs r3, r3, #5
|
|
80052f2: f003 0301 and.w r3, r3, #1
|
|
80052f6: 2b00 cmp r3, #0
|
|
80052f8: d002 beq.n 8005300 <HAL_SUBGHZ_IRQHandler+0xc0>
|
|
{
|
|
#if (USE_HAL_SUBGHZ_REGISTER_CALLBACKS == 1U)
|
|
hsubghz->HeaderErrorCallback(hsubghz);
|
|
#else
|
|
HAL_SUBGHZ_HeaderErrorCallback(hsubghz);
|
|
80052fa: 6878 ldr r0, [r7, #4]
|
|
80052fc: f005 fdec bl 800aed8 <HAL_SUBGHZ_HeaderErrorCallback>
|
|
#endif /* USE_HAL_SUBGHZ_REGISTER_CALLBACKS */
|
|
}
|
|
|
|
/* Wrong CRC received Interrupt */
|
|
if (SUBGHZ_CHECK_IT_SOURCE(itsource, SUBGHZ_IT_CRC_ERROR) != RESET)
|
|
8005300: 89fb ldrh r3, [r7, #14]
|
|
8005302: 099b lsrs r3, r3, #6
|
|
8005304: f003 0301 and.w r3, r3, #1
|
|
8005308: 2b00 cmp r3, #0
|
|
800530a: d002 beq.n 8005312 <HAL_SUBGHZ_IRQHandler+0xd2>
|
|
{
|
|
#if (USE_HAL_SUBGHZ_REGISTER_CALLBACKS == 1U)
|
|
hsubghz->CRCErrorCallback(hsubghz);
|
|
#else
|
|
HAL_SUBGHZ_CRCErrorCallback(hsubghz);
|
|
800530c: 6878 ldr r0, [r7, #4]
|
|
800530e: f005 fda7 bl 800ae60 <HAL_SUBGHZ_CRCErrorCallback>
|
|
#endif /* USE_HAL_SUBGHZ_REGISTER_CALLBACKS */
|
|
}
|
|
|
|
/* Channel activity detection finished Interrupt */
|
|
if (SUBGHZ_CHECK_IT_SOURCE(itsource, SUBGHZ_IT_CAD_DONE) != RESET)
|
|
8005312: 89fb ldrh r3, [r7, #14]
|
|
8005314: 09db lsrs r3, r3, #7
|
|
8005316: f003 0301 and.w r3, r3, #1
|
|
800531a: 2b00 cmp r3, #0
|
|
800531c: d00e beq.n 800533c <HAL_SUBGHZ_IRQHandler+0xfc>
|
|
{
|
|
hsubghz->CADStatusCallback(hsubghz, HAL_SUBGHZ_CAD_CLEAR);
|
|
}
|
|
#else
|
|
/* Channel activity Detected Interrupt */
|
|
if (SUBGHZ_CHECK_IT_SOURCE(itsource, SUBGHZ_IT_CAD_ACTIVITY_DETECTED) != RESET)
|
|
800531e: 89fb ldrh r3, [r7, #14]
|
|
8005320: 0a1b lsrs r3, r3, #8
|
|
8005322: f003 0301 and.w r3, r3, #1
|
|
8005326: 2b00 cmp r3, #0
|
|
8005328: d004 beq.n 8005334 <HAL_SUBGHZ_IRQHandler+0xf4>
|
|
{
|
|
HAL_SUBGHZ_CADStatusCallback(hsubghz, HAL_SUBGHZ_CAD_DETECTED);
|
|
800532a: 2101 movs r1, #1
|
|
800532c: 6878 ldr r0, [r7, #4]
|
|
800532e: f005 fda5 bl 800ae7c <HAL_SUBGHZ_CADStatusCallback>
|
|
8005332: e003 b.n 800533c <HAL_SUBGHZ_IRQHandler+0xfc>
|
|
}
|
|
else
|
|
{
|
|
HAL_SUBGHZ_CADStatusCallback(hsubghz, HAL_SUBGHZ_CAD_CLEAR);
|
|
8005334: 2100 movs r1, #0
|
|
8005336: 6878 ldr r0, [r7, #4]
|
|
8005338: f005 fda0 bl 800ae7c <HAL_SUBGHZ_CADStatusCallback>
|
|
}
|
|
#endif /* USE_HAL_SUBGHZ_REGISTER_CALLBACKS */
|
|
}
|
|
|
|
/* Rx or Tx Timeout Interrupt */
|
|
if (SUBGHZ_CHECK_IT_SOURCE(itsource, SUBGHZ_IT_RX_TX_TIMEOUT) != RESET)
|
|
800533c: 89fb ldrh r3, [r7, #14]
|
|
800533e: 0a5b lsrs r3, r3, #9
|
|
8005340: f003 0301 and.w r3, r3, #1
|
|
8005344: 2b00 cmp r3, #0
|
|
8005346: d002 beq.n 800534e <HAL_SUBGHZ_IRQHandler+0x10e>
|
|
{
|
|
#if (USE_HAL_SUBGHZ_REGISTER_CALLBACKS == 1U)
|
|
hsubghz->RxTxTimeoutCallback(hsubghz);
|
|
#else
|
|
HAL_SUBGHZ_RxTxTimeoutCallback(hsubghz);
|
|
8005348: 6878 ldr r0, [r7, #4]
|
|
800534a: f005 fdb5 bl 800aeb8 <HAL_SUBGHZ_RxTxTimeoutCallback>
|
|
#endif /* USE_HAL_SUBGHZ_REGISTER_CALLBACKS */
|
|
}
|
|
|
|
/* LR_FHSS Hop interrupt */
|
|
if (SUBGHZ_CHECK_IT_SOURCE(itsource, SUBGHZ_IT_LR_FHSS_HOP) != RESET)
|
|
800534e: 89fb ldrh r3, [r7, #14]
|
|
8005350: 0b9b lsrs r3, r3, #14
|
|
8005352: f003 0301 and.w r3, r3, #1
|
|
8005356: 2b00 cmp r3, #0
|
|
8005358: d002 beq.n 8005360 <HAL_SUBGHZ_IRQHandler+0x120>
|
|
{
|
|
#if (USE_HAL_SUBGHZ_REGISTER_CALLBACKS == 1U)
|
|
hsubghz->LrFhssHopCallback(hsubghz);
|
|
#else
|
|
HAL_SUBGHZ_LrFhssHopCallback(hsubghz);
|
|
800535a: 6878 ldr r0, [r7, #4]
|
|
800535c: f005 fdf4 bl 800af48 <HAL_SUBGHZ_LrFhssHopCallback>
|
|
#endif /* USE_HAL_SUBGHZ_REGISTER_CALLBACKS */
|
|
}
|
|
}
|
|
8005360: bf00 nop
|
|
8005362: 3710 adds r7, #16
|
|
8005364: 46bd mov sp, r7
|
|
8005366: bd80 pop {r7, pc}
|
|
|
|
08005368 <SUBGHZSPI_Init>:
|
|
* @brief Initializes the SUBGHZSPI peripheral
|
|
* @param BaudratePrescaler SPI Baudrate prescaler
|
|
* @retval None
|
|
*/
|
|
void SUBGHZSPI_Init(uint32_t BaudratePrescaler)
|
|
{
|
|
8005368: b480 push {r7}
|
|
800536a: b083 sub sp, #12
|
|
800536c: af00 add r7, sp, #0
|
|
800536e: 6078 str r0, [r7, #4]
|
|
/* Check the parameters */
|
|
assert_param(IS_SUBGHZ_ALL_INSTANCE(SUBGHZSPI));
|
|
|
|
/* Disable SUBGHZSPI Peripheral */
|
|
CLEAR_BIT(SUBGHZSPI->CR1, SPI_CR1_SPE);
|
|
8005370: 4b0c ldr r3, [pc, #48] @ (80053a4 <SUBGHZSPI_Init+0x3c>)
|
|
8005372: 681b ldr r3, [r3, #0]
|
|
8005374: 4a0b ldr r2, [pc, #44] @ (80053a4 <SUBGHZSPI_Init+0x3c>)
|
|
8005376: f023 0340 bic.w r3, r3, #64 @ 0x40
|
|
800537a: 6013 str r3, [r2, #0]
|
|
* NSS management: Internal (Done with External bit inside PWR *
|
|
* Communication speed: BaudratePrescaler *
|
|
* First bit: MSB *
|
|
* CRC calculation: Disable *
|
|
*--------------------------------------------------------------------------*/
|
|
WRITE_REG(SUBGHZSPI->CR1, (SPI_CR1_MSTR | SPI_CR1_SSI | BaudratePrescaler | SPI_CR1_SSM));
|
|
800537c: 4a09 ldr r2, [pc, #36] @ (80053a4 <SUBGHZSPI_Init+0x3c>)
|
|
800537e: 687b ldr r3, [r7, #4]
|
|
8005380: f443 7341 orr.w r3, r3, #772 @ 0x304
|
|
8005384: 6013 str r3, [r2, #0]
|
|
* Data Size: 8bits *
|
|
* TI Mode: Disable *
|
|
* NSS Pulse: Disable *
|
|
* Rx FIFO Threshold: 8bits *
|
|
*--------------------------------------------------------------------------*/
|
|
WRITE_REG(SUBGHZSPI->CR2, (SPI_CR2_FRXTH | SPI_CR2_DS_0 | SPI_CR2_DS_1 | SPI_CR2_DS_2));
|
|
8005386: 4b07 ldr r3, [pc, #28] @ (80053a4 <SUBGHZSPI_Init+0x3c>)
|
|
8005388: f44f 52b8 mov.w r2, #5888 @ 0x1700
|
|
800538c: 605a str r2, [r3, #4]
|
|
|
|
/* Enable SUBGHZSPI Peripheral */
|
|
SET_BIT(SUBGHZSPI->CR1, SPI_CR1_SPE);
|
|
800538e: 4b05 ldr r3, [pc, #20] @ (80053a4 <SUBGHZSPI_Init+0x3c>)
|
|
8005390: 681b ldr r3, [r3, #0]
|
|
8005392: 4a04 ldr r2, [pc, #16] @ (80053a4 <SUBGHZSPI_Init+0x3c>)
|
|
8005394: f043 0340 orr.w r3, r3, #64 @ 0x40
|
|
8005398: 6013 str r3, [r2, #0]
|
|
}
|
|
800539a: bf00 nop
|
|
800539c: 370c adds r7, #12
|
|
800539e: 46bd mov sp, r7
|
|
80053a0: bc80 pop {r7}
|
|
80053a2: 4770 bx lr
|
|
80053a4: 58010000 .word 0x58010000
|
|
|
|
080053a8 <SUBGHZSPI_Transmit>:
|
|
* @param Data data to transmit
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef SUBGHZSPI_Transmit(SUBGHZ_HandleTypeDef *hsubghz,
|
|
uint8_t Data)
|
|
{
|
|
80053a8: b480 push {r7}
|
|
80053aa: b087 sub sp, #28
|
|
80053ac: af00 add r7, sp, #0
|
|
80053ae: 6078 str r0, [r7, #4]
|
|
80053b0: 460b mov r3, r1
|
|
80053b2: 70fb strb r3, [r7, #3]
|
|
HAL_StatusTypeDef status = HAL_OK;
|
|
80053b4: 2300 movs r3, #0
|
|
80053b6: 75fb strb r3, [r7, #23]
|
|
__IO uint32_t count;
|
|
|
|
/* Handle Tx transmission from SUBGHZSPI peripheral to Radio ****************/
|
|
/* Initialize Timeout */
|
|
count = SUBGHZ_DEFAULT_TIMEOUT * SUBGHZ_DEFAULT_LOOP_TIME;
|
|
80053b8: 4b23 ldr r3, [pc, #140] @ (8005448 <SUBGHZSPI_Transmit+0xa0>)
|
|
80053ba: 681a ldr r2, [r3, #0]
|
|
80053bc: 4613 mov r3, r2
|
|
80053be: 00db lsls r3, r3, #3
|
|
80053c0: 1a9b subs r3, r3, r2
|
|
80053c2: 009b lsls r3, r3, #2
|
|
80053c4: 0cdb lsrs r3, r3, #19
|
|
80053c6: 2264 movs r2, #100 @ 0x64
|
|
80053c8: fb02 f303 mul.w r3, r2, r3
|
|
80053cc: 60fb str r3, [r7, #12]
|
|
|
|
/* Wait until TXE flag is set */
|
|
do
|
|
{
|
|
if (count == 0U)
|
|
80053ce: 68fb ldr r3, [r7, #12]
|
|
80053d0: 2b00 cmp r3, #0
|
|
80053d2: d105 bne.n 80053e0 <SUBGHZSPI_Transmit+0x38>
|
|
{
|
|
status = HAL_ERROR;
|
|
80053d4: 2301 movs r3, #1
|
|
80053d6: 75fb strb r3, [r7, #23]
|
|
hsubghz->ErrorCode = HAL_SUBGHZ_ERROR_TIMEOUT;
|
|
80053d8: 687b ldr r3, [r7, #4]
|
|
80053da: 2201 movs r2, #1
|
|
80053dc: 609a str r2, [r3, #8]
|
|
break;
|
|
80053de: e008 b.n 80053f2 <SUBGHZSPI_Transmit+0x4a>
|
|
}
|
|
count--;
|
|
80053e0: 68fb ldr r3, [r7, #12]
|
|
80053e2: 3b01 subs r3, #1
|
|
80053e4: 60fb str r3, [r7, #12]
|
|
} while (READ_BIT(SUBGHZSPI->SR, SPI_SR_TXE) != (SPI_SR_TXE));
|
|
80053e6: 4b19 ldr r3, [pc, #100] @ (800544c <SUBGHZSPI_Transmit+0xa4>)
|
|
80053e8: 689b ldr r3, [r3, #8]
|
|
80053ea: f003 0302 and.w r3, r3, #2
|
|
80053ee: 2b02 cmp r3, #2
|
|
80053f0: d1ed bne.n 80053ce <SUBGHZSPI_Transmit+0x26>
|
|
|
|
/* Transmit Data*/
|
|
#if defined (__GNUC__)
|
|
__IO uint8_t *spidr = ((__IO uint8_t *)&SUBGHZSPI->DR);
|
|
80053f2: 4b17 ldr r3, [pc, #92] @ (8005450 <SUBGHZSPI_Transmit+0xa8>)
|
|
80053f4: 613b str r3, [r7, #16]
|
|
*spidr = Data;
|
|
80053f6: 693b ldr r3, [r7, #16]
|
|
80053f8: 78fa ldrb r2, [r7, #3]
|
|
80053fa: 701a strb r2, [r3, #0]
|
|
*((__IO uint8_t *)&SUBGHZSPI->DR) = Data;
|
|
#endif /* __GNUC__ */
|
|
|
|
/* Handle Rx transmission from SUBGHZSPI peripheral to Radio ****************/
|
|
/* Initialize Timeout */
|
|
count = SUBGHZ_DEFAULT_TIMEOUT * SUBGHZ_DEFAULT_LOOP_TIME;
|
|
80053fc: 4b12 ldr r3, [pc, #72] @ (8005448 <SUBGHZSPI_Transmit+0xa0>)
|
|
80053fe: 681a ldr r2, [r3, #0]
|
|
8005400: 4613 mov r3, r2
|
|
8005402: 00db lsls r3, r3, #3
|
|
8005404: 1a9b subs r3, r3, r2
|
|
8005406: 009b lsls r3, r3, #2
|
|
8005408: 0cdb lsrs r3, r3, #19
|
|
800540a: 2264 movs r2, #100 @ 0x64
|
|
800540c: fb02 f303 mul.w r3, r2, r3
|
|
8005410: 60fb str r3, [r7, #12]
|
|
|
|
/* Wait until RXNE flag is set */
|
|
do
|
|
{
|
|
if (count == 0U)
|
|
8005412: 68fb ldr r3, [r7, #12]
|
|
8005414: 2b00 cmp r3, #0
|
|
8005416: d105 bne.n 8005424 <SUBGHZSPI_Transmit+0x7c>
|
|
{
|
|
status = HAL_ERROR;
|
|
8005418: 2301 movs r3, #1
|
|
800541a: 75fb strb r3, [r7, #23]
|
|
hsubghz->ErrorCode = HAL_SUBGHZ_ERROR_TIMEOUT;
|
|
800541c: 687b ldr r3, [r7, #4]
|
|
800541e: 2201 movs r2, #1
|
|
8005420: 609a str r2, [r3, #8]
|
|
break;
|
|
8005422: e008 b.n 8005436 <SUBGHZSPI_Transmit+0x8e>
|
|
}
|
|
count--;
|
|
8005424: 68fb ldr r3, [r7, #12]
|
|
8005426: 3b01 subs r3, #1
|
|
8005428: 60fb str r3, [r7, #12]
|
|
} while (READ_BIT(SUBGHZSPI->SR, SPI_SR_RXNE) != (SPI_SR_RXNE));
|
|
800542a: 4b08 ldr r3, [pc, #32] @ (800544c <SUBGHZSPI_Transmit+0xa4>)
|
|
800542c: 689b ldr r3, [r3, #8]
|
|
800542e: f003 0301 and.w r3, r3, #1
|
|
8005432: 2b01 cmp r3, #1
|
|
8005434: d1ed bne.n 8005412 <SUBGHZSPI_Transmit+0x6a>
|
|
|
|
/* Flush Rx data */
|
|
READ_REG(SUBGHZSPI->DR);
|
|
8005436: 4b05 ldr r3, [pc, #20] @ (800544c <SUBGHZSPI_Transmit+0xa4>)
|
|
8005438: 68db ldr r3, [r3, #12]
|
|
|
|
return status;
|
|
800543a: 7dfb ldrb r3, [r7, #23]
|
|
}
|
|
800543c: 4618 mov r0, r3
|
|
800543e: 371c adds r7, #28
|
|
8005440: 46bd mov sp, r7
|
|
8005442: bc80 pop {r7}
|
|
8005444: 4770 bx lr
|
|
8005446: bf00 nop
|
|
8005448: 20000000 .word 0x20000000
|
|
800544c: 58010000 .word 0x58010000
|
|
8005450: 5801000c .word 0x5801000c
|
|
|
|
08005454 <SUBGHZSPI_Receive>:
|
|
* @param pData pointer on data to receive
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef SUBGHZSPI_Receive(SUBGHZ_HandleTypeDef *hsubghz,
|
|
uint8_t *pData)
|
|
{
|
|
8005454: b480 push {r7}
|
|
8005456: b087 sub sp, #28
|
|
8005458: af00 add r7, sp, #0
|
|
800545a: 6078 str r0, [r7, #4]
|
|
800545c: 6039 str r1, [r7, #0]
|
|
HAL_StatusTypeDef status = HAL_OK;
|
|
800545e: 2300 movs r3, #0
|
|
8005460: 75fb strb r3, [r7, #23]
|
|
__IO uint32_t count;
|
|
|
|
/* Handle Tx transmission from SUBGHZSPI peripheral to Radio ****************/
|
|
/* Initialize Timeout */
|
|
count = SUBGHZ_DEFAULT_TIMEOUT * SUBGHZ_DEFAULT_LOOP_TIME;
|
|
8005462: 4b25 ldr r3, [pc, #148] @ (80054f8 <SUBGHZSPI_Receive+0xa4>)
|
|
8005464: 681a ldr r2, [r3, #0]
|
|
8005466: 4613 mov r3, r2
|
|
8005468: 00db lsls r3, r3, #3
|
|
800546a: 1a9b subs r3, r3, r2
|
|
800546c: 009b lsls r3, r3, #2
|
|
800546e: 0cdb lsrs r3, r3, #19
|
|
8005470: 2264 movs r2, #100 @ 0x64
|
|
8005472: fb02 f303 mul.w r3, r2, r3
|
|
8005476: 60fb str r3, [r7, #12]
|
|
|
|
/* Wait until TXE flag is set */
|
|
do
|
|
{
|
|
if (count == 0U)
|
|
8005478: 68fb ldr r3, [r7, #12]
|
|
800547a: 2b00 cmp r3, #0
|
|
800547c: d105 bne.n 800548a <SUBGHZSPI_Receive+0x36>
|
|
{
|
|
status = HAL_ERROR;
|
|
800547e: 2301 movs r3, #1
|
|
8005480: 75fb strb r3, [r7, #23]
|
|
hsubghz->ErrorCode = HAL_SUBGHZ_ERROR_TIMEOUT;
|
|
8005482: 687b ldr r3, [r7, #4]
|
|
8005484: 2201 movs r2, #1
|
|
8005486: 609a str r2, [r3, #8]
|
|
break;
|
|
8005488: e008 b.n 800549c <SUBGHZSPI_Receive+0x48>
|
|
}
|
|
count--;
|
|
800548a: 68fb ldr r3, [r7, #12]
|
|
800548c: 3b01 subs r3, #1
|
|
800548e: 60fb str r3, [r7, #12]
|
|
} while (READ_BIT(SUBGHZSPI->SR, SPI_SR_TXE) != (SPI_SR_TXE));
|
|
8005490: 4b1a ldr r3, [pc, #104] @ (80054fc <SUBGHZSPI_Receive+0xa8>)
|
|
8005492: 689b ldr r3, [r3, #8]
|
|
8005494: f003 0302 and.w r3, r3, #2
|
|
8005498: 2b02 cmp r3, #2
|
|
800549a: d1ed bne.n 8005478 <SUBGHZSPI_Receive+0x24>
|
|
|
|
/* Transmit Data*/
|
|
#if defined (__GNUC__)
|
|
__IO uint8_t *spidr = ((__IO uint8_t *)&SUBGHZSPI->DR);
|
|
800549c: 4b18 ldr r3, [pc, #96] @ (8005500 <SUBGHZSPI_Receive+0xac>)
|
|
800549e: 613b str r3, [r7, #16]
|
|
*spidr = SUBGHZ_DUMMY_DATA;
|
|
80054a0: 693b ldr r3, [r7, #16]
|
|
80054a2: 22ff movs r2, #255 @ 0xff
|
|
80054a4: 701a strb r2, [r3, #0]
|
|
*((__IO uint8_t *)&SUBGHZSPI->DR) = SUBGHZ_DUMMY_DATA;
|
|
#endif /* __GNUC__ */
|
|
|
|
/* Handle Rx transmission from SUBGHZSPI peripheral to Radio ****************/
|
|
/* Initialize Timeout */
|
|
count = SUBGHZ_DEFAULT_TIMEOUT * SUBGHZ_DEFAULT_LOOP_TIME;
|
|
80054a6: 4b14 ldr r3, [pc, #80] @ (80054f8 <SUBGHZSPI_Receive+0xa4>)
|
|
80054a8: 681a ldr r2, [r3, #0]
|
|
80054aa: 4613 mov r3, r2
|
|
80054ac: 00db lsls r3, r3, #3
|
|
80054ae: 1a9b subs r3, r3, r2
|
|
80054b0: 009b lsls r3, r3, #2
|
|
80054b2: 0cdb lsrs r3, r3, #19
|
|
80054b4: 2264 movs r2, #100 @ 0x64
|
|
80054b6: fb02 f303 mul.w r3, r2, r3
|
|
80054ba: 60fb str r3, [r7, #12]
|
|
|
|
/* Wait until RXNE flag is set */
|
|
do
|
|
{
|
|
if (count == 0U)
|
|
80054bc: 68fb ldr r3, [r7, #12]
|
|
80054be: 2b00 cmp r3, #0
|
|
80054c0: d105 bne.n 80054ce <SUBGHZSPI_Receive+0x7a>
|
|
{
|
|
status = HAL_ERROR;
|
|
80054c2: 2301 movs r3, #1
|
|
80054c4: 75fb strb r3, [r7, #23]
|
|
hsubghz->ErrorCode = HAL_SUBGHZ_ERROR_TIMEOUT;
|
|
80054c6: 687b ldr r3, [r7, #4]
|
|
80054c8: 2201 movs r2, #1
|
|
80054ca: 609a str r2, [r3, #8]
|
|
break;
|
|
80054cc: e008 b.n 80054e0 <SUBGHZSPI_Receive+0x8c>
|
|
}
|
|
count--;
|
|
80054ce: 68fb ldr r3, [r7, #12]
|
|
80054d0: 3b01 subs r3, #1
|
|
80054d2: 60fb str r3, [r7, #12]
|
|
} while (READ_BIT(SUBGHZSPI->SR, SPI_SR_RXNE) != (SPI_SR_RXNE));
|
|
80054d4: 4b09 ldr r3, [pc, #36] @ (80054fc <SUBGHZSPI_Receive+0xa8>)
|
|
80054d6: 689b ldr r3, [r3, #8]
|
|
80054d8: f003 0301 and.w r3, r3, #1
|
|
80054dc: 2b01 cmp r3, #1
|
|
80054de: d1ed bne.n 80054bc <SUBGHZSPI_Receive+0x68>
|
|
|
|
/* Retrieve pData */
|
|
*pData = (uint8_t)(READ_REG(SUBGHZSPI->DR));
|
|
80054e0: 4b06 ldr r3, [pc, #24] @ (80054fc <SUBGHZSPI_Receive+0xa8>)
|
|
80054e2: 68db ldr r3, [r3, #12]
|
|
80054e4: b2da uxtb r2, r3
|
|
80054e6: 683b ldr r3, [r7, #0]
|
|
80054e8: 701a strb r2, [r3, #0]
|
|
|
|
return status;
|
|
80054ea: 7dfb ldrb r3, [r7, #23]
|
|
}
|
|
80054ec: 4618 mov r0, r3
|
|
80054ee: 371c adds r7, #28
|
|
80054f0: 46bd mov sp, r7
|
|
80054f2: bc80 pop {r7}
|
|
80054f4: 4770 bx lr
|
|
80054f6: bf00 nop
|
|
80054f8: 20000000 .word 0x20000000
|
|
80054fc: 58010000 .word 0x58010000
|
|
8005500: 5801000c .word 0x5801000c
|
|
|
|
08005504 <SUBGHZ_CheckDeviceReady>:
|
|
* @param hsubghz pointer to a SUBGHZ_HandleTypeDef structure that contains
|
|
* the handle information for SUBGHZ module.
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef SUBGHZ_CheckDeviceReady(SUBGHZ_HandleTypeDef *hsubghz)
|
|
{
|
|
8005504: b580 push {r7, lr}
|
|
8005506: b084 sub sp, #16
|
|
8005508: af00 add r7, sp, #0
|
|
800550a: 6078 str r0, [r7, #4]
|
|
__IO uint32_t count;
|
|
|
|
/* Wakeup radio in case of sleep mode: Select-Unselect radio */
|
|
if (hsubghz->DeepSleep == SUBGHZ_DEEP_SLEEP_ENABLE)
|
|
800550c: 687b ldr r3, [r7, #4]
|
|
800550e: 791b ldrb r3, [r3, #4]
|
|
8005510: 2b01 cmp r3, #1
|
|
8005512: d10d bne.n 8005530 <SUBGHZ_CheckDeviceReady+0x2c>
|
|
{
|
|
/* Initialize NSS switch Delay */
|
|
count = SUBGHZ_NSS_LOOP_TIME;
|
|
8005514: 4b0a ldr r3, [pc, #40] @ (8005540 <SUBGHZ_CheckDeviceReady+0x3c>)
|
|
8005516: 681b ldr r3, [r3, #0]
|
|
8005518: 0c1b lsrs r3, r3, #16
|
|
800551a: 60fb str r3, [r7, #12]
|
|
|
|
/* NSS = 0; */
|
|
LL_PWR_SelectSUBGHZSPI_NSS();
|
|
800551c: f7ff fb98 bl 8004c50 <LL_PWR_SelectSUBGHZSPI_NSS>
|
|
|
|
/* Wait Radio wakeup */
|
|
do
|
|
{
|
|
count--;
|
|
8005520: 68fb ldr r3, [r7, #12]
|
|
8005522: 3b01 subs r3, #1
|
|
8005524: 60fb str r3, [r7, #12]
|
|
} while (count != 0UL);
|
|
8005526: 68fb ldr r3, [r7, #12]
|
|
8005528: 2b00 cmp r3, #0
|
|
800552a: d1f9 bne.n 8005520 <SUBGHZ_CheckDeviceReady+0x1c>
|
|
|
|
/* NSS = 1 */
|
|
LL_PWR_UnselectSUBGHZSPI_NSS();
|
|
800552c: f7ff fb80 bl 8004c30 <LL_PWR_UnselectSUBGHZSPI_NSS>
|
|
}
|
|
return (SUBGHZ_WaitOnBusy(hsubghz));
|
|
8005530: 6878 ldr r0, [r7, #4]
|
|
8005532: f000 f807 bl 8005544 <SUBGHZ_WaitOnBusy>
|
|
8005536: 4603 mov r3, r0
|
|
}
|
|
8005538: 4618 mov r0, r3
|
|
800553a: 3710 adds r7, #16
|
|
800553c: 46bd mov sp, r7
|
|
800553e: bd80 pop {r7, pc}
|
|
8005540: 20000000 .word 0x20000000
|
|
|
|
08005544 <SUBGHZ_WaitOnBusy>:
|
|
* @param hsubghz pointer to a SUBGHZ_HandleTypeDef structure that contains
|
|
* the handle information for SUBGHZ module.
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef SUBGHZ_WaitOnBusy(SUBGHZ_HandleTypeDef *hsubghz)
|
|
{
|
|
8005544: b580 push {r7, lr}
|
|
8005546: b086 sub sp, #24
|
|
8005548: af00 add r7, sp, #0
|
|
800554a: 6078 str r0, [r7, #4]
|
|
HAL_StatusTypeDef status;
|
|
__IO uint32_t count;
|
|
uint32_t mask;
|
|
|
|
status = HAL_OK;
|
|
800554c: 2300 movs r3, #0
|
|
800554e: 75fb strb r3, [r7, #23]
|
|
count = SUBGHZ_DEFAULT_TIMEOUT * SUBGHZ_RFBUSY_LOOP_TIME;
|
|
8005550: 4b12 ldr r3, [pc, #72] @ (800559c <SUBGHZ_WaitOnBusy+0x58>)
|
|
8005552: 681a ldr r2, [r3, #0]
|
|
8005554: 4613 mov r3, r2
|
|
8005556: 005b lsls r3, r3, #1
|
|
8005558: 4413 add r3, r2
|
|
800555a: 00db lsls r3, r3, #3
|
|
800555c: 0d1b lsrs r3, r3, #20
|
|
800555e: 2264 movs r2, #100 @ 0x64
|
|
8005560: fb02 f303 mul.w r3, r2, r3
|
|
8005564: 60fb str r3, [r7, #12]
|
|
|
|
/* Wait until Busy signal is set */
|
|
do
|
|
{
|
|
mask = LL_PWR_IsActiveFlag_RFBUSYMS();
|
|
8005566: f7ff fba1 bl 8004cac <LL_PWR_IsActiveFlag_RFBUSYMS>
|
|
800556a: 6138 str r0, [r7, #16]
|
|
|
|
if (count == 0U)
|
|
800556c: 68fb ldr r3, [r7, #12]
|
|
800556e: 2b00 cmp r3, #0
|
|
8005570: d105 bne.n 800557e <SUBGHZ_WaitOnBusy+0x3a>
|
|
{
|
|
status = HAL_ERROR;
|
|
8005572: 2301 movs r3, #1
|
|
8005574: 75fb strb r3, [r7, #23]
|
|
hsubghz->ErrorCode = HAL_SUBGHZ_ERROR_RF_BUSY;
|
|
8005576: 687b ldr r3, [r7, #4]
|
|
8005578: 2202 movs r2, #2
|
|
800557a: 609a str r2, [r3, #8]
|
|
break;
|
|
800557c: e009 b.n 8005592 <SUBGHZ_WaitOnBusy+0x4e>
|
|
}
|
|
count--;
|
|
800557e: 68fb ldr r3, [r7, #12]
|
|
8005580: 3b01 subs r3, #1
|
|
8005582: 60fb str r3, [r7, #12]
|
|
} while ((LL_PWR_IsActiveFlag_RFBUSYS()& mask) == 1UL);
|
|
8005584: f7ff fb80 bl 8004c88 <LL_PWR_IsActiveFlag_RFBUSYS>
|
|
8005588: 4602 mov r2, r0
|
|
800558a: 693b ldr r3, [r7, #16]
|
|
800558c: 4013 ands r3, r2
|
|
800558e: 2b01 cmp r3, #1
|
|
8005590: d0e9 beq.n 8005566 <SUBGHZ_WaitOnBusy+0x22>
|
|
|
|
return status;
|
|
8005592: 7dfb ldrb r3, [r7, #23]
|
|
}
|
|
8005594: 4618 mov r0, r3
|
|
8005596: 3718 adds r7, #24
|
|
8005598: 46bd mov sp, r7
|
|
800559a: bd80 pop {r7, pc}
|
|
800559c: 20000000 .word 0x20000000
|
|
|
|
080055a0 <LL_RCC_GetUSARTClockSource>:
|
|
{
|
|
80055a0: b480 push {r7}
|
|
80055a2: b083 sub sp, #12
|
|
80055a4: af00 add r7, sp, #0
|
|
80055a6: 6078 str r0, [r7, #4]
|
|
return (uint32_t)(READ_BIT(RCC->CCIPR, USARTx) | (USARTx << 16));
|
|
80055a8: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
80055ac: f8d3 2088 ldr.w r2, [r3, #136] @ 0x88
|
|
80055b0: 687b ldr r3, [r7, #4]
|
|
80055b2: 401a ands r2, r3
|
|
80055b4: 687b ldr r3, [r7, #4]
|
|
80055b6: 041b lsls r3, r3, #16
|
|
80055b8: 4313 orrs r3, r2
|
|
}
|
|
80055ba: 4618 mov r0, r3
|
|
80055bc: 370c adds r7, #12
|
|
80055be: 46bd mov sp, r7
|
|
80055c0: bc80 pop {r7}
|
|
80055c2: 4770 bx lr
|
|
|
|
080055c4 <LL_RCC_GetLPUARTClockSource>:
|
|
{
|
|
80055c4: b480 push {r7}
|
|
80055c6: b083 sub sp, #12
|
|
80055c8: af00 add r7, sp, #0
|
|
80055ca: 6078 str r0, [r7, #4]
|
|
return (uint32_t)(READ_BIT(RCC->CCIPR, LPUARTx));
|
|
80055cc: f04f 43b0 mov.w r3, #1476395008 @ 0x58000000
|
|
80055d0: f8d3 2088 ldr.w r2, [r3, #136] @ 0x88
|
|
80055d4: 687b ldr r3, [r7, #4]
|
|
80055d6: 4013 ands r3, r2
|
|
}
|
|
80055d8: 4618 mov r0, r3
|
|
80055da: 370c adds r7, #12
|
|
80055dc: 46bd mov sp, r7
|
|
80055de: bc80 pop {r7}
|
|
80055e0: 4770 bx lr
|
|
|
|
080055e2 <HAL_UART_Init>:
|
|
* parameters in the UART_InitTypeDef and initialize the associated handle.
|
|
* @param huart UART handle.
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_UART_Init(UART_HandleTypeDef *huart)
|
|
{
|
|
80055e2: b580 push {r7, lr}
|
|
80055e4: b082 sub sp, #8
|
|
80055e6: af00 add r7, sp, #0
|
|
80055e8: 6078 str r0, [r7, #4]
|
|
/* Check the UART handle allocation */
|
|
if (huart == NULL)
|
|
80055ea: 687b ldr r3, [r7, #4]
|
|
80055ec: 2b00 cmp r3, #0
|
|
80055ee: d101 bne.n 80055f4 <HAL_UART_Init+0x12>
|
|
{
|
|
return HAL_ERROR;
|
|
80055f0: 2301 movs r3, #1
|
|
80055f2: e042 b.n 800567a <HAL_UART_Init+0x98>
|
|
{
|
|
/* Check the parameters */
|
|
assert_param((IS_UART_INSTANCE(huart->Instance)) || (IS_LPUART_INSTANCE(huart->Instance)));
|
|
}
|
|
|
|
if (huart->gState == HAL_UART_STATE_RESET)
|
|
80055f4: 687b ldr r3, [r7, #4]
|
|
80055f6: f8d3 3088 ldr.w r3, [r3, #136] @ 0x88
|
|
80055fa: 2b00 cmp r3, #0
|
|
80055fc: d106 bne.n 800560c <HAL_UART_Init+0x2a>
|
|
{
|
|
/* Allocate lock resource and initialize it */
|
|
huart->Lock = HAL_UNLOCKED;
|
|
80055fe: 687b ldr r3, [r7, #4]
|
|
8005600: 2200 movs r2, #0
|
|
8005602: f883 2084 strb.w r2, [r3, #132] @ 0x84
|
|
|
|
/* Init the low level hardware */
|
|
huart->MspInitCallback(huart);
|
|
#else
|
|
/* Init the low level hardware : GPIO, CLOCK */
|
|
HAL_UART_MspInit(huart);
|
|
8005606: 6878 ldr r0, [r7, #4]
|
|
8005608: f7fb feb4 bl 8001374 <HAL_UART_MspInit>
|
|
#endif /* (USE_HAL_UART_REGISTER_CALLBACKS) */
|
|
}
|
|
|
|
huart->gState = HAL_UART_STATE_BUSY;
|
|
800560c: 687b ldr r3, [r7, #4]
|
|
800560e: 2224 movs r2, #36 @ 0x24
|
|
8005610: f8c3 2088 str.w r2, [r3, #136] @ 0x88
|
|
|
|
__HAL_UART_DISABLE(huart);
|
|
8005614: 687b ldr r3, [r7, #4]
|
|
8005616: 681b ldr r3, [r3, #0]
|
|
8005618: 681a ldr r2, [r3, #0]
|
|
800561a: 687b ldr r3, [r7, #4]
|
|
800561c: 681b ldr r3, [r3, #0]
|
|
800561e: f022 0201 bic.w r2, r2, #1
|
|
8005622: 601a str r2, [r3, #0]
|
|
|
|
/* Perform advanced settings configuration */
|
|
/* For some items, configuration requires to be done prior TE and RE bits are set */
|
|
if (huart->AdvancedInit.AdvFeatureInit != UART_ADVFEATURE_NO_INIT)
|
|
8005624: 687b ldr r3, [r7, #4]
|
|
8005626: 6a9b ldr r3, [r3, #40] @ 0x28
|
|
8005628: 2b00 cmp r3, #0
|
|
800562a: d002 beq.n 8005632 <HAL_UART_Init+0x50>
|
|
{
|
|
UART_AdvFeatureConfig(huart);
|
|
800562c: 6878 ldr r0, [r7, #4]
|
|
800562e: f001 f813 bl 8006658 <UART_AdvFeatureConfig>
|
|
}
|
|
|
|
/* Set the UART Communication parameters */
|
|
if (UART_SetConfig(huart) == HAL_ERROR)
|
|
8005632: 6878 ldr r0, [r7, #4]
|
|
8005634: f000 fd9c bl 8006170 <UART_SetConfig>
|
|
8005638: 4603 mov r3, r0
|
|
800563a: 2b01 cmp r3, #1
|
|
800563c: d101 bne.n 8005642 <HAL_UART_Init+0x60>
|
|
{
|
|
return HAL_ERROR;
|
|
800563e: 2301 movs r3, #1
|
|
8005640: e01b b.n 800567a <HAL_UART_Init+0x98>
|
|
}
|
|
|
|
/* In asynchronous mode, the following bits must be kept cleared:
|
|
- LINEN and CLKEN bits in the USART_CR2 register,
|
|
- SCEN, HDSEL and IREN bits in the USART_CR3 register.*/
|
|
CLEAR_BIT(huart->Instance->CR2, (USART_CR2_LINEN | USART_CR2_CLKEN));
|
|
8005642: 687b ldr r3, [r7, #4]
|
|
8005644: 681b ldr r3, [r3, #0]
|
|
8005646: 685a ldr r2, [r3, #4]
|
|
8005648: 687b ldr r3, [r7, #4]
|
|
800564a: 681b ldr r3, [r3, #0]
|
|
800564c: f422 4290 bic.w r2, r2, #18432 @ 0x4800
|
|
8005650: 605a str r2, [r3, #4]
|
|
CLEAR_BIT(huart->Instance->CR3, (USART_CR3_SCEN | USART_CR3_HDSEL | USART_CR3_IREN));
|
|
8005652: 687b ldr r3, [r7, #4]
|
|
8005654: 681b ldr r3, [r3, #0]
|
|
8005656: 689a ldr r2, [r3, #8]
|
|
8005658: 687b ldr r3, [r7, #4]
|
|
800565a: 681b ldr r3, [r3, #0]
|
|
800565c: f022 022a bic.w r2, r2, #42 @ 0x2a
|
|
8005660: 609a str r2, [r3, #8]
|
|
|
|
__HAL_UART_ENABLE(huart);
|
|
8005662: 687b ldr r3, [r7, #4]
|
|
8005664: 681b ldr r3, [r3, #0]
|
|
8005666: 681a ldr r2, [r3, #0]
|
|
8005668: 687b ldr r3, [r7, #4]
|
|
800566a: 681b ldr r3, [r3, #0]
|
|
800566c: f042 0201 orr.w r2, r2, #1
|
|
8005670: 601a str r2, [r3, #0]
|
|
|
|
/* TEACK and/or REACK to check before moving huart->gState and huart->RxState to Ready */
|
|
return (UART_CheckIdleState(huart));
|
|
8005672: 6878 ldr r0, [r7, #4]
|
|
8005674: f001 f891 bl 800679a <UART_CheckIdleState>
|
|
8005678: 4603 mov r3, r0
|
|
}
|
|
800567a: 4618 mov r0, r3
|
|
800567c: 3708 adds r7, #8
|
|
800567e: 46bd mov sp, r7
|
|
8005680: bd80 pop {r7, pc}
|
|
|
|
08005682 <HAL_UART_Transmit>:
|
|
* @param Size Amount of data elements (u8 or u16) to be sent.
|
|
* @param Timeout Timeout duration.
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_UART_Transmit(UART_HandleTypeDef *huart, const uint8_t *pData, uint16_t Size, uint32_t Timeout)
|
|
{
|
|
8005682: b580 push {r7, lr}
|
|
8005684: b08a sub sp, #40 @ 0x28
|
|
8005686: af02 add r7, sp, #8
|
|
8005688: 60f8 str r0, [r7, #12]
|
|
800568a: 60b9 str r1, [r7, #8]
|
|
800568c: 603b str r3, [r7, #0]
|
|
800568e: 4613 mov r3, r2
|
|
8005690: 80fb strh r3, [r7, #6]
|
|
const uint8_t *pdata8bits;
|
|
const uint16_t *pdata16bits;
|
|
uint32_t tickstart;
|
|
|
|
/* Check that a Tx process is not already ongoing */
|
|
if (huart->gState == HAL_UART_STATE_READY)
|
|
8005692: 68fb ldr r3, [r7, #12]
|
|
8005694: f8d3 3088 ldr.w r3, [r3, #136] @ 0x88
|
|
8005698: 2b20 cmp r3, #32
|
|
800569a: f040 8086 bne.w 80057aa <HAL_UART_Transmit+0x128>
|
|
{
|
|
if ((pData == NULL) || (Size == 0U))
|
|
800569e: 68bb ldr r3, [r7, #8]
|
|
80056a0: 2b00 cmp r3, #0
|
|
80056a2: d002 beq.n 80056aa <HAL_UART_Transmit+0x28>
|
|
80056a4: 88fb ldrh r3, [r7, #6]
|
|
80056a6: 2b00 cmp r3, #0
|
|
80056a8: d101 bne.n 80056ae <HAL_UART_Transmit+0x2c>
|
|
{
|
|
return HAL_ERROR;
|
|
80056aa: 2301 movs r3, #1
|
|
80056ac: e07e b.n 80057ac <HAL_UART_Transmit+0x12a>
|
|
return HAL_ERROR;
|
|
}
|
|
}
|
|
|
|
#endif /* CORE_CM0PLUS */
|
|
huart->ErrorCode = HAL_UART_ERROR_NONE;
|
|
80056ae: 68fb ldr r3, [r7, #12]
|
|
80056b0: 2200 movs r2, #0
|
|
80056b2: f8c3 2090 str.w r2, [r3, #144] @ 0x90
|
|
huart->gState = HAL_UART_STATE_BUSY_TX;
|
|
80056b6: 68fb ldr r3, [r7, #12]
|
|
80056b8: 2221 movs r2, #33 @ 0x21
|
|
80056ba: f8c3 2088 str.w r2, [r3, #136] @ 0x88
|
|
|
|
/* Init tickstart for timeout management */
|
|
tickstart = HAL_GetTick();
|
|
80056be: f7fb fac3 bl 8000c48 <HAL_GetTick>
|
|
80056c2: 6178 str r0, [r7, #20]
|
|
|
|
huart->TxXferSize = Size;
|
|
80056c4: 68fb ldr r3, [r7, #12]
|
|
80056c6: 88fa ldrh r2, [r7, #6]
|
|
80056c8: f8a3 2054 strh.w r2, [r3, #84] @ 0x54
|
|
huart->TxXferCount = Size;
|
|
80056cc: 68fb ldr r3, [r7, #12]
|
|
80056ce: 88fa ldrh r2, [r7, #6]
|
|
80056d0: f8a3 2056 strh.w r2, [r3, #86] @ 0x56
|
|
|
|
/* In case of 9bits/No Parity transfer, pData needs to be handled as a uint16_t pointer */
|
|
if ((huart->Init.WordLength == UART_WORDLENGTH_9B) && (huart->Init.Parity == UART_PARITY_NONE))
|
|
80056d4: 68fb ldr r3, [r7, #12]
|
|
80056d6: 689b ldr r3, [r3, #8]
|
|
80056d8: f5b3 5f80 cmp.w r3, #4096 @ 0x1000
|
|
80056dc: d108 bne.n 80056f0 <HAL_UART_Transmit+0x6e>
|
|
80056de: 68fb ldr r3, [r7, #12]
|
|
80056e0: 691b ldr r3, [r3, #16]
|
|
80056e2: 2b00 cmp r3, #0
|
|
80056e4: d104 bne.n 80056f0 <HAL_UART_Transmit+0x6e>
|
|
{
|
|
pdata8bits = NULL;
|
|
80056e6: 2300 movs r3, #0
|
|
80056e8: 61fb str r3, [r7, #28]
|
|
pdata16bits = (const uint16_t *) pData;
|
|
80056ea: 68bb ldr r3, [r7, #8]
|
|
80056ec: 61bb str r3, [r7, #24]
|
|
80056ee: e003 b.n 80056f8 <HAL_UART_Transmit+0x76>
|
|
}
|
|
else
|
|
{
|
|
pdata8bits = pData;
|
|
80056f0: 68bb ldr r3, [r7, #8]
|
|
80056f2: 61fb str r3, [r7, #28]
|
|
pdata16bits = NULL;
|
|
80056f4: 2300 movs r3, #0
|
|
80056f6: 61bb str r3, [r7, #24]
|
|
}
|
|
|
|
while (huart->TxXferCount > 0U)
|
|
80056f8: e03a b.n 8005770 <HAL_UART_Transmit+0xee>
|
|
{
|
|
if (UART_WaitOnFlagUntilTimeout(huart, UART_FLAG_TXE, RESET, tickstart, Timeout) != HAL_OK)
|
|
80056fa: 683b ldr r3, [r7, #0]
|
|
80056fc: 9300 str r3, [sp, #0]
|
|
80056fe: 697b ldr r3, [r7, #20]
|
|
8005700: 2200 movs r2, #0
|
|
8005702: 2180 movs r1, #128 @ 0x80
|
|
8005704: 68f8 ldr r0, [r7, #12]
|
|
8005706: f001 f8f2 bl 80068ee <UART_WaitOnFlagUntilTimeout>
|
|
800570a: 4603 mov r3, r0
|
|
800570c: 2b00 cmp r3, #0
|
|
800570e: d005 beq.n 800571c <HAL_UART_Transmit+0x9a>
|
|
{
|
|
|
|
huart->gState = HAL_UART_STATE_READY;
|
|
8005710: 68fb ldr r3, [r7, #12]
|
|
8005712: 2220 movs r2, #32
|
|
8005714: f8c3 2088 str.w r2, [r3, #136] @ 0x88
|
|
|
|
return HAL_TIMEOUT;
|
|
8005718: 2303 movs r3, #3
|
|
800571a: e047 b.n 80057ac <HAL_UART_Transmit+0x12a>
|
|
}
|
|
if (pdata8bits == NULL)
|
|
800571c: 69fb ldr r3, [r7, #28]
|
|
800571e: 2b00 cmp r3, #0
|
|
8005720: d10b bne.n 800573a <HAL_UART_Transmit+0xb8>
|
|
{
|
|
huart->Instance->TDR = (uint16_t)(*pdata16bits & 0x01FFU);
|
|
8005722: 69bb ldr r3, [r7, #24]
|
|
8005724: 881b ldrh r3, [r3, #0]
|
|
8005726: 461a mov r2, r3
|
|
8005728: 68fb ldr r3, [r7, #12]
|
|
800572a: 681b ldr r3, [r3, #0]
|
|
800572c: f3c2 0208 ubfx r2, r2, #0, #9
|
|
8005730: 629a str r2, [r3, #40] @ 0x28
|
|
pdata16bits++;
|
|
8005732: 69bb ldr r3, [r7, #24]
|
|
8005734: 3302 adds r3, #2
|
|
8005736: 61bb str r3, [r7, #24]
|
|
8005738: e007 b.n 800574a <HAL_UART_Transmit+0xc8>
|
|
}
|
|
else
|
|
{
|
|
huart->Instance->TDR = (uint8_t)(*pdata8bits & 0xFFU);
|
|
800573a: 69fb ldr r3, [r7, #28]
|
|
800573c: 781a ldrb r2, [r3, #0]
|
|
800573e: 68fb ldr r3, [r7, #12]
|
|
8005740: 681b ldr r3, [r3, #0]
|
|
8005742: 629a str r2, [r3, #40] @ 0x28
|
|
pdata8bits++;
|
|
8005744: 69fb ldr r3, [r7, #28]
|
|
8005746: 3301 adds r3, #1
|
|
8005748: 61fb str r3, [r7, #28]
|
|
}
|
|
if ((huart->gState & HAL_UART_STATE_BUSY_TX) == HAL_UART_STATE_BUSY_TX)
|
|
800574a: 68fb ldr r3, [r7, #12]
|
|
800574c: f8d3 3088 ldr.w r3, [r3, #136] @ 0x88
|
|
8005750: f003 0321 and.w r3, r3, #33 @ 0x21
|
|
8005754: 2b21 cmp r3, #33 @ 0x21
|
|
8005756: d109 bne.n 800576c <HAL_UART_Transmit+0xea>
|
|
{
|
|
huart->TxXferCount--;
|
|
8005758: 68fb ldr r3, [r7, #12]
|
|
800575a: f8b3 3056 ldrh.w r3, [r3, #86] @ 0x56
|
|
800575e: b29b uxth r3, r3
|
|
8005760: 3b01 subs r3, #1
|
|
8005762: b29a uxth r2, r3
|
|
8005764: 68fb ldr r3, [r7, #12]
|
|
8005766: f8a3 2056 strh.w r2, [r3, #86] @ 0x56
|
|
800576a: e001 b.n 8005770 <HAL_UART_Transmit+0xee>
|
|
}
|
|
else
|
|
{
|
|
/* Process was aborted during the transmission */
|
|
return HAL_ERROR;
|
|
800576c: 2301 movs r3, #1
|
|
800576e: e01d b.n 80057ac <HAL_UART_Transmit+0x12a>
|
|
while (huart->TxXferCount > 0U)
|
|
8005770: 68fb ldr r3, [r7, #12]
|
|
8005772: f8b3 3056 ldrh.w r3, [r3, #86] @ 0x56
|
|
8005776: b29b uxth r3, r3
|
|
8005778: 2b00 cmp r3, #0
|
|
800577a: d1be bne.n 80056fa <HAL_UART_Transmit+0x78>
|
|
}
|
|
}
|
|
|
|
if (UART_WaitOnFlagUntilTimeout(huart, UART_FLAG_TC, RESET, tickstart, Timeout) != HAL_OK)
|
|
800577c: 683b ldr r3, [r7, #0]
|
|
800577e: 9300 str r3, [sp, #0]
|
|
8005780: 697b ldr r3, [r7, #20]
|
|
8005782: 2200 movs r2, #0
|
|
8005784: 2140 movs r1, #64 @ 0x40
|
|
8005786: 68f8 ldr r0, [r7, #12]
|
|
8005788: f001 f8b1 bl 80068ee <UART_WaitOnFlagUntilTimeout>
|
|
800578c: 4603 mov r3, r0
|
|
800578e: 2b00 cmp r3, #0
|
|
8005790: d005 beq.n 800579e <HAL_UART_Transmit+0x11c>
|
|
{
|
|
huart->gState = HAL_UART_STATE_READY;
|
|
8005792: 68fb ldr r3, [r7, #12]
|
|
8005794: 2220 movs r2, #32
|
|
8005796: f8c3 2088 str.w r2, [r3, #136] @ 0x88
|
|
|
|
return HAL_TIMEOUT;
|
|
800579a: 2303 movs r3, #3
|
|
800579c: e006 b.n 80057ac <HAL_UART_Transmit+0x12a>
|
|
}
|
|
|
|
/* At end of Tx process, restore huart->gState to Ready */
|
|
huart->gState = HAL_UART_STATE_READY;
|
|
800579e: 68fb ldr r3, [r7, #12]
|
|
80057a0: 2220 movs r2, #32
|
|
80057a2: f8c3 2088 str.w r2, [r3, #136] @ 0x88
|
|
|
|
return HAL_OK;
|
|
80057a6: 2300 movs r3, #0
|
|
80057a8: e000 b.n 80057ac <HAL_UART_Transmit+0x12a>
|
|
}
|
|
else
|
|
{
|
|
return HAL_BUSY;
|
|
80057aa: 2302 movs r3, #2
|
|
}
|
|
}
|
|
80057ac: 4618 mov r0, r3
|
|
80057ae: 3720 adds r7, #32
|
|
80057b0: 46bd mov sp, r7
|
|
80057b2: bd80 pop {r7, pc}
|
|
|
|
080057b4 <HAL_UART_Receive_IT>:
|
|
* @param pData Pointer to data buffer (u8 or u16 data elements).
|
|
* @param Size Amount of data elements (u8 or u16) to be received.
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_UART_Receive_IT(UART_HandleTypeDef *huart, uint8_t *pData, uint16_t Size)
|
|
{
|
|
80057b4: b580 push {r7, lr}
|
|
80057b6: b08a sub sp, #40 @ 0x28
|
|
80057b8: af00 add r7, sp, #0
|
|
80057ba: 60f8 str r0, [r7, #12]
|
|
80057bc: 60b9 str r1, [r7, #8]
|
|
80057be: 4613 mov r3, r2
|
|
80057c0: 80fb strh r3, [r7, #6]
|
|
/* Check that a Rx process is not already ongoing */
|
|
if (huart->RxState == HAL_UART_STATE_READY)
|
|
80057c2: 68fb ldr r3, [r7, #12]
|
|
80057c4: f8d3 308c ldr.w r3, [r3, #140] @ 0x8c
|
|
80057c8: 2b20 cmp r3, #32
|
|
80057ca: d137 bne.n 800583c <HAL_UART_Receive_IT+0x88>
|
|
{
|
|
if ((pData == NULL) || (Size == 0U))
|
|
80057cc: 68bb ldr r3, [r7, #8]
|
|
80057ce: 2b00 cmp r3, #0
|
|
80057d0: d002 beq.n 80057d8 <HAL_UART_Receive_IT+0x24>
|
|
80057d2: 88fb ldrh r3, [r7, #6]
|
|
80057d4: 2b00 cmp r3, #0
|
|
80057d6: d101 bne.n 80057dc <HAL_UART_Receive_IT+0x28>
|
|
{
|
|
return HAL_ERROR;
|
|
80057d8: 2301 movs r3, #1
|
|
80057da: e030 b.n 800583e <HAL_UART_Receive_IT+0x8a>
|
|
}
|
|
}
|
|
|
|
#endif /* CORE_CM0PLUS */
|
|
/* Set Reception type to Standard reception */
|
|
huart->ReceptionType = HAL_UART_RECEPTION_STANDARD;
|
|
80057dc: 68fb ldr r3, [r7, #12]
|
|
80057de: 2200 movs r2, #0
|
|
80057e0: 66da str r2, [r3, #108] @ 0x6c
|
|
|
|
if (!(IS_LPUART_INSTANCE(huart->Instance)))
|
|
80057e2: 68fb ldr r3, [r7, #12]
|
|
80057e4: 681b ldr r3, [r3, #0]
|
|
80057e6: 4a18 ldr r2, [pc, #96] @ (8005848 <HAL_UART_Receive_IT+0x94>)
|
|
80057e8: 4293 cmp r3, r2
|
|
80057ea: d01f beq.n 800582c <HAL_UART_Receive_IT+0x78>
|
|
{
|
|
/* Check that USART RTOEN bit is set */
|
|
if (READ_BIT(huart->Instance->CR2, USART_CR2_RTOEN) != 0U)
|
|
80057ec: 68fb ldr r3, [r7, #12]
|
|
80057ee: 681b ldr r3, [r3, #0]
|
|
80057f0: 685b ldr r3, [r3, #4]
|
|
80057f2: f403 0300 and.w r3, r3, #8388608 @ 0x800000
|
|
80057f6: 2b00 cmp r3, #0
|
|
80057f8: d018 beq.n 800582c <HAL_UART_Receive_IT+0x78>
|
|
{
|
|
/* Enable the UART Receiver Timeout Interrupt */
|
|
ATOMIC_SET_BIT(huart->Instance->CR1, USART_CR1_RTOIE);
|
|
80057fa: 68fb ldr r3, [r7, #12]
|
|
80057fc: 681b ldr r3, [r3, #0]
|
|
80057fe: 617b str r3, [r7, #20]
|
|
*/
|
|
__STATIC_FORCEINLINE uint32_t __LDREXW(volatile uint32_t *addr)
|
|
{
|
|
uint32_t result;
|
|
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
8005800: 697b ldr r3, [r7, #20]
|
|
8005802: e853 3f00 ldrex r3, [r3]
|
|
8005806: 613b str r3, [r7, #16]
|
|
return(result);
|
|
8005808: 693b ldr r3, [r7, #16]
|
|
800580a: f043 6380 orr.w r3, r3, #67108864 @ 0x4000000
|
|
800580e: 627b str r3, [r7, #36] @ 0x24
|
|
8005810: 68fb ldr r3, [r7, #12]
|
|
8005812: 681b ldr r3, [r3, #0]
|
|
8005814: 461a mov r2, r3
|
|
8005816: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8005818: 623b str r3, [r7, #32]
|
|
800581a: 61fa str r2, [r7, #28]
|
|
*/
|
|
__STATIC_FORCEINLINE uint32_t __STREXW(uint32_t value, volatile uint32_t *addr)
|
|
{
|
|
uint32_t result;
|
|
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
800581c: 69f9 ldr r1, [r7, #28]
|
|
800581e: 6a3a ldr r2, [r7, #32]
|
|
8005820: e841 2300 strex r3, r2, [r1]
|
|
8005824: 61bb str r3, [r7, #24]
|
|
return(result);
|
|
8005826: 69bb ldr r3, [r7, #24]
|
|
8005828: 2b00 cmp r3, #0
|
|
800582a: d1e6 bne.n 80057fa <HAL_UART_Receive_IT+0x46>
|
|
}
|
|
}
|
|
|
|
return (UART_Start_Receive_IT(huart, pData, Size));
|
|
800582c: 88fb ldrh r3, [r7, #6]
|
|
800582e: 461a mov r2, r3
|
|
8005830: 68b9 ldr r1, [r7, #8]
|
|
8005832: 68f8 ldr r0, [r7, #12]
|
|
8005834: f001 f8c8 bl 80069c8 <UART_Start_Receive_IT>
|
|
8005838: 4603 mov r3, r0
|
|
800583a: e000 b.n 800583e <HAL_UART_Receive_IT+0x8a>
|
|
}
|
|
else
|
|
{
|
|
return HAL_BUSY;
|
|
800583c: 2302 movs r3, #2
|
|
}
|
|
}
|
|
800583e: 4618 mov r0, r3
|
|
8005840: 3728 adds r7, #40 @ 0x28
|
|
8005842: 46bd mov sp, r7
|
|
8005844: bd80 pop {r7, pc}
|
|
8005846: bf00 nop
|
|
8005848: 40008000 .word 0x40008000
|
|
|
|
0800584c <HAL_UART_Transmit_DMA>:
|
|
* @param pData Pointer to data buffer (u8 or u16 data elements).
|
|
* @param Size Amount of data elements (u8 or u16) to be sent.
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_UART_Transmit_DMA(UART_HandleTypeDef *huart, const uint8_t *pData, uint16_t Size)
|
|
{
|
|
800584c: b580 push {r7, lr}
|
|
800584e: b08a sub sp, #40 @ 0x28
|
|
8005850: af00 add r7, sp, #0
|
|
8005852: 60f8 str r0, [r7, #12]
|
|
8005854: 60b9 str r1, [r7, #8]
|
|
8005856: 4613 mov r3, r2
|
|
8005858: 80fb strh r3, [r7, #6]
|
|
/* Check that a Tx process is not already ongoing */
|
|
if (huart->gState == HAL_UART_STATE_READY)
|
|
800585a: 68fb ldr r3, [r7, #12]
|
|
800585c: f8d3 3088 ldr.w r3, [r3, #136] @ 0x88
|
|
8005860: 2b20 cmp r3, #32
|
|
8005862: d167 bne.n 8005934 <HAL_UART_Transmit_DMA+0xe8>
|
|
{
|
|
if ((pData == NULL) || (Size == 0U))
|
|
8005864: 68bb ldr r3, [r7, #8]
|
|
8005866: 2b00 cmp r3, #0
|
|
8005868: d002 beq.n 8005870 <HAL_UART_Transmit_DMA+0x24>
|
|
800586a: 88fb ldrh r3, [r7, #6]
|
|
800586c: 2b00 cmp r3, #0
|
|
800586e: d101 bne.n 8005874 <HAL_UART_Transmit_DMA+0x28>
|
|
{
|
|
return HAL_ERROR;
|
|
8005870: 2301 movs r3, #1
|
|
8005872: e060 b.n 8005936 <HAL_UART_Transmit_DMA+0xea>
|
|
return HAL_ERROR;
|
|
}
|
|
}
|
|
|
|
#endif /* CORE_CM0PLUS */
|
|
huart->pTxBuffPtr = pData;
|
|
8005874: 68fb ldr r3, [r7, #12]
|
|
8005876: 68ba ldr r2, [r7, #8]
|
|
8005878: 651a str r2, [r3, #80] @ 0x50
|
|
huart->TxXferSize = Size;
|
|
800587a: 68fb ldr r3, [r7, #12]
|
|
800587c: 88fa ldrh r2, [r7, #6]
|
|
800587e: f8a3 2054 strh.w r2, [r3, #84] @ 0x54
|
|
huart->TxXferCount = Size;
|
|
8005882: 68fb ldr r3, [r7, #12]
|
|
8005884: 88fa ldrh r2, [r7, #6]
|
|
8005886: f8a3 2056 strh.w r2, [r3, #86] @ 0x56
|
|
|
|
huart->ErrorCode = HAL_UART_ERROR_NONE;
|
|
800588a: 68fb ldr r3, [r7, #12]
|
|
800588c: 2200 movs r2, #0
|
|
800588e: f8c3 2090 str.w r2, [r3, #144] @ 0x90
|
|
huart->gState = HAL_UART_STATE_BUSY_TX;
|
|
8005892: 68fb ldr r3, [r7, #12]
|
|
8005894: 2221 movs r2, #33 @ 0x21
|
|
8005896: f8c3 2088 str.w r2, [r3, #136] @ 0x88
|
|
|
|
if (huart->hdmatx != NULL)
|
|
800589a: 68fb ldr r3, [r7, #12]
|
|
800589c: 6fdb ldr r3, [r3, #124] @ 0x7c
|
|
800589e: 2b00 cmp r3, #0
|
|
80058a0: d028 beq.n 80058f4 <HAL_UART_Transmit_DMA+0xa8>
|
|
{
|
|
/* Set the UART DMA transfer complete callback */
|
|
huart->hdmatx->XferCpltCallback = UART_DMATransmitCplt;
|
|
80058a2: 68fb ldr r3, [r7, #12]
|
|
80058a4: 6fdb ldr r3, [r3, #124] @ 0x7c
|
|
80058a6: 4a26 ldr r2, [pc, #152] @ (8005940 <HAL_UART_Transmit_DMA+0xf4>)
|
|
80058a8: 62da str r2, [r3, #44] @ 0x2c
|
|
|
|
/* Set the UART DMA Half transfer complete callback */
|
|
huart->hdmatx->XferHalfCpltCallback = UART_DMATxHalfCplt;
|
|
80058aa: 68fb ldr r3, [r7, #12]
|
|
80058ac: 6fdb ldr r3, [r3, #124] @ 0x7c
|
|
80058ae: 4a25 ldr r2, [pc, #148] @ (8005944 <HAL_UART_Transmit_DMA+0xf8>)
|
|
80058b0: 631a str r2, [r3, #48] @ 0x30
|
|
|
|
/* Set the DMA error callback */
|
|
huart->hdmatx->XferErrorCallback = UART_DMAError;
|
|
80058b2: 68fb ldr r3, [r7, #12]
|
|
80058b4: 6fdb ldr r3, [r3, #124] @ 0x7c
|
|
80058b6: 4a24 ldr r2, [pc, #144] @ (8005948 <HAL_UART_Transmit_DMA+0xfc>)
|
|
80058b8: 635a str r2, [r3, #52] @ 0x34
|
|
|
|
/* Set the DMA abort callback */
|
|
huart->hdmatx->XferAbortCallback = NULL;
|
|
80058ba: 68fb ldr r3, [r7, #12]
|
|
80058bc: 6fdb ldr r3, [r3, #124] @ 0x7c
|
|
80058be: 2200 movs r2, #0
|
|
80058c0: 639a str r2, [r3, #56] @ 0x38
|
|
|
|
/* Enable the UART transmit DMA channel */
|
|
if (HAL_DMA_Start_IT(huart->hdmatx, (uint32_t)huart->pTxBuffPtr, (uint32_t)&huart->Instance->TDR, Size) != HAL_OK)
|
|
80058c2: 68fb ldr r3, [r7, #12]
|
|
80058c4: 6fd8 ldr r0, [r3, #124] @ 0x7c
|
|
80058c6: 68fb ldr r3, [r7, #12]
|
|
80058c8: 6d1b ldr r3, [r3, #80] @ 0x50
|
|
80058ca: 4619 mov r1, r3
|
|
80058cc: 68fb ldr r3, [r7, #12]
|
|
80058ce: 681b ldr r3, [r3, #0]
|
|
80058d0: 3328 adds r3, #40 @ 0x28
|
|
80058d2: 461a mov r2, r3
|
|
80058d4: 88fb ldrh r3, [r7, #6]
|
|
80058d6: f7fc fac7 bl 8001e68 <HAL_DMA_Start_IT>
|
|
80058da: 4603 mov r3, r0
|
|
80058dc: 2b00 cmp r3, #0
|
|
80058de: d009 beq.n 80058f4 <HAL_UART_Transmit_DMA+0xa8>
|
|
{
|
|
/* Set error code to DMA */
|
|
huart->ErrorCode = HAL_UART_ERROR_DMA;
|
|
80058e0: 68fb ldr r3, [r7, #12]
|
|
80058e2: 2210 movs r2, #16
|
|
80058e4: f8c3 2090 str.w r2, [r3, #144] @ 0x90
|
|
|
|
/* Restore huart->gState to ready */
|
|
huart->gState = HAL_UART_STATE_READY;
|
|
80058e8: 68fb ldr r3, [r7, #12]
|
|
80058ea: 2220 movs r2, #32
|
|
80058ec: f8c3 2088 str.w r2, [r3, #136] @ 0x88
|
|
|
|
return HAL_ERROR;
|
|
80058f0: 2301 movs r3, #1
|
|
80058f2: e020 b.n 8005936 <HAL_UART_Transmit_DMA+0xea>
|
|
}
|
|
}
|
|
/* Clear the TC flag in the ICR register */
|
|
__HAL_UART_CLEAR_FLAG(huart, UART_CLEAR_TCF);
|
|
80058f4: 68fb ldr r3, [r7, #12]
|
|
80058f6: 681b ldr r3, [r3, #0]
|
|
80058f8: 2240 movs r2, #64 @ 0x40
|
|
80058fa: 621a str r2, [r3, #32]
|
|
|
|
/* Enable the DMA transfer for transmit request by setting the DMAT bit
|
|
in the UART CR3 register */
|
|
ATOMIC_SET_BIT(huart->Instance->CR3, USART_CR3_DMAT);
|
|
80058fc: 68fb ldr r3, [r7, #12]
|
|
80058fe: 681b ldr r3, [r3, #0]
|
|
8005900: 3308 adds r3, #8
|
|
8005902: 617b str r3, [r7, #20]
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
8005904: 697b ldr r3, [r7, #20]
|
|
8005906: e853 3f00 ldrex r3, [r3]
|
|
800590a: 613b str r3, [r7, #16]
|
|
return(result);
|
|
800590c: 693b ldr r3, [r7, #16]
|
|
800590e: f043 0380 orr.w r3, r3, #128 @ 0x80
|
|
8005912: 627b str r3, [r7, #36] @ 0x24
|
|
8005914: 68fb ldr r3, [r7, #12]
|
|
8005916: 681b ldr r3, [r3, #0]
|
|
8005918: 3308 adds r3, #8
|
|
800591a: 6a7a ldr r2, [r7, #36] @ 0x24
|
|
800591c: 623a str r2, [r7, #32]
|
|
800591e: 61fb str r3, [r7, #28]
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
8005920: 69f9 ldr r1, [r7, #28]
|
|
8005922: 6a3a ldr r2, [r7, #32]
|
|
8005924: e841 2300 strex r3, r2, [r1]
|
|
8005928: 61bb str r3, [r7, #24]
|
|
return(result);
|
|
800592a: 69bb ldr r3, [r7, #24]
|
|
800592c: 2b00 cmp r3, #0
|
|
800592e: d1e5 bne.n 80058fc <HAL_UART_Transmit_DMA+0xb0>
|
|
|
|
return HAL_OK;
|
|
8005930: 2300 movs r3, #0
|
|
8005932: e000 b.n 8005936 <HAL_UART_Transmit_DMA+0xea>
|
|
}
|
|
else
|
|
{
|
|
return HAL_BUSY;
|
|
8005934: 2302 movs r3, #2
|
|
}
|
|
}
|
|
8005936: 4618 mov r0, r3
|
|
8005938: 3728 adds r7, #40 @ 0x28
|
|
800593a: 46bd mov sp, r7
|
|
800593c: bd80 pop {r7, pc}
|
|
800593e: bf00 nop
|
|
8005940: 08006d53 .word 0x08006d53
|
|
8005944: 08006de5 .word 0x08006de5
|
|
8005948: 08006e01 .word 0x08006e01
|
|
|
|
0800594c <HAL_UART_AbortReceive>:
|
|
* - Set handle State to READY
|
|
* @note This procedure is executed in blocking mode : when exiting function, Abort is considered as completed.
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_UART_AbortReceive(UART_HandleTypeDef *huart)
|
|
{
|
|
800594c: b580 push {r7, lr}
|
|
800594e: b09a sub sp, #104 @ 0x68
|
|
8005950: af00 add r7, sp, #0
|
|
8005952: 6078 str r0, [r7, #4]
|
|
/* Disable PEIE, EIE, RXNEIE and RXFTIE interrupts */
|
|
ATOMIC_CLEAR_BIT(huart->Instance->CR1, (USART_CR1_PEIE | USART_CR1_RXNEIE_RXFNEIE));
|
|
8005954: 687b ldr r3, [r7, #4]
|
|
8005956: 681b ldr r3, [r3, #0]
|
|
8005958: 64bb str r3, [r7, #72] @ 0x48
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
800595a: 6cbb ldr r3, [r7, #72] @ 0x48
|
|
800595c: e853 3f00 ldrex r3, [r3]
|
|
8005960: 647b str r3, [r7, #68] @ 0x44
|
|
return(result);
|
|
8005962: 6c7b ldr r3, [r7, #68] @ 0x44
|
|
8005964: f423 7390 bic.w r3, r3, #288 @ 0x120
|
|
8005968: 667b str r3, [r7, #100] @ 0x64
|
|
800596a: 687b ldr r3, [r7, #4]
|
|
800596c: 681b ldr r3, [r3, #0]
|
|
800596e: 461a mov r2, r3
|
|
8005970: 6e7b ldr r3, [r7, #100] @ 0x64
|
|
8005972: 657b str r3, [r7, #84] @ 0x54
|
|
8005974: 653a str r2, [r7, #80] @ 0x50
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
8005976: 6d39 ldr r1, [r7, #80] @ 0x50
|
|
8005978: 6d7a ldr r2, [r7, #84] @ 0x54
|
|
800597a: e841 2300 strex r3, r2, [r1]
|
|
800597e: 64fb str r3, [r7, #76] @ 0x4c
|
|
return(result);
|
|
8005980: 6cfb ldr r3, [r7, #76] @ 0x4c
|
|
8005982: 2b00 cmp r3, #0
|
|
8005984: d1e6 bne.n 8005954 <HAL_UART_AbortReceive+0x8>
|
|
ATOMIC_CLEAR_BIT(huart->Instance->CR3, USART_CR3_EIE | USART_CR3_RXFTIE);
|
|
8005986: 687b ldr r3, [r7, #4]
|
|
8005988: 681b ldr r3, [r3, #0]
|
|
800598a: 3308 adds r3, #8
|
|
800598c: 637b str r3, [r7, #52] @ 0x34
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
800598e: 6b7b ldr r3, [r7, #52] @ 0x34
|
|
8005990: e853 3f00 ldrex r3, [r3]
|
|
8005994: 633b str r3, [r7, #48] @ 0x30
|
|
return(result);
|
|
8005996: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
8005998: f023 5380 bic.w r3, r3, #268435456 @ 0x10000000
|
|
800599c: f023 0301 bic.w r3, r3, #1
|
|
80059a0: 663b str r3, [r7, #96] @ 0x60
|
|
80059a2: 687b ldr r3, [r7, #4]
|
|
80059a4: 681b ldr r3, [r3, #0]
|
|
80059a6: 3308 adds r3, #8
|
|
80059a8: 6e3a ldr r2, [r7, #96] @ 0x60
|
|
80059aa: 643a str r2, [r7, #64] @ 0x40
|
|
80059ac: 63fb str r3, [r7, #60] @ 0x3c
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
80059ae: 6bf9 ldr r1, [r7, #60] @ 0x3c
|
|
80059b0: 6c3a ldr r2, [r7, #64] @ 0x40
|
|
80059b2: e841 2300 strex r3, r2, [r1]
|
|
80059b6: 63bb str r3, [r7, #56] @ 0x38
|
|
return(result);
|
|
80059b8: 6bbb ldr r3, [r7, #56] @ 0x38
|
|
80059ba: 2b00 cmp r3, #0
|
|
80059bc: d1e3 bne.n 8005986 <HAL_UART_AbortReceive+0x3a>
|
|
|
|
/* If Reception till IDLE event was ongoing, disable IDLEIE interrupt */
|
|
if (huart->ReceptionType == HAL_UART_RECEPTION_TOIDLE)
|
|
80059be: 687b ldr r3, [r7, #4]
|
|
80059c0: 6edb ldr r3, [r3, #108] @ 0x6c
|
|
80059c2: 2b01 cmp r3, #1
|
|
80059c4: d118 bne.n 80059f8 <HAL_UART_AbortReceive+0xac>
|
|
{
|
|
ATOMIC_CLEAR_BIT(huart->Instance->CR1, (USART_CR1_IDLEIE));
|
|
80059c6: 687b ldr r3, [r7, #4]
|
|
80059c8: 681b ldr r3, [r3, #0]
|
|
80059ca: 623b str r3, [r7, #32]
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
80059cc: 6a3b ldr r3, [r7, #32]
|
|
80059ce: e853 3f00 ldrex r3, [r3]
|
|
80059d2: 61fb str r3, [r7, #28]
|
|
return(result);
|
|
80059d4: 69fb ldr r3, [r7, #28]
|
|
80059d6: f023 0310 bic.w r3, r3, #16
|
|
80059da: 65fb str r3, [r7, #92] @ 0x5c
|
|
80059dc: 687b ldr r3, [r7, #4]
|
|
80059de: 681b ldr r3, [r3, #0]
|
|
80059e0: 461a mov r2, r3
|
|
80059e2: 6dfb ldr r3, [r7, #92] @ 0x5c
|
|
80059e4: 62fb str r3, [r7, #44] @ 0x2c
|
|
80059e6: 62ba str r2, [r7, #40] @ 0x28
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
80059e8: 6ab9 ldr r1, [r7, #40] @ 0x28
|
|
80059ea: 6afa ldr r2, [r7, #44] @ 0x2c
|
|
80059ec: e841 2300 strex r3, r2, [r1]
|
|
80059f0: 627b str r3, [r7, #36] @ 0x24
|
|
return(result);
|
|
80059f2: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
80059f4: 2b00 cmp r3, #0
|
|
80059f6: d1e6 bne.n 80059c6 <HAL_UART_AbortReceive+0x7a>
|
|
}
|
|
|
|
/* Abort the UART DMA Rx channel if enabled */
|
|
if (HAL_IS_BIT_SET(huart->Instance->CR3, USART_CR3_DMAR))
|
|
80059f8: 687b ldr r3, [r7, #4]
|
|
80059fa: 681b ldr r3, [r3, #0]
|
|
80059fc: 689b ldr r3, [r3, #8]
|
|
80059fe: f003 0340 and.w r3, r3, #64 @ 0x40
|
|
8005a02: 2b40 cmp r3, #64 @ 0x40
|
|
8005a04: d13b bne.n 8005a7e <HAL_UART_AbortReceive+0x132>
|
|
{
|
|
/* Disable the UART DMA Rx request if enabled */
|
|
ATOMIC_CLEAR_BIT(huart->Instance->CR3, USART_CR3_DMAR);
|
|
8005a06: 687b ldr r3, [r7, #4]
|
|
8005a08: 681b ldr r3, [r3, #0]
|
|
8005a0a: 3308 adds r3, #8
|
|
8005a0c: 60fb str r3, [r7, #12]
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
8005a0e: 68fb ldr r3, [r7, #12]
|
|
8005a10: e853 3f00 ldrex r3, [r3]
|
|
8005a14: 60bb str r3, [r7, #8]
|
|
return(result);
|
|
8005a16: 68bb ldr r3, [r7, #8]
|
|
8005a18: f023 0340 bic.w r3, r3, #64 @ 0x40
|
|
8005a1c: 65bb str r3, [r7, #88] @ 0x58
|
|
8005a1e: 687b ldr r3, [r7, #4]
|
|
8005a20: 681b ldr r3, [r3, #0]
|
|
8005a22: 3308 adds r3, #8
|
|
8005a24: 6dba ldr r2, [r7, #88] @ 0x58
|
|
8005a26: 61ba str r2, [r7, #24]
|
|
8005a28: 617b str r3, [r7, #20]
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
8005a2a: 6979 ldr r1, [r7, #20]
|
|
8005a2c: 69ba ldr r2, [r7, #24]
|
|
8005a2e: e841 2300 strex r3, r2, [r1]
|
|
8005a32: 613b str r3, [r7, #16]
|
|
return(result);
|
|
8005a34: 693b ldr r3, [r7, #16]
|
|
8005a36: 2b00 cmp r3, #0
|
|
8005a38: d1e5 bne.n 8005a06 <HAL_UART_AbortReceive+0xba>
|
|
|
|
/* Abort the UART DMA Rx channel : use blocking DMA Abort API (no callback) */
|
|
if (huart->hdmarx != NULL)
|
|
8005a3a: 687b ldr r3, [r7, #4]
|
|
8005a3c: f8d3 3080 ldr.w r3, [r3, #128] @ 0x80
|
|
8005a40: 2b00 cmp r3, #0
|
|
8005a42: d01c beq.n 8005a7e <HAL_UART_AbortReceive+0x132>
|
|
{
|
|
/* Set the UART DMA Abort callback to Null.
|
|
No call back execution at end of DMA abort procedure */
|
|
huart->hdmarx->XferAbortCallback = NULL;
|
|
8005a44: 687b ldr r3, [r7, #4]
|
|
8005a46: f8d3 3080 ldr.w r3, [r3, #128] @ 0x80
|
|
8005a4a: 2200 movs r2, #0
|
|
8005a4c: 639a str r2, [r3, #56] @ 0x38
|
|
|
|
if (HAL_DMA_Abort(huart->hdmarx) != HAL_OK)
|
|
8005a4e: 687b ldr r3, [r7, #4]
|
|
8005a50: f8d3 3080 ldr.w r3, [r3, #128] @ 0x80
|
|
8005a54: 4618 mov r0, r3
|
|
8005a56: f7fc fa85 bl 8001f64 <HAL_DMA_Abort>
|
|
8005a5a: 4603 mov r3, r0
|
|
8005a5c: 2b00 cmp r3, #0
|
|
8005a5e: d00e beq.n 8005a7e <HAL_UART_AbortReceive+0x132>
|
|
{
|
|
if (HAL_DMA_GetError(huart->hdmarx) == HAL_DMA_ERROR_TIMEOUT)
|
|
8005a60: 687b ldr r3, [r7, #4]
|
|
8005a62: f8d3 3080 ldr.w r3, [r3, #128] @ 0x80
|
|
8005a66: 4618 mov r0, r3
|
|
8005a68: f7fc fc00 bl 800226c <HAL_DMA_GetError>
|
|
8005a6c: 4603 mov r3, r0
|
|
8005a6e: 2b20 cmp r3, #32
|
|
8005a70: d105 bne.n 8005a7e <HAL_UART_AbortReceive+0x132>
|
|
{
|
|
/* Set error code to DMA */
|
|
huart->ErrorCode = HAL_UART_ERROR_DMA;
|
|
8005a72: 687b ldr r3, [r7, #4]
|
|
8005a74: 2210 movs r2, #16
|
|
8005a76: f8c3 2090 str.w r2, [r3, #144] @ 0x90
|
|
|
|
return HAL_TIMEOUT;
|
|
8005a7a: 2303 movs r3, #3
|
|
8005a7c: e013 b.n 8005aa6 <HAL_UART_AbortReceive+0x15a>
|
|
}
|
|
}
|
|
}
|
|
|
|
/* Clear the Error flags in the ICR register */
|
|
__HAL_UART_CLEAR_FLAG(huart, UART_CLEAR_OREF | UART_CLEAR_NEF | UART_CLEAR_PEF | UART_CLEAR_FEF);
|
|
8005a7e: 687b ldr r3, [r7, #4]
|
|
8005a80: 681b ldr r3, [r3, #0]
|
|
8005a82: 220f movs r2, #15
|
|
8005a84: 621a str r2, [r3, #32]
|
|
|
|
/* Discard the received data */
|
|
__HAL_UART_SEND_REQ(huart, UART_RXDATA_FLUSH_REQUEST);
|
|
8005a86: 687b ldr r3, [r7, #4]
|
|
8005a88: 681b ldr r3, [r3, #0]
|
|
8005a8a: 699a ldr r2, [r3, #24]
|
|
8005a8c: 687b ldr r3, [r7, #4]
|
|
8005a8e: 681b ldr r3, [r3, #0]
|
|
8005a90: f042 0208 orr.w r2, r2, #8
|
|
8005a94: 619a str r2, [r3, #24]
|
|
|
|
/* Restore huart->RxState to Ready */
|
|
huart->RxState = HAL_UART_STATE_READY;
|
|
8005a96: 687b ldr r3, [r7, #4]
|
|
8005a98: 2220 movs r2, #32
|
|
8005a9a: f8c3 208c str.w r2, [r3, #140] @ 0x8c
|
|
huart->ReceptionType = HAL_UART_RECEPTION_STANDARD;
|
|
8005a9e: 687b ldr r3, [r7, #4]
|
|
8005aa0: 2200 movs r2, #0
|
|
8005aa2: 66da str r2, [r3, #108] @ 0x6c
|
|
|
|
return HAL_OK;
|
|
8005aa4: 2300 movs r3, #0
|
|
}
|
|
8005aa6: 4618 mov r0, r3
|
|
8005aa8: 3768 adds r7, #104 @ 0x68
|
|
8005aaa: 46bd mov sp, r7
|
|
8005aac: bd80 pop {r7, pc}
|
|
...
|
|
|
|
08005ab0 <HAL_UART_IRQHandler>:
|
|
* @brief Handle UART interrupt request.
|
|
* @param huart UART handle.
|
|
* @retval None
|
|
*/
|
|
void HAL_UART_IRQHandler(UART_HandleTypeDef *huart)
|
|
{
|
|
8005ab0: b580 push {r7, lr}
|
|
8005ab2: b0ba sub sp, #232 @ 0xe8
|
|
8005ab4: af00 add r7, sp, #0
|
|
8005ab6: 6078 str r0, [r7, #4]
|
|
uint32_t isrflags = READ_REG(huart->Instance->ISR);
|
|
8005ab8: 687b ldr r3, [r7, #4]
|
|
8005aba: 681b ldr r3, [r3, #0]
|
|
8005abc: 69db ldr r3, [r3, #28]
|
|
8005abe: f8c7 30e4 str.w r3, [r7, #228] @ 0xe4
|
|
uint32_t cr1its = READ_REG(huart->Instance->CR1);
|
|
8005ac2: 687b ldr r3, [r7, #4]
|
|
8005ac4: 681b ldr r3, [r3, #0]
|
|
8005ac6: 681b ldr r3, [r3, #0]
|
|
8005ac8: f8c7 30e0 str.w r3, [r7, #224] @ 0xe0
|
|
uint32_t cr3its = READ_REG(huart->Instance->CR3);
|
|
8005acc: 687b ldr r3, [r7, #4]
|
|
8005ace: 681b ldr r3, [r3, #0]
|
|
8005ad0: 689b ldr r3, [r3, #8]
|
|
8005ad2: f8c7 30dc str.w r3, [r7, #220] @ 0xdc
|
|
|
|
uint32_t errorflags;
|
|
uint32_t errorcode;
|
|
|
|
/* If no error occurs */
|
|
errorflags = (isrflags & (uint32_t)(USART_ISR_PE | USART_ISR_FE | USART_ISR_ORE | USART_ISR_NE | USART_ISR_RTOF));
|
|
8005ad6: f8d7 20e4 ldr.w r2, [r7, #228] @ 0xe4
|
|
8005ada: f640 030f movw r3, #2063 @ 0x80f
|
|
8005ade: 4013 ands r3, r2
|
|
8005ae0: f8c7 30d8 str.w r3, [r7, #216] @ 0xd8
|
|
if (errorflags == 0U)
|
|
8005ae4: f8d7 30d8 ldr.w r3, [r7, #216] @ 0xd8
|
|
8005ae8: 2b00 cmp r3, #0
|
|
8005aea: d11b bne.n 8005b24 <HAL_UART_IRQHandler+0x74>
|
|
{
|
|
/* UART in mode Receiver ---------------------------------------------------*/
|
|
if (((isrflags & USART_ISR_RXNE_RXFNE) != 0U)
|
|
8005aec: f8d7 30e4 ldr.w r3, [r7, #228] @ 0xe4
|
|
8005af0: f003 0320 and.w r3, r3, #32
|
|
8005af4: 2b00 cmp r3, #0
|
|
8005af6: d015 beq.n 8005b24 <HAL_UART_IRQHandler+0x74>
|
|
&& (((cr1its & USART_CR1_RXNEIE_RXFNEIE) != 0U)
|
|
8005af8: f8d7 30e0 ldr.w r3, [r7, #224] @ 0xe0
|
|
8005afc: f003 0320 and.w r3, r3, #32
|
|
8005b00: 2b00 cmp r3, #0
|
|
8005b02: d105 bne.n 8005b10 <HAL_UART_IRQHandler+0x60>
|
|
|| ((cr3its & USART_CR3_RXFTIE) != 0U)))
|
|
8005b04: f8d7 30dc ldr.w r3, [r7, #220] @ 0xdc
|
|
8005b08: f003 5380 and.w r3, r3, #268435456 @ 0x10000000
|
|
8005b0c: 2b00 cmp r3, #0
|
|
8005b0e: d009 beq.n 8005b24 <HAL_UART_IRQHandler+0x74>
|
|
{
|
|
if (huart->RxISR != NULL)
|
|
8005b10: 687b ldr r3, [r7, #4]
|
|
8005b12: 6f5b ldr r3, [r3, #116] @ 0x74
|
|
8005b14: 2b00 cmp r3, #0
|
|
8005b16: f000 8300 beq.w 800611a <HAL_UART_IRQHandler+0x66a>
|
|
{
|
|
huart->RxISR(huart);
|
|
8005b1a: 687b ldr r3, [r7, #4]
|
|
8005b1c: 6f5b ldr r3, [r3, #116] @ 0x74
|
|
8005b1e: 6878 ldr r0, [r7, #4]
|
|
8005b20: 4798 blx r3
|
|
}
|
|
return;
|
|
8005b22: e2fa b.n 800611a <HAL_UART_IRQHandler+0x66a>
|
|
}
|
|
}
|
|
|
|
/* If some errors occur */
|
|
if ((errorflags != 0U)
|
|
8005b24: f8d7 30d8 ldr.w r3, [r7, #216] @ 0xd8
|
|
8005b28: 2b00 cmp r3, #0
|
|
8005b2a: f000 8123 beq.w 8005d74 <HAL_UART_IRQHandler+0x2c4>
|
|
&& ((((cr3its & (USART_CR3_RXFTIE | USART_CR3_EIE)) != 0U)
|
|
8005b2e: f8d7 20dc ldr.w r2, [r7, #220] @ 0xdc
|
|
8005b32: 4b8d ldr r3, [pc, #564] @ (8005d68 <HAL_UART_IRQHandler+0x2b8>)
|
|
8005b34: 4013 ands r3, r2
|
|
8005b36: 2b00 cmp r3, #0
|
|
8005b38: d106 bne.n 8005b48 <HAL_UART_IRQHandler+0x98>
|
|
|| ((cr1its & (USART_CR1_RXNEIE_RXFNEIE | USART_CR1_PEIE | USART_CR1_RTOIE)) != 0U))))
|
|
8005b3a: f8d7 20e0 ldr.w r2, [r7, #224] @ 0xe0
|
|
8005b3e: 4b8b ldr r3, [pc, #556] @ (8005d6c <HAL_UART_IRQHandler+0x2bc>)
|
|
8005b40: 4013 ands r3, r2
|
|
8005b42: 2b00 cmp r3, #0
|
|
8005b44: f000 8116 beq.w 8005d74 <HAL_UART_IRQHandler+0x2c4>
|
|
{
|
|
/* UART parity error interrupt occurred -------------------------------------*/
|
|
if (((isrflags & USART_ISR_PE) != 0U) && ((cr1its & USART_CR1_PEIE) != 0U))
|
|
8005b48: f8d7 30e4 ldr.w r3, [r7, #228] @ 0xe4
|
|
8005b4c: f003 0301 and.w r3, r3, #1
|
|
8005b50: 2b00 cmp r3, #0
|
|
8005b52: d011 beq.n 8005b78 <HAL_UART_IRQHandler+0xc8>
|
|
8005b54: f8d7 30e0 ldr.w r3, [r7, #224] @ 0xe0
|
|
8005b58: f403 7380 and.w r3, r3, #256 @ 0x100
|
|
8005b5c: 2b00 cmp r3, #0
|
|
8005b5e: d00b beq.n 8005b78 <HAL_UART_IRQHandler+0xc8>
|
|
{
|
|
__HAL_UART_CLEAR_FLAG(huart, UART_CLEAR_PEF);
|
|
8005b60: 687b ldr r3, [r7, #4]
|
|
8005b62: 681b ldr r3, [r3, #0]
|
|
8005b64: 2201 movs r2, #1
|
|
8005b66: 621a str r2, [r3, #32]
|
|
|
|
huart->ErrorCode |= HAL_UART_ERROR_PE;
|
|
8005b68: 687b ldr r3, [r7, #4]
|
|
8005b6a: f8d3 3090 ldr.w r3, [r3, #144] @ 0x90
|
|
8005b6e: f043 0201 orr.w r2, r3, #1
|
|
8005b72: 687b ldr r3, [r7, #4]
|
|
8005b74: f8c3 2090 str.w r2, [r3, #144] @ 0x90
|
|
}
|
|
|
|
/* UART frame error interrupt occurred --------------------------------------*/
|
|
if (((isrflags & USART_ISR_FE) != 0U) && ((cr3its & USART_CR3_EIE) != 0U))
|
|
8005b78: f8d7 30e4 ldr.w r3, [r7, #228] @ 0xe4
|
|
8005b7c: f003 0302 and.w r3, r3, #2
|
|
8005b80: 2b00 cmp r3, #0
|
|
8005b82: d011 beq.n 8005ba8 <HAL_UART_IRQHandler+0xf8>
|
|
8005b84: f8d7 30dc ldr.w r3, [r7, #220] @ 0xdc
|
|
8005b88: f003 0301 and.w r3, r3, #1
|
|
8005b8c: 2b00 cmp r3, #0
|
|
8005b8e: d00b beq.n 8005ba8 <HAL_UART_IRQHandler+0xf8>
|
|
{
|
|
__HAL_UART_CLEAR_FLAG(huart, UART_CLEAR_FEF);
|
|
8005b90: 687b ldr r3, [r7, #4]
|
|
8005b92: 681b ldr r3, [r3, #0]
|
|
8005b94: 2202 movs r2, #2
|
|
8005b96: 621a str r2, [r3, #32]
|
|
|
|
huart->ErrorCode |= HAL_UART_ERROR_FE;
|
|
8005b98: 687b ldr r3, [r7, #4]
|
|
8005b9a: f8d3 3090 ldr.w r3, [r3, #144] @ 0x90
|
|
8005b9e: f043 0204 orr.w r2, r3, #4
|
|
8005ba2: 687b ldr r3, [r7, #4]
|
|
8005ba4: f8c3 2090 str.w r2, [r3, #144] @ 0x90
|
|
}
|
|
|
|
/* UART noise error interrupt occurred --------------------------------------*/
|
|
if (((isrflags & USART_ISR_NE) != 0U) && ((cr3its & USART_CR3_EIE) != 0U))
|
|
8005ba8: f8d7 30e4 ldr.w r3, [r7, #228] @ 0xe4
|
|
8005bac: f003 0304 and.w r3, r3, #4
|
|
8005bb0: 2b00 cmp r3, #0
|
|
8005bb2: d011 beq.n 8005bd8 <HAL_UART_IRQHandler+0x128>
|
|
8005bb4: f8d7 30dc ldr.w r3, [r7, #220] @ 0xdc
|
|
8005bb8: f003 0301 and.w r3, r3, #1
|
|
8005bbc: 2b00 cmp r3, #0
|
|
8005bbe: d00b beq.n 8005bd8 <HAL_UART_IRQHandler+0x128>
|
|
{
|
|
__HAL_UART_CLEAR_FLAG(huart, UART_CLEAR_NEF);
|
|
8005bc0: 687b ldr r3, [r7, #4]
|
|
8005bc2: 681b ldr r3, [r3, #0]
|
|
8005bc4: 2204 movs r2, #4
|
|
8005bc6: 621a str r2, [r3, #32]
|
|
|
|
huart->ErrorCode |= HAL_UART_ERROR_NE;
|
|
8005bc8: 687b ldr r3, [r7, #4]
|
|
8005bca: f8d3 3090 ldr.w r3, [r3, #144] @ 0x90
|
|
8005bce: f043 0202 orr.w r2, r3, #2
|
|
8005bd2: 687b ldr r3, [r7, #4]
|
|
8005bd4: f8c3 2090 str.w r2, [r3, #144] @ 0x90
|
|
}
|
|
|
|
/* UART Over-Run interrupt occurred -----------------------------------------*/
|
|
if (((isrflags & USART_ISR_ORE) != 0U)
|
|
8005bd8: f8d7 30e4 ldr.w r3, [r7, #228] @ 0xe4
|
|
8005bdc: f003 0308 and.w r3, r3, #8
|
|
8005be0: 2b00 cmp r3, #0
|
|
8005be2: d017 beq.n 8005c14 <HAL_UART_IRQHandler+0x164>
|
|
&& (((cr1its & USART_CR1_RXNEIE_RXFNEIE) != 0U) ||
|
|
8005be4: f8d7 30e0 ldr.w r3, [r7, #224] @ 0xe0
|
|
8005be8: f003 0320 and.w r3, r3, #32
|
|
8005bec: 2b00 cmp r3, #0
|
|
8005bee: d105 bne.n 8005bfc <HAL_UART_IRQHandler+0x14c>
|
|
((cr3its & (USART_CR3_RXFTIE | USART_CR3_EIE)) != 0U)))
|
|
8005bf0: f8d7 20dc ldr.w r2, [r7, #220] @ 0xdc
|
|
8005bf4: 4b5c ldr r3, [pc, #368] @ (8005d68 <HAL_UART_IRQHandler+0x2b8>)
|
|
8005bf6: 4013 ands r3, r2
|
|
&& (((cr1its & USART_CR1_RXNEIE_RXFNEIE) != 0U) ||
|
|
8005bf8: 2b00 cmp r3, #0
|
|
8005bfa: d00b beq.n 8005c14 <HAL_UART_IRQHandler+0x164>
|
|
{
|
|
__HAL_UART_CLEAR_FLAG(huart, UART_CLEAR_OREF);
|
|
8005bfc: 687b ldr r3, [r7, #4]
|
|
8005bfe: 681b ldr r3, [r3, #0]
|
|
8005c00: 2208 movs r2, #8
|
|
8005c02: 621a str r2, [r3, #32]
|
|
|
|
huart->ErrorCode |= HAL_UART_ERROR_ORE;
|
|
8005c04: 687b ldr r3, [r7, #4]
|
|
8005c06: f8d3 3090 ldr.w r3, [r3, #144] @ 0x90
|
|
8005c0a: f043 0208 orr.w r2, r3, #8
|
|
8005c0e: 687b ldr r3, [r7, #4]
|
|
8005c10: f8c3 2090 str.w r2, [r3, #144] @ 0x90
|
|
}
|
|
|
|
/* UART Receiver Timeout interrupt occurred ---------------------------------*/
|
|
if (((isrflags & USART_ISR_RTOF) != 0U) && ((cr1its & USART_CR1_RTOIE) != 0U))
|
|
8005c14: f8d7 30e4 ldr.w r3, [r7, #228] @ 0xe4
|
|
8005c18: f403 6300 and.w r3, r3, #2048 @ 0x800
|
|
8005c1c: 2b00 cmp r3, #0
|
|
8005c1e: d012 beq.n 8005c46 <HAL_UART_IRQHandler+0x196>
|
|
8005c20: f8d7 30e0 ldr.w r3, [r7, #224] @ 0xe0
|
|
8005c24: f003 6380 and.w r3, r3, #67108864 @ 0x4000000
|
|
8005c28: 2b00 cmp r3, #0
|
|
8005c2a: d00c beq.n 8005c46 <HAL_UART_IRQHandler+0x196>
|
|
{
|
|
__HAL_UART_CLEAR_FLAG(huart, UART_CLEAR_RTOF);
|
|
8005c2c: 687b ldr r3, [r7, #4]
|
|
8005c2e: 681b ldr r3, [r3, #0]
|
|
8005c30: f44f 6200 mov.w r2, #2048 @ 0x800
|
|
8005c34: 621a str r2, [r3, #32]
|
|
|
|
huart->ErrorCode |= HAL_UART_ERROR_RTO;
|
|
8005c36: 687b ldr r3, [r7, #4]
|
|
8005c38: f8d3 3090 ldr.w r3, [r3, #144] @ 0x90
|
|
8005c3c: f043 0220 orr.w r2, r3, #32
|
|
8005c40: 687b ldr r3, [r7, #4]
|
|
8005c42: f8c3 2090 str.w r2, [r3, #144] @ 0x90
|
|
}
|
|
|
|
/* Call UART Error Call back function if need be ----------------------------*/
|
|
if (huart->ErrorCode != HAL_UART_ERROR_NONE)
|
|
8005c46: 687b ldr r3, [r7, #4]
|
|
8005c48: f8d3 3090 ldr.w r3, [r3, #144] @ 0x90
|
|
8005c4c: 2b00 cmp r3, #0
|
|
8005c4e: f000 8266 beq.w 800611e <HAL_UART_IRQHandler+0x66e>
|
|
{
|
|
/* UART in mode Receiver --------------------------------------------------*/
|
|
if (((isrflags & USART_ISR_RXNE_RXFNE) != 0U)
|
|
8005c52: f8d7 30e4 ldr.w r3, [r7, #228] @ 0xe4
|
|
8005c56: f003 0320 and.w r3, r3, #32
|
|
8005c5a: 2b00 cmp r3, #0
|
|
8005c5c: d013 beq.n 8005c86 <HAL_UART_IRQHandler+0x1d6>
|
|
&& (((cr1its & USART_CR1_RXNEIE_RXFNEIE) != 0U)
|
|
8005c5e: f8d7 30e0 ldr.w r3, [r7, #224] @ 0xe0
|
|
8005c62: f003 0320 and.w r3, r3, #32
|
|
8005c66: 2b00 cmp r3, #0
|
|
8005c68: d105 bne.n 8005c76 <HAL_UART_IRQHandler+0x1c6>
|
|
|| ((cr3its & USART_CR3_RXFTIE) != 0U)))
|
|
8005c6a: f8d7 30dc ldr.w r3, [r7, #220] @ 0xdc
|
|
8005c6e: f003 5380 and.w r3, r3, #268435456 @ 0x10000000
|
|
8005c72: 2b00 cmp r3, #0
|
|
8005c74: d007 beq.n 8005c86 <HAL_UART_IRQHandler+0x1d6>
|
|
{
|
|
if (huart->RxISR != NULL)
|
|
8005c76: 687b ldr r3, [r7, #4]
|
|
8005c78: 6f5b ldr r3, [r3, #116] @ 0x74
|
|
8005c7a: 2b00 cmp r3, #0
|
|
8005c7c: d003 beq.n 8005c86 <HAL_UART_IRQHandler+0x1d6>
|
|
{
|
|
huart->RxISR(huart);
|
|
8005c7e: 687b ldr r3, [r7, #4]
|
|
8005c80: 6f5b ldr r3, [r3, #116] @ 0x74
|
|
8005c82: 6878 ldr r0, [r7, #4]
|
|
8005c84: 4798 blx r3
|
|
/* If Error is to be considered as blocking :
|
|
- Receiver Timeout error in Reception
|
|
- Overrun error in Reception
|
|
- any error occurs in DMA mode reception
|
|
*/
|
|
errorcode = huart->ErrorCode;
|
|
8005c86: 687b ldr r3, [r7, #4]
|
|
8005c88: f8d3 3090 ldr.w r3, [r3, #144] @ 0x90
|
|
8005c8c: f8c7 30d4 str.w r3, [r7, #212] @ 0xd4
|
|
if ((HAL_IS_BIT_SET(huart->Instance->CR3, USART_CR3_DMAR)) ||
|
|
8005c90: 687b ldr r3, [r7, #4]
|
|
8005c92: 681b ldr r3, [r3, #0]
|
|
8005c94: 689b ldr r3, [r3, #8]
|
|
8005c96: f003 0340 and.w r3, r3, #64 @ 0x40
|
|
8005c9a: 2b40 cmp r3, #64 @ 0x40
|
|
8005c9c: d005 beq.n 8005caa <HAL_UART_IRQHandler+0x1fa>
|
|
((errorcode & (HAL_UART_ERROR_RTO | HAL_UART_ERROR_ORE)) != 0U))
|
|
8005c9e: f8d7 30d4 ldr.w r3, [r7, #212] @ 0xd4
|
|
8005ca2: f003 0328 and.w r3, r3, #40 @ 0x28
|
|
if ((HAL_IS_BIT_SET(huart->Instance->CR3, USART_CR3_DMAR)) ||
|
|
8005ca6: 2b00 cmp r3, #0
|
|
8005ca8: d054 beq.n 8005d54 <HAL_UART_IRQHandler+0x2a4>
|
|
{
|
|
/* Blocking error : transfer is aborted
|
|
Set the UART state ready to be able to start again the process,
|
|
Disable Rx Interrupts, and disable Rx DMA request, if ongoing */
|
|
UART_EndRxTransfer(huart);
|
|
8005caa: 6878 ldr r0, [r7, #4]
|
|
8005cac: f000 ffec bl 8006c88 <UART_EndRxTransfer>
|
|
|
|
/* Abort the UART DMA Rx channel if enabled */
|
|
if (HAL_IS_BIT_SET(huart->Instance->CR3, USART_CR3_DMAR))
|
|
8005cb0: 687b ldr r3, [r7, #4]
|
|
8005cb2: 681b ldr r3, [r3, #0]
|
|
8005cb4: 689b ldr r3, [r3, #8]
|
|
8005cb6: f003 0340 and.w r3, r3, #64 @ 0x40
|
|
8005cba: 2b40 cmp r3, #64 @ 0x40
|
|
8005cbc: d146 bne.n 8005d4c <HAL_UART_IRQHandler+0x29c>
|
|
{
|
|
/* Disable the UART DMA Rx request if enabled */
|
|
ATOMIC_CLEAR_BIT(huart->Instance->CR3, USART_CR3_DMAR);
|
|
8005cbe: 687b ldr r3, [r7, #4]
|
|
8005cc0: 681b ldr r3, [r3, #0]
|
|
8005cc2: 3308 adds r3, #8
|
|
8005cc4: f8c7 309c str.w r3, [r7, #156] @ 0x9c
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
8005cc8: f8d7 309c ldr.w r3, [r7, #156] @ 0x9c
|
|
8005ccc: e853 3f00 ldrex r3, [r3]
|
|
8005cd0: f8c7 3098 str.w r3, [r7, #152] @ 0x98
|
|
return(result);
|
|
8005cd4: f8d7 3098 ldr.w r3, [r7, #152] @ 0x98
|
|
8005cd8: f023 0340 bic.w r3, r3, #64 @ 0x40
|
|
8005cdc: f8c7 30d0 str.w r3, [r7, #208] @ 0xd0
|
|
8005ce0: 687b ldr r3, [r7, #4]
|
|
8005ce2: 681b ldr r3, [r3, #0]
|
|
8005ce4: 3308 adds r3, #8
|
|
8005ce6: f8d7 20d0 ldr.w r2, [r7, #208] @ 0xd0
|
|
8005cea: f8c7 20a8 str.w r2, [r7, #168] @ 0xa8
|
|
8005cee: f8c7 30a4 str.w r3, [r7, #164] @ 0xa4
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
8005cf2: f8d7 10a4 ldr.w r1, [r7, #164] @ 0xa4
|
|
8005cf6: f8d7 20a8 ldr.w r2, [r7, #168] @ 0xa8
|
|
8005cfa: e841 2300 strex r3, r2, [r1]
|
|
8005cfe: f8c7 30a0 str.w r3, [r7, #160] @ 0xa0
|
|
return(result);
|
|
8005d02: f8d7 30a0 ldr.w r3, [r7, #160] @ 0xa0
|
|
8005d06: 2b00 cmp r3, #0
|
|
8005d08: d1d9 bne.n 8005cbe <HAL_UART_IRQHandler+0x20e>
|
|
|
|
/* Abort the UART DMA Rx channel */
|
|
if (huart->hdmarx != NULL)
|
|
8005d0a: 687b ldr r3, [r7, #4]
|
|
8005d0c: f8d3 3080 ldr.w r3, [r3, #128] @ 0x80
|
|
8005d10: 2b00 cmp r3, #0
|
|
8005d12: d017 beq.n 8005d44 <HAL_UART_IRQHandler+0x294>
|
|
{
|
|
/* Set the UART DMA Abort callback :
|
|
will lead to call HAL_UART_ErrorCallback() at end of DMA abort procedure */
|
|
huart->hdmarx->XferAbortCallback = UART_DMAAbortOnError;
|
|
8005d14: 687b ldr r3, [r7, #4]
|
|
8005d16: f8d3 3080 ldr.w r3, [r3, #128] @ 0x80
|
|
8005d1a: 4a15 ldr r2, [pc, #84] @ (8005d70 <HAL_UART_IRQHandler+0x2c0>)
|
|
8005d1c: 639a str r2, [r3, #56] @ 0x38
|
|
|
|
/* Abort DMA RX */
|
|
if (HAL_DMA_Abort_IT(huart->hdmarx) != HAL_OK)
|
|
8005d1e: 687b ldr r3, [r7, #4]
|
|
8005d20: f8d3 3080 ldr.w r3, [r3, #128] @ 0x80
|
|
8005d24: 4618 mov r0, r3
|
|
8005d26: f7fc f97b bl 8002020 <HAL_DMA_Abort_IT>
|
|
8005d2a: 4603 mov r3, r0
|
|
8005d2c: 2b00 cmp r3, #0
|
|
8005d2e: d019 beq.n 8005d64 <HAL_UART_IRQHandler+0x2b4>
|
|
{
|
|
/* Call Directly huart->hdmarx->XferAbortCallback function in case of error */
|
|
huart->hdmarx->XferAbortCallback(huart->hdmarx);
|
|
8005d30: 687b ldr r3, [r7, #4]
|
|
8005d32: f8d3 3080 ldr.w r3, [r3, #128] @ 0x80
|
|
8005d36: 6b9b ldr r3, [r3, #56] @ 0x38
|
|
8005d38: 687a ldr r2, [r7, #4]
|
|
8005d3a: f8d2 2080 ldr.w r2, [r2, #128] @ 0x80
|
|
8005d3e: 4610 mov r0, r2
|
|
8005d40: 4798 blx r3
|
|
if (HAL_IS_BIT_SET(huart->Instance->CR3, USART_CR3_DMAR))
|
|
8005d42: e00f b.n 8005d64 <HAL_UART_IRQHandler+0x2b4>
|
|
#if (USE_HAL_UART_REGISTER_CALLBACKS == 1)
|
|
/*Call registered error callback*/
|
|
huart->ErrorCallback(huart);
|
|
#else
|
|
/*Call legacy weak error callback*/
|
|
HAL_UART_ErrorCallback(huart);
|
|
8005d44: 6878 ldr r0, [r7, #4]
|
|
8005d46: f000 f9fe bl 8006146 <HAL_UART_ErrorCallback>
|
|
if (HAL_IS_BIT_SET(huart->Instance->CR3, USART_CR3_DMAR))
|
|
8005d4a: e00b b.n 8005d64 <HAL_UART_IRQHandler+0x2b4>
|
|
#if (USE_HAL_UART_REGISTER_CALLBACKS == 1)
|
|
/*Call registered error callback*/
|
|
huart->ErrorCallback(huart);
|
|
#else
|
|
/*Call legacy weak error callback*/
|
|
HAL_UART_ErrorCallback(huart);
|
|
8005d4c: 6878 ldr r0, [r7, #4]
|
|
8005d4e: f000 f9fa bl 8006146 <HAL_UART_ErrorCallback>
|
|
if (HAL_IS_BIT_SET(huart->Instance->CR3, USART_CR3_DMAR))
|
|
8005d52: e007 b.n 8005d64 <HAL_UART_IRQHandler+0x2b4>
|
|
#if (USE_HAL_UART_REGISTER_CALLBACKS == 1)
|
|
/*Call registered error callback*/
|
|
huart->ErrorCallback(huart);
|
|
#else
|
|
/*Call legacy weak error callback*/
|
|
HAL_UART_ErrorCallback(huart);
|
|
8005d54: 6878 ldr r0, [r7, #4]
|
|
8005d56: f000 f9f6 bl 8006146 <HAL_UART_ErrorCallback>
|
|
#endif /* USE_HAL_UART_REGISTER_CALLBACKS */
|
|
huart->ErrorCode = HAL_UART_ERROR_NONE;
|
|
8005d5a: 687b ldr r3, [r7, #4]
|
|
8005d5c: 2200 movs r2, #0
|
|
8005d5e: f8c3 2090 str.w r2, [r3, #144] @ 0x90
|
|
}
|
|
}
|
|
return;
|
|
8005d62: e1dc b.n 800611e <HAL_UART_IRQHandler+0x66e>
|
|
if (HAL_IS_BIT_SET(huart->Instance->CR3, USART_CR3_DMAR))
|
|
8005d64: bf00 nop
|
|
return;
|
|
8005d66: e1da b.n 800611e <HAL_UART_IRQHandler+0x66e>
|
|
8005d68: 10000001 .word 0x10000001
|
|
8005d6c: 04000120 .word 0x04000120
|
|
8005d70: 08006e71 .word 0x08006e71
|
|
|
|
} /* End if some error occurs */
|
|
|
|
/* Check current reception Mode :
|
|
If Reception till IDLE event has been selected : */
|
|
if ((huart->ReceptionType == HAL_UART_RECEPTION_TOIDLE)
|
|
8005d74: 687b ldr r3, [r7, #4]
|
|
8005d76: 6edb ldr r3, [r3, #108] @ 0x6c
|
|
8005d78: 2b01 cmp r3, #1
|
|
8005d7a: f040 8170 bne.w 800605e <HAL_UART_IRQHandler+0x5ae>
|
|
&& ((isrflags & USART_ISR_IDLE) != 0U)
|
|
8005d7e: f8d7 30e4 ldr.w r3, [r7, #228] @ 0xe4
|
|
8005d82: f003 0310 and.w r3, r3, #16
|
|
8005d86: 2b00 cmp r3, #0
|
|
8005d88: f000 8169 beq.w 800605e <HAL_UART_IRQHandler+0x5ae>
|
|
&& ((cr1its & USART_ISR_IDLE) != 0U))
|
|
8005d8c: f8d7 30e0 ldr.w r3, [r7, #224] @ 0xe0
|
|
8005d90: f003 0310 and.w r3, r3, #16
|
|
8005d94: 2b00 cmp r3, #0
|
|
8005d96: f000 8162 beq.w 800605e <HAL_UART_IRQHandler+0x5ae>
|
|
{
|
|
__HAL_UART_CLEAR_FLAG(huart, UART_CLEAR_IDLEF);
|
|
8005d9a: 687b ldr r3, [r7, #4]
|
|
8005d9c: 681b ldr r3, [r3, #0]
|
|
8005d9e: 2210 movs r2, #16
|
|
8005da0: 621a str r2, [r3, #32]
|
|
|
|
/* Check if DMA mode is enabled in UART */
|
|
if (HAL_IS_BIT_SET(huart->Instance->CR3, USART_CR3_DMAR))
|
|
8005da2: 687b ldr r3, [r7, #4]
|
|
8005da4: 681b ldr r3, [r3, #0]
|
|
8005da6: 689b ldr r3, [r3, #8]
|
|
8005da8: f003 0340 and.w r3, r3, #64 @ 0x40
|
|
8005dac: 2b40 cmp r3, #64 @ 0x40
|
|
8005dae: f040 80d8 bne.w 8005f62 <HAL_UART_IRQHandler+0x4b2>
|
|
{
|
|
/* DMA mode enabled */
|
|
/* Check received length : If all expected data are received, do nothing,
|
|
(DMA cplt callback will be called).
|
|
Otherwise, if at least one data has already been received, IDLE event is to be notified to user */
|
|
uint16_t nb_remaining_rx_data = (uint16_t) __HAL_DMA_GET_COUNTER(huart->hdmarx);
|
|
8005db2: 687b ldr r3, [r7, #4]
|
|
8005db4: f8d3 3080 ldr.w r3, [r3, #128] @ 0x80
|
|
8005db8: 681b ldr r3, [r3, #0]
|
|
8005dba: 685b ldr r3, [r3, #4]
|
|
8005dbc: f8a7 30be strh.w r3, [r7, #190] @ 0xbe
|
|
if ((nb_remaining_rx_data > 0U)
|
|
8005dc0: f8b7 30be ldrh.w r3, [r7, #190] @ 0xbe
|
|
8005dc4: 2b00 cmp r3, #0
|
|
8005dc6: f000 80af beq.w 8005f28 <HAL_UART_IRQHandler+0x478>
|
|
&& (nb_remaining_rx_data < huart->RxXferSize))
|
|
8005dca: 687b ldr r3, [r7, #4]
|
|
8005dcc: f8b3 305c ldrh.w r3, [r3, #92] @ 0x5c
|
|
8005dd0: f8b7 20be ldrh.w r2, [r7, #190] @ 0xbe
|
|
8005dd4: 429a cmp r2, r3
|
|
8005dd6: f080 80a7 bcs.w 8005f28 <HAL_UART_IRQHandler+0x478>
|
|
{
|
|
/* Reception is not complete */
|
|
huart->RxXferCount = nb_remaining_rx_data;
|
|
8005dda: 687b ldr r3, [r7, #4]
|
|
8005ddc: f8b7 20be ldrh.w r2, [r7, #190] @ 0xbe
|
|
8005de0: f8a3 205e strh.w r2, [r3, #94] @ 0x5e
|
|
|
|
/* In Normal mode, end DMA xfer and HAL UART Rx process*/
|
|
if (HAL_IS_BIT_CLR(huart->hdmarx->Instance->CCR, DMA_CCR_CIRC))
|
|
8005de4: 687b ldr r3, [r7, #4]
|
|
8005de6: f8d3 3080 ldr.w r3, [r3, #128] @ 0x80
|
|
8005dea: 681b ldr r3, [r3, #0]
|
|
8005dec: 681b ldr r3, [r3, #0]
|
|
8005dee: f003 0320 and.w r3, r3, #32
|
|
8005df2: 2b00 cmp r3, #0
|
|
8005df4: f040 8087 bne.w 8005f06 <HAL_UART_IRQHandler+0x456>
|
|
{
|
|
/* Disable PE and ERR (Frame error, noise error, overrun error) interrupts */
|
|
ATOMIC_CLEAR_BIT(huart->Instance->CR1, USART_CR1_PEIE);
|
|
8005df8: 687b ldr r3, [r7, #4]
|
|
8005dfa: 681b ldr r3, [r3, #0]
|
|
8005dfc: f8c7 3088 str.w r3, [r7, #136] @ 0x88
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
8005e00: f8d7 3088 ldr.w r3, [r7, #136] @ 0x88
|
|
8005e04: e853 3f00 ldrex r3, [r3]
|
|
8005e08: f8c7 3084 str.w r3, [r7, #132] @ 0x84
|
|
return(result);
|
|
8005e0c: f8d7 3084 ldr.w r3, [r7, #132] @ 0x84
|
|
8005e10: f423 7380 bic.w r3, r3, #256 @ 0x100
|
|
8005e14: f8c7 30b8 str.w r3, [r7, #184] @ 0xb8
|
|
8005e18: 687b ldr r3, [r7, #4]
|
|
8005e1a: 681b ldr r3, [r3, #0]
|
|
8005e1c: 461a mov r2, r3
|
|
8005e1e: f8d7 30b8 ldr.w r3, [r7, #184] @ 0xb8
|
|
8005e22: f8c7 3094 str.w r3, [r7, #148] @ 0x94
|
|
8005e26: f8c7 2090 str.w r2, [r7, #144] @ 0x90
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
8005e2a: f8d7 1090 ldr.w r1, [r7, #144] @ 0x90
|
|
8005e2e: f8d7 2094 ldr.w r2, [r7, #148] @ 0x94
|
|
8005e32: e841 2300 strex r3, r2, [r1]
|
|
8005e36: f8c7 308c str.w r3, [r7, #140] @ 0x8c
|
|
return(result);
|
|
8005e3a: f8d7 308c ldr.w r3, [r7, #140] @ 0x8c
|
|
8005e3e: 2b00 cmp r3, #0
|
|
8005e40: d1da bne.n 8005df8 <HAL_UART_IRQHandler+0x348>
|
|
ATOMIC_CLEAR_BIT(huart->Instance->CR3, USART_CR3_EIE);
|
|
8005e42: 687b ldr r3, [r7, #4]
|
|
8005e44: 681b ldr r3, [r3, #0]
|
|
8005e46: 3308 adds r3, #8
|
|
8005e48: 677b str r3, [r7, #116] @ 0x74
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
8005e4a: 6f7b ldr r3, [r7, #116] @ 0x74
|
|
8005e4c: e853 3f00 ldrex r3, [r3]
|
|
8005e50: 673b str r3, [r7, #112] @ 0x70
|
|
return(result);
|
|
8005e52: 6f3b ldr r3, [r7, #112] @ 0x70
|
|
8005e54: f023 0301 bic.w r3, r3, #1
|
|
8005e58: f8c7 30b4 str.w r3, [r7, #180] @ 0xb4
|
|
8005e5c: 687b ldr r3, [r7, #4]
|
|
8005e5e: 681b ldr r3, [r3, #0]
|
|
8005e60: 3308 adds r3, #8
|
|
8005e62: f8d7 20b4 ldr.w r2, [r7, #180] @ 0xb4
|
|
8005e66: f8c7 2080 str.w r2, [r7, #128] @ 0x80
|
|
8005e6a: 67fb str r3, [r7, #124] @ 0x7c
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
8005e6c: 6ff9 ldr r1, [r7, #124] @ 0x7c
|
|
8005e6e: f8d7 2080 ldr.w r2, [r7, #128] @ 0x80
|
|
8005e72: e841 2300 strex r3, r2, [r1]
|
|
8005e76: 67bb str r3, [r7, #120] @ 0x78
|
|
return(result);
|
|
8005e78: 6fbb ldr r3, [r7, #120] @ 0x78
|
|
8005e7a: 2b00 cmp r3, #0
|
|
8005e7c: d1e1 bne.n 8005e42 <HAL_UART_IRQHandler+0x392>
|
|
|
|
/* Disable the DMA transfer for the receiver request by resetting the DMAR bit
|
|
in the UART CR3 register */
|
|
ATOMIC_CLEAR_BIT(huart->Instance->CR3, USART_CR3_DMAR);
|
|
8005e7e: 687b ldr r3, [r7, #4]
|
|
8005e80: 681b ldr r3, [r3, #0]
|
|
8005e82: 3308 adds r3, #8
|
|
8005e84: 663b str r3, [r7, #96] @ 0x60
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
8005e86: 6e3b ldr r3, [r7, #96] @ 0x60
|
|
8005e88: e853 3f00 ldrex r3, [r3]
|
|
8005e8c: 65fb str r3, [r7, #92] @ 0x5c
|
|
return(result);
|
|
8005e8e: 6dfb ldr r3, [r7, #92] @ 0x5c
|
|
8005e90: f023 0340 bic.w r3, r3, #64 @ 0x40
|
|
8005e94: f8c7 30b0 str.w r3, [r7, #176] @ 0xb0
|
|
8005e98: 687b ldr r3, [r7, #4]
|
|
8005e9a: 681b ldr r3, [r3, #0]
|
|
8005e9c: 3308 adds r3, #8
|
|
8005e9e: f8d7 20b0 ldr.w r2, [r7, #176] @ 0xb0
|
|
8005ea2: 66fa str r2, [r7, #108] @ 0x6c
|
|
8005ea4: 66bb str r3, [r7, #104] @ 0x68
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
8005ea6: 6eb9 ldr r1, [r7, #104] @ 0x68
|
|
8005ea8: 6efa ldr r2, [r7, #108] @ 0x6c
|
|
8005eaa: e841 2300 strex r3, r2, [r1]
|
|
8005eae: 667b str r3, [r7, #100] @ 0x64
|
|
return(result);
|
|
8005eb0: 6e7b ldr r3, [r7, #100] @ 0x64
|
|
8005eb2: 2b00 cmp r3, #0
|
|
8005eb4: d1e3 bne.n 8005e7e <HAL_UART_IRQHandler+0x3ce>
|
|
|
|
/* At end of Rx process, restore huart->RxState to Ready */
|
|
huart->RxState = HAL_UART_STATE_READY;
|
|
8005eb6: 687b ldr r3, [r7, #4]
|
|
8005eb8: 2220 movs r2, #32
|
|
8005eba: f8c3 208c str.w r2, [r3, #140] @ 0x8c
|
|
huart->ReceptionType = HAL_UART_RECEPTION_STANDARD;
|
|
8005ebe: 687b ldr r3, [r7, #4]
|
|
8005ec0: 2200 movs r2, #0
|
|
8005ec2: 66da str r2, [r3, #108] @ 0x6c
|
|
|
|
ATOMIC_CLEAR_BIT(huart->Instance->CR1, USART_CR1_IDLEIE);
|
|
8005ec4: 687b ldr r3, [r7, #4]
|
|
8005ec6: 681b ldr r3, [r3, #0]
|
|
8005ec8: 64fb str r3, [r7, #76] @ 0x4c
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
8005eca: 6cfb ldr r3, [r7, #76] @ 0x4c
|
|
8005ecc: e853 3f00 ldrex r3, [r3]
|
|
8005ed0: 64bb str r3, [r7, #72] @ 0x48
|
|
return(result);
|
|
8005ed2: 6cbb ldr r3, [r7, #72] @ 0x48
|
|
8005ed4: f023 0310 bic.w r3, r3, #16
|
|
8005ed8: f8c7 30ac str.w r3, [r7, #172] @ 0xac
|
|
8005edc: 687b ldr r3, [r7, #4]
|
|
8005ede: 681b ldr r3, [r3, #0]
|
|
8005ee0: 461a mov r2, r3
|
|
8005ee2: f8d7 30ac ldr.w r3, [r7, #172] @ 0xac
|
|
8005ee6: 65bb str r3, [r7, #88] @ 0x58
|
|
8005ee8: 657a str r2, [r7, #84] @ 0x54
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
8005eea: 6d79 ldr r1, [r7, #84] @ 0x54
|
|
8005eec: 6dba ldr r2, [r7, #88] @ 0x58
|
|
8005eee: e841 2300 strex r3, r2, [r1]
|
|
8005ef2: 653b str r3, [r7, #80] @ 0x50
|
|
return(result);
|
|
8005ef4: 6d3b ldr r3, [r7, #80] @ 0x50
|
|
8005ef6: 2b00 cmp r3, #0
|
|
8005ef8: d1e4 bne.n 8005ec4 <HAL_UART_IRQHandler+0x414>
|
|
|
|
/* Last bytes received, so no need as the abort is immediate */
|
|
(void)HAL_DMA_Abort(huart->hdmarx);
|
|
8005efa: 687b ldr r3, [r7, #4]
|
|
8005efc: f8d3 3080 ldr.w r3, [r3, #128] @ 0x80
|
|
8005f00: 4618 mov r0, r3
|
|
8005f02: f7fc f82f bl 8001f64 <HAL_DMA_Abort>
|
|
}
|
|
|
|
/* Initialize type of RxEvent that correspond to RxEvent callback execution;
|
|
In this case, Rx Event type is Idle Event */
|
|
huart->RxEventType = HAL_UART_RXEVENT_IDLE;
|
|
8005f06: 687b ldr r3, [r7, #4]
|
|
8005f08: 2202 movs r2, #2
|
|
8005f0a: 671a str r2, [r3, #112] @ 0x70
|
|
#if (USE_HAL_UART_REGISTER_CALLBACKS == 1)
|
|
/*Call registered Rx Event callback*/
|
|
huart->RxEventCallback(huart, (huart->RxXferSize - huart->RxXferCount));
|
|
#else
|
|
/*Call legacy weak Rx Event callback*/
|
|
HAL_UARTEx_RxEventCallback(huart, (huart->RxXferSize - huart->RxXferCount));
|
|
8005f0c: 687b ldr r3, [r7, #4]
|
|
8005f0e: f8b3 205c ldrh.w r2, [r3, #92] @ 0x5c
|
|
8005f12: 687b ldr r3, [r7, #4]
|
|
8005f14: f8b3 305e ldrh.w r3, [r3, #94] @ 0x5e
|
|
8005f18: b29b uxth r3, r3
|
|
8005f1a: 1ad3 subs r3, r2, r3
|
|
8005f1c: b29b uxth r3, r3
|
|
8005f1e: 4619 mov r1, r3
|
|
8005f20: 6878 ldr r0, [r7, #4]
|
|
8005f22: f000 f919 bl 8006158 <HAL_UARTEx_RxEventCallback>
|
|
HAL_UARTEx_RxEventCallback(huart, huart->RxXferSize);
|
|
#endif /* (USE_HAL_UART_REGISTER_CALLBACKS) */
|
|
}
|
|
}
|
|
}
|
|
return;
|
|
8005f26: e0fc b.n 8006122 <HAL_UART_IRQHandler+0x672>
|
|
if (nb_remaining_rx_data == huart->RxXferSize)
|
|
8005f28: 687b ldr r3, [r7, #4]
|
|
8005f2a: f8b3 305c ldrh.w r3, [r3, #92] @ 0x5c
|
|
8005f2e: f8b7 20be ldrh.w r2, [r7, #190] @ 0xbe
|
|
8005f32: 429a cmp r2, r3
|
|
8005f34: f040 80f5 bne.w 8006122 <HAL_UART_IRQHandler+0x672>
|
|
if (HAL_IS_BIT_SET(huart->hdmarx->Instance->CCR, DMA_CCR_CIRC))
|
|
8005f38: 687b ldr r3, [r7, #4]
|
|
8005f3a: f8d3 3080 ldr.w r3, [r3, #128] @ 0x80
|
|
8005f3e: 681b ldr r3, [r3, #0]
|
|
8005f40: 681b ldr r3, [r3, #0]
|
|
8005f42: f003 0320 and.w r3, r3, #32
|
|
8005f46: 2b20 cmp r3, #32
|
|
8005f48: f040 80eb bne.w 8006122 <HAL_UART_IRQHandler+0x672>
|
|
huart->RxEventType = HAL_UART_RXEVENT_IDLE;
|
|
8005f4c: 687b ldr r3, [r7, #4]
|
|
8005f4e: 2202 movs r2, #2
|
|
8005f50: 671a str r2, [r3, #112] @ 0x70
|
|
HAL_UARTEx_RxEventCallback(huart, huart->RxXferSize);
|
|
8005f52: 687b ldr r3, [r7, #4]
|
|
8005f54: f8b3 305c ldrh.w r3, [r3, #92] @ 0x5c
|
|
8005f58: 4619 mov r1, r3
|
|
8005f5a: 6878 ldr r0, [r7, #4]
|
|
8005f5c: f000 f8fc bl 8006158 <HAL_UARTEx_RxEventCallback>
|
|
return;
|
|
8005f60: e0df b.n 8006122 <HAL_UART_IRQHandler+0x672>
|
|
else
|
|
{
|
|
/* DMA mode not enabled */
|
|
/* Check received length : If all expected data are received, do nothing.
|
|
Otherwise, if at least one data has already been received, IDLE event is to be notified to user */
|
|
uint16_t nb_rx_data = huart->RxXferSize - huart->RxXferCount;
|
|
8005f62: 687b ldr r3, [r7, #4]
|
|
8005f64: f8b3 205c ldrh.w r2, [r3, #92] @ 0x5c
|
|
8005f68: 687b ldr r3, [r7, #4]
|
|
8005f6a: f8b3 305e ldrh.w r3, [r3, #94] @ 0x5e
|
|
8005f6e: b29b uxth r3, r3
|
|
8005f70: 1ad3 subs r3, r2, r3
|
|
8005f72: f8a7 30ce strh.w r3, [r7, #206] @ 0xce
|
|
if ((huart->RxXferCount > 0U)
|
|
8005f76: 687b ldr r3, [r7, #4]
|
|
8005f78: f8b3 305e ldrh.w r3, [r3, #94] @ 0x5e
|
|
8005f7c: b29b uxth r3, r3
|
|
8005f7e: 2b00 cmp r3, #0
|
|
8005f80: f000 80d1 beq.w 8006126 <HAL_UART_IRQHandler+0x676>
|
|
&& (nb_rx_data > 0U))
|
|
8005f84: f8b7 30ce ldrh.w r3, [r7, #206] @ 0xce
|
|
8005f88: 2b00 cmp r3, #0
|
|
8005f8a: f000 80cc beq.w 8006126 <HAL_UART_IRQHandler+0x676>
|
|
{
|
|
/* Disable the UART Parity Error Interrupt and RXNE interrupts */
|
|
ATOMIC_CLEAR_BIT(huart->Instance->CR1, (USART_CR1_RXNEIE_RXFNEIE | USART_CR1_PEIE));
|
|
8005f8e: 687b ldr r3, [r7, #4]
|
|
8005f90: 681b ldr r3, [r3, #0]
|
|
8005f92: 63bb str r3, [r7, #56] @ 0x38
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
8005f94: 6bbb ldr r3, [r7, #56] @ 0x38
|
|
8005f96: e853 3f00 ldrex r3, [r3]
|
|
8005f9a: 637b str r3, [r7, #52] @ 0x34
|
|
return(result);
|
|
8005f9c: 6b7b ldr r3, [r7, #52] @ 0x34
|
|
8005f9e: f423 7390 bic.w r3, r3, #288 @ 0x120
|
|
8005fa2: f8c7 30c8 str.w r3, [r7, #200] @ 0xc8
|
|
8005fa6: 687b ldr r3, [r7, #4]
|
|
8005fa8: 681b ldr r3, [r3, #0]
|
|
8005faa: 461a mov r2, r3
|
|
8005fac: f8d7 30c8 ldr.w r3, [r7, #200] @ 0xc8
|
|
8005fb0: 647b str r3, [r7, #68] @ 0x44
|
|
8005fb2: 643a str r2, [r7, #64] @ 0x40
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
8005fb4: 6c39 ldr r1, [r7, #64] @ 0x40
|
|
8005fb6: 6c7a ldr r2, [r7, #68] @ 0x44
|
|
8005fb8: e841 2300 strex r3, r2, [r1]
|
|
8005fbc: 63fb str r3, [r7, #60] @ 0x3c
|
|
return(result);
|
|
8005fbe: 6bfb ldr r3, [r7, #60] @ 0x3c
|
|
8005fc0: 2b00 cmp r3, #0
|
|
8005fc2: d1e4 bne.n 8005f8e <HAL_UART_IRQHandler+0x4de>
|
|
|
|
/* Disable the UART Error Interrupt:(Frame error, noise error, overrun error) and RX FIFO Threshold interrupt */
|
|
ATOMIC_CLEAR_BIT(huart->Instance->CR3, (USART_CR3_EIE | USART_CR3_RXFTIE));
|
|
8005fc4: 687b ldr r3, [r7, #4]
|
|
8005fc6: 681b ldr r3, [r3, #0]
|
|
8005fc8: 3308 adds r3, #8
|
|
8005fca: 627b str r3, [r7, #36] @ 0x24
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
8005fcc: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8005fce: e853 3f00 ldrex r3, [r3]
|
|
8005fd2: 623b str r3, [r7, #32]
|
|
return(result);
|
|
8005fd4: 6a3b ldr r3, [r7, #32]
|
|
8005fd6: f023 5380 bic.w r3, r3, #268435456 @ 0x10000000
|
|
8005fda: f023 0301 bic.w r3, r3, #1
|
|
8005fde: f8c7 30c4 str.w r3, [r7, #196] @ 0xc4
|
|
8005fe2: 687b ldr r3, [r7, #4]
|
|
8005fe4: 681b ldr r3, [r3, #0]
|
|
8005fe6: 3308 adds r3, #8
|
|
8005fe8: f8d7 20c4 ldr.w r2, [r7, #196] @ 0xc4
|
|
8005fec: 633a str r2, [r7, #48] @ 0x30
|
|
8005fee: 62fb str r3, [r7, #44] @ 0x2c
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
8005ff0: 6af9 ldr r1, [r7, #44] @ 0x2c
|
|
8005ff2: 6b3a ldr r2, [r7, #48] @ 0x30
|
|
8005ff4: e841 2300 strex r3, r2, [r1]
|
|
8005ff8: 62bb str r3, [r7, #40] @ 0x28
|
|
return(result);
|
|
8005ffa: 6abb ldr r3, [r7, #40] @ 0x28
|
|
8005ffc: 2b00 cmp r3, #0
|
|
8005ffe: d1e1 bne.n 8005fc4 <HAL_UART_IRQHandler+0x514>
|
|
|
|
/* Rx process is completed, restore huart->RxState to Ready */
|
|
huart->RxState = HAL_UART_STATE_READY;
|
|
8006000: 687b ldr r3, [r7, #4]
|
|
8006002: 2220 movs r2, #32
|
|
8006004: f8c3 208c str.w r2, [r3, #140] @ 0x8c
|
|
huart->ReceptionType = HAL_UART_RECEPTION_STANDARD;
|
|
8006008: 687b ldr r3, [r7, #4]
|
|
800600a: 2200 movs r2, #0
|
|
800600c: 66da str r2, [r3, #108] @ 0x6c
|
|
|
|
/* Clear RxISR function pointer */
|
|
huart->RxISR = NULL;
|
|
800600e: 687b ldr r3, [r7, #4]
|
|
8006010: 2200 movs r2, #0
|
|
8006012: 675a str r2, [r3, #116] @ 0x74
|
|
|
|
ATOMIC_CLEAR_BIT(huart->Instance->CR1, USART_CR1_IDLEIE);
|
|
8006014: 687b ldr r3, [r7, #4]
|
|
8006016: 681b ldr r3, [r3, #0]
|
|
8006018: 613b str r3, [r7, #16]
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
800601a: 693b ldr r3, [r7, #16]
|
|
800601c: e853 3f00 ldrex r3, [r3]
|
|
8006020: 60fb str r3, [r7, #12]
|
|
return(result);
|
|
8006022: 68fb ldr r3, [r7, #12]
|
|
8006024: f023 0310 bic.w r3, r3, #16
|
|
8006028: f8c7 30c0 str.w r3, [r7, #192] @ 0xc0
|
|
800602c: 687b ldr r3, [r7, #4]
|
|
800602e: 681b ldr r3, [r3, #0]
|
|
8006030: 461a mov r2, r3
|
|
8006032: f8d7 30c0 ldr.w r3, [r7, #192] @ 0xc0
|
|
8006036: 61fb str r3, [r7, #28]
|
|
8006038: 61ba str r2, [r7, #24]
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
800603a: 69b9 ldr r1, [r7, #24]
|
|
800603c: 69fa ldr r2, [r7, #28]
|
|
800603e: e841 2300 strex r3, r2, [r1]
|
|
8006042: 617b str r3, [r7, #20]
|
|
return(result);
|
|
8006044: 697b ldr r3, [r7, #20]
|
|
8006046: 2b00 cmp r3, #0
|
|
8006048: d1e4 bne.n 8006014 <HAL_UART_IRQHandler+0x564>
|
|
|
|
/* Initialize type of RxEvent that correspond to RxEvent callback execution;
|
|
In this case, Rx Event type is Idle Event */
|
|
huart->RxEventType = HAL_UART_RXEVENT_IDLE;
|
|
800604a: 687b ldr r3, [r7, #4]
|
|
800604c: 2202 movs r2, #2
|
|
800604e: 671a str r2, [r3, #112] @ 0x70
|
|
#if (USE_HAL_UART_REGISTER_CALLBACKS == 1)
|
|
/*Call registered Rx complete callback*/
|
|
huart->RxEventCallback(huart, nb_rx_data);
|
|
#else
|
|
/*Call legacy weak Rx Event callback*/
|
|
HAL_UARTEx_RxEventCallback(huart, nb_rx_data);
|
|
8006050: f8b7 30ce ldrh.w r3, [r7, #206] @ 0xce
|
|
8006054: 4619 mov r1, r3
|
|
8006056: 6878 ldr r0, [r7, #4]
|
|
8006058: f000 f87e bl 8006158 <HAL_UARTEx_RxEventCallback>
|
|
#endif /* (USE_HAL_UART_REGISTER_CALLBACKS) */
|
|
}
|
|
return;
|
|
800605c: e063 b.n 8006126 <HAL_UART_IRQHandler+0x676>
|
|
}
|
|
}
|
|
|
|
/* UART wakeup from Stop mode interrupt occurred ---------------------------*/
|
|
if (((isrflags & USART_ISR_WUF) != 0U) && ((cr3its & USART_CR3_WUFIE) != 0U))
|
|
800605e: f8d7 30e4 ldr.w r3, [r7, #228] @ 0xe4
|
|
8006062: f403 1380 and.w r3, r3, #1048576 @ 0x100000
|
|
8006066: 2b00 cmp r3, #0
|
|
8006068: d00e beq.n 8006088 <HAL_UART_IRQHandler+0x5d8>
|
|
800606a: f8d7 30dc ldr.w r3, [r7, #220] @ 0xdc
|
|
800606e: f403 0380 and.w r3, r3, #4194304 @ 0x400000
|
|
8006072: 2b00 cmp r3, #0
|
|
8006074: d008 beq.n 8006088 <HAL_UART_IRQHandler+0x5d8>
|
|
{
|
|
__HAL_UART_CLEAR_FLAG(huart, UART_CLEAR_WUF);
|
|
8006076: 687b ldr r3, [r7, #4]
|
|
8006078: 681b ldr r3, [r3, #0]
|
|
800607a: f44f 1280 mov.w r2, #1048576 @ 0x100000
|
|
800607e: 621a str r2, [r3, #32]
|
|
#if (USE_HAL_UART_REGISTER_CALLBACKS == 1)
|
|
/* Call registered Wakeup Callback */
|
|
huart->WakeupCallback(huart);
|
|
#else
|
|
/* Call legacy weak Wakeup Callback */
|
|
HAL_UARTEx_WakeupCallback(huart);
|
|
8006080: 6878 ldr r0, [r7, #4]
|
|
8006082: f001 fc4f bl 8007924 <HAL_UARTEx_WakeupCallback>
|
|
#endif /* USE_HAL_UART_REGISTER_CALLBACKS */
|
|
return;
|
|
8006086: e051 b.n 800612c <HAL_UART_IRQHandler+0x67c>
|
|
}
|
|
|
|
/* UART in mode Transmitter ------------------------------------------------*/
|
|
if (((isrflags & USART_ISR_TXE_TXFNF) != 0U)
|
|
8006088: f8d7 30e4 ldr.w r3, [r7, #228] @ 0xe4
|
|
800608c: f003 0380 and.w r3, r3, #128 @ 0x80
|
|
8006090: 2b00 cmp r3, #0
|
|
8006092: d014 beq.n 80060be <HAL_UART_IRQHandler+0x60e>
|
|
&& (((cr1its & USART_CR1_TXEIE_TXFNFIE) != 0U)
|
|
8006094: f8d7 30e0 ldr.w r3, [r7, #224] @ 0xe0
|
|
8006098: f003 0380 and.w r3, r3, #128 @ 0x80
|
|
800609c: 2b00 cmp r3, #0
|
|
800609e: d105 bne.n 80060ac <HAL_UART_IRQHandler+0x5fc>
|
|
|| ((cr3its & USART_CR3_TXFTIE) != 0U)))
|
|
80060a0: f8d7 30dc ldr.w r3, [r7, #220] @ 0xdc
|
|
80060a4: f403 0300 and.w r3, r3, #8388608 @ 0x800000
|
|
80060a8: 2b00 cmp r3, #0
|
|
80060aa: d008 beq.n 80060be <HAL_UART_IRQHandler+0x60e>
|
|
{
|
|
if (huart->TxISR != NULL)
|
|
80060ac: 687b ldr r3, [r7, #4]
|
|
80060ae: 6f9b ldr r3, [r3, #120] @ 0x78
|
|
80060b0: 2b00 cmp r3, #0
|
|
80060b2: d03a beq.n 800612a <HAL_UART_IRQHandler+0x67a>
|
|
{
|
|
huart->TxISR(huart);
|
|
80060b4: 687b ldr r3, [r7, #4]
|
|
80060b6: 6f9b ldr r3, [r3, #120] @ 0x78
|
|
80060b8: 6878 ldr r0, [r7, #4]
|
|
80060ba: 4798 blx r3
|
|
}
|
|
return;
|
|
80060bc: e035 b.n 800612a <HAL_UART_IRQHandler+0x67a>
|
|
}
|
|
|
|
/* UART in mode Transmitter (transmission end) -----------------------------*/
|
|
if (((isrflags & USART_ISR_TC) != 0U) && ((cr1its & USART_CR1_TCIE) != 0U))
|
|
80060be: f8d7 30e4 ldr.w r3, [r7, #228] @ 0xe4
|
|
80060c2: f003 0340 and.w r3, r3, #64 @ 0x40
|
|
80060c6: 2b00 cmp r3, #0
|
|
80060c8: d009 beq.n 80060de <HAL_UART_IRQHandler+0x62e>
|
|
80060ca: f8d7 30e0 ldr.w r3, [r7, #224] @ 0xe0
|
|
80060ce: f003 0340 and.w r3, r3, #64 @ 0x40
|
|
80060d2: 2b00 cmp r3, #0
|
|
80060d4: d003 beq.n 80060de <HAL_UART_IRQHandler+0x62e>
|
|
{
|
|
UART_EndTransmit_IT(huart);
|
|
80060d6: 6878 ldr r0, [r7, #4]
|
|
80060d8: f000 fed8 bl 8006e8c <UART_EndTransmit_IT>
|
|
return;
|
|
80060dc: e026 b.n 800612c <HAL_UART_IRQHandler+0x67c>
|
|
}
|
|
|
|
/* UART TX Fifo Empty occurred ----------------------------------------------*/
|
|
if (((isrflags & USART_ISR_TXFE) != 0U) && ((cr1its & USART_CR1_TXFEIE) != 0U))
|
|
80060de: f8d7 30e4 ldr.w r3, [r7, #228] @ 0xe4
|
|
80060e2: f403 0300 and.w r3, r3, #8388608 @ 0x800000
|
|
80060e6: 2b00 cmp r3, #0
|
|
80060e8: d009 beq.n 80060fe <HAL_UART_IRQHandler+0x64e>
|
|
80060ea: f8d7 30e0 ldr.w r3, [r7, #224] @ 0xe0
|
|
80060ee: f003 4380 and.w r3, r3, #1073741824 @ 0x40000000
|
|
80060f2: 2b00 cmp r3, #0
|
|
80060f4: d003 beq.n 80060fe <HAL_UART_IRQHandler+0x64e>
|
|
#if (USE_HAL_UART_REGISTER_CALLBACKS == 1)
|
|
/* Call registered Tx Fifo Empty Callback */
|
|
huart->TxFifoEmptyCallback(huart);
|
|
#else
|
|
/* Call legacy weak Tx Fifo Empty Callback */
|
|
HAL_UARTEx_TxFifoEmptyCallback(huart);
|
|
80060f6: 6878 ldr r0, [r7, #4]
|
|
80060f8: f001 fc26 bl 8007948 <HAL_UARTEx_TxFifoEmptyCallback>
|
|
#endif /* USE_HAL_UART_REGISTER_CALLBACKS */
|
|
return;
|
|
80060fc: e016 b.n 800612c <HAL_UART_IRQHandler+0x67c>
|
|
}
|
|
|
|
/* UART RX Fifo Full occurred ----------------------------------------------*/
|
|
if (((isrflags & USART_ISR_RXFF) != 0U) && ((cr1its & USART_CR1_RXFFIE) != 0U))
|
|
80060fe: f8d7 30e4 ldr.w r3, [r7, #228] @ 0xe4
|
|
8006102: f003 7380 and.w r3, r3, #16777216 @ 0x1000000
|
|
8006106: 2b00 cmp r3, #0
|
|
8006108: d010 beq.n 800612c <HAL_UART_IRQHandler+0x67c>
|
|
800610a: f8d7 30e0 ldr.w r3, [r7, #224] @ 0xe0
|
|
800610e: 2b00 cmp r3, #0
|
|
8006110: da0c bge.n 800612c <HAL_UART_IRQHandler+0x67c>
|
|
#if (USE_HAL_UART_REGISTER_CALLBACKS == 1)
|
|
/* Call registered Rx Fifo Full Callback */
|
|
huart->RxFifoFullCallback(huart);
|
|
#else
|
|
/* Call legacy weak Rx Fifo Full Callback */
|
|
HAL_UARTEx_RxFifoFullCallback(huart);
|
|
8006112: 6878 ldr r0, [r7, #4]
|
|
8006114: f001 fc0f bl 8007936 <HAL_UARTEx_RxFifoFullCallback>
|
|
#endif /* USE_HAL_UART_REGISTER_CALLBACKS */
|
|
return;
|
|
8006118: e008 b.n 800612c <HAL_UART_IRQHandler+0x67c>
|
|
return;
|
|
800611a: bf00 nop
|
|
800611c: e006 b.n 800612c <HAL_UART_IRQHandler+0x67c>
|
|
return;
|
|
800611e: bf00 nop
|
|
8006120: e004 b.n 800612c <HAL_UART_IRQHandler+0x67c>
|
|
return;
|
|
8006122: bf00 nop
|
|
8006124: e002 b.n 800612c <HAL_UART_IRQHandler+0x67c>
|
|
return;
|
|
8006126: bf00 nop
|
|
8006128: e000 b.n 800612c <HAL_UART_IRQHandler+0x67c>
|
|
return;
|
|
800612a: bf00 nop
|
|
}
|
|
}
|
|
800612c: 37e8 adds r7, #232 @ 0xe8
|
|
800612e: 46bd mov sp, r7
|
|
8006130: bd80 pop {r7, pc}
|
|
8006132: bf00 nop
|
|
|
|
08006134 <HAL_UART_TxHalfCpltCallback>:
|
|
* @brief Tx Half Transfer completed callback.
|
|
* @param huart UART handle.
|
|
* @retval None
|
|
*/
|
|
__weak void HAL_UART_TxHalfCpltCallback(UART_HandleTypeDef *huart)
|
|
{
|
|
8006134: b480 push {r7}
|
|
8006136: b083 sub sp, #12
|
|
8006138: af00 add r7, sp, #0
|
|
800613a: 6078 str r0, [r7, #4]
|
|
UNUSED(huart);
|
|
|
|
/* NOTE: This function should not be modified, when the callback is needed,
|
|
the HAL_UART_TxHalfCpltCallback can be implemented in the user file.
|
|
*/
|
|
}
|
|
800613c: bf00 nop
|
|
800613e: 370c adds r7, #12
|
|
8006140: 46bd mov sp, r7
|
|
8006142: bc80 pop {r7}
|
|
8006144: 4770 bx lr
|
|
|
|
08006146 <HAL_UART_ErrorCallback>:
|
|
* @brief UART error callback.
|
|
* @param huart UART handle.
|
|
* @retval None
|
|
*/
|
|
__weak void HAL_UART_ErrorCallback(UART_HandleTypeDef *huart)
|
|
{
|
|
8006146: b480 push {r7}
|
|
8006148: b083 sub sp, #12
|
|
800614a: af00 add r7, sp, #0
|
|
800614c: 6078 str r0, [r7, #4]
|
|
UNUSED(huart);
|
|
|
|
/* NOTE : This function should not be modified, when the callback is needed,
|
|
the HAL_UART_ErrorCallback can be implemented in the user file.
|
|
*/
|
|
}
|
|
800614e: bf00 nop
|
|
8006150: 370c adds r7, #12
|
|
8006152: 46bd mov sp, r7
|
|
8006154: bc80 pop {r7}
|
|
8006156: 4770 bx lr
|
|
|
|
08006158 <HAL_UARTEx_RxEventCallback>:
|
|
* @param Size Number of data available in application reception buffer (indicates a position in
|
|
* reception buffer until which, data are available)
|
|
* @retval None
|
|
*/
|
|
__weak void HAL_UARTEx_RxEventCallback(UART_HandleTypeDef *huart, uint16_t Size)
|
|
{
|
|
8006158: b480 push {r7}
|
|
800615a: b083 sub sp, #12
|
|
800615c: af00 add r7, sp, #0
|
|
800615e: 6078 str r0, [r7, #4]
|
|
8006160: 460b mov r3, r1
|
|
8006162: 807b strh r3, [r7, #2]
|
|
UNUSED(Size);
|
|
|
|
/* NOTE : This function should not be modified, when the callback is needed,
|
|
the HAL_UARTEx_RxEventCallback can be implemented in the user file.
|
|
*/
|
|
}
|
|
8006164: bf00 nop
|
|
8006166: 370c adds r7, #12
|
|
8006168: 46bd mov sp, r7
|
|
800616a: bc80 pop {r7}
|
|
800616c: 4770 bx lr
|
|
...
|
|
|
|
08006170 <UART_SetConfig>:
|
|
* @brief Configure the UART peripheral.
|
|
* @param huart UART handle.
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef UART_SetConfig(UART_HandleTypeDef *huart)
|
|
{
|
|
8006170: e92d 4fb0 stmdb sp!, {r4, r5, r7, r8, r9, sl, fp, lr}
|
|
8006174: b08c sub sp, #48 @ 0x30
|
|
8006176: af00 add r7, sp, #0
|
|
8006178: 6178 str r0, [r7, #20]
|
|
uint32_t tmpreg;
|
|
uint16_t brrtemp;
|
|
UART_ClockSourceTypeDef clocksource;
|
|
uint32_t usartdiv;
|
|
HAL_StatusTypeDef ret = HAL_OK;
|
|
800617a: 2300 movs r3, #0
|
|
800617c: f887 302a strb.w r3, [r7, #42] @ 0x2a
|
|
* the UART Word Length, Parity, Mode and oversampling:
|
|
* set the M bits according to huart->Init.WordLength value
|
|
* set PCE and PS bits according to huart->Init.Parity value
|
|
* set TE and RE bits according to huart->Init.Mode value
|
|
* set OVER8 bit according to huart->Init.OverSampling value */
|
|
tmpreg = (uint32_t)huart->Init.WordLength | huart->Init.Parity | huart->Init.Mode | huart->Init.OverSampling ;
|
|
8006180: 697b ldr r3, [r7, #20]
|
|
8006182: 689a ldr r2, [r3, #8]
|
|
8006184: 697b ldr r3, [r7, #20]
|
|
8006186: 691b ldr r3, [r3, #16]
|
|
8006188: 431a orrs r2, r3
|
|
800618a: 697b ldr r3, [r7, #20]
|
|
800618c: 695b ldr r3, [r3, #20]
|
|
800618e: 431a orrs r2, r3
|
|
8006190: 697b ldr r3, [r7, #20]
|
|
8006192: 69db ldr r3, [r3, #28]
|
|
8006194: 4313 orrs r3, r2
|
|
8006196: 62fb str r3, [r7, #44] @ 0x2c
|
|
MODIFY_REG(huart->Instance->CR1, USART_CR1_FIELDS, tmpreg);
|
|
8006198: 697b ldr r3, [r7, #20]
|
|
800619a: 681b ldr r3, [r3, #0]
|
|
800619c: 681a ldr r2, [r3, #0]
|
|
800619e: 4b94 ldr r3, [pc, #592] @ (80063f0 <UART_SetConfig+0x280>)
|
|
80061a0: 4013 ands r3, r2
|
|
80061a2: 697a ldr r2, [r7, #20]
|
|
80061a4: 6812 ldr r2, [r2, #0]
|
|
80061a6: 6af9 ldr r1, [r7, #44] @ 0x2c
|
|
80061a8: 430b orrs r3, r1
|
|
80061aa: 6013 str r3, [r2, #0]
|
|
|
|
/*-------------------------- USART CR2 Configuration -----------------------*/
|
|
/* Configure the UART Stop Bits: Set STOP[13:12] bits according
|
|
* to huart->Init.StopBits value */
|
|
MODIFY_REG(huart->Instance->CR2, USART_CR2_STOP, huart->Init.StopBits);
|
|
80061ac: 697b ldr r3, [r7, #20]
|
|
80061ae: 681b ldr r3, [r3, #0]
|
|
80061b0: 685b ldr r3, [r3, #4]
|
|
80061b2: f423 5140 bic.w r1, r3, #12288 @ 0x3000
|
|
80061b6: 697b ldr r3, [r7, #20]
|
|
80061b8: 68da ldr r2, [r3, #12]
|
|
80061ba: 697b ldr r3, [r7, #20]
|
|
80061bc: 681b ldr r3, [r3, #0]
|
|
80061be: 430a orrs r2, r1
|
|
80061c0: 605a str r2, [r3, #4]
|
|
/* Configure
|
|
* - UART HardWare Flow Control: set CTSE and RTSE bits according
|
|
* to huart->Init.HwFlowCtl value
|
|
* - one-bit sampling method versus three samples' majority rule according
|
|
* to huart->Init.OneBitSampling (not applicable to LPUART) */
|
|
tmpreg = (uint32_t)huart->Init.HwFlowCtl;
|
|
80061c2: 697b ldr r3, [r7, #20]
|
|
80061c4: 699b ldr r3, [r3, #24]
|
|
80061c6: 62fb str r3, [r7, #44] @ 0x2c
|
|
|
|
if (!(UART_INSTANCE_LOWPOWER(huart)))
|
|
80061c8: 697b ldr r3, [r7, #20]
|
|
80061ca: 681b ldr r3, [r3, #0]
|
|
80061cc: 4a89 ldr r2, [pc, #548] @ (80063f4 <UART_SetConfig+0x284>)
|
|
80061ce: 4293 cmp r3, r2
|
|
80061d0: d004 beq.n 80061dc <UART_SetConfig+0x6c>
|
|
{
|
|
tmpreg |= huart->Init.OneBitSampling;
|
|
80061d2: 697b ldr r3, [r7, #20]
|
|
80061d4: 6a1b ldr r3, [r3, #32]
|
|
80061d6: 6afa ldr r2, [r7, #44] @ 0x2c
|
|
80061d8: 4313 orrs r3, r2
|
|
80061da: 62fb str r3, [r7, #44] @ 0x2c
|
|
}
|
|
MODIFY_REG(huart->Instance->CR3, USART_CR3_FIELDS, tmpreg);
|
|
80061dc: 697b ldr r3, [r7, #20]
|
|
80061de: 681b ldr r3, [r3, #0]
|
|
80061e0: 689b ldr r3, [r3, #8]
|
|
80061e2: f023 436e bic.w r3, r3, #3992977408 @ 0xee000000
|
|
80061e6: f423 6330 bic.w r3, r3, #2816 @ 0xb00
|
|
80061ea: 697a ldr r2, [r7, #20]
|
|
80061ec: 6812 ldr r2, [r2, #0]
|
|
80061ee: 6af9 ldr r1, [r7, #44] @ 0x2c
|
|
80061f0: 430b orrs r3, r1
|
|
80061f2: 6093 str r3, [r2, #8]
|
|
|
|
/*-------------------------- USART PRESC Configuration -----------------------*/
|
|
/* Configure
|
|
* - UART Clock Prescaler : set PRESCALER according to huart->Init.ClockPrescaler value */
|
|
MODIFY_REG(huart->Instance->PRESC, USART_PRESC_PRESCALER, huart->Init.ClockPrescaler);
|
|
80061f4: 697b ldr r3, [r7, #20]
|
|
80061f6: 681b ldr r3, [r3, #0]
|
|
80061f8: 6adb ldr r3, [r3, #44] @ 0x2c
|
|
80061fa: f023 010f bic.w r1, r3, #15
|
|
80061fe: 697b ldr r3, [r7, #20]
|
|
8006200: 6a5a ldr r2, [r3, #36] @ 0x24
|
|
8006202: 697b ldr r3, [r7, #20]
|
|
8006204: 681b ldr r3, [r3, #0]
|
|
8006206: 430a orrs r2, r1
|
|
8006208: 62da str r2, [r3, #44] @ 0x2c
|
|
|
|
/*-------------------------- USART BRR Configuration -----------------------*/
|
|
UART_GETCLOCKSOURCE(huart, clocksource);
|
|
800620a: 697b ldr r3, [r7, #20]
|
|
800620c: 681b ldr r3, [r3, #0]
|
|
800620e: 4a7a ldr r2, [pc, #488] @ (80063f8 <UART_SetConfig+0x288>)
|
|
8006210: 4293 cmp r3, r2
|
|
8006212: d127 bne.n 8006264 <UART_SetConfig+0xf4>
|
|
8006214: 2003 movs r0, #3
|
|
8006216: f7ff f9c3 bl 80055a0 <LL_RCC_GetUSARTClockSource>
|
|
800621a: 4603 mov r3, r0
|
|
800621c: f5a3 3340 sub.w r3, r3, #196608 @ 0x30000
|
|
8006220: 2b03 cmp r3, #3
|
|
8006222: d81b bhi.n 800625c <UART_SetConfig+0xec>
|
|
8006224: a201 add r2, pc, #4 @ (adr r2, 800622c <UART_SetConfig+0xbc>)
|
|
8006226: f852 f023 ldr.w pc, [r2, r3, lsl #2]
|
|
800622a: bf00 nop
|
|
800622c: 0800623d .word 0x0800623d
|
|
8006230: 0800624d .word 0x0800624d
|
|
8006234: 08006245 .word 0x08006245
|
|
8006238: 08006255 .word 0x08006255
|
|
800623c: 2301 movs r3, #1
|
|
800623e: f887 302b strb.w r3, [r7, #43] @ 0x2b
|
|
8006242: e080 b.n 8006346 <UART_SetConfig+0x1d6>
|
|
8006244: 2302 movs r3, #2
|
|
8006246: f887 302b strb.w r3, [r7, #43] @ 0x2b
|
|
800624a: e07c b.n 8006346 <UART_SetConfig+0x1d6>
|
|
800624c: 2304 movs r3, #4
|
|
800624e: f887 302b strb.w r3, [r7, #43] @ 0x2b
|
|
8006252: e078 b.n 8006346 <UART_SetConfig+0x1d6>
|
|
8006254: 2308 movs r3, #8
|
|
8006256: f887 302b strb.w r3, [r7, #43] @ 0x2b
|
|
800625a: e074 b.n 8006346 <UART_SetConfig+0x1d6>
|
|
800625c: 2310 movs r3, #16
|
|
800625e: f887 302b strb.w r3, [r7, #43] @ 0x2b
|
|
8006262: e070 b.n 8006346 <UART_SetConfig+0x1d6>
|
|
8006264: 697b ldr r3, [r7, #20]
|
|
8006266: 681b ldr r3, [r3, #0]
|
|
8006268: 4a64 ldr r2, [pc, #400] @ (80063fc <UART_SetConfig+0x28c>)
|
|
800626a: 4293 cmp r3, r2
|
|
800626c: d138 bne.n 80062e0 <UART_SetConfig+0x170>
|
|
800626e: 200c movs r0, #12
|
|
8006270: f7ff f996 bl 80055a0 <LL_RCC_GetUSARTClockSource>
|
|
8006274: 4603 mov r3, r0
|
|
8006276: f5a3 2340 sub.w r3, r3, #786432 @ 0xc0000
|
|
800627a: 2b0c cmp r3, #12
|
|
800627c: d82c bhi.n 80062d8 <UART_SetConfig+0x168>
|
|
800627e: a201 add r2, pc, #4 @ (adr r2, 8006284 <UART_SetConfig+0x114>)
|
|
8006280: f852 f023 ldr.w pc, [r2, r3, lsl #2]
|
|
8006284: 080062b9 .word 0x080062b9
|
|
8006288: 080062d9 .word 0x080062d9
|
|
800628c: 080062d9 .word 0x080062d9
|
|
8006290: 080062d9 .word 0x080062d9
|
|
8006294: 080062c9 .word 0x080062c9
|
|
8006298: 080062d9 .word 0x080062d9
|
|
800629c: 080062d9 .word 0x080062d9
|
|
80062a0: 080062d9 .word 0x080062d9
|
|
80062a4: 080062c1 .word 0x080062c1
|
|
80062a8: 080062d9 .word 0x080062d9
|
|
80062ac: 080062d9 .word 0x080062d9
|
|
80062b0: 080062d9 .word 0x080062d9
|
|
80062b4: 080062d1 .word 0x080062d1
|
|
80062b8: 2300 movs r3, #0
|
|
80062ba: f887 302b strb.w r3, [r7, #43] @ 0x2b
|
|
80062be: e042 b.n 8006346 <UART_SetConfig+0x1d6>
|
|
80062c0: 2302 movs r3, #2
|
|
80062c2: f887 302b strb.w r3, [r7, #43] @ 0x2b
|
|
80062c6: e03e b.n 8006346 <UART_SetConfig+0x1d6>
|
|
80062c8: 2304 movs r3, #4
|
|
80062ca: f887 302b strb.w r3, [r7, #43] @ 0x2b
|
|
80062ce: e03a b.n 8006346 <UART_SetConfig+0x1d6>
|
|
80062d0: 2308 movs r3, #8
|
|
80062d2: f887 302b strb.w r3, [r7, #43] @ 0x2b
|
|
80062d6: e036 b.n 8006346 <UART_SetConfig+0x1d6>
|
|
80062d8: 2310 movs r3, #16
|
|
80062da: f887 302b strb.w r3, [r7, #43] @ 0x2b
|
|
80062de: e032 b.n 8006346 <UART_SetConfig+0x1d6>
|
|
80062e0: 697b ldr r3, [r7, #20]
|
|
80062e2: 681b ldr r3, [r3, #0]
|
|
80062e4: 4a43 ldr r2, [pc, #268] @ (80063f4 <UART_SetConfig+0x284>)
|
|
80062e6: 4293 cmp r3, r2
|
|
80062e8: d12a bne.n 8006340 <UART_SetConfig+0x1d0>
|
|
80062ea: f44f 6040 mov.w r0, #3072 @ 0xc00
|
|
80062ee: f7ff f969 bl 80055c4 <LL_RCC_GetLPUARTClockSource>
|
|
80062f2: 4603 mov r3, r0
|
|
80062f4: f5b3 6f40 cmp.w r3, #3072 @ 0xc00
|
|
80062f8: d01a beq.n 8006330 <UART_SetConfig+0x1c0>
|
|
80062fa: f5b3 6f40 cmp.w r3, #3072 @ 0xc00
|
|
80062fe: d81b bhi.n 8006338 <UART_SetConfig+0x1c8>
|
|
8006300: f5b3 6f00 cmp.w r3, #2048 @ 0x800
|
|
8006304: d00c beq.n 8006320 <UART_SetConfig+0x1b0>
|
|
8006306: f5b3 6f00 cmp.w r3, #2048 @ 0x800
|
|
800630a: d815 bhi.n 8006338 <UART_SetConfig+0x1c8>
|
|
800630c: 2b00 cmp r3, #0
|
|
800630e: d003 beq.n 8006318 <UART_SetConfig+0x1a8>
|
|
8006310: f5b3 6f80 cmp.w r3, #1024 @ 0x400
|
|
8006314: d008 beq.n 8006328 <UART_SetConfig+0x1b8>
|
|
8006316: e00f b.n 8006338 <UART_SetConfig+0x1c8>
|
|
8006318: 2300 movs r3, #0
|
|
800631a: f887 302b strb.w r3, [r7, #43] @ 0x2b
|
|
800631e: e012 b.n 8006346 <UART_SetConfig+0x1d6>
|
|
8006320: 2302 movs r3, #2
|
|
8006322: f887 302b strb.w r3, [r7, #43] @ 0x2b
|
|
8006326: e00e b.n 8006346 <UART_SetConfig+0x1d6>
|
|
8006328: 2304 movs r3, #4
|
|
800632a: f887 302b strb.w r3, [r7, #43] @ 0x2b
|
|
800632e: e00a b.n 8006346 <UART_SetConfig+0x1d6>
|
|
8006330: 2308 movs r3, #8
|
|
8006332: f887 302b strb.w r3, [r7, #43] @ 0x2b
|
|
8006336: e006 b.n 8006346 <UART_SetConfig+0x1d6>
|
|
8006338: 2310 movs r3, #16
|
|
800633a: f887 302b strb.w r3, [r7, #43] @ 0x2b
|
|
800633e: e002 b.n 8006346 <UART_SetConfig+0x1d6>
|
|
8006340: 2310 movs r3, #16
|
|
8006342: f887 302b strb.w r3, [r7, #43] @ 0x2b
|
|
|
|
/* Check LPUART instance */
|
|
if (UART_INSTANCE_LOWPOWER(huart))
|
|
8006346: 697b ldr r3, [r7, #20]
|
|
8006348: 681b ldr r3, [r3, #0]
|
|
800634a: 4a2a ldr r2, [pc, #168] @ (80063f4 <UART_SetConfig+0x284>)
|
|
800634c: 4293 cmp r3, r2
|
|
800634e: f040 80a4 bne.w 800649a <UART_SetConfig+0x32a>
|
|
{
|
|
/* Retrieve frequency clock */
|
|
switch (clocksource)
|
|
8006352: f897 302b ldrb.w r3, [r7, #43] @ 0x2b
|
|
8006356: 2b08 cmp r3, #8
|
|
8006358: d823 bhi.n 80063a2 <UART_SetConfig+0x232>
|
|
800635a: a201 add r2, pc, #4 @ (adr r2, 8006360 <UART_SetConfig+0x1f0>)
|
|
800635c: f852 f023 ldr.w pc, [r2, r3, lsl #2]
|
|
8006360: 08006385 .word 0x08006385
|
|
8006364: 080063a3 .word 0x080063a3
|
|
8006368: 0800638d .word 0x0800638d
|
|
800636c: 080063a3 .word 0x080063a3
|
|
8006370: 08006393 .word 0x08006393
|
|
8006374: 080063a3 .word 0x080063a3
|
|
8006378: 080063a3 .word 0x080063a3
|
|
800637c: 080063a3 .word 0x080063a3
|
|
8006380: 0800639b .word 0x0800639b
|
|
{
|
|
case UART_CLOCKSOURCE_PCLK1:
|
|
pclk = HAL_RCC_GetPCLK1Freq();
|
|
8006384: f7fd fdc6 bl 8003f14 <HAL_RCC_GetPCLK1Freq>
|
|
8006388: 6278 str r0, [r7, #36] @ 0x24
|
|
break;
|
|
800638a: e010 b.n 80063ae <UART_SetConfig+0x23e>
|
|
case UART_CLOCKSOURCE_HSI:
|
|
pclk = (uint32_t) HSI_VALUE;
|
|
800638c: 4b1c ldr r3, [pc, #112] @ (8006400 <UART_SetConfig+0x290>)
|
|
800638e: 627b str r3, [r7, #36] @ 0x24
|
|
break;
|
|
8006390: e00d b.n 80063ae <UART_SetConfig+0x23e>
|
|
case UART_CLOCKSOURCE_SYSCLK:
|
|
pclk = HAL_RCC_GetSysClockFreq();
|
|
8006392: f7fd fd0b bl 8003dac <HAL_RCC_GetSysClockFreq>
|
|
8006396: 6278 str r0, [r7, #36] @ 0x24
|
|
break;
|
|
8006398: e009 b.n 80063ae <UART_SetConfig+0x23e>
|
|
case UART_CLOCKSOURCE_LSE:
|
|
pclk = (uint32_t) LSE_VALUE;
|
|
800639a: f44f 4300 mov.w r3, #32768 @ 0x8000
|
|
800639e: 627b str r3, [r7, #36] @ 0x24
|
|
break;
|
|
80063a0: e005 b.n 80063ae <UART_SetConfig+0x23e>
|
|
default:
|
|
pclk = 0U;
|
|
80063a2: 2300 movs r3, #0
|
|
80063a4: 627b str r3, [r7, #36] @ 0x24
|
|
ret = HAL_ERROR;
|
|
80063a6: 2301 movs r3, #1
|
|
80063a8: f887 302a strb.w r3, [r7, #42] @ 0x2a
|
|
break;
|
|
80063ac: bf00 nop
|
|
}
|
|
|
|
/* If proper clock source reported */
|
|
if (pclk != 0U)
|
|
80063ae: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
80063b0: 2b00 cmp r3, #0
|
|
80063b2: f000 8137 beq.w 8006624 <UART_SetConfig+0x4b4>
|
|
{
|
|
/* Compute clock after Prescaler */
|
|
lpuart_ker_ck_pres = (pclk / UARTPrescTable[huart->Init.ClockPrescaler]);
|
|
80063b6: 697b ldr r3, [r7, #20]
|
|
80063b8: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
80063ba: 4a12 ldr r2, [pc, #72] @ (8006404 <UART_SetConfig+0x294>)
|
|
80063bc: f832 3013 ldrh.w r3, [r2, r3, lsl #1]
|
|
80063c0: 461a mov r2, r3
|
|
80063c2: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
80063c4: fbb3 f3f2 udiv r3, r3, r2
|
|
80063c8: 61bb str r3, [r7, #24]
|
|
|
|
/* Ensure that Frequency clock is in the range [3 * baudrate, 4096 * baudrate] */
|
|
if ((lpuart_ker_ck_pres < (3U * huart->Init.BaudRate)) ||
|
|
80063ca: 697b ldr r3, [r7, #20]
|
|
80063cc: 685a ldr r2, [r3, #4]
|
|
80063ce: 4613 mov r3, r2
|
|
80063d0: 005b lsls r3, r3, #1
|
|
80063d2: 4413 add r3, r2
|
|
80063d4: 69ba ldr r2, [r7, #24]
|
|
80063d6: 429a cmp r2, r3
|
|
80063d8: d305 bcc.n 80063e6 <UART_SetConfig+0x276>
|
|
(lpuart_ker_ck_pres > (4096U * huart->Init.BaudRate)))
|
|
80063da: 697b ldr r3, [r7, #20]
|
|
80063dc: 685b ldr r3, [r3, #4]
|
|
80063de: 031b lsls r3, r3, #12
|
|
if ((lpuart_ker_ck_pres < (3U * huart->Init.BaudRate)) ||
|
|
80063e0: 69ba ldr r2, [r7, #24]
|
|
80063e2: 429a cmp r2, r3
|
|
80063e4: d910 bls.n 8006408 <UART_SetConfig+0x298>
|
|
{
|
|
ret = HAL_ERROR;
|
|
80063e6: 2301 movs r3, #1
|
|
80063e8: f887 302a strb.w r3, [r7, #42] @ 0x2a
|
|
80063ec: e11a b.n 8006624 <UART_SetConfig+0x4b4>
|
|
80063ee: bf00 nop
|
|
80063f0: cfff69f3 .word 0xcfff69f3
|
|
80063f4: 40008000 .word 0x40008000
|
|
80063f8: 40013800 .word 0x40013800
|
|
80063fc: 40004400 .word 0x40004400
|
|
8006400: 00f42400 .word 0x00f42400
|
|
8006404: 0801039c .word 0x0801039c
|
|
}
|
|
else
|
|
{
|
|
/* Check computed UsartDiv value is in allocated range
|
|
(it is forbidden to write values lower than 0x300 in the LPUART_BRR register) */
|
|
usartdiv = (uint32_t)(UART_DIV_LPUART(pclk, huart->Init.BaudRate, huart->Init.ClockPrescaler));
|
|
8006408: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
800640a: 2200 movs r2, #0
|
|
800640c: 60bb str r3, [r7, #8]
|
|
800640e: 60fa str r2, [r7, #12]
|
|
8006410: 697b ldr r3, [r7, #20]
|
|
8006412: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
8006414: 4a8e ldr r2, [pc, #568] @ (8006650 <UART_SetConfig+0x4e0>)
|
|
8006416: f832 3013 ldrh.w r3, [r2, r3, lsl #1]
|
|
800641a: b29b uxth r3, r3
|
|
800641c: 2200 movs r2, #0
|
|
800641e: 603b str r3, [r7, #0]
|
|
8006420: 607a str r2, [r7, #4]
|
|
8006422: e9d7 2300 ldrd r2, r3, [r7]
|
|
8006426: e9d7 0102 ldrd r0, r1, [r7, #8]
|
|
800642a: f7f9 ff11 bl 8000250 <__aeabi_uldivmod>
|
|
800642e: 4602 mov r2, r0
|
|
8006430: 460b mov r3, r1
|
|
8006432: 4610 mov r0, r2
|
|
8006434: 4619 mov r1, r3
|
|
8006436: f04f 0200 mov.w r2, #0
|
|
800643a: f04f 0300 mov.w r3, #0
|
|
800643e: 020b lsls r3, r1, #8
|
|
8006440: ea43 6310 orr.w r3, r3, r0, lsr #24
|
|
8006444: 0202 lsls r2, r0, #8
|
|
8006446: 6979 ldr r1, [r7, #20]
|
|
8006448: 6849 ldr r1, [r1, #4]
|
|
800644a: 0849 lsrs r1, r1, #1
|
|
800644c: 2000 movs r0, #0
|
|
800644e: 460c mov r4, r1
|
|
8006450: 4605 mov r5, r0
|
|
8006452: eb12 0804 adds.w r8, r2, r4
|
|
8006456: eb43 0905 adc.w r9, r3, r5
|
|
800645a: 697b ldr r3, [r7, #20]
|
|
800645c: 685b ldr r3, [r3, #4]
|
|
800645e: 2200 movs r2, #0
|
|
8006460: 469a mov sl, r3
|
|
8006462: 4693 mov fp, r2
|
|
8006464: 4652 mov r2, sl
|
|
8006466: 465b mov r3, fp
|
|
8006468: 4640 mov r0, r8
|
|
800646a: 4649 mov r1, r9
|
|
800646c: f7f9 fef0 bl 8000250 <__aeabi_uldivmod>
|
|
8006470: 4602 mov r2, r0
|
|
8006472: 460b mov r3, r1
|
|
8006474: 4613 mov r3, r2
|
|
8006476: 623b str r3, [r7, #32]
|
|
if ((usartdiv >= LPUART_BRR_MIN) && (usartdiv <= LPUART_BRR_MAX))
|
|
8006478: 6a3b ldr r3, [r7, #32]
|
|
800647a: f5b3 7f40 cmp.w r3, #768 @ 0x300
|
|
800647e: d308 bcc.n 8006492 <UART_SetConfig+0x322>
|
|
8006480: 6a3b ldr r3, [r7, #32]
|
|
8006482: f5b3 1f80 cmp.w r3, #1048576 @ 0x100000
|
|
8006486: d204 bcs.n 8006492 <UART_SetConfig+0x322>
|
|
{
|
|
huart->Instance->BRR = usartdiv;
|
|
8006488: 697b ldr r3, [r7, #20]
|
|
800648a: 681b ldr r3, [r3, #0]
|
|
800648c: 6a3a ldr r2, [r7, #32]
|
|
800648e: 60da str r2, [r3, #12]
|
|
8006490: e0c8 b.n 8006624 <UART_SetConfig+0x4b4>
|
|
}
|
|
else
|
|
{
|
|
ret = HAL_ERROR;
|
|
8006492: 2301 movs r3, #1
|
|
8006494: f887 302a strb.w r3, [r7, #42] @ 0x2a
|
|
8006498: e0c4 b.n 8006624 <UART_SetConfig+0x4b4>
|
|
} /* if ( (lpuart_ker_ck_pres < (3 * huart->Init.BaudRate) ) ||
|
|
(lpuart_ker_ck_pres > (4096 * huart->Init.BaudRate) )) */
|
|
} /* if (pclk != 0) */
|
|
}
|
|
/* Check UART Over Sampling to set Baud Rate Register */
|
|
else if (huart->Init.OverSampling == UART_OVERSAMPLING_8)
|
|
800649a: 697b ldr r3, [r7, #20]
|
|
800649c: 69db ldr r3, [r3, #28]
|
|
800649e: f5b3 4f00 cmp.w r3, #32768 @ 0x8000
|
|
80064a2: d167 bne.n 8006574 <UART_SetConfig+0x404>
|
|
{
|
|
switch (clocksource)
|
|
80064a4: f897 302b ldrb.w r3, [r7, #43] @ 0x2b
|
|
80064a8: 2b08 cmp r3, #8
|
|
80064aa: d828 bhi.n 80064fe <UART_SetConfig+0x38e>
|
|
80064ac: a201 add r2, pc, #4 @ (adr r2, 80064b4 <UART_SetConfig+0x344>)
|
|
80064ae: f852 f023 ldr.w pc, [r2, r3, lsl #2]
|
|
80064b2: bf00 nop
|
|
80064b4: 080064d9 .word 0x080064d9
|
|
80064b8: 080064e1 .word 0x080064e1
|
|
80064bc: 080064e9 .word 0x080064e9
|
|
80064c0: 080064ff .word 0x080064ff
|
|
80064c4: 080064ef .word 0x080064ef
|
|
80064c8: 080064ff .word 0x080064ff
|
|
80064cc: 080064ff .word 0x080064ff
|
|
80064d0: 080064ff .word 0x080064ff
|
|
80064d4: 080064f7 .word 0x080064f7
|
|
{
|
|
case UART_CLOCKSOURCE_PCLK1:
|
|
pclk = HAL_RCC_GetPCLK1Freq();
|
|
80064d8: f7fd fd1c bl 8003f14 <HAL_RCC_GetPCLK1Freq>
|
|
80064dc: 6278 str r0, [r7, #36] @ 0x24
|
|
break;
|
|
80064de: e014 b.n 800650a <UART_SetConfig+0x39a>
|
|
case UART_CLOCKSOURCE_PCLK2:
|
|
pclk = HAL_RCC_GetPCLK2Freq();
|
|
80064e0: f7fd fd2a bl 8003f38 <HAL_RCC_GetPCLK2Freq>
|
|
80064e4: 6278 str r0, [r7, #36] @ 0x24
|
|
break;
|
|
80064e6: e010 b.n 800650a <UART_SetConfig+0x39a>
|
|
case UART_CLOCKSOURCE_HSI:
|
|
pclk = (uint32_t) HSI_VALUE;
|
|
80064e8: 4b5a ldr r3, [pc, #360] @ (8006654 <UART_SetConfig+0x4e4>)
|
|
80064ea: 627b str r3, [r7, #36] @ 0x24
|
|
break;
|
|
80064ec: e00d b.n 800650a <UART_SetConfig+0x39a>
|
|
case UART_CLOCKSOURCE_SYSCLK:
|
|
pclk = HAL_RCC_GetSysClockFreq();
|
|
80064ee: f7fd fc5d bl 8003dac <HAL_RCC_GetSysClockFreq>
|
|
80064f2: 6278 str r0, [r7, #36] @ 0x24
|
|
break;
|
|
80064f4: e009 b.n 800650a <UART_SetConfig+0x39a>
|
|
case UART_CLOCKSOURCE_LSE:
|
|
pclk = (uint32_t) LSE_VALUE;
|
|
80064f6: f44f 4300 mov.w r3, #32768 @ 0x8000
|
|
80064fa: 627b str r3, [r7, #36] @ 0x24
|
|
break;
|
|
80064fc: e005 b.n 800650a <UART_SetConfig+0x39a>
|
|
default:
|
|
pclk = 0U;
|
|
80064fe: 2300 movs r3, #0
|
|
8006500: 627b str r3, [r7, #36] @ 0x24
|
|
ret = HAL_ERROR;
|
|
8006502: 2301 movs r3, #1
|
|
8006504: f887 302a strb.w r3, [r7, #42] @ 0x2a
|
|
break;
|
|
8006508: bf00 nop
|
|
}
|
|
|
|
/* USARTDIV must be greater than or equal to 0d16 */
|
|
if (pclk != 0U)
|
|
800650a: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
800650c: 2b00 cmp r3, #0
|
|
800650e: f000 8089 beq.w 8006624 <UART_SetConfig+0x4b4>
|
|
{
|
|
usartdiv = (uint32_t)(UART_DIV_SAMPLING8(pclk, huart->Init.BaudRate, huart->Init.ClockPrescaler));
|
|
8006512: 697b ldr r3, [r7, #20]
|
|
8006514: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
8006516: 4a4e ldr r2, [pc, #312] @ (8006650 <UART_SetConfig+0x4e0>)
|
|
8006518: f832 3013 ldrh.w r3, [r2, r3, lsl #1]
|
|
800651c: 461a mov r2, r3
|
|
800651e: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8006520: fbb3 f3f2 udiv r3, r3, r2
|
|
8006524: 005a lsls r2, r3, #1
|
|
8006526: 697b ldr r3, [r7, #20]
|
|
8006528: 685b ldr r3, [r3, #4]
|
|
800652a: 085b lsrs r3, r3, #1
|
|
800652c: 441a add r2, r3
|
|
800652e: 697b ldr r3, [r7, #20]
|
|
8006530: 685b ldr r3, [r3, #4]
|
|
8006532: fbb2 f3f3 udiv r3, r2, r3
|
|
8006536: 623b str r3, [r7, #32]
|
|
if ((usartdiv >= UART_BRR_MIN) && (usartdiv <= UART_BRR_MAX))
|
|
8006538: 6a3b ldr r3, [r7, #32]
|
|
800653a: 2b0f cmp r3, #15
|
|
800653c: d916 bls.n 800656c <UART_SetConfig+0x3fc>
|
|
800653e: 6a3b ldr r3, [r7, #32]
|
|
8006540: f5b3 3f80 cmp.w r3, #65536 @ 0x10000
|
|
8006544: d212 bcs.n 800656c <UART_SetConfig+0x3fc>
|
|
{
|
|
brrtemp = (uint16_t)(usartdiv & 0xFFF0U);
|
|
8006546: 6a3b ldr r3, [r7, #32]
|
|
8006548: b29b uxth r3, r3
|
|
800654a: f023 030f bic.w r3, r3, #15
|
|
800654e: 83fb strh r3, [r7, #30]
|
|
brrtemp |= (uint16_t)((usartdiv & (uint16_t)0x000FU) >> 1U);
|
|
8006550: 6a3b ldr r3, [r7, #32]
|
|
8006552: 085b lsrs r3, r3, #1
|
|
8006554: b29b uxth r3, r3
|
|
8006556: f003 0307 and.w r3, r3, #7
|
|
800655a: b29a uxth r2, r3
|
|
800655c: 8bfb ldrh r3, [r7, #30]
|
|
800655e: 4313 orrs r3, r2
|
|
8006560: 83fb strh r3, [r7, #30]
|
|
huart->Instance->BRR = brrtemp;
|
|
8006562: 697b ldr r3, [r7, #20]
|
|
8006564: 681b ldr r3, [r3, #0]
|
|
8006566: 8bfa ldrh r2, [r7, #30]
|
|
8006568: 60da str r2, [r3, #12]
|
|
800656a: e05b b.n 8006624 <UART_SetConfig+0x4b4>
|
|
}
|
|
else
|
|
{
|
|
ret = HAL_ERROR;
|
|
800656c: 2301 movs r3, #1
|
|
800656e: f887 302a strb.w r3, [r7, #42] @ 0x2a
|
|
8006572: e057 b.n 8006624 <UART_SetConfig+0x4b4>
|
|
}
|
|
}
|
|
}
|
|
else
|
|
{
|
|
switch (clocksource)
|
|
8006574: f897 302b ldrb.w r3, [r7, #43] @ 0x2b
|
|
8006578: 2b08 cmp r3, #8
|
|
800657a: d828 bhi.n 80065ce <UART_SetConfig+0x45e>
|
|
800657c: a201 add r2, pc, #4 @ (adr r2, 8006584 <UART_SetConfig+0x414>)
|
|
800657e: f852 f023 ldr.w pc, [r2, r3, lsl #2]
|
|
8006582: bf00 nop
|
|
8006584: 080065a9 .word 0x080065a9
|
|
8006588: 080065b1 .word 0x080065b1
|
|
800658c: 080065b9 .word 0x080065b9
|
|
8006590: 080065cf .word 0x080065cf
|
|
8006594: 080065bf .word 0x080065bf
|
|
8006598: 080065cf .word 0x080065cf
|
|
800659c: 080065cf .word 0x080065cf
|
|
80065a0: 080065cf .word 0x080065cf
|
|
80065a4: 080065c7 .word 0x080065c7
|
|
{
|
|
case UART_CLOCKSOURCE_PCLK1:
|
|
pclk = HAL_RCC_GetPCLK1Freq();
|
|
80065a8: f7fd fcb4 bl 8003f14 <HAL_RCC_GetPCLK1Freq>
|
|
80065ac: 6278 str r0, [r7, #36] @ 0x24
|
|
break;
|
|
80065ae: e014 b.n 80065da <UART_SetConfig+0x46a>
|
|
case UART_CLOCKSOURCE_PCLK2:
|
|
pclk = HAL_RCC_GetPCLK2Freq();
|
|
80065b0: f7fd fcc2 bl 8003f38 <HAL_RCC_GetPCLK2Freq>
|
|
80065b4: 6278 str r0, [r7, #36] @ 0x24
|
|
break;
|
|
80065b6: e010 b.n 80065da <UART_SetConfig+0x46a>
|
|
case UART_CLOCKSOURCE_HSI:
|
|
pclk = (uint32_t) HSI_VALUE;
|
|
80065b8: 4b26 ldr r3, [pc, #152] @ (8006654 <UART_SetConfig+0x4e4>)
|
|
80065ba: 627b str r3, [r7, #36] @ 0x24
|
|
break;
|
|
80065bc: e00d b.n 80065da <UART_SetConfig+0x46a>
|
|
case UART_CLOCKSOURCE_SYSCLK:
|
|
pclk = HAL_RCC_GetSysClockFreq();
|
|
80065be: f7fd fbf5 bl 8003dac <HAL_RCC_GetSysClockFreq>
|
|
80065c2: 6278 str r0, [r7, #36] @ 0x24
|
|
break;
|
|
80065c4: e009 b.n 80065da <UART_SetConfig+0x46a>
|
|
case UART_CLOCKSOURCE_LSE:
|
|
pclk = (uint32_t) LSE_VALUE;
|
|
80065c6: f44f 4300 mov.w r3, #32768 @ 0x8000
|
|
80065ca: 627b str r3, [r7, #36] @ 0x24
|
|
break;
|
|
80065cc: e005 b.n 80065da <UART_SetConfig+0x46a>
|
|
default:
|
|
pclk = 0U;
|
|
80065ce: 2300 movs r3, #0
|
|
80065d0: 627b str r3, [r7, #36] @ 0x24
|
|
ret = HAL_ERROR;
|
|
80065d2: 2301 movs r3, #1
|
|
80065d4: f887 302a strb.w r3, [r7, #42] @ 0x2a
|
|
break;
|
|
80065d8: bf00 nop
|
|
}
|
|
|
|
if (pclk != 0U)
|
|
80065da: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
80065dc: 2b00 cmp r3, #0
|
|
80065de: d021 beq.n 8006624 <UART_SetConfig+0x4b4>
|
|
{
|
|
/* USARTDIV must be greater than or equal to 0d16 */
|
|
usartdiv = (uint32_t)(UART_DIV_SAMPLING16(pclk, huart->Init.BaudRate, huart->Init.ClockPrescaler));
|
|
80065e0: 697b ldr r3, [r7, #20]
|
|
80065e2: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
80065e4: 4a1a ldr r2, [pc, #104] @ (8006650 <UART_SetConfig+0x4e0>)
|
|
80065e6: f832 3013 ldrh.w r3, [r2, r3, lsl #1]
|
|
80065ea: 461a mov r2, r3
|
|
80065ec: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
80065ee: fbb3 f2f2 udiv r2, r3, r2
|
|
80065f2: 697b ldr r3, [r7, #20]
|
|
80065f4: 685b ldr r3, [r3, #4]
|
|
80065f6: 085b lsrs r3, r3, #1
|
|
80065f8: 441a add r2, r3
|
|
80065fa: 697b ldr r3, [r7, #20]
|
|
80065fc: 685b ldr r3, [r3, #4]
|
|
80065fe: fbb2 f3f3 udiv r3, r2, r3
|
|
8006602: 623b str r3, [r7, #32]
|
|
if ((usartdiv >= UART_BRR_MIN) && (usartdiv <= UART_BRR_MAX))
|
|
8006604: 6a3b ldr r3, [r7, #32]
|
|
8006606: 2b0f cmp r3, #15
|
|
8006608: d909 bls.n 800661e <UART_SetConfig+0x4ae>
|
|
800660a: 6a3b ldr r3, [r7, #32]
|
|
800660c: f5b3 3f80 cmp.w r3, #65536 @ 0x10000
|
|
8006610: d205 bcs.n 800661e <UART_SetConfig+0x4ae>
|
|
{
|
|
huart->Instance->BRR = (uint16_t)usartdiv;
|
|
8006612: 6a3b ldr r3, [r7, #32]
|
|
8006614: b29a uxth r2, r3
|
|
8006616: 697b ldr r3, [r7, #20]
|
|
8006618: 681b ldr r3, [r3, #0]
|
|
800661a: 60da str r2, [r3, #12]
|
|
800661c: e002 b.n 8006624 <UART_SetConfig+0x4b4>
|
|
}
|
|
else
|
|
{
|
|
ret = HAL_ERROR;
|
|
800661e: 2301 movs r3, #1
|
|
8006620: f887 302a strb.w r3, [r7, #42] @ 0x2a
|
|
}
|
|
}
|
|
}
|
|
|
|
/* Initialize the number of data to process during RX/TX ISR execution */
|
|
huart->NbTxDataToProcess = 1;
|
|
8006624: 697b ldr r3, [r7, #20]
|
|
8006626: 2201 movs r2, #1
|
|
8006628: f8a3 206a strh.w r2, [r3, #106] @ 0x6a
|
|
huart->NbRxDataToProcess = 1;
|
|
800662c: 697b ldr r3, [r7, #20]
|
|
800662e: 2201 movs r2, #1
|
|
8006630: f8a3 2068 strh.w r2, [r3, #104] @ 0x68
|
|
|
|
/* Clear ISR function pointers */
|
|
huart->RxISR = NULL;
|
|
8006634: 697b ldr r3, [r7, #20]
|
|
8006636: 2200 movs r2, #0
|
|
8006638: 675a str r2, [r3, #116] @ 0x74
|
|
huart->TxISR = NULL;
|
|
800663a: 697b ldr r3, [r7, #20]
|
|
800663c: 2200 movs r2, #0
|
|
800663e: 679a str r2, [r3, #120] @ 0x78
|
|
|
|
return ret;
|
|
8006640: f897 302a ldrb.w r3, [r7, #42] @ 0x2a
|
|
}
|
|
8006644: 4618 mov r0, r3
|
|
8006646: 3730 adds r7, #48 @ 0x30
|
|
8006648: 46bd mov sp, r7
|
|
800664a: e8bd 8fb0 ldmia.w sp!, {r4, r5, r7, r8, r9, sl, fp, pc}
|
|
800664e: bf00 nop
|
|
8006650: 0801039c .word 0x0801039c
|
|
8006654: 00f42400 .word 0x00f42400
|
|
|
|
08006658 <UART_AdvFeatureConfig>:
|
|
* @brief Configure the UART peripheral advanced features.
|
|
* @param huart UART handle.
|
|
* @retval None
|
|
*/
|
|
void UART_AdvFeatureConfig(UART_HandleTypeDef *huart)
|
|
{
|
|
8006658: b480 push {r7}
|
|
800665a: b083 sub sp, #12
|
|
800665c: af00 add r7, sp, #0
|
|
800665e: 6078 str r0, [r7, #4]
|
|
/* Check whether the set of advanced features to configure is properly set */
|
|
assert_param(IS_UART_ADVFEATURE_INIT(huart->AdvancedInit.AdvFeatureInit));
|
|
|
|
/* if required, configure RX/TX pins swap */
|
|
if (HAL_IS_BIT_SET(huart->AdvancedInit.AdvFeatureInit, UART_ADVFEATURE_SWAP_INIT))
|
|
8006660: 687b ldr r3, [r7, #4]
|
|
8006662: 6a9b ldr r3, [r3, #40] @ 0x28
|
|
8006664: f003 0308 and.w r3, r3, #8
|
|
8006668: 2b00 cmp r3, #0
|
|
800666a: d00a beq.n 8006682 <UART_AdvFeatureConfig+0x2a>
|
|
{
|
|
assert_param(IS_UART_ADVFEATURE_SWAP(huart->AdvancedInit.Swap));
|
|
MODIFY_REG(huart->Instance->CR2, USART_CR2_SWAP, huart->AdvancedInit.Swap);
|
|
800666c: 687b ldr r3, [r7, #4]
|
|
800666e: 681b ldr r3, [r3, #0]
|
|
8006670: 685b ldr r3, [r3, #4]
|
|
8006672: f423 4100 bic.w r1, r3, #32768 @ 0x8000
|
|
8006676: 687b ldr r3, [r7, #4]
|
|
8006678: 6b9a ldr r2, [r3, #56] @ 0x38
|
|
800667a: 687b ldr r3, [r7, #4]
|
|
800667c: 681b ldr r3, [r3, #0]
|
|
800667e: 430a orrs r2, r1
|
|
8006680: 605a str r2, [r3, #4]
|
|
}
|
|
|
|
/* if required, configure TX pin active level inversion */
|
|
if (HAL_IS_BIT_SET(huart->AdvancedInit.AdvFeatureInit, UART_ADVFEATURE_TXINVERT_INIT))
|
|
8006682: 687b ldr r3, [r7, #4]
|
|
8006684: 6a9b ldr r3, [r3, #40] @ 0x28
|
|
8006686: f003 0301 and.w r3, r3, #1
|
|
800668a: 2b00 cmp r3, #0
|
|
800668c: d00a beq.n 80066a4 <UART_AdvFeatureConfig+0x4c>
|
|
{
|
|
assert_param(IS_UART_ADVFEATURE_TXINV(huart->AdvancedInit.TxPinLevelInvert));
|
|
MODIFY_REG(huart->Instance->CR2, USART_CR2_TXINV, huart->AdvancedInit.TxPinLevelInvert);
|
|
800668e: 687b ldr r3, [r7, #4]
|
|
8006690: 681b ldr r3, [r3, #0]
|
|
8006692: 685b ldr r3, [r3, #4]
|
|
8006694: f423 3100 bic.w r1, r3, #131072 @ 0x20000
|
|
8006698: 687b ldr r3, [r7, #4]
|
|
800669a: 6ada ldr r2, [r3, #44] @ 0x2c
|
|
800669c: 687b ldr r3, [r7, #4]
|
|
800669e: 681b ldr r3, [r3, #0]
|
|
80066a0: 430a orrs r2, r1
|
|
80066a2: 605a str r2, [r3, #4]
|
|
}
|
|
|
|
/* if required, configure RX pin active level inversion */
|
|
if (HAL_IS_BIT_SET(huart->AdvancedInit.AdvFeatureInit, UART_ADVFEATURE_RXINVERT_INIT))
|
|
80066a4: 687b ldr r3, [r7, #4]
|
|
80066a6: 6a9b ldr r3, [r3, #40] @ 0x28
|
|
80066a8: f003 0302 and.w r3, r3, #2
|
|
80066ac: 2b00 cmp r3, #0
|
|
80066ae: d00a beq.n 80066c6 <UART_AdvFeatureConfig+0x6e>
|
|
{
|
|
assert_param(IS_UART_ADVFEATURE_RXINV(huart->AdvancedInit.RxPinLevelInvert));
|
|
MODIFY_REG(huart->Instance->CR2, USART_CR2_RXINV, huart->AdvancedInit.RxPinLevelInvert);
|
|
80066b0: 687b ldr r3, [r7, #4]
|
|
80066b2: 681b ldr r3, [r3, #0]
|
|
80066b4: 685b ldr r3, [r3, #4]
|
|
80066b6: f423 3180 bic.w r1, r3, #65536 @ 0x10000
|
|
80066ba: 687b ldr r3, [r7, #4]
|
|
80066bc: 6b1a ldr r2, [r3, #48] @ 0x30
|
|
80066be: 687b ldr r3, [r7, #4]
|
|
80066c0: 681b ldr r3, [r3, #0]
|
|
80066c2: 430a orrs r2, r1
|
|
80066c4: 605a str r2, [r3, #4]
|
|
}
|
|
|
|
/* if required, configure data inversion */
|
|
if (HAL_IS_BIT_SET(huart->AdvancedInit.AdvFeatureInit, UART_ADVFEATURE_DATAINVERT_INIT))
|
|
80066c6: 687b ldr r3, [r7, #4]
|
|
80066c8: 6a9b ldr r3, [r3, #40] @ 0x28
|
|
80066ca: f003 0304 and.w r3, r3, #4
|
|
80066ce: 2b00 cmp r3, #0
|
|
80066d0: d00a beq.n 80066e8 <UART_AdvFeatureConfig+0x90>
|
|
{
|
|
assert_param(IS_UART_ADVFEATURE_DATAINV(huart->AdvancedInit.DataInvert));
|
|
MODIFY_REG(huart->Instance->CR2, USART_CR2_DATAINV, huart->AdvancedInit.DataInvert);
|
|
80066d2: 687b ldr r3, [r7, #4]
|
|
80066d4: 681b ldr r3, [r3, #0]
|
|
80066d6: 685b ldr r3, [r3, #4]
|
|
80066d8: f423 2180 bic.w r1, r3, #262144 @ 0x40000
|
|
80066dc: 687b ldr r3, [r7, #4]
|
|
80066de: 6b5a ldr r2, [r3, #52] @ 0x34
|
|
80066e0: 687b ldr r3, [r7, #4]
|
|
80066e2: 681b ldr r3, [r3, #0]
|
|
80066e4: 430a orrs r2, r1
|
|
80066e6: 605a str r2, [r3, #4]
|
|
}
|
|
|
|
/* if required, configure RX overrun detection disabling */
|
|
if (HAL_IS_BIT_SET(huart->AdvancedInit.AdvFeatureInit, UART_ADVFEATURE_RXOVERRUNDISABLE_INIT))
|
|
80066e8: 687b ldr r3, [r7, #4]
|
|
80066ea: 6a9b ldr r3, [r3, #40] @ 0x28
|
|
80066ec: f003 0310 and.w r3, r3, #16
|
|
80066f0: 2b00 cmp r3, #0
|
|
80066f2: d00a beq.n 800670a <UART_AdvFeatureConfig+0xb2>
|
|
{
|
|
assert_param(IS_UART_OVERRUN(huart->AdvancedInit.OverrunDisable));
|
|
MODIFY_REG(huart->Instance->CR3, USART_CR3_OVRDIS, huart->AdvancedInit.OverrunDisable);
|
|
80066f4: 687b ldr r3, [r7, #4]
|
|
80066f6: 681b ldr r3, [r3, #0]
|
|
80066f8: 689b ldr r3, [r3, #8]
|
|
80066fa: f423 5180 bic.w r1, r3, #4096 @ 0x1000
|
|
80066fe: 687b ldr r3, [r7, #4]
|
|
8006700: 6bda ldr r2, [r3, #60] @ 0x3c
|
|
8006702: 687b ldr r3, [r7, #4]
|
|
8006704: 681b ldr r3, [r3, #0]
|
|
8006706: 430a orrs r2, r1
|
|
8006708: 609a str r2, [r3, #8]
|
|
}
|
|
|
|
/* if required, configure DMA disabling on reception error */
|
|
if (HAL_IS_BIT_SET(huart->AdvancedInit.AdvFeatureInit, UART_ADVFEATURE_DMADISABLEONERROR_INIT))
|
|
800670a: 687b ldr r3, [r7, #4]
|
|
800670c: 6a9b ldr r3, [r3, #40] @ 0x28
|
|
800670e: f003 0320 and.w r3, r3, #32
|
|
8006712: 2b00 cmp r3, #0
|
|
8006714: d00a beq.n 800672c <UART_AdvFeatureConfig+0xd4>
|
|
{
|
|
assert_param(IS_UART_ADVFEATURE_DMAONRXERROR(huart->AdvancedInit.DMADisableonRxError));
|
|
MODIFY_REG(huart->Instance->CR3, USART_CR3_DDRE, huart->AdvancedInit.DMADisableonRxError);
|
|
8006716: 687b ldr r3, [r7, #4]
|
|
8006718: 681b ldr r3, [r3, #0]
|
|
800671a: 689b ldr r3, [r3, #8]
|
|
800671c: f423 5100 bic.w r1, r3, #8192 @ 0x2000
|
|
8006720: 687b ldr r3, [r7, #4]
|
|
8006722: 6c1a ldr r2, [r3, #64] @ 0x40
|
|
8006724: 687b ldr r3, [r7, #4]
|
|
8006726: 681b ldr r3, [r3, #0]
|
|
8006728: 430a orrs r2, r1
|
|
800672a: 609a str r2, [r3, #8]
|
|
}
|
|
|
|
/* if required, configure auto Baud rate detection scheme */
|
|
if (HAL_IS_BIT_SET(huart->AdvancedInit.AdvFeatureInit, UART_ADVFEATURE_AUTOBAUDRATE_INIT))
|
|
800672c: 687b ldr r3, [r7, #4]
|
|
800672e: 6a9b ldr r3, [r3, #40] @ 0x28
|
|
8006730: f003 0340 and.w r3, r3, #64 @ 0x40
|
|
8006734: 2b00 cmp r3, #0
|
|
8006736: d01a beq.n 800676e <UART_AdvFeatureConfig+0x116>
|
|
{
|
|
assert_param(IS_USART_AUTOBAUDRATE_DETECTION_INSTANCE(huart->Instance));
|
|
assert_param(IS_UART_ADVFEATURE_AUTOBAUDRATE(huart->AdvancedInit.AutoBaudRateEnable));
|
|
MODIFY_REG(huart->Instance->CR2, USART_CR2_ABREN, huart->AdvancedInit.AutoBaudRateEnable);
|
|
8006738: 687b ldr r3, [r7, #4]
|
|
800673a: 681b ldr r3, [r3, #0]
|
|
800673c: 685b ldr r3, [r3, #4]
|
|
800673e: f423 1180 bic.w r1, r3, #1048576 @ 0x100000
|
|
8006742: 687b ldr r3, [r7, #4]
|
|
8006744: 6c5a ldr r2, [r3, #68] @ 0x44
|
|
8006746: 687b ldr r3, [r7, #4]
|
|
8006748: 681b ldr r3, [r3, #0]
|
|
800674a: 430a orrs r2, r1
|
|
800674c: 605a str r2, [r3, #4]
|
|
/* set auto Baudrate detection parameters if detection is enabled */
|
|
if (huart->AdvancedInit.AutoBaudRateEnable == UART_ADVFEATURE_AUTOBAUDRATE_ENABLE)
|
|
800674e: 687b ldr r3, [r7, #4]
|
|
8006750: 6c5b ldr r3, [r3, #68] @ 0x44
|
|
8006752: f5b3 1f80 cmp.w r3, #1048576 @ 0x100000
|
|
8006756: d10a bne.n 800676e <UART_AdvFeatureConfig+0x116>
|
|
{
|
|
assert_param(IS_UART_ADVFEATURE_AUTOBAUDRATEMODE(huart->AdvancedInit.AutoBaudRateMode));
|
|
MODIFY_REG(huart->Instance->CR2, USART_CR2_ABRMODE, huart->AdvancedInit.AutoBaudRateMode);
|
|
8006758: 687b ldr r3, [r7, #4]
|
|
800675a: 681b ldr r3, [r3, #0]
|
|
800675c: 685b ldr r3, [r3, #4]
|
|
800675e: f423 01c0 bic.w r1, r3, #6291456 @ 0x600000
|
|
8006762: 687b ldr r3, [r7, #4]
|
|
8006764: 6c9a ldr r2, [r3, #72] @ 0x48
|
|
8006766: 687b ldr r3, [r7, #4]
|
|
8006768: 681b ldr r3, [r3, #0]
|
|
800676a: 430a orrs r2, r1
|
|
800676c: 605a str r2, [r3, #4]
|
|
}
|
|
}
|
|
|
|
/* if required, configure MSB first on communication line */
|
|
if (HAL_IS_BIT_SET(huart->AdvancedInit.AdvFeatureInit, UART_ADVFEATURE_MSBFIRST_INIT))
|
|
800676e: 687b ldr r3, [r7, #4]
|
|
8006770: 6a9b ldr r3, [r3, #40] @ 0x28
|
|
8006772: f003 0380 and.w r3, r3, #128 @ 0x80
|
|
8006776: 2b00 cmp r3, #0
|
|
8006778: d00a beq.n 8006790 <UART_AdvFeatureConfig+0x138>
|
|
{
|
|
assert_param(IS_UART_ADVFEATURE_MSBFIRST(huart->AdvancedInit.MSBFirst));
|
|
MODIFY_REG(huart->Instance->CR2, USART_CR2_MSBFIRST, huart->AdvancedInit.MSBFirst);
|
|
800677a: 687b ldr r3, [r7, #4]
|
|
800677c: 681b ldr r3, [r3, #0]
|
|
800677e: 685b ldr r3, [r3, #4]
|
|
8006780: f423 2100 bic.w r1, r3, #524288 @ 0x80000
|
|
8006784: 687b ldr r3, [r7, #4]
|
|
8006786: 6cda ldr r2, [r3, #76] @ 0x4c
|
|
8006788: 687b ldr r3, [r7, #4]
|
|
800678a: 681b ldr r3, [r3, #0]
|
|
800678c: 430a orrs r2, r1
|
|
800678e: 605a str r2, [r3, #4]
|
|
}
|
|
}
|
|
8006790: bf00 nop
|
|
8006792: 370c adds r7, #12
|
|
8006794: 46bd mov sp, r7
|
|
8006796: bc80 pop {r7}
|
|
8006798: 4770 bx lr
|
|
|
|
0800679a <UART_CheckIdleState>:
|
|
* @brief Check the UART Idle State.
|
|
* @param huart UART handle.
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef UART_CheckIdleState(UART_HandleTypeDef *huart)
|
|
{
|
|
800679a: b580 push {r7, lr}
|
|
800679c: b098 sub sp, #96 @ 0x60
|
|
800679e: af02 add r7, sp, #8
|
|
80067a0: 6078 str r0, [r7, #4]
|
|
uint32_t tickstart;
|
|
|
|
/* Initialize the UART ErrorCode */
|
|
huart->ErrorCode = HAL_UART_ERROR_NONE;
|
|
80067a2: 687b ldr r3, [r7, #4]
|
|
80067a4: 2200 movs r2, #0
|
|
80067a6: f8c3 2090 str.w r2, [r3, #144] @ 0x90
|
|
|
|
/* Init tickstart for timeout management */
|
|
tickstart = HAL_GetTick();
|
|
80067aa: f7fa fa4d bl 8000c48 <HAL_GetTick>
|
|
80067ae: 6578 str r0, [r7, #84] @ 0x54
|
|
|
|
/* Check if the Transmitter is enabled */
|
|
if ((huart->Instance->CR1 & USART_CR1_TE) == USART_CR1_TE)
|
|
80067b0: 687b ldr r3, [r7, #4]
|
|
80067b2: 681b ldr r3, [r3, #0]
|
|
80067b4: 681b ldr r3, [r3, #0]
|
|
80067b6: f003 0308 and.w r3, r3, #8
|
|
80067ba: 2b08 cmp r3, #8
|
|
80067bc: d12f bne.n 800681e <UART_CheckIdleState+0x84>
|
|
{
|
|
/* Wait until TEACK flag is set */
|
|
if (UART_WaitOnFlagUntilTimeout(huart, USART_ISR_TEACK, RESET, tickstart, HAL_UART_TIMEOUT_VALUE) != HAL_OK)
|
|
80067be: f06f 437e mvn.w r3, #4261412864 @ 0xfe000000
|
|
80067c2: 9300 str r3, [sp, #0]
|
|
80067c4: 6d7b ldr r3, [r7, #84] @ 0x54
|
|
80067c6: 2200 movs r2, #0
|
|
80067c8: f44f 1100 mov.w r1, #2097152 @ 0x200000
|
|
80067cc: 6878 ldr r0, [r7, #4]
|
|
80067ce: f000 f88e bl 80068ee <UART_WaitOnFlagUntilTimeout>
|
|
80067d2: 4603 mov r3, r0
|
|
80067d4: 2b00 cmp r3, #0
|
|
80067d6: d022 beq.n 800681e <UART_CheckIdleState+0x84>
|
|
{
|
|
/* Disable TXE interrupt for the interrupt process */
|
|
ATOMIC_CLEAR_BIT(huart->Instance->CR1, (USART_CR1_TXEIE_TXFNFIE));
|
|
80067d8: 687b ldr r3, [r7, #4]
|
|
80067da: 681b ldr r3, [r3, #0]
|
|
80067dc: 63bb str r3, [r7, #56] @ 0x38
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
80067de: 6bbb ldr r3, [r7, #56] @ 0x38
|
|
80067e0: e853 3f00 ldrex r3, [r3]
|
|
80067e4: 637b str r3, [r7, #52] @ 0x34
|
|
return(result);
|
|
80067e6: 6b7b ldr r3, [r7, #52] @ 0x34
|
|
80067e8: f023 0380 bic.w r3, r3, #128 @ 0x80
|
|
80067ec: 653b str r3, [r7, #80] @ 0x50
|
|
80067ee: 687b ldr r3, [r7, #4]
|
|
80067f0: 681b ldr r3, [r3, #0]
|
|
80067f2: 461a mov r2, r3
|
|
80067f4: 6d3b ldr r3, [r7, #80] @ 0x50
|
|
80067f6: 647b str r3, [r7, #68] @ 0x44
|
|
80067f8: 643a str r2, [r7, #64] @ 0x40
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
80067fa: 6c39 ldr r1, [r7, #64] @ 0x40
|
|
80067fc: 6c7a ldr r2, [r7, #68] @ 0x44
|
|
80067fe: e841 2300 strex r3, r2, [r1]
|
|
8006802: 63fb str r3, [r7, #60] @ 0x3c
|
|
return(result);
|
|
8006804: 6bfb ldr r3, [r7, #60] @ 0x3c
|
|
8006806: 2b00 cmp r3, #0
|
|
8006808: d1e6 bne.n 80067d8 <UART_CheckIdleState+0x3e>
|
|
|
|
huart->gState = HAL_UART_STATE_READY;
|
|
800680a: 687b ldr r3, [r7, #4]
|
|
800680c: 2220 movs r2, #32
|
|
800680e: f8c3 2088 str.w r2, [r3, #136] @ 0x88
|
|
|
|
__HAL_UNLOCK(huart);
|
|
8006812: 687b ldr r3, [r7, #4]
|
|
8006814: 2200 movs r2, #0
|
|
8006816: f883 2084 strb.w r2, [r3, #132] @ 0x84
|
|
|
|
/* Timeout occurred */
|
|
return HAL_TIMEOUT;
|
|
800681a: 2303 movs r3, #3
|
|
800681c: e063 b.n 80068e6 <UART_CheckIdleState+0x14c>
|
|
}
|
|
}
|
|
|
|
/* Check if the Receiver is enabled */
|
|
if ((huart->Instance->CR1 & USART_CR1_RE) == USART_CR1_RE)
|
|
800681e: 687b ldr r3, [r7, #4]
|
|
8006820: 681b ldr r3, [r3, #0]
|
|
8006822: 681b ldr r3, [r3, #0]
|
|
8006824: f003 0304 and.w r3, r3, #4
|
|
8006828: 2b04 cmp r3, #4
|
|
800682a: d149 bne.n 80068c0 <UART_CheckIdleState+0x126>
|
|
{
|
|
/* Wait until REACK flag is set */
|
|
if (UART_WaitOnFlagUntilTimeout(huart, USART_ISR_REACK, RESET, tickstart, HAL_UART_TIMEOUT_VALUE) != HAL_OK)
|
|
800682c: f06f 437e mvn.w r3, #4261412864 @ 0xfe000000
|
|
8006830: 9300 str r3, [sp, #0]
|
|
8006832: 6d7b ldr r3, [r7, #84] @ 0x54
|
|
8006834: 2200 movs r2, #0
|
|
8006836: f44f 0180 mov.w r1, #4194304 @ 0x400000
|
|
800683a: 6878 ldr r0, [r7, #4]
|
|
800683c: f000 f857 bl 80068ee <UART_WaitOnFlagUntilTimeout>
|
|
8006840: 4603 mov r3, r0
|
|
8006842: 2b00 cmp r3, #0
|
|
8006844: d03c beq.n 80068c0 <UART_CheckIdleState+0x126>
|
|
{
|
|
/* Disable RXNE, PE and ERR (Frame error, noise error, overrun error)
|
|
interrupts for the interrupt process */
|
|
ATOMIC_CLEAR_BIT(huart->Instance->CR1, (USART_CR1_RXNEIE_RXFNEIE | USART_CR1_PEIE));
|
|
8006846: 687b ldr r3, [r7, #4]
|
|
8006848: 681b ldr r3, [r3, #0]
|
|
800684a: 627b str r3, [r7, #36] @ 0x24
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
800684c: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
800684e: e853 3f00 ldrex r3, [r3]
|
|
8006852: 623b str r3, [r7, #32]
|
|
return(result);
|
|
8006854: 6a3b ldr r3, [r7, #32]
|
|
8006856: f423 7390 bic.w r3, r3, #288 @ 0x120
|
|
800685a: 64fb str r3, [r7, #76] @ 0x4c
|
|
800685c: 687b ldr r3, [r7, #4]
|
|
800685e: 681b ldr r3, [r3, #0]
|
|
8006860: 461a mov r2, r3
|
|
8006862: 6cfb ldr r3, [r7, #76] @ 0x4c
|
|
8006864: 633b str r3, [r7, #48] @ 0x30
|
|
8006866: 62fa str r2, [r7, #44] @ 0x2c
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
8006868: 6af9 ldr r1, [r7, #44] @ 0x2c
|
|
800686a: 6b3a ldr r2, [r7, #48] @ 0x30
|
|
800686c: e841 2300 strex r3, r2, [r1]
|
|
8006870: 62bb str r3, [r7, #40] @ 0x28
|
|
return(result);
|
|
8006872: 6abb ldr r3, [r7, #40] @ 0x28
|
|
8006874: 2b00 cmp r3, #0
|
|
8006876: d1e6 bne.n 8006846 <UART_CheckIdleState+0xac>
|
|
ATOMIC_CLEAR_BIT(huart->Instance->CR3, USART_CR3_EIE);
|
|
8006878: 687b ldr r3, [r7, #4]
|
|
800687a: 681b ldr r3, [r3, #0]
|
|
800687c: 3308 adds r3, #8
|
|
800687e: 613b str r3, [r7, #16]
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
8006880: 693b ldr r3, [r7, #16]
|
|
8006882: e853 3f00 ldrex r3, [r3]
|
|
8006886: 60fb str r3, [r7, #12]
|
|
return(result);
|
|
8006888: 68fb ldr r3, [r7, #12]
|
|
800688a: f023 0301 bic.w r3, r3, #1
|
|
800688e: 64bb str r3, [r7, #72] @ 0x48
|
|
8006890: 687b ldr r3, [r7, #4]
|
|
8006892: 681b ldr r3, [r3, #0]
|
|
8006894: 3308 adds r3, #8
|
|
8006896: 6cba ldr r2, [r7, #72] @ 0x48
|
|
8006898: 61fa str r2, [r7, #28]
|
|
800689a: 61bb str r3, [r7, #24]
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
800689c: 69b9 ldr r1, [r7, #24]
|
|
800689e: 69fa ldr r2, [r7, #28]
|
|
80068a0: e841 2300 strex r3, r2, [r1]
|
|
80068a4: 617b str r3, [r7, #20]
|
|
return(result);
|
|
80068a6: 697b ldr r3, [r7, #20]
|
|
80068a8: 2b00 cmp r3, #0
|
|
80068aa: d1e5 bne.n 8006878 <UART_CheckIdleState+0xde>
|
|
|
|
huart->RxState = HAL_UART_STATE_READY;
|
|
80068ac: 687b ldr r3, [r7, #4]
|
|
80068ae: 2220 movs r2, #32
|
|
80068b0: f8c3 208c str.w r2, [r3, #140] @ 0x8c
|
|
|
|
__HAL_UNLOCK(huart);
|
|
80068b4: 687b ldr r3, [r7, #4]
|
|
80068b6: 2200 movs r2, #0
|
|
80068b8: f883 2084 strb.w r2, [r3, #132] @ 0x84
|
|
|
|
/* Timeout occurred */
|
|
return HAL_TIMEOUT;
|
|
80068bc: 2303 movs r3, #3
|
|
80068be: e012 b.n 80068e6 <UART_CheckIdleState+0x14c>
|
|
}
|
|
}
|
|
|
|
/* Initialize the UART State */
|
|
huart->gState = HAL_UART_STATE_READY;
|
|
80068c0: 687b ldr r3, [r7, #4]
|
|
80068c2: 2220 movs r2, #32
|
|
80068c4: f8c3 2088 str.w r2, [r3, #136] @ 0x88
|
|
huart->RxState = HAL_UART_STATE_READY;
|
|
80068c8: 687b ldr r3, [r7, #4]
|
|
80068ca: 2220 movs r2, #32
|
|
80068cc: f8c3 208c str.w r2, [r3, #140] @ 0x8c
|
|
huart->ReceptionType = HAL_UART_RECEPTION_STANDARD;
|
|
80068d0: 687b ldr r3, [r7, #4]
|
|
80068d2: 2200 movs r2, #0
|
|
80068d4: 66da str r2, [r3, #108] @ 0x6c
|
|
huart->RxEventType = HAL_UART_RXEVENT_TC;
|
|
80068d6: 687b ldr r3, [r7, #4]
|
|
80068d8: 2200 movs r2, #0
|
|
80068da: 671a str r2, [r3, #112] @ 0x70
|
|
|
|
__HAL_UNLOCK(huart);
|
|
80068dc: 687b ldr r3, [r7, #4]
|
|
80068de: 2200 movs r2, #0
|
|
80068e0: f883 2084 strb.w r2, [r3, #132] @ 0x84
|
|
|
|
return HAL_OK;
|
|
80068e4: 2300 movs r3, #0
|
|
}
|
|
80068e6: 4618 mov r0, r3
|
|
80068e8: 3758 adds r7, #88 @ 0x58
|
|
80068ea: 46bd mov sp, r7
|
|
80068ec: bd80 pop {r7, pc}
|
|
|
|
080068ee <UART_WaitOnFlagUntilTimeout>:
|
|
* @param Timeout Timeout duration
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef UART_WaitOnFlagUntilTimeout(UART_HandleTypeDef *huart, uint32_t Flag, FlagStatus Status,
|
|
uint32_t Tickstart, uint32_t Timeout)
|
|
{
|
|
80068ee: b580 push {r7, lr}
|
|
80068f0: b084 sub sp, #16
|
|
80068f2: af00 add r7, sp, #0
|
|
80068f4: 60f8 str r0, [r7, #12]
|
|
80068f6: 60b9 str r1, [r7, #8]
|
|
80068f8: 603b str r3, [r7, #0]
|
|
80068fa: 4613 mov r3, r2
|
|
80068fc: 71fb strb r3, [r7, #7]
|
|
/* Wait until flag is set */
|
|
while ((__HAL_UART_GET_FLAG(huart, Flag) ? SET : RESET) == Status)
|
|
80068fe: e04f b.n 80069a0 <UART_WaitOnFlagUntilTimeout+0xb2>
|
|
{
|
|
/* Check for the Timeout */
|
|
if (Timeout != HAL_MAX_DELAY)
|
|
8006900: 69bb ldr r3, [r7, #24]
|
|
8006902: f1b3 3fff cmp.w r3, #4294967295 @ 0xffffffff
|
|
8006906: d04b beq.n 80069a0 <UART_WaitOnFlagUntilTimeout+0xb2>
|
|
{
|
|
if (((HAL_GetTick() - Tickstart) > Timeout) || (Timeout == 0U))
|
|
8006908: f7fa f99e bl 8000c48 <HAL_GetTick>
|
|
800690c: 4602 mov r2, r0
|
|
800690e: 683b ldr r3, [r7, #0]
|
|
8006910: 1ad3 subs r3, r2, r3
|
|
8006912: 69ba ldr r2, [r7, #24]
|
|
8006914: 429a cmp r2, r3
|
|
8006916: d302 bcc.n 800691e <UART_WaitOnFlagUntilTimeout+0x30>
|
|
8006918: 69bb ldr r3, [r7, #24]
|
|
800691a: 2b00 cmp r3, #0
|
|
800691c: d101 bne.n 8006922 <UART_WaitOnFlagUntilTimeout+0x34>
|
|
{
|
|
|
|
return HAL_TIMEOUT;
|
|
800691e: 2303 movs r3, #3
|
|
8006920: e04e b.n 80069c0 <UART_WaitOnFlagUntilTimeout+0xd2>
|
|
}
|
|
|
|
if ((READ_BIT(huart->Instance->CR1, USART_CR1_RE) != 0U) && (Flag != UART_FLAG_TXE) && (Flag != UART_FLAG_TC))
|
|
8006922: 68fb ldr r3, [r7, #12]
|
|
8006924: 681b ldr r3, [r3, #0]
|
|
8006926: 681b ldr r3, [r3, #0]
|
|
8006928: f003 0304 and.w r3, r3, #4
|
|
800692c: 2b00 cmp r3, #0
|
|
800692e: d037 beq.n 80069a0 <UART_WaitOnFlagUntilTimeout+0xb2>
|
|
8006930: 68bb ldr r3, [r7, #8]
|
|
8006932: 2b80 cmp r3, #128 @ 0x80
|
|
8006934: d034 beq.n 80069a0 <UART_WaitOnFlagUntilTimeout+0xb2>
|
|
8006936: 68bb ldr r3, [r7, #8]
|
|
8006938: 2b40 cmp r3, #64 @ 0x40
|
|
800693a: d031 beq.n 80069a0 <UART_WaitOnFlagUntilTimeout+0xb2>
|
|
{
|
|
if (__HAL_UART_GET_FLAG(huart, UART_FLAG_ORE) == SET)
|
|
800693c: 68fb ldr r3, [r7, #12]
|
|
800693e: 681b ldr r3, [r3, #0]
|
|
8006940: 69db ldr r3, [r3, #28]
|
|
8006942: f003 0308 and.w r3, r3, #8
|
|
8006946: 2b08 cmp r3, #8
|
|
8006948: d110 bne.n 800696c <UART_WaitOnFlagUntilTimeout+0x7e>
|
|
{
|
|
/* Clear Overrun Error flag*/
|
|
__HAL_UART_CLEAR_FLAG(huart, UART_CLEAR_OREF);
|
|
800694a: 68fb ldr r3, [r7, #12]
|
|
800694c: 681b ldr r3, [r3, #0]
|
|
800694e: 2208 movs r2, #8
|
|
8006950: 621a str r2, [r3, #32]
|
|
|
|
/* Blocking error : transfer is aborted
|
|
Set the UART state ready to be able to start again the process,
|
|
Disable Rx Interrupts if ongoing */
|
|
UART_EndRxTransfer(huart);
|
|
8006952: 68f8 ldr r0, [r7, #12]
|
|
8006954: f000 f998 bl 8006c88 <UART_EndRxTransfer>
|
|
|
|
huart->ErrorCode = HAL_UART_ERROR_ORE;
|
|
8006958: 68fb ldr r3, [r7, #12]
|
|
800695a: 2208 movs r2, #8
|
|
800695c: f8c3 2090 str.w r2, [r3, #144] @ 0x90
|
|
|
|
/* Process Unlocked */
|
|
__HAL_UNLOCK(huart);
|
|
8006960: 68fb ldr r3, [r7, #12]
|
|
8006962: 2200 movs r2, #0
|
|
8006964: f883 2084 strb.w r2, [r3, #132] @ 0x84
|
|
|
|
return HAL_ERROR;
|
|
8006968: 2301 movs r3, #1
|
|
800696a: e029 b.n 80069c0 <UART_WaitOnFlagUntilTimeout+0xd2>
|
|
}
|
|
if (__HAL_UART_GET_FLAG(huart, UART_FLAG_RTOF) == SET)
|
|
800696c: 68fb ldr r3, [r7, #12]
|
|
800696e: 681b ldr r3, [r3, #0]
|
|
8006970: 69db ldr r3, [r3, #28]
|
|
8006972: f403 6300 and.w r3, r3, #2048 @ 0x800
|
|
8006976: f5b3 6f00 cmp.w r3, #2048 @ 0x800
|
|
800697a: d111 bne.n 80069a0 <UART_WaitOnFlagUntilTimeout+0xb2>
|
|
{
|
|
/* Clear Receiver Timeout flag*/
|
|
__HAL_UART_CLEAR_FLAG(huart, UART_CLEAR_RTOF);
|
|
800697c: 68fb ldr r3, [r7, #12]
|
|
800697e: 681b ldr r3, [r3, #0]
|
|
8006980: f44f 6200 mov.w r2, #2048 @ 0x800
|
|
8006984: 621a str r2, [r3, #32]
|
|
|
|
/* Blocking error : transfer is aborted
|
|
Set the UART state ready to be able to start again the process,
|
|
Disable Rx Interrupts if ongoing */
|
|
UART_EndRxTransfer(huart);
|
|
8006986: 68f8 ldr r0, [r7, #12]
|
|
8006988: f000 f97e bl 8006c88 <UART_EndRxTransfer>
|
|
|
|
huart->ErrorCode = HAL_UART_ERROR_RTO;
|
|
800698c: 68fb ldr r3, [r7, #12]
|
|
800698e: 2220 movs r2, #32
|
|
8006990: f8c3 2090 str.w r2, [r3, #144] @ 0x90
|
|
|
|
/* Process Unlocked */
|
|
__HAL_UNLOCK(huart);
|
|
8006994: 68fb ldr r3, [r7, #12]
|
|
8006996: 2200 movs r2, #0
|
|
8006998: f883 2084 strb.w r2, [r3, #132] @ 0x84
|
|
|
|
return HAL_TIMEOUT;
|
|
800699c: 2303 movs r3, #3
|
|
800699e: e00f b.n 80069c0 <UART_WaitOnFlagUntilTimeout+0xd2>
|
|
while ((__HAL_UART_GET_FLAG(huart, Flag) ? SET : RESET) == Status)
|
|
80069a0: 68fb ldr r3, [r7, #12]
|
|
80069a2: 681b ldr r3, [r3, #0]
|
|
80069a4: 69da ldr r2, [r3, #28]
|
|
80069a6: 68bb ldr r3, [r7, #8]
|
|
80069a8: 4013 ands r3, r2
|
|
80069aa: 68ba ldr r2, [r7, #8]
|
|
80069ac: 429a cmp r2, r3
|
|
80069ae: bf0c ite eq
|
|
80069b0: 2301 moveq r3, #1
|
|
80069b2: 2300 movne r3, #0
|
|
80069b4: b2db uxtb r3, r3
|
|
80069b6: 461a mov r2, r3
|
|
80069b8: 79fb ldrb r3, [r7, #7]
|
|
80069ba: 429a cmp r2, r3
|
|
80069bc: d0a0 beq.n 8006900 <UART_WaitOnFlagUntilTimeout+0x12>
|
|
}
|
|
}
|
|
}
|
|
}
|
|
return HAL_OK;
|
|
80069be: 2300 movs r3, #0
|
|
}
|
|
80069c0: 4618 mov r0, r3
|
|
80069c2: 3710 adds r7, #16
|
|
80069c4: 46bd mov sp, r7
|
|
80069c6: bd80 pop {r7, pc}
|
|
|
|
080069c8 <UART_Start_Receive_IT>:
|
|
* @param pData Pointer to data buffer (u8 or u16 data elements).
|
|
* @param Size Amount of data elements (u8 or u16) to be received.
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef UART_Start_Receive_IT(UART_HandleTypeDef *huart, uint8_t *pData, uint16_t Size)
|
|
{
|
|
80069c8: b480 push {r7}
|
|
80069ca: b0a3 sub sp, #140 @ 0x8c
|
|
80069cc: af00 add r7, sp, #0
|
|
80069ce: 60f8 str r0, [r7, #12]
|
|
80069d0: 60b9 str r1, [r7, #8]
|
|
80069d2: 4613 mov r3, r2
|
|
80069d4: 80fb strh r3, [r7, #6]
|
|
huart->pRxBuffPtr = pData;
|
|
80069d6: 68fb ldr r3, [r7, #12]
|
|
80069d8: 68ba ldr r2, [r7, #8]
|
|
80069da: 659a str r2, [r3, #88] @ 0x58
|
|
huart->RxXferSize = Size;
|
|
80069dc: 68fb ldr r3, [r7, #12]
|
|
80069de: 88fa ldrh r2, [r7, #6]
|
|
80069e0: f8a3 205c strh.w r2, [r3, #92] @ 0x5c
|
|
huart->RxXferCount = Size;
|
|
80069e4: 68fb ldr r3, [r7, #12]
|
|
80069e6: 88fa ldrh r2, [r7, #6]
|
|
80069e8: f8a3 205e strh.w r2, [r3, #94] @ 0x5e
|
|
huart->RxISR = NULL;
|
|
80069ec: 68fb ldr r3, [r7, #12]
|
|
80069ee: 2200 movs r2, #0
|
|
80069f0: 675a str r2, [r3, #116] @ 0x74
|
|
|
|
/* Computation of UART mask to apply to RDR register */
|
|
UART_MASK_COMPUTATION(huart);
|
|
80069f2: 68fb ldr r3, [r7, #12]
|
|
80069f4: 689b ldr r3, [r3, #8]
|
|
80069f6: f5b3 5f80 cmp.w r3, #4096 @ 0x1000
|
|
80069fa: d10e bne.n 8006a1a <UART_Start_Receive_IT+0x52>
|
|
80069fc: 68fb ldr r3, [r7, #12]
|
|
80069fe: 691b ldr r3, [r3, #16]
|
|
8006a00: 2b00 cmp r3, #0
|
|
8006a02: d105 bne.n 8006a10 <UART_Start_Receive_IT+0x48>
|
|
8006a04: 68fb ldr r3, [r7, #12]
|
|
8006a06: f240 12ff movw r2, #511 @ 0x1ff
|
|
8006a0a: f8a3 2060 strh.w r2, [r3, #96] @ 0x60
|
|
8006a0e: e02d b.n 8006a6c <UART_Start_Receive_IT+0xa4>
|
|
8006a10: 68fb ldr r3, [r7, #12]
|
|
8006a12: 22ff movs r2, #255 @ 0xff
|
|
8006a14: f8a3 2060 strh.w r2, [r3, #96] @ 0x60
|
|
8006a18: e028 b.n 8006a6c <UART_Start_Receive_IT+0xa4>
|
|
8006a1a: 68fb ldr r3, [r7, #12]
|
|
8006a1c: 689b ldr r3, [r3, #8]
|
|
8006a1e: 2b00 cmp r3, #0
|
|
8006a20: d10d bne.n 8006a3e <UART_Start_Receive_IT+0x76>
|
|
8006a22: 68fb ldr r3, [r7, #12]
|
|
8006a24: 691b ldr r3, [r3, #16]
|
|
8006a26: 2b00 cmp r3, #0
|
|
8006a28: d104 bne.n 8006a34 <UART_Start_Receive_IT+0x6c>
|
|
8006a2a: 68fb ldr r3, [r7, #12]
|
|
8006a2c: 22ff movs r2, #255 @ 0xff
|
|
8006a2e: f8a3 2060 strh.w r2, [r3, #96] @ 0x60
|
|
8006a32: e01b b.n 8006a6c <UART_Start_Receive_IT+0xa4>
|
|
8006a34: 68fb ldr r3, [r7, #12]
|
|
8006a36: 227f movs r2, #127 @ 0x7f
|
|
8006a38: f8a3 2060 strh.w r2, [r3, #96] @ 0x60
|
|
8006a3c: e016 b.n 8006a6c <UART_Start_Receive_IT+0xa4>
|
|
8006a3e: 68fb ldr r3, [r7, #12]
|
|
8006a40: 689b ldr r3, [r3, #8]
|
|
8006a42: f1b3 5f80 cmp.w r3, #268435456 @ 0x10000000
|
|
8006a46: d10d bne.n 8006a64 <UART_Start_Receive_IT+0x9c>
|
|
8006a48: 68fb ldr r3, [r7, #12]
|
|
8006a4a: 691b ldr r3, [r3, #16]
|
|
8006a4c: 2b00 cmp r3, #0
|
|
8006a4e: d104 bne.n 8006a5a <UART_Start_Receive_IT+0x92>
|
|
8006a50: 68fb ldr r3, [r7, #12]
|
|
8006a52: 227f movs r2, #127 @ 0x7f
|
|
8006a54: f8a3 2060 strh.w r2, [r3, #96] @ 0x60
|
|
8006a58: e008 b.n 8006a6c <UART_Start_Receive_IT+0xa4>
|
|
8006a5a: 68fb ldr r3, [r7, #12]
|
|
8006a5c: 223f movs r2, #63 @ 0x3f
|
|
8006a5e: f8a3 2060 strh.w r2, [r3, #96] @ 0x60
|
|
8006a62: e003 b.n 8006a6c <UART_Start_Receive_IT+0xa4>
|
|
8006a64: 68fb ldr r3, [r7, #12]
|
|
8006a66: 2200 movs r2, #0
|
|
8006a68: f8a3 2060 strh.w r2, [r3, #96] @ 0x60
|
|
|
|
huart->ErrorCode = HAL_UART_ERROR_NONE;
|
|
8006a6c: 68fb ldr r3, [r7, #12]
|
|
8006a6e: 2200 movs r2, #0
|
|
8006a70: f8c3 2090 str.w r2, [r3, #144] @ 0x90
|
|
huart->RxState = HAL_UART_STATE_BUSY_RX;
|
|
8006a74: 68fb ldr r3, [r7, #12]
|
|
8006a76: 2222 movs r2, #34 @ 0x22
|
|
8006a78: f8c3 208c str.w r2, [r3, #140] @ 0x8c
|
|
|
|
/* Enable the UART Error Interrupt: (Frame error, noise error, overrun error) */
|
|
ATOMIC_SET_BIT(huart->Instance->CR3, USART_CR3_EIE);
|
|
8006a7c: 68fb ldr r3, [r7, #12]
|
|
8006a7e: 681b ldr r3, [r3, #0]
|
|
8006a80: 3308 adds r3, #8
|
|
8006a82: 667b str r3, [r7, #100] @ 0x64
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
8006a84: 6e7b ldr r3, [r7, #100] @ 0x64
|
|
8006a86: e853 3f00 ldrex r3, [r3]
|
|
8006a8a: 663b str r3, [r7, #96] @ 0x60
|
|
return(result);
|
|
8006a8c: 6e3b ldr r3, [r7, #96] @ 0x60
|
|
8006a8e: f043 0301 orr.w r3, r3, #1
|
|
8006a92: f8c7 3084 str.w r3, [r7, #132] @ 0x84
|
|
8006a96: 68fb ldr r3, [r7, #12]
|
|
8006a98: 681b ldr r3, [r3, #0]
|
|
8006a9a: 3308 adds r3, #8
|
|
8006a9c: f8d7 2084 ldr.w r2, [r7, #132] @ 0x84
|
|
8006aa0: 673a str r2, [r7, #112] @ 0x70
|
|
8006aa2: 66fb str r3, [r7, #108] @ 0x6c
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
8006aa4: 6ef9 ldr r1, [r7, #108] @ 0x6c
|
|
8006aa6: 6f3a ldr r2, [r7, #112] @ 0x70
|
|
8006aa8: e841 2300 strex r3, r2, [r1]
|
|
8006aac: 66bb str r3, [r7, #104] @ 0x68
|
|
return(result);
|
|
8006aae: 6ebb ldr r3, [r7, #104] @ 0x68
|
|
8006ab0: 2b00 cmp r3, #0
|
|
8006ab2: d1e3 bne.n 8006a7c <UART_Start_Receive_IT+0xb4>
|
|
|
|
/* Configure Rx interrupt processing */
|
|
if ((huart->FifoMode == UART_FIFOMODE_ENABLE) && (Size >= huart->NbRxDataToProcess))
|
|
8006ab4: 68fb ldr r3, [r7, #12]
|
|
8006ab6: 6e5b ldr r3, [r3, #100] @ 0x64
|
|
8006ab8: f1b3 5f00 cmp.w r3, #536870912 @ 0x20000000
|
|
8006abc: d14f bne.n 8006b5e <UART_Start_Receive_IT+0x196>
|
|
8006abe: 68fb ldr r3, [r7, #12]
|
|
8006ac0: f8b3 3068 ldrh.w r3, [r3, #104] @ 0x68
|
|
8006ac4: 88fa ldrh r2, [r7, #6]
|
|
8006ac6: 429a cmp r2, r3
|
|
8006ac8: d349 bcc.n 8006b5e <UART_Start_Receive_IT+0x196>
|
|
{
|
|
/* Set the Rx ISR function pointer according to the data word length */
|
|
if ((huart->Init.WordLength == UART_WORDLENGTH_9B) && (huart->Init.Parity == UART_PARITY_NONE))
|
|
8006aca: 68fb ldr r3, [r7, #12]
|
|
8006acc: 689b ldr r3, [r3, #8]
|
|
8006ace: f5b3 5f80 cmp.w r3, #4096 @ 0x1000
|
|
8006ad2: d107 bne.n 8006ae4 <UART_Start_Receive_IT+0x11c>
|
|
8006ad4: 68fb ldr r3, [r7, #12]
|
|
8006ad6: 691b ldr r3, [r3, #16]
|
|
8006ad8: 2b00 cmp r3, #0
|
|
8006ada: d103 bne.n 8006ae4 <UART_Start_Receive_IT+0x11c>
|
|
{
|
|
huart->RxISR = UART_RxISR_16BIT_FIFOEN;
|
|
8006adc: 68fb ldr r3, [r7, #12]
|
|
8006ade: 4a46 ldr r2, [pc, #280] @ (8006bf8 <UART_Start_Receive_IT+0x230>)
|
|
8006ae0: 675a str r2, [r3, #116] @ 0x74
|
|
8006ae2: e002 b.n 8006aea <UART_Start_Receive_IT+0x122>
|
|
}
|
|
else
|
|
{
|
|
huart->RxISR = UART_RxISR_8BIT_FIFOEN;
|
|
8006ae4: 68fb ldr r3, [r7, #12]
|
|
8006ae6: 4a45 ldr r2, [pc, #276] @ (8006bfc <UART_Start_Receive_IT+0x234>)
|
|
8006ae8: 675a str r2, [r3, #116] @ 0x74
|
|
}
|
|
|
|
/* Enable the UART Parity Error interrupt and RX FIFO Threshold interrupt */
|
|
if (huart->Init.Parity != UART_PARITY_NONE)
|
|
8006aea: 68fb ldr r3, [r7, #12]
|
|
8006aec: 691b ldr r3, [r3, #16]
|
|
8006aee: 2b00 cmp r3, #0
|
|
8006af0: d01a beq.n 8006b28 <UART_Start_Receive_IT+0x160>
|
|
{
|
|
ATOMIC_SET_BIT(huart->Instance->CR1, USART_CR1_PEIE);
|
|
8006af2: 68fb ldr r3, [r7, #12]
|
|
8006af4: 681b ldr r3, [r3, #0]
|
|
8006af6: 653b str r3, [r7, #80] @ 0x50
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
8006af8: 6d3b ldr r3, [r7, #80] @ 0x50
|
|
8006afa: e853 3f00 ldrex r3, [r3]
|
|
8006afe: 64fb str r3, [r7, #76] @ 0x4c
|
|
return(result);
|
|
8006b00: 6cfb ldr r3, [r7, #76] @ 0x4c
|
|
8006b02: f443 7380 orr.w r3, r3, #256 @ 0x100
|
|
8006b06: f8c7 3080 str.w r3, [r7, #128] @ 0x80
|
|
8006b0a: 68fb ldr r3, [r7, #12]
|
|
8006b0c: 681b ldr r3, [r3, #0]
|
|
8006b0e: 461a mov r2, r3
|
|
8006b10: f8d7 3080 ldr.w r3, [r7, #128] @ 0x80
|
|
8006b14: 65fb str r3, [r7, #92] @ 0x5c
|
|
8006b16: 65ba str r2, [r7, #88] @ 0x58
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
8006b18: 6db9 ldr r1, [r7, #88] @ 0x58
|
|
8006b1a: 6dfa ldr r2, [r7, #92] @ 0x5c
|
|
8006b1c: e841 2300 strex r3, r2, [r1]
|
|
8006b20: 657b str r3, [r7, #84] @ 0x54
|
|
return(result);
|
|
8006b22: 6d7b ldr r3, [r7, #84] @ 0x54
|
|
8006b24: 2b00 cmp r3, #0
|
|
8006b26: d1e4 bne.n 8006af2 <UART_Start_Receive_IT+0x12a>
|
|
}
|
|
ATOMIC_SET_BIT(huart->Instance->CR3, USART_CR3_RXFTIE);
|
|
8006b28: 68fb ldr r3, [r7, #12]
|
|
8006b2a: 681b ldr r3, [r3, #0]
|
|
8006b2c: 3308 adds r3, #8
|
|
8006b2e: 63fb str r3, [r7, #60] @ 0x3c
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
8006b30: 6bfb ldr r3, [r7, #60] @ 0x3c
|
|
8006b32: e853 3f00 ldrex r3, [r3]
|
|
8006b36: 63bb str r3, [r7, #56] @ 0x38
|
|
return(result);
|
|
8006b38: 6bbb ldr r3, [r7, #56] @ 0x38
|
|
8006b3a: f043 5380 orr.w r3, r3, #268435456 @ 0x10000000
|
|
8006b3e: 67fb str r3, [r7, #124] @ 0x7c
|
|
8006b40: 68fb ldr r3, [r7, #12]
|
|
8006b42: 681b ldr r3, [r3, #0]
|
|
8006b44: 3308 adds r3, #8
|
|
8006b46: 6ffa ldr r2, [r7, #124] @ 0x7c
|
|
8006b48: 64ba str r2, [r7, #72] @ 0x48
|
|
8006b4a: 647b str r3, [r7, #68] @ 0x44
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
8006b4c: 6c79 ldr r1, [r7, #68] @ 0x44
|
|
8006b4e: 6cba ldr r2, [r7, #72] @ 0x48
|
|
8006b50: e841 2300 strex r3, r2, [r1]
|
|
8006b54: 643b str r3, [r7, #64] @ 0x40
|
|
return(result);
|
|
8006b56: 6c3b ldr r3, [r7, #64] @ 0x40
|
|
8006b58: 2b00 cmp r3, #0
|
|
8006b5a: d1e5 bne.n 8006b28 <UART_Start_Receive_IT+0x160>
|
|
8006b5c: e046 b.n 8006bec <UART_Start_Receive_IT+0x224>
|
|
}
|
|
else
|
|
{
|
|
/* Set the Rx ISR function pointer according to the data word length */
|
|
if ((huart->Init.WordLength == UART_WORDLENGTH_9B) && (huart->Init.Parity == UART_PARITY_NONE))
|
|
8006b5e: 68fb ldr r3, [r7, #12]
|
|
8006b60: 689b ldr r3, [r3, #8]
|
|
8006b62: f5b3 5f80 cmp.w r3, #4096 @ 0x1000
|
|
8006b66: d107 bne.n 8006b78 <UART_Start_Receive_IT+0x1b0>
|
|
8006b68: 68fb ldr r3, [r7, #12]
|
|
8006b6a: 691b ldr r3, [r3, #16]
|
|
8006b6c: 2b00 cmp r3, #0
|
|
8006b6e: d103 bne.n 8006b78 <UART_Start_Receive_IT+0x1b0>
|
|
{
|
|
huart->RxISR = UART_RxISR_16BIT;
|
|
8006b70: 68fb ldr r3, [r7, #12]
|
|
8006b72: 4a23 ldr r2, [pc, #140] @ (8006c00 <UART_Start_Receive_IT+0x238>)
|
|
8006b74: 675a str r2, [r3, #116] @ 0x74
|
|
8006b76: e002 b.n 8006b7e <UART_Start_Receive_IT+0x1b6>
|
|
}
|
|
else
|
|
{
|
|
huart->RxISR = UART_RxISR_8BIT;
|
|
8006b78: 68fb ldr r3, [r7, #12]
|
|
8006b7a: 4a22 ldr r2, [pc, #136] @ (8006c04 <UART_Start_Receive_IT+0x23c>)
|
|
8006b7c: 675a str r2, [r3, #116] @ 0x74
|
|
}
|
|
|
|
/* Enable the UART Parity Error interrupt and Data Register Not Empty interrupt */
|
|
if (huart->Init.Parity != UART_PARITY_NONE)
|
|
8006b7e: 68fb ldr r3, [r7, #12]
|
|
8006b80: 691b ldr r3, [r3, #16]
|
|
8006b82: 2b00 cmp r3, #0
|
|
8006b84: d019 beq.n 8006bba <UART_Start_Receive_IT+0x1f2>
|
|
{
|
|
ATOMIC_SET_BIT(huart->Instance->CR1, USART_CR1_PEIE | USART_CR1_RXNEIE_RXFNEIE);
|
|
8006b86: 68fb ldr r3, [r7, #12]
|
|
8006b88: 681b ldr r3, [r3, #0]
|
|
8006b8a: 62bb str r3, [r7, #40] @ 0x28
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
8006b8c: 6abb ldr r3, [r7, #40] @ 0x28
|
|
8006b8e: e853 3f00 ldrex r3, [r3]
|
|
8006b92: 627b str r3, [r7, #36] @ 0x24
|
|
return(result);
|
|
8006b94: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8006b96: f443 7390 orr.w r3, r3, #288 @ 0x120
|
|
8006b9a: 677b str r3, [r7, #116] @ 0x74
|
|
8006b9c: 68fb ldr r3, [r7, #12]
|
|
8006b9e: 681b ldr r3, [r3, #0]
|
|
8006ba0: 461a mov r2, r3
|
|
8006ba2: 6f7b ldr r3, [r7, #116] @ 0x74
|
|
8006ba4: 637b str r3, [r7, #52] @ 0x34
|
|
8006ba6: 633a str r2, [r7, #48] @ 0x30
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
8006ba8: 6b39 ldr r1, [r7, #48] @ 0x30
|
|
8006baa: 6b7a ldr r2, [r7, #52] @ 0x34
|
|
8006bac: e841 2300 strex r3, r2, [r1]
|
|
8006bb0: 62fb str r3, [r7, #44] @ 0x2c
|
|
return(result);
|
|
8006bb2: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
8006bb4: 2b00 cmp r3, #0
|
|
8006bb6: d1e6 bne.n 8006b86 <UART_Start_Receive_IT+0x1be>
|
|
8006bb8: e018 b.n 8006bec <UART_Start_Receive_IT+0x224>
|
|
}
|
|
else
|
|
{
|
|
ATOMIC_SET_BIT(huart->Instance->CR1, USART_CR1_RXNEIE_RXFNEIE);
|
|
8006bba: 68fb ldr r3, [r7, #12]
|
|
8006bbc: 681b ldr r3, [r3, #0]
|
|
8006bbe: 617b str r3, [r7, #20]
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
8006bc0: 697b ldr r3, [r7, #20]
|
|
8006bc2: e853 3f00 ldrex r3, [r3]
|
|
8006bc6: 613b str r3, [r7, #16]
|
|
return(result);
|
|
8006bc8: 693b ldr r3, [r7, #16]
|
|
8006bca: f043 0320 orr.w r3, r3, #32
|
|
8006bce: 67bb str r3, [r7, #120] @ 0x78
|
|
8006bd0: 68fb ldr r3, [r7, #12]
|
|
8006bd2: 681b ldr r3, [r3, #0]
|
|
8006bd4: 461a mov r2, r3
|
|
8006bd6: 6fbb ldr r3, [r7, #120] @ 0x78
|
|
8006bd8: 623b str r3, [r7, #32]
|
|
8006bda: 61fa str r2, [r7, #28]
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
8006bdc: 69f9 ldr r1, [r7, #28]
|
|
8006bde: 6a3a ldr r2, [r7, #32]
|
|
8006be0: e841 2300 strex r3, r2, [r1]
|
|
8006be4: 61bb str r3, [r7, #24]
|
|
return(result);
|
|
8006be6: 69bb ldr r3, [r7, #24]
|
|
8006be8: 2b00 cmp r3, #0
|
|
8006bea: d1e6 bne.n 8006bba <UART_Start_Receive_IT+0x1f2>
|
|
}
|
|
}
|
|
return HAL_OK;
|
|
8006bec: 2300 movs r3, #0
|
|
}
|
|
8006bee: 4618 mov r0, r3
|
|
8006bf0: 378c adds r7, #140 @ 0x8c
|
|
8006bf2: 46bd mov sp, r7
|
|
8006bf4: bc80 pop {r7}
|
|
8006bf6: 4770 bx lr
|
|
8006bf8: 080075b9 .word 0x080075b9
|
|
8006bfc: 08007255 .word 0x08007255
|
|
8006c00: 0800709d .word 0x0800709d
|
|
8006c04: 08006ee5 .word 0x08006ee5
|
|
|
|
08006c08 <UART_EndTxTransfer>:
|
|
* @brief End ongoing Tx transfer on UART peripheral (following error detection or Transmit completion).
|
|
* @param huart UART handle.
|
|
* @retval None
|
|
*/
|
|
static void UART_EndTxTransfer(UART_HandleTypeDef *huart)
|
|
{
|
|
8006c08: b480 push {r7}
|
|
8006c0a: b08f sub sp, #60 @ 0x3c
|
|
8006c0c: af00 add r7, sp, #0
|
|
8006c0e: 6078 str r0, [r7, #4]
|
|
/* Disable TXEIE, TCIE, TXFT interrupts */
|
|
ATOMIC_CLEAR_BIT(huart->Instance->CR1, (USART_CR1_TXEIE_TXFNFIE | USART_CR1_TCIE));
|
|
8006c10: 687b ldr r3, [r7, #4]
|
|
8006c12: 681b ldr r3, [r3, #0]
|
|
8006c14: 623b str r3, [r7, #32]
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
8006c16: 6a3b ldr r3, [r7, #32]
|
|
8006c18: e853 3f00 ldrex r3, [r3]
|
|
8006c1c: 61fb str r3, [r7, #28]
|
|
return(result);
|
|
8006c1e: 69fb ldr r3, [r7, #28]
|
|
8006c20: f023 03c0 bic.w r3, r3, #192 @ 0xc0
|
|
8006c24: 637b str r3, [r7, #52] @ 0x34
|
|
8006c26: 687b ldr r3, [r7, #4]
|
|
8006c28: 681b ldr r3, [r3, #0]
|
|
8006c2a: 461a mov r2, r3
|
|
8006c2c: 6b7b ldr r3, [r7, #52] @ 0x34
|
|
8006c2e: 62fb str r3, [r7, #44] @ 0x2c
|
|
8006c30: 62ba str r2, [r7, #40] @ 0x28
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
8006c32: 6ab9 ldr r1, [r7, #40] @ 0x28
|
|
8006c34: 6afa ldr r2, [r7, #44] @ 0x2c
|
|
8006c36: e841 2300 strex r3, r2, [r1]
|
|
8006c3a: 627b str r3, [r7, #36] @ 0x24
|
|
return(result);
|
|
8006c3c: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8006c3e: 2b00 cmp r3, #0
|
|
8006c40: d1e6 bne.n 8006c10 <UART_EndTxTransfer+0x8>
|
|
ATOMIC_CLEAR_BIT(huart->Instance->CR3, (USART_CR3_TXFTIE));
|
|
8006c42: 687b ldr r3, [r7, #4]
|
|
8006c44: 681b ldr r3, [r3, #0]
|
|
8006c46: 3308 adds r3, #8
|
|
8006c48: 60fb str r3, [r7, #12]
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
8006c4a: 68fb ldr r3, [r7, #12]
|
|
8006c4c: e853 3f00 ldrex r3, [r3]
|
|
8006c50: 60bb str r3, [r7, #8]
|
|
return(result);
|
|
8006c52: 68bb ldr r3, [r7, #8]
|
|
8006c54: f423 0300 bic.w r3, r3, #8388608 @ 0x800000
|
|
8006c58: 633b str r3, [r7, #48] @ 0x30
|
|
8006c5a: 687b ldr r3, [r7, #4]
|
|
8006c5c: 681b ldr r3, [r3, #0]
|
|
8006c5e: 3308 adds r3, #8
|
|
8006c60: 6b3a ldr r2, [r7, #48] @ 0x30
|
|
8006c62: 61ba str r2, [r7, #24]
|
|
8006c64: 617b str r3, [r7, #20]
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
8006c66: 6979 ldr r1, [r7, #20]
|
|
8006c68: 69ba ldr r2, [r7, #24]
|
|
8006c6a: e841 2300 strex r3, r2, [r1]
|
|
8006c6e: 613b str r3, [r7, #16]
|
|
return(result);
|
|
8006c70: 693b ldr r3, [r7, #16]
|
|
8006c72: 2b00 cmp r3, #0
|
|
8006c74: d1e5 bne.n 8006c42 <UART_EndTxTransfer+0x3a>
|
|
|
|
/* At end of Tx process, restore huart->gState to Ready */
|
|
huart->gState = HAL_UART_STATE_READY;
|
|
8006c76: 687b ldr r3, [r7, #4]
|
|
8006c78: 2220 movs r2, #32
|
|
8006c7a: f8c3 2088 str.w r2, [r3, #136] @ 0x88
|
|
}
|
|
8006c7e: bf00 nop
|
|
8006c80: 373c adds r7, #60 @ 0x3c
|
|
8006c82: 46bd mov sp, r7
|
|
8006c84: bc80 pop {r7}
|
|
8006c86: 4770 bx lr
|
|
|
|
08006c88 <UART_EndRxTransfer>:
|
|
* @brief End ongoing Rx transfer on UART peripheral (following error detection or Reception completion).
|
|
* @param huart UART handle.
|
|
* @retval None
|
|
*/
|
|
static void UART_EndRxTransfer(UART_HandleTypeDef *huart)
|
|
{
|
|
8006c88: b480 push {r7}
|
|
8006c8a: b095 sub sp, #84 @ 0x54
|
|
8006c8c: af00 add r7, sp, #0
|
|
8006c8e: 6078 str r0, [r7, #4]
|
|
/* Disable RXNE, PE and ERR (Frame error, noise error, overrun error) interrupts */
|
|
ATOMIC_CLEAR_BIT(huart->Instance->CR1, (USART_CR1_RXNEIE_RXFNEIE | USART_CR1_PEIE));
|
|
8006c90: 687b ldr r3, [r7, #4]
|
|
8006c92: 681b ldr r3, [r3, #0]
|
|
8006c94: 637b str r3, [r7, #52] @ 0x34
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
8006c96: 6b7b ldr r3, [r7, #52] @ 0x34
|
|
8006c98: e853 3f00 ldrex r3, [r3]
|
|
8006c9c: 633b str r3, [r7, #48] @ 0x30
|
|
return(result);
|
|
8006c9e: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
8006ca0: f423 7390 bic.w r3, r3, #288 @ 0x120
|
|
8006ca4: 64fb str r3, [r7, #76] @ 0x4c
|
|
8006ca6: 687b ldr r3, [r7, #4]
|
|
8006ca8: 681b ldr r3, [r3, #0]
|
|
8006caa: 461a mov r2, r3
|
|
8006cac: 6cfb ldr r3, [r7, #76] @ 0x4c
|
|
8006cae: 643b str r3, [r7, #64] @ 0x40
|
|
8006cb0: 63fa str r2, [r7, #60] @ 0x3c
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
8006cb2: 6bf9 ldr r1, [r7, #60] @ 0x3c
|
|
8006cb4: 6c3a ldr r2, [r7, #64] @ 0x40
|
|
8006cb6: e841 2300 strex r3, r2, [r1]
|
|
8006cba: 63bb str r3, [r7, #56] @ 0x38
|
|
return(result);
|
|
8006cbc: 6bbb ldr r3, [r7, #56] @ 0x38
|
|
8006cbe: 2b00 cmp r3, #0
|
|
8006cc0: d1e6 bne.n 8006c90 <UART_EndRxTransfer+0x8>
|
|
ATOMIC_CLEAR_BIT(huart->Instance->CR3, (USART_CR3_EIE | USART_CR3_RXFTIE));
|
|
8006cc2: 687b ldr r3, [r7, #4]
|
|
8006cc4: 681b ldr r3, [r3, #0]
|
|
8006cc6: 3308 adds r3, #8
|
|
8006cc8: 623b str r3, [r7, #32]
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
8006cca: 6a3b ldr r3, [r7, #32]
|
|
8006ccc: e853 3f00 ldrex r3, [r3]
|
|
8006cd0: 61fb str r3, [r7, #28]
|
|
return(result);
|
|
8006cd2: 69fb ldr r3, [r7, #28]
|
|
8006cd4: f023 5380 bic.w r3, r3, #268435456 @ 0x10000000
|
|
8006cd8: f023 0301 bic.w r3, r3, #1
|
|
8006cdc: 64bb str r3, [r7, #72] @ 0x48
|
|
8006cde: 687b ldr r3, [r7, #4]
|
|
8006ce0: 681b ldr r3, [r3, #0]
|
|
8006ce2: 3308 adds r3, #8
|
|
8006ce4: 6cba ldr r2, [r7, #72] @ 0x48
|
|
8006ce6: 62fa str r2, [r7, #44] @ 0x2c
|
|
8006ce8: 62bb str r3, [r7, #40] @ 0x28
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
8006cea: 6ab9 ldr r1, [r7, #40] @ 0x28
|
|
8006cec: 6afa ldr r2, [r7, #44] @ 0x2c
|
|
8006cee: e841 2300 strex r3, r2, [r1]
|
|
8006cf2: 627b str r3, [r7, #36] @ 0x24
|
|
return(result);
|
|
8006cf4: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8006cf6: 2b00 cmp r3, #0
|
|
8006cf8: d1e3 bne.n 8006cc2 <UART_EndRxTransfer+0x3a>
|
|
|
|
/* In case of reception waiting for IDLE event, disable also the IDLE IE interrupt source */
|
|
if (huart->ReceptionType == HAL_UART_RECEPTION_TOIDLE)
|
|
8006cfa: 687b ldr r3, [r7, #4]
|
|
8006cfc: 6edb ldr r3, [r3, #108] @ 0x6c
|
|
8006cfe: 2b01 cmp r3, #1
|
|
8006d00: d118 bne.n 8006d34 <UART_EndRxTransfer+0xac>
|
|
{
|
|
ATOMIC_CLEAR_BIT(huart->Instance->CR1, USART_CR1_IDLEIE);
|
|
8006d02: 687b ldr r3, [r7, #4]
|
|
8006d04: 681b ldr r3, [r3, #0]
|
|
8006d06: 60fb str r3, [r7, #12]
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
8006d08: 68fb ldr r3, [r7, #12]
|
|
8006d0a: e853 3f00 ldrex r3, [r3]
|
|
8006d0e: 60bb str r3, [r7, #8]
|
|
return(result);
|
|
8006d10: 68bb ldr r3, [r7, #8]
|
|
8006d12: f023 0310 bic.w r3, r3, #16
|
|
8006d16: 647b str r3, [r7, #68] @ 0x44
|
|
8006d18: 687b ldr r3, [r7, #4]
|
|
8006d1a: 681b ldr r3, [r3, #0]
|
|
8006d1c: 461a mov r2, r3
|
|
8006d1e: 6c7b ldr r3, [r7, #68] @ 0x44
|
|
8006d20: 61bb str r3, [r7, #24]
|
|
8006d22: 617a str r2, [r7, #20]
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
8006d24: 6979 ldr r1, [r7, #20]
|
|
8006d26: 69ba ldr r2, [r7, #24]
|
|
8006d28: e841 2300 strex r3, r2, [r1]
|
|
8006d2c: 613b str r3, [r7, #16]
|
|
return(result);
|
|
8006d2e: 693b ldr r3, [r7, #16]
|
|
8006d30: 2b00 cmp r3, #0
|
|
8006d32: d1e6 bne.n 8006d02 <UART_EndRxTransfer+0x7a>
|
|
}
|
|
|
|
/* At end of Rx process, restore huart->RxState to Ready */
|
|
huart->RxState = HAL_UART_STATE_READY;
|
|
8006d34: 687b ldr r3, [r7, #4]
|
|
8006d36: 2220 movs r2, #32
|
|
8006d38: f8c3 208c str.w r2, [r3, #140] @ 0x8c
|
|
huart->ReceptionType = HAL_UART_RECEPTION_STANDARD;
|
|
8006d3c: 687b ldr r3, [r7, #4]
|
|
8006d3e: 2200 movs r2, #0
|
|
8006d40: 66da str r2, [r3, #108] @ 0x6c
|
|
|
|
/* Reset RxIsr function pointer */
|
|
huart->RxISR = NULL;
|
|
8006d42: 687b ldr r3, [r7, #4]
|
|
8006d44: 2200 movs r2, #0
|
|
8006d46: 675a str r2, [r3, #116] @ 0x74
|
|
}
|
|
8006d48: bf00 nop
|
|
8006d4a: 3754 adds r7, #84 @ 0x54
|
|
8006d4c: 46bd mov sp, r7
|
|
8006d4e: bc80 pop {r7}
|
|
8006d50: 4770 bx lr
|
|
|
|
08006d52 <UART_DMATransmitCplt>:
|
|
* @brief DMA UART transmit process complete callback.
|
|
* @param hdma DMA handle.
|
|
* @retval None
|
|
*/
|
|
static void UART_DMATransmitCplt(DMA_HandleTypeDef *hdma)
|
|
{
|
|
8006d52: b580 push {r7, lr}
|
|
8006d54: b090 sub sp, #64 @ 0x40
|
|
8006d56: af00 add r7, sp, #0
|
|
8006d58: 6078 str r0, [r7, #4]
|
|
UART_HandleTypeDef *huart = (UART_HandleTypeDef *)(hdma->Parent);
|
|
8006d5a: 687b ldr r3, [r7, #4]
|
|
8006d5c: 6a9b ldr r3, [r3, #40] @ 0x28
|
|
8006d5e: 63fb str r3, [r7, #60] @ 0x3c
|
|
|
|
/* DMA Normal mode */
|
|
if (HAL_IS_BIT_CLR(hdma->Instance->CCR, DMA_CCR_CIRC))
|
|
8006d60: 687b ldr r3, [r7, #4]
|
|
8006d62: 681b ldr r3, [r3, #0]
|
|
8006d64: 681b ldr r3, [r3, #0]
|
|
8006d66: f003 0320 and.w r3, r3, #32
|
|
8006d6a: 2b00 cmp r3, #0
|
|
8006d6c: d133 bne.n 8006dd6 <UART_DMATransmitCplt+0x84>
|
|
{
|
|
/* Disable the DMA transfer for transmit request by resetting the DMAT bit
|
|
in the UART CR3 register */
|
|
ATOMIC_CLEAR_BIT(huart->Instance->CR3, USART_CR3_DMAT);
|
|
8006d6e: 6bfb ldr r3, [r7, #60] @ 0x3c
|
|
8006d70: 681b ldr r3, [r3, #0]
|
|
8006d72: 3308 adds r3, #8
|
|
8006d74: 627b str r3, [r7, #36] @ 0x24
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
8006d76: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8006d78: e853 3f00 ldrex r3, [r3]
|
|
8006d7c: 623b str r3, [r7, #32]
|
|
return(result);
|
|
8006d7e: 6a3b ldr r3, [r7, #32]
|
|
8006d80: f023 0380 bic.w r3, r3, #128 @ 0x80
|
|
8006d84: 63bb str r3, [r7, #56] @ 0x38
|
|
8006d86: 6bfb ldr r3, [r7, #60] @ 0x3c
|
|
8006d88: 681b ldr r3, [r3, #0]
|
|
8006d8a: 3308 adds r3, #8
|
|
8006d8c: 6bba ldr r2, [r7, #56] @ 0x38
|
|
8006d8e: 633a str r2, [r7, #48] @ 0x30
|
|
8006d90: 62fb str r3, [r7, #44] @ 0x2c
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
8006d92: 6af9 ldr r1, [r7, #44] @ 0x2c
|
|
8006d94: 6b3a ldr r2, [r7, #48] @ 0x30
|
|
8006d96: e841 2300 strex r3, r2, [r1]
|
|
8006d9a: 62bb str r3, [r7, #40] @ 0x28
|
|
return(result);
|
|
8006d9c: 6abb ldr r3, [r7, #40] @ 0x28
|
|
8006d9e: 2b00 cmp r3, #0
|
|
8006da0: d1e5 bne.n 8006d6e <UART_DMATransmitCplt+0x1c>
|
|
|
|
/* Enable the UART Transmit Complete Interrupt */
|
|
ATOMIC_SET_BIT(huart->Instance->CR1, USART_CR1_TCIE);
|
|
8006da2: 6bfb ldr r3, [r7, #60] @ 0x3c
|
|
8006da4: 681b ldr r3, [r3, #0]
|
|
8006da6: 613b str r3, [r7, #16]
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
8006da8: 693b ldr r3, [r7, #16]
|
|
8006daa: e853 3f00 ldrex r3, [r3]
|
|
8006dae: 60fb str r3, [r7, #12]
|
|
return(result);
|
|
8006db0: 68fb ldr r3, [r7, #12]
|
|
8006db2: f043 0340 orr.w r3, r3, #64 @ 0x40
|
|
8006db6: 637b str r3, [r7, #52] @ 0x34
|
|
8006db8: 6bfb ldr r3, [r7, #60] @ 0x3c
|
|
8006dba: 681b ldr r3, [r3, #0]
|
|
8006dbc: 461a mov r2, r3
|
|
8006dbe: 6b7b ldr r3, [r7, #52] @ 0x34
|
|
8006dc0: 61fb str r3, [r7, #28]
|
|
8006dc2: 61ba str r2, [r7, #24]
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
8006dc4: 69b9 ldr r1, [r7, #24]
|
|
8006dc6: 69fa ldr r2, [r7, #28]
|
|
8006dc8: e841 2300 strex r3, r2, [r1]
|
|
8006dcc: 617b str r3, [r7, #20]
|
|
return(result);
|
|
8006dce: 697b ldr r3, [r7, #20]
|
|
8006dd0: 2b00 cmp r3, #0
|
|
8006dd2: d1e6 bne.n 8006da2 <UART_DMATransmitCplt+0x50>
|
|
#else
|
|
/*Call legacy weak Tx complete callback*/
|
|
HAL_UART_TxCpltCallback(huart);
|
|
#endif /* USE_HAL_UART_REGISTER_CALLBACKS */
|
|
}
|
|
}
|
|
8006dd4: e002 b.n 8006ddc <UART_DMATransmitCplt+0x8a>
|
|
HAL_UART_TxCpltCallback(huart);
|
|
8006dd6: 6bf8 ldr r0, [r7, #60] @ 0x3c
|
|
8006dd8: f7fa fc3e bl 8001658 <HAL_UART_TxCpltCallback>
|
|
}
|
|
8006ddc: bf00 nop
|
|
8006dde: 3740 adds r7, #64 @ 0x40
|
|
8006de0: 46bd mov sp, r7
|
|
8006de2: bd80 pop {r7, pc}
|
|
|
|
08006de4 <UART_DMATxHalfCplt>:
|
|
* @brief DMA UART transmit process half complete callback.
|
|
* @param hdma DMA handle.
|
|
* @retval None
|
|
*/
|
|
static void UART_DMATxHalfCplt(DMA_HandleTypeDef *hdma)
|
|
{
|
|
8006de4: b580 push {r7, lr}
|
|
8006de6: b084 sub sp, #16
|
|
8006de8: af00 add r7, sp, #0
|
|
8006dea: 6078 str r0, [r7, #4]
|
|
UART_HandleTypeDef *huart = (UART_HandleTypeDef *)(hdma->Parent);
|
|
8006dec: 687b ldr r3, [r7, #4]
|
|
8006dee: 6a9b ldr r3, [r3, #40] @ 0x28
|
|
8006df0: 60fb str r3, [r7, #12]
|
|
#if (USE_HAL_UART_REGISTER_CALLBACKS == 1)
|
|
/*Call registered Tx Half complete callback*/
|
|
huart->TxHalfCpltCallback(huart);
|
|
#else
|
|
/*Call legacy weak Tx Half complete callback*/
|
|
HAL_UART_TxHalfCpltCallback(huart);
|
|
8006df2: 68f8 ldr r0, [r7, #12]
|
|
8006df4: f7ff f99e bl 8006134 <HAL_UART_TxHalfCpltCallback>
|
|
#endif /* USE_HAL_UART_REGISTER_CALLBACKS */
|
|
}
|
|
8006df8: bf00 nop
|
|
8006dfa: 3710 adds r7, #16
|
|
8006dfc: 46bd mov sp, r7
|
|
8006dfe: bd80 pop {r7, pc}
|
|
|
|
08006e00 <UART_DMAError>:
|
|
* @brief DMA UART communication error callback.
|
|
* @param hdma DMA handle.
|
|
* @retval None
|
|
*/
|
|
static void UART_DMAError(DMA_HandleTypeDef *hdma)
|
|
{
|
|
8006e00: b580 push {r7, lr}
|
|
8006e02: b086 sub sp, #24
|
|
8006e04: af00 add r7, sp, #0
|
|
8006e06: 6078 str r0, [r7, #4]
|
|
UART_HandleTypeDef *huart = (UART_HandleTypeDef *)(hdma->Parent);
|
|
8006e08: 687b ldr r3, [r7, #4]
|
|
8006e0a: 6a9b ldr r3, [r3, #40] @ 0x28
|
|
8006e0c: 617b str r3, [r7, #20]
|
|
|
|
const HAL_UART_StateTypeDef gstate = huart->gState;
|
|
8006e0e: 697b ldr r3, [r7, #20]
|
|
8006e10: f8d3 3088 ldr.w r3, [r3, #136] @ 0x88
|
|
8006e14: 613b str r3, [r7, #16]
|
|
const HAL_UART_StateTypeDef rxstate = huart->RxState;
|
|
8006e16: 697b ldr r3, [r7, #20]
|
|
8006e18: f8d3 308c ldr.w r3, [r3, #140] @ 0x8c
|
|
8006e1c: 60fb str r3, [r7, #12]
|
|
|
|
/* Stop UART DMA Tx request if ongoing */
|
|
if ((HAL_IS_BIT_SET(huart->Instance->CR3, USART_CR3_DMAT)) &&
|
|
8006e1e: 697b ldr r3, [r7, #20]
|
|
8006e20: 681b ldr r3, [r3, #0]
|
|
8006e22: 689b ldr r3, [r3, #8]
|
|
8006e24: f003 0380 and.w r3, r3, #128 @ 0x80
|
|
8006e28: 2b80 cmp r3, #128 @ 0x80
|
|
8006e2a: d105 bne.n 8006e38 <UART_DMAError+0x38>
|
|
8006e2c: 693b ldr r3, [r7, #16]
|
|
8006e2e: 2b21 cmp r3, #33 @ 0x21
|
|
8006e30: d102 bne.n 8006e38 <UART_DMAError+0x38>
|
|
(gstate == HAL_UART_STATE_BUSY_TX))
|
|
{
|
|
UART_EndTxTransfer(huart);
|
|
8006e32: 6978 ldr r0, [r7, #20]
|
|
8006e34: f7ff fee8 bl 8006c08 <UART_EndTxTransfer>
|
|
}
|
|
|
|
/* Stop UART DMA Rx request if ongoing */
|
|
if ((HAL_IS_BIT_SET(huart->Instance->CR3, USART_CR3_DMAR)) &&
|
|
8006e38: 697b ldr r3, [r7, #20]
|
|
8006e3a: 681b ldr r3, [r3, #0]
|
|
8006e3c: 689b ldr r3, [r3, #8]
|
|
8006e3e: f003 0340 and.w r3, r3, #64 @ 0x40
|
|
8006e42: 2b40 cmp r3, #64 @ 0x40
|
|
8006e44: d105 bne.n 8006e52 <UART_DMAError+0x52>
|
|
8006e46: 68fb ldr r3, [r7, #12]
|
|
8006e48: 2b22 cmp r3, #34 @ 0x22
|
|
8006e4a: d102 bne.n 8006e52 <UART_DMAError+0x52>
|
|
(rxstate == HAL_UART_STATE_BUSY_RX))
|
|
{
|
|
UART_EndRxTransfer(huart);
|
|
8006e4c: 6978 ldr r0, [r7, #20]
|
|
8006e4e: f7ff ff1b bl 8006c88 <UART_EndRxTransfer>
|
|
}
|
|
|
|
huart->ErrorCode |= HAL_UART_ERROR_DMA;
|
|
8006e52: 697b ldr r3, [r7, #20]
|
|
8006e54: f8d3 3090 ldr.w r3, [r3, #144] @ 0x90
|
|
8006e58: f043 0210 orr.w r2, r3, #16
|
|
8006e5c: 697b ldr r3, [r7, #20]
|
|
8006e5e: f8c3 2090 str.w r2, [r3, #144] @ 0x90
|
|
#if (USE_HAL_UART_REGISTER_CALLBACKS == 1)
|
|
/*Call registered error callback*/
|
|
huart->ErrorCallback(huart);
|
|
#else
|
|
/*Call legacy weak error callback*/
|
|
HAL_UART_ErrorCallback(huart);
|
|
8006e62: 6978 ldr r0, [r7, #20]
|
|
8006e64: f7ff f96f bl 8006146 <HAL_UART_ErrorCallback>
|
|
#endif /* USE_HAL_UART_REGISTER_CALLBACKS */
|
|
}
|
|
8006e68: bf00 nop
|
|
8006e6a: 3718 adds r7, #24
|
|
8006e6c: 46bd mov sp, r7
|
|
8006e6e: bd80 pop {r7, pc}
|
|
|
|
08006e70 <UART_DMAAbortOnError>:
|
|
* (To be called at end of DMA Abort procedure following error occurrence).
|
|
* @param hdma DMA handle.
|
|
* @retval None
|
|
*/
|
|
static void UART_DMAAbortOnError(DMA_HandleTypeDef *hdma)
|
|
{
|
|
8006e70: b580 push {r7, lr}
|
|
8006e72: b084 sub sp, #16
|
|
8006e74: af00 add r7, sp, #0
|
|
8006e76: 6078 str r0, [r7, #4]
|
|
UART_HandleTypeDef *huart = (UART_HandleTypeDef *)(hdma->Parent);
|
|
8006e78: 687b ldr r3, [r7, #4]
|
|
8006e7a: 6a9b ldr r3, [r3, #40] @ 0x28
|
|
8006e7c: 60fb str r3, [r7, #12]
|
|
#if (USE_HAL_UART_REGISTER_CALLBACKS == 1)
|
|
/*Call registered error callback*/
|
|
huart->ErrorCallback(huart);
|
|
#else
|
|
/*Call legacy weak error callback*/
|
|
HAL_UART_ErrorCallback(huart);
|
|
8006e7e: 68f8 ldr r0, [r7, #12]
|
|
8006e80: f7ff f961 bl 8006146 <HAL_UART_ErrorCallback>
|
|
#endif /* USE_HAL_UART_REGISTER_CALLBACKS */
|
|
}
|
|
8006e84: bf00 nop
|
|
8006e86: 3710 adds r7, #16
|
|
8006e88: 46bd mov sp, r7
|
|
8006e8a: bd80 pop {r7, pc}
|
|
|
|
08006e8c <UART_EndTransmit_IT>:
|
|
* @param huart pointer to a UART_HandleTypeDef structure that contains
|
|
* the configuration information for the specified UART module.
|
|
* @retval None
|
|
*/
|
|
static void UART_EndTransmit_IT(UART_HandleTypeDef *huart)
|
|
{
|
|
8006e8c: b580 push {r7, lr}
|
|
8006e8e: b088 sub sp, #32
|
|
8006e90: af00 add r7, sp, #0
|
|
8006e92: 6078 str r0, [r7, #4]
|
|
/* Disable the UART Transmit Complete Interrupt */
|
|
ATOMIC_CLEAR_BIT(huart->Instance->CR1, USART_CR1_TCIE);
|
|
8006e94: 687b ldr r3, [r7, #4]
|
|
8006e96: 681b ldr r3, [r3, #0]
|
|
8006e98: 60fb str r3, [r7, #12]
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
8006e9a: 68fb ldr r3, [r7, #12]
|
|
8006e9c: e853 3f00 ldrex r3, [r3]
|
|
8006ea0: 60bb str r3, [r7, #8]
|
|
return(result);
|
|
8006ea2: 68bb ldr r3, [r7, #8]
|
|
8006ea4: f023 0340 bic.w r3, r3, #64 @ 0x40
|
|
8006ea8: 61fb str r3, [r7, #28]
|
|
8006eaa: 687b ldr r3, [r7, #4]
|
|
8006eac: 681b ldr r3, [r3, #0]
|
|
8006eae: 461a mov r2, r3
|
|
8006eb0: 69fb ldr r3, [r7, #28]
|
|
8006eb2: 61bb str r3, [r7, #24]
|
|
8006eb4: 617a str r2, [r7, #20]
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
8006eb6: 6979 ldr r1, [r7, #20]
|
|
8006eb8: 69ba ldr r2, [r7, #24]
|
|
8006eba: e841 2300 strex r3, r2, [r1]
|
|
8006ebe: 613b str r3, [r7, #16]
|
|
return(result);
|
|
8006ec0: 693b ldr r3, [r7, #16]
|
|
8006ec2: 2b00 cmp r3, #0
|
|
8006ec4: d1e6 bne.n 8006e94 <UART_EndTransmit_IT+0x8>
|
|
|
|
/* Tx process is ended, restore huart->gState to Ready */
|
|
huart->gState = HAL_UART_STATE_READY;
|
|
8006ec6: 687b ldr r3, [r7, #4]
|
|
8006ec8: 2220 movs r2, #32
|
|
8006eca: f8c3 2088 str.w r2, [r3, #136] @ 0x88
|
|
|
|
/* Cleat TxISR function pointer */
|
|
huart->TxISR = NULL;
|
|
8006ece: 687b ldr r3, [r7, #4]
|
|
8006ed0: 2200 movs r2, #0
|
|
8006ed2: 679a str r2, [r3, #120] @ 0x78
|
|
#if (USE_HAL_UART_REGISTER_CALLBACKS == 1)
|
|
/*Call registered Tx complete callback*/
|
|
huart->TxCpltCallback(huart);
|
|
#else
|
|
/*Call legacy weak Tx complete callback*/
|
|
HAL_UART_TxCpltCallback(huart);
|
|
8006ed4: 6878 ldr r0, [r7, #4]
|
|
8006ed6: f7fa fbbf bl 8001658 <HAL_UART_TxCpltCallback>
|
|
#endif /* USE_HAL_UART_REGISTER_CALLBACKS */
|
|
}
|
|
8006eda: bf00 nop
|
|
8006edc: 3720 adds r7, #32
|
|
8006ede: 46bd mov sp, r7
|
|
8006ee0: bd80 pop {r7, pc}
|
|
...
|
|
|
|
08006ee4 <UART_RxISR_8BIT>:
|
|
* @brief RX interrupt handler for 7 or 8 bits data word length .
|
|
* @param huart UART handle.
|
|
* @retval None
|
|
*/
|
|
static void UART_RxISR_8BIT(UART_HandleTypeDef *huart)
|
|
{
|
|
8006ee4: b580 push {r7, lr}
|
|
8006ee6: b09c sub sp, #112 @ 0x70
|
|
8006ee8: af00 add r7, sp, #0
|
|
8006eea: 6078 str r0, [r7, #4]
|
|
uint16_t uhMask = huart->Mask;
|
|
8006eec: 687b ldr r3, [r7, #4]
|
|
8006eee: f8b3 3060 ldrh.w r3, [r3, #96] @ 0x60
|
|
8006ef2: f8a7 306e strh.w r3, [r7, #110] @ 0x6e
|
|
uint16_t uhdata;
|
|
|
|
/* Check that a Rx process is ongoing */
|
|
if (huart->RxState == HAL_UART_STATE_BUSY_RX)
|
|
8006ef6: 687b ldr r3, [r7, #4]
|
|
8006ef8: f8d3 308c ldr.w r3, [r3, #140] @ 0x8c
|
|
8006efc: 2b22 cmp r3, #34 @ 0x22
|
|
8006efe: f040 80be bne.w 800707e <UART_RxISR_8BIT+0x19a>
|
|
{
|
|
uhdata = (uint16_t) READ_REG(huart->Instance->RDR);
|
|
8006f02: 687b ldr r3, [r7, #4]
|
|
8006f04: 681b ldr r3, [r3, #0]
|
|
8006f06: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
8006f08: f8a7 306c strh.w r3, [r7, #108] @ 0x6c
|
|
*huart->pRxBuffPtr = (uint8_t)(uhdata & (uint8_t)uhMask);
|
|
8006f0c: f8b7 306c ldrh.w r3, [r7, #108] @ 0x6c
|
|
8006f10: b2d9 uxtb r1, r3
|
|
8006f12: f8b7 306e ldrh.w r3, [r7, #110] @ 0x6e
|
|
8006f16: b2da uxtb r2, r3
|
|
8006f18: 687b ldr r3, [r7, #4]
|
|
8006f1a: 6d9b ldr r3, [r3, #88] @ 0x58
|
|
8006f1c: 400a ands r2, r1
|
|
8006f1e: b2d2 uxtb r2, r2
|
|
8006f20: 701a strb r2, [r3, #0]
|
|
huart->pRxBuffPtr++;
|
|
8006f22: 687b ldr r3, [r7, #4]
|
|
8006f24: 6d9b ldr r3, [r3, #88] @ 0x58
|
|
8006f26: 1c5a adds r2, r3, #1
|
|
8006f28: 687b ldr r3, [r7, #4]
|
|
8006f2a: 659a str r2, [r3, #88] @ 0x58
|
|
huart->RxXferCount--;
|
|
8006f2c: 687b ldr r3, [r7, #4]
|
|
8006f2e: f8b3 305e ldrh.w r3, [r3, #94] @ 0x5e
|
|
8006f32: b29b uxth r3, r3
|
|
8006f34: 3b01 subs r3, #1
|
|
8006f36: b29a uxth r2, r3
|
|
8006f38: 687b ldr r3, [r7, #4]
|
|
8006f3a: f8a3 205e strh.w r2, [r3, #94] @ 0x5e
|
|
|
|
if (huart->RxXferCount == 0U)
|
|
8006f3e: 687b ldr r3, [r7, #4]
|
|
8006f40: f8b3 305e ldrh.w r3, [r3, #94] @ 0x5e
|
|
8006f44: b29b uxth r3, r3
|
|
8006f46: 2b00 cmp r3, #0
|
|
8006f48: f040 80a1 bne.w 800708e <UART_RxISR_8BIT+0x1aa>
|
|
{
|
|
/* Disable the UART Parity Error Interrupt and RXNE interrupts */
|
|
ATOMIC_CLEAR_BIT(huart->Instance->CR1, (USART_CR1_RXNEIE_RXFNEIE | USART_CR1_PEIE));
|
|
8006f4c: 687b ldr r3, [r7, #4]
|
|
8006f4e: 681b ldr r3, [r3, #0]
|
|
8006f50: 64fb str r3, [r7, #76] @ 0x4c
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
8006f52: 6cfb ldr r3, [r7, #76] @ 0x4c
|
|
8006f54: e853 3f00 ldrex r3, [r3]
|
|
8006f58: 64bb str r3, [r7, #72] @ 0x48
|
|
return(result);
|
|
8006f5a: 6cbb ldr r3, [r7, #72] @ 0x48
|
|
8006f5c: f423 7390 bic.w r3, r3, #288 @ 0x120
|
|
8006f60: 66bb str r3, [r7, #104] @ 0x68
|
|
8006f62: 687b ldr r3, [r7, #4]
|
|
8006f64: 681b ldr r3, [r3, #0]
|
|
8006f66: 461a mov r2, r3
|
|
8006f68: 6ebb ldr r3, [r7, #104] @ 0x68
|
|
8006f6a: 65bb str r3, [r7, #88] @ 0x58
|
|
8006f6c: 657a str r2, [r7, #84] @ 0x54
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
8006f6e: 6d79 ldr r1, [r7, #84] @ 0x54
|
|
8006f70: 6dba ldr r2, [r7, #88] @ 0x58
|
|
8006f72: e841 2300 strex r3, r2, [r1]
|
|
8006f76: 653b str r3, [r7, #80] @ 0x50
|
|
return(result);
|
|
8006f78: 6d3b ldr r3, [r7, #80] @ 0x50
|
|
8006f7a: 2b00 cmp r3, #0
|
|
8006f7c: d1e6 bne.n 8006f4c <UART_RxISR_8BIT+0x68>
|
|
|
|
/* Disable the UART Error Interrupt: (Frame error, noise error, overrun error) */
|
|
ATOMIC_CLEAR_BIT(huart->Instance->CR3, USART_CR3_EIE);
|
|
8006f7e: 687b ldr r3, [r7, #4]
|
|
8006f80: 681b ldr r3, [r3, #0]
|
|
8006f82: 3308 adds r3, #8
|
|
8006f84: 63bb str r3, [r7, #56] @ 0x38
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
8006f86: 6bbb ldr r3, [r7, #56] @ 0x38
|
|
8006f88: e853 3f00 ldrex r3, [r3]
|
|
8006f8c: 637b str r3, [r7, #52] @ 0x34
|
|
return(result);
|
|
8006f8e: 6b7b ldr r3, [r7, #52] @ 0x34
|
|
8006f90: f023 0301 bic.w r3, r3, #1
|
|
8006f94: 667b str r3, [r7, #100] @ 0x64
|
|
8006f96: 687b ldr r3, [r7, #4]
|
|
8006f98: 681b ldr r3, [r3, #0]
|
|
8006f9a: 3308 adds r3, #8
|
|
8006f9c: 6e7a ldr r2, [r7, #100] @ 0x64
|
|
8006f9e: 647a str r2, [r7, #68] @ 0x44
|
|
8006fa0: 643b str r3, [r7, #64] @ 0x40
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
8006fa2: 6c39 ldr r1, [r7, #64] @ 0x40
|
|
8006fa4: 6c7a ldr r2, [r7, #68] @ 0x44
|
|
8006fa6: e841 2300 strex r3, r2, [r1]
|
|
8006faa: 63fb str r3, [r7, #60] @ 0x3c
|
|
return(result);
|
|
8006fac: 6bfb ldr r3, [r7, #60] @ 0x3c
|
|
8006fae: 2b00 cmp r3, #0
|
|
8006fb0: d1e5 bne.n 8006f7e <UART_RxISR_8BIT+0x9a>
|
|
|
|
/* Rx process is completed, restore huart->RxState to Ready */
|
|
huart->RxState = HAL_UART_STATE_READY;
|
|
8006fb2: 687b ldr r3, [r7, #4]
|
|
8006fb4: 2220 movs r2, #32
|
|
8006fb6: f8c3 208c str.w r2, [r3, #140] @ 0x8c
|
|
|
|
/* Clear RxISR function pointer */
|
|
huart->RxISR = NULL;
|
|
8006fba: 687b ldr r3, [r7, #4]
|
|
8006fbc: 2200 movs r2, #0
|
|
8006fbe: 675a str r2, [r3, #116] @ 0x74
|
|
|
|
/* Initialize type of RxEvent to Transfer Complete */
|
|
huart->RxEventType = HAL_UART_RXEVENT_TC;
|
|
8006fc0: 687b ldr r3, [r7, #4]
|
|
8006fc2: 2200 movs r2, #0
|
|
8006fc4: 671a str r2, [r3, #112] @ 0x70
|
|
|
|
if (!(IS_LPUART_INSTANCE(huart->Instance)))
|
|
8006fc6: 687b ldr r3, [r7, #4]
|
|
8006fc8: 681b ldr r3, [r3, #0]
|
|
8006fca: 4a33 ldr r2, [pc, #204] @ (8007098 <UART_RxISR_8BIT+0x1b4>)
|
|
8006fcc: 4293 cmp r3, r2
|
|
8006fce: d01f beq.n 8007010 <UART_RxISR_8BIT+0x12c>
|
|
{
|
|
/* Check that USART RTOEN bit is set */
|
|
if (READ_BIT(huart->Instance->CR2, USART_CR2_RTOEN) != 0U)
|
|
8006fd0: 687b ldr r3, [r7, #4]
|
|
8006fd2: 681b ldr r3, [r3, #0]
|
|
8006fd4: 685b ldr r3, [r3, #4]
|
|
8006fd6: f403 0300 and.w r3, r3, #8388608 @ 0x800000
|
|
8006fda: 2b00 cmp r3, #0
|
|
8006fdc: d018 beq.n 8007010 <UART_RxISR_8BIT+0x12c>
|
|
{
|
|
/* Enable the UART Receiver Timeout Interrupt */
|
|
ATOMIC_CLEAR_BIT(huart->Instance->CR1, USART_CR1_RTOIE);
|
|
8006fde: 687b ldr r3, [r7, #4]
|
|
8006fe0: 681b ldr r3, [r3, #0]
|
|
8006fe2: 627b str r3, [r7, #36] @ 0x24
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
8006fe4: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8006fe6: e853 3f00 ldrex r3, [r3]
|
|
8006fea: 623b str r3, [r7, #32]
|
|
return(result);
|
|
8006fec: 6a3b ldr r3, [r7, #32]
|
|
8006fee: f023 6380 bic.w r3, r3, #67108864 @ 0x4000000
|
|
8006ff2: 663b str r3, [r7, #96] @ 0x60
|
|
8006ff4: 687b ldr r3, [r7, #4]
|
|
8006ff6: 681b ldr r3, [r3, #0]
|
|
8006ff8: 461a mov r2, r3
|
|
8006ffa: 6e3b ldr r3, [r7, #96] @ 0x60
|
|
8006ffc: 633b str r3, [r7, #48] @ 0x30
|
|
8006ffe: 62fa str r2, [r7, #44] @ 0x2c
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
8007000: 6af9 ldr r1, [r7, #44] @ 0x2c
|
|
8007002: 6b3a ldr r2, [r7, #48] @ 0x30
|
|
8007004: e841 2300 strex r3, r2, [r1]
|
|
8007008: 62bb str r3, [r7, #40] @ 0x28
|
|
return(result);
|
|
800700a: 6abb ldr r3, [r7, #40] @ 0x28
|
|
800700c: 2b00 cmp r3, #0
|
|
800700e: d1e6 bne.n 8006fde <UART_RxISR_8BIT+0xfa>
|
|
}
|
|
}
|
|
|
|
/* Check current reception Mode :
|
|
If Reception till IDLE event has been selected : */
|
|
if (huart->ReceptionType == HAL_UART_RECEPTION_TOIDLE)
|
|
8007010: 687b ldr r3, [r7, #4]
|
|
8007012: 6edb ldr r3, [r3, #108] @ 0x6c
|
|
8007014: 2b01 cmp r3, #1
|
|
8007016: d12e bne.n 8007076 <UART_RxISR_8BIT+0x192>
|
|
{
|
|
/* Set reception type to Standard */
|
|
huart->ReceptionType = HAL_UART_RECEPTION_STANDARD;
|
|
8007018: 687b ldr r3, [r7, #4]
|
|
800701a: 2200 movs r2, #0
|
|
800701c: 66da str r2, [r3, #108] @ 0x6c
|
|
|
|
/* Disable IDLE interrupt */
|
|
ATOMIC_CLEAR_BIT(huart->Instance->CR1, USART_CR1_IDLEIE);
|
|
800701e: 687b ldr r3, [r7, #4]
|
|
8007020: 681b ldr r3, [r3, #0]
|
|
8007022: 613b str r3, [r7, #16]
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
8007024: 693b ldr r3, [r7, #16]
|
|
8007026: e853 3f00 ldrex r3, [r3]
|
|
800702a: 60fb str r3, [r7, #12]
|
|
return(result);
|
|
800702c: 68fb ldr r3, [r7, #12]
|
|
800702e: f023 0310 bic.w r3, r3, #16
|
|
8007032: 65fb str r3, [r7, #92] @ 0x5c
|
|
8007034: 687b ldr r3, [r7, #4]
|
|
8007036: 681b ldr r3, [r3, #0]
|
|
8007038: 461a mov r2, r3
|
|
800703a: 6dfb ldr r3, [r7, #92] @ 0x5c
|
|
800703c: 61fb str r3, [r7, #28]
|
|
800703e: 61ba str r2, [r7, #24]
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
8007040: 69b9 ldr r1, [r7, #24]
|
|
8007042: 69fa ldr r2, [r7, #28]
|
|
8007044: e841 2300 strex r3, r2, [r1]
|
|
8007048: 617b str r3, [r7, #20]
|
|
return(result);
|
|
800704a: 697b ldr r3, [r7, #20]
|
|
800704c: 2b00 cmp r3, #0
|
|
800704e: d1e6 bne.n 800701e <UART_RxISR_8BIT+0x13a>
|
|
|
|
if (__HAL_UART_GET_FLAG(huart, UART_FLAG_IDLE) == SET)
|
|
8007050: 687b ldr r3, [r7, #4]
|
|
8007052: 681b ldr r3, [r3, #0]
|
|
8007054: 69db ldr r3, [r3, #28]
|
|
8007056: f003 0310 and.w r3, r3, #16
|
|
800705a: 2b10 cmp r3, #16
|
|
800705c: d103 bne.n 8007066 <UART_RxISR_8BIT+0x182>
|
|
{
|
|
/* Clear IDLE Flag */
|
|
__HAL_UART_CLEAR_FLAG(huart, UART_CLEAR_IDLEF);
|
|
800705e: 687b ldr r3, [r7, #4]
|
|
8007060: 681b ldr r3, [r3, #0]
|
|
8007062: 2210 movs r2, #16
|
|
8007064: 621a str r2, [r3, #32]
|
|
#if (USE_HAL_UART_REGISTER_CALLBACKS == 1)
|
|
/*Call registered Rx Event callback*/
|
|
huart->RxEventCallback(huart, huart->RxXferSize);
|
|
#else
|
|
/*Call legacy weak Rx Event callback*/
|
|
HAL_UARTEx_RxEventCallback(huart, huart->RxXferSize);
|
|
8007066: 687b ldr r3, [r7, #4]
|
|
8007068: f8b3 305c ldrh.w r3, [r3, #92] @ 0x5c
|
|
800706c: 4619 mov r1, r3
|
|
800706e: 6878 ldr r0, [r7, #4]
|
|
8007070: f7ff f872 bl 8006158 <HAL_UARTEx_RxEventCallback>
|
|
else
|
|
{
|
|
/* Clear RXNE interrupt flag */
|
|
__HAL_UART_SEND_REQ(huart, UART_RXDATA_FLUSH_REQUEST);
|
|
}
|
|
}
|
|
8007074: e00b b.n 800708e <UART_RxISR_8BIT+0x1aa>
|
|
HAL_UART_RxCpltCallback(huart);
|
|
8007076: 6878 ldr r0, [r7, #4]
|
|
8007078: f7fa fb04 bl 8001684 <HAL_UART_RxCpltCallback>
|
|
}
|
|
800707c: e007 b.n 800708e <UART_RxISR_8BIT+0x1aa>
|
|
__HAL_UART_SEND_REQ(huart, UART_RXDATA_FLUSH_REQUEST);
|
|
800707e: 687b ldr r3, [r7, #4]
|
|
8007080: 681b ldr r3, [r3, #0]
|
|
8007082: 699a ldr r2, [r3, #24]
|
|
8007084: 687b ldr r3, [r7, #4]
|
|
8007086: 681b ldr r3, [r3, #0]
|
|
8007088: f042 0208 orr.w r2, r2, #8
|
|
800708c: 619a str r2, [r3, #24]
|
|
}
|
|
800708e: bf00 nop
|
|
8007090: 3770 adds r7, #112 @ 0x70
|
|
8007092: 46bd mov sp, r7
|
|
8007094: bd80 pop {r7, pc}
|
|
8007096: bf00 nop
|
|
8007098: 40008000 .word 0x40008000
|
|
|
|
0800709c <UART_RxISR_16BIT>:
|
|
* interruptions have been enabled by HAL_UART_Receive_IT()
|
|
* @param huart UART handle.
|
|
* @retval None
|
|
*/
|
|
static void UART_RxISR_16BIT(UART_HandleTypeDef *huart)
|
|
{
|
|
800709c: b580 push {r7, lr}
|
|
800709e: b09c sub sp, #112 @ 0x70
|
|
80070a0: af00 add r7, sp, #0
|
|
80070a2: 6078 str r0, [r7, #4]
|
|
uint16_t *tmp;
|
|
uint16_t uhMask = huart->Mask;
|
|
80070a4: 687b ldr r3, [r7, #4]
|
|
80070a6: f8b3 3060 ldrh.w r3, [r3, #96] @ 0x60
|
|
80070aa: f8a7 306e strh.w r3, [r7, #110] @ 0x6e
|
|
uint16_t uhdata;
|
|
|
|
/* Check that a Rx process is ongoing */
|
|
if (huart->RxState == HAL_UART_STATE_BUSY_RX)
|
|
80070ae: 687b ldr r3, [r7, #4]
|
|
80070b0: f8d3 308c ldr.w r3, [r3, #140] @ 0x8c
|
|
80070b4: 2b22 cmp r3, #34 @ 0x22
|
|
80070b6: f040 80be bne.w 8007236 <UART_RxISR_16BIT+0x19a>
|
|
{
|
|
uhdata = (uint16_t) READ_REG(huart->Instance->RDR);
|
|
80070ba: 687b ldr r3, [r7, #4]
|
|
80070bc: 681b ldr r3, [r3, #0]
|
|
80070be: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
80070c0: f8a7 306c strh.w r3, [r7, #108] @ 0x6c
|
|
tmp = (uint16_t *) huart->pRxBuffPtr ;
|
|
80070c4: 687b ldr r3, [r7, #4]
|
|
80070c6: 6d9b ldr r3, [r3, #88] @ 0x58
|
|
80070c8: 66bb str r3, [r7, #104] @ 0x68
|
|
*tmp = (uint16_t)(uhdata & uhMask);
|
|
80070ca: f8b7 206c ldrh.w r2, [r7, #108] @ 0x6c
|
|
80070ce: f8b7 306e ldrh.w r3, [r7, #110] @ 0x6e
|
|
80070d2: 4013 ands r3, r2
|
|
80070d4: b29a uxth r2, r3
|
|
80070d6: 6ebb ldr r3, [r7, #104] @ 0x68
|
|
80070d8: 801a strh r2, [r3, #0]
|
|
huart->pRxBuffPtr += 2U;
|
|
80070da: 687b ldr r3, [r7, #4]
|
|
80070dc: 6d9b ldr r3, [r3, #88] @ 0x58
|
|
80070de: 1c9a adds r2, r3, #2
|
|
80070e0: 687b ldr r3, [r7, #4]
|
|
80070e2: 659a str r2, [r3, #88] @ 0x58
|
|
huart->RxXferCount--;
|
|
80070e4: 687b ldr r3, [r7, #4]
|
|
80070e6: f8b3 305e ldrh.w r3, [r3, #94] @ 0x5e
|
|
80070ea: b29b uxth r3, r3
|
|
80070ec: 3b01 subs r3, #1
|
|
80070ee: b29a uxth r2, r3
|
|
80070f0: 687b ldr r3, [r7, #4]
|
|
80070f2: f8a3 205e strh.w r2, [r3, #94] @ 0x5e
|
|
|
|
if (huart->RxXferCount == 0U)
|
|
80070f6: 687b ldr r3, [r7, #4]
|
|
80070f8: f8b3 305e ldrh.w r3, [r3, #94] @ 0x5e
|
|
80070fc: b29b uxth r3, r3
|
|
80070fe: 2b00 cmp r3, #0
|
|
8007100: f040 80a1 bne.w 8007246 <UART_RxISR_16BIT+0x1aa>
|
|
{
|
|
/* Disable the UART Parity Error Interrupt and RXNE interrupt*/
|
|
ATOMIC_CLEAR_BIT(huart->Instance->CR1, (USART_CR1_RXNEIE_RXFNEIE | USART_CR1_PEIE));
|
|
8007104: 687b ldr r3, [r7, #4]
|
|
8007106: 681b ldr r3, [r3, #0]
|
|
8007108: 64bb str r3, [r7, #72] @ 0x48
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
800710a: 6cbb ldr r3, [r7, #72] @ 0x48
|
|
800710c: e853 3f00 ldrex r3, [r3]
|
|
8007110: 647b str r3, [r7, #68] @ 0x44
|
|
return(result);
|
|
8007112: 6c7b ldr r3, [r7, #68] @ 0x44
|
|
8007114: f423 7390 bic.w r3, r3, #288 @ 0x120
|
|
8007118: 667b str r3, [r7, #100] @ 0x64
|
|
800711a: 687b ldr r3, [r7, #4]
|
|
800711c: 681b ldr r3, [r3, #0]
|
|
800711e: 461a mov r2, r3
|
|
8007120: 6e7b ldr r3, [r7, #100] @ 0x64
|
|
8007122: 657b str r3, [r7, #84] @ 0x54
|
|
8007124: 653a str r2, [r7, #80] @ 0x50
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
8007126: 6d39 ldr r1, [r7, #80] @ 0x50
|
|
8007128: 6d7a ldr r2, [r7, #84] @ 0x54
|
|
800712a: e841 2300 strex r3, r2, [r1]
|
|
800712e: 64fb str r3, [r7, #76] @ 0x4c
|
|
return(result);
|
|
8007130: 6cfb ldr r3, [r7, #76] @ 0x4c
|
|
8007132: 2b00 cmp r3, #0
|
|
8007134: d1e6 bne.n 8007104 <UART_RxISR_16BIT+0x68>
|
|
|
|
/* Disable the UART Error Interrupt: (Frame error, noise error, overrun error) */
|
|
ATOMIC_CLEAR_BIT(huart->Instance->CR3, USART_CR3_EIE);
|
|
8007136: 687b ldr r3, [r7, #4]
|
|
8007138: 681b ldr r3, [r3, #0]
|
|
800713a: 3308 adds r3, #8
|
|
800713c: 637b str r3, [r7, #52] @ 0x34
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
800713e: 6b7b ldr r3, [r7, #52] @ 0x34
|
|
8007140: e853 3f00 ldrex r3, [r3]
|
|
8007144: 633b str r3, [r7, #48] @ 0x30
|
|
return(result);
|
|
8007146: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
8007148: f023 0301 bic.w r3, r3, #1
|
|
800714c: 663b str r3, [r7, #96] @ 0x60
|
|
800714e: 687b ldr r3, [r7, #4]
|
|
8007150: 681b ldr r3, [r3, #0]
|
|
8007152: 3308 adds r3, #8
|
|
8007154: 6e3a ldr r2, [r7, #96] @ 0x60
|
|
8007156: 643a str r2, [r7, #64] @ 0x40
|
|
8007158: 63fb str r3, [r7, #60] @ 0x3c
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
800715a: 6bf9 ldr r1, [r7, #60] @ 0x3c
|
|
800715c: 6c3a ldr r2, [r7, #64] @ 0x40
|
|
800715e: e841 2300 strex r3, r2, [r1]
|
|
8007162: 63bb str r3, [r7, #56] @ 0x38
|
|
return(result);
|
|
8007164: 6bbb ldr r3, [r7, #56] @ 0x38
|
|
8007166: 2b00 cmp r3, #0
|
|
8007168: d1e5 bne.n 8007136 <UART_RxISR_16BIT+0x9a>
|
|
|
|
/* Rx process is completed, restore huart->RxState to Ready */
|
|
huart->RxState = HAL_UART_STATE_READY;
|
|
800716a: 687b ldr r3, [r7, #4]
|
|
800716c: 2220 movs r2, #32
|
|
800716e: f8c3 208c str.w r2, [r3, #140] @ 0x8c
|
|
|
|
/* Clear RxISR function pointer */
|
|
huart->RxISR = NULL;
|
|
8007172: 687b ldr r3, [r7, #4]
|
|
8007174: 2200 movs r2, #0
|
|
8007176: 675a str r2, [r3, #116] @ 0x74
|
|
|
|
/* Initialize type of RxEvent to Transfer Complete */
|
|
huart->RxEventType = HAL_UART_RXEVENT_TC;
|
|
8007178: 687b ldr r3, [r7, #4]
|
|
800717a: 2200 movs r2, #0
|
|
800717c: 671a str r2, [r3, #112] @ 0x70
|
|
|
|
if (!(IS_LPUART_INSTANCE(huart->Instance)))
|
|
800717e: 687b ldr r3, [r7, #4]
|
|
8007180: 681b ldr r3, [r3, #0]
|
|
8007182: 4a33 ldr r2, [pc, #204] @ (8007250 <UART_RxISR_16BIT+0x1b4>)
|
|
8007184: 4293 cmp r3, r2
|
|
8007186: d01f beq.n 80071c8 <UART_RxISR_16BIT+0x12c>
|
|
{
|
|
/* Check that USART RTOEN bit is set */
|
|
if (READ_BIT(huart->Instance->CR2, USART_CR2_RTOEN) != 0U)
|
|
8007188: 687b ldr r3, [r7, #4]
|
|
800718a: 681b ldr r3, [r3, #0]
|
|
800718c: 685b ldr r3, [r3, #4]
|
|
800718e: f403 0300 and.w r3, r3, #8388608 @ 0x800000
|
|
8007192: 2b00 cmp r3, #0
|
|
8007194: d018 beq.n 80071c8 <UART_RxISR_16BIT+0x12c>
|
|
{
|
|
/* Enable the UART Receiver Timeout Interrupt */
|
|
ATOMIC_CLEAR_BIT(huart->Instance->CR1, USART_CR1_RTOIE);
|
|
8007196: 687b ldr r3, [r7, #4]
|
|
8007198: 681b ldr r3, [r3, #0]
|
|
800719a: 623b str r3, [r7, #32]
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
800719c: 6a3b ldr r3, [r7, #32]
|
|
800719e: e853 3f00 ldrex r3, [r3]
|
|
80071a2: 61fb str r3, [r7, #28]
|
|
return(result);
|
|
80071a4: 69fb ldr r3, [r7, #28]
|
|
80071a6: f023 6380 bic.w r3, r3, #67108864 @ 0x4000000
|
|
80071aa: 65fb str r3, [r7, #92] @ 0x5c
|
|
80071ac: 687b ldr r3, [r7, #4]
|
|
80071ae: 681b ldr r3, [r3, #0]
|
|
80071b0: 461a mov r2, r3
|
|
80071b2: 6dfb ldr r3, [r7, #92] @ 0x5c
|
|
80071b4: 62fb str r3, [r7, #44] @ 0x2c
|
|
80071b6: 62ba str r2, [r7, #40] @ 0x28
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
80071b8: 6ab9 ldr r1, [r7, #40] @ 0x28
|
|
80071ba: 6afa ldr r2, [r7, #44] @ 0x2c
|
|
80071bc: e841 2300 strex r3, r2, [r1]
|
|
80071c0: 627b str r3, [r7, #36] @ 0x24
|
|
return(result);
|
|
80071c2: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
80071c4: 2b00 cmp r3, #0
|
|
80071c6: d1e6 bne.n 8007196 <UART_RxISR_16BIT+0xfa>
|
|
}
|
|
}
|
|
|
|
/* Check current reception Mode :
|
|
If Reception till IDLE event has been selected : */
|
|
if (huart->ReceptionType == HAL_UART_RECEPTION_TOIDLE)
|
|
80071c8: 687b ldr r3, [r7, #4]
|
|
80071ca: 6edb ldr r3, [r3, #108] @ 0x6c
|
|
80071cc: 2b01 cmp r3, #1
|
|
80071ce: d12e bne.n 800722e <UART_RxISR_16BIT+0x192>
|
|
{
|
|
/* Set reception type to Standard */
|
|
huart->ReceptionType = HAL_UART_RECEPTION_STANDARD;
|
|
80071d0: 687b ldr r3, [r7, #4]
|
|
80071d2: 2200 movs r2, #0
|
|
80071d4: 66da str r2, [r3, #108] @ 0x6c
|
|
|
|
/* Disable IDLE interrupt */
|
|
ATOMIC_CLEAR_BIT(huart->Instance->CR1, USART_CR1_IDLEIE);
|
|
80071d6: 687b ldr r3, [r7, #4]
|
|
80071d8: 681b ldr r3, [r3, #0]
|
|
80071da: 60fb str r3, [r7, #12]
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
80071dc: 68fb ldr r3, [r7, #12]
|
|
80071de: e853 3f00 ldrex r3, [r3]
|
|
80071e2: 60bb str r3, [r7, #8]
|
|
return(result);
|
|
80071e4: 68bb ldr r3, [r7, #8]
|
|
80071e6: f023 0310 bic.w r3, r3, #16
|
|
80071ea: 65bb str r3, [r7, #88] @ 0x58
|
|
80071ec: 687b ldr r3, [r7, #4]
|
|
80071ee: 681b ldr r3, [r3, #0]
|
|
80071f0: 461a mov r2, r3
|
|
80071f2: 6dbb ldr r3, [r7, #88] @ 0x58
|
|
80071f4: 61bb str r3, [r7, #24]
|
|
80071f6: 617a str r2, [r7, #20]
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
80071f8: 6979 ldr r1, [r7, #20]
|
|
80071fa: 69ba ldr r2, [r7, #24]
|
|
80071fc: e841 2300 strex r3, r2, [r1]
|
|
8007200: 613b str r3, [r7, #16]
|
|
return(result);
|
|
8007202: 693b ldr r3, [r7, #16]
|
|
8007204: 2b00 cmp r3, #0
|
|
8007206: d1e6 bne.n 80071d6 <UART_RxISR_16BIT+0x13a>
|
|
|
|
if (__HAL_UART_GET_FLAG(huart, UART_FLAG_IDLE) == SET)
|
|
8007208: 687b ldr r3, [r7, #4]
|
|
800720a: 681b ldr r3, [r3, #0]
|
|
800720c: 69db ldr r3, [r3, #28]
|
|
800720e: f003 0310 and.w r3, r3, #16
|
|
8007212: 2b10 cmp r3, #16
|
|
8007214: d103 bne.n 800721e <UART_RxISR_16BIT+0x182>
|
|
{
|
|
/* Clear IDLE Flag */
|
|
__HAL_UART_CLEAR_FLAG(huart, UART_CLEAR_IDLEF);
|
|
8007216: 687b ldr r3, [r7, #4]
|
|
8007218: 681b ldr r3, [r3, #0]
|
|
800721a: 2210 movs r2, #16
|
|
800721c: 621a str r2, [r3, #32]
|
|
#if (USE_HAL_UART_REGISTER_CALLBACKS == 1)
|
|
/*Call registered Rx Event callback*/
|
|
huart->RxEventCallback(huart, huart->RxXferSize);
|
|
#else
|
|
/*Call legacy weak Rx Event callback*/
|
|
HAL_UARTEx_RxEventCallback(huart, huart->RxXferSize);
|
|
800721e: 687b ldr r3, [r7, #4]
|
|
8007220: f8b3 305c ldrh.w r3, [r3, #92] @ 0x5c
|
|
8007224: 4619 mov r1, r3
|
|
8007226: 6878 ldr r0, [r7, #4]
|
|
8007228: f7fe ff96 bl 8006158 <HAL_UARTEx_RxEventCallback>
|
|
else
|
|
{
|
|
/* Clear RXNE interrupt flag */
|
|
__HAL_UART_SEND_REQ(huart, UART_RXDATA_FLUSH_REQUEST);
|
|
}
|
|
}
|
|
800722c: e00b b.n 8007246 <UART_RxISR_16BIT+0x1aa>
|
|
HAL_UART_RxCpltCallback(huart);
|
|
800722e: 6878 ldr r0, [r7, #4]
|
|
8007230: f7fa fa28 bl 8001684 <HAL_UART_RxCpltCallback>
|
|
}
|
|
8007234: e007 b.n 8007246 <UART_RxISR_16BIT+0x1aa>
|
|
__HAL_UART_SEND_REQ(huart, UART_RXDATA_FLUSH_REQUEST);
|
|
8007236: 687b ldr r3, [r7, #4]
|
|
8007238: 681b ldr r3, [r3, #0]
|
|
800723a: 699a ldr r2, [r3, #24]
|
|
800723c: 687b ldr r3, [r7, #4]
|
|
800723e: 681b ldr r3, [r3, #0]
|
|
8007240: f042 0208 orr.w r2, r2, #8
|
|
8007244: 619a str r2, [r3, #24]
|
|
}
|
|
8007246: bf00 nop
|
|
8007248: 3770 adds r7, #112 @ 0x70
|
|
800724a: 46bd mov sp, r7
|
|
800724c: bd80 pop {r7, pc}
|
|
800724e: bf00 nop
|
|
8007250: 40008000 .word 0x40008000
|
|
|
|
08007254 <UART_RxISR_8BIT_FIFOEN>:
|
|
* interruptions have been enabled by HAL_UART_Receive_IT()
|
|
* @param huart UART handle.
|
|
* @retval None
|
|
*/
|
|
static void UART_RxISR_8BIT_FIFOEN(UART_HandleTypeDef *huart)
|
|
{
|
|
8007254: b580 push {r7, lr}
|
|
8007256: b0ac sub sp, #176 @ 0xb0
|
|
8007258: af00 add r7, sp, #0
|
|
800725a: 6078 str r0, [r7, #4]
|
|
uint16_t uhMask = huart->Mask;
|
|
800725c: 687b ldr r3, [r7, #4]
|
|
800725e: f8b3 3060 ldrh.w r3, [r3, #96] @ 0x60
|
|
8007262: f8a7 30aa strh.w r3, [r7, #170] @ 0xaa
|
|
uint16_t uhdata;
|
|
uint16_t nb_rx_data;
|
|
uint16_t rxdatacount;
|
|
uint32_t isrflags = READ_REG(huart->Instance->ISR);
|
|
8007266: 687b ldr r3, [r7, #4]
|
|
8007268: 681b ldr r3, [r3, #0]
|
|
800726a: 69db ldr r3, [r3, #28]
|
|
800726c: f8c7 30ac str.w r3, [r7, #172] @ 0xac
|
|
uint32_t cr1its = READ_REG(huart->Instance->CR1);
|
|
8007270: 687b ldr r3, [r7, #4]
|
|
8007272: 681b ldr r3, [r3, #0]
|
|
8007274: 681b ldr r3, [r3, #0]
|
|
8007276: f8c7 30a4 str.w r3, [r7, #164] @ 0xa4
|
|
uint32_t cr3its = READ_REG(huart->Instance->CR3);
|
|
800727a: 687b ldr r3, [r7, #4]
|
|
800727c: 681b ldr r3, [r3, #0]
|
|
800727e: 689b ldr r3, [r3, #8]
|
|
8007280: f8c7 30a0 str.w r3, [r7, #160] @ 0xa0
|
|
|
|
/* Check that a Rx process is ongoing */
|
|
if (huart->RxState == HAL_UART_STATE_BUSY_RX)
|
|
8007284: 687b ldr r3, [r7, #4]
|
|
8007286: f8d3 308c ldr.w r3, [r3, #140] @ 0x8c
|
|
800728a: 2b22 cmp r3, #34 @ 0x22
|
|
800728c: f040 8183 bne.w 8007596 <UART_RxISR_8BIT_FIFOEN+0x342>
|
|
{
|
|
nb_rx_data = huart->NbRxDataToProcess;
|
|
8007290: 687b ldr r3, [r7, #4]
|
|
8007292: f8b3 3068 ldrh.w r3, [r3, #104] @ 0x68
|
|
8007296: f8a7 309e strh.w r3, [r7, #158] @ 0x9e
|
|
while ((nb_rx_data > 0U) && ((isrflags & USART_ISR_RXNE_RXFNE) != 0U))
|
|
800729a: e126 b.n 80074ea <UART_RxISR_8BIT_FIFOEN+0x296>
|
|
{
|
|
uhdata = (uint16_t) READ_REG(huart->Instance->RDR);
|
|
800729c: 687b ldr r3, [r7, #4]
|
|
800729e: 681b ldr r3, [r3, #0]
|
|
80072a0: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
80072a2: f8a7 309c strh.w r3, [r7, #156] @ 0x9c
|
|
*huart->pRxBuffPtr = (uint8_t)(uhdata & (uint8_t)uhMask);
|
|
80072a6: f8b7 309c ldrh.w r3, [r7, #156] @ 0x9c
|
|
80072aa: b2d9 uxtb r1, r3
|
|
80072ac: f8b7 30aa ldrh.w r3, [r7, #170] @ 0xaa
|
|
80072b0: b2da uxtb r2, r3
|
|
80072b2: 687b ldr r3, [r7, #4]
|
|
80072b4: 6d9b ldr r3, [r3, #88] @ 0x58
|
|
80072b6: 400a ands r2, r1
|
|
80072b8: b2d2 uxtb r2, r2
|
|
80072ba: 701a strb r2, [r3, #0]
|
|
huart->pRxBuffPtr++;
|
|
80072bc: 687b ldr r3, [r7, #4]
|
|
80072be: 6d9b ldr r3, [r3, #88] @ 0x58
|
|
80072c0: 1c5a adds r2, r3, #1
|
|
80072c2: 687b ldr r3, [r7, #4]
|
|
80072c4: 659a str r2, [r3, #88] @ 0x58
|
|
huart->RxXferCount--;
|
|
80072c6: 687b ldr r3, [r7, #4]
|
|
80072c8: f8b3 305e ldrh.w r3, [r3, #94] @ 0x5e
|
|
80072cc: b29b uxth r3, r3
|
|
80072ce: 3b01 subs r3, #1
|
|
80072d0: b29a uxth r2, r3
|
|
80072d2: 687b ldr r3, [r7, #4]
|
|
80072d4: f8a3 205e strh.w r2, [r3, #94] @ 0x5e
|
|
isrflags = READ_REG(huart->Instance->ISR);
|
|
80072d8: 687b ldr r3, [r7, #4]
|
|
80072da: 681b ldr r3, [r3, #0]
|
|
80072dc: 69db ldr r3, [r3, #28]
|
|
80072de: f8c7 30ac str.w r3, [r7, #172] @ 0xac
|
|
|
|
/* If some non blocking errors occurred */
|
|
if ((isrflags & (USART_ISR_PE | USART_ISR_FE | USART_ISR_NE)) != 0U)
|
|
80072e2: f8d7 30ac ldr.w r3, [r7, #172] @ 0xac
|
|
80072e6: f003 0307 and.w r3, r3, #7
|
|
80072ea: 2b00 cmp r3, #0
|
|
80072ec: d053 beq.n 8007396 <UART_RxISR_8BIT_FIFOEN+0x142>
|
|
{
|
|
/* UART parity error interrupt occurred -------------------------------------*/
|
|
if (((isrflags & USART_ISR_PE) != 0U) && ((cr1its & USART_CR1_PEIE) != 0U))
|
|
80072ee: f8d7 30ac ldr.w r3, [r7, #172] @ 0xac
|
|
80072f2: f003 0301 and.w r3, r3, #1
|
|
80072f6: 2b00 cmp r3, #0
|
|
80072f8: d011 beq.n 800731e <UART_RxISR_8BIT_FIFOEN+0xca>
|
|
80072fa: f8d7 30a4 ldr.w r3, [r7, #164] @ 0xa4
|
|
80072fe: f403 7380 and.w r3, r3, #256 @ 0x100
|
|
8007302: 2b00 cmp r3, #0
|
|
8007304: d00b beq.n 800731e <UART_RxISR_8BIT_FIFOEN+0xca>
|
|
{
|
|
__HAL_UART_CLEAR_FLAG(huart, UART_CLEAR_PEF);
|
|
8007306: 687b ldr r3, [r7, #4]
|
|
8007308: 681b ldr r3, [r3, #0]
|
|
800730a: 2201 movs r2, #1
|
|
800730c: 621a str r2, [r3, #32]
|
|
|
|
huart->ErrorCode |= HAL_UART_ERROR_PE;
|
|
800730e: 687b ldr r3, [r7, #4]
|
|
8007310: f8d3 3090 ldr.w r3, [r3, #144] @ 0x90
|
|
8007314: f043 0201 orr.w r2, r3, #1
|
|
8007318: 687b ldr r3, [r7, #4]
|
|
800731a: f8c3 2090 str.w r2, [r3, #144] @ 0x90
|
|
}
|
|
|
|
/* UART frame error interrupt occurred --------------------------------------*/
|
|
if (((isrflags & USART_ISR_FE) != 0U) && ((cr3its & USART_CR3_EIE) != 0U))
|
|
800731e: f8d7 30ac ldr.w r3, [r7, #172] @ 0xac
|
|
8007322: f003 0302 and.w r3, r3, #2
|
|
8007326: 2b00 cmp r3, #0
|
|
8007328: d011 beq.n 800734e <UART_RxISR_8BIT_FIFOEN+0xfa>
|
|
800732a: f8d7 30a0 ldr.w r3, [r7, #160] @ 0xa0
|
|
800732e: f003 0301 and.w r3, r3, #1
|
|
8007332: 2b00 cmp r3, #0
|
|
8007334: d00b beq.n 800734e <UART_RxISR_8BIT_FIFOEN+0xfa>
|
|
{
|
|
__HAL_UART_CLEAR_FLAG(huart, UART_CLEAR_FEF);
|
|
8007336: 687b ldr r3, [r7, #4]
|
|
8007338: 681b ldr r3, [r3, #0]
|
|
800733a: 2202 movs r2, #2
|
|
800733c: 621a str r2, [r3, #32]
|
|
|
|
huart->ErrorCode |= HAL_UART_ERROR_FE;
|
|
800733e: 687b ldr r3, [r7, #4]
|
|
8007340: f8d3 3090 ldr.w r3, [r3, #144] @ 0x90
|
|
8007344: f043 0204 orr.w r2, r3, #4
|
|
8007348: 687b ldr r3, [r7, #4]
|
|
800734a: f8c3 2090 str.w r2, [r3, #144] @ 0x90
|
|
}
|
|
|
|
/* UART noise error interrupt occurred --------------------------------------*/
|
|
if (((isrflags & USART_ISR_NE) != 0U) && ((cr3its & USART_CR3_EIE) != 0U))
|
|
800734e: f8d7 30ac ldr.w r3, [r7, #172] @ 0xac
|
|
8007352: f003 0304 and.w r3, r3, #4
|
|
8007356: 2b00 cmp r3, #0
|
|
8007358: d011 beq.n 800737e <UART_RxISR_8BIT_FIFOEN+0x12a>
|
|
800735a: f8d7 30a0 ldr.w r3, [r7, #160] @ 0xa0
|
|
800735e: f003 0301 and.w r3, r3, #1
|
|
8007362: 2b00 cmp r3, #0
|
|
8007364: d00b beq.n 800737e <UART_RxISR_8BIT_FIFOEN+0x12a>
|
|
{
|
|
__HAL_UART_CLEAR_FLAG(huart, UART_CLEAR_NEF);
|
|
8007366: 687b ldr r3, [r7, #4]
|
|
8007368: 681b ldr r3, [r3, #0]
|
|
800736a: 2204 movs r2, #4
|
|
800736c: 621a str r2, [r3, #32]
|
|
|
|
huart->ErrorCode |= HAL_UART_ERROR_NE;
|
|
800736e: 687b ldr r3, [r7, #4]
|
|
8007370: f8d3 3090 ldr.w r3, [r3, #144] @ 0x90
|
|
8007374: f043 0202 orr.w r2, r3, #2
|
|
8007378: 687b ldr r3, [r7, #4]
|
|
800737a: f8c3 2090 str.w r2, [r3, #144] @ 0x90
|
|
}
|
|
|
|
/* Call UART Error Call back function if need be ----------------------------*/
|
|
if (huart->ErrorCode != HAL_UART_ERROR_NONE)
|
|
800737e: 687b ldr r3, [r7, #4]
|
|
8007380: f8d3 3090 ldr.w r3, [r3, #144] @ 0x90
|
|
8007384: 2b00 cmp r3, #0
|
|
8007386: d006 beq.n 8007396 <UART_RxISR_8BIT_FIFOEN+0x142>
|
|
#if (USE_HAL_UART_REGISTER_CALLBACKS == 1)
|
|
/*Call registered error callback*/
|
|
huart->ErrorCallback(huart);
|
|
#else
|
|
/*Call legacy weak error callback*/
|
|
HAL_UART_ErrorCallback(huart);
|
|
8007388: 6878 ldr r0, [r7, #4]
|
|
800738a: f7fe fedc bl 8006146 <HAL_UART_ErrorCallback>
|
|
#endif /* USE_HAL_UART_REGISTER_CALLBACKS */
|
|
huart->ErrorCode = HAL_UART_ERROR_NONE;
|
|
800738e: 687b ldr r3, [r7, #4]
|
|
8007390: 2200 movs r2, #0
|
|
8007392: f8c3 2090 str.w r2, [r3, #144] @ 0x90
|
|
}
|
|
}
|
|
|
|
if (huart->RxXferCount == 0U)
|
|
8007396: 687b ldr r3, [r7, #4]
|
|
8007398: f8b3 305e ldrh.w r3, [r3, #94] @ 0x5e
|
|
800739c: b29b uxth r3, r3
|
|
800739e: 2b00 cmp r3, #0
|
|
80073a0: f040 80a3 bne.w 80074ea <UART_RxISR_8BIT_FIFOEN+0x296>
|
|
{
|
|
/* Disable the UART Parity Error Interrupt and RXFT interrupt*/
|
|
ATOMIC_CLEAR_BIT(huart->Instance->CR1, USART_CR1_PEIE);
|
|
80073a4: 687b ldr r3, [r7, #4]
|
|
80073a6: 681b ldr r3, [r3, #0]
|
|
80073a8: 673b str r3, [r7, #112] @ 0x70
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
80073aa: 6f3b ldr r3, [r7, #112] @ 0x70
|
|
80073ac: e853 3f00 ldrex r3, [r3]
|
|
80073b0: 66fb str r3, [r7, #108] @ 0x6c
|
|
return(result);
|
|
80073b2: 6efb ldr r3, [r7, #108] @ 0x6c
|
|
80073b4: f423 7380 bic.w r3, r3, #256 @ 0x100
|
|
80073b8: f8c7 3098 str.w r3, [r7, #152] @ 0x98
|
|
80073bc: 687b ldr r3, [r7, #4]
|
|
80073be: 681b ldr r3, [r3, #0]
|
|
80073c0: 461a mov r2, r3
|
|
80073c2: f8d7 3098 ldr.w r3, [r7, #152] @ 0x98
|
|
80073c6: 67fb str r3, [r7, #124] @ 0x7c
|
|
80073c8: 67ba str r2, [r7, #120] @ 0x78
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
80073ca: 6fb9 ldr r1, [r7, #120] @ 0x78
|
|
80073cc: 6ffa ldr r2, [r7, #124] @ 0x7c
|
|
80073ce: e841 2300 strex r3, r2, [r1]
|
|
80073d2: 677b str r3, [r7, #116] @ 0x74
|
|
return(result);
|
|
80073d4: 6f7b ldr r3, [r7, #116] @ 0x74
|
|
80073d6: 2b00 cmp r3, #0
|
|
80073d8: d1e4 bne.n 80073a4 <UART_RxISR_8BIT_FIFOEN+0x150>
|
|
|
|
/* Disable the UART Error Interrupt: (Frame error, noise error, overrun error)
|
|
and RX FIFO Threshold interrupt */
|
|
ATOMIC_CLEAR_BIT(huart->Instance->CR3, (USART_CR3_EIE | USART_CR3_RXFTIE));
|
|
80073da: 687b ldr r3, [r7, #4]
|
|
80073dc: 681b ldr r3, [r3, #0]
|
|
80073de: 3308 adds r3, #8
|
|
80073e0: 65fb str r3, [r7, #92] @ 0x5c
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
80073e2: 6dfb ldr r3, [r7, #92] @ 0x5c
|
|
80073e4: e853 3f00 ldrex r3, [r3]
|
|
80073e8: 65bb str r3, [r7, #88] @ 0x58
|
|
return(result);
|
|
80073ea: 6dbb ldr r3, [r7, #88] @ 0x58
|
|
80073ec: f023 5380 bic.w r3, r3, #268435456 @ 0x10000000
|
|
80073f0: f023 0301 bic.w r3, r3, #1
|
|
80073f4: f8c7 3094 str.w r3, [r7, #148] @ 0x94
|
|
80073f8: 687b ldr r3, [r7, #4]
|
|
80073fa: 681b ldr r3, [r3, #0]
|
|
80073fc: 3308 adds r3, #8
|
|
80073fe: f8d7 2094 ldr.w r2, [r7, #148] @ 0x94
|
|
8007402: 66ba str r2, [r7, #104] @ 0x68
|
|
8007404: 667b str r3, [r7, #100] @ 0x64
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
8007406: 6e79 ldr r1, [r7, #100] @ 0x64
|
|
8007408: 6eba ldr r2, [r7, #104] @ 0x68
|
|
800740a: e841 2300 strex r3, r2, [r1]
|
|
800740e: 663b str r3, [r7, #96] @ 0x60
|
|
return(result);
|
|
8007410: 6e3b ldr r3, [r7, #96] @ 0x60
|
|
8007412: 2b00 cmp r3, #0
|
|
8007414: d1e1 bne.n 80073da <UART_RxISR_8BIT_FIFOEN+0x186>
|
|
|
|
/* Rx process is completed, restore huart->RxState to Ready */
|
|
huart->RxState = HAL_UART_STATE_READY;
|
|
8007416: 687b ldr r3, [r7, #4]
|
|
8007418: 2220 movs r2, #32
|
|
800741a: f8c3 208c str.w r2, [r3, #140] @ 0x8c
|
|
|
|
/* Clear RxISR function pointer */
|
|
huart->RxISR = NULL;
|
|
800741e: 687b ldr r3, [r7, #4]
|
|
8007420: 2200 movs r2, #0
|
|
8007422: 675a str r2, [r3, #116] @ 0x74
|
|
|
|
/* Initialize type of RxEvent to Transfer Complete */
|
|
huart->RxEventType = HAL_UART_RXEVENT_TC;
|
|
8007424: 687b ldr r3, [r7, #4]
|
|
8007426: 2200 movs r2, #0
|
|
8007428: 671a str r2, [r3, #112] @ 0x70
|
|
|
|
if (!(IS_LPUART_INSTANCE(huart->Instance)))
|
|
800742a: 687b ldr r3, [r7, #4]
|
|
800742c: 681b ldr r3, [r3, #0]
|
|
800742e: 4a60 ldr r2, [pc, #384] @ (80075b0 <UART_RxISR_8BIT_FIFOEN+0x35c>)
|
|
8007430: 4293 cmp r3, r2
|
|
8007432: d021 beq.n 8007478 <UART_RxISR_8BIT_FIFOEN+0x224>
|
|
{
|
|
/* Check that USART RTOEN bit is set */
|
|
if (READ_BIT(huart->Instance->CR2, USART_CR2_RTOEN) != 0U)
|
|
8007434: 687b ldr r3, [r7, #4]
|
|
8007436: 681b ldr r3, [r3, #0]
|
|
8007438: 685b ldr r3, [r3, #4]
|
|
800743a: f403 0300 and.w r3, r3, #8388608 @ 0x800000
|
|
800743e: 2b00 cmp r3, #0
|
|
8007440: d01a beq.n 8007478 <UART_RxISR_8BIT_FIFOEN+0x224>
|
|
{
|
|
/* Enable the UART Receiver Timeout Interrupt */
|
|
ATOMIC_CLEAR_BIT(huart->Instance->CR1, USART_CR1_RTOIE);
|
|
8007442: 687b ldr r3, [r7, #4]
|
|
8007444: 681b ldr r3, [r3, #0]
|
|
8007446: 64bb str r3, [r7, #72] @ 0x48
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
8007448: 6cbb ldr r3, [r7, #72] @ 0x48
|
|
800744a: e853 3f00 ldrex r3, [r3]
|
|
800744e: 647b str r3, [r7, #68] @ 0x44
|
|
return(result);
|
|
8007450: 6c7b ldr r3, [r7, #68] @ 0x44
|
|
8007452: f023 6380 bic.w r3, r3, #67108864 @ 0x4000000
|
|
8007456: f8c7 3090 str.w r3, [r7, #144] @ 0x90
|
|
800745a: 687b ldr r3, [r7, #4]
|
|
800745c: 681b ldr r3, [r3, #0]
|
|
800745e: 461a mov r2, r3
|
|
8007460: f8d7 3090 ldr.w r3, [r7, #144] @ 0x90
|
|
8007464: 657b str r3, [r7, #84] @ 0x54
|
|
8007466: 653a str r2, [r7, #80] @ 0x50
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
8007468: 6d39 ldr r1, [r7, #80] @ 0x50
|
|
800746a: 6d7a ldr r2, [r7, #84] @ 0x54
|
|
800746c: e841 2300 strex r3, r2, [r1]
|
|
8007470: 64fb str r3, [r7, #76] @ 0x4c
|
|
return(result);
|
|
8007472: 6cfb ldr r3, [r7, #76] @ 0x4c
|
|
8007474: 2b00 cmp r3, #0
|
|
8007476: d1e4 bne.n 8007442 <UART_RxISR_8BIT_FIFOEN+0x1ee>
|
|
}
|
|
}
|
|
|
|
/* Check current reception Mode :
|
|
If Reception till IDLE event has been selected : */
|
|
if (huart->ReceptionType == HAL_UART_RECEPTION_TOIDLE)
|
|
8007478: 687b ldr r3, [r7, #4]
|
|
800747a: 6edb ldr r3, [r3, #108] @ 0x6c
|
|
800747c: 2b01 cmp r3, #1
|
|
800747e: d130 bne.n 80074e2 <UART_RxISR_8BIT_FIFOEN+0x28e>
|
|
{
|
|
/* Set reception type to Standard */
|
|
huart->ReceptionType = HAL_UART_RECEPTION_STANDARD;
|
|
8007480: 687b ldr r3, [r7, #4]
|
|
8007482: 2200 movs r2, #0
|
|
8007484: 66da str r2, [r3, #108] @ 0x6c
|
|
|
|
/* Disable IDLE interrupt */
|
|
ATOMIC_CLEAR_BIT(huart->Instance->CR1, USART_CR1_IDLEIE);
|
|
8007486: 687b ldr r3, [r7, #4]
|
|
8007488: 681b ldr r3, [r3, #0]
|
|
800748a: 637b str r3, [r7, #52] @ 0x34
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
800748c: 6b7b ldr r3, [r7, #52] @ 0x34
|
|
800748e: e853 3f00 ldrex r3, [r3]
|
|
8007492: 633b str r3, [r7, #48] @ 0x30
|
|
return(result);
|
|
8007494: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
8007496: f023 0310 bic.w r3, r3, #16
|
|
800749a: f8c7 308c str.w r3, [r7, #140] @ 0x8c
|
|
800749e: 687b ldr r3, [r7, #4]
|
|
80074a0: 681b ldr r3, [r3, #0]
|
|
80074a2: 461a mov r2, r3
|
|
80074a4: f8d7 308c ldr.w r3, [r7, #140] @ 0x8c
|
|
80074a8: 643b str r3, [r7, #64] @ 0x40
|
|
80074aa: 63fa str r2, [r7, #60] @ 0x3c
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
80074ac: 6bf9 ldr r1, [r7, #60] @ 0x3c
|
|
80074ae: 6c3a ldr r2, [r7, #64] @ 0x40
|
|
80074b0: e841 2300 strex r3, r2, [r1]
|
|
80074b4: 63bb str r3, [r7, #56] @ 0x38
|
|
return(result);
|
|
80074b6: 6bbb ldr r3, [r7, #56] @ 0x38
|
|
80074b8: 2b00 cmp r3, #0
|
|
80074ba: d1e4 bne.n 8007486 <UART_RxISR_8BIT_FIFOEN+0x232>
|
|
|
|
if (__HAL_UART_GET_FLAG(huart, UART_FLAG_IDLE) == SET)
|
|
80074bc: 687b ldr r3, [r7, #4]
|
|
80074be: 681b ldr r3, [r3, #0]
|
|
80074c0: 69db ldr r3, [r3, #28]
|
|
80074c2: f003 0310 and.w r3, r3, #16
|
|
80074c6: 2b10 cmp r3, #16
|
|
80074c8: d103 bne.n 80074d2 <UART_RxISR_8BIT_FIFOEN+0x27e>
|
|
{
|
|
/* Clear IDLE Flag */
|
|
__HAL_UART_CLEAR_FLAG(huart, UART_CLEAR_IDLEF);
|
|
80074ca: 687b ldr r3, [r7, #4]
|
|
80074cc: 681b ldr r3, [r3, #0]
|
|
80074ce: 2210 movs r2, #16
|
|
80074d0: 621a str r2, [r3, #32]
|
|
#if (USE_HAL_UART_REGISTER_CALLBACKS == 1)
|
|
/*Call registered Rx Event callback*/
|
|
huart->RxEventCallback(huart, huart->RxXferSize);
|
|
#else
|
|
/*Call legacy weak Rx Event callback*/
|
|
HAL_UARTEx_RxEventCallback(huart, huart->RxXferSize);
|
|
80074d2: 687b ldr r3, [r7, #4]
|
|
80074d4: f8b3 305c ldrh.w r3, [r3, #92] @ 0x5c
|
|
80074d8: 4619 mov r1, r3
|
|
80074da: 6878 ldr r0, [r7, #4]
|
|
80074dc: f7fe fe3c bl 8006158 <HAL_UARTEx_RxEventCallback>
|
|
#else
|
|
/*Call legacy weak Rx complete callback*/
|
|
HAL_UART_RxCpltCallback(huart);
|
|
#endif /* USE_HAL_UART_REGISTER_CALLBACKS */
|
|
}
|
|
break;
|
|
80074e0: e00e b.n 8007500 <UART_RxISR_8BIT_FIFOEN+0x2ac>
|
|
HAL_UART_RxCpltCallback(huart);
|
|
80074e2: 6878 ldr r0, [r7, #4]
|
|
80074e4: f7fa f8ce bl 8001684 <HAL_UART_RxCpltCallback>
|
|
break;
|
|
80074e8: e00a b.n 8007500 <UART_RxISR_8BIT_FIFOEN+0x2ac>
|
|
while ((nb_rx_data > 0U) && ((isrflags & USART_ISR_RXNE_RXFNE) != 0U))
|
|
80074ea: f8b7 309e ldrh.w r3, [r7, #158] @ 0x9e
|
|
80074ee: 2b00 cmp r3, #0
|
|
80074f0: d006 beq.n 8007500 <UART_RxISR_8BIT_FIFOEN+0x2ac>
|
|
80074f2: f8d7 30ac ldr.w r3, [r7, #172] @ 0xac
|
|
80074f6: f003 0320 and.w r3, r3, #32
|
|
80074fa: 2b00 cmp r3, #0
|
|
80074fc: f47f aece bne.w 800729c <UART_RxISR_8BIT_FIFOEN+0x48>
|
|
|
|
/* When remaining number of bytes to receive is less than the RX FIFO
|
|
threshold, next incoming frames are processed as if FIFO mode was
|
|
disabled (i.e. one interrupt per received frame).
|
|
*/
|
|
rxdatacount = huart->RxXferCount;
|
|
8007500: 687b ldr r3, [r7, #4]
|
|
8007502: f8b3 305e ldrh.w r3, [r3, #94] @ 0x5e
|
|
8007506: f8a7 308a strh.w r3, [r7, #138] @ 0x8a
|
|
if ((rxdatacount != 0U) && (rxdatacount < huart->NbRxDataToProcess))
|
|
800750a: f8b7 308a ldrh.w r3, [r7, #138] @ 0x8a
|
|
800750e: 2b00 cmp r3, #0
|
|
8007510: d049 beq.n 80075a6 <UART_RxISR_8BIT_FIFOEN+0x352>
|
|
8007512: 687b ldr r3, [r7, #4]
|
|
8007514: f8b3 3068 ldrh.w r3, [r3, #104] @ 0x68
|
|
8007518: f8b7 208a ldrh.w r2, [r7, #138] @ 0x8a
|
|
800751c: 429a cmp r2, r3
|
|
800751e: d242 bcs.n 80075a6 <UART_RxISR_8BIT_FIFOEN+0x352>
|
|
{
|
|
/* Disable the UART RXFT interrupt*/
|
|
ATOMIC_CLEAR_BIT(huart->Instance->CR3, USART_CR3_RXFTIE);
|
|
8007520: 687b ldr r3, [r7, #4]
|
|
8007522: 681b ldr r3, [r3, #0]
|
|
8007524: 3308 adds r3, #8
|
|
8007526: 623b str r3, [r7, #32]
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
8007528: 6a3b ldr r3, [r7, #32]
|
|
800752a: e853 3f00 ldrex r3, [r3]
|
|
800752e: 61fb str r3, [r7, #28]
|
|
return(result);
|
|
8007530: 69fb ldr r3, [r7, #28]
|
|
8007532: f023 5380 bic.w r3, r3, #268435456 @ 0x10000000
|
|
8007536: f8c7 3084 str.w r3, [r7, #132] @ 0x84
|
|
800753a: 687b ldr r3, [r7, #4]
|
|
800753c: 681b ldr r3, [r3, #0]
|
|
800753e: 3308 adds r3, #8
|
|
8007540: f8d7 2084 ldr.w r2, [r7, #132] @ 0x84
|
|
8007544: 62fa str r2, [r7, #44] @ 0x2c
|
|
8007546: 62bb str r3, [r7, #40] @ 0x28
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
8007548: 6ab9 ldr r1, [r7, #40] @ 0x28
|
|
800754a: 6afa ldr r2, [r7, #44] @ 0x2c
|
|
800754c: e841 2300 strex r3, r2, [r1]
|
|
8007550: 627b str r3, [r7, #36] @ 0x24
|
|
return(result);
|
|
8007552: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8007554: 2b00 cmp r3, #0
|
|
8007556: d1e3 bne.n 8007520 <UART_RxISR_8BIT_FIFOEN+0x2cc>
|
|
|
|
/* Update the RxISR function pointer */
|
|
huart->RxISR = UART_RxISR_8BIT;
|
|
8007558: 687b ldr r3, [r7, #4]
|
|
800755a: 4a16 ldr r2, [pc, #88] @ (80075b4 <UART_RxISR_8BIT_FIFOEN+0x360>)
|
|
800755c: 675a str r2, [r3, #116] @ 0x74
|
|
|
|
/* Enable the UART Data Register Not Empty interrupt */
|
|
ATOMIC_SET_BIT(huart->Instance->CR1, USART_CR1_RXNEIE_RXFNEIE);
|
|
800755e: 687b ldr r3, [r7, #4]
|
|
8007560: 681b ldr r3, [r3, #0]
|
|
8007562: 60fb str r3, [r7, #12]
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
8007564: 68fb ldr r3, [r7, #12]
|
|
8007566: e853 3f00 ldrex r3, [r3]
|
|
800756a: 60bb str r3, [r7, #8]
|
|
return(result);
|
|
800756c: 68bb ldr r3, [r7, #8]
|
|
800756e: f043 0320 orr.w r3, r3, #32
|
|
8007572: f8c7 3080 str.w r3, [r7, #128] @ 0x80
|
|
8007576: 687b ldr r3, [r7, #4]
|
|
8007578: 681b ldr r3, [r3, #0]
|
|
800757a: 461a mov r2, r3
|
|
800757c: f8d7 3080 ldr.w r3, [r7, #128] @ 0x80
|
|
8007580: 61bb str r3, [r7, #24]
|
|
8007582: 617a str r2, [r7, #20]
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
8007584: 6979 ldr r1, [r7, #20]
|
|
8007586: 69ba ldr r2, [r7, #24]
|
|
8007588: e841 2300 strex r3, r2, [r1]
|
|
800758c: 613b str r3, [r7, #16]
|
|
return(result);
|
|
800758e: 693b ldr r3, [r7, #16]
|
|
8007590: 2b00 cmp r3, #0
|
|
8007592: d1e4 bne.n 800755e <UART_RxISR_8BIT_FIFOEN+0x30a>
|
|
else
|
|
{
|
|
/* Clear RXNE interrupt flag */
|
|
__HAL_UART_SEND_REQ(huart, UART_RXDATA_FLUSH_REQUEST);
|
|
}
|
|
}
|
|
8007594: e007 b.n 80075a6 <UART_RxISR_8BIT_FIFOEN+0x352>
|
|
__HAL_UART_SEND_REQ(huart, UART_RXDATA_FLUSH_REQUEST);
|
|
8007596: 687b ldr r3, [r7, #4]
|
|
8007598: 681b ldr r3, [r3, #0]
|
|
800759a: 699a ldr r2, [r3, #24]
|
|
800759c: 687b ldr r3, [r7, #4]
|
|
800759e: 681b ldr r3, [r3, #0]
|
|
80075a0: f042 0208 orr.w r2, r2, #8
|
|
80075a4: 619a str r2, [r3, #24]
|
|
}
|
|
80075a6: bf00 nop
|
|
80075a8: 37b0 adds r7, #176 @ 0xb0
|
|
80075aa: 46bd mov sp, r7
|
|
80075ac: bd80 pop {r7, pc}
|
|
80075ae: bf00 nop
|
|
80075b0: 40008000 .word 0x40008000
|
|
80075b4: 08006ee5 .word 0x08006ee5
|
|
|
|
080075b8 <UART_RxISR_16BIT_FIFOEN>:
|
|
* interruptions have been enabled by HAL_UART_Receive_IT()
|
|
* @param huart UART handle.
|
|
* @retval None
|
|
*/
|
|
static void UART_RxISR_16BIT_FIFOEN(UART_HandleTypeDef *huart)
|
|
{
|
|
80075b8: b580 push {r7, lr}
|
|
80075ba: b0ae sub sp, #184 @ 0xb8
|
|
80075bc: af00 add r7, sp, #0
|
|
80075be: 6078 str r0, [r7, #4]
|
|
uint16_t *tmp;
|
|
uint16_t uhMask = huart->Mask;
|
|
80075c0: 687b ldr r3, [r7, #4]
|
|
80075c2: f8b3 3060 ldrh.w r3, [r3, #96] @ 0x60
|
|
80075c6: f8a7 30b2 strh.w r3, [r7, #178] @ 0xb2
|
|
uint16_t uhdata;
|
|
uint16_t nb_rx_data;
|
|
uint16_t rxdatacount;
|
|
uint32_t isrflags = READ_REG(huart->Instance->ISR);
|
|
80075ca: 687b ldr r3, [r7, #4]
|
|
80075cc: 681b ldr r3, [r3, #0]
|
|
80075ce: 69db ldr r3, [r3, #28]
|
|
80075d0: f8c7 30b4 str.w r3, [r7, #180] @ 0xb4
|
|
uint32_t cr1its = READ_REG(huart->Instance->CR1);
|
|
80075d4: 687b ldr r3, [r7, #4]
|
|
80075d6: 681b ldr r3, [r3, #0]
|
|
80075d8: 681b ldr r3, [r3, #0]
|
|
80075da: f8c7 30ac str.w r3, [r7, #172] @ 0xac
|
|
uint32_t cr3its = READ_REG(huart->Instance->CR3);
|
|
80075de: 687b ldr r3, [r7, #4]
|
|
80075e0: 681b ldr r3, [r3, #0]
|
|
80075e2: 689b ldr r3, [r3, #8]
|
|
80075e4: f8c7 30a8 str.w r3, [r7, #168] @ 0xa8
|
|
|
|
/* Check that a Rx process is ongoing */
|
|
if (huart->RxState == HAL_UART_STATE_BUSY_RX)
|
|
80075e8: 687b ldr r3, [r7, #4]
|
|
80075ea: f8d3 308c ldr.w r3, [r3, #140] @ 0x8c
|
|
80075ee: 2b22 cmp r3, #34 @ 0x22
|
|
80075f0: f040 8187 bne.w 8007902 <UART_RxISR_16BIT_FIFOEN+0x34a>
|
|
{
|
|
nb_rx_data = huart->NbRxDataToProcess;
|
|
80075f4: 687b ldr r3, [r7, #4]
|
|
80075f6: f8b3 3068 ldrh.w r3, [r3, #104] @ 0x68
|
|
80075fa: f8a7 30a6 strh.w r3, [r7, #166] @ 0xa6
|
|
while ((nb_rx_data > 0U) && ((isrflags & USART_ISR_RXNE_RXFNE) != 0U))
|
|
80075fe: e12a b.n 8007856 <UART_RxISR_16BIT_FIFOEN+0x29e>
|
|
{
|
|
uhdata = (uint16_t) READ_REG(huart->Instance->RDR);
|
|
8007600: 687b ldr r3, [r7, #4]
|
|
8007602: 681b ldr r3, [r3, #0]
|
|
8007604: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
8007606: f8a7 30a4 strh.w r3, [r7, #164] @ 0xa4
|
|
tmp = (uint16_t *) huart->pRxBuffPtr ;
|
|
800760a: 687b ldr r3, [r7, #4]
|
|
800760c: 6d9b ldr r3, [r3, #88] @ 0x58
|
|
800760e: f8c7 30a0 str.w r3, [r7, #160] @ 0xa0
|
|
*tmp = (uint16_t)(uhdata & uhMask);
|
|
8007612: f8b7 20a4 ldrh.w r2, [r7, #164] @ 0xa4
|
|
8007616: f8b7 30b2 ldrh.w r3, [r7, #178] @ 0xb2
|
|
800761a: 4013 ands r3, r2
|
|
800761c: b29a uxth r2, r3
|
|
800761e: f8d7 30a0 ldr.w r3, [r7, #160] @ 0xa0
|
|
8007622: 801a strh r2, [r3, #0]
|
|
huart->pRxBuffPtr += 2U;
|
|
8007624: 687b ldr r3, [r7, #4]
|
|
8007626: 6d9b ldr r3, [r3, #88] @ 0x58
|
|
8007628: 1c9a adds r2, r3, #2
|
|
800762a: 687b ldr r3, [r7, #4]
|
|
800762c: 659a str r2, [r3, #88] @ 0x58
|
|
huart->RxXferCount--;
|
|
800762e: 687b ldr r3, [r7, #4]
|
|
8007630: f8b3 305e ldrh.w r3, [r3, #94] @ 0x5e
|
|
8007634: b29b uxth r3, r3
|
|
8007636: 3b01 subs r3, #1
|
|
8007638: b29a uxth r2, r3
|
|
800763a: 687b ldr r3, [r7, #4]
|
|
800763c: f8a3 205e strh.w r2, [r3, #94] @ 0x5e
|
|
isrflags = READ_REG(huart->Instance->ISR);
|
|
8007640: 687b ldr r3, [r7, #4]
|
|
8007642: 681b ldr r3, [r3, #0]
|
|
8007644: 69db ldr r3, [r3, #28]
|
|
8007646: f8c7 30b4 str.w r3, [r7, #180] @ 0xb4
|
|
|
|
/* If some non blocking errors occurred */
|
|
if ((isrflags & (USART_ISR_PE | USART_ISR_FE | USART_ISR_NE)) != 0U)
|
|
800764a: f8d7 30b4 ldr.w r3, [r7, #180] @ 0xb4
|
|
800764e: f003 0307 and.w r3, r3, #7
|
|
8007652: 2b00 cmp r3, #0
|
|
8007654: d053 beq.n 80076fe <UART_RxISR_16BIT_FIFOEN+0x146>
|
|
{
|
|
/* UART parity error interrupt occurred -------------------------------------*/
|
|
if (((isrflags & USART_ISR_PE) != 0U) && ((cr1its & USART_CR1_PEIE) != 0U))
|
|
8007656: f8d7 30b4 ldr.w r3, [r7, #180] @ 0xb4
|
|
800765a: f003 0301 and.w r3, r3, #1
|
|
800765e: 2b00 cmp r3, #0
|
|
8007660: d011 beq.n 8007686 <UART_RxISR_16BIT_FIFOEN+0xce>
|
|
8007662: f8d7 30ac ldr.w r3, [r7, #172] @ 0xac
|
|
8007666: f403 7380 and.w r3, r3, #256 @ 0x100
|
|
800766a: 2b00 cmp r3, #0
|
|
800766c: d00b beq.n 8007686 <UART_RxISR_16BIT_FIFOEN+0xce>
|
|
{
|
|
__HAL_UART_CLEAR_FLAG(huart, UART_CLEAR_PEF);
|
|
800766e: 687b ldr r3, [r7, #4]
|
|
8007670: 681b ldr r3, [r3, #0]
|
|
8007672: 2201 movs r2, #1
|
|
8007674: 621a str r2, [r3, #32]
|
|
|
|
huart->ErrorCode |= HAL_UART_ERROR_PE;
|
|
8007676: 687b ldr r3, [r7, #4]
|
|
8007678: f8d3 3090 ldr.w r3, [r3, #144] @ 0x90
|
|
800767c: f043 0201 orr.w r2, r3, #1
|
|
8007680: 687b ldr r3, [r7, #4]
|
|
8007682: f8c3 2090 str.w r2, [r3, #144] @ 0x90
|
|
}
|
|
|
|
/* UART frame error interrupt occurred --------------------------------------*/
|
|
if (((isrflags & USART_ISR_FE) != 0U) && ((cr3its & USART_CR3_EIE) != 0U))
|
|
8007686: f8d7 30b4 ldr.w r3, [r7, #180] @ 0xb4
|
|
800768a: f003 0302 and.w r3, r3, #2
|
|
800768e: 2b00 cmp r3, #0
|
|
8007690: d011 beq.n 80076b6 <UART_RxISR_16BIT_FIFOEN+0xfe>
|
|
8007692: f8d7 30a8 ldr.w r3, [r7, #168] @ 0xa8
|
|
8007696: f003 0301 and.w r3, r3, #1
|
|
800769a: 2b00 cmp r3, #0
|
|
800769c: d00b beq.n 80076b6 <UART_RxISR_16BIT_FIFOEN+0xfe>
|
|
{
|
|
__HAL_UART_CLEAR_FLAG(huart, UART_CLEAR_FEF);
|
|
800769e: 687b ldr r3, [r7, #4]
|
|
80076a0: 681b ldr r3, [r3, #0]
|
|
80076a2: 2202 movs r2, #2
|
|
80076a4: 621a str r2, [r3, #32]
|
|
|
|
huart->ErrorCode |= HAL_UART_ERROR_FE;
|
|
80076a6: 687b ldr r3, [r7, #4]
|
|
80076a8: f8d3 3090 ldr.w r3, [r3, #144] @ 0x90
|
|
80076ac: f043 0204 orr.w r2, r3, #4
|
|
80076b0: 687b ldr r3, [r7, #4]
|
|
80076b2: f8c3 2090 str.w r2, [r3, #144] @ 0x90
|
|
}
|
|
|
|
/* UART noise error interrupt occurred --------------------------------------*/
|
|
if (((isrflags & USART_ISR_NE) != 0U) && ((cr3its & USART_CR3_EIE) != 0U))
|
|
80076b6: f8d7 30b4 ldr.w r3, [r7, #180] @ 0xb4
|
|
80076ba: f003 0304 and.w r3, r3, #4
|
|
80076be: 2b00 cmp r3, #0
|
|
80076c0: d011 beq.n 80076e6 <UART_RxISR_16BIT_FIFOEN+0x12e>
|
|
80076c2: f8d7 30a8 ldr.w r3, [r7, #168] @ 0xa8
|
|
80076c6: f003 0301 and.w r3, r3, #1
|
|
80076ca: 2b00 cmp r3, #0
|
|
80076cc: d00b beq.n 80076e6 <UART_RxISR_16BIT_FIFOEN+0x12e>
|
|
{
|
|
__HAL_UART_CLEAR_FLAG(huart, UART_CLEAR_NEF);
|
|
80076ce: 687b ldr r3, [r7, #4]
|
|
80076d0: 681b ldr r3, [r3, #0]
|
|
80076d2: 2204 movs r2, #4
|
|
80076d4: 621a str r2, [r3, #32]
|
|
|
|
huart->ErrorCode |= HAL_UART_ERROR_NE;
|
|
80076d6: 687b ldr r3, [r7, #4]
|
|
80076d8: f8d3 3090 ldr.w r3, [r3, #144] @ 0x90
|
|
80076dc: f043 0202 orr.w r2, r3, #2
|
|
80076e0: 687b ldr r3, [r7, #4]
|
|
80076e2: f8c3 2090 str.w r2, [r3, #144] @ 0x90
|
|
}
|
|
|
|
/* Call UART Error Call back function if need be ----------------------------*/
|
|
if (huart->ErrorCode != HAL_UART_ERROR_NONE)
|
|
80076e6: 687b ldr r3, [r7, #4]
|
|
80076e8: f8d3 3090 ldr.w r3, [r3, #144] @ 0x90
|
|
80076ec: 2b00 cmp r3, #0
|
|
80076ee: d006 beq.n 80076fe <UART_RxISR_16BIT_FIFOEN+0x146>
|
|
#if (USE_HAL_UART_REGISTER_CALLBACKS == 1)
|
|
/*Call registered error callback*/
|
|
huart->ErrorCallback(huart);
|
|
#else
|
|
/*Call legacy weak error callback*/
|
|
HAL_UART_ErrorCallback(huart);
|
|
80076f0: 6878 ldr r0, [r7, #4]
|
|
80076f2: f7fe fd28 bl 8006146 <HAL_UART_ErrorCallback>
|
|
#endif /* USE_HAL_UART_REGISTER_CALLBACKS */
|
|
huart->ErrorCode = HAL_UART_ERROR_NONE;
|
|
80076f6: 687b ldr r3, [r7, #4]
|
|
80076f8: 2200 movs r2, #0
|
|
80076fa: f8c3 2090 str.w r2, [r3, #144] @ 0x90
|
|
}
|
|
}
|
|
|
|
if (huart->RxXferCount == 0U)
|
|
80076fe: 687b ldr r3, [r7, #4]
|
|
8007700: f8b3 305e ldrh.w r3, [r3, #94] @ 0x5e
|
|
8007704: b29b uxth r3, r3
|
|
8007706: 2b00 cmp r3, #0
|
|
8007708: f040 80a5 bne.w 8007856 <UART_RxISR_16BIT_FIFOEN+0x29e>
|
|
{
|
|
/* Disable the UART Parity Error Interrupt and RXFT interrupt*/
|
|
ATOMIC_CLEAR_BIT(huart->Instance->CR1, USART_CR1_PEIE);
|
|
800770c: 687b ldr r3, [r7, #4]
|
|
800770e: 681b ldr r3, [r3, #0]
|
|
8007710: 677b str r3, [r7, #116] @ 0x74
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
8007712: 6f7b ldr r3, [r7, #116] @ 0x74
|
|
8007714: e853 3f00 ldrex r3, [r3]
|
|
8007718: 673b str r3, [r7, #112] @ 0x70
|
|
return(result);
|
|
800771a: 6f3b ldr r3, [r7, #112] @ 0x70
|
|
800771c: f423 7380 bic.w r3, r3, #256 @ 0x100
|
|
8007720: f8c7 309c str.w r3, [r7, #156] @ 0x9c
|
|
8007724: 687b ldr r3, [r7, #4]
|
|
8007726: 681b ldr r3, [r3, #0]
|
|
8007728: 461a mov r2, r3
|
|
800772a: f8d7 309c ldr.w r3, [r7, #156] @ 0x9c
|
|
800772e: f8c7 3080 str.w r3, [r7, #128] @ 0x80
|
|
8007732: 67fa str r2, [r7, #124] @ 0x7c
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
8007734: 6ff9 ldr r1, [r7, #124] @ 0x7c
|
|
8007736: f8d7 2080 ldr.w r2, [r7, #128] @ 0x80
|
|
800773a: e841 2300 strex r3, r2, [r1]
|
|
800773e: 67bb str r3, [r7, #120] @ 0x78
|
|
return(result);
|
|
8007740: 6fbb ldr r3, [r7, #120] @ 0x78
|
|
8007742: 2b00 cmp r3, #0
|
|
8007744: d1e2 bne.n 800770c <UART_RxISR_16BIT_FIFOEN+0x154>
|
|
|
|
/* Disable the UART Error Interrupt: (Frame error, noise error, overrun error)
|
|
and RX FIFO Threshold interrupt */
|
|
ATOMIC_CLEAR_BIT(huart->Instance->CR3, (USART_CR3_EIE | USART_CR3_RXFTIE));
|
|
8007746: 687b ldr r3, [r7, #4]
|
|
8007748: 681b ldr r3, [r3, #0]
|
|
800774a: 3308 adds r3, #8
|
|
800774c: 663b str r3, [r7, #96] @ 0x60
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
800774e: 6e3b ldr r3, [r7, #96] @ 0x60
|
|
8007750: e853 3f00 ldrex r3, [r3]
|
|
8007754: 65fb str r3, [r7, #92] @ 0x5c
|
|
return(result);
|
|
8007756: 6dfb ldr r3, [r7, #92] @ 0x5c
|
|
8007758: f023 5380 bic.w r3, r3, #268435456 @ 0x10000000
|
|
800775c: f023 0301 bic.w r3, r3, #1
|
|
8007760: f8c7 3098 str.w r3, [r7, #152] @ 0x98
|
|
8007764: 687b ldr r3, [r7, #4]
|
|
8007766: 681b ldr r3, [r3, #0]
|
|
8007768: 3308 adds r3, #8
|
|
800776a: f8d7 2098 ldr.w r2, [r7, #152] @ 0x98
|
|
800776e: 66fa str r2, [r7, #108] @ 0x6c
|
|
8007770: 66bb str r3, [r7, #104] @ 0x68
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
8007772: 6eb9 ldr r1, [r7, #104] @ 0x68
|
|
8007774: 6efa ldr r2, [r7, #108] @ 0x6c
|
|
8007776: e841 2300 strex r3, r2, [r1]
|
|
800777a: 667b str r3, [r7, #100] @ 0x64
|
|
return(result);
|
|
800777c: 6e7b ldr r3, [r7, #100] @ 0x64
|
|
800777e: 2b00 cmp r3, #0
|
|
8007780: d1e1 bne.n 8007746 <UART_RxISR_16BIT_FIFOEN+0x18e>
|
|
|
|
/* Rx process is completed, restore huart->RxState to Ready */
|
|
huart->RxState = HAL_UART_STATE_READY;
|
|
8007782: 687b ldr r3, [r7, #4]
|
|
8007784: 2220 movs r2, #32
|
|
8007786: f8c3 208c str.w r2, [r3, #140] @ 0x8c
|
|
|
|
/* Clear RxISR function pointer */
|
|
huart->RxISR = NULL;
|
|
800778a: 687b ldr r3, [r7, #4]
|
|
800778c: 2200 movs r2, #0
|
|
800778e: 675a str r2, [r3, #116] @ 0x74
|
|
|
|
/* Initialize type of RxEvent to Transfer Complete */
|
|
huart->RxEventType = HAL_UART_RXEVENT_TC;
|
|
8007790: 687b ldr r3, [r7, #4]
|
|
8007792: 2200 movs r2, #0
|
|
8007794: 671a str r2, [r3, #112] @ 0x70
|
|
|
|
if (!(IS_LPUART_INSTANCE(huart->Instance)))
|
|
8007796: 687b ldr r3, [r7, #4]
|
|
8007798: 681b ldr r3, [r3, #0]
|
|
800779a: 4a60 ldr r2, [pc, #384] @ (800791c <UART_RxISR_16BIT_FIFOEN+0x364>)
|
|
800779c: 4293 cmp r3, r2
|
|
800779e: d021 beq.n 80077e4 <UART_RxISR_16BIT_FIFOEN+0x22c>
|
|
{
|
|
/* Check that USART RTOEN bit is set */
|
|
if (READ_BIT(huart->Instance->CR2, USART_CR2_RTOEN) != 0U)
|
|
80077a0: 687b ldr r3, [r7, #4]
|
|
80077a2: 681b ldr r3, [r3, #0]
|
|
80077a4: 685b ldr r3, [r3, #4]
|
|
80077a6: f403 0300 and.w r3, r3, #8388608 @ 0x800000
|
|
80077aa: 2b00 cmp r3, #0
|
|
80077ac: d01a beq.n 80077e4 <UART_RxISR_16BIT_FIFOEN+0x22c>
|
|
{
|
|
/* Enable the UART Receiver Timeout Interrupt */
|
|
ATOMIC_CLEAR_BIT(huart->Instance->CR1, USART_CR1_RTOIE);
|
|
80077ae: 687b ldr r3, [r7, #4]
|
|
80077b0: 681b ldr r3, [r3, #0]
|
|
80077b2: 64fb str r3, [r7, #76] @ 0x4c
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
80077b4: 6cfb ldr r3, [r7, #76] @ 0x4c
|
|
80077b6: e853 3f00 ldrex r3, [r3]
|
|
80077ba: 64bb str r3, [r7, #72] @ 0x48
|
|
return(result);
|
|
80077bc: 6cbb ldr r3, [r7, #72] @ 0x48
|
|
80077be: f023 6380 bic.w r3, r3, #67108864 @ 0x4000000
|
|
80077c2: f8c7 3094 str.w r3, [r7, #148] @ 0x94
|
|
80077c6: 687b ldr r3, [r7, #4]
|
|
80077c8: 681b ldr r3, [r3, #0]
|
|
80077ca: 461a mov r2, r3
|
|
80077cc: f8d7 3094 ldr.w r3, [r7, #148] @ 0x94
|
|
80077d0: 65bb str r3, [r7, #88] @ 0x58
|
|
80077d2: 657a str r2, [r7, #84] @ 0x54
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
80077d4: 6d79 ldr r1, [r7, #84] @ 0x54
|
|
80077d6: 6dba ldr r2, [r7, #88] @ 0x58
|
|
80077d8: e841 2300 strex r3, r2, [r1]
|
|
80077dc: 653b str r3, [r7, #80] @ 0x50
|
|
return(result);
|
|
80077de: 6d3b ldr r3, [r7, #80] @ 0x50
|
|
80077e0: 2b00 cmp r3, #0
|
|
80077e2: d1e4 bne.n 80077ae <UART_RxISR_16BIT_FIFOEN+0x1f6>
|
|
}
|
|
}
|
|
|
|
/* Check current reception Mode :
|
|
If Reception till IDLE event has been selected : */
|
|
if (huart->ReceptionType == HAL_UART_RECEPTION_TOIDLE)
|
|
80077e4: 687b ldr r3, [r7, #4]
|
|
80077e6: 6edb ldr r3, [r3, #108] @ 0x6c
|
|
80077e8: 2b01 cmp r3, #1
|
|
80077ea: d130 bne.n 800784e <UART_RxISR_16BIT_FIFOEN+0x296>
|
|
{
|
|
/* Set reception type to Standard */
|
|
huart->ReceptionType = HAL_UART_RECEPTION_STANDARD;
|
|
80077ec: 687b ldr r3, [r7, #4]
|
|
80077ee: 2200 movs r2, #0
|
|
80077f0: 66da str r2, [r3, #108] @ 0x6c
|
|
|
|
/* Disable IDLE interrupt */
|
|
ATOMIC_CLEAR_BIT(huart->Instance->CR1, USART_CR1_IDLEIE);
|
|
80077f2: 687b ldr r3, [r7, #4]
|
|
80077f4: 681b ldr r3, [r3, #0]
|
|
80077f6: 63bb str r3, [r7, #56] @ 0x38
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
80077f8: 6bbb ldr r3, [r7, #56] @ 0x38
|
|
80077fa: e853 3f00 ldrex r3, [r3]
|
|
80077fe: 637b str r3, [r7, #52] @ 0x34
|
|
return(result);
|
|
8007800: 6b7b ldr r3, [r7, #52] @ 0x34
|
|
8007802: f023 0310 bic.w r3, r3, #16
|
|
8007806: f8c7 3090 str.w r3, [r7, #144] @ 0x90
|
|
800780a: 687b ldr r3, [r7, #4]
|
|
800780c: 681b ldr r3, [r3, #0]
|
|
800780e: 461a mov r2, r3
|
|
8007810: f8d7 3090 ldr.w r3, [r7, #144] @ 0x90
|
|
8007814: 647b str r3, [r7, #68] @ 0x44
|
|
8007816: 643a str r2, [r7, #64] @ 0x40
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
8007818: 6c39 ldr r1, [r7, #64] @ 0x40
|
|
800781a: 6c7a ldr r2, [r7, #68] @ 0x44
|
|
800781c: e841 2300 strex r3, r2, [r1]
|
|
8007820: 63fb str r3, [r7, #60] @ 0x3c
|
|
return(result);
|
|
8007822: 6bfb ldr r3, [r7, #60] @ 0x3c
|
|
8007824: 2b00 cmp r3, #0
|
|
8007826: d1e4 bne.n 80077f2 <UART_RxISR_16BIT_FIFOEN+0x23a>
|
|
|
|
if (__HAL_UART_GET_FLAG(huart, UART_FLAG_IDLE) == SET)
|
|
8007828: 687b ldr r3, [r7, #4]
|
|
800782a: 681b ldr r3, [r3, #0]
|
|
800782c: 69db ldr r3, [r3, #28]
|
|
800782e: f003 0310 and.w r3, r3, #16
|
|
8007832: 2b10 cmp r3, #16
|
|
8007834: d103 bne.n 800783e <UART_RxISR_16BIT_FIFOEN+0x286>
|
|
{
|
|
/* Clear IDLE Flag */
|
|
__HAL_UART_CLEAR_FLAG(huart, UART_CLEAR_IDLEF);
|
|
8007836: 687b ldr r3, [r7, #4]
|
|
8007838: 681b ldr r3, [r3, #0]
|
|
800783a: 2210 movs r2, #16
|
|
800783c: 621a str r2, [r3, #32]
|
|
#if (USE_HAL_UART_REGISTER_CALLBACKS == 1)
|
|
/*Call registered Rx Event callback*/
|
|
huart->RxEventCallback(huart, huart->RxXferSize);
|
|
#else
|
|
/*Call legacy weak Rx Event callback*/
|
|
HAL_UARTEx_RxEventCallback(huart, huart->RxXferSize);
|
|
800783e: 687b ldr r3, [r7, #4]
|
|
8007840: f8b3 305c ldrh.w r3, [r3, #92] @ 0x5c
|
|
8007844: 4619 mov r1, r3
|
|
8007846: 6878 ldr r0, [r7, #4]
|
|
8007848: f7fe fc86 bl 8006158 <HAL_UARTEx_RxEventCallback>
|
|
#else
|
|
/*Call legacy weak Rx complete callback*/
|
|
HAL_UART_RxCpltCallback(huart);
|
|
#endif /* USE_HAL_UART_REGISTER_CALLBACKS */
|
|
}
|
|
break;
|
|
800784c: e00e b.n 800786c <UART_RxISR_16BIT_FIFOEN+0x2b4>
|
|
HAL_UART_RxCpltCallback(huart);
|
|
800784e: 6878 ldr r0, [r7, #4]
|
|
8007850: f7f9 ff18 bl 8001684 <HAL_UART_RxCpltCallback>
|
|
break;
|
|
8007854: e00a b.n 800786c <UART_RxISR_16BIT_FIFOEN+0x2b4>
|
|
while ((nb_rx_data > 0U) && ((isrflags & USART_ISR_RXNE_RXFNE) != 0U))
|
|
8007856: f8b7 30a6 ldrh.w r3, [r7, #166] @ 0xa6
|
|
800785a: 2b00 cmp r3, #0
|
|
800785c: d006 beq.n 800786c <UART_RxISR_16BIT_FIFOEN+0x2b4>
|
|
800785e: f8d7 30b4 ldr.w r3, [r7, #180] @ 0xb4
|
|
8007862: f003 0320 and.w r3, r3, #32
|
|
8007866: 2b00 cmp r3, #0
|
|
8007868: f47f aeca bne.w 8007600 <UART_RxISR_16BIT_FIFOEN+0x48>
|
|
|
|
/* When remaining number of bytes to receive is less than the RX FIFO
|
|
threshold, next incoming frames are processed as if FIFO mode was
|
|
disabled (i.e. one interrupt per received frame).
|
|
*/
|
|
rxdatacount = huart->RxXferCount;
|
|
800786c: 687b ldr r3, [r7, #4]
|
|
800786e: f8b3 305e ldrh.w r3, [r3, #94] @ 0x5e
|
|
8007872: f8a7 308e strh.w r3, [r7, #142] @ 0x8e
|
|
if ((rxdatacount != 0U) && (rxdatacount < huart->NbRxDataToProcess))
|
|
8007876: f8b7 308e ldrh.w r3, [r7, #142] @ 0x8e
|
|
800787a: 2b00 cmp r3, #0
|
|
800787c: d049 beq.n 8007912 <UART_RxISR_16BIT_FIFOEN+0x35a>
|
|
800787e: 687b ldr r3, [r7, #4]
|
|
8007880: f8b3 3068 ldrh.w r3, [r3, #104] @ 0x68
|
|
8007884: f8b7 208e ldrh.w r2, [r7, #142] @ 0x8e
|
|
8007888: 429a cmp r2, r3
|
|
800788a: d242 bcs.n 8007912 <UART_RxISR_16BIT_FIFOEN+0x35a>
|
|
{
|
|
/* Disable the UART RXFT interrupt*/
|
|
ATOMIC_CLEAR_BIT(huart->Instance->CR3, USART_CR3_RXFTIE);
|
|
800788c: 687b ldr r3, [r7, #4]
|
|
800788e: 681b ldr r3, [r3, #0]
|
|
8007890: 3308 adds r3, #8
|
|
8007892: 627b str r3, [r7, #36] @ 0x24
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
8007894: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
8007896: e853 3f00 ldrex r3, [r3]
|
|
800789a: 623b str r3, [r7, #32]
|
|
return(result);
|
|
800789c: 6a3b ldr r3, [r7, #32]
|
|
800789e: f023 5380 bic.w r3, r3, #268435456 @ 0x10000000
|
|
80078a2: f8c7 3088 str.w r3, [r7, #136] @ 0x88
|
|
80078a6: 687b ldr r3, [r7, #4]
|
|
80078a8: 681b ldr r3, [r3, #0]
|
|
80078aa: 3308 adds r3, #8
|
|
80078ac: f8d7 2088 ldr.w r2, [r7, #136] @ 0x88
|
|
80078b0: 633a str r2, [r7, #48] @ 0x30
|
|
80078b2: 62fb str r3, [r7, #44] @ 0x2c
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
80078b4: 6af9 ldr r1, [r7, #44] @ 0x2c
|
|
80078b6: 6b3a ldr r2, [r7, #48] @ 0x30
|
|
80078b8: e841 2300 strex r3, r2, [r1]
|
|
80078bc: 62bb str r3, [r7, #40] @ 0x28
|
|
return(result);
|
|
80078be: 6abb ldr r3, [r7, #40] @ 0x28
|
|
80078c0: 2b00 cmp r3, #0
|
|
80078c2: d1e3 bne.n 800788c <UART_RxISR_16BIT_FIFOEN+0x2d4>
|
|
|
|
/* Update the RxISR function pointer */
|
|
huart->RxISR = UART_RxISR_16BIT;
|
|
80078c4: 687b ldr r3, [r7, #4]
|
|
80078c6: 4a16 ldr r2, [pc, #88] @ (8007920 <UART_RxISR_16BIT_FIFOEN+0x368>)
|
|
80078c8: 675a str r2, [r3, #116] @ 0x74
|
|
|
|
/* Enable the UART Data Register Not Empty interrupt */
|
|
ATOMIC_SET_BIT(huart->Instance->CR1, USART_CR1_RXNEIE_RXFNEIE);
|
|
80078ca: 687b ldr r3, [r7, #4]
|
|
80078cc: 681b ldr r3, [r3, #0]
|
|
80078ce: 613b str r3, [r7, #16]
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
80078d0: 693b ldr r3, [r7, #16]
|
|
80078d2: e853 3f00 ldrex r3, [r3]
|
|
80078d6: 60fb str r3, [r7, #12]
|
|
return(result);
|
|
80078d8: 68fb ldr r3, [r7, #12]
|
|
80078da: f043 0320 orr.w r3, r3, #32
|
|
80078de: f8c7 3084 str.w r3, [r7, #132] @ 0x84
|
|
80078e2: 687b ldr r3, [r7, #4]
|
|
80078e4: 681b ldr r3, [r3, #0]
|
|
80078e6: 461a mov r2, r3
|
|
80078e8: f8d7 3084 ldr.w r3, [r7, #132] @ 0x84
|
|
80078ec: 61fb str r3, [r7, #28]
|
|
80078ee: 61ba str r2, [r7, #24]
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
80078f0: 69b9 ldr r1, [r7, #24]
|
|
80078f2: 69fa ldr r2, [r7, #28]
|
|
80078f4: e841 2300 strex r3, r2, [r1]
|
|
80078f8: 617b str r3, [r7, #20]
|
|
return(result);
|
|
80078fa: 697b ldr r3, [r7, #20]
|
|
80078fc: 2b00 cmp r3, #0
|
|
80078fe: d1e4 bne.n 80078ca <UART_RxISR_16BIT_FIFOEN+0x312>
|
|
else
|
|
{
|
|
/* Clear RXNE interrupt flag */
|
|
__HAL_UART_SEND_REQ(huart, UART_RXDATA_FLUSH_REQUEST);
|
|
}
|
|
}
|
|
8007900: e007 b.n 8007912 <UART_RxISR_16BIT_FIFOEN+0x35a>
|
|
__HAL_UART_SEND_REQ(huart, UART_RXDATA_FLUSH_REQUEST);
|
|
8007902: 687b ldr r3, [r7, #4]
|
|
8007904: 681b ldr r3, [r3, #0]
|
|
8007906: 699a ldr r2, [r3, #24]
|
|
8007908: 687b ldr r3, [r7, #4]
|
|
800790a: 681b ldr r3, [r3, #0]
|
|
800790c: f042 0208 orr.w r2, r2, #8
|
|
8007910: 619a str r2, [r3, #24]
|
|
}
|
|
8007912: bf00 nop
|
|
8007914: 37b8 adds r7, #184 @ 0xb8
|
|
8007916: 46bd mov sp, r7
|
|
8007918: bd80 pop {r7, pc}
|
|
800791a: bf00 nop
|
|
800791c: 40008000 .word 0x40008000
|
|
8007920: 0800709d .word 0x0800709d
|
|
|
|
08007924 <HAL_UARTEx_WakeupCallback>:
|
|
* @brief UART wakeup from Stop mode callback.
|
|
* @param huart UART handle.
|
|
* @retval None
|
|
*/
|
|
__weak void HAL_UARTEx_WakeupCallback(UART_HandleTypeDef *huart)
|
|
{
|
|
8007924: b480 push {r7}
|
|
8007926: b083 sub sp, #12
|
|
8007928: af00 add r7, sp, #0
|
|
800792a: 6078 str r0, [r7, #4]
|
|
UNUSED(huart);
|
|
|
|
/* NOTE : This function should not be modified, when the callback is needed,
|
|
the HAL_UARTEx_WakeupCallback can be implemented in the user file.
|
|
*/
|
|
}
|
|
800792c: bf00 nop
|
|
800792e: 370c adds r7, #12
|
|
8007930: 46bd mov sp, r7
|
|
8007932: bc80 pop {r7}
|
|
8007934: 4770 bx lr
|
|
|
|
08007936 <HAL_UARTEx_RxFifoFullCallback>:
|
|
* @brief UART RX Fifo full callback.
|
|
* @param huart UART handle.
|
|
* @retval None
|
|
*/
|
|
__weak void HAL_UARTEx_RxFifoFullCallback(UART_HandleTypeDef *huart)
|
|
{
|
|
8007936: b480 push {r7}
|
|
8007938: b083 sub sp, #12
|
|
800793a: af00 add r7, sp, #0
|
|
800793c: 6078 str r0, [r7, #4]
|
|
UNUSED(huart);
|
|
|
|
/* NOTE : This function should not be modified, when the callback is needed,
|
|
the HAL_UARTEx_RxFifoFullCallback can be implemented in the user file.
|
|
*/
|
|
}
|
|
800793e: bf00 nop
|
|
8007940: 370c adds r7, #12
|
|
8007942: 46bd mov sp, r7
|
|
8007944: bc80 pop {r7}
|
|
8007946: 4770 bx lr
|
|
|
|
08007948 <HAL_UARTEx_TxFifoEmptyCallback>:
|
|
* @brief UART TX Fifo empty callback.
|
|
* @param huart UART handle.
|
|
* @retval None
|
|
*/
|
|
__weak void HAL_UARTEx_TxFifoEmptyCallback(UART_HandleTypeDef *huart)
|
|
{
|
|
8007948: b480 push {r7}
|
|
800794a: b083 sub sp, #12
|
|
800794c: af00 add r7, sp, #0
|
|
800794e: 6078 str r0, [r7, #4]
|
|
UNUSED(huart);
|
|
|
|
/* NOTE : This function should not be modified, when the callback is needed,
|
|
the HAL_UARTEx_TxFifoEmptyCallback can be implemented in the user file.
|
|
*/
|
|
}
|
|
8007950: bf00 nop
|
|
8007952: 370c adds r7, #12
|
|
8007954: 46bd mov sp, r7
|
|
8007956: bc80 pop {r7}
|
|
8007958: 4770 bx lr
|
|
|
|
0800795a <HAL_UARTEx_StopModeWakeUpSourceConfig>:
|
|
* @arg @ref UART_WAKEUP_ON_STARTBIT
|
|
* @arg @ref UART_WAKEUP_ON_READDATA_NONEMPTY
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_UARTEx_StopModeWakeUpSourceConfig(UART_HandleTypeDef *huart, UART_WakeUpTypeDef WakeUpSelection)
|
|
{
|
|
800795a: b580 push {r7, lr}
|
|
800795c: b088 sub sp, #32
|
|
800795e: af02 add r7, sp, #8
|
|
8007960: 60f8 str r0, [r7, #12]
|
|
8007962: 1d3b adds r3, r7, #4
|
|
8007964: e883 0006 stmia.w r3, {r1, r2}
|
|
HAL_StatusTypeDef status = HAL_OK;
|
|
8007968: 2300 movs r3, #0
|
|
800796a: 75fb strb r3, [r7, #23]
|
|
assert_param(IS_UART_WAKEUP_FROMSTOP_INSTANCE(huart->Instance));
|
|
/* check the wake-up selection parameter */
|
|
assert_param(IS_UART_WAKEUP_SELECTION(WakeUpSelection.WakeUpEvent));
|
|
|
|
/* Process Locked */
|
|
__HAL_LOCK(huart);
|
|
800796c: 68fb ldr r3, [r7, #12]
|
|
800796e: f893 3084 ldrb.w r3, [r3, #132] @ 0x84
|
|
8007972: 2b01 cmp r3, #1
|
|
8007974: d101 bne.n 800797a <HAL_UARTEx_StopModeWakeUpSourceConfig+0x20>
|
|
8007976: 2302 movs r3, #2
|
|
8007978: e046 b.n 8007a08 <HAL_UARTEx_StopModeWakeUpSourceConfig+0xae>
|
|
800797a: 68fb ldr r3, [r7, #12]
|
|
800797c: 2201 movs r2, #1
|
|
800797e: f883 2084 strb.w r2, [r3, #132] @ 0x84
|
|
|
|
huart->gState = HAL_UART_STATE_BUSY;
|
|
8007982: 68fb ldr r3, [r7, #12]
|
|
8007984: 2224 movs r2, #36 @ 0x24
|
|
8007986: f8c3 2088 str.w r2, [r3, #136] @ 0x88
|
|
|
|
/* Disable the Peripheral */
|
|
__HAL_UART_DISABLE(huart);
|
|
800798a: 68fb ldr r3, [r7, #12]
|
|
800798c: 681b ldr r3, [r3, #0]
|
|
800798e: 681a ldr r2, [r3, #0]
|
|
8007990: 68fb ldr r3, [r7, #12]
|
|
8007992: 681b ldr r3, [r3, #0]
|
|
8007994: f022 0201 bic.w r2, r2, #1
|
|
8007998: 601a str r2, [r3, #0]
|
|
|
|
/* Set the wake-up selection scheme */
|
|
MODIFY_REG(huart->Instance->CR3, USART_CR3_WUS, WakeUpSelection.WakeUpEvent);
|
|
800799a: 68fb ldr r3, [r7, #12]
|
|
800799c: 681b ldr r3, [r3, #0]
|
|
800799e: 689b ldr r3, [r3, #8]
|
|
80079a0: f423 1140 bic.w r1, r3, #3145728 @ 0x300000
|
|
80079a4: 687a ldr r2, [r7, #4]
|
|
80079a6: 68fb ldr r3, [r7, #12]
|
|
80079a8: 681b ldr r3, [r3, #0]
|
|
80079aa: 430a orrs r2, r1
|
|
80079ac: 609a str r2, [r3, #8]
|
|
|
|
if (WakeUpSelection.WakeUpEvent == UART_WAKEUP_ON_ADDRESS)
|
|
80079ae: 687b ldr r3, [r7, #4]
|
|
80079b0: 2b00 cmp r3, #0
|
|
80079b2: d105 bne.n 80079c0 <HAL_UARTEx_StopModeWakeUpSourceConfig+0x66>
|
|
{
|
|
UARTEx_Wakeup_AddressConfig(huart, WakeUpSelection);
|
|
80079b4: 1d3b adds r3, r7, #4
|
|
80079b6: e893 0006 ldmia.w r3, {r1, r2}
|
|
80079ba: 68f8 ldr r0, [r7, #12]
|
|
80079bc: f000 f911 bl 8007be2 <UARTEx_Wakeup_AddressConfig>
|
|
}
|
|
|
|
/* Enable the Peripheral */
|
|
__HAL_UART_ENABLE(huart);
|
|
80079c0: 68fb ldr r3, [r7, #12]
|
|
80079c2: 681b ldr r3, [r3, #0]
|
|
80079c4: 681a ldr r2, [r3, #0]
|
|
80079c6: 68fb ldr r3, [r7, #12]
|
|
80079c8: 681b ldr r3, [r3, #0]
|
|
80079ca: f042 0201 orr.w r2, r2, #1
|
|
80079ce: 601a str r2, [r3, #0]
|
|
|
|
/* Init tickstart for timeout management */
|
|
tickstart = HAL_GetTick();
|
|
80079d0: f7f9 f93a bl 8000c48 <HAL_GetTick>
|
|
80079d4: 6138 str r0, [r7, #16]
|
|
|
|
/* Wait until REACK flag is set */
|
|
if (UART_WaitOnFlagUntilTimeout(huart, USART_ISR_REACK, RESET, tickstart, HAL_UART_TIMEOUT_VALUE) != HAL_OK)
|
|
80079d6: f06f 437e mvn.w r3, #4261412864 @ 0xfe000000
|
|
80079da: 9300 str r3, [sp, #0]
|
|
80079dc: 693b ldr r3, [r7, #16]
|
|
80079de: 2200 movs r2, #0
|
|
80079e0: f44f 0180 mov.w r1, #4194304 @ 0x400000
|
|
80079e4: 68f8 ldr r0, [r7, #12]
|
|
80079e6: f7fe ff82 bl 80068ee <UART_WaitOnFlagUntilTimeout>
|
|
80079ea: 4603 mov r3, r0
|
|
80079ec: 2b00 cmp r3, #0
|
|
80079ee: d002 beq.n 80079f6 <HAL_UARTEx_StopModeWakeUpSourceConfig+0x9c>
|
|
{
|
|
status = HAL_TIMEOUT;
|
|
80079f0: 2303 movs r3, #3
|
|
80079f2: 75fb strb r3, [r7, #23]
|
|
80079f4: e003 b.n 80079fe <HAL_UARTEx_StopModeWakeUpSourceConfig+0xa4>
|
|
}
|
|
else
|
|
{
|
|
/* Initialize the UART State */
|
|
huart->gState = HAL_UART_STATE_READY;
|
|
80079f6: 68fb ldr r3, [r7, #12]
|
|
80079f8: 2220 movs r2, #32
|
|
80079fa: f8c3 2088 str.w r2, [r3, #136] @ 0x88
|
|
}
|
|
|
|
/* Process Unlocked */
|
|
__HAL_UNLOCK(huart);
|
|
80079fe: 68fb ldr r3, [r7, #12]
|
|
8007a00: 2200 movs r2, #0
|
|
8007a02: f883 2084 strb.w r2, [r3, #132] @ 0x84
|
|
|
|
return status;
|
|
8007a06: 7dfb ldrb r3, [r7, #23]
|
|
}
|
|
8007a08: 4618 mov r0, r3
|
|
8007a0a: 3718 adds r7, #24
|
|
8007a0c: 46bd mov sp, r7
|
|
8007a0e: bd80 pop {r7, pc}
|
|
|
|
08007a10 <HAL_UARTEx_EnableStopMode>:
|
|
* @note The UART is able to wake up the MCU from Stop 1 mode as long as UART clock is HSI or LSE.
|
|
* @param huart UART handle.
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_UARTEx_EnableStopMode(UART_HandleTypeDef *huart)
|
|
{
|
|
8007a10: b480 push {r7}
|
|
8007a12: b089 sub sp, #36 @ 0x24
|
|
8007a14: af00 add r7, sp, #0
|
|
8007a16: 6078 str r0, [r7, #4]
|
|
/* Process Locked */
|
|
__HAL_LOCK(huart);
|
|
8007a18: 687b ldr r3, [r7, #4]
|
|
8007a1a: f893 3084 ldrb.w r3, [r3, #132] @ 0x84
|
|
8007a1e: 2b01 cmp r3, #1
|
|
8007a20: d101 bne.n 8007a26 <HAL_UARTEx_EnableStopMode+0x16>
|
|
8007a22: 2302 movs r3, #2
|
|
8007a24: e021 b.n 8007a6a <HAL_UARTEx_EnableStopMode+0x5a>
|
|
8007a26: 687b ldr r3, [r7, #4]
|
|
8007a28: 2201 movs r2, #1
|
|
8007a2a: f883 2084 strb.w r2, [r3, #132] @ 0x84
|
|
|
|
/* Set UESM bit */
|
|
ATOMIC_SET_BIT(huart->Instance->CR1, USART_CR1_UESM);
|
|
8007a2e: 687b ldr r3, [r7, #4]
|
|
8007a30: 681b ldr r3, [r3, #0]
|
|
8007a32: 60fb str r3, [r7, #12]
|
|
__ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
|
|
8007a34: 68fb ldr r3, [r7, #12]
|
|
8007a36: e853 3f00 ldrex r3, [r3]
|
|
8007a3a: 60bb str r3, [r7, #8]
|
|
return(result);
|
|
8007a3c: 68bb ldr r3, [r7, #8]
|
|
8007a3e: f043 0302 orr.w r3, r3, #2
|
|
8007a42: 61fb str r3, [r7, #28]
|
|
8007a44: 687b ldr r3, [r7, #4]
|
|
8007a46: 681b ldr r3, [r3, #0]
|
|
8007a48: 461a mov r2, r3
|
|
8007a4a: 69fb ldr r3, [r7, #28]
|
|
8007a4c: 61bb str r3, [r7, #24]
|
|
8007a4e: 617a str r2, [r7, #20]
|
|
__ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
|
|
8007a50: 6979 ldr r1, [r7, #20]
|
|
8007a52: 69ba ldr r2, [r7, #24]
|
|
8007a54: e841 2300 strex r3, r2, [r1]
|
|
8007a58: 613b str r3, [r7, #16]
|
|
return(result);
|
|
8007a5a: 693b ldr r3, [r7, #16]
|
|
8007a5c: 2b00 cmp r3, #0
|
|
8007a5e: d1e6 bne.n 8007a2e <HAL_UARTEx_EnableStopMode+0x1e>
|
|
|
|
/* Process Unlocked */
|
|
__HAL_UNLOCK(huart);
|
|
8007a60: 687b ldr r3, [r7, #4]
|
|
8007a62: 2200 movs r2, #0
|
|
8007a64: f883 2084 strb.w r2, [r3, #132] @ 0x84
|
|
|
|
return HAL_OK;
|
|
8007a68: 2300 movs r3, #0
|
|
}
|
|
8007a6a: 4618 mov r0, r3
|
|
8007a6c: 3724 adds r7, #36 @ 0x24
|
|
8007a6e: 46bd mov sp, r7
|
|
8007a70: bc80 pop {r7}
|
|
8007a72: 4770 bx lr
|
|
|
|
08007a74 <HAL_UARTEx_EnableFifoMode>:
|
|
* @brief Enable the FIFO mode.
|
|
* @param huart UART handle.
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_UARTEx_EnableFifoMode(UART_HandleTypeDef *huart)
|
|
{
|
|
8007a74: b580 push {r7, lr}
|
|
8007a76: b084 sub sp, #16
|
|
8007a78: af00 add r7, sp, #0
|
|
8007a7a: 6078 str r0, [r7, #4]
|
|
|
|
/* Check parameters */
|
|
assert_param(IS_UART_FIFO_INSTANCE(huart->Instance));
|
|
|
|
/* Process Locked */
|
|
__HAL_LOCK(huart);
|
|
8007a7c: 687b ldr r3, [r7, #4]
|
|
8007a7e: f893 3084 ldrb.w r3, [r3, #132] @ 0x84
|
|
8007a82: 2b01 cmp r3, #1
|
|
8007a84: d101 bne.n 8007a8a <HAL_UARTEx_EnableFifoMode+0x16>
|
|
8007a86: 2302 movs r3, #2
|
|
8007a88: e02b b.n 8007ae2 <HAL_UARTEx_EnableFifoMode+0x6e>
|
|
8007a8a: 687b ldr r3, [r7, #4]
|
|
8007a8c: 2201 movs r2, #1
|
|
8007a8e: f883 2084 strb.w r2, [r3, #132] @ 0x84
|
|
|
|
huart->gState = HAL_UART_STATE_BUSY;
|
|
8007a92: 687b ldr r3, [r7, #4]
|
|
8007a94: 2224 movs r2, #36 @ 0x24
|
|
8007a96: f8c3 2088 str.w r2, [r3, #136] @ 0x88
|
|
|
|
/* Save actual UART configuration */
|
|
tmpcr1 = READ_REG(huart->Instance->CR1);
|
|
8007a9a: 687b ldr r3, [r7, #4]
|
|
8007a9c: 681b ldr r3, [r3, #0]
|
|
8007a9e: 681b ldr r3, [r3, #0]
|
|
8007aa0: 60fb str r3, [r7, #12]
|
|
|
|
/* Disable UART */
|
|
__HAL_UART_DISABLE(huart);
|
|
8007aa2: 687b ldr r3, [r7, #4]
|
|
8007aa4: 681b ldr r3, [r3, #0]
|
|
8007aa6: 681a ldr r2, [r3, #0]
|
|
8007aa8: 687b ldr r3, [r7, #4]
|
|
8007aaa: 681b ldr r3, [r3, #0]
|
|
8007aac: f022 0201 bic.w r2, r2, #1
|
|
8007ab0: 601a str r2, [r3, #0]
|
|
|
|
/* Enable FIFO mode */
|
|
SET_BIT(tmpcr1, USART_CR1_FIFOEN);
|
|
8007ab2: 68fb ldr r3, [r7, #12]
|
|
8007ab4: f043 5300 orr.w r3, r3, #536870912 @ 0x20000000
|
|
8007ab8: 60fb str r3, [r7, #12]
|
|
huart->FifoMode = UART_FIFOMODE_ENABLE;
|
|
8007aba: 687b ldr r3, [r7, #4]
|
|
8007abc: f04f 5200 mov.w r2, #536870912 @ 0x20000000
|
|
8007ac0: 665a str r2, [r3, #100] @ 0x64
|
|
|
|
/* Restore UART configuration */
|
|
WRITE_REG(huart->Instance->CR1, tmpcr1);
|
|
8007ac2: 687b ldr r3, [r7, #4]
|
|
8007ac4: 681b ldr r3, [r3, #0]
|
|
8007ac6: 68fa ldr r2, [r7, #12]
|
|
8007ac8: 601a str r2, [r3, #0]
|
|
|
|
/* Determine the number of data to process during RX/TX ISR execution */
|
|
UARTEx_SetNbDataToProcess(huart);
|
|
8007aca: 6878 ldr r0, [r7, #4]
|
|
8007acc: f000 f8ac bl 8007c28 <UARTEx_SetNbDataToProcess>
|
|
|
|
huart->gState = HAL_UART_STATE_READY;
|
|
8007ad0: 687b ldr r3, [r7, #4]
|
|
8007ad2: 2220 movs r2, #32
|
|
8007ad4: f8c3 2088 str.w r2, [r3, #136] @ 0x88
|
|
|
|
/* Process Unlocked */
|
|
__HAL_UNLOCK(huart);
|
|
8007ad8: 687b ldr r3, [r7, #4]
|
|
8007ada: 2200 movs r2, #0
|
|
8007adc: f883 2084 strb.w r2, [r3, #132] @ 0x84
|
|
|
|
return HAL_OK;
|
|
8007ae0: 2300 movs r3, #0
|
|
}
|
|
8007ae2: 4618 mov r0, r3
|
|
8007ae4: 3710 adds r7, #16
|
|
8007ae6: 46bd mov sp, r7
|
|
8007ae8: bd80 pop {r7, pc}
|
|
|
|
08007aea <HAL_UARTEx_SetTxFifoThreshold>:
|
|
* @arg @ref UART_TXFIFO_THRESHOLD_7_8
|
|
* @arg @ref UART_TXFIFO_THRESHOLD_8_8
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_UARTEx_SetTxFifoThreshold(UART_HandleTypeDef *huart, uint32_t Threshold)
|
|
{
|
|
8007aea: b580 push {r7, lr}
|
|
8007aec: b084 sub sp, #16
|
|
8007aee: af00 add r7, sp, #0
|
|
8007af0: 6078 str r0, [r7, #4]
|
|
8007af2: 6039 str r1, [r7, #0]
|
|
/* Check parameters */
|
|
assert_param(IS_UART_FIFO_INSTANCE(huart->Instance));
|
|
assert_param(IS_UART_TXFIFO_THRESHOLD(Threshold));
|
|
|
|
/* Process Locked */
|
|
__HAL_LOCK(huart);
|
|
8007af4: 687b ldr r3, [r7, #4]
|
|
8007af6: f893 3084 ldrb.w r3, [r3, #132] @ 0x84
|
|
8007afa: 2b01 cmp r3, #1
|
|
8007afc: d101 bne.n 8007b02 <HAL_UARTEx_SetTxFifoThreshold+0x18>
|
|
8007afe: 2302 movs r3, #2
|
|
8007b00: e02d b.n 8007b5e <HAL_UARTEx_SetTxFifoThreshold+0x74>
|
|
8007b02: 687b ldr r3, [r7, #4]
|
|
8007b04: 2201 movs r2, #1
|
|
8007b06: f883 2084 strb.w r2, [r3, #132] @ 0x84
|
|
|
|
huart->gState = HAL_UART_STATE_BUSY;
|
|
8007b0a: 687b ldr r3, [r7, #4]
|
|
8007b0c: 2224 movs r2, #36 @ 0x24
|
|
8007b0e: f8c3 2088 str.w r2, [r3, #136] @ 0x88
|
|
|
|
/* Save actual UART configuration */
|
|
tmpcr1 = READ_REG(huart->Instance->CR1);
|
|
8007b12: 687b ldr r3, [r7, #4]
|
|
8007b14: 681b ldr r3, [r3, #0]
|
|
8007b16: 681b ldr r3, [r3, #0]
|
|
8007b18: 60fb str r3, [r7, #12]
|
|
|
|
/* Disable UART */
|
|
__HAL_UART_DISABLE(huart);
|
|
8007b1a: 687b ldr r3, [r7, #4]
|
|
8007b1c: 681b ldr r3, [r3, #0]
|
|
8007b1e: 681a ldr r2, [r3, #0]
|
|
8007b20: 687b ldr r3, [r7, #4]
|
|
8007b22: 681b ldr r3, [r3, #0]
|
|
8007b24: f022 0201 bic.w r2, r2, #1
|
|
8007b28: 601a str r2, [r3, #0]
|
|
|
|
/* Update TX threshold configuration */
|
|
MODIFY_REG(huart->Instance->CR3, USART_CR3_TXFTCFG, Threshold);
|
|
8007b2a: 687b ldr r3, [r7, #4]
|
|
8007b2c: 681b ldr r3, [r3, #0]
|
|
8007b2e: 689b ldr r3, [r3, #8]
|
|
8007b30: f023 4160 bic.w r1, r3, #3758096384 @ 0xe0000000
|
|
8007b34: 687b ldr r3, [r7, #4]
|
|
8007b36: 681b ldr r3, [r3, #0]
|
|
8007b38: 683a ldr r2, [r7, #0]
|
|
8007b3a: 430a orrs r2, r1
|
|
8007b3c: 609a str r2, [r3, #8]
|
|
|
|
/* Determine the number of data to process during RX/TX ISR execution */
|
|
UARTEx_SetNbDataToProcess(huart);
|
|
8007b3e: 6878 ldr r0, [r7, #4]
|
|
8007b40: f000 f872 bl 8007c28 <UARTEx_SetNbDataToProcess>
|
|
|
|
/* Restore UART configuration */
|
|
WRITE_REG(huart->Instance->CR1, tmpcr1);
|
|
8007b44: 687b ldr r3, [r7, #4]
|
|
8007b46: 681b ldr r3, [r3, #0]
|
|
8007b48: 68fa ldr r2, [r7, #12]
|
|
8007b4a: 601a str r2, [r3, #0]
|
|
|
|
huart->gState = HAL_UART_STATE_READY;
|
|
8007b4c: 687b ldr r3, [r7, #4]
|
|
8007b4e: 2220 movs r2, #32
|
|
8007b50: f8c3 2088 str.w r2, [r3, #136] @ 0x88
|
|
|
|
/* Process Unlocked */
|
|
__HAL_UNLOCK(huart);
|
|
8007b54: 687b ldr r3, [r7, #4]
|
|
8007b56: 2200 movs r2, #0
|
|
8007b58: f883 2084 strb.w r2, [r3, #132] @ 0x84
|
|
|
|
return HAL_OK;
|
|
8007b5c: 2300 movs r3, #0
|
|
}
|
|
8007b5e: 4618 mov r0, r3
|
|
8007b60: 3710 adds r7, #16
|
|
8007b62: 46bd mov sp, r7
|
|
8007b64: bd80 pop {r7, pc}
|
|
|
|
08007b66 <HAL_UARTEx_SetRxFifoThreshold>:
|
|
* @arg @ref UART_RXFIFO_THRESHOLD_7_8
|
|
* @arg @ref UART_RXFIFO_THRESHOLD_8_8
|
|
* @retval HAL status
|
|
*/
|
|
HAL_StatusTypeDef HAL_UARTEx_SetRxFifoThreshold(UART_HandleTypeDef *huart, uint32_t Threshold)
|
|
{
|
|
8007b66: b580 push {r7, lr}
|
|
8007b68: b084 sub sp, #16
|
|
8007b6a: af00 add r7, sp, #0
|
|
8007b6c: 6078 str r0, [r7, #4]
|
|
8007b6e: 6039 str r1, [r7, #0]
|
|
/* Check the parameters */
|
|
assert_param(IS_UART_FIFO_INSTANCE(huart->Instance));
|
|
assert_param(IS_UART_RXFIFO_THRESHOLD(Threshold));
|
|
|
|
/* Process Locked */
|
|
__HAL_LOCK(huart);
|
|
8007b70: 687b ldr r3, [r7, #4]
|
|
8007b72: f893 3084 ldrb.w r3, [r3, #132] @ 0x84
|
|
8007b76: 2b01 cmp r3, #1
|
|
8007b78: d101 bne.n 8007b7e <HAL_UARTEx_SetRxFifoThreshold+0x18>
|
|
8007b7a: 2302 movs r3, #2
|
|
8007b7c: e02d b.n 8007bda <HAL_UARTEx_SetRxFifoThreshold+0x74>
|
|
8007b7e: 687b ldr r3, [r7, #4]
|
|
8007b80: 2201 movs r2, #1
|
|
8007b82: f883 2084 strb.w r2, [r3, #132] @ 0x84
|
|
|
|
huart->gState = HAL_UART_STATE_BUSY;
|
|
8007b86: 687b ldr r3, [r7, #4]
|
|
8007b88: 2224 movs r2, #36 @ 0x24
|
|
8007b8a: f8c3 2088 str.w r2, [r3, #136] @ 0x88
|
|
|
|
/* Save actual UART configuration */
|
|
tmpcr1 = READ_REG(huart->Instance->CR1);
|
|
8007b8e: 687b ldr r3, [r7, #4]
|
|
8007b90: 681b ldr r3, [r3, #0]
|
|
8007b92: 681b ldr r3, [r3, #0]
|
|
8007b94: 60fb str r3, [r7, #12]
|
|
|
|
/* Disable UART */
|
|
__HAL_UART_DISABLE(huart);
|
|
8007b96: 687b ldr r3, [r7, #4]
|
|
8007b98: 681b ldr r3, [r3, #0]
|
|
8007b9a: 681a ldr r2, [r3, #0]
|
|
8007b9c: 687b ldr r3, [r7, #4]
|
|
8007b9e: 681b ldr r3, [r3, #0]
|
|
8007ba0: f022 0201 bic.w r2, r2, #1
|
|
8007ba4: 601a str r2, [r3, #0]
|
|
|
|
/* Update RX threshold configuration */
|
|
MODIFY_REG(huart->Instance->CR3, USART_CR3_RXFTCFG, Threshold);
|
|
8007ba6: 687b ldr r3, [r7, #4]
|
|
8007ba8: 681b ldr r3, [r3, #0]
|
|
8007baa: 689b ldr r3, [r3, #8]
|
|
8007bac: f023 6160 bic.w r1, r3, #234881024 @ 0xe000000
|
|
8007bb0: 687b ldr r3, [r7, #4]
|
|
8007bb2: 681b ldr r3, [r3, #0]
|
|
8007bb4: 683a ldr r2, [r7, #0]
|
|
8007bb6: 430a orrs r2, r1
|
|
8007bb8: 609a str r2, [r3, #8]
|
|
|
|
/* Determine the number of data to process during RX/TX ISR execution */
|
|
UARTEx_SetNbDataToProcess(huart);
|
|
8007bba: 6878 ldr r0, [r7, #4]
|
|
8007bbc: f000 f834 bl 8007c28 <UARTEx_SetNbDataToProcess>
|
|
|
|
/* Restore UART configuration */
|
|
WRITE_REG(huart->Instance->CR1, tmpcr1);
|
|
8007bc0: 687b ldr r3, [r7, #4]
|
|
8007bc2: 681b ldr r3, [r3, #0]
|
|
8007bc4: 68fa ldr r2, [r7, #12]
|
|
8007bc6: 601a str r2, [r3, #0]
|
|
|
|
huart->gState = HAL_UART_STATE_READY;
|
|
8007bc8: 687b ldr r3, [r7, #4]
|
|
8007bca: 2220 movs r2, #32
|
|
8007bcc: f8c3 2088 str.w r2, [r3, #136] @ 0x88
|
|
|
|
/* Process Unlocked */
|
|
__HAL_UNLOCK(huart);
|
|
8007bd0: 687b ldr r3, [r7, #4]
|
|
8007bd2: 2200 movs r2, #0
|
|
8007bd4: f883 2084 strb.w r2, [r3, #132] @ 0x84
|
|
|
|
return HAL_OK;
|
|
8007bd8: 2300 movs r3, #0
|
|
}
|
|
8007bda: 4618 mov r0, r3
|
|
8007bdc: 3710 adds r7, #16
|
|
8007bde: 46bd mov sp, r7
|
|
8007be0: bd80 pop {r7, pc}
|
|
|
|
08007be2 <UARTEx_Wakeup_AddressConfig>:
|
|
* @param huart UART handle.
|
|
* @param WakeUpSelection UART wake up from stop mode parameters.
|
|
* @retval None
|
|
*/
|
|
static void UARTEx_Wakeup_AddressConfig(UART_HandleTypeDef *huart, UART_WakeUpTypeDef WakeUpSelection)
|
|
{
|
|
8007be2: b480 push {r7}
|
|
8007be4: b085 sub sp, #20
|
|
8007be6: af00 add r7, sp, #0
|
|
8007be8: 60f8 str r0, [r7, #12]
|
|
8007bea: 1d3b adds r3, r7, #4
|
|
8007bec: e883 0006 stmia.w r3, {r1, r2}
|
|
assert_param(IS_UART_ADDRESSLENGTH_DETECT(WakeUpSelection.AddressLength));
|
|
|
|
/* Set the USART address length */
|
|
MODIFY_REG(huart->Instance->CR2, USART_CR2_ADDM7, WakeUpSelection.AddressLength);
|
|
8007bf0: 68fb ldr r3, [r7, #12]
|
|
8007bf2: 681b ldr r3, [r3, #0]
|
|
8007bf4: 685b ldr r3, [r3, #4]
|
|
8007bf6: f023 0210 bic.w r2, r3, #16
|
|
8007bfa: 893b ldrh r3, [r7, #8]
|
|
8007bfc: 4619 mov r1, r3
|
|
8007bfe: 68fb ldr r3, [r7, #12]
|
|
8007c00: 681b ldr r3, [r3, #0]
|
|
8007c02: 430a orrs r2, r1
|
|
8007c04: 605a str r2, [r3, #4]
|
|
|
|
/* Set the USART address node */
|
|
MODIFY_REG(huart->Instance->CR2, USART_CR2_ADD, ((uint32_t)WakeUpSelection.Address << UART_CR2_ADDRESS_LSB_POS));
|
|
8007c06: 68fb ldr r3, [r7, #12]
|
|
8007c08: 681b ldr r3, [r3, #0]
|
|
8007c0a: 685b ldr r3, [r3, #4]
|
|
8007c0c: f023 417f bic.w r1, r3, #4278190080 @ 0xff000000
|
|
8007c10: 7abb ldrb r3, [r7, #10]
|
|
8007c12: 061a lsls r2, r3, #24
|
|
8007c14: 68fb ldr r3, [r7, #12]
|
|
8007c16: 681b ldr r3, [r3, #0]
|
|
8007c18: 430a orrs r2, r1
|
|
8007c1a: 605a str r2, [r3, #4]
|
|
}
|
|
8007c1c: bf00 nop
|
|
8007c1e: 3714 adds r7, #20
|
|
8007c20: 46bd mov sp, r7
|
|
8007c22: bc80 pop {r7}
|
|
8007c24: 4770 bx lr
|
|
...
|
|
|
|
08007c28 <UARTEx_SetNbDataToProcess>:
|
|
* the UART configuration registers.
|
|
* @param huart UART handle.
|
|
* @retval None
|
|
*/
|
|
static void UARTEx_SetNbDataToProcess(UART_HandleTypeDef *huart)
|
|
{
|
|
8007c28: b480 push {r7}
|
|
8007c2a: b085 sub sp, #20
|
|
8007c2c: af00 add r7, sp, #0
|
|
8007c2e: 6078 str r0, [r7, #4]
|
|
uint8_t rx_fifo_threshold;
|
|
uint8_t tx_fifo_threshold;
|
|
static const uint8_t numerator[] = {1U, 1U, 1U, 3U, 7U, 1U, 0U, 0U};
|
|
static const uint8_t denominator[] = {8U, 4U, 2U, 4U, 8U, 1U, 1U, 1U};
|
|
|
|
if (huart->FifoMode == UART_FIFOMODE_DISABLE)
|
|
8007c30: 687b ldr r3, [r7, #4]
|
|
8007c32: 6e5b ldr r3, [r3, #100] @ 0x64
|
|
8007c34: 2b00 cmp r3, #0
|
|
8007c36: d108 bne.n 8007c4a <UARTEx_SetNbDataToProcess+0x22>
|
|
{
|
|
huart->NbTxDataToProcess = 1U;
|
|
8007c38: 687b ldr r3, [r7, #4]
|
|
8007c3a: 2201 movs r2, #1
|
|
8007c3c: f8a3 206a strh.w r2, [r3, #106] @ 0x6a
|
|
huart->NbRxDataToProcess = 1U;
|
|
8007c40: 687b ldr r3, [r7, #4]
|
|
8007c42: 2201 movs r2, #1
|
|
8007c44: f8a3 2068 strh.w r2, [r3, #104] @ 0x68
|
|
huart->NbTxDataToProcess = ((uint16_t)tx_fifo_depth * numerator[tx_fifo_threshold]) /
|
|
(uint16_t)denominator[tx_fifo_threshold];
|
|
huart->NbRxDataToProcess = ((uint16_t)rx_fifo_depth * numerator[rx_fifo_threshold]) /
|
|
(uint16_t)denominator[rx_fifo_threshold];
|
|
}
|
|
}
|
|
8007c48: e031 b.n 8007cae <UARTEx_SetNbDataToProcess+0x86>
|
|
rx_fifo_depth = RX_FIFO_DEPTH;
|
|
8007c4a: 2308 movs r3, #8
|
|
8007c4c: 73fb strb r3, [r7, #15]
|
|
tx_fifo_depth = TX_FIFO_DEPTH;
|
|
8007c4e: 2308 movs r3, #8
|
|
8007c50: 73bb strb r3, [r7, #14]
|
|
rx_fifo_threshold = (uint8_t)(READ_BIT(huart->Instance->CR3, USART_CR3_RXFTCFG) >> USART_CR3_RXFTCFG_Pos);
|
|
8007c52: 687b ldr r3, [r7, #4]
|
|
8007c54: 681b ldr r3, [r3, #0]
|
|
8007c56: 689b ldr r3, [r3, #8]
|
|
8007c58: 0e5b lsrs r3, r3, #25
|
|
8007c5a: b2db uxtb r3, r3
|
|
8007c5c: f003 0307 and.w r3, r3, #7
|
|
8007c60: 737b strb r3, [r7, #13]
|
|
tx_fifo_threshold = (uint8_t)(READ_BIT(huart->Instance->CR3, USART_CR3_TXFTCFG) >> USART_CR3_TXFTCFG_Pos);
|
|
8007c62: 687b ldr r3, [r7, #4]
|
|
8007c64: 681b ldr r3, [r3, #0]
|
|
8007c66: 689b ldr r3, [r3, #8]
|
|
8007c68: 0f5b lsrs r3, r3, #29
|
|
8007c6a: b2db uxtb r3, r3
|
|
8007c6c: f003 0307 and.w r3, r3, #7
|
|
8007c70: 733b strb r3, [r7, #12]
|
|
huart->NbTxDataToProcess = ((uint16_t)tx_fifo_depth * numerator[tx_fifo_threshold]) /
|
|
8007c72: 7bbb ldrb r3, [r7, #14]
|
|
8007c74: 7b3a ldrb r2, [r7, #12]
|
|
8007c76: 4910 ldr r1, [pc, #64] @ (8007cb8 <UARTEx_SetNbDataToProcess+0x90>)
|
|
8007c78: 5c8a ldrb r2, [r1, r2]
|
|
8007c7a: fb02 f303 mul.w r3, r2, r3
|
|
(uint16_t)denominator[tx_fifo_threshold];
|
|
8007c7e: 7b3a ldrb r2, [r7, #12]
|
|
8007c80: 490e ldr r1, [pc, #56] @ (8007cbc <UARTEx_SetNbDataToProcess+0x94>)
|
|
8007c82: 5c8a ldrb r2, [r1, r2]
|
|
huart->NbTxDataToProcess = ((uint16_t)tx_fifo_depth * numerator[tx_fifo_threshold]) /
|
|
8007c84: fb93 f3f2 sdiv r3, r3, r2
|
|
8007c88: b29a uxth r2, r3
|
|
8007c8a: 687b ldr r3, [r7, #4]
|
|
8007c8c: f8a3 206a strh.w r2, [r3, #106] @ 0x6a
|
|
huart->NbRxDataToProcess = ((uint16_t)rx_fifo_depth * numerator[rx_fifo_threshold]) /
|
|
8007c90: 7bfb ldrb r3, [r7, #15]
|
|
8007c92: 7b7a ldrb r2, [r7, #13]
|
|
8007c94: 4908 ldr r1, [pc, #32] @ (8007cb8 <UARTEx_SetNbDataToProcess+0x90>)
|
|
8007c96: 5c8a ldrb r2, [r1, r2]
|
|
8007c98: fb02 f303 mul.w r3, r2, r3
|
|
(uint16_t)denominator[rx_fifo_threshold];
|
|
8007c9c: 7b7a ldrb r2, [r7, #13]
|
|
8007c9e: 4907 ldr r1, [pc, #28] @ (8007cbc <UARTEx_SetNbDataToProcess+0x94>)
|
|
8007ca0: 5c8a ldrb r2, [r1, r2]
|
|
huart->NbRxDataToProcess = ((uint16_t)rx_fifo_depth * numerator[rx_fifo_threshold]) /
|
|
8007ca2: fb93 f3f2 sdiv r3, r3, r2
|
|
8007ca6: b29a uxth r2, r3
|
|
8007ca8: 687b ldr r3, [r7, #4]
|
|
8007caa: f8a3 2068 strh.w r2, [r3, #104] @ 0x68
|
|
}
|
|
8007cae: bf00 nop
|
|
8007cb0: 3714 adds r7, #20
|
|
8007cb2: 46bd mov sp, r7
|
|
8007cb4: bc80 pop {r7}
|
|
8007cb6: 4770 bx lr
|
|
8007cb8: 080103b4 .word 0x080103b4
|
|
8007cbc: 080103bc .word 0x080103bc
|
|
|
|
08007cc0 <LL_GPIO_SetOutputPin>:
|
|
* @arg @ref LL_GPIO_PIN_15
|
|
* @arg @ref LL_GPIO_PIN_ALL
|
|
* @retval None
|
|
*/
|
|
__STATIC_INLINE void LL_GPIO_SetOutputPin(GPIO_TypeDef *GPIOx, uint32_t PinMask)
|
|
{
|
|
8007cc0: b480 push {r7}
|
|
8007cc2: b083 sub sp, #12
|
|
8007cc4: af00 add r7, sp, #0
|
|
8007cc6: 6078 str r0, [r7, #4]
|
|
8007cc8: 6039 str r1, [r7, #0]
|
|
WRITE_REG(GPIOx->BSRR, PinMask);
|
|
8007cca: 687b ldr r3, [r7, #4]
|
|
8007ccc: 683a ldr r2, [r7, #0]
|
|
8007cce: 619a str r2, [r3, #24]
|
|
}
|
|
8007cd0: bf00 nop
|
|
8007cd2: 370c adds r7, #12
|
|
8007cd4: 46bd mov sp, r7
|
|
8007cd6: bc80 pop {r7}
|
|
8007cd8: 4770 bx lr
|
|
|
|
08007cda <LL_GPIO_ResetOutputPin>:
|
|
* @arg @ref LL_GPIO_PIN_15
|
|
* @arg @ref LL_GPIO_PIN_ALL
|
|
* @retval None
|
|
*/
|
|
__STATIC_INLINE void LL_GPIO_ResetOutputPin(GPIO_TypeDef *GPIOx, uint32_t PinMask)
|
|
{
|
|
8007cda: b480 push {r7}
|
|
8007cdc: b083 sub sp, #12
|
|
8007cde: af00 add r7, sp, #0
|
|
8007ce0: 6078 str r0, [r7, #4]
|
|
8007ce2: 6039 str r1, [r7, #0]
|
|
WRITE_REG(GPIOx->BRR, PinMask);
|
|
8007ce4: 687b ldr r3, [r7, #4]
|
|
8007ce6: 683a ldr r2, [r7, #0]
|
|
8007ce8: 629a str r2, [r3, #40] @ 0x28
|
|
}
|
|
8007cea: bf00 nop
|
|
8007cec: 370c adds r7, #12
|
|
8007cee: 46bd mov sp, r7
|
|
8007cf0: bc80 pop {r7}
|
|
8007cf2: 4770 bx lr
|
|
|
|
08007cf4 <RadioInit>:
|
|
TimerEvent_t RxTimeoutTimer;
|
|
|
|
/* Private functions ---------------------------------------------------------*/
|
|
|
|
static void RadioInit( RadioEvents_t *events )
|
|
{
|
|
8007cf4: b580 push {r7, lr}
|
|
8007cf6: b084 sub sp, #16
|
|
8007cf8: af02 add r7, sp, #8
|
|
8007cfa: 6078 str r0, [r7, #4]
|
|
RadioEvents = events;
|
|
8007cfc: 4a24 ldr r2, [pc, #144] @ (8007d90 <RadioInit+0x9c>)
|
|
8007cfe: 687b ldr r3, [r7, #4]
|
|
8007d00: 6013 str r3, [r2, #0]
|
|
|
|
SubgRf.RxContinuous = false;
|
|
8007d02: 4b24 ldr r3, [pc, #144] @ (8007d94 <RadioInit+0xa0>)
|
|
8007d04: 2200 movs r2, #0
|
|
8007d06: 705a strb r2, [r3, #1]
|
|
SubgRf.TxTimeout = 0;
|
|
8007d08: 4b22 ldr r3, [pc, #136] @ (8007d94 <RadioInit+0xa0>)
|
|
8007d0a: 2200 movs r2, #0
|
|
8007d0c: 605a str r2, [r3, #4]
|
|
SubgRf.RxTimeout = 0;
|
|
8007d0e: 4b21 ldr r3, [pc, #132] @ (8007d94 <RadioInit+0xa0>)
|
|
8007d10: 2200 movs r2, #0
|
|
8007d12: 609a str r2, [r3, #8]
|
|
/*See STM32WL Errata: RadioSetRxDutyCycle*/
|
|
SubgRf.RxDcPreambleDetectTimeout = 0;
|
|
8007d14: 4b1f ldr r3, [pc, #124] @ (8007d94 <RadioInit+0xa0>)
|
|
8007d16: 2200 movs r2, #0
|
|
8007d18: 659a str r2, [r3, #88] @ 0x58
|
|
#if( RADIO_LR_FHSS_IS_ON == 1 )
|
|
SubgRf.lr_fhss.is_lr_fhss_on = false;
|
|
#endif /* RADIO_LR_FHSS_IS_ON == 1 */
|
|
SUBGRF_Init( RadioOnDioIrq );
|
|
8007d1a: 481f ldr r0, [pc, #124] @ (8007d98 <RadioInit+0xa4>)
|
|
8007d1c: f001 fffa bl 8009d14 <SUBGRF_Init>
|
|
/*SubgRf.publicNetwork set to false*/
|
|
SubgRf.PublicNetwork.Current = false;
|
|
8007d20: 4b1c ldr r3, [pc, #112] @ (8007d94 <RadioInit+0xa0>)
|
|
8007d22: 2200 movs r2, #0
|
|
8007d24: 735a strb r2, [r3, #13]
|
|
SubgRf.PublicNetwork.Previous = false;
|
|
8007d26: 4b1b ldr r3, [pc, #108] @ (8007d94 <RadioInit+0xa0>)
|
|
8007d28: 2200 movs r2, #0
|
|
8007d2a: 731a strb r2, [r3, #12]
|
|
|
|
RADIO_IRQ_PROCESS_INIT();
|
|
|
|
SUBGRF_SetRegulatorMode( );
|
|
8007d2c: f002 fa90 bl 800a250 <SUBGRF_SetRegulatorMode>
|
|
|
|
SUBGRF_SetBufferBaseAddress( 0x00, 0x00 );
|
|
8007d30: 2100 movs r1, #0
|
|
8007d32: 2000 movs r0, #0
|
|
8007d34: f002 fe5c bl 800a9f0 <SUBGRF_SetBufferBaseAddress>
|
|
SUBGRF_SetTxParams( RFO_LP, 0, RADIO_RAMP_200_US );
|
|
8007d38: 2204 movs r2, #4
|
|
8007d3a: 2100 movs r1, #0
|
|
8007d3c: 2001 movs r0, #1
|
|
8007d3e: f002 fc1f bl 800a580 <SUBGRF_SetTxParams>
|
|
SUBGRF_SetDioIrqParams( IRQ_RADIO_ALL, IRQ_RADIO_ALL, IRQ_RADIO_NONE, IRQ_RADIO_NONE );
|
|
8007d42: 2300 movs r3, #0
|
|
8007d44: 2200 movs r2, #0
|
|
8007d46: f64f 71ff movw r1, #65535 @ 0xffff
|
|
8007d4a: f64f 70ff movw r0, #65535 @ 0xffff
|
|
8007d4e: f002 fb4f bl 800a3f0 <SUBGRF_SetDioIrqParams>
|
|
|
|
RadioSleep();
|
|
8007d52: f000 fe9f bl 8008a94 <RadioSleep>
|
|
// Initialize driver timeout timers
|
|
TimerInit( &TxTimeoutTimer, RadioOnTxTimeoutIrq );
|
|
8007d56: 2300 movs r3, #0
|
|
8007d58: 9300 str r3, [sp, #0]
|
|
8007d5a: 4b10 ldr r3, [pc, #64] @ (8007d9c <RadioInit+0xa8>)
|
|
8007d5c: 2200 movs r2, #0
|
|
8007d5e: f04f 31ff mov.w r1, #4294967295 @ 0xffffffff
|
|
8007d62: 480f ldr r0, [pc, #60] @ (8007da0 <RadioInit+0xac>)
|
|
8007d64: f006 faa6 bl 800e2b4 <UTIL_TIMER_Create>
|
|
TimerInit( &RxTimeoutTimer, RadioOnRxTimeoutIrq );
|
|
8007d68: 2300 movs r3, #0
|
|
8007d6a: 9300 str r3, [sp, #0]
|
|
8007d6c: 4b0d ldr r3, [pc, #52] @ (8007da4 <RadioInit+0xb0>)
|
|
8007d6e: 2200 movs r2, #0
|
|
8007d70: f04f 31ff mov.w r1, #4294967295 @ 0xffffffff
|
|
8007d74: 480c ldr r0, [pc, #48] @ (8007da8 <RadioInit+0xb4>)
|
|
8007d76: f006 fa9d bl 800e2b4 <UTIL_TIMER_Create>
|
|
TimerStop( &TxTimeoutTimer );
|
|
8007d7a: 4809 ldr r0, [pc, #36] @ (8007da0 <RadioInit+0xac>)
|
|
8007d7c: f006 fb3e bl 800e3fc <UTIL_TIMER_Stop>
|
|
TimerStop( &RxTimeoutTimer );
|
|
8007d80: 4809 ldr r0, [pc, #36] @ (8007da8 <RadioInit+0xb4>)
|
|
8007d82: f006 fb3b bl 800e3fc <UTIL_TIMER_Stop>
|
|
}
|
|
8007d86: bf00 nop
|
|
8007d88: 3708 adds r7, #8
|
|
8007d8a: 46bd mov sp, r7
|
|
8007d8c: bd80 pop {r7, pc}
|
|
8007d8e: bf00 nop
|
|
8007d90: 200002f4 .word 0x200002f4
|
|
8007d94: 200002f8 .word 0x200002f8
|
|
8007d98: 08008eb9 .word 0x08008eb9
|
|
8007d9c: 08008e29 .word 0x08008e29
|
|
8007da0: 20000354 .word 0x20000354
|
|
8007da4: 08008e3d .word 0x08008e3d
|
|
8007da8: 2000036c .word 0x2000036c
|
|
|
|
08007dac <RadioGetStatus>:
|
|
|
|
static RadioState_t RadioGetStatus( void )
|
|
{
|
|
8007dac: b580 push {r7, lr}
|
|
8007dae: af00 add r7, sp, #0
|
|
switch( SUBGRF_GetOperatingMode( ) )
|
|
8007db0: f001 fff8 bl 8009da4 <SUBGRF_GetOperatingMode>
|
|
8007db4: 4603 mov r3, r0
|
|
8007db6: 2b07 cmp r3, #7
|
|
8007db8: d00a beq.n 8007dd0 <RadioGetStatus+0x24>
|
|
8007dba: 2b07 cmp r3, #7
|
|
8007dbc: dc0a bgt.n 8007dd4 <RadioGetStatus+0x28>
|
|
8007dbe: 2b04 cmp r3, #4
|
|
8007dc0: d002 beq.n 8007dc8 <RadioGetStatus+0x1c>
|
|
8007dc2: 2b05 cmp r3, #5
|
|
8007dc4: d002 beq.n 8007dcc <RadioGetStatus+0x20>
|
|
8007dc6: e005 b.n 8007dd4 <RadioGetStatus+0x28>
|
|
{
|
|
case MODE_TX:
|
|
return RF_TX_RUNNING;
|
|
8007dc8: 2302 movs r3, #2
|
|
8007dca: e004 b.n 8007dd6 <RadioGetStatus+0x2a>
|
|
case MODE_RX:
|
|
return RF_RX_RUNNING;
|
|
8007dcc: 2301 movs r3, #1
|
|
8007dce: e002 b.n 8007dd6 <RadioGetStatus+0x2a>
|
|
case MODE_CAD:
|
|
return RF_CAD;
|
|
8007dd0: 2303 movs r3, #3
|
|
8007dd2: e000 b.n 8007dd6 <RadioGetStatus+0x2a>
|
|
default:
|
|
return RF_IDLE;
|
|
8007dd4: 2300 movs r3, #0
|
|
}
|
|
}
|
|
8007dd6: 4618 mov r0, r3
|
|
8007dd8: bd80 pop {r7, pc}
|
|
...
|
|
|
|
08007ddc <RadioSetModem>:
|
|
|
|
static void RadioSetModem( RadioModems_t modem )
|
|
{
|
|
8007ddc: b580 push {r7, lr}
|
|
8007dde: b082 sub sp, #8
|
|
8007de0: af00 add r7, sp, #0
|
|
8007de2: 4603 mov r3, r0
|
|
8007de4: 71fb strb r3, [r7, #7]
|
|
SubgRf.Modem = modem;
|
|
8007de6: 4a2a ldr r2, [pc, #168] @ (8007e90 <RadioSetModem+0xb4>)
|
|
8007de8: 79fb ldrb r3, [r7, #7]
|
|
8007dea: 7013 strb r3, [r2, #0]
|
|
RFW_SetRadioModem( modem );
|
|
8007dec: 79fb ldrb r3, [r7, #7]
|
|
8007dee: 4618 mov r0, r3
|
|
8007df0: f003 fd82 bl 800b8f8 <RFW_SetRadioModem>
|
|
switch( modem )
|
|
8007df4: 79fb ldrb r3, [r7, #7]
|
|
8007df6: 2b05 cmp r3, #5
|
|
8007df8: d80e bhi.n 8007e18 <RadioSetModem+0x3c>
|
|
8007dfa: a201 add r2, pc, #4 @ (adr r2, 8007e00 <RadioSetModem+0x24>)
|
|
8007dfc: f852 f023 ldr.w pc, [r2, r3, lsl #2]
|
|
8007e00: 08007e27 .word 0x08007e27
|
|
8007e04: 08007e35 .word 0x08007e35
|
|
8007e08: 08007e19 .word 0x08007e19
|
|
8007e0c: 08007e5b .word 0x08007e5b
|
|
8007e10: 08007e69 .word 0x08007e69
|
|
8007e14: 08007e77 .word 0x08007e77
|
|
{
|
|
default:
|
|
case MODEM_MSK:
|
|
SUBGRF_SetPacketType( PACKET_TYPE_GMSK );
|
|
8007e18: 2003 movs r0, #3
|
|
8007e1a: f002 fb8b bl 800a534 <SUBGRF_SetPacketType>
|
|
// When switching to GFSK mode the LoRa SyncWord register value is reset
|
|
// Thus, we also reset the RadioPublicNetwork variable
|
|
SubgRf.PublicNetwork.Current = false;
|
|
8007e1e: 4b1c ldr r3, [pc, #112] @ (8007e90 <RadioSetModem+0xb4>)
|
|
8007e20: 2200 movs r2, #0
|
|
8007e22: 735a strb r2, [r3, #13]
|
|
break;
|
|
8007e24: e02f b.n 8007e86 <RadioSetModem+0xaa>
|
|
case MODEM_FSK:
|
|
SUBGRF_SetPacketType( PACKET_TYPE_GFSK );
|
|
8007e26: 2000 movs r0, #0
|
|
8007e28: f002 fb84 bl 800a534 <SUBGRF_SetPacketType>
|
|
// When switching to GFSK mode the LoRa SyncWord register value is reset
|
|
// Thus, we also reset the RadioPublicNetwork variable
|
|
SubgRf.PublicNetwork.Current = false;
|
|
8007e2c: 4b18 ldr r3, [pc, #96] @ (8007e90 <RadioSetModem+0xb4>)
|
|
8007e2e: 2200 movs r2, #0
|
|
8007e30: 735a strb r2, [r3, #13]
|
|
break;
|
|
8007e32: e028 b.n 8007e86 <RadioSetModem+0xaa>
|
|
case MODEM_LORA:
|
|
SUBGRF_SetPacketType( PACKET_TYPE_LORA );
|
|
8007e34: 2001 movs r0, #1
|
|
8007e36: f002 fb7d bl 800a534 <SUBGRF_SetPacketType>
|
|
// Public/Private network register is reset when switching modems
|
|
if( SubgRf.PublicNetwork.Current != SubgRf.PublicNetwork.Previous )
|
|
8007e3a: 4b15 ldr r3, [pc, #84] @ (8007e90 <RadioSetModem+0xb4>)
|
|
8007e3c: 7b5a ldrb r2, [r3, #13]
|
|
8007e3e: 4b14 ldr r3, [pc, #80] @ (8007e90 <RadioSetModem+0xb4>)
|
|
8007e40: 7b1b ldrb r3, [r3, #12]
|
|
8007e42: 429a cmp r2, r3
|
|
8007e44: d01e beq.n 8007e84 <RadioSetModem+0xa8>
|
|
{
|
|
SubgRf.PublicNetwork.Current = SubgRf.PublicNetwork.Previous;
|
|
8007e46: 4b12 ldr r3, [pc, #72] @ (8007e90 <RadioSetModem+0xb4>)
|
|
8007e48: 7b1a ldrb r2, [r3, #12]
|
|
8007e4a: 4b11 ldr r3, [pc, #68] @ (8007e90 <RadioSetModem+0xb4>)
|
|
8007e4c: 735a strb r2, [r3, #13]
|
|
RadioSetPublicNetwork( SubgRf.PublicNetwork.Current );
|
|
8007e4e: 4b10 ldr r3, [pc, #64] @ (8007e90 <RadioSetModem+0xb4>)
|
|
8007e50: 7b5b ldrb r3, [r3, #13]
|
|
8007e52: 4618 mov r0, r3
|
|
8007e54: f000 ffb2 bl 8008dbc <RadioSetPublicNetwork>
|
|
}
|
|
break;
|
|
8007e58: e014 b.n 8007e84 <RadioSetModem+0xa8>
|
|
case MODEM_BPSK:
|
|
SUBGRF_SetPacketType( PACKET_TYPE_BPSK );
|
|
8007e5a: 2002 movs r0, #2
|
|
8007e5c: f002 fb6a bl 800a534 <SUBGRF_SetPacketType>
|
|
// When switching to BPSK mode the LoRa SyncWord register value is reset
|
|
// Thus, we also reset the RadioPublicNetwork variable
|
|
SubgRf.PublicNetwork.Current = false;
|
|
8007e60: 4b0b ldr r3, [pc, #44] @ (8007e90 <RadioSetModem+0xb4>)
|
|
8007e62: 2200 movs r2, #0
|
|
8007e64: 735a strb r2, [r3, #13]
|
|
break;
|
|
8007e66: e00e b.n 8007e86 <RadioSetModem+0xaa>
|
|
#if (RADIO_SIGFOX_ENABLE == 1)
|
|
case MODEM_SIGFOX_TX:
|
|
SUBGRF_SetPacketType( PACKET_TYPE_BPSK );
|
|
8007e68: 2002 movs r0, #2
|
|
8007e6a: f002 fb63 bl 800a534 <SUBGRF_SetPacketType>
|
|
// When switching to BPSK mode the LoRa SyncWord register value is reset
|
|
// Thus, we also reset the RadioPublicNetwork variable
|
|
SubgRf.PublicNetwork.Current = false;
|
|
8007e6e: 4b08 ldr r3, [pc, #32] @ (8007e90 <RadioSetModem+0xb4>)
|
|
8007e70: 2200 movs r2, #0
|
|
8007e72: 735a strb r2, [r3, #13]
|
|
break;
|
|
8007e74: e007 b.n 8007e86 <RadioSetModem+0xaa>
|
|
case MODEM_SIGFOX_RX:
|
|
SUBGRF_SetPacketType( PACKET_TYPE_GFSK );
|
|
8007e76: 2000 movs r0, #0
|
|
8007e78: f002 fb5c bl 800a534 <SUBGRF_SetPacketType>
|
|
// When switching to GFSK mode the LoRa SyncWord register value is reset
|
|
// Thus, we also reset the RadioPublicNetwork variable
|
|
SubgRf.PublicNetwork.Current = false;
|
|
8007e7c: 4b04 ldr r3, [pc, #16] @ (8007e90 <RadioSetModem+0xb4>)
|
|
8007e7e: 2200 movs r2, #0
|
|
8007e80: 735a strb r2, [r3, #13]
|
|
break;
|
|
8007e82: e000 b.n 8007e86 <RadioSetModem+0xaa>
|
|
break;
|
|
8007e84: bf00 nop
|
|
#endif /*RADIO_SIGFOX_ENABLE == 1*/
|
|
}
|
|
}
|
|
8007e86: bf00 nop
|
|
8007e88: 3708 adds r7, #8
|
|
8007e8a: 46bd mov sp, r7
|
|
8007e8c: bd80 pop {r7, pc}
|
|
8007e8e: bf00 nop
|
|
8007e90: 200002f8 .word 0x200002f8
|
|
|
|
08007e94 <RadioSetChannel>:
|
|
|
|
static void RadioSetChannel( uint32_t freq )
|
|
{
|
|
8007e94: b580 push {r7, lr}
|
|
8007e96: b082 sub sp, #8
|
|
8007e98: af00 add r7, sp, #0
|
|
8007e9a: 6078 str r0, [r7, #4]
|
|
SUBGRF_SetRfFrequency( freq );
|
|
8007e9c: 6878 ldr r0, [r7, #4]
|
|
8007e9e: f002 fb03 bl 800a4a8 <SUBGRF_SetRfFrequency>
|
|
}
|
|
8007ea2: bf00 nop
|
|
8007ea4: 3708 adds r7, #8
|
|
8007ea6: 46bd mov sp, r7
|
|
8007ea8: bd80 pop {r7, pc}
|
|
|
|
08007eaa <RadioIsChannelFree>:
|
|
|
|
static bool RadioIsChannelFree( uint32_t freq, uint32_t rxBandwidth, int16_t rssiThresh, uint32_t maxCarrierSenseTime )
|
|
{
|
|
8007eaa: b580 push {r7, lr}
|
|
8007eac: b090 sub sp, #64 @ 0x40
|
|
8007eae: af0a add r7, sp, #40 @ 0x28
|
|
8007eb0: 60f8 str r0, [r7, #12]
|
|
8007eb2: 60b9 str r1, [r7, #8]
|
|
8007eb4: 603b str r3, [r7, #0]
|
|
8007eb6: 4613 mov r3, r2
|
|
8007eb8: 80fb strh r3, [r7, #6]
|
|
bool status = true;
|
|
8007eba: 2301 movs r3, #1
|
|
8007ebc: 75fb strb r3, [r7, #23]
|
|
int16_t rssi = 0;
|
|
8007ebe: 2300 movs r3, #0
|
|
8007ec0: 82bb strh r3, [r7, #20]
|
|
uint32_t carrierSenseTime = 0;
|
|
8007ec2: 2300 movs r3, #0
|
|
8007ec4: 613b str r3, [r7, #16]
|
|
|
|
RadioStandby( );
|
|
8007ec6: f000 fdf8 bl 8008aba <RadioStandby>
|
|
|
|
RadioSetModem( MODEM_FSK );
|
|
8007eca: 2000 movs r0, #0
|
|
8007ecc: f7ff ff86 bl 8007ddc <RadioSetModem>
|
|
|
|
RadioSetChannel( freq );
|
|
8007ed0: 68f8 ldr r0, [r7, #12]
|
|
8007ed2: f7ff ffdf bl 8007e94 <RadioSetChannel>
|
|
|
|
// Set Rx bandwidth. Other parameters are not used.
|
|
RadioSetRxConfig( MODEM_FSK, rxBandwidth, 600, 0, rxBandwidth, 3, 0, false,
|
|
8007ed6: 2301 movs r3, #1
|
|
8007ed8: 9309 str r3, [sp, #36] @ 0x24
|
|
8007eda: 2300 movs r3, #0
|
|
8007edc: 9308 str r3, [sp, #32]
|
|
8007ede: 2300 movs r3, #0
|
|
8007ee0: 9307 str r3, [sp, #28]
|
|
8007ee2: 2300 movs r3, #0
|
|
8007ee4: 9306 str r3, [sp, #24]
|
|
8007ee6: 2300 movs r3, #0
|
|
8007ee8: 9305 str r3, [sp, #20]
|
|
8007eea: 2300 movs r3, #0
|
|
8007eec: 9304 str r3, [sp, #16]
|
|
8007eee: 2300 movs r3, #0
|
|
8007ef0: 9303 str r3, [sp, #12]
|
|
8007ef2: 2300 movs r3, #0
|
|
8007ef4: 9302 str r3, [sp, #8]
|
|
8007ef6: 2303 movs r3, #3
|
|
8007ef8: 9301 str r3, [sp, #4]
|
|
8007efa: 68bb ldr r3, [r7, #8]
|
|
8007efc: 9300 str r3, [sp, #0]
|
|
8007efe: 2300 movs r3, #0
|
|
8007f00: f44f 7216 mov.w r2, #600 @ 0x258
|
|
8007f04: 68b9 ldr r1, [r7, #8]
|
|
8007f06: 2000 movs r0, #0
|
|
8007f08: f000 f83c bl 8007f84 <RadioSetRxConfig>
|
|
0, false, 0, 0, false, true );
|
|
RadioRx( 0 );
|
|
8007f0c: 2000 movs r0, #0
|
|
8007f0e: f000 fddb bl 8008ac8 <RadioRx>
|
|
|
|
RADIO_DELAY_MS( RadioGetWakeupTime( ) );
|
|
8007f12: f000 ff81 bl 8008e18 <RadioGetWakeupTime>
|
|
8007f16: 4603 mov r3, r0
|
|
8007f18: 4618 mov r0, r3
|
|
8007f1a: f7f8 fea9 bl 8000c70 <HAL_Delay>
|
|
|
|
carrierSenseTime = TimerGetCurrentTime( );
|
|
8007f1e: f006 fb87 bl 800e630 <UTIL_TIMER_GetCurrentTime>
|
|
8007f22: 6138 str r0, [r7, #16]
|
|
|
|
// Perform carrier sense for maxCarrierSenseTime
|
|
while( TimerGetElapsedTime( carrierSenseTime ) < maxCarrierSenseTime )
|
|
8007f24: e00d b.n 8007f42 <RadioIsChannelFree+0x98>
|
|
{
|
|
rssi = RadioRssi( MODEM_FSK );
|
|
8007f26: 2000 movs r0, #0
|
|
8007f28: f000 fec8 bl 8008cbc <RadioRssi>
|
|
8007f2c: 4603 mov r3, r0
|
|
8007f2e: 82bb strh r3, [r7, #20]
|
|
|
|
if( rssi > rssiThresh )
|
|
8007f30: f9b7 2014 ldrsh.w r2, [r7, #20]
|
|
8007f34: f9b7 3006 ldrsh.w r3, [r7, #6]
|
|
8007f38: 429a cmp r2, r3
|
|
8007f3a: dd02 ble.n 8007f42 <RadioIsChannelFree+0x98>
|
|
{
|
|
status = false;
|
|
8007f3c: 2300 movs r3, #0
|
|
8007f3e: 75fb strb r3, [r7, #23]
|
|
break;
|
|
8007f40: e006 b.n 8007f50 <RadioIsChannelFree+0xa6>
|
|
while( TimerGetElapsedTime( carrierSenseTime ) < maxCarrierSenseTime )
|
|
8007f42: 6938 ldr r0, [r7, #16]
|
|
8007f44: f006 fb86 bl 800e654 <UTIL_TIMER_GetElapsedTime>
|
|
8007f48: 4602 mov r2, r0
|
|
8007f4a: 683b ldr r3, [r7, #0]
|
|
8007f4c: 4293 cmp r3, r2
|
|
8007f4e: d8ea bhi.n 8007f26 <RadioIsChannelFree+0x7c>
|
|
}
|
|
}
|
|
RadioStandby( );
|
|
8007f50: f000 fdb3 bl 8008aba <RadioStandby>
|
|
|
|
return status;
|
|
8007f54: 7dfb ldrb r3, [r7, #23]
|
|
}
|
|
8007f56: 4618 mov r0, r3
|
|
8007f58: 3718 adds r7, #24
|
|
8007f5a: 46bd mov sp, r7
|
|
8007f5c: bd80 pop {r7, pc}
|
|
|
|
08007f5e <RadioRandom>:
|
|
|
|
static uint32_t RadioRandom( void )
|
|
{
|
|
8007f5e: b580 push {r7, lr}
|
|
8007f60: b082 sub sp, #8
|
|
8007f62: af00 add r7, sp, #0
|
|
uint32_t rnd = 0;
|
|
8007f64: 2300 movs r3, #0
|
|
8007f66: 607b str r3, [r7, #4]
|
|
|
|
/*
|
|
* Radio setup for random number generation
|
|
*/
|
|
// Disable modem interrupts
|
|
SUBGRF_SetDioIrqParams( IRQ_RADIO_NONE, IRQ_RADIO_NONE, IRQ_RADIO_NONE, IRQ_RADIO_NONE );
|
|
8007f68: 2300 movs r3, #0
|
|
8007f6a: 2200 movs r2, #0
|
|
8007f6c: 2100 movs r1, #0
|
|
8007f6e: 2000 movs r0, #0
|
|
8007f70: f002 fa3e bl 800a3f0 <SUBGRF_SetDioIrqParams>
|
|
|
|
rnd = SUBGRF_GetRandom();
|
|
8007f74: f001 ffe7 bl 8009f46 <SUBGRF_GetRandom>
|
|
8007f78: 6078 str r0, [r7, #4]
|
|
|
|
return rnd;
|
|
8007f7a: 687b ldr r3, [r7, #4]
|
|
}
|
|
8007f7c: 4618 mov r0, r3
|
|
8007f7e: 3708 adds r7, #8
|
|
8007f80: 46bd mov sp, r7
|
|
8007f82: bd80 pop {r7, pc}
|
|
|
|
08007f84 <RadioSetRxConfig>:
|
|
uint32_t bandwidthAfc, uint16_t preambleLen,
|
|
uint16_t symbTimeout, bool fixLen,
|
|
uint8_t payloadLen,
|
|
bool crcOn, bool freqHopOn, uint8_t hopPeriod,
|
|
bool iqInverted, bool rxContinuous )
|
|
{
|
|
8007f84: b580 push {r7, lr}
|
|
8007f86: b08a sub sp, #40 @ 0x28
|
|
8007f88: af00 add r7, sp, #0
|
|
8007f8a: 60b9 str r1, [r7, #8]
|
|
8007f8c: 607a str r2, [r7, #4]
|
|
8007f8e: 461a mov r2, r3
|
|
8007f90: 4603 mov r3, r0
|
|
8007f92: 73fb strb r3, [r7, #15]
|
|
8007f94: 4613 mov r3, r2
|
|
8007f96: 73bb strb r3, [r7, #14]
|
|
#if (RADIO_SIGFOX_ENABLE == 1)
|
|
uint8_t modReg;
|
|
#endif
|
|
SubgRf.RxContinuous = rxContinuous;
|
|
8007f98: 4ab9 ldr r2, [pc, #740] @ (8008280 <RadioSetRxConfig+0x2fc>)
|
|
8007f9a: f897 3054 ldrb.w r3, [r7, #84] @ 0x54
|
|
8007f9e: 7053 strb r3, [r2, #1]
|
|
RFW_DeInit();
|
|
8007fa0: f003 fb40 bl 800b624 <RFW_DeInit>
|
|
if( rxContinuous == true )
|
|
8007fa4: f897 3054 ldrb.w r3, [r7, #84] @ 0x54
|
|
8007fa8: 2b00 cmp r3, #0
|
|
8007faa: d001 beq.n 8007fb0 <RadioSetRxConfig+0x2c>
|
|
{
|
|
symbTimeout = 0;
|
|
8007fac: 2300 movs r3, #0
|
|
8007fae: 873b strh r3, [r7, #56] @ 0x38
|
|
}
|
|
if( fixLen == true )
|
|
8007fb0: f897 303c ldrb.w r3, [r7, #60] @ 0x3c
|
|
8007fb4: 2b00 cmp r3, #0
|
|
8007fb6: d004 beq.n 8007fc2 <RadioSetRxConfig+0x3e>
|
|
{
|
|
MaxPayloadLength = payloadLen;
|
|
8007fb8: 4ab2 ldr r2, [pc, #712] @ (8008284 <RadioSetRxConfig+0x300>)
|
|
8007fba: f897 3040 ldrb.w r3, [r7, #64] @ 0x40
|
|
8007fbe: 7013 strb r3, [r2, #0]
|
|
8007fc0: e002 b.n 8007fc8 <RadioSetRxConfig+0x44>
|
|
}
|
|
else
|
|
{
|
|
MaxPayloadLength = 0xFF;
|
|
8007fc2: 4bb0 ldr r3, [pc, #704] @ (8008284 <RadioSetRxConfig+0x300>)
|
|
8007fc4: 22ff movs r2, #255 @ 0xff
|
|
8007fc6: 701a strb r2, [r3, #0]
|
|
}
|
|
|
|
switch( modem )
|
|
8007fc8: 7bfb ldrb r3, [r7, #15]
|
|
8007fca: 2b05 cmp r3, #5
|
|
8007fcc: d009 beq.n 8007fe2 <RadioSetRxConfig+0x5e>
|
|
8007fce: 2b05 cmp r3, #5
|
|
8007fd0: f300 81d7 bgt.w 8008382 <RadioSetRxConfig+0x3fe>
|
|
8007fd4: 2b00 cmp r3, #0
|
|
8007fd6: f000 80bf beq.w 8008158 <RadioSetRxConfig+0x1d4>
|
|
8007fda: 2b01 cmp r3, #1
|
|
8007fdc: f000 8124 beq.w 8008228 <RadioSetRxConfig+0x2a4>
|
|
// Timeout Max, Timeout handled directly in SetRx function
|
|
SubgRf.RxTimeout = 0xFFFF;
|
|
|
|
break;
|
|
default:
|
|
break;
|
|
8007fe0: e1cf b.n 8008382 <RadioSetRxConfig+0x3fe>
|
|
SUBGRF_SetStopRxTimerOnPreambleDetect( true );
|
|
8007fe2: 2001 movs r0, #1
|
|
8007fe4: f002 f8f6 bl 800a1d4 <SUBGRF_SetStopRxTimerOnPreambleDetect>
|
|
SubgRf.ModulationParams.PacketType = PACKET_TYPE_GFSK;
|
|
8007fe8: 4ba5 ldr r3, [pc, #660] @ (8008280 <RadioSetRxConfig+0x2fc>)
|
|
8007fea: 2200 movs r2, #0
|
|
8007fec: f883 2038 strb.w r2, [r3, #56] @ 0x38
|
|
SubgRf.ModulationParams.Params.Gfsk.BitRate = datarate;
|
|
8007ff0: 4aa3 ldr r2, [pc, #652] @ (8008280 <RadioSetRxConfig+0x2fc>)
|
|
8007ff2: 687b ldr r3, [r7, #4]
|
|
8007ff4: 63d3 str r3, [r2, #60] @ 0x3c
|
|
SubgRf.ModulationParams.Params.Gfsk.ModulationShaping = MOD_SHAPING_G_BT_05;
|
|
8007ff6: 4ba2 ldr r3, [pc, #648] @ (8008280 <RadioSetRxConfig+0x2fc>)
|
|
8007ff8: 2209 movs r2, #9
|
|
8007ffa: f883 2044 strb.w r2, [r3, #68] @ 0x44
|
|
SubgRf.ModulationParams.Params.Gfsk.Fdev = 800;
|
|
8007ffe: 4ba0 ldr r3, [pc, #640] @ (8008280 <RadioSetRxConfig+0x2fc>)
|
|
8008000: f44f 7248 mov.w r2, #800 @ 0x320
|
|
8008004: 641a str r2, [r3, #64] @ 0x40
|
|
SubgRf.ModulationParams.Params.Gfsk.Bandwidth = SUBGRF_GetFskBandwidthRegValue( bandwidth );
|
|
8008006: 68b8 ldr r0, [r7, #8]
|
|
8008008: f002 ffd0 bl 800afac <SUBGRF_GetFskBandwidthRegValue>
|
|
800800c: 4603 mov r3, r0
|
|
800800e: 461a mov r2, r3
|
|
8008010: 4b9b ldr r3, [pc, #620] @ (8008280 <RadioSetRxConfig+0x2fc>)
|
|
8008012: f883 2045 strb.w r2, [r3, #69] @ 0x45
|
|
SubgRf.PacketParams.PacketType = PACKET_TYPE_GFSK;
|
|
8008016: 4b9a ldr r3, [pc, #616] @ (8008280 <RadioSetRxConfig+0x2fc>)
|
|
8008018: 2200 movs r2, #0
|
|
800801a: 739a strb r2, [r3, #14]
|
|
SubgRf.PacketParams.Params.Gfsk.PreambleLength = ( preambleLen << 3 ); // convert byte into bit
|
|
800801c: 8ebb ldrh r3, [r7, #52] @ 0x34
|
|
800801e: 00db lsls r3, r3, #3
|
|
8008020: b29a uxth r2, r3
|
|
8008022: 4b97 ldr r3, [pc, #604] @ (8008280 <RadioSetRxConfig+0x2fc>)
|
|
8008024: 821a strh r2, [r3, #16]
|
|
SubgRf.PacketParams.Params.Gfsk.PreambleMinDetect = RADIO_PREAMBLE_DETECTOR_OFF;
|
|
8008026: 4b96 ldr r3, [pc, #600] @ (8008280 <RadioSetRxConfig+0x2fc>)
|
|
8008028: 2200 movs r2, #0
|
|
800802a: 749a strb r2, [r3, #18]
|
|
SubgRf.PacketParams.Params.Gfsk.SyncWordLength = 2 << 3; // convert byte into bit
|
|
800802c: 4b94 ldr r3, [pc, #592] @ (8008280 <RadioSetRxConfig+0x2fc>)
|
|
800802e: 2210 movs r2, #16
|
|
8008030: 74da strb r2, [r3, #19]
|
|
SubgRf.PacketParams.Params.Gfsk.AddrComp = RADIO_ADDRESSCOMP_FILT_OFF;
|
|
8008032: 4b93 ldr r3, [pc, #588] @ (8008280 <RadioSetRxConfig+0x2fc>)
|
|
8008034: 2200 movs r2, #0
|
|
8008036: 751a strb r2, [r3, #20]
|
|
SubgRf.PacketParams.Params.Gfsk.HeaderType = RADIO_PACKET_FIXED_LENGTH;
|
|
8008038: 4b91 ldr r3, [pc, #580] @ (8008280 <RadioSetRxConfig+0x2fc>)
|
|
800803a: 2200 movs r2, #0
|
|
800803c: 755a strb r2, [r3, #21]
|
|
SubgRf.PacketParams.Params.Gfsk.PayloadLength = MaxPayloadLength;
|
|
800803e: 4b91 ldr r3, [pc, #580] @ (8008284 <RadioSetRxConfig+0x300>)
|
|
8008040: 781a ldrb r2, [r3, #0]
|
|
8008042: 4b8f ldr r3, [pc, #572] @ (8008280 <RadioSetRxConfig+0x2fc>)
|
|
8008044: 759a strb r2, [r3, #22]
|
|
SubgRf.PacketParams.Params.Gfsk.CrcLength = RADIO_CRC_OFF;
|
|
8008046: 4b8e ldr r3, [pc, #568] @ (8008280 <RadioSetRxConfig+0x2fc>)
|
|
8008048: 2201 movs r2, #1
|
|
800804a: 75da strb r2, [r3, #23]
|
|
SubgRf.PacketParams.Params.Gfsk.DcFree = RADIO_DC_FREE_OFF;
|
|
800804c: 4b8c ldr r3, [pc, #560] @ (8008280 <RadioSetRxConfig+0x2fc>)
|
|
800804e: 2200 movs r2, #0
|
|
8008050: 761a strb r2, [r3, #24]
|
|
RadioSetModem( MODEM_SIGFOX_RX );
|
|
8008052: 2005 movs r0, #5
|
|
8008054: f7ff fec2 bl 8007ddc <RadioSetModem>
|
|
SUBGRF_SetModulationParams( &SubgRf.ModulationParams );
|
|
8008058: 488b ldr r0, [pc, #556] @ (8008288 <RadioSetRxConfig+0x304>)
|
|
800805a: f002 fb5f bl 800a71c <SUBGRF_SetModulationParams>
|
|
SUBGRF_SetPacketParams( &SubgRf.PacketParams );
|
|
800805e: 488b ldr r0, [pc, #556] @ (800828c <RadioSetRxConfig+0x308>)
|
|
8008060: f002 fc2a bl 800a8b8 <SUBGRF_SetPacketParams>
|
|
SUBGRF_SetSyncWord( ( uint8_t[] ){0xB2, 0x27, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 } );
|
|
8008064: 4a8a ldr r2, [pc, #552] @ (8008290 <RadioSetRxConfig+0x30c>)
|
|
8008066: f107 031c add.w r3, r7, #28
|
|
800806a: e892 0003 ldmia.w r2, {r0, r1}
|
|
800806e: e883 0003 stmia.w r3, {r0, r1}
|
|
8008072: f107 031c add.w r3, r7, #28
|
|
8008076: 4618 mov r0, r3
|
|
8008078: f001 fee3 bl 8009e42 <SUBGRF_SetSyncWord>
|
|
SUBGRF_SetWhiteningSeed( 0x01FF );
|
|
800807c: f240 10ff movw r0, #511 @ 0x1ff
|
|
8008080: f001 ff2e bl 8009ee0 <SUBGRF_SetWhiteningSeed>
|
|
modReg= RadioRead(SUBGHZ_AGCGFORSTCFGR);
|
|
8008084: f640 00b8 movw r0, #2232 @ 0x8b8
|
|
8008088: f000 fe36 bl 8008cf8 <RadioRead>
|
|
800808c: 4603 mov r3, r0
|
|
800808e: f887 3027 strb.w r3, [r7, #39] @ 0x27
|
|
modReg&=RADIO_BIT_MASK(4);
|
|
8008092: f897 3027 ldrb.w r3, [r7, #39] @ 0x27
|
|
8008096: f023 0310 bic.w r3, r3, #16
|
|
800809a: f887 3027 strb.w r3, [r7, #39] @ 0x27
|
|
RadioWrite(SUBGHZ_AGCGFORSTCFGR, modReg);
|
|
800809e: f897 3027 ldrb.w r3, [r7, #39] @ 0x27
|
|
80080a2: 4619 mov r1, r3
|
|
80080a4: f640 00b8 movw r0, #2232 @ 0x8b8
|
|
80080a8: f000 fe14 bl 8008cd4 <RadioWrite>
|
|
RadioWrite(SUBGHZ_AGCGFORSTPOWTHR, 0x4 );
|
|
80080ac: 2104 movs r1, #4
|
|
80080ae: f640 00b9 movw r0, #2233 @ 0x8b9
|
|
80080b2: f000 fe0f bl 8008cd4 <RadioWrite>
|
|
modReg= RadioRead(SUBGHZ_AGCRSSICTL0R);
|
|
80080b6: f640 009b movw r0, #2203 @ 0x89b
|
|
80080ba: f000 fe1d bl 8008cf8 <RadioRead>
|
|
80080be: 4603 mov r3, r0
|
|
80080c0: f887 3027 strb.w r3, [r7, #39] @ 0x27
|
|
modReg&=( RADIO_BIT_MASK(2) & RADIO_BIT_MASK(3) & RADIO_BIT_MASK(4) );
|
|
80080c4: f897 3027 ldrb.w r3, [r7, #39] @ 0x27
|
|
80080c8: f023 031c bic.w r3, r3, #28
|
|
80080cc: f887 3027 strb.w r3, [r7, #39] @ 0x27
|
|
RadioWrite(SUBGHZ_AGCRSSICTL0R, (modReg| (0x1<<3) ) );
|
|
80080d0: f897 3027 ldrb.w r3, [r7, #39] @ 0x27
|
|
80080d4: f043 0308 orr.w r3, r3, #8
|
|
80080d8: b2db uxtb r3, r3
|
|
80080da: 4619 mov r1, r3
|
|
80080dc: f640 009b movw r0, #2203 @ 0x89b
|
|
80080e0: f000 fdf8 bl 8008cd4 <RadioWrite>
|
|
modReg= RadioRead(SUBGHZ_GAFCR);
|
|
80080e4: f240 60d1 movw r0, #1745 @ 0x6d1
|
|
80080e8: f000 fe06 bl 8008cf8 <RadioRead>
|
|
80080ec: 4603 mov r3, r0
|
|
80080ee: f887 3027 strb.w r3, [r7, #39] @ 0x27
|
|
modReg&=( RADIO_BIT_MASK(3) & RADIO_BIT_MASK(4) );
|
|
80080f2: f897 3027 ldrb.w r3, [r7, #39] @ 0x27
|
|
80080f6: f023 0318 bic.w r3, r3, #24
|
|
80080fa: f887 3027 strb.w r3, [r7, #39] @ 0x27
|
|
RadioWrite(SUBGHZ_GAFCR, (modReg| (0x3<<3) ));
|
|
80080fe: f897 3027 ldrb.w r3, [r7, #39] @ 0x27
|
|
8008102: f043 0318 orr.w r3, r3, #24
|
|
8008106: b2db uxtb r3, r3
|
|
8008108: 4619 mov r1, r3
|
|
800810a: f240 60d1 movw r0, #1745 @ 0x6d1
|
|
800810e: f000 fde1 bl 8008cd4 <RadioWrite>
|
|
modReg= RadioRead(SUBGHZ_GBSYNCR);
|
|
8008112: f240 60ac movw r0, #1708 @ 0x6ac
|
|
8008116: f000 fdef bl 8008cf8 <RadioRead>
|
|
800811a: 4603 mov r3, r0
|
|
800811c: f887 3027 strb.w r3, [r7, #39] @ 0x27
|
|
modReg&=( RADIO_BIT_MASK(4) & RADIO_BIT_MASK(5) & RADIO_BIT_MASK(6) );
|
|
8008120: f897 3027 ldrb.w r3, [r7, #39] @ 0x27
|
|
8008124: f023 0370 bic.w r3, r3, #112 @ 0x70
|
|
8008128: f887 3027 strb.w r3, [r7, #39] @ 0x27
|
|
RadioWrite(SUBGHZ_GBSYNCR, (modReg| (0x5<<4) ));
|
|
800812c: f897 3027 ldrb.w r3, [r7, #39] @ 0x27
|
|
8008130: f043 0350 orr.w r3, r3, #80 @ 0x50
|
|
8008134: b2db uxtb r3, r3
|
|
8008136: 4619 mov r1, r3
|
|
8008138: f240 60ac movw r0, #1708 @ 0x6ac
|
|
800813c: f000 fdca bl 8008cd4 <RadioWrite>
|
|
SubgRf.RxTimeout = ( uint32_t )(( symbTimeout * 8 * 1000 ) /datarate);
|
|
8008140: 8f3b ldrh r3, [r7, #56] @ 0x38
|
|
8008142: f44f 52fa mov.w r2, #8000 @ 0x1f40
|
|
8008146: fb02 f303 mul.w r3, r2, r3
|
|
800814a: 461a mov r2, r3
|
|
800814c: 687b ldr r3, [r7, #4]
|
|
800814e: fbb2 f3f3 udiv r3, r2, r3
|
|
8008152: 4a4b ldr r2, [pc, #300] @ (8008280 <RadioSetRxConfig+0x2fc>)
|
|
8008154: 6093 str r3, [r2, #8]
|
|
break;
|
|
8008156: e115 b.n 8008384 <RadioSetRxConfig+0x400>
|
|
SUBGRF_SetStopRxTimerOnPreambleDetect( false );
|
|
8008158: 2000 movs r0, #0
|
|
800815a: f002 f83b bl 800a1d4 <SUBGRF_SetStopRxTimerOnPreambleDetect>
|
|
SubgRf.ModulationParams.PacketType = PACKET_TYPE_GFSK;
|
|
800815e: 4b48 ldr r3, [pc, #288] @ (8008280 <RadioSetRxConfig+0x2fc>)
|
|
8008160: 2200 movs r2, #0
|
|
8008162: f883 2038 strb.w r2, [r3, #56] @ 0x38
|
|
SubgRf.ModulationParams.Params.Gfsk.BitRate = datarate;
|
|
8008166: 4a46 ldr r2, [pc, #280] @ (8008280 <RadioSetRxConfig+0x2fc>)
|
|
8008168: 687b ldr r3, [r7, #4]
|
|
800816a: 63d3 str r3, [r2, #60] @ 0x3c
|
|
SubgRf.ModulationParams.Params.Gfsk.ModulationShaping = MOD_SHAPING_G_BT_1;
|
|
800816c: 4b44 ldr r3, [pc, #272] @ (8008280 <RadioSetRxConfig+0x2fc>)
|
|
800816e: 220b movs r2, #11
|
|
8008170: f883 2044 strb.w r2, [r3, #68] @ 0x44
|
|
SubgRf.ModulationParams.Params.Gfsk.Bandwidth = SUBGRF_GetFskBandwidthRegValue( bandwidth );
|
|
8008174: 68b8 ldr r0, [r7, #8]
|
|
8008176: f002 ff19 bl 800afac <SUBGRF_GetFskBandwidthRegValue>
|
|
800817a: 4603 mov r3, r0
|
|
800817c: 461a mov r2, r3
|
|
800817e: 4b40 ldr r3, [pc, #256] @ (8008280 <RadioSetRxConfig+0x2fc>)
|
|
8008180: f883 2045 strb.w r2, [r3, #69] @ 0x45
|
|
SubgRf.PacketParams.PacketType = PACKET_TYPE_GFSK;
|
|
8008184: 4b3e ldr r3, [pc, #248] @ (8008280 <RadioSetRxConfig+0x2fc>)
|
|
8008186: 2200 movs r2, #0
|
|
8008188: 739a strb r2, [r3, #14]
|
|
SubgRf.PacketParams.Params.Gfsk.PreambleLength = ( preambleLen << 3 ); // convert byte into bit
|
|
800818a: 8ebb ldrh r3, [r7, #52] @ 0x34
|
|
800818c: 00db lsls r3, r3, #3
|
|
800818e: b29a uxth r2, r3
|
|
8008190: 4b3b ldr r3, [pc, #236] @ (8008280 <RadioSetRxConfig+0x2fc>)
|
|
8008192: 821a strh r2, [r3, #16]
|
|
SubgRf.PacketParams.Params.Gfsk.PreambleMinDetect = RADIO_PREAMBLE_DETECTOR_08_BITS;
|
|
8008194: 4b3a ldr r3, [pc, #232] @ (8008280 <RadioSetRxConfig+0x2fc>)
|
|
8008196: 2204 movs r2, #4
|
|
8008198: 749a strb r2, [r3, #18]
|
|
SubgRf.PacketParams.Params.Gfsk.SyncWordLength = 3 << 3; // convert byte into bit
|
|
800819a: 4b39 ldr r3, [pc, #228] @ (8008280 <RadioSetRxConfig+0x2fc>)
|
|
800819c: 2218 movs r2, #24
|
|
800819e: 74da strb r2, [r3, #19]
|
|
SubgRf.PacketParams.Params.Gfsk.AddrComp = RADIO_ADDRESSCOMP_FILT_OFF;
|
|
80081a0: 4b37 ldr r3, [pc, #220] @ (8008280 <RadioSetRxConfig+0x2fc>)
|
|
80081a2: 2200 movs r2, #0
|
|
80081a4: 751a strb r2, [r3, #20]
|
|
SubgRf.PacketParams.Params.Gfsk.HeaderType = ( fixLen == true ) ? RADIO_PACKET_FIXED_LENGTH : RADIO_PACKET_VARIABLE_LENGTH;
|
|
80081a6: f897 303c ldrb.w r3, [r7, #60] @ 0x3c
|
|
80081aa: f083 0301 eor.w r3, r3, #1
|
|
80081ae: b2db uxtb r3, r3
|
|
80081b0: 461a mov r2, r3
|
|
80081b2: 4b33 ldr r3, [pc, #204] @ (8008280 <RadioSetRxConfig+0x2fc>)
|
|
80081b4: 755a strb r2, [r3, #21]
|
|
SubgRf.PacketParams.Params.Gfsk.PayloadLength = MaxPayloadLength;
|
|
80081b6: 4b33 ldr r3, [pc, #204] @ (8008284 <RadioSetRxConfig+0x300>)
|
|
80081b8: 781a ldrb r2, [r3, #0]
|
|
80081ba: 4b31 ldr r3, [pc, #196] @ (8008280 <RadioSetRxConfig+0x2fc>)
|
|
80081bc: 759a strb r2, [r3, #22]
|
|
if( crcOn == true )
|
|
80081be: f897 3044 ldrb.w r3, [r7, #68] @ 0x44
|
|
80081c2: 2b00 cmp r3, #0
|
|
80081c4: d003 beq.n 80081ce <RadioSetRxConfig+0x24a>
|
|
SubgRf.PacketParams.Params.Gfsk.CrcLength = RADIO_CRC_2_BYTES_CCIT;
|
|
80081c6: 4b2e ldr r3, [pc, #184] @ (8008280 <RadioSetRxConfig+0x2fc>)
|
|
80081c8: 22f2 movs r2, #242 @ 0xf2
|
|
80081ca: 75da strb r2, [r3, #23]
|
|
80081cc: e002 b.n 80081d4 <RadioSetRxConfig+0x250>
|
|
SubgRf.PacketParams.Params.Gfsk.CrcLength = RADIO_CRC_OFF;
|
|
80081ce: 4b2c ldr r3, [pc, #176] @ (8008280 <RadioSetRxConfig+0x2fc>)
|
|
80081d0: 2201 movs r2, #1
|
|
80081d2: 75da strb r2, [r3, #23]
|
|
SubgRf.PacketParams.Params.Gfsk.DcFree = RADIO_DC_FREEWHITENING;
|
|
80081d4: 4b2a ldr r3, [pc, #168] @ (8008280 <RadioSetRxConfig+0x2fc>)
|
|
80081d6: 2201 movs r2, #1
|
|
80081d8: 761a strb r2, [r3, #24]
|
|
RadioStandby( );
|
|
80081da: f000 fc6e bl 8008aba <RadioStandby>
|
|
RadioSetModem( MODEM_FSK );
|
|
80081de: 2000 movs r0, #0
|
|
80081e0: f7ff fdfc bl 8007ddc <RadioSetModem>
|
|
SUBGRF_SetModulationParams( &SubgRf.ModulationParams );
|
|
80081e4: 4828 ldr r0, [pc, #160] @ (8008288 <RadioSetRxConfig+0x304>)
|
|
80081e6: f002 fa99 bl 800a71c <SUBGRF_SetModulationParams>
|
|
SUBGRF_SetPacketParams( &SubgRf.PacketParams );
|
|
80081ea: 4828 ldr r0, [pc, #160] @ (800828c <RadioSetRxConfig+0x308>)
|
|
80081ec: f002 fb64 bl 800a8b8 <SUBGRF_SetPacketParams>
|
|
SUBGRF_SetSyncWord( ( uint8_t[] ){ 0xC1, 0x94, 0xC1, 0x00, 0x00, 0x00, 0x00, 0x00 } );
|
|
80081f0: 4a28 ldr r2, [pc, #160] @ (8008294 <RadioSetRxConfig+0x310>)
|
|
80081f2: f107 0314 add.w r3, r7, #20
|
|
80081f6: e892 0003 ldmia.w r2, {r0, r1}
|
|
80081fa: e883 0003 stmia.w r3, {r0, r1}
|
|
80081fe: f107 0314 add.w r3, r7, #20
|
|
8008202: 4618 mov r0, r3
|
|
8008204: f001 fe1d bl 8009e42 <SUBGRF_SetSyncWord>
|
|
SUBGRF_SetWhiteningSeed( 0x01FF );
|
|
8008208: f240 10ff movw r0, #511 @ 0x1ff
|
|
800820c: f001 fe68 bl 8009ee0 <SUBGRF_SetWhiteningSeed>
|
|
SubgRf.RxTimeout = ( uint32_t )(( symbTimeout * 8 * 1000 ) /datarate);
|
|
8008210: 8f3b ldrh r3, [r7, #56] @ 0x38
|
|
8008212: f44f 52fa mov.w r2, #8000 @ 0x1f40
|
|
8008216: fb02 f303 mul.w r3, r2, r3
|
|
800821a: 461a mov r2, r3
|
|
800821c: 687b ldr r3, [r7, #4]
|
|
800821e: fbb2 f3f3 udiv r3, r2, r3
|
|
8008222: 4a17 ldr r2, [pc, #92] @ (8008280 <RadioSetRxConfig+0x2fc>)
|
|
8008224: 6093 str r3, [r2, #8]
|
|
break;
|
|
8008226: e0ad b.n 8008384 <RadioSetRxConfig+0x400>
|
|
SUBGRF_SetStopRxTimerOnPreambleDetect( false );
|
|
8008228: 2000 movs r0, #0
|
|
800822a: f001 ffd3 bl 800a1d4 <SUBGRF_SetStopRxTimerOnPreambleDetect>
|
|
SubgRf.ModulationParams.PacketType = PACKET_TYPE_LORA;
|
|
800822e: 4b14 ldr r3, [pc, #80] @ (8008280 <RadioSetRxConfig+0x2fc>)
|
|
8008230: 2201 movs r2, #1
|
|
8008232: f883 2038 strb.w r2, [r3, #56] @ 0x38
|
|
SubgRf.ModulationParams.Params.LoRa.SpreadingFactor = ( RadioLoRaSpreadingFactors_t )datarate;
|
|
8008236: 687b ldr r3, [r7, #4]
|
|
8008238: b2da uxtb r2, r3
|
|
800823a: 4b11 ldr r3, [pc, #68] @ (8008280 <RadioSetRxConfig+0x2fc>)
|
|
800823c: f883 2050 strb.w r2, [r3, #80] @ 0x50
|
|
SubgRf.ModulationParams.Params.LoRa.Bandwidth = Bandwidths[bandwidth];
|
|
8008240: 4a15 ldr r2, [pc, #84] @ (8008298 <RadioSetRxConfig+0x314>)
|
|
8008242: 68bb ldr r3, [r7, #8]
|
|
8008244: 4413 add r3, r2
|
|
8008246: 781a ldrb r2, [r3, #0]
|
|
8008248: 4b0d ldr r3, [pc, #52] @ (8008280 <RadioSetRxConfig+0x2fc>)
|
|
800824a: f883 2051 strb.w r2, [r3, #81] @ 0x51
|
|
SubgRf.ModulationParams.Params.LoRa.CodingRate = ( RadioLoRaCodingRates_t )coderate;
|
|
800824e: 4a0c ldr r2, [pc, #48] @ (8008280 <RadioSetRxConfig+0x2fc>)
|
|
8008250: 7bbb ldrb r3, [r7, #14]
|
|
8008252: f882 3052 strb.w r3, [r2, #82] @ 0x52
|
|
if( ( ( bandwidth == 0 ) && ( ( datarate == 11 ) || ( datarate == 12 ) ) ) ||
|
|
8008256: 68bb ldr r3, [r7, #8]
|
|
8008258: 2b00 cmp r3, #0
|
|
800825a: d105 bne.n 8008268 <RadioSetRxConfig+0x2e4>
|
|
800825c: 687b ldr r3, [r7, #4]
|
|
800825e: 2b0b cmp r3, #11
|
|
8008260: d008 beq.n 8008274 <RadioSetRxConfig+0x2f0>
|
|
8008262: 687b ldr r3, [r7, #4]
|
|
8008264: 2b0c cmp r3, #12
|
|
8008266: d005 beq.n 8008274 <RadioSetRxConfig+0x2f0>
|
|
8008268: 68bb ldr r3, [r7, #8]
|
|
800826a: 2b01 cmp r3, #1
|
|
800826c: d116 bne.n 800829c <RadioSetRxConfig+0x318>
|
|
( ( bandwidth == 1 ) && ( datarate == 12 ) ) )
|
|
800826e: 687b ldr r3, [r7, #4]
|
|
8008270: 2b0c cmp r3, #12
|
|
8008272: d113 bne.n 800829c <RadioSetRxConfig+0x318>
|
|
SubgRf.ModulationParams.Params.LoRa.LowDatarateOptimize = 0x01;
|
|
8008274: 4b02 ldr r3, [pc, #8] @ (8008280 <RadioSetRxConfig+0x2fc>)
|
|
8008276: 2201 movs r2, #1
|
|
8008278: f883 2053 strb.w r2, [r3, #83] @ 0x53
|
|
800827c: e012 b.n 80082a4 <RadioSetRxConfig+0x320>
|
|
800827e: bf00 nop
|
|
8008280: 200002f8 .word 0x200002f8
|
|
8008284: 20000008 .word 0x20000008
|
|
8008288: 20000330 .word 0x20000330
|
|
800828c: 20000306 .word 0x20000306
|
|
8008290: 0800f8ac .word 0x0800f8ac
|
|
8008294: 0800f8b4 .word 0x0800f8b4
|
|
8008298: 08010450 .word 0x08010450
|
|
SubgRf.ModulationParams.Params.LoRa.LowDatarateOptimize = 0x00;
|
|
800829c: 4b3b ldr r3, [pc, #236] @ (800838c <RadioSetRxConfig+0x408>)
|
|
800829e: 2200 movs r2, #0
|
|
80082a0: f883 2053 strb.w r2, [r3, #83] @ 0x53
|
|
SubgRf.PacketParams.PacketType = PACKET_TYPE_LORA;
|
|
80082a4: 4b39 ldr r3, [pc, #228] @ (800838c <RadioSetRxConfig+0x408>)
|
|
80082a6: 2201 movs r2, #1
|
|
80082a8: 739a strb r2, [r3, #14]
|
|
if( ( SubgRf.ModulationParams.Params.LoRa.SpreadingFactor == LORA_SF5 ) ||
|
|
80082aa: 4b38 ldr r3, [pc, #224] @ (800838c <RadioSetRxConfig+0x408>)
|
|
80082ac: f893 3050 ldrb.w r3, [r3, #80] @ 0x50
|
|
80082b0: 2b05 cmp r3, #5
|
|
80082b2: d004 beq.n 80082be <RadioSetRxConfig+0x33a>
|
|
( SubgRf.ModulationParams.Params.LoRa.SpreadingFactor == LORA_SF6 ) )
|
|
80082b4: 4b35 ldr r3, [pc, #212] @ (800838c <RadioSetRxConfig+0x408>)
|
|
80082b6: f893 3050 ldrb.w r3, [r3, #80] @ 0x50
|
|
if( ( SubgRf.ModulationParams.Params.LoRa.SpreadingFactor == LORA_SF5 ) ||
|
|
80082ba: 2b06 cmp r3, #6
|
|
80082bc: d10a bne.n 80082d4 <RadioSetRxConfig+0x350>
|
|
if( preambleLen < 12 )
|
|
80082be: 8ebb ldrh r3, [r7, #52] @ 0x34
|
|
80082c0: 2b0b cmp r3, #11
|
|
80082c2: d803 bhi.n 80082cc <RadioSetRxConfig+0x348>
|
|
SubgRf.PacketParams.Params.LoRa.PreambleLength = 12;
|
|
80082c4: 4b31 ldr r3, [pc, #196] @ (800838c <RadioSetRxConfig+0x408>)
|
|
80082c6: 220c movs r2, #12
|
|
80082c8: 839a strh r2, [r3, #28]
|
|
if( preambleLen < 12 )
|
|
80082ca: e006 b.n 80082da <RadioSetRxConfig+0x356>
|
|
SubgRf.PacketParams.Params.LoRa.PreambleLength = preambleLen;
|
|
80082cc: 4a2f ldr r2, [pc, #188] @ (800838c <RadioSetRxConfig+0x408>)
|
|
80082ce: 8ebb ldrh r3, [r7, #52] @ 0x34
|
|
80082d0: 8393 strh r3, [r2, #28]
|
|
if( preambleLen < 12 )
|
|
80082d2: e002 b.n 80082da <RadioSetRxConfig+0x356>
|
|
SubgRf.PacketParams.Params.LoRa.PreambleLength = preambleLen;
|
|
80082d4: 4a2d ldr r2, [pc, #180] @ (800838c <RadioSetRxConfig+0x408>)
|
|
80082d6: 8ebb ldrh r3, [r7, #52] @ 0x34
|
|
80082d8: 8393 strh r3, [r2, #28]
|
|
SubgRf.PacketParams.Params.LoRa.HeaderType = ( RadioLoRaPacketLengthsMode_t )fixLen;
|
|
80082da: f897 203c ldrb.w r2, [r7, #60] @ 0x3c
|
|
80082de: 4b2b ldr r3, [pc, #172] @ (800838c <RadioSetRxConfig+0x408>)
|
|
80082e0: 779a strb r2, [r3, #30]
|
|
SubgRf.PacketParams.Params.LoRa.PayloadLength = MaxPayloadLength;
|
|
80082e2: 4b2b ldr r3, [pc, #172] @ (8008390 <RadioSetRxConfig+0x40c>)
|
|
80082e4: 781a ldrb r2, [r3, #0]
|
|
80082e6: 4b29 ldr r3, [pc, #164] @ (800838c <RadioSetRxConfig+0x408>)
|
|
80082e8: 77da strb r2, [r3, #31]
|
|
SubgRf.PacketParams.Params.LoRa.CrcMode = ( RadioLoRaCrcModes_t )crcOn;
|
|
80082ea: f897 2044 ldrb.w r2, [r7, #68] @ 0x44
|
|
80082ee: 4b27 ldr r3, [pc, #156] @ (800838c <RadioSetRxConfig+0x408>)
|
|
80082f0: f883 2020 strb.w r2, [r3, #32]
|
|
SubgRf.PacketParams.Params.LoRa.InvertIQ = ( RadioLoRaIQModes_t )iqInverted;
|
|
80082f4: f897 2050 ldrb.w r2, [r7, #80] @ 0x50
|
|
80082f8: 4b24 ldr r3, [pc, #144] @ (800838c <RadioSetRxConfig+0x408>)
|
|
80082fa: f883 2021 strb.w r2, [r3, #33] @ 0x21
|
|
RadioStandby( );
|
|
80082fe: f000 fbdc bl 8008aba <RadioStandby>
|
|
RadioSetModem( MODEM_LORA );
|
|
8008302: 2001 movs r0, #1
|
|
8008304: f7ff fd6a bl 8007ddc <RadioSetModem>
|
|
SUBGRF_SetModulationParams( &SubgRf.ModulationParams );
|
|
8008308: 4822 ldr r0, [pc, #136] @ (8008394 <RadioSetRxConfig+0x410>)
|
|
800830a: f002 fa07 bl 800a71c <SUBGRF_SetModulationParams>
|
|
SUBGRF_SetPacketParams( &SubgRf.PacketParams );
|
|
800830e: 4822 ldr r0, [pc, #136] @ (8008398 <RadioSetRxConfig+0x414>)
|
|
8008310: f002 fad2 bl 800a8b8 <SUBGRF_SetPacketParams>
|
|
SUBGRF_SetLoRaSymbNumTimeout( symbTimeout );
|
|
8008314: 8f3b ldrh r3, [r7, #56] @ 0x38
|
|
8008316: b2db uxtb r3, r3
|
|
8008318: 4618 mov r0, r3
|
|
800831a: f001 ff6a bl 800a1f2 <SUBGRF_SetLoRaSymbNumTimeout>
|
|
SUBGRF_WriteRegister(SUBGHZ_AGCCFG,SUBGRF_ReadRegister(SUBGHZ_AGCCFG)&0x1);
|
|
800831e: f640 00a3 movw r0, #2211 @ 0x8a3
|
|
8008322: f002 fc31 bl 800ab88 <SUBGRF_ReadRegister>
|
|
8008326: 4603 mov r3, r0
|
|
8008328: f003 0301 and.w r3, r3, #1
|
|
800832c: b2db uxtb r3, r3
|
|
800832e: 4619 mov r1, r3
|
|
8008330: f640 00a3 movw r0, #2211 @ 0x8a3
|
|
8008334: f002 fc06 bl 800ab44 <SUBGRF_WriteRegister>
|
|
if( SubgRf.PacketParams.Params.LoRa.InvertIQ == LORA_IQ_INVERTED )
|
|
8008338: 4b14 ldr r3, [pc, #80] @ (800838c <RadioSetRxConfig+0x408>)
|
|
800833a: f893 3021 ldrb.w r3, [r3, #33] @ 0x21
|
|
800833e: 2b01 cmp r3, #1
|
|
8008340: d10d bne.n 800835e <RadioSetRxConfig+0x3da>
|
|
SUBGRF_WriteRegister( SUBGHZ_LIQPOLR, SUBGRF_ReadRegister( SUBGHZ_LIQPOLR ) & ~( 1 << 2 ) );
|
|
8008342: f240 7036 movw r0, #1846 @ 0x736
|
|
8008346: f002 fc1f bl 800ab88 <SUBGRF_ReadRegister>
|
|
800834a: 4603 mov r3, r0
|
|
800834c: f023 0304 bic.w r3, r3, #4
|
|
8008350: b2db uxtb r3, r3
|
|
8008352: 4619 mov r1, r3
|
|
8008354: f240 7036 movw r0, #1846 @ 0x736
|
|
8008358: f002 fbf4 bl 800ab44 <SUBGRF_WriteRegister>
|
|
800835c: e00c b.n 8008378 <RadioSetRxConfig+0x3f4>
|
|
SUBGRF_WriteRegister( SUBGHZ_LIQPOLR, SUBGRF_ReadRegister( SUBGHZ_LIQPOLR ) | ( 1 << 2 ) );
|
|
800835e: f240 7036 movw r0, #1846 @ 0x736
|
|
8008362: f002 fc11 bl 800ab88 <SUBGRF_ReadRegister>
|
|
8008366: 4603 mov r3, r0
|
|
8008368: f043 0304 orr.w r3, r3, #4
|
|
800836c: b2db uxtb r3, r3
|
|
800836e: 4619 mov r1, r3
|
|
8008370: f240 7036 movw r0, #1846 @ 0x736
|
|
8008374: f002 fbe6 bl 800ab44 <SUBGRF_WriteRegister>
|
|
SubgRf.RxTimeout = 0xFFFF;
|
|
8008378: 4b04 ldr r3, [pc, #16] @ (800838c <RadioSetRxConfig+0x408>)
|
|
800837a: f64f 72ff movw r2, #65535 @ 0xffff
|
|
800837e: 609a str r2, [r3, #8]
|
|
break;
|
|
8008380: e000 b.n 8008384 <RadioSetRxConfig+0x400>
|
|
break;
|
|
8008382: bf00 nop
|
|
}
|
|
}
|
|
8008384: bf00 nop
|
|
8008386: 3728 adds r7, #40 @ 0x28
|
|
8008388: 46bd mov sp, r7
|
|
800838a: bd80 pop {r7, pc}
|
|
800838c: 200002f8 .word 0x200002f8
|
|
8008390: 20000008 .word 0x20000008
|
|
8008394: 20000330 .word 0x20000330
|
|
8008398: 20000306 .word 0x20000306
|
|
|
|
0800839c <RadioSetTxConfig>:
|
|
static void RadioSetTxConfig( RadioModems_t modem, int8_t power, uint32_t fdev,
|
|
uint32_t bandwidth, uint32_t datarate,
|
|
uint8_t coderate, uint16_t preambleLen,
|
|
bool fixLen, bool crcOn, bool freqHopOn,
|
|
uint8_t hopPeriod, bool iqInverted, uint32_t timeout )
|
|
{
|
|
800839c: b580 push {r7, lr}
|
|
800839e: b086 sub sp, #24
|
|
80083a0: af00 add r7, sp, #0
|
|
80083a2: 60ba str r2, [r7, #8]
|
|
80083a4: 607b str r3, [r7, #4]
|
|
80083a6: 4603 mov r3, r0
|
|
80083a8: 73fb strb r3, [r7, #15]
|
|
80083aa: 460b mov r3, r1
|
|
80083ac: 73bb strb r3, [r7, #14]
|
|
#if( RADIO_LR_FHSS_IS_ON == 1 )
|
|
/*disable LrFhss*/
|
|
SubgRf.lr_fhss.is_lr_fhss_on = false;
|
|
#endif /* RADIO_LR_FHSS_IS_ON == 1 */
|
|
RFW_DeInit();
|
|
80083ae: f003 f939 bl 800b624 <RFW_DeInit>
|
|
switch( modem )
|
|
80083b2: 7bfb ldrb r3, [r7, #15]
|
|
80083b4: 2b04 cmp r3, #4
|
|
80083b6: f000 80c7 beq.w 8008548 <RadioSetTxConfig+0x1ac>
|
|
80083ba: 2b04 cmp r3, #4
|
|
80083bc: f300 80d6 bgt.w 800856c <RadioSetTxConfig+0x1d0>
|
|
80083c0: 2b00 cmp r3, #0
|
|
80083c2: d002 beq.n 80083ca <RadioSetTxConfig+0x2e>
|
|
80083c4: 2b01 cmp r3, #1
|
|
80083c6: d059 beq.n 800847c <RadioSetTxConfig+0xe0>
|
|
SubgRf.ModulationParams.Params.Bpsk.ModulationShaping = MOD_SHAPING_DBPSK;
|
|
SUBGRF_SetModulationParams( &SubgRf.ModulationParams );
|
|
break;
|
|
#endif /*RADIO_SIGFOX_ENABLE == 1*/
|
|
default:
|
|
break;
|
|
80083c8: e0d0 b.n 800856c <RadioSetTxConfig+0x1d0>
|
|
SubgRf.ModulationParams.PacketType = PACKET_TYPE_GFSK;
|
|
80083ca: 4b77 ldr r3, [pc, #476] @ (80085a8 <RadioSetTxConfig+0x20c>)
|
|
80083cc: 2200 movs r2, #0
|
|
80083ce: f883 2038 strb.w r2, [r3, #56] @ 0x38
|
|
SubgRf.ModulationParams.Params.Gfsk.BitRate = datarate;
|
|
80083d2: 4a75 ldr r2, [pc, #468] @ (80085a8 <RadioSetTxConfig+0x20c>)
|
|
80083d4: 6a3b ldr r3, [r7, #32]
|
|
80083d6: 63d3 str r3, [r2, #60] @ 0x3c
|
|
SubgRf.ModulationParams.Params.Gfsk.ModulationShaping = MOD_SHAPING_G_BT_1;
|
|
80083d8: 4b73 ldr r3, [pc, #460] @ (80085a8 <RadioSetTxConfig+0x20c>)
|
|
80083da: 220b movs r2, #11
|
|
80083dc: f883 2044 strb.w r2, [r3, #68] @ 0x44
|
|
SubgRf.ModulationParams.Params.Gfsk.Bandwidth = SUBGRF_GetFskBandwidthRegValue( bandwidth );
|
|
80083e0: 6878 ldr r0, [r7, #4]
|
|
80083e2: f002 fde3 bl 800afac <SUBGRF_GetFskBandwidthRegValue>
|
|
80083e6: 4603 mov r3, r0
|
|
80083e8: 461a mov r2, r3
|
|
80083ea: 4b6f ldr r3, [pc, #444] @ (80085a8 <RadioSetTxConfig+0x20c>)
|
|
80083ec: f883 2045 strb.w r2, [r3, #69] @ 0x45
|
|
SubgRf.ModulationParams.Params.Gfsk.Fdev = fdev;
|
|
80083f0: 4a6d ldr r2, [pc, #436] @ (80085a8 <RadioSetTxConfig+0x20c>)
|
|
80083f2: 68bb ldr r3, [r7, #8]
|
|
80083f4: 6413 str r3, [r2, #64] @ 0x40
|
|
SubgRf.PacketParams.PacketType = PACKET_TYPE_GFSK;
|
|
80083f6: 4b6c ldr r3, [pc, #432] @ (80085a8 <RadioSetTxConfig+0x20c>)
|
|
80083f8: 2200 movs r2, #0
|
|
80083fa: 739a strb r2, [r3, #14]
|
|
SubgRf.PacketParams.Params.Gfsk.PreambleLength = ( preambleLen << 3 ); // convert byte into bit
|
|
80083fc: 8d3b ldrh r3, [r7, #40] @ 0x28
|
|
80083fe: 00db lsls r3, r3, #3
|
|
8008400: b29a uxth r2, r3
|
|
8008402: 4b69 ldr r3, [pc, #420] @ (80085a8 <RadioSetTxConfig+0x20c>)
|
|
8008404: 821a strh r2, [r3, #16]
|
|
SubgRf.PacketParams.Params.Gfsk.PreambleMinDetect = RADIO_PREAMBLE_DETECTOR_08_BITS;
|
|
8008406: 4b68 ldr r3, [pc, #416] @ (80085a8 <RadioSetTxConfig+0x20c>)
|
|
8008408: 2204 movs r2, #4
|
|
800840a: 749a strb r2, [r3, #18]
|
|
SubgRf.PacketParams.Params.Gfsk.SyncWordLength = 3 << 3 ; // convert byte into bit
|
|
800840c: 4b66 ldr r3, [pc, #408] @ (80085a8 <RadioSetTxConfig+0x20c>)
|
|
800840e: 2218 movs r2, #24
|
|
8008410: 74da strb r2, [r3, #19]
|
|
SubgRf.PacketParams.Params.Gfsk.AddrComp = RADIO_ADDRESSCOMP_FILT_OFF;
|
|
8008412: 4b65 ldr r3, [pc, #404] @ (80085a8 <RadioSetTxConfig+0x20c>)
|
|
8008414: 2200 movs r2, #0
|
|
8008416: 751a strb r2, [r3, #20]
|
|
SubgRf.PacketParams.Params.Gfsk.HeaderType = ( fixLen == true ) ? RADIO_PACKET_FIXED_LENGTH : RADIO_PACKET_VARIABLE_LENGTH;
|
|
8008418: f897 302c ldrb.w r3, [r7, #44] @ 0x2c
|
|
800841c: f083 0301 eor.w r3, r3, #1
|
|
8008420: b2db uxtb r3, r3
|
|
8008422: 461a mov r2, r3
|
|
8008424: 4b60 ldr r3, [pc, #384] @ (80085a8 <RadioSetTxConfig+0x20c>)
|
|
8008426: 755a strb r2, [r3, #21]
|
|
if( crcOn == true )
|
|
8008428: f897 3030 ldrb.w r3, [r7, #48] @ 0x30
|
|
800842c: 2b00 cmp r3, #0
|
|
800842e: d003 beq.n 8008438 <RadioSetTxConfig+0x9c>
|
|
SubgRf.PacketParams.Params.Gfsk.CrcLength = RADIO_CRC_2_BYTES_CCIT;
|
|
8008430: 4b5d ldr r3, [pc, #372] @ (80085a8 <RadioSetTxConfig+0x20c>)
|
|
8008432: 22f2 movs r2, #242 @ 0xf2
|
|
8008434: 75da strb r2, [r3, #23]
|
|
8008436: e002 b.n 800843e <RadioSetTxConfig+0xa2>
|
|
SubgRf.PacketParams.Params.Gfsk.CrcLength = RADIO_CRC_OFF;
|
|
8008438: 4b5b ldr r3, [pc, #364] @ (80085a8 <RadioSetTxConfig+0x20c>)
|
|
800843a: 2201 movs r2, #1
|
|
800843c: 75da strb r2, [r3, #23]
|
|
SubgRf.PacketParams.Params.Gfsk.DcFree = RADIO_DC_FREEWHITENING;
|
|
800843e: 4b5a ldr r3, [pc, #360] @ (80085a8 <RadioSetTxConfig+0x20c>)
|
|
8008440: 2201 movs r2, #1
|
|
8008442: 761a strb r2, [r3, #24]
|
|
RadioStandby( );
|
|
8008444: f000 fb39 bl 8008aba <RadioStandby>
|
|
RadioSetModem( MODEM_FSK );
|
|
8008448: 2000 movs r0, #0
|
|
800844a: f7ff fcc7 bl 8007ddc <RadioSetModem>
|
|
SUBGRF_SetModulationParams( &SubgRf.ModulationParams );
|
|
800844e: 4857 ldr r0, [pc, #348] @ (80085ac <RadioSetTxConfig+0x210>)
|
|
8008450: f002 f964 bl 800a71c <SUBGRF_SetModulationParams>
|
|
SUBGRF_SetPacketParams( &SubgRf.PacketParams );
|
|
8008454: 4856 ldr r0, [pc, #344] @ (80085b0 <RadioSetTxConfig+0x214>)
|
|
8008456: f002 fa2f bl 800a8b8 <SUBGRF_SetPacketParams>
|
|
SUBGRF_SetSyncWord( ( uint8_t[] ){ 0xC1, 0x94, 0xC1, 0x00, 0x00, 0x00, 0x00, 0x00 } );
|
|
800845a: 4a56 ldr r2, [pc, #344] @ (80085b4 <RadioSetTxConfig+0x218>)
|
|
800845c: f107 0310 add.w r3, r7, #16
|
|
8008460: e892 0003 ldmia.w r2, {r0, r1}
|
|
8008464: e883 0003 stmia.w r3, {r0, r1}
|
|
8008468: f107 0310 add.w r3, r7, #16
|
|
800846c: 4618 mov r0, r3
|
|
800846e: f001 fce8 bl 8009e42 <SUBGRF_SetSyncWord>
|
|
SUBGRF_SetWhiteningSeed( 0x01FF );
|
|
8008472: f240 10ff movw r0, #511 @ 0x1ff
|
|
8008476: f001 fd33 bl 8009ee0 <SUBGRF_SetWhiteningSeed>
|
|
break;
|
|
800847a: e078 b.n 800856e <RadioSetTxConfig+0x1d2>
|
|
SubgRf.ModulationParams.PacketType = PACKET_TYPE_LORA;
|
|
800847c: 4b4a ldr r3, [pc, #296] @ (80085a8 <RadioSetTxConfig+0x20c>)
|
|
800847e: 2201 movs r2, #1
|
|
8008480: f883 2038 strb.w r2, [r3, #56] @ 0x38
|
|
SubgRf.ModulationParams.Params.LoRa.SpreadingFactor = ( RadioLoRaSpreadingFactors_t ) datarate;
|
|
8008484: 6a3b ldr r3, [r7, #32]
|
|
8008486: b2da uxtb r2, r3
|
|
8008488: 4b47 ldr r3, [pc, #284] @ (80085a8 <RadioSetTxConfig+0x20c>)
|
|
800848a: f883 2050 strb.w r2, [r3, #80] @ 0x50
|
|
SubgRf.ModulationParams.Params.LoRa.Bandwidth = Bandwidths[bandwidth];
|
|
800848e: 4a4a ldr r2, [pc, #296] @ (80085b8 <RadioSetTxConfig+0x21c>)
|
|
8008490: 687b ldr r3, [r7, #4]
|
|
8008492: 4413 add r3, r2
|
|
8008494: 781a ldrb r2, [r3, #0]
|
|
8008496: 4b44 ldr r3, [pc, #272] @ (80085a8 <RadioSetTxConfig+0x20c>)
|
|
8008498: f883 2051 strb.w r2, [r3, #81] @ 0x51
|
|
SubgRf.ModulationParams.Params.LoRa.CodingRate= ( RadioLoRaCodingRates_t )coderate;
|
|
800849c: 4a42 ldr r2, [pc, #264] @ (80085a8 <RadioSetTxConfig+0x20c>)
|
|
800849e: f897 3024 ldrb.w r3, [r7, #36] @ 0x24
|
|
80084a2: f882 3052 strb.w r3, [r2, #82] @ 0x52
|
|
if( ( ( bandwidth == 0 ) && ( ( datarate == 11 ) || ( datarate == 12 ) ) ) ||
|
|
80084a6: 687b ldr r3, [r7, #4]
|
|
80084a8: 2b00 cmp r3, #0
|
|
80084aa: d105 bne.n 80084b8 <RadioSetTxConfig+0x11c>
|
|
80084ac: 6a3b ldr r3, [r7, #32]
|
|
80084ae: 2b0b cmp r3, #11
|
|
80084b0: d008 beq.n 80084c4 <RadioSetTxConfig+0x128>
|
|
80084b2: 6a3b ldr r3, [r7, #32]
|
|
80084b4: 2b0c cmp r3, #12
|
|
80084b6: d005 beq.n 80084c4 <RadioSetTxConfig+0x128>
|
|
80084b8: 687b ldr r3, [r7, #4]
|
|
80084ba: 2b01 cmp r3, #1
|
|
80084bc: d107 bne.n 80084ce <RadioSetTxConfig+0x132>
|
|
( ( bandwidth == 1 ) && ( datarate == 12 ) ) )
|
|
80084be: 6a3b ldr r3, [r7, #32]
|
|
80084c0: 2b0c cmp r3, #12
|
|
80084c2: d104 bne.n 80084ce <RadioSetTxConfig+0x132>
|
|
SubgRf.ModulationParams.Params.LoRa.LowDatarateOptimize = 0x01;
|
|
80084c4: 4b38 ldr r3, [pc, #224] @ (80085a8 <RadioSetTxConfig+0x20c>)
|
|
80084c6: 2201 movs r2, #1
|
|
80084c8: f883 2053 strb.w r2, [r3, #83] @ 0x53
|
|
80084cc: e003 b.n 80084d6 <RadioSetTxConfig+0x13a>
|
|
SubgRf.ModulationParams.Params.LoRa.LowDatarateOptimize = 0x00;
|
|
80084ce: 4b36 ldr r3, [pc, #216] @ (80085a8 <RadioSetTxConfig+0x20c>)
|
|
80084d0: 2200 movs r2, #0
|
|
80084d2: f883 2053 strb.w r2, [r3, #83] @ 0x53
|
|
SubgRf.PacketParams.PacketType = PACKET_TYPE_LORA;
|
|
80084d6: 4b34 ldr r3, [pc, #208] @ (80085a8 <RadioSetTxConfig+0x20c>)
|
|
80084d8: 2201 movs r2, #1
|
|
80084da: 739a strb r2, [r3, #14]
|
|
if( ( SubgRf.ModulationParams.Params.LoRa.SpreadingFactor == LORA_SF5 ) ||
|
|
80084dc: 4b32 ldr r3, [pc, #200] @ (80085a8 <RadioSetTxConfig+0x20c>)
|
|
80084de: f893 3050 ldrb.w r3, [r3, #80] @ 0x50
|
|
80084e2: 2b05 cmp r3, #5
|
|
80084e4: d004 beq.n 80084f0 <RadioSetTxConfig+0x154>
|
|
( SubgRf.ModulationParams.Params.LoRa.SpreadingFactor == LORA_SF6 ) )
|
|
80084e6: 4b30 ldr r3, [pc, #192] @ (80085a8 <RadioSetTxConfig+0x20c>)
|
|
80084e8: f893 3050 ldrb.w r3, [r3, #80] @ 0x50
|
|
if( ( SubgRf.ModulationParams.Params.LoRa.SpreadingFactor == LORA_SF5 ) ||
|
|
80084ec: 2b06 cmp r3, #6
|
|
80084ee: d10a bne.n 8008506 <RadioSetTxConfig+0x16a>
|
|
if( preambleLen < 12 )
|
|
80084f0: 8d3b ldrh r3, [r7, #40] @ 0x28
|
|
80084f2: 2b0b cmp r3, #11
|
|
80084f4: d803 bhi.n 80084fe <RadioSetTxConfig+0x162>
|
|
SubgRf.PacketParams.Params.LoRa.PreambleLength = 12;
|
|
80084f6: 4b2c ldr r3, [pc, #176] @ (80085a8 <RadioSetTxConfig+0x20c>)
|
|
80084f8: 220c movs r2, #12
|
|
80084fa: 839a strh r2, [r3, #28]
|
|
if( preambleLen < 12 )
|
|
80084fc: e006 b.n 800850c <RadioSetTxConfig+0x170>
|
|
SubgRf.PacketParams.Params.LoRa.PreambleLength = preambleLen;
|
|
80084fe: 4a2a ldr r2, [pc, #168] @ (80085a8 <RadioSetTxConfig+0x20c>)
|
|
8008500: 8d3b ldrh r3, [r7, #40] @ 0x28
|
|
8008502: 8393 strh r3, [r2, #28]
|
|
if( preambleLen < 12 )
|
|
8008504: e002 b.n 800850c <RadioSetTxConfig+0x170>
|
|
SubgRf.PacketParams.Params.LoRa.PreambleLength = preambleLen;
|
|
8008506: 4a28 ldr r2, [pc, #160] @ (80085a8 <RadioSetTxConfig+0x20c>)
|
|
8008508: 8d3b ldrh r3, [r7, #40] @ 0x28
|
|
800850a: 8393 strh r3, [r2, #28]
|
|
SubgRf.PacketParams.Params.LoRa.HeaderType = ( RadioLoRaPacketLengthsMode_t )fixLen;
|
|
800850c: f897 202c ldrb.w r2, [r7, #44] @ 0x2c
|
|
8008510: 4b25 ldr r3, [pc, #148] @ (80085a8 <RadioSetTxConfig+0x20c>)
|
|
8008512: 779a strb r2, [r3, #30]
|
|
SubgRf.PacketParams.Params.LoRa.PayloadLength = MaxPayloadLength;
|
|
8008514: 4b29 ldr r3, [pc, #164] @ (80085bc <RadioSetTxConfig+0x220>)
|
|
8008516: 781a ldrb r2, [r3, #0]
|
|
8008518: 4b23 ldr r3, [pc, #140] @ (80085a8 <RadioSetTxConfig+0x20c>)
|
|
800851a: 77da strb r2, [r3, #31]
|
|
SubgRf.PacketParams.Params.LoRa.CrcMode = ( RadioLoRaCrcModes_t )crcOn;
|
|
800851c: f897 2030 ldrb.w r2, [r7, #48] @ 0x30
|
|
8008520: 4b21 ldr r3, [pc, #132] @ (80085a8 <RadioSetTxConfig+0x20c>)
|
|
8008522: f883 2020 strb.w r2, [r3, #32]
|
|
SubgRf.PacketParams.Params.LoRa.InvertIQ = ( RadioLoRaIQModes_t )iqInverted;
|
|
8008526: f897 203c ldrb.w r2, [r7, #60] @ 0x3c
|
|
800852a: 4b1f ldr r3, [pc, #124] @ (80085a8 <RadioSetTxConfig+0x20c>)
|
|
800852c: f883 2021 strb.w r2, [r3, #33] @ 0x21
|
|
RadioStandby( );
|
|
8008530: f000 fac3 bl 8008aba <RadioStandby>
|
|
RadioSetModem( MODEM_LORA );
|
|
8008534: 2001 movs r0, #1
|
|
8008536: f7ff fc51 bl 8007ddc <RadioSetModem>
|
|
SUBGRF_SetModulationParams( &SubgRf.ModulationParams );
|
|
800853a: 481c ldr r0, [pc, #112] @ (80085ac <RadioSetTxConfig+0x210>)
|
|
800853c: f002 f8ee bl 800a71c <SUBGRF_SetModulationParams>
|
|
SUBGRF_SetPacketParams( &SubgRf.PacketParams );
|
|
8008540: 481b ldr r0, [pc, #108] @ (80085b0 <RadioSetTxConfig+0x214>)
|
|
8008542: f002 f9b9 bl 800a8b8 <SUBGRF_SetPacketParams>
|
|
break;
|
|
8008546: e012 b.n 800856e <RadioSetTxConfig+0x1d2>
|
|
RadioSetModem(MODEM_SIGFOX_TX);
|
|
8008548: 2004 movs r0, #4
|
|
800854a: f7ff fc47 bl 8007ddc <RadioSetModem>
|
|
SubgRf.ModulationParams.PacketType = PACKET_TYPE_BPSK;
|
|
800854e: 4b16 ldr r3, [pc, #88] @ (80085a8 <RadioSetTxConfig+0x20c>)
|
|
8008550: 2202 movs r2, #2
|
|
8008552: f883 2038 strb.w r2, [r3, #56] @ 0x38
|
|
SubgRf.ModulationParams.Params.Bpsk.BitRate = datarate;
|
|
8008556: 4a14 ldr r2, [pc, #80] @ (80085a8 <RadioSetTxConfig+0x20c>)
|
|
8008558: 6a3b ldr r3, [r7, #32]
|
|
800855a: 6493 str r3, [r2, #72] @ 0x48
|
|
SubgRf.ModulationParams.Params.Bpsk.ModulationShaping = MOD_SHAPING_DBPSK;
|
|
800855c: 4b12 ldr r3, [pc, #72] @ (80085a8 <RadioSetTxConfig+0x20c>)
|
|
800855e: 2216 movs r2, #22
|
|
8008560: f883 204c strb.w r2, [r3, #76] @ 0x4c
|
|
SUBGRF_SetModulationParams( &SubgRf.ModulationParams );
|
|
8008564: 4811 ldr r0, [pc, #68] @ (80085ac <RadioSetTxConfig+0x210>)
|
|
8008566: f002 f8d9 bl 800a71c <SUBGRF_SetModulationParams>
|
|
break;
|
|
800856a: e000 b.n 800856e <RadioSetTxConfig+0x1d2>
|
|
break;
|
|
800856c: bf00 nop
|
|
}
|
|
|
|
SubgRf.AntSwitchPaSelect = SUBGRF_SetRfTxPower( power );
|
|
800856e: f997 300e ldrsb.w r3, [r7, #14]
|
|
8008572: 4618 mov r0, r3
|
|
8008574: f002 fc1c bl 800adb0 <SUBGRF_SetRfTxPower>
|
|
8008578: 4603 mov r3, r0
|
|
800857a: 461a mov r2, r3
|
|
800857c: 4b0a ldr r3, [pc, #40] @ (80085a8 <RadioSetTxConfig+0x20c>)
|
|
800857e: f883 2056 strb.w r2, [r3, #86] @ 0x56
|
|
/* WORKAROUND - Trimming the output voltage power_ldo to 3.3V */
|
|
SUBGRF_WriteRegister(REG_DRV_CTRL, 0x7 << 1);
|
|
8008582: 210e movs r1, #14
|
|
8008584: f640 101f movw r0, #2335 @ 0x91f
|
|
8008588: f002 fadc bl 800ab44 <SUBGRF_WriteRegister>
|
|
RFW_SetAntSwitch( SubgRf.AntSwitchPaSelect );
|
|
800858c: 4b06 ldr r3, [pc, #24] @ (80085a8 <RadioSetTxConfig+0x20c>)
|
|
800858e: f893 3056 ldrb.w r3, [r3, #86] @ 0x56
|
|
8008592: 4618 mov r0, r3
|
|
8008594: f003 f866 bl 800b664 <RFW_SetAntSwitch>
|
|
SubgRf.TxTimeout = timeout;
|
|
8008598: 4a03 ldr r2, [pc, #12] @ (80085a8 <RadioSetTxConfig+0x20c>)
|
|
800859a: 6c3b ldr r3, [r7, #64] @ 0x40
|
|
800859c: 6053 str r3, [r2, #4]
|
|
}
|
|
800859e: bf00 nop
|
|
80085a0: 3718 adds r7, #24
|
|
80085a2: 46bd mov sp, r7
|
|
80085a4: bd80 pop {r7, pc}
|
|
80085a6: bf00 nop
|
|
80085a8: 200002f8 .word 0x200002f8
|
|
80085ac: 20000330 .word 0x20000330
|
|
80085b0: 20000306 .word 0x20000306
|
|
80085b4: 0800f8b4 .word 0x0800f8b4
|
|
80085b8: 08010450 .word 0x08010450
|
|
80085bc: 20000008 .word 0x20000008
|
|
|
|
080085c0 <RadioCheckRfFrequency>:
|
|
|
|
static bool RadioCheckRfFrequency( uint32_t frequency )
|
|
{
|
|
80085c0: b480 push {r7}
|
|
80085c2: b083 sub sp, #12
|
|
80085c4: af00 add r7, sp, #0
|
|
80085c6: 6078 str r0, [r7, #4]
|
|
return true;
|
|
80085c8: 2301 movs r3, #1
|
|
}
|
|
80085ca: 4618 mov r0, r3
|
|
80085cc: 370c adds r7, #12
|
|
80085ce: 46bd mov sp, r7
|
|
80085d0: bc80 pop {r7}
|
|
80085d2: 4770 bx lr
|
|
|
|
080085d4 <RadioGetLoRaBandwidthInHz>:
|
|
|
|
static uint32_t RadioGetLoRaBandwidthInHz( RadioLoRaBandwidths_t bw )
|
|
{
|
|
80085d4: b480 push {r7}
|
|
80085d6: b085 sub sp, #20
|
|
80085d8: af00 add r7, sp, #0
|
|
80085da: 4603 mov r3, r0
|
|
80085dc: 71fb strb r3, [r7, #7]
|
|
uint32_t bandwidthInHz = 0;
|
|
80085de: 2300 movs r3, #0
|
|
80085e0: 60fb str r3, [r7, #12]
|
|
|
|
switch( bw )
|
|
80085e2: 79fb ldrb r3, [r7, #7]
|
|
80085e4: 2b0a cmp r3, #10
|
|
80085e6: d83e bhi.n 8008666 <RadioGetLoRaBandwidthInHz+0x92>
|
|
80085e8: a201 add r2, pc, #4 @ (adr r2, 80085f0 <RadioGetLoRaBandwidthInHz+0x1c>)
|
|
80085ea: f852 f023 ldr.w pc, [r2, r3, lsl #2]
|
|
80085ee: bf00 nop
|
|
80085f0: 0800861d .word 0x0800861d
|
|
80085f4: 0800862d .word 0x0800862d
|
|
80085f8: 0800863d .word 0x0800863d
|
|
80085fc: 0800864d .word 0x0800864d
|
|
8008600: 08008655 .word 0x08008655
|
|
8008604: 0800865b .word 0x0800865b
|
|
8008608: 08008661 .word 0x08008661
|
|
800860c: 08008667 .word 0x08008667
|
|
8008610: 08008625 .word 0x08008625
|
|
8008614: 08008635 .word 0x08008635
|
|
8008618: 08008645 .word 0x08008645
|
|
{
|
|
case LORA_BW_007:
|
|
bandwidthInHz = 7812UL;
|
|
800861c: f641 6384 movw r3, #7812 @ 0x1e84
|
|
8008620: 60fb str r3, [r7, #12]
|
|
break;
|
|
8008622: e020 b.n 8008666 <RadioGetLoRaBandwidthInHz+0x92>
|
|
case LORA_BW_010:
|
|
bandwidthInHz = 10417UL;
|
|
8008624: f642 03b1 movw r3, #10417 @ 0x28b1
|
|
8008628: 60fb str r3, [r7, #12]
|
|
break;
|
|
800862a: e01c b.n 8008666 <RadioGetLoRaBandwidthInHz+0x92>
|
|
case LORA_BW_015:
|
|
bandwidthInHz = 15625UL;
|
|
800862c: f643 5309 movw r3, #15625 @ 0x3d09
|
|
8008630: 60fb str r3, [r7, #12]
|
|
break;
|
|
8008632: e018 b.n 8008666 <RadioGetLoRaBandwidthInHz+0x92>
|
|
case LORA_BW_020:
|
|
bandwidthInHz = 20833UL;
|
|
8008634: f245 1361 movw r3, #20833 @ 0x5161
|
|
8008638: 60fb str r3, [r7, #12]
|
|
break;
|
|
800863a: e014 b.n 8008666 <RadioGetLoRaBandwidthInHz+0x92>
|
|
case LORA_BW_031:
|
|
bandwidthInHz = 31250UL;
|
|
800863c: f647 2312 movw r3, #31250 @ 0x7a12
|
|
8008640: 60fb str r3, [r7, #12]
|
|
break;
|
|
8008642: e010 b.n 8008666 <RadioGetLoRaBandwidthInHz+0x92>
|
|
case LORA_BW_041:
|
|
bandwidthInHz = 41667UL;
|
|
8008644: f24a 23c3 movw r3, #41667 @ 0xa2c3
|
|
8008648: 60fb str r3, [r7, #12]
|
|
break;
|
|
800864a: e00c b.n 8008666 <RadioGetLoRaBandwidthInHz+0x92>
|
|
case LORA_BW_062:
|
|
bandwidthInHz = 62500UL;
|
|
800864c: f24f 4324 movw r3, #62500 @ 0xf424
|
|
8008650: 60fb str r3, [r7, #12]
|
|
break;
|
|
8008652: e008 b.n 8008666 <RadioGetLoRaBandwidthInHz+0x92>
|
|
case LORA_BW_125:
|
|
bandwidthInHz = 125000UL;
|
|
8008654: 4b07 ldr r3, [pc, #28] @ (8008674 <RadioGetLoRaBandwidthInHz+0xa0>)
|
|
8008656: 60fb str r3, [r7, #12]
|
|
break;
|
|
8008658: e005 b.n 8008666 <RadioGetLoRaBandwidthInHz+0x92>
|
|
case LORA_BW_250:
|
|
bandwidthInHz = 250000UL;
|
|
800865a: 4b07 ldr r3, [pc, #28] @ (8008678 <RadioGetLoRaBandwidthInHz+0xa4>)
|
|
800865c: 60fb str r3, [r7, #12]
|
|
break;
|
|
800865e: e002 b.n 8008666 <RadioGetLoRaBandwidthInHz+0x92>
|
|
case LORA_BW_500:
|
|
bandwidthInHz = 500000UL;
|
|
8008660: 4b06 ldr r3, [pc, #24] @ (800867c <RadioGetLoRaBandwidthInHz+0xa8>)
|
|
8008662: 60fb str r3, [r7, #12]
|
|
break;
|
|
8008664: bf00 nop
|
|
}
|
|
|
|
return bandwidthInHz;
|
|
8008666: 68fb ldr r3, [r7, #12]
|
|
}
|
|
8008668: 4618 mov r0, r3
|
|
800866a: 3714 adds r7, #20
|
|
800866c: 46bd mov sp, r7
|
|
800866e: bc80 pop {r7}
|
|
8008670: 4770 bx lr
|
|
8008672: bf00 nop
|
|
8008674: 0001e848 .word 0x0001e848
|
|
8008678: 0003d090 .word 0x0003d090
|
|
800867c: 0007a120 .word 0x0007a120
|
|
|
|
08008680 <RadioGetGfskTimeOnAirNumerator>:
|
|
|
|
static uint32_t RadioGetGfskTimeOnAirNumerator( uint32_t datarate, uint8_t coderate,
|
|
uint16_t preambleLen, bool fixLen, uint8_t payloadLen,
|
|
bool crcOn )
|
|
{
|
|
8008680: b480 push {r7}
|
|
8008682: b083 sub sp, #12
|
|
8008684: af00 add r7, sp, #0
|
|
8008686: 6078 str r0, [r7, #4]
|
|
8008688: 4608 mov r0, r1
|
|
800868a: 4611 mov r1, r2
|
|
800868c: 461a mov r2, r3
|
|
800868e: 4603 mov r3, r0
|
|
8008690: 70fb strb r3, [r7, #3]
|
|
8008692: 460b mov r3, r1
|
|
8008694: 803b strh r3, [r7, #0]
|
|
8008696: 4613 mov r3, r2
|
|
8008698: 70bb strb r3, [r7, #2]
|
|
return ( preambleLen << 3 ) +
|
|
800869a: 883b ldrh r3, [r7, #0]
|
|
800869c: 00db lsls r3, r3, #3
|
|
( ( fixLen == false ) ? 8 : 0 ) + 24 +
|
|
800869e: 78ba ldrb r2, [r7, #2]
|
|
80086a0: f082 0201 eor.w r2, r2, #1
|
|
80086a4: b2d2 uxtb r2, r2
|
|
80086a6: 2a00 cmp r2, #0
|
|
80086a8: d001 beq.n 80086ae <RadioGetGfskTimeOnAirNumerator+0x2e>
|
|
80086aa: 2208 movs r2, #8
|
|
80086ac: e000 b.n 80086b0 <RadioGetGfskTimeOnAirNumerator+0x30>
|
|
80086ae: 2200 movs r2, #0
|
|
return ( preambleLen << 3 ) +
|
|
80086b0: 4413 add r3, r2
|
|
( ( fixLen == false ) ? 8 : 0 ) + 24 +
|
|
80086b2: f103 0218 add.w r2, r3, #24
|
|
( ( payloadLen + ( ( crcOn == true ) ? 2 : 0 ) ) << 3 );
|
|
80086b6: 7c3b ldrb r3, [r7, #16]
|
|
80086b8: 7d39 ldrb r1, [r7, #20]
|
|
80086ba: 2900 cmp r1, #0
|
|
80086bc: d001 beq.n 80086c2 <RadioGetGfskTimeOnAirNumerator+0x42>
|
|
80086be: 2102 movs r1, #2
|
|
80086c0: e000 b.n 80086c4 <RadioGetGfskTimeOnAirNumerator+0x44>
|
|
80086c2: 2100 movs r1, #0
|
|
80086c4: 440b add r3, r1
|
|
80086c6: 00db lsls r3, r3, #3
|
|
( ( fixLen == false ) ? 8 : 0 ) + 24 +
|
|
80086c8: 4413 add r3, r2
|
|
}
|
|
80086ca: 4618 mov r0, r3
|
|
80086cc: 370c adds r7, #12
|
|
80086ce: 46bd mov sp, r7
|
|
80086d0: bc80 pop {r7}
|
|
80086d2: 4770 bx lr
|
|
|
|
080086d4 <RadioGetLoRaTimeOnAirNumerator>:
|
|
|
|
static uint32_t RadioGetLoRaTimeOnAirNumerator( uint32_t bandwidth,
|
|
uint32_t datarate, uint8_t coderate,
|
|
uint16_t preambleLen, bool fixLen, uint8_t payloadLen,
|
|
bool crcOn )
|
|
{
|
|
80086d4: b480 push {r7}
|
|
80086d6: b08b sub sp, #44 @ 0x2c
|
|
80086d8: af00 add r7, sp, #0
|
|
80086da: 60f8 str r0, [r7, #12]
|
|
80086dc: 60b9 str r1, [r7, #8]
|
|
80086de: 4611 mov r1, r2
|
|
80086e0: 461a mov r2, r3
|
|
80086e2: 460b mov r3, r1
|
|
80086e4: 71fb strb r3, [r7, #7]
|
|
80086e6: 4613 mov r3, r2
|
|
80086e8: 80bb strh r3, [r7, #4]
|
|
int32_t crDenom = coderate + 4;
|
|
80086ea: 79fb ldrb r3, [r7, #7]
|
|
80086ec: 3304 adds r3, #4
|
|
80086ee: 617b str r3, [r7, #20]
|
|
bool lowDatareOptimize = false;
|
|
80086f0: 2300 movs r3, #0
|
|
80086f2: f887 3027 strb.w r3, [r7, #39] @ 0x27
|
|
|
|
// Ensure that the preamble length is at least 12 symbols when using SF5 or SF6
|
|
if( ( datarate == 5 ) || ( datarate == 6 ) )
|
|
80086f6: 68bb ldr r3, [r7, #8]
|
|
80086f8: 2b05 cmp r3, #5
|
|
80086fa: d002 beq.n 8008702 <RadioGetLoRaTimeOnAirNumerator+0x2e>
|
|
80086fc: 68bb ldr r3, [r7, #8]
|
|
80086fe: 2b06 cmp r3, #6
|
|
8008700: d104 bne.n 800870c <RadioGetLoRaTimeOnAirNumerator+0x38>
|
|
{
|
|
if( preambleLen < 12 )
|
|
8008702: 88bb ldrh r3, [r7, #4]
|
|
8008704: 2b0b cmp r3, #11
|
|
8008706: d801 bhi.n 800870c <RadioGetLoRaTimeOnAirNumerator+0x38>
|
|
{
|
|
preambleLen = 12;
|
|
8008708: 230c movs r3, #12
|
|
800870a: 80bb strh r3, [r7, #4]
|
|
}
|
|
}
|
|
|
|
if( ( ( bandwidth == 0 ) && ( ( datarate == 11 ) || ( datarate == 12 ) ) ) ||
|
|
800870c: 68fb ldr r3, [r7, #12]
|
|
800870e: 2b00 cmp r3, #0
|
|
8008710: d105 bne.n 800871e <RadioGetLoRaTimeOnAirNumerator+0x4a>
|
|
8008712: 68bb ldr r3, [r7, #8]
|
|
8008714: 2b0b cmp r3, #11
|
|
8008716: d008 beq.n 800872a <RadioGetLoRaTimeOnAirNumerator+0x56>
|
|
8008718: 68bb ldr r3, [r7, #8]
|
|
800871a: 2b0c cmp r3, #12
|
|
800871c: d005 beq.n 800872a <RadioGetLoRaTimeOnAirNumerator+0x56>
|
|
800871e: 68fb ldr r3, [r7, #12]
|
|
8008720: 2b01 cmp r3, #1
|
|
8008722: d105 bne.n 8008730 <RadioGetLoRaTimeOnAirNumerator+0x5c>
|
|
( ( bandwidth == 1 ) && ( datarate == 12 ) ) )
|
|
8008724: 68bb ldr r3, [r7, #8]
|
|
8008726: 2b0c cmp r3, #12
|
|
8008728: d102 bne.n 8008730 <RadioGetLoRaTimeOnAirNumerator+0x5c>
|
|
{
|
|
lowDatareOptimize = true;
|
|
800872a: 2301 movs r3, #1
|
|
800872c: f887 3027 strb.w r3, [r7, #39] @ 0x27
|
|
}
|
|
|
|
int32_t ceilDenominator;
|
|
int32_t ceilNumerator = ( payloadLen << 3 ) +
|
|
8008730: f897 3034 ldrb.w r3, [r7, #52] @ 0x34
|
|
8008734: 00db lsls r3, r3, #3
|
|
( crcOn ? 16 : 0 ) -
|
|
8008736: f897 2038 ldrb.w r2, [r7, #56] @ 0x38
|
|
800873a: 2a00 cmp r2, #0
|
|
800873c: d001 beq.n 8008742 <RadioGetLoRaTimeOnAirNumerator+0x6e>
|
|
800873e: 2210 movs r2, #16
|
|
8008740: e000 b.n 8008744 <RadioGetLoRaTimeOnAirNumerator+0x70>
|
|
8008742: 2200 movs r2, #0
|
|
int32_t ceilNumerator = ( payloadLen << 3 ) +
|
|
8008744: 4413 add r3, r2
|
|
8008746: 461a mov r2, r3
|
|
( 4 * datarate ) +
|
|
8008748: 68bb ldr r3, [r7, #8]
|
|
800874a: 009b lsls r3, r3, #2
|
|
( crcOn ? 16 : 0 ) -
|
|
800874c: 1ad3 subs r3, r2, r3
|
|
( fixLen ? 0 : 20 );
|
|
800874e: f897 2030 ldrb.w r2, [r7, #48] @ 0x30
|
|
8008752: 2a00 cmp r2, #0
|
|
8008754: d001 beq.n 800875a <RadioGetLoRaTimeOnAirNumerator+0x86>
|
|
8008756: 2200 movs r2, #0
|
|
8008758: e000 b.n 800875c <RadioGetLoRaTimeOnAirNumerator+0x88>
|
|
800875a: 2214 movs r2, #20
|
|
( 4 * datarate ) +
|
|
800875c: 4413 add r3, r2
|
|
int32_t ceilNumerator = ( payloadLen << 3 ) +
|
|
800875e: 61fb str r3, [r7, #28]
|
|
|
|
if( datarate <= 6 )
|
|
8008760: 68bb ldr r3, [r7, #8]
|
|
8008762: 2b06 cmp r3, #6
|
|
8008764: d803 bhi.n 800876e <RadioGetLoRaTimeOnAirNumerator+0x9a>
|
|
{
|
|
ceilDenominator = 4 * datarate;
|
|
8008766: 68bb ldr r3, [r7, #8]
|
|
8008768: 009b lsls r3, r3, #2
|
|
800876a: 623b str r3, [r7, #32]
|
|
800876c: e00e b.n 800878c <RadioGetLoRaTimeOnAirNumerator+0xb8>
|
|
}
|
|
else
|
|
{
|
|
ceilNumerator += 8;
|
|
800876e: 69fb ldr r3, [r7, #28]
|
|
8008770: 3308 adds r3, #8
|
|
8008772: 61fb str r3, [r7, #28]
|
|
|
|
if( lowDatareOptimize == true )
|
|
8008774: f897 3027 ldrb.w r3, [r7, #39] @ 0x27
|
|
8008778: 2b00 cmp r3, #0
|
|
800877a: d004 beq.n 8008786 <RadioGetLoRaTimeOnAirNumerator+0xb2>
|
|
{
|
|
ceilDenominator = 4 * ( datarate - 2 );
|
|
800877c: 68bb ldr r3, [r7, #8]
|
|
800877e: 3b02 subs r3, #2
|
|
8008780: 009b lsls r3, r3, #2
|
|
8008782: 623b str r3, [r7, #32]
|
|
8008784: e002 b.n 800878c <RadioGetLoRaTimeOnAirNumerator+0xb8>
|
|
}
|
|
else
|
|
{
|
|
ceilDenominator = 4 * datarate;
|
|
8008786: 68bb ldr r3, [r7, #8]
|
|
8008788: 009b lsls r3, r3, #2
|
|
800878a: 623b str r3, [r7, #32]
|
|
}
|
|
}
|
|
|
|
if( ceilNumerator < 0 )
|
|
800878c: 69fb ldr r3, [r7, #28]
|
|
800878e: 2b00 cmp r3, #0
|
|
8008790: da01 bge.n 8008796 <RadioGetLoRaTimeOnAirNumerator+0xc2>
|
|
{
|
|
ceilNumerator = 0;
|
|
8008792: 2300 movs r3, #0
|
|
8008794: 61fb str r3, [r7, #28]
|
|
}
|
|
|
|
// Perform integral ceil()
|
|
int32_t intermediate =
|
|
( ( ceilNumerator + ceilDenominator - 1 ) / ceilDenominator ) * crDenom + preambleLen + 12;
|
|
8008796: 69fa ldr r2, [r7, #28]
|
|
8008798: 6a3b ldr r3, [r7, #32]
|
|
800879a: 4413 add r3, r2
|
|
800879c: 1e5a subs r2, r3, #1
|
|
800879e: 6a3b ldr r3, [r7, #32]
|
|
80087a0: fb92 f3f3 sdiv r3, r2, r3
|
|
80087a4: 697a ldr r2, [r7, #20]
|
|
80087a6: fb03 f202 mul.w r2, r3, r2
|
|
80087aa: 88bb ldrh r3, [r7, #4]
|
|
80087ac: 4413 add r3, r2
|
|
int32_t intermediate =
|
|
80087ae: 330c adds r3, #12
|
|
80087b0: 61bb str r3, [r7, #24]
|
|
|
|
if( datarate <= 6 )
|
|
80087b2: 68bb ldr r3, [r7, #8]
|
|
80087b4: 2b06 cmp r3, #6
|
|
80087b6: d802 bhi.n 80087be <RadioGetLoRaTimeOnAirNumerator+0xea>
|
|
{
|
|
intermediate += 2;
|
|
80087b8: 69bb ldr r3, [r7, #24]
|
|
80087ba: 3302 adds r3, #2
|
|
80087bc: 61bb str r3, [r7, #24]
|
|
}
|
|
|
|
return ( uint32_t )( ( 4 * intermediate + 1 ) * ( 1 << ( datarate - 2 ) ) );
|
|
80087be: 69bb ldr r3, [r7, #24]
|
|
80087c0: 009b lsls r3, r3, #2
|
|
80087c2: 1c5a adds r2, r3, #1
|
|
80087c4: 68bb ldr r3, [r7, #8]
|
|
80087c6: 3b02 subs r3, #2
|
|
80087c8: fa02 f303 lsl.w r3, r2, r3
|
|
}
|
|
80087cc: 4618 mov r0, r3
|
|
80087ce: 372c adds r7, #44 @ 0x2c
|
|
80087d0: 46bd mov sp, r7
|
|
80087d2: bc80 pop {r7}
|
|
80087d4: 4770 bx lr
|
|
...
|
|
|
|
080087d8 <RadioTimeOnAir>:
|
|
|
|
static uint32_t RadioTimeOnAir( RadioModems_t modem, uint32_t bandwidth,
|
|
uint32_t datarate, uint8_t coderate,
|
|
uint16_t preambleLen, bool fixLen, uint8_t payloadLen,
|
|
bool crcOn )
|
|
{
|
|
80087d8: b580 push {r7, lr}
|
|
80087da: b08a sub sp, #40 @ 0x28
|
|
80087dc: af04 add r7, sp, #16
|
|
80087de: 60b9 str r1, [r7, #8]
|
|
80087e0: 607a str r2, [r7, #4]
|
|
80087e2: 461a mov r2, r3
|
|
80087e4: 4603 mov r3, r0
|
|
80087e6: 73fb strb r3, [r7, #15]
|
|
80087e8: 4613 mov r3, r2
|
|
80087ea: 73bb strb r3, [r7, #14]
|
|
uint32_t numerator = 0;
|
|
80087ec: 2300 movs r3, #0
|
|
80087ee: 617b str r3, [r7, #20]
|
|
uint32_t denominator = 1;
|
|
80087f0: 2301 movs r3, #1
|
|
80087f2: 613b str r3, [r7, #16]
|
|
|
|
switch( modem )
|
|
80087f4: 7bfb ldrb r3, [r7, #15]
|
|
80087f6: 2b00 cmp r3, #0
|
|
80087f8: d002 beq.n 8008800 <RadioTimeOnAir+0x28>
|
|
80087fa: 2b01 cmp r3, #1
|
|
80087fc: d017 beq.n 800882e <RadioTimeOnAir+0x56>
|
|
fixLen, payloadLen, crcOn );
|
|
denominator = RadioGetLoRaBandwidthInHz( Bandwidths[bandwidth] );
|
|
}
|
|
break;
|
|
default:
|
|
break;
|
|
80087fe: e035 b.n 800886c <RadioTimeOnAir+0x94>
|
|
numerator = 1000U * RadioGetGfskTimeOnAirNumerator( datarate, coderate,
|
|
8008800: f897 0024 ldrb.w r0, [r7, #36] @ 0x24
|
|
8008804: 8c3a ldrh r2, [r7, #32]
|
|
8008806: 7bb9 ldrb r1, [r7, #14]
|
|
8008808: f897 302c ldrb.w r3, [r7, #44] @ 0x2c
|
|
800880c: 9301 str r3, [sp, #4]
|
|
800880e: f897 3028 ldrb.w r3, [r7, #40] @ 0x28
|
|
8008812: 9300 str r3, [sp, #0]
|
|
8008814: 4603 mov r3, r0
|
|
8008816: 6878 ldr r0, [r7, #4]
|
|
8008818: f7ff ff32 bl 8008680 <RadioGetGfskTimeOnAirNumerator>
|
|
800881c: 4603 mov r3, r0
|
|
800881e: f44f 727a mov.w r2, #1000 @ 0x3e8
|
|
8008822: fb02 f303 mul.w r3, r2, r3
|
|
8008826: 617b str r3, [r7, #20]
|
|
denominator = datarate;
|
|
8008828: 687b ldr r3, [r7, #4]
|
|
800882a: 613b str r3, [r7, #16]
|
|
break;
|
|
800882c: e01e b.n 800886c <RadioTimeOnAir+0x94>
|
|
numerator = 1000U * RadioGetLoRaTimeOnAirNumerator( bandwidth, datarate,
|
|
800882e: 8c39 ldrh r1, [r7, #32]
|
|
8008830: 7bba ldrb r2, [r7, #14]
|
|
8008832: f897 302c ldrb.w r3, [r7, #44] @ 0x2c
|
|
8008836: 9302 str r3, [sp, #8]
|
|
8008838: f897 3028 ldrb.w r3, [r7, #40] @ 0x28
|
|
800883c: 9301 str r3, [sp, #4]
|
|
800883e: f897 3024 ldrb.w r3, [r7, #36] @ 0x24
|
|
8008842: 9300 str r3, [sp, #0]
|
|
8008844: 460b mov r3, r1
|
|
8008846: 6879 ldr r1, [r7, #4]
|
|
8008848: 68b8 ldr r0, [r7, #8]
|
|
800884a: f7ff ff43 bl 80086d4 <RadioGetLoRaTimeOnAirNumerator>
|
|
800884e: 4603 mov r3, r0
|
|
8008850: f44f 727a mov.w r2, #1000 @ 0x3e8
|
|
8008854: fb02 f303 mul.w r3, r2, r3
|
|
8008858: 617b str r3, [r7, #20]
|
|
denominator = RadioGetLoRaBandwidthInHz( Bandwidths[bandwidth] );
|
|
800885a: 4a0a ldr r2, [pc, #40] @ (8008884 <RadioTimeOnAir+0xac>)
|
|
800885c: 68bb ldr r3, [r7, #8]
|
|
800885e: 4413 add r3, r2
|
|
8008860: 781b ldrb r3, [r3, #0]
|
|
8008862: 4618 mov r0, r3
|
|
8008864: f7ff feb6 bl 80085d4 <RadioGetLoRaBandwidthInHz>
|
|
8008868: 6138 str r0, [r7, #16]
|
|
break;
|
|
800886a: bf00 nop
|
|
}
|
|
// Perform integral ceil()
|
|
return DIVC( numerator, denominator );
|
|
800886c: 697a ldr r2, [r7, #20]
|
|
800886e: 693b ldr r3, [r7, #16]
|
|
8008870: 4413 add r3, r2
|
|
8008872: 1e5a subs r2, r3, #1
|
|
8008874: 693b ldr r3, [r7, #16]
|
|
8008876: fbb2 f3f3 udiv r3, r2, r3
|
|
}
|
|
800887a: 4618 mov r0, r3
|
|
800887c: 3718 adds r7, #24
|
|
800887e: 46bd mov sp, r7
|
|
8008880: bd80 pop {r7, pc}
|
|
8008882: bf00 nop
|
|
8008884: 08010450 .word 0x08010450
|
|
|
|
08008888 <RadioSend>:
|
|
|
|
static radio_status_t RadioSend( uint8_t *buffer, uint8_t size )
|
|
{
|
|
8008888: b580 push {r7, lr}
|
|
800888a: b084 sub sp, #16
|
|
800888c: af00 add r7, sp, #0
|
|
800888e: 6078 str r0, [r7, #4]
|
|
8008890: 460b mov r3, r1
|
|
8008892: 70fb strb r3, [r7, #3]
|
|
SUBGRF_SetDioIrqParams( IRQ_TX_DONE | IRQ_RX_TX_TIMEOUT | IRQ_TX_DBG,
|
|
8008894: 2300 movs r3, #0
|
|
8008896: 2200 movs r2, #0
|
|
8008898: f240 2101 movw r1, #513 @ 0x201
|
|
800889c: f240 2001 movw r0, #513 @ 0x201
|
|
80088a0: f001 fda6 bl 800a3f0 <SUBGRF_SetDioIrqParams>
|
|
IRQ_TX_DONE | IRQ_RX_TX_TIMEOUT | IRQ_TX_DBG,
|
|
IRQ_RADIO_NONE,
|
|
IRQ_RADIO_NONE );
|
|
|
|
/* Set DBG pin */
|
|
DBG_GPIO_RADIO_TX( SET );
|
|
80088a4: f44f 5100 mov.w r1, #8192 @ 0x2000
|
|
80088a8: 4874 ldr r0, [pc, #464] @ (8008a7c <RadioSend+0x1f4>)
|
|
80088aa: f7ff fa09 bl 8007cc0 <LL_GPIO_SetOutputPin>
|
|
|
|
/* Set RF switch */
|
|
SUBGRF_SetSwitch( SubgRf.AntSwitchPaSelect, RFSWITCH_TX );
|
|
80088ae: 4b74 ldr r3, [pc, #464] @ (8008a80 <RadioSend+0x1f8>)
|
|
80088b0: f893 3056 ldrb.w r3, [r3, #86] @ 0x56
|
|
80088b4: 2101 movs r1, #1
|
|
80088b6: 4618 mov r0, r3
|
|
80088b8: f002 fa52 bl 800ad60 <SUBGRF_SetSwitch>
|
|
/* WORKAROUND - Modulation Quality with 500 kHz LoRaTM Bandwidth*/
|
|
/* RegTxModulation = @address 0x0889 */
|
|
if( ( SubgRf.Modem == MODEM_LORA ) && ( SubgRf.ModulationParams.Params.LoRa.Bandwidth == LORA_BW_500 ) )
|
|
80088bc: 4b70 ldr r3, [pc, #448] @ (8008a80 <RadioSend+0x1f8>)
|
|
80088be: 781b ldrb r3, [r3, #0]
|
|
80088c0: 2b01 cmp r3, #1
|
|
80088c2: d112 bne.n 80088ea <RadioSend+0x62>
|
|
80088c4: 4b6e ldr r3, [pc, #440] @ (8008a80 <RadioSend+0x1f8>)
|
|
80088c6: f893 3051 ldrb.w r3, [r3, #81] @ 0x51
|
|
80088ca: 2b06 cmp r3, #6
|
|
80088cc: d10d bne.n 80088ea <RadioSend+0x62>
|
|
{
|
|
SUBGRF_WriteRegister( SUBGHZ_SDCFG0R, SUBGRF_ReadRegister( SUBGHZ_SDCFG0R ) & ~( 1 << 2 ) );
|
|
80088ce: f640 0089 movw r0, #2185 @ 0x889
|
|
80088d2: f002 f959 bl 800ab88 <SUBGRF_ReadRegister>
|
|
80088d6: 4603 mov r3, r0
|
|
80088d8: f023 0304 bic.w r3, r3, #4
|
|
80088dc: b2db uxtb r3, r3
|
|
80088de: 4619 mov r1, r3
|
|
80088e0: f640 0089 movw r0, #2185 @ 0x889
|
|
80088e4: f002 f92e bl 800ab44 <SUBGRF_WriteRegister>
|
|
80088e8: e00c b.n 8008904 <RadioSend+0x7c>
|
|
}
|
|
else
|
|
{
|
|
SUBGRF_WriteRegister( SUBGHZ_SDCFG0R, SUBGRF_ReadRegister( SUBGHZ_SDCFG0R ) | ( 1 << 2 ) );
|
|
80088ea: f640 0089 movw r0, #2185 @ 0x889
|
|
80088ee: f002 f94b bl 800ab88 <SUBGRF_ReadRegister>
|
|
80088f2: 4603 mov r3, r0
|
|
80088f4: f043 0304 orr.w r3, r3, #4
|
|
80088f8: b2db uxtb r3, r3
|
|
80088fa: 4619 mov r1, r3
|
|
80088fc: f640 0089 movw r0, #2185 @ 0x889
|
|
8008900: f002 f920 bl 800ab44 <SUBGRF_WriteRegister>
|
|
}
|
|
else
|
|
#endif /* RADIO_LR_FHSS_IS_ON == 1 */
|
|
{
|
|
/* WORKAROUND END */
|
|
switch( SubgRf.Modem )
|
|
8008904: 4b5e ldr r3, [pc, #376] @ (8008a80 <RadioSend+0x1f8>)
|
|
8008906: 781b ldrb r3, [r3, #0]
|
|
8008908: 2b04 cmp r3, #4
|
|
800890a: f200 80a7 bhi.w 8008a5c <RadioSend+0x1d4>
|
|
800890e: a201 add r2, pc, #4 @ (adr r2, 8008914 <RadioSend+0x8c>)
|
|
8008910: f852 f023 ldr.w pc, [r2, r3, lsl #2]
|
|
8008914: 08008943 .word 0x08008943
|
|
8008918: 08008929 .word 0x08008929
|
|
800891c: 08008943 .word 0x08008943
|
|
8008920: 080089a5 .word 0x080089a5
|
|
8008924: 080089c5 .word 0x080089c5
|
|
{
|
|
case MODEM_LORA:
|
|
{
|
|
SubgRf.PacketParams.Params.LoRa.PayloadLength = size;
|
|
8008928: 4a55 ldr r2, [pc, #340] @ (8008a80 <RadioSend+0x1f8>)
|
|
800892a: 78fb ldrb r3, [r7, #3]
|
|
800892c: 77d3 strb r3, [r2, #31]
|
|
SUBGRF_SetPacketParams( &SubgRf.PacketParams );
|
|
800892e: 4855 ldr r0, [pc, #340] @ (8008a84 <RadioSend+0x1fc>)
|
|
8008930: f001 ffc2 bl 800a8b8 <SUBGRF_SetPacketParams>
|
|
SUBGRF_SendPayload( buffer, size, 0 );
|
|
8008934: 78fb ldrb r3, [r7, #3]
|
|
8008936: 2200 movs r2, #0
|
|
8008938: 4619 mov r1, r3
|
|
800893a: 6878 ldr r0, [r7, #4]
|
|
800893c: f001 fa6e bl 8009e1c <SUBGRF_SendPayload>
|
|
break;
|
|
8008940: e08d b.n 8008a5e <RadioSend+0x1d6>
|
|
}
|
|
case MODEM_MSK:
|
|
case MODEM_FSK:
|
|
{
|
|
if ( 1UL == RFW_Is_Init( ) )
|
|
8008942: f002 fe7b bl 800b63c <RFW_Is_Init>
|
|
8008946: 4603 mov r3, r0
|
|
8008948: 2b01 cmp r3, #1
|
|
800894a: d11e bne.n 800898a <RadioSend+0x102>
|
|
{
|
|
uint8_t outsize;
|
|
if ( 0UL == RFW_TransmitInit( buffer,size, &outsize ) )
|
|
800894c: f107 020d add.w r2, r7, #13
|
|
8008950: 78fb ldrb r3, [r7, #3]
|
|
8008952: 4619 mov r1, r3
|
|
8008954: 6878 ldr r0, [r7, #4]
|
|
8008956: f002 fe95 bl 800b684 <RFW_TransmitInit>
|
|
800895a: 4603 mov r3, r0
|
|
800895c: 2b00 cmp r3, #0
|
|
800895e: d10c bne.n 800897a <RadioSend+0xf2>
|
|
{
|
|
SubgRf.PacketParams.Params.Gfsk.PayloadLength = outsize;
|
|
8008960: 7b7a ldrb r2, [r7, #13]
|
|
8008962: 4b47 ldr r3, [pc, #284] @ (8008a80 <RadioSend+0x1f8>)
|
|
8008964: 759a strb r2, [r3, #22]
|
|
SUBGRF_SetPacketParams( &SubgRf.PacketParams );
|
|
8008966: 4847 ldr r0, [pc, #284] @ (8008a84 <RadioSend+0x1fc>)
|
|
8008968: f001 ffa6 bl 800a8b8 <SUBGRF_SetPacketParams>
|
|
SUBGRF_SendPayload( buffer, outsize, 0 );
|
|
800896c: 7b7b ldrb r3, [r7, #13]
|
|
800896e: 2200 movs r2, #0
|
|
8008970: 4619 mov r1, r3
|
|
8008972: 6878 ldr r0, [r7, #4]
|
|
8008974: f001 fa52 bl 8009e1c <SUBGRF_SendPayload>
|
|
{
|
|
SubgRf.PacketParams.Params.Gfsk.PayloadLength = size;
|
|
SUBGRF_SetPacketParams( &SubgRf.PacketParams );
|
|
SUBGRF_SendPayload( buffer, size, 0 );
|
|
}
|
|
break;
|
|
8008978: e071 b.n 8008a5e <RadioSend+0x1d6>
|
|
MW_LOG( TS_ON, VLEVEL_M, "RadioSend Oversize\r\n" );
|
|
800897a: 4b43 ldr r3, [pc, #268] @ (8008a88 <RadioSend+0x200>)
|
|
800897c: 2201 movs r2, #1
|
|
800897e: 2100 movs r1, #0
|
|
8008980: 2002 movs r0, #2
|
|
8008982: f005 ff33 bl 800e7ec <UTIL_ADV_TRACE_COND_FSend>
|
|
return RADIO_STATUS_ERROR;
|
|
8008986: 2303 movs r3, #3
|
|
8008988: e073 b.n 8008a72 <RadioSend+0x1ea>
|
|
SubgRf.PacketParams.Params.Gfsk.PayloadLength = size;
|
|
800898a: 4a3d ldr r2, [pc, #244] @ (8008a80 <RadioSend+0x1f8>)
|
|
800898c: 78fb ldrb r3, [r7, #3]
|
|
800898e: 7593 strb r3, [r2, #22]
|
|
SUBGRF_SetPacketParams( &SubgRf.PacketParams );
|
|
8008990: 483c ldr r0, [pc, #240] @ (8008a84 <RadioSend+0x1fc>)
|
|
8008992: f001 ff91 bl 800a8b8 <SUBGRF_SetPacketParams>
|
|
SUBGRF_SendPayload( buffer, size, 0 );
|
|
8008996: 78fb ldrb r3, [r7, #3]
|
|
8008998: 2200 movs r2, #0
|
|
800899a: 4619 mov r1, r3
|
|
800899c: 6878 ldr r0, [r7, #4]
|
|
800899e: f001 fa3d bl 8009e1c <SUBGRF_SendPayload>
|
|
break;
|
|
80089a2: e05c b.n 8008a5e <RadioSend+0x1d6>
|
|
}
|
|
case MODEM_BPSK:
|
|
{
|
|
SubgRf.PacketParams.PacketType = PACKET_TYPE_BPSK;
|
|
80089a4: 4b36 ldr r3, [pc, #216] @ (8008a80 <RadioSend+0x1f8>)
|
|
80089a6: 2202 movs r2, #2
|
|
80089a8: 739a strb r2, [r3, #14]
|
|
SubgRf.PacketParams.Params.Bpsk.PayloadLength = size;
|
|
80089aa: 4a35 ldr r2, [pc, #212] @ (8008a80 <RadioSend+0x1f8>)
|
|
80089ac: 78fb ldrb r3, [r7, #3]
|
|
80089ae: 7693 strb r3, [r2, #26]
|
|
SUBGRF_SetPacketParams( &SubgRf.PacketParams );
|
|
80089b0: 4834 ldr r0, [pc, #208] @ (8008a84 <RadioSend+0x1fc>)
|
|
80089b2: f001 ff81 bl 800a8b8 <SUBGRF_SetPacketParams>
|
|
SUBGRF_SendPayload( buffer, size, 0 );
|
|
80089b6: 78fb ldrb r3, [r7, #3]
|
|
80089b8: 2200 movs r2, #0
|
|
80089ba: 4619 mov r1, r3
|
|
80089bc: 6878 ldr r0, [r7, #4]
|
|
80089be: f001 fa2d bl 8009e1c <SUBGRF_SendPayload>
|
|
break;
|
|
80089c2: e04c b.n 8008a5e <RadioSend+0x1d6>
|
|
case MODEM_SIGFOX_TX:
|
|
{
|
|
/* from bpsk to dbpsk */
|
|
/* first 1 bit duplicated */
|
|
/* RadioBuffer is 1 bytes more */
|
|
payload_integration( RadioBuffer, buffer, size );
|
|
80089c4: 78fb ldrb r3, [r7, #3]
|
|
80089c6: 461a mov r2, r3
|
|
80089c8: 6879 ldr r1, [r7, #4]
|
|
80089ca: 4830 ldr r0, [pc, #192] @ (8008a8c <RadioSend+0x204>)
|
|
80089cc: f000 fcfa bl 80093c4 <payload_integration>
|
|
|
|
SubgRf.PacketParams.PacketType = PACKET_TYPE_BPSK;
|
|
80089d0: 4b2b ldr r3, [pc, #172] @ (8008a80 <RadioSend+0x1f8>)
|
|
80089d2: 2202 movs r2, #2
|
|
80089d4: 739a strb r2, [r3, #14]
|
|
SubgRf.PacketParams.Params.Bpsk.PayloadLength = size + 1;
|
|
80089d6: 78fb ldrb r3, [r7, #3]
|
|
80089d8: 3301 adds r3, #1
|
|
80089da: b2da uxtb r2, r3
|
|
80089dc: 4b28 ldr r3, [pc, #160] @ (8008a80 <RadioSend+0x1f8>)
|
|
80089de: 769a strb r2, [r3, #26]
|
|
SUBGRF_SetPacketParams( &SubgRf.PacketParams );
|
|
80089e0: 4828 ldr r0, [pc, #160] @ (8008a84 <RadioSend+0x1fc>)
|
|
80089e2: f001 ff69 bl 800a8b8 <SUBGRF_SetPacketParams>
|
|
|
|
RadioWrite( SUBGHZ_RAM_RAMPUPL, 0 ); // clean start-up LSB
|
|
80089e6: 2100 movs r1, #0
|
|
80089e8: 20f1 movs r0, #241 @ 0xf1
|
|
80089ea: f000 f973 bl 8008cd4 <RadioWrite>
|
|
RadioWrite( SUBGHZ_RAM_RAMPUPH, 0 ); // clean start-up MSB
|
|
80089ee: 2100 movs r1, #0
|
|
80089f0: 20f0 movs r0, #240 @ 0xf0
|
|
80089f2: f000 f96f bl 8008cd4 <RadioWrite>
|
|
if( SubgRf.ModulationParams.Params.Bpsk.BitRate == 100 )
|
|
80089f6: 4b22 ldr r3, [pc, #136] @ (8008a80 <RadioSend+0x1f8>)
|
|
80089f8: 6c9b ldr r3, [r3, #72] @ 0x48
|
|
80089fa: 2b64 cmp r3, #100 @ 0x64
|
|
80089fc: d108 bne.n 8008a10 <RadioSend+0x188>
|
|
{
|
|
RadioWrite( SUBGHZ_RAM_RAMPDNL, 0x70 ); // clean end of frame LSB
|
|
80089fe: 2170 movs r1, #112 @ 0x70
|
|
8008a00: 20f3 movs r0, #243 @ 0xf3
|
|
8008a02: f000 f967 bl 8008cd4 <RadioWrite>
|
|
RadioWrite( SUBGHZ_RAM_RAMPDNH, 0x1D ); // clean end of frame MSB
|
|
8008a06: 211d movs r1, #29
|
|
8008a08: 20f2 movs r0, #242 @ 0xf2
|
|
8008a0a: f000 f963 bl 8008cd4 <RadioWrite>
|
|
8008a0e: e007 b.n 8008a20 <RadioSend+0x198>
|
|
}
|
|
else // 600 bps
|
|
{
|
|
RadioWrite( SUBGHZ_RAM_RAMPDNL, 0xE1 ); // clean end of frame LSB
|
|
8008a10: 21e1 movs r1, #225 @ 0xe1
|
|
8008a12: 20f3 movs r0, #243 @ 0xf3
|
|
8008a14: f000 f95e bl 8008cd4 <RadioWrite>
|
|
RadioWrite( SUBGHZ_RAM_RAMPDNH, 0x04 ); // clean end of frame MSB
|
|
8008a18: 2104 movs r1, #4
|
|
8008a1a: 20f2 movs r0, #242 @ 0xf2
|
|
8008a1c: f000 f95a bl 8008cd4 <RadioWrite>
|
|
}
|
|
|
|
uint16_t bitNum = ( size * 8 ) + 2;
|
|
8008a20: 78fb ldrb r3, [r7, #3]
|
|
8008a22: b29b uxth r3, r3
|
|
8008a24: 00db lsls r3, r3, #3
|
|
8008a26: b29b uxth r3, r3
|
|
8008a28: 3302 adds r3, #2
|
|
8008a2a: 81fb strh r3, [r7, #14]
|
|
RadioWrite( SUBGHZ_RAM_FRAMELIMH, ( bitNum >> 8 ) & 0x00FF ); // limit frame
|
|
8008a2c: 89fb ldrh r3, [r7, #14]
|
|
8008a2e: 0a1b lsrs r3, r3, #8
|
|
8008a30: b29b uxth r3, r3
|
|
8008a32: b2db uxtb r3, r3
|
|
8008a34: 4619 mov r1, r3
|
|
8008a36: 20f4 movs r0, #244 @ 0xf4
|
|
8008a38: f000 f94c bl 8008cd4 <RadioWrite>
|
|
RadioWrite( SUBGHZ_RAM_FRAMELIML, bitNum & 0x00FF ); // limit frame
|
|
8008a3c: 89fb ldrh r3, [r7, #14]
|
|
8008a3e: b2db uxtb r3, r3
|
|
8008a40: 4619 mov r1, r3
|
|
8008a42: 20f5 movs r0, #245 @ 0xf5
|
|
8008a44: f000 f946 bl 8008cd4 <RadioWrite>
|
|
SUBGRF_SendPayload( RadioBuffer, size + 1, 0xFFFFFF );
|
|
8008a48: 78fb ldrb r3, [r7, #3]
|
|
8008a4a: 3301 adds r3, #1
|
|
8008a4c: b2db uxtb r3, r3
|
|
8008a4e: f06f 427f mvn.w r2, #4278190080 @ 0xff000000
|
|
8008a52: 4619 mov r1, r3
|
|
8008a54: 480d ldr r0, [pc, #52] @ (8008a8c <RadioSend+0x204>)
|
|
8008a56: f001 f9e1 bl 8009e1c <SUBGRF_SendPayload>
|
|
break;
|
|
8008a5a: e000 b.n 8008a5e <RadioSend+0x1d6>
|
|
}
|
|
#endif /*RADIO_SIGFOX_ENABLE == 1*/
|
|
default:
|
|
break;
|
|
8008a5c: bf00 nop
|
|
}
|
|
|
|
TimerSetValue( &TxTimeoutTimer, SubgRf.TxTimeout );
|
|
8008a5e: 4b08 ldr r3, [pc, #32] @ (8008a80 <RadioSend+0x1f8>)
|
|
8008a60: 685b ldr r3, [r3, #4]
|
|
8008a62: 4619 mov r1, r3
|
|
8008a64: 480a ldr r0, [pc, #40] @ (8008a90 <RadioSend+0x208>)
|
|
8008a66: f005 fd39 bl 800e4dc <UTIL_TIMER_SetPeriod>
|
|
TimerStart( &TxTimeoutTimer );
|
|
8008a6a: 4809 ldr r0, [pc, #36] @ (8008a90 <RadioSend+0x208>)
|
|
8008a6c: f005 fc58 bl 800e320 <UTIL_TIMER_Start>
|
|
}
|
|
|
|
return RADIO_STATUS_OK;
|
|
8008a70: 2300 movs r3, #0
|
|
}
|
|
8008a72: 4618 mov r0, r3
|
|
8008a74: 3710 adds r7, #16
|
|
8008a76: 46bd mov sp, r7
|
|
8008a78: bd80 pop {r7, pc}
|
|
8008a7a: bf00 nop
|
|
8008a7c: 48000400 .word 0x48000400
|
|
8008a80: 200002f8 .word 0x200002f8
|
|
8008a84: 20000306 .word 0x20000306
|
|
8008a88: 0800f8bc .word 0x0800f8bc
|
|
8008a8c: 200001f4 .word 0x200001f4
|
|
8008a90: 20000354 .word 0x20000354
|
|
|
|
08008a94 <RadioSleep>:
|
|
|
|
static void RadioSleep( void )
|
|
{
|
|
8008a94: b580 push {r7, lr}
|
|
8008a96: b082 sub sp, #8
|
|
8008a98: af00 add r7, sp, #0
|
|
SleepParams_t params = { 0 };
|
|
8008a9a: 2300 movs r3, #0
|
|
8008a9c: 713b strb r3, [r7, #4]
|
|
|
|
params.Fields.WarmStart = 1;
|
|
8008a9e: 793b ldrb r3, [r7, #4]
|
|
8008aa0: f043 0304 orr.w r3, r3, #4
|
|
8008aa4: 713b strb r3, [r7, #4]
|
|
SUBGRF_SetSleep( params );
|
|
8008aa6: 7938 ldrb r0, [r7, #4]
|
|
8008aa8: f001 fa94 bl 8009fd4 <SUBGRF_SetSleep>
|
|
|
|
RADIO_DELAY_MS( 2 );
|
|
8008aac: 2002 movs r0, #2
|
|
8008aae: f7f8 f8df bl 8000c70 <HAL_Delay>
|
|
}
|
|
8008ab2: bf00 nop
|
|
8008ab4: 3708 adds r7, #8
|
|
8008ab6: 46bd mov sp, r7
|
|
8008ab8: bd80 pop {r7, pc}
|
|
|
|
08008aba <RadioStandby>:
|
|
|
|
static void RadioStandby( void )
|
|
{
|
|
8008aba: b580 push {r7, lr}
|
|
8008abc: af00 add r7, sp, #0
|
|
SUBGRF_SetStandby( STDBY_RC );
|
|
8008abe: 2000 movs r0, #0
|
|
8008ac0: f001 fabc bl 800a03c <SUBGRF_SetStandby>
|
|
}
|
|
8008ac4: bf00 nop
|
|
8008ac6: bd80 pop {r7, pc}
|
|
|
|
08008ac8 <RadioRx>:
|
|
|
|
static void RadioRx( uint32_t timeout )
|
|
{
|
|
8008ac8: b580 push {r7, lr}
|
|
8008aca: b082 sub sp, #8
|
|
8008acc: af00 add r7, sp, #0
|
|
8008ace: 6078 str r0, [r7, #4]
|
|
if( SubgRf.lr_fhss.is_lr_fhss_on == true )
|
|
{
|
|
//return LORAMAC_RADIO_STATUS_ERROR;
|
|
}
|
|
#endif /* RADIO_LR_FHSS_IS_ON == 1 */
|
|
if( 1UL == RFW_Is_Init( ) )
|
|
8008ad0: f002 fdb4 bl 800b63c <RFW_Is_Init>
|
|
8008ad4: 4603 mov r3, r0
|
|
8008ad6: 2b01 cmp r3, #1
|
|
8008ad8: d102 bne.n 8008ae0 <RadioRx+0x18>
|
|
{
|
|
RFW_ReceiveInit( );
|
|
8008ada: f002 fe59 bl 800b790 <RFW_ReceiveInit>
|
|
8008ade: e007 b.n 8008af0 <RadioRx+0x28>
|
|
}
|
|
else
|
|
{
|
|
SUBGRF_SetDioIrqParams( IRQ_RX_DONE | IRQ_RX_TX_TIMEOUT | IRQ_CRC_ERROR | IRQ_HEADER_ERROR | IRQ_RX_DBG,
|
|
8008ae0: 2300 movs r3, #0
|
|
8008ae2: 2200 movs r2, #0
|
|
8008ae4: f240 2162 movw r1, #610 @ 0x262
|
|
8008ae8: f240 2062 movw r0, #610 @ 0x262
|
|
8008aec: f001 fc80 bl 800a3f0 <SUBGRF_SetDioIrqParams>
|
|
IRQ_RX_DONE | IRQ_RX_TX_TIMEOUT | IRQ_CRC_ERROR | IRQ_HEADER_ERROR | IRQ_RX_DBG,
|
|
IRQ_RADIO_NONE,
|
|
IRQ_RADIO_NONE );
|
|
}
|
|
|
|
if( timeout != 0 )
|
|
8008af0: 687b ldr r3, [r7, #4]
|
|
8008af2: 2b00 cmp r3, #0
|
|
8008af4: d006 beq.n 8008b04 <RadioRx+0x3c>
|
|
{
|
|
TimerSetValue( &RxTimeoutTimer, timeout );
|
|
8008af6: 6879 ldr r1, [r7, #4]
|
|
8008af8: 4813 ldr r0, [pc, #76] @ (8008b48 <RadioRx+0x80>)
|
|
8008afa: f005 fcef bl 800e4dc <UTIL_TIMER_SetPeriod>
|
|
TimerStart( &RxTimeoutTimer );
|
|
8008afe: 4812 ldr r0, [pc, #72] @ (8008b48 <RadioRx+0x80>)
|
|
8008b00: f005 fc0e bl 800e320 <UTIL_TIMER_Start>
|
|
}
|
|
/* switch off RxDcPreambleDetect See STM32WL Errata: RadioSetRxDutyCycle*/
|
|
SubgRf.RxDcPreambleDetectTimeout = 0;
|
|
8008b04: 4b11 ldr r3, [pc, #68] @ (8008b4c <RadioRx+0x84>)
|
|
8008b06: 2200 movs r2, #0
|
|
8008b08: 659a str r2, [r3, #88] @ 0x58
|
|
/* Set DBG pin */
|
|
DBG_GPIO_RADIO_RX( SET );
|
|
8008b0a: f44f 5180 mov.w r1, #4096 @ 0x1000
|
|
8008b0e: 4810 ldr r0, [pc, #64] @ (8008b50 <RadioRx+0x88>)
|
|
8008b10: f7ff f8d6 bl 8007cc0 <LL_GPIO_SetOutputPin>
|
|
/* RF switch configuration */
|
|
SUBGRF_SetSwitch( SubgRf.AntSwitchPaSelect, RFSWITCH_RX );
|
|
8008b14: 4b0d ldr r3, [pc, #52] @ (8008b4c <RadioRx+0x84>)
|
|
8008b16: f893 3056 ldrb.w r3, [r3, #86] @ 0x56
|
|
8008b1a: 2100 movs r1, #0
|
|
8008b1c: 4618 mov r0, r3
|
|
8008b1e: f002 f91f bl 800ad60 <SUBGRF_SetSwitch>
|
|
|
|
if( SubgRf.RxContinuous == true )
|
|
8008b22: 4b0a ldr r3, [pc, #40] @ (8008b4c <RadioRx+0x84>)
|
|
8008b24: 785b ldrb r3, [r3, #1]
|
|
8008b26: 2b00 cmp r3, #0
|
|
8008b28: d004 beq.n 8008b34 <RadioRx+0x6c>
|
|
{
|
|
SUBGRF_SetRx( 0xFFFFFF ); // Rx Continuous
|
|
8008b2a: f06f 407f mvn.w r0, #4278190080 @ 0xff000000
|
|
8008b2e: f001 fac1 bl 800a0b4 <SUBGRF_SetRx>
|
|
}
|
|
else
|
|
{
|
|
SUBGRF_SetRx( SubgRf.RxTimeout << 6 );
|
|
}
|
|
}
|
|
8008b32: e005 b.n 8008b40 <RadioRx+0x78>
|
|
SUBGRF_SetRx( SubgRf.RxTimeout << 6 );
|
|
8008b34: 4b05 ldr r3, [pc, #20] @ (8008b4c <RadioRx+0x84>)
|
|
8008b36: 689b ldr r3, [r3, #8]
|
|
8008b38: 019b lsls r3, r3, #6
|
|
8008b3a: 4618 mov r0, r3
|
|
8008b3c: f001 faba bl 800a0b4 <SUBGRF_SetRx>
|
|
}
|
|
8008b40: bf00 nop
|
|
8008b42: 3708 adds r7, #8
|
|
8008b44: 46bd mov sp, r7
|
|
8008b46: bd80 pop {r7, pc}
|
|
8008b48: 2000036c .word 0x2000036c
|
|
8008b4c: 200002f8 .word 0x200002f8
|
|
8008b50: 48000400 .word 0x48000400
|
|
|
|
08008b54 <RadioRxBoosted>:
|
|
|
|
static void RadioRxBoosted( uint32_t timeout )
|
|
{
|
|
8008b54: b580 push {r7, lr}
|
|
8008b56: b082 sub sp, #8
|
|
8008b58: af00 add r7, sp, #0
|
|
8008b5a: 6078 str r0, [r7, #4]
|
|
if( SubgRf.lr_fhss.is_lr_fhss_on == true )
|
|
{
|
|
//return LORAMAC_RADIO_STATUS_ERROR;
|
|
}
|
|
#endif /* RADIO_LR_FHSS_IS_ON == 1 */
|
|
if( 1UL == RFW_Is_Init() )
|
|
8008b5c: f002 fd6e bl 800b63c <RFW_Is_Init>
|
|
8008b60: 4603 mov r3, r0
|
|
8008b62: 2b01 cmp r3, #1
|
|
8008b64: d102 bne.n 8008b6c <RadioRxBoosted+0x18>
|
|
{
|
|
RFW_ReceiveInit();
|
|
8008b66: f002 fe13 bl 800b790 <RFW_ReceiveInit>
|
|
8008b6a: e007 b.n 8008b7c <RadioRxBoosted+0x28>
|
|
}
|
|
else
|
|
{
|
|
SUBGRF_SetDioIrqParams( IRQ_RX_DONE | IRQ_RX_TX_TIMEOUT | IRQ_CRC_ERROR | IRQ_HEADER_ERROR | IRQ_RX_DBG,
|
|
8008b6c: 2300 movs r3, #0
|
|
8008b6e: 2200 movs r2, #0
|
|
8008b70: f240 2162 movw r1, #610 @ 0x262
|
|
8008b74: f240 2062 movw r0, #610 @ 0x262
|
|
8008b78: f001 fc3a bl 800a3f0 <SUBGRF_SetDioIrqParams>
|
|
IRQ_RX_DONE | IRQ_RX_TX_TIMEOUT | IRQ_CRC_ERROR | IRQ_HEADER_ERROR | IRQ_RX_DBG,
|
|
IRQ_RADIO_NONE,
|
|
IRQ_RADIO_NONE );
|
|
}
|
|
if( timeout != 0 )
|
|
8008b7c: 687b ldr r3, [r7, #4]
|
|
8008b7e: 2b00 cmp r3, #0
|
|
8008b80: d006 beq.n 8008b90 <RadioRxBoosted+0x3c>
|
|
{
|
|
TimerSetValue( &RxTimeoutTimer, timeout );
|
|
8008b82: 6879 ldr r1, [r7, #4]
|
|
8008b84: 4813 ldr r0, [pc, #76] @ (8008bd4 <RadioRxBoosted+0x80>)
|
|
8008b86: f005 fca9 bl 800e4dc <UTIL_TIMER_SetPeriod>
|
|
TimerStart( &RxTimeoutTimer );
|
|
8008b8a: 4812 ldr r0, [pc, #72] @ (8008bd4 <RadioRxBoosted+0x80>)
|
|
8008b8c: f005 fbc8 bl 800e320 <UTIL_TIMER_Start>
|
|
}
|
|
/* switch off RxDcPreambleDetect See STM32WL Errata: RadioSetRxDutyCycle*/
|
|
SubgRf.RxDcPreambleDetectTimeout = 0;
|
|
8008b90: 4b11 ldr r3, [pc, #68] @ (8008bd8 <RadioRxBoosted+0x84>)
|
|
8008b92: 2200 movs r2, #0
|
|
8008b94: 659a str r2, [r3, #88] @ 0x58
|
|
/* Set DBG pin */
|
|
DBG_GPIO_RADIO_RX( SET );
|
|
8008b96: f44f 5180 mov.w r1, #4096 @ 0x1000
|
|
8008b9a: 4810 ldr r0, [pc, #64] @ (8008bdc <RadioRxBoosted+0x88>)
|
|
8008b9c: f7ff f890 bl 8007cc0 <LL_GPIO_SetOutputPin>
|
|
/* RF switch configuration */
|
|
SUBGRF_SetSwitch( SubgRf.AntSwitchPaSelect, RFSWITCH_RX );
|
|
8008ba0: 4b0d ldr r3, [pc, #52] @ (8008bd8 <RadioRxBoosted+0x84>)
|
|
8008ba2: f893 3056 ldrb.w r3, [r3, #86] @ 0x56
|
|
8008ba6: 2100 movs r1, #0
|
|
8008ba8: 4618 mov r0, r3
|
|
8008baa: f002 f8d9 bl 800ad60 <SUBGRF_SetSwitch>
|
|
|
|
if( SubgRf.RxContinuous == true )
|
|
8008bae: 4b0a ldr r3, [pc, #40] @ (8008bd8 <RadioRxBoosted+0x84>)
|
|
8008bb0: 785b ldrb r3, [r3, #1]
|
|
8008bb2: 2b00 cmp r3, #0
|
|
8008bb4: d004 beq.n 8008bc0 <RadioRxBoosted+0x6c>
|
|
{
|
|
SUBGRF_SetRxBoosted( 0xFFFFFF ); // Rx Continuous
|
|
8008bb6: f06f 407f mvn.w r0, #4278190080 @ 0xff000000
|
|
8008bba: f001 fa9b bl 800a0f4 <SUBGRF_SetRxBoosted>
|
|
}
|
|
else
|
|
{
|
|
SUBGRF_SetRxBoosted( SubgRf.RxTimeout << 6 );
|
|
}
|
|
}
|
|
8008bbe: e005 b.n 8008bcc <RadioRxBoosted+0x78>
|
|
SUBGRF_SetRxBoosted( SubgRf.RxTimeout << 6 );
|
|
8008bc0: 4b05 ldr r3, [pc, #20] @ (8008bd8 <RadioRxBoosted+0x84>)
|
|
8008bc2: 689b ldr r3, [r3, #8]
|
|
8008bc4: 019b lsls r3, r3, #6
|
|
8008bc6: 4618 mov r0, r3
|
|
8008bc8: f001 fa94 bl 800a0f4 <SUBGRF_SetRxBoosted>
|
|
}
|
|
8008bcc: bf00 nop
|
|
8008bce: 3708 adds r7, #8
|
|
8008bd0: 46bd mov sp, r7
|
|
8008bd2: bd80 pop {r7, pc}
|
|
8008bd4: 2000036c .word 0x2000036c
|
|
8008bd8: 200002f8 .word 0x200002f8
|
|
8008bdc: 48000400 .word 0x48000400
|
|
|
|
08008be0 <RadioSetRxDutyCycle>:
|
|
|
|
static void RadioSetRxDutyCycle( uint32_t rxTime, uint32_t sleepTime )
|
|
{
|
|
8008be0: b580 push {r7, lr}
|
|
8008be2: b082 sub sp, #8
|
|
8008be4: af00 add r7, sp, #0
|
|
8008be6: 6078 str r0, [r7, #4]
|
|
8008be8: 6039 str r1, [r7, #0]
|
|
/*See STM32WL Errata: RadioSetRxDutyCycle*/
|
|
SubgRf.RxDcPreambleDetectTimeout = 2 * rxTime + sleepTime;
|
|
8008bea: 687b ldr r3, [r7, #4]
|
|
8008bec: 005a lsls r2, r3, #1
|
|
8008bee: 683b ldr r3, [r7, #0]
|
|
8008bf0: 4413 add r3, r2
|
|
8008bf2: 4a0c ldr r2, [pc, #48] @ (8008c24 <RadioSetRxDutyCycle+0x44>)
|
|
8008bf4: 6593 str r3, [r2, #88] @ 0x58
|
|
/*Enable also the IRQ_PREAMBLE_DETECTED*/
|
|
SUBGRF_SetDioIrqParams( IRQ_RADIO_ALL, IRQ_RADIO_ALL, IRQ_RADIO_NONE, IRQ_RADIO_NONE );
|
|
8008bf6: 2300 movs r3, #0
|
|
8008bf8: 2200 movs r2, #0
|
|
8008bfa: f64f 71ff movw r1, #65535 @ 0xffff
|
|
8008bfe: f64f 70ff movw r0, #65535 @ 0xffff
|
|
8008c02: f001 fbf5 bl 800a3f0 <SUBGRF_SetDioIrqParams>
|
|
/* RF switch configuration */
|
|
SUBGRF_SetSwitch( SubgRf.AntSwitchPaSelect, RFSWITCH_RX );
|
|
8008c06: 4b07 ldr r3, [pc, #28] @ (8008c24 <RadioSetRxDutyCycle+0x44>)
|
|
8008c08: f893 3056 ldrb.w r3, [r3, #86] @ 0x56
|
|
8008c0c: 2100 movs r1, #0
|
|
8008c0e: 4618 mov r0, r3
|
|
8008c10: f002 f8a6 bl 800ad60 <SUBGRF_SetSwitch>
|
|
/* Start Rx DutyCycle*/
|
|
SUBGRF_SetRxDutyCycle( rxTime, sleepTime );
|
|
8008c14: 6839 ldr r1, [r7, #0]
|
|
8008c16: 6878 ldr r0, [r7, #4]
|
|
8008c18: f001 fa90 bl 800a13c <SUBGRF_SetRxDutyCycle>
|
|
}
|
|
8008c1c: bf00 nop
|
|
8008c1e: 3708 adds r7, #8
|
|
8008c20: 46bd mov sp, r7
|
|
8008c22: bd80 pop {r7, pc}
|
|
8008c24: 200002f8 .word 0x200002f8
|
|
|
|
08008c28 <RadioStartCad>:
|
|
|
|
static void RadioStartCad( void )
|
|
{
|
|
8008c28: b580 push {r7, lr}
|
|
8008c2a: af00 add r7, sp, #0
|
|
/* RF switch configuration */
|
|
SUBGRF_SetSwitch( SubgRf.AntSwitchPaSelect, RFSWITCH_RX );
|
|
8008c2c: 4b09 ldr r3, [pc, #36] @ (8008c54 <RadioStartCad+0x2c>)
|
|
8008c2e: f893 3056 ldrb.w r3, [r3, #86] @ 0x56
|
|
8008c32: 2100 movs r1, #0
|
|
8008c34: 4618 mov r0, r3
|
|
8008c36: f002 f893 bl 800ad60 <SUBGRF_SetSwitch>
|
|
|
|
SUBGRF_SetDioIrqParams( IRQ_CAD_CLEAR | IRQ_CAD_DETECTED,
|
|
8008c3a: 2300 movs r3, #0
|
|
8008c3c: 2200 movs r2, #0
|
|
8008c3e: f44f 71c0 mov.w r1, #384 @ 0x180
|
|
8008c42: f44f 70c0 mov.w r0, #384 @ 0x180
|
|
8008c46: f001 fbd3 bl 800a3f0 <SUBGRF_SetDioIrqParams>
|
|
IRQ_CAD_CLEAR | IRQ_CAD_DETECTED,
|
|
IRQ_RADIO_NONE,
|
|
IRQ_RADIO_NONE );
|
|
SUBGRF_SetCad( );
|
|
8008c4a: f001 faa3 bl 800a194 <SUBGRF_SetCad>
|
|
}
|
|
8008c4e: bf00 nop
|
|
8008c50: bd80 pop {r7, pc}
|
|
8008c52: bf00 nop
|
|
8008c54: 200002f8 .word 0x200002f8
|
|
|
|
08008c58 <RadioSetTxContinuousWave>:
|
|
|
|
static void RadioSetTxContinuousWave( uint32_t freq, int8_t power, uint16_t time )
|
|
{
|
|
8008c58: b580 push {r7, lr}
|
|
8008c5a: b084 sub sp, #16
|
|
8008c5c: af00 add r7, sp, #0
|
|
8008c5e: 6078 str r0, [r7, #4]
|
|
8008c60: 460b mov r3, r1
|
|
8008c62: 70fb strb r3, [r7, #3]
|
|
8008c64: 4613 mov r3, r2
|
|
8008c66: 803b strh r3, [r7, #0]
|
|
if( SubgRf.lr_fhss.is_lr_fhss_on == true )
|
|
{
|
|
//return LORAMAC_RADIO_STATUS_ERROR;
|
|
}
|
|
#endif /* RADIO_LR_FHSS_IS_ON == 1 */
|
|
uint32_t timeout = ( uint32_t )time * 1000;
|
|
8008c68: 883b ldrh r3, [r7, #0]
|
|
8008c6a: f44f 727a mov.w r2, #1000 @ 0x3e8
|
|
8008c6e: fb02 f303 mul.w r3, r2, r3
|
|
8008c72: 60fb str r3, [r7, #12]
|
|
uint8_t antswitchpow;
|
|
|
|
SUBGRF_SetRfFrequency( freq );
|
|
8008c74: 6878 ldr r0, [r7, #4]
|
|
8008c76: f001 fc17 bl 800a4a8 <SUBGRF_SetRfFrequency>
|
|
|
|
antswitchpow = SUBGRF_SetRfTxPower( power );
|
|
8008c7a: f997 3003 ldrsb.w r3, [r7, #3]
|
|
8008c7e: 4618 mov r0, r3
|
|
8008c80: f002 f896 bl 800adb0 <SUBGRF_SetRfTxPower>
|
|
8008c84: 4603 mov r3, r0
|
|
8008c86: 72fb strb r3, [r7, #11]
|
|
|
|
/* WORKAROUND - Trimming the output voltage power_ldo to 3.3V */
|
|
SUBGRF_WriteRegister(REG_DRV_CTRL, 0x7 << 1);
|
|
8008c88: 210e movs r1, #14
|
|
8008c8a: f640 101f movw r0, #2335 @ 0x91f
|
|
8008c8e: f001 ff59 bl 800ab44 <SUBGRF_WriteRegister>
|
|
|
|
/* Set RF switch */
|
|
SUBGRF_SetSwitch( antswitchpow, RFSWITCH_TX );
|
|
8008c92: 7afb ldrb r3, [r7, #11]
|
|
8008c94: 2101 movs r1, #1
|
|
8008c96: 4618 mov r0, r3
|
|
8008c98: f002 f862 bl 800ad60 <SUBGRF_SetSwitch>
|
|
|
|
SUBGRF_SetTxContinuousWave( );
|
|
8008c9c: f001 fa88 bl 800a1b0 <SUBGRF_SetTxContinuousWave>
|
|
|
|
TimerSetValue( &TxTimeoutTimer, timeout );
|
|
8008ca0: 68f9 ldr r1, [r7, #12]
|
|
8008ca2: 4805 ldr r0, [pc, #20] @ (8008cb8 <RadioSetTxContinuousWave+0x60>)
|
|
8008ca4: f005 fc1a bl 800e4dc <UTIL_TIMER_SetPeriod>
|
|
TimerStart( &TxTimeoutTimer );
|
|
8008ca8: 4803 ldr r0, [pc, #12] @ (8008cb8 <RadioSetTxContinuousWave+0x60>)
|
|
8008caa: f005 fb39 bl 800e320 <UTIL_TIMER_Start>
|
|
}
|
|
8008cae: bf00 nop
|
|
8008cb0: 3710 adds r7, #16
|
|
8008cb2: 46bd mov sp, r7
|
|
8008cb4: bd80 pop {r7, pc}
|
|
8008cb6: bf00 nop
|
|
8008cb8: 20000354 .word 0x20000354
|
|
|
|
08008cbc <RadioRssi>:
|
|
|
|
static int16_t RadioRssi( RadioModems_t modem )
|
|
{
|
|
8008cbc: b580 push {r7, lr}
|
|
8008cbe: b082 sub sp, #8
|
|
8008cc0: af00 add r7, sp, #0
|
|
8008cc2: 4603 mov r3, r0
|
|
8008cc4: 71fb strb r3, [r7, #7]
|
|
return SUBGRF_GetRssiInst( );
|
|
8008cc6: f001 feaa bl 800aa1e <SUBGRF_GetRssiInst>
|
|
8008cca: 4603 mov r3, r0
|
|
}
|
|
8008ccc: 4618 mov r0, r3
|
|
8008cce: 3708 adds r7, #8
|
|
8008cd0: 46bd mov sp, r7
|
|
8008cd2: bd80 pop {r7, pc}
|
|
|
|
08008cd4 <RadioWrite>:
|
|
|
|
static void RadioWrite( uint16_t addr, uint8_t data )
|
|
{
|
|
8008cd4: b580 push {r7, lr}
|
|
8008cd6: b082 sub sp, #8
|
|
8008cd8: af00 add r7, sp, #0
|
|
8008cda: 4603 mov r3, r0
|
|
8008cdc: 460a mov r2, r1
|
|
8008cde: 80fb strh r3, [r7, #6]
|
|
8008ce0: 4613 mov r3, r2
|
|
8008ce2: 717b strb r3, [r7, #5]
|
|
SUBGRF_WriteRegister( addr, data );
|
|
8008ce4: 797a ldrb r2, [r7, #5]
|
|
8008ce6: 88fb ldrh r3, [r7, #6]
|
|
8008ce8: 4611 mov r1, r2
|
|
8008cea: 4618 mov r0, r3
|
|
8008cec: f001 ff2a bl 800ab44 <SUBGRF_WriteRegister>
|
|
}
|
|
8008cf0: bf00 nop
|
|
8008cf2: 3708 adds r7, #8
|
|
8008cf4: 46bd mov sp, r7
|
|
8008cf6: bd80 pop {r7, pc}
|
|
|
|
08008cf8 <RadioRead>:
|
|
|
|
static uint8_t RadioRead( uint16_t addr )
|
|
{
|
|
8008cf8: b580 push {r7, lr}
|
|
8008cfa: b082 sub sp, #8
|
|
8008cfc: af00 add r7, sp, #0
|
|
8008cfe: 4603 mov r3, r0
|
|
8008d00: 80fb strh r3, [r7, #6]
|
|
return SUBGRF_ReadRegister( addr );
|
|
8008d02: 88fb ldrh r3, [r7, #6]
|
|
8008d04: 4618 mov r0, r3
|
|
8008d06: f001 ff3f bl 800ab88 <SUBGRF_ReadRegister>
|
|
8008d0a: 4603 mov r3, r0
|
|
}
|
|
8008d0c: 4618 mov r0, r3
|
|
8008d0e: 3708 adds r7, #8
|
|
8008d10: 46bd mov sp, r7
|
|
8008d12: bd80 pop {r7, pc}
|
|
|
|
08008d14 <RadioWriteRegisters>:
|
|
|
|
static void RadioWriteRegisters( uint16_t addr, uint8_t *buffer, uint8_t size )
|
|
{
|
|
8008d14: b580 push {r7, lr}
|
|
8008d16: b082 sub sp, #8
|
|
8008d18: af00 add r7, sp, #0
|
|
8008d1a: 4603 mov r3, r0
|
|
8008d1c: 6039 str r1, [r7, #0]
|
|
8008d1e: 80fb strh r3, [r7, #6]
|
|
8008d20: 4613 mov r3, r2
|
|
8008d22: 717b strb r3, [r7, #5]
|
|
SUBGRF_WriteRegisters( addr, buffer, size );
|
|
8008d24: 797b ldrb r3, [r7, #5]
|
|
8008d26: b29a uxth r2, r3
|
|
8008d28: 88fb ldrh r3, [r7, #6]
|
|
8008d2a: 6839 ldr r1, [r7, #0]
|
|
8008d2c: 4618 mov r0, r3
|
|
8008d2e: f001 ff4b bl 800abc8 <SUBGRF_WriteRegisters>
|
|
}
|
|
8008d32: bf00 nop
|
|
8008d34: 3708 adds r7, #8
|
|
8008d36: 46bd mov sp, r7
|
|
8008d38: bd80 pop {r7, pc}
|
|
|
|
08008d3a <RadioReadRegisters>:
|
|
|
|
static void RadioReadRegisters( uint16_t addr, uint8_t *buffer, uint8_t size )
|
|
{
|
|
8008d3a: b580 push {r7, lr}
|
|
8008d3c: b082 sub sp, #8
|
|
8008d3e: af00 add r7, sp, #0
|
|
8008d40: 4603 mov r3, r0
|
|
8008d42: 6039 str r1, [r7, #0]
|
|
8008d44: 80fb strh r3, [r7, #6]
|
|
8008d46: 4613 mov r3, r2
|
|
8008d48: 717b strb r3, [r7, #5]
|
|
SUBGRF_ReadRegisters( addr, buffer, size );
|
|
8008d4a: 797b ldrb r3, [r7, #5]
|
|
8008d4c: b29a uxth r2, r3
|
|
8008d4e: 88fb ldrh r3, [r7, #6]
|
|
8008d50: 6839 ldr r1, [r7, #0]
|
|
8008d52: 4618 mov r0, r3
|
|
8008d54: f001 ff5a bl 800ac0c <SUBGRF_ReadRegisters>
|
|
}
|
|
8008d58: bf00 nop
|
|
8008d5a: 3708 adds r7, #8
|
|
8008d5c: 46bd mov sp, r7
|
|
8008d5e: bd80 pop {r7, pc}
|
|
|
|
08008d60 <RadioSetMaxPayloadLength>:
|
|
|
|
static void RadioSetMaxPayloadLength( RadioModems_t modem, uint8_t max )
|
|
{
|
|
8008d60: b580 push {r7, lr}
|
|
8008d62: b082 sub sp, #8
|
|
8008d64: af00 add r7, sp, #0
|
|
8008d66: 4603 mov r3, r0
|
|
8008d68: 460a mov r2, r1
|
|
8008d6a: 71fb strb r3, [r7, #7]
|
|
8008d6c: 4613 mov r3, r2
|
|
8008d6e: 71bb strb r3, [r7, #6]
|
|
if( modem == MODEM_LORA )
|
|
8008d70: 79fb ldrb r3, [r7, #7]
|
|
8008d72: 2b01 cmp r3, #1
|
|
8008d74: d10a bne.n 8008d8c <RadioSetMaxPayloadLength+0x2c>
|
|
{
|
|
SubgRf.PacketParams.Params.LoRa.PayloadLength = MaxPayloadLength = max;
|
|
8008d76: 4a0e ldr r2, [pc, #56] @ (8008db0 <RadioSetMaxPayloadLength+0x50>)
|
|
8008d78: 79bb ldrb r3, [r7, #6]
|
|
8008d7a: 7013 strb r3, [r2, #0]
|
|
8008d7c: 4b0c ldr r3, [pc, #48] @ (8008db0 <RadioSetMaxPayloadLength+0x50>)
|
|
8008d7e: 781a ldrb r2, [r3, #0]
|
|
8008d80: 4b0c ldr r3, [pc, #48] @ (8008db4 <RadioSetMaxPayloadLength+0x54>)
|
|
8008d82: 77da strb r2, [r3, #31]
|
|
SUBGRF_SetPacketParams( &SubgRf.PacketParams );
|
|
8008d84: 480c ldr r0, [pc, #48] @ (8008db8 <RadioSetMaxPayloadLength+0x58>)
|
|
8008d86: f001 fd97 bl 800a8b8 <SUBGRF_SetPacketParams>
|
|
{
|
|
SubgRf.PacketParams.Params.Gfsk.PayloadLength = MaxPayloadLength = max;
|
|
SUBGRF_SetPacketParams( &SubgRf.PacketParams );
|
|
}
|
|
}
|
|
}
|
|
8008d8a: e00d b.n 8008da8 <RadioSetMaxPayloadLength+0x48>
|
|
if( SubgRf.PacketParams.Params.Gfsk.HeaderType == RADIO_PACKET_VARIABLE_LENGTH )
|
|
8008d8c: 4b09 ldr r3, [pc, #36] @ (8008db4 <RadioSetMaxPayloadLength+0x54>)
|
|
8008d8e: 7d5b ldrb r3, [r3, #21]
|
|
8008d90: 2b01 cmp r3, #1
|
|
8008d92: d109 bne.n 8008da8 <RadioSetMaxPayloadLength+0x48>
|
|
SubgRf.PacketParams.Params.Gfsk.PayloadLength = MaxPayloadLength = max;
|
|
8008d94: 4a06 ldr r2, [pc, #24] @ (8008db0 <RadioSetMaxPayloadLength+0x50>)
|
|
8008d96: 79bb ldrb r3, [r7, #6]
|
|
8008d98: 7013 strb r3, [r2, #0]
|
|
8008d9a: 4b05 ldr r3, [pc, #20] @ (8008db0 <RadioSetMaxPayloadLength+0x50>)
|
|
8008d9c: 781a ldrb r2, [r3, #0]
|
|
8008d9e: 4b05 ldr r3, [pc, #20] @ (8008db4 <RadioSetMaxPayloadLength+0x54>)
|
|
8008da0: 759a strb r2, [r3, #22]
|
|
SUBGRF_SetPacketParams( &SubgRf.PacketParams );
|
|
8008da2: 4805 ldr r0, [pc, #20] @ (8008db8 <RadioSetMaxPayloadLength+0x58>)
|
|
8008da4: f001 fd88 bl 800a8b8 <SUBGRF_SetPacketParams>
|
|
}
|
|
8008da8: bf00 nop
|
|
8008daa: 3708 adds r7, #8
|
|
8008dac: 46bd mov sp, r7
|
|
8008dae: bd80 pop {r7, pc}
|
|
8008db0: 20000008 .word 0x20000008
|
|
8008db4: 200002f8 .word 0x200002f8
|
|
8008db8: 20000306 .word 0x20000306
|
|
|
|
08008dbc <RadioSetPublicNetwork>:
|
|
|
|
static void RadioSetPublicNetwork( bool enable )
|
|
{
|
|
8008dbc: b580 push {r7, lr}
|
|
8008dbe: b082 sub sp, #8
|
|
8008dc0: af00 add r7, sp, #0
|
|
8008dc2: 4603 mov r3, r0
|
|
8008dc4: 71fb strb r3, [r7, #7]
|
|
SubgRf.PublicNetwork.Current = SubgRf.PublicNetwork.Previous = enable;
|
|
8008dc6: 4a13 ldr r2, [pc, #76] @ (8008e14 <RadioSetPublicNetwork+0x58>)
|
|
8008dc8: 79fb ldrb r3, [r7, #7]
|
|
8008dca: 7313 strb r3, [r2, #12]
|
|
8008dcc: 4b11 ldr r3, [pc, #68] @ (8008e14 <RadioSetPublicNetwork+0x58>)
|
|
8008dce: 7b1a ldrb r2, [r3, #12]
|
|
8008dd0: 4b10 ldr r3, [pc, #64] @ (8008e14 <RadioSetPublicNetwork+0x58>)
|
|
8008dd2: 735a strb r2, [r3, #13]
|
|
|
|
RadioSetModem( MODEM_LORA );
|
|
8008dd4: 2001 movs r0, #1
|
|
8008dd6: f7ff f801 bl 8007ddc <RadioSetModem>
|
|
if( enable == true )
|
|
8008dda: 79fb ldrb r3, [r7, #7]
|
|
8008ddc: 2b00 cmp r3, #0
|
|
8008dde: d00a beq.n 8008df6 <RadioSetPublicNetwork+0x3a>
|
|
{
|
|
// Change LoRa modem SyncWord
|
|
SUBGRF_WriteRegister( REG_LR_SYNCWORD, ( LORA_MAC_PUBLIC_SYNCWORD >> 8 ) & 0xFF );
|
|
8008de0: 2134 movs r1, #52 @ 0x34
|
|
8008de2: f44f 60e8 mov.w r0, #1856 @ 0x740
|
|
8008de6: f001 fead bl 800ab44 <SUBGRF_WriteRegister>
|
|
SUBGRF_WriteRegister( REG_LR_SYNCWORD + 1, LORA_MAC_PUBLIC_SYNCWORD & 0xFF );
|
|
8008dea: 2144 movs r1, #68 @ 0x44
|
|
8008dec: f240 7041 movw r0, #1857 @ 0x741
|
|
8008df0: f001 fea8 bl 800ab44 <SUBGRF_WriteRegister>
|
|
{
|
|
// Change LoRa modem SyncWord
|
|
SUBGRF_WriteRegister( REG_LR_SYNCWORD, ( LORA_MAC_PRIVATE_SYNCWORD >> 8 ) & 0xFF );
|
|
SUBGRF_WriteRegister( REG_LR_SYNCWORD + 1, LORA_MAC_PRIVATE_SYNCWORD & 0xFF );
|
|
}
|
|
}
|
|
8008df4: e009 b.n 8008e0a <RadioSetPublicNetwork+0x4e>
|
|
SUBGRF_WriteRegister( REG_LR_SYNCWORD, ( LORA_MAC_PRIVATE_SYNCWORD >> 8 ) & 0xFF );
|
|
8008df6: 2114 movs r1, #20
|
|
8008df8: f44f 60e8 mov.w r0, #1856 @ 0x740
|
|
8008dfc: f001 fea2 bl 800ab44 <SUBGRF_WriteRegister>
|
|
SUBGRF_WriteRegister( REG_LR_SYNCWORD + 1, LORA_MAC_PRIVATE_SYNCWORD & 0xFF );
|
|
8008e00: 2124 movs r1, #36 @ 0x24
|
|
8008e02: f240 7041 movw r0, #1857 @ 0x741
|
|
8008e06: f001 fe9d bl 800ab44 <SUBGRF_WriteRegister>
|
|
}
|
|
8008e0a: bf00 nop
|
|
8008e0c: 3708 adds r7, #8
|
|
8008e0e: 46bd mov sp, r7
|
|
8008e10: bd80 pop {r7, pc}
|
|
8008e12: bf00 nop
|
|
8008e14: 200002f8 .word 0x200002f8
|
|
|
|
08008e18 <RadioGetWakeupTime>:
|
|
|
|
static uint32_t RadioGetWakeupTime( void )
|
|
{
|
|
8008e18: b580 push {r7, lr}
|
|
8008e1a: af00 add r7, sp, #0
|
|
return SUBGRF_GetRadioWakeUpTime() + RADIO_WAKEUP_TIME;
|
|
8008e1c: f001 fffc bl 800ae18 <SUBGRF_GetRadioWakeUpTime>
|
|
8008e20: 4603 mov r3, r0
|
|
8008e22: 3303 adds r3, #3
|
|
}
|
|
8008e24: 4618 mov r0, r3
|
|
8008e26: bd80 pop {r7, pc}
|
|
|
|
08008e28 <RadioOnTxTimeoutIrq>:
|
|
|
|
static void RadioOnTxTimeoutIrq( void *context )
|
|
{
|
|
8008e28: b580 push {r7, lr}
|
|
8008e2a: b082 sub sp, #8
|
|
8008e2c: af00 add r7, sp, #0
|
|
8008e2e: 6078 str r0, [r7, #4]
|
|
RADIO_TX_TIMEOUT_PROCESS();
|
|
8008e30: f000 f80e bl 8008e50 <RadioOnTxTimeoutProcess>
|
|
}
|
|
8008e34: bf00 nop
|
|
8008e36: 3708 adds r7, #8
|
|
8008e38: 46bd mov sp, r7
|
|
8008e3a: bd80 pop {r7, pc}
|
|
|
|
08008e3c <RadioOnRxTimeoutIrq>:
|
|
|
|
static void RadioOnRxTimeoutIrq( void *context )
|
|
{
|
|
8008e3c: b580 push {r7, lr}
|
|
8008e3e: b082 sub sp, #8
|
|
8008e40: af00 add r7, sp, #0
|
|
8008e42: 6078 str r0, [r7, #4]
|
|
RADIO_RX_TIMEOUT_PROCESS();
|
|
8008e44: f000 f81e bl 8008e84 <RadioOnRxTimeoutProcess>
|
|
}
|
|
8008e48: bf00 nop
|
|
8008e4a: 3708 adds r7, #8
|
|
8008e4c: 46bd mov sp, r7
|
|
8008e4e: bd80 pop {r7, pc}
|
|
|
|
08008e50 <RadioOnTxTimeoutProcess>:
|
|
|
|
static void RadioOnTxTimeoutProcess( void )
|
|
{
|
|
8008e50: b580 push {r7, lr}
|
|
8008e52: af00 add r7, sp, #0
|
|
DBG_GPIO_RADIO_TX( RST );
|
|
8008e54: f44f 5100 mov.w r1, #8192 @ 0x2000
|
|
8008e58: 4808 ldr r0, [pc, #32] @ (8008e7c <RadioOnTxTimeoutProcess+0x2c>)
|
|
8008e5a: f7fe ff3e bl 8007cda <LL_GPIO_ResetOutputPin>
|
|
|
|
if( ( RadioEvents != NULL ) && ( RadioEvents->TxTimeout != NULL ) )
|
|
8008e5e: 4b08 ldr r3, [pc, #32] @ (8008e80 <RadioOnTxTimeoutProcess+0x30>)
|
|
8008e60: 681b ldr r3, [r3, #0]
|
|
8008e62: 2b00 cmp r3, #0
|
|
8008e64: d008 beq.n 8008e78 <RadioOnTxTimeoutProcess+0x28>
|
|
8008e66: 4b06 ldr r3, [pc, #24] @ (8008e80 <RadioOnTxTimeoutProcess+0x30>)
|
|
8008e68: 681b ldr r3, [r3, #0]
|
|
8008e6a: 685b ldr r3, [r3, #4]
|
|
8008e6c: 2b00 cmp r3, #0
|
|
8008e6e: d003 beq.n 8008e78 <RadioOnTxTimeoutProcess+0x28>
|
|
{
|
|
RadioEvents->TxTimeout( );
|
|
8008e70: 4b03 ldr r3, [pc, #12] @ (8008e80 <RadioOnTxTimeoutProcess+0x30>)
|
|
8008e72: 681b ldr r3, [r3, #0]
|
|
8008e74: 685b ldr r3, [r3, #4]
|
|
8008e76: 4798 blx r3
|
|
}
|
|
}
|
|
8008e78: bf00 nop
|
|
8008e7a: bd80 pop {r7, pc}
|
|
8008e7c: 48000400 .word 0x48000400
|
|
8008e80: 200002f4 .word 0x200002f4
|
|
|
|
08008e84 <RadioOnRxTimeoutProcess>:
|
|
|
|
static void RadioOnRxTimeoutProcess( void )
|
|
{
|
|
8008e84: b580 push {r7, lr}
|
|
8008e86: af00 add r7, sp, #0
|
|
DBG_GPIO_RADIO_RX( RST );
|
|
8008e88: f44f 5180 mov.w r1, #4096 @ 0x1000
|
|
8008e8c: 4808 ldr r0, [pc, #32] @ (8008eb0 <RadioOnRxTimeoutProcess+0x2c>)
|
|
8008e8e: f7fe ff24 bl 8007cda <LL_GPIO_ResetOutputPin>
|
|
|
|
if( ( RadioEvents != NULL ) && ( RadioEvents->RxTimeout != NULL ) )
|
|
8008e92: 4b08 ldr r3, [pc, #32] @ (8008eb4 <RadioOnRxTimeoutProcess+0x30>)
|
|
8008e94: 681b ldr r3, [r3, #0]
|
|
8008e96: 2b00 cmp r3, #0
|
|
8008e98: d008 beq.n 8008eac <RadioOnRxTimeoutProcess+0x28>
|
|
8008e9a: 4b06 ldr r3, [pc, #24] @ (8008eb4 <RadioOnRxTimeoutProcess+0x30>)
|
|
8008e9c: 681b ldr r3, [r3, #0]
|
|
8008e9e: 68db ldr r3, [r3, #12]
|
|
8008ea0: 2b00 cmp r3, #0
|
|
8008ea2: d003 beq.n 8008eac <RadioOnRxTimeoutProcess+0x28>
|
|
{
|
|
RadioEvents->RxTimeout( );
|
|
8008ea4: 4b03 ldr r3, [pc, #12] @ (8008eb4 <RadioOnRxTimeoutProcess+0x30>)
|
|
8008ea6: 681b ldr r3, [r3, #0]
|
|
8008ea8: 68db ldr r3, [r3, #12]
|
|
8008eaa: 4798 blx r3
|
|
}
|
|
}
|
|
8008eac: bf00 nop
|
|
8008eae: bd80 pop {r7, pc}
|
|
8008eb0: 48000400 .word 0x48000400
|
|
8008eb4: 200002f4 .word 0x200002f4
|
|
|
|
08008eb8 <RadioOnDioIrq>:
|
|
|
|
static void RadioOnDioIrq( RadioIrqMasks_t radioIrq )
|
|
{
|
|
8008eb8: b580 push {r7, lr}
|
|
8008eba: b082 sub sp, #8
|
|
8008ebc: af00 add r7, sp, #0
|
|
8008ebe: 4603 mov r3, r0
|
|
8008ec0: 80fb strh r3, [r7, #6]
|
|
SubgRf.RadioIrq = radioIrq;
|
|
8008ec2: 4a05 ldr r2, [pc, #20] @ (8008ed8 <RadioOnDioIrq+0x20>)
|
|
8008ec4: 88fb ldrh r3, [r7, #6]
|
|
8008ec6: f8a2 3054 strh.w r3, [r2, #84] @ 0x54
|
|
|
|
RADIO_IRQ_PROCESS();
|
|
8008eca: f000 f807 bl 8008edc <RadioIrqProcess>
|
|
}
|
|
8008ece: bf00 nop
|
|
8008ed0: 3708 adds r7, #8
|
|
8008ed2: 46bd mov sp, r7
|
|
8008ed4: bd80 pop {r7, pc}
|
|
8008ed6: bf00 nop
|
|
8008ed8: 200002f8 .word 0x200002f8
|
|
|
|
08008edc <RadioIrqProcess>:
|
|
|
|
static void RadioIrqProcess( void )
|
|
{
|
|
8008edc: b5b0 push {r4, r5, r7, lr}
|
|
8008ede: b082 sub sp, #8
|
|
8008ee0: af00 add r7, sp, #0
|
|
uint8_t size = 0;
|
|
8008ee2: 2300 movs r3, #0
|
|
8008ee4: 71fb strb r3, [r7, #7]
|
|
int32_t cfo = 0;
|
|
8008ee6: 2300 movs r3, #0
|
|
8008ee8: 603b str r3, [r7, #0]
|
|
|
|
switch( SubgRf.RadioIrq )
|
|
8008eea: 4bb2 ldr r3, [pc, #712] @ (80091b4 <RadioIrqProcess+0x2d8>)
|
|
8008eec: f8b3 3054 ldrh.w r3, [r3, #84] @ 0x54
|
|
8008ef0: f5b3 7f00 cmp.w r3, #512 @ 0x200
|
|
8008ef4: f000 8117 beq.w 8009126 <RadioIrqProcess+0x24a>
|
|
8008ef8: f5b3 7f00 cmp.w r3, #512 @ 0x200
|
|
8008efc: f300 81fe bgt.w 80092fc <RadioIrqProcess+0x420>
|
|
8008f00: f5b3 7f80 cmp.w r3, #256 @ 0x100
|
|
8008f04: f000 80fb beq.w 80090fe <RadioIrqProcess+0x222>
|
|
8008f08: f5b3 7f80 cmp.w r3, #256 @ 0x100
|
|
8008f0c: f300 81f6 bgt.w 80092fc <RadioIrqProcess+0x420>
|
|
8008f10: 2b80 cmp r3, #128 @ 0x80
|
|
8008f12: f000 80e0 beq.w 80090d6 <RadioIrqProcess+0x1fa>
|
|
8008f16: 2b80 cmp r3, #128 @ 0x80
|
|
8008f18: f300 81f0 bgt.w 80092fc <RadioIrqProcess+0x420>
|
|
8008f1c: 2b20 cmp r3, #32
|
|
8008f1e: dc49 bgt.n 8008fb4 <RadioIrqProcess+0xd8>
|
|
8008f20: 2b00 cmp r3, #0
|
|
8008f22: f340 81eb ble.w 80092fc <RadioIrqProcess+0x420>
|
|
8008f26: 3b01 subs r3, #1
|
|
8008f28: 2b1f cmp r3, #31
|
|
8008f2a: f200 81e7 bhi.w 80092fc <RadioIrqProcess+0x420>
|
|
8008f2e: a201 add r2, pc, #4 @ (adr r2, 8008f34 <RadioIrqProcess+0x58>)
|
|
8008f30: f852 f023 ldr.w pc, [r2, r3, lsl #2]
|
|
8008f34: 08008fbd .word 0x08008fbd
|
|
8008f38: 08009001 .word 0x08009001
|
|
8008f3c: 080092fd .word 0x080092fd
|
|
8008f40: 080091d9 .word 0x080091d9
|
|
8008f44: 080092fd .word 0x080092fd
|
|
8008f48: 080092fd .word 0x080092fd
|
|
8008f4c: 080092fd .word 0x080092fd
|
|
8008f50: 08009255 .word 0x08009255
|
|
8008f54: 080092fd .word 0x080092fd
|
|
8008f58: 080092fd .word 0x080092fd
|
|
8008f5c: 080092fd .word 0x080092fd
|
|
8008f60: 080092fd .word 0x080092fd
|
|
8008f64: 080092fd .word 0x080092fd
|
|
8008f68: 080092fd .word 0x080092fd
|
|
8008f6c: 080092fd .word 0x080092fd
|
|
8008f70: 08009271 .word 0x08009271
|
|
8008f74: 080092fd .word 0x080092fd
|
|
8008f78: 080092fd .word 0x080092fd
|
|
8008f7c: 080092fd .word 0x080092fd
|
|
8008f80: 080092fd .word 0x080092fd
|
|
8008f84: 080092fd .word 0x080092fd
|
|
8008f88: 080092fd .word 0x080092fd
|
|
8008f8c: 080092fd .word 0x080092fd
|
|
8008f90: 080092fd .word 0x080092fd
|
|
8008f94: 080092fd .word 0x080092fd
|
|
8008f98: 080092fd .word 0x080092fd
|
|
8008f9c: 080092fd .word 0x080092fd
|
|
8008fa0: 080092fd .word 0x080092fd
|
|
8008fa4: 080092fd .word 0x080092fd
|
|
8008fa8: 080092fd .word 0x080092fd
|
|
8008fac: 080092fd .word 0x080092fd
|
|
8008fb0: 0800927f .word 0x0800927f
|
|
8008fb4: 2b40 cmp r3, #64 @ 0x40
|
|
8008fb6: f000 8183 beq.w 80092c0 <RadioIrqProcess+0x3e4>
|
|
MW_LOG( TS_ON, VLEVEL_M, "HOP\r\n" );
|
|
break;
|
|
}
|
|
#endif /* RADIO_LR_FHSS_IS_ON == 1 */
|
|
default:
|
|
break;
|
|
8008fba: e19f b.n 80092fc <RadioIrqProcess+0x420>
|
|
DBG_GPIO_RADIO_TX( RST );
|
|
8008fbc: f44f 5100 mov.w r1, #8192 @ 0x2000
|
|
8008fc0: 487d ldr r0, [pc, #500] @ (80091b8 <RadioIrqProcess+0x2dc>)
|
|
8008fc2: f7fe fe8a bl 8007cda <LL_GPIO_ResetOutputPin>
|
|
TimerStop( &TxTimeoutTimer );
|
|
8008fc6: 487d ldr r0, [pc, #500] @ (80091bc <RadioIrqProcess+0x2e0>)
|
|
8008fc8: f005 fa18 bl 800e3fc <UTIL_TIMER_Stop>
|
|
SUBGRF_SetStandby( STDBY_RC );
|
|
8008fcc: 2000 movs r0, #0
|
|
8008fce: f001 f835 bl 800a03c <SUBGRF_SetStandby>
|
|
if( RFW_Is_LongPacketModeEnabled() == 1 )
|
|
8008fd2: f002 fb3d bl 800b650 <RFW_Is_LongPacketModeEnabled>
|
|
8008fd6: 4603 mov r3, r0
|
|
8008fd8: 2b01 cmp r3, #1
|
|
8008fda: d101 bne.n 8008fe0 <RadioIrqProcess+0x104>
|
|
RFW_DeInit_TxLongPacket( );
|
|
8008fdc: f002 fbf4 bl 800b7c8 <RFW_DeInit_TxLongPacket>
|
|
if( ( RadioEvents != NULL ) && ( RadioEvents->TxDone != NULL ) )
|
|
8008fe0: 4b77 ldr r3, [pc, #476] @ (80091c0 <RadioIrqProcess+0x2e4>)
|
|
8008fe2: 681b ldr r3, [r3, #0]
|
|
8008fe4: 2b00 cmp r3, #0
|
|
8008fe6: f000 818b beq.w 8009300 <RadioIrqProcess+0x424>
|
|
8008fea: 4b75 ldr r3, [pc, #468] @ (80091c0 <RadioIrqProcess+0x2e4>)
|
|
8008fec: 681b ldr r3, [r3, #0]
|
|
8008fee: 681b ldr r3, [r3, #0]
|
|
8008ff0: 2b00 cmp r3, #0
|
|
8008ff2: f000 8185 beq.w 8009300 <RadioIrqProcess+0x424>
|
|
RadioEvents->TxDone( );
|
|
8008ff6: 4b72 ldr r3, [pc, #456] @ (80091c0 <RadioIrqProcess+0x2e4>)
|
|
8008ff8: 681b ldr r3, [r3, #0]
|
|
8008ffa: 681b ldr r3, [r3, #0]
|
|
8008ffc: 4798 blx r3
|
|
break;
|
|
8008ffe: e17f b.n 8009300 <RadioIrqProcess+0x424>
|
|
DBG_GPIO_RADIO_RX( RST );
|
|
8009000: f44f 5180 mov.w r1, #4096 @ 0x1000
|
|
8009004: 486c ldr r0, [pc, #432] @ (80091b8 <RadioIrqProcess+0x2dc>)
|
|
8009006: f7fe fe68 bl 8007cda <LL_GPIO_ResetOutputPin>
|
|
TimerStop( &RxTimeoutTimer );
|
|
800900a: 486e ldr r0, [pc, #440] @ (80091c4 <RadioIrqProcess+0x2e8>)
|
|
800900c: f005 f9f6 bl 800e3fc <UTIL_TIMER_Stop>
|
|
if( SubgRf.RxContinuous == false )
|
|
8009010: 4b68 ldr r3, [pc, #416] @ (80091b4 <RadioIrqProcess+0x2d8>)
|
|
8009012: 785b ldrb r3, [r3, #1]
|
|
8009014: f083 0301 eor.w r3, r3, #1
|
|
8009018: b2db uxtb r3, r3
|
|
800901a: 2b00 cmp r3, #0
|
|
800901c: d014 beq.n 8009048 <RadioIrqProcess+0x16c>
|
|
SUBGRF_SetStandby( STDBY_RC );
|
|
800901e: 2000 movs r0, #0
|
|
8009020: f001 f80c bl 800a03c <SUBGRF_SetStandby>
|
|
SUBGRF_WriteRegister( SUBGHZ_RTCCTLR, 0x00 );
|
|
8009024: 2100 movs r1, #0
|
|
8009026: f640 1002 movw r0, #2306 @ 0x902
|
|
800902a: f001 fd8b bl 800ab44 <SUBGRF_WriteRegister>
|
|
SUBGRF_WriteRegister( SUBGHZ_EVENTMASKR, SUBGRF_ReadRegister( SUBGHZ_EVENTMASKR ) | ( 1 << 1 ) );
|
|
800902e: f640 1044 movw r0, #2372 @ 0x944
|
|
8009032: f001 fda9 bl 800ab88 <SUBGRF_ReadRegister>
|
|
8009036: 4603 mov r3, r0
|
|
8009038: f043 0302 orr.w r3, r3, #2
|
|
800903c: b2db uxtb r3, r3
|
|
800903e: 4619 mov r1, r3
|
|
8009040: f640 1044 movw r0, #2372 @ 0x944
|
|
8009044: f001 fd7e bl 800ab44 <SUBGRF_WriteRegister>
|
|
SUBGRF_GetPayload( RadioBuffer, &size, 255 );
|
|
8009048: 1dfb adds r3, r7, #7
|
|
800904a: 22ff movs r2, #255 @ 0xff
|
|
800904c: 4619 mov r1, r3
|
|
800904e: 485e ldr r0, [pc, #376] @ (80091c8 <RadioIrqProcess+0x2ec>)
|
|
8009050: f000 fec2 bl 8009dd8 <SUBGRF_GetPayload>
|
|
SUBGRF_GetPacketStatus( &( SubgRf.PacketStatus ) );
|
|
8009054: 485d ldr r0, [pc, #372] @ (80091cc <RadioIrqProcess+0x2f0>)
|
|
8009056: f001 fd23 bl 800aaa0 <SUBGRF_GetPacketStatus>
|
|
if( ( RadioEvents != NULL ) && ( RadioEvents->RxDone != NULL ) )
|
|
800905a: 4b59 ldr r3, [pc, #356] @ (80091c0 <RadioIrqProcess+0x2e4>)
|
|
800905c: 681b ldr r3, [r3, #0]
|
|
800905e: 2b00 cmp r3, #0
|
|
8009060: f000 8150 beq.w 8009304 <RadioIrqProcess+0x428>
|
|
8009064: 4b56 ldr r3, [pc, #344] @ (80091c0 <RadioIrqProcess+0x2e4>)
|
|
8009066: 681b ldr r3, [r3, #0]
|
|
8009068: 689b ldr r3, [r3, #8]
|
|
800906a: 2b00 cmp r3, #0
|
|
800906c: f000 814a beq.w 8009304 <RadioIrqProcess+0x428>
|
|
switch( SubgRf.PacketStatus.packetType )
|
|
8009070: 4b50 ldr r3, [pc, #320] @ (80091b4 <RadioIrqProcess+0x2d8>)
|
|
8009072: f893 3024 ldrb.w r3, [r3, #36] @ 0x24
|
|
8009076: 2b01 cmp r3, #1
|
|
8009078: d10e bne.n 8009098 <RadioIrqProcess+0x1bc>
|
|
RadioEvents->RxDone( RadioBuffer, size, SubgRf.PacketStatus.Params.LoRa.RssiPkt,
|
|
800907a: 4b51 ldr r3, [pc, #324] @ (80091c0 <RadioIrqProcess+0x2e4>)
|
|
800907c: 681b ldr r3, [r3, #0]
|
|
800907e: 689c ldr r4, [r3, #8]
|
|
8009080: 79fb ldrb r3, [r7, #7]
|
|
8009082: 4619 mov r1, r3
|
|
8009084: 4b4b ldr r3, [pc, #300] @ (80091b4 <RadioIrqProcess+0x2d8>)
|
|
8009086: f993 3030 ldrsb.w r3, [r3, #48] @ 0x30
|
|
800908a: 461a mov r2, r3
|
|
800908c: 4b49 ldr r3, [pc, #292] @ (80091b4 <RadioIrqProcess+0x2d8>)
|
|
800908e: f993 3031 ldrsb.w r3, [r3, #49] @ 0x31
|
|
8009092: 484d ldr r0, [pc, #308] @ (80091c8 <RadioIrqProcess+0x2ec>)
|
|
8009094: 47a0 blx r4
|
|
break;
|
|
8009096: e01d b.n 80090d4 <RadioIrqProcess+0x1f8>
|
|
SUBGRF_GetCFO( SubgRf.ModulationParams.Params.Gfsk.BitRate, &cfo );
|
|
8009098: 4b46 ldr r3, [pc, #280] @ (80091b4 <RadioIrqProcess+0x2d8>)
|
|
800909a: 6bdb ldr r3, [r3, #60] @ 0x3c
|
|
800909c: 463a mov r2, r7
|
|
800909e: 4611 mov r1, r2
|
|
80090a0: 4618 mov r0, r3
|
|
80090a2: f001 ffab bl 800affc <SUBGRF_GetCFO>
|
|
RadioEvents->RxDone( RadioBuffer, size, SubgRf.PacketStatus.Params.Gfsk.RssiAvg, ( int8_t ) DIVR( cfo, 1000 ) );
|
|
80090a6: 4b46 ldr r3, [pc, #280] @ (80091c0 <RadioIrqProcess+0x2e4>)
|
|
80090a8: 681b ldr r3, [r3, #0]
|
|
80090aa: 689c ldr r4, [r3, #8]
|
|
80090ac: 79fb ldrb r3, [r7, #7]
|
|
80090ae: 4619 mov r1, r3
|
|
80090b0: 4b40 ldr r3, [pc, #256] @ (80091b4 <RadioIrqProcess+0x2d8>)
|
|
80090b2: f993 3029 ldrsb.w r3, [r3, #41] @ 0x29
|
|
80090b6: 4618 mov r0, r3
|
|
80090b8: 683b ldr r3, [r7, #0]
|
|
80090ba: f503 73fa add.w r3, r3, #500 @ 0x1f4
|
|
80090be: 4a44 ldr r2, [pc, #272] @ (80091d0 <RadioIrqProcess+0x2f4>)
|
|
80090c0: fb82 5203 smull r5, r2, r2, r3
|
|
80090c4: 1192 asrs r2, r2, #6
|
|
80090c6: 17db asrs r3, r3, #31
|
|
80090c8: 1ad3 subs r3, r2, r3
|
|
80090ca: b25b sxtb r3, r3
|
|
80090cc: 4602 mov r2, r0
|
|
80090ce: 483e ldr r0, [pc, #248] @ (80091c8 <RadioIrqProcess+0x2ec>)
|
|
80090d0: 47a0 blx r4
|
|
break;
|
|
80090d2: bf00 nop
|
|
break;
|
|
80090d4: e116 b.n 8009304 <RadioIrqProcess+0x428>
|
|
SUBGRF_SetStandby( STDBY_RC );
|
|
80090d6: 2000 movs r0, #0
|
|
80090d8: f000 ffb0 bl 800a03c <SUBGRF_SetStandby>
|
|
if( ( RadioEvents != NULL ) && ( RadioEvents->CadDone != NULL ) )
|
|
80090dc: 4b38 ldr r3, [pc, #224] @ (80091c0 <RadioIrqProcess+0x2e4>)
|
|
80090de: 681b ldr r3, [r3, #0]
|
|
80090e0: 2b00 cmp r3, #0
|
|
80090e2: f000 8111 beq.w 8009308 <RadioIrqProcess+0x42c>
|
|
80090e6: 4b36 ldr r3, [pc, #216] @ (80091c0 <RadioIrqProcess+0x2e4>)
|
|
80090e8: 681b ldr r3, [r3, #0]
|
|
80090ea: 699b ldr r3, [r3, #24]
|
|
80090ec: 2b00 cmp r3, #0
|
|
80090ee: f000 810b beq.w 8009308 <RadioIrqProcess+0x42c>
|
|
RadioEvents->CadDone( false );
|
|
80090f2: 4b33 ldr r3, [pc, #204] @ (80091c0 <RadioIrqProcess+0x2e4>)
|
|
80090f4: 681b ldr r3, [r3, #0]
|
|
80090f6: 699b ldr r3, [r3, #24]
|
|
80090f8: 2000 movs r0, #0
|
|
80090fa: 4798 blx r3
|
|
break;
|
|
80090fc: e104 b.n 8009308 <RadioIrqProcess+0x42c>
|
|
SUBGRF_SetStandby( STDBY_RC );
|
|
80090fe: 2000 movs r0, #0
|
|
8009100: f000 ff9c bl 800a03c <SUBGRF_SetStandby>
|
|
if( ( RadioEvents != NULL ) && ( RadioEvents->CadDone != NULL ) )
|
|
8009104: 4b2e ldr r3, [pc, #184] @ (80091c0 <RadioIrqProcess+0x2e4>)
|
|
8009106: 681b ldr r3, [r3, #0]
|
|
8009108: 2b00 cmp r3, #0
|
|
800910a: f000 80ff beq.w 800930c <RadioIrqProcess+0x430>
|
|
800910e: 4b2c ldr r3, [pc, #176] @ (80091c0 <RadioIrqProcess+0x2e4>)
|
|
8009110: 681b ldr r3, [r3, #0]
|
|
8009112: 699b ldr r3, [r3, #24]
|
|
8009114: 2b00 cmp r3, #0
|
|
8009116: f000 80f9 beq.w 800930c <RadioIrqProcess+0x430>
|
|
RadioEvents->CadDone( true );
|
|
800911a: 4b29 ldr r3, [pc, #164] @ (80091c0 <RadioIrqProcess+0x2e4>)
|
|
800911c: 681b ldr r3, [r3, #0]
|
|
800911e: 699b ldr r3, [r3, #24]
|
|
8009120: 2001 movs r0, #1
|
|
8009122: 4798 blx r3
|
|
break;
|
|
8009124: e0f2 b.n 800930c <RadioIrqProcess+0x430>
|
|
MW_LOG( TS_ON, VLEVEL_M, "IRQ_RX_TX_TIMEOUT\r\n" );
|
|
8009126: 4b2b ldr r3, [pc, #172] @ (80091d4 <RadioIrqProcess+0x2f8>)
|
|
8009128: 2201 movs r2, #1
|
|
800912a: 2100 movs r1, #0
|
|
800912c: 2002 movs r0, #2
|
|
800912e: f005 fb5d bl 800e7ec <UTIL_ADV_TRACE_COND_FSend>
|
|
if( SUBGRF_GetOperatingMode( ) == MODE_TX )
|
|
8009132: f000 fe37 bl 8009da4 <SUBGRF_GetOperatingMode>
|
|
8009136: 4603 mov r3, r0
|
|
8009138: 2b04 cmp r3, #4
|
|
800913a: d11a bne.n 8009172 <RadioIrqProcess+0x296>
|
|
DBG_GPIO_RADIO_TX( RST );
|
|
800913c: f44f 5100 mov.w r1, #8192 @ 0x2000
|
|
8009140: 481d ldr r0, [pc, #116] @ (80091b8 <RadioIrqProcess+0x2dc>)
|
|
8009142: f7fe fdca bl 8007cda <LL_GPIO_ResetOutputPin>
|
|
TimerStop( &TxTimeoutTimer );
|
|
8009146: 481d ldr r0, [pc, #116] @ (80091bc <RadioIrqProcess+0x2e0>)
|
|
8009148: f005 f958 bl 800e3fc <UTIL_TIMER_Stop>
|
|
SUBGRF_SetStandby( STDBY_RC );
|
|
800914c: 2000 movs r0, #0
|
|
800914e: f000 ff75 bl 800a03c <SUBGRF_SetStandby>
|
|
if( ( RadioEvents != NULL ) && ( RadioEvents->TxTimeout != NULL ) )
|
|
8009152: 4b1b ldr r3, [pc, #108] @ (80091c0 <RadioIrqProcess+0x2e4>)
|
|
8009154: 681b ldr r3, [r3, #0]
|
|
8009156: 2b00 cmp r3, #0
|
|
8009158: f000 80da beq.w 8009310 <RadioIrqProcess+0x434>
|
|
800915c: 4b18 ldr r3, [pc, #96] @ (80091c0 <RadioIrqProcess+0x2e4>)
|
|
800915e: 681b ldr r3, [r3, #0]
|
|
8009160: 685b ldr r3, [r3, #4]
|
|
8009162: 2b00 cmp r3, #0
|
|
8009164: f000 80d4 beq.w 8009310 <RadioIrqProcess+0x434>
|
|
RadioEvents->TxTimeout( );
|
|
8009168: 4b15 ldr r3, [pc, #84] @ (80091c0 <RadioIrqProcess+0x2e4>)
|
|
800916a: 681b ldr r3, [r3, #0]
|
|
800916c: 685b ldr r3, [r3, #4]
|
|
800916e: 4798 blx r3
|
|
break;
|
|
8009170: e0ce b.n 8009310 <RadioIrqProcess+0x434>
|
|
else if( SUBGRF_GetOperatingMode( ) == MODE_RX )
|
|
8009172: f000 fe17 bl 8009da4 <SUBGRF_GetOperatingMode>
|
|
8009176: 4603 mov r3, r0
|
|
8009178: 2b05 cmp r3, #5
|
|
800917a: f040 80c9 bne.w 8009310 <RadioIrqProcess+0x434>
|
|
DBG_GPIO_RADIO_RX( RST );
|
|
800917e: f44f 5180 mov.w r1, #4096 @ 0x1000
|
|
8009182: 480d ldr r0, [pc, #52] @ (80091b8 <RadioIrqProcess+0x2dc>)
|
|
8009184: f7fe fda9 bl 8007cda <LL_GPIO_ResetOutputPin>
|
|
TimerStop( &RxTimeoutTimer );
|
|
8009188: 480e ldr r0, [pc, #56] @ (80091c4 <RadioIrqProcess+0x2e8>)
|
|
800918a: f005 f937 bl 800e3fc <UTIL_TIMER_Stop>
|
|
SUBGRF_SetStandby( STDBY_RC );
|
|
800918e: 2000 movs r0, #0
|
|
8009190: f000 ff54 bl 800a03c <SUBGRF_SetStandby>
|
|
if( ( RadioEvents != NULL ) && ( RadioEvents->RxTimeout != NULL ) )
|
|
8009194: 4b0a ldr r3, [pc, #40] @ (80091c0 <RadioIrqProcess+0x2e4>)
|
|
8009196: 681b ldr r3, [r3, #0]
|
|
8009198: 2b00 cmp r3, #0
|
|
800919a: f000 80b9 beq.w 8009310 <RadioIrqProcess+0x434>
|
|
800919e: 4b08 ldr r3, [pc, #32] @ (80091c0 <RadioIrqProcess+0x2e4>)
|
|
80091a0: 681b ldr r3, [r3, #0]
|
|
80091a2: 68db ldr r3, [r3, #12]
|
|
80091a4: 2b00 cmp r3, #0
|
|
80091a6: f000 80b3 beq.w 8009310 <RadioIrqProcess+0x434>
|
|
RadioEvents->RxTimeout( );
|
|
80091aa: 4b05 ldr r3, [pc, #20] @ (80091c0 <RadioIrqProcess+0x2e4>)
|
|
80091ac: 681b ldr r3, [r3, #0]
|
|
80091ae: 68db ldr r3, [r3, #12]
|
|
80091b0: 4798 blx r3
|
|
break;
|
|
80091b2: e0ad b.n 8009310 <RadioIrqProcess+0x434>
|
|
80091b4: 200002f8 .word 0x200002f8
|
|
80091b8: 48000400 .word 0x48000400
|
|
80091bc: 20000354 .word 0x20000354
|
|
80091c0: 200002f4 .word 0x200002f4
|
|
80091c4: 2000036c .word 0x2000036c
|
|
80091c8: 200001f4 .word 0x200001f4
|
|
80091cc: 2000031c .word 0x2000031c
|
|
80091d0: 10624dd3 .word 0x10624dd3
|
|
80091d4: 0800f8d4 .word 0x0800f8d4
|
|
MW_LOG( TS_ON, VLEVEL_M, "PRE OK\r\n" );
|
|
80091d8: 4b54 ldr r3, [pc, #336] @ (800932c <RadioIrqProcess+0x450>)
|
|
80091da: 2201 movs r2, #1
|
|
80091dc: 2100 movs r1, #0
|
|
80091de: 2002 movs r0, #2
|
|
80091e0: f005 fb04 bl 800e7ec <UTIL_ADV_TRACE_COND_FSend>
|
|
if( SubgRf.RxDcPreambleDetectTimeout != 0 )
|
|
80091e4: 4b52 ldr r3, [pc, #328] @ (8009330 <RadioIrqProcess+0x454>)
|
|
80091e6: 6d9b ldr r3, [r3, #88] @ 0x58
|
|
80091e8: 2b00 cmp r3, #0
|
|
80091ea: f000 8093 beq.w 8009314 <RadioIrqProcess+0x438>
|
|
Radio.Write( SUBGHZ_RTCPRDR2, ( SubgRf.RxDcPreambleDetectTimeout >> 16 ) & 0xFF ); /*Update Radio RTC Period MSB*/
|
|
80091ee: 4a51 ldr r2, [pc, #324] @ (8009334 <RadioIrqProcess+0x458>)
|
|
80091f0: 4b4f ldr r3, [pc, #316] @ (8009330 <RadioIrqProcess+0x454>)
|
|
80091f2: 6d9b ldr r3, [r3, #88] @ 0x58
|
|
80091f4: 0c1b lsrs r3, r3, #16
|
|
80091f6: b2db uxtb r3, r3
|
|
80091f8: 4619 mov r1, r3
|
|
80091fa: f640 1003 movw r0, #2307 @ 0x903
|
|
80091fe: 4790 blx r2
|
|
Radio.Write( SUBGHZ_RTCPRDR1, ( SubgRf.RxDcPreambleDetectTimeout >> 8 ) & 0xFF ); /*Update Radio RTC Period MidByte*/
|
|
8009200: 4a4c ldr r2, [pc, #304] @ (8009334 <RadioIrqProcess+0x458>)
|
|
8009202: 4b4b ldr r3, [pc, #300] @ (8009330 <RadioIrqProcess+0x454>)
|
|
8009204: 6d9b ldr r3, [r3, #88] @ 0x58
|
|
8009206: 0a1b lsrs r3, r3, #8
|
|
8009208: b2db uxtb r3, r3
|
|
800920a: 4619 mov r1, r3
|
|
800920c: f640 1004 movw r0, #2308 @ 0x904
|
|
8009210: 4790 blx r2
|
|
Radio.Write( SUBGHZ_RTCPRDR0, ( SubgRf.RxDcPreambleDetectTimeout ) & 0xFF ); /*Update Radio RTC Period lsb*/
|
|
8009212: 4a48 ldr r2, [pc, #288] @ (8009334 <RadioIrqProcess+0x458>)
|
|
8009214: 4b46 ldr r3, [pc, #280] @ (8009330 <RadioIrqProcess+0x454>)
|
|
8009216: 6d9b ldr r3, [r3, #88] @ 0x58
|
|
8009218: b2db uxtb r3, r3
|
|
800921a: 4619 mov r1, r3
|
|
800921c: f640 1005 movw r0, #2309 @ 0x905
|
|
8009220: 4790 blx r2
|
|
Radio.Write( SUBGHZ_RTCCTLR, Radio.Read( SUBGHZ_RTCCTLR ) | 0x1 ); /*restart Radio RTC*/
|
|
8009222: 4c44 ldr r4, [pc, #272] @ (8009334 <RadioIrqProcess+0x458>)
|
|
8009224: 4b44 ldr r3, [pc, #272] @ (8009338 <RadioIrqProcess+0x45c>)
|
|
8009226: f640 1002 movw r0, #2306 @ 0x902
|
|
800922a: 4798 blx r3
|
|
800922c: 4603 mov r3, r0
|
|
800922e: f043 0301 orr.w r3, r3, #1
|
|
8009232: b2db uxtb r3, r3
|
|
8009234: 4619 mov r1, r3
|
|
8009236: f640 1002 movw r0, #2306 @ 0x902
|
|
800923a: 47a0 blx r4
|
|
SubgRf.RxDcPreambleDetectTimeout = 0;
|
|
800923c: 4b3c ldr r3, [pc, #240] @ (8009330 <RadioIrqProcess+0x454>)
|
|
800923e: 2200 movs r2, #0
|
|
8009240: 659a str r2, [r3, #88] @ 0x58
|
|
SUBGRF_SetDioIrqParams( IRQ_RX_DONE | IRQ_RX_TX_TIMEOUT | IRQ_CRC_ERROR | IRQ_HEADER_ERROR | IRQ_RX_DBG,
|
|
8009242: 2300 movs r3, #0
|
|
8009244: 2200 movs r2, #0
|
|
8009246: f240 2162 movw r1, #610 @ 0x262
|
|
800924a: f240 2062 movw r0, #610 @ 0x262
|
|
800924e: f001 f8cf bl 800a3f0 <SUBGRF_SetDioIrqParams>
|
|
break;
|
|
8009252: e05f b.n 8009314 <RadioIrqProcess+0x438>
|
|
MW_LOG( TS_ON, VLEVEL_M, "SYNC OK\r\n" );
|
|
8009254: 4b39 ldr r3, [pc, #228] @ (800933c <RadioIrqProcess+0x460>)
|
|
8009256: 2201 movs r2, #1
|
|
8009258: 2100 movs r1, #0
|
|
800925a: 2002 movs r0, #2
|
|
800925c: f005 fac6 bl 800e7ec <UTIL_ADV_TRACE_COND_FSend>
|
|
if( 1UL == RFW_Is_Init( ) )
|
|
8009260: f002 f9ec bl 800b63c <RFW_Is_Init>
|
|
8009264: 4603 mov r3, r0
|
|
8009266: 2b01 cmp r3, #1
|
|
8009268: d156 bne.n 8009318 <RadioIrqProcess+0x43c>
|
|
RFW_ReceivePayload( );
|
|
800926a: f002 fac9 bl 800b800 <RFW_ReceivePayload>
|
|
break;
|
|
800926e: e053 b.n 8009318 <RadioIrqProcess+0x43c>
|
|
MW_LOG( TS_ON, VLEVEL_M, "HDR OK\r\n" );
|
|
8009270: 4b33 ldr r3, [pc, #204] @ (8009340 <RadioIrqProcess+0x464>)
|
|
8009272: 2201 movs r2, #1
|
|
8009274: 2100 movs r1, #0
|
|
8009276: 2002 movs r0, #2
|
|
8009278: f005 fab8 bl 800e7ec <UTIL_ADV_TRACE_COND_FSend>
|
|
break;
|
|
800927c: e051 b.n 8009322 <RadioIrqProcess+0x446>
|
|
TimerStop( &RxTimeoutTimer );
|
|
800927e: 4831 ldr r0, [pc, #196] @ (8009344 <RadioIrqProcess+0x468>)
|
|
8009280: f005 f8bc bl 800e3fc <UTIL_TIMER_Stop>
|
|
if( SubgRf.RxContinuous == false )
|
|
8009284: 4b2a ldr r3, [pc, #168] @ (8009330 <RadioIrqProcess+0x454>)
|
|
8009286: 785b ldrb r3, [r3, #1]
|
|
8009288: f083 0301 eor.w r3, r3, #1
|
|
800928c: b2db uxtb r3, r3
|
|
800928e: 2b00 cmp r3, #0
|
|
8009290: d002 beq.n 8009298 <RadioIrqProcess+0x3bc>
|
|
SUBGRF_SetStandby( STDBY_RC );
|
|
8009292: 2000 movs r0, #0
|
|
8009294: f000 fed2 bl 800a03c <SUBGRF_SetStandby>
|
|
if( ( RadioEvents != NULL ) && ( RadioEvents->RxTimeout != NULL ) )
|
|
8009298: 4b2b ldr r3, [pc, #172] @ (8009348 <RadioIrqProcess+0x46c>)
|
|
800929a: 681b ldr r3, [r3, #0]
|
|
800929c: 2b00 cmp r3, #0
|
|
800929e: d03d beq.n 800931c <RadioIrqProcess+0x440>
|
|
80092a0: 4b29 ldr r3, [pc, #164] @ (8009348 <RadioIrqProcess+0x46c>)
|
|
80092a2: 681b ldr r3, [r3, #0]
|
|
80092a4: 68db ldr r3, [r3, #12]
|
|
80092a6: 2b00 cmp r3, #0
|
|
80092a8: d038 beq.n 800931c <RadioIrqProcess+0x440>
|
|
RadioEvents->RxTimeout( );
|
|
80092aa: 4b27 ldr r3, [pc, #156] @ (8009348 <RadioIrqProcess+0x46c>)
|
|
80092ac: 681b ldr r3, [r3, #0]
|
|
80092ae: 68db ldr r3, [r3, #12]
|
|
80092b0: 4798 blx r3
|
|
MW_LOG( TS_ON, VLEVEL_M, "HDR KO\r\n" );
|
|
80092b2: 4b26 ldr r3, [pc, #152] @ (800934c <RadioIrqProcess+0x470>)
|
|
80092b4: 2201 movs r2, #1
|
|
80092b6: 2100 movs r1, #0
|
|
80092b8: 2002 movs r0, #2
|
|
80092ba: f005 fa97 bl 800e7ec <UTIL_ADV_TRACE_COND_FSend>
|
|
break;
|
|
80092be: e02d b.n 800931c <RadioIrqProcess+0x440>
|
|
MW_LOG( TS_ON, VLEVEL_M, "IRQ_CRC_ERROR\r\n" );
|
|
80092c0: 4b23 ldr r3, [pc, #140] @ (8009350 <RadioIrqProcess+0x474>)
|
|
80092c2: 2201 movs r2, #1
|
|
80092c4: 2100 movs r1, #0
|
|
80092c6: 2002 movs r0, #2
|
|
80092c8: f005 fa90 bl 800e7ec <UTIL_ADV_TRACE_COND_FSend>
|
|
if( SubgRf.RxContinuous == false )
|
|
80092cc: 4b18 ldr r3, [pc, #96] @ (8009330 <RadioIrqProcess+0x454>)
|
|
80092ce: 785b ldrb r3, [r3, #1]
|
|
80092d0: f083 0301 eor.w r3, r3, #1
|
|
80092d4: b2db uxtb r3, r3
|
|
80092d6: 2b00 cmp r3, #0
|
|
80092d8: d002 beq.n 80092e0 <RadioIrqProcess+0x404>
|
|
SUBGRF_SetStandby( STDBY_RC );
|
|
80092da: 2000 movs r0, #0
|
|
80092dc: f000 feae bl 800a03c <SUBGRF_SetStandby>
|
|
if( ( RadioEvents != NULL ) && ( RadioEvents->RxError ) )
|
|
80092e0: 4b19 ldr r3, [pc, #100] @ (8009348 <RadioIrqProcess+0x46c>)
|
|
80092e2: 681b ldr r3, [r3, #0]
|
|
80092e4: 2b00 cmp r3, #0
|
|
80092e6: d01b beq.n 8009320 <RadioIrqProcess+0x444>
|
|
80092e8: 4b17 ldr r3, [pc, #92] @ (8009348 <RadioIrqProcess+0x46c>)
|
|
80092ea: 681b ldr r3, [r3, #0]
|
|
80092ec: 691b ldr r3, [r3, #16]
|
|
80092ee: 2b00 cmp r3, #0
|
|
80092f0: d016 beq.n 8009320 <RadioIrqProcess+0x444>
|
|
RadioEvents->RxError( );
|
|
80092f2: 4b15 ldr r3, [pc, #84] @ (8009348 <RadioIrqProcess+0x46c>)
|
|
80092f4: 681b ldr r3, [r3, #0]
|
|
80092f6: 691b ldr r3, [r3, #16]
|
|
80092f8: 4798 blx r3
|
|
break;
|
|
80092fa: e011 b.n 8009320 <RadioIrqProcess+0x444>
|
|
break;
|
|
80092fc: bf00 nop
|
|
80092fe: e010 b.n 8009322 <RadioIrqProcess+0x446>
|
|
break;
|
|
8009300: bf00 nop
|
|
8009302: e00e b.n 8009322 <RadioIrqProcess+0x446>
|
|
break;
|
|
8009304: bf00 nop
|
|
8009306: e00c b.n 8009322 <RadioIrqProcess+0x446>
|
|
break;
|
|
8009308: bf00 nop
|
|
800930a: e00a b.n 8009322 <RadioIrqProcess+0x446>
|
|
break;
|
|
800930c: bf00 nop
|
|
800930e: e008 b.n 8009322 <RadioIrqProcess+0x446>
|
|
break;
|
|
8009310: bf00 nop
|
|
8009312: e006 b.n 8009322 <RadioIrqProcess+0x446>
|
|
break;
|
|
8009314: bf00 nop
|
|
8009316: e004 b.n 8009322 <RadioIrqProcess+0x446>
|
|
break;
|
|
8009318: bf00 nop
|
|
800931a: e002 b.n 8009322 <RadioIrqProcess+0x446>
|
|
break;
|
|
800931c: bf00 nop
|
|
800931e: e000 b.n 8009322 <RadioIrqProcess+0x446>
|
|
break;
|
|
8009320: bf00 nop
|
|
}
|
|
}
|
|
8009322: bf00 nop
|
|
8009324: 3708 adds r7, #8
|
|
8009326: 46bd mov sp, r7
|
|
8009328: bdb0 pop {r4, r5, r7, pc}
|
|
800932a: bf00 nop
|
|
800932c: 0800f8e8 .word 0x0800f8e8
|
|
8009330: 200002f8 .word 0x200002f8
|
|
8009334: 08008cd5 .word 0x08008cd5
|
|
8009338: 08008cf9 .word 0x08008cf9
|
|
800933c: 0800f8f4 .word 0x0800f8f4
|
|
8009340: 0800f900 .word 0x0800f900
|
|
8009344: 2000036c .word 0x2000036c
|
|
8009348: 200002f4 .word 0x200002f4
|
|
800934c: 0800f90c .word 0x0800f90c
|
|
8009350: 0800f918 .word 0x0800f918
|
|
|
|
08009354 <RadioTxPrbs>:
|
|
|
|
static void RadioTxPrbs( void )
|
|
{
|
|
8009354: b580 push {r7, lr}
|
|
8009356: af00 add r7, sp, #0
|
|
SUBGRF_SetSwitch( SubgRf.AntSwitchPaSelect, RFSWITCH_TX );
|
|
8009358: 4b09 ldr r3, [pc, #36] @ (8009380 <RadioTxPrbs+0x2c>)
|
|
800935a: f893 3056 ldrb.w r3, [r3, #86] @ 0x56
|
|
800935e: 2101 movs r1, #1
|
|
8009360: 4618 mov r0, r3
|
|
8009362: f001 fcfd bl 800ad60 <SUBGRF_SetSwitch>
|
|
Radio.Write( SUBGHZ_GPKTCTL1AR, 0x2d ); // sel mode prbs9 instead of preamble
|
|
8009366: 4b07 ldr r3, [pc, #28] @ (8009384 <RadioTxPrbs+0x30>)
|
|
8009368: 212d movs r1, #45 @ 0x2d
|
|
800936a: f44f 60d7 mov.w r0, #1720 @ 0x6b8
|
|
800936e: 4798 blx r3
|
|
SUBGRF_SetTxInfinitePreamble( );
|
|
8009370: f000 ff27 bl 800a1c2 <SUBGRF_SetTxInfinitePreamble>
|
|
SUBGRF_SetTx( 0x0fffff );
|
|
8009374: 4804 ldr r0, [pc, #16] @ (8009388 <RadioTxPrbs+0x34>)
|
|
8009376: f000 fe7d bl 800a074 <SUBGRF_SetTx>
|
|
}
|
|
800937a: bf00 nop
|
|
800937c: bd80 pop {r7, pc}
|
|
800937e: bf00 nop
|
|
8009380: 200002f8 .word 0x200002f8
|
|
8009384: 08008cd5 .word 0x08008cd5
|
|
8009388: 000fffff .word 0x000fffff
|
|
|
|
0800938c <RadioTxCw>:
|
|
|
|
static void RadioTxCw( int8_t power )
|
|
{
|
|
800938c: b580 push {r7, lr}
|
|
800938e: b084 sub sp, #16
|
|
8009390: af00 add r7, sp, #0
|
|
8009392: 4603 mov r3, r0
|
|
8009394: 71fb strb r3, [r7, #7]
|
|
uint8_t paselect = SUBGRF_SetRfTxPower( power );
|
|
8009396: f997 3007 ldrsb.w r3, [r7, #7]
|
|
800939a: 4618 mov r0, r3
|
|
800939c: f001 fd08 bl 800adb0 <SUBGRF_SetRfTxPower>
|
|
80093a0: 4603 mov r3, r0
|
|
80093a2: 73fb strb r3, [r7, #15]
|
|
/* WORKAROUND - Trimming the output voltage power_ldo to 3.3V */
|
|
SUBGRF_WriteRegister(REG_DRV_CTRL, 0x7 << 1);
|
|
80093a4: 210e movs r1, #14
|
|
80093a6: f640 101f movw r0, #2335 @ 0x91f
|
|
80093aa: f001 fbcb bl 800ab44 <SUBGRF_WriteRegister>
|
|
SUBGRF_SetSwitch( paselect, RFSWITCH_TX );
|
|
80093ae: 7bfb ldrb r3, [r7, #15]
|
|
80093b0: 2101 movs r1, #1
|
|
80093b2: 4618 mov r0, r3
|
|
80093b4: f001 fcd4 bl 800ad60 <SUBGRF_SetSwitch>
|
|
SUBGRF_SetTxContinuousWave( );
|
|
80093b8: f000 fefa bl 800a1b0 <SUBGRF_SetTxContinuousWave>
|
|
}
|
|
80093bc: bf00 nop
|
|
80093be: 3710 adds r7, #16
|
|
80093c0: 46bd mov sp, r7
|
|
80093c2: bd80 pop {r7, pc}
|
|
|
|
080093c4 <payload_integration>:
|
|
|
|
#if (RADIO_SIGFOX_ENABLE == 1)
|
|
static void payload_integration( uint8_t *outBuffer, uint8_t *inBuffer, uint8_t size )
|
|
{
|
|
80093c4: b480 push {r7}
|
|
80093c6: b089 sub sp, #36 @ 0x24
|
|
80093c8: af00 add r7, sp, #0
|
|
80093ca: 60f8 str r0, [r7, #12]
|
|
80093cc: 60b9 str r1, [r7, #8]
|
|
80093ce: 4613 mov r3, r2
|
|
80093d0: 71fb strb r3, [r7, #7]
|
|
uint8_t prevInt = 0;
|
|
80093d2: 2300 movs r3, #0
|
|
80093d4: 77fb strb r3, [r7, #31]
|
|
uint8_t currBit;
|
|
uint8_t index_bit;
|
|
uint8_t index_byte;
|
|
uint8_t index_bit_out;
|
|
uint8_t index_byte_out;
|
|
int32_t i = 0;
|
|
80093d6: 2300 movs r3, #0
|
|
80093d8: 61bb str r3, [r7, #24]
|
|
|
|
for( i = 0; i < size; i++ )
|
|
80093da: 2300 movs r3, #0
|
|
80093dc: 61bb str r3, [r7, #24]
|
|
80093de: e011 b.n 8009404 <payload_integration+0x40>
|
|
{
|
|
/* reverse all inputs */
|
|
inBuffer[i] = ~inBuffer[i];
|
|
80093e0: 69bb ldr r3, [r7, #24]
|
|
80093e2: 68ba ldr r2, [r7, #8]
|
|
80093e4: 4413 add r3, r2
|
|
80093e6: 781a ldrb r2, [r3, #0]
|
|
80093e8: 69bb ldr r3, [r7, #24]
|
|
80093ea: 68b9 ldr r1, [r7, #8]
|
|
80093ec: 440b add r3, r1
|
|
80093ee: 43d2 mvns r2, r2
|
|
80093f0: b2d2 uxtb r2, r2
|
|
80093f2: 701a strb r2, [r3, #0]
|
|
/* init outBuffer */
|
|
outBuffer[i] = 0;
|
|
80093f4: 69bb ldr r3, [r7, #24]
|
|
80093f6: 68fa ldr r2, [r7, #12]
|
|
80093f8: 4413 add r3, r2
|
|
80093fa: 2200 movs r2, #0
|
|
80093fc: 701a strb r2, [r3, #0]
|
|
for( i = 0; i < size; i++ )
|
|
80093fe: 69bb ldr r3, [r7, #24]
|
|
8009400: 3301 adds r3, #1
|
|
8009402: 61bb str r3, [r7, #24]
|
|
8009404: 79fb ldrb r3, [r7, #7]
|
|
8009406: 69ba ldr r2, [r7, #24]
|
|
8009408: 429a cmp r2, r3
|
|
800940a: dbe9 blt.n 80093e0 <payload_integration+0x1c>
|
|
}
|
|
|
|
for( i = 0; i < ( size * 8 ); i++ )
|
|
800940c: 2300 movs r3, #0
|
|
800940e: 61bb str r3, [r7, #24]
|
|
8009410: e049 b.n 80094a6 <payload_integration+0xe2>
|
|
{
|
|
/* index to take bit in inBuffer */
|
|
index_bit = 7 - ( i % 8 );
|
|
8009412: 69bb ldr r3, [r7, #24]
|
|
8009414: 425a negs r2, r3
|
|
8009416: f003 0307 and.w r3, r3, #7
|
|
800941a: f002 0207 and.w r2, r2, #7
|
|
800941e: bf58 it pl
|
|
8009420: 4253 negpl r3, r2
|
|
8009422: b2db uxtb r3, r3
|
|
8009424: f1c3 0307 rsb r3, r3, #7
|
|
8009428: 75fb strb r3, [r7, #23]
|
|
index_byte = i / 8;
|
|
800942a: 69bb ldr r3, [r7, #24]
|
|
800942c: 2b00 cmp r3, #0
|
|
800942e: da00 bge.n 8009432 <payload_integration+0x6e>
|
|
8009430: 3307 adds r3, #7
|
|
8009432: 10db asrs r3, r3, #3
|
|
8009434: 75bb strb r3, [r7, #22]
|
|
/* index to place bit in outBuffer is shifted 1 bit right */
|
|
index_bit_out = 7 - ( ( i + 1 ) % 8 );
|
|
8009436: 69bb ldr r3, [r7, #24]
|
|
8009438: 3301 adds r3, #1
|
|
800943a: 425a negs r2, r3
|
|
800943c: f003 0307 and.w r3, r3, #7
|
|
8009440: f002 0207 and.w r2, r2, #7
|
|
8009444: bf58 it pl
|
|
8009446: 4253 negpl r3, r2
|
|
8009448: b2db uxtb r3, r3
|
|
800944a: f1c3 0307 rsb r3, r3, #7
|
|
800944e: 757b strb r3, [r7, #21]
|
|
index_byte_out = ( i + 1 ) / 8;
|
|
8009450: 69bb ldr r3, [r7, #24]
|
|
8009452: 3301 adds r3, #1
|
|
8009454: 2b00 cmp r3, #0
|
|
8009456: da00 bge.n 800945a <payload_integration+0x96>
|
|
8009458: 3307 adds r3, #7
|
|
800945a: 10db asrs r3, r3, #3
|
|
800945c: 753b strb r3, [r7, #20]
|
|
/* extract current bit from input */
|
|
currBit = ( inBuffer[index_byte] >> index_bit ) & 0x01;
|
|
800945e: 7dbb ldrb r3, [r7, #22]
|
|
8009460: 68ba ldr r2, [r7, #8]
|
|
8009462: 4413 add r3, r2
|
|
8009464: 781b ldrb r3, [r3, #0]
|
|
8009466: 461a mov r2, r3
|
|
8009468: 7dfb ldrb r3, [r7, #23]
|
|
800946a: fa42 f303 asr.w r3, r2, r3
|
|
800946e: b2db uxtb r3, r3
|
|
8009470: f003 0301 and.w r3, r3, #1
|
|
8009474: 74fb strb r3, [r7, #19]
|
|
/* integration */
|
|
prevInt ^= currBit;
|
|
8009476: 7ffa ldrb r2, [r7, #31]
|
|
8009478: 7cfb ldrb r3, [r7, #19]
|
|
800947a: 4053 eors r3, r2
|
|
800947c: 77fb strb r3, [r7, #31]
|
|
/* write result integration in output */
|
|
outBuffer[index_byte_out] |= ( prevInt << index_bit_out );
|
|
800947e: 7d3b ldrb r3, [r7, #20]
|
|
8009480: 68fa ldr r2, [r7, #12]
|
|
8009482: 4413 add r3, r2
|
|
8009484: 781b ldrb r3, [r3, #0]
|
|
8009486: b25a sxtb r2, r3
|
|
8009488: 7ff9 ldrb r1, [r7, #31]
|
|
800948a: 7d7b ldrb r3, [r7, #21]
|
|
800948c: fa01 f303 lsl.w r3, r1, r3
|
|
8009490: b25b sxtb r3, r3
|
|
8009492: 4313 orrs r3, r2
|
|
8009494: b259 sxtb r1, r3
|
|
8009496: 7d3b ldrb r3, [r7, #20]
|
|
8009498: 68fa ldr r2, [r7, #12]
|
|
800949a: 4413 add r3, r2
|
|
800949c: b2ca uxtb r2, r1
|
|
800949e: 701a strb r2, [r3, #0]
|
|
for( i = 0; i < ( size * 8 ); i++ )
|
|
80094a0: 69bb ldr r3, [r7, #24]
|
|
80094a2: 3301 adds r3, #1
|
|
80094a4: 61bb str r3, [r7, #24]
|
|
80094a6: 79fb ldrb r3, [r7, #7]
|
|
80094a8: 00db lsls r3, r3, #3
|
|
80094aa: 69ba ldr r2, [r7, #24]
|
|
80094ac: 429a cmp r2, r3
|
|
80094ae: dbb0 blt.n 8009412 <payload_integration+0x4e>
|
|
}
|
|
|
|
outBuffer[size] = ( prevInt << 7 ) | ( prevInt << 6 ) | ( ( ( !prevInt ) & 0x01 ) << 5 ) ;
|
|
80094b0: f997 301f ldrsb.w r3, [r7, #31]
|
|
80094b4: 01db lsls r3, r3, #7
|
|
80094b6: b25a sxtb r2, r3
|
|
80094b8: f997 301f ldrsb.w r3, [r7, #31]
|
|
80094bc: 019b lsls r3, r3, #6
|
|
80094be: b25b sxtb r3, r3
|
|
80094c0: 4313 orrs r3, r2
|
|
80094c2: b25b sxtb r3, r3
|
|
80094c4: 7ffa ldrb r2, [r7, #31]
|
|
80094c6: 2a00 cmp r2, #0
|
|
80094c8: d101 bne.n 80094ce <payload_integration+0x10a>
|
|
80094ca: 2220 movs r2, #32
|
|
80094cc: e000 b.n 80094d0 <payload_integration+0x10c>
|
|
80094ce: 2200 movs r2, #0
|
|
80094d0: 4313 orrs r3, r2
|
|
80094d2: b259 sxtb r1, r3
|
|
80094d4: 79fb ldrb r3, [r7, #7]
|
|
80094d6: 68fa ldr r2, [r7, #12]
|
|
80094d8: 4413 add r3, r2
|
|
80094da: b2ca uxtb r2, r1
|
|
80094dc: 701a strb r2, [r3, #0]
|
|
}
|
|
80094de: bf00 nop
|
|
80094e0: 3724 adds r7, #36 @ 0x24
|
|
80094e2: 46bd mov sp, r7
|
|
80094e4: bc80 pop {r7}
|
|
80094e6: 4770 bx lr
|
|
|
|
080094e8 <RadioSetRxGenericConfig>:
|
|
#endif /*RADIO_SIGFOX_ENABLE == 1*/
|
|
|
|
static int32_t RadioSetRxGenericConfig( GenericModems_t modem, RxConfigGeneric_t *config, uint32_t rxContinuous,
|
|
uint32_t symbTimeout )
|
|
{
|
|
80094e8: b580 push {r7, lr}
|
|
80094ea: b08c sub sp, #48 @ 0x30
|
|
80094ec: af00 add r7, sp, #0
|
|
80094ee: 60b9 str r1, [r7, #8]
|
|
80094f0: 607a str r2, [r7, #4]
|
|
80094f2: 603b str r3, [r7, #0]
|
|
80094f4: 4603 mov r3, r0
|
|
80094f6: 73fb strb r3, [r7, #15]
|
|
#if (RADIO_GENERIC_CONFIG_ENABLE == 1)
|
|
int32_t status = 0;
|
|
80094f8: 2300 movs r3, #0
|
|
80094fa: 62bb str r3, [r7, #40] @ 0x28
|
|
uint8_t syncword[8] = {0};
|
|
80094fc: f107 0320 add.w r3, r7, #32
|
|
8009500: 2200 movs r2, #0
|
|
8009502: 601a str r2, [r3, #0]
|
|
8009504: 605a str r2, [r3, #4]
|
|
uint8_t MaxPayloadLength;
|
|
|
|
RFW_DeInit( ); /* switch Off FwPacketDecoding by default */
|
|
8009506: f002 f88d bl 800b624 <RFW_DeInit>
|
|
|
|
if( rxContinuous != 0 )
|
|
800950a: 687b ldr r3, [r7, #4]
|
|
800950c: 2b00 cmp r3, #0
|
|
800950e: d001 beq.n 8009514 <RadioSetRxGenericConfig+0x2c>
|
|
{
|
|
symbTimeout = 0;
|
|
8009510: 2300 movs r3, #0
|
|
8009512: 603b str r3, [r7, #0]
|
|
}
|
|
SubgRf.RxContinuous = ( rxContinuous == 0 ) ? false : true;
|
|
8009514: 687b ldr r3, [r7, #4]
|
|
8009516: 2b00 cmp r3, #0
|
|
8009518: bf14 ite ne
|
|
800951a: 2301 movne r3, #1
|
|
800951c: 2300 moveq r3, #0
|
|
800951e: b2da uxtb r2, r3
|
|
8009520: 4ba3 ldr r3, [pc, #652] @ (80097b0 <RadioSetRxGenericConfig+0x2c8>)
|
|
8009522: 705a strb r2, [r3, #1]
|
|
|
|
switch( modem )
|
|
8009524: 7bfb ldrb r3, [r7, #15]
|
|
8009526: 2b00 cmp r3, #0
|
|
8009528: d003 beq.n 8009532 <RadioSetRxGenericConfig+0x4a>
|
|
800952a: 2b01 cmp r3, #1
|
|
800952c: f000 80dc beq.w 80096e8 <RadioSetRxGenericConfig+0x200>
|
|
|
|
// Timeout Max, Timeout handled directly in SetRx function
|
|
SubgRf.RxTimeout = 0xFFFF;
|
|
break;
|
|
default:
|
|
break;
|
|
8009530: e195 b.n 800985e <RadioSetRxGenericConfig+0x376>
|
|
if( ( config->fsk.BitRate == 0 ) || ( config->fsk.PreambleLen == 0 ) )
|
|
8009532: 68bb ldr r3, [r7, #8]
|
|
8009534: 689b ldr r3, [r3, #8]
|
|
8009536: 2b00 cmp r3, #0
|
|
8009538: d003 beq.n 8009542 <RadioSetRxGenericConfig+0x5a>
|
|
800953a: 68bb ldr r3, [r7, #8]
|
|
800953c: 68db ldr r3, [r3, #12]
|
|
800953e: 2b00 cmp r3, #0
|
|
8009540: d102 bne.n 8009548 <RadioSetRxGenericConfig+0x60>
|
|
return -1;
|
|
8009542: f04f 33ff mov.w r3, #4294967295 @ 0xffffffff
|
|
8009546: e18b b.n 8009860 <RadioSetRxGenericConfig+0x378>
|
|
if( config->fsk.SyncWordLength > 8 )
|
|
8009548: 68bb ldr r3, [r7, #8]
|
|
800954a: 7f9b ldrb r3, [r3, #30]
|
|
800954c: 2b08 cmp r3, #8
|
|
800954e: d902 bls.n 8009556 <RadioSetRxGenericConfig+0x6e>
|
|
return -1;
|
|
8009550: f04f 33ff mov.w r3, #4294967295 @ 0xffffffff
|
|
8009554: e184 b.n 8009860 <RadioSetRxGenericConfig+0x378>
|
|
RADIO_MEMCPY8( syncword, config->fsk.SyncWord, config->fsk.SyncWordLength );
|
|
8009556: 68bb ldr r3, [r7, #8]
|
|
8009558: 6919 ldr r1, [r3, #16]
|
|
800955a: 68bb ldr r3, [r7, #8]
|
|
800955c: 7f9b ldrb r3, [r3, #30]
|
|
800955e: 461a mov r2, r3
|
|
8009560: f107 0320 add.w r3, r7, #32
|
|
8009564: 4618 mov r0, r3
|
|
8009566: f004 fa43 bl 800d9f0 <UTIL_MEM_cpy_8>
|
|
SUBGRF_SetStopRxTimerOnPreambleDetect( ( config->fsk.StopTimerOnPreambleDetect == 0 ) ? false : true );
|
|
800956a: 68bb ldr r3, [r7, #8]
|
|
800956c: 681b ldr r3, [r3, #0]
|
|
800956e: 2b00 cmp r3, #0
|
|
8009570: bf14 ite ne
|
|
8009572: 2301 movne r3, #1
|
|
8009574: 2300 moveq r3, #0
|
|
8009576: b2db uxtb r3, r3
|
|
8009578: 4618 mov r0, r3
|
|
800957a: f000 fe2b bl 800a1d4 <SUBGRF_SetStopRxTimerOnPreambleDetect>
|
|
SubgRf.ModulationParams.PacketType = PACKET_TYPE_GFSK;
|
|
800957e: 4b8c ldr r3, [pc, #560] @ (80097b0 <RadioSetRxGenericConfig+0x2c8>)
|
|
8009580: 2200 movs r2, #0
|
|
8009582: f883 2038 strb.w r2, [r3, #56] @ 0x38
|
|
SubgRf.ModulationParams.Params.Gfsk.BitRate = config->fsk.BitRate;
|
|
8009586: 68bb ldr r3, [r7, #8]
|
|
8009588: 689b ldr r3, [r3, #8]
|
|
800958a: 4a89 ldr r2, [pc, #548] @ (80097b0 <RadioSetRxGenericConfig+0x2c8>)
|
|
800958c: 63d3 str r3, [r2, #60] @ 0x3c
|
|
SubgRf.ModulationParams.Params.Gfsk.ModulationShaping = ( RadioModShapings_t ) config->fsk.ModulationShaping;
|
|
800958e: 68bb ldr r3, [r7, #8]
|
|
8009590: f893 2020 ldrb.w r2, [r3, #32]
|
|
8009594: 4b86 ldr r3, [pc, #536] @ (80097b0 <RadioSetRxGenericConfig+0x2c8>)
|
|
8009596: f883 2044 strb.w r2, [r3, #68] @ 0x44
|
|
SubgRf.ModulationParams.Params.Gfsk.Bandwidth = SUBGRF_GetFskBandwidthRegValue( config->fsk.Bandwidth );
|
|
800959a: 68bb ldr r3, [r7, #8]
|
|
800959c: 685b ldr r3, [r3, #4]
|
|
800959e: 4618 mov r0, r3
|
|
80095a0: f001 fd04 bl 800afac <SUBGRF_GetFskBandwidthRegValue>
|
|
80095a4: 4603 mov r3, r0
|
|
80095a6: 461a mov r2, r3
|
|
80095a8: 4b81 ldr r3, [pc, #516] @ (80097b0 <RadioSetRxGenericConfig+0x2c8>)
|
|
80095aa: f883 2045 strb.w r2, [r3, #69] @ 0x45
|
|
SubgRf.PacketParams.PacketType = PACKET_TYPE_GFSK;
|
|
80095ae: 4b80 ldr r3, [pc, #512] @ (80097b0 <RadioSetRxGenericConfig+0x2c8>)
|
|
80095b0: 2200 movs r2, #0
|
|
80095b2: 739a strb r2, [r3, #14]
|
|
SubgRf.PacketParams.Params.Gfsk.PreambleLength = ( config->fsk.PreambleLen ) << 3 ; // convert byte into bit
|
|
80095b4: 68bb ldr r3, [r7, #8]
|
|
80095b6: 68db ldr r3, [r3, #12]
|
|
80095b8: b29b uxth r3, r3
|
|
80095ba: 00db lsls r3, r3, #3
|
|
80095bc: b29a uxth r2, r3
|
|
80095be: 4b7c ldr r3, [pc, #496] @ (80097b0 <RadioSetRxGenericConfig+0x2c8>)
|
|
80095c0: 821a strh r2, [r3, #16]
|
|
SubgRf.PacketParams.Params.Gfsk.PreambleMinDetect = ( RadioPreambleDetection_t ) config->fsk.PreambleMinDetect;
|
|
80095c2: 68bb ldr r3, [r7, #8]
|
|
80095c4: 7fda ldrb r2, [r3, #31]
|
|
80095c6: 4b7a ldr r3, [pc, #488] @ (80097b0 <RadioSetRxGenericConfig+0x2c8>)
|
|
80095c8: 749a strb r2, [r3, #18]
|
|
SubgRf.PacketParams.Params.Gfsk.SyncWordLength = ( config->fsk.SyncWordLength ) << 3; // convert byte into bit
|
|
80095ca: 68bb ldr r3, [r7, #8]
|
|
80095cc: 7f9b ldrb r3, [r3, #30]
|
|
80095ce: 00db lsls r3, r3, #3
|
|
80095d0: b2da uxtb r2, r3
|
|
80095d2: 4b77 ldr r3, [pc, #476] @ (80097b0 <RadioSetRxGenericConfig+0x2c8>)
|
|
80095d4: 74da strb r2, [r3, #19]
|
|
SubgRf.PacketParams.Params.Gfsk.AddrComp = ( RadioAddressComp_t ) config->fsk.AddrComp;
|
|
80095d6: 68bb ldr r3, [r7, #8]
|
|
80095d8: f893 2021 ldrb.w r2, [r3, #33] @ 0x21
|
|
80095dc: 4b74 ldr r3, [pc, #464] @ (80097b0 <RadioSetRxGenericConfig+0x2c8>)
|
|
80095de: 751a strb r2, [r3, #20]
|
|
if( config->fsk.LengthMode == RADIO_FSK_PACKET_FIXED_LENGTH )
|
|
80095e0: 68bb ldr r3, [r7, #8]
|
|
80095e2: f893 3022 ldrb.w r3, [r3, #34] @ 0x22
|
|
80095e6: 2b00 cmp r3, #0
|
|
80095e8: d105 bne.n 80095f6 <RadioSetRxGenericConfig+0x10e>
|
|
SubgRf.PacketParams.Params.Gfsk.PayloadLength = config->fsk.MaxPayloadLength;
|
|
80095ea: 68bb ldr r3, [r7, #8]
|
|
80095ec: 695b ldr r3, [r3, #20]
|
|
80095ee: b2da uxtb r2, r3
|
|
80095f0: 4b6f ldr r3, [pc, #444] @ (80097b0 <RadioSetRxGenericConfig+0x2c8>)
|
|
80095f2: 759a strb r2, [r3, #22]
|
|
80095f4: e00b b.n 800960e <RadioSetRxGenericConfig+0x126>
|
|
else if( config->fsk.LengthMode == RADIO_FSK_PACKET_2BYTES_LENGTH )
|
|
80095f6: 68bb ldr r3, [r7, #8]
|
|
80095f8: f893 3022 ldrb.w r3, [r3, #34] @ 0x22
|
|
80095fc: 2b02 cmp r3, #2
|
|
80095fe: d103 bne.n 8009608 <RadioSetRxGenericConfig+0x120>
|
|
SubgRf.PacketParams.Params.Gfsk.PayloadLength = 0xFF;
|
|
8009600: 4b6b ldr r3, [pc, #428] @ (80097b0 <RadioSetRxGenericConfig+0x2c8>)
|
|
8009602: 22ff movs r2, #255 @ 0xff
|
|
8009604: 759a strb r2, [r3, #22]
|
|
8009606: e002 b.n 800960e <RadioSetRxGenericConfig+0x126>
|
|
SubgRf.PacketParams.Params.Gfsk.PayloadLength = 0xFF;
|
|
8009608: 4b69 ldr r3, [pc, #420] @ (80097b0 <RadioSetRxGenericConfig+0x2c8>)
|
|
800960a: 22ff movs r2, #255 @ 0xff
|
|
800960c: 759a strb r2, [r3, #22]
|
|
if( ( config->fsk.Whitening == RADIO_FSK_DC_IBM_WHITENING )
|
|
800960e: 68bb ldr r3, [r7, #8]
|
|
8009610: f893 3024 ldrb.w r3, [r3, #36] @ 0x24
|
|
8009614: 2b02 cmp r3, #2
|
|
8009616: d004 beq.n 8009622 <RadioSetRxGenericConfig+0x13a>
|
|
|| ( config->fsk.LengthMode == RADIO_FSK_PACKET_2BYTES_LENGTH ) )
|
|
8009618: 68bb ldr r3, [r7, #8]
|
|
800961a: f893 3022 ldrb.w r3, [r3, #34] @ 0x22
|
|
800961e: 2b02 cmp r3, #2
|
|
8009620: d12d bne.n 800967e <RadioSetRxGenericConfig+0x196>
|
|
if( ( config->fsk.CrcLength != RADIO_FSK_CRC_2_BYTES_IBM ) && ( config->fsk.CrcLength != RADIO_FSK_CRC_2_BYTES_CCIT )
|
|
8009622: 68bb ldr r3, [r7, #8]
|
|
8009624: f893 3023 ldrb.w r3, [r3, #35] @ 0x23
|
|
8009628: 2bf1 cmp r3, #241 @ 0xf1
|
|
800962a: d00c beq.n 8009646 <RadioSetRxGenericConfig+0x15e>
|
|
800962c: 68bb ldr r3, [r7, #8]
|
|
800962e: f893 3023 ldrb.w r3, [r3, #35] @ 0x23
|
|
8009632: 2bf2 cmp r3, #242 @ 0xf2
|
|
8009634: d007 beq.n 8009646 <RadioSetRxGenericConfig+0x15e>
|
|
&& ( config->fsk.CrcLength != RADIO_FSK_CRC_OFF ) )
|
|
8009636: 68bb ldr r3, [r7, #8]
|
|
8009638: f893 3023 ldrb.w r3, [r3, #35] @ 0x23
|
|
800963c: 2b01 cmp r3, #1
|
|
800963e: d002 beq.n 8009646 <RadioSetRxGenericConfig+0x15e>
|
|
return -1;
|
|
8009640: f04f 33ff mov.w r3, #4294967295 @ 0xffffffff
|
|
8009644: e10c b.n 8009860 <RadioSetRxGenericConfig+0x378>
|
|
ConfigGeneric.rtx = CONFIG_RX;
|
|
8009646: 2300 movs r3, #0
|
|
8009648: 773b strb r3, [r7, #28]
|
|
ConfigGeneric.RxConfig = config;
|
|
800964a: 68bb ldr r3, [r7, #8]
|
|
800964c: 61bb str r3, [r7, #24]
|
|
if( 0UL != RFW_Init( &ConfigGeneric, RadioEvents, &RxTimeoutTimer ) )
|
|
800964e: 4b59 ldr r3, [pc, #356] @ (80097b4 <RadioSetRxGenericConfig+0x2cc>)
|
|
8009650: 6819 ldr r1, [r3, #0]
|
|
8009652: f107 0314 add.w r3, r7, #20
|
|
8009656: 4a58 ldr r2, [pc, #352] @ (80097b8 <RadioSetRxGenericConfig+0x2d0>)
|
|
8009658: 4618 mov r0, r3
|
|
800965a: f001 ff49 bl 800b4f0 <RFW_Init>
|
|
800965e: 4603 mov r3, r0
|
|
8009660: 2b00 cmp r3, #0
|
|
8009662: d002 beq.n 800966a <RadioSetRxGenericConfig+0x182>
|
|
return -1;
|
|
8009664: f04f 33ff mov.w r3, #4294967295 @ 0xffffffff
|
|
8009668: e0fa b.n 8009860 <RadioSetRxGenericConfig+0x378>
|
|
SubgRf.PacketParams.Params.Gfsk.DcFree = ( RadioDcFree_t ) RADIO_FSK_DC_FREE_OFF;
|
|
800966a: 4b51 ldr r3, [pc, #324] @ (80097b0 <RadioSetRxGenericConfig+0x2c8>)
|
|
800966c: 2200 movs r2, #0
|
|
800966e: 761a strb r2, [r3, #24]
|
|
SubgRf.PacketParams.Params.Gfsk.CrcLength = ( RadioCrcTypes_t ) RADIO_CRC_OFF;
|
|
8009670: 4b4f ldr r3, [pc, #316] @ (80097b0 <RadioSetRxGenericConfig+0x2c8>)
|
|
8009672: 2201 movs r2, #1
|
|
8009674: 75da strb r2, [r3, #23]
|
|
SubgRf.PacketParams.Params.Gfsk.HeaderType = ( RadioPacketLengthModes_t ) RADIO_PACKET_FIXED_LENGTH;
|
|
8009676: 4b4e ldr r3, [pc, #312] @ (80097b0 <RadioSetRxGenericConfig+0x2c8>)
|
|
8009678: 2200 movs r2, #0
|
|
800967a: 755a strb r2, [r3, #21]
|
|
{
|
|
800967c: e00e b.n 800969c <RadioSetRxGenericConfig+0x1b4>
|
|
SubgRf.PacketParams.Params.Gfsk.CrcLength = ( RadioCrcTypes_t ) config->fsk.CrcLength;
|
|
800967e: 68bb ldr r3, [r7, #8]
|
|
8009680: f893 2023 ldrb.w r2, [r3, #35] @ 0x23
|
|
8009684: 4b4a ldr r3, [pc, #296] @ (80097b0 <RadioSetRxGenericConfig+0x2c8>)
|
|
8009686: 75da strb r2, [r3, #23]
|
|
SubgRf.PacketParams.Params.Gfsk.DcFree = ( RadioDcFree_t ) config->fsk.Whitening;
|
|
8009688: 68bb ldr r3, [r7, #8]
|
|
800968a: f893 2024 ldrb.w r2, [r3, #36] @ 0x24
|
|
800968e: 4b48 ldr r3, [pc, #288] @ (80097b0 <RadioSetRxGenericConfig+0x2c8>)
|
|
8009690: 761a strb r2, [r3, #24]
|
|
SubgRf.PacketParams.Params.Gfsk.HeaderType = ( RadioPacketLengthModes_t ) config->fsk.LengthMode;
|
|
8009692: 68bb ldr r3, [r7, #8]
|
|
8009694: f893 2022 ldrb.w r2, [r3, #34] @ 0x22
|
|
8009698: 4b45 ldr r3, [pc, #276] @ (80097b0 <RadioSetRxGenericConfig+0x2c8>)
|
|
800969a: 755a strb r2, [r3, #21]
|
|
RadioStandby( );
|
|
800969c: f7ff fa0d bl 8008aba <RadioStandby>
|
|
RadioSetModem( MODEM_FSK );
|
|
80096a0: 2000 movs r0, #0
|
|
80096a2: f7fe fb9b bl 8007ddc <RadioSetModem>
|
|
SUBGRF_SetModulationParams( &SubgRf.ModulationParams );
|
|
80096a6: 4845 ldr r0, [pc, #276] @ (80097bc <RadioSetRxGenericConfig+0x2d4>)
|
|
80096a8: f001 f838 bl 800a71c <SUBGRF_SetModulationParams>
|
|
SUBGRF_SetPacketParams( &SubgRf.PacketParams );
|
|
80096ac: 4844 ldr r0, [pc, #272] @ (80097c0 <RadioSetRxGenericConfig+0x2d8>)
|
|
80096ae: f001 f903 bl 800a8b8 <SUBGRF_SetPacketParams>
|
|
SUBGRF_SetSyncWord( syncword );
|
|
80096b2: f107 0320 add.w r3, r7, #32
|
|
80096b6: 4618 mov r0, r3
|
|
80096b8: f000 fbc3 bl 8009e42 <SUBGRF_SetSyncWord>
|
|
SUBGRF_SetWhiteningSeed( config->fsk.whiteSeed );
|
|
80096bc: 68bb ldr r3, [r7, #8]
|
|
80096be: 8b9b ldrh r3, [r3, #28]
|
|
80096c0: 4618 mov r0, r3
|
|
80096c2: f000 fc0d bl 8009ee0 <SUBGRF_SetWhiteningSeed>
|
|
SUBGRF_SetCrcPolynomial( config->fsk.CrcPolynomial );
|
|
80096c6: 68bb ldr r3, [r7, #8]
|
|
80096c8: 8b1b ldrh r3, [r3, #24]
|
|
80096ca: 4618 mov r0, r3
|
|
80096cc: f000 fbe8 bl 8009ea0 <SUBGRF_SetCrcPolynomial>
|
|
SubgRf.RxTimeout = ( uint32_t )( ( symbTimeout * 1000 * 8 ) / config->fsk.BitRate );
|
|
80096d0: 683b ldr r3, [r7, #0]
|
|
80096d2: f44f 52fa mov.w r2, #8000 @ 0x1f40
|
|
80096d6: fb03 f202 mul.w r2, r3, r2
|
|
80096da: 68bb ldr r3, [r7, #8]
|
|
80096dc: 689b ldr r3, [r3, #8]
|
|
80096de: fbb2 f3f3 udiv r3, r2, r3
|
|
80096e2: 4a33 ldr r2, [pc, #204] @ (80097b0 <RadioSetRxGenericConfig+0x2c8>)
|
|
80096e4: 6093 str r3, [r2, #8]
|
|
break;
|
|
80096e6: e0ba b.n 800985e <RadioSetRxGenericConfig+0x376>
|
|
if( config->lora.PreambleLen == 0 )
|
|
80096e8: 68bb ldr r3, [r7, #8]
|
|
80096ea: 8e1b ldrh r3, [r3, #48] @ 0x30
|
|
80096ec: 2b00 cmp r3, #0
|
|
80096ee: d102 bne.n 80096f6 <RadioSetRxGenericConfig+0x20e>
|
|
return -1;
|
|
80096f0: f04f 33ff mov.w r3, #4294967295 @ 0xffffffff
|
|
80096f4: e0b4 b.n 8009860 <RadioSetRxGenericConfig+0x378>
|
|
if( config->lora.LengthMode == RADIO_LORA_PACKET_FIXED_LENGTH )
|
|
80096f6: 68bb ldr r3, [r7, #8]
|
|
80096f8: f893 3032 ldrb.w r3, [r3, #50] @ 0x32
|
|
80096fc: 2b01 cmp r3, #1
|
|
80096fe: d105 bne.n 800970c <RadioSetRxGenericConfig+0x224>
|
|
MaxPayloadLength = config->lora.MaxPayloadLength;
|
|
8009700: 68bb ldr r3, [r7, #8]
|
|
8009702: f893 3033 ldrb.w r3, [r3, #51] @ 0x33
|
|
8009706: f887 302f strb.w r3, [r7, #47] @ 0x2f
|
|
800970a: e002 b.n 8009712 <RadioSetRxGenericConfig+0x22a>
|
|
MaxPayloadLength = 0xFF;
|
|
800970c: 23ff movs r3, #255 @ 0xff
|
|
800970e: f887 302f strb.w r3, [r7, #47] @ 0x2f
|
|
SUBGRF_SetStopRxTimerOnPreambleDetect( ( config->lora.StopTimerOnPreambleDetect == 0 ) ? false : true );
|
|
8009712: 68bb ldr r3, [r7, #8]
|
|
8009714: 6a9b ldr r3, [r3, #40] @ 0x28
|
|
8009716: 2b00 cmp r3, #0
|
|
8009718: bf14 ite ne
|
|
800971a: 2301 movne r3, #1
|
|
800971c: 2300 moveq r3, #0
|
|
800971e: b2db uxtb r3, r3
|
|
8009720: 4618 mov r0, r3
|
|
8009722: f000 fd57 bl 800a1d4 <SUBGRF_SetStopRxTimerOnPreambleDetect>
|
|
SUBGRF_SetLoRaSymbNumTimeout( symbTimeout );
|
|
8009726: 683b ldr r3, [r7, #0]
|
|
8009728: b2db uxtb r3, r3
|
|
800972a: 4618 mov r0, r3
|
|
800972c: f000 fd61 bl 800a1f2 <SUBGRF_SetLoRaSymbNumTimeout>
|
|
SubgRf.ModulationParams.PacketType = PACKET_TYPE_LORA;
|
|
8009730: 4b1f ldr r3, [pc, #124] @ (80097b0 <RadioSetRxGenericConfig+0x2c8>)
|
|
8009732: 2201 movs r2, #1
|
|
8009734: f883 2038 strb.w r2, [r3, #56] @ 0x38
|
|
SubgRf.ModulationParams.Params.LoRa.SpreadingFactor = ( RadioLoRaSpreadingFactors_t ) config->lora.SpreadingFactor;
|
|
8009738: 68bb ldr r3, [r7, #8]
|
|
800973a: f893 202c ldrb.w r2, [r3, #44] @ 0x2c
|
|
800973e: 4b1c ldr r3, [pc, #112] @ (80097b0 <RadioSetRxGenericConfig+0x2c8>)
|
|
8009740: f883 2050 strb.w r2, [r3, #80] @ 0x50
|
|
SubgRf.ModulationParams.Params.LoRa.Bandwidth = ( RadioLoRaBandwidths_t ) config->lora.Bandwidth;
|
|
8009744: 68bb ldr r3, [r7, #8]
|
|
8009746: f893 202d ldrb.w r2, [r3, #45] @ 0x2d
|
|
800974a: 4b19 ldr r3, [pc, #100] @ (80097b0 <RadioSetRxGenericConfig+0x2c8>)
|
|
800974c: f883 2051 strb.w r2, [r3, #81] @ 0x51
|
|
SubgRf.ModulationParams.Params.LoRa.CodingRate = ( RadioLoRaCodingRates_t ) config->lora.Coderate;
|
|
8009750: 68bb ldr r3, [r7, #8]
|
|
8009752: f893 202e ldrb.w r2, [r3, #46] @ 0x2e
|
|
8009756: 4b16 ldr r3, [pc, #88] @ (80097b0 <RadioSetRxGenericConfig+0x2c8>)
|
|
8009758: f883 2052 strb.w r2, [r3, #82] @ 0x52
|
|
switch( config->lora.LowDatarateOptimize )
|
|
800975c: 68bb ldr r3, [r7, #8]
|
|
800975e: f893 302f ldrb.w r3, [r3, #47] @ 0x2f
|
|
8009762: 2b02 cmp r3, #2
|
|
8009764: d010 beq.n 8009788 <RadioSetRxGenericConfig+0x2a0>
|
|
8009766: 2b02 cmp r3, #2
|
|
8009768: dc2c bgt.n 80097c4 <RadioSetRxGenericConfig+0x2dc>
|
|
800976a: 2b00 cmp r3, #0
|
|
800976c: d002 beq.n 8009774 <RadioSetRxGenericConfig+0x28c>
|
|
800976e: 2b01 cmp r3, #1
|
|
8009770: d005 beq.n 800977e <RadioSetRxGenericConfig+0x296>
|
|
break;
|
|
8009772: e027 b.n 80097c4 <RadioSetRxGenericConfig+0x2dc>
|
|
SubgRf.ModulationParams.Params.LoRa.LowDatarateOptimize = 0;
|
|
8009774: 4b0e ldr r3, [pc, #56] @ (80097b0 <RadioSetRxGenericConfig+0x2c8>)
|
|
8009776: 2200 movs r2, #0
|
|
8009778: f883 2053 strb.w r2, [r3, #83] @ 0x53
|
|
break;
|
|
800977c: e023 b.n 80097c6 <RadioSetRxGenericConfig+0x2de>
|
|
SubgRf.ModulationParams.Params.LoRa.LowDatarateOptimize = 1;
|
|
800977e: 4b0c ldr r3, [pc, #48] @ (80097b0 <RadioSetRxGenericConfig+0x2c8>)
|
|
8009780: 2201 movs r2, #1
|
|
8009782: f883 2053 strb.w r2, [r3, #83] @ 0x53
|
|
break;
|
|
8009786: e01e b.n 80097c6 <RadioSetRxGenericConfig+0x2de>
|
|
if( ( config->lora.SpreadingFactor == RADIO_LORA_SF11 ) || ( config->lora.SpreadingFactor == RADIO_LORA_SF12 ) )
|
|
8009788: 68bb ldr r3, [r7, #8]
|
|
800978a: f893 302c ldrb.w r3, [r3, #44] @ 0x2c
|
|
800978e: 2b0b cmp r3, #11
|
|
8009790: d004 beq.n 800979c <RadioSetRxGenericConfig+0x2b4>
|
|
8009792: 68bb ldr r3, [r7, #8]
|
|
8009794: f893 302c ldrb.w r3, [r3, #44] @ 0x2c
|
|
8009798: 2b0c cmp r3, #12
|
|
800979a: d104 bne.n 80097a6 <RadioSetRxGenericConfig+0x2be>
|
|
SubgRf.ModulationParams.Params.LoRa.LowDatarateOptimize = 1;
|
|
800979c: 4b04 ldr r3, [pc, #16] @ (80097b0 <RadioSetRxGenericConfig+0x2c8>)
|
|
800979e: 2201 movs r2, #1
|
|
80097a0: f883 2053 strb.w r2, [r3, #83] @ 0x53
|
|
break;
|
|
80097a4: e00f b.n 80097c6 <RadioSetRxGenericConfig+0x2de>
|
|
SubgRf.ModulationParams.Params.LoRa.LowDatarateOptimize = 0;
|
|
80097a6: 4b02 ldr r3, [pc, #8] @ (80097b0 <RadioSetRxGenericConfig+0x2c8>)
|
|
80097a8: 2200 movs r2, #0
|
|
80097aa: f883 2053 strb.w r2, [r3, #83] @ 0x53
|
|
break;
|
|
80097ae: e00a b.n 80097c6 <RadioSetRxGenericConfig+0x2de>
|
|
80097b0: 200002f8 .word 0x200002f8
|
|
80097b4: 200002f4 .word 0x200002f4
|
|
80097b8: 2000036c .word 0x2000036c
|
|
80097bc: 20000330 .word 0x20000330
|
|
80097c0: 20000306 .word 0x20000306
|
|
break;
|
|
80097c4: bf00 nop
|
|
SubgRf.PacketParams.PacketType = PACKET_TYPE_LORA;
|
|
80097c6: 4b28 ldr r3, [pc, #160] @ (8009868 <RadioSetRxGenericConfig+0x380>)
|
|
80097c8: 2201 movs r2, #1
|
|
80097ca: 739a strb r2, [r3, #14]
|
|
SubgRf.PacketParams.Params.LoRa.PreambleLength = config->lora.PreambleLen;
|
|
80097cc: 68bb ldr r3, [r7, #8]
|
|
80097ce: 8e1a ldrh r2, [r3, #48] @ 0x30
|
|
80097d0: 4b25 ldr r3, [pc, #148] @ (8009868 <RadioSetRxGenericConfig+0x380>)
|
|
80097d2: 839a strh r2, [r3, #28]
|
|
SubgRf.PacketParams.Params.LoRa.HeaderType = ( RadioLoRaPacketLengthsMode_t ) config->lora.LengthMode;
|
|
80097d4: 68bb ldr r3, [r7, #8]
|
|
80097d6: f893 2032 ldrb.w r2, [r3, #50] @ 0x32
|
|
80097da: 4b23 ldr r3, [pc, #140] @ (8009868 <RadioSetRxGenericConfig+0x380>)
|
|
80097dc: 779a strb r2, [r3, #30]
|
|
SubgRf.PacketParams.Params.LoRa.PayloadLength = MaxPayloadLength;
|
|
80097de: 4a22 ldr r2, [pc, #136] @ (8009868 <RadioSetRxGenericConfig+0x380>)
|
|
80097e0: f897 302f ldrb.w r3, [r7, #47] @ 0x2f
|
|
80097e4: 77d3 strb r3, [r2, #31]
|
|
SubgRf.PacketParams.Params.LoRa.CrcMode = ( RadioLoRaCrcModes_t ) config->lora.CrcMode;
|
|
80097e6: 68bb ldr r3, [r7, #8]
|
|
80097e8: f893 2034 ldrb.w r2, [r3, #52] @ 0x34
|
|
80097ec: 4b1e ldr r3, [pc, #120] @ (8009868 <RadioSetRxGenericConfig+0x380>)
|
|
80097ee: f883 2020 strb.w r2, [r3, #32]
|
|
SubgRf.PacketParams.Params.LoRa.InvertIQ = ( RadioLoRaIQModes_t ) config->lora.IqInverted;
|
|
80097f2: 68bb ldr r3, [r7, #8]
|
|
80097f4: f893 2035 ldrb.w r2, [r3, #53] @ 0x35
|
|
80097f8: 4b1b ldr r3, [pc, #108] @ (8009868 <RadioSetRxGenericConfig+0x380>)
|
|
80097fa: f883 2021 strb.w r2, [r3, #33] @ 0x21
|
|
RadioStandby( );
|
|
80097fe: f7ff f95c bl 8008aba <RadioStandby>
|
|
RadioSetModem( MODEM_LORA );
|
|
8009802: 2001 movs r0, #1
|
|
8009804: f7fe faea bl 8007ddc <RadioSetModem>
|
|
SUBGRF_SetModulationParams( &SubgRf.ModulationParams );
|
|
8009808: 4818 ldr r0, [pc, #96] @ (800986c <RadioSetRxGenericConfig+0x384>)
|
|
800980a: f000 ff87 bl 800a71c <SUBGRF_SetModulationParams>
|
|
SUBGRF_SetPacketParams( &SubgRf.PacketParams );
|
|
800980e: 4818 ldr r0, [pc, #96] @ (8009870 <RadioSetRxGenericConfig+0x388>)
|
|
8009810: f001 f852 bl 800a8b8 <SUBGRF_SetPacketParams>
|
|
if( SubgRf.PacketParams.Params.LoRa.InvertIQ == LORA_IQ_INVERTED )
|
|
8009814: 4b14 ldr r3, [pc, #80] @ (8009868 <RadioSetRxGenericConfig+0x380>)
|
|
8009816: f893 3021 ldrb.w r3, [r3, #33] @ 0x21
|
|
800981a: 2b01 cmp r3, #1
|
|
800981c: d10d bne.n 800983a <RadioSetRxGenericConfig+0x352>
|
|
SUBGRF_WriteRegister( SUBGHZ_LIQPOLR, SUBGRF_ReadRegister( SUBGHZ_LIQPOLR ) & ~( 1 << 2 ) );
|
|
800981e: f240 7036 movw r0, #1846 @ 0x736
|
|
8009822: f001 f9b1 bl 800ab88 <SUBGRF_ReadRegister>
|
|
8009826: 4603 mov r3, r0
|
|
8009828: f023 0304 bic.w r3, r3, #4
|
|
800982c: b2db uxtb r3, r3
|
|
800982e: 4619 mov r1, r3
|
|
8009830: f240 7036 movw r0, #1846 @ 0x736
|
|
8009834: f001 f986 bl 800ab44 <SUBGRF_WriteRegister>
|
|
8009838: e00c b.n 8009854 <RadioSetRxGenericConfig+0x36c>
|
|
SUBGRF_WriteRegister( SUBGHZ_LIQPOLR, SUBGRF_ReadRegister( SUBGHZ_LIQPOLR ) | ( 1 << 2 ) );
|
|
800983a: f240 7036 movw r0, #1846 @ 0x736
|
|
800983e: f001 f9a3 bl 800ab88 <SUBGRF_ReadRegister>
|
|
8009842: 4603 mov r3, r0
|
|
8009844: f043 0304 orr.w r3, r3, #4
|
|
8009848: b2db uxtb r3, r3
|
|
800984a: 4619 mov r1, r3
|
|
800984c: f240 7036 movw r0, #1846 @ 0x736
|
|
8009850: f001 f978 bl 800ab44 <SUBGRF_WriteRegister>
|
|
SubgRf.RxTimeout = 0xFFFF;
|
|
8009854: 4b04 ldr r3, [pc, #16] @ (8009868 <RadioSetRxGenericConfig+0x380>)
|
|
8009856: f64f 72ff movw r2, #65535 @ 0xffff
|
|
800985a: 609a str r2, [r3, #8]
|
|
break;
|
|
800985c: bf00 nop
|
|
}
|
|
return status;
|
|
800985e: 6abb ldr r3, [r7, #40] @ 0x28
|
|
#else /* RADIO_GENERIC_CONFIG_ENABLE == 1*/
|
|
return -1;
|
|
#endif /* RADIO_GENERIC_CONFIG_ENABLE == 0*/
|
|
}
|
|
8009860: 4618 mov r0, r3
|
|
8009862: 3730 adds r7, #48 @ 0x30
|
|
8009864: 46bd mov sp, r7
|
|
8009866: bd80 pop {r7, pc}
|
|
8009868: 200002f8 .word 0x200002f8
|
|
800986c: 20000330 .word 0x20000330
|
|
8009870: 20000306 .word 0x20000306
|
|
|
|
08009874 <RadioSetTxGenericConfig>:
|
|
|
|
static int32_t RadioSetTxGenericConfig( GenericModems_t modem, TxConfigGeneric_t *config, int8_t power,
|
|
uint32_t timeout )
|
|
{
|
|
8009874: b580 push {r7, lr}
|
|
8009876: b08e sub sp, #56 @ 0x38
|
|
8009878: af00 add r7, sp, #0
|
|
800987a: 60b9 str r1, [r7, #8]
|
|
800987c: 607b str r3, [r7, #4]
|
|
800987e: 4603 mov r3, r0
|
|
8009880: 73fb strb r3, [r7, #15]
|
|
8009882: 4613 mov r3, r2
|
|
8009884: 73bb strb r3, [r7, #14]
|
|
#if( RADIO_LR_FHSS_IS_ON == 1 )
|
|
/*disable LrFhss*/
|
|
SubgRf.lr_fhss.is_lr_fhss_on = false;
|
|
#endif /* RADIO_LR_FHSS_IS_ON == 1 */
|
|
#if (RADIO_GENERIC_CONFIG_ENABLE == 1)
|
|
uint8_t syncword[8] = {0};
|
|
8009886: f107 032c add.w r3, r7, #44 @ 0x2c
|
|
800988a: 2200 movs r2, #0
|
|
800988c: 601a str r2, [r3, #0]
|
|
800988e: 605a str r2, [r3, #4]
|
|
RadioModems_t radio_modem;
|
|
RFW_DeInit( ); /* switch Off FwPacketDecoding by default */
|
|
8009890: f001 fec8 bl 800b624 <RFW_DeInit>
|
|
switch( modem )
|
|
8009894: 7bfb ldrb r3, [r7, #15]
|
|
8009896: 2b03 cmp r3, #3
|
|
8009898: f200 8205 bhi.w 8009ca6 <RadioSetTxGenericConfig+0x432>
|
|
800989c: a201 add r2, pc, #4 @ (adr r2, 80098a4 <RadioSetTxGenericConfig+0x30>)
|
|
800989e: f852 f023 ldr.w pc, [r2, r3, lsl #2]
|
|
80098a2: bf00 nop
|
|
80098a4: 08009a29 .word 0x08009a29
|
|
80098a8: 08009b71 .word 0x08009b71
|
|
80098ac: 08009c69 .word 0x08009c69
|
|
80098b0: 080098b5 .word 0x080098b5
|
|
{
|
|
case GENERIC_MSK:
|
|
if( config->msk.SyncWordLength > 8 )
|
|
80098b4: 68bb ldr r3, [r7, #8]
|
|
80098b6: 7c9b ldrb r3, [r3, #18]
|
|
80098b8: 2b08 cmp r3, #8
|
|
80098ba: d902 bls.n 80098c2 <RadioSetTxGenericConfig+0x4e>
|
|
{
|
|
return -1;
|
|
80098bc: f04f 33ff mov.w r3, #4294967295 @ 0xffffffff
|
|
80098c0: e206 b.n 8009cd0 <RadioSetTxGenericConfig+0x45c>
|
|
}
|
|
else
|
|
{
|
|
RADIO_MEMCPY8( syncword, config->msk.SyncWord, config->msk.SyncWordLength );
|
|
80098c2: 68bb ldr r3, [r7, #8]
|
|
80098c4: 6899 ldr r1, [r3, #8]
|
|
80098c6: 68bb ldr r3, [r7, #8]
|
|
80098c8: 7c9b ldrb r3, [r3, #18]
|
|
80098ca: 461a mov r2, r3
|
|
80098cc: f107 032c add.w r3, r7, #44 @ 0x2c
|
|
80098d0: 4618 mov r0, r3
|
|
80098d2: f004 f88d bl 800d9f0 <UTIL_MEM_cpy_8>
|
|
}
|
|
if( ( config->msk.BitRate == 0 ) )
|
|
80098d6: 68bb ldr r3, [r7, #8]
|
|
80098d8: 681b ldr r3, [r3, #0]
|
|
80098da: 2b00 cmp r3, #0
|
|
80098dc: d102 bne.n 80098e4 <RadioSetTxGenericConfig+0x70>
|
|
{
|
|
return -1;
|
|
80098de: f04f 33ff mov.w r3, #4294967295 @ 0xffffffff
|
|
80098e2: e1f5 b.n 8009cd0 <RadioSetTxGenericConfig+0x45c>
|
|
}
|
|
else if( config->msk.BitRate <= 10000 )
|
|
80098e4: 68bb ldr r3, [r7, #8]
|
|
80098e6: 681b ldr r3, [r3, #0]
|
|
80098e8: f242 7210 movw r2, #10000 @ 0x2710
|
|
80098ec: 4293 cmp r3, r2
|
|
80098ee: d813 bhi.n 8009918 <RadioSetTxGenericConfig+0xa4>
|
|
{
|
|
/*max msk modulator datarate is 10kbps*/
|
|
radio_modem = MODEM_MSK;
|
|
80098f0: 2302 movs r3, #2
|
|
80098f2: f887 3037 strb.w r3, [r7, #55] @ 0x37
|
|
SubgRf.PacketParams.PacketType = PACKET_TYPE_GMSK;
|
|
80098f6: 4b99 ldr r3, [pc, #612] @ (8009b5c <RadioSetTxGenericConfig+0x2e8>)
|
|
80098f8: 2203 movs r2, #3
|
|
80098fa: 739a strb r2, [r3, #14]
|
|
SubgRf.ModulationParams.PacketType = PACKET_TYPE_GMSK;
|
|
80098fc: 4b97 ldr r3, [pc, #604] @ (8009b5c <RadioSetTxGenericConfig+0x2e8>)
|
|
80098fe: 2203 movs r2, #3
|
|
8009900: f883 2038 strb.w r2, [r3, #56] @ 0x38
|
|
SubgRf.ModulationParams.Params.Gfsk.BitRate = config->msk.BitRate;
|
|
8009904: 68bb ldr r3, [r7, #8]
|
|
8009906: 681b ldr r3, [r3, #0]
|
|
8009908: 4a94 ldr r2, [pc, #592] @ (8009b5c <RadioSetTxGenericConfig+0x2e8>)
|
|
800990a: 63d3 str r3, [r2, #60] @ 0x3c
|
|
SubgRf.ModulationParams.Params.Gfsk.ModulationShaping = ( RadioModShapings_t ) config->msk.ModulationShaping;
|
|
800990c: 68bb ldr r3, [r7, #8]
|
|
800990e: 7cda ldrb r2, [r3, #19]
|
|
8009910: 4b92 ldr r3, [pc, #584] @ (8009b5c <RadioSetTxGenericConfig+0x2e8>)
|
|
8009912: f883 2044 strb.w r2, [r3, #68] @ 0x44
|
|
8009916: e017 b.n 8009948 <RadioSetTxGenericConfig+0xd4>
|
|
}
|
|
else
|
|
{
|
|
radio_modem = MODEM_FSK;
|
|
8009918: 2300 movs r3, #0
|
|
800991a: f887 3037 strb.w r3, [r7, #55] @ 0x37
|
|
SubgRf.PacketParams.PacketType = PACKET_TYPE_GFSK;
|
|
800991e: 4b8f ldr r3, [pc, #572] @ (8009b5c <RadioSetTxGenericConfig+0x2e8>)
|
|
8009920: 2200 movs r2, #0
|
|
8009922: 739a strb r2, [r3, #14]
|
|
SubgRf.ModulationParams.PacketType = PACKET_TYPE_GFSK;
|
|
8009924: 4b8d ldr r3, [pc, #564] @ (8009b5c <RadioSetTxGenericConfig+0x2e8>)
|
|
8009926: 2200 movs r2, #0
|
|
8009928: f883 2038 strb.w r2, [r3, #56] @ 0x38
|
|
SubgRf.ModulationParams.Params.Gfsk.BitRate = config->msk.BitRate;
|
|
800992c: 68bb ldr r3, [r7, #8]
|
|
800992e: 681b ldr r3, [r3, #0]
|
|
8009930: 4a8a ldr r2, [pc, #552] @ (8009b5c <RadioSetTxGenericConfig+0x2e8>)
|
|
8009932: 63d3 str r3, [r2, #60] @ 0x3c
|
|
SubgRf.ModulationParams.Params.Gfsk.ModulationShaping = ( RadioModShapings_t ) config->msk.ModulationShaping;
|
|
8009934: 68bb ldr r3, [r7, #8]
|
|
8009936: 7cda ldrb r2, [r3, #19]
|
|
8009938: 4b88 ldr r3, [pc, #544] @ (8009b5c <RadioSetTxGenericConfig+0x2e8>)
|
|
800993a: f883 2044 strb.w r2, [r3, #68] @ 0x44
|
|
/*do msk with gfsk modulator*/
|
|
SubgRf.ModulationParams.Params.Gfsk.Fdev = config->msk.BitRate / 4;
|
|
800993e: 68bb ldr r3, [r7, #8]
|
|
8009940: 681b ldr r3, [r3, #0]
|
|
8009942: 089b lsrs r3, r3, #2
|
|
8009944: 4a85 ldr r2, [pc, #532] @ (8009b5c <RadioSetTxGenericConfig+0x2e8>)
|
|
8009946: 6413 str r3, [r2, #64] @ 0x40
|
|
}
|
|
|
|
SubgRf.PacketParams.Params.Gfsk.PreambleLength = ( config->msk.PreambleLen ) << 3; // convert byte into bit
|
|
8009948: 68bb ldr r3, [r7, #8]
|
|
800994a: 685b ldr r3, [r3, #4]
|
|
800994c: b29b uxth r3, r3
|
|
800994e: 00db lsls r3, r3, #3
|
|
8009950: b29a uxth r2, r3
|
|
8009952: 4b82 ldr r3, [pc, #520] @ (8009b5c <RadioSetTxGenericConfig+0x2e8>)
|
|
8009954: 821a strh r2, [r3, #16]
|
|
SubgRf.PacketParams.Params.Gfsk.PreambleMinDetect = RADIO_PREAMBLE_DETECTOR_08_BITS; // don't care in tx
|
|
8009956: 4b81 ldr r3, [pc, #516] @ (8009b5c <RadioSetTxGenericConfig+0x2e8>)
|
|
8009958: 2204 movs r2, #4
|
|
800995a: 749a strb r2, [r3, #18]
|
|
SubgRf.PacketParams.Params.Gfsk.SyncWordLength = ( config->msk.SyncWordLength ) << 3; // convert byte into bit
|
|
800995c: 68bb ldr r3, [r7, #8]
|
|
800995e: 7c9b ldrb r3, [r3, #18]
|
|
8009960: 00db lsls r3, r3, #3
|
|
8009962: b2da uxtb r2, r3
|
|
8009964: 4b7d ldr r3, [pc, #500] @ (8009b5c <RadioSetTxGenericConfig+0x2e8>)
|
|
8009966: 74da strb r2, [r3, #19]
|
|
SubgRf.PacketParams.Params.Gfsk.AddrComp = RADIO_ADDRESSCOMP_FILT_OFF; // don't care in tx
|
|
8009968: 4b7c ldr r3, [pc, #496] @ (8009b5c <RadioSetTxGenericConfig+0x2e8>)
|
|
800996a: 2200 movs r2, #0
|
|
800996c: 751a strb r2, [r3, #20]
|
|
|
|
if( ( config->msk.Whitening == RADIO_FSK_DC_IBM_WHITENING )
|
|
800996e: 68bb ldr r3, [r7, #8]
|
|
8009970: 7d9b ldrb r3, [r3, #22]
|
|
8009972: 2b02 cmp r3, #2
|
|
8009974: d003 beq.n 800997e <RadioSetTxGenericConfig+0x10a>
|
|
|| ( config->msk.HeaderType == RADIO_FSK_PACKET_2BYTES_LENGTH ) )
|
|
8009976: 68bb ldr r3, [r7, #8]
|
|
8009978: 7d1b ldrb r3, [r3, #20]
|
|
800997a: 2b02 cmp r3, #2
|
|
800997c: d12b bne.n 80099d6 <RadioSetTxGenericConfig+0x162>
|
|
{
|
|
/* Supports only RADIO_FSK_CRC_2_BYTES_IBM or RADIO_FSK_CRC_2_BYTES_CCIT */
|
|
if( ( config->msk.CrcLength != RADIO_FSK_CRC_2_BYTES_IBM ) && ( config->msk.CrcLength != RADIO_FSK_CRC_2_BYTES_CCIT )
|
|
800997e: 68bb ldr r3, [r7, #8]
|
|
8009980: 7d5b ldrb r3, [r3, #21]
|
|
8009982: 2bf1 cmp r3, #241 @ 0xf1
|
|
8009984: d00a beq.n 800999c <RadioSetTxGenericConfig+0x128>
|
|
8009986: 68bb ldr r3, [r7, #8]
|
|
8009988: 7d5b ldrb r3, [r3, #21]
|
|
800998a: 2bf2 cmp r3, #242 @ 0xf2
|
|
800998c: d006 beq.n 800999c <RadioSetTxGenericConfig+0x128>
|
|
&& ( config->msk.CrcLength != RADIO_FSK_CRC_OFF ) )
|
|
800998e: 68bb ldr r3, [r7, #8]
|
|
8009990: 7d5b ldrb r3, [r3, #21]
|
|
8009992: 2b01 cmp r3, #1
|
|
8009994: d002 beq.n 800999c <RadioSetTxGenericConfig+0x128>
|
|
{
|
|
return -1;
|
|
8009996: f04f 33ff mov.w r3, #4294967295 @ 0xffffffff
|
|
800999a: e199 b.n 8009cd0 <RadioSetTxGenericConfig+0x45c>
|
|
}
|
|
ConfigGeneric_t ConfigGeneric;
|
|
/*msk and fsk are union, no need for copy as fsk/msk struct are on same address*/
|
|
ConfigGeneric.TxConfig = config;
|
|
800999c: 68bb ldr r3, [r7, #8]
|
|
800999e: 623b str r3, [r7, #32]
|
|
ConfigGeneric.rtx = CONFIG_TX;
|
|
80099a0: 2301 movs r3, #1
|
|
80099a2: f887 3028 strb.w r3, [r7, #40] @ 0x28
|
|
if( 0UL != RFW_Init( &ConfigGeneric, RadioEvents, &TxTimeoutTimer ) )
|
|
80099a6: 4b6e ldr r3, [pc, #440] @ (8009b60 <RadioSetTxGenericConfig+0x2ec>)
|
|
80099a8: 6819 ldr r1, [r3, #0]
|
|
80099aa: f107 0320 add.w r3, r7, #32
|
|
80099ae: 4a6d ldr r2, [pc, #436] @ (8009b64 <RadioSetTxGenericConfig+0x2f0>)
|
|
80099b0: 4618 mov r0, r3
|
|
80099b2: f001 fd9d bl 800b4f0 <RFW_Init>
|
|
80099b6: 4603 mov r3, r0
|
|
80099b8: 2b00 cmp r3, #0
|
|
80099ba: d002 beq.n 80099c2 <RadioSetTxGenericConfig+0x14e>
|
|
{
|
|
return -1;
|
|
80099bc: f04f 33ff mov.w r3, #4294967295 @ 0xffffffff
|
|
80099c0: e186 b.n 8009cd0 <RadioSetTxGenericConfig+0x45c>
|
|
}
|
|
/* whitening off, will be processed by FW, switch off built-in radio whitening */
|
|
SubgRf.PacketParams.Params.Gfsk.DcFree = ( RadioDcFree_t ) RADIO_FSK_DC_FREE_OFF;
|
|
80099c2: 4b66 ldr r3, [pc, #408] @ (8009b5c <RadioSetTxGenericConfig+0x2e8>)
|
|
80099c4: 2200 movs r2, #0
|
|
80099c6: 761a strb r2, [r3, #24]
|
|
/* Crc processed by FW, switch off built-in radio Crc */
|
|
SubgRf.PacketParams.Params.Gfsk.CrcLength = ( RadioCrcTypes_t ) RADIO_CRC_OFF;
|
|
80099c8: 4b64 ldr r3, [pc, #400] @ (8009b5c <RadioSetTxGenericConfig+0x2e8>)
|
|
80099ca: 2201 movs r2, #1
|
|
80099cc: 75da strb r2, [r3, #23]
|
|
/* length contained in Tx, but will be processed by FW after de-whitening */
|
|
SubgRf.PacketParams.Params.Gfsk.HeaderType = ( RadioPacketLengthModes_t ) RADIO_PACKET_FIXED_LENGTH;
|
|
80099ce: 4b63 ldr r3, [pc, #396] @ (8009b5c <RadioSetTxGenericConfig+0x2e8>)
|
|
80099d0: 2200 movs r2, #0
|
|
80099d2: 755a strb r2, [r3, #21]
|
|
{
|
|
80099d4: e00b b.n 80099ee <RadioSetTxGenericConfig+0x17a>
|
|
}
|
|
else
|
|
{
|
|
SubgRf.PacketParams.Params.Gfsk.CrcLength = ( RadioCrcTypes_t ) config->msk.CrcLength;
|
|
80099d6: 68bb ldr r3, [r7, #8]
|
|
80099d8: 7d5a ldrb r2, [r3, #21]
|
|
80099da: 4b60 ldr r3, [pc, #384] @ (8009b5c <RadioSetTxGenericConfig+0x2e8>)
|
|
80099dc: 75da strb r2, [r3, #23]
|
|
SubgRf.PacketParams.Params.Gfsk.DcFree = ( RadioDcFree_t ) config->msk.Whitening;
|
|
80099de: 68bb ldr r3, [r7, #8]
|
|
80099e0: 7d9a ldrb r2, [r3, #22]
|
|
80099e2: 4b5e ldr r3, [pc, #376] @ (8009b5c <RadioSetTxGenericConfig+0x2e8>)
|
|
80099e4: 761a strb r2, [r3, #24]
|
|
SubgRf.PacketParams.Params.Gfsk.HeaderType = ( RadioPacketLengthModes_t ) config->msk.HeaderType;
|
|
80099e6: 68bb ldr r3, [r7, #8]
|
|
80099e8: 7d1a ldrb r2, [r3, #20]
|
|
80099ea: 4b5c ldr r3, [pc, #368] @ (8009b5c <RadioSetTxGenericConfig+0x2e8>)
|
|
80099ec: 755a strb r2, [r3, #21]
|
|
}
|
|
|
|
RadioStandby( );
|
|
80099ee: f7ff f864 bl 8008aba <RadioStandby>
|
|
RadioSetModem( radio_modem );
|
|
80099f2: f897 3037 ldrb.w r3, [r7, #55] @ 0x37
|
|
80099f6: 4618 mov r0, r3
|
|
80099f8: f7fe f9f0 bl 8007ddc <RadioSetModem>
|
|
|
|
SUBGRF_SetModulationParams( &SubgRf.ModulationParams );
|
|
80099fc: 485a ldr r0, [pc, #360] @ (8009b68 <RadioSetTxGenericConfig+0x2f4>)
|
|
80099fe: f000 fe8d bl 800a71c <SUBGRF_SetModulationParams>
|
|
SUBGRF_SetPacketParams( &SubgRf.PacketParams );
|
|
8009a02: 485a ldr r0, [pc, #360] @ (8009b6c <RadioSetTxGenericConfig+0x2f8>)
|
|
8009a04: f000 ff58 bl 800a8b8 <SUBGRF_SetPacketParams>
|
|
SUBGRF_SetSyncWord( syncword );
|
|
8009a08: f107 032c add.w r3, r7, #44 @ 0x2c
|
|
8009a0c: 4618 mov r0, r3
|
|
8009a0e: f000 fa18 bl 8009e42 <SUBGRF_SetSyncWord>
|
|
SUBGRF_SetWhiteningSeed( config->msk.whiteSeed );
|
|
8009a12: 68bb ldr r3, [r7, #8]
|
|
8009a14: 8a1b ldrh r3, [r3, #16]
|
|
8009a16: 4618 mov r0, r3
|
|
8009a18: f000 fa62 bl 8009ee0 <SUBGRF_SetWhiteningSeed>
|
|
SUBGRF_SetCrcPolynomial( config->msk.CrcPolynomial );
|
|
8009a1c: 68bb ldr r3, [r7, #8]
|
|
8009a1e: 899b ldrh r3, [r3, #12]
|
|
8009a20: 4618 mov r0, r3
|
|
8009a22: f000 fa3d bl 8009ea0 <SUBGRF_SetCrcPolynomial>
|
|
break;
|
|
8009a26: e13f b.n 8009ca8 <RadioSetTxGenericConfig+0x434>
|
|
case GENERIC_FSK:
|
|
if( config->fsk.BitRate == 0 )
|
|
8009a28: 68bb ldr r3, [r7, #8]
|
|
8009a2a: 681b ldr r3, [r3, #0]
|
|
8009a2c: 2b00 cmp r3, #0
|
|
8009a2e: d102 bne.n 8009a36 <RadioSetTxGenericConfig+0x1c2>
|
|
{
|
|
return -1;
|
|
8009a30: f04f 33ff mov.w r3, #4294967295 @ 0xffffffff
|
|
8009a34: e14c b.n 8009cd0 <RadioSetTxGenericConfig+0x45c>
|
|
}
|
|
if( config->fsk.SyncWordLength > 8 )
|
|
8009a36: 68bb ldr r3, [r7, #8]
|
|
8009a38: 7c9b ldrb r3, [r3, #18]
|
|
8009a3a: 2b08 cmp r3, #8
|
|
8009a3c: d902 bls.n 8009a44 <RadioSetTxGenericConfig+0x1d0>
|
|
{
|
|
return -1;
|
|
8009a3e: f04f 33ff mov.w r3, #4294967295 @ 0xffffffff
|
|
8009a42: e145 b.n 8009cd0 <RadioSetTxGenericConfig+0x45c>
|
|
}
|
|
else
|
|
{
|
|
RADIO_MEMCPY8( syncword, config->fsk.SyncWord, config->fsk.SyncWordLength );
|
|
8009a44: 68bb ldr r3, [r7, #8]
|
|
8009a46: 6899 ldr r1, [r3, #8]
|
|
8009a48: 68bb ldr r3, [r7, #8]
|
|
8009a4a: 7c9b ldrb r3, [r3, #18]
|
|
8009a4c: 461a mov r2, r3
|
|
8009a4e: f107 032c add.w r3, r7, #44 @ 0x2c
|
|
8009a52: 4618 mov r0, r3
|
|
8009a54: f003 ffcc bl 800d9f0 <UTIL_MEM_cpy_8>
|
|
}
|
|
SubgRf.ModulationParams.PacketType = PACKET_TYPE_GFSK;
|
|
8009a58: 4b40 ldr r3, [pc, #256] @ (8009b5c <RadioSetTxGenericConfig+0x2e8>)
|
|
8009a5a: 2200 movs r2, #0
|
|
8009a5c: f883 2038 strb.w r2, [r3, #56] @ 0x38
|
|
SubgRf.ModulationParams.Params.Gfsk.BitRate = config->fsk.BitRate;
|
|
8009a60: 68bb ldr r3, [r7, #8]
|
|
8009a62: 681b ldr r3, [r3, #0]
|
|
8009a64: 4a3d ldr r2, [pc, #244] @ (8009b5c <RadioSetTxGenericConfig+0x2e8>)
|
|
8009a66: 63d3 str r3, [r2, #60] @ 0x3c
|
|
SubgRf.ModulationParams.Params.Gfsk.ModulationShaping = ( RadioModShapings_t ) config->fsk.ModulationShaping;
|
|
8009a68: 68bb ldr r3, [r7, #8]
|
|
8009a6a: 7cda ldrb r2, [r3, #19]
|
|
8009a6c: 4b3b ldr r3, [pc, #236] @ (8009b5c <RadioSetTxGenericConfig+0x2e8>)
|
|
8009a6e: f883 2044 strb.w r2, [r3, #68] @ 0x44
|
|
SubgRf.ModulationParams.Params.Gfsk.Fdev = config->fsk.FrequencyDeviation;
|
|
8009a72: 68bb ldr r3, [r7, #8]
|
|
8009a74: 699b ldr r3, [r3, #24]
|
|
8009a76: 4a39 ldr r2, [pc, #228] @ (8009b5c <RadioSetTxGenericConfig+0x2e8>)
|
|
8009a78: 6413 str r3, [r2, #64] @ 0x40
|
|
|
|
SubgRf.PacketParams.PacketType = PACKET_TYPE_GFSK;
|
|
8009a7a: 4b38 ldr r3, [pc, #224] @ (8009b5c <RadioSetTxGenericConfig+0x2e8>)
|
|
8009a7c: 2200 movs r2, #0
|
|
8009a7e: 739a strb r2, [r3, #14]
|
|
SubgRf.PacketParams.Params.Gfsk.PreambleLength = ( config->fsk.PreambleLen ) << 3; // convert byte into bit
|
|
8009a80: 68bb ldr r3, [r7, #8]
|
|
8009a82: 685b ldr r3, [r3, #4]
|
|
8009a84: b29b uxth r3, r3
|
|
8009a86: 00db lsls r3, r3, #3
|
|
8009a88: b29a uxth r2, r3
|
|
8009a8a: 4b34 ldr r3, [pc, #208] @ (8009b5c <RadioSetTxGenericConfig+0x2e8>)
|
|
8009a8c: 821a strh r2, [r3, #16]
|
|
SubgRf.PacketParams.Params.Gfsk.PreambleMinDetect = RADIO_PREAMBLE_DETECTOR_08_BITS; // don't care in tx
|
|
8009a8e: 4b33 ldr r3, [pc, #204] @ (8009b5c <RadioSetTxGenericConfig+0x2e8>)
|
|
8009a90: 2204 movs r2, #4
|
|
8009a92: 749a strb r2, [r3, #18]
|
|
SubgRf.PacketParams.Params.Gfsk.SyncWordLength = ( config->fsk.SyncWordLength ) << 3; // convert byte into bit
|
|
8009a94: 68bb ldr r3, [r7, #8]
|
|
8009a96: 7c9b ldrb r3, [r3, #18]
|
|
8009a98: 00db lsls r3, r3, #3
|
|
8009a9a: b2da uxtb r2, r3
|
|
8009a9c: 4b2f ldr r3, [pc, #188] @ (8009b5c <RadioSetTxGenericConfig+0x2e8>)
|
|
8009a9e: 74da strb r2, [r3, #19]
|
|
SubgRf.PacketParams.Params.Gfsk.AddrComp = RADIO_ADDRESSCOMP_FILT_OFF; // don't care in tx
|
|
8009aa0: 4b2e ldr r3, [pc, #184] @ (8009b5c <RadioSetTxGenericConfig+0x2e8>)
|
|
8009aa2: 2200 movs r2, #0
|
|
8009aa4: 751a strb r2, [r3, #20]
|
|
|
|
if( ( config->fsk.Whitening == RADIO_FSK_DC_IBM_WHITENING )
|
|
8009aa6: 68bb ldr r3, [r7, #8]
|
|
8009aa8: 7d9b ldrb r3, [r3, #22]
|
|
8009aaa: 2b02 cmp r3, #2
|
|
8009aac: d003 beq.n 8009ab6 <RadioSetTxGenericConfig+0x242>
|
|
|| ( config->fsk.HeaderType == RADIO_FSK_PACKET_2BYTES_LENGTH ) )
|
|
8009aae: 68bb ldr r3, [r7, #8]
|
|
8009ab0: 7d1b ldrb r3, [r3, #20]
|
|
8009ab2: 2b02 cmp r3, #2
|
|
8009ab4: d12a bne.n 8009b0c <RadioSetTxGenericConfig+0x298>
|
|
{
|
|
/* Supports only RADIO_FSK_CRC_2_BYTES_IBM or RADIO_FSK_CRC_2_BYTES_CCIT */
|
|
if( ( config->fsk.CrcLength != RADIO_FSK_CRC_2_BYTES_IBM ) && ( config->fsk.CrcLength != RADIO_FSK_CRC_2_BYTES_CCIT )
|
|
8009ab6: 68bb ldr r3, [r7, #8]
|
|
8009ab8: 7d5b ldrb r3, [r3, #21]
|
|
8009aba: 2bf1 cmp r3, #241 @ 0xf1
|
|
8009abc: d00a beq.n 8009ad4 <RadioSetTxGenericConfig+0x260>
|
|
8009abe: 68bb ldr r3, [r7, #8]
|
|
8009ac0: 7d5b ldrb r3, [r3, #21]
|
|
8009ac2: 2bf2 cmp r3, #242 @ 0xf2
|
|
8009ac4: d006 beq.n 8009ad4 <RadioSetTxGenericConfig+0x260>
|
|
&& ( config->fsk.CrcLength != RADIO_FSK_CRC_OFF ) )
|
|
8009ac6: 68bb ldr r3, [r7, #8]
|
|
8009ac8: 7d5b ldrb r3, [r3, #21]
|
|
8009aca: 2b01 cmp r3, #1
|
|
8009acc: d002 beq.n 8009ad4 <RadioSetTxGenericConfig+0x260>
|
|
{
|
|
return -1;
|
|
8009ace: f04f 33ff mov.w r3, #4294967295 @ 0xffffffff
|
|
8009ad2: e0fd b.n 8009cd0 <RadioSetTxGenericConfig+0x45c>
|
|
}
|
|
ConfigGeneric_t ConfigGeneric;
|
|
ConfigGeneric.rtx = CONFIG_TX;
|
|
8009ad4: 2301 movs r3, #1
|
|
8009ad6: 773b strb r3, [r7, #28]
|
|
ConfigGeneric.TxConfig = config;
|
|
8009ad8: 68bb ldr r3, [r7, #8]
|
|
8009ada: 617b str r3, [r7, #20]
|
|
if( 0UL != RFW_Init( &ConfigGeneric, RadioEvents, &TxTimeoutTimer ) )
|
|
8009adc: 4b20 ldr r3, [pc, #128] @ (8009b60 <RadioSetTxGenericConfig+0x2ec>)
|
|
8009ade: 6819 ldr r1, [r3, #0]
|
|
8009ae0: f107 0314 add.w r3, r7, #20
|
|
8009ae4: 4a1f ldr r2, [pc, #124] @ (8009b64 <RadioSetTxGenericConfig+0x2f0>)
|
|
8009ae6: 4618 mov r0, r3
|
|
8009ae8: f001 fd02 bl 800b4f0 <RFW_Init>
|
|
8009aec: 4603 mov r3, r0
|
|
8009aee: 2b00 cmp r3, #0
|
|
8009af0: d002 beq.n 8009af8 <RadioSetTxGenericConfig+0x284>
|
|
{
|
|
return -1;
|
|
8009af2: f04f 33ff mov.w r3, #4294967295 @ 0xffffffff
|
|
8009af6: e0eb b.n 8009cd0 <RadioSetTxGenericConfig+0x45c>
|
|
}
|
|
/* whitening off, will be processed by FW, switch off built-in radio whitening */
|
|
SubgRf.PacketParams.Params.Gfsk.DcFree = ( RadioDcFree_t ) RADIO_FSK_DC_FREE_OFF;
|
|
8009af8: 4b18 ldr r3, [pc, #96] @ (8009b5c <RadioSetTxGenericConfig+0x2e8>)
|
|
8009afa: 2200 movs r2, #0
|
|
8009afc: 761a strb r2, [r3, #24]
|
|
/* Crc processed by FW, switch off built-in radio Crc */
|
|
SubgRf.PacketParams.Params.Gfsk.CrcLength = ( RadioCrcTypes_t ) RADIO_CRC_OFF;
|
|
8009afe: 4b17 ldr r3, [pc, #92] @ (8009b5c <RadioSetTxGenericConfig+0x2e8>)
|
|
8009b00: 2201 movs r2, #1
|
|
8009b02: 75da strb r2, [r3, #23]
|
|
/* length contained in Tx, but will be processed by FW after de-whitening */
|
|
SubgRf.PacketParams.Params.Gfsk.HeaderType = ( RadioPacketLengthModes_t ) RADIO_PACKET_FIXED_LENGTH;
|
|
8009b04: 4b15 ldr r3, [pc, #84] @ (8009b5c <RadioSetTxGenericConfig+0x2e8>)
|
|
8009b06: 2200 movs r2, #0
|
|
8009b08: 755a strb r2, [r3, #21]
|
|
{
|
|
8009b0a: e00b b.n 8009b24 <RadioSetTxGenericConfig+0x2b0>
|
|
}
|
|
else
|
|
{
|
|
SubgRf.PacketParams.Params.Gfsk.CrcLength = ( RadioCrcTypes_t ) config->fsk.CrcLength;
|
|
8009b0c: 68bb ldr r3, [r7, #8]
|
|
8009b0e: 7d5a ldrb r2, [r3, #21]
|
|
8009b10: 4b12 ldr r3, [pc, #72] @ (8009b5c <RadioSetTxGenericConfig+0x2e8>)
|
|
8009b12: 75da strb r2, [r3, #23]
|
|
SubgRf.PacketParams.Params.Gfsk.DcFree = ( RadioDcFree_t ) config->fsk.Whitening;
|
|
8009b14: 68bb ldr r3, [r7, #8]
|
|
8009b16: 7d9a ldrb r2, [r3, #22]
|
|
8009b18: 4b10 ldr r3, [pc, #64] @ (8009b5c <RadioSetTxGenericConfig+0x2e8>)
|
|
8009b1a: 761a strb r2, [r3, #24]
|
|
SubgRf.PacketParams.Params.Gfsk.HeaderType = ( RadioPacketLengthModes_t ) config->fsk.HeaderType;
|
|
8009b1c: 68bb ldr r3, [r7, #8]
|
|
8009b1e: 7d1a ldrb r2, [r3, #20]
|
|
8009b20: 4b0e ldr r3, [pc, #56] @ (8009b5c <RadioSetTxGenericConfig+0x2e8>)
|
|
8009b22: 755a strb r2, [r3, #21]
|
|
}
|
|
|
|
RadioStandby( );
|
|
8009b24: f7fe ffc9 bl 8008aba <RadioStandby>
|
|
RadioSetModem( MODEM_FSK );
|
|
8009b28: 2000 movs r0, #0
|
|
8009b2a: f7fe f957 bl 8007ddc <RadioSetModem>
|
|
SUBGRF_SetModulationParams( &SubgRf.ModulationParams );
|
|
8009b2e: 480e ldr r0, [pc, #56] @ (8009b68 <RadioSetTxGenericConfig+0x2f4>)
|
|
8009b30: f000 fdf4 bl 800a71c <SUBGRF_SetModulationParams>
|
|
SUBGRF_SetPacketParams( &SubgRf.PacketParams );
|
|
8009b34: 480d ldr r0, [pc, #52] @ (8009b6c <RadioSetTxGenericConfig+0x2f8>)
|
|
8009b36: f000 febf bl 800a8b8 <SUBGRF_SetPacketParams>
|
|
SUBGRF_SetSyncWord( syncword );
|
|
8009b3a: f107 032c add.w r3, r7, #44 @ 0x2c
|
|
8009b3e: 4618 mov r0, r3
|
|
8009b40: f000 f97f bl 8009e42 <SUBGRF_SetSyncWord>
|
|
SUBGRF_SetWhiteningSeed( config->fsk.whiteSeed );
|
|
8009b44: 68bb ldr r3, [r7, #8]
|
|
8009b46: 8a1b ldrh r3, [r3, #16]
|
|
8009b48: 4618 mov r0, r3
|
|
8009b4a: f000 f9c9 bl 8009ee0 <SUBGRF_SetWhiteningSeed>
|
|
SUBGRF_SetCrcPolynomial( config->fsk.CrcPolynomial );
|
|
8009b4e: 68bb ldr r3, [r7, #8]
|
|
8009b50: 899b ldrh r3, [r3, #12]
|
|
8009b52: 4618 mov r0, r3
|
|
8009b54: f000 f9a4 bl 8009ea0 <SUBGRF_SetCrcPolynomial>
|
|
break;
|
|
8009b58: e0a6 b.n 8009ca8 <RadioSetTxGenericConfig+0x434>
|
|
8009b5a: bf00 nop
|
|
8009b5c: 200002f8 .word 0x200002f8
|
|
8009b60: 200002f4 .word 0x200002f4
|
|
8009b64: 20000354 .word 0x20000354
|
|
8009b68: 20000330 .word 0x20000330
|
|
8009b6c: 20000306 .word 0x20000306
|
|
case GENERIC_LORA:
|
|
SubgRf.ModulationParams.PacketType = PACKET_TYPE_LORA;
|
|
8009b70: 4b59 ldr r3, [pc, #356] @ (8009cd8 <RadioSetTxGenericConfig+0x464>)
|
|
8009b72: 2201 movs r2, #1
|
|
8009b74: f883 2038 strb.w r2, [r3, #56] @ 0x38
|
|
SubgRf.ModulationParams.Params.LoRa.SpreadingFactor = ( RadioLoRaSpreadingFactors_t ) config->lora.SpreadingFactor;
|
|
8009b78: 68bb ldr r3, [r7, #8]
|
|
8009b7a: 781a ldrb r2, [r3, #0]
|
|
8009b7c: 4b56 ldr r3, [pc, #344] @ (8009cd8 <RadioSetTxGenericConfig+0x464>)
|
|
8009b7e: f883 2050 strb.w r2, [r3, #80] @ 0x50
|
|
SubgRf.ModulationParams.Params.LoRa.Bandwidth = ( RadioLoRaBandwidths_t ) config->lora.Bandwidth;
|
|
8009b82: 68bb ldr r3, [r7, #8]
|
|
8009b84: 785a ldrb r2, [r3, #1]
|
|
8009b86: 4b54 ldr r3, [pc, #336] @ (8009cd8 <RadioSetTxGenericConfig+0x464>)
|
|
8009b88: f883 2051 strb.w r2, [r3, #81] @ 0x51
|
|
SubgRf.ModulationParams.Params.LoRa.CodingRate = ( RadioLoRaCodingRates_t ) config->lora.Coderate;
|
|
8009b8c: 68bb ldr r3, [r7, #8]
|
|
8009b8e: 789a ldrb r2, [r3, #2]
|
|
8009b90: 4b51 ldr r3, [pc, #324] @ (8009cd8 <RadioSetTxGenericConfig+0x464>)
|
|
8009b92: f883 2052 strb.w r2, [r3, #82] @ 0x52
|
|
switch( config->lora.LowDatarateOptimize )
|
|
8009b96: 68bb ldr r3, [r7, #8]
|
|
8009b98: 78db ldrb r3, [r3, #3]
|
|
8009b9a: 2b02 cmp r3, #2
|
|
8009b9c: d010 beq.n 8009bc0 <RadioSetTxGenericConfig+0x34c>
|
|
8009b9e: 2b02 cmp r3, #2
|
|
8009ba0: dc20 bgt.n 8009be4 <RadioSetTxGenericConfig+0x370>
|
|
8009ba2: 2b00 cmp r3, #0
|
|
8009ba4: d002 beq.n 8009bac <RadioSetTxGenericConfig+0x338>
|
|
8009ba6: 2b01 cmp r3, #1
|
|
8009ba8: d005 beq.n 8009bb6 <RadioSetTxGenericConfig+0x342>
|
|
{
|
|
SubgRf.ModulationParams.Params.LoRa.LowDatarateOptimize = 0;
|
|
}
|
|
break;
|
|
default:
|
|
break;
|
|
8009baa: e01b b.n 8009be4 <RadioSetTxGenericConfig+0x370>
|
|
SubgRf.ModulationParams.Params.LoRa.LowDatarateOptimize = 0;
|
|
8009bac: 4b4a ldr r3, [pc, #296] @ (8009cd8 <RadioSetTxGenericConfig+0x464>)
|
|
8009bae: 2200 movs r2, #0
|
|
8009bb0: f883 2053 strb.w r2, [r3, #83] @ 0x53
|
|
break;
|
|
8009bb4: e017 b.n 8009be6 <RadioSetTxGenericConfig+0x372>
|
|
SubgRf.ModulationParams.Params.LoRa.LowDatarateOptimize = 1;
|
|
8009bb6: 4b48 ldr r3, [pc, #288] @ (8009cd8 <RadioSetTxGenericConfig+0x464>)
|
|
8009bb8: 2201 movs r2, #1
|
|
8009bba: f883 2053 strb.w r2, [r3, #83] @ 0x53
|
|
break;
|
|
8009bbe: e012 b.n 8009be6 <RadioSetTxGenericConfig+0x372>
|
|
if( ( config->lora.SpreadingFactor == RADIO_LORA_SF11 ) || ( config->lora.SpreadingFactor == RADIO_LORA_SF12 ) )
|
|
8009bc0: 68bb ldr r3, [r7, #8]
|
|
8009bc2: 781b ldrb r3, [r3, #0]
|
|
8009bc4: 2b0b cmp r3, #11
|
|
8009bc6: d003 beq.n 8009bd0 <RadioSetTxGenericConfig+0x35c>
|
|
8009bc8: 68bb ldr r3, [r7, #8]
|
|
8009bca: 781b ldrb r3, [r3, #0]
|
|
8009bcc: 2b0c cmp r3, #12
|
|
8009bce: d104 bne.n 8009bda <RadioSetTxGenericConfig+0x366>
|
|
SubgRf.ModulationParams.Params.LoRa.LowDatarateOptimize = 1;
|
|
8009bd0: 4b41 ldr r3, [pc, #260] @ (8009cd8 <RadioSetTxGenericConfig+0x464>)
|
|
8009bd2: 2201 movs r2, #1
|
|
8009bd4: f883 2053 strb.w r2, [r3, #83] @ 0x53
|
|
break;
|
|
8009bd8: e005 b.n 8009be6 <RadioSetTxGenericConfig+0x372>
|
|
SubgRf.ModulationParams.Params.LoRa.LowDatarateOptimize = 0;
|
|
8009bda: 4b3f ldr r3, [pc, #252] @ (8009cd8 <RadioSetTxGenericConfig+0x464>)
|
|
8009bdc: 2200 movs r2, #0
|
|
8009bde: f883 2053 strb.w r2, [r3, #83] @ 0x53
|
|
break;
|
|
8009be2: e000 b.n 8009be6 <RadioSetTxGenericConfig+0x372>
|
|
break;
|
|
8009be4: bf00 nop
|
|
}
|
|
|
|
SubgRf.PacketParams.PacketType = PACKET_TYPE_LORA;
|
|
8009be6: 4b3c ldr r3, [pc, #240] @ (8009cd8 <RadioSetTxGenericConfig+0x464>)
|
|
8009be8: 2201 movs r2, #1
|
|
8009bea: 739a strb r2, [r3, #14]
|
|
SubgRf.PacketParams.Params.LoRa.PreambleLength = config->lora.PreambleLen;
|
|
8009bec: 68bb ldr r3, [r7, #8]
|
|
8009bee: 889a ldrh r2, [r3, #4]
|
|
8009bf0: 4b39 ldr r3, [pc, #228] @ (8009cd8 <RadioSetTxGenericConfig+0x464>)
|
|
8009bf2: 839a strh r2, [r3, #28]
|
|
SubgRf.PacketParams.Params.LoRa.HeaderType = ( RadioLoRaPacketLengthsMode_t ) config->lora.LengthMode;
|
|
8009bf4: 68bb ldr r3, [r7, #8]
|
|
8009bf6: 799a ldrb r2, [r3, #6]
|
|
8009bf8: 4b37 ldr r3, [pc, #220] @ (8009cd8 <RadioSetTxGenericConfig+0x464>)
|
|
8009bfa: 779a strb r2, [r3, #30]
|
|
SubgRf.PacketParams.Params.LoRa.CrcMode = ( RadioLoRaCrcModes_t ) config->lora.CrcMode;
|
|
8009bfc: 68bb ldr r3, [r7, #8]
|
|
8009bfe: 79da ldrb r2, [r3, #7]
|
|
8009c00: 4b35 ldr r3, [pc, #212] @ (8009cd8 <RadioSetTxGenericConfig+0x464>)
|
|
8009c02: f883 2020 strb.w r2, [r3, #32]
|
|
SubgRf.PacketParams.Params.LoRa.InvertIQ = ( RadioLoRaIQModes_t ) config->lora.IqInverted;
|
|
8009c06: 68bb ldr r3, [r7, #8]
|
|
8009c08: 7a1a ldrb r2, [r3, #8]
|
|
8009c0a: 4b33 ldr r3, [pc, #204] @ (8009cd8 <RadioSetTxGenericConfig+0x464>)
|
|
8009c0c: f883 2021 strb.w r2, [r3, #33] @ 0x21
|
|
|
|
RadioStandby( );
|
|
8009c10: f7fe ff53 bl 8008aba <RadioStandby>
|
|
RadioSetModem( MODEM_LORA );
|
|
8009c14: 2001 movs r0, #1
|
|
8009c16: f7fe f8e1 bl 8007ddc <RadioSetModem>
|
|
SUBGRF_SetModulationParams( &SubgRf.ModulationParams );
|
|
8009c1a: 4830 ldr r0, [pc, #192] @ (8009cdc <RadioSetTxGenericConfig+0x468>)
|
|
8009c1c: f000 fd7e bl 800a71c <SUBGRF_SetModulationParams>
|
|
SUBGRF_SetPacketParams( &SubgRf.PacketParams );
|
|
8009c20: 482f ldr r0, [pc, #188] @ (8009ce0 <RadioSetTxGenericConfig+0x46c>)
|
|
8009c22: f000 fe49 bl 800a8b8 <SUBGRF_SetPacketParams>
|
|
|
|
/* WORKAROUND - Modulation Quality with 500 kHz LoRa Bandwidth, see STM32WL Erratasheet */
|
|
if( SubgRf.ModulationParams.Params.LoRa.Bandwidth == LORA_BW_500 )
|
|
8009c26: 4b2c ldr r3, [pc, #176] @ (8009cd8 <RadioSetTxGenericConfig+0x464>)
|
|
8009c28: f893 3051 ldrb.w r3, [r3, #81] @ 0x51
|
|
8009c2c: 2b06 cmp r3, #6
|
|
8009c2e: d10d bne.n 8009c4c <RadioSetTxGenericConfig+0x3d8>
|
|
{
|
|
// RegTxModulation = @address 0x0889
|
|
SUBGRF_WriteRegister( SUBGHZ_SDCFG0R, SUBGRF_ReadRegister( SUBGHZ_SDCFG0R ) & ~( 1 << 2 ) );
|
|
8009c30: f640 0089 movw r0, #2185 @ 0x889
|
|
8009c34: f000 ffa8 bl 800ab88 <SUBGRF_ReadRegister>
|
|
8009c38: 4603 mov r3, r0
|
|
8009c3a: f023 0304 bic.w r3, r3, #4
|
|
8009c3e: b2db uxtb r3, r3
|
|
8009c40: 4619 mov r1, r3
|
|
8009c42: f640 0089 movw r0, #2185 @ 0x889
|
|
8009c46: f000 ff7d bl 800ab44 <SUBGRF_WriteRegister>
|
|
{
|
|
// RegTxModulation = @address 0x0889
|
|
SUBGRF_WriteRegister( SUBGHZ_SDCFG0R, SUBGRF_ReadRegister( SUBGHZ_SDCFG0R ) | ( 1 << 2 ) );
|
|
}
|
|
/* WORKAROUND END */
|
|
break;
|
|
8009c4a: e02d b.n 8009ca8 <RadioSetTxGenericConfig+0x434>
|
|
SUBGRF_WriteRegister( SUBGHZ_SDCFG0R, SUBGRF_ReadRegister( SUBGHZ_SDCFG0R ) | ( 1 << 2 ) );
|
|
8009c4c: f640 0089 movw r0, #2185 @ 0x889
|
|
8009c50: f000 ff9a bl 800ab88 <SUBGRF_ReadRegister>
|
|
8009c54: 4603 mov r3, r0
|
|
8009c56: f043 0304 orr.w r3, r3, #4
|
|
8009c5a: b2db uxtb r3, r3
|
|
8009c5c: 4619 mov r1, r3
|
|
8009c5e: f640 0089 movw r0, #2185 @ 0x889
|
|
8009c62: f000 ff6f bl 800ab44 <SUBGRF_WriteRegister>
|
|
break;
|
|
8009c66: e01f b.n 8009ca8 <RadioSetTxGenericConfig+0x434>
|
|
case GENERIC_BPSK:
|
|
if( ( config->bpsk.BitRate == 0 ) || ( config->bpsk.BitRate > 1000 ) )
|
|
8009c68: 68bb ldr r3, [r7, #8]
|
|
8009c6a: 681b ldr r3, [r3, #0]
|
|
8009c6c: 2b00 cmp r3, #0
|
|
8009c6e: d004 beq.n 8009c7a <RadioSetTxGenericConfig+0x406>
|
|
8009c70: 68bb ldr r3, [r7, #8]
|
|
8009c72: 681b ldr r3, [r3, #0]
|
|
8009c74: f5b3 7f7a cmp.w r3, #1000 @ 0x3e8
|
|
8009c78: d902 bls.n 8009c80 <RadioSetTxGenericConfig+0x40c>
|
|
{
|
|
return -1;
|
|
8009c7a: f04f 33ff mov.w r3, #4294967295 @ 0xffffffff
|
|
8009c7e: e027 b.n 8009cd0 <RadioSetTxGenericConfig+0x45c>
|
|
}
|
|
RadioSetModem( MODEM_BPSK );
|
|
8009c80: 2003 movs r0, #3
|
|
8009c82: f7fe f8ab bl 8007ddc <RadioSetModem>
|
|
SubgRf.ModulationParams.PacketType = PACKET_TYPE_BPSK;
|
|
8009c86: 4b14 ldr r3, [pc, #80] @ (8009cd8 <RadioSetTxGenericConfig+0x464>)
|
|
8009c88: 2202 movs r2, #2
|
|
8009c8a: f883 2038 strb.w r2, [r3, #56] @ 0x38
|
|
SubgRf.ModulationParams.Params.Bpsk.BitRate = config->bpsk.BitRate;
|
|
8009c8e: 68bb ldr r3, [r7, #8]
|
|
8009c90: 681b ldr r3, [r3, #0]
|
|
8009c92: 4a11 ldr r2, [pc, #68] @ (8009cd8 <RadioSetTxGenericConfig+0x464>)
|
|
8009c94: 6493 str r3, [r2, #72] @ 0x48
|
|
SubgRf.ModulationParams.Params.Bpsk.ModulationShaping = MOD_SHAPING_DBPSK;
|
|
8009c96: 4b10 ldr r3, [pc, #64] @ (8009cd8 <RadioSetTxGenericConfig+0x464>)
|
|
8009c98: 2216 movs r2, #22
|
|
8009c9a: f883 204c strb.w r2, [r3, #76] @ 0x4c
|
|
SUBGRF_SetModulationParams( &SubgRf.ModulationParams );
|
|
8009c9e: 480f ldr r0, [pc, #60] @ (8009cdc <RadioSetTxGenericConfig+0x468>)
|
|
8009ca0: f000 fd3c bl 800a71c <SUBGRF_SetModulationParams>
|
|
break;
|
|
8009ca4: e000 b.n 8009ca8 <RadioSetTxGenericConfig+0x434>
|
|
default:
|
|
break;
|
|
8009ca6: bf00 nop
|
|
}
|
|
|
|
SubgRf.AntSwitchPaSelect = SUBGRF_SetRfTxPower( power );
|
|
8009ca8: f997 300e ldrsb.w r3, [r7, #14]
|
|
8009cac: 4618 mov r0, r3
|
|
8009cae: f001 f87f bl 800adb0 <SUBGRF_SetRfTxPower>
|
|
8009cb2: 4603 mov r3, r0
|
|
8009cb4: 461a mov r2, r3
|
|
8009cb6: 4b08 ldr r3, [pc, #32] @ (8009cd8 <RadioSetTxGenericConfig+0x464>)
|
|
8009cb8: f883 2056 strb.w r2, [r3, #86] @ 0x56
|
|
RFW_SetAntSwitch( SubgRf.AntSwitchPaSelect );
|
|
8009cbc: 4b06 ldr r3, [pc, #24] @ (8009cd8 <RadioSetTxGenericConfig+0x464>)
|
|
8009cbe: f893 3056 ldrb.w r3, [r3, #86] @ 0x56
|
|
8009cc2: 4618 mov r0, r3
|
|
8009cc4: f001 fcce bl 800b664 <RFW_SetAntSwitch>
|
|
SubgRf.TxTimeout = timeout;
|
|
8009cc8: 4a03 ldr r2, [pc, #12] @ (8009cd8 <RadioSetTxGenericConfig+0x464>)
|
|
8009cca: 687b ldr r3, [r7, #4]
|
|
8009ccc: 6053 str r3, [r2, #4]
|
|
return 0;
|
|
8009cce: 2300 movs r3, #0
|
|
#else /* RADIO_GENERIC_CONFIG_ENABLE == 1*/
|
|
return -1;
|
|
#endif /* RADIO_GENERIC_CONFIG_ENABLE == 0*/
|
|
}
|
|
8009cd0: 4618 mov r0, r3
|
|
8009cd2: 3738 adds r7, #56 @ 0x38
|
|
8009cd4: 46bd mov sp, r7
|
|
8009cd6: bd80 pop {r7, pc}
|
|
8009cd8: 200002f8 .word 0x200002f8
|
|
8009cdc: 20000330 .word 0x20000330
|
|
8009ce0: 20000306 .word 0x20000306
|
|
|
|
08009ce4 <RadioLrFhssSetCfg>:
|
|
return ( prbs31_val - 1 ) % ( max );
|
|
}
|
|
#endif /* RADIO_LR_FHSS_IS_ON == 1 */
|
|
|
|
static radio_status_t RadioLrFhssSetCfg( const radio_lr_fhss_cfg_params_t *cfg_params )
|
|
{
|
|
8009ce4: b480 push {r7}
|
|
8009ce6: b085 sub sp, #20
|
|
8009ce8: af00 add r7, sp, #0
|
|
8009cea: 6078 str r0, [r7, #4]
|
|
radio_status_t status = RADIO_STATUS_UNSUPPORTED_FEATURE;
|
|
8009cec: 2301 movs r3, #1
|
|
8009cee: 73fb strb r3, [r7, #15]
|
|
{
|
|
return status;
|
|
}
|
|
SubgRf.lr_fhss.is_lr_fhss_on = true;
|
|
#endif /* RADIO_LR_FHSS_IS_ON == 1 */
|
|
return status;
|
|
8009cf0: 7bfb ldrb r3, [r7, #15]
|
|
}
|
|
8009cf2: 4618 mov r0, r3
|
|
8009cf4: 3714 adds r7, #20
|
|
8009cf6: 46bd mov sp, r7
|
|
8009cf8: bc80 pop {r7}
|
|
8009cfa: 4770 bx lr
|
|
|
|
08009cfc <RadioLrFhssGetTimeOnAirInMs>:
|
|
|
|
static radio_status_t RadioLrFhssGetTimeOnAirInMs( const radio_lr_fhss_time_on_air_params_t *params,
|
|
uint32_t *time_on_air_in_ms )
|
|
{
|
|
8009cfc: b480 push {r7}
|
|
8009cfe: b083 sub sp, #12
|
|
8009d00: af00 add r7, sp, #0
|
|
8009d02: 6078 str r0, [r7, #4]
|
|
8009d04: 6039 str r1, [r7, #0]
|
|
*time_on_air_in_ms = lr_fhss_get_time_on_air_in_ms( ¶ms->radio_lr_fhss_params.lr_fhss_params,
|
|
params->pld_len_in_bytes );
|
|
|
|
return RADIO_STATUS_OK;
|
|
#else
|
|
return RADIO_STATUS_UNSUPPORTED_FEATURE;
|
|
8009d06: 2301 movs r3, #1
|
|
#endif /* RADIO_LR_FHSS_IS_ON */
|
|
8009d08: 4618 mov r0, r3
|
|
8009d0a: 370c adds r7, #12
|
|
8009d0c: 46bd mov sp, r7
|
|
8009d0e: bc80 pop {r7}
|
|
8009d10: 4770 bx lr
|
|
...
|
|
|
|
08009d14 <SUBGRF_Init>:
|
|
*/
|
|
static DioIrqHandler RadioOnDioIrqCb;
|
|
|
|
/* Exported functions ---------------------------------------------------------*/
|
|
void SUBGRF_Init( DioIrqHandler dioIrq )
|
|
{
|
|
8009d14: b580 push {r7, lr}
|
|
8009d16: b084 sub sp, #16
|
|
8009d18: af00 add r7, sp, #0
|
|
8009d1a: 6078 str r0, [r7, #4]
|
|
if ( dioIrq != NULL)
|
|
8009d1c: 687b ldr r3, [r7, #4]
|
|
8009d1e: 2b00 cmp r3, #0
|
|
8009d20: d002 beq.n 8009d28 <SUBGRF_Init+0x14>
|
|
{
|
|
RadioOnDioIrqCb = dioIrq;
|
|
8009d22: 4a1d ldr r2, [pc, #116] @ (8009d98 <SUBGRF_Init+0x84>)
|
|
8009d24: 687b ldr r3, [r7, #4]
|
|
8009d26: 6013 str r3, [r2, #0]
|
|
}
|
|
|
|
RADIO_INIT();
|
|
8009d28: f7f6 fedc bl 8000ae4 <MX_SUBGHZ_Init>
|
|
|
|
/* set default SMPS current drive to default*/
|
|
Radio_SMPS_Set(SMPS_DRIVE_SETTING_DEFAULT);
|
|
8009d2c: 2002 movs r0, #2
|
|
8009d2e: f001 f91b bl 800af68 <Radio_SMPS_Set>
|
|
|
|
ImageCalibrated = false;
|
|
8009d32: 4b1a ldr r3, [pc, #104] @ (8009d9c <SUBGRF_Init+0x88>)
|
|
8009d34: 2200 movs r2, #0
|
|
8009d36: 701a strb r2, [r3, #0]
|
|
|
|
SUBGRF_SetStandby( STDBY_RC );
|
|
8009d38: 2000 movs r0, #0
|
|
8009d3a: f000 f97f bl 800a03c <SUBGRF_SetStandby>
|
|
|
|
// Initialize TCXO control
|
|
if (1U == RBI_IsTCXO() )
|
|
8009d3e: f003 fd95 bl 800d86c <RBI_IsTCXO>
|
|
8009d42: 4603 mov r3, r0
|
|
8009d44: 2b01 cmp r3, #1
|
|
8009d46: d10e bne.n 8009d66 <SUBGRF_Init+0x52>
|
|
{
|
|
SUBGRF_SetTcxoMode( TCXO_CTRL_VOLTAGE, RF_WAKEUP_TIME << 6 );// 100 ms
|
|
8009d48: 2140 movs r1, #64 @ 0x40
|
|
8009d4a: 2001 movs r0, #1
|
|
8009d4c: f000 fb8a bl 800a464 <SUBGRF_SetTcxoMode>
|
|
SUBGRF_WriteRegister( REG_XTA_TRIM, 0x00 );
|
|
8009d50: 2100 movs r1, #0
|
|
8009d52: f640 1011 movw r0, #2321 @ 0x911
|
|
8009d56: f000 fef5 bl 800ab44 <SUBGRF_WriteRegister>
|
|
|
|
/*enable calibration for cut1.1 and later*/
|
|
CalibrationParams_t calibParam;
|
|
calibParam.Value = 0x7F;
|
|
8009d5a: 237f movs r3, #127 @ 0x7f
|
|
8009d5c: 733b strb r3, [r7, #12]
|
|
SUBGRF_Calibrate( calibParam );
|
|
8009d5e: 7b38 ldrb r0, [r7, #12]
|
|
8009d60: f000 fa8d bl 800a27e <SUBGRF_Calibrate>
|
|
8009d64: e009 b.n 8009d7a <SUBGRF_Init+0x66>
|
|
}
|
|
else
|
|
{
|
|
SUBGRF_WriteRegister( REG_XTA_TRIM, XTAL_DEFAULT_CAP_VALUE );
|
|
8009d66: 2120 movs r1, #32
|
|
8009d68: f640 1011 movw r0, #2321 @ 0x911
|
|
8009d6c: f000 feea bl 800ab44 <SUBGRF_WriteRegister>
|
|
SUBGRF_WriteRegister( REG_XTB_TRIM, XTAL_DEFAULT_CAP_VALUE );
|
|
8009d70: 2120 movs r1, #32
|
|
8009d72: f640 1012 movw r0, #2322 @ 0x912
|
|
8009d76: f000 fee5 bl 800ab44 <SUBGRF_WriteRegister>
|
|
}
|
|
|
|
/* WORKAROUND - Trimming the output voltage power_ldo to 3.3V */
|
|
SUBGRF_WriteRegister(REG_DRV_CTRL, 0x7 << 1);
|
|
8009d7a: 210e movs r1, #14
|
|
8009d7c: f640 101f movw r0, #2335 @ 0x91f
|
|
8009d80: f000 fee0 bl 800ab44 <SUBGRF_WriteRegister>
|
|
|
|
/* Init RF Switch */
|
|
RBI_Init();
|
|
8009d84: f003 fd56 bl 800d834 <RBI_Init>
|
|
|
|
OperatingMode = MODE_STDBY_RC;
|
|
8009d88: 4b05 ldr r3, [pc, #20] @ (8009da0 <SUBGRF_Init+0x8c>)
|
|
8009d8a: 2201 movs r2, #1
|
|
8009d8c: 701a strb r2, [r3, #0]
|
|
}
|
|
8009d8e: bf00 nop
|
|
8009d90: 3710 adds r7, #16
|
|
8009d92: 46bd mov sp, r7
|
|
8009d94: bd80 pop {r7, pc}
|
|
8009d96: bf00 nop
|
|
8009d98: 20000390 .word 0x20000390
|
|
8009d9c: 2000038c .word 0x2000038c
|
|
8009da0: 20000384 .word 0x20000384
|
|
|
|
08009da4 <SUBGRF_GetOperatingMode>:
|
|
|
|
RadioOperatingModes_t SUBGRF_GetOperatingMode( void )
|
|
{
|
|
8009da4: b480 push {r7}
|
|
8009da6: af00 add r7, sp, #0
|
|
return OperatingMode;
|
|
8009da8: 4b02 ldr r3, [pc, #8] @ (8009db4 <SUBGRF_GetOperatingMode+0x10>)
|
|
8009daa: 781b ldrb r3, [r3, #0]
|
|
}
|
|
8009dac: 4618 mov r0, r3
|
|
8009dae: 46bd mov sp, r7
|
|
8009db0: bc80 pop {r7}
|
|
8009db2: 4770 bx lr
|
|
8009db4: 20000384 .word 0x20000384
|
|
|
|
08009db8 <SUBGRF_SetPayload>:
|
|
|
|
void SUBGRF_SetPayload( uint8_t *payload, uint8_t size )
|
|
{
|
|
8009db8: b580 push {r7, lr}
|
|
8009dba: b082 sub sp, #8
|
|
8009dbc: af00 add r7, sp, #0
|
|
8009dbe: 6078 str r0, [r7, #4]
|
|
8009dc0: 460b mov r3, r1
|
|
8009dc2: 70fb strb r3, [r7, #3]
|
|
SUBGRF_WriteBuffer( 0x00, payload, size );
|
|
8009dc4: 78fb ldrb r3, [r7, #3]
|
|
8009dc6: 461a mov r2, r3
|
|
8009dc8: 6879 ldr r1, [r7, #4]
|
|
8009dca: 2000 movs r0, #0
|
|
8009dcc: f000 ff40 bl 800ac50 <SUBGRF_WriteBuffer>
|
|
}
|
|
8009dd0: bf00 nop
|
|
8009dd2: 3708 adds r7, #8
|
|
8009dd4: 46bd mov sp, r7
|
|
8009dd6: bd80 pop {r7, pc}
|
|
|
|
08009dd8 <SUBGRF_GetPayload>:
|
|
|
|
uint8_t SUBGRF_GetPayload( uint8_t *buffer, uint8_t *size, uint8_t maxSize )
|
|
{
|
|
8009dd8: b580 push {r7, lr}
|
|
8009dda: b086 sub sp, #24
|
|
8009ddc: af00 add r7, sp, #0
|
|
8009dde: 60f8 str r0, [r7, #12]
|
|
8009de0: 60b9 str r1, [r7, #8]
|
|
8009de2: 4613 mov r3, r2
|
|
8009de4: 71fb strb r3, [r7, #7]
|
|
uint8_t offset = 0;
|
|
8009de6: 2300 movs r3, #0
|
|
8009de8: 75fb strb r3, [r7, #23]
|
|
|
|
SUBGRF_GetRxBufferStatus( size, &offset );
|
|
8009dea: f107 0317 add.w r3, r7, #23
|
|
8009dee: 4619 mov r1, r3
|
|
8009df0: 68b8 ldr r0, [r7, #8]
|
|
8009df2: f000 fe29 bl 800aa48 <SUBGRF_GetRxBufferStatus>
|
|
if( *size > maxSize )
|
|
8009df6: 68bb ldr r3, [r7, #8]
|
|
8009df8: 781b ldrb r3, [r3, #0]
|
|
8009dfa: 79fa ldrb r2, [r7, #7]
|
|
8009dfc: 429a cmp r2, r3
|
|
8009dfe: d201 bcs.n 8009e04 <SUBGRF_GetPayload+0x2c>
|
|
{
|
|
return 1;
|
|
8009e00: 2301 movs r3, #1
|
|
8009e02: e007 b.n 8009e14 <SUBGRF_GetPayload+0x3c>
|
|
}
|
|
SUBGRF_ReadBuffer( offset, buffer, *size );
|
|
8009e04: 7df8 ldrb r0, [r7, #23]
|
|
8009e06: 68bb ldr r3, [r7, #8]
|
|
8009e08: 781b ldrb r3, [r3, #0]
|
|
8009e0a: 461a mov r2, r3
|
|
8009e0c: 68f9 ldr r1, [r7, #12]
|
|
8009e0e: f000 ff41 bl 800ac94 <SUBGRF_ReadBuffer>
|
|
|
|
return 0;
|
|
8009e12: 2300 movs r3, #0
|
|
}
|
|
8009e14: 4618 mov r0, r3
|
|
8009e16: 3718 adds r7, #24
|
|
8009e18: 46bd mov sp, r7
|
|
8009e1a: bd80 pop {r7, pc}
|
|
|
|
08009e1c <SUBGRF_SendPayload>:
|
|
|
|
void SUBGRF_SendPayload( uint8_t *payload, uint8_t size, uint32_t timeout)
|
|
{
|
|
8009e1c: b580 push {r7, lr}
|
|
8009e1e: b084 sub sp, #16
|
|
8009e20: af00 add r7, sp, #0
|
|
8009e22: 60f8 str r0, [r7, #12]
|
|
8009e24: 460b mov r3, r1
|
|
8009e26: 607a str r2, [r7, #4]
|
|
8009e28: 72fb strb r3, [r7, #11]
|
|
SUBGRF_SetPayload( payload, size );
|
|
8009e2a: 7afb ldrb r3, [r7, #11]
|
|
8009e2c: 4619 mov r1, r3
|
|
8009e2e: 68f8 ldr r0, [r7, #12]
|
|
8009e30: f7ff ffc2 bl 8009db8 <SUBGRF_SetPayload>
|
|
SUBGRF_SetTx( timeout );
|
|
8009e34: 6878 ldr r0, [r7, #4]
|
|
8009e36: f000 f91d bl 800a074 <SUBGRF_SetTx>
|
|
}
|
|
8009e3a: bf00 nop
|
|
8009e3c: 3710 adds r7, #16
|
|
8009e3e: 46bd mov sp, r7
|
|
8009e40: bd80 pop {r7, pc}
|
|
|
|
08009e42 <SUBGRF_SetSyncWord>:
|
|
|
|
uint8_t SUBGRF_SetSyncWord( uint8_t *syncWord )
|
|
{
|
|
8009e42: b580 push {r7, lr}
|
|
8009e44: b082 sub sp, #8
|
|
8009e46: af00 add r7, sp, #0
|
|
8009e48: 6078 str r0, [r7, #4]
|
|
SUBGRF_WriteRegisters( REG_LR_SYNCWORDBASEADDRESS, syncWord, 8 );
|
|
8009e4a: 2208 movs r2, #8
|
|
8009e4c: 6879 ldr r1, [r7, #4]
|
|
8009e4e: f44f 60d8 mov.w r0, #1728 @ 0x6c0
|
|
8009e52: f000 feb9 bl 800abc8 <SUBGRF_WriteRegisters>
|
|
return 0;
|
|
8009e56: 2300 movs r3, #0
|
|
}
|
|
8009e58: 4618 mov r0, r3
|
|
8009e5a: 3708 adds r7, #8
|
|
8009e5c: 46bd mov sp, r7
|
|
8009e5e: bd80 pop {r7, pc}
|
|
|
|
08009e60 <SUBGRF_SetCrcSeed>:
|
|
|
|
void SUBGRF_SetCrcSeed( uint16_t seed )
|
|
{
|
|
8009e60: b580 push {r7, lr}
|
|
8009e62: b084 sub sp, #16
|
|
8009e64: af00 add r7, sp, #0
|
|
8009e66: 4603 mov r3, r0
|
|
8009e68: 80fb strh r3, [r7, #6]
|
|
uint8_t buf[2];
|
|
|
|
buf[0] = ( uint8_t )( ( seed >> 8 ) & 0xFF );
|
|
8009e6a: 88fb ldrh r3, [r7, #6]
|
|
8009e6c: 0a1b lsrs r3, r3, #8
|
|
8009e6e: b29b uxth r3, r3
|
|
8009e70: b2db uxtb r3, r3
|
|
8009e72: 733b strb r3, [r7, #12]
|
|
buf[1] = ( uint8_t )( seed & 0xFF );
|
|
8009e74: 88fb ldrh r3, [r7, #6]
|
|
8009e76: b2db uxtb r3, r3
|
|
8009e78: 737b strb r3, [r7, #13]
|
|
|
|
switch( SUBGRF_GetPacketType( ) )
|
|
8009e7a: f000 fb77 bl 800a56c <SUBGRF_GetPacketType>
|
|
8009e7e: 4603 mov r3, r0
|
|
8009e80: 2b00 cmp r3, #0
|
|
8009e82: d108 bne.n 8009e96 <SUBGRF_SetCrcSeed+0x36>
|
|
{
|
|
case PACKET_TYPE_GFSK:
|
|
SUBGRF_WriteRegisters( REG_LR_CRCSEEDBASEADDR, buf, 2 );
|
|
8009e84: f107 030c add.w r3, r7, #12
|
|
8009e88: 2202 movs r2, #2
|
|
8009e8a: 4619 mov r1, r3
|
|
8009e8c: f240 60bc movw r0, #1724 @ 0x6bc
|
|
8009e90: f000 fe9a bl 800abc8 <SUBGRF_WriteRegisters>
|
|
break;
|
|
8009e94: e000 b.n 8009e98 <SUBGRF_SetCrcSeed+0x38>
|
|
|
|
default:
|
|
break;
|
|
8009e96: bf00 nop
|
|
}
|
|
}
|
|
8009e98: bf00 nop
|
|
8009e9a: 3710 adds r7, #16
|
|
8009e9c: 46bd mov sp, r7
|
|
8009e9e: bd80 pop {r7, pc}
|
|
|
|
08009ea0 <SUBGRF_SetCrcPolynomial>:
|
|
|
|
void SUBGRF_SetCrcPolynomial( uint16_t polynomial )
|
|
{
|
|
8009ea0: b580 push {r7, lr}
|
|
8009ea2: b084 sub sp, #16
|
|
8009ea4: af00 add r7, sp, #0
|
|
8009ea6: 4603 mov r3, r0
|
|
8009ea8: 80fb strh r3, [r7, #6]
|
|
uint8_t buf[2];
|
|
|
|
buf[0] = ( uint8_t )( ( polynomial >> 8 ) & 0xFF );
|
|
8009eaa: 88fb ldrh r3, [r7, #6]
|
|
8009eac: 0a1b lsrs r3, r3, #8
|
|
8009eae: b29b uxth r3, r3
|
|
8009eb0: b2db uxtb r3, r3
|
|
8009eb2: 733b strb r3, [r7, #12]
|
|
buf[1] = ( uint8_t )( polynomial & 0xFF );
|
|
8009eb4: 88fb ldrh r3, [r7, #6]
|
|
8009eb6: b2db uxtb r3, r3
|
|
8009eb8: 737b strb r3, [r7, #13]
|
|
|
|
switch( SUBGRF_GetPacketType( ) )
|
|
8009eba: f000 fb57 bl 800a56c <SUBGRF_GetPacketType>
|
|
8009ebe: 4603 mov r3, r0
|
|
8009ec0: 2b00 cmp r3, #0
|
|
8009ec2: d108 bne.n 8009ed6 <SUBGRF_SetCrcPolynomial+0x36>
|
|
{
|
|
case PACKET_TYPE_GFSK:
|
|
SUBGRF_WriteRegisters( REG_LR_CRCPOLYBASEADDR, buf, 2 );
|
|
8009ec4: f107 030c add.w r3, r7, #12
|
|
8009ec8: 2202 movs r2, #2
|
|
8009eca: 4619 mov r1, r3
|
|
8009ecc: f240 60be movw r0, #1726 @ 0x6be
|
|
8009ed0: f000 fe7a bl 800abc8 <SUBGRF_WriteRegisters>
|
|
break;
|
|
8009ed4: e000 b.n 8009ed8 <SUBGRF_SetCrcPolynomial+0x38>
|
|
|
|
default:
|
|
break;
|
|
8009ed6: bf00 nop
|
|
}
|
|
}
|
|
8009ed8: bf00 nop
|
|
8009eda: 3710 adds r7, #16
|
|
8009edc: 46bd mov sp, r7
|
|
8009ede: bd80 pop {r7, pc}
|
|
|
|
08009ee0 <SUBGRF_SetWhiteningSeed>:
|
|
|
|
void SUBGRF_SetWhiteningSeed( uint16_t seed )
|
|
{
|
|
8009ee0: b580 push {r7, lr}
|
|
8009ee2: b084 sub sp, #16
|
|
8009ee4: af00 add r7, sp, #0
|
|
8009ee6: 4603 mov r3, r0
|
|
8009ee8: 80fb strh r3, [r7, #6]
|
|
uint8_t regValue = 0;
|
|
8009eea: 2300 movs r3, #0
|
|
8009eec: 73fb strb r3, [r7, #15]
|
|
|
|
switch( SUBGRF_GetPacketType( ) )
|
|
8009eee: f000 fb3d bl 800a56c <SUBGRF_GetPacketType>
|
|
8009ef2: 4603 mov r3, r0
|
|
8009ef4: 2b00 cmp r3, #0
|
|
8009ef6: d121 bne.n 8009f3c <SUBGRF_SetWhiteningSeed+0x5c>
|
|
{
|
|
case PACKET_TYPE_GFSK:
|
|
regValue = SUBGRF_ReadRegister( REG_LR_WHITSEEDBASEADDR_MSB ) & 0xFE;
|
|
8009ef8: f44f 60d7 mov.w r0, #1720 @ 0x6b8
|
|
8009efc: f000 fe44 bl 800ab88 <SUBGRF_ReadRegister>
|
|
8009f00: 4603 mov r3, r0
|
|
8009f02: f023 0301 bic.w r3, r3, #1
|
|
8009f06: 73fb strb r3, [r7, #15]
|
|
regValue = ( ( seed >> 8 ) & 0x01 ) | regValue;
|
|
8009f08: 88fb ldrh r3, [r7, #6]
|
|
8009f0a: 0a1b lsrs r3, r3, #8
|
|
8009f0c: b29b uxth r3, r3
|
|
8009f0e: b25b sxtb r3, r3
|
|
8009f10: f003 0301 and.w r3, r3, #1
|
|
8009f14: b25a sxtb r2, r3
|
|
8009f16: f997 300f ldrsb.w r3, [r7, #15]
|
|
8009f1a: 4313 orrs r3, r2
|
|
8009f1c: b25b sxtb r3, r3
|
|
8009f1e: 73fb strb r3, [r7, #15]
|
|
SUBGRF_WriteRegister( REG_LR_WHITSEEDBASEADDR_MSB, regValue ); // only 1 bit.
|
|
8009f20: 7bfb ldrb r3, [r7, #15]
|
|
8009f22: 4619 mov r1, r3
|
|
8009f24: f44f 60d7 mov.w r0, #1720 @ 0x6b8
|
|
8009f28: f000 fe0c bl 800ab44 <SUBGRF_WriteRegister>
|
|
SUBGRF_WriteRegister( REG_LR_WHITSEEDBASEADDR_LSB, (uint8_t)seed );
|
|
8009f2c: 88fb ldrh r3, [r7, #6]
|
|
8009f2e: b2db uxtb r3, r3
|
|
8009f30: 4619 mov r1, r3
|
|
8009f32: f240 60b9 movw r0, #1721 @ 0x6b9
|
|
8009f36: f000 fe05 bl 800ab44 <SUBGRF_WriteRegister>
|
|
break;
|
|
8009f3a: e000 b.n 8009f3e <SUBGRF_SetWhiteningSeed+0x5e>
|
|
|
|
default:
|
|
break;
|
|
8009f3c: bf00 nop
|
|
}
|
|
}
|
|
8009f3e: bf00 nop
|
|
8009f40: 3710 adds r7, #16
|
|
8009f42: 46bd mov sp, r7
|
|
8009f44: bd80 pop {r7, pc}
|
|
|
|
08009f46 <SUBGRF_GetRandom>:
|
|
|
|
uint32_t SUBGRF_GetRandom( void )
|
|
{
|
|
8009f46: b580 push {r7, lr}
|
|
8009f48: b082 sub sp, #8
|
|
8009f4a: af00 add r7, sp, #0
|
|
uint32_t number = 0;
|
|
8009f4c: 2300 movs r3, #0
|
|
8009f4e: 603b str r3, [r7, #0]
|
|
uint8_t regAnaLna = 0;
|
|
8009f50: 2300 movs r3, #0
|
|
8009f52: 71fb strb r3, [r7, #7]
|
|
uint8_t regAnaMixer = 0;
|
|
8009f54: 2300 movs r3, #0
|
|
8009f56: 71bb strb r3, [r7, #6]
|
|
|
|
regAnaLna = SUBGRF_ReadRegister( REG_ANA_LNA );
|
|
8009f58: f640 00e2 movw r0, #2274 @ 0x8e2
|
|
8009f5c: f000 fe14 bl 800ab88 <SUBGRF_ReadRegister>
|
|
8009f60: 4603 mov r3, r0
|
|
8009f62: 71fb strb r3, [r7, #7]
|
|
SUBGRF_WriteRegister( REG_ANA_LNA, regAnaLna & ~( 1 << 0 ) );
|
|
8009f64: 79fb ldrb r3, [r7, #7]
|
|
8009f66: f023 0301 bic.w r3, r3, #1
|
|
8009f6a: b2db uxtb r3, r3
|
|
8009f6c: 4619 mov r1, r3
|
|
8009f6e: f640 00e2 movw r0, #2274 @ 0x8e2
|
|
8009f72: f000 fde7 bl 800ab44 <SUBGRF_WriteRegister>
|
|
|
|
regAnaMixer = SUBGRF_ReadRegister( REG_ANA_MIXER );
|
|
8009f76: f640 00e5 movw r0, #2277 @ 0x8e5
|
|
8009f7a: f000 fe05 bl 800ab88 <SUBGRF_ReadRegister>
|
|
8009f7e: 4603 mov r3, r0
|
|
8009f80: 71bb strb r3, [r7, #6]
|
|
SUBGRF_WriteRegister( REG_ANA_MIXER, regAnaMixer & ~( 1 << 7 ) );
|
|
8009f82: 79bb ldrb r3, [r7, #6]
|
|
8009f84: f003 037f and.w r3, r3, #127 @ 0x7f
|
|
8009f88: b2db uxtb r3, r3
|
|
8009f8a: 4619 mov r1, r3
|
|
8009f8c: f640 00e5 movw r0, #2277 @ 0x8e5
|
|
8009f90: f000 fdd8 bl 800ab44 <SUBGRF_WriteRegister>
|
|
|
|
// Set radio in continuous reception
|
|
SUBGRF_SetRx( 0xFFFFFF ); // Rx Continuous
|
|
8009f94: f06f 407f mvn.w r0, #4278190080 @ 0xff000000
|
|
8009f98: f000 f88c bl 800a0b4 <SUBGRF_SetRx>
|
|
|
|
SUBGRF_ReadRegisters( RANDOM_NUMBER_GENERATORBASEADDR, ( uint8_t* )&number, 4 );
|
|
8009f9c: 463b mov r3, r7
|
|
8009f9e: 2204 movs r2, #4
|
|
8009fa0: 4619 mov r1, r3
|
|
8009fa2: f640 0019 movw r0, #2073 @ 0x819
|
|
8009fa6: f000 fe31 bl 800ac0c <SUBGRF_ReadRegisters>
|
|
|
|
SUBGRF_SetStandby( STDBY_RC );
|
|
8009faa: 2000 movs r0, #0
|
|
8009fac: f000 f846 bl 800a03c <SUBGRF_SetStandby>
|
|
|
|
SUBGRF_WriteRegister( REG_ANA_LNA, regAnaLna );
|
|
8009fb0: 79fb ldrb r3, [r7, #7]
|
|
8009fb2: 4619 mov r1, r3
|
|
8009fb4: f640 00e2 movw r0, #2274 @ 0x8e2
|
|
8009fb8: f000 fdc4 bl 800ab44 <SUBGRF_WriteRegister>
|
|
SUBGRF_WriteRegister( REG_ANA_MIXER, regAnaMixer );
|
|
8009fbc: 79bb ldrb r3, [r7, #6]
|
|
8009fbe: 4619 mov r1, r3
|
|
8009fc0: f640 00e5 movw r0, #2277 @ 0x8e5
|
|
8009fc4: f000 fdbe bl 800ab44 <SUBGRF_WriteRegister>
|
|
|
|
return number;
|
|
8009fc8: 683b ldr r3, [r7, #0]
|
|
}
|
|
8009fca: 4618 mov r0, r3
|
|
8009fcc: 3708 adds r7, #8
|
|
8009fce: 46bd mov sp, r7
|
|
8009fd0: bd80 pop {r7, pc}
|
|
...
|
|
|
|
08009fd4 <SUBGRF_SetSleep>:
|
|
|
|
void SUBGRF_SetSleep( SleepParams_t sleepConfig )
|
|
{
|
|
8009fd4: b580 push {r7, lr}
|
|
8009fd6: b084 sub sp, #16
|
|
8009fd8: af00 add r7, sp, #0
|
|
8009fda: 7138 strb r0, [r7, #4]
|
|
/* switch the antenna OFF by SW */
|
|
RBI_ConfigRFSwitch(RBI_SWITCH_OFF);
|
|
8009fdc: 2000 movs r0, #0
|
|
8009fde: f003 fc30 bl 800d842 <RBI_ConfigRFSwitch>
|
|
|
|
Radio_SMPS_Set(SMPS_DRIVE_SETTING_DEFAULT);
|
|
8009fe2: 2002 movs r0, #2
|
|
8009fe4: f000 ffc0 bl 800af68 <Radio_SMPS_Set>
|
|
|
|
uint8_t value = ( ( ( uint8_t )sleepConfig.Fields.WarmStart << 2 ) |
|
|
8009fe8: 793b ldrb r3, [r7, #4]
|
|
8009fea: f3c3 0380 ubfx r3, r3, #2, #1
|
|
8009fee: b2db uxtb r3, r3
|
|
8009ff0: b25b sxtb r3, r3
|
|
8009ff2: 009b lsls r3, r3, #2
|
|
8009ff4: b25a sxtb r2, r3
|
|
( ( uint8_t )sleepConfig.Fields.Reset << 1 ) |
|
|
8009ff6: 793b ldrb r3, [r7, #4]
|
|
8009ff8: f3c3 0340 ubfx r3, r3, #1, #1
|
|
8009ffc: b2db uxtb r3, r3
|
|
uint8_t value = ( ( ( uint8_t )sleepConfig.Fields.WarmStart << 2 ) |
|
|
8009ffe: b25b sxtb r3, r3
|
|
800a000: 005b lsls r3, r3, #1
|
|
800a002: b25b sxtb r3, r3
|
|
800a004: 4313 orrs r3, r2
|
|
800a006: b25a sxtb r2, r3
|
|
( ( uint8_t )sleepConfig.Fields.WakeUpRTC ) );
|
|
800a008: 793b ldrb r3, [r7, #4]
|
|
800a00a: f3c3 0300 ubfx r3, r3, #0, #1
|
|
800a00e: b2db uxtb r3, r3
|
|
800a010: b25b sxtb r3, r3
|
|
( ( uint8_t )sleepConfig.Fields.Reset << 1 ) |
|
|
800a012: 4313 orrs r3, r2
|
|
800a014: b25b sxtb r3, r3
|
|
800a016: b2db uxtb r3, r3
|
|
uint8_t value = ( ( ( uint8_t )sleepConfig.Fields.WarmStart << 2 ) |
|
|
800a018: 73fb strb r3, [r7, #15]
|
|
SUBGRF_WriteCommand( RADIO_SET_SLEEP, &value, 1 );
|
|
800a01a: f107 030f add.w r3, r7, #15
|
|
800a01e: 2201 movs r2, #1
|
|
800a020: 4619 mov r1, r3
|
|
800a022: 2084 movs r0, #132 @ 0x84
|
|
800a024: f000 fe58 bl 800acd8 <SUBGRF_WriteCommand>
|
|
OperatingMode = MODE_SLEEP;
|
|
800a028: 4b03 ldr r3, [pc, #12] @ (800a038 <SUBGRF_SetSleep+0x64>)
|
|
800a02a: 2200 movs r2, #0
|
|
800a02c: 701a strb r2, [r3, #0]
|
|
}
|
|
800a02e: bf00 nop
|
|
800a030: 3710 adds r7, #16
|
|
800a032: 46bd mov sp, r7
|
|
800a034: bd80 pop {r7, pc}
|
|
800a036: bf00 nop
|
|
800a038: 20000384 .word 0x20000384
|
|
|
|
0800a03c <SUBGRF_SetStandby>:
|
|
|
|
void SUBGRF_SetStandby( RadioStandbyModes_t standbyConfig )
|
|
{
|
|
800a03c: b580 push {r7, lr}
|
|
800a03e: b082 sub sp, #8
|
|
800a040: af00 add r7, sp, #0
|
|
800a042: 4603 mov r3, r0
|
|
800a044: 71fb strb r3, [r7, #7]
|
|
SUBGRF_WriteCommand( RADIO_SET_STANDBY, ( uint8_t* )&standbyConfig, 1 );
|
|
800a046: 1dfb adds r3, r7, #7
|
|
800a048: 2201 movs r2, #1
|
|
800a04a: 4619 mov r1, r3
|
|
800a04c: 2080 movs r0, #128 @ 0x80
|
|
800a04e: f000 fe43 bl 800acd8 <SUBGRF_WriteCommand>
|
|
if( standbyConfig == STDBY_RC )
|
|
800a052: 79fb ldrb r3, [r7, #7]
|
|
800a054: 2b00 cmp r3, #0
|
|
800a056: d103 bne.n 800a060 <SUBGRF_SetStandby+0x24>
|
|
{
|
|
OperatingMode = MODE_STDBY_RC;
|
|
800a058: 4b05 ldr r3, [pc, #20] @ (800a070 <SUBGRF_SetStandby+0x34>)
|
|
800a05a: 2201 movs r2, #1
|
|
800a05c: 701a strb r2, [r3, #0]
|
|
}
|
|
else
|
|
{
|
|
OperatingMode = MODE_STDBY_XOSC;
|
|
}
|
|
}
|
|
800a05e: e002 b.n 800a066 <SUBGRF_SetStandby+0x2a>
|
|
OperatingMode = MODE_STDBY_XOSC;
|
|
800a060: 4b03 ldr r3, [pc, #12] @ (800a070 <SUBGRF_SetStandby+0x34>)
|
|
800a062: 2202 movs r2, #2
|
|
800a064: 701a strb r2, [r3, #0]
|
|
}
|
|
800a066: bf00 nop
|
|
800a068: 3708 adds r7, #8
|
|
800a06a: 46bd mov sp, r7
|
|
800a06c: bd80 pop {r7, pc}
|
|
800a06e: bf00 nop
|
|
800a070: 20000384 .word 0x20000384
|
|
|
|
0800a074 <SUBGRF_SetTx>:
|
|
SUBGRF_WriteCommand( RADIO_SET_FS, 0, 0 );
|
|
OperatingMode = MODE_FS;
|
|
}
|
|
|
|
void SUBGRF_SetTx( uint32_t timeout )
|
|
{
|
|
800a074: b580 push {r7, lr}
|
|
800a076: b084 sub sp, #16
|
|
800a078: af00 add r7, sp, #0
|
|
800a07a: 6078 str r0, [r7, #4]
|
|
uint8_t buf[3];
|
|
|
|
OperatingMode = MODE_TX;
|
|
800a07c: 4b0c ldr r3, [pc, #48] @ (800a0b0 <SUBGRF_SetTx+0x3c>)
|
|
800a07e: 2204 movs r2, #4
|
|
800a080: 701a strb r2, [r3, #0]
|
|
|
|
buf[0] = ( uint8_t )( ( timeout >> 16 ) & 0xFF );
|
|
800a082: 687b ldr r3, [r7, #4]
|
|
800a084: 0c1b lsrs r3, r3, #16
|
|
800a086: b2db uxtb r3, r3
|
|
800a088: 733b strb r3, [r7, #12]
|
|
buf[1] = ( uint8_t )( ( timeout >> 8 ) & 0xFF );
|
|
800a08a: 687b ldr r3, [r7, #4]
|
|
800a08c: 0a1b lsrs r3, r3, #8
|
|
800a08e: b2db uxtb r3, r3
|
|
800a090: 737b strb r3, [r7, #13]
|
|
buf[2] = ( uint8_t )( timeout & 0xFF );
|
|
800a092: 687b ldr r3, [r7, #4]
|
|
800a094: b2db uxtb r3, r3
|
|
800a096: 73bb strb r3, [r7, #14]
|
|
SUBGRF_WriteCommand( RADIO_SET_TX, buf, 3 );
|
|
800a098: f107 030c add.w r3, r7, #12
|
|
800a09c: 2203 movs r2, #3
|
|
800a09e: 4619 mov r1, r3
|
|
800a0a0: 2083 movs r0, #131 @ 0x83
|
|
800a0a2: f000 fe19 bl 800acd8 <SUBGRF_WriteCommand>
|
|
}
|
|
800a0a6: bf00 nop
|
|
800a0a8: 3710 adds r7, #16
|
|
800a0aa: 46bd mov sp, r7
|
|
800a0ac: bd80 pop {r7, pc}
|
|
800a0ae: bf00 nop
|
|
800a0b0: 20000384 .word 0x20000384
|
|
|
|
0800a0b4 <SUBGRF_SetRx>:
|
|
|
|
void SUBGRF_SetRx( uint32_t timeout )
|
|
{
|
|
800a0b4: b580 push {r7, lr}
|
|
800a0b6: b084 sub sp, #16
|
|
800a0b8: af00 add r7, sp, #0
|
|
800a0ba: 6078 str r0, [r7, #4]
|
|
uint8_t buf[3];
|
|
|
|
OperatingMode = MODE_RX;
|
|
800a0bc: 4b0c ldr r3, [pc, #48] @ (800a0f0 <SUBGRF_SetRx+0x3c>)
|
|
800a0be: 2205 movs r2, #5
|
|
800a0c0: 701a strb r2, [r3, #0]
|
|
|
|
buf[0] = ( uint8_t )( ( timeout >> 16 ) & 0xFF );
|
|
800a0c2: 687b ldr r3, [r7, #4]
|
|
800a0c4: 0c1b lsrs r3, r3, #16
|
|
800a0c6: b2db uxtb r3, r3
|
|
800a0c8: 733b strb r3, [r7, #12]
|
|
buf[1] = ( uint8_t )( ( timeout >> 8 ) & 0xFF );
|
|
800a0ca: 687b ldr r3, [r7, #4]
|
|
800a0cc: 0a1b lsrs r3, r3, #8
|
|
800a0ce: b2db uxtb r3, r3
|
|
800a0d0: 737b strb r3, [r7, #13]
|
|
buf[2] = ( uint8_t )( timeout & 0xFF );
|
|
800a0d2: 687b ldr r3, [r7, #4]
|
|
800a0d4: b2db uxtb r3, r3
|
|
800a0d6: 73bb strb r3, [r7, #14]
|
|
SUBGRF_WriteCommand( RADIO_SET_RX, buf, 3 );
|
|
800a0d8: f107 030c add.w r3, r7, #12
|
|
800a0dc: 2203 movs r2, #3
|
|
800a0de: 4619 mov r1, r3
|
|
800a0e0: 2082 movs r0, #130 @ 0x82
|
|
800a0e2: f000 fdf9 bl 800acd8 <SUBGRF_WriteCommand>
|
|
}
|
|
800a0e6: bf00 nop
|
|
800a0e8: 3710 adds r7, #16
|
|
800a0ea: 46bd mov sp, r7
|
|
800a0ec: bd80 pop {r7, pc}
|
|
800a0ee: bf00 nop
|
|
800a0f0: 20000384 .word 0x20000384
|
|
|
|
0800a0f4 <SUBGRF_SetRxBoosted>:
|
|
|
|
void SUBGRF_SetRxBoosted( uint32_t timeout )
|
|
{
|
|
800a0f4: b580 push {r7, lr}
|
|
800a0f6: b084 sub sp, #16
|
|
800a0f8: af00 add r7, sp, #0
|
|
800a0fa: 6078 str r0, [r7, #4]
|
|
uint8_t buf[3];
|
|
|
|
OperatingMode = MODE_RX;
|
|
800a0fc: 4b0e ldr r3, [pc, #56] @ (800a138 <SUBGRF_SetRxBoosted+0x44>)
|
|
800a0fe: 2205 movs r2, #5
|
|
800a100: 701a strb r2, [r3, #0]
|
|
|
|
SUBGRF_WriteRegister( REG_RX_GAIN, 0x97 ); // max LNA gain, increase current by ~2mA for around ~3dB in sensitivity
|
|
800a102: 2197 movs r1, #151 @ 0x97
|
|
800a104: f640 00ac movw r0, #2220 @ 0x8ac
|
|
800a108: f000 fd1c bl 800ab44 <SUBGRF_WriteRegister>
|
|
|
|
buf[0] = ( uint8_t )( ( timeout >> 16 ) & 0xFF );
|
|
800a10c: 687b ldr r3, [r7, #4]
|
|
800a10e: 0c1b lsrs r3, r3, #16
|
|
800a110: b2db uxtb r3, r3
|
|
800a112: 733b strb r3, [r7, #12]
|
|
buf[1] = ( uint8_t )( ( timeout >> 8 ) & 0xFF );
|
|
800a114: 687b ldr r3, [r7, #4]
|
|
800a116: 0a1b lsrs r3, r3, #8
|
|
800a118: b2db uxtb r3, r3
|
|
800a11a: 737b strb r3, [r7, #13]
|
|
buf[2] = ( uint8_t )( timeout & 0xFF );
|
|
800a11c: 687b ldr r3, [r7, #4]
|
|
800a11e: b2db uxtb r3, r3
|
|
800a120: 73bb strb r3, [r7, #14]
|
|
SUBGRF_WriteCommand( RADIO_SET_RX, buf, 3 );
|
|
800a122: f107 030c add.w r3, r7, #12
|
|
800a126: 2203 movs r2, #3
|
|
800a128: 4619 mov r1, r3
|
|
800a12a: 2082 movs r0, #130 @ 0x82
|
|
800a12c: f000 fdd4 bl 800acd8 <SUBGRF_WriteCommand>
|
|
}
|
|
800a130: bf00 nop
|
|
800a132: 3710 adds r7, #16
|
|
800a134: 46bd mov sp, r7
|
|
800a136: bd80 pop {r7, pc}
|
|
800a138: 20000384 .word 0x20000384
|
|
|
|
0800a13c <SUBGRF_SetRxDutyCycle>:
|
|
|
|
void SUBGRF_SetRxDutyCycle( uint32_t rxTime, uint32_t sleepTime )
|
|
{
|
|
800a13c: b580 push {r7, lr}
|
|
800a13e: b084 sub sp, #16
|
|
800a140: af00 add r7, sp, #0
|
|
800a142: 6078 str r0, [r7, #4]
|
|
800a144: 6039 str r1, [r7, #0]
|
|
uint8_t buf[6];
|
|
|
|
buf[0] = ( uint8_t )( ( rxTime >> 16 ) & 0xFF );
|
|
800a146: 687b ldr r3, [r7, #4]
|
|
800a148: 0c1b lsrs r3, r3, #16
|
|
800a14a: b2db uxtb r3, r3
|
|
800a14c: 723b strb r3, [r7, #8]
|
|
buf[1] = ( uint8_t )( ( rxTime >> 8 ) & 0xFF );
|
|
800a14e: 687b ldr r3, [r7, #4]
|
|
800a150: 0a1b lsrs r3, r3, #8
|
|
800a152: b2db uxtb r3, r3
|
|
800a154: 727b strb r3, [r7, #9]
|
|
buf[2] = ( uint8_t )( rxTime & 0xFF );
|
|
800a156: 687b ldr r3, [r7, #4]
|
|
800a158: b2db uxtb r3, r3
|
|
800a15a: 72bb strb r3, [r7, #10]
|
|
buf[3] = ( uint8_t )( ( sleepTime >> 16 ) & 0xFF );
|
|
800a15c: 683b ldr r3, [r7, #0]
|
|
800a15e: 0c1b lsrs r3, r3, #16
|
|
800a160: b2db uxtb r3, r3
|
|
800a162: 72fb strb r3, [r7, #11]
|
|
buf[4] = ( uint8_t )( ( sleepTime >> 8 ) & 0xFF );
|
|
800a164: 683b ldr r3, [r7, #0]
|
|
800a166: 0a1b lsrs r3, r3, #8
|
|
800a168: b2db uxtb r3, r3
|
|
800a16a: 733b strb r3, [r7, #12]
|
|
buf[5] = ( uint8_t )( sleepTime & 0xFF );
|
|
800a16c: 683b ldr r3, [r7, #0]
|
|
800a16e: b2db uxtb r3, r3
|
|
800a170: 737b strb r3, [r7, #13]
|
|
SUBGRF_WriteCommand( RADIO_SET_RXDUTYCYCLE, buf, 6 );
|
|
800a172: f107 0308 add.w r3, r7, #8
|
|
800a176: 2206 movs r2, #6
|
|
800a178: 4619 mov r1, r3
|
|
800a17a: 2094 movs r0, #148 @ 0x94
|
|
800a17c: f000 fdac bl 800acd8 <SUBGRF_WriteCommand>
|
|
OperatingMode = MODE_RX_DC;
|
|
800a180: 4b03 ldr r3, [pc, #12] @ (800a190 <SUBGRF_SetRxDutyCycle+0x54>)
|
|
800a182: 2206 movs r2, #6
|
|
800a184: 701a strb r2, [r3, #0]
|
|
}
|
|
800a186: bf00 nop
|
|
800a188: 3710 adds r7, #16
|
|
800a18a: 46bd mov sp, r7
|
|
800a18c: bd80 pop {r7, pc}
|
|
800a18e: bf00 nop
|
|
800a190: 20000384 .word 0x20000384
|
|
|
|
0800a194 <SUBGRF_SetCad>:
|
|
|
|
void SUBGRF_SetCad( void )
|
|
{
|
|
800a194: b580 push {r7, lr}
|
|
800a196: af00 add r7, sp, #0
|
|
SUBGRF_WriteCommand( RADIO_SET_CAD, 0, 0 );
|
|
800a198: 2200 movs r2, #0
|
|
800a19a: 2100 movs r1, #0
|
|
800a19c: 20c5 movs r0, #197 @ 0xc5
|
|
800a19e: f000 fd9b bl 800acd8 <SUBGRF_WriteCommand>
|
|
OperatingMode = MODE_CAD;
|
|
800a1a2: 4b02 ldr r3, [pc, #8] @ (800a1ac <SUBGRF_SetCad+0x18>)
|
|
800a1a4: 2207 movs r2, #7
|
|
800a1a6: 701a strb r2, [r3, #0]
|
|
}
|
|
800a1a8: bf00 nop
|
|
800a1aa: bd80 pop {r7, pc}
|
|
800a1ac: 20000384 .word 0x20000384
|
|
|
|
0800a1b0 <SUBGRF_SetTxContinuousWave>:
|
|
|
|
void SUBGRF_SetTxContinuousWave( void )
|
|
{
|
|
800a1b0: b580 push {r7, lr}
|
|
800a1b2: af00 add r7, sp, #0
|
|
SUBGRF_WriteCommand( RADIO_SET_TXCONTINUOUSWAVE, 0, 0 );
|
|
800a1b4: 2200 movs r2, #0
|
|
800a1b6: 2100 movs r1, #0
|
|
800a1b8: 20d1 movs r0, #209 @ 0xd1
|
|
800a1ba: f000 fd8d bl 800acd8 <SUBGRF_WriteCommand>
|
|
}
|
|
800a1be: bf00 nop
|
|
800a1c0: bd80 pop {r7, pc}
|
|
|
|
0800a1c2 <SUBGRF_SetTxInfinitePreamble>:
|
|
|
|
void SUBGRF_SetTxInfinitePreamble( void )
|
|
{
|
|
800a1c2: b580 push {r7, lr}
|
|
800a1c4: af00 add r7, sp, #0
|
|
SUBGRF_WriteCommand( RADIO_SET_TXCONTINUOUSPREAMBLE, 0, 0 );
|
|
800a1c6: 2200 movs r2, #0
|
|
800a1c8: 2100 movs r1, #0
|
|
800a1ca: 20d2 movs r0, #210 @ 0xd2
|
|
800a1cc: f000 fd84 bl 800acd8 <SUBGRF_WriteCommand>
|
|
}
|
|
800a1d0: bf00 nop
|
|
800a1d2: bd80 pop {r7, pc}
|
|
|
|
0800a1d4 <SUBGRF_SetStopRxTimerOnPreambleDetect>:
|
|
|
|
void SUBGRF_SetStopRxTimerOnPreambleDetect( bool enable )
|
|
{
|
|
800a1d4: b580 push {r7, lr}
|
|
800a1d6: b082 sub sp, #8
|
|
800a1d8: af00 add r7, sp, #0
|
|
800a1da: 4603 mov r3, r0
|
|
800a1dc: 71fb strb r3, [r7, #7]
|
|
SUBGRF_WriteCommand( RADIO_SET_STOPRXTIMERONPREAMBLE, ( uint8_t* )&enable, 1 );
|
|
800a1de: 1dfb adds r3, r7, #7
|
|
800a1e0: 2201 movs r2, #1
|
|
800a1e2: 4619 mov r1, r3
|
|
800a1e4: 209f movs r0, #159 @ 0x9f
|
|
800a1e6: f000 fd77 bl 800acd8 <SUBGRF_WriteCommand>
|
|
}
|
|
800a1ea: bf00 nop
|
|
800a1ec: 3708 adds r7, #8
|
|
800a1ee: 46bd mov sp, r7
|
|
800a1f0: bd80 pop {r7, pc}
|
|
|
|
0800a1f2 <SUBGRF_SetLoRaSymbNumTimeout>:
|
|
|
|
void SUBGRF_SetLoRaSymbNumTimeout( uint8_t symbNum )
|
|
{
|
|
800a1f2: b580 push {r7, lr}
|
|
800a1f4: b084 sub sp, #16
|
|
800a1f6: af00 add r7, sp, #0
|
|
800a1f8: 4603 mov r3, r0
|
|
800a1fa: 71fb strb r3, [r7, #7]
|
|
SUBGRF_WriteCommand( RADIO_SET_LORASYMBTIMEOUT, &symbNum, 1 );
|
|
800a1fc: 1dfb adds r3, r7, #7
|
|
800a1fe: 2201 movs r2, #1
|
|
800a200: 4619 mov r1, r3
|
|
800a202: 20a0 movs r0, #160 @ 0xa0
|
|
800a204: f000 fd68 bl 800acd8 <SUBGRF_WriteCommand>
|
|
|
|
if( symbNum >= 64 )
|
|
800a208: 79fb ldrb r3, [r7, #7]
|
|
800a20a: 2b3f cmp r3, #63 @ 0x3f
|
|
800a20c: d91c bls.n 800a248 <SUBGRF_SetLoRaSymbNumTimeout+0x56>
|
|
{
|
|
uint8_t mant = symbNum >> 1;
|
|
800a20e: 79fb ldrb r3, [r7, #7]
|
|
800a210: 085b lsrs r3, r3, #1
|
|
800a212: 73fb strb r3, [r7, #15]
|
|
uint8_t exp = 0;
|
|
800a214: 2300 movs r3, #0
|
|
800a216: 73bb strb r3, [r7, #14]
|
|
uint8_t reg = 0;
|
|
800a218: 2300 movs r3, #0
|
|
800a21a: 737b strb r3, [r7, #13]
|
|
|
|
while( mant > 31 )
|
|
800a21c: e005 b.n 800a22a <SUBGRF_SetLoRaSymbNumTimeout+0x38>
|
|
{
|
|
mant >>= 2;
|
|
800a21e: 7bfb ldrb r3, [r7, #15]
|
|
800a220: 089b lsrs r3, r3, #2
|
|
800a222: 73fb strb r3, [r7, #15]
|
|
exp++;
|
|
800a224: 7bbb ldrb r3, [r7, #14]
|
|
800a226: 3301 adds r3, #1
|
|
800a228: 73bb strb r3, [r7, #14]
|
|
while( mant > 31 )
|
|
800a22a: 7bfb ldrb r3, [r7, #15]
|
|
800a22c: 2b1f cmp r3, #31
|
|
800a22e: d8f6 bhi.n 800a21e <SUBGRF_SetLoRaSymbNumTimeout+0x2c>
|
|
}
|
|
|
|
reg = exp + ( mant << 3 );
|
|
800a230: 7bfb ldrb r3, [r7, #15]
|
|
800a232: 00db lsls r3, r3, #3
|
|
800a234: b2da uxtb r2, r3
|
|
800a236: 7bbb ldrb r3, [r7, #14]
|
|
800a238: 4413 add r3, r2
|
|
800a23a: 737b strb r3, [r7, #13]
|
|
SUBGRF_WriteRegister( REG_LR_SYNCH_TIMEOUT, reg );
|
|
800a23c: 7b7b ldrb r3, [r7, #13]
|
|
800a23e: 4619 mov r1, r3
|
|
800a240: f240 7006 movw r0, #1798 @ 0x706
|
|
800a244: f000 fc7e bl 800ab44 <SUBGRF_WriteRegister>
|
|
}
|
|
}
|
|
800a248: bf00 nop
|
|
800a24a: 3710 adds r7, #16
|
|
800a24c: 46bd mov sp, r7
|
|
800a24e: bd80 pop {r7, pc}
|
|
|
|
0800a250 <SUBGRF_SetRegulatorMode>:
|
|
|
|
void SUBGRF_SetRegulatorMode( void )
|
|
{
|
|
800a250: b580 push {r7, lr}
|
|
800a252: b082 sub sp, #8
|
|
800a254: af00 add r7, sp, #0
|
|
RadioRegulatorMode_t mode;
|
|
|
|
if ( ( 1UL == RBI_IsDCDC() ) && ( 1UL == DCDC_ENABLE ) )
|
|
800a256: f003 fb10 bl 800d87a <RBI_IsDCDC>
|
|
800a25a: 4603 mov r3, r0
|
|
800a25c: 2b01 cmp r3, #1
|
|
800a25e: d102 bne.n 800a266 <SUBGRF_SetRegulatorMode+0x16>
|
|
{
|
|
mode = USE_DCDC ;
|
|
800a260: 2301 movs r3, #1
|
|
800a262: 71fb strb r3, [r7, #7]
|
|
800a264: e001 b.n 800a26a <SUBGRF_SetRegulatorMode+0x1a>
|
|
}
|
|
else
|
|
{
|
|
mode = USE_LDO ;
|
|
800a266: 2300 movs r3, #0
|
|
800a268: 71fb strb r3, [r7, #7]
|
|
}
|
|
SUBGRF_WriteCommand( RADIO_SET_REGULATORMODE, ( uint8_t* )&mode, 1 );
|
|
800a26a: 1dfb adds r3, r7, #7
|
|
800a26c: 2201 movs r2, #1
|
|
800a26e: 4619 mov r1, r3
|
|
800a270: 2096 movs r0, #150 @ 0x96
|
|
800a272: f000 fd31 bl 800acd8 <SUBGRF_WriteCommand>
|
|
}
|
|
800a276: bf00 nop
|
|
800a278: 3708 adds r7, #8
|
|
800a27a: 46bd mov sp, r7
|
|
800a27c: bd80 pop {r7, pc}
|
|
|
|
0800a27e <SUBGRF_Calibrate>:
|
|
|
|
void SUBGRF_Calibrate( CalibrationParams_t calibParam )
|
|
{
|
|
800a27e: b580 push {r7, lr}
|
|
800a280: b084 sub sp, #16
|
|
800a282: af00 add r7, sp, #0
|
|
800a284: 7138 strb r0, [r7, #4]
|
|
uint8_t value = ( ( ( uint8_t )calibParam.Fields.ImgEnable << 6 ) |
|
|
800a286: 793b ldrb r3, [r7, #4]
|
|
800a288: f3c3 1380 ubfx r3, r3, #6, #1
|
|
800a28c: b2db uxtb r3, r3
|
|
800a28e: b25b sxtb r3, r3
|
|
800a290: 019b lsls r3, r3, #6
|
|
800a292: b25a sxtb r2, r3
|
|
( ( uint8_t )calibParam.Fields.ADCBulkPEnable << 5 ) |
|
|
800a294: 793b ldrb r3, [r7, #4]
|
|
800a296: f3c3 1340 ubfx r3, r3, #5, #1
|
|
800a29a: b2db uxtb r3, r3
|
|
uint8_t value = ( ( ( uint8_t )calibParam.Fields.ImgEnable << 6 ) |
|
|
800a29c: b25b sxtb r3, r3
|
|
800a29e: 015b lsls r3, r3, #5
|
|
800a2a0: b25b sxtb r3, r3
|
|
800a2a2: 4313 orrs r3, r2
|
|
800a2a4: b25a sxtb r2, r3
|
|
( ( uint8_t )calibParam.Fields.ADCBulkNEnable << 4 ) |
|
|
800a2a6: 793b ldrb r3, [r7, #4]
|
|
800a2a8: f3c3 1300 ubfx r3, r3, #4, #1
|
|
800a2ac: b2db uxtb r3, r3
|
|
( ( uint8_t )calibParam.Fields.ADCBulkPEnable << 5 ) |
|
|
800a2ae: b25b sxtb r3, r3
|
|
800a2b0: 011b lsls r3, r3, #4
|
|
800a2b2: b25b sxtb r3, r3
|
|
800a2b4: 4313 orrs r3, r2
|
|
800a2b6: b25a sxtb r2, r3
|
|
( ( uint8_t )calibParam.Fields.ADCPulseEnable << 3 ) |
|
|
800a2b8: 793b ldrb r3, [r7, #4]
|
|
800a2ba: f3c3 03c0 ubfx r3, r3, #3, #1
|
|
800a2be: b2db uxtb r3, r3
|
|
( ( uint8_t )calibParam.Fields.ADCBulkNEnable << 4 ) |
|
|
800a2c0: b25b sxtb r3, r3
|
|
800a2c2: 00db lsls r3, r3, #3
|
|
800a2c4: b25b sxtb r3, r3
|
|
800a2c6: 4313 orrs r3, r2
|
|
800a2c8: b25a sxtb r2, r3
|
|
( ( uint8_t )calibParam.Fields.PLLEnable << 2 ) |
|
|
800a2ca: 793b ldrb r3, [r7, #4]
|
|
800a2cc: f3c3 0380 ubfx r3, r3, #2, #1
|
|
800a2d0: b2db uxtb r3, r3
|
|
( ( uint8_t )calibParam.Fields.ADCPulseEnable << 3 ) |
|
|
800a2d2: b25b sxtb r3, r3
|
|
800a2d4: 009b lsls r3, r3, #2
|
|
800a2d6: b25b sxtb r3, r3
|
|
800a2d8: 4313 orrs r3, r2
|
|
800a2da: b25a sxtb r2, r3
|
|
( ( uint8_t )calibParam.Fields.RC13MEnable << 1 ) |
|
|
800a2dc: 793b ldrb r3, [r7, #4]
|
|
800a2de: f3c3 0340 ubfx r3, r3, #1, #1
|
|
800a2e2: b2db uxtb r3, r3
|
|
( ( uint8_t )calibParam.Fields.PLLEnable << 2 ) |
|
|
800a2e4: b25b sxtb r3, r3
|
|
800a2e6: 005b lsls r3, r3, #1
|
|
800a2e8: b25b sxtb r3, r3
|
|
800a2ea: 4313 orrs r3, r2
|
|
800a2ec: b25a sxtb r2, r3
|
|
( ( uint8_t )calibParam.Fields.RC64KEnable ) );
|
|
800a2ee: 793b ldrb r3, [r7, #4]
|
|
800a2f0: f3c3 0300 ubfx r3, r3, #0, #1
|
|
800a2f4: b2db uxtb r3, r3
|
|
800a2f6: b25b sxtb r3, r3
|
|
( ( uint8_t )calibParam.Fields.RC13MEnable << 1 ) |
|
|
800a2f8: 4313 orrs r3, r2
|
|
800a2fa: b25b sxtb r3, r3
|
|
800a2fc: b2db uxtb r3, r3
|
|
uint8_t value = ( ( ( uint8_t )calibParam.Fields.ImgEnable << 6 ) |
|
|
800a2fe: 73fb strb r3, [r7, #15]
|
|
|
|
SUBGRF_WriteCommand( RADIO_CALIBRATE, &value, 1 );
|
|
800a300: f107 030f add.w r3, r7, #15
|
|
800a304: 2201 movs r2, #1
|
|
800a306: 4619 mov r1, r3
|
|
800a308: 2089 movs r0, #137 @ 0x89
|
|
800a30a: f000 fce5 bl 800acd8 <SUBGRF_WriteCommand>
|
|
}
|
|
800a30e: bf00 nop
|
|
800a310: 3710 adds r7, #16
|
|
800a312: 46bd mov sp, r7
|
|
800a314: bd80 pop {r7, pc}
|
|
...
|
|
|
|
0800a318 <SUBGRF_CalibrateImage>:
|
|
|
|
void SUBGRF_CalibrateImage( uint32_t freq )
|
|
{
|
|
800a318: b580 push {r7, lr}
|
|
800a31a: b084 sub sp, #16
|
|
800a31c: af00 add r7, sp, #0
|
|
800a31e: 6078 str r0, [r7, #4]
|
|
uint8_t calFreq[2];
|
|
|
|
if( freq > 900000000 )
|
|
800a320: 687b ldr r3, [r7, #4]
|
|
800a322: 4a1d ldr r2, [pc, #116] @ (800a398 <SUBGRF_CalibrateImage+0x80>)
|
|
800a324: 4293 cmp r3, r2
|
|
800a326: d904 bls.n 800a332 <SUBGRF_CalibrateImage+0x1a>
|
|
{
|
|
calFreq[0] = 0xE1;
|
|
800a328: 23e1 movs r3, #225 @ 0xe1
|
|
800a32a: 733b strb r3, [r7, #12]
|
|
calFreq[1] = 0xE9;
|
|
800a32c: 23e9 movs r3, #233 @ 0xe9
|
|
800a32e: 737b strb r3, [r7, #13]
|
|
800a330: e027 b.n 800a382 <SUBGRF_CalibrateImage+0x6a>
|
|
}
|
|
else if( freq > 850000000 )
|
|
800a332: 687b ldr r3, [r7, #4]
|
|
800a334: 4a19 ldr r2, [pc, #100] @ (800a39c <SUBGRF_CalibrateImage+0x84>)
|
|
800a336: 4293 cmp r3, r2
|
|
800a338: d904 bls.n 800a344 <SUBGRF_CalibrateImage+0x2c>
|
|
{
|
|
calFreq[0] = 0xD7;
|
|
800a33a: 23d7 movs r3, #215 @ 0xd7
|
|
800a33c: 733b strb r3, [r7, #12]
|
|
calFreq[1] = 0xDB;
|
|
800a33e: 23db movs r3, #219 @ 0xdb
|
|
800a340: 737b strb r3, [r7, #13]
|
|
800a342: e01e b.n 800a382 <SUBGRF_CalibrateImage+0x6a>
|
|
}
|
|
else if( freq > 770000000 )
|
|
800a344: 687b ldr r3, [r7, #4]
|
|
800a346: 4a16 ldr r2, [pc, #88] @ (800a3a0 <SUBGRF_CalibrateImage+0x88>)
|
|
800a348: 4293 cmp r3, r2
|
|
800a34a: d904 bls.n 800a356 <SUBGRF_CalibrateImage+0x3e>
|
|
{
|
|
calFreq[0] = 0xC1;
|
|
800a34c: 23c1 movs r3, #193 @ 0xc1
|
|
800a34e: 733b strb r3, [r7, #12]
|
|
calFreq[1] = 0xC5;
|
|
800a350: 23c5 movs r3, #197 @ 0xc5
|
|
800a352: 737b strb r3, [r7, #13]
|
|
800a354: e015 b.n 800a382 <SUBGRF_CalibrateImage+0x6a>
|
|
}
|
|
else if( freq > 460000000 )
|
|
800a356: 687b ldr r3, [r7, #4]
|
|
800a358: 4a12 ldr r2, [pc, #72] @ (800a3a4 <SUBGRF_CalibrateImage+0x8c>)
|
|
800a35a: 4293 cmp r3, r2
|
|
800a35c: d904 bls.n 800a368 <SUBGRF_CalibrateImage+0x50>
|
|
{
|
|
calFreq[0] = 0x75;
|
|
800a35e: 2375 movs r3, #117 @ 0x75
|
|
800a360: 733b strb r3, [r7, #12]
|
|
calFreq[1] = 0x81;
|
|
800a362: 2381 movs r3, #129 @ 0x81
|
|
800a364: 737b strb r3, [r7, #13]
|
|
800a366: e00c b.n 800a382 <SUBGRF_CalibrateImage+0x6a>
|
|
}
|
|
else if( freq > 425000000 )
|
|
800a368: 687b ldr r3, [r7, #4]
|
|
800a36a: 4a0f ldr r2, [pc, #60] @ (800a3a8 <SUBGRF_CalibrateImage+0x90>)
|
|
800a36c: 4293 cmp r3, r2
|
|
800a36e: d904 bls.n 800a37a <SUBGRF_CalibrateImage+0x62>
|
|
{
|
|
calFreq[0] = 0x6B;
|
|
800a370: 236b movs r3, #107 @ 0x6b
|
|
800a372: 733b strb r3, [r7, #12]
|
|
calFreq[1] = 0x6F;
|
|
800a374: 236f movs r3, #111 @ 0x6f
|
|
800a376: 737b strb r3, [r7, #13]
|
|
800a378: e003 b.n 800a382 <SUBGRF_CalibrateImage+0x6a>
|
|
}
|
|
else /* freq <= 425000000*/
|
|
{
|
|
/* [ 156MHz - 171MHz ] */
|
|
calFreq[0] = 0x29;
|
|
800a37a: 2329 movs r3, #41 @ 0x29
|
|
800a37c: 733b strb r3, [r7, #12]
|
|
calFreq[1] = 0x2B ;
|
|
800a37e: 232b movs r3, #43 @ 0x2b
|
|
800a380: 737b strb r3, [r7, #13]
|
|
}
|
|
SUBGRF_WriteCommand( RADIO_CALIBRATEIMAGE, calFreq, 2 );
|
|
800a382: f107 030c add.w r3, r7, #12
|
|
800a386: 2202 movs r2, #2
|
|
800a388: 4619 mov r1, r3
|
|
800a38a: 2098 movs r0, #152 @ 0x98
|
|
800a38c: f000 fca4 bl 800acd8 <SUBGRF_WriteCommand>
|
|
}
|
|
800a390: bf00 nop
|
|
800a392: 3710 adds r7, #16
|
|
800a394: 46bd mov sp, r7
|
|
800a396: bd80 pop {r7, pc}
|
|
800a398: 35a4e900 .word 0x35a4e900
|
|
800a39c: 32a9f880 .word 0x32a9f880
|
|
800a3a0: 2de54480 .word 0x2de54480
|
|
800a3a4: 1b6b0b00 .word 0x1b6b0b00
|
|
800a3a8: 1954fc40 .word 0x1954fc40
|
|
|
|
0800a3ac <SUBGRF_SetPaConfig>:
|
|
|
|
void SUBGRF_SetPaConfig( uint8_t paDutyCycle, uint8_t hpMax, uint8_t deviceSel, uint8_t paLut )
|
|
{
|
|
800a3ac: b590 push {r4, r7, lr}
|
|
800a3ae: b085 sub sp, #20
|
|
800a3b0: af00 add r7, sp, #0
|
|
800a3b2: 4604 mov r4, r0
|
|
800a3b4: 4608 mov r0, r1
|
|
800a3b6: 4611 mov r1, r2
|
|
800a3b8: 461a mov r2, r3
|
|
800a3ba: 4623 mov r3, r4
|
|
800a3bc: 71fb strb r3, [r7, #7]
|
|
800a3be: 4603 mov r3, r0
|
|
800a3c0: 71bb strb r3, [r7, #6]
|
|
800a3c2: 460b mov r3, r1
|
|
800a3c4: 717b strb r3, [r7, #5]
|
|
800a3c6: 4613 mov r3, r2
|
|
800a3c8: 713b strb r3, [r7, #4]
|
|
uint8_t buf[4];
|
|
|
|
buf[0] = paDutyCycle;
|
|
800a3ca: 79fb ldrb r3, [r7, #7]
|
|
800a3cc: 733b strb r3, [r7, #12]
|
|
buf[1] = hpMax;
|
|
800a3ce: 79bb ldrb r3, [r7, #6]
|
|
800a3d0: 737b strb r3, [r7, #13]
|
|
buf[2] = deviceSel;
|
|
800a3d2: 797b ldrb r3, [r7, #5]
|
|
800a3d4: 73bb strb r3, [r7, #14]
|
|
buf[3] = paLut;
|
|
800a3d6: 793b ldrb r3, [r7, #4]
|
|
800a3d8: 73fb strb r3, [r7, #15]
|
|
SUBGRF_WriteCommand( RADIO_SET_PACONFIG, buf, 4 );
|
|
800a3da: f107 030c add.w r3, r7, #12
|
|
800a3de: 2204 movs r2, #4
|
|
800a3e0: 4619 mov r1, r3
|
|
800a3e2: 2095 movs r0, #149 @ 0x95
|
|
800a3e4: f000 fc78 bl 800acd8 <SUBGRF_WriteCommand>
|
|
}
|
|
800a3e8: bf00 nop
|
|
800a3ea: 3714 adds r7, #20
|
|
800a3ec: 46bd mov sp, r7
|
|
800a3ee: bd90 pop {r4, r7, pc}
|
|
|
|
0800a3f0 <SUBGRF_SetDioIrqParams>:
|
|
{
|
|
SUBGRF_WriteCommand( RADIO_SET_TXFALLBACKMODE, &fallbackMode, 1 );
|
|
}
|
|
|
|
void SUBGRF_SetDioIrqParams( uint16_t irqMask, uint16_t dio1Mask, uint16_t dio2Mask, uint16_t dio3Mask )
|
|
{
|
|
800a3f0: b590 push {r4, r7, lr}
|
|
800a3f2: b085 sub sp, #20
|
|
800a3f4: af00 add r7, sp, #0
|
|
800a3f6: 4604 mov r4, r0
|
|
800a3f8: 4608 mov r0, r1
|
|
800a3fa: 4611 mov r1, r2
|
|
800a3fc: 461a mov r2, r3
|
|
800a3fe: 4623 mov r3, r4
|
|
800a400: 80fb strh r3, [r7, #6]
|
|
800a402: 4603 mov r3, r0
|
|
800a404: 80bb strh r3, [r7, #4]
|
|
800a406: 460b mov r3, r1
|
|
800a408: 807b strh r3, [r7, #2]
|
|
800a40a: 4613 mov r3, r2
|
|
800a40c: 803b strh r3, [r7, #0]
|
|
uint8_t buf[8];
|
|
|
|
buf[0] = ( uint8_t )( ( irqMask >> 8 ) & 0x00FF );
|
|
800a40e: 88fb ldrh r3, [r7, #6]
|
|
800a410: 0a1b lsrs r3, r3, #8
|
|
800a412: b29b uxth r3, r3
|
|
800a414: b2db uxtb r3, r3
|
|
800a416: 723b strb r3, [r7, #8]
|
|
buf[1] = ( uint8_t )( irqMask & 0x00FF );
|
|
800a418: 88fb ldrh r3, [r7, #6]
|
|
800a41a: b2db uxtb r3, r3
|
|
800a41c: 727b strb r3, [r7, #9]
|
|
buf[2] = ( uint8_t )( ( dio1Mask >> 8 ) & 0x00FF );
|
|
800a41e: 88bb ldrh r3, [r7, #4]
|
|
800a420: 0a1b lsrs r3, r3, #8
|
|
800a422: b29b uxth r3, r3
|
|
800a424: b2db uxtb r3, r3
|
|
800a426: 72bb strb r3, [r7, #10]
|
|
buf[3] = ( uint8_t )( dio1Mask & 0x00FF );
|
|
800a428: 88bb ldrh r3, [r7, #4]
|
|
800a42a: b2db uxtb r3, r3
|
|
800a42c: 72fb strb r3, [r7, #11]
|
|
buf[4] = ( uint8_t )( ( dio2Mask >> 8 ) & 0x00FF );
|
|
800a42e: 887b ldrh r3, [r7, #2]
|
|
800a430: 0a1b lsrs r3, r3, #8
|
|
800a432: b29b uxth r3, r3
|
|
800a434: b2db uxtb r3, r3
|
|
800a436: 733b strb r3, [r7, #12]
|
|
buf[5] = ( uint8_t )( dio2Mask & 0x00FF );
|
|
800a438: 887b ldrh r3, [r7, #2]
|
|
800a43a: b2db uxtb r3, r3
|
|
800a43c: 737b strb r3, [r7, #13]
|
|
buf[6] = ( uint8_t )( ( dio3Mask >> 8 ) & 0x00FF );
|
|
800a43e: 883b ldrh r3, [r7, #0]
|
|
800a440: 0a1b lsrs r3, r3, #8
|
|
800a442: b29b uxth r3, r3
|
|
800a444: b2db uxtb r3, r3
|
|
800a446: 73bb strb r3, [r7, #14]
|
|
buf[7] = ( uint8_t )( dio3Mask & 0x00FF );
|
|
800a448: 883b ldrh r3, [r7, #0]
|
|
800a44a: b2db uxtb r3, r3
|
|
800a44c: 73fb strb r3, [r7, #15]
|
|
SUBGRF_WriteCommand( RADIO_CFG_DIOIRQ, buf, 8 );
|
|
800a44e: f107 0308 add.w r3, r7, #8
|
|
800a452: 2208 movs r2, #8
|
|
800a454: 4619 mov r1, r3
|
|
800a456: 2008 movs r0, #8
|
|
800a458: f000 fc3e bl 800acd8 <SUBGRF_WriteCommand>
|
|
}
|
|
800a45c: bf00 nop
|
|
800a45e: 3714 adds r7, #20
|
|
800a460: 46bd mov sp, r7
|
|
800a462: bd90 pop {r4, r7, pc}
|
|
|
|
0800a464 <SUBGRF_SetTcxoMode>:
|
|
SUBGRF_ReadCommand( RADIO_GET_IRQSTATUS, irqStatus, 2 );
|
|
return ( irqStatus[0] << 8 ) | irqStatus[1];
|
|
}
|
|
|
|
void SUBGRF_SetTcxoMode (RadioTcxoCtrlVoltage_t tcxoVoltage, uint32_t timeout )
|
|
{
|
|
800a464: b580 push {r7, lr}
|
|
800a466: b084 sub sp, #16
|
|
800a468: af00 add r7, sp, #0
|
|
800a46a: 4603 mov r3, r0
|
|
800a46c: 6039 str r1, [r7, #0]
|
|
800a46e: 71fb strb r3, [r7, #7]
|
|
uint8_t buf[4];
|
|
|
|
buf[0] = tcxoVoltage & 0x07;
|
|
800a470: 79fb ldrb r3, [r7, #7]
|
|
800a472: f003 0307 and.w r3, r3, #7
|
|
800a476: b2db uxtb r3, r3
|
|
800a478: 733b strb r3, [r7, #12]
|
|
buf[1] = ( uint8_t )( ( timeout >> 16 ) & 0xFF );
|
|
800a47a: 683b ldr r3, [r7, #0]
|
|
800a47c: 0c1b lsrs r3, r3, #16
|
|
800a47e: b2db uxtb r3, r3
|
|
800a480: 737b strb r3, [r7, #13]
|
|
buf[2] = ( uint8_t )( ( timeout >> 8 ) & 0xFF );
|
|
800a482: 683b ldr r3, [r7, #0]
|
|
800a484: 0a1b lsrs r3, r3, #8
|
|
800a486: b2db uxtb r3, r3
|
|
800a488: 73bb strb r3, [r7, #14]
|
|
buf[3] = ( uint8_t )( timeout & 0xFF );
|
|
800a48a: 683b ldr r3, [r7, #0]
|
|
800a48c: b2db uxtb r3, r3
|
|
800a48e: 73fb strb r3, [r7, #15]
|
|
|
|
SUBGRF_WriteCommand( RADIO_SET_TCXOMODE, buf, 4 );
|
|
800a490: f107 030c add.w r3, r7, #12
|
|
800a494: 2204 movs r2, #4
|
|
800a496: 4619 mov r1, r3
|
|
800a498: 2097 movs r0, #151 @ 0x97
|
|
800a49a: f000 fc1d bl 800acd8 <SUBGRF_WriteCommand>
|
|
}
|
|
800a49e: bf00 nop
|
|
800a4a0: 3710 adds r7, #16
|
|
800a4a2: 46bd mov sp, r7
|
|
800a4a4: bd80 pop {r7, pc}
|
|
...
|
|
|
|
0800a4a8 <SUBGRF_SetRfFrequency>:
|
|
|
|
void SUBGRF_SetRfFrequency( uint32_t frequency )
|
|
{
|
|
800a4a8: e92d 43b0 stmdb sp!, {r4, r5, r7, r8, r9, lr}
|
|
800a4ac: b084 sub sp, #16
|
|
800a4ae: af00 add r7, sp, #0
|
|
800a4b0: 6078 str r0, [r7, #4]
|
|
uint8_t buf[4];
|
|
uint32_t chan = 0;
|
|
800a4b2: 2300 movs r3, #0
|
|
800a4b4: 60fb str r3, [r7, #12]
|
|
|
|
if( ImageCalibrated == false )
|
|
800a4b6: 4b1d ldr r3, [pc, #116] @ (800a52c <SUBGRF_SetRfFrequency+0x84>)
|
|
800a4b8: 781b ldrb r3, [r3, #0]
|
|
800a4ba: f083 0301 eor.w r3, r3, #1
|
|
800a4be: b2db uxtb r3, r3
|
|
800a4c0: 2b00 cmp r3, #0
|
|
800a4c2: d005 beq.n 800a4d0 <SUBGRF_SetRfFrequency+0x28>
|
|
{
|
|
SUBGRF_CalibrateImage( frequency );
|
|
800a4c4: 6878 ldr r0, [r7, #4]
|
|
800a4c6: f7ff ff27 bl 800a318 <SUBGRF_CalibrateImage>
|
|
ImageCalibrated = true;
|
|
800a4ca: 4b18 ldr r3, [pc, #96] @ (800a52c <SUBGRF_SetRfFrequency+0x84>)
|
|
800a4cc: 2201 movs r2, #1
|
|
800a4ce: 701a strb r2, [r3, #0]
|
|
}
|
|
SX_FREQ_TO_CHANNEL(chan, frequency);
|
|
800a4d0: 687b ldr r3, [r7, #4]
|
|
800a4d2: 2200 movs r2, #0
|
|
800a4d4: 461c mov r4, r3
|
|
800a4d6: 4615 mov r5, r2
|
|
800a4d8: ea4f 19d4 mov.w r9, r4, lsr #7
|
|
800a4dc: ea4f 6844 mov.w r8, r4, lsl #25
|
|
800a4e0: 4a13 ldr r2, [pc, #76] @ (800a530 <SUBGRF_SetRfFrequency+0x88>)
|
|
800a4e2: f04f 0300 mov.w r3, #0
|
|
800a4e6: 4640 mov r0, r8
|
|
800a4e8: 4649 mov r1, r9
|
|
800a4ea: f7f5 feb1 bl 8000250 <__aeabi_uldivmod>
|
|
800a4ee: 4602 mov r2, r0
|
|
800a4f0: 460b mov r3, r1
|
|
800a4f2: 4613 mov r3, r2
|
|
800a4f4: 60fb str r3, [r7, #12]
|
|
buf[0] = ( uint8_t )( ( chan >> 24 ) & 0xFF );
|
|
800a4f6: 68fb ldr r3, [r7, #12]
|
|
800a4f8: 0e1b lsrs r3, r3, #24
|
|
800a4fa: b2db uxtb r3, r3
|
|
800a4fc: 723b strb r3, [r7, #8]
|
|
buf[1] = ( uint8_t )( ( chan >> 16 ) & 0xFF );
|
|
800a4fe: 68fb ldr r3, [r7, #12]
|
|
800a500: 0c1b lsrs r3, r3, #16
|
|
800a502: b2db uxtb r3, r3
|
|
800a504: 727b strb r3, [r7, #9]
|
|
buf[2] = ( uint8_t )( ( chan >> 8 ) & 0xFF );
|
|
800a506: 68fb ldr r3, [r7, #12]
|
|
800a508: 0a1b lsrs r3, r3, #8
|
|
800a50a: b2db uxtb r3, r3
|
|
800a50c: 72bb strb r3, [r7, #10]
|
|
buf[3] = ( uint8_t )( chan & 0xFF );
|
|
800a50e: 68fb ldr r3, [r7, #12]
|
|
800a510: b2db uxtb r3, r3
|
|
800a512: 72fb strb r3, [r7, #11]
|
|
SUBGRF_WriteCommand( RADIO_SET_RFFREQUENCY, buf, 4 );
|
|
800a514: f107 0308 add.w r3, r7, #8
|
|
800a518: 2204 movs r2, #4
|
|
800a51a: 4619 mov r1, r3
|
|
800a51c: 2086 movs r0, #134 @ 0x86
|
|
800a51e: f000 fbdb bl 800acd8 <SUBGRF_WriteCommand>
|
|
}
|
|
800a522: bf00 nop
|
|
800a524: 3710 adds r7, #16
|
|
800a526: 46bd mov sp, r7
|
|
800a528: e8bd 83b0 ldmia.w sp!, {r4, r5, r7, r8, r9, pc}
|
|
800a52c: 2000038c .word 0x2000038c
|
|
800a530: 01e84800 .word 0x01e84800
|
|
|
|
0800a534 <SUBGRF_SetPacketType>:
|
|
|
|
void SUBGRF_SetPacketType( RadioPacketTypes_t packetType )
|
|
{
|
|
800a534: b580 push {r7, lr}
|
|
800a536: b082 sub sp, #8
|
|
800a538: af00 add r7, sp, #0
|
|
800a53a: 4603 mov r3, r0
|
|
800a53c: 71fb strb r3, [r7, #7]
|
|
// Save packet type internally to avoid questioning the radio
|
|
PacketType = packetType;
|
|
800a53e: 79fa ldrb r2, [r7, #7]
|
|
800a540: 4b09 ldr r3, [pc, #36] @ (800a568 <SUBGRF_SetPacketType+0x34>)
|
|
800a542: 701a strb r2, [r3, #0]
|
|
|
|
if( packetType == PACKET_TYPE_GFSK )
|
|
800a544: 79fb ldrb r3, [r7, #7]
|
|
800a546: 2b00 cmp r3, #0
|
|
800a548: d104 bne.n 800a554 <SUBGRF_SetPacketType+0x20>
|
|
{
|
|
SUBGRF_WriteRegister( REG_BIT_SYNC, 0x00 );
|
|
800a54a: 2100 movs r1, #0
|
|
800a54c: f240 60ac movw r0, #1708 @ 0x6ac
|
|
800a550: f000 faf8 bl 800ab44 <SUBGRF_WriteRegister>
|
|
}
|
|
SUBGRF_WriteCommand( RADIO_SET_PACKETTYPE, ( uint8_t* )&packetType, 1 );
|
|
800a554: 1dfb adds r3, r7, #7
|
|
800a556: 2201 movs r2, #1
|
|
800a558: 4619 mov r1, r3
|
|
800a55a: 208a movs r0, #138 @ 0x8a
|
|
800a55c: f000 fbbc bl 800acd8 <SUBGRF_WriteCommand>
|
|
}
|
|
800a560: bf00 nop
|
|
800a562: 3708 adds r7, #8
|
|
800a564: 46bd mov sp, r7
|
|
800a566: bd80 pop {r7, pc}
|
|
800a568: 20000385 .word 0x20000385
|
|
|
|
0800a56c <SUBGRF_GetPacketType>:
|
|
|
|
RadioPacketTypes_t SUBGRF_GetPacketType( void )
|
|
{
|
|
800a56c: b480 push {r7}
|
|
800a56e: af00 add r7, sp, #0
|
|
return PacketType;
|
|
800a570: 4b02 ldr r3, [pc, #8] @ (800a57c <SUBGRF_GetPacketType+0x10>)
|
|
800a572: 781b ldrb r3, [r3, #0]
|
|
}
|
|
800a574: 4618 mov r0, r3
|
|
800a576: 46bd mov sp, r7
|
|
800a578: bc80 pop {r7}
|
|
800a57a: 4770 bx lr
|
|
800a57c: 20000385 .word 0x20000385
|
|
|
|
0800a580 <SUBGRF_SetTxParams>:
|
|
|
|
void SUBGRF_SetTxParams( uint8_t paSelect, int8_t power, RadioRampTimes_t rampTime )
|
|
{
|
|
800a580: b580 push {r7, lr}
|
|
800a582: b084 sub sp, #16
|
|
800a584: af00 add r7, sp, #0
|
|
800a586: 4603 mov r3, r0
|
|
800a588: 71fb strb r3, [r7, #7]
|
|
800a58a: 460b mov r3, r1
|
|
800a58c: 71bb strb r3, [r7, #6]
|
|
800a58e: 4613 mov r3, r2
|
|
800a590: 717b strb r3, [r7, #5]
|
|
uint8_t buf[2];
|
|
int32_t max_power;
|
|
|
|
if (paSelect == RFO_LP)
|
|
800a592: 79fb ldrb r3, [r7, #7]
|
|
800a594: 2b01 cmp r3, #1
|
|
800a596: d149 bne.n 800a62c <SUBGRF_SetTxParams+0xac>
|
|
{
|
|
max_power = RBI_GetRFOMaxPowerConfig(RBI_RFO_LP_MAXPOWER);
|
|
800a598: 2000 movs r0, #0
|
|
800a59a: f003 f975 bl 800d888 <RBI_GetRFOMaxPowerConfig>
|
|
800a59e: 60f8 str r0, [r7, #12]
|
|
if (power > max_power)
|
|
800a5a0: f997 3006 ldrsb.w r3, [r7, #6]
|
|
800a5a4: 68fa ldr r2, [r7, #12]
|
|
800a5a6: 429a cmp r2, r3
|
|
800a5a8: da01 bge.n 800a5ae <SUBGRF_SetTxParams+0x2e>
|
|
{
|
|
power = max_power;
|
|
800a5aa: 68fb ldr r3, [r7, #12]
|
|
800a5ac: 71bb strb r3, [r7, #6]
|
|
}
|
|
if (max_power == 14)
|
|
800a5ae: 68fb ldr r3, [r7, #12]
|
|
800a5b0: 2b0e cmp r3, #14
|
|
800a5b2: d10e bne.n 800a5d2 <SUBGRF_SetTxParams+0x52>
|
|
{
|
|
SUBGRF_SetPaConfig(0x04, 0x00, 0x01, 0x01);
|
|
800a5b4: 2301 movs r3, #1
|
|
800a5b6: 2201 movs r2, #1
|
|
800a5b8: 2100 movs r1, #0
|
|
800a5ba: 2004 movs r0, #4
|
|
800a5bc: f7ff fef6 bl 800a3ac <SUBGRF_SetPaConfig>
|
|
power = 0x0E - (max_power - power);
|
|
800a5c0: 79ba ldrb r2, [r7, #6]
|
|
800a5c2: 68fb ldr r3, [r7, #12]
|
|
800a5c4: b2db uxtb r3, r3
|
|
800a5c6: 1ad3 subs r3, r2, r3
|
|
800a5c8: b2db uxtb r3, r3
|
|
800a5ca: 330e adds r3, #14
|
|
800a5cc: b2db uxtb r3, r3
|
|
800a5ce: 71bb strb r3, [r7, #6]
|
|
800a5d0: e01f b.n 800a612 <SUBGRF_SetTxParams+0x92>
|
|
}
|
|
else if (max_power == 10)
|
|
800a5d2: 68fb ldr r3, [r7, #12]
|
|
800a5d4: 2b0a cmp r3, #10
|
|
800a5d6: d10e bne.n 800a5f6 <SUBGRF_SetTxParams+0x76>
|
|
{
|
|
SUBGRF_SetPaConfig(0x01, 0x00, 0x01, 0x01);
|
|
800a5d8: 2301 movs r3, #1
|
|
800a5da: 2201 movs r2, #1
|
|
800a5dc: 2100 movs r1, #0
|
|
800a5de: 2001 movs r0, #1
|
|
800a5e0: f7ff fee4 bl 800a3ac <SUBGRF_SetPaConfig>
|
|
power = 0x0D - (max_power - power);
|
|
800a5e4: 79ba ldrb r2, [r7, #6]
|
|
800a5e6: 68fb ldr r3, [r7, #12]
|
|
800a5e8: b2db uxtb r3, r3
|
|
800a5ea: 1ad3 subs r3, r2, r3
|
|
800a5ec: b2db uxtb r3, r3
|
|
800a5ee: 330d adds r3, #13
|
|
800a5f0: b2db uxtb r3, r3
|
|
800a5f2: 71bb strb r3, [r7, #6]
|
|
800a5f4: e00d b.n 800a612 <SUBGRF_SetTxParams+0x92>
|
|
}
|
|
else /*default 15dBm*/
|
|
{
|
|
SUBGRF_SetPaConfig(0x07, 0x00, 0x01, 0x01);
|
|
800a5f6: 2301 movs r3, #1
|
|
800a5f8: 2201 movs r2, #1
|
|
800a5fa: 2100 movs r1, #0
|
|
800a5fc: 2007 movs r0, #7
|
|
800a5fe: f7ff fed5 bl 800a3ac <SUBGRF_SetPaConfig>
|
|
power = 0x0E - (max_power - power);
|
|
800a602: 79ba ldrb r2, [r7, #6]
|
|
800a604: 68fb ldr r3, [r7, #12]
|
|
800a606: b2db uxtb r3, r3
|
|
800a608: 1ad3 subs r3, r2, r3
|
|
800a60a: b2db uxtb r3, r3
|
|
800a60c: 330e adds r3, #14
|
|
800a60e: b2db uxtb r3, r3
|
|
800a610: 71bb strb r3, [r7, #6]
|
|
}
|
|
if (power < -17)
|
|
800a612: f997 3006 ldrsb.w r3, [r7, #6]
|
|
800a616: f113 0f11 cmn.w r3, #17
|
|
800a61a: da01 bge.n 800a620 <SUBGRF_SetTxParams+0xa0>
|
|
{
|
|
power = -17;
|
|
800a61c: 23ef movs r3, #239 @ 0xef
|
|
800a61e: 71bb strb r3, [r7, #6]
|
|
}
|
|
SUBGRF_WriteRegister(REG_OCP, 0x18); /* current max is 80 mA for the whole device*/
|
|
800a620: 2118 movs r1, #24
|
|
800a622: f640 00e7 movw r0, #2279 @ 0x8e7
|
|
800a626: f000 fa8d bl 800ab44 <SUBGRF_WriteRegister>
|
|
800a62a: e067 b.n 800a6fc <SUBGRF_SetTxParams+0x17c>
|
|
}
|
|
else /* rfo_hp*/
|
|
{
|
|
/* WORKAROUND - Better Resistance of the RFO High Power Tx to Antenna Mismatch, see STM32WL Erratasheet*/
|
|
SUBGRF_WriteRegister(REG_TX_CLAMP, SUBGRF_ReadRegister(REG_TX_CLAMP) | (0x0F << 1));
|
|
800a62c: f640 00d8 movw r0, #2264 @ 0x8d8
|
|
800a630: f000 faaa bl 800ab88 <SUBGRF_ReadRegister>
|
|
800a634: 4603 mov r3, r0
|
|
800a636: f043 031e orr.w r3, r3, #30
|
|
800a63a: b2db uxtb r3, r3
|
|
800a63c: 4619 mov r1, r3
|
|
800a63e: f640 00d8 movw r0, #2264 @ 0x8d8
|
|
800a642: f000 fa7f bl 800ab44 <SUBGRF_WriteRegister>
|
|
/* WORKAROUND END*/
|
|
max_power = RBI_GetRFOMaxPowerConfig(RBI_RFO_HP_MAXPOWER);
|
|
800a646: 2001 movs r0, #1
|
|
800a648: f003 f91e bl 800d888 <RBI_GetRFOMaxPowerConfig>
|
|
800a64c: 60f8 str r0, [r7, #12]
|
|
if (power > max_power)
|
|
800a64e: f997 3006 ldrsb.w r3, [r7, #6]
|
|
800a652: 68fa ldr r2, [r7, #12]
|
|
800a654: 429a cmp r2, r3
|
|
800a656: da01 bge.n 800a65c <SUBGRF_SetTxParams+0xdc>
|
|
{
|
|
power = max_power;
|
|
800a658: 68fb ldr r3, [r7, #12]
|
|
800a65a: 71bb strb r3, [r7, #6]
|
|
}
|
|
if (max_power == 20)
|
|
800a65c: 68fb ldr r3, [r7, #12]
|
|
800a65e: 2b14 cmp r3, #20
|
|
800a660: d10e bne.n 800a680 <SUBGRF_SetTxParams+0x100>
|
|
{
|
|
SUBGRF_SetPaConfig(0x03, 0x05, 0x00, 0x01);
|
|
800a662: 2301 movs r3, #1
|
|
800a664: 2200 movs r2, #0
|
|
800a666: 2105 movs r1, #5
|
|
800a668: 2003 movs r0, #3
|
|
800a66a: f7ff fe9f bl 800a3ac <SUBGRF_SetPaConfig>
|
|
power = 0x16 - (max_power - power);
|
|
800a66e: 79ba ldrb r2, [r7, #6]
|
|
800a670: 68fb ldr r3, [r7, #12]
|
|
800a672: b2db uxtb r3, r3
|
|
800a674: 1ad3 subs r3, r2, r3
|
|
800a676: b2db uxtb r3, r3
|
|
800a678: 3316 adds r3, #22
|
|
800a67a: b2db uxtb r3, r3
|
|
800a67c: 71bb strb r3, [r7, #6]
|
|
800a67e: e031 b.n 800a6e4 <SUBGRF_SetTxParams+0x164>
|
|
}
|
|
else if (max_power == 17)
|
|
800a680: 68fb ldr r3, [r7, #12]
|
|
800a682: 2b11 cmp r3, #17
|
|
800a684: d10e bne.n 800a6a4 <SUBGRF_SetTxParams+0x124>
|
|
{
|
|
SUBGRF_SetPaConfig(0x02, 0x03, 0x00, 0x01);
|
|
800a686: 2301 movs r3, #1
|
|
800a688: 2200 movs r2, #0
|
|
800a68a: 2103 movs r1, #3
|
|
800a68c: 2002 movs r0, #2
|
|
800a68e: f7ff fe8d bl 800a3ac <SUBGRF_SetPaConfig>
|
|
power = 0x16 - (max_power - power);
|
|
800a692: 79ba ldrb r2, [r7, #6]
|
|
800a694: 68fb ldr r3, [r7, #12]
|
|
800a696: b2db uxtb r3, r3
|
|
800a698: 1ad3 subs r3, r2, r3
|
|
800a69a: b2db uxtb r3, r3
|
|
800a69c: 3316 adds r3, #22
|
|
800a69e: b2db uxtb r3, r3
|
|
800a6a0: 71bb strb r3, [r7, #6]
|
|
800a6a2: e01f b.n 800a6e4 <SUBGRF_SetTxParams+0x164>
|
|
}
|
|
else if (max_power == 14)
|
|
800a6a4: 68fb ldr r3, [r7, #12]
|
|
800a6a6: 2b0e cmp r3, #14
|
|
800a6a8: d10e bne.n 800a6c8 <SUBGRF_SetTxParams+0x148>
|
|
{
|
|
SUBGRF_SetPaConfig(0x02, 0x02, 0x00, 0x01);
|
|
800a6aa: 2301 movs r3, #1
|
|
800a6ac: 2200 movs r2, #0
|
|
800a6ae: 2102 movs r1, #2
|
|
800a6b0: 2002 movs r0, #2
|
|
800a6b2: f7ff fe7b bl 800a3ac <SUBGRF_SetPaConfig>
|
|
power = 0x0E - (max_power - power);
|
|
800a6b6: 79ba ldrb r2, [r7, #6]
|
|
800a6b8: 68fb ldr r3, [r7, #12]
|
|
800a6ba: b2db uxtb r3, r3
|
|
800a6bc: 1ad3 subs r3, r2, r3
|
|
800a6be: b2db uxtb r3, r3
|
|
800a6c0: 330e adds r3, #14
|
|
800a6c2: b2db uxtb r3, r3
|
|
800a6c4: 71bb strb r3, [r7, #6]
|
|
800a6c6: e00d b.n 800a6e4 <SUBGRF_SetTxParams+0x164>
|
|
}
|
|
else /*22dBm*/
|
|
{
|
|
SUBGRF_SetPaConfig(0x04, 0x07, 0x00, 0x01);
|
|
800a6c8: 2301 movs r3, #1
|
|
800a6ca: 2200 movs r2, #0
|
|
800a6cc: 2107 movs r1, #7
|
|
800a6ce: 2004 movs r0, #4
|
|
800a6d0: f7ff fe6c bl 800a3ac <SUBGRF_SetPaConfig>
|
|
power = 0x16 - (max_power - power);
|
|
800a6d4: 79ba ldrb r2, [r7, #6]
|
|
800a6d6: 68fb ldr r3, [r7, #12]
|
|
800a6d8: b2db uxtb r3, r3
|
|
800a6da: 1ad3 subs r3, r2, r3
|
|
800a6dc: b2db uxtb r3, r3
|
|
800a6de: 3316 adds r3, #22
|
|
800a6e0: b2db uxtb r3, r3
|
|
800a6e2: 71bb strb r3, [r7, #6]
|
|
}
|
|
if (power < -9)
|
|
800a6e4: f997 3006 ldrsb.w r3, [r7, #6]
|
|
800a6e8: f113 0f09 cmn.w r3, #9
|
|
800a6ec: da01 bge.n 800a6f2 <SUBGRF_SetTxParams+0x172>
|
|
{
|
|
power = -9;
|
|
800a6ee: 23f7 movs r3, #247 @ 0xf7
|
|
800a6f0: 71bb strb r3, [r7, #6]
|
|
}
|
|
SUBGRF_WriteRegister(REG_OCP, 0x38); /*current max 160mA for the whole device*/
|
|
800a6f2: 2138 movs r1, #56 @ 0x38
|
|
800a6f4: f640 00e7 movw r0, #2279 @ 0x8e7
|
|
800a6f8: f000 fa24 bl 800ab44 <SUBGRF_WriteRegister>
|
|
}
|
|
buf[0] = power;
|
|
800a6fc: 79bb ldrb r3, [r7, #6]
|
|
800a6fe: 723b strb r3, [r7, #8]
|
|
buf[1] = (uint8_t)rampTime;
|
|
800a700: 797b ldrb r3, [r7, #5]
|
|
800a702: 727b strb r3, [r7, #9]
|
|
SUBGRF_WriteCommand(RADIO_SET_TXPARAMS, buf, 2);
|
|
800a704: f107 0308 add.w r3, r7, #8
|
|
800a708: 2202 movs r2, #2
|
|
800a70a: 4619 mov r1, r3
|
|
800a70c: 208e movs r0, #142 @ 0x8e
|
|
800a70e: f000 fae3 bl 800acd8 <SUBGRF_WriteCommand>
|
|
}
|
|
800a712: bf00 nop
|
|
800a714: 3710 adds r7, #16
|
|
800a716: 46bd mov sp, r7
|
|
800a718: bd80 pop {r7, pc}
|
|
...
|
|
|
|
0800a71c <SUBGRF_SetModulationParams>:
|
|
|
|
void SUBGRF_SetModulationParams( ModulationParams_t *modulationParams )
|
|
{
|
|
800a71c: e92d 43b0 stmdb sp!, {r4, r5, r7, r8, r9, lr}
|
|
800a720: b086 sub sp, #24
|
|
800a722: af00 add r7, sp, #0
|
|
800a724: 6078 str r0, [r7, #4]
|
|
uint8_t n;
|
|
uint32_t tempVal = 0;
|
|
800a726: 2300 movs r3, #0
|
|
800a728: 617b str r3, [r7, #20]
|
|
uint8_t buf[8] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 };
|
|
800a72a: f107 0308 add.w r3, r7, #8
|
|
800a72e: 2200 movs r2, #0
|
|
800a730: 601a str r2, [r3, #0]
|
|
800a732: 605a str r2, [r3, #4]
|
|
|
|
// Check if required configuration corresponds to the stored packet type
|
|
// If not, silently update radio packet type
|
|
if( PacketType != modulationParams->PacketType )
|
|
800a734: 687b ldr r3, [r7, #4]
|
|
800a736: 781a ldrb r2, [r3, #0]
|
|
800a738: 4b5c ldr r3, [pc, #368] @ (800a8ac <SUBGRF_SetModulationParams+0x190>)
|
|
800a73a: 781b ldrb r3, [r3, #0]
|
|
800a73c: 429a cmp r2, r3
|
|
800a73e: d004 beq.n 800a74a <SUBGRF_SetModulationParams+0x2e>
|
|
{
|
|
SUBGRF_SetPacketType( modulationParams->PacketType );
|
|
800a740: 687b ldr r3, [r7, #4]
|
|
800a742: 781b ldrb r3, [r3, #0]
|
|
800a744: 4618 mov r0, r3
|
|
800a746: f7ff fef5 bl 800a534 <SUBGRF_SetPacketType>
|
|
}
|
|
|
|
switch( modulationParams->PacketType )
|
|
800a74a: 687b ldr r3, [r7, #4]
|
|
800a74c: 781b ldrb r3, [r3, #0]
|
|
800a74e: 2b03 cmp r3, #3
|
|
800a750: f200 80a5 bhi.w 800a89e <SUBGRF_SetModulationParams+0x182>
|
|
800a754: a201 add r2, pc, #4 @ (adr r2, 800a75c <SUBGRF_SetModulationParams+0x40>)
|
|
800a756: f852 f023 ldr.w pc, [r2, r3, lsl #2]
|
|
800a75a: bf00 nop
|
|
800a75c: 0800a76d .word 0x0800a76d
|
|
800a760: 0800a82d .word 0x0800a82d
|
|
800a764: 0800a7ef .word 0x0800a7ef
|
|
800a768: 0800a85b .word 0x0800a85b
|
|
{
|
|
case PACKET_TYPE_GFSK:
|
|
n = 8;
|
|
800a76c: 2308 movs r3, #8
|
|
800a76e: 74fb strb r3, [r7, #19]
|
|
tempVal = ( uint32_t )(( 32 * XTAL_FREQ ) / modulationParams->Params.Gfsk.BitRate );
|
|
800a770: 687b ldr r3, [r7, #4]
|
|
800a772: 685b ldr r3, [r3, #4]
|
|
800a774: 4a4e ldr r2, [pc, #312] @ (800a8b0 <SUBGRF_SetModulationParams+0x194>)
|
|
800a776: fbb2 f3f3 udiv r3, r2, r3
|
|
800a77a: 617b str r3, [r7, #20]
|
|
buf[0] = ( tempVal >> 16 ) & 0xFF;
|
|
800a77c: 697b ldr r3, [r7, #20]
|
|
800a77e: 0c1b lsrs r3, r3, #16
|
|
800a780: b2db uxtb r3, r3
|
|
800a782: 723b strb r3, [r7, #8]
|
|
buf[1] = ( tempVal >> 8 ) & 0xFF;
|
|
800a784: 697b ldr r3, [r7, #20]
|
|
800a786: 0a1b lsrs r3, r3, #8
|
|
800a788: b2db uxtb r3, r3
|
|
800a78a: 727b strb r3, [r7, #9]
|
|
buf[2] = tempVal & 0xFF;
|
|
800a78c: 697b ldr r3, [r7, #20]
|
|
800a78e: b2db uxtb r3, r3
|
|
800a790: 72bb strb r3, [r7, #10]
|
|
buf[3] = modulationParams->Params.Gfsk.ModulationShaping;
|
|
800a792: 687b ldr r3, [r7, #4]
|
|
800a794: 7b1b ldrb r3, [r3, #12]
|
|
800a796: 72fb strb r3, [r7, #11]
|
|
buf[4] = modulationParams->Params.Gfsk.Bandwidth;
|
|
800a798: 687b ldr r3, [r7, #4]
|
|
800a79a: 7b5b ldrb r3, [r3, #13]
|
|
800a79c: 733b strb r3, [r7, #12]
|
|
SX_FREQ_TO_CHANNEL(tempVal, modulationParams->Params.Gfsk.Fdev);
|
|
800a79e: 687b ldr r3, [r7, #4]
|
|
800a7a0: 689b ldr r3, [r3, #8]
|
|
800a7a2: 2200 movs r2, #0
|
|
800a7a4: 461c mov r4, r3
|
|
800a7a6: 4615 mov r5, r2
|
|
800a7a8: ea4f 19d4 mov.w r9, r4, lsr #7
|
|
800a7ac: ea4f 6844 mov.w r8, r4, lsl #25
|
|
800a7b0: 4a40 ldr r2, [pc, #256] @ (800a8b4 <SUBGRF_SetModulationParams+0x198>)
|
|
800a7b2: f04f 0300 mov.w r3, #0
|
|
800a7b6: 4640 mov r0, r8
|
|
800a7b8: 4649 mov r1, r9
|
|
800a7ba: f7f5 fd49 bl 8000250 <__aeabi_uldivmod>
|
|
800a7be: 4602 mov r2, r0
|
|
800a7c0: 460b mov r3, r1
|
|
800a7c2: 4613 mov r3, r2
|
|
800a7c4: 617b str r3, [r7, #20]
|
|
buf[5] = ( tempVal >> 16 ) & 0xFF;
|
|
800a7c6: 697b ldr r3, [r7, #20]
|
|
800a7c8: 0c1b lsrs r3, r3, #16
|
|
800a7ca: b2db uxtb r3, r3
|
|
800a7cc: 737b strb r3, [r7, #13]
|
|
buf[6] = ( tempVal >> 8 ) & 0xFF;
|
|
800a7ce: 697b ldr r3, [r7, #20]
|
|
800a7d0: 0a1b lsrs r3, r3, #8
|
|
800a7d2: b2db uxtb r3, r3
|
|
800a7d4: 73bb strb r3, [r7, #14]
|
|
buf[7] = ( tempVal& 0xFF );
|
|
800a7d6: 697b ldr r3, [r7, #20]
|
|
800a7d8: b2db uxtb r3, r3
|
|
800a7da: 73fb strb r3, [r7, #15]
|
|
SUBGRF_WriteCommand( RADIO_SET_MODULATIONPARAMS, buf, n );
|
|
800a7dc: 7cfb ldrb r3, [r7, #19]
|
|
800a7de: b29a uxth r2, r3
|
|
800a7e0: f107 0308 add.w r3, r7, #8
|
|
800a7e4: 4619 mov r1, r3
|
|
800a7e6: 208b movs r0, #139 @ 0x8b
|
|
800a7e8: f000 fa76 bl 800acd8 <SUBGRF_WriteCommand>
|
|
break;
|
|
800a7ec: e058 b.n 800a8a0 <SUBGRF_SetModulationParams+0x184>
|
|
case PACKET_TYPE_BPSK:
|
|
n = 4;
|
|
800a7ee: 2304 movs r3, #4
|
|
800a7f0: 74fb strb r3, [r7, #19]
|
|
tempVal = ( uint32_t ) (( 32 * XTAL_FREQ) / modulationParams->Params.Bpsk.BitRate );
|
|
800a7f2: 687b ldr r3, [r7, #4]
|
|
800a7f4: 691b ldr r3, [r3, #16]
|
|
800a7f6: 4a2e ldr r2, [pc, #184] @ (800a8b0 <SUBGRF_SetModulationParams+0x194>)
|
|
800a7f8: fbb2 f3f3 udiv r3, r2, r3
|
|
800a7fc: 617b str r3, [r7, #20]
|
|
buf[0] = ( tempVal >> 16 ) & 0xFF;
|
|
800a7fe: 697b ldr r3, [r7, #20]
|
|
800a800: 0c1b lsrs r3, r3, #16
|
|
800a802: b2db uxtb r3, r3
|
|
800a804: 723b strb r3, [r7, #8]
|
|
buf[1] = ( tempVal >> 8 ) & 0xFF;
|
|
800a806: 697b ldr r3, [r7, #20]
|
|
800a808: 0a1b lsrs r3, r3, #8
|
|
800a80a: b2db uxtb r3, r3
|
|
800a80c: 727b strb r3, [r7, #9]
|
|
buf[2] = tempVal & 0xFF;
|
|
800a80e: 697b ldr r3, [r7, #20]
|
|
800a810: b2db uxtb r3, r3
|
|
800a812: 72bb strb r3, [r7, #10]
|
|
buf[3] = modulationParams->Params.Bpsk.ModulationShaping;
|
|
800a814: 687b ldr r3, [r7, #4]
|
|
800a816: 7d1b ldrb r3, [r3, #20]
|
|
800a818: 72fb strb r3, [r7, #11]
|
|
SUBGRF_WriteCommand( RADIO_SET_MODULATIONPARAMS, buf, n );
|
|
800a81a: 7cfb ldrb r3, [r7, #19]
|
|
800a81c: b29a uxth r2, r3
|
|
800a81e: f107 0308 add.w r3, r7, #8
|
|
800a822: 4619 mov r1, r3
|
|
800a824: 208b movs r0, #139 @ 0x8b
|
|
800a826: f000 fa57 bl 800acd8 <SUBGRF_WriteCommand>
|
|
break;
|
|
800a82a: e039 b.n 800a8a0 <SUBGRF_SetModulationParams+0x184>
|
|
case PACKET_TYPE_LORA:
|
|
n = 4;
|
|
800a82c: 2304 movs r3, #4
|
|
800a82e: 74fb strb r3, [r7, #19]
|
|
buf[0] = modulationParams->Params.LoRa.SpreadingFactor;
|
|
800a830: 687b ldr r3, [r7, #4]
|
|
800a832: 7e1b ldrb r3, [r3, #24]
|
|
800a834: 723b strb r3, [r7, #8]
|
|
buf[1] = modulationParams->Params.LoRa.Bandwidth;
|
|
800a836: 687b ldr r3, [r7, #4]
|
|
800a838: 7e5b ldrb r3, [r3, #25]
|
|
800a83a: 727b strb r3, [r7, #9]
|
|
buf[2] = modulationParams->Params.LoRa.CodingRate;
|
|
800a83c: 687b ldr r3, [r7, #4]
|
|
800a83e: 7e9b ldrb r3, [r3, #26]
|
|
800a840: 72bb strb r3, [r7, #10]
|
|
buf[3] = modulationParams->Params.LoRa.LowDatarateOptimize;
|
|
800a842: 687b ldr r3, [r7, #4]
|
|
800a844: 7edb ldrb r3, [r3, #27]
|
|
800a846: 72fb strb r3, [r7, #11]
|
|
|
|
SUBGRF_WriteCommand( RADIO_SET_MODULATIONPARAMS, buf, n );
|
|
800a848: 7cfb ldrb r3, [r7, #19]
|
|
800a84a: b29a uxth r2, r3
|
|
800a84c: f107 0308 add.w r3, r7, #8
|
|
800a850: 4619 mov r1, r3
|
|
800a852: 208b movs r0, #139 @ 0x8b
|
|
800a854: f000 fa40 bl 800acd8 <SUBGRF_WriteCommand>
|
|
|
|
break;
|
|
800a858: e022 b.n 800a8a0 <SUBGRF_SetModulationParams+0x184>
|
|
case PACKET_TYPE_GMSK:
|
|
n = 5;
|
|
800a85a: 2305 movs r3, #5
|
|
800a85c: 74fb strb r3, [r7, #19]
|
|
tempVal = ( uint32_t )(( 32 *XTAL_FREQ) / modulationParams->Params.Gfsk.BitRate );
|
|
800a85e: 687b ldr r3, [r7, #4]
|
|
800a860: 685b ldr r3, [r3, #4]
|
|
800a862: 4a13 ldr r2, [pc, #76] @ (800a8b0 <SUBGRF_SetModulationParams+0x194>)
|
|
800a864: fbb2 f3f3 udiv r3, r2, r3
|
|
800a868: 617b str r3, [r7, #20]
|
|
buf[0] = ( tempVal >> 16 ) & 0xFF;
|
|
800a86a: 697b ldr r3, [r7, #20]
|
|
800a86c: 0c1b lsrs r3, r3, #16
|
|
800a86e: b2db uxtb r3, r3
|
|
800a870: 723b strb r3, [r7, #8]
|
|
buf[1] = ( tempVal >> 8 ) & 0xFF;
|
|
800a872: 697b ldr r3, [r7, #20]
|
|
800a874: 0a1b lsrs r3, r3, #8
|
|
800a876: b2db uxtb r3, r3
|
|
800a878: 727b strb r3, [r7, #9]
|
|
buf[2] = tempVal & 0xFF;
|
|
800a87a: 697b ldr r3, [r7, #20]
|
|
800a87c: b2db uxtb r3, r3
|
|
800a87e: 72bb strb r3, [r7, #10]
|
|
buf[3] = modulationParams->Params.Gfsk.ModulationShaping;
|
|
800a880: 687b ldr r3, [r7, #4]
|
|
800a882: 7b1b ldrb r3, [r3, #12]
|
|
800a884: 72fb strb r3, [r7, #11]
|
|
buf[4] = modulationParams->Params.Gfsk.Bandwidth;
|
|
800a886: 687b ldr r3, [r7, #4]
|
|
800a888: 7b5b ldrb r3, [r3, #13]
|
|
800a88a: 733b strb r3, [r7, #12]
|
|
SUBGRF_WriteCommand( RADIO_SET_MODULATIONPARAMS, buf, n );
|
|
800a88c: 7cfb ldrb r3, [r7, #19]
|
|
800a88e: b29a uxth r2, r3
|
|
800a890: f107 0308 add.w r3, r7, #8
|
|
800a894: 4619 mov r1, r3
|
|
800a896: 208b movs r0, #139 @ 0x8b
|
|
800a898: f000 fa1e bl 800acd8 <SUBGRF_WriteCommand>
|
|
break;
|
|
800a89c: e000 b.n 800a8a0 <SUBGRF_SetModulationParams+0x184>
|
|
default:
|
|
case PACKET_TYPE_NONE:
|
|
break;
|
|
800a89e: bf00 nop
|
|
}
|
|
}
|
|
800a8a0: bf00 nop
|
|
800a8a2: 3718 adds r7, #24
|
|
800a8a4: 46bd mov sp, r7
|
|
800a8a6: e8bd 83b0 ldmia.w sp!, {r4, r5, r7, r8, r9, pc}
|
|
800a8aa: bf00 nop
|
|
800a8ac: 20000385 .word 0x20000385
|
|
800a8b0: 3d090000 .word 0x3d090000
|
|
800a8b4: 01e84800 .word 0x01e84800
|
|
|
|
0800a8b8 <SUBGRF_SetPacketParams>:
|
|
|
|
void SUBGRF_SetPacketParams( PacketParams_t *packetParams )
|
|
{
|
|
800a8b8: b580 push {r7, lr}
|
|
800a8ba: b086 sub sp, #24
|
|
800a8bc: af00 add r7, sp, #0
|
|
800a8be: 6078 str r0, [r7, #4]
|
|
uint8_t n;
|
|
uint8_t crcVal = 0;
|
|
800a8c0: 2300 movs r3, #0
|
|
800a8c2: 75bb strb r3, [r7, #22]
|
|
uint8_t buf[9] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 };
|
|
800a8c4: f107 030c add.w r3, r7, #12
|
|
800a8c8: 2200 movs r2, #0
|
|
800a8ca: 601a str r2, [r3, #0]
|
|
800a8cc: 605a str r2, [r3, #4]
|
|
800a8ce: 721a strb r2, [r3, #8]
|
|
|
|
// Check if required configuration corresponds to the stored packet type
|
|
// If not, silently update radio packet type
|
|
if( PacketType != packetParams->PacketType )
|
|
800a8d0: 687b ldr r3, [r7, #4]
|
|
800a8d2: 781a ldrb r2, [r3, #0]
|
|
800a8d4: 4b44 ldr r3, [pc, #272] @ (800a9e8 <SUBGRF_SetPacketParams+0x130>)
|
|
800a8d6: 781b ldrb r3, [r3, #0]
|
|
800a8d8: 429a cmp r2, r3
|
|
800a8da: d004 beq.n 800a8e6 <SUBGRF_SetPacketParams+0x2e>
|
|
{
|
|
SUBGRF_SetPacketType( packetParams->PacketType );
|
|
800a8dc: 687b ldr r3, [r7, #4]
|
|
800a8de: 781b ldrb r3, [r3, #0]
|
|
800a8e0: 4618 mov r0, r3
|
|
800a8e2: f7ff fe27 bl 800a534 <SUBGRF_SetPacketType>
|
|
}
|
|
|
|
switch( packetParams->PacketType )
|
|
800a8e6: 687b ldr r3, [r7, #4]
|
|
800a8e8: 781b ldrb r3, [r3, #0]
|
|
800a8ea: 2b03 cmp r3, #3
|
|
800a8ec: d878 bhi.n 800a9e0 <SUBGRF_SetPacketParams+0x128>
|
|
800a8ee: a201 add r2, pc, #4 @ (adr r2, 800a8f4 <SUBGRF_SetPacketParams+0x3c>)
|
|
800a8f0: f852 f023 ldr.w pc, [r2, r3, lsl #2]
|
|
800a8f4: 0800a905 .word 0x0800a905
|
|
800a8f8: 0800a995 .word 0x0800a995
|
|
800a8fc: 0800a989 .word 0x0800a989
|
|
800a900: 0800a905 .word 0x0800a905
|
|
{
|
|
case PACKET_TYPE_GMSK:
|
|
case PACKET_TYPE_GFSK:
|
|
if( packetParams->Params.Gfsk.CrcLength == RADIO_CRC_2_BYTES_IBM )
|
|
800a904: 687b ldr r3, [r7, #4]
|
|
800a906: 7a5b ldrb r3, [r3, #9]
|
|
800a908: 2bf1 cmp r3, #241 @ 0xf1
|
|
800a90a: d10a bne.n 800a922 <SUBGRF_SetPacketParams+0x6a>
|
|
{
|
|
SUBGRF_SetCrcSeed( CRC_IBM_SEED );
|
|
800a90c: f64f 70ff movw r0, #65535 @ 0xffff
|
|
800a910: f7ff faa6 bl 8009e60 <SUBGRF_SetCrcSeed>
|
|
SUBGRF_SetCrcPolynomial( CRC_POLYNOMIAL_IBM );
|
|
800a914: f248 0005 movw r0, #32773 @ 0x8005
|
|
800a918: f7ff fac2 bl 8009ea0 <SUBGRF_SetCrcPolynomial>
|
|
crcVal = RADIO_CRC_2_BYTES;
|
|
800a91c: 2302 movs r3, #2
|
|
800a91e: 75bb strb r3, [r7, #22]
|
|
800a920: e011 b.n 800a946 <SUBGRF_SetPacketParams+0x8e>
|
|
}
|
|
else if( packetParams->Params.Gfsk.CrcLength == RADIO_CRC_2_BYTES_CCIT )
|
|
800a922: 687b ldr r3, [r7, #4]
|
|
800a924: 7a5b ldrb r3, [r3, #9]
|
|
800a926: 2bf2 cmp r3, #242 @ 0xf2
|
|
800a928: d10a bne.n 800a940 <SUBGRF_SetPacketParams+0x88>
|
|
{
|
|
SUBGRF_SetCrcSeed( CRC_CCITT_SEED );
|
|
800a92a: f641 500f movw r0, #7439 @ 0x1d0f
|
|
800a92e: f7ff fa97 bl 8009e60 <SUBGRF_SetCrcSeed>
|
|
SUBGRF_SetCrcPolynomial( CRC_POLYNOMIAL_CCITT );
|
|
800a932: f241 0021 movw r0, #4129 @ 0x1021
|
|
800a936: f7ff fab3 bl 8009ea0 <SUBGRF_SetCrcPolynomial>
|
|
crcVal = RADIO_CRC_2_BYTES_INV;
|
|
800a93a: 2306 movs r3, #6
|
|
800a93c: 75bb strb r3, [r7, #22]
|
|
800a93e: e002 b.n 800a946 <SUBGRF_SetPacketParams+0x8e>
|
|
}
|
|
else
|
|
{
|
|
crcVal = packetParams->Params.Gfsk.CrcLength;
|
|
800a940: 687b ldr r3, [r7, #4]
|
|
800a942: 7a5b ldrb r3, [r3, #9]
|
|
800a944: 75bb strb r3, [r7, #22]
|
|
}
|
|
n = 9;
|
|
800a946: 2309 movs r3, #9
|
|
800a948: 75fb strb r3, [r7, #23]
|
|
buf[0] = ( packetParams->Params.Gfsk.PreambleLength >> 8 ) & 0xFF;
|
|
800a94a: 687b ldr r3, [r7, #4]
|
|
800a94c: 885b ldrh r3, [r3, #2]
|
|
800a94e: 0a1b lsrs r3, r3, #8
|
|
800a950: b29b uxth r3, r3
|
|
800a952: b2db uxtb r3, r3
|
|
800a954: 733b strb r3, [r7, #12]
|
|
buf[1] = packetParams->Params.Gfsk.PreambleLength;
|
|
800a956: 687b ldr r3, [r7, #4]
|
|
800a958: 885b ldrh r3, [r3, #2]
|
|
800a95a: b2db uxtb r3, r3
|
|
800a95c: 737b strb r3, [r7, #13]
|
|
buf[2] = packetParams->Params.Gfsk.PreambleMinDetect;
|
|
800a95e: 687b ldr r3, [r7, #4]
|
|
800a960: 791b ldrb r3, [r3, #4]
|
|
800a962: 73bb strb r3, [r7, #14]
|
|
buf[3] = ( packetParams->Params.Gfsk.SyncWordLength /*<< 3*/ ); // convert from byte to bit
|
|
800a964: 687b ldr r3, [r7, #4]
|
|
800a966: 795b ldrb r3, [r3, #5]
|
|
800a968: 73fb strb r3, [r7, #15]
|
|
buf[4] = packetParams->Params.Gfsk.AddrComp;
|
|
800a96a: 687b ldr r3, [r7, #4]
|
|
800a96c: 799b ldrb r3, [r3, #6]
|
|
800a96e: 743b strb r3, [r7, #16]
|
|
buf[5] = packetParams->Params.Gfsk.HeaderType;
|
|
800a970: 687b ldr r3, [r7, #4]
|
|
800a972: 79db ldrb r3, [r3, #7]
|
|
800a974: 747b strb r3, [r7, #17]
|
|
buf[6] = packetParams->Params.Gfsk.PayloadLength;
|
|
800a976: 687b ldr r3, [r7, #4]
|
|
800a978: 7a1b ldrb r3, [r3, #8]
|
|
800a97a: 74bb strb r3, [r7, #18]
|
|
buf[7] = crcVal;
|
|
800a97c: 7dbb ldrb r3, [r7, #22]
|
|
800a97e: 74fb strb r3, [r7, #19]
|
|
buf[8] = packetParams->Params.Gfsk.DcFree;
|
|
800a980: 687b ldr r3, [r7, #4]
|
|
800a982: 7a9b ldrb r3, [r3, #10]
|
|
800a984: 753b strb r3, [r7, #20]
|
|
break;
|
|
800a986: e022 b.n 800a9ce <SUBGRF_SetPacketParams+0x116>
|
|
case PACKET_TYPE_BPSK:
|
|
n = 1;
|
|
800a988: 2301 movs r3, #1
|
|
800a98a: 75fb strb r3, [r7, #23]
|
|
buf[0] = packetParams->Params.Bpsk.PayloadLength;
|
|
800a98c: 687b ldr r3, [r7, #4]
|
|
800a98e: 7b1b ldrb r3, [r3, #12]
|
|
800a990: 733b strb r3, [r7, #12]
|
|
break;
|
|
800a992: e01c b.n 800a9ce <SUBGRF_SetPacketParams+0x116>
|
|
case PACKET_TYPE_LORA:
|
|
n = 6;
|
|
800a994: 2306 movs r3, #6
|
|
800a996: 75fb strb r3, [r7, #23]
|
|
buf[0] = ( packetParams->Params.LoRa.PreambleLength >> 8 ) & 0xFF;
|
|
800a998: 687b ldr r3, [r7, #4]
|
|
800a99a: 89db ldrh r3, [r3, #14]
|
|
800a99c: 0a1b lsrs r3, r3, #8
|
|
800a99e: b29b uxth r3, r3
|
|
800a9a0: b2db uxtb r3, r3
|
|
800a9a2: 733b strb r3, [r7, #12]
|
|
buf[1] = packetParams->Params.LoRa.PreambleLength;
|
|
800a9a4: 687b ldr r3, [r7, #4]
|
|
800a9a6: 89db ldrh r3, [r3, #14]
|
|
800a9a8: b2db uxtb r3, r3
|
|
800a9aa: 737b strb r3, [r7, #13]
|
|
buf[2] = LoRaHeaderType = packetParams->Params.LoRa.HeaderType;
|
|
800a9ac: 687b ldr r3, [r7, #4]
|
|
800a9ae: 7c1a ldrb r2, [r3, #16]
|
|
800a9b0: 4b0e ldr r3, [pc, #56] @ (800a9ec <SUBGRF_SetPacketParams+0x134>)
|
|
800a9b2: 4611 mov r1, r2
|
|
800a9b4: 7019 strb r1, [r3, #0]
|
|
800a9b6: 4613 mov r3, r2
|
|
800a9b8: 73bb strb r3, [r7, #14]
|
|
buf[3] = packetParams->Params.LoRa.PayloadLength;
|
|
800a9ba: 687b ldr r3, [r7, #4]
|
|
800a9bc: 7c5b ldrb r3, [r3, #17]
|
|
800a9be: 73fb strb r3, [r7, #15]
|
|
buf[4] = packetParams->Params.LoRa.CrcMode;
|
|
800a9c0: 687b ldr r3, [r7, #4]
|
|
800a9c2: 7c9b ldrb r3, [r3, #18]
|
|
800a9c4: 743b strb r3, [r7, #16]
|
|
buf[5] = packetParams->Params.LoRa.InvertIQ;
|
|
800a9c6: 687b ldr r3, [r7, #4]
|
|
800a9c8: 7cdb ldrb r3, [r3, #19]
|
|
800a9ca: 747b strb r3, [r7, #17]
|
|
break;
|
|
800a9cc: bf00 nop
|
|
default:
|
|
case PACKET_TYPE_NONE:
|
|
return;
|
|
}
|
|
SUBGRF_WriteCommand( RADIO_SET_PACKETPARAMS, buf, n );
|
|
800a9ce: 7dfb ldrb r3, [r7, #23]
|
|
800a9d0: b29a uxth r2, r3
|
|
800a9d2: f107 030c add.w r3, r7, #12
|
|
800a9d6: 4619 mov r1, r3
|
|
800a9d8: 208c movs r0, #140 @ 0x8c
|
|
800a9da: f000 f97d bl 800acd8 <SUBGRF_WriteCommand>
|
|
800a9de: e000 b.n 800a9e2 <SUBGRF_SetPacketParams+0x12a>
|
|
return;
|
|
800a9e0: bf00 nop
|
|
}
|
|
800a9e2: 3718 adds r7, #24
|
|
800a9e4: 46bd mov sp, r7
|
|
800a9e6: bd80 pop {r7, pc}
|
|
800a9e8: 20000385 .word 0x20000385
|
|
800a9ec: 20000386 .word 0x20000386
|
|
|
|
0800a9f0 <SUBGRF_SetBufferBaseAddress>:
|
|
SUBGRF_WriteCommand( RADIO_SET_CADPARAMS, buf, 7 );
|
|
OperatingMode = MODE_CAD;
|
|
}
|
|
|
|
void SUBGRF_SetBufferBaseAddress( uint8_t txBaseAddress, uint8_t rxBaseAddress )
|
|
{
|
|
800a9f0: b580 push {r7, lr}
|
|
800a9f2: b084 sub sp, #16
|
|
800a9f4: af00 add r7, sp, #0
|
|
800a9f6: 4603 mov r3, r0
|
|
800a9f8: 460a mov r2, r1
|
|
800a9fa: 71fb strb r3, [r7, #7]
|
|
800a9fc: 4613 mov r3, r2
|
|
800a9fe: 71bb strb r3, [r7, #6]
|
|
uint8_t buf[2];
|
|
|
|
buf[0] = txBaseAddress;
|
|
800aa00: 79fb ldrb r3, [r7, #7]
|
|
800aa02: 733b strb r3, [r7, #12]
|
|
buf[1] = rxBaseAddress;
|
|
800aa04: 79bb ldrb r3, [r7, #6]
|
|
800aa06: 737b strb r3, [r7, #13]
|
|
SUBGRF_WriteCommand( RADIO_SET_BUFFERBASEADDRESS, buf, 2 );
|
|
800aa08: f107 030c add.w r3, r7, #12
|
|
800aa0c: 2202 movs r2, #2
|
|
800aa0e: 4619 mov r1, r3
|
|
800aa10: 208f movs r0, #143 @ 0x8f
|
|
800aa12: f000 f961 bl 800acd8 <SUBGRF_WriteCommand>
|
|
}
|
|
800aa16: bf00 nop
|
|
800aa18: 3710 adds r7, #16
|
|
800aa1a: 46bd mov sp, r7
|
|
800aa1c: bd80 pop {r7, pc}
|
|
|
|
0800aa1e <SUBGRF_GetRssiInst>:
|
|
status.Fields.ChipMode = ( stat & ( 0x07 << 4 ) ) >> 4;
|
|
return status;
|
|
}
|
|
|
|
int8_t SUBGRF_GetRssiInst( void )
|
|
{
|
|
800aa1e: b580 push {r7, lr}
|
|
800aa20: b082 sub sp, #8
|
|
800aa22: af00 add r7, sp, #0
|
|
uint8_t buf[1];
|
|
int8_t rssi = 0;
|
|
800aa24: 2300 movs r3, #0
|
|
800aa26: 71fb strb r3, [r7, #7]
|
|
|
|
SUBGRF_ReadCommand( RADIO_GET_RSSIINST, buf, 1 );
|
|
800aa28: 1d3b adds r3, r7, #4
|
|
800aa2a: 2201 movs r2, #1
|
|
800aa2c: 4619 mov r1, r3
|
|
800aa2e: 2015 movs r0, #21
|
|
800aa30: f000 f974 bl 800ad1c <SUBGRF_ReadCommand>
|
|
rssi = -buf[0] >> 1;
|
|
800aa34: 793b ldrb r3, [r7, #4]
|
|
800aa36: 425b negs r3, r3
|
|
800aa38: 105b asrs r3, r3, #1
|
|
800aa3a: 71fb strb r3, [r7, #7]
|
|
return rssi;
|
|
800aa3c: f997 3007 ldrsb.w r3, [r7, #7]
|
|
}
|
|
800aa40: 4618 mov r0, r3
|
|
800aa42: 3708 adds r7, #8
|
|
800aa44: 46bd mov sp, r7
|
|
800aa46: bd80 pop {r7, pc}
|
|
|
|
0800aa48 <SUBGRF_GetRxBufferStatus>:
|
|
|
|
void SUBGRF_GetRxBufferStatus( uint8_t *payloadLength, uint8_t *rxStartBufferPointer )
|
|
{
|
|
800aa48: b580 push {r7, lr}
|
|
800aa4a: b084 sub sp, #16
|
|
800aa4c: af00 add r7, sp, #0
|
|
800aa4e: 6078 str r0, [r7, #4]
|
|
800aa50: 6039 str r1, [r7, #0]
|
|
uint8_t status[2];
|
|
|
|
SUBGRF_ReadCommand( RADIO_GET_RXBUFFERSTATUS, status, 2 );
|
|
800aa52: f107 030c add.w r3, r7, #12
|
|
800aa56: 2202 movs r2, #2
|
|
800aa58: 4619 mov r1, r3
|
|
800aa5a: 2013 movs r0, #19
|
|
800aa5c: f000 f95e bl 800ad1c <SUBGRF_ReadCommand>
|
|
|
|
// In case of LORA fixed header, the payloadLength is obtained by reading
|
|
// the register REG_LR_PAYLOADLENGTH
|
|
if( ( SUBGRF_GetPacketType( ) == PACKET_TYPE_LORA ) && ( LoRaHeaderType == LORA_PACKET_FIXED_LENGTH ) )
|
|
800aa60: f7ff fd84 bl 800a56c <SUBGRF_GetPacketType>
|
|
800aa64: 4603 mov r3, r0
|
|
800aa66: 2b01 cmp r3, #1
|
|
800aa68: d10d bne.n 800aa86 <SUBGRF_GetRxBufferStatus+0x3e>
|
|
800aa6a: 4b0c ldr r3, [pc, #48] @ (800aa9c <SUBGRF_GetRxBufferStatus+0x54>)
|
|
800aa6c: 781b ldrb r3, [r3, #0]
|
|
800aa6e: b2db uxtb r3, r3
|
|
800aa70: 2b01 cmp r3, #1
|
|
800aa72: d108 bne.n 800aa86 <SUBGRF_GetRxBufferStatus+0x3e>
|
|
{
|
|
*payloadLength = SUBGRF_ReadRegister( REG_LR_PAYLOADLENGTH );
|
|
800aa74: f240 7002 movw r0, #1794 @ 0x702
|
|
800aa78: f000 f886 bl 800ab88 <SUBGRF_ReadRegister>
|
|
800aa7c: 4603 mov r3, r0
|
|
800aa7e: 461a mov r2, r3
|
|
800aa80: 687b ldr r3, [r7, #4]
|
|
800aa82: 701a strb r2, [r3, #0]
|
|
800aa84: e002 b.n 800aa8c <SUBGRF_GetRxBufferStatus+0x44>
|
|
}
|
|
else
|
|
{
|
|
*payloadLength = status[0];
|
|
800aa86: 7b3a ldrb r2, [r7, #12]
|
|
800aa88: 687b ldr r3, [r7, #4]
|
|
800aa8a: 701a strb r2, [r3, #0]
|
|
}
|
|
*rxStartBufferPointer = status[1];
|
|
800aa8c: 7b7a ldrb r2, [r7, #13]
|
|
800aa8e: 683b ldr r3, [r7, #0]
|
|
800aa90: 701a strb r2, [r3, #0]
|
|
}
|
|
800aa92: bf00 nop
|
|
800aa94: 3710 adds r7, #16
|
|
800aa96: 46bd mov sp, r7
|
|
800aa98: bd80 pop {r7, pc}
|
|
800aa9a: bf00 nop
|
|
800aa9c: 20000386 .word 0x20000386
|
|
|
|
0800aaa0 <SUBGRF_GetPacketStatus>:
|
|
|
|
void SUBGRF_GetPacketStatus( PacketStatus_t *pktStatus )
|
|
{
|
|
800aaa0: b580 push {r7, lr}
|
|
800aaa2: b084 sub sp, #16
|
|
800aaa4: af00 add r7, sp, #0
|
|
800aaa6: 6078 str r0, [r7, #4]
|
|
uint8_t status[3];
|
|
|
|
SUBGRF_ReadCommand( RADIO_GET_PACKETSTATUS, status, 3 );
|
|
800aaa8: f107 030c add.w r3, r7, #12
|
|
800aaac: 2203 movs r2, #3
|
|
800aaae: 4619 mov r1, r3
|
|
800aab0: 2014 movs r0, #20
|
|
800aab2: f000 f933 bl 800ad1c <SUBGRF_ReadCommand>
|
|
|
|
pktStatus->packetType = SUBGRF_GetPacketType( );
|
|
800aab6: f7ff fd59 bl 800a56c <SUBGRF_GetPacketType>
|
|
800aaba: 4603 mov r3, r0
|
|
800aabc: 461a mov r2, r3
|
|
800aabe: 687b ldr r3, [r7, #4]
|
|
800aac0: 701a strb r2, [r3, #0]
|
|
switch( pktStatus->packetType )
|
|
800aac2: 687b ldr r3, [r7, #4]
|
|
800aac4: 781b ldrb r3, [r3, #0]
|
|
800aac6: 2b00 cmp r3, #0
|
|
800aac8: d002 beq.n 800aad0 <SUBGRF_GetPacketStatus+0x30>
|
|
800aaca: 2b01 cmp r3, #1
|
|
800aacc: d013 beq.n 800aaf6 <SUBGRF_GetPacketStatus+0x56>
|
|
800aace: e02a b.n 800ab26 <SUBGRF_GetPacketStatus+0x86>
|
|
{
|
|
case PACKET_TYPE_GFSK:
|
|
pktStatus->Params.Gfsk.RxStatus = status[0];
|
|
800aad0: 7b3a ldrb r2, [r7, #12]
|
|
800aad2: 687b ldr r3, [r7, #4]
|
|
800aad4: 711a strb r2, [r3, #4]
|
|
pktStatus->Params.Gfsk.RssiSync = -status[1] >> 1;
|
|
800aad6: 7b7b ldrb r3, [r7, #13]
|
|
800aad8: 425b negs r3, r3
|
|
800aada: 105b asrs r3, r3, #1
|
|
800aadc: b25a sxtb r2, r3
|
|
800aade: 687b ldr r3, [r7, #4]
|
|
800aae0: 719a strb r2, [r3, #6]
|
|
pktStatus->Params.Gfsk.RssiAvg = -status[2] >> 1;
|
|
800aae2: 7bbb ldrb r3, [r7, #14]
|
|
800aae4: 425b negs r3, r3
|
|
800aae6: 105b asrs r3, r3, #1
|
|
800aae8: b25a sxtb r2, r3
|
|
800aaea: 687b ldr r3, [r7, #4]
|
|
800aaec: 715a strb r2, [r3, #5]
|
|
pktStatus->Params.Gfsk.FreqError = 0;
|
|
800aaee: 687b ldr r3, [r7, #4]
|
|
800aaf0: 2200 movs r2, #0
|
|
800aaf2: 609a str r2, [r3, #8]
|
|
break;
|
|
800aaf4: e020 b.n 800ab38 <SUBGRF_GetPacketStatus+0x98>
|
|
|
|
case PACKET_TYPE_LORA:
|
|
pktStatus->Params.LoRa.RssiPkt = -status[0] >> 1;
|
|
800aaf6: 7b3b ldrb r3, [r7, #12]
|
|
800aaf8: 425b negs r3, r3
|
|
800aafa: 105b asrs r3, r3, #1
|
|
800aafc: b25a sxtb r2, r3
|
|
800aafe: 687b ldr r3, [r7, #4]
|
|
800ab00: 731a strb r2, [r3, #12]
|
|
// Returns SNR value [dB] rounded to the nearest integer value
|
|
pktStatus->Params.LoRa.SnrPkt = ( ( ( int8_t )status[1] ) + 2 ) >> 2;
|
|
800ab02: 7b7b ldrb r3, [r7, #13]
|
|
800ab04: b25b sxtb r3, r3
|
|
800ab06: 3302 adds r3, #2
|
|
800ab08: 109b asrs r3, r3, #2
|
|
800ab0a: b25a sxtb r2, r3
|
|
800ab0c: 687b ldr r3, [r7, #4]
|
|
800ab0e: 735a strb r2, [r3, #13]
|
|
pktStatus->Params.LoRa.SignalRssiPkt = -status[2] >> 1;
|
|
800ab10: 7bbb ldrb r3, [r7, #14]
|
|
800ab12: 425b negs r3, r3
|
|
800ab14: 105b asrs r3, r3, #1
|
|
800ab16: b25a sxtb r2, r3
|
|
800ab18: 687b ldr r3, [r7, #4]
|
|
800ab1a: 739a strb r2, [r3, #14]
|
|
pktStatus->Params.LoRa.FreqError = FrequencyError;
|
|
800ab1c: 4b08 ldr r3, [pc, #32] @ (800ab40 <SUBGRF_GetPacketStatus+0xa0>)
|
|
800ab1e: 681a ldr r2, [r3, #0]
|
|
800ab20: 687b ldr r3, [r7, #4]
|
|
800ab22: 611a str r2, [r3, #16]
|
|
break;
|
|
800ab24: e008 b.n 800ab38 <SUBGRF_GetPacketStatus+0x98>
|
|
|
|
default:
|
|
case PACKET_TYPE_NONE:
|
|
// In that specific case, we set everything in the pktStatus to zeros
|
|
// and reset the packet type accordingly
|
|
RADIO_MEMSET8( pktStatus, 0, sizeof( PacketStatus_t ) );
|
|
800ab26: 2214 movs r2, #20
|
|
800ab28: 2100 movs r1, #0
|
|
800ab2a: 6878 ldr r0, [r7, #4]
|
|
800ab2c: f002 ff7f bl 800da2e <UTIL_MEM_set_8>
|
|
pktStatus->packetType = PACKET_TYPE_NONE;
|
|
800ab30: 687b ldr r3, [r7, #4]
|
|
800ab32: 220f movs r2, #15
|
|
800ab34: 701a strb r2, [r3, #0]
|
|
break;
|
|
800ab36: bf00 nop
|
|
}
|
|
}
|
|
800ab38: bf00 nop
|
|
800ab3a: 3710 adds r7, #16
|
|
800ab3c: 46bd mov sp, r7
|
|
800ab3e: bd80 pop {r7, pc}
|
|
800ab40: 20000388 .word 0x20000388
|
|
|
|
0800ab44 <SUBGRF_WriteRegister>:
|
|
buf[1] = ( uint8_t )( ( uint16_t )irq & 0x00FF );
|
|
SUBGRF_WriteCommand( RADIO_CLR_IRQSTATUS, buf, 2 );
|
|
}
|
|
|
|
void SUBGRF_WriteRegister( uint16_t addr, uint8_t data )
|
|
{
|
|
800ab44: b580 push {r7, lr}
|
|
800ab46: b086 sub sp, #24
|
|
800ab48: af00 add r7, sp, #0
|
|
800ab4a: 4603 mov r3, r0
|
|
800ab4c: 460a mov r2, r1
|
|
800ab4e: 80fb strh r3, [r7, #6]
|
|
800ab50: 4613 mov r3, r2
|
|
800ab52: 717b strb r3, [r7, #5]
|
|
__ASM volatile ("MRS %0, primask" : "=r" (result) :: "memory");
|
|
800ab54: f3ef 8310 mrs r3, PRIMASK
|
|
800ab58: 60fb str r3, [r7, #12]
|
|
return(result);
|
|
800ab5a: 68fb ldr r3, [r7, #12]
|
|
CRITICAL_SECTION_BEGIN();
|
|
800ab5c: 617b str r3, [r7, #20]
|
|
__ASM volatile ("cpsid i" : : : "memory");
|
|
800ab5e: b672 cpsid i
|
|
}
|
|
800ab60: bf00 nop
|
|
HAL_SUBGHZ_WriteRegisters( &hsubghz, addr, (uint8_t*)&data, 1 );
|
|
800ab62: 1d7a adds r2, r7, #5
|
|
800ab64: 88f9 ldrh r1, [r7, #6]
|
|
800ab66: 2301 movs r3, #1
|
|
800ab68: 4806 ldr r0, [pc, #24] @ (800ab84 <SUBGRF_WriteRegister+0x40>)
|
|
800ab6a: f7fa f94b bl 8004e04 <HAL_SUBGHZ_WriteRegisters>
|
|
800ab6e: 697b ldr r3, [r7, #20]
|
|
800ab70: 613b str r3, [r7, #16]
|
|
__ASM volatile ("MSR primask, %0" : : "r" (priMask) : "memory");
|
|
800ab72: 693b ldr r3, [r7, #16]
|
|
800ab74: f383 8810 msr PRIMASK, r3
|
|
}
|
|
800ab78: bf00 nop
|
|
CRITICAL_SECTION_END();
|
|
}
|
|
800ab7a: bf00 nop
|
|
800ab7c: 3718 adds r7, #24
|
|
800ab7e: 46bd mov sp, r7
|
|
800ab80: bd80 pop {r7, pc}
|
|
800ab82: bf00 nop
|
|
800ab84: 200000c0 .word 0x200000c0
|
|
|
|
0800ab88 <SUBGRF_ReadRegister>:
|
|
|
|
uint8_t SUBGRF_ReadRegister( uint16_t addr )
|
|
{
|
|
800ab88: b580 push {r7, lr}
|
|
800ab8a: b086 sub sp, #24
|
|
800ab8c: af00 add r7, sp, #0
|
|
800ab8e: 4603 mov r3, r0
|
|
800ab90: 80fb strh r3, [r7, #6]
|
|
__ASM volatile ("MRS %0, primask" : "=r" (result) :: "memory");
|
|
800ab92: f3ef 8310 mrs r3, PRIMASK
|
|
800ab96: 60fb str r3, [r7, #12]
|
|
return(result);
|
|
800ab98: 68fb ldr r3, [r7, #12]
|
|
uint8_t data;
|
|
CRITICAL_SECTION_BEGIN();
|
|
800ab9a: 617b str r3, [r7, #20]
|
|
__ASM volatile ("cpsid i" : : : "memory");
|
|
800ab9c: b672 cpsid i
|
|
}
|
|
800ab9e: bf00 nop
|
|
HAL_SUBGHZ_ReadRegisters( &hsubghz, addr, &data, 1 );
|
|
800aba0: f107 020b add.w r2, r7, #11
|
|
800aba4: 88f9 ldrh r1, [r7, #6]
|
|
800aba6: 2301 movs r3, #1
|
|
800aba8: 4806 ldr r0, [pc, #24] @ (800abc4 <SUBGRF_ReadRegister+0x3c>)
|
|
800abaa: f7fa f98a bl 8004ec2 <HAL_SUBGHZ_ReadRegisters>
|
|
800abae: 697b ldr r3, [r7, #20]
|
|
800abb0: 613b str r3, [r7, #16]
|
|
__ASM volatile ("MSR primask, %0" : : "r" (priMask) : "memory");
|
|
800abb2: 693b ldr r3, [r7, #16]
|
|
800abb4: f383 8810 msr PRIMASK, r3
|
|
}
|
|
800abb8: bf00 nop
|
|
CRITICAL_SECTION_END();
|
|
return data;
|
|
800abba: 7afb ldrb r3, [r7, #11]
|
|
}
|
|
800abbc: 4618 mov r0, r3
|
|
800abbe: 3718 adds r7, #24
|
|
800abc0: 46bd mov sp, r7
|
|
800abc2: bd80 pop {r7, pc}
|
|
800abc4: 200000c0 .word 0x200000c0
|
|
|
|
0800abc8 <SUBGRF_WriteRegisters>:
|
|
|
|
void SUBGRF_WriteRegisters( uint16_t address, uint8_t *buffer, uint16_t size )
|
|
{
|
|
800abc8: b580 push {r7, lr}
|
|
800abca: b086 sub sp, #24
|
|
800abcc: af00 add r7, sp, #0
|
|
800abce: 4603 mov r3, r0
|
|
800abd0: 6039 str r1, [r7, #0]
|
|
800abd2: 80fb strh r3, [r7, #6]
|
|
800abd4: 4613 mov r3, r2
|
|
800abd6: 80bb strh r3, [r7, #4]
|
|
__ASM volatile ("MRS %0, primask" : "=r" (result) :: "memory");
|
|
800abd8: f3ef 8310 mrs r3, PRIMASK
|
|
800abdc: 60fb str r3, [r7, #12]
|
|
return(result);
|
|
800abde: 68fb ldr r3, [r7, #12]
|
|
CRITICAL_SECTION_BEGIN();
|
|
800abe0: 617b str r3, [r7, #20]
|
|
__ASM volatile ("cpsid i" : : : "memory");
|
|
800abe2: b672 cpsid i
|
|
}
|
|
800abe4: bf00 nop
|
|
HAL_SUBGHZ_WriteRegisters( &hsubghz, address, buffer, size );
|
|
800abe6: 88bb ldrh r3, [r7, #4]
|
|
800abe8: 88f9 ldrh r1, [r7, #6]
|
|
800abea: 683a ldr r2, [r7, #0]
|
|
800abec: 4806 ldr r0, [pc, #24] @ (800ac08 <SUBGRF_WriteRegisters+0x40>)
|
|
800abee: f7fa f909 bl 8004e04 <HAL_SUBGHZ_WriteRegisters>
|
|
800abf2: 697b ldr r3, [r7, #20]
|
|
800abf4: 613b str r3, [r7, #16]
|
|
__ASM volatile ("MSR primask, %0" : : "r" (priMask) : "memory");
|
|
800abf6: 693b ldr r3, [r7, #16]
|
|
800abf8: f383 8810 msr PRIMASK, r3
|
|
}
|
|
800abfc: bf00 nop
|
|
CRITICAL_SECTION_END();
|
|
}
|
|
800abfe: bf00 nop
|
|
800ac00: 3718 adds r7, #24
|
|
800ac02: 46bd mov sp, r7
|
|
800ac04: bd80 pop {r7, pc}
|
|
800ac06: bf00 nop
|
|
800ac08: 200000c0 .word 0x200000c0
|
|
|
|
0800ac0c <SUBGRF_ReadRegisters>:
|
|
|
|
void SUBGRF_ReadRegisters( uint16_t address, uint8_t *buffer, uint16_t size )
|
|
{
|
|
800ac0c: b580 push {r7, lr}
|
|
800ac0e: b086 sub sp, #24
|
|
800ac10: af00 add r7, sp, #0
|
|
800ac12: 4603 mov r3, r0
|
|
800ac14: 6039 str r1, [r7, #0]
|
|
800ac16: 80fb strh r3, [r7, #6]
|
|
800ac18: 4613 mov r3, r2
|
|
800ac1a: 80bb strh r3, [r7, #4]
|
|
__ASM volatile ("MRS %0, primask" : "=r" (result) :: "memory");
|
|
800ac1c: f3ef 8310 mrs r3, PRIMASK
|
|
800ac20: 60fb str r3, [r7, #12]
|
|
return(result);
|
|
800ac22: 68fb ldr r3, [r7, #12]
|
|
CRITICAL_SECTION_BEGIN();
|
|
800ac24: 617b str r3, [r7, #20]
|
|
__ASM volatile ("cpsid i" : : : "memory");
|
|
800ac26: b672 cpsid i
|
|
}
|
|
800ac28: bf00 nop
|
|
HAL_SUBGHZ_ReadRegisters( &hsubghz, address, buffer, size );
|
|
800ac2a: 88bb ldrh r3, [r7, #4]
|
|
800ac2c: 88f9 ldrh r1, [r7, #6]
|
|
800ac2e: 683a ldr r2, [r7, #0]
|
|
800ac30: 4806 ldr r0, [pc, #24] @ (800ac4c <SUBGRF_ReadRegisters+0x40>)
|
|
800ac32: f7fa f946 bl 8004ec2 <HAL_SUBGHZ_ReadRegisters>
|
|
800ac36: 697b ldr r3, [r7, #20]
|
|
800ac38: 613b str r3, [r7, #16]
|
|
__ASM volatile ("MSR primask, %0" : : "r" (priMask) : "memory");
|
|
800ac3a: 693b ldr r3, [r7, #16]
|
|
800ac3c: f383 8810 msr PRIMASK, r3
|
|
}
|
|
800ac40: bf00 nop
|
|
CRITICAL_SECTION_END();
|
|
}
|
|
800ac42: bf00 nop
|
|
800ac44: 3718 adds r7, #24
|
|
800ac46: 46bd mov sp, r7
|
|
800ac48: bd80 pop {r7, pc}
|
|
800ac4a: bf00 nop
|
|
800ac4c: 200000c0 .word 0x200000c0
|
|
|
|
0800ac50 <SUBGRF_WriteBuffer>:
|
|
|
|
void SUBGRF_WriteBuffer( uint8_t offset, uint8_t *buffer, uint8_t size )
|
|
{
|
|
800ac50: b580 push {r7, lr}
|
|
800ac52: b086 sub sp, #24
|
|
800ac54: af00 add r7, sp, #0
|
|
800ac56: 4603 mov r3, r0
|
|
800ac58: 6039 str r1, [r7, #0]
|
|
800ac5a: 71fb strb r3, [r7, #7]
|
|
800ac5c: 4613 mov r3, r2
|
|
800ac5e: 71bb strb r3, [r7, #6]
|
|
__ASM volatile ("MRS %0, primask" : "=r" (result) :: "memory");
|
|
800ac60: f3ef 8310 mrs r3, PRIMASK
|
|
800ac64: 60fb str r3, [r7, #12]
|
|
return(result);
|
|
800ac66: 68fb ldr r3, [r7, #12]
|
|
CRITICAL_SECTION_BEGIN();
|
|
800ac68: 617b str r3, [r7, #20]
|
|
__ASM volatile ("cpsid i" : : : "memory");
|
|
800ac6a: b672 cpsid i
|
|
}
|
|
800ac6c: bf00 nop
|
|
HAL_SUBGHZ_WriteBuffer( &hsubghz, offset, buffer, size );
|
|
800ac6e: 79bb ldrb r3, [r7, #6]
|
|
800ac70: b29b uxth r3, r3
|
|
800ac72: 79f9 ldrb r1, [r7, #7]
|
|
800ac74: 683a ldr r2, [r7, #0]
|
|
800ac76: 4806 ldr r0, [pc, #24] @ (800ac90 <SUBGRF_WriteBuffer+0x40>)
|
|
800ac78: f7fa fa37 bl 80050ea <HAL_SUBGHZ_WriteBuffer>
|
|
800ac7c: 697b ldr r3, [r7, #20]
|
|
800ac7e: 613b str r3, [r7, #16]
|
|
__ASM volatile ("MSR primask, %0" : : "r" (priMask) : "memory");
|
|
800ac80: 693b ldr r3, [r7, #16]
|
|
800ac82: f383 8810 msr PRIMASK, r3
|
|
}
|
|
800ac86: bf00 nop
|
|
CRITICAL_SECTION_END();
|
|
}
|
|
800ac88: bf00 nop
|
|
800ac8a: 3718 adds r7, #24
|
|
800ac8c: 46bd mov sp, r7
|
|
800ac8e: bd80 pop {r7, pc}
|
|
800ac90: 200000c0 .word 0x200000c0
|
|
|
|
0800ac94 <SUBGRF_ReadBuffer>:
|
|
|
|
void SUBGRF_ReadBuffer( uint8_t offset, uint8_t *buffer, uint8_t size )
|
|
{
|
|
800ac94: b580 push {r7, lr}
|
|
800ac96: b086 sub sp, #24
|
|
800ac98: af00 add r7, sp, #0
|
|
800ac9a: 4603 mov r3, r0
|
|
800ac9c: 6039 str r1, [r7, #0]
|
|
800ac9e: 71fb strb r3, [r7, #7]
|
|
800aca0: 4613 mov r3, r2
|
|
800aca2: 71bb strb r3, [r7, #6]
|
|
__ASM volatile ("MRS %0, primask" : "=r" (result) :: "memory");
|
|
800aca4: f3ef 8310 mrs r3, PRIMASK
|
|
800aca8: 60fb str r3, [r7, #12]
|
|
return(result);
|
|
800acaa: 68fb ldr r3, [r7, #12]
|
|
CRITICAL_SECTION_BEGIN();
|
|
800acac: 617b str r3, [r7, #20]
|
|
__ASM volatile ("cpsid i" : : : "memory");
|
|
800acae: b672 cpsid i
|
|
}
|
|
800acb0: bf00 nop
|
|
HAL_SUBGHZ_ReadBuffer( &hsubghz, offset, buffer, size );
|
|
800acb2: 79bb ldrb r3, [r7, #6]
|
|
800acb4: b29b uxth r3, r3
|
|
800acb6: 79f9 ldrb r1, [r7, #7]
|
|
800acb8: 683a ldr r2, [r7, #0]
|
|
800acba: 4806 ldr r0, [pc, #24] @ (800acd4 <SUBGRF_ReadBuffer+0x40>)
|
|
800acbc: f7fa fa68 bl 8005190 <HAL_SUBGHZ_ReadBuffer>
|
|
800acc0: 697b ldr r3, [r7, #20]
|
|
800acc2: 613b str r3, [r7, #16]
|
|
__ASM volatile ("MSR primask, %0" : : "r" (priMask) : "memory");
|
|
800acc4: 693b ldr r3, [r7, #16]
|
|
800acc6: f383 8810 msr PRIMASK, r3
|
|
}
|
|
800acca: bf00 nop
|
|
CRITICAL_SECTION_END();
|
|
}
|
|
800accc: bf00 nop
|
|
800acce: 3718 adds r7, #24
|
|
800acd0: 46bd mov sp, r7
|
|
800acd2: bd80 pop {r7, pc}
|
|
800acd4: 200000c0 .word 0x200000c0
|
|
|
|
0800acd8 <SUBGRF_WriteCommand>:
|
|
|
|
void SUBGRF_WriteCommand( SUBGHZ_RadioSetCmd_t Command, uint8_t *pBuffer,
|
|
uint16_t Size )
|
|
{
|
|
800acd8: b580 push {r7, lr}
|
|
800acda: b086 sub sp, #24
|
|
800acdc: af00 add r7, sp, #0
|
|
800acde: 4603 mov r3, r0
|
|
800ace0: 6039 str r1, [r7, #0]
|
|
800ace2: 71fb strb r3, [r7, #7]
|
|
800ace4: 4613 mov r3, r2
|
|
800ace6: 80bb strh r3, [r7, #4]
|
|
__ASM volatile ("MRS %0, primask" : "=r" (result) :: "memory");
|
|
800ace8: f3ef 8310 mrs r3, PRIMASK
|
|
800acec: 60fb str r3, [r7, #12]
|
|
return(result);
|
|
800acee: 68fb ldr r3, [r7, #12]
|
|
CRITICAL_SECTION_BEGIN();
|
|
800acf0: 617b str r3, [r7, #20]
|
|
__ASM volatile ("cpsid i" : : : "memory");
|
|
800acf2: b672 cpsid i
|
|
}
|
|
800acf4: bf00 nop
|
|
HAL_SUBGHZ_ExecSetCmd( &hsubghz, Command, pBuffer, Size );
|
|
800acf6: 88bb ldrh r3, [r7, #4]
|
|
800acf8: 79f9 ldrb r1, [r7, #7]
|
|
800acfa: 683a ldr r2, [r7, #0]
|
|
800acfc: 4806 ldr r0, [pc, #24] @ (800ad18 <SUBGRF_WriteCommand+0x40>)
|
|
800acfe: f7fa f941 bl 8004f84 <HAL_SUBGHZ_ExecSetCmd>
|
|
800ad02: 697b ldr r3, [r7, #20]
|
|
800ad04: 613b str r3, [r7, #16]
|
|
__ASM volatile ("MSR primask, %0" : : "r" (priMask) : "memory");
|
|
800ad06: 693b ldr r3, [r7, #16]
|
|
800ad08: f383 8810 msr PRIMASK, r3
|
|
}
|
|
800ad0c: bf00 nop
|
|
CRITICAL_SECTION_END();
|
|
}
|
|
800ad0e: bf00 nop
|
|
800ad10: 3718 adds r7, #24
|
|
800ad12: 46bd mov sp, r7
|
|
800ad14: bd80 pop {r7, pc}
|
|
800ad16: bf00 nop
|
|
800ad18: 200000c0 .word 0x200000c0
|
|
|
|
0800ad1c <SUBGRF_ReadCommand>:
|
|
|
|
void SUBGRF_ReadCommand( SUBGHZ_RadioGetCmd_t Command, uint8_t *pBuffer,
|
|
uint16_t Size )
|
|
{
|
|
800ad1c: b580 push {r7, lr}
|
|
800ad1e: b086 sub sp, #24
|
|
800ad20: af00 add r7, sp, #0
|
|
800ad22: 4603 mov r3, r0
|
|
800ad24: 6039 str r1, [r7, #0]
|
|
800ad26: 71fb strb r3, [r7, #7]
|
|
800ad28: 4613 mov r3, r2
|
|
800ad2a: 80bb strh r3, [r7, #4]
|
|
__ASM volatile ("MRS %0, primask" : "=r" (result) :: "memory");
|
|
800ad2c: f3ef 8310 mrs r3, PRIMASK
|
|
800ad30: 60fb str r3, [r7, #12]
|
|
return(result);
|
|
800ad32: 68fb ldr r3, [r7, #12]
|
|
CRITICAL_SECTION_BEGIN();
|
|
800ad34: 617b str r3, [r7, #20]
|
|
__ASM volatile ("cpsid i" : : : "memory");
|
|
800ad36: b672 cpsid i
|
|
}
|
|
800ad38: bf00 nop
|
|
HAL_SUBGHZ_ExecGetCmd( &hsubghz, Command, pBuffer, Size );
|
|
800ad3a: 88bb ldrh r3, [r7, #4]
|
|
800ad3c: 79f9 ldrb r1, [r7, #7]
|
|
800ad3e: 683a ldr r2, [r7, #0]
|
|
800ad40: 4806 ldr r0, [pc, #24] @ (800ad5c <SUBGRF_ReadCommand+0x40>)
|
|
800ad42: f7fa f97e bl 8005042 <HAL_SUBGHZ_ExecGetCmd>
|
|
800ad46: 697b ldr r3, [r7, #20]
|
|
800ad48: 613b str r3, [r7, #16]
|
|
__ASM volatile ("MSR primask, %0" : : "r" (priMask) : "memory");
|
|
800ad4a: 693b ldr r3, [r7, #16]
|
|
800ad4c: f383 8810 msr PRIMASK, r3
|
|
}
|
|
800ad50: bf00 nop
|
|
CRITICAL_SECTION_END();
|
|
}
|
|
800ad52: bf00 nop
|
|
800ad54: 3718 adds r7, #24
|
|
800ad56: 46bd mov sp, r7
|
|
800ad58: bd80 pop {r7, pc}
|
|
800ad5a: bf00 nop
|
|
800ad5c: 200000c0 .word 0x200000c0
|
|
|
|
0800ad60 <SUBGRF_SetSwitch>:
|
|
|
|
void SUBGRF_SetSwitch( uint8_t paSelect, RFState_t rxtx )
|
|
{
|
|
800ad60: b580 push {r7, lr}
|
|
800ad62: b084 sub sp, #16
|
|
800ad64: af00 add r7, sp, #0
|
|
800ad66: 4603 mov r3, r0
|
|
800ad68: 460a mov r2, r1
|
|
800ad6a: 71fb strb r3, [r7, #7]
|
|
800ad6c: 4613 mov r3, r2
|
|
800ad6e: 71bb strb r3, [r7, #6]
|
|
RBI_Switch_TypeDef state = RBI_SWITCH_RX;
|
|
800ad70: 2301 movs r3, #1
|
|
800ad72: 73fb strb r3, [r7, #15]
|
|
|
|
if (rxtx == RFSWITCH_TX)
|
|
800ad74: 79bb ldrb r3, [r7, #6]
|
|
800ad76: 2b01 cmp r3, #1
|
|
800ad78: d10d bne.n 800ad96 <SUBGRF_SetSwitch+0x36>
|
|
{
|
|
if (paSelect == RFO_LP)
|
|
800ad7a: 79fb ldrb r3, [r7, #7]
|
|
800ad7c: 2b01 cmp r3, #1
|
|
800ad7e: d104 bne.n 800ad8a <SUBGRF_SetSwitch+0x2a>
|
|
{
|
|
state = RBI_SWITCH_RFO_LP;
|
|
800ad80: 2302 movs r3, #2
|
|
800ad82: 73fb strb r3, [r7, #15]
|
|
Radio_SMPS_Set(SMPS_DRIVE_SETTING_MAX);
|
|
800ad84: 2004 movs r0, #4
|
|
800ad86: f000 f8ef bl 800af68 <Radio_SMPS_Set>
|
|
}
|
|
if (paSelect == RFO_HP)
|
|
800ad8a: 79fb ldrb r3, [r7, #7]
|
|
800ad8c: 2b02 cmp r3, #2
|
|
800ad8e: d107 bne.n 800ada0 <SUBGRF_SetSwitch+0x40>
|
|
{
|
|
state = RBI_SWITCH_RFO_HP;
|
|
800ad90: 2303 movs r3, #3
|
|
800ad92: 73fb strb r3, [r7, #15]
|
|
800ad94: e004 b.n 800ada0 <SUBGRF_SetSwitch+0x40>
|
|
}
|
|
}
|
|
else
|
|
{
|
|
if (rxtx == RFSWITCH_RX)
|
|
800ad96: 79bb ldrb r3, [r7, #6]
|
|
800ad98: 2b00 cmp r3, #0
|
|
800ad9a: d101 bne.n 800ada0 <SUBGRF_SetSwitch+0x40>
|
|
{
|
|
state = RBI_SWITCH_RX;
|
|
800ad9c: 2301 movs r3, #1
|
|
800ad9e: 73fb strb r3, [r7, #15]
|
|
}
|
|
}
|
|
RBI_ConfigRFSwitch(state);
|
|
800ada0: 7bfb ldrb r3, [r7, #15]
|
|
800ada2: 4618 mov r0, r3
|
|
800ada4: f002 fd4d bl 800d842 <RBI_ConfigRFSwitch>
|
|
}
|
|
800ada8: bf00 nop
|
|
800adaa: 3710 adds r7, #16
|
|
800adac: 46bd mov sp, r7
|
|
800adae: bd80 pop {r7, pc}
|
|
|
|
0800adb0 <SUBGRF_SetRfTxPower>:
|
|
|
|
uint8_t SUBGRF_SetRfTxPower( int8_t power )
|
|
{
|
|
800adb0: b580 push {r7, lr}
|
|
800adb2: b084 sub sp, #16
|
|
800adb4: af00 add r7, sp, #0
|
|
800adb6: 4603 mov r3, r0
|
|
800adb8: 71fb strb r3, [r7, #7]
|
|
uint8_t paSelect= RFO_LP;
|
|
800adba: 2301 movs r3, #1
|
|
800adbc: 73fb strb r3, [r7, #15]
|
|
|
|
int32_t TxConfig = RBI_GetTxConfig();
|
|
800adbe: f002 fd4e bl 800d85e <RBI_GetTxConfig>
|
|
800adc2: 60b8 str r0, [r7, #8]
|
|
|
|
switch (TxConfig)
|
|
800adc4: 68bb ldr r3, [r7, #8]
|
|
800adc6: 2b02 cmp r3, #2
|
|
800adc8: d016 beq.n 800adf8 <SUBGRF_SetRfTxPower+0x48>
|
|
800adca: 68bb ldr r3, [r7, #8]
|
|
800adcc: 2b02 cmp r3, #2
|
|
800adce: dc16 bgt.n 800adfe <SUBGRF_SetRfTxPower+0x4e>
|
|
800add0: 68bb ldr r3, [r7, #8]
|
|
800add2: 2b00 cmp r3, #0
|
|
800add4: d003 beq.n 800adde <SUBGRF_SetRfTxPower+0x2e>
|
|
800add6: 68bb ldr r3, [r7, #8]
|
|
800add8: 2b01 cmp r3, #1
|
|
800adda: d00a beq.n 800adf2 <SUBGRF_SetRfTxPower+0x42>
|
|
{
|
|
paSelect = RFO_HP;
|
|
break;
|
|
}
|
|
default:
|
|
break;
|
|
800addc: e00f b.n 800adfe <SUBGRF_SetRfTxPower+0x4e>
|
|
if (power > 15)
|
|
800adde: f997 3007 ldrsb.w r3, [r7, #7]
|
|
800ade2: 2b0f cmp r3, #15
|
|
800ade4: dd02 ble.n 800adec <SUBGRF_SetRfTxPower+0x3c>
|
|
paSelect = RFO_HP;
|
|
800ade6: 2302 movs r3, #2
|
|
800ade8: 73fb strb r3, [r7, #15]
|
|
break;
|
|
800adea: e009 b.n 800ae00 <SUBGRF_SetRfTxPower+0x50>
|
|
paSelect = RFO_LP;
|
|
800adec: 2301 movs r3, #1
|
|
800adee: 73fb strb r3, [r7, #15]
|
|
break;
|
|
800adf0: e006 b.n 800ae00 <SUBGRF_SetRfTxPower+0x50>
|
|
paSelect = RFO_LP;
|
|
800adf2: 2301 movs r3, #1
|
|
800adf4: 73fb strb r3, [r7, #15]
|
|
break;
|
|
800adf6: e003 b.n 800ae00 <SUBGRF_SetRfTxPower+0x50>
|
|
paSelect = RFO_HP;
|
|
800adf8: 2302 movs r3, #2
|
|
800adfa: 73fb strb r3, [r7, #15]
|
|
break;
|
|
800adfc: e000 b.n 800ae00 <SUBGRF_SetRfTxPower+0x50>
|
|
break;
|
|
800adfe: bf00 nop
|
|
}
|
|
|
|
SUBGRF_SetTxParams( paSelect, power, RADIO_RAMP_40_US );
|
|
800ae00: f997 1007 ldrsb.w r1, [r7, #7]
|
|
800ae04: 7bfb ldrb r3, [r7, #15]
|
|
800ae06: 2202 movs r2, #2
|
|
800ae08: 4618 mov r0, r3
|
|
800ae0a: f7ff fbb9 bl 800a580 <SUBGRF_SetTxParams>
|
|
|
|
return paSelect;
|
|
800ae0e: 7bfb ldrb r3, [r7, #15]
|
|
}
|
|
800ae10: 4618 mov r0, r3
|
|
800ae12: 3710 adds r7, #16
|
|
800ae14: 46bd mov sp, r7
|
|
800ae16: bd80 pop {r7, pc}
|
|
|
|
0800ae18 <SUBGRF_GetRadioWakeUpTime>:
|
|
|
|
uint32_t SUBGRF_GetRadioWakeUpTime( void )
|
|
{
|
|
800ae18: b480 push {r7}
|
|
800ae1a: af00 add r7, sp, #0
|
|
return RF_WAKEUP_TIME;
|
|
800ae1c: 2301 movs r3, #1
|
|
}
|
|
800ae1e: 4618 mov r0, r3
|
|
800ae20: 46bd mov sp, r7
|
|
800ae22: bc80 pop {r7}
|
|
800ae24: 4770 bx lr
|
|
...
|
|
|
|
0800ae28 <HAL_SUBGHZ_TxCpltCallback>:
|
|
|
|
/* HAL_SUBGHz Callbacks definitions */
|
|
void HAL_SUBGHZ_TxCpltCallback(SUBGHZ_HandleTypeDef *hsubghz)
|
|
{
|
|
800ae28: b580 push {r7, lr}
|
|
800ae2a: b082 sub sp, #8
|
|
800ae2c: af00 add r7, sp, #0
|
|
800ae2e: 6078 str r0, [r7, #4]
|
|
RadioOnDioIrqCb( IRQ_TX_DONE );
|
|
800ae30: 4b03 ldr r3, [pc, #12] @ (800ae40 <HAL_SUBGHZ_TxCpltCallback+0x18>)
|
|
800ae32: 681b ldr r3, [r3, #0]
|
|
800ae34: 2001 movs r0, #1
|
|
800ae36: 4798 blx r3
|
|
}
|
|
800ae38: bf00 nop
|
|
800ae3a: 3708 adds r7, #8
|
|
800ae3c: 46bd mov sp, r7
|
|
800ae3e: bd80 pop {r7, pc}
|
|
800ae40: 20000390 .word 0x20000390
|
|
|
|
0800ae44 <HAL_SUBGHZ_RxCpltCallback>:
|
|
|
|
void HAL_SUBGHZ_RxCpltCallback(SUBGHZ_HandleTypeDef *hsubghz)
|
|
{
|
|
800ae44: b580 push {r7, lr}
|
|
800ae46: b082 sub sp, #8
|
|
800ae48: af00 add r7, sp, #0
|
|
800ae4a: 6078 str r0, [r7, #4]
|
|
RadioOnDioIrqCb( IRQ_RX_DONE );
|
|
800ae4c: 4b03 ldr r3, [pc, #12] @ (800ae5c <HAL_SUBGHZ_RxCpltCallback+0x18>)
|
|
800ae4e: 681b ldr r3, [r3, #0]
|
|
800ae50: 2002 movs r0, #2
|
|
800ae52: 4798 blx r3
|
|
}
|
|
800ae54: bf00 nop
|
|
800ae56: 3708 adds r7, #8
|
|
800ae58: 46bd mov sp, r7
|
|
800ae5a: bd80 pop {r7, pc}
|
|
800ae5c: 20000390 .word 0x20000390
|
|
|
|
0800ae60 <HAL_SUBGHZ_CRCErrorCallback>:
|
|
|
|
void HAL_SUBGHZ_CRCErrorCallback (SUBGHZ_HandleTypeDef *hsubghz)
|
|
{
|
|
800ae60: b580 push {r7, lr}
|
|
800ae62: b082 sub sp, #8
|
|
800ae64: af00 add r7, sp, #0
|
|
800ae66: 6078 str r0, [r7, #4]
|
|
RadioOnDioIrqCb( IRQ_CRC_ERROR);
|
|
800ae68: 4b03 ldr r3, [pc, #12] @ (800ae78 <HAL_SUBGHZ_CRCErrorCallback+0x18>)
|
|
800ae6a: 681b ldr r3, [r3, #0]
|
|
800ae6c: 2040 movs r0, #64 @ 0x40
|
|
800ae6e: 4798 blx r3
|
|
}
|
|
800ae70: bf00 nop
|
|
800ae72: 3708 adds r7, #8
|
|
800ae74: 46bd mov sp, r7
|
|
800ae76: bd80 pop {r7, pc}
|
|
800ae78: 20000390 .word 0x20000390
|
|
|
|
0800ae7c <HAL_SUBGHZ_CADStatusCallback>:
|
|
|
|
void HAL_SUBGHZ_CADStatusCallback(SUBGHZ_HandleTypeDef *hsubghz, HAL_SUBGHZ_CadStatusTypeDef cadstatus)
|
|
{
|
|
800ae7c: b580 push {r7, lr}
|
|
800ae7e: b082 sub sp, #8
|
|
800ae80: af00 add r7, sp, #0
|
|
800ae82: 6078 str r0, [r7, #4]
|
|
800ae84: 460b mov r3, r1
|
|
800ae86: 70fb strb r3, [r7, #3]
|
|
switch (cadstatus)
|
|
800ae88: 78fb ldrb r3, [r7, #3]
|
|
800ae8a: 2b00 cmp r3, #0
|
|
800ae8c: d002 beq.n 800ae94 <HAL_SUBGHZ_CADStatusCallback+0x18>
|
|
800ae8e: 2b01 cmp r3, #1
|
|
800ae90: d005 beq.n 800ae9e <HAL_SUBGHZ_CADStatusCallback+0x22>
|
|
break;
|
|
case HAL_SUBGHZ_CAD_DETECTED:
|
|
RadioOnDioIrqCb( IRQ_CAD_DETECTED);
|
|
break;
|
|
default:
|
|
break;
|
|
800ae92: e00a b.n 800aeaa <HAL_SUBGHZ_CADStatusCallback+0x2e>
|
|
RadioOnDioIrqCb( IRQ_CAD_CLEAR);
|
|
800ae94: 4b07 ldr r3, [pc, #28] @ (800aeb4 <HAL_SUBGHZ_CADStatusCallback+0x38>)
|
|
800ae96: 681b ldr r3, [r3, #0]
|
|
800ae98: 2080 movs r0, #128 @ 0x80
|
|
800ae9a: 4798 blx r3
|
|
break;
|
|
800ae9c: e005 b.n 800aeaa <HAL_SUBGHZ_CADStatusCallback+0x2e>
|
|
RadioOnDioIrqCb( IRQ_CAD_DETECTED);
|
|
800ae9e: 4b05 ldr r3, [pc, #20] @ (800aeb4 <HAL_SUBGHZ_CADStatusCallback+0x38>)
|
|
800aea0: 681b ldr r3, [r3, #0]
|
|
800aea2: f44f 7080 mov.w r0, #256 @ 0x100
|
|
800aea6: 4798 blx r3
|
|
break;
|
|
800aea8: bf00 nop
|
|
}
|
|
}
|
|
800aeaa: bf00 nop
|
|
800aeac: 3708 adds r7, #8
|
|
800aeae: 46bd mov sp, r7
|
|
800aeb0: bd80 pop {r7, pc}
|
|
800aeb2: bf00 nop
|
|
800aeb4: 20000390 .word 0x20000390
|
|
|
|
0800aeb8 <HAL_SUBGHZ_RxTxTimeoutCallback>:
|
|
|
|
void HAL_SUBGHZ_RxTxTimeoutCallback(SUBGHZ_HandleTypeDef *hsubghz)
|
|
{
|
|
800aeb8: b580 push {r7, lr}
|
|
800aeba: b082 sub sp, #8
|
|
800aebc: af00 add r7, sp, #0
|
|
800aebe: 6078 str r0, [r7, #4]
|
|
RadioOnDioIrqCb( IRQ_RX_TX_TIMEOUT );
|
|
800aec0: 4b04 ldr r3, [pc, #16] @ (800aed4 <HAL_SUBGHZ_RxTxTimeoutCallback+0x1c>)
|
|
800aec2: 681b ldr r3, [r3, #0]
|
|
800aec4: f44f 7000 mov.w r0, #512 @ 0x200
|
|
800aec8: 4798 blx r3
|
|
}
|
|
800aeca: bf00 nop
|
|
800aecc: 3708 adds r7, #8
|
|
800aece: 46bd mov sp, r7
|
|
800aed0: bd80 pop {r7, pc}
|
|
800aed2: bf00 nop
|
|
800aed4: 20000390 .word 0x20000390
|
|
|
|
0800aed8 <HAL_SUBGHZ_HeaderErrorCallback>:
|
|
|
|
void HAL_SUBGHZ_HeaderErrorCallback(SUBGHZ_HandleTypeDef *hsubghz)
|
|
{
|
|
800aed8: b580 push {r7, lr}
|
|
800aeda: b082 sub sp, #8
|
|
800aedc: af00 add r7, sp, #0
|
|
800aede: 6078 str r0, [r7, #4]
|
|
RadioOnDioIrqCb( IRQ_HEADER_ERROR );
|
|
800aee0: 4b03 ldr r3, [pc, #12] @ (800aef0 <HAL_SUBGHZ_HeaderErrorCallback+0x18>)
|
|
800aee2: 681b ldr r3, [r3, #0]
|
|
800aee4: 2020 movs r0, #32
|
|
800aee6: 4798 blx r3
|
|
}
|
|
800aee8: bf00 nop
|
|
800aeea: 3708 adds r7, #8
|
|
800aeec: 46bd mov sp, r7
|
|
800aeee: bd80 pop {r7, pc}
|
|
800aef0: 20000390 .word 0x20000390
|
|
|
|
0800aef4 <HAL_SUBGHZ_PreambleDetectedCallback>:
|
|
|
|
void HAL_SUBGHZ_PreambleDetectedCallback(SUBGHZ_HandleTypeDef *hsubghz)
|
|
{
|
|
800aef4: b580 push {r7, lr}
|
|
800aef6: b082 sub sp, #8
|
|
800aef8: af00 add r7, sp, #0
|
|
800aefa: 6078 str r0, [r7, #4]
|
|
RadioOnDioIrqCb( IRQ_PREAMBLE_DETECTED );
|
|
800aefc: 4b03 ldr r3, [pc, #12] @ (800af0c <HAL_SUBGHZ_PreambleDetectedCallback+0x18>)
|
|
800aefe: 681b ldr r3, [r3, #0]
|
|
800af00: 2004 movs r0, #4
|
|
800af02: 4798 blx r3
|
|
}
|
|
800af04: bf00 nop
|
|
800af06: 3708 adds r7, #8
|
|
800af08: 46bd mov sp, r7
|
|
800af0a: bd80 pop {r7, pc}
|
|
800af0c: 20000390 .word 0x20000390
|
|
|
|
0800af10 <HAL_SUBGHZ_SyncWordValidCallback>:
|
|
|
|
void HAL_SUBGHZ_SyncWordValidCallback(SUBGHZ_HandleTypeDef *hsubghz)
|
|
{
|
|
800af10: b580 push {r7, lr}
|
|
800af12: b082 sub sp, #8
|
|
800af14: af00 add r7, sp, #0
|
|
800af16: 6078 str r0, [r7, #4]
|
|
RadioOnDioIrqCb( IRQ_SYNCWORD_VALID );
|
|
800af18: 4b03 ldr r3, [pc, #12] @ (800af28 <HAL_SUBGHZ_SyncWordValidCallback+0x18>)
|
|
800af1a: 681b ldr r3, [r3, #0]
|
|
800af1c: 2008 movs r0, #8
|
|
800af1e: 4798 blx r3
|
|
}
|
|
800af20: bf00 nop
|
|
800af22: 3708 adds r7, #8
|
|
800af24: 46bd mov sp, r7
|
|
800af26: bd80 pop {r7, pc}
|
|
800af28: 20000390 .word 0x20000390
|
|
|
|
0800af2c <HAL_SUBGHZ_HeaderValidCallback>:
|
|
|
|
void HAL_SUBGHZ_HeaderValidCallback(SUBGHZ_HandleTypeDef *hsubghz)
|
|
{
|
|
800af2c: b580 push {r7, lr}
|
|
800af2e: b082 sub sp, #8
|
|
800af30: af00 add r7, sp, #0
|
|
800af32: 6078 str r0, [r7, #4]
|
|
RadioOnDioIrqCb( IRQ_HEADER_VALID );
|
|
800af34: 4b03 ldr r3, [pc, #12] @ (800af44 <HAL_SUBGHZ_HeaderValidCallback+0x18>)
|
|
800af36: 681b ldr r3, [r3, #0]
|
|
800af38: 2010 movs r0, #16
|
|
800af3a: 4798 blx r3
|
|
}
|
|
800af3c: bf00 nop
|
|
800af3e: 3708 adds r7, #8
|
|
800af40: 46bd mov sp, r7
|
|
800af42: bd80 pop {r7, pc}
|
|
800af44: 20000390 .word 0x20000390
|
|
|
|
0800af48 <HAL_SUBGHZ_LrFhssHopCallback>:
|
|
|
|
void HAL_SUBGHZ_LrFhssHopCallback(SUBGHZ_HandleTypeDef *hsubghz)
|
|
{
|
|
800af48: b580 push {r7, lr}
|
|
800af4a: b082 sub sp, #8
|
|
800af4c: af00 add r7, sp, #0
|
|
800af4e: 6078 str r0, [r7, #4]
|
|
RadioOnDioIrqCb( IRQ_LR_FHSS_HOP );
|
|
800af50: 4b04 ldr r3, [pc, #16] @ (800af64 <HAL_SUBGHZ_LrFhssHopCallback+0x1c>)
|
|
800af52: 681b ldr r3, [r3, #0]
|
|
800af54: f44f 4080 mov.w r0, #16384 @ 0x4000
|
|
800af58: 4798 blx r3
|
|
}
|
|
800af5a: bf00 nop
|
|
800af5c: 3708 adds r7, #8
|
|
800af5e: 46bd mov sp, r7
|
|
800af60: bd80 pop {r7, pc}
|
|
800af62: bf00 nop
|
|
800af64: 20000390 .word 0x20000390
|
|
|
|
0800af68 <Radio_SMPS_Set>:
|
|
|
|
static void Radio_SMPS_Set(uint8_t level)
|
|
{
|
|
800af68: b580 push {r7, lr}
|
|
800af6a: b084 sub sp, #16
|
|
800af6c: af00 add r7, sp, #0
|
|
800af6e: 4603 mov r3, r0
|
|
800af70: 71fb strb r3, [r7, #7]
|
|
if ( 1U == RBI_IsDCDC() )
|
|
800af72: f002 fc82 bl 800d87a <RBI_IsDCDC>
|
|
800af76: 4603 mov r3, r0
|
|
800af78: 2b01 cmp r3, #1
|
|
800af7a: d112 bne.n 800afa2 <Radio_SMPS_Set+0x3a>
|
|
{
|
|
uint8_t modReg;
|
|
modReg= SUBGRF_ReadRegister(SUBGHZ_SMPSC2R);
|
|
800af7c: f640 1023 movw r0, #2339 @ 0x923
|
|
800af80: f7ff fe02 bl 800ab88 <SUBGRF_ReadRegister>
|
|
800af84: 4603 mov r3, r0
|
|
800af86: 73fb strb r3, [r7, #15]
|
|
modReg&= (~SMPS_DRV_MASK);
|
|
800af88: 7bfb ldrb r3, [r7, #15]
|
|
800af8a: f023 0306 bic.w r3, r3, #6
|
|
800af8e: 73fb strb r3, [r7, #15]
|
|
SUBGRF_WriteRegister(SUBGHZ_SMPSC2R, modReg | level);
|
|
800af90: 7bfa ldrb r2, [r7, #15]
|
|
800af92: 79fb ldrb r3, [r7, #7]
|
|
800af94: 4313 orrs r3, r2
|
|
800af96: b2db uxtb r3, r3
|
|
800af98: 4619 mov r1, r3
|
|
800af9a: f640 1023 movw r0, #2339 @ 0x923
|
|
800af9e: f7ff fdd1 bl 800ab44 <SUBGRF_WriteRegister>
|
|
}
|
|
}
|
|
800afa2: bf00 nop
|
|
800afa4: 3710 adds r7, #16
|
|
800afa6: 46bd mov sp, r7
|
|
800afa8: bd80 pop {r7, pc}
|
|
...
|
|
|
|
0800afac <SUBGRF_GetFskBandwidthRegValue>:
|
|
|
|
uint8_t SUBGRF_GetFskBandwidthRegValue( uint32_t bandwidth )
|
|
{
|
|
800afac: b480 push {r7}
|
|
800afae: b085 sub sp, #20
|
|
800afb0: af00 add r7, sp, #0
|
|
800afb2: 6078 str r0, [r7, #4]
|
|
uint8_t i;
|
|
|
|
if( bandwidth == 0 )
|
|
800afb4: 687b ldr r3, [r7, #4]
|
|
800afb6: 2b00 cmp r3, #0
|
|
800afb8: d101 bne.n 800afbe <SUBGRF_GetFskBandwidthRegValue+0x12>
|
|
{
|
|
return( 0x1F );
|
|
800afba: 231f movs r3, #31
|
|
800afbc: e017 b.n 800afee <SUBGRF_GetFskBandwidthRegValue+0x42>
|
|
}
|
|
|
|
for( i = 0; i < ( sizeof( FskBandwidths ) / sizeof( FskBandwidth_t ) ); i++ )
|
|
800afbe: 2300 movs r3, #0
|
|
800afc0: 73fb strb r3, [r7, #15]
|
|
800afc2: e00f b.n 800afe4 <SUBGRF_GetFskBandwidthRegValue+0x38>
|
|
{
|
|
if ( bandwidth < FskBandwidths[i].bandwidth )
|
|
800afc4: 7bfb ldrb r3, [r7, #15]
|
|
800afc6: 4a0c ldr r2, [pc, #48] @ (800aff8 <SUBGRF_GetFskBandwidthRegValue+0x4c>)
|
|
800afc8: f852 3033 ldr.w r3, [r2, r3, lsl #3]
|
|
800afcc: 687a ldr r2, [r7, #4]
|
|
800afce: 429a cmp r2, r3
|
|
800afd0: d205 bcs.n 800afde <SUBGRF_GetFskBandwidthRegValue+0x32>
|
|
{
|
|
return FskBandwidths[i].RegValue;
|
|
800afd2: 7bfb ldrb r3, [r7, #15]
|
|
800afd4: 4a08 ldr r2, [pc, #32] @ (800aff8 <SUBGRF_GetFskBandwidthRegValue+0x4c>)
|
|
800afd6: 00db lsls r3, r3, #3
|
|
800afd8: 4413 add r3, r2
|
|
800afda: 791b ldrb r3, [r3, #4]
|
|
800afdc: e007 b.n 800afee <SUBGRF_GetFskBandwidthRegValue+0x42>
|
|
for( i = 0; i < ( sizeof( FskBandwidths ) / sizeof( FskBandwidth_t ) ); i++ )
|
|
800afde: 7bfb ldrb r3, [r7, #15]
|
|
800afe0: 3301 adds r3, #1
|
|
800afe2: 73fb strb r3, [r7, #15]
|
|
800afe4: 7bfb ldrb r3, [r7, #15]
|
|
800afe6: 2b15 cmp r3, #21
|
|
800afe8: d9ec bls.n 800afc4 <SUBGRF_GetFskBandwidthRegValue+0x18>
|
|
}
|
|
}
|
|
// ERROR: Value not found
|
|
while( 1 );
|
|
800afea: bf00 nop
|
|
800afec: e7fd b.n 800afea <SUBGRF_GetFskBandwidthRegValue+0x3e>
|
|
}
|
|
800afee: 4618 mov r0, r3
|
|
800aff0: 3714 adds r7, #20
|
|
800aff2: 46bd mov sp, r7
|
|
800aff4: bc80 pop {r7}
|
|
800aff6: 4770 bx lr
|
|
800aff8: 08010454 .word 0x08010454
|
|
|
|
0800affc <SUBGRF_GetCFO>:
|
|
void SUBGRF_GetCFO( uint32_t bitRate, int32_t *cfo)
|
|
{
|
|
800affc: b580 push {r7, lr}
|
|
800affe: b08a sub sp, #40 @ 0x28
|
|
800b000: af00 add r7, sp, #0
|
|
800b002: 6078 str r0, [r7, #4]
|
|
800b004: 6039 str r1, [r7, #0]
|
|
uint8_t BwMant[] = {4, 8, 10, 12};
|
|
800b006: 4b35 ldr r3, [pc, #212] @ (800b0dc <SUBGRF_GetCFO+0xe0>)
|
|
800b008: 60fb str r3, [r7, #12]
|
|
/* read demod bandwidth: mant bit4:3, exp bits 2:0 */
|
|
uint8_t reg = (SUBGRF_ReadRegister( SUBGHZ_BWSELR ));
|
|
800b00a: f640 0007 movw r0, #2055 @ 0x807
|
|
800b00e: f7ff fdbb bl 800ab88 <SUBGRF_ReadRegister>
|
|
800b012: 4603 mov r3, r0
|
|
800b014: 77fb strb r3, [r7, #31]
|
|
uint8_t bandwidth_mant = BwMant[( reg >> 3 ) & 0x3];
|
|
800b016: 7ffb ldrb r3, [r7, #31]
|
|
800b018: 08db lsrs r3, r3, #3
|
|
800b01a: b2db uxtb r3, r3
|
|
800b01c: f003 0303 and.w r3, r3, #3
|
|
800b020: 3328 adds r3, #40 @ 0x28
|
|
800b022: 443b add r3, r7
|
|
800b024: f813 3c1c ldrb.w r3, [r3, #-28]
|
|
800b028: 77bb strb r3, [r7, #30]
|
|
uint8_t bandwidth_exp = reg & 0x7;
|
|
800b02a: 7ffb ldrb r3, [r7, #31]
|
|
800b02c: f003 0307 and.w r3, r3, #7
|
|
800b030: 777b strb r3, [r7, #29]
|
|
uint32_t cf_fs = XTAL_FREQ / ( bandwidth_mant * ( 1 << ( bandwidth_exp + 1 )));
|
|
800b032: 7fba ldrb r2, [r7, #30]
|
|
800b034: 7f7b ldrb r3, [r7, #29]
|
|
800b036: 3301 adds r3, #1
|
|
800b038: fa02 f303 lsl.w r3, r2, r3
|
|
800b03c: 461a mov r2, r3
|
|
800b03e: 4b28 ldr r3, [pc, #160] @ (800b0e0 <SUBGRF_GetCFO+0xe4>)
|
|
800b040: fbb3 f3f2 udiv r3, r3, r2
|
|
800b044: 61bb str r3, [r7, #24]
|
|
uint32_t cf_osr = cf_fs / bitRate;
|
|
800b046: 69ba ldr r2, [r7, #24]
|
|
800b048: 687b ldr r3, [r7, #4]
|
|
800b04a: fbb2 f3f3 udiv r3, r2, r3
|
|
800b04e: 617b str r3, [r7, #20]
|
|
uint8_t interp = 1;
|
|
800b050: 2301 movs r3, #1
|
|
800b052: f887 3027 strb.w r3, [r7, #39] @ 0x27
|
|
/* calculate demod interpolation factor */
|
|
if (cf_osr * interp < 8)
|
|
800b056: f897 3027 ldrb.w r3, [r7, #39] @ 0x27
|
|
800b05a: 697a ldr r2, [r7, #20]
|
|
800b05c: fb02 f303 mul.w r3, r2, r3
|
|
800b060: 2b07 cmp r3, #7
|
|
800b062: d802 bhi.n 800b06a <SUBGRF_GetCFO+0x6e>
|
|
{
|
|
interp = 2;
|
|
800b064: 2302 movs r3, #2
|
|
800b066: f887 3027 strb.w r3, [r7, #39] @ 0x27
|
|
}
|
|
if (cf_osr * interp < 4)
|
|
800b06a: f897 3027 ldrb.w r3, [r7, #39] @ 0x27
|
|
800b06e: 697a ldr r2, [r7, #20]
|
|
800b070: fb02 f303 mul.w r3, r2, r3
|
|
800b074: 2b03 cmp r3, #3
|
|
800b076: d802 bhi.n 800b07e <SUBGRF_GetCFO+0x82>
|
|
{
|
|
interp = 4;
|
|
800b078: 2304 movs r3, #4
|
|
800b07a: f887 3027 strb.w r3, [r7, #39] @ 0x27
|
|
}
|
|
/* calculate demod sampling frequency */
|
|
uint32_t fs = cf_fs* interp;
|
|
800b07e: f897 2027 ldrb.w r2, [r7, #39] @ 0x27
|
|
800b082: 69bb ldr r3, [r7, #24]
|
|
800b084: fb02 f303 mul.w r3, r2, r3
|
|
800b088: 613b str r3, [r7, #16]
|
|
/* get the cfo registers */
|
|
int32_t cfo_bin = ( SUBGRF_ReadRegister( SUBGHZ_GCFORH ) & 0xF ) << 8;
|
|
800b08a: f44f 60d6 mov.w r0, #1712 @ 0x6b0
|
|
800b08e: f7ff fd7b bl 800ab88 <SUBGRF_ReadRegister>
|
|
800b092: 4603 mov r3, r0
|
|
800b094: 021b lsls r3, r3, #8
|
|
800b096: f403 6370 and.w r3, r3, #3840 @ 0xf00
|
|
800b09a: 623b str r3, [r7, #32]
|
|
cfo_bin |= SUBGRF_ReadRegister( SUBGHZ_GCFORL );
|
|
800b09c: f240 60b1 movw r0, #1713 @ 0x6b1
|
|
800b0a0: f7ff fd72 bl 800ab88 <SUBGRF_ReadRegister>
|
|
800b0a4: 4603 mov r3, r0
|
|
800b0a6: 461a mov r2, r3
|
|
800b0a8: 6a3b ldr r3, [r7, #32]
|
|
800b0aa: 4313 orrs r3, r2
|
|
800b0ac: 623b str r3, [r7, #32]
|
|
/* negate if 12 bits sign bit is 1 */
|
|
if (( cfo_bin & 0x800 ) == 0x800 )
|
|
800b0ae: 6a3b ldr r3, [r7, #32]
|
|
800b0b0: f403 6300 and.w r3, r3, #2048 @ 0x800
|
|
800b0b4: 2b00 cmp r3, #0
|
|
800b0b6: d005 beq.n 800b0c4 <SUBGRF_GetCFO+0xc8>
|
|
{
|
|
cfo_bin |= 0xFFFFF000;
|
|
800b0b8: 6a3b ldr r3, [r7, #32]
|
|
800b0ba: ea6f 5303 mvn.w r3, r3, lsl #20
|
|
800b0be: ea6f 5313 mvn.w r3, r3, lsr #20
|
|
800b0c2: 623b str r3, [r7, #32]
|
|
}
|
|
/* calculate cfo in Hz */
|
|
/* shift by 5 first to not saturate, cfo_bin on 12bits */
|
|
*cfo = ((int32_t)( cfo_bin * ( fs >> 5 ))) >> ( 12 - 5 );
|
|
800b0c4: 693b ldr r3, [r7, #16]
|
|
800b0c6: 095b lsrs r3, r3, #5
|
|
800b0c8: 6a3a ldr r2, [r7, #32]
|
|
800b0ca: fb02 f303 mul.w r3, r2, r3
|
|
800b0ce: 11da asrs r2, r3, #7
|
|
800b0d0: 683b ldr r3, [r7, #0]
|
|
800b0d2: 601a str r2, [r3, #0]
|
|
}
|
|
800b0d4: bf00 nop
|
|
800b0d6: 3728 adds r7, #40 @ 0x28
|
|
800b0d8: 46bd mov sp, r7
|
|
800b0da: bd80 pop {r7, pc}
|
|
800b0dc: 0c0a0804 .word 0x0c0a0804
|
|
800b0e0: 01e84800 .word 0x01e84800
|
|
|
|
0800b0e4 <LL_DBGMCU_GetRevisionID>:
|
|
{
|
|
800b0e4: b480 push {r7}
|
|
800b0e6: af00 add r7, sp, #0
|
|
return (uint32_t)(READ_BIT(DBGMCU->IDCODE, DBGMCU_IDCODE_REV_ID) >> DBGMCU_IDCODE_REV_ID_Pos);
|
|
800b0e8: 4b03 ldr r3, [pc, #12] @ (800b0f8 <LL_DBGMCU_GetRevisionID+0x14>)
|
|
800b0ea: 681b ldr r3, [r3, #0]
|
|
800b0ec: 0c1b lsrs r3, r3, #16
|
|
800b0ee: b29b uxth r3, r3
|
|
}
|
|
800b0f0: 4618 mov r0, r3
|
|
800b0f2: 46bd mov sp, r7
|
|
800b0f4: bc80 pop {r7}
|
|
800b0f6: 4770 bx lr
|
|
800b0f8: e0042000 .word 0xe0042000
|
|
|
|
0800b0fc <LL_GPIO_SetOutputPin>:
|
|
{
|
|
800b0fc: b480 push {r7}
|
|
800b0fe: b083 sub sp, #12
|
|
800b100: af00 add r7, sp, #0
|
|
800b102: 6078 str r0, [r7, #4]
|
|
800b104: 6039 str r1, [r7, #0]
|
|
WRITE_REG(GPIOx->BSRR, PinMask);
|
|
800b106: 687b ldr r3, [r7, #4]
|
|
800b108: 683a ldr r2, [r7, #0]
|
|
800b10a: 619a str r2, [r3, #24]
|
|
}
|
|
800b10c: bf00 nop
|
|
800b10e: 370c adds r7, #12
|
|
800b110: 46bd mov sp, r7
|
|
800b112: bc80 pop {r7}
|
|
800b114: 4770 bx lr
|
|
|
|
0800b116 <LL_GPIO_ResetOutputPin>:
|
|
{
|
|
800b116: b480 push {r7}
|
|
800b118: b083 sub sp, #12
|
|
800b11a: af00 add r7, sp, #0
|
|
800b11c: 6078 str r0, [r7, #4]
|
|
800b11e: 6039 str r1, [r7, #0]
|
|
WRITE_REG(GPIOx->BRR, PinMask);
|
|
800b120: 687b ldr r3, [r7, #4]
|
|
800b122: 683a ldr r2, [r7, #0]
|
|
800b124: 629a str r2, [r3, #40] @ 0x28
|
|
}
|
|
800b126: bf00 nop
|
|
800b128: 370c adds r7, #12
|
|
800b12a: 46bd mov sp, r7
|
|
800b12c: bc80 pop {r7}
|
|
800b12e: 4770 bx lr
|
|
|
|
0800b130 <RFW_TransmitLongPacket>:
|
|
#endif /* RFW_ENABLE == 1 */
|
|
|
|
/* Exported functions --------------------------------------------------------*/
|
|
int32_t RFW_TransmitLongPacket( uint16_t payload_size, uint32_t timeout,
|
|
void ( *TxLongPacketGetNextChunkCb )( uint8_t **buffer, uint8_t buffer_size ) )
|
|
{
|
|
800b130: b580 push {r7, lr}
|
|
800b132: b08e sub sp, #56 @ 0x38
|
|
800b134: af02 add r7, sp, #8
|
|
800b136: 4603 mov r3, r0
|
|
800b138: 60b9 str r1, [r7, #8]
|
|
800b13a: 607a str r2, [r7, #4]
|
|
800b13c: 81fb strh r3, [r7, #14]
|
|
int32_t status = 0;
|
|
800b13e: 2300 movs r3, #0
|
|
800b140: 62fb str r3, [r7, #44] @ 0x2c
|
|
#if (RFW_LONGPACKET_ENABLE == 1 )
|
|
uint32_t total_size = payload_size + RFWPacket.Init.PayloadLengthFieldSize + RFWPacket.Init.CrcFieldSize;
|
|
800b142: 89fb ldrh r3, [r7, #14]
|
|
800b144: 4ab0 ldr r2, [pc, #704] @ (800b408 <RFW_TransmitLongPacket+0x2d8>)
|
|
800b146: 7852 ldrb r2, [r2, #1]
|
|
800b148: 4413 add r3, r2
|
|
800b14a: 4aaf ldr r2, [pc, #700] @ (800b408 <RFW_TransmitLongPacket+0x2d8>)
|
|
800b14c: 78d2 ldrb r2, [r2, #3]
|
|
800b14e: 4413 add r3, r2
|
|
800b150: 627b str r3, [r7, #36] @ 0x24
|
|
|
|
RFW_MW_LOG( TS_ON, VLEVEL_M, "RevID=%04X\r\n", LL_DBGMCU_GetRevisionID() );
|
|
800b152: f7ff ffc7 bl 800b0e4 <LL_DBGMCU_GetRevisionID>
|
|
800b156: 4603 mov r3, r0
|
|
800b158: 9300 str r3, [sp, #0]
|
|
800b15a: 4bac ldr r3, [pc, #688] @ (800b40c <RFW_TransmitLongPacket+0x2dc>)
|
|
800b15c: 2201 movs r2, #1
|
|
800b15e: 2100 movs r1, #0
|
|
800b160: 2002 movs r0, #2
|
|
800b162: f003 fb43 bl 800e7ec <UTIL_ADV_TRACE_COND_FSend>
|
|
|
|
if( ( TxLongPacketGetNextChunkCb == NULL ) ||
|
|
800b166: 687b ldr r3, [r7, #4]
|
|
800b168: 2b00 cmp r3, #0
|
|
800b16a: d012 beq.n 800b192 <RFW_TransmitLongPacket+0x62>
|
|
( payload_size > ( 1 << ( 8 * RFWPacket.Init.PayloadLengthFieldSize ) ) - 1 ) || /*check that size fits inside the packetLengthField*/
|
|
800b16c: 4ba6 ldr r3, [pc, #664] @ (800b408 <RFW_TransmitLongPacket+0x2d8>)
|
|
800b16e: 785b ldrb r3, [r3, #1]
|
|
800b170: 00db lsls r3, r3, #3
|
|
800b172: 2201 movs r2, #1
|
|
800b174: 409a lsls r2, r3
|
|
800b176: 89fb ldrh r3, [r7, #14]
|
|
if( ( TxLongPacketGetNextChunkCb == NULL ) ||
|
|
800b178: 429a cmp r2, r3
|
|
800b17a: dd0a ble.n 800b192 <RFW_TransmitLongPacket+0x62>
|
|
( RFWPacket.Init.Enable == 0 ) || /* Can only be used when after RadioSetTxGenericConfig*/
|
|
800b17c: 4ba2 ldr r3, [pc, #648] @ (800b408 <RFW_TransmitLongPacket+0x2d8>)
|
|
800b17e: 781b ldrb r3, [r3, #0]
|
|
( payload_size > ( 1 << ( 8 * RFWPacket.Init.PayloadLengthFieldSize ) ) - 1 ) || /*check that size fits inside the packetLengthField*/
|
|
800b180: 2b00 cmp r3, #0
|
|
800b182: d006 beq.n 800b192 <RFW_TransmitLongPacket+0x62>
|
|
( LL_DBGMCU_GetRevisionID() < 0x1003 ) ) /* Only available from stm32wl revision Y*/
|
|
800b184: f7ff ffae bl 800b0e4 <LL_DBGMCU_GetRevisionID>
|
|
800b188: 4603 mov r3, r0
|
|
( RFWPacket.Init.Enable == 0 ) || /* Can only be used when after RadioSetTxGenericConfig*/
|
|
800b18a: f241 0202 movw r2, #4098 @ 0x1002
|
|
800b18e: 4293 cmp r3, r2
|
|
800b190: d803 bhi.n 800b19a <RFW_TransmitLongPacket+0x6a>
|
|
{
|
|
status = -1;
|
|
800b192: f04f 33ff mov.w r3, #4294967295 @ 0xffffffff
|
|
800b196: 62fb str r3, [r7, #44] @ 0x2c
|
|
800b198: e130 b.n 800b3fc <RFW_TransmitLongPacket+0x2cc>
|
|
}
|
|
else
|
|
{
|
|
/*chunk buffer pointer fed by the application*/
|
|
uint8_t *app_chunk_buffer_ptr = NULL;
|
|
800b19a: 2300 movs r3, #0
|
|
800b19c: 61bb str r3, [r7, #24]
|
|
uint8_t chunk_size;
|
|
uint8_t crc_size;
|
|
/*timeout for next chunk*/
|
|
uint32_t chunk_timeout;
|
|
/*Records call back*/
|
|
RFWPacket.TxLongPacketGetNextChunkCb = TxLongPacketGetNextChunkCb;
|
|
800b19e: 4a9a ldr r2, [pc, #616] @ (800b408 <RFW_TransmitLongPacket+0x2d8>)
|
|
800b1a0: 687b ldr r3, [r7, #4]
|
|
800b1a2: 6413 str r3, [r2, #64] @ 0x40
|
|
|
|
/* Radio IRQ is set to DIO1 by default */
|
|
SUBGRF_SetDioIrqParams( IRQ_TX_DONE | IRQ_RX_TX_TIMEOUT,
|
|
800b1a4: 2300 movs r3, #0
|
|
800b1a6: 2200 movs r2, #0
|
|
800b1a8: f240 2101 movw r1, #513 @ 0x201
|
|
800b1ac: f240 2001 movw r0, #513 @ 0x201
|
|
800b1b0: f7ff f91e bl 800a3f0 <SUBGRF_SetDioIrqParams>
|
|
IRQ_TX_DONE | IRQ_RX_TX_TIMEOUT,
|
|
IRQ_RADIO_NONE,
|
|
IRQ_RADIO_NONE );
|
|
|
|
/* Set DBG pin */
|
|
DBG_GPIO_RADIO_TX( SET );
|
|
800b1b4: f44f 5100 mov.w r1, #8192 @ 0x2000
|
|
800b1b8: 4895 ldr r0, [pc, #596] @ (800b410 <RFW_TransmitLongPacket+0x2e0>)
|
|
800b1ba: f7ff ff9f bl 800b0fc <LL_GPIO_SetOutputPin>
|
|
/* Set RF switch */
|
|
SUBGRF_SetSwitch( RFWPacket.AntSwitchPaSelect, RFSWITCH_TX );
|
|
800b1be: 4b92 ldr r3, [pc, #584] @ (800b408 <RFW_TransmitLongPacket+0x2d8>)
|
|
800b1c0: f893 3044 ldrb.w r3, [r3, #68] @ 0x44
|
|
800b1c4: 2101 movs r1, #1
|
|
800b1c6: 4618 mov r0, r3
|
|
800b1c8: f7ff fdca bl 800ad60 <SUBGRF_SetSwitch>
|
|
|
|
switch( RFWPacket.Init.Modem )
|
|
800b1cc: 4b8e ldr r3, [pc, #568] @ (800b408 <RFW_TransmitLongPacket+0x2d8>)
|
|
800b1ce: 7b9b ldrb r3, [r3, #14]
|
|
800b1d0: 2b04 cmp r3, #4
|
|
800b1d2: f200 8110 bhi.w 800b3f6 <RFW_TransmitLongPacket+0x2c6>
|
|
800b1d6: a201 add r2, pc, #4 @ (adr r2, 800b1dc <RFW_TransmitLongPacket+0xac>)
|
|
800b1d8: f852 f023 ldr.w pc, [r2, r3, lsl #2]
|
|
800b1dc: 0800b1f1 .word 0x0800b1f1
|
|
800b1e0: 0800b3df .word 0x0800b3df
|
|
800b1e4: 0800b1f1 .word 0x0800b1f1
|
|
800b1e8: 0800b3e7 .word 0x0800b3e7
|
|
800b1ec: 0800b3ef .word 0x0800b3ef
|
|
{
|
|
case MODEM_FSK:
|
|
case MODEM_MSK:
|
|
{
|
|
if( RFWPacket.Init.Enable == 1 )
|
|
800b1f0: 4b85 ldr r3, [pc, #532] @ (800b408 <RFW_TransmitLongPacket+0x2d8>)
|
|
800b1f2: 781b ldrb r3, [r3, #0]
|
|
800b1f4: 2b01 cmp r3, #1
|
|
800b1f6: f040 80ee bne.w 800b3d6 <RFW_TransmitLongPacket+0x2a6>
|
|
{
|
|
/*crc will be calculated on the fly along with packet chunk transmission*/
|
|
uint8_t crc_result[2];
|
|
/*init radio buffer offset*/
|
|
RFWPacket.RadioBufferOffset = 0;
|
|
800b1fa: 4b83 ldr r3, [pc, #524] @ (800b408 <RFW_TransmitLongPacket+0x2d8>)
|
|
800b1fc: 2200 movs r2, #0
|
|
800b1fe: f883 2036 strb.w r2, [r3, #54] @ 0x36
|
|
/*long packet mode enable*/
|
|
RFWPacket.LongPacketModeEnable = 1;
|
|
800b202: 4b81 ldr r3, [pc, #516] @ (800b408 <RFW_TransmitLongPacket+0x2d8>)
|
|
800b204: 2201 movs r2, #1
|
|
800b206: 769a strb r2, [r3, #26]
|
|
/*Remaining bytes to transmit*/
|
|
RFWPacket.LongPacketRemainingBytes = total_size;
|
|
800b208: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
800b20a: b29a uxth r2, r3
|
|
800b20c: 4b7e ldr r3, [pc, #504] @ (800b408 <RFW_TransmitLongPacket+0x2d8>)
|
|
800b20e: 869a strh r2, [r3, #52] @ 0x34
|
|
/*Records total payload bytes to transmit*/
|
|
RFWPacket.PayloadLength = total_size;
|
|
800b210: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
800b212: b29a uxth r2, r3
|
|
800b214: 4b7c ldr r3, [pc, #496] @ (800b408 <RFW_TransmitLongPacket+0x2d8>)
|
|
800b216: 831a strh r2, [r3, #24]
|
|
if( total_size > RADIO_BUF_SIZE )
|
|
800b218: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
800b21a: 2bff cmp r3, #255 @ 0xff
|
|
800b21c: d919 bls.n 800b252 <RFW_TransmitLongPacket+0x122>
|
|
{
|
|
/*cut in chunk*/
|
|
if( total_size < RADIO_BUF_SIZE + RFWPacket.Init.CrcFieldSize )
|
|
800b21e: 4b7a ldr r3, [pc, #488] @ (800b408 <RFW_TransmitLongPacket+0x2d8>)
|
|
800b220: 78db ldrb r3, [r3, #3]
|
|
800b222: 33ff adds r3, #255 @ 0xff
|
|
800b224: 461a mov r2, r3
|
|
800b226: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
800b228: 4293 cmp r3, r2
|
|
800b22a: d209 bcs.n 800b240 <RFW_TransmitLongPacket+0x110>
|
|
{
|
|
/*reduce chunk so that crc is treated in the next chunk*/
|
|
chunk_size = RADIO_BUF_SIZE - RFWPacket.Init.PayloadLengthFieldSize - RFWPacket.Init.CrcFieldSize;
|
|
800b22c: 4b76 ldr r3, [pc, #472] @ (800b408 <RFW_TransmitLongPacket+0x2d8>)
|
|
800b22e: 785b ldrb r3, [r3, #1]
|
|
800b230: 43db mvns r3, r3
|
|
800b232: b2da uxtb r2, r3
|
|
800b234: 4b74 ldr r3, [pc, #464] @ (800b408 <RFW_TransmitLongPacket+0x2d8>)
|
|
800b236: 78db ldrb r3, [r3, #3]
|
|
800b238: 1ad3 subs r3, r2, r3
|
|
800b23a: f887 302b strb.w r3, [r7, #43] @ 0x2b
|
|
800b23e: e004 b.n 800b24a <RFW_TransmitLongPacket+0x11a>
|
|
}
|
|
else
|
|
{
|
|
chunk_size = RADIO_BUF_SIZE - RFWPacket.Init.PayloadLengthFieldSize;
|
|
800b240: 4b71 ldr r3, [pc, #452] @ (800b408 <RFW_TransmitLongPacket+0x2d8>)
|
|
800b242: 785b ldrb r3, [r3, #1]
|
|
800b244: 43db mvns r3, r3
|
|
800b246: f887 302b strb.w r3, [r7, #43] @ 0x2b
|
|
}
|
|
/*Set crc size for the crc calculation: no crc here because it is not the end of the packet*/
|
|
crc_size = 0;
|
|
800b24a: 2300 movs r3, #0
|
|
800b24c: f887 302a strb.w r3, [r7, #42] @ 0x2a
|
|
800b250: e006 b.n 800b260 <RFW_TransmitLongPacket+0x130>
|
|
}
|
|
else
|
|
{
|
|
chunk_size = payload_size;
|
|
800b252: 89fb ldrh r3, [r7, #14]
|
|
800b254: f887 302b strb.w r3, [r7, #43] @ 0x2b
|
|
/*Set crc size for the crc calculation*/
|
|
crc_size = RFWPacket.Init.CrcFieldSize;
|
|
800b258: 4b6b ldr r3, [pc, #428] @ (800b408 <RFW_TransmitLongPacket+0x2d8>)
|
|
800b25a: 78db ldrb r3, [r3, #3]
|
|
800b25c: f887 302a strb.w r3, [r7, #42] @ 0x2a
|
|
}
|
|
/* Prepend payload size before Payload*/
|
|
if( RFWPacket.Init.PayloadLengthFieldSize == 1 )
|
|
800b260: 4b69 ldr r3, [pc, #420] @ (800b408 <RFW_TransmitLongPacket+0x2d8>)
|
|
800b262: 785b ldrb r3, [r3, #1]
|
|
800b264: 2b01 cmp r3, #1
|
|
800b266: d104 bne.n 800b272 <RFW_TransmitLongPacket+0x142>
|
|
{
|
|
ChunkBuffer[0] = payload_size;
|
|
800b268: 89fb ldrh r3, [r7, #14]
|
|
800b26a: b2da uxtb r2, r3
|
|
800b26c: 4b69 ldr r3, [pc, #420] @ (800b414 <RFW_TransmitLongPacket+0x2e4>)
|
|
800b26e: 701a strb r2, [r3, #0]
|
|
800b270: e009 b.n 800b286 <RFW_TransmitLongPacket+0x156>
|
|
}
|
|
else
|
|
{
|
|
ChunkBuffer[0] = ( uint8_t )( ( payload_size ) >> 8 );
|
|
800b272: 89fb ldrh r3, [r7, #14]
|
|
800b274: 0a1b lsrs r3, r3, #8
|
|
800b276: b29b uxth r3, r3
|
|
800b278: b2da uxtb r2, r3
|
|
800b27a: 4b66 ldr r3, [pc, #408] @ (800b414 <RFW_TransmitLongPacket+0x2e4>)
|
|
800b27c: 701a strb r2, [r3, #0]
|
|
ChunkBuffer[1] = ( uint8_t )( ( payload_size ) & 0xFF );
|
|
800b27e: 89fb ldrh r3, [r7, #14]
|
|
800b280: b2da uxtb r2, r3
|
|
800b282: 4b64 ldr r3, [pc, #400] @ (800b414 <RFW_TransmitLongPacket+0x2e4>)
|
|
800b284: 705a strb r2, [r3, #1]
|
|
}
|
|
/* Get Tx chunk from app*/
|
|
TxLongPacketGetNextChunkCb( &app_chunk_buffer_ptr, chunk_size );
|
|
800b286: f897 102b ldrb.w r1, [r7, #43] @ 0x2b
|
|
800b28a: f107 0218 add.w r2, r7, #24
|
|
800b28e: 687b ldr r3, [r7, #4]
|
|
800b290: 4610 mov r0, r2
|
|
800b292: 4798 blx r3
|
|
|
|
/* Copy first chunk in ChunkBuffer Buffer*/
|
|
RADIO_MEMCPY8( &ChunkBuffer[RFWPacket.Init.PayloadLengthFieldSize], app_chunk_buffer_ptr, chunk_size );
|
|
800b294: 4b5c ldr r3, [pc, #368] @ (800b408 <RFW_TransmitLongPacket+0x2d8>)
|
|
800b296: 785b ldrb r3, [r3, #1]
|
|
800b298: 461a mov r2, r3
|
|
800b29a: 4b5e ldr r3, [pc, #376] @ (800b414 <RFW_TransmitLongPacket+0x2e4>)
|
|
800b29c: 4413 add r3, r2
|
|
800b29e: 69b9 ldr r1, [r7, #24]
|
|
800b2a0: f897 202b ldrb.w r2, [r7, #43] @ 0x2b
|
|
800b2a4: b292 uxth r2, r2
|
|
800b2a6: 4618 mov r0, r3
|
|
800b2a8: f002 fba2 bl 800d9f0 <UTIL_MEM_cpy_8>
|
|
|
|
if( RFWPacket.Init.CrcEnable == 1 )
|
|
800b2ac: 4b56 ldr r3, [pc, #344] @ (800b408 <RFW_TransmitLongPacket+0x2d8>)
|
|
800b2ae: 789b ldrb r3, [r3, #2]
|
|
800b2b0: 2b01 cmp r3, #1
|
|
800b2b2: d11f bne.n 800b2f4 <RFW_TransmitLongPacket+0x1c4>
|
|
{
|
|
/* Set the state of the Crc to crc_seed*/
|
|
RFW_CrcSetState( &RFWPacket );
|
|
800b2b4: 4854 ldr r0, [pc, #336] @ (800b408 <RFW_TransmitLongPacket+0x2d8>)
|
|
800b2b6: f000 fc57 bl 800bb68 <RFW_CrcSetState>
|
|
/* Run the crc calculation on payload length and payload*/
|
|
RFW_CrcRun( &RFWPacket, ChunkBuffer, RFWPacket.Init.PayloadLengthFieldSize + chunk_size, crc_result );
|
|
800b2ba: 4b53 ldr r3, [pc, #332] @ (800b408 <RFW_TransmitLongPacket+0x2d8>)
|
|
800b2bc: 785b ldrb r3, [r3, #1]
|
|
800b2be: 461a mov r2, r3
|
|
800b2c0: f897 302b ldrb.w r3, [r7, #43] @ 0x2b
|
|
800b2c4: 4413 add r3, r2
|
|
800b2c6: 461a mov r2, r3
|
|
800b2c8: f107 0314 add.w r3, r7, #20
|
|
800b2cc: 4951 ldr r1, [pc, #324] @ (800b414 <RFW_TransmitLongPacket+0x2e4>)
|
|
800b2ce: 484e ldr r0, [pc, #312] @ (800b408 <RFW_TransmitLongPacket+0x2d8>)
|
|
800b2d0: f000 fc9f bl 800bc12 <RFW_CrcRun>
|
|
/* Append the crc result after the payload if total_size<= RADIO_BUF_SIZE*/
|
|
RADIO_MEMCPY8( &ChunkBuffer[RFWPacket.Init.PayloadLengthFieldSize + chunk_size], crc_result, crc_size );
|
|
800b2d4: 4b4c ldr r3, [pc, #304] @ (800b408 <RFW_TransmitLongPacket+0x2d8>)
|
|
800b2d6: 785b ldrb r3, [r3, #1]
|
|
800b2d8: 461a mov r2, r3
|
|
800b2da: f897 302b ldrb.w r3, [r7, #43] @ 0x2b
|
|
800b2de: 4413 add r3, r2
|
|
800b2e0: 4a4c ldr r2, [pc, #304] @ (800b414 <RFW_TransmitLongPacket+0x2e4>)
|
|
800b2e2: 4413 add r3, r2
|
|
800b2e4: f897 202a ldrb.w r2, [r7, #42] @ 0x2a
|
|
800b2e8: b292 uxth r2, r2
|
|
800b2ea: f107 0114 add.w r1, r7, #20
|
|
800b2ee: 4618 mov r0, r3
|
|
800b2f0: f002 fb7e bl 800d9f0 <UTIL_MEM_cpy_8>
|
|
}
|
|
/* Init whitening at beginning of the packet*/
|
|
RFW_WhiteSetState( &RFWPacket );
|
|
800b2f4: 4844 ldr r0, [pc, #272] @ (800b408 <RFW_TransmitLongPacket+0x2d8>)
|
|
800b2f6: f000 fc0f bl 800bb18 <RFW_WhiteSetState>
|
|
/* Run the whitening calculation on payload length, payload and crc if crc fits inside 1st chunk*/
|
|
RFW_WhiteRun( &RFWPacket, &ChunkBuffer[0], RFWPacket.Init.PayloadLengthFieldSize + chunk_size + crc_size );
|
|
800b2fa: 4b43 ldr r3, [pc, #268] @ (800b408 <RFW_TransmitLongPacket+0x2d8>)
|
|
800b2fc: 785b ldrb r3, [r3, #1]
|
|
800b2fe: 461a mov r2, r3
|
|
800b300: f897 302b ldrb.w r3, [r7, #43] @ 0x2b
|
|
800b304: 441a add r2, r3
|
|
800b306: f897 302a ldrb.w r3, [r7, #42] @ 0x2a
|
|
800b30a: 4413 add r3, r2
|
|
800b30c: 461a mov r2, r3
|
|
800b30e: 4941 ldr r1, [pc, #260] @ (800b414 <RFW_TransmitLongPacket+0x2e4>)
|
|
800b310: 483d ldr r0, [pc, #244] @ (800b408 <RFW_TransmitLongPacket+0x2d8>)
|
|
800b312: f000 fc36 bl 800bb82 <RFW_WhiteRun>
|
|
/* Configure the Transmitter to send all*/
|
|
/* Init radio buffer */
|
|
SUBGRF_WriteRegister( SUBGHZ_GRTXPLDLEN, RFWPacket.Init.PayloadLengthFieldSize + chunk_size + crc_size );
|
|
800b316: 4b3c ldr r3, [pc, #240] @ (800b408 <RFW_TransmitLongPacket+0x2d8>)
|
|
800b318: 785a ldrb r2, [r3, #1]
|
|
800b31a: f897 302b ldrb.w r3, [r7, #43] @ 0x2b
|
|
800b31e: 4413 add r3, r2
|
|
800b320: b2da uxtb r2, r3
|
|
800b322: f897 302a ldrb.w r3, [r7, #42] @ 0x2a
|
|
800b326: 4413 add r3, r2
|
|
800b328: b2db uxtb r3, r3
|
|
800b32a: 4619 mov r1, r3
|
|
800b32c: f240 60bb movw r0, #1723 @ 0x6bb
|
|
800b330: f7ff fc08 bl 800ab44 <SUBGRF_WriteRegister>
|
|
SUBGRF_WriteRegister( SUBGHZ_TXADRPTR, 0 );
|
|
800b334: 2100 movs r1, #0
|
|
800b336: f640 0002 movw r0, #2050 @ 0x802
|
|
800b33a: f7ff fc03 bl 800ab44 <SUBGRF_WriteRegister>
|
|
/* Send*/
|
|
SUBGRF_SendPayload( ChunkBuffer, RFWPacket.Init.PayloadLengthFieldSize + chunk_size + crc_size, 0 );
|
|
800b33e: 4b32 ldr r3, [pc, #200] @ (800b408 <RFW_TransmitLongPacket+0x2d8>)
|
|
800b340: 785a ldrb r2, [r3, #1]
|
|
800b342: f897 302b ldrb.w r3, [r7, #43] @ 0x2b
|
|
800b346: 4413 add r3, r2
|
|
800b348: b2da uxtb r2, r3
|
|
800b34a: f897 302a ldrb.w r3, [r7, #42] @ 0x2a
|
|
800b34e: 4413 add r3, r2
|
|
800b350: b2db uxtb r3, r3
|
|
800b352: 2200 movs r2, #0
|
|
800b354: 4619 mov r1, r3
|
|
800b356: 482f ldr r0, [pc, #188] @ (800b414 <RFW_TransmitLongPacket+0x2e4>)
|
|
800b358: f7fe fd60 bl 8009e1c <SUBGRF_SendPayload>
|
|
if( total_size > RADIO_BUF_SIZE )
|
|
800b35c: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
800b35e: 2bff cmp r3, #255 @ 0xff
|
|
800b360: d94b bls.n 800b3fa <RFW_TransmitLongPacket+0x2ca>
|
|
{
|
|
/*in case total size is greater than RADIO_BUF_SIZE, need to program a timer to get next chunk*/
|
|
/*RFWPacket.LongPacketRemainingBytes-= RFWPacket.Init.PayloadLengthFieldSize+ chunk_size+ crc_size;*/
|
|
/*Initialize Timer to get new chunk and update radio ptr*/
|
|
chunk_timeout = ( LONGPACKET_CHUNK_LENGTH_BYTES * 8 * 1000 ) / RFWPacket.BitRate;
|
|
800b362: 4b29 ldr r3, [pc, #164] @ (800b408 <RFW_TransmitLongPacket+0x2d8>)
|
|
800b364: 6c9b ldr r3, [r3, #72] @ 0x48
|
|
800b366: f44f 227a mov.w r2, #1024000 @ 0xfa000
|
|
800b36a: fbb2 f3f3 udiv r3, r2, r3
|
|
800b36e: 623b str r3, [r7, #32]
|
|
RFW_MW_LOG( TS_ON, VLEVEL_M, "Timeout=%d,\r\n", chunk_timeout );
|
|
800b370: 6a3b ldr r3, [r7, #32]
|
|
800b372: 9300 str r3, [sp, #0]
|
|
800b374: 4b28 ldr r3, [pc, #160] @ (800b418 <RFW_TransmitLongPacket+0x2e8>)
|
|
800b376: 2201 movs r2, #1
|
|
800b378: 2100 movs r1, #0
|
|
800b37a: 2002 movs r0, #2
|
|
800b37c: f003 fa36 bl 800e7ec <UTIL_ADV_TRACE_COND_FSend>
|
|
TimerInit( &RFWPacket.Timer, RFW_TransmitLongPacket_NewTxChunkTimerEvent );
|
|
800b380: 2300 movs r3, #0
|
|
800b382: 9300 str r3, [sp, #0]
|
|
800b384: 4b25 ldr r3, [pc, #148] @ (800b41c <RFW_TransmitLongPacket+0x2ec>)
|
|
800b386: 2200 movs r2, #0
|
|
800b388: f04f 31ff mov.w r1, #4294967295 @ 0xffffffff
|
|
800b38c: 4824 ldr r0, [pc, #144] @ (800b420 <RFW_TransmitLongPacket+0x2f0>)
|
|
800b38e: f002 ff91 bl 800e2b4 <UTIL_TIMER_Create>
|
|
TimerSetValue( &RFWPacket.Timer, chunk_timeout );
|
|
800b392: 6a39 ldr r1, [r7, #32]
|
|
800b394: 4822 ldr r0, [pc, #136] @ (800b420 <RFW_TransmitLongPacket+0x2f0>)
|
|
800b396: f003 f8a1 bl 800e4dc <UTIL_TIMER_SetPeriod>
|
|
TimerStart( &RFWPacket.Timer );
|
|
800b39a: 4821 ldr r0, [pc, #132] @ (800b420 <RFW_TransmitLongPacket+0x2f0>)
|
|
800b39c: f002 ffc0 bl 800e320 <UTIL_TIMER_Start>
|
|
/*Write bit infinite_sequence = 1, required for long packet*/
|
|
uint8_t reg = SUBGRF_ReadRegister( SUBGHZ_GPKTCTL1AR );
|
|
800b3a0: f44f 60d7 mov.w r0, #1720 @ 0x6b8
|
|
800b3a4: f7ff fbf0 bl 800ab88 <SUBGRF_ReadRegister>
|
|
800b3a8: 4603 mov r3, r0
|
|
800b3aa: 77fb strb r3, [r7, #31]
|
|
SUBGRF_WriteRegister( SUBGHZ_GPKTCTL1AR, reg | 0x02 );
|
|
800b3ac: 7ffb ldrb r3, [r7, #31]
|
|
800b3ae: f043 0302 orr.w r3, r3, #2
|
|
800b3b2: b2db uxtb r3, r3
|
|
800b3b4: 4619 mov r1, r3
|
|
800b3b6: f44f 60d7 mov.w r0, #1720 @ 0x6b8
|
|
800b3ba: f7ff fbc3 bl 800ab44 <SUBGRF_WriteRegister>
|
|
|
|
TimerSetValue( RFWPacket.RxTimeoutTimer, timeout );
|
|
800b3be: 4b12 ldr r3, [pc, #72] @ (800b408 <RFW_TransmitLongPacket+0x2d8>)
|
|
800b3c0: 6cdb ldr r3, [r3, #76] @ 0x4c
|
|
800b3c2: 68b9 ldr r1, [r7, #8]
|
|
800b3c4: 4618 mov r0, r3
|
|
800b3c6: f003 f889 bl 800e4dc <UTIL_TIMER_SetPeriod>
|
|
TimerStart( RFWPacket.RxTimeoutTimer );
|
|
800b3ca: 4b0f ldr r3, [pc, #60] @ (800b408 <RFW_TransmitLongPacket+0x2d8>)
|
|
800b3cc: 6cdb ldr r3, [r3, #76] @ 0x4c
|
|
800b3ce: 4618 mov r0, r3
|
|
800b3d0: f002 ffa6 bl 800e320 <UTIL_TIMER_Start>
|
|
else
|
|
{
|
|
/* error*/
|
|
status = -1;
|
|
}
|
|
break;
|
|
800b3d4: e011 b.n 800b3fa <RFW_TransmitLongPacket+0x2ca>
|
|
status = -1;
|
|
800b3d6: f04f 33ff mov.w r3, #4294967295 @ 0xffffffff
|
|
800b3da: 62fb str r3, [r7, #44] @ 0x2c
|
|
break;
|
|
800b3dc: e00d b.n 800b3fa <RFW_TransmitLongPacket+0x2ca>
|
|
}
|
|
case MODEM_LORA:
|
|
{
|
|
/* not supported by the radio Ip*/
|
|
status = -2;
|
|
800b3de: f06f 0301 mvn.w r3, #1
|
|
800b3e2: 62fb str r3, [r7, #44] @ 0x2c
|
|
break;
|
|
800b3e4: e00a b.n 800b3fc <RFW_TransmitLongPacket+0x2cc>
|
|
}
|
|
case MODEM_BPSK:
|
|
{
|
|
/* not supported by the FW*/
|
|
status = -2;
|
|
800b3e6: f06f 0301 mvn.w r3, #1
|
|
800b3ea: 62fb str r3, [r7, #44] @ 0x2c
|
|
break;
|
|
800b3ec: e006 b.n 800b3fc <RFW_TransmitLongPacket+0x2cc>
|
|
}
|
|
case MODEM_SIGFOX_TX:
|
|
{
|
|
/* not supported by the FW*/
|
|
status = -2;
|
|
800b3ee: f06f 0301 mvn.w r3, #1
|
|
800b3f2: 62fb str r3, [r7, #44] @ 0x2c
|
|
break;
|
|
800b3f4: e002 b.n 800b3fc <RFW_TransmitLongPacket+0x2cc>
|
|
}
|
|
default:
|
|
break;
|
|
800b3f6: bf00 nop
|
|
800b3f8: e000 b.n 800b3fc <RFW_TransmitLongPacket+0x2cc>
|
|
break;
|
|
800b3fa: bf00 nop
|
|
}
|
|
}
|
|
#else
|
|
status = -1;
|
|
#endif /* RFW_LONGPACKET_ENABLE == 1 */
|
|
return status;
|
|
800b3fc: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
}
|
|
800b3fe: 4618 mov r0, r3
|
|
800b400: 3730 adds r7, #48 @ 0x30
|
|
800b402: 46bd mov sp, r7
|
|
800b404: bd80 pop {r7, pc}
|
|
800b406: bf00 nop
|
|
800b408: 20000394 .word 0x20000394
|
|
800b40c: 0800f928 .word 0x0800f928
|
|
800b410: 48000400 .word 0x48000400
|
|
800b414: 200003e8 .word 0x200003e8
|
|
800b418: 0800f938 .word 0x0800f938
|
|
800b41c: 0800b919 .word 0x0800b919
|
|
800b420: 200003b0 .word 0x200003b0
|
|
|
|
0800b424 <RFW_ReceiveLongPacket>:
|
|
|
|
int32_t RFW_ReceiveLongPacket( uint8_t boosted_mode, uint32_t timeout,
|
|
void ( *RxLongPacketStoreChunkCb )( uint8_t *buffer, uint8_t chunk_size ) )
|
|
{
|
|
800b424: b580 push {r7, lr}
|
|
800b426: b086 sub sp, #24
|
|
800b428: af00 add r7, sp, #0
|
|
800b42a: 4603 mov r3, r0
|
|
800b42c: 60b9 str r1, [r7, #8]
|
|
800b42e: 607a str r2, [r7, #4]
|
|
800b430: 73fb strb r3, [r7, #15]
|
|
int32_t status = 0;
|
|
800b432: 2300 movs r3, #0
|
|
800b434: 617b str r3, [r7, #20]
|
|
#if (RFW_LONGPACKET_ENABLE == 1 )
|
|
if( ( RxLongPacketStoreChunkCb == NULL ) ||
|
|
800b436: 687b ldr r3, [r7, #4]
|
|
800b438: 2b00 cmp r3, #0
|
|
800b43a: d003 beq.n 800b444 <RFW_ReceiveLongPacket+0x20>
|
|
( RFWPacket.Init.Enable == 0 ) ) /* Can only be used when after RadioSetRxGenericConfig*/
|
|
800b43c: 4b2a ldr r3, [pc, #168] @ (800b4e8 <RFW_ReceiveLongPacket+0xc4>)
|
|
800b43e: 781b ldrb r3, [r3, #0]
|
|
if( ( RxLongPacketStoreChunkCb == NULL ) ||
|
|
800b440: 2b00 cmp r3, #0
|
|
800b442: d103 bne.n 800b44c <RFW_ReceiveLongPacket+0x28>
|
|
{
|
|
status = -1;
|
|
800b444: f04f 33ff mov.w r3, #4294967295 @ 0xffffffff
|
|
800b448: 617b str r3, [r7, #20]
|
|
800b44a: e047 b.n 800b4dc <RFW_ReceiveLongPacket+0xb8>
|
|
}
|
|
else
|
|
{
|
|
/*Records call back*/
|
|
RFWPacket.RxLongPacketStoreChunkCb = RxLongPacketStoreChunkCb;
|
|
800b44c: 4a26 ldr r2, [pc, #152] @ (800b4e8 <RFW_ReceiveLongPacket+0xc4>)
|
|
800b44e: 687b ldr r3, [r7, #4]
|
|
800b450: 63d3 str r3, [r2, #60] @ 0x3c
|
|
SUBGRF_SetDioIrqParams( IRQ_SYNCWORD_VALID | IRQ_RX_TX_TIMEOUT,
|
|
800b452: 2300 movs r3, #0
|
|
800b454: 2200 movs r2, #0
|
|
800b456: f44f 7102 mov.w r1, #520 @ 0x208
|
|
800b45a: f44f 7002 mov.w r0, #520 @ 0x208
|
|
800b45e: f7fe ffc7 bl 800a3f0 <SUBGRF_SetDioIrqParams>
|
|
IRQ_SYNCWORD_VALID | IRQ_RX_TX_TIMEOUT,
|
|
IRQ_RADIO_NONE,
|
|
IRQ_RADIO_NONE );
|
|
SUBGRF_SetSwitch( RFWPacket.AntSwitchPaSelect, RFSWITCH_RX );
|
|
800b462: 4b21 ldr r3, [pc, #132] @ (800b4e8 <RFW_ReceiveLongPacket+0xc4>)
|
|
800b464: f893 3044 ldrb.w r3, [r3, #68] @ 0x44
|
|
800b468: 2100 movs r1, #0
|
|
800b46a: 4618 mov r0, r3
|
|
800b46c: f7ff fc78 bl 800ad60 <SUBGRF_SetSwitch>
|
|
/*init radio buffer offset*/
|
|
RFWPacket.RadioBufferOffset = 0;
|
|
800b470: 4b1d ldr r3, [pc, #116] @ (800b4e8 <RFW_ReceiveLongPacket+0xc4>)
|
|
800b472: 2200 movs r2, #0
|
|
800b474: f883 2036 strb.w r2, [r3, #54] @ 0x36
|
|
/* Init whitening at beginning of the packet*/
|
|
RFW_WhiteSetState( &RFWPacket );
|
|
800b478: 481b ldr r0, [pc, #108] @ (800b4e8 <RFW_ReceiveLongPacket+0xc4>)
|
|
800b47a: f000 fb4d bl 800bb18 <RFW_WhiteSetState>
|
|
/* Set the state of the Crc to crc_seed*/
|
|
RFW_CrcSetState( &RFWPacket );
|
|
800b47e: 481a ldr r0, [pc, #104] @ (800b4e8 <RFW_ReceiveLongPacket+0xc4>)
|
|
800b480: f000 fb72 bl 800bb68 <RFW_CrcSetState>
|
|
/* Init radio buffer */
|
|
SUBGRF_WriteRegister( SUBGHZ_GRTXPLDLEN, 255 );
|
|
800b484: 21ff movs r1, #255 @ 0xff
|
|
800b486: f240 60bb movw r0, #1723 @ 0x6bb
|
|
800b48a: f7ff fb5b bl 800ab44 <SUBGRF_WriteRegister>
|
|
SUBGRF_WriteRegister( SUBGHZ_RXADRPTR, 0 );
|
|
800b48e: 2100 movs r1, #0
|
|
800b490: f640 0003 movw r0, #2051 @ 0x803
|
|
800b494: f7ff fb56 bl 800ab44 <SUBGRF_WriteRegister>
|
|
/*enable long packet*/
|
|
RFWPacket.LongPacketModeEnable = 1;
|
|
800b498: 4b13 ldr r3, [pc, #76] @ (800b4e8 <RFW_ReceiveLongPacket+0xc4>)
|
|
800b49a: 2201 movs r2, #1
|
|
800b49c: 769a strb r2, [r3, #26]
|
|
|
|
if( timeout != 0 )
|
|
800b49e: 68bb ldr r3, [r7, #8]
|
|
800b4a0: 2b00 cmp r3, #0
|
|
800b4a2: d00a beq.n 800b4ba <RFW_ReceiveLongPacket+0x96>
|
|
{
|
|
TimerSetValue( RFWPacket.RxTimeoutTimer, timeout );
|
|
800b4a4: 4b10 ldr r3, [pc, #64] @ (800b4e8 <RFW_ReceiveLongPacket+0xc4>)
|
|
800b4a6: 6cdb ldr r3, [r3, #76] @ 0x4c
|
|
800b4a8: 68b9 ldr r1, [r7, #8]
|
|
800b4aa: 4618 mov r0, r3
|
|
800b4ac: f003 f816 bl 800e4dc <UTIL_TIMER_SetPeriod>
|
|
TimerStart( RFWPacket.RxTimeoutTimer );
|
|
800b4b0: 4b0d ldr r3, [pc, #52] @ (800b4e8 <RFW_ReceiveLongPacket+0xc4>)
|
|
800b4b2: 6cdb ldr r3, [r3, #76] @ 0x4c
|
|
800b4b4: 4618 mov r0, r3
|
|
800b4b6: f002 ff33 bl 800e320 <UTIL_TIMER_Start>
|
|
}
|
|
DBG_GPIO_RADIO_RX( SET );
|
|
800b4ba: f44f 5180 mov.w r1, #4096 @ 0x1000
|
|
800b4be: 480b ldr r0, [pc, #44] @ (800b4ec <RFW_ReceiveLongPacket+0xc8>)
|
|
800b4c0: f7ff fe1c bl 800b0fc <LL_GPIO_SetOutputPin>
|
|
if( boosted_mode == 1 )
|
|
800b4c4: 7bfb ldrb r3, [r7, #15]
|
|
800b4c6: 2b01 cmp r3, #1
|
|
800b4c8: d104 bne.n 800b4d4 <RFW_ReceiveLongPacket+0xb0>
|
|
{
|
|
SUBGRF_SetRxBoosted( 0xFFFFFF ); /* Rx Continuous */
|
|
800b4ca: f06f 407f mvn.w r0, #4278190080 @ 0xff000000
|
|
800b4ce: f7fe fe11 bl 800a0f4 <SUBGRF_SetRxBoosted>
|
|
800b4d2: e003 b.n 800b4dc <RFW_ReceiveLongPacket+0xb8>
|
|
}
|
|
else
|
|
{
|
|
SUBGRF_SetRx( 0xFFFFFF ); /* Rx Continuous */
|
|
800b4d4: f06f 407f mvn.w r0, #4278190080 @ 0xff000000
|
|
800b4d8: f7fe fdec bl 800a0b4 <SUBGRF_SetRx>
|
|
}
|
|
}
|
|
#else
|
|
status = -1;
|
|
#endif /* RFW_LONGPACKET_ENABLE == 1 */
|
|
return status;
|
|
800b4dc: 697b ldr r3, [r7, #20]
|
|
}
|
|
800b4de: 4618 mov r0, r3
|
|
800b4e0: 3718 adds r7, #24
|
|
800b4e2: 46bd mov sp, r7
|
|
800b4e4: bd80 pop {r7, pc}
|
|
800b4e6: bf00 nop
|
|
800b4e8: 20000394 .word 0x20000394
|
|
800b4ec: 48000400 .word 0x48000400
|
|
|
|
0800b4f0 <RFW_Init>:
|
|
|
|
int32_t RFW_Init( ConfigGeneric_t *config, RadioEvents_t *RadioEvents, TimerEvent_t *TimeoutTimerEvent )
|
|
{
|
|
800b4f0: b580 push {r7, lr}
|
|
800b4f2: b08a sub sp, #40 @ 0x28
|
|
800b4f4: af02 add r7, sp, #8
|
|
800b4f6: 60f8 str r0, [r7, #12]
|
|
800b4f8: 60b9 str r1, [r7, #8]
|
|
800b4fa: 607a str r2, [r7, #4]
|
|
#if (RFW_ENABLE == 1 )
|
|
RADIO_FSK_PacketLengthModes_t HeaderType;
|
|
uint32_t RxMaxPayloadLength = 0;
|
|
800b4fc: 2300 movs r3, #0
|
|
800b4fe: 61bb str r3, [r7, #24]
|
|
RADIO_FSK_CrcTypes_t CrcLength;
|
|
uint16_t whiteSeed;
|
|
uint16_t CrcPolynomial;
|
|
uint16_t CrcSeed;
|
|
if( config->rtx == CONFIG_TX )
|
|
800b500: 68fb ldr r3, [r7, #12]
|
|
800b502: 7a1b ldrb r3, [r3, #8]
|
|
800b504: 2b01 cmp r3, #1
|
|
800b506: d11c bne.n 800b542 <RFW_Init+0x52>
|
|
{
|
|
HeaderType = config->TxConfig->fsk.HeaderType;
|
|
800b508: 68fb ldr r3, [r7, #12]
|
|
800b50a: 681b ldr r3, [r3, #0]
|
|
800b50c: 7d1b ldrb r3, [r3, #20]
|
|
800b50e: 77fb strb r3, [r7, #31]
|
|
CrcLength = config->TxConfig->fsk.CrcLength;
|
|
800b510: 68fb ldr r3, [r7, #12]
|
|
800b512: 681b ldr r3, [r3, #0]
|
|
800b514: 7d5b ldrb r3, [r3, #21]
|
|
800b516: 75fb strb r3, [r7, #23]
|
|
whiteSeed = config->TxConfig->fsk.whiteSeed;
|
|
800b518: 68fb ldr r3, [r7, #12]
|
|
800b51a: 681b ldr r3, [r3, #0]
|
|
800b51c: 8a1b ldrh r3, [r3, #16]
|
|
800b51e: 82bb strh r3, [r7, #20]
|
|
CrcPolynomial = config->TxConfig->fsk.CrcPolynomial;
|
|
800b520: 68fb ldr r3, [r7, #12]
|
|
800b522: 681b ldr r3, [r3, #0]
|
|
800b524: 899b ldrh r3, [r3, #12]
|
|
800b526: 827b strh r3, [r7, #18]
|
|
CrcSeed = config->TxConfig->fsk.CrcSeed;
|
|
800b528: 68fb ldr r3, [r7, #12]
|
|
800b52a: 681b ldr r3, [r3, #0]
|
|
800b52c: 89db ldrh r3, [r3, #14]
|
|
800b52e: 823b strh r3, [r7, #16]
|
|
RFWPacket.BitRate = config->TxConfig->fsk.BitRate;
|
|
800b530: 68fb ldr r3, [r7, #12]
|
|
800b532: 681b ldr r3, [r3, #0]
|
|
800b534: 681b ldr r3, [r3, #0]
|
|
800b536: 4a38 ldr r2, [pc, #224] @ (800b618 <RFW_Init+0x128>)
|
|
800b538: 6493 str r3, [r2, #72] @ 0x48
|
|
RFWPacket.TxTimeoutTimer = TimeoutTimerEvent;
|
|
800b53a: 4a37 ldr r2, [pc, #220] @ (800b618 <RFW_Init+0x128>)
|
|
800b53c: 687b ldr r3, [r7, #4]
|
|
800b53e: 6513 str r3, [r2, #80] @ 0x50
|
|
800b540: e021 b.n 800b586 <RFW_Init+0x96>
|
|
}
|
|
else
|
|
{
|
|
HeaderType = config->RxConfig->fsk.LengthMode;
|
|
800b542: 68fb ldr r3, [r7, #12]
|
|
800b544: 685b ldr r3, [r3, #4]
|
|
800b546: f893 3022 ldrb.w r3, [r3, #34] @ 0x22
|
|
800b54a: 77fb strb r3, [r7, #31]
|
|
CrcLength = config->RxConfig->fsk.CrcLength;
|
|
800b54c: 68fb ldr r3, [r7, #12]
|
|
800b54e: 685b ldr r3, [r3, #4]
|
|
800b550: f893 3023 ldrb.w r3, [r3, #35] @ 0x23
|
|
800b554: 75fb strb r3, [r7, #23]
|
|
RxMaxPayloadLength = config->RxConfig->fsk.MaxPayloadLength;
|
|
800b556: 68fb ldr r3, [r7, #12]
|
|
800b558: 685b ldr r3, [r3, #4]
|
|
800b55a: 695b ldr r3, [r3, #20]
|
|
800b55c: 61bb str r3, [r7, #24]
|
|
whiteSeed = config->RxConfig->fsk.whiteSeed;
|
|
800b55e: 68fb ldr r3, [r7, #12]
|
|
800b560: 685b ldr r3, [r3, #4]
|
|
800b562: 8b9b ldrh r3, [r3, #28]
|
|
800b564: 82bb strh r3, [r7, #20]
|
|
CrcPolynomial = config->RxConfig->fsk.CrcPolynomial;
|
|
800b566: 68fb ldr r3, [r7, #12]
|
|
800b568: 685b ldr r3, [r3, #4]
|
|
800b56a: 8b1b ldrh r3, [r3, #24]
|
|
800b56c: 827b strh r3, [r7, #18]
|
|
CrcSeed = config->RxConfig->fsk.CrcSeed;
|
|
800b56e: 68fb ldr r3, [r7, #12]
|
|
800b570: 685b ldr r3, [r3, #4]
|
|
800b572: 8b5b ldrh r3, [r3, #26]
|
|
800b574: 823b strh r3, [r7, #16]
|
|
RFWPacket.BitRate = config->RxConfig->fsk.BitRate;
|
|
800b576: 68fb ldr r3, [r7, #12]
|
|
800b578: 685b ldr r3, [r3, #4]
|
|
800b57a: 689b ldr r3, [r3, #8]
|
|
800b57c: 4a26 ldr r2, [pc, #152] @ (800b618 <RFW_Init+0x128>)
|
|
800b57e: 6493 str r3, [r2, #72] @ 0x48
|
|
RFWPacket.RxTimeoutTimer = TimeoutTimerEvent;
|
|
800b580: 4a25 ldr r2, [pc, #148] @ (800b618 <RFW_Init+0x128>)
|
|
800b582: 687b ldr r3, [r7, #4]
|
|
800b584: 64d3 str r3, [r2, #76] @ 0x4c
|
|
}
|
|
if( ( RadioEvents != NULL ) && ( RadioEvents->RxError ) )
|
|
800b586: 68bb ldr r3, [r7, #8]
|
|
800b588: 2b00 cmp r3, #0
|
|
800b58a: d00a beq.n 800b5a2 <RFW_Init+0xb2>
|
|
800b58c: 68bb ldr r3, [r7, #8]
|
|
800b58e: 691b ldr r3, [r3, #16]
|
|
800b590: 2b00 cmp r3, #0
|
|
800b592: d006 beq.n 800b5a2 <RFW_Init+0xb2>
|
|
{
|
|
RFWPacket.Init.RadioEvents = RadioEvents;
|
|
800b594: 4a20 ldr r2, [pc, #128] @ (800b618 <RFW_Init+0x128>)
|
|
800b596: 68bb ldr r3, [r7, #8]
|
|
800b598: 6113 str r3, [r2, #16]
|
|
}
|
|
else
|
|
{
|
|
return -1;
|
|
}
|
|
if( HeaderType == RADIO_FSK_PACKET_2BYTES_LENGTH )
|
|
800b59a: 7ffb ldrb r3, [r7, #31]
|
|
800b59c: 2b02 cmp r3, #2
|
|
800b59e: d003 beq.n 800b5a8 <RFW_Init+0xb8>
|
|
800b5a0: e006 b.n 800b5b0 <RFW_Init+0xc0>
|
|
return -1;
|
|
800b5a2: f04f 33ff mov.w r3, #4294967295 @ 0xffffffff
|
|
800b5a6: e032 b.n 800b60e <RFW_Init+0x11e>
|
|
{
|
|
#if (RFW_LONGPACKET_ENABLE == 1 )
|
|
RFWPacket.Init.PayloadLengthFieldSize = 2;
|
|
800b5a8: 4b1b ldr r3, [pc, #108] @ (800b618 <RFW_Init+0x128>)
|
|
800b5aa: 2202 movs r2, #2
|
|
800b5ac: 705a strb r2, [r3, #1]
|
|
800b5ae: e002 b.n 800b5b6 <RFW_Init+0xc6>
|
|
return -1;
|
|
#endif /* RFW_LONGPACKET_ENABLE == 1 */
|
|
}
|
|
else
|
|
{
|
|
RFWPacket.Init.PayloadLengthFieldSize = 1;
|
|
800b5b0: 4b19 ldr r3, [pc, #100] @ (800b618 <RFW_Init+0x128>)
|
|
800b5b2: 2201 movs r2, #1
|
|
800b5b4: 705a strb r2, [r3, #1]
|
|
}
|
|
/*record, used to reject packet in length decoded at sync time out greater than LongPacketMaxRxLength*/
|
|
RFWPacket.Init.LongPacketMaxRxLength = RxMaxPayloadLength;
|
|
800b5b6: 69bb ldr r3, [r7, #24]
|
|
800b5b8: b29a uxth r2, r3
|
|
800b5ba: 4b17 ldr r3, [pc, #92] @ (800b618 <RFW_Init+0x128>)
|
|
800b5bc: 819a strh r2, [r3, #12]
|
|
if( CrcLength == RADIO_FSK_CRC_OFF )
|
|
800b5be: 7dfb ldrb r3, [r7, #23]
|
|
800b5c0: 2b01 cmp r3, #1
|
|
800b5c2: d106 bne.n 800b5d2 <RFW_Init+0xe2>
|
|
{
|
|
RFWPacket.Init.CrcEnable = 0;
|
|
800b5c4: 4b14 ldr r3, [pc, #80] @ (800b618 <RFW_Init+0x128>)
|
|
800b5c6: 2200 movs r2, #0
|
|
800b5c8: 709a strb r2, [r3, #2]
|
|
RFWPacket.Init.CrcFieldSize = 0;
|
|
800b5ca: 4b13 ldr r3, [pc, #76] @ (800b618 <RFW_Init+0x128>)
|
|
800b5cc: 2200 movs r2, #0
|
|
800b5ce: 70da strb r2, [r3, #3]
|
|
800b5d0: e005 b.n 800b5de <RFW_Init+0xee>
|
|
}
|
|
else
|
|
{
|
|
RFWPacket.Init.CrcEnable = 1;
|
|
800b5d2: 4b11 ldr r3, [pc, #68] @ (800b618 <RFW_Init+0x128>)
|
|
800b5d4: 2201 movs r2, #1
|
|
800b5d6: 709a strb r2, [r3, #2]
|
|
RFWPacket.Init.CrcFieldSize = 2;
|
|
800b5d8: 4b0f ldr r3, [pc, #60] @ (800b618 <RFW_Init+0x128>)
|
|
800b5da: 2202 movs r2, #2
|
|
800b5dc: 70da strb r2, [r3, #3]
|
|
}
|
|
/*Macro can be used to init interrupt behaviour*/
|
|
RFW_IT_INIT();
|
|
/*Initialise whitening Seed*/
|
|
RFW_WhiteInitState( &RFWPacket.Init, whiteSeed );
|
|
800b5de: 8abb ldrh r3, [r7, #20]
|
|
800b5e0: 4619 mov r1, r3
|
|
800b5e2: 480d ldr r0, [pc, #52] @ (800b618 <RFW_Init+0x128>)
|
|
800b5e4: f000 fa8a bl 800bafc <RFW_WhiteInitState>
|
|
/*Initialise Crc Seed*/
|
|
RFW_CrcInitState( &RFWPacket.Init, CrcPolynomial, CrcSeed, CrcLength );
|
|
800b5e8: 7dfb ldrb r3, [r7, #23]
|
|
800b5ea: 8a3a ldrh r2, [r7, #16]
|
|
800b5ec: 8a79 ldrh r1, [r7, #18]
|
|
800b5ee: 480a ldr r0, [pc, #40] @ (800b618 <RFW_Init+0x128>)
|
|
800b5f0: f000 fa9f bl 800bb32 <RFW_CrcInitState>
|
|
/*Enable the RFWPacket decoding*/
|
|
RFWPacket.Init.Enable = 1;
|
|
800b5f4: 4b08 ldr r3, [pc, #32] @ (800b618 <RFW_Init+0x128>)
|
|
800b5f6: 2201 movs r2, #1
|
|
800b5f8: 701a strb r2, [r3, #0]
|
|
/* Initialize Timer for end of fixed packet, started at sync*/
|
|
TimerInit( &RFWPacket.Timer, RFW_GetPayloadTimerEvent );
|
|
800b5fa: 2300 movs r3, #0
|
|
800b5fc: 9300 str r3, [sp, #0]
|
|
800b5fe: 4b07 ldr r3, [pc, #28] @ (800b61c <RFW_Init+0x12c>)
|
|
800b600: 2200 movs r2, #0
|
|
800b602: f04f 31ff mov.w r1, #4294967295 @ 0xffffffff
|
|
800b606: 4806 ldr r0, [pc, #24] @ (800b620 <RFW_Init+0x130>)
|
|
800b608: f002 fe54 bl 800e2b4 <UTIL_TIMER_Create>
|
|
return 0;
|
|
800b60c: 2300 movs r3, #0
|
|
#else
|
|
return -1;
|
|
#endif /* RFW_ENABLE == 1 */
|
|
}
|
|
800b60e: 4618 mov r0, r3
|
|
800b610: 3720 adds r7, #32
|
|
800b612: 46bd mov sp, r7
|
|
800b614: bd80 pop {r7, pc}
|
|
800b616: bf00 nop
|
|
800b618: 20000394 .word 0x20000394
|
|
800b61c: 0800be2d .word 0x0800be2d
|
|
800b620: 200003b0 .word 0x200003b0
|
|
|
|
0800b624 <RFW_DeInit>:
|
|
|
|
void RFW_DeInit( void )
|
|
{
|
|
800b624: b480 push {r7}
|
|
800b626: af00 add r7, sp, #0
|
|
#if (RFW_ENABLE == 1 )
|
|
RFWPacket.Init.Enable = 0; /*Disable the RFWPacket decoding*/
|
|
800b628: 4b03 ldr r3, [pc, #12] @ (800b638 <RFW_DeInit+0x14>)
|
|
800b62a: 2200 movs r2, #0
|
|
800b62c: 701a strb r2, [r3, #0]
|
|
#endif /* RFW_ENABLE == 1 */
|
|
}
|
|
800b62e: bf00 nop
|
|
800b630: 46bd mov sp, r7
|
|
800b632: bc80 pop {r7}
|
|
800b634: 4770 bx lr
|
|
800b636: bf00 nop
|
|
800b638: 20000394 .word 0x20000394
|
|
|
|
0800b63c <RFW_Is_Init>:
|
|
|
|
uint8_t RFW_Is_Init( void )
|
|
{
|
|
800b63c: b480 push {r7}
|
|
800b63e: af00 add r7, sp, #0
|
|
#if (RFW_ENABLE == 1 )
|
|
return RFWPacket.Init.Enable;
|
|
800b640: 4b02 ldr r3, [pc, #8] @ (800b64c <RFW_Is_Init+0x10>)
|
|
800b642: 781b ldrb r3, [r3, #0]
|
|
#else
|
|
return 0;
|
|
#endif /* RFW_ENABLE == 1 */
|
|
}
|
|
800b644: 4618 mov r0, r3
|
|
800b646: 46bd mov sp, r7
|
|
800b648: bc80 pop {r7}
|
|
800b64a: 4770 bx lr
|
|
800b64c: 20000394 .word 0x20000394
|
|
|
|
0800b650 <RFW_Is_LongPacketModeEnabled>:
|
|
|
|
uint8_t RFW_Is_LongPacketModeEnabled( void )
|
|
{
|
|
800b650: b480 push {r7}
|
|
800b652: af00 add r7, sp, #0
|
|
#if (RFW_ENABLE == 1 )
|
|
return RFWPacket.LongPacketModeEnable;
|
|
800b654: 4b02 ldr r3, [pc, #8] @ (800b660 <RFW_Is_LongPacketModeEnabled+0x10>)
|
|
800b656: 7e9b ldrb r3, [r3, #26]
|
|
#else
|
|
return 0;
|
|
#endif /* RFW_ENABLE == 1 */
|
|
}
|
|
800b658: 4618 mov r0, r3
|
|
800b65a: 46bd mov sp, r7
|
|
800b65c: bc80 pop {r7}
|
|
800b65e: 4770 bx lr
|
|
800b660: 20000394 .word 0x20000394
|
|
|
|
0800b664 <RFW_SetAntSwitch>:
|
|
|
|
void RFW_SetAntSwitch( uint8_t AntSwitch )
|
|
{
|
|
800b664: b480 push {r7}
|
|
800b666: b083 sub sp, #12
|
|
800b668: af00 add r7, sp, #0
|
|
800b66a: 4603 mov r3, r0
|
|
800b66c: 71fb strb r3, [r7, #7]
|
|
#if (RFW_ENABLE == 1 )
|
|
RFWPacket.AntSwitchPaSelect = AntSwitch;
|
|
800b66e: 4a04 ldr r2, [pc, #16] @ (800b680 <RFW_SetAntSwitch+0x1c>)
|
|
800b670: 79fb ldrb r3, [r7, #7]
|
|
800b672: f882 3044 strb.w r3, [r2, #68] @ 0x44
|
|
#endif /* RFW_ENABLE == 1 */
|
|
}
|
|
800b676: bf00 nop
|
|
800b678: 370c adds r7, #12
|
|
800b67a: 46bd mov sp, r7
|
|
800b67c: bc80 pop {r7}
|
|
800b67e: 4770 bx lr
|
|
800b680: 20000394 .word 0x20000394
|
|
|
|
0800b684 <RFW_TransmitInit>:
|
|
|
|
int32_t RFW_TransmitInit( uint8_t *inOutBuffer, uint8_t size, uint8_t *outSize )
|
|
{
|
|
800b684: b580 push {r7, lr}
|
|
800b686: b086 sub sp, #24
|
|
800b688: af00 add r7, sp, #0
|
|
800b68a: 60f8 str r0, [r7, #12]
|
|
800b68c: 460b mov r3, r1
|
|
800b68e: 607a str r2, [r7, #4]
|
|
800b690: 72fb strb r3, [r7, #11]
|
|
int32_t status = -1;
|
|
800b692: f04f 33ff mov.w r3, #4294967295 @ 0xffffffff
|
|
800b696: 617b str r3, [r7, #20]
|
|
#if (RFW_ENABLE == 1 )
|
|
uint8_t crc_result[2];
|
|
if( size + RFWPacket.Init.PayloadLengthFieldSize + RFWPacket.Init.CrcFieldSize > RADIO_BUF_SIZE )
|
|
800b698: 7afb ldrb r3, [r7, #11]
|
|
800b69a: 4a3a ldr r2, [pc, #232] @ (800b784 <RFW_TransmitInit+0x100>)
|
|
800b69c: 7852 ldrb r2, [r2, #1]
|
|
800b69e: 4413 add r3, r2
|
|
800b6a0: 4a38 ldr r2, [pc, #224] @ (800b784 <RFW_TransmitInit+0x100>)
|
|
800b6a2: 78d2 ldrb r2, [r2, #3]
|
|
800b6a4: 4413 add r3, r2
|
|
800b6a6: 2bff cmp r3, #255 @ 0xff
|
|
800b6a8: dd09 ble.n 800b6be <RFW_TransmitInit+0x3a>
|
|
{
|
|
RFW_MW_LOG( TS_ON, VLEVEL_M, "RadioSend Oversize\r\n" );
|
|
800b6aa: 4b37 ldr r3, [pc, #220] @ (800b788 <RFW_TransmitInit+0x104>)
|
|
800b6ac: 2201 movs r2, #1
|
|
800b6ae: 2100 movs r1, #0
|
|
800b6b0: 2002 movs r0, #2
|
|
800b6b2: f003 f89b bl 800e7ec <UTIL_ADV_TRACE_COND_FSend>
|
|
status = -1;
|
|
800b6b6: f04f 33ff mov.w r3, #4294967295 @ 0xffffffff
|
|
800b6ba: 617b str r3, [r7, #20]
|
|
800b6bc: e05d b.n 800b77a <RFW_TransmitInit+0xf6>
|
|
}
|
|
else
|
|
{
|
|
/* Copy tx buffer in payload*/
|
|
RADIO_MEMCPY8( &ChunkBuffer[RFWPacket.Init.PayloadLengthFieldSize], inOutBuffer, size );
|
|
800b6be: 4b31 ldr r3, [pc, #196] @ (800b784 <RFW_TransmitInit+0x100>)
|
|
800b6c0: 785b ldrb r3, [r3, #1]
|
|
800b6c2: 461a mov r2, r3
|
|
800b6c4: 4b31 ldr r3, [pc, #196] @ (800b78c <RFW_TransmitInit+0x108>)
|
|
800b6c6: 4413 add r3, r2
|
|
800b6c8: 7afa ldrb r2, [r7, #11]
|
|
800b6ca: b292 uxth r2, r2
|
|
800b6cc: 68f9 ldr r1, [r7, #12]
|
|
800b6ce: 4618 mov r0, r3
|
|
800b6d0: f002 f98e bl 800d9f0 <UTIL_MEM_cpy_8>
|
|
/* Calculate the crc on */
|
|
/* Payload Size without the packet length field nor the CRC */
|
|
/* Prepend payload size before Payload*/
|
|
if( RFWPacket.Init.PayloadLengthFieldSize == 1 )
|
|
800b6d4: 4b2b ldr r3, [pc, #172] @ (800b784 <RFW_TransmitInit+0x100>)
|
|
800b6d6: 785b ldrb r3, [r3, #1]
|
|
800b6d8: 2b01 cmp r3, #1
|
|
800b6da: d103 bne.n 800b6e4 <RFW_TransmitInit+0x60>
|
|
{
|
|
ChunkBuffer[0] = size;
|
|
800b6dc: 4a2b ldr r2, [pc, #172] @ (800b78c <RFW_TransmitInit+0x108>)
|
|
800b6de: 7afb ldrb r3, [r7, #11]
|
|
800b6e0: 7013 strb r3, [r2, #0]
|
|
800b6e2: e005 b.n 800b6f0 <RFW_TransmitInit+0x6c>
|
|
}
|
|
else
|
|
{
|
|
ChunkBuffer[0] = 0;
|
|
800b6e4: 4b29 ldr r3, [pc, #164] @ (800b78c <RFW_TransmitInit+0x108>)
|
|
800b6e6: 2200 movs r2, #0
|
|
800b6e8: 701a strb r2, [r3, #0]
|
|
ChunkBuffer[1] = size;
|
|
800b6ea: 4a28 ldr r2, [pc, #160] @ (800b78c <RFW_TransmitInit+0x108>)
|
|
800b6ec: 7afb ldrb r3, [r7, #11]
|
|
800b6ee: 7053 strb r3, [r2, #1]
|
|
}
|
|
if( RFWPacket.Init.CrcEnable == 1 )
|
|
800b6f0: 4b24 ldr r3, [pc, #144] @ (800b784 <RFW_TransmitInit+0x100>)
|
|
800b6f2: 789b ldrb r3, [r3, #2]
|
|
800b6f4: 2b01 cmp r3, #1
|
|
800b6f6: d11a bne.n 800b72e <RFW_TransmitInit+0xaa>
|
|
{
|
|
/* Set the state of the Crc to crc_seed*/
|
|
RFW_CrcSetState( &RFWPacket );
|
|
800b6f8: 4822 ldr r0, [pc, #136] @ (800b784 <RFW_TransmitInit+0x100>)
|
|
800b6fa: f000 fa35 bl 800bb68 <RFW_CrcSetState>
|
|
/*Run the crc calculation on payload length and payload*/
|
|
RFW_CrcRun( &RFWPacket, &ChunkBuffer[0], size + RFWPacket.Init.PayloadLengthFieldSize, crc_result );
|
|
800b6fe: 7afb ldrb r3, [r7, #11]
|
|
800b700: 4a20 ldr r2, [pc, #128] @ (800b784 <RFW_TransmitInit+0x100>)
|
|
800b702: 7852 ldrb r2, [r2, #1]
|
|
800b704: 4413 add r3, r2
|
|
800b706: 461a mov r2, r3
|
|
800b708: f107 0310 add.w r3, r7, #16
|
|
800b70c: 491f ldr r1, [pc, #124] @ (800b78c <RFW_TransmitInit+0x108>)
|
|
800b70e: 481d ldr r0, [pc, #116] @ (800b784 <RFW_TransmitInit+0x100>)
|
|
800b710: f000 fa7f bl 800bc12 <RFW_CrcRun>
|
|
/*append the crc result after the payload*/
|
|
RADIO_MEMCPY8( &ChunkBuffer[size + RFWPacket.Init.PayloadLengthFieldSize], crc_result, RFWPacket.Init.CrcFieldSize );
|
|
800b714: 7afb ldrb r3, [r7, #11]
|
|
800b716: 4a1b ldr r2, [pc, #108] @ (800b784 <RFW_TransmitInit+0x100>)
|
|
800b718: 7852 ldrb r2, [r2, #1]
|
|
800b71a: 4413 add r3, r2
|
|
800b71c: 4a1b ldr r2, [pc, #108] @ (800b78c <RFW_TransmitInit+0x108>)
|
|
800b71e: 4413 add r3, r2
|
|
800b720: 4a18 ldr r2, [pc, #96] @ (800b784 <RFW_TransmitInit+0x100>)
|
|
800b722: 78d2 ldrb r2, [r2, #3]
|
|
800b724: f107 0110 add.w r1, r7, #16
|
|
800b728: 4618 mov r0, r3
|
|
800b72a: f002 f961 bl 800d9f0 <UTIL_MEM_cpy_8>
|
|
}
|
|
/*init whitening at beginning of the packet*/
|
|
RFW_WhiteSetState( &RFWPacket );
|
|
800b72e: 4815 ldr r0, [pc, #84] @ (800b784 <RFW_TransmitInit+0x100>)
|
|
800b730: f000 f9f2 bl 800bb18 <RFW_WhiteSetState>
|
|
/*Run the whitening calculation on payload length, payload and crc*/
|
|
RFW_WhiteRun( &RFWPacket, &ChunkBuffer[0], size + RFWPacket.Init.PayloadLengthFieldSize + RFWPacket.Init.CrcFieldSize );
|
|
800b734: 7afb ldrb r3, [r7, #11]
|
|
800b736: 4a13 ldr r2, [pc, #76] @ (800b784 <RFW_TransmitInit+0x100>)
|
|
800b738: 7852 ldrb r2, [r2, #1]
|
|
800b73a: 4413 add r3, r2
|
|
800b73c: 4a11 ldr r2, [pc, #68] @ (800b784 <RFW_TransmitInit+0x100>)
|
|
800b73e: 78d2 ldrb r2, [r2, #3]
|
|
800b740: 4413 add r3, r2
|
|
800b742: 461a mov r2, r3
|
|
800b744: 4911 ldr r1, [pc, #68] @ (800b78c <RFW_TransmitInit+0x108>)
|
|
800b746: 480f ldr r0, [pc, #60] @ (800b784 <RFW_TransmitInit+0x100>)
|
|
800b748: f000 fa1b bl 800bb82 <RFW_WhiteRun>
|
|
/*Configure the Transmitter to send all*/
|
|
*outSize = ( uint8_t ) size + RFWPacket.Init.PayloadLengthFieldSize + RFWPacket.Init.CrcFieldSize;
|
|
800b74c: 4b0d ldr r3, [pc, #52] @ (800b784 <RFW_TransmitInit+0x100>)
|
|
800b74e: 785a ldrb r2, [r3, #1]
|
|
800b750: 7afb ldrb r3, [r7, #11]
|
|
800b752: 4413 add r3, r2
|
|
800b754: b2da uxtb r2, r3
|
|
800b756: 4b0b ldr r3, [pc, #44] @ (800b784 <RFW_TransmitInit+0x100>)
|
|
800b758: 78db ldrb r3, [r3, #3]
|
|
800b75a: 4413 add r3, r2
|
|
800b75c: b2da uxtb r2, r3
|
|
800b75e: 687b ldr r3, [r7, #4]
|
|
800b760: 701a strb r2, [r3, #0]
|
|
/*copy result*/
|
|
RADIO_MEMCPY8( inOutBuffer, ChunkBuffer, *outSize );
|
|
800b762: 687b ldr r3, [r7, #4]
|
|
800b764: 781b ldrb r3, [r3, #0]
|
|
800b766: 461a mov r2, r3
|
|
800b768: 4908 ldr r1, [pc, #32] @ (800b78c <RFW_TransmitInit+0x108>)
|
|
800b76a: 68f8 ldr r0, [r7, #12]
|
|
800b76c: f002 f940 bl 800d9f0 <UTIL_MEM_cpy_8>
|
|
|
|
RFWPacket.LongPacketModeEnable = 0;
|
|
800b770: 4b04 ldr r3, [pc, #16] @ (800b784 <RFW_TransmitInit+0x100>)
|
|
800b772: 2200 movs r2, #0
|
|
800b774: 769a strb r2, [r3, #26]
|
|
|
|
status = 0;
|
|
800b776: 2300 movs r3, #0
|
|
800b778: 617b str r3, [r7, #20]
|
|
}
|
|
#endif /* RFW_ENABLE == 1 */
|
|
return status;
|
|
800b77a: 697b ldr r3, [r7, #20]
|
|
}
|
|
800b77c: 4618 mov r0, r3
|
|
800b77e: 3718 adds r7, #24
|
|
800b780: 46bd mov sp, r7
|
|
800b782: bd80 pop {r7, pc}
|
|
800b784: 20000394 .word 0x20000394
|
|
800b788: 0800f948 .word 0x0800f948
|
|
800b78c: 200003e8 .word 0x200003e8
|
|
|
|
0800b790 <RFW_ReceiveInit>:
|
|
|
|
int32_t RFW_ReceiveInit( void )
|
|
{
|
|
800b790: b580 push {r7, lr}
|
|
800b792: af00 add r7, sp, #0
|
|
#if (RFW_ENABLE == 1 )
|
|
/* Radio IRQ is set to DIO1 by default */
|
|
SUBGRF_SetDioIrqParams( IRQ_RADIO_ALL & ( ~IRQ_RX_DONE ), /* IRQ_RX_DONE | IRQ_RX_TX_TIMEOUT, */
|
|
800b794: 2300 movs r3, #0
|
|
800b796: 2200 movs r2, #0
|
|
800b798: f64f 71fd movw r1, #65533 @ 0xfffd
|
|
800b79c: f64f 70fd movw r0, #65533 @ 0xfffd
|
|
800b7a0: f7fe fe26 bl 800a3f0 <SUBGRF_SetDioIrqParams>
|
|
IRQ_RADIO_ALL & ( ~IRQ_RX_DONE ), /* IRQ_RX_DONE | IRQ_RX_TX_TIMEOUT, */
|
|
IRQ_RADIO_NONE,
|
|
IRQ_RADIO_NONE );
|
|
|
|
/*init whitening at beginning of the packet*/
|
|
RFW_WhiteSetState( &RFWPacket );
|
|
800b7a4: 4807 ldr r0, [pc, #28] @ (800b7c4 <RFW_ReceiveInit+0x34>)
|
|
800b7a6: f000 f9b7 bl 800bb18 <RFW_WhiteSetState>
|
|
/* Set the state of the Crc to crc_seed*/
|
|
RFW_CrcSetState( &RFWPacket );
|
|
800b7aa: 4806 ldr r0, [pc, #24] @ (800b7c4 <RFW_ReceiveInit+0x34>)
|
|
800b7ac: f000 f9dc bl 800bb68 <RFW_CrcSetState>
|
|
|
|
RFWPacket.RxPayloadOffset = 0;
|
|
800b7b0: 4b04 ldr r3, [pc, #16] @ (800b7c4 <RFW_ReceiveInit+0x34>)
|
|
800b7b2: 2200 movs r2, #0
|
|
800b7b4: 871a strh r2, [r3, #56] @ 0x38
|
|
|
|
RFWPacket.LongPacketModeEnable = 0;
|
|
800b7b6: 4b03 ldr r3, [pc, #12] @ (800b7c4 <RFW_ReceiveInit+0x34>)
|
|
800b7b8: 2200 movs r2, #0
|
|
800b7ba: 769a strb r2, [r3, #26]
|
|
return 0;
|
|
800b7bc: 2300 movs r3, #0
|
|
#else
|
|
return -1;
|
|
#endif /* RFW_ENABLE == 1 */
|
|
}
|
|
800b7be: 4618 mov r0, r3
|
|
800b7c0: bd80 pop {r7, pc}
|
|
800b7c2: bf00 nop
|
|
800b7c4: 20000394 .word 0x20000394
|
|
|
|
0800b7c8 <RFW_DeInit_TxLongPacket>:
|
|
|
|
void RFW_DeInit_TxLongPacket( void )
|
|
{
|
|
800b7c8: b580 push {r7, lr}
|
|
800b7ca: b082 sub sp, #8
|
|
800b7cc: af00 add r7, sp, #0
|
|
#if (RFW_LONGPACKET_ENABLE == 1 )
|
|
/*long packet WA*/
|
|
uint8_t reg = SUBGRF_ReadRegister( SUBGHZ_GPKTCTL1AR );
|
|
800b7ce: f44f 60d7 mov.w r0, #1720 @ 0x6b8
|
|
800b7d2: f7ff f9d9 bl 800ab88 <SUBGRF_ReadRegister>
|
|
800b7d6: 4603 mov r3, r0
|
|
800b7d8: 71fb strb r3, [r7, #7]
|
|
SUBGRF_WriteRegister( SUBGHZ_GPKTCTL1AR, reg & ~0x02 ); /* clear infinite_sequence bit */
|
|
800b7da: 79fb ldrb r3, [r7, #7]
|
|
800b7dc: f023 0302 bic.w r3, r3, #2
|
|
800b7e0: b2db uxtb r3, r3
|
|
800b7e2: 4619 mov r1, r3
|
|
800b7e4: f44f 60d7 mov.w r0, #1720 @ 0x6b8
|
|
800b7e8: f7ff f9ac bl 800ab44 <SUBGRF_WriteRegister>
|
|
SUBGRF_WriteRegister( SUBGHZ_GRTXPLDLEN, 0xFF ); /* RxTxPldLen: reset to 0xFF */
|
|
800b7ec: 21ff movs r1, #255 @ 0xff
|
|
800b7ee: f240 60bb movw r0, #1723 @ 0x6bb
|
|
800b7f2: f7ff f9a7 bl 800ab44 <SUBGRF_WriteRegister>
|
|
#endif /* RFW_LONGPACKET_ENABLE == 1 */
|
|
}
|
|
800b7f6: bf00 nop
|
|
800b7f8: 3708 adds r7, #8
|
|
800b7fa: 46bd mov sp, r7
|
|
800b7fc: bd80 pop {r7, pc}
|
|
...
|
|
|
|
0800b800 <RFW_ReceivePayload>:
|
|
|
|
void RFW_ReceivePayload( void )
|
|
{
|
|
800b800: b580 push {r7, lr}
|
|
800b802: b086 sub sp, #24
|
|
800b804: af02 add r7, sp, #8
|
|
#if (RFW_ENABLE == 1 )
|
|
uint16_t PayloadLength = 0;
|
|
800b806: 2300 movs r3, #0
|
|
800b808: 80fb strh r3, [r7, #6]
|
|
if( RFW_GetPacketLength( &PayloadLength ) == 0 )
|
|
800b80a: 1dbb adds r3, r7, #6
|
|
800b80c: 4618 mov r0, r3
|
|
800b80e: f000 fab7 bl 800bd80 <RFW_GetPacketLength>
|
|
800b812: 4603 mov r3, r0
|
|
800b814: 2b00 cmp r3, #0
|
|
800b816: d15e bne.n 800b8d6 <RFW_ReceivePayload+0xd6>
|
|
{
|
|
uint32_t timeout;
|
|
uint32_t packet_length = PayloadLength + RFWPacket.Init.CrcFieldSize;
|
|
800b818: 88fb ldrh r3, [r7, #6]
|
|
800b81a: 461a mov r2, r3
|
|
800b81c: 4b33 ldr r3, [pc, #204] @ (800b8ec <RFW_ReceivePayload+0xec>)
|
|
800b81e: 78db ldrb r3, [r3, #3]
|
|
800b820: 4413 add r3, r2
|
|
800b822: 60bb str r3, [r7, #8]
|
|
/*record payload length*/
|
|
RFWPacket.PayloadLength = PayloadLength;
|
|
800b824: 88fa ldrh r2, [r7, #6]
|
|
800b826: 4b31 ldr r3, [pc, #196] @ (800b8ec <RFW_ReceivePayload+0xec>)
|
|
800b828: 831a strh r2, [r3, #24]
|
|
/*record remaining payload length*/
|
|
RFWPacket.LongPacketRemainingBytes = ( uint16_t ) packet_length;
|
|
800b82a: 68bb ldr r3, [r7, #8]
|
|
800b82c: b29a uxth r2, r3
|
|
800b82e: 4b2f ldr r3, [pc, #188] @ (800b8ec <RFW_ReceivePayload+0xec>)
|
|
800b830: 869a strh r2, [r3, #52] @ 0x34
|
|
/*record rx buffer offset*/
|
|
RFWPacket.RadioBufferOffset = RFWPacket.Init.PayloadLengthFieldSize;
|
|
800b832: 4b2e ldr r3, [pc, #184] @ (800b8ec <RFW_ReceivePayload+0xec>)
|
|
800b834: 785a ldrb r2, [r3, #1]
|
|
800b836: 4b2d ldr r3, [pc, #180] @ (800b8ec <RFW_ReceivePayload+0xec>)
|
|
800b838: f883 2036 strb.w r2, [r3, #54] @ 0x36
|
|
/*if decoded PayloadLength is longer than LongPacketMaxRxLength, reject packet*/
|
|
if( PayloadLength > RFWPacket.Init.LongPacketMaxRxLength )
|
|
800b83c: 4b2b ldr r3, [pc, #172] @ (800b8ec <RFW_ReceivePayload+0xec>)
|
|
800b83e: 899a ldrh r2, [r3, #12]
|
|
800b840: 88fb ldrh r3, [r7, #6]
|
|
800b842: 429a cmp r2, r3
|
|
800b844: d207 bcs.n 800b856 <RFW_ReceivePayload+0x56>
|
|
{
|
|
SUBGRF_SetStandby( STDBY_RC );
|
|
800b846: 2000 movs r0, #0
|
|
800b848: f7fe fbf8 bl 800a03c <SUBGRF_SetStandby>
|
|
RFWPacket.Init.RadioEvents->RxError( );
|
|
800b84c: 4b27 ldr r3, [pc, #156] @ (800b8ec <RFW_ReceivePayload+0xec>)
|
|
800b84e: 691b ldr r3, [r3, #16]
|
|
800b850: 691b ldr r3, [r3, #16]
|
|
800b852: 4798 blx r3
|
|
800b854: e046 b.n 800b8e4 <RFW_ReceivePayload+0xe4>
|
|
return;
|
|
}
|
|
if( packet_length < LONGPACKET_CHUNK_LENGTH_BYTES )
|
|
800b856: 68bb ldr r3, [r7, #8]
|
|
800b858: 2b7f cmp r3, #127 @ 0x7f
|
|
800b85a: d817 bhi.n 800b88c <RFW_ReceivePayload+0x8c>
|
|
{
|
|
/* all in one chunks*/
|
|
/* calculate time to end of packet*/
|
|
timeout = DIVC( ( packet_length ) * 8 * 1000, RFWPacket.BitRate ) + 2;
|
|
800b85c: 68bb ldr r3, [r7, #8]
|
|
800b85e: f44f 52fa mov.w r2, #8000 @ 0x1f40
|
|
800b862: fb03 f202 mul.w r2, r3, r2
|
|
800b866: 4b21 ldr r3, [pc, #132] @ (800b8ec <RFW_ReceivePayload+0xec>)
|
|
800b868: 6c9b ldr r3, [r3, #72] @ 0x48
|
|
800b86a: 4413 add r3, r2
|
|
800b86c: 1e5a subs r2, r3, #1
|
|
800b86e: 4b1f ldr r3, [pc, #124] @ (800b8ec <RFW_ReceivePayload+0xec>)
|
|
800b870: 6c9b ldr r3, [r3, #72] @ 0x48
|
|
800b872: fbb2 f3f3 udiv r3, r2, r3
|
|
800b876: 3302 adds r3, #2
|
|
800b878: 60fb str r3, [r7, #12]
|
|
/**/
|
|
/* start timer at the end of the packet*/
|
|
RFW_MW_LOG( TS_ON, VLEVEL_M, "end packet in %dms\r\n", timeout );
|
|
800b87a: 68fb ldr r3, [r7, #12]
|
|
800b87c: 9300 str r3, [sp, #0]
|
|
800b87e: 4b1c ldr r3, [pc, #112] @ (800b8f0 <RFW_ReceivePayload+0xf0>)
|
|
800b880: 2201 movs r2, #1
|
|
800b882: 2100 movs r1, #0
|
|
800b884: 2002 movs r0, #2
|
|
800b886: f002 ffb1 bl 800e7ec <UTIL_ADV_TRACE_COND_FSend>
|
|
800b88a: e01c b.n 800b8c6 <RFW_ReceivePayload+0xc6>
|
|
|
|
}
|
|
else if( packet_length < ( 3 * LONGPACKET_CHUNK_LENGTH_BYTES / 2 ) )
|
|
800b88c: 68bb ldr r3, [r7, #8]
|
|
800b88e: 2bbf cmp r3, #191 @ 0xbf
|
|
800b890: d80f bhi.n 800b8b2 <RFW_ReceivePayload+0xb2>
|
|
{
|
|
/* packet contained in 2 chunks*/
|
|
/* make sure that crc not cut in chunk*/
|
|
timeout = DIVR( ( packet_length * 8 * 1000 ) / 2, RFWPacket.BitRate );
|
|
800b892: 68bb ldr r3, [r7, #8]
|
|
800b894: f44f 52fa mov.w r2, #8000 @ 0x1f40
|
|
800b898: fb02 f303 mul.w r3, r2, r3
|
|
800b89c: 085a lsrs r2, r3, #1
|
|
800b89e: 4b13 ldr r3, [pc, #76] @ (800b8ec <RFW_ReceivePayload+0xec>)
|
|
800b8a0: 6c9b ldr r3, [r3, #72] @ 0x48
|
|
800b8a2: 085b lsrs r3, r3, #1
|
|
800b8a4: 441a add r2, r3
|
|
800b8a6: 4b11 ldr r3, [pc, #68] @ (800b8ec <RFW_ReceivePayload+0xec>)
|
|
800b8a8: 6c9b ldr r3, [r3, #72] @ 0x48
|
|
800b8aa: fbb2 f3f3 udiv r3, r2, r3
|
|
800b8ae: 60fb str r3, [r7, #12]
|
|
800b8b0: e009 b.n 800b8c6 <RFW_ReceivePayload+0xc6>
|
|
}
|
|
else
|
|
{
|
|
/* packet contained in multiple chunk*/
|
|
/* program radio timer for first chunk*/
|
|
timeout = DIVR( LONGPACKET_CHUNK_LENGTH_BYTES * 8 * 1000, RFWPacket.BitRate );
|
|
800b8b2: 4b0e ldr r3, [pc, #56] @ (800b8ec <RFW_ReceivePayload+0xec>)
|
|
800b8b4: 6c9b ldr r3, [r3, #72] @ 0x48
|
|
800b8b6: 085b lsrs r3, r3, #1
|
|
800b8b8: f503 227a add.w r2, r3, #1024000 @ 0xfa000
|
|
800b8bc: 4b0b ldr r3, [pc, #44] @ (800b8ec <RFW_ReceivePayload+0xec>)
|
|
800b8be: 6c9b ldr r3, [r3, #72] @ 0x48
|
|
800b8c0: fbb2 f3f3 udiv r3, r2, r3
|
|
800b8c4: 60fb str r3, [r7, #12]
|
|
}
|
|
TimerSetValue( &RFWPacket.Timer, timeout );
|
|
800b8c6: 68f9 ldr r1, [r7, #12]
|
|
800b8c8: 480a ldr r0, [pc, #40] @ (800b8f4 <RFW_ReceivePayload+0xf4>)
|
|
800b8ca: f002 fe07 bl 800e4dc <UTIL_TIMER_SetPeriod>
|
|
TimerStart( &RFWPacket.Timer );
|
|
800b8ce: 4809 ldr r0, [pc, #36] @ (800b8f4 <RFW_ReceivePayload+0xf4>)
|
|
800b8d0: f002 fd26 bl 800e320 <UTIL_TIMER_Start>
|
|
800b8d4: e006 b.n 800b8e4 <RFW_ReceivePayload+0xe4>
|
|
}
|
|
else
|
|
{
|
|
/*timeout*/
|
|
SUBGRF_SetStandby( STDBY_RC );
|
|
800b8d6: 2000 movs r0, #0
|
|
800b8d8: f7fe fbb0 bl 800a03c <SUBGRF_SetStandby>
|
|
RFWPacket.Init.RadioEvents->RxTimeout( );
|
|
800b8dc: 4b03 ldr r3, [pc, #12] @ (800b8ec <RFW_ReceivePayload+0xec>)
|
|
800b8de: 691b ldr r3, [r3, #16]
|
|
800b8e0: 68db ldr r3, [r3, #12]
|
|
800b8e2: 4798 blx r3
|
|
}
|
|
#endif /* RFW_ENABLE == 1 */
|
|
}
|
|
800b8e4: 3710 adds r7, #16
|
|
800b8e6: 46bd mov sp, r7
|
|
800b8e8: bd80 pop {r7, pc}
|
|
800b8ea: bf00 nop
|
|
800b8ec: 20000394 .word 0x20000394
|
|
800b8f0: 0800f960 .word 0x0800f960
|
|
800b8f4: 200003b0 .word 0x200003b0
|
|
|
|
0800b8f8 <RFW_SetRadioModem>:
|
|
|
|
void RFW_SetRadioModem( RadioModems_t Modem )
|
|
{
|
|
800b8f8: b480 push {r7}
|
|
800b8fa: b083 sub sp, #12
|
|
800b8fc: af00 add r7, sp, #0
|
|
800b8fe: 4603 mov r3, r0
|
|
800b900: 71fb strb r3, [r7, #7]
|
|
#if (RFW_ENABLE == 1 )
|
|
RFWPacket.Init.Modem = Modem;
|
|
800b902: 4a04 ldr r2, [pc, #16] @ (800b914 <RFW_SetRadioModem+0x1c>)
|
|
800b904: 79fb ldrb r3, [r7, #7]
|
|
800b906: 7393 strb r3, [r2, #14]
|
|
#endif /* RFW_ENABLE == 1 */
|
|
}
|
|
800b908: bf00 nop
|
|
800b90a: 370c adds r7, #12
|
|
800b90c: 46bd mov sp, r7
|
|
800b90e: bc80 pop {r7}
|
|
800b910: 4770 bx lr
|
|
800b912: bf00 nop
|
|
800b914: 20000394 .word 0x20000394
|
|
|
|
0800b918 <RFW_TransmitLongPacket_NewTxChunkTimerEvent>:
|
|
|
|
/* Private Functions Definition -----------------------------------------------*/
|
|
#if (RFW_LONGPACKET_ENABLE == 1 )
|
|
static void RFW_TransmitLongPacket_NewTxChunkTimerEvent( void *param )
|
|
{
|
|
800b918: b580 push {r7, lr}
|
|
800b91a: b082 sub sp, #8
|
|
800b91c: af00 add r7, sp, #0
|
|
800b91e: 6078 str r0, [r7, #4]
|
|
RFW_TRANSMIT_LONGPACKET_TX_CHUNK_PROCESS();
|
|
800b920: f000 f804 bl 800b92c <RFW_TransmitLongPacket_TxChunkProcess>
|
|
}
|
|
800b924: bf00 nop
|
|
800b926: 3708 adds r7, #8
|
|
800b928: 46bd mov sp, r7
|
|
800b92a: bd80 pop {r7, pc}
|
|
|
|
0800b92c <RFW_TransmitLongPacket_TxChunkProcess>:
|
|
|
|
static void RFW_TransmitLongPacket_TxChunkProcess( void )
|
|
{
|
|
800b92c: b590 push {r4, r7, lr}
|
|
800b92e: b08d sub sp, #52 @ 0x34
|
|
800b930: af06 add r7, sp, #24
|
|
uint8_t *app_chunk_buffer_ptr = NULL;
|
|
800b932: 2300 movs r3, #0
|
|
800b934: 60bb str r3, [r7, #8]
|
|
uint8_t chunk_size = 0;
|
|
800b936: 2300 movs r3, #0
|
|
800b938: 75fb strb r3, [r7, #23]
|
|
uint8_t crc_result[2] = {0};
|
|
800b93a: 2300 movs r3, #0
|
|
800b93c: 80bb strh r3, [r7, #4]
|
|
uint8_t crc_size;
|
|
uint32_t timeout;/*timeout for next chunk*/
|
|
/*records how much has been sent*/
|
|
uint8_t read_ptr = SUBGRF_ReadRegister( SUBGHZ_TXADRPTR ); /*radio has transmitted up to read_ptr*/
|
|
800b93e: f640 0002 movw r0, #2050 @ 0x802
|
|
800b942: f7ff f921 bl 800ab88 <SUBGRF_ReadRegister>
|
|
800b946: 4603 mov r3, r0
|
|
800b948: 757b strb r3, [r7, #21]
|
|
uint8_t write_ptr = SUBGRF_ReadRegister( SUBGHZ_GRTXPLDLEN ); /*from read_ptr to write_ptr still to be transmitted*/
|
|
800b94a: f240 60bb movw r0, #1723 @ 0x6bb
|
|
800b94e: f7ff f91b bl 800ab88 <SUBGRF_ReadRegister>
|
|
800b952: 4603 mov r3, r0
|
|
800b954: 753b strb r3, [r7, #20]
|
|
/*calculates how much bytes were sent since previous radio loading*/
|
|
uint8_t bytes_sent = read_ptr - RFWPacket.RadioBufferOffset;
|
|
800b956: 4b64 ldr r3, [pc, #400] @ (800bae8 <RFW_TransmitLongPacket_TxChunkProcess+0x1bc>)
|
|
800b958: f893 3036 ldrb.w r3, [r3, #54] @ 0x36
|
|
800b95c: 7d7a ldrb r2, [r7, #21]
|
|
800b95e: 1ad3 subs r3, r2, r3
|
|
800b960: 74fb strb r3, [r7, #19]
|
|
/*bytes already loaded in the radio to send*/
|
|
uint8_t bytes_loaded = write_ptr - read_ptr;
|
|
800b962: 7d3a ldrb r2, [r7, #20]
|
|
800b964: 7d7b ldrb r3, [r7, #21]
|
|
800b966: 1ad3 subs r3, r2, r3
|
|
800b968: 74bb strb r3, [r7, #18]
|
|
|
|
/* Update offset tx, intentional wrap around*/
|
|
RFWPacket.RadioBufferOffset += bytes_sent;
|
|
800b96a: 4b5f ldr r3, [pc, #380] @ (800bae8 <RFW_TransmitLongPacket_TxChunkProcess+0x1bc>)
|
|
800b96c: f893 2036 ldrb.w r2, [r3, #54] @ 0x36
|
|
800b970: 7cfb ldrb r3, [r7, #19]
|
|
800b972: 4413 add r3, r2
|
|
800b974: b2da uxtb r2, r3
|
|
800b976: 4b5c ldr r3, [pc, #368] @ (800bae8 <RFW_TransmitLongPacket_TxChunkProcess+0x1bc>)
|
|
800b978: f883 2036 strb.w r2, [r3, #54] @ 0x36
|
|
/*record payload remaining bytes to send*/
|
|
RFWPacket.LongPacketRemainingBytes -= bytes_sent;
|
|
800b97c: 4b5a ldr r3, [pc, #360] @ (800bae8 <RFW_TransmitLongPacket_TxChunkProcess+0x1bc>)
|
|
800b97e: 8e9a ldrh r2, [r3, #52] @ 0x34
|
|
800b980: 7cfb ldrb r3, [r7, #19]
|
|
800b982: b29b uxth r3, r3
|
|
800b984: 1ad3 subs r3, r2, r3
|
|
800b986: b29a uxth r2, r3
|
|
800b988: 4b57 ldr r3, [pc, #348] @ (800bae8 <RFW_TransmitLongPacket_TxChunkProcess+0x1bc>)
|
|
800b98a: 869a strh r2, [r3, #52] @ 0x34
|
|
RFW_MW_LOG( TS_ON, VLEVEL_M, "read_ptr=%d, write_ptr=%d, bytes_sent=%d, bytes_loaded=%d,remaining to send=%d\r\n",
|
|
800b98c: 7d7b ldrb r3, [r7, #21]
|
|
800b98e: 7d3a ldrb r2, [r7, #20]
|
|
800b990: 7cf9 ldrb r1, [r7, #19]
|
|
800b992: 7cb8 ldrb r0, [r7, #18]
|
|
800b994: 4c54 ldr r4, [pc, #336] @ (800bae8 <RFW_TransmitLongPacket_TxChunkProcess+0x1bc>)
|
|
800b996: 8ea4 ldrh r4, [r4, #52] @ 0x34
|
|
800b998: 9404 str r4, [sp, #16]
|
|
800b99a: 9003 str r0, [sp, #12]
|
|
800b99c: 9102 str r1, [sp, #8]
|
|
800b99e: 9201 str r2, [sp, #4]
|
|
800b9a0: 9300 str r3, [sp, #0]
|
|
800b9a2: 4b52 ldr r3, [pc, #328] @ (800baec <RFW_TransmitLongPacket_TxChunkProcess+0x1c0>)
|
|
800b9a4: 2201 movs r2, #1
|
|
800b9a6: 2100 movs r1, #0
|
|
800b9a8: 2002 movs r0, #2
|
|
800b9aa: f002 ff1f bl 800e7ec <UTIL_ADV_TRACE_COND_FSend>
|
|
read_ptr, write_ptr, bytes_sent, bytes_loaded, RFWPacket.LongPacketRemainingBytes );
|
|
if( RFWPacket.LongPacketRemainingBytes > 256 )
|
|
800b9ae: 4b4e ldr r3, [pc, #312] @ (800bae8 <RFW_TransmitLongPacket_TxChunkProcess+0x1bc>)
|
|
800b9b0: 8e9b ldrh r3, [r3, #52] @ 0x34
|
|
800b9b2: f5b3 7f80 cmp.w r3, #256 @ 0x100
|
|
800b9b6: d929 bls.n 800ba0c <RFW_TransmitLongPacket_TxChunkProcess+0xe0>
|
|
{
|
|
/*get next chunk */
|
|
/*make sure that at least full CrcFieldSize will be loaded for the last chunk*/
|
|
if( RFWPacket.LongPacketRemainingBytes > 256 + RFWPacket.Init.CrcFieldSize )
|
|
800b9b8: 4b4b ldr r3, [pc, #300] @ (800bae8 <RFW_TransmitLongPacket_TxChunkProcess+0x1bc>)
|
|
800b9ba: 8e9b ldrh r3, [r3, #52] @ 0x34
|
|
800b9bc: 461a mov r2, r3
|
|
800b9be: 4b4a ldr r3, [pc, #296] @ (800bae8 <RFW_TransmitLongPacket_TxChunkProcess+0x1bc>)
|
|
800b9c0: 78db ldrb r3, [r3, #3]
|
|
800b9c2: f503 7380 add.w r3, r3, #256 @ 0x100
|
|
800b9c6: 429a cmp r2, r3
|
|
800b9c8: dd02 ble.n 800b9d0 <RFW_TransmitLongPacket_TxChunkProcess+0xa4>
|
|
{
|
|
chunk_size = bytes_sent;
|
|
800b9ca: 7cfb ldrb r3, [r7, #19]
|
|
800b9cc: 75fb strb r3, [r7, #23]
|
|
800b9ce: e004 b.n 800b9da <RFW_TransmitLongPacket_TxChunkProcess+0xae>
|
|
}
|
|
else
|
|
{
|
|
chunk_size = bytes_sent - RFWPacket.Init.CrcFieldSize;
|
|
800b9d0: 4b45 ldr r3, [pc, #276] @ (800bae8 <RFW_TransmitLongPacket_TxChunkProcess+0x1bc>)
|
|
800b9d2: 78db ldrb r3, [r3, #3]
|
|
800b9d4: 7cfa ldrb r2, [r7, #19]
|
|
800b9d6: 1ad3 subs r3, r2, r3
|
|
800b9d8: 75fb strb r3, [r7, #23]
|
|
}
|
|
/*no crc since it is not the last chunk*/
|
|
crc_size = 0;
|
|
800b9da: 2300 movs r3, #0
|
|
800b9dc: 75bb strb r3, [r7, #22]
|
|
/*calculate timeout for next chunk*/
|
|
timeout = DIVR( chunk_size * 8 * 1000, RFWPacket.BitRate );
|
|
800b9de: 7dfb ldrb r3, [r7, #23]
|
|
800b9e0: f44f 52fa mov.w r2, #8000 @ 0x1f40
|
|
800b9e4: fb02 f303 mul.w r3, r2, r3
|
|
800b9e8: 461a mov r2, r3
|
|
800b9ea: 4b3f ldr r3, [pc, #252] @ (800bae8 <RFW_TransmitLongPacket_TxChunkProcess+0x1bc>)
|
|
800b9ec: 6c9b ldr r3, [r3, #72] @ 0x48
|
|
800b9ee: 085b lsrs r3, r3, #1
|
|
800b9f0: 441a add r2, r3
|
|
800b9f2: 4b3d ldr r3, [pc, #244] @ (800bae8 <RFW_TransmitLongPacket_TxChunkProcess+0x1bc>)
|
|
800b9f4: 6c9b ldr r3, [r3, #72] @ 0x48
|
|
800b9f6: fbb2 f3f3 udiv r3, r2, r3
|
|
800b9fa: 60fb str r3, [r7, #12]
|
|
|
|
TimerSetValue( &RFWPacket.Timer, timeout );
|
|
800b9fc: 68f9 ldr r1, [r7, #12]
|
|
800b9fe: 483c ldr r0, [pc, #240] @ (800baf0 <RFW_TransmitLongPacket_TxChunkProcess+0x1c4>)
|
|
800ba00: f002 fd6c bl 800e4dc <UTIL_TIMER_SetPeriod>
|
|
TimerStart( &RFWPacket.Timer );
|
|
800ba04: 483a ldr r0, [pc, #232] @ (800baf0 <RFW_TransmitLongPacket_TxChunkProcess+0x1c4>)
|
|
800ba06: f002 fc8b bl 800e320 <UTIL_TIMER_Start>
|
|
800ba0a: e015 b.n 800ba38 <RFW_TransmitLongPacket_TxChunkProcess+0x10c>
|
|
}
|
|
else
|
|
{
|
|
/*last chunk to send*/
|
|
|
|
if( RFWPacket.LongPacketRemainingBytes > bytes_loaded )
|
|
800ba0c: 4b36 ldr r3, [pc, #216] @ (800bae8 <RFW_TransmitLongPacket_TxChunkProcess+0x1bc>)
|
|
800ba0e: 8e9a ldrh r2, [r3, #52] @ 0x34
|
|
800ba10: 7cbb ldrb r3, [r7, #18]
|
|
800ba12: b29b uxth r3, r3
|
|
800ba14: 429a cmp r2, r3
|
|
800ba16: d906 bls.n 800ba26 <RFW_TransmitLongPacket_TxChunkProcess+0xfa>
|
|
{
|
|
chunk_size = RFWPacket.LongPacketRemainingBytes - bytes_loaded;
|
|
800ba18: 4b33 ldr r3, [pc, #204] @ (800bae8 <RFW_TransmitLongPacket_TxChunkProcess+0x1bc>)
|
|
800ba1a: 8e9b ldrh r3, [r3, #52] @ 0x34
|
|
800ba1c: b2da uxtb r2, r3
|
|
800ba1e: 7cbb ldrb r3, [r7, #18]
|
|
800ba20: 1ad3 subs r3, r2, r3
|
|
800ba22: 75fb strb r3, [r7, #23]
|
|
800ba24: e002 b.n 800ba2c <RFW_TransmitLongPacket_TxChunkProcess+0x100>
|
|
}
|
|
else/* nothing to load anymore*/
|
|
{
|
|
chunk_size = RFWPacket.Init.CrcFieldSize;
|
|
800ba26: 4b30 ldr r3, [pc, #192] @ (800bae8 <RFW_TransmitLongPacket_TxChunkProcess+0x1bc>)
|
|
800ba28: 78db ldrb r3, [r3, #3]
|
|
800ba2a: 75fb strb r3, [r7, #23]
|
|
}
|
|
/* crc, since it is the last chunk*/
|
|
crc_size = RFWPacket.Init.CrcFieldSize;
|
|
800ba2c: 4b2e ldr r3, [pc, #184] @ (800bae8 <RFW_TransmitLongPacket_TxChunkProcess+0x1bc>)
|
|
800ba2e: 78db ldrb r3, [r3, #3]
|
|
800ba30: 75bb strb r3, [r7, #22]
|
|
/*no more bytes to send*/
|
|
RFWPacket.LongPacketRemainingBytes = 0;
|
|
800ba32: 4b2d ldr r3, [pc, #180] @ (800bae8 <RFW_TransmitLongPacket_TxChunkProcess+0x1bc>)
|
|
800ba34: 2200 movs r2, #0
|
|
800ba36: 869a strh r2, [r3, #52] @ 0x34
|
|
/*no need to program another timer, Tx done will complete the Tx process*/
|
|
}
|
|
/*get new chunk from the app*/
|
|
RFWPacket.TxLongPacketGetNextChunkCb( &app_chunk_buffer_ptr, chunk_size - crc_size );
|
|
800ba38: 4b2b ldr r3, [pc, #172] @ (800bae8 <RFW_TransmitLongPacket_TxChunkProcess+0x1bc>)
|
|
800ba3a: 6c1b ldr r3, [r3, #64] @ 0x40
|
|
800ba3c: 7df9 ldrb r1, [r7, #23]
|
|
800ba3e: 7dba ldrb r2, [r7, #22]
|
|
800ba40: 1a8a subs r2, r1, r2
|
|
800ba42: b2d1 uxtb r1, r2
|
|
800ba44: f107 0208 add.w r2, r7, #8
|
|
800ba48: 4610 mov r0, r2
|
|
800ba4a: 4798 blx r3
|
|
/* Copy app_chunk_buffer_ptr in ChunkBuffer Buffer*/
|
|
RADIO_MEMCPY8( ChunkBuffer, app_chunk_buffer_ptr, chunk_size - crc_size );
|
|
800ba4c: 68b9 ldr r1, [r7, #8]
|
|
800ba4e: 7dfb ldrb r3, [r7, #23]
|
|
800ba50: b29a uxth r2, r3
|
|
800ba52: 7dbb ldrb r3, [r7, #22]
|
|
800ba54: b29b uxth r3, r3
|
|
800ba56: 1ad3 subs r3, r2, r3
|
|
800ba58: b29b uxth r3, r3
|
|
800ba5a: 461a mov r2, r3
|
|
800ba5c: 4825 ldr r0, [pc, #148] @ (800baf4 <RFW_TransmitLongPacket_TxChunkProcess+0x1c8>)
|
|
800ba5e: f001 ffc7 bl 800d9f0 <UTIL_MEM_cpy_8>
|
|
if( RFWPacket.Init.CrcEnable == 1 )
|
|
800ba62: 4b21 ldr r3, [pc, #132] @ (800bae8 <RFW_TransmitLongPacket_TxChunkProcess+0x1bc>)
|
|
800ba64: 789b ldrb r3, [r3, #2]
|
|
800ba66: 2b01 cmp r3, #1
|
|
800ba68: d113 bne.n 800ba92 <RFW_TransmitLongPacket_TxChunkProcess+0x166>
|
|
{
|
|
/* Run the crc calculation on payload length and payload*/
|
|
RFW_CrcRun( &RFWPacket, ChunkBuffer, chunk_size - crc_size, crc_result );
|
|
800ba6a: 7dfa ldrb r2, [r7, #23]
|
|
800ba6c: 7dbb ldrb r3, [r7, #22]
|
|
800ba6e: 1ad3 subs r3, r2, r3
|
|
800ba70: 461a mov r2, r3
|
|
800ba72: 1d3b adds r3, r7, #4
|
|
800ba74: 491f ldr r1, [pc, #124] @ (800baf4 <RFW_TransmitLongPacket_TxChunkProcess+0x1c8>)
|
|
800ba76: 481c ldr r0, [pc, #112] @ (800bae8 <RFW_TransmitLongPacket_TxChunkProcess+0x1bc>)
|
|
800ba78: f000 f8cb bl 800bc12 <RFW_CrcRun>
|
|
/* Append the crc result after the payload (if last chunk)*/
|
|
RADIO_MEMCPY8( &ChunkBuffer[chunk_size - crc_size], crc_result, crc_size );
|
|
800ba7c: 7dfa ldrb r2, [r7, #23]
|
|
800ba7e: 7dbb ldrb r3, [r7, #22]
|
|
800ba80: 1ad3 subs r3, r2, r3
|
|
800ba82: 4a1c ldr r2, [pc, #112] @ (800baf4 <RFW_TransmitLongPacket_TxChunkProcess+0x1c8>)
|
|
800ba84: 4413 add r3, r2
|
|
800ba86: 7dba ldrb r2, [r7, #22]
|
|
800ba88: b292 uxth r2, r2
|
|
800ba8a: 1d39 adds r1, r7, #4
|
|
800ba8c: 4618 mov r0, r3
|
|
800ba8e: f001 ffaf bl 800d9f0 <UTIL_MEM_cpy_8>
|
|
}
|
|
/* Run the whitening calculation on payload length, payload and crc*/
|
|
RFW_WhiteRun( &RFWPacket, ChunkBuffer, chunk_size );
|
|
800ba92: 7dfb ldrb r3, [r7, #23]
|
|
800ba94: 461a mov r2, r3
|
|
800ba96: 4917 ldr r1, [pc, #92] @ (800baf4 <RFW_TransmitLongPacket_TxChunkProcess+0x1c8>)
|
|
800ba98: 4813 ldr r0, [pc, #76] @ (800bae8 <RFW_TransmitLongPacket_TxChunkProcess+0x1bc>)
|
|
800ba9a: f000 f872 bl 800bb82 <RFW_WhiteRun>
|
|
/*write next chunk*/
|
|
SUBGRF_WriteBuffer( write_ptr, ChunkBuffer, chunk_size );
|
|
800ba9e: 7dfa ldrb r2, [r7, #23]
|
|
800baa0: 7d3b ldrb r3, [r7, #20]
|
|
800baa2: 4914 ldr r1, [pc, #80] @ (800baf4 <RFW_TransmitLongPacket_TxChunkProcess+0x1c8>)
|
|
800baa4: 4618 mov r0, r3
|
|
800baa6: f7ff f8d3 bl 800ac50 <SUBGRF_WriteBuffer>
|
|
|
|
/*update end ptr*/
|
|
SUBGRF_WriteRegister( SUBGHZ_GRTXPLDLEN, ( uint8_t )( chunk_size + write_ptr ) );
|
|
800baaa: 7dfa ldrb r2, [r7, #23]
|
|
800baac: 7d3b ldrb r3, [r7, #20]
|
|
800baae: 4413 add r3, r2
|
|
800bab0: b2db uxtb r3, r3
|
|
800bab2: 4619 mov r1, r3
|
|
800bab4: f240 60bb movw r0, #1723 @ 0x6bb
|
|
800bab8: f7ff f844 bl 800ab44 <SUBGRF_WriteRegister>
|
|
|
|
RFW_MW_LOG( TS_ON, VLEVEL_M, "next chunk size=%d, new write ptr=%d\n\r", chunk_size + crc_size,
|
|
800babc: 7dfa ldrb r2, [r7, #23]
|
|
800babe: 7dbb ldrb r3, [r7, #22]
|
|
800bac0: 4413 add r3, r2
|
|
800bac2: 7df9 ldrb r1, [r7, #23]
|
|
800bac4: 7dba ldrb r2, [r7, #22]
|
|
800bac6: 440a add r2, r1
|
|
800bac8: b2d1 uxtb r1, r2
|
|
800baca: 7d3a ldrb r2, [r7, #20]
|
|
800bacc: 440a add r2, r1
|
|
800bace: b2d2 uxtb r2, r2
|
|
800bad0: 9201 str r2, [sp, #4]
|
|
800bad2: 9300 str r3, [sp, #0]
|
|
800bad4: 4b08 ldr r3, [pc, #32] @ (800baf8 <RFW_TransmitLongPacket_TxChunkProcess+0x1cc>)
|
|
800bad6: 2201 movs r2, #1
|
|
800bad8: 2100 movs r1, #0
|
|
800bada: 2002 movs r0, #2
|
|
800badc: f002 fe86 bl 800e7ec <UTIL_ADV_TRACE_COND_FSend>
|
|
( uint8_t )( chunk_size + crc_size + write_ptr ) );
|
|
}
|
|
800bae0: bf00 nop
|
|
800bae2: 371c adds r7, #28
|
|
800bae4: 46bd mov sp, r7
|
|
800bae6: bd90 pop {r4, r7, pc}
|
|
800bae8: 20000394 .word 0x20000394
|
|
800baec: 0800f978 .word 0x0800f978
|
|
800baf0: 200003b0 .word 0x200003b0
|
|
800baf4: 200003e8 .word 0x200003e8
|
|
800baf8: 0800f9cc .word 0x0800f9cc
|
|
|
|
0800bafc <RFW_WhiteInitState>:
|
|
#endif /* RFW_LONGPACKET_ENABLE == 1 */
|
|
|
|
#if (RFW_ENABLE == 1 )
|
|
static void RFW_WhiteInitState( RFwInit_t *Init, uint16_t WhiteSeed )
|
|
{
|
|
800bafc: b480 push {r7}
|
|
800bafe: b083 sub sp, #12
|
|
800bb00: af00 add r7, sp, #0
|
|
800bb02: 6078 str r0, [r7, #4]
|
|
800bb04: 460b mov r3, r1
|
|
800bb06: 807b strh r3, [r7, #2]
|
|
Init->WhiteSeed = WhiteSeed;
|
|
800bb08: 687b ldr r3, [r7, #4]
|
|
800bb0a: 887a ldrh r2, [r7, #2]
|
|
800bb0c: 815a strh r2, [r3, #10]
|
|
}
|
|
800bb0e: bf00 nop
|
|
800bb10: 370c adds r7, #12
|
|
800bb12: 46bd mov sp, r7
|
|
800bb14: bc80 pop {r7}
|
|
800bb16: 4770 bx lr
|
|
|
|
0800bb18 <RFW_WhiteSetState>:
|
|
|
|
static void RFW_WhiteSetState( RadioFw_t *RFWPacket )
|
|
{
|
|
800bb18: b480 push {r7}
|
|
800bb1a: b083 sub sp, #12
|
|
800bb1c: af00 add r7, sp, #0
|
|
800bb1e: 6078 str r0, [r7, #4]
|
|
RFWPacket->WhiteLfsrState = RFWPacket->Init.WhiteSeed;
|
|
800bb20: 687b ldr r3, [r7, #4]
|
|
800bb22: 895a ldrh r2, [r3, #10]
|
|
800bb24: 687b ldr r3, [r7, #4]
|
|
800bb26: 82da strh r2, [r3, #22]
|
|
}
|
|
800bb28: bf00 nop
|
|
800bb2a: 370c adds r7, #12
|
|
800bb2c: 46bd mov sp, r7
|
|
800bb2e: bc80 pop {r7}
|
|
800bb30: 4770 bx lr
|
|
|
|
0800bb32 <RFW_CrcInitState>:
|
|
|
|
static void RFW_CrcInitState( RFwInit_t *Init, const uint16_t CrcPolynomial, const uint16_t CrcSeed,
|
|
const RADIO_FSK_CrcTypes_t CrcType )
|
|
{
|
|
800bb32: b480 push {r7}
|
|
800bb34: b085 sub sp, #20
|
|
800bb36: af00 add r7, sp, #0
|
|
800bb38: 60f8 str r0, [r7, #12]
|
|
800bb3a: 4608 mov r0, r1
|
|
800bb3c: 4611 mov r1, r2
|
|
800bb3e: 461a mov r2, r3
|
|
800bb40: 4603 mov r3, r0
|
|
800bb42: 817b strh r3, [r7, #10]
|
|
800bb44: 460b mov r3, r1
|
|
800bb46: 813b strh r3, [r7, #8]
|
|
800bb48: 4613 mov r3, r2
|
|
800bb4a: 71fb strb r3, [r7, #7]
|
|
Init->CrcPolynomial = CrcPolynomial;
|
|
800bb4c: 68fb ldr r3, [r7, #12]
|
|
800bb4e: 897a ldrh r2, [r7, #10]
|
|
800bb50: 809a strh r2, [r3, #4]
|
|
Init->CrcSeed = CrcSeed;
|
|
800bb52: 68fb ldr r3, [r7, #12]
|
|
800bb54: 893a ldrh r2, [r7, #8]
|
|
800bb56: 80da strh r2, [r3, #6]
|
|
Init->CrcType = CrcType;
|
|
800bb58: 68fb ldr r3, [r7, #12]
|
|
800bb5a: 79fa ldrb r2, [r7, #7]
|
|
800bb5c: 721a strb r2, [r3, #8]
|
|
}
|
|
800bb5e: bf00 nop
|
|
800bb60: 3714 adds r7, #20
|
|
800bb62: 46bd mov sp, r7
|
|
800bb64: bc80 pop {r7}
|
|
800bb66: 4770 bx lr
|
|
|
|
0800bb68 <RFW_CrcSetState>:
|
|
|
|
static void RFW_CrcSetState( RadioFw_t *RFWPacket )
|
|
{
|
|
800bb68: b480 push {r7}
|
|
800bb6a: b083 sub sp, #12
|
|
800bb6c: af00 add r7, sp, #0
|
|
800bb6e: 6078 str r0, [r7, #4]
|
|
RFWPacket->CrcLfsrState = RFWPacket->Init.CrcSeed;
|
|
800bb70: 687b ldr r3, [r7, #4]
|
|
800bb72: 88da ldrh r2, [r3, #6]
|
|
800bb74: 687b ldr r3, [r7, #4]
|
|
800bb76: 829a strh r2, [r3, #20]
|
|
}
|
|
800bb78: bf00 nop
|
|
800bb7a: 370c adds r7, #12
|
|
800bb7c: 46bd mov sp, r7
|
|
800bb7e: bc80 pop {r7}
|
|
800bb80: 4770 bx lr
|
|
|
|
0800bb82 <RFW_WhiteRun>:
|
|
|
|
static void RFW_WhiteRun( RadioFw_t *RFWPacket, uint8_t *Payload, uint32_t Size )
|
|
{
|
|
800bb82: b480 push {r7}
|
|
800bb84: b089 sub sp, #36 @ 0x24
|
|
800bb86: af00 add r7, sp, #0
|
|
800bb88: 60f8 str r0, [r7, #12]
|
|
800bb8a: 60b9 str r1, [r7, #8]
|
|
800bb8c: 607a str r2, [r7, #4]
|
|
/*run the whitening algo on Size bytes*/
|
|
uint16_t ibmwhite_state = RFWPacket->WhiteLfsrState;
|
|
800bb8e: 68fb ldr r3, [r7, #12]
|
|
800bb90: 8adb ldrh r3, [r3, #22]
|
|
800bb92: 83fb strh r3, [r7, #30]
|
|
for( int32_t i = 0; i < Size; i++ )
|
|
800bb94: 2300 movs r3, #0
|
|
800bb96: 61bb str r3, [r7, #24]
|
|
800bb98: e02f b.n 800bbfa <RFW_WhiteRun+0x78>
|
|
{
|
|
Payload[i] ^= ibmwhite_state & 0xFF;
|
|
800bb9a: 69bb ldr r3, [r7, #24]
|
|
800bb9c: 68ba ldr r2, [r7, #8]
|
|
800bb9e: 4413 add r3, r2
|
|
800bba0: 781b ldrb r3, [r3, #0]
|
|
800bba2: b25a sxtb r2, r3
|
|
800bba4: 8bfb ldrh r3, [r7, #30]
|
|
800bba6: b25b sxtb r3, r3
|
|
800bba8: 4053 eors r3, r2
|
|
800bbaa: b259 sxtb r1, r3
|
|
800bbac: 69bb ldr r3, [r7, #24]
|
|
800bbae: 68ba ldr r2, [r7, #8]
|
|
800bbb0: 4413 add r3, r2
|
|
800bbb2: b2ca uxtb r2, r1
|
|
800bbb4: 701a strb r2, [r3, #0]
|
|
for( int32_t j = 0; j < 8; j++ )
|
|
800bbb6: 2300 movs r3, #0
|
|
800bbb8: 617b str r3, [r7, #20]
|
|
800bbba: e018 b.n 800bbee <RFW_WhiteRun+0x6c>
|
|
{
|
|
uint8_t msb = ( ( ibmwhite_state >> 5 ) & 0x1 ) ^ ( ( ibmwhite_state >> 0 ) & 0x1 );
|
|
800bbbc: 8bfb ldrh r3, [r7, #30]
|
|
800bbbe: 095b lsrs r3, r3, #5
|
|
800bbc0: b29b uxth r3, r3
|
|
800bbc2: b2da uxtb r2, r3
|
|
800bbc4: 8bfb ldrh r3, [r7, #30]
|
|
800bbc6: b2db uxtb r3, r3
|
|
800bbc8: 4053 eors r3, r2
|
|
800bbca: b2db uxtb r3, r3
|
|
800bbcc: f003 0301 and.w r3, r3, #1
|
|
800bbd0: 74fb strb r3, [r7, #19]
|
|
ibmwhite_state = ( ( msb << 8 ) | ( ibmwhite_state >> 1 ) );
|
|
800bbd2: 7cfb ldrb r3, [r7, #19]
|
|
800bbd4: b21b sxth r3, r3
|
|
800bbd6: 021b lsls r3, r3, #8
|
|
800bbd8: b21a sxth r2, r3
|
|
800bbda: 8bfb ldrh r3, [r7, #30]
|
|
800bbdc: 085b lsrs r3, r3, #1
|
|
800bbde: b29b uxth r3, r3
|
|
800bbe0: b21b sxth r3, r3
|
|
800bbe2: 4313 orrs r3, r2
|
|
800bbe4: b21b sxth r3, r3
|
|
800bbe6: 83fb strh r3, [r7, #30]
|
|
for( int32_t j = 0; j < 8; j++ )
|
|
800bbe8: 697b ldr r3, [r7, #20]
|
|
800bbea: 3301 adds r3, #1
|
|
800bbec: 617b str r3, [r7, #20]
|
|
800bbee: 697b ldr r3, [r7, #20]
|
|
800bbf0: 2b07 cmp r3, #7
|
|
800bbf2: dde3 ble.n 800bbbc <RFW_WhiteRun+0x3a>
|
|
for( int32_t i = 0; i < Size; i++ )
|
|
800bbf4: 69bb ldr r3, [r7, #24]
|
|
800bbf6: 3301 adds r3, #1
|
|
800bbf8: 61bb str r3, [r7, #24]
|
|
800bbfa: 69bb ldr r3, [r7, #24]
|
|
800bbfc: 687a ldr r2, [r7, #4]
|
|
800bbfe: 429a cmp r2, r3
|
|
800bc00: d8cb bhi.n 800bb9a <RFW_WhiteRun+0x18>
|
|
}
|
|
}
|
|
RFWPacket->WhiteLfsrState = ibmwhite_state;
|
|
800bc02: 68fb ldr r3, [r7, #12]
|
|
800bc04: 8bfa ldrh r2, [r7, #30]
|
|
800bc06: 82da strh r2, [r3, #22]
|
|
}
|
|
800bc08: bf00 nop
|
|
800bc0a: 3724 adds r7, #36 @ 0x24
|
|
800bc0c: 46bd mov sp, r7
|
|
800bc0e: bc80 pop {r7}
|
|
800bc10: 4770 bx lr
|
|
|
|
0800bc12 <RFW_CrcRun>:
|
|
|
|
static int32_t RFW_CrcRun( RadioFw_t *const RFWPacket, const uint8_t *Payload, const uint32_t Size,
|
|
uint8_t CrcResult[2] )
|
|
{
|
|
800bc12: b580 push {r7, lr}
|
|
800bc14: b088 sub sp, #32
|
|
800bc16: af00 add r7, sp, #0
|
|
800bc18: 60f8 str r0, [r7, #12]
|
|
800bc1a: 60b9 str r1, [r7, #8]
|
|
800bc1c: 607a str r2, [r7, #4]
|
|
800bc1e: 603b str r3, [r7, #0]
|
|
int32_t status = 0;
|
|
800bc20: 2300 movs r3, #0
|
|
800bc22: 617b str r3, [r7, #20]
|
|
int32_t i = 0;
|
|
800bc24: 2300 movs r3, #0
|
|
800bc26: 61fb str r3, [r7, #28]
|
|
uint16_t polynomial = RFWPacket->Init.CrcPolynomial;
|
|
800bc28: 68fb ldr r3, [r7, #12]
|
|
800bc2a: 889b ldrh r3, [r3, #4]
|
|
800bc2c: 827b strh r3, [r7, #18]
|
|
/* Restore state from previous chunk*/
|
|
uint16_t crc = RFWPacket->CrcLfsrState;
|
|
800bc2e: 68fb ldr r3, [r7, #12]
|
|
800bc30: 8a9b ldrh r3, [r3, #20]
|
|
800bc32: 837b strh r3, [r7, #26]
|
|
for( i = 0; i < Size; i++ )
|
|
800bc34: 2300 movs r3, #0
|
|
800bc36: 61fb str r3, [r7, #28]
|
|
800bc38: e00d b.n 800bc56 <RFW_CrcRun+0x44>
|
|
{
|
|
crc = RFW_CrcRun1Byte( crc, Payload[i], polynomial );
|
|
800bc3a: 69fb ldr r3, [r7, #28]
|
|
800bc3c: 68ba ldr r2, [r7, #8]
|
|
800bc3e: 4413 add r3, r2
|
|
800bc40: 7819 ldrb r1, [r3, #0]
|
|
800bc42: 8a7a ldrh r2, [r7, #18]
|
|
800bc44: 8b7b ldrh r3, [r7, #26]
|
|
800bc46: 4618 mov r0, r3
|
|
800bc48: f000 f82f bl 800bcaa <RFW_CrcRun1Byte>
|
|
800bc4c: 4603 mov r3, r0
|
|
800bc4e: 837b strh r3, [r7, #26]
|
|
for( i = 0; i < Size; i++ )
|
|
800bc50: 69fb ldr r3, [r7, #28]
|
|
800bc52: 3301 adds r3, #1
|
|
800bc54: 61fb str r3, [r7, #28]
|
|
800bc56: 69fb ldr r3, [r7, #28]
|
|
800bc58: 687a ldr r2, [r7, #4]
|
|
800bc5a: 429a cmp r2, r3
|
|
800bc5c: d8ed bhi.n 800bc3a <RFW_CrcRun+0x28>
|
|
}
|
|
/*Save state for next chunk*/
|
|
RFWPacket->CrcLfsrState = crc;
|
|
800bc5e: 68fb ldr r3, [r7, #12]
|
|
800bc60: 8b7a ldrh r2, [r7, #26]
|
|
800bc62: 829a strh r2, [r3, #20]
|
|
|
|
if( RFWPacket->Init.CrcType == RADIO_FSK_CRC_2_BYTES_IBM )
|
|
800bc64: 68fb ldr r3, [r7, #12]
|
|
800bc66: 7a1b ldrb r3, [r3, #8]
|
|
800bc68: 2bf1 cmp r3, #241 @ 0xf1
|
|
800bc6a: d10b bne.n 800bc84 <RFW_CrcRun+0x72>
|
|
{
|
|
CrcResult[1] = crc & 0xFF;
|
|
800bc6c: 683b ldr r3, [r7, #0]
|
|
800bc6e: 3301 adds r3, #1
|
|
800bc70: 8b7a ldrh r2, [r7, #26]
|
|
800bc72: b2d2 uxtb r2, r2
|
|
800bc74: 701a strb r2, [r3, #0]
|
|
CrcResult[0] = crc >> 8;
|
|
800bc76: 8b7b ldrh r3, [r7, #26]
|
|
800bc78: 0a1b lsrs r3, r3, #8
|
|
800bc7a: b29b uxth r3, r3
|
|
800bc7c: b2da uxtb r2, r3
|
|
800bc7e: 683b ldr r3, [r7, #0]
|
|
800bc80: 701a strb r2, [r3, #0]
|
|
800bc82: e00d b.n 800bca0 <RFW_CrcRun+0x8e>
|
|
}
|
|
else
|
|
{
|
|
crc = ~crc ;
|
|
800bc84: 8b7b ldrh r3, [r7, #26]
|
|
800bc86: 43db mvns r3, r3
|
|
800bc88: 837b strh r3, [r7, #26]
|
|
CrcResult[1] = crc & 0xFF;
|
|
800bc8a: 683b ldr r3, [r7, #0]
|
|
800bc8c: 3301 adds r3, #1
|
|
800bc8e: 8b7a ldrh r2, [r7, #26]
|
|
800bc90: b2d2 uxtb r2, r2
|
|
800bc92: 701a strb r2, [r3, #0]
|
|
CrcResult[0] = crc >> 8;
|
|
800bc94: 8b7b ldrh r3, [r7, #26]
|
|
800bc96: 0a1b lsrs r3, r3, #8
|
|
800bc98: b29b uxth r3, r3
|
|
800bc9a: b2da uxtb r2, r3
|
|
800bc9c: 683b ldr r3, [r7, #0]
|
|
800bc9e: 701a strb r2, [r3, #0]
|
|
}
|
|
return status;
|
|
800bca0: 697b ldr r3, [r7, #20]
|
|
}
|
|
800bca2: 4618 mov r0, r3
|
|
800bca4: 3720 adds r7, #32
|
|
800bca6: 46bd mov sp, r7
|
|
800bca8: bd80 pop {r7, pc}
|
|
|
|
0800bcaa <RFW_CrcRun1Byte>:
|
|
|
|
uint16_t RFW_CrcRun1Byte( uint16_t Crc, uint8_t DataByte, uint16_t Polynomial )
|
|
{
|
|
800bcaa: b480 push {r7}
|
|
800bcac: b085 sub sp, #20
|
|
800bcae: af00 add r7, sp, #0
|
|
800bcb0: 4603 mov r3, r0
|
|
800bcb2: 80fb strh r3, [r7, #6]
|
|
800bcb4: 460b mov r3, r1
|
|
800bcb6: 717b strb r3, [r7, #5]
|
|
800bcb8: 4613 mov r3, r2
|
|
800bcba: 807b strh r3, [r7, #2]
|
|
uint8_t i;
|
|
for( i = 0; i < 8; i++ )
|
|
800bcbc: 2300 movs r3, #0
|
|
800bcbe: 73fb strb r3, [r7, #15]
|
|
800bcc0: e018 b.n 800bcf4 <RFW_CrcRun1Byte+0x4a>
|
|
{
|
|
if( ( ( ( Crc & 0x8000 ) >> 8 ) ^ ( DataByte & 0x80 ) ) != 0 )
|
|
800bcc2: 88fb ldrh r3, [r7, #6]
|
|
800bcc4: 121a asrs r2, r3, #8
|
|
800bcc6: 797b ldrb r3, [r7, #5]
|
|
800bcc8: 4053 eors r3, r2
|
|
800bcca: f003 0380 and.w r3, r3, #128 @ 0x80
|
|
800bcce: 2b00 cmp r3, #0
|
|
800bcd0: d007 beq.n 800bce2 <RFW_CrcRun1Byte+0x38>
|
|
{
|
|
Crc <<= 1;
|
|
800bcd2: 88fb ldrh r3, [r7, #6]
|
|
800bcd4: 005b lsls r3, r3, #1
|
|
800bcd6: 80fb strh r3, [r7, #6]
|
|
Crc ^= Polynomial;
|
|
800bcd8: 88fa ldrh r2, [r7, #6]
|
|
800bcda: 887b ldrh r3, [r7, #2]
|
|
800bcdc: 4053 eors r3, r2
|
|
800bcde: 80fb strh r3, [r7, #6]
|
|
800bce0: e002 b.n 800bce8 <RFW_CrcRun1Byte+0x3e>
|
|
}
|
|
else
|
|
{
|
|
Crc <<= 1;
|
|
800bce2: 88fb ldrh r3, [r7, #6]
|
|
800bce4: 005b lsls r3, r3, #1
|
|
800bce6: 80fb strh r3, [r7, #6]
|
|
}
|
|
DataByte <<= 1;
|
|
800bce8: 797b ldrb r3, [r7, #5]
|
|
800bcea: 005b lsls r3, r3, #1
|
|
800bcec: 717b strb r3, [r7, #5]
|
|
for( i = 0; i < 8; i++ )
|
|
800bcee: 7bfb ldrb r3, [r7, #15]
|
|
800bcf0: 3301 adds r3, #1
|
|
800bcf2: 73fb strb r3, [r7, #15]
|
|
800bcf4: 7bfb ldrb r3, [r7, #15]
|
|
800bcf6: 2b07 cmp r3, #7
|
|
800bcf8: d9e3 bls.n 800bcc2 <RFW_CrcRun1Byte+0x18>
|
|
}
|
|
return Crc;
|
|
800bcfa: 88fb ldrh r3, [r7, #6]
|
|
}
|
|
800bcfc: 4618 mov r0, r3
|
|
800bcfe: 3714 adds r7, #20
|
|
800bd00: 46bd mov sp, r7
|
|
800bd02: bc80 pop {r7}
|
|
800bd04: 4770 bx lr
|
|
...
|
|
|
|
0800bd08 <RFW_PollRxBytes>:
|
|
|
|
static int32_t RFW_PollRxBytes( uint32_t bytes )
|
|
{
|
|
800bd08: b580 push {r7, lr}
|
|
800bd0a: b086 sub sp, #24
|
|
800bd0c: af00 add r7, sp, #0
|
|
800bd0e: 6078 str r0, [r7, #4]
|
|
uint32_t now = TimerGetCurrentTime( );
|
|
800bd10: f002 fc8e bl 800e630 <UTIL_TIMER_GetCurrentTime>
|
|
800bd14: 6138 str r0, [r7, #16]
|
|
uint8_t reg_buff_ptr_ref = SUBGRF_ReadRegister( SUBGHZ_RXADRPTR );
|
|
800bd16: f640 0003 movw r0, #2051 @ 0x803
|
|
800bd1a: f7fe ff35 bl 800ab88 <SUBGRF_ReadRegister>
|
|
800bd1e: 4603 mov r3, r0
|
|
800bd20: 73fb strb r3, [r7, #15]
|
|
uint8_t reg_buff_ptr = reg_buff_ptr_ref;
|
|
800bd22: 7bfb ldrb r3, [r7, #15]
|
|
800bd24: 75fb strb r3, [r7, #23]
|
|
uint32_t timeout = DIVC( bytes * 8 * 1000, RFWPacket.BitRate );
|
|
800bd26: 687b ldr r3, [r7, #4]
|
|
800bd28: f44f 52fa mov.w r2, #8000 @ 0x1f40
|
|
800bd2c: fb03 f202 mul.w r2, r3, r2
|
|
800bd30: 4b12 ldr r3, [pc, #72] @ (800bd7c <RFW_PollRxBytes+0x74>)
|
|
800bd32: 6c9b ldr r3, [r3, #72] @ 0x48
|
|
800bd34: 4413 add r3, r2
|
|
800bd36: 1e5a subs r2, r3, #1
|
|
800bd38: 4b10 ldr r3, [pc, #64] @ (800bd7c <RFW_PollRxBytes+0x74>)
|
|
800bd3a: 6c9b ldr r3, [r3, #72] @ 0x48
|
|
800bd3c: fbb2 f3f3 udiv r3, r2, r3
|
|
800bd40: 60bb str r3, [r7, #8]
|
|
/* Wait that packet length is received */
|
|
while( ( reg_buff_ptr - reg_buff_ptr_ref ) < bytes )
|
|
800bd42: e00f b.n 800bd64 <RFW_PollRxBytes+0x5c>
|
|
{
|
|
/*reading rx address pointer*/
|
|
reg_buff_ptr = SUBGRF_ReadRegister( SUBGHZ_RXADRPTR );
|
|
800bd44: f640 0003 movw r0, #2051 @ 0x803
|
|
800bd48: f7fe ff1e bl 800ab88 <SUBGRF_ReadRegister>
|
|
800bd4c: 4603 mov r3, r0
|
|
800bd4e: 75fb strb r3, [r7, #23]
|
|
if( TimerGetElapsedTime( now ) > timeout )
|
|
800bd50: 6938 ldr r0, [r7, #16]
|
|
800bd52: f002 fc7f bl 800e654 <UTIL_TIMER_GetElapsedTime>
|
|
800bd56: 4602 mov r2, r0
|
|
800bd58: 68bb ldr r3, [r7, #8]
|
|
800bd5a: 4293 cmp r3, r2
|
|
800bd5c: d202 bcs.n 800bd64 <RFW_PollRxBytes+0x5c>
|
|
{
|
|
/*timeout*/
|
|
return -1;
|
|
800bd5e: f04f 33ff mov.w r3, #4294967295 @ 0xffffffff
|
|
800bd62: e007 b.n 800bd74 <RFW_PollRxBytes+0x6c>
|
|
while( ( reg_buff_ptr - reg_buff_ptr_ref ) < bytes )
|
|
800bd64: 7dfa ldrb r2, [r7, #23]
|
|
800bd66: 7bfb ldrb r3, [r7, #15]
|
|
800bd68: 1ad3 subs r3, r2, r3
|
|
800bd6a: 461a mov r2, r3
|
|
800bd6c: 687b ldr r3, [r7, #4]
|
|
800bd6e: 4293 cmp r3, r2
|
|
800bd70: d8e8 bhi.n 800bd44 <RFW_PollRxBytes+0x3c>
|
|
}
|
|
}
|
|
return 0;
|
|
800bd72: 2300 movs r3, #0
|
|
}
|
|
800bd74: 4618 mov r0, r3
|
|
800bd76: 3718 adds r7, #24
|
|
800bd78: 46bd mov sp, r7
|
|
800bd7a: bd80 pop {r7, pc}
|
|
800bd7c: 20000394 .word 0x20000394
|
|
|
|
0800bd80 <RFW_GetPacketLength>:
|
|
|
|
static int32_t RFW_GetPacketLength( uint16_t *PayloadLength )
|
|
{
|
|
800bd80: b580 push {r7, lr}
|
|
800bd82: b086 sub sp, #24
|
|
800bd84: af02 add r7, sp, #8
|
|
800bd86: 6078 str r0, [r7, #4]
|
|
if( 0UL != RFW_PollRxBytes( RFWPacket.Init.PayloadLengthFieldSize ) )
|
|
800bd88: 4b25 ldr r3, [pc, #148] @ (800be20 <RFW_GetPacketLength+0xa0>)
|
|
800bd8a: 785b ldrb r3, [r3, #1]
|
|
800bd8c: 4618 mov r0, r3
|
|
800bd8e: f7ff ffbb bl 800bd08 <RFW_PollRxBytes>
|
|
800bd92: 4603 mov r3, r0
|
|
800bd94: 2b00 cmp r3, #0
|
|
800bd96: d002 beq.n 800bd9e <RFW_GetPacketLength+0x1e>
|
|
{
|
|
return -1;
|
|
800bd98: f04f 33ff mov.w r3, #4294967295 @ 0xffffffff
|
|
800bd9c: e03b b.n 800be16 <RFW_GetPacketLength+0x96>
|
|
}
|
|
/* Get buffer from Radio*/
|
|
SUBGRF_ReadBuffer( 0, ChunkBuffer, RFWPacket.Init.PayloadLengthFieldSize );
|
|
800bd9e: 4b20 ldr r3, [pc, #128] @ (800be20 <RFW_GetPacketLength+0xa0>)
|
|
800bda0: 785b ldrb r3, [r3, #1]
|
|
800bda2: 461a mov r2, r3
|
|
800bda4: 491f ldr r1, [pc, #124] @ (800be24 <RFW_GetPacketLength+0xa4>)
|
|
800bda6: 2000 movs r0, #0
|
|
800bda8: f7fe ff74 bl 800ac94 <SUBGRF_ReadBuffer>
|
|
/* De-whiten packet length*/
|
|
RFW_WhiteRun( &RFWPacket, ChunkBuffer, RFWPacket.Init.PayloadLengthFieldSize );
|
|
800bdac: 4b1c ldr r3, [pc, #112] @ (800be20 <RFW_GetPacketLength+0xa0>)
|
|
800bdae: 785b ldrb r3, [r3, #1]
|
|
800bdb0: 461a mov r2, r3
|
|
800bdb2: 491c ldr r1, [pc, #112] @ (800be24 <RFW_GetPacketLength+0xa4>)
|
|
800bdb4: 481a ldr r0, [pc, #104] @ (800be20 <RFW_GetPacketLength+0xa0>)
|
|
800bdb6: f7ff fee4 bl 800bb82 <RFW_WhiteRun>
|
|
/*do crc 1st calculation packetLengthField and store intermediate result */
|
|
if( RFWPacket.Init.CrcEnable == 1 )
|
|
800bdba: 4b19 ldr r3, [pc, #100] @ (800be20 <RFW_GetPacketLength+0xa0>)
|
|
800bdbc: 789b ldrb r3, [r3, #2]
|
|
800bdbe: 2b01 cmp r3, #1
|
|
800bdc0: d108 bne.n 800bdd4 <RFW_GetPacketLength+0x54>
|
|
{
|
|
/*run Crc algo on payloadLengthField*/
|
|
uint8_t crc_dummy[2];
|
|
RFW_CrcRun( &RFWPacket, ChunkBuffer, RFWPacket.Init.PayloadLengthFieldSize, crc_dummy );
|
|
800bdc2: 4b17 ldr r3, [pc, #92] @ (800be20 <RFW_GetPacketLength+0xa0>)
|
|
800bdc4: 785b ldrb r3, [r3, #1]
|
|
800bdc6: 461a mov r2, r3
|
|
800bdc8: f107 030c add.w r3, r7, #12
|
|
800bdcc: 4915 ldr r1, [pc, #84] @ (800be24 <RFW_GetPacketLength+0xa4>)
|
|
800bdce: 4814 ldr r0, [pc, #80] @ (800be20 <RFW_GetPacketLength+0xa0>)
|
|
800bdd0: f7ff ff1f bl 800bc12 <RFW_CrcRun>
|
|
}
|
|
if( RFWPacket.Init.PayloadLengthFieldSize == 1 )
|
|
800bdd4: 4b12 ldr r3, [pc, #72] @ (800be20 <RFW_GetPacketLength+0xa0>)
|
|
800bdd6: 785b ldrb r3, [r3, #1]
|
|
800bdd8: 2b01 cmp r3, #1
|
|
800bdda: d105 bne.n 800bde8 <RFW_GetPacketLength+0x68>
|
|
{
|
|
*PayloadLength = ( uint16_t ) ChunkBuffer[0];
|
|
800bddc: 4b11 ldr r3, [pc, #68] @ (800be24 <RFW_GetPacketLength+0xa4>)
|
|
800bdde: 781b ldrb r3, [r3, #0]
|
|
800bde0: 461a mov r2, r3
|
|
800bde2: 687b ldr r3, [r7, #4]
|
|
800bde4: 801a strh r2, [r3, #0]
|
|
800bde6: e00c b.n 800be02 <RFW_GetPacketLength+0x82>
|
|
}
|
|
else
|
|
{
|
|
/*packet length is 2 bytes*/
|
|
*PayloadLength = ( ( ( uint16_t ) ChunkBuffer[0] ) << 8 ) | ChunkBuffer[1];
|
|
800bde8: 4b0e ldr r3, [pc, #56] @ (800be24 <RFW_GetPacketLength+0xa4>)
|
|
800bdea: 781b ldrb r3, [r3, #0]
|
|
800bdec: b21b sxth r3, r3
|
|
800bdee: 021b lsls r3, r3, #8
|
|
800bdf0: b21a sxth r2, r3
|
|
800bdf2: 4b0c ldr r3, [pc, #48] @ (800be24 <RFW_GetPacketLength+0xa4>)
|
|
800bdf4: 785b ldrb r3, [r3, #1]
|
|
800bdf6: b21b sxth r3, r3
|
|
800bdf8: 4313 orrs r3, r2
|
|
800bdfa: b21b sxth r3, r3
|
|
800bdfc: b29a uxth r2, r3
|
|
800bdfe: 687b ldr r3, [r7, #4]
|
|
800be00: 801a strh r2, [r3, #0]
|
|
}
|
|
RFW_MW_LOG( TS_ON, VLEVEL_M, "PayloadLength=%d,\r\n", *PayloadLength );
|
|
800be02: 687b ldr r3, [r7, #4]
|
|
800be04: 881b ldrh r3, [r3, #0]
|
|
800be06: 9300 str r3, [sp, #0]
|
|
800be08: 4b07 ldr r3, [pc, #28] @ (800be28 <RFW_GetPacketLength+0xa8>)
|
|
800be0a: 2201 movs r2, #1
|
|
800be0c: 2100 movs r1, #0
|
|
800be0e: 2002 movs r0, #2
|
|
800be10: f002 fcec bl 800e7ec <UTIL_ADV_TRACE_COND_FSend>
|
|
return 0;
|
|
800be14: 2300 movs r3, #0
|
|
}
|
|
800be16: 4618 mov r0, r3
|
|
800be18: 3710 adds r7, #16
|
|
800be1a: 46bd mov sp, r7
|
|
800be1c: bd80 pop {r7, pc}
|
|
800be1e: bf00 nop
|
|
800be20: 20000394 .word 0x20000394
|
|
800be24: 200003e8 .word 0x200003e8
|
|
800be28: 0800f9f4 .word 0x0800f9f4
|
|
|
|
0800be2c <RFW_GetPayloadTimerEvent>:
|
|
|
|
static void RFW_GetPayloadTimerEvent( void *context )
|
|
{
|
|
800be2c: b580 push {r7, lr}
|
|
800be2e: b082 sub sp, #8
|
|
800be30: af00 add r7, sp, #0
|
|
800be32: 6078 str r0, [r7, #4]
|
|
RFW_GET_PAYLOAD_PROCESS();
|
|
800be34: f000 f804 bl 800be40 <RFW_GetPayloadProcess>
|
|
}
|
|
800be38: bf00 nop
|
|
800be3a: 3708 adds r7, #8
|
|
800be3c: 46bd mov sp, r7
|
|
800be3e: bd80 pop {r7, pc}
|
|
|
|
0800be40 <RFW_GetPayloadProcess>:
|
|
|
|
static void RFW_GetPayloadProcess( void )
|
|
{
|
|
800be40: b580 push {r7, lr}
|
|
800be42: b086 sub sp, #24
|
|
800be44: af04 add r7, sp, #16
|
|
/*long packet mode*/
|
|
uint8_t read_ptr = SUBGRF_ReadRegister( SUBGHZ_RXADRPTR );
|
|
800be46: f640 0003 movw r0, #2051 @ 0x803
|
|
800be4a: f7fe fe9d bl 800ab88 <SUBGRF_ReadRegister>
|
|
800be4e: 4603 mov r3, r0
|
|
800be50: 70fb strb r3, [r7, #3]
|
|
uint8_t size = read_ptr - RFWPacket.RadioBufferOffset;
|
|
800be52: 4b83 ldr r3, [pc, #524] @ (800c060 <RFW_GetPayloadProcess+0x220>)
|
|
800be54: f893 3036 ldrb.w r3, [r3, #54] @ 0x36
|
|
800be58: 78fa ldrb r2, [r7, #3]
|
|
800be5a: 1ad3 subs r3, r2, r3
|
|
800be5c: 70bb strb r3, [r7, #2]
|
|
uint32_t Timeout;
|
|
/*check remaining size*/
|
|
if( RFWPacket.LongPacketRemainingBytes > size )
|
|
800be5e: 4b80 ldr r3, [pc, #512] @ (800c060 <RFW_GetPayloadProcess+0x220>)
|
|
800be60: 8e9a ldrh r2, [r3, #52] @ 0x34
|
|
800be62: 78bb ldrb r3, [r7, #2]
|
|
800be64: b29b uxth r3, r3
|
|
800be66: 429a cmp r2, r3
|
|
800be68: f240 80cd bls.w 800c006 <RFW_GetPayloadProcess+0x1c6>
|
|
{
|
|
/* update LongPacketRemainingBytes*/
|
|
RFWPacket.LongPacketRemainingBytes -= size;
|
|
800be6c: 4b7c ldr r3, [pc, #496] @ (800c060 <RFW_GetPayloadProcess+0x220>)
|
|
800be6e: 8e9a ldrh r2, [r3, #52] @ 0x34
|
|
800be70: 78bb ldrb r3, [r7, #2]
|
|
800be72: b29b uxth r3, r3
|
|
800be74: 1ad3 subs r3, r2, r3
|
|
800be76: b29a uxth r2, r3
|
|
800be78: 4b79 ldr r3, [pc, #484] @ (800c060 <RFW_GetPayloadProcess+0x220>)
|
|
800be7a: 869a strh r2, [r3, #52] @ 0x34
|
|
/*intermediate chunk*/
|
|
RFW_MW_LOG( TS_ON, VLEVEL_M, "RxTxPldLen=0x%02X,\r\n", SUBGRF_ReadRegister( SUBGHZ_GRTXPLDLEN ) );
|
|
800be7c: f240 60bb movw r0, #1723 @ 0x6bb
|
|
800be80: f7fe fe82 bl 800ab88 <SUBGRF_ReadRegister>
|
|
800be84: 4603 mov r3, r0
|
|
800be86: 9300 str r3, [sp, #0]
|
|
800be88: 4b76 ldr r3, [pc, #472] @ (800c064 <RFW_GetPayloadProcess+0x224>)
|
|
800be8a: 2201 movs r2, #1
|
|
800be8c: 2100 movs r1, #0
|
|
800be8e: 2002 movs r0, #2
|
|
800be90: f002 fcac bl 800e7ec <UTIL_ADV_TRACE_COND_FSend>
|
|
RFW_MW_LOG( TS_ON, VLEVEL_M, "RxAddrPtr=0x%02X,\r\n", read_ptr );
|
|
800be94: 78fb ldrb r3, [r7, #3]
|
|
800be96: 9300 str r3, [sp, #0]
|
|
800be98: 4b73 ldr r3, [pc, #460] @ (800c068 <RFW_GetPayloadProcess+0x228>)
|
|
800be9a: 2201 movs r2, #1
|
|
800be9c: 2100 movs r1, #0
|
|
800be9e: 2002 movs r0, #2
|
|
800bea0: f002 fca4 bl 800e7ec <UTIL_ADV_TRACE_COND_FSend>
|
|
RFW_MW_LOG( TS_ON, VLEVEL_M, "offset= %d, size=%d, remaining=%d,\r\n", RFWPacket.RadioBufferOffset, size,
|
|
800bea4: 4b6e ldr r3, [pc, #440] @ (800c060 <RFW_GetPayloadProcess+0x220>)
|
|
800bea6: f893 3036 ldrb.w r3, [r3, #54] @ 0x36
|
|
800beaa: 4619 mov r1, r3
|
|
800beac: 78bb ldrb r3, [r7, #2]
|
|
800beae: 4a6c ldr r2, [pc, #432] @ (800c060 <RFW_GetPayloadProcess+0x220>)
|
|
800beb0: 8e92 ldrh r2, [r2, #52] @ 0x34
|
|
800beb2: 9202 str r2, [sp, #8]
|
|
800beb4: 9301 str r3, [sp, #4]
|
|
800beb6: 9100 str r1, [sp, #0]
|
|
800beb8: 4b6c ldr r3, [pc, #432] @ (800c06c <RFW_GetPayloadProcess+0x22c>)
|
|
800beba: 2201 movs r2, #1
|
|
800bebc: 2100 movs r1, #0
|
|
800bebe: 2002 movs r0, #2
|
|
800bec0: f002 fc94 bl 800e7ec <UTIL_ADV_TRACE_COND_FSend>
|
|
RFWPacket.LongPacketRemainingBytes );
|
|
/*update pld length so that not reached*/
|
|
SUBGRF_WriteRegister( SUBGHZ_GRTXPLDLEN, read_ptr - 1 );
|
|
800bec4: 78fb ldrb r3, [r7, #3]
|
|
800bec6: 3b01 subs r3, #1
|
|
800bec8: b2db uxtb r3, r3
|
|
800beca: 4619 mov r1, r3
|
|
800becc: f240 60bb movw r0, #1723 @ 0x6bb
|
|
800bed0: f7fe fe38 bl 800ab44 <SUBGRF_WriteRegister>
|
|
/* read data from radio*/
|
|
SUBGRF_ReadBuffer( RFWPacket.RadioBufferOffset, ChunkBuffer, size );
|
|
800bed4: 4b62 ldr r3, [pc, #392] @ (800c060 <RFW_GetPayloadProcess+0x220>)
|
|
800bed6: f893 3036 ldrb.w r3, [r3, #54] @ 0x36
|
|
800beda: 78ba ldrb r2, [r7, #2]
|
|
800bedc: 4964 ldr r1, [pc, #400] @ (800c070 <RFW_GetPayloadProcess+0x230>)
|
|
800bede: 4618 mov r0, r3
|
|
800bee0: f7fe fed8 bl 800ac94 <SUBGRF_ReadBuffer>
|
|
/* update buffer Offset, with intentional wrap around*/
|
|
RFWPacket.RadioBufferOffset += size;
|
|
800bee4: 4b5e ldr r3, [pc, #376] @ (800c060 <RFW_GetPayloadProcess+0x220>)
|
|
800bee6: f893 2036 ldrb.w r2, [r3, #54] @ 0x36
|
|
800beea: 78bb ldrb r3, [r7, #2]
|
|
800beec: 4413 add r3, r2
|
|
800beee: b2da uxtb r2, r3
|
|
800bef0: 4b5b ldr r3, [pc, #364] @ (800c060 <RFW_GetPayloadProcess+0x220>)
|
|
800bef2: f883 2036 strb.w r2, [r3, #54] @ 0x36
|
|
/*Run the de-whitening on current chunk*/
|
|
RFW_WhiteRun( &RFWPacket, ChunkBuffer, size );
|
|
800bef6: 78bb ldrb r3, [r7, #2]
|
|
800bef8: 461a mov r2, r3
|
|
800befa: 495d ldr r1, [pc, #372] @ (800c070 <RFW_GetPayloadProcess+0x230>)
|
|
800befc: 4858 ldr r0, [pc, #352] @ (800c060 <RFW_GetPayloadProcess+0x220>)
|
|
800befe: f7ff fe40 bl 800bb82 <RFW_WhiteRun>
|
|
if( RFWPacket.Init.CrcEnable == 1 )
|
|
800bf02: 4b57 ldr r3, [pc, #348] @ (800c060 <RFW_GetPayloadProcess+0x220>)
|
|
800bf04: 789b ldrb r3, [r3, #2]
|
|
800bf06: 2b01 cmp r3, #1
|
|
800bf08: d105 bne.n 800bf16 <RFW_GetPayloadProcess+0xd6>
|
|
{
|
|
/*run Crc algo on partial chunk*/
|
|
uint8_t crc_dummy[2];
|
|
RFW_CrcRun( &RFWPacket, ChunkBuffer, size, crc_dummy );
|
|
800bf0a: 78ba ldrb r2, [r7, #2]
|
|
800bf0c: 463b mov r3, r7
|
|
800bf0e: 4958 ldr r1, [pc, #352] @ (800c070 <RFW_GetPayloadProcess+0x230>)
|
|
800bf10: 4853 ldr r0, [pc, #332] @ (800c060 <RFW_GetPayloadProcess+0x220>)
|
|
800bf12: f7ff fe7e bl 800bc12 <RFW_CrcRun>
|
|
}
|
|
|
|
if( RFWPacket.LongPacketModeEnable == 1 )
|
|
800bf16: 4b52 ldr r3, [pc, #328] @ (800c060 <RFW_GetPayloadProcess+0x220>)
|
|
800bf18: 7e9b ldrb r3, [r3, #26]
|
|
800bf1a: 2b01 cmp r3, #1
|
|
800bf1c: d106 bne.n 800bf2c <RFW_GetPayloadProcess+0xec>
|
|
{
|
|
/*report rx data chunk to application*/
|
|
RFWPacket.RxLongPacketStoreChunkCb( ChunkBuffer, size );
|
|
800bf1e: 4b50 ldr r3, [pc, #320] @ (800c060 <RFW_GetPayloadProcess+0x220>)
|
|
800bf20: 6bdb ldr r3, [r3, #60] @ 0x3c
|
|
800bf22: 78ba ldrb r2, [r7, #2]
|
|
800bf24: 4611 mov r1, r2
|
|
800bf26: 4852 ldr r0, [pc, #328] @ (800c070 <RFW_GetPayloadProcess+0x230>)
|
|
800bf28: 4798 blx r3
|
|
800bf2a: e02b b.n 800bf84 <RFW_GetPayloadProcess+0x144>
|
|
}
|
|
else
|
|
{
|
|
if( RFWPacket.RxPayloadOffset += size < RADIO_BUF_SIZE )
|
|
800bf2c: 4b4c ldr r3, [pc, #304] @ (800c060 <RFW_GetPayloadProcess+0x220>)
|
|
800bf2e: 8f1b ldrh r3, [r3, #56] @ 0x38
|
|
800bf30: 78ba ldrb r2, [r7, #2]
|
|
800bf32: 2aff cmp r2, #255 @ 0xff
|
|
800bf34: bf14 ite ne
|
|
800bf36: 2201 movne r2, #1
|
|
800bf38: 2200 moveq r2, #0
|
|
800bf3a: b2d2 uxtb r2, r2
|
|
800bf3c: 4413 add r3, r2
|
|
800bf3e: b29a uxth r2, r3
|
|
800bf40: 4b47 ldr r3, [pc, #284] @ (800c060 <RFW_GetPayloadProcess+0x220>)
|
|
800bf42: 871a strh r2, [r3, #56] @ 0x38
|
|
800bf44: 4b46 ldr r3, [pc, #280] @ (800c060 <RFW_GetPayloadProcess+0x220>)
|
|
800bf46: 8f1b ldrh r3, [r3, #56] @ 0x38
|
|
800bf48: 2b00 cmp r3, #0
|
|
800bf4a: d013 beq.n 800bf74 <RFW_GetPayloadProcess+0x134>
|
|
{
|
|
RADIO_MEMCPY8( &RxBuffer[RFWPacket.RxPayloadOffset], ChunkBuffer, size );
|
|
800bf4c: 4b44 ldr r3, [pc, #272] @ (800c060 <RFW_GetPayloadProcess+0x220>)
|
|
800bf4e: 8f1b ldrh r3, [r3, #56] @ 0x38
|
|
800bf50: 461a mov r2, r3
|
|
800bf52: 4b48 ldr r3, [pc, #288] @ (800c074 <RFW_GetPayloadProcess+0x234>)
|
|
800bf54: 4413 add r3, r2
|
|
800bf56: 78ba ldrb r2, [r7, #2]
|
|
800bf58: b292 uxth r2, r2
|
|
800bf5a: 4945 ldr r1, [pc, #276] @ (800c070 <RFW_GetPayloadProcess+0x230>)
|
|
800bf5c: 4618 mov r0, r3
|
|
800bf5e: f001 fd47 bl 800d9f0 <UTIL_MEM_cpy_8>
|
|
RFWPacket.RxPayloadOffset += size;
|
|
800bf62: 4b3f ldr r3, [pc, #252] @ (800c060 <RFW_GetPayloadProcess+0x220>)
|
|
800bf64: 8f1a ldrh r2, [r3, #56] @ 0x38
|
|
800bf66: 78bb ldrb r3, [r7, #2]
|
|
800bf68: b29b uxth r3, r3
|
|
800bf6a: 4413 add r3, r2
|
|
800bf6c: b29a uxth r2, r3
|
|
800bf6e: 4b3c ldr r3, [pc, #240] @ (800c060 <RFW_GetPayloadProcess+0x220>)
|
|
800bf70: 871a strh r2, [r3, #56] @ 0x38
|
|
800bf72: e007 b.n 800bf84 <RFW_GetPayloadProcess+0x144>
|
|
}
|
|
else
|
|
{
|
|
/*stop the radio*/
|
|
SUBGRF_SetStandby( STDBY_RC );
|
|
800bf74: 2000 movs r0, #0
|
|
800bf76: f7fe f861 bl 800a03c <SUBGRF_SetStandby>
|
|
/*report CRC error*/
|
|
RFWPacket.Init.RadioEvents->RxError( );
|
|
800bf7a: 4b39 ldr r3, [pc, #228] @ (800c060 <RFW_GetPayloadProcess+0x220>)
|
|
800bf7c: 691b ldr r3, [r3, #16]
|
|
800bf7e: 691b ldr r3, [r3, #16]
|
|
800bf80: 4798 blx r3
|
|
return;
|
|
800bf82: e069 b.n 800c058 <RFW_GetPayloadProcess+0x218>
|
|
}
|
|
}
|
|
/*calculate next timer timeout*/
|
|
if( RFWPacket.LongPacketRemainingBytes < LONGPACKET_CHUNK_LENGTH_BYTES )
|
|
800bf84: 4b36 ldr r3, [pc, #216] @ (800c060 <RFW_GetPayloadProcess+0x220>)
|
|
800bf86: 8e9b ldrh r3, [r3, #52] @ 0x34
|
|
800bf88: 2b7f cmp r3, #127 @ 0x7f
|
|
800bf8a: d812 bhi.n 800bfb2 <RFW_GetPayloadProcess+0x172>
|
|
{
|
|
/*for the next and last chunk DIVC +1 to make sure crc is received.*/
|
|
Timeout = DIVC( ( RFWPacket.LongPacketRemainingBytes ) * 8 * 1000, RFWPacket.BitRate ) + 2;
|
|
800bf8c: 4b34 ldr r3, [pc, #208] @ (800c060 <RFW_GetPayloadProcess+0x220>)
|
|
800bf8e: 8e9b ldrh r3, [r3, #52] @ 0x34
|
|
800bf90: 461a mov r2, r3
|
|
800bf92: f44f 53fa mov.w r3, #8000 @ 0x1f40
|
|
800bf96: fb02 f303 mul.w r3, r2, r3
|
|
800bf9a: 461a mov r2, r3
|
|
800bf9c: 4b30 ldr r3, [pc, #192] @ (800c060 <RFW_GetPayloadProcess+0x220>)
|
|
800bf9e: 6c9b ldr r3, [r3, #72] @ 0x48
|
|
800bfa0: 4413 add r3, r2
|
|
800bfa2: 1e5a subs r2, r3, #1
|
|
800bfa4: 4b2e ldr r3, [pc, #184] @ (800c060 <RFW_GetPayloadProcess+0x220>)
|
|
800bfa6: 6c9b ldr r3, [r3, #72] @ 0x48
|
|
800bfa8: fbb2 f3f3 udiv r3, r2, r3
|
|
800bfac: 3302 adds r3, #2
|
|
800bfae: 607b str r3, [r7, #4]
|
|
800bfb0: e021 b.n 800bff6 <RFW_GetPayloadProcess+0x1b6>
|
|
}
|
|
else if( RFWPacket.LongPacketRemainingBytes < ( 3 * LONGPACKET_CHUNK_LENGTH_BYTES ) / 2 )
|
|
800bfb2: 4b2b ldr r3, [pc, #172] @ (800c060 <RFW_GetPayloadProcess+0x220>)
|
|
800bfb4: 8e9b ldrh r3, [r3, #52] @ 0x34
|
|
800bfb6: 2bbf cmp r3, #191 @ 0xbf
|
|
800bfb8: d813 bhi.n 800bfe2 <RFW_GetPayloadProcess+0x1a2>
|
|
{
|
|
/*this is to make sure that last chunk will always be greater than LONGPACKET_CHUNK_LENGTH_BYTES/2 */
|
|
Timeout = DIVR( ( RFWPacket.LongPacketRemainingBytes / 2 ) * 8 * 1000, RFWPacket.BitRate );
|
|
800bfba: 4b29 ldr r3, [pc, #164] @ (800c060 <RFW_GetPayloadProcess+0x220>)
|
|
800bfbc: 8e9b ldrh r3, [r3, #52] @ 0x34
|
|
800bfbe: 085b lsrs r3, r3, #1
|
|
800bfc0: b29b uxth r3, r3
|
|
800bfc2: 461a mov r2, r3
|
|
800bfc4: f44f 53fa mov.w r3, #8000 @ 0x1f40
|
|
800bfc8: fb02 f303 mul.w r3, r2, r3
|
|
800bfcc: 461a mov r2, r3
|
|
800bfce: 4b24 ldr r3, [pc, #144] @ (800c060 <RFW_GetPayloadProcess+0x220>)
|
|
800bfd0: 6c9b ldr r3, [r3, #72] @ 0x48
|
|
800bfd2: 085b lsrs r3, r3, #1
|
|
800bfd4: 441a add r2, r3
|
|
800bfd6: 4b22 ldr r3, [pc, #136] @ (800c060 <RFW_GetPayloadProcess+0x220>)
|
|
800bfd8: 6c9b ldr r3, [r3, #72] @ 0x48
|
|
800bfda: fbb2 f3f3 udiv r3, r2, r3
|
|
800bfde: 607b str r3, [r7, #4]
|
|
800bfe0: e009 b.n 800bff6 <RFW_GetPayloadProcess+0x1b6>
|
|
}
|
|
else
|
|
{
|
|
/*size value is close to LONGPACKET_CHUNK_LENGTH_BYTES with +/- errors compensated in closed loop here*/
|
|
Timeout = DIVR( ( LONGPACKET_CHUNK_LENGTH_BYTES ) * 8 * 1000, RFWPacket.BitRate );
|
|
800bfe2: 4b1f ldr r3, [pc, #124] @ (800c060 <RFW_GetPayloadProcess+0x220>)
|
|
800bfe4: 6c9b ldr r3, [r3, #72] @ 0x48
|
|
800bfe6: 085b lsrs r3, r3, #1
|
|
800bfe8: f503 227a add.w r2, r3, #1024000 @ 0xfa000
|
|
800bfec: 4b1c ldr r3, [pc, #112] @ (800c060 <RFW_GetPayloadProcess+0x220>)
|
|
800bfee: 6c9b ldr r3, [r3, #72] @ 0x48
|
|
800bff0: fbb2 f3f3 udiv r3, r2, r3
|
|
800bff4: 607b str r3, [r7, #4]
|
|
}
|
|
TimerSetValue( &RFWPacket.Timer, Timeout );
|
|
800bff6: 6879 ldr r1, [r7, #4]
|
|
800bff8: 481f ldr r0, [pc, #124] @ (800c078 <RFW_GetPayloadProcess+0x238>)
|
|
800bffa: f002 fa6f bl 800e4dc <UTIL_TIMER_SetPeriod>
|
|
TimerStart( &RFWPacket.Timer );
|
|
800bffe: 481e ldr r0, [pc, #120] @ (800c078 <RFW_GetPayloadProcess+0x238>)
|
|
800c000: f002 f98e bl 800e320 <UTIL_TIMER_Start>
|
|
800c004: e028 b.n 800c058 <RFW_GetPayloadProcess+0x218>
|
|
}
|
|
else
|
|
{
|
|
if( RFWPacket.LongPacketRemainingBytes < RFWPacket.Init.CrcFieldSize )
|
|
800c006: 4b16 ldr r3, [pc, #88] @ (800c060 <RFW_GetPayloadProcess+0x220>)
|
|
800c008: 8e9b ldrh r3, [r3, #52] @ 0x34
|
|
800c00a: 4a15 ldr r2, [pc, #84] @ (800c060 <RFW_GetPayloadProcess+0x220>)
|
|
800c00c: 78d2 ldrb r2, [r2, #3]
|
|
800c00e: 4293 cmp r3, r2
|
|
800c010: d204 bcs.n 800c01c <RFW_GetPayloadProcess+0x1dc>
|
|
{
|
|
/* force LongPacketRemainingBytes to CrcFieldSize: this should never happen*/
|
|
RFWPacket.LongPacketRemainingBytes = RFWPacket.Init.CrcFieldSize;
|
|
800c012: 4b13 ldr r3, [pc, #76] @ (800c060 <RFW_GetPayloadProcess+0x220>)
|
|
800c014: 78db ldrb r3, [r3, #3]
|
|
800c016: 461a mov r2, r3
|
|
800c018: 4b11 ldr r3, [pc, #68] @ (800c060 <RFW_GetPayloadProcess+0x220>)
|
|
800c01a: 869a strh r2, [r3, #52] @ 0x34
|
|
}
|
|
/*last chunk*/
|
|
RFW_MW_LOG( TS_ON, VLEVEL_M, "LastChunk. offset= %d, size=%d, remaining=%d,\r\n", RFWPacket.RadioBufferOffset, size,
|
|
800c01c: 4b10 ldr r3, [pc, #64] @ (800c060 <RFW_GetPayloadProcess+0x220>)
|
|
800c01e: f893 3036 ldrb.w r3, [r3, #54] @ 0x36
|
|
800c022: 4619 mov r1, r3
|
|
800c024: 78bb ldrb r3, [r7, #2]
|
|
800c026: 4a0e ldr r2, [pc, #56] @ (800c060 <RFW_GetPayloadProcess+0x220>)
|
|
800c028: 8e92 ldrh r2, [r2, #52] @ 0x34
|
|
800c02a: 9202 str r2, [sp, #8]
|
|
800c02c: 9301 str r3, [sp, #4]
|
|
800c02e: 9100 str r1, [sp, #0]
|
|
800c030: 4b12 ldr r3, [pc, #72] @ (800c07c <RFW_GetPayloadProcess+0x23c>)
|
|
800c032: 2201 movs r2, #1
|
|
800c034: 2100 movs r1, #0
|
|
800c036: 2002 movs r0, #2
|
|
800c038: f002 fbd8 bl 800e7ec <UTIL_ADV_TRACE_COND_FSend>
|
|
RFWPacket.LongPacketRemainingBytes );
|
|
size = RFWPacket.LongPacketRemainingBytes;
|
|
800c03c: 4b08 ldr r3, [pc, #32] @ (800c060 <RFW_GetPayloadProcess+0x220>)
|
|
800c03e: 8e9b ldrh r3, [r3, #52] @ 0x34
|
|
800c040: 70bb strb r3, [r7, #2]
|
|
/* update LongPacketRemainingBytes*/
|
|
RFWPacket.LongPacketRemainingBytes = 0;
|
|
800c042: 4b07 ldr r3, [pc, #28] @ (800c060 <RFW_GetPayloadProcess+0x220>)
|
|
800c044: 2200 movs r2, #0
|
|
800c046: 869a strh r2, [r3, #52] @ 0x34
|
|
/*Process last chunk*/
|
|
RFW_GetPayload( RFWPacket.RadioBufferOffset, size );
|
|
800c048: 4b05 ldr r3, [pc, #20] @ (800c060 <RFW_GetPayloadProcess+0x220>)
|
|
800c04a: f893 3036 ldrb.w r3, [r3, #54] @ 0x36
|
|
800c04e: 78ba ldrb r2, [r7, #2]
|
|
800c050: 4611 mov r1, r2
|
|
800c052: 4618 mov r0, r3
|
|
800c054: f000 f814 bl 800c080 <RFW_GetPayload>
|
|
}
|
|
}
|
|
800c058: 3708 adds r7, #8
|
|
800c05a: 46bd mov sp, r7
|
|
800c05c: bd80 pop {r7, pc}
|
|
800c05e: bf00 nop
|
|
800c060: 20000394 .word 0x20000394
|
|
800c064: 0800fa08 .word 0x0800fa08
|
|
800c068: 0800fa20 .word 0x0800fa20
|
|
800c06c: 0800fa34 .word 0x0800fa34
|
|
800c070: 200003e8 .word 0x200003e8
|
|
800c074: 200004e8 .word 0x200004e8
|
|
800c078: 200003b0 .word 0x200003b0
|
|
800c07c: 0800fa5c .word 0x0800fa5c
|
|
|
|
0800c080 <RFW_GetPayload>:
|
|
|
|
static void RFW_GetPayload( uint8_t Offset, uint8_t Length )
|
|
{
|
|
800c080: b5b0 push {r4, r5, r7, lr}
|
|
800c082: b088 sub sp, #32
|
|
800c084: af04 add r7, sp, #16
|
|
800c086: 4603 mov r3, r0
|
|
800c088: 460a mov r2, r1
|
|
800c08a: 71fb strb r3, [r7, #7]
|
|
800c08c: 4613 mov r3, r2
|
|
800c08e: 71bb strb r3, [r7, #6]
|
|
uint8_t crc_result[2];
|
|
/*stop the radio*/
|
|
SUBGRF_SetStandby( STDBY_RC );
|
|
800c090: 2000 movs r0, #0
|
|
800c092: f7fd ffd3 bl 800a03c <SUBGRF_SetStandby>
|
|
/*read data buffer*/
|
|
SUBGRF_ReadBuffer( Offset, ChunkBuffer, Length );
|
|
800c096: 79ba ldrb r2, [r7, #6]
|
|
800c098: 79fb ldrb r3, [r7, #7]
|
|
800c09a: 495a ldr r1, [pc, #360] @ (800c204 <RFW_GetPayload+0x184>)
|
|
800c09c: 4618 mov r0, r3
|
|
800c09e: f7fe fdf9 bl 800ac94 <SUBGRF_ReadBuffer>
|
|
/*Run the de-whitening on all packet*/
|
|
RFW_WhiteRun( &RFWPacket, ChunkBuffer, Length );
|
|
800c0a2: 79bb ldrb r3, [r7, #6]
|
|
800c0a4: 461a mov r2, r3
|
|
800c0a6: 4957 ldr r1, [pc, #348] @ (800c204 <RFW_GetPayload+0x184>)
|
|
800c0a8: 4857 ldr r0, [pc, #348] @ (800c208 <RFW_GetPayload+0x188>)
|
|
800c0aa: f7ff fd6a bl 800bb82 <RFW_WhiteRun>
|
|
if( RFWPacket.Init.CrcEnable == 1 )
|
|
800c0ae: 4b56 ldr r3, [pc, #344] @ (800c208 <RFW_GetPayload+0x188>)
|
|
800c0b0: 789b ldrb r3, [r3, #2]
|
|
800c0b2: 2b01 cmp r3, #1
|
|
800c0b4: d10a bne.n 800c0cc <RFW_GetPayload+0x4c>
|
|
{
|
|
RFW_CrcRun( &RFWPacket, ChunkBuffer, Length - RFWPacket.Init.CrcFieldSize, crc_result );
|
|
800c0b6: 79bb ldrb r3, [r7, #6]
|
|
800c0b8: 4a53 ldr r2, [pc, #332] @ (800c208 <RFW_GetPayload+0x188>)
|
|
800c0ba: 78d2 ldrb r2, [r2, #3]
|
|
800c0bc: 1a9b subs r3, r3, r2
|
|
800c0be: 461a mov r2, r3
|
|
800c0c0: f107 030c add.w r3, r7, #12
|
|
800c0c4: 494f ldr r1, [pc, #316] @ (800c204 <RFW_GetPayload+0x184>)
|
|
800c0c6: 4850 ldr r0, [pc, #320] @ (800c208 <RFW_GetPayload+0x188>)
|
|
800c0c8: f7ff fda3 bl 800bc12 <RFW_CrcRun>
|
|
}
|
|
if( RFWPacket.LongPacketModeEnable == 1 )
|
|
800c0cc: 4b4e ldr r3, [pc, #312] @ (800c208 <RFW_GetPayload+0x188>)
|
|
800c0ce: 7e9b ldrb r3, [r3, #26]
|
|
800c0d0: 2b01 cmp r3, #1
|
|
800c0d2: d10a bne.n 800c0ea <RFW_GetPayload+0x6a>
|
|
{
|
|
/*report rx data chunk to application*/
|
|
|
|
RFWPacket.RxLongPacketStoreChunkCb( ChunkBuffer, Length - RFWPacket.Init.CrcFieldSize );
|
|
800c0d4: 4b4c ldr r3, [pc, #304] @ (800c208 <RFW_GetPayload+0x188>)
|
|
800c0d6: 6bdb ldr r3, [r3, #60] @ 0x3c
|
|
800c0d8: 4a4b ldr r2, [pc, #300] @ (800c208 <RFW_GetPayload+0x188>)
|
|
800c0da: 78d2 ldrb r2, [r2, #3]
|
|
800c0dc: 79b9 ldrb r1, [r7, #6]
|
|
800c0de: 1a8a subs r2, r1, r2
|
|
800c0e0: b2d2 uxtb r2, r2
|
|
800c0e2: 4611 mov r1, r2
|
|
800c0e4: 4847 ldr r0, [pc, #284] @ (800c204 <RFW_GetPayload+0x184>)
|
|
800c0e6: 4798 blx r3
|
|
800c0e8: e02a b.n 800c140 <RFW_GetPayload+0xc0>
|
|
}
|
|
else
|
|
{
|
|
if( RFWPacket.RxPayloadOffset + Length - RFWPacket.Init.CrcFieldSize < RADIO_BUF_SIZE )
|
|
800c0ea: 4b47 ldr r3, [pc, #284] @ (800c208 <RFW_GetPayload+0x188>)
|
|
800c0ec: 8f1b ldrh r3, [r3, #56] @ 0x38
|
|
800c0ee: 461a mov r2, r3
|
|
800c0f0: 79bb ldrb r3, [r7, #6]
|
|
800c0f2: 4413 add r3, r2
|
|
800c0f4: 4a44 ldr r2, [pc, #272] @ (800c208 <RFW_GetPayload+0x188>)
|
|
800c0f6: 78d2 ldrb r2, [r2, #3]
|
|
800c0f8: 1a9b subs r3, r3, r2
|
|
800c0fa: 2bfe cmp r3, #254 @ 0xfe
|
|
800c0fc: dc1b bgt.n 800c136 <RFW_GetPayload+0xb6>
|
|
{
|
|
RADIO_MEMCPY8( &RxBuffer[RFWPacket.RxPayloadOffset], ChunkBuffer, Length - RFWPacket.Init.CrcFieldSize );
|
|
800c0fe: 4b42 ldr r3, [pc, #264] @ (800c208 <RFW_GetPayload+0x188>)
|
|
800c100: 8f1b ldrh r3, [r3, #56] @ 0x38
|
|
800c102: 461a mov r2, r3
|
|
800c104: 4b41 ldr r3, [pc, #260] @ (800c20c <RFW_GetPayload+0x18c>)
|
|
800c106: 18d0 adds r0, r2, r3
|
|
800c108: 79bb ldrb r3, [r7, #6]
|
|
800c10a: b29b uxth r3, r3
|
|
800c10c: 4a3e ldr r2, [pc, #248] @ (800c208 <RFW_GetPayload+0x188>)
|
|
800c10e: 78d2 ldrb r2, [r2, #3]
|
|
800c110: 1a9b subs r3, r3, r2
|
|
800c112: b29b uxth r3, r3
|
|
800c114: 461a mov r2, r3
|
|
800c116: 493b ldr r1, [pc, #236] @ (800c204 <RFW_GetPayload+0x184>)
|
|
800c118: f001 fc6a bl 800d9f0 <UTIL_MEM_cpy_8>
|
|
RFWPacket.RxPayloadOffset += Length - RFWPacket.Init.CrcFieldSize;
|
|
800c11c: 4b3a ldr r3, [pc, #232] @ (800c208 <RFW_GetPayload+0x188>)
|
|
800c11e: 8f1a ldrh r2, [r3, #56] @ 0x38
|
|
800c120: 79bb ldrb r3, [r7, #6]
|
|
800c122: b29b uxth r3, r3
|
|
800c124: 4938 ldr r1, [pc, #224] @ (800c208 <RFW_GetPayload+0x188>)
|
|
800c126: 78c9 ldrb r1, [r1, #3]
|
|
800c128: 1a5b subs r3, r3, r1
|
|
800c12a: b29b uxth r3, r3
|
|
800c12c: 4413 add r3, r2
|
|
800c12e: b29a uxth r2, r3
|
|
800c130: 4b35 ldr r3, [pc, #212] @ (800c208 <RFW_GetPayload+0x188>)
|
|
800c132: 871a strh r2, [r3, #56] @ 0x38
|
|
800c134: e004 b.n 800c140 <RFW_GetPayload+0xc0>
|
|
}
|
|
else
|
|
{
|
|
/*report CRC error*/
|
|
RFWPacket.Init.RadioEvents->RxError( );
|
|
800c136: 4b34 ldr r3, [pc, #208] @ (800c208 <RFW_GetPayload+0x188>)
|
|
800c138: 691b ldr r3, [r3, #16]
|
|
800c13a: 691b ldr r3, [r3, #16]
|
|
800c13c: 4798 blx r3
|
|
800c13e: e05d b.n 800c1fc <RFW_GetPayload+0x17c>
|
|
return;
|
|
}
|
|
}
|
|
TimerStop( RFWPacket.RxTimeoutTimer );
|
|
800c140: 4b31 ldr r3, [pc, #196] @ (800c208 <RFW_GetPayload+0x188>)
|
|
800c142: 6cdb ldr r3, [r3, #76] @ 0x4c
|
|
800c144: 4618 mov r0, r3
|
|
800c146: f002 f959 bl 800e3fc <UTIL_TIMER_Stop>
|
|
/* CRC check*/
|
|
RFW_MW_LOG( TS_ON, VLEVEL_M, "crc_result= 0x%02X%02X, crc_payload=0x%02X%02X\r\n", crc_result[0], crc_result[1],
|
|
800c14a: 7b3b ldrb r3, [r7, #12]
|
|
800c14c: 4619 mov r1, r3
|
|
800c14e: 7b7b ldrb r3, [r7, #13]
|
|
800c150: 4618 mov r0, r3
|
|
800c152: 79bb ldrb r3, [r7, #6]
|
|
800c154: 3b02 subs r3, #2
|
|
800c156: 4a2b ldr r2, [pc, #172] @ (800c204 <RFW_GetPayload+0x184>)
|
|
800c158: 5cd3 ldrb r3, [r2, r3]
|
|
800c15a: 461c mov r4, r3
|
|
800c15c: 79bb ldrb r3, [r7, #6]
|
|
800c15e: 3b01 subs r3, #1
|
|
800c160: 4a28 ldr r2, [pc, #160] @ (800c204 <RFW_GetPayload+0x184>)
|
|
800c162: 5cd3 ldrb r3, [r2, r3]
|
|
800c164: 9303 str r3, [sp, #12]
|
|
800c166: 9402 str r4, [sp, #8]
|
|
800c168: 9001 str r0, [sp, #4]
|
|
800c16a: 9100 str r1, [sp, #0]
|
|
800c16c: 4b28 ldr r3, [pc, #160] @ (800c210 <RFW_GetPayload+0x190>)
|
|
800c16e: 2201 movs r2, #1
|
|
800c170: 2100 movs r1, #0
|
|
800c172: 2002 movs r0, #2
|
|
800c174: f002 fb3a bl 800e7ec <UTIL_ADV_TRACE_COND_FSend>
|
|
ChunkBuffer[Length - 2], ChunkBuffer[Length - 1] );
|
|
if( ( ( crc_result[0] == ChunkBuffer[Length - 2] ) &&
|
|
800c178: 7b3a ldrb r2, [r7, #12]
|
|
800c17a: 79bb ldrb r3, [r7, #6]
|
|
800c17c: 3b02 subs r3, #2
|
|
800c17e: 4921 ldr r1, [pc, #132] @ (800c204 <RFW_GetPayload+0x184>)
|
|
800c180: 5ccb ldrb r3, [r1, r3]
|
|
800c182: 429a cmp r2, r3
|
|
800c184: d106 bne.n 800c194 <RFW_GetPayload+0x114>
|
|
( crc_result[1] == ChunkBuffer[Length - 1] ) ) ||
|
|
800c186: 7b7a ldrb r2, [r7, #13]
|
|
800c188: 79bb ldrb r3, [r7, #6]
|
|
800c18a: 3b01 subs r3, #1
|
|
800c18c: 491d ldr r1, [pc, #116] @ (800c204 <RFW_GetPayload+0x184>)
|
|
800c18e: 5ccb ldrb r3, [r1, r3]
|
|
if( ( ( crc_result[0] == ChunkBuffer[Length - 2] ) &&
|
|
800c190: 429a cmp r2, r3
|
|
800c192: d003 beq.n 800c19c <RFW_GetPayload+0x11c>
|
|
( RFWPacket.Init.CrcEnable == 0 ) )
|
|
800c194: 4b1c ldr r3, [pc, #112] @ (800c208 <RFW_GetPayload+0x188>)
|
|
800c196: 789b ldrb r3, [r3, #2]
|
|
( crc_result[1] == ChunkBuffer[Length - 1] ) ) ||
|
|
800c198: 2b00 cmp r3, #0
|
|
800c19a: d126 bne.n 800c1ea <RFW_GetPayload+0x16a>
|
|
{
|
|
/*read Rssi sampled at Sync*/
|
|
uint8_t rssi_sync = SUBGRF_ReadRegister( 0x06CA );
|
|
800c19c: f240 60ca movw r0, #1738 @ 0x6ca
|
|
800c1a0: f7fe fcf2 bl 800ab88 <SUBGRF_ReadRegister>
|
|
800c1a4: 4603 mov r3, r0
|
|
800c1a6: 73fb strb r3, [r7, #15]
|
|
/* Get Carrier Frequency Offset*/
|
|
int32_t cfo;
|
|
SUBGRF_GetCFO( RFWPacket.BitRate, &cfo );
|
|
800c1a8: 4b17 ldr r3, [pc, #92] @ (800c208 <RFW_GetPayload+0x188>)
|
|
800c1aa: 6c9b ldr r3, [r3, #72] @ 0x48
|
|
800c1ac: f107 0208 add.w r2, r7, #8
|
|
800c1b0: 4611 mov r1, r2
|
|
800c1b2: 4618 mov r0, r3
|
|
800c1b4: f7fe ff22 bl 800affc <SUBGRF_GetCFO>
|
|
/*ChunkBuffer[1] to remove packet Length*/
|
|
RFWPacket.Init.RadioEvents->RxDone( RxBuffer,
|
|
800c1b8: 4b13 ldr r3, [pc, #76] @ (800c208 <RFW_GetPayload+0x188>)
|
|
800c1ba: 691b ldr r3, [r3, #16]
|
|
800c1bc: 689c ldr r4, [r3, #8]
|
|
800c1be: 4b12 ldr r3, [pc, #72] @ (800c208 <RFW_GetPayload+0x188>)
|
|
800c1c0: 8f19 ldrh r1, [r3, #56] @ 0x38
|
|
800c1c2: 7bfb ldrb r3, [r7, #15]
|
|
800c1c4: 085b lsrs r3, r3, #1
|
|
800c1c6: b2db uxtb r3, r3
|
|
800c1c8: 425b negs r3, r3
|
|
800c1ca: b29b uxth r3, r3
|
|
800c1cc: b218 sxth r0, r3
|
|
RFWPacket.RxPayloadOffset,
|
|
-( rssi_sync >> 1 ),
|
|
( int8_t ) DIVR( cfo, 1000 ) );
|
|
800c1ce: 68bb ldr r3, [r7, #8]
|
|
800c1d0: f503 73fa add.w r3, r3, #500 @ 0x1f4
|
|
800c1d4: 4a0f ldr r2, [pc, #60] @ (800c214 <RFW_GetPayload+0x194>)
|
|
800c1d6: fb82 5203 smull r5, r2, r2, r3
|
|
800c1da: 1192 asrs r2, r2, #6
|
|
800c1dc: 17db asrs r3, r3, #31
|
|
800c1de: 1ad3 subs r3, r2, r3
|
|
RFWPacket.Init.RadioEvents->RxDone( RxBuffer,
|
|
800c1e0: b25b sxtb r3, r3
|
|
800c1e2: 4602 mov r2, r0
|
|
800c1e4: 4809 ldr r0, [pc, #36] @ (800c20c <RFW_GetPayload+0x18c>)
|
|
800c1e6: 47a0 blx r4
|
|
{
|
|
800c1e8: e003 b.n 800c1f2 <RFW_GetPayload+0x172>
|
|
}
|
|
else
|
|
{
|
|
/*report CRC error*/
|
|
RFWPacket.Init.RadioEvents->RxError( );
|
|
800c1ea: 4b07 ldr r3, [pc, #28] @ (800c208 <RFW_GetPayload+0x188>)
|
|
800c1ec: 691b ldr r3, [r3, #16]
|
|
800c1ee: 691b ldr r3, [r3, #16]
|
|
800c1f0: 4798 blx r3
|
|
}
|
|
DBG_GPIO_RADIO_RX( RST );
|
|
800c1f2: f44f 5180 mov.w r1, #4096 @ 0x1000
|
|
800c1f6: 4808 ldr r0, [pc, #32] @ (800c218 <RFW_GetPayload+0x198>)
|
|
800c1f8: f7fe ff8d bl 800b116 <LL_GPIO_ResetOutputPin>
|
|
}
|
|
800c1fc: 3710 adds r7, #16
|
|
800c1fe: 46bd mov sp, r7
|
|
800c200: bdb0 pop {r4, r5, r7, pc}
|
|
800c202: bf00 nop
|
|
800c204: 200003e8 .word 0x200003e8
|
|
800c208: 20000394 .word 0x20000394
|
|
800c20c: 200004e8 .word 0x200004e8
|
|
800c210: 0800fa8c .word 0x0800fa8c
|
|
800c214: 10624dd3 .word 0x10624dd3
|
|
800c218: 48000400 .word 0x48000400
|
|
|
|
0800c21c <MX_SubGHz_Phy_Init>:
|
|
#include "subghz_phy_app.h"
|
|
#include "sys_app.h"
|
|
#include "stm32_seq.h"
|
|
|
|
void MX_SubGHz_Phy_Init(void)
|
|
{
|
|
800c21c: b580 push {r7, lr}
|
|
800c21e: af00 add r7, sp, #0
|
|
SystemApp_Init();
|
|
800c220: f7f4 fc98 bl 8000b54 <SystemApp_Init>
|
|
SubghzApp_Init();
|
|
800c224: f000 f80c bl 800c240 <SubghzApp_Init>
|
|
}
|
|
800c228: bf00 nop
|
|
800c22a: bd80 pop {r7, pc}
|
|
|
|
0800c22c <MX_SubGHz_Phy_Process>:
|
|
|
|
void MX_SubGHz_Phy_Process(void)
|
|
{
|
|
800c22c: b580 push {r7, lr}
|
|
800c22e: af00 add r7, sp, #0
|
|
SubghzApp_Process();
|
|
800c230: f000 f858 bl 800c2e4 <SubghzApp_Process>
|
|
UTIL_SEQ_Run(UTIL_SEQ_DEFAULT);
|
|
800c234: f04f 30ff mov.w r0, #4294967295 @ 0xffffffff
|
|
800c238: f001 feec bl 800e014 <UTIL_SEQ_Run>
|
|
}
|
|
800c23c: bf00 nop
|
|
800c23e: bd80 pop {r7, pc}
|
|
|
|
0800c240 <SubghzApp_Init>:
|
|
static void App_ReconfigureUart(uint32_t baudrate);
|
|
static uint8_t App_ParseHexSyncWord(const char *text, uint8_t out[3]);
|
|
static char *App_SkipSpaces(char *s);
|
|
|
|
void SubghzApp_Init(void)
|
|
{
|
|
800c240: b580 push {r7, lr}
|
|
800c242: af00 add r7, sp, #0
|
|
if (!Config_Load(&g_cfg))
|
|
800c244: 481b ldr r0, [pc, #108] @ (800c2b4 <SubghzApp_Init+0x74>)
|
|
800c246: f001 fa51 bl 800d6ec <Config_Load>
|
|
800c24a: 4603 mov r3, r0
|
|
800c24c: f083 0301 eor.w r3, r3, #1
|
|
800c250: b2db uxtb r3, r3
|
|
800c252: 2b00 cmp r3, #0
|
|
800c254: d002 beq.n 800c25c <SubghzApp_Init+0x1c>
|
|
{
|
|
Config_LoadDefaults(&g_cfg);
|
|
800c256: 4817 ldr r0, [pc, #92] @ (800c2b4 <SubghzApp_Init+0x74>)
|
|
800c258: f001 f9f4 bl 800d644 <Config_LoadDefaults>
|
|
}
|
|
|
|
RadioEvents.TxDone = OnTxDone;
|
|
800c25c: 4b16 ldr r3, [pc, #88] @ (800c2b8 <SubghzApp_Init+0x78>)
|
|
800c25e: 4a17 ldr r2, [pc, #92] @ (800c2bc <SubghzApp_Init+0x7c>)
|
|
800c260: 601a str r2, [r3, #0]
|
|
RadioEvents.RxDone = OnRxDone;
|
|
800c262: 4b15 ldr r3, [pc, #84] @ (800c2b8 <SubghzApp_Init+0x78>)
|
|
800c264: 4a16 ldr r2, [pc, #88] @ (800c2c0 <SubghzApp_Init+0x80>)
|
|
800c266: 609a str r2, [r3, #8]
|
|
RadioEvents.TxTimeout = OnTxTimeout;
|
|
800c268: 4b13 ldr r3, [pc, #76] @ (800c2b8 <SubghzApp_Init+0x78>)
|
|
800c26a: 4a16 ldr r2, [pc, #88] @ (800c2c4 <SubghzApp_Init+0x84>)
|
|
800c26c: 605a str r2, [r3, #4]
|
|
RadioEvents.RxTimeout = OnRxTimeout;
|
|
800c26e: 4b12 ldr r3, [pc, #72] @ (800c2b8 <SubghzApp_Init+0x78>)
|
|
800c270: 4a15 ldr r2, [pc, #84] @ (800c2c8 <SubghzApp_Init+0x88>)
|
|
800c272: 60da str r2, [r3, #12]
|
|
RadioEvents.RxError = OnRxError;
|
|
800c274: 4b10 ldr r3, [pc, #64] @ (800c2b8 <SubghzApp_Init+0x78>)
|
|
800c276: 4a15 ldr r2, [pc, #84] @ (800c2cc <SubghzApp_Init+0x8c>)
|
|
800c278: 611a str r2, [r3, #16]
|
|
|
|
Radio.Init(&RadioEvents);
|
|
800c27a: 4b15 ldr r3, [pc, #84] @ (800c2d0 <SubghzApp_Init+0x90>)
|
|
800c27c: 681b ldr r3, [r3, #0]
|
|
800c27e: 480e ldr r0, [pc, #56] @ (800c2b8 <SubghzApp_Init+0x78>)
|
|
800c280: 4798 blx r3
|
|
|
|
App_RadioApplyConfig();
|
|
800c282: f000 f9a7 bl 800c5d4 <App_RadioApplyConfig>
|
|
App_ReconfigureUart(g_cfg.uart_baudrate);
|
|
800c286: 4b0b ldr r3, [pc, #44] @ (800c2b4 <SubghzApp_Init+0x74>)
|
|
800c288: 69db ldr r3, [r3, #28]
|
|
800c28a: 4618 mov r0, r3
|
|
800c28c: f001 f808 bl 800d2a0 <App_ReconfigureUart>
|
|
App_RadioEnterRx();
|
|
800c290: f000 fa54 bl 800c73c <App_RadioEnterRx>
|
|
|
|
g_uart_last_data_tick = HAL_GetTick();
|
|
800c294: f7f4 fcd8 bl 8000c48 <HAL_GetTick>
|
|
800c298: 4603 mov r3, r0
|
|
800c29a: 4a0e ldr r2, [pc, #56] @ (800c2d4 <SubghzApp_Init+0x94>)
|
|
800c29c: 6013 str r3, [r2, #0]
|
|
(void)vcom_ReceiveInit(UartRxByteCallback);
|
|
800c29e: 480e ldr r0, [pc, #56] @ (800c2d8 <SubghzApp_Init+0x98>)
|
|
800c2a0: f7f5 f984 bl 80015ac <vcom_ReceiveInit>
|
|
|
|
App_Printf("\r\nSTM32WL UART<->SUBGHZ bridge started\r\n");
|
|
800c2a4: 480d ldr r0, [pc, #52] @ (800c2dc <SubghzApp_Init+0x9c>)
|
|
800c2a6: f000 ffb5 bl 800d214 <App_Printf>
|
|
App_Printf("DATA mode, escape sequence: silence 800 ms + +++ + silence 800 ms\r\n");
|
|
800c2aa: 480d ldr r0, [pc, #52] @ (800c2e0 <SubghzApp_Init+0xa0>)
|
|
800c2ac: f000 ffb2 bl 800d214 <App_Printf>
|
|
}
|
|
800c2b0: bf00 nop
|
|
800c2b2: bd80 pop {r7, pc}
|
|
800c2b4: 20000604 .word 0x20000604
|
|
800c2b8: 200005e8 .word 0x200005e8
|
|
800c2bc: 0800d581 .word 0x0800d581
|
|
800c2c0: 0800d599 .word 0x0800d599
|
|
800c2c4: 0800d5fd .word 0x0800d5fd
|
|
800c2c8: 0800d615 .word 0x0800d615
|
|
800c2cc: 0800d62d .word 0x0800d62d
|
|
800c2d0: 080103c4 .word 0x080103c4
|
|
800c2d4: 20000b7c .word 0x20000b7c
|
|
800c2d8: 0800c9b9 .word 0x0800c9b9
|
|
800c2dc: 0800fac0 .word 0x0800fac0
|
|
800c2e0: 0800faec .word 0x0800faec
|
|
|
|
0800c2e4 <SubghzApp_Process>:
|
|
|
|
void SubghzApp_Process(void)
|
|
{
|
|
800c2e4: b580 push {r7, lr}
|
|
800c2e6: af00 add r7, sp, #0
|
|
App_ProcessEscape();
|
|
800c2e8: f000 f8ce bl 800c488 <App_ProcessEscape>
|
|
App_ProcessUartPacketizer();
|
|
800c2ec: f000 f8a0 bl 800c430 <App_ProcessUartPacketizer>
|
|
App_ProcessRadioEvents();
|
|
800c2f0: f000 f806 bl 800c300 <App_ProcessRadioEvents>
|
|
App_StartNextTxIfPossible();
|
|
800c2f4: f000 f918 bl 800c528 <App_StartNextTxIfPossible>
|
|
App_ProcessLeds();
|
|
800c2f8: f001 f8f0 bl 800d4dc <App_ProcessLeds>
|
|
}
|
|
800c2fc: bf00 nop
|
|
800c2fe: bd80 pop {r7, pc}
|
|
|
|
0800c300 <App_ProcessRadioEvents>:
|
|
|
|
static void App_ProcessRadioEvents(void)
|
|
{
|
|
800c300: b580 push {r7, lr}
|
|
800c302: af00 add r7, sp, #0
|
|
if (g_radio_tx_done != 0U)
|
|
800c304: 4b3b ldr r3, [pc, #236] @ (800c3f4 <App_ProcessRadioEvents+0xf4>)
|
|
800c306: 781b ldrb r3, [r3, #0]
|
|
800c308: b2db uxtb r3, r3
|
|
800c30a: 2b00 cmp r3, #0
|
|
800c30c: d00f beq.n 800c32e <App_ProcessRadioEvents+0x2e>
|
|
{
|
|
g_radio_tx_done = 0U;
|
|
800c30e: 4b39 ldr r3, [pc, #228] @ (800c3f4 <App_ProcessRadioEvents+0xf4>)
|
|
800c310: 2200 movs r2, #0
|
|
800c312: 701a strb r2, [r3, #0]
|
|
g_radio_busy = 0U;
|
|
800c314: 4b38 ldr r3, [pc, #224] @ (800c3f8 <App_ProcessRadioEvents+0xf8>)
|
|
800c316: 2200 movs r2, #0
|
|
800c318: 701a strb r2, [r3, #0]
|
|
g_stat_uart_packets_tx++;
|
|
800c31a: 4b38 ldr r3, [pc, #224] @ (800c3fc <App_ProcessRadioEvents+0xfc>)
|
|
800c31c: 681b ldr r3, [r3, #0]
|
|
800c31e: 3301 adds r3, #1
|
|
800c320: 4a36 ldr r2, [pc, #216] @ (800c3fc <App_ProcessRadioEvents+0xfc>)
|
|
800c322: 6013 str r3, [r2, #0]
|
|
App_QueuePop();
|
|
800c324: f000 fb2a bl 800c97c <App_QueuePop>
|
|
g_radio_needs_rx_restart = 1U;
|
|
800c328: 4b35 ldr r3, [pc, #212] @ (800c400 <App_ProcessRadioEvents+0x100>)
|
|
800c32a: 2201 movs r2, #1
|
|
800c32c: 701a strb r2, [r3, #0]
|
|
}
|
|
|
|
if (g_radio_tx_timeout != 0U)
|
|
800c32e: 4b35 ldr r3, [pc, #212] @ (800c404 <App_ProcessRadioEvents+0x104>)
|
|
800c330: 781b ldrb r3, [r3, #0]
|
|
800c332: b2db uxtb r3, r3
|
|
800c334: 2b00 cmp r3, #0
|
|
800c336: d00f beq.n 800c358 <App_ProcessRadioEvents+0x58>
|
|
{
|
|
g_radio_tx_timeout = 0U;
|
|
800c338: 4b32 ldr r3, [pc, #200] @ (800c404 <App_ProcessRadioEvents+0x104>)
|
|
800c33a: 2200 movs r2, #0
|
|
800c33c: 701a strb r2, [r3, #0]
|
|
g_radio_busy = 0U;
|
|
800c33e: 4b2e ldr r3, [pc, #184] @ (800c3f8 <App_ProcessRadioEvents+0xf8>)
|
|
800c340: 2200 movs r2, #0
|
|
800c342: 701a strb r2, [r3, #0]
|
|
App_LedErrPulse();
|
|
800c344: f001 f8b0 bl 800d4a8 <App_LedErrPulse>
|
|
App_QueuePop();
|
|
800c348: f000 fb18 bl 800c97c <App_QueuePop>
|
|
App_Printf("\r\n[WARN] radio tx timeout\r\n");
|
|
800c34c: 482e ldr r0, [pc, #184] @ (800c408 <App_ProcessRadioEvents+0x108>)
|
|
800c34e: f000 ff61 bl 800d214 <App_Printf>
|
|
g_radio_needs_rx_restart = 1U;
|
|
800c352: 4b2b ldr r3, [pc, #172] @ (800c400 <App_ProcessRadioEvents+0x100>)
|
|
800c354: 2201 movs r2, #1
|
|
800c356: 701a strb r2, [r3, #0]
|
|
}
|
|
|
|
if (g_radio_rx_done != 0U)
|
|
800c358: 4b2c ldr r3, [pc, #176] @ (800c40c <App_ProcessRadioEvents+0x10c>)
|
|
800c35a: 781b ldrb r3, [r3, #0]
|
|
800c35c: b2db uxtb r3, r3
|
|
800c35e: 2b00 cmp r3, #0
|
|
800c360: d01e beq.n 800c3a0 <App_ProcessRadioEvents+0xa0>
|
|
{
|
|
g_radio_rx_done = 0U;
|
|
800c362: 4b2a ldr r3, [pc, #168] @ (800c40c <App_ProcessRadioEvents+0x10c>)
|
|
800c364: 2200 movs r2, #0
|
|
800c366: 701a strb r2, [r3, #0]
|
|
App_LedRxPulse();
|
|
800c368: f001 f884 bl 800d474 <App_LedRxPulse>
|
|
g_stat_radio_packets_rx++;
|
|
800c36c: 4b28 ldr r3, [pc, #160] @ (800c410 <App_ProcessRadioEvents+0x110>)
|
|
800c36e: 681b ldr r3, [r3, #0]
|
|
800c370: 3301 adds r3, #1
|
|
800c372: 4a27 ldr r2, [pc, #156] @ (800c410 <App_ProcessRadioEvents+0x110>)
|
|
800c374: 6013 str r3, [r2, #0]
|
|
g_stat_radio_bytes_rx += g_rx_payload_len;
|
|
800c376: 4b27 ldr r3, [pc, #156] @ (800c414 <App_ProcessRadioEvents+0x114>)
|
|
800c378: 881b ldrh r3, [r3, #0]
|
|
800c37a: 461a mov r2, r3
|
|
800c37c: 4b26 ldr r3, [pc, #152] @ (800c418 <App_ProcessRadioEvents+0x118>)
|
|
800c37e: 681b ldr r3, [r3, #0]
|
|
800c380: 4413 add r3, r2
|
|
800c382: 4a25 ldr r2, [pc, #148] @ (800c418 <App_ProcessRadioEvents+0x118>)
|
|
800c384: 6013 str r3, [r2, #0]
|
|
|
|
if (g_mode == APP_MODE_DATA)
|
|
800c386: 4b25 ldr r3, [pc, #148] @ (800c41c <App_ProcessRadioEvents+0x11c>)
|
|
800c388: 781b ldrb r3, [r3, #0]
|
|
800c38a: 2b00 cmp r3, #0
|
|
800c38c: d105 bne.n 800c39a <App_ProcessRadioEvents+0x9a>
|
|
{
|
|
App_Write(g_rx_payload, g_rx_payload_len);
|
|
800c38e: 4b21 ldr r3, [pc, #132] @ (800c414 <App_ProcessRadioEvents+0x114>)
|
|
800c390: 881b ldrh r3, [r3, #0]
|
|
800c392: 4619 mov r1, r3
|
|
800c394: 4822 ldr r0, [pc, #136] @ (800c420 <App_ProcessRadioEvents+0x120>)
|
|
800c396: f000 ff69 bl 800d26c <App_Write>
|
|
}
|
|
|
|
g_radio_needs_rx_restart = 1U;
|
|
800c39a: 4b19 ldr r3, [pc, #100] @ (800c400 <App_ProcessRadioEvents+0x100>)
|
|
800c39c: 2201 movs r2, #1
|
|
800c39e: 701a strb r2, [r3, #0]
|
|
}
|
|
|
|
if ((g_radio_rx_timeout != 0U) || (g_radio_rx_error != 0U))
|
|
800c3a0: 4b20 ldr r3, [pc, #128] @ (800c424 <App_ProcessRadioEvents+0x124>)
|
|
800c3a2: 781b ldrb r3, [r3, #0]
|
|
800c3a4: b2db uxtb r3, r3
|
|
800c3a6: 2b00 cmp r3, #0
|
|
800c3a8: d104 bne.n 800c3b4 <App_ProcessRadioEvents+0xb4>
|
|
800c3aa: 4b1f ldr r3, [pc, #124] @ (800c428 <App_ProcessRadioEvents+0x128>)
|
|
800c3ac: 781b ldrb r3, [r3, #0]
|
|
800c3ae: b2db uxtb r3, r3
|
|
800c3b0: 2b00 cmp r3, #0
|
|
800c3b2: d00a beq.n 800c3ca <App_ProcessRadioEvents+0xca>
|
|
{
|
|
g_radio_rx_timeout = 0U;
|
|
800c3b4: 4b1b ldr r3, [pc, #108] @ (800c424 <App_ProcessRadioEvents+0x124>)
|
|
800c3b6: 2200 movs r2, #0
|
|
800c3b8: 701a strb r2, [r3, #0]
|
|
g_radio_rx_error = 0U;
|
|
800c3ba: 4b1b ldr r3, [pc, #108] @ (800c428 <App_ProcessRadioEvents+0x128>)
|
|
800c3bc: 2200 movs r2, #0
|
|
800c3be: 701a strb r2, [r3, #0]
|
|
App_LedErrPulse();
|
|
800c3c0: f001 f872 bl 800d4a8 <App_LedErrPulse>
|
|
g_radio_needs_rx_restart = 1U;
|
|
800c3c4: 4b0e ldr r3, [pc, #56] @ (800c400 <App_ProcessRadioEvents+0x100>)
|
|
800c3c6: 2201 movs r2, #1
|
|
800c3c8: 701a strb r2, [r3, #0]
|
|
}
|
|
|
|
if ((g_radio_needs_rx_restart != 0U) && (g_radio_busy == 0U) && (g_tx_q_count == 0U))
|
|
800c3ca: 4b0d ldr r3, [pc, #52] @ (800c400 <App_ProcessRadioEvents+0x100>)
|
|
800c3cc: 781b ldrb r3, [r3, #0]
|
|
800c3ce: b2db uxtb r3, r3
|
|
800c3d0: 2b00 cmp r3, #0
|
|
800c3d2: d00d beq.n 800c3f0 <App_ProcessRadioEvents+0xf0>
|
|
800c3d4: 4b08 ldr r3, [pc, #32] @ (800c3f8 <App_ProcessRadioEvents+0xf8>)
|
|
800c3d6: 781b ldrb r3, [r3, #0]
|
|
800c3d8: b2db uxtb r3, r3
|
|
800c3da: 2b00 cmp r3, #0
|
|
800c3dc: d108 bne.n 800c3f0 <App_ProcessRadioEvents+0xf0>
|
|
800c3de: 4b13 ldr r3, [pc, #76] @ (800c42c <App_ProcessRadioEvents+0x12c>)
|
|
800c3e0: 781b ldrb r3, [r3, #0]
|
|
800c3e2: 2b00 cmp r3, #0
|
|
800c3e4: d104 bne.n 800c3f0 <App_ProcessRadioEvents+0xf0>
|
|
{
|
|
g_radio_needs_rx_restart = 0U;
|
|
800c3e6: 4b06 ldr r3, [pc, #24] @ (800c400 <App_ProcessRadioEvents+0x100>)
|
|
800c3e8: 2200 movs r2, #0
|
|
800c3ea: 701a strb r2, [r3, #0]
|
|
App_RadioEnterRx();
|
|
800c3ec: f000 f9a6 bl 800c73c <App_RadioEnterRx>
|
|
}
|
|
}
|
|
800c3f0: bf00 nop
|
|
800c3f2: bd80 pop {r7, pc}
|
|
800c3f4: 20000624 .word 0x20000624
|
|
800c3f8: 2000063f .word 0x2000063f
|
|
800c3fc: 20000bf8 .word 0x20000bf8
|
|
800c400: 20000640 .word 0x20000640
|
|
800c404: 20000625 .word 0x20000625
|
|
800c408: 0800fb30 .word 0x0800fb30
|
|
800c40c: 20000626 .word 0x20000626
|
|
800c410: 20000c00 .word 0x20000c00
|
|
800c414: 20000720 .word 0x20000720
|
|
800c418: 20000c04 .word 0x20000c04
|
|
800c41c: 20000b90 .word 0x20000b90
|
|
800c420: 20000644 .word 0x20000644
|
|
800c424: 20000627 .word 0x20000627
|
|
800c428: 20000628 .word 0x20000628
|
|
800c42c: 20000a9a .word 0x20000a9a
|
|
|
|
0800c430 <App_ProcessUartPacketizer>:
|
|
|
|
static void App_ProcessUartPacketizer(void)
|
|
{
|
|
800c430: b580 push {r7, lr}
|
|
800c432: b082 sub sp, #8
|
|
800c434: af00 add r7, sp, #0
|
|
uint32_t now = HAL_GetTick();
|
|
800c436: f7f4 fc07 bl 8000c48 <HAL_GetTick>
|
|
800c43a: 6078 str r0, [r7, #4]
|
|
|
|
if (g_mode != APP_MODE_DATA)
|
|
800c43c: 4b0d ldr r3, [pc, #52] @ (800c474 <App_ProcessUartPacketizer+0x44>)
|
|
800c43e: 781b ldrb r3, [r3, #0]
|
|
800c440: 2b00 cmp r3, #0
|
|
800c442: d112 bne.n 800c46a <App_ProcessUartPacketizer+0x3a>
|
|
{
|
|
return;
|
|
}
|
|
|
|
if ((g_uart_build_len > 0U) &&
|
|
800c444: 4b0c ldr r3, [pc, #48] @ (800c478 <App_ProcessUartPacketizer+0x48>)
|
|
800c446: 881b ldrh r3, [r3, #0]
|
|
800c448: 2b00 cmp r3, #0
|
|
800c44a: d00f beq.n 800c46c <App_ProcessUartPacketizer+0x3c>
|
|
((now - g_uart_last_data_tick) >= g_cfg.uart_packet_timeout_ms) &&
|
|
800c44c: 4b0b ldr r3, [pc, #44] @ (800c47c <App_ProcessUartPacketizer+0x4c>)
|
|
800c44e: 681b ldr r3, [r3, #0]
|
|
800c450: 687a ldr r2, [r7, #4]
|
|
800c452: 1ad3 subs r3, r2, r3
|
|
800c454: 4a0a ldr r2, [pc, #40] @ (800c480 <App_ProcessUartPacketizer+0x50>)
|
|
800c456: 8b52 ldrh r2, [r2, #26]
|
|
if ((g_uart_build_len > 0U) &&
|
|
800c458: 4293 cmp r3, r2
|
|
800c45a: d307 bcc.n 800c46c <App_ProcessUartPacketizer+0x3c>
|
|
(g_escape.active == 0U))
|
|
800c45c: 4b09 ldr r3, [pc, #36] @ (800c484 <App_ProcessUartPacketizer+0x54>)
|
|
800c45e: 781b ldrb r3, [r3, #0]
|
|
((now - g_uart_last_data_tick) >= g_cfg.uart_packet_timeout_ms) &&
|
|
800c460: 2b00 cmp r3, #0
|
|
800c462: d103 bne.n 800c46c <App_ProcessUartPacketizer+0x3c>
|
|
{
|
|
App_DataModeFlushBuilder();
|
|
800c464: f000 fa24 bl 800c8b0 <App_DataModeFlushBuilder>
|
|
800c468: e000 b.n 800c46c <App_ProcessUartPacketizer+0x3c>
|
|
return;
|
|
800c46a: bf00 nop
|
|
}
|
|
}
|
|
800c46c: 3708 adds r7, #8
|
|
800c46e: 46bd mov sp, r7
|
|
800c470: bd80 pop {r7, pc}
|
|
800c472: bf00 nop
|
|
800c474: 20000b90 .word 0x20000b90
|
|
800c478: 20000b78 .word 0x20000b78
|
|
800c47c: 20000b7c .word 0x20000b7c
|
|
800c480: 20000604 .word 0x20000604
|
|
800c484: 20000b80 .word 0x20000b80
|
|
|
|
0800c488 <App_ProcessEscape>:
|
|
|
|
static void App_ProcessEscape(void)
|
|
{
|
|
800c488: b580 push {r7, lr}
|
|
800c48a: b082 sub sp, #8
|
|
800c48c: af00 add r7, sp, #0
|
|
uint32_t now = HAL_GetTick();
|
|
800c48e: f7f4 fbdb bl 8000c48 <HAL_GetTick>
|
|
800c492: 6038 str r0, [r7, #0]
|
|
uint8_t i;
|
|
|
|
if ((g_mode != APP_MODE_DATA) || (g_escape.active == 0U))
|
|
800c494: 4b22 ldr r3, [pc, #136] @ (800c520 <App_ProcessEscape+0x98>)
|
|
800c496: 781b ldrb r3, [r3, #0]
|
|
800c498: 2b00 cmp r3, #0
|
|
800c49a: d13c bne.n 800c516 <App_ProcessEscape+0x8e>
|
|
800c49c: 4b21 ldr r3, [pc, #132] @ (800c524 <App_ProcessEscape+0x9c>)
|
|
800c49e: 781b ldrb r3, [r3, #0]
|
|
800c4a0: 2b00 cmp r3, #0
|
|
800c4a2: d038 beq.n 800c516 <App_ProcessEscape+0x8e>
|
|
{
|
|
return;
|
|
}
|
|
|
|
if ((g_escape.count == 3U) && ((now - g_escape.last_tick) >= CONFIG_ESCAPE_GUARD_MS))
|
|
800c4a4: 4b1f ldr r3, [pc, #124] @ (800c524 <App_ProcessEscape+0x9c>)
|
|
800c4a6: 785b ldrb r3, [r3, #1]
|
|
800c4a8: 2b03 cmp r3, #3
|
|
800c4aa: d10f bne.n 800c4cc <App_ProcessEscape+0x44>
|
|
800c4ac: 4b1d ldr r3, [pc, #116] @ (800c524 <App_ProcessEscape+0x9c>)
|
|
800c4ae: 68db ldr r3, [r3, #12]
|
|
800c4b0: 683a ldr r2, [r7, #0]
|
|
800c4b2: 1ad3 subs r3, r2, r3
|
|
800c4b4: f5b3 7f48 cmp.w r3, #800 @ 0x320
|
|
800c4b8: d308 bcc.n 800c4cc <App_ProcessEscape+0x44>
|
|
{
|
|
g_escape.active = 0U;
|
|
800c4ba: 4b1a ldr r3, [pc, #104] @ (800c524 <App_ProcessEscape+0x9c>)
|
|
800c4bc: 2200 movs r2, #0
|
|
800c4be: 701a strb r2, [r3, #0]
|
|
g_escape.count = 0U;
|
|
800c4c0: 4b18 ldr r3, [pc, #96] @ (800c524 <App_ProcessEscape+0x9c>)
|
|
800c4c2: 2200 movs r2, #0
|
|
800c4c4: 705a strb r2, [r3, #1]
|
|
App_EnterConfigMode();
|
|
800c4c6: f000 f945 bl 800c754 <App_EnterConfigMode>
|
|
return;
|
|
800c4ca: e025 b.n 800c518 <App_ProcessEscape+0x90>
|
|
}
|
|
|
|
if ((g_escape.count < 3U) && ((now - g_escape.last_tick) >= CONFIG_ESCAPE_GUARD_MS))
|
|
800c4cc: 4b15 ldr r3, [pc, #84] @ (800c524 <App_ProcessEscape+0x9c>)
|
|
800c4ce: 785b ldrb r3, [r3, #1]
|
|
800c4d0: 2b02 cmp r3, #2
|
|
800c4d2: d821 bhi.n 800c518 <App_ProcessEscape+0x90>
|
|
800c4d4: 4b13 ldr r3, [pc, #76] @ (800c524 <App_ProcessEscape+0x9c>)
|
|
800c4d6: 68db ldr r3, [r3, #12]
|
|
800c4d8: 683a ldr r2, [r7, #0]
|
|
800c4da: 1ad3 subs r3, r2, r3
|
|
800c4dc: f5b3 7f48 cmp.w r3, #800 @ 0x320
|
|
800c4e0: d31a bcc.n 800c518 <App_ProcessEscape+0x90>
|
|
{
|
|
for (i = 0U; i < g_escape.count; i++)
|
|
800c4e2: 2300 movs r3, #0
|
|
800c4e4: 71fb strb r3, [r7, #7]
|
|
800c4e6: e00a b.n 800c4fe <App_ProcessEscape+0x76>
|
|
{
|
|
App_DataModeFeedByte(g_escape.bytes[i], now);
|
|
800c4e8: 79fb ldrb r3, [r7, #7]
|
|
800c4ea: 4a0e ldr r2, [pc, #56] @ (800c524 <App_ProcessEscape+0x9c>)
|
|
800c4ec: 4413 add r3, r2
|
|
800c4ee: 789b ldrb r3, [r3, #2]
|
|
800c4f0: 6839 ldr r1, [r7, #0]
|
|
800c4f2: 4618 mov r0, r3
|
|
800c4f4: f000 f99a bl 800c82c <App_DataModeFeedByte>
|
|
for (i = 0U; i < g_escape.count; i++)
|
|
800c4f8: 79fb ldrb r3, [r7, #7]
|
|
800c4fa: 3301 adds r3, #1
|
|
800c4fc: 71fb strb r3, [r7, #7]
|
|
800c4fe: 4b09 ldr r3, [pc, #36] @ (800c524 <App_ProcessEscape+0x9c>)
|
|
800c500: 785b ldrb r3, [r3, #1]
|
|
800c502: 79fa ldrb r2, [r7, #7]
|
|
800c504: 429a cmp r2, r3
|
|
800c506: d3ef bcc.n 800c4e8 <App_ProcessEscape+0x60>
|
|
}
|
|
g_escape.active = 0U;
|
|
800c508: 4b06 ldr r3, [pc, #24] @ (800c524 <App_ProcessEscape+0x9c>)
|
|
800c50a: 2200 movs r2, #0
|
|
800c50c: 701a strb r2, [r3, #0]
|
|
g_escape.count = 0U;
|
|
800c50e: 4b05 ldr r3, [pc, #20] @ (800c524 <App_ProcessEscape+0x9c>)
|
|
800c510: 2200 movs r2, #0
|
|
800c512: 705a strb r2, [r3, #1]
|
|
800c514: e000 b.n 800c518 <App_ProcessEscape+0x90>
|
|
return;
|
|
800c516: bf00 nop
|
|
}
|
|
}
|
|
800c518: 3708 adds r7, #8
|
|
800c51a: 46bd mov sp, r7
|
|
800c51c: bd80 pop {r7, pc}
|
|
800c51e: bf00 nop
|
|
800c520: 20000b90 .word 0x20000b90
|
|
800c524: 20000b80 .word 0x20000b80
|
|
|
|
0800c528 <App_StartNextTxIfPossible>:
|
|
|
|
static void App_StartNextTxIfPossible(void)
|
|
{
|
|
800c528: b598 push {r3, r4, r7, lr}
|
|
800c52a: af00 add r7, sp, #0
|
|
if ((g_mode != APP_MODE_DATA) || (g_radio_busy != 0U) || (g_tx_q_count == 0U))
|
|
800c52c: 4b16 ldr r3, [pc, #88] @ (800c588 <App_StartNextTxIfPossible+0x60>)
|
|
800c52e: 781b ldrb r3, [r3, #0]
|
|
800c530: 2b00 cmp r3, #0
|
|
800c532: d126 bne.n 800c582 <App_StartNextTxIfPossible+0x5a>
|
|
800c534: 4b15 ldr r3, [pc, #84] @ (800c58c <App_StartNextTxIfPossible+0x64>)
|
|
800c536: 781b ldrb r3, [r3, #0]
|
|
800c538: b2db uxtb r3, r3
|
|
800c53a: 2b00 cmp r3, #0
|
|
800c53c: d121 bne.n 800c582 <App_StartNextTxIfPossible+0x5a>
|
|
800c53e: 4b14 ldr r3, [pc, #80] @ (800c590 <App_StartNextTxIfPossible+0x68>)
|
|
800c540: 781b ldrb r3, [r3, #0]
|
|
800c542: 2b00 cmp r3, #0
|
|
800c544: d01d beq.n 800c582 <App_StartNextTxIfPossible+0x5a>
|
|
{
|
|
return;
|
|
}
|
|
|
|
App_RadioConfigureTx();
|
|
800c546: f000 f8ad bl 800c6a4 <App_RadioConfigureTx>
|
|
g_radio_busy = 1U;
|
|
800c54a: 4b10 ldr r3, [pc, #64] @ (800c58c <App_StartNextTxIfPossible+0x64>)
|
|
800c54c: 2201 movs r2, #1
|
|
800c54e: 701a strb r2, [r3, #0]
|
|
App_LedTxPulse();
|
|
800c550: f000 ff76 bl 800d440 <App_LedTxPulse>
|
|
(void)Radio.Send(g_tx_queue[g_tx_q_head].data, g_tx_queue[g_tx_q_head].len);
|
|
800c554: 4b0f ldr r3, [pc, #60] @ (800c594 <App_StartNextTxIfPossible+0x6c>)
|
|
800c556: 6a9b ldr r3, [r3, #40] @ 0x28
|
|
800c558: 4a0f ldr r2, [pc, #60] @ (800c598 <App_StartNextTxIfPossible+0x70>)
|
|
800c55a: 7812 ldrb r2, [r2, #0]
|
|
800c55c: 4611 mov r1, r2
|
|
800c55e: 22dd movs r2, #221 @ 0xdd
|
|
800c560: fb01 f202 mul.w r2, r1, r2
|
|
800c564: 490d ldr r1, [pc, #52] @ (800c59c <App_StartNextTxIfPossible+0x74>)
|
|
800c566: 1850 adds r0, r2, r1
|
|
800c568: 4a0b ldr r2, [pc, #44] @ (800c598 <App_StartNextTxIfPossible+0x70>)
|
|
800c56a: 7812 ldrb r2, [r2, #0]
|
|
800c56c: 4614 mov r4, r2
|
|
800c56e: 490b ldr r1, [pc, #44] @ (800c59c <App_StartNextTxIfPossible+0x74>)
|
|
800c570: 22dd movs r2, #221 @ 0xdd
|
|
800c572: fb04 f202 mul.w r2, r4, r2
|
|
800c576: 440a add r2, r1
|
|
800c578: 32dc adds r2, #220 @ 0xdc
|
|
800c57a: 7812 ldrb r2, [r2, #0]
|
|
800c57c: 4611 mov r1, r2
|
|
800c57e: 4798 blx r3
|
|
800c580: e000 b.n 800c584 <App_StartNextTxIfPossible+0x5c>
|
|
return;
|
|
800c582: bf00 nop
|
|
}
|
|
800c584: bd98 pop {r3, r4, r7, pc}
|
|
800c586: bf00 nop
|
|
800c588: 20000b90 .word 0x20000b90
|
|
800c58c: 2000063f .word 0x2000063f
|
|
800c590: 20000a9a .word 0x20000a9a
|
|
800c594: 080103c4 .word 0x080103c4
|
|
800c598: 20000a98 .word 0x20000a98
|
|
800c59c: 20000724 .word 0x20000724
|
|
|
|
0800c5a0 <App_ApplyConfig>:
|
|
static void App_ApplyConfig(void)
|
|
{
|
|
800c5a0: b580 push {r7, lr}
|
|
800c5a2: af00 add r7, sp, #0
|
|
App_RadioApplyConfig();
|
|
800c5a4: f000 f816 bl 800c5d4 <App_RadioApplyConfig>
|
|
App_RadioConfigureRx();
|
|
800c5a8: f000 f828 bl 800c5fc <App_RadioConfigureRx>
|
|
App_RadioConfigureTx();
|
|
800c5ac: f000 f87a bl 800c6a4 <App_RadioConfigureTx>
|
|
if (!Config_Save(&g_cfg)) {
|
|
800c5b0: 4806 ldr r0, [pc, #24] @ (800c5cc <App_ApplyConfig+0x2c>)
|
|
800c5b2: f001 f8cb bl 800d74c <Config_Save>
|
|
800c5b6: 4603 mov r3, r0
|
|
800c5b8: f083 0301 eor.w r3, r3, #1
|
|
800c5bc: b2db uxtb r3, r3
|
|
800c5be: 2b00 cmp r3, #0
|
|
800c5c0: d002 beq.n 800c5c8 <App_ApplyConfig+0x28>
|
|
App_Printf("Error while saving cnf\r\n");
|
|
800c5c2: 4803 ldr r0, [pc, #12] @ (800c5d0 <App_ApplyConfig+0x30>)
|
|
800c5c4: f000 fe26 bl 800d214 <App_Printf>
|
|
}
|
|
}
|
|
800c5c8: bf00 nop
|
|
800c5ca: bd80 pop {r7, pc}
|
|
800c5cc: 20000604 .word 0x20000604
|
|
800c5d0: 0800fb4c .word 0x0800fb4c
|
|
|
|
0800c5d4 <App_RadioApplyConfig>:
|
|
|
|
|
|
static void App_RadioApplyConfig(void)
|
|
{
|
|
800c5d4: b580 push {r7, lr}
|
|
800c5d6: af00 add r7, sp, #0
|
|
Radio.SetChannel(g_cfg.rf_frequency);
|
|
800c5d8: 4b05 ldr r3, [pc, #20] @ (800c5f0 <App_RadioApplyConfig+0x1c>)
|
|
800c5da: 68db ldr r3, [r3, #12]
|
|
800c5dc: 4a05 ldr r2, [pc, #20] @ (800c5f4 <App_RadioApplyConfig+0x20>)
|
|
800c5de: 6812 ldr r2, [r2, #0]
|
|
800c5e0: 4610 mov r0, r2
|
|
800c5e2: 4798 blx r3
|
|
g_radio_needs_rx_restart = 1U;
|
|
800c5e4: 4b04 ldr r3, [pc, #16] @ (800c5f8 <App_RadioApplyConfig+0x24>)
|
|
800c5e6: 2201 movs r2, #1
|
|
800c5e8: 701a strb r2, [r3, #0]
|
|
}
|
|
800c5ea: bf00 nop
|
|
800c5ec: bd80 pop {r7, pc}
|
|
800c5ee: bf00 nop
|
|
800c5f0: 080103c4 .word 0x080103c4
|
|
800c5f4: 20000604 .word 0x20000604
|
|
800c5f8: 20000640 .word 0x20000640
|
|
|
|
0800c5fc <App_RadioConfigureRx>:
|
|
|
|
static void App_RadioConfigureRx(void)
|
|
{
|
|
800c5fc: b590 push {r4, r7, lr}
|
|
800c5fe: b08f sub sp, #60 @ 0x3c
|
|
800c600: af00 add r7, sp, #0
|
|
RxConfigGeneric_t rx = {0};
|
|
800c602: 463b mov r3, r7
|
|
800c604: 2238 movs r2, #56 @ 0x38
|
|
800c606: 2100 movs r1, #0
|
|
800c608: 4618 mov r0, r3
|
|
800c60a: f002 fc9f bl 800ef4c <memset>
|
|
|
|
Radio.SetChannel(g_cfg.rf_frequency);
|
|
800c60e: 4b22 ldr r3, [pc, #136] @ (800c698 <App_RadioConfigureRx+0x9c>)
|
|
800c610: 68db ldr r3, [r3, #12]
|
|
800c612: 4a22 ldr r2, [pc, #136] @ (800c69c <App_RadioConfigureRx+0xa0>)
|
|
800c614: 6812 ldr r2, [r2, #0]
|
|
800c616: 4610 mov r0, r2
|
|
800c618: 4798 blx r3
|
|
|
|
rx.fsk.ModulationShaping = RADIO_FSK_MOD_SHAPING_G_BT_05;
|
|
800c61a: 2309 movs r3, #9
|
|
800c61c: f887 3020 strb.w r3, [r7, #32]
|
|
rx.fsk.Bandwidth = g_cfg.fsk_bandwidth;
|
|
800c620: 4b1e ldr r3, [pc, #120] @ (800c69c <App_RadioConfigureRx+0xa0>)
|
|
800c622: 68db ldr r3, [r3, #12]
|
|
800c624: 607b str r3, [r7, #4]
|
|
rx.fsk.BitRate = g_cfg.fsk_bitrate;
|
|
800c626: 4b1d ldr r3, [pc, #116] @ (800c69c <App_RadioConfigureRx+0xa0>)
|
|
800c628: 689b ldr r3, [r3, #8]
|
|
800c62a: 60bb str r3, [r7, #8]
|
|
rx.fsk.PreambleLen = g_cfg.fsk_preamble_len;
|
|
800c62c: 4b1b ldr r3, [pc, #108] @ (800c69c <App_RadioConfigureRx+0xa0>)
|
|
800c62e: 8a9b ldrh r3, [r3, #20]
|
|
800c630: 60fb str r3, [r7, #12]
|
|
rx.fsk.SyncWordLength = RADIO_SYNCWORD_LEN;
|
|
800c632: 2303 movs r3, #3
|
|
800c634: 77bb strb r3, [r7, #30]
|
|
rx.fsk.PreambleMinDetect = RADIO_FSK_PREAMBLE_DETECTOR_08_BITS;
|
|
800c636: 2304 movs r3, #4
|
|
800c638: 77fb strb r3, [r7, #31]
|
|
rx.fsk.SyncWord = g_cfg.syncword;
|
|
800c63a: 4b19 ldr r3, [pc, #100] @ (800c6a0 <App_RadioConfigureRx+0xa4>)
|
|
800c63c: 613b str r3, [r7, #16]
|
|
rx.fsk.whiteSeed = RADIO_WHITENING_SEED;
|
|
800c63e: f240 13ff movw r3, #511 @ 0x1ff
|
|
800c642: 83bb strh r3, [r7, #28]
|
|
rx.fsk.LengthMode = RADIO_FSK_PACKET_VARIABLE_LENGTH;
|
|
800c644: 2301 movs r3, #1
|
|
800c646: f887 3022 strb.w r3, [r7, #34] @ 0x22
|
|
rx.fsk.CrcLength = RADIO_FSK_CRC_2_BYTES_IBM;
|
|
800c64a: 23f1 movs r3, #241 @ 0xf1
|
|
800c64c: f887 3023 strb.w r3, [r7, #35] @ 0x23
|
|
rx.fsk.CrcPolynomial = RADIO_CRC_POLY;
|
|
800c650: f248 0305 movw r3, #32773 @ 0x8005
|
|
800c654: 833b strh r3, [r7, #24]
|
|
rx.fsk.CrcSeed = RADIO_CRC_SEED;
|
|
800c656: f64f 73ff movw r3, #65535 @ 0xffff
|
|
800c65a: 837b strh r3, [r7, #26]
|
|
rx.fsk.Whitening = RADIO_FSK_DC_FREEWHITENING;
|
|
800c65c: 2301 movs r3, #1
|
|
800c65e: f887 3024 strb.w r3, [r7, #36] @ 0x24
|
|
rx.fsk.MaxPayloadLength = RADIO_MAX_PAYLOAD_SIZE;
|
|
800c662: 23dc movs r3, #220 @ 0xdc
|
|
800c664: 617b str r3, [r7, #20]
|
|
rx.fsk.StopTimerOnPreambleDetect = 0;
|
|
800c666: 2300 movs r3, #0
|
|
800c668: 603b str r3, [r7, #0]
|
|
rx.fsk.AddrComp = RADIO_FSK_ADDRESSCOMP_FILT_OFF;
|
|
800c66a: 2300 movs r3, #0
|
|
800c66c: f887 3021 strb.w r3, [r7, #33] @ 0x21
|
|
|
|
Radio.Standby();
|
|
800c670: 4b09 ldr r3, [pc, #36] @ (800c698 <App_RadioConfigureRx+0x9c>)
|
|
800c672: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
800c674: 4798 blx r3
|
|
if (0UL != Radio.RadioSetRxGenericConfig(GENERIC_FSK, &rx, RX_CONTINUOUS_ON, 0U))
|
|
800c676: 4b08 ldr r3, [pc, #32] @ (800c698 <App_RadioConfigureRx+0x9c>)
|
|
800c678: 6f5c ldr r4, [r3, #116] @ 0x74
|
|
800c67a: 4639 mov r1, r7
|
|
800c67c: 2300 movs r3, #0
|
|
800c67e: 2201 movs r2, #1
|
|
800c680: 2000 movs r0, #0
|
|
800c682: 47a0 blx r4
|
|
800c684: 4603 mov r3, r0
|
|
800c686: 2b00 cmp r3, #0
|
|
800c688: d001 beq.n 800c68e <App_RadioConfigureRx+0x92>
|
|
{
|
|
Error_Handler();
|
|
800c68a: f7f4 f8a1 bl 80007d0 <Error_Handler>
|
|
}
|
|
}
|
|
800c68e: bf00 nop
|
|
800c690: 373c adds r7, #60 @ 0x3c
|
|
800c692: 46bd mov sp, r7
|
|
800c694: bd90 pop {r4, r7, pc}
|
|
800c696: bf00 nop
|
|
800c698: 080103c4 .word 0x080103c4
|
|
800c69c: 20000604 .word 0x20000604
|
|
800c6a0: 2000061a .word 0x2000061a
|
|
|
|
0800c6a4 <App_RadioConfigureTx>:
|
|
|
|
static void App_RadioConfigureTx(void)
|
|
{
|
|
800c6a4: b590 push {r4, r7, lr}
|
|
800c6a6: b089 sub sp, #36 @ 0x24
|
|
800c6a8: af00 add r7, sp, #0
|
|
TxConfigGeneric_t tx = {0};
|
|
800c6aa: 1d3b adds r3, r7, #4
|
|
800c6ac: 2200 movs r2, #0
|
|
800c6ae: 601a str r2, [r3, #0]
|
|
800c6b0: 605a str r2, [r3, #4]
|
|
800c6b2: 609a str r2, [r3, #8]
|
|
800c6b4: 60da str r2, [r3, #12]
|
|
800c6b6: 611a str r2, [r3, #16]
|
|
800c6b8: 615a str r2, [r3, #20]
|
|
800c6ba: 619a str r2, [r3, #24]
|
|
|
|
Radio.SetChannel(g_cfg.rf_frequency);
|
|
800c6bc: 4b1c ldr r3, [pc, #112] @ (800c730 <App_RadioConfigureTx+0x8c>)
|
|
800c6be: 68db ldr r3, [r3, #12]
|
|
800c6c0: 4a1c ldr r2, [pc, #112] @ (800c734 <App_RadioConfigureTx+0x90>)
|
|
800c6c2: 6812 ldr r2, [r2, #0]
|
|
800c6c4: 4610 mov r0, r2
|
|
800c6c6: 4798 blx r3
|
|
|
|
tx.fsk.ModulationShaping = RADIO_FSK_MOD_SHAPING_G_BT_05;
|
|
800c6c8: 2309 movs r3, #9
|
|
800c6ca: 75fb strb r3, [r7, #23]
|
|
tx.fsk.FrequencyDeviation = g_cfg.fsk_fdev;
|
|
800c6cc: 4b19 ldr r3, [pc, #100] @ (800c734 <App_RadioConfigureTx+0x90>)
|
|
800c6ce: 691b ldr r3, [r3, #16]
|
|
800c6d0: 61fb str r3, [r7, #28]
|
|
tx.fsk.BitRate = g_cfg.fsk_bitrate;
|
|
800c6d2: 4b18 ldr r3, [pc, #96] @ (800c734 <App_RadioConfigureTx+0x90>)
|
|
800c6d4: 689b ldr r3, [r3, #8]
|
|
800c6d6: 607b str r3, [r7, #4]
|
|
tx.fsk.PreambleLen = g_cfg.fsk_preamble_len;
|
|
800c6d8: 4b16 ldr r3, [pc, #88] @ (800c734 <App_RadioConfigureTx+0x90>)
|
|
800c6da: 8a9b ldrh r3, [r3, #20]
|
|
800c6dc: 60bb str r3, [r7, #8]
|
|
tx.fsk.SyncWordLength = RADIO_SYNCWORD_LEN;
|
|
800c6de: 2303 movs r3, #3
|
|
800c6e0: 75bb strb r3, [r7, #22]
|
|
tx.fsk.SyncWord = g_cfg.syncword;
|
|
800c6e2: 4b15 ldr r3, [pc, #84] @ (800c738 <App_RadioConfigureTx+0x94>)
|
|
800c6e4: 60fb str r3, [r7, #12]
|
|
tx.fsk.whiteSeed = RADIO_WHITENING_SEED;
|
|
800c6e6: f240 13ff movw r3, #511 @ 0x1ff
|
|
800c6ea: 82bb strh r3, [r7, #20]
|
|
tx.fsk.HeaderType = RADIO_FSK_PACKET_VARIABLE_LENGTH;
|
|
800c6ec: 2301 movs r3, #1
|
|
800c6ee: 763b strb r3, [r7, #24]
|
|
tx.fsk.CrcLength = RADIO_FSK_CRC_2_BYTES_IBM;
|
|
800c6f0: 23f1 movs r3, #241 @ 0xf1
|
|
800c6f2: 767b strb r3, [r7, #25]
|
|
tx.fsk.CrcPolynomial = RADIO_CRC_POLY;
|
|
800c6f4: f248 0305 movw r3, #32773 @ 0x8005
|
|
800c6f8: 823b strh r3, [r7, #16]
|
|
tx.fsk.CrcSeed = RADIO_CRC_SEED;
|
|
800c6fa: f64f 73ff movw r3, #65535 @ 0xffff
|
|
800c6fe: 827b strh r3, [r7, #18]
|
|
tx.fsk.Whitening = RADIO_FSK_DC_FREEWHITENING;
|
|
800c700: 2301 movs r3, #1
|
|
800c702: 76bb strb r3, [r7, #26]
|
|
|
|
Radio.Standby();
|
|
800c704: 4b0a ldr r3, [pc, #40] @ (800c730 <App_RadioConfigureTx+0x8c>)
|
|
800c706: 6b1b ldr r3, [r3, #48] @ 0x30
|
|
800c708: 4798 blx r3
|
|
if (0UL != Radio.RadioSetTxGenericConfig(GENERIC_FSK, &tx, g_cfg.tx_power, TX_TIMEOUT_VALUE_MS))
|
|
800c70a: 4b09 ldr r3, [pc, #36] @ (800c730 <App_RadioConfigureTx+0x8c>)
|
|
800c70c: 6f9c ldr r4, [r3, #120] @ 0x78
|
|
800c70e: 4b09 ldr r3, [pc, #36] @ (800c734 <App_RadioConfigureTx+0x90>)
|
|
800c710: f993 2004 ldrsb.w r2, [r3, #4]
|
|
800c714: 1d39 adds r1, r7, #4
|
|
800c716: f640 33b8 movw r3, #3000 @ 0xbb8
|
|
800c71a: 2000 movs r0, #0
|
|
800c71c: 47a0 blx r4
|
|
800c71e: 4603 mov r3, r0
|
|
800c720: 2b00 cmp r3, #0
|
|
800c722: d001 beq.n 800c728 <App_RadioConfigureTx+0x84>
|
|
{
|
|
Error_Handler();
|
|
800c724: f7f4 f854 bl 80007d0 <Error_Handler>
|
|
}
|
|
}
|
|
800c728: bf00 nop
|
|
800c72a: 3724 adds r7, #36 @ 0x24
|
|
800c72c: 46bd mov sp, r7
|
|
800c72e: bd90 pop {r4, r7, pc}
|
|
800c730: 080103c4 .word 0x080103c4
|
|
800c734: 20000604 .word 0x20000604
|
|
800c738: 2000061a .word 0x2000061a
|
|
|
|
0800c73c <App_RadioEnterRx>:
|
|
|
|
static void App_RadioEnterRx(void)
|
|
{
|
|
800c73c: b580 push {r7, lr}
|
|
800c73e: af00 add r7, sp, #0
|
|
App_RadioConfigureRx();
|
|
800c740: f7ff ff5c bl 800c5fc <App_RadioConfigureRx>
|
|
Radio.Rx(RX_TIMEOUT_VALUE_MS);
|
|
800c744: 4b02 ldr r3, [pc, #8] @ (800c750 <App_RadioEnterRx+0x14>)
|
|
800c746: 6b5b ldr r3, [r3, #52] @ 0x34
|
|
800c748: 2000 movs r0, #0
|
|
800c74a: 4798 blx r3
|
|
}
|
|
800c74c: bf00 nop
|
|
800c74e: bd80 pop {r7, pc}
|
|
800c750: 080103c4 .word 0x080103c4
|
|
|
|
0800c754 <App_EnterConfigMode>:
|
|
|
|
static void App_EnterConfigMode(void)
|
|
{
|
|
800c754: b580 push {r7, lr}
|
|
800c756: af00 add r7, sp, #0
|
|
App_ResetDataPath();
|
|
800c758: f000 f846 bl 800c7e8 <App_ResetDataPath>
|
|
g_mode = APP_MODE_CONFIG;
|
|
800c75c: 4b0f ldr r3, [pc, #60] @ (800c79c <App_EnterConfigMode+0x48>)
|
|
800c75e: 2201 movs r2, #1
|
|
800c760: 701a strb r2, [r3, #0]
|
|
App_Printf("\r\n\r\n[CONFIG MODE]\r\n");
|
|
800c762: 480f ldr r0, [pc, #60] @ (800c7a0 <App_EnterConfigMode+0x4c>)
|
|
800c764: f000 fd56 bl 800d214 <App_Printf>
|
|
App_Printf("type 'help' for commands\r\n");
|
|
800c768: 480e ldr r0, [pc, #56] @ (800c7a4 <App_EnterConfigMode+0x50>)
|
|
800c76a: f000 fd53 bl 800d214 <App_Printf>
|
|
if (!Config_Load(&g_cfg))
|
|
800c76e: 480e ldr r0, [pc, #56] @ (800c7a8 <App_EnterConfigMode+0x54>)
|
|
800c770: f000 ffbc bl 800d6ec <Config_Load>
|
|
800c774: 4603 mov r3, r0
|
|
800c776: f083 0301 eor.w r3, r3, #1
|
|
800c77a: b2db uxtb r3, r3
|
|
800c77c: 2b00 cmp r3, #0
|
|
800c77e: d008 beq.n 800c792 <App_EnterConfigMode+0x3e>
|
|
{
|
|
App_Printf("Error while loading cnf\r\n");
|
|
800c780: 480a ldr r0, [pc, #40] @ (800c7ac <App_EnterConfigMode+0x58>)
|
|
800c782: f000 fd47 bl 800d214 <App_Printf>
|
|
App_Printf("Cnf was reset to defaults\r\n");
|
|
800c786: 480a ldr r0, [pc, #40] @ (800c7b0 <App_EnterConfigMode+0x5c>)
|
|
800c788: f000 fd44 bl 800d214 <App_Printf>
|
|
Config_LoadDefaults(&g_cfg);
|
|
800c78c: 4806 ldr r0, [pc, #24] @ (800c7a8 <App_EnterConfigMode+0x54>)
|
|
800c78e: f000 ff59 bl 800d644 <Config_LoadDefaults>
|
|
|
|
}
|
|
App_PrintConfigPrompt();
|
|
800c792: f000 fc25 bl 800cfe0 <App_PrintConfigPrompt>
|
|
}
|
|
800c796: bf00 nop
|
|
800c798: bd80 pop {r7, pc}
|
|
800c79a: bf00 nop
|
|
800c79c: 20000b90 .word 0x20000b90
|
|
800c7a0: 0800fb68 .word 0x0800fb68
|
|
800c7a4: 0800fb7c .word 0x0800fb7c
|
|
800c7a8: 20000604 .word 0x20000604
|
|
800c7ac: 0800fb98 .word 0x0800fb98
|
|
800c7b0: 0800fbb4 .word 0x0800fbb4
|
|
|
|
0800c7b4 <App_ExitConfigMode>:
|
|
|
|
static void App_ExitConfigMode(void)
|
|
{
|
|
800c7b4: b580 push {r7, lr}
|
|
800c7b6: af00 add r7, sp, #0
|
|
g_cfg_line_len = 0U;
|
|
800c7b8: 4b07 ldr r3, [pc, #28] @ (800c7d8 <App_ExitConfigMode+0x24>)
|
|
800c7ba: 2200 movs r2, #0
|
|
800c7bc: 801a strh r2, [r3, #0]
|
|
App_ResetDataPath();
|
|
800c7be: f000 f813 bl 800c7e8 <App_ResetDataPath>
|
|
g_mode = APP_MODE_DATA;
|
|
800c7c2: 4b06 ldr r3, [pc, #24] @ (800c7dc <App_ExitConfigMode+0x28>)
|
|
800c7c4: 2200 movs r2, #0
|
|
800c7c6: 701a strb r2, [r3, #0]
|
|
App_Printf("\r\n[DATA MODE]\r\n");
|
|
800c7c8: 4805 ldr r0, [pc, #20] @ (800c7e0 <App_ExitConfigMode+0x2c>)
|
|
800c7ca: f000 fd23 bl 800d214 <App_Printf>
|
|
g_radio_needs_rx_restart = 1U;
|
|
800c7ce: 4b05 ldr r3, [pc, #20] @ (800c7e4 <App_ExitConfigMode+0x30>)
|
|
800c7d0: 2201 movs r2, #1
|
|
800c7d2: 701a strb r2, [r3, #0]
|
|
}
|
|
800c7d4: bf00 nop
|
|
800c7d6: bd80 pop {r7, pc}
|
|
800c7d8: 20000bf4 .word 0x20000bf4
|
|
800c7dc: 20000b90 .word 0x20000b90
|
|
800c7e0: 0800fbd0 .word 0x0800fbd0
|
|
800c7e4: 20000640 .word 0x20000640
|
|
|
|
0800c7e8 <App_ResetDataPath>:
|
|
|
|
static void App_ResetDataPath(void)
|
|
{
|
|
800c7e8: b480 push {r7}
|
|
800c7ea: af00 add r7, sp, #0
|
|
g_uart_build_len = 0U;
|
|
800c7ec: 4b0a ldr r3, [pc, #40] @ (800c818 <App_ResetDataPath+0x30>)
|
|
800c7ee: 2200 movs r2, #0
|
|
800c7f0: 801a strh r2, [r3, #0]
|
|
g_escape.active = 0U;
|
|
800c7f2: 4b0a ldr r3, [pc, #40] @ (800c81c <App_ResetDataPath+0x34>)
|
|
800c7f4: 2200 movs r2, #0
|
|
800c7f6: 701a strb r2, [r3, #0]
|
|
g_escape.count = 0U;
|
|
800c7f8: 4b08 ldr r3, [pc, #32] @ (800c81c <App_ResetDataPath+0x34>)
|
|
800c7fa: 2200 movs r2, #0
|
|
800c7fc: 705a strb r2, [r3, #1]
|
|
g_tx_q_head = 0U;
|
|
800c7fe: 4b08 ldr r3, [pc, #32] @ (800c820 <App_ResetDataPath+0x38>)
|
|
800c800: 2200 movs r2, #0
|
|
800c802: 701a strb r2, [r3, #0]
|
|
g_tx_q_tail = 0U;
|
|
800c804: 4b07 ldr r3, [pc, #28] @ (800c824 <App_ResetDataPath+0x3c>)
|
|
800c806: 2200 movs r2, #0
|
|
800c808: 701a strb r2, [r3, #0]
|
|
g_tx_q_count = 0U;
|
|
800c80a: 4b07 ldr r3, [pc, #28] @ (800c828 <App_ResetDataPath+0x40>)
|
|
800c80c: 2200 movs r2, #0
|
|
800c80e: 701a strb r2, [r3, #0]
|
|
}
|
|
800c810: bf00 nop
|
|
800c812: 46bd mov sp, r7
|
|
800c814: bc80 pop {r7}
|
|
800c816: 4770 bx lr
|
|
800c818: 20000b78 .word 0x20000b78
|
|
800c81c: 20000b80 .word 0x20000b80
|
|
800c820: 20000a98 .word 0x20000a98
|
|
800c824: 20000a99 .word 0x20000a99
|
|
800c828: 20000a9a .word 0x20000a9a
|
|
|
|
0800c82c <App_DataModeFeedByte>:
|
|
|
|
static void App_DataModeFeedByte(uint8_t ch, uint32_t now)
|
|
{
|
|
800c82c: b580 push {r7, lr}
|
|
800c82e: b082 sub sp, #8
|
|
800c830: af00 add r7, sp, #0
|
|
800c832: 4603 mov r3, r0
|
|
800c834: 6039 str r1, [r7, #0]
|
|
800c836: 71fb strb r3, [r7, #7]
|
|
if (g_uart_build_len < UART_DATA_BUFFER_SIZE)
|
|
800c838: 4b19 ldr r3, [pc, #100] @ (800c8a0 <App_DataModeFeedByte+0x74>)
|
|
800c83a: 881b ldrh r3, [r3, #0]
|
|
800c83c: 2bdb cmp r3, #219 @ 0xdb
|
|
800c83e: d812 bhi.n 800c866 <App_DataModeFeedByte+0x3a>
|
|
{
|
|
g_uart_build_buf[g_uart_build_len++] = ch;
|
|
800c840: 4b17 ldr r3, [pc, #92] @ (800c8a0 <App_DataModeFeedByte+0x74>)
|
|
800c842: 881b ldrh r3, [r3, #0]
|
|
800c844: 1c5a adds r2, r3, #1
|
|
800c846: b291 uxth r1, r2
|
|
800c848: 4a15 ldr r2, [pc, #84] @ (800c8a0 <App_DataModeFeedByte+0x74>)
|
|
800c84a: 8011 strh r1, [r2, #0]
|
|
800c84c: 4619 mov r1, r3
|
|
800c84e: 4a15 ldr r2, [pc, #84] @ (800c8a4 <App_DataModeFeedByte+0x78>)
|
|
800c850: 79fb ldrb r3, [r7, #7]
|
|
800c852: 5453 strb r3, [r2, r1]
|
|
g_uart_last_data_tick = now;
|
|
800c854: 4a14 ldr r2, [pc, #80] @ (800c8a8 <App_DataModeFeedByte+0x7c>)
|
|
800c856: 683b ldr r3, [r7, #0]
|
|
800c858: 6013 str r3, [r2, #0]
|
|
g_stat_uart_bytes_tx++;
|
|
800c85a: 4b14 ldr r3, [pc, #80] @ (800c8ac <App_DataModeFeedByte+0x80>)
|
|
800c85c: 681b ldr r3, [r3, #0]
|
|
800c85e: 3301 adds r3, #1
|
|
800c860: 4a12 ldr r2, [pc, #72] @ (800c8ac <App_DataModeFeedByte+0x80>)
|
|
800c862: 6013 str r3, [r2, #0]
|
|
g_uart_build_buf[g_uart_build_len++] = ch;
|
|
g_uart_last_data_tick = now;
|
|
g_stat_uart_bytes_tx++;
|
|
}
|
|
}
|
|
}
|
|
800c864: e017 b.n 800c896 <App_DataModeFeedByte+0x6a>
|
|
App_DataModeFlushBuilder();
|
|
800c866: f000 f823 bl 800c8b0 <App_DataModeFlushBuilder>
|
|
if (g_uart_build_len < UART_DATA_BUFFER_SIZE)
|
|
800c86a: 4b0d ldr r3, [pc, #52] @ (800c8a0 <App_DataModeFeedByte+0x74>)
|
|
800c86c: 881b ldrh r3, [r3, #0]
|
|
800c86e: 2bdb cmp r3, #219 @ 0xdb
|
|
800c870: d811 bhi.n 800c896 <App_DataModeFeedByte+0x6a>
|
|
g_uart_build_buf[g_uart_build_len++] = ch;
|
|
800c872: 4b0b ldr r3, [pc, #44] @ (800c8a0 <App_DataModeFeedByte+0x74>)
|
|
800c874: 881b ldrh r3, [r3, #0]
|
|
800c876: 1c5a adds r2, r3, #1
|
|
800c878: b291 uxth r1, r2
|
|
800c87a: 4a09 ldr r2, [pc, #36] @ (800c8a0 <App_DataModeFeedByte+0x74>)
|
|
800c87c: 8011 strh r1, [r2, #0]
|
|
800c87e: 4619 mov r1, r3
|
|
800c880: 4a08 ldr r2, [pc, #32] @ (800c8a4 <App_DataModeFeedByte+0x78>)
|
|
800c882: 79fb ldrb r3, [r7, #7]
|
|
800c884: 5453 strb r3, [r2, r1]
|
|
g_uart_last_data_tick = now;
|
|
800c886: 4a08 ldr r2, [pc, #32] @ (800c8a8 <App_DataModeFeedByte+0x7c>)
|
|
800c888: 683b ldr r3, [r7, #0]
|
|
800c88a: 6013 str r3, [r2, #0]
|
|
g_stat_uart_bytes_tx++;
|
|
800c88c: 4b07 ldr r3, [pc, #28] @ (800c8ac <App_DataModeFeedByte+0x80>)
|
|
800c88e: 681b ldr r3, [r3, #0]
|
|
800c890: 3301 adds r3, #1
|
|
800c892: 4a06 ldr r2, [pc, #24] @ (800c8ac <App_DataModeFeedByte+0x80>)
|
|
800c894: 6013 str r3, [r2, #0]
|
|
}
|
|
800c896: bf00 nop
|
|
800c898: 3708 adds r7, #8
|
|
800c89a: 46bd mov sp, r7
|
|
800c89c: bd80 pop {r7, pc}
|
|
800c89e: bf00 nop
|
|
800c8a0: 20000b78 .word 0x20000b78
|
|
800c8a4: 20000a9c .word 0x20000a9c
|
|
800c8a8: 20000b7c .word 0x20000b7c
|
|
800c8ac: 20000bfc .word 0x20000bfc
|
|
|
|
0800c8b0 <App_DataModeFlushBuilder>:
|
|
|
|
static void App_DataModeFlushBuilder(void)
|
|
{
|
|
800c8b0: b580 push {r7, lr}
|
|
800c8b2: af00 add r7, sp, #0
|
|
if (g_uart_build_len == 0U)
|
|
800c8b4: 4b0b ldr r3, [pc, #44] @ (800c8e4 <App_DataModeFlushBuilder+0x34>)
|
|
800c8b6: 881b ldrh r3, [r3, #0]
|
|
800c8b8: 2b00 cmp r3, #0
|
|
800c8ba: d011 beq.n 800c8e0 <App_DataModeFlushBuilder+0x30>
|
|
{
|
|
return;
|
|
}
|
|
|
|
if (App_QueuePush(g_uart_build_buf, g_uart_build_len) == 0U)
|
|
800c8bc: 4b09 ldr r3, [pc, #36] @ (800c8e4 <App_DataModeFlushBuilder+0x34>)
|
|
800c8be: 881b ldrh r3, [r3, #0]
|
|
800c8c0: 4619 mov r1, r3
|
|
800c8c2: 4809 ldr r0, [pc, #36] @ (800c8e8 <App_DataModeFlushBuilder+0x38>)
|
|
800c8c4: f000 f814 bl 800c8f0 <App_QueuePush>
|
|
800c8c8: 4603 mov r3, r0
|
|
800c8ca: 2b00 cmp r3, #0
|
|
800c8cc: d104 bne.n 800c8d8 <App_DataModeFlushBuilder+0x28>
|
|
{
|
|
g_stat_queue_overflow++;
|
|
800c8ce: 4b07 ldr r3, [pc, #28] @ (800c8ec <App_DataModeFlushBuilder+0x3c>)
|
|
800c8d0: 681b ldr r3, [r3, #0]
|
|
800c8d2: 3301 adds r3, #1
|
|
800c8d4: 4a05 ldr r2, [pc, #20] @ (800c8ec <App_DataModeFlushBuilder+0x3c>)
|
|
800c8d6: 6013 str r3, [r2, #0]
|
|
}
|
|
g_uart_build_len = 0U;
|
|
800c8d8: 4b02 ldr r3, [pc, #8] @ (800c8e4 <App_DataModeFlushBuilder+0x34>)
|
|
800c8da: 2200 movs r2, #0
|
|
800c8dc: 801a strh r2, [r3, #0]
|
|
800c8de: e000 b.n 800c8e2 <App_DataModeFlushBuilder+0x32>
|
|
return;
|
|
800c8e0: bf00 nop
|
|
}
|
|
800c8e2: bd80 pop {r7, pc}
|
|
800c8e4: 20000b78 .word 0x20000b78
|
|
800c8e8: 20000a9c .word 0x20000a9c
|
|
800c8ec: 20000c08 .word 0x20000c08
|
|
|
|
0800c8f0 <App_QueuePush>:
|
|
|
|
static uint8_t App_QueuePush(const uint8_t *data, uint16_t len)
|
|
{
|
|
800c8f0: b580 push {r7, lr}
|
|
800c8f2: b082 sub sp, #8
|
|
800c8f4: af00 add r7, sp, #0
|
|
800c8f6: 6078 str r0, [r7, #4]
|
|
800c8f8: 460b mov r3, r1
|
|
800c8fa: 807b strh r3, [r7, #2]
|
|
if ((len == 0U) || (len > RADIO_MAX_PAYLOAD_SIZE) || (g_tx_q_count >= TX_QUEUE_DEPTH))
|
|
800c8fc: 887b ldrh r3, [r7, #2]
|
|
800c8fe: 2b00 cmp r3, #0
|
|
800c900: d006 beq.n 800c910 <App_QueuePush+0x20>
|
|
800c902: 887b ldrh r3, [r7, #2]
|
|
800c904: 2bdc cmp r3, #220 @ 0xdc
|
|
800c906: d803 bhi.n 800c910 <App_QueuePush+0x20>
|
|
800c908: 4b19 ldr r3, [pc, #100] @ (800c970 <App_QueuePush+0x80>)
|
|
800c90a: 781b ldrb r3, [r3, #0]
|
|
800c90c: 2b03 cmp r3, #3
|
|
800c90e: d901 bls.n 800c914 <App_QueuePush+0x24>
|
|
{
|
|
return 0U;
|
|
800c910: 2300 movs r3, #0
|
|
800c912: e029 b.n 800c968 <App_QueuePush+0x78>
|
|
}
|
|
|
|
memcpy(g_tx_queue[g_tx_q_tail].data, data, len);
|
|
800c914: 4b17 ldr r3, [pc, #92] @ (800c974 <App_QueuePush+0x84>)
|
|
800c916: 781b ldrb r3, [r3, #0]
|
|
800c918: 461a mov r2, r3
|
|
800c91a: 23dd movs r3, #221 @ 0xdd
|
|
800c91c: fb02 f303 mul.w r3, r2, r3
|
|
800c920: 4a15 ldr r2, [pc, #84] @ (800c978 <App_QueuePush+0x88>)
|
|
800c922: 4413 add r3, r2
|
|
800c924: 887a ldrh r2, [r7, #2]
|
|
800c926: 6879 ldr r1, [r7, #4]
|
|
800c928: 4618 mov r0, r3
|
|
800c92a: f002 fb55 bl 800efd8 <memcpy>
|
|
g_tx_queue[g_tx_q_tail].len = (uint8_t)len;
|
|
800c92e: 4b11 ldr r3, [pc, #68] @ (800c974 <App_QueuePush+0x84>)
|
|
800c930: 781b ldrb r3, [r3, #0]
|
|
800c932: 4618 mov r0, r3
|
|
800c934: 887b ldrh r3, [r7, #2]
|
|
800c936: b2d9 uxtb r1, r3
|
|
800c938: 4a0f ldr r2, [pc, #60] @ (800c978 <App_QueuePush+0x88>)
|
|
800c93a: 23dd movs r3, #221 @ 0xdd
|
|
800c93c: fb00 f303 mul.w r3, r0, r3
|
|
800c940: 4413 add r3, r2
|
|
800c942: 33dc adds r3, #220 @ 0xdc
|
|
800c944: 460a mov r2, r1
|
|
800c946: 701a strb r2, [r3, #0]
|
|
g_tx_q_tail = (uint8_t)((g_tx_q_tail + 1U) % TX_QUEUE_DEPTH);
|
|
800c948: 4b0a ldr r3, [pc, #40] @ (800c974 <App_QueuePush+0x84>)
|
|
800c94a: 781b ldrb r3, [r3, #0]
|
|
800c94c: 3301 adds r3, #1
|
|
800c94e: b2db uxtb r3, r3
|
|
800c950: f003 0303 and.w r3, r3, #3
|
|
800c954: b2da uxtb r2, r3
|
|
800c956: 4b07 ldr r3, [pc, #28] @ (800c974 <App_QueuePush+0x84>)
|
|
800c958: 701a strb r2, [r3, #0]
|
|
g_tx_q_count++;
|
|
800c95a: 4b05 ldr r3, [pc, #20] @ (800c970 <App_QueuePush+0x80>)
|
|
800c95c: 781b ldrb r3, [r3, #0]
|
|
800c95e: 3301 adds r3, #1
|
|
800c960: b2da uxtb r2, r3
|
|
800c962: 4b03 ldr r3, [pc, #12] @ (800c970 <App_QueuePush+0x80>)
|
|
800c964: 701a strb r2, [r3, #0]
|
|
return 1U;
|
|
800c966: 2301 movs r3, #1
|
|
}
|
|
800c968: 4618 mov r0, r3
|
|
800c96a: 3708 adds r7, #8
|
|
800c96c: 46bd mov sp, r7
|
|
800c96e: bd80 pop {r7, pc}
|
|
800c970: 20000a9a .word 0x20000a9a
|
|
800c974: 20000a99 .word 0x20000a99
|
|
800c978: 20000724 .word 0x20000724
|
|
|
|
0800c97c <App_QueuePop>:
|
|
|
|
static void App_QueuePop(void)
|
|
{
|
|
800c97c: b480 push {r7}
|
|
800c97e: af00 add r7, sp, #0
|
|
if (g_tx_q_count == 0U)
|
|
800c980: 4b0b ldr r3, [pc, #44] @ (800c9b0 <App_QueuePop+0x34>)
|
|
800c982: 781b ldrb r3, [r3, #0]
|
|
800c984: 2b00 cmp r3, #0
|
|
800c986: d00f beq.n 800c9a8 <App_QueuePop+0x2c>
|
|
{
|
|
return;
|
|
}
|
|
|
|
g_tx_q_head = (uint8_t)((g_tx_q_head + 1U) % TX_QUEUE_DEPTH);
|
|
800c988: 4b0a ldr r3, [pc, #40] @ (800c9b4 <App_QueuePop+0x38>)
|
|
800c98a: 781b ldrb r3, [r3, #0]
|
|
800c98c: 3301 adds r3, #1
|
|
800c98e: b2db uxtb r3, r3
|
|
800c990: f003 0303 and.w r3, r3, #3
|
|
800c994: b2da uxtb r2, r3
|
|
800c996: 4b07 ldr r3, [pc, #28] @ (800c9b4 <App_QueuePop+0x38>)
|
|
800c998: 701a strb r2, [r3, #0]
|
|
g_tx_q_count--;
|
|
800c99a: 4b05 ldr r3, [pc, #20] @ (800c9b0 <App_QueuePop+0x34>)
|
|
800c99c: 781b ldrb r3, [r3, #0]
|
|
800c99e: 3b01 subs r3, #1
|
|
800c9a0: b2da uxtb r2, r3
|
|
800c9a2: 4b03 ldr r3, [pc, #12] @ (800c9b0 <App_QueuePop+0x34>)
|
|
800c9a4: 701a strb r2, [r3, #0]
|
|
800c9a6: e000 b.n 800c9aa <App_QueuePop+0x2e>
|
|
return;
|
|
800c9a8: bf00 nop
|
|
}
|
|
800c9aa: 46bd mov sp, r7
|
|
800c9ac: bc80 pop {r7}
|
|
800c9ae: 4770 bx lr
|
|
800c9b0: 20000a9a .word 0x20000a9a
|
|
800c9b4: 20000a98 .word 0x20000a98
|
|
|
|
0800c9b8 <UartRxByteCallback>:
|
|
|
|
static void UartRxByteCallback(uint8_t *rxChar, uint16_t size, uint8_t error)
|
|
{
|
|
800c9b8: b580 push {r7, lr}
|
|
800c9ba: b084 sub sp, #16
|
|
800c9bc: af00 add r7, sp, #0
|
|
800c9be: 6078 str r0, [r7, #4]
|
|
800c9c0: 460b mov r3, r1
|
|
800c9c2: 807b strh r3, [r7, #2]
|
|
800c9c4: 4613 mov r3, r2
|
|
800c9c6: 707b strb r3, [r7, #1]
|
|
uint8_t ch;
|
|
uint32_t now;
|
|
uint8_t i;
|
|
|
|
if ((error != 0U) || (size == 0U) || (rxChar == NULL))
|
|
800c9c8: 787b ldrb r3, [r7, #1]
|
|
800c9ca: 2b00 cmp r3, #0
|
|
800c9cc: f040 808a bne.w 800cae4 <UartRxByteCallback+0x12c>
|
|
800c9d0: 887b ldrh r3, [r7, #2]
|
|
800c9d2: 2b00 cmp r3, #0
|
|
800c9d4: f000 8086 beq.w 800cae4 <UartRxByteCallback+0x12c>
|
|
800c9d8: 687b ldr r3, [r7, #4]
|
|
800c9da: 2b00 cmp r3, #0
|
|
800c9dc: f000 8082 beq.w 800cae4 <UartRxByteCallback+0x12c>
|
|
{
|
|
return;
|
|
}
|
|
|
|
ch = rxChar[0];
|
|
800c9e0: 687b ldr r3, [r7, #4]
|
|
800c9e2: 781b ldrb r3, [r3, #0]
|
|
800c9e4: 73bb strb r3, [r7, #14]
|
|
now = HAL_GetTick();
|
|
800c9e6: f7f4 f92f bl 8000c48 <HAL_GetTick>
|
|
800c9ea: 60b8 str r0, [r7, #8]
|
|
|
|
if (g_mode == APP_MODE_CONFIG)
|
|
800c9ec: 4b3f ldr r3, [pc, #252] @ (800caec <UartRxByteCallback+0x134>)
|
|
800c9ee: 781b ldrb r3, [r3, #0]
|
|
800c9f0: 2b01 cmp r3, #1
|
|
800c9f2: d104 bne.n 800c9fe <UartRxByteCallback+0x46>
|
|
{
|
|
App_ConfigFeedByte(ch);
|
|
800c9f4: 7bbb ldrb r3, [r7, #14]
|
|
800c9f6: 4618 mov r0, r3
|
|
800c9f8: f000 f87e bl 800caf8 <App_ConfigFeedByte>
|
|
return;
|
|
800c9fc: e073 b.n 800cae6 <UartRxByteCallback+0x12e>
|
|
}
|
|
|
|
if (g_escape.active == 0U)
|
|
800c9fe: 4b3c ldr r3, [pc, #240] @ (800caf0 <UartRxByteCallback+0x138>)
|
|
800ca00: 781b ldrb r3, [r3, #0]
|
|
800ca02: 2b00 cmp r3, #0
|
|
800ca04: d11f bne.n 800ca46 <UartRxByteCallback+0x8e>
|
|
{
|
|
if (((now - g_uart_last_data_tick) >= CONFIG_ESCAPE_GUARD_MS) && (ch == '+'))
|
|
800ca06: 4b3b ldr r3, [pc, #236] @ (800caf4 <UartRxByteCallback+0x13c>)
|
|
800ca08: 681b ldr r3, [r3, #0]
|
|
800ca0a: 68ba ldr r2, [r7, #8]
|
|
800ca0c: 1ad3 subs r3, r2, r3
|
|
800ca0e: f5b3 7f48 cmp.w r3, #800 @ 0x320
|
|
800ca12: d312 bcc.n 800ca3a <UartRxByteCallback+0x82>
|
|
800ca14: 7bbb ldrb r3, [r7, #14]
|
|
800ca16: 2b2b cmp r3, #43 @ 0x2b
|
|
800ca18: d10f bne.n 800ca3a <UartRxByteCallback+0x82>
|
|
{
|
|
g_escape.active = 1U;
|
|
800ca1a: 4b35 ldr r3, [pc, #212] @ (800caf0 <UartRxByteCallback+0x138>)
|
|
800ca1c: 2201 movs r2, #1
|
|
800ca1e: 701a strb r2, [r3, #0]
|
|
g_escape.count = 1U;
|
|
800ca20: 4b33 ldr r3, [pc, #204] @ (800caf0 <UartRxByteCallback+0x138>)
|
|
800ca22: 2201 movs r2, #1
|
|
800ca24: 705a strb r2, [r3, #1]
|
|
g_escape.bytes[0] = ch;
|
|
800ca26: 4a32 ldr r2, [pc, #200] @ (800caf0 <UartRxByteCallback+0x138>)
|
|
800ca28: 7bbb ldrb r3, [r7, #14]
|
|
800ca2a: 7093 strb r3, [r2, #2]
|
|
g_escape.start_tick = now;
|
|
800ca2c: 4a30 ldr r2, [pc, #192] @ (800caf0 <UartRxByteCallback+0x138>)
|
|
800ca2e: 68bb ldr r3, [r7, #8]
|
|
800ca30: 6093 str r3, [r2, #8]
|
|
g_escape.last_tick = now;
|
|
800ca32: 4a2f ldr r2, [pc, #188] @ (800caf0 <UartRxByteCallback+0x138>)
|
|
800ca34: 68bb ldr r3, [r7, #8]
|
|
800ca36: 60d3 str r3, [r2, #12]
|
|
return;
|
|
800ca38: e055 b.n 800cae6 <UartRxByteCallback+0x12e>
|
|
}
|
|
|
|
App_DataModeFeedByte(ch, now);
|
|
800ca3a: 7bbb ldrb r3, [r7, #14]
|
|
800ca3c: 68b9 ldr r1, [r7, #8]
|
|
800ca3e: 4618 mov r0, r3
|
|
800ca40: f7ff fef4 bl 800c82c <App_DataModeFeedByte>
|
|
return;
|
|
800ca44: e04f b.n 800cae6 <UartRxByteCallback+0x12e>
|
|
}
|
|
|
|
if ((ch == '+') && (g_escape.count < 3U))
|
|
800ca46: 7bbb ldrb r3, [r7, #14]
|
|
800ca48: 2b2b cmp r3, #43 @ 0x2b
|
|
800ca4a: d112 bne.n 800ca72 <UartRxByteCallback+0xba>
|
|
800ca4c: 4b28 ldr r3, [pc, #160] @ (800caf0 <UartRxByteCallback+0x138>)
|
|
800ca4e: 785b ldrb r3, [r3, #1]
|
|
800ca50: 2b02 cmp r3, #2
|
|
800ca52: d80e bhi.n 800ca72 <UartRxByteCallback+0xba>
|
|
{
|
|
g_escape.bytes[g_escape.count++] = ch;
|
|
800ca54: 4b26 ldr r3, [pc, #152] @ (800caf0 <UartRxByteCallback+0x138>)
|
|
800ca56: 785b ldrb r3, [r3, #1]
|
|
800ca58: 1c5a adds r2, r3, #1
|
|
800ca5a: b2d1 uxtb r1, r2
|
|
800ca5c: 4a24 ldr r2, [pc, #144] @ (800caf0 <UartRxByteCallback+0x138>)
|
|
800ca5e: 7051 strb r1, [r2, #1]
|
|
800ca60: 461a mov r2, r3
|
|
800ca62: 4b23 ldr r3, [pc, #140] @ (800caf0 <UartRxByteCallback+0x138>)
|
|
800ca64: 4413 add r3, r2
|
|
800ca66: 7bba ldrb r2, [r7, #14]
|
|
800ca68: 709a strb r2, [r3, #2]
|
|
g_escape.last_tick = now;
|
|
800ca6a: 4a21 ldr r2, [pc, #132] @ (800caf0 <UartRxByteCallback+0x138>)
|
|
800ca6c: 68bb ldr r3, [r7, #8]
|
|
800ca6e: 60d3 str r3, [r2, #12]
|
|
return;
|
|
800ca70: e039 b.n 800cae6 <UartRxByteCallback+0x12e>
|
|
}
|
|
|
|
for (i = 0U; i < g_escape.count; i++)
|
|
800ca72: 2300 movs r3, #0
|
|
800ca74: 73fb strb r3, [r7, #15]
|
|
800ca76: e00a b.n 800ca8e <UartRxByteCallback+0xd6>
|
|
{
|
|
App_DataModeFeedByte(g_escape.bytes[i], now);
|
|
800ca78: 7bfb ldrb r3, [r7, #15]
|
|
800ca7a: 4a1d ldr r2, [pc, #116] @ (800caf0 <UartRxByteCallback+0x138>)
|
|
800ca7c: 4413 add r3, r2
|
|
800ca7e: 789b ldrb r3, [r3, #2]
|
|
800ca80: 68b9 ldr r1, [r7, #8]
|
|
800ca82: 4618 mov r0, r3
|
|
800ca84: f7ff fed2 bl 800c82c <App_DataModeFeedByte>
|
|
for (i = 0U; i < g_escape.count; i++)
|
|
800ca88: 7bfb ldrb r3, [r7, #15]
|
|
800ca8a: 3301 adds r3, #1
|
|
800ca8c: 73fb strb r3, [r7, #15]
|
|
800ca8e: 4b18 ldr r3, [pc, #96] @ (800caf0 <UartRxByteCallback+0x138>)
|
|
800ca90: 785b ldrb r3, [r3, #1]
|
|
800ca92: 7bfa ldrb r2, [r7, #15]
|
|
800ca94: 429a cmp r2, r3
|
|
800ca96: d3ef bcc.n 800ca78 <UartRxByteCallback+0xc0>
|
|
}
|
|
g_escape.active = 0U;
|
|
800ca98: 4b15 ldr r3, [pc, #84] @ (800caf0 <UartRxByteCallback+0x138>)
|
|
800ca9a: 2200 movs r2, #0
|
|
800ca9c: 701a strb r2, [r3, #0]
|
|
g_escape.count = 0U;
|
|
800ca9e: 4b14 ldr r3, [pc, #80] @ (800caf0 <UartRxByteCallback+0x138>)
|
|
800caa0: 2200 movs r2, #0
|
|
800caa2: 705a strb r2, [r3, #1]
|
|
|
|
if (((now - g_uart_last_data_tick) >= CONFIG_ESCAPE_GUARD_MS) && (ch == '+'))
|
|
800caa4: 4b13 ldr r3, [pc, #76] @ (800caf4 <UartRxByteCallback+0x13c>)
|
|
800caa6: 681b ldr r3, [r3, #0]
|
|
800caa8: 68ba ldr r2, [r7, #8]
|
|
800caaa: 1ad3 subs r3, r2, r3
|
|
800caac: f5b3 7f48 cmp.w r3, #800 @ 0x320
|
|
800cab0: d312 bcc.n 800cad8 <UartRxByteCallback+0x120>
|
|
800cab2: 7bbb ldrb r3, [r7, #14]
|
|
800cab4: 2b2b cmp r3, #43 @ 0x2b
|
|
800cab6: d10f bne.n 800cad8 <UartRxByteCallback+0x120>
|
|
{
|
|
g_escape.active = 1U;
|
|
800cab8: 4b0d ldr r3, [pc, #52] @ (800caf0 <UartRxByteCallback+0x138>)
|
|
800caba: 2201 movs r2, #1
|
|
800cabc: 701a strb r2, [r3, #0]
|
|
g_escape.count = 1U;
|
|
800cabe: 4b0c ldr r3, [pc, #48] @ (800caf0 <UartRxByteCallback+0x138>)
|
|
800cac0: 2201 movs r2, #1
|
|
800cac2: 705a strb r2, [r3, #1]
|
|
g_escape.bytes[0] = ch;
|
|
800cac4: 4a0a ldr r2, [pc, #40] @ (800caf0 <UartRxByteCallback+0x138>)
|
|
800cac6: 7bbb ldrb r3, [r7, #14]
|
|
800cac8: 7093 strb r3, [r2, #2]
|
|
g_escape.start_tick = now;
|
|
800caca: 4a09 ldr r2, [pc, #36] @ (800caf0 <UartRxByteCallback+0x138>)
|
|
800cacc: 68bb ldr r3, [r7, #8]
|
|
800cace: 6093 str r3, [r2, #8]
|
|
g_escape.last_tick = now;
|
|
800cad0: 4a07 ldr r2, [pc, #28] @ (800caf0 <UartRxByteCallback+0x138>)
|
|
800cad2: 68bb ldr r3, [r7, #8]
|
|
800cad4: 60d3 str r3, [r2, #12]
|
|
return;
|
|
800cad6: e006 b.n 800cae6 <UartRxByteCallback+0x12e>
|
|
}
|
|
|
|
App_DataModeFeedByte(ch, now);
|
|
800cad8: 7bbb ldrb r3, [r7, #14]
|
|
800cada: 68b9 ldr r1, [r7, #8]
|
|
800cadc: 4618 mov r0, r3
|
|
800cade: f7ff fea5 bl 800c82c <App_DataModeFeedByte>
|
|
800cae2: e000 b.n 800cae6 <UartRxByteCallback+0x12e>
|
|
return;
|
|
800cae4: bf00 nop
|
|
}
|
|
800cae6: 3710 adds r7, #16
|
|
800cae8: 46bd mov sp, r7
|
|
800caea: bd80 pop {r7, pc}
|
|
800caec: 20000b90 .word 0x20000b90
|
|
800caf0: 20000b80 .word 0x20000b80
|
|
800caf4: 20000b7c .word 0x20000b7c
|
|
|
|
0800caf8 <App_ConfigFeedByte>:
|
|
|
|
static void App_ConfigFeedByte(uint8_t ch)
|
|
{
|
|
800caf8: b580 push {r7, lr}
|
|
800cafa: b082 sub sp, #8
|
|
800cafc: af00 add r7, sp, #0
|
|
800cafe: 4603 mov r3, r0
|
|
800cb00: 71fb strb r3, [r7, #7]
|
|
if ((ch == '\r') || (ch == '\n'))
|
|
800cb02: 79fb ldrb r3, [r7, #7]
|
|
800cb04: 2b0d cmp r3, #13
|
|
800cb06: d002 beq.n 800cb0e <App_ConfigFeedByte+0x16>
|
|
800cb08: 79fb ldrb r3, [r7, #7]
|
|
800cb0a: 2b0a cmp r3, #10
|
|
800cb0c: d115 bne.n 800cb3a <App_ConfigFeedByte+0x42>
|
|
{
|
|
if (g_cfg_line_len > 0U)
|
|
800cb0e: 4b26 ldr r3, [pc, #152] @ (800cba8 <App_ConfigFeedByte+0xb0>)
|
|
800cb10: 881b ldrh r3, [r3, #0]
|
|
800cb12: 2b00 cmp r3, #0
|
|
800cb14: d00e beq.n 800cb34 <App_ConfigFeedByte+0x3c>
|
|
{
|
|
g_cfg_line[g_cfg_line_len] = '\0';
|
|
800cb16: 4b24 ldr r3, [pc, #144] @ (800cba8 <App_ConfigFeedByte+0xb0>)
|
|
800cb18: 881b ldrh r3, [r3, #0]
|
|
800cb1a: 461a mov r2, r3
|
|
800cb1c: 4b23 ldr r3, [pc, #140] @ (800cbac <App_ConfigFeedByte+0xb4>)
|
|
800cb1e: 2100 movs r1, #0
|
|
800cb20: 5499 strb r1, [r3, r2]
|
|
App_Printf("\r\n");
|
|
800cb22: 4823 ldr r0, [pc, #140] @ (800cbb0 <App_ConfigFeedByte+0xb8>)
|
|
800cb24: f000 fb76 bl 800d214 <App_Printf>
|
|
App_ConfigExecuteLine(g_cfg_line);
|
|
800cb28: 4820 ldr r0, [pc, #128] @ (800cbac <App_ConfigFeedByte+0xb4>)
|
|
800cb2a: f000 f847 bl 800cbbc <App_ConfigExecuteLine>
|
|
g_cfg_line_len = 0U;
|
|
800cb2e: 4b1e ldr r3, [pc, #120] @ (800cba8 <App_ConfigFeedByte+0xb0>)
|
|
800cb30: 2200 movs r2, #0
|
|
800cb32: 801a strh r2, [r3, #0]
|
|
}
|
|
App_PrintConfigPrompt();
|
|
800cb34: f000 fa54 bl 800cfe0 <App_PrintConfigPrompt>
|
|
return;
|
|
800cb38: e032 b.n 800cba0 <App_ConfigFeedByte+0xa8>
|
|
}
|
|
|
|
if ((ch == 0x08U) || (ch == 0x7FU))
|
|
800cb3a: 79fb ldrb r3, [r7, #7]
|
|
800cb3c: 2b08 cmp r3, #8
|
|
800cb3e: d002 beq.n 800cb46 <App_ConfigFeedByte+0x4e>
|
|
800cb40: 79fb ldrb r3, [r7, #7]
|
|
800cb42: 2b7f cmp r3, #127 @ 0x7f
|
|
800cb44: d10e bne.n 800cb64 <App_ConfigFeedByte+0x6c>
|
|
{
|
|
if (g_cfg_line_len > 0U)
|
|
800cb46: 4b18 ldr r3, [pc, #96] @ (800cba8 <App_ConfigFeedByte+0xb0>)
|
|
800cb48: 881b ldrh r3, [r3, #0]
|
|
800cb4a: 2b00 cmp r3, #0
|
|
800cb4c: d027 beq.n 800cb9e <App_ConfigFeedByte+0xa6>
|
|
{
|
|
g_cfg_line_len--;
|
|
800cb4e: 4b16 ldr r3, [pc, #88] @ (800cba8 <App_ConfigFeedByte+0xb0>)
|
|
800cb50: 881b ldrh r3, [r3, #0]
|
|
800cb52: 3b01 subs r3, #1
|
|
800cb54: b29a uxth r2, r3
|
|
800cb56: 4b14 ldr r3, [pc, #80] @ (800cba8 <App_ConfigFeedByte+0xb0>)
|
|
800cb58: 801a strh r2, [r3, #0]
|
|
App_Write((const uint8_t *)"\b \b", 3U);
|
|
800cb5a: 2103 movs r1, #3
|
|
800cb5c: 4815 ldr r0, [pc, #84] @ (800cbb4 <App_ConfigFeedByte+0xbc>)
|
|
800cb5e: f000 fb85 bl 800d26c <App_Write>
|
|
}
|
|
return;
|
|
800cb62: e01c b.n 800cb9e <App_ConfigFeedByte+0xa6>
|
|
}
|
|
|
|
if ((isprint(ch) != 0) && (g_cfg_line_len < (CONFIG_LINE_SIZE - 1U)))
|
|
800cb64: 79fb ldrb r3, [r7, #7]
|
|
800cb66: 3301 adds r3, #1
|
|
800cb68: 4a13 ldr r2, [pc, #76] @ (800cbb8 <App_ConfigFeedByte+0xc0>)
|
|
800cb6a: 4413 add r3, r2
|
|
800cb6c: 781b ldrb r3, [r3, #0]
|
|
800cb6e: f003 0397 and.w r3, r3, #151 @ 0x97
|
|
800cb72: 2b00 cmp r3, #0
|
|
800cb74: d014 beq.n 800cba0 <App_ConfigFeedByte+0xa8>
|
|
800cb76: 4b0c ldr r3, [pc, #48] @ (800cba8 <App_ConfigFeedByte+0xb0>)
|
|
800cb78: 881b ldrh r3, [r3, #0]
|
|
800cb7a: 2b5e cmp r3, #94 @ 0x5e
|
|
800cb7c: d810 bhi.n 800cba0 <App_ConfigFeedByte+0xa8>
|
|
{
|
|
g_cfg_line[g_cfg_line_len++] = (char)ch;
|
|
800cb7e: 4b0a ldr r3, [pc, #40] @ (800cba8 <App_ConfigFeedByte+0xb0>)
|
|
800cb80: 881b ldrh r3, [r3, #0]
|
|
800cb82: 1c5a adds r2, r3, #1
|
|
800cb84: b291 uxth r1, r2
|
|
800cb86: 4a08 ldr r2, [pc, #32] @ (800cba8 <App_ConfigFeedByte+0xb0>)
|
|
800cb88: 8011 strh r1, [r2, #0]
|
|
800cb8a: 461a mov r2, r3
|
|
800cb8c: 79f9 ldrb r1, [r7, #7]
|
|
800cb8e: 4b07 ldr r3, [pc, #28] @ (800cbac <App_ConfigFeedByte+0xb4>)
|
|
800cb90: 5499 strb r1, [r3, r2]
|
|
App_Write(&ch, 1U);
|
|
800cb92: 1dfb adds r3, r7, #7
|
|
800cb94: 2101 movs r1, #1
|
|
800cb96: 4618 mov r0, r3
|
|
800cb98: f000 fb68 bl 800d26c <App_Write>
|
|
800cb9c: e000 b.n 800cba0 <App_ConfigFeedByte+0xa8>
|
|
return;
|
|
800cb9e: bf00 nop
|
|
}
|
|
}
|
|
800cba0: 3708 adds r7, #8
|
|
800cba2: 46bd mov sp, r7
|
|
800cba4: bd80 pop {r7, pc}
|
|
800cba6: bf00 nop
|
|
800cba8: 20000bf4 .word 0x20000bf4
|
|
800cbac: 20000b94 .word 0x20000b94
|
|
800cbb0: 0800fbe0 .word 0x0800fbe0
|
|
800cbb4: 0800fbe4 .word 0x0800fbe4
|
|
800cbb8: 08010518 .word 0x08010518
|
|
|
|
0800cbbc <App_ConfigExecuteLine>:
|
|
|
|
static void App_ConfigExecuteLine(char *line)
|
|
{
|
|
800cbbc: b580 push {r7, lr}
|
|
800cbbe: b086 sub sp, #24
|
|
800cbc0: af00 add r7, sp, #0
|
|
800cbc2: 6078 str r0, [r7, #4]
|
|
char *arg;
|
|
uint32_t u32;
|
|
uint8_t sync[3];
|
|
|
|
line = App_SkipSpaces(line);
|
|
800cbc4: 6878 ldr r0, [r7, #4]
|
|
800cbc6: f000 fc19 bl 800d3fc <App_SkipSpaces>
|
|
800cbca: 6078 str r0, [r7, #4]
|
|
if (*line == '\0')
|
|
800cbcc: 687b ldr r3, [r7, #4]
|
|
800cbce: 781b ldrb r3, [r3, #0]
|
|
800cbd0: 2b00 cmp r3, #0
|
|
800cbd2: f000 81ef beq.w 800cfb4 <App_ConfigExecuteLine+0x3f8>
|
|
{
|
|
return;
|
|
}
|
|
|
|
if ((strcmp(line, "help") == 0) || (strcmp(line, "?") == 0))
|
|
800cbd6: 49a0 ldr r1, [pc, #640] @ (800ce58 <App_ConfigExecuteLine+0x29c>)
|
|
800cbd8: 6878 ldr r0, [r7, #4]
|
|
800cbda: f7f3 fad1 bl 8000180 <strcmp>
|
|
800cbde: 4603 mov r3, r0
|
|
800cbe0: 2b00 cmp r3, #0
|
|
800cbe2: d006 beq.n 800cbf2 <App_ConfigExecuteLine+0x36>
|
|
800cbe4: 499d ldr r1, [pc, #628] @ (800ce5c <App_ConfigExecuteLine+0x2a0>)
|
|
800cbe6: 6878 ldr r0, [r7, #4]
|
|
800cbe8: f7f3 faca bl 8000180 <strcmp>
|
|
800cbec: 4603 mov r3, r0
|
|
800cbee: 2b00 cmp r3, #0
|
|
800cbf0: d102 bne.n 800cbf8 <App_ConfigExecuteLine+0x3c>
|
|
{
|
|
App_PrintHelp();
|
|
800cbf2: f000 fa05 bl 800d000 <App_PrintHelp>
|
|
return;
|
|
800cbf6: e1de b.n 800cfb6 <App_ConfigExecuteLine+0x3fa>
|
|
}
|
|
|
|
if ((strcmp(line, "show") == 0) || (strcmp(line, "status") == 0))
|
|
800cbf8: 4999 ldr r1, [pc, #612] @ (800ce60 <App_ConfigExecuteLine+0x2a4>)
|
|
800cbfa: 6878 ldr r0, [r7, #4]
|
|
800cbfc: f7f3 fac0 bl 8000180 <strcmp>
|
|
800cc00: 4603 mov r3, r0
|
|
800cc02: 2b00 cmp r3, #0
|
|
800cc04: d006 beq.n 800cc14 <App_ConfigExecuteLine+0x58>
|
|
800cc06: 4997 ldr r1, [pc, #604] @ (800ce64 <App_ConfigExecuteLine+0x2a8>)
|
|
800cc08: 6878 ldr r0, [r7, #4]
|
|
800cc0a: f7f3 fab9 bl 8000180 <strcmp>
|
|
800cc0e: 4603 mov r3, r0
|
|
800cc10: 2b00 cmp r3, #0
|
|
800cc12: d102 bne.n 800cc1a <App_ConfigExecuteLine+0x5e>
|
|
{
|
|
App_PrintStatus();
|
|
800cc14: f000 fa44 bl 800d0a0 <App_PrintStatus>
|
|
return;
|
|
800cc18: e1cd b.n 800cfb6 <App_ConfigExecuteLine+0x3fa>
|
|
}
|
|
|
|
if (strcmp(line, "exit") == 0)
|
|
800cc1a: 4993 ldr r1, [pc, #588] @ (800ce68 <App_ConfigExecuteLine+0x2ac>)
|
|
800cc1c: 6878 ldr r0, [r7, #4]
|
|
800cc1e: f7f3 faaf bl 8000180 <strcmp>
|
|
800cc22: 4603 mov r3, r0
|
|
800cc24: 2b00 cmp r3, #0
|
|
800cc26: d102 bne.n 800cc2e <App_ConfigExecuteLine+0x72>
|
|
{
|
|
App_ExitConfigMode();
|
|
800cc28: f7ff fdc4 bl 800c7b4 <App_ExitConfigMode>
|
|
return;
|
|
800cc2c: e1c3 b.n 800cfb6 <App_ConfigExecuteLine+0x3fa>
|
|
}
|
|
if (strcmp(line, "save") == 0)
|
|
800cc2e: 498f ldr r1, [pc, #572] @ (800ce6c <App_ConfigExecuteLine+0x2b0>)
|
|
800cc30: 6878 ldr r0, [r7, #4]
|
|
800cc32: f7f3 faa5 bl 8000180 <strcmp>
|
|
800cc36: 4603 mov r3, r0
|
|
800cc38: 2b00 cmp r3, #0
|
|
800cc3a: d102 bne.n 800cc42 <App_ConfigExecuteLine+0x86>
|
|
{
|
|
App_ApplyConfig();
|
|
800cc3c: f7ff fcb0 bl 800c5a0 <App_ApplyConfig>
|
|
return;
|
|
800cc40: e1b9 b.n 800cfb6 <App_ConfigExecuteLine+0x3fa>
|
|
}
|
|
if (strcmp(line, "defaults") == 0)
|
|
800cc42: 498b ldr r1, [pc, #556] @ (800ce70 <App_ConfigExecuteLine+0x2b4>)
|
|
800cc44: 6878 ldr r0, [r7, #4]
|
|
800cc46: f7f3 fa9b bl 8000180 <strcmp>
|
|
800cc4a: 4603 mov r3, r0
|
|
800cc4c: 2b00 cmp r3, #0
|
|
800cc4e: d106 bne.n 800cc5e <App_ConfigExecuteLine+0xa2>
|
|
{
|
|
Config_LoadDefaults(&g_cfg);
|
|
800cc50: 4888 ldr r0, [pc, #544] @ (800ce74 <App_ConfigExecuteLine+0x2b8>)
|
|
800cc52: f000 fcf7 bl 800d644 <Config_LoadDefaults>
|
|
App_Printf("defaults restored\r\n");
|
|
800cc56: 4888 ldr r0, [pc, #544] @ (800ce78 <App_ConfigExecuteLine+0x2bc>)
|
|
800cc58: f000 fadc bl 800d214 <App_Printf>
|
|
return;
|
|
800cc5c: e1ab b.n 800cfb6 <App_ConfigExecuteLine+0x3fa>
|
|
}
|
|
|
|
if (strncmp(line, "freq ", 5) == 0)
|
|
800cc5e: 2205 movs r2, #5
|
|
800cc60: 4986 ldr r1, [pc, #536] @ (800ce7c <App_ConfigExecuteLine+0x2c0>)
|
|
800cc62: 6878 ldr r0, [r7, #4]
|
|
800cc64: f002 f97a bl 800ef5c <strncmp>
|
|
800cc68: 4603 mov r3, r0
|
|
800cc6a: 2b00 cmp r3, #0
|
|
800cc6c: d11d bne.n 800ccaa <App_ConfigExecuteLine+0xee>
|
|
{
|
|
u32 = strtoul(&line[5], NULL, 10);
|
|
800cc6e: 687b ldr r3, [r7, #4]
|
|
800cc70: 3305 adds r3, #5
|
|
800cc72: 220a movs r2, #10
|
|
800cc74: 2100 movs r1, #0
|
|
800cc76: 4618 mov r0, r3
|
|
800cc78: f002 f922 bl 800eec0 <strtoul>
|
|
800cc7c: 6138 str r0, [r7, #16]
|
|
if (u32 < 150000000UL || u32 > 960000000UL)
|
|
800cc7e: 693b ldr r3, [r7, #16]
|
|
800cc80: 4a7f ldr r2, [pc, #508] @ (800ce80 <App_ConfigExecuteLine+0x2c4>)
|
|
800cc82: 4293 cmp r3, r2
|
|
800cc84: d903 bls.n 800cc8e <App_ConfigExecuteLine+0xd2>
|
|
800cc86: 693b ldr r3, [r7, #16]
|
|
800cc88: 4a7e ldr r2, [pc, #504] @ (800ce84 <App_ConfigExecuteLine+0x2c8>)
|
|
800cc8a: 4293 cmp r3, r2
|
|
800cc8c: d903 bls.n 800cc96 <App_ConfigExecuteLine+0xda>
|
|
{
|
|
App_Printf("bad frequency\r\n");
|
|
800cc8e: 487e ldr r0, [pc, #504] @ (800ce88 <App_ConfigExecuteLine+0x2cc>)
|
|
800cc90: f000 fac0 bl 800d214 <App_Printf>
|
|
return;
|
|
800cc94: e18f b.n 800cfb6 <App_ConfigExecuteLine+0x3fa>
|
|
}
|
|
g_cfg.rf_frequency = u32;
|
|
800cc96: 4a77 ldr r2, [pc, #476] @ (800ce74 <App_ConfigExecuteLine+0x2b8>)
|
|
800cc98: 693b ldr r3, [r7, #16]
|
|
800cc9a: 6013 str r3, [r2, #0]
|
|
App_Printf("freq=%lu\r\n", (unsigned long)g_cfg.rf_frequency);
|
|
800cc9c: 4b75 ldr r3, [pc, #468] @ (800ce74 <App_ConfigExecuteLine+0x2b8>)
|
|
800cc9e: 681b ldr r3, [r3, #0]
|
|
800cca0: 4619 mov r1, r3
|
|
800cca2: 487a ldr r0, [pc, #488] @ (800ce8c <App_ConfigExecuteLine+0x2d0>)
|
|
800cca4: f000 fab6 bl 800d214 <App_Printf>
|
|
return;
|
|
800cca8: e185 b.n 800cfb6 <App_ConfigExecuteLine+0x3fa>
|
|
}
|
|
|
|
if (strncmp(line, "power ", 6) == 0)
|
|
800ccaa: 2206 movs r2, #6
|
|
800ccac: 4978 ldr r1, [pc, #480] @ (800ce90 <App_ConfigExecuteLine+0x2d4>)
|
|
800ccae: 6878 ldr r0, [r7, #4]
|
|
800ccb0: f002 f954 bl 800ef5c <strncmp>
|
|
800ccb4: 4603 mov r3, r0
|
|
800ccb6: 2b00 cmp r3, #0
|
|
800ccb8: d11e bne.n 800ccf8 <App_ConfigExecuteLine+0x13c>
|
|
{
|
|
long pwr = strtol(&line[6], NULL, 10);
|
|
800ccba: 687b ldr r3, [r7, #4]
|
|
800ccbc: 3306 adds r3, #6
|
|
800ccbe: 220a movs r2, #10
|
|
800ccc0: 2100 movs r1, #0
|
|
800ccc2: 4618 mov r0, r3
|
|
800ccc4: f002 f884 bl 800edd0 <strtol>
|
|
800ccc8: 60f8 str r0, [r7, #12]
|
|
if ((pwr < -9L) || (pwr > 22L))
|
|
800ccca: 68fb ldr r3, [r7, #12]
|
|
800cccc: f113 0f09 cmn.w r3, #9
|
|
800ccd0: db02 blt.n 800ccd8 <App_ConfigExecuteLine+0x11c>
|
|
800ccd2: 68fb ldr r3, [r7, #12]
|
|
800ccd4: 2b16 cmp r3, #22
|
|
800ccd6: dd03 ble.n 800cce0 <App_ConfigExecuteLine+0x124>
|
|
{
|
|
App_Printf("bad power\r\n");
|
|
800ccd8: 486e ldr r0, [pc, #440] @ (800ce94 <App_ConfigExecuteLine+0x2d8>)
|
|
800ccda: f000 fa9b bl 800d214 <App_Printf>
|
|
return;
|
|
800ccde: e16a b.n 800cfb6 <App_ConfigExecuteLine+0x3fa>
|
|
}
|
|
g_cfg.tx_power = (int8_t)pwr;
|
|
800cce0: 68fb ldr r3, [r7, #12]
|
|
800cce2: b25a sxtb r2, r3
|
|
800cce4: 4b63 ldr r3, [pc, #396] @ (800ce74 <App_ConfigExecuteLine+0x2b8>)
|
|
800cce6: 711a strb r2, [r3, #4]
|
|
App_Printf("power=%d\r\n", g_cfg.tx_power);
|
|
800cce8: 4b62 ldr r3, [pc, #392] @ (800ce74 <App_ConfigExecuteLine+0x2b8>)
|
|
800ccea: f993 3004 ldrsb.w r3, [r3, #4]
|
|
800ccee: 4619 mov r1, r3
|
|
800ccf0: 4869 ldr r0, [pc, #420] @ (800ce98 <App_ConfigExecuteLine+0x2dc>)
|
|
800ccf2: f000 fa8f bl 800d214 <App_Printf>
|
|
return;
|
|
800ccf6: e15e b.n 800cfb6 <App_ConfigExecuteLine+0x3fa>
|
|
}
|
|
|
|
if (strncmp(line, "bitrate ", 8) == 0)
|
|
800ccf8: 2208 movs r2, #8
|
|
800ccfa: 4968 ldr r1, [pc, #416] @ (800ce9c <App_ConfigExecuteLine+0x2e0>)
|
|
800ccfc: 6878 ldr r0, [r7, #4]
|
|
800ccfe: f002 f92d bl 800ef5c <strncmp>
|
|
800cd02: 4603 mov r3, r0
|
|
800cd04: 2b00 cmp r3, #0
|
|
800cd06: d11d bne.n 800cd44 <App_ConfigExecuteLine+0x188>
|
|
{
|
|
u32 = strtoul(&line[8], NULL, 10);
|
|
800cd08: 687b ldr r3, [r7, #4]
|
|
800cd0a: 3308 adds r3, #8
|
|
800cd0c: 220a movs r2, #10
|
|
800cd0e: 2100 movs r1, #0
|
|
800cd10: 4618 mov r0, r3
|
|
800cd12: f002 f8d5 bl 800eec0 <strtoul>
|
|
800cd16: 6138 str r0, [r7, #16]
|
|
if ((u32 < 600UL) || (u32 > 300000UL))
|
|
800cd18: 693b ldr r3, [r7, #16]
|
|
800cd1a: f5b3 7f16 cmp.w r3, #600 @ 0x258
|
|
800cd1e: d303 bcc.n 800cd28 <App_ConfigExecuteLine+0x16c>
|
|
800cd20: 693b ldr r3, [r7, #16]
|
|
800cd22: 4a5f ldr r2, [pc, #380] @ (800cea0 <App_ConfigExecuteLine+0x2e4>)
|
|
800cd24: 4293 cmp r3, r2
|
|
800cd26: d903 bls.n 800cd30 <App_ConfigExecuteLine+0x174>
|
|
{
|
|
App_Printf("bad bitrate\r\n");
|
|
800cd28: 485e ldr r0, [pc, #376] @ (800cea4 <App_ConfigExecuteLine+0x2e8>)
|
|
800cd2a: f000 fa73 bl 800d214 <App_Printf>
|
|
return;
|
|
800cd2e: e142 b.n 800cfb6 <App_ConfigExecuteLine+0x3fa>
|
|
}
|
|
g_cfg.fsk_bitrate = u32;
|
|
800cd30: 4a50 ldr r2, [pc, #320] @ (800ce74 <App_ConfigExecuteLine+0x2b8>)
|
|
800cd32: 693b ldr r3, [r7, #16]
|
|
800cd34: 6093 str r3, [r2, #8]
|
|
App_Printf("bitrate=%lu\r\n", (unsigned long)g_cfg.fsk_bitrate);
|
|
800cd36: 4b4f ldr r3, [pc, #316] @ (800ce74 <App_ConfigExecuteLine+0x2b8>)
|
|
800cd38: 689b ldr r3, [r3, #8]
|
|
800cd3a: 4619 mov r1, r3
|
|
800cd3c: 485a ldr r0, [pc, #360] @ (800cea8 <App_ConfigExecuteLine+0x2ec>)
|
|
800cd3e: f000 fa69 bl 800d214 <App_Printf>
|
|
return;
|
|
800cd42: e138 b.n 800cfb6 <App_ConfigExecuteLine+0x3fa>
|
|
}
|
|
|
|
if (strncmp(line, "bandwidth ", 10) == 0)
|
|
800cd44: 220a movs r2, #10
|
|
800cd46: 4959 ldr r1, [pc, #356] @ (800ceac <App_ConfigExecuteLine+0x2f0>)
|
|
800cd48: 6878 ldr r0, [r7, #4]
|
|
800cd4a: f002 f907 bl 800ef5c <strncmp>
|
|
800cd4e: 4603 mov r3, r0
|
|
800cd50: 2b00 cmp r3, #0
|
|
800cd52: d11e bne.n 800cd92 <App_ConfigExecuteLine+0x1d6>
|
|
{
|
|
u32 = strtoul(&line[10], NULL, 10);
|
|
800cd54: 687b ldr r3, [r7, #4]
|
|
800cd56: 330a adds r3, #10
|
|
800cd58: 220a movs r2, #10
|
|
800cd5a: 2100 movs r1, #0
|
|
800cd5c: 4618 mov r0, r3
|
|
800cd5e: f002 f8af bl 800eec0 <strtoul>
|
|
800cd62: 6138 str r0, [r7, #16]
|
|
if ((u32 < 2600UL) || (u32 > 250000UL))
|
|
800cd64: 693b ldr r3, [r7, #16]
|
|
800cd66: f640 2227 movw r2, #2599 @ 0xa27
|
|
800cd6a: 4293 cmp r3, r2
|
|
800cd6c: d903 bls.n 800cd76 <App_ConfigExecuteLine+0x1ba>
|
|
800cd6e: 693b ldr r3, [r7, #16]
|
|
800cd70: 4a4f ldr r2, [pc, #316] @ (800ceb0 <App_ConfigExecuteLine+0x2f4>)
|
|
800cd72: 4293 cmp r3, r2
|
|
800cd74: d903 bls.n 800cd7e <App_ConfigExecuteLine+0x1c2>
|
|
{
|
|
App_Printf("bad bandwidth\r\n");
|
|
800cd76: 484f ldr r0, [pc, #316] @ (800ceb4 <App_ConfigExecuteLine+0x2f8>)
|
|
800cd78: f000 fa4c bl 800d214 <App_Printf>
|
|
return;
|
|
800cd7c: e11b b.n 800cfb6 <App_ConfigExecuteLine+0x3fa>
|
|
}
|
|
g_cfg.fsk_bandwidth = u32;
|
|
800cd7e: 4a3d ldr r2, [pc, #244] @ (800ce74 <App_ConfigExecuteLine+0x2b8>)
|
|
800cd80: 693b ldr r3, [r7, #16]
|
|
800cd82: 60d3 str r3, [r2, #12]
|
|
App_Printf("bandwidth=%lu\r\n", (unsigned long)g_cfg.fsk_bandwidth);
|
|
800cd84: 4b3b ldr r3, [pc, #236] @ (800ce74 <App_ConfigExecuteLine+0x2b8>)
|
|
800cd86: 68db ldr r3, [r3, #12]
|
|
800cd88: 4619 mov r1, r3
|
|
800cd8a: 484b ldr r0, [pc, #300] @ (800ceb8 <App_ConfigExecuteLine+0x2fc>)
|
|
800cd8c: f000 fa42 bl 800d214 <App_Printf>
|
|
return;
|
|
800cd90: e111 b.n 800cfb6 <App_ConfigExecuteLine+0x3fa>
|
|
}
|
|
|
|
if (strncmp(line, "fdev ", 5) == 0)
|
|
800cd92: 2205 movs r2, #5
|
|
800cd94: 4949 ldr r1, [pc, #292] @ (800cebc <App_ConfigExecuteLine+0x300>)
|
|
800cd96: 6878 ldr r0, [r7, #4]
|
|
800cd98: f002 f8e0 bl 800ef5c <strncmp>
|
|
800cd9c: 4603 mov r3, r0
|
|
800cd9e: 2b00 cmp r3, #0
|
|
800cda0: d119 bne.n 800cdd6 <App_ConfigExecuteLine+0x21a>
|
|
{
|
|
u32 = strtoul(&line[5], NULL, 10);
|
|
800cda2: 687b ldr r3, [r7, #4]
|
|
800cda4: 3305 adds r3, #5
|
|
800cda6: 220a movs r2, #10
|
|
800cda8: 2100 movs r1, #0
|
|
800cdaa: 4618 mov r0, r3
|
|
800cdac: f002 f888 bl 800eec0 <strtoul>
|
|
800cdb0: 6138 str r0, [r7, #16]
|
|
if (u32 > 200000UL)
|
|
800cdb2: 693b ldr r3, [r7, #16]
|
|
800cdb4: 4a42 ldr r2, [pc, #264] @ (800cec0 <App_ConfigExecuteLine+0x304>)
|
|
800cdb6: 4293 cmp r3, r2
|
|
800cdb8: d903 bls.n 800cdc2 <App_ConfigExecuteLine+0x206>
|
|
{
|
|
App_Printf("bad fdev\r\n");
|
|
800cdba: 4842 ldr r0, [pc, #264] @ (800cec4 <App_ConfigExecuteLine+0x308>)
|
|
800cdbc: f000 fa2a bl 800d214 <App_Printf>
|
|
return;
|
|
800cdc0: e0f9 b.n 800cfb6 <App_ConfigExecuteLine+0x3fa>
|
|
}
|
|
g_cfg.fsk_fdev = u32;
|
|
800cdc2: 4a2c ldr r2, [pc, #176] @ (800ce74 <App_ConfigExecuteLine+0x2b8>)
|
|
800cdc4: 693b ldr r3, [r7, #16]
|
|
800cdc6: 6113 str r3, [r2, #16]
|
|
App_Printf("fdev=%lu\r\n", (unsigned long)g_cfg.fsk_fdev);
|
|
800cdc8: 4b2a ldr r3, [pc, #168] @ (800ce74 <App_ConfigExecuteLine+0x2b8>)
|
|
800cdca: 691b ldr r3, [r3, #16]
|
|
800cdcc: 4619 mov r1, r3
|
|
800cdce: 483e ldr r0, [pc, #248] @ (800cec8 <App_ConfigExecuteLine+0x30c>)
|
|
800cdd0: f000 fa20 bl 800d214 <App_Printf>
|
|
return;
|
|
800cdd4: e0ef b.n 800cfb6 <App_ConfigExecuteLine+0x3fa>
|
|
}
|
|
|
|
if (strncmp(line, "preamble ", 9) == 0)
|
|
800cdd6: 2209 movs r2, #9
|
|
800cdd8: 493c ldr r1, [pc, #240] @ (800cecc <App_ConfigExecuteLine+0x310>)
|
|
800cdda: 6878 ldr r0, [r7, #4]
|
|
800cddc: f002 f8be bl 800ef5c <strncmp>
|
|
800cde0: 4603 mov r3, r0
|
|
800cde2: 2b00 cmp r3, #0
|
|
800cde4: d11d bne.n 800ce22 <App_ConfigExecuteLine+0x266>
|
|
{
|
|
u32 = strtoul(&line[9], NULL, 10);
|
|
800cde6: 687b ldr r3, [r7, #4]
|
|
800cde8: 3309 adds r3, #9
|
|
800cdea: 220a movs r2, #10
|
|
800cdec: 2100 movs r1, #0
|
|
800cdee: 4618 mov r0, r3
|
|
800cdf0: f002 f866 bl 800eec0 <strtoul>
|
|
800cdf4: 6138 str r0, [r7, #16]
|
|
if ((u32 < 2UL) || (u32 > 65535UL))
|
|
800cdf6: 693b ldr r3, [r7, #16]
|
|
800cdf8: 2b01 cmp r3, #1
|
|
800cdfa: d903 bls.n 800ce04 <App_ConfigExecuteLine+0x248>
|
|
800cdfc: 693b ldr r3, [r7, #16]
|
|
800cdfe: f5b3 3f80 cmp.w r3, #65536 @ 0x10000
|
|
800ce02: d303 bcc.n 800ce0c <App_ConfigExecuteLine+0x250>
|
|
{
|
|
App_Printf("bad preamble\r\n");
|
|
800ce04: 4832 ldr r0, [pc, #200] @ (800ced0 <App_ConfigExecuteLine+0x314>)
|
|
800ce06: f000 fa05 bl 800d214 <App_Printf>
|
|
return;
|
|
800ce0a: e0d4 b.n 800cfb6 <App_ConfigExecuteLine+0x3fa>
|
|
}
|
|
g_cfg.fsk_preamble_len = (uint16_t)u32;
|
|
800ce0c: 693b ldr r3, [r7, #16]
|
|
800ce0e: b29a uxth r2, r3
|
|
800ce10: 4b18 ldr r3, [pc, #96] @ (800ce74 <App_ConfigExecuteLine+0x2b8>)
|
|
800ce12: 829a strh r2, [r3, #20]
|
|
App_Printf("preamble=%u\r\n", g_cfg.fsk_preamble_len);
|
|
800ce14: 4b17 ldr r3, [pc, #92] @ (800ce74 <App_ConfigExecuteLine+0x2b8>)
|
|
800ce16: 8a9b ldrh r3, [r3, #20]
|
|
800ce18: 4619 mov r1, r3
|
|
800ce1a: 482e ldr r0, [pc, #184] @ (800ced4 <App_ConfigExecuteLine+0x318>)
|
|
800ce1c: f000 f9fa bl 800d214 <App_Printf>
|
|
return;
|
|
800ce20: e0c9 b.n 800cfb6 <App_ConfigExecuteLine+0x3fa>
|
|
}
|
|
|
|
if (strncmp(line, "timeout ", 8) == 0)
|
|
800ce22: 2208 movs r2, #8
|
|
800ce24: 492c ldr r1, [pc, #176] @ (800ced8 <App_ConfigExecuteLine+0x31c>)
|
|
800ce26: 6878 ldr r0, [r7, #4]
|
|
800ce28: f002 f898 bl 800ef5c <strncmp>
|
|
800ce2c: 4603 mov r3, r0
|
|
800ce2e: 2b00 cmp r3, #0
|
|
800ce30: d161 bne.n 800cef6 <App_ConfigExecuteLine+0x33a>
|
|
{
|
|
u32 = strtoul(&line[8], NULL, 10);
|
|
800ce32: 687b ldr r3, [r7, #4]
|
|
800ce34: 3308 adds r3, #8
|
|
800ce36: 220a movs r2, #10
|
|
800ce38: 2100 movs r1, #0
|
|
800ce3a: 4618 mov r0, r3
|
|
800ce3c: f002 f840 bl 800eec0 <strtoul>
|
|
800ce40: 6138 str r0, [r7, #16]
|
|
if ((u32 < 1UL) || (u32 > 1000UL))
|
|
800ce42: 693b ldr r3, [r7, #16]
|
|
800ce44: 2b00 cmp r3, #0
|
|
800ce46: d003 beq.n 800ce50 <App_ConfigExecuteLine+0x294>
|
|
800ce48: 693b ldr r3, [r7, #16]
|
|
800ce4a: f5b3 7f7a cmp.w r3, #1000 @ 0x3e8
|
|
800ce4e: d947 bls.n 800cee0 <App_ConfigExecuteLine+0x324>
|
|
{
|
|
App_Printf("bad timeout\r\n");
|
|
800ce50: 4822 ldr r0, [pc, #136] @ (800cedc <App_ConfigExecuteLine+0x320>)
|
|
800ce52: f000 f9df bl 800d214 <App_Printf>
|
|
return;
|
|
800ce56: e0ae b.n 800cfb6 <App_ConfigExecuteLine+0x3fa>
|
|
800ce58: 0800fbe8 .word 0x0800fbe8
|
|
800ce5c: 0800fbf0 .word 0x0800fbf0
|
|
800ce60: 0800fbf4 .word 0x0800fbf4
|
|
800ce64: 0800fbfc .word 0x0800fbfc
|
|
800ce68: 0800fc04 .word 0x0800fc04
|
|
800ce6c: 0800fc0c .word 0x0800fc0c
|
|
800ce70: 0800fc14 .word 0x0800fc14
|
|
800ce74: 20000604 .word 0x20000604
|
|
800ce78: 0800fc20 .word 0x0800fc20
|
|
800ce7c: 0800fc34 .word 0x0800fc34
|
|
800ce80: 08f0d17f .word 0x08f0d17f
|
|
800ce84: 39387000 .word 0x39387000
|
|
800ce88: 0800fc3c .word 0x0800fc3c
|
|
800ce8c: 0800fc4c .word 0x0800fc4c
|
|
800ce90: 0800fc58 .word 0x0800fc58
|
|
800ce94: 0800fc60 .word 0x0800fc60
|
|
800ce98: 0800fc6c .word 0x0800fc6c
|
|
800ce9c: 0800fc78 .word 0x0800fc78
|
|
800cea0: 000493e0 .word 0x000493e0
|
|
800cea4: 0800fc84 .word 0x0800fc84
|
|
800cea8: 0800fc94 .word 0x0800fc94
|
|
800ceac: 0800fca4 .word 0x0800fca4
|
|
800ceb0: 0003d090 .word 0x0003d090
|
|
800ceb4: 0800fcb0 .word 0x0800fcb0
|
|
800ceb8: 0800fcc0 .word 0x0800fcc0
|
|
800cebc: 0800fcd0 .word 0x0800fcd0
|
|
800cec0: 00030d40 .word 0x00030d40
|
|
800cec4: 0800fcd8 .word 0x0800fcd8
|
|
800cec8: 0800fce4 .word 0x0800fce4
|
|
800cecc: 0800fcf0 .word 0x0800fcf0
|
|
800ced0: 0800fcfc .word 0x0800fcfc
|
|
800ced4: 0800fd0c .word 0x0800fd0c
|
|
800ced8: 0800fd1c .word 0x0800fd1c
|
|
800cedc: 0800fd28 .word 0x0800fd28
|
|
}
|
|
g_cfg.uart_packet_timeout_ms = (uint16_t)u32;
|
|
800cee0: 693b ldr r3, [r7, #16]
|
|
800cee2: b29a uxth r2, r3
|
|
800cee4: 4b35 ldr r3, [pc, #212] @ (800cfbc <App_ConfigExecuteLine+0x400>)
|
|
800cee6: 835a strh r2, [r3, #26]
|
|
App_Printf("timeout=%u\r\n", g_cfg.uart_packet_timeout_ms);
|
|
800cee8: 4b34 ldr r3, [pc, #208] @ (800cfbc <App_ConfigExecuteLine+0x400>)
|
|
800ceea: 8b5b ldrh r3, [r3, #26]
|
|
800ceec: 4619 mov r1, r3
|
|
800ceee: 4834 ldr r0, [pc, #208] @ (800cfc0 <App_ConfigExecuteLine+0x404>)
|
|
800cef0: f000 f990 bl 800d214 <App_Printf>
|
|
return;
|
|
800cef4: e05f b.n 800cfb6 <App_ConfigExecuteLine+0x3fa>
|
|
}
|
|
|
|
if (strncmp(line, "uart ", 5) == 0)
|
|
800cef6: 2205 movs r2, #5
|
|
800cef8: 4932 ldr r1, [pc, #200] @ (800cfc4 <App_ConfigExecuteLine+0x408>)
|
|
800cefa: 6878 ldr r0, [r7, #4]
|
|
800cefc: f002 f82e bl 800ef5c <strncmp>
|
|
800cf00: 4603 mov r3, r0
|
|
800cf02: 2b00 cmp r3, #0
|
|
800cf04: d122 bne.n 800cf4c <App_ConfigExecuteLine+0x390>
|
|
{
|
|
u32 = strtoul(&line[5], NULL, 10);
|
|
800cf06: 687b ldr r3, [r7, #4]
|
|
800cf08: 3305 adds r3, #5
|
|
800cf0a: 220a movs r2, #10
|
|
800cf0c: 2100 movs r1, #0
|
|
800cf0e: 4618 mov r0, r3
|
|
800cf10: f001 ffd6 bl 800eec0 <strtoul>
|
|
800cf14: 6138 str r0, [r7, #16]
|
|
if ((u32 < 1200UL) || (u32 > 921600UL))
|
|
800cf16: 693b ldr r3, [r7, #16]
|
|
800cf18: f5b3 6f96 cmp.w r3, #1200 @ 0x4b0
|
|
800cf1c: d303 bcc.n 800cf26 <App_ConfigExecuteLine+0x36a>
|
|
800cf1e: 693b ldr r3, [r7, #16]
|
|
800cf20: f5b3 2f61 cmp.w r3, #921600 @ 0xe1000
|
|
800cf24: d903 bls.n 800cf2e <App_ConfigExecuteLine+0x372>
|
|
{
|
|
App_Printf("bad uart baudrate\r\n");
|
|
800cf26: 4828 ldr r0, [pc, #160] @ (800cfc8 <App_ConfigExecuteLine+0x40c>)
|
|
800cf28: f000 f974 bl 800d214 <App_Printf>
|
|
return;
|
|
800cf2c: e043 b.n 800cfb6 <App_ConfigExecuteLine+0x3fa>
|
|
}
|
|
g_cfg.uart_baudrate = u32;
|
|
800cf2e: 4a23 ldr r2, [pc, #140] @ (800cfbc <App_ConfigExecuteLine+0x400>)
|
|
800cf30: 693b ldr r3, [r7, #16]
|
|
800cf32: 61d3 str r3, [r2, #28]
|
|
App_Printf("switching uart to %lu baud\r\n", (unsigned long)g_cfg.uart_baudrate);
|
|
800cf34: 4b21 ldr r3, [pc, #132] @ (800cfbc <App_ConfigExecuteLine+0x400>)
|
|
800cf36: 69db ldr r3, [r3, #28]
|
|
800cf38: 4619 mov r1, r3
|
|
800cf3a: 4824 ldr r0, [pc, #144] @ (800cfcc <App_ConfigExecuteLine+0x410>)
|
|
800cf3c: f000 f96a bl 800d214 <App_Printf>
|
|
App_ReconfigureUart(g_cfg.uart_baudrate);
|
|
800cf40: 4b1e ldr r3, [pc, #120] @ (800cfbc <App_ConfigExecuteLine+0x400>)
|
|
800cf42: 69db ldr r3, [r3, #28]
|
|
800cf44: 4618 mov r0, r3
|
|
800cf46: f000 f9ab bl 800d2a0 <App_ReconfigureUart>
|
|
return;
|
|
800cf4a: e034 b.n 800cfb6 <App_ConfigExecuteLine+0x3fa>
|
|
}
|
|
|
|
if (strncmp(line, "sync ", 5) == 0)
|
|
800cf4c: 2205 movs r2, #5
|
|
800cf4e: 4920 ldr r1, [pc, #128] @ (800cfd0 <App_ConfigExecuteLine+0x414>)
|
|
800cf50: 6878 ldr r0, [r7, #4]
|
|
800cf52: f002 f803 bl 800ef5c <strncmp>
|
|
800cf56: 4603 mov r3, r0
|
|
800cf58: 2b00 cmp r3, #0
|
|
800cf5a: d126 bne.n 800cfaa <App_ConfigExecuteLine+0x3ee>
|
|
{
|
|
arg = App_SkipSpaces(&line[5]);
|
|
800cf5c: 687b ldr r3, [r7, #4]
|
|
800cf5e: 3305 adds r3, #5
|
|
800cf60: 4618 mov r0, r3
|
|
800cf62: f000 fa4b bl 800d3fc <App_SkipSpaces>
|
|
800cf66: 6178 str r0, [r7, #20]
|
|
if (App_ParseHexSyncWord(arg, sync) == 0U)
|
|
800cf68: f107 0308 add.w r3, r7, #8
|
|
800cf6c: 4619 mov r1, r3
|
|
800cf6e: 6978 ldr r0, [r7, #20]
|
|
800cf70: f000 f9ce bl 800d310 <App_ParseHexSyncWord>
|
|
800cf74: 4603 mov r3, r0
|
|
800cf76: 2b00 cmp r3, #0
|
|
800cf78: d103 bne.n 800cf82 <App_ConfigExecuteLine+0x3c6>
|
|
{
|
|
App_Printf("bad sync, use 6 hex chars, e.g. C194C1\r\n");
|
|
800cf7a: 4816 ldr r0, [pc, #88] @ (800cfd4 <App_ConfigExecuteLine+0x418>)
|
|
800cf7c: f000 f94a bl 800d214 <App_Printf>
|
|
return;
|
|
800cf80: e019 b.n 800cfb6 <App_ConfigExecuteLine+0x3fa>
|
|
}
|
|
memcpy(g_cfg.syncword, sync, sizeof(sync));
|
|
800cf82: 4b0e ldr r3, [pc, #56] @ (800cfbc <App_ConfigExecuteLine+0x400>)
|
|
800cf84: 3316 adds r3, #22
|
|
800cf86: f107 0208 add.w r2, r7, #8
|
|
800cf8a: 8811 ldrh r1, [r2, #0]
|
|
800cf8c: 7892 ldrb r2, [r2, #2]
|
|
800cf8e: 8019 strh r1, [r3, #0]
|
|
800cf90: 709a strb r2, [r3, #2]
|
|
App_Printf("sync=%02X%02X%02X\r\n", g_cfg.syncword[0], g_cfg.syncword[1], g_cfg.syncword[2]);
|
|
800cf92: 4b0a ldr r3, [pc, #40] @ (800cfbc <App_ConfigExecuteLine+0x400>)
|
|
800cf94: 7d9b ldrb r3, [r3, #22]
|
|
800cf96: 4619 mov r1, r3
|
|
800cf98: 4b08 ldr r3, [pc, #32] @ (800cfbc <App_ConfigExecuteLine+0x400>)
|
|
800cf9a: 7ddb ldrb r3, [r3, #23]
|
|
800cf9c: 461a mov r2, r3
|
|
800cf9e: 4b07 ldr r3, [pc, #28] @ (800cfbc <App_ConfigExecuteLine+0x400>)
|
|
800cfa0: 7e1b ldrb r3, [r3, #24]
|
|
800cfa2: 480d ldr r0, [pc, #52] @ (800cfd8 <App_ConfigExecuteLine+0x41c>)
|
|
800cfa4: f000 f936 bl 800d214 <App_Printf>
|
|
return;
|
|
800cfa8: e005 b.n 800cfb6 <App_ConfigExecuteLine+0x3fa>
|
|
}
|
|
|
|
App_Printf("unknown command: %s\r\n", line);
|
|
800cfaa: 6879 ldr r1, [r7, #4]
|
|
800cfac: 480b ldr r0, [pc, #44] @ (800cfdc <App_ConfigExecuteLine+0x420>)
|
|
800cfae: f000 f931 bl 800d214 <App_Printf>
|
|
800cfb2: e000 b.n 800cfb6 <App_ConfigExecuteLine+0x3fa>
|
|
return;
|
|
800cfb4: bf00 nop
|
|
}
|
|
800cfb6: 3718 adds r7, #24
|
|
800cfb8: 46bd mov sp, r7
|
|
800cfba: bd80 pop {r7, pc}
|
|
800cfbc: 20000604 .word 0x20000604
|
|
800cfc0: 0800fd38 .word 0x0800fd38
|
|
800cfc4: 0800fd48 .word 0x0800fd48
|
|
800cfc8: 0800fd50 .word 0x0800fd50
|
|
800cfcc: 0800fd64 .word 0x0800fd64
|
|
800cfd0: 0800fd84 .word 0x0800fd84
|
|
800cfd4: 0800fd8c .word 0x0800fd8c
|
|
800cfd8: 0800fdb8 .word 0x0800fdb8
|
|
800cfdc: 0800fdcc .word 0x0800fdcc
|
|
|
|
0800cfe0 <App_PrintConfigPrompt>:
|
|
|
|
static void App_PrintConfigPrompt(void)
|
|
{
|
|
800cfe0: b580 push {r7, lr}
|
|
800cfe2: af00 add r7, sp, #0
|
|
if (g_mode == APP_MODE_CONFIG)
|
|
800cfe4: 4b04 ldr r3, [pc, #16] @ (800cff8 <App_PrintConfigPrompt+0x18>)
|
|
800cfe6: 781b ldrb r3, [r3, #0]
|
|
800cfe8: 2b01 cmp r3, #1
|
|
800cfea: d102 bne.n 800cff2 <App_PrintConfigPrompt+0x12>
|
|
{
|
|
App_Printf("cfg> ");
|
|
800cfec: 4803 ldr r0, [pc, #12] @ (800cffc <App_PrintConfigPrompt+0x1c>)
|
|
800cfee: f000 f911 bl 800d214 <App_Printf>
|
|
}
|
|
}
|
|
800cff2: bf00 nop
|
|
800cff4: bd80 pop {r7, pc}
|
|
800cff6: bf00 nop
|
|
800cff8: 20000b90 .word 0x20000b90
|
|
800cffc: 0800fde4 .word 0x0800fde4
|
|
|
|
0800d000 <App_PrintHelp>:
|
|
|
|
static void App_PrintHelp(void)
|
|
{
|
|
800d000: b580 push {r7, lr}
|
|
800d002: af00 add r7, sp, #0
|
|
App_Printf("commands:\r\n");
|
|
800d004: 4817 ldr r0, [pc, #92] @ (800d064 <App_PrintHelp+0x64>)
|
|
800d006: f000 f905 bl 800d214 <App_Printf>
|
|
App_Printf(" help - this help\r\n");
|
|
800d00a: 4817 ldr r0, [pc, #92] @ (800d068 <App_PrintHelp+0x68>)
|
|
800d00c: f000 f902 bl 800d214 <App_Printf>
|
|
App_Printf(" show - current config and counters\r\n");
|
|
800d010: 4816 ldr r0, [pc, #88] @ (800d06c <App_PrintHelp+0x6c>)
|
|
800d012: f000 f8ff bl 800d214 <App_Printf>
|
|
App_Printf(" freq <hz> - rf frequency\r\n");
|
|
800d016: 4816 ldr r0, [pc, #88] @ (800d070 <App_PrintHelp+0x70>)
|
|
800d018: f000 f8fc bl 800d214 <App_Printf>
|
|
App_Printf(" power <dbm> - tx power (-9..22)\r\n");
|
|
800d01c: 4815 ldr r0, [pc, #84] @ (800d074 <App_PrintHelp+0x74>)
|
|
800d01e: f000 f8f9 bl 800d214 <App_Printf>
|
|
App_Printf(" bitrate <bps> - fsk bitrate\r\n");
|
|
800d022: 4815 ldr r0, [pc, #84] @ (800d078 <App_PrintHelp+0x78>)
|
|
800d024: f000 f8f6 bl 800d214 <App_Printf>
|
|
App_Printf(" bandwidth <hz> - fsk rx bandwidth\r\n");
|
|
800d028: 4814 ldr r0, [pc, #80] @ (800d07c <App_PrintHelp+0x7c>)
|
|
800d02a: f000 f8f3 bl 800d214 <App_Printf>
|
|
App_Printf(" fdev <hz> - fsk frequency deviation\r\n");
|
|
800d02e: 4814 ldr r0, [pc, #80] @ (800d080 <App_PrintHelp+0x80>)
|
|
800d030: f000 f8f0 bl 800d214 <App_Printf>
|
|
App_Printf(" preamble <bytes> - fsk preamble length\r\n");
|
|
800d034: 4813 ldr r0, [pc, #76] @ (800d084 <App_PrintHelp+0x84>)
|
|
800d036: f000 f8ed bl 800d214 <App_Printf>
|
|
App_Printf(" sync <hex6> - 3-byte syncword, example C194C1\r\n");
|
|
800d03a: 4813 ldr r0, [pc, #76] @ (800d088 <App_PrintHelp+0x88>)
|
|
800d03c: f000 f8ea bl 800d214 <App_Printf>
|
|
App_Printf(" timeout <ms> - uart silence before rf packet send\r\n");
|
|
800d040: 4812 ldr r0, [pc, #72] @ (800d08c <App_PrintHelp+0x8c>)
|
|
800d042: f000 f8e7 bl 800d214 <App_Printf>
|
|
App_Printf(" uart <baud> - change uart baudrate\r\n");
|
|
800d046: 4812 ldr r0, [pc, #72] @ (800d090 <App_PrintHelp+0x90>)
|
|
800d048: f000 f8e4 bl 800d214 <App_Printf>
|
|
App_Printf(" save - save and apply changes\r\n");
|
|
800d04c: 4811 ldr r0, [pc, #68] @ (800d094 <App_PrintHelp+0x94>)
|
|
800d04e: f000 f8e1 bl 800d214 <App_Printf>
|
|
App_Printf(" defaults - restore default config\r\n");
|
|
800d052: 4811 ldr r0, [pc, #68] @ (800d098 <App_PrintHelp+0x98>)
|
|
800d054: f000 f8de bl 800d214 <App_Printf>
|
|
App_Printf(" exit - return to transparent bridge mode\r\n");
|
|
800d058: 4810 ldr r0, [pc, #64] @ (800d09c <App_PrintHelp+0x9c>)
|
|
800d05a: f000 f8db bl 800d214 <App_Printf>
|
|
}
|
|
800d05e: bf00 nop
|
|
800d060: bd80 pop {r7, pc}
|
|
800d062: bf00 nop
|
|
800d064: 0800fdec .word 0x0800fdec
|
|
800d068: 0800fdf8 .word 0x0800fdf8
|
|
800d06c: 0800fe20 .word 0x0800fe20
|
|
800d070: 0800fe58 .word 0x0800fe58
|
|
800d074: 0800fe80 .word 0x0800fe80
|
|
800d078: 0800feb0 .word 0x0800feb0
|
|
800d07c: 0800fed8 .word 0x0800fed8
|
|
800d080: 0800ff04 .word 0x0800ff04
|
|
800d084: 0800ff38 .word 0x0800ff38
|
|
800d088: 0800ff68 .word 0x0800ff68
|
|
800d08c: 0800ffa4 .word 0x0800ffa4
|
|
800d090: 0800ffe4 .word 0x0800ffe4
|
|
800d094: 08010014 .word 0x08010014
|
|
800d098: 08010048 .word 0x08010048
|
|
800d09c: 0801007c .word 0x0801007c
|
|
|
|
0800d0a0 <App_PrintStatus>:
|
|
|
|
static void App_PrintStatus(void)
|
|
{
|
|
800d0a0: b580 push {r7, lr}
|
|
800d0a2: af00 add r7, sp, #0
|
|
App_Printf("mode=%s\r\n", (g_mode == APP_MODE_CONFIG) ? "config" : "data");
|
|
800d0a4: 4b3d ldr r3, [pc, #244] @ (800d19c <App_PrintStatus+0xfc>)
|
|
800d0a6: 781b ldrb r3, [r3, #0]
|
|
800d0a8: 2b01 cmp r3, #1
|
|
800d0aa: d101 bne.n 800d0b0 <App_PrintStatus+0x10>
|
|
800d0ac: 4b3c ldr r3, [pc, #240] @ (800d1a0 <App_PrintStatus+0x100>)
|
|
800d0ae: e000 b.n 800d0b2 <App_PrintStatus+0x12>
|
|
800d0b0: 4b3c ldr r3, [pc, #240] @ (800d1a4 <App_PrintStatus+0x104>)
|
|
800d0b2: 4619 mov r1, r3
|
|
800d0b4: 483c ldr r0, [pc, #240] @ (800d1a8 <App_PrintStatus+0x108>)
|
|
800d0b6: f000 f8ad bl 800d214 <App_Printf>
|
|
App_Printf("freq=%lu Hz\r\n", (unsigned long)g_cfg.rf_frequency);
|
|
800d0ba: 4b3c ldr r3, [pc, #240] @ (800d1ac <App_PrintStatus+0x10c>)
|
|
800d0bc: 681b ldr r3, [r3, #0]
|
|
800d0be: 4619 mov r1, r3
|
|
800d0c0: 483b ldr r0, [pc, #236] @ (800d1b0 <App_PrintStatus+0x110>)
|
|
800d0c2: f000 f8a7 bl 800d214 <App_Printf>
|
|
App_Printf("power=%d dBm\r\n", g_cfg.tx_power);
|
|
800d0c6: 4b39 ldr r3, [pc, #228] @ (800d1ac <App_PrintStatus+0x10c>)
|
|
800d0c8: f993 3004 ldrsb.w r3, [r3, #4]
|
|
800d0cc: 4619 mov r1, r3
|
|
800d0ce: 4839 ldr r0, [pc, #228] @ (800d1b4 <App_PrintStatus+0x114>)
|
|
800d0d0: f000 f8a0 bl 800d214 <App_Printf>
|
|
App_Printf("bitrate=%lu bps\r\n", (unsigned long)g_cfg.fsk_bitrate);
|
|
800d0d4: 4b35 ldr r3, [pc, #212] @ (800d1ac <App_PrintStatus+0x10c>)
|
|
800d0d6: 689b ldr r3, [r3, #8]
|
|
800d0d8: 4619 mov r1, r3
|
|
800d0da: 4837 ldr r0, [pc, #220] @ (800d1b8 <App_PrintStatus+0x118>)
|
|
800d0dc: f000 f89a bl 800d214 <App_Printf>
|
|
App_Printf("bandwidth=%lu Hz\r\n", (unsigned long)g_cfg.fsk_bandwidth);
|
|
800d0e0: 4b32 ldr r3, [pc, #200] @ (800d1ac <App_PrintStatus+0x10c>)
|
|
800d0e2: 68db ldr r3, [r3, #12]
|
|
800d0e4: 4619 mov r1, r3
|
|
800d0e6: 4835 ldr r0, [pc, #212] @ (800d1bc <App_PrintStatus+0x11c>)
|
|
800d0e8: f000 f894 bl 800d214 <App_Printf>
|
|
App_Printf("fdev=%lu Hz\r\n", (unsigned long)g_cfg.fsk_fdev);
|
|
800d0ec: 4b2f ldr r3, [pc, #188] @ (800d1ac <App_PrintStatus+0x10c>)
|
|
800d0ee: 691b ldr r3, [r3, #16]
|
|
800d0f0: 4619 mov r1, r3
|
|
800d0f2: 4833 ldr r0, [pc, #204] @ (800d1c0 <App_PrintStatus+0x120>)
|
|
800d0f4: f000 f88e bl 800d214 <App_Printf>
|
|
App_Printf("preamble=%u bytes\r\n", g_cfg.fsk_preamble_len);
|
|
800d0f8: 4b2c ldr r3, [pc, #176] @ (800d1ac <App_PrintStatus+0x10c>)
|
|
800d0fa: 8a9b ldrh r3, [r3, #20]
|
|
800d0fc: 4619 mov r1, r3
|
|
800d0fe: 4831 ldr r0, [pc, #196] @ (800d1c4 <App_PrintStatus+0x124>)
|
|
800d100: f000 f888 bl 800d214 <App_Printf>
|
|
App_Printf("sync=%02X%02X%02X\r\n", g_cfg.syncword[0], g_cfg.syncword[1], g_cfg.syncword[2]);
|
|
800d104: 4b29 ldr r3, [pc, #164] @ (800d1ac <App_PrintStatus+0x10c>)
|
|
800d106: 7d9b ldrb r3, [r3, #22]
|
|
800d108: 4619 mov r1, r3
|
|
800d10a: 4b28 ldr r3, [pc, #160] @ (800d1ac <App_PrintStatus+0x10c>)
|
|
800d10c: 7ddb ldrb r3, [r3, #23]
|
|
800d10e: 461a mov r2, r3
|
|
800d110: 4b26 ldr r3, [pc, #152] @ (800d1ac <App_PrintStatus+0x10c>)
|
|
800d112: 7e1b ldrb r3, [r3, #24]
|
|
800d114: 482c ldr r0, [pc, #176] @ (800d1c8 <App_PrintStatus+0x128>)
|
|
800d116: f000 f87d bl 800d214 <App_Printf>
|
|
App_Printf("uart_baud=%lu\r\n", (unsigned long)g_cfg.uart_baudrate);
|
|
800d11a: 4b24 ldr r3, [pc, #144] @ (800d1ac <App_PrintStatus+0x10c>)
|
|
800d11c: 69db ldr r3, [r3, #28]
|
|
800d11e: 4619 mov r1, r3
|
|
800d120: 482a ldr r0, [pc, #168] @ (800d1cc <App_PrintStatus+0x12c>)
|
|
800d122: f000 f877 bl 800d214 <App_Printf>
|
|
App_Printf("uart_pkt_timeout=%u ms\r\n", g_cfg.uart_packet_timeout_ms);
|
|
800d126: 4b21 ldr r3, [pc, #132] @ (800d1ac <App_PrintStatus+0x10c>)
|
|
800d128: 8b5b ldrh r3, [r3, #26]
|
|
800d12a: 4619 mov r1, r3
|
|
800d12c: 4828 ldr r0, [pc, #160] @ (800d1d0 <App_PrintStatus+0x130>)
|
|
800d12e: f000 f871 bl 800d214 <App_Printf>
|
|
App_Printf("tx_queue=%u/%u\r\n", g_tx_q_count, TX_QUEUE_DEPTH);
|
|
800d132: 4b28 ldr r3, [pc, #160] @ (800d1d4 <App_PrintStatus+0x134>)
|
|
800d134: 781b ldrb r3, [r3, #0]
|
|
800d136: 2204 movs r2, #4
|
|
800d138: 4619 mov r1, r3
|
|
800d13a: 4827 ldr r0, [pc, #156] @ (800d1d8 <App_PrintStatus+0x138>)
|
|
800d13c: f000 f86a bl 800d214 <App_Printf>
|
|
App_Printf("last_rx_rssi=%d dBm\r\n", (int)g_last_rx_rssi);
|
|
800d140: 4b26 ldr r3, [pc, #152] @ (800d1dc <App_PrintStatus+0x13c>)
|
|
800d142: 881b ldrh r3, [r3, #0]
|
|
800d144: b21b sxth r3, r3
|
|
800d146: 4619 mov r1, r3
|
|
800d148: 4825 ldr r0, [pc, #148] @ (800d1e0 <App_PrintStatus+0x140>)
|
|
800d14a: f000 f863 bl 800d214 <App_Printf>
|
|
App_Printf("last_rx_cfo=%d\r\n", (int)g_last_rx_cfo);
|
|
800d14e: 4b25 ldr r3, [pc, #148] @ (800d1e4 <App_PrintStatus+0x144>)
|
|
800d150: 781b ldrb r3, [r3, #0]
|
|
800d152: b25b sxtb r3, r3
|
|
800d154: 4619 mov r1, r3
|
|
800d156: 4824 ldr r0, [pc, #144] @ (800d1e8 <App_PrintStatus+0x148>)
|
|
800d158: f000 f85c bl 800d214 <App_Printf>
|
|
App_Printf("stat_uart_packets_tx=%lu\r\n", (unsigned long)g_stat_uart_packets_tx);
|
|
800d15c: 4b23 ldr r3, [pc, #140] @ (800d1ec <App_PrintStatus+0x14c>)
|
|
800d15e: 681b ldr r3, [r3, #0]
|
|
800d160: 4619 mov r1, r3
|
|
800d162: 4823 ldr r0, [pc, #140] @ (800d1f0 <App_PrintStatus+0x150>)
|
|
800d164: f000 f856 bl 800d214 <App_Printf>
|
|
App_Printf("stat_uart_bytes_tx=%lu\r\n", (unsigned long)g_stat_uart_bytes_tx);
|
|
800d168: 4b22 ldr r3, [pc, #136] @ (800d1f4 <App_PrintStatus+0x154>)
|
|
800d16a: 681b ldr r3, [r3, #0]
|
|
800d16c: 4619 mov r1, r3
|
|
800d16e: 4822 ldr r0, [pc, #136] @ (800d1f8 <App_PrintStatus+0x158>)
|
|
800d170: f000 f850 bl 800d214 <App_Printf>
|
|
App_Printf("stat_radio_packets_rx=%lu\r\n", (unsigned long)g_stat_radio_packets_rx);
|
|
800d174: 4b21 ldr r3, [pc, #132] @ (800d1fc <App_PrintStatus+0x15c>)
|
|
800d176: 681b ldr r3, [r3, #0]
|
|
800d178: 4619 mov r1, r3
|
|
800d17a: 4821 ldr r0, [pc, #132] @ (800d200 <App_PrintStatus+0x160>)
|
|
800d17c: f000 f84a bl 800d214 <App_Printf>
|
|
App_Printf("stat_radio_bytes_rx=%lu\r\n", (unsigned long)g_stat_radio_bytes_rx);
|
|
800d180: 4b20 ldr r3, [pc, #128] @ (800d204 <App_PrintStatus+0x164>)
|
|
800d182: 681b ldr r3, [r3, #0]
|
|
800d184: 4619 mov r1, r3
|
|
800d186: 4820 ldr r0, [pc, #128] @ (800d208 <App_PrintStatus+0x168>)
|
|
800d188: f000 f844 bl 800d214 <App_Printf>
|
|
App_Printf("stat_queue_overflow=%lu\r\n", (unsigned long)g_stat_queue_overflow);
|
|
800d18c: 4b1f ldr r3, [pc, #124] @ (800d20c <App_PrintStatus+0x16c>)
|
|
800d18e: 681b ldr r3, [r3, #0]
|
|
800d190: 4619 mov r1, r3
|
|
800d192: 481f ldr r0, [pc, #124] @ (800d210 <App_PrintStatus+0x170>)
|
|
800d194: f000 f83e bl 800d214 <App_Printf>
|
|
}
|
|
800d198: bf00 nop
|
|
800d19a: bd80 pop {r7, pc}
|
|
800d19c: 20000b90 .word 0x20000b90
|
|
800d1a0: 080100bc .word 0x080100bc
|
|
800d1a4: 080100c4 .word 0x080100c4
|
|
800d1a8: 080100cc .word 0x080100cc
|
|
800d1ac: 20000604 .word 0x20000604
|
|
800d1b0: 080100d8 .word 0x080100d8
|
|
800d1b4: 080100e8 .word 0x080100e8
|
|
800d1b8: 080100f8 .word 0x080100f8
|
|
800d1bc: 0801010c .word 0x0801010c
|
|
800d1c0: 08010120 .word 0x08010120
|
|
800d1c4: 08010130 .word 0x08010130
|
|
800d1c8: 0800fdb8 .word 0x0800fdb8
|
|
800d1cc: 08010144 .word 0x08010144
|
|
800d1d0: 08010154 .word 0x08010154
|
|
800d1d4: 20000a9a .word 0x20000a9a
|
|
800d1d8: 08010170 .word 0x08010170
|
|
800d1dc: 2000062a .word 0x2000062a
|
|
800d1e0: 08010184 .word 0x08010184
|
|
800d1e4: 2000062c .word 0x2000062c
|
|
800d1e8: 0801019c .word 0x0801019c
|
|
800d1ec: 20000bf8 .word 0x20000bf8
|
|
800d1f0: 080101b0 .word 0x080101b0
|
|
800d1f4: 20000bfc .word 0x20000bfc
|
|
800d1f8: 080101cc .word 0x080101cc
|
|
800d1fc: 20000c00 .word 0x20000c00
|
|
800d200: 080101e8 .word 0x080101e8
|
|
800d204: 20000c04 .word 0x20000c04
|
|
800d208: 08010204 .word 0x08010204
|
|
800d20c: 20000c08 .word 0x20000c08
|
|
800d210: 08010220 .word 0x08010220
|
|
|
|
0800d214 <App_Printf>:
|
|
|
|
static void App_Printf(const char *fmt, ...)
|
|
{
|
|
800d214: b40f push {r0, r1, r2, r3}
|
|
800d216: b580 push {r7, lr}
|
|
800d218: b0b2 sub sp, #200 @ 0xc8
|
|
800d21a: af00 add r7, sp, #0
|
|
char buffer[192];
|
|
va_list ap;
|
|
int len;
|
|
|
|
va_start(ap, fmt);
|
|
800d21c: f107 03d4 add.w r3, r7, #212 @ 0xd4
|
|
800d220: 603b str r3, [r7, #0]
|
|
len = vsnprintf(buffer, sizeof(buffer), fmt, ap);
|
|
800d222: 1d38 adds r0, r7, #4
|
|
800d224: 683b ldr r3, [r7, #0]
|
|
800d226: f8d7 20d0 ldr.w r2, [r7, #208] @ 0xd0
|
|
800d22a: 21c0 movs r1, #192 @ 0xc0
|
|
800d22c: f001 fe80 bl 800ef30 <vsniprintf>
|
|
800d230: f8c7 00c4 str.w r0, [r7, #196] @ 0xc4
|
|
va_end(ap);
|
|
|
|
if (len <= 0)
|
|
800d234: f8d7 30c4 ldr.w r3, [r7, #196] @ 0xc4
|
|
800d238: 2b00 cmp r3, #0
|
|
800d23a: dd0f ble.n 800d25c <App_Printf+0x48>
|
|
{
|
|
return;
|
|
}
|
|
|
|
if ((size_t)len >= sizeof(buffer))
|
|
800d23c: f8d7 30c4 ldr.w r3, [r7, #196] @ 0xc4
|
|
800d240: 2bbf cmp r3, #191 @ 0xbf
|
|
800d242: d902 bls.n 800d24a <App_Printf+0x36>
|
|
{
|
|
len = (int)(sizeof(buffer) - 1U);
|
|
800d244: 23bf movs r3, #191 @ 0xbf
|
|
800d246: f8c7 30c4 str.w r3, [r7, #196] @ 0xc4
|
|
}
|
|
|
|
App_Write((const uint8_t *)buffer, (uint16_t)len);
|
|
800d24a: f8d7 30c4 ldr.w r3, [r7, #196] @ 0xc4
|
|
800d24e: b29a uxth r2, r3
|
|
800d250: 1d3b adds r3, r7, #4
|
|
800d252: 4611 mov r1, r2
|
|
800d254: 4618 mov r0, r3
|
|
800d256: f000 f809 bl 800d26c <App_Write>
|
|
800d25a: e000 b.n 800d25e <App_Printf+0x4a>
|
|
return;
|
|
800d25c: bf00 nop
|
|
}
|
|
800d25e: 37c8 adds r7, #200 @ 0xc8
|
|
800d260: 46bd mov sp, r7
|
|
800d262: e8bd 4080 ldmia.w sp!, {r7, lr}
|
|
800d266: b004 add sp, #16
|
|
800d268: 4770 bx lr
|
|
...
|
|
|
|
0800d26c <App_Write>:
|
|
|
|
static void App_Write(const uint8_t *data, uint16_t len)
|
|
{
|
|
800d26c: b580 push {r7, lr}
|
|
800d26e: b082 sub sp, #8
|
|
800d270: af00 add r7, sp, #0
|
|
800d272: 6078 str r0, [r7, #4]
|
|
800d274: 460b mov r3, r1
|
|
800d276: 807b strh r3, [r7, #2]
|
|
if ((data == NULL) || (len == 0U))
|
|
800d278: 687b ldr r3, [r7, #4]
|
|
800d27a: 2b00 cmp r3, #0
|
|
800d27c: d00a beq.n 800d294 <App_Write+0x28>
|
|
800d27e: 887b ldrh r3, [r7, #2]
|
|
800d280: 2b00 cmp r3, #0
|
|
800d282: d007 beq.n 800d294 <App_Write+0x28>
|
|
{
|
|
return;
|
|
}
|
|
|
|
(void)HAL_UART_Transmit(&huart2, (uint8_t *)data, len, 1000U);
|
|
800d284: 887a ldrh r2, [r7, #2]
|
|
800d286: f44f 737a mov.w r3, #1000 @ 0x3e8
|
|
800d28a: 6879 ldr r1, [r7, #4]
|
|
800d28c: 4803 ldr r0, [pc, #12] @ (800d29c <App_Write+0x30>)
|
|
800d28e: f7f8 f9f8 bl 8005682 <HAL_UART_Transmit>
|
|
800d292: e000 b.n 800d296 <App_Write+0x2a>
|
|
return;
|
|
800d294: bf00 nop
|
|
}
|
|
800d296: 3708 adds r7, #8
|
|
800d298: 46bd mov sp, r7
|
|
800d29a: bd80 pop {r7, pc}
|
|
800d29c: 200000dc .word 0x200000dc
|
|
|
|
0800d2a0 <App_ReconfigureUart>:
|
|
|
|
static void App_ReconfigureUart(uint32_t baudrate)
|
|
{
|
|
800d2a0: b580 push {r7, lr}
|
|
800d2a2: b082 sub sp, #8
|
|
800d2a4: af00 add r7, sp, #0
|
|
800d2a6: 6078 str r0, [r7, #4]
|
|
huart2.Init.BaudRate = baudrate;
|
|
800d2a8: 4a17 ldr r2, [pc, #92] @ (800d308 <App_ReconfigureUart+0x68>)
|
|
800d2aa: 687b ldr r3, [r7, #4]
|
|
800d2ac: 6053 str r3, [r2, #4]
|
|
|
|
(void)HAL_UART_AbortReceive(&huart2);
|
|
800d2ae: 4816 ldr r0, [pc, #88] @ (800d308 <App_ReconfigureUart+0x68>)
|
|
800d2b0: f7f8 fb4c bl 800594c <HAL_UART_AbortReceive>
|
|
|
|
if (HAL_UART_Init(&huart2) != HAL_OK)
|
|
800d2b4: 4814 ldr r0, [pc, #80] @ (800d308 <App_ReconfigureUart+0x68>)
|
|
800d2b6: f7f8 f994 bl 80055e2 <HAL_UART_Init>
|
|
800d2ba: 4603 mov r3, r0
|
|
800d2bc: 2b00 cmp r3, #0
|
|
800d2be: d001 beq.n 800d2c4 <App_ReconfigureUart+0x24>
|
|
{
|
|
Error_Handler();
|
|
800d2c0: f7f3 fa86 bl 80007d0 <Error_Handler>
|
|
}
|
|
if (HAL_UARTEx_SetTxFifoThreshold(&huart2, UART_TXFIFO_THRESHOLD_1_8) != HAL_OK)
|
|
800d2c4: 2100 movs r1, #0
|
|
800d2c6: 4810 ldr r0, [pc, #64] @ (800d308 <App_ReconfigureUart+0x68>)
|
|
800d2c8: f7fa fc0f bl 8007aea <HAL_UARTEx_SetTxFifoThreshold>
|
|
800d2cc: 4603 mov r3, r0
|
|
800d2ce: 2b00 cmp r3, #0
|
|
800d2d0: d001 beq.n 800d2d6 <App_ReconfigureUart+0x36>
|
|
{
|
|
Error_Handler();
|
|
800d2d2: f7f3 fa7d bl 80007d0 <Error_Handler>
|
|
}
|
|
if (HAL_UARTEx_SetRxFifoThreshold(&huart2, UART_RXFIFO_THRESHOLD_1_8) != HAL_OK)
|
|
800d2d6: 2100 movs r1, #0
|
|
800d2d8: 480b ldr r0, [pc, #44] @ (800d308 <App_ReconfigureUart+0x68>)
|
|
800d2da: f7fa fc44 bl 8007b66 <HAL_UARTEx_SetRxFifoThreshold>
|
|
800d2de: 4603 mov r3, r0
|
|
800d2e0: 2b00 cmp r3, #0
|
|
800d2e2: d001 beq.n 800d2e8 <App_ReconfigureUart+0x48>
|
|
{
|
|
Error_Handler();
|
|
800d2e4: f7f3 fa74 bl 80007d0 <Error_Handler>
|
|
}
|
|
if (HAL_UARTEx_EnableFifoMode(&huart2) != HAL_OK)
|
|
800d2e8: 4807 ldr r0, [pc, #28] @ (800d308 <App_ReconfigureUart+0x68>)
|
|
800d2ea: f7fa fbc3 bl 8007a74 <HAL_UARTEx_EnableFifoMode>
|
|
800d2ee: 4603 mov r3, r0
|
|
800d2f0: 2b00 cmp r3, #0
|
|
800d2f2: d001 beq.n 800d2f8 <App_ReconfigureUart+0x58>
|
|
{
|
|
Error_Handler();
|
|
800d2f4: f7f3 fa6c bl 80007d0 <Error_Handler>
|
|
}
|
|
|
|
(void)vcom_ReceiveInit(UartRxByteCallback);
|
|
800d2f8: 4804 ldr r0, [pc, #16] @ (800d30c <App_ReconfigureUart+0x6c>)
|
|
800d2fa: f7f4 f957 bl 80015ac <vcom_ReceiveInit>
|
|
}
|
|
800d2fe: bf00 nop
|
|
800d300: 3708 adds r7, #8
|
|
800d302: 46bd mov sp, r7
|
|
800d304: bd80 pop {r7, pc}
|
|
800d306: bf00 nop
|
|
800d308: 200000dc .word 0x200000dc
|
|
800d30c: 0800c9b9 .word 0x0800c9b9
|
|
|
|
0800d310 <App_ParseHexSyncWord>:
|
|
|
|
static uint8_t App_ParseHexSyncWord(const char *text, uint8_t out[3])
|
|
{
|
|
800d310: b580 push {r7, lr}
|
|
800d312: b088 sub sp, #32
|
|
800d314: af00 add r7, sp, #0
|
|
800d316: 6078 str r0, [r7, #4]
|
|
800d318: 6039 str r1, [r7, #0]
|
|
char buf[7];
|
|
char *endptr;
|
|
unsigned long value;
|
|
size_t i;
|
|
size_t n = 0U;
|
|
800d31a: 2300 movs r3, #0
|
|
800d31c: 61bb str r3, [r7, #24]
|
|
|
|
if ((text == NULL) || (out == NULL))
|
|
800d31e: 687b ldr r3, [r7, #4]
|
|
800d320: 2b00 cmp r3, #0
|
|
800d322: d002 beq.n 800d32a <App_ParseHexSyncWord+0x1a>
|
|
800d324: 683b ldr r3, [r7, #0]
|
|
800d326: 2b00 cmp r3, #0
|
|
800d328: d117 bne.n 800d35a <App_ParseHexSyncWord+0x4a>
|
|
{
|
|
return 0U;
|
|
800d32a: 2300 movs r3, #0
|
|
800d32c: e05f b.n 800d3ee <App_ParseHexSyncWord+0xde>
|
|
}
|
|
|
|
while ((*text != '\0') && (n < 6U))
|
|
{
|
|
if (isxdigit((unsigned char)*text) != 0)
|
|
800d32e: 687b ldr r3, [r7, #4]
|
|
800d330: 781b ldrb r3, [r3, #0]
|
|
800d332: 3301 adds r3, #1
|
|
800d334: 4a30 ldr r2, [pc, #192] @ (800d3f8 <App_ParseHexSyncWord+0xe8>)
|
|
800d336: 4413 add r3, r2
|
|
800d338: 781b ldrb r3, [r3, #0]
|
|
800d33a: f003 0344 and.w r3, r3, #68 @ 0x44
|
|
800d33e: 2b00 cmp r3, #0
|
|
800d340: d008 beq.n 800d354 <App_ParseHexSyncWord+0x44>
|
|
{
|
|
buf[n++] = *text;
|
|
800d342: 69bb ldr r3, [r7, #24]
|
|
800d344: 1c5a adds r2, r3, #1
|
|
800d346: 61ba str r2, [r7, #24]
|
|
800d348: 687a ldr r2, [r7, #4]
|
|
800d34a: 7812 ldrb r2, [r2, #0]
|
|
800d34c: 3320 adds r3, #32
|
|
800d34e: 443b add r3, r7
|
|
800d350: f803 2c14 strb.w r2, [r3, #-20]
|
|
}
|
|
text++;
|
|
800d354: 687b ldr r3, [r7, #4]
|
|
800d356: 3301 adds r3, #1
|
|
800d358: 607b str r3, [r7, #4]
|
|
while ((*text != '\0') && (n < 6U))
|
|
800d35a: 687b ldr r3, [r7, #4]
|
|
800d35c: 781b ldrb r3, [r3, #0]
|
|
800d35e: 2b00 cmp r3, #0
|
|
800d360: d002 beq.n 800d368 <App_ParseHexSyncWord+0x58>
|
|
800d362: 69bb ldr r3, [r7, #24]
|
|
800d364: 2b05 cmp r3, #5
|
|
800d366: d9e2 bls.n 800d32e <App_ParseHexSyncWord+0x1e>
|
|
}
|
|
|
|
if (n != 6U)
|
|
800d368: 69bb ldr r3, [r7, #24]
|
|
800d36a: 2b06 cmp r3, #6
|
|
800d36c: d001 beq.n 800d372 <App_ParseHexSyncWord+0x62>
|
|
{
|
|
return 0U;
|
|
800d36e: 2300 movs r3, #0
|
|
800d370: e03d b.n 800d3ee <App_ParseHexSyncWord+0xde>
|
|
}
|
|
|
|
for (i = 0U; i < n; i++)
|
|
800d372: 2300 movs r3, #0
|
|
800d374: 61fb str r3, [r7, #28]
|
|
800d376: e011 b.n 800d39c <App_ParseHexSyncWord+0x8c>
|
|
{
|
|
if (isxdigit((unsigned char)buf[i]) == 0)
|
|
800d378: f107 020c add.w r2, r7, #12
|
|
800d37c: 69fb ldr r3, [r7, #28]
|
|
800d37e: 4413 add r3, r2
|
|
800d380: 781b ldrb r3, [r3, #0]
|
|
800d382: 3301 adds r3, #1
|
|
800d384: 4a1c ldr r2, [pc, #112] @ (800d3f8 <App_ParseHexSyncWord+0xe8>)
|
|
800d386: 4413 add r3, r2
|
|
800d388: 781b ldrb r3, [r3, #0]
|
|
800d38a: f003 0344 and.w r3, r3, #68 @ 0x44
|
|
800d38e: 2b00 cmp r3, #0
|
|
800d390: d101 bne.n 800d396 <App_ParseHexSyncWord+0x86>
|
|
{
|
|
return 0U;
|
|
800d392: 2300 movs r3, #0
|
|
800d394: e02b b.n 800d3ee <App_ParseHexSyncWord+0xde>
|
|
for (i = 0U; i < n; i++)
|
|
800d396: 69fb ldr r3, [r7, #28]
|
|
800d398: 3301 adds r3, #1
|
|
800d39a: 61fb str r3, [r7, #28]
|
|
800d39c: 69fa ldr r2, [r7, #28]
|
|
800d39e: 69bb ldr r3, [r7, #24]
|
|
800d3a0: 429a cmp r2, r3
|
|
800d3a2: d3e9 bcc.n 800d378 <App_ParseHexSyncWord+0x68>
|
|
}
|
|
}
|
|
|
|
buf[6] = '\0';
|
|
800d3a4: 2300 movs r3, #0
|
|
800d3a6: 74bb strb r3, [r7, #18]
|
|
value = strtoul(buf, &endptr, 16);
|
|
800d3a8: f107 0108 add.w r1, r7, #8
|
|
800d3ac: f107 030c add.w r3, r7, #12
|
|
800d3b0: 2210 movs r2, #16
|
|
800d3b2: 4618 mov r0, r3
|
|
800d3b4: f001 fd84 bl 800eec0 <strtoul>
|
|
800d3b8: 6178 str r0, [r7, #20]
|
|
if ((endptr == NULL) || (*endptr != '\0'))
|
|
800d3ba: 68bb ldr r3, [r7, #8]
|
|
800d3bc: 2b00 cmp r3, #0
|
|
800d3be: d003 beq.n 800d3c8 <App_ParseHexSyncWord+0xb8>
|
|
800d3c0: 68bb ldr r3, [r7, #8]
|
|
800d3c2: 781b ldrb r3, [r3, #0]
|
|
800d3c4: 2b00 cmp r3, #0
|
|
800d3c6: d001 beq.n 800d3cc <App_ParseHexSyncWord+0xbc>
|
|
{
|
|
return 0U;
|
|
800d3c8: 2300 movs r3, #0
|
|
800d3ca: e010 b.n 800d3ee <App_ParseHexSyncWord+0xde>
|
|
}
|
|
|
|
out[0] = (uint8_t)((value >> 16) & 0xFFU);
|
|
800d3cc: 697b ldr r3, [r7, #20]
|
|
800d3ce: 0c1b lsrs r3, r3, #16
|
|
800d3d0: b2da uxtb r2, r3
|
|
800d3d2: 683b ldr r3, [r7, #0]
|
|
800d3d4: 701a strb r2, [r3, #0]
|
|
out[1] = (uint8_t)((value >> 8) & 0xFFU);
|
|
800d3d6: 697b ldr r3, [r7, #20]
|
|
800d3d8: 0a1a lsrs r2, r3, #8
|
|
800d3da: 683b ldr r3, [r7, #0]
|
|
800d3dc: 3301 adds r3, #1
|
|
800d3de: b2d2 uxtb r2, r2
|
|
800d3e0: 701a strb r2, [r3, #0]
|
|
out[2] = (uint8_t)(value & 0xFFU);
|
|
800d3e2: 683b ldr r3, [r7, #0]
|
|
800d3e4: 3302 adds r3, #2
|
|
800d3e6: 697a ldr r2, [r7, #20]
|
|
800d3e8: b2d2 uxtb r2, r2
|
|
800d3ea: 701a strb r2, [r3, #0]
|
|
return 1U;
|
|
800d3ec: 2301 movs r3, #1
|
|
}
|
|
800d3ee: 4618 mov r0, r3
|
|
800d3f0: 3720 adds r7, #32
|
|
800d3f2: 46bd mov sp, r7
|
|
800d3f4: bd80 pop {r7, pc}
|
|
800d3f6: bf00 nop
|
|
800d3f8: 08010518 .word 0x08010518
|
|
|
|
0800d3fc <App_SkipSpaces>:
|
|
|
|
static char *App_SkipSpaces(char *s)
|
|
{
|
|
800d3fc: b480 push {r7}
|
|
800d3fe: b083 sub sp, #12
|
|
800d400: af00 add r7, sp, #0
|
|
800d402: 6078 str r0, [r7, #4]
|
|
while ((s != NULL) && (*s != '\0') && isspace((unsigned char)*s))
|
|
800d404: e002 b.n 800d40c <App_SkipSpaces+0x10>
|
|
{
|
|
s++;
|
|
800d406: 687b ldr r3, [r7, #4]
|
|
800d408: 3301 adds r3, #1
|
|
800d40a: 607b str r3, [r7, #4]
|
|
while ((s != NULL) && (*s != '\0') && isspace((unsigned char)*s))
|
|
800d40c: 687b ldr r3, [r7, #4]
|
|
800d40e: 2b00 cmp r3, #0
|
|
800d410: d00d beq.n 800d42e <App_SkipSpaces+0x32>
|
|
800d412: 687b ldr r3, [r7, #4]
|
|
800d414: 781b ldrb r3, [r3, #0]
|
|
800d416: 2b00 cmp r3, #0
|
|
800d418: d009 beq.n 800d42e <App_SkipSpaces+0x32>
|
|
800d41a: 687b ldr r3, [r7, #4]
|
|
800d41c: 781b ldrb r3, [r3, #0]
|
|
800d41e: 3301 adds r3, #1
|
|
800d420: 4a06 ldr r2, [pc, #24] @ (800d43c <App_SkipSpaces+0x40>)
|
|
800d422: 4413 add r3, r2
|
|
800d424: 781b ldrb r3, [r3, #0]
|
|
800d426: f003 0308 and.w r3, r3, #8
|
|
800d42a: 2b00 cmp r3, #0
|
|
800d42c: d1eb bne.n 800d406 <App_SkipSpaces+0xa>
|
|
}
|
|
return s;
|
|
800d42e: 687b ldr r3, [r7, #4]
|
|
}
|
|
800d430: 4618 mov r0, r3
|
|
800d432: 370c adds r7, #12
|
|
800d434: 46bd mov sp, r7
|
|
800d436: bc80 pop {r7}
|
|
800d438: 4770 bx lr
|
|
800d43a: bf00 nop
|
|
800d43c: 08010518 .word 0x08010518
|
|
|
|
0800d440 <App_LedTxPulse>:
|
|
|
|
static void App_LedTxPulse(void)
|
|
{
|
|
800d440: b580 push {r7, lr}
|
|
800d442: af00 add r7, sp, #0
|
|
HAL_GPIO_WritePin(LED1_GPIO_Port, LED1_Pin, GPIO_PIN_SET);
|
|
800d444: 2201 movs r2, #1
|
|
800d446: f44f 4100 mov.w r1, #32768 @ 0x8000
|
|
800d44a: 4807 ldr r0, [pc, #28] @ (800d468 <App_LedTxPulse+0x28>)
|
|
800d44c: f7f5 fc3c bl 8002cc8 <HAL_GPIO_WritePin>
|
|
g_led_tx_until = HAL_GetTick() + LED_PULSE_MS;
|
|
800d450: f7f3 fbfa bl 8000c48 <HAL_GetTick>
|
|
800d454: 4603 mov r3, r0
|
|
800d456: 3332 adds r3, #50 @ 0x32
|
|
800d458: 4a04 ldr r2, [pc, #16] @ (800d46c <App_LedTxPulse+0x2c>)
|
|
800d45a: 6013 str r3, [r2, #0]
|
|
g_led_tx_active = 1U;
|
|
800d45c: 4b04 ldr r3, [pc, #16] @ (800d470 <App_LedTxPulse+0x30>)
|
|
800d45e: 2201 movs r2, #1
|
|
800d460: 701a strb r2, [r3, #0]
|
|
}
|
|
800d462: bf00 nop
|
|
800d464: bd80 pop {r7, pc}
|
|
800d466: bf00 nop
|
|
800d468: 48000400 .word 0x48000400
|
|
800d46c: 20000630 .word 0x20000630
|
|
800d470: 2000063c .word 0x2000063c
|
|
|
|
0800d474 <App_LedRxPulse>:
|
|
|
|
static void App_LedRxPulse(void)
|
|
{
|
|
800d474: b580 push {r7, lr}
|
|
800d476: af00 add r7, sp, #0
|
|
HAL_GPIO_WritePin(LED2_GPIO_Port, LED2_Pin, GPIO_PIN_SET);
|
|
800d478: 2201 movs r2, #1
|
|
800d47a: f44f 7100 mov.w r1, #512 @ 0x200
|
|
800d47e: 4807 ldr r0, [pc, #28] @ (800d49c <App_LedRxPulse+0x28>)
|
|
800d480: f7f5 fc22 bl 8002cc8 <HAL_GPIO_WritePin>
|
|
g_led_rx_until = HAL_GetTick() + LED_PULSE_MS;
|
|
800d484: f7f3 fbe0 bl 8000c48 <HAL_GetTick>
|
|
800d488: 4603 mov r3, r0
|
|
800d48a: 3332 adds r3, #50 @ 0x32
|
|
800d48c: 4a04 ldr r2, [pc, #16] @ (800d4a0 <App_LedRxPulse+0x2c>)
|
|
800d48e: 6013 str r3, [r2, #0]
|
|
g_led_rx_active = 1U;
|
|
800d490: 4b04 ldr r3, [pc, #16] @ (800d4a4 <App_LedRxPulse+0x30>)
|
|
800d492: 2201 movs r2, #1
|
|
800d494: 701a strb r2, [r3, #0]
|
|
}
|
|
800d496: bf00 nop
|
|
800d498: bd80 pop {r7, pc}
|
|
800d49a: bf00 nop
|
|
800d49c: 48000400 .word 0x48000400
|
|
800d4a0: 20000634 .word 0x20000634
|
|
800d4a4: 2000063d .word 0x2000063d
|
|
|
|
0800d4a8 <App_LedErrPulse>:
|
|
|
|
static void App_LedErrPulse(void)
|
|
{
|
|
800d4a8: b580 push {r7, lr}
|
|
800d4aa: af00 add r7, sp, #0
|
|
HAL_GPIO_WritePin(LED3_GPIO_Port, LED3_Pin, GPIO_PIN_SET);
|
|
800d4ac: 2201 movs r2, #1
|
|
800d4ae: f44f 6100 mov.w r1, #2048 @ 0x800
|
|
800d4b2: 4807 ldr r0, [pc, #28] @ (800d4d0 <App_LedErrPulse+0x28>)
|
|
800d4b4: f7f5 fc08 bl 8002cc8 <HAL_GPIO_WritePin>
|
|
g_led_err_until = HAL_GetTick() + LED_PULSE_MS;
|
|
800d4b8: f7f3 fbc6 bl 8000c48 <HAL_GetTick>
|
|
800d4bc: 4603 mov r3, r0
|
|
800d4be: 3332 adds r3, #50 @ 0x32
|
|
800d4c0: 4a04 ldr r2, [pc, #16] @ (800d4d4 <App_LedErrPulse+0x2c>)
|
|
800d4c2: 6013 str r3, [r2, #0]
|
|
g_led_err_active = 1U;
|
|
800d4c4: 4b04 ldr r3, [pc, #16] @ (800d4d8 <App_LedErrPulse+0x30>)
|
|
800d4c6: 2201 movs r2, #1
|
|
800d4c8: 701a strb r2, [r3, #0]
|
|
}
|
|
800d4ca: bf00 nop
|
|
800d4cc: bd80 pop {r7, pc}
|
|
800d4ce: bf00 nop
|
|
800d4d0: 48000400 .word 0x48000400
|
|
800d4d4: 20000638 .word 0x20000638
|
|
800d4d8: 2000063e .word 0x2000063e
|
|
|
|
0800d4dc <App_ProcessLeds>:
|
|
|
|
static void App_ProcessLeds(void)
|
|
{
|
|
800d4dc: b580 push {r7, lr}
|
|
800d4de: b082 sub sp, #8
|
|
800d4e0: af00 add r7, sp, #0
|
|
uint32_t now = HAL_GetTick();
|
|
800d4e2: f7f3 fbb1 bl 8000c48 <HAL_GetTick>
|
|
800d4e6: 6078 str r0, [r7, #4]
|
|
|
|
if (g_led_tx_active && ((int32_t)(now - g_led_tx_until) >= 0))
|
|
800d4e8: 4b1e ldr r3, [pc, #120] @ (800d564 <App_ProcessLeds+0x88>)
|
|
800d4ea: 781b ldrb r3, [r3, #0]
|
|
800d4ec: 2b00 cmp r3, #0
|
|
800d4ee: d00e beq.n 800d50e <App_ProcessLeds+0x32>
|
|
800d4f0: 4b1d ldr r3, [pc, #116] @ (800d568 <App_ProcessLeds+0x8c>)
|
|
800d4f2: 681b ldr r3, [r3, #0]
|
|
800d4f4: 687a ldr r2, [r7, #4]
|
|
800d4f6: 1ad3 subs r3, r2, r3
|
|
800d4f8: 2b00 cmp r3, #0
|
|
800d4fa: db08 blt.n 800d50e <App_ProcessLeds+0x32>
|
|
{
|
|
HAL_GPIO_WritePin(LED1_GPIO_Port, LED1_Pin, GPIO_PIN_RESET);
|
|
800d4fc: 2200 movs r2, #0
|
|
800d4fe: f44f 4100 mov.w r1, #32768 @ 0x8000
|
|
800d502: 481a ldr r0, [pc, #104] @ (800d56c <App_ProcessLeds+0x90>)
|
|
800d504: f7f5 fbe0 bl 8002cc8 <HAL_GPIO_WritePin>
|
|
g_led_tx_active = 0U;
|
|
800d508: 4b16 ldr r3, [pc, #88] @ (800d564 <App_ProcessLeds+0x88>)
|
|
800d50a: 2200 movs r2, #0
|
|
800d50c: 701a strb r2, [r3, #0]
|
|
}
|
|
|
|
if (g_led_rx_active && ((int32_t)(now - g_led_rx_until) >= 0))
|
|
800d50e: 4b18 ldr r3, [pc, #96] @ (800d570 <App_ProcessLeds+0x94>)
|
|
800d510: 781b ldrb r3, [r3, #0]
|
|
800d512: 2b00 cmp r3, #0
|
|
800d514: d00e beq.n 800d534 <App_ProcessLeds+0x58>
|
|
800d516: 4b17 ldr r3, [pc, #92] @ (800d574 <App_ProcessLeds+0x98>)
|
|
800d518: 681b ldr r3, [r3, #0]
|
|
800d51a: 687a ldr r2, [r7, #4]
|
|
800d51c: 1ad3 subs r3, r2, r3
|
|
800d51e: 2b00 cmp r3, #0
|
|
800d520: db08 blt.n 800d534 <App_ProcessLeds+0x58>
|
|
{
|
|
HAL_GPIO_WritePin(LED2_GPIO_Port, LED2_Pin, GPIO_PIN_RESET);
|
|
800d522: 2200 movs r2, #0
|
|
800d524: f44f 7100 mov.w r1, #512 @ 0x200
|
|
800d528: 4810 ldr r0, [pc, #64] @ (800d56c <App_ProcessLeds+0x90>)
|
|
800d52a: f7f5 fbcd bl 8002cc8 <HAL_GPIO_WritePin>
|
|
g_led_rx_active = 0U;
|
|
800d52e: 4b10 ldr r3, [pc, #64] @ (800d570 <App_ProcessLeds+0x94>)
|
|
800d530: 2200 movs r2, #0
|
|
800d532: 701a strb r2, [r3, #0]
|
|
}
|
|
|
|
if (g_led_err_active && ((int32_t)(now - g_led_err_until) >= 0))
|
|
800d534: 4b10 ldr r3, [pc, #64] @ (800d578 <App_ProcessLeds+0x9c>)
|
|
800d536: 781b ldrb r3, [r3, #0]
|
|
800d538: 2b00 cmp r3, #0
|
|
800d53a: d00e beq.n 800d55a <App_ProcessLeds+0x7e>
|
|
800d53c: 4b0f ldr r3, [pc, #60] @ (800d57c <App_ProcessLeds+0xa0>)
|
|
800d53e: 681b ldr r3, [r3, #0]
|
|
800d540: 687a ldr r2, [r7, #4]
|
|
800d542: 1ad3 subs r3, r2, r3
|
|
800d544: 2b00 cmp r3, #0
|
|
800d546: db08 blt.n 800d55a <App_ProcessLeds+0x7e>
|
|
{
|
|
HAL_GPIO_WritePin(LED3_GPIO_Port, LED3_Pin, GPIO_PIN_RESET);
|
|
800d548: 2200 movs r2, #0
|
|
800d54a: f44f 6100 mov.w r1, #2048 @ 0x800
|
|
800d54e: 4807 ldr r0, [pc, #28] @ (800d56c <App_ProcessLeds+0x90>)
|
|
800d550: f7f5 fbba bl 8002cc8 <HAL_GPIO_WritePin>
|
|
g_led_err_active = 0U;
|
|
800d554: 4b08 ldr r3, [pc, #32] @ (800d578 <App_ProcessLeds+0x9c>)
|
|
800d556: 2200 movs r2, #0
|
|
800d558: 701a strb r2, [r3, #0]
|
|
}
|
|
}
|
|
800d55a: bf00 nop
|
|
800d55c: 3708 adds r7, #8
|
|
800d55e: 46bd mov sp, r7
|
|
800d560: bd80 pop {r7, pc}
|
|
800d562: bf00 nop
|
|
800d564: 2000063c .word 0x2000063c
|
|
800d568: 20000630 .word 0x20000630
|
|
800d56c: 48000400 .word 0x48000400
|
|
800d570: 2000063d .word 0x2000063d
|
|
800d574: 20000634 .word 0x20000634
|
|
800d578: 2000063e .word 0x2000063e
|
|
800d57c: 20000638 .word 0x20000638
|
|
|
|
0800d580 <OnTxDone>:
|
|
|
|
|
|
static void OnTxDone(void)
|
|
{
|
|
800d580: b480 push {r7}
|
|
800d582: af00 add r7, sp, #0
|
|
g_radio_tx_done = 1U;
|
|
800d584: 4b03 ldr r3, [pc, #12] @ (800d594 <OnTxDone+0x14>)
|
|
800d586: 2201 movs r2, #1
|
|
800d588: 701a strb r2, [r3, #0]
|
|
}
|
|
800d58a: bf00 nop
|
|
800d58c: 46bd mov sp, r7
|
|
800d58e: bc80 pop {r7}
|
|
800d590: 4770 bx lr
|
|
800d592: bf00 nop
|
|
800d594: 20000624 .word 0x20000624
|
|
|
|
0800d598 <OnRxDone>:
|
|
|
|
static void OnRxDone(uint8_t *payload, uint16_t size, int16_t rssi, int8_t cfo)
|
|
{
|
|
800d598: b580 push {r7, lr}
|
|
800d59a: b084 sub sp, #16
|
|
800d59c: af00 add r7, sp, #0
|
|
800d59e: 60f8 str r0, [r7, #12]
|
|
800d5a0: 4608 mov r0, r1
|
|
800d5a2: 4611 mov r1, r2
|
|
800d5a4: 461a mov r2, r3
|
|
800d5a6: 4603 mov r3, r0
|
|
800d5a8: 817b strh r3, [r7, #10]
|
|
800d5aa: 460b mov r3, r1
|
|
800d5ac: 813b strh r3, [r7, #8]
|
|
800d5ae: 4613 mov r3, r2
|
|
800d5b0: 71fb strb r3, [r7, #7]
|
|
g_last_rx_rssi = rssi;
|
|
800d5b2: 4a0d ldr r2, [pc, #52] @ (800d5e8 <OnRxDone+0x50>)
|
|
800d5b4: 893b ldrh r3, [r7, #8]
|
|
800d5b6: 8013 strh r3, [r2, #0]
|
|
g_last_rx_cfo = cfo;
|
|
800d5b8: 4a0c ldr r2, [pc, #48] @ (800d5ec <OnRxDone+0x54>)
|
|
800d5ba: 79fb ldrb r3, [r7, #7]
|
|
800d5bc: 7013 strb r3, [r2, #0]
|
|
|
|
if (size > RADIO_MAX_PAYLOAD_SIZE)
|
|
800d5be: 897b ldrh r3, [r7, #10]
|
|
800d5c0: 2bdc cmp r3, #220 @ 0xdc
|
|
800d5c2: d901 bls.n 800d5c8 <OnRxDone+0x30>
|
|
{
|
|
size = RADIO_MAX_PAYLOAD_SIZE;
|
|
800d5c4: 23dc movs r3, #220 @ 0xdc
|
|
800d5c6: 817b strh r3, [r7, #10]
|
|
}
|
|
|
|
memcpy(g_rx_payload, payload, size);
|
|
800d5c8: 897b ldrh r3, [r7, #10]
|
|
800d5ca: 461a mov r2, r3
|
|
800d5cc: 68f9 ldr r1, [r7, #12]
|
|
800d5ce: 4808 ldr r0, [pc, #32] @ (800d5f0 <OnRxDone+0x58>)
|
|
800d5d0: f001 fd02 bl 800efd8 <memcpy>
|
|
g_rx_payload_len = size;
|
|
800d5d4: 4a07 ldr r2, [pc, #28] @ (800d5f4 <OnRxDone+0x5c>)
|
|
800d5d6: 897b ldrh r3, [r7, #10]
|
|
800d5d8: 8013 strh r3, [r2, #0]
|
|
g_radio_rx_done = 1U;
|
|
800d5da: 4b07 ldr r3, [pc, #28] @ (800d5f8 <OnRxDone+0x60>)
|
|
800d5dc: 2201 movs r2, #1
|
|
800d5de: 701a strb r2, [r3, #0]
|
|
}
|
|
800d5e0: bf00 nop
|
|
800d5e2: 3710 adds r7, #16
|
|
800d5e4: 46bd mov sp, r7
|
|
800d5e6: bd80 pop {r7, pc}
|
|
800d5e8: 2000062a .word 0x2000062a
|
|
800d5ec: 2000062c .word 0x2000062c
|
|
800d5f0: 20000644 .word 0x20000644
|
|
800d5f4: 20000720 .word 0x20000720
|
|
800d5f8: 20000626 .word 0x20000626
|
|
|
|
0800d5fc <OnTxTimeout>:
|
|
|
|
static void OnTxTimeout(void)
|
|
{
|
|
800d5fc: b480 push {r7}
|
|
800d5fe: af00 add r7, sp, #0
|
|
g_radio_tx_timeout = 1U;
|
|
800d600: 4b03 ldr r3, [pc, #12] @ (800d610 <OnTxTimeout+0x14>)
|
|
800d602: 2201 movs r2, #1
|
|
800d604: 701a strb r2, [r3, #0]
|
|
}
|
|
800d606: bf00 nop
|
|
800d608: 46bd mov sp, r7
|
|
800d60a: bc80 pop {r7}
|
|
800d60c: 4770 bx lr
|
|
800d60e: bf00 nop
|
|
800d610: 20000625 .word 0x20000625
|
|
|
|
0800d614 <OnRxTimeout>:
|
|
|
|
static void OnRxTimeout(void)
|
|
{
|
|
800d614: b480 push {r7}
|
|
800d616: af00 add r7, sp, #0
|
|
g_radio_rx_timeout = 1U;
|
|
800d618: 4b03 ldr r3, [pc, #12] @ (800d628 <OnRxTimeout+0x14>)
|
|
800d61a: 2201 movs r2, #1
|
|
800d61c: 701a strb r2, [r3, #0]
|
|
}
|
|
800d61e: bf00 nop
|
|
800d620: 46bd mov sp, r7
|
|
800d622: bc80 pop {r7}
|
|
800d624: 4770 bx lr
|
|
800d626: bf00 nop
|
|
800d628: 20000627 .word 0x20000627
|
|
|
|
0800d62c <OnRxError>:
|
|
|
|
static void OnRxError(void)
|
|
{
|
|
800d62c: b480 push {r7}
|
|
800d62e: af00 add r7, sp, #0
|
|
g_radio_rx_error = 1U;
|
|
800d630: 4b03 ldr r3, [pc, #12] @ (800d640 <OnRxError+0x14>)
|
|
800d632: 2201 movs r2, #1
|
|
800d634: 701a strb r2, [r3, #0]
|
|
}
|
|
800d636: bf00 nop
|
|
800d638: 46bd mov sp, r7
|
|
800d63a: bc80 pop {r7}
|
|
800d63c: 4770 bx lr
|
|
800d63e: bf00 nop
|
|
800d640: 20000628 .word 0x20000628
|
|
|
|
0800d644 <Config_LoadDefaults>:
|
|
#include "config_defaults.h"
|
|
|
|
#include <string.h>
|
|
|
|
void Config_LoadDefaults(BridgeConfig_t *cfg)
|
|
{
|
|
800d644: b480 push {r7}
|
|
800d646: b083 sub sp, #12
|
|
800d648: af00 add r7, sp, #0
|
|
800d64a: 6078 str r0, [r7, #4]
|
|
if (cfg == 0)
|
|
800d64c: 687b ldr r3, [r7, #4]
|
|
800d64e: 2b00 cmp r3, #0
|
|
800d650: d023 beq.n 800d69a <Config_LoadDefaults+0x56>
|
|
{
|
|
return;
|
|
}
|
|
cfg->rf_frequency = DEFAULT_RF_FREQUENCY;
|
|
800d652: 687b ldr r3, [r7, #4]
|
|
800d654: 4a13 ldr r2, [pc, #76] @ (800d6a4 <Config_LoadDefaults+0x60>)
|
|
800d656: 601a str r2, [r3, #0]
|
|
cfg->tx_power = DEFAULT_TX_OUTPUT_POWER;
|
|
800d658: 687b ldr r3, [r7, #4]
|
|
800d65a: 220e movs r2, #14
|
|
800d65c: 711a strb r2, [r3, #4]
|
|
cfg->fsk_bitrate = DEFAULT_FSK_BITRATE;
|
|
800d65e: 687b ldr r3, [r7, #4]
|
|
800d660: f24c 3250 movw r2, #50000 @ 0xc350
|
|
800d664: 609a str r2, [r3, #8]
|
|
cfg->fsk_bandwidth = DEFAULT_FSK_BANDWIDTH;
|
|
800d666: 687b ldr r3, [r7, #4]
|
|
800d668: f24c 3250 movw r2, #50000 @ 0xc350
|
|
800d66c: 60da str r2, [r3, #12]
|
|
cfg->fsk_fdev = DEFAULT_FSK_FDEV;
|
|
800d66e: 687b ldr r3, [r7, #4]
|
|
800d670: f246 12a8 movw r2, #25000 @ 0x61a8
|
|
800d674: 611a str r2, [r3, #16]
|
|
cfg->fsk_preamble_len = DEFAULT_FSK_PREAMBLE_LENGTH;
|
|
800d676: 687b ldr r3, [r7, #4]
|
|
800d678: 2204 movs r2, #4
|
|
800d67a: 829a strh r2, [r3, #20]
|
|
static const uint8_t default_syncword[3] = DEFAULT_SYNCWORD;
|
|
memcpy(cfg->syncword, default_syncword, sizeof(cfg->syncword));
|
|
800d67c: 687b ldr r3, [r7, #4]
|
|
800d67e: 3316 adds r3, #22
|
|
800d680: 4a09 ldr r2, [pc, #36] @ (800d6a8 <Config_LoadDefaults+0x64>)
|
|
800d682: 8811 ldrh r1, [r2, #0]
|
|
800d684: 7892 ldrb r2, [r2, #2]
|
|
800d686: 8019 strh r1, [r3, #0]
|
|
800d688: 709a strb r2, [r3, #2]
|
|
cfg->uart_packet_timeout_ms = DEFAULT_UART_PACKET_TIMEOUT_MS;
|
|
800d68a: 687b ldr r3, [r7, #4]
|
|
800d68c: 2214 movs r2, #20
|
|
800d68e: 835a strh r2, [r3, #26]
|
|
cfg->uart_baudrate = DEFAULT_UART_BAUDRATE;
|
|
800d690: 687b ldr r3, [r7, #4]
|
|
800d692: f44f 32e1 mov.w r2, #115200 @ 0x1c200
|
|
800d696: 61da str r2, [r3, #28]
|
|
800d698: e000 b.n 800d69c <Config_LoadDefaults+0x58>
|
|
return;
|
|
800d69a: bf00 nop
|
|
800d69c: 370c adds r7, #12
|
|
800d69e: 46bd mov sp, r7
|
|
800d6a0: bc80 pop {r7}
|
|
800d6a2: 4770 bx lr
|
|
800d6a4: 19d094e0 .word 0x19d094e0
|
|
800d6a8: 08010504 .word 0x08010504
|
|
|
|
0800d6ac <Config_CalcChecksum>:
|
|
uint32_t checksum;
|
|
BridgeConfig_t cfg;
|
|
} FlashConfig_t;
|
|
|
|
static uint32_t Config_CalcChecksum(const uint8_t *data, uint32_t len)
|
|
{
|
|
800d6ac: b480 push {r7}
|
|
800d6ae: b085 sub sp, #20
|
|
800d6b0: af00 add r7, sp, #0
|
|
800d6b2: 6078 str r0, [r7, #4]
|
|
800d6b4: 6039 str r1, [r7, #0]
|
|
uint32_t sum = 0;
|
|
800d6b6: 2300 movs r3, #0
|
|
800d6b8: 60fb str r3, [r7, #12]
|
|
uint32_t i;
|
|
|
|
for (i = 0; i < len; i++)
|
|
800d6ba: 2300 movs r3, #0
|
|
800d6bc: 60bb str r3, [r7, #8]
|
|
800d6be: e00a b.n 800d6d6 <Config_CalcChecksum+0x2a>
|
|
{
|
|
sum += data[i];
|
|
800d6c0: 687a ldr r2, [r7, #4]
|
|
800d6c2: 68bb ldr r3, [r7, #8]
|
|
800d6c4: 4413 add r3, r2
|
|
800d6c6: 781b ldrb r3, [r3, #0]
|
|
800d6c8: 461a mov r2, r3
|
|
800d6ca: 68fb ldr r3, [r7, #12]
|
|
800d6cc: 4413 add r3, r2
|
|
800d6ce: 60fb str r3, [r7, #12]
|
|
for (i = 0; i < len; i++)
|
|
800d6d0: 68bb ldr r3, [r7, #8]
|
|
800d6d2: 3301 adds r3, #1
|
|
800d6d4: 60bb str r3, [r7, #8]
|
|
800d6d6: 68ba ldr r2, [r7, #8]
|
|
800d6d8: 683b ldr r3, [r7, #0]
|
|
800d6da: 429a cmp r2, r3
|
|
800d6dc: d3f0 bcc.n 800d6c0 <Config_CalcChecksum+0x14>
|
|
}
|
|
|
|
return sum;
|
|
800d6de: 68fb ldr r3, [r7, #12]
|
|
}
|
|
800d6e0: 4618 mov r0, r3
|
|
800d6e2: 3714 adds r7, #20
|
|
800d6e4: 46bd mov sp, r7
|
|
800d6e6: bc80 pop {r7}
|
|
800d6e8: 4770 bx lr
|
|
...
|
|
|
|
0800d6ec <Config_Load>:
|
|
|
|
bool Config_Load(BridgeConfig_t *cfg)
|
|
{
|
|
800d6ec: b580 push {r7, lr}
|
|
800d6ee: b084 sub sp, #16
|
|
800d6f0: af00 add r7, sp, #0
|
|
800d6f2: 6078 str r0, [r7, #4]
|
|
const FlashConfig_t *stored;
|
|
uint32_t calc;
|
|
|
|
if (cfg == 0)
|
|
800d6f4: 687b ldr r3, [r7, #4]
|
|
800d6f6: 2b00 cmp r3, #0
|
|
800d6f8: d101 bne.n 800d6fe <Config_Load+0x12>
|
|
{
|
|
return false;
|
|
800d6fa: 2300 movs r3, #0
|
|
800d6fc: e01e b.n 800d73c <Config_Load+0x50>
|
|
}
|
|
|
|
stored = (const FlashConfig_t *)CONFIG_FLASH_ADDR;
|
|
800d6fe: 4b11 ldr r3, [pc, #68] @ (800d744 <Config_Load+0x58>)
|
|
800d700: 60fb str r3, [r7, #12]
|
|
|
|
if (stored->magic != CONFIG_MAGIC)
|
|
800d702: 68fb ldr r3, [r7, #12]
|
|
800d704: 681b ldr r3, [r3, #0]
|
|
800d706: 4a10 ldr r2, [pc, #64] @ (800d748 <Config_Load+0x5c>)
|
|
800d708: 4293 cmp r3, r2
|
|
800d70a: d001 beq.n 800d710 <Config_Load+0x24>
|
|
{
|
|
return false;
|
|
800d70c: 2300 movs r3, #0
|
|
800d70e: e015 b.n 800d73c <Config_Load+0x50>
|
|
}
|
|
|
|
calc = Config_CalcChecksum((const uint8_t *)&stored->cfg, sizeof(BridgeConfig_t));
|
|
800d710: 68fb ldr r3, [r7, #12]
|
|
800d712: 3308 adds r3, #8
|
|
800d714: 2120 movs r1, #32
|
|
800d716: 4618 mov r0, r3
|
|
800d718: f7ff ffc8 bl 800d6ac <Config_CalcChecksum>
|
|
800d71c: 60b8 str r0, [r7, #8]
|
|
|
|
if (calc != stored->checksum)
|
|
800d71e: 68fb ldr r3, [r7, #12]
|
|
800d720: 685b ldr r3, [r3, #4]
|
|
800d722: 68ba ldr r2, [r7, #8]
|
|
800d724: 429a cmp r2, r3
|
|
800d726: d001 beq.n 800d72c <Config_Load+0x40>
|
|
{
|
|
return false;
|
|
800d728: 2300 movs r3, #0
|
|
800d72a: e007 b.n 800d73c <Config_Load+0x50>
|
|
}
|
|
|
|
memcpy(cfg, &stored->cfg, sizeof(BridgeConfig_t));
|
|
800d72c: 68fb ldr r3, [r7, #12]
|
|
800d72e: 3308 adds r3, #8
|
|
800d730: 2220 movs r2, #32
|
|
800d732: 4619 mov r1, r3
|
|
800d734: 6878 ldr r0, [r7, #4]
|
|
800d736: f001 fc4f bl 800efd8 <memcpy>
|
|
return true;
|
|
800d73a: 2301 movs r3, #1
|
|
}
|
|
800d73c: 4618 mov r0, r3
|
|
800d73e: 3710 adds r7, #16
|
|
800d740: 46bd mov sp, r7
|
|
800d742: bd80 pop {r7, pc}
|
|
800d744: 0803f800 .word 0x0803f800
|
|
800d748: 43464731 .word 0x43464731
|
|
|
|
0800d74c <Config_Save>:
|
|
|
|
bool Config_Save(const BridgeConfig_t *cfg)
|
|
{
|
|
800d74c: b580 push {r7, lr}
|
|
800d74e: b094 sub sp, #80 @ 0x50
|
|
800d750: af00 add r7, sp, #0
|
|
800d752: 6078 str r0, [r7, #4]
|
|
FlashConfig_t temp;
|
|
FLASH_EraseInitTypeDef erase;
|
|
uint32_t page_error = 0;
|
|
800d754: 2300 movs r3, #0
|
|
800d756: 60bb str r3, [r7, #8]
|
|
uint32_t addr;
|
|
uint32_t i;
|
|
const uint64_t *src64;
|
|
uint32_t words64_count;
|
|
|
|
if (cfg == 0)
|
|
800d758: 687b ldr r3, [r7, #4]
|
|
800d75a: 2b00 cmp r3, #0
|
|
800d75c: d101 bne.n 800d762 <Config_Save+0x16>
|
|
{
|
|
return false;
|
|
800d75e: 2300 movs r3, #0
|
|
800d760: e05f b.n 800d822 <Config_Save+0xd6>
|
|
}
|
|
|
|
memset(&temp, 0xFF, sizeof(temp));
|
|
800d762: f107 0318 add.w r3, r7, #24
|
|
800d766: 2228 movs r2, #40 @ 0x28
|
|
800d768: 21ff movs r1, #255 @ 0xff
|
|
800d76a: 4618 mov r0, r3
|
|
800d76c: f001 fbee bl 800ef4c <memset>
|
|
|
|
temp.magic = CONFIG_MAGIC;
|
|
800d770: 4b2e ldr r3, [pc, #184] @ (800d82c <Config_Save+0xe0>)
|
|
800d772: 61bb str r3, [r7, #24]
|
|
memcpy(&temp.cfg, cfg, sizeof(BridgeConfig_t));
|
|
800d774: f107 0318 add.w r3, r7, #24
|
|
800d778: 3308 adds r3, #8
|
|
800d77a: 2220 movs r2, #32
|
|
800d77c: 6879 ldr r1, [r7, #4]
|
|
800d77e: 4618 mov r0, r3
|
|
800d780: f001 fc2a bl 800efd8 <memcpy>
|
|
temp.checksum = Config_CalcChecksum((const uint8_t *)&temp.cfg, sizeof(BridgeConfig_t));
|
|
800d784: f107 0318 add.w r3, r7, #24
|
|
800d788: 3308 adds r3, #8
|
|
800d78a: 2120 movs r1, #32
|
|
800d78c: 4618 mov r0, r3
|
|
800d78e: f7ff ff8d bl 800d6ac <Config_CalcChecksum>
|
|
800d792: 4603 mov r3, r0
|
|
800d794: 61fb str r3, [r7, #28]
|
|
|
|
HAL_FLASH_Unlock();
|
|
800d796: f7f4 fe91 bl 80024bc <HAL_FLASH_Unlock>
|
|
|
|
memset(&erase, 0, sizeof(erase));
|
|
800d79a: f107 030c add.w r3, r7, #12
|
|
800d79e: 220c movs r2, #12
|
|
800d7a0: 2100 movs r1, #0
|
|
800d7a2: 4618 mov r0, r3
|
|
800d7a4: f001 fbd2 bl 800ef4c <memset>
|
|
erase.TypeErase = FLASH_TYPEERASE_PAGES;
|
|
800d7a8: 2302 movs r3, #2
|
|
800d7aa: 60fb str r3, [r7, #12]
|
|
erase.Page = (CONFIG_FLASH_ADDR - FLASH_BASE_ADDR) / FLASH_PAGE_SIZE;
|
|
800d7ac: 237f movs r3, #127 @ 0x7f
|
|
800d7ae: 613b str r3, [r7, #16]
|
|
erase.NbPages = 1;
|
|
800d7b0: 2301 movs r3, #1
|
|
800d7b2: 617b str r3, [r7, #20]
|
|
|
|
if (HAL_FLASHEx_Erase(&erase, &page_error) != HAL_OK)
|
|
800d7b4: f107 0208 add.w r2, r7, #8
|
|
800d7b8: f107 030c add.w r3, r7, #12
|
|
800d7bc: 4611 mov r1, r2
|
|
800d7be: 4618 mov r0, r3
|
|
800d7c0: f7f4 ff7e bl 80026c0 <HAL_FLASHEx_Erase>
|
|
800d7c4: 4603 mov r3, r0
|
|
800d7c6: 2b00 cmp r3, #0
|
|
800d7c8: d003 beq.n 800d7d2 <Config_Save+0x86>
|
|
{
|
|
HAL_FLASH_Lock();
|
|
800d7ca: f7f4 fe99 bl 8002500 <HAL_FLASH_Lock>
|
|
return false;
|
|
800d7ce: 2300 movs r3, #0
|
|
800d7d0: e027 b.n 800d822 <Config_Save+0xd6>
|
|
}
|
|
|
|
addr = CONFIG_FLASH_ADDR;
|
|
800d7d2: 4b17 ldr r3, [pc, #92] @ (800d830 <Config_Save+0xe4>)
|
|
800d7d4: 64fb str r3, [r7, #76] @ 0x4c
|
|
src64 = (const uint64_t *)&temp;
|
|
800d7d6: f107 0318 add.w r3, r7, #24
|
|
800d7da: 647b str r3, [r7, #68] @ 0x44
|
|
words64_count = (sizeof(FlashConfig_t) + 7U) / 8U;
|
|
800d7dc: 2305 movs r3, #5
|
|
800d7de: 643b str r3, [r7, #64] @ 0x40
|
|
|
|
for (i = 0; i < words64_count; i++)
|
|
800d7e0: 2300 movs r3, #0
|
|
800d7e2: 64bb str r3, [r7, #72] @ 0x48
|
|
800d7e4: e016 b.n 800d814 <Config_Save+0xc8>
|
|
{
|
|
if (HAL_FLASH_Program(FLASH_TYPEPROGRAM_DOUBLEWORD, addr, src64[i]) != HAL_OK)
|
|
800d7e6: 6cbb ldr r3, [r7, #72] @ 0x48
|
|
800d7e8: 00db lsls r3, r3, #3
|
|
800d7ea: 6c7a ldr r2, [r7, #68] @ 0x44
|
|
800d7ec: 4413 add r3, r2
|
|
800d7ee: e9d3 2300 ldrd r2, r3, [r3]
|
|
800d7f2: 6cf9 ldr r1, [r7, #76] @ 0x4c
|
|
800d7f4: 2001 movs r0, #1
|
|
800d7f6: f7f4 fe1d bl 8002434 <HAL_FLASH_Program>
|
|
800d7fa: 4603 mov r3, r0
|
|
800d7fc: 2b00 cmp r3, #0
|
|
800d7fe: d003 beq.n 800d808 <Config_Save+0xbc>
|
|
{
|
|
HAL_FLASH_Lock();
|
|
800d800: f7f4 fe7e bl 8002500 <HAL_FLASH_Lock>
|
|
return false;
|
|
800d804: 2300 movs r3, #0
|
|
800d806: e00c b.n 800d822 <Config_Save+0xd6>
|
|
}
|
|
|
|
addr += 8U;
|
|
800d808: 6cfb ldr r3, [r7, #76] @ 0x4c
|
|
800d80a: 3308 adds r3, #8
|
|
800d80c: 64fb str r3, [r7, #76] @ 0x4c
|
|
for (i = 0; i < words64_count; i++)
|
|
800d80e: 6cbb ldr r3, [r7, #72] @ 0x48
|
|
800d810: 3301 adds r3, #1
|
|
800d812: 64bb str r3, [r7, #72] @ 0x48
|
|
800d814: 6cba ldr r2, [r7, #72] @ 0x48
|
|
800d816: 6c3b ldr r3, [r7, #64] @ 0x40
|
|
800d818: 429a cmp r2, r3
|
|
800d81a: d3e4 bcc.n 800d7e6 <Config_Save+0x9a>
|
|
}
|
|
|
|
HAL_FLASH_Lock();
|
|
800d81c: f7f4 fe70 bl 8002500 <HAL_FLASH_Lock>
|
|
|
|
return true;
|
|
800d820: 2301 movs r3, #1
|
|
}
|
|
800d822: 4618 mov r0, r3
|
|
800d824: 3750 adds r7, #80 @ 0x50
|
|
800d826: 46bd mov sp, r7
|
|
800d828: bd80 pop {r7, pc}
|
|
800d82a: bf00 nop
|
|
800d82c: 43464731 .word 0x43464731
|
|
800d830: 0803f800 .word 0x0803f800
|
|
|
|
0800d834 <RBI_Init>:
|
|
|
|
/* USER CODE END PFP */
|
|
|
|
/* Exported functions --------------------------------------------------------*/
|
|
int32_t RBI_Init(void)
|
|
{
|
|
800d834: b580 push {r7, lr}
|
|
800d836: af00 add r7, sp, #0
|
|
* 1/ For User boards, the BSP/STM32WLxx_Nucleo/ directory can be copied and replaced in the project. The copy must then be updated depending:
|
|
* on board RF switch configuration (pin control, number of port etc)
|
|
* on TCXO configuration
|
|
* on DC/DC configuration
|
|
* on maximum output power that the board can deliver*/
|
|
return BSP_RADIO_Init();
|
|
800d838: f7f3 ff8e bl 8001758 <BSP_RADIO_Init>
|
|
800d83c: 4603 mov r3, r0
|
|
/* USER CODE BEGIN RBI_Init_2 */
|
|
#warning user to provide its board code or to call his board driver functions
|
|
/* USER CODE END RBI_Init_2 */
|
|
return retcode;
|
|
#endif /* USE_BSP_DRIVER */
|
|
}
|
|
800d83e: 4618 mov r0, r3
|
|
800d840: bd80 pop {r7, pc}
|
|
|
|
0800d842 <RBI_ConfigRFSwitch>:
|
|
return retcode;
|
|
#endif /* USE_BSP_DRIVER */
|
|
}
|
|
|
|
int32_t RBI_ConfigRFSwitch(RBI_Switch_TypeDef Config)
|
|
{
|
|
800d842: b580 push {r7, lr}
|
|
800d844: b082 sub sp, #8
|
|
800d846: af00 add r7, sp, #0
|
|
800d848: 4603 mov r3, r0
|
|
800d84a: 71fb strb r3, [r7, #7]
|
|
* 1/ For User boards, the BSP/STM32WLxx_Nucleo/ directory can be copied and replaced in the project. The copy must then be updated depending:
|
|
* on board RF switch configuration (pin control, number of port etc)
|
|
* on TCXO configuration
|
|
* on DC/DC configuration
|
|
* on maximum output power that the board can deliver*/
|
|
return BSP_RADIO_ConfigRFSwitch((BSP_RADIO_Switch_TypeDef) Config);
|
|
800d84c: 79fb ldrb r3, [r7, #7]
|
|
800d84e: 4618 mov r0, r3
|
|
800d850: f7f3 ffc0 bl 80017d4 <BSP_RADIO_ConfigRFSwitch>
|
|
800d854: 4603 mov r3, r0
|
|
/* USER CODE BEGIN RBI_ConfigRFSwitch_2 */
|
|
#warning user to provide its board code or to call his board driver functions
|
|
/* USER CODE END RBI_ConfigRFSwitch_2 */
|
|
return retcode;
|
|
#endif /* USE_BSP_DRIVER */
|
|
}
|
|
800d856: 4618 mov r0, r3
|
|
800d858: 3708 adds r7, #8
|
|
800d85a: 46bd mov sp, r7
|
|
800d85c: bd80 pop {r7, pc}
|
|
|
|
0800d85e <RBI_GetTxConfig>:
|
|
|
|
int32_t RBI_GetTxConfig(void)
|
|
{
|
|
800d85e: b580 push {r7, lr}
|
|
800d860: af00 add r7, sp, #0
|
|
* 1/ For User boards, the BSP/STM32WLxx_Nucleo/ directory can be copied and replaced in the project. The copy must then be updated depending:
|
|
* on board RF switch configuration (pin control, number of port etc)
|
|
* on TCXO configuration
|
|
* on DC/DC configuration
|
|
* on maximum output power that the board can deliver*/
|
|
return BSP_RADIO_GetTxConfig();
|
|
800d862: f7f4 f813 bl 800188c <BSP_RADIO_GetTxConfig>
|
|
800d866: 4603 mov r3, r0
|
|
/* USER CODE BEGIN RBI_GetTxConfig_2 */
|
|
#warning user to provide its board code or to call his board driver functions
|
|
/* USER CODE END RBI_GetTxConfig_2 */
|
|
return retcode;
|
|
#endif /* USE_BSP_DRIVER */
|
|
}
|
|
800d868: 4618 mov r0, r3
|
|
800d86a: bd80 pop {r7, pc}
|
|
|
|
0800d86c <RBI_IsTCXO>:
|
|
|
|
int32_t RBI_IsTCXO(void)
|
|
{
|
|
800d86c: b580 push {r7, lr}
|
|
800d86e: af00 add r7, sp, #0
|
|
* 1/ For User boards, the BSP/STM32WLxx_Nucleo/ directory can be copied and replaced in the project. The copy must then be updated depending:
|
|
* on board RF switch configuration (pin control, number of port etc)
|
|
* on TCXO configuration
|
|
* on DC/DC configuration
|
|
* on maximum output power that the board can deliver*/
|
|
return BSP_RADIO_IsTCXO();
|
|
800d870: f7f4 f813 bl 800189a <BSP_RADIO_IsTCXO>
|
|
800d874: 4603 mov r3, r0
|
|
/* USER CODE BEGIN RBI_IsTCXO_2 */
|
|
#warning user to provide its board code or to call his board driver functions
|
|
/* USER CODE END RBI_IsTCXO_2 */
|
|
return retcode;
|
|
#endif /* USE_BSP_DRIVER */
|
|
}
|
|
800d876: 4618 mov r0, r3
|
|
800d878: bd80 pop {r7, pc}
|
|
|
|
0800d87a <RBI_IsDCDC>:
|
|
|
|
int32_t RBI_IsDCDC(void)
|
|
{
|
|
800d87a: b580 push {r7, lr}
|
|
800d87c: af00 add r7, sp, #0
|
|
* 1/ For User boards, the BSP/STM32WLxx_Nucleo/ directory can be copied and replaced in the project. The copy must then be updated depending:
|
|
* on board RF switch configuration (pin control, number of port etc)
|
|
* on TCXO configuration
|
|
* on DC/DC configuration
|
|
* on maximum output power that the board can deliver*/
|
|
return BSP_RADIO_IsDCDC();
|
|
800d87e: f7f4 f813 bl 80018a8 <BSP_RADIO_IsDCDC>
|
|
800d882: 4603 mov r3, r0
|
|
/* USER CODE BEGIN RBI_IsDCDC_2 */
|
|
#warning user to provide its board code or to call his board driver functions
|
|
/* USER CODE END RBI_IsDCDC_2 */
|
|
return retcode;
|
|
#endif /* USE_BSP_DRIVER */
|
|
}
|
|
800d884: 4618 mov r0, r3
|
|
800d886: bd80 pop {r7, pc}
|
|
|
|
0800d888 <RBI_GetRFOMaxPowerConfig>:
|
|
|
|
int32_t RBI_GetRFOMaxPowerConfig(RBI_RFOMaxPowerConfig_TypeDef Config)
|
|
{
|
|
800d888: b580 push {r7, lr}
|
|
800d88a: b082 sub sp, #8
|
|
800d88c: af00 add r7, sp, #0
|
|
800d88e: 4603 mov r3, r0
|
|
800d890: 71fb strb r3, [r7, #7]
|
|
* 1/ For User boards, the BSP/STM32WLxx_Nucleo/ directory can be copied and replaced in the project. The copy must then be updated depending:
|
|
* on board RF switch configuration (pin control, number of port etc)
|
|
* on TCXO configuration
|
|
* on DC/DC configuration
|
|
* on maximum output power that the board can deliver*/
|
|
return BSP_RADIO_GetRFOMaxPowerConfig((BSP_RADIO_RFOMaxPowerConfig_TypeDef) Config);
|
|
800d892: 79fb ldrb r3, [r7, #7]
|
|
800d894: 4618 mov r0, r3
|
|
800d896: f7f4 f80e bl 80018b6 <BSP_RADIO_GetRFOMaxPowerConfig>
|
|
800d89a: 4603 mov r3, r0
|
|
ret = 22; /*dBm*/
|
|
}
|
|
/* USER CODE END RBI_GetRFOMaxPowerConfig_2 */
|
|
return ret;
|
|
#endif /* USE_BSP_DRIVER */
|
|
}
|
|
800d89c: 4618 mov r0, r3
|
|
800d89e: 3708 adds r7, #8
|
|
800d8a0: 46bd mov sp, r7
|
|
800d8a2: bd80 pop {r7, pc}
|
|
|
|
0800d8a4 <UTIL_LPM_Init>:
|
|
|
|
/** @addtogroup TINY_LPM_Exported_function
|
|
* @{
|
|
*/
|
|
void UTIL_LPM_Init( void )
|
|
{
|
|
800d8a4: b480 push {r7}
|
|
800d8a6: af00 add r7, sp, #0
|
|
StopModeDisable = UTIL_LPM_NO_BIT_SET;
|
|
800d8a8: 4b04 ldr r3, [pc, #16] @ (800d8bc <UTIL_LPM_Init+0x18>)
|
|
800d8aa: 2200 movs r2, #0
|
|
800d8ac: 601a str r2, [r3, #0]
|
|
OffModeDisable = UTIL_LPM_NO_BIT_SET;
|
|
800d8ae: 4b04 ldr r3, [pc, #16] @ (800d8c0 <UTIL_LPM_Init+0x1c>)
|
|
800d8b0: 2200 movs r2, #0
|
|
800d8b2: 601a str r2, [r3, #0]
|
|
UTIL_LPM_INIT_CRITICAL_SECTION( );
|
|
}
|
|
800d8b4: bf00 nop
|
|
800d8b6: 46bd mov sp, r7
|
|
800d8b8: bc80 pop {r7}
|
|
800d8ba: 4770 bx lr
|
|
800d8bc: 20000c0c .word 0x20000c0c
|
|
800d8c0: 20000c10 .word 0x20000c10
|
|
|
|
0800d8c4 <UTIL_LPM_SetStopMode>:
|
|
void UTIL_LPM_DeInit( void )
|
|
{
|
|
}
|
|
|
|
void UTIL_LPM_SetStopMode( UTIL_LPM_bm_t lpm_id_bm, UTIL_LPM_State_t state )
|
|
{
|
|
800d8c4: b480 push {r7}
|
|
800d8c6: b087 sub sp, #28
|
|
800d8c8: af00 add r7, sp, #0
|
|
800d8ca: 6078 str r0, [r7, #4]
|
|
800d8cc: 460b mov r3, r1
|
|
800d8ce: 70fb strb r3, [r7, #3]
|
|
__ASM volatile ("MRS %0, primask" : "=r" (result) :: "memory");
|
|
800d8d0: f3ef 8310 mrs r3, PRIMASK
|
|
800d8d4: 613b str r3, [r7, #16]
|
|
return(result);
|
|
800d8d6: 693b ldr r3, [r7, #16]
|
|
UTIL_LPM_ENTER_CRITICAL_SECTION( );
|
|
800d8d8: 617b str r3, [r7, #20]
|
|
__ASM volatile ("cpsid i" : : : "memory");
|
|
800d8da: b672 cpsid i
|
|
}
|
|
800d8dc: bf00 nop
|
|
|
|
switch( state )
|
|
800d8de: 78fb ldrb r3, [r7, #3]
|
|
800d8e0: 2b00 cmp r3, #0
|
|
800d8e2: d008 beq.n 800d8f6 <UTIL_LPM_SetStopMode+0x32>
|
|
800d8e4: 2b01 cmp r3, #1
|
|
800d8e6: d10e bne.n 800d906 <UTIL_LPM_SetStopMode+0x42>
|
|
{
|
|
case UTIL_LPM_DISABLE:
|
|
{
|
|
StopModeDisable |= lpm_id_bm;
|
|
800d8e8: 4b0d ldr r3, [pc, #52] @ (800d920 <UTIL_LPM_SetStopMode+0x5c>)
|
|
800d8ea: 681a ldr r2, [r3, #0]
|
|
800d8ec: 687b ldr r3, [r7, #4]
|
|
800d8ee: 4313 orrs r3, r2
|
|
800d8f0: 4a0b ldr r2, [pc, #44] @ (800d920 <UTIL_LPM_SetStopMode+0x5c>)
|
|
800d8f2: 6013 str r3, [r2, #0]
|
|
break;
|
|
800d8f4: e008 b.n 800d908 <UTIL_LPM_SetStopMode+0x44>
|
|
}
|
|
case UTIL_LPM_ENABLE:
|
|
{
|
|
StopModeDisable &= ( ~lpm_id_bm );
|
|
800d8f6: 687b ldr r3, [r7, #4]
|
|
800d8f8: 43da mvns r2, r3
|
|
800d8fa: 4b09 ldr r3, [pc, #36] @ (800d920 <UTIL_LPM_SetStopMode+0x5c>)
|
|
800d8fc: 681b ldr r3, [r3, #0]
|
|
800d8fe: 4013 ands r3, r2
|
|
800d900: 4a07 ldr r2, [pc, #28] @ (800d920 <UTIL_LPM_SetStopMode+0x5c>)
|
|
800d902: 6013 str r3, [r2, #0]
|
|
break;
|
|
800d904: e000 b.n 800d908 <UTIL_LPM_SetStopMode+0x44>
|
|
}
|
|
default :
|
|
{
|
|
break;
|
|
800d906: bf00 nop
|
|
800d908: 697b ldr r3, [r7, #20]
|
|
800d90a: 60fb str r3, [r7, #12]
|
|
__ASM volatile ("MSR primask, %0" : : "r" (priMask) : "memory");
|
|
800d90c: 68fb ldr r3, [r7, #12]
|
|
800d90e: f383 8810 msr PRIMASK, r3
|
|
}
|
|
800d912: bf00 nop
|
|
}
|
|
}
|
|
|
|
UTIL_LPM_EXIT_CRITICAL_SECTION( );
|
|
}
|
|
800d914: bf00 nop
|
|
800d916: 371c adds r7, #28
|
|
800d918: 46bd mov sp, r7
|
|
800d91a: bc80 pop {r7}
|
|
800d91c: 4770 bx lr
|
|
800d91e: bf00 nop
|
|
800d920: 20000c0c .word 0x20000c0c
|
|
|
|
0800d924 <UTIL_LPM_SetOffMode>:
|
|
|
|
void UTIL_LPM_SetOffMode( UTIL_LPM_bm_t lpm_id_bm, UTIL_LPM_State_t state )
|
|
{
|
|
800d924: b480 push {r7}
|
|
800d926: b087 sub sp, #28
|
|
800d928: af00 add r7, sp, #0
|
|
800d92a: 6078 str r0, [r7, #4]
|
|
800d92c: 460b mov r3, r1
|
|
800d92e: 70fb strb r3, [r7, #3]
|
|
__ASM volatile ("MRS %0, primask" : "=r" (result) :: "memory");
|
|
800d930: f3ef 8310 mrs r3, PRIMASK
|
|
800d934: 613b str r3, [r7, #16]
|
|
return(result);
|
|
800d936: 693b ldr r3, [r7, #16]
|
|
UTIL_LPM_ENTER_CRITICAL_SECTION( );
|
|
800d938: 617b str r3, [r7, #20]
|
|
__ASM volatile ("cpsid i" : : : "memory");
|
|
800d93a: b672 cpsid i
|
|
}
|
|
800d93c: bf00 nop
|
|
|
|
switch(state)
|
|
800d93e: 78fb ldrb r3, [r7, #3]
|
|
800d940: 2b00 cmp r3, #0
|
|
800d942: d008 beq.n 800d956 <UTIL_LPM_SetOffMode+0x32>
|
|
800d944: 2b01 cmp r3, #1
|
|
800d946: d10e bne.n 800d966 <UTIL_LPM_SetOffMode+0x42>
|
|
{
|
|
case UTIL_LPM_DISABLE:
|
|
{
|
|
OffModeDisable |= lpm_id_bm;
|
|
800d948: 4b0d ldr r3, [pc, #52] @ (800d980 <UTIL_LPM_SetOffMode+0x5c>)
|
|
800d94a: 681a ldr r2, [r3, #0]
|
|
800d94c: 687b ldr r3, [r7, #4]
|
|
800d94e: 4313 orrs r3, r2
|
|
800d950: 4a0b ldr r2, [pc, #44] @ (800d980 <UTIL_LPM_SetOffMode+0x5c>)
|
|
800d952: 6013 str r3, [r2, #0]
|
|
break;
|
|
800d954: e008 b.n 800d968 <UTIL_LPM_SetOffMode+0x44>
|
|
}
|
|
case UTIL_LPM_ENABLE:
|
|
{
|
|
OffModeDisable &= ( ~lpm_id_bm );
|
|
800d956: 687b ldr r3, [r7, #4]
|
|
800d958: 43da mvns r2, r3
|
|
800d95a: 4b09 ldr r3, [pc, #36] @ (800d980 <UTIL_LPM_SetOffMode+0x5c>)
|
|
800d95c: 681b ldr r3, [r3, #0]
|
|
800d95e: 4013 ands r3, r2
|
|
800d960: 4a07 ldr r2, [pc, #28] @ (800d980 <UTIL_LPM_SetOffMode+0x5c>)
|
|
800d962: 6013 str r3, [r2, #0]
|
|
break;
|
|
800d964: e000 b.n 800d968 <UTIL_LPM_SetOffMode+0x44>
|
|
}
|
|
default :
|
|
{
|
|
break;
|
|
800d966: bf00 nop
|
|
800d968: 697b ldr r3, [r7, #20]
|
|
800d96a: 60fb str r3, [r7, #12]
|
|
__ASM volatile ("MSR primask, %0" : : "r" (priMask) : "memory");
|
|
800d96c: 68fb ldr r3, [r7, #12]
|
|
800d96e: f383 8810 msr PRIMASK, r3
|
|
}
|
|
800d972: bf00 nop
|
|
}
|
|
}
|
|
|
|
UTIL_LPM_EXIT_CRITICAL_SECTION( );
|
|
}
|
|
800d974: bf00 nop
|
|
800d976: 371c adds r7, #28
|
|
800d978: 46bd mov sp, r7
|
|
800d97a: bc80 pop {r7}
|
|
800d97c: 4770 bx lr
|
|
800d97e: bf00 nop
|
|
800d980: 20000c10 .word 0x20000c10
|
|
|
|
0800d984 <UTIL_LPM_EnterLowPower>:
|
|
|
|
return mode_selected;
|
|
}
|
|
|
|
void UTIL_LPM_EnterLowPower( void )
|
|
{
|
|
800d984: b580 push {r7, lr}
|
|
800d986: b084 sub sp, #16
|
|
800d988: af00 add r7, sp, #0
|
|
__ASM volatile ("MRS %0, primask" : "=r" (result) :: "memory");
|
|
800d98a: f3ef 8310 mrs r3, PRIMASK
|
|
800d98e: 60bb str r3, [r7, #8]
|
|
return(result);
|
|
800d990: 68bb ldr r3, [r7, #8]
|
|
UTIL_LPM_ENTER_CRITICAL_SECTION_ELP( );
|
|
800d992: 60fb str r3, [r7, #12]
|
|
__ASM volatile ("cpsid i" : : : "memory");
|
|
800d994: b672 cpsid i
|
|
}
|
|
800d996: bf00 nop
|
|
|
|
if( StopModeDisable != UTIL_LPM_NO_BIT_SET )
|
|
800d998: 4b12 ldr r3, [pc, #72] @ (800d9e4 <UTIL_LPM_EnterLowPower+0x60>)
|
|
800d99a: 681b ldr r3, [r3, #0]
|
|
800d99c: 2b00 cmp r3, #0
|
|
800d99e: d006 beq.n 800d9ae <UTIL_LPM_EnterLowPower+0x2a>
|
|
{
|
|
/**
|
|
* At least one user disallows Stop Mode
|
|
* SLEEP mode is required
|
|
*/
|
|
UTIL_PowerDriver.EnterSleepMode( );
|
|
800d9a0: 4b11 ldr r3, [pc, #68] @ (800d9e8 <UTIL_LPM_EnterLowPower+0x64>)
|
|
800d9a2: 681b ldr r3, [r3, #0]
|
|
800d9a4: 4798 blx r3
|
|
UTIL_PowerDriver.ExitSleepMode( );
|
|
800d9a6: 4b10 ldr r3, [pc, #64] @ (800d9e8 <UTIL_LPM_EnterLowPower+0x64>)
|
|
800d9a8: 685b ldr r3, [r3, #4]
|
|
800d9aa: 4798 blx r3
|
|
800d9ac: e010 b.n 800d9d0 <UTIL_LPM_EnterLowPower+0x4c>
|
|
}
|
|
else
|
|
{
|
|
if( OffModeDisable != UTIL_LPM_NO_BIT_SET )
|
|
800d9ae: 4b0f ldr r3, [pc, #60] @ (800d9ec <UTIL_LPM_EnterLowPower+0x68>)
|
|
800d9b0: 681b ldr r3, [r3, #0]
|
|
800d9b2: 2b00 cmp r3, #0
|
|
800d9b4: d006 beq.n 800d9c4 <UTIL_LPM_EnterLowPower+0x40>
|
|
{
|
|
/**
|
|
* At least one user disallows Off Mode
|
|
* STOP mode is required
|
|
*/
|
|
UTIL_PowerDriver.EnterStopMode( );
|
|
800d9b6: 4b0c ldr r3, [pc, #48] @ (800d9e8 <UTIL_LPM_EnterLowPower+0x64>)
|
|
800d9b8: 689b ldr r3, [r3, #8]
|
|
800d9ba: 4798 blx r3
|
|
UTIL_PowerDriver.ExitStopMode( );
|
|
800d9bc: 4b0a ldr r3, [pc, #40] @ (800d9e8 <UTIL_LPM_EnterLowPower+0x64>)
|
|
800d9be: 68db ldr r3, [r3, #12]
|
|
800d9c0: 4798 blx r3
|
|
800d9c2: e005 b.n 800d9d0 <UTIL_LPM_EnterLowPower+0x4c>
|
|
else
|
|
{
|
|
/**
|
|
* OFF mode is required
|
|
*/
|
|
UTIL_PowerDriver.EnterOffMode( );
|
|
800d9c4: 4b08 ldr r3, [pc, #32] @ (800d9e8 <UTIL_LPM_EnterLowPower+0x64>)
|
|
800d9c6: 691b ldr r3, [r3, #16]
|
|
800d9c8: 4798 blx r3
|
|
UTIL_PowerDriver.ExitOffMode( );
|
|
800d9ca: 4b07 ldr r3, [pc, #28] @ (800d9e8 <UTIL_LPM_EnterLowPower+0x64>)
|
|
800d9cc: 695b ldr r3, [r3, #20]
|
|
800d9ce: 4798 blx r3
|
|
800d9d0: 68fb ldr r3, [r7, #12]
|
|
800d9d2: 607b str r3, [r7, #4]
|
|
__ASM volatile ("MSR primask, %0" : : "r" (priMask) : "memory");
|
|
800d9d4: 687b ldr r3, [r7, #4]
|
|
800d9d6: f383 8810 msr PRIMASK, r3
|
|
}
|
|
800d9da: bf00 nop
|
|
}
|
|
}
|
|
|
|
UTIL_LPM_EXIT_CRITICAL_SECTION_ELP( );
|
|
}
|
|
800d9dc: bf00 nop
|
|
800d9de: 3710 adds r7, #16
|
|
800d9e0: 46bd mov sp, r7
|
|
800d9e2: bd80 pop {r7, pc}
|
|
800d9e4: 20000c0c .word 0x20000c0c
|
|
800d9e8: 08010294 .word 0x08010294
|
|
800d9ec: 20000c10 .word 0x20000c10
|
|
|
|
0800d9f0 <UTIL_MEM_cpy_8>:
|
|
/* Global variables ----------------------------------------------------------*/
|
|
/* Private function prototypes -----------------------------------------------*/
|
|
/* Functions Definition ------------------------------------------------------*/
|
|
|
|
void UTIL_MEM_cpy_8( void *dst, const void *src, uint16_t size )
|
|
{
|
|
800d9f0: b480 push {r7}
|
|
800d9f2: b087 sub sp, #28
|
|
800d9f4: af00 add r7, sp, #0
|
|
800d9f6: 60f8 str r0, [r7, #12]
|
|
800d9f8: 60b9 str r1, [r7, #8]
|
|
800d9fa: 4613 mov r3, r2
|
|
800d9fc: 80fb strh r3, [r7, #6]
|
|
uint8_t* dst8= (uint8_t *) dst;
|
|
800d9fe: 68fb ldr r3, [r7, #12]
|
|
800da00: 617b str r3, [r7, #20]
|
|
uint8_t* src8= (uint8_t *) src;
|
|
800da02: 68bb ldr r3, [r7, #8]
|
|
800da04: 613b str r3, [r7, #16]
|
|
|
|
while( size-- )
|
|
800da06: e007 b.n 800da18 <UTIL_MEM_cpy_8+0x28>
|
|
{
|
|
*dst8++ = *src8++;
|
|
800da08: 693a ldr r2, [r7, #16]
|
|
800da0a: 1c53 adds r3, r2, #1
|
|
800da0c: 613b str r3, [r7, #16]
|
|
800da0e: 697b ldr r3, [r7, #20]
|
|
800da10: 1c59 adds r1, r3, #1
|
|
800da12: 6179 str r1, [r7, #20]
|
|
800da14: 7812 ldrb r2, [r2, #0]
|
|
800da16: 701a strb r2, [r3, #0]
|
|
while( size-- )
|
|
800da18: 88fb ldrh r3, [r7, #6]
|
|
800da1a: 1e5a subs r2, r3, #1
|
|
800da1c: 80fa strh r2, [r7, #6]
|
|
800da1e: 2b00 cmp r3, #0
|
|
800da20: d1f2 bne.n 800da08 <UTIL_MEM_cpy_8+0x18>
|
|
}
|
|
}
|
|
800da22: bf00 nop
|
|
800da24: bf00 nop
|
|
800da26: 371c adds r7, #28
|
|
800da28: 46bd mov sp, r7
|
|
800da2a: bc80 pop {r7}
|
|
800da2c: 4770 bx lr
|
|
|
|
0800da2e <UTIL_MEM_set_8>:
|
|
*dst8-- = *src8++;
|
|
}
|
|
}
|
|
|
|
void UTIL_MEM_set_8( void *dst, uint8_t value, uint16_t size )
|
|
{
|
|
800da2e: b480 push {r7}
|
|
800da30: b085 sub sp, #20
|
|
800da32: af00 add r7, sp, #0
|
|
800da34: 6078 str r0, [r7, #4]
|
|
800da36: 460b mov r3, r1
|
|
800da38: 70fb strb r3, [r7, #3]
|
|
800da3a: 4613 mov r3, r2
|
|
800da3c: 803b strh r3, [r7, #0]
|
|
uint8_t* dst8= (uint8_t *) dst;
|
|
800da3e: 687b ldr r3, [r7, #4]
|
|
800da40: 60fb str r3, [r7, #12]
|
|
while( size-- )
|
|
800da42: e004 b.n 800da4e <UTIL_MEM_set_8+0x20>
|
|
{
|
|
*dst8++ = value;
|
|
800da44: 68fb ldr r3, [r7, #12]
|
|
800da46: 1c5a adds r2, r3, #1
|
|
800da48: 60fa str r2, [r7, #12]
|
|
800da4a: 78fa ldrb r2, [r7, #3]
|
|
800da4c: 701a strb r2, [r3, #0]
|
|
while( size-- )
|
|
800da4e: 883b ldrh r3, [r7, #0]
|
|
800da50: 1e5a subs r2, r3, #1
|
|
800da52: 803a strh r2, [r7, #0]
|
|
800da54: 2b00 cmp r3, #0
|
|
800da56: d1f5 bne.n 800da44 <UTIL_MEM_set_8+0x16>
|
|
}
|
|
}
|
|
800da58: bf00 nop
|
|
800da5a: bf00 nop
|
|
800da5c: 3714 adds r7, #20
|
|
800da5e: 46bd mov sp, r7
|
|
800da60: bc80 pop {r7}
|
|
800da62: 4770 bx lr
|
|
|
|
0800da64 <SysTimeAdd>:
|
|
* @addtogroup SYSTIME_exported_function
|
|
* @{
|
|
*/
|
|
|
|
SysTime_t SysTimeAdd( SysTime_t a, SysTime_t b )
|
|
{
|
|
800da64: b082 sub sp, #8
|
|
800da66: b480 push {r7}
|
|
800da68: b087 sub sp, #28
|
|
800da6a: af00 add r7, sp, #0
|
|
800da6c: 60f8 str r0, [r7, #12]
|
|
800da6e: 1d38 adds r0, r7, #4
|
|
800da70: e880 0006 stmia.w r0, {r1, r2}
|
|
800da74: 627b str r3, [r7, #36] @ 0x24
|
|
SysTime_t c = { .Seconds = 0, .SubSeconds = 0 };
|
|
800da76: 2300 movs r3, #0
|
|
800da78: 613b str r3, [r7, #16]
|
|
800da7a: 2300 movs r3, #0
|
|
800da7c: 82bb strh r3, [r7, #20]
|
|
|
|
c.Seconds = a.Seconds + b.Seconds;
|
|
800da7e: 687a ldr r2, [r7, #4]
|
|
800da80: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
800da82: 4413 add r3, r2
|
|
800da84: 613b str r3, [r7, #16]
|
|
c.SubSeconds = a.SubSeconds + b.SubSeconds;
|
|
800da86: f9b7 3008 ldrsh.w r3, [r7, #8]
|
|
800da8a: b29a uxth r2, r3
|
|
800da8c: f9b7 3028 ldrsh.w r3, [r7, #40] @ 0x28
|
|
800da90: b29b uxth r3, r3
|
|
800da92: 4413 add r3, r2
|
|
800da94: b29b uxth r3, r3
|
|
800da96: b21b sxth r3, r3
|
|
800da98: 82bb strh r3, [r7, #20]
|
|
if( c.SubSeconds >= 1000 )
|
|
800da9a: f9b7 3014 ldrsh.w r3, [r7, #20]
|
|
800da9e: f5b3 7f7a cmp.w r3, #1000 @ 0x3e8
|
|
800daa2: db0a blt.n 800daba <SysTimeAdd+0x56>
|
|
{
|
|
c.Seconds++;
|
|
800daa4: 693b ldr r3, [r7, #16]
|
|
800daa6: 3301 adds r3, #1
|
|
800daa8: 613b str r3, [r7, #16]
|
|
c.SubSeconds -= 1000;
|
|
800daaa: f9b7 3014 ldrsh.w r3, [r7, #20]
|
|
800daae: b29b uxth r3, r3
|
|
800dab0: f5a3 737a sub.w r3, r3, #1000 @ 0x3e8
|
|
800dab4: b29b uxth r3, r3
|
|
800dab6: b21b sxth r3, r3
|
|
800dab8: 82bb strh r3, [r7, #20]
|
|
}
|
|
return c;
|
|
800daba: 68fb ldr r3, [r7, #12]
|
|
800dabc: 461a mov r2, r3
|
|
800dabe: f107 0310 add.w r3, r7, #16
|
|
800dac2: e893 0003 ldmia.w r3, {r0, r1}
|
|
800dac6: e882 0003 stmia.w r2, {r0, r1}
|
|
}
|
|
800daca: 68f8 ldr r0, [r7, #12]
|
|
800dacc: 371c adds r7, #28
|
|
800dace: 46bd mov sp, r7
|
|
800dad0: bc80 pop {r7}
|
|
800dad2: b002 add sp, #8
|
|
800dad4: 4770 bx lr
|
|
...
|
|
|
|
0800dad8 <SysTimeGet>:
|
|
UTIL_SYSTIMDriver.BKUPWrite_Seconds( DeltaTime.Seconds );
|
|
UTIL_SYSTIMDriver.BKUPWrite_SubSeconds( ( uint32_t ) DeltaTime.SubSeconds );
|
|
}
|
|
|
|
SysTime_t SysTimeGet( void )
|
|
{
|
|
800dad8: b580 push {r7, lr}
|
|
800dada: b08a sub sp, #40 @ 0x28
|
|
800dadc: af02 add r7, sp, #8
|
|
800dade: 6078 str r0, [r7, #4]
|
|
SysTime_t calendarTime = { .Seconds = 0, .SubSeconds = 0 };
|
|
800dae0: 2300 movs r3, #0
|
|
800dae2: 61bb str r3, [r7, #24]
|
|
800dae4: 2300 movs r3, #0
|
|
800dae6: 83bb strh r3, [r7, #28]
|
|
SysTime_t sysTime = { .Seconds = 0, .SubSeconds = 0 };
|
|
800dae8: 2300 movs r3, #0
|
|
800daea: 613b str r3, [r7, #16]
|
|
800daec: 2300 movs r3, #0
|
|
800daee: 82bb strh r3, [r7, #20]
|
|
SysTime_t DeltaTime;
|
|
|
|
calendarTime.Seconds = UTIL_SYSTIMDriver.GetCalendarTime( ( uint16_t* )&calendarTime.SubSeconds );
|
|
800daf0: 4b14 ldr r3, [pc, #80] @ (800db44 <SysTimeGet+0x6c>)
|
|
800daf2: 691b ldr r3, [r3, #16]
|
|
800daf4: f107 0218 add.w r2, r7, #24
|
|
800daf8: 3204 adds r2, #4
|
|
800dafa: 4610 mov r0, r2
|
|
800dafc: 4798 blx r3
|
|
800dafe: 4603 mov r3, r0
|
|
800db00: 61bb str r3, [r7, #24]
|
|
|
|
DeltaTime.SubSeconds = (int16_t)UTIL_SYSTIMDriver.BKUPRead_SubSeconds();
|
|
800db02: 4b10 ldr r3, [pc, #64] @ (800db44 <SysTimeGet+0x6c>)
|
|
800db04: 68db ldr r3, [r3, #12]
|
|
800db06: 4798 blx r3
|
|
800db08: 4603 mov r3, r0
|
|
800db0a: b21b sxth r3, r3
|
|
800db0c: 81bb strh r3, [r7, #12]
|
|
DeltaTime.Seconds = UTIL_SYSTIMDriver.BKUPRead_Seconds();
|
|
800db0e: 4b0d ldr r3, [pc, #52] @ (800db44 <SysTimeGet+0x6c>)
|
|
800db10: 685b ldr r3, [r3, #4]
|
|
800db12: 4798 blx r3
|
|
800db14: 4603 mov r3, r0
|
|
800db16: 60bb str r3, [r7, #8]
|
|
|
|
sysTime = SysTimeAdd( DeltaTime, calendarTime );
|
|
800db18: f107 0010 add.w r0, r7, #16
|
|
800db1c: 69fb ldr r3, [r7, #28]
|
|
800db1e: 9300 str r3, [sp, #0]
|
|
800db20: 69bb ldr r3, [r7, #24]
|
|
800db22: f107 0208 add.w r2, r7, #8
|
|
800db26: ca06 ldmia r2, {r1, r2}
|
|
800db28: f7ff ff9c bl 800da64 <SysTimeAdd>
|
|
|
|
return sysTime;
|
|
800db2c: 687b ldr r3, [r7, #4]
|
|
800db2e: 461a mov r2, r3
|
|
800db30: f107 0310 add.w r3, r7, #16
|
|
800db34: e893 0003 ldmia.w r3, {r0, r1}
|
|
800db38: e882 0003 stmia.w r2, {r0, r1}
|
|
}
|
|
800db3c: 6878 ldr r0, [r7, #4]
|
|
800db3e: 3720 adds r7, #32
|
|
800db40: 46bd mov sp, r7
|
|
800db42: bd80 pop {r7, pc}
|
|
800db44: 08010378 .word 0x08010378
|
|
|
|
0800db48 <ee_skip_atoi>:
|
|
return sc - s;
|
|
}
|
|
#endif
|
|
|
|
static int ee_skip_atoi(const char **s)
|
|
{
|
|
800db48: b480 push {r7}
|
|
800db4a: b085 sub sp, #20
|
|
800db4c: af00 add r7, sp, #0
|
|
800db4e: 6078 str r0, [r7, #4]
|
|
int i = 0;
|
|
800db50: 2300 movs r3, #0
|
|
800db52: 60fb str r3, [r7, #12]
|
|
while (is_digit(**s)) i = i*10 + *((*s)++) - '0';
|
|
800db54: e00e b.n 800db74 <ee_skip_atoi+0x2c>
|
|
800db56: 68fa ldr r2, [r7, #12]
|
|
800db58: 4613 mov r3, r2
|
|
800db5a: 009b lsls r3, r3, #2
|
|
800db5c: 4413 add r3, r2
|
|
800db5e: 005b lsls r3, r3, #1
|
|
800db60: 4618 mov r0, r3
|
|
800db62: 687b ldr r3, [r7, #4]
|
|
800db64: 681b ldr r3, [r3, #0]
|
|
800db66: 1c59 adds r1, r3, #1
|
|
800db68: 687a ldr r2, [r7, #4]
|
|
800db6a: 6011 str r1, [r2, #0]
|
|
800db6c: 781b ldrb r3, [r3, #0]
|
|
800db6e: 4403 add r3, r0
|
|
800db70: 3b30 subs r3, #48 @ 0x30
|
|
800db72: 60fb str r3, [r7, #12]
|
|
800db74: 687b ldr r3, [r7, #4]
|
|
800db76: 681b ldr r3, [r3, #0]
|
|
800db78: 781b ldrb r3, [r3, #0]
|
|
800db7a: 2b2f cmp r3, #47 @ 0x2f
|
|
800db7c: d904 bls.n 800db88 <ee_skip_atoi+0x40>
|
|
800db7e: 687b ldr r3, [r7, #4]
|
|
800db80: 681b ldr r3, [r3, #0]
|
|
800db82: 781b ldrb r3, [r3, #0]
|
|
800db84: 2b39 cmp r3, #57 @ 0x39
|
|
800db86: d9e6 bls.n 800db56 <ee_skip_atoi+0xe>
|
|
return i;
|
|
800db88: 68fb ldr r3, [r7, #12]
|
|
}
|
|
800db8a: 4618 mov r0, r3
|
|
800db8c: 3714 adds r7, #20
|
|
800db8e: 46bd mov sp, r7
|
|
800db90: bc80 pop {r7}
|
|
800db92: 4770 bx lr
|
|
|
|
0800db94 <ee_number>:
|
|
|
|
#define ASSIGN_STR(_c) do { *str++ = (_c); max_size--; if (max_size == 0) return str; } while (0)
|
|
|
|
static char *ee_number(char *str, int max_size, long num, int base, int size, int precision, int type)
|
|
{
|
|
800db94: b480 push {r7}
|
|
800db96: b099 sub sp, #100 @ 0x64
|
|
800db98: af00 add r7, sp, #0
|
|
800db9a: 60f8 str r0, [r7, #12]
|
|
800db9c: 60b9 str r1, [r7, #8]
|
|
800db9e: 607a str r2, [r7, #4]
|
|
800dba0: 603b str r3, [r7, #0]
|
|
char c;
|
|
char sign, tmp[66];
|
|
char *dig = lower_digits;
|
|
800dba2: 4b71 ldr r3, [pc, #452] @ (800dd68 <ee_number+0x1d4>)
|
|
800dba4: 681b ldr r3, [r3, #0]
|
|
800dba6: 65bb str r3, [r7, #88] @ 0x58
|
|
int i;
|
|
|
|
if (type & UPPERCASE) dig = upper_digits;
|
|
800dba8: 6f3b ldr r3, [r7, #112] @ 0x70
|
|
800dbaa: f003 0340 and.w r3, r3, #64 @ 0x40
|
|
800dbae: 2b00 cmp r3, #0
|
|
800dbb0: d002 beq.n 800dbb8 <ee_number+0x24>
|
|
800dbb2: 4b6e ldr r3, [pc, #440] @ (800dd6c <ee_number+0x1d8>)
|
|
800dbb4: 681b ldr r3, [r3, #0]
|
|
800dbb6: 65bb str r3, [r7, #88] @ 0x58
|
|
#ifdef TINY_PRINTF
|
|
#else
|
|
if (type & LEFT) type &= ~ZEROPAD;
|
|
#endif
|
|
if (base < 2 || base > 36) return 0;
|
|
800dbb8: 683b ldr r3, [r7, #0]
|
|
800dbba: 2b01 cmp r3, #1
|
|
800dbbc: dd02 ble.n 800dbc4 <ee_number+0x30>
|
|
800dbbe: 683b ldr r3, [r7, #0]
|
|
800dbc0: 2b24 cmp r3, #36 @ 0x24
|
|
800dbc2: dd01 ble.n 800dbc8 <ee_number+0x34>
|
|
800dbc4: 2300 movs r3, #0
|
|
800dbc6: e0ca b.n 800dd5e <ee_number+0x1ca>
|
|
|
|
c = (type & ZEROPAD) ? '0' : ' ';
|
|
800dbc8: 6f3b ldr r3, [r7, #112] @ 0x70
|
|
800dbca: f003 0301 and.w r3, r3, #1
|
|
800dbce: 2b00 cmp r3, #0
|
|
800dbd0: d001 beq.n 800dbd6 <ee_number+0x42>
|
|
800dbd2: 2330 movs r3, #48 @ 0x30
|
|
800dbd4: e000 b.n 800dbd8 <ee_number+0x44>
|
|
800dbd6: 2320 movs r3, #32
|
|
800dbd8: f887 3053 strb.w r3, [r7, #83] @ 0x53
|
|
sign = 0;
|
|
800dbdc: 2300 movs r3, #0
|
|
800dbde: f887 305f strb.w r3, [r7, #95] @ 0x5f
|
|
if (type & SIGN)
|
|
800dbe2: 6f3b ldr r3, [r7, #112] @ 0x70
|
|
800dbe4: f003 0302 and.w r3, r3, #2
|
|
800dbe8: 2b00 cmp r3, #0
|
|
800dbea: d00b beq.n 800dc04 <ee_number+0x70>
|
|
{
|
|
if (num < 0)
|
|
800dbec: 687b ldr r3, [r7, #4]
|
|
800dbee: 2b00 cmp r3, #0
|
|
800dbf0: da08 bge.n 800dc04 <ee_number+0x70>
|
|
{
|
|
sign = '-';
|
|
800dbf2: 232d movs r3, #45 @ 0x2d
|
|
800dbf4: f887 305f strb.w r3, [r7, #95] @ 0x5f
|
|
num = -num;
|
|
800dbf8: 687b ldr r3, [r7, #4]
|
|
800dbfa: 425b negs r3, r3
|
|
800dbfc: 607b str r3, [r7, #4]
|
|
size--;
|
|
800dbfe: 6ebb ldr r3, [r7, #104] @ 0x68
|
|
800dc00: 3b01 subs r3, #1
|
|
800dc02: 66bb str r3, [r7, #104] @ 0x68
|
|
else if (base == 8)
|
|
size--;
|
|
}
|
|
#endif
|
|
|
|
i = 0;
|
|
800dc04: 2300 movs r3, #0
|
|
800dc06: 657b str r3, [r7, #84] @ 0x54
|
|
|
|
if (num == 0)
|
|
800dc08: 687b ldr r3, [r7, #4]
|
|
800dc0a: 2b00 cmp r3, #0
|
|
800dc0c: d11e bne.n 800dc4c <ee_number+0xb8>
|
|
tmp[i++] = '0';
|
|
800dc0e: 6d7b ldr r3, [r7, #84] @ 0x54
|
|
800dc10: 1c5a adds r2, r3, #1
|
|
800dc12: 657a str r2, [r7, #84] @ 0x54
|
|
800dc14: 3360 adds r3, #96 @ 0x60
|
|
800dc16: 443b add r3, r7
|
|
800dc18: 2230 movs r2, #48 @ 0x30
|
|
800dc1a: f803 2c50 strb.w r2, [r3, #-80]
|
|
800dc1e: e018 b.n 800dc52 <ee_number+0xbe>
|
|
else
|
|
{
|
|
while (num != 0)
|
|
{
|
|
tmp[i++] = dig[((unsigned long) num) % (unsigned) base];
|
|
800dc20: 687b ldr r3, [r7, #4]
|
|
800dc22: 683a ldr r2, [r7, #0]
|
|
800dc24: fbb3 f1f2 udiv r1, r3, r2
|
|
800dc28: fb01 f202 mul.w r2, r1, r2
|
|
800dc2c: 1a9b subs r3, r3, r2
|
|
800dc2e: 6dba ldr r2, [r7, #88] @ 0x58
|
|
800dc30: 441a add r2, r3
|
|
800dc32: 6d7b ldr r3, [r7, #84] @ 0x54
|
|
800dc34: 1c59 adds r1, r3, #1
|
|
800dc36: 6579 str r1, [r7, #84] @ 0x54
|
|
800dc38: 7812 ldrb r2, [r2, #0]
|
|
800dc3a: 3360 adds r3, #96 @ 0x60
|
|
800dc3c: 443b add r3, r7
|
|
800dc3e: f803 2c50 strb.w r2, [r3, #-80]
|
|
num = ((unsigned long) num) / (unsigned) base;
|
|
800dc42: 687a ldr r2, [r7, #4]
|
|
800dc44: 683b ldr r3, [r7, #0]
|
|
800dc46: fbb2 f3f3 udiv r3, r2, r3
|
|
800dc4a: 607b str r3, [r7, #4]
|
|
while (num != 0)
|
|
800dc4c: 687b ldr r3, [r7, #4]
|
|
800dc4e: 2b00 cmp r3, #0
|
|
800dc50: d1e6 bne.n 800dc20 <ee_number+0x8c>
|
|
}
|
|
}
|
|
|
|
if (i > precision) precision = i;
|
|
800dc52: 6d7a ldr r2, [r7, #84] @ 0x54
|
|
800dc54: 6efb ldr r3, [r7, #108] @ 0x6c
|
|
800dc56: 429a cmp r2, r3
|
|
800dc58: dd01 ble.n 800dc5e <ee_number+0xca>
|
|
800dc5a: 6d7b ldr r3, [r7, #84] @ 0x54
|
|
800dc5c: 66fb str r3, [r7, #108] @ 0x6c
|
|
size -= precision;
|
|
800dc5e: 6eba ldr r2, [r7, #104] @ 0x68
|
|
800dc60: 6efb ldr r3, [r7, #108] @ 0x6c
|
|
800dc62: 1ad3 subs r3, r2, r3
|
|
800dc64: 66bb str r3, [r7, #104] @ 0x68
|
|
if (!(type & (ZEROPAD /* TINY option | LEFT */))) while (size-- > 0) ASSIGN_STR(' ');
|
|
800dc66: 6f3b ldr r3, [r7, #112] @ 0x70
|
|
800dc68: f003 0301 and.w r3, r3, #1
|
|
800dc6c: 2b00 cmp r3, #0
|
|
800dc6e: d112 bne.n 800dc96 <ee_number+0x102>
|
|
800dc70: e00c b.n 800dc8c <ee_number+0xf8>
|
|
800dc72: 68fb ldr r3, [r7, #12]
|
|
800dc74: 1c5a adds r2, r3, #1
|
|
800dc76: 60fa str r2, [r7, #12]
|
|
800dc78: 2220 movs r2, #32
|
|
800dc7a: 701a strb r2, [r3, #0]
|
|
800dc7c: 68bb ldr r3, [r7, #8]
|
|
800dc7e: 3b01 subs r3, #1
|
|
800dc80: 60bb str r3, [r7, #8]
|
|
800dc82: 68bb ldr r3, [r7, #8]
|
|
800dc84: 2b00 cmp r3, #0
|
|
800dc86: d101 bne.n 800dc8c <ee_number+0xf8>
|
|
800dc88: 68fb ldr r3, [r7, #12]
|
|
800dc8a: e068 b.n 800dd5e <ee_number+0x1ca>
|
|
800dc8c: 6ebb ldr r3, [r7, #104] @ 0x68
|
|
800dc8e: 1e5a subs r2, r3, #1
|
|
800dc90: 66ba str r2, [r7, #104] @ 0x68
|
|
800dc92: 2b00 cmp r3, #0
|
|
800dc94: dced bgt.n 800dc72 <ee_number+0xde>
|
|
if (sign) ASSIGN_STR(sign);
|
|
800dc96: f897 305f ldrb.w r3, [r7, #95] @ 0x5f
|
|
800dc9a: 2b00 cmp r3, #0
|
|
800dc9c: d01b beq.n 800dcd6 <ee_number+0x142>
|
|
800dc9e: 68fb ldr r3, [r7, #12]
|
|
800dca0: 1c5a adds r2, r3, #1
|
|
800dca2: 60fa str r2, [r7, #12]
|
|
800dca4: f897 205f ldrb.w r2, [r7, #95] @ 0x5f
|
|
800dca8: 701a strb r2, [r3, #0]
|
|
800dcaa: 68bb ldr r3, [r7, #8]
|
|
800dcac: 3b01 subs r3, #1
|
|
800dcae: 60bb str r3, [r7, #8]
|
|
800dcb0: 68bb ldr r3, [r7, #8]
|
|
800dcb2: 2b00 cmp r3, #0
|
|
800dcb4: d10f bne.n 800dcd6 <ee_number+0x142>
|
|
800dcb6: 68fb ldr r3, [r7, #12]
|
|
800dcb8: e051 b.n 800dd5e <ee_number+0x1ca>
|
|
}
|
|
}
|
|
#endif
|
|
|
|
#ifdef TINY_PRINTF
|
|
while (size-- > 0) ASSIGN_STR(c);
|
|
800dcba: 68fb ldr r3, [r7, #12]
|
|
800dcbc: 1c5a adds r2, r3, #1
|
|
800dcbe: 60fa str r2, [r7, #12]
|
|
800dcc0: f897 2053 ldrb.w r2, [r7, #83] @ 0x53
|
|
800dcc4: 701a strb r2, [r3, #0]
|
|
800dcc6: 68bb ldr r3, [r7, #8]
|
|
800dcc8: 3b01 subs r3, #1
|
|
800dcca: 60bb str r3, [r7, #8]
|
|
800dccc: 68bb ldr r3, [r7, #8]
|
|
800dcce: 2b00 cmp r3, #0
|
|
800dcd0: d101 bne.n 800dcd6 <ee_number+0x142>
|
|
800dcd2: 68fb ldr r3, [r7, #12]
|
|
800dcd4: e043 b.n 800dd5e <ee_number+0x1ca>
|
|
800dcd6: 6ebb ldr r3, [r7, #104] @ 0x68
|
|
800dcd8: 1e5a subs r2, r3, #1
|
|
800dcda: 66ba str r2, [r7, #104] @ 0x68
|
|
800dcdc: 2b00 cmp r3, #0
|
|
800dcde: dcec bgt.n 800dcba <ee_number+0x126>
|
|
#else
|
|
if (!(type & LEFT)) while (size-- > 0) ASSIGN_STR(c);
|
|
#endif
|
|
while (i < precision--) ASSIGN_STR('0');
|
|
800dce0: e00c b.n 800dcfc <ee_number+0x168>
|
|
800dce2: 68fb ldr r3, [r7, #12]
|
|
800dce4: 1c5a adds r2, r3, #1
|
|
800dce6: 60fa str r2, [r7, #12]
|
|
800dce8: 2230 movs r2, #48 @ 0x30
|
|
800dcea: 701a strb r2, [r3, #0]
|
|
800dcec: 68bb ldr r3, [r7, #8]
|
|
800dcee: 3b01 subs r3, #1
|
|
800dcf0: 60bb str r3, [r7, #8]
|
|
800dcf2: 68bb ldr r3, [r7, #8]
|
|
800dcf4: 2b00 cmp r3, #0
|
|
800dcf6: d101 bne.n 800dcfc <ee_number+0x168>
|
|
800dcf8: 68fb ldr r3, [r7, #12]
|
|
800dcfa: e030 b.n 800dd5e <ee_number+0x1ca>
|
|
800dcfc: 6efb ldr r3, [r7, #108] @ 0x6c
|
|
800dcfe: 1e5a subs r2, r3, #1
|
|
800dd00: 66fa str r2, [r7, #108] @ 0x6c
|
|
800dd02: 6d7a ldr r2, [r7, #84] @ 0x54
|
|
800dd04: 429a cmp r2, r3
|
|
800dd06: dbec blt.n 800dce2 <ee_number+0x14e>
|
|
while (i-- > 0) ASSIGN_STR(tmp[i]);
|
|
800dd08: e010 b.n 800dd2c <ee_number+0x198>
|
|
800dd0a: 68fb ldr r3, [r7, #12]
|
|
800dd0c: 1c5a adds r2, r3, #1
|
|
800dd0e: 60fa str r2, [r7, #12]
|
|
800dd10: f107 0110 add.w r1, r7, #16
|
|
800dd14: 6d7a ldr r2, [r7, #84] @ 0x54
|
|
800dd16: 440a add r2, r1
|
|
800dd18: 7812 ldrb r2, [r2, #0]
|
|
800dd1a: 701a strb r2, [r3, #0]
|
|
800dd1c: 68bb ldr r3, [r7, #8]
|
|
800dd1e: 3b01 subs r3, #1
|
|
800dd20: 60bb str r3, [r7, #8]
|
|
800dd22: 68bb ldr r3, [r7, #8]
|
|
800dd24: 2b00 cmp r3, #0
|
|
800dd26: d101 bne.n 800dd2c <ee_number+0x198>
|
|
800dd28: 68fb ldr r3, [r7, #12]
|
|
800dd2a: e018 b.n 800dd5e <ee_number+0x1ca>
|
|
800dd2c: 6d7b ldr r3, [r7, #84] @ 0x54
|
|
800dd2e: 1e5a subs r2, r3, #1
|
|
800dd30: 657a str r2, [r7, #84] @ 0x54
|
|
800dd32: 2b00 cmp r3, #0
|
|
800dd34: dce9 bgt.n 800dd0a <ee_number+0x176>
|
|
while (size-- > 0) ASSIGN_STR(' ');
|
|
800dd36: e00c b.n 800dd52 <ee_number+0x1be>
|
|
800dd38: 68fb ldr r3, [r7, #12]
|
|
800dd3a: 1c5a adds r2, r3, #1
|
|
800dd3c: 60fa str r2, [r7, #12]
|
|
800dd3e: 2220 movs r2, #32
|
|
800dd40: 701a strb r2, [r3, #0]
|
|
800dd42: 68bb ldr r3, [r7, #8]
|
|
800dd44: 3b01 subs r3, #1
|
|
800dd46: 60bb str r3, [r7, #8]
|
|
800dd48: 68bb ldr r3, [r7, #8]
|
|
800dd4a: 2b00 cmp r3, #0
|
|
800dd4c: d101 bne.n 800dd52 <ee_number+0x1be>
|
|
800dd4e: 68fb ldr r3, [r7, #12]
|
|
800dd50: e005 b.n 800dd5e <ee_number+0x1ca>
|
|
800dd52: 6ebb ldr r3, [r7, #104] @ 0x68
|
|
800dd54: 1e5a subs r2, r3, #1
|
|
800dd56: 66ba str r2, [r7, #104] @ 0x68
|
|
800dd58: 2b00 cmp r3, #0
|
|
800dd5a: dced bgt.n 800dd38 <ee_number+0x1a4>
|
|
|
|
return str;
|
|
800dd5c: 68fb ldr r3, [r7, #12]
|
|
}
|
|
800dd5e: 4618 mov r0, r3
|
|
800dd60: 3764 adds r7, #100 @ 0x64
|
|
800dd62: 46bd mov sp, r7
|
|
800dd64: bc80 pop {r7}
|
|
800dd66: 4770 bx lr
|
|
800dd68: 2000000c .word 0x2000000c
|
|
800dd6c: 20000010 .word 0x20000010
|
|
|
|
0800dd70 <tiny_vsnprintf_like>:
|
|
|
|
#define CHECK_STR_SIZE(_buf, _str, _size) \
|
|
if ((((_str) - (_buf)) >= ((_size)-1))) { break; }
|
|
|
|
int tiny_vsnprintf_like(char *buf, const int size, const char *fmt, va_list args)
|
|
{
|
|
800dd70: b580 push {r7, lr}
|
|
800dd72: b092 sub sp, #72 @ 0x48
|
|
800dd74: af04 add r7, sp, #16
|
|
800dd76: 60f8 str r0, [r7, #12]
|
|
800dd78: 60b9 str r1, [r7, #8]
|
|
800dd7a: 607a str r2, [r7, #4]
|
|
800dd7c: 603b str r3, [r7, #0]
|
|
|
|
int field_width; // Width of output field
|
|
int precision; // Min. # of digits for integers; max number of chars for from string
|
|
int qualifier; // 'h', 'l', or 'L' for integer fields
|
|
|
|
if (size <= 0)
|
|
800dd7e: 68bb ldr r3, [r7, #8]
|
|
800dd80: 2b00 cmp r3, #0
|
|
800dd82: dc01 bgt.n 800dd88 <tiny_vsnprintf_like+0x18>
|
|
{
|
|
return 0;
|
|
800dd84: 2300 movs r3, #0
|
|
800dd86: e13e b.n 800e006 <tiny_vsnprintf_like+0x296>
|
|
}
|
|
|
|
for (str = buf; *fmt || ((str - buf) >= size-1); fmt++)
|
|
800dd88: 68fb ldr r3, [r7, #12]
|
|
800dd8a: 62fb str r3, [r7, #44] @ 0x2c
|
|
800dd8c: e128 b.n 800dfe0 <tiny_vsnprintf_like+0x270>
|
|
{
|
|
CHECK_STR_SIZE(buf, str, size);
|
|
800dd8e: 6afa ldr r2, [r7, #44] @ 0x2c
|
|
800dd90: 68fb ldr r3, [r7, #12]
|
|
800dd92: 1ad2 subs r2, r2, r3
|
|
800dd94: 68bb ldr r3, [r7, #8]
|
|
800dd96: 3b01 subs r3, #1
|
|
800dd98: 429a cmp r2, r3
|
|
800dd9a: f280 812e bge.w 800dffa <tiny_vsnprintf_like+0x28a>
|
|
|
|
if (*fmt != '%')
|
|
800dd9e: 687b ldr r3, [r7, #4]
|
|
800dda0: 781b ldrb r3, [r3, #0]
|
|
800dda2: 2b25 cmp r3, #37 @ 0x25
|
|
800dda4: d006 beq.n 800ddb4 <tiny_vsnprintf_like+0x44>
|
|
{
|
|
*str++ = *fmt;
|
|
800dda6: 687a ldr r2, [r7, #4]
|
|
800dda8: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
800ddaa: 1c59 adds r1, r3, #1
|
|
800ddac: 62f9 str r1, [r7, #44] @ 0x2c
|
|
800ddae: 7812 ldrb r2, [r2, #0]
|
|
800ddb0: 701a strb r2, [r3, #0]
|
|
continue;
|
|
800ddb2: e112 b.n 800dfda <tiny_vsnprintf_like+0x26a>
|
|
}
|
|
|
|
// Process flags
|
|
flags = 0;
|
|
800ddb4: 2300 movs r3, #0
|
|
800ddb6: 623b str r3, [r7, #32]
|
|
#ifdef TINY_PRINTF
|
|
/* Support %0, but not %-, %+, %space and %# */
|
|
fmt++;
|
|
800ddb8: 687b ldr r3, [r7, #4]
|
|
800ddba: 3301 adds r3, #1
|
|
800ddbc: 607b str r3, [r7, #4]
|
|
if (*fmt == '0')
|
|
800ddbe: 687b ldr r3, [r7, #4]
|
|
800ddc0: 781b ldrb r3, [r3, #0]
|
|
800ddc2: 2b30 cmp r3, #48 @ 0x30
|
|
800ddc4: d103 bne.n 800ddce <tiny_vsnprintf_like+0x5e>
|
|
{
|
|
flags |= ZEROPAD;
|
|
800ddc6: 6a3b ldr r3, [r7, #32]
|
|
800ddc8: f043 0301 orr.w r3, r3, #1
|
|
800ddcc: 623b str r3, [r7, #32]
|
|
case '0': flags |= ZEROPAD; goto repeat;
|
|
}
|
|
#endif
|
|
|
|
// Get field width
|
|
field_width = -1;
|
|
800ddce: f04f 33ff mov.w r3, #4294967295 @ 0xffffffff
|
|
800ddd2: 61fb str r3, [r7, #28]
|
|
if (is_digit(*fmt))
|
|
800ddd4: 687b ldr r3, [r7, #4]
|
|
800ddd6: 781b ldrb r3, [r3, #0]
|
|
800ddd8: 2b2f cmp r3, #47 @ 0x2f
|
|
800ddda: d908 bls.n 800ddee <tiny_vsnprintf_like+0x7e>
|
|
800dddc: 687b ldr r3, [r7, #4]
|
|
800ddde: 781b ldrb r3, [r3, #0]
|
|
800dde0: 2b39 cmp r3, #57 @ 0x39
|
|
800dde2: d804 bhi.n 800ddee <tiny_vsnprintf_like+0x7e>
|
|
field_width = ee_skip_atoi(&fmt);
|
|
800dde4: 1d3b adds r3, r7, #4
|
|
800dde6: 4618 mov r0, r3
|
|
800dde8: f7ff feae bl 800db48 <ee_skip_atoi>
|
|
800ddec: 61f8 str r0, [r7, #28]
|
|
}
|
|
}
|
|
#endif
|
|
|
|
// Get the precision
|
|
precision = -1;
|
|
800ddee: f04f 33ff mov.w r3, #4294967295 @ 0xffffffff
|
|
800ddf2: 61bb str r3, [r7, #24]
|
|
if (precision < 0) precision = 0;
|
|
}
|
|
#endif
|
|
|
|
// Get the conversion qualifier
|
|
qualifier = -1;
|
|
800ddf4: f04f 33ff mov.w r3, #4294967295 @ 0xffffffff
|
|
800ddf8: 617b str r3, [r7, #20]
|
|
fmt++;
|
|
}
|
|
#endif
|
|
|
|
// Default base
|
|
base = 10;
|
|
800ddfa: 230a movs r3, #10
|
|
800ddfc: 633b str r3, [r7, #48] @ 0x30
|
|
|
|
switch (*fmt)
|
|
800ddfe: 687b ldr r3, [r7, #4]
|
|
800de00: 781b ldrb r3, [r3, #0]
|
|
800de02: 3b58 subs r3, #88 @ 0x58
|
|
800de04: 2b20 cmp r3, #32
|
|
800de06: f200 8094 bhi.w 800df32 <tiny_vsnprintf_like+0x1c2>
|
|
800de0a: a201 add r2, pc, #4 @ (adr r2, 800de10 <tiny_vsnprintf_like+0xa0>)
|
|
800de0c: f852 f023 ldr.w pc, [r2, r3, lsl #2]
|
|
800de10: 0800df1b .word 0x0800df1b
|
|
800de14: 0800df33 .word 0x0800df33
|
|
800de18: 0800df33 .word 0x0800df33
|
|
800de1c: 0800df33 .word 0x0800df33
|
|
800de20: 0800df33 .word 0x0800df33
|
|
800de24: 0800df33 .word 0x0800df33
|
|
800de28: 0800df33 .word 0x0800df33
|
|
800de2c: 0800df33 .word 0x0800df33
|
|
800de30: 0800df33 .word 0x0800df33
|
|
800de34: 0800df33 .word 0x0800df33
|
|
800de38: 0800df33 .word 0x0800df33
|
|
800de3c: 0800de9f .word 0x0800de9f
|
|
800de40: 0800df29 .word 0x0800df29
|
|
800de44: 0800df33 .word 0x0800df33
|
|
800de48: 0800df33 .word 0x0800df33
|
|
800de4c: 0800df33 .word 0x0800df33
|
|
800de50: 0800df33 .word 0x0800df33
|
|
800de54: 0800df29 .word 0x0800df29
|
|
800de58: 0800df33 .word 0x0800df33
|
|
800de5c: 0800df33 .word 0x0800df33
|
|
800de60: 0800df33 .word 0x0800df33
|
|
800de64: 0800df33 .word 0x0800df33
|
|
800de68: 0800df33 .word 0x0800df33
|
|
800de6c: 0800df33 .word 0x0800df33
|
|
800de70: 0800df33 .word 0x0800df33
|
|
800de74: 0800df33 .word 0x0800df33
|
|
800de78: 0800df33 .word 0x0800df33
|
|
800de7c: 0800debf .word 0x0800debf
|
|
800de80: 0800df33 .word 0x0800df33
|
|
800de84: 0800df7f .word 0x0800df7f
|
|
800de88: 0800df33 .word 0x0800df33
|
|
800de8c: 0800df33 .word 0x0800df33
|
|
800de90: 0800df23 .word 0x0800df23
|
|
case 'c':
|
|
#ifdef TINY_PRINTF
|
|
#else
|
|
if (!(flags & LEFT))
|
|
#endif
|
|
while (--field_width > 0) *str++ = ' ';
|
|
800de94: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
800de96: 1c5a adds r2, r3, #1
|
|
800de98: 62fa str r2, [r7, #44] @ 0x2c
|
|
800de9a: 2220 movs r2, #32
|
|
800de9c: 701a strb r2, [r3, #0]
|
|
800de9e: 69fb ldr r3, [r7, #28]
|
|
800dea0: 3b01 subs r3, #1
|
|
800dea2: 61fb str r3, [r7, #28]
|
|
800dea4: 69fb ldr r3, [r7, #28]
|
|
800dea6: 2b00 cmp r3, #0
|
|
800dea8: dcf4 bgt.n 800de94 <tiny_vsnprintf_like+0x124>
|
|
*str++ = (unsigned char) va_arg(args, int);
|
|
800deaa: 683b ldr r3, [r7, #0]
|
|
800deac: 1d1a adds r2, r3, #4
|
|
800deae: 603a str r2, [r7, #0]
|
|
800deb0: 6819 ldr r1, [r3, #0]
|
|
800deb2: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
800deb4: 1c5a adds r2, r3, #1
|
|
800deb6: 62fa str r2, [r7, #44] @ 0x2c
|
|
800deb8: b2ca uxtb r2, r1
|
|
800deba: 701a strb r2, [r3, #0]
|
|
#ifdef TINY_PRINTF
|
|
#else
|
|
while (--field_width > 0) *str++ = ' ';
|
|
#endif
|
|
continue;
|
|
800debc: e08d b.n 800dfda <tiny_vsnprintf_like+0x26a>
|
|
|
|
case 's':
|
|
s = va_arg(args, char *);
|
|
800debe: 683b ldr r3, [r7, #0]
|
|
800dec0: 1d1a adds r2, r3, #4
|
|
800dec2: 603a str r2, [r7, #0]
|
|
800dec4: 681b ldr r3, [r3, #0]
|
|
800dec6: 627b str r3, [r7, #36] @ 0x24
|
|
if (!s) s = "<NULL>";
|
|
800dec8: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
800deca: 2b00 cmp r3, #0
|
|
800decc: d101 bne.n 800ded2 <tiny_vsnprintf_like+0x162>
|
|
800dece: 4b50 ldr r3, [pc, #320] @ (800e010 <tiny_vsnprintf_like+0x2a0>)
|
|
800ded0: 627b str r3, [r7, #36] @ 0x24
|
|
#ifdef TINY_PRINTF
|
|
len = strlen(s);
|
|
800ded2: 6a78 ldr r0, [r7, #36] @ 0x24
|
|
800ded4: f7f2 f95e bl 8000194 <strlen>
|
|
800ded8: 4603 mov r3, r0
|
|
800deda: 613b str r3, [r7, #16]
|
|
#else
|
|
len = strnlen(s, precision);
|
|
if (!(flags & LEFT))
|
|
#endif
|
|
while (len < field_width--) *str++ = ' ';
|
|
800dedc: e004 b.n 800dee8 <tiny_vsnprintf_like+0x178>
|
|
800dede: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
800dee0: 1c5a adds r2, r3, #1
|
|
800dee2: 62fa str r2, [r7, #44] @ 0x2c
|
|
800dee4: 2220 movs r2, #32
|
|
800dee6: 701a strb r2, [r3, #0]
|
|
800dee8: 69fb ldr r3, [r7, #28]
|
|
800deea: 1e5a subs r2, r3, #1
|
|
800deec: 61fa str r2, [r7, #28]
|
|
800deee: 693a ldr r2, [r7, #16]
|
|
800def0: 429a cmp r2, r3
|
|
800def2: dbf4 blt.n 800dede <tiny_vsnprintf_like+0x16e>
|
|
for (i = 0; i < len; ++i) *str++ = *s++;
|
|
800def4: 2300 movs r3, #0
|
|
800def6: 62bb str r3, [r7, #40] @ 0x28
|
|
800def8: e00a b.n 800df10 <tiny_vsnprintf_like+0x1a0>
|
|
800defa: 6a7a ldr r2, [r7, #36] @ 0x24
|
|
800defc: 1c53 adds r3, r2, #1
|
|
800defe: 627b str r3, [r7, #36] @ 0x24
|
|
800df00: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
800df02: 1c59 adds r1, r3, #1
|
|
800df04: 62f9 str r1, [r7, #44] @ 0x2c
|
|
800df06: 7812 ldrb r2, [r2, #0]
|
|
800df08: 701a strb r2, [r3, #0]
|
|
800df0a: 6abb ldr r3, [r7, #40] @ 0x28
|
|
800df0c: 3301 adds r3, #1
|
|
800df0e: 62bb str r3, [r7, #40] @ 0x28
|
|
800df10: 6aba ldr r2, [r7, #40] @ 0x28
|
|
800df12: 693b ldr r3, [r7, #16]
|
|
800df14: 429a cmp r2, r3
|
|
800df16: dbf0 blt.n 800defa <tiny_vsnprintf_like+0x18a>
|
|
#ifdef TINY_PRINTF
|
|
#else
|
|
while (len < field_width--) *str++ = ' ';
|
|
#endif
|
|
continue;
|
|
800df18: e05f b.n 800dfda <tiny_vsnprintf_like+0x26a>
|
|
base = 8;
|
|
break;
|
|
#endif
|
|
|
|
case 'X':
|
|
flags |= UPPERCASE;
|
|
800df1a: 6a3b ldr r3, [r7, #32]
|
|
800df1c: f043 0340 orr.w r3, r3, #64 @ 0x40
|
|
800df20: 623b str r3, [r7, #32]
|
|
|
|
case 'x':
|
|
base = 16;
|
|
800df22: 2310 movs r3, #16
|
|
800df24: 633b str r3, [r7, #48] @ 0x30
|
|
break;
|
|
800df26: e02b b.n 800df80 <tiny_vsnprintf_like+0x210>
|
|
|
|
case 'd':
|
|
case 'i':
|
|
flags |= SIGN;
|
|
800df28: 6a3b ldr r3, [r7, #32]
|
|
800df2a: f043 0302 orr.w r3, r3, #2
|
|
800df2e: 623b str r3, [r7, #32]
|
|
|
|
case 'u':
|
|
break;
|
|
800df30: e025 b.n 800df7e <tiny_vsnprintf_like+0x20e>
|
|
continue;
|
|
|
|
#endif
|
|
|
|
default:
|
|
if (*fmt != '%') *str++ = '%';
|
|
800df32: 687b ldr r3, [r7, #4]
|
|
800df34: 781b ldrb r3, [r3, #0]
|
|
800df36: 2b25 cmp r3, #37 @ 0x25
|
|
800df38: d004 beq.n 800df44 <tiny_vsnprintf_like+0x1d4>
|
|
800df3a: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
800df3c: 1c5a adds r2, r3, #1
|
|
800df3e: 62fa str r2, [r7, #44] @ 0x2c
|
|
800df40: 2225 movs r2, #37 @ 0x25
|
|
800df42: 701a strb r2, [r3, #0]
|
|
CHECK_STR_SIZE(buf, str, size);
|
|
800df44: 6afa ldr r2, [r7, #44] @ 0x2c
|
|
800df46: 68fb ldr r3, [r7, #12]
|
|
800df48: 1ad2 subs r2, r2, r3
|
|
800df4a: 68bb ldr r3, [r7, #8]
|
|
800df4c: 3b01 subs r3, #1
|
|
800df4e: 429a cmp r2, r3
|
|
800df50: da16 bge.n 800df80 <tiny_vsnprintf_like+0x210>
|
|
if (*fmt)
|
|
800df52: 687b ldr r3, [r7, #4]
|
|
800df54: 781b ldrb r3, [r3, #0]
|
|
800df56: 2b00 cmp r3, #0
|
|
800df58: d006 beq.n 800df68 <tiny_vsnprintf_like+0x1f8>
|
|
*str++ = *fmt;
|
|
800df5a: 687a ldr r2, [r7, #4]
|
|
800df5c: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
800df5e: 1c59 adds r1, r3, #1
|
|
800df60: 62f9 str r1, [r7, #44] @ 0x2c
|
|
800df62: 7812 ldrb r2, [r2, #0]
|
|
800df64: 701a strb r2, [r3, #0]
|
|
800df66: e002 b.n 800df6e <tiny_vsnprintf_like+0x1fe>
|
|
else
|
|
--fmt;
|
|
800df68: 687b ldr r3, [r7, #4]
|
|
800df6a: 3b01 subs r3, #1
|
|
800df6c: 607b str r3, [r7, #4]
|
|
CHECK_STR_SIZE(buf, str, size);
|
|
800df6e: 6afa ldr r2, [r7, #44] @ 0x2c
|
|
800df70: 68fb ldr r3, [r7, #12]
|
|
800df72: 1ad2 subs r2, r2, r3
|
|
800df74: 68bb ldr r3, [r7, #8]
|
|
800df76: 3b01 subs r3, #1
|
|
800df78: 429a cmp r2, r3
|
|
800df7a: db2d blt.n 800dfd8 <tiny_vsnprintf_like+0x268>
|
|
800df7c: e000 b.n 800df80 <tiny_vsnprintf_like+0x210>
|
|
break;
|
|
800df7e: bf00 nop
|
|
continue;
|
|
}
|
|
|
|
if (qualifier == 'l')
|
|
800df80: 697b ldr r3, [r7, #20]
|
|
800df82: 2b6c cmp r3, #108 @ 0x6c
|
|
800df84: d105 bne.n 800df92 <tiny_vsnprintf_like+0x222>
|
|
num = va_arg(args, unsigned long);
|
|
800df86: 683b ldr r3, [r7, #0]
|
|
800df88: 1d1a adds r2, r3, #4
|
|
800df8a: 603a str r2, [r7, #0]
|
|
800df8c: 681b ldr r3, [r3, #0]
|
|
800df8e: 637b str r3, [r7, #52] @ 0x34
|
|
800df90: e00f b.n 800dfb2 <tiny_vsnprintf_like+0x242>
|
|
else if (flags & SIGN)
|
|
800df92: 6a3b ldr r3, [r7, #32]
|
|
800df94: f003 0302 and.w r3, r3, #2
|
|
800df98: 2b00 cmp r3, #0
|
|
800df9a: d005 beq.n 800dfa8 <tiny_vsnprintf_like+0x238>
|
|
num = va_arg(args, int);
|
|
800df9c: 683b ldr r3, [r7, #0]
|
|
800df9e: 1d1a adds r2, r3, #4
|
|
800dfa0: 603a str r2, [r7, #0]
|
|
800dfa2: 681b ldr r3, [r3, #0]
|
|
800dfa4: 637b str r3, [r7, #52] @ 0x34
|
|
800dfa6: e004 b.n 800dfb2 <tiny_vsnprintf_like+0x242>
|
|
else
|
|
num = va_arg(args, unsigned int);
|
|
800dfa8: 683b ldr r3, [r7, #0]
|
|
800dfaa: 1d1a adds r2, r3, #4
|
|
800dfac: 603a str r2, [r7, #0]
|
|
800dfae: 681b ldr r3, [r3, #0]
|
|
800dfb0: 637b str r3, [r7, #52] @ 0x34
|
|
|
|
str = ee_number(str, ((size - 1) - (str - buf)), num, base, field_width, precision, flags);
|
|
800dfb2: 68bb ldr r3, [r7, #8]
|
|
800dfb4: 1e5a subs r2, r3, #1
|
|
800dfb6: 6af9 ldr r1, [r7, #44] @ 0x2c
|
|
800dfb8: 68fb ldr r3, [r7, #12]
|
|
800dfba: 1acb subs r3, r1, r3
|
|
800dfbc: 1ad1 subs r1, r2, r3
|
|
800dfbe: 6b7a ldr r2, [r7, #52] @ 0x34
|
|
800dfc0: 6a3b ldr r3, [r7, #32]
|
|
800dfc2: 9302 str r3, [sp, #8]
|
|
800dfc4: 69bb ldr r3, [r7, #24]
|
|
800dfc6: 9301 str r3, [sp, #4]
|
|
800dfc8: 69fb ldr r3, [r7, #28]
|
|
800dfca: 9300 str r3, [sp, #0]
|
|
800dfcc: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
800dfce: 6af8 ldr r0, [r7, #44] @ 0x2c
|
|
800dfd0: f7ff fde0 bl 800db94 <ee_number>
|
|
800dfd4: 62f8 str r0, [r7, #44] @ 0x2c
|
|
800dfd6: e000 b.n 800dfda <tiny_vsnprintf_like+0x26a>
|
|
continue;
|
|
800dfd8: bf00 nop
|
|
for (str = buf; *fmt || ((str - buf) >= size-1); fmt++)
|
|
800dfda: 687b ldr r3, [r7, #4]
|
|
800dfdc: 3301 adds r3, #1
|
|
800dfde: 607b str r3, [r7, #4]
|
|
800dfe0: 687b ldr r3, [r7, #4]
|
|
800dfe2: 781b ldrb r3, [r3, #0]
|
|
800dfe4: 2b00 cmp r3, #0
|
|
800dfe6: f47f aed2 bne.w 800dd8e <tiny_vsnprintf_like+0x1e>
|
|
800dfea: 6afa ldr r2, [r7, #44] @ 0x2c
|
|
800dfec: 68fb ldr r3, [r7, #12]
|
|
800dfee: 1ad2 subs r2, r2, r3
|
|
800dff0: 68bb ldr r3, [r7, #8]
|
|
800dff2: 3b01 subs r3, #1
|
|
800dff4: 429a cmp r2, r3
|
|
800dff6: f6bf aeca bge.w 800dd8e <tiny_vsnprintf_like+0x1e>
|
|
}
|
|
|
|
*str = '\0';
|
|
800dffa: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
800dffc: 2200 movs r2, #0
|
|
800dffe: 701a strb r2, [r3, #0]
|
|
return str - buf;
|
|
800e000: 6afa ldr r2, [r7, #44] @ 0x2c
|
|
800e002: 68fb ldr r3, [r7, #12]
|
|
800e004: 1ad3 subs r3, r2, r3
|
|
}
|
|
800e006: 4618 mov r0, r3
|
|
800e008: 3738 adds r7, #56 @ 0x38
|
|
800e00a: 46bd mov sp, r7
|
|
800e00c: bd80 pop {r7, pc}
|
|
800e00e: bf00 nop
|
|
800e010: 0801028c .word 0x0801028c
|
|
|
|
0800e014 <UTIL_SEQ_Run>:
|
|
* That is the reason why many variables that are used only in that function are declared static.
|
|
* Note: These variables could have been declared static in the function.
|
|
*
|
|
*/
|
|
void UTIL_SEQ_Run( UTIL_SEQ_bm_t Mask_bm )
|
|
{
|
|
800e014: b580 push {r7, lr}
|
|
800e016: b090 sub sp, #64 @ 0x40
|
|
800e018: af00 add r7, sp, #0
|
|
800e01a: 6078 str r0, [r7, #4]
|
|
/*
|
|
* When this function is nested, the mask to be applied cannot be larger than the first call
|
|
* The mask is always getting smaller and smaller
|
|
* A copy is made of the mask set by UTIL_SEQ_Run() in case it is called again in the task
|
|
*/
|
|
super_mask_backup = SuperMask;
|
|
800e01c: 4b73 ldr r3, [pc, #460] @ (800e1ec <UTIL_SEQ_Run+0x1d8>)
|
|
800e01e: 681b ldr r3, [r3, #0]
|
|
800e020: 62bb str r3, [r7, #40] @ 0x28
|
|
SuperMask &= Mask_bm;
|
|
800e022: 4b72 ldr r3, [pc, #456] @ (800e1ec <UTIL_SEQ_Run+0x1d8>)
|
|
800e024: 681a ldr r2, [r3, #0]
|
|
800e026: 687b ldr r3, [r7, #4]
|
|
800e028: 4013 ands r3, r2
|
|
800e02a: 4a70 ldr r2, [pc, #448] @ (800e1ec <UTIL_SEQ_Run+0x1d8>)
|
|
800e02c: 6013 str r3, [r2, #0]
|
|
* TaskMask that comes from UTIL_SEQ_PauseTask() / UTIL_SEQ_ResumeTask
|
|
* SuperMask that comes from UTIL_SEQ_Run
|
|
* If the waited event is there, exit from UTIL_SEQ_Run() to return to the
|
|
* waiting task
|
|
*/
|
|
local_taskset = TaskSet;
|
|
800e02e: 4b70 ldr r3, [pc, #448] @ (800e1f0 <UTIL_SEQ_Run+0x1dc>)
|
|
800e030: 681b ldr r3, [r3, #0]
|
|
800e032: 63bb str r3, [r7, #56] @ 0x38
|
|
local_evtset = EvtSet;
|
|
800e034: 4b6f ldr r3, [pc, #444] @ (800e1f4 <UTIL_SEQ_Run+0x1e0>)
|
|
800e036: 681b ldr r3, [r3, #0]
|
|
800e038: 637b str r3, [r7, #52] @ 0x34
|
|
local_taskmask = TaskMask;
|
|
800e03a: 4b6f ldr r3, [pc, #444] @ (800e1f8 <UTIL_SEQ_Run+0x1e4>)
|
|
800e03c: 681b ldr r3, [r3, #0]
|
|
800e03e: 633b str r3, [r7, #48] @ 0x30
|
|
local_evtwaited = EvtWaited;
|
|
800e040: 4b6e ldr r3, [pc, #440] @ (800e1fc <UTIL_SEQ_Run+0x1e8>)
|
|
800e042: 681b ldr r3, [r3, #0]
|
|
800e044: 62fb str r3, [r7, #44] @ 0x2c
|
|
while(((local_taskset & local_taskmask & SuperMask) != 0U) && ((local_evtset & local_evtwaited)==0U))
|
|
800e046: e08d b.n 800e164 <UTIL_SEQ_Run+0x150>
|
|
{
|
|
counter = 0U;
|
|
800e048: 2300 movs r3, #0
|
|
800e04a: 63fb str r3, [r7, #60] @ 0x3c
|
|
/*
|
|
* When a flag is set, the associated bit is set in TaskPrio[counter].priority mask depending
|
|
* on the priority parameter given from UTIL_SEQ_SetTask()
|
|
* The while loop is looking for a flag set from the highest priority maskr to the lower
|
|
*/
|
|
while((TaskPrio[counter].priority & local_taskmask & SuperMask)== 0U)
|
|
800e04c: e002 b.n 800e054 <UTIL_SEQ_Run+0x40>
|
|
{
|
|
counter++;
|
|
800e04e: 6bfb ldr r3, [r7, #60] @ 0x3c
|
|
800e050: 3301 adds r3, #1
|
|
800e052: 63fb str r3, [r7, #60] @ 0x3c
|
|
while((TaskPrio[counter].priority & local_taskmask & SuperMask)== 0U)
|
|
800e054: 4a6a ldr r2, [pc, #424] @ (800e200 <UTIL_SEQ_Run+0x1ec>)
|
|
800e056: 6bfb ldr r3, [r7, #60] @ 0x3c
|
|
800e058: f852 2033 ldr.w r2, [r2, r3, lsl #3]
|
|
800e05c: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
800e05e: 401a ands r2, r3
|
|
800e060: 4b62 ldr r3, [pc, #392] @ (800e1ec <UTIL_SEQ_Run+0x1d8>)
|
|
800e062: 681b ldr r3, [r3, #0]
|
|
800e064: 4013 ands r3, r2
|
|
800e066: 2b00 cmp r3, #0
|
|
800e068: d0f1 beq.n 800e04e <UTIL_SEQ_Run+0x3a>
|
|
}
|
|
|
|
current_task_set = TaskPrio[counter].priority & local_taskmask & SuperMask;
|
|
800e06a: 4a65 ldr r2, [pc, #404] @ (800e200 <UTIL_SEQ_Run+0x1ec>)
|
|
800e06c: 6bfb ldr r3, [r7, #60] @ 0x3c
|
|
800e06e: f852 2033 ldr.w r2, [r2, r3, lsl #3]
|
|
800e072: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
800e074: 401a ands r2, r3
|
|
800e076: 4b5d ldr r3, [pc, #372] @ (800e1ec <UTIL_SEQ_Run+0x1d8>)
|
|
800e078: 681b ldr r3, [r3, #0]
|
|
800e07a: 4013 ands r3, r2
|
|
800e07c: 627b str r3, [r7, #36] @ 0x24
|
|
* so that the second one can be executed.
|
|
* Note that the first flag is not removed from the list of pending task but just masked by the round_robin mask
|
|
*
|
|
* In the check below, the round_robin mask is reinitialize in case all pending tasks haven been executed at least once
|
|
*/
|
|
if ((TaskPrio[counter].round_robin & current_task_set) == 0U)
|
|
800e07e: 4a60 ldr r2, [pc, #384] @ (800e200 <UTIL_SEQ_Run+0x1ec>)
|
|
800e080: 6bfb ldr r3, [r7, #60] @ 0x3c
|
|
800e082: 00db lsls r3, r3, #3
|
|
800e084: 4413 add r3, r2
|
|
800e086: 685a ldr r2, [r3, #4]
|
|
800e088: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
800e08a: 4013 ands r3, r2
|
|
800e08c: 2b00 cmp r3, #0
|
|
800e08e: d106 bne.n 800e09e <UTIL_SEQ_Run+0x8a>
|
|
{
|
|
TaskPrio[counter].round_robin = UTIL_SEQ_ALL_BIT_SET;
|
|
800e090: 4a5b ldr r2, [pc, #364] @ (800e200 <UTIL_SEQ_Run+0x1ec>)
|
|
800e092: 6bfb ldr r3, [r7, #60] @ 0x3c
|
|
800e094: 00db lsls r3, r3, #3
|
|
800e096: 4413 add r3, r2
|
|
800e098: f04f 32ff mov.w r2, #4294967295 @ 0xffffffff
|
|
800e09c: 605a str r2, [r3, #4]
|
|
/*
|
|
* Read the flag index of the task to be executed
|
|
* Once the index is read, the associated task will be executed even though a higher priority stack is requested
|
|
* before task execution.
|
|
*/
|
|
CurrentTaskIdx = (SEQ_BitPosition(current_task_set & TaskPrio[counter].round_robin));
|
|
800e09e: 4a58 ldr r2, [pc, #352] @ (800e200 <UTIL_SEQ_Run+0x1ec>)
|
|
800e0a0: 6bfb ldr r3, [r7, #60] @ 0x3c
|
|
800e0a2: 00db lsls r3, r3, #3
|
|
800e0a4: 4413 add r3, r2
|
|
800e0a6: 685a ldr r2, [r3, #4]
|
|
800e0a8: 6a7b ldr r3, [r7, #36] @ 0x24
|
|
800e0aa: 4013 ands r3, r2
|
|
800e0ac: 4618 mov r0, r3
|
|
800e0ae: f000 f8b9 bl 800e224 <SEQ_BitPosition>
|
|
800e0b2: 4603 mov r3, r0
|
|
800e0b4: 461a mov r2, r3
|
|
800e0b6: 4b53 ldr r3, [pc, #332] @ (800e204 <UTIL_SEQ_Run+0x1f0>)
|
|
800e0b8: 601a str r2, [r3, #0]
|
|
|
|
/*
|
|
* remove from the roun_robin mask the task that has been selected to be executed
|
|
*/
|
|
TaskPrio[counter].round_robin &= ~(1U << CurrentTaskIdx);
|
|
800e0ba: 4a51 ldr r2, [pc, #324] @ (800e200 <UTIL_SEQ_Run+0x1ec>)
|
|
800e0bc: 6bfb ldr r3, [r7, #60] @ 0x3c
|
|
800e0be: 00db lsls r3, r3, #3
|
|
800e0c0: 4413 add r3, r2
|
|
800e0c2: 685a ldr r2, [r3, #4]
|
|
800e0c4: 4b4f ldr r3, [pc, #316] @ (800e204 <UTIL_SEQ_Run+0x1f0>)
|
|
800e0c6: 681b ldr r3, [r3, #0]
|
|
800e0c8: 2101 movs r1, #1
|
|
800e0ca: fa01 f303 lsl.w r3, r1, r3
|
|
800e0ce: 43db mvns r3, r3
|
|
800e0d0: 401a ands r2, r3
|
|
800e0d2: 494b ldr r1, [pc, #300] @ (800e200 <UTIL_SEQ_Run+0x1ec>)
|
|
800e0d4: 6bfb ldr r3, [r7, #60] @ 0x3c
|
|
800e0d6: 00db lsls r3, r3, #3
|
|
800e0d8: 440b add r3, r1
|
|
800e0da: 605a str r2, [r3, #4]
|
|
__ASM volatile ("MRS %0, primask" : "=r" (result) :: "memory");
|
|
800e0dc: f3ef 8310 mrs r3, PRIMASK
|
|
800e0e0: 61bb str r3, [r7, #24]
|
|
return(result);
|
|
800e0e2: 69bb ldr r3, [r7, #24]
|
|
|
|
UTIL_SEQ_ENTER_CRITICAL_SECTION( );
|
|
800e0e4: 623b str r3, [r7, #32]
|
|
__ASM volatile ("cpsid i" : : : "memory");
|
|
800e0e6: b672 cpsid i
|
|
}
|
|
800e0e8: bf00 nop
|
|
/* remove from the list or pending task the one that has been selected to be executed */
|
|
TaskSet &= ~(1U << CurrentTaskIdx);
|
|
800e0ea: 4b46 ldr r3, [pc, #280] @ (800e204 <UTIL_SEQ_Run+0x1f0>)
|
|
800e0ec: 681b ldr r3, [r3, #0]
|
|
800e0ee: 2201 movs r2, #1
|
|
800e0f0: fa02 f303 lsl.w r3, r2, r3
|
|
800e0f4: 43da mvns r2, r3
|
|
800e0f6: 4b3e ldr r3, [pc, #248] @ (800e1f0 <UTIL_SEQ_Run+0x1dc>)
|
|
800e0f8: 681b ldr r3, [r3, #0]
|
|
800e0fa: 4013 ands r3, r2
|
|
800e0fc: 4a3c ldr r2, [pc, #240] @ (800e1f0 <UTIL_SEQ_Run+0x1dc>)
|
|
800e0fe: 6013 str r3, [r2, #0]
|
|
/* remove from all priority mask the task that has been selected to be executed */
|
|
for (counter = UTIL_SEQ_CONF_PRIO_NBR; counter != 0U; counter--)
|
|
800e100: 2301 movs r3, #1
|
|
800e102: 63fb str r3, [r7, #60] @ 0x3c
|
|
800e104: e013 b.n 800e12e <UTIL_SEQ_Run+0x11a>
|
|
{
|
|
TaskPrio[counter - 1U].priority &= ~(1U << CurrentTaskIdx);
|
|
800e106: 6bfb ldr r3, [r7, #60] @ 0x3c
|
|
800e108: 3b01 subs r3, #1
|
|
800e10a: 4a3d ldr r2, [pc, #244] @ (800e200 <UTIL_SEQ_Run+0x1ec>)
|
|
800e10c: f852 1033 ldr.w r1, [r2, r3, lsl #3]
|
|
800e110: 4b3c ldr r3, [pc, #240] @ (800e204 <UTIL_SEQ_Run+0x1f0>)
|
|
800e112: 681b ldr r3, [r3, #0]
|
|
800e114: 2201 movs r2, #1
|
|
800e116: fa02 f303 lsl.w r3, r2, r3
|
|
800e11a: 43da mvns r2, r3
|
|
800e11c: 6bfb ldr r3, [r7, #60] @ 0x3c
|
|
800e11e: 3b01 subs r3, #1
|
|
800e120: 400a ands r2, r1
|
|
800e122: 4937 ldr r1, [pc, #220] @ (800e200 <UTIL_SEQ_Run+0x1ec>)
|
|
800e124: f841 2033 str.w r2, [r1, r3, lsl #3]
|
|
for (counter = UTIL_SEQ_CONF_PRIO_NBR; counter != 0U; counter--)
|
|
800e128: 6bfb ldr r3, [r7, #60] @ 0x3c
|
|
800e12a: 3b01 subs r3, #1
|
|
800e12c: 63fb str r3, [r7, #60] @ 0x3c
|
|
800e12e: 6bfb ldr r3, [r7, #60] @ 0x3c
|
|
800e130: 2b00 cmp r3, #0
|
|
800e132: d1e8 bne.n 800e106 <UTIL_SEQ_Run+0xf2>
|
|
800e134: 6a3b ldr r3, [r7, #32]
|
|
800e136: 617b str r3, [r7, #20]
|
|
__ASM volatile ("MSR primask, %0" : : "r" (priMask) : "memory");
|
|
800e138: 697b ldr r3, [r7, #20]
|
|
800e13a: f383 8810 msr PRIMASK, r3
|
|
}
|
|
800e13e: bf00 nop
|
|
}
|
|
UTIL_SEQ_EXIT_CRITICAL_SECTION( );
|
|
|
|
/* Execute the task */
|
|
TaskCb[CurrentTaskIdx]( );
|
|
800e140: 4b30 ldr r3, [pc, #192] @ (800e204 <UTIL_SEQ_Run+0x1f0>)
|
|
800e142: 681b ldr r3, [r3, #0]
|
|
800e144: 4a30 ldr r2, [pc, #192] @ (800e208 <UTIL_SEQ_Run+0x1f4>)
|
|
800e146: f852 3023 ldr.w r3, [r2, r3, lsl #2]
|
|
800e14a: 4798 blx r3
|
|
|
|
local_taskset = TaskSet;
|
|
800e14c: 4b28 ldr r3, [pc, #160] @ (800e1f0 <UTIL_SEQ_Run+0x1dc>)
|
|
800e14e: 681b ldr r3, [r3, #0]
|
|
800e150: 63bb str r3, [r7, #56] @ 0x38
|
|
local_evtset = EvtSet;
|
|
800e152: 4b28 ldr r3, [pc, #160] @ (800e1f4 <UTIL_SEQ_Run+0x1e0>)
|
|
800e154: 681b ldr r3, [r3, #0]
|
|
800e156: 637b str r3, [r7, #52] @ 0x34
|
|
local_taskmask = TaskMask;
|
|
800e158: 4b27 ldr r3, [pc, #156] @ (800e1f8 <UTIL_SEQ_Run+0x1e4>)
|
|
800e15a: 681b ldr r3, [r3, #0]
|
|
800e15c: 633b str r3, [r7, #48] @ 0x30
|
|
local_evtwaited = EvtWaited;
|
|
800e15e: 4b27 ldr r3, [pc, #156] @ (800e1fc <UTIL_SEQ_Run+0x1e8>)
|
|
800e160: 681b ldr r3, [r3, #0]
|
|
800e162: 62fb str r3, [r7, #44] @ 0x2c
|
|
while(((local_taskset & local_taskmask & SuperMask) != 0U) && ((local_evtset & local_evtwaited)==0U))
|
|
800e164: 6bba ldr r2, [r7, #56] @ 0x38
|
|
800e166: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
800e168: 401a ands r2, r3
|
|
800e16a: 4b20 ldr r3, [pc, #128] @ (800e1ec <UTIL_SEQ_Run+0x1d8>)
|
|
800e16c: 681b ldr r3, [r3, #0]
|
|
800e16e: 4013 ands r3, r2
|
|
800e170: 2b00 cmp r3, #0
|
|
800e172: d005 beq.n 800e180 <UTIL_SEQ_Run+0x16c>
|
|
800e174: 6b7a ldr r2, [r7, #52] @ 0x34
|
|
800e176: 6afb ldr r3, [r7, #44] @ 0x2c
|
|
800e178: 4013 ands r3, r2
|
|
800e17a: 2b00 cmp r3, #0
|
|
800e17c: f43f af64 beq.w 800e048 <UTIL_SEQ_Run+0x34>
|
|
}
|
|
|
|
/* the set of CurrentTaskIdx to no task running allows to call WaitEvt in the Pre/Post ilde context */
|
|
CurrentTaskIdx = UTIL_SEQ_NOTASKRUNNING;
|
|
800e180: 4b20 ldr r3, [pc, #128] @ (800e204 <UTIL_SEQ_Run+0x1f0>)
|
|
800e182: f04f 32ff mov.w r2, #4294967295 @ 0xffffffff
|
|
800e186: 601a str r2, [r3, #0]
|
|
UTIL_SEQ_PreIdle( );
|
|
800e188: f000 f840 bl 800e20c <UTIL_SEQ_PreIdle>
|
|
__ASM volatile ("MRS %0, primask" : "=r" (result) :: "memory");
|
|
800e18c: f3ef 8310 mrs r3, PRIMASK
|
|
800e190: 613b str r3, [r7, #16]
|
|
return(result);
|
|
800e192: 693b ldr r3, [r7, #16]
|
|
|
|
UTIL_SEQ_ENTER_CRITICAL_SECTION_IDLE( );
|
|
800e194: 61fb str r3, [r7, #28]
|
|
__ASM volatile ("cpsid i" : : : "memory");
|
|
800e196: b672 cpsid i
|
|
}
|
|
800e198: bf00 nop
|
|
local_taskset = TaskSet;
|
|
800e19a: 4b15 ldr r3, [pc, #84] @ (800e1f0 <UTIL_SEQ_Run+0x1dc>)
|
|
800e19c: 681b ldr r3, [r3, #0]
|
|
800e19e: 63bb str r3, [r7, #56] @ 0x38
|
|
local_evtset = EvtSet;
|
|
800e1a0: 4b14 ldr r3, [pc, #80] @ (800e1f4 <UTIL_SEQ_Run+0x1e0>)
|
|
800e1a2: 681b ldr r3, [r3, #0]
|
|
800e1a4: 637b str r3, [r7, #52] @ 0x34
|
|
local_taskmask = TaskMask;
|
|
800e1a6: 4b14 ldr r3, [pc, #80] @ (800e1f8 <UTIL_SEQ_Run+0x1e4>)
|
|
800e1a8: 681b ldr r3, [r3, #0]
|
|
800e1aa: 633b str r3, [r7, #48] @ 0x30
|
|
if ((local_taskset & local_taskmask & SuperMask) == 0U)
|
|
800e1ac: 6bba ldr r2, [r7, #56] @ 0x38
|
|
800e1ae: 6b3b ldr r3, [r7, #48] @ 0x30
|
|
800e1b0: 401a ands r2, r3
|
|
800e1b2: 4b0e ldr r3, [pc, #56] @ (800e1ec <UTIL_SEQ_Run+0x1d8>)
|
|
800e1b4: 681b ldr r3, [r3, #0]
|
|
800e1b6: 4013 ands r3, r2
|
|
800e1b8: 2b00 cmp r3, #0
|
|
800e1ba: d107 bne.n 800e1cc <UTIL_SEQ_Run+0x1b8>
|
|
{
|
|
if ((local_evtset & EvtWaited)== 0U)
|
|
800e1bc: 4b0f ldr r3, [pc, #60] @ (800e1fc <UTIL_SEQ_Run+0x1e8>)
|
|
800e1be: 681a ldr r2, [r3, #0]
|
|
800e1c0: 6b7b ldr r3, [r7, #52] @ 0x34
|
|
800e1c2: 4013 ands r3, r2
|
|
800e1c4: 2b00 cmp r3, #0
|
|
800e1c6: d101 bne.n 800e1cc <UTIL_SEQ_Run+0x1b8>
|
|
{
|
|
UTIL_SEQ_Idle( );
|
|
800e1c8: f7f2 fce8 bl 8000b9c <UTIL_SEQ_Idle>
|
|
800e1cc: 69fb ldr r3, [r7, #28]
|
|
800e1ce: 60fb str r3, [r7, #12]
|
|
__ASM volatile ("MSR primask, %0" : : "r" (priMask) : "memory");
|
|
800e1d0: 68fb ldr r3, [r7, #12]
|
|
800e1d2: f383 8810 msr PRIMASK, r3
|
|
}
|
|
800e1d6: bf00 nop
|
|
}
|
|
}
|
|
UTIL_SEQ_EXIT_CRITICAL_SECTION_IDLE( );
|
|
|
|
UTIL_SEQ_PostIdle( );
|
|
800e1d8: f000 f81e bl 800e218 <UTIL_SEQ_PostIdle>
|
|
|
|
/* restore the mask from UTIL_SEQ_Run() */
|
|
SuperMask = super_mask_backup;
|
|
800e1dc: 4a03 ldr r2, [pc, #12] @ (800e1ec <UTIL_SEQ_Run+0x1d8>)
|
|
800e1de: 6abb ldr r3, [r7, #40] @ 0x28
|
|
800e1e0: 6013 str r3, [r2, #0]
|
|
|
|
return;
|
|
800e1e2: bf00 nop
|
|
}
|
|
800e1e4: 3740 adds r7, #64 @ 0x40
|
|
800e1e6: 46bd mov sp, r7
|
|
800e1e8: bd80 pop {r7, pc}
|
|
800e1ea: bf00 nop
|
|
800e1ec: 20000018 .word 0x20000018
|
|
800e1f0: 20000c14 .word 0x20000c14
|
|
800e1f4: 20000c18 .word 0x20000c18
|
|
800e1f8: 20000014 .word 0x20000014
|
|
800e1fc: 20000c1c .word 0x20000c1c
|
|
800e200: 20000c28 .word 0x20000c28
|
|
800e204: 20000c20 .word 0x20000c20
|
|
800e208: 20000c24 .word 0x20000c24
|
|
|
|
0800e20c <UTIL_SEQ_PreIdle>:
|
|
{
|
|
return;
|
|
}
|
|
|
|
__WEAK void UTIL_SEQ_PreIdle( void )
|
|
{
|
|
800e20c: b480 push {r7}
|
|
800e20e: af00 add r7, sp, #0
|
|
/*
|
|
* Unless specified by the application, there is nothing to be done
|
|
*/
|
|
return;
|
|
800e210: bf00 nop
|
|
}
|
|
800e212: 46bd mov sp, r7
|
|
800e214: bc80 pop {r7}
|
|
800e216: 4770 bx lr
|
|
|
|
0800e218 <UTIL_SEQ_PostIdle>:
|
|
|
|
__WEAK void UTIL_SEQ_PostIdle( void )
|
|
{
|
|
800e218: b480 push {r7}
|
|
800e21a: af00 add r7, sp, #0
|
|
/*
|
|
* Unless specified by the application, there is nothing to be done
|
|
*/
|
|
return;
|
|
800e21c: bf00 nop
|
|
}
|
|
800e21e: 46bd mov sp, r7
|
|
800e220: bc80 pop {r7}
|
|
800e222: 4770 bx lr
|
|
|
|
0800e224 <SEQ_BitPosition>:
|
|
* @brief return the position of the first bit set to 1
|
|
* @param Value 32 bit value
|
|
* @retval bit position
|
|
*/
|
|
uint8_t SEQ_BitPosition(uint32_t Value)
|
|
{
|
|
800e224: b480 push {r7}
|
|
800e226: b085 sub sp, #20
|
|
800e228: af00 add r7, sp, #0
|
|
800e22a: 6078 str r0, [r7, #4]
|
|
uint8_t n = 0U;
|
|
800e22c: 2300 movs r3, #0
|
|
800e22e: 73fb strb r3, [r7, #15]
|
|
uint32_t lvalue = Value;
|
|
800e230: 687b ldr r3, [r7, #4]
|
|
800e232: 60bb str r3, [r7, #8]
|
|
|
|
if ((lvalue & 0xFFFF0000U) == 0U) { n = 16U; lvalue <<= 16U; }
|
|
800e234: 68bb ldr r3, [r7, #8]
|
|
800e236: f5b3 3f80 cmp.w r3, #65536 @ 0x10000
|
|
800e23a: d204 bcs.n 800e246 <SEQ_BitPosition+0x22>
|
|
800e23c: 2310 movs r3, #16
|
|
800e23e: 73fb strb r3, [r7, #15]
|
|
800e240: 68bb ldr r3, [r7, #8]
|
|
800e242: 041b lsls r3, r3, #16
|
|
800e244: 60bb str r3, [r7, #8]
|
|
if ((lvalue & 0xFF000000U) == 0U) { n += 8U; lvalue <<= 8U; }
|
|
800e246: 68bb ldr r3, [r7, #8]
|
|
800e248: f1b3 7f80 cmp.w r3, #16777216 @ 0x1000000
|
|
800e24c: d205 bcs.n 800e25a <SEQ_BitPosition+0x36>
|
|
800e24e: 7bfb ldrb r3, [r7, #15]
|
|
800e250: 3308 adds r3, #8
|
|
800e252: 73fb strb r3, [r7, #15]
|
|
800e254: 68bb ldr r3, [r7, #8]
|
|
800e256: 021b lsls r3, r3, #8
|
|
800e258: 60bb str r3, [r7, #8]
|
|
if ((lvalue & 0xF0000000U) == 0U) { n += 4U; lvalue <<= 4U; }
|
|
800e25a: 68bb ldr r3, [r7, #8]
|
|
800e25c: f1b3 5f80 cmp.w r3, #268435456 @ 0x10000000
|
|
800e260: d205 bcs.n 800e26e <SEQ_BitPosition+0x4a>
|
|
800e262: 7bfb ldrb r3, [r7, #15]
|
|
800e264: 3304 adds r3, #4
|
|
800e266: 73fb strb r3, [r7, #15]
|
|
800e268: 68bb ldr r3, [r7, #8]
|
|
800e26a: 011b lsls r3, r3, #4
|
|
800e26c: 60bb str r3, [r7, #8]
|
|
|
|
n += SEQ_clz_table_4bit[lvalue >> (32-4)];
|
|
800e26e: 68bb ldr r3, [r7, #8]
|
|
800e270: 0f1b lsrs r3, r3, #28
|
|
800e272: 4a07 ldr r2, [pc, #28] @ (800e290 <SEQ_BitPosition+0x6c>)
|
|
800e274: 5cd2 ldrb r2, [r2, r3]
|
|
800e276: 7bfb ldrb r3, [r7, #15]
|
|
800e278: 4413 add r3, r2
|
|
800e27a: 73fb strb r3, [r7, #15]
|
|
|
|
return (uint8_t)(31U-n);
|
|
800e27c: 7bfb ldrb r3, [r7, #15]
|
|
800e27e: f1c3 031f rsb r3, r3, #31
|
|
800e282: b2db uxtb r3, r3
|
|
}
|
|
800e284: 4618 mov r0, r3
|
|
800e286: 3714 adds r7, #20
|
|
800e288: 46bd mov sp, r7
|
|
800e28a: bc80 pop {r7}
|
|
800e28c: 4770 bx lr
|
|
800e28e: bf00 nop
|
|
800e290: 08010508 .word 0x08010508
|
|
|
|
0800e294 <UTIL_TIMER_Init>:
|
|
* @addtogroup TIMER_SERVER_exported_function
|
|
* @{
|
|
*/
|
|
|
|
UTIL_TIMER_Status_t UTIL_TIMER_Init(void)
|
|
{
|
|
800e294: b580 push {r7, lr}
|
|
800e296: af00 add r7, sp, #0
|
|
UTIL_TIMER_INIT_CRITICAL_SECTION();
|
|
TimerListHead = NULL;
|
|
800e298: 4b04 ldr r3, [pc, #16] @ (800e2ac <UTIL_TIMER_Init+0x18>)
|
|
800e29a: 2200 movs r2, #0
|
|
800e29c: 601a str r2, [r3, #0]
|
|
return UTIL_TimerDriver.InitTimer();
|
|
800e29e: 4b04 ldr r3, [pc, #16] @ (800e2b0 <UTIL_TIMER_Init+0x1c>)
|
|
800e2a0: 681b ldr r3, [r3, #0]
|
|
800e2a2: 4798 blx r3
|
|
800e2a4: 4603 mov r3, r0
|
|
}
|
|
800e2a6: 4618 mov r0, r3
|
|
800e2a8: bd80 pop {r7, pc}
|
|
800e2aa: bf00 nop
|
|
800e2ac: 20000c30 .word 0x20000c30
|
|
800e2b0: 0801034c .word 0x0801034c
|
|
|
|
0800e2b4 <UTIL_TIMER_Create>:
|
|
{
|
|
return UTIL_TimerDriver.DeInitTimer();
|
|
}
|
|
|
|
UTIL_TIMER_Status_t UTIL_TIMER_Create( UTIL_TIMER_Object_t *TimerObject, uint32_t PeriodValue, UTIL_TIMER_Mode_t Mode, void ( *Callback )( void *), void *Argument)
|
|
{
|
|
800e2b4: b580 push {r7, lr}
|
|
800e2b6: b084 sub sp, #16
|
|
800e2b8: af00 add r7, sp, #0
|
|
800e2ba: 60f8 str r0, [r7, #12]
|
|
800e2bc: 60b9 str r1, [r7, #8]
|
|
800e2be: 603b str r3, [r7, #0]
|
|
800e2c0: 4613 mov r3, r2
|
|
800e2c2: 71fb strb r3, [r7, #7]
|
|
if((TimerObject != NULL) && (Callback != NULL))
|
|
800e2c4: 68fb ldr r3, [r7, #12]
|
|
800e2c6: 2b00 cmp r3, #0
|
|
800e2c8: d023 beq.n 800e312 <UTIL_TIMER_Create+0x5e>
|
|
800e2ca: 683b ldr r3, [r7, #0]
|
|
800e2cc: 2b00 cmp r3, #0
|
|
800e2ce: d020 beq.n 800e312 <UTIL_TIMER_Create+0x5e>
|
|
{
|
|
TimerObject->Timestamp = 0U;
|
|
800e2d0: 68fb ldr r3, [r7, #12]
|
|
800e2d2: 2200 movs r2, #0
|
|
800e2d4: 601a str r2, [r3, #0]
|
|
TimerObject->ReloadValue = UTIL_TimerDriver.ms2Tick(PeriodValue);
|
|
800e2d6: 4b11 ldr r3, [pc, #68] @ (800e31c <UTIL_TIMER_Create+0x68>)
|
|
800e2d8: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
800e2da: 68b8 ldr r0, [r7, #8]
|
|
800e2dc: 4798 blx r3
|
|
800e2de: 4602 mov r2, r0
|
|
800e2e0: 68fb ldr r3, [r7, #12]
|
|
800e2e2: 605a str r2, [r3, #4]
|
|
TimerObject->IsPending = 0U;
|
|
800e2e4: 68fb ldr r3, [r7, #12]
|
|
800e2e6: 2200 movs r2, #0
|
|
800e2e8: 721a strb r2, [r3, #8]
|
|
TimerObject->IsRunning = 0U;
|
|
800e2ea: 68fb ldr r3, [r7, #12]
|
|
800e2ec: 2200 movs r2, #0
|
|
800e2ee: 725a strb r2, [r3, #9]
|
|
TimerObject->IsReloadStopped = 0U;
|
|
800e2f0: 68fb ldr r3, [r7, #12]
|
|
800e2f2: 2200 movs r2, #0
|
|
800e2f4: 729a strb r2, [r3, #10]
|
|
TimerObject->Callback = Callback;
|
|
800e2f6: 68fb ldr r3, [r7, #12]
|
|
800e2f8: 683a ldr r2, [r7, #0]
|
|
800e2fa: 60da str r2, [r3, #12]
|
|
TimerObject->argument = Argument;
|
|
800e2fc: 68fb ldr r3, [r7, #12]
|
|
800e2fe: 69ba ldr r2, [r7, #24]
|
|
800e300: 611a str r2, [r3, #16]
|
|
TimerObject->Mode = Mode;
|
|
800e302: 68fb ldr r3, [r7, #12]
|
|
800e304: 79fa ldrb r2, [r7, #7]
|
|
800e306: 72da strb r2, [r3, #11]
|
|
TimerObject->Next = NULL;
|
|
800e308: 68fb ldr r3, [r7, #12]
|
|
800e30a: 2200 movs r2, #0
|
|
800e30c: 615a str r2, [r3, #20]
|
|
return UTIL_TIMER_OK;
|
|
800e30e: 2300 movs r3, #0
|
|
800e310: e000 b.n 800e314 <UTIL_TIMER_Create+0x60>
|
|
}
|
|
else
|
|
{
|
|
return UTIL_TIMER_INVALID_PARAM;
|
|
800e312: 2301 movs r3, #1
|
|
}
|
|
}
|
|
800e314: 4618 mov r0, r3
|
|
800e316: 3710 adds r7, #16
|
|
800e318: 46bd mov sp, r7
|
|
800e31a: bd80 pop {r7, pc}
|
|
800e31c: 0801034c .word 0x0801034c
|
|
|
|
0800e320 <UTIL_TIMER_Start>:
|
|
|
|
UTIL_TIMER_Status_t UTIL_TIMER_Start( UTIL_TIMER_Object_t *TimerObject)
|
|
{
|
|
800e320: b580 push {r7, lr}
|
|
800e322: b08a sub sp, #40 @ 0x28
|
|
800e324: af00 add r7, sp, #0
|
|
800e326: 6078 str r0, [r7, #4]
|
|
UTIL_TIMER_Status_t ret = UTIL_TIMER_OK;
|
|
800e328: 2300 movs r3, #0
|
|
800e32a: f887 3027 strb.w r3, [r7, #39] @ 0x27
|
|
uint32_t elapsedTime;
|
|
uint32_t minValue;
|
|
uint32_t ticks;
|
|
|
|
if(( TimerObject != NULL ) && ( TimerExists( TimerObject ) == false ) && (TimerObject->IsRunning == 0U))
|
|
800e32e: 687b ldr r3, [r7, #4]
|
|
800e330: 2b00 cmp r3, #0
|
|
800e332: d056 beq.n 800e3e2 <UTIL_TIMER_Start+0xc2>
|
|
800e334: 6878 ldr r0, [r7, #4]
|
|
800e336: f000 f9a9 bl 800e68c <TimerExists>
|
|
800e33a: 4603 mov r3, r0
|
|
800e33c: f083 0301 eor.w r3, r3, #1
|
|
800e340: b2db uxtb r3, r3
|
|
800e342: 2b00 cmp r3, #0
|
|
800e344: d04d beq.n 800e3e2 <UTIL_TIMER_Start+0xc2>
|
|
800e346: 687b ldr r3, [r7, #4]
|
|
800e348: 7a5b ldrb r3, [r3, #9]
|
|
800e34a: 2b00 cmp r3, #0
|
|
800e34c: d149 bne.n 800e3e2 <UTIL_TIMER_Start+0xc2>
|
|
__ASM volatile ("MRS %0, primask" : "=r" (result) :: "memory");
|
|
800e34e: f3ef 8310 mrs r3, PRIMASK
|
|
800e352: 613b str r3, [r7, #16]
|
|
return(result);
|
|
800e354: 693b ldr r3, [r7, #16]
|
|
{
|
|
UTIL_TIMER_ENTER_CRITICAL_SECTION();
|
|
800e356: 61fb str r3, [r7, #28]
|
|
__ASM volatile ("cpsid i" : : : "memory");
|
|
800e358: b672 cpsid i
|
|
}
|
|
800e35a: bf00 nop
|
|
ticks = TimerObject->ReloadValue;
|
|
800e35c: 687b ldr r3, [r7, #4]
|
|
800e35e: 685b ldr r3, [r3, #4]
|
|
800e360: 623b str r3, [r7, #32]
|
|
minValue = UTIL_TimerDriver.GetMinimumTimeout( );
|
|
800e362: 4b24 ldr r3, [pc, #144] @ (800e3f4 <UTIL_TIMER_Start+0xd4>)
|
|
800e364: 6a1b ldr r3, [r3, #32]
|
|
800e366: 4798 blx r3
|
|
800e368: 61b8 str r0, [r7, #24]
|
|
|
|
if( ticks < minValue )
|
|
800e36a: 6a3a ldr r2, [r7, #32]
|
|
800e36c: 69bb ldr r3, [r7, #24]
|
|
800e36e: 429a cmp r2, r3
|
|
800e370: d201 bcs.n 800e376 <UTIL_TIMER_Start+0x56>
|
|
{
|
|
ticks = minValue;
|
|
800e372: 69bb ldr r3, [r7, #24]
|
|
800e374: 623b str r3, [r7, #32]
|
|
}
|
|
|
|
TimerObject->Timestamp = ticks;
|
|
800e376: 687b ldr r3, [r7, #4]
|
|
800e378: 6a3a ldr r2, [r7, #32]
|
|
800e37a: 601a str r2, [r3, #0]
|
|
TimerObject->IsPending = 0U;
|
|
800e37c: 687b ldr r3, [r7, #4]
|
|
800e37e: 2200 movs r2, #0
|
|
800e380: 721a strb r2, [r3, #8]
|
|
TimerObject->IsRunning = 1U;
|
|
800e382: 687b ldr r3, [r7, #4]
|
|
800e384: 2201 movs r2, #1
|
|
800e386: 725a strb r2, [r3, #9]
|
|
TimerObject->IsReloadStopped = 0U;
|
|
800e388: 687b ldr r3, [r7, #4]
|
|
800e38a: 2200 movs r2, #0
|
|
800e38c: 729a strb r2, [r3, #10]
|
|
if( TimerListHead == NULL )
|
|
800e38e: 4b1a ldr r3, [pc, #104] @ (800e3f8 <UTIL_TIMER_Start+0xd8>)
|
|
800e390: 681b ldr r3, [r3, #0]
|
|
800e392: 2b00 cmp r3, #0
|
|
800e394: d106 bne.n 800e3a4 <UTIL_TIMER_Start+0x84>
|
|
{
|
|
UTIL_TimerDriver.SetTimerContext();
|
|
800e396: 4b17 ldr r3, [pc, #92] @ (800e3f4 <UTIL_TIMER_Start+0xd4>)
|
|
800e398: 691b ldr r3, [r3, #16]
|
|
800e39a: 4798 blx r3
|
|
TimerInsertNewHeadTimer( TimerObject ); /* insert a timeout at now+obj->Timestamp */
|
|
800e39c: 6878 ldr r0, [r7, #4]
|
|
800e39e: f000 f9eb bl 800e778 <TimerInsertNewHeadTimer>
|
|
800e3a2: e017 b.n 800e3d4 <UTIL_TIMER_Start+0xb4>
|
|
}
|
|
else
|
|
{
|
|
elapsedTime = UTIL_TimerDriver.GetTimerElapsedTime( );
|
|
800e3a4: 4b13 ldr r3, [pc, #76] @ (800e3f4 <UTIL_TIMER_Start+0xd4>)
|
|
800e3a6: 699b ldr r3, [r3, #24]
|
|
800e3a8: 4798 blx r3
|
|
800e3aa: 6178 str r0, [r7, #20]
|
|
TimerObject->Timestamp += elapsedTime;
|
|
800e3ac: 687b ldr r3, [r7, #4]
|
|
800e3ae: 681a ldr r2, [r3, #0]
|
|
800e3b0: 697b ldr r3, [r7, #20]
|
|
800e3b2: 441a add r2, r3
|
|
800e3b4: 687b ldr r3, [r7, #4]
|
|
800e3b6: 601a str r2, [r3, #0]
|
|
|
|
if( TimerObject->Timestamp < TimerListHead->Timestamp )
|
|
800e3b8: 687b ldr r3, [r7, #4]
|
|
800e3ba: 681a ldr r2, [r3, #0]
|
|
800e3bc: 4b0e ldr r3, [pc, #56] @ (800e3f8 <UTIL_TIMER_Start+0xd8>)
|
|
800e3be: 681b ldr r3, [r3, #0]
|
|
800e3c0: 681b ldr r3, [r3, #0]
|
|
800e3c2: 429a cmp r2, r3
|
|
800e3c4: d203 bcs.n 800e3ce <UTIL_TIMER_Start+0xae>
|
|
{
|
|
TimerInsertNewHeadTimer( TimerObject);
|
|
800e3c6: 6878 ldr r0, [r7, #4]
|
|
800e3c8: f000 f9d6 bl 800e778 <TimerInsertNewHeadTimer>
|
|
800e3cc: e002 b.n 800e3d4 <UTIL_TIMER_Start+0xb4>
|
|
}
|
|
else
|
|
{
|
|
TimerInsertTimer( TimerObject);
|
|
800e3ce: 6878 ldr r0, [r7, #4]
|
|
800e3d0: f000 f9a2 bl 800e718 <TimerInsertTimer>
|
|
800e3d4: 69fb ldr r3, [r7, #28]
|
|
800e3d6: 60fb str r3, [r7, #12]
|
|
__ASM volatile ("MSR primask, %0" : : "r" (priMask) : "memory");
|
|
800e3d8: 68fb ldr r3, [r7, #12]
|
|
800e3da: f383 8810 msr PRIMASK, r3
|
|
}
|
|
800e3de: bf00 nop
|
|
{
|
|
800e3e0: e002 b.n 800e3e8 <UTIL_TIMER_Start+0xc8>
|
|
}
|
|
UTIL_TIMER_EXIT_CRITICAL_SECTION();
|
|
}
|
|
else
|
|
{
|
|
ret = UTIL_TIMER_INVALID_PARAM;
|
|
800e3e2: 2301 movs r3, #1
|
|
800e3e4: f887 3027 strb.w r3, [r7, #39] @ 0x27
|
|
}
|
|
return ret;
|
|
800e3e8: f897 3027 ldrb.w r3, [r7, #39] @ 0x27
|
|
}
|
|
800e3ec: 4618 mov r0, r3
|
|
800e3ee: 3728 adds r7, #40 @ 0x28
|
|
800e3f0: 46bd mov sp, r7
|
|
800e3f2: bd80 pop {r7, pc}
|
|
800e3f4: 0801034c .word 0x0801034c
|
|
800e3f8: 20000c30 .word 0x20000c30
|
|
|
|
0800e3fc <UTIL_TIMER_Stop>:
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
UTIL_TIMER_Status_t UTIL_TIMER_Stop( UTIL_TIMER_Object_t *TimerObject )
|
|
{
|
|
800e3fc: b580 push {r7, lr}
|
|
800e3fe: b088 sub sp, #32
|
|
800e400: af00 add r7, sp, #0
|
|
800e402: 6078 str r0, [r7, #4]
|
|
UTIL_TIMER_Status_t ret = UTIL_TIMER_OK;
|
|
800e404: 2300 movs r3, #0
|
|
800e406: 77fb strb r3, [r7, #31]
|
|
|
|
if (NULL != TimerObject)
|
|
800e408: 687b ldr r3, [r7, #4]
|
|
800e40a: 2b00 cmp r3, #0
|
|
800e40c: d05b beq.n 800e4c6 <UTIL_TIMER_Stop+0xca>
|
|
__ASM volatile ("MRS %0, primask" : "=r" (result) :: "memory");
|
|
800e40e: f3ef 8310 mrs r3, PRIMASK
|
|
800e412: 60fb str r3, [r7, #12]
|
|
return(result);
|
|
800e414: 68fb ldr r3, [r7, #12]
|
|
{
|
|
UTIL_TIMER_ENTER_CRITICAL_SECTION();
|
|
800e416: 613b str r3, [r7, #16]
|
|
__ASM volatile ("cpsid i" : : : "memory");
|
|
800e418: b672 cpsid i
|
|
}
|
|
800e41a: bf00 nop
|
|
UTIL_TIMER_Object_t* prev = TimerListHead;
|
|
800e41c: 4b2d ldr r3, [pc, #180] @ (800e4d4 <UTIL_TIMER_Stop+0xd8>)
|
|
800e41e: 681b ldr r3, [r3, #0]
|
|
800e420: 61bb str r3, [r7, #24]
|
|
UTIL_TIMER_Object_t* cur = TimerListHead;
|
|
800e422: 4b2c ldr r3, [pc, #176] @ (800e4d4 <UTIL_TIMER_Stop+0xd8>)
|
|
800e424: 681b ldr r3, [r3, #0]
|
|
800e426: 617b str r3, [r7, #20]
|
|
TimerObject->IsReloadStopped = 1U;
|
|
800e428: 687b ldr r3, [r7, #4]
|
|
800e42a: 2201 movs r2, #1
|
|
800e42c: 729a strb r2, [r3, #10]
|
|
|
|
/* List is empty or the Obj to stop does not exist */
|
|
if(NULL != TimerListHead)
|
|
800e42e: 4b29 ldr r3, [pc, #164] @ (800e4d4 <UTIL_TIMER_Stop+0xd8>)
|
|
800e430: 681b ldr r3, [r3, #0]
|
|
800e432: 2b00 cmp r3, #0
|
|
800e434: d041 beq.n 800e4ba <UTIL_TIMER_Stop+0xbe>
|
|
{
|
|
TimerObject->IsRunning = 0U;
|
|
800e436: 687b ldr r3, [r7, #4]
|
|
800e438: 2200 movs r2, #0
|
|
800e43a: 725a strb r2, [r3, #9]
|
|
|
|
if( TimerListHead == TimerObject ) /* Stop the Head */
|
|
800e43c: 4b25 ldr r3, [pc, #148] @ (800e4d4 <UTIL_TIMER_Stop+0xd8>)
|
|
800e43e: 681b ldr r3, [r3, #0]
|
|
800e440: 687a ldr r2, [r7, #4]
|
|
800e442: 429a cmp r2, r3
|
|
800e444: d134 bne.n 800e4b0 <UTIL_TIMER_Stop+0xb4>
|
|
{
|
|
TimerListHead->IsPending = 0;
|
|
800e446: 4b23 ldr r3, [pc, #140] @ (800e4d4 <UTIL_TIMER_Stop+0xd8>)
|
|
800e448: 681b ldr r3, [r3, #0]
|
|
800e44a: 2200 movs r2, #0
|
|
800e44c: 721a strb r2, [r3, #8]
|
|
if( TimerListHead->Next != NULL )
|
|
800e44e: 4b21 ldr r3, [pc, #132] @ (800e4d4 <UTIL_TIMER_Stop+0xd8>)
|
|
800e450: 681b ldr r3, [r3, #0]
|
|
800e452: 695b ldr r3, [r3, #20]
|
|
800e454: 2b00 cmp r3, #0
|
|
800e456: d00a beq.n 800e46e <UTIL_TIMER_Stop+0x72>
|
|
{
|
|
TimerListHead = TimerListHead->Next;
|
|
800e458: 4b1e ldr r3, [pc, #120] @ (800e4d4 <UTIL_TIMER_Stop+0xd8>)
|
|
800e45a: 681b ldr r3, [r3, #0]
|
|
800e45c: 695b ldr r3, [r3, #20]
|
|
800e45e: 4a1d ldr r2, [pc, #116] @ (800e4d4 <UTIL_TIMER_Stop+0xd8>)
|
|
800e460: 6013 str r3, [r2, #0]
|
|
TimerSetTimeout( TimerListHead );
|
|
800e462: 4b1c ldr r3, [pc, #112] @ (800e4d4 <UTIL_TIMER_Stop+0xd8>)
|
|
800e464: 681b ldr r3, [r3, #0]
|
|
800e466: 4618 mov r0, r3
|
|
800e468: f000 f92c bl 800e6c4 <TimerSetTimeout>
|
|
800e46c: e023 b.n 800e4b6 <UTIL_TIMER_Stop+0xba>
|
|
}
|
|
else
|
|
{
|
|
UTIL_TimerDriver.StopTimerEvt( );
|
|
800e46e: 4b1a ldr r3, [pc, #104] @ (800e4d8 <UTIL_TIMER_Stop+0xdc>)
|
|
800e470: 68db ldr r3, [r3, #12]
|
|
800e472: 4798 blx r3
|
|
TimerListHead = NULL;
|
|
800e474: 4b17 ldr r3, [pc, #92] @ (800e4d4 <UTIL_TIMER_Stop+0xd8>)
|
|
800e476: 2200 movs r2, #0
|
|
800e478: 601a str r2, [r3, #0]
|
|
800e47a: e01c b.n 800e4b6 <UTIL_TIMER_Stop+0xba>
|
|
}
|
|
else /* Stop an object within the list */
|
|
{
|
|
while( cur != NULL )
|
|
{
|
|
if( cur == TimerObject )
|
|
800e47c: 697a ldr r2, [r7, #20]
|
|
800e47e: 687b ldr r3, [r7, #4]
|
|
800e480: 429a cmp r2, r3
|
|
800e482: d110 bne.n 800e4a6 <UTIL_TIMER_Stop+0xaa>
|
|
{
|
|
if( cur->Next != NULL )
|
|
800e484: 697b ldr r3, [r7, #20]
|
|
800e486: 695b ldr r3, [r3, #20]
|
|
800e488: 2b00 cmp r3, #0
|
|
800e48a: d006 beq.n 800e49a <UTIL_TIMER_Stop+0x9e>
|
|
{
|
|
cur = cur->Next;
|
|
800e48c: 697b ldr r3, [r7, #20]
|
|
800e48e: 695b ldr r3, [r3, #20]
|
|
800e490: 617b str r3, [r7, #20]
|
|
prev->Next = cur;
|
|
800e492: 69bb ldr r3, [r7, #24]
|
|
800e494: 697a ldr r2, [r7, #20]
|
|
800e496: 615a str r2, [r3, #20]
|
|
else
|
|
{
|
|
cur = NULL;
|
|
prev->Next = cur;
|
|
}
|
|
break;
|
|
800e498: e00d b.n 800e4b6 <UTIL_TIMER_Stop+0xba>
|
|
cur = NULL;
|
|
800e49a: 2300 movs r3, #0
|
|
800e49c: 617b str r3, [r7, #20]
|
|
prev->Next = cur;
|
|
800e49e: 69bb ldr r3, [r7, #24]
|
|
800e4a0: 697a ldr r2, [r7, #20]
|
|
800e4a2: 615a str r2, [r3, #20]
|
|
break;
|
|
800e4a4: e007 b.n 800e4b6 <UTIL_TIMER_Stop+0xba>
|
|
}
|
|
else
|
|
{
|
|
prev = cur;
|
|
800e4a6: 697b ldr r3, [r7, #20]
|
|
800e4a8: 61bb str r3, [r7, #24]
|
|
cur = cur->Next;
|
|
800e4aa: 697b ldr r3, [r7, #20]
|
|
800e4ac: 695b ldr r3, [r3, #20]
|
|
800e4ae: 617b str r3, [r7, #20]
|
|
while( cur != NULL )
|
|
800e4b0: 697b ldr r3, [r7, #20]
|
|
800e4b2: 2b00 cmp r3, #0
|
|
800e4b4: d1e2 bne.n 800e47c <UTIL_TIMER_Stop+0x80>
|
|
}
|
|
}
|
|
}
|
|
ret = UTIL_TIMER_OK;
|
|
800e4b6: 2300 movs r3, #0
|
|
800e4b8: 77fb strb r3, [r7, #31]
|
|
800e4ba: 693b ldr r3, [r7, #16]
|
|
800e4bc: 60bb str r3, [r7, #8]
|
|
__ASM volatile ("MSR primask, %0" : : "r" (priMask) : "memory");
|
|
800e4be: 68bb ldr r3, [r7, #8]
|
|
800e4c0: f383 8810 msr PRIMASK, r3
|
|
}
|
|
800e4c4: e001 b.n 800e4ca <UTIL_TIMER_Stop+0xce>
|
|
}
|
|
UTIL_TIMER_EXIT_CRITICAL_SECTION();
|
|
}
|
|
else
|
|
{
|
|
ret = UTIL_TIMER_INVALID_PARAM;
|
|
800e4c6: 2301 movs r3, #1
|
|
800e4c8: 77fb strb r3, [r7, #31]
|
|
}
|
|
return ret;
|
|
800e4ca: 7ffb ldrb r3, [r7, #31]
|
|
}
|
|
800e4cc: 4618 mov r0, r3
|
|
800e4ce: 3720 adds r7, #32
|
|
800e4d0: 46bd mov sp, r7
|
|
800e4d2: bd80 pop {r7, pc}
|
|
800e4d4: 20000c30 .word 0x20000c30
|
|
800e4d8: 0801034c .word 0x0801034c
|
|
|
|
0800e4dc <UTIL_TIMER_SetPeriod>:
|
|
|
|
UTIL_TIMER_Status_t UTIL_TIMER_SetPeriod(UTIL_TIMER_Object_t *TimerObject, uint32_t NewPeriodValue)
|
|
{
|
|
800e4dc: b580 push {r7, lr}
|
|
800e4de: b084 sub sp, #16
|
|
800e4e0: af00 add r7, sp, #0
|
|
800e4e2: 6078 str r0, [r7, #4]
|
|
800e4e4: 6039 str r1, [r7, #0]
|
|
UTIL_TIMER_Status_t ret = UTIL_TIMER_OK;
|
|
800e4e6: 2300 movs r3, #0
|
|
800e4e8: 73fb strb r3, [r7, #15]
|
|
|
|
if(NULL == TimerObject)
|
|
800e4ea: 687b ldr r3, [r7, #4]
|
|
800e4ec: 2b00 cmp r3, #0
|
|
800e4ee: d102 bne.n 800e4f6 <UTIL_TIMER_SetPeriod+0x1a>
|
|
{
|
|
ret = UTIL_TIMER_INVALID_PARAM;
|
|
800e4f0: 2301 movs r3, #1
|
|
800e4f2: 73fb strb r3, [r7, #15]
|
|
800e4f4: e014 b.n 800e520 <UTIL_TIMER_SetPeriod+0x44>
|
|
}
|
|
else
|
|
{
|
|
TimerObject->ReloadValue = UTIL_TimerDriver.ms2Tick(NewPeriodValue);
|
|
800e4f6: 4b0d ldr r3, [pc, #52] @ (800e52c <UTIL_TIMER_SetPeriod+0x50>)
|
|
800e4f8: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
800e4fa: 6838 ldr r0, [r7, #0]
|
|
800e4fc: 4798 blx r3
|
|
800e4fe: 4602 mov r2, r0
|
|
800e500: 687b ldr r3, [r7, #4]
|
|
800e502: 605a str r2, [r3, #4]
|
|
if(TimerExists(TimerObject))
|
|
800e504: 6878 ldr r0, [r7, #4]
|
|
800e506: f000 f8c1 bl 800e68c <TimerExists>
|
|
800e50a: 4603 mov r3, r0
|
|
800e50c: 2b00 cmp r3, #0
|
|
800e50e: d007 beq.n 800e520 <UTIL_TIMER_SetPeriod+0x44>
|
|
{
|
|
(void)UTIL_TIMER_Stop(TimerObject);
|
|
800e510: 6878 ldr r0, [r7, #4]
|
|
800e512: f7ff ff73 bl 800e3fc <UTIL_TIMER_Stop>
|
|
ret = UTIL_TIMER_Start(TimerObject);
|
|
800e516: 6878 ldr r0, [r7, #4]
|
|
800e518: f7ff ff02 bl 800e320 <UTIL_TIMER_Start>
|
|
800e51c: 4603 mov r3, r0
|
|
800e51e: 73fb strb r3, [r7, #15]
|
|
}
|
|
}
|
|
return ret;
|
|
800e520: 7bfb ldrb r3, [r7, #15]
|
|
}
|
|
800e522: 4618 mov r0, r3
|
|
800e524: 3710 adds r7, #16
|
|
800e526: 46bd mov sp, r7
|
|
800e528: bd80 pop {r7, pc}
|
|
800e52a: bf00 nop
|
|
800e52c: 0801034c .word 0x0801034c
|
|
|
|
0800e530 <UTIL_TIMER_IRQ_Handler>:
|
|
}
|
|
return NextTimer;
|
|
}
|
|
|
|
void UTIL_TIMER_IRQ_Handler( void )
|
|
{
|
|
800e530: b590 push {r4, r7, lr}
|
|
800e532: b089 sub sp, #36 @ 0x24
|
|
800e534: af00 add r7, sp, #0
|
|
__ASM volatile ("MRS %0, primask" : "=r" (result) :: "memory");
|
|
800e536: f3ef 8310 mrs r3, PRIMASK
|
|
800e53a: 60bb str r3, [r7, #8]
|
|
return(result);
|
|
800e53c: 68bb ldr r3, [r7, #8]
|
|
UTIL_TIMER_Object_t* cur;
|
|
uint32_t old, now, DeltaContext;
|
|
|
|
UTIL_TIMER_ENTER_CRITICAL_SECTION();
|
|
800e53e: 61bb str r3, [r7, #24]
|
|
__ASM volatile ("cpsid i" : : : "memory");
|
|
800e540: b672 cpsid i
|
|
}
|
|
800e542: bf00 nop
|
|
|
|
old = UTIL_TimerDriver.GetTimerContext( );
|
|
800e544: 4b38 ldr r3, [pc, #224] @ (800e628 <UTIL_TIMER_IRQ_Handler+0xf8>)
|
|
800e546: 695b ldr r3, [r3, #20]
|
|
800e548: 4798 blx r3
|
|
800e54a: 6178 str r0, [r7, #20]
|
|
now = UTIL_TimerDriver.SetTimerContext( );
|
|
800e54c: 4b36 ldr r3, [pc, #216] @ (800e628 <UTIL_TIMER_IRQ_Handler+0xf8>)
|
|
800e54e: 691b ldr r3, [r3, #16]
|
|
800e550: 4798 blx r3
|
|
800e552: 6138 str r0, [r7, #16]
|
|
|
|
DeltaContext = now - old; /*intentional wrap around */
|
|
800e554: 693a ldr r2, [r7, #16]
|
|
800e556: 697b ldr r3, [r7, #20]
|
|
800e558: 1ad3 subs r3, r2, r3
|
|
800e55a: 60fb str r3, [r7, #12]
|
|
|
|
/* update timeStamp based upon new Time Reference*/
|
|
/* because delta context should never exceed 2^32*/
|
|
if ( TimerListHead != NULL )
|
|
800e55c: 4b33 ldr r3, [pc, #204] @ (800e62c <UTIL_TIMER_IRQ_Handler+0xfc>)
|
|
800e55e: 681b ldr r3, [r3, #0]
|
|
800e560: 2b00 cmp r3, #0
|
|
800e562: d037 beq.n 800e5d4 <UTIL_TIMER_IRQ_Handler+0xa4>
|
|
{
|
|
cur = TimerListHead;
|
|
800e564: 4b31 ldr r3, [pc, #196] @ (800e62c <UTIL_TIMER_IRQ_Handler+0xfc>)
|
|
800e566: 681b ldr r3, [r3, #0]
|
|
800e568: 61fb str r3, [r7, #28]
|
|
do {
|
|
if (cur->Timestamp > DeltaContext)
|
|
800e56a: 69fb ldr r3, [r7, #28]
|
|
800e56c: 681b ldr r3, [r3, #0]
|
|
800e56e: 68fa ldr r2, [r7, #12]
|
|
800e570: 429a cmp r2, r3
|
|
800e572: d206 bcs.n 800e582 <UTIL_TIMER_IRQ_Handler+0x52>
|
|
{
|
|
cur->Timestamp -= DeltaContext;
|
|
800e574: 69fb ldr r3, [r7, #28]
|
|
800e576: 681a ldr r2, [r3, #0]
|
|
800e578: 68fb ldr r3, [r7, #12]
|
|
800e57a: 1ad2 subs r2, r2, r3
|
|
800e57c: 69fb ldr r3, [r7, #28]
|
|
800e57e: 601a str r2, [r3, #0]
|
|
800e580: e002 b.n 800e588 <UTIL_TIMER_IRQ_Handler+0x58>
|
|
}
|
|
else
|
|
{
|
|
cur->Timestamp = 0;
|
|
800e582: 69fb ldr r3, [r7, #28]
|
|
800e584: 2200 movs r2, #0
|
|
800e586: 601a str r2, [r3, #0]
|
|
}
|
|
cur = cur->Next;
|
|
800e588: 69fb ldr r3, [r7, #28]
|
|
800e58a: 695b ldr r3, [r3, #20]
|
|
800e58c: 61fb str r3, [r7, #28]
|
|
} while(cur != NULL);
|
|
800e58e: 69fb ldr r3, [r7, #28]
|
|
800e590: 2b00 cmp r3, #0
|
|
800e592: d1ea bne.n 800e56a <UTIL_TIMER_IRQ_Handler+0x3a>
|
|
}
|
|
|
|
/* Execute expired timer and update the list */
|
|
while ((TimerListHead != NULL) && ((TimerListHead->Timestamp == 0U) || (TimerListHead->Timestamp < UTIL_TimerDriver.GetTimerElapsedTime( ))))
|
|
800e594: e01e b.n 800e5d4 <UTIL_TIMER_IRQ_Handler+0xa4>
|
|
{
|
|
cur = TimerListHead;
|
|
800e596: 4b25 ldr r3, [pc, #148] @ (800e62c <UTIL_TIMER_IRQ_Handler+0xfc>)
|
|
800e598: 681b ldr r3, [r3, #0]
|
|
800e59a: 61fb str r3, [r7, #28]
|
|
TimerListHead = TimerListHead->Next;
|
|
800e59c: 4b23 ldr r3, [pc, #140] @ (800e62c <UTIL_TIMER_IRQ_Handler+0xfc>)
|
|
800e59e: 681b ldr r3, [r3, #0]
|
|
800e5a0: 695b ldr r3, [r3, #20]
|
|
800e5a2: 4a22 ldr r2, [pc, #136] @ (800e62c <UTIL_TIMER_IRQ_Handler+0xfc>)
|
|
800e5a4: 6013 str r3, [r2, #0]
|
|
cur->IsPending = 0;
|
|
800e5a6: 69fb ldr r3, [r7, #28]
|
|
800e5a8: 2200 movs r2, #0
|
|
800e5aa: 721a strb r2, [r3, #8]
|
|
cur->IsRunning = 0;
|
|
800e5ac: 69fb ldr r3, [r7, #28]
|
|
800e5ae: 2200 movs r2, #0
|
|
800e5b0: 725a strb r2, [r3, #9]
|
|
cur->Callback(cur->argument);
|
|
800e5b2: 69fb ldr r3, [r7, #28]
|
|
800e5b4: 68db ldr r3, [r3, #12]
|
|
800e5b6: 69fa ldr r2, [r7, #28]
|
|
800e5b8: 6912 ldr r2, [r2, #16]
|
|
800e5ba: 4610 mov r0, r2
|
|
800e5bc: 4798 blx r3
|
|
if(( cur->Mode == UTIL_TIMER_PERIODIC) && (cur->IsReloadStopped == 0U))
|
|
800e5be: 69fb ldr r3, [r7, #28]
|
|
800e5c0: 7adb ldrb r3, [r3, #11]
|
|
800e5c2: 2b01 cmp r3, #1
|
|
800e5c4: d106 bne.n 800e5d4 <UTIL_TIMER_IRQ_Handler+0xa4>
|
|
800e5c6: 69fb ldr r3, [r7, #28]
|
|
800e5c8: 7a9b ldrb r3, [r3, #10]
|
|
800e5ca: 2b00 cmp r3, #0
|
|
800e5cc: d102 bne.n 800e5d4 <UTIL_TIMER_IRQ_Handler+0xa4>
|
|
{
|
|
(void)UTIL_TIMER_Start(cur);
|
|
800e5ce: 69f8 ldr r0, [r7, #28]
|
|
800e5d0: f7ff fea6 bl 800e320 <UTIL_TIMER_Start>
|
|
while ((TimerListHead != NULL) && ((TimerListHead->Timestamp == 0U) || (TimerListHead->Timestamp < UTIL_TimerDriver.GetTimerElapsedTime( ))))
|
|
800e5d4: 4b15 ldr r3, [pc, #84] @ (800e62c <UTIL_TIMER_IRQ_Handler+0xfc>)
|
|
800e5d6: 681b ldr r3, [r3, #0]
|
|
800e5d8: 2b00 cmp r3, #0
|
|
800e5da: d00d beq.n 800e5f8 <UTIL_TIMER_IRQ_Handler+0xc8>
|
|
800e5dc: 4b13 ldr r3, [pc, #76] @ (800e62c <UTIL_TIMER_IRQ_Handler+0xfc>)
|
|
800e5de: 681b ldr r3, [r3, #0]
|
|
800e5e0: 681b ldr r3, [r3, #0]
|
|
800e5e2: 2b00 cmp r3, #0
|
|
800e5e4: d0d7 beq.n 800e596 <UTIL_TIMER_IRQ_Handler+0x66>
|
|
800e5e6: 4b11 ldr r3, [pc, #68] @ (800e62c <UTIL_TIMER_IRQ_Handler+0xfc>)
|
|
800e5e8: 681b ldr r3, [r3, #0]
|
|
800e5ea: 681c ldr r4, [r3, #0]
|
|
800e5ec: 4b0e ldr r3, [pc, #56] @ (800e628 <UTIL_TIMER_IRQ_Handler+0xf8>)
|
|
800e5ee: 699b ldr r3, [r3, #24]
|
|
800e5f0: 4798 blx r3
|
|
800e5f2: 4603 mov r3, r0
|
|
800e5f4: 429c cmp r4, r3
|
|
800e5f6: d3ce bcc.n 800e596 <UTIL_TIMER_IRQ_Handler+0x66>
|
|
}
|
|
}
|
|
|
|
/* start the next TimerListHead if it exists and it is not pending*/
|
|
if(( TimerListHead != NULL ) && (TimerListHead->IsPending == 0U))
|
|
800e5f8: 4b0c ldr r3, [pc, #48] @ (800e62c <UTIL_TIMER_IRQ_Handler+0xfc>)
|
|
800e5fa: 681b ldr r3, [r3, #0]
|
|
800e5fc: 2b00 cmp r3, #0
|
|
800e5fe: d009 beq.n 800e614 <UTIL_TIMER_IRQ_Handler+0xe4>
|
|
800e600: 4b0a ldr r3, [pc, #40] @ (800e62c <UTIL_TIMER_IRQ_Handler+0xfc>)
|
|
800e602: 681b ldr r3, [r3, #0]
|
|
800e604: 7a1b ldrb r3, [r3, #8]
|
|
800e606: 2b00 cmp r3, #0
|
|
800e608: d104 bne.n 800e614 <UTIL_TIMER_IRQ_Handler+0xe4>
|
|
{
|
|
TimerSetTimeout( TimerListHead );
|
|
800e60a: 4b08 ldr r3, [pc, #32] @ (800e62c <UTIL_TIMER_IRQ_Handler+0xfc>)
|
|
800e60c: 681b ldr r3, [r3, #0]
|
|
800e60e: 4618 mov r0, r3
|
|
800e610: f000 f858 bl 800e6c4 <TimerSetTimeout>
|
|
800e614: 69bb ldr r3, [r7, #24]
|
|
800e616: 607b str r3, [r7, #4]
|
|
__ASM volatile ("MSR primask, %0" : : "r" (priMask) : "memory");
|
|
800e618: 687b ldr r3, [r7, #4]
|
|
800e61a: f383 8810 msr PRIMASK, r3
|
|
}
|
|
800e61e: bf00 nop
|
|
}
|
|
UTIL_TIMER_EXIT_CRITICAL_SECTION();
|
|
}
|
|
800e620: bf00 nop
|
|
800e622: 3724 adds r7, #36 @ 0x24
|
|
800e624: 46bd mov sp, r7
|
|
800e626: bd90 pop {r4, r7, pc}
|
|
800e628: 0801034c .word 0x0801034c
|
|
800e62c: 20000c30 .word 0x20000c30
|
|
|
|
0800e630 <UTIL_TIMER_GetCurrentTime>:
|
|
|
|
UTIL_TIMER_Time_t UTIL_TIMER_GetCurrentTime(void)
|
|
{
|
|
800e630: b580 push {r7, lr}
|
|
800e632: b082 sub sp, #8
|
|
800e634: af00 add r7, sp, #0
|
|
uint32_t now = UTIL_TimerDriver.GetTimerValue( );
|
|
800e636: 4b06 ldr r3, [pc, #24] @ (800e650 <UTIL_TIMER_GetCurrentTime+0x20>)
|
|
800e638: 69db ldr r3, [r3, #28]
|
|
800e63a: 4798 blx r3
|
|
800e63c: 6078 str r0, [r7, #4]
|
|
return UTIL_TimerDriver.Tick2ms(now);
|
|
800e63e: 4b04 ldr r3, [pc, #16] @ (800e650 <UTIL_TIMER_GetCurrentTime+0x20>)
|
|
800e640: 6a9b ldr r3, [r3, #40] @ 0x28
|
|
800e642: 6878 ldr r0, [r7, #4]
|
|
800e644: 4798 blx r3
|
|
800e646: 4603 mov r3, r0
|
|
}
|
|
800e648: 4618 mov r0, r3
|
|
800e64a: 3708 adds r7, #8
|
|
800e64c: 46bd mov sp, r7
|
|
800e64e: bd80 pop {r7, pc}
|
|
800e650: 0801034c .word 0x0801034c
|
|
|
|
0800e654 <UTIL_TIMER_GetElapsedTime>:
|
|
|
|
UTIL_TIMER_Time_t UTIL_TIMER_GetElapsedTime(UTIL_TIMER_Time_t past )
|
|
{
|
|
800e654: b580 push {r7, lr}
|
|
800e656: b084 sub sp, #16
|
|
800e658: af00 add r7, sp, #0
|
|
800e65a: 6078 str r0, [r7, #4]
|
|
uint32_t nowInTicks = UTIL_TimerDriver.GetTimerValue( );
|
|
800e65c: 4b0a ldr r3, [pc, #40] @ (800e688 <UTIL_TIMER_GetElapsedTime+0x34>)
|
|
800e65e: 69db ldr r3, [r3, #28]
|
|
800e660: 4798 blx r3
|
|
800e662: 60f8 str r0, [r7, #12]
|
|
uint32_t pastInTicks = UTIL_TimerDriver.ms2Tick( past );
|
|
800e664: 4b08 ldr r3, [pc, #32] @ (800e688 <UTIL_TIMER_GetElapsedTime+0x34>)
|
|
800e666: 6a5b ldr r3, [r3, #36] @ 0x24
|
|
800e668: 6878 ldr r0, [r7, #4]
|
|
800e66a: 4798 blx r3
|
|
800e66c: 60b8 str r0, [r7, #8]
|
|
/* intentional wrap around. Works Ok if tick duation below 1ms */
|
|
return UTIL_TimerDriver.Tick2ms( nowInTicks- pastInTicks );
|
|
800e66e: 4b06 ldr r3, [pc, #24] @ (800e688 <UTIL_TIMER_GetElapsedTime+0x34>)
|
|
800e670: 6a9b ldr r3, [r3, #40] @ 0x28
|
|
800e672: 68f9 ldr r1, [r7, #12]
|
|
800e674: 68ba ldr r2, [r7, #8]
|
|
800e676: 1a8a subs r2, r1, r2
|
|
800e678: 4610 mov r0, r2
|
|
800e67a: 4798 blx r3
|
|
800e67c: 4603 mov r3, r0
|
|
}
|
|
800e67e: 4618 mov r0, r3
|
|
800e680: 3710 adds r7, #16
|
|
800e682: 46bd mov sp, r7
|
|
800e684: bd80 pop {r7, pc}
|
|
800e686: bf00 nop
|
|
800e688: 0801034c .word 0x0801034c
|
|
|
|
0800e68c <TimerExists>:
|
|
*
|
|
* @param TimerObject Structure containing the timer object parameters
|
|
* @retval 1 (the object is already in the list) or 0
|
|
*/
|
|
bool TimerExists( UTIL_TIMER_Object_t *TimerObject )
|
|
{
|
|
800e68c: b480 push {r7}
|
|
800e68e: b085 sub sp, #20
|
|
800e690: af00 add r7, sp, #0
|
|
800e692: 6078 str r0, [r7, #4]
|
|
UTIL_TIMER_Object_t* cur = TimerListHead;
|
|
800e694: 4b0a ldr r3, [pc, #40] @ (800e6c0 <TimerExists+0x34>)
|
|
800e696: 681b ldr r3, [r3, #0]
|
|
800e698: 60fb str r3, [r7, #12]
|
|
|
|
while( cur != NULL )
|
|
800e69a: e008 b.n 800e6ae <TimerExists+0x22>
|
|
{
|
|
if( cur == TimerObject )
|
|
800e69c: 68fa ldr r2, [r7, #12]
|
|
800e69e: 687b ldr r3, [r7, #4]
|
|
800e6a0: 429a cmp r2, r3
|
|
800e6a2: d101 bne.n 800e6a8 <TimerExists+0x1c>
|
|
{
|
|
return true;
|
|
800e6a4: 2301 movs r3, #1
|
|
800e6a6: e006 b.n 800e6b6 <TimerExists+0x2a>
|
|
}
|
|
cur = cur->Next;
|
|
800e6a8: 68fb ldr r3, [r7, #12]
|
|
800e6aa: 695b ldr r3, [r3, #20]
|
|
800e6ac: 60fb str r3, [r7, #12]
|
|
while( cur != NULL )
|
|
800e6ae: 68fb ldr r3, [r7, #12]
|
|
800e6b0: 2b00 cmp r3, #0
|
|
800e6b2: d1f3 bne.n 800e69c <TimerExists+0x10>
|
|
}
|
|
return false;
|
|
800e6b4: 2300 movs r3, #0
|
|
}
|
|
800e6b6: 4618 mov r0, r3
|
|
800e6b8: 3714 adds r7, #20
|
|
800e6ba: 46bd mov sp, r7
|
|
800e6bc: bc80 pop {r7}
|
|
800e6be: 4770 bx lr
|
|
800e6c0: 20000c30 .word 0x20000c30
|
|
|
|
0800e6c4 <TimerSetTimeout>:
|
|
* @brief Sets a timeout with the duration "timestamp"
|
|
*
|
|
* @param TimerObject Structure containing the timer object parameters
|
|
*/
|
|
void TimerSetTimeout( UTIL_TIMER_Object_t *TimerObject )
|
|
{
|
|
800e6c4: b590 push {r4, r7, lr}
|
|
800e6c6: b085 sub sp, #20
|
|
800e6c8: af00 add r7, sp, #0
|
|
800e6ca: 6078 str r0, [r7, #4]
|
|
uint32_t minTicks= UTIL_TimerDriver.GetMinimumTimeout( );
|
|
800e6cc: 4b11 ldr r3, [pc, #68] @ (800e714 <TimerSetTimeout+0x50>)
|
|
800e6ce: 6a1b ldr r3, [r3, #32]
|
|
800e6d0: 4798 blx r3
|
|
800e6d2: 60f8 str r0, [r7, #12]
|
|
TimerObject->IsPending = 1;
|
|
800e6d4: 687b ldr r3, [r7, #4]
|
|
800e6d6: 2201 movs r2, #1
|
|
800e6d8: 721a strb r2, [r3, #8]
|
|
|
|
/* In case deadline too soon */
|
|
if(TimerObject->Timestamp < (UTIL_TimerDriver.GetTimerElapsedTime( ) + minTicks) )
|
|
800e6da: 687b ldr r3, [r7, #4]
|
|
800e6dc: 681c ldr r4, [r3, #0]
|
|
800e6de: 4b0d ldr r3, [pc, #52] @ (800e714 <TimerSetTimeout+0x50>)
|
|
800e6e0: 699b ldr r3, [r3, #24]
|
|
800e6e2: 4798 blx r3
|
|
800e6e4: 4602 mov r2, r0
|
|
800e6e6: 68fb ldr r3, [r7, #12]
|
|
800e6e8: 4413 add r3, r2
|
|
800e6ea: 429c cmp r4, r3
|
|
800e6ec: d207 bcs.n 800e6fe <TimerSetTimeout+0x3a>
|
|
{
|
|
TimerObject->Timestamp = UTIL_TimerDriver.GetTimerElapsedTime( ) + minTicks;
|
|
800e6ee: 4b09 ldr r3, [pc, #36] @ (800e714 <TimerSetTimeout+0x50>)
|
|
800e6f0: 699b ldr r3, [r3, #24]
|
|
800e6f2: 4798 blx r3
|
|
800e6f4: 4602 mov r2, r0
|
|
800e6f6: 68fb ldr r3, [r7, #12]
|
|
800e6f8: 441a add r2, r3
|
|
800e6fa: 687b ldr r3, [r7, #4]
|
|
800e6fc: 601a str r2, [r3, #0]
|
|
}
|
|
UTIL_TimerDriver.StartTimerEvt( TimerObject->Timestamp );
|
|
800e6fe: 4b05 ldr r3, [pc, #20] @ (800e714 <TimerSetTimeout+0x50>)
|
|
800e700: 689b ldr r3, [r3, #8]
|
|
800e702: 687a ldr r2, [r7, #4]
|
|
800e704: 6812 ldr r2, [r2, #0]
|
|
800e706: 4610 mov r0, r2
|
|
800e708: 4798 blx r3
|
|
}
|
|
800e70a: bf00 nop
|
|
800e70c: 3714 adds r7, #20
|
|
800e70e: 46bd mov sp, r7
|
|
800e710: bd90 pop {r4, r7, pc}
|
|
800e712: bf00 nop
|
|
800e714: 0801034c .word 0x0801034c
|
|
|
|
0800e718 <TimerInsertTimer>:
|
|
* next timer to expire.
|
|
*
|
|
* @param TimerObject Structure containing the timer object parameters
|
|
*/
|
|
void TimerInsertTimer( UTIL_TIMER_Object_t *TimerObject)
|
|
{
|
|
800e718: b480 push {r7}
|
|
800e71a: b085 sub sp, #20
|
|
800e71c: af00 add r7, sp, #0
|
|
800e71e: 6078 str r0, [r7, #4]
|
|
UTIL_TIMER_Object_t* cur = TimerListHead;
|
|
800e720: 4b14 ldr r3, [pc, #80] @ (800e774 <TimerInsertTimer+0x5c>)
|
|
800e722: 681b ldr r3, [r3, #0]
|
|
800e724: 60fb str r3, [r7, #12]
|
|
UTIL_TIMER_Object_t* next = TimerListHead->Next;
|
|
800e726: 4b13 ldr r3, [pc, #76] @ (800e774 <TimerInsertTimer+0x5c>)
|
|
800e728: 681b ldr r3, [r3, #0]
|
|
800e72a: 695b ldr r3, [r3, #20]
|
|
800e72c: 60bb str r3, [r7, #8]
|
|
|
|
while (cur->Next != NULL )
|
|
800e72e: e012 b.n 800e756 <TimerInsertTimer+0x3e>
|
|
{
|
|
if( TimerObject->Timestamp > next->Timestamp )
|
|
800e730: 687b ldr r3, [r7, #4]
|
|
800e732: 681a ldr r2, [r3, #0]
|
|
800e734: 68bb ldr r3, [r7, #8]
|
|
800e736: 681b ldr r3, [r3, #0]
|
|
800e738: 429a cmp r2, r3
|
|
800e73a: d905 bls.n 800e748 <TimerInsertTimer+0x30>
|
|
{
|
|
cur = next;
|
|
800e73c: 68bb ldr r3, [r7, #8]
|
|
800e73e: 60fb str r3, [r7, #12]
|
|
next = next->Next;
|
|
800e740: 68bb ldr r3, [r7, #8]
|
|
800e742: 695b ldr r3, [r3, #20]
|
|
800e744: 60bb str r3, [r7, #8]
|
|
800e746: e006 b.n 800e756 <TimerInsertTimer+0x3e>
|
|
}
|
|
else
|
|
{
|
|
cur->Next = TimerObject;
|
|
800e748: 68fb ldr r3, [r7, #12]
|
|
800e74a: 687a ldr r2, [r7, #4]
|
|
800e74c: 615a str r2, [r3, #20]
|
|
TimerObject->Next = next;
|
|
800e74e: 687b ldr r3, [r7, #4]
|
|
800e750: 68ba ldr r2, [r7, #8]
|
|
800e752: 615a str r2, [r3, #20]
|
|
return;
|
|
800e754: e009 b.n 800e76a <TimerInsertTimer+0x52>
|
|
while (cur->Next != NULL )
|
|
800e756: 68fb ldr r3, [r7, #12]
|
|
800e758: 695b ldr r3, [r3, #20]
|
|
800e75a: 2b00 cmp r3, #0
|
|
800e75c: d1e8 bne.n 800e730 <TimerInsertTimer+0x18>
|
|
|
|
}
|
|
}
|
|
cur->Next = TimerObject;
|
|
800e75e: 68fb ldr r3, [r7, #12]
|
|
800e760: 687a ldr r2, [r7, #4]
|
|
800e762: 615a str r2, [r3, #20]
|
|
TimerObject->Next = NULL;
|
|
800e764: 687b ldr r3, [r7, #4]
|
|
800e766: 2200 movs r2, #0
|
|
800e768: 615a str r2, [r3, #20]
|
|
}
|
|
800e76a: 3714 adds r7, #20
|
|
800e76c: 46bd mov sp, r7
|
|
800e76e: bc80 pop {r7}
|
|
800e770: 4770 bx lr
|
|
800e772: bf00 nop
|
|
800e774: 20000c30 .word 0x20000c30
|
|
|
|
0800e778 <TimerInsertNewHeadTimer>:
|
|
*
|
|
* @remark The list is automatically sorted. The list head always contains the
|
|
* next timer to expire.
|
|
*/
|
|
void TimerInsertNewHeadTimer( UTIL_TIMER_Object_t *TimerObject )
|
|
{
|
|
800e778: b580 push {r7, lr}
|
|
800e77a: b084 sub sp, #16
|
|
800e77c: af00 add r7, sp, #0
|
|
800e77e: 6078 str r0, [r7, #4]
|
|
UTIL_TIMER_Object_t* cur = TimerListHead;
|
|
800e780: 4b0b ldr r3, [pc, #44] @ (800e7b0 <TimerInsertNewHeadTimer+0x38>)
|
|
800e782: 681b ldr r3, [r3, #0]
|
|
800e784: 60fb str r3, [r7, #12]
|
|
|
|
if( cur != NULL )
|
|
800e786: 68fb ldr r3, [r7, #12]
|
|
800e788: 2b00 cmp r3, #0
|
|
800e78a: d002 beq.n 800e792 <TimerInsertNewHeadTimer+0x1a>
|
|
{
|
|
cur->IsPending = 0;
|
|
800e78c: 68fb ldr r3, [r7, #12]
|
|
800e78e: 2200 movs r2, #0
|
|
800e790: 721a strb r2, [r3, #8]
|
|
}
|
|
|
|
TimerObject->Next = cur;
|
|
800e792: 687b ldr r3, [r7, #4]
|
|
800e794: 68fa ldr r2, [r7, #12]
|
|
800e796: 615a str r2, [r3, #20]
|
|
TimerListHead = TimerObject;
|
|
800e798: 4a05 ldr r2, [pc, #20] @ (800e7b0 <TimerInsertNewHeadTimer+0x38>)
|
|
800e79a: 687b ldr r3, [r7, #4]
|
|
800e79c: 6013 str r3, [r2, #0]
|
|
TimerSetTimeout( TimerListHead );
|
|
800e79e: 4b04 ldr r3, [pc, #16] @ (800e7b0 <TimerInsertNewHeadTimer+0x38>)
|
|
800e7a0: 681b ldr r3, [r3, #0]
|
|
800e7a2: 4618 mov r0, r3
|
|
800e7a4: f7ff ff8e bl 800e6c4 <TimerSetTimeout>
|
|
}
|
|
800e7a8: bf00 nop
|
|
800e7aa: 3710 adds r7, #16
|
|
800e7ac: 46bd mov sp, r7
|
|
800e7ae: bd80 pop {r7, pc}
|
|
800e7b0: 20000c30 .word 0x20000c30
|
|
|
|
0800e7b4 <UTIL_ADV_TRACE_Init>:
|
|
|
|
/** @addtogroup ADV_TRACE_exported_function
|
|
* @{
|
|
*/
|
|
UTIL_ADV_TRACE_Status_t UTIL_ADV_TRACE_Init(void)
|
|
{
|
|
800e7b4: b580 push {r7, lr}
|
|
800e7b6: af00 add r7, sp, #0
|
|
/* initialize the Ptr for Read/Write */
|
|
(void)UTIL_ADV_TRACE_MEMSET8(&ADV_TRACE_Ctx, 0x0, sizeof(ADV_TRACE_Context));
|
|
800e7b8: 2218 movs r2, #24
|
|
800e7ba: 2100 movs r1, #0
|
|
800e7bc: 4807 ldr r0, [pc, #28] @ (800e7dc <UTIL_ADV_TRACE_Init+0x28>)
|
|
800e7be: f7ff f936 bl 800da2e <UTIL_MEM_set_8>
|
|
(void)UTIL_ADV_TRACE_MEMSET8(&ADV_TRACE_Buffer, 0x0, sizeof(ADV_TRACE_Buffer));
|
|
800e7c2: f44f 7200 mov.w r2, #512 @ 0x200
|
|
800e7c6: 2100 movs r1, #0
|
|
800e7c8: 4805 ldr r0, [pc, #20] @ (800e7e0 <UTIL_ADV_TRACE_Init+0x2c>)
|
|
800e7ca: f7ff f930 bl 800da2e <UTIL_MEM_set_8>
|
|
#endif
|
|
/* Allocate Lock resource */
|
|
UTIL_ADV_TRACE_INIT_CRITICAL_SECTION();
|
|
|
|
/* Initialize the Low Level interface */
|
|
return UTIL_TraceDriver.Init(TRACE_TxCpltCallback);
|
|
800e7ce: 4b05 ldr r3, [pc, #20] @ (800e7e4 <UTIL_ADV_TRACE_Init+0x30>)
|
|
800e7d0: 681b ldr r3, [r3, #0]
|
|
800e7d2: 4805 ldr r0, [pc, #20] @ (800e7e8 <UTIL_ADV_TRACE_Init+0x34>)
|
|
800e7d4: 4798 blx r3
|
|
800e7d6: 4603 mov r3, r0
|
|
}
|
|
800e7d8: 4618 mov r0, r3
|
|
800e7da: bd80 pop {r7, pc}
|
|
800e7dc: 20000c34 .word 0x20000c34
|
|
800e7e0: 20000c4c .word 0x20000c4c
|
|
800e7e4: 0801038c .word 0x0801038c
|
|
800e7e8: 0800ea31 .word 0x0800ea31
|
|
|
|
0800e7ec <UTIL_ADV_TRACE_COND_FSend>:
|
|
return UTIL_TraceDriver.StartRx(UserCallback);
|
|
}
|
|
|
|
#if defined(UTIL_ADV_TRACE_CONDITIONNAL)
|
|
UTIL_ADV_TRACE_Status_t UTIL_ADV_TRACE_COND_FSend(uint32_t VerboseLevel, uint32_t Region, uint32_t TimeStampState, const char *strFormat, ...)
|
|
{
|
|
800e7ec: b408 push {r3}
|
|
800e7ee: b580 push {r7, lr}
|
|
800e7f0: b08d sub sp, #52 @ 0x34
|
|
800e7f2: af00 add r7, sp, #0
|
|
800e7f4: 60f8 str r0, [r7, #12]
|
|
800e7f6: 60b9 str r1, [r7, #8]
|
|
800e7f8: 607a str r2, [r7, #4]
|
|
va_list vaArgs;
|
|
#if defined(UTIL_ADV_TRACE_UNCHUNK_MODE)
|
|
uint8_t buf[UTIL_ADV_TRACE_TMP_MAX_TIMESTMAP_SIZE];
|
|
uint16_t timestamp_size = 0u;
|
|
800e7fa: 2300 movs r3, #0
|
|
800e7fc: 82fb strh r3, [r7, #22]
|
|
uint16_t writepos;
|
|
uint16_t idx;
|
|
#else
|
|
uint8_t buf[UTIL_ADV_TRACE_TMP_BUF_SIZE+UTIL_ADV_TRACE_TMP_MAX_TIMESTMAP_SIZE];
|
|
#endif
|
|
uint16_t buff_size = 0u;
|
|
800e7fe: 2300 movs r3, #0
|
|
800e800: 85bb strh r3, [r7, #44] @ 0x2c
|
|
|
|
/* check verbose level */
|
|
if(!(ADV_TRACE_Ctx.CurrentVerboseLevel >= VerboseLevel))
|
|
800e802: 4b37 ldr r3, [pc, #220] @ (800e8e0 <UTIL_ADV_TRACE_COND_FSend+0xf4>)
|
|
800e804: 7a1b ldrb r3, [r3, #8]
|
|
800e806: 461a mov r2, r3
|
|
800e808: 68fb ldr r3, [r7, #12]
|
|
800e80a: 4293 cmp r3, r2
|
|
800e80c: d902 bls.n 800e814 <UTIL_ADV_TRACE_COND_FSend+0x28>
|
|
{
|
|
return UTIL_ADV_TRACE_GIVEUP;
|
|
800e80e: f06f 0304 mvn.w r3, #4
|
|
800e812: e05e b.n 800e8d2 <UTIL_ADV_TRACE_COND_FSend+0xe6>
|
|
}
|
|
|
|
if((Region & ADV_TRACE_Ctx.RegionMask) != Region)
|
|
800e814: 4b32 ldr r3, [pc, #200] @ (800e8e0 <UTIL_ADV_TRACE_COND_FSend+0xf4>)
|
|
800e816: 68da ldr r2, [r3, #12]
|
|
800e818: 68bb ldr r3, [r7, #8]
|
|
800e81a: 4013 ands r3, r2
|
|
800e81c: 68ba ldr r2, [r7, #8]
|
|
800e81e: 429a cmp r2, r3
|
|
800e820: d002 beq.n 800e828 <UTIL_ADV_TRACE_COND_FSend+0x3c>
|
|
{
|
|
return UTIL_ADV_TRACE_REGIONMASKED;
|
|
800e822: f06f 0305 mvn.w r3, #5
|
|
800e826: e054 b.n 800e8d2 <UTIL_ADV_TRACE_COND_FSend+0xe6>
|
|
}
|
|
|
|
#if defined(UTIL_ADV_TRACE_UNCHUNK_MODE)
|
|
if((ADV_TRACE_Ctx.timestamp_func != NULL) && (TimeStampState != 0u))
|
|
800e828: 4b2d ldr r3, [pc, #180] @ (800e8e0 <UTIL_ADV_TRACE_COND_FSend+0xf4>)
|
|
800e82a: 685b ldr r3, [r3, #4]
|
|
800e82c: 2b00 cmp r3, #0
|
|
800e82e: d00a beq.n 800e846 <UTIL_ADV_TRACE_COND_FSend+0x5a>
|
|
800e830: 687b ldr r3, [r7, #4]
|
|
800e832: 2b00 cmp r3, #0
|
|
800e834: d007 beq.n 800e846 <UTIL_ADV_TRACE_COND_FSend+0x5a>
|
|
{
|
|
ADV_TRACE_Ctx.timestamp_func(buf,×tamp_size);
|
|
800e836: 4b2a ldr r3, [pc, #168] @ (800e8e0 <UTIL_ADV_TRACE_COND_FSend+0xf4>)
|
|
800e838: 685b ldr r3, [r3, #4]
|
|
800e83a: f107 0116 add.w r1, r7, #22
|
|
800e83e: f107 0218 add.w r2, r7, #24
|
|
800e842: 4610 mov r0, r2
|
|
800e844: 4798 blx r3
|
|
}
|
|
|
|
va_start( vaArgs, strFormat);
|
|
800e846: f107 0340 add.w r3, r7, #64 @ 0x40
|
|
800e84a: 62bb str r3, [r7, #40] @ 0x28
|
|
buff_size =(uint16_t)UTIL_ADV_TRACE_VSNPRINTF((char *)sztmp,UTIL_ADV_TRACE_TMP_BUF_SIZE, strFormat, vaArgs);
|
|
800e84c: 6abb ldr r3, [r7, #40] @ 0x28
|
|
800e84e: 6bfa ldr r2, [r7, #60] @ 0x3c
|
|
800e850: f44f 7180 mov.w r1, #256 @ 0x100
|
|
800e854: 4823 ldr r0, [pc, #140] @ (800e8e4 <UTIL_ADV_TRACE_COND_FSend+0xf8>)
|
|
800e856: f7ff fa8b bl 800dd70 <tiny_vsnprintf_like>
|
|
800e85a: 4603 mov r3, r0
|
|
800e85c: 85bb strh r3, [r7, #44] @ 0x2c
|
|
|
|
TRACE_Lock();
|
|
800e85e: f000 f9f1 bl 800ec44 <TRACE_Lock>
|
|
|
|
/* if allocation is ok, write data into the buffer */
|
|
if (TRACE_AllocateBufer((buff_size+timestamp_size),&writepos) != -1)
|
|
800e862: 8afa ldrh r2, [r7, #22]
|
|
800e864: 8dbb ldrh r3, [r7, #44] @ 0x2c
|
|
800e866: 4413 add r3, r2
|
|
800e868: b29b uxth r3, r3
|
|
800e86a: f107 0214 add.w r2, r7, #20
|
|
800e86e: 4611 mov r1, r2
|
|
800e870: 4618 mov r0, r3
|
|
800e872: f000 f969 bl 800eb48 <TRACE_AllocateBufer>
|
|
800e876: 4603 mov r3, r0
|
|
800e878: f1b3 3fff cmp.w r3, #4294967295 @ 0xffffffff
|
|
800e87c: d025 beq.n 800e8ca <UTIL_ADV_TRACE_COND_FSend+0xde>
|
|
}
|
|
UTIL_ADV_TRACE_EXIT_CRITICAL_SECTION();
|
|
#endif
|
|
|
|
/* copy the timestamp */
|
|
for (idx = 0u; idx < timestamp_size; idx++)
|
|
800e87e: 2300 movs r3, #0
|
|
800e880: 85fb strh r3, [r7, #46] @ 0x2e
|
|
800e882: e00e b.n 800e8a2 <UTIL_ADV_TRACE_COND_FSend+0xb6>
|
|
{
|
|
ADV_TRACE_Buffer[writepos] = buf[idx];
|
|
800e884: 8dfb ldrh r3, [r7, #46] @ 0x2e
|
|
800e886: 8aba ldrh r2, [r7, #20]
|
|
800e888: 3330 adds r3, #48 @ 0x30
|
|
800e88a: 443b add r3, r7
|
|
800e88c: f813 1c18 ldrb.w r1, [r3, #-24]
|
|
800e890: 4b15 ldr r3, [pc, #84] @ (800e8e8 <UTIL_ADV_TRACE_COND_FSend+0xfc>)
|
|
800e892: 5499 strb r1, [r3, r2]
|
|
writepos = writepos + 1u;
|
|
800e894: 8abb ldrh r3, [r7, #20]
|
|
800e896: 3301 adds r3, #1
|
|
800e898: b29b uxth r3, r3
|
|
800e89a: 82bb strh r3, [r7, #20]
|
|
for (idx = 0u; idx < timestamp_size; idx++)
|
|
800e89c: 8dfb ldrh r3, [r7, #46] @ 0x2e
|
|
800e89e: 3301 adds r3, #1
|
|
800e8a0: 85fb strh r3, [r7, #46] @ 0x2e
|
|
800e8a2: 8afb ldrh r3, [r7, #22]
|
|
800e8a4: 8dfa ldrh r2, [r7, #46] @ 0x2e
|
|
800e8a6: 429a cmp r2, r3
|
|
800e8a8: d3ec bcc.n 800e884 <UTIL_ADV_TRACE_COND_FSend+0x98>
|
|
}
|
|
|
|
/* copy the data */
|
|
(void)UTIL_ADV_TRACE_VSNPRINTF((char *)(&ADV_TRACE_Buffer[writepos]), UTIL_ADV_TRACE_TMP_BUF_SIZE, strFormat, vaArgs);
|
|
800e8aa: 8abb ldrh r3, [r7, #20]
|
|
800e8ac: 461a mov r2, r3
|
|
800e8ae: 4b0e ldr r3, [pc, #56] @ (800e8e8 <UTIL_ADV_TRACE_COND_FSend+0xfc>)
|
|
800e8b0: 18d0 adds r0, r2, r3
|
|
800e8b2: 6abb ldr r3, [r7, #40] @ 0x28
|
|
800e8b4: 6bfa ldr r2, [r7, #60] @ 0x3c
|
|
800e8b6: f44f 7180 mov.w r1, #256 @ 0x100
|
|
800e8ba: f7ff fa59 bl 800dd70 <tiny_vsnprintf_like>
|
|
va_end(vaArgs);
|
|
|
|
TRACE_UnLock();
|
|
800e8be: f000 f9df bl 800ec80 <TRACE_UnLock>
|
|
|
|
return TRACE_Send();
|
|
800e8c2: f000 f831 bl 800e928 <TRACE_Send>
|
|
800e8c6: 4603 mov r3, r0
|
|
800e8c8: e003 b.n 800e8d2 <UTIL_ADV_TRACE_COND_FSend+0xe6>
|
|
}
|
|
|
|
va_end(vaArgs);
|
|
TRACE_UnLock();
|
|
800e8ca: f000 f9d9 bl 800ec80 <TRACE_UnLock>
|
|
ADV_TRACE_Ctx.OverRunStatus = TRACE_OVERRUN_INDICATION;
|
|
}
|
|
UTIL_ADV_TRACE_EXIT_CRITICAL_SECTION();
|
|
#endif
|
|
|
|
return UTIL_ADV_TRACE_MEM_FULL;
|
|
800e8ce: f06f 0302 mvn.w r3, #2
|
|
buff_size += (uint16_t) UTIL_ADV_TRACE_VSNPRINTF((char* )(buf + buff_size), UTIL_ADV_TRACE_TMP_BUF_SIZE, strFormat, vaArgs);
|
|
va_end(vaArgs);
|
|
|
|
return UTIL_ADV_TRACE_Send(buf, buff_size);
|
|
#endif
|
|
}
|
|
800e8d2: 4618 mov r0, r3
|
|
800e8d4: 3734 adds r7, #52 @ 0x34
|
|
800e8d6: 46bd mov sp, r7
|
|
800e8d8: e8bd 4080 ldmia.w sp!, {r7, lr}
|
|
800e8dc: b001 add sp, #4
|
|
800e8de: 4770 bx lr
|
|
800e8e0: 20000c34 .word 0x20000c34
|
|
800e8e4: 20000e4c .word 0x20000e4c
|
|
800e8e8: 20000c4c .word 0x20000c4c
|
|
|
|
0800e8ec <UTIL_ADV_TRACE_RegisterTimeStampFunction>:
|
|
}
|
|
#endif
|
|
|
|
#if defined(UTIL_ADV_TRACE_CONDITIONNAL)
|
|
void UTIL_ADV_TRACE_RegisterTimeStampFunction(cb_timestamp *cb)
|
|
{
|
|
800e8ec: b480 push {r7}
|
|
800e8ee: b083 sub sp, #12
|
|
800e8f0: af00 add r7, sp, #0
|
|
800e8f2: 6078 str r0, [r7, #4]
|
|
ADV_TRACE_Ctx.timestamp_func = *cb;
|
|
800e8f4: 4a03 ldr r2, [pc, #12] @ (800e904 <UTIL_ADV_TRACE_RegisterTimeStampFunction+0x18>)
|
|
800e8f6: 687b ldr r3, [r7, #4]
|
|
800e8f8: 6053 str r3, [r2, #4]
|
|
}
|
|
800e8fa: bf00 nop
|
|
800e8fc: 370c adds r7, #12
|
|
800e8fe: 46bd mov sp, r7
|
|
800e900: bc80 pop {r7}
|
|
800e902: 4770 bx lr
|
|
800e904: 20000c34 .word 0x20000c34
|
|
|
|
0800e908 <UTIL_ADV_TRACE_SetVerboseLevel>:
|
|
|
|
void UTIL_ADV_TRACE_SetVerboseLevel(uint8_t Level)
|
|
{
|
|
800e908: b480 push {r7}
|
|
800e90a: b083 sub sp, #12
|
|
800e90c: af00 add r7, sp, #0
|
|
800e90e: 4603 mov r3, r0
|
|
800e910: 71fb strb r3, [r7, #7]
|
|
ADV_TRACE_Ctx.CurrentVerboseLevel = Level;
|
|
800e912: 4a04 ldr r2, [pc, #16] @ (800e924 <UTIL_ADV_TRACE_SetVerboseLevel+0x1c>)
|
|
800e914: 79fb ldrb r3, [r7, #7]
|
|
800e916: 7213 strb r3, [r2, #8]
|
|
}
|
|
800e918: bf00 nop
|
|
800e91a: 370c adds r7, #12
|
|
800e91c: 46bd mov sp, r7
|
|
800e91e: bc80 pop {r7}
|
|
800e920: 4770 bx lr
|
|
800e922: bf00 nop
|
|
800e924: 20000c34 .word 0x20000c34
|
|
|
|
0800e928 <TRACE_Send>:
|
|
/**
|
|
* @brief send the data of the trace to low layer
|
|
* @retval Status based on @ref UTIL_ADV_TRACE_Status_t
|
|
*/
|
|
static UTIL_ADV_TRACE_Status_t TRACE_Send(void)
|
|
{
|
|
800e928: b580 push {r7, lr}
|
|
800e92a: b088 sub sp, #32
|
|
800e92c: af00 add r7, sp, #0
|
|
UTIL_ADV_TRACE_Status_t ret = UTIL_ADV_TRACE_OK;
|
|
800e92e: 2300 movs r3, #0
|
|
800e930: 77fb strb r3, [r7, #31]
|
|
uint8_t *ptr = NULL;
|
|
800e932: 2300 movs r3, #0
|
|
800e934: 61bb str r3, [r7, #24]
|
|
__ASM volatile ("MRS %0, primask" : "=r" (result) :: "memory");
|
|
800e936: f3ef 8310 mrs r3, PRIMASK
|
|
800e93a: 613b str r3, [r7, #16]
|
|
return(result);
|
|
800e93c: 693b ldr r3, [r7, #16]
|
|
|
|
UTIL_ADV_TRACE_ENTER_CRITICAL_SECTION();
|
|
800e93e: 617b str r3, [r7, #20]
|
|
__ASM volatile ("cpsid i" : : : "memory");
|
|
800e940: b672 cpsid i
|
|
}
|
|
800e942: bf00 nop
|
|
|
|
if(TRACE_IsLocked() == 0u)
|
|
800e944: f000 f9ba bl 800ecbc <TRACE_IsLocked>
|
|
800e948: 4603 mov r3, r0
|
|
800e94a: 2b00 cmp r3, #0
|
|
800e94c: d15d bne.n 800ea0a <TRACE_Send+0xe2>
|
|
{
|
|
TRACE_Lock();
|
|
800e94e: f000 f979 bl 800ec44 <TRACE_Lock>
|
|
|
|
if(ADV_TRACE_Ctx.TraceRdPtr != ADV_TRACE_Ctx.TraceWrPtr)
|
|
800e952: 4b34 ldr r3, [pc, #208] @ (800ea24 <TRACE_Send+0xfc>)
|
|
800e954: 8a1a ldrh r2, [r3, #16]
|
|
800e956: 4b33 ldr r3, [pc, #204] @ (800ea24 <TRACE_Send+0xfc>)
|
|
800e958: 8a5b ldrh r3, [r3, #18]
|
|
800e95a: 429a cmp r2, r3
|
|
800e95c: d04d beq.n 800e9fa <TRACE_Send+0xd2>
|
|
{
|
|
#ifdef UTIL_ADV_TRACE_UNCHUNK_MODE
|
|
if(TRACE_UNCHUNK_DETECTED == ADV_TRACE_Ctx.unchunk_status)
|
|
800e95e: 4b31 ldr r3, [pc, #196] @ (800ea24 <TRACE_Send+0xfc>)
|
|
800e960: 789b ldrb r3, [r3, #2]
|
|
800e962: 2b01 cmp r3, #1
|
|
800e964: d117 bne.n 800e996 <TRACE_Send+0x6e>
|
|
{
|
|
ADV_TRACE_Ctx.TraceSentSize = (uint16_t) (ADV_TRACE_Ctx.unchunk_enabled - ADV_TRACE_Ctx.TraceRdPtr);
|
|
800e966: 4b2f ldr r3, [pc, #188] @ (800ea24 <TRACE_Send+0xfc>)
|
|
800e968: 881a ldrh r2, [r3, #0]
|
|
800e96a: 4b2e ldr r3, [pc, #184] @ (800ea24 <TRACE_Send+0xfc>)
|
|
800e96c: 8a1b ldrh r3, [r3, #16]
|
|
800e96e: 1ad3 subs r3, r2, r3
|
|
800e970: b29a uxth r2, r3
|
|
800e972: 4b2c ldr r3, [pc, #176] @ (800ea24 <TRACE_Send+0xfc>)
|
|
800e974: 829a strh r2, [r3, #20]
|
|
ADV_TRACE_Ctx.unchunk_status = TRACE_UNCHUNK_TRANSFER;
|
|
800e976: 4b2b ldr r3, [pc, #172] @ (800ea24 <TRACE_Send+0xfc>)
|
|
800e978: 2202 movs r2, #2
|
|
800e97a: 709a strb r2, [r3, #2]
|
|
ADV_TRACE_Ctx.unchunk_enabled = 0;
|
|
800e97c: 4b29 ldr r3, [pc, #164] @ (800ea24 <TRACE_Send+0xfc>)
|
|
800e97e: 2200 movs r2, #0
|
|
800e980: 801a strh r2, [r3, #0]
|
|
|
|
UTIL_ADV_TRACE_DEBUG("\nTRACE_TxCpltCallback::unchunk start(%d,%d)\n", ADV_TRACE_Ctx.unchunk_enabled, ADV_TRACE_Ctx.TraceRdPtr);
|
|
|
|
if(0u == ADV_TRACE_Ctx.TraceSentSize)
|
|
800e982: 4b28 ldr r3, [pc, #160] @ (800ea24 <TRACE_Send+0xfc>)
|
|
800e984: 8a9b ldrh r3, [r3, #20]
|
|
800e986: 2b00 cmp r3, #0
|
|
800e988: d105 bne.n 800e996 <TRACE_Send+0x6e>
|
|
{
|
|
ADV_TRACE_Ctx.unchunk_status = TRACE_UNCHUNK_NONE;
|
|
800e98a: 4b26 ldr r3, [pc, #152] @ (800ea24 <TRACE_Send+0xfc>)
|
|
800e98c: 2200 movs r2, #0
|
|
800e98e: 709a strb r2, [r3, #2]
|
|
ADV_TRACE_Ctx.TraceRdPtr = 0;
|
|
800e990: 4b24 ldr r3, [pc, #144] @ (800ea24 <TRACE_Send+0xfc>)
|
|
800e992: 2200 movs r2, #0
|
|
800e994: 821a strh r2, [r3, #16]
|
|
}
|
|
}
|
|
|
|
if(TRACE_UNCHUNK_NONE == ADV_TRACE_Ctx.unchunk_status)
|
|
800e996: 4b23 ldr r3, [pc, #140] @ (800ea24 <TRACE_Send+0xfc>)
|
|
800e998: 789b ldrb r3, [r3, #2]
|
|
800e99a: 2b00 cmp r3, #0
|
|
800e99c: d115 bne.n 800e9ca <TRACE_Send+0xa2>
|
|
{
|
|
#endif
|
|
if(ADV_TRACE_Ctx.TraceWrPtr > ADV_TRACE_Ctx.TraceRdPtr)
|
|
800e99e: 4b21 ldr r3, [pc, #132] @ (800ea24 <TRACE_Send+0xfc>)
|
|
800e9a0: 8a5a ldrh r2, [r3, #18]
|
|
800e9a2: 4b20 ldr r3, [pc, #128] @ (800ea24 <TRACE_Send+0xfc>)
|
|
800e9a4: 8a1b ldrh r3, [r3, #16]
|
|
800e9a6: 429a cmp r2, r3
|
|
800e9a8: d908 bls.n 800e9bc <TRACE_Send+0x94>
|
|
{
|
|
ADV_TRACE_Ctx.TraceSentSize = ADV_TRACE_Ctx.TraceWrPtr - ADV_TRACE_Ctx.TraceRdPtr;
|
|
800e9aa: 4b1e ldr r3, [pc, #120] @ (800ea24 <TRACE_Send+0xfc>)
|
|
800e9ac: 8a5a ldrh r2, [r3, #18]
|
|
800e9ae: 4b1d ldr r3, [pc, #116] @ (800ea24 <TRACE_Send+0xfc>)
|
|
800e9b0: 8a1b ldrh r3, [r3, #16]
|
|
800e9b2: 1ad3 subs r3, r2, r3
|
|
800e9b4: b29a uxth r2, r3
|
|
800e9b6: 4b1b ldr r3, [pc, #108] @ (800ea24 <TRACE_Send+0xfc>)
|
|
800e9b8: 829a strh r2, [r3, #20]
|
|
800e9ba: e006 b.n 800e9ca <TRACE_Send+0xa2>
|
|
}
|
|
else /* TraceRdPtr > TraceWrPtr */
|
|
{
|
|
ADV_TRACE_Ctx.TraceSentSize = UTIL_ADV_TRACE_FIFO_SIZE - ADV_TRACE_Ctx.TraceRdPtr;
|
|
800e9bc: 4b19 ldr r3, [pc, #100] @ (800ea24 <TRACE_Send+0xfc>)
|
|
800e9be: 8a1b ldrh r3, [r3, #16]
|
|
800e9c0: f5c3 7300 rsb r3, r3, #512 @ 0x200
|
|
800e9c4: b29a uxth r2, r3
|
|
800e9c6: 4b17 ldr r3, [pc, #92] @ (800ea24 <TRACE_Send+0xfc>)
|
|
800e9c8: 829a strh r2, [r3, #20]
|
|
|
|
}
|
|
#ifdef UTIL_ADV_TRACE_UNCHUNK_MODE
|
|
}
|
|
#endif
|
|
ptr = &ADV_TRACE_Buffer[ADV_TRACE_Ctx.TraceRdPtr];
|
|
800e9ca: 4b16 ldr r3, [pc, #88] @ (800ea24 <TRACE_Send+0xfc>)
|
|
800e9cc: 8a1b ldrh r3, [r3, #16]
|
|
800e9ce: 461a mov r2, r3
|
|
800e9d0: 4b15 ldr r3, [pc, #84] @ (800ea28 <TRACE_Send+0x100>)
|
|
800e9d2: 4413 add r3, r2
|
|
800e9d4: 61bb str r3, [r7, #24]
|
|
800e9d6: 697b ldr r3, [r7, #20]
|
|
800e9d8: 60fb str r3, [r7, #12]
|
|
__ASM volatile ("MSR primask, %0" : : "r" (priMask) : "memory");
|
|
800e9da: 68fb ldr r3, [r7, #12]
|
|
800e9dc: f383 8810 msr PRIMASK, r3
|
|
}
|
|
800e9e0: bf00 nop
|
|
|
|
UTIL_ADV_TRACE_EXIT_CRITICAL_SECTION();
|
|
UTIL_ADV_TRACE_PreSendHook();
|
|
800e9e2: f7f2 f901 bl 8000be8 <UTIL_ADV_TRACE_PreSendHook>
|
|
|
|
UTIL_ADV_TRACE_DEBUG("\n--TRACE_Send(%d-%d)--\n", ADV_TRACE_Ctx.TraceRdPtr, ADV_TRACE_Ctx.TraceSentSize);
|
|
ret = UTIL_TraceDriver.Send(ptr, ADV_TRACE_Ctx.TraceSentSize);
|
|
800e9e6: 4b11 ldr r3, [pc, #68] @ (800ea2c <TRACE_Send+0x104>)
|
|
800e9e8: 68db ldr r3, [r3, #12]
|
|
800e9ea: 4a0e ldr r2, [pc, #56] @ (800ea24 <TRACE_Send+0xfc>)
|
|
800e9ec: 8a92 ldrh r2, [r2, #20]
|
|
800e9ee: 4611 mov r1, r2
|
|
800e9f0: 69b8 ldr r0, [r7, #24]
|
|
800e9f2: 4798 blx r3
|
|
800e9f4: 4603 mov r3, r0
|
|
800e9f6: 77fb strb r3, [r7, #31]
|
|
800e9f8: e00d b.n 800ea16 <TRACE_Send+0xee>
|
|
}
|
|
else
|
|
{
|
|
TRACE_UnLock();
|
|
800e9fa: f000 f941 bl 800ec80 <TRACE_UnLock>
|
|
800e9fe: 697b ldr r3, [r7, #20]
|
|
800ea00: 60bb str r3, [r7, #8]
|
|
__ASM volatile ("MSR primask, %0" : : "r" (priMask) : "memory");
|
|
800ea02: 68bb ldr r3, [r7, #8]
|
|
800ea04: f383 8810 msr PRIMASK, r3
|
|
}
|
|
800ea08: e005 b.n 800ea16 <TRACE_Send+0xee>
|
|
800ea0a: 697b ldr r3, [r7, #20]
|
|
800ea0c: 607b str r3, [r7, #4]
|
|
__ASM volatile ("MSR primask, %0" : : "r" (priMask) : "memory");
|
|
800ea0e: 687b ldr r3, [r7, #4]
|
|
800ea10: f383 8810 msr PRIMASK, r3
|
|
}
|
|
800ea14: bf00 nop
|
|
else
|
|
{
|
|
UTIL_ADV_TRACE_EXIT_CRITICAL_SECTION();
|
|
}
|
|
|
|
return ret;
|
|
800ea16: f997 301f ldrsb.w r3, [r7, #31]
|
|
}
|
|
800ea1a: 4618 mov r0, r3
|
|
800ea1c: 3720 adds r7, #32
|
|
800ea1e: 46bd mov sp, r7
|
|
800ea20: bd80 pop {r7, pc}
|
|
800ea22: bf00 nop
|
|
800ea24: 20000c34 .word 0x20000c34
|
|
800ea28: 20000c4c .word 0x20000c4c
|
|
800ea2c: 0801038c .word 0x0801038c
|
|
|
|
0800ea30 <TRACE_TxCpltCallback>:
|
|
* @brief Tx callback called by the low layer level to inform a transfer complete
|
|
* @param Ptr pointer not used only for HAL compatibility
|
|
* @retval none
|
|
*/
|
|
static void TRACE_TxCpltCallback(void *Ptr)
|
|
{
|
|
800ea30: b580 push {r7, lr}
|
|
800ea32: b088 sub sp, #32
|
|
800ea34: af00 add r7, sp, #0
|
|
800ea36: 6078 str r0, [r7, #4]
|
|
uint8_t *ptr = NULL;
|
|
800ea38: 2300 movs r3, #0
|
|
800ea3a: 61fb str r3, [r7, #28]
|
|
__ASM volatile ("MRS %0, primask" : "=r" (result) :: "memory");
|
|
800ea3c: f3ef 8310 mrs r3, PRIMASK
|
|
800ea40: 617b str r3, [r7, #20]
|
|
return(result);
|
|
800ea42: 697b ldr r3, [r7, #20]
|
|
UTIL_ADV_TRACE_ENTER_CRITICAL_SECTION();
|
|
800ea44: 61bb str r3, [r7, #24]
|
|
__ASM volatile ("cpsid i" : : : "memory");
|
|
800ea46: b672 cpsid i
|
|
}
|
|
800ea48: bf00 nop
|
|
ADV_TRACE_Ctx.TraceSentSize = 0u;
|
|
}
|
|
#endif
|
|
|
|
#if defined(UTIL_ADV_TRACE_UNCHUNK_MODE)
|
|
if(TRACE_UNCHUNK_TRANSFER == ADV_TRACE_Ctx.unchunk_status)
|
|
800ea4a: 4b3c ldr r3, [pc, #240] @ (800eb3c <TRACE_TxCpltCallback+0x10c>)
|
|
800ea4c: 789b ldrb r3, [r3, #2]
|
|
800ea4e: 2b02 cmp r3, #2
|
|
800ea50: d106 bne.n 800ea60 <TRACE_TxCpltCallback+0x30>
|
|
{
|
|
ADV_TRACE_Ctx.unchunk_status = TRACE_UNCHUNK_NONE;
|
|
800ea52: 4b3a ldr r3, [pc, #232] @ (800eb3c <TRACE_TxCpltCallback+0x10c>)
|
|
800ea54: 2200 movs r2, #0
|
|
800ea56: 709a strb r2, [r3, #2]
|
|
ADV_TRACE_Ctx.TraceRdPtr = 0;
|
|
800ea58: 4b38 ldr r3, [pc, #224] @ (800eb3c <TRACE_TxCpltCallback+0x10c>)
|
|
800ea5a: 2200 movs r2, #0
|
|
800ea5c: 821a strh r2, [r3, #16]
|
|
800ea5e: e00a b.n 800ea76 <TRACE_TxCpltCallback+0x46>
|
|
UTIL_ADV_TRACE_DEBUG("\nTRACE_TxCpltCallback::unchunk complete\n");
|
|
}
|
|
else
|
|
{
|
|
ADV_TRACE_Ctx.TraceRdPtr = (ADV_TRACE_Ctx.TraceRdPtr + ADV_TRACE_Ctx.TraceSentSize) % UTIL_ADV_TRACE_FIFO_SIZE;
|
|
800ea60: 4b36 ldr r3, [pc, #216] @ (800eb3c <TRACE_TxCpltCallback+0x10c>)
|
|
800ea62: 8a1a ldrh r2, [r3, #16]
|
|
800ea64: 4b35 ldr r3, [pc, #212] @ (800eb3c <TRACE_TxCpltCallback+0x10c>)
|
|
800ea66: 8a9b ldrh r3, [r3, #20]
|
|
800ea68: 4413 add r3, r2
|
|
800ea6a: b29b uxth r3, r3
|
|
800ea6c: f3c3 0308 ubfx r3, r3, #0, #9
|
|
800ea70: b29a uxth r2, r3
|
|
800ea72: 4b32 ldr r3, [pc, #200] @ (800eb3c <TRACE_TxCpltCallback+0x10c>)
|
|
800ea74: 821a strh r2, [r3, #16]
|
|
UTIL_TraceDriver.Send(ptr, ADV_TRACE_Ctx.TraceSentSize);
|
|
return;
|
|
}
|
|
#endif
|
|
|
|
if((ADV_TRACE_Ctx.TraceRdPtr != ADV_TRACE_Ctx.TraceWrPtr) && (1u == ADV_TRACE_Ctx.TraceLock))
|
|
800ea76: 4b31 ldr r3, [pc, #196] @ (800eb3c <TRACE_TxCpltCallback+0x10c>)
|
|
800ea78: 8a1a ldrh r2, [r3, #16]
|
|
800ea7a: 4b30 ldr r3, [pc, #192] @ (800eb3c <TRACE_TxCpltCallback+0x10c>)
|
|
800ea7c: 8a5b ldrh r3, [r3, #18]
|
|
800ea7e: 429a cmp r2, r3
|
|
800ea80: d04d beq.n 800eb1e <TRACE_TxCpltCallback+0xee>
|
|
800ea82: 4b2e ldr r3, [pc, #184] @ (800eb3c <TRACE_TxCpltCallback+0x10c>)
|
|
800ea84: 8adb ldrh r3, [r3, #22]
|
|
800ea86: 2b01 cmp r3, #1
|
|
800ea88: d149 bne.n 800eb1e <TRACE_TxCpltCallback+0xee>
|
|
{
|
|
#ifdef UTIL_ADV_TRACE_UNCHUNK_MODE
|
|
if(TRACE_UNCHUNK_DETECTED == ADV_TRACE_Ctx.unchunk_status)
|
|
800ea8a: 4b2c ldr r3, [pc, #176] @ (800eb3c <TRACE_TxCpltCallback+0x10c>)
|
|
800ea8c: 789b ldrb r3, [r3, #2]
|
|
800ea8e: 2b01 cmp r3, #1
|
|
800ea90: d117 bne.n 800eac2 <TRACE_TxCpltCallback+0x92>
|
|
{
|
|
ADV_TRACE_Ctx.TraceSentSize = ADV_TRACE_Ctx.unchunk_enabled - ADV_TRACE_Ctx.TraceRdPtr;
|
|
800ea92: 4b2a ldr r3, [pc, #168] @ (800eb3c <TRACE_TxCpltCallback+0x10c>)
|
|
800ea94: 881a ldrh r2, [r3, #0]
|
|
800ea96: 4b29 ldr r3, [pc, #164] @ (800eb3c <TRACE_TxCpltCallback+0x10c>)
|
|
800ea98: 8a1b ldrh r3, [r3, #16]
|
|
800ea9a: 1ad3 subs r3, r2, r3
|
|
800ea9c: b29a uxth r2, r3
|
|
800ea9e: 4b27 ldr r3, [pc, #156] @ (800eb3c <TRACE_TxCpltCallback+0x10c>)
|
|
800eaa0: 829a strh r2, [r3, #20]
|
|
ADV_TRACE_Ctx.unchunk_status = TRACE_UNCHUNK_TRANSFER;
|
|
800eaa2: 4b26 ldr r3, [pc, #152] @ (800eb3c <TRACE_TxCpltCallback+0x10c>)
|
|
800eaa4: 2202 movs r2, #2
|
|
800eaa6: 709a strb r2, [r3, #2]
|
|
ADV_TRACE_Ctx.unchunk_enabled = 0;
|
|
800eaa8: 4b24 ldr r3, [pc, #144] @ (800eb3c <TRACE_TxCpltCallback+0x10c>)
|
|
800eaaa: 2200 movs r2, #0
|
|
800eaac: 801a strh r2, [r3, #0]
|
|
|
|
UTIL_ADV_TRACE_DEBUG("\nTRACE_TxCpltCallback::unchunk start(%d,%d)\n", ADV_TRACE_Ctx.unchunk_enabled, ADV_TRACE_Ctx.TraceRdPtr);
|
|
|
|
if(0u == ADV_TRACE_Ctx.TraceSentSize)
|
|
800eaae: 4b23 ldr r3, [pc, #140] @ (800eb3c <TRACE_TxCpltCallback+0x10c>)
|
|
800eab0: 8a9b ldrh r3, [r3, #20]
|
|
800eab2: 2b00 cmp r3, #0
|
|
800eab4: d105 bne.n 800eac2 <TRACE_TxCpltCallback+0x92>
|
|
{
|
|
/* this case occurs when an ongoing write aligned the Rd position with chunk position */
|
|
/* in that case the unchunk is forgot */
|
|
ADV_TRACE_Ctx.unchunk_status = TRACE_UNCHUNK_NONE;
|
|
800eab6: 4b21 ldr r3, [pc, #132] @ (800eb3c <TRACE_TxCpltCallback+0x10c>)
|
|
800eab8: 2200 movs r2, #0
|
|
800eaba: 709a strb r2, [r3, #2]
|
|
ADV_TRACE_Ctx.TraceRdPtr = 0;
|
|
800eabc: 4b1f ldr r3, [pc, #124] @ (800eb3c <TRACE_TxCpltCallback+0x10c>)
|
|
800eabe: 2200 movs r2, #0
|
|
800eac0: 821a strh r2, [r3, #16]
|
|
}
|
|
}
|
|
|
|
if(TRACE_UNCHUNK_NONE == ADV_TRACE_Ctx.unchunk_status)
|
|
800eac2: 4b1e ldr r3, [pc, #120] @ (800eb3c <TRACE_TxCpltCallback+0x10c>)
|
|
800eac4: 789b ldrb r3, [r3, #2]
|
|
800eac6: 2b00 cmp r3, #0
|
|
800eac8: d115 bne.n 800eaf6 <TRACE_TxCpltCallback+0xc6>
|
|
{
|
|
#endif
|
|
if(ADV_TRACE_Ctx.TraceWrPtr > ADV_TRACE_Ctx.TraceRdPtr)
|
|
800eaca: 4b1c ldr r3, [pc, #112] @ (800eb3c <TRACE_TxCpltCallback+0x10c>)
|
|
800eacc: 8a5a ldrh r2, [r3, #18]
|
|
800eace: 4b1b ldr r3, [pc, #108] @ (800eb3c <TRACE_TxCpltCallback+0x10c>)
|
|
800ead0: 8a1b ldrh r3, [r3, #16]
|
|
800ead2: 429a cmp r2, r3
|
|
800ead4: d908 bls.n 800eae8 <TRACE_TxCpltCallback+0xb8>
|
|
{
|
|
ADV_TRACE_Ctx.TraceSentSize = ADV_TRACE_Ctx.TraceWrPtr - ADV_TRACE_Ctx.TraceRdPtr;
|
|
800ead6: 4b19 ldr r3, [pc, #100] @ (800eb3c <TRACE_TxCpltCallback+0x10c>)
|
|
800ead8: 8a5a ldrh r2, [r3, #18]
|
|
800eada: 4b18 ldr r3, [pc, #96] @ (800eb3c <TRACE_TxCpltCallback+0x10c>)
|
|
800eadc: 8a1b ldrh r3, [r3, #16]
|
|
800eade: 1ad3 subs r3, r2, r3
|
|
800eae0: b29a uxth r2, r3
|
|
800eae2: 4b16 ldr r3, [pc, #88] @ (800eb3c <TRACE_TxCpltCallback+0x10c>)
|
|
800eae4: 829a strh r2, [r3, #20]
|
|
800eae6: e006 b.n 800eaf6 <TRACE_TxCpltCallback+0xc6>
|
|
}
|
|
else /* TraceRdPtr > TraceWrPtr */
|
|
{
|
|
ADV_TRACE_Ctx.TraceSentSize = UTIL_ADV_TRACE_FIFO_SIZE - ADV_TRACE_Ctx.TraceRdPtr;
|
|
800eae8: 4b14 ldr r3, [pc, #80] @ (800eb3c <TRACE_TxCpltCallback+0x10c>)
|
|
800eaea: 8a1b ldrh r3, [r3, #16]
|
|
800eaec: f5c3 7300 rsb r3, r3, #512 @ 0x200
|
|
800eaf0: b29a uxth r2, r3
|
|
800eaf2: 4b12 ldr r3, [pc, #72] @ (800eb3c <TRACE_TxCpltCallback+0x10c>)
|
|
800eaf4: 829a strh r2, [r3, #20]
|
|
}
|
|
#ifdef UTIL_ADV_TRACE_UNCHUNK_MODE
|
|
}
|
|
#endif
|
|
ptr = &ADV_TRACE_Buffer[ADV_TRACE_Ctx.TraceRdPtr];
|
|
800eaf6: 4b11 ldr r3, [pc, #68] @ (800eb3c <TRACE_TxCpltCallback+0x10c>)
|
|
800eaf8: 8a1b ldrh r3, [r3, #16]
|
|
800eafa: 461a mov r2, r3
|
|
800eafc: 4b10 ldr r3, [pc, #64] @ (800eb40 <TRACE_TxCpltCallback+0x110>)
|
|
800eafe: 4413 add r3, r2
|
|
800eb00: 61fb str r3, [r7, #28]
|
|
800eb02: 69bb ldr r3, [r7, #24]
|
|
800eb04: 613b str r3, [r7, #16]
|
|
__ASM volatile ("MSR primask, %0" : : "r" (priMask) : "memory");
|
|
800eb06: 693b ldr r3, [r7, #16]
|
|
800eb08: f383 8810 msr PRIMASK, r3
|
|
}
|
|
800eb0c: bf00 nop
|
|
UTIL_ADV_TRACE_EXIT_CRITICAL_SECTION();
|
|
UTIL_ADV_TRACE_DEBUG("\n--TRACE_Send(%d-%d)--\n", ADV_TRACE_Ctx.TraceRdPtr, ADV_TRACE_Ctx.TraceSentSize);
|
|
UTIL_TraceDriver.Send(ptr, ADV_TRACE_Ctx.TraceSentSize);
|
|
800eb0e: 4b0d ldr r3, [pc, #52] @ (800eb44 <TRACE_TxCpltCallback+0x114>)
|
|
800eb10: 68db ldr r3, [r3, #12]
|
|
800eb12: 4a0a ldr r2, [pc, #40] @ (800eb3c <TRACE_TxCpltCallback+0x10c>)
|
|
800eb14: 8a92 ldrh r2, [r2, #20]
|
|
800eb16: 4611 mov r1, r2
|
|
800eb18: 69f8 ldr r0, [r7, #28]
|
|
800eb1a: 4798 blx r3
|
|
800eb1c: e00a b.n 800eb34 <TRACE_TxCpltCallback+0x104>
|
|
800eb1e: 69bb ldr r3, [r7, #24]
|
|
800eb20: 60fb str r3, [r7, #12]
|
|
__ASM volatile ("MSR primask, %0" : : "r" (priMask) : "memory");
|
|
800eb22: 68fb ldr r3, [r7, #12]
|
|
800eb24: f383 8810 msr PRIMASK, r3
|
|
}
|
|
800eb28: bf00 nop
|
|
}
|
|
else
|
|
{
|
|
UTIL_ADV_TRACE_EXIT_CRITICAL_SECTION();
|
|
UTIL_ADV_TRACE_PostSendHook();
|
|
800eb2a: f7f2 f865 bl 8000bf8 <UTIL_ADV_TRACE_PostSendHook>
|
|
TRACE_UnLock();
|
|
800eb2e: f000 f8a7 bl 800ec80 <TRACE_UnLock>
|
|
}
|
|
}
|
|
800eb32: bf00 nop
|
|
800eb34: bf00 nop
|
|
800eb36: 3720 adds r7, #32
|
|
800eb38: 46bd mov sp, r7
|
|
800eb3a: bd80 pop {r7, pc}
|
|
800eb3c: 20000c34 .word 0x20000c34
|
|
800eb40: 20000c4c .word 0x20000c4c
|
|
800eb44: 0801038c .word 0x0801038c
|
|
|
|
0800eb48 <TRACE_AllocateBufer>:
|
|
* @param Size to allocate within fifo
|
|
* @param Pos position within the fifo
|
|
* @retval write position inside the buffer is -1 no space available.
|
|
*/
|
|
static int16_t TRACE_AllocateBufer(uint16_t Size, uint16_t *Pos)
|
|
{
|
|
800eb48: b480 push {r7}
|
|
800eb4a: b087 sub sp, #28
|
|
800eb4c: af00 add r7, sp, #0
|
|
800eb4e: 4603 mov r3, r0
|
|
800eb50: 6039 str r1, [r7, #0]
|
|
800eb52: 80fb strh r3, [r7, #6]
|
|
uint16_t freesize;
|
|
int16_t ret = -1;
|
|
800eb54: f64f 73ff movw r3, #65535 @ 0xffff
|
|
800eb58: 82bb strh r3, [r7, #20]
|
|
__ASM volatile ("MRS %0, primask" : "=r" (result) :: "memory");
|
|
800eb5a: f3ef 8310 mrs r3, PRIMASK
|
|
800eb5e: 60fb str r3, [r7, #12]
|
|
return(result);
|
|
800eb60: 68fb ldr r3, [r7, #12]
|
|
|
|
UTIL_ADV_TRACE_ENTER_CRITICAL_SECTION();
|
|
800eb62: 613b str r3, [r7, #16]
|
|
__ASM volatile ("cpsid i" : : : "memory");
|
|
800eb64: b672 cpsid i
|
|
}
|
|
800eb66: bf00 nop
|
|
|
|
if(ADV_TRACE_Ctx.TraceWrPtr == ADV_TRACE_Ctx.TraceRdPtr)
|
|
800eb68: 4b35 ldr r3, [pc, #212] @ (800ec40 <TRACE_AllocateBufer+0xf8>)
|
|
800eb6a: 8a5a ldrh r2, [r3, #18]
|
|
800eb6c: 4b34 ldr r3, [pc, #208] @ (800ec40 <TRACE_AllocateBufer+0xf8>)
|
|
800eb6e: 8a1b ldrh r3, [r3, #16]
|
|
800eb70: 429a cmp r2, r3
|
|
800eb72: d11b bne.n 800ebac <TRACE_AllocateBufer+0x64>
|
|
{
|
|
#ifdef UTIL_ADV_TRACE_UNCHUNK_MODE
|
|
freesize = (uint16_t)(UTIL_ADV_TRACE_FIFO_SIZE - ADV_TRACE_Ctx.TraceWrPtr);
|
|
800eb74: 4b32 ldr r3, [pc, #200] @ (800ec40 <TRACE_AllocateBufer+0xf8>)
|
|
800eb76: 8a5b ldrh r3, [r3, #18]
|
|
800eb78: f5c3 7300 rsb r3, r3, #512 @ 0x200
|
|
800eb7c: 82fb strh r3, [r7, #22]
|
|
if((Size >= freesize) && (ADV_TRACE_Ctx.TraceRdPtr > Size))
|
|
800eb7e: 88fa ldrh r2, [r7, #6]
|
|
800eb80: 8afb ldrh r3, [r7, #22]
|
|
800eb82: 429a cmp r2, r3
|
|
800eb84: d33a bcc.n 800ebfc <TRACE_AllocateBufer+0xb4>
|
|
800eb86: 4b2e ldr r3, [pc, #184] @ (800ec40 <TRACE_AllocateBufer+0xf8>)
|
|
800eb88: 8a1b ldrh r3, [r3, #16]
|
|
800eb8a: 88fa ldrh r2, [r7, #6]
|
|
800eb8c: 429a cmp r2, r3
|
|
800eb8e: d235 bcs.n 800ebfc <TRACE_AllocateBufer+0xb4>
|
|
{
|
|
ADV_TRACE_Ctx.unchunk_status = TRACE_UNCHUNK_DETECTED;
|
|
800eb90: 4b2b ldr r3, [pc, #172] @ (800ec40 <TRACE_AllocateBufer+0xf8>)
|
|
800eb92: 2201 movs r2, #1
|
|
800eb94: 709a strb r2, [r3, #2]
|
|
ADV_TRACE_Ctx.unchunk_enabled = ADV_TRACE_Ctx.TraceWrPtr;
|
|
800eb96: 4b2a ldr r3, [pc, #168] @ (800ec40 <TRACE_AllocateBufer+0xf8>)
|
|
800eb98: 8a5a ldrh r2, [r3, #18]
|
|
800eb9a: 4b29 ldr r3, [pc, #164] @ (800ec40 <TRACE_AllocateBufer+0xf8>)
|
|
800eb9c: 801a strh r2, [r3, #0]
|
|
freesize = ADV_TRACE_Ctx.TraceRdPtr;
|
|
800eb9e: 4b28 ldr r3, [pc, #160] @ (800ec40 <TRACE_AllocateBufer+0xf8>)
|
|
800eba0: 8a1b ldrh r3, [r3, #16]
|
|
800eba2: 82fb strh r3, [r7, #22]
|
|
ADV_TRACE_Ctx.TraceWrPtr = 0;
|
|
800eba4: 4b26 ldr r3, [pc, #152] @ (800ec40 <TRACE_AllocateBufer+0xf8>)
|
|
800eba6: 2200 movs r2, #0
|
|
800eba8: 825a strh r2, [r3, #18]
|
|
800ebaa: e027 b.n 800ebfc <TRACE_AllocateBufer+0xb4>
|
|
#endif
|
|
}
|
|
else
|
|
{
|
|
#ifdef UTIL_ADV_TRACE_UNCHUNK_MODE
|
|
if (ADV_TRACE_Ctx.TraceWrPtr > ADV_TRACE_Ctx.TraceRdPtr)
|
|
800ebac: 4b24 ldr r3, [pc, #144] @ (800ec40 <TRACE_AllocateBufer+0xf8>)
|
|
800ebae: 8a5a ldrh r2, [r3, #18]
|
|
800ebb0: 4b23 ldr r3, [pc, #140] @ (800ec40 <TRACE_AllocateBufer+0xf8>)
|
|
800ebb2: 8a1b ldrh r3, [r3, #16]
|
|
800ebb4: 429a cmp r2, r3
|
|
800ebb6: d91b bls.n 800ebf0 <TRACE_AllocateBufer+0xa8>
|
|
{
|
|
freesize = (uint16_t)(UTIL_ADV_TRACE_FIFO_SIZE - ADV_TRACE_Ctx.TraceWrPtr);
|
|
800ebb8: 4b21 ldr r3, [pc, #132] @ (800ec40 <TRACE_AllocateBufer+0xf8>)
|
|
800ebba: 8a5b ldrh r3, [r3, #18]
|
|
800ebbc: f5c3 7300 rsb r3, r3, #512 @ 0x200
|
|
800ebc0: 82fb strh r3, [r7, #22]
|
|
if((Size >= freesize) && (ADV_TRACE_Ctx.TraceRdPtr > Size))
|
|
800ebc2: 88fa ldrh r2, [r7, #6]
|
|
800ebc4: 8afb ldrh r3, [r7, #22]
|
|
800ebc6: 429a cmp r2, r3
|
|
800ebc8: d318 bcc.n 800ebfc <TRACE_AllocateBufer+0xb4>
|
|
800ebca: 4b1d ldr r3, [pc, #116] @ (800ec40 <TRACE_AllocateBufer+0xf8>)
|
|
800ebcc: 8a1b ldrh r3, [r3, #16]
|
|
800ebce: 88fa ldrh r2, [r7, #6]
|
|
800ebd0: 429a cmp r2, r3
|
|
800ebd2: d213 bcs.n 800ebfc <TRACE_AllocateBufer+0xb4>
|
|
{
|
|
ADV_TRACE_Ctx.unchunk_status = TRACE_UNCHUNK_DETECTED;
|
|
800ebd4: 4b1a ldr r3, [pc, #104] @ (800ec40 <TRACE_AllocateBufer+0xf8>)
|
|
800ebd6: 2201 movs r2, #1
|
|
800ebd8: 709a strb r2, [r3, #2]
|
|
ADV_TRACE_Ctx.unchunk_enabled = ADV_TRACE_Ctx.TraceWrPtr;
|
|
800ebda: 4b19 ldr r3, [pc, #100] @ (800ec40 <TRACE_AllocateBufer+0xf8>)
|
|
800ebdc: 8a5a ldrh r2, [r3, #18]
|
|
800ebde: 4b18 ldr r3, [pc, #96] @ (800ec40 <TRACE_AllocateBufer+0xf8>)
|
|
800ebe0: 801a strh r2, [r3, #0]
|
|
freesize = ADV_TRACE_Ctx.TraceRdPtr;
|
|
800ebe2: 4b17 ldr r3, [pc, #92] @ (800ec40 <TRACE_AllocateBufer+0xf8>)
|
|
800ebe4: 8a1b ldrh r3, [r3, #16]
|
|
800ebe6: 82fb strh r3, [r7, #22]
|
|
ADV_TRACE_Ctx.TraceWrPtr = 0;
|
|
800ebe8: 4b15 ldr r3, [pc, #84] @ (800ec40 <TRACE_AllocateBufer+0xf8>)
|
|
800ebea: 2200 movs r2, #0
|
|
800ebec: 825a strh r2, [r3, #18]
|
|
800ebee: e005 b.n 800ebfc <TRACE_AllocateBufer+0xb4>
|
|
}
|
|
}
|
|
else
|
|
{
|
|
freesize = (uint16_t)(ADV_TRACE_Ctx.TraceRdPtr - ADV_TRACE_Ctx.TraceWrPtr);
|
|
800ebf0: 4b13 ldr r3, [pc, #76] @ (800ec40 <TRACE_AllocateBufer+0xf8>)
|
|
800ebf2: 8a1a ldrh r2, [r3, #16]
|
|
800ebf4: 4b12 ldr r3, [pc, #72] @ (800ec40 <TRACE_AllocateBufer+0xf8>)
|
|
800ebf6: 8a5b ldrh r3, [r3, #18]
|
|
800ebf8: 1ad3 subs r3, r2, r3
|
|
800ebfa: 82fb strh r3, [r7, #22]
|
|
freesize = ADV_TRACE_Ctx.TraceRdPtr - ADV_TRACE_Ctx.TraceWrPtr;
|
|
}
|
|
#endif
|
|
}
|
|
|
|
if(freesize > Size)
|
|
800ebfc: 8afa ldrh r2, [r7, #22]
|
|
800ebfe: 88fb ldrh r3, [r7, #6]
|
|
800ec00: 429a cmp r2, r3
|
|
800ec02: d90f bls.n 800ec24 <TRACE_AllocateBufer+0xdc>
|
|
{
|
|
*Pos = ADV_TRACE_Ctx.TraceWrPtr;
|
|
800ec04: 4b0e ldr r3, [pc, #56] @ (800ec40 <TRACE_AllocateBufer+0xf8>)
|
|
800ec06: 8a5a ldrh r2, [r3, #18]
|
|
800ec08: 683b ldr r3, [r7, #0]
|
|
800ec0a: 801a strh r2, [r3, #0]
|
|
ADV_TRACE_Ctx.TraceWrPtr = (ADV_TRACE_Ctx.TraceWrPtr + Size) % UTIL_ADV_TRACE_FIFO_SIZE;
|
|
800ec0c: 4b0c ldr r3, [pc, #48] @ (800ec40 <TRACE_AllocateBufer+0xf8>)
|
|
800ec0e: 8a5a ldrh r2, [r3, #18]
|
|
800ec10: 88fb ldrh r3, [r7, #6]
|
|
800ec12: 4413 add r3, r2
|
|
800ec14: b29b uxth r3, r3
|
|
800ec16: f3c3 0308 ubfx r3, r3, #0, #9
|
|
800ec1a: b29a uxth r2, r3
|
|
800ec1c: 4b08 ldr r3, [pc, #32] @ (800ec40 <TRACE_AllocateBufer+0xf8>)
|
|
800ec1e: 825a strh r2, [r3, #18]
|
|
ret = 0;
|
|
800ec20: 2300 movs r3, #0
|
|
800ec22: 82bb strh r3, [r7, #20]
|
|
800ec24: 693b ldr r3, [r7, #16]
|
|
800ec26: 60bb str r3, [r7, #8]
|
|
__ASM volatile ("MSR primask, %0" : : "r" (priMask) : "memory");
|
|
800ec28: 68bb ldr r3, [r7, #8]
|
|
800ec2a: f383 8810 msr PRIMASK, r3
|
|
}
|
|
800ec2e: bf00 nop
|
|
}
|
|
}
|
|
#endif
|
|
|
|
UTIL_ADV_TRACE_EXIT_CRITICAL_SECTION();
|
|
return ret;
|
|
800ec30: f9b7 3014 ldrsh.w r3, [r7, #20]
|
|
}
|
|
800ec34: 4618 mov r0, r3
|
|
800ec36: 371c adds r7, #28
|
|
800ec38: 46bd mov sp, r7
|
|
800ec3a: bc80 pop {r7}
|
|
800ec3c: 4770 bx lr
|
|
800ec3e: bf00 nop
|
|
800ec40: 20000c34 .word 0x20000c34
|
|
|
|
0800ec44 <TRACE_Lock>:
|
|
/**
|
|
* @brief Lock the trace buffer.
|
|
* @retval None.
|
|
*/
|
|
static void TRACE_Lock(void)
|
|
{
|
|
800ec44: b480 push {r7}
|
|
800ec46: b085 sub sp, #20
|
|
800ec48: af00 add r7, sp, #0
|
|
__ASM volatile ("MRS %0, primask" : "=r" (result) :: "memory");
|
|
800ec4a: f3ef 8310 mrs r3, PRIMASK
|
|
800ec4e: 607b str r3, [r7, #4]
|
|
return(result);
|
|
800ec50: 687b ldr r3, [r7, #4]
|
|
UTIL_ADV_TRACE_ENTER_CRITICAL_SECTION();
|
|
800ec52: 60fb str r3, [r7, #12]
|
|
__ASM volatile ("cpsid i" : : : "memory");
|
|
800ec54: b672 cpsid i
|
|
}
|
|
800ec56: bf00 nop
|
|
ADV_TRACE_Ctx.TraceLock++;
|
|
800ec58: 4b08 ldr r3, [pc, #32] @ (800ec7c <TRACE_Lock+0x38>)
|
|
800ec5a: 8adb ldrh r3, [r3, #22]
|
|
800ec5c: 3301 adds r3, #1
|
|
800ec5e: b29a uxth r2, r3
|
|
800ec60: 4b06 ldr r3, [pc, #24] @ (800ec7c <TRACE_Lock+0x38>)
|
|
800ec62: 82da strh r2, [r3, #22]
|
|
800ec64: 68fb ldr r3, [r7, #12]
|
|
800ec66: 60bb str r3, [r7, #8]
|
|
__ASM volatile ("MSR primask, %0" : : "r" (priMask) : "memory");
|
|
800ec68: 68bb ldr r3, [r7, #8]
|
|
800ec6a: f383 8810 msr PRIMASK, r3
|
|
}
|
|
800ec6e: bf00 nop
|
|
UTIL_ADV_TRACE_EXIT_CRITICAL_SECTION();
|
|
}
|
|
800ec70: bf00 nop
|
|
800ec72: 3714 adds r7, #20
|
|
800ec74: 46bd mov sp, r7
|
|
800ec76: bc80 pop {r7}
|
|
800ec78: 4770 bx lr
|
|
800ec7a: bf00 nop
|
|
800ec7c: 20000c34 .word 0x20000c34
|
|
|
|
0800ec80 <TRACE_UnLock>:
|
|
/**
|
|
* @brief UnLock the trace buffer.
|
|
* @retval None.
|
|
*/
|
|
static void TRACE_UnLock(void)
|
|
{
|
|
800ec80: b480 push {r7}
|
|
800ec82: b085 sub sp, #20
|
|
800ec84: af00 add r7, sp, #0
|
|
__ASM volatile ("MRS %0, primask" : "=r" (result) :: "memory");
|
|
800ec86: f3ef 8310 mrs r3, PRIMASK
|
|
800ec8a: 607b str r3, [r7, #4]
|
|
return(result);
|
|
800ec8c: 687b ldr r3, [r7, #4]
|
|
UTIL_ADV_TRACE_ENTER_CRITICAL_SECTION();
|
|
800ec8e: 60fb str r3, [r7, #12]
|
|
__ASM volatile ("cpsid i" : : : "memory");
|
|
800ec90: b672 cpsid i
|
|
}
|
|
800ec92: bf00 nop
|
|
ADV_TRACE_Ctx.TraceLock--;
|
|
800ec94: 4b08 ldr r3, [pc, #32] @ (800ecb8 <TRACE_UnLock+0x38>)
|
|
800ec96: 8adb ldrh r3, [r3, #22]
|
|
800ec98: 3b01 subs r3, #1
|
|
800ec9a: b29a uxth r2, r3
|
|
800ec9c: 4b06 ldr r3, [pc, #24] @ (800ecb8 <TRACE_UnLock+0x38>)
|
|
800ec9e: 82da strh r2, [r3, #22]
|
|
800eca0: 68fb ldr r3, [r7, #12]
|
|
800eca2: 60bb str r3, [r7, #8]
|
|
__ASM volatile ("MSR primask, %0" : : "r" (priMask) : "memory");
|
|
800eca4: 68bb ldr r3, [r7, #8]
|
|
800eca6: f383 8810 msr PRIMASK, r3
|
|
}
|
|
800ecaa: bf00 nop
|
|
UTIL_ADV_TRACE_EXIT_CRITICAL_SECTION();
|
|
}
|
|
800ecac: bf00 nop
|
|
800ecae: 3714 adds r7, #20
|
|
800ecb0: 46bd mov sp, r7
|
|
800ecb2: bc80 pop {r7}
|
|
800ecb4: 4770 bx lr
|
|
800ecb6: bf00 nop
|
|
800ecb8: 20000c34 .word 0x20000c34
|
|
|
|
0800ecbc <TRACE_IsLocked>:
|
|
/**
|
|
* @brief UnLock the trace buffer.
|
|
* @retval None.
|
|
*/
|
|
static uint32_t TRACE_IsLocked(void)
|
|
{
|
|
800ecbc: b480 push {r7}
|
|
800ecbe: af00 add r7, sp, #0
|
|
return (ADV_TRACE_Ctx.TraceLock == 0u? 0u: 1u);
|
|
800ecc0: 4b05 ldr r3, [pc, #20] @ (800ecd8 <TRACE_IsLocked+0x1c>)
|
|
800ecc2: 8adb ldrh r3, [r3, #22]
|
|
800ecc4: 2b00 cmp r3, #0
|
|
800ecc6: bf14 ite ne
|
|
800ecc8: 2301 movne r3, #1
|
|
800ecca: 2300 moveq r3, #0
|
|
800eccc: b2db uxtb r3, r3
|
|
}
|
|
800ecce: 4618 mov r0, r3
|
|
800ecd0: 46bd mov sp, r7
|
|
800ecd2: bc80 pop {r7}
|
|
800ecd4: 4770 bx lr
|
|
800ecd6: bf00 nop
|
|
800ecd8: 20000c34 .word 0x20000c34
|
|
|
|
0800ecdc <_strtol_l.isra.0>:
|
|
800ecdc: 2b24 cmp r3, #36 @ 0x24
|
|
800ecde: e92d 47f0 stmdb sp!, {r4, r5, r6, r7, r8, r9, sl, lr}
|
|
800ece2: 4686 mov lr, r0
|
|
800ece4: 4690 mov r8, r2
|
|
800ece6: d801 bhi.n 800ecec <_strtol_l.isra.0+0x10>
|
|
800ece8: 2b01 cmp r3, #1
|
|
800ecea: d106 bne.n 800ecfa <_strtol_l.isra.0+0x1e>
|
|
800ecec: f000 f948 bl 800ef80 <__errno>
|
|
800ecf0: 2316 movs r3, #22
|
|
800ecf2: 6003 str r3, [r0, #0]
|
|
800ecf4: 2000 movs r0, #0
|
|
800ecf6: e8bd 87f0 ldmia.w sp!, {r4, r5, r6, r7, r8, r9, sl, pc}
|
|
800ecfa: 4834 ldr r0, [pc, #208] @ (800edcc <_strtol_l.isra.0+0xf0>)
|
|
800ecfc: 460d mov r5, r1
|
|
800ecfe: 462a mov r2, r5
|
|
800ed00: f815 4b01 ldrb.w r4, [r5], #1
|
|
800ed04: 5d06 ldrb r6, [r0, r4]
|
|
800ed06: f016 0608 ands.w r6, r6, #8
|
|
800ed0a: d1f8 bne.n 800ecfe <_strtol_l.isra.0+0x22>
|
|
800ed0c: 2c2d cmp r4, #45 @ 0x2d
|
|
800ed0e: d110 bne.n 800ed32 <_strtol_l.isra.0+0x56>
|
|
800ed10: 782c ldrb r4, [r5, #0]
|
|
800ed12: 2601 movs r6, #1
|
|
800ed14: 1c95 adds r5, r2, #2
|
|
800ed16: f033 0210 bics.w r2, r3, #16
|
|
800ed1a: d115 bne.n 800ed48 <_strtol_l.isra.0+0x6c>
|
|
800ed1c: 2c30 cmp r4, #48 @ 0x30
|
|
800ed1e: d10d bne.n 800ed3c <_strtol_l.isra.0+0x60>
|
|
800ed20: 782a ldrb r2, [r5, #0]
|
|
800ed22: f002 02df and.w r2, r2, #223 @ 0xdf
|
|
800ed26: 2a58 cmp r2, #88 @ 0x58
|
|
800ed28: d108 bne.n 800ed3c <_strtol_l.isra.0+0x60>
|
|
800ed2a: 786c ldrb r4, [r5, #1]
|
|
800ed2c: 3502 adds r5, #2
|
|
800ed2e: 2310 movs r3, #16
|
|
800ed30: e00a b.n 800ed48 <_strtol_l.isra.0+0x6c>
|
|
800ed32: 2c2b cmp r4, #43 @ 0x2b
|
|
800ed34: bf04 itt eq
|
|
800ed36: 782c ldrbeq r4, [r5, #0]
|
|
800ed38: 1c95 addeq r5, r2, #2
|
|
800ed3a: e7ec b.n 800ed16 <_strtol_l.isra.0+0x3a>
|
|
800ed3c: 2b00 cmp r3, #0
|
|
800ed3e: d1f6 bne.n 800ed2e <_strtol_l.isra.0+0x52>
|
|
800ed40: 2c30 cmp r4, #48 @ 0x30
|
|
800ed42: bf14 ite ne
|
|
800ed44: 230a movne r3, #10
|
|
800ed46: 2308 moveq r3, #8
|
|
800ed48: f106 4c00 add.w ip, r6, #2147483648 @ 0x80000000
|
|
800ed4c: f10c 3cff add.w ip, ip, #4294967295 @ 0xffffffff
|
|
800ed50: 2200 movs r2, #0
|
|
800ed52: fbbc f9f3 udiv r9, ip, r3
|
|
800ed56: 4610 mov r0, r2
|
|
800ed58: fb03 ca19 mls sl, r3, r9, ip
|
|
800ed5c: f1a4 0730 sub.w r7, r4, #48 @ 0x30
|
|
800ed60: 2f09 cmp r7, #9
|
|
800ed62: d80f bhi.n 800ed84 <_strtol_l.isra.0+0xa8>
|
|
800ed64: 463c mov r4, r7
|
|
800ed66: 42a3 cmp r3, r4
|
|
800ed68: dd1b ble.n 800eda2 <_strtol_l.isra.0+0xc6>
|
|
800ed6a: 1c57 adds r7, r2, #1
|
|
800ed6c: d007 beq.n 800ed7e <_strtol_l.isra.0+0xa2>
|
|
800ed6e: 4581 cmp r9, r0
|
|
800ed70: d314 bcc.n 800ed9c <_strtol_l.isra.0+0xc0>
|
|
800ed72: d101 bne.n 800ed78 <_strtol_l.isra.0+0x9c>
|
|
800ed74: 45a2 cmp sl, r4
|
|
800ed76: db11 blt.n 800ed9c <_strtol_l.isra.0+0xc0>
|
|
800ed78: fb00 4003 mla r0, r0, r3, r4
|
|
800ed7c: 2201 movs r2, #1
|
|
800ed7e: f815 4b01 ldrb.w r4, [r5], #1
|
|
800ed82: e7eb b.n 800ed5c <_strtol_l.isra.0+0x80>
|
|
800ed84: f1a4 0741 sub.w r7, r4, #65 @ 0x41
|
|
800ed88: 2f19 cmp r7, #25
|
|
800ed8a: d801 bhi.n 800ed90 <_strtol_l.isra.0+0xb4>
|
|
800ed8c: 3c37 subs r4, #55 @ 0x37
|
|
800ed8e: e7ea b.n 800ed66 <_strtol_l.isra.0+0x8a>
|
|
800ed90: f1a4 0761 sub.w r7, r4, #97 @ 0x61
|
|
800ed94: 2f19 cmp r7, #25
|
|
800ed96: d804 bhi.n 800eda2 <_strtol_l.isra.0+0xc6>
|
|
800ed98: 3c57 subs r4, #87 @ 0x57
|
|
800ed9a: e7e4 b.n 800ed66 <_strtol_l.isra.0+0x8a>
|
|
800ed9c: f04f 32ff mov.w r2, #4294967295 @ 0xffffffff
|
|
800eda0: e7ed b.n 800ed7e <_strtol_l.isra.0+0xa2>
|
|
800eda2: 1c53 adds r3, r2, #1
|
|
800eda4: d108 bne.n 800edb8 <_strtol_l.isra.0+0xdc>
|
|
800eda6: 2322 movs r3, #34 @ 0x22
|
|
800eda8: f8ce 3000 str.w r3, [lr]
|
|
800edac: 4660 mov r0, ip
|
|
800edae: f1b8 0f00 cmp.w r8, #0
|
|
800edb2: d0a0 beq.n 800ecf6 <_strtol_l.isra.0+0x1a>
|
|
800edb4: 1e69 subs r1, r5, #1
|
|
800edb6: e006 b.n 800edc6 <_strtol_l.isra.0+0xea>
|
|
800edb8: b106 cbz r6, 800edbc <_strtol_l.isra.0+0xe0>
|
|
800edba: 4240 negs r0, r0
|
|
800edbc: f1b8 0f00 cmp.w r8, #0
|
|
800edc0: d099 beq.n 800ecf6 <_strtol_l.isra.0+0x1a>
|
|
800edc2: 2a00 cmp r2, #0
|
|
800edc4: d1f6 bne.n 800edb4 <_strtol_l.isra.0+0xd8>
|
|
800edc6: f8c8 1000 str.w r1, [r8]
|
|
800edca: e794 b.n 800ecf6 <_strtol_l.isra.0+0x1a>
|
|
800edcc: 08010519 .word 0x08010519
|
|
|
|
0800edd0 <strtol>:
|
|
800edd0: 4613 mov r3, r2
|
|
800edd2: 460a mov r2, r1
|
|
800edd4: 4601 mov r1, r0
|
|
800edd6: 4802 ldr r0, [pc, #8] @ (800ede0 <strtol+0x10>)
|
|
800edd8: 6800 ldr r0, [r0, #0]
|
|
800edda: f7ff bf7f b.w 800ecdc <_strtol_l.isra.0>
|
|
800edde: bf00 nop
|
|
800ede0: 2000001c .word 0x2000001c
|
|
|
|
0800ede4 <_strtoul_l.isra.0>:
|
|
800ede4: e92d 43f0 stmdb sp!, {r4, r5, r6, r7, r8, r9, lr}
|
|
800ede8: 4e34 ldr r6, [pc, #208] @ (800eebc <_strtoul_l.isra.0+0xd8>)
|
|
800edea: 4686 mov lr, r0
|
|
800edec: 460d mov r5, r1
|
|
800edee: 4628 mov r0, r5
|
|
800edf0: f815 4b01 ldrb.w r4, [r5], #1
|
|
800edf4: 5d37 ldrb r7, [r6, r4]
|
|
800edf6: f017 0708 ands.w r7, r7, #8
|
|
800edfa: d1f8 bne.n 800edee <_strtoul_l.isra.0+0xa>
|
|
800edfc: 2c2d cmp r4, #45 @ 0x2d
|
|
800edfe: d110 bne.n 800ee22 <_strtoul_l.isra.0+0x3e>
|
|
800ee00: 782c ldrb r4, [r5, #0]
|
|
800ee02: 2701 movs r7, #1
|
|
800ee04: 1c85 adds r5, r0, #2
|
|
800ee06: f033 0010 bics.w r0, r3, #16
|
|
800ee0a: d115 bne.n 800ee38 <_strtoul_l.isra.0+0x54>
|
|
800ee0c: 2c30 cmp r4, #48 @ 0x30
|
|
800ee0e: d10d bne.n 800ee2c <_strtoul_l.isra.0+0x48>
|
|
800ee10: 7828 ldrb r0, [r5, #0]
|
|
800ee12: f000 00df and.w r0, r0, #223 @ 0xdf
|
|
800ee16: 2858 cmp r0, #88 @ 0x58
|
|
800ee18: d108 bne.n 800ee2c <_strtoul_l.isra.0+0x48>
|
|
800ee1a: 786c ldrb r4, [r5, #1]
|
|
800ee1c: 3502 adds r5, #2
|
|
800ee1e: 2310 movs r3, #16
|
|
800ee20: e00a b.n 800ee38 <_strtoul_l.isra.0+0x54>
|
|
800ee22: 2c2b cmp r4, #43 @ 0x2b
|
|
800ee24: bf04 itt eq
|
|
800ee26: 782c ldrbeq r4, [r5, #0]
|
|
800ee28: 1c85 addeq r5, r0, #2
|
|
800ee2a: e7ec b.n 800ee06 <_strtoul_l.isra.0+0x22>
|
|
800ee2c: 2b00 cmp r3, #0
|
|
800ee2e: d1f6 bne.n 800ee1e <_strtoul_l.isra.0+0x3a>
|
|
800ee30: 2c30 cmp r4, #48 @ 0x30
|
|
800ee32: bf14 ite ne
|
|
800ee34: 230a movne r3, #10
|
|
800ee36: 2308 moveq r3, #8
|
|
800ee38: f04f 38ff mov.w r8, #4294967295 @ 0xffffffff
|
|
800ee3c: 2600 movs r6, #0
|
|
800ee3e: fbb8 f8f3 udiv r8, r8, r3
|
|
800ee42: fb03 f908 mul.w r9, r3, r8
|
|
800ee46: ea6f 0909 mvn.w r9, r9
|
|
800ee4a: 4630 mov r0, r6
|
|
800ee4c: f1a4 0c30 sub.w ip, r4, #48 @ 0x30
|
|
800ee50: f1bc 0f09 cmp.w ip, #9
|
|
800ee54: d810 bhi.n 800ee78 <_strtoul_l.isra.0+0x94>
|
|
800ee56: 4664 mov r4, ip
|
|
800ee58: 42a3 cmp r3, r4
|
|
800ee5a: dd1e ble.n 800ee9a <_strtoul_l.isra.0+0xb6>
|
|
800ee5c: f1b6 3fff cmp.w r6, #4294967295 @ 0xffffffff
|
|
800ee60: d007 beq.n 800ee72 <_strtoul_l.isra.0+0x8e>
|
|
800ee62: 4580 cmp r8, r0
|
|
800ee64: d316 bcc.n 800ee94 <_strtoul_l.isra.0+0xb0>
|
|
800ee66: d101 bne.n 800ee6c <_strtoul_l.isra.0+0x88>
|
|
800ee68: 45a1 cmp r9, r4
|
|
800ee6a: db13 blt.n 800ee94 <_strtoul_l.isra.0+0xb0>
|
|
800ee6c: fb00 4003 mla r0, r0, r3, r4
|
|
800ee70: 2601 movs r6, #1
|
|
800ee72: f815 4b01 ldrb.w r4, [r5], #1
|
|
800ee76: e7e9 b.n 800ee4c <_strtoul_l.isra.0+0x68>
|
|
800ee78: f1a4 0c41 sub.w ip, r4, #65 @ 0x41
|
|
800ee7c: f1bc 0f19 cmp.w ip, #25
|
|
800ee80: d801 bhi.n 800ee86 <_strtoul_l.isra.0+0xa2>
|
|
800ee82: 3c37 subs r4, #55 @ 0x37
|
|
800ee84: e7e8 b.n 800ee58 <_strtoul_l.isra.0+0x74>
|
|
800ee86: f1a4 0c61 sub.w ip, r4, #97 @ 0x61
|
|
800ee8a: f1bc 0f19 cmp.w ip, #25
|
|
800ee8e: d804 bhi.n 800ee9a <_strtoul_l.isra.0+0xb6>
|
|
800ee90: 3c57 subs r4, #87 @ 0x57
|
|
800ee92: e7e1 b.n 800ee58 <_strtoul_l.isra.0+0x74>
|
|
800ee94: f04f 36ff mov.w r6, #4294967295 @ 0xffffffff
|
|
800ee98: e7eb b.n 800ee72 <_strtoul_l.isra.0+0x8e>
|
|
800ee9a: 1c73 adds r3, r6, #1
|
|
800ee9c: d106 bne.n 800eeac <_strtoul_l.isra.0+0xc8>
|
|
800ee9e: 2322 movs r3, #34 @ 0x22
|
|
800eea0: f8ce 3000 str.w r3, [lr]
|
|
800eea4: 4630 mov r0, r6
|
|
800eea6: b932 cbnz r2, 800eeb6 <_strtoul_l.isra.0+0xd2>
|
|
800eea8: e8bd 83f0 ldmia.w sp!, {r4, r5, r6, r7, r8, r9, pc}
|
|
800eeac: b107 cbz r7, 800eeb0 <_strtoul_l.isra.0+0xcc>
|
|
800eeae: 4240 negs r0, r0
|
|
800eeb0: 2a00 cmp r2, #0
|
|
800eeb2: d0f9 beq.n 800eea8 <_strtoul_l.isra.0+0xc4>
|
|
800eeb4: b106 cbz r6, 800eeb8 <_strtoul_l.isra.0+0xd4>
|
|
800eeb6: 1e69 subs r1, r5, #1
|
|
800eeb8: 6011 str r1, [r2, #0]
|
|
800eeba: e7f5 b.n 800eea8 <_strtoul_l.isra.0+0xc4>
|
|
800eebc: 08010519 .word 0x08010519
|
|
|
|
0800eec0 <strtoul>:
|
|
800eec0: 4613 mov r3, r2
|
|
800eec2: 460a mov r2, r1
|
|
800eec4: 4601 mov r1, r0
|
|
800eec6: 4802 ldr r0, [pc, #8] @ (800eed0 <strtoul+0x10>)
|
|
800eec8: 6800 ldr r0, [r0, #0]
|
|
800eeca: f7ff bf8b b.w 800ede4 <_strtoul_l.isra.0>
|
|
800eece: bf00 nop
|
|
800eed0: 2000001c .word 0x2000001c
|
|
|
|
0800eed4 <_vsniprintf_r>:
|
|
800eed4: b530 push {r4, r5, lr}
|
|
800eed6: 4614 mov r4, r2
|
|
800eed8: 2c00 cmp r4, #0
|
|
800eeda: b09b sub sp, #108 @ 0x6c
|
|
800eedc: 4605 mov r5, r0
|
|
800eede: 461a mov r2, r3
|
|
800eee0: da05 bge.n 800eeee <_vsniprintf_r+0x1a>
|
|
800eee2: 238b movs r3, #139 @ 0x8b
|
|
800eee4: 6003 str r3, [r0, #0]
|
|
800eee6: f04f 30ff mov.w r0, #4294967295 @ 0xffffffff
|
|
800eeea: b01b add sp, #108 @ 0x6c
|
|
800eeec: bd30 pop {r4, r5, pc}
|
|
800eeee: f44f 7302 mov.w r3, #520 @ 0x208
|
|
800eef2: f8ad 300c strh.w r3, [sp, #12]
|
|
800eef6: f04f 0300 mov.w r3, #0
|
|
800eefa: 9319 str r3, [sp, #100] @ 0x64
|
|
800eefc: bf14 ite ne
|
|
800eefe: f104 33ff addne.w r3, r4, #4294967295 @ 0xffffffff
|
|
800ef02: 4623 moveq r3, r4
|
|
800ef04: 9302 str r3, [sp, #8]
|
|
800ef06: 9305 str r3, [sp, #20]
|
|
800ef08: f64f 73ff movw r3, #65535 @ 0xffff
|
|
800ef0c: 9100 str r1, [sp, #0]
|
|
800ef0e: 9104 str r1, [sp, #16]
|
|
800ef10: f8ad 300e strh.w r3, [sp, #14]
|
|
800ef14: 4669 mov r1, sp
|
|
800ef16: 9b1e ldr r3, [sp, #120] @ 0x78
|
|
800ef18: f000 f9c0 bl 800f29c <_svfiprintf_r>
|
|
800ef1c: 1c43 adds r3, r0, #1
|
|
800ef1e: bfbc itt lt
|
|
800ef20: 238b movlt r3, #139 @ 0x8b
|
|
800ef22: 602b strlt r3, [r5, #0]
|
|
800ef24: 2c00 cmp r4, #0
|
|
800ef26: d0e0 beq.n 800eeea <_vsniprintf_r+0x16>
|
|
800ef28: 9b00 ldr r3, [sp, #0]
|
|
800ef2a: 2200 movs r2, #0
|
|
800ef2c: 701a strb r2, [r3, #0]
|
|
800ef2e: e7dc b.n 800eeea <_vsniprintf_r+0x16>
|
|
|
|
0800ef30 <vsniprintf>:
|
|
800ef30: b507 push {r0, r1, r2, lr}
|
|
800ef32: 9300 str r3, [sp, #0]
|
|
800ef34: 4613 mov r3, r2
|
|
800ef36: 460a mov r2, r1
|
|
800ef38: 4601 mov r1, r0
|
|
800ef3a: 4803 ldr r0, [pc, #12] @ (800ef48 <vsniprintf+0x18>)
|
|
800ef3c: 6800 ldr r0, [r0, #0]
|
|
800ef3e: f7ff ffc9 bl 800eed4 <_vsniprintf_r>
|
|
800ef42: b003 add sp, #12
|
|
800ef44: f85d fb04 ldr.w pc, [sp], #4
|
|
800ef48: 2000001c .word 0x2000001c
|
|
|
|
0800ef4c <memset>:
|
|
800ef4c: 4402 add r2, r0
|
|
800ef4e: 4603 mov r3, r0
|
|
800ef50: 4293 cmp r3, r2
|
|
800ef52: d100 bne.n 800ef56 <memset+0xa>
|
|
800ef54: 4770 bx lr
|
|
800ef56: f803 1b01 strb.w r1, [r3], #1
|
|
800ef5a: e7f9 b.n 800ef50 <memset+0x4>
|
|
|
|
0800ef5c <strncmp>:
|
|
800ef5c: b510 push {r4, lr}
|
|
800ef5e: b16a cbz r2, 800ef7c <strncmp+0x20>
|
|
800ef60: 3901 subs r1, #1
|
|
800ef62: 1884 adds r4, r0, r2
|
|
800ef64: f810 2b01 ldrb.w r2, [r0], #1
|
|
800ef68: f811 3f01 ldrb.w r3, [r1, #1]!
|
|
800ef6c: 429a cmp r2, r3
|
|
800ef6e: d103 bne.n 800ef78 <strncmp+0x1c>
|
|
800ef70: 42a0 cmp r0, r4
|
|
800ef72: d001 beq.n 800ef78 <strncmp+0x1c>
|
|
800ef74: 2a00 cmp r2, #0
|
|
800ef76: d1f5 bne.n 800ef64 <strncmp+0x8>
|
|
800ef78: 1ad0 subs r0, r2, r3
|
|
800ef7a: bd10 pop {r4, pc}
|
|
800ef7c: 4610 mov r0, r2
|
|
800ef7e: e7fc b.n 800ef7a <strncmp+0x1e>
|
|
|
|
0800ef80 <__errno>:
|
|
800ef80: 4b01 ldr r3, [pc, #4] @ (800ef88 <__errno+0x8>)
|
|
800ef82: 6818 ldr r0, [r3, #0]
|
|
800ef84: 4770 bx lr
|
|
800ef86: bf00 nop
|
|
800ef88: 2000001c .word 0x2000001c
|
|
|
|
0800ef8c <__libc_init_array>:
|
|
800ef8c: b570 push {r4, r5, r6, lr}
|
|
800ef8e: 4d0d ldr r5, [pc, #52] @ (800efc4 <__libc_init_array+0x38>)
|
|
800ef90: 4c0d ldr r4, [pc, #52] @ (800efc8 <__libc_init_array+0x3c>)
|
|
800ef92: 1b64 subs r4, r4, r5
|
|
800ef94: 10a4 asrs r4, r4, #2
|
|
800ef96: 2600 movs r6, #0
|
|
800ef98: 42a6 cmp r6, r4
|
|
800ef9a: d109 bne.n 800efb0 <__libc_init_array+0x24>
|
|
800ef9c: 4d0b ldr r5, [pc, #44] @ (800efcc <__libc_init_array+0x40>)
|
|
800ef9e: 4c0c ldr r4, [pc, #48] @ (800efd0 <__libc_init_array+0x44>)
|
|
800efa0: f000 fc64 bl 800f86c <_init>
|
|
800efa4: 1b64 subs r4, r4, r5
|
|
800efa6: 10a4 asrs r4, r4, #2
|
|
800efa8: 2600 movs r6, #0
|
|
800efaa: 42a6 cmp r6, r4
|
|
800efac: d105 bne.n 800efba <__libc_init_array+0x2e>
|
|
800efae: bd70 pop {r4, r5, r6, pc}
|
|
800efb0: f855 3b04 ldr.w r3, [r5], #4
|
|
800efb4: 4798 blx r3
|
|
800efb6: 3601 adds r6, #1
|
|
800efb8: e7ee b.n 800ef98 <__libc_init_array+0xc>
|
|
800efba: f855 3b04 ldr.w r3, [r5], #4
|
|
800efbe: 4798 blx r3
|
|
800efc0: 3601 adds r6, #1
|
|
800efc2: e7f2 b.n 800efaa <__libc_init_array+0x1e>
|
|
800efc4: 08010654 .word 0x08010654
|
|
800efc8: 08010654 .word 0x08010654
|
|
800efcc: 08010654 .word 0x08010654
|
|
800efd0: 08010658 .word 0x08010658
|
|
|
|
0800efd4 <__retarget_lock_acquire_recursive>:
|
|
800efd4: 4770 bx lr
|
|
|
|
0800efd6 <__retarget_lock_release_recursive>:
|
|
800efd6: 4770 bx lr
|
|
|
|
0800efd8 <memcpy>:
|
|
800efd8: 440a add r2, r1
|
|
800efda: 4291 cmp r1, r2
|
|
800efdc: f100 33ff add.w r3, r0, #4294967295 @ 0xffffffff
|
|
800efe0: d100 bne.n 800efe4 <memcpy+0xc>
|
|
800efe2: 4770 bx lr
|
|
800efe4: b510 push {r4, lr}
|
|
800efe6: f811 4b01 ldrb.w r4, [r1], #1
|
|
800efea: f803 4f01 strb.w r4, [r3, #1]!
|
|
800efee: 4291 cmp r1, r2
|
|
800eff0: d1f9 bne.n 800efe6 <memcpy+0xe>
|
|
800eff2: bd10 pop {r4, pc}
|
|
|
|
0800eff4 <_free_r>:
|
|
800eff4: b538 push {r3, r4, r5, lr}
|
|
800eff6: 4605 mov r5, r0
|
|
800eff8: 2900 cmp r1, #0
|
|
800effa: d041 beq.n 800f080 <_free_r+0x8c>
|
|
800effc: f851 3c04 ldr.w r3, [r1, #-4]
|
|
800f000: 1f0c subs r4, r1, #4
|
|
800f002: 2b00 cmp r3, #0
|
|
800f004: bfb8 it lt
|
|
800f006: 18e4 addlt r4, r4, r3
|
|
800f008: f000 f8e0 bl 800f1cc <__malloc_lock>
|
|
800f00c: 4a1d ldr r2, [pc, #116] @ (800f084 <_free_r+0x90>)
|
|
800f00e: 6813 ldr r3, [r2, #0]
|
|
800f010: b933 cbnz r3, 800f020 <_free_r+0x2c>
|
|
800f012: 6063 str r3, [r4, #4]
|
|
800f014: 6014 str r4, [r2, #0]
|
|
800f016: 4628 mov r0, r5
|
|
800f018: e8bd 4038 ldmia.w sp!, {r3, r4, r5, lr}
|
|
800f01c: f000 b8dc b.w 800f1d8 <__malloc_unlock>
|
|
800f020: 42a3 cmp r3, r4
|
|
800f022: d908 bls.n 800f036 <_free_r+0x42>
|
|
800f024: 6820 ldr r0, [r4, #0]
|
|
800f026: 1821 adds r1, r4, r0
|
|
800f028: 428b cmp r3, r1
|
|
800f02a: bf01 itttt eq
|
|
800f02c: 6819 ldreq r1, [r3, #0]
|
|
800f02e: 685b ldreq r3, [r3, #4]
|
|
800f030: 1809 addeq r1, r1, r0
|
|
800f032: 6021 streq r1, [r4, #0]
|
|
800f034: e7ed b.n 800f012 <_free_r+0x1e>
|
|
800f036: 461a mov r2, r3
|
|
800f038: 685b ldr r3, [r3, #4]
|
|
800f03a: b10b cbz r3, 800f040 <_free_r+0x4c>
|
|
800f03c: 42a3 cmp r3, r4
|
|
800f03e: d9fa bls.n 800f036 <_free_r+0x42>
|
|
800f040: 6811 ldr r1, [r2, #0]
|
|
800f042: 1850 adds r0, r2, r1
|
|
800f044: 42a0 cmp r0, r4
|
|
800f046: d10b bne.n 800f060 <_free_r+0x6c>
|
|
800f048: 6820 ldr r0, [r4, #0]
|
|
800f04a: 4401 add r1, r0
|
|
800f04c: 1850 adds r0, r2, r1
|
|
800f04e: 4283 cmp r3, r0
|
|
800f050: 6011 str r1, [r2, #0]
|
|
800f052: d1e0 bne.n 800f016 <_free_r+0x22>
|
|
800f054: 6818 ldr r0, [r3, #0]
|
|
800f056: 685b ldr r3, [r3, #4]
|
|
800f058: 6053 str r3, [r2, #4]
|
|
800f05a: 4408 add r0, r1
|
|
800f05c: 6010 str r0, [r2, #0]
|
|
800f05e: e7da b.n 800f016 <_free_r+0x22>
|
|
800f060: d902 bls.n 800f068 <_free_r+0x74>
|
|
800f062: 230c movs r3, #12
|
|
800f064: 602b str r3, [r5, #0]
|
|
800f066: e7d6 b.n 800f016 <_free_r+0x22>
|
|
800f068: 6820 ldr r0, [r4, #0]
|
|
800f06a: 1821 adds r1, r4, r0
|
|
800f06c: 428b cmp r3, r1
|
|
800f06e: bf04 itt eq
|
|
800f070: 6819 ldreq r1, [r3, #0]
|
|
800f072: 685b ldreq r3, [r3, #4]
|
|
800f074: 6063 str r3, [r4, #4]
|
|
800f076: bf04 itt eq
|
|
800f078: 1809 addeq r1, r1, r0
|
|
800f07a: 6021 streq r1, [r4, #0]
|
|
800f07c: 6054 str r4, [r2, #4]
|
|
800f07e: e7ca b.n 800f016 <_free_r+0x22>
|
|
800f080: bd38 pop {r3, r4, r5, pc}
|
|
800f082: bf00 nop
|
|
800f084: 20001090 .word 0x20001090
|
|
|
|
0800f088 <sbrk_aligned>:
|
|
800f088: b570 push {r4, r5, r6, lr}
|
|
800f08a: 4e0f ldr r6, [pc, #60] @ (800f0c8 <sbrk_aligned+0x40>)
|
|
800f08c: 460c mov r4, r1
|
|
800f08e: 6831 ldr r1, [r6, #0]
|
|
800f090: 4605 mov r5, r0
|
|
800f092: b911 cbnz r1, 800f09a <sbrk_aligned+0x12>
|
|
800f094: f000 fba4 bl 800f7e0 <_sbrk_r>
|
|
800f098: 6030 str r0, [r6, #0]
|
|
800f09a: 4621 mov r1, r4
|
|
800f09c: 4628 mov r0, r5
|
|
800f09e: f000 fb9f bl 800f7e0 <_sbrk_r>
|
|
800f0a2: 1c43 adds r3, r0, #1
|
|
800f0a4: d103 bne.n 800f0ae <sbrk_aligned+0x26>
|
|
800f0a6: f04f 34ff mov.w r4, #4294967295 @ 0xffffffff
|
|
800f0aa: 4620 mov r0, r4
|
|
800f0ac: bd70 pop {r4, r5, r6, pc}
|
|
800f0ae: 1cc4 adds r4, r0, #3
|
|
800f0b0: f024 0403 bic.w r4, r4, #3
|
|
800f0b4: 42a0 cmp r0, r4
|
|
800f0b6: d0f8 beq.n 800f0aa <sbrk_aligned+0x22>
|
|
800f0b8: 1a21 subs r1, r4, r0
|
|
800f0ba: 4628 mov r0, r5
|
|
800f0bc: f000 fb90 bl 800f7e0 <_sbrk_r>
|
|
800f0c0: 3001 adds r0, #1
|
|
800f0c2: d1f2 bne.n 800f0aa <sbrk_aligned+0x22>
|
|
800f0c4: e7ef b.n 800f0a6 <sbrk_aligned+0x1e>
|
|
800f0c6: bf00 nop
|
|
800f0c8: 2000108c .word 0x2000108c
|
|
|
|
0800f0cc <_malloc_r>:
|
|
800f0cc: e92d 43f8 stmdb sp!, {r3, r4, r5, r6, r7, r8, r9, lr}
|
|
800f0d0: 1ccd adds r5, r1, #3
|
|
800f0d2: f025 0503 bic.w r5, r5, #3
|
|
800f0d6: 3508 adds r5, #8
|
|
800f0d8: 2d0c cmp r5, #12
|
|
800f0da: bf38 it cc
|
|
800f0dc: 250c movcc r5, #12
|
|
800f0de: 2d00 cmp r5, #0
|
|
800f0e0: 4606 mov r6, r0
|
|
800f0e2: db01 blt.n 800f0e8 <_malloc_r+0x1c>
|
|
800f0e4: 42a9 cmp r1, r5
|
|
800f0e6: d904 bls.n 800f0f2 <_malloc_r+0x26>
|
|
800f0e8: 230c movs r3, #12
|
|
800f0ea: 6033 str r3, [r6, #0]
|
|
800f0ec: 2000 movs r0, #0
|
|
800f0ee: e8bd 83f8 ldmia.w sp!, {r3, r4, r5, r6, r7, r8, r9, pc}
|
|
800f0f2: f8df 80d4 ldr.w r8, [pc, #212] @ 800f1c8 <_malloc_r+0xfc>
|
|
800f0f6: f000 f869 bl 800f1cc <__malloc_lock>
|
|
800f0fa: f8d8 3000 ldr.w r3, [r8]
|
|
800f0fe: 461c mov r4, r3
|
|
800f100: bb44 cbnz r4, 800f154 <_malloc_r+0x88>
|
|
800f102: 4629 mov r1, r5
|
|
800f104: 4630 mov r0, r6
|
|
800f106: f7ff ffbf bl 800f088 <sbrk_aligned>
|
|
800f10a: 1c43 adds r3, r0, #1
|
|
800f10c: 4604 mov r4, r0
|
|
800f10e: d158 bne.n 800f1c2 <_malloc_r+0xf6>
|
|
800f110: f8d8 4000 ldr.w r4, [r8]
|
|
800f114: 4627 mov r7, r4
|
|
800f116: 2f00 cmp r7, #0
|
|
800f118: d143 bne.n 800f1a2 <_malloc_r+0xd6>
|
|
800f11a: 2c00 cmp r4, #0
|
|
800f11c: d04b beq.n 800f1b6 <_malloc_r+0xea>
|
|
800f11e: 6823 ldr r3, [r4, #0]
|
|
800f120: 4639 mov r1, r7
|
|
800f122: 4630 mov r0, r6
|
|
800f124: eb04 0903 add.w r9, r4, r3
|
|
800f128: f000 fb5a bl 800f7e0 <_sbrk_r>
|
|
800f12c: 4581 cmp r9, r0
|
|
800f12e: d142 bne.n 800f1b6 <_malloc_r+0xea>
|
|
800f130: 6821 ldr r1, [r4, #0]
|
|
800f132: 1a6d subs r5, r5, r1
|
|
800f134: 4629 mov r1, r5
|
|
800f136: 4630 mov r0, r6
|
|
800f138: f7ff ffa6 bl 800f088 <sbrk_aligned>
|
|
800f13c: 3001 adds r0, #1
|
|
800f13e: d03a beq.n 800f1b6 <_malloc_r+0xea>
|
|
800f140: 6823 ldr r3, [r4, #0]
|
|
800f142: 442b add r3, r5
|
|
800f144: 6023 str r3, [r4, #0]
|
|
800f146: f8d8 3000 ldr.w r3, [r8]
|
|
800f14a: 685a ldr r2, [r3, #4]
|
|
800f14c: bb62 cbnz r2, 800f1a8 <_malloc_r+0xdc>
|
|
800f14e: f8c8 7000 str.w r7, [r8]
|
|
800f152: e00f b.n 800f174 <_malloc_r+0xa8>
|
|
800f154: 6822 ldr r2, [r4, #0]
|
|
800f156: 1b52 subs r2, r2, r5
|
|
800f158: d420 bmi.n 800f19c <_malloc_r+0xd0>
|
|
800f15a: 2a0b cmp r2, #11
|
|
800f15c: d917 bls.n 800f18e <_malloc_r+0xc2>
|
|
800f15e: 1961 adds r1, r4, r5
|
|
800f160: 42a3 cmp r3, r4
|
|
800f162: 6025 str r5, [r4, #0]
|
|
800f164: bf18 it ne
|
|
800f166: 6059 strne r1, [r3, #4]
|
|
800f168: 6863 ldr r3, [r4, #4]
|
|
800f16a: bf08 it eq
|
|
800f16c: f8c8 1000 streq.w r1, [r8]
|
|
800f170: 5162 str r2, [r4, r5]
|
|
800f172: 604b str r3, [r1, #4]
|
|
800f174: 4630 mov r0, r6
|
|
800f176: f000 f82f bl 800f1d8 <__malloc_unlock>
|
|
800f17a: f104 000b add.w r0, r4, #11
|
|
800f17e: 1d23 adds r3, r4, #4
|
|
800f180: f020 0007 bic.w r0, r0, #7
|
|
800f184: 1ac2 subs r2, r0, r3
|
|
800f186: bf1c itt ne
|
|
800f188: 1a1b subne r3, r3, r0
|
|
800f18a: 50a3 strne r3, [r4, r2]
|
|
800f18c: e7af b.n 800f0ee <_malloc_r+0x22>
|
|
800f18e: 6862 ldr r2, [r4, #4]
|
|
800f190: 42a3 cmp r3, r4
|
|
800f192: bf0c ite eq
|
|
800f194: f8c8 2000 streq.w r2, [r8]
|
|
800f198: 605a strne r2, [r3, #4]
|
|
800f19a: e7eb b.n 800f174 <_malloc_r+0xa8>
|
|
800f19c: 4623 mov r3, r4
|
|
800f19e: 6864 ldr r4, [r4, #4]
|
|
800f1a0: e7ae b.n 800f100 <_malloc_r+0x34>
|
|
800f1a2: 463c mov r4, r7
|
|
800f1a4: 687f ldr r7, [r7, #4]
|
|
800f1a6: e7b6 b.n 800f116 <_malloc_r+0x4a>
|
|
800f1a8: 461a mov r2, r3
|
|
800f1aa: 685b ldr r3, [r3, #4]
|
|
800f1ac: 42a3 cmp r3, r4
|
|
800f1ae: d1fb bne.n 800f1a8 <_malloc_r+0xdc>
|
|
800f1b0: 2300 movs r3, #0
|
|
800f1b2: 6053 str r3, [r2, #4]
|
|
800f1b4: e7de b.n 800f174 <_malloc_r+0xa8>
|
|
800f1b6: 230c movs r3, #12
|
|
800f1b8: 6033 str r3, [r6, #0]
|
|
800f1ba: 4630 mov r0, r6
|
|
800f1bc: f000 f80c bl 800f1d8 <__malloc_unlock>
|
|
800f1c0: e794 b.n 800f0ec <_malloc_r+0x20>
|
|
800f1c2: 6005 str r5, [r0, #0]
|
|
800f1c4: e7d6 b.n 800f174 <_malloc_r+0xa8>
|
|
800f1c6: bf00 nop
|
|
800f1c8: 20001090 .word 0x20001090
|
|
|
|
0800f1cc <__malloc_lock>:
|
|
800f1cc: 4801 ldr r0, [pc, #4] @ (800f1d4 <__malloc_lock+0x8>)
|
|
800f1ce: f7ff bf01 b.w 800efd4 <__retarget_lock_acquire_recursive>
|
|
800f1d2: bf00 nop
|
|
800f1d4: 20001088 .word 0x20001088
|
|
|
|
0800f1d8 <__malloc_unlock>:
|
|
800f1d8: 4801 ldr r0, [pc, #4] @ (800f1e0 <__malloc_unlock+0x8>)
|
|
800f1da: f7ff befc b.w 800efd6 <__retarget_lock_release_recursive>
|
|
800f1de: bf00 nop
|
|
800f1e0: 20001088 .word 0x20001088
|
|
|
|
0800f1e4 <__ssputs_r>:
|
|
800f1e4: e92d 47f0 stmdb sp!, {r4, r5, r6, r7, r8, r9, sl, lr}
|
|
800f1e8: 688e ldr r6, [r1, #8]
|
|
800f1ea: 461f mov r7, r3
|
|
800f1ec: 42be cmp r6, r7
|
|
800f1ee: 680b ldr r3, [r1, #0]
|
|
800f1f0: 4682 mov sl, r0
|
|
800f1f2: 460c mov r4, r1
|
|
800f1f4: 4690 mov r8, r2
|
|
800f1f6: d82d bhi.n 800f254 <__ssputs_r+0x70>
|
|
800f1f8: f9b1 200c ldrsh.w r2, [r1, #12]
|
|
800f1fc: f412 6f90 tst.w r2, #1152 @ 0x480
|
|
800f200: d026 beq.n 800f250 <__ssputs_r+0x6c>
|
|
800f202: 6965 ldr r5, [r4, #20]
|
|
800f204: 6909 ldr r1, [r1, #16]
|
|
800f206: eb05 0545 add.w r5, r5, r5, lsl #1
|
|
800f20a: eba3 0901 sub.w r9, r3, r1
|
|
800f20e: eb05 75d5 add.w r5, r5, r5, lsr #31
|
|
800f212: 1c7b adds r3, r7, #1
|
|
800f214: 444b add r3, r9
|
|
800f216: 106d asrs r5, r5, #1
|
|
800f218: 429d cmp r5, r3
|
|
800f21a: bf38 it cc
|
|
800f21c: 461d movcc r5, r3
|
|
800f21e: 0553 lsls r3, r2, #21
|
|
800f220: d527 bpl.n 800f272 <__ssputs_r+0x8e>
|
|
800f222: 4629 mov r1, r5
|
|
800f224: f7ff ff52 bl 800f0cc <_malloc_r>
|
|
800f228: 4606 mov r6, r0
|
|
800f22a: b360 cbz r0, 800f286 <__ssputs_r+0xa2>
|
|
800f22c: 6921 ldr r1, [r4, #16]
|
|
800f22e: 464a mov r2, r9
|
|
800f230: f7ff fed2 bl 800efd8 <memcpy>
|
|
800f234: 89a3 ldrh r3, [r4, #12]
|
|
800f236: f423 6390 bic.w r3, r3, #1152 @ 0x480
|
|
800f23a: f043 0380 orr.w r3, r3, #128 @ 0x80
|
|
800f23e: 81a3 strh r3, [r4, #12]
|
|
800f240: 6126 str r6, [r4, #16]
|
|
800f242: 6165 str r5, [r4, #20]
|
|
800f244: 444e add r6, r9
|
|
800f246: eba5 0509 sub.w r5, r5, r9
|
|
800f24a: 6026 str r6, [r4, #0]
|
|
800f24c: 60a5 str r5, [r4, #8]
|
|
800f24e: 463e mov r6, r7
|
|
800f250: 42be cmp r6, r7
|
|
800f252: d900 bls.n 800f256 <__ssputs_r+0x72>
|
|
800f254: 463e mov r6, r7
|
|
800f256: 6820 ldr r0, [r4, #0]
|
|
800f258: 4632 mov r2, r6
|
|
800f25a: 4641 mov r1, r8
|
|
800f25c: f000 faa6 bl 800f7ac <memmove>
|
|
800f260: 68a3 ldr r3, [r4, #8]
|
|
800f262: 1b9b subs r3, r3, r6
|
|
800f264: 60a3 str r3, [r4, #8]
|
|
800f266: 6823 ldr r3, [r4, #0]
|
|
800f268: 4433 add r3, r6
|
|
800f26a: 6023 str r3, [r4, #0]
|
|
800f26c: 2000 movs r0, #0
|
|
800f26e: e8bd 87f0 ldmia.w sp!, {r4, r5, r6, r7, r8, r9, sl, pc}
|
|
800f272: 462a mov r2, r5
|
|
800f274: f000 fac4 bl 800f800 <_realloc_r>
|
|
800f278: 4606 mov r6, r0
|
|
800f27a: 2800 cmp r0, #0
|
|
800f27c: d1e0 bne.n 800f240 <__ssputs_r+0x5c>
|
|
800f27e: 6921 ldr r1, [r4, #16]
|
|
800f280: 4650 mov r0, sl
|
|
800f282: f7ff feb7 bl 800eff4 <_free_r>
|
|
800f286: 230c movs r3, #12
|
|
800f288: f8ca 3000 str.w r3, [sl]
|
|
800f28c: 89a3 ldrh r3, [r4, #12]
|
|
800f28e: f043 0340 orr.w r3, r3, #64 @ 0x40
|
|
800f292: 81a3 strh r3, [r4, #12]
|
|
800f294: f04f 30ff mov.w r0, #4294967295 @ 0xffffffff
|
|
800f298: e7e9 b.n 800f26e <__ssputs_r+0x8a>
|
|
...
|
|
|
|
0800f29c <_svfiprintf_r>:
|
|
800f29c: e92d 4ff0 stmdb sp!, {r4, r5, r6, r7, r8, r9, sl, fp, lr}
|
|
800f2a0: 4698 mov r8, r3
|
|
800f2a2: 898b ldrh r3, [r1, #12]
|
|
800f2a4: 061b lsls r3, r3, #24
|
|
800f2a6: b09d sub sp, #116 @ 0x74
|
|
800f2a8: 4607 mov r7, r0
|
|
800f2aa: 460d mov r5, r1
|
|
800f2ac: 4614 mov r4, r2
|
|
800f2ae: d510 bpl.n 800f2d2 <_svfiprintf_r+0x36>
|
|
800f2b0: 690b ldr r3, [r1, #16]
|
|
800f2b2: b973 cbnz r3, 800f2d2 <_svfiprintf_r+0x36>
|
|
800f2b4: 2140 movs r1, #64 @ 0x40
|
|
800f2b6: f7ff ff09 bl 800f0cc <_malloc_r>
|
|
800f2ba: 6028 str r0, [r5, #0]
|
|
800f2bc: 6128 str r0, [r5, #16]
|
|
800f2be: b930 cbnz r0, 800f2ce <_svfiprintf_r+0x32>
|
|
800f2c0: 230c movs r3, #12
|
|
800f2c2: 603b str r3, [r7, #0]
|
|
800f2c4: f04f 30ff mov.w r0, #4294967295 @ 0xffffffff
|
|
800f2c8: b01d add sp, #116 @ 0x74
|
|
800f2ca: e8bd 8ff0 ldmia.w sp!, {r4, r5, r6, r7, r8, r9, sl, fp, pc}
|
|
800f2ce: 2340 movs r3, #64 @ 0x40
|
|
800f2d0: 616b str r3, [r5, #20]
|
|
800f2d2: 2300 movs r3, #0
|
|
800f2d4: 9309 str r3, [sp, #36] @ 0x24
|
|
800f2d6: 2320 movs r3, #32
|
|
800f2d8: f88d 3029 strb.w r3, [sp, #41] @ 0x29
|
|
800f2dc: f8cd 800c str.w r8, [sp, #12]
|
|
800f2e0: 2330 movs r3, #48 @ 0x30
|
|
800f2e2: f8df 819c ldr.w r8, [pc, #412] @ 800f480 <_svfiprintf_r+0x1e4>
|
|
800f2e6: f88d 302a strb.w r3, [sp, #42] @ 0x2a
|
|
800f2ea: f04f 0901 mov.w r9, #1
|
|
800f2ee: 4623 mov r3, r4
|
|
800f2f0: 469a mov sl, r3
|
|
800f2f2: f813 2b01 ldrb.w r2, [r3], #1
|
|
800f2f6: b10a cbz r2, 800f2fc <_svfiprintf_r+0x60>
|
|
800f2f8: 2a25 cmp r2, #37 @ 0x25
|
|
800f2fa: d1f9 bne.n 800f2f0 <_svfiprintf_r+0x54>
|
|
800f2fc: ebba 0b04 subs.w fp, sl, r4
|
|
800f300: d00b beq.n 800f31a <_svfiprintf_r+0x7e>
|
|
800f302: 465b mov r3, fp
|
|
800f304: 4622 mov r2, r4
|
|
800f306: 4629 mov r1, r5
|
|
800f308: 4638 mov r0, r7
|
|
800f30a: f7ff ff6b bl 800f1e4 <__ssputs_r>
|
|
800f30e: 3001 adds r0, #1
|
|
800f310: f000 80a7 beq.w 800f462 <_svfiprintf_r+0x1c6>
|
|
800f314: 9a09 ldr r2, [sp, #36] @ 0x24
|
|
800f316: 445a add r2, fp
|
|
800f318: 9209 str r2, [sp, #36] @ 0x24
|
|
800f31a: f89a 3000 ldrb.w r3, [sl]
|
|
800f31e: 2b00 cmp r3, #0
|
|
800f320: f000 809f beq.w 800f462 <_svfiprintf_r+0x1c6>
|
|
800f324: 2300 movs r3, #0
|
|
800f326: f04f 32ff mov.w r2, #4294967295 @ 0xffffffff
|
|
800f32a: e9cd 2305 strd r2, r3, [sp, #20]
|
|
800f32e: f10a 0a01 add.w sl, sl, #1
|
|
800f332: 9304 str r3, [sp, #16]
|
|
800f334: 9307 str r3, [sp, #28]
|
|
800f336: f88d 3053 strb.w r3, [sp, #83] @ 0x53
|
|
800f33a: 931a str r3, [sp, #104] @ 0x68
|
|
800f33c: 4654 mov r4, sl
|
|
800f33e: 2205 movs r2, #5
|
|
800f340: f814 1b01 ldrb.w r1, [r4], #1
|
|
800f344: 484e ldr r0, [pc, #312] @ (800f480 <_svfiprintf_r+0x1e4>)
|
|
800f346: f7f0 ff33 bl 80001b0 <memchr>
|
|
800f34a: 9a04 ldr r2, [sp, #16]
|
|
800f34c: b9d8 cbnz r0, 800f386 <_svfiprintf_r+0xea>
|
|
800f34e: 06d0 lsls r0, r2, #27
|
|
800f350: bf44 itt mi
|
|
800f352: 2320 movmi r3, #32
|
|
800f354: f88d 3053 strbmi.w r3, [sp, #83] @ 0x53
|
|
800f358: 0711 lsls r1, r2, #28
|
|
800f35a: bf44 itt mi
|
|
800f35c: 232b movmi r3, #43 @ 0x2b
|
|
800f35e: f88d 3053 strbmi.w r3, [sp, #83] @ 0x53
|
|
800f362: f89a 3000 ldrb.w r3, [sl]
|
|
800f366: 2b2a cmp r3, #42 @ 0x2a
|
|
800f368: d015 beq.n 800f396 <_svfiprintf_r+0xfa>
|
|
800f36a: 9a07 ldr r2, [sp, #28]
|
|
800f36c: 4654 mov r4, sl
|
|
800f36e: 2000 movs r0, #0
|
|
800f370: f04f 0c0a mov.w ip, #10
|
|
800f374: 4621 mov r1, r4
|
|
800f376: f811 3b01 ldrb.w r3, [r1], #1
|
|
800f37a: 3b30 subs r3, #48 @ 0x30
|
|
800f37c: 2b09 cmp r3, #9
|
|
800f37e: d94b bls.n 800f418 <_svfiprintf_r+0x17c>
|
|
800f380: b1b0 cbz r0, 800f3b0 <_svfiprintf_r+0x114>
|
|
800f382: 9207 str r2, [sp, #28]
|
|
800f384: e014 b.n 800f3b0 <_svfiprintf_r+0x114>
|
|
800f386: eba0 0308 sub.w r3, r0, r8
|
|
800f38a: fa09 f303 lsl.w r3, r9, r3
|
|
800f38e: 4313 orrs r3, r2
|
|
800f390: 9304 str r3, [sp, #16]
|
|
800f392: 46a2 mov sl, r4
|
|
800f394: e7d2 b.n 800f33c <_svfiprintf_r+0xa0>
|
|
800f396: 9b03 ldr r3, [sp, #12]
|
|
800f398: 1d19 adds r1, r3, #4
|
|
800f39a: 681b ldr r3, [r3, #0]
|
|
800f39c: 9103 str r1, [sp, #12]
|
|
800f39e: 2b00 cmp r3, #0
|
|
800f3a0: bfbb ittet lt
|
|
800f3a2: 425b neglt r3, r3
|
|
800f3a4: f042 0202 orrlt.w r2, r2, #2
|
|
800f3a8: 9307 strge r3, [sp, #28]
|
|
800f3aa: 9307 strlt r3, [sp, #28]
|
|
800f3ac: bfb8 it lt
|
|
800f3ae: 9204 strlt r2, [sp, #16]
|
|
800f3b0: 7823 ldrb r3, [r4, #0]
|
|
800f3b2: 2b2e cmp r3, #46 @ 0x2e
|
|
800f3b4: d10a bne.n 800f3cc <_svfiprintf_r+0x130>
|
|
800f3b6: 7863 ldrb r3, [r4, #1]
|
|
800f3b8: 2b2a cmp r3, #42 @ 0x2a
|
|
800f3ba: d132 bne.n 800f422 <_svfiprintf_r+0x186>
|
|
800f3bc: 9b03 ldr r3, [sp, #12]
|
|
800f3be: 1d1a adds r2, r3, #4
|
|
800f3c0: 681b ldr r3, [r3, #0]
|
|
800f3c2: 9203 str r2, [sp, #12]
|
|
800f3c4: ea43 73e3 orr.w r3, r3, r3, asr #31
|
|
800f3c8: 3402 adds r4, #2
|
|
800f3ca: 9305 str r3, [sp, #20]
|
|
800f3cc: f8df a0b4 ldr.w sl, [pc, #180] @ 800f484 <_svfiprintf_r+0x1e8>
|
|
800f3d0: 7821 ldrb r1, [r4, #0]
|
|
800f3d2: 2203 movs r2, #3
|
|
800f3d4: 4650 mov r0, sl
|
|
800f3d6: f7f0 feeb bl 80001b0 <memchr>
|
|
800f3da: b138 cbz r0, 800f3ec <_svfiprintf_r+0x150>
|
|
800f3dc: 9b04 ldr r3, [sp, #16]
|
|
800f3de: eba0 000a sub.w r0, r0, sl
|
|
800f3e2: 2240 movs r2, #64 @ 0x40
|
|
800f3e4: 4082 lsls r2, r0
|
|
800f3e6: 4313 orrs r3, r2
|
|
800f3e8: 3401 adds r4, #1
|
|
800f3ea: 9304 str r3, [sp, #16]
|
|
800f3ec: f814 1b01 ldrb.w r1, [r4], #1
|
|
800f3f0: 4825 ldr r0, [pc, #148] @ (800f488 <_svfiprintf_r+0x1ec>)
|
|
800f3f2: f88d 1028 strb.w r1, [sp, #40] @ 0x28
|
|
800f3f6: 2206 movs r2, #6
|
|
800f3f8: f7f0 feda bl 80001b0 <memchr>
|
|
800f3fc: 2800 cmp r0, #0
|
|
800f3fe: d036 beq.n 800f46e <_svfiprintf_r+0x1d2>
|
|
800f400: 4b22 ldr r3, [pc, #136] @ (800f48c <_svfiprintf_r+0x1f0>)
|
|
800f402: bb1b cbnz r3, 800f44c <_svfiprintf_r+0x1b0>
|
|
800f404: 9b03 ldr r3, [sp, #12]
|
|
800f406: 3307 adds r3, #7
|
|
800f408: f023 0307 bic.w r3, r3, #7
|
|
800f40c: 3308 adds r3, #8
|
|
800f40e: 9303 str r3, [sp, #12]
|
|
800f410: 9b09 ldr r3, [sp, #36] @ 0x24
|
|
800f412: 4433 add r3, r6
|
|
800f414: 9309 str r3, [sp, #36] @ 0x24
|
|
800f416: e76a b.n 800f2ee <_svfiprintf_r+0x52>
|
|
800f418: fb0c 3202 mla r2, ip, r2, r3
|
|
800f41c: 460c mov r4, r1
|
|
800f41e: 2001 movs r0, #1
|
|
800f420: e7a8 b.n 800f374 <_svfiprintf_r+0xd8>
|
|
800f422: 2300 movs r3, #0
|
|
800f424: 3401 adds r4, #1
|
|
800f426: 9305 str r3, [sp, #20]
|
|
800f428: 4619 mov r1, r3
|
|
800f42a: f04f 0c0a mov.w ip, #10
|
|
800f42e: 4620 mov r0, r4
|
|
800f430: f810 2b01 ldrb.w r2, [r0], #1
|
|
800f434: 3a30 subs r2, #48 @ 0x30
|
|
800f436: 2a09 cmp r2, #9
|
|
800f438: d903 bls.n 800f442 <_svfiprintf_r+0x1a6>
|
|
800f43a: 2b00 cmp r3, #0
|
|
800f43c: d0c6 beq.n 800f3cc <_svfiprintf_r+0x130>
|
|
800f43e: 9105 str r1, [sp, #20]
|
|
800f440: e7c4 b.n 800f3cc <_svfiprintf_r+0x130>
|
|
800f442: fb0c 2101 mla r1, ip, r1, r2
|
|
800f446: 4604 mov r4, r0
|
|
800f448: 2301 movs r3, #1
|
|
800f44a: e7f0 b.n 800f42e <_svfiprintf_r+0x192>
|
|
800f44c: ab03 add r3, sp, #12
|
|
800f44e: 9300 str r3, [sp, #0]
|
|
800f450: 462a mov r2, r5
|
|
800f452: 4b0f ldr r3, [pc, #60] @ (800f490 <_svfiprintf_r+0x1f4>)
|
|
800f454: a904 add r1, sp, #16
|
|
800f456: 4638 mov r0, r7
|
|
800f458: f3af 8000 nop.w
|
|
800f45c: 1c42 adds r2, r0, #1
|
|
800f45e: 4606 mov r6, r0
|
|
800f460: d1d6 bne.n 800f410 <_svfiprintf_r+0x174>
|
|
800f462: 89ab ldrh r3, [r5, #12]
|
|
800f464: 065b lsls r3, r3, #25
|
|
800f466: f53f af2d bmi.w 800f2c4 <_svfiprintf_r+0x28>
|
|
800f46a: 9809 ldr r0, [sp, #36] @ 0x24
|
|
800f46c: e72c b.n 800f2c8 <_svfiprintf_r+0x2c>
|
|
800f46e: ab03 add r3, sp, #12
|
|
800f470: 9300 str r3, [sp, #0]
|
|
800f472: 462a mov r2, r5
|
|
800f474: 4b06 ldr r3, [pc, #24] @ (800f490 <_svfiprintf_r+0x1f4>)
|
|
800f476: a904 add r1, sp, #16
|
|
800f478: 4638 mov r0, r7
|
|
800f47a: f000 f879 bl 800f570 <_printf_i>
|
|
800f47e: e7ed b.n 800f45c <_svfiprintf_r+0x1c0>
|
|
800f480: 08010619 .word 0x08010619
|
|
800f484: 0801061f .word 0x0801061f
|
|
800f488: 08010623 .word 0x08010623
|
|
800f48c: 00000000 .word 0x00000000
|
|
800f490: 0800f1e5 .word 0x0800f1e5
|
|
|
|
0800f494 <_printf_common>:
|
|
800f494: e92d 47f0 stmdb sp!, {r4, r5, r6, r7, r8, r9, sl, lr}
|
|
800f498: 4616 mov r6, r2
|
|
800f49a: 4698 mov r8, r3
|
|
800f49c: 688a ldr r2, [r1, #8]
|
|
800f49e: 690b ldr r3, [r1, #16]
|
|
800f4a0: f8dd 9020 ldr.w r9, [sp, #32]
|
|
800f4a4: 4293 cmp r3, r2
|
|
800f4a6: bfb8 it lt
|
|
800f4a8: 4613 movlt r3, r2
|
|
800f4aa: 6033 str r3, [r6, #0]
|
|
800f4ac: f891 2043 ldrb.w r2, [r1, #67] @ 0x43
|
|
800f4b0: 4607 mov r7, r0
|
|
800f4b2: 460c mov r4, r1
|
|
800f4b4: b10a cbz r2, 800f4ba <_printf_common+0x26>
|
|
800f4b6: 3301 adds r3, #1
|
|
800f4b8: 6033 str r3, [r6, #0]
|
|
800f4ba: 6823 ldr r3, [r4, #0]
|
|
800f4bc: 0699 lsls r1, r3, #26
|
|
800f4be: bf42 ittt mi
|
|
800f4c0: 6833 ldrmi r3, [r6, #0]
|
|
800f4c2: 3302 addmi r3, #2
|
|
800f4c4: 6033 strmi r3, [r6, #0]
|
|
800f4c6: 6825 ldr r5, [r4, #0]
|
|
800f4c8: f015 0506 ands.w r5, r5, #6
|
|
800f4cc: d106 bne.n 800f4dc <_printf_common+0x48>
|
|
800f4ce: f104 0a19 add.w sl, r4, #25
|
|
800f4d2: 68e3 ldr r3, [r4, #12]
|
|
800f4d4: 6832 ldr r2, [r6, #0]
|
|
800f4d6: 1a9b subs r3, r3, r2
|
|
800f4d8: 42ab cmp r3, r5
|
|
800f4da: dc26 bgt.n 800f52a <_printf_common+0x96>
|
|
800f4dc: f894 3043 ldrb.w r3, [r4, #67] @ 0x43
|
|
800f4e0: 6822 ldr r2, [r4, #0]
|
|
800f4e2: 3b00 subs r3, #0
|
|
800f4e4: bf18 it ne
|
|
800f4e6: 2301 movne r3, #1
|
|
800f4e8: 0692 lsls r2, r2, #26
|
|
800f4ea: d42b bmi.n 800f544 <_printf_common+0xb0>
|
|
800f4ec: f104 0243 add.w r2, r4, #67 @ 0x43
|
|
800f4f0: 4641 mov r1, r8
|
|
800f4f2: 4638 mov r0, r7
|
|
800f4f4: 47c8 blx r9
|
|
800f4f6: 3001 adds r0, #1
|
|
800f4f8: d01e beq.n 800f538 <_printf_common+0xa4>
|
|
800f4fa: 6823 ldr r3, [r4, #0]
|
|
800f4fc: 6922 ldr r2, [r4, #16]
|
|
800f4fe: f003 0306 and.w r3, r3, #6
|
|
800f502: 2b04 cmp r3, #4
|
|
800f504: bf02 ittt eq
|
|
800f506: 68e5 ldreq r5, [r4, #12]
|
|
800f508: 6833 ldreq r3, [r6, #0]
|
|
800f50a: 1aed subeq r5, r5, r3
|
|
800f50c: 68a3 ldr r3, [r4, #8]
|
|
800f50e: bf0c ite eq
|
|
800f510: ea25 75e5 biceq.w r5, r5, r5, asr #31
|
|
800f514: 2500 movne r5, #0
|
|
800f516: 4293 cmp r3, r2
|
|
800f518: bfc4 itt gt
|
|
800f51a: 1a9b subgt r3, r3, r2
|
|
800f51c: 18ed addgt r5, r5, r3
|
|
800f51e: 2600 movs r6, #0
|
|
800f520: 341a adds r4, #26
|
|
800f522: 42b5 cmp r5, r6
|
|
800f524: d11a bne.n 800f55c <_printf_common+0xc8>
|
|
800f526: 2000 movs r0, #0
|
|
800f528: e008 b.n 800f53c <_printf_common+0xa8>
|
|
800f52a: 2301 movs r3, #1
|
|
800f52c: 4652 mov r2, sl
|
|
800f52e: 4641 mov r1, r8
|
|
800f530: 4638 mov r0, r7
|
|
800f532: 47c8 blx r9
|
|
800f534: 3001 adds r0, #1
|
|
800f536: d103 bne.n 800f540 <_printf_common+0xac>
|
|
800f538: f04f 30ff mov.w r0, #4294967295 @ 0xffffffff
|
|
800f53c: e8bd 87f0 ldmia.w sp!, {r4, r5, r6, r7, r8, r9, sl, pc}
|
|
800f540: 3501 adds r5, #1
|
|
800f542: e7c6 b.n 800f4d2 <_printf_common+0x3e>
|
|
800f544: 18e1 adds r1, r4, r3
|
|
800f546: 1c5a adds r2, r3, #1
|
|
800f548: 2030 movs r0, #48 @ 0x30
|
|
800f54a: f881 0043 strb.w r0, [r1, #67] @ 0x43
|
|
800f54e: 4422 add r2, r4
|
|
800f550: f894 1045 ldrb.w r1, [r4, #69] @ 0x45
|
|
800f554: f882 1043 strb.w r1, [r2, #67] @ 0x43
|
|
800f558: 3302 adds r3, #2
|
|
800f55a: e7c7 b.n 800f4ec <_printf_common+0x58>
|
|
800f55c: 2301 movs r3, #1
|
|
800f55e: 4622 mov r2, r4
|
|
800f560: 4641 mov r1, r8
|
|
800f562: 4638 mov r0, r7
|
|
800f564: 47c8 blx r9
|
|
800f566: 3001 adds r0, #1
|
|
800f568: d0e6 beq.n 800f538 <_printf_common+0xa4>
|
|
800f56a: 3601 adds r6, #1
|
|
800f56c: e7d9 b.n 800f522 <_printf_common+0x8e>
|
|
...
|
|
|
|
0800f570 <_printf_i>:
|
|
800f570: e92d 47ff stmdb sp!, {r0, r1, r2, r3, r4, r5, r6, r7, r8, r9, sl, lr}
|
|
800f574: 7e0f ldrb r7, [r1, #24]
|
|
800f576: 9e0c ldr r6, [sp, #48] @ 0x30
|
|
800f578: 2f78 cmp r7, #120 @ 0x78
|
|
800f57a: 4691 mov r9, r2
|
|
800f57c: 4680 mov r8, r0
|
|
800f57e: 460c mov r4, r1
|
|
800f580: 469a mov sl, r3
|
|
800f582: f101 0243 add.w r2, r1, #67 @ 0x43
|
|
800f586: d807 bhi.n 800f598 <_printf_i+0x28>
|
|
800f588: 2f62 cmp r7, #98 @ 0x62
|
|
800f58a: d80a bhi.n 800f5a2 <_printf_i+0x32>
|
|
800f58c: 2f00 cmp r7, #0
|
|
800f58e: f000 80d1 beq.w 800f734 <_printf_i+0x1c4>
|
|
800f592: 2f58 cmp r7, #88 @ 0x58
|
|
800f594: f000 80b8 beq.w 800f708 <_printf_i+0x198>
|
|
800f598: f104 0642 add.w r6, r4, #66 @ 0x42
|
|
800f59c: f884 7042 strb.w r7, [r4, #66] @ 0x42
|
|
800f5a0: e03a b.n 800f618 <_printf_i+0xa8>
|
|
800f5a2: f1a7 0363 sub.w r3, r7, #99 @ 0x63
|
|
800f5a6: 2b15 cmp r3, #21
|
|
800f5a8: d8f6 bhi.n 800f598 <_printf_i+0x28>
|
|
800f5aa: a101 add r1, pc, #4 @ (adr r1, 800f5b0 <_printf_i+0x40>)
|
|
800f5ac: f851 f023 ldr.w pc, [r1, r3, lsl #2]
|
|
800f5b0: 0800f609 .word 0x0800f609
|
|
800f5b4: 0800f61d .word 0x0800f61d
|
|
800f5b8: 0800f599 .word 0x0800f599
|
|
800f5bc: 0800f599 .word 0x0800f599
|
|
800f5c0: 0800f599 .word 0x0800f599
|
|
800f5c4: 0800f599 .word 0x0800f599
|
|
800f5c8: 0800f61d .word 0x0800f61d
|
|
800f5cc: 0800f599 .word 0x0800f599
|
|
800f5d0: 0800f599 .word 0x0800f599
|
|
800f5d4: 0800f599 .word 0x0800f599
|
|
800f5d8: 0800f599 .word 0x0800f599
|
|
800f5dc: 0800f71b .word 0x0800f71b
|
|
800f5e0: 0800f647 .word 0x0800f647
|
|
800f5e4: 0800f6d5 .word 0x0800f6d5
|
|
800f5e8: 0800f599 .word 0x0800f599
|
|
800f5ec: 0800f599 .word 0x0800f599
|
|
800f5f0: 0800f73d .word 0x0800f73d
|
|
800f5f4: 0800f599 .word 0x0800f599
|
|
800f5f8: 0800f647 .word 0x0800f647
|
|
800f5fc: 0800f599 .word 0x0800f599
|
|
800f600: 0800f599 .word 0x0800f599
|
|
800f604: 0800f6dd .word 0x0800f6dd
|
|
800f608: 6833 ldr r3, [r6, #0]
|
|
800f60a: 1d1a adds r2, r3, #4
|
|
800f60c: 681b ldr r3, [r3, #0]
|
|
800f60e: 6032 str r2, [r6, #0]
|
|
800f610: f104 0642 add.w r6, r4, #66 @ 0x42
|
|
800f614: f884 3042 strb.w r3, [r4, #66] @ 0x42
|
|
800f618: 2301 movs r3, #1
|
|
800f61a: e09c b.n 800f756 <_printf_i+0x1e6>
|
|
800f61c: 6833 ldr r3, [r6, #0]
|
|
800f61e: 6820 ldr r0, [r4, #0]
|
|
800f620: 1d19 adds r1, r3, #4
|
|
800f622: 6031 str r1, [r6, #0]
|
|
800f624: 0606 lsls r6, r0, #24
|
|
800f626: d501 bpl.n 800f62c <_printf_i+0xbc>
|
|
800f628: 681d ldr r5, [r3, #0]
|
|
800f62a: e003 b.n 800f634 <_printf_i+0xc4>
|
|
800f62c: 0645 lsls r5, r0, #25
|
|
800f62e: d5fb bpl.n 800f628 <_printf_i+0xb8>
|
|
800f630: f9b3 5000 ldrsh.w r5, [r3]
|
|
800f634: 2d00 cmp r5, #0
|
|
800f636: da03 bge.n 800f640 <_printf_i+0xd0>
|
|
800f638: 232d movs r3, #45 @ 0x2d
|
|
800f63a: 426d negs r5, r5
|
|
800f63c: f884 3043 strb.w r3, [r4, #67] @ 0x43
|
|
800f640: 4858 ldr r0, [pc, #352] @ (800f7a4 <_printf_i+0x234>)
|
|
800f642: 230a movs r3, #10
|
|
800f644: e011 b.n 800f66a <_printf_i+0xfa>
|
|
800f646: 6821 ldr r1, [r4, #0]
|
|
800f648: 6833 ldr r3, [r6, #0]
|
|
800f64a: 0608 lsls r0, r1, #24
|
|
800f64c: f853 5b04 ldr.w r5, [r3], #4
|
|
800f650: d402 bmi.n 800f658 <_printf_i+0xe8>
|
|
800f652: 0649 lsls r1, r1, #25
|
|
800f654: bf48 it mi
|
|
800f656: b2ad uxthmi r5, r5
|
|
800f658: 2f6f cmp r7, #111 @ 0x6f
|
|
800f65a: 4852 ldr r0, [pc, #328] @ (800f7a4 <_printf_i+0x234>)
|
|
800f65c: 6033 str r3, [r6, #0]
|
|
800f65e: bf14 ite ne
|
|
800f660: 230a movne r3, #10
|
|
800f662: 2308 moveq r3, #8
|
|
800f664: 2100 movs r1, #0
|
|
800f666: f884 1043 strb.w r1, [r4, #67] @ 0x43
|
|
800f66a: 6866 ldr r6, [r4, #4]
|
|
800f66c: 60a6 str r6, [r4, #8]
|
|
800f66e: 2e00 cmp r6, #0
|
|
800f670: db05 blt.n 800f67e <_printf_i+0x10e>
|
|
800f672: 6821 ldr r1, [r4, #0]
|
|
800f674: 432e orrs r6, r5
|
|
800f676: f021 0104 bic.w r1, r1, #4
|
|
800f67a: 6021 str r1, [r4, #0]
|
|
800f67c: d04b beq.n 800f716 <_printf_i+0x1a6>
|
|
800f67e: 4616 mov r6, r2
|
|
800f680: fbb5 f1f3 udiv r1, r5, r3
|
|
800f684: fb03 5711 mls r7, r3, r1, r5
|
|
800f688: 5dc7 ldrb r7, [r0, r7]
|
|
800f68a: f806 7d01 strb.w r7, [r6, #-1]!
|
|
800f68e: 462f mov r7, r5
|
|
800f690: 42bb cmp r3, r7
|
|
800f692: 460d mov r5, r1
|
|
800f694: d9f4 bls.n 800f680 <_printf_i+0x110>
|
|
800f696: 2b08 cmp r3, #8
|
|
800f698: d10b bne.n 800f6b2 <_printf_i+0x142>
|
|
800f69a: 6823 ldr r3, [r4, #0]
|
|
800f69c: 07df lsls r7, r3, #31
|
|
800f69e: d508 bpl.n 800f6b2 <_printf_i+0x142>
|
|
800f6a0: 6923 ldr r3, [r4, #16]
|
|
800f6a2: 6861 ldr r1, [r4, #4]
|
|
800f6a4: 4299 cmp r1, r3
|
|
800f6a6: bfde ittt le
|
|
800f6a8: 2330 movle r3, #48 @ 0x30
|
|
800f6aa: f806 3c01 strble.w r3, [r6, #-1]
|
|
800f6ae: f106 36ff addle.w r6, r6, #4294967295 @ 0xffffffff
|
|
800f6b2: 1b92 subs r2, r2, r6
|
|
800f6b4: 6122 str r2, [r4, #16]
|
|
800f6b6: f8cd a000 str.w sl, [sp]
|
|
800f6ba: 464b mov r3, r9
|
|
800f6bc: aa03 add r2, sp, #12
|
|
800f6be: 4621 mov r1, r4
|
|
800f6c0: 4640 mov r0, r8
|
|
800f6c2: f7ff fee7 bl 800f494 <_printf_common>
|
|
800f6c6: 3001 adds r0, #1
|
|
800f6c8: d14a bne.n 800f760 <_printf_i+0x1f0>
|
|
800f6ca: f04f 30ff mov.w r0, #4294967295 @ 0xffffffff
|
|
800f6ce: b004 add sp, #16
|
|
800f6d0: e8bd 87f0 ldmia.w sp!, {r4, r5, r6, r7, r8, r9, sl, pc}
|
|
800f6d4: 6823 ldr r3, [r4, #0]
|
|
800f6d6: f043 0320 orr.w r3, r3, #32
|
|
800f6da: 6023 str r3, [r4, #0]
|
|
800f6dc: 4832 ldr r0, [pc, #200] @ (800f7a8 <_printf_i+0x238>)
|
|
800f6de: 2778 movs r7, #120 @ 0x78
|
|
800f6e0: f884 7045 strb.w r7, [r4, #69] @ 0x45
|
|
800f6e4: 6823 ldr r3, [r4, #0]
|
|
800f6e6: 6831 ldr r1, [r6, #0]
|
|
800f6e8: 061f lsls r7, r3, #24
|
|
800f6ea: f851 5b04 ldr.w r5, [r1], #4
|
|
800f6ee: d402 bmi.n 800f6f6 <_printf_i+0x186>
|
|
800f6f0: 065f lsls r7, r3, #25
|
|
800f6f2: bf48 it mi
|
|
800f6f4: b2ad uxthmi r5, r5
|
|
800f6f6: 6031 str r1, [r6, #0]
|
|
800f6f8: 07d9 lsls r1, r3, #31
|
|
800f6fa: bf44 itt mi
|
|
800f6fc: f043 0320 orrmi.w r3, r3, #32
|
|
800f700: 6023 strmi r3, [r4, #0]
|
|
800f702: b11d cbz r5, 800f70c <_printf_i+0x19c>
|
|
800f704: 2310 movs r3, #16
|
|
800f706: e7ad b.n 800f664 <_printf_i+0xf4>
|
|
800f708: 4826 ldr r0, [pc, #152] @ (800f7a4 <_printf_i+0x234>)
|
|
800f70a: e7e9 b.n 800f6e0 <_printf_i+0x170>
|
|
800f70c: 6823 ldr r3, [r4, #0]
|
|
800f70e: f023 0320 bic.w r3, r3, #32
|
|
800f712: 6023 str r3, [r4, #0]
|
|
800f714: e7f6 b.n 800f704 <_printf_i+0x194>
|
|
800f716: 4616 mov r6, r2
|
|
800f718: e7bd b.n 800f696 <_printf_i+0x126>
|
|
800f71a: 6833 ldr r3, [r6, #0]
|
|
800f71c: 6825 ldr r5, [r4, #0]
|
|
800f71e: 6961 ldr r1, [r4, #20]
|
|
800f720: 1d18 adds r0, r3, #4
|
|
800f722: 6030 str r0, [r6, #0]
|
|
800f724: 062e lsls r6, r5, #24
|
|
800f726: 681b ldr r3, [r3, #0]
|
|
800f728: d501 bpl.n 800f72e <_printf_i+0x1be>
|
|
800f72a: 6019 str r1, [r3, #0]
|
|
800f72c: e002 b.n 800f734 <_printf_i+0x1c4>
|
|
800f72e: 0668 lsls r0, r5, #25
|
|
800f730: d5fb bpl.n 800f72a <_printf_i+0x1ba>
|
|
800f732: 8019 strh r1, [r3, #0]
|
|
800f734: 2300 movs r3, #0
|
|
800f736: 6123 str r3, [r4, #16]
|
|
800f738: 4616 mov r6, r2
|
|
800f73a: e7bc b.n 800f6b6 <_printf_i+0x146>
|
|
800f73c: 6833 ldr r3, [r6, #0]
|
|
800f73e: 1d1a adds r2, r3, #4
|
|
800f740: 6032 str r2, [r6, #0]
|
|
800f742: 681e ldr r6, [r3, #0]
|
|
800f744: 6862 ldr r2, [r4, #4]
|
|
800f746: 2100 movs r1, #0
|
|
800f748: 4630 mov r0, r6
|
|
800f74a: f7f0 fd31 bl 80001b0 <memchr>
|
|
800f74e: b108 cbz r0, 800f754 <_printf_i+0x1e4>
|
|
800f750: 1b80 subs r0, r0, r6
|
|
800f752: 6060 str r0, [r4, #4]
|
|
800f754: 6863 ldr r3, [r4, #4]
|
|
800f756: 6123 str r3, [r4, #16]
|
|
800f758: 2300 movs r3, #0
|
|
800f75a: f884 3043 strb.w r3, [r4, #67] @ 0x43
|
|
800f75e: e7aa b.n 800f6b6 <_printf_i+0x146>
|
|
800f760: 6923 ldr r3, [r4, #16]
|
|
800f762: 4632 mov r2, r6
|
|
800f764: 4649 mov r1, r9
|
|
800f766: 4640 mov r0, r8
|
|
800f768: 47d0 blx sl
|
|
800f76a: 3001 adds r0, #1
|
|
800f76c: d0ad beq.n 800f6ca <_printf_i+0x15a>
|
|
800f76e: 6823 ldr r3, [r4, #0]
|
|
800f770: 079b lsls r3, r3, #30
|
|
800f772: d413 bmi.n 800f79c <_printf_i+0x22c>
|
|
800f774: 68e0 ldr r0, [r4, #12]
|
|
800f776: 9b03 ldr r3, [sp, #12]
|
|
800f778: 4298 cmp r0, r3
|
|
800f77a: bfb8 it lt
|
|
800f77c: 4618 movlt r0, r3
|
|
800f77e: e7a6 b.n 800f6ce <_printf_i+0x15e>
|
|
800f780: 2301 movs r3, #1
|
|
800f782: 4632 mov r2, r6
|
|
800f784: 4649 mov r1, r9
|
|
800f786: 4640 mov r0, r8
|
|
800f788: 47d0 blx sl
|
|
800f78a: 3001 adds r0, #1
|
|
800f78c: d09d beq.n 800f6ca <_printf_i+0x15a>
|
|
800f78e: 3501 adds r5, #1
|
|
800f790: 68e3 ldr r3, [r4, #12]
|
|
800f792: 9903 ldr r1, [sp, #12]
|
|
800f794: 1a5b subs r3, r3, r1
|
|
800f796: 42ab cmp r3, r5
|
|
800f798: dcf2 bgt.n 800f780 <_printf_i+0x210>
|
|
800f79a: e7eb b.n 800f774 <_printf_i+0x204>
|
|
800f79c: 2500 movs r5, #0
|
|
800f79e: f104 0619 add.w r6, r4, #25
|
|
800f7a2: e7f5 b.n 800f790 <_printf_i+0x220>
|
|
800f7a4: 0801062a .word 0x0801062a
|
|
800f7a8: 0801063b .word 0x0801063b
|
|
|
|
0800f7ac <memmove>:
|
|
800f7ac: 4288 cmp r0, r1
|
|
800f7ae: b510 push {r4, lr}
|
|
800f7b0: eb01 0402 add.w r4, r1, r2
|
|
800f7b4: d902 bls.n 800f7bc <memmove+0x10>
|
|
800f7b6: 4284 cmp r4, r0
|
|
800f7b8: 4623 mov r3, r4
|
|
800f7ba: d807 bhi.n 800f7cc <memmove+0x20>
|
|
800f7bc: 1e43 subs r3, r0, #1
|
|
800f7be: 42a1 cmp r1, r4
|
|
800f7c0: d008 beq.n 800f7d4 <memmove+0x28>
|
|
800f7c2: f811 2b01 ldrb.w r2, [r1], #1
|
|
800f7c6: f803 2f01 strb.w r2, [r3, #1]!
|
|
800f7ca: e7f8 b.n 800f7be <memmove+0x12>
|
|
800f7cc: 4402 add r2, r0
|
|
800f7ce: 4601 mov r1, r0
|
|
800f7d0: 428a cmp r2, r1
|
|
800f7d2: d100 bne.n 800f7d6 <memmove+0x2a>
|
|
800f7d4: bd10 pop {r4, pc}
|
|
800f7d6: f813 4d01 ldrb.w r4, [r3, #-1]!
|
|
800f7da: f802 4d01 strb.w r4, [r2, #-1]!
|
|
800f7de: e7f7 b.n 800f7d0 <memmove+0x24>
|
|
|
|
0800f7e0 <_sbrk_r>:
|
|
800f7e0: b538 push {r3, r4, r5, lr}
|
|
800f7e2: 4d06 ldr r5, [pc, #24] @ (800f7fc <_sbrk_r+0x1c>)
|
|
800f7e4: 2300 movs r3, #0
|
|
800f7e6: 4604 mov r4, r0
|
|
800f7e8: 4608 mov r0, r1
|
|
800f7ea: 602b str r3, [r5, #0]
|
|
800f7ec: f7f1 faba bl 8000d64 <_sbrk>
|
|
800f7f0: 1c43 adds r3, r0, #1
|
|
800f7f2: d102 bne.n 800f7fa <_sbrk_r+0x1a>
|
|
800f7f4: 682b ldr r3, [r5, #0]
|
|
800f7f6: b103 cbz r3, 800f7fa <_sbrk_r+0x1a>
|
|
800f7f8: 6023 str r3, [r4, #0]
|
|
800f7fa: bd38 pop {r3, r4, r5, pc}
|
|
800f7fc: 20001084 .word 0x20001084
|
|
|
|
0800f800 <_realloc_r>:
|
|
800f800: e92d 41f0 stmdb sp!, {r4, r5, r6, r7, r8, lr}
|
|
800f804: 4607 mov r7, r0
|
|
800f806: 4614 mov r4, r2
|
|
800f808: 460d mov r5, r1
|
|
800f80a: b921 cbnz r1, 800f816 <_realloc_r+0x16>
|
|
800f80c: e8bd 41f0 ldmia.w sp!, {r4, r5, r6, r7, r8, lr}
|
|
800f810: 4611 mov r1, r2
|
|
800f812: f7ff bc5b b.w 800f0cc <_malloc_r>
|
|
800f816: b92a cbnz r2, 800f824 <_realloc_r+0x24>
|
|
800f818: f7ff fbec bl 800eff4 <_free_r>
|
|
800f81c: 4625 mov r5, r4
|
|
800f81e: 4628 mov r0, r5
|
|
800f820: e8bd 81f0 ldmia.w sp!, {r4, r5, r6, r7, r8, pc}
|
|
800f824: f000 f81a bl 800f85c <_malloc_usable_size_r>
|
|
800f828: 4284 cmp r4, r0
|
|
800f82a: 4606 mov r6, r0
|
|
800f82c: d802 bhi.n 800f834 <_realloc_r+0x34>
|
|
800f82e: ebb4 0f50 cmp.w r4, r0, lsr #1
|
|
800f832: d8f4 bhi.n 800f81e <_realloc_r+0x1e>
|
|
800f834: 4621 mov r1, r4
|
|
800f836: 4638 mov r0, r7
|
|
800f838: f7ff fc48 bl 800f0cc <_malloc_r>
|
|
800f83c: 4680 mov r8, r0
|
|
800f83e: b908 cbnz r0, 800f844 <_realloc_r+0x44>
|
|
800f840: 4645 mov r5, r8
|
|
800f842: e7ec b.n 800f81e <_realloc_r+0x1e>
|
|
800f844: 42b4 cmp r4, r6
|
|
800f846: 4622 mov r2, r4
|
|
800f848: 4629 mov r1, r5
|
|
800f84a: bf28 it cs
|
|
800f84c: 4632 movcs r2, r6
|
|
800f84e: f7ff fbc3 bl 800efd8 <memcpy>
|
|
800f852: 4629 mov r1, r5
|
|
800f854: 4638 mov r0, r7
|
|
800f856: f7ff fbcd bl 800eff4 <_free_r>
|
|
800f85a: e7f1 b.n 800f840 <_realloc_r+0x40>
|
|
|
|
0800f85c <_malloc_usable_size_r>:
|
|
800f85c: f851 3c04 ldr.w r3, [r1, #-4]
|
|
800f860: 1f18 subs r0, r3, #4
|
|
800f862: 2b00 cmp r3, #0
|
|
800f864: bfbc itt lt
|
|
800f866: 580b ldrlt r3, [r1, r0]
|
|
800f868: 18c0 addlt r0, r0, r3
|
|
800f86a: 4770 bx lr
|
|
|
|
0800f86c <_init>:
|
|
800f86c: b5f8 push {r3, r4, r5, r6, r7, lr}
|
|
800f86e: bf00 nop
|
|
800f870: bcf8 pop {r3, r4, r5, r6, r7}
|
|
800f872: bc08 pop {r3}
|
|
800f874: 469e mov lr, r3
|
|
800f876: 4770 bx lr
|
|
|
|
0800f878 <_fini>:
|
|
800f878: b5f8 push {r3, r4, r5, r6, r7, lr}
|
|
800f87a: bf00 nop
|
|
800f87c: bcf8 pop {r3, r4, r5, r6, r7}
|
|
800f87e: bc08 pop {r3}
|
|
800f880: 469e mov lr, r3
|
|
800f882: 4770 bx lr
|