Blame | Last modification | View Log | RSS feed
FlightCtrl.elf: file format elf32-avrSections:Idx Name Size VMA LMA File off Algn0 .data 000001ea 00800100 000164ce 00016562 2**0CONTENTS, ALLOC, LOAD, DATA1 .text 000164ce 00000000 00000000 00000094 2**1CONTENTS, ALLOC, LOAD, READONLY, CODE2 .bss 000009ef 008002ea 008002ea 0001674c 2**0ALLOC3 .comment 00000030 00000000 00000000 0001674c 2**0CONTENTS, READONLY4 .debug_aranges 00000580 00000000 00000000 00016780 2**3CONTENTS, READONLY, DEBUGGING5 .debug_info 00011ffe 00000000 00000000 00016d00 2**0CONTENTS, READONLY, DEBUGGING6 .debug_abbrev 00002459 00000000 00000000 00028cfe 2**0CONTENTS, READONLY, DEBUGGING7 .debug_line 0000a084 00000000 00000000 0002b157 2**0CONTENTS, READONLY, DEBUGGING8 .debug_frame 00001cc8 00000000 00000000 000351dc 2**2CONTENTS, READONLY, DEBUGGING9 .debug_str 000030b7 00000000 00000000 00036ea4 2**0CONTENTS, READONLY, DEBUGGING10 .debug_loc 000082f5 00000000 00000000 00039f5b 2**0CONTENTS, READONLY, DEBUGGING11 .debug_ranges 00000468 00000000 00000000 00042250 2**0CONTENTS, READONLY, DEBUGGINGDisassembly of section .text:00000000 <__vectors>:0: 0c 94 f0 0c jmp 0x19e0 ; 0x19e0 <__ctors_end>4: 0c 94 4a 0d jmp 0x1a94 ; 0x1a94 <__bad_interrupt>8: 0c 94 4a 0d jmp 0x1a94 ; 0x1a94 <__bad_interrupt>c: 0c 94 4a 0d jmp 0x1a94 ; 0x1a94 <__bad_interrupt>10: 0c 94 4a 0d jmp 0x1a94 ; 0x1a94 <__bad_interrupt>14: 0c 94 4a 0d jmp 0x1a94 ; 0x1a94 <__bad_interrupt>18: 0c 94 4a 0d jmp 0x1a94 ; 0x1a94 <__bad_interrupt>1c: 0c 94 4a 0d jmp 0x1a94 ; 0x1a94 <__bad_interrupt>20: 0c 94 4a 0d jmp 0x1a94 ; 0x1a94 <__bad_interrupt>24: 0c 94 6d 9f jmp 0x13eda ; 0x13eda <__vector_9>28: 0c 94 4a 0d jmp 0x1a94 ; 0x1a94 <__bad_interrupt>2c: 0c 94 4a 0d jmp 0x1a94 ; 0x1a94 <__bad_interrupt>30: 0c 94 b3 91 jmp 0x12366 ; 0x12366 <__vector_12>34: 0c 94 4a 0d jmp 0x1a94 ; 0x1a94 <__bad_interrupt>38: 0c 94 4a 0d jmp 0x1a94 ; 0x1a94 <__bad_interrupt>3c: 0c 94 4a 0d jmp 0x1a94 ; 0x1a94 <__bad_interrupt>40: 0c 94 4a 0d jmp 0x1a94 ; 0x1a94 <__bad_interrupt>44: 0c 94 4a 0d jmp 0x1a94 ; 0x1a94 <__bad_interrupt>48: 0c 94 64 9b jmp 0x136c8 ; 0x136c8 <__vector_18>4c: 0c 94 4a 0d jmp 0x1a94 ; 0x1a94 <__bad_interrupt>50: 0c 94 da a5 jmp 0x14bb4 ; 0x14bb4 <__vector_20>54: 0c 94 4a 0d jmp 0x1a94 ; 0x1a94 <__bad_interrupt>58: 0c 94 9e a5 jmp 0x14b3c ; 0x14b3c <__vector_22>5c: 0c 94 4a 0d jmp 0x1a94 ; 0x1a94 <__bad_interrupt>60: 0c 94 05 1c jmp 0x380a ; 0x380a <__vector_24>64: 0c 94 4a 0d jmp 0x1a94 ; 0x1a94 <__bad_interrupt>68: 0c 94 33 a1 jmp 0x14266 ; 0x14266 <__vector_26>6c: 0c 94 4a 0d jmp 0x1a94 ; 0x1a94 <__bad_interrupt>70: 0c 94 a1 1a jmp 0x3542 ; 0x3542 <__vector_28>74: 0c 94 4a 0d jmp 0x1a94 ; 0x1a94 <__bad_interrupt>78: 0c 94 f6 0f jmp 0x1fec ; 0x1fec <__vector_30>7c: 0c 94 4a 0d jmp 0x1a94 ; 0x1a94 <__bad_interrupt>80: 0c 94 4a 0d jmp 0x1a94 ; 0x1a94 <__bad_interrupt>84: 0c 94 4a 0d jmp 0x1a94 ; 0x1a94 <__bad_interrupt>88: 0c 94 4a 0d jmp 0x1a94 ; 0x1a94 <__bad_interrupt>8c: 32 1c adc r3, r28e: 3e 1c adc r3, r1490: 49 1c adc r4, r992: 56 1c adc r5, r694: 71 1c adc r7, r196: 8b 1c adc r8, r1198: 9d 1c adc r9, r139a: af 1c adc r10, r159c: 33 1d adc r19, r39e: bc 1f adc r27, r28a0: 5b 1e adc r5, r27a2: 6d 1e adc r6, r29a4: 7e 1e adc r7, r30a6: 95 1e adc r9, r21a8: b6 1e adc r11, r22aa: d6 1e adc r13, r22ac: 27 1f adc r18, r23ae: 78 1f adc r23, r24b0: 62 66 ori r22, 0x62 ; 98b2: a8 6a ori r26, 0xA8 ; 168b4: a0 70 andi r26, 0x00 ; 0b6: 13 74 andi r17, 0x43 ; 67b8: cf 75 andi r28, 0x5F ; 95ba: 71 77 andi r23, 0x71 ; 113bc: 4c 79 andi r20, 0x9C ; 156be: 72 66 ori r23, 0x62 ; 98c0: 3c 67 ori r19, 0x7C ; 124c2: 0b 68 ori r16, 0x8B ; 139c4: 8a 68 ori r24, 0x8A ; 138c6: d9 68 ori r29, 0x89 ; 137c8: 71 69 ori r23, 0x91 ; 145ca: 99 7b andi r25, 0xB9 ; 185cc: fa 69 ori r31, 0x9A ; 154ce: 7e 6a ori r23, 0xAE ; 174d0: 7e 6a ori r23, 0xAE ; 174d2: 7e 6a ori r23, 0xAE ; 174d4: 7e 6a ori r23, 0xAE ; 174d6: 7e 6a ori r23, 0xAE ; 174d8: 7e 6a ori r23, 0xAE ; 174da: 7e 6a ori r23, 0xAE ; 174dc: 7e 6a ori r23, 0xAE ; 174de: 7e 6a ori r23, 0xAE ; 174e0: b8 6a ori r27, 0xA8 ; 168e2: 76 6b ori r23, 0xB6 ; 182e4: 1a 6c ori r17, 0xCA ; 202e6: 57 6c ori r21, 0xC7 ; 199e8: cd 6c ori r28, 0xCD ; 205ea: 4e 6d ori r20, 0xDE ; 222ec: 43 6e ori r20, 0xE3 ; 227ee: ed 6f ori r30, 0xFD ; 253f0: 71 70 andi r23, 0x01 ; 1f2: 71 70 andi r23, 0x01 ; 1f4: 71 70 andi r23, 0x01 ; 1f6: 71 70 andi r23, 0x01 ; 1f8: 71 70 andi r23, 0x01 ; 1fa: 71 70 andi r23, 0x01 ; 1fc: 71 70 andi r23, 0x01 ; 1fe: 71 70 andi r23, 0x01 ; 1100: 71 70 andi r23, 0x01 ; 1102: b0 70 andi r27, 0x00 ; 0104: cf 70 andi r28, 0x0F ; 15106: fe 70 andi r31, 0x0E ; 14108: a3 71 andi r26, 0x13 ; 1910a: 0e 72 andi r16, 0x2E ; 4610c: ad 72 andi r26, 0x2D ; 4510e: ef 72 andi r30, 0x2F ; 47110: 87 73 andi r24, 0x37 ; 55112: 99 7b andi r25, 0xB9 ; 185114: e5 73 andi r30, 0x35 ; 53116: e5 73 andi r30, 0x35 ; 53118: e5 73 andi r30, 0x35 ; 5311a: e5 73 andi r30, 0x35 ; 5311c: e5 73 andi r30, 0x35 ; 5311e: e5 73 andi r30, 0x35 ; 53120: e5 73 andi r30, 0x35 ; 53122: e5 73 andi r30, 0x35 ; 53124: 9f 87 std Y+15, r25 ; 0x0f126: d4 88 ldd r13, Z+20 ; 0x14128: 71 89 ldd r23, Z+17 ; 0x1112a: f4 89 ldd r31, Z+20 ; 0x1412c: 36 8a std Z+22, r3 ; 0x1612e: da 8a std Y+18, r13 ; 0x12130: 64 8b std Z+20, r22 ; 0x14132: cb 8b std Y+19, r28 ; 0x13134: 5a 8c ldd r5, Y+26 ; 0x1a136: 98 8c ldd r9, Y+24 ; 0x18138: 15 8d ldd r17, Z+29 ; 0x1d13a: 43 8d ldd r20, Z+27 ; 0x1b13c: 71 8d ldd r23, Z+25 ; 0x1913e: cd 8d ldd r28, Y+29 ; 0x1d140: 21 8e std Z+25, r2 ; 0x19142: 7f 8e std Y+31, r7 ; 0x1f144: cd 8e std Y+29, r12 ; 0x1d146: 17 8f std Z+31, r17 ; 0x1f148: 8a 8f std Y+26, r24 ; 0x1a14a: a6 90 elpm r10, Z14c: 19 97 sbiw r26, 0x09 ; 914e: 7f 98 cbi 0x0f, 7 ; 15150: fa 98 cbi 0x1f, 2 ; 31152: b5 99 sbic 0x16, 5 ; 22154: 53 99 sbic 0x0a, 3 ; 10156: 85 99 sbic 0x10, 5 ; 16158: 58 97 sbiw r26, 0x18 ; 2415a: 27 98 cbi 0x04, 7 ; 415c: b5 99 sbic 0x16, 5 ; 2215e: b9 97 sbiw r30, 0x29 ; 41160: 53 a1 ldd r21, Z+35 ; 0x23162: b2 a1 ldd r27, Z+34 ; 0x22164: f1 a1 ldd r31, Z+33 ; 0x21166: 51 a2 std Z+33, r5 ; 0x21168: 70 a2 std Z+32, r7 ; 0x2016a: b1 a2 std Z+33, r11 ; 0x2116c: 6a a3 std Y+34, r22 ; 0x2216e: 7d a8 ldd r7, Y+53 ; 0x35170: 73 ab std Z+51, r23 ; 0x33172: 73 ab std Z+51, r23 ; 0x33174: 73 ab std Z+51, r23 ; 0x33176: 73 ab std Z+51, r23 ; 0x33178: 73 ab std Z+51, r23 ; 0x3317a: 73 ab std Z+51, r23 ; 0x3317c: 73 ab std Z+51, r23 ; 0x3317e: 73 ab std Z+51, r23 ; 0x33180: 73 ab std Z+51, r23 ; 0x33182: 73 ab std Z+51, r23 ; 0x33184: 73 ab std Z+51, r23 ; 0x33186: 73 ab std Z+51, r23 ; 0x33188: 73 ab std Z+51, r23 ; 0x3318a: 73 ab std Z+51, r23 ; 0x3318c: 73 ab std Z+51, r23 ; 0x3318e: 73 ab std Z+51, r23 ; 0x33190: 73 ab std Z+51, r23 ; 0x33192: 73 ab std Z+51, r23 ; 0x33194: 73 ab std Z+51, r23 ; 0x33196: 73 ab std Z+51, r23 ; 0x33198: 73 ab std Z+51, r23 ; 0x3319a: 73 ab std Z+51, r23 ; 0x3319c: 73 ab std Z+51, r23 ; 0x3319e: 73 ab std Z+51, r23 ; 0x331a0: 73 ab std Z+51, r23 ; 0x331a2: 73 ab std Z+51, r23 ; 0x331a4: ea a9 ldd r30, Y+50 ; 0x321a6: 73 ab std Z+51, r23 ; 0x331a8: 73 ab std Z+51, r23 ; 0x331aa: 73 ab std Z+51, r23 ; 0x331ac: e8 aa std Y+48, r14 ; 0x301ae: 73 ab std Z+51, r23 ; 0x331b0: 73 ab std Z+51, r23 ; 0x331b2: d6 a8 ldd r13, Z+54 ; 0x361b4: af a8 ldd r10, Y+55 ; 0x371b6: 73 ab std Z+51, r23 ; 0x331b8: 05 a9 ldd r16, Z+53 ; 0x351ba: 0c a9 ldd r16, Y+52 ; 0x341bc: 73 ab std Z+51, r23 ; 0x331be: 88 a9 ldd r24, Y+48 ; 0x301c0: 88 a8 ldd r8, Y+48 ; 0x301c2: 3e aa std Y+54, r3 ; 0x361c4: 73 ab std Z+51, r23 ; 0x331c6: 93 aa std Z+51, r9 ; 0x331c8: 73 ab std Z+51, r23 ; 0x331ca: 22 aa std Z+50, r2 ; 0x321cc: bd ab std Y+53, r27 ; 0x351ce: aa ac ldd r10, Y+58 ; 0x3a1d0: aa ac ldd r10, Y+58 ; 0x3a1d2: aa ac ldd r10, Y+58 ; 0x3a1d4: aa ac ldd r10, Y+58 ; 0x3a1d6: aa ac ldd r10, Y+58 ; 0x3a1d8: aa ac ldd r10, Y+58 ; 0x3a1da: aa ac ldd r10, Y+58 ; 0x3a1dc: aa ac ldd r10, Y+58 ; 0x3a1de: aa ac ldd r10, Y+58 ; 0x3a1e0: aa ac ldd r10, Y+58 ; 0x3a1e2: aa ac ldd r10, Y+58 ; 0x3a1e4: aa ac ldd r10, Y+58 ; 0x3a1e6: aa ac ldd r10, Y+58 ; 0x3a1e8: aa ac ldd r10, Y+58 ; 0x3a1ea: aa ac ldd r10, Y+58 ; 0x3a1ec: aa ac ldd r10, Y+58 ; 0x3a1ee: aa ac ldd r10, Y+58 ; 0x3a1f0: aa ac ldd r10, Y+58 ; 0x3a1f2: aa ac ldd r10, Y+58 ; 0x3a1f4: aa ac ldd r10, Y+58 ; 0x3a1f6: aa ac ldd r10, Y+58 ; 0x3a1f8: c8 ab std Y+48, r28 ; 0x301fa: d9 ab std Y+49, r29 ; 0x311fc: ec ab std Y+52, r30 ; 0x341fe: 29 ac ldd r2, Y+57 ; 0x39200: aa ac ldd r10, Y+58 ; 0x3a202: aa ac ldd r10, Y+58 ; 0x3a204: a7 ac ldd r10, Z+63 ; 0x3f206: 4f ac ldd r4, Y+63 ; 0x3f208: aa ac ldd r10, Y+58 ; 0x3a20a: aa ac ldd r10, Y+58 ; 0x3a20c: aa ac ldd r10, Y+58 ; 0x3a20e: 87 ac ldd r8, Z+63 ; 0x3f210: aa ac ldd r10, Y+58 ; 0x3a212: aa ac ldd r10, Y+58 ; 0x3a214: aa ac ldd r10, Y+58 ; 0x3a216: aa ac ldd r10, Y+58 ; 0x3a218: aa ac ldd r10, Y+58 ; 0x3a21a: aa ac ldd r10, Y+58 ; 0x3a21c: aa ac ldd r10, Y+58 ; 0x3a21e: 80 ab std Z+48, r24 ; 0x30220: aa ac ldd r10, Y+58 ; 0x3a222: 95 ac ldd r9, Z+61 ; 0x3d224: a3 18 sub r10, r3226: a6 18 sub r10, r6228: a6 18 sub r10, r622a: a6 18 sub r10, r622c: af 18 sub r10, r1522e: b2 18 sub r11, r2230: b5 18 sub r11, r5232: c7 18 sub r12, r7234: c4 18 sub r12, r400000236 <__trampolines_end>:236: 2e 00 .word 0x002e ; ????00000238 <__c.3073>:238: 0a 0d 4d 69 78 65 72 2d 43 6f 6e 66 69 67 3a 20 ..Mixer-Config:248: 27 25 73 27 20 28 25 75 20 4d 6f 74 6f 72 73 29 '%s' (%u Motors)...00000259 <__c.3068>:259: 0a 0d 47 65 6e 65 72 61 74 69 6e 67 20 64 65 66 ..Generating def269: 61 75 6c 74 20 4d 69 78 65 72 20 54 61 62 6c 65 ault Mixer Table...0000027a <__c.3066>:27a: 0a 0d 55 73 69 6e 67 20 50 61 72 61 6d 65 74 65 ..Using Paramete28a: 72 20 53 65 74 20 25 64 00 r Set %d.00000293 <__c.3057>:293: 0a 0d 47 65 6e 65 72 61 74 69 6e 67 20 64 65 66 ..Generating def2a3: 61 75 6c 74 20 50 61 72 61 6d 65 74 65 72 20 53 ault Parameter S2b3: 65 74 20 25 64 00 et %d.000002b9 <__c.3054>:2b9: 0a 0d 2d 2d 3e 20 48 61 72 64 77 61 72 65 20 56 ..--> Hardware V2c9: 65 72 73 69 6f 6e 20 42 79 74 65 20 43 68 61 6e ersion Byte Chan2d9: 67 65 64 20 3c 2d 2d 00 ged <--.000002e1 <__c.3166>:2e1: 0a 0d 47 79 72 6f 20 63 61 6c 69 62 72 61 74 69 ..Gyro calibrati2f1: 6f 6e 20 64 61 74 61 20 6e 6f 74 20 76 61 6c 69 on data not vali301: 64 0d 0a 00 d...00000305 <__c.3161>:305: 0a 0d 41 43 43 20 6e 6f 74 20 63 61 6c 69 62 72 ..ACC not calibr315: 61 74 65 64 21 0d 0a 00 ated!...0000031d <__c.3040>:31d: 1b 5b 32 4a 46 43 2d 53 74 61 72 74 21 0a 0d 46 .[2JFC-Start!..F32d: 6c 75 67 7a 65 69 74 3a 20 25 64 20 6d 69 6e 00 lugzeit: %d min.0000033d <__c.3038>:33d: 0a 0d 46 6c 69 67 68 74 2d 74 69 6d 65 20 25 75 ..Flight-time %u34d: 20 6d 69 6e 20 54 6f 74 61 6c 3a 25 75 20 6d 69 min Total:%u mi35d: 6e 00 n.0000035f <__c.3036>:35f: 4f 4b 0a 0d 00 OK...00000364 <__c.3031>:364: 0a 0d 43 61 6c 69 62 72 61 74 69 6e 67 20 70 72 ..Calibrating pr374: 65 73 73 75 72 65 20 73 65 6e 73 6f 72 2e 2e 00 essure sensor...00000384 <__c.3029>:384: 3c 2d 2d 20 77 61 72 6e 69 6e 67 20 6f 6c 64 20 <-- warning old394: 56 65 72 73 69 6f 6e 21 00 Version!.0000039d <__c.3027>:39d: 0a 0d 42 4c 2d 46 69 72 6d 77 61 72 65 20 25 64 ..BL-Firmware %d3ad: 2e 25 30 32 64 00 .%02d.000003b3 <__c.3022>:3b3: 0a 0d 0a 0d 21 21 20 4d 49 53 53 49 4e 47 20 42 ....!! MISSING B3c3: 4c 2d 43 54 52 4c 3a 20 25 64 20 21 21 00 L-CTRL: %d !!.000003d1 <__c.3017>:3d1: 25 64 00 %d.000003d4 <__c.3008>:3d4: 0a 0d 46 6f 75 6e 64 20 42 4c 2d 43 74 72 6c 3a ..Found BL-Ctrl:3e4: 20 00 .000003e6 <__c.2999>:3e6: 0a 0d 4f 6c 64 20 46 43 20 48 61 72 64 77 61 72 ..Old FC Hardwar3f6: 65 20 6e 6f 74 20 73 75 70 70 6f 72 74 65 64 20 e not supported406: 62 79 20 74 68 69 73 20 46 69 72 6d 77 61 72 65 by this Firmware416: 21 00 !.00000418 <__c.2985>:418: 20 20 41 75 74 6f 6c 61 6e 64 69 6e 67 3a 20 25 Autolanding: %428: 64 2e 25 64 56 00 d.%dV.0000042e <__c.2983>:42e: 20 20 41 75 74 6f 2d 43 48 3a 20 25 64 2e 25 64 Auto-CH: %d.%d43e: 56 00 V.00000440 <__c.2981>:440: 20 4c 6f 77 20 77 61 72 6e 69 6e 67 3a 20 25 64 Low warning: %d450: 2e 25 64 56 00 .%dV.00000455 <__c.2979>:455: 20 25 64 20 43 65 6c 6c 73 20 00 %d Cells .00000460 <__c.2977>:460: 0a 0d 42 61 74 74 3a 00 ..Batt:.00000468 <__c.2968>:468: 0a 0d 3d 3d 3d 3d 3d 3d 3d 3d 3d 3d 3d 3d 3d 3d ..==============478: 3d 3d 3d 3d 3d 3d 3d 3d 3d 3d 3d 3d 3d 3d 3d 3d ================488: 3d 3d 3d 3d 3d 00 =====.0000048e <__c.3496>:48e: 25 73 00 %s.00000491 <__c.3494>:491: 28 53 65 74 20 2d 3e 20 4c 6f 61 64 29 00 (Set -> Load).0000049f <__c.3492>:49f: 4e 6f 20 53 44 2d 43 61 72 64 20 20 20 00 No SD-Card .000004ad <__c.3490>:4ad: 2d 2d 00 --.000004b0 <__c.3488>:4b0: 25 32 64 00 %2d.000004b4 <__c.3486>:4b4: 20 20 20 00 .000004b8 <__c.3484>:4b8: 6c 6f 61 64 20 70 6f 69 6e 74 3a 00 load point:.000004c4 <__c.3479>:4c4: 43 61 6d 3a 20 25 33 69 00 Cam: %3i.000004cd <__c.3477>:4cd: 44 49 52 3a 20 25 33 64 25 63 00 DIR: %3d%c.000004d8 <__c.3475>:4d8: 41 4c 54 3a 25 34 69 6d 20 20 20 20 00 ALT:%4im .000004e5 <__c.3473>:4e5: 41 4c 54 3a 25 34 69 2f 25 69 6d 20 00 ALT:%4i/%im .000004f2 <__c.3470>:4f2: 57 50 3a 25 32 64 2f 25 64 20 44 69 73 74 3a 25 WP:%2d/%d Dist:%502: 33 64 6d 20 00 3dm .00000507 <__c.3468>:507: 20 25 32 69 3a 25 30 32 69 20 00 %2i:%02i .00000512 <__c.3466>:512: 20 25 32 69 2e 25 31 69 56 20 00 %2i.%1iV .0000051d <__c.3462>:51d: 4c 6f 61 64 20 73 69 6e 67 6c 65 20 50 6f 73 69 Load single Posi52d: 74 69 6f 6e 00 tion.00000532 <__c.3455>:532: 21 4e 6f 20 47 50 53 2d 46 69 78 21 20 00 !No GPS-Fix! .00000540 <__c.3453>:540: 28 53 65 74 20 2d 3e 20 53 74 6f 72 65 29 00 (Set -> Store).0000054f <__c.3451>:54f: 4e 6f 20 53 44 2d 43 61 72 64 20 20 20 00 No SD-Card .0000055d <__c.3449>:55d: 2d 2d 00 --.00000560 <__c.3447>:560: 25 32 64 20 00 %2d .00000565 <__c.3445>:565: 20 20 20 00 .00000569 <__c.3443>:569: 53 74 6f 72 65 20 70 6f 69 6e 74 3a 00 Store point:.00000576 <__c.3438>:576: 43 61 6d 3a 20 25 33 69 00 Cam: %3i.0000057f <__c.3436>:57f: 44 49 52 3a 20 25 33 64 25 63 00 DIR: %3d%c.0000058a <__c.3434>:58a: 41 4c 54 3a 25 34 69 6d 00 ALT:%4im.00000593 <__c.3431>:593: 20 25 32 69 3a 25 30 32 69 20 00 %2i:%02i .0000059e <__c.3429>:59e: 20 25 32 69 2e 25 31 69 56 20 00 %2i.%1iV .000005a9 <__c.3425>:5a9: 53 74 6f 72 65 20 73 69 6e 67 6c 65 20 50 6f 73 Store single Pos5b9: 69 74 69 6f 6e 00 ition.000005bf <__c.3418>:5bf: 20 20 20 20 20 20 20 20 20 20 20 20 20 00 .000005cd <__c.3416>:5cd: 28 53 65 74 20 2d 3e 20 4c 6f 61 64 29 00 (Set -> Load).000005db <__c.3414>:5db: 4e 6f 20 53 44 2d 43 61 72 64 20 20 20 00 No SD-Card .000005e9 <__c.3412>:5e9: 20 2d 2d 00 --.000005ed <__c.3410>:5ed: 25 32 64 20 28 46 49 58 29 00 %2d (FIX).000005f7 <__c.3408>:5f7: 20 20 20 00 .000005fb <__c.3406>:5fb: 4c 6f 61 64 20 6c 69 73 74 3a 00 Load list:.00000606 <__c.3401>:606: 25 73 00 %s.00000609 <__c.3399>:609: 25 32 69 2e 25 31 69 56 20 00 %2i.%1iV .00000613 <__c.3396>:613: 4e 6f 20 57 50 73 20 61 63 74 69 76 65 20 20 20 No WPs active623: 20 00 .00000625 <__c.3394>:625: 41 63 74 69 76 65 20 57 50 3a 25 32 64 2f 25 64 Active WP:%2d/%d635: 20 00 .00000637 <__c.3390>:637: 28 46 69 78 65 64 20 50 6f 73 69 74 69 6f 6e 73 (Fixed Positions647: 29 00 ).00000649 <__c.3388>:649: 4c 6f 61 64 20 57 61 79 70 6f 69 6e 74 73 00 Load Waypoints.00000658 <__c.3381>:658: 21 4e 6f 20 47 50 53 2d 46 69 78 21 20 00 !No GPS-Fix! .00000666 <__c.3379>:666: 20 20 20 20 20 20 20 20 20 20 20 20 20 00 .00000674 <__c.3377>:674: 28 53 65 74 20 2d 3e 20 4c 6f 61 64 29 00 (Set -> Load).00000682 <__c.3375>:682: 4e 6f 20 53 44 2d 43 61 72 64 20 20 20 00 No SD-Card .00000690 <__c.3373>:690: 4c 6f 61 64 20 6c 69 73 74 3a 20 2d 2d 20 00 Load list: -- .0000069f <__c.3371>:69f: 4c 6f 61 64 20 6c 69 73 74 3a 00 Load list:.000006aa <__c.3369>:6aa: 25 32 69 20 20 20 00 %2i .000006b1 <__c.3367>:6b1: 20 20 20 00 .000006b5 <__c.3362>:6b5: 25 73 00 %s.000006b8 <__c.3360>:6b8: 25 32 69 2e 25 31 69 56 20 00 %2i.%1iV .000006c2 <__c.3357>:6c2: 4e 6f 20 57 50 73 20 61 63 74 69 76 65 20 20 20 No WPs active6d2: 20 20 00 .000006d5 <__c.3355>:6d5: 41 63 74 69 76 65 20 57 50 3a 25 32 64 2f 25 64 Active WP:%2d/%d6e5: 20 00 .000006e7 <__c.3351>:6e7: 28 52 65 6c 61 74 69 76 65 20 50 6f 73 69 74 69 (Relative Positi6f7: 6f 6e 73 29 00 ons).000006fc <__c.3349>:6fc: 4c 6f 61 64 20 57 61 79 70 6f 69 6e 74 73 00 Load Waypoints.0000070b <__c.3333>:70b: 43 4f 4d 50 41 53 53 20 4f 46 46 21 20 00 COMPASS OFF! .00000719 <__c.3331>:719: 48 48 21 20 00 HH! .0000071e <__c.3329>:71e: 4c 4f 4f 50 49 4e 47 21 20 00 LOOPING! .00000728 <__c.3327>:728: 43 4f 55 50 4c 49 4e 47 20 4f 46 46 21 20 00 COUPLING OFF! .00000737 <__c.3324>:737: 50 34 3a 25 34 69 20 50 35 3a 25 34 69 20 36 3a P4:%4i P5:%4i 6:747: 25 33 69 00 %3i.0000074b <__c.3322>:74b: 50 31 3a 25 34 69 20 50 32 3a 25 34 69 20 33 3a P1:%4i P2:%4i 3:75b: 25 33 69 00 %3i.0000075f <__c.3320>:75f: 47 73 3a 25 34 69 20 59 61 3a 25 34 69 20 00 Gs:%4i Ya:%4i .0000076e <__c.3318>:76e: 4e 69 3a 25 34 69 20 52 6f 3a 25 34 69 20 43 3a Ni:%4i Ro:%4i C:77e: 25 33 69 00 %3i.00000782 <__c.3315>:782: 48 4f 4c 44 20 00 HOLD .00000788 <__c.3313>:788: 25 75 6d 00 %um.0000078c <__c.3311>:78c: 48 4f 4d 45 20 41 4c 54 3a 00 HOME ALT:.00000796 <__c.3308>:796: 20 46 53 3a 25 75 73 65 6b 20 00 FS:%usek .000007a1 <__c.3306>:7a1: 28 48 4f 4c 44 29 00 (HOLD).000007a8 <__c.3304>:7a8: 28 41 49 44 29 20 00 (AID) .000007af <__c.3302>:7af: 28 48 4f 4d 45 29 00 (HOME).000007b6 <__c.3300>:7b6: 28 46 52 45 45 29 00 (FREE).000007bd <__c.3298>:7bd: 44 49 53 41 42 4c 45 44 00 DISABLED.000007c6 <__c.3296>:7c6: 47 50 53 3a 00 GPS:.000007cb <__c.3293>:7cb: 20 54 45 41 43 48 00 TEACH.000007d2 <__c.3291>:7d2: 20 28 4f 46 46 29 00 (OFF).000007d9 <__c.3289>:7d9: 20 28 4f 4e 29 20 00 (ON) .000007e0 <__c.3287>:7e0: 44 49 53 41 42 4c 45 44 00 DISABLED.000007e9 <__c.3285>:7e9: 43 46 3a 00 CF:.000007ed <__c.3282>:7ed: 44 49 53 41 42 4c 45 44 00 DISABLED.000007f6 <__c.3280>:7f6: 56 41 52 49 4f 00 VARIO.000007fc <__c.3278>:7fc: 4c 49 4d 49 54 00 LIMIT.00000802 <__c.3276>:802: 28 4f 46 46 29 20 00 (OFF) .00000809 <__c.3274>:809: 28 4f 4e 29 20 20 00 (ON) .00000810 <__c.3272>:810: 50 4f 54 49 3a 25 33 75 20 00 POTI:%3u .0000081a <__c.3270>:81a: 41 4c 54 3a 00 ALT:.0000081f <__c.3267>:81f: 4d 69 6e 3a 25 32 69 2e 25 31 69 56 20 25 73 20 Min:%2i.%1iV %s...00000830 <__c.3263>:830: 53 65 74 74 69 6e 67 3a 25 75 20 25 73 20 00 Setting:%u %s .0000083f <__c.3249>:83f: 20 77 77 77 2e 4d 69 6b 72 6f 4b 6f 70 74 65 72 www.MikroKopter84f: 2e 64 65 20 20 00 .de .00000855 <__c.3247>:855: 21 21 20 4c 69 50 6f 20 76 6f 6c 74 61 67 65 20 !! LiPo voltage865: 21 21 00 !!.00000868 <__c.3245>:868: 45 52 52 3a 20 00 ERR: .0000086e <__c.3243>:86e: 45 52 52 3a 20 25 32 64 20 21 00 ERR: %2d !.00000879 <__c.3240>:879: 25 33 69 20 25 33 69 20 25 33 69 20 25 33 69 25 %3i %3i %3i %3i%889: 63 43 00 cC.0000088c <__c.3238>:88c: 25 33 69 20 25 33 69 25 63 43 20 20 20 20 20 20 %3i %3i%cC89c: 20 20 00 .0000089f <__c.3236>:89f: 25 32 69 2e 25 69 20 25 32 69 2e 25 69 20 25 32 %2i.%i %2i.%i %28af: 69 2e 25 69 20 25 32 69 2e 25 69 41 00 i.%i %2i.%iA.000008bc <__c.3234>:8bc: 25 32 69 2e 25 69 20 25 32 69 2e 25 69 41 00 %2i.%i %2i.%iA.000008cb <__c.3231>:8cb: 25 33 69 20 25 33 69 20 25 33 69 20 25 33 69 25 %3i %3i %3i %3i%8db: 63 43 00 cC.000008de <__c.3229>:8de: 25 32 69 2e 25 69 20 25 32 69 2e 25 69 20 25 32 %2i.%i %2i.%i %28ee: 69 2e 25 69 20 25 32 69 2e 25 69 41 00 i.%i %2i.%iA.000008fb <__c.3226>:8fb: 20 20 20 4e 6f 20 4e 61 76 69 43 74 72 6c 20 20 No NaviCtrl90b: 20 20 20 20 20 00 .00000911 <__c.3224>:911: 44 47 50 53 20 00 DGPS .00000917 <__c.3222>:917: 4e 4f 46 49 58 00 NOFIX.0000091d <__c.3218>:91d: 20 20 33 44 20 00 3D .00000923 <__c.3215>:923: 47 50 53 3a 25 32 75 6d 2f 73 20 53 41 54 3a 25 GPS:%2um/s SAT:%933: 64 20 00 d .00000936 <__c.3212>:936: 20 20 00 .00000939 <__c.3210>:939: 43 46 00 CF.0000093c <__c.3208>:93c: 50 57 52 3a 25 32 69 2e 25 31 69 41 20 28 25 69 PWR:%2i.%1iA (%i94c: 57 29 20 00 W) .00000950 <__c.3205>:950: 48 4d 3a 25 33 64 25 63 20 20 44 49 53 54 3a 25 HM:%3d%c DIST:%960: 33 64 6d 20 25 63 00 3dm %c.00000967 <__c.3202>:967: 25 63 00 %c.0000096a <__c.3200>:96a: 41 4c 54 3a 2d 2d 2d 2d 20 00 ALT:---- .00000974 <__c.3198>:974: 41 4c 54 3a 25 34 69 6d 00 ALT:%4im.0000097d <__c.3196>:97d: 41 4c 54 3a 25 34 69 6d 00 ALT:%4im.00000986 <__c.3194>:986: 44 49 52 3a 25 33 64 25 63 00 DIR:%3d%c.00000990 <__c.3190>:990: 20 25 32 69 3a 25 30 32 69 20 20 25 32 69 2e 25 %2i:%02i %2i.%9a0: 31 69 56 20 25 34 69 6d 41 68 00 1iV %4imAh.000009ab <__c.3188>:9ab: 20 25 32 69 3a 25 30 32 69 20 20 25 32 69 2e 25 %2i:%02i %2i.%9bb: 31 69 56 20 25 34 69 6d 41 68 00 1iV %4imAh.000009c6 <__c.3173>:9c6: 20 77 77 77 2e 4d 69 6b 72 6f 4b 6f 70 74 65 72 www.MikroKopter9d6: 2e 64 65 20 20 00 .de .000009dc <__c.3171>:9dc: 21 21 20 4c 69 50 6f 20 76 6f 6c 74 61 67 65 20 !! LiPo voltage9ec: 21 21 00 !!.000009ef <__c.3169>:9ef: 45 52 52 3a 20 00 ERR: .000009f5 <__c.3167>:9f5: 45 52 52 3a 20 25 32 64 20 21 00 ERR: %2d !.00000a00 <__c.3163>:a00: 20 20 20 20 25 32 75 6d 2f 73 3a 20 20 48 4d 3a %2um/s: HM:a10: 25 33 64 25 63 20 25 63 00 %3d%c %c.00000a19 <__c.3161>:a19: 69 6e 63 6c 3a 25 32 64 25 63 28 25 32 69 29 00 incl:%2d%c(%2i).00000a29 <__c.3159>:a29: 48 4d 3a 25 33 64 25 63 20 25 63 00 HM:%3d%c %c.00000a35 <__c.3157>:a35: 4d 41 47 3a 25 33 75 25 25 20 00 MAG:%3u%% .00000a40 <__c.3154>:a40: 21 21 00 !!.00000a43 <__c.3150>:a43: 33 44 00 3D.00000a46 <__c.3148>:a46: 44 20 00 D .00000a49 <__c.3145>:a49: 44 49 53 54 3a 25 33 64 6d 00 DIST:%3dm.00000a53 <__c.3143>:a53: 53 41 54 3a 25 32 64 20 00 SAT:%2d .00000a5c <__c.3141>:a5c: 3a 00 :.00000a5e <__c.3138>:a5e: 2d 2d 2d 2d 2d 2d 2d 2d 2d 2d 2d 2d 2d 2d 2d 2d ----------------a6e: 2d 2d 2d 2d 2d 00 -----.00000a74 <__c.3136>:a74: 2d 2d 2d 2d 2d 2d 2d 2d 2d 2b 2d 2d 2d 2d 2d 2d ---------+------a84: 2d 2d 2d 2d 2d 00 -----.00000a8a <__c.3134>:a8a: 3a 00 :.00000a8c <__c.3132>:a8c: 3a 00 :.00000a8e <__c.3130>:a8e: 3a 00 :.00000a90 <__c.3127>:a90: 49 3a 25 32 69 2e 25 31 69 41 20 00 I:%2i.%1iA .00000a9c <__c.3125>:a9c: 20 20 25 35 69 20 20 00 %5i .00000aa4 <__c.3123>:aa4: 20 20 25 35 69 20 20 00 %5i .00000aac <__c.3120>:aac: 20 00 .00000aae <__c.3118>:aae: 43 00 C.00000ab0 <__c.3116>:ab0: 44 49 52 3a 20 25 33 64 25 63 00 DIR: %3d%c.00000abb <__c.3114>:abb: 20 20 25 32 69 3a 25 30 32 69 20 20 00 %2i:%02i .00000ac8 <__c.3112>:ac8: 20 20 25 32 69 3a 25 30 32 69 20 20 00 %2i:%02i .00000ad5 <__c.3108>:ad5: 41 4c 54 3a 2d 2d 2d 2d 20 00 ALT:---- .00000adf <__c.3106>:adf: 41 4c 54 3a 25 34 69 6d 20 20 00 ALT:%4im .00000aea <__c.3104>:aea: 41 4c 54 3a 25 34 69 6d 20 25 63 00 ALT:%4im %c.00000af6 <__c.3102>:af6: 20 20 25 32 69 2e 25 31 69 56 20 20 00 %2i.%1iV .00000b03 <__c.3100>:b03: 20 20 25 32 69 2e 25 31 69 56 20 20 00 %2i.%1iV .00000b10 <__c.2991>:b10: 20 20 20 20 20 20 20 20 20 20 20 20 20 20 20 20b20: 20 20 20 20 20 00 .00000b26 <HOTT_ERROR>:b26: 00 00 05 00 05 00 04 01 06 01 08 00 06 01 02 00 ................b36: 04 00 04 00 07 00 07 00 07 00 07 00 07 00 07 00 ................b46: 07 00 03 01 03 01 05 00 17 01 0f 01 06 00 09 01 ................b56: 0a 01 19 01 05 01 05 01 19 01 1a 01 0f 01 01 00 ................b66: 09 00 06 00 06 00 ......00000b6c <NC_ERROR_TEXT>:b6c: 4e 6f 20 45 72 72 6f 72 20 20 20 20 20 20 20 20 No Errorb7c: 00 4e 6f 74 20 63 6f 6d 70 61 74 69 62 6c 65 20 .Not compatibleb8c: 20 00 4d 4b 33 4d 61 67 20 6e 6f 74 20 63 6f 6d .MK3Mag not comb9c: 70 61 00 4e 6f 20 46 43 20 63 6f 6d 6d 75 6e 69 pa.No FC communibac: 63 61 74 00 43 6f 6d 70 61 73 73 20 63 6f 6d 6d cat.Compass commbbc: 75 6e 69 63 00 47 50 53 20 63 6f 6d 6d 75 6e 69 unic.GPS communibcc: 63 61 74 69 6f 00 63 6f 6d 70 61 73 73 20 76 61 catio.compass vabdc: 6c 75 65 20 20 20 00 52 43 20 53 69 67 6e 61 6c lue .RC Signalbec: 20 6c 6f 73 74 20 20 00 46 43 20 73 70 69 20 72 lost .FC spi rbfc: 78 20 65 72 72 6f 72 20 00 4e 6f 20 4e 43 20 63 x error .No NC cc0c: 6f 6d 6d 75 6e 69 63 61 74 00 46 43 20 4e 69 63 ommunicat.FC Nicc1c: 6b 20 47 79 72 6f 20 20 20 20 00 46 43 20 52 6f k Gyro .FC Roc2c: 6c 6c 20 47 79 72 6f 20 20 20 20 00 46 43 20 59 ll Gyro .FC Yc3c: 61 77 20 47 79 72 6f 20 20 20 20 20 00 46 43 20 aw Gyro .FCc4c: 4e 69 63 6b 20 41 43 43 20 20 20 20 20 00 46 43 Nick ACC .FCc5c: 20 52 6f 6c 6c 20 41 43 43 20 20 20 20 20 00 46 Roll ACC .Fc6c: 43 20 5a 2d 41 43 43 20 20 20 20 20 20 20 20 00 C Z-ACC .c7c: 50 72 65 73 73 75 72 65 20 73 65 6e 73 6f 72 20 Pressure sensorc8c: 00 49 32 43 20 46 43 2d 3e 42 4c 2d 43 74 72 6c .I2C FC->BL-Ctrlc9c: 20 00 42 6c 20 4d 69 73 73 69 6e 67 20 20 20 20 .Bl Missingcac: 20 20 00 4d 69 78 65 72 20 45 72 72 6f 72 20 20 .Mixer Errorcbc: 20 20 20 00 43 61 72 65 66 72 65 65 20 45 72 72 .Carefree Errccc: 6f 72 20 20 00 47 50 53 20 46 69 78 20 6c 6f 73 or .GPS Fix loscdc: 74 20 20 20 20 00 4d 61 67 6e 65 74 20 45 72 72 t .Magnet Errcec: 6f 72 20 20 20 20 00 4d 6f 74 6f 72 20 72 65 73 or .Motor rescfc: 74 61 72 74 20 20 20 00 42 4c 20 4c 69 6d 69 74 tart .BL Limitd0c: 61 74 69 6f 6e 20 20 20 00 47 50 53 20 52 61 6e ation .GPS Rand1c: 67 65 20 20 20 20 20 20 20 00 4e 6f 20 53 44 2d ge .No SD-d2c: 43 61 72 64 20 20 20 20 20 20 00 53 44 2d 4c 6f Card .SD-Lod3c: 67 67 69 6e 67 20 65 72 72 6f 72 00 46 6c 79 69 gging error.Flyid4c: 6e 67 20 72 61 6e 67 65 21 20 20 20 00 4d 61 78 ng range! .Maxd5c: 20 41 6c 74 69 74 75 64 65 21 20 20 20 00 4e 6f Altitude! .Nod6c: 20 47 50 53 20 66 69 78 20 20 20 20 20 20 00 63 GPS fix .cd7c: 6f 6d 70 61 73 73 20 6e 6f 74 20 63 61 6c 2e 00 ompass not cal..d8c: 42 4c 2d 53 65 6c 66 74 65 73 74 20 20 20 20 20 BL-Selftestd9c: 00 6e 6f 20 65 78 74 2e 20 63 6f 6d 70 61 73 73 .no ext. compassdac: 20 00 63 6f 6d 70 61 73 73 20 73 65 6e 73 6f 72 .compass sensordbc: 20 20 00 .00000dbf <SETTING>:dbf: 53 65 74 20 20 3a 00 Set :.00000dc6 <BOAT_MODE>:dc6: 20 4d 69 6b 72 6f 4b 6f 70 74 65 72 20 28 42 6f MikroKopter (Bodd6: 61 74 29 20 20 00 at) .00000ddc <SIMULATION>:ddc: 20 20 53 49 4d 55 4c 41 54 49 4f 4e 20 61 63 74 SIMULATION actdec: 69 76 65 20 20 00 ive .00000df2 <LANDING>:df2: 20 21 21 20 20 20 4c 41 4e 44 49 4e 47 20 20 20 !! LANDINGe02: 20 21 21 20 20 00 !! .00000e08 <UNDERVOLTAGE>:e08: 20 21 21 20 4c 69 50 6f 20 76 6f 6c 74 61 67 65 !! LiPo voltagee18: 20 21 21 20 20 00 !! .00000e1e <MIKROKOPTER>:e1e: 20 20 20 20 20 4d 69 6b 72 6f 4b 6f 70 74 65 72 MikroKoptere2e: 20 20 20 20 20 00 .00000e34 <__c.3126>:e34: 4e 6f 20 4e 61 76 69 43 74 72 6c 21 00 No NaviCtrl!.00000e41 <__c.3124>:e41: 48 6f 6d 65 3a 25 33 64 6d 20 25 33 64 25 63 20 Home:%3dm %3d%ce51: 25 63 00 %c.00000e54 <__c.3122>:e54: 44 47 50 53 00 DGPS.00000e59 <__c.3120>:e59: 4e 6f 46 78 00 NoFx.00000e5e <__c.3116>:e5e: 20 20 33 44 00 3D.00000e63 <__c.3113>:e63: 25 32 75 6d 2f 73 20 53 61 74 3a 25 64 20 00 %2um/s Sat:%d .00000e72 <__c.3108>:e72: 20 20 00 .00000e75 <__c.3106>:e75: 2d 3e 00 ->.00000e78 <__c.3104>:e78: 2d 2d 2f 2d 2d 00 --/--.00000e7e <__c.3102>:e7e: 25 32 64 2f 25 64 20 00 %2d/%d .00000e86 <__c.3100>:e86: 23 25 32 64 20 57 50 73 3a 00 #%2d WPs:.00000e90 <__c.3098>:e90: 6e 6f 20 47 50 53 2d 46 69 78 00 no GPS-Fix.00000e9b <__c.3096>:e9b: 6e 6f 20 53 44 2d 43 61 72 64 00 no SD-Card.00000ea6 <__c.3094>:ea6: 52 65 6c 3a 25 73 00 Rel:%s.00000ead <__c.3092>:ead: 52 65 6c 61 74 69 76 65 20 57 50 73 20 00 Relative WPs .00000ebb <__c.3085>:ebb: 20 20 00 .00000ebe <__c.3083>:ebe: 2d 3e 00 ->.00000ec1 <__c.3081>:ec1: 2d 2d 2f 2d 2d 00 --/--.00000ec7 <__c.3079>:ec7: 25 32 64 2f 25 64 20 00 %2d/%d .00000ecf <__c.3077>:ecf: 23 25 32 64 20 57 50 3a 00 #%2d WP:.00000ed8 <__c.3075>:ed8: 6e 6f 20 53 44 2d 43 61 72 64 00 no SD-Card.00000ee3 <__c.3073>:ee3: 46 49 58 3a 25 73 00 FIX:%s.00000eea <__c.3071>:eea: 46 49 58 20 57 61 79 70 6f 69 6e 74 73 00 FIX Waypoints.00000ef8 <__c.3064>:ef8: 20 20 00 .00000efb <__c.3062>:efb: 2d 3e 00 ->.00000efe <__c.3060>:efe: 20 20 20 20 20 20 20 20 20 20 20 20 20 20 20 20...00000f0f <__c.3058>:f0f: 44 69 73 74 3a 25 33 64 20 41 6c 74 3a 25 33 64 Dist:%3d Alt:%3df1f: 20 00 .00000f21 <__c.3056>:f21: 25 32 64 00 %2d.00000f25 <__c.3054>:f25: 6e 6f 20 53 44 2d 43 61 72 64 00 no SD-Card.00000f30 <__c.3052>:f30: 4c 6f 61 64 20 50 6f 69 6e 74 00 Load Point.00000f3b <__c.3045>:f3b: 20 20 00 .00000f3e <__c.3043>:f3e: 2d 3e 00 ->.00000f41 <__c.3041>:f41: 44 69 72 3a 25 33 64 20 41 6c 74 3a 25 33 64 6d Dir:%3d Alt:%3dm...00000f52 <__c.3039>:f52: 25 32 64 00 %2d.00000f56 <__c.3037>:f56: 6e 6f 20 47 50 53 2d 46 69 78 00 no GPS-Fix.00000f61 <__c.3035>:f61: 6e 6f 20 53 44 2d 43 61 72 64 00 no SD-Card.00000f6c <__c.3033>:f6c: 53 61 76 65 20 50 6f 69 6e 74 3a 00 Save Point:.00000f78 <__c.3026>:f78: 53 61 76 65 20 73 69 6e 67 6c 2e 50 6f 69 6e 74 Save singl.Point...00000f89 <__c.3021>:f89: 4c 6f 61 64 20 73 69 6e 67 6c 2e 50 6f 69 6e 74 Load singl.Point...00000f9a <__c.3016>:f9a: 28 52 65 6c 61 74 69 76 65 29 20 20 20 00 (Relative) .00000fa8 <__c.3014>:fa8: 4c 6f 61 64 20 57 61 79 70 6f 69 6e 74 73 00 Load Waypoints.00000fb7 <__c.3009>:fb7: 28 46 69 78 65 64 29 20 20 20 20 20 20 00 (Fixed) .00000fc5 <__c.3007>:fc5: 4c 6f 61 64 20 57 61 79 70 6f 69 6e 74 73 00 Load Waypoints.00000fd4 <__c.3002>:fd4: 49 6e 63 6c 69 2e 3a 25 33 69 25 63 20 28 25 69 Incli.:%3i%c (%ife4: 29 20 00 ) .00000fe7 <__c.3000>:fe7: 4d 61 67 6e 65 74 3a 25 33 69 25 25 20 25 33 69 Magnet:%3i%% %3iff7: 25 63 00 %c.00000ffa <__c.2995>:ffa: 25 34 69 57 20 25 36 69 6d 41 68 00 %4iW %6imAh.00001006 <__c.2993>:1006: 25 32 69 2e 25 31 69 56 20 25 33 69 2e 25 31 69 %2i.%1iV %3i.%1i1016: 41 00 A.00001018 <__c.2988>:1018: 25 63 43 20 20 20 20 20 00 %cC .00001021 <__c.2986>:1021: 54 65 6d 70 65 72 61 74 75 72 65 73 20 20 20 20 Temperatures...00001032 <__c.2984>:1032: 25 33 69 20 25 33 69 20 25 33 69 20 25 33 69 00 %3i %3i %3i %3i.00001042 <__c.2982>:1042: 25 33 69 20 25 33 69 20 25 33 69 20 25 33 69 00 %3i %3i %3i %3i.00001052 <__c.2977>:1052: 52 00 R.00001054 <__c.2975>:1054: 25 34 69 6d 25 63 00 %4im%c.0000105b <__c.2973>:105b: 25 34 69 20 25 32 69 3a 25 30 32 69 00 %4i %2i:%02i.00001068 <__c.2971>:1068: 28 42 6f 61 74 2d 4d 6f 64 65 29 00 (Boat-Mode).00001074 <__c.2969>:1074: 53 65 74 25 64 3a 25 73 00 Set%d:%s.0000107d <__c.2967>:107d: 53 49 4d 55 4c 41 54 49 4f 4e 00 SIMULATION.00001088 <__c.2965>:1088: 45 52 52 4f 52 3a 20 25 32 64 20 00 ERROR: %2d .00001094 <__c.2961>:1094: 53 74 61 74 75 73 20 20 20 20 00 Status .0000109f <__c.2959>:109f: 25 33 64 25 63 20 25 33 64 6d 25 63 00 %3d%c %3dm%c.000010ac <__c.2957>:10ac: 25 32 69 2e 25 31 69 56 00 %2i.%1iV.000010b5 <JetiBox_Menu>:10b5: 08 01 00 00 ea 81 00 02 01 01 b0 7b 01 03 02 02 ...........{....10c5: 2f 7c 02 04 03 03 35 81 03 05 04 09 ec 7c 04 06 /|....5......|..10d5: 05 0a 17 7d 05 07 06 0b 42 7d 06 08 07 0c 57 7d ...}....B}....W}10e5: 07 00 08 06 a8 7c 04 09 09 09 31 7f 05 0a 0a 0a .....|....1.....10f5: 26 80 06 0b 0b 0b 4c 7e 07 0c 0c 0c 6c 7d &.....L~....l}00001103 <JETI_CODE>:1103: 00 4f 50 51 52 53 54 53 56 57 48 00 58 59 00 5a .OPQRSTSVWH.XY.Z1113: 55 45 46 47 48 41 00 49 42 4a 4a 00 00 00 00 00 UEFGHA.IBJJ.....1123: 00 00 00 00 00 00 44 4c 4d 00 00 00 00 00 4e 00 ......DLM.....N.1133: 00 00 4b 00 43 ..K.C00001138 <__c.3160>:1138: 25 31 64 2e 25 30 32 64 20 25 31 64 2e 25 30 32 %1d.%02d %1d.%021148: 64 20 25 31 64 2e 25 30 32 64 20 25 31 64 2e 25 d %1d.%02d %1d.%1158: 30 32 64 00 02d.0000115c <__c.3158>:115c: 42 4c 20 56 65 72 73 69 6f 6e 73 00 BL Versions.00001168 <__c.3155>:1168: 31 32 00 12.0000116b <__c.3153>:116b: 31 31 00 11.0000116e <__c.3151>:116e: 31 30 00 10.00001171 <__c.3149>:1171: 20 25 63 20 20 20 2d 20 20 20 2d 20 20 20 2d 20 %c - - -...00001182 <__c.3147>:1182: 20 25 63 20 20 20 25 63 20 20 20 25 63 20 20 20 %c %c %c1192: 25 63 20 00 %c .00001196 <__c.3145>:1196: 20 25 63 20 20 20 25 63 20 20 20 25 63 20 20 20 %c %c %c11a6: 25 63 20 00 %c .000011aa <__c.3143>:11aa: 42 4c 2d 43 74 72 6c 20 66 6f 75 6e 64 20 00 BL-Ctrl found .000011b9 <__c.3137>:11b9: 25 33 64 20 25 33 64 20 25 33 64 20 25 33 64 20 %3d %3d %3d %3d...000011ca <__c.3135>:11ca: 28 69 6e 20 30 2e 31 41 29 00 (in 0.1A).000011d4 <__c.3133>:11d4: 42 4c 20 43 75 72 72 65 6e 74 00 BL Current.000011df <__c.3127>:11df: 25 33 64 20 25 33 64 20 25 33 64 20 25 33 64 20 %3d %3d %3d %3d...000011f0 <__c.3125>:11f0: 42 4c 20 54 65 6d 70 65 72 61 74 75 72 65 00 BL Temperature.000011ff <__c.3119>:11ff: 25 33 64 20 25 33 64 20 25 33 64 20 25 33 64 20 %3d %3d %3d %3d...00001210 <__c.3117>:1210: 42 4c 2d 43 74 72 6c 20 45 72 72 6f 72 73 20 00 BL-Ctrl Errors .00001220 <__c.3114>:1220: 52 61 6e 67 65 3a 25 33 69 2d 25 33 69 00 Range:%3i-%3i.0000122e <__c.3112>:122e: 50 6f 73 69 74 69 6f 6e 3a 20 25 33 69 00 Position: %3i.0000123c <__c.3110>:123c: 53 65 74 70 6f 69 6e 74 20 20 25 33 69 00 Setpoint %3i.0000124a <__c.3108>:124a: 53 65 72 76 6f 20 20 00 Servo .00001252 <__c.3105>:1252: 54 72 75 65 3a 20 20 20 20 20 25 35 69 00 True: %5i.00001260 <__c.3103>:1260: 47 79 72 6f 3a 20 20 20 20 20 25 35 69 00 Gyro: %5i.0000126e <__c.3101>:126e: 4d 61 67 6e 65 74 3a 20 20 20 25 35 69 00 Magnet: %5i.0000127c <__c.3099>:127c: 43 6f 6d 70 61 73 73 00 Compass.00001284 <__c.3096>:1284: 28 72 65 73 65 74 29 00 (reset).0000128c <__c.3094>:128c: 41 63 74 3a 20 20 25 35 75 6d 69 6e 00 Act: %5umin.00001299 <__c.3092>:1299: 54 6f 74 61 6c 3a 25 35 75 6d 69 6e 00 Total:%5umin.000012a6 <__c.3090>:12a6: 46 6c 69 67 68 74 2d 54 69 6d 65 20 20 00 Flight-Time .000012b4 <__c.3084>:12b4: 50 6f 74 69 25 69 3a 20 20 25 33 69 00 Poti%i: %3i.000012c1 <__c.3078>:12c1: 50 6f 74 69 25 69 3a 20 20 25 33 69 00 Poti%i: %3i.000012ce <__c.3075>:12ce: 4c 61 6e 64 3a 20 25 32 64 2e 25 64 56 00 Land: %2d.%dV.000012dc <__c.3073>:12dc: 48 6f 6d 65 3a 20 25 32 64 2e 25 64 56 00 Home: %2d.%dV.000012ea <__c.3071>:12ea: 57 61 72 6e 3a 20 25 32 64 2e 25 64 56 00 Warn: %2d.%dV.000012f8 <__c.3069>:12f8: 55 6e 64 65 72 76 6f 6c 74 61 67 65 73 20 20 00 Undervoltages .00001308 <__c.3066>:1308: 52 43 2d 43 68 61 6e 6e 65 6c 73 3a 25 34 69 00 RC-Channels:%4i.00001318 <__c.3064>:1318: 52 43 2d 51 75 61 6c 69 74 79 3a 20 25 34 69 00 RC-Quality: %4i.00001328 <__c.3062>:1328: 52 65 63 65 69 76 65 72 00 Receiver.00001331 <__c.3059>:1331: 44 69 73 63 68 61 72 67 65 3a 20 25 35 69 6d 41 Discharge: %5imA1341: 68 00 h.00001343 <__c.3057>:1343: 50 6f 77 65 72 3a 20 20 20 20 20 25 34 69 57 00 Power: %4iW.00001353 <__c.3055>:1353: 43 75 72 72 65 6e 74 3a 20 20 20 25 33 69 2e 25 Current: %3i.%1363: 31 69 41 00 1iA.00001367 <__c.3053>:1367: 56 6f 6c 74 61 67 65 3a 20 20 20 25 33 69 2e 25 Voltage: %3i.%1377: 31 69 56 00 1iV.0000137b <__c.3050>:137b: 5a 20 20 20 20 25 34 69 20 28 25 33 69 29 00 Z %4i (%3i).0000138a <__c.3048>:138a: 52 6f 6c 6c 20 25 34 69 20 28 25 33 69 29 00 Roll %4i (%3i).00001399 <__c.3046>:1399: 4e 69 63 6b 20 25 34 69 20 28 25 33 69 29 00 Nick %4i (%3i).000013a8 <__c.3044>:13a8: 41 43 43 20 2d 20 53 65 6e 73 6f 72 00 ACC - Sensor.000013b5 <__c.3041>:13b5: 59 61 77 20 20 25 34 69 20 28 25 34 69 29 00 Yaw %4i (%4i).000013c4 <__c.3039>:13c4: 52 6f 6c 6c 20 25 34 69 20 28 25 34 69 29 00 Roll %4i (%4i).000013d3 <__c.3037>:13d3: 4e 69 63 6b 20 25 34 69 20 28 25 34 69 29 00 Nick %4i (%4i).000013e2 <__c.3035>:13e2: 47 79 72 6f 20 2d 20 53 65 6e 73 6f 72 00 Gyro - Sensor.000013f0 <__c.3032>:13f0: 50 33 3a 25 34 69 20 20 50 34 3a 25 34 69 20 00 P3:%4i P4:%4i .00001400 <__c.3030>:1400: 50 31 3a 25 34 69 20 20 50 32 3a 25 34 69 20 00 P1:%4i P2:%4i .00001410 <__c.3028>:1410: 47 73 3a 25 34 69 20 20 47 69 3a 25 34 69 20 00 Gs:%4i Gi:%4i .00001420 <__c.3026>:1420: 4e 69 3a 25 34 69 20 20 52 6f 3a 25 34 69 20 00 Ni:%4i Ro:%4i .00001430 <__c.3020>:1430: 4b 25 69 3a 25 34 69 20 20 4b 25 69 3a 25 34 69 K%i:%4i K%i:%4i1440: 20 00 .00001442 <__c.3017>:1442: 43 6f 6d 70 61 73 73 3a 20 20 20 25 35 69 00 Compass: %5i.00001451 <__c.3015>:1451: 52 6f 6c 6c 3a 20 20 20 20 20 20 25 35 69 00 Roll: %5i.00001460 <__c.3013>:1460: 4e 69 63 6b 3a 20 20 20 20 20 20 25 35 69 00 Nick: %5i.0000146f <__c.3011>:146f: 61 63 74 2e 20 62 65 61 72 69 6e 67 00 act. bearing.0000147c <__c.3008>:147c: 25 69 00 %i.0000147f <__c.3006>:147f: 28 41 29 00 (A).00001483 <__c.3004>:1483: 4f 66 66 73 65 74 3a 20 20 25 35 69 00 Offset: %5i.00001490 <__c.3002>:1490: 50 72 65 73 73 75 72 65 3a 25 35 69 00 Pressure:%5i.0000149d <__c.3000>:149d: 53 65 74 70 6f 69 6e 74 3a 25 35 69 00 Setpoint:%5i.000014aa <__c.2998>:14aa: 48 65 69 67 68 74 3a 20 20 25 35 69 00 Height: %5i.000014b7 <__c.2994>:14b7: 42 4c 2d 53 65 6c 66 74 65 73 74 20 45 72 72 3a BL-Selftest Err:14c7: 25 32 64 00 %2d.000014cb <__c.2992>:14cb: 49 32 43 20 45 52 52 4f 52 21 21 21 00 I2C ERROR!!!.000014d8 <__c.2990>:14d8: 4d 69 73 73 69 6e 67 20 42 4c 2d 43 74 72 6c 3a Missing BL-Ctrl:14e8: 25 64 20 21 21 00 %d !!.000014ee <__c.2988>:14ee: 48 61 72 64 77 61 72 65 20 45 72 72 6f 72 20 31 Hardware Error 114fe: 3a 25 64 20 21 21 00 :%d !!.00001505 <__c.2986>:1505: 45 52 52 25 32 64 3a 00 ERR%2d:.0000150d <__c.2984>:150d: 4d 69 78 65 72 20 45 72 72 6f 72 21 00 Mixer Error!.0000151a <__c.2982>:151a: 42 4f 41 54 00 BOAT.0000151f <__c.2980>:151f: 53 65 74 3a 25 64 20 25 73 00 Set:%d %s.00001529 <__c.2978>:1529: 48 57 3a 56 25 64 2e 25 64 20 53 57 3a 25 64 2e HW:V%d.%d SW:%d.1539: 25 30 32 64 25 63 20 00 %02d%c .00001541 <__c.2976>:1541: 2b 20 4d 69 6b 72 6f 4b 6f 70 74 65 72 20 2b 00 + MikroKopter +.00001551 <__c.2973>:1551: 5b 25 69 5d 00 [%i].00001556 <__c.2971>:1556: 5b 25 69 5d 00 [%i].0000155b <pgm_sinlookup>:155b: 00 00 8f 00 1e 01 ad 01 3b 02 ca 02 58 03 e6 03 ........;...X...156b: 74 04 02 05 8f 05 1b 06 a7 06 33 07 be 07 48 08 t.........3...H.157b: d2 08 5b 09 e3 09 6b 0a f2 0a 78 0b fd 0b 81 0c ..[...k...x.....158b: 04 0d 86 0d 07 0e 87 0e 06 0f 84 0f 00 10 7b 10 ..............{.159b: f5 10 6e 11 e5 11 5b 12 cf 12 42 13 b3 13 23 14 ..n...[...B...#.15ab: 92 14 fe 14 6a 15 d3 15 3b 16 a1 16 05 17 67 17 ....j...;.....g.15bb: c8 17 27 18 83 18 de 18 37 19 8e 19 e3 19 36 1a ..'.....7.....6.15cb: 87 1a d6 1a 23 1b 6e 1b b6 1b fd 1b 41 1c 83 1c ....#.n.....A...15db: c3 1c 00 1d 3c 1d 75 1d ab 1d e0 1d 12 1e 42 1e ....<.u.......B.15eb: 6f 1e 9a 1e c3 1e e9 1e 0d 1f 2e 1f 4d 1f 69 1f o...........M.i.15fb: 84 1f 9b 1f b0 1f c3 1f d3 1f e1 1f ec 1f f5 1f ................160b: fb 1f ff 1f 00 20 .....00001611 <__c.3146>:1611: 56 65 72 73 69 6f 6e 20 67 65 73 65 6e 64 65 74 Version gesendet...00001622 <__c.3143>:1622: 21 21 21 20 49 4e 43 4f 4d 50 41 54 49 42 4c 45 !!! INCOMPATIBLE1632: 20 21 21 21 00 !!!.00001637 <__c.3101>:1637: 57 72 69 74 69 6e 67 20 42 4c 20 25 64 00 Writing BL %d.00001645 <__c.3095>:1645: 52 65 61 64 69 6e 67 20 42 4c 20 25 64 00 Reading BL %d.00001653 <__c.3080>:1653: 4c 65 73 65 20 53 65 74 74 69 6e 67 20 25 64 00 Lese Setting %d.00001663 <__c.3069>:1663: 4d 69 78 65 72 20 6c 65 73 65 6e 00 Mixer lesen.0000166f <ANALOG_TEXT>:166f: 41 6e 67 6c 65 4e 69 63 6b 20 20 20 20 20 20 20 AngleNick167f: 41 6e 67 6c 65 52 6f 6c 6c 20 20 20 20 20 20 20 AngleRoll168f: 41 63 63 4e 69 63 6b 20 20 20 20 20 20 20 20 20 AccNick169f: 41 63 63 52 6f 6c 6c 20 20 20 20 20 20 20 20 20 AccRoll16af: 59 61 77 47 79 72 6f 20 20 20 20 20 20 20 20 20 YawGyro16bf: 41 6c 74 69 74 75 64 65 20 5b 30 2e 31 6d 5d 20 Altitude [0.1m]16cf: 41 63 63 5a 20 20 20 20 20 20 20 20 20 20 20 20 AccZ16df: 47 61 73 20 20 20 20 20 20 20 20 20 20 20 20 20 Gas16ef: 43 6f 6d 70 61 73 73 20 56 61 6c 75 65 20 20 20 Compass Value16ff: 56 6f 6c 74 61 67 65 20 5b 30 2e 31 56 5d 20 20 Voltage [0.1V]170f: 52 65 63 65 69 76 65 72 20 4c 65 76 65 6c 20 20 Receiver Level171f: 47 79 72 6f 20 43 6f 6d 70 61 73 73 20 20 20 20 Gyro Compass172f: 4d 6f 74 6f 72 20 31 20 20 20 20 20 20 20 20 20 Motor 1173f: 4d 6f 74 6f 72 20 32 20 20 20 20 20 20 20 20 20 Motor 2174f: 4d 6f 74 6f 72 20 33 20 20 20 20 20 20 20 20 20 Motor 3175f: 4d 6f 74 6f 72 20 34 20 20 20 20 20 20 20 20 20 Motor 4176f: 31 36 20 20 20 20 20 20 20 20 20 20 20 20 20 20 16177f: 31 37 20 20 20 20 20 20 20 20 20 20 20 20 20 20 17178f: 31 38 20 20 20 20 20 20 20 20 20 20 20 20 20 20 18179f: 31 39 20 20 20 20 20 20 20 20 20 20 20 20 20 20 1917af: 53 65 72 76 6f 20 20 20 20 20 20 20 20 20 20 20 Servo17bf: 48 6f 76 65 72 67 61 73 20 20 20 20 20 20 20 20 Hovergas17cf: 43 75 72 72 65 6e 74 20 5b 30 2e 31 41 5d 20 20 Current [0.1A]17df: 43 61 70 61 63 69 74 79 20 5b 6d 41 68 5d 20 20 Capacity [mAh]17ef: 48 65 69 67 68 74 20 53 65 74 70 6f 69 6e 74 20 Height Setpoint17ff: 32 35 20 20 20 20 20 20 20 20 20 20 20 20 20 20 25180f: 32 36 20 20 20 20 20 20 20 20 20 20 20 20 20 20 26181f: 32 37 20 20 20 20 20 20 20 20 20 20 20 20 20 20 27182f: 49 32 43 2d 45 72 72 6f 72 20 20 20 20 20 20 20 I2C-Error183f: 42 4c 20 4c 69 6d 69 74 20 20 20 20 20 20 20 20 BL Limit184f: 47 50 53 5f 4e 69 63 6b 20 20 20 20 20 20 20 20 GPS_Nick185f: 47 50 53 5f 52 6f 6c 6c 20 20 20 20 20 20 20 20 GPS_Roll0000186f <Msg2>:186f: 0a 0d 77 77 77 2e 4d 69 6b 72 6f 4b 6f 70 74 65 ..www.MikroKopte187f: 72 2e 64 65 20 28 63 29 20 48 69 53 79 73 74 65 r.de (c) HiSyste188f: 6d 73 20 47 6d 62 48 00 ms GmbH.00001897 <Msg1>:1897: 0a 0d 74 68 65 20 75 73 65 20 6f 66 20 74 68 69 ..the use of thi18a7: 73 20 73 6f 66 74 77 61 72 65 20 69 73 20 6f 6e s software is on18b7: 6c 79 20 70 65 72 6d 69 74 74 65 64 20 0a 0d 6f ly permitted ..o18c7: 6e 20 6f 72 69 67 69 6e 61 6c 20 4d 69 6b 72 6f n original Mikro18d7: 4b 6f 70 74 65 72 2d 48 61 72 64 77 61 72 65 00 Kopter-Hardware.000018e7 <Rec_USER>:18e7: 55 73 65 72 00 User.000018ec <Rec_HoTT>:18ec: 48 6f 54 54 20 56 34 00 HoTT V4.000018f4 <Rec_ACT_DSL>:18f4: 41 43 54 20 44 53 4c 00 ACT DSL.000018fc <Rec_Jeti>:18fc: 4a 65 74 69 00 Jeti.00001901 <Rec_Spektrum>:1901: 53 70 65 6b 74 72 75 6d 00 Spektrum.0000190a <Rec_PPM>:190a: 50 50 4d 00 PPM.0000190e <__c.6>:190e: 0a 0d 52 65 63 65 69 76 65 72 3a 20 00 ..Receiver: .0000191b <__c.7>:191b: 53 2e 42 75 73 00 S.Bus.00001921 <__c.8>:1921: 75 6e 6b 6e 6f 77 6e 2e 20 55 73 69 6e 67 20 50 unknown. Using P1931: 50 4d 2e 2e 2e 00 PM....00001937 <__c.9>:1937: 6e 6f 74 20 73 75 70 70 6f 72 74 65 64 20 62 79 not supported by1947: 20 68 61 72 64 77 61 72 65 21 00 hardware!.00001952 <__c.3>:1952: 0a 0d 20 2d 20 4c 49 42 20 4e 4f 54 20 43 4f 4d .. - LIB NOT COM1962: 50 41 54 49 42 4c 45 20 21 21 21 21 00 PATIBLE !!!!.0000196f <__c.4>:196f: 0a 0d 0a 0d 21 21 20 42 6f 6f 74 6c 6f 61 64 65 ....!! Bootloade197f: 72 20 6e 6f 74 20 63 6f 6d 70 61 74 69 62 6c 65 r not compatible198f: 20 74 6f 20 48 61 72 64 77 61 72 65 20 3e 20 32 to Hardware > 2199f: 2e 32 20 21 21 0a 0d 0a 0d 00 .2 !!.....000019a9 <__c.5>:19a9: 0a 0d 46 6c 69 67 68 74 43 6f 6e 74 72 6f 6c 0a ..FlightControl.19b9: 0d 48 61 72 64 77 61 72 65 3a 25 64 2e 25 64 0a .Hardware:%d.%d.19c9: 0d 53 6f 66 74 77 61 72 65 3a 56 25 64 2e 25 30 .Software:V%d.%019d9: 32 64 25 63 20 00 00 2d%c ..000019e0 <__ctors_end>:19e0: 11 24 eor r1, r119e2: 1f be out 0x3f, r1 ; 6319e4: cf ef ldi r28, 0xFF ; 25519e6: d0 e4 ldi r29, 0x40 ; 6419e8: de bf out 0x3e, r29 ; 6219ea: cd bf out 0x3d, r28 ; 61000019ec <__do_copy_data>:19ec: 12 e0 ldi r17, 0x02 ; 219ee: a0 e0 ldi r26, 0x00 ; 019f0: b1 e0 ldi r27, 0x01 ; 119f2: ee ec ldi r30, 0xCE ; 20619f4: f4 e6 ldi r31, 0x64 ; 10019f6: 01 e0 ldi r16, 0x01 ; 119f8: 0b bf out 0x3b, r16 ; 5919fa: 02 c0 rjmp .+4 ; 0x1a00 <__do_copy_data+0x14>19fc: 07 90 elpm r0, Z+19fe: 0d 92 st X+, r01a00: aa 3e cpi r26, 0xEA ; 2341a02: b1 07 cpc r27, r171a04: d9 f7 brne .-10 ; 0x19fc <__do_copy_data+0x10>00001a06 <__do_clear_bss>:1a06: 2c e0 ldi r18, 0x0C ; 121a08: aa ee ldi r26, 0xEA ; 2341a0a: b2 e0 ldi r27, 0x02 ; 21a0c: 01 c0 rjmp .+2 ; 0x1a10 <.do_clear_bss_start>00001a0e <.do_clear_bss_loop>:1a0e: 1d 92 st X+, r100001a10 <.do_clear_bss_start>:1a10: a9 3d cpi r26, 0xD9 ; 2171a12: b2 07 cpc r27, r181a14: e1 f7 brne .-8 ; 0x1a0e <.do_clear_bss_loop>00001a16 <ndfcvbghs>:1a16: 7a ea ldi r23, 0xAA ; 1701a18: e2 e0 ldi r30, 0x02 ; 21a1a: f0 e0 ldi r31, 0x00 ; 01a1c: 81 e2 ldi r24, 0x21 ; 331a1e: 80 93 57 00 sts 0x0057, r241a22: 14 91 lpm r17, Z1a24: 20 ef ldi r18, 0xF0 ; 2401a26: 37 ef ldi r19, 0xF7 ; 2471a28: 41 e0 ldi r20, 0x01 ; 11a2a: 50 e0 ldi r21, 0x00 ; 01a2c: c6 e1 ldi r28, 0x16 ; 221a2e: d3 e0 ldi r29, 0x03 ; 31a30: 6f e0 ldi r22, 0x0F ; 151a32: da 01 movw r26, r201a34: c9 01 movw r24, r181a36: 2f 5f subi r18, 0xFF ; 2551a38: 3f 4f sbci r19, 0xFF ; 2551a3a: 4f 4f sbci r20, 0xFF ; 2551a3c: 5f 4f sbci r21, 0xFF ; 2551a3e: ab bf out 0x3b, r26 ; 591a40: fc 01 movw r30, r241a42: 87 91 elpm r24, Z+1a44: 89 93 st Y+, r241a46: 61 50 subi r22, 0x01 ; 11a48: 67 ff sbrs r22, 71a4a: f3 cf rjmp .-26 ; 0x1a32 <ndfcvbghs+0x1c>1a4c: 84 ee ldi r24, 0xE4 ; 2281a4e: 8a bd out 0x2a, r24 ; 421a50: 80 91 1e 03 lds r24, 0x031E1a54: 80 93 ea 02 sts 0x02EA, r241a58: 89 31 cpi r24, 0x19 ; 251a5a: 38 f0 brcs .+14 ; 0x1a6a <ndfcvbghs+0x54>1a5c: 86 e0 ldi r24, 0x06 ; 61a5e: 80 93 0b 01 sts 0x010B, r241a62: 87 e0 ldi r24, 0x07 ; 71a64: 80 93 0a 01 sts 0x010A, r241a68: 7b ea ldi r23, 0xAB ; 1711a6a: e6 e1 ldi r30, 0x16 ; 221a6c: f3 e0 ldi r31, 0x03 ; 31a6e: 6e e0 ldi r22, 0x0E ; 141a70: 81 91 ld r24, Z+1a72: 78 27 eor r23, r241a74: 70 95 com r231a76: 61 50 subi r22, 0x01 ; 11a78: 67 ff sbrs r22, 71a7a: fa cf rjmp .-12 ; 0x1a70 <ndfcvbghs+0x5a>1a7c: 80 91 25 03 lds r24, 0x03251a80: 78 17 cp r23, r241a82: 21 f0 breq .+8 ; 0x1a8c <ndfcvbghs+0x76>1a84: 17 39 cpi r17, 0x97 ; 1511a86: 11 f4 brne .+4 ; 0x1a8c <ndfcvbghs+0x76>1a88: 00 00 nop1a8a: fe cf rjmp .-4 ; 0x1a88 <ndfcvbghs+0x72>1a8c: 0e 94 9e 5a call 0xb53c ; 0xb53c <main>1a90: 0c 94 65 b2 jmp 0x164ca ; 0x164ca <_exit>00001a94 <__bad_interrupt>:1a94: 0c 94 00 00 jmp 0 ; 0x0 <__vectors>00001a98 <isqrt32>:.global isqrt32.func isqrt32isqrt32:clr r01a98: 00 24 eor r0, r0clr r181a9a: 22 27 eor r18, r18clr r191a9c: 33 27 eor r19, r19clr r201a9e: 44 27 eor r20, r20ldi r21, 11aa0: 51 e0 ldi r21, 0x01 ; 1clr r271aa2: bb 27 eor r27, r27clr r301aa4: ee 27 eor r30, r30clr r311aa6: ff 27 eor r31, r31ldi r26, 161aa8: a0 e1 ldi r26, 0x10 ; 161: lsl r221aaa: 66 0f add r22, r22rol r231aac: 77 1f adc r23, r23rol r241aae: 88 1f adc r24, r24rol r251ab0: 99 1f adc r25, r25rol r01ab2: 00 1c adc r0, r0rol r181ab4: 22 1f adc r18, r18rol r191ab6: 33 1f adc r19, r19rol r201ab8: 44 1f adc r20, r20lsl r221aba: 66 0f add r22, r22rol r231abc: 77 1f adc r23, r23rol r241abe: 88 1f adc r24, r24rol r251ac0: 99 1f adc r25, r25rol r01ac2: 00 1c adc r0, r0rol r181ac4: 22 1f adc r18, r18rol r191ac6: 33 1f adc r19, r19rol r201ac8: 44 1f adc r20, r20brpl 2f1aca: 2a f4 brpl .+10 ; 0x1ad6 <isqrt32+0x3e>add r0, r211acc: 05 0e add r0, r21adc r18, r271ace: 2b 1f adc r18, r27adc r19, r301ad0: 3e 1f adc r19, r30adc r20, r311ad2: 4f 1f adc r20, r31rjmp 3f1ad4: 04 c0 rjmp .+8 ; 0x1ade <isqrt32+0x46>2: sub r0, r211ad6: 05 1a sub r0, r21sbc r18, r271ad8: 2b 0b sbc r18, r27sbc r19, r301ada: 3e 0b sbc r19, r30sbc r20, r311adc: 4f 0b sbc r20, r313: lsl r211ade: 55 0f add r21, r21rol r271ae0: bb 1f adc r27, r27rol r301ae2: ee 1f adc r30, r30andi r21, 0b111110001ae4: 58 7f andi r21, 0xF8 ; 248ori r21, 0b000001011ae6: 55 60 ori r21, 0x05 ; 5sbrc r20, 71ae8: 47 fd sbrc r20, 7subi r21, 21aea: 52 50 subi r21, 0x02 ; 2dec r261aec: aa 95 dec r26brne 1b1aee: e9 f6 brne .-70 ; 0x1aaa <isqrt32+0x12>lsr r301af0: e6 95 lsr r30ror r271af2: b7 95 ror r27ror r211af4: 57 95 ror r21lsr r301af6: e6 95 lsr r30ror r271af8: b7 95 ror r27ror r211afa: 57 95 ror r21mov r24, r211afc: 85 2f mov r24, r21mov r25, r271afe: 9b 2f mov r25, r27ret1b00: 08 95 ret00001b02 <isqrt16>:.global isqrt16.func isqrt16isqrt16:clr r181b02: 22 27 eor r18, r18clr r191b04: 33 27 eor r19, r19ldi r20, 11b06: 41 e0 ldi r20, 0x01 ; 1clr r211b08: 55 27 eor r21, r21ldi r22, 81b0a: 68 e0 ldi r22, 0x08 ; 81: lsl r241b0c: 88 0f add r24, r24rol r251b0e: 99 1f adc r25, r25rol r181b10: 22 1f adc r18, r18rol r191b12: 33 1f adc r19, r19lsl r241b14: 88 0f add r24, r24rol r251b16: 99 1f adc r25, r25rol r181b18: 22 1f adc r18, r18rol r191b1a: 33 1f adc r19, r19brpl 2f1b1c: 1a f4 brpl .+6 ; 0x1b24 <isqrt16+0x22>add r18, r201b1e: 24 0f add r18, r20adc r19, r211b20: 35 1f adc r19, r21rjmp 3f1b22: 02 c0 rjmp .+4 ; 0x1b28 <isqrt16+0x26>2: sub r18, r201b24: 24 1b sub r18, r20sbc r19, r211b26: 35 0b sbc r19, r213: lsl r201b28: 44 0f add r20, r20rol r211b2a: 55 1f adc r21, r21andi r20, 0b111110001b2c: 48 7f andi r20, 0xF8 ; 248ori r20, 0b000001011b2e: 45 60 ori r20, 0x05 ; 5sbrc r19, 71b30: 37 fd sbrc r19, 7subi r20, 21b32: 42 50 subi r20, 0x02 ; 2dec r221b34: 6a 95 dec r22brne 1b1b36: 51 f7 brne .-44 ; 0x1b0c <isqrt16+0xa>lsr r211b38: 56 95 lsr r21ror r201b3a: 47 95 ror r20lsr r211b3c: 56 95 lsr r21ror r201b3e: 47 95 ror r20mov r24, r201b40: 84 2f mov r24, r20ret1b42: 08 95 ret00001b44 <ihypot>:.global ihypot.func ihypotihypot:clr r261b44: aa 27 eor r26, r26sbrs r25, 71b46: 97 ff sbrs r25, 7rjmp 1f1b48: 04 c0 rjmp .+8 ; 0x1b52 <ihypot+0xe>com r241b4a: 80 95 com r24com r251b4c: 90 95 com r25adc r24, r261b4e: 8a 1f adc r24, r26adc r25, r261b50: 9a 1f adc r25, r261: sbrs r23, 71b52: 77 ff sbrs r23, 7rjmp 2f1b54: 04 c0 rjmp .+8 ; 0x1b5e <ihypot+0x1a>com r221b56: 60 95 com r22com r231b58: 70 95 com r23adc r22, r261b5a: 6a 1f adc r22, r26adc r23, r261b5c: 7a 1f adc r23, r262: mul r22, r221b5e: 66 9f mul r22, r22movw r18, r01b60: 90 01 movw r18, r0mul r23, r231b62: 77 9f mul r23, r23movw r20, r01b64: a0 01 movw r20, r0mul r22, r231b66: 67 9f mul r22, r23add r19, r01b68: 30 0d add r19, r0adc r20, r11b6a: 41 1d adc r20, r1adc r21, r261b6c: 5a 1f adc r21, r26add r19, r01b6e: 30 0d add r19, r0adc r20, r11b70: 41 1d adc r20, r1adc r21, r261b72: 5a 1f adc r21, r26mul r24, r241b74: 88 9f mul r24, r24movw r30, r01b76: f0 01 movw r30, r0mul r25, r251b78: 99 9f mul r25, r25add r18, r301b7a: 2e 0f add r18, r30adc r19, r311b7c: 3f 1f adc r19, r31adc r20, r01b7e: 40 1d adc r20, r0adc r21, r11b80: 51 1d adc r21, r1mul r24, r251b82: 89 9f mul r24, r25add r19, r01b84: 30 0d add r19, r0adc r20, r11b86: 41 1d adc r20, r1adc r21, r261b88: 5a 1f adc r21, r26add r19, r01b8a: 30 0d add r19, r0adc r20, r11b8c: 41 1d adc r20, r1adc r21, r261b8e: 5a 1f adc r21, r26movw r24, r201b90: ca 01 movw r24, r20movw r22, r181b92: b9 01 movw r22, r18clr r11b94: 11 24 eor r1, r1rjmp isqrt321b96: 80 cf rjmp .-256 ; 0x1a98 <isqrt32>00001b98 <fomklkdtn89SFGrsgt9rf>:1b98: 4f b7 in r20, 0x3f ; 631b9a: 20 e4 ldi r18, 0x40 ; 641b9c: 30 e0 ldi r19, 0x00 ; 01b9e: f8 94 cli1ba0: 80 91 c9 00 lds r24, 0x00C91ba4: 8f 77 andi r24, 0x7F ; 1271ba6: 80 93 c9 00 sts 0x00C9, r241baa: 80 91 c9 00 lds r24, 0x00C91bae: 8f 7b andi r24, 0xBF ; 1911bb0: 80 93 c9 00 sts 0x00C9, r241bb4: 80 91 c9 00 lds r24, 0x00C91bb8: 8f 7d andi r24, 0xDF ; 2231bba: 80 93 c9 00 sts 0x00C9, r241bbe: 83 2f mov r24, r191bc0: 99 27 eor r25, r251bc2: 80 93 cd 00 sts 0x00CD, r241bc6: 20 93 cc 00 sts 0x00CC, r181bca: 80 91 c8 00 lds r24, 0x00C81bce: 82 60 ori r24, 0x02 ; 21bd0: 80 93 c8 00 sts 0x00C8, r241bd4: 88 e1 ldi r24, 0x18 ; 241bd6: 80 93 c9 00 sts 0x00C9, r241bda: 80 91 ca 00 lds r24, 0x00CA1bde: 8f 77 andi r24, 0x7F ; 1271be0: 80 93 ca 00 sts 0x00CA, r241be4: 80 91 ca 00 lds r24, 0x00CA1be8: 8f 7b andi r24, 0xBF ; 1911bea: 80 93 ca 00 sts 0x00CA, r241bee: 80 91 ca 00 lds r24, 0x00CA1bf2: 8f 7d andi r24, 0xDF ; 2231bf4: 80 93 ca 00 sts 0x00CA, r241bf8: 80 91 ca 00 lds r24, 0x00CA1bfc: 8f 7e andi r24, 0xEF ; 2391bfe: 80 93 ca 00 sts 0x00CA, r241c02: 80 91 ca 00 lds r24, 0x00CA1c06: 87 7f andi r24, 0xF7 ; 2471c08: 80 93 ca 00 sts 0x00CA, r241c0c: 80 91 c9 00 lds r24, 0x00C91c10: 8b 7f andi r24, 0xFB ; 2511c12: 80 93 c9 00 sts 0x00C9, r241c16: 80 91 ca 00 lds r24, 0x00CA1c1a: 84 60 ori r24, 0x04 ; 41c1c: 80 93 ca 00 sts 0x00CA, r241c20: 80 91 ca 00 lds r24, 0x00CA1c24: 82 60 ori r24, 0x02 ; 21c26: 80 93 ca 00 sts 0x00CA, r241c2a: 80 91 c8 00 lds r24, 0x00C81c2e: 87 ff sbrs r24, 71c30: 03 c0 rjmp .+6 ; 0x1c38 <fomklkdtn89SFGrsgt9rf+0xa0>1c32: 80 91 ce 00 lds r24, 0x00CE1c36: f9 cf rjmp .-14 ; 0x1c2a <fomklkdtn89SFGrsgt9rf+0x92>1c38: 80 91 c9 00 lds r24, 0x00C91c3c: 80 68 ori r24, 0x80 ; 1281c3e: 80 93 c9 00 sts 0x00C9, r241c42: 4f bf out 0x3f, r20 ; 631c44: 08 95 ret00001c46 <FGRT0589rge90gj459gg4>:1c46: 0f 93 push r161c48: 1f 93 push r171c4a: cf 93 push r281c4c: df 93 push r291c4e: 48 2f mov r20, r241c50: 4f 5f subi r20, 0xFF ; 2551c52: 89 31 cpi r24, 0x19 ; 251c54: 08 f0 brcs .+2 ; 0x1c58 <FGRT0589rge90gj459gg4+0x12>1c56: 8b c0 rjmp .+278 ; 0x1d6e <FGRT0589rge90gj459gg4+0x128>1c58: 80 91 30 08 lds r24, 0x08301c5c: 84 17 cp r24, r201c5e: 20 f4 brcc .+8 ; 0x1c68 <FGRT0589rge90gj459gg4+0x22>1c60: 4f 5f subi r20, 0xFF ; 2551c62: 40 93 30 08 sts 0x0830, r201c66: 41 50 subi r20, 0x01 ; 11c68: cb 01 movw r24, r221c6a: 83 53 subi r24, 0x33 ; 511c6c: 9b 42 sbci r25, 0x2B ; 431c6e: 68 e1 ldi r22, 0x18 ; 241c70: 70 e0 ldi r23, 0x00 ; 01c72: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>1c76: a4 2f mov r26, r201c78: bb 27 eor r27, r271c7a: fd 01 movw r30, r261c7c: ea 0f add r30, r261c7e: fb 1f adc r31, r271c80: ef 5c subi r30, 0xCF ; 2071c82: f7 4f sbci r31, 0xF7 ; 2471c84: 80 81 ld r24, Z1c86: 91 81 ldd r25, Z+1 ; 0x011c88: 9b 01 movw r18, r221c8a: 28 1b sub r18, r241c8c: 39 0b sbc r19, r251c8e: c9 01 movw r24, r181c90: 37 ff sbrs r19, 71c92: 03 c0 rjmp .+6 ; 0x1c9a <FGRT0589rge90gj459gg4+0x54>1c94: 90 95 com r251c96: 81 95 neg r241c98: 9f 4f sbci r25, 0xFF ; 2551c9a: 06 97 sbiw r24, 0x06 ; 61c9c: 94 f4 brge .+36 ; 0x1cc2 <FGRT0589rge90gj459gg4+0x7c>1c9e: 80 91 04 04 lds r24, 0x04041ca2: 88 3c cpi r24, 0xC8 ; 2001ca4: 30 f4 brcc .+12 ; 0x1cb2 <FGRT0589rge90gj459gg4+0x6c>1ca6: 80 91 04 04 lds r24, 0x04041caa: 86 5f subi r24, 0xF6 ; 2461cac: 80 93 04 04 sts 0x0404, r241cb0: 08 c0 rjmp .+16 ; 0x1cc2 <FGRT0589rge90gj459gg4+0x7c>1cb2: 88 ec ldi r24, 0xC8 ; 2001cb4: 80 93 04 04 sts 0x0404, r241cb8: 80 91 6f 00 lds r24, 0x006F1cbc: 8f 7d andi r24, 0xDF ; 2231cbe: 80 93 6f 00 sts 0x006F, r241cc2: fd 01 movw r30, r261cc4: ea 0f add r30, r261cc6: fb 1f adc r31, r271cc8: ef 5c subi r30, 0xCF ; 2071cca: f7 4f sbci r31, 0xF7 ; 2471ccc: 80 81 ld r24, Z1cce: 91 81 ldd r25, Z+1 ; 0x011cd0: 9c 01 movw r18, r241cd2: 22 0f add r18, r181cd4: 33 1f adc r19, r191cd6: 28 0f add r18, r241cd8: 39 1f adc r19, r251cda: 26 0f add r18, r221cdc: 37 1f adc r19, r231cde: 37 ff sbrs r19, 71ce0: 02 c0 rjmp .+4 ; 0x1ce6 <FGRT0589rge90gj459gg4+0xa0>1ce2: 2d 5f subi r18, 0xFD ; 2531ce4: 3f 4f sbci r19, 0xFF ; 2551ce6: e9 01 movw r28, r181ce8: d5 95 asr r291cea: c7 95 ror r281cec: d5 95 asr r291cee: c7 95 ror r281cf0: cb 01 movw r24, r221cf2: 01 96 adiw r24, 0x01 ; 11cf4: 8c 17 cp r24, r281cf6: 9d 07 cpc r25, r291cf8: 14 f4 brge .+4 ; 0x1cfe <FGRT0589rge90gj459gg4+0xb8>1cfa: 21 97 sbiw r28, 0x01 ; 11cfc: 06 c0 rjmp .+12 ; 0x1d0a <FGRT0589rge90gj459gg4+0xc4>1cfe: 61 50 subi r22, 0x01 ; 11d00: 70 40 sbci r23, 0x00 ; 01d02: c6 17 cp r28, r221d04: d7 07 cpc r29, r231d06: 0c f4 brge .+2 ; 0x1d0a <FGRT0589rge90gj459gg4+0xc4>1d08: 21 96 adiw r28, 0x01 ; 11d0a: 80 91 04 04 lds r24, 0x04041d0e: 84 3b cpi r24, 0xB4 ; 1801d10: d8 f0 brcs .+54 ; 0x1d48 <FGRT0589rge90gj459gg4+0x102>1d12: 8d 01 movw r16, r261d14: 0a 0f add r16, r261d16: 1b 1f adc r17, r271d18: f8 01 movw r30, r161d1a: ef 5c subi r30, 0xCF ; 2071d1c: f7 4f sbci r31, 0xF7 ; 2471d1e: 80 81 ld r24, Z1d20: 91 81 ldd r25, Z+1 ; 0x011d22: fe 01 movw r30, r281d24: e8 1b sub r30, r241d26: f9 0b sbc r31, r251d28: cf 01 movw r24, r301d2a: 63 e0 ldi r22, 0x03 ; 31d2c: 70 e0 ldi r23, 0x00 ; 01d2e: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>1d32: cb 01 movw r24, r221d34: 88 0f add r24, r241d36: 99 1f adc r25, r251d38: 86 0f add r24, r221d3a: 97 1f adc r25, r231d3c: 09 58 subi r16, 0x89 ; 1371d3e: 17 4f sbci r17, 0xF7 ; 2471d40: f8 01 movw r30, r161d42: 91 83 std Z+1, r25 ; 0x011d44: 80 83 st Z, r241d46: 07 c0 rjmp .+14 ; 0x1d56 <FGRT0589rge90gj459gg4+0x110>1d48: aa 0f add r26, r261d4a: bb 1f adc r27, r271d4c: a9 58 subi r26, 0x89 ; 1371d4e: b7 4f sbci r27, 0xF7 ; 2471d50: 11 96 adiw r26, 0x01 ; 11d52: 1c 92 st X, r11d54: 1e 92 st -X, r11d56: e4 2f mov r30, r201d58: ff 27 eor r31, r311d5a: ee 0f add r30, r301d5c: ff 1f adc r31, r311d5e: ef 5c subi r30, 0xCF ; 2071d60: f7 4f sbci r31, 0xF7 ; 2471d62: d1 83 std Z+1, r29 ; 0x011d64: c0 83 st Z, r281d66: 44 30 cpi r20, 0x04 ; 41d68: 11 f4 brne .+4 ; 0x1d6e <FGRT0589rge90gj459gg4+0x128>1d6a: 10 92 93 02 sts 0x0293, r11d6e: df 91 pop r291d70: cf 91 pop r281d72: 1f 91 pop r171d74: 0f 91 pop r161d76: 08 95 ret00001d78 <DFGeefWEF43tgt5uGreg5>:1d78: cf 93 push r281d7a: df 93 push r291d7c: 20 91 aa 0c lds r18, 0x0CAA1d80: 82 2f mov r24, r181d82: 99 27 eor r25, r251d84: 80 7f andi r24, 0xF0 ; 2401d86: 90 70 andi r25, 0x00 ; 01d88: 40 97 sbiw r24, 0x10 ; 161d8a: 09 f0 breq .+2 ; 0x1d8e <DFGeefWEF43tgt5uGreg5+0x16>1d8c: 64 c0 rjmp .+200 ; 0x1e56 <DFGeefWEF43tgt5uGreg5+0xde>1d8e: 2f 31 cpi r18, 0x1F ; 311d90: 09 f0 breq .+2 ; 0x1d94 <DFGeefWEF43tgt5uGreg5+0x1c>1d92: 40 c0 rjmp .+128 ; 0x1e14 <DFGeefWEF43tgt5uGreg5+0x9c>1d94: 80 91 ab 0c lds r24, 0x0CAB1d98: 80 93 f4 02 sts 0x02F4, r241d9c: 90 91 ad 0c lds r25, 0x0CAD1da0: 90 93 f6 02 sts 0x02F6, r251da4: 80 91 ae 0c lds r24, 0x0CAE1da8: 80 93 f5 02 sts 0x02F5, r241dac: 99 23 and r25, r251dae: 09 f0 breq .+2 ; 0x1db2 <DFGeefWEF43tgt5uGreg5+0x3a>1db0: 52 c0 rjmp .+164 ; 0x1e56 <DFGeefWEF43tgt5uGreg5+0xde>1db2: 80 91 3f 05 lds r24, 0x053F1db6: 28 2f mov r18, r241db8: 33 27 eor r19, r191dba: 22 0f add r18, r181dbc: 33 1f adc r19, r191dbe: f9 01 movw r30, r181dc0: e9 58 subi r30, 0x89 ; 1371dc2: f7 4f sbci r31, 0xF7 ; 2471dc4: 11 82 std Z+1, r1 ; 0x011dc6: 10 82 st Z, r11dc8: 80 91 40 05 lds r24, 0x05401dcc: a8 2f mov r26, r241dce: bb 27 eor r27, r271dd0: aa 0f add r26, r261dd2: bb 1f adc r27, r271dd4: fd 01 movw r30, r261dd6: e9 58 subi r30, 0x89 ; 1371dd8: f7 4f sbci r31, 0xF7 ; 2471dda: 11 82 std Z+1, r1 ; 0x011ddc: 10 82 st Z, r11dde: 80 91 42 05 lds r24, 0x05421de2: e8 2f mov r30, r241de4: ff 27 eor r31, r311de6: ee 0f add r30, r301de8: ff 1f adc r31, r311dea: cf 01 movw r24, r301dec: 89 58 subi r24, 0x89 ; 1371dee: 97 4f sbci r25, 0xF7 ; 2471df0: ec 01 movw r28, r241df2: 19 82 std Y+1, r1 ; 0x011df4: 18 82 st Y, r11df6: 2f 5c subi r18, 0xCF ; 2071df8: 37 4f sbci r19, 0xF7 ; 2471dfa: e9 01 movw r28, r181dfc: 19 82 std Y+1, r1 ; 0x011dfe: 18 82 st Y, r11e00: af 5c subi r26, 0xCF ; 2071e02: b7 4f sbci r27, 0xF7 ; 2471e04: 11 96 adiw r26, 0x01 ; 11e06: 1c 92 st X, r11e08: 1e 92 st -X, r11e0a: ef 5c subi r30, 0xCF ; 2071e0c: f7 4f sbci r31, 0xF7 ; 2471e0e: 11 82 std Z+1, r1 ; 0x011e10: 10 82 st Z, r11e12: 21 c0 rjmp .+66 ; 0x1e56 <DFGeefWEF43tgt5uGreg5+0xde>1e14: c2 2f mov r28, r181e16: cf 70 andi r28, 0x0F ; 151e18: ca 30 cpi r28, 0x0A ; 101e1a: e8 f4 brcc .+58 ; 0x1e56 <DFGeefWEF43tgt5uGreg5+0xde>1e1c: 80 91 ab 0c lds r24, 0x0CAB1e20: 80 93 d6 0c sts 0x0CD6, r241e24: 80 91 ac 0c lds r24, 0x0CAC1e28: 80 93 d5 0c sts 0x0CD5, r241e2c: 80 91 ad 0c lds r24, 0x0CAD1e30: 80 93 d8 0c sts 0x0CD8, r241e34: 80 91 ae 0c lds r24, 0x0CAE1e38: 80 93 d7 0c sts 0x0CD7, r241e3c: 60 91 d5 0c lds r22, 0x0CD51e40: 70 91 d6 0c lds r23, 0x0CD61e44: 8c 2f mov r24, r281e46: ff de rcall .-514 ; 0x1c46 <FGRT0589rge90gj459gg4>1e48: 60 91 d7 0c lds r22, 0x0CD71e4c: 70 91 d8 0c lds r23, 0x0CD81e50: 8c 2f mov r24, r281e52: 8f 5f subi r24, 0xFF ; 2551e54: f8 de rcall .-528 ; 0x1c46 <FGRT0589rge90gj459gg4>1e56: df 91 pop r291e58: cf 91 pop r281e5a: 08 95 ret00001e5c <FGtj76uzh56z3grEg5t45>:1e5c: cf 93 push r281e5e: c8 2f mov r28, r241e60: 8f 3f cpi r24, 0xFF ; 2551e62: 49 f4 brne .+18 ; 0x1e76 <FGtj76uzh56z3grEg5t45+0x1a>1e64: 80 91 f7 02 lds r24, 0x02F71e68: 8f 3f cpi r24, 0xFF ; 2551e6a: 29 f4 brne .+10 ; 0x1e76 <FGtj76uzh56z3grEg5t45+0x1a>1e6c: 10 92 f9 02 sts 0x02F9, r11e70: 10 92 f8 02 sts 0x02F8, r11e74: 31 c0 rjmp .+98 ; 0x1ed8 <FGtj76uzh56z3grEg5t45+0x7c>1e76: 20 91 f9 02 lds r18, 0x02F91e7a: 22 23 and r18, r181e7c: 39 f4 brne .+14 ; 0x1e8c <FGtj76uzh56z3grEg5t45+0x30>1e7e: cf 31 cpi r28, 0x1F ; 311e80: 11 f4 brne .+4 ; 0x1e86 <FGtj76uzh56z3grEg5t45+0x2a>1e82: 85 e0 ldi r24, 0x05 ; 51e84: 01 c0 rjmp .+2 ; 0x1e88 <FGtj76uzh56z3grEg5t45+0x2c>1e86: 84 e0 ldi r24, 0x04 ; 41e88: 80 93 fa 02 sts 0x02FA, r241e8c: 80 91 fa 02 lds r24, 0x02FA1e90: 90 91 f8 02 lds r25, 0x02F81e94: 82 17 cp r24, r181e96: 98 f4 brcc .+38 ; 0x1ebe <FGtj76uzh56z3grEg5t45+0x62>1e98: 89 2f mov r24, r251e9a: 80 95 com r241e9c: 80 93 f8 02 sts 0x02F8, r241ea0: 8f 3f cpi r24, 0xFF ; 2551ea2: 19 f4 brne .+6 ; 0x1eaa <FGtj76uzh56z3grEg5t45+0x4e>1ea4: 8e ef ldi r24, 0xFE ; 2541ea6: 80 93 f8 02 sts 0x02F8, r241eaa: 80 91 f8 02 lds r24, 0x02F81eae: c8 17 cp r28, r241eb0: 09 f4 brne .+2 ; 0x1eb4 <FGtj76uzh56z3grEg5t45+0x58>1eb2: 62 df rcall .-316 ; 0x1d78 <DFGeefWEF43tgt5uGreg5>1eb4: 10 92 f9 02 sts 0x02F9, r11eb8: 10 92 f8 02 sts 0x02F8, r11ebc: 0b c0 rjmp .+22 ; 0x1ed4 <FGtj76uzh56z3grEg5t45+0x78>1ebe: e2 2f mov r30, r181ec0: ff 27 eor r31, r311ec2: e6 55 subi r30, 0x56 ; 861ec4: f3 4f sbci r31, 0xF3 ; 2431ec6: c0 83 st Z, r281ec8: 2f 5f subi r18, 0xFF ; 2551eca: 20 93 f9 02 sts 0x02F9, r181ece: 9c 0f add r25, r281ed0: 90 93 f8 02 sts 0x02F8, r251ed4: c0 93 f7 02 sts 0x02F7, r281ed8: cf 91 pop r281eda: 08 95 ret00001edc <LIBFC_JetiBox_Putchar>:1edc: 90 91 f3 02 lds r25, 0x02F31ee0: 93 32 cpi r25, 0x23 ; 351ee2: 40 f4 brcc .+16 ; 0x1ef4 <LIBFC_JetiBox_Putchar+0x18>1ee4: e9 2f mov r30, r251ee6: ff 27 eor r31, r311ee8: ee 54 subi r30, 0x4E ; 781eea: f3 4f sbci r31, 0xF3 ; 2431eec: 80 83 st Z, r241eee: 9f 5f subi r25, 0xFF ; 2551ef0: 90 93 f3 02 sts 0x02F3, r251ef4: 08 95 ret00001ef6 <LIBFC_JetiBox_SetPos>:1ef6: 83 32 cpi r24, 0x23 ; 351ef8: 18 f4 brcc .+6 ; 0x1f00 <LIBFC_JetiBox_SetPos+0xa>1efa: 8d 5f subi r24, 0xFD ; 2531efc: 80 93 f3 02 sts 0x02F3, r241f00: 08 95 ret00001f02 <LIBFC_JetiBox_Clear>:1f02: 90 e2 ldi r25, 0x20 ; 321f04: e5 eb ldi r30, 0xB5 ; 1811f06: fc e0 ldi r31, 0x0C ; 121f08: 8f e1 ldi r24, 0x1F ; 311f0a: 91 93 st Z+, r251f0c: 81 50 subi r24, 0x01 ; 11f0e: 87 ff sbrs r24, 71f10: fc cf rjmp .-8 ; 0x1f0a <LIBFC_JetiBox_Clear+0x8>1f12: 08 95 ret00001f14 <INiuzBtergGIBuB76T0G5>:1f14: cf 93 push r281f16: cf b7 in r28, 0x3f ; 631f18: 23 e0 ldi r18, 0x03 ; 31f1a: 31 e0 ldi r19, 0x01 ; 11f1c: f8 94 cli1f1e: 80 91 c9 00 lds r24, 0x00C91f22: 8f 77 andi r24, 0x7F ; 1271f24: 80 93 c9 00 sts 0x00C9, r241f28: 80 91 c9 00 lds r24, 0x00C91f2c: 8f 7b andi r24, 0xBF ; 1911f2e: 80 93 c9 00 sts 0x00C9, r241f32: 80 91 c9 00 lds r24, 0x00C91f36: 8f 7d andi r24, 0xDF ; 2231f38: 80 93 c9 00 sts 0x00C9, r241f3c: 83 2f mov r24, r191f3e: 99 27 eor r25, r251f40: 80 93 cd 00 sts 0x00CD, r241f44: 20 93 cc 00 sts 0x00CC, r181f48: 80 91 c8 00 lds r24, 0x00C81f4c: 82 60 ori r24, 0x02 ; 21f4e: 80 93 c8 00 sts 0x00C8, r241f52: 88 e1 ldi r24, 0x18 ; 241f54: 80 93 c9 00 sts 0x00C9, r241f58: 80 91 ca 00 lds r24, 0x00CA1f5c: 8f 77 andi r24, 0x7F ; 1271f5e: 80 93 ca 00 sts 0x00CA, r241f62: 80 91 ca 00 lds r24, 0x00CA1f66: 8f 7b andi r24, 0xBF ; 1911f68: 80 93 ca 00 sts 0x00CA, r241f6c: 80 91 ca 00 lds r24, 0x00CA1f70: 80 62 ori r24, 0x20 ; 321f72: 80 93 ca 00 sts 0x00CA, r241f76: 80 91 ca 00 lds r24, 0x00CA1f7a: 80 61 ori r24, 0x10 ; 161f7c: 80 93 ca 00 sts 0x00CA, r241f80: 80 91 ca 00 lds r24, 0x00CA1f84: 88 60 ori r24, 0x08 ; 81f86: 80 93 ca 00 sts 0x00CA, r241f8a: 80 91 c9 00 lds r24, 0x00C91f8e: 84 60 ori r24, 0x04 ; 41f90: 80 93 c9 00 sts 0x00C9, r241f94: 80 91 ca 00 lds r24, 0x00CA1f98: 84 60 ori r24, 0x04 ; 41f9a: 80 93 ca 00 sts 0x00CA, r241f9e: 80 91 ca 00 lds r24, 0x00CA1fa2: 82 60 ori r24, 0x02 ; 21fa4: 80 93 ca 00 sts 0x00CA, r241fa8: 80 91 c8 00 lds r24, 0x00C81fac: 87 ff sbrs r24, 71fae: 03 c0 rjmp .+6 ; 0x1fb6 <INiuzBtergGIBuB76T0G5+0xa2>1fb0: 80 91 ce 00 lds r24, 0x00CE1fb4: f9 cf rjmp .-14 ; 0x1fa8 <INiuzBtergGIBuB76T0G5+0x94>1fb6: 80 91 c9 00 lds r24, 0x00C91fba: 80 68 ori r24, 0x80 ; 1281fbc: 80 93 c9 00 sts 0x00C9, r241fc0: 80 91 c9 00 lds r24, 0x00C91fc4: 80 64 ori r24, 0x40 ; 641fc6: 80 93 c9 00 sts 0x00C9, r241fca: 9b df rcall .-202 ; 0x1f02 <LIBFC_JetiBox_Clear>1fcc: cf bf out 0x3f, r28 ; 631fce: cf 91 pop r281fd0: 08 95 ret00001fd2 <KLNMIOHMUHG76GFGr43r3>:1fd2: 28 2f mov r18, r241fd4: 99 27 eor r25, r251fd6: 8f 70 andi r24, 0x0F ; 151fd8: 90 70 andi r25, 0x00 ; 01fda: 89 2b or r24, r251fdc: 31 f4 brne .+12 ; 0x1fea <KLNMIOHMUHG76GFGr43r3+0x18>1fde: 20 95 com r181fe0: 80 91 f2 02 lds r24, 0x02F21fe4: 82 2b or r24, r181fe6: 80 93 f2 02 sts 0x02F2, r241fea: 08 95 ret00001fec <__vector_30>:1fec: 1f 92 push r11fee: 0f 92 push r01ff0: 0f b6 in r0, 0x3f ; 631ff2: 0f 92 push r01ff4: 11 24 eor r1, r11ff6: 8f 93 push r241ff8: ef 93 push r301ffa: ff 93 push r311ffc: 80 91 06 01 lds r24, 0x01062000: 88 23 and r24, r242002: 09 f0 breq .+2 ; 0x2006 <__vector_30+0x1a>2004: 68 c0 rjmp .+208 ; 0x20d6 <__vector_30+0xea>2006: e0 91 fc 02 lds r30, 0x02FC200a: ee 23 and r30, r30200c: 89 f4 brne .+34 ; 0x2030 <__vector_30+0x44>200e: 80 91 fb 02 lds r24, 0x02FB2012: 88 23 and r24, r242014: 69 f4 brne .+26 ; 0x2030 <__vector_30+0x44>2016: 80 91 b2 0c lds r24, 0x0CB2201a: 88 23 and r24, r24201c: 21 f0 breq .+8 ; 0x2026 <__vector_30+0x3a>201e: 81 e0 ldi r24, 0x01 ; 12020: 80 93 fd 02 sts 0x02FD, r242024: 05 c0 rjmp .+10 ; 0x2030 <__vector_30+0x44>2026: 80 91 c9 00 lds r24, 0x00C9202a: 81 60 ori r24, 0x01 ; 1202c: 80 93 c9 00 sts 0x00C9, r242030: 80 91 fd 02 lds r24, 0x02FD2034: 88 23 and r24, r242036: 79 f4 brne .+30 ; 0x2056 <__vector_30+0x6a>2038: ef 5f subi r30, 0xFF ; 255203a: e0 93 fc 02 sts 0x02FC, r30203e: 80 91 89 0c lds r24, 0x0C892042: 8e 17 cp r24, r302044: 20 f4 brcc .+8 ; 0x204e <__vector_30+0x62>2046: 81 e0 ldi r24, 0x01 ; 12048: 80 93 fd 02 sts 0x02FD, r24204c: 1c c0 rjmp .+56 ; 0x2086 <__vector_30+0x9a>204e: ff 27 eor r31, r312050: e7 57 subi r30, 0x77 ; 1192052: f3 4f sbci r31, 0xF3 ; 2432054: 3c c0 rjmp .+120 ; 0x20ce <__vector_30+0xe2>2056: 80 91 fb 02 lds r24, 0x02FB205a: 88 23 and r24, r24205c: 61 f4 brne .+24 ; 0x2076 <__vector_30+0x8a>205e: 80 91 b2 0c lds r24, 0x0CB22062: 88 23 and r24, r242064: 11 f4 brne .+4 ; 0x206a <__vector_30+0x7e>2066: 83 e0 ldi r24, 0x03 ; 32068: 03 c0 rjmp .+6 ; 0x2070 <__vector_30+0x84>206a: 81 39 cpi r24, 0x91 ; 145206c: 99 f4 brne .+38 ; 0x2094 <__vector_30+0xa8>206e: 81 e0 ldi r24, 0x01 ; 12070: 80 93 fb 02 sts 0x02FB, r242074: 0f c0 rjmp .+30 ; 0x2094 <__vector_30+0xa8>2076: 83 30 cpi r24, 0x03 ; 32078: 99 f4 brne .+38 ; 0x20a0 <__vector_30+0xb4>207a: 80 91 b2 0c lds r24, 0x0CB2207e: 88 23 and r24, r242080: 49 f0 breq .+18 ; 0x2094 <__vector_30+0xa8>2082: 10 92 b2 0c sts 0x0CB2, r12086: 80 91 c9 00 lds r24, 0x00C9208a: 8e 7f andi r24, 0xFE ; 254208c: 80 93 c9 00 sts 0x00C9, r242090: 8e ef ldi r24, 0xFE ; 2542092: 1e c0 rjmp .+60 ; 0x20d0 <__vector_30+0xe4>2094: 80 91 c9 00 lds r24, 0x00C92098: 81 60 ori r24, 0x01 ; 1209a: 80 93 c9 00 sts 0x00C9, r24209e: 0e c0 rjmp .+28 ; 0x20bc <__vector_30+0xd0>20a0: 83 32 cpi r24, 0x23 ; 3520a2: 61 f4 brne .+24 ; 0x20bc <__vector_30+0xd0>20a4: 80 91 c9 00 lds r24, 0x00C920a8: 8e 7f andi r24, 0xFE ; 25420aa: 80 93 c9 00 sts 0x00C9, r2420ae: 8f ef ldi r24, 0xFF ; 25520b0: 80 93 ce 00 sts 0x00CE, r2420b4: 81 e0 ldi r24, 0x01 ; 120b6: 80 93 06 01 sts 0x0106, r2420ba: 18 c0 rjmp .+48 ; 0x20ec <__vector_30+0x100>20bc: 80 91 fb 02 lds r24, 0x02FB20c0: e8 2f mov r30, r2420c2: ff 27 eor r31, r3120c4: ee 54 subi r30, 0x4E ; 7820c6: f3 4f sbci r31, 0xF3 ; 24320c8: 8f 5f subi r24, 0xFF ; 25520ca: 80 93 fb 02 sts 0x02FB, r2420ce: 80 81 ld r24, Z20d0: 80 93 ce 00 sts 0x00CE, r2420d4: 0b c0 rjmp .+22 ; 0x20ec <__vector_30+0x100>20d6: 10 92 fb 02 sts 0x02FB, r120da: 10 92 fc 02 sts 0x02FC, r120de: 10 92 fd 02 sts 0x02FD, r120e2: 80 91 c9 00 lds r24, 0x00C920e6: 80 61 ori r24, 0x10 ; 1620e8: 80 93 c9 00 sts 0x00C9, r2420ec: ff 91 pop r3120ee: ef 91 pop r3020f0: 8f 91 pop r2420f2: 0f 90 pop r020f4: 0f be out 0x3f, r0 ; 6320f6: 0f 90 pop r020f8: 1f 90 pop r120fa: 18 95 reti000020fc <update_crc>:20fc: 68 27 eor r22, r2420fe: 27 e0 ldi r18, 0x07 ; 72100: 32 2f mov r19, r182102: 67 ff sbrs r22, 72104: 06 c0 rjmp .+12 ; 0x2112 <update_crc+0x16>2106: 86 2f mov r24, r222108: 99 27 eor r25, r25210a: 88 0f add r24, r24210c: 99 1f adc r25, r25210e: 83 27 eor r24, r192110: 02 c0 rjmp .+4 ; 0x2116 <update_crc+0x1a>2112: 86 2f mov r24, r222114: 88 0f add r24, r242116: 68 2f mov r22, r242118: 21 50 subi r18, 0x01 ; 1211a: 27 ff sbrs r18, 7211c: f2 cf rjmp .-28 ; 0x2102 <update_crc+0x6>211e: 99 27 eor r25, r252120: 08 95 ret00002122 <crc8>:2122: 0f 93 push r162124: 1f 93 push r172126: cf 93 push r282128: df 93 push r29212a: 06 2f mov r16, r22212c: 60 e0 ldi r22, 0x00 ; 0212e: 16 2f mov r17, r222130: 60 17 cp r22, r162132: 38 f4 brcc .+14 ; 0x2142 <crc8+0x20>2134: ec 01 movw r28, r242136: 89 91 ld r24, Y+2138: e1 df rcall .-62 ; 0x20fc <update_crc>213a: 68 2f mov r22, r24213c: 1f 5f subi r17, 0xFF ; 255213e: 10 17 cp r17, r162140: d0 f3 brcs .-12 ; 0x2136 <crc8+0x14>2142: 86 2f mov r24, r222144: 99 27 eor r25, r252146: df 91 pop r292148: cf 91 pop r28214a: 1f 91 pop r17214c: 0f 91 pop r16214e: 08 95 ret00002150 <JetiEX_GetLength>:2150: dc 01 movw r26, r242152: 90 e0 ldi r25, 0x00 ; 02154: 96 17 cp r25, r222156: 58 f4 brcc .+22 ; 0x216e <JetiEX_GetLength+0x1e>2158: 8c 91 ld r24, X215a: 80 32 cpi r24, 0x20 ; 32215c: 41 f0 breq .+16 ; 0x216e <JetiEX_GetLength+0x1e>215e: 9f 5f subi r25, 0xFF ; 2552160: 96 17 cp r25, r222162: 28 f4 brcc .+10 ; 0x216e <JetiEX_GetLength+0x1e>2164: fd 01 movw r30, r262166: e9 0f add r30, r252168: f1 1d adc r31, r1216a: 80 81 ld r24, Z216c: f6 cf rjmp .-20 ; 0x215a <JetiEX_GetLength+0xa>216e: 89 2f mov r24, r252170: 99 27 eor r25, r252172: 08 95 ret00002174 <JetiEX_CreatePacket>:2174: a0 e0 ldi r26, 0x00 ; 02176: b0 e0 ldi r27, 0x00 ; 02178: e0 ec ldi r30, 0xC0 ; 192217a: f0 e1 ldi r31, 0x10 ; 16217c: 0c 94 e1 b1 jmp 0x163c2 ; 0x163c2 <__prologue_saves__+0x12>2180: 8f e9 ldi r24, 0x9F ; 1592182: 80 93 8a 0c sts 0x0C8A, r242186: 80 e1 ldi r24, 0x10 ; 162188: 80 93 8c 0c sts 0x0C8C, r24218c: 84 ea ldi r24, 0xA4 ; 164218e: 80 93 8d 0c sts 0x0C8D, r242192: 85 e5 ldi r24, 0x55 ; 852194: 80 93 8e 0c sts 0x0C8E, r242198: 8d e5 ldi r24, 0x5D ; 93219a: 80 93 8f 0c sts 0x0C8F, r24219e: 10 92 90 0c sts 0x0C90, r121a2: 80 91 ff 02 lds r24, 0x02FF21a6: 88 23 and r24, r2421a8: 09 f0 breq .+2 ; 0x21ac <JetiEX_CreatePacket+0x38>21aa: 67 c0 rjmp .+206 ; 0x227a <JetiEX_CreatePacket+0x106>21ac: 80 91 fe 02 lds r24, 0x02FE21b0: 13 e1 ldi r17, 0x13 ; 1921b2: 81 9f mul r24, r1721b4: c0 01 movw r24, r021b6: 11 24 eor r1, r121b8: 63 e0 ldi r22, 0x03 ; 321ba: 88 59 subi r24, 0x98 ; 15221bc: 9e 4f sbci r25, 0xFE ; 25421be: c8 df rcall .-112 ; 0x2150 <JetiEX_GetLength>21c0: 08 2f mov r16, r2421c2: 80 91 fe 02 lds r24, 0x02FE21c6: 81 9f mul r24, r1721c8: c0 01 movw r24, r021ca: 11 24 eor r1, r121cc: 6a e0 ldi r22, 0x0A ; 1021ce: 82 5a subi r24, 0xA2 ; 16221d0: 9e 4f sbci r25, 0xFE ; 25421d2: be df rcall .-132 ; 0x2150 <JetiEX_GetLength>21d4: 98 2f mov r25, r2421d6: 80 0f add r24, r1621d8: 86 5f subi r24, 0xF6 ; 24621da: 80 93 89 0c sts 0x0C89, r2421de: 2e ef ldi r18, 0xFE ; 25421e0: b2 2e mov r11, r1821e2: b8 0e add r11, r2421e4: b0 92 8b 0c sts 0x0C8B, r1121e8: 20 91 fe 02 lds r18, 0x02FE21ec: 20 93 91 0c sts 0x0C91, r1821f0: e9 2e mov r14, r2521f2: ff 24 eor r15, r1521f4: c7 01 movw r24, r1421f6: 13 e0 ldi r17, 0x03 ; 321f8: 88 0f add r24, r2421fa: 99 1f adc r25, r2521fc: 1a 95 dec r1721fe: e1 f7 brne .-8 ; 0x21f8 <JetiEX_CreatePacket+0x84>2200: 80 2b or r24, r162202: 80 93 92 0c sts 0x0C92, r242206: 82 2f mov r24, r182208: 99 27 eor r25, r25220a: c3 e1 ldi r28, 0x13 ; 19220c: cc 2e mov r12, r28220e: d1 2c mov r13, r12210: 8c 9d mul r24, r122212: 90 01 movw r18, r02214: 8d 9d mul r24, r132216: 30 0d add r19, r02218: 9c 9d mul r25, r12221a: 30 0d add r19, r0221c: 11 24 eor r1, r1221e: c9 01 movw r24, r182220: 82 5a subi r24, 0xA2 ; 1622222: 9e 4f sbci r25, 0xFE ; 2542224: a7 01 movw r20, r142226: bc 01 movw r22, r242228: 83 e9 ldi r24, 0x93 ; 147222a: 9c e0 ldi r25, 0x0C ; 12222c: 0e 94 25 b2 call 0x1644a ; 0x1644a <memcpy>2230: 11 27 eor r17, r172232: 80 91 fe 02 lds r24, 0x02FE2236: 99 27 eor r25, r252238: 8c 9d mul r24, r12223a: e0 01 movw r28, r0223c: 8d 9d mul r24, r13223e: d0 0d add r29, r02240: 9c 9d mul r25, r122242: d0 0d add r29, r02244: 11 24 eor r1, r12246: ce 01 movw r24, r282248: 88 59 subi r24, 0x98 ; 152224a: 9e 4f sbci r25, 0xFE ; 254224c: a8 01 movw r20, r16224e: bc 01 movw r22, r242250: c7 01 movw r24, r142252: 8d 56 subi r24, 0x6D ; 1092254: 93 4f sbci r25, 0xF3 ; 2432256: 0e 94 25 b2 call 0x1644a ; 0x1644a <memcpy>225a: 07 57 subi r16, 0x77 ; 119225c: 13 4f sbci r17, 0xF3 ; 243225e: 0e 0d add r16, r142260: 1f 1d adc r17, r152262: 6b 2d mov r22, r112264: 8b e8 ldi r24, 0x8B ; 1392266: 9c e0 ldi r25, 0x0C ; 122268: 5c df rcall .-328 ; 0x2122 <crc8>226a: f8 01 movw r30, r16226c: 82 87 std Z+10, r24 ; 0x0a226e: 80 91 ff 02 lds r24, 0x02FF2272: 8f 5f subi r24, 0xFF ; 2552274: 80 93 ff 02 sts 0x02FF, r242278: 92 c0 rjmp .+292 ; 0x239e <JetiEX_CreatePacket+0x22a>227a: c0 90 90 0c lds r12, 0x0C90227e: 1c 2d mov r17, r122280: 0e 94 b8 84 call 0x10970 ; 0x10970 <JetiEX_Update>2284: 30 91 07 01 lds r19, 0x01072288: 30 31 cpi r19, 0x10 ; 16228a: 08 f0 brcs .+2 ; 0x228e <JetiEX_CreatePacket+0x11a>228c: 58 c0 rjmp .+176 ; 0x233e <JetiEX_CreatePacket+0x1ca>228e: b3 e1 ldi r27, 0x13 ; 192290: eb 2e mov r14, r272292: f1 2c mov r15, r12294: 63 2f mov r22, r192296: 81 2f mov r24, r172298: 99 27 eor r25, r25229a: fc 01 movw r30, r24229c: ee 0f add r30, r30229e: ff 1f adc r31, r3122a0: e8 0f add r30, r2422a2: f9 1f adc r31, r2522a4: ec 0d add r30, r1222a6: f1 1d adc r31, r122a8: e7 57 subi r30, 0x77 ; 11922aa: f3 4f sbci r31, 0xF3 ; 24322ac: 83 2f mov r24, r1922ae: 99 27 eor r25, r2522b0: 8e 9d mul r24, r1422b2: d0 01 movw r26, r022b4: 8f 9d mul r24, r1522b6: b0 0d add r27, r022b8: 9e 9d mul r25, r1422ba: b0 0d add r27, r022bc: 11 24 eor r1, r122be: a2 5a subi r26, 0xA2 ; 16222c0: be 4f sbci r27, 0xFE ; 25422c2: ed 01 movw r28, r2622c4: 2d 85 ldd r18, Y+13 ; 0x0d22c6: 74 e0 ldi r23, 0x04 ; 422c8: 88 0f add r24, r2422ca: 99 1f adc r25, r2522cc: 7a 95 dec r2322ce: e1 f7 brne .-8 ; 0x22c8 <JetiEX_CreatePacket+0x154>22d0: 28 2b or r18, r2422d2: 20 87 std Z+8, r18 ; 0x0822d4: 3e 30 cpi r19, 0x0E ; 1422d6: 88 f4 brcc .+34 ; 0x22fa <JetiEX_CreatePacket+0x186>22d8: 2e 85 ldd r18, Y+14 ; 0x0e22da: 3f 85 ldd r19, Y+15 ; 0x0f22dc: 3f 79 andi r19, 0x9F ; 15922de: 8a 89 ldd r24, Y+18 ; 0x1222e0: 99 27 eor r25, r2522e2: 98 2f mov r25, r2422e4: 88 27 eor r24, r2422e6: 92 95 swap r2522e8: 99 0f add r25, r2522ea: 90 7e andi r25, 0xE0 ; 22422ec: 28 2b or r18, r2422ee: 39 2b or r19, r2522f0: 21 87 std Z+9, r18 ; 0x0922f2: 83 2f mov r24, r1922f4: 99 27 eor r25, r2522f6: 82 87 std Z+10, r24 ; 0x0a22f8: 16 c0 rjmp .+44 ; 0x2326 <JetiEX_CreatePacket+0x1b2>22fa: ed 01 movw r28, r2622fc: 2e 85 ldd r18, Y+14 ; 0x0e22fe: 3f 85 ldd r19, Y+15 ; 0x0f2300: 48 89 ldd r20, Y+16 ; 0x102302: 59 89 ldd r21, Y+17 ; 0x112304: 21 87 std Z+9, r18 ; 0x092306: bb 27 eor r27, r272308: a5 2f mov r26, r21230a: 94 2f mov r25, r20230c: 83 2f mov r24, r19230e: 82 87 std Z+10, r24 ; 0x0a2310: ca 01 movw r24, r202312: aa 27 eor r26, r262314: bb 27 eor r27, r272316: 83 87 std Z+11, r24 ; 0x0b2318: 85 2f mov r24, r21231a: 99 27 eor r25, r25231c: aa 27 eor r26, r26231e: bb 27 eor r27, r272320: 84 87 std Z+12, r24 ; 0x0c2322: e2 e0 ldi r30, 0x02 ; 22324: ce 0e add r12, r302326: 86 2f mov r24, r222328: 8f 5f subi r24, 0xFF ; 255232a: 68 2f mov r22, r24232c: 1f 5f subi r17, 0xFF ; 255232e: 16 30 cpi r17, 0x06 ; 62330: 20 f4 brcc .+8 ; 0x233a <JetiEX_CreatePacket+0x1c6>2332: 38 2f mov r19, r242334: 80 31 cpi r24, 0x10 ; 162336: 08 f4 brcc .+2 ; 0x233a <JetiEX_CreatePacket+0x1c6>2338: ae cf rjmp .-164 ; 0x2296 <JetiEX_CreatePacket+0x122>233a: 80 93 07 01 sts 0x0107, r24233e: 83 e0 ldi r24, 0x03 ; 32340: 18 9f mul r17, r242342: c0 01 movw r24, r02344: 11 24 eor r1, r12346: 2c 2d mov r18, r122348: 28 0f add r18, r24234a: 28 5f subi r18, 0xF8 ; 248234c: 20 93 89 0c sts 0x0C89, r182350: 22 5c subi r18, 0xC2 ; 1942352: 20 93 8b 0c sts 0x0C8B, r182356: 81 2f mov r24, r172358: 99 27 eor r25, r25235a: 8c 01 movw r16, r24235c: 00 0f add r16, r16235e: 11 1f adc r17, r172360: 08 0f add r16, r242362: 19 1f adc r17, r252364: 0c 0d add r16, r122366: 11 1d adc r17, r12368: 07 57 subi r16, 0x77 ; 119236a: 13 4f sbci r17, 0xF3 ; 243236c: 20 54 subi r18, 0x40 ; 64236e: 62 2f mov r22, r182370: 8b e8 ldi r24, 0x8B ; 1392372: 9c e0 ldi r25, 0x0C ; 122374: d6 de rcall .-596 ; 0x2122 <crc8>2376: e8 01 movw r28, r162378: 88 87 std Y+8, r24 ; 0x08237a: 80 91 07 01 lds r24, 0x0107237e: 80 31 cpi r24, 0x10 ; 162380: 70 f0 brcs .+28 ; 0x239e <JetiEX_CreatePacket+0x22a>2382: 81 e0 ldi r24, 0x01 ; 12384: 80 93 07 01 sts 0x0107, r242388: 10 92 ff 02 sts 0x02FF, r1238c: 80 91 fe 02 lds r24, 0x02FE2390: 8f 5f subi r24, 0xFF ; 2552392: 80 93 fe 02 sts 0x02FE, r242396: 80 31 cpi r24, 0x10 ; 162398: 10 f0 brcs .+4 ; 0x239e <JetiEX_CreatePacket+0x22a>239a: 10 92 fe 02 sts 0x02FE, r1239e: e9 e0 ldi r30, 0x09 ; 923a0: cd b7 in r28, 0x3d ; 6123a2: de b7 in r29, 0x3e ; 6223a4: 0c 94 fd b1 jmp 0x163fa ; 0x163fa <__epilogue_restores__+0x12>000023a8 <a48784362857632195659>:23a8: 80 91 06 01 lds r24, 0x010623ac: 88 23 and r24, r2423ae: 09 f4 brne .+2 ; 0x23b2 <a48784362857632195659+0xa>23b0: 46 c0 rjmp .+140 ; 0x243e <a48784362857632195659+0x96>23b2: 80 91 cb 03 lds r24, 0x03CB23b6: 85 fd sbrc r24, 523b8: 04 c0 rjmp .+8 ; 0x23c2 <a48784362857632195659+0x1a>23ba: 80 91 5c 04 lds r24, 0x045C23be: 88 23 and r24, r2423c0: 81 f0 breq .+32 ; 0x23e2 <a48784362857632195659+0x3a>23c2: 82 e9 ldi r24, 0x92 ; 14623c4: 80 93 b2 0c sts 0x0CB2, r2423c8: 83 e2 ldi r24, 0x23 ; 3523ca: 80 93 b3 0c sts 0x0CB3, r2423ce: 80 91 5c 04 lds r24, 0x045C23d2: 88 23 and r24, r2423d4: 09 f4 brne .+2 ; 0x23d8 <a48784362857632195659+0x30>23d6: 85 e5 ldi r24, 0x55 ; 8523d8: 80 93 b4 0c sts 0x0CB4, r2423dc: 10 92 5c 04 sts 0x045C, r123e0: 02 c0 rjmp .+4 ; 0x23e6 <a48784362857632195659+0x3e>23e2: 80 93 b2 0c sts 0x0CB2, r2423e6: 80 91 08 01 lds r24, 0x010823ea: 8f 30 cpi r24, 0x0F ; 1523ec: 71 f4 brne .+28 ; 0x240a <a48784362857632195659+0x62>23ee: 80 91 f2 02 lds r24, 0x02F223f2: 0e 94 ad 83 call 0x1075a ; 0x1075a <JetiBox_Update>23f6: 88 23 and r24, r2423f8: 41 f0 breq .+16 ; 0x240a <a48784362857632195659+0x62>23fa: 81 e9 ldi r24, 0x91 ; 14523fc: 80 93 b2 0c sts 0x0CB2, r242400: 80 93 b3 0c sts 0x0CB3, r242404: 81 e3 ldi r24, 0x31 ; 492406: 80 93 b4 0c sts 0x0CB4, r24240a: 10 92 06 01 sts 0x0106, r1240e: 80 91 c8 00 lds r24, 0x00C82412: 85 ff sbrs r24, 52414: fc cf rjmp .-8 ; 0x240e <a48784362857632195659+0x66>2416: 80 91 c9 00 lds r24, 0x00C9241a: 8f 7e andi r24, 0xEF ; 239241c: 80 93 c9 00 sts 0x00C9, r242420: 80 91 c9 00 lds r24, 0x00C92424: 8e 7f andi r24, 0xFE ; 2542426: 80 93 c9 00 sts 0x00C9, r24242a: a4 de rcall .-696 ; 0x2174 <JetiEX_CreatePacket>242c: 8e e7 ldi r24, 0x7E ; 126242e: 80 93 ce 00 sts 0x00CE, r242432: 80 91 f2 02 lds r24, 0x02F22436: 80 93 08 01 sts 0x0108, r24243a: 10 92 f2 02 sts 0x02F2, r1243e: 08 95 ret00002440 <njkvnfuhgbuzrgezgf483>:2440: ef 92 push r142442: ff 92 push r152444: 0f 93 push r162446: 1f 93 push r172448: cf 93 push r28244a: df 93 push r29244c: 7c 01 movw r14, r24244e: 8b 01 movw r16, r222450: ea 01 movw r28, r202452: 45 2b or r20, r212454: 39 f0 breq .+14 ; 0x2464 <njkvnfuhgbuzrgezgf483+0x24>2456: f8 01 movw r30, r162458: 81 91 ld r24, Z+245a: 8f 01 movw r16, r30245c: f7 01 movw r30, r14245e: 09 95 icall2460: 21 97 sbiw r28, 0x01 ; 12462: c9 f7 brne .-14 ; 0x2456 <njkvnfuhgbuzrgezgf483+0x16>2464: e6 e0 ldi r30, 0x06 ; 62466: cd b7 in r28, 0x3d ; 612468: de b7 in r29, 0x3e ; 62246a: 0c 94 00 b2 jmp 0x16400 ; 0x16400 <__epilogue_restores__+0x18>0000246e <lkvgnfdgun57th38rgh84>:246e: ef 92 push r142470: ff 92 push r152472: 0f 93 push r162474: 1f 93 push r172476: cf 93 push r282478: df 93 push r29247a: 7c 01 movw r14, r24247c: 8b 01 movw r16, r22247e: ea 01 movw r28, r202480: 45 2b or r20, r212482: 41 f0 breq .+16 ; 0x2494 <lkvgnfdgun57th38rgh84+0x26>2484: f8 01 movw r30, r162486: 0f 5f subi r16, 0xFF ; 2552488: 1f 4f sbci r17, 0xFF ; 255248a: 84 91 lpm r24, Z248c: f7 01 movw r30, r14248e: 09 95 icall2490: 21 97 sbiw r28, 0x01 ; 12492: c1 f7 brne .-16 ; 0x2484 <lkvgnfdgun57th38rgh84+0x16>2494: e6 e0 ldi r30, 0x06 ; 62496: cd b7 in r28, 0x3d ; 612498: de b7 in r29, 0x3e ; 62249a: 0c 94 00 b2 jmp 0x16400 ; 0x16400 <__epilogue_restores__+0x18>0000249e <fgmjgnrtuth587th9rTrw>:249e: 0f 93 push r1624a0: 1f 93 push r1724a2: cf 93 push r2824a4: 8c 01 movw r16, r2424a6: c6 2f mov r28, r2224a8: 16 16 cp r1, r2224aa: 34 f4 brge .+12 ; 0x24b8 <fgmjgnrtuth587th9rTrw+0x1a>24ac: 80 e2 ldi r24, 0x20 ; 3224ae: f8 01 movw r30, r1624b0: 09 95 icall24b2: c1 50 subi r28, 0x01 ; 124b4: 1c 16 cp r1, r2824b6: d4 f3 brlt .-12 ; 0x24ac <fgmjgnrtuth587th9rTrw+0xe>24b8: cf 91 pop r2824ba: 1f 91 pop r1724bc: 0f 91 pop r1624be: 08 95 ret000024c0 <wqqeRT45jth8g758735h4>:24c0: 0f 93 push r1624c2: 1f 93 push r1724c4: cf 93 push r2824c6: 8c 01 movw r16, r2424c8: c6 2f mov r28, r2224ca: 16 16 cp r1, r2224cc: 34 f4 brge .+12 ; 0x24da <wqqeRT45jth8g758735h4+0x1a>24ce: 80 e3 ldi r24, 0x30 ; 4824d0: f8 01 movw r30, r1624d2: 09 95 icall24d4: c1 50 subi r28, 0x01 ; 124d6: 1c 16 cp r1, r2824d8: d4 f3 brlt .-12 ; 0x24ce <wqqeRT45jth8g758735h4+0xe>24da: cf 91 pop r2824dc: 1f 91 pop r1724de: 0f 91 pop r1624e0: 08 95 ret000024e2 <IIllllIllIlllIIlllII>:24e2: a5 e3 ldi r26, 0x35 ; 5324e4: b0 e0 ldi r27, 0x00 ; 024e6: e7 e7 ldi r30, 0x77 ; 11924e8: f2 e1 ldi r31, 0x12 ; 1824ea: 0c 94 d8 b1 jmp 0x163b0 ; 0x163b0 <__prologue_saves__>24ee: 2e 96 adiw r28, 0x0e ; 1424f0: ee ad ldd r30, Y+62 ; 0x3e24f2: ff ad ldd r31, Y+63 ; 0x3f24f4: 2e 97 sbiw r28, 0x0e ; 1424f6: 88 24 eor r8, r824f8: 99 24 eor r9, r924fa: 54 01 movw r10, r824fc: 80 91 ec 02 lds r24, 0x02EC2500: 88 23 and r24, r242502: 21 f4 brne .+8 ; 0x250c <IIllllIllIlllIIlllII+0x2a>2504: 2c 96 adiw r28, 0x0c ; 122506: 1f ae std Y+63, r1 ; 0x3f2508: 1e ae std Y+62, r1 ; 0x3e250a: 2c 97 sbiw r28, 0x0c ; 12250c: ae e4 ldi r26, 0x4E ; 78250e: 4a 2e mov r4, r262510: 51 2c mov r5, r12512: 4c 0e add r4, r282514: 5d 1e adc r5, r292516: 6f 01 movw r12, r302518: b6 01 movw r22, r12251a: 05 c0 rjmp .+10 ; 0x2526 <IIllllIllIlllIIlllII+0x44>251c: 15 32 cpi r17, 0x25 ; 37251e: 39 f0 breq .+14 ; 0x252e <IIllllIllIlllIIlllII+0x4c>2520: 08 94 sec2522: c1 1c adc r12, r12524: d1 1c adc r13, r12526: f6 01 movw r30, r122528: 14 91 lpm r17, Z252a: 11 23 and r17, r17252c: b9 f7 brne .-18 ; 0x251c <IIllllIllIlllIIlllII+0x3a>252e: a6 01 movw r20, r122530: 46 1b sub r20, r222532: 57 0b sbc r21, r232534: 29 f0 breq .+10 ; 0x2540 <IIllllIllIlllIIlllII+0x5e>2536: 2c 96 adiw r28, 0x0c ; 122538: 8e ad ldd r24, Y+62 ; 0x3e253a: 9f ad ldd r25, Y+63 ; 0x3f253c: 2c 97 sbiw r28, 0x0c ; 12253e: 97 df rcall .-210 ; 0x246e <lkvgnfdgun57th38rgh84>2540: 11 23 and r17, r172542: 09 f4 brne .+2 ; 0x2546 <IIllllIllIlllIIlllII+0x64>2544: 64 c2 rjmp .+1224 ; 0x2a0e <IIllllIllIlllIIlllII+0x52c>2546: 08 94 sec2548: c1 1c adc r12, r1254a: d1 1c adc r13, r1254c: ff 24 eor r15, r15254e: fd a6 std Y+45, r15 ; 0x2d2550: fc a6 std Y+44, r15 ; 0x2c2552: ef ef ldi r30, 0xFF ; 2552554: ee 2e mov r14, r302556: f9 a6 std Y+41, r15 ; 0x292558: f6 01 movw r30, r12255a: 08 94 sec255c: c1 1c adc r12, r1255e: d1 1c adc r13, r12560: 14 91 lpm r17, Z2562: 15 37 cpi r17, 0x75 ; 1172564: 21 f0 breq .+8 ; 0x256e <IIllllIllIlllIIlllII+0x8c>2566: 81 2f mov r24, r172568: 80 62 ori r24, 0x20 ; 32256a: 88 37 cpi r24, 0x78 ; 120256c: b1 f4 brne .+44 ; 0x259a <IIllllIllIlllIIlllII+0xb8>256e: f0 fe sbrs r15, 02570: 0a c0 rjmp .+20 ; 0x2586 <IIllllIllIlllIIlllII+0xa4>2572: f2 01 movw r30, r42574: 24 e0 ldi r18, 0x04 ; 42576: 30 e0 ldi r19, 0x00 ; 02578: 42 0e add r4, r18257a: 53 1e adc r5, r19257c: 80 80 ld r8, Z257e: 91 80 ldd r9, Z+1 ; 0x012580: a2 80 ldd r10, Z+2 ; 0x022582: b3 80 ldd r11, Z+3 ; 0x032584: 0a c0 rjmp .+20 ; 0x259a <IIllllIllIlllIIlllII+0xb8>2586: f2 01 movw r30, r42588: 42 e0 ldi r20, 0x02 ; 2258a: 50 e0 ldi r21, 0x00 ; 0258c: 44 0e add r4, r20258e: 55 1e adc r5, r212590: 80 81 ld r24, Z2592: 91 81 ldd r25, Z+1 ; 0x012594: 4c 01 movw r8, r242596: aa 24 eor r10, r102598: bb 24 eor r11, r11259a: 10 32 cpi r17, 0x20 ; 32259c: 21 f4 brne .+8 ; 0x25a6 <IIllllIllIlllIIlllII+0xc4>259e: 89 a5 ldd r24, Y+41 ; 0x2925a0: 88 23 and r24, r2425a2: d1 f6 brne .-76 ; 0x2558 <IIllllIllIlllIIlllII+0x76>25a4: 1d c0 rjmp .+58 ; 0x25e0 <IIllllIllIlllIIlllII+0xfe>25a6: 13 32 cpi r17, 0x23 ; 3525a8: 19 f4 brne .+6 ; 0x25b0 <IIllllIllIlllIIlllII+0xce>25aa: 58 e0 ldi r21, 0x08 ; 825ac: f5 2a or r15, r2125ae: d4 cf rjmp .-88 ; 0x2558 <IIllllIllIlllIIlllII+0x76>25b0: 1a 32 cpi r17, 0x2A ; 4225b2: 11 f0 breq .+4 ; 0x25b8 <IIllllIllIlllIIlllII+0xd6>25b4: 1d 32 cpi r17, 0x2D ; 4525b6: 91 f4 brne .+36 ; 0x25dc <IIllllIllIlllIIlllII+0xfa>25b8: 1a 32 cpi r17, 0x2A ; 4225ba: 59 f4 brne .+22 ; 0x25d2 <IIllllIllIlllIIlllII+0xf0>25bc: f2 01 movw r30, r425be: 82 e0 ldi r24, 0x02 ; 225c0: 90 e0 ldi r25, 0x00 ; 025c2: 48 0e add r4, r2425c4: 59 1e adc r5, r2525c6: e0 81 ld r30, Z25c8: ec a7 std Y+44, r30 ; 0x2c25ca: ee 23 and r30, r3025cc: 2c f6 brge .-118 ; 0x2558 <IIllllIllIlllIIlllII+0x76>25ce: e1 95 neg r3025d0: ec a7 std Y+44, r30 ; 0x2c25d2: 90 e1 ldi r25, 0x10 ; 1625d4: f9 2a or r15, r2525d6: af ed ldi r26, 0xDF ; 22325d8: fa 22 and r15, r2625da: be cf rjmp .-132 ; 0x2558 <IIllllIllIlllIIlllII+0x76>25dc: 1b 32 cpi r17, 0x2B ; 4325de: 11 f4 brne .+4 ; 0x25e4 <IIllllIllIlllIIlllII+0x102>25e0: 19 a7 std Y+41, r17 ; 0x2925e2: ba cf rjmp .-140 ; 0x2558 <IIllllIllIlllIIlllII+0x76>25e4: 1e 32 cpi r17, 0x2E ; 4625e6: c1 f5 brne .+112 ; 0x2658 <IIllllIllIlllIIlllII+0x176>25e8: f6 01 movw r30, r1225ea: 08 94 sec25ec: c1 1c adc r12, r125ee: d1 1c adc r13, r125f0: 14 91 lpm r17, Z25f2: 1a 32 cpi r17, 0x2A ; 4225f4: 79 f4 brne .+30 ; 0x2614 <IIllllIllIlllIIlllII+0x132>25f6: f2 01 movw r30, r425f8: 22 e0 ldi r18, 0x02 ; 225fa: 30 e0 ldi r19, 0x00 ; 025fc: 42 0e add r4, r1825fe: 53 1e adc r5, r192600: 40 81 ld r20, Z2602: 51 81 ldd r21, Z+1 ; 0x012604: 3f ef ldi r19, 0xFF ; 2552606: 4f 3f cpi r20, 0xFF ; 2552608: 53 07 cpc r21, r19260a: 14 f4 brge .+4 ; 0x2610 <IIllllIllIlllIIlllII+0x12e>260c: 4f ef ldi r20, 0xFF ; 255260e: 5f ef ldi r21, 0xFF ; 2552610: e4 2e mov r14, r202612: a2 cf rjmp .-188 ; 0x2558 <IIllllIllIlllIIlllII+0x76>2614: 40 e0 ldi r20, 0x00 ; 02616: 50 e0 ldi r21, 0x00 ; 02618: 81 2f mov r24, r17261a: 80 53 subi r24, 0x30 ; 48261c: 8a 30 cpi r24, 0x0A ; 10261e: a0 f4 brcc .+40 ; 0x2648 <IIllllIllIlllIIlllII+0x166>2620: ca 01 movw r24, r202622: 73 e0 ldi r23, 0x03 ; 32624: 88 0f add r24, r242626: 99 1f adc r25, r252628: 7a 95 dec r23262a: e1 f7 brne .-8 ; 0x2624 <IIllllIllIlllIIlllII+0x142>262c: 84 0f add r24, r20262e: 95 1f adc r25, r212630: 48 0f add r20, r242632: 59 1f adc r21, r252634: 41 0f add r20, r172636: 51 1d adc r21, r12638: 40 53 subi r20, 0x30 ; 48263a: 50 40 sbci r21, 0x00 ; 0263c: f6 01 movw r30, r12263e: 08 94 sec2640: c1 1c adc r12, r12642: d1 1c adc r13, r12644: 14 91 lpm r17, Z2646: e8 cf rjmp .-48 ; 0x2618 <IIllllIllIlllIIlllII+0x136>2648: 8f ef ldi r24, 0xFF ; 255264a: 4f 3f cpi r20, 0xFF ; 255264c: 58 07 cpc r21, r24264e: 14 f4 brge .+4 ; 0x2654 <IIllllIllIlllIIlllII+0x172>2650: 4f ef ldi r20, 0xFF ; 2552652: 5f ef ldi r21, 0xFF ; 2552654: e4 2e mov r14, r202656: 85 cf rjmp .-246 ; 0x2562 <IIllllIllIlllIIlllII+0x80>2658: 10 33 cpi r17, 0x30 ; 48265a: 29 f4 brne .+10 ; 0x2666 <IIllllIllIlllIIlllII+0x184>265c: f4 fc sbrc r15, 4265e: 7c cf rjmp .-264 ; 0x2558 <IIllllIllIlllIIlllII+0x76>2660: 90 e2 ldi r25, 0x20 ; 322662: f9 2a or r15, r252664: 79 cf rjmp .-270 ; 0x2558 <IIllllIllIlllIIlllII+0x76>2666: 81 2f mov r24, r172668: 81 53 subi r24, 0x31 ; 49266a: 89 30 cpi r24, 0x09 ; 9266c: d8 f4 brcc .+54 ; 0x26a4 <IIllllIllIlllIIlllII+0x1c2>266e: 40 e0 ldi r20, 0x00 ; 02670: 50 e0 ldi r21, 0x00 ; 02672: ca 01 movw r24, r202674: 63 e0 ldi r22, 0x03 ; 32676: 88 0f add r24, r242678: 99 1f adc r25, r25267a: 6a 95 dec r22267c: e1 f7 brne .-8 ; 0x2676 <IIllllIllIlllIIlllII+0x194>267e: 84 0f add r24, r202680: 95 1f adc r25, r212682: 48 0f add r20, r242684: 59 1f adc r21, r252686: 41 0f add r20, r172688: 51 1d adc r21, r1268a: 40 53 subi r20, 0x30 ; 48268c: 50 40 sbci r21, 0x00 ; 0268e: f6 01 movw r30, r122690: 08 94 sec2692: c1 1c adc r12, r12694: d1 1c adc r13, r12696: 14 91 lpm r17, Z2698: 81 2f mov r24, r17269a: 80 53 subi r24, 0x30 ; 48269c: 8a 30 cpi r24, 0x0A ; 10269e: 48 f3 brcs .-46 ; 0x2672 <IIllllIllIlllIIlllII+0x190>26a0: 4c a7 std Y+44, r20 ; 0x2c26a2: 5f cf rjmp .-322 ; 0x2562 <IIllllIllIlllIIlllII+0x80>26a4: 18 36 cpi r17, 0x68 ; 10426a6: 19 f4 brne .+6 ; 0x26ae <IIllllIllIlllIIlllII+0x1cc>26a8: a4 e0 ldi r26, 0x04 ; 426aa: fa 2a or r15, r2626ac: 55 cf rjmp .-342 ; 0x2558 <IIllllIllIlllIIlllII+0x76>26ae: 1c 36 cpi r17, 0x6C ; 10826b0: 19 f4 brne .+6 ; 0x26b8 <IIllllIllIlllIIlllII+0x1d6>26b2: b1 e0 ldi r27, 0x01 ; 126b4: fb 2a or r15, r2726b6: 50 cf rjmp .-352 ; 0x2558 <IIllllIllIlllIIlllII+0x76>26b8: 13 36 cpi r17, 0x63 ; 9926ba: 61 f4 brne .+24 ; 0x26d4 <IIllllIllIlllIIlllII+0x1f2>26bc: 3e 01 movw r6, r2826be: 08 94 sec26c0: 61 1c adc r6, r126c2: 71 1c adc r7, r126c4: f2 01 movw r30, r426c6: 22 e0 ldi r18, 0x02 ; 226c8: 30 e0 ldi r19, 0x00 ; 026ca: 42 0e add r4, r1826cc: 53 1e adc r5, r1926ce: 80 81 ld r24, Z26d0: 89 83 std Y+1, r24 ; 0x0126d2: 3c c1 rjmp .+632 ; 0x294c <IIllllIllIlllIIlllII+0x46a>26d4: 14 34 cpi r17, 0x44 ; 6826d6: 21 f0 breq .+8 ; 0x26e0 <IIllllIllIlllIIlllII+0x1fe>26d8: 14 36 cpi r17, 0x64 ; 10026da: 11 f0 breq .+4 ; 0x26e0 <IIllllIllIlllIIlllII+0x1fe>26dc: 19 36 cpi r17, 0x69 ; 10526de: 51 f5 brne .+84 ; 0x2734 <IIllllIllIlllIIlllII+0x252>26e0: 14 34 cpi r17, 0x44 ; 6826e2: 11 f4 brne .+4 ; 0x26e8 <IIllllIllIlllIIlllII+0x206>26e4: 31 e0 ldi r19, 0x01 ; 126e6: f3 2a or r15, r1926e8: f0 fe sbrs r15, 026ea: 0a c0 rjmp .+20 ; 0x2700 <IIllllIllIlllIIlllII+0x21e>26ec: f2 01 movw r30, r426ee: 44 e0 ldi r20, 0x04 ; 426f0: 50 e0 ldi r21, 0x00 ; 026f2: 44 0e add r4, r2026f4: 55 1e adc r5, r2126f6: 80 80 ld r8, Z26f8: 91 80 ldd r9, Z+1 ; 0x0126fa: a2 80 ldd r10, Z+2 ; 0x0226fc: b3 80 ldd r11, Z+3 ; 0x0326fe: 0c c0 rjmp .+24 ; 0x2718 <IIllllIllIlllIIlllII+0x236>2700: f2 01 movw r30, r42702: 82 e0 ldi r24, 0x02 ; 22704: 90 e0 ldi r25, 0x00 ; 02706: 48 0e add r4, r242708: 59 1e adc r5, r25270a: 80 81 ld r24, Z270c: 91 81 ldd r25, Z+1 ; 0x01270e: 4c 01 movw r8, r242710: aa 24 eor r10, r102712: 97 fc sbrc r9, 72714: a0 94 com r102716: ba 2c mov r11, r102718: b7 fe sbrs r11, 7271a: 0a c0 rjmp .+20 ; 0x2730 <IIllllIllIlllIIlllII+0x24e>271c: b0 94 com r11271e: a0 94 com r102720: 90 94 com r92722: 80 94 com r82724: 81 1c adc r8, r12726: 91 1c adc r9, r12728: a1 1c adc r10, r1272a: b1 1c adc r11, r1272c: 8d e2 ldi r24, 0x2D ; 45272e: 89 a7 std Y+41, r24 ; 0x292730: 0a e0 ldi r16, 0x0A ; 102732: 6f c0 rjmp .+222 ; 0x2812 <IIllllIllIlllIIlllII+0x330>2734: 1f 34 cpi r17, 0x4F ; 792736: 11 f0 breq .+4 ; 0x273c <IIllllIllIlllIIlllII+0x25a>2738: 1f 36 cpi r17, 0x6F ; 111273a: 31 f4 brne .+12 ; 0x2748 <IIllllIllIlllIIlllII+0x266>273c: 1f 34 cpi r17, 0x4F ; 79273e: 11 f4 brne .+4 ; 0x2744 <IIllllIllIlllIIlllII+0x262>2740: 91 e0 ldi r25, 0x01 ; 12742: f9 2a or r15, r252744: 08 e0 ldi r16, 0x08 ; 82746: 64 c0 rjmp .+200 ; 0x2810 <IIllllIllIlllIIlllII+0x32e>2748: 10 37 cpi r17, 0x70 ; 112274a: 79 f4 brne .+30 ; 0x276a <IIllllIllIlllIIlllII+0x288>274c: f2 01 movw r30, r4274e: a2 e0 ldi r26, 0x02 ; 22750: b0 e0 ldi r27, 0x00 ; 02752: 4a 0e add r4, r262754: 5b 1e adc r5, r272756: 80 81 ld r24, Z2758: 91 81 ldd r25, Z+1 ; 0x01275a: 4c 01 movw r8, r24275c: aa 24 eor r10, r10275e: bb 24 eor r11, r112760: 00 e1 ldi r16, 0x10 ; 162762: b0 e4 ldi r27, 0x40 ; 642764: fb 2a or r15, r272766: 18 e7 ldi r17, 0x78 ; 1202768: 53 c0 rjmp .+166 ; 0x2810 <IIllllIllIlllIIlllII+0x32e>276a: 13 37 cpi r17, 0x73 ; 115276c: c1 f5 brne .+112 ; 0x27de <IIllllIllIlllIIlllII+0x2fc>276e: f2 01 movw r30, r42770: 22 e0 ldi r18, 0x02 ; 22772: 30 e0 ldi r19, 0x00 ; 02774: 42 0e add r4, r182776: 53 1e adc r5, r192778: 60 80 ld r6, Z277a: 71 80 ldd r7, Z+1 ; 0x01277c: 61 14 cp r6, r1277e: 71 04 cpc r7, r12780: 89 f4 brne .+34 ; 0x27a4 <IIllllIllIlllIIlllII+0x2c2>2782: 3e 01 movw r6, r282784: 08 94 sec2786: 61 1c adc r6, r12788: 71 1c adc r7, r1278a: 88 e2 ldi r24, 0x28 ; 40278c: 89 83 std Y+1, r24 ; 0x01278e: 8e e6 ldi r24, 0x6E ; 1102790: f3 01 movw r30, r62792: 81 83 std Z+1, r24 ; 0x012794: 85 e7 ldi r24, 0x75 ; 1172796: 8b 83 std Y+3, r24 ; 0x032798: 8c e6 ldi r24, 0x6C ; 108279a: 8c 83 std Y+4, r24 ; 0x04279c: 8d 83 std Y+5, r24 ; 0x05279e: 89 e2 ldi r24, 0x29 ; 4127a0: 8e 83 std Y+6, r24 ; 0x0627a2: 1f 82 std Y+7, r1 ; 0x0727a4: e7 fc sbrc r14, 727a6: 13 c0 rjmp .+38 ; 0x27ce <IIllllIllIlllIIlllII+0x2ec>27a8: 8e 2d mov r24, r1427aa: 99 27 eor r25, r2527ac: 87 fd sbrc r24, 727ae: 90 95 com r2527b0: ac 01 movw r20, r2427b2: 60 e0 ldi r22, 0x00 ; 027b4: 70 e0 ldi r23, 0x00 ; 027b6: c3 01 movw r24, r627b8: 0e 94 18 b2 call 0x16430 ; 0x16430 <memchr>27bc: 00 97 sbiw r24, 0x00 ; 027be: 29 f0 breq .+10 ; 0x27ca <IIllllIllIlllIIlllII+0x2e8>27c0: 38 2e mov r3, r2427c2: 36 18 sub r3, r627c4: e3 14 cp r14, r327c6: 0c f0 brlt .+2 ; 0x27ca <IIllllIllIlllIIlllII+0x2e8>27c8: c3 c0 rjmp .+390 ; 0x2950 <IIllllIllIlllIIlllII+0x46e>27ca: 3e 2c mov r3, r1427cc: c1 c0 rjmp .+386 ; 0x2950 <IIllllIllIlllIIlllII+0x46e>27ce: f3 01 movw r30, r627d0: 01 90 ld r0, Z+27d2: 00 20 and r0, r027d4: e9 f7 brne .-6 ; 0x27d0 <IIllllIllIlllIIlllII+0x2ee>27d6: 31 97 sbiw r30, 0x01 ; 127d8: 3e 2e mov r3, r3027da: 36 18 sub r3, r627dc: b9 c0 rjmp .+370 ; 0x2950 <IIllllIllIlllIIlllII+0x46e>27de: 15 35 cpi r17, 0x55 ; 8527e0: 11 f0 breq .+4 ; 0x27e6 <IIllllIllIlllIIlllII+0x304>27e2: 15 37 cpi r17, 0x75 ; 11727e4: 31 f4 brne .+12 ; 0x27f2 <IIllllIllIlllIIlllII+0x310>27e6: 15 35 cpi r17, 0x55 ; 8527e8: 11 f4 brne .+4 ; 0x27ee <IIllllIllIlllIIlllII+0x30c>27ea: f1 e0 ldi r31, 0x01 ; 127ec: ff 2a or r15, r3127ee: 0a e0 ldi r16, 0x0A ; 1027f0: 0f c0 rjmp .+30 ; 0x2810 <IIllllIllIlllIIlllII+0x32e>27f2: 18 35 cpi r17, 0x58 ; 8827f4: 19 f0 breq .+6 ; 0x27fc <IIllllIllIlllIIlllII+0x31a>27f6: 18 37 cpi r17, 0x78 ; 12027f8: 09 f0 breq .+2 ; 0x27fc <IIllllIllIlllIIlllII+0x31a>27fa: a0 c0 rjmp .+320 ; 0x293c <IIllllIllIlllIIlllII+0x45a>27fc: 00 e1 ldi r16, 0x10 ; 1627fe: f3 fe sbrs r15, 32800: 07 c0 rjmp .+14 ; 0x2810 <IIllllIllIlllIIlllII+0x32e>2802: 81 14 cp r8, r12804: 91 04 cpc r9, r12806: a1 04 cpc r10, r12808: b1 04 cpc r11, r1280a: 11 f0 breq .+4 ; 0x2810 <IIllllIllIlllIIlllII+0x32e>280c: 20 e4 ldi r18, 0x40 ; 64280e: f2 2a or r15, r182810: 19 a6 std Y+41, r1 ; 0x292812: ed a6 std Y+45, r14 ; 0x2d2814: e7 fc sbrc r14, 72816: 02 c0 rjmp .+4 ; 0x281c <IIllllIllIlllIIlllII+0x33a>2818: 3f ed ldi r19, 0xDF ; 223281a: f3 22 and r15, r19281c: 49 e2 ldi r20, 0x29 ; 41281e: 64 2e mov r6, r202820: 71 2c mov r7, r12822: 6c 0e add r6, r282824: 7d 1e adc r7, r292826: 81 14 cp r8, r12828: 91 04 cpc r9, r1282a: a1 04 cpc r10, r1282c: b1 04 cpc r11, r1282e: 21 f4 brne .+8 ; 0x2838 <IIllllIllIlllIIlllII+0x356>2830: 4d a5 ldd r20, Y+45 ; 0x2d2832: 44 23 and r20, r202834: 09 f4 brne .+2 ; 0x2838 <IIllllIllIlllIIlllII+0x356>2836: 7b c0 rjmp .+246 ; 0x292e <IIllllIllIlllIIlllII+0x44c>2838: 80 2f mov r24, r16283a: 99 27 eor r25, r25283c: aa 27 eor r26, r26283e: bb 27 eor r27, r272840: 8e a7 std Y+46, r24 ; 0x2e2842: 9f a7 std Y+47, r25 ; 0x2f2844: a8 ab std Y+48, r26 ; 0x302846: b9 ab std Y+49, r27 ; 0x312848: 20 2e mov r2, r16284a: 33 24 eor r3, r3284c: 90 e0 ldi r25, 0x00 ; 0284e: 89 16 cp r8, r252850: 90 e0 ldi r25, 0x00 ; 02852: 99 06 cpc r9, r252854: 91 e0 ldi r25, 0x01 ; 12856: a9 06 cpc r10, r252858: 90 e0 ldi r25, 0x00 ; 0285a: b9 06 cpc r11, r25285c: 48 f0 brcs .+18 ; 0x2870 <IIllllIllIlllIIlllII+0x38e>285e: c5 01 movw r24, r102860: b4 01 movw r22, r82862: 2e a5 ldd r18, Y+46 ; 0x2e2864: 3f a5 ldd r19, Y+47 ; 0x2f2866: 48 a9 ldd r20, Y+48 ; 0x302868: 59 a9 ldd r21, Y+49 ; 0x31286a: 0e 94 69 b1 call 0x162d2 ; 0x162d2 <__udivmodsi4>286e: 17 c0 rjmp .+46 ; 0x289e <IIllllIllIlllIIlllII+0x3bc>2870: af ef ldi r26, 0xFF ; 2552872: 8a 16 cp r8, r262874: 91 04 cpc r9, r12876: a1 04 cpc r10, r12878: b1 04 cpc r11, r1287a: 49 f0 breq .+18 ; 0x288e <IIllllIllIlllIIlllII+0x3ac>287c: 40 f0 brcs .+16 ; 0x288e <IIllllIllIlllIIlllII+0x3ac>287e: c4 01 movw r24, r82880: b1 01 movw r22, r22882: 0e 94 42 b1 call 0x16284 ; 0x16284 <__udivmodhi4>2886: 9b 01 movw r18, r222888: 44 27 eor r20, r20288a: 55 27 eor r21, r21288c: 08 c0 rjmp .+16 ; 0x289e <IIllllIllIlllIIlllII+0x3bc>288e: 88 2d mov r24, r82890: 60 2f mov r22, r162892: 0e 94 36 b1 call 0x1626c ; 0x1626c <__udivmodqi4>2896: 28 2f mov r18, r242898: 33 27 eor r19, r19289a: 44 27 eor r20, r20289c: 55 27 eor r21, r21289e: 2a ab std Y+50, r18 ; 0x3228a0: 3b ab std Y+51, r19 ; 0x3328a2: 4c ab std Y+52, r20 ; 0x3428a4: 5d ab std Y+53, r21 ; 0x3528a6: 0a 30 cpi r16, 0x0A ; 1028a8: 59 f4 brne .+22 ; 0x28c0 <IIllllIllIlllIIlllII+0x3de>28aa: 8a a9 ldd r24, Y+50 ; 0x3228ac: 88 0f add r24, r2428ae: 88 0f add r24, r2428b0: 88 0f add r24, r2428b2: 9a a9 ldd r25, Y+50 ; 0x3228b4: 99 0f add r25, r2528b6: 89 0f add r24, r2528b8: 38 2d mov r19, r828ba: 38 1b sub r19, r2428bc: 83 2f mov r24, r1928be: 10 c0 rjmp .+32 ; 0x28e0 <IIllllIllIlllIIlllII+0x3fe>28c0: 00 31 cpi r16, 0x10 ; 1628c2: 39 f4 brne .+14 ; 0x28d2 <IIllllIllIlllIIlllII+0x3f0>28c4: 8a a9 ldd r24, Y+50 ; 0x3228c6: 82 95 swap r2428c8: 80 7f andi r24, 0xF0 ; 24028ca: 48 2d mov r20, r828cc: 48 1b sub r20, r2428ce: 84 2f mov r24, r2028d0: 07 c0 rjmp .+14 ; 0x28e0 <IIllllIllIlllIIlllII+0x3fe>28d2: 8a a9 ldd r24, Y+50 ; 0x3228d4: 88 0f add r24, r2428d6: 88 0f add r24, r2428d8: 88 0f add r24, r2428da: 58 2d mov r21, r828dc: 58 1b sub r21, r2428de: 85 2f mov r24, r2128e0: 90 e0 ldi r25, 0x00 ; 028e2: 2e a5 ldd r18, Y+46 ; 0x2e28e4: 3f a5 ldd r19, Y+47 ; 0x2f28e6: 48 a9 ldd r20, Y+48 ; 0x3028e8: 59 a9 ldd r21, Y+49 ; 0x3128ea: 82 16 cp r8, r1828ec: 93 06 cpc r9, r1928ee: a4 06 cpc r10, r2028f0: b5 06 cpc r11, r2128f2: 08 f0 brcs .+2 ; 0x28f6 <IIllllIllIlllIIlllII+0x414>28f4: 91 e0 ldi r25, 0x01 ; 128f6: 8a a8 ldd r8, Y+50 ; 0x3228f8: 9b a8 ldd r9, Y+51 ; 0x3328fa: ac a8 ldd r10, Y+52 ; 0x3428fc: bd a8 ldd r11, Y+53 ; 0x3528fe: 8a 30 cpi r24, 0x0A ; 102900: 10 f4 brcc .+4 ; 0x2906 <IIllllIllIlllIIlllII+0x424>2902: 80 5d subi r24, 0xD0 ; 2082904: 04 c0 rjmp .+8 ; 0x290e <IIllllIllIlllIIlllII+0x42c>2906: 89 5a subi r24, 0xA9 ; 1692908: 18 35 cpi r17, 0x58 ; 88290a: 09 f4 brne .+2 ; 0x290e <IIllllIllIlllIIlllII+0x42c>290c: 8f 7d andi r24, 0xDF ; 223290e: d3 01 movw r26, r62910: 8e 93 st -X, r242912: 3d 01 movw r6, r262914: 99 23 and r25, r252916: 09 f0 breq .+2 ; 0x291a <IIllllIllIlllIIlllII+0x438>2918: 99 cf rjmp .-206 ; 0x284c <IIllllIllIlllIIlllII+0x36a>291a: 08 30 cpi r16, 0x08 ; 8291c: 41 f4 brne .+16 ; 0x292e <IIllllIllIlllIIlllII+0x44c>291e: f3 fe sbrs r15, 32920: 06 c0 rjmp .+12 ; 0x292e <IIllllIllIlllIIlllII+0x44c>2922: 80 33 cpi r24, 0x30 ; 482924: 21 f0 breq .+8 ; 0x292e <IIllllIllIlllIIlllII+0x44c>2926: 80 e3 ldi r24, 0x30 ; 482928: fd 01 movw r30, r26292a: 82 93 st -Z, r24292c: 3f 01 movw r6, r30292e: ce 01 movw r24, r282930: 01 96 adiw r24, 0x01 ; 12932: 38 2e mov r3, r242934: 36 18 sub r3, r62936: f8 e2 ldi r31, 0x28 ; 402938: 3f 0e add r3, r31293a: 0b c0 rjmp .+22 ; 0x2952 <IIllllIllIlllIIlllII+0x470>293c: 11 23 and r17, r17293e: 09 f4 brne .+2 ; 0x2942 <IIllllIllIlllIIlllII+0x460>2940: 66 c0 rjmp .+204 ; 0x2a0e <IIllllIllIlllIIlllII+0x52c>2942: 3e 01 movw r6, r282944: 08 94 sec2946: 61 1c adc r6, r12948: 71 1c adc r7, r1294a: 19 83 std Y+1, r17 ; 0x01294c: 31 e0 ldi r19, 0x01 ; 1294e: 33 2e mov r3, r192950: 19 a6 std Y+41, r1 ; 0x292952: 03 2d mov r16, r32954: 2d a4 ldd r2, Y+45 ; 0x2d2956: 23 18 sub r2, r32958: 27 fc sbrc r2, 7295a: 22 24 eor r2, r2295c: 89 a5 ldd r24, Y+41 ; 0x29295e: 88 23 and r24, r242960: 11 f0 breq .+4 ; 0x2966 <IIllllIllIlllIIlllII+0x484>2962: 0f 5f subi r16, 0xFF ; 2552964: 02 c0 rjmp .+4 ; 0x296a <IIllllIllIlllIIlllII+0x488>2966: f6 fc sbrc r15, 62968: 0e 5f subi r16, 0xFE ; 254296a: 02 0d add r16, r2296c: ef 2c mov r14, r15296e: ff 24 eor r15, r152970: c7 01 movw r24, r142972: 80 73 andi r24, 0x30 ; 482974: 90 70 andi r25, 0x00 ; 02976: 89 2b or r24, r252978: 41 f4 brne .+16 ; 0x298a <IIllllIllIlllIIlllII+0x4a8>297a: 8c a5 ldd r24, Y+44 ; 0x2c297c: 80 1b sub r24, r16297e: 68 2f mov r22, r242980: 2c 96 adiw r28, 0x0c ; 122982: 8e ad ldd r24, Y+62 ; 0x3e2984: 9f ad ldd r25, Y+63 ; 0x3f2986: 2c 97 sbiw r28, 0x0c ; 122988: 8a dd rcall .-1260 ; 0x249e <fgmjgnrtuth587th9rTrw>298a: 89 a5 ldd r24, Y+41 ; 0x29298c: 88 23 and r24, r24298e: 31 f0 breq .+12 ; 0x299c <IIllllIllIlllIIlllII+0x4ba>2990: 41 e0 ldi r20, 0x01 ; 12992: 50 e0 ldi r21, 0x00 ; 02994: be 01 movw r22, r282996: 67 5d subi r22, 0xD7 ; 2152998: 7f 4f sbci r23, 0xFF ; 255299a: 0a c0 rjmp .+20 ; 0x29b0 <IIllllIllIlllIIlllII+0x4ce>299c: e6 fe sbrs r14, 6299e: 0d c0 rjmp .+26 ; 0x29ba <IIllllIllIlllIIlllII+0x4d8>29a0: 80 e3 ldi r24, 0x30 ; 4829a2: 8a a7 std Y+42, r24 ; 0x2a29a4: 1b a7 std Y+43, r17 ; 0x2b29a6: 42 e0 ldi r20, 0x02 ; 229a8: 50 e0 ldi r21, 0x00 ; 029aa: be 01 movw r22, r2829ac: 66 5d subi r22, 0xD6 ; 21429ae: 7f 4f sbci r23, 0xFF ; 25529b0: 2c 96 adiw r28, 0x0c ; 1229b2: 8e ad ldd r24, Y+62 ; 0x3e29b4: 9f ad ldd r25, Y+63 ; 0x3f29b6: 2c 97 sbiw r28, 0x0c ; 1229b8: 43 dd rcall .-1402 ; 0x2440 <njkvnfuhgbuzrgezgf483>29ba: c7 01 movw r24, r1429bc: 80 73 andi r24, 0x30 ; 4829be: 90 70 andi r25, 0x00 ; 029c0: 80 97 sbiw r24, 0x20 ; 3229c2: 41 f4 brne .+16 ; 0x29d4 <IIllllIllIlllIIlllII+0x4f2>29c4: 8c a5 ldd r24, Y+44 ; 0x2c29c6: 80 1b sub r24, r1629c8: 68 2f mov r22, r2429ca: 2c 96 adiw r28, 0x0c ; 1229cc: 8e ad ldd r24, Y+62 ; 0x3e29ce: 9f ad ldd r25, Y+63 ; 0x3f29d0: 2c 97 sbiw r28, 0x0c ; 1229d2: 76 dd rcall .-1300 ; 0x24c0 <wqqeRT45jth8g758735h4>29d4: 62 2d mov r22, r229d6: 2c 96 adiw r28, 0x0c ; 1229d8: 8e ad ldd r24, Y+62 ; 0x3e29da: 9f ad ldd r25, Y+63 ; 0x3f29dc: 2c 97 sbiw r28, 0x0c ; 1229de: 70 dd rcall .-1312 ; 0x24c0 <wqqeRT45jth8g758735h4>29e0: 83 2d mov r24, r329e2: 99 27 eor r25, r2529e4: 87 fd sbrc r24, 729e6: 90 95 com r2529e8: ac 01 movw r20, r2429ea: b3 01 movw r22, r629ec: 2c 96 adiw r28, 0x0c ; 1229ee: 8e ad ldd r24, Y+62 ; 0x3e29f0: 9f ad ldd r25, Y+63 ; 0x3f29f2: 2c 97 sbiw r28, 0x0c ; 1229f4: 25 dd rcall .-1462 ; 0x2440 <njkvnfuhgbuzrgezgf483>29f6: e4 fe sbrs r14, 429f8: 8f cd rjmp .-1250 ; 0x2518 <IIllllIllIlllIIlllII+0x36>29fa: 2c a5 ldd r18, Y+44 ; 0x2c29fc: 20 1b sub r18, r1629fe: 2c a7 std Y+44, r18 ; 0x2c2a00: 62 2f mov r22, r182a02: 2c 96 adiw r28, 0x0c ; 122a04: 8e ad ldd r24, Y+62 ; 0x3e2a06: 9f ad ldd r25, Y+63 ; 0x3f2a08: 2c 97 sbiw r28, 0x0c ; 122a0a: 49 dd rcall .-1390 ; 0x249e <fgmjgnrtuth587th9rTrw>2a0c: 85 cd rjmp .-1270 ; 0x2518 <IIllllIllIlllIIlllII+0x36>2a0e: e2 e1 ldi r30, 0x12 ; 182a10: cb 5c subi r28, 0xCB ; 2032a12: 0c 94 f4 b1 jmp 0x163e8 ; 0x163e8 <__epilogue_restores__>00002a16 <LIBFC_HoTT_Putchar>:2a16: 98 2f mov r25, r242a18: 80 91 b1 0c lds r24, 0x0CB12a1c: 88 3a cpi r24, 0xA8 ; 1682a1e: 50 f4 brcc .+20 ; 0x2a34 <LIBFC_HoTT_Putchar+0x1e>2a20: 80 91 b1 0c lds r24, 0x0CB12a24: e8 2f mov r30, r242a26: ff 27 eor r31, r312a28: e8 5f subi r30, 0xF8 ; 2482a2a: f8 4f sbci r31, 0xF8 ; 2482a2c: 93 83 std Z+3, r25 ; 0x032a2e: 8f 5f subi r24, 0xFF ; 2552a30: 80 93 b1 0c sts 0x0CB1, r242a34: 08 95 ret00002a36 <LIBFC_HoTT_Putchar_INV>:2a36: 98 2f mov r25, r242a38: 80 91 b1 0c lds r24, 0x0CB12a3c: 88 3a cpi r24, 0xA8 ; 1682a3e: 58 f4 brcc .+22 ; 0x2a56 <LIBFC_HoTT_Putchar_INV+0x20>2a40: 80 91 b1 0c lds r24, 0x0CB12a44: e8 2f mov r30, r242a46: ff 27 eor r31, r312a48: e8 5f subi r30, 0xF8 ; 2482a4a: f8 4f sbci r31, 0xF8 ; 2482a4c: 90 68 ori r25, 0x80 ; 1282a4e: 93 83 std Z+3, r25 ; 0x032a50: 8f 5f subi r24, 0xFF ; 2552a52: 80 93 b1 0c sts 0x0CB1, r242a56: 08 95 ret00002a58 <LIBFC_HoTT_Putchar_BLINK>:2a58: 98 2f mov r25, r242a5a: 80 91 ed 02 lds r24, 0x02ED2a5e: 88 23 and r24, r242a60: 11 f0 breq .+4 ; 0x2a66 <LIBFC_HoTT_Putchar_BLINK+0xe>2a62: 89 2f mov r24, r252a64: e8 cf rjmp .-48 ; 0x2a36 <LIBFC_HoTT_Putchar_INV>2a66: 89 2f mov r24, r252a68: d6 cf rjmp .-84 ; 0x2a16 <LIBFC_HoTT_Putchar>00002a6a <LIBFC_HoTT_SetPos>:2a6a: 88 3a cpi r24, 0xA8 ; 1682a6c: 10 f4 brcc .+4 ; 0x2a72 <LIBFC_HoTT_SetPos+0x8>2a6e: 80 93 b1 0c sts 0x0CB1, r242a72: 08 95 ret00002a74 <LIBFC_HoTT_Clear>:2a74: 80 e0 ldi r24, 0x00 ; 02a76: 90 e2 ldi r25, 0x20 ; 322a78: eb e0 ldi r30, 0x0B ; 112a7a: f7 e0 ldi r31, 0x07 ; 72a7c: 91 93 st Z+, r252a7e: 8f 5f subi r24, 0xFF ; 2552a80: 88 3a cpi r24, 0xA8 ; 1682a82: e0 f3 brcs .-8 ; 0x2a7c <LIBFC_HoTT_Clear+0x8>2a84: 08 95 ret00002a86 <HoTT_Init>:2a86: 4f b7 in r20, 0x3f ; 632a88: 21 e8 ldi r18, 0x81 ; 1292a8a: 30 e0 ldi r19, 0x00 ; 02a8c: f8 94 cli2a8e: 80 91 c9 00 lds r24, 0x00C92a92: 8f 77 andi r24, 0x7F ; 1272a94: 80 93 c9 00 sts 0x00C9, r242a98: 80 91 c9 00 lds r24, 0x00C92a9c: 8f 7b andi r24, 0xBF ; 1912a9e: 80 93 c9 00 sts 0x00C9, r242aa2: 80 91 c9 00 lds r24, 0x00C92aa6: 8f 7d andi r24, 0xDF ; 2232aa8: 80 93 c9 00 sts 0x00C9, r242aac: 83 2f mov r24, r192aae: 99 27 eor r25, r252ab0: 80 93 cd 00 sts 0x00CD, r242ab4: 20 93 cc 00 sts 0x00CC, r182ab8: 80 91 c8 00 lds r24, 0x00C82abc: 82 60 ori r24, 0x02 ; 22abe: 80 93 c8 00 sts 0x00C8, r242ac2: 88 e1 ldi r24, 0x18 ; 242ac4: 80 93 c9 00 sts 0x00C9, r242ac8: 80 91 ca 00 lds r24, 0x00CA2acc: 8f 77 andi r24, 0x7F ; 1272ace: 80 93 ca 00 sts 0x00CA, r242ad2: 80 91 ca 00 lds r24, 0x00CA2ad6: 8f 7b andi r24, 0xBF ; 1912ad8: 80 93 ca 00 sts 0x00CA, r242adc: 80 91 ca 00 lds r24, 0x00CA2ae0: 8f 7d andi r24, 0xDF ; 2232ae2: 80 93 ca 00 sts 0x00CA, r242ae6: 80 91 ca 00 lds r24, 0x00CA2aea: 8f 7e andi r24, 0xEF ; 2392aec: 80 93 ca 00 sts 0x00CA, r242af0: 80 91 ca 00 lds r24, 0x00CA2af4: 87 7f andi r24, 0xF7 ; 2472af6: 80 93 ca 00 sts 0x00CA, r242afa: 80 91 c9 00 lds r24, 0x00C92afe: 84 60 ori r24, 0x04 ; 42b00: 80 93 c9 00 sts 0x00C9, r242b04: 80 91 ca 00 lds r24, 0x00CA2b08: 84 60 ori r24, 0x04 ; 42b0a: 80 93 ca 00 sts 0x00CA, r242b0e: 80 91 ca 00 lds r24, 0x00CA2b12: 82 60 ori r24, 0x02 ; 22b14: 80 93 ca 00 sts 0x00CA, r242b18: 80 91 c9 00 lds r24, 0x00C92b1c: 81 60 ori r24, 0x01 ; 12b1e: 80 93 c9 00 sts 0x00C9, r242b22: 80 91 c8 00 lds r24, 0x00C82b26: 87 ff sbrs r24, 72b28: 03 c0 rjmp .+6 ; 0x2b30 <HoTT_Init+0xaa>2b2a: 80 91 ce 00 lds r24, 0x00CE2b2e: f9 cf rjmp .-14 ; 0x2b22 <HoTT_Init+0x9c>2b30: 80 91 c9 00 lds r24, 0x00C92b34: 80 68 ori r24, 0x80 ; 1282b36: 80 93 c9 00 sts 0x00C9, r242b3a: 4f bf out 0x3f, r20 ; 632b3c: 3c e7 ldi r19, 0x7C ; 1242b3e: 30 93 7a 06 sts 0x067A, r192b42: 2d e7 ldi r18, 0x7D ; 1252b44: 20 93 a5 06 sts 0x06A5, r182b48: 8e e8 ldi r24, 0x8E ; 1422b4a: 80 93 7b 06 sts 0x067B, r242b4e: 10 92 97 06 sts 0x0697, r12b52: 10 92 96 06 sts 0x0696, r12b56: 10 92 80 06 sts 0x0680, r12b5a: 80 ee ldi r24, 0xE0 ; 2242b5c: 80 93 7d 06 sts 0x067D, r242b60: 30 93 dc 06 sts 0x06DC, r192b64: 20 93 07 07 sts 0x0707, r182b68: 10 92 e8 06 sts 0x06E8, r12b6c: 10 92 e7 06 sts 0x06E7, r12b70: 10 92 ea 06 sts 0x06EA, r12b74: 10 92 e9 06 sts 0x06E9, r12b78: 10 92 ec 06 sts 0x06EC, r12b7c: 10 92 eb 06 sts 0x06EB, r12b80: 84 ef ldi r24, 0xF4 ; 2442b82: 91 e0 ldi r25, 0x01 ; 12b84: 90 93 e6 06 sts 0x06E6, r252b88: 80 93 e5 06 sts 0x06E5, r242b8c: 90 93 e4 06 sts 0x06E4, r252b90: 80 93 e3 06 sts 0x06E3, r242b94: 90 93 e2 06 sts 0x06E2, r252b98: 80 93 e1 06 sts 0x06E1, r242b9c: 10 92 de 06 sts 0x06DE, r12ba0: 89 e8 ldi r24, 0x89 ; 1372ba2: 80 93 dd 06 sts 0x06DD, r242ba6: 10 92 05 07 sts 0x0705, r12baa: 10 92 06 07 sts 0x0706, r12bae: 80 e9 ldi r24, 0x90 ; 1442bb0: 80 93 df 06 sts 0x06DF, r242bb4: 30 93 b4 07 sts 0x07B4, r192bb8: 20 93 df 07 sts 0x07DF, r182bbc: 10 92 b6 07 sts 0x07B6, r12bc0: 8a e8 ldi r24, 0x8A ; 1382bc2: 80 93 b5 07 sts 0x07B5, r242bc6: 10 92 bc 07 sts 0x07BC, r12bca: 10 92 bb 07 sts 0x07BB, r12bce: 10 92 ba 07 sts 0x07BA, r12bd2: 10 92 be 07 sts 0x07BE, r12bd6: 10 92 bf 07 sts 0x07BF, r12bda: 10 92 c0 07 sts 0x07C0, r12bde: 10 92 c1 07 sts 0x07C1, r12be2: 10 92 c3 07 sts 0x07C3, r12be6: 10 92 c4 07 sts 0x07C4, r12bea: 10 92 c5 07 sts 0x07C5, r12bee: 10 92 c6 07 sts 0x07C6, r12bf2: 10 92 ca 07 sts 0x07CA, r12bf6: 10 92 c9 07 sts 0x07C9, r12bfa: 10 92 c8 07 sts 0x07C8, r12bfe: 10 92 c7 07 sts 0x07C7, r12c02: 80 ea ldi r24, 0xA0 ; 1602c04: 80 93 b7 07 sts 0x07B7, r242c08: 30 93 a6 06 sts 0x06A6, r192c0c: 20 93 d1 06 sts 0x06D1, r182c10: 10 92 a8 06 sts 0x06A8, r12c14: 8d e8 ldi r24, 0x8D ; 1412c16: 80 93 a7 06 sts 0x06A7, r242c1a: 10 92 d0 06 sts 0x06D0, r12c1e: 80 ed ldi r24, 0xD0 ; 2082c20: 80 93 a9 06 sts 0x06A9, r242c24: 8b e7 ldi r24, 0x7B ; 1232c26: 80 93 08 07 sts 0x0708, r242c2a: 80 e8 ldi r24, 0x80 ; 1282c2c: 80 93 09 07 sts 0x0709, r242c30: 10 92 0a 07 sts 0x070A, r12c34: 80 91 80 06 lds r24, 0x06802c38: 90 e2 ldi r25, 0x20 ; 322c3a: eb e0 ldi r30, 0x0B ; 112c3c: f7 e0 ldi r31, 0x07 ; 72c3e: 91 93 st Z+, r252c40: 8f 5f subi r24, 0xFF ; 2552c42: 88 3a cpi r24, 0xA8 ; 1682c44: e0 f3 brcs .-8 ; 0x2c3e <HoTT_Init+0x1b8>2c46: 8d e7 ldi r24, 0x7D ; 1252c48: 80 93 b3 07 sts 0x07B3, r242c4c: 08 95 ret00002c4e <HoTT_Parser>:2c4e: cf 93 push r282c50: c8 2f mov r28, r242c52: 80 91 00 03 lds r24, 0x03002c56: 80 38 cpi r24, 0x80 ; 1282c58: 79 f4 brne .+30 ; 0x2c78 <HoTT_Parser+0x2a>2c5a: 8c 2f mov r24, r282c5c: 0e 94 f5 61 call 0xc3ea ; 0xc3ea <HoTT_Telemety>2c60: 80 93 ef 02 sts 0x02EF, r242c64: 80 91 ef 02 lds r24, 0x02EF2c68: 88 23 and r24, r242c6a: 31 f1 breq .+76 ; 0x2cb8 <HoTT_Parser+0x6a>2c6c: c0 93 b0 0c sts 0x0CB0, r282c70: 80 91 ef 02 lds r24, 0x02EF2c74: 8f 5f subi r24, 0xFF ; 2552c76: 16 c0 rjmp .+44 ; 0x2ca4 <HoTT_Parser+0x56>2c78: 8f 37 cpi r24, 0x7F ; 1272c7a: f1 f4 brne .+60 ; 0x2cb8 <HoTT_Parser+0x6a>2c7c: 80 91 a9 0c lds r24, 0x0CA92c80: 88 23 and r24, r242c82: 29 f4 brne .+10 ; 0x2c8e <HoTT_Parser+0x40>2c84: 8c 2f mov r24, r282c86: 80 95 com r242c88: 8f 70 andi r24, 0x0F ; 152c8a: 80 93 a9 0c sts 0x0CA9, r242c8e: 0e 94 cc 60 call 0xc198 ; 0xc198 <HoTT_Waring>2c92: 80 93 0a 07 sts 0x070A, r242c96: 88 e0 ldi r24, 0x08 ; 82c98: 97 e0 ldi r25, 0x07 ; 72c9a: 90 93 f1 02 sts 0x02F1, r252c9e: 80 93 f0 02 sts 0x02F0, r242ca2: 8d ea ldi r24, 0xAD ; 1732ca4: 80 93 ef 02 sts 0x02EF, r242ca8: 80 91 c9 00 lds r24, 0x00C92cac: 8f 7e andi r24, 0xEF ; 2392cae: 80 93 c9 00 sts 0x00C9, r242cb2: 82 e0 ldi r24, 0x02 ; 22cb4: 80 93 ee 02 sts 0x02EE, r242cb8: c0 93 00 03 sts 0x0300, r282cbc: cf 91 pop r282cbe: 08 95 ret00002cc0 <HoTT_Polling>:2cc0: 30 91 ee 02 lds r19, 0x02EE2cc4: 33 23 and r19, r192cc6: 31 f0 breq .+12 ; 0x2cd4 <HoTT_Polling+0x14>2cc8: 80 91 ee 02 lds r24, 0x02EE2ccc: 81 50 subi r24, 0x01 ; 12cce: 80 93 ee 02 sts 0x02EE, r242cd2: 08 95 ret2cd4: 80 91 ef 02 lds r24, 0x02EF2cd8: 88 23 and r24, r242cda: 61 f1 breq .+88 ; 0x2d34 <HoTT_Polling+0x74>2cdc: 40 91 ef 02 lds r20, 0x02EF2ce0: 90 91 01 03 lds r25, 0x03012ce4: 41 30 cpi r20, 0x01 ; 12ce6: 69 f4 brne .+26 ; 0x2d02 <HoTT_Polling+0x42>2ce8: 29 2f mov r18, r252cea: 30 93 01 03 sts 0x0301, r192cee: 80 91 ed 02 lds r24, 0x02ED2cf2: 88 23 and r24, r242cf4: 19 f0 breq .+6 ; 0x2cfc <HoTT_Polling+0x3c>2cf6: 30 93 ed 02 sts 0x02ED, r192cfa: 10 c0 rjmp .+32 ; 0x2d1c <HoTT_Polling+0x5c>2cfc: 40 93 ed 02 sts 0x02ED, r202d00: 0d c0 rjmp .+26 ; 0x2d1c <HoTT_Polling+0x5c>2d02: e0 91 f0 02 lds r30, 0x02F02d06: f0 91 f1 02 lds r31, 0x02F12d0a: 81 91 ld r24, Z+2d0c: f0 93 f1 02 sts 0x02F1, r312d10: e0 93 f0 02 sts 0x02F0, r302d14: 28 2f mov r18, r242d16: 98 0f add r25, r242d18: 90 93 01 03 sts 0x0301, r252d1c: 80 91 c8 00 lds r24, 0x00C82d20: 85 ff sbrs r24, 52d22: fc cf rjmp .-8 ; 0x2d1c <HoTT_Polling+0x5c>2d24: 20 93 ce 00 sts 0x00CE, r182d28: 80 91 ef 02 lds r24, 0x02EF2d2c: 81 50 subi r24, 0x01 ; 12d2e: 80 93 ef 02 sts 0x02EF, r242d32: 08 95 ret2d34: 80 91 c9 00 lds r24, 0x00C92d38: 80 61 ori r24, 0x10 ; 162d3a: 80 93 c9 00 sts 0x00C9, r242d3e: 08 95 ret00002d40 <ACC_AltitudeFusion>:2d40: 6f 92 push r62d42: 7f 92 push r72d44: 8f 92 push r82d46: 9f 92 push r92d48: af 92 push r102d4a: bf 92 push r112d4c: cf 92 push r122d4e: df 92 push r132d50: ef 92 push r142d52: ff 92 push r152d54: 0f 93 push r162d56: 1f 93 push r172d58: 88 23 and r24, r242d5a: 61 f1 breq .+88 ; 0x2db4 <ACC_AltitudeFusion+0x74>2d5c: 82 30 cpi r24, 0x02 ; 22d5e: 41 f4 brne .+16 ; 0x2d70 <ACC_AltitudeFusion+0x30>2d60: 10 92 0a 03 sts 0x030A, r12d64: 10 92 0b 03 sts 0x030B, r12d68: 10 92 0c 03 sts 0x030C, r12d6c: 10 92 0d 03 sts 0x030D, r12d70: 20 91 fe 03 lds r18, 0x03FE2d74: 30 91 ff 03 lds r19, 0x03FF2d78: 40 91 00 04 lds r20, 0x04002d7c: 50 91 01 04 lds r21, 0x04012d80: da 01 movw r26, r202d82: c9 01 movw r24, r182d84: 19 e0 ldi r17, 0x09 ; 92d86: 88 0f add r24, r242d88: 99 1f adc r25, r252d8a: aa 1f adc r26, r262d8c: bb 1f adc r27, r272d8e: 1a 95 dec r172d90: d1 f7 brne .-12 ; 0x2d86 <ACC_AltitudeFusion+0x46>2d92: 80 93 57 03 sts 0x0357, r242d96: 90 93 58 03 sts 0x0358, r252d9a: a0 93 59 03 sts 0x0359, r262d9e: b0 93 5a 03 sts 0x035A, r272da2: 20 93 02 03 sts 0x0302, r182da6: 30 93 03 03 sts 0x0303, r192daa: 40 93 04 03 sts 0x0304, r202dae: 50 93 05 03 sts 0x0305, r212db2: 26 c1 rjmp .+588 ; 0x3000 <ACC_AltitudeFusion+0x2c0>2db4: a0 90 fe 03 lds r10, 0x03FE2db8: b0 90 ff 03 lds r11, 0x03FF2dbc: c0 90 00 04 lds r12, 0x04002dc0: d0 90 01 04 lds r13, 0x04012dc4: 80 91 02 03 lds r24, 0x03022dc8: 90 91 03 03 lds r25, 0x03032dcc: a0 91 04 03 lds r26, 0x03042dd0: b0 91 05 03 lds r27, 0x03052dd4: 35 01 movw r6, r102dd6: 46 01 movw r8, r122dd8: 68 1a sub r6, r242dda: 79 0a sbc r7, r252ddc: 8a 0a sbc r8, r262dde: 9b 0a sbc r9, r272de0: 60 92 06 03 sts 0x0306, r62de4: 70 92 07 03 sts 0x0307, r72de8: 80 92 08 03 sts 0x0308, r82dec: 90 92 09 03 sts 0x0309, r92df0: 80 91 5b 03 lds r24, 0x035B2df4: 90 91 5c 03 lds r25, 0x035C2df8: 84 55 subi r24, 0x54 ; 842dfa: 9f 4f sbci r25, 0xFF ; 2552dfc: 7c 01 movw r14, r242dfe: 00 27 eor r16, r162e00: f7 fc sbrc r15, 72e02: 00 95 com r162e04: 10 2f mov r17, r162e06: 80 91 2d 06 lds r24, 0x062D2e0a: 90 91 2e 06 lds r25, 0x062E2e0e: 9c 01 movw r18, r242e10: 44 27 eor r20, r202e12: 37 fd sbrc r19, 72e14: 40 95 com r202e16: 54 2f mov r21, r202e18: c8 01 movw r24, r162e1a: b7 01 movw r22, r142e1c: 0e 94 27 b1 call 0x1624e ; 0x1624e <__mulsi3>2e20: 97 ff sbrs r25, 72e22: 04 c0 rjmp .+8 ; 0x2e2c <ACC_AltitudeFusion+0xec>2e24: 61 50 subi r22, 0x01 ; 12e26: 70 4e sbci r23, 0xE0 ; 2242e28: 8f 4f sbci r24, 0xFF ; 2552e2a: 9f 4f sbci r25, 0xFF ; 2552e2c: ab 01 movw r20, r222e2e: bc 01 movw r22, r242e30: fd e0 ldi r31, 0x0D ; 132e32: 75 95 asr r232e34: 67 95 ror r222e36: 57 95 ror r212e38: 47 95 ror r202e3a: fa 95 dec r312e3c: d1 f7 brne .-12 ; 0x2e32 <ACC_AltitudeFusion+0xf2>2e3e: 4c 5a subi r20, 0xAC ; 1722e40: 50 40 sbci r21, 0x00 ; 02e42: 60 40 sbci r22, 0x00 ; 02e44: 70 40 sbci r23, 0x00 ; 02e46: 40 93 0e 03 sts 0x030E, r202e4a: 50 93 0f 03 sts 0x030F, r212e4e: 60 93 10 03 sts 0x0310, r222e52: 70 93 11 03 sts 0x0311, r232e56: 20 91 ec 08 lds r18, 0x08EC2e5a: 30 91 ed 08 lds r19, 0x08ED2e5e: 37 ff sbrs r19, 72e60: 02 c0 rjmp .+4 ; 0x2e66 <ACC_AltitudeFusion+0x126>2e62: 21 5f subi r18, 0xF1 ; 2412e64: 3f 4f sbci r19, 0xFF ; 2552e66: e4 e0 ldi r30, 0x04 ; 42e68: 35 95 asr r192e6a: 27 95 ror r182e6c: ea 95 dec r302e6e: e1 f7 brne .-8 ; 0x2e68 <ACC_AltitudeFusion+0x128>2e70: 80 91 5f 03 lds r24, 0x035F2e74: 90 91 60 03 lds r25, 0x03602e78: 82 9f mul r24, r182e7a: d0 01 movw r26, r02e7c: 83 9f mul r24, r192e7e: b0 0d add r27, r02e80: 92 9f mul r25, r182e82: b0 0d add r27, r02e84: 11 24 eor r1, r12e86: cd 01 movw r24, r262e88: b7 ff sbrs r27, 72e8a: 02 c0 rjmp .+4 ; 0x2e90 <ACC_AltitudeFusion+0x150>2e8c: 81 50 subi r24, 0x01 ; 12e8e: 9f 4f sbci r25, 0xFF ; 2552e90: e9 2f mov r30, r252e92: ff 27 eor r31, r312e94: e7 fd sbrc r30, 72e96: fa 95 dec r312e98: 20 91 ea 08 lds r18, 0x08EA2e9c: 30 91 eb 08 lds r19, 0x08EB2ea0: 37 ff sbrs r19, 72ea2: 02 c0 rjmp .+4 ; 0x2ea8 <ACC_AltitudeFusion+0x168>2ea4: 21 5f subi r18, 0xF1 ; 2412ea6: 3f 4f sbci r19, 0xFF ; 2552ea8: 84 e0 ldi r24, 0x04 ; 42eaa: 35 95 asr r192eac: 27 95 ror r182eae: 8a 95 dec r242eb0: e1 f7 brne .-8 ; 0x2eaa <ACC_AltitudeFusion+0x16a>2eb2: 80 91 5d 03 lds r24, 0x035D2eb6: 90 91 5e 03 lds r25, 0x035E2eba: 82 9f mul r24, r182ebc: d0 01 movw r26, r02ebe: 83 9f mul r24, r192ec0: b0 0d add r27, r02ec2: 92 9f mul r25, r182ec4: b0 0d add r27, r02ec6: 11 24 eor r1, r12ec8: cd 01 movw r24, r262eca: b7 ff sbrs r27, 72ecc: 02 c0 rjmp .+4 ; 0x2ed2 <ACC_AltitudeFusion+0x192>2ece: 81 50 subi r24, 0x01 ; 12ed0: 9f 4f sbci r25, 0xFF ; 2552ed2: 89 2f mov r24, r252ed4: 99 0f add r25, r252ed6: 99 0b sbc r25, r252ed8: e8 0f add r30, r242eda: f9 1f adc r31, r252edc: cf 01 movw r24, r302ede: aa 27 eor r26, r262ee0: 97 fd sbrc r25, 72ee2: a0 95 com r262ee4: ba 2f mov r27, r262ee6: 84 0f add r24, r202ee8: 95 1f adc r25, r212eea: a6 1f adc r26, r222eec: b7 1f adc r27, r232eee: 80 93 0e 03 sts 0x030E, r242ef2: 90 93 0f 03 sts 0x030F, r252ef6: a0 93 10 03 sts 0x0310, r262efa: b0 93 11 03 sts 0x0311, r272efe: bc 01 movw r22, r242f00: cd 01 movw r24, r262f02: 2d e0 ldi r18, 0x0D ; 132f04: 30 e0 ldi r19, 0x00 ; 02f06: 40 e0 ldi r20, 0x00 ; 02f08: 50 e0 ldi r21, 0x00 ; 02f0a: 0e 94 27 b1 call 0x1624e ; 0x1624e <__mulsi3>2f0e: 7b 01 movw r14, r222f10: 8c 01 movw r16, r242f12: c4 01 movw r24, r82f14: b3 01 movw r22, r62f16: 24 ef ldi r18, 0xF4 ; 2442f18: 31 e0 ldi r19, 0x01 ; 12f1a: 40 e0 ldi r20, 0x00 ; 02f1c: 50 e0 ldi r21, 0x00 ; 02f1e: 0e 94 27 b1 call 0x1624e ; 0x1624e <__mulsi3>2f22: dc 01 movw r26, r242f24: cb 01 movw r24, r222f26: e8 0e add r14, r242f28: f9 1e adc r15, r252f2a: 0a 1f adc r16, r262f2c: 1b 1f adc r17, r272f2e: 80 91 0a 03 lds r24, 0x030A2f32: 90 91 0b 03 lds r25, 0x030B2f36: a0 91 0c 03 lds r26, 0x030C2f3a: b0 91 0d 03 lds r27, 0x030D2f3e: 20 91 12 03 lds r18, 0x03122f42: 30 91 13 03 lds r19, 0x03132f46: 40 91 14 03 lds r20, 0x03142f4a: 50 91 15 03 lds r21, 0x03152f4e: 82 1b sub r24, r182f50: 93 0b sbc r25, r192f52: a4 0b sbc r26, r202f54: b5 0b sbc r27, r212f56: e8 0e add r14, r242f58: f9 1e adc r15, r252f5a: 0a 1f adc r16, r262f5c: 1b 1f adc r17, r272f5e: e0 92 0a 03 sts 0x030A, r142f62: f0 92 0b 03 sts 0x030B, r152f66: 00 93 0c 03 sts 0x030C, r162f6a: 10 93 0d 03 sts 0x030D, r172f6e: d8 01 movw r26, r162f70: c7 01 movw r24, r142f72: 80 50 subi r24, 0x00 ; 02f74: 9e 4f sbci r25, 0xFE ; 2542f76: af 4f sbci r26, 0xFF ; 2552f78: bf 4f sbci r27, 0xFF ; 2552f7a: b7 ff sbrs r27, 72f7c: 06 c0 rjmp .+12 ; 0x2f8a <ACC_AltitudeFusion+0x24a>2f7e: d8 01 movw r26, r162f80: c7 01 movw r24, r142f82: 81 50 subi r24, 0x01 ; 12f84: 9a 4f sbci r25, 0xFA ; 2502f86: af 4f sbci r26, 0xFF ; 2552f88: bf 4f sbci r27, 0xFF ; 2552f8a: 1a e0 ldi r17, 0x0A ; 102f8c: b5 95 asr r272f8e: a7 95 ror r262f90: 97 95 ror r252f92: 87 95 ror r242f94: 1a 95 dec r172f96: d1 f7 brne .-12 ; 0x2f8c <ACC_AltitudeFusion+0x24c>2f98: 80 93 12 03 sts 0x0312, r242f9c: 90 93 13 03 sts 0x0313, r252fa0: a0 93 14 03 sts 0x0314, r262fa4: b0 93 15 03 sts 0x0315, r272fa8: a0 92 02 03 sts 0x0302, r102fac: b0 92 03 03 sts 0x0303, r112fb0: c0 92 04 03 sts 0x0304, r122fb4: d0 92 05 03 sts 0x0305, r132fb8: 20 91 57 03 lds r18, 0x03572fbc: 30 91 58 03 lds r19, 0x03582fc0: 40 91 59 03 lds r20, 0x03592fc4: 50 91 5a 03 lds r21, 0x035A2fc8: e0 90 4a 03 lds r14, 0x034A2fcc: f0 90 4b 03 lds r15, 0x034B2fd0: 00 91 4c 03 lds r16, 0x034C2fd4: 10 91 4d 03 lds r17, 0x034D2fd8: 2e 19 sub r18, r142fda: 3f 09 sbc r19, r152fdc: 40 0b sbc r20, r162fde: 51 0b sbc r21, r172fe0: 28 0f add r18, r242fe2: 39 1f adc r19, r252fe4: 4a 1f adc r20, r262fe6: 5b 1f adc r21, r272fe8: 2a 0d add r18, r102fea: 3b 1d adc r19, r112fec: 4c 1d adc r20, r122fee: 5d 1d adc r21, r132ff0: 20 93 57 03 sts 0x0357, r182ff4: 30 93 58 03 sts 0x0358, r192ff8: 40 93 59 03 sts 0x0359, r202ffc: 50 93 5a 03 sts 0x035A, r213000: 80 91 12 03 lds r24, 0x03123004: 90 91 13 03 lds r25, 0x03133008: 90 93 55 03 sts 0x0355, r25300c: 80 93 54 03 sts 0x0354, r243010: 80 91 57 03 lds r24, 0x03573014: 90 91 58 03 lds r25, 0x03583018: a0 91 59 03 lds r26, 0x0359301c: b0 91 5a 03 lds r27, 0x035A3020: bc 01 movw r22, r243022: cd 01 movw r24, r263024: 1f 91 pop r173026: 0f 91 pop r163028: ff 90 pop r15302a: ef 90 pop r14302c: df 90 pop r13302e: cf 90 pop r123030: bf 90 pop r113032: af 90 pop r103034: 9f 90 pop r93036: 8f 90 pop r83038: 7f 90 pop r7303a: 6f 90 pop r6303c: 08 95 ret0000303e <LIBFC_GetCPUType>:303e: 2f b7 in r18, 0x3f ; 633040: 40 e0 ldi r20, 0x00 ; 03042: f8 94 cli3044: e0 e0 ldi r30, 0x00 ; 03046: f0 e0 ldi r31, 0x00 ; 03048: 81 e2 ldi r24, 0x21 ; 33304a: 80 93 57 00 sts 0x0057, r24304e: 94 91 lpm r25, Z3050: e2 e0 ldi r30, 0x02 ; 23052: f0 e0 ldi r31, 0x00 ; 03054: 80 93 57 00 sts 0x0057, r243058: 34 91 lpm r19, Z305a: e4 e0 ldi r30, 0x04 ; 4305c: f0 e0 ldi r31, 0x00 ; 0305e: 80 93 57 00 sts 0x0057, r243062: 84 91 lpm r24, Z3064: 2f bf out 0x3f, r18 ; 633066: 9e 31 cpi r25, 0x1E ; 303068: 99 f4 brne .+38 ; 0x3090 <LIBFC_GetCPUType+0x52>306a: 36 39 cpi r19, 0x96 ; 150306c: 41 f4 brne .+16 ; 0x307e <LIBFC_GetCPUType+0x40>306e: 89 30 cpi r24, 0x09 ; 93070: 11 f4 brne .+4 ; 0x3076 <LIBFC_GetCPUType+0x38>3072: 41 e0 ldi r20, 0x01 ; 13074: 0d c0 rjmp .+26 ; 0x3090 <LIBFC_GetCPUType+0x52>3076: 8a 30 cpi r24, 0x0A ; 103078: 59 f4 brne .+22 ; 0x3090 <LIBFC_GetCPUType+0x52>307a: 42 e0 ldi r20, 0x02 ; 2307c: 09 c0 rjmp .+18 ; 0x3090 <LIBFC_GetCPUType+0x52>307e: 37 39 cpi r19, 0x97 ; 1513080: 39 f4 brne .+14 ; 0x3090 <LIBFC_GetCPUType+0x52>3082: 86 30 cpi r24, 0x06 ; 63084: 11 f4 brne .+4 ; 0x308a <LIBFC_GetCPUType+0x4c>3086: 43 e0 ldi r20, 0x03 ; 33088: 03 c0 rjmp .+6 ; 0x3090 <LIBFC_GetCPUType+0x52>308a: 85 30 cpi r24, 0x05 ; 5308c: 09 f4 brne .+2 ; 0x3090 <LIBFC_GetCPUType+0x52>308e: 44 e0 ldi r20, 0x04 ; 43090: 84 2f mov r24, r203092: 99 27 eor r25, r253094: 08 95 ret00003096 <awokdjwqdjcjuhcuweih>:3096: 9f b7 in r25, 0x3f ; 633098: f8 94 cli309a: 80 91 c9 00 lds r24, 0x00C9309e: 87 7f andi r24, 0xF7 ; 24730a0: 80 93 c9 00 sts 0x00C9, r2430a4: 80 91 c9 00 lds r24, 0x00C930a8: 8f 7e andi r24, 0xEF ; 23930aa: 80 93 c9 00 sts 0x00C9, r2430ae: 80 91 c9 00 lds r24, 0x00C930b2: 8f 77 andi r24, 0x7F ; 12730b4: 80 93 c9 00 sts 0x00C9, r2430b8: 80 91 c9 00 lds r24, 0x00C930bc: 8f 7b andi r24, 0xBF ; 19130be: 80 93 c9 00 sts 0x00C9, r2430c2: 80 91 c9 00 lds r24, 0x00C930c6: 8f 7d andi r24, 0xDF ; 22330c8: 80 93 c9 00 sts 0x00C9, r2430cc: 9f bf out 0x3f, r25 ; 6330ce: 08 95 ret000030d0 <LIBFC_ReceiverInit>:30d0: 1f 93 push r1730d2: cf 93 push r2830d4: df 93 push r2930d6: 18 2f mov r17, r2430d8: 80 91 ec 02 lds r24, 0x02EC30dc: 88 23 and r24, r2430de: 09 f4 brne .+2 ; 0x30e2 <LIBFC_ReceiverInit+0x12>30e0: a4 c0 rjmp .+328 ; 0x322a <LIBFC_ReceiverInit+0x15a>30e2: 80 91 05 01 lds r24, 0x010530e6: 18 17 cp r17, r2430e8: 09 f4 brne .+2 ; 0x30ec <LIBFC_ReceiverInit+0x1c>30ea: 9f c0 rjmp .+318 ; 0x322a <LIBFC_ReceiverInit+0x15a>30ec: 80 91 eb 02 lds r24, 0x02EB30f0: 88 23 and r24, r2430f2: 19 f4 brne .+6 ; 0x30fa <LIBFC_ReceiverInit+0x2a>30f4: a4 df rcall .-184 ; 0x303e <LIBFC_GetCPUType>30f6: 80 93 eb 02 sts 0x02EB, r2430fa: 82 ed ldi r24, 0xD2 ; 21030fc: 91 e0 ldi r25, 0x01 ; 130fe: 90 93 92 02 sts 0x0292, r253102: 80 93 91 02 sts 0x0291, r243106: 8e e0 ldi r24, 0x0E ; 143108: 99 e1 ldi r25, 0x19 ; 25310a: 9f 93 push r25310c: 8f 93 push r24310e: c7 eb ldi r28, 0xB7 ; 1833110: dc ea ldi r29, 0xAC ; 1723112: df 93 push r293114: cf 93 push r283116: e0 91 78 06 lds r30, 0x0678311a: f0 91 79 06 lds r31, 0x0679311e: 09 95 icall3120: 0f 90 pop r03122: 0f 90 pop r03124: 0f 90 pop r03126: 0f 90 pop r03128: 81 2f mov r24, r17312a: 99 27 eor r25, r25312c: aa 27 eor r26, r26312e: bb 27 eor r27, r273130: fc 01 movw r30, r243132: 09 97 sbiw r24, 0x09 ; 93134: 78 f5 brcc .+94 ; 0x3194 <LIBFC_ReceiverInit+0xc4>3136: ee 5e subi r30, 0xEE ; 2383138: fe 4f sbci r31, 0xFE ; 254313a: 20 91 78 06 lds r18, 0x0678313e: 30 91 79 06 lds r19, 0x06793142: 0c 94 a7 b1 jmp 0x1634e ; 0x1634e <__tablejump2__>3146: 8a e0 ldi r24, 0x0A ; 103148: 99 e1 ldi r25, 0x19 ; 25314a: 02 c0 rjmp .+4 ; 0x3150 <LIBFC_ReceiverInit+0x80>314c: 81 e0 ldi r24, 0x01 ; 1314e: 99 e1 ldi r25, 0x19 ; 253150: 9f 93 push r253152: 8f 93 push r243154: df 93 push r293156: cf 93 push r283158: f9 01 movw r30, r18315a: 09 95 icall315c: 27 c0 rjmp .+78 ; 0x31ac <LIBFC_ReceiverInit+0xdc>315e: 8c ef ldi r24, 0xFC ; 2523160: 98 e1 ldi r25, 0x18 ; 243162: f6 cf rjmp .-20 ; 0x3150 <LIBFC_ReceiverInit+0x80>3164: 84 ef ldi r24, 0xF4 ; 2443166: 98 e1 ldi r25, 0x18 ; 243168: f3 cf rjmp .-26 ; 0x3150 <LIBFC_ReceiverInit+0x80>316a: 8c ee ldi r24, 0xEC ; 236316c: 98 e1 ldi r25, 0x18 ; 24316e: 9f 93 push r253170: 8f 93 push r243172: df 93 push r293174: cf 93 push r283176: f9 01 movw r30, r183178: 09 95 icall317a: 88 ed ldi r24, 0xD8 ; 216317c: 91 e0 ldi r25, 0x01 ; 1317e: 90 93 92 02 sts 0x0292, r253182: 80 93 91 02 sts 0x0291, r243186: 12 c0 rjmp .+36 ; 0x31ac <LIBFC_ReceiverInit+0xdc>3188: 87 ee ldi r24, 0xE7 ; 231318a: 98 e1 ldi r25, 0x18 ; 24318c: e1 cf rjmp .-62 ; 0x3150 <LIBFC_ReceiverInit+0x80>318e: 8b e1 ldi r24, 0x1B ; 273190: 99 e1 ldi r25, 0x19 ; 253192: de cf rjmp .-68 ; 0x3150 <LIBFC_ReceiverInit+0x80>3194: 81 e2 ldi r24, 0x21 ; 333196: 99 e1 ldi r25, 0x19 ; 253198: 9f 93 push r25319a: 8f 93 push r24319c: df 93 push r29319e: cf 93 push r2831a0: e0 91 78 06 lds r30, 0x067831a4: f0 91 79 06 lds r31, 0x067931a8: 09 95 icall31aa: 10 e0 ldi r17, 0x00 ; 031ac: 0f 90 pop r031ae: 0f 90 pop r031b0: 0f 90 pop r031b2: 0f 90 pop r031b4: 80 91 eb 02 lds r24, 0x02EB31b8: 84 30 cpi r24, 0x04 ; 431ba: 11 f0 breq .+4 ; 0x31c0 <LIBFC_ReceiverInit+0xf0>31bc: 82 30 cpi r24, 0x02 ; 231be: 01 f5 brne .+64 ; 0x3200 <LIBFC_ReceiverInit+0x130>31c0: 6a df rcall .-300 ; 0x3096 <awokdjwqdjcjuhcuweih>31c2: 81 2f mov r24, r1731c4: 81 50 subi r24, 0x01 ; 131c6: 83 30 cpi r24, 0x03 ; 331c8: 18 f4 brcc .+6 ; 0x31d0 <LIBFC_ReceiverInit+0x100>31ca: 0e 94 1c 94 call 0x12838 ; 0x12838 <SpektrumUartInit>31ce: 2b c0 rjmp .+86 ; 0x3226 <LIBFC_ReceiverInit+0x156>31d0: 14 30 cpi r17, 0x04 ; 431d2: 19 f4 brne .+6 ; 0x31da <LIBFC_ReceiverInit+0x10a>31d4: 0e 94 8a 0f call 0x1f14 ; 0x1f14 <INiuzBtergGIBuB76T0G5>31d8: 26 c0 rjmp .+76 ; 0x3226 <LIBFC_ReceiverInit+0x156>31da: 18 30 cpi r17, 0x08 ; 831dc: 19 f4 brne .+6 ; 0x31e4 <LIBFC_ReceiverInit+0x114>31de: 0e 94 06 b0 call 0x1600c ; 0x1600c <User_Receiver_Init>31e2: 21 c0 rjmp .+66 ; 0x3226 <LIBFC_ReceiverInit+0x156>31e4: 15 30 cpi r17, 0x05 ; 531e6: 19 f4 brne .+6 ; 0x31ee <LIBFC_ReceiverInit+0x11e>31e8: 0e 94 cc 0d call 0x1b98 ; 0x1b98 <fomklkdtn89SFGrsgt9rf>31ec: 1c c0 rjmp .+56 ; 0x3226 <LIBFC_ReceiverInit+0x156>31ee: 16 30 cpi r17, 0x06 ; 631f0: 11 f4 brne .+4 ; 0x31f6 <LIBFC_ReceiverInit+0x126>31f2: 49 dc rcall .-1902 ; 0x2a86 <HoTT_Init>31f4: 18 c0 rjmp .+48 ; 0x3226 <LIBFC_ReceiverInit+0x156>31f6: 17 30 cpi r17, 0x07 ; 731f8: b1 f4 brne .+44 ; 0x3226 <LIBFC_ReceiverInit+0x156>31fa: 0e 94 c5 92 call 0x1258a ; 0x1258a <SbusUartInit>31fe: 13 c0 rjmp .+38 ; 0x3226 <LIBFC_ReceiverInit+0x156>3200: 11 23 and r17, r173202: 89 f0 breq .+34 ; 0x3226 <LIBFC_ReceiverInit+0x156>3204: 87 e3 ldi r24, 0x37 ; 553206: 99 e1 ldi r25, 0x19 ; 253208: 9f 93 push r25320a: 8f 93 push r24320c: 87 eb ldi r24, 0xB7 ; 183320e: 9c ea ldi r25, 0xAC ; 1723210: 9f 93 push r253212: 8f 93 push r243214: e0 91 78 06 lds r30, 0x06783218: f0 91 79 06 lds r31, 0x0679321c: 09 95 icall321e: 0f 90 pop r03220: 0f 90 pop r03222: 0f 90 pop r03224: 0f 90 pop r03226: 10 93 05 01 sts 0x0105, r17322a: df 91 pop r29322c: cf 91 pop r28322e: 1f 91 pop r173230: 08 95 ret00003232 <LIBFC_Init>:3232: 0f 93 push r163234: 1f 93 push r173236: 08 2f mov r16, r243238: 81 e0 ldi r24, 0x01 ; 1323a: 80 93 ec 02 sts 0x02EC, r24323e: 40 91 04 01 lds r20, 0x01043242: e7 e9 ldi r30, 0x97 ; 1513244: f8 e1 ldi r31, 0x18 ; 243246: 20 e0 ldi r18, 0x00 ; 03248: 30 e0 ldi r19, 0x00 ; 0324a: 5f e4 ldi r21, 0x4F ; 79324c: 84 91 lpm r24, Z324e: 99 27 eor r25, r253250: 2f 5f subi r18, 0xFF ; 2553252: 3f 4f sbci r19, 0xFF ; 2553254: 82 9f mul r24, r183256: b0 01 movw r22, r03258: 83 9f mul r24, r19325a: 70 0d add r23, r0325c: 92 9f mul r25, r18325e: 70 0d add r23, r03260: 11 24 eor r1, r13262: 46 27 eor r20, r223264: 51 50 subi r21, 0x01 ; 13266: 31 96 adiw r30, 0x01 ; 13268: 57 ff sbrs r21, 7326a: f0 cf rjmp .-32 ; 0x324c <LIBFC_Init+0x1a>326c: 40 93 04 01 sts 0x0104, r203270: ef e6 ldi r30, 0x6F ; 1113272: f8 e1 ldi r31, 0x18 ; 243274: 20 e0 ldi r18, 0x00 ; 03276: 30 e0 ldi r19, 0x00 ; 03278: 57 e2 ldi r21, 0x27 ; 39327a: 84 91 lpm r24, Z327c: 99 27 eor r25, r25327e: 2f 5f subi r18, 0xFF ; 2553280: 3f 4f sbci r19, 0xFF ; 2553282: 82 9f mul r24, r183284: b0 01 movw r22, r03286: 83 9f mul r24, r193288: 70 0d add r23, r0328a: 92 9f mul r25, r18328c: 70 0d add r23, r0328e: 11 24 eor r1, r13290: 46 27 eor r20, r223292: 51 50 subi r21, 0x01 ; 13294: 31 96 adiw r30, 0x01 ; 13296: 57 ff sbrs r21, 73298: f0 cf rjmp .-32 ; 0x327a <LIBFC_Init+0x48>329a: 40 93 04 01 sts 0x0104, r20329e: 80 91 eb 02 lds r24, 0x02EB32a2: 88 23 and r24, r2432a4: 19 f4 brne .+6 ; 0x32ac <LIBFC_Init+0x7a>32a6: cb de rcall .-618 ; 0x303e <LIBFC_GetCPUType>32a8: 80 93 eb 02 sts 0x02EB, r2432ac: 81 e7 ldi r24, 0x71 ; 11332ae: 92 e1 ldi r25, 0x12 ; 1832b0: 90 93 79 06 sts 0x0679, r2532b4: 80 93 78 06 sts 0x0678, r2432b8: 80 91 04 01 lds r24, 0x010432bc: 83 34 cpi r24, 0x43 ; 6732be: 59 f0 breq .+22 ; 0x32d6 <LIBFC_Init+0xa4>32c0: 88 e1 ldi r24, 0x18 ; 2432c2: 90 e0 ldi r25, 0x00 ; 032c4: 29 e2 ldi r18, 0x29 ; 4132c6: 0f b6 in r0, 0x3f ; 6332c8: f8 94 cli32ca: a8 95 wdr32cc: 80 93 60 00 sts 0x0060, r2432d0: 0f be out 0x3f, r0 ; 6332d2: 20 93 60 00 sts 0x0060, r1832d6: 07 30 cpi r16, 0x07 ; 732d8: 91 f0 breq .+36 ; 0x32fe <LIBFC_Init+0xcc>32da: 82 e5 ldi r24, 0x52 ; 8232dc: 99 e1 ldi r25, 0x19 ; 2532de: 9f 93 push r2532e0: 8f 93 push r2432e2: 87 eb ldi r24, 0xB7 ; 18332e4: 9c ea ldi r25, 0xAC ; 17232e6: 9f 93 push r2532e8: 8f 93 push r2432ea: e0 91 78 06 lds r30, 0x067832ee: f0 91 79 06 lds r31, 0x067932f2: 09 95 icall32f4: 0f 90 pop r032f6: 0f 90 pop r032f8: 0f 90 pop r032fa: 0f 90 pop r032fc: ee cf rjmp .-36 ; 0x32da <LIBFC_Init+0xa8>32fe: 80 91 54 01 lds r24, 0x01543302: 89 31 cpi r24, 0x19 ; 253304: 58 f1 brcs .+86 ; 0x335c <LIBFC_Init+0x12a>3306: 80 91 ea 02 lds r24, 0x02EA330a: 88 23 and r24, r24330c: a9 f4 brne .+42 ; 0x3338 <LIBFC_Init+0x106>330e: 8f e6 ldi r24, 0x6F ; 1113310: 99 e1 ldi r25, 0x19 ; 253312: 9f 93 push r253314: 8f 93 push r243316: 87 eb ldi r24, 0xB7 ; 1833318: 9c ea ldi r25, 0xAC ; 172331a: 9f 93 push r25331c: 8f 93 push r24331e: e0 91 78 06 lds r30, 0x06783322: f0 91 79 06 lds r31, 0x06793326: 09 95 icall3328: 87 e1 ldi r24, 0x17 ; 23332a: 80 93 54 01 sts 0x0154, r24332e: 0f 90 pop r03330: 0f 90 pop r03332: 0f 90 pop r03334: 0f 90 pop r03336: 12 c0 rjmp .+36 ; 0x335c <LIBFC_Init+0x12a>3338: 15 bc out 0x25, r1 ; 37333a: 87 31 cpi r24, 0x17 ; 23333c: 19 f4 brne .+6 ; 0x3344 <LIBFC_Init+0x112>333e: 80 93 54 01 sts 0x0154, r243342: 06 c0 rjmp .+12 ; 0x3350 <LIBFC_Init+0x11e>3344: 87 e0 ldi r24, 0x07 ; 73346: 80 93 0b 01 sts 0x010B, r24334a: 86 e0 ldi r24, 0x06 ; 6334c: 80 93 0a 01 sts 0x010A, r243350: e0 91 02 01 lds r30, 0x01023354: f0 91 03 01 lds r31, 0x01033358: 8d ef ldi r24, 0xFD ; 253335a: 09 95 icall335c: 0e 94 4b 59 call 0xb296 ; 0xb296 <PrintLine>3360: 81 e6 ldi r24, 0x61 ; 973362: 90 e0 ldi r25, 0x00 ; 03364: 9f 93 push r253366: 8f 93 push r243368: 88 e0 ldi r24, 0x08 ; 8336a: 90 e0 ldi r25, 0x00 ; 0336c: 9f 93 push r25336e: 8f 93 push r243370: 82 e0 ldi r24, 0x02 ; 23372: 90 e0 ldi r25, 0x00 ; 03374: 9f 93 push r253376: 8f 93 push r243378: 80 91 54 01 lds r24, 0x0154337c: 6a e0 ldi r22, 0x0A ; 10337e: 0e 94 36 b1 call 0x1626c ; 0x1626c <__udivmodqi4>3382: 89 2f mov r24, r253384: 99 27 eor r25, r253386: 9f 93 push r253388: 8f 93 push r24338a: 80 91 54 01 lds r24, 0x0154338e: 0e 94 36 b1 call 0x1626c ; 0x1626c <__udivmodqi4>3392: 99 27 eor r25, r253394: 9f 93 push r253396: 8f 93 push r243398: 89 ea ldi r24, 0xA9 ; 169339a: 99 e1 ldi r25, 0x19 ; 25339c: 9f 93 push r25339e: 8f 93 push r2433a0: 07 eb ldi r16, 0xB7 ; 18333a2: 1c ea ldi r17, 0xAC ; 17233a4: 1f 93 push r1733a6: 0f 93 push r1633a8: e0 91 78 06 lds r30, 0x067833ac: f0 91 79 06 lds r31, 0x067933b0: 09 95 icall33b2: 87 e9 ldi r24, 0x97 ; 15133b4: 98 e1 ldi r25, 0x18 ; 2433b6: 9f 93 push r2533b8: 8f 93 push r2433ba: 1f 93 push r1733bc: 0f 93 push r1633be: e0 91 78 06 lds r30, 0x067833c2: f0 91 79 06 lds r31, 0x067933c6: 09 95 icall33c8: 8f e6 ldi r24, 0x6F ; 11133ca: 98 e1 ldi r25, 0x18 ; 2433cc: 9f 93 push r2533ce: 8f 93 push r2433d0: 1f 93 push r1733d2: 0f 93 push r1633d4: e0 91 78 06 lds r30, 0x067833d8: f0 91 79 06 lds r31, 0x067933dc: 09 95 icall33de: 0e 94 4b 59 call 0xb296 ; 0xb296 <PrintLine>33e2: 83 ec ldi r24, 0xC3 ; 19533e4: 80 93 81 00 sts 0x0081, r2433e8: 80 91 6f 00 lds r24, 0x006F33ec: 80 62 ori r24, 0x20 ; 3233ee: 80 93 6f 00 sts 0x006F, r2433f2: 8d b7 in r24, 0x3d ; 6133f4: 9e b7 in r25, 0x3e ; 6233f6: 46 96 adiw r24, 0x16 ; 2233f8: 8d bf out 0x3d, r24 ; 6133fa: 1f 91 pop r1733fc: 0f 91 pop r1633fe: 08 95 ret00003400 <LIBFC_CheckSettings>:3400: 80 91 a6 05 lds r24, 0x05A63404: 8d 33 cpi r24, 0x3D ; 613406: 38 f0 brcs .+14 ; 0x3416 <LIBFC_CheckSettings+0x16>3408: 80 91 d7 08 lds r24, 0x08D7340c: 87 fd sbrc r24, 7340e: 03 c0 rjmp .+6 ; 0x3416 <LIBFC_CheckSettings+0x16>3410: 8c e3 ldi r24, 0x3C ; 603412: 80 93 a6 05 sts 0x05A6, r243416: 80 91 54 05 lds r24, 0x0554341a: 88 23 and r24, r24341c: 31 f0 breq .+12 ; 0x342a <LIBFC_CheckSettings+0x2a>341e: 80 55 subi r24, 0x50 ; 803420: 85 36 cpi r24, 0x65 ; 1013422: 18 f0 brcs .+6 ; 0x342a <LIBFC_CheckSettings+0x2a>3424: 8f e7 ldi r24, 0x7F ; 1273426: 80 93 54 05 sts 0x0554, r24342a: 08 95 ret0000342c <LIBFC_Polling>:342c: 80 91 ec 02 lds r24, 0x02EC3430: 88 23 and r24, r243432: 09 f4 brne .+2 ; 0x3436 <LIBFC_Polling+0xa>3434: 85 c0 rjmp .+266 ; 0x3540 <LIBFC_Polling+0x114>3436: 80 91 26 03 lds r24, 0x0326343a: 81 50 subi r24, 0x01 ; 1343c: 80 93 26 03 sts 0x0326, r243440: 88 23 and r24, r243442: 09 f0 breq .+2 ; 0x3446 <LIBFC_Polling+0x1a>3444: 69 c0 rjmp .+210 ; 0x3518 <LIBFC_Polling+0xec>3446: 89 e1 ldi r24, 0x19 ; 253448: 80 93 26 03 sts 0x0326, r24344c: 80 91 a6 05 lds r24, 0x05A63450: 8e 33 cpi r24, 0x3E ; 623452: 38 f0 brcs .+14 ; 0x3462 <LIBFC_Polling+0x36>3454: 80 91 d7 08 lds r24, 0x08D73458: 87 fd sbrc r24, 7345a: 03 c0 rjmp .+6 ; 0x3462 <LIBFC_Polling+0x36>345c: 8d e3 ldi r24, 0x3D ; 61345e: 80 93 a6 05 sts 0x05A6, r243462: 80 91 04 04 lds r24, 0x04043466: 82 38 cpi r24, 0x82 ; 1303468: a0 f5 brcc .+104 ; 0x34d2 <LIBFC_Polling+0xa6>346a: 80 91 cc 03 lds r24, 0x03CC346e: 90 91 cd 03 lds r25, 0x03CD3472: 80 5d subi r24, 0xD0 ; 2083474: 97 40 sbci r25, 0x07 ; 73476: 20 f0 brcs .+8 ; 0x3480 <LIBFC_Polling+0x54>3478: 80 91 1b 05 lds r24, 0x051B347c: 84 36 cpi r24, 0x64 ; 100347e: 20 f4 brcc .+8 ; 0x3488 <LIBFC_Polling+0x5c>3480: 10 92 28 03 sts 0x0328, r13484: 10 92 27 03 sts 0x0327, r13488: 20 91 27 03 lds r18, 0x0327348c: 30 91 28 03 lds r19, 0x03283490: 21 15 cp r18, r13492: 31 05 cpc r19, r13494: b1 f1 breq .+108 ; 0x3502 <LIBFC_Polling+0xd6>3496: c9 01 movw r24, r183498: 01 97 sbiw r24, 0x01 ; 1349a: 90 93 28 03 sts 0x0328, r25349e: 80 93 27 03 sts 0x0327, r2434a2: 41 97 sbiw r24, 0x11 ; 1734a4: 98 f1 brcs .+102 ; 0x350c <LIBFC_Polling+0xe0>34a6: 80 91 d7 08 lds r24, 0x08D734aa: 84 ff sbrs r24, 434ac: 2f c0 rjmp .+94 ; 0x350c <LIBFC_Polling+0xe0>34ae: 80 91 ca 03 lds r24, 0x03CA34b2: 84 60 ori r24, 0x04 ; 434b4: 80 93 ca 03 sts 0x03CA, r2434b8: 80 91 e5 08 lds r24, 0x08E534bc: 87 ff sbrs r24, 734be: 26 c0 rjmp .+76 ; 0x350c <LIBFC_Polling+0xe0>34c0: 80 91 8d 04 lds r24, 0x048D34c4: 88 23 and r24, r2434c6: 11 f1 breq .+68 ; 0x350c <LIBFC_Polling+0xe0>34c8: 30 93 28 03 sts 0x0328, r1934cc: 20 93 27 03 sts 0x0327, r1834d0: 1d c0 rjmp .+58 ; 0x350c <LIBFC_Polling+0xe0>34d2: 80 91 04 04 lds r24, 0x040434d6: 85 3b cpi r24, 0xB5 ; 18134d8: c8 f0 brcs .+50 ; 0x350c <LIBFC_Polling+0xe0>34da: 90 91 a6 05 lds r25, 0x05A634de: 84 e1 ldi r24, 0x14 ; 2034e0: 98 9f mul r25, r2434e2: c0 01 movw r24, r034e4: 11 24 eor r1, r134e6: 40 96 adiw r24, 0x10 ; 1634e8: 20 91 27 03 lds r18, 0x032734ec: 30 91 28 03 lds r19, 0x032834f0: 28 17 cp r18, r2434f2: 39 07 cpc r19, r2534f4: 30 f4 brcc .+12 ; 0x3502 <LIBFC_Polling+0xd6>34f6: 2f 5f subi r18, 0xFF ; 25534f8: 3f 4f sbci r19, 0xFF ; 25534fa: 30 93 28 03 sts 0x0328, r1934fe: 20 93 27 03 sts 0x0327, r183502: 80 91 ca 03 lds r24, 0x03CA3506: 8b 7f andi r24, 0xFB ; 2513508: 80 93 ca 03 sts 0x03CA, r24350c: 80 91 04 01 lds r24, 0x01043510: 83 34 cpi r24, 0x43 ; 673512: 11 f0 breq .+4 ; 0x3518 <LIBFC_Polling+0xec>3514: 10 92 ec 02 sts 0x02EC, r13518: 90 91 05 01 lds r25, 0x0105351c: 96 30 cpi r25, 0x06 ; 6351e: 09 f4 brne .+2 ; 0x3522 <LIBFC_Polling+0xf6>3520: cf cb rjmp .-2146 ; 0x2cc0 <HoTT_Polling>3522: 80 91 09 01 lds r24, 0x01093526: 88 23 and r24, r243528: 21 f0 breq .+8 ; 0x3532 <LIBFC_Polling+0x106>352a: 81 50 subi r24, 0x01 ; 1352c: 80 93 09 01 sts 0x0109, r243530: 08 95 ret3532: 8b e4 ldi r24, 0x4B ; 753534: 80 93 09 01 sts 0x0109, r243538: 94 30 cpi r25, 0x04 ; 4353a: 11 f4 brne .+4 ; 0x3540 <LIBFC_Polling+0x114>353c: 0c 94 d4 11 jmp 0x23a8 ; 0x23a8 <a48784362857632195659>3540: 08 95 ret00003542 <__vector_28>:3542: 1f 92 push r13544: 0f 92 push r03546: 0f b6 in r0, 0x3f ; 633548: 0f 92 push r0354a: 11 24 eor r1, r1354c: 2f 93 push r18354e: 3f 93 push r193550: 4f 93 push r203552: 5f 93 push r213554: 6f 93 push r223556: 7f 93 push r233558: 8f 93 push r24355a: 9f 93 push r25355c: af 93 push r26355e: bf 93 push r273560: ef 93 push r303562: ff 93 push r313564: 90 91 ce 00 lds r25, 0x00CE3568: 80 91 ec 04 lds r24, 0x04EC356c: 88 23 and r24, r24356e: b9 f0 breq .+46 ; 0x359e <__vector_28+0x5c>3570: 90 93 c6 00 sts 0x00C6, r253574: 80 91 ec 04 lds r24, 0x04EC3578: 82 30 cpi r24, 0x02 ; 2357a: 09 f0 breq .+2 ; 0x357e <__vector_28+0x3c>357c: 3e c0 rjmp .+124 ; 0x35fa <__vector_28+0xb8>357e: 9f 3f cpi r25, 0xFF ; 2553580: e1 f5 brne .+120 ; 0x35fa <__vector_28+0xb8>3582: 8f ef ldi r24, 0xFF ; 2553584: 94 e3 ldi r25, 0x34 ; 523586: ac e0 ldi r26, 0x0C ; 123588: b0 e0 ldi r27, 0x00 ; 0358a: c2 97 sbiw r24, 0x32 ; 50358c: a1 09 sbc r26, r1358e: b1 09 sbc r27, r13590: b7 ff sbrs r27, 73592: fb cf rjmp .-10 ; 0x358a <__vector_28+0x48>3594: 80 91 8c 0a lds r24, 0x0A8C3598: 80 93 ce 00 sts 0x00CE, r24359c: 2e c0 rjmp .+92 ; 0x35fa <__vector_28+0xb8>359e: 20 91 05 01 lds r18, 0x010535a2: 82 2f mov r24, r1835a4: 81 50 subi r24, 0x01 ; 135a6: 83 30 cpi r24, 0x03 ; 335a8: 20 f4 brcc .+8 ; 0x35b2 <__vector_28+0x70>35aa: 89 2f mov r24, r2535ac: 0e 94 65 94 call 0x128ca ; 0x128ca <SpektrumParser>35b0: 24 c0 rjmp .+72 ; 0x35fa <__vector_28+0xb8>35b2: 24 30 cpi r18, 0x04 ; 435b4: 21 f4 brne .+8 ; 0x35be <__vector_28+0x7c>35b6: 89 2f mov r24, r2535b8: 0e 94 e9 0f call 0x1fd2 ; 0x1fd2 <KLNMIOHMUHG76GFGr43r3>35bc: 1e c0 rjmp .+60 ; 0x35fa <__vector_28+0xb8>35be: 28 30 cpi r18, 0x08 ; 835c0: 21 f4 brne .+8 ; 0x35ca <__vector_28+0x88>35c2: 89 2f mov r24, r2535c4: 0e 94 07 b0 call 0x1600e ; 0x1600e <User_RX_Parser>35c8: 18 c0 rjmp .+48 ; 0x35fa <__vector_28+0xb8>35ca: 80 91 54 01 lds r24, 0x015435ce: 89 31 cpi r24, 0x19 ; 2535d0: 20 f0 brcs .+8 ; 0x35da <__vector_28+0x98>35d2: 80 91 ea 02 lds r24, 0x02EA35d6: 88 23 and r24, r2435d8: 81 f0 breq .+32 ; 0x35fa <__vector_28+0xb8>35da: 25 30 cpi r18, 0x05 ; 535dc: 21 f4 brne .+8 ; 0x35e6 <__vector_28+0xa4>35de: 89 2f mov r24, r2535e0: 0e 94 2e 0f call 0x1e5c ; 0x1e5c <FGtj76uzh56z3grEg5t45>35e4: 0a c0 rjmp .+20 ; 0x35fa <__vector_28+0xb8>35e6: 26 30 cpi r18, 0x06 ; 635e8: 19 f4 brne .+6 ; 0x35f0 <__vector_28+0xae>35ea: 89 2f mov r24, r2535ec: 30 db rcall .-2464 ; 0x2c4e <HoTT_Parser>35ee: 05 c0 rjmp .+10 ; 0x35fa <__vector_28+0xb8>35f0: 27 30 cpi r18, 0x07 ; 735f2: 19 f4 brne .+6 ; 0x35fa <__vector_28+0xb8>35f4: 89 2f mov r24, r2535f6: 0e 94 11 93 call 0x12622 ; 0x12622 <SbusParser>35fa: ff 91 pop r3135fc: ef 91 pop r3035fe: bf 91 pop r273600: af 91 pop r263602: 9f 91 pop r253604: 8f 91 pop r243606: 7f 91 pop r233608: 6f 91 pop r22360a: 5f 91 pop r21360c: 4f 91 pop r20360e: 3f 91 pop r193610: 2f 91 pop r183612: 0f 90 pop r03614: 0f be out 0x3f, r0 ; 633616: 0f 90 pop r03618: 1f 90 pop r1361a: 18 95 reti0000361c <ADC_Init>://#######################################################################################void ADC_Init(void)//#######################################################################################{ADMUX = 0;//Referenz ist extern361c: 10 92 7c 00 sts 0x007C, r1ANALOG_ON;3620: 8f ec ldi r24, 0xCF ; 2073622: 80 93 7a 00 sts 0x007A, r243626: 08 95 ret00003628 <CalcExpandBaroStep>:#define DESIRED_H_ADC 800void CalcExpandBaroStep(void){if(ACC_AltitudeControl) ExpandBaroStep = BaroStep * (long)ExpandBaro;3628: 80 91 c2 03 lds r24, 0x03C2362c: 88 23 and r24, r24362e: a1 f0 breq .+40 ; 0x3658 <CalcExpandBaroStep+0x30>3630: 20 91 0d 01 lds r18, 0x010D3634: 30 91 0e 01 lds r19, 0x010E3638: a0 91 56 03 lds r26, 0x0356363c: bb 27 eor r27, r27363e: a7 fd sbrc r26, 73640: b0 95 com r273642: 0e 94 c2 b1 call 0x16384 ; 0x16384 <__usmulhisi3>3646: 60 93 4e 03 sts 0x034E, r22364a: 70 93 4f 03 sts 0x034F, r23364e: 80 93 50 03 sts 0x0350, r243652: 90 93 51 03 sts 0x0351, r253656: 08 95 retelse ExpandBaroStep = (16 * BaroStep) * (long)ExpandBaro - 4;3658: 20 91 0d 01 lds r18, 0x010D365c: 30 91 0e 01 lds r19, 0x010E3660: 22 95 swap r183662: 32 95 swap r193664: 30 7f andi r19, 0xF0 ; 2403666: 32 27 eor r19, r183668: 20 7f andi r18, 0xF0 ; 240366a: 32 27 eor r19, r18366c: a0 91 56 03 lds r26, 0x03563670: bb 27 eor r27, r273672: a7 fd sbrc r26, 73674: b0 95 com r273676: 0e 94 c2 b1 call 0x16384 ; 0x16384 <__usmulhisi3>367a: dc 01 movw r26, r24367c: cb 01 movw r24, r22367e: 04 97 sbiw r24, 0x04 ; 43680: a1 09 sbc r26, r13682: b1 09 sbc r27, r13684: 80 93 4e 03 sts 0x034E, r243688: 90 93 4f 03 sts 0x034F, r25368c: a0 93 50 03 sts 0x0350, r263690: b0 93 51 03 sts 0x0351, r273694: 08 95 ret00003696 <SucheLuftruckOffset>:}void SucheLuftruckOffset(void){3696: ef 92 push r143698: ff 92 push r15369a: 0f 93 push r16369c: 1f 93 push r17369e: cf 93 push r2836a0: df 93 push r29unsigned int off;ExpandBaro = 0;36a2: 10 92 56 03 sts 0x0356, r1CalcExpandBaroStep();36a6: c0 df rcall .-128 ; 0x3628 <CalcExpandBaroStep>off = GetParamByte(PID_PRESSURE_OFFSET);36a8: 83 e0 ldi r24, 0x03 ; 336aa: 90 e0 ldi r25, 0x00 ; 036ac: 0e 94 42 25 call 0x4a84 ; 0x4a84 <GetParamByte>36b0: c8 2f mov r28, r2436b2: d0 e0 ldi r29, 0x00 ; 0if(off < 240) off += 10;36b4: c0 3f cpi r28, 0xF0 ; 24036b6: d1 05 cpc r29, r136b8: 08 f4 brcc .+2 ; 0x36bc <SucheLuftruckOffset+0x26>36ba: 2a 96 adiw r28, 0x0a ; 10OCR0A = off;36bc: c7 bd out 0x27, r28 ; 39OCR0B = 255-off;36be: 8c 2f mov r24, r2836c0: 80 95 com r2436c2: 88 bd out 0x28, r24 ; 40Delay_ms_Mess(150);36c4: 86 e9 ldi r24, 0x96 ; 15036c6: 90 e0 ldi r25, 0x00 ; 036c8: 0e 94 6e 9c call 0x138dc ; 0x138dc <Delay_ms_Mess>if(MessLuftdruck > DESIRED_H_ADC) off = 240;36cc: 80 91 10 01 lds r24, 0x011036d0: 90 91 11 01 lds r25, 0x011136d4: 81 32 cpi r24, 0x21 ; 3336d6: 93 40 sbci r25, 0x03 ; 336d8: 58 f0 brcs .+22 ; 0x36f0 <SucheLuftruckOffset+0x5a>36da: c0 ef ldi r28, 0xF0 ; 24036dc: d0 e0 ldi r29, 0x00 ; 0for(; off > 5; off--){OCR0A = off;OCR0B = 255-off;Delay_ms_Mess(100);printf(".");36de: 0f 2e mov r0, r3136e0: f6 e3 ldi r31, 0x36 ; 5436e2: ef 2e mov r14, r3136e4: f2 e0 ldi r31, 0x02 ; 236e6: ff 2e mov r15, r3136e8: f0 2d mov r31, r036ea: 07 eb ldi r16, 0xB7 ; 18336ec: 1c ea ldi r17, 0xAC ; 17236ee: 04 c0 rjmp .+8 ; 0x36f8 <SucheLuftruckOffset+0x62>if(off < 240) off += 10;OCR0A = off;OCR0B = 255-off;Delay_ms_Mess(150);if(MessLuftdruck > DESIRED_H_ADC) off = 240;for(; off > 5; off--)36f0: c6 30 cpi r28, 0x06 ; 636f2: d1 05 cpc r29, r136f4: a0 f7 brcc .-24 ; 0x36de <SucheLuftruckOffset+0x48>36f6: 20 c0 rjmp .+64 ; 0x3738 <SucheLuftruckOffset+0xa2>{OCR0A = off;36f8: 8c 2f mov r24, r2836fa: c7 bd out 0x27, r28 ; 3936fc: 80 95 com r24OCR0B = 255-off;36fe: 88 bd out 0x28, r24 ; 40Delay_ms_Mess(100);3700: 84 e6 ldi r24, 0x64 ; 1003702: 90 e0 ldi r25, 0x00 ; 03704: 0e 94 6e 9c call 0x138dc ; 0x138dc <Delay_ms_Mess>printf(".");3708: ff 92 push r15370a: ef 92 push r14370c: 1f 93 push r17370e: 0f 93 push r163710: e0 91 78 06 lds r30, 0x06783714: f0 91 79 06 lds r31, 0x06793718: 09 95 icallif(MessLuftdruck > DESIRED_H_ADC) break;371a: 80 91 10 01 lds r24, 0x0110371e: 90 91 11 01 lds r25, 0x01113722: 0f 90 pop r03724: 0f 90 pop r03726: 0f 90 pop r03728: 0f 90 pop r0372a: 81 32 cpi r24, 0x21 ; 33372c: 93 40 sbci r25, 0x03 ; 3372e: 20 f4 brcc .+8 ; 0x3738 <SucheLuftruckOffset+0xa2>if(off < 240) off += 10;OCR0A = off;OCR0B = 255-off;Delay_ms_Mess(150);if(MessLuftdruck > DESIRED_H_ADC) off = 240;for(; off > 5; off--)3730: 21 97 sbiw r28, 0x01 ; 13732: c6 30 cpi r28, 0x06 ; 63734: d1 05 cpc r29, r13736: 00 f7 brcc .-64 ; 0x36f8 <SucheLuftruckOffset+0x62>OCR0B = 255-off;Delay_ms_Mess(100);printf(".");if(MessLuftdruck > DESIRED_H_ADC) break;}DruckOffsetSetting = off;3738: c0 93 12 05 sts 0x0512, r28SetParamByte(PID_PRESSURE_OFFSET, off);373c: 6c 2f mov r22, r28373e: 83 e0 ldi r24, 0x03 ; 33740: 90 e0 ldi r25, 0x00 ; 03742: 0e 94 45 25 call 0x4a8a ; 0x4a8a <SetParamByte>if((EE_Parameter.GlobalConfig & CFG_HOEHENREGELUNG) && (DruckOffsetSetting < 10 || DruckOffsetSetting >= 230)) VersionInfo.HardwareError[0] |= FC_ERROR0_PRESSURE;3746: 80 91 4b 05 lds r24, 0x054B374a: 80 ff sbrs r24, 0374c: 0a c0 rjmp .+20 ; 0x3762 <SucheLuftruckOffset+0xcc>374e: 80 91 12 05 lds r24, 0x05123752: 8a 50 subi r24, 0x0A ; 103754: 8c 3d cpi r24, 0xDC ; 2203756: 28 f0 brcs .+10 ; 0x3762 <SucheLuftruckOffset+0xcc>3758: e2 e6 ldi r30, 0x62 ; 98375a: fa e0 ldi r31, 0x0A ; 10375c: 80 81 ld r24, Z375e: 80 64 ori r24, 0x40 ; 643760: 80 83 st Z, r24#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++// + correction of the altitude error in higher altitudes// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++CalAthmospheare = 16;3762: 80 e1 ldi r24, 0x10 ; 163764: 80 93 0c 01 sts 0x010C, r24if(ACC_AltitudeControl)3768: 80 91 c2 03 lds r24, 0x03C2376c: 88 23 and r24, r24376e: 69 f1 breq .+90 ; 0x37ca <SucheLuftruckOffset+0x134>{if(PlatinenVersion < 23) { if(off < 140) CalAthmospheare += (160 - off) / 26; }3770: 80 91 54 01 lds r24, 0x01543774: 87 31 cpi r24, 0x17 ; 233776: a8 f4 brcc .+42 ; 0x37a2 <SucheLuftruckOffset+0x10c>3778: cc 38 cpi r28, 0x8C ; 140377a: d1 05 cpc r29, r1377c: 30 f5 brcc .+76 ; 0x37ca <SucheLuftruckOffset+0x134>377e: 20 ea ldi r18, 0xA0 ; 1603780: 30 e0 ldi r19, 0x00 ; 03782: 2c 1b sub r18, r283784: 3d 0b sbc r19, r293786: a5 ec ldi r26, 0xC5 ; 1973788: be e4 ldi r27, 0x4E ; 78378a: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>378e: 96 95 lsr r253790: 87 95 ror r243792: 96 95 lsr r253794: 87 95 ror r243796: 96 95 lsr r253798: 87 95 ror r24379a: 80 5f subi r24, 0xF0 ; 240379c: 80 93 0c 01 sts 0x010C, r2437a0: 14 c0 rjmp .+40 ; 0x37ca <SucheLuftruckOffset+0x134>else { if(off < 170) CalAthmospheare += (188 - off) / 19; }37a2: ca 3a cpi r28, 0xAA ; 17037a4: d1 05 cpc r29, r137a6: 88 f4 brcc .+34 ; 0x37ca <SucheLuftruckOffset+0x134>37a8: 2c eb ldi r18, 0xBC ; 18837aa: 30 e0 ldi r19, 0x00 ; 037ac: 2c 1b sub r18, r2837ae: 3d 0b sbc r19, r2937b0: a5 e9 ldi r26, 0x95 ; 14937b2: b7 ed ldi r27, 0xD7 ; 21537b4: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>37b8: 92 95 swap r2537ba: 82 95 swap r2437bc: 8f 70 andi r24, 0x0F ; 1537be: 89 27 eor r24, r2537c0: 9f 70 andi r25, 0x0F ; 1537c2: 89 27 eor r24, r2537c4: 80 5f subi r24, 0xF0 ; 24037c6: 80 93 0c 01 sts 0x010C, r24}Luftdruck = MessLuftdruck * CalAthmospheare;37ca: 20 91 10 01 lds r18, 0x011037ce: 30 91 11 01 lds r19, 0x011137d2: 40 91 0c 01 lds r20, 0x010C37d6: 42 9f mul r20, r1837d8: c0 01 movw r24, r037da: 43 9f mul r20, r1937dc: 90 0d add r25, r037de: 11 24 eor r1, r137e0: a0 e0 ldi r26, 0x00 ; 037e2: b0 e0 ldi r27, 0x00 ; 037e4: 80 93 12 01 sts 0x0112, r2437e8: 90 93 13 01 sts 0x0113, r2537ec: a0 93 14 01 sts 0x0114, r2637f0: b0 93 15 01 sts 0x0115, r27#endifDelay_ms_Mess(300);37f4: 8c e2 ldi r24, 0x2C ; 4437f6: 91 e0 ldi r25, 0x01 ; 137f8: 0e 94 6e 9c call 0x138dc ; 0x138dc <Delay_ms_Mess>}37fc: df 91 pop r2937fe: cf 91 pop r283800: 1f 91 pop r173802: 0f 91 pop r163804: ff 90 pop r153806: ef 90 pop r143808: 08 95 ret0000380a <__vector_24>://#######################################################################################//ISR(ADC_vect)//#######################################################################################{380a: 1f 92 push r1380c: 0f 92 push r0380e: 0f b6 in r0, 0x3f ; 633810: 0f 92 push r03812: 11 24 eor r1, r13814: 0b b6 in r0, 0x3b ; 593816: 0f 92 push r03818: 8f 92 push r8381a: 9f 92 push r9381c: af 92 push r10381e: bf 92 push r113820: cf 92 push r123822: df 92 push r133824: ef 92 push r143826: ff 92 push r153828: 0f 93 push r16382a: 1f 93 push r17382c: 2f 93 push r18382e: 3f 93 push r193830: 4f 93 push r203832: 5f 93 push r213834: 6f 93 push r223836: 7f 93 push r233838: 8f 93 push r24383a: 9f 93 push r25383c: af 93 push r26383e: bf 93 push r273840: ef 93 push r303842: ff 93 push r31static signed int subcount = 0;static signed int gier1, roll1, nick1, nick_filter, roll_filter;static signed int accy, accx;static long tmpLuftdruck = 0;static char messanzahl_Druck = 0;switch(state++)3844: 80 91 41 03 lds r24, 0x03413848: 91 e0 ldi r25, 0x01 ; 1384a: 98 0f add r25, r24384c: 90 93 41 03 sts 0x0341, r253850: 90 e0 ldi r25, 0x00 ; 03852: 82 31 cpi r24, 0x12 ; 183854: 91 05 cpc r25, r13856: 08 f0 brcs .+2 ; 0x385a <__vector_24+0x50>3858: 5d c5 rjmp .+2746 ; 0x4314 <__stack+0x215>385a: fc 01 movw r30, r24385c: ea 5b subi r30, 0xBA ; 186385e: ff 4f sbci r31, 0xFF ; 2553860: 0c 94 a7 b1 jmp 0x1634e ; 0x1634e <__tablejump2__>{case 0:nick1 = ADC;3864: 80 91 78 00 lds r24, 0x00783868: 90 91 79 00 lds r25, 0x0079386c: 90 93 40 03 sts 0x0340, r253870: 80 93 3f 03 sts 0x033F, r24kanal = AD_ROLL;3874: 81 e0 ldi r24, 0x01 ; 13876: 80 93 3e 03 sts 0x033E, r24break;387a: 51 c5 rjmp .+2722 ; 0x431e <__stack+0x21f>case 1:roll1 = ADC;387c: 80 91 78 00 lds r24, 0x00783880: 90 91 79 00 lds r25, 0x00793884: 90 93 3d 03 sts 0x033D, r253888: 80 93 3c 03 sts 0x033C, r24kanal = AD_GIER;388c: 10 92 3e 03 sts 0x033E, r1break;3890: 46 c5 rjmp .+2700 ; 0x431e <__stack+0x21f>case 2:gier1 = ADC;3892: 80 91 78 00 lds r24, 0x00783896: 90 91 79 00 lds r25, 0x0079389a: 90 93 3b 03 sts 0x033B, r25389e: 80 93 3a 03 sts 0x033A, r24kanal = AD_ACC_Y;38a2: 80 91 0b 01 lds r24, 0x010B38a6: 80 93 3e 03 sts 0x033E, r24break;38aa: 39 c5 rjmp .+2674 ; 0x431e <__stack+0x21f>case 3:Aktuell_ay = NeutralAccY - ADC;38ac: 20 91 78 00 lds r18, 0x007838b0: 30 91 79 00 lds r19, 0x007938b4: 80 91 4b 04 lds r24, 0x044B38b8: 90 91 4c 04 lds r25, 0x044C38bc: 82 1b sub r24, r1838be: 93 0b sbc r25, r1938c0: 90 93 05 05 sts 0x0505, r2538c4: 80 93 04 05 sts 0x0504, r24accy = Aktuell_ay;38c8: 80 91 04 05 lds r24, 0x050438cc: 90 91 05 05 lds r25, 0x050538d0: 90 93 39 03 sts 0x0339, r2538d4: 80 93 38 03 sts 0x0338, r24kanal = AD_ACC_X;38d8: 80 91 0a 01 lds r24, 0x010A38dc: 80 93 3e 03 sts 0x033E, r24break;38e0: 1e c5 rjmp .+2620 ; 0x431e <__stack+0x21f>case 4:Aktuell_ax = ADC - NeutralAccX;38e2: 80 91 78 00 lds r24, 0x007838e6: 90 91 79 00 lds r25, 0x007938ea: 20 91 4d 04 lds r18, 0x044D38ee: 30 91 4e 04 lds r19, 0x044E38f2: 82 1b sub r24, r1838f4: 93 0b sbc r25, r1938f6: 90 93 11 05 sts 0x0511, r2538fa: 80 93 10 05 sts 0x0510, r24accx = Aktuell_ax;38fe: 80 91 10 05 lds r24, 0x05103902: 90 91 11 05 lds r25, 0x05113906: 90 93 37 03 sts 0x0337, r25390a: 80 93 36 03 sts 0x0336, r24kanal = AD_NICK;390e: 82 e0 ldi r24, 0x02 ; 23910: 80 93 3e 03 sts 0x033E, r24break;3914: 04 c5 rjmp .+2568 ; 0x431e <__stack+0x21f>case 5:nick1 += ADC;3916: 80 91 78 00 lds r24, 0x0078391a: 90 91 79 00 lds r25, 0x0079391e: 20 91 3f 03 lds r18, 0x033F3922: 30 91 40 03 lds r19, 0x03403926: 82 0f add r24, r183928: 93 1f adc r25, r19392a: 90 93 40 03 sts 0x0340, r25392e: 80 93 3f 03 sts 0x033F, r24kanal = AD_ROLL;3932: 81 e0 ldi r24, 0x01 ; 13934: 80 93 3e 03 sts 0x033E, r24break;3938: f2 c4 rjmp .+2532 ; 0x431e <__stack+0x21f>case 6:roll1 += ADC;393a: 80 91 78 00 lds r24, 0x0078393e: 90 91 79 00 lds r25, 0x00793942: 20 91 3c 03 lds r18, 0x033C3946: 30 91 3d 03 lds r19, 0x033D394a: 82 0f add r24, r18394c: 93 1f adc r25, r19394e: 90 93 3d 03 sts 0x033D, r253952: 80 93 3c 03 sts 0x033C, r24kanal = AD_UBAT;3956: 84 e0 ldi r24, 0x04 ; 43958: 80 93 3e 03 sts 0x033E, r24break;395c: e0 c4 rjmp .+2496 ; 0x431e <__stack+0x21f>case 7:#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))if(EE_Parameter.ExtraConfig & CFG_3_3V_REFERENCE) UBat = (3 * UBat + (11 * ADC) / 30) / 4; // there were some single FC2.1 with 3.3V reference395e: 80 91 b8 05 lds r24, 0x05B83962: 83 ff sbrs r24, 33964: 29 c0 rjmp .+82 ; 0x39b8 <__vector_24+0x1ae>3966: 40 91 1a 01 lds r20, 0x011A396a: 50 91 1b 01 lds r21, 0x011B396e: 80 91 78 00 lds r24, 0x00783972: 90 91 79 00 lds r25, 0x00793976: 6b e0 ldi r22, 0x0B ; 113978: 68 9f mul r22, r24397a: 90 01 movw r18, r0397c: 69 9f mul r22, r25397e: 30 0d add r19, r03980: 11 24 eor r1, r13982: a9 e8 ldi r26, 0x89 ; 1373984: b8 e8 ldi r27, 0x88 ; 1363986: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>398a: 92 95 swap r25398c: 82 95 swap r24398e: 8f 70 andi r24, 0x0F ; 153990: 89 27 eor r24, r253992: 9f 70 andi r25, 0x0F ; 153994: 89 27 eor r24, r253996: 9a 01 movw r18, r203998: 22 0f add r18, r18399a: 33 1f adc r19, r19399c: 42 0f add r20, r18399e: 53 1f adc r21, r1939a0: 48 0f add r20, r2439a2: 59 1f adc r21, r2539a4: ca 01 movw r24, r2039a6: 96 95 lsr r2539a8: 87 95 ror r2439aa: 96 95 lsr r2539ac: 87 95 ror r2439ae: 90 93 1b 01 sts 0x011B, r2539b2: 80 93 1a 01 sts 0x011A, r2439b6: 53 c0 rjmp .+166 ; 0x3a5e <__vector_24+0x254>else#endif{static unsigned int tmpVoltage = 0;if(!tmpVoltage) tmpVoltage = (10 * ADC);39b8: 80 91 34 03 lds r24, 0x033439bc: 90 91 35 03 lds r25, 0x033539c0: 89 2b or r24, r2539c2: 99 f4 brne .+38 ; 0x39ea <__vector_24+0x1e0>39c4: 80 91 78 00 lds r24, 0x007839c8: 90 91 79 00 lds r25, 0x007939cc: 9c 01 movw r18, r2439ce: 22 0f add r18, r1839d0: 33 1f adc r19, r1939d2: 88 0f add r24, r2439d4: 99 1f adc r25, r2539d6: 88 0f add r24, r2439d8: 99 1f adc r25, r2539da: 88 0f add r24, r2439dc: 99 1f adc r25, r2539de: 82 0f add r24, r1839e0: 93 1f adc r25, r1939e2: 90 93 35 03 sts 0x0335, r2539e6: 80 93 34 03 sts 0x0334, r24if(tmpVoltage <= (10 * ADC)) tmpVoltage += 2; else tmpVoltage -= 2;39ea: 20 91 78 00 lds r18, 0x007839ee: 30 91 79 00 lds r19, 0x007939f2: 80 91 34 03 lds r24, 0x033439f6: 90 91 35 03 lds r25, 0x033539fa: a9 01 movw r20, r1839fc: 44 0f add r20, r2039fe: 55 1f adc r21, r213a00: 22 0f add r18, r183a02: 33 1f adc r19, r193a04: 22 0f add r18, r183a06: 33 1f adc r19, r193a08: 22 0f add r18, r183a0a: 33 1f adc r19, r193a0c: 24 0f add r18, r203a0e: 35 1f adc r19, r213a10: 28 17 cp r18, r243a12: 39 07 cpc r19, r253a14: 30 f0 brcs .+12 ; 0x3a22 <__vector_24+0x218>3a16: 02 96 adiw r24, 0x02 ; 23a18: 90 93 35 03 sts 0x0335, r253a1c: 80 93 34 03 sts 0x0334, r243a20: 05 c0 rjmp .+10 ; 0x3a2c <__vector_24+0x222>3a22: 02 97 sbiw r24, 0x02 ; 23a24: 90 93 35 03 sts 0x0335, r253a28: 80 93 34 03 sts 0x0334, r24UBat = tmpVoltage / 31;3a2c: 40 91 34 03 lds r20, 0x03343a30: 50 91 35 03 lds r21, 0x03353a34: 9a 01 movw r18, r203a36: a3 e4 ldi r26, 0x43 ; 673a38: b8 e0 ldi r27, 0x08 ; 83a3a: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>3a3e: 48 1b sub r20, r243a40: 59 0b sbc r21, r253a42: 56 95 lsr r213a44: 47 95 ror r203a46: 84 0f add r24, r203a48: 95 1f adc r25, r213a4a: 92 95 swap r253a4c: 82 95 swap r243a4e: 8f 70 andi r24, 0x0F ; 153a50: 89 27 eor r24, r253a52: 9f 70 andi r25, 0x0F ; 153a54: 89 27 eor r24, r253a56: 90 93 1b 01 sts 0x011B, r253a5a: 80 93 1a 01 sts 0x011A, r24}kanal = AD_ACC_Z;3a5e: 85 e0 ldi r24, 0x05 ; 53a60: 80 93 3e 03 sts 0x033E, r24break;3a64: 5c c4 rjmp .+2232 ; 0x431e <__stack+0x21f>case 8:Aktuell_az = ADC;3a66: 80 91 78 00 lds r24, 0x00783a6a: 90 91 79 00 lds r25, 0x00793a6e: 90 93 07 05 sts 0x0507, r253a72: 80 93 06 05 sts 0x0506, r24AdWertAccHoch = Aktuell_az - NeutralAccZ - (int) NeutralAccZfine;3a76: 20 91 06 05 lds r18, 0x05063a7a: 30 91 07 05 lds r19, 0x05073a7e: 80 91 47 04 lds r24, 0x04473a82: 90 91 48 04 lds r25, 0x04483a86: 40 91 46 04 lds r20, 0x04463a8a: 28 1b sub r18, r243a8c: 39 0b sbc r19, r253a8e: 24 1b sub r18, r203a90: 31 09 sbc r19, r13a92: 47 fd sbrc r20, 73a94: 33 95 inc r193a96: 30 93 5c 03 sts 0x035C, r193a9a: 20 93 5b 03 sts 0x035B, r18if(!ACC_AltitudeControl) // The Offset must be corrected, because of the ACC-Drift from vibrations3a9e: 20 91 c2 03 lds r18, 0x03C23aa2: 21 11 cpse r18, r13aa4: 72 c0 rjmp .+228 ; 0x3b8a <__vector_24+0x380>{if(AdWertAccHoch > 1)3aa6: 20 91 5b 03 lds r18, 0x035B3aaa: 30 91 5c 03 lds r19, 0x035C3aae: 22 30 cpi r18, 0x02 ; 23ab0: 31 05 cpc r19, r13ab2: 8c f1 brlt .+98 ; 0x3b16 <__vector_24+0x30c>{if(NeutralAccZ < 750)3ab4: 8e 3e cpi r24, 0xEE ; 2383ab6: 22 e0 ldi r18, 0x02 ; 23ab8: 92 07 cpc r25, r183aba: 0c f0 brlt .+2 ; 0x3abe <__vector_24+0x2b4>3abc: ad c0 rjmp .+346 ; 0x3c18 <__vector_24+0x40e>{subcount += 5;3abe: 20 91 32 03 lds r18, 0x03323ac2: 30 91 33 03 lds r19, 0x03333ac6: a9 01 movw r20, r183ac8: 4b 5f subi r20, 0xFB ; 2513aca: 5f 4f sbci r21, 0xFF ; 2553acc: 50 93 33 03 sts 0x0333, r213ad0: 40 93 32 03 sts 0x0332, r20if(modell_fliegt < 500) subcount += 10;3ad4: 40 91 cc 03 lds r20, 0x03CC3ad8: 50 91 cd 03 lds r21, 0x03CD3adc: 44 3f cpi r20, 0xF4 ; 2443ade: 51 40 sbci r21, 0x01 ; 13ae0: 30 f4 brcc .+12 ; 0x3aee <__vector_24+0x2e4>3ae2: 21 5f subi r18, 0xF1 ; 2413ae4: 3f 4f sbci r19, 0xFF ; 2553ae6: 30 93 33 03 sts 0x0333, r193aea: 20 93 32 03 sts 0x0332, r18if(subcount > 100) { NeutralAccZ++; subcount -= 100;}3aee: 20 91 32 03 lds r18, 0x03323af2: 30 91 33 03 lds r19, 0x03333af6: 25 36 cpi r18, 0x65 ; 1013af8: 31 05 cpc r19, r13afa: 0c f4 brge .+2 ; 0x3afe <__vector_24+0x2f4>3afc: 8d c0 rjmp .+282 ; 0x3c18 <__vector_24+0x40e>3afe: 01 96 adiw r24, 0x01 ; 13b00: 90 93 48 04 sts 0x0448, r253b04: 80 93 47 04 sts 0x0447, r243b08: 24 56 subi r18, 0x64 ; 1003b0a: 31 09 sbc r19, r13b0c: 30 93 33 03 sts 0x0333, r193b10: 20 93 32 03 sts 0x0332, r183b14: 81 c0 rjmp .+258 ; 0x3c18 <__vector_24+0x40e>}}else if(AdWertAccHoch < -1)3b16: 20 91 5b 03 lds r18, 0x035B3b1a: 30 91 5c 03 lds r19, 0x035C3b1e: 2f 3f cpi r18, 0xFF ; 2553b20: 3f 4f sbci r19, 0xFF ; 2553b22: 0c f0 brlt .+2 ; 0x3b26 <__vector_24+0x31c>3b24: 79 c0 rjmp .+242 ; 0x3c18 <__vector_24+0x40e>{if(NeutralAccZ > 550)3b26: 87 32 cpi r24, 0x27 ; 393b28: 22 e0 ldi r18, 0x02 ; 23b2a: 92 07 cpc r25, r183b2c: 0c f4 brge .+2 ; 0x3b30 <__vector_24+0x326>3b2e: 74 c0 rjmp .+232 ; 0x3c18 <__vector_24+0x40e>{subcount -= 5;3b30: 20 91 32 03 lds r18, 0x03323b34: 30 91 33 03 lds r19, 0x03333b38: a9 01 movw r20, r183b3a: 45 50 subi r20, 0x05 ; 53b3c: 51 09 sbc r21, r13b3e: 50 93 33 03 sts 0x0333, r213b42: 40 93 32 03 sts 0x0332, r20if(modell_fliegt < 500) subcount -= 10;3b46: 40 91 cc 03 lds r20, 0x03CC3b4a: 50 91 cd 03 lds r21, 0x03CD3b4e: 44 3f cpi r20, 0xF4 ; 2443b50: 51 40 sbci r21, 0x01 ; 13b52: 30 f4 brcc .+12 ; 0x3b60 <__vector_24+0x356>3b54: 2f 50 subi r18, 0x0F ; 153b56: 31 09 sbc r19, r13b58: 30 93 33 03 sts 0x0333, r193b5c: 20 93 32 03 sts 0x0332, r18if(subcount < -100) { NeutralAccZ--; subcount += 100;}3b60: 20 91 32 03 lds r18, 0x03323b64: 30 91 33 03 lds r19, 0x03333b68: 2c 39 cpi r18, 0x9C ; 1563b6a: ef ef ldi r30, 0xFF ; 2553b6c: 3e 07 cpc r19, r303b6e: 0c f0 brlt .+2 ; 0x3b72 <__vector_24+0x368>3b70: 53 c0 rjmp .+166 ; 0x3c18 <__vector_24+0x40e>3b72: 01 97 sbiw r24, 0x01 ; 13b74: 90 93 48 04 sts 0x0448, r253b78: 80 93 47 04 sts 0x0447, r243b7c: 2c 59 subi r18, 0x9C ; 1563b7e: 3f 4f sbci r19, 0xFF ; 2553b80: 30 93 33 03 sts 0x0333, r193b84: 20 93 32 03 sts 0x0332, r183b88: 47 c0 rjmp .+142 ; 0x3c18 <__vector_24+0x40e>}}}#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))elseif(CosAttitude > 8192 - 50) // horizontal leveled within 6°3b8a: 80 91 2d 06 lds r24, 0x062D3b8e: 90 91 2e 06 lds r25, 0x062E3b92: 8f 3c cpi r24, 0xCF ; 2073b94: 9f 41 sbci r25, 0x1F ; 313b96: 0c f4 brge .+2 ; 0x3b9a <__vector_24+0x390>3b98: 3f c0 rjmp .+126 ; 0x3c18 <__vector_24+0x40e>{if(AdWertAccHoch > 1)3b9a: 80 91 5b 03 lds r24, 0x035B3b9e: 90 91 5c 03 lds r25, 0x035C3ba2: 02 97 sbiw r24, 0x02 ; 23ba4: cc f0 brlt .+50 ; 0x3bd8 <__vector_24+0x3ce>{if(++subcount > 5000)3ba6: 20 91 32 03 lds r18, 0x03323baa: 30 91 33 03 lds r19, 0x03333bae: c9 01 movw r24, r183bb0: 01 96 adiw r24, 0x01 ; 13bb2: 90 93 33 03 sts 0x0333, r253bb6: 80 93 32 03 sts 0x0332, r243bba: 89 38 cpi r24, 0x89 ; 1373bbc: 93 41 sbci r25, 0x13 ; 193bbe: 64 f1 brlt .+88 ; 0x3c18 <__vector_24+0x40e>{if(NeutralAccZfine < 6) NeutralAccZfine++;3bc0: 46 30 cpi r20, 0x06 ; 63bc2: 1c f4 brge .+6 ; 0x3bca <__vector_24+0x3c0>3bc4: 4f 5f subi r20, 0xFF ; 2553bc6: 40 93 46 04 sts 0x0446, r20subcount -= 5000;3bca: 27 58 subi r18, 0x87 ; 1353bcc: 33 41 sbci r19, 0x13 ; 193bce: 30 93 33 03 sts 0x0333, r193bd2: 20 93 32 03 sts 0x0332, r183bd6: 20 c0 rjmp .+64 ; 0x3c18 <__vector_24+0x40e>}}elseif(AdWertAccHoch < -1)3bd8: 80 91 5b 03 lds r24, 0x035B3bdc: 90 91 5c 03 lds r25, 0x035C3be0: 8f 3f cpi r24, 0xFF ; 2553be2: 9f 4f sbci r25, 0xFF ; 2553be4: cc f4 brge .+50 ; 0x3c18 <__vector_24+0x40e>{if(--subcount < -5000)3be6: 80 91 32 03 lds r24, 0x03323bea: 90 91 33 03 lds r25, 0x03333bee: 9c 01 movw r18, r243bf0: 21 50 subi r18, 0x01 ; 13bf2: 31 09 sbc r19, r13bf4: 30 93 33 03 sts 0x0333, r193bf8: 20 93 32 03 sts 0x0332, r183bfc: 28 37 cpi r18, 0x78 ; 1203bfe: 3c 4e sbci r19, 0xEC ; 2363c00: 5c f4 brge .+22 ; 0x3c18 <__vector_24+0x40e>{if(NeutralAccZfine > -6) NeutralAccZfine--;3c02: 4b 3f cpi r20, 0xFB ; 2513c04: 1c f0 brlt .+6 ; 0x3c0c <__vector_24+0x402>3c06: 41 50 subi r20, 0x01 ; 13c08: 40 93 46 04 sts 0x0446, r20subcount += 5000;3c0c: 89 57 subi r24, 0x79 ; 1213c0e: 9c 4e sbci r25, 0xEC ; 2363c10: 90 93 33 03 sts 0x0333, r253c14: 80 93 32 03 sts 0x0332, r24}}}#endifMess_Integral_Hoch += AdWertAccHoch; // Integrieren3c18: 80 91 5b 03 lds r24, 0x035B3c1c: 90 91 5c 03 lds r25, 0x035C3c20: 40 91 1e 04 lds r20, 0x041E3c24: 50 91 1f 04 lds r21, 0x041F3c28: 60 91 20 04 lds r22, 0x04203c2c: 70 91 21 04 lds r23, 0x04213c30: aa 27 eor r26, r263c32: 97 fd sbrc r25, 73c34: a0 95 com r263c36: ba 2f mov r27, r263c38: 84 0f add r24, r203c3a: 95 1f adc r25, r213c3c: a6 1f adc r26, r223c3e: b7 1f adc r27, r233c40: 80 93 1e 04 sts 0x041E, r243c44: 90 93 1f 04 sts 0x041F, r253c48: a0 93 20 04 sts 0x0420, r263c4c: b0 93 21 04 sts 0x0421, r27Mess_Integral_Hoch -= Mess_Integral_Hoch / 1024; // dämfen3c50: c0 90 1e 04 lds r12, 0x041E3c54: d0 90 1f 04 lds r13, 0x041F3c58: e0 90 20 04 lds r14, 0x04203c5c: f0 90 21 04 lds r15, 0x04213c60: 80 91 1e 04 lds r24, 0x041E3c64: 90 91 1f 04 lds r25, 0x041F3c68: a0 91 20 04 lds r26, 0x04203c6c: b0 91 21 04 lds r27, 0x04213c70: bb 23 and r27, r273c72: 24 f4 brge .+8 ; 0x3c7c <__vector_24+0x472>3c74: 81 50 subi r24, 0x01 ; 13c76: 9c 4f sbci r25, 0xFC ; 2523c78: af 4f sbci r26, 0xFF ; 2553c7a: bf 4f sbci r27, 0xFF ; 2553c7c: ac 01 movw r20, r243c7e: bd 01 movw r22, r263c80: 03 2e mov r0, r193c82: 3a e0 ldi r19, 0x0A ; 103c84: 75 95 asr r233c86: 67 95 ror r223c88: 57 95 ror r213c8a: 47 95 ror r203c8c: 3a 95 dec r193c8e: d1 f7 brne .-12 ; 0x3c84 <__vector_24+0x47a>3c90: 30 2d mov r19, r03c92: d7 01 movw r26, r143c94: c6 01 movw r24, r123c96: 84 1b sub r24, r203c98: 95 0b sbc r25, r213c9a: a6 0b sbc r26, r223c9c: b7 0b sbc r27, r233c9e: 80 93 1e 04 sts 0x041E, r243ca2: 90 93 1f 04 sts 0x041F, r253ca6: a0 93 20 04 sts 0x0420, r263caa: b0 93 21 04 sts 0x0421, r27kanal = AD_DRUCK;3cae: 83 e0 ldi r24, 0x03 ; 33cb0: 80 93 3e 03 sts 0x033E, r24break;3cb4: 34 c3 rjmp .+1640 ; 0x431e <__stack+0x21f>// "case 9:" fehlt hier absichtlichcase 10:nick1 += ADC;3cb6: 80 91 78 00 lds r24, 0x00783cba: 90 91 79 00 lds r25, 0x00793cbe: 20 91 3f 03 lds r18, 0x033F3cc2: 30 91 40 03 lds r19, 0x03403cc6: 82 0f add r24, r183cc8: 93 1f adc r25, r193cca: 90 93 40 03 sts 0x0340, r253cce: 80 93 3f 03 sts 0x033F, r24kanal = AD_ROLL;3cd2: 81 e0 ldi r24, 0x01 ; 13cd4: 80 93 3e 03 sts 0x033E, r24break;3cd8: 22 c3 rjmp .+1604 ; 0x431e <__stack+0x21f>case 11:roll1 += ADC;3cda: 80 91 78 00 lds r24, 0x00783cde: 90 91 79 00 lds r25, 0x00793ce2: 20 91 3c 03 lds r18, 0x033C3ce6: 30 91 3d 03 lds r19, 0x033D3cea: 82 0f add r24, r183cec: 93 1f adc r25, r193cee: 90 93 3d 03 sts 0x033D, r253cf2: 80 93 3c 03 sts 0x033C, r24kanal = AD_GIER;3cf6: 10 92 3e 03 sts 0x033E, r1break;3cfa: 11 c3 rjmp .+1570 ; 0x431e <__stack+0x21f>/* if(PlatinenVersion == 10) AdWertGier = (ADC + gier1 + 1) / 2;elseif(PlatinenVersion >= 20) AdWertGier = 2047 - (ADC + gier1);else AdWertGier = (ADC + gier1);*/AdWertGier = 2047 - (ADC + gier1);3cfc: 20 91 78 00 lds r18, 0x00783d00: 30 91 79 00 lds r19, 0x00793d04: 8f ef ldi r24, 0xFF ; 2553d06: 97 e0 ldi r25, 0x07 ; 73d08: 82 1b sub r24, r183d0a: 93 0b sbc r25, r193d0c: 20 91 3a 03 lds r18, 0x033A3d10: 30 91 3b 03 lds r19, 0x033B3d14: 82 1b sub r24, r183d16: 93 0b sbc r25, r193d18: 90 93 62 03 sts 0x0362, r253d1c: 80 93 61 03 sts 0x0361, r24kanal = AD_ACC_Y;3d20: 80 91 0b 01 lds r24, 0x010B3d24: 80 93 3e 03 sts 0x033E, r24break;3d28: fa c2 rjmp .+1524 ; 0x431e <__stack+0x21f>case 13:Aktuell_ay = NeutralAccY - ADC;3d2a: 20 91 78 00 lds r18, 0x00783d2e: 30 91 79 00 lds r19, 0x00793d32: 80 91 4b 04 lds r24, 0x044B3d36: 90 91 4c 04 lds r25, 0x044C3d3a: 82 1b sub r24, r183d3c: 93 0b sbc r25, r193d3e: 90 93 05 05 sts 0x0505, r253d42: 80 93 04 05 sts 0x0504, r24AdWertAccRoll = (Aktuell_ay + accy);3d46: 20 91 04 05 lds r18, 0x05043d4a: 30 91 05 05 lds r19, 0x05053d4e: 80 91 38 03 lds r24, 0x03383d52: 90 91 39 03 lds r25, 0x03393d56: 82 0f add r24, r183d58: 93 1f adc r25, r193d5a: 90 93 60 03 sts 0x0360, r253d5e: 80 93 5f 03 sts 0x035F, r24kanal = AD_ACC_X;3d62: 80 91 0a 01 lds r24, 0x010A3d66: 80 93 3e 03 sts 0x033E, r24break;3d6a: d9 c2 rjmp .+1458 ; 0x431e <__stack+0x21f>case 14:Aktuell_ax = ADC - NeutralAccX;3d6c: 80 91 78 00 lds r24, 0x00783d70: 90 91 79 00 lds r25, 0x00793d74: 20 91 4d 04 lds r18, 0x044D3d78: 30 91 4e 04 lds r19, 0x044E3d7c: 82 1b sub r24, r183d7e: 93 0b sbc r25, r193d80: 90 93 11 05 sts 0x0511, r253d84: 80 93 10 05 sts 0x0510, r24AdWertAccNick = (Aktuell_ax + accx);3d88: 20 91 10 05 lds r18, 0x05103d8c: 30 91 11 05 lds r19, 0x05113d90: 80 91 36 03 lds r24, 0x03363d94: 90 91 37 03 lds r25, 0x03373d98: 82 0f add r24, r183d9a: 93 1f adc r25, r193d9c: 90 93 5e 03 sts 0x035E, r253da0: 80 93 5d 03 sts 0x035D, r24kanal = AD_NICK;3da4: 82 e0 ldi r24, 0x02 ; 23da6: 80 93 3e 03 sts 0x033E, r24break;3daa: b9 c2 rjmp .+1394 ; 0x431e <__stack+0x21f>case 15:nick1 += ADC;3dac: 20 91 78 00 lds r18, 0x00783db0: 30 91 79 00 lds r19, 0x00793db4: 80 91 3f 03 lds r24, 0x033F3db8: 90 91 40 03 lds r25, 0x03403dbc: 82 0f add r24, r183dbe: 93 1f adc r25, r19//if(PlatinenVersion == 10) nick1 *= 2; elsenick1 *= 4;3dc0: 88 0f add r24, r243dc2: 99 1f adc r25, r253dc4: 88 0f add r24, r243dc6: 99 1f adc r25, r253dc8: 90 93 40 03 sts 0x0340, r253dcc: 80 93 3f 03 sts 0x033F, r24AdWertNick = nick1 / 8;3dd0: 9c 01 movw r18, r243dd2: 99 23 and r25, r253dd4: 14 f4 brge .+4 ; 0x3dda <__vector_24+0x5d0>3dd6: 29 5f subi r18, 0xF9 ; 2493dd8: 3f 4f sbci r19, 0xFF ; 2553dda: 35 95 asr r193ddc: 27 95 ror r183dde: 35 95 asr r193de0: 27 95 ror r183de2: 35 95 asr r193de4: 27 95 ror r183de6: 30 93 66 03 sts 0x0366, r193dea: 20 93 65 03 sts 0x0365, r18nick_filter = (nick_filter + nick1) / 2;3dee: 20 91 30 03 lds r18, 0x03303df2: 30 91 31 03 lds r19, 0x03313df6: 82 0f add r24, r183df8: 93 1f adc r25, r193dfa: 99 23 and r25, r253dfc: 0c f4 brge .+2 ; 0x3e00 <__vector_24+0x5f6>3dfe: 01 96 adiw r24, 0x01 ; 13e00: 95 95 asr r253e02: 87 95 ror r243e04: 90 93 31 03 sts 0x0331, r253e08: 80 93 30 03 sts 0x0330, r24HiResNick = nick_filter - AdNeutralNick;3e0c: 20 91 57 04 lds r18, 0x04573e10: 30 91 58 04 lds r19, 0x04583e14: 82 1b sub r24, r183e16: 93 0b sbc r25, r193e18: 90 93 19 01 sts 0x0119, r253e1c: 80 93 18 01 sts 0x0118, r24AdWertNickFilter = (AdWertNickFilter + HiResNick) / 2;3e20: 20 91 69 03 lds r18, 0x03693e24: 30 91 6a 03 lds r19, 0x036A3e28: 80 91 18 01 lds r24, 0x01183e2c: 90 91 19 01 lds r25, 0x01193e30: 82 0f add r24, r183e32: 93 1f adc r25, r193e34: 99 23 and r25, r253e36: 0c f4 brge .+2 ; 0x3e3a <__vector_24+0x630>3e38: 01 96 adiw r24, 0x01 ; 13e3a: 95 95 asr r253e3c: 87 95 ror r243e3e: 90 93 6a 03 sts 0x036A, r253e42: 80 93 69 03 sts 0x0369, r24kanal = AD_ROLL;3e46: 81 e0 ldi r24, 0x01 ; 13e48: 80 93 3e 03 sts 0x033E, r24break;3e4c: 68 c2 rjmp .+1232 ; 0x431e <__stack+0x21f>case 16:roll1 += ADC;3e4e: 20 91 78 00 lds r18, 0x00783e52: 30 91 79 00 lds r19, 0x00793e56: 80 91 3c 03 lds r24, 0x033C3e5a: 90 91 3d 03 lds r25, 0x033D3e5e: 82 0f add r24, r183e60: 93 1f adc r25, r19//if(PlatinenVersion == 10) roll1 *= 2; elseroll1 *= 4;3e62: 88 0f add r24, r243e64: 99 1f adc r25, r253e66: 88 0f add r24, r243e68: 99 1f adc r25, r253e6a: 90 93 3d 03 sts 0x033D, r253e6e: 80 93 3c 03 sts 0x033C, r24AdWertRoll = roll1 / 8;3e72: 9c 01 movw r18, r243e74: 99 23 and r25, r253e76: 14 f4 brge .+4 ; 0x3e7c <__vector_24+0x672>3e78: 29 5f subi r18, 0xF9 ; 2493e7a: 3f 4f sbci r19, 0xFF ; 2553e7c: 35 95 asr r193e7e: 27 95 ror r183e80: 35 95 asr r193e82: 27 95 ror r183e84: 35 95 asr r193e86: 27 95 ror r183e88: 30 93 64 03 sts 0x0364, r193e8c: 20 93 63 03 sts 0x0363, r18roll_filter = (roll_filter + roll1) / 2;3e90: 20 91 2e 03 lds r18, 0x032E3e94: 30 91 2f 03 lds r19, 0x032F3e98: 82 0f add r24, r183e9a: 93 1f adc r25, r193e9c: 99 23 and r25, r253e9e: 0c f4 brge .+2 ; 0x3ea2 <__vector_24+0x698>3ea0: 01 96 adiw r24, 0x01 ; 13ea2: 95 95 asr r253ea4: 87 95 ror r243ea6: 90 93 2f 03 sts 0x032F, r253eaa: 80 93 2e 03 sts 0x032E, r24HiResRoll = roll_filter - AdNeutralRoll;3eae: 20 91 55 04 lds r18, 0x04553eb2: 30 91 56 04 lds r19, 0x04563eb6: 82 1b sub r24, r183eb8: 93 0b sbc r25, r193eba: 90 93 17 01 sts 0x0117, r253ebe: 80 93 16 01 sts 0x0116, r24AdWertRollFilter = (AdWertRollFilter + HiResRoll) / 2;3ec2: 20 91 67 03 lds r18, 0x03673ec6: 30 91 68 03 lds r19, 0x03683eca: 80 91 16 01 lds r24, 0x01163ece: 90 91 17 01 lds r25, 0x01173ed2: 82 0f add r24, r183ed4: 93 1f adc r25, r193ed6: 99 23 and r25, r253ed8: 0c f4 brge .+2 ; 0x3edc <__vector_24+0x6d2>3eda: 01 96 adiw r24, 0x01 ; 13edc: 95 95 asr r253ede: 87 95 ror r243ee0: 90 93 68 03 sts 0x0368, r253ee4: 80 93 67 03 sts 0x0367, r24kanal = AD_DRUCK;3ee8: 83 e0 ldi r24, 0x03 ; 33eea: 80 93 3e 03 sts 0x033E, r24break;3eee: 17 c2 rjmp .+1070 ; 0x431e <__stack+0x21f>case 17:#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))if(ACC_AltitudeControl)3ef0: 80 91 c2 03 lds r24, 0x03C23ef4: 88 23 and r24, r243ef6: 11 f1 breq .+68 ; 0x3f3c <__vector_24+0x732>{HoehenWertF_Mess = (ACC_AltitudeFusion(0) + SA_FILTER/2)/SA_FILTER; // cm3ef8: 80 e0 ldi r24, 0x00 ; 03efa: 0e 94 a0 16 call 0x2d40 ; 0x2d40 <ACC_AltitudeFusion>3efe: ab 01 movw r20, r223f00: bc 01 movw r22, r243f02: 5f 5f subi r21, 0xFF ; 2553f04: 6f 4f sbci r22, 0xFF ; 2553f06: 7f 4f sbci r23, 0xFF ; 2553f08: db 01 movw r26, r223f0a: ca 01 movw r24, r203f0c: 77 23 and r23, r233f0e: 24 f4 brge .+8 ; 0x3f18 <__vector_24+0x70e>3f10: 81 50 subi r24, 0x01 ; 13f12: 9e 4f sbci r25, 0xFE ; 2543f14: af 4f sbci r26, 0xFF ; 2553f16: bf 4f sbci r27, 0xFF ; 2553f18: 07 2e mov r0, r233f1a: 79 e0 ldi r23, 0x09 ; 93f1c: b5 95 asr r273f1e: a7 95 ror r263f20: 97 95 ror r253f22: 87 95 ror r243f24: 7a 95 dec r233f26: d1 f7 brne .-12 ; 0x3f1c <__vector_24+0x712>3f28: 70 2d mov r23, r03f2a: 80 93 42 03 sts 0x0342, r243f2e: 90 93 43 03 sts 0x0343, r253f32: a0 93 44 03 sts 0x0344, r263f36: b0 93 45 03 sts 0x0345, r273f3a: 10 c0 rjmp .+32 ; 0x3f5c <__vector_24+0x752>}else HoehenWertF_Mess = HoehenWert;3f3c: 80 91 fe 03 lds r24, 0x03FE3f40: 90 91 ff 03 lds r25, 0x03FF3f44: a0 91 00 04 lds r26, 0x04003f48: b0 91 01 04 lds r27, 0x04013f4c: 80 93 42 03 sts 0x0342, r243f50: 90 93 43 03 sts 0x0343, r253f54: a0 93 44 03 sts 0x0344, r263f58: b0 93 45 03 sts 0x0345, r27#endifstate = 0;3f5c: 10 92 41 03 sts 0x0341, r1AdReady = 1;3f60: 81 e0 ldi r24, 0x01 ; 13f62: 80 93 0f 01 sts 0x010F, r24ZaehlMessungen++;3f66: 80 91 52 03 lds r24, 0x03523f6a: 90 91 53 03 lds r25, 0x03533f6e: 01 96 adiw r24, 0x01 ; 13f70: 90 93 53 03 sts 0x0353, r253f74: 80 93 52 03 sts 0x0352, r24// "break" fehlt hier absichtlichcase 9:MessLuftdruck = ADC;3f78: 80 91 78 00 lds r24, 0x00783f7c: 90 91 79 00 lds r25, 0x00793f80: 90 93 11 01 sts 0x0111, r253f84: 80 93 10 01 sts 0x0110, r24#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))if(ACC_AltitudeControl)3f88: 80 91 c2 03 lds r24, 0x03C23f8c: 88 23 and r24, r243f8e: 09 f4 brne .+2 ; 0x3f92 <__vector_24+0x788>3f90: 6e c0 rjmp .+220 ; 0x406e <__vector_24+0x864>{// ExpandBaroStep = BaroStep * (long)ExpandBaro; // wird in fc.c aufgerufen// tmpLuftdruck = MessLuftdruck - BaroStep * (long)ExpandBaro; // -523 counts per offset steptmpLuftdruck = MessLuftdruck - ExpandBaroStep; // -523 counts per offset step3f92: c0 90 10 01 lds r12, 0x01103f96: d0 90 11 01 lds r13, 0x01113f9a: e1 2c mov r14, r13f9c: f1 2c mov r15, r13f9e: 80 91 4e 03 lds r24, 0x034E3fa2: 90 91 4f 03 lds r25, 0x034F3fa6: a0 91 50 03 lds r26, 0x03503faa: b0 91 51 03 lds r27, 0x03513fae: c8 1a sub r12, r243fb0: d9 0a sbc r13, r253fb2: ea 0a sbc r14, r263fb4: fb 0a sbc r15, r273fb6: c0 92 2a 03 sts 0x032A, r123fba: d0 92 2b 03 sts 0x032B, r133fbe: e0 92 2c 03 sts 0x032C, r143fc2: f0 92 2d 03 sts 0x032D, r15Luftdruck -= Luftdruck / CalAthmospheare; // 163fc6: 80 90 12 01 lds r8, 0x01123fca: 90 90 13 01 lds r9, 0x01133fce: a0 90 14 01 lds r10, 0x01143fd2: b0 90 15 01 lds r11, 0x01153fd6: 60 91 12 01 lds r22, 0x01123fda: 70 91 13 01 lds r23, 0x01133fde: 80 91 14 01 lds r24, 0x01143fe2: 90 91 15 01 lds r25, 0x01153fe6: 20 91 0c 01 lds r18, 0x010C3fea: 30 e0 ldi r19, 0x00 ; 03fec: 40 e0 ldi r20, 0x00 ; 03fee: 50 e0 ldi r21, 0x00 ; 03ff0: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>3ff4: 82 1a sub r8, r183ff6: 93 0a sbc r9, r193ff8: a4 0a sbc r10, r203ffa: b5 0a sbc r11, r213ffc: 80 92 12 01 sts 0x0112, r84000: 90 92 13 01 sts 0x0113, r94004: a0 92 14 01 sts 0x0114, r104008: b0 92 15 01 sts 0x0115, r11Luftdruck += tmpLuftdruck;400c: 80 91 12 01 lds r24, 0x01124010: 90 91 13 01 lds r25, 0x01134014: a0 91 14 01 lds r26, 0x01144018: b0 91 15 01 lds r27, 0x0115401c: c8 0e add r12, r24401e: d9 1e adc r13, r254020: ea 1e adc r14, r264022: fb 1e adc r15, r274024: c0 92 12 01 sts 0x0112, r124028: d0 92 13 01 sts 0x0113, r13402c: e0 92 14 01 sts 0x0114, r144030: f0 92 15 01 sts 0x0115, r15HoehenWert_Mess = StartLuftdruck - Luftdruck; // cm4034: 80 91 08 05 lds r24, 0x05084038: 90 91 09 05 lds r25, 0x0509403c: a0 91 0a 05 lds r26, 0x050A4040: b0 91 0b 05 lds r27, 0x050B4044: 40 91 12 01 lds r20, 0x01124048: 50 91 13 01 lds r21, 0x0113404c: 60 91 14 01 lds r22, 0x01144050: 70 91 15 01 lds r23, 0x01154054: 84 1b sub r24, r204056: 95 0b sbc r25, r214058: a6 0b sbc r26, r22405a: b7 0b sbc r27, r23405c: 80 93 46 03 sts 0x0346, r244060: 90 93 47 03 sts 0x0347, r254064: a0 93 48 03 sts 0x0348, r264068: b0 93 49 03 sts 0x0349, r27406c: 4f c1 rjmp .+670 ; 0x430c <__stack+0x20d>}else#endif{ // old version (until FC V2.1)tmpLuftdruck += MessLuftdruck;406e: 20 91 10 01 lds r18, 0x01104072: 30 91 11 01 lds r19, 0x01114076: 80 91 2a 03 lds r24, 0x032A407a: 90 91 2b 03 lds r25, 0x032B407e: a0 91 2c 03 lds r26, 0x032C4082: b0 91 2d 03 lds r27, 0x032D4086: 82 0f add r24, r184088: 93 1f adc r25, r19408a: a1 1d adc r26, r1408c: b1 1d adc r27, r1408e: 80 93 2a 03 sts 0x032A, r244092: 90 93 2b 03 sts 0x032B, r254096: a0 93 2c 03 sts 0x032C, r26409a: b0 93 2d 03 sts 0x032D, r27if(++messanzahl_Druck >= 16) // war bis 0.86 "18"409e: 20 91 29 03 lds r18, 0x032940a2: 2f 5f subi r18, 0xFF ; 25540a4: 20 93 29 03 sts 0x0329, r1840a8: 20 31 cpi r18, 0x10 ; 1640aa: 08 f4 brcc .+2 ; 0x40ae <__vector_24+0x8a4>40ac: 2f c1 rjmp .+606 ; 0x430c <__stack+0x20d>{signed int tmp;// Luftdruck = (7 * Luftdruck + tmpLuftdruck - (16 * BaroStep) * (long)ExpandBaro + 4) / 8; // -523.19 counts per 10 counts offset step// ExpandBaroStep = (16 * BaroStep) * (long)ExpandBaro - 4; // wird in fc.c aufgerufenLuftdruck = (7 * Luftdruck + tmpLuftdruck - ExpandBaroStep) / 8; // -523.19 counts per 10 counts offset step40ae: 40 91 12 01 lds r20, 0x011240b2: 50 91 13 01 lds r21, 0x011340b6: 60 91 14 01 lds r22, 0x011440ba: 70 91 15 01 lds r23, 0x011540be: 6a 01 movw r12, r2040c0: 7b 01 movw r14, r2240c2: cc 0c add r12, r1240c4: dd 1c adc r13, r1340c6: ee 1c adc r14, r1440c8: ff 1c adc r15, r1540ca: cc 0c add r12, r1240cc: dd 1c adc r13, r1340ce: ee 1c adc r14, r1440d0: ff 1c adc r15, r1540d2: cc 0c add r12, r1240d4: dd 1c adc r13, r1340d6: ee 1c adc r14, r1440d8: ff 1c adc r15, r1540da: c4 1a sub r12, r2040dc: d5 0a sbc r13, r2140de: e6 0a sbc r14, r2240e0: f7 0a sbc r15, r2340e2: c8 0e add r12, r2440e4: d9 1e adc r13, r2540e6: ea 1e adc r14, r2640e8: fb 1e adc r15, r2740ea: 40 91 4e 03 lds r20, 0x034E40ee: 50 91 4f 03 lds r21, 0x034F40f2: 60 91 50 03 lds r22, 0x035040f6: 70 91 51 03 lds r23, 0x035140fa: c4 1a sub r12, r2040fc: d5 0a sbc r13, r2140fe: e6 0a sbc r14, r224100: f7 0a sbc r15, r234102: b7 01 movw r22, r144104: a6 01 movw r20, r124106: 22 f4 brpl .+8 ; 0x4110 <__stack+0x11>4108: 49 5f subi r20, 0xF9 ; 249410a: 5f 4f sbci r21, 0xFF ; 255410c: 6f 4f sbci r22, 0xFF ; 255410e: 7f 4f sbci r23, 0xFF ; 2554110: 68 94 set4112: 12 f8 bld r1, 24114: 75 95 asr r234116: 67 95 ror r224118: 57 95 ror r21411a: 47 95 ror r20411c: 16 94 lsr r1411e: d1 f7 brne .-12 ; 0x4114 <__stack+0x15>4120: 40 93 12 01 sts 0x0112, r204124: 50 93 13 01 sts 0x0113, r214128: 60 93 14 01 sts 0x0114, r22412c: 70 93 15 01 sts 0x0115, r23HoehenWert_Mess = StartLuftdruck - Luftdruck;4130: 40 91 08 05 lds r20, 0x05084134: 50 91 09 05 lds r21, 0x05094138: 60 91 0a 05 lds r22, 0x050A413c: 70 91 0b 05 lds r23, 0x050B4140: 00 91 12 01 lds r16, 0x01124144: 10 91 13 01 lds r17, 0x01134148: 20 91 14 01 lds r18, 0x0114414c: 30 91 15 01 lds r19, 0x01154150: 40 1b sub r20, r164152: 51 0b sbc r21, r174154: 62 0b sbc r22, r184156: 73 0b sbc r23, r194158: 40 93 46 03 sts 0x0346, r20415c: 50 93 47 03 sts 0x0347, r214160: 60 93 48 03 sts 0x0348, r224164: 70 93 49 03 sts 0x0349, r23SummenHoehe -= SummenHoehe/SM_FILTER;4168: 00 91 57 03 lds r16, 0x0357416c: 10 91 58 03 lds r17, 0x03584170: 20 91 59 03 lds r18, 0x03594174: 30 91 5a 03 lds r19, 0x035A4178: c0 90 57 03 lds r12, 0x0357417c: d0 90 58 03 lds r13, 0x03584180: e0 90 59 03 lds r14, 0x03594184: f0 90 5a 03 lds r15, 0x035A4188: ff 20 and r15, r15418a: 2c f4 brge .+10 ; 0x4196 <__stack+0x97>418c: ef e0 ldi r30, 0x0F ; 15418e: ce 0e add r12, r304190: d1 1c adc r13, r14192: e1 1c adc r14, r14194: f1 1c adc r15, r14196: 46 01 movw r8, r124198: 57 01 movw r10, r14419a: 68 94 set419c: 13 f8 bld r1, 3419e: b5 94 asr r1141a0: a7 94 ror r1041a2: 97 94 ror r941a4: 87 94 ror r841a6: 16 94 lsr r141a8: d1 f7 brne .-12 ; 0x419e <__stack+0x9f>41aa: 68 01 movw r12, r1641ac: 79 01 movw r14, r1841ae: c8 18 sub r12, r841b0: d9 08 sbc r13, r941b2: ea 08 sbc r14, r1041b4: fb 08 sbc r15, r1141b6: c0 92 57 03 sts 0x0357, r1241ba: d0 92 58 03 sts 0x0358, r1341be: e0 92 59 03 sts 0x0359, r1441c2: f0 92 5a 03 sts 0x035A, r15SummenHoehe += HoehenWert_Mess;41c6: c0 90 57 03 lds r12, 0x035741ca: d0 90 58 03 lds r13, 0x035841ce: e0 90 59 03 lds r14, 0x035941d2: f0 90 5a 03 lds r15, 0x035A41d6: c4 0e add r12, r2041d8: d5 1e adc r13, r2141da: e6 1e adc r14, r2241dc: f7 1e adc r15, r2341de: c0 92 57 03 sts 0x0357, r1241e2: d0 92 58 03 sts 0x0358, r1341e6: e0 92 59 03 sts 0x0359, r1441ea: f0 92 5a 03 sts 0x035A, r15tmp = (HoehenWert_Mess - SummenHoehe/SM_FILTER);41ee: c0 90 57 03 lds r12, 0x035741f2: d0 90 58 03 lds r13, 0x035841f6: e0 90 59 03 lds r14, 0x035941fa: f0 90 5a 03 lds r15, 0x035A41fe: ff 20 and r15, r154200: 2c f4 brge .+10 ; 0x420c <__stack+0x10d>4202: 2f e0 ldi r18, 0x0F ; 154204: c2 0e add r12, r184206: d1 1c adc r13, r14208: e1 1c adc r14, r1420a: f1 1c adc r15, r1420c: 68 94 set420e: 13 f8 bld r1, 34210: f5 94 asr r154212: e7 94 ror r144214: d7 94 ror r134216: c7 94 ror r124218: 16 94 lsr r1421a: d1 f7 brne .-12 ; 0x4210 <__stack+0x111>421c: 4c 19 sub r20, r12421e: 5d 09 sbc r21, r134220: 41 15 cp r20, r14222: 6c ef ldi r22, 0xFC ; 2524224: 56 07 cpc r21, r224226: 14 f4 brge .+4 ; 0x422c <__stack+0x12d>4228: 40 e0 ldi r20, 0x00 ; 0422a: 5c ef ldi r21, 0xFC ; 252422c: 41 30 cpi r20, 0x01 ; 1422e: e4 e0 ldi r30, 0x04 ; 44230: 5e 07 cpc r21, r304232: 14 f0 brlt .+4 ; 0x4238 <__stack+0x139>4234: 40 e0 ldi r20, 0x00 ; 04236: 54 e0 ldi r21, 0x04 ; 4if(tmp > 1024) tmp = 1024; else if(tmp < -1024) tmp = -1024;if(abs(VarioMeter) > 700) VarioMeter = (15 * VarioMeter + 8 * tmp)/16;4238: 20 91 54 03 lds r18, 0x0354423c: 30 91 55 03 lds r19, 0x03554240: 33 23 and r19, r194242: 1c f4 brge .+6 ; 0x424a <__stack+0x14b>4244: 31 95 neg r194246: 21 95 neg r184248: 31 09 sbc r19, r1424a: 2d 3b cpi r18, 0xBD ; 189424c: 32 40 sbci r19, 0x02 ; 2424e: 1c f1 brlt .+70 ; 0x4296 <__stack+0x197>4250: 60 91 54 03 lds r22, 0x03544254: 70 91 55 03 lds r23, 0x03554258: ef e0 ldi r30, 0x0F ; 15425a: e6 9f mul r30, r22425c: 90 01 movw r18, r0425e: e7 9f mul r30, r234260: 30 0d add r19, r04262: 11 24 eor r1, r14264: 44 0f add r20, r204266: 55 1f adc r21, r214268: 44 0f add r20, r20426a: 55 1f adc r21, r21426c: 44 0f add r20, r20426e: 55 1f adc r21, r214270: 42 0f add r20, r184272: 53 1f adc r21, r194274: 55 23 and r21, r214276: 14 f4 brge .+4 ; 0x427c <__stack+0x17d>4278: 41 5f subi r20, 0xF1 ; 241427a: 5f 4f sbci r21, 0xFF ; 255427c: 55 95 asr r21427e: 47 95 ror r204280: 55 95 asr r214282: 47 95 ror r204284: 55 95 asr r214286: 47 95 ror r204288: 55 95 asr r21428a: 47 95 ror r20428c: 50 93 55 03 sts 0x0355, r214290: 40 93 54 03 sts 0x0354, r204294: 24 c0 rjmp .+72 ; 0x42de <__stack+0x1df>else VarioMeter = (31 * VarioMeter + 8 * tmp)/32;4296: 60 91 54 03 lds r22, 0x0354429a: 70 91 55 03 lds r23, 0x0355429e: ef e1 ldi r30, 0x1F ; 3142a0: e6 9f mul r30, r2242a2: 90 01 movw r18, r042a4: e7 9f mul r30, r2342a6: 30 0d add r19, r042a8: 11 24 eor r1, r142aa: 44 0f add r20, r2042ac: 55 1f adc r21, r2142ae: 44 0f add r20, r2042b0: 55 1f adc r21, r2142b2: 44 0f add r20, r2042b4: 55 1f adc r21, r2142b6: 42 0f add r20, r1842b8: 53 1f adc r21, r1942ba: 55 23 and r21, r2142bc: 14 f4 brge .+4 ; 0x42c2 <__stack+0x1c3>42be: 41 5e subi r20, 0xE1 ; 22542c0: 5f 4f sbci r21, 0xFF ; 25542c2: 55 95 asr r2142c4: 47 95 ror r2042c6: 55 95 asr r2142c8: 47 95 ror r2042ca: 55 95 asr r2142cc: 47 95 ror r2042ce: 55 95 asr r2142d0: 47 95 ror r2042d2: 55 95 asr r2142d4: 47 95 ror r2042d6: 50 93 55 03 sts 0x0355, r2142da: 40 93 54 03 sts 0x0354, r20tmpLuftdruck /= 2;42de: ac 01 movw r20, r2442e0: bd 01 movw r22, r2642e2: bb 23 and r27, r2742e4: 24 f4 brge .+8 ; 0x42ee <__stack+0x1ef>42e6: 4f 5f subi r20, 0xFF ; 25542e8: 5f 4f sbci r21, 0xFF ; 25542ea: 6f 4f sbci r22, 0xFF ; 25542ec: 7f 4f sbci r23, 0xFF ; 25542ee: 75 95 asr r2342f0: 67 95 ror r2242f2: 57 95 ror r2142f4: 47 95 ror r2042f6: 40 93 2a 03 sts 0x032A, r2042fa: 50 93 2b 03 sts 0x032B, r2142fe: 60 93 2c 03 sts 0x032C, r224302: 70 93 2d 03 sts 0x032D, r23messanzahl_Druck = 16/2;4306: 88 e0 ldi r24, 0x08 ; 84308: 80 93 29 03 sts 0x0329, r24}}kanal = AD_NICK;430c: 82 e0 ldi r24, 0x02 ; 2430e: 80 93 3e 03 sts 0x033E, r24break;4312: 05 c0 rjmp .+10 ; 0x431e <__stack+0x21f>default:kanal = 0; state = 0; kanal = AD_NICK;4314: 10 92 41 03 sts 0x0341, r14318: 82 e0 ldi r24, 0x02 ; 2431a: 80 93 3e 03 sts 0x033E, r24break;}ADMUX = kanal;431e: 80 91 3e 03 lds r24, 0x033E4322: 80 93 7c 00 sts 0x007C, r24if(state != 0) ANALOG_ON;4326: 80 91 41 03 lds r24, 0x0341432a: 88 23 and r24, r24432c: 19 f0 breq .+6 ; 0x4334 <__stack+0x235>432e: 8f ec ldi r24, 0xCF ; 2074330: 80 93 7a 00 sts 0x007A, r24}4334: ff 91 pop r314336: ef 91 pop r304338: bf 91 pop r27433a: af 91 pop r26433c: 9f 91 pop r25433e: 8f 91 pop r244340: 7f 91 pop r234342: 6f 91 pop r224344: 5f 91 pop r214346: 4f 91 pop r204348: 3f 91 pop r19434a: 2f 91 pop r18434c: 1f 91 pop r17434e: 0f 91 pop r164350: ff 90 pop r154352: ef 90 pop r144354: df 90 pop r134356: cf 90 pop r124358: bf 90 pop r11435a: af 90 pop r10435c: 9f 90 pop r9435e: 8f 90 pop r84360: 0f 90 pop r04362: 0b be out 0x3b, r0 ; 594364: 0f 90 pop r04366: 0f be out 0x3f, r0 ; 634368: 0f 90 pop r0436a: 1f 90 pop r1436c: 18 95 reti0000436e <Capacity_Init>:Capacity_t Capacity;// initialize capacity calculationvoid Capacity_Init(void){Capacity.ActualCurrent = 0;436e: 10 92 16 05 sts 0x0516, r14372: 10 92 15 05 sts 0x0515, r1Capacity.UsedCapacity = 0;4376: 10 92 1a 05 sts 0x051A, r1437a: 10 92 19 05 sts 0x0519, r1Capacity.ActualPower = 0;437e: 10 92 18 05 sts 0x0518, r14382: 10 92 17 05 sts 0x0517, r1Capacity.MinOfMaxPWM = 0;4386: 10 92 1b 05 sts 0x051B, r1update_timer = SetDelay(CAPACITY_UPDATE_INTERVAL);438a: 82 e3 ldi r24, 0x32 ; 50438c: 90 e0 ldi r25, 0x00 ; 0438e: 0e 94 5a 9c call 0x138b4 ; 0x138b4 <SetDelay>4392: 90 93 74 03 sts 0x0374, r254396: 80 93 73 03 sts 0x0373, r24439a: 08 95 ret0000439c <BL3_Current>:// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++// + extended Current measurement -> 200 = 20A 201 = 21A 255 = 75A (20+55)// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++unsigned int BL3_Current(unsigned char who) // in 0,1A{if(Motor[who].Current == 255) return(0); // invalid439c: 28 2f mov r18, r24439e: 30 e0 ldi r19, 0x00 ; 043a0: 9f e0 ldi r25, 0x0F ; 1543a2: 89 9f mul r24, r2543a4: f0 01 movw r30, r043a6: 11 24 eor r1, r143a8: e9 56 subi r30, 0x69 ; 10543aa: f6 4f sbci r31, 0xF6 ; 24643ac: 85 81 ldd r24, Z+5 ; 0x0543ae: 8f 3f cpi r24, 0xFF ; 25543b0: 09 f1 breq .+66 ; 0x43f4 <BL3_Current+0x58>if(Motor[who].Current <= 200) return(Motor[who].Current);43b2: 89 3c cpi r24, 0xC9 ; 20143b4: 10 f4 brcc .+4 ; 0x43ba <BL3_Current+0x1e>43b6: 90 e0 ldi r25, 0x00 ; 043b8: 08 95 retelse{if(Motor[who].Version & MOTOR_STATE_BL30) return(200 + 10 * ((unsigned int)Motor[who].Current-200));43ba: 9f e0 ldi r25, 0x0F ; 1543bc: 92 9f mul r25, r1843be: f0 01 movw r30, r043c0: 93 9f mul r25, r1943c2: f0 0d add r31, r043c4: 11 24 eor r1, r143c6: e9 56 subi r30, 0x69 ; 10543c8: f6 4f sbci r31, 0xF6 ; 24643ca: 90 81 ld r25, Z43cc: 92 ff sbrs r25, 243ce: 10 c0 rjmp .+32 ; 0x43f0 <BL3_Current+0x54>43d0: 28 2f mov r18, r2443d2: 30 e0 ldi r19, 0x00 ; 043d4: c9 01 movw r24, r1843d6: 88 0f add r24, r2443d8: 99 1f adc r25, r2543da: 22 0f add r18, r1843dc: 33 1f adc r19, r1943de: 22 0f add r18, r1843e0: 33 1f adc r19, r1943e2: 22 0f add r18, r1843e4: 33 1f adc r19, r1943e6: 82 0f add r24, r1843e8: 93 1f adc r25, r1943ea: 88 50 subi r24, 0x08 ; 843ec: 97 40 sbci r25, 0x07 ; 743ee: 08 95 retelse return(Motor[who].Current);43f0: 90 e0 ldi r25, 0x00 ; 043f2: 08 95 ret// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++// + extended Current measurement -> 200 = 20A 201 = 21A 255 = 75A (20+55)// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++unsigned int BL3_Current(unsigned char who) // in 0,1A{if(Motor[who].Current == 255) return(0); // invalid43f4: 80 e0 ldi r24, 0x00 ; 043f6: 90 e0 ldi r25, 0x00 ; 0else{if(Motor[who].Version & MOTOR_STATE_BL30) return(200 + 10 * ((unsigned int)Motor[who].Current-200));else return(Motor[who].Current);}}43f8: 08 95 ret000043fa <Capacity_Update>:// called in main loop at a regular intervalvoid Capacity_Update(void){43fa: 9f 92 push r943fc: af 92 push r1043fe: bf 92 push r114400: cf 92 push r124402: df 92 push r134404: ef 92 push r144406: ff 92 push r154408: 0f 93 push r16440a: 1f 93 push r17440c: cf 93 push r28440e: df 93 push r29static unsigned short SubCounter = 0;static unsigned short CurrentOffset = 0;static unsigned long SumCurrentOffset = 0;unsigned char i, NumOfMotors, MinOfMaxPWM;if(CheckDelay(update_timer))4410: 80 91 73 03 lds r24, 0x03734414: 90 91 74 03 lds r25, 0x03744418: 0e 94 63 9c call 0x138c6 ; 0x138c6 <CheckDelay>441c: 88 23 and r24, r24441e: 09 f4 brne .+2 ; 0x4422 <Capacity_Update+0x28>4420: fb c0 rjmp .+502 ; 0x4618 <Capacity_Update+0x21e>{update_timer += CAPACITY_UPDATE_INTERVAL; // do not use SetDelay to avoid timing leaks4422: 80 91 73 03 lds r24, 0x03734426: 90 91 74 03 lds r25, 0x0374442a: c2 96 adiw r24, 0x32 ; 50442c: 90 93 74 03 sts 0x0374, r254430: 80 93 73 03 sts 0x0373, r24// determine sum of all present BL currents and setpointsCurrent = 0;SetSum = 0;NumOfMotors = 0;MinOfMaxPWM = 255;if(Capacity.MinOfMaxPWM == 254) FC_StatusFlags3 |= FC_STATUS3_REDUNDANCE;4434: 80 91 1b 05 lds r24, 0x051B4438: 8e 3f cpi r24, 0xFE ; 254443a: 31 f4 brne .+12 ; 0x4448 <Capacity_Update+0x4e>443c: 80 91 c9 03 lds r24, 0x03C94440: 81 60 ori r24, 0x01 ; 14442: 80 93 c9 03 sts 0x03C9, r244446: dd c0 rjmp .+442 ; 0x4602 <Capacity_Update+0x208>else if(Capacity.MinOfMaxPWM == 255) FC_StatusFlags3 &= ~FC_STATUS3_REDUNDANCE;4448: 8f 3f cpi r24, 0xFF ; 255444a: 09 f0 breq .+2 ; 0x444e <Capacity_Update+0x54>444c: da c0 rjmp .+436 ; 0x4602 <Capacity_Update+0x208>444e: 80 91 c9 03 lds r24, 0x03C94452: 8e 7f andi r24, 0xFE ; 2544454: 80 93 c9 03 sts 0x03C9, r244458: d4 c0 rjmp .+424 ; 0x4602 <Capacity_Update+0x208>445a: 78 01 movw r14, r16445c: f8 01 movw r30, r16445e: 33 97 sbiw r30, 0x03 ; 3for(i = 0; i < MAX_MOTORS; i++){if(Motor[i].State & MOTOR_STATE_PRESENT_MASK/* && Mixer.Motor[i][MIX_GAS]*/)4460: 80 81 ld r24, Z4462: 88 23 and r24, r244464: e4 f4 brge .+56 ; 0x449e <Capacity_Update+0xa4>{NumOfMotors++;4466: b3 94 inc r114468: 32 96 adiw r30, 0x02 ; 2if(Motor[i].Current > 200)446a: 80 81 ld r24, Z446c: 89 3c cpi r24, 0xC9 ; 201446e: 28 f0 brcs .+10 ; 0x447a <Capacity_Update+0x80>{Current += BL3_Current(i); // extended Current measurement -> 200 = 20A 201 = 21A 255 = 75A (20+55)4470: 8a 2d mov r24, r104472: 94 df rcall .-216 ; 0x439c <BL3_Current>4474: c8 0f add r28, r244476: d9 1f adc r29, r254478: 02 c0 rjmp .+4 ; 0x447e <Capacity_Update+0x84>}else Current += (unsigned int)(Motor[i].Current);447a: c8 0f add r28, r24447c: d1 1d adc r29, r1447e: f7 01 movw r30, r144480: 35 97 sbiw r30, 0x05 ; 5SetSum += (unsigned int)(Motor[i].SetPoint);4482: 80 81 ld r24, Z4484: c8 0e add r12, r244486: d1 1c adc r13, r1if(Motor[i].MaxPWM <= MinOfMaxPWM) MinOfMaxPWM = Motor[i].MaxPWM; else FC_StatusFlags3 &= ~FC_STATUS3_REDUNDANCE;4488: f7 01 movw r30, r14448a: 80 81 ld r24, Z448c: 98 16 cp r9, r24448e: 30 f4 brcc .+12 ; 0x449c <Capacity_Update+0xa2>4490: 80 91 c9 03 lds r24, 0x03C94494: 8e 7f andi r24, 0xFE ; 2544496: 80 93 c9 03 sts 0x03C9, r24449a: 01 c0 rjmp .+2 ; 0x449e <Capacity_Update+0xa4>449c: 98 2e mov r9, r24NumOfMotors = 0;MinOfMaxPWM = 255;if(Capacity.MinOfMaxPWM == 254) FC_StatusFlags3 |= FC_STATUS3_REDUNDANCE;else if(Capacity.MinOfMaxPWM == 255) FC_StatusFlags3 &= ~FC_STATUS3_REDUNDANCE;for(i = 0; i < MAX_MOTORS; i++)449e: a3 94 inc r1044a0: 01 5f subi r16, 0xF1 ; 24144a2: 1f 4f sbci r17, 0xFF ; 25544a4: fc e0 ldi r31, 0x0C ; 1244a6: af 12 cpse r10, r3144a8: d8 cf rjmp .-80 ; 0x445a <Capacity_Update+0x60>else Current += (unsigned int)(Motor[i].Current);SetSum += (unsigned int)(Motor[i].SetPoint);if(Motor[i].MaxPWM <= MinOfMaxPWM) MinOfMaxPWM = Motor[i].MaxPWM; else FC_StatusFlags3 &= ~FC_STATUS3_REDUNDANCE;}}Capacity.MinOfMaxPWM = MinOfMaxPWM;44aa: 90 92 1b 05 sts 0x051B, r9if(SetSum == 0) // if all setpoints are 044ae: cd 28 or r12, r1344b0: 59 f5 brne .+86 ; 0x4508 <Capacity_Update+0x10e>{ // determine offsets of motor currents#define CURRENT_AVERAGE 8 // 8bit = 256 * 10 ms = 2.56s average timeCurrentOffset = (unsigned int)(SumCurrentOffset>>CURRENT_AVERAGE);44b2: 40 91 6f 03 lds r20, 0x036F44b6: 50 91 70 03 lds r21, 0x037044ba: 60 91 71 03 lds r22, 0x037144be: 70 91 72 03 lds r23, 0x037244c2: 05 2f mov r16, r2144c4: 16 2f mov r17, r2244c6: 27 2f mov r18, r2344c8: 33 27 eor r19, r1944ca: 10 93 6e 03 sts 0x036E, r1744ce: 00 93 6d 03 sts 0x036D, r16SumCurrentOffset -= CurrentOffset;44d2: 22 27 eor r18, r1844d4: 33 27 eor r19, r1944d6: 40 1b sub r20, r1644d8: 51 0b sbc r21, r1744da: 62 0b sbc r22, r1844dc: 73 0b sbc r23, r19SumCurrentOffset += Current;44de: 4c 0f add r20, r2844e0: 5d 1f adc r21, r2944e2: 61 1d adc r22, r144e4: 71 1d adc r23, r144e6: 40 93 6f 03 sts 0x036F, r2044ea: 50 93 70 03 sts 0x0370, r2144ee: 60 93 71 03 sts 0x0371, r2244f2: 70 93 72 03 sts 0x0372, r23// add the FC and BL OffsetsCurrent += FC_OFFSET_CURRENT + NumOfMotors * BL_OFFSET_CURRENT;}// update actual CurrentCapacity.ActualCurrent = Current;44f6: 85 e0 ldi r24, 0x05 ; 544f8: 90 e0 ldi r25, 0x00 ; 044fa: 90 93 16 05 sts 0x0516, r2544fe: 80 93 15 05 sts 0x0515, r24#define CURRENT_AVERAGE 8 // 8bit = 256 * 10 ms = 2.56s average timeCurrentOffset = (unsigned int)(SumCurrentOffset>>CURRENT_AVERAGE);SumCurrentOffset -= CurrentOffset;SumCurrentOffset += Current;// after averaging set current to static offsetCurrent = FC_OFFSET_CURRENT;4502: c5 e0 ldi r28, 0x05 ; 54504: d0 e0 ldi r29, 0x00 ; 04506: 1c c0 rjmp .+56 ; 0x4540 <Capacity_Update+0x146>}else // some motors are running, includes also motor test condition, where "MotorRunning" is false{ // subtract offsetif(Current > CurrentOffset) Current -= CurrentOffset;4508: 80 91 6d 03 lds r24, 0x036D450c: 90 91 6e 03 lds r25, 0x036E4510: 8c 17 cp r24, r284512: 9d 07 cpc r25, r294514: 28 f4 brcc .+10 ; 0x4520 <Capacity_Update+0x126>4516: 9e 01 movw r18, r284518: 28 1b sub r18, r24451a: 39 0b sbc r19, r25451c: c9 01 movw r24, r18451e: 02 c0 rjmp .+4 ; 0x4524 <Capacity_Update+0x12a>else Current = 0;4520: 80 e0 ldi r24, 0x00 ; 04522: 90 e0 ldi r25, 0x00 ; 0// add the FC and BL OffsetsCurrent += FC_OFFSET_CURRENT + NumOfMotors * BL_OFFSET_CURRENT;4524: cb 2d mov r28, r114526: d0 e0 ldi r29, 0x00 ; 04528: cc 0f add r28, r28452a: dd 1f adc r29, r29452c: 25 96 adiw r28, 0x05 ; 5452e: c8 0f add r28, r244530: d9 1f adc r29, r25}// update actual CurrentCapacity.ActualCurrent = Current;4532: d0 93 16 05 sts 0x0516, r294536: c0 93 15 05 sts 0x0515, r28// update actual Powerif(Current < 255) Capacity.ActualPower = (UBat * Current) / 100; // in W higher resolution453a: cf 3f cpi r28, 0xFF ; 255453c: d1 05 cpc r29, r1453e: d0 f4 brcc .+52 ; 0x4574 <Capacity_Update+0x17a>4540: 80 91 1a 01 lds r24, 0x011A4544: 90 91 1b 01 lds r25, 0x011B4548: c8 9f mul r28, r24454a: 90 01 movw r18, r0454c: c9 9f mul r28, r25454e: 30 0d add r19, r04550: d8 9f mul r29, r244552: 30 0d add r19, r04554: 11 24 eor r1, r14556: 36 95 lsr r194558: 27 95 ror r18455a: 36 95 lsr r19455c: 27 95 ror r18455e: ab e7 ldi r26, 0x7B ; 1234560: b4 e1 ldi r27, 0x14 ; 204562: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>4566: 96 95 lsr r254568: 87 95 ror r24456a: 90 93 18 05 sts 0x0518, r25456e: 80 93 17 05 sts 0x0517, r244572: 25 c0 rjmp .+74 ; 0x45be <Capacity_Update+0x1c4>else Capacity.ActualPower = (UBat * (Current/4)) / 25; // in W4574: 80 91 1a 01 lds r24, 0x011A4578: 90 91 1b 01 lds r25, 0x011B457c: 9e 01 movw r18, r28457e: 36 95 lsr r194580: 27 95 ror r184582: 36 95 lsr r194584: 27 95 ror r184586: 28 9f mul r18, r244588: a0 01 movw r20, r0458a: 29 9f mul r18, r25458c: 50 0d add r21, r0458e: 38 9f mul r19, r244590: 50 0d add r21, r04592: 11 24 eor r1, r14594: 9a 01 movw r18, r204596: af ea ldi r26, 0xAF ; 1754598: b7 e4 ldi r27, 0x47 ; 71459a: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>459e: 48 1b sub r20, r2445a0: 59 0b sbc r21, r2545a2: 56 95 lsr r2145a4: 47 95 ror r2045a6: 84 0f add r24, r2045a8: 95 1f adc r25, r2145aa: 92 95 swap r2545ac: 82 95 swap r2445ae: 8f 70 andi r24, 0x0F ; 1545b0: 89 27 eor r24, r2545b2: 9f 70 andi r25, 0x0F ; 1545b4: 89 27 eor r24, r2545b6: 90 93 18 05 sts 0x0518, r2545ba: 80 93 17 05 sts 0x0517, r24// update used capacitySubCounter += Current;45be: 80 91 6b 03 lds r24, 0x036B45c2: 90 91 6c 03 lds r25, 0x036C45c6: c8 0f add r28, r2445c8: d9 1f adc r29, r2545ca: d0 93 6c 03 sts 0x036C, r2945ce: c0 93 6b 03 sts 0x036B, r28// 100mA * 1ms * CAPACITY_UPDATE_INTERVAL = 1 mA * 100 ms * CAPACITY_UPDATE_INTERVAL// = 1mA * 0.1s * CAPACITY_UPDATE_INTERVAL = 1mA * 1min / (600 / CAPACITY_UPDATE_INTERVAL)// = 1mAh / (36000 / CAPACITY_UPDATE_INTERVAL)#define SUB_COUNTER_LIMIT (36000 / CAPACITY_UPDATE_INTERVAL)while(SubCounter > SUB_COUNTER_LIMIT)45d2: c1 3d cpi r28, 0xD1 ; 20945d4: 32 e0 ldi r19, 0x02 ; 245d6: d3 07 cpc r29, r1945d8: f8 f0 brcs .+62 ; 0x4618 <Capacity_Update+0x21e>45da: 80 91 19 05 lds r24, 0x051945de: 90 91 1a 05 lds r25, 0x051A{Capacity.UsedCapacity++; // we have one mAh more45e2: 01 96 adiw r24, 0x01 ; 1SubCounter -= SUB_COUNTER_LIMIT; // keep the remaining sub part45e4: c0 5d subi r28, 0xD0 ; 20845e6: d2 40 sbci r29, 0x02 ; 2// 100mA * 1ms * CAPACITY_UPDATE_INTERVAL = 1 mA * 100 ms * CAPACITY_UPDATE_INTERVAL// = 1mA * 0.1s * CAPACITY_UPDATE_INTERVAL = 1mA * 1min / (600 / CAPACITY_UPDATE_INTERVAL)// = 1mAh / (36000 / CAPACITY_UPDATE_INTERVAL)#define SUB_COUNTER_LIMIT (36000 / CAPACITY_UPDATE_INTERVAL)while(SubCounter > SUB_COUNTER_LIMIT)45e8: c1 3d cpi r28, 0xD1 ; 20945ea: e2 e0 ldi r30, 0x02 ; 245ec: de 07 cpc r29, r3045ee: c8 f7 brcc .-14 ; 0x45e2 <Capacity_Update+0x1e8>45f0: 90 93 1a 05 sts 0x051A, r2545f4: 80 93 19 05 sts 0x0519, r2445f8: d0 93 6c 03 sts 0x036C, r2945fc: c0 93 6b 03 sts 0x036B, r284600: 0b c0 rjmp .+22 ; 0x4618 <Capacity_Update+0x21e>4602: 0d e9 ldi r16, 0x9D ; 1574604: 19 e0 ldi r17, 0x09 ; 9}}// called in main loop at a regular intervalvoid Capacity_Update(void){4606: 99 24 eor r9, r94608: 9a 94 dec r9460a: b1 2c mov r11, r1460c: a1 2c mov r10, r1460e: c1 2c mov r12, r14610: d1 2c mov r13, r14612: c0 e0 ldi r28, 0x00 ; 04614: d0 e0 ldi r29, 0x00 ; 04616: 21 cf rjmp .-446 ; 0x445a <Capacity_Update+0x60>{Capacity.UsedCapacity++; // we have one mAh moreSubCounter -= SUB_COUNTER_LIMIT; // keep the remaining sub part}} // EOF check delay update timer}4618: df 91 pop r29461a: cf 91 pop r28461c: 1f 91 pop r17461e: 0f 91 pop r164620: ff 90 pop r154622: ef 90 pop r144624: df 90 pop r134626: cf 90 pop r124628: bf 90 pop r11462a: af 90 pop r10462c: 9f 90 pop r9462e: 08 95 ret00004630 <Debug_Putchar>:unsigned char SendDebugOutput = 0;// function called from _printf_P to output charactervoid Debug_Putchar(char c){if (!SendDebugOutput)4630: 90 91 76 03 lds r25, 0x03764634: 91 11 cpse r25, r14636: 0f c0 rjmp .+30 ; 0x4656 <Debug_Putchar+0x26>{tDebug.Text[Debug_BufPtr++] = c; // copy character to buffer4638: e0 91 75 03 lds r30, 0x0375463c: 91 e0 ldi r25, 0x01 ; 1463e: 9e 0f add r25, r304640: 90 93 75 03 sts 0x0375, r254644: f0 e0 ldi r31, 0x00 ; 04646: e4 5e subi r30, 0xE4 ; 2284648: fa 4f sbci r31, 0xFA ; 250464a: 81 83 std Z+1, r24 ; 0x01if (Debug_BufPtr > 30) Debug_BufPtr = 30; // avoid buffer overflow464c: 9f 31 cpi r25, 0x1F ; 31464e: 18 f0 brcs .+6 ; 0x4656 <Debug_Putchar+0x26>4650: 8e e1 ldi r24, 0x1E ; 304652: 80 93 75 03 sts 0x0375, r244656: 08 95 ret00004658 <DebugSend>:}}void DebugSend(unsigned char cmd){if (!SendDebugOutput)4658: 90 91 76 03 lds r25, 0x0376465c: 91 11 cpse r25, r1465e: 0d c0 rjmp .+26 ; 0x467a <DebugSend+0x22>{tDebug.Cmd = cmd;4660: 80 93 1c 05 sts 0x051C, r24tDebug.Text[Debug_BufPtr] = '\0'; // end of text marker4664: e0 91 75 03 lds r30, 0x03754668: f0 e0 ldi r31, 0x00 ; 0466a: e4 5e subi r30, 0xE4 ; 228466c: fa 4f sbci r31, 0xFA ; 250466e: 11 82 std Z+1, r1 ; 0x01Debug_BufPtr = 0; // set bufferindex to 04670: 10 92 75 03 sts 0x0375, r1SendDebugOutput = 1; // set flag to trasmit data the next time in serial transmit function4674: 81 e0 ldi r24, 0x01 ; 14676: 80 93 76 03 sts 0x0376, r24467a: 08 95 ret0000467c <RAM_Checksum>:uint8_t RAM_Checksum(uint8_t* pBuffer, uint16_t len){uint8_t crc = 0xAA;uint16_t i;for(i=0; i<len; i++)467c: 61 15 cp r22, r1467e: 71 05 cpc r23, r14680: 51 f0 breq .+20 ; 0x4696 <RAM_Checksum+0x1a>4682: fc 01 movw r30, r244684: 68 0f add r22, r244686: 79 1f adc r23, r25uint8_t RequiredMotors;uint8_t RAM_Checksum(uint8_t* pBuffer, uint16_t len){uint8_t crc = 0xAA;4688: 8a ea ldi r24, 0xAA ; 170uint16_t i;for(i=0; i<len; i++){crc += pBuffer[i];468a: 91 91 ld r25, Z+468c: 89 0f add r24, r25uint8_t RAM_Checksum(uint8_t* pBuffer, uint16_t len){uint8_t crc = 0xAA;uint16_t i;for(i=0; i<len; i++)468e: e6 17 cp r30, r224690: f7 07 cpc r31, r234692: d9 f7 brne .-10 ; 0x468a <RAM_Checksum+0xe>4694: 08 95 retuint8_t RequiredMotors;uint8_t RAM_Checksum(uint8_t* pBuffer, uint16_t len){uint8_t crc = 0xAA;4696: 8a ea ldi r24, 0xAA ; 170for(i=0; i<len; i++){crc += pBuffer[i];}return crc;}4698: 08 95 ret0000469a <EEProm_Checksum>:uint8_t EEProm_Checksum(uint16_t EEAddr, uint16_t len){469a: ff 92 push r15469c: 0f 93 push r16469e: 1f 93 push r1746a0: cf 93 push r2846a2: df 93 push r29uint8_t crc = 0xAA;uint16_t off;for(off=0; off<len; off++)46a4: 61 15 cp r22, r146a6: 71 05 cpc r23, r146a8: 89 f0 breq .+34 ; 0x46cc <EEProm_Checksum+0x32>46aa: 8b 01 movw r16, r2246ac: 08 0f add r16, r2446ae: 19 1f adc r17, r2546b0: ec 01 movw r28, r24return crc;}uint8_t EEProm_Checksum(uint16_t EEAddr, uint16_t len){uint8_t crc = 0xAA;46b2: 0f 2e mov r0, r3146b4: fa ea ldi r31, 0xAA ; 17046b6: ff 2e mov r15, r3146b8: f0 2d mov r31, r0uint16_t off;for(off=0; off<len; off++){crc += eeprom_read_byte((uint8_t*)(EEAddr + off));;46ba: ce 01 movw r24, r2846bc: 0e 94 3e b2 call 0x1647c ; 0x1647c <__eerd_byte_m1284>46c0: f8 0e add r15, r2446c2: 21 96 adiw r28, 0x01 ; 1uint8_t EEProm_Checksum(uint16_t EEAddr, uint16_t len){uint8_t crc = 0xAA;uint16_t off;for(off=0; off<len; off++)46c4: c0 17 cp r28, r1646c6: d1 07 cpc r29, r1746c8: c1 f7 brne .-16 ; 0x46ba <EEProm_Checksum+0x20>46ca: 04 c0 rjmp .+8 ; 0x46d4 <EEProm_Checksum+0x3a>return crc;}uint8_t EEProm_Checksum(uint16_t EEAddr, uint16_t len){uint8_t crc = 0xAA;46cc: 0f 2e mov r0, r3146ce: fa ea ldi r31, 0xAA ; 17046d0: ff 2e mov r15, r3146d2: f0 2d mov r31, r0for(off=0; off<len; off++){crc += eeprom_read_byte((uint8_t*)(EEAddr + off));;}return crc;}46d4: 8f 2d mov r24, r1546d6: df 91 pop r2946d8: cf 91 pop r2846da: 1f 91 pop r1746dc: 0f 91 pop r1646de: ff 90 pop r1546e0: 08 95 ret000046e2 <ParamSet_DefaultStickMapping>:void ParamSet_DefaultStickMapping(void){EE_Parameter.Kanalbelegung[K_GAS] = 1;46e2: 81 e0 ldi r24, 0x01 ; 146e4: 80 93 41 05 sts 0x0541, r24EE_Parameter.Kanalbelegung[K_ROLL] = 2;46e8: 82 e0 ldi r24, 0x02 ; 246ea: 80 93 40 05 sts 0x0540, r24EE_Parameter.Kanalbelegung[K_NICK] = 3;46ee: 83 e0 ldi r24, 0x03 ; 346f0: 80 93 3f 05 sts 0x053F, r24EE_Parameter.Kanalbelegung[K_GIER] = 4;46f4: 84 e0 ldi r24, 0x04 ; 446f6: 80 93 42 05 sts 0x0542, r24EE_Parameter.Kanalbelegung[K_POTI1] = 5;46fa: 85 e0 ldi r24, 0x05 ; 546fc: 80 93 43 05 sts 0x0543, r24EE_Parameter.Kanalbelegung[K_POTI2] = 6;4700: 86 e0 ldi r24, 0x06 ; 64702: 80 93 44 05 sts 0x0544, r24EE_Parameter.Kanalbelegung[K_POTI3] = 7;4706: 87 e0 ldi r24, 0x07 ; 74708: 80 93 45 05 sts 0x0545, r24EE_Parameter.Kanalbelegung[K_POTI4] = 8;470c: 88 e0 ldi r24, 0x08 ; 8470e: 80 93 46 05 sts 0x0546, r24EE_Parameter.Kanalbelegung[K_POTI5] = 9;4712: 89 e0 ldi r24, 0x09 ; 94714: 80 93 47 05 sts 0x0547, r24EE_Parameter.Kanalbelegung[K_POTI6] = 10;4718: 8a e0 ldi r24, 0x0A ; 10471a: 80 93 48 05 sts 0x0548, r24EE_Parameter.Kanalbelegung[K_POTI7] = 11;471e: 8b e0 ldi r24, 0x0B ; 114720: 80 93 49 05 sts 0x0549, r24EE_Parameter.Kanalbelegung[K_POTI8] = 12;4724: 8c e0 ldi r24, 0x0C ; 124726: 80 93 4a 05 sts 0x054A, r24472a: 08 95 ret0000472c <CommonDefaults>:/***************************************************//* Default Values for parameter set 1 *//***************************************************/void CommonDefaults(void){EE_Parameter.Revision = EEPARAM_REVISION;472c: 87 e6 ldi r24, 0x67 ; 103472e: 80 93 3e 05 sts 0x053E, r24memset(EE_Parameter.Name,0,12); // delete name4732: 8c e0 ldi r24, 0x0C ; 124734: ea eb ldi r30, 0xBA ; 1864736: f5 e0 ldi r31, 0x05 ; 54738: df 01 movw r26, r30473a: 1d 92 st X+, r1473c: 8a 95 dec r24473e: e9 f7 brne .-6 ; 0x473a <CommonDefaults+0xe>// if(PlatinenVersion >= 20){EE_Parameter.Gyro_D = 10;4740: 8a e0 ldi r24, 0x0A ; 104742: 80 93 5e 05 sts 0x055E, r24EE_Parameter.Driftkomp = 0;4746: 10 92 82 05 sts 0x0582, r1EE_Parameter.GyroAccFaktor = 27;474a: 8b e1 ldi r24, 0x1B ; 27474c: 80 93 5a 05 sts 0x055A, r24EE_Parameter.WinkelUmschlagNick = 78;4750: 8e e4 ldi r24, 0x4E ; 784752: 80 93 7f 05 sts 0x057F, r24EE_Parameter.WinkelUmschlagRoll = 78;4756: 80 93 80 05 sts 0x0580, r24EE_Parameter.GyroAccFaktor = 30;EE_Parameter.WinkelUmschlagNick = 85;EE_Parameter.WinkelUmschlagRoll = 85;}*/EE_Parameter.GyroAccAbgleich = 32; // 1/k475a: 80 e2 ldi r24, 0x20 ; 32475c: 80 93 81 05 sts 0x0581, r24EE_Parameter.BitConfig = 0; // Looping usw.4760: 10 92 b6 05 sts 0x05B6, r1EE_Parameter.GlobalConfig = CFG_ACHSENKOPPLUNG_AKTIV | CFG_KOMPASS_AKTIV | CFG_GPS_AKTIV | CFG_HOEHEN_SCHALTER;4764: 8a e6 ldi r24, 0x6A ; 1064766: 80 93 4b 05 sts 0x054B, r24EE_Parameter.ExtraConfig = CFG_GPS_AID | CFG2_VARIO_BEEP | CFG_LEARNABLE_CAREFREE | CFG_NO_RCOFF_BEEPING;476a: 82 e7 ldi r24, 0x72 ; 114476c: 80 93 b8 05 sts 0x05B8, r24EE_Parameter.GlobalConfig3 = CFG3_SPEAK_ALL | CFG3_NO_GPSFIX_NO_START;//4770: 80 e5 ldi r24, 0x50 ; 804772: 80 93 b9 05 sts 0x05B9, r24#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))EE_Parameter.Receiver = RECEIVER_HOTT;4776: 86 e0 ldi r24, 0x06 ; 64778: 80 93 65 05 sts 0x0565, r24#elseEE_Parameter.Receiver = RECEIVER_JETI;#endifEE_Parameter.MotorSafetySwitch = 0;477c: 10 92 a3 05 sts 0x05A3, r1EE_Parameter.ExternalControl = 0;4780: 10 92 a0 05 sts 0x05A0, r1EE_Parameter.Gas_Min = 8; // Wert : 0-324784: 88 e0 ldi r24, 0x08 ; 84786: 80 93 58 05 sts 0x0558, r24EE_Parameter.Gas_Max = 230; // Wert : 33-247478a: 86 ee ldi r24, 0xE6 ; 230478c: 80 93 59 05 sts 0x0559, r24EE_Parameter.KompassWirkung = 64; // Wert : 0-2474790: 80 e4 ldi r24, 0x40 ; 644792: 80 93 5b 05 sts 0x055B, r24EE_Parameter.HoeheChannel = 5; // Wert : 0-324796: 85 e0 ldi r24, 0x05 ; 54798: 80 93 4e 05 sts 0x054E, r24EE_Parameter.Hoehe_MinGas = 30;479c: 8e e1 ldi r24, 0x1E ; 30479e: 80 93 4c 05 sts 0x054C, r24EE_Parameter.Hoehe_TiltCompensation = 110; // in %47a2: 8e e6 ldi r24, 0x6E ; 11047a4: 80 93 53 05 sts 0x0553, r24#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))if(ACC_AltitudeControl)47a8: 80 91 c2 03 lds r24, 0x03C247ac: 88 23 and r24, r2447ae: 99 f0 breq .+38 ; 0x47d6 <CommonDefaults+0xaa>{EE_Parameter.Hoehe_P = 20; // Wert : 0-3247b0: 84 e1 ldi r24, 0x14 ; 2047b2: 80 93 4f 05 sts 0x054F, r24EE_Parameter.Luftdruck_D = 40; // Wert : 0-24747b6: 88 e2 ldi r24, 0x28 ; 4047b8: 80 93 4d 05 sts 0x054D, r24EE_Parameter.Hoehe_ACC_Wirkung = 30; // Wert : 0-24747bc: 8e e1 ldi r24, 0x1E ; 3047be: 80 93 51 05 sts 0x0551, r24EE_Parameter.Hoehe_HoverBand = 1; // Wert : 0-24747c2: 81 e0 ldi r24, 0x01 ; 147c4: 80 93 52 05 sts 0x0552, r24EE_Parameter.Hoehe_StickNeutralPoint = 127;// Wert : 0-247 (0 = Hover-Estimation)47c8: 8f e7 ldi r24, 0x7F ; 12747ca: 80 93 54 05 sts 0x0554, r24EE_Parameter.FailSafeTime = 60; // 0 = off47ce: 8c e3 ldi r24, 0x3C ; 6047d0: 80 93 a6 05 sts 0x05A6, r2447d4: 0f c0 rjmp .+30 ; 0x47f4 <CommonDefaults+0xc8>}else#endif{EE_Parameter.Hoehe_P = 15; // Wert : 0-3247d6: 8f e0 ldi r24, 0x0F ; 1547d8: 80 93 4f 05 sts 0x054F, r24EE_Parameter.Luftdruck_D = 30; // Wert : 0-24747dc: 8e e1 ldi r24, 0x1E ; 3047de: 80 93 4d 05 sts 0x054D, r24EE_Parameter.Hoehe_ACC_Wirkung = 0; // Wert : 0-24747e2: 10 92 51 05 sts 0x0551, r1EE_Parameter.Hoehe_HoverBand = 8; // Wert : 0-24747e6: 88 e0 ldi r24, 0x08 ; 847e8: 80 93 52 05 sts 0x0552, r24EE_Parameter.Hoehe_StickNeutralPoint = 0;// Wert : 0-247 (0 = Hover-Estimation)47ec: 10 92 54 05 sts 0x0554, r1EE_Parameter.FailSafeTime = 0; // 0 = off47f0: 10 92 a6 05 sts 0x05A6, r1}EE_Parameter.Hoehe_Verstaerkung = 15; // Wert : 0-50 (15 -> ca. +/- 5m/sek bei Stick-Voll-Ausschlag)47f4: 8f e0 ldi r24, 0x0F ; 1547f6: 80 93 50 05 sts 0x0550, r24EE_Parameter.StartLandChannel = 0;47fa: 10 92 af 05 sts 0x05AF, r1EE_Parameter.LandingSpeed = 12;47fe: 8c e0 ldi r24, 0x0C ; 124800: 80 93 b0 05 sts 0x05B0, r24EE_Parameter.UserParam1 = 0; // zur freien Verwendung4804: 10 92 67 05 sts 0x0567, r1EE_Parameter.UserParam2 = 0; // zur freien Verwendung4808: 10 92 68 05 sts 0x0568, r1EE_Parameter.UserParam3 = 0; // zur freien Verwendung480c: 10 92 69 05 sts 0x0569, r1EE_Parameter.UserParam4 = 0; // zur freien Verwendung4810: 10 92 6a 05 sts 0x056A, r1EE_Parameter.UserParam5 = 0; // zur freien Verwendung4814: 10 92 84 05 sts 0x0584, r1EE_Parameter.UserParam6 = 0; // zur freien Verwendung4818: 10 92 85 05 sts 0x0585, r1EE_Parameter.UserParam7 = 0; // zur freien Verwendung481c: 10 92 86 05 sts 0x0586, r1EE_Parameter.UserParam8 = 0; // zur freien Verwendung4820: 10 92 87 05 sts 0x0587, r1EE_Parameter.ServoNickControl = 128; // Wert : 0-247 // Stellung des Servos4824: 20 e8 ldi r18, 0x80 ; 1284826: 20 93 6b 05 sts 0x056B, r18EE_Parameter.ServoNickComp = 50; // Wert : 0-247 // Einfluss Gyro/Servo482a: 82 e3 ldi r24, 0x32 ; 50482c: 80 93 6c 05 sts 0x056C, r24EE_Parameter.ServoCompInvert = 2; // Wert : 0-247 // Richtung Einfluss Gyro/Servo4830: 52 e0 ldi r21, 0x02 ; 24832: 50 93 b7 05 sts 0x05B7, r21EE_Parameter.ServoNickMin = 24; // Wert : 0-247 // Anschlag4836: 98 e1 ldi r25, 0x18 ; 244838: 90 93 6d 05 sts 0x056D, r25EE_Parameter.ServoNickMax = 230; // Wert : 0-247 // Anschlag483c: 96 ee ldi r25, 0xE6 ; 230483e: 90 93 6e 05 sts 0x056E, r25EE_Parameter.ServoNickRefresh = 3;4842: 93 e0 ldi r25, 0x03 ; 34844: 90 93 73 05 sts 0x0573, r25EE_Parameter.Servo3 = 125;4848: 9d e7 ldi r25, 0x7D ; 125484a: 90 93 76 05 sts 0x0576, r25EE_Parameter.Servo4 = 125;484e: 90 93 77 05 sts 0x0577, r25EE_Parameter.Servo5 = 125;4852: 90 93 78 05 sts 0x0578, r25EE_Parameter.ServoRollControl = 128; // Wert : 0-247 // Stellung des Servos4856: 20 93 6f 05 sts 0x056F, r18EE_Parameter.ServoRollComp = 85; // Wert : 0-247 // Einfluss Gyro/Servo485a: 75 e5 ldi r23, 0x55 ; 85485c: 70 93 70 05 sts 0x0570, r23EE_Parameter.ServoRollMin = 70; // Wert : 0-247 // Anschlag4860: 26 e4 ldi r18, 0x46 ; 704862: 20 93 71 05 sts 0x0571, r18EE_Parameter.ServoRollMax = 220; // Wert : 0-247 // Anschlag4866: 3c ed ldi r19, 0xDC ; 2204868: 30 93 72 05 sts 0x0572, r19EE_Parameter.ServoManualControlSpeed = 60;486c: 3c e3 ldi r19, 0x3C ; 60486e: 30 93 74 05 sts 0x0574, r19EE_Parameter.CamOrientation = 0; // Wert : 0-24 -> 0-360 -> 15° steps4872: 10 92 75 05 sts 0x0575, r1EE_Parameter.J16Bitmask = 0xAA;4876: 3a ea ldi r19, 0xAA ; 1704878: 30 93 88 05 sts 0x0588, r19EE_Parameter.J17Bitmask = 0xCC;487c: 4c ec ldi r20, 0xCC ; 204487e: 40 93 8a 05 sts 0x058A, r20EE_Parameter.WARN_J16_Bitmask = 0x00;4882: 10 92 8c 05 sts 0x058C, r1EE_Parameter.WARN_J17_Bitmask = 0xAA;4886: 30 93 8d 05 sts 0x058D, r19EE_Parameter.J16Timing = 40;488a: 48 e2 ldi r20, 0x28 ; 40488c: 40 93 89 05 sts 0x0589, r20EE_Parameter.J17Timing = 40;4890: 40 93 8b 05 sts 0x058B, r20EE_Parameter.AutoPhotoDistance = 0; // Photo release in meter4894: 10 92 8e 05 sts 0x058E, r1EE_Parameter.AutoPhotoAtitudes = 0; // Photo release in meter4898: 10 92 b4 05 sts 0x05B4, r1EE_Parameter.SingleWpSpeed = 50; // Speed when flying the single points489c: 80 93 b5 05 sts 0x05B5, r24EE_Parameter.LoopGasLimit = 50;48a0: 80 93 79 05 sts 0x0579, r24EE_Parameter.LoopThreshold = 90; // Wert: 0-247 Schwelle für Stickausschlag48a4: 3a e5 ldi r19, 0x5A ; 9048a6: 30 93 7a 05 sts 0x057A, r19EE_Parameter.LoopHysterese = 50;48aa: 80 93 7b 05 sts 0x057B, r24EE_Parameter.NaviGpsModeChannel = 6; // Kanal 648ae: 66 e0 ldi r22, 0x06 ; 648b0: 60 93 8f 05 sts 0x058F, r22EE_Parameter.NaviGpsGain = 100;48b4: e4 e6 ldi r30, 0x64 ; 10048b6: e0 93 90 05 sts 0x0590, r30EE_Parameter.NaviGpsP = 100;48ba: e0 93 91 05 sts 0x0591, r30EE_Parameter.NaviGpsI = 90;48be: 30 93 92 05 sts 0x0592, r19EE_Parameter.NaviGpsD = 120;48c2: e8 e7 ldi r30, 0x78 ; 12048c4: e0 93 93 05 sts 0x0593, r30EE_Parameter.NaviGpsA = 40;48c8: 40 93 97 05 sts 0x0597, r20EE_Parameter.NaviGpsPLimit = 75;48cc: 4b e4 ldi r20, 0x4B ; 7548ce: 40 93 94 05 sts 0x0594, r20EE_Parameter.NaviGpsILimit = 85;48d2: 70 93 95 05 sts 0x0595, r23EE_Parameter.NaviGpsDLimit = 75;48d6: 40 93 96 05 sts 0x0596, r20EE_Parameter.NaviGpsMinSat = 6;48da: 60 93 98 05 sts 0x0598, r22EE_Parameter.NaviStickThreshold = 8;48de: 48 e0 ldi r20, 0x08 ; 848e0: 40 93 99 05 sts 0x0599, r20EE_Parameter.NaviWindCorrection = 50;48e4: 80 93 9a 05 sts 0x059A, r24EE_Parameter.NaviAccCompensation = 42;48e8: 8a e2 ldi r24, 0x2A ; 4248ea: 80 93 9b 05 sts 0x059B, r24EE_Parameter.NaviMaxFlyingRange = 0;48ee: 10 92 9c 05 sts 0x059C, r1EE_Parameter.NaviDescendRange = 0;48f2: 10 92 9f 05 sts 0x059F, r1EE_Parameter.NaviAngleLimitation = 140;48f6: 8c e8 ldi r24, 0x8C ; 14048f8: 80 93 9d 05 sts 0x059D, r24EE_Parameter.NaviPH_LoginTime = 2;48fc: 50 93 9e 05 sts 0x059E, r21EE_Parameter.OrientationAngle = 0;4900: 10 92 a1 05 sts 0x05A1, r1EE_Parameter.CareFreeChannel = 0;4904: 10 92 a2 05 sts 0x05A2, r1EE_Parameter.NotGas = 65; // Wert : 0-247 // Gaswert bei Empangsverlust (ggf. in Prozent)4908: 41 e4 ldi r20, 0x41 ; 65490a: 40 93 63 05 sts 0x0563, r20EE_Parameter.NotGasZeit = 90; // Wert : 0-247 // Zeit bis auf NotGas geschaltet wird, wg. Rx-Problemen490e: 30 93 64 05 sts 0x0564, r19EE_Parameter.MotorSmooth = 0;4912: 10 92 a4 05 sts 0x05A4, r1EE_Parameter.ComingHomeAltitude = 0; // 0 = don't change4916: 10 92 a5 05 sts 0x05A5, r1EE_Parameter.MaxAltitude = 150; // 0 = off491a: 36 e9 ldi r19, 0x96 ; 150491c: 30 93 a7 05 sts 0x05A7, r19EE_Parameter.AchsKopplung1 = 125;4920: 90 93 7c 05 sts 0x057C, r25EE_Parameter.AchsKopplung2 = 52;4924: 94 e3 ldi r25, 0x34 ; 524926: 90 93 7d 05 sts 0x057D, r25EE_Parameter.FailsafeChannel = 0;492a: 10 92 a8 05 sts 0x05A8, r1EE_Parameter.ServoFilterNick = 0;492e: 10 92 a9 05 sts 0x05A9, r1EE_Parameter.ServoFilterRoll = 0;4932: 10 92 aa 05 sts 0x05AA, r1EE_Parameter.Servo3OnValue = 140;4936: 80 93 ab 05 sts 0x05AB, r24EE_Parameter.Servo3OffValue = 70;493a: 20 93 ac 05 sts 0x05AC, r18EE_Parameter.Servo4OnValue = 140;493e: 80 93 ad 05 sts 0x05AD, r24EE_Parameter.Servo4OffValue = 70;4942: 20 93 ae 05 sts 0x05AE, r18EE_Parameter.CompassOffset = 0;4946: 10 92 b1 05 sts 0x05B1, r1EE_Parameter.UnterspannungsWarnung = 32; // Wert : 0-247 ( Automatische Zellenerkennung bei < 50)494a: 80 e2 ldi r24, 0x20 ; 32494c: 80 93 62 05 sts 0x0562, r24EE_Parameter.ComingHomeVoltage = 31;4950: 8f e1 ldi r24, 0x1F ; 314952: 80 93 b3 05 sts 0x05B3, r24EE_Parameter.AutoLandingVoltage = 30;4956: 8e e1 ldi r24, 0x1E ; 304958: 80 93 b2 05 sts 0x05B2, r24495c: 08 95 ret0000495e <ParamSet_DefaultSet1>:/***************************************************//* Default Values for parameter set 1 *//***************************************************/void ParamSet_DefaultSet1(void) // normal{CommonDefaults();495e: e6 de rcall .-564 ; 0x472c <CommonDefaults>EE_Parameter.Stick_P = 10; // Wert : 1-204960: 8a e0 ldi r24, 0x0A ; 104962: 80 93 55 05 sts 0x0555, r24EE_Parameter.Stick_D = 16; // Wert : 0-204966: 80 e1 ldi r24, 0x10 ; 164968: 80 93 56 05 sts 0x0556, r24EE_Parameter.StickGier_P = 6; // Wert : 1-20496c: 86 e0 ldi r24, 0x06 ; 6496e: 80 93 57 05 sts 0x0557, r24EE_Parameter.Gyro_P = 90; // Wert : 0-2474972: 2a e5 ldi r18, 0x5A ; 904974: 20 93 5c 05 sts 0x055C, r18EE_Parameter.Gyro_I = 120; // Wert : 0-2474978: 98 e7 ldi r25, 0x78 ; 120497a: 90 93 5d 05 sts 0x055D, r25EE_Parameter.Gyro_Gier_P = 90; // Wert : 0-247497e: 20 93 5f 05 sts 0x055F, r18EE_Parameter.Gyro_Gier_I = 120; // Wert : 0-2474982: 90 93 60 05 sts 0x0560, r25EE_Parameter.Gyro_Stability = 6; // Wert : 1-84986: 80 93 61 05 sts 0x0561, r24EE_Parameter.I_Faktor = 32;498a: 80 e2 ldi r24, 0x20 ; 32498c: 80 93 66 05 sts 0x0566, r24EE_Parameter.CouplingYawCorrection = 60;4990: 8c e3 ldi r24, 0x3C ; 604992: 80 93 7e 05 sts 0x057E, r24EE_Parameter.DynamicStability = 75;4996: 8b e4 ldi r24, 0x4B ; 754998: 80 93 83 05 sts 0x0583, r24memcpy(EE_Parameter.Name, "Fast",4);499c: 86 e4 ldi r24, 0x46 ; 70499e: 91 e6 ldi r25, 0x61 ; 9749a0: a3 e7 ldi r26, 0x73 ; 11549a2: b4 e7 ldi r27, 0x74 ; 11649a4: 80 93 ba 05 sts 0x05BA, r2449a8: 90 93 bb 05 sts 0x05BB, r2549ac: a0 93 bc 05 sts 0x05BC, r2649b0: b0 93 bd 05 sts 0x05BD, r27EE_Parameter.crc = RAM_Checksum((uint8_t*)(&EE_Parameter), sizeof(EE_Parameter)-1);49b4: 68 e8 ldi r22, 0x88 ; 13649b6: 70 e0 ldi r23, 0x00 ; 049b8: 8e e3 ldi r24, 0x3E ; 6249ba: 95 e0 ldi r25, 0x05 ; 549bc: 5f de rcall .-834 ; 0x467c <RAM_Checksum>49be: 80 93 c6 05 sts 0x05C6, r2449c2: 08 95 ret000049c4 <ParamSet_DefaultSet2>:/***************************************************//* Default Values for parameter set 2 *//***************************************************/void ParamSet_DefaultSet2(void) // Agil{CommonDefaults();49c4: b3 de rcall .-666 ; 0x472c <CommonDefaults>EE_Parameter.Stick_P = 8; // Wert : 1-2049c6: 88 e0 ldi r24, 0x08 ; 849c8: 80 93 55 05 sts 0x0555, r24EE_Parameter.Stick_D = 16; // Wert : 0-2049cc: 80 e1 ldi r24, 0x10 ; 1649ce: 80 93 56 05 sts 0x0556, r24EE_Parameter.StickGier_P = 6; // Wert : 1-2049d2: 96 e0 ldi r25, 0x06 ; 649d4: 90 93 57 05 sts 0x0557, r25EE_Parameter.Gyro_P = 100; // Wert : 0-24749d8: 34 e6 ldi r19, 0x64 ; 10049da: 30 93 5c 05 sts 0x055C, r19EE_Parameter.Gyro_I = 120; // Wert : 0-24749de: 28 e7 ldi r18, 0x78 ; 12049e0: 20 93 5d 05 sts 0x055D, r18EE_Parameter.Gyro_Gier_P = 100; // Wert : 0-24749e4: 30 93 5f 05 sts 0x055F, r19EE_Parameter.Gyro_Gier_I = 120; // Wert : 0-24749e8: 20 93 60 05 sts 0x0560, r18EE_Parameter.Gyro_Stability = 6; // Wert : 1-849ec: 90 93 61 05 sts 0x0561, r25EE_Parameter.I_Faktor = 16;49f0: 80 93 66 05 sts 0x0566, r24EE_Parameter.CouplingYawCorrection = 70;49f4: 86 e4 ldi r24, 0x46 ; 7049f6: 80 93 7e 05 sts 0x057E, r24EE_Parameter.DynamicStability = 70;49fa: 80 93 83 05 sts 0x0583, r24memcpy(EE_Parameter.Name, "Agile",5);49fe: 85 e0 ldi r24, 0x05 ; 54a00: e5 ec ldi r30, 0xC5 ; 1974a02: f2 e0 ldi r31, 0x02 ; 24a04: aa eb ldi r26, 0xBA ; 1864a06: b5 e0 ldi r27, 0x05 ; 54a08: 01 90 ld r0, Z+4a0a: 0d 92 st X+, r04a0c: 8a 95 dec r244a0e: e1 f7 brne .-8 ; 0x4a08 <ParamSet_DefaultSet2+0x44>EE_Parameter.crc = RAM_Checksum((uint8_t*)(&EE_Parameter), sizeof(EE_Parameter)-1);4a10: 68 e8 ldi r22, 0x88 ; 1364a12: 70 e0 ldi r23, 0x00 ; 04a14: 8e e3 ldi r24, 0x3E ; 624a16: 95 e0 ldi r25, 0x05 ; 54a18: 31 de rcall .-926 ; 0x467c <RAM_Checksum>4a1a: 80 93 c6 05 sts 0x05C6, r244a1e: 08 95 ret00004a20 <ParamSet_DefaultSet3>:/***************************************************//* Default Values for parameter set 3 *//***************************************************/void ParamSet_DefaultSet3(void) // Easy{CommonDefaults();4a20: 85 de rcall .-758 ; 0x472c <CommonDefaults>EE_Parameter.Stick_P = 6; // Wert : 1-204a22: 86 e0 ldi r24, 0x06 ; 64a24: 80 93 55 05 sts 0x0555, r24EE_Parameter.Stick_D = 10; // Wert : 0-204a28: 9a e0 ldi r25, 0x0A ; 104a2a: 90 93 56 05 sts 0x0556, r25EE_Parameter.StickGier_P = 4; // Wert : 1-204a2e: 94 e0 ldi r25, 0x04 ; 44a30: 90 93 57 05 sts 0x0557, r25EE_Parameter.Gyro_P = 100; // Wert : 0-2474a34: 24 e6 ldi r18, 0x64 ; 1004a36: 20 93 5c 05 sts 0x055C, r18EE_Parameter.Gyro_I = 120; // Wert : 0-2474a3a: 98 e7 ldi r25, 0x78 ; 1204a3c: 90 93 5d 05 sts 0x055D, r25EE_Parameter.Gyro_Gier_P = 100; // Wert : 0-2474a40: 20 93 5f 05 sts 0x055F, r18EE_Parameter.Gyro_Gier_I = 120; // Wert : 0-2474a44: 90 93 60 05 sts 0x0560, r25EE_Parameter.Gyro_Stability = 6; // Wert : 1-84a48: 80 93 61 05 sts 0x0561, r24EE_Parameter.I_Faktor = 16;4a4c: 80 e1 ldi r24, 0x10 ; 164a4e: 80 93 66 05 sts 0x0566, r24EE_Parameter.CouplingYawCorrection = 70;4a52: 86 e4 ldi r24, 0x46 ; 704a54: 80 93 7e 05 sts 0x057E, r24EE_Parameter.DynamicStability = 70;4a58: 80 93 83 05 sts 0x0583, r24memcpy(EE_Parameter.Name, "Easy", 4);4a5c: 85 e4 ldi r24, 0x45 ; 694a5e: 91 e6 ldi r25, 0x61 ; 974a60: a3 e7 ldi r26, 0x73 ; 1154a62: b9 e7 ldi r27, 0x79 ; 1214a64: 80 93 ba 05 sts 0x05BA, r244a68: 90 93 bb 05 sts 0x05BB, r254a6c: a0 93 bc 05 sts 0x05BC, r264a70: b0 93 bd 05 sts 0x05BD, r27EE_Parameter.crc = RAM_Checksum((uint8_t*)(&EE_Parameter), sizeof(EE_Parameter)-1);4a74: 68 e8 ldi r22, 0x88 ; 1364a76: 70 e0 ldi r23, 0x00 ; 04a78: 8e e3 ldi r24, 0x3E ; 624a7a: 95 e0 ldi r25, 0x05 ; 54a7c: ff dd rcall .-1026 ; 0x467c <RAM_Checksum>4a7e: 80 93 c6 05 sts 0x05C6, r244a82: 08 95 ret00004a84 <GetParamByte>:/***************************************************//* Read Parameter from EEPROM as byte *//***************************************************/uint8_t GetParamByte(uint16_t param_id){return eeprom_read_byte((uint8_t*)(EEPROM_ADR_PARAM_BEGIN + param_id));4a84: 0c 94 3e b2 jmp 0x1647c ; 0x1647c <__eerd_byte_m1284>}4a88: 08 95 ret00004a8a <SetParamByte>:/***************************************************//* Write Parameter to EEPROM as byte *//***************************************************/void SetParamByte(uint16_t param_id, uint8_t value){eeprom_write_byte((uint8_t*)(EEPROM_ADR_PARAM_BEGIN + param_id), value);4a8a: 0c 94 54 b2 jmp 0x164a8 ; 0x164a8 <__eewr_byte_m1284>4a8e: 08 95 ret00004a90 <GetParamWord>:/***************************************************//* Read Parameter from EEPROM as word *//***************************************************/uint16_t GetParamWord(uint16_t param_id){return eeprom_read_word((uint16_t *)(EEPROM_ADR_PARAM_BEGIN + param_id));4a90: 0c 94 46 b2 jmp 0x1648c ; 0x1648c <__eerd_word_m1284>}4a94: 08 95 ret00004a96 <SetParamWord>:/***************************************************//* Write Parameter to EEPROM as word *//***************************************************/void SetParamWord(uint16_t param_id, uint16_t value){eeprom_write_word((uint16_t*)(EEPROM_ADR_PARAM_BEGIN + param_id), value);4a96: 0c 94 62 b2 jmp 0x164c4 ; 0x164c4 <__eewr_word_m1284>4a9a: 08 95 ret00004a9c <ParamSet_ReadFromEEProm>:/***************************************************//* Read Parameter Set from EEPROM *//***************************************************/// number [1..5]uint8_t ParamSet_ReadFromEEProm(uint8_t setnumber){4a9c: ff 92 push r154a9e: 0f 93 push r164aa0: 1f 93 push r174aa2: cf 93 push r284aa4: df 93 push r29uint8_t crc;uint16_t eeaddr;// range the setnumberif((1 > setnumber) || (setnumber > 5)) setnumber = 3;4aa6: 9f ef ldi r25, 0xFF ; 2554aa8: 98 0f add r25, r244aaa: 95 30 cpi r25, 0x05 ; 54aac: 08 f0 brcs .+2 ; 0x4ab0 <ParamSet_ReadFromEEProm+0x14>4aae: 83 e0 ldi r24, 0x03 ; 3// calculate eeprom addreeaddr = EEPROM_ADR_PARAMSET + PARAMSET_STRUCT_LEN * (setnumber - 1);4ab0: 90 e0 ldi r25, 0x00 ; 04ab2: 01 97 sbiw r24, 0x01 ; 14ab4: 29 e8 ldi r18, 0x89 ; 1374ab6: 28 9f mul r18, r244ab8: e0 01 movw r28, r04aba: 29 9f mul r18, r254abc: d0 0d add r29, r04abe: 11 24 eor r1, r14ac0: 8e 01 movw r16, r284ac2: 0c 59 subi r16, 0x9C ; 1564ac4: 1f 4f sbci r17, 0xFF ; 255// calculate checksum from eepromcrc = EEProm_Checksum(eeaddr, PARAMSET_STRUCT_LEN - 1);4ac6: 68 e8 ldi r22, 0x88 ; 1364ac8: 70 e0 ldi r23, 0x00 ; 04aca: c8 01 movw r24, r164acc: e6 dd rcall .-1076 ; 0x469a <EEProm_Checksum>4ace: f8 2e mov r15, r24// check crcif(crc != eeprom_read_byte((uint8_t*)(eeaddr + PARAMSET_STRUCT_LEN - 1))) return 0;4ad0: ce 01 movw r24, r284ad2: 84 51 subi r24, 0x14 ; 204ad4: 9f 4f sbci r25, 0xFF ; 2554ad6: 0e 94 3e b2 call 0x1647c ; 0x1647c <__eerd_byte_m1284>4ada: 8f 11 cpse r24, r154adc: 12 c0 rjmp .+36 ; 0x4b02 <ParamSet_ReadFromEEProm+0x66>// check revisionif(eeprom_read_byte((uint8_t*)(eeaddr)) != EEPARAM_REVISION) return 0;4ade: c8 01 movw r24, r164ae0: 0e 94 3e b2 call 0x1647c ; 0x1647c <__eerd_byte_m1284>4ae4: 87 36 cpi r24, 0x67 ; 1034ae6: 79 f4 brne .+30 ; 0x4b06 <ParamSet_ReadFromEEProm+0x6a>// read paramset from eepromeeprom_read_block((void *) &EE_Parameter, (void*)(EEPROM_ADR_PARAMSET + PARAMSET_STRUCT_LEN * (setnumber - 1)), PARAMSET_STRUCT_LEN);4ae8: 49 e8 ldi r20, 0x89 ; 1374aea: 50 e0 ldi r21, 0x00 ; 04aec: b8 01 movw r22, r164aee: 8e e3 ldi r24, 0x3E ; 624af0: 95 e0 ldi r25, 0x05 ; 54af2: 0e 94 2e b2 call 0x1645c ; 0x1645c <__eerd_block_m1284>LED_Init();4af6: 0e 94 80 85 call 0x10b00 ; 0x10b00 <LED_Init>#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))LIBFC_HoTT_Clear();4afa: 0e 94 3a 15 call 0x2a74 ; 0x2a74 <LIBFC_HoTT_Clear>#endifreturn 1;4afe: 81 e0 ldi r24, 0x01 ; 14b00: 03 c0 rjmp .+6 ; 0x4b08 <ParamSet_ReadFromEEProm+0x6c>// calculate checksum from eepromcrc = EEProm_Checksum(eeaddr, PARAMSET_STRUCT_LEN - 1);// check crcif(crc != eeprom_read_byte((uint8_t*)(eeaddr + PARAMSET_STRUCT_LEN - 1))) return 0;4b02: 80 e0 ldi r24, 0x00 ; 04b04: 01 c0 rjmp .+2 ; 0x4b08 <ParamSet_ReadFromEEProm+0x6c>// check revisionif(eeprom_read_byte((uint8_t*)(eeaddr)) != EEPARAM_REVISION) return 0;4b06: 80 e0 ldi r24, 0x00 ; 0LED_Init();#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))LIBFC_HoTT_Clear();#endifreturn 1;}4b08: df 91 pop r294b0a: cf 91 pop r284b0c: 1f 91 pop r174b0e: 0f 91 pop r164b10: ff 90 pop r154b12: 08 95 ret00004b14 <MixerTable_ReadFromEEProm>:/***************************************************//* Read MixerTable from EEPROM *//***************************************************/uint8_t MixerTable_ReadFromEEProm(void){4b14: cf 93 push r28uint8_t crc;// calculate checksum in eepromcrc = EEProm_Checksum(EEPROM_ADR_MIXERTABLE, sizeof(Mixer) - 1);4b16: 6d e4 ldi r22, 0x4D ; 774b18: 70 e0 ldi r23, 0x00 ; 04b1a: 88 ee ldi r24, 0xE8 ; 2324b1c: 93 e0 ldi r25, 0x03 ; 34b1e: bd dd rcall .-1158 ; 0x469a <EEProm_Checksum>4b20: c8 2f mov r28, r24// check crcif( crc != eeprom_read_byte((uint8_t*)(EEPROM_ADR_MIXERTABLE + sizeof(Mixer) - 1)) ) return 0;4b22: 85 e3 ldi r24, 0x35 ; 534b24: 94 e0 ldi r25, 0x04 ; 44b26: 0e 94 3e b2 call 0x1647c ; 0x1647c <__eerd_byte_m1284>4b2a: 8c 13 cpse r24, r284b2c: 10 c0 rjmp .+32 ; 0x4b4e <MixerTable_ReadFromEEProm+0x3a>// check revisionif(eeprom_read_byte((uint8_t*)(EEPROM_ADR_MIXERTABLE)) != EEMIXER_REVISION) return 0;4b2e: 88 ee ldi r24, 0xE8 ; 2324b30: 93 e0 ldi r25, 0x03 ; 34b32: 0e 94 3e b2 call 0x1647c ; 0x1647c <__eerd_byte_m1284>4b36: 81 30 cpi r24, 0x01 ; 14b38: 61 f4 brne .+24 ; 0x4b52 <MixerTable_ReadFromEEProm+0x3e>// read mixer tableeeprom_read_block((void *) &Mixer, (void*)(EEPROM_ADR_MIXERTABLE), sizeof(Mixer));4b3a: 4e e4 ldi r20, 0x4E ; 784b3c: 50 e0 ldi r21, 0x00 ; 04b3e: 68 ee ldi r22, 0xE8 ; 2324b40: 73 e0 ldi r23, 0x03 ; 34b42: 87 ec ldi r24, 0xC7 ; 1994b44: 95 e0 ldi r25, 0x05 ; 54b46: 0e 94 2e b2 call 0x1645c ; 0x1645c <__eerd_block_m1284>return 1;4b4a: 81 e0 ldi r24, 0x01 ; 14b4c: 03 c0 rjmp .+6 ; 0x4b54 <MixerTable_ReadFromEEProm+0x40>// calculate checksum in eepromcrc = EEProm_Checksum(EEPROM_ADR_MIXERTABLE, sizeof(Mixer) - 1);// check crcif( crc != eeprom_read_byte((uint8_t*)(EEPROM_ADR_MIXERTABLE + sizeof(Mixer) - 1)) ) return 0;4b4e: 80 e0 ldi r24, 0x00 ; 04b50: 01 c0 rjmp .+2 ; 0x4b54 <MixerTable_ReadFromEEProm+0x40>// check revisionif(eeprom_read_byte((uint8_t*)(EEPROM_ADR_MIXERTABLE)) != EEMIXER_REVISION) return 0;4b52: 80 e0 ldi r24, 0x00 ; 0// read mixer tableeeprom_read_block((void *) &Mixer, (void*)(EEPROM_ADR_MIXERTABLE), sizeof(Mixer));return 1;}4b54: cf 91 pop r284b56: 08 95 ret00004b58 <MixerTable_WriteToEEProm>:/***************************************************//* Write Mixer Table to EEPROM *//***************************************************/uint8_t MixerTable_WriteToEEProm(void){if(Mixer.Revision == EEMIXER_REVISION)4b58: 80 91 c7 05 lds r24, 0x05C74b5c: 81 30 cpi r24, 0x01 ; 14b5e: 89 f4 brne .+34 ; 0x4b82 <MixerTable_WriteToEEProm+0x2a>{// update crcMixer.crc = RAM_Checksum((uint8_t*)(&Mixer), sizeof(Mixer) - 1);4b60: 6d e4 ldi r22, 0x4D ; 774b62: 70 e0 ldi r23, 0x00 ; 04b64: 87 ec ldi r24, 0xC7 ; 1994b66: 95 e0 ldi r25, 0x05 ; 54b68: 89 dd rcall .-1262 ; 0x467c <RAM_Checksum>4b6a: 80 93 14 06 sts 0x0614, r24// write to eepromeeprom_write_block((void *) &Mixer, (void*)(EEPROM_ADR_MIXERTABLE), sizeof(Mixer));4b6e: 4e e4 ldi r20, 0x4E ; 784b70: 50 e0 ldi r21, 0x00 ; 04b72: 68 ee ldi r22, 0xE8 ; 2324b74: 73 e0 ldi r23, 0x03 ; 34b76: 87 ec ldi r24, 0xC7 ; 1994b78: 95 e0 ldi r25, 0x05 ; 54b7a: 0e 94 4b b2 call 0x16496 ; 0x16496 <__eewr_block_m1284>return 1;4b7e: 81 e0 ldi r24, 0x01 ; 14b80: 08 95 ret}else return 0;4b82: 80 e0 ldi r24, 0x00 ; 0}4b84: 08 95 ret00004b86 <MixerTable_Default>:/***************************************************/void MixerTable_Default(void) // Quadro{uint8_t i;Mixer.Revision = EEMIXER_REVISION;4b86: 81 e0 ldi r24, 0x01 ; 14b88: 80 93 c7 05 sts 0x05C7, r244b8c: e7 ed ldi r30, 0xD7 ; 2154b8e: f5 e0 ldi r31, 0x05 ; 54b90: 87 e1 ldi r24, 0x17 ; 234b92: 96 e0 ldi r25, 0x06 ; 64b94: df 01 movw r26, r304b96: 13 97 sbiw r26, 0x03 ; 3// clear mixer tablefor(i = 0; i < 16; i++){Mixer.Motor[i][MIX_GAS] = 0;4b98: 1c 92 st X, r14b9a: 11 96 adiw r26, 0x01 ; 1Mixer.Motor[i][MIX_NICK] = 0;4b9c: 1c 92 st X, r14b9e: 11 96 adiw r26, 0x01 ; 1Mixer.Motor[i][MIX_ROLL] = 0;4ba0: 1c 92 st X, r1Mixer.Motor[i][MIX_YAW] = 0;4ba2: 10 82 st Z, r14ba4: 34 96 adiw r30, 0x04 ; 4{uint8_t i;Mixer.Revision = EEMIXER_REVISION;// clear mixer tablefor(i = 0; i < 16; i++)4ba6: e8 17 cp r30, r244ba8: f9 07 cpc r31, r254baa: a1 f7 brne .-24 ; 0x4b94 <MixerTable_Default+0xe>Mixer.Motor[i][MIX_NICK] = 0;Mixer.Motor[i][MIX_ROLL] = 0;Mixer.Motor[i][MIX_YAW] = 0;}// default = QuadroMixer.Motor[0][MIX_GAS] = 64; Mixer.Motor[0][MIX_NICK] = +64; Mixer.Motor[0][MIX_ROLL] = 0; Mixer.Motor[0][MIX_YAW] = +64;4bac: 80 e4 ldi r24, 0x40 ; 644bae: 80 93 d4 05 sts 0x05D4, r244bb2: 80 93 d5 05 sts 0x05D5, r244bb6: 10 92 d6 05 sts 0x05D6, r14bba: 80 93 d7 05 sts 0x05D7, r24Mixer.Motor[1][MIX_GAS] = 64; Mixer.Motor[1][MIX_NICK] = -64; Mixer.Motor[1][MIX_ROLL] = 0; Mixer.Motor[1][MIX_YAW] = +64;4bbe: 80 93 d8 05 sts 0x05D8, r244bc2: 90 ec ldi r25, 0xC0 ; 1924bc4: 90 93 d9 05 sts 0x05D9, r254bc8: 10 92 da 05 sts 0x05DA, r14bcc: 80 93 db 05 sts 0x05DB, r24Mixer.Motor[2][MIX_GAS] = 64; Mixer.Motor[2][MIX_NICK] = 0; Mixer.Motor[2][MIX_ROLL] = -64; Mixer.Motor[2][MIX_YAW] = -64;4bd0: 80 93 dc 05 sts 0x05DC, r244bd4: 10 92 dd 05 sts 0x05DD, r14bd8: 90 93 de 05 sts 0x05DE, r254bdc: 90 93 df 05 sts 0x05DF, r25Mixer.Motor[3][MIX_GAS] = 64; Mixer.Motor[3][MIX_NICK] = 0; Mixer.Motor[3][MIX_ROLL] = +64; Mixer.Motor[3][MIX_YAW] = -64;4be0: 80 93 e0 05 sts 0x05E0, r244be4: 10 92 e1 05 sts 0x05E1, r14be8: 80 93 e2 05 sts 0x05E2, r244bec: 90 93 e3 05 sts 0x05E3, r25memcpy(Mixer.Name, "Quadro\0\0\0\0\0\0", 12);4bf0: 8c e0 ldi r24, 0x0C ; 124bf2: e8 eb ldi r30, 0xB8 ; 1844bf4: f2 e0 ldi r31, 0x02 ; 24bf6: a8 ec ldi r26, 0xC8 ; 2004bf8: b5 e0 ldi r27, 0x05 ; 54bfa: 01 90 ld r0, Z+4bfc: 0d 92 st X+, r04bfe: 8a 95 dec r244c00: e1 f7 brne .-8 ; 0x4bfa <MixerTable_Default+0x74>Mixer.crc = RAM_Checksum((uint8_t*)(&Mixer), sizeof(Mixer) - 1);4c02: 6d e4 ldi r22, 0x4D ; 774c04: 70 e0 ldi r23, 0x00 ; 04c06: 87 ec ldi r24, 0xC7 ; 1994c08: 95 e0 ldi r25, 0x05 ; 54c0a: 38 dd rcall .-1424 ; 0x467c <RAM_Checksum>4c0c: 80 93 14 06 sts 0x0614, r244c10: 08 95 ret00004c12 <GetActiveParamSet>:/* Get active parameter set *//***************************************************/uint8_t GetActiveParamSet(void){uint8_t setnumber;setnumber = eeprom_read_byte((uint8_t*)(EEPROM_ADR_PARAM_BEGIN + PID_ACTIVE_SET));4c12: 82 e0 ldi r24, 0x02 ; 24c14: 90 e0 ldi r25, 0x00 ; 04c16: 0e 94 3e b2 call 0x1647c ; 0x1647c <__eerd_byte_m1284>if(setnumber > 5)4c1a: 86 30 cpi r24, 0x06 ; 64c1c: 30 f0 brcs .+12 ; 0x4c2a <GetActiveParamSet+0x18>{setnumber = 3;eeprom_write_byte((void*)(EEPROM_ADR_PARAM_BEGIN+PID_ACTIVE_SET), setnumber);4c1e: 63 e0 ldi r22, 0x03 ; 34c20: 82 e0 ldi r24, 0x02 ; 24c22: 90 e0 ldi r25, 0x00 ; 04c24: 0e 94 54 b2 call 0x164a8 ; 0x164a8 <__eewr_byte_m1284>{uint8_t setnumber;setnumber = eeprom_read_byte((uint8_t*)(EEPROM_ADR_PARAM_BEGIN + PID_ACTIVE_SET));if(setnumber > 5){setnumber = 3;4c28: 83 e0 ldi r24, 0x03 ; 3eeprom_write_byte((void*)(EEPROM_ADR_PARAM_BEGIN+PID_ACTIVE_SET), setnumber);}ActiveParamSet = setnumber;4c2a: 80 93 52 01 sts 0x0152, r24return(setnumber);}4c2e: 08 95 ret00004c30 <SetActiveParamSet>:/***************************************************//* Set active parameter set *//***************************************************/void SetActiveParamSet(uint8_t setnumber){4c30: 86 30 cpi r24, 0x06 ; 64c32: 08 f0 brcs .+2 ; 0x4c36 <SetActiveParamSet+0x6>4c34: 85 e0 ldi r24, 0x05 ; 5if(setnumber > 5) setnumber = 5;if(setnumber < 1) setnumber = 1;4c36: 81 11 cpse r24, r14c38: 01 c0 rjmp .+2 ; 0x4c3c <SetActiveParamSet+0xc>4c3a: 81 e0 ldi r24, 0x01 ; 1ActiveParamSet = setnumber;4c3c: 80 93 52 01 sts 0x0152, r24eeprom_write_byte((uint8_t*)(EEPROM_ADR_PARAM_BEGIN + PID_ACTIVE_SET), setnumber);4c40: 68 2f mov r22, r244c42: 82 e0 ldi r24, 0x02 ; 24c44: 90 e0 ldi r25, 0x00 ; 04c46: 0c 94 54 b2 jmp 0x164a8 ; 0x164a8 <__eewr_byte_m1284>4c4a: 08 95 ret00004c4c <ParamSet_WriteToEEProm>:/***************************************************//* Write Parameter Set to EEPROM *//***************************************************/// number [1..5]uint8_t ParamSet_WriteToEEProm(uint8_t setnumber){4c4c: cf 93 push r28uint8_t crc;if(EE_Parameter.Revision == EEPARAM_REVISION) // write only the right revision to eeprom4c4e: 90 91 3e 05 lds r25, 0x053E4c52: 97 36 cpi r25, 0x67 ; 1034c54: 09 f0 breq .+2 ; 0x4c58 <ParamSet_WriteToEEProm+0xc>4c56: 47 c0 rjmp .+142 ; 0x4ce6 <ParamSet_WriteToEEProm+0x9a>4c58: c8 2f mov r28, r244c5a: 86 30 cpi r24, 0x06 ; 64c5c: 08 f0 brcs .+2 ; 0x4c60 <ParamSet_WriteToEEProm+0x14>4c5e: c5 e0 ldi r28, 0x05 ; 5{if(setnumber > 5) setnumber = 5;if(setnumber < 1) return 0;4c60: cc 23 and r28, r284c62: 09 f4 brne .+2 ; 0x4c66 <ParamSet_WriteToEEProm+0x1a>4c64: 42 c0 rjmp .+132 ; 0x4cea <ParamSet_WriteToEEProm+0x9e>LIBFC_CheckSettings();4c66: 0e 94 00 1a call 0x3400 ; 0x3400 <LIBFC_CheckSettings>if(EE_Parameter.GlobalConfig3 & CFG3_VARIO_FAILSAFE) // check the Setting: Not more than 100% emergency gas4c6a: 80 91 b9 05 lds r24, 0x05B94c6e: 82 ff sbrs r24, 24c70: 07 c0 rjmp .+14 ; 0x4c80 <ParamSet_WriteToEEProm+0x34>{if(EE_Parameter.NotGas > 99) EE_Parameter.NotGas = 80; // i.e. 80% of Hovergas4c72: 80 91 63 05 lds r24, 0x05634c76: 84 36 cpi r24, 0x64 ; 1004c78: 18 f0 brcs .+6 ; 0x4c80 <ParamSet_WriteToEEProm+0x34>4c7a: 80 e5 ldi r24, 0x50 ; 804c7c: 80 93 63 05 sts 0x0563, r24}// update checksumEE_Parameter.crc = RAM_Checksum((uint8_t*)(&EE_Parameter), sizeof(EE_Parameter)-1);4c80: 68 e8 ldi r22, 0x88 ; 1364c82: 70 e0 ldi r23, 0x00 ; 04c84: 8e e3 ldi r24, 0x3E ; 624c86: 95 e0 ldi r25, 0x05 ; 54c88: f9 dc rcall .-1550 ; 0x467c <RAM_Checksum>4c8a: 80 93 c6 05 sts 0x05C6, r24// write paramset to eepromeeprom_write_block((void *) &EE_Parameter, (void*)(EEPROM_ADR_PARAMSET + PARAMSET_STRUCT_LEN * (setnumber - 1)), PARAMSET_STRUCT_LEN);4c8e: 2c 2f mov r18, r284c90: 30 e0 ldi r19, 0x00 ; 04c92: 21 50 subi r18, 0x01 ; 14c94: 31 09 sbc r19, r14c96: 89 e8 ldi r24, 0x89 ; 1374c98: 82 9f mul r24, r184c9a: b0 01 movw r22, r04c9c: 83 9f mul r24, r194c9e: 70 0d add r23, r04ca0: 11 24 eor r1, r14ca2: 6c 59 subi r22, 0x9C ; 1564ca4: 7f 4f sbci r23, 0xFF ; 2554ca6: 49 e8 ldi r20, 0x89 ; 1374ca8: 50 e0 ldi r21, 0x00 ; 04caa: 8e e3 ldi r24, 0x3E ; 624cac: 95 e0 ldi r25, 0x05 ; 54cae: 0e 94 4b b2 call 0x16496 ; 0x16496 <__eewr_block_m1284>// backup channel settings to separate block in eepromeeprom_write_block( (void*)(EE_Parameter.Kanalbelegung), (void*)(EEPROM_ADR_CHANNELS), sizeof(EE_Parameter.Kanalbelegung));4cb2: 4c e0 ldi r20, 0x0C ; 124cb4: 50 e0 ldi r21, 0x00 ; 04cb6: 60 e5 ldi r22, 0x50 ; 804cb8: 70 e0 ldi r23, 0x00 ; 04cba: 8f e3 ldi r24, 0x3F ; 634cbc: 95 e0 ldi r25, 0x05 ; 54cbe: 0e 94 4b b2 call 0x16496 ; 0x16496 <__eewr_block_m1284>// write crc of channel block to eepromcrc = RAM_Checksum((uint8_t*)(EE_Parameter.Kanalbelegung), sizeof(EE_Parameter.Kanalbelegung));4cc2: 6c e0 ldi r22, 0x0C ; 124cc4: 70 e0 ldi r23, 0x00 ; 04cc6: 8f e3 ldi r24, 0x3F ; 634cc8: 95 e0 ldi r25, 0x05 ; 54cca: d8 dc rcall .-1616 ; 0x467c <RAM_Checksum>eeprom_write_byte((uint8_t*)(EEPROM_ADR_CHANNELS + sizeof(EE_Parameter.Kanalbelegung)), crc);4ccc: 68 2f mov r22, r244cce: 8c e5 ldi r24, 0x5C ; 924cd0: 90 e0 ldi r25, 0x00 ; 04cd2: 0e 94 54 b2 call 0x164a8 ; 0x164a8 <__eewr_byte_m1284>// update active settings numberSetActiveParamSet(setnumber);4cd6: 8c 2f mov r24, r284cd8: ab df rcall .-170 ; 0x4c30 <SetActiveParamSet>LED_Init();4cda: 0e 94 80 85 call 0x10b00 ; 0x10b00 <LED_Init>#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))LIBFC_HoTT_Clear();4cde: 0e 94 3a 15 call 0x2a74 ; 0x2a74 <LIBFC_HoTT_Clear>#endifreturn 1;4ce2: 81 e0 ldi r24, 0x01 ; 14ce4: 03 c0 rjmp .+6 ; 0x4cec <ParamSet_WriteToEEProm+0xa0>}// wrong revisionreturn 0;4ce6: 80 e0 ldi r24, 0x00 ; 04ce8: 01 c0 rjmp .+2 ; 0x4cec <ParamSet_WriteToEEProm+0xa0>uint8_t crc;if(EE_Parameter.Revision == EEPARAM_REVISION) // write only the right revision to eeprom{if(setnumber > 5) setnumber = 5;if(setnumber < 1) return 0;4cea: 80 e0 ldi r24, 0x00 ; 0#endifreturn 1;}// wrong revisionreturn 0;}4cec: cf 91 pop r284cee: 08 95 ret00004cf0 <SetDefaultParameter>:/***************************************************//* Set default parameter set *//***************************************************/void SetDefaultParameter(uint8_t set, uint8_t restore_channels){4cf0: cf 93 push r284cf2: df 93 push r294cf4: c8 2f mov r28, r244cf6: d6 2f mov r29, r22if(set > 5) set = 5;4cf8: 86 30 cpi r24, 0x06 ; 64cfa: 80 f4 brcc .+32 ; 0x4d1c <SetDefaultParameter+0x2c>else if(set < 1) set = 1;4cfc: 88 23 and r24, r244cfe: 39 f0 breq .+14 ; 0x4d0e <SetDefaultParameter+0x1e>switch(set)4d00: 82 30 cpi r24, 0x02 ; 24d02: 41 f0 breq .+16 ; 0x4d14 <SetDefaultParameter+0x24>4d04: 83 30 cpi r24, 0x03 ; 34d06: 41 f0 breq .+16 ; 0x4d18 <SetDefaultParameter+0x28>4d08: 81 30 cpi r24, 0x01 ; 14d0a: 49 f4 brne .+18 ; 0x4d1e <SetDefaultParameter+0x2e>4d0c: 01 c0 rjmp .+2 ; 0x4d10 <SetDefaultParameter+0x20>/***************************************************/void SetDefaultParameter(uint8_t set, uint8_t restore_channels){if(set > 5) set = 5;else if(set < 1) set = 1;4d0e: c1 e0 ldi r28, 0x01 ; 1switch(set){case 1:ParamSet_DefaultSet1(); // Fill ParamSet Structure to default parameter set 1 (Sport)4d10: 26 de rcall .-948 ; 0x495e <ParamSet_DefaultSet1>break;4d12: 06 c0 rjmp .+12 ; 0x4d20 <SetDefaultParameter+0x30>case 2:ParamSet_DefaultSet2(); // Kamera4d14: 57 de rcall .-850 ; 0x49c4 <ParamSet_DefaultSet2>break;4d16: 04 c0 rjmp .+8 ; 0x4d20 <SetDefaultParameter+0x30>case 3:ParamSet_DefaultSet3(); // Beginner4d18: 83 de rcall .-762 ; 0x4a20 <ParamSet_DefaultSet3>break;4d1a: 02 c0 rjmp .+4 ; 0x4d20 <SetDefaultParameter+0x30>/* Set default parameter set *//***************************************************/void SetDefaultParameter(uint8_t set, uint8_t restore_channels){if(set > 5) set = 5;4d1c: c5 e0 ldi r28, 0x05 ; 5break;case 3:ParamSet_DefaultSet3(); // Beginnerbreak;default:ParamSet_DefaultSet3(); // Beginner4d1e: 80 de rcall .-768 ; 0x4a20 <ParamSet_DefaultSet3>break;}if(restore_channels)4d20: dd 23 and r29, r294d22: b9 f0 breq .+46 ; 0x4d52 <SetDefaultParameter+0x62>{uint8_t crc;// 1st check for a valid channel backup in eepromcrc = EEProm_Checksum(EEPROM_ADR_CHANNELS, sizeof(EE_Parameter.Kanalbelegung));4d24: 6c e0 ldi r22, 0x0C ; 124d26: 70 e0 ldi r23, 0x00 ; 04d28: 80 e5 ldi r24, 0x50 ; 804d2a: 90 e0 ldi r25, 0x00 ; 04d2c: b6 dc rcall .-1684 ; 0x469a <EEProm_Checksum>4d2e: d8 2f mov r29, r24if(crc == eeprom_read_byte((uint8_t*)(EEPROM_ADR_CHANNELS + sizeof(EE_Parameter.Kanalbelegung))) )4d30: 8c e5 ldi r24, 0x5C ; 924d32: 90 e0 ldi r25, 0x00 ; 04d34: 0e 94 3e b2 call 0x1647c ; 0x1647c <__eerd_byte_m1284>4d38: 8d 13 cpse r24, r294d3a: 09 c0 rjmp .+18 ; 0x4d4e <SetDefaultParameter+0x5e>{eeprom_read_block((void *)EE_Parameter.Kanalbelegung, (void*)(EEPROM_ADR_CHANNELS), sizeof(EE_Parameter.Kanalbelegung));4d3c: 4c e0 ldi r20, 0x0C ; 124d3e: 50 e0 ldi r21, 0x00 ; 04d40: 60 e5 ldi r22, 0x50 ; 804d42: 70 e0 ldi r23, 0x00 ; 04d44: 8f e3 ldi r24, 0x3F ; 634d46: 95 e0 ldi r25, 0x05 ; 54d48: 0e 94 2e b2 call 0x1645c ; 0x1645c <__eerd_block_m1284>4d4c: 03 c0 rjmp .+6 ; 0x4d54 <SetDefaultParameter+0x64>}else ParamSet_DefaultStickMapping();4d4e: c9 dc rcall .-1646 ; 0x46e2 <ParamSet_DefaultStickMapping>4d50: 01 c0 rjmp .+2 ; 0x4d54 <SetDefaultParameter+0x64>}else ParamSet_DefaultStickMapping();4d52: c7 dc rcall .-1650 ; 0x46e2 <ParamSet_DefaultStickMapping>ParamSet_WriteToEEProm(set);4d54: 8c 2f mov r24, r284d56: 7a df rcall .-268 ; 0x4c4c <ParamSet_WriteToEEProm>}4d58: df 91 pop r294d5a: cf 91 pop r284d5c: 08 95 ret00004d5e <ParamSet_Init>:/***************************************************//* Initialize EEPROM Parameter Sets *//***************************************************/void ParamSet_Init(void){4d5e: 8f 92 push r84d60: 9f 92 push r94d62: af 92 push r104d64: bf 92 push r114d66: cf 92 push r124d68: df 92 push r134d6a: ef 92 push r144d6c: ff 92 push r154d6e: 0f 93 push r164d70: 1f 93 push r174d72: cf 93 push r284d74: df 93 push r29/***************************************************//* Read Parameter from EEPROM as byte *//***************************************************/uint8_t GetParamByte(uint16_t param_id){return eeprom_read_byte((uint8_t*)(EEPROM_ADR_PARAM_BEGIN + param_id));4d76: 81 e1 ldi r24, 0x11 ; 174d78: 90 e0 ldi r25, 0x00 ; 04d7a: 0e 94 3e b2 call 0x1647c ; 0x1647c <__eerd_byte_m1284>/***************************************************/void ParamSet_Init(void){uint8_t channel_backup = 0, bad_params = 0, ee_default = 0,i;#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))if(PlatinenVersion != GetParamByte(PID_HARDWARE_VERSION))4d7e: 90 91 54 01 lds r25, 0x01544d82: 98 17 cp r25, r244d84: 71 f1 breq .+92 ; 0x4de2 <ParamSet_Init+0x84>{if(PlatinenVersion == 22 && GetParamByte(PID_HARDWARE_VERSION) == 21 && !(PIND & 0x10)) SetParamByte(PID_EE_REVISION,0); // reset the Settings if the Version changed to V2.24d86: 96 31 cpi r25, 0x16 ; 224d88: 49 f4 brne .+18 ; 0x4d9c <ParamSet_Init+0x3e>4d8a: 85 31 cpi r24, 0x15 ; 214d8c: 39 f4 brne .+14 ; 0x4d9c <ParamSet_Init+0x3e>4d8e: 4c 99 sbic 0x09, 4 ; 94d90: 05 c0 rjmp .+10 ; 0x4d9c <ParamSet_Init+0x3e>/***************************************************//* Write Parameter to EEPROM as byte *//***************************************************/void SetParamByte(uint16_t param_id, uint8_t value){eeprom_write_byte((uint8_t*)(EEPROM_ADR_PARAM_BEGIN + param_id), value);4d92: 60 e0 ldi r22, 0x00 ; 04d94: 81 e0 ldi r24, 0x01 ; 14d96: 90 e0 ldi r25, 0x00 ; 04d98: 0e 94 54 b2 call 0x164a8 ; 0x164a8 <__eewr_byte_m1284>4d9c: 60 91 54 01 lds r22, 0x01544da0: 81 e1 ldi r24, 0x11 ; 174da2: 90 e0 ldi r25, 0x00 ; 04da4: 0e 94 54 b2 call 0x164a8 ; 0x164a8 <__eewr_byte_m1284>#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))if(PlatinenVersion != GetParamByte(PID_HARDWARE_VERSION)){if(PlatinenVersion == 22 && GetParamByte(PID_HARDWARE_VERSION) == 21 && !(PIND & 0x10)) SetParamByte(PID_EE_REVISION,0); // reset the Settings if the Version changed to V2.2SetParamByte(PID_HARDWARE_VERSION,PlatinenVersion); // Remember the Version numberwdt_enable(WDTO_15MS); // Reset-Commando4da8: 28 e0 ldi r18, 0x08 ; 84daa: 88 e1 ldi r24, 0x18 ; 244dac: 90 e0 ldi r25, 0x00 ; 04dae: 0f b6 in r0, 0x3f ; 634db0: f8 94 cli4db2: a8 95 wdr4db4: 80 93 60 00 sts 0x0060, r244db8: 0f be out 0x3f, r0 ; 634dba: 20 93 60 00 sts 0x0060, r18printf("\n\r--> Hardware Version Byte Changed <--");4dbe: 89 eb ldi r24, 0xB9 ; 1854dc0: 92 e0 ldi r25, 0x02 ; 24dc2: 9f 93 push r254dc4: 8f 93 push r244dc6: 87 eb ldi r24, 0xB7 ; 1834dc8: 9c ea ldi r25, 0xAC ; 1724dca: 9f 93 push r254dcc: 8f 93 push r244dce: e0 91 78 06 lds r30, 0x06784dd2: f0 91 79 06 lds r31, 0x06794dd6: 09 95 icall4dd8: 0f 90 pop r04dda: 0f 90 pop r04ddc: 0f 90 pop r04dde: 0f 90 pop r04de0: ff cf rjmp .-2 ; 0x4de0 <ParamSet_Init+0x82>/***************************************************//* Read Parameter from EEPROM as byte *//***************************************************/uint8_t GetParamByte(uint16_t param_id){return eeprom_read_byte((uint8_t*)(EEPROM_ADR_PARAM_BEGIN + param_id));4de2: 81 e0 ldi r24, 0x01 ; 14de4: 90 e0 ldi r25, 0x00 ; 04de6: 0e 94 3e b2 call 0x1647c ; 0x1647c <__eerd_byte_m1284>wdt_enable(WDTO_15MS); // Reset-Commandoprintf("\n\r--> Hardware Version Byte Changed <--");while(1);}#endifif((EEPARAM_REVISION) != GetParamByte(PID_EE_REVISION))4dea: ff 24 eor r15, r154dec: f3 94 inc r154dee: 87 36 cpi r24, 0x67 ; 1034df0: 09 f4 brne .+2 ; 0x4df4 <ParamSet_Init+0x96>4df2: f1 2c mov r15, r1{ee_default = 1; // software update or forced by mktool}// 1st check for a valid channel backup in eepromi = EEProm_Checksum(EEPROM_ADR_CHANNELS, sizeof(EE_Parameter.Kanalbelegung));4df4: 6c e0 ldi r22, 0x0C ; 124df6: 70 e0 ldi r23, 0x00 ; 04df8: 80 e5 ldi r24, 0x50 ; 804dfa: 90 e0 ldi r25, 0x00 ; 04dfc: 4e dc rcall .-1892 ; 0x469a <EEProm_Checksum>4dfe: b8 2e mov r11, r24if(i == eeprom_read_byte((uint8_t*)(EEPROM_ADR_CHANNELS + sizeof(EE_Parameter.Kanalbelegung)))) channel_backup = 1;4e00: 8c e5 ldi r24, 0x5C ; 924e02: 90 e0 ldi r25, 0x00 ; 04e04: 0e 94 3e b2 call 0x1647c ; 0x1647c <__eerd_byte_m1284>4e08: c8 2e mov r12, r244e0a: c1 e0 ldi r28, 0x01 ; 14e0c: d0 e0 ldi r29, 0x00 ; 0/***************************************************//* Initialize EEPROM Parameter Sets *//***************************************************/void ParamSet_Init(void){uint8_t channel_backup = 0, bad_params = 0, ee_default = 0,i;4e0e: d1 2c mov r13, r1for (i = 1;i < 6; i++){if(ee_default || !ParamSet_ReadFromEEProm(i)) // could not read paramset from eeprom{bad_params = 1;printf("\n\rGenerating default Parameter Set %d",i);4e10: 0f 2e mov r0, r314e12: f3 e9 ldi r31, 0x93 ; 1474e14: 8f 2e mov r8, r314e16: f2 e0 ldi r31, 0x02 ; 24e18: 9f 2e mov r9, r314e1a: f0 2d mov r31, r04e1c: 07 eb ldi r16, 0xB7 ; 1834e1e: 1c ea ldi r17, 0xAC ; 172// check all 5 parameter settingsfor (i = 1;i < 6; i++){if(ee_default || !ParamSet_ReadFromEEProm(i)) // could not read paramset from eeprom{bad_params = 1;4e20: aa 24 eor r10, r104e22: a3 94 inc r104e24: ec 2e mov r14, r28// parameter check// check all 5 parameter settingsfor (i = 1;i < 6; i++){if(ee_default || !ParamSet_ReadFromEEProm(i)) // could not read paramset from eeprom4e26: f1 10 cpse r15, r14e28: 04 c0 rjmp .+8 ; 0x4e32 <ParamSet_Init+0xd4>4e2a: 8c 2f mov r24, r284e2c: 37 de rcall .-914 ; 0x4a9c <ParamSet_ReadFromEEProm>4e2e: 81 11 cpse r24, r14e30: 2c c0 rjmp .+88 ; 0x4e8a <ParamSet_Init+0x12c>{bad_params = 1;printf("\n\rGenerating default Parameter Set %d",i);4e32: df 93 push r294e34: cf 93 push r284e36: 9f 92 push r94e38: 8f 92 push r84e3a: 1f 93 push r174e3c: 0f 93 push r164e3e: e0 91 78 06 lds r30, 0x06784e42: f0 91 79 06 lds r31, 0x06794e46: 09 95 icallswitch(i)4e48: 0f 90 pop r04e4a: 0f 90 pop r04e4c: 0f 90 pop r04e4e: 0f 90 pop r04e50: 0f 90 pop r04e52: 0f 90 pop r04e54: 81 e0 ldi r24, 0x01 ; 14e56: e8 16 cp r14, r244e58: 21 f0 breq .+8 ; 0x4e62 <ParamSet_Init+0x104>4e5a: 92 e0 ldi r25, 0x02 ; 24e5c: e9 16 cp r14, r254e5e: 19 f0 breq .+6 ; 0x4e66 <ParamSet_Init+0x108>4e60: 04 c0 rjmp .+8 ; 0x4e6a <ParamSet_Init+0x10c>{case 1:ParamSet_DefaultSet1(); // Fill ParamSet Structure to default parameter set 1 (Sport)4e62: 7d dd rcall .-1286 ; 0x495e <ParamSet_DefaultSet1>break;4e64: 03 c0 rjmp .+6 ; 0x4e6c <ParamSet_Init+0x10e>case 2:ParamSet_DefaultSet2(); // Normal4e66: ae dd rcall .-1188 ; 0x49c4 <ParamSet_DefaultSet2>break;4e68: 01 c0 rjmp .+2 ; 0x4e6c <ParamSet_Init+0x10e>default:ParamSet_DefaultSet3(); // Easy4e6a: da dd rcall .-1100 ; 0x4a20 <ParamSet_DefaultSet3>break;}if(channel_backup) // if we have an channel mapping backup in eeprom4e6c: bc 10 cpse r11, r124e6e: 09 c0 rjmp .+18 ; 0x4e82 <ParamSet_Init+0x124>{ // restore it from eepromeeprom_read_block((void *)EE_Parameter.Kanalbelegung, (void*)(EEPROM_ADR_CHANNELS), sizeof(EE_Parameter.Kanalbelegung));4e70: 4c e0 ldi r20, 0x0C ; 124e72: 50 e0 ldi r21, 0x00 ; 04e74: 60 e5 ldi r22, 0x50 ; 804e76: 70 e0 ldi r23, 0x00 ; 04e78: 8f e3 ldi r24, 0x3F ; 634e7a: 95 e0 ldi r25, 0x05 ; 54e7c: 0e 94 2e b2 call 0x1645c ; 0x1645c <__eerd_block_m1284>4e80: 01 c0 rjmp .+2 ; 0x4e84 <ParamSet_Init+0x126>}else{ // use default mappingParamSet_DefaultStickMapping();4e82: 2f dc rcall .-1954 ; 0x46e2 <ParamSet_DefaultStickMapping>}ParamSet_WriteToEEProm(i);4e84: 8e 2d mov r24, r144e86: e2 de rcall .-572 ; 0x4c4c <ParamSet_WriteToEEProm>// check all 5 parameter settingsfor (i = 1;i < 6; i++){if(ee_default || !ParamSet_ReadFromEEProm(i)) // could not read paramset from eeprom{bad_params = 1;4e88: da 2c mov r13, r104e8a: 21 96 adiw r28, 0x01 ; 1if(i == eeprom_read_byte((uint8_t*)(EEPROM_ADR_CHANNELS + sizeof(EE_Parameter.Kanalbelegung)))) channel_backup = 1;// parameter check// check all 5 parameter settingsfor (i = 1;i < 6; i++)4e8c: c6 30 cpi r28, 0x06 ; 64e8e: d1 05 cpc r29, r14e90: 49 f6 brne .-110 ; 0x4e24 <ParamSet_Init+0xc6>ParamSet_DefaultStickMapping();}ParamSet_WriteToEEProm(i);}}if(bad_params) // at least one of the parameter settings were invalid4e92: dd 20 and r13, r134e94: 11 f0 breq .+4 ; 0x4e9a <ParamSet_Init+0x13c>{// default-Setting is parameter set 3SetActiveParamSet(3);4e96: 83 e0 ldi r24, 0x03 ; 34e98: cb de rcall .-618 ; 0x4c30 <SetActiveParamSet>}// read active parameter set to ParamSet stucturei = GetActiveParamSet();4e9a: bb de rcall .-650 ; 0x4c12 <GetActiveParamSet>4e9c: c8 2f mov r28, r24ParamSet_ReadFromEEProm(i);4e9e: fe dd rcall .-1028 ; 0x4a9c <ParamSet_ReadFromEEProm>printf("\n\rUsing Parameter Set %d", i);4ea0: 1f 92 push r14ea2: cf 93 push r284ea4: 8a e7 ldi r24, 0x7A ; 1224ea6: 92 e0 ldi r25, 0x02 ; 24ea8: 9f 93 push r254eaa: 8f 93 push r244eac: 87 eb ldi r24, 0xB7 ; 1834eae: 9c ea ldi r25, 0xAC ; 1724eb0: 9f 93 push r254eb2: 8f 93 push r244eb4: e0 91 78 06 lds r30, 0x06784eb8: f0 91 79 06 lds r31, 0x06794ebc: 09 95 icall/***************************************************//* Read Parameter from EEPROM as byte *//***************************************************/uint8_t GetParamByte(uint16_t param_id){return eeprom_read_byte((uint8_t*)(EEPROM_ADR_PARAM_BEGIN + param_id));4ebe: 81 e0 ldi r24, 0x01 ; 14ec0: 90 e0 ldi r25, 0x00 ; 04ec2: 0e 94 3e b2 call 0x1647c ; 0x1647c <__eerd_byte_m1284>i = GetActiveParamSet();ParamSet_ReadFromEEProm(i);printf("\n\rUsing Parameter Set %d", i);// load mixer tableif(GetParamByte(PID_EE_REVISION) == 0xff || !MixerTable_ReadFromEEProm() )4ec6: 0f 90 pop r04ec8: 0f 90 pop r04eca: 0f 90 pop r04ecc: 0f 90 pop r04ece: 0f 90 pop r04ed0: 0f 90 pop r04ed2: 8f 3f cpi r24, 0xFF ; 2554ed4: 19 f0 breq .+6 ; 0x4edc <ParamSet_Init+0x17e>4ed6: 1e de rcall .-964 ; 0x4b14 <MixerTable_ReadFromEEProm>4ed8: 81 11 cpse r24, r14eda: 13 c0 rjmp .+38 ; 0x4f02 <ParamSet_Init+0x1a4>{printf("\n\rGenerating default Mixer Table");4edc: 89 e5 ldi r24, 0x59 ; 894ede: 92 e0 ldi r25, 0x02 ; 24ee0: 9f 93 push r254ee2: 8f 93 push r244ee4: 87 eb ldi r24, 0xB7 ; 1834ee6: 9c ea ldi r25, 0xAC ; 1724ee8: 9f 93 push r254eea: 8f 93 push r244eec: e0 91 78 06 lds r30, 0x06784ef0: f0 91 79 06 lds r31, 0x06794ef4: 09 95 icallMixerTable_Default(); // Quadro4ef6: 47 de rcall .-882 ; 0x4b86 <MixerTable_Default>MixerTable_WriteToEEProm();4ef8: 2f de rcall .-930 ; 0x4b58 <MixerTable_WriteToEEProm>4efa: 0f 90 pop r04efc: 0f 90 pop r04efe: 0f 90 pop r04f00: 0f 90 pop r0}if(ee_default) SetParamByte(PID_EE_REVISION, (EEPARAM_REVISION));4f02: ff 20 and r15, r154f04: 29 f0 breq .+10 ; 0x4f10 <ParamSet_Init+0x1b2>/***************************************************//* Write Parameter to EEPROM as byte *//***************************************************/void SetParamByte(uint16_t param_id, uint8_t value){eeprom_write_byte((uint8_t*)(EEPROM_ADR_PARAM_BEGIN + param_id), value);4f06: 67 e6 ldi r22, 0x67 ; 1034f08: 81 e0 ldi r24, 0x01 ; 14f0a: 90 e0 ldi r25, 0x00 ; 04f0c: 0e 94 54 b2 call 0x164a8 ; 0x164a8 <__eewr_byte_m1284>4f10: e4 ed ldi r30, 0xD4 ; 2124f12: f5 e0 ldi r31, 0x05 ; 54f14: 84 e1 ldi r24, 0x14 ; 204f16: 96 e0 ldi r25, 0x06 ; 6// check all 5 parameter settingsfor (i = 1;i < 6; i++){if(ee_default || !ParamSet_ReadFromEEProm(i)) // could not read paramset from eeprom{bad_params = 1;4f18: 20 e0 ldi r18, 0x00 ; 0if(ee_default) SetParamByte(PID_EE_REVISION, (EEPARAM_REVISION));// determine motornumberRequiredMotors = 0;for(i = 0; i < 16; i++){if(Mixer.Motor[i][MIX_GAS] > 0) RequiredMotors++;4f1a: 30 81 ld r19, Z4f1c: 13 16 cp r1, r194f1e: 0c f4 brge .+2 ; 0x4f22 <ParamSet_Init+0x1c4>4f20: 2f 5f subi r18, 0xFF ; 2554f22: 34 96 adiw r30, 0x04 ; 4MixerTable_WriteToEEProm();}if(ee_default) SetParamByte(PID_EE_REVISION, (EEPARAM_REVISION));// determine motornumberRequiredMotors = 0;for(i = 0; i < 16; i++)4f24: e8 17 cp r30, r244f26: f9 07 cpc r31, r254f28: c1 f7 brne .-16 ; 0x4f1a <ParamSet_Init+0x1bc>4f2a: 20 93 3d 05 sts 0x053D, r18{if(Mixer.Motor[i][MIX_GAS] > 0) RequiredMotors++;}printf("\n\rMixer-Config: '%s' (%u Motors)",Mixer.Name, RequiredMotors);4f2e: 1f 92 push r14f30: 2f 93 push r184f32: 88 ec ldi r24, 0xC8 ; 2004f34: 95 e0 ldi r25, 0x05 ; 54f36: 9f 93 push r254f38: 8f 93 push r244f3a: 88 e3 ldi r24, 0x38 ; 564f3c: 92 e0 ldi r25, 0x02 ; 24f3e: 9f 93 push r254f40: 8f 93 push r244f42: 87 eb ldi r24, 0xB7 ; 1834f44: 9c ea ldi r25, 0xAC ; 1724f46: 9f 93 push r254f48: 8f 93 push r244f4a: e0 91 78 06 lds r30, 0x06784f4e: f0 91 79 06 lds r31, 0x06794f52: 09 95 icallPrintLine();// ("\n\r===================================");4f54: 0e 94 4b 59 call 0xb296 ; 0xb296 <PrintLine>4f58: 8d b7 in r24, 0x3d ; 614f5a: 9e b7 in r25, 0x3e ; 624f5c: 08 96 adiw r24, 0x08 ; 84f5e: 0f b6 in r0, 0x3f ; 634f60: f8 94 cli4f62: 9e bf out 0x3e, r25 ; 624f64: 0f be out 0x3f, r0 ; 634f66: 8d bf out 0x3d, r24 ; 61}4f68: df 91 pop r294f6a: cf 91 pop r284f6c: 1f 91 pop r174f6e: 0f 91 pop r164f70: ff 90 pop r154f72: ef 90 pop r144f74: df 90 pop r134f76: cf 90 pop r124f78: bf 90 pop r114f7a: af 90 pop r104f7c: 9f 90 pop r94f7e: 8f 90 pop r84f80: 08 95 ret00004f82 <CopyDebugValues>:// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++// Debugwerte zuordnen// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++void CopyDebugValues(void){4f82: cf 92 push r124f84: df 92 push r134f86: ef 92 push r144f88: ff 92 push r15DebugOut.Analog[0] = ToNaviCtrl.IntegralNick;//IntegralNick / (EE_Parameter.GyroAccFaktor * 4);4f8a: 80 91 ea 08 lds r24, 0x08EA4f8e: 90 91 eb 08 lds r25, 0x08EB4f92: 90 93 49 0c sts 0x0C49, r254f96: 80 93 48 0c sts 0x0C48, r24DebugOut.Analog[1] = ToNaviCtrl.IntegralRoll;//IntegralRoll / (EE_Parameter.GyroAccFaktor * 4);4f9a: 80 91 ec 08 lds r24, 0x08EC4f9e: 90 91 ed 08 lds r25, 0x08ED4fa2: 90 93 4b 0c sts 0x0C4B, r254fa6: 80 93 4a 0c sts 0x0C4A, r24DebugOut.Analog[2] = Mittelwert_AccNick / 4;4faa: 80 91 60 06 lds r24, 0x06604fae: 90 91 61 06 lds r25, 0x06614fb2: 99 23 and r25, r254fb4: 0c f4 brge .+2 ; 0x4fb8 <CopyDebugValues+0x36>4fb6: 03 96 adiw r24, 0x03 ; 34fb8: 95 95 asr r254fba: 87 95 ror r244fbc: 95 95 asr r254fbe: 87 95 ror r244fc0: 90 93 4d 0c sts 0x0C4D, r254fc4: 80 93 4c 0c sts 0x0C4C, r24DebugOut.Analog[3] = Mittelwert_AccRoll / 4;4fc8: 80 91 72 06 lds r24, 0x06724fcc: 90 91 73 06 lds r25, 0x06734fd0: 99 23 and r25, r254fd2: 0c f4 brge .+2 ; 0x4fd6 <CopyDebugValues+0x54>4fd4: 03 96 adiw r24, 0x03 ; 34fd6: 95 95 asr r254fd8: 87 95 ror r244fda: 95 95 asr r254fdc: 87 95 ror r244fde: 90 93 4f 0c sts 0x0C4F, r254fe2: 80 93 4e 0c sts 0x0C4E, r24DebugOut.Analog[4] = (signed int) AdNeutralGier - AdWertGier;4fe6: 20 91 61 03 lds r18, 0x03614fea: 30 91 62 03 lds r19, 0x03624fee: 80 91 53 04 lds r24, 0x04534ff2: 90 91 54 04 lds r25, 0x04544ff6: 82 1b sub r24, r184ff8: 93 0b sbc r25, r194ffa: 90 93 51 0c sts 0x0C51, r254ffe: 80 93 50 0c sts 0x0C50, r24DebugOut.Analog[5] = HoehenWert/10;5002: 60 91 fe 03 lds r22, 0x03FE5006: 70 91 ff 03 lds r23, 0x03FF500a: 80 91 00 04 lds r24, 0x0400500e: 90 91 01 04 lds r25, 0x04015012: 0f 2e mov r0, r315014: fa e0 ldi r31, 0x0A ; 105016: cf 2e mov r12, r315018: d1 2c mov r13, r1501a: e1 2c mov r14, r1501c: f1 2c mov r15, r1501e: f0 2d mov r31, r05020: a7 01 movw r20, r145022: 96 01 movw r18, r125024: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>5028: 30 93 53 0c sts 0x0C53, r19502c: 20 93 52 0c sts 0x0C52, r18DebugOut.Analog[6] = Aktuell_az;//AdWertAccHoch;//(Mess_Integral_Hoch / 512);5030: 80 91 06 05 lds r24, 0x05065034: 90 91 07 05 lds r25, 0x05075038: 90 93 55 0c sts 0x0C55, r25503c: 80 93 54 0c sts 0x0C54, r24DebugOut.Analog[8] = KompassValue;5040: 80 91 4e 01 lds r24, 0x014E5044: 90 91 4f 01 lds r25, 0x014F5048: 90 93 59 0c sts 0x0C59, r25504c: 80 93 58 0c sts 0x0C58, r24DebugOut.Analog[9] = UBat;5050: 80 91 1a 01 lds r24, 0x011A5054: 90 91 1b 01 lds r25, 0x011B5058: 90 93 5b 0c sts 0x0C5B, r25505c: 80 93 5a 0c sts 0x0C5A, r24DebugOut.Analog[10] = SenderOkay;5060: 80 91 04 04 lds r24, 0x04045064: 90 e0 ldi r25, 0x00 ; 05066: 90 93 5d 0c sts 0x0C5D, r25506a: 80 93 5c 0c sts 0x0C5C, r24DebugOut.Analog[11] = ErsatzKompassInGrad;506e: 80 91 21 06 lds r24, 0x06215072: 90 91 22 06 lds r25, 0x06225076: 90 93 5f 0c sts 0x0C5F, r25507a: 80 93 5e 0c sts 0x0C5E, r24DebugOut.Analog[12] = Motor[0].SetPoint;507e: 80 91 98 09 lds r24, 0x09985082: 90 e0 ldi r25, 0x00 ; 05084: 90 93 61 0c sts 0x0C61, r255088: 80 93 60 0c sts 0x0C60, r24DebugOut.Analog[13] = Motor[1].SetPoint;508c: 80 91 a7 09 lds r24, 0x09A75090: 90 e0 ldi r25, 0x00 ; 05092: 90 93 63 0c sts 0x0C63, r255096: 80 93 62 0c sts 0x0C62, r24DebugOut.Analog[14] = Motor[2].SetPoint;509a: 80 91 b6 09 lds r24, 0x09B6509e: 90 e0 ldi r25, 0x00 ; 050a0: 90 93 65 0c sts 0x0C65, r2550a4: 80 93 64 0c sts 0x0C64, r24DebugOut.Analog[15] = Motor[3].SetPoint;50a8: 80 91 c5 09 lds r24, 0x09C550ac: 90 e0 ldi r25, 0x00 ; 050ae: 90 93 67 0c sts 0x0C67, r2550b2: 80 93 66 0c sts 0x0C66, r24DebugOut.Analog[20] = ServoNickValue;50b6: 80 91 c6 04 lds r24, 0x04C650ba: 90 91 c7 04 lds r25, 0x04C750be: 90 93 71 0c sts 0x0C71, r2550c2: 80 93 70 0c sts 0x0C70, r24DebugOut.Analog[21] = HoverGas;50c6: 80 91 e8 03 lds r24, 0x03E850ca: 90 91 e9 03 lds r25, 0x03E950ce: 90 93 73 0c sts 0x0C73, r2550d2: 80 93 72 0c sts 0x0C72, r24DebugOut.Analog[22] = Capacity.ActualCurrent;50d6: 80 91 15 05 lds r24, 0x051550da: 90 91 16 05 lds r25, 0x051650de: 90 93 75 0c sts 0x0C75, r2550e2: 80 93 74 0c sts 0x0C74, r24DebugOut.Analog[23] = Capacity.UsedCapacity;50e6: 80 91 19 05 lds r24, 0x051950ea: 90 91 1a 05 lds r25, 0x051A50ee: 90 93 77 0c sts 0x0C77, r2550f2: 80 93 76 0c sts 0x0C76, r24DebugOut.Analog[24] = SollHoehe/10;50f6: 60 91 fa 03 lds r22, 0x03FA50fa: 70 91 fb 03 lds r23, 0x03FB50fe: 80 91 fc 03 lds r24, 0x03FC5102: 90 91 fd 03 lds r25, 0x03FD5106: a7 01 movw r20, r145108: 96 01 movw r18, r12510a: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>510e: 30 93 79 0c sts 0x0C79, r195112: 20 93 78 0c sts 0x0C78, r18// DebugOut.Analog[27] = KompassSollWert;DebugOut.Analog[29] = Capacity.MinOfMaxPWM;5116: 80 91 1b 05 lds r24, 0x051B511a: 90 e0 ldi r25, 0x00 ; 0511c: 90 93 83 0c sts 0x0C83, r255120: 80 93 82 0c sts 0x0C82, r24DebugOut.Analog[30] = GPS_Nick;5124: 80 91 6a 04 lds r24, 0x046A5128: 90 91 6b 04 lds r25, 0x046B512c: 90 93 85 0c sts 0x0C85, r255130: 80 93 84 0c sts 0x0C84, r24DebugOut.Analog[31] = GPS_Roll;5134: 80 91 68 04 lds r24, 0x04685138: 90 91 69 04 lds r25, 0x0469513c: 90 93 87 0c sts 0x0C87, r255140: 80 93 86 0c sts 0x0C86, r24if(VersionInfo.HardwareError[0] || VersionInfo.HardwareError[1]) DebugOut.Status[1] |= 1; else DebugOut.Status[1] &= 0xfe;5144: 80 91 62 0a lds r24, 0x0A625148: 81 11 cpse r24, r1514a: 04 c0 rjmp .+8 ; 0x5154 <CopyDebugValues+0x1d2>514c: 80 91 63 0a lds r24, 0x0A635150: 88 23 and r24, r245152: 31 f0 breq .+12 ; 0x5160 <CopyDebugValues+0x1de>5154: e7 e4 ldi r30, 0x47 ; 715156: fc e0 ldi r31, 0x0C ; 125158: 80 81 ld r24, Z515a: 81 60 ori r24, 0x01 ; 1515c: 80 83 st Z, r24515e: 05 c0 rjmp .+10 ; 0x516a <CopyDebugValues+0x1e8>5160: e7 e4 ldi r30, 0x47 ; 715162: fc e0 ldi r31, 0x0C ; 125164: 80 81 ld r24, Z5166: 8e 7f andi r24, 0xFE ; 2545168: 80 83 st Z, r24//DebugOut.Analog[17] = VarioMeter;//DebugOut.Analog[16] = GasIsZeroCnt;//DebugOut.Analog[18] = HoehenWertF;//DebugOut.Analog[25] = Parameter_Hoehe_P;//DebugOut.Analog[26] = Parameter_Luftdruck_D;}516a: ff 90 pop r15516c: ef 90 pop r14516e: df 90 pop r135170: cf 90 pop r125172: 08 95 ret00005174 <Piep>:void Piep(unsigned char Anzahl, unsigned int dauer){5174: ff 92 push r155176: 0f 93 push r165178: 1f 93 push r17517a: cf 93 push r28517c: df 93 push r29517e: 8b 01 movw r16, r22unsigned int wait = 0;if(MotorenEin) return; //auf keinen Fall im Flug!5180: 90 91 03 04 lds r25, 0x04035184: 91 11 cpse r25, r15186: 31 c0 rjmp .+98 ; 0x51ea <Piep+0x76>GRN_OFF;5188: 90 91 54 01 lds r25, 0x0154518c: 99 31 cpi r25, 0x19 ; 25518e: 11 f4 brne .+4 ; 0x5194 <Piep+0x20>5190: 29 98 cbi 0x05, 1 ; 55192: 21 c0 rjmp .+66 ; 0x51d6 <Piep+0x62>5194: 29 9a sbi 0x05, 1 ; 55196: 1f c0 rjmp .+62 ; 0x51d6 <Piep+0x62>while(Anzahl--){beeptime = dauer;5198: 10 93 ce 04 sts 0x04CE, r17519c: 00 93 cd 04 sts 0x04CD, r16wait = dauer;51a0: e8 01 movw r28, r16while(beeptime || wait)51a2: 0f c0 rjmp .+30 ; 0x51c2 <Piep+0x4e>{if(UpdateMotor)51a4: 90 91 d1 04 lds r25, 0x04D151a8: 99 23 and r25, r2551aa: 59 f0 breq .+22 ; 0x51c2 <Piep+0x4e>{UpdateMotor = 0;51ac: 10 92 d1 04 sts 0x04D1, r1if(!beeptime) wait--;51b0: 20 91 cd 04 lds r18, 0x04CD51b4: 30 91 ce 04 lds r19, 0x04CE51b8: 23 2b or r18, r1951ba: 09 f4 brne .+2 ; 0x51be <Piep+0x4a>51bc: 21 97 sbiw r28, 0x01 ; 1LIBFC_Polling();51be: 0e 94 16 1a call 0x342c ; 0x342c <LIBFC_Polling>GRN_OFF;while(Anzahl--){beeptime = dauer;wait = dauer;while(beeptime || wait)51c2: 20 91 cd 04 lds r18, 0x04CD51c6: 30 91 ce 04 lds r19, 0x04CE51ca: 23 2b or r18, r1951cc: 59 f7 brne .-42 ; 0x51a4 <Piep+0x30>51ce: 20 97 sbiw r28, 0x00 ; 051d0: 49 f7 brne .-46 ; 0x51a4 <Piep+0x30>51d2: fa 94 dec r1551d4: 01 c0 rjmp .+2 ; 0x51d8 <Piep+0x64>if(MotorenEin) return; //auf keinen Fall im Flug!GRN_OFF;while(Anzahl--){beeptime = dauer;wait = dauer;51d6: f8 2e mov r15, r24void Piep(unsigned char Anzahl, unsigned int dauer){unsigned int wait = 0;if(MotorenEin) return; //auf keinen Fall im Flug!GRN_OFF;while(Anzahl--)51d8: f1 10 cpse r15, r151da: de cf rjmp .-68 ; 0x5198 <Piep+0x24>if(!beeptime) wait--;LIBFC_Polling();};}}GRN_ON;51dc: 80 91 54 01 lds r24, 0x015451e0: 89 31 cpi r24, 0x19 ; 2551e2: 11 f4 brne .+4 ; 0x51e8 <Piep+0x74>51e4: 29 9a sbi 0x05, 1 ; 551e6: 01 c0 rjmp .+2 ; 0x51ea <Piep+0x76>51e8: 29 98 cbi 0x05, 1 ; 5}51ea: df 91 pop r2951ec: cf 91 pop r2851ee: 1f 91 pop r1751f0: 0f 91 pop r1651f2: ff 90 pop r1551f4: 08 95 ret000051f6 <CalibrierMittelwert>:void CalibrierMittelwert(void)//############################################################################{// if(PlatinenVersion == 13) SucheGyroOffset();// ADC auschalten, damit die Werte sich nicht während der Berechnung ändernANALOG_OFF;51f6: ea e7 ldi r30, 0x7A ; 12251f8: f0 e0 ldi r31, 0x00 ; 051fa: 10 82 st Z, r1MesswertNick = AdWertNick;51fc: 80 91 65 03 lds r24, 0x03655200: 90 91 66 03 lds r25, 0x03665204: 90 93 28 06 sts 0x0628, r255208: 80 93 27 06 sts 0x0627, r24MesswertRoll = AdWertRoll;520c: 80 91 63 03 lds r24, 0x03635210: 90 91 64 03 lds r25, 0x03645214: 90 93 1d 06 sts 0x061D, r255218: 80 93 1c 06 sts 0x061C, r24MesswertGier = AdWertGier;521c: 80 91 61 03 lds r24, 0x03615220: 90 91 62 03 lds r25, 0x03625224: 90 93 68 06 sts 0x0668, r255228: 80 93 67 06 sts 0x0667, r24Mittelwert_AccNick = ACC_AMPLIFY * AdWertAccNick;522c: 80 91 5d 03 lds r24, 0x035D5230: 90 91 5e 03 lds r25, 0x035E5234: 9c 01 movw r18, r245236: 22 0f add r18, r185238: 33 1f adc r19, r19523a: 82 0f add r24, r18523c: 93 1f adc r25, r19523e: 88 0f add r24, r245240: 99 1f adc r25, r255242: 90 93 61 06 sts 0x0661, r255246: 80 93 60 06 sts 0x0660, r24Mittelwert_AccRoll = ACC_AMPLIFY * AdWertAccRoll;524a: 80 91 5f 03 lds r24, 0x035F524e: 90 91 60 03 lds r25, 0x03605252: 9c 01 movw r18, r245254: 22 0f add r18, r185256: 33 1f adc r19, r195258: 82 0f add r24, r18525a: 93 1f adc r25, r19525c: 88 0f add r24, r24525e: 99 1f adc r25, r255260: 90 93 73 06 sts 0x0673, r255264: 80 93 72 06 sts 0x0672, r24// ADC einschaltenANALOG_ON;5268: 8f ec ldi r24, 0xCF ; 207526a: 80 83 st Z, r24Umschlag180Nick = (long) EE_Parameter.WinkelUmschlagNick * 2500L;526c: 20 91 7f 05 lds r18, 0x057F5270: 30 e0 ldi r19, 0x00 ; 05272: a4 ec ldi r26, 0xC4 ; 1965274: b9 e0 ldi r27, 0x09 ; 95276: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>527a: 60 93 46 01 sts 0x0146, r22527e: 70 93 47 01 sts 0x0147, r235282: 80 93 48 01 sts 0x0148, r245286: 90 93 49 01 sts 0x0149, r25Umschlag180Roll = (long) EE_Parameter.WinkelUmschlagRoll * 2500L;528a: 20 91 80 05 lds r18, 0x0580528e: 30 e0 ldi r19, 0x00 ; 05290: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>5294: 60 93 42 01 sts 0x0142, r225298: 70 93 43 01 sts 0x0143, r23529c: 80 93 44 01 sts 0x0144, r2452a0: 90 93 45 01 sts 0x0145, r2552a4: 08 95 ret000052a6 <SetNeutral>:// Parameter: 1 -> before Start// Parameter: 2 -> calibrate and store ACC// Parameter: 3 -> use stored Gyro calibration Data from EEPROMunsigned char SetNeutral(unsigned char AdjustmentMode) // retuns: "sucess"//############################################################################{52a6: 8f 92 push r852a8: 9f 92 push r952aa: af 92 push r1052ac: bf 92 push r1152ae: cf 92 push r1252b0: df 92 push r1352b2: ef 92 push r1452b4: ff 92 push r1552b6: 0f 93 push r1652b8: 1f 93 push r1752ba: cf 93 push r2852bc: df 93 push r2952be: c8 2f mov r28, r24unsigned char i, sucess = 1;unsigned int gier_neutral = 0, nick_neutral = 0, roll_neutral = 0, acc_z_neutral = 0, barotest;VersionInfo.HardwareError[0] = 0;52c0: 10 92 62 0a sts 0x0A62, r1// HEF4017Reset_ON;NeutralAccX = 0;52c4: 10 92 4e 04 sts 0x044E, r152c8: 10 92 4d 04 sts 0x044D, r1NeutralAccY = 0;52cc: 10 92 4c 04 sts 0x044C, r152d0: 10 92 4b 04 sts 0x044B, r1NeutralAccZ = 0;52d4: 10 92 48 04 sts 0x0448, r152d8: 10 92 47 04 sts 0x0447, r1NeutralAccZfine = 0;52dc: 10 92 46 04 sts 0x0446, r1AdNeutralNick = 0;52e0: 10 92 58 04 sts 0x0458, r152e4: 10 92 57 04 sts 0x0457, r1AdNeutralRoll = 0;52e8: 10 92 56 04 sts 0x0456, r152ec: 10 92 55 04 sts 0x0455, r1AdNeutralGier = 0;52f0: 10 92 54 04 sts 0x0454, r152f4: 10 92 53 04 sts 0x0453, r1Parameter_AchsKopplung1 = 0;52f8: 10 92 2a 01 sts 0x012A, r1Parameter_AchsKopplung2 = 0;52fc: 10 92 29 01 sts 0x0129, r1ExpandBaro = 0;5300: 10 92 56 03 sts 0x0356, r1if(AdjustmentMode == 3) FC_StatusFlags3 |= FC_STATUS3_BOAT;5304: 83 30 cpi r24, 0x03 ; 35306: 29 f4 brne .+10 ; 0x5312 <SetNeutral+0x6c>5308: 80 91 c9 03 lds r24, 0x03C9530c: 82 60 ori r24, 0x02 ; 2530e: 80 93 c9 03 sts 0x03C9, r24// else FC_StatusFlags3 &= ~FC_STATUS3_BOAT; -> do not clear thatCalibrierMittelwert();5312: 71 df rcall .-286 ; 0x51f6 <CalibrierMittelwert>Delay_ms_Mess(100);5314: 84 e6 ldi r24, 0x64 ; 1005316: 90 e0 ldi r25, 0x00 ; 05318: 0e 94 6e 9c call 0x138dc ; 0x138dc <Delay_ms_Mess>CalibrierMittelwert();531c: 6c df rcall .-296 ; 0x51f6 <CalibrierMittelwert>if((EE_Parameter.GlobalConfig & CFG_HOEHENREGELUNG)) // Höhenregelung aktiviert?531e: 80 91 4b 05 lds r24, 0x054B5322: 80 ff sbrs r24, 05324: 13 c0 rjmp .+38 ; 0x534c <SetNeutral+0xa6>{if((MessLuftdruck > 950) || (MessLuftdruck < 750) || ExpandBaro) SucheLuftruckOffset();5326: 80 91 10 01 lds r24, 0x0110532a: 90 91 11 01 lds r25, 0x0111532e: 87 3b cpi r24, 0xB7 ; 1835330: 93 40 sbci r25, 0x03 ; 35332: 50 f4 brcc .+20 ; 0x5348 <SetNeutral+0xa2>5334: 80 91 10 01 lds r24, 0x01105338: 90 91 11 01 lds r25, 0x0111533c: 8e 3e cpi r24, 0xEE ; 238533e: 92 40 sbci r25, 0x02 ; 25340: 18 f0 brcs .+6 ; 0x5348 <SetNeutral+0xa2>5342: 80 91 56 03 lds r24, 0x03565346: 81 11 cpse r24, r15348: 0e 94 4b 1b call 0x3696 ; 0x3696 <SucheLuftruckOffset>}barotest = MessLuftdruck;534c: 00 91 10 01 lds r16, 0x01105350: 10 91 11 01 lds r17, 0x0111#define NEUTRAL_FILTER 32OCR0A += OPA_OFFSET_STEP;5354: 87 b5 in r24, 0x27 ; 395356: 8b 5f subi r24, 0xFB ; 2515358: 87 bd out 0x27, r24 ; 39OCR0B = 255 - OCR0A;535a: 87 b5 in r24, 0x27 ; 39535c: 80 95 com r24535e: 88 bd out 0x28, r24 ; 405360: d0 e2 ldi r29, 0x20 ; 32// Parameter: 3 -> use stored Gyro calibration Data from EEPROMunsigned char SetNeutral(unsigned char AdjustmentMode) // retuns: "sucess"//############################################################################{unsigned char i, sucess = 1;unsigned int gier_neutral = 0, nick_neutral = 0, roll_neutral = 0, acc_z_neutral = 0, barotest;5362: e1 2c mov r14, r15364: f1 2c mov r15, r15366: a1 2c mov r10, r15368: b1 2c mov r11, r1536a: 81 2c mov r8, r1536c: 91 2c mov r9, r1536e: c1 2c mov r12, r15370: d1 2c mov r13, r1#define NEUTRAL_FILTER 32OCR0A += OPA_OFFSET_STEP;OCR0B = 255 - OCR0A;for(i=0; i<NEUTRAL_FILTER; i++){Delay_ms_Mess(10);5372: 8a e0 ldi r24, 0x0A ; 105374: 90 e0 ldi r25, 0x00 ; 05376: 0e 94 6e 9c call 0x138dc ; 0x138dc <Delay_ms_Mess>gier_neutral += AdWertGier;537a: 80 91 61 03 lds r24, 0x0361537e: 90 91 62 03 lds r25, 0x03625382: c8 0e add r12, r245384: d9 1e adc r13, r25nick_neutral += AdWertNick;5386: 80 91 65 03 lds r24, 0x0365538a: 90 91 66 03 lds r25, 0x0366538e: 88 0e add r8, r245390: 99 1e adc r9, r25roll_neutral += AdWertRoll;5392: 80 91 63 03 lds r24, 0x03635396: 90 91 64 03 lds r25, 0x0364539a: a8 0e add r10, r24539c: b9 1e adc r11, r25acc_z_neutral += Aktuell_az;539e: 80 91 06 05 lds r24, 0x050653a2: 90 91 07 05 lds r25, 0x050753a6: e8 0e add r14, r2453a8: f9 1e adc r15, r2553aa: d1 50 subi r29, 0x01 ; 1barotest = MessLuftdruck;#define NEUTRAL_FILTER 32OCR0A += OPA_OFFSET_STEP;OCR0B = 255 - OCR0A;for(i=0; i<NEUTRAL_FILTER; i++)53ac: 11 f7 brne .-60 ; 0x5372 <SetNeutral+0xcc>gier_neutral += AdWertGier;nick_neutral += AdWertNick;roll_neutral += AdWertRoll;acc_z_neutral += Aktuell_az;}if(MessLuftdruck < 1010 && MessLuftdruck > 20) BaroStep = barotest - MessLuftdruck;53ae: 80 91 10 01 lds r24, 0x011053b2: 90 91 11 01 lds r25, 0x011153b6: 82 3f cpi r24, 0xF2 ; 24253b8: 93 40 sbci r25, 0x03 ; 353ba: 80 f4 brcc .+32 ; 0x53dc <SetNeutral+0x136>53bc: 80 91 10 01 lds r24, 0x011053c0: 90 91 11 01 lds r25, 0x011153c4: 45 97 sbiw r24, 0x15 ; 2153c6: 50 f0 brcs .+20 ; 0x53dc <SetNeutral+0x136>53c8: 80 91 10 01 lds r24, 0x011053cc: 90 91 11 01 lds r25, 0x011153d0: 08 1b sub r16, r2453d2: 19 0b sbc r17, r2553d4: 10 93 0e 01 sts 0x010E, r1753d8: 00 93 0d 01 sts 0x010D, r16OCR0A -= OPA_OFFSET_STEP;53dc: 87 b5 in r24, 0x27 ; 3953de: 85 50 subi r24, 0x05 ; 553e0: 87 bd out 0x27, r24 ; 39OCR0B = 255 - OCR0A;53e2: 87 b5 in r24, 0x27 ; 3953e4: 80 95 com r2453e6: 88 bd out 0x28, r24 ; 40AdNeutralNick = (nick_neutral+NEUTRAL_FILTER/2) / (NEUTRAL_FILTER / 8);53e8: 80 e1 ldi r24, 0x10 ; 1653ea: 88 0e add r8, r2453ec: 91 1c adc r9, r153ee: 96 94 lsr r953f0: 87 94 ror r853f2: 96 94 lsr r953f4: 87 94 ror r853f6: 90 92 58 04 sts 0x0458, r953fa: 80 92 57 04 sts 0x0457, r8AdNeutralRoll = (roll_neutral+NEUTRAL_FILTER/2) / (NEUTRAL_FILTER / 8);53fe: 20 e1 ldi r18, 0x10 ; 165400: a2 0e add r10, r185402: b1 1c adc r11, r15404: b6 94 lsr r115406: a7 94 ror r105408: b6 94 lsr r11540a: a7 94 ror r10540c: b0 92 56 04 sts 0x0456, r115410: a0 92 55 04 sts 0x0455, r10AdNeutralGier = (gier_neutral+NEUTRAL_FILTER/2) / (NEUTRAL_FILTER);5414: 40 e1 ldi r20, 0x10 ; 165416: c4 0e add r12, r205418: d1 1c adc r13, r1541a: d6 94 lsr r13541c: c7 94 ror r12541e: d6 94 lsr r135420: c7 94 ror r125422: d6 94 lsr r135424: c7 94 ror r125426: d6 94 lsr r135428: c7 94 ror r12542a: d6 94 lsr r13542c: c7 94 ror r12542e: d0 92 54 04 sts 0x0454, r135432: c0 92 53 04 sts 0x0453, r12NeutralAccZ = (acc_z_neutral+NEUTRAL_FILTER/2) / (NEUTRAL_FILTER);5436: 60 e1 ldi r22, 0x10 ; 165438: e6 0e add r14, r22543a: f1 1c adc r15, r1543c: f6 94 lsr r15543e: e7 94 ror r145440: f6 94 lsr r155442: e7 94 ror r145444: f6 94 lsr r155446: e7 94 ror r145448: f6 94 lsr r15544a: e7 94 ror r14544c: f6 94 lsr r15544e: e7 94 ror r145450: f0 92 48 04 sts 0x0448, r155454: e0 92 47 04 sts 0x0447, r14StartNeutralRoll = AdNeutralRoll;5458: b0 92 52 04 sts 0x0452, r11545c: a0 92 51 04 sts 0x0451, r10StartNeutralNick = AdNeutralNick;5460: 90 92 50 04 sts 0x0450, r95464: 80 92 4f 04 sts 0x044F, r8if(AdjustmentMode == 2)5468: c2 30 cpi r28, 0x02 ; 2546a: 09 f0 breq .+2 ; 0x546e <SetNeutral+0x1c8>546c: 4c c0 rjmp .+152 ; 0x5506 <SetNeutral+0x260>{NeutralAccX = abs(Mittelwert_AccNick) / (2*ACC_AMPLIFY);546e: 80 91 60 06 lds r24, 0x06605472: 90 91 61 06 lds r25, 0x06615476: 99 23 and r25, r255478: 1c f4 brge .+6 ; 0x5480 <SetNeutral+0x1da>547a: 91 95 neg r25547c: 81 95 neg r24547e: 91 09 sbc r25, r15480: 6c e0 ldi r22, 0x0C ; 125482: 70 e0 ldi r23, 0x00 ; 05484: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>5488: 9b 01 movw r18, r22548a: 70 93 4e 04 sts 0x044E, r23548e: 60 93 4d 04 sts 0x044D, r22NeutralAccY = abs(Mittelwert_AccRoll) / (2*ACC_AMPLIFY);5492: 80 91 72 06 lds r24, 0x06725496: 90 91 73 06 lds r25, 0x0673549a: 99 23 and r25, r25549c: 1c f4 brge .+6 ; 0x54a4 <SetNeutral+0x1fe>549e: 91 95 neg r2554a0: 81 95 neg r2454a2: 91 09 sbc r25, r154a4: 6c e0 ldi r22, 0x0C ; 1254a6: 70 e0 ldi r23, 0x00 ; 054a8: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>54ac: 70 93 4c 04 sts 0x044C, r2354b0: 60 93 4b 04 sts 0x044B, r22// Save ACC neutral settings to eepromSetParamWord(PID_ACC_NICK, (uint16_t)NeutralAccX);54b4: b9 01 movw r22, r1854b6: 84 e0 ldi r24, 0x04 ; 454b8: 90 e0 ldi r25, 0x00 ; 054ba: ed da rcall .-2598 ; 0x4a96 <SetParamWord>SetParamWord(PID_ACC_ROLL, (uint16_t)NeutralAccY);54bc: 60 91 4b 04 lds r22, 0x044B54c0: 70 91 4c 04 lds r23, 0x044C54c4: 86 e0 ldi r24, 0x06 ; 654c6: 90 e0 ldi r25, 0x00 ; 054c8: e6 da rcall .-2612 ; 0x4a96 <SetParamWord>SetParamWord(PID_ACC_TOP, (uint16_t)NeutralAccZ);54ca: 60 91 47 04 lds r22, 0x044754ce: 70 91 48 04 lds r23, 0x044854d2: 88 e0 ldi r24, 0x08 ; 854d4: 90 e0 ldi r25, 0x00 ; 054d6: df da rcall .-2626 ; 0x4a96 <SetParamWord>SetParamWord(PID_GYRO_NICK,(uint16_t)AdNeutralNick);54d8: 60 91 57 04 lds r22, 0x045754dc: 70 91 58 04 lds r23, 0x045854e0: 82 e1 ldi r24, 0x12 ; 1854e2: 90 e0 ldi r25, 0x00 ; 054e4: d8 da rcall .-2640 ; 0x4a96 <SetParamWord>SetParamWord(PID_GYRO_ROLL,(uint16_t)AdNeutralRoll);54e6: 60 91 55 04 lds r22, 0x045554ea: 70 91 56 04 lds r23, 0x045654ee: 84 e1 ldi r24, 0x14 ; 2054f0: 90 e0 ldi r25, 0x00 ; 054f2: d1 da rcall .-2654 ; 0x4a96 <SetParamWord>SetParamWord(PID_GYRO_YAW,(uint16_t)AdNeutralGier);54f4: 60 91 53 04 lds r22, 0x045354f8: 70 91 54 04 lds r23, 0x045454fc: 86 e1 ldi r24, 0x16 ; 2254fe: 90 e0 ldi r25, 0x00 ; 05500: ca da rcall .-2668 ; 0x4a96 <SetParamWord>// Parameter: 2 -> calibrate and store ACC// Parameter: 3 -> use stored Gyro calibration Data from EEPROMunsigned char SetNeutral(unsigned char AdjustmentMode) // retuns: "sucess"//############################################################################{unsigned char i, sucess = 1;5502: d1 e0 ldi r29, 0x01 ; 15504: 91 c0 rjmp .+290 ; 0x5628 <SetNeutral+0x382>SetParamWord(PID_GYRO_YAW,(uint16_t)AdNeutralGier);}else{// restore from eepromNeutralAccX = (int16_t)GetParamWord(PID_ACC_NICK);5506: 84 e0 ldi r24, 0x04 ; 45508: 90 e0 ldi r25, 0x00 ; 0550a: c2 da rcall .-2684 ; 0x4a90 <GetParamWord>550c: 90 93 4e 04 sts 0x044E, r255510: 80 93 4d 04 sts 0x044D, r24NeutralAccY = (int16_t)GetParamWord(PID_ACC_ROLL);5514: 86 e0 ldi r24, 0x06 ; 65516: 90 e0 ldi r25, 0x00 ; 05518: bb da rcall .-2698 ; 0x4a90 <GetParamWord>551a: 90 93 4c 04 sts 0x044C, r25551e: 80 93 4b 04 sts 0x044B, r24// strange settings?if(((unsigned int) NeutralAccX > 2048) || ((unsigned int) NeutralAccY > 2048)/* || ((unsigned int) NeutralAccZ > 1024)*/)5522: 20 91 4d 04 lds r18, 0x044D5526: 30 91 4e 04 lds r19, 0x044E552a: 21 30 cpi r18, 0x01 ; 1552c: 38 40 sbci r19, 0x08 ; 8552e: 18 f4 brcc .+6 ; 0x5536 <SetNeutral+0x290>5530: 81 30 cpi r24, 0x01 ; 15532: 98 40 sbci r25, 0x08 ; 85534: a8 f1 brcs .+106 ; 0x55a0 <SetNeutral+0x2fa>{printf("\n\rACC not calibrated!\r\n");5536: 85 e0 ldi r24, 0x05 ; 55538: 93 e0 ldi r25, 0x03 ; 3553a: 9f 93 push r25553c: 8f 93 push r24553e: 87 eb ldi r24, 0xB7 ; 1835540: 9c ea ldi r25, 0xAC ; 1725542: 9f 93 push r255544: 8f 93 push r245546: e0 91 78 06 lds r30, 0x0678554a: f0 91 79 06 lds r31, 0x0679554e: 09 95 icallNeutralAccX = abs(Mittelwert_AccNick) / (2*ACC_AMPLIFY);5550: 80 91 60 06 lds r24, 0x06605554: 90 91 61 06 lds r25, 0x06615558: 99 23 and r25, r25555a: 1c f4 brge .+6 ; 0x5562 <SetNeutral+0x2bc>555c: 91 95 neg r25555e: 81 95 neg r245560: 91 09 sbc r25, r15562: 6c e0 ldi r22, 0x0C ; 125564: 70 e0 ldi r23, 0x00 ; 05566: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>556a: 70 93 4e 04 sts 0x044E, r23556e: 60 93 4d 04 sts 0x044D, r22NeutralAccY = abs(Mittelwert_AccRoll) / (2*ACC_AMPLIFY);5572: 80 91 72 06 lds r24, 0x06725576: 90 91 73 06 lds r25, 0x0673557a: 99 23 and r25, r25557c: 1c f4 brge .+6 ; 0x5584 <SetNeutral+0x2de>557e: 91 95 neg r255580: 81 95 neg r245582: 91 09 sbc r25, r15584: 6c e0 ldi r22, 0x0C ; 125586: 70 e0 ldi r23, 0x00 ; 05588: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>558c: 70 93 4c 04 sts 0x044C, r235590: 60 93 4b 04 sts 0x044B, r225594: 0f 90 pop r05596: 0f 90 pop r05598: 0f 90 pop r0559a: 0f 90 pop r0sucess = 0;559c: d0 e0 ldi r29, 0x00 ; 0559e: 01 c0 rjmp .+2 ; 0x55a2 <SetNeutral+0x2fc>// Parameter: 2 -> calibrate and store ACC// Parameter: 3 -> use stored Gyro calibration Data from EEPROMunsigned char SetNeutral(unsigned char AdjustmentMode) // retuns: "sucess"//############################################################################{unsigned char i, sucess = 1;55a0: d1 e0 ldi r29, 0x01 ; 1printf("\n\rACC not calibrated!\r\n");NeutralAccX = abs(Mittelwert_AccNick) / (2*ACC_AMPLIFY);NeutralAccY = abs(Mittelwert_AccRoll) / (2*ACC_AMPLIFY);sucess = 0;}if(FC_StatusFlags3 & FC_STATUS3_BOAT) // Read Gyro Data from eeprom55a2: 80 91 c9 03 lds r24, 0x03C955a6: 81 ff sbrs r24, 155a8: 3f c0 rjmp .+126 ; 0x5628 <SetNeutral+0x382>{unsigned int nick, roll, gier;// restore from eepromnick = (int16_t)GetParamWord(PID_GYRO_NICK);55aa: 82 e1 ldi r24, 0x12 ; 1855ac: 90 e0 ldi r25, 0x00 ; 055ae: 70 da rcall .-2848 ; 0x4a90 <GetParamWord>55b0: 8c 01 movw r16, r24roll = (int16_t)GetParamWord(PID_GYRO_ROLL);55b2: 84 e1 ldi r24, 0x14 ; 2055b4: 90 e0 ldi r25, 0x00 ; 055b6: 6c da rcall .-2856 ; 0x4a90 <GetParamWord>55b8: 7c 01 movw r14, r24gier = (int16_t)GetParamWord(PID_GYRO_YAW);55ba: 86 e1 ldi r24, 0x16 ; 2255bc: 90 e0 ldi r25, 0x00 ; 055be: 68 da rcall .-2864 ; 0x4a90 <GetParamWord>// strange settings?if(((unsigned int) nick > (600 * 16)) || ((unsigned int) nick < (400 * 16))55c0: 98 01 movw r18, r1655c2: 39 51 subi r19, 0x19 ; 2555c4: 21 38 cpi r18, 0x81 ; 12955c6: 3c 40 sbci r19, 0x0C ; 1255c8: 58 f4 brcc .+22 ; 0x55e0 <SetNeutral+0x33a>|| ((unsigned int) roll > (600 * 16)) || ((unsigned int) roll < (400 * 16))55ca: 97 01 movw r18, r1455cc: 39 51 subi r19, 0x19 ; 2555ce: 21 38 cpi r18, 0x81 ; 12955d0: 3c 40 sbci r19, 0x0C ; 1255d2: 30 f4 brcc .+12 ; 0x55e0 <SetNeutral+0x33a>|| ((unsigned int) gier > (600 * 2)) || ((unsigned int) gier < (400 * 2)))55d4: 9c 01 movw r18, r2455d6: 20 52 subi r18, 0x20 ; 3255d8: 33 40 sbci r19, 0x03 ; 355da: 21 39 cpi r18, 0x91 ; 14555dc: 31 40 sbci r19, 0x01 ; 155de: c0 f0 brcs .+48 ; 0x5610 <SetNeutral+0x36a>{printf("\n\rGyro calibration data not valid\r\n");55e0: 81 ee ldi r24, 0xE1 ; 22555e2: 92 e0 ldi r25, 0x02 ; 255e4: 9f 93 push r2555e6: 8f 93 push r2455e8: 87 eb ldi r24, 0xB7 ; 18355ea: 9c ea ldi r25, 0xAC ; 17255ec: 9f 93 push r2555ee: 8f 93 push r2455f0: e0 91 78 06 lds r30, 0x067855f4: f0 91 79 06 lds r31, 0x067955f8: 09 95 icallsucess = 0;FC_StatusFlags3 &= ~FC_STATUS3_BOAT;55fa: 80 91 c9 03 lds r24, 0x03C955fe: 8d 7f andi r24, 0xFD ; 2535600: 80 93 c9 03 sts 0x03C9, r245604: 0f 90 pop r05606: 0f 90 pop r05608: 0f 90 pop r0560a: 0f 90 pop r0if(((unsigned int) nick > (600 * 16)) || ((unsigned int) nick < (400 * 16))|| ((unsigned int) roll > (600 * 16)) || ((unsigned int) roll < (400 * 16))|| ((unsigned int) gier > (600 * 2)) || ((unsigned int) gier < (400 * 2))){printf("\n\rGyro calibration data not valid\r\n");sucess = 0;560c: d0 e0 ldi r29, 0x00 ; 0FC_StatusFlags3 &= ~FC_STATUS3_BOAT;560e: 0c c0 rjmp .+24 ; 0x5628 <SetNeutral+0x382>}else{AdNeutralNick = nick;5610: 10 93 58 04 sts 0x0458, r175614: 00 93 57 04 sts 0x0457, r16AdNeutralRoll = roll;5618: f0 92 56 04 sts 0x0456, r15561c: e0 92 55 04 sts 0x0455, r14AdNeutralGier = gier;5620: 90 93 54 04 sts 0x0454, r255624: 80 93 53 04 sts 0x0453, r24}}}EEAR = EE_DUMMY; // Set the EEPROM Address pointer to an unused space5628: 12 bc out 0x22, r1 ; 34562a: 11 bc out 0x21, r1 ; 33MesswertNick = 0;562c: 10 92 28 06 sts 0x0628, r15630: 10 92 27 06 sts 0x0627, r1MesswertRoll = 0;5634: 10 92 1d 06 sts 0x061D, r15638: 10 92 1c 06 sts 0x061C, r1MesswertGier = 0;563c: 10 92 68 06 sts 0x0668, r15640: 10 92 67 06 sts 0x0667, r1Delay_ms_Mess(200);5644: 88 ec ldi r24, 0xC8 ; 2005646: 90 e0 ldi r25, 0x00 ; 05648: 0e 94 6e 9c call 0x138dc ; 0x138dc <Delay_ms_Mess>Mittelwert_AccNick = ACC_AMPLIFY * AdWertAccNick;564c: 80 91 5d 03 lds r24, 0x035D5650: 90 91 5e 03 lds r25, 0x035E5654: dc 01 movw r26, r245656: aa 0f add r26, r265658: bb 1f adc r27, r27565a: 8a 0f add r24, r26565c: 9b 1f adc r25, r27565e: dc 01 movw r26, r245660: aa 0f add r26, r265662: bb 1f adc r27, r275664: b0 93 61 06 sts 0x0661, r275668: a0 93 60 06 sts 0x0660, r26Mittelwert_AccRoll = ACC_AMPLIFY * AdWertAccRoll;566c: 80 91 5f 03 lds r24, 0x035F5670: 90 91 60 03 lds r25, 0x03605674: fc 01 movw r30, r245676: ee 0f add r30, r305678: ff 1f adc r31, r31567a: 8e 0f add r24, r30567c: 9f 1f adc r25, r31567e: fc 01 movw r30, r245680: ee 0f add r30, r305682: ff 1f adc r31, r315684: f0 93 73 06 sts 0x0673, r315688: e0 93 72 06 sts 0x0672, r30IntegralNick = EE_Parameter.GyroAccFaktor * (long)Mittelwert_AccNick;568c: 80 90 5a 05 lds r8, 0x055A5690: 91 2c mov r9, r15692: a1 2c mov r10, r15694: b1 2c mov r11, r15696: a5 01 movw r20, r105698: 94 01 movw r18, r8569a: 0e 94 d2 b1 call 0x163a4 ; 0x163a4 <__mulshisi3>569e: 6b 01 movw r12, r2256a0: 7c 01 movw r14, r2456a2: 60 93 42 04 sts 0x0442, r2256a6: 70 93 43 04 sts 0x0443, r2356aa: 80 93 44 04 sts 0x0444, r2456ae: 90 93 45 04 sts 0x0445, r25IntegralRoll = EE_Parameter.GyroAccFaktor * (long)Mittelwert_AccRoll;56b2: df 01 movw r26, r3056b4: 0e 94 d2 b1 call 0x163a4 ; 0x163a4 <__mulshisi3>56b8: 60 93 3e 04 sts 0x043E, r2256bc: 70 93 3f 04 sts 0x043F, r2356c0: 80 93 40 04 sts 0x0440, r2456c4: 90 93 41 04 sts 0x0441, r25Mess_IntegralNick = IntegralNick;56c8: c0 92 36 04 sts 0x0436, r1256cc: d0 92 37 04 sts 0x0437, r1356d0: e0 92 38 04 sts 0x0438, r1456d4: f0 92 39 04 sts 0x0439, r15Mess_IntegralRoll = IntegralRoll;56d8: 60 93 32 04 sts 0x0432, r2256dc: 70 93 33 04 sts 0x0433, r2356e0: 80 93 34 04 sts 0x0434, r2456e4: 90 93 35 04 sts 0x0435, r25Mess_Integral_Gier = 0;56e8: 10 92 2e 04 sts 0x042E, r156ec: 10 92 2f 04 sts 0x042F, r156f0: 10 92 30 04 sts 0x0430, r156f4: 10 92 31 04 sts 0x0431, r1KompassSollWert = KompassValue;56f8: e0 91 4e 01 lds r30, 0x014E56fc: f0 91 4f 01 lds r31, 0x014F5700: f0 93 1d 04 sts 0x041D, r315704: e0 93 1c 04 sts 0x041C, r30KompassSignalSchlecht = 100;5708: 84 e6 ldi r24, 0x64 ; 100570a: 90 e0 ldi r25, 0x00 ; 0570c: 90 93 4b 01 sts 0x014B, r255710: 80 93 4a 01 sts 0x014A, r24Umschlag180Nick = ((long) EE_Parameter.WinkelUmschlagNick * 2500L) + 15000L;5714: 20 91 7f 05 lds r18, 0x057F5718: 30 e0 ldi r19, 0x00 ; 0571a: a4 ec ldi r26, 0xC4 ; 196571c: b9 e0 ldi r27, 0x09 ; 9571e: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>5722: dc 01 movw r26, r245724: cb 01 movw r24, r225726: 88 56 subi r24, 0x68 ; 1045728: 95 4c sbci r25, 0xC5 ; 197572a: af 4f sbci r26, 0xFF ; 255572c: bf 4f sbci r27, 0xFF ; 255572e: 80 93 46 01 sts 0x0146, r245732: 90 93 47 01 sts 0x0147, r255736: a0 93 48 01 sts 0x0148, r26573a: b0 93 49 01 sts 0x0149, r27Umschlag180Roll = ((long) EE_Parameter.WinkelUmschlagRoll * 2500L) + 15000L;573e: 20 91 80 05 lds r18, 0x05805742: 30 e0 ldi r19, 0x00 ; 05744: a4 ec ldi r26, 0xC4 ; 1965746: b9 e0 ldi r27, 0x09 ; 95748: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>574c: dc 01 movw r26, r24574e: cb 01 movw r24, r225750: 88 56 subi r24, 0x68 ; 1045752: 95 4c sbci r25, 0xC5 ; 1975754: af 4f sbci r26, 0xFF ; 2555756: bf 4f sbci r27, 0xFF ; 2555758: 80 93 42 01 sts 0x0142, r24575c: 90 93 43 01 sts 0x0143, r255760: a0 93 44 01 sts 0x0144, r265764: b0 93 45 01 sts 0x0145, r27ExternHoehenValue = 0;5768: 10 92 26 01 sts 0x0126, r1576c: 10 92 25 01 sts 0x0125, r1ErsatzKompass = KompassValue * GIER_GRAD_FAKTOR;5770: 20 91 21 01 lds r18, 0x01215774: 30 91 22 01 lds r19, 0x01225778: 40 91 23 01 lds r20, 0x0123577c: 50 91 24 01 lds r21, 0x01245780: df 01 movw r26, r305782: 0e 94 d2 b1 call 0x163a4 ; 0x163a4 <__mulshisi3>5786: 60 93 6e 06 sts 0x066E, r22578a: 70 93 6f 06 sts 0x066F, r23578e: 80 93 70 06 sts 0x0670, r245792: 90 93 71 06 sts 0x0671, r25GierGyroFehler = 0;5796: 10 92 19 04 sts 0x0419, r1579a: 10 92 18 04 sts 0x0418, r1LED_Init();579e: 0e 94 80 85 call 0x10b00 ; 0x10b00 <LED_Init>if(AdjustmentMode != 0) FC_StatusFlags |= FC_STATUS_CALIBRATE;57a2: cc 23 and r28, r2857a4: 29 f0 breq .+10 ; 0x57b0 <SetNeutral+0x50a>57a6: 80 91 cb 03 lds r24, 0x03CB57aa: 84 60 ori r24, 0x04 ; 457ac: 80 93 cb 03 sts 0x03CB, r24FromNaviCtrl_Value.Kalman_K = -1;57b0: 8f ef ldi r24, 0xFF ; 25557b2: 80 93 4c 09 sts 0x094C, r24FromNaviCtrl_Value.Kalman_MaxDrift = 0;57b6: 10 92 4d 09 sts 0x094D, r1FromNaviCtrl_Value.Kalman_MaxFusion = 32;57ba: 80 e2 ldi r24, 0x20 ; 3257bc: 80 93 4e 09 sts 0x094E, r24SenderOkay = 100;57c0: 84 e6 ldi r24, 0x64 ; 10057c2: 80 93 04 04 sts 0x0404, r24if(ServoActive) DDRD |=0x80; // enable J7 -> Servo signal57c6: 80 91 cb 04 lds r24, 0x04CB57ca: 88 23 and r24, r2457cc: 11 f0 breq .+4 ; 0x57d2 <SetNeutral+0x52c>57ce: 57 9a sbi 0x0a, 7 ; 1057d0: 19 c0 rjmp .+50 ; 0x5804 <SetNeutral+0x55e>57d2: 80 91 b7 05 lds r24, 0x05B757d6: 85 70 andi r24, 0x05 ; 5else{if((EE_Parameter.ServoCompInvert & SERVO_NICK_INV) && (EE_Parameter.ServoCompInvert & SERVO_RELATIVE)) NickServoValue = 12000;//((128 + 60) * 4 * 16); // neutral position = upper 1/4// else57d8: 85 30 cpi r24, 0x05 ; 557da: 39 f4 brne .+14 ; 0x57ea <SetNeutral+0x544>57dc: 80 ee ldi r24, 0xE0 ; 22457de: 9e e2 ldi r25, 0x2E ; 4657e0: 90 93 a8 02 sts 0x02A8, r2557e4: 80 93 a7 02 sts 0x02A7, r2457e8: 06 c0 rjmp .+12 ; 0x57f6 <SetNeutral+0x550>else NickServoValue = ((128 - 60) * 4 * 16); // neutral position = lower 1/457ea: 80 e0 ldi r24, 0x00 ; 057ec: 91 e1 ldi r25, 0x11 ; 1757ee: 90 93 a8 02 sts 0x02A8, r2557f2: 80 93 a7 02 sts 0x02A7, r24CalculateServoSignals = 1;57f6: 81 e0 ldi r24, 0x01 ; 157f8: 80 93 af 02 sts 0x02AF, r24CalculateServo(); // nick57fc: 0e 94 14 9d call 0x13a28 ; 0x13a28 <CalculateServo>CalculateServo(); // roll5800: 0e 94 14 9d call 0x13a28 ; 0x13a28 <CalculateServo>}#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))signed int tilt1, tilt2;tilt1 = (int)(IntegralNick/GIER_GRAD_FAKTOR); // nick angle in deg5804: c0 90 21 01 lds r12, 0x01215808: d0 90 22 01 lds r13, 0x0122580c: e0 90 23 01 lds r14, 0x01235810: f0 90 24 01 lds r15, 0x0124tilt2 = (int)(IntegralRoll/GIER_GRAD_FAKTOR); // roll angle in deg5814: 60 91 3e 04 lds r22, 0x043E5818: 70 91 3f 04 lds r23, 0x043F581c: 80 91 40 04 lds r24, 0x04405820: 90 91 41 04 lds r25, 0x04415824: a7 01 movw r20, r145826: 96 01 movw r18, r125828: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>582c: 49 01 movw r8, r18582e: 5a 01 movw r10, r20CalculateServo(); // roll}#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))signed int tilt1, tilt2;tilt1 = (int)(IntegralNick/GIER_GRAD_FAKTOR); // nick angle in deg5830: 60 91 42 04 lds r22, 0x04425834: 70 91 43 04 lds r23, 0x04435838: 80 91 44 04 lds r24, 0x0444583c: 90 91 45 04 lds r25, 0x04455840: a7 01 movw r20, r145842: 96 01 movw r18, r125844: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>tilt2 = (int)(IntegralRoll/GIER_GRAD_FAKTOR); // roll angle in degtilt1 = (int16_t)ihypot(tilt1,tilt2); // tilt angle over all5848: b4 01 movw r22, r8584a: c9 01 movw r24, r18584c: 0e 94 a2 0d call 0x1b44 ; 0x1b44 <ihypot>5850: 7c 01 movw r14, r24CosAttitude = c_cos_8192(tilt1);5852: 0e 94 2d 91 call 0x1225a ; 0x1225a <c_cos_8192>5856: 9c 01 movw r18, r245858: 90 93 2e 06 sts 0x062E, r25585c: 80 93 2d 06 sts 0x062D, r24NeutralAccZ = (long)((long) (NeutralAccZ - 512) * 8192 + 4096) / CosAttitude + 512;5860: 60 91 47 04 lds r22, 0x04475864: 70 91 48 04 lds r23, 0x04485868: 72 50 subi r23, 0x02 ; 2586a: cb 01 movw r24, r22586c: aa 27 eor r26, r26586e: 97 fd sbrc r25, 75870: a0 95 com r265872: ba 2f mov r27, r265874: 07 2e mov r0, r235876: 7d e0 ldi r23, 0x0D ; 135878: 88 0f add r24, r24587a: 99 1f adc r25, r25587c: aa 1f adc r26, r26587e: bb 1f adc r27, r275880: 7a 95 dec r235882: d1 f7 brne .-12 ; 0x5878 <SetNeutral+0x5d2>5884: 70 2d mov r23, r05886: bc 01 movw r22, r245888: cd 01 movw r24, r26588a: 70 5f subi r23, 0xF0 ; 240588c: 8f 4f sbci r24, 0xFF ; 255588e: 9f 4f sbci r25, 0xFF ; 2555890: 44 27 eor r20, r205892: 37 fd sbrc r19, 75894: 40 95 com r205896: 54 2f mov r21, r205898: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>589c: c9 01 movw r24, r18589e: b9 01 movw r22, r1858a0: 7e 5f subi r23, 0xFE ; 25458a2: 70 93 48 04 sts 0x0448, r2358a6: 60 93 47 04 sts 0x0447, r22if(tilt1 > 20) sucess = 0; // calibration must be within 20° Tilt angle58aa: 65 e1 ldi r22, 0x15 ; 2158ac: e6 16 cp r14, r2258ae: f1 04 cpc r15, r158b0: 0c f0 brlt .+2 ; 0x58b4 <SetNeutral+0x60e>58b2: d0 e0 ldi r29, 0x00 ; 0if(AdjustmentMode != 0 && ACC_AltitudeControl) if((NeutralAccZ < 682 - 30) || (NeutralAccZ > 682 + 35)) { VersionInfo.HardwareError[0] |= FC_ERROR0_ACC_TOP; sucess = 0;};58b4: cc 23 and r28, r2858b6: 79 f0 breq .+30 ; 0x58d6 <SetNeutral+0x630>58b8: 60 91 c2 03 lds r22, 0x03C258bc: 66 23 and r22, r2258be: 59 f0 breq .+22 ; 0x58d6 <SetNeutral+0x630>58c0: 2c 58 subi r18, 0x8C ; 14058c2: 31 09 sbc r19, r158c4: 22 34 cpi r18, 0x42 ; 6658c6: 31 05 cpc r19, r158c8: 30 f0 brcs .+12 ; 0x58d6 <SetNeutral+0x630>58ca: e2 e6 ldi r30, 0x62 ; 9858cc: fa e0 ldi r31, 0x0A ; 1058ce: 20 81 ld r18, Z58d0: 20 62 ori r18, 0x20 ; 3258d2: 20 83 st Z, r1858d4: d0 e0 ldi r29, 0x00 ; 0#elseNeutralAccZ = (int16_t)GetParamWord(PID_ACC_TOP);EEAR = EE_DUMMY; // Set the EEPROM Address pointer to an unused space#endifif((AdNeutralNick < 150 * 16) || (AdNeutralNick > 850 * 16)) { VersionInfo.HardwareError[0] |= FC_ERROR0_GYRO_NICK; };58d6: 20 91 57 04 lds r18, 0x045758da: 30 91 58 04 lds r19, 0x045858de: 20 56 subi r18, 0x60 ; 9658e0: 39 40 sbci r19, 0x09 ; 958e2: 21 3c cpi r18, 0xC1 ; 19358e4: 3b 42 sbci r19, 0x2B ; 4358e6: 28 f0 brcs .+10 ; 0x58f2 <SetNeutral+0x64c>58e8: e2 e6 ldi r30, 0x62 ; 9858ea: fa e0 ldi r31, 0x0A ; 1058ec: 20 81 ld r18, Z58ee: 21 60 ori r18, 0x01 ; 158f0: 20 83 st Z, r18if((AdNeutralRoll < 150 * 16) || (AdNeutralRoll > 850 * 16)) { VersionInfo.HardwareError[0] |= FC_ERROR0_GYRO_ROLL; };58f2: 20 91 55 04 lds r18, 0x045558f6: 30 91 56 04 lds r19, 0x045658fa: 20 56 subi r18, 0x60 ; 9658fc: 39 40 sbci r19, 0x09 ; 958fe: 21 3c cpi r18, 0xC1 ; 1935900: 3b 42 sbci r19, 0x2B ; 435902: 28 f0 brcs .+10 ; 0x590e <SetNeutral+0x668>5904: e2 e6 ldi r30, 0x62 ; 985906: fa e0 ldi r31, 0x0A ; 105908: 20 81 ld r18, Z590a: 22 60 ori r18, 0x02 ; 2590c: 20 83 st Z, r18if((AdNeutralGier < 150 * 2) || (AdNeutralGier > 850 * 2)) { VersionInfo.HardwareError[0] |= FC_ERROR0_GYRO_YAW; };590e: 20 91 53 04 lds r18, 0x04535912: 30 91 54 04 lds r19, 0x04545916: 2c 52 subi r18, 0x2C ; 445918: 31 40 sbci r19, 0x01 ; 1591a: 29 37 cpi r18, 0x79 ; 121591c: 35 40 sbci r19, 0x05 ; 5591e: 28 f0 brcs .+10 ; 0x592a <SetNeutral+0x684>5920: e2 e6 ldi r30, 0x62 ; 985922: fa e0 ldi r31, 0x0A ; 105924: 20 81 ld r18, Z5926: 24 60 ori r18, 0x04 ; 45928: 20 83 st Z, r18if((NeutralAccX < 300) || (NeutralAccX > 750)) { VersionInfo.HardwareError[0] |= FC_ERROR0_ACC_NICK; };592a: 20 91 4d 04 lds r18, 0x044D592e: 30 91 4e 04 lds r19, 0x044E5932: 2c 52 subi r18, 0x2C ; 445934: 31 40 sbci r19, 0x01 ; 15936: 23 3c cpi r18, 0xC3 ; 1955938: 31 40 sbci r19, 0x01 ; 1593a: 28 f0 brcs .+10 ; 0x5946 <SetNeutral+0x6a0>593c: e2 e6 ldi r30, 0x62 ; 98593e: fa e0 ldi r31, 0x0A ; 105940: 20 81 ld r18, Z5942: 28 60 ori r18, 0x08 ; 85944: 20 83 st Z, r18if((NeutralAccY < 300) || (NeutralAccY > 750)) { VersionInfo.HardwareError[0] |= FC_ERROR0_ACC_ROLL; };5946: 20 91 4b 04 lds r18, 0x044B594a: 30 91 4c 04 lds r19, 0x044C594e: 2c 52 subi r18, 0x2C ; 445950: 31 40 sbci r19, 0x01 ; 15952: 23 3c cpi r18, 0xC3 ; 1955954: 31 40 sbci r19, 0x01 ; 15956: 28 f0 brcs .+10 ; 0x5962 <SetNeutral+0x6bc>5958: e2 e6 ldi r30, 0x62 ; 98595a: fa e0 ldi r31, 0x0A ; 10595c: 20 81 ld r18, Z595e: 20 61 ori r18, 0x10 ; 165960: 20 83 st Z, r18if((NeutralAccZ < 512) || (NeutralAccZ > 850)) { VersionInfo.HardwareError[0] |= FC_ERROR0_ACC_TOP; };5962: 83 35 cpi r24, 0x53 ; 835964: 91 40 sbci r25, 0x01 ; 15966: 28 f0 brcs .+10 ; 0x5972 <SetNeutral+0x6cc>5968: e2 e6 ldi r30, 0x62 ; 98596a: fa e0 ldi r31, 0x0A ; 10596c: 80 81 ld r24, Z596e: 80 62 ori r24, 0x20 ; 325970: 80 83 st Z, r24if(VersionInfo.HardwareError[0]) sucess = 0;5972: 80 91 62 0a lds r24, 0x0A625976: 81 11 cpse r24, r15978: d0 e0 ldi r29, 0x00 ; 0carefree_old = 70;597a: 86 e4 ldi r24, 0x46 ; 70597c: 80 93 3d 01 sts 0x013D, r24#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))LIBFC_HoTT_Clear();5980: 0e 94 3a 15 call 0x2a74 ; 0x2a74 <LIBFC_HoTT_Clear>ACC_AltitudeFusion(2); // initalisation5984: 82 e0 ldi r24, 0x02 ; 25986: 0e 94 a0 16 call 0x2d40 ; 0x2d40 <ACC_AltitudeFusion>#endifStartLuftdruck = Luftdruck;598a: 80 91 12 01 lds r24, 0x0112598e: 90 91 13 01 lds r25, 0x01135992: a0 91 14 01 lds r26, 0x01145996: b0 91 15 01 lds r27, 0x0115599a: 80 93 08 05 sts 0x0508, r24599e: 90 93 09 05 sts 0x0509, r2559a2: a0 93 0a 05 sts 0x050A, r2659a6: b0 93 0b 05 sts 0x050B, r27VarioMeter = 0;59aa: 10 92 55 03 sts 0x0355, r159ae: 10 92 54 03 sts 0x0354, r1SummenHoehe = 0; Mess_Integral_Hoch = 0;59b2: 10 92 57 03 sts 0x0357, r159b6: 10 92 58 03 sts 0x0358, r159ba: 10 92 59 03 sts 0x0359, r159be: 10 92 5a 03 sts 0x035A, r159c2: 10 92 1e 04 sts 0x041E, r159c6: 10 92 1f 04 sts 0x041F, r159ca: 10 92 20 04 sts 0x0420, r159ce: 10 92 21 04 sts 0x0421, r1DebugOut.Analog[28] = 0; // I2C-Counter59d2: 10 92 81 0c sts 0x0C81, r159d6: 10 92 80 0c sts 0x0C80, r1CalcExpandBaroStep();59da: 0e 94 14 1b call 0x3628 ; 0x3628 <CalcExpandBaroStep>if(FC_StatusFlags3 & FC_STATUS3_BOAT && !EE_Parameter.Driftkomp) EE_Parameter.Driftkomp = 4;59de: 80 91 c9 03 lds r24, 0x03C959e2: 81 ff sbrs r24, 159e4: 07 c0 rjmp .+14 ; 0x59f4 <SetNeutral+0x74e>59e6: 80 91 82 05 lds r24, 0x058259ea: 81 11 cpse r24, r159ec: 03 c0 rjmp .+6 ; 0x59f4 <SetNeutral+0x74e>59ee: 84 e0 ldi r24, 0x04 ; 459f0: 80 93 82 05 sts 0x0582, r24return(sucess);}59f4: 8d 2f mov r24, r2959f6: df 91 pop r2959f8: cf 91 pop r2859fa: 1f 91 pop r1759fc: 0f 91 pop r1659fe: ff 90 pop r155a00: ef 90 pop r145a02: df 90 pop r135a04: cf 90 pop r125a06: bf 90 pop r115a08: af 90 pop r105a0a: 9f 90 pop r95a0c: 8f 90 pop r85a0e: 08 95 ret00005a10 <Mittelwert>://############################################################################// Bearbeitet die Messwertevoid Mittelwert(void)//############################################################################{5a10: 2f 92 push r25a12: 3f 92 push r35a14: 4f 92 push r45a16: 5f 92 push r55a18: 6f 92 push r65a1a: 7f 92 push r75a1c: 8f 92 push r85a1e: 9f 92 push r95a20: af 92 push r105a22: bf 92 push r115a24: cf 92 push r125a26: df 92 push r135a28: ef 92 push r145a2a: ff 92 push r155a2c: 0f 93 push r165a2e: 1f 93 push r175a30: cf 93 push r285a32: df 93 push r295a34: cd b7 in r28, 0x3d ; 615a36: de b7 in r29, 0x3e ; 625a38: 60 97 sbiw r28, 0x10 ; 165a3a: 0f b6 in r0, 0x3f ; 635a3c: f8 94 cli5a3e: de bf out 0x3e, r29 ; 625a40: 0f be out 0x3f, r0 ; 635a42: cd bf out 0x3d, r28 ; 61static signed long tmpl,tmpl2,tmpl3,tmpl4;static signed int oldNick, oldRoll, d2Roll, d2Nick;signed long winkel_nick, winkel_roll;MesswertGier = (signed int) AdNeutralGier - AdWertGier;5a44: 20 91 61 03 lds r18, 0x03615a48: 30 91 62 03 lds r19, 0x03625a4c: 80 91 53 04 lds r24, 0x04535a50: 90 91 54 04 lds r25, 0x04545a54: 82 1b sub r24, r185a56: 93 0b sbc r25, r195a58: 90 93 68 06 sts 0x0668, r255a5c: 80 93 67 06 sts 0x0667, r24MesswertNick = (signed int) AdWertNickFilter / 8;5a60: 80 91 69 03 lds r24, 0x03695a64: 90 91 6a 03 lds r25, 0x036A5a68: 99 23 and r25, r255a6a: 0c f4 brge .+2 ; 0x5a6e <Mittelwert+0x5e>5a6c: 07 96 adiw r24, 0x07 ; 75a6e: 9c 01 movw r18, r245a70: 35 95 asr r195a72: 27 95 ror r185a74: 35 95 asr r195a76: 27 95 ror r185a78: 35 95 asr r195a7a: 27 95 ror r185a7c: 30 93 28 06 sts 0x0628, r195a80: 20 93 27 06 sts 0x0627, r18MesswertRoll = (signed int) AdWertRollFilter / 8;5a84: 80 91 67 03 lds r24, 0x03675a88: 90 91 68 03 lds r25, 0x03685a8c: 99 23 and r25, r255a8e: 0c f4 brge .+2 ; 0x5a92 <Mittelwert+0x82>5a90: 07 96 adiw r24, 0x07 ; 75a92: 95 95 asr r255a94: 87 95 ror r245a96: 95 95 asr r255a98: 87 95 ror r245a9a: 95 95 asr r255a9c: 87 95 ror r245a9e: 90 93 1d 06 sts 0x061D, r255aa2: 80 93 1c 06 sts 0x061C, r24RohMesswertNick = MesswertNick;5aa6: 30 93 30 06 sts 0x0630, r195aaa: 20 93 2f 06 sts 0x062F, r18RohMesswertRoll = MesswertRoll;5aae: 90 93 2b 06 sts 0x062B, r255ab2: 80 93 2a 06 sts 0x062A, r24// Beschleunigungssensor ++++++++++++++++++++++++++++++++++++++++++++++++Mittelwert_AccNick = (Mittelwert_AccNick * 3 + ((ACC_AMPLIFY * AdWertAccNick))) / 4L;5ab6: 20 91 5d 03 lds r18, 0x035D5aba: 30 91 5e 03 lds r19, 0x035E5abe: 80 91 60 06 lds r24, 0x06605ac2: 90 91 61 06 lds r25, 0x06615ac6: ac 01 movw r20, r245ac8: 44 0f add r20, r205aca: 55 1f adc r21, r215acc: 84 0f add r24, r205ace: 95 1f adc r25, r215ad0: a9 01 movw r20, r185ad2: 44 0f add r20, r205ad4: 55 1f adc r21, r215ad6: 24 0f add r18, r205ad8: 35 1f adc r19, r215ada: 22 0f add r18, r185adc: 33 1f adc r19, r195ade: 82 0f add r24, r185ae0: 93 1f adc r25, r195ae2: 99 23 and r25, r255ae4: 0c f4 brge .+2 ; 0x5ae8 <Mittelwert+0xd8>5ae6: 03 96 adiw r24, 0x03 ; 35ae8: 95 95 asr r255aea: 87 95 ror r245aec: 95 95 asr r255aee: 87 95 ror r245af0: 90 93 61 06 sts 0x0661, r255af4: 80 93 60 06 sts 0x0660, r24Mittelwert_AccRoll = (Mittelwert_AccRoll * 3 + ((ACC_AMPLIFY * AdWertAccRoll))) / 4L;5af8: 20 91 5f 03 lds r18, 0x035F5afc: 30 91 60 03 lds r19, 0x03605b00: 80 91 72 06 lds r24, 0x06725b04: 90 91 73 06 lds r25, 0x06735b08: ac 01 movw r20, r245b0a: 44 0f add r20, r205b0c: 55 1f adc r21, r215b0e: 84 0f add r24, r205b10: 95 1f adc r25, r215b12: a9 01 movw r20, r185b14: 44 0f add r20, r205b16: 55 1f adc r21, r215b18: 24 0f add r18, r205b1a: 35 1f adc r19, r215b1c: 22 0f add r18, r185b1e: 33 1f adc r19, r195b20: 82 0f add r24, r185b22: 93 1f adc r25, r195b24: 99 23 and r25, r255b26: 0c f4 brge .+2 ; 0x5b2a <Mittelwert+0x11a>5b28: 03 96 adiw r24, 0x03 ; 35b2a: 95 95 asr r255b2c: 87 95 ror r245b2e: 95 95 asr r255b30: 87 95 ror r245b32: 90 93 73 06 sts 0x0673, r255b36: 80 93 72 06 sts 0x0672, r24NaviAccNick += AdWertAccNick;5b3a: 80 91 5d 03 lds r24, 0x035D5b3e: 90 91 5e 03 lds r25, 0x035E5b42: 20 91 39 06 lds r18, 0x06395b46: 30 91 3a 06 lds r19, 0x063A5b4a: 82 0f add r24, r185b4c: 93 1f adc r25, r195b4e: 90 93 3a 06 sts 0x063A, r255b52: 80 93 39 06 sts 0x0639, r24NaviAccRoll += AdWertAccRoll;5b56: 80 91 5f 03 lds r24, 0x035F5b5a: 90 91 60 03 lds r25, 0x03605b5e: 20 91 6a 06 lds r18, 0x066A5b62: 30 91 6b 06 lds r19, 0x066B5b66: 82 0f add r24, r185b68: 93 1f adc r25, r195b6a: 90 93 6b 06 sts 0x066B, r255b6e: 80 93 6a 06 sts 0x066A, r24NaviCntAcc++;5b72: 80 91 49 04 lds r24, 0x04495b76: 90 91 4a 04 lds r25, 0x044A5b7a: 01 96 adiw r24, 0x01 ; 15b7c: 90 93 4a 04 sts 0x044A, r255b80: 80 93 49 04 sts 0x0449, r24//++++++++++++++++++++++++++++++++++++++++++++++++HoehenWert = HoehenWert_Mess;5b84: 80 91 46 03 lds r24, 0x03465b88: 90 91 47 03 lds r25, 0x03475b8c: a0 91 48 03 lds r26, 0x03485b90: b0 91 49 03 lds r27, 0x03495b94: 80 93 fe 03 sts 0x03FE, r245b98: 90 93 ff 03 sts 0x03FF, r255b9c: a0 93 00 04 sts 0x0400, r265ba0: b0 93 01 04 sts 0x0401, r27#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))HoehenWertF = HoehenWertF_Mess;5ba4: 80 91 42 03 lds r24, 0x03425ba8: 90 91 43 03 lds r25, 0x03435bac: a0 91 44 03 lds r26, 0x03445bb0: b0 91 45 03 lds r27, 0x03455bb4: 80 93 4a 03 sts 0x034A, r245bb8: 90 93 4b 03 sts 0x034B, r255bbc: a0 93 4c 03 sts 0x034C, r265bc0: b0 93 4d 03 sts 0x034D, r27#elseHoehenWertF = HoehenWert;#endif//++++++++++++++++++++++++++++++++++++++++++++++++// ADC einschaltenANALOG_ON;5bc4: 8f ec ldi r24, 0xCF ; 2075bc6: 80 93 7a 00 sts 0x007A, r24AdReady = 0;5bca: 10 92 0f 01 sts 0x010F, r1//++++++++++++++++++++++++++++++++++++++++++++++++if(Mess_IntegralRoll > 93000L) winkel_roll = 93000L;5bce: 00 91 32 04 lds r16, 0x04325bd2: 10 91 33 04 lds r17, 0x04335bd6: 70 91 34 04 lds r23, 0x04345bda: 60 91 35 04 lds r22, 0x0435else if(Mess_IntegralRoll <-93000L) winkel_roll = -93000L;else winkel_roll = Mess_IntegralRoll;if(Mess_IntegralNick > 93000L) winkel_nick = 93000L;5bde: 50 91 36 04 lds r21, 0x04365be2: 40 91 37 04 lds r20, 0x04375be6: 30 91 38 04 lds r19, 0x04385bea: 20 91 39 04 lds r18, 0x0439else if(Mess_IntegralNick <-93000L) winkel_nick = -93000L;else winkel_nick = Mess_IntegralNick;// Gier ++++++++++++++++++++++++++++++++++++++++++++++++Mess_Integral_Gier += MesswertGier;5bee: 20 90 67 06 lds r2, 0x06675bf2: 30 90 68 06 lds r3, 0x06685bf6: 61 01 movw r12, r25bf8: ee 24 eor r14, r145bfa: d7 fc sbrc r13, 75bfc: e0 94 com r145bfe: fe 2c mov r15, r145c00: 80 91 2e 04 lds r24, 0x042E5c04: 90 91 2f 04 lds r25, 0x042F5c08: a0 91 30 04 lds r26, 0x04305c0c: b0 91 31 04 lds r27, 0x04315c10: 46 01 movw r8, r125c12: 57 01 movw r10, r145c14: 88 0e add r8, r245c16: 99 1e adc r9, r255c18: aa 1e adc r10, r265c1a: bb 1e adc r11, r275c1c: 80 92 2e 04 sts 0x042E, r85c20: 90 92 2f 04 sts 0x042F, r95c24: a0 92 30 04 sts 0x0430, r105c28: b0 92 31 04 sts 0x0431, r11ErsatzKompass += MesswertGier;5c2c: 80 91 6e 06 lds r24, 0x066E5c30: 90 91 6f 06 lds r25, 0x066F5c34: a0 91 70 06 lds r26, 0x06705c38: b0 91 71 06 lds r27, 0x06715c3c: 26 01 movw r4, r125c3e: 37 01 movw r6, r145c40: 48 0e add r4, r245c42: 59 1e adc r5, r255c44: 6a 1e adc r6, r265c46: 7b 1e adc r7, r275c48: 40 92 6e 06 sts 0x066E, r45c4c: 50 92 6f 06 sts 0x066F, r55c50: 60 92 70 06 sts 0x0670, r65c54: 70 92 71 06 sts 0x0671, r7// Kopplungsanteil +++++++++++++++++++++++++++++++++++++if(!Looping_Nick && !Looping_Roll && (Parameter_GlobalConfig & CFG_ACHSENKOPPLUNG_AKTIV))5c58: 80 91 e7 03 lds r24, 0x03E75c5c: 81 11 cpse r24, r15c5e: c5 c1 rjmp .+906 ; 0x5fea <Mittelwert+0x5da>5c60: 80 91 e6 03 lds r24, 0x03E65c64: 81 11 cpse r24, r15c66: c1 c1 rjmp .+898 ; 0x5fea <Mittelwert+0x5da>5c68: 80 91 5c 06 lds r24, 0x065C5c6c: 86 ff sbrs r24, 65c6e: bd c1 rjmp .+890 ; 0x5fea <Mittelwert+0x5da>5c70: 09 87 std Y+9, r16 ; 0x095c72: 1a 87 std Y+10, r17 ; 0x0a5c74: 7b 87 std Y+11, r23 ; 0x0b5c76: 6c 87 std Y+12, r22 ; 0x0c5c78: 89 85 ldd r24, Y+9 ; 0x095c7a: 9a 85 ldd r25, Y+10 ; 0x0a5c7c: ab 85 ldd r26, Y+11 ; 0x0b5c7e: bc 85 ldd r27, Y+12 ; 0x0c5c80: 88 3b cpi r24, 0xB8 ; 1845c82: 94 49 sbci r25, 0x94 ; 1485c84: ae 4f sbci r26, 0xFE ; 2545c86: bf 4f sbci r27, 0xFF ; 2555c88: 44 f4 brge .+16 ; 0x5c9a <Mittelwert+0x28a>5c8a: 88 eb ldi r24, 0xB8 ; 1845c8c: 94 e9 ldi r25, 0x94 ; 1485c8e: ae ef ldi r26, 0xFE ; 2545c90: bf ef ldi r27, 0xFF ; 2555c92: 89 87 std Y+9, r24 ; 0x095c94: 9a 87 std Y+10, r25 ; 0x0a5c96: ab 87 std Y+11, r26 ; 0x0b5c98: bc 87 std Y+12, r27 ; 0x0c5c9a: 89 85 ldd r24, Y+9 ; 0x095c9c: 9a 85 ldd r25, Y+10 ; 0x0a5c9e: ab 85 ldd r26, Y+11 ; 0x0b5ca0: bc 85 ldd r27, Y+12 ; 0x0c5ca2: 89 34 cpi r24, 0x49 ; 735ca4: 9b 46 sbci r25, 0x6B ; 1075ca6: a1 40 sbci r26, 0x01 ; 15ca8: b1 05 cpc r27, r15caa: 44 f0 brlt .+16 ; 0x5cbc <Mittelwert+0x2ac>5cac: 88 e4 ldi r24, 0x48 ; 725cae: 9b e6 ldi r25, 0x6B ; 1075cb0: a1 e0 ldi r26, 0x01 ; 15cb2: b0 e0 ldi r27, 0x00 ; 05cb4: 89 87 std Y+9, r24 ; 0x095cb6: 9a 87 std Y+10, r25 ; 0x0a5cb8: ab 87 std Y+11, r26 ; 0x0b5cba: bc 87 std Y+12, r27 ; 0x0c5cbc: 85 2f mov r24, r215cbe: 94 2f mov r25, r205cc0: a3 2f mov r26, r195cc2: b2 2f mov r27, r185cc4: 88 3b cpi r24, 0xB8 ; 1845cc6: e4 e9 ldi r30, 0x94 ; 1485cc8: 9e 07 cpc r25, r305cca: ee ef ldi r30, 0xFE ; 2545ccc: ae 07 cpc r26, r305cce: ef ef ldi r30, 0xFF ; 2555cd0: be 07 cpc r27, r305cd2: 24 f4 brge .+8 ; 0x5cdc <Mittelwert+0x2cc>5cd4: 88 eb ldi r24, 0xB8 ; 1845cd6: 94 e9 ldi r25, 0x94 ; 1485cd8: ae ef ldi r26, 0xFE ; 2545cda: bf ef ldi r27, 0xFF ; 2555cdc: 8d 83 std Y+5, r24 ; 0x055cde: 9e 83 std Y+6, r25 ; 0x065ce0: af 83 std Y+7, r26 ; 0x075ce2: b8 87 std Y+8, r27 ; 0x085ce4: 89 34 cpi r24, 0x49 ; 735ce6: 9b 46 sbci r25, 0x6B ; 1075ce8: a1 40 sbci r26, 0x01 ; 15cea: b1 05 cpc r27, r15cec: 44 f0 brlt .+16 ; 0x5cfe <Mittelwert+0x2ee>5cee: 08 e4 ldi r16, 0x48 ; 725cf0: 1b e6 ldi r17, 0x6B ; 1075cf2: 21 e0 ldi r18, 0x01 ; 15cf4: 30 e0 ldi r19, 0x00 ; 05cf6: 0d 83 std Y+5, r16 ; 0x055cf8: 1e 83 std Y+6, r17 ; 0x065cfa: 2f 83 std Y+7, r18 ; 0x075cfc: 38 87 std Y+8, r19 ; 0x08{tmpl3 = (MesswertRoll * winkel_nick) / 2048L;tmpl3 *= Parameter_AchsKopplung2; //655cfe: 80 91 29 01 lds r24, 0x01295d02: 08 2f mov r16, r245d04: 10 e0 ldi r17, 0x00 ; 05d06: 20 e0 ldi r18, 0x00 ; 05d08: 30 e0 ldi r19, 0x00 ; 05d0a: 0d 87 std Y+13, r16 ; 0x0d5d0c: 1e 87 std Y+14, r17 ; 0x0e5d0e: 2f 87 std Y+15, r18 ; 0x0f5d10: 38 8b std Y+16, r19 ; 0x10Mess_Integral_Gier += MesswertGier;ErsatzKompass += MesswertGier;// Kopplungsanteil +++++++++++++++++++++++++++++++++++++if(!Looping_Nick && !Looping_Roll && (Parameter_GlobalConfig & CFG_ACHSENKOPPLUNG_AKTIV)){tmpl3 = (MesswertRoll * winkel_nick) / 2048L;5d12: a0 91 1c 06 lds r26, 0x061C5d16: b0 91 1d 06 lds r27, 0x061D5d1a: 2d 81 ldd r18, Y+5 ; 0x055d1c: 3e 81 ldd r19, Y+6 ; 0x065d1e: 4f 81 ldd r20, Y+7 ; 0x075d20: 58 85 ldd r21, Y+8 ; 0x085d22: 0e 94 d2 b1 call 0x163a4 ; 0x163a4 <__mulshisi3>5d26: 8b 01 movw r16, r225d28: 9c 01 movw r18, r245d2a: 99 23 and r25, r255d2c: 24 f4 brge .+8 ; 0x5d36 <Mittelwert+0x326>5d2e: 01 50 subi r16, 0x01 ; 15d30: 18 4f sbci r17, 0xF8 ; 2485d32: 2f 4f sbci r18, 0xFF ; 2555d34: 3f 4f sbci r19, 0xFF ; 2555d36: a9 01 movw r20, r185d38: 98 01 movw r18, r165d3a: 01 2e mov r0, r175d3c: 1b e0 ldi r17, 0x0B ; 115d3e: 55 95 asr r215d40: 47 95 ror r205d42: 37 95 ror r195d44: 27 95 ror r185d46: 1a 95 dec r175d48: d1 f7 brne .-12 ; 0x5d3e <Mittelwert+0x32e>5d4a: 10 2d mov r17, r0tmpl3 *= Parameter_AchsKopplung2; //655d4c: 6d 85 ldd r22, Y+13 ; 0x0d5d4e: 7e 85 ldd r23, Y+14 ; 0x0e5d50: 8f 85 ldd r24, Y+15 ; 0x0f5d52: 98 89 ldd r25, Y+16 ; 0x105d54: 0e 94 27 b1 call 0x1624e ; 0x1624e <__mulsi3>tmpl3 /= 4096L;5d58: 8b 01 movw r16, r225d5a: 9c 01 movw r18, r245d5c: 99 23 and r25, r255d5e: 24 f4 brge .+8 ; 0x5d68 <Mittelwert+0x358>5d60: 01 50 subi r16, 0x01 ; 15d62: 10 4f sbci r17, 0xF0 ; 2405d64: 2f 4f sbci r18, 0xFF ; 2555d66: 3f 4f sbci r19, 0xFF ; 2555d68: d9 01 movw r26, r185d6a: c8 01 movw r24, r165d6c: 07 2e mov r0, r235d6e: 7c e0 ldi r23, 0x0C ; 125d70: b5 95 asr r275d72: a7 95 ror r265d74: 97 95 ror r255d76: 87 95 ror r245d78: 7a 95 dec r235d7a: d1 f7 brne .-12 ; 0x5d70 <Mittelwert+0x360>5d7c: 70 2d mov r23, r05d7e: 89 83 std Y+1, r24 ; 0x015d80: 9a 83 std Y+2, r25 ; 0x025d82: ab 83 std Y+3, r26 ; 0x035d84: bc 83 std Y+4, r27 ; 0x045d86: 80 93 b8 03 sts 0x03B8, r245d8a: 90 93 b9 03 sts 0x03B9, r255d8e: a0 93 ba 03 sts 0x03BA, r265d92: b0 93 bb 03 sts 0x03BB, r27tmpl4 = (MesswertNick * winkel_roll) / 2048L;5d96: a0 91 27 06 lds r26, 0x06275d9a: b0 91 28 06 lds r27, 0x06285d9e: 29 85 ldd r18, Y+9 ; 0x095da0: 3a 85 ldd r19, Y+10 ; 0x0a5da2: 4b 85 ldd r20, Y+11 ; 0x0b5da4: 5c 85 ldd r21, Y+12 ; 0x0c5da6: 0e 94 d2 b1 call 0x163a4 ; 0x163a4 <__mulshisi3>5daa: 8b 01 movw r16, r225dac: 9c 01 movw r18, r245dae: 99 23 and r25, r255db0: 24 f4 brge .+8 ; 0x5dba <Mittelwert+0x3aa>5db2: 01 50 subi r16, 0x01 ; 15db4: 18 4f sbci r17, 0xF8 ; 2485db6: 2f 4f sbci r18, 0xFF ; 2555db8: 3f 4f sbci r19, 0xFF ; 2555dba: c9 01 movw r24, r185dbc: b8 01 movw r22, r165dbe: 05 2e mov r0, r215dc0: 5b e0 ldi r21, 0x0B ; 115dc2: 95 95 asr r255dc4: 87 95 ror r245dc6: 77 95 ror r235dc8: 67 95 ror r225dca: 5a 95 dec r215dcc: d1 f7 brne .-12 ; 0x5dc2 <Mittelwert+0x3b2>5dce: 50 2d mov r21, r0tmpl4 *= Parameter_AchsKopplung2; //655dd0: 2d 85 ldd r18, Y+13 ; 0x0d5dd2: 3e 85 ldd r19, Y+14 ; 0x0e5dd4: 4f 85 ldd r20, Y+15 ; 0x0f5dd6: 58 89 ldd r21, Y+16 ; 0x105dd8: 0e 94 27 b1 call 0x1624e ; 0x1624e <__mulsi3>tmpl4 /= 4096L;5ddc: 8b 01 movw r16, r225dde: 9c 01 movw r18, r245de0: 99 23 and r25, r255de2: 24 f4 brge .+8 ; 0x5dec <Mittelwert+0x3dc>5de4: 01 50 subi r16, 0x01 ; 15de6: 10 4f sbci r17, 0xF0 ; 2405de8: 2f 4f sbci r18, 0xFF ; 2555dea: 3f 4f sbci r19, 0xFF ; 2555dec: d9 01 movw r26, r185dee: c8 01 movw r24, r165df0: 07 2e mov r0, r235df2: 7c e0 ldi r23, 0x0C ; 125df4: b5 95 asr r275df6: a7 95 ror r265df8: 97 95 ror r255dfa: 87 95 ror r245dfc: 7a 95 dec r235dfe: d1 f7 brne .-12 ; 0x5df4 <Mittelwert+0x3e4>5e00: 70 2d mov r23, r0KopplungsteilNickRoll = tmpl3;5e02: e9 81 ldd r30, Y+1 ; 0x015e04: fa 81 ldd r31, Y+2 ; 0x025e06: f0 93 16 06 sts 0x0616, r315e0a: e0 93 15 06 sts 0x0615, r30KopplungsteilRollNick = tmpl4;5e0e: 90 93 18 06 sts 0x0618, r255e12: 80 93 17 06 sts 0x0617, r24tmpl4 -= tmpl3;5e16: 09 81 ldd r16, Y+1 ; 0x015e18: 1a 81 ldd r17, Y+2 ; 0x025e1a: 2b 81 ldd r18, Y+3 ; 0x035e1c: 3c 81 ldd r19, Y+4 ; 0x045e1e: 80 1b sub r24, r165e20: 91 0b sbc r25, r175e22: a2 0b sbc r26, r185e24: b3 0b sbc r27, r195e26: 80 93 b4 03 sts 0x03B4, r245e2a: 90 93 b5 03 sts 0x03B5, r255e2e: a0 93 b6 03 sts 0x03B6, r265e32: b0 93 b7 03 sts 0x03B7, r27ErsatzKompass += tmpl4;5e36: b3 01 movw r22, r65e38: a2 01 movw r20, r45e3a: 48 0f add r20, r245e3c: 59 1f adc r21, r255e3e: 6a 1f adc r22, r265e40: 7b 1f adc r23, r275e42: 40 93 6e 06 sts 0x066E, r205e46: 50 93 6f 06 sts 0x066F, r215e4a: 60 93 70 06 sts 0x0670, r225e4e: 70 93 71 06 sts 0x0671, r23if(!Parameter_CouplingYawCorrection) Mess_Integral_Gier -= tmpl4/2; // Gier nachhelfen5e52: 20 91 28 01 lds r18, 0x01285e56: 21 11 cpse r18, r15e58: 1a c0 rjmp .+52 ; 0x5e8e <Mittelwert+0x47e>5e5a: ac 01 movw r20, r245e5c: bd 01 movw r22, r265e5e: bb 23 and r27, r275e60: 24 f4 brge .+8 ; 0x5e6a <Mittelwert+0x45a>5e62: 4f 5f subi r20, 0xFF ; 2555e64: 5f 4f sbci r21, 0xFF ; 2555e66: 6f 4f sbci r22, 0xFF ; 2555e68: 7f 4f sbci r23, 0xFF ; 2555e6a: 75 95 asr r235e6c: 67 95 ror r225e6e: 57 95 ror r215e70: 47 95 ror r205e72: 95 01 movw r18, r105e74: 84 01 movw r16, r85e76: 04 1b sub r16, r205e78: 15 0b sbc r17, r215e7a: 26 0b sbc r18, r225e7c: 37 0b sbc r19, r235e7e: 00 93 2e 04 sts 0x042E, r165e82: 10 93 2f 04 sts 0x042F, r175e86: 20 93 30 04 sts 0x0430, r185e8a: 30 93 31 04 sts 0x0431, r19tmpl = ((MesswertGier + tmpl4) * winkel_nick) / 2048L;5e8e: 46 01 movw r8, r125e90: 57 01 movw r10, r145e92: 88 0e add r8, r245e94: 99 1e adc r9, r255e96: aa 1e adc r10, r265e98: bb 1e adc r11, r27tmpl *= Parameter_AchsKopplung1; // 905e9a: e0 90 2a 01 lds r14, 0x012A5e9e: ce 2c mov r12, r145ea0: d1 2c mov r13, r15ea2: e1 2c mov r14, r15ea4: f1 2c mov r15, r1KopplungsteilRollNick = tmpl4;tmpl4 -= tmpl3;ErsatzKompass += tmpl4;if(!Parameter_CouplingYawCorrection) Mess_Integral_Gier -= tmpl4/2; // Gier nachhelfentmpl = ((MesswertGier + tmpl4) * winkel_nick) / 2048L;5ea6: a5 01 movw r20, r105ea8: 94 01 movw r18, r85eaa: 6d 81 ldd r22, Y+5 ; 0x055eac: 7e 81 ldd r23, Y+6 ; 0x065eae: 8f 81 ldd r24, Y+7 ; 0x075eb0: 98 85 ldd r25, Y+8 ; 0x085eb2: 0e 94 27 b1 call 0x1624e ; 0x1624e <__mulsi3>5eb6: 8b 01 movw r16, r225eb8: 9c 01 movw r18, r245eba: 99 23 and r25, r255ebc: 24 f4 brge .+8 ; 0x5ec6 <Mittelwert+0x4b6>5ebe: 01 50 subi r16, 0x01 ; 15ec0: 18 4f sbci r17, 0xF8 ; 2485ec2: 2f 4f sbci r18, 0xFF ; 2555ec4: 3f 4f sbci r19, 0xFF ; 2555ec6: a9 01 movw r20, r185ec8: 98 01 movw r18, r165eca: 01 2e mov r0, r175ecc: 1b e0 ldi r17, 0x0B ; 115ece: 55 95 asr r215ed0: 47 95 ror r205ed2: 37 95 ror r195ed4: 27 95 ror r185ed6: 1a 95 dec r175ed8: d1 f7 brne .-12 ; 0x5ece <Mittelwert+0x4be>5eda: 10 2d mov r17, r0tmpl *= Parameter_AchsKopplung1; // 905edc: c7 01 movw r24, r145ede: b6 01 movw r22, r125ee0: 0e 94 27 b1 call 0x1624e ; 0x1624e <__mulsi3>tmpl /= 4096L;5ee4: 2b 01 movw r4, r225ee6: 3c 01 movw r6, r245ee8: 99 23 and r25, r255eea: 34 f4 brge .+12 ; 0x5ef8 <Mittelwert+0x4e8>5eec: 1f ef ldi r17, 0xFF ; 2555eee: 41 0e add r4, r175ef0: 1f e0 ldi r17, 0x0F ; 155ef2: 51 1e adc r5, r175ef4: 61 1c adc r6, r15ef6: 71 1c adc r7, r15ef8: 03 2e mov r0, r195efa: 3c e0 ldi r19, 0x0C ; 125efc: 75 94 asr r75efe: 67 94 ror r65f00: 57 94 ror r55f02: 47 94 ror r45f04: 3a 95 dec r195f06: d1 f7 brne .-12 ; 0x5efc <Mittelwert+0x4ec>5f08: 30 2d mov r19, r05f0a: 40 92 b0 03 sts 0x03B0, r45f0e: 50 92 b1 03 sts 0x03B1, r55f12: 60 92 b2 03 sts 0x03B2, r65f16: 70 92 b3 03 sts 0x03B3, r7tmpl2 = ((MesswertGier + tmpl4) * winkel_roll) / 2048L;5f1a: a5 01 movw r20, r105f1c: 94 01 movw r18, r85f1e: 69 85 ldd r22, Y+9 ; 0x095f20: 7a 85 ldd r23, Y+10 ; 0x0a5f22: 8b 85 ldd r24, Y+11 ; 0x0b5f24: 9c 85 ldd r25, Y+12 ; 0x0c5f26: 0e 94 27 b1 call 0x1624e ; 0x1624e <__mulsi3>5f2a: 8b 01 movw r16, r225f2c: 9c 01 movw r18, r245f2e: 99 23 and r25, r255f30: 24 f4 brge .+8 ; 0x5f3a <Mittelwert+0x52a>5f32: 01 50 subi r16, 0x01 ; 15f34: 18 4f sbci r17, 0xF8 ; 2485f36: 2f 4f sbci r18, 0xFF ; 2555f38: 3f 4f sbci r19, 0xFF ; 2555f3a: c9 01 movw r24, r185f3c: b8 01 movw r22, r165f3e: 05 2e mov r0, r215f40: 5b e0 ldi r21, 0x0B ; 115f42: 95 95 asr r255f44: 87 95 ror r245f46: 77 95 ror r235f48: 67 95 ror r225f4a: 5a 95 dec r215f4c: d1 f7 brne .-12 ; 0x5f42 <Mittelwert+0x532>5f4e: 50 2d mov r21, r0tmpl2 *= Parameter_AchsKopplung1;5f50: a7 01 movw r20, r145f52: 96 01 movw r18, r125f54: 0e 94 27 b1 call 0x1624e ; 0x1624e <__mulsi3>tmpl2 /= 4096L;5f58: 8b 01 movw r16, r225f5a: 9c 01 movw r18, r245f5c: 99 23 and r25, r255f5e: 24 f4 brge .+8 ; 0x5f68 <Mittelwert+0x558>5f60: 01 50 subi r16, 0x01 ; 15f62: 10 4f sbci r17, 0xF0 ; 2405f64: 2f 4f sbci r18, 0xFF ; 2555f66: 3f 4f sbci r19, 0xFF ; 2555f68: d9 01 movw r26, r185f6a: c8 01 movw r24, r165f6c: 07 2e mov r0, r235f6e: 7c e0 ldi r23, 0x0C ; 125f70: b5 95 asr r275f72: a7 95 ror r265f74: 97 95 ror r255f76: 87 95 ror r245f78: 7a 95 dec r235f7a: d1 f7 brne .-12 ; 0x5f70 <Mittelwert+0x560>5f7c: 70 2d mov r23, r05f7e: 80 93 ac 03 sts 0x03AC, r245f82: 90 93 ad 03 sts 0x03AD, r255f86: a0 93 ae 03 sts 0x03AE, r265f8a: b0 93 af 03 sts 0x03AF, r27if(abs(MesswertGier) > 64) if(labs(tmpl) > 128 || labs(tmpl2) > 128) TrichterFlug = 1;5f8e: 91 01 movw r18, r25f90: 33 20 and r3, r35f92: 24 f4 brge .+8 ; 0x5f9c <Mittelwert+0x58c>5f94: 22 27 eor r18, r185f96: 33 27 eor r19, r195f98: 22 19 sub r18, r25f9a: 33 09 sbc r19, r35f9c: 21 34 cpi r18, 0x41 ; 655f9e: 31 05 cpc r19, r15fa0: e4 f1 brlt .+120 ; 0x601a <Mittelwert+0x60a>5fa2: b3 01 movw r22, r65fa4: a2 01 movw r20, r45fa6: 77 20 and r7, r75fa8: 3c f4 brge .+14 ; 0x5fb8 <Mittelwert+0x5a8>5faa: 44 27 eor r20, r205fac: 55 27 eor r21, r215fae: ba 01 movw r22, r205fb0: 44 19 sub r20, r45fb2: 55 09 sbc r21, r55fb4: 66 09 sbc r22, r65fb6: 77 09 sbc r23, r75fb8: 41 38 cpi r20, 0x81 ; 1295fba: 51 05 cpc r21, r15fbc: 61 05 cpc r22, r15fbe: 71 05 cpc r23, r15fc0: 84 f4 brge .+32 ; 0x5fe2 <Mittelwert+0x5d2>5fc2: ac 01 movw r20, r245fc4: bd 01 movw r22, r265fc6: bb 23 and r27, r275fc8: 3c f4 brge .+14 ; 0x5fd8 <Mittelwert+0x5c8>5fca: 44 27 eor r20, r205fcc: 55 27 eor r21, r215fce: ba 01 movw r22, r205fd0: 48 1b sub r20, r245fd2: 59 0b sbc r21, r255fd4: 6a 0b sbc r22, r265fd6: 7b 0b sbc r23, r275fd8: 41 38 cpi r20, 0x81 ; 1295fda: 51 05 cpc r21, r15fdc: 61 05 cpc r22, r15fde: 71 05 cpc r23, r15fe0: e4 f0 brlt .+56 ; 0x601a <Mittelwert+0x60a>5fe2: 81 e0 ldi r24, 0x01 ; 15fe4: 80 93 1a 04 sts 0x041A, r245fe8: 18 c0 rjmp .+48 ; 0x601a <Mittelwert+0x60a>//MesswertGier += (Parameter_CouplingYawCorrection * tmpl4) / 256;}else tmpl = tmpl2 = KopplungsteilNickRoll = KopplungsteilRollNick = 0;5fea: 10 92 18 06 sts 0x0618, r15fee: 10 92 17 06 sts 0x0617, r15ff2: 10 92 16 06 sts 0x0616, r15ff6: 10 92 15 06 sts 0x0615, r15ffa: 10 92 ac 03 sts 0x03AC, r15ffe: 10 92 ad 03 sts 0x03AD, r16002: 10 92 ae 03 sts 0x03AE, r16006: 10 92 af 03 sts 0x03AF, r1600a: 10 92 b0 03 sts 0x03B0, r1600e: 10 92 b1 03 sts 0x03B1, r16012: 10 92 b2 03 sts 0x03B2, r16016: 10 92 b3 03 sts 0x03B3, r1TrimRoll = tmpl - tmpl2 / 100L;601a: c0 90 b0 03 lds r12, 0x03B0601e: d0 90 b1 03 lds r13, 0x03B16022: e0 90 b2 03 lds r14, 0x03B26026: f0 90 b3 03 lds r15, 0x03B3602a: 80 90 ac 03 lds r8, 0x03AC602e: 90 90 ad 03 lds r9, 0x03AD6032: a0 90 ae 03 lds r10, 0x03AE6036: b0 90 af 03 lds r11, 0x03AF603a: 0f 2e mov r0, r31603c: f4 e6 ldi r31, 0x64 ; 100603e: 4f 2e mov r4, r316040: 51 2c mov r5, r16042: 61 2c mov r6, r16044: 71 2c mov r7, r16046: f0 2d mov r31, r06048: c5 01 movw r24, r10604a: b4 01 movw r22, r8604c: a3 01 movw r20, r6604e: 92 01 movw r18, r46050: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>6054: 16 01 movw r2, r126056: 22 1a sub r2, r186058: 33 0a sbc r3, r19605a: 30 92 26 06 sts 0x0626, r3605e: 20 92 25 06 sts 0x0625, r2TrimNick = -tmpl2 + tmpl / 100L;6062: c7 01 movw r24, r146064: b6 01 movw r22, r126066: a3 01 movw r20, r66068: 92 01 movw r18, r4606a: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>606e: f9 01 movw r30, r186070: e8 19 sub r30, r86072: f9 09 sbc r31, r96074: f0 93 1f 06 sts 0x061F, r316078: e0 93 1e 06 sts 0x061E, r30// Kompasswert begrenzen ++++++++++++++++++++++++++++++++++++++++++++++++if(ErsatzKompass >= (360L * GIER_GRAD_FAKTOR)) ErsatzKompass -= 360L * GIER_GRAD_FAKTOR; // 360° Umschlag607c: 40 90 21 01 lds r4, 0x01216080: 50 90 22 01 lds r5, 0x01226084: 60 90 23 01 lds r6, 0x01236088: 70 90 24 01 lds r7, 0x0124608c: a8 e6 ldi r26, 0x68 ; 104608e: b1 e0 ldi r27, 0x01 ; 16090: a3 01 movw r20, r66092: 92 01 movw r18, r46094: 0e 94 c8 b1 call 0x16390 ; 0x16390 <__muluhisi3>6098: 6b 01 movw r12, r22609a: 7c 01 movw r14, r24609c: 80 90 6e 06 lds r8, 0x066E60a0: 90 90 6f 06 lds r9, 0x066F60a4: a0 90 70 06 lds r10, 0x067060a8: b0 90 71 06 lds r11, 0x067160ac: 86 16 cp r8, r2260ae: 97 06 cpc r9, r2360b0: a8 06 cpc r10, r2460b2: b9 06 cpc r11, r2560b4: 84 f0 brlt .+32 ; 0x60d6 <Mittelwert+0x6c6>60b6: a8 e9 ldi r26, 0x98 ; 15260b8: be ef ldi r27, 0xFE ; 25460ba: 0e 94 d4 b1 call 0x163a8 ; 0x163a8 <__mulohisi3>60be: 86 0e add r8, r2260c0: 97 1e adc r9, r2360c2: a8 1e adc r10, r2460c4: b9 1e adc r11, r2560c6: 80 92 6e 06 sts 0x066E, r860ca: 90 92 6f 06 sts 0x066F, r960ce: a0 92 70 06 sts 0x0670, r1060d2: b0 92 71 06 sts 0x0671, r11if(ErsatzKompass < 0) ErsatzKompass += 360L * GIER_GRAD_FAKTOR;60d6: 80 91 6e 06 lds r24, 0x066E60da: 90 91 6f 06 lds r25, 0x066F60de: a0 91 70 06 lds r26, 0x067060e2: b0 91 71 06 lds r27, 0x067160e6: bb 23 and r27, r2760e8: 64 f4 brge .+24 ; 0x6102 <Mittelwert+0x6f2>60ea: 8c 0d add r24, r1260ec: 9d 1d adc r25, r1360ee: ae 1d adc r26, r1460f0: bf 1d adc r27, r1560f2: 80 93 6e 06 sts 0x066E, r2460f6: 90 93 6f 06 sts 0x066F, r2560fa: a0 93 70 06 sts 0x0670, r2660fe: b0 93 71 06 sts 0x0671, r27// Roll ++++++++++++++++++++++++++++++++++++++++++++++++Mess_IntegralRoll += MesswertRoll + TrimRoll - LageKorrekturRoll;6102: 80 91 1c 06 lds r24, 0x061C6106: 90 91 1d 06 lds r25, 0x061D610a: 82 0d add r24, r2610c: 93 1d adc r25, r3610e: 20 91 ec 03 lds r18, 0x03EC6112: 30 91 ed 03 lds r19, 0x03ED6116: 82 1b sub r24, r186118: 93 0b sbc r25, r19611a: aa 27 eor r26, r26611c: 97 fd sbrc r25, 7611e: a0 95 com r266120: ba 2f mov r27, r266122: 40 91 32 04 lds r20, 0x04326126: 50 91 33 04 lds r21, 0x0433612a: 60 91 34 04 lds r22, 0x0434612e: 70 91 35 04 lds r23, 0x04356132: 48 0f add r20, r246134: 59 1f adc r21, r256136: 6a 1f adc r22, r266138: 7b 1f adc r23, r27613a: 40 93 32 04 sts 0x0432, r20613e: 50 93 33 04 sts 0x0433, r216142: 60 93 34 04 sts 0x0434, r226146: 70 93 35 04 sts 0x0435, r23if(Mess_IntegralRoll > Umschlag180Roll)614a: 80 91 42 01 lds r24, 0x0142614e: 90 91 43 01 lds r25, 0x01436152: a0 91 44 01 lds r26, 0x01446156: b0 91 45 01 lds r27, 0x0145615a: 84 17 cp r24, r20615c: 95 07 cpc r25, r21615e: a6 07 cpc r26, r226160: b7 07 cpc r27, r236162: 84 f4 brge .+32 ; 0x6184 <Mittelwert+0x774>{Mess_IntegralRoll = -(Umschlag180Roll - 25000L);6164: 48 ea ldi r20, 0xA8 ; 1686166: 51 e6 ldi r21, 0x61 ; 976168: 60 e0 ldi r22, 0x00 ; 0616a: 70 e0 ldi r23, 0x00 ; 0616c: 48 1b sub r20, r24616e: 59 0b sbc r21, r256170: 6a 0b sbc r22, r266172: 7b 0b sbc r23, r276174: 40 93 32 04 sts 0x0432, r206178: 50 93 33 04 sts 0x0433, r21617c: 60 93 34 04 sts 0x0434, r226180: 70 93 35 04 sts 0x0435, r23}if(Mess_IntegralRoll <-Umschlag180Roll)6184: 88 24 eor r8, r86186: 99 24 eor r9, r96188: 54 01 movw r10, r8618a: 88 1a sub r8, r24618c: 99 0a sbc r9, r25618e: aa 0a sbc r10, r266190: bb 0a sbc r11, r276192: 40 91 32 04 lds r20, 0x04326196: 50 91 33 04 lds r21, 0x0433619a: 60 91 34 04 lds r22, 0x0434619e: 70 91 35 04 lds r23, 0x043561a2: 48 15 cp r20, r861a4: 59 05 cpc r21, r961a6: 6a 05 cpc r22, r1061a8: 7b 05 cpc r23, r1161aa: 64 f4 brge .+24 ; 0x61c4 <Mittelwert+0x7b4>{Mess_IntegralRoll = (Umschlag180Roll - 25000L);61ac: 88 5a subi r24, 0xA8 ; 16861ae: 91 46 sbci r25, 0x61 ; 9761b0: a1 09 sbc r26, r161b2: b1 09 sbc r27, r161b4: 80 93 32 04 sts 0x0432, r2461b8: 90 93 33 04 sts 0x0433, r2561bc: a0 93 34 04 sts 0x0434, r2661c0: b0 93 35 04 sts 0x0435, r27}// Nick ++++++++++++++++++++++++++++++++++++++++++++++++Mess_IntegralNick += MesswertNick + TrimNick - LageKorrekturNick;61c4: 40 91 27 06 lds r20, 0x062761c8: 50 91 28 06 lds r21, 0x062861cc: 4e 0f add r20, r3061ce: 5f 1f adc r21, r3161d0: 20 91 ea 03 lds r18, 0x03EA61d4: 30 91 eb 03 lds r19, 0x03EB61d8: 42 1b sub r20, r1861da: 53 0b sbc r21, r1961dc: 66 27 eor r22, r2261de: 57 fd sbrc r21, 761e0: 60 95 com r2261e2: 76 2f mov r23, r2261e4: 80 91 36 04 lds r24, 0x043661e8: 90 91 37 04 lds r25, 0x043761ec: a0 91 38 04 lds r26, 0x043861f0: b0 91 39 04 lds r27, 0x043961f4: 84 0f add r24, r2061f6: 95 1f adc r25, r2161f8: a6 1f adc r26, r2261fa: b7 1f adc r27, r2361fc: 80 93 36 04 sts 0x0436, r246200: 90 93 37 04 sts 0x0437, r256204: a0 93 38 04 sts 0x0438, r266208: b0 93 39 04 sts 0x0439, r27if(Mess_IntegralNick > Umschlag180Nick)620c: 40 91 46 01 lds r20, 0x01466210: 50 91 47 01 lds r21, 0x01476214: 60 91 48 01 lds r22, 0x01486218: 70 91 49 01 lds r23, 0x0149621c: 48 17 cp r20, r24621e: 59 07 cpc r21, r256220: 6a 07 cpc r22, r266222: 7b 07 cpc r23, r276224: 84 f4 brge .+32 ; 0x6246 <Mittelwert+0x836>{Mess_IntegralNick = -(Umschlag180Nick - 25000L);6226: 88 ea ldi r24, 0xA8 ; 1686228: 91 e6 ldi r25, 0x61 ; 97622a: a0 e0 ldi r26, 0x00 ; 0622c: b0 e0 ldi r27, 0x00 ; 0622e: 84 1b sub r24, r206230: 95 0b sbc r25, r216232: a6 0b sbc r26, r226234: b7 0b sbc r27, r236236: 80 93 36 04 sts 0x0436, r24623a: 90 93 37 04 sts 0x0437, r25623e: a0 93 38 04 sts 0x0438, r266242: b0 93 39 04 sts 0x0439, r27}if(Mess_IntegralNick <-Umschlag180Nick)6246: 88 24 eor r8, r86248: 99 24 eor r9, r9624a: 54 01 movw r10, r8624c: 84 1a sub r8, r20624e: 95 0a sbc r9, r216250: a6 0a sbc r10, r226252: b7 0a sbc r11, r236254: 80 91 36 04 lds r24, 0x04366258: 90 91 37 04 lds r25, 0x0437625c: a0 91 38 04 lds r26, 0x04386260: b0 91 39 04 lds r27, 0x04396264: 88 15 cp r24, r86266: 99 05 cpc r25, r96268: aa 05 cpc r26, r10626a: bb 05 cpc r27, r11626c: 74 f4 brge .+28 ; 0x628a <Mittelwert+0x87a>{Mess_IntegralNick = (Umschlag180Nick - 25000L);626e: db 01 movw r26, r226270: ca 01 movw r24, r206272: 88 5a subi r24, 0xA8 ; 1686274: 91 46 sbci r25, 0x61 ; 976276: a1 09 sbc r26, r16278: b1 09 sbc r27, r1627a: 80 93 36 04 sts 0x0436, r24627e: 90 93 37 04 sts 0x0437, r256282: a0 93 38 04 sts 0x0438, r266286: b0 93 39 04 sts 0x0439, r27}Integral_Gier = Mess_Integral_Gier;628a: 80 91 2e 04 lds r24, 0x042E628e: 90 91 2f 04 lds r25, 0x042F6292: a0 91 30 04 lds r26, 0x04306296: b0 91 31 04 lds r27, 0x0431629a: 80 93 3a 04 sts 0x043A, r24629e: 90 93 3b 04 sts 0x043B, r2562a2: a0 93 3c 04 sts 0x043C, r2662a6: b0 93 3d 04 sts 0x043D, r27IntegralNick = Mess_IntegralNick;62aa: 80 91 36 04 lds r24, 0x043662ae: 90 91 37 04 lds r25, 0x043762b2: a0 91 38 04 lds r26, 0x043862b6: b0 91 39 04 lds r27, 0x043962ba: 80 93 42 04 sts 0x0442, r2462be: 90 93 43 04 sts 0x0443, r2562c2: a0 93 44 04 sts 0x0444, r2662c6: b0 93 45 04 sts 0x0445, r27IntegralRoll = Mess_IntegralRoll;62ca: 80 91 32 04 lds r24, 0x043262ce: 90 91 33 04 lds r25, 0x043362d2: a0 91 34 04 lds r26, 0x043462d6: b0 91 35 04 lds r27, 0x043562da: 80 93 3e 04 sts 0x043E, r2462de: 90 93 3f 04 sts 0x043F, r2562e2: a0 93 40 04 sts 0x0440, r2662e6: b0 93 41 04 sts 0x0441, r27#define D_LIMIT 128MesswertNick = HiResNick / 8;62ea: 80 91 18 01 lds r24, 0x011862ee: 90 91 19 01 lds r25, 0x011962f2: 99 23 and r25, r2562f4: 0c f4 brge .+2 ; 0x62f8 <Mittelwert+0x8e8>62f6: 07 96 adiw r24, 0x07 ; 762f8: 95 95 asr r2562fa: 87 95 ror r2462fc: 95 95 asr r2562fe: 87 95 ror r246300: 95 95 asr r256302: 87 95 ror r246304: 90 93 28 06 sts 0x0628, r256308: 80 93 27 06 sts 0x0627, r24MesswertRoll = HiResRoll / 8;630c: 80 91 16 01 lds r24, 0x01166310: 90 91 17 01 lds r25, 0x01176314: 99 23 and r25, r256316: 0c f4 brge .+2 ; 0x631a <Mittelwert+0x90a>6318: 07 96 adiw r24, 0x07 ; 7631a: 95 95 asr r25631c: 87 95 ror r24631e: 95 95 asr r256320: 87 95 ror r246322: 95 95 asr r256324: 87 95 ror r246326: 90 93 1d 06 sts 0x061D, r25632a: 80 93 1c 06 sts 0x061C, r24if(AdWertNick < 15) MesswertNick = -1000; if(AdWertNick < 7) MesswertNick = -2000;632e: 80 91 65 03 lds r24, 0x03656332: 90 91 66 03 lds r25, 0x03666336: 0f 97 sbiw r24, 0x0f ; 156338: 34 f4 brge .+12 ; 0x6346 <Mittelwert+0x936>633a: 88 e1 ldi r24, 0x18 ; 24633c: 9c ef ldi r25, 0xFC ; 252633e: 90 93 28 06 sts 0x0628, r256342: 80 93 27 06 sts 0x0627, r246346: 80 91 65 03 lds r24, 0x0365634a: 90 91 66 03 lds r25, 0x0366634e: 07 97 sbiw r24, 0x07 ; 76350: 34 f4 brge .+12 ; 0x635e <Mittelwert+0x94e>6352: 80 e3 ldi r24, 0x30 ; 486354: 98 ef ldi r25, 0xF8 ; 2486356: 90 93 28 06 sts 0x0628, r25635a: 80 93 27 06 sts 0x0627, r24// if(PlatinenVersion == 10) { if(AdWertNick > 1010) MesswertNick = +1000; if(AdWertNick > 1017) MesswertNick = +2000; }// else{ if(AdWertNick > 2000) MesswertNick = +1000; if(AdWertNick > 2015) MesswertNick = +2000; }635e: 80 91 65 03 lds r24, 0x03656362: 90 91 66 03 lds r25, 0x03666366: 81 3d cpi r24, 0xD1 ; 2096368: 97 40 sbci r25, 0x07 ; 7636a: 34 f0 brlt .+12 ; 0x6378 <Mittelwert+0x968>636c: 88 ee ldi r24, 0xE8 ; 232636e: 93 e0 ldi r25, 0x03 ; 36370: 90 93 28 06 sts 0x0628, r256374: 80 93 27 06 sts 0x0627, r246378: 80 91 65 03 lds r24, 0x0365637c: 90 91 66 03 lds r25, 0x03666380: 80 3e cpi r24, 0xE0 ; 2246382: 97 40 sbci r25, 0x07 ; 76384: 34 f0 brlt .+12 ; 0x6392 <Mittelwert+0x982>6386: 80 ed ldi r24, 0xD0 ; 2086388: 97 e0 ldi r25, 0x07 ; 7638a: 90 93 28 06 sts 0x0628, r25638e: 80 93 27 06 sts 0x0627, r24if(AdWertRoll < 15) MesswertRoll = -1000; if(AdWertRoll < 7) MesswertRoll = -2000;6392: 80 91 63 03 lds r24, 0x03636396: 90 91 64 03 lds r25, 0x0364639a: 0f 97 sbiw r24, 0x0f ; 15639c: 34 f4 brge .+12 ; 0x63aa <Mittelwert+0x99a>639e: 88 e1 ldi r24, 0x18 ; 2463a0: 9c ef ldi r25, 0xFC ; 25263a2: 90 93 1d 06 sts 0x061D, r2563a6: 80 93 1c 06 sts 0x061C, r2463aa: 80 91 63 03 lds r24, 0x036363ae: 90 91 64 03 lds r25, 0x036463b2: 07 97 sbiw r24, 0x07 ; 763b4: 34 f4 brge .+12 ; 0x63c2 <Mittelwert+0x9b2>63b6: 80 e3 ldi r24, 0x30 ; 4863b8: 98 ef ldi r25, 0xF8 ; 24863ba: 90 93 1d 06 sts 0x061D, r2563be: 80 93 1c 06 sts 0x061C, r24// if(PlatinenVersion == 10) { if(AdWertRoll > 1010) MesswertRoll = +1000; if(AdWertRoll > 1017) MesswertRoll = +2000; }// else{ if(AdWertRoll > 2000) MesswertRoll = +1000; if(AdWertRoll > 2015) MesswertRoll = +2000; }63c2: 80 91 63 03 lds r24, 0x036363c6: 90 91 64 03 lds r25, 0x036463ca: 81 3d cpi r24, 0xD1 ; 20963cc: 97 40 sbci r25, 0x07 ; 763ce: 34 f0 brlt .+12 ; 0x63dc <Mittelwert+0x9cc>63d0: 88 ee ldi r24, 0xE8 ; 23263d2: 93 e0 ldi r25, 0x03 ; 363d4: 90 93 1d 06 sts 0x061D, r2563d8: 80 93 1c 06 sts 0x061C, r2463dc: 80 91 63 03 lds r24, 0x036363e0: 90 91 64 03 lds r25, 0x036463e4: 80 3e cpi r24, 0xE0 ; 22463e6: 97 40 sbci r25, 0x07 ; 763e8: 34 f0 brlt .+12 ; 0x63f6 <Mittelwert+0x9e6>63ea: 80 ed ldi r24, 0xD0 ; 20863ec: 97 e0 ldi r25, 0x07 ; 763ee: 90 93 1d 06 sts 0x061D, r2563f2: 80 93 1c 06 sts 0x061C, r24if(Parameter_Gyro_D)63f6: 40 91 35 01 lds r20, 0x013563fa: 44 23 and r20, r2063fc: 09 f4 brne .+2 ; 0x6400 <Mittelwert+0x9f0>63fe: ba c0 rjmp .+372 ; 0x6574 <Mittelwert+0xb64>{d2Nick = HiResNick - oldNick;6400: 80 91 18 01 lds r24, 0x01186404: 90 91 19 01 lds r25, 0x01196408: 20 91 aa 03 lds r18, 0x03AA640c: 30 91 ab 03 lds r19, 0x03AB6410: 82 1b sub r24, r186412: 93 0b sbc r25, r196414: 90 93 a9 03 sts 0x03A9, r256418: 80 93 a8 03 sts 0x03A8, r24oldNick = (oldNick + HiResNick)/2;641c: 60 91 18 01 lds r22, 0x01186420: 70 91 19 01 lds r23, 0x01196424: 26 0f add r18, r226426: 37 1f adc r19, r236428: 33 23 and r19, r19642a: 14 f4 brge .+4 ; 0x6430 <Mittelwert+0xa20>642c: 2f 5f subi r18, 0xFF ; 255642e: 3f 4f sbci r19, 0xFF ; 2556430: 35 95 asr r196432: 27 95 ror r186434: 30 93 ab 03 sts 0x03AB, r196438: 20 93 aa 03 sts 0x03AA, r18if(d2Nick > D_LIMIT) d2Nick = D_LIMIT;643c: 81 38 cpi r24, 0x81 ; 129643e: 91 05 cpc r25, r16440: 3c f0 brlt .+14 ; 0x6450 <Mittelwert+0xa40>6442: 80 e8 ldi r24, 0x80 ; 1286444: 90 e0 ldi r25, 0x00 ; 06446: 90 93 a9 03 sts 0x03A9, r25644a: 80 93 a8 03 sts 0x03A8, r24644e: 09 c0 rjmp .+18 ; 0x6462 <Mittelwert+0xa52>else if(d2Nick < -D_LIMIT) d2Nick = -D_LIMIT;6450: 80 38 cpi r24, 0x80 ; 1286452: 9f 4f sbci r25, 0xFF ; 2556454: 34 f4 brge .+12 ; 0x6462 <Mittelwert+0xa52>6456: 80 e8 ldi r24, 0x80 ; 1286458: 9f ef ldi r25, 0xFF ; 255645a: 90 93 a9 03 sts 0x03A9, r25645e: 80 93 a8 03 sts 0x03A8, r24d2Roll = HiResRoll - oldRoll;6462: 80 91 16 01 lds r24, 0x01166466: 90 91 17 01 lds r25, 0x0117646a: 20 91 a6 03 lds r18, 0x03A6646e: 30 91 a7 03 lds r19, 0x03A76472: 82 1b sub r24, r186474: 93 0b sbc r25, r196476: 90 93 a5 03 sts 0x03A5, r25647a: 80 93 a4 03 sts 0x03A4, r24oldRoll = (oldRoll + HiResRoll)/2;647e: 60 91 16 01 lds r22, 0x01166482: 70 91 17 01 lds r23, 0x01176486: 26 0f add r18, r226488: 37 1f adc r19, r23648a: 33 23 and r19, r19648c: 14 f4 brge .+4 ; 0x6492 <Mittelwert+0xa82>648e: 2f 5f subi r18, 0xFF ; 2556490: 3f 4f sbci r19, 0xFF ; 2556492: 35 95 asr r196494: 27 95 ror r186496: 30 93 a7 03 sts 0x03A7, r19649a: 20 93 a6 03 sts 0x03A6, r18if(d2Roll > D_LIMIT) d2Roll = D_LIMIT;649e: 81 38 cpi r24, 0x81 ; 12964a0: 91 05 cpc r25, r164a2: 3c f0 brlt .+14 ; 0x64b2 <Mittelwert+0xaa2>64a4: 80 e8 ldi r24, 0x80 ; 12864a6: 90 e0 ldi r25, 0x00 ; 064a8: 90 93 a5 03 sts 0x03A5, r2564ac: 80 93 a4 03 sts 0x03A4, r2464b0: 09 c0 rjmp .+18 ; 0x64c4 <Mittelwert+0xab4>else if(d2Roll < -D_LIMIT) d2Roll = -D_LIMIT;64b2: 80 38 cpi r24, 0x80 ; 12864b4: 9f 4f sbci r25, 0xFF ; 25564b6: 34 f4 brge .+12 ; 0x64c4 <Mittelwert+0xab4>64b8: 80 e8 ldi r24, 0x80 ; 12864ba: 9f ef ldi r25, 0xFF ; 25564bc: 90 93 a5 03 sts 0x03A5, r2564c0: 80 93 a4 03 sts 0x03A4, r24MesswertNick += (d2Nick * (signed int) Parameter_Gyro_D) / 16;64c4: 50 e0 ldi r21, 0x00 ; 064c6: 80 91 a8 03 lds r24, 0x03A864ca: 90 91 a9 03 lds r25, 0x03A964ce: 48 9f mul r20, r2464d0: 90 01 movw r18, r064d2: 49 9f mul r20, r2564d4: 30 0d add r19, r064d6: 58 9f mul r21, r2464d8: 30 0d add r19, r064da: 11 24 eor r1, r164dc: c9 01 movw r24, r1864de: 33 23 and r19, r1964e0: 0c f4 brge .+2 ; 0x64e4 <Mittelwert+0xad4>64e2: 0f 96 adiw r24, 0x0f ; 1564e4: 95 95 asr r2564e6: 87 95 ror r2464e8: 95 95 asr r2564ea: 87 95 ror r2464ec: 95 95 asr r2564ee: 87 95 ror r2464f0: 95 95 asr r2564f2: 87 95 ror r2464f4: 60 91 27 06 lds r22, 0x062764f8: 70 91 28 06 lds r23, 0x062864fc: 86 0f add r24, r2264fe: 97 1f adc r25, r236500: 90 93 28 06 sts 0x0628, r256504: 80 93 27 06 sts 0x0627, r24MesswertRoll += (d2Roll * (signed int) Parameter_Gyro_D) / 16;6508: 60 91 a4 03 lds r22, 0x03A4650c: 70 91 a5 03 lds r23, 0x03A56510: 46 9f mul r20, r226512: c0 01 movw r24, r06514: 47 9f mul r20, r236516: 90 0d add r25, r06518: 56 9f mul r21, r22651a: 90 0d add r25, r0651c: 11 24 eor r1, r1651e: ac 01 movw r20, r246520: 99 23 and r25, r256522: 14 f4 brge .+4 ; 0x6528 <Mittelwert+0xb18>6524: 41 5f subi r20, 0xF1 ; 2416526: 5f 4f sbci r21, 0xFF ; 2556528: 55 95 asr r21652a: 47 95 ror r20652c: 55 95 asr r21652e: 47 95 ror r206530: 55 95 asr r216532: 47 95 ror r206534: 55 95 asr r216536: 47 95 ror r206538: 60 91 1c 06 lds r22, 0x061C653c: 70 91 1d 06 lds r23, 0x061D6540: 46 0f add r20, r226542: 57 1f adc r21, r236544: 50 93 1d 06 sts 0x061D, r216548: 40 93 1c 06 sts 0x061C, r20HiResNick += (d2Nick * (signed int) Parameter_Gyro_D);654c: 40 91 18 01 lds r20, 0x01186550: 50 91 19 01 lds r21, 0x01196554: 24 0f add r18, r206556: 35 1f adc r19, r216558: 30 93 19 01 sts 0x0119, r19655c: 20 93 18 01 sts 0x0118, r18HiResRoll += (d2Roll * (signed int) Parameter_Gyro_D);6560: 20 91 16 01 lds r18, 0x01166564: 30 91 17 01 lds r19, 0x01176568: 82 0f add r24, r18656a: 93 1f adc r25, r19656c: 90 93 17 01 sts 0x0117, r256570: 80 93 16 01 sts 0x0116, r24}if(RohMesswertRoll > 0) TrimRoll += ((long) abs(KopplungsteilNickRoll) * Parameter_CouplingYawCorrection) / 64L;6574: 40 91 2a 06 lds r20, 0x062A6578: 50 91 2b 06 lds r21, 0x062B657c: 14 16 cp r1, r20657e: 15 06 cpc r1, r216580: 3c f5 brge .+78 ; 0x65d0 <Mittelwert+0xbc0>6582: a0 91 15 06 lds r26, 0x06156586: b0 91 16 06 lds r27, 0x0616658a: bb 23 and r27, r27658c: 1c f4 brge .+6 ; 0x6594 <Mittelwert+0xb84>658e: b1 95 neg r276590: a1 95 neg r266592: b1 09 sbc r27, r16594: 20 91 28 01 lds r18, 0x01286598: 30 e0 ldi r19, 0x00 ; 0659a: 0e 94 c2 b1 call 0x16384 ; 0x16384 <__usmulhisi3>659e: 8b 01 movw r16, r2265a0: 9c 01 movw r18, r2465a2: 99 23 and r25, r2565a4: 24 f4 brge .+8 ; 0x65ae <Mittelwert+0xb9e>65a6: 01 5c subi r16, 0xC1 ; 19365a8: 1f 4f sbci r17, 0xFF ; 25565aa: 2f 4f sbci r18, 0xFF ; 25565ac: 3f 4f sbci r19, 0xFF ; 25565ae: d9 01 movw r26, r1865b0: c8 01 movw r24, r1665b2: 68 94 set65b4: 15 f8 bld r1, 565b6: b5 95 asr r2765b8: a7 95 ror r2665ba: 97 95 ror r2565bc: 87 95 ror r2465be: 16 94 lsr r165c0: d1 f7 brne .-12 ; 0x65b6 <Mittelwert+0xba6>65c2: 82 0d add r24, r265c4: 93 1d adc r25, r365c6: 90 93 26 06 sts 0x0626, r2565ca: 80 93 25 06 sts 0x0625, r2465ce: 27 c0 rjmp .+78 ; 0x661e <Mittelwert+0xc0e>else TrimRoll -= ((long) abs(KopplungsteilNickRoll) * Parameter_CouplingYawCorrection) / 64L;65d0: a0 91 15 06 lds r26, 0x061565d4: b0 91 16 06 lds r27, 0x061665d8: bb 23 and r27, r2765da: 1c f4 brge .+6 ; 0x65e2 <Mittelwert+0xbd2>65dc: b1 95 neg r2765de: a1 95 neg r2665e0: b1 09 sbc r27, r165e2: 20 91 28 01 lds r18, 0x012865e6: 30 e0 ldi r19, 0x00 ; 065e8: 0e 94 c2 b1 call 0x16384 ; 0x16384 <__usmulhisi3>65ec: 8b 01 movw r16, r2265ee: 9c 01 movw r18, r2465f0: 99 23 and r25, r2565f2: 24 f4 brge .+8 ; 0x65fc <Mittelwert+0xbec>65f4: 01 5c subi r16, 0xC1 ; 19365f6: 1f 4f sbci r17, 0xFF ; 25565f8: 2f 4f sbci r18, 0xFF ; 25565fa: 3f 4f sbci r19, 0xFF ; 25565fc: d9 01 movw r26, r1865fe: c8 01 movw r24, r166600: 68 94 set6602: 15 f8 bld r1, 56604: b5 95 asr r276606: a7 95 ror r266608: 97 95 ror r25660a: 87 95 ror r24660c: 16 94 lsr r1660e: d1 f7 brne .-12 ; 0x6604 <Mittelwert+0xbf4>6610: 71 01 movw r14, r26612: e8 1a sub r14, r246614: f9 0a sbc r15, r256616: f0 92 26 06 sts 0x0626, r15661a: e0 92 25 06 sts 0x0625, r14if(RohMesswertNick > 0) TrimNick += ((long) abs(KopplungsteilRollNick) * Parameter_CouplingYawCorrection) / 64L;661e: e0 90 2f 06 lds r14, 0x062F6622: f0 90 30 06 lds r15, 0x06306626: 1e 14 cp r1, r146628: 1f 04 cpc r1, r15662a: 3c f5 brge .+78 ; 0x667a <Mittelwert+0xc6a>662c: a0 91 17 06 lds r26, 0x06176630: b0 91 18 06 lds r27, 0x06186634: bb 23 and r27, r276636: 1c f4 brge .+6 ; 0x663e <Mittelwert+0xc2e>6638: b1 95 neg r27663a: a1 95 neg r26663c: b1 09 sbc r27, r1663e: 20 91 28 01 lds r18, 0x01286642: 30 e0 ldi r19, 0x00 ; 06644: 0e 94 c2 b1 call 0x16384 ; 0x16384 <__usmulhisi3>6648: 8b 01 movw r16, r22664a: 9c 01 movw r18, r24664c: 99 23 and r25, r25664e: 24 f4 brge .+8 ; 0x6658 <Mittelwert+0xc48>6650: 01 5c subi r16, 0xC1 ; 1936652: 1f 4f sbci r17, 0xFF ; 2556654: 2f 4f sbci r18, 0xFF ; 2556656: 3f 4f sbci r19, 0xFF ; 2556658: d9 01 movw r26, r18665a: c8 01 movw r24, r16665c: 68 94 set665e: 15 f8 bld r1, 56660: b5 95 asr r276662: a7 95 ror r266664: 97 95 ror r256666: 87 95 ror r246668: 16 94 lsr r1666a: d1 f7 brne .-12 ; 0x6660 <Mittelwert+0xc50>666c: 8e 0f add r24, r30666e: 9f 1f adc r25, r316670: 90 93 1f 06 sts 0x061F, r256674: 80 93 1e 06 sts 0x061E, r246678: 26 c0 rjmp .+76 ; 0x66c6 <Mittelwert+0xcb6>else TrimNick -= ((long) abs(KopplungsteilRollNick) * Parameter_CouplingYawCorrection) / 64L;667a: a0 91 17 06 lds r26, 0x0617667e: b0 91 18 06 lds r27, 0x06186682: bb 23 and r27, r276684: 1c f4 brge .+6 ; 0x668c <Mittelwert+0xc7c>6686: b1 95 neg r276688: a1 95 neg r26668a: b1 09 sbc r27, r1668c: 20 91 28 01 lds r18, 0x01286690: 30 e0 ldi r19, 0x00 ; 06692: 0e 94 c2 b1 call 0x16384 ; 0x16384 <__usmulhisi3>6696: 8b 01 movw r16, r226698: 9c 01 movw r18, r24669a: 99 23 and r25, r25669c: 24 f4 brge .+8 ; 0x66a6 <Mittelwert+0xc96>669e: 01 5c subi r16, 0xC1 ; 19366a0: 1f 4f sbci r17, 0xFF ; 25566a2: 2f 4f sbci r18, 0xFF ; 25566a4: 3f 4f sbci r19, 0xFF ; 25566a6: d9 01 movw r26, r1866a8: c8 01 movw r24, r1666aa: 68 94 set66ac: 15 f8 bld r1, 566ae: b5 95 asr r2766b0: a7 95 ror r2666b2: 97 95 ror r2566b4: 87 95 ror r2466b6: 16 94 lsr r166b8: d1 f7 brne .-12 ; 0x66ae <Mittelwert+0xc9e>66ba: e8 1b sub r30, r2466bc: f9 0b sbc r31, r2566be: f0 93 1f 06 sts 0x061F, r3166c2: e0 93 1e 06 sts 0x061E, r30if(Parameter_GlobalConfig & CFG_DREHRATEN_BEGRENZER && !Looping_Nick && !Looping_Roll)66c6: 80 91 5c 06 lds r24, 0x065C66ca: 88 23 and r24, r2466cc: 0c f0 brlt .+2 ; 0x66d0 <Mittelwert+0xcc0>66ce: 46 c0 rjmp .+140 ; 0x675c <Mittelwert+0xd4c>66d0: 80 91 e7 03 lds r24, 0x03E766d4: 81 11 cpse r24, r166d6: 42 c0 rjmp .+132 ; 0x675c <Mittelwert+0xd4c>66d8: 80 91 e6 03 lds r24, 0x03E666dc: 81 11 cpse r24, r166de: 3e c0 rjmp .+124 ; 0x675c <Mittelwert+0xd4c>{if(RohMesswertNick > 256) MesswertNick += 1 * (RohMesswertNick - 256);66e0: b1 e0 ldi r27, 0x01 ; 166e2: eb 16 cp r14, r2766e4: fb 06 cpc r15, r2766e6: 64 f0 brlt .+24 ; 0x6700 <Mittelwert+0xcf0>66e8: fa 94 dec r1566ea: 80 91 27 06 lds r24, 0x062766ee: 90 91 28 06 lds r25, 0x062866f2: e8 0e add r14, r2466f4: f9 1e adc r15, r2566f6: f0 92 28 06 sts 0x0628, r1566fa: e0 92 27 06 sts 0x0627, r1466fe: 0f c0 rjmp .+30 ; 0x671e <Mittelwert+0xd0e>else if(RohMesswertNick < -256) MesswertNick += 1 * (RohMesswertNick + 256);6700: e1 14 cp r14, r16702: ff ef ldi r31, 0xFF ; 2556704: ff 06 cpc r15, r316706: 5c f4 brge .+22 ; 0x671e <Mittelwert+0xd0e>6708: f3 94 inc r15670a: 80 91 27 06 lds r24, 0x0627670e: 90 91 28 06 lds r25, 0x06286712: e8 0e add r14, r246714: f9 1e adc r15, r256716: f0 92 28 06 sts 0x0628, r15671a: e0 92 27 06 sts 0x0627, r14if(RohMesswertRoll > 256) MesswertRoll += 1 * (RohMesswertRoll - 256);671e: 41 30 cpi r20, 0x01 ; 16720: 11 e0 ldi r17, 0x01 ; 16722: 51 07 cpc r21, r176724: 64 f0 brlt .+24 ; 0x673e <Mittelwert+0xd2e>6726: 5a 95 dec r216728: 80 91 1c 06 lds r24, 0x061C672c: 90 91 1d 06 lds r25, 0x061D6730: 48 0f add r20, r246732: 59 1f adc r21, r256734: 50 93 1d 06 sts 0x061D, r216738: 40 93 1c 06 sts 0x061C, r20673c: 0f c0 rjmp .+30 ; 0x675c <Mittelwert+0xd4c>else if(RohMesswertRoll < -256) MesswertRoll += 1 * (RohMesswertRoll + 256);673e: 41 15 cp r20, r16740: 2f ef ldi r18, 0xFF ; 2556742: 52 07 cpc r21, r186744: 5c f4 brge .+22 ; 0x675c <Mittelwert+0xd4c>6746: 53 95 inc r216748: 80 91 1c 06 lds r24, 0x061C674c: 90 91 1d 06 lds r25, 0x061D6750: 48 0f add r20, r246752: 59 1f adc r21, r256754: 50 93 1d 06 sts 0x061D, r216758: 40 93 1c 06 sts 0x061C, r20}}675c: 60 96 adiw r28, 0x10 ; 16675e: 0f b6 in r0, 0x3f ; 636760: f8 94 cli6762: de bf out 0x3e, r29 ; 626764: 0f be out 0x3f, r0 ; 636766: cd bf out 0x3d, r28 ; 616768: df 91 pop r29676a: cf 91 pop r28676c: 1f 91 pop r17676e: 0f 91 pop r166770: ff 90 pop r156772: ef 90 pop r146774: df 90 pop r136776: cf 90 pop r126778: bf 90 pop r11677a: af 90 pop r10677c: 9f 90 pop r9677e: 8f 90 pop r86780: 7f 90 pop r76782: 6f 90 pop r66784: 5f 90 pop r56786: 4f 90 pop r46788: 3f 90 pop r3678a: 2f 90 pop r2678c: 08 95 ret0000678e <SendMotorData>://############################################################################// Senden der Motorwerte per I2C-Busvoid SendMotorData(void)//############################################################################{678e: cf 93 push r286790: df 93 push r29unsigned char i;if(!MotorenEin)6792: 80 91 03 04 lds r24, 0x04036796: 81 11 cpse r24, r16798: 28 c0 rjmp .+80 ; 0x67ea <SendMotorData+0x5c>{FC_StatusFlags &= ~(FC_STATUS_MOTOR_RUN | FC_STATUS_FLY);679a: 80 91 cb 03 lds r24, 0x03CB679e: 8c 7f andi r24, 0xFC ; 25267a0: 80 93 cb 03 sts 0x03CB, r24FC_StatusFlags2 &= ~FC_STATUS2_WAIT_FOR_TAKEOFF;67a4: 80 91 ca 03 lds r24, 0x03CA67a8: 8f 7d andi r24, 0xDF ; 22367aa: 80 93 ca 03 sts 0x03CA, r2467ae: a7 e6 ldi r26, 0x67 ; 10367b0: ba e0 ldi r27, 0x0A ; 1067b2: e9 e9 ldi r30, 0x99 ; 15367b4: f9 e0 ldi r31, 0x09 ; 967b6: 83 e7 ldi r24, 0x73 ; 11567b8: 9a e0 ldi r25, 0x0A ; 10for(i=0;i<MAX_MOTORS;i++){if(!PC_MotortestActive) MotorTest[i] = 0;67ba: 20 91 f5 04 lds r18, 0x04F567be: 21 11 cpse r18, r167c0: 01 c0 rjmp .+2 ; 0x67c4 <SendMotorData+0x36>67c2: 1c 92 st X, r1Motor[i].SetPoint = MotorTest[i];67c4: 2d 91 ld r18, X+67c6: ef 01 movw r28, r3067c8: 21 97 sbiw r28, 0x01 ; 167ca: 28 83 st Y, r18Motor[i].SetPointLowerBits = 0;67cc: 10 82 st Z, r167ce: 3f 96 adiw r30, 0x0f ; 15unsigned char i;if(!MotorenEin){FC_StatusFlags &= ~(FC_STATUS_MOTOR_RUN | FC_STATUS_FLY);FC_StatusFlags2 &= ~FC_STATUS2_WAIT_FOR_TAKEOFF;for(i=0;i<MAX_MOTORS;i++)67d0: a8 17 cp r26, r2467d2: b9 07 cpc r27, r2567d4: 91 f7 brne .-28 ; 0x67ba <SendMotorData+0x2c>/*Motor[i].SetPoint = MotorTest[i] / 4; // testing the high resolutionMotor[i].SetPointLowerBits = MotorTest[i] % 4;*/}if(PC_MotortestActive) PC_MotortestActive--;67d6: 80 91 f5 04 lds r24, 0x04F567da: 88 23 and r24, r2467dc: 59 f0 breq .+22 ; 0x67f4 <SendMotorData+0x66>67de: 80 91 f5 04 lds r24, 0x04F567e2: 81 50 subi r24, 0x01 ; 167e4: 80 93 f5 04 sts 0x04F5, r2467e8: 05 c0 rjmp .+10 ; 0x67f4 <SendMotorData+0x66>}else FC_StatusFlags |= FC_STATUS_MOTOR_RUN;67ea: 80 91 cb 03 lds r24, 0x03CB67ee: 81 60 ori r24, 0x01 ; 167f0: 80 93 cb 03 sts 0x03CB, r24return;}}#endifif(I2C_TransferActive)67f4: 80 91 e0 04 lds r24, 0x04E067f8: 88 23 and r24, r2467fa: 19 f0 breq .+6 ; 0x6802 <SendMotorData+0x74>{I2C_TransferActive = 0; // enable for the next time67fc: 10 92 e0 04 sts 0x04E0, r16800: 0a c0 rjmp .+20 ; 0x6816 <SendMotorData+0x88>}else{// motor_write = 0;I2C_Start(TWI_STATE_MOTOR_TX); //Start I2C Interrupt Mode6802: 10 92 e3 04 sts 0x04E3, r16806: 80 91 de 04 lds r24, 0x04DE680a: 8e 7f andi r24, 0xFE ; 254680c: 80 93 de 04 sts 0x04DE, r246810: 85 ea ldi r24, 0xA5 ; 1656812: 80 93 bc 00 sts 0x00BC, r24}}6816: df 91 pop r296818: cf 91 pop r28681a: 08 95 ret0000681c <GetChannelValue>:unsigned char GetChannelValue(unsigned char ch) // gives the unsigned value of the channel{int tmp2;if(ch == 0) return(0);681c: 88 23 and r24, r24681e: a9 f0 breq .+42 ; 0x684a <GetChannelValue+0x2e>tmp2 = PPM_in[ch] + 127;6820: e8 2f mov r30, r246822: f0 e0 ldi r31, 0x00 ; 06824: ee 0f add r30, r306826: ff 1f adc r31, r316828: ef 5c subi r30, 0xCF ; 207682a: f7 4f sbci r31, 0xF7 ; 247682c: 80 81 ld r24, Z682e: 91 81 ldd r25, Z+1 ; 0x016830: 81 58 subi r24, 0x81 ; 1296832: 9f 4f sbci r25, 0xFF ; 2556834: 99 23 and r25, r256836: 14 f4 brge .+4 ; 0x683c <GetChannelValue+0x20>6838: 80 e0 ldi r24, 0x00 ; 0683a: 90 e0 ldi r25, 0x00 ; 0683c: 8f 3f cpi r24, 0xFF ; 255683e: 91 05 cpc r25, r16840: 29 f0 breq .+10 ; 0x684c <GetChannelValue+0x30>6842: 24 f0 brlt .+8 ; 0x684c <GetChannelValue+0x30>6844: 8f ef ldi r24, 0xFF ; 2556846: 90 e0 ldi r25, 0x00 ; 0if(tmp2 > 255) tmp2 = 255; else if(tmp2 < 0) tmp2 = 0;return(tmp2);6848: 08 95 ret}unsigned char GetChannelValue(unsigned char ch) // gives the unsigned value of the channel{int tmp2;if(ch == 0) return(0);684a: 80 e0 ldi r24, 0x00 ; 0tmp2 = PPM_in[ch] + 127;if(tmp2 > 255) tmp2 = 255; else if(tmp2 < 0) tmp2 = 0;return(tmp2);}684c: 08 95 ret0000684e <ParameterZuordnung>://############################################################################// Trägt ggf. das Poti als Parameter einvoid ParameterZuordnung(void)//############################################################################{684e: df 92 push r136850: ef 92 push r146852: ff 92 push r156854: 0f 93 push r166856: 1f 93 push r176858: cf 93 push r28685a: df 93 push r29685c: a3 e4 ldi r26, 0x43 ; 67685e: b5 e0 ldi r27, 0x05 ; 56860: e5 e0 ldi r30, 0x05 ; 56862: f4 e0 ldi r31, 0x04 ; 46864: 4b e4 ldi r20, 0x4B ; 756866: 55 e0 ldi r21, 0x05 ; 56868: e1 2c mov r14, r1686a: f1 2c mov r15, r1686c: 0f ef ldi r16, 0xFF ; 255686e: 10 e0 ldi r17, 0x00 ; 0unsigned char tmp,i;for(i=0;i<8;i++){int tmp2;tmp = EE_Parameter.Kanalbelegung[K_POTI1 + i];6870: 2d 91 ld r18, X+tmp2 = PPM_in[tmp] + 127;6872: c2 2f mov r28, r186874: d0 e0 ldi r29, 0x00 ; 06876: cc 0f add r28, r286878: dd 1f adc r29, r29687a: cf 5c subi r28, 0xCF ; 207687c: d7 4f sbci r29, 0xF7 ; 247687e: 88 81 ld r24, Y6880: 99 81 ldd r25, Y+1 ; 0x016882: 81 58 subi r24, 0x81 ; 1296884: 9f 4f sbci r25, 0xFF ; 2556886: 99 23 and r25, r256888: 14 f4 brge .+4 ; 0x688e <ParameterZuordnung+0x40>688a: 8e 2d mov r24, r14688c: 9f 2d mov r25, r15688e: 8f 3f cpi r24, 0xFF ; 2556890: 91 05 cpc r25, r16892: 19 f0 breq .+6 ; 0x689a <ParameterZuordnung+0x4c>6894: 14 f0 brlt .+4 ; 0x689a <ParameterZuordnung+0x4c>6896: 80 2f mov r24, r166898: 91 2f mov r25, r17if(tmp2 > 255) tmp2 = 255; else if(tmp2 < 0) tmp2 = 0;if(tmp == 25) Poti[i] = tmp2; // 25 = WaypointEvent channel -> no filter689a: 29 31 cpi r18, 0x19 ; 25689c: 11 f4 brne .+4 ; 0x68a2 <ParameterZuordnung+0x54>689e: 80 83 st Z, r2468a0: 1e c0 rjmp .+60 ; 0x68de <ParameterZuordnung+0x90>68a2: ef 01 movw r28, r30elseif(tmp2 != Poti[i])68a4: d0 80 ld r13, Z68a6: 2d 2d mov r18, r1368a8: 30 e0 ldi r19, 0x00 ; 068aa: 28 17 cp r18, r2468ac: 39 07 cpc r19, r2568ae: b9 f0 breq .+46 ; 0x68de <ParameterZuordnung+0x90>{Poti[i] += (tmp2 - Poti[i]) / 4;68b0: bc 01 movw r22, r2468b2: 62 1b sub r22, r1868b4: 73 0b sbc r23, r1968b6: 9b 01 movw r18, r2268b8: 12 f4 brpl .+4 ; 0x68be <ParameterZuordnung+0x70>68ba: 2d 5f subi r18, 0xFD ; 25368bc: 3f 4f sbci r19, 0xFF ; 25568be: 35 95 asr r1968c0: 27 95 ror r1868c2: 35 95 asr r1968c4: 27 95 ror r1868c6: 2d 0d add r18, r1368c8: 28 83 st Y, r18if(Poti[i] > tmp2) Poti[i]--;68ca: 62 2f mov r22, r1868cc: 70 e0 ldi r23, 0x00 ; 068ce: 86 17 cp r24, r2268d0: 97 07 cpc r25, r2368d2: 1c f4 brge .+6 ; 0x68da <ParameterZuordnung+0x8c>68d4: 21 50 subi r18, 0x01 ; 168d6: 28 83 st Y, r1868d8: 02 c0 rjmp .+4 ; 0x68de <ParameterZuordnung+0x90>else Poti[i]++;68da: 2f 5f subi r18, 0xFF ; 25568dc: 28 83 st Y, r1868de: 31 96 adiw r30, 0x01 ; 1// Trägt ggf. das Poti als Parameter einvoid ParameterZuordnung(void)//############################################################################{unsigned char tmp,i;for(i=0;i<8;i++)68e0: a4 17 cp r26, r2068e2: b5 07 cpc r27, r2168e4: 29 f6 brne .-118 ; 0x6870 <ParameterZuordnung+0x22>Poti[i] += (tmp2 - Poti[i]) / 4;if(Poti[i] > tmp2) Poti[i]--;else Poti[i]++;}}CHK_POTI_MM(Parameter_Luftdruck_D,EE_Parameter.Luftdruck_D,0,100);68e6: 80 91 4d 05 lds r24, 0x054D68ea: 88 3f cpi r24, 0xF8 ; 24868ec: 18 f4 brcc .+6 ; 0x68f4 <ParameterZuordnung+0xa6>68ee: 80 93 3a 01 sts 0x013A, r2468f2: 09 c0 rjmp .+18 ; 0x6906 <ParameterZuordnung+0xb8>68f4: ef ef ldi r30, 0xFF ; 25568f6: f0 e0 ldi r31, 0x00 ; 068f8: e8 1b sub r30, r2468fa: f1 09 sbc r31, r168fc: eb 5f subi r30, 0xFB ; 25168fe: fb 4f sbci r31, 0xFB ; 2516900: 80 81 ld r24, Z6902: 80 93 3a 01 sts 0x013A, r246906: 80 91 3a 01 lds r24, 0x013A690a: 84 36 cpi r24, 0x64 ; 100690c: 18 f0 brcs .+6 ; 0x6914 <ParameterZuordnung+0xc6>690e: 84 e6 ldi r24, 0x64 ; 1006910: 80 93 3a 01 sts 0x013A, r24CHK_POTI_MM(Parameter_Hoehe_P,EE_Parameter.Hoehe_P,0,100);6914: 80 91 4f 05 lds r24, 0x054F6918: 88 3f cpi r24, 0xF8 ; 248691a: 18 f4 brcc .+6 ; 0x6922 <ParameterZuordnung+0xd4>691c: 80 93 39 01 sts 0x0139, r246920: 09 c0 rjmp .+18 ; 0x6934 <ParameterZuordnung+0xe6>6922: ef ef ldi r30, 0xFF ; 2556924: f0 e0 ldi r31, 0x00 ; 06926: e8 1b sub r30, r246928: f1 09 sbc r31, r1692a: eb 5f subi r30, 0xFB ; 251692c: fb 4f sbci r31, 0xFB ; 251692e: 80 81 ld r24, Z6930: 80 93 39 01 sts 0x0139, r246934: 80 91 39 01 lds r24, 0x01396938: 84 36 cpi r24, 0x64 ; 100693a: 18 f0 brcs .+6 ; 0x6942 <ParameterZuordnung+0xf4>693c: 84 e6 ldi r24, 0x64 ; 100693e: 80 93 39 01 sts 0x0139, r24CHK_POTI_MM(Parameter_Gyro_P,EE_Parameter.Gyro_P,10,255);6942: 80 91 5c 05 lds r24, 0x055C6946: 88 3f cpi r24, 0xF8 ; 2486948: 18 f4 brcc .+6 ; 0x6950 <ParameterZuordnung+0x102>694a: 80 93 34 01 sts 0x0134, r24694e: 09 c0 rjmp .+18 ; 0x6962 <ParameterZuordnung+0x114>6950: ef ef ldi r30, 0xFF ; 2556952: f0 e0 ldi r31, 0x00 ; 06954: e8 1b sub r30, r246956: f1 09 sbc r31, r16958: eb 5f subi r30, 0xFB ; 251695a: fb 4f sbci r31, 0xFB ; 251695c: 80 81 ld r24, Z695e: 80 93 34 01 sts 0x0134, r246962: 80 91 34 01 lds r24, 0x01346966: 8b 30 cpi r24, 0x0B ; 116968: 18 f4 brcc .+6 ; 0x6970 <ParameterZuordnung+0x122>696a: 8a e0 ldi r24, 0x0A ; 10696c: 80 93 34 01 sts 0x0134, r24CHK_POTI_MM(Parameter_J16Timing,EE_Parameter.J16Timing,5,255);6970: 80 91 89 05 lds r24, 0x05896974: 88 3f cpi r24, 0xF8 ; 2486976: 18 f4 brcc .+6 ; 0x697e <ParameterZuordnung+0x130>6978: 80 93 3b 06 sts 0x063B, r24697c: 09 c0 rjmp .+18 ; 0x6990 <ParameterZuordnung+0x142>697e: ef ef ldi r30, 0xFF ; 2556980: f0 e0 ldi r31, 0x00 ; 06982: e8 1b sub r30, r246984: f1 09 sbc r31, r16986: eb 5f subi r30, 0xFB ; 2516988: fb 4f sbci r31, 0xFB ; 251698a: 80 81 ld r24, Z698c: 80 93 3b 06 sts 0x063B, r246990: 80 91 3b 06 lds r24, 0x063B6994: 86 30 cpi r24, 0x06 ; 66996: 18 f4 brcc .+6 ; 0x699e <ParameterZuordnung+0x150>6998: 85 e0 ldi r24, 0x05 ; 5699a: 80 93 3b 06 sts 0x063B, r24CHK_POTI_MM(Parameter_J17Timing,EE_Parameter.J17Timing,5,255);699e: 80 91 8b 05 lds r24, 0x058B69a2: 88 3f cpi r24, 0xF8 ; 24869a4: 18 f4 brcc .+6 ; 0x69ac <ParameterZuordnung+0x15e>69a6: 80 93 63 06 sts 0x0663, r2469aa: 09 c0 rjmp .+18 ; 0x69be <ParameterZuordnung+0x170>69ac: ef ef ldi r30, 0xFF ; 25569ae: f0 e0 ldi r31, 0x00 ; 069b0: e8 1b sub r30, r2469b2: f1 09 sbc r31, r169b4: eb 5f subi r30, 0xFB ; 25169b6: fb 4f sbci r31, 0xFB ; 25169b8: 80 81 ld r24, Z69ba: 80 93 63 06 sts 0x0663, r2469be: 80 91 63 06 lds r24, 0x066369c2: 86 30 cpi r24, 0x06 ; 669c4: 18 f4 brcc .+6 ; 0x69cc <ParameterZuordnung+0x17e>69c6: 85 e0 ldi r24, 0x05 ; 569c8: 80 93 63 06 sts 0x0663, r24if(EE_Parameter.Servo3 == 247) { if(PORTC & (1<<PORTC2)) Parameter_Servo3 = EE_Parameter.Servo3OnValue; else Parameter_Servo3 = EE_Parameter.Servo3OffValue;} // Out1 (J16)69cc: 80 91 76 05 lds r24, 0x057669d0: 87 3f cpi r24, 0xF7 ; 24769d2: 61 f4 brne .+24 ; 0x69ec <ParameterZuordnung+0x19e>69d4: 42 9b sbis 0x08, 2 ; 869d6: 05 c0 rjmp .+10 ; 0x69e2 <ParameterZuordnung+0x194>69d8: 80 91 ab 05 lds r24, 0x05AB69dc: 80 93 38 06 sts 0x0638, r2469e0: 28 c0 rjmp .+80 ; 0x6a32 <ParameterZuordnung+0x1e4>69e2: 80 91 ac 05 lds r24, 0x05AC69e6: 80 93 38 06 sts 0x0638, r2469ea: 23 c0 rjmp .+70 ; 0x6a32 <ParameterZuordnung+0x1e4>else if(EE_Parameter.Servo3 == 246) { if(PORTC & (1<<PORTC3)) Parameter_Servo3 = EE_Parameter.Servo3OnValue; else Parameter_Servo3 = EE_Parameter.Servo3OffValue;}69ec: 86 3f cpi r24, 0xF6 ; 24669ee: 61 f4 brne .+24 ; 0x6a08 <ParameterZuordnung+0x1ba>69f0: 43 9b sbis 0x08, 3 ; 869f2: 05 c0 rjmp .+10 ; 0x69fe <ParameterZuordnung+0x1b0>69f4: 80 91 ab 05 lds r24, 0x05AB69f8: 80 93 38 06 sts 0x0638, r2469fc: 1a c0 rjmp .+52 ; 0x6a32 <ParameterZuordnung+0x1e4>69fe: 80 91 ac 05 lds r24, 0x05AC6a02: 80 93 38 06 sts 0x0638, r246a06: 15 c0 rjmp .+42 ; 0x6a32 <ParameterZuordnung+0x1e4>else CHK_POTI_MM(Parameter_Servo3,EE_Parameter.Servo3, 24, 255);6a08: 88 3f cpi r24, 0xF8 ; 2486a0a: 18 f4 brcc .+6 ; 0x6a12 <ParameterZuordnung+0x1c4>6a0c: 80 93 38 06 sts 0x0638, r246a10: 09 c0 rjmp .+18 ; 0x6a24 <ParameterZuordnung+0x1d6>6a12: ef ef ldi r30, 0xFF ; 2556a14: f0 e0 ldi r31, 0x00 ; 06a16: e8 1b sub r30, r246a18: f1 09 sbc r31, r16a1a: eb 5f subi r30, 0xFB ; 2516a1c: fb 4f sbci r31, 0xFB ; 2516a1e: 80 81 ld r24, Z6a20: 80 93 38 06 sts 0x0638, r246a24: 80 91 38 06 lds r24, 0x06386a28: 89 31 cpi r24, 0x19 ; 256a2a: 18 f4 brcc .+6 ; 0x6a32 <ParameterZuordnung+0x1e4>6a2c: 88 e1 ldi r24, 0x18 ; 246a2e: 80 93 38 06 sts 0x0638, r24if(EE_Parameter.Servo4 == 247) { if(PORTC & (1<<PORTC2)) Parameter_Servo4 = EE_Parameter.Servo4OnValue; else Parameter_Servo4 = EE_Parameter.Servo4OffValue;}6a32: 80 91 77 05 lds r24, 0x05776a36: 87 3f cpi r24, 0xF7 ; 2476a38: 61 f4 brne .+24 ; 0x6a52 <ParameterZuordnung+0x204>6a3a: 42 9b sbis 0x08, 2 ; 86a3c: 05 c0 rjmp .+10 ; 0x6a48 <ParameterZuordnung+0x1fa>6a3e: 80 91 ad 05 lds r24, 0x05AD6a42: 80 93 19 06 sts 0x0619, r246a46: 28 c0 rjmp .+80 ; 0x6a98 <ParameterZuordnung+0x24a>6a48: 80 91 ae 05 lds r24, 0x05AE6a4c: 80 93 19 06 sts 0x0619, r246a50: 23 c0 rjmp .+70 ; 0x6a98 <ParameterZuordnung+0x24a>else if(EE_Parameter.Servo4 == 246) { if(PORTC & (1<<PORTC3)) Parameter_Servo4 = EE_Parameter.Servo4OnValue; else Parameter_Servo4 = EE_Parameter.Servo4OffValue;} // Out2 (J17)6a52: 86 3f cpi r24, 0xF6 ; 2466a54: 61 f4 brne .+24 ; 0x6a6e <ParameterZuordnung+0x220>6a56: 43 9b sbis 0x08, 3 ; 86a58: 05 c0 rjmp .+10 ; 0x6a64 <ParameterZuordnung+0x216>6a5a: 80 91 ad 05 lds r24, 0x05AD6a5e: 80 93 19 06 sts 0x0619, r246a62: 1a c0 rjmp .+52 ; 0x6a98 <ParameterZuordnung+0x24a>6a64: 80 91 ae 05 lds r24, 0x05AE6a68: 80 93 19 06 sts 0x0619, r246a6c: 15 c0 rjmp .+42 ; 0x6a98 <ParameterZuordnung+0x24a>else CHK_POTI_MM(Parameter_Servo4,EE_Parameter.Servo4, 24, 255);6a6e: 88 3f cpi r24, 0xF8 ; 2486a70: 18 f4 brcc .+6 ; 0x6a78 <ParameterZuordnung+0x22a>6a72: 80 93 19 06 sts 0x0619, r246a76: 09 c0 rjmp .+18 ; 0x6a8a <ParameterZuordnung+0x23c>6a78: ef ef ldi r30, 0xFF ; 2556a7a: f0 e0 ldi r31, 0x00 ; 06a7c: e8 1b sub r30, r246a7e: f1 09 sbc r31, r16a80: eb 5f subi r30, 0xFB ; 2516a82: fb 4f sbci r31, 0xFB ; 2516a84: 80 81 ld r24, Z6a86: 80 93 19 06 sts 0x0619, r246a8a: 80 91 19 06 lds r24, 0x06196a8e: 89 31 cpi r24, 0x19 ; 256a90: 18 f4 brcc .+6 ; 0x6a98 <ParameterZuordnung+0x24a>6a92: 88 e1 ldi r24, 0x18 ; 246a94: 80 93 19 06 sts 0x0619, r24CHK_POTI_MM(Parameter_Servo5,EE_Parameter.Servo5, 24, 255);6a98: 80 91 78 05 lds r24, 0x05786a9c: 88 3f cpi r24, 0xF8 ; 2486a9e: 18 f4 brcc .+6 ; 0x6aa6 <ParameterZuordnung+0x258>6aa0: 80 93 41 06 sts 0x0641, r246aa4: 09 c0 rjmp .+18 ; 0x6ab8 <ParameterZuordnung+0x26a>6aa6: ef ef ldi r30, 0xFF ; 2556aa8: f0 e0 ldi r31, 0x00 ; 06aaa: e8 1b sub r30, r246aac: f1 09 sbc r31, r16aae: eb 5f subi r30, 0xFB ; 2516ab0: fb 4f sbci r31, 0xFB ; 2516ab2: 80 81 ld r24, Z6ab4: 80 93 41 06 sts 0x0641, r246ab8: 80 91 41 06 lds r24, 0x06416abc: 89 31 cpi r24, 0x19 ; 256abe: 18 f4 brcc .+6 ; 0x6ac6 <ParameterZuordnung+0x278>6ac0: 88 e1 ldi r24, 0x18 ; 246ac2: 80 93 41 06 sts 0x0641, r24Parameter_HoehenSchalter = GetChannelValue(EE_Parameter.HoeheChannel);6ac6: 80 91 4e 05 lds r24, 0x054E6aca: a8 de rcall .-688 ; 0x681c <GetChannelValue>6acc: 80 93 e1 03 sts 0x03E1, r24CHK_POTI(Parameter_Hoehe_ACC_Wirkung,EE_Parameter.Hoehe_ACC_Wirkung);6ad0: 80 91 51 05 lds r24, 0x05516ad4: 88 3f cpi r24, 0xF8 ; 2486ad6: 18 f4 brcc .+6 ; 0x6ade <ParameterZuordnung+0x290>6ad8: 80 93 38 01 sts 0x0138, r246adc: 09 c0 rjmp .+18 ; 0x6af0 <ParameterZuordnung+0x2a2>6ade: ef ef ldi r30, 0xFF ; 2556ae0: f0 e0 ldi r31, 0x00 ; 06ae2: e8 1b sub r30, r246ae4: f1 09 sbc r31, r16ae6: eb 5f subi r30, 0xFB ; 2516ae8: fb 4f sbci r31, 0xFB ; 2516aea: 80 81 ld r24, Z6aec: 80 93 38 01 sts 0x0138, r24CHK_POTI(Parameter_Hoehe_TiltCompensation,EE_Parameter.Hoehe_TiltCompensation);6af0: 80 91 53 05 lds r24, 0x05536af4: 88 3f cpi r24, 0xF8 ; 2486af6: 18 f4 brcc .+6 ; 0x6afe <ParameterZuordnung+0x2b0>6af8: 80 93 36 01 sts 0x0136, r246afc: 09 c0 rjmp .+18 ; 0x6b10 <ParameterZuordnung+0x2c2>6afe: ef ef ldi r30, 0xFF ; 2556b00: f0 e0 ldi r31, 0x00 ; 06b02: e8 1b sub r30, r246b04: f1 09 sbc r31, r16b06: eb 5f subi r30, 0xFB ; 2516b08: fb 4f sbci r31, 0xFB ; 2516b0a: 80 81 ld r24, Z6b0c: 80 93 36 01 sts 0x0136, r24CHK_POTI(Parameter_KompassWirkung,EE_Parameter.KompassWirkung);6b10: 80 91 5b 05 lds r24, 0x055B6b14: 88 3f cpi r24, 0xF8 ; 2486b16: 18 f4 brcc .+6 ; 0x6b1e <ParameterZuordnung+0x2d0>6b18: 80 93 37 01 sts 0x0137, r246b1c: 09 c0 rjmp .+18 ; 0x6b30 <ParameterZuordnung+0x2e2>6b1e: ef ef ldi r30, 0xFF ; 2556b20: f0 e0 ldi r31, 0x00 ; 06b22: e8 1b sub r30, r246b24: f1 09 sbc r31, r16b26: eb 5f subi r30, 0xFB ; 2516b28: fb 4f sbci r31, 0xFB ; 2516b2a: 80 81 ld r24, Z6b2c: 80 93 37 01 sts 0x0137, r24CHK_POTI(Parameter_Gyro_I,EE_Parameter.Gyro_I);6b30: 80 91 5d 05 lds r24, 0x055D6b34: 88 3f cpi r24, 0xF8 ; 2486b36: 18 f4 brcc .+6 ; 0x6b3e <ParameterZuordnung+0x2f0>6b38: 80 93 33 01 sts 0x0133, r246b3c: 09 c0 rjmp .+18 ; 0x6b50 <ParameterZuordnung+0x302>6b3e: ef ef ldi r30, 0xFF ; 2556b40: f0 e0 ldi r31, 0x00 ; 06b42: e8 1b sub r30, r246b44: f1 09 sbc r31, r16b46: eb 5f subi r30, 0xFB ; 2516b48: fb 4f sbci r31, 0xFB ; 2516b4a: 80 81 ld r24, Z6b4c: 80 93 33 01 sts 0x0133, r24CHK_POTI(Parameter_Gyro_D,EE_Parameter.Gyro_D);6b50: 80 91 5e 05 lds r24, 0x055E6b54: 88 3f cpi r24, 0xF8 ; 2486b56: 18 f4 brcc .+6 ; 0x6b5e <ParameterZuordnung+0x310>6b58: 80 93 35 01 sts 0x0135, r246b5c: 09 c0 rjmp .+18 ; 0x6b70 <ParameterZuordnung+0x322>6b5e: ef ef ldi r30, 0xFF ; 2556b60: f0 e0 ldi r31, 0x00 ; 06b62: e8 1b sub r30, r246b64: f1 09 sbc r31, r16b66: eb 5f subi r30, 0xFB ; 2516b68: fb 4f sbci r31, 0xFB ; 2516b6a: 80 81 ld r24, Z6b6c: 80 93 35 01 sts 0x0135, r24CHK_POTI(Parameter_Gyro_Gier_P,EE_Parameter.Gyro_Gier_P);6b70: 80 91 5f 05 lds r24, 0x055F6b74: 88 3f cpi r24, 0xF8 ; 2486b76: 18 f4 brcc .+6 ; 0x6b7e <ParameterZuordnung+0x330>6b78: 80 93 32 01 sts 0x0132, r246b7c: 09 c0 rjmp .+18 ; 0x6b90 <ParameterZuordnung+0x342>6b7e: ef ef ldi r30, 0xFF ; 2556b80: f0 e0 ldi r31, 0x00 ; 06b82: e8 1b sub r30, r246b84: f1 09 sbc r31, r16b86: eb 5f subi r30, 0xFB ; 2516b88: fb 4f sbci r31, 0xFB ; 2516b8a: 80 81 ld r24, Z6b8c: 80 93 32 01 sts 0x0132, r24CHK_POTI(Parameter_Gyro_Gier_I,EE_Parameter.Gyro_Gier_I);6b90: 80 91 60 05 lds r24, 0x05606b94: 88 3f cpi r24, 0xF8 ; 2486b96: 18 f4 brcc .+6 ; 0x6b9e <ParameterZuordnung+0x350>6b98: 80 93 31 01 sts 0x0131, r246b9c: 09 c0 rjmp .+18 ; 0x6bb0 <ParameterZuordnung+0x362>6b9e: ef ef ldi r30, 0xFF ; 2556ba0: f0 e0 ldi r31, 0x00 ; 06ba2: e8 1b sub r30, r246ba4: f1 09 sbc r31, r16ba6: eb 5f subi r30, 0xFB ; 2516ba8: fb 4f sbci r31, 0xFB ; 2516baa: 80 81 ld r24, Z6bac: 80 93 31 01 sts 0x0131, r24CHK_POTI(Parameter_I_Faktor,EE_Parameter.I_Faktor);6bb0: 80 91 66 05 lds r24, 0x05666bb4: 88 3f cpi r24, 0xF8 ; 2486bb6: 18 f4 brcc .+6 ; 0x6bbe <ParameterZuordnung+0x370>6bb8: 80 93 30 01 sts 0x0130, r246bbc: 09 c0 rjmp .+18 ; 0x6bd0 <ParameterZuordnung+0x382>6bbe: ef ef ldi r30, 0xFF ; 2556bc0: f0 e0 ldi r31, 0x00 ; 06bc2: e8 1b sub r30, r246bc4: f1 09 sbc r31, r16bc6: eb 5f subi r30, 0xFB ; 2516bc8: fb 4f sbci r31, 0xFB ; 2516bca: 80 81 ld r24, Z6bcc: 80 93 30 01 sts 0x0130, r24CHK_POTI(Parameter_UserParam1,EE_Parameter.UserParam1);6bd0: 80 91 67 05 lds r24, 0x05676bd4: 88 3f cpi r24, 0xF8 ; 2486bd6: 18 f4 brcc .+6 ; 0x6bde <ParameterZuordnung+0x390>6bd8: 80 93 e0 03 sts 0x03E0, r246bdc: 09 c0 rjmp .+18 ; 0x6bf0 <ParameterZuordnung+0x3a2>6bde: ef ef ldi r30, 0xFF ; 2556be0: f0 e0 ldi r31, 0x00 ; 06be2: e8 1b sub r30, r246be4: f1 09 sbc r31, r16be6: eb 5f subi r30, 0xFB ; 2516be8: fb 4f sbci r31, 0xFB ; 2516bea: 80 81 ld r24, Z6bec: 80 93 e0 03 sts 0x03E0, r24CHK_POTI(Parameter_UserParam2,EE_Parameter.UserParam2);6bf0: 80 91 68 05 lds r24, 0x05686bf4: 88 3f cpi r24, 0xF8 ; 2486bf6: 18 f4 brcc .+6 ; 0x6bfe <ParameterZuordnung+0x3b0>6bf8: 80 93 df 03 sts 0x03DF, r246bfc: 09 c0 rjmp .+18 ; 0x6c10 <ParameterZuordnung+0x3c2>6bfe: ef ef ldi r30, 0xFF ; 2556c00: f0 e0 ldi r31, 0x00 ; 06c02: e8 1b sub r30, r246c04: f1 09 sbc r31, r16c06: eb 5f subi r30, 0xFB ; 2516c08: fb 4f sbci r31, 0xFB ; 2516c0a: 80 81 ld r24, Z6c0c: 80 93 df 03 sts 0x03DF, r24CHK_POTI(Parameter_UserParam3,EE_Parameter.UserParam3);6c10: 80 91 69 05 lds r24, 0x05696c14: 88 3f cpi r24, 0xF8 ; 2486c16: 18 f4 brcc .+6 ; 0x6c1e <ParameterZuordnung+0x3d0>6c18: 80 93 de 03 sts 0x03DE, r246c1c: 09 c0 rjmp .+18 ; 0x6c30 <ParameterZuordnung+0x3e2>6c1e: ef ef ldi r30, 0xFF ; 2556c20: f0 e0 ldi r31, 0x00 ; 06c22: e8 1b sub r30, r246c24: f1 09 sbc r31, r16c26: eb 5f subi r30, 0xFB ; 2516c28: fb 4f sbci r31, 0xFB ; 2516c2a: 80 81 ld r24, Z6c2c: 80 93 de 03 sts 0x03DE, r24CHK_POTI(Parameter_UserParam4,EE_Parameter.UserParam4);6c30: 80 91 6a 05 lds r24, 0x056A6c34: 88 3f cpi r24, 0xF8 ; 2486c36: 18 f4 brcc .+6 ; 0x6c3e <ParameterZuordnung+0x3f0>6c38: 80 93 dd 03 sts 0x03DD, r246c3c: 09 c0 rjmp .+18 ; 0x6c50 <ParameterZuordnung+0x402>6c3e: ef ef ldi r30, 0xFF ; 2556c40: f0 e0 ldi r31, 0x00 ; 06c42: e8 1b sub r30, r246c44: f1 09 sbc r31, r16c46: eb 5f subi r30, 0xFB ; 2516c48: fb 4f sbci r31, 0xFB ; 2516c4a: 80 81 ld r24, Z6c4c: 80 93 dd 03 sts 0x03DD, r24CHK_POTI(Parameter_UserParam5,EE_Parameter.UserParam5);6c50: 80 91 84 05 lds r24, 0x05846c54: 88 3f cpi r24, 0xF8 ; 2486c56: 18 f4 brcc .+6 ; 0x6c5e <ParameterZuordnung+0x410>6c58: 80 93 dc 03 sts 0x03DC, r246c5c: 09 c0 rjmp .+18 ; 0x6c70 <ParameterZuordnung+0x422>6c5e: ef ef ldi r30, 0xFF ; 2556c60: f0 e0 ldi r31, 0x00 ; 06c62: e8 1b sub r30, r246c64: f1 09 sbc r31, r16c66: eb 5f subi r30, 0xFB ; 2516c68: fb 4f sbci r31, 0xFB ; 2516c6a: 80 81 ld r24, Z6c6c: 80 93 dc 03 sts 0x03DC, r24CHK_POTI(Parameter_UserParam6,EE_Parameter.UserParam6);6c70: 80 91 85 05 lds r24, 0x05856c74: 88 3f cpi r24, 0xF8 ; 2486c76: 18 f4 brcc .+6 ; 0x6c7e <ParameterZuordnung+0x430>6c78: 80 93 db 03 sts 0x03DB, r246c7c: 09 c0 rjmp .+18 ; 0x6c90 <ParameterZuordnung+0x442>6c7e: ef ef ldi r30, 0xFF ; 2556c80: f0 e0 ldi r31, 0x00 ; 06c82: e8 1b sub r30, r246c84: f1 09 sbc r31, r16c86: eb 5f subi r30, 0xFB ; 2516c88: fb 4f sbci r31, 0xFB ; 2516c8a: 80 81 ld r24, Z6c8c: 80 93 db 03 sts 0x03DB, r24CHK_POTI(Parameter_UserParam7,EE_Parameter.UserParam7);6c90: 80 91 86 05 lds r24, 0x05866c94: 88 3f cpi r24, 0xF8 ; 2486c96: 18 f4 brcc .+6 ; 0x6c9e <ParameterZuordnung+0x450>6c98: 80 93 da 03 sts 0x03DA, r246c9c: 09 c0 rjmp .+18 ; 0x6cb0 <ParameterZuordnung+0x462>6c9e: ef ef ldi r30, 0xFF ; 2556ca0: f0 e0 ldi r31, 0x00 ; 06ca2: e8 1b sub r30, r246ca4: f1 09 sbc r31, r16ca6: eb 5f subi r30, 0xFB ; 2516ca8: fb 4f sbci r31, 0xFB ; 2516caa: 80 81 ld r24, Z6cac: 80 93 da 03 sts 0x03DA, r24CHK_POTI(Parameter_UserParam8,EE_Parameter.UserParam8);6cb0: 80 91 87 05 lds r24, 0x05876cb4: 88 3f cpi r24, 0xF8 ; 2486cb6: 18 f4 brcc .+6 ; 0x6cbe <ParameterZuordnung+0x470>6cb8: 80 93 d9 03 sts 0x03D9, r246cbc: 09 c0 rjmp .+18 ; 0x6cd0 <ParameterZuordnung+0x482>6cbe: ef ef ldi r30, 0xFF ; 2556cc0: f0 e0 ldi r31, 0x00 ; 06cc2: e8 1b sub r30, r246cc4: f1 09 sbc r31, r16cc6: eb 5f subi r30, 0xFB ; 2516cc8: fb 4f sbci r31, 0xFB ; 2516cca: 80 81 ld r24, Z6ccc: 80 93 d9 03 sts 0x03D9, r24CHK_POTI(Parameter_ServoNickControl,EE_Parameter.ServoNickControl);6cd0: 80 91 6b 05 lds r24, 0x056B6cd4: 88 3f cpi r24, 0xF8 ; 2486cd6: 18 f4 brcc .+6 ; 0x6cde <ParameterZuordnung+0x490>6cd8: 80 93 2f 01 sts 0x012F, r246cdc: 09 c0 rjmp .+18 ; 0x6cf0 <ParameterZuordnung+0x4a2>6cde: ef ef ldi r30, 0xFF ; 2556ce0: f0 e0 ldi r31, 0x00 ; 06ce2: e8 1b sub r30, r246ce4: f1 09 sbc r31, r16ce6: eb 5f subi r30, 0xFB ; 2516ce8: fb 4f sbci r31, 0xFB ; 2516cea: 80 81 ld r24, Z6cec: 80 93 2f 01 sts 0x012F, r24CHK_POTI(Parameter_ServoRollControl,EE_Parameter.ServoRollControl);6cf0: 80 91 6f 05 lds r24, 0x056F6cf4: 88 3f cpi r24, 0xF8 ; 2486cf6: 18 f4 brcc .+6 ; 0x6cfe <ParameterZuordnung+0x4b0>6cf8: 80 93 2e 01 sts 0x012E, r246cfc: 09 c0 rjmp .+18 ; 0x6d10 <ParameterZuordnung+0x4c2>6cfe: ef ef ldi r30, 0xFF ; 2556d00: f0 e0 ldi r31, 0x00 ; 06d02: e8 1b sub r30, r246d04: f1 09 sbc r31, r16d06: eb 5f subi r30, 0xFB ; 2516d08: fb 4f sbci r31, 0xFB ; 2516d0a: 80 81 ld r24, Z6d0c: 80 93 2e 01 sts 0x012E, r24CHK_POTI(Parameter_ServoNickComp,EE_Parameter.ServoNickComp);6d10: 80 91 6c 05 lds r24, 0x056C6d14: 88 3f cpi r24, 0xF8 ; 2486d16: 18 f4 brcc .+6 ; 0x6d1e <ParameterZuordnung+0x4d0>6d18: 80 93 2d 01 sts 0x012D, r246d1c: 09 c0 rjmp .+18 ; 0x6d30 <ParameterZuordnung+0x4e2>6d1e: ef ef ldi r30, 0xFF ; 2556d20: f0 e0 ldi r31, 0x00 ; 06d22: e8 1b sub r30, r246d24: f1 09 sbc r31, r16d26: eb 5f subi r30, 0xFB ; 2516d28: fb 4f sbci r31, 0xFB ; 2516d2a: 80 81 ld r24, Z6d2c: 80 93 2d 01 sts 0x012D, r24CHK_POTI(Parameter_ServoRollComp,EE_Parameter.ServoRollComp);6d30: 80 91 70 05 lds r24, 0x05706d34: 88 3f cpi r24, 0xF8 ; 2486d36: 18 f4 brcc .+6 ; 0x6d3e <ParameterZuordnung+0x4f0>6d38: 80 93 2c 01 sts 0x012C, r246d3c: 09 c0 rjmp .+18 ; 0x6d50 <ParameterZuordnung+0x502>6d3e: ef ef ldi r30, 0xFF ; 2556d40: f0 e0 ldi r31, 0x00 ; 06d42: e8 1b sub r30, r246d44: f1 09 sbc r31, r16d46: eb 5f subi r30, 0xFB ; 2516d48: fb 4f sbci r31, 0xFB ; 2516d4a: 80 81 ld r24, Z6d4c: 80 93 2c 01 sts 0x012C, r24CHK_POTI(Parameter_LoopGasLimit,EE_Parameter.LoopGasLimit);6d50: 80 91 79 05 lds r24, 0x05796d54: 88 3f cpi r24, 0xF8 ; 2486d56: 18 f4 brcc .+6 ; 0x6d5e <ParameterZuordnung+0x510>6d58: 80 93 2b 01 sts 0x012B, r246d5c: 09 c0 rjmp .+18 ; 0x6d70 <ParameterZuordnung+0x522>6d5e: ef ef ldi r30, 0xFF ; 2556d60: f0 e0 ldi r31, 0x00 ; 06d62: e8 1b sub r30, r246d64: f1 09 sbc r31, r16d66: eb 5f subi r30, 0xFB ; 2516d68: fb 4f sbci r31, 0xFB ; 2516d6a: 80 81 ld r24, Z6d6c: 80 93 2b 01 sts 0x012B, r24CHK_POTI(Parameter_AchsKopplung1,EE_Parameter.AchsKopplung1);6d70: 80 91 7c 05 lds r24, 0x057C6d74: 88 3f cpi r24, 0xF8 ; 2486d76: 18 f4 brcc .+6 ; 0x6d7e <ParameterZuordnung+0x530>6d78: 80 93 2a 01 sts 0x012A, r246d7c: 09 c0 rjmp .+18 ; 0x6d90 <ParameterZuordnung+0x542>6d7e: ef ef ldi r30, 0xFF ; 2556d80: f0 e0 ldi r31, 0x00 ; 06d82: e8 1b sub r30, r246d84: f1 09 sbc r31, r16d86: eb 5f subi r30, 0xFB ; 2516d88: fb 4f sbci r31, 0xFB ; 2516d8a: 80 81 ld r24, Z6d8c: 80 93 2a 01 sts 0x012A, r24CHK_POTI(Parameter_AchsKopplung2,EE_Parameter.AchsKopplung2);6d90: 80 91 7d 05 lds r24, 0x057D6d94: 88 3f cpi r24, 0xF8 ; 2486d96: 18 f4 brcc .+6 ; 0x6d9e <ParameterZuordnung+0x550>6d98: 80 93 29 01 sts 0x0129, r246d9c: 09 c0 rjmp .+18 ; 0x6db0 <ParameterZuordnung+0x562>6d9e: ef ef ldi r30, 0xFF ; 2556da0: f0 e0 ldi r31, 0x00 ; 06da2: e8 1b sub r30, r246da4: f1 09 sbc r31, r16da6: eb 5f subi r30, 0xFB ; 2516da8: fb 4f sbci r31, 0xFB ; 2516daa: 80 81 ld r24, Z6dac: 80 93 29 01 sts 0x0129, r24CHK_POTI(Parameter_CouplingYawCorrection,EE_Parameter.CouplingYawCorrection);6db0: 80 91 7e 05 lds r24, 0x057E6db4: 88 3f cpi r24, 0xF8 ; 2486db6: 18 f4 brcc .+6 ; 0x6dbe <ParameterZuordnung+0x570>6db8: 80 93 28 01 sts 0x0128, r246dbc: 09 c0 rjmp .+18 ; 0x6dd0 <ParameterZuordnung+0x582>6dbe: ef ef ldi r30, 0xFF ; 2556dc0: f0 e0 ldi r31, 0x00 ; 06dc2: e8 1b sub r30, r246dc4: f1 09 sbc r31, r16dc6: eb 5f subi r30, 0xFB ; 2516dc8: fb 4f sbci r31, 0xFB ; 2516dca: 80 81 ld r24, Z6dcc: 80 93 28 01 sts 0x0128, r24CHK_POTI(Parameter_MaximumAltitude,EE_Parameter.MaxAltitude);6dd0: 80 91 a7 05 lds r24, 0x05A76dd4: 88 3f cpi r24, 0xF8 ; 2486dd6: 18 f4 brcc .+6 ; 0x6dde <ParameterZuordnung+0x590>6dd8: 80 93 24 06 sts 0x0624, r246ddc: 09 c0 rjmp .+18 ; 0x6df0 <ParameterZuordnung+0x5a2>6dde: ef ef ldi r30, 0xFF ; 2556de0: f0 e0 ldi r31, 0x00 ; 06de2: e8 1b sub r30, r246de4: f1 09 sbc r31, r16de6: eb 5f subi r30, 0xFB ; 2516de8: fb 4f sbci r31, 0xFB ; 2516dea: 80 81 ld r24, Z6dec: 80 93 24 06 sts 0x0624, r24// if((NC_To_FC_MaxAltitude && NC_To_FC_MaxAltitude < Parameter_MaximumAltitude) || Parameter_MaximumAltitude == 0) Parameter_MaximumAltitude = NC_To_FC_MaxAltitude;Parameter_GlobalConfig = EE_Parameter.GlobalConfig;6df0: 80 91 4b 05 lds r24, 0x054B6df4: 80 93 5c 06 sts 0x065C, r24Parameter_ExtraConfig = EE_Parameter.ExtraConfig;6df8: 80 91 b8 05 lds r24, 0x05B86dfc: 80 93 40 06 sts 0x0640, r24// CHK_POTI(Parameter_AchsGegenKopplung1,EE_Parameter.AchsGegenKopplung1,0,255);CHK_POTI(Parameter_DynamicStability,EE_Parameter.DynamicStability);6e00: 80 91 83 05 lds r24, 0x05836e04: 88 3f cpi r24, 0xF8 ; 2486e06: 18 f4 brcc .+6 ; 0x6e0e <ParameterZuordnung+0x5c0>6e08: 80 93 27 01 sts 0x0127, r246e0c: 09 c0 rjmp .+18 ; 0x6e20 <ParameterZuordnung+0x5d2>6e0e: ef ef ldi r30, 0xFF ; 2556e10: f0 e0 ldi r31, 0x00 ; 06e12: e8 1b sub r30, r246e14: f1 09 sbc r31, r16e16: eb 5f subi r30, 0xFB ; 2516e18: fb 4f sbci r31, 0xFB ; 2516e1a: 80 81 ld r24, Z6e1c: 80 93 27 01 sts 0x0127, r24CHK_POTI(Parameter_ExternalControl,EE_Parameter.ExternalControl);6e20: 80 91 a0 05 lds r24, 0x05A06e24: 88 3f cpi r24, 0xF8 ; 2486e26: 18 f4 brcc .+6 ; 0x6e2e <ParameterZuordnung+0x5e0>6e28: 80 93 75 06 sts 0x0675, r246e2c: 09 c0 rjmp .+18 ; 0x6e40 <ParameterZuordnung+0x5f2>6e2e: ef ef ldi r30, 0xFF ; 2556e30: f0 e0 ldi r31, 0x00 ; 06e32: e8 1b sub r30, r246e34: f1 09 sbc r31, r16e36: eb 5f subi r30, 0xFB ; 2516e38: fb 4f sbci r31, 0xFB ; 2516e3a: 80 81 ld r24, Z6e3c: 80 93 75 06 sts 0x0675, r24Ki = 10300 / (Parameter_I_Faktor + 1);6e40: 60 91 30 01 lds r22, 0x01306e44: 70 e0 ldi r23, 0x00 ; 06e46: 6f 5f subi r22, 0xFF ; 2556e48: 7f 4f sbci r23, 0xFF ; 2556e4a: 8c e3 ldi r24, 0x3C ; 606e4c: 98 e2 ldi r25, 0x28 ; 406e4e: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>6e52: 70 93 3c 01 sts 0x013C, r236e56: 60 93 3b 01 sts 0x013B, r22MAX_GAS = EE_Parameter.Gas_Max;6e5a: 80 91 59 05 lds r24, 0x05596e5e: 80 93 64 06 sts 0x0664, r24MIN_GAS = EE_Parameter.Gas_Min;6e62: 80 91 58 05 lds r24, 0x05586e66: 80 93 2c 06 sts 0x062C, r24if(EE_Parameter.CareFreeChannel)6e6a: e0 91 a2 05 lds r30, 0x05A26e6e: ee 23 and r30, r306e70: 09 f4 brne .+2 ; 0x6e74 <ParameterZuordnung+0x626>6e72: 4b c0 rjmp .+150 ; 0x6f0a <ParameterZuordnung+0x6bc>{CareFree = 1;6e74: 81 e0 ldi r24, 0x01 ; 16e76: 80 93 d8 03 sts 0x03D8, r24if(PPM_in[EE_Parameter.CareFreeChannel] < -64) CareFree = 0;6e7a: f0 e0 ldi r31, 0x00 ; 06e7c: ee 0f add r30, r306e7e: ff 1f adc r31, r316e80: ef 5c subi r30, 0xCF ; 2076e82: f7 4f sbci r31, 0xF7 ; 2476e84: 80 81 ld r24, Z6e86: 91 81 ldd r25, Z+1 ; 0x016e88: 80 3c cpi r24, 0xC0 ; 1926e8a: 9f 4f sbci r25, 0xFF ; 2556e8c: 14 f4 brge .+4 ; 0x6e92 <ParameterZuordnung+0x644>6e8e: 10 92 d8 03 sts 0x03D8, r1// if(tmp >= 248 && Poti[255 - tmp] < 50) CareFree = 0;if(carefree_old != CareFree)6e92: 80 91 3d 01 lds r24, 0x013D6e96: 20 91 d8 03 lds r18, 0x03D86e9a: 82 17 cp r24, r186e9c: 41 f1 breq .+80 ; 0x6eee <ParameterZuordnung+0x6a0>{if(carefree_old < 3)6e9e: 83 30 cpi r24, 0x03 ; 36ea0: 18 f5 brcc .+70 ; 0x6ee8 <ParameterZuordnung+0x69a>{#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))if(CareFree) { beeptime = 1500; if(!SpeakHoTT) SpeakHoTT = SPEAK_CF_ON; }6ea2: 22 23 and r18, r186ea4: 71 f0 breq .+28 ; 0x6ec2 <ParameterZuordnung+0x674>6ea6: 8c ed ldi r24, 0xDC ; 2206ea8: 95 e0 ldi r25, 0x05 ; 56eaa: 90 93 ce 04 sts 0x04CE, r256eae: 80 93 cd 04 sts 0x04CD, r246eb2: 80 91 57 01 lds r24, 0x01576eb6: 81 11 cpse r24, r16eb8: 11 c0 rjmp .+34 ; 0x6edc <ParameterZuordnung+0x68e>6eba: 8e e2 ldi r24, 0x2E ; 466ebc: 80 93 57 01 sts 0x0157, r246ec0: 0d c0 rjmp .+26 ; 0x6edc <ParameterZuordnung+0x68e>else { beeptime = 200; if(!SpeakHoTT) SpeakHoTT = SPEAK_CF_OFF; }6ec2: 88 ec ldi r24, 0xC8 ; 2006ec4: 90 e0 ldi r25, 0x00 ; 06ec6: 90 93 ce 04 sts 0x04CE, r256eca: 80 93 cd 04 sts 0x04CD, r246ece: 80 91 57 01 lds r24, 0x01576ed2: 81 11 cpse r24, r16ed4: 03 c0 rjmp .+6 ; 0x6edc <ParameterZuordnung+0x68e>6ed6: 87 e1 ldi r24, 0x17 ; 236ed8: 80 93 57 01 sts 0x0157, r24#elseif(CareFree) beeptime = 1500;else beeptime = 200;#endifNeueKompassRichtungMerken = 5;6edc: 85 e0 ldi r24, 0x05 ; 56ede: 80 93 ee 03 sts 0x03EE, r24carefree_old = CareFree;6ee2: 20 93 3d 01 sts 0x013D, r186ee6: 03 c0 rjmp .+6 ; 0x6eee <ParameterZuordnung+0x6a0>} else carefree_old--;6ee8: 81 50 subi r24, 0x01 ; 16eea: 80 93 3d 01 sts 0x013D, r24}if(FromNaviCtrl.CompassValue < 0 && CareFree) VersionInfo.HardwareError[0] |= FC_ERROR0_CAREFREE; //else VersionInfo.HardwareError[0] &= ~FC_ERROR0_CAREFREE;6eee: 80 91 13 09 lds r24, 0x09136ef2: 90 91 14 09 lds r25, 0x09146ef6: 99 23 and r25, r256ef8: 84 f5 brge .+96 ; 0x6f5a <ParameterZuordnung+0x70c>6efa: 22 23 and r18, r186efc: 89 f0 breq .+34 ; 0x6f20 <ParameterZuordnung+0x6d2>6efe: e2 e6 ldi r30, 0x62 ; 986f00: fa e0 ldi r31, 0x0A ; 106f02: 80 81 ld r24, Z6f04: 80 68 ori r24, 0x80 ; 1286f06: 80 83 st Z, r246f08: 05 c0 rjmp .+10 ; 0x6f14 <ParameterZuordnung+0x6c6>}else{CareFree = 0;6f0a: 10 92 d8 03 sts 0x03D8, r1carefree_old = 10;6f0e: 8a e0 ldi r24, 0x0A ; 106f10: 80 93 3d 01 sts 0x013D, r24}if(FromNaviCtrl.CompassValue < 0 && MotorenEin && CareFree && BeepMuster == 0xffff) // ungültiger Kompasswert6f14: 80 91 13 09 lds r24, 0x09136f18: 90 91 14 09 lds r25, 0x09146f1c: 99 23 and r25, r256f1e: ec f4 brge .+58 ; 0x6f5a <ParameterZuordnung+0x70c>6f20: 80 91 03 04 lds r24, 0x04036f24: 88 23 and r24, r246f26: c9 f0 breq .+50 ; 0x6f5a <ParameterZuordnung+0x70c>6f28: 80 91 d8 03 lds r24, 0x03D86f2c: 88 23 and r24, r246f2e: f9 f0 breq .+62 ; 0x6f6e <ParameterZuordnung+0x720>6f30: 80 91 a9 02 lds r24, 0x02A96f34: 90 91 aa 02 lds r25, 0x02AA6f38: 01 96 adiw r24, 0x01 ; 16f3a: 99 f4 brne .+38 ; 0x6f62 <ParameterZuordnung+0x714>{beeptime = 15000;6f3c: 88 e9 ldi r24, 0x98 ; 1526f3e: 9a e3 ldi r25, 0x3A ; 586f40: 90 93 ce 04 sts 0x04CE, r256f44: 80 93 cd 04 sts 0x04CD, r24BeepMuster = 0xA400;6f48: 80 e0 ldi r24, 0x00 ; 06f4a: 94 ea ldi r25, 0xA4 ; 1646f4c: 90 93 aa 02 sts 0x02AA, r256f50: 80 93 a9 02 sts 0x02A9, r24CareFree = 0;6f54: 10 92 d8 03 sts 0x03D8, r16f58: 0a c0 rjmp .+20 ; 0x6f6e <ParameterZuordnung+0x720>}if(CareFree) { FC_StatusFlags2 |= FC_STATUS2_CAREFREE; /*if(Parameter_AchsKopplung1 < 210) Parameter_AchsKopplung1 += 30;*/} else FC_StatusFlags2 &= ~FC_STATUS2_CAREFREE;6f5a: 80 91 d8 03 lds r24, 0x03D86f5e: 88 23 and r24, r246f60: 31 f0 breq .+12 ; 0x6f6e <ParameterZuordnung+0x720>6f62: 80 91 ca 03 lds r24, 0x03CA6f66: 81 60 ori r24, 0x01 ; 16f68: 80 93 ca 03 sts 0x03CA, r246f6c: 05 c0 rjmp .+10 ; 0x6f78 <ParameterZuordnung+0x72a>6f6e: 80 91 ca 03 lds r24, 0x03CA6f72: 8e 7f andi r24, 0xFE ; 2546f74: 80 93 ca 03 sts 0x03CA, r24}6f78: df 91 pop r296f7a: cf 91 pop r286f7c: 1f 91 pop r176f7e: 0f 91 pop r166f80: ff 90 pop r156f82: ef 90 pop r146f84: df 90 pop r136f86: 08 95 ret00006f88 <CalcStickGasHover>:void CalcStickGasHover(void){if(!EE_Parameter.Hoehe_StickNeutralPoint)6f88: 80 91 54 05 lds r24, 0x05546f8c: 81 11 cpse r24, r16f8e: 21 c0 rjmp .+66 ; 0x6fd2 <CalcStickGasHover+0x4a>{StickGasHover = HoverGas/STICK_GAIN; // rescale back to stick valueStickGasHover = (unsigned int)((unsigned int) StickGasHover * UBat) / BattLowVoltageWarning;6f90: 20 91 1a 01 lds r18, 0x011A6f94: 30 91 1b 01 lds r19, 0x011Bvoid CalcStickGasHover(void){if(!EE_Parameter.Hoehe_StickNeutralPoint){StickGasHover = HoverGas/STICK_GAIN; // rescale back to stick value6f98: 80 91 e8 03 lds r24, 0x03E86f9c: 90 91 e9 03 lds r25, 0x03E96fa0: 99 23 and r25, r256fa2: 0c f4 brge .+2 ; 0x6fa6 <CalcStickGasHover+0x1e>6fa4: 03 96 adiw r24, 0x03 ; 36fa6: ac 01 movw r20, r246fa8: 55 95 asr r216faa: 47 95 ror r206fac: 55 95 asr r216fae: 47 95 ror r20StickGasHover = (unsigned int)((unsigned int) StickGasHover * UBat) / BattLowVoltageWarning;6fb0: 42 9f mul r20, r186fb2: c0 01 movw r24, r06fb4: 43 9f mul r20, r196fb6: 90 0d add r25, r06fb8: 52 9f mul r21, r186fba: 90 0d add r25, r06fbc: 11 24 eor r1, r16fbe: 60 91 53 01 lds r22, 0x01536fc2: 70 e0 ldi r23, 0x00 ; 06fc4: 0e 94 42 b1 call 0x16284 ; 0x16284 <__udivmodhi4>6fc8: 70 93 41 01 sts 0x0141, r236fcc: 60 93 40 01 sts 0x0140, r226fd0: 05 c0 rjmp .+10 ; 0x6fdc <CalcStickGasHover+0x54>}else StickGasHover = EE_Parameter.Hoehe_StickNeutralPoint;6fd2: 90 e0 ldi r25, 0x00 ; 06fd4: 90 93 41 01 sts 0x0141, r256fd8: 80 93 40 01 sts 0x0140, r24LIMIT_MIN_MAX(StickGasHover, 70, 175); // reserve some range for trim up and down6fdc: 80 91 40 01 lds r24, 0x01406fe0: 90 91 41 01 lds r25, 0x01416fe4: 87 34 cpi r24, 0x47 ; 716fe6: 91 05 cpc r25, r16fe8: 38 f4 brcc .+14 ; 0x6ff8 <CalcStickGasHover+0x70>6fea: 86 e4 ldi r24, 0x46 ; 706fec: 90 e0 ldi r25, 0x00 ; 06fee: 90 93 41 01 sts 0x0141, r256ff2: 80 93 40 01 sts 0x0140, r246ff6: 08 95 ret6ff8: 8f 3a cpi r24, 0xAF ; 1756ffa: 91 05 cpc r25, r16ffc: 30 f0 brcs .+12 ; 0x700a <CalcStickGasHover+0x82>6ffe: 8f ea ldi r24, 0xAF ; 1757000: 90 e0 ldi r25, 0x00 ; 07002: 90 93 41 01 sts 0x0141, r257006: 80 93 40 01 sts 0x0140, r24700a: 08 95 ret0000700c <MotorRegler>://############################################################################//void MotorRegler(void)//############################################################################{700c: 2f 92 push r2700e: 3f 92 push r37010: 4f 92 push r47012: 5f 92 push r57014: 6f 92 push r67016: 7f 92 push r77018: 8f 92 push r8701a: 9f 92 push r9701c: af 92 push r10701e: bf 92 push r117020: cf 92 push r127022: df 92 push r137024: ef 92 push r147026: ff 92 push r157028: 0f 93 push r16702a: 1f 93 push r17702c: cf 93 push r28702e: df 93 push r297030: cd b7 in r28, 0x3d ; 617032: de b7 in r29, 0x3e ; 627034: a6 97 sbiw r28, 0x26 ; 387036: 0f b6 in r0, 0x3f ; 637038: f8 94 cli703a: de bf out 0x3e, r29 ; 62703c: 0f be out 0x3f, r0 ; 63703e: cd bf out 0x3d, r28 ; 61static unsigned char delay_neutral = 0;static unsigned char delay_einschalten = 0,delay_ausschalten = 0;static signed char move_safety_switch = 0;int IntegralNickMalFaktor,IntegralRollMalFaktor;unsigned char i;Mittelwert();7040: 0e 94 08 2d call 0x5a10 ; 0x5a10 <Mittelwert>// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++// Gaswert ermitteln// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++if(!(FC_StatusFlags & (FC_STATUS_EMERGENCY_LANDING | FC_STATUS2_RC_FAILSAVE_ACTIVE)))7044: 80 91 cb 03 lds r24, 0x03CB7048: 84 71 andi r24, 0x14 ; 20704a: a9 f5 brne .+106 ; 0x70b6 <MotorRegler+0xaa>{if(EE_Parameter.GlobalConfig3 & CFG3_VARIO_FAILSAFE)704c: 80 91 b9 05 lds r24, 0x05B97050: 82 ff sbrs r24, 27052: 2a c0 rjmp .+84 ; 0x70a8 <MotorRegler+0x9c>{if(HoverGas && HoverGas < 150 * STICK_GAIN)7054: 80 91 e8 03 lds r24, 0x03E87058: 90 91 e9 03 lds r25, 0x03E9705c: 00 97 sbiw r24, 0x00 ; 0705e: e9 f0 breq .+58 ; 0x709a <MotorRegler+0x8e>7060: 88 35 cpi r24, 0x58 ; 887062: 02 e0 ldi r16, 0x02 ; 27064: 90 07 cpc r25, r167066: cc f4 brge .+50 ; 0x709a <MotorRegler+0x8e>{HooverGasEmergencyPercent = (HoverGas/(STICK_GAIN) * EE_Parameter.NotGas) / 100; // i.e. 80% of Hovergas7068: 9c 01 movw r18, r24706a: 99 23 and r25, r25706c: 14 f4 brge .+4 ; 0x7072 <MotorRegler+0x66>706e: 2d 5f subi r18, 0xFD ; 2537070: 3f 4f sbci r19, 0xFF ; 2557072: 35 95 asr r197074: 27 95 ror r187076: 35 95 asr r197078: 27 95 ror r18707a: 40 91 63 05 lds r20, 0x0563707e: 42 9f mul r20, r187080: c0 01 movw r24, r07082: 43 9f mul r20, r197084: 90 0d add r25, r07086: 11 24 eor r1, r17088: 64 e6 ldi r22, 0x64 ; 100708a: 70 e0 ldi r23, 0x00 ; 0708c: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>7090: 70 93 c8 03 sts 0x03C8, r237094: 60 93 c7 03 sts 0x03C7, r227098: 0e c0 rjmp .+28 ; 0x70b6 <MotorRegler+0xaa>}else HooverGasEmergencyPercent = 45; // default if the Hoovergas was could not calculated yet709a: 8d e2 ldi r24, 0x2D ; 45709c: 90 e0 ldi r25, 0x00 ; 0709e: 90 93 c8 03 sts 0x03C8, r2570a2: 80 93 c7 03 sts 0x03C7, r2470a6: 07 c0 rjmp .+14 ; 0x70b6 <MotorRegler+0xaa>} else HooverGasEmergencyPercent = EE_Parameter.NotGas;70a8: 80 91 63 05 lds r24, 0x056370ac: 90 e0 ldi r25, 0x00 ; 070ae: 90 93 c8 03 sts 0x03C8, r2570b2: 80 93 c7 03 sts 0x03C7, r24}if(GasIsZeroCnt == 30000) // in that case we have RC-Lost, but the MK is probably landed70b6: 20 91 c5 03 lds r18, 0x03C570ba: 30 91 c6 03 lds r19, 0x03C670be: 20 33 cpi r18, 0x30 ; 4870c0: 15 e7 ldi r17, 0x75 ; 11770c2: 31 07 cpc r19, r1770c4: 59 f4 brne .+22 ; 0x70dc <MotorRegler+0xd0>{StickGas = 0; // Hold Gas down in that case70c6: 10 92 0f 04 sts 0x040F, r170ca: 10 92 0e 04 sts 0x040E, r1HooverGasEmergencyPercent = MIN_GAS;70ce: 80 91 2c 06 lds r24, 0x062C70d2: 90 e0 ldi r25, 0x00 ; 070d4: 90 93 c8 03 sts 0x03C8, r2570d8: 80 93 c7 03 sts 0x03C7, r24}GasMischanteil = StickGas;70dc: 80 91 0e 04 lds r24, 0x040E70e0: 90 91 0f 04 lds r25, 0x040Fif(GasMischanteil < MIN_GAS + 10) GasMischanteil = MIN_GAS + 10;70e4: 20 90 2c 06 lds r2, 0x062C70e8: 31 2c mov r3, r170ea: 4a e0 ldi r20, 0x0A ; 1070ec: 24 0e add r2, r2070ee: 31 1c adc r3, r170f0: 28 16 cp r2, r2470f2: 39 06 cpc r3, r2570f4: 0c f4 brge .+2 ; 0x70f8 <MotorRegler+0xec>70f6: 1c 01 movw r2, r24// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++// Empfang schlecht// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++if(SenderOkay < 100 && !(FC_StatusFlags2 & FC_STATUS2_RC_FAILSAVE_ACTIVE))70f8: 80 91 04 04 lds r24, 0x040470fc: 84 36 cpi r24, 0x64 ; 10070fe: a0 f5 brcc .+104 ; 0x7168 <MotorRegler+0x15c>7100: 80 91 ca 03 lds r24, 0x03CA7104: 82 fd sbrc r24, 27106: 30 c0 rjmp .+96 ; 0x7168 <MotorRegler+0x15c>{if(RcLostTimer) RcLostTimer--;7108: 80 91 a2 03 lds r24, 0x03A2710c: 90 91 a3 03 lds r25, 0x03A37110: 00 97 sbiw r24, 0x00 ; 07112: 31 f0 breq .+12 ; 0x7120 <MotorRegler+0x114>7114: 01 97 sbiw r24, 0x01 ; 17116: 90 93 a3 03 sts 0x03A3, r25711a: 80 93 a2 03 sts 0x03A2, r24711e: 0b c0 rjmp .+22 ; 0x7136 <MotorRegler+0x12a>else{MotorenEin = 0;7120: 10 92 03 04 sts 0x0403, r1modell_fliegt = 0;7124: 10 92 cd 03 sts 0x03CD, r17128: 10 92 cc 03 sts 0x03CC, r1FC_StatusFlags &= ~(FC_STATUS_EMERGENCY_LANDING | FC_STATUS_FLY);712c: 80 91 cb 03 lds r24, 0x03CB7130: 8d 7e andi r24, 0xED ; 2377132: 80 93 cb 03 sts 0x03CB, r24}ROT_ON;7136: 28 9a sbi 0x05, 0 ; 5if(modell_fliegt > 1000 && Capacity.MinOfMaxPWM > 100) // wahrscheinlich in der Luft --> langsam absenken7138: 80 91 cc 03 lds r24, 0x03CC713c: 90 91 cd 03 lds r25, 0x03CD7140: 89 3e cpi r24, 0xE9 ; 2337142: 93 40 sbci r25, 0x03 ; 37144: 70 f0 brcs .+28 ; 0x7162 <MotorRegler+0x156>7146: 80 91 1b 05 lds r24, 0x051B714a: 85 36 cpi r24, 0x65 ; 101714c: 50 f0 brcs .+20 ; 0x7162 <MotorRegler+0x156>{GasMischanteil = HooverGasEmergencyPercent;714e: 20 90 c7 03 lds r2, 0x03C77152: 30 90 c8 03 lds r3, 0x03C8FC_StatusFlags |= FC_STATUS_EMERGENCY_LANDING;7156: 80 91 cb 03 lds r24, 0x03CB715a: 80 61 ori r24, 0x10 ; 16715c: 80 93 cb 03 sts 0x03CB, r247160: f1 c5 rjmp .+3042 ; 0x7d44 <MotorRegler+0xd38>}else{MotorenEin = 0;7162: 10 92 03 04 sts 0x0403, r17166: ee c5 rjmp .+3036 ; 0x7d44 <MotorRegler+0xd38>}else// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++// Emfang gut// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++if(SenderOkay > 140)7168: 80 91 04 04 lds r24, 0x0404716c: 8d 38 cpi r24, 0x8D ; 141716e: 08 f4 brcc .+2 ; 0x7172 <MotorRegler+0x166>7170: bf c5 rjmp .+2942 ; 0x7cf0 <MotorRegler+0xce4>{#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))static unsigned int trigger = 1000;static unsigned char old_switch = 100;if(EE_Parameter.StartLandChannel && EE_Parameter.LandingSpeed)7172: 80 91 af 05 lds r24, 0x05AF7176: 88 23 and r24, r247178: 09 f4 brne .+2 ; 0x717c <MotorRegler+0x170>717a: 4d c0 rjmp .+154 ; 0x7216 <MotorRegler+0x20a>717c: 90 91 b0 05 lds r25, 0x05B07180: 99 23 and r25, r257182: 09 f4 brne .+2 ; 0x7186 <MotorRegler+0x17a>7184: 48 c0 rjmp .+144 ; 0x7216 <MotorRegler+0x20a>{if(PPM_in[EE_Parameter.StartLandChannel] > 50)7186: 90 e0 ldi r25, 0x00 ; 07188: fc 01 movw r30, r24718a: ee 0f add r30, r30718c: ff 1f adc r31, r31718e: ef 5c subi r30, 0xCF ; 2077190: f7 4f sbci r31, 0xF7 ; 2477192: 20 81 ld r18, Z7194: 31 81 ldd r19, Z+1 ; 0x017196: 23 33 cpi r18, 0x33 ; 517198: 31 05 cpc r19, r1719a: cc f0 brlt .+50 ; 0x71ce <MotorRegler+0x1c2>{if(old_switch == 50) if(FC_StatusFlags2 & FC_STATUS2_WAIT_FOR_TAKEOFF) { FC_StatusFlags2 |= FC_STATUS2_AUTO_STARTING; SpeakHoTT = SPEAK_RISING;}719c: 80 91 1f 01 lds r24, 0x011F71a0: 82 33 cpi r24, 0x32 ; 5071a2: 61 f4 brne .+24 ; 0x71bc <MotorRegler+0x1b0>71a4: 80 91 ca 03 lds r24, 0x03CA71a8: 85 ff sbrs r24, 571aa: 08 c0 rjmp .+16 ; 0x71bc <MotorRegler+0x1b0>71ac: 80 91 ca 03 lds r24, 0x03CA71b0: 80 64 ori r24, 0x40 ; 6471b2: 80 93 ca 03 sts 0x03CA, r2471b6: 80 e3 ldi r24, 0x30 ; 4871b8: 80 93 57 01 sts 0x0157, r24FC_StatusFlags2 &= ~FC_STATUS2_AUTO_LANDING;71bc: 80 91 ca 03 lds r24, 0x03CA71c0: 8f 77 andi r24, 0x7F ; 12771c2: 80 93 ca 03 sts 0x03CA, r24old_switch = 150;71c6: 86 e9 ldi r24, 0x96 ; 15071c8: 80 93 1f 01 sts 0x011F, r2471cc: 24 c0 rjmp .+72 ; 0x7216 <MotorRegler+0x20a>}elseif(PPM_in[EE_Parameter.StartLandChannel] < -50)71ce: fc 01 movw r30, r2471d0: ee 0f add r30, r3071d2: ff 1f adc r31, r3171d4: ef 5c subi r30, 0xCF ; 20771d6: f7 4f sbci r31, 0xF7 ; 24771d8: 80 81 ld r24, Z71da: 91 81 ldd r25, Z+1 ; 0x0171dc: 8e 3c cpi r24, 0xCE ; 20671de: 9f 4f sbci r25, 0xFF ; 25571e0: ac f4 brge .+42 ; 0x720c <MotorRegler+0x200>{if(old_switch == 150) { FC_StatusFlags2 |= FC_STATUS2_AUTO_LANDING; SpeakHoTT = SPEAK_SINKING;}71e2: 80 91 1f 01 lds r24, 0x011F71e6: 86 39 cpi r24, 0x96 ; 15071e8: 41 f4 brne .+16 ; 0x71fa <MotorRegler+0x1ee>71ea: 80 91 ca 03 lds r24, 0x03CA71ee: 80 68 ori r24, 0x80 ; 12871f0: 80 93 ca 03 sts 0x03CA, r2471f4: 8f e2 ldi r24, 0x2F ; 4771f6: 80 93 57 01 sts 0x0157, r24FC_StatusFlags2 &= ~FC_STATUS2_AUTO_STARTING;71fa: 80 91 ca 03 lds r24, 0x03CA71fe: 8f 7b andi r24, 0xBF ; 1917200: 80 93 ca 03 sts 0x03CA, r24old_switch = 50;7204: 82 e3 ldi r24, 0x32 ; 507206: 80 93 1f 01 sts 0x011F, r24720a: 05 c0 rjmp .+10 ; 0x7216 <MotorRegler+0x20a>}else{FC_StatusFlags2 &= ~(FC_STATUS2_AUTO_STARTING | FC_STATUS2_AUTO_LANDING);720c: 80 91 ca 03 lds r24, 0x03CA7210: 8f 73 andi r24, 0x3F ; 637212: 80 93 ca 03 sts 0x03CA, r24}}#endifFC_StatusFlags &= ~FC_STATUS_EMERGENCY_LANDING;7216: 80 91 cb 03 lds r24, 0x03CB721a: 8f 7e andi r24, 0xEF ; 239721c: 80 93 cb 03 sts 0x03CB, r24RcLostTimer = EE_Parameter.NotGasZeit * 50;7220: 80 91 64 05 lds r24, 0x05647224: 72 e3 ldi r23, 0x32 ; 507226: 87 9f mul r24, r237228: c0 01 movw r24, r0722a: 11 24 eor r1, r1722c: 90 93 a3 03 sts 0x03A3, r257230: 80 93 a2 03 sts 0x03A2, r24if(GasMischanteil > 40 && MotorenEin)7234: 89 e2 ldi r24, 0x29 ; 417236: 28 16 cp r2, r247238: 31 04 cpc r3, r1723a: 8c f0 brlt .+34 ; 0x725e <MotorRegler+0x252>723c: 80 91 03 04 lds r24, 0x04037240: 88 23 and r24, r247242: 69 f0 breq .+26 ; 0x725e <MotorRegler+0x252>{if(modell_fliegt < 0xffff) modell_fliegt++;7244: 80 91 cc 03 lds r24, 0x03CC7248: 90 91 cd 03 lds r25, 0x03CD724c: 8f 3f cpi r24, 0xFF ; 255724e: af ef ldi r26, 0xFF ; 2557250: 9a 07 cpc r25, r267252: b1 f1 breq .+108 ; 0x72c0 <MotorRegler+0x2b4>7254: 01 96 adiw r24, 0x01 ; 17256: 90 93 cd 03 sts 0x03CD, r25725a: 80 93 cc 03 sts 0x03CC, r24}if((modell_fliegt < 256))725e: 80 91 cc 03 lds r24, 0x03CC7262: 90 91 cd 03 lds r25, 0x03CD7266: 8f 3f cpi r24, 0xFF ; 2557268: 91 05 cpc r25, r1726a: 09 f0 breq .+2 ; 0x726e <MotorRegler+0x262>726c: 48 f5 brcc .+82 ; 0x72c0 <MotorRegler+0x2b4>{SummeNick = 0;726e: 10 92 26 04 sts 0x0426, r17272: 10 92 27 04 sts 0x0427, r17276: 10 92 28 04 sts 0x0428, r1727a: 10 92 29 04 sts 0x0429, r1SummeRoll = 0;727e: 10 92 22 04 sts 0x0422, r17282: 10 92 23 04 sts 0x0423, r17286: 10 92 24 04 sts 0x0424, r1728a: 10 92 25 04 sts 0x0425, r1sollGier = 0;728e: 10 92 9e 03 sts 0x039E, r17292: 10 92 9f 03 sts 0x039F, r17296: 10 92 a0 03 sts 0x03A0, r1729a: 10 92 a1 03 sts 0x03A1, r1Mess_Integral_Gier = 0;729e: 10 92 2e 04 sts 0x042E, r172a2: 10 92 2f 04 sts 0x042F, r172a6: 10 92 30 04 sts 0x0430, r172aa: 10 92 31 04 sts 0x0431, r1FC_StatusFlags2 |= FC_STATUS2_WAIT_FOR_TAKEOFF;72ae: 80 91 ca 03 lds r24, 0x03CA72b2: 80 62 ori r24, 0x20 ; 3272b4: 80 93 ca 03 sts 0x03CA, r24#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))old_switch = 100;72b8: 84 e6 ldi r24, 0x64 ; 10072ba: 80 93 1f 01 sts 0x011F, r2472be: 38 c1 rjmp .+624 ; 0x7530 <MotorRegler+0x524>#endif}else{FC_StatusFlags |= FC_STATUS_FLY;72c0: 80 91 cb 03 lds r24, 0x03CB72c4: 82 60 ori r24, 0x02 ; 272c6: 80 93 cb 03 sts 0x03CB, r24if(FC_StatusFlags2 & FC_STATUS2_WAIT_FOR_TAKEOFF)72ca: 80 91 ca 03 lds r24, 0x03CA72ce: 85 ff sbrs r24, 572d0: 9a c0 rjmp .+308 ; 0x7406 <MotorRegler+0x3fa>{#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))if((NC_To_FC_Flags & NC_TO_FC_AUTOSTART || FC_StatusFlags2 & FC_STATUS2_AUTO_STARTING) && (VarioCharacter == '=') && ACC_AltitudeControl)72d2: 80 91 b7 04 lds r24, 0x04B772d6: 28 2f mov r18, r2472d8: 24 70 andi r18, 0x04 ; 472da: 82 fd sbrc r24, 272dc: 04 c0 rjmp .+8 ; 0x72e6 <MotorRegler+0x2da>72de: 80 91 ca 03 lds r24, 0x03CA72e2: 86 ff sbrs r24, 672e4: 2a c0 rjmp .+84 ; 0x733a <MotorRegler+0x32e>72e6: 80 91 20 01 lds r24, 0x012072ea: 8d 33 cpi r24, 0x3D ; 6172ec: 31 f5 brne .+76 ; 0x733a <MotorRegler+0x32e>72ee: 80 91 c2 03 lds r24, 0x03C272f2: 88 23 and r24, r2472f4: 11 f1 breq .+68 ; 0x733a <MotorRegler+0x32e>{FromNC_AltitudeSpeed = 80;72f6: 80 e5 ldi r24, 0x50 ; 8072f8: 80 93 f3 03 sts 0x03F3, r24FromNC_AltitudeSetpoint = 500;72fc: 84 ef ldi r24, 0xF4 ; 24472fe: 91 e0 ldi r25, 0x01 ; 17300: a0 e0 ldi r26, 0x00 ; 07302: b0 e0 ldi r27, 0x00 ; 07304: 80 93 f4 03 sts 0x03F4, r247308: 90 93 f5 03 sts 0x03F5, r25730c: a0 93 f6 03 sts 0x03F6, r267310: b0 93 f7 03 sts 0x03F7, r27SollHoehe = 500;7314: 80 93 fa 03 sts 0x03FA, r247318: 90 93 fb 03 sts 0x03FB, r25731c: a0 93 fc 03 sts 0x03FC, r267320: b0 93 fd 03 sts 0x03FD, r27trigger = 1000;7324: 88 ee ldi r24, 0xE8 ; 2327326: 93 e0 ldi r25, 0x03 ; 37328: 90 93 1e 01 sts 0x011E, r25732c: 80 93 1d 01 sts 0x011D, r24if(NC_To_FC_Flags & NC_TO_FC_AUTOSTART) SpeakHoTT = SPEAK_NEXT_WP;7330: 22 23 and r18, r187332: 19 f0 breq .+6 ; 0x733a <MotorRegler+0x32e>7334: 8d e0 ldi r24, 0x0D ; 137336: 80 93 57 01 sts 0x0157, r24}*/}// else FC_StatusFlags2 &= ~(FC_STATUS2_AUTO_STARTING);#endifif(HoehenWertF > 150 || HoehenWert < -350 || !(Parameter_GlobalConfig & CFG_HOEHENREGELUNG))733a: 80 91 4a 03 lds r24, 0x034A733e: 90 91 4b 03 lds r25, 0x034B7342: a0 91 4c 03 lds r26, 0x034C7346: b0 91 4d 03 lds r27, 0x034D734a: 87 39 cpi r24, 0x97 ; 151734c: 91 05 cpc r25, r1734e: a1 05 cpc r26, r17350: b1 05 cpc r27, r17352: 8c f4 brge .+34 ; 0x7376 <MotorRegler+0x36a>7354: 80 91 fe 03 lds r24, 0x03FE7358: 90 91 ff 03 lds r25, 0x03FF735c: a0 91 00 04 lds r26, 0x04007360: b0 91 01 04 lds r27, 0x04017364: 82 3a cpi r24, 0xA2 ; 1627366: 9e 4f sbci r25, 0xFE ; 2547368: af 4f sbci r26, 0xFF ; 255736a: bf 4f sbci r27, 0xFF ; 255736c: 24 f0 brlt .+8 ; 0x7376 <MotorRegler+0x36a>736e: 80 91 5c 06 lds r24, 0x065C7372: 80 fd sbrc r24, 07374: 21 c0 rjmp .+66 ; 0x73b8 <MotorRegler+0x3ac>{#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))trigger = 1000;7376: 88 ee ldi r24, 0xE8 ; 2327378: 93 e0 ldi r25, 0x03 ; 3737a: 90 93 1e 01 sts 0x011E, r25737e: 80 93 1d 01 sts 0x011D, r24if(FC_StatusFlags2 & FC_STATUS2_AUTO_STARTING) { FromNC_AltitudeSpeed = 0; SollHoehe = 300;/*HoehenWertF + 100;*/}7382: 80 91 ca 03 lds r24, 0x03CA7386: 86 ff sbrs r24, 67388: 0f c0 rjmp .+30 ; 0x73a8 <MotorRegler+0x39c>738a: 10 92 f3 03 sts 0x03F3, r1738e: 8c e2 ldi r24, 0x2C ; 447390: 91 e0 ldi r25, 0x01 ; 17392: a0 e0 ldi r26, 0x00 ; 07394: b0 e0 ldi r27, 0x00 ; 07396: 80 93 fa 03 sts 0x03FA, r24739a: 90 93 fb 03 sts 0x03FB, r25739e: a0 93 fc 03 sts 0x03FC, r2673a2: b0 93 fd 03 sts 0x03FD, r2773a6: 03 c0 rjmp .+6 ; 0x73ae <MotorRegler+0x3a2>else SpeakHoTT = SPEAK_RISING;73a8: 80 e3 ldi r24, 0x30 ; 4873aa: 80 93 57 01 sts 0x0157, r24#endifFC_StatusFlags2 &= ~(FC_STATUS2_WAIT_FOR_TAKEOFF | FC_STATUS2_AUTO_STARTING | FC_STATUS2_AUTO_LANDING);73ae: 80 91 ca 03 lds r24, 0x03CA73b2: 8f 71 andi r24, 0x1F ; 3173b4: 80 93 ca 03 sts 0x03CA, r24}SummeNick = 0;73b8: 10 92 26 04 sts 0x0426, r173bc: 10 92 27 04 sts 0x0427, r173c0: 10 92 28 04 sts 0x0428, r173c4: 10 92 29 04 sts 0x0429, r1SummeRoll = 0;73c8: 10 92 22 04 sts 0x0422, r173cc: 10 92 23 04 sts 0x0423, r173d0: 10 92 24 04 sts 0x0424, r173d4: 10 92 25 04 sts 0x0425, r1Mess_Integral_Gier = 0;73d8: 10 92 2e 04 sts 0x042E, r173dc: 10 92 2f 04 sts 0x042F, r173e0: 10 92 30 04 sts 0x0430, r173e4: 10 92 31 04 sts 0x0431, r1// sollGier = 0;if(modell_fliegt > 1000) modell_fliegt = 1000; // for the Hooverpoint-Estimation73e8: 80 91 cc 03 lds r24, 0x03CC73ec: 90 91 cd 03 lds r25, 0x03CD73f0: 89 3e cpi r24, 0xE9 ; 23373f2: 93 40 sbci r25, 0x03 ; 373f4: 08 f4 brcc .+2 ; 0x73f8 <MotorRegler+0x3ec>73f6: 9c c0 rjmp .+312 ; 0x7530 <MotorRegler+0x524>73f8: 88 ee ldi r24, 0xE8 ; 23273fa: 93 e0 ldi r25, 0x03 ; 373fc: 90 93 cd 03 sts 0x03CD, r257400: 80 93 cc 03 sts 0x03CC, r247404: 95 c0 rjmp .+298 ; 0x7530 <MotorRegler+0x524>}else // Flying mode{#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))if((FC_StatusFlags2 & FC_STATUS2_AUTO_LANDING) && (VarioCharacter == 'v' || VarioCharacter == '=') && ACC_AltitudeControl)7406: 80 91 ca 03 lds r24, 0x03CA740a: 88 23 and r24, r24740c: d4 f4 brge .+52 ; 0x7442 <MotorRegler+0x436>740e: 80 91 20 01 lds r24, 0x01207412: 86 37 cpi r24, 0x76 ; 1187414: 11 f0 breq .+4 ; 0x741a <MotorRegler+0x40e>7416: 8d 33 cpi r24, 0x3D ; 617418: a1 f4 brne .+40 ; 0x7442 <MotorRegler+0x436>741a: 80 91 c2 03 lds r24, 0x03C2741e: 88 23 and r24, r247420: 81 f0 breq .+32 ; 0x7442 <MotorRegler+0x436>{FromNC_AltitudeSpeed = EE_Parameter.LandingSpeed;7422: 80 91 b0 05 lds r24, 0x05B07426: 80 93 f3 03 sts 0x03F3, r24FromNC_AltitudeSetpoint = -20000;742a: 80 ee ldi r24, 0xE0 ; 224742c: 91 eb ldi r25, 0xB1 ; 177742e: af ef ldi r26, 0xFF ; 2557430: bf ef ldi r27, 0xFF ; 2557432: 80 93 f4 03 sts 0x03F4, r247436: 90 93 f5 03 sts 0x03F5, r25743a: a0 93 f6 03 sts 0x03F6, r26743e: b0 93 f7 03 sts 0x03F7, r27}if(trigger < 1000)7442: 80 91 1d 01 lds r24, 0x011D7446: 90 91 1e 01 lds r25, 0x011E744a: 88 3e cpi r24, 0xE8 ; 232744c: 03 e0 ldi r16, 0x03 ; 3744e: 90 07 cpc r25, r167450: 08 f0 brcs .+2 ; 0x7454 <MotorRegler+0x448>7452: 49 c0 rjmp .+146 ; 0x74e6 <MotorRegler+0x4da>{trigger++;7454: 9c 01 movw r18, r247456: 2f 5f subi r18, 0xFF ; 2557458: 3f 4f sbci r19, 0xFF ; 255745a: 30 93 1e 01 sts 0x011E, r19745e: 20 93 1d 01 sts 0x011D, r18SummeNick = 0;7462: 10 92 26 04 sts 0x0426, r17466: 10 92 27 04 sts 0x0427, r1746a: 10 92 28 04 sts 0x0428, r1746e: 10 92 29 04 sts 0x0429, r1SummeRoll = 0;7472: 10 92 22 04 sts 0x0422, r17476: 10 92 23 04 sts 0x0423, r1747a: 10 92 24 04 sts 0x0424, r1747e: 10 92 25 04 sts 0x0425, r1Mess_Integral_Gier = 0;7482: 10 92 2e 04 sts 0x042E, r17486: 10 92 2f 04 sts 0x042F, r1748a: 10 92 30 04 sts 0x0430, r1748e: 10 92 31 04 sts 0x0431, r1SollHoehe = HoehenWertF - 300;7492: 80 91 4a 03 lds r24, 0x034A7496: 90 91 4b 03 lds r25, 0x034B749a: a0 91 4c 03 lds r26, 0x034C749e: b0 91 4d 03 lds r27, 0x034D74a2: 8c 52 subi r24, 0x2C ; 4474a4: 91 40 sbci r25, 0x01 ; 174a6: a1 09 sbc r26, r174a8: b1 09 sbc r27, r174aa: 80 93 fa 03 sts 0x03FA, r2474ae: 90 93 fb 03 sts 0x03FB, r2574b2: a0 93 fc 03 sts 0x03FC, r2674b6: b0 93 fd 03 sts 0x03FD, r27if(trigger == 1000 && FC_StatusFlags2 & FC_STATUS2_AUTO_LANDING && VarioCharacter != '+')74ba: 28 3e cpi r18, 0xE8 ; 23274bc: 33 40 sbci r19, 0x03 ; 374be: c1 f5 brne .+112 ; 0x7530 <MotorRegler+0x524>74c0: 80 91 ca 03 lds r24, 0x03CA74c4: 88 23 and r24, r2474c6: a4 f5 brge .+104 ; 0x7530 <MotorRegler+0x524>74c8: 80 91 20 01 lds r24, 0x012074cc: 8b 32 cpi r24, 0x2B ; 4374ce: 81 f1 breq .+96 ; 0x7530 <MotorRegler+0x524>{FC_StatusFlags2 &= ~FC_STATUS2_AUTO_LANDING;74d0: 80 91 ca 03 lds r24, 0x03CA74d4: 8f 77 andi r24, 0x7F ; 12774d6: 80 93 ca 03 sts 0x03CA, r24FC_StatusFlags2 |= FC_STATUS2_WAIT_FOR_TAKEOFF; // go back into starting state74da: 80 91 ca 03 lds r24, 0x03CA74de: 80 62 ori r24, 0x20 ; 3274e0: 80 93 ca 03 sts 0x03CA, r2474e4: 25 c0 rjmp .+74 ; 0x7530 <MotorRegler+0x524>}}elseif(ACC_AltitudeControl && (VarioCharacter == 'v' || VarioCharacter == '-') && HoehenWert < 1000 /*&& FromNC_AltitudeSetpoint < 0*/)74e6: 80 91 c2 03 lds r24, 0x03C274ea: 88 23 and r24, r2474ec: 09 f1 breq .+66 ; 0x7530 <MotorRegler+0x524>74ee: 80 91 20 01 lds r24, 0x012074f2: 86 37 cpi r24, 0x76 ; 11874f4: 11 f0 breq .+4 ; 0x74fa <MotorRegler+0x4ee>74f6: 8d 32 cpi r24, 0x2D ; 4574f8: d9 f4 brne .+54 ; 0x7530 <MotorRegler+0x524>74fa: 80 91 fe 03 lds r24, 0x03FE74fe: 90 91 ff 03 lds r25, 0x03FF7502: a0 91 00 04 lds r26, 0x04007506: b0 91 01 04 lds r27, 0x0401750a: 88 3e cpi r24, 0xE8 ; 232750c: 93 40 sbci r25, 0x03 ; 3750e: a1 05 cpc r26, r17510: b1 05 cpc r27, r17512: 74 f4 brge .+28 ; 0x7530 <MotorRegler+0x524>{if(Aktuell_az > 940)7514: 80 91 06 05 lds r24, 0x05067518: 90 91 07 05 lds r25, 0x0507751c: 8d 3a cpi r24, 0xAD ; 173751e: 93 40 sbci r25, 0x03 ; 37520: 3c f0 brlt .+14 ; 0x7530 <MotorRegler+0x524>{trigger = 0;7522: 10 92 1e 01 sts 0x011E, r17526: 10 92 1d 01 sts 0x011D, r1SpeakHoTT = SPEAK_LANDING;752a: 8e e0 ldi r24, 0x0E ; 14752c: 80 93 57 01 sts 0x0157, r24};}#endif}} // end of: modell_fliegt > 256if((PPM_in[EE_Parameter.Kanalbelegung[K_GAS]] > 80) && MotorenEin == 0 && !(NC_To_FC_Flags & NC_TO_FC_SIMULATION_ACTIVE))7530: e0 91 41 05 lds r30, 0x05417534: f0 e0 ldi r31, 0x00 ; 07536: ee 0f add r30, r307538: ff 1f adc r31, r31753a: ef 5c subi r30, 0xCF ; 207753c: f7 4f sbci r31, 0xF7 ; 247753e: 80 81 ld r24, Z7540: 91 81 ldd r25, Z+1 ; 0x017542: 81 35 cpi r24, 0x51 ; 817544: 91 05 cpc r25, r17546: 0c f4 brge .+2 ; 0x754a <MotorRegler+0x53e>7548: 87 c1 rjmp .+782 ; 0x7858 <MotorRegler+0x84c>754a: 80 91 03 04 lds r24, 0x0403754e: 81 11 cpse r24, r17550: 83 c1 rjmp .+774 ; 0x7858 <MotorRegler+0x84c>7552: 80 91 b7 04 lds r24, 0x04B77556: 84 fd sbrc r24, 47558: 7f c1 rjmp .+766 ; 0x7858 <MotorRegler+0x84c>{// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++// auf Nullwerte kalibrieren// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++if(abs(PPM_in[EE_Parameter.Kanalbelegung[K_GIER]]) > 75) // Neutralwerte755a: e0 91 42 05 lds r30, 0x0542755e: f0 e0 ldi r31, 0x00 ; 07560: ee 0f add r30, r307562: ff 1f adc r31, r317564: ef 5c subi r30, 0xCF ; 2077566: f7 4f sbci r31, 0xF7 ; 2477568: 80 81 ld r24, Z756a: 91 81 ldd r25, Z+1 ; 0x01756c: 99 23 and r25, r25756e: 1c f4 brge .+6 ; 0x7576 <MotorRegler+0x56a>7570: 91 95 neg r257572: 81 95 neg r247574: 91 09 sbc r25, r17576: 8c 34 cpi r24, 0x4C ; 767578: 91 05 cpc r25, r1757a: 0c f4 brge .+2 ; 0x757e <MotorRegler+0x572>757c: 6b c1 rjmp .+726 ; 0x7854 <MotorRegler+0x848>{if(++delay_neutral > 200) // nicht sofort757e: 80 91 9d 03 lds r24, 0x039D7582: 8f 5f subi r24, 0xFF ; 2557584: 89 3c cpi r24, 0xC9 ; 2017586: 18 f4 brcc .+6 ; 0x758e <MotorRegler+0x582>7588: 80 93 9d 03 sts 0x039D, r24758c: 65 c1 rjmp .+714 ; 0x7858 <MotorRegler+0x84c>{unsigned char setting = 0;delay_neutral = 0;758e: 10 92 9d 03 sts 0x039D, r1modell_fliegt = 0;7592: 10 92 cd 03 sts 0x03CD, r17596: 10 92 cc 03 sts 0x03CC, r1if(PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] > 70 || abs(PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]]) > 70)759a: 20 91 3f 05 lds r18, 0x053F759e: 30 e0 ldi r19, 0x00 ; 075a0: f9 01 movw r30, r1875a2: ee 0f add r30, r3075a4: ff 1f adc r31, r3175a6: ef 5c subi r30, 0xCF ; 20775a8: f7 4f sbci r31, 0xF7 ; 24775aa: 80 81 ld r24, Z75ac: 91 81 ldd r25, Z+1 ; 0x0175ae: 87 34 cpi r24, 0x47 ; 7175b0: 91 05 cpc r25, r175b2: 94 f4 brge .+36 ; 0x75d8 <MotorRegler+0x5cc>75b4: e0 91 40 05 lds r30, 0x054075b8: f0 e0 ldi r31, 0x00 ; 075ba: ee 0f add r30, r3075bc: ff 1f adc r31, r3175be: ef 5c subi r30, 0xCF ; 20775c0: f7 4f sbci r31, 0xF7 ; 24775c2: 80 81 ld r24, Z75c4: 91 81 ldd r25, Z+1 ; 0x0175c6: 99 23 and r25, r2575c8: 1c f4 brge .+6 ; 0x75d0 <MotorRegler+0x5c4>75ca: 91 95 neg r2575cc: 81 95 neg r2475ce: 91 09 sbc r25, r175d0: 87 34 cpi r24, 0x47 ; 7175d2: 91 05 cpc r25, r175d4: 0c f4 brge .+2 ; 0x75d8 <MotorRegler+0x5cc>75d6: 8c c0 rjmp .+280 ; 0x76f0 <MotorRegler+0x6e4>{if(PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] > 70 && PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] < 70 && PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] > -70) setting = 1;75d8: 40 91 40 05 lds r20, 0x054075dc: 50 e0 ldi r21, 0x00 ; 075de: fa 01 movw r30, r2075e0: ee 0f add r30, r3075e2: ff 1f adc r31, r3175e4: ef 5c subi r30, 0xCF ; 20775e6: f7 4f sbci r31, 0xF7 ; 24775e8: 80 81 ld r24, Z75ea: 91 81 ldd r25, Z+1 ; 0x0175ec: 87 34 cpi r24, 0x47 ; 7175ee: 91 05 cpc r25, r175f0: bc f0 brlt .+46 ; 0x7620 <MotorRegler+0x614>75f2: f9 01 movw r30, r1875f4: ee 0f add r30, r3075f6: ff 1f adc r31, r3175f8: ef 5c subi r30, 0xCF ; 20775fa: f7 4f sbci r31, 0xF7 ; 24775fc: 80 81 ld r24, Z75fe: 91 81 ldd r25, Z+1 ; 0x017600: 86 34 cpi r24, 0x46 ; 707602: 91 05 cpc r25, r17604: 7c f4 brge .+30 ; 0x7624 <MotorRegler+0x618>7606: f9 01 movw r30, r187608: ee 0f add r30, r30760a: ff 1f adc r31, r31760c: ef 5c subi r30, 0xCF ; 207760e: f7 4f sbci r31, 0xF7 ; 2477610: 80 81 ld r24, Z7612: 91 81 ldd r25, Z+1 ; 0x017614: 11 e0 ldi r17, 0x01 ; 17616: 8b 3b cpi r24, 0xBB ; 1877618: 9f 4f sbci r25, 0xFF ; 255761a: 2c f4 brge .+10 ; 0x7626 <MotorRegler+0x61a>761c: 10 e0 ldi r17, 0x00 ; 0761e: 03 c0 rjmp .+6 ; 0x7626 <MotorRegler+0x61a>// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++if(abs(PPM_in[EE_Parameter.Kanalbelegung[K_GIER]]) > 75) // Neutralwerte{if(++delay_neutral > 200) // nicht sofort{unsigned char setting = 0;7620: 10 e0 ldi r17, 0x00 ; 07622: 01 c0 rjmp .+2 ; 0x7626 <MotorRegler+0x61a>7624: 10 e0 ldi r17, 0x00 ; 0delay_neutral = 0;modell_fliegt = 0;if(PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] > 70 || abs(PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]]) > 70){if(PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] > 70 && PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] < 70 && PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] > -70) setting = 1;if(PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] > 70 && PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] > 70) setting = 2;7626: fa 01 movw r30, r207628: ee 0f add r30, r30762a: ff 1f adc r31, r31762c: ef 5c subi r30, 0xCF ; 207762e: f7 4f sbci r31, 0xF7 ; 2477630: 80 81 ld r24, Z7632: 91 81 ldd r25, Z+1 ; 0x017634: 87 34 cpi r24, 0x47 ; 717636: 91 05 cpc r25, r17638: 5c f0 brlt .+22 ; 0x7650 <MotorRegler+0x644>763a: f9 01 movw r30, r18763c: ee 0f add r30, r30763e: ff 1f adc r31, r317640: ef 5c subi r30, 0xCF ; 2077642: f7 4f sbci r31, 0xF7 ; 2477644: 80 81 ld r24, Z7646: 91 81 ldd r25, Z+1 ; 0x017648: 87 34 cpi r24, 0x47 ; 71764a: 91 05 cpc r25, r1764c: 0c f0 brlt .+2 ; 0x7650 <MotorRegler+0x644>764e: 12 e0 ldi r17, 0x02 ; 2if(PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] < 70 && PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] > 70) setting = 3;7650: fa 01 movw r30, r207652: ee 0f add r30, r307654: ff 1f adc r31, r317656: ef 5c subi r30, 0xCF ; 2077658: f7 4f sbci r31, 0xF7 ; 247765a: 80 81 ld r24, Z765c: 91 81 ldd r25, Z+1 ; 0x01765e: 86 34 cpi r24, 0x46 ; 707660: 91 05 cpc r25, r17662: 5c f4 brge .+22 ; 0x767a <MotorRegler+0x66e>7664: f9 01 movw r30, r187666: ee 0f add r30, r307668: ff 1f adc r31, r31766a: ef 5c subi r30, 0xCF ; 207766c: f7 4f sbci r31, 0xF7 ; 247766e: 80 81 ld r24, Z7670: 91 81 ldd r25, Z+1 ; 0x017672: 87 34 cpi r24, 0x47 ; 717674: 91 05 cpc r25, r17676: 0c f0 brlt .+2 ; 0x767a <MotorRegler+0x66e>7678: 13 e0 ldi r17, 0x03 ; 3if(PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] <-70 && PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] > 70) setting = 4;767a: fa 01 movw r30, r20767c: ee 0f add r30, r30767e: ff 1f adc r31, r317680: ef 5c subi r30, 0xCF ; 2077682: f7 4f sbci r31, 0xF7 ; 2477684: 80 81 ld r24, Z7686: 91 81 ldd r25, Z+1 ; 0x017688: 8a 3b cpi r24, 0xBA ; 186768a: 9f 4f sbci r25, 0xFF ; 255768c: 5c f4 brge .+22 ; 0x76a4 <MotorRegler+0x698>768e: f9 01 movw r30, r187690: ee 0f add r30, r307692: ff 1f adc r31, r317694: ef 5c subi r30, 0xCF ; 2077696: f7 4f sbci r31, 0xF7 ; 2477698: 80 81 ld r24, Z769a: 91 81 ldd r25, Z+1 ; 0x01769c: 87 34 cpi r24, 0x47 ; 71769e: 91 05 cpc r25, r176a0: 0c f0 brlt .+2 ; 0x76a4 <MotorRegler+0x698>76a2: 14 e0 ldi r17, 0x04 ; 4if(PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] <-70 && PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] < 70 && PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] > -70) setting = 5;76a4: 44 0f add r20, r2076a6: 55 1f adc r21, r2176a8: fa 01 movw r30, r2076aa: ef 5c subi r30, 0xCF ; 20776ac: f7 4f sbci r31, 0xF7 ; 24776ae: 80 81 ld r24, Z76b0: 91 81 ldd r25, Z+1 ; 0x0176b2: 8a 3b cpi r24, 0xBA ; 18676b4: 9f 4f sbci r25, 0xFF ; 25576b6: a4 f4 brge .+40 ; 0x76e0 <MotorRegler+0x6d4>76b8: f9 01 movw r30, r1876ba: ee 0f add r30, r3076bc: ff 1f adc r31, r3176be: ef 5c subi r30, 0xCF ; 20776c0: f7 4f sbci r31, 0xF7 ; 24776c2: 80 81 ld r24, Z76c4: 91 81 ldd r25, Z+1 ; 0x0176c6: 86 34 cpi r24, 0x46 ; 7076c8: 91 05 cpc r25, r176ca: 54 f4 brge .+20 ; 0x76e0 <MotorRegler+0x6d4>76cc: 22 0f add r18, r1876ce: 33 1f adc r19, r1976d0: f9 01 movw r30, r1876d2: ef 5c subi r30, 0xCF ; 20776d4: f7 4f sbci r31, 0xF7 ; 24776d6: 80 81 ld r24, Z76d8: 91 81 ldd r25, Z+1 ; 0x0176da: 8b 3b cpi r24, 0xBB ; 18776dc: 9f 4f sbci r25, 0xFF ; 25576de: 1c f4 brge .+6 ; 0x76e6 <MotorRegler+0x6da>if(setting) SetActiveParamSet(setting); // aktiven Datensatz merken76e0: 11 23 and r17, r1776e2: 39 f0 breq .+14 ; 0x76f2 <MotorRegler+0x6e6>76e4: 01 c0 rjmp .+2 ; 0x76e8 <MotorRegler+0x6dc>{if(PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] > 70 && PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] < 70 && PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] > -70) setting = 1;if(PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] > 70 && PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] > 70) setting = 2;if(PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] < 70 && PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] > 70) setting = 3;if(PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] <-70 && PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] > 70) setting = 4;if(PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] <-70 && PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] < 70 && PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] > -70) setting = 5;76e6: 15 e0 ldi r17, 0x05 ; 5if(setting) SetActiveParamSet(setting); // aktiven Datensatz merken76e8: 81 2f mov r24, r1776ea: 0e 94 18 26 call 0x4c30 ; 0x4c30 <SetActiveParamSet>76ee: 01 c0 rjmp .+2 ; 0x76f2 <MotorRegler+0x6e6>// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++if(abs(PPM_in[EE_Parameter.Kanalbelegung[K_GIER]]) > 75) // Neutralwerte{if(++delay_neutral > 200) // nicht sofort{unsigned char setting = 0;76f0: 10 e0 ldi r17, 0x00 ; 0if(PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] < 70 && PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] > 70) setting = 3;if(PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] <-70 && PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] > 70) setting = 4;if(PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] <-70 && PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] < 70 && PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] > -70) setting = 5;if(setting) SetActiveParamSet(setting); // aktiven Datensatz merken}if(abs(PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]]) < 30 && PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] < -70)76f2: e0 91 40 05 lds r30, 0x054076f6: f0 e0 ldi r31, 0x00 ; 076f8: ee 0f add r30, r3076fa: ff 1f adc r31, r3176fc: ef 5c subi r30, 0xCF ; 20776fe: f7 4f sbci r31, 0xF7 ; 2477700: 20 81 ld r18, Z7702: 31 81 ldd r19, Z+1 ; 0x017704: 33 23 and r19, r197706: 1c f4 brge .+6 ; 0x770e <MotorRegler+0x702>7708: 31 95 neg r19770a: 21 95 neg r18770c: 31 09 sbc r19, r1770e: 2e 31 cpi r18, 0x1E ; 307710: 31 05 cpc r19, r17712: c4 f4 brge .+48 ; 0x7744 <MotorRegler+0x738>7714: e0 91 3f 05 lds r30, 0x053F7718: f0 e0 ldi r31, 0x00 ; 0771a: ee 0f add r30, r30771c: ff 1f adc r31, r31771e: ef 5c subi r30, 0xCF ; 2077720: f7 4f sbci r31, 0xF7 ; 2477722: 20 81 ld r18, Z7724: 31 81 ldd r19, Z+1 ; 0x017726: 2a 3b cpi r18, 0xBA ; 1867728: 3f 4f sbci r19, 0xFF ; 255772a: 64 f4 brge .+24 ; 0x7744 <MotorRegler+0x738>{WinkelOut.CalcState = 1;772c: 81 e0 ldi r24, 0x01 ; 1772e: 80 93 7d 0a sts 0x0A7D, r24CalibrationDone = 0;7732: 10 92 ef 03 sts 0x03EF, r1beeptime = 1000;7736: 88 ee ldi r24, 0xE8 ; 2327738: 93 e0 ldi r25, 0x03 ; 3773a: 90 93 ce 04 sts 0x04CE, r25773e: 80 93 cd 04 sts 0x04CD, r247742: 8a c0 rjmp .+276 ; 0x7858 <MotorRegler+0x84c>}else{ParamSet_ReadFromEEProm(ActiveParamSet);7744: 80 91 52 01 lds r24, 0x01527748: 0e 94 4e 25 call 0x4a9c ; 0x4a9c <ParamSet_ReadFromEEProm>LipoDetection(0);774c: 80 e0 ldi r24, 0x00 ; 0774e: 0e 94 90 59 call 0xb320 ; 0xb320 <LipoDetection>LIBFC_ReceiverInit(EE_Parameter.Receiver);7752: 80 91 65 05 lds r24, 0x05657756: 0e 94 68 18 call 0x30d0 ; 0x30d0 <LIBFC_ReceiverInit>if((Parameter_GlobalConfig & CFG_HOEHENREGELUNG)) // Höhenregelung aktiviert?775a: 80 91 5c 06 lds r24, 0x065C775e: 80 ff sbrs r24, 07760: 10 c0 rjmp .+32 ; 0x7782 <MotorRegler+0x776>{if((MessLuftdruck > 950) || (MessLuftdruck < 750)) SucheLuftruckOffset();7762: 20 91 10 01 lds r18, 0x01107766: 30 91 11 01 lds r19, 0x0111776a: 27 3b cpi r18, 0xB7 ; 183776c: 33 40 sbci r19, 0x03 ; 3776e: 38 f4 brcc .+14 ; 0x777e <MotorRegler+0x772>7770: 20 91 10 01 lds r18, 0x01107774: 30 91 11 01 lds r19, 0x01117778: 2e 3e cpi r18, 0xEE ; 238777a: 32 40 sbci r19, 0x02 ; 2777c: 10 f4 brcc .+4 ; 0x7782 <MotorRegler+0x776>777e: 0e 94 4b 1b call 0x3696 ; 0x3696 <SucheLuftruckOffset>}if(!setting && PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] < -70 && PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] < 70) CalibrationDone = SetNeutral(3);7782: 11 11 cpse r17, r17784: 41 c0 rjmp .+130 ; 0x7808 <MotorRegler+0x7fc>7786: e0 91 40 05 lds r30, 0x0540778a: f0 e0 ldi r31, 0x00 ; 0778c: ee 0f add r30, r30778e: ff 1f adc r31, r317790: ef 5c subi r30, 0xCF ; 2077792: f7 4f sbci r31, 0xF7 ; 2477794: 80 81 ld r24, Z7796: 91 81 ldd r25, Z+1 ; 0x017798: 8a 3b cpi r24, 0xBA ; 186779a: 9f 4f sbci r25, 0xFF ; 255779c: 94 f4 brge .+36 ; 0x77c2 <MotorRegler+0x7b6>779e: e0 91 3f 05 lds r30, 0x053F77a2: f0 e0 ldi r31, 0x00 ; 077a4: ee 0f add r30, r3077a6: ff 1f adc r31, r3177a8: ef 5c subi r30, 0xCF ; 20777aa: f7 4f sbci r31, 0xF7 ; 24777ac: 80 81 ld r24, Z77ae: 91 81 ldd r25, Z+1 ; 0x0177b0: 86 34 cpi r24, 0x46 ; 7077b2: 91 05 cpc r25, r177b4: 34 f4 brge .+12 ; 0x77c2 <MotorRegler+0x7b6>77b6: 83 e0 ldi r24, 0x03 ; 377b8: 0e 94 53 29 call 0x52a6 ; 0x52a6 <SetNeutral>77bc: 80 93 ef 03 sts 0x03EF, r2477c0: 28 c0 rjmp .+80 ; 0x7812 <MotorRegler+0x806>elseif(!setting && PPM_in[EE_Parameter.Kanalbelegung[K_GIER]] < -75 && abs(PPM_in[EE_Parameter.Kanalbelegung[K_NICK]]) < 70) CalibrationDone = SetNeutral(2); // store ACC values into EEPROM77c2: e0 91 42 05 lds r30, 0x054277c6: f0 e0 ldi r31, 0x00 ; 077c8: ee 0f add r30, r3077ca: ff 1f adc r31, r3177cc: ef 5c subi r30, 0xCF ; 20777ce: f7 4f sbci r31, 0xF7 ; 24777d0: 80 81 ld r24, Z77d2: 91 81 ldd r25, Z+1 ; 0x0177d4: 85 3b cpi r24, 0xB5 ; 18177d6: 9f 4f sbci r25, 0xFF ; 25577d8: bc f4 brge .+46 ; 0x7808 <MotorRegler+0x7fc>77da: e0 91 3f 05 lds r30, 0x053F77de: f0 e0 ldi r31, 0x00 ; 077e0: ee 0f add r30, r3077e2: ff 1f adc r31, r3177e4: ef 5c subi r30, 0xCF ; 20777e6: f7 4f sbci r31, 0xF7 ; 24777e8: 80 81 ld r24, Z77ea: 91 81 ldd r25, Z+1 ; 0x0177ec: 99 23 and r25, r2577ee: 1c f4 brge .+6 ; 0x77f6 <MotorRegler+0x7ea>77f0: 91 95 neg r2577f2: 81 95 neg r2477f4: 91 09 sbc r25, r177f6: 86 34 cpi r24, 0x46 ; 7077f8: 91 05 cpc r25, r177fa: 34 f4 brge .+12 ; 0x7808 <MotorRegler+0x7fc>77fc: 82 e0 ldi r24, 0x02 ; 277fe: 0e 94 53 29 call 0x52a6 ; 0x52a6 <SetNeutral>7802: 80 93 ef 03 sts 0x03EF, r247806: 05 c0 rjmp .+10 ; 0x7812 <MotorRegler+0x806>else CalibrationDone = SetNeutral(1);7808: 81 e0 ldi r24, 0x01 ; 1780a: 0e 94 53 29 call 0x52a6 ; 0x52a6 <SetNeutral>780e: 80 93 ef 03 sts 0x03EF, r24ServoActive = 1;7812: 81 e0 ldi r24, 0x01 ; 17814: 80 93 cb 04 sts 0x04CB, r24DDRD |=0x80; // enable J7 -> Servo signal7818: 57 9a sbi 0x0a, 7 ; 10#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))if(VersionInfo.HardwareError[0]) SpeakHoTT = SPEAK_ERR_SENSOR;781a: 80 91 62 0a lds r24, 0x0A62781e: 88 23 and r24, r247820: 21 f0 breq .+8 ; 0x782a <MotorRegler+0x81e>7822: 87 e0 ldi r24, 0x07 ; 77824: 80 93 57 01 sts 0x0157, r247828: 0b c0 rjmp .+22 ; 0x7840 <MotorRegler+0x834>elseif(!CalibrationDone) SpeakHoTT = SPEAK_ERR_CALIBARTION;782a: 80 91 ef 03 lds r24, 0x03EF782e: 81 11 cpse r24, r17830: 04 c0 rjmp .+8 ; 0x783a <MotorRegler+0x82e>7832: 81 e0 ldi r24, 0x01 ; 17834: 80 93 57 01 sts 0x0157, r247838: 03 c0 rjmp .+6 ; 0x7840 <MotorRegler+0x834>else SpeakHoTT = SPEAK_CALIBRATE;783a: 88 e1 ldi r24, 0x18 ; 24783c: 80 93 57 01 sts 0x0157, r24ShowSettingNameTime = 10; // for HoTT & Jeti7840: 8a e0 ldi r24, 0x0A ; 107842: 80 93 80 04 sts 0x0480, r24#endifPiep(ActiveParamSet,120);7846: 68 e7 ldi r22, 0x78 ; 1207848: 70 e0 ldi r23, 0x00 ; 0784a: 80 91 52 01 lds r24, 0x0152784e: 0e 94 ba 28 call 0x5174 ; 0x5174 <Piep>7852: 02 c0 rjmp .+4 ; 0x7858 <MotorRegler+0x84c>#endifPiep(ActiveParamSet,120);}}*/else delay_neutral = 0;7854: 10 92 9d 03 sts 0x039D, r1}// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++// Gas ist unten// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++if(PPM_in[EE_Parameter.Kanalbelegung[K_GAS]] < -100)7858: e0 91 41 05 lds r30, 0x0541785c: f0 e0 ldi r31, 0x00 ; 0785e: ee 0f add r30, r307860: ff 1f adc r31, r317862: ef 5c subi r30, 0xCF ; 2077864: f7 4f sbci r31, 0xF7 ; 2477866: 80 81 ld r24, Z7868: 91 81 ldd r25, Z+1 ; 0x01786a: 8c 39 cpi r24, 0x9C ; 156786c: 9f 4f sbci r25, 0xFF ; 255786e: 0c f0 brlt .+2 ; 0x7872 <MotorRegler+0x866>7870: 38 c2 rjmp .+1136 ; 0x7ce2 <MotorRegler+0xcd6>{if(PPM_diff[EE_Parameter.MotorSafetySwitch & 127] > 5) move_safety_switch = 100;7872: 40 91 a3 05 lds r20, 0x05A37876: 84 2f mov r24, r207878: 8f 77 andi r24, 0x7F ; 127787a: 90 e0 ldi r25, 0x00 ; 0787c: fc 01 movw r30, r24787e: ee 0f add r30, r307880: ff 1f adc r31, r317882: e9 58 subi r30, 0x89 ; 1377884: f7 4f sbci r31, 0xF7 ; 2477886: 20 81 ld r18, Z7888: 31 81 ldd r19, Z+1 ; 0x01788a: 26 30 cpi r18, 0x06 ; 6788c: 31 05 cpc r19, r1788e: 24 f0 brlt .+8 ; 0x7898 <MotorRegler+0x88c>7890: 84 e6 ldi r24, 0x64 ; 1007892: 80 93 9c 03 sts 0x039C, r247896: 0d c0 rjmp .+26 ; 0x78b2 <MotorRegler+0x8a6>elseif(PPM_diff[EE_Parameter.MotorSafetySwitch & 127] < -5) move_safety_switch = -100;7898: fc 01 movw r30, r24789a: ee 0f add r30, r30789c: ff 1f adc r31, r31789e: e9 58 subi r30, 0x89 ; 13778a0: f7 4f sbci r31, 0xF7 ; 24778a2: 80 81 ld r24, Z78a4: 91 81 ldd r25, Z+1 ; 0x0178a6: 8b 3f cpi r24, 0xFB ; 25178a8: 9f 4f sbci r25, 0xFF ; 25578aa: 1c f4 brge .+6 ; 0x78b2 <MotorRegler+0x8a6>78ac: 8c e9 ldi r24, 0x9C ; 15678ae: 80 93 9c 03 sts 0x039C, r24// Motoren Startenif(!MotorenEin)78b2: 80 91 03 04 lds r24, 0x040378b6: 81 11 cpse r24, r178b8: 66 c1 rjmp .+716 ; 0x7b86 <MotorRegler+0xb7a>{if(((((PPM_in[EE_Parameter.Kanalbelegung[K_GIER]] < -100) && ((!(EE_Parameter.GlobalConfig3 & CFG3_MOTOR_SWITCH_MODE) && PPM_in[EE_Parameter.MotorSafetySwitch] < -75) || EE_Parameter.MotorSafetySwitch == 0)))78ba: e0 91 42 05 lds r30, 0x054278be: f0 e0 ldi r31, 0x00 ; 078c0: ee 0f add r30, r3078c2: ff 1f adc r31, r3178c4: ef 5c subi r30, 0xCF ; 20778c6: f7 4f sbci r31, 0xF7 ; 24778c8: 80 81 ld r24, Z78ca: 91 81 ldd r25, Z+1 ; 0x0178cc: 8c 39 cpi r24, 0x9C ; 15678ce: 9f 4f sbci r25, 0xFF ; 25578d0: 8c f4 brge .+34 ; 0x78f4 <MotorRegler+0x8e8>78d2: 80 91 b9 05 lds r24, 0x05B978d6: 83 fd sbrc r24, 378d8: 0b c0 rjmp .+22 ; 0x78f0 <MotorRegler+0x8e4>78da: e4 2f mov r30, r2078dc: f0 e0 ldi r31, 0x00 ; 078de: ee 0f add r30, r3078e0: ff 1f adc r31, r3178e2: ef 5c subi r30, 0xCF ; 20778e4: f7 4f sbci r31, 0xF7 ; 24778e6: 80 81 ld r24, Z78e8: 91 81 ldd r25, Z+1 ; 0x0178ea: 85 3b cpi r24, 0xB5 ; 18178ec: 9f 4f sbci r25, 0xFF ; 25578ee: bc f0 brlt .+46 ; 0x791e <MotorRegler+0x912>78f0: 44 23 and r20, r2078f2: a9 f0 breq .+42 ; 0x791e <MotorRegler+0x912>|| (((EE_Parameter.GlobalConfig3 & CFG3_MOTOR_SWITCH_MODE) && PPM_in[EE_Parameter.MotorSafetySwitch] > -10 && move_safety_switch == 100)))78f4: 80 91 b9 05 lds r24, 0x05B978f8: 83 ff sbrs r24, 378fa: 42 c1 rjmp .+644 ; 0x7b80 <MotorRegler+0xb74>78fc: e4 2f mov r30, r2078fe: f0 e0 ldi r31, 0x00 ; 07900: ee 0f add r30, r307902: ff 1f adc r31, r317904: ef 5c subi r30, 0xCF ; 2077906: f7 4f sbci r31, 0xF7 ; 2477908: 80 81 ld r24, Z790a: 91 81 ldd r25, Z+1 ; 0x01790c: 87 3f cpi r24, 0xF7 ; 247790e: 9f 4f sbci r25, 0xFF ; 2557910: 0c f4 brge .+2 ; 0x7914 <MotorRegler+0x908>7912: 36 c1 rjmp .+620 ; 0x7b80 <MotorRegler+0xb74>7914: 80 91 9c 03 lds r24, 0x039C7918: 84 36 cpi r24, 0x64 ; 100791a: 09 f0 breq .+2 ; 0x791e <MotorRegler+0x912>791c: 31 c1 rjmp .+610 ; 0x7b80 <MotorRegler+0xb74>&& !(NC_To_FC_Flags & NC_TO_FC_SIMULATION_ACTIVE))791e: 80 91 b7 04 lds r24, 0x04B77922: 84 fd sbrc r24, 47924: 2d c1 rjmp .+602 ; 0x7b80 <MotorRegler+0xb74>{// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++// Einschalten// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++if(CalibrationDone) FC_StatusFlags |= FC_STATUS_START;7926: 80 91 ef 03 lds r24, 0x03EF792a: 88 23 and r24, r24792c: 29 f0 breq .+10 ; 0x7938 <MotorRegler+0x92c>792e: 80 91 cb 03 lds r24, 0x03CB7932: 88 60 ori r24, 0x08 ; 87934: 80 93 cb 03 sts 0x03CB, r24StartLuftdruck = Luftdruck;7938: 80 91 12 01 lds r24, 0x0112793c: 90 91 13 01 lds r25, 0x01137940: a0 91 14 01 lds r26, 0x01147944: b0 91 15 01 lds r27, 0x01157948: 80 93 08 05 sts 0x0508, r24794c: 90 93 09 05 sts 0x0509, r257950: a0 93 0a 05 sts 0x050A, r267954: b0 93 0b 05 sts 0x050B, r27HoehenWert = 0;7958: 10 92 fe 03 sts 0x03FE, r1795c: 10 92 ff 03 sts 0x03FF, r17960: 10 92 00 04 sts 0x0400, r17964: 10 92 01 04 sts 0x0401, r1HoehenWert_Mess = 0;7968: 10 92 46 03 sts 0x0346, r1796c: 10 92 47 03 sts 0x0347, r17970: 10 92 48 03 sts 0x0348, r17974: 10 92 49 03 sts 0x0349, r1GasIsZeroCnt = 600;7978: 88 e5 ldi r24, 0x58 ; 88797a: 92 e0 ldi r25, 0x02 ; 2797c: 90 93 c6 03 sts 0x03C6, r257980: 80 93 c5 03 sts 0x03C5, r24#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))HoehenWertF_Mess = 0;7984: 10 92 42 03 sts 0x0342, r17988: 10 92 43 03 sts 0x0343, r1798c: 10 92 44 03 sts 0x0344, r17990: 10 92 45 03 sts 0x0345, r1#endifSummenHoehe = 0;7994: 10 92 57 03 sts 0x0357, r17998: 10 92 58 03 sts 0x0358, r1799c: 10 92 59 03 sts 0x0359, r179a0: 10 92 5a 03 sts 0x035A, r1if((PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] > -100 || abs(PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]]) < 100) && EE_Parameter.MotorSafetySwitch == 0) delay_einschalten = 0;79a4: e0 91 3f 05 lds r30, 0x053F79a8: f0 e0 ldi r31, 0x00 ; 079aa: ee 0f add r30, r3079ac: ff 1f adc r31, r3179ae: ef 5c subi r30, 0xCF ; 20779b0: f7 4f sbci r31, 0xF7 ; 24779b2: 80 81 ld r24, Z79b4: 91 81 ldd r25, Z+1 ; 0x0179b6: 8d 39 cpi r24, 0x9D ; 15779b8: 9f 4f sbci r25, 0xFF ; 25579ba: 8c f4 brge .+34 ; 0x79de <MotorRegler+0x9d2>79bc: e0 91 40 05 lds r30, 0x054079c0: f0 e0 ldi r31, 0x00 ; 079c2: ee 0f add r30, r3079c4: ff 1f adc r31, r3179c6: ef 5c subi r30, 0xCF ; 20779c8: f7 4f sbci r31, 0xF7 ; 24779ca: 80 81 ld r24, Z79cc: 91 81 ldd r25, Z+1 ; 0x0179ce: 99 23 and r25, r2579d0: 1c f4 brge .+6 ; 0x79d8 <MotorRegler+0x9cc>79d2: 91 95 neg r2579d4: 81 95 neg r2479d6: 91 09 sbc r25, r179d8: 84 36 cpi r24, 0x64 ; 10079da: 91 05 cpc r25, r179dc: 34 f4 brge .+12 ; 0x79ea <MotorRegler+0x9de>79de: 41 11 cpse r20, r179e0: 04 c0 rjmp .+8 ; 0x79ea <MotorRegler+0x9de>if(++delay_einschalten > 253)79e2: 81 e0 ldi r24, 0x01 ; 179e4: 80 93 9b 03 sts 0x039B, r2479e8: 5e c1 rjmp .+700 ; 0x7ca6 <MotorRegler+0xc9a>79ea: 80 91 9b 03 lds r24, 0x039B79ee: 8f 5f subi r24, 0xFF ; 25579f0: 80 93 9b 03 sts 0x039B, r2479f4: 8e 3f cpi r24, 0xFE ; 25479f6: 08 f4 brcc .+2 ; 0x79fa <MotorRegler+0x9ee>79f8: 56 c1 rjmp .+684 ; 0x7ca6 <MotorRegler+0xc9a>{if(FC_StatusFlags3 & FC_STATUS3_BOAT) { if((abs(MesswertGier) > 32*2 || abs(MesswertNick) > 20*3) || abs(MesswertRoll) > 20*3) CalibrationDone = 0; } // dann ist der Gyro defekt, schlecht kalibriert oder der MK dreht sich79fa: 80 91 c9 03 lds r24, 0x03C979fe: 81 ff sbrs r24, 17a00: 25 c0 rjmp .+74 ; 0x7a4c <MotorRegler+0xa40>7a02: 80 91 67 06 lds r24, 0x06677a06: 90 91 68 06 lds r25, 0x06687a0a: 99 23 and r25, r257a0c: 1c f4 brge .+6 ; 0x7a14 <MotorRegler+0xa08>7a0e: 91 95 neg r257a10: 81 95 neg r247a12: 91 09 sbc r25, r17a14: 81 34 cpi r24, 0x41 ; 657a16: 91 05 cpc r25, r17a18: b4 f4 brge .+44 ; 0x7a46 <MotorRegler+0xa3a>7a1a: 80 91 27 06 lds r24, 0x06277a1e: 90 91 28 06 lds r25, 0x06287a22: 99 23 and r25, r257a24: 1c f4 brge .+6 ; 0x7a2c <MotorRegler+0xa20>7a26: 91 95 neg r257a28: 81 95 neg r247a2a: 91 09 sbc r25, r17a2c: cd 97 sbiw r24, 0x3d ; 617a2e: 5c f4 brge .+22 ; 0x7a46 <MotorRegler+0xa3a>7a30: 80 91 1c 06 lds r24, 0x061C7a34: 90 91 1d 06 lds r25, 0x061D7a38: 99 23 and r25, r257a3a: 1c f4 brge .+6 ; 0x7a42 <MotorRegler+0xa36>7a3c: 91 95 neg r257a3e: 81 95 neg r247a40: 91 09 sbc r25, r17a42: cd 97 sbiw r24, 0x3d ; 617a44: 34 f1 brlt .+76 ; 0x7a92 <MotorRegler+0xa86>7a46: 10 92 ef 03 sts 0x03EF, r17a4a: 23 c0 rjmp .+70 ; 0x7a92 <MotorRegler+0xa86>elseif((abs(MesswertGier) > 32 || abs(MesswertNick) > 20) || abs(MesswertRoll) > 20) CalibrationDone = 0; // dann ist der Gyro defekt, schlecht kalibriert oder der MK dreht sich7a4c: 80 91 67 06 lds r24, 0x06677a50: 90 91 68 06 lds r25, 0x06687a54: 99 23 and r25, r257a56: 1c f4 brge .+6 ; 0x7a5e <MotorRegler+0xa52>7a58: 91 95 neg r257a5a: 81 95 neg r247a5c: 91 09 sbc r25, r17a5e: 81 97 sbiw r24, 0x21 ; 337a60: b4 f4 brge .+44 ; 0x7a8e <MotorRegler+0xa82>7a62: 80 91 27 06 lds r24, 0x06277a66: 90 91 28 06 lds r25, 0x06287a6a: 99 23 and r25, r257a6c: 1c f4 brge .+6 ; 0x7a74 <MotorRegler+0xa68>7a6e: 91 95 neg r257a70: 81 95 neg r247a72: 91 09 sbc r25, r17a74: 45 97 sbiw r24, 0x15 ; 217a76: 5c f4 brge .+22 ; 0x7a8e <MotorRegler+0xa82>7a78: 80 91 1c 06 lds r24, 0x061C7a7c: 90 91 1d 06 lds r25, 0x061D7a80: 99 23 and r25, r257a82: 1c f4 brge .+6 ; 0x7a8a <MotorRegler+0xa7e>7a84: 91 95 neg r257a86: 81 95 neg r247a88: 91 09 sbc r25, r17a8a: 45 97 sbiw r24, 0x15 ; 217a8c: 14 f0 brlt .+4 ; 0x7a92 <MotorRegler+0xa86>7a8e: 10 92 ef 03 sts 0x03EF, r1delay_einschalten = 0;7a92: 10 92 9b 03 sts 0x039B, r1if(!VersionInfo.HardwareError[0] && CalibrationDone && !NC_ErrorCode)7a96: 80 91 62 0a lds r24, 0x0A627a9a: 81 11 cpse r24, r17a9c: 63 c0 rjmp .+198 ; 0x7b64 <MotorRegler+0xb58>7a9e: 80 91 ef 03 lds r24, 0x03EF7aa2: 88 23 and r24, r247aa4: 09 f4 brne .+2 ; 0x7aa8 <MotorRegler+0xa9c>7aa6: 5e c0 rjmp .+188 ; 0x7b64 <MotorRegler+0xb58>7aa8: 80 91 bb 04 lds r24, 0x04BB7aac: 81 11 cpse r24, r17aae: 5a c0 rjmp .+180 ; 0x7b64 <MotorRegler+0xb58>{modell_fliegt = 1;7ab0: 81 e0 ldi r24, 0x01 ; 17ab2: 90 e0 ldi r25, 0x00 ; 07ab4: 90 93 cd 03 sts 0x03CD, r257ab8: 80 93 cc 03 sts 0x03CC, r24MotorenEin = 1;7abc: 80 93 03 04 sts 0x0403, r24sollGier = 0;7ac0: 10 92 9e 03 sts 0x039E, r17ac4: 10 92 9f 03 sts 0x039F, r17ac8: 10 92 a0 03 sts 0x03A0, r17acc: 10 92 a1 03 sts 0x03A1, r1Mess_Integral_Gier = 0;7ad0: 10 92 2e 04 sts 0x042E, r17ad4: 10 92 2f 04 sts 0x042F, r17ad8: 10 92 30 04 sts 0x0430, r17adc: 10 92 31 04 sts 0x0431, r1Mess_Integral_Gier2 = 0;7ae0: 10 92 2a 04 sts 0x042A, r17ae4: 10 92 2b 04 sts 0x042B, r17ae8: 10 92 2c 04 sts 0x042C, r17aec: 10 92 2d 04 sts 0x042D, r1Mess_IntegralNick = EE_Parameter.GyroAccFaktor * (long)Mittelwert_AccNick;7af0: c0 90 5a 05 lds r12, 0x055A7af4: d1 2c mov r13, r17af6: e1 2c mov r14, r17af8: f1 2c mov r15, r17afa: a0 91 60 06 lds r26, 0x06607afe: b0 91 61 06 lds r27, 0x06617b02: a7 01 movw r20, r147b04: 96 01 movw r18, r127b06: 0e 94 d2 b1 call 0x163a4 ; 0x163a4 <__mulshisi3>7b0a: 60 93 36 04 sts 0x0436, r227b0e: 70 93 37 04 sts 0x0437, r237b12: 80 93 38 04 sts 0x0438, r247b16: 90 93 39 04 sts 0x0439, r25Mess_IntegralRoll = EE_Parameter.GyroAccFaktor * (long)Mittelwert_AccRoll;7b1a: a0 91 72 06 lds r26, 0x06727b1e: b0 91 73 06 lds r27, 0x06737b22: 0e 94 d2 b1 call 0x163a4 ; 0x163a4 <__mulshisi3>7b26: 60 93 32 04 sts 0x0432, r227b2a: 70 93 33 04 sts 0x0433, r237b2e: 80 93 34 04 sts 0x0434, r247b32: 90 93 35 04 sts 0x0435, r25SummeNick = 0;7b36: 10 92 26 04 sts 0x0426, r17b3a: 10 92 27 04 sts 0x0427, r17b3e: 10 92 28 04 sts 0x0428, r17b42: 10 92 29 04 sts 0x0429, r1SummeRoll = 0;7b46: 10 92 22 04 sts 0x0422, r17b4a: 10 92 23 04 sts 0x0423, r17b4e: 10 92 24 04 sts 0x0424, r17b52: 10 92 25 04 sts 0x0425, r1// ControlHeading = (((int) EE_Parameter.OrientationAngle * 15 + KompassValue) % 360) / 2;NeueKompassRichtungMerken = 100; // 2 sekunden7b56: 84 e6 ldi r24, 0x64 ; 1007b58: 80 93 ee 03 sts 0x03EE, r24#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))SpeakHoTT = SPEAK_STARTING;7b5c: 84 e3 ldi r24, 0x34 ; 527b5e: 80 93 57 01 sts 0x0157, r247b62: a1 c0 rjmp .+322 ; 0x7ca6 <MotorRegler+0xc9a>#endif}else{beeptime = 1500; // indicate missing calibration7b64: 8c ed ldi r24, 0xDC ; 2207b66: 95 e0 ldi r25, 0x05 ; 57b68: 90 93 ce 04 sts 0x04CE, r257b6c: 80 93 cd 04 sts 0x04CD, r24#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))if(!CalibrationDone) SpeakHoTT = SPEAK_ERR_CALIBARTION;7b70: 80 91 ef 03 lds r24, 0x03EF7b74: 81 11 cpse r24, r17b76: 97 c0 rjmp .+302 ; 0x7ca6 <MotorRegler+0xc9a>7b78: 81 e0 ldi r24, 0x01 ; 17b7a: 80 93 57 01 sts 0x0157, r247b7e: 93 c0 rjmp .+294 ; 0x7ca6 <MotorRegler+0xc9a>#endif}}}else delay_einschalten = 0;7b80: 10 92 9b 03 sts 0x039B, r17b84: 90 c0 rjmp .+288 ; 0x7ca6 <MotorRegler+0xc9a>// Auschalten// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++else // only if motors are running{// if((PPM_in[EE_Parameter.Kanalbelegung[K_GIER]] > 75) && (PPM_in[EE_Parameter.MotorSafetySwitch] < -75 || EE_Parameter.MotorSafetySwitch == 0))if((((PPM_in[EE_Parameter.Kanalbelegung[K_GIER]] > 100) && ((!(EE_Parameter.GlobalConfig3 & CFG3_MOTOR_SWITCH_MODE) && PPM_in[EE_Parameter.MotorSafetySwitch] < -75) || EE_Parameter.MotorSafetySwitch == 0)))7b86: e0 91 42 05 lds r30, 0x05427b8a: f0 e0 ldi r31, 0x00 ; 07b8c: ee 0f add r30, r307b8e: ff 1f adc r31, r317b90: ef 5c subi r30, 0xCF ; 2077b92: f7 4f sbci r31, 0xF7 ; 2477b94: 80 81 ld r24, Z7b96: 91 81 ldd r25, Z+1 ; 0x017b98: 85 36 cpi r24, 0x65 ; 1017b9a: 91 05 cpc r25, r17b9c: 8c f0 brlt .+34 ; 0x7bc0 <MotorRegler+0xbb4>7b9e: 80 91 b9 05 lds r24, 0x05B97ba2: 83 fd sbrc r24, 37ba4: 0b c0 rjmp .+22 ; 0x7bbc <MotorRegler+0xbb0>7ba6: e4 2f mov r30, r207ba8: f0 e0 ldi r31, 0x00 ; 07baa: ee 0f add r30, r307bac: ff 1f adc r31, r317bae: ef 5c subi r30, 0xCF ; 2077bb0: f7 4f sbci r31, 0xF7 ; 2477bb2: 80 81 ld r24, Z7bb4: 91 81 ldd r25, Z+1 ; 0x017bb6: 85 3b cpi r24, 0xB5 ; 1817bb8: 9f 4f sbci r25, 0xFF ; 2557bba: bc f0 brlt .+46 ; 0x7bea <MotorRegler+0xbde>7bbc: 44 23 and r20, r207bbe: a9 f0 breq .+42 ; 0x7bea <MotorRegler+0xbde>|| (((EE_Parameter.GlobalConfig3 & CFG3_MOTOR_SWITCH_MODE) && PPM_in[EE_Parameter.MotorSafetySwitch] < -50 && move_safety_switch == -100)))7bc0: 80 91 b9 05 lds r24, 0x05B97bc4: 83 ff sbrs r24, 37bc6: 6d c0 rjmp .+218 ; 0x7ca2 <MotorRegler+0xc96>7bc8: e4 2f mov r30, r207bca: f0 e0 ldi r31, 0x00 ; 07bcc: ee 0f add r30, r307bce: ff 1f adc r31, r317bd0: ef 5c subi r30, 0xCF ; 2077bd2: f7 4f sbci r31, 0xF7 ; 2477bd4: 80 81 ld r24, Z7bd6: 91 81 ldd r25, Z+1 ; 0x017bd8: 8e 3c cpi r24, 0xCE ; 2067bda: 9f 4f sbci r25, 0xFF ; 2557bdc: 0c f0 brlt .+2 ; 0x7be0 <MotorRegler+0xbd4>7bde: 61 c0 rjmp .+194 ; 0x7ca2 <MotorRegler+0xc96>7be0: 80 91 9c 03 lds r24, 0x039C7be4: 8c 39 cpi r24, 0x9C ; 1567be6: 09 f0 breq .+2 ; 0x7bea <MotorRegler+0xbde>7be8: 5c c0 rjmp .+184 ; 0x7ca2 <MotorRegler+0xc96>{if((PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] > -100 || abs(PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]]) < 100) && EE_Parameter.MotorSafetySwitch == 0)7bea: e0 91 3f 05 lds r30, 0x053F7bee: f0 e0 ldi r31, 0x00 ; 07bf0: ee 0f add r30, r307bf2: ff 1f adc r31, r317bf4: ef 5c subi r30, 0xCF ; 2077bf6: f7 4f sbci r31, 0xF7 ; 2477bf8: 80 81 ld r24, Z7bfa: 91 81 ldd r25, Z+1 ; 0x017bfc: 8d 39 cpi r24, 0x9D ; 1577bfe: 9f 4f sbci r25, 0xFF ; 2557c00: 8c f4 brge .+34 ; 0x7c24 <MotorRegler+0xc18>7c02: e0 91 40 05 lds r30, 0x05407c06: f0 e0 ldi r31, 0x00 ; 07c08: ee 0f add r30, r307c0a: ff 1f adc r31, r317c0c: ef 5c subi r30, 0xCF ; 2077c0e: f7 4f sbci r31, 0xF7 ; 2477c10: 80 81 ld r24, Z7c12: 91 81 ldd r25, Z+1 ; 0x017c14: 99 23 and r25, r257c16: 1c f4 brge .+6 ; 0x7c1e <MotorRegler+0xc12>7c18: 91 95 neg r257c1a: 81 95 neg r247c1c: 91 09 sbc r25, r17c1e: 84 36 cpi r24, 0x64 ; 1007c20: 91 05 cpc r25, r17c22: 34 f4 brge .+12 ; 0x7c30 <MotorRegler+0xc24>7c24: 41 11 cpse r20, r17c26: 04 c0 rjmp .+8 ; 0x7c30 <MotorRegler+0xc24>SummeNick = 0;SummeRoll = 0;StickNick = 0;StickRoll = 0;}if(++delay_ausschalten > 250) // nicht sofort7c28: 81 e0 ldi r24, 0x01 ; 17c2a: 80 93 9a 03 sts 0x039A, r247c2e: 3b c0 rjmp .+118 ; 0x7ca6 <MotorRegler+0xc9a>{delay_ausschalten = 0;}else{SummeNick = 0;7c30: 10 92 26 04 sts 0x0426, r17c34: 10 92 27 04 sts 0x0427, r17c38: 10 92 28 04 sts 0x0428, r17c3c: 10 92 29 04 sts 0x0429, r1SummeRoll = 0;7c40: 10 92 22 04 sts 0x0422, r17c44: 10 92 23 04 sts 0x0423, r17c48: 10 92 24 04 sts 0x0424, r17c4c: 10 92 25 04 sts 0x0425, r1StickNick = 0;7c50: 10 92 15 04 sts 0x0415, r17c54: 10 92 14 04 sts 0x0414, r1StickRoll = 0;7c58: 10 92 13 04 sts 0x0413, r17c5c: 10 92 12 04 sts 0x0412, r1}if(++delay_ausschalten > 250) // nicht sofort7c60: 80 91 9a 03 lds r24, 0x039A7c64: 8f 5f subi r24, 0xFF ; 2557c66: 80 93 9a 03 sts 0x039A, r247c6a: 8b 3f cpi r24, 0xFB ; 2517c6c: 88 f0 brcs .+34 ; 0x7c90 <MotorRegler+0xc84>{MotorenEin = 0;7c6e: 10 92 03 04 sts 0x0403, r1delay_ausschalten = 0;7c72: 10 92 9a 03 sts 0x039A, r1modell_fliegt = 0;7c76: 10 92 cd 03 sts 0x03CD, r17c7a: 10 92 cc 03 sts 0x03CC, r1FC_StatusFlags2 &= ~(FC_STATUS2_WAIT_FOR_TAKEOFF | FC_STATUS2_AUTO_STARTING | FC_STATUS2_AUTO_LANDING);7c7e: 80 91 ca 03 lds r24, 0x03CA7c82: 8f 71 andi r24, 0x1F ; 317c84: 80 93 ca 03 sts 0x03CA, r24#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))SpeakHoTT = SPEAK_MK_OFF;7c88: 86 e2 ldi r24, 0x26 ; 387c8a: 80 93 57 01 sts 0x0157, r247c8e: 0b c0 rjmp .+22 ; 0x7ca6 <MotorRegler+0xc9a>#endif}elseif(delay_ausschalten == 100) beeptime = 3500;7c90: 84 36 cpi r24, 0x64 ; 1007c92: 49 f4 brne .+18 ; 0x7ca6 <MotorRegler+0xc9a>7c94: 8c ea ldi r24, 0xAC ; 1727c96: 9d e0 ldi r25, 0x0D ; 137c98: 90 93 ce 04 sts 0x04CE, r257c9c: 80 93 cd 04 sts 0x04CD, r247ca0: 02 c0 rjmp .+4 ; 0x7ca6 <MotorRegler+0xc9a>}else delay_ausschalten = 0;7ca2: 10 92 9a 03 sts 0x039A, r1}if(GasIsZeroCnt < 1000)7ca6: 80 91 c5 03 lds r24, 0x03C57caa: 90 91 c6 03 lds r25, 0x03C67cae: 88 3e cpi r24, 0xE8 ; 2327cb0: 13 e0 ldi r17, 0x03 ; 37cb2: 91 07 cpc r25, r177cb4: 08 f0 brcs .+2 ; 0x7cb8 <MotorRegler+0xcac>7cb6: 46 c0 rjmp .+140 ; 0x7d44 <MotorRegler+0xd38>{if(VarioMeter > -150) GasIsZeroCnt++;7cb8: 20 91 54 03 lds r18, 0x03547cbc: 30 91 55 03 lds r19, 0x03557cc0: 2b 36 cpi r18, 0x6B ; 1077cc2: 3f 4f sbci r19, 0xFF ; 2557cc4: 34 f0 brlt .+12 ; 0x7cd2 <MotorRegler+0xcc6>7cc6: 01 96 adiw r24, 0x01 ; 17cc8: 90 93 c6 03 sts 0x03C6, r257ccc: 80 93 c5 03 sts 0x03C5, r247cd0: 39 c0 rjmp .+114 ; 0x7d44 <MotorRegler+0xd38>else if(GasIsZeroCnt) GasIsZeroCnt--;7cd2: 00 97 sbiw r24, 0x00 ; 07cd4: b9 f1 breq .+110 ; 0x7d44 <MotorRegler+0xd38>7cd6: 01 97 sbiw r24, 0x01 ; 17cd8: 90 93 c6 03 sts 0x03C6, r257cdc: 80 93 c5 03 sts 0x03C5, r247ce0: 31 c0 rjmp .+98 ; 0x7d44 <MotorRegler+0xd38>}}else // gas not at minimum{move_safety_switch = 0;7ce2: 10 92 9c 03 sts 0x039C, r1GasIsZeroCnt = 0;7ce6: 10 92 c6 03 sts 0x03C6, r17cea: 10 92 c5 03 sts 0x03C5, r17cee: 2a c0 rjmp .+84 ; 0x7d44 <MotorRegler+0xd38>}}else // Empfang zwischen 100 und 140 -> schlecht{if(GasIsZeroCnt >= 750) // gas-stick was down for 1.5 seconds before RC-Lost7cf0: 2e 3e cpi r18, 0xEE ; 2387cf2: 32 40 sbci r19, 0x02 ; 27cf4: 38 f1 brcs .+78 ; 0x7d44 <MotorRegler+0xd38>{if((GPSInfo.HomeDistance < 40 * 10) && (HoehenWert < 15 * 100)) // and we are at the starting point -> maybe landed?7cf6: 80 91 db 08 lds r24, 0x08DB7cfa: 90 91 dc 08 lds r25, 0x08DC7cfe: 80 39 cpi r24, 0x90 ; 1447d00: 91 40 sbci r25, 0x01 ; 17d02: 00 f5 brcc .+64 ; 0x7d44 <MotorRegler+0xd38>7d04: 80 91 fe 03 lds r24, 0x03FE7d08: 90 91 ff 03 lds r25, 0x03FF7d0c: a0 91 00 04 lds r26, 0x04007d10: b0 91 01 04 lds r27, 0x04017d14: 8c 3d cpi r24, 0xDC ; 2207d16: 95 40 sbci r25, 0x05 ; 57d18: a1 05 cpc r26, r17d1a: b1 05 cpc r27, r17d1c: 9c f4 brge .+38 ; 0x7d44 <MotorRegler+0xd38>{GasIsZeroCnt = 30000;7d1e: 80 e3 ldi r24, 0x30 ; 487d20: 95 e7 ldi r25, 0x75 ; 1177d22: 90 93 c6 03 sts 0x03C6, r257d26: 80 93 c5 03 sts 0x03C5, r24if(modell_fliegt > 1001) modell_fliegt = 1001;7d2a: 80 91 cc 03 lds r24, 0x03CC7d2e: 90 91 cd 03 lds r25, 0x03CD7d32: 8a 3e cpi r24, 0xEA ; 2347d34: 93 40 sbci r25, 0x03 ; 37d36: 30 f0 brcs .+12 ; 0x7d44 <MotorRegler+0xd38>7d38: 89 ee ldi r24, 0xE9 ; 2337d3a: 93 e0 ldi r25, 0x03 ; 37d3c: 90 93 cd 03 sts 0x03CD, r257d40: 80 93 cc 03 sts 0x03CC, r24}// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++// neue Werte von der Funke// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++if(!NewPpmData-- || (FC_StatusFlags & FC_STATUS_EMERGENCY_LANDING))7d44: 80 91 93 02 lds r24, 0x02937d48: 9f ef ldi r25, 0xFF ; 2557d4a: 98 0f add r25, r247d4c: 90 93 93 02 sts 0x0293, r257d50: 88 23 and r24, r247d52: 21 f0 breq .+8 ; 0x7d5c <MotorRegler+0xd50>7d54: 80 91 cb 03 lds r24, 0x03CB7d58: 84 ff sbrs r24, 47d5a: d2 c3 rjmp .+1956 ; 0x8500 <MotorRegler+0x14f4>{static int stick_nick,stick_roll;unsigned char stick_p;ParameterZuordnung();7d5c: 0e 94 27 34 call 0x684e ; 0x684e <ParameterZuordnung>stick_p = EE_Parameter.Stick_P;stick_nick = (stick_nick * 3 + PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] * stick_p) / 4;7d60: 80 91 3f 05 lds r24, 0x053F7d64: 90 e0 ldi r25, 0x00 ; 07d66: 88 0f add r24, r247d68: 99 1f adc r25, r257d6a: fc 01 movw r30, r247d6c: ef 5c subi r30, 0xCF ; 2077d6e: f7 4f sbci r31, 0xF7 ; 2477d70: a0 81 ld r26, Z7d72: b1 81 ldd r27, Z+1 ; 0x017d74: 60 91 55 05 lds r22, 0x05557d78: 70 e0 ldi r23, 0x00 ; 0stick_nick += PPM_diff[EE_Parameter.Kanalbelegung[K_NICK]] * EE_Parameter.Stick_D;7d7a: fc 01 movw r30, r247d7c: e9 58 subi r30, 0x89 ; 1377d7e: f7 4f sbci r31, 0xF7 ; 2477d80: 01 90 ld r0, Z+7d82: f0 81 ld r31, Z7d84: e0 2d mov r30, r07d86: 40 91 56 05 lds r20, 0x05567d8a: 50 e0 ldi r21, 0x00 ; 0{static int stick_nick,stick_roll;unsigned char stick_p;ParameterZuordnung();stick_p = EE_Parameter.Stick_P;stick_nick = (stick_nick * 3 + PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] * stick_p) / 4;7d8c: 80 91 98 03 lds r24, 0x03987d90: 90 91 99 03 lds r25, 0x03997d94: 9c 01 movw r18, r247d96: 22 0f add r18, r187d98: 33 1f adc r19, r197d9a: 82 0f add r24, r187d9c: 93 1f adc r25, r197d9e: a6 9f mul r26, r227da0: 90 01 movw r18, r07da2: a7 9f mul r26, r237da4: 30 0d add r19, r07da6: b6 9f mul r27, r227da8: 30 0d add r19, r07daa: 11 24 eor r1, r17dac: 82 0f add r24, r187dae: 93 1f adc r25, r197db0: 99 23 and r25, r257db2: 0c f4 brge .+2 ; 0x7db6 <MotorRegler+0xdaa>7db4: 03 96 adiw r24, 0x03 ; 37db6: 95 95 asr r257db8: 87 95 ror r247dba: 95 95 asr r257dbc: 87 95 ror r24stick_nick += PPM_diff[EE_Parameter.Kanalbelegung[K_NICK]] * EE_Parameter.Stick_D;7dbe: e4 9f mul r30, r207dc0: 90 01 movw r18, r07dc2: e5 9f mul r30, r217dc4: 30 0d add r19, r07dc6: f4 9f mul r31, r207dc8: 30 0d add r19, r07dca: 11 24 eor r1, r17dcc: 82 0f add r24, r187dce: 93 1f adc r25, r197dd0: 90 93 99 03 sts 0x0399, r257dd4: 80 93 98 03 sts 0x0398, r24stick_roll = (stick_roll * 3 + PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] * stick_p) / 4;7dd8: 20 91 40 05 lds r18, 0x05407ddc: 30 e0 ldi r19, 0x00 ; 07dde: 22 0f add r18, r187de0: 33 1f adc r19, r197de2: f9 01 movw r30, r187de4: ef 5c subi r30, 0xCF ; 2077de6: f7 4f sbci r31, 0xF7 ; 2477de8: 00 81 ld r16, Z7dea: 11 81 ldd r17, Z+1 ; 0x01stick_roll += PPM_diff[EE_Parameter.Kanalbelegung[K_ROLL]] * EE_Parameter.Stick_D;7dec: f9 01 movw r30, r187dee: e9 58 subi r30, 0x89 ; 1377df0: f7 4f sbci r31, 0xF7 ; 2477df2: 01 90 ld r0, Z+7df4: f0 81 ld r31, Z7df6: e0 2d mov r30, r0unsigned char stick_p;ParameterZuordnung();stick_p = EE_Parameter.Stick_P;stick_nick = (stick_nick * 3 + PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] * stick_p) / 4;stick_nick += PPM_diff[EE_Parameter.Kanalbelegung[K_NICK]] * EE_Parameter.Stick_D;stick_roll = (stick_roll * 3 + PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] * stick_p) / 4;7df8: 20 91 96 03 lds r18, 0x03967dfc: 30 91 97 03 lds r19, 0x03977e00: d9 01 movw r26, r187e02: aa 0f add r26, r267e04: bb 1f adc r27, r277e06: 2a 0f add r18, r267e08: 3b 1f adc r19, r277e0a: 60 9f mul r22, r167e0c: d0 01 movw r26, r07e0e: 61 9f mul r22, r177e10: b0 0d add r27, r07e12: 70 9f mul r23, r167e14: b0 0d add r27, r07e16: 11 24 eor r1, r17e18: 2a 0f add r18, r267e1a: 3b 1f adc r19, r277e1c: 33 23 and r19, r197e1e: 14 f4 brge .+4 ; 0x7e24 <MotorRegler+0xe18>7e20: 2d 5f subi r18, 0xFD ; 2537e22: 3f 4f sbci r19, 0xFF ; 2557e24: 35 95 asr r197e26: 27 95 ror r187e28: 35 95 asr r197e2a: 27 95 ror r18stick_roll += PPM_diff[EE_Parameter.Kanalbelegung[K_ROLL]] * EE_Parameter.Stick_D;7e2c: 4e 9f mul r20, r307e2e: b0 01 movw r22, r07e30: 4f 9f mul r20, r317e32: 70 0d add r23, r07e34: 5e 9f mul r21, r307e36: 70 0d add r23, r07e38: 11 24 eor r1, r17e3a: 26 0f add r18, r227e3c: 37 1f adc r19, r237e3e: 30 93 97 03 sts 0x0397, r197e42: 20 93 96 03 sts 0x0396, r18// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++// CareFree und freie Wahl der vorderen Richtung// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++if(CareFree)7e46: 40 91 d8 03 lds r20, 0x03D87e4a: 44 23 and r20, r207e4c: 09 f4 brne .+2 ; 0x7e50 <MotorRegler+0xe44>7e4e: 59 c0 rjmp .+178 ; 0x7f02 <MotorRegler+0xef6>{signed int nick, roll;nick = stick_nick / 4;7e50: ac 01 movw r20, r247e52: 99 23 and r25, r257e54: 14 f4 brge .+4 ; 0x7e5a <MotorRegler+0xe4e>7e56: 4d 5f subi r20, 0xFD ; 2537e58: 5f 4f sbci r21, 0xFF ; 2557e5a: 55 95 asr r217e5c: 47 95 ror r207e5e: 55 95 asr r217e60: 47 95 ror r20roll = stick_roll / 4;7e62: c9 01 movw r24, r187e64: 99 23 and r25, r257e66: 0c f4 brge .+2 ; 0x7e6a <MotorRegler+0xe5e>7e68: 03 96 adiw r24, 0x03 ; 37e6a: fc 01 movw r30, r247e6c: f5 95 asr r317e6e: e7 95 ror r307e70: f5 95 asr r317e72: e7 95 ror r30StickNick = ((FromNC_Rotate_C * nick) + (FromNC_Rotate_S * roll)) / (32 / 4);7e74: 60 91 a5 02 lds r22, 0x02A57e78: 77 27 eor r23, r237e7a: 67 fd sbrc r22, 77e7c: 70 95 com r237e7e: 20 91 be 04 lds r18, 0x04BE7e82: 33 27 eor r19, r197e84: 27 fd sbrc r18, 77e86: 30 95 com r197e88: 64 9f mul r22, r207e8a: d0 01 movw r26, r07e8c: 65 9f mul r22, r217e8e: b0 0d add r27, r07e90: 74 9f mul r23, r207e92: b0 0d add r27, r07e94: 11 24 eor r1, r17e96: 2e 9f mul r18, r307e98: c0 01 movw r24, r07e9a: 2f 9f mul r18, r317e9c: 90 0d add r25, r07e9e: 3e 9f mul r19, r307ea0: 90 0d add r25, r07ea2: 11 24 eor r1, r17ea4: 8a 0f add r24, r267ea6: 9b 1f adc r25, r277ea8: 99 23 and r25, r257eaa: 0c f4 brge .+2 ; 0x7eae <MotorRegler+0xea2>7eac: 07 96 adiw r24, 0x07 ; 77eae: 95 95 asr r257eb0: 87 95 ror r247eb2: 95 95 asr r257eb4: 87 95 ror r247eb6: 95 95 asr r257eb8: 87 95 ror r247eba: 90 93 15 04 sts 0x0415, r257ebe: 80 93 14 04 sts 0x0414, r24StickRoll = ((FromNC_Rotate_C * roll) - (FromNC_Rotate_S * nick)) / (32 / 4);7ec2: e6 9f mul r30, r227ec4: d0 01 movw r26, r07ec6: e7 9f mul r30, r237ec8: b0 0d add r27, r07eca: f6 9f mul r31, r227ecc: b0 0d add r27, r07ece: 11 24 eor r1, r17ed0: 42 9f mul r20, r187ed2: c0 01 movw r24, r07ed4: 43 9f mul r20, r197ed6: 90 0d add r25, r07ed8: 52 9f mul r21, r187eda: 90 0d add r25, r07edc: 11 24 eor r1, r17ede: 9d 01 movw r18, r267ee0: 28 1b sub r18, r247ee2: 39 0b sbc r19, r257ee4: c9 01 movw r24, r187ee6: 99 23 and r25, r257ee8: 0c f4 brge .+2 ; 0x7eec <MotorRegler+0xee0>7eea: 07 96 adiw r24, 0x07 ; 77eec: 95 95 asr r257eee: 87 95 ror r247ef0: 95 95 asr r257ef2: 87 95 ror r247ef4: 95 95 asr r257ef6: 87 95 ror r247ef8: 90 93 13 04 sts 0x0413, r257efc: 80 93 12 04 sts 0x0412, r247f00: 50 c0 rjmp .+160 ; 0x7fa2 <MotorRegler+0xf96>}else{FromNC_Rotate_C = sintab[EE_Parameter.OrientationAngle + 6];7f02: a0 91 a1 05 lds r26, 0x05A17f06: b0 e0 ldi r27, 0x00 ; 07f08: a5 53 subi r26, 0x35 ; 537f0a: bd 4f sbci r27, 0xFD ; 2537f0c: 16 96 adiw r26, 0x06 ; 67f0e: ec 91 ld r30, X7f10: 16 97 sbiw r26, 0x06 ; 67f12: e0 93 a5 02 sts 0x02A5, r30FromNC_Rotate_S = sintab[EE_Parameter.OrientationAngle];7f16: 6c 91 ld r22, X7f18: 60 93 be 04 sts 0x04BE, r22StickNick = ((FromNC_Rotate_C * stick_nick) + (FromNC_Rotate_S * stick_roll)) / 8;7f1c: ff 27 eor r31, r317f1e: e7 fd sbrc r30, 77f20: f0 95 com r317f22: 77 27 eor r23, r237f24: 67 fd sbrc r22, 77f26: 70 95 com r237f28: 8e 9f mul r24, r307f2a: d0 01 movw r26, r07f2c: 8f 9f mul r24, r317f2e: b0 0d add r27, r07f30: 9e 9f mul r25, r307f32: b0 0d add r27, r07f34: 11 24 eor r1, r17f36: 26 9f mul r18, r227f38: a0 01 movw r20, r07f3a: 27 9f mul r18, r237f3c: 50 0d add r21, r07f3e: 36 9f mul r19, r227f40: 50 0d add r21, r07f42: 11 24 eor r1, r17f44: 4a 0f add r20, r267f46: 5b 1f adc r21, r277f48: 55 23 and r21, r217f4a: 14 f4 brge .+4 ; 0x7f50 <MotorRegler+0xf44>7f4c: 49 5f subi r20, 0xF9 ; 2497f4e: 5f 4f sbci r21, 0xFF ; 2557f50: 55 95 asr r217f52: 47 95 ror r207f54: 55 95 asr r217f56: 47 95 ror r207f58: 55 95 asr r217f5a: 47 95 ror r207f5c: 50 93 15 04 sts 0x0415, r217f60: 40 93 14 04 sts 0x0414, r20StickRoll = ((FromNC_Rotate_C * stick_roll) - (FromNC_Rotate_S * stick_nick)) / 8;7f64: 2e 9f mul r18, r307f66: d0 01 movw r26, r07f68: 2f 9f mul r18, r317f6a: b0 0d add r27, r07f6c: 3e 9f mul r19, r307f6e: b0 0d add r27, r07f70: 11 24 eor r1, r17f72: 86 9f mul r24, r227f74: a0 01 movw r20, r07f76: 87 9f mul r24, r237f78: 50 0d add r21, r07f7a: 96 9f mul r25, r227f7c: 50 0d add r21, r07f7e: 11 24 eor r1, r17f80: 9d 01 movw r18, r267f82: 24 1b sub r18, r207f84: 35 0b sbc r19, r217f86: c9 01 movw r24, r187f88: 99 23 and r25, r257f8a: 0c f4 brge .+2 ; 0x7f8e <MotorRegler+0xf82>7f8c: 07 96 adiw r24, 0x07 ; 77f8e: 95 95 asr r257f90: 87 95 ror r247f92: 95 95 asr r257f94: 87 95 ror r247f96: 95 95 asr r257f98: 87 95 ror r247f9a: 90 93 13 04 sts 0x0413, r257f9e: 80 93 12 04 sts 0x0412, r24}StickGier = -PPM_in[EE_Parameter.Kanalbelegung[K_GIER]];7fa2: e0 91 42 05 lds r30, 0x05427fa6: f0 e0 ldi r31, 0x00 ; 07fa8: ee 0f add r30, r307faa: ff 1f adc r31, r317fac: ef 5c subi r30, 0xCF ; 2077fae: f7 4f sbci r31, 0xF7 ; 2477fb0: 80 81 ld r24, Z7fb2: 91 81 ldd r25, Z+1 ; 0x017fb4: 22 27 eor r18, r187fb6: 33 27 eor r19, r197fb8: 28 1b sub r18, r247fba: 39 0b sbc r19, r25if(StickGier > 4) StickGier -= 4; else7fbc: 25 30 cpi r18, 0x05 ; 57fbe: 31 05 cpc r19, r17fc0: 54 f0 brlt .+20 ; 0x7fd6 <MotorRegler+0xfca>7fc2: 2c ef ldi r18, 0xFC ; 2527fc4: 3f ef ldi r19, 0xFF ; 2557fc6: f9 01 movw r30, r187fc8: e8 1b sub r30, r247fca: f9 0b sbc r31, r257fcc: f0 93 11 04 sts 0x0411, r317fd0: e0 93 10 04 sts 0x0410, r307fd4: 11 c0 rjmp .+34 ; 0x7ff8 <MotorRegler+0xfec>if(StickGier < -4) StickGier += 4; else StickGier = 0;7fd6: 2c 3f cpi r18, 0xFC ; 2527fd8: 3f 4f sbci r19, 0xFF ; 2557fda: 54 f4 brge .+20 ; 0x7ff0 <MotorRegler+0xfe4>7fdc: 24 e0 ldi r18, 0x04 ; 47fde: 30 e0 ldi r19, 0x00 ; 07fe0: 49 01 movw r8, r187fe2: 88 1a sub r8, r247fe4: 99 0a sbc r9, r257fe6: 90 92 11 04 sts 0x0411, r97fea: 80 92 10 04 sts 0x0410, r87fee: 04 c0 rjmp .+8 ; 0x7ff8 <MotorRegler+0xfec>7ff0: 10 92 11 04 sts 0x0411, r17ff4: 10 92 10 04 sts 0x0410, r1if(GasIsZeroCnt > 512) // About to switch - off7ff8: 80 91 c5 03 lds r24, 0x03C57ffc: 90 91 c6 03 lds r25, 0x03C68000: 81 30 cpi r24, 0x01 ; 18002: 92 40 sbci r25, 0x02 ; 28004: 98 f1 brcs .+102 ; 0x806c <MotorRegler+0x1060>{StickNick = StickNick/8;8006: 80 91 14 04 lds r24, 0x0414800a: 90 91 15 04 lds r25, 0x0415800e: 99 23 and r25, r258010: 0c f4 brge .+2 ; 0x8014 <MotorRegler+0x1008>8012: 07 96 adiw r24, 0x07 ; 78014: 95 95 asr r258016: 87 95 ror r248018: 95 95 asr r25801a: 87 95 ror r24801c: 95 95 asr r25801e: 87 95 ror r248020: 90 93 15 04 sts 0x0415, r258024: 80 93 14 04 sts 0x0414, r24StickRoll = StickRoll/8;8028: 80 91 12 04 lds r24, 0x0412802c: 90 91 13 04 lds r25, 0x04138030: 99 23 and r25, r258032: 0c f4 brge .+2 ; 0x8036 <MotorRegler+0x102a>8034: 07 96 adiw r24, 0x07 ; 78036: 95 95 asr r258038: 87 95 ror r24803a: 95 95 asr r25803c: 87 95 ror r24803e: 95 95 asr r258040: 87 95 ror r248042: 90 93 13 04 sts 0x0413, r258046: 80 93 12 04 sts 0x0412, r24SummeNick = 0;804a: 10 92 26 04 sts 0x0426, r1804e: 10 92 27 04 sts 0x0427, r18052: 10 92 28 04 sts 0x0428, r18056: 10 92 29 04 sts 0x0429, r1SummeRoll = 0;805a: 10 92 22 04 sts 0x0422, r1805e: 10 92 23 04 sts 0x0423, r18062: 10 92 24 04 sts 0x0424, r18066: 10 92 25 04 sts 0x0425, r1806a: 4e c0 rjmp .+156 ; 0x8108 <MotorRegler+0x10fc>}elseif(GPS_Aid_StickMultiplikator) // in that case the GPS controls stronger806c: 20 91 67 04 lds r18, 0x04678070: 22 23 and r18, r188072: 09 f4 brne .+2 ; 0x8076 <MotorRegler+0x106a>8074: 49 c0 rjmp .+146 ; 0x8108 <MotorRegler+0x10fc>{StickNick = (GPS_Aid_StickMultiplikator * (StickNick / 8)) / 16;8076: 30 e0 ldi r19, 0x00 ; 08078: 80 91 14 04 lds r24, 0x0414807c: 90 91 15 04 lds r25, 0x04158080: 99 23 and r25, r258082: 0c f4 brge .+2 ; 0x8086 <MotorRegler+0x107a>8084: 07 96 adiw r24, 0x07 ; 78086: ac 01 movw r20, r248088: 55 95 asr r21808a: 47 95 ror r20808c: 55 95 asr r21808e: 47 95 ror r208090: 55 95 asr r218092: 47 95 ror r208094: 24 9f mul r18, r208096: c0 01 movw r24, r08098: 25 9f mul r18, r21809a: 90 0d add r25, r0809c: 34 9f mul r19, r20809e: 90 0d add r25, r080a0: 11 24 eor r1, r180a2: 99 23 and r25, r2580a4: 0c f4 brge .+2 ; 0x80a8 <MotorRegler+0x109c>80a6: 0f 96 adiw r24, 0x0f ; 1580a8: 95 95 asr r2580aa: 87 95 ror r2480ac: 95 95 asr r2580ae: 87 95 ror r2480b0: 95 95 asr r2580b2: 87 95 ror r2480b4: 95 95 asr r2580b6: 87 95 ror r2480b8: 90 93 15 04 sts 0x0415, r2580bc: 80 93 14 04 sts 0x0414, r24StickRoll = (GPS_Aid_StickMultiplikator * (StickRoll / 8)) / 16;80c0: 80 91 12 04 lds r24, 0x041280c4: 90 91 13 04 lds r25, 0x041380c8: 99 23 and r25, r2580ca: 0c f4 brge .+2 ; 0x80ce <MotorRegler+0x10c2>80cc: 07 96 adiw r24, 0x07 ; 780ce: ac 01 movw r20, r2480d0: 55 95 asr r2180d2: 47 95 ror r2080d4: 55 95 asr r2180d6: 47 95 ror r2080d8: 55 95 asr r2180da: 47 95 ror r2080dc: 24 9f mul r18, r2080de: c0 01 movw r24, r080e0: 25 9f mul r18, r2180e2: 90 0d add r25, r080e4: 34 9f mul r19, r2080e6: 90 0d add r25, r080e8: 11 24 eor r1, r180ea: 99 23 and r25, r2580ec: 0c f4 brge .+2 ; 0x80f0 <MotorRegler+0x10e4>80ee: 0f 96 adiw r24, 0x0f ; 1580f0: 95 95 asr r2580f2: 87 95 ror r2480f4: 95 95 asr r2580f6: 87 95 ror r2480f8: 95 95 asr r2580fa: 87 95 ror r2480fc: 95 95 asr r2580fe: 87 95 ror r248100: 90 93 13 04 sts 0x0413, r258104: 80 93 12 04 sts 0x0412, r24}StickNick -= GPS_Nick;8108: c0 90 14 04 lds r12, 0x0414810c: d0 90 15 04 lds r13, 0x04158110: 80 91 6a 04 lds r24, 0x046A8114: 90 91 6b 04 lds r25, 0x046B8118: c8 1a sub r12, r24811a: d9 0a sbc r13, r25811c: d0 92 15 04 sts 0x0415, r138120: c0 92 14 04 sts 0x0414, r12StickRoll -= GPS_Roll;8124: e0 90 12 04 lds r14, 0x04128128: f0 90 13 04 lds r15, 0x0413812c: 80 91 68 04 lds r24, 0x04688130: 90 91 69 04 lds r25, 0x04698134: e8 1a sub r14, r248136: f9 0a sbc r15, r258138: f0 92 13 04 sts 0x0413, r15813c: e0 92 12 04 sts 0x0412, r14StickGas = PPM_in[EE_Parameter.Kanalbelegung[K_GAS]] + 127;8140: e0 91 41 05 lds r30, 0x05418144: f0 e0 ldi r31, 0x00 ; 08146: ee 0f add r30, r308148: ff 1f adc r31, r31814a: ef 5c subi r30, 0xCF ; 207814c: f7 4f sbci r31, 0xF7 ; 247814e: 00 81 ld r16, Z8150: 11 81 ldd r17, Z+1 ; 0x018152: 01 58 subi r16, 0x81 ; 1298154: 1f 4f sbci r17, 0xFF ; 2558156: 10 93 0f 04 sts 0x040F, r17815a: 00 93 0e 04 sts 0x040E, r16GyroFaktor = (Parameter_Gyro_P + 10.0);815e: 60 91 34 01 lds r22, 0x01348162: 70 e0 ldi r23, 0x00 ; 08164: 80 e0 ldi r24, 0x00 ; 08166: 90 e0 ldi r25, 0x00 ; 08168: 0e 94 9b b0 call 0x16136 ; 0x16136 <__floatsisf>816c: 20 e0 ldi r18, 0x00 ; 0816e: 30 e0 ldi r19, 0x00 ; 08170: 40 e2 ldi r20, 0x20 ; 328172: 51 e4 ldi r21, 0x41 ; 658174: 0e 94 09 b0 call 0x16012 ; 0x16012 <__addsf3>8178: 0e 94 6d b0 call 0x160da ; 0x160da <__fixunssfsi>817c: 60 93 6c 06 sts 0x066C, r22IntegralFaktor = Parameter_Gyro_I;8180: 80 91 33 01 lds r24, 0x01338184: 80 93 42 06 sts 0x0642, r24GyroFaktorGier = (Parameter_Gyro_Gier_P + 10.0);8188: 60 91 32 01 lds r22, 0x0132818c: 70 e0 ldi r23, 0x00 ; 0818e: 80 e0 ldi r24, 0x00 ; 08190: 90 e0 ldi r25, 0x00 ; 08192: 0e 94 9b b0 call 0x16136 ; 0x16136 <__floatsisf>8196: 20 e0 ldi r18, 0x00 ; 08198: 30 e0 ldi r19, 0x00 ; 0819a: 40 e2 ldi r20, 0x20 ; 32819c: 51 e4 ldi r21, 0x41 ; 65819e: 0e 94 09 b0 call 0x16012 ; 0x16012 <__addsf3>81a2: 0e 94 6d b0 call 0x160da ; 0x160da <__fixunssfsi>81a6: 60 93 23 06 sts 0x0623, r22IntegralFaktorGier = Parameter_Gyro_Gier_I;81aa: 80 91 31 01 lds r24, 0x013181ae: 80 93 31 06 sts 0x0631, r24//+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++//+ Analoge Steuerung per Seriell//+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++if(ExternControl.Config & 0x01 && Parameter_ExternalControl > 128)81b2: 80 91 89 0a lds r24, 0x0A8981b6: 80 ff sbrs r24, 081b8: 45 c0 rjmp .+138 ; 0x8244 <MotorRegler+0x1238>81ba: 80 91 75 06 lds r24, 0x067581be: 81 38 cpi r24, 0x81 ; 12981c0: 08 f4 brcc .+2 ; 0x81c4 <MotorRegler+0x11b8>81c2: 40 c0 rjmp .+128 ; 0x8244 <MotorRegler+0x1238>{StickNick += (int) ExternControl.Nick * (int) EE_Parameter.Stick_P;81c4: 20 91 55 05 lds r18, 0x055581c8: 30 e0 ldi r19, 0x00 ; 081ca: 40 91 82 0a lds r20, 0x0A8281ce: 42 03 mulsu r20, r1881d0: c0 01 movw r24, r081d2: 43 9f mul r20, r1981d4: 90 0d add r25, r081d6: 11 24 eor r1, r181d8: c8 0e add r12, r2481da: d9 1e adc r13, r2581dc: d0 92 15 04 sts 0x0415, r1381e0: c0 92 14 04 sts 0x0414, r12StickRoll += (int) ExternControl.Roll * (int) EE_Parameter.Stick_P;81e4: 40 91 83 0a lds r20, 0x0A8381e8: 42 03 mulsu r20, r1881ea: c0 01 movw r24, r081ec: 43 9f mul r20, r1981ee: 90 0d add r25, r081f0: 11 24 eor r1, r181f2: e8 0e add r14, r2481f4: f9 1e adc r15, r2581f6: f0 92 13 04 sts 0x0413, r1581fa: e0 92 12 04 sts 0x0412, r14StickGier += ExternControl.Gier;81fe: 20 91 84 0a lds r18, 0x0A848202: 80 91 10 04 lds r24, 0x04108206: 90 91 11 04 lds r25, 0x0411820a: 82 0f add r24, r18820c: 91 1d adc r25, r1820e: 27 fd sbrc r18, 78210: 9a 95 dec r258212: 90 93 11 04 sts 0x0411, r258216: 80 93 10 04 sts 0x0410, r24ExternHoehenValue = (int) ExternControl.Hight * (int)EE_Parameter.Hoehe_Verstaerkung;821a: 30 91 86 0a lds r19, 0x0A86821e: 20 91 50 05 lds r18, 0x05508222: 32 03 mulsu r19, r188224: c0 01 movw r24, r08226: 11 24 eor r1, r18228: 90 93 26 01 sts 0x0126, r25822c: 80 93 25 01 sts 0x0125, r24if(ExternControl.Gas < StickGas) StickGas = ExternControl.Gas;8230: 80 91 85 0a lds r24, 0x0A858234: 90 e0 ldi r25, 0x00 ; 08236: 80 17 cp r24, r168238: 91 07 cpc r25, r17823a: 24 f4 brge .+8 ; 0x8244 <MotorRegler+0x1238>823c: 90 93 0f 04 sts 0x040F, r258240: 80 93 0e 04 sts 0x040E, r24}if(StickGas < 0) StickGas = 0;8244: 80 91 0e 04 lds r24, 0x040E8248: 90 91 0f 04 lds r25, 0x040F824c: 99 23 and r25, r25824e: 24 f4 brge .+8 ; 0x8258 <MotorRegler+0x124c>8250: 10 92 0f 04 sts 0x040F, r18254: 10 92 0e 04 sts 0x040E, r1if(Parameter_GlobalConfig & CFG_HEADING_HOLD) IntegralFaktor = 0;8258: 80 91 5c 06 lds r24, 0x065C825c: 82 fd sbrc r24, 2825e: 10 92 42 06 sts 0x0642, r1if(abs(StickNick/STICK_GAIN) > MaxStickNick)8262: 80 91 14 04 lds r24, 0x04148266: 90 91 15 04 lds r25, 0x0415826a: 40 91 d0 03 lds r20, 0x03D0826e: 50 91 d1 03 lds r21, 0x03D18272: 9c 01 movw r18, r248274: 99 23 and r25, r258276: 14 f4 brge .+4 ; 0x827c <MotorRegler+0x1270>8278: 2d 5f subi r18, 0xFD ; 253827a: 3f 4f sbci r19, 0xFF ; 255827c: 35 95 asr r19827e: 27 95 ror r188280: 35 95 asr r198282: 27 95 ror r188284: 33 23 and r19, r198286: 1c f4 brge .+6 ; 0x828e <MotorRegler+0x1282>8288: 31 95 neg r19828a: 21 95 neg r18828c: 31 09 sbc r19, r1828e: 42 17 cp r20, r188290: 53 07 cpc r21, r198292: f4 f4 brge .+60 ; 0x82d0 <MotorRegler+0x12c4>{MaxStickNick = abs(StickNick)/STICK_GAIN;8294: 9c 01 movw r18, r248296: 99 23 and r25, r258298: 24 f4 brge .+8 ; 0x82a2 <MotorRegler+0x1296>829a: 22 27 eor r18, r18829c: 33 27 eor r19, r19829e: 28 1b sub r18, r2482a0: 39 0b sbc r19, r2582a2: c9 01 movw r24, r1882a4: 99 23 and r25, r2582a6: 0c f4 brge .+2 ; 0x82aa <MotorRegler+0x129e>82a8: 03 96 adiw r24, 0x03 ; 382aa: 95 95 asr r2582ac: 87 95 ror r2482ae: 95 95 asr r2582b0: 87 95 ror r24if(MaxStickNick > 100) MaxStickNick = 100;82b2: 85 36 cpi r24, 0x65 ; 10182b4: 91 05 cpc r25, r182b6: 2c f4 brge .+10 ; 0x82c2 <MotorRegler+0x12b6>if(Parameter_GlobalConfig & CFG_HEADING_HOLD) IntegralFaktor = 0;if(abs(StickNick/STICK_GAIN) > MaxStickNick){MaxStickNick = abs(StickNick)/STICK_GAIN;82b8: 90 93 d1 03 sts 0x03D1, r2582bc: 80 93 d0 03 sts 0x03D0, r2482c0: 0d c0 rjmp .+26 ; 0x82dc <MotorRegler+0x12d0>if(MaxStickNick > 100) MaxStickNick = 100;82c2: 84 e6 ldi r24, 0x64 ; 10082c4: 90 e0 ldi r25, 0x00 ; 082c6: 90 93 d1 03 sts 0x03D1, r2582ca: 80 93 d0 03 sts 0x03D0, r2482ce: 06 c0 rjmp .+12 ; 0x82dc <MotorRegler+0x12d0>}else MaxStickNick--;82d0: 41 50 subi r20, 0x01 ; 182d2: 51 09 sbc r21, r182d4: 50 93 d1 03 sts 0x03D1, r2182d8: 40 93 d0 03 sts 0x03D0, r20if(abs(StickRoll/STICK_GAIN) > MaxStickRoll)82dc: 80 91 12 04 lds r24, 0x041282e0: 90 91 13 04 lds r25, 0x041382e4: 40 91 ce 03 lds r20, 0x03CE82e8: 50 91 cf 03 lds r21, 0x03CF82ec: 9c 01 movw r18, r2482ee: 99 23 and r25, r2582f0: 14 f4 brge .+4 ; 0x82f6 <MotorRegler+0x12ea>82f2: 2d 5f subi r18, 0xFD ; 25382f4: 3f 4f sbci r19, 0xFF ; 25582f6: 35 95 asr r1982f8: 27 95 ror r1882fa: 35 95 asr r1982fc: 27 95 ror r1882fe: 33 23 and r19, r198300: 1c f4 brge .+6 ; 0x8308 <MotorRegler+0x12fc>8302: 31 95 neg r198304: 21 95 neg r188306: 31 09 sbc r19, r18308: 42 17 cp r20, r18830a: 53 07 cpc r21, r19830c: f4 f4 brge .+60 ; 0x834a <MotorRegler+0x133e>{MaxStickRoll = abs(StickRoll)/STICK_GAIN;830e: 9c 01 movw r18, r248310: 99 23 and r25, r258312: 24 f4 brge .+8 ; 0x831c <MotorRegler+0x1310>8314: 22 27 eor r18, r188316: 33 27 eor r19, r198318: 28 1b sub r18, r24831a: 39 0b sbc r19, r25831c: c9 01 movw r24, r18831e: 99 23 and r25, r258320: 0c f4 brge .+2 ; 0x8324 <MotorRegler+0x1318>8322: 03 96 adiw r24, 0x03 ; 38324: 95 95 asr r258326: 87 95 ror r248328: 95 95 asr r25832a: 87 95 ror r24if(MaxStickRoll > 100) MaxStickRoll = 100;832c: 85 36 cpi r24, 0x65 ; 101832e: 91 05 cpc r25, r18330: 2c f4 brge .+10 ; 0x833c <MotorRegler+0x1330>if(MaxStickNick > 100) MaxStickNick = 100;}else MaxStickNick--;if(abs(StickRoll/STICK_GAIN) > MaxStickRoll){MaxStickRoll = abs(StickRoll)/STICK_GAIN;8332: 90 93 cf 03 sts 0x03CF, r258336: 80 93 ce 03 sts 0x03CE, r24833a: 0d c0 rjmp .+26 ; 0x8356 <MotorRegler+0x134a>if(MaxStickRoll > 100) MaxStickRoll = 100;833c: 84 e6 ldi r24, 0x64 ; 100833e: 90 e0 ldi r25, 0x00 ; 08340: 90 93 cf 03 sts 0x03CF, r258344: 80 93 ce 03 sts 0x03CE, r248348: 06 c0 rjmp .+12 ; 0x8356 <MotorRegler+0x134a>}else MaxStickRoll--;834a: 41 50 subi r20, 0x01 ; 1834c: 51 09 sbc r21, r1834e: 50 93 cf 03 sts 0x03CF, r218352: 40 93 ce 03 sts 0x03CE, r20if(FC_StatusFlags & FC_STATUS_EMERGENCY_LANDING) {MaxStickNick = 0; MaxStickRoll = 0;}8356: 80 91 cb 03 lds r24, 0x03CB835a: 84 ff sbrs r24, 4835c: 08 c0 rjmp .+16 ; 0x836e <MotorRegler+0x1362>835e: 10 92 d1 03 sts 0x03D1, r18362: 10 92 d0 03 sts 0x03D0, r18366: 10 92 cf 03 sts 0x03CF, r1836a: 10 92 ce 03 sts 0x03CE, r1// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++// Looping?// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++if((PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] > EE_Parameter.LoopThreshold) && EE_Parameter.BitConfig & CFG_LOOP_LINKS) Looping_Links = 1;836e: 20 91 40 05 lds r18, 0x05408372: 30 e0 ldi r19, 0x00 ; 08374: f9 01 movw r30, r188376: ee 0f add r30, r308378: ff 1f adc r31, r31837a: ef 5c subi r30, 0xCF ; 207837c: f7 4f sbci r31, 0xF7 ; 247837e: 40 81 ld r20, Z8380: 51 81 ldd r21, Z+1 ; 0x018382: 80 91 7a 05 lds r24, 0x057A8386: 90 e0 ldi r25, 0x00 ; 08388: 84 17 cp r24, r20838a: 95 07 cpc r25, r21838c: 44 f4 brge .+16 ; 0x839e <MotorRegler+0x1392>838e: 40 91 b6 05 lds r20, 0x05B68392: 42 ff sbrs r20, 28394: 04 c0 rjmp .+8 ; 0x839e <MotorRegler+0x1392>8396: 41 e0 ldi r20, 0x01 ; 18398: 40 93 e5 03 sts 0x03E5, r20839c: 11 c0 rjmp .+34 ; 0x83c0 <MotorRegler+0x13b4>else{{if((PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] < (EE_Parameter.LoopThreshold - EE_Parameter.LoopHysterese))) Looping_Links = 0;839e: f9 01 movw r30, r1883a0: ee 0f add r30, r3083a2: ff 1f adc r31, r3183a4: ef 5c subi r30, 0xCF ; 20783a6: f7 4f sbci r31, 0xF7 ; 24783a8: 60 81 ld r22, Z83aa: 71 81 ldd r23, Z+1 ; 0x0183ac: 40 91 7b 05 lds r20, 0x057B83b0: dc 01 movw r26, r2483b2: a4 1b sub r26, r2083b4: b1 09 sbc r27, r183b6: 6a 17 cp r22, r2683b8: 7b 07 cpc r23, r2783ba: 14 f4 brge .+4 ; 0x83c0 <MotorRegler+0x13b4>83bc: 10 92 e5 03 sts 0x03E5, r1}}if((PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] < -EE_Parameter.LoopThreshold) && EE_Parameter.BitConfig & CFG_LOOP_RECHTS) Looping_Rechts = 1;83c0: f9 01 movw r30, r1883c2: ee 0f add r30, r3083c4: ff 1f adc r31, r3183c6: ef 5c subi r30, 0xCF ; 20783c8: f7 4f sbci r31, 0xF7 ; 24783ca: 60 81 ld r22, Z83cc: 71 81 ldd r23, Z+1 ; 0x0183ce: 44 27 eor r20, r2083d0: 55 27 eor r21, r2183d2: 48 1b sub r20, r2483d4: 59 0b sbc r21, r2583d6: 64 17 cp r22, r2083d8: 75 07 cpc r23, r2183da: 44 f4 brge .+16 ; 0x83ec <MotorRegler+0x13e0>83dc: 60 91 b6 05 lds r22, 0x05B683e0: 63 ff sbrs r22, 383e2: 04 c0 rjmp .+8 ; 0x83ec <MotorRegler+0x13e0>83e4: 21 e0 ldi r18, 0x01 ; 183e6: 20 93 e4 03 sts 0x03E4, r1883ea: 15 c0 rjmp .+42 ; 0x8416 <MotorRegler+0x140a>else{if(Looping_Rechts) // Hysterese83ec: 60 91 e4 03 lds r22, 0x03E483f0: 66 23 and r22, r2283f2: 89 f0 breq .+34 ; 0x8416 <MotorRegler+0x140a>{if(PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] > -(EE_Parameter.LoopThreshold - EE_Parameter.LoopHysterese)) Looping_Rechts = 0;83f4: f9 01 movw r30, r1883f6: ee 0f add r30, r3083f8: ff 1f adc r31, r3183fa: ef 5c subi r30, 0xCF ; 20783fc: f7 4f sbci r31, 0xF7 ; 24783fe: 60 81 ld r22, Z8400: 71 81 ldd r23, Z+1 ; 0x018402: 20 91 7b 05 lds r18, 0x057B8406: 30 e0 ldi r19, 0x00 ; 08408: 28 1b sub r18, r24840a: 39 0b sbc r19, r25840c: 26 17 cp r18, r22840e: 37 07 cpc r19, r238410: 14 f4 brge .+4 ; 0x8416 <MotorRegler+0x140a>8412: 10 92 e4 03 sts 0x03E4, r1}}if((PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] > EE_Parameter.LoopThreshold) && EE_Parameter.BitConfig & CFG_LOOP_OBEN) Looping_Oben = 1;8416: 20 91 3f 05 lds r18, 0x053F841a: 30 e0 ldi r19, 0x00 ; 0841c: f9 01 movw r30, r18841e: ee 0f add r30, r308420: ff 1f adc r31, r318422: ef 5c subi r30, 0xCF ; 2078424: f7 4f sbci r31, 0xF7 ; 2478426: 60 81 ld r22, Z8428: 71 81 ldd r23, Z+1 ; 0x01842a: 86 17 cp r24, r22842c: 97 07 cpc r25, r23842e: 44 f4 brge .+16 ; 0x8440 <MotorRegler+0x1434>8430: 60 91 b6 05 lds r22, 0x05B68434: 60 ff sbrs r22, 08436: 04 c0 rjmp .+8 ; 0x8440 <MotorRegler+0x1434>8438: 61 e0 ldi r22, 0x01 ; 1843a: 60 93 e2 03 sts 0x03E2, r22843e: 16 c0 rjmp .+44 ; 0x846c <MotorRegler+0x1460>else{if(Looping_Oben) // Hysterese8440: 60 91 e2 03 lds r22, 0x03E28444: 66 23 and r22, r228446: 91 f0 breq .+36 ; 0x846c <MotorRegler+0x1460>{if((PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] < (EE_Parameter.LoopThreshold - EE_Parameter.LoopHysterese))) Looping_Oben = 0;8448: f9 01 movw r30, r18844a: ee 0f add r30, r30844c: ff 1f adc r31, r31844e: ef 5c subi r30, 0xCF ; 2078450: f7 4f sbci r31, 0xF7 ; 2478452: 01 90 ld r0, Z+8454: f0 81 ld r31, Z8456: e0 2d mov r30, r08458: 60 91 7b 05 lds r22, 0x057B845c: 4c 01 movw r8, r24845e: 86 1a sub r8, r228460: 91 08 sbc r9, r18462: e8 15 cp r30, r88464: f9 05 cpc r31, r98466: 14 f4 brge .+4 ; 0x846c <MotorRegler+0x1460>8468: 10 92 e2 03 sts 0x03E2, r1}}if((PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] < -EE_Parameter.LoopThreshold) && EE_Parameter.BitConfig & CFG_LOOP_UNTEN) Looping_Unten = 1;846c: f9 01 movw r30, r18846e: ee 0f add r30, r308470: ff 1f adc r31, r318472: ef 5c subi r30, 0xCF ; 2078474: f7 4f sbci r31, 0xF7 ; 2478476: 60 81 ld r22, Z8478: 71 81 ldd r23, Z+1 ; 0x01847a: 64 17 cp r22, r20847c: 75 07 cpc r23, r21847e: 44 f4 brge .+16 ; 0x8490 <MotorRegler+0x1484>8480: 40 91 b6 05 lds r20, 0x05B68484: 41 ff sbrs r20, 18486: 04 c0 rjmp .+8 ; 0x8490 <MotorRegler+0x1484>8488: 81 e0 ldi r24, 0x01 ; 1848a: 80 93 e3 03 sts 0x03E3, r24848e: 16 c0 rjmp .+44 ; 0x84bc <MotorRegler+0x14b0>else{if(Looping_Unten) // Hysterese8490: 40 91 e3 03 lds r20, 0x03E38494: 44 23 and r20, r208496: 91 f0 breq .+36 ; 0x84bc <MotorRegler+0x14b0>{if(PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] > -(EE_Parameter.LoopThreshold - EE_Parameter.LoopHysterese)) Looping_Unten = 0;8498: f9 01 movw r30, r18849a: ee 0f add r30, r30849c: ff 1f adc r31, r31849e: ef 5c subi r30, 0xCF ; 20784a0: f7 4f sbci r31, 0xF7 ; 24784a2: 20 81 ld r18, Z84a4: 31 81 ldd r19, Z+1 ; 0x0184a6: 40 91 7b 05 lds r20, 0x057B84aa: 50 e0 ldi r21, 0x00 ; 084ac: 5a 01 movw r10, r2084ae: a8 1a sub r10, r2484b0: b9 0a sbc r11, r2584b2: a2 16 cp r10, r1884b4: b3 06 cpc r11, r1984b6: 14 f4 brge .+4 ; 0x84bc <MotorRegler+0x14b0>84b8: 10 92 e3 03 sts 0x03E3, r1}}if(Looping_Links || Looping_Rechts) Looping_Roll = 1; else Looping_Roll = 0;84bc: 80 91 e5 03 lds r24, 0x03E584c0: 81 11 cpse r24, r184c2: 04 c0 rjmp .+8 ; 0x84cc <MotorRegler+0x14c0>84c4: 80 91 e4 03 lds r24, 0x03E484c8: 88 23 and r24, r2484ca: 21 f0 breq .+8 ; 0x84d4 <MotorRegler+0x14c8>84cc: 81 e0 ldi r24, 0x01 ; 184ce: 80 93 e6 03 sts 0x03E6, r2484d2: 02 c0 rjmp .+4 ; 0x84d8 <MotorRegler+0x14cc>84d4: 10 92 e6 03 sts 0x03E6, r1if(Looping_Oben || Looping_Unten) { Looping_Nick = 1; Looping_Roll = 0; Looping_Links = 0; Looping_Rechts = 0;} else Looping_Nick = 0;84d8: 80 91 e2 03 lds r24, 0x03E284dc: 81 11 cpse r24, r184de: 04 c0 rjmp .+8 ; 0x84e8 <MotorRegler+0x14dc>84e0: 80 91 e3 03 lds r24, 0x03E384e4: 88 23 and r24, r2484e6: 51 f0 breq .+20 ; 0x84fc <MotorRegler+0x14f0>84e8: 81 e0 ldi r24, 0x01 ; 184ea: 80 93 e7 03 sts 0x03E7, r2484ee: 10 92 e6 03 sts 0x03E6, r184f2: 10 92 e5 03 sts 0x03E5, r184f6: 10 92 e4 03 sts 0x03E4, r184fa: 02 c0 rjmp .+4 ; 0x8500 <MotorRegler+0x14f4>84fc: 10 92 e7 03 sts 0x03E7, r1} // Ende neue Funken-Werteif(Looping_Roll || Looping_Nick)8500: 80 91 e6 03 lds r24, 0x03E68504: 81 11 cpse r24, r18506: 04 c0 rjmp .+8 ; 0x8510 <MotorRegler+0x1504>8508: 80 91 e7 03 lds r24, 0x03E7850c: 88 23 and r24, r24850e: 51 f0 breq .+20 ; 0x8524 <MotorRegler+0x1518>{if(GasMischanteil > EE_Parameter.LoopGasLimit) GasMischanteil = EE_Parameter.LoopGasLimit;8510: 80 91 79 05 lds r24, 0x05798514: 90 e0 ldi r25, 0x00 ; 08516: 82 15 cp r24, r28518: 93 05 cpc r25, r3851a: 0c f4 brge .+2 ; 0x851e <MotorRegler+0x1512>851c: 1c 01 movw r2, r24TrichterFlug = 1;851e: 81 e0 ldi r24, 0x01 ; 18520: 80 93 1a 04 sts 0x041A, r24// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++// Bei Empfangsausfall im Flug// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++if(FC_StatusFlags2 & FC_STATUS2_RC_FAILSAVE_ACTIVE)8524: 80 91 ca 03 lds r24, 0x03CA8528: 82 ff sbrs r24, 2852a: 31 c0 rjmp .+98 ; 0x858e <MotorRegler+0x1582>{StickNick = -GPS_Nick;852c: 80 91 6a 04 lds r24, 0x046A8530: 90 91 6b 04 lds r25, 0x046B8534: 91 95 neg r258536: 81 95 neg r248538: 91 09 sbc r25, r1853a: 90 93 15 04 sts 0x0415, r25853e: 80 93 14 04 sts 0x0414, r24StickRoll = -GPS_Roll;8542: 80 91 68 04 lds r24, 0x04688546: 90 91 69 04 lds r25, 0x0469854a: 91 95 neg r25854c: 81 95 neg r24854e: 91 09 sbc r25, r18550: 90 93 13 04 sts 0x0413, r258554: 80 93 12 04 sts 0x0412, r24StickGas = StickGasHover;8558: 80 91 40 01 lds r24, 0x0140855c: 90 91 41 01 lds r25, 0x01418560: 90 93 0f 04 sts 0x040F, r258564: 80 93 0e 04 sts 0x040E, r24StickGier = 0;8568: 10 92 11 04 sts 0x0411, r1856c: 10 92 10 04 sts 0x0410, r1Parameter_GlobalConfig &= ~(CFG_HEADING_HOLD | CFG_DREHRATEN_BEGRENZER);8570: 80 91 5c 06 lds r24, 0x065C8574: 8b 77 andi r24, 0x7B ; 123Parameter_GlobalConfig |= CFG_HOEHENREGELUNG | CFG_ACHSENKOPPLUNG_AKTIV | CFG_KOMPASS_AKTIV | CFG_GPS_AKTIV | CFG_HOEHEN_SCHALTER | CFG_GPS_AKTIV;8576: 8b 66 ori r24, 0x6B ; 1078578: 80 93 5c 06 sts 0x065C, r24Parameter_ExtraConfig &= ~(CFG2_HEIGHT_LIMIT | CFG_LEARNABLE_CAREFREE | CFG2_VARIO_BEEP);857c: 80 91 40 06 lds r24, 0x06408580: 8c 7b andi r24, 0xBC ; 1888582: 80 93 40 06 sts 0x0640, r24Parameter_HoehenSchalter = 200; // switch on8586: 88 ec ldi r24, 0xC8 ; 2008588: 80 93 e1 03 sts 0x03E1, r24858c: 1e c0 rjmp .+60 ; 0x85ca <MotorRegler+0x15be>}elseif(FC_StatusFlags & FC_STATUS_EMERGENCY_LANDING)858e: 80 91 cb 03 lds r24, 0x03CB8592: 84 ff sbrs r24, 48594: 1a c0 rjmp .+52 ; 0x85ca <MotorRegler+0x15be>{StickGier = 0;8596: 10 92 11 04 sts 0x0411, r1859a: 10 92 10 04 sts 0x0410, r1StickNick = 0;859e: 10 92 15 04 sts 0x0415, r185a2: 10 92 14 04 sts 0x0414, r1StickRoll = 0;85a6: 10 92 13 04 sts 0x0413, r185aa: 10 92 12 04 sts 0x0412, r1GyroFaktor = 90;85ae: 9a e5 ldi r25, 0x5A ; 9085b0: 90 93 6c 06 sts 0x066C, r25IntegralFaktor = 120;85b4: 88 e7 ldi r24, 0x78 ; 12085b6: 80 93 42 06 sts 0x0642, r24GyroFaktorGier = 90;85ba: 90 93 23 06 sts 0x0623, r25IntegralFaktorGier = 120;85be: 80 93 31 06 sts 0x0631, r24Looping_Roll = 0;85c2: 10 92 e6 03 sts 0x03E6, r1Looping_Nick = 0;85c6: 10 92 e7 03 sts 0x03E7, r1// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++// Integrale auf ACC-Signal abgleichen// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++#define ABGLEICH_ANZAHL 256LMittelIntegralNick += IntegralNick; // Für die Mittelwertbildung aufsummieren85ca: c0 90 42 04 lds r12, 0x044285ce: d0 90 43 04 lds r13, 0x044385d2: e0 90 44 04 lds r14, 0x044485d6: f0 90 45 04 lds r15, 0x044585da: 80 91 34 06 lds r24, 0x063485de: 90 91 35 06 lds r25, 0x063585e2: a0 91 36 06 lds r26, 0x063685e6: b0 91 37 06 lds r27, 0x063785ea: 8c 0d add r24, r1285ec: 9d 1d adc r25, r1385ee: ae 1d adc r26, r1485f0: bf 1d adc r27, r1585f2: 80 93 34 06 sts 0x0634, r2485f6: 90 93 35 06 sts 0x0635, r2585fa: a0 93 36 06 sts 0x0636, r2685fe: b0 93 37 06 sts 0x0637, r27MittelIntegralRoll += IntegralRoll;8602: 80 90 3e 04 lds r8, 0x043E8606: 90 90 3f 04 lds r9, 0x043F860a: a0 90 40 04 lds r10, 0x0440860e: b0 90 41 04 lds r11, 0x04418612: 80 91 3c 06 lds r24, 0x063C8616: 90 91 3d 06 lds r25, 0x063D861a: a0 91 3e 06 lds r26, 0x063E861e: b0 91 3f 06 lds r27, 0x063F8622: 88 0d add r24, r88624: 99 1d adc r25, r98626: aa 1d adc r26, r108628: bb 1d adc r27, r11862a: 80 93 3c 06 sts 0x063C, r24862e: 90 93 3d 06 sts 0x063D, r258632: a0 93 3e 06 sts 0x063E, r268636: b0 93 3f 06 sts 0x063F, r27if(Looping_Nick || Looping_Roll)863a: 80 91 e7 03 lds r24, 0x03E7863e: 81 11 cpse r24, r18640: 0c 94 14 59 jmp 0xb228 ; 0xb228 <MotorRegler+0x421c>8644: 80 91 e6 03 lds r24, 0x03E68648: 81 11 cpse r24, r1864a: 0c 94 f1 58 jmp 0xb1e2 ; 0xb1e2 <MotorRegler+0x41d6>LageKorrekturNick = 0;LageKorrekturRoll = 0;}// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++if(!Looping_Nick && !Looping_Roll && (Aktuell_az > 512 || MotorenEin))864e: 80 91 06 05 lds r24, 0x05068652: 90 91 07 05 lds r25, 0x05078656: 81 30 cpi r24, 0x01 ; 18658: 92 40 sbci r25, 0x02 ; 2865a: 2c f4 brge .+10 ; 0x8666 <MotorRegler+0x165a>865c: 80 91 03 04 lds r24, 0x04038660: 88 23 and r24, r248662: 09 f4 brne .+2 ; 0x8666 <MotorRegler+0x165a>8664: e0 c1 rjmp .+960 ; 0x8a26 <MotorRegler+0x1a1a>{long tmp_long, tmp_long2;if(FromNaviCtrl_Value.Kalman_K > 0 /*&& !TrichterFlug*/)8666: 40 90 4c 09 lds r4, 0x094C866a: 14 14 cp r1, r4866c: 0c f0 brlt .+2 ; 0x8670 <MotorRegler+0x1664>866e: c9 c0 rjmp .+402 ; 0x8802 <MotorRegler+0x17f6>{tmp_long = (long)(IntegralNick / EE_Parameter.GyroAccFaktor - (long)(Mittelwert_AccNick - FromNaviCtrl.AccErrorN));8670: 80 91 5a 05 lds r24, 0x055A8674: 08 2f mov r16, r248676: 10 e0 ldi r17, 0x00 ; 08678: 20 e0 ldi r18, 0x00 ; 0867a: 30 e0 ldi r19, 0x00 ; 0867c: 0d 83 std Y+5, r16 ; 0x05867e: 1e 83 std Y+6, r17 ; 0x068680: 2f 83 std Y+7, r18 ; 0x078682: 38 87 std Y+8, r19 ; 0x08tmp_long2 = (long)(IntegralRoll / EE_Parameter.GyroAccFaktor - (long)(Mittelwert_AccRoll - FromNaviCtrl.AccErrorR));tmp_long = (tmp_long * FromNaviCtrl_Value.Kalman_K) / (32 * 16);8684: 55 24 eor r5, r58686: 47 fc sbrc r4, 78688: 50 94 com r5868a: 65 2c mov r6, r5868c: 75 2c mov r7, r5if(!Looping_Nick && !Looping_Roll && (Aktuell_az > 512 || MotorenEin)){long tmp_long, tmp_long2;if(FromNaviCtrl_Value.Kalman_K > 0 /*&& !TrichterFlug*/){tmp_long = (long)(IntegralNick / EE_Parameter.GyroAccFaktor - (long)(Mittelwert_AccNick - FromNaviCtrl.AccErrorN));868e: c7 01 movw r24, r148690: b6 01 movw r22, r128692: a9 01 movw r20, r188694: 98 01 movw r18, r168696: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>869a: 80 91 60 06 lds r24, 0x0660869e: 90 91 61 06 lds r25, 0x066186a2: 60 91 15 09 lds r22, 0x091586a6: 70 91 16 09 lds r23, 0x091686aa: 86 1b sub r24, r2286ac: 97 0b sbc r25, r2386ae: aa 27 eor r26, r2686b0: 97 fd sbrc r25, 786b2: a0 95 com r2686b4: ba 2f mov r27, r2686b6: 79 01 movw r14, r1886b8: 8a 01 movw r16, r2086ba: e8 1a sub r14, r2486bc: f9 0a sbc r15, r2586be: 0a 0b sbc r16, r2686c0: 1b 0b sbc r17, r2786c2: c8 01 movw r24, r1686c4: b7 01 movw r22, r14tmp_long2 = (long)(IntegralRoll / EE_Parameter.GyroAccFaktor - (long)(Mittelwert_AccRoll - FromNaviCtrl.AccErrorR));tmp_long = (tmp_long * FromNaviCtrl_Value.Kalman_K) / (32 * 16);86c6: a3 01 movw r20, r686c8: 92 01 movw r18, r486ca: 0e 94 27 b1 call 0x1624e ; 0x1624e <__mulsi3>86ce: 6b 01 movw r12, r2286d0: 7c 01 movw r14, r2486d2: 99 23 and r25, r2586d4: 34 f4 brge .+12 ; 0x86e2 <MotorRegler+0x16d6>86d6: 0f ef ldi r16, 0xFF ; 25586d8: c0 0e add r12, r1686da: 01 e0 ldi r16, 0x01 ; 186dc: d0 1e adc r13, r1686de: e1 1c adc r14, r186e0: f1 1c adc r15, r186e2: 0b 2e mov r0, r2786e4: b9 e0 ldi r27, 0x09 ; 986e6: f5 94 asr r1586e8: e7 94 ror r1486ea: d7 94 ror r1386ec: c7 94 ror r1286ee: ba 95 dec r2786f0: d1 f7 brne .-12 ; 0x86e6 <MotorRegler+0x16da>86f2: b0 2d mov r27, r0{long tmp_long, tmp_long2;if(FromNaviCtrl_Value.Kalman_K > 0 /*&& !TrichterFlug*/){tmp_long = (long)(IntegralNick / EE_Parameter.GyroAccFaktor - (long)(Mittelwert_AccNick - FromNaviCtrl.AccErrorN));tmp_long2 = (long)(IntegralRoll / EE_Parameter.GyroAccFaktor - (long)(Mittelwert_AccRoll - FromNaviCtrl.AccErrorR));86f4: c5 01 movw r24, r1086f6: b4 01 movw r22, r886f8: 2d 81 ldd r18, Y+5 ; 0x0586fa: 3e 81 ldd r19, Y+6 ; 0x0686fc: 4f 81 ldd r20, Y+7 ; 0x0786fe: 58 85 ldd r21, Y+8 ; 0x088700: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>8704: 80 91 72 06 lds r24, 0x06728708: 90 91 73 06 lds r25, 0x0673870c: 60 91 17 09 lds r22, 0x09178710: 70 91 18 09 lds r23, 0x09188714: 86 1b sub r24, r228716: 97 0b sbc r25, r238718: aa 27 eor r26, r26871a: 97 fd sbrc r25, 7871c: a0 95 com r26871e: ba 2f mov r27, r268720: 28 1b sub r18, r248722: 39 0b sbc r19, r258724: 4a 0b sbc r20, r268726: 5b 0b sbc r21, r27tmp_long = (tmp_long * FromNaviCtrl_Value.Kalman_K) / (32 * 16);tmp_long2 = (tmp_long2 * FromNaviCtrl_Value.Kalman_K) / (32 * 16);8728: c3 01 movw r24, r6872a: b2 01 movw r22, r4872c: 0e 94 27 b1 call 0x1624e ; 0x1624e <__mulsi3>8730: 8b 01 movw r16, r228732: 9c 01 movw r18, r248734: 99 23 and r25, r258736: 24 f4 brge .+8 ; 0x8740 <MotorRegler+0x1734>8738: 01 50 subi r16, 0x01 ; 1873a: 1e 4f sbci r17, 0xFE ; 254873c: 2f 4f sbci r18, 0xFF ; 255873e: 3f 4f sbci r19, 0xFF ; 2558740: 0f 2e mov r0, r318742: f9 e0 ldi r31, 0x09 ; 98744: 35 95 asr r198746: 27 95 ror r188748: 17 95 ror r17874a: 07 95 ror r16874c: fa 95 dec r31874e: d1 f7 brne .-12 ; 0x8744 <MotorRegler+0x1738>8750: f0 2d mov r31, r0if((MaxStickNick > 64) || (MaxStickRoll > 64))8752: 80 91 d0 03 lds r24, 0x03D08756: 90 91 d1 03 lds r25, 0x03D1875a: 81 34 cpi r24, 0x41 ; 65875c: 91 05 cpc r25, r1875e: 3c f4 brge .+14 ; 0x876e <MotorRegler+0x1762>8760: 80 91 ce 03 lds r24, 0x03CE8764: 90 91 cf 03 lds r25, 0x03CF8768: 81 34 cpi r24, 0x41 ; 65876a: 91 05 cpc r25, r1876c: d4 f0 brlt .+52 ; 0x87a2 <MotorRegler+0x1796>{tmp_long /= 2;876e: d7 01 movw r26, r148770: c6 01 movw r24, r128772: ff 20 and r15, r158774: 1c f4 brge .+6 ; 0x877c <MotorRegler+0x1770>8776: 01 96 adiw r24, 0x01 ; 18778: a1 1d adc r26, r1877a: b1 1d adc r27, r1877c: 6c 01 movw r12, r24877e: 7d 01 movw r14, r268780: f5 94 asr r158782: e7 94 ror r148784: d7 94 ror r138786: c7 94 ror r12tmp_long2 /= 2;8788: d9 01 movw r26, r18878a: c8 01 movw r24, r16878c: 33 23 and r19, r19878e: 1c f4 brge .+6 ; 0x8796 <MotorRegler+0x178a>8790: 01 96 adiw r24, 0x01 ; 18792: a1 1d adc r26, r18794: b1 1d adc r27, r18796: 8c 01 movw r16, r248798: 9d 01 movw r18, r26879a: 35 95 asr r19879c: 27 95 ror r18879e: 17 95 ror r1787a0: 07 95 ror r16}if(tmp_long > (long) FromNaviCtrl_Value.Kalman_MaxFusion) tmp_long = (long) FromNaviCtrl_Value.Kalman_MaxFusion;87a2: 80 91 4e 09 lds r24, 0x094E87a6: 48 2f mov r20, r2487a8: 55 27 eor r21, r2187aa: 47 fd sbrc r20, 787ac: 50 95 com r2187ae: 65 2f mov r22, r2187b0: 75 2f mov r23, r2187b2: 4c 15 cp r20, r1287b4: 5d 05 cpc r21, r1387b6: 6e 05 cpc r22, r1487b8: 7f 05 cpc r23, r1587ba: 14 f4 brge .+4 ; 0x87c0 <MotorRegler+0x17b4>87bc: 6a 01 movw r12, r2087be: 7b 01 movw r14, r22if(tmp_long < (long)-FromNaviCtrl_Value.Kalman_MaxFusion) tmp_long = (long)-FromNaviCtrl_Value.Kalman_MaxFusion;87c0: 99 27 eor r25, r2587c2: 81 95 neg r2487c4: 0c f4 brge .+2 ; 0x87c8 <MotorRegler+0x17bc>87c6: 90 95 com r2587c8: aa 27 eor r26, r2687ca: 97 fd sbrc r25, 787cc: a0 95 com r2687ce: ba 2f mov r27, r2687d0: c8 16 cp r12, r2487d2: d9 06 cpc r13, r2587d4: ea 06 cpc r14, r2687d6: fb 06 cpc r15, r2787d8: 14 f4 brge .+4 ; 0x87de <MotorRegler+0x17d2>87da: 6c 01 movw r12, r2487dc: 7d 01 movw r14, r2687de: 40 17 cp r20, r1687e0: 51 07 cpc r21, r1787e2: 62 07 cpc r22, r1887e4: 73 07 cpc r23, r1987e6: 14 f4 brge .+4 ; 0x87ec <MotorRegler+0x17e0>87e8: 8a 01 movw r16, r2087ea: 9b 01 movw r18, r2287ec: b9 01 movw r22, r1887ee: a8 01 movw r20, r1687f0: 08 17 cp r16, r2487f2: 19 07 cpc r17, r2587f4: 2a 07 cpc r18, r2687f6: 3b 07 cpc r19, r2787f8: 0c f0 brlt .+2 ; 0x87fc <MotorRegler+0x17f0>87fa: d8 c0 rjmp .+432 ; 0x89ac <MotorRegler+0x19a0>87fc: ac 01 movw r20, r2487fe: bd 01 movw r22, r268800: d5 c0 rjmp .+426 ; 0x89ac <MotorRegler+0x19a0>if(tmp_long2 > (long) FromNaviCtrl_Value.Kalman_MaxFusion) tmp_long2 = (long) FromNaviCtrl_Value.Kalman_MaxFusion;if(tmp_long2 < (long)-FromNaviCtrl_Value.Kalman_MaxFusion) tmp_long2 = (long)-FromNaviCtrl_Value.Kalman_MaxFusion;}else{tmp_long = (long)(IntegralNick / EE_Parameter.GyroAccFaktor - (long)Mittelwert_AccNick);8802: 40 90 5a 05 lds r4, 0x055A8806: 51 2c mov r5, r18808: 61 2c mov r6, r1880a: 71 2c mov r7, r1tmp_long2 = (long)(IntegralRoll / EE_Parameter.GyroAccFaktor - (long)Mittelwert_AccRoll);880c: c5 01 movw r24, r10880e: b4 01 movw r22, r88810: a3 01 movw r20, r68812: 92 01 movw r18, r48814: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>8818: 80 91 72 06 lds r24, 0x0672881c: 90 91 73 06 lds r25, 0x06738820: aa 27 eor r26, r268822: 97 fd sbrc r25, 78824: a0 95 com r268826: ba 2f mov r27, r268828: 49 01 movw r8, r18882a: 5a 01 movw r10, r20882c: 88 1a sub r8, r24882e: 99 0a sbc r9, r258830: aa 0a sbc r10, r268832: bb 0a sbc r11, r278834: 8d 82 std Y+5, r8 ; 0x058836: 9e 82 std Y+6, r9 ; 0x068838: af 82 std Y+7, r10 ; 0x07883a: b8 86 std Y+8, r11 ; 0x08if(tmp_long2 > (long) FromNaviCtrl_Value.Kalman_MaxFusion) tmp_long2 = (long) FromNaviCtrl_Value.Kalman_MaxFusion;if(tmp_long2 < (long)-FromNaviCtrl_Value.Kalman_MaxFusion) tmp_long2 = (long)-FromNaviCtrl_Value.Kalman_MaxFusion;}else{tmp_long = (long)(IntegralNick / EE_Parameter.GyroAccFaktor - (long)Mittelwert_AccNick);883c: c7 01 movw r24, r14883e: b6 01 movw r22, r128840: a3 01 movw r20, r68842: 92 01 movw r18, r48844: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>8848: 80 91 60 06 lds r24, 0x0660884c: 90 91 61 06 lds r25, 0x06618850: aa 27 eor r26, r268852: 97 fd sbrc r25, 78854: a0 95 com r268856: ba 2f mov r27, r268858: 79 01 movw r14, r18885a: 8a 01 movw r16, r20885c: e8 1a sub r14, r24885e: f9 0a sbc r15, r258860: 0a 0b sbc r16, r268862: 1b 0b sbc r17, r27tmp_long2 = (long)(IntegralRoll / EE_Parameter.GyroAccFaktor - (long)Mittelwert_AccRoll);tmp_long /= 16;8864: 67 01 movw r12, r148866: 78 01 movw r14, r168868: ff 20 and r15, r15886a: 2c f4 brge .+10 ; 0x8876 <MotorRegler+0x186a>886c: 0f e0 ldi r16, 0x0F ; 15886e: c0 0e add r12, r168870: d1 1c adc r13, r18872: e1 1c adc r14, r18874: f1 1c adc r15, r18876: 68 94 set8878: 13 f8 bld r1, 3887a: f5 94 asr r15887c: e7 94 ror r14887e: d7 94 ror r138880: c7 94 ror r128882: 16 94 lsr r18884: d1 f7 brne .-12 ; 0x887a <MotorRegler+0x186e>tmp_long2 /= 16;8886: 8d 80 ldd r8, Y+5 ; 0x058888: 9e 80 ldd r9, Y+6 ; 0x06888a: af 80 ldd r10, Y+7 ; 0x07888c: b8 84 ldd r11, Y+8 ; 0x08888e: bb 20 and r11, r118890: 2c f4 brge .+10 ; 0x889c <MotorRegler+0x1890>8892: 1f e0 ldi r17, 0x0F ; 158894: 81 0e add r8, r178896: 91 1c adc r9, r18898: a1 1c adc r10, r1889a: b1 1c adc r11, r1889c: 68 94 set889e: 13 f8 bld r1, 388a0: b5 94 asr r1188a2: a7 94 ror r1088a4: 97 94 ror r988a6: 87 94 ror r888a8: 16 94 lsr r188aa: d1 f7 brne .-12 ; 0x88a0 <MotorRegler+0x1894>if((MaxStickNick > 64) || (MaxStickRoll > 64))88ac: 80 91 d0 03 lds r24, 0x03D088b0: 90 91 d1 03 lds r25, 0x03D188b4: 81 34 cpi r24, 0x41 ; 6588b6: 91 05 cpc r25, r188b8: 3c f4 brge .+14 ; 0x88c8 <MotorRegler+0x18bc>88ba: 80 91 ce 03 lds r24, 0x03CE88be: 90 91 cf 03 lds r25, 0x03CF88c2: 81 34 cpi r24, 0x41 ; 6588c4: 91 05 cpc r25, r188c6: bc f0 brlt .+46 ; 0x88f6 <MotorRegler+0x18ea>{tmp_long /= 3;88c8: 0f 2e mov r0, r3188ca: f3 e0 ldi r31, 0x03 ; 388cc: 4f 2e mov r4, r3188ce: 51 2c mov r5, r188d0: 61 2c mov r6, r188d2: 71 2c mov r7, r188d4: f0 2d mov r31, r088d6: c7 01 movw r24, r1488d8: b6 01 movw r22, r1288da: a3 01 movw r20, r688dc: 92 01 movw r18, r488de: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>88e2: 69 01 movw r12, r1888e4: 7a 01 movw r14, r20tmp_long2 /= 3;88e6: c5 01 movw r24, r1088e8: b4 01 movw r22, r888ea: a3 01 movw r20, r688ec: 92 01 movw r18, r488ee: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>88f2: 49 01 movw r8, r1888f4: 5a 01 movw r10, r20}if(abs(PPM_in[EE_Parameter.Kanalbelegung[K_GIER]]) > 25)88f6: e0 91 42 05 lds r30, 0x054288fa: f0 e0 ldi r31, 0x00 ; 088fc: ee 0f add r30, r3088fe: ff 1f adc r31, r318900: ef 5c subi r30, 0xCF ; 2078902: f7 4f sbci r31, 0xF7 ; 2478904: 80 81 ld r24, Z8906: 91 81 ldd r25, Z+1 ; 0x018908: 99 23 and r25, r25890a: 1c f4 brge .+6 ; 0x8912 <MotorRegler+0x1906>890c: 91 95 neg r25890e: 81 95 neg r248910: 91 09 sbc r25, r18912: 4a 97 sbiw r24, 0x1a ; 268914: bc f0 brlt .+46 ; 0x8944 <MotorRegler+0x1938>{tmp_long /= 3;8916: 0f 2e mov r0, r318918: f3 e0 ldi r31, 0x03 ; 3891a: 4f 2e mov r4, r31891c: 51 2c mov r5, r1891e: 61 2c mov r6, r18920: 71 2c mov r7, r18922: f0 2d mov r31, r08924: c7 01 movw r24, r148926: b6 01 movw r22, r128928: a3 01 movw r20, r6892a: 92 01 movw r18, r4892c: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>8930: 69 01 movw r12, r188932: 7a 01 movw r14, r20tmp_long2 /= 3;8934: c5 01 movw r24, r108936: b4 01 movw r22, r88938: a3 01 movw r20, r6893a: 92 01 movw r18, r4893c: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>8940: 49 01 movw r8, r188942: 5a 01 movw r10, r20}KompassFusion = 25;8944: 89 e1 ldi r24, 0x19 ; 258946: 80 93 4c 01 sts 0x014C, r24894a: 21 e2 ldi r18, 0x21 ; 33894c: c2 16 cp r12, r18894e: d1 04 cpc r13, r18950: e1 04 cpc r14, r18952: f1 04 cpc r15, r18954: 2c f0 brlt .+10 ; 0x8960 <MotorRegler+0x1954>8956: c1 2c mov r12, r18958: d1 2c mov r13, r1895a: 76 01 movw r14, r12895c: 68 94 set895e: c5 f8 bld r12, 58960: 30 ee ldi r19, 0xE0 ; 2248962: c3 16 cp r12, r198964: 3f ef ldi r19, 0xFF ; 2558966: d3 06 cpc r13, r198968: e3 06 cpc r14, r19896a: f3 06 cpc r15, r19896c: 44 f4 brge .+16 ; 0x897e <MotorRegler+0x1972>896e: 0f 2e mov r0, r318970: f0 ee ldi r31, 0xE0 ; 2248972: cf 2e mov r12, r318974: dd 24 eor r13, r138976: da 94 dec r138978: ed 2c mov r14, r13897a: fd 2c mov r15, r13897c: f0 2d mov r31, r0897e: d5 01 movw r26, r108980: c4 01 movw r24, r88982: 81 32 cpi r24, 0x21 ; 338984: 91 05 cpc r25, r18986: a1 05 cpc r26, r18988: b1 05 cpc r27, r1898a: 24 f0 brlt .+8 ; 0x8994 <MotorRegler+0x1988>898c: 80 e2 ldi r24, 0x20 ; 32898e: 90 e0 ldi r25, 0x00 ; 08990: a0 e0 ldi r26, 0x00 ; 08992: b0 e0 ldi r27, 0x00 ; 08994: ac 01 movw r20, r248996: bd 01 movw r22, r268998: 40 3e cpi r20, 0xE0 ; 224899a: 8f ef ldi r24, 0xFF ; 255899c: 58 07 cpc r21, r24899e: 68 07 cpc r22, r2489a0: 78 07 cpc r23, r2489a2: 24 f4 brge .+8 ; 0x89ac <MotorRegler+0x19a0>89a4: 40 ee ldi r20, 0xE0 ; 22489a6: 5f ef ldi r21, 0xFF ; 25589a8: 6f ef ldi r22, 0xFF ; 25589aa: 7f ef ldi r23, 0xFF ; 255if(tmp_long < -AUSGLEICH) tmp_long =-AUSGLEICH;if(tmp_long2 > AUSGLEICH) tmp_long2 = AUSGLEICH;if(tmp_long2 <-AUSGLEICH) tmp_long2 =-AUSGLEICH;}Mess_IntegralNick -= tmp_long;89ac: 80 91 36 04 lds r24, 0x043689b0: 90 91 37 04 lds r25, 0x043789b4: a0 91 38 04 lds r26, 0x043889b8: b0 91 39 04 lds r27, 0x043989bc: 8c 19 sub r24, r1289be: 9d 09 sbc r25, r1389c0: ae 09 sbc r26, r1489c2: bf 09 sbc r27, r1589c4: 80 93 36 04 sts 0x0436, r2489c8: 90 93 37 04 sts 0x0437, r2589cc: a0 93 38 04 sts 0x0438, r2689d0: b0 93 39 04 sts 0x0439, r27Mess_IntegralRoll -= tmp_long2;89d4: 80 91 32 04 lds r24, 0x043289d8: 90 91 33 04 lds r25, 0x043389dc: a0 91 34 04 lds r26, 0x043489e0: b0 91 35 04 lds r27, 0x043589e4: 84 1b sub r24, r2089e6: 95 0b sbc r25, r2189e8: a6 0b sbc r26, r2289ea: b7 0b sbc r27, r2389ec: 80 93 32 04 sts 0x0432, r2489f0: 90 93 33 04 sts 0x0433, r2589f4: a0 93 34 04 sts 0x0434, r2689f8: b0 93 35 04 sts 0x0435, r27DriftNick += tmp_long;89fc: 80 91 be 03 lds r24, 0x03BE8a00: 90 91 bf 03 lds r25, 0x03BF8a04: c8 0e add r12, r248a06: d9 1e adc r13, r258a08: d0 92 bf 03 sts 0x03BF, r138a0c: c0 92 be 03 sts 0x03BE, r12DriftRoll += tmp_long2;8a10: 80 91 bc 03 lds r24, 0x03BC8a14: 90 91 bd 03 lds r25, 0x03BD8a18: 9c 01 movw r18, r248a1a: 24 0f add r18, r208a1c: 35 1f adc r19, r218a1e: 30 93 bd 03 sts 0x03BD, r198a22: 20 93 bc 03 sts 0x03BC, r18}// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++if(ZaehlMessungen >= ABGLEICH_ANZAHL)8a26: 80 91 52 03 lds r24, 0x03528a2a: 90 91 53 03 lds r25, 0x03538a2e: 8f 3f cpi r24, 0xFF ; 2558a30: 91 05 cpc r25, r18a32: 09 f0 breq .+2 ; 0x8a36 <MotorRegler+0x1a2a>8a34: 08 f4 brcc .+2 ; 0x8a38 <MotorRegler+0x1a2c>8a36: 5a c1 rjmp .+692 ; 0x8cec <MotorRegler+0x1ce0>// static char last_n_p,last_n_n,last_r_p,last_r_n;static long MittelIntegralNick_Alt,MittelIntegralRoll_Alt;// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++// Gyro-Drift ermitteln// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++if(EE_Parameter.Driftkomp && abs(Mittelwert_AccNick) < 200*4 && abs(Mittelwert_AccRoll) < 200*4 && !TrichterFlug && abs(MesswertGier) < 32/* && (FC_StatusFlags & FC_STATUS_FLY)*/)8a38: 00 91 82 05 lds r16, 0x05828a3c: 00 23 and r16, r168a3e: 09 f4 brne .+2 ; 0x8a42 <MotorRegler+0x1a36>8a40: 07 c1 rjmp .+526 ; 0x8c50 <MotorRegler+0x1c44>8a42: 80 91 60 06 lds r24, 0x06608a46: 90 91 61 06 lds r25, 0x06618a4a: 81 5e subi r24, 0xE1 ; 2258a4c: 9c 4f sbci r25, 0xFC ; 2528a4e: 8f 33 cpi r24, 0x3F ; 638a50: 96 40 sbci r25, 0x06 ; 68a52: 08 f0 brcs .+2 ; 0x8a56 <MotorRegler+0x1a4a>8a54: fd c0 rjmp .+506 ; 0x8c50 <MotorRegler+0x1c44>8a56: 80 91 72 06 lds r24, 0x06728a5a: 90 91 73 06 lds r25, 0x06738a5e: 81 5e subi r24, 0xE1 ; 2258a60: 9c 4f sbci r25, 0xFC ; 2528a62: 8f 33 cpi r24, 0x3F ; 638a64: 96 40 sbci r25, 0x06 ; 68a66: 08 f0 brcs .+2 ; 0x8a6a <MotorRegler+0x1a5e>8a68: f3 c0 rjmp .+486 ; 0x8c50 <MotorRegler+0x1c44>8a6a: 80 91 1a 04 lds r24, 0x041A8a6e: 81 11 cpse r24, r18a70: ef c0 rjmp .+478 ; 0x8c50 <MotorRegler+0x1c44>8a72: 80 91 67 06 lds r24, 0x06678a76: 90 91 68 06 lds r25, 0x06688a7a: 4f 96 adiw r24, 0x1f ; 318a7c: cf 97 sbiw r24, 0x3f ; 638a7e: 08 f0 brcs .+2 ; 0x8a82 <MotorRegler+0x1a76>8a80: e7 c0 rjmp .+462 ; 0x8c50 <MotorRegler+0x1c44>{DebugOut.Analog[16] = EE_Parameter.Driftkomp;8a82: 10 e0 ldi r17, 0x00 ; 08a84: 10 93 69 0c sts 0x0C69, r178a88: 00 93 68 0c sts 0x0C68, r16DriftNick -= DriftNick / (64 * (unsigned int) EE_Parameter.Driftkomp);8a8c: e0 91 be 03 lds r30, 0x03BE8a90: f0 91 bf 03 lds r31, 0x03BF8a94: 00 24 eor r0, r08a96: 16 95 lsr r178a98: 07 95 ror r168a9a: 07 94 ror r08a9c: 16 95 lsr r178a9e: 07 95 ror r168aa0: 07 94 ror r08aa2: 10 2f mov r17, r168aa4: 00 2d mov r16, r08aa6: cf 01 movw r24, r308aa8: b8 01 movw r22, r168aaa: 0e 94 42 b1 call 0x16284 ; 0x16284 <__udivmodhi4>8aae: e6 1b sub r30, r228ab0: f7 0b sbc r31, r238ab2: f0 93 bf 03 sts 0x03BF, r318ab6: e0 93 be 03 sts 0x03BE, r30DriftRoll -= DriftRoll / (64 * (unsigned int) EE_Parameter.Driftkomp);8aba: 20 91 bc 03 lds r18, 0x03BC8abe: 30 91 bd 03 lds r19, 0x03BD8ac2: c9 01 movw r24, r188ac4: b8 01 movw r22, r168ac6: 0e 94 42 b1 call 0x16284 ; 0x16284 <__udivmodhi4>8aca: 26 1b sub r18, r228acc: 37 0b sbc r19, r238ace: 30 93 bd 03 sts 0x03BD, r198ad2: 20 93 bc 03 sts 0x03BC, r18GierGyroFehler -= GierGyroFehler / (64 * (unsigned int) EE_Parameter.Driftkomp);8ad6: e0 90 18 04 lds r14, 0x04188ada: f0 90 19 04 lds r15, 0x04198ade: c7 01 movw r24, r148ae0: b8 01 movw r22, r168ae2: 0e 94 42 b1 call 0x16284 ; 0x16284 <__udivmodhi4>8ae6: e6 1a sub r14, r228ae8: f7 0a sbc r15, r238aea: f0 92 19 04 sts 0x0419, r158aee: e0 92 18 04 sts 0x0418, r14if((MaxStickNick > 64) || (MaxStickRoll > 64) || (abs(PPM_in[EE_Parameter.Kanalbelegung[K_GIER]]) > 25))8af2: 80 91 d0 03 lds r24, 0x03D08af6: 90 91 d1 03 lds r25, 0x03D18afa: 81 34 cpi r24, 0x41 ; 658afc: 91 05 cpc r25, r18afe: bc f4 brge .+46 ; 0x8b2e <MotorRegler+0x1b22>8b00: 80 91 ce 03 lds r24, 0x03CE8b04: 90 91 cf 03 lds r25, 0x03CF8b08: 81 34 cpi r24, 0x41 ; 658b0a: 91 05 cpc r25, r18b0c: 84 f4 brge .+32 ; 0x8b2e <MotorRegler+0x1b22>8b0e: a0 91 42 05 lds r26, 0x05428b12: b0 e0 ldi r27, 0x00 ; 08b14: aa 0f add r26, r268b16: bb 1f adc r27, r278b18: af 5c subi r26, 0xCF ; 2078b1a: b7 4f sbci r27, 0xF7 ; 2478b1c: 8d 91 ld r24, X+8b1e: 9c 91 ld r25, X8b20: 99 23 and r25, r258b22: 1c f4 brge .+6 ; 0x8b2a <MotorRegler+0x1b1e>8b24: 91 95 neg r258b26: 81 95 neg r248b28: 91 09 sbc r25, r18b2a: 4a 97 sbiw r24, 0x1a ; 268b2c: c4 f0 brlt .+48 ; 0x8b5e <MotorRegler+0x1b52>{DriftNick /= 2;8b2e: cf 01 movw r24, r308b30: ff 23 and r31, r318b32: 0c f4 brge .+2 ; 0x8b36 <MotorRegler+0x1b2a>8b34: 01 96 adiw r24, 0x01 ; 18b36: 95 95 asr r258b38: 87 95 ror r248b3a: 90 93 bf 03 sts 0x03BF, r258b3e: 80 93 be 03 sts 0x03BE, r24DriftRoll /= 2;8b42: c9 01 movw r24, r188b44: 99 23 and r25, r258b46: 0c f4 brge .+2 ; 0x8b4a <MotorRegler+0x1b3e>8b48: 01 96 adiw r24, 0x01 ; 18b4a: 95 95 asr r258b4c: 87 95 ror r248b4e: 90 93 bd 03 sts 0x03BD, r258b52: 80 93 bc 03 sts 0x03BC, r24GierGyroFehler = 0;8b56: 10 92 19 04 sts 0x0419, r18b5a: 10 92 18 04 sts 0x0418, r1}if(DriftNick > 3000) { DriftNick = 0; AdNeutralNick++;}8b5e: 80 91 be 03 lds r24, 0x03BE8b62: 90 91 bf 03 lds r25, 0x03BF8b66: 89 3b cpi r24, 0xB9 ; 1858b68: 9b 40 sbci r25, 0x0B ; 118b6a: 6c f0 brlt .+26 ; 0x8b86 <MotorRegler+0x1b7a>8b6c: 10 92 bf 03 sts 0x03BF, r18b70: 10 92 be 03 sts 0x03BE, r18b74: 80 91 57 04 lds r24, 0x04578b78: 90 91 58 04 lds r25, 0x04588b7c: 01 96 adiw r24, 0x01 ; 18b7e: 90 93 58 04 sts 0x0458, r258b82: 80 93 57 04 sts 0x0457, r24if(DriftNick <-3000) { DriftNick = 0; AdNeutralNick--;}8b86: 80 91 be 03 lds r24, 0x03BE8b8a: 90 91 bf 03 lds r25, 0x03BF8b8e: 88 34 cpi r24, 0x48 ; 728b90: 94 4f sbci r25, 0xF4 ; 2448b92: 6c f4 brge .+26 ; 0x8bae <MotorRegler+0x1ba2>8b94: 10 92 bf 03 sts 0x03BF, r18b98: 10 92 be 03 sts 0x03BE, r18b9c: 80 91 57 04 lds r24, 0x04578ba0: 90 91 58 04 lds r25, 0x04588ba4: 01 97 sbiw r24, 0x01 ; 18ba6: 90 93 58 04 sts 0x0458, r258baa: 80 93 57 04 sts 0x0457, r24if(DriftRoll > 3000) { DriftRoll = 0; AdNeutralRoll++;}8bae: 80 91 bc 03 lds r24, 0x03BC8bb2: 90 91 bd 03 lds r25, 0x03BD8bb6: 89 3b cpi r24, 0xB9 ; 1858bb8: 9b 40 sbci r25, 0x0B ; 118bba: 6c f0 brlt .+26 ; 0x8bd6 <MotorRegler+0x1bca>8bbc: 10 92 bd 03 sts 0x03BD, r18bc0: 10 92 bc 03 sts 0x03BC, r18bc4: 80 91 55 04 lds r24, 0x04558bc8: 90 91 56 04 lds r25, 0x04568bcc: 01 96 adiw r24, 0x01 ; 18bce: 90 93 56 04 sts 0x0456, r258bd2: 80 93 55 04 sts 0x0455, r24if(DriftRoll <-3000) { DriftRoll = 0; AdNeutralRoll--;}8bd6: 80 91 bc 03 lds r24, 0x03BC8bda: 90 91 bd 03 lds r25, 0x03BD8bde: 88 34 cpi r24, 0x48 ; 728be0: 94 4f sbci r25, 0xF4 ; 2448be2: 6c f4 brge .+26 ; 0x8bfe <MotorRegler+0x1bf2>8be4: 10 92 bd 03 sts 0x03BD, r18be8: 10 92 bc 03 sts 0x03BC, r18bec: 80 91 55 04 lds r24, 0x04558bf0: 90 91 56 04 lds r25, 0x04568bf4: 01 97 sbiw r24, 0x01 ; 18bf6: 90 93 56 04 sts 0x0456, r258bfa: 80 93 55 04 sts 0x0455, r24if(GierGyroFehler > 3500) { GierGyroFehler = 0; AdNeutralGier++; }8bfe: 80 91 18 04 lds r24, 0x04188c02: 90 91 19 04 lds r25, 0x04198c06: 8d 3a cpi r24, 0xAD ; 1738c08: 9d 40 sbci r25, 0x0D ; 138c0a: 6c f0 brlt .+26 ; 0x8c26 <MotorRegler+0x1c1a>8c0c: 10 92 19 04 sts 0x0419, r18c10: 10 92 18 04 sts 0x0418, r18c14: 80 91 53 04 lds r24, 0x04538c18: 90 91 54 04 lds r25, 0x04548c1c: 01 96 adiw r24, 0x01 ; 18c1e: 90 93 54 04 sts 0x0454, r258c22: 80 93 53 04 sts 0x0453, r24if(GierGyroFehler <-3500) { GierGyroFehler = 0; AdNeutralGier--; }8c26: 80 91 18 04 lds r24, 0x04188c2a: 90 91 19 04 lds r25, 0x04198c2e: 84 35 cpi r24, 0x54 ; 848c30: 92 4f sbci r25, 0xF2 ; 2428c32: d4 f4 brge .+52 ; 0x8c68 <MotorRegler+0x1c5c>8c34: 10 92 19 04 sts 0x0419, r18c38: 10 92 18 04 sts 0x0418, r18c3c: 80 91 53 04 lds r24, 0x04538c40: 90 91 54 04 lds r25, 0x04548c44: 01 97 sbiw r24, 0x01 ; 18c46: 90 93 54 04 sts 0x0454, r258c4a: 80 93 53 04 sts 0x0453, r248c4e: 0c c0 rjmp .+24 ; 0x8c68 <MotorRegler+0x1c5c>}else{DriftNick = 0;8c50: 10 92 bf 03 sts 0x03BF, r18c54: 10 92 be 03 sts 0x03BE, r1DriftRoll = 0;8c58: 10 92 bd 03 sts 0x03BD, r18c5c: 10 92 bc 03 sts 0x03BC, r1GierGyroFehler = 0;8c60: 10 92 19 04 sts 0x0419, r18c64: 10 92 18 04 sts 0x0418, r1}TrichterFlug = 0;8c68: 10 92 1a 04 sts 0x041A, r1LageKorrekturRoll = 0;LageKorrekturNick = 0;TrichterFlug = 0;}*/if(!IntegralFaktor) { LageKorrekturRoll = 0; LageKorrekturNick = 0;} // z.B. bei HH8c6c: 80 91 42 06 lds r24, 0x06428c70: 81 11 cpse r24, r18c72: 08 c0 rjmp .+16 ; 0x8c84 <MotorRegler+0x1c78>8c74: 10 92 ed 03 sts 0x03ED, r18c78: 10 92 ec 03 sts 0x03EC, r18c7c: 10 92 eb 03 sts 0x03EB, r18c80: 10 92 ea 03 sts 0x03EA, r1// +++++++++++++++++++++++++++++++++++++++++++++++++++++MittelIntegralNick_Alt = MittelIntegralNick;8c84: 80 91 34 06 lds r24, 0x06348c88: 90 91 35 06 lds r25, 0x06358c8c: a0 91 36 06 lds r26, 0x06368c90: b0 91 37 06 lds r27, 0x06378c94: 80 93 92 03 sts 0x0392, r248c98: 90 93 93 03 sts 0x0393, r258c9c: a0 93 94 03 sts 0x0394, r268ca0: b0 93 95 03 sts 0x0395, r27MittelIntegralRoll_Alt = MittelIntegralRoll;8ca4: 80 91 3c 06 lds r24, 0x063C8ca8: 90 91 3d 06 lds r25, 0x063D8cac: a0 91 3e 06 lds r26, 0x063E8cb0: b0 91 3f 06 lds r27, 0x063F8cb4: 80 93 8e 03 sts 0x038E, r248cb8: 90 93 8f 03 sts 0x038F, r258cbc: a0 93 90 03 sts 0x0390, r268cc0: b0 93 91 03 sts 0x0391, r27// +++++++++++++++++++++++++++++++++++++++++++++++++++++MittelIntegralNick = 0;8cc4: 10 92 34 06 sts 0x0634, r18cc8: 10 92 35 06 sts 0x0635, r18ccc: 10 92 36 06 sts 0x0636, r18cd0: 10 92 37 06 sts 0x0637, r1MittelIntegralRoll = 0;8cd4: 10 92 3c 06 sts 0x063C, r18cd8: 10 92 3d 06 sts 0x063D, r18cdc: 10 92 3e 06 sts 0x063E, r18ce0: 10 92 3f 06 sts 0x063F, r1ZaehlMessungen = 0;8ce4: 10 92 53 03 sts 0x0353, r18ce8: 10 92 52 03 sts 0x0352, r1} // ZaehlMessungen >= ABGLEICH_ANZAHL// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++// Gieren// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++if(abs(StickGier) > 3) // war 158cec: e0 91 10 04 lds r30, 0x04108cf0: f0 91 11 04 lds r31, 0x04118cf4: df 01 movw r26, r308cf6: ff 23 and r31, r318cf8: 24 f4 brge .+8 ; 0x8d02 <MotorRegler+0x1cf6>8cfa: aa 27 eor r26, r268cfc: bb 27 eor r27, r278cfe: ae 1b sub r26, r308d00: bf 0b sbc r27, r318d02: a4 30 cpi r26, 0x04 ; 48d04: b1 05 cpc r27, r18d06: 3c f0 brlt .+14 ; 0x8d16 <MotorRegler+0x1d0a>{// KompassSignalSchlecht = 1000;if(!(Parameter_GlobalConfig & CFG_KOMPASS_FIX))8d08: 80 91 5c 06 lds r24, 0x065C8d0c: 84 fd sbrc r24, 48d0e: 03 c0 rjmp .+6 ; 0x8d16 <MotorRegler+0x1d0a>{NeueKompassRichtungMerken = 50; // eine Sekunde zum Einloggen8d10: 82 e3 ldi r24, 0x32 ; 508d12: 80 93 ee 03 sts 0x03EE, r24};}tmp_int = (long) EE_Parameter.StickGier_P * ((long)StickGier * abs(StickGier)) / 512L; // expo y = ax + bx²8d16: 10 91 57 05 lds r17, 0x0557tmp_int += (EE_Parameter.StickGier_P * StickGier) / 4;if(GasIsZeroCnt > 512) tmp_int = 0; // disable Yawing when Gas-Stick is to Zero8d1a: 80 91 c5 03 lds r24, 0x03C58d1e: 90 91 c6 03 lds r25, 0x03C68d22: 81 30 cpi r24, 0x01 ; 18d24: 92 40 sbci r25, 0x02 ; 28d26: 68 f5 brcc .+90 ; 0x8d82 <MotorRegler+0x1d76>if(!(Parameter_GlobalConfig & CFG_KOMPASS_FIX)){NeueKompassRichtungMerken = 50; // eine Sekunde zum Einloggen};}tmp_int = (long) EE_Parameter.StickGier_P * ((long)StickGier * abs(StickGier)) / 512L; // expo y = ax + bx²8d28: 9f 01 movw r18, r308d2a: 0e 94 ad b1 call 0x1635a ; 0x1635a <__mulhisi3>8d2e: 9b 01 movw r18, r228d30: ac 01 movw r20, r248d32: a1 2f mov r26, r178d34: b0 e0 ldi r27, 0x00 ; 08d36: 0e 94 c8 b1 call 0x16390 ; 0x16390 <__muluhisi3>8d3a: 6b 01 movw r12, r228d3c: 7c 01 movw r14, r248d3e: 99 23 and r25, r258d40: 34 f4 brge .+12 ; 0x8d4e <MotorRegler+0x1d42>8d42: 5f ef ldi r21, 0xFF ; 2558d44: c5 0e add r12, r218d46: 51 e0 ldi r21, 0x01 ; 18d48: d5 1e adc r13, r218d4a: e1 1c adc r14, r18d4c: f1 1c adc r15, r18d4e: b7 01 movw r22, r148d50: a6 01 movw r20, r128d52: 03 2e mov r0, r198d54: 39 e0 ldi r19, 0x09 ; 98d56: 75 95 asr r238d58: 67 95 ror r228d5a: 57 95 ror r218d5c: 47 95 ror r208d5e: 3a 95 dec r198d60: d1 f7 brne .-12 ; 0x8d56 <MotorRegler+0x1d4a>8d62: 30 2d mov r19, r0tmp_int += (EE_Parameter.StickGier_P * StickGier) / 4;8d64: 1e 9f mul r17, r308d66: c0 01 movw r24, r08d68: 1f 9f mul r17, r318d6a: 90 0d add r25, r08d6c: 11 24 eor r1, r18d6e: 99 23 and r25, r258d70: 0c f4 brge .+2 ; 0x8d74 <MotorRegler+0x1d68>8d72: 03 96 adiw r24, 0x03 ; 38d74: 95 95 asr r258d76: 87 95 ror r248d78: 95 95 asr r258d7a: 87 95 ror r248d7c: 48 0f add r20, r248d7e: 59 1f adc r21, r258d80: 02 c0 rjmp .+4 ; 0x8d86 <MotorRegler+0x1d7a>if(GasIsZeroCnt > 512) tmp_int = 0; // disable Yawing when Gas-Stick is to Zero8d82: 40 e0 ldi r20, 0x00 ; 08d84: 50 e0 ldi r21, 0x00 ; 0tmp_int += CompassGierSetpoint;8d86: 80 91 f0 03 lds r24, 0x03F08d8a: 90 91 f1 03 lds r25, 0x03F18d8e: 48 0f add r20, r248d90: 59 1f adc r21, r25sollGier = tmp_int;8d92: 66 27 eor r22, r228d94: 57 fd sbrc r21, 78d96: 60 95 com r228d98: 76 2f mov r23, r228d9a: 40 93 9e 03 sts 0x039E, r208d9e: 50 93 9f 03 sts 0x039F, r218da2: 60 93 a0 03 sts 0x03A0, r228da6: 70 93 a1 03 sts 0x03A1, r23Mess_Integral_Gier -= tmp_int;8daa: 80 91 2e 04 lds r24, 0x042E8dae: 90 91 2f 04 lds r25, 0x042F8db2: a0 91 30 04 lds r26, 0x04308db6: b0 91 31 04 lds r27, 0x04318dba: 84 1b sub r24, r208dbc: 95 0b sbc r25, r218dbe: a6 0b sbc r26, r228dc0: b7 0b sbc r27, r238dc2: 80 93 2e 04 sts 0x042E, r248dc6: 90 93 2f 04 sts 0x042F, r258dca: a0 93 30 04 sts 0x0430, r268dce: b0 93 31 04 sts 0x0431, r27if(Mess_Integral_Gier > 50000) Mess_Integral_Gier = 50000; // begrenzen8dd2: 81 35 cpi r24, 0x51 ; 818dd4: 63 ec ldi r22, 0xC3 ; 1958dd6: 96 07 cpc r25, r228dd8: a1 05 cpc r26, r18dda: b1 05 cpc r27, r18ddc: 6c f0 brlt .+26 ; 0x8df8 <MotorRegler+0x1dec>8dde: 80 e5 ldi r24, 0x50 ; 808de0: 93 ec ldi r25, 0xC3 ; 1958de2: a0 e0 ldi r26, 0x00 ; 08de4: b0 e0 ldi r27, 0x00 ; 08de6: 80 93 2e 04 sts 0x042E, r248dea: 90 93 2f 04 sts 0x042F, r258dee: a0 93 30 04 sts 0x0430, r268df2: b0 93 31 04 sts 0x0431, r278df6: 11 c0 rjmp .+34 ; 0x8e1a <MotorRegler+0x1e0e>if(Mess_Integral_Gier <-50000) Mess_Integral_Gier =-50000;8df8: 80 3b cpi r24, 0xB0 ; 1768dfa: 9c 43 sbci r25, 0x3C ; 608dfc: af 4f sbci r26, 0xFF ; 2558dfe: bf 4f sbci r27, 0xFF ; 2558e00: 64 f4 brge .+24 ; 0x8e1a <MotorRegler+0x1e0e>8e02: 80 eb ldi r24, 0xB0 ; 1768e04: 9c e3 ldi r25, 0x3C ; 608e06: af ef ldi r26, 0xFF ; 2558e08: bf ef ldi r27, 0xFF ; 2558e0a: 80 93 2e 04 sts 0x042E, r248e0e: 90 93 2f 04 sts 0x042F, r258e12: a0 93 30 04 sts 0x0430, r268e16: b0 93 31 04 sts 0x0431, r27// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++// Kompass// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++if(KompassValue >= 0 && (Parameter_GlobalConfig & CFG_KOMPASS_AKTIV))8e1a: e0 90 4e 01 lds r14, 0x014E8e1e: f0 90 4f 01 lds r15, 0x014F8e22: ff 20 and r15, r158e24: 0c f4 brge .+2 ; 0x8e28 <MotorRegler+0x1e1c>8e26: fe c0 rjmp .+508 ; 0x9024 <MotorRegler+0x2018>8e28: 80 91 5c 06 lds r24, 0x065C8e2c: 83 ff sbrs r24, 38e2e: fa c0 rjmp .+500 ; 0x9024 <MotorRegler+0x2018>{if(CalculateCompassTimer-- == 1)8e30: 80 91 4d 01 lds r24, 0x014D8e34: 81 30 cpi r24, 0x01 ; 18e36: 21 f0 breq .+8 ; 0x8e40 <MotorRegler+0x1e34>8e38: 81 50 subi r24, 0x01 ; 18e3a: 80 93 4d 01 sts 0x014D, r248e3e: f6 c0 rjmp .+492 ; 0x902c <MotorRegler+0x2020>{int w,v,r,fehler,korrektur; // wird von der SPI-Routine auf 1 gesetztCalculateCompassTimer = 13; // falls keine Navi-Daten8e40: 8d e0 ldi r24, 0x0D ; 138e42: 80 93 4d 01 sts 0x014D, r24// max. Korrekturwert schätzenw = abs(IntegralNick /512); // mit zunehmender Neigung den Einfluss drosseln8e46: 80 91 42 04 lds r24, 0x04428e4a: 90 91 43 04 lds r25, 0x04438e4e: a0 91 44 04 lds r26, 0x04448e52: b0 91 45 04 lds r27, 0x04458e56: bb 23 and r27, r278e58: 24 f4 brge .+8 ; 0x8e62 <MotorRegler+0x1e56>8e5a: 81 50 subi r24, 0x01 ; 18e5c: 9e 4f sbci r25, 0xFE ; 2548e5e: af 4f sbci r26, 0xFF ; 2558e60: bf 4f sbci r27, 0xFF ; 2558e62: 07 2e mov r0, r238e64: 79 e0 ldi r23, 0x09 ; 98e66: b5 95 asr r278e68: a7 95 ror r268e6a: 97 95 ror r258e6c: 87 95 ror r248e6e: 7a 95 dec r238e70: d1 f7 brne .-12 ; 0x8e66 <MotorRegler+0x1e5a>8e72: 70 2d mov r23, r08e74: 9c 01 movw r18, r248e76: 99 23 and r25, r258e78: 24 f4 brge .+8 ; 0x8e82 <MotorRegler+0x1e76>8e7a: 22 27 eor r18, r188e7c: 33 27 eor r19, r198e7e: 28 1b sub r18, r248e80: 39 0b sbc r19, r25v = abs(IntegralRoll /512);8e82: 80 91 3e 04 lds r24, 0x043E8e86: 90 91 3f 04 lds r25, 0x043F8e8a: a0 91 40 04 lds r26, 0x04408e8e: b0 91 41 04 lds r27, 0x04418e92: bb 23 and r27, r278e94: 24 f4 brge .+8 ; 0x8e9e <MotorRegler+0x1e92>8e96: 81 50 subi r24, 0x01 ; 18e98: 9e 4f sbci r25, 0xFE ; 2548e9a: af 4f sbci r26, 0xFF ; 2558e9c: bf 4f sbci r27, 0xFF ; 2558e9e: 07 2e mov r0, r238ea0: 79 e0 ldi r23, 0x09 ; 98ea2: b5 95 asr r278ea4: a7 95 ror r268ea6: 97 95 ror r258ea8: 87 95 ror r248eaa: 7a 95 dec r238eac: d1 f7 brne .-12 ; 0x8ea2 <MotorRegler+0x1e96>8eae: 70 2d mov r23, r08eb0: 6c 01 movw r12, r248eb2: 99 23 and r25, r258eb4: 24 f4 brge .+8 ; 0x8ebe <MotorRegler+0x1eb2>8eb6: cc 24 eor r12, r128eb8: dd 24 eor r13, r138eba: c8 1a sub r12, r248ebc: d9 0a sbc r13, r258ebe: c2 16 cp r12, r188ec0: d3 06 cpc r13, r198ec2: 0c f4 brge .+2 ; 0x8ec6 <MotorRegler+0x1eba>8ec4: 69 01 movw r12, r18if(v > w) w = v; // grösste Neigung ermitteln// korrektur = w / 4 + 1;korrektur = w / 8 + 2;ErsatzKompassInGrad = ErsatzKompass/GIER_GRAD_FAKTOR;8ec6: 80 90 6e 06 lds r8, 0x066E8eca: 90 90 6f 06 lds r9, 0x066F8ece: a0 90 70 06 lds r10, 0x06708ed2: b0 90 71 06 lds r11, 0x06718ed6: 20 91 21 01 lds r18, 0x01218eda: 30 91 22 01 lds r19, 0x01228ede: 40 91 23 01 lds r20, 0x01238ee2: 50 91 24 01 lds r21, 0x01248ee6: c5 01 movw r24, r108ee8: b4 01 movw r22, r88eea: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>8eee: 89 01 movw r16, r188ef0: 9a 01 movw r18, r208ef2: 10 93 22 06 sts 0x0622, r178ef6: 00 93 21 06 sts 0x0621, r16// Kompassfehlerwert bestimmenfehler = ((540 + KompassValue - ErsatzKompassInGrad) % 360) - 180;8efa: 84 ee ldi r24, 0xE4 ; 2288efc: e8 1a sub r14, r248efe: 8d ef ldi r24, 0xFD ; 2538f00: f8 0a sbc r15, r248f02: c7 01 movw r24, r148f04: 80 1b sub r24, r168f06: 91 0b sbc r25, r178f08: 68 e6 ldi r22, 0x68 ; 1048f0a: 71 e0 ldi r23, 0x01 ; 18f0c: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>8f10: 84 5b subi r24, 0xB4 ; 1808f12: 91 09 sbc r25, r1// GIER_GRAD_FAKTOR ist ca. 1200// Kompasswert einloggenif(NeueKompassRichtungMerken) KompassSollWert = ErsatzKompassInGrad;8f14: 60 91 ee 03 lds r22, 0x03EE8f18: 66 23 and r22, r228f1a: 21 f0 breq .+8 ; 0x8f24 <MotorRegler+0x1f18>8f1c: 10 93 1d 04 sts 0x041D, r178f20: 00 93 1c 04 sts 0x041C, r16if(KompassSignalSchlecht) KompassSignalSchlecht--;8f24: 40 91 4a 01 lds r20, 0x014A8f28: 50 91 4b 01 lds r21, 0x014B8f2c: 41 15 cp r20, r18f2e: 51 05 cpc r21, r18f30: 39 f0 breq .+14 ; 0x8f40 <MotorRegler+0x1f34>8f32: 41 50 subi r20, 0x01 ; 18f34: 51 09 sbc r21, r18f36: 50 93 4b 01 sts 0x014B, r218f3a: 40 93 4a 01 sts 0x014A, r208f3e: 13 c0 rjmp .+38 ; 0x8f66 <MotorRegler+0x1f5a>elseif(w < 25)8f40: a9 e1 ldi r26, 0x19 ; 258f42: ca 16 cp r12, r268f44: d1 04 cpc r13, r18f46: ac f4 brge .+42 ; 0x8f72 <MotorRegler+0x1f66>{GierGyroFehler += fehler;8f48: 40 91 18 04 lds r20, 0x04188f4c: 50 91 19 04 lds r21, 0x04198f50: 48 0f add r20, r248f52: 59 1f adc r21, r258f54: 50 93 19 04 sts 0x0419, r218f58: 40 93 18 04 sts 0x0418, r20if(NeueKompassRichtungMerken) NeueKompassRichtungMerken--;8f5c: 66 23 and r22, r228f5e: 19 f0 breq .+6 ; 0x8f66 <MotorRegler+0x1f5a>8f60: 61 50 subi r22, 0x01 ; 18f62: 60 93 ee 03 sts 0x03EE, r22}}*/}// Kompass fusionierenif(!KompassSignalSchlecht) ErsatzKompass += (fehler * KompassFusion) / korrektur;8f66: 40 91 4a 01 lds r20, 0x014A8f6a: 50 91 4b 01 lds r21, 0x014B8f6e: 45 2b or r20, r218f70: 49 f5 brne .+82 ; 0x8fc4 <MotorRegler+0x1fb8>8f72: 40 91 4c 01 lds r20, 0x014C8f76: 48 9f mul r20, r248f78: f0 01 movw r30, r08f7a: 49 9f mul r20, r258f7c: f0 0d add r31, r08f7e: 11 24 eor r1, r1// max. Korrekturwert schätzenw = abs(IntegralNick /512); // mit zunehmender Neigung den Einfluss drosselnv = abs(IntegralRoll /512);if(v > w) w = v; // grösste Neigung ermitteln// korrektur = w / 4 + 1;korrektur = w / 8 + 2;8f80: a6 01 movw r20, r128f82: dd 20 and r13, r138f84: 14 f4 brge .+4 ; 0x8f8a <MotorRegler+0x1f7e>8f86: 49 5f subi r20, 0xF9 ; 2498f88: 5f 4f sbci r21, 0xFF ; 2558f8a: ba 01 movw r22, r208f8c: 75 95 asr r238f8e: 67 95 ror r228f90: 75 95 asr r238f92: 67 95 ror r228f94: 75 95 asr r238f96: 67 95 ror r228f98: 6e 5f subi r22, 0xFE ; 2548f9a: 7f 4f sbci r23, 0xFF ; 255}}*/}// Kompass fusionierenif(!KompassSignalSchlecht) ErsatzKompass += (fehler * KompassFusion) / korrektur;8f9c: cf 01 movw r24, r308f9e: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>8fa2: cb 01 movw r24, r228fa4: aa 27 eor r26, r268fa6: 97 fd sbrc r25, 78fa8: a0 95 com r268faa: ba 2f mov r27, r268fac: 88 0e add r8, r248fae: 99 1e adc r9, r258fb0: aa 1e adc r10, r268fb2: bb 1e adc r11, r278fb4: 80 92 6e 06 sts 0x066E, r88fb8: 90 92 6f 06 sts 0x066F, r98fbc: a0 92 70 06 sts 0x0670, r108fc0: b0 92 71 06 sts 0x0671, r11// MK Gierenif(!NeueKompassRichtungMerken)8fc4: 80 91 ee 03 lds r24, 0x03EE8fc8: 81 11 cpse r24, r18fca: 27 c0 rjmp .+78 ; 0x901a <MotorRegler+0x200e>{r = ((540 + (KompassSollWert - ErsatzKompassInGrad)) % 360) - 180;v = r * (Parameter_KompassWirkung/2); // nach Kompass ausrichten8fcc: 40 91 37 01 lds r20, 0x01378fd0: 46 95 lsr r20// Kompass fusionierenif(!KompassSignalSchlecht) ErsatzKompass += (fehler * KompassFusion) / korrektur;// MK Gierenif(!NeueKompassRichtungMerken){r = ((540 + (KompassSollWert - ErsatzKompassInGrad)) % 360) - 180;8fd2: 80 91 1c 04 lds r24, 0x041C8fd6: 90 91 1d 04 lds r25, 0x041D8fda: 80 1b sub r24, r168fdc: 91 0b sbc r25, r178fde: 84 5e subi r24, 0xE4 ; 2288fe0: 9d 4f sbci r25, 0xFD ; 2538fe2: 68 e6 ldi r22, 0x68 ; 1048fe4: 71 e0 ldi r23, 0x01 ; 18fe6: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>8fea: 84 5b subi r24, 0xB4 ; 1808fec: 91 09 sbc r25, r1v = r * (Parameter_KompassWirkung/2); // nach Kompass ausrichten8fee: 48 9f mul r20, r248ff0: 90 01 movw r18, r08ff2: 49 9f mul r20, r258ff4: 30 0d add r19, r08ff6: 11 24 eor r1, r1CompassGierSetpoint = v / 16;8ff8: 33 23 and r19, r198ffa: 14 f4 brge .+4 ; 0x9000 <MotorRegler+0x1ff4>8ffc: 21 5f subi r18, 0xF1 ; 2418ffe: 3f 4f sbci r19, 0xFF ; 2559000: 35 95 asr r199002: 27 95 ror r189004: 35 95 asr r199006: 27 95 ror r189008: 35 95 asr r19900a: 27 95 ror r18900c: 35 95 asr r19900e: 27 95 ror r189010: 30 93 f1 03 sts 0x03F1, r199014: 20 93 f0 03 sts 0x03F0, r189018: 09 c0 rjmp .+18 ; 0x902c <MotorRegler+0x2020>}else CompassGierSetpoint = 0;901a: 10 92 f1 03 sts 0x03F1, r1901e: 10 92 f0 03 sts 0x03F0, r19022: 04 c0 rjmp .+8 ; 0x902c <MotorRegler+0x2020>} // CalculateCompassTimer}else CompassGierSetpoint = 0;9024: 10 92 f1 03 sts 0x03F1, r19028: 10 92 f0 03 sts 0x03F0, r1//DebugOut.Analog[16] = KompassFusion;// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++// Drehgeschwindigkeit und -winkel zu einem Istwert zusammenfassen// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++if(TrichterFlug) { SummeRoll = 0; SummeNick = 0;};902c: 80 91 1a 04 lds r24, 0x041A9030: 88 23 and r24, r249032: 81 f0 breq .+32 ; 0x9054 <MotorRegler+0x2048>9034: 10 92 22 04 sts 0x0422, r19038: 10 92 23 04 sts 0x0423, r1903c: 10 92 24 04 sts 0x0424, r19040: 10 92 25 04 sts 0x0425, r19044: 10 92 26 04 sts 0x0426, r19048: 10 92 27 04 sts 0x0427, r1904c: 10 92 28 04 sts 0x0428, r19050: 10 92 29 04 sts 0x0429, r1if(!Looping_Nick) IntegralNickMalFaktor = (IntegralNick * IntegralFaktor) / (44000 / STICK_GAIN); else IntegralNickMalFaktor = 0;9054: 80 91 e7 03 lds r24, 0x03E79058: 81 11 cpse r24, r1905a: 15 c0 rjmp .+42 ; 0x9086 <MotorRegler+0x207a>905c: a0 91 42 06 lds r26, 0x06429060: 20 91 42 04 lds r18, 0x04429064: 30 91 43 04 lds r19, 0x04439068: 40 91 44 04 lds r20, 0x0444906c: 50 91 45 04 lds r21, 0x04459070: b0 e0 ldi r27, 0x00 ; 09072: 0e 94 c8 b1 call 0x16390 ; 0x16390 <__muluhisi3>9076: 28 ef ldi r18, 0xF8 ; 2489078: 3a e2 ldi r19, 0x2A ; 42907a: 40 e0 ldi r20, 0x00 ; 0907c: 50 e0 ldi r21, 0x00 ; 0907e: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>9082: 79 01 movw r14, r189084: 02 c0 rjmp .+4 ; 0x908a <MotorRegler+0x207e>9086: e1 2c mov r14, r19088: f1 2c mov r15, r1if(!Looping_Roll) IntegralRollMalFaktor = (IntegralRoll * IntegralFaktor) / (44000 / STICK_GAIN); else IntegralRollMalFaktor = 0;908a: 80 91 e6 03 lds r24, 0x03E6908e: 81 11 cpse r24, r19090: 15 c0 rjmp .+42 ; 0x90bc <MotorRegler+0x20b0>9092: a0 91 42 06 lds r26, 0x06429096: 20 91 3e 04 lds r18, 0x043E909a: 30 91 3f 04 lds r19, 0x043F909e: 40 91 40 04 lds r20, 0x044090a2: 50 91 41 04 lds r21, 0x044190a6: b0 e0 ldi r27, 0x00 ; 090a8: 0e 94 c8 b1 call 0x16390 ; 0x16390 <__muluhisi3>90ac: 28 ef ldi r18, 0xF8 ; 24890ae: 3a e2 ldi r19, 0x2A ; 4290b0: 40 e0 ldi r20, 0x00 ; 090b2: 50 e0 ldi r21, 0x00 ; 090b4: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>90b8: 59 01 movw r10, r1890ba: 02 c0 rjmp .+4 ; 0x90c0 <MotorRegler+0x20b4>90bc: a1 2c mov r10, r190be: b1 2c mov r11, r1#define TRIM_MAX 200if(TrimNick > TRIM_MAX) TrimNick = TRIM_MAX; else if(TrimNick <-TRIM_MAX) TrimNick =-TRIM_MAX;90c0: 80 91 1e 06 lds r24, 0x061E90c4: 90 91 1f 06 lds r25, 0x061F90c8: 89 3c cpi r24, 0xC9 ; 20190ca: 91 05 cpc r25, r190cc: 3c f0 brlt .+14 ; 0x90dc <MotorRegler+0x20d0>90ce: 88 ec ldi r24, 0xC8 ; 20090d0: 90 e0 ldi r25, 0x00 ; 090d2: 90 93 1f 06 sts 0x061F, r2590d6: 80 93 1e 06 sts 0x061E, r2490da: 09 c0 rjmp .+18 ; 0x90ee <MotorRegler+0x20e2>90dc: 88 33 cpi r24, 0x38 ; 5690de: 9f 4f sbci r25, 0xFF ; 25590e0: 34 f4 brge .+12 ; 0x90ee <MotorRegler+0x20e2>90e2: 88 e3 ldi r24, 0x38 ; 5690e4: 9f ef ldi r25, 0xFF ; 25590e6: 90 93 1f 06 sts 0x061F, r2590ea: 80 93 1e 06 sts 0x061E, r24if(TrimRoll > TRIM_MAX) TrimRoll = TRIM_MAX; else if(TrimRoll <-TRIM_MAX) TrimRoll =-TRIM_MAX;90ee: 80 91 25 06 lds r24, 0x062590f2: 90 91 26 06 lds r25, 0x062690f6: 89 3c cpi r24, 0xC9 ; 20190f8: 91 05 cpc r25, r190fa: 3c f0 brlt .+14 ; 0x910a <MotorRegler+0x20fe>90fc: 88 ec ldi r24, 0xC8 ; 20090fe: 90 e0 ldi r25, 0x00 ; 09100: 90 93 26 06 sts 0x0626, r259104: 80 93 25 06 sts 0x0625, r249108: 09 c0 rjmp .+18 ; 0x911c <MotorRegler+0x2110>910a: 88 33 cpi r24, 0x38 ; 56910c: 9f 4f sbci r25, 0xFF ; 255910e: 34 f4 brge .+12 ; 0x911c <MotorRegler+0x2110>9110: 88 e3 ldi r24, 0x38 ; 569112: 9f ef ldi r25, 0xFF ; 2559114: 90 93 26 06 sts 0x0626, r259118: 80 93 25 06 sts 0x0625, r24MesswertNick = IntegralNickMalFaktor + (long)((long)MesswertNick * GyroFaktor + (long)TrimNick * 128L) / (256L / STICK_GAIN);911c: 40 90 6c 06 lds r4, 0x066C9120: 51 2c mov r5, r19122: 61 2c mov r6, r19124: 71 2c mov r7, r19126: a0 91 27 06 lds r26, 0x0627912a: b0 91 28 06 lds r27, 0x0628912e: a3 01 movw r20, r69130: 92 01 movw r18, r49132: 0e 94 d2 b1 call 0x163a4 ; 0x163a4 <__mulshisi3>9136: 40 91 1e 06 lds r20, 0x061E913a: 50 91 1f 06 lds r21, 0x061F913e: 8a 01 movw r16, r209140: 22 27 eor r18, r189142: 17 fd sbrc r17, 79144: 20 95 com r189146: 32 2f mov r19, r189148: 00 0f add r16, r16914a: 11 1f adc r17, r17914c: 22 1f adc r18, r18914e: 33 1f adc r19, r199150: 00 0f add r16, r169152: 11 1f adc r17, r179154: 22 1f adc r18, r189156: 33 1f adc r19, r199158: 00 0f add r16, r16915a: 11 1f adc r17, r17915c: 22 1f adc r18, r18915e: 33 1f adc r19, r199160: 00 0f add r16, r169162: 11 1f adc r17, r179164: 22 1f adc r18, r189166: 33 1f adc r19, r199168: 00 0f add r16, r16916a: 11 1f adc r17, r17916c: 22 1f adc r18, r18916e: 33 1f adc r19, r199170: 00 0f add r16, r169172: 11 1f adc r17, r179174: 22 1f adc r18, r189176: 33 1f adc r19, r199178: 00 0f add r16, r16917a: 11 1f adc r17, r17917c: 22 1f adc r18, r18917e: 33 1f adc r19, r199180: ab 01 movw r20, r229182: bc 01 movw r22, r249184: 40 0f add r20, r169186: 51 1f adc r21, r179188: 62 1f adc r22, r18918a: 73 1f adc r23, r19918c: db 01 movw r26, r22918e: ca 01 movw r24, r209190: 77 23 and r23, r239192: 1c f4 brge .+6 ; 0x919a <MotorRegler+0x218e>9194: cf 96 adiw r24, 0x3f ; 639196: a1 1d adc r26, r19198: b1 1d adc r27, r1919a: 68 94 set919c: 15 f8 bld r1, 5919e: b5 95 asr r2791a0: a7 95 ror r2691a2: 97 95 ror r2591a4: 87 95 ror r2491a6: 16 94 lsr r191a8: d1 f7 brne .-12 ; 0x919e <MotorRegler+0x2192>91aa: 67 01 movw r12, r1491ac: c8 0e add r12, r2491ae: d9 1e adc r13, r2591b0: d0 92 28 06 sts 0x0628, r1391b4: c0 92 27 06 sts 0x0627, r12MesswertRoll = IntegralRollMalFaktor + (long)((long)MesswertRoll * GyroFaktor + (long)TrimRoll * 128L) / (256L / STICK_GAIN);91b8: a0 91 1c 06 lds r26, 0x061C91bc: b0 91 1d 06 lds r27, 0x061D91c0: a3 01 movw r20, r691c2: 92 01 movw r18, r491c4: 0e 94 d2 b1 call 0x163a4 ; 0x163a4 <__mulshisi3>91c8: 20 91 25 06 lds r18, 0x062591cc: 30 91 26 06 lds r19, 0x062691d0: 89 01 movw r16, r1891d2: 22 27 eor r18, r1891d4: 17 fd sbrc r17, 791d6: 20 95 com r1891d8: 32 2f mov r19, r1891da: 00 0f add r16, r1691dc: 11 1f adc r17, r1791de: 22 1f adc r18, r1891e0: 33 1f adc r19, r1991e2: 00 0f add r16, r1691e4: 11 1f adc r17, r1791e6: 22 1f adc r18, r1891e8: 33 1f adc r19, r1991ea: 00 0f add r16, r1691ec: 11 1f adc r17, r1791ee: 22 1f adc r18, r1891f0: 33 1f adc r19, r1991f2: 00 0f add r16, r1691f4: 11 1f adc r17, r1791f6: 22 1f adc r18, r1891f8: 33 1f adc r19, r1991fa: 00 0f add r16, r1691fc: 11 1f adc r17, r1791fe: 22 1f adc r18, r189200: 33 1f adc r19, r199202: 00 0f add r16, r169204: 11 1f adc r17, r179206: 22 1f adc r18, r189208: 33 1f adc r19, r19920a: 00 0f add r16, r16920c: 11 1f adc r17, r17920e: 22 1f adc r18, r189210: 33 1f adc r19, r199212: dc 01 movw r26, r249214: cb 01 movw r24, r229216: 80 0f add r24, r169218: 91 1f adc r25, r17921a: a2 1f adc r26, r18921c: b3 1f adc r27, r19921e: 8c 01 movw r16, r249220: 9d 01 movw r18, r269222: bb 23 and r27, r279224: 24 f4 brge .+8 ; 0x922e <MotorRegler+0x2222>9226: 01 5c subi r16, 0xC1 ; 1939228: 1f 4f sbci r17, 0xFF ; 255922a: 2f 4f sbci r18, 0xFF ; 255922c: 3f 4f sbci r19, 0xFF ; 255922e: 68 94 set9230: 15 f8 bld r1, 59232: 35 95 asr r199234: 27 95 ror r189236: 17 95 ror r179238: 07 95 ror r16923a: 16 94 lsr r1923c: d1 f7 brne .-12 ; 0x9232 <MotorRegler+0x2226>923e: 0a 0d add r16, r109240: 1b 1d adc r17, r119242: 10 93 1d 06 sts 0x061D, r179246: 00 93 1c 06 sts 0x061C, r16MesswertGier = (long)(MesswertGier * 2 * (long)GyroFaktorGier) / (256L / STICK_GAIN) + (long)(Integral_Gier * IntegralFaktorGier) / (2 * (44000 / STICK_GAIN));924a: a0 91 67 06 lds r26, 0x0667924e: b0 91 68 06 lds r27, 0x06689252: aa 0f add r26, r269254: bb 1f adc r27, r279256: 20 91 23 06 lds r18, 0x0623925a: 30 e0 ldi r19, 0x00 ; 0925c: 0e 94 c2 b1 call 0x16384 ; 0x16384 <__usmulhisi3>9260: 2b 01 movw r4, r229262: 3c 01 movw r6, r249264: 99 23 and r25, r259266: 2c f4 brge .+10 ; 0x9272 <MotorRegler+0x2266>9268: ff e3 ldi r31, 0x3F ; 63926a: 4f 0e add r4, r31926c: 51 1c adc r5, r1926e: 61 1c adc r6, r19270: 71 1c adc r7, r19272: 68 94 set9274: 15 f8 bld r1, 59276: 75 94 asr r79278: 67 94 ror r6927a: 57 94 ror r5927c: 47 94 ror r4927e: 16 94 lsr r19280: d1 f7 brne .-12 ; 0x9276 <MotorRegler+0x226a>9282: a0 91 31 06 lds r26, 0x06319286: 20 91 3a 04 lds r18, 0x043A928a: 30 91 3b 04 lds r19, 0x043B928e: 40 91 3c 04 lds r20, 0x043C9292: 50 91 3d 04 lds r21, 0x043D9296: b0 e0 ldi r27, 0x00 ; 09298: 0e 94 c8 b1 call 0x16390 ; 0x16390 <__muluhisi3>929c: 20 ef ldi r18, 0xF0 ; 240929e: 35 e5 ldi r19, 0x55 ; 8592a0: 40 e0 ldi r20, 0x00 ; 092a2: 50 e0 ldi r21, 0x00 ; 092a4: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>92a8: 24 0d add r18, r492aa: 35 1d adc r19, r592ac: 30 93 68 06 sts 0x0668, r1992b0: 20 93 67 06 sts 0x0667, r18// Maximalwerte abfangen#define MAX_SENSOR (4096)if(MesswertNick > MAX_SENSOR) MesswertNick = MAX_SENSOR;92b4: 41 e0 ldi r20, 0x01 ; 192b6: c4 16 cp r12, r2092b8: 40 e1 ldi r20, 0x10 ; 1692ba: d4 06 cpc r13, r2092bc: 3c f0 brlt .+14 ; 0x92cc <MotorRegler+0x22c0>92be: 80 e0 ldi r24, 0x00 ; 092c0: 90 e1 ldi r25, 0x10 ; 1692c2: 90 93 28 06 sts 0x0628, r2592c6: 80 93 27 06 sts 0x0627, r2492ca: 0d c0 rjmp .+26 ; 0x92e6 <MotorRegler+0x22da>if(MesswertNick < -MAX_SENSOR) MesswertNick = -MAX_SENSOR;92cc: 80 91 27 06 lds r24, 0x062792d0: 90 91 28 06 lds r25, 0x062892d4: 81 15 cp r24, r192d6: 90 4f sbci r25, 0xF0 ; 24092d8: 34 f4 brge .+12 ; 0x92e6 <MotorRegler+0x22da>92da: 80 e0 ldi r24, 0x00 ; 092dc: 90 ef ldi r25, 0xF0 ; 24092de: 90 93 28 06 sts 0x0628, r2592e2: 80 93 27 06 sts 0x0627, r24if(MesswertRoll > MAX_SENSOR) MesswertRoll = MAX_SENSOR;92e6: 01 30 cpi r16, 0x01 ; 192e8: 10 41 sbci r17, 0x10 ; 1692ea: 3c f0 brlt .+14 ; 0x92fa <MotorRegler+0x22ee>92ec: 80 e0 ldi r24, 0x00 ; 092ee: 90 e1 ldi r25, 0x10 ; 1692f0: 90 93 1d 06 sts 0x061D, r2592f4: 80 93 1c 06 sts 0x061C, r2492f8: 0d c0 rjmp .+26 ; 0x9314 <MotorRegler+0x2308>if(MesswertRoll < -MAX_SENSOR) MesswertRoll = -MAX_SENSOR;92fa: 80 91 1c 06 lds r24, 0x061C92fe: 90 91 1d 06 lds r25, 0x061D9302: 81 15 cp r24, r19304: 90 4f sbci r25, 0xF0 ; 2409306: 34 f4 brge .+12 ; 0x9314 <MotorRegler+0x2308>9308: 80 e0 ldi r24, 0x00 ; 0930a: 90 ef ldi r25, 0xF0 ; 240930c: 90 93 1d 06 sts 0x061D, r259310: 80 93 1c 06 sts 0x061C, r24if(MesswertGier > MAX_SENSOR) MesswertGier = MAX_SENSOR;9314: 21 30 cpi r18, 0x01 ; 19316: 30 41 sbci r19, 0x10 ; 169318: 3c f0 brlt .+14 ; 0x9328 <MotorRegler+0x231c>931a: 80 e0 ldi r24, 0x00 ; 0931c: 90 e1 ldi r25, 0x10 ; 16931e: 90 93 68 06 sts 0x0668, r259322: 80 93 67 06 sts 0x0667, r249326: 0d c0 rjmp .+26 ; 0x9342 <MotorRegler+0x2336>if(MesswertGier < -MAX_SENSOR) MesswertGier = -MAX_SENSOR;9328: 80 91 67 06 lds r24, 0x0667932c: 90 91 68 06 lds r25, 0x06689330: 81 15 cp r24, r19332: 90 4f sbci r25, 0xF0 ; 2409334: 34 f4 brge .+12 ; 0x9342 <MotorRegler+0x2336>9336: 80 e0 ldi r24, 0x00 ; 09338: 90 ef ldi r25, 0xF0 ; 240933a: 90 93 68 06 sts 0x0668, r25933e: 80 93 67 06 sts 0x0667, r24// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++// Undervoltage// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++if(!(FC_StatusFlags & FC_STATUS_LOWBAT))9342: 80 91 cb 03 lds r24, 0x03CB9346: 85 fd sbrc r24, 59348: 0e c0 rjmp .+28 ; 0x9366 <MotorRegler+0x235a>{GasMischanteil = ((unsigned int)GasMischanteil * BattLowVoltageWarning) / UBat; // Gas auf das aktuelle Spannungvieveau beziehen934a: 60 91 1a 01 lds r22, 0x011A934e: 70 91 1b 01 lds r23, 0x011B9352: 20 91 53 01 lds r18, 0x01539356: 22 9d mul r18, r29358: c0 01 movw r24, r0935a: 23 9d mul r18, r3935c: 90 0d add r25, r0935e: 11 24 eor r1, r19360: 0e 94 42 b1 call 0x16284 ; 0x16284 <__udivmodhi4>9364: 1b 01 movw r2, r22}// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++// Auto-Landing// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++static unsigned char slower;if(!slower--)9366: 80 91 8d 03 lds r24, 0x038D936a: 9f ef ldi r25, 0xFF ; 255936c: 98 0f add r25, r24936e: 90 93 8d 03 sts 0x038D, r259372: 81 11 cpse r24, r19374: 66 c0 rjmp .+204 ; 0x9442 <MotorRegler+0x2436>{static unsigned int u_filter = 0;if(!u_filter) u_filter = UBat;9376: 80 91 8b 03 lds r24, 0x038B937a: 90 91 8c 03 lds r25, 0x038C937e: 89 2b or r24, r259380: 41 f4 brne .+16 ; 0x9392 <MotorRegler+0x2386>9382: 80 91 1a 01 lds r24, 0x011A9386: 90 91 1b 01 lds r25, 0x011B938a: 90 93 8c 03 sts 0x038C, r25938e: 80 93 8b 03 sts 0x038B, r24if(UBat > u_filter) u_filter++; else9392: 20 91 1a 01 lds r18, 0x011A9396: 30 91 1b 01 lds r19, 0x011B939a: 80 91 8b 03 lds r24, 0x038B939e: 90 91 8c 03 lds r25, 0x038C93a2: 82 17 cp r24, r1893a4: 93 07 cpc r25, r1993a6: 30 f4 brcc .+12 ; 0x93b4 <MotorRegler+0x23a8>93a8: 01 96 adiw r24, 0x01 ; 193aa: 90 93 8c 03 sts 0x038C, r2593ae: 80 93 8b 03 sts 0x038B, r2493b2: 0c c0 rjmp .+24 ; 0x93cc <MotorRegler+0x23c0>if(UBat < u_filter) u_filter--;93b4: 20 91 1a 01 lds r18, 0x011A93b8: 30 91 1b 01 lds r19, 0x011B93bc: 28 17 cp r18, r2493be: 39 07 cpc r19, r2593c0: 28 f4 brcc .+10 ; 0x93cc <MotorRegler+0x23c0>93c2: 01 97 sbiw r24, 0x01 ; 193c4: 90 93 8c 03 sts 0x038C, r2593c8: 80 93 8b 03 sts 0x038B, r24slower = 100; // 5Hz93cc: 84 e6 ldi r24, 0x64 ; 10093ce: 80 93 8d 03 sts 0x038D, r24if(u_filter < BattAutoLandingVoltage)93d2: 40 91 65 04 lds r20, 0x046593d6: 80 91 8b 03 lds r24, 0x038B93da: 90 91 8c 03 lds r25, 0x038C93de: 24 2f mov r18, r2093e0: 30 e0 ldi r19, 0x00 ; 093e2: 82 17 cp r24, r1893e4: 93 07 cpc r25, r1993e6: 20 f4 brcc .+8 ; 0x93f0 <MotorRegler+0x23e4>{LowVoltageLandingActive = 10; // 2 sek93e8: 2a e0 ldi r18, 0x0A ; 1093ea: 20 93 c1 03 sts 0x03C1, r1893ee: 0f c0 rjmp .+30 ; 0x940e <MotorRegler+0x2402>}else if(u_filter > BattAutoLandingVoltage + LipoCells && LowVoltageLandingActive) LowVoltageLandingActive--;93f0: 20 91 51 01 lds r18, 0x015193f4: 30 e0 ldi r19, 0x00 ; 093f6: 24 0f add r18, r2093f8: 31 1d adc r19, r193fa: 28 17 cp r18, r2493fc: 39 07 cpc r19, r2593fe: 38 f4 brcc .+14 ; 0x940e <MotorRegler+0x2402>9400: 20 91 c1 03 lds r18, 0x03C19404: 22 23 and r18, r189406: 19 f0 breq .+6 ; 0x940e <MotorRegler+0x2402>9408: 21 50 subi r18, 0x01 ; 1940a: 20 93 c1 03 sts 0x03C1, r18if(u_filter < BattComingHomeVoltage)940e: 40 91 64 04 lds r20, 0x04649412: 24 2f mov r18, r209414: 30 e0 ldi r19, 0x00 ; 09416: 82 17 cp r24, r189418: 93 07 cpc r25, r19941a: 20 f4 brcc .+8 ; 0x9424 <MotorRegler+0x2418>{LowVoltageHomeActive = 25; // min. 5 sek941c: 89 e1 ldi r24, 0x19 ; 25941e: 80 93 c0 03 sts 0x03C0, r249422: 0f c0 rjmp .+30 ; 0x9442 <MotorRegler+0x2436>}else if(u_filter > BattComingHomeVoltage + LipoCells && LowVoltageHomeActive) LowVoltageHomeActive--;9424: 20 91 51 01 lds r18, 0x01519428: 30 e0 ldi r19, 0x00 ; 0942a: 24 0f add r18, r20942c: 31 1d adc r19, r1942e: 28 17 cp r18, r249430: 39 07 cpc r19, r259432: 38 f4 brcc .+14 ; 0x9442 <MotorRegler+0x2436>9434: 80 91 c0 03 lds r24, 0x03C09438: 88 23 and r24, r24943a: 19 f0 breq .+6 ; 0x9442 <MotorRegler+0x2436>943c: 81 50 subi r24, 0x01 ; 1943e: 80 93 c0 03 sts 0x03C0, r24}if(LowVoltageLandingActive && FromNC_AltitudeSetpoint >= 0)9442: 80 91 c1 03 lds r24, 0x03C19446: 88 23 and r24, r249448: d1 f0 breq .+52 ; 0x947e <MotorRegler+0x2472>944a: 80 91 f4 03 lds r24, 0x03F4944e: 90 91 f5 03 lds r25, 0x03F59452: a0 91 f6 03 lds r26, 0x03F69456: b0 91 f7 03 lds r27, 0x03F7945a: bb 23 and r27, r27945c: 84 f0 brlt .+32 ; 0x947e <MotorRegler+0x2472>{FromNC_AltitudeSpeed = EE_Parameter.LandingSpeed;945e: 80 91 b0 05 lds r24, 0x05B09462: 80 93 f3 03 sts 0x03F3, r24FromNC_AltitudeSetpoint = -20000;9466: 80 ee ldi r24, 0xE0 ; 2249468: 91 eb ldi r25, 0xB1 ; 177946a: af ef ldi r26, 0xFF ; 255946c: bf ef ldi r27, 0xFF ; 255946e: 80 93 f4 03 sts 0x03F4, r249472: 90 93 f5 03 sts 0x03F5, r259476: a0 93 f6 03 sts 0x03F6, r26947a: b0 93 f7 03 sts 0x03F7, r27}// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++// send SPI pending bytesif(BytegapSPI == 0) SPI_TransmitByte();947e: 80 91 cc 04 lds r24, 0x04CC9482: 81 11 cpse r24, r19484: 02 c0 rjmp .+4 ; 0x948a <MotorRegler+0x247e>9486: 0e 94 de 95 call 0x12bbc ; 0x12bbc <SPI_TransmitByte>// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++// Höhenregelung// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++GasMischanteil *= STICK_GAIN;948a: 22 0c add r2, r2948c: 33 1c adc r3, r3948e: 22 0c add r2, r29490: 33 1c adc r3, r3// if height control is activatedif((Parameter_GlobalConfig & CFG_HOEHENREGELUNG) && !(Looping_Roll || Looping_Nick) && !(VersionInfo.HardwareError[0] & 0x7F)) // Höhenregelung9492: 80 91 5c 06 lds r24, 0x065C9496: 80 fd sbrc r24, 09498: 02 c0 rjmp .+4 ; 0x949e <MotorRegler+0x2492>949a: 0c 94 b7 54 jmp 0xa96e ; 0xa96e <MotorRegler+0x3962>949e: 80 91 e6 03 lds r24, 0x03E694a2: 81 11 cpse r24, r194a4: 0c 94 b7 54 jmp 0xa96e ; 0xa96e <MotorRegler+0x3962>94a8: 80 91 e7 03 lds r24, 0x03E794ac: 81 11 cpse r24, r194ae: 0c 94 b7 54 jmp 0xa96e ; 0xa96e <MotorRegler+0x3962>94b2: 80 91 62 0a lds r24, 0x0A6294b6: 8f 77 andi r24, 0x7F ; 12794b8: 11 f0 breq .+4 ; 0x94be <MotorRegler+0x24b2>94ba: 0c 94 b7 54 jmp 0xa96e ; 0xa96e <MotorRegler+0x3962>static int HeightDeviation = 0, FilterHCGas = 0;static unsigned long HoverGasFilter = 0;static unsigned char delay = 100, BaroAtUpperLimit = 0, BaroAtLowerLimit = 0;// Expand the measurement// measurement of air pressure close to upper limit and no overflow in correction of the new OCR0A value occursif(!BaroExpandActive)94be: 80 91 59 04 lds r24, 0x045994c2: 90 91 5a 04 lds r25, 0x045A94c6: 89 2b or r24, r2594c8: 09 f0 breq .+2 ; 0x94cc <MotorRegler+0x24c0>94ca: 5f c0 rjmp .+190 ; 0x958a <MotorRegler+0x257e>{if(MessLuftdruck > 920)94cc: 80 91 10 01 lds r24, 0x011094d0: 90 91 11 01 lds r25, 0x011194d4: 89 39 cpi r24, 0x99 ; 15394d6: 93 40 sbci r25, 0x03 ; 394d8: 30 f1 brcs .+76 ; 0x9526 <MotorRegler+0x251a>{ // increase offsetif(OCR0A < (255 - OPA_OFFSET_STEP))94da: 87 b5 in r24, 0x27 ; 3994dc: 8a 3f cpi r24, 0xFA ; 25094de: f8 f4 brcc .+62 ; 0x951e <MotorRegler+0x2512>{ExpandBaro -= 1;94e0: 80 91 56 03 lds r24, 0x035694e4: 81 50 subi r24, 0x01 ; 194e6: 80 93 56 03 sts 0x0356, r24OCR0A = DruckOffsetSetting - OPA_OFFSET_STEP * ExpandBaro; // increase offset to shift ADC down94ea: 98 2f mov r25, r2494ec: 99 0f add r25, r2594ee: 99 0f add r25, r2594f0: 89 0f add r24, r2594f2: 90 91 12 05 lds r25, 0x051294f6: 98 1b sub r25, r2494f8: 97 bd out 0x27, r25 ; 39OCR0B = 255 - OCR0A;94fa: 87 b5 in r24, 0x27 ; 3994fc: 80 95 com r2494fe: 88 bd out 0x28, r24 ; 40beeptime = 300;9500: 8c e2 ldi r24, 0x2C ; 449502: 91 e0 ldi r25, 0x01 ; 19504: 90 93 ce 04 sts 0x04CE, r259508: 80 93 cd 04 sts 0x04CD, r24BaroExpandActive = 350;950c: 8e e5 ldi r24, 0x5E ; 94950e: 91 e0 ldi r25, 0x01 ; 19510: 90 93 5a 04 sts 0x045A, r259514: 80 93 59 04 sts 0x0459, r24CalcExpandBaroStep();9518: 0e 94 14 1b call 0x3628 ; 0x3628 <CalcExpandBaroStep>951c: 6b c0 rjmp .+214 ; 0x95f4 <MotorRegler+0x25e8>}else{BaroAtLowerLimit = 1;951e: 81 e0 ldi r24, 0x01 ; 19520: 80 93 8a 03 sts 0x038A, r249524: 67 c0 rjmp .+206 ; 0x95f4 <MotorRegler+0x25e8>}}// measurement of air pressure close to lower limit andelseif(MessLuftdruck < 100)9526: 80 91 10 01 lds r24, 0x0110952a: 90 91 11 01 lds r25, 0x0111952e: 84 36 cpi r24, 0x64 ; 1009530: 91 05 cpc r25, r19532: 30 f5 brcc .+76 ; 0x9580 <MotorRegler+0x2574>{ // decrease offsetif(OCR0A > OPA_OFFSET_STEP)9534: 87 b5 in r24, 0x27 ; 399536: 86 30 cpi r24, 0x06 ; 69538: f8 f0 brcs .+62 ; 0x9578 <MotorRegler+0x256c>{ExpandBaro += 1;953a: 80 91 56 03 lds r24, 0x0356953e: 8f 5f subi r24, 0xFF ; 2559540: 80 93 56 03 sts 0x0356, r24OCR0A = DruckOffsetSetting - OPA_OFFSET_STEP * ExpandBaro; // decrease offset to shift ADC up9544: 98 2f mov r25, r249546: 99 0f add r25, r259548: 99 0f add r25, r25954a: 89 0f add r24, r25954c: 90 91 12 05 lds r25, 0x05129550: 98 1b sub r25, r249552: 97 bd out 0x27, r25 ; 39OCR0B = 255 - OCR0A;9554: 87 b5 in r24, 0x27 ; 399556: 80 95 com r249558: 88 bd out 0x28, r24 ; 40beeptime = 300;955a: 8c e2 ldi r24, 0x2C ; 44955c: 91 e0 ldi r25, 0x01 ; 1955e: 90 93 ce 04 sts 0x04CE, r259562: 80 93 cd 04 sts 0x04CD, r24BaroExpandActive = 350;9566: 8e e5 ldi r24, 0x5E ; 949568: 91 e0 ldi r25, 0x01 ; 1956a: 90 93 5a 04 sts 0x045A, r25956e: 80 93 59 04 sts 0x0459, r24CalcExpandBaroStep();9572: 0e 94 14 1b call 0x3628 ; 0x3628 <CalcExpandBaroStep>9576: 3e c0 rjmp .+124 ; 0x95f4 <MotorRegler+0x25e8>}else{BaroAtUpperLimit = 1;9578: 81 e0 ldi r24, 0x01 ; 1957a: 80 93 89 03 sts 0x0389, r24957e: 3a c0 rjmp .+116 ; 0x95f4 <MotorRegler+0x25e8>}}else{BaroAtUpperLimit = 0;9580: 10 92 89 03 sts 0x0389, r1BaroAtLowerLimit = 0;9584: 10 92 8a 03 sts 0x038A, r19588: 35 c0 rjmp .+106 ; 0x95f4 <MotorRegler+0x25e8>}}else // delay, because of expanding the Baro-Range{// now clear the D-valuesVarioMeter = 0;958a: 10 92 55 03 sts 0x0355, r1958e: 10 92 54 03 sts 0x0354, r1#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))if(ACC_AltitudeControl) ACC_AltitudeFusion(1); // init9592: 80 91 c2 03 lds r24, 0x03C29596: 88 23 and r24, r249598: 21 f0 breq .+8 ; 0x95a2 <MotorRegler+0x2596>959a: 81 e0 ldi r24, 0x01 ; 1959c: 0e 94 a0 16 call 0x2d40 ; 0x2d40 <ACC_AltitudeFusion>95a0: 20 c0 rjmp .+64 ; 0x95e2 <MotorRegler+0x25d6>else SummenHoehe = HoehenWert * SM_FILTER;95a2: 80 91 fe 03 lds r24, 0x03FE95a6: 90 91 ff 03 lds r25, 0x03FF95aa: a0 91 00 04 lds r26, 0x040095ae: b0 91 01 04 lds r27, 0x040195b2: 88 0f add r24, r2495b4: 99 1f adc r25, r2595b6: aa 1f adc r26, r2695b8: bb 1f adc r27, r2795ba: 88 0f add r24, r2495bc: 99 1f adc r25, r2595be: aa 1f adc r26, r2695c0: bb 1f adc r27, r2795c2: 88 0f add r24, r2495c4: 99 1f adc r25, r2595c6: aa 1f adc r26, r2695c8: bb 1f adc r27, r2795ca: 88 0f add r24, r2495cc: 99 1f adc r25, r2595ce: aa 1f adc r26, r2695d0: bb 1f adc r27, r2795d2: 80 93 57 03 sts 0x0357, r2495d6: 90 93 58 03 sts 0x0358, r2595da: a0 93 59 03 sts 0x0359, r2695de: b0 93 5a 03 sts 0x035A, r27#elseSummenHoehe = HoehenWert * SM_FILTER;#endifBaroExpandActive--;95e2: 80 91 59 04 lds r24, 0x045995e6: 90 91 5a 04 lds r25, 0x045A95ea: 01 97 sbiw r24, 0x01 ; 195ec: 90 93 5a 04 sts 0x045A, r2595f0: 80 93 59 04 sts 0x0459, r24}// if height control is activated by an rc channelif(Parameter_GlobalConfig & CFG_HOEHEN_SCHALTER) // Regler wird über Schalter gesteuert95f4: 80 91 5c 06 lds r24, 0x065C95f8: 81 ff sbrs r24, 195fa: 41 c0 rjmp .+130 ; 0x967e <MotorRegler+0x2672>{ // check if parameter is less than activation thresholdif(Parameter_HoehenSchalter < 50) // for 3 or 2-state switch height control is disabled in lowest position95fc: 80 91 e1 03 lds r24, 0x03E19600: 82 33 cpi r24, 0x32 ; 509602: 48 f5 brcc .+82 ; 0x9656 <MotorRegler+0x264a>{ //height control not activeif(!delay--)9604: 80 91 1c 01 lds r24, 0x011C9608: 9f ef ldi r25, 0xFF ; 255960a: 98 0f add r25, r24960c: 90 93 1c 01 sts 0x011C, r259610: 81 11 cpse r24, r19612: 53 c0 rjmp .+166 ; 0x96ba <MotorRegler+0x26ae>{#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))if(!SpeakHoTT && HoehenReglerAktiv) SpeakHoTT = SPEAK_ALTITUDE_OFF;9614: 80 91 57 01 lds r24, 0x01579618: 81 11 cpse r24, r1961a: 07 c0 rjmp .+14 ; 0x962a <MotorRegler+0x261e>961c: 80 91 1b 04 lds r24, 0x041B9620: 88 23 and r24, r249622: 19 f0 breq .+6 ; 0x962a <MotorRegler+0x261e>9624: 88 e2 ldi r24, 0x28 ; 409626: 80 93 57 01 sts 0x0157, r24#endifHoehenReglerAktiv = 0; // disable height control962a: 10 92 1b 04 sts 0x041B, r1SollHoehe = HoehenWert; // update SetPoint with current reading962e: 80 91 fe 03 lds r24, 0x03FE9632: 90 91 ff 03 lds r25, 0x03FF9636: a0 91 00 04 lds r26, 0x0400963a: b0 91 01 04 lds r27, 0x0401963e: 80 93 fa 03 sts 0x03FA, r249642: 90 93 fb 03 sts 0x03FB, r259646: a0 93 fc 03 sts 0x03FC, r26964a: b0 93 fd 03 sts 0x03FD, r27delay = 1;964e: 81 e0 ldi r24, 0x01 ; 19650: 80 93 1c 01 sts 0x011C, r249654: 32 c0 rjmp .+100 ; 0x96ba <MotorRegler+0x26ae>}}elseif(Parameter_HoehenSchalter > 70)9656: 87 34 cpi r24, 0x47 ; 719658: 80 f1 brcs .+96 ; 0x96ba <MotorRegler+0x26ae>{ //height control is activated#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))if(!SpeakHoTT && !HoehenReglerAktiv) SpeakHoTT = SPEAK_ALTITUDE_ON;965a: 80 91 57 01 lds r24, 0x0157965e: 81 11 cpse r24, r19660: 07 c0 rjmp .+14 ; 0x9670 <MotorRegler+0x2664>9662: 80 91 1b 04 lds r24, 0x041B9666: 81 11 cpse r24, r19668: 03 c0 rjmp .+6 ; 0x9670 <MotorRegler+0x2664>966a: 87 e2 ldi r24, 0x27 ; 39966c: 80 93 57 01 sts 0x0157, r24#endifdelay = 200;9670: 88 ec ldi r24, 0xC8 ; 2009672: 80 93 1c 01 sts 0x011C, r24HoehenReglerAktiv = 1; // enable height control9676: 81 e0 ldi r24, 0x01 ; 19678: 80 93 1b 04 sts 0x041B, r24967c: 1e c0 rjmp .+60 ; 0x96ba <MotorRegler+0x26ae>}}else // no switchable height control{SollHoehe = ((int16_t) ExternHoehenValue + (int16_t) Parameter_HoehenSchalter) * (int)EE_Parameter.Hoehe_Verstaerkung;967e: 80 91 e1 03 lds r24, 0x03E19682: 20 91 25 01 lds r18, 0x01259686: 30 91 26 01 lds r19, 0x0126968a: 28 0f add r18, r24968c: 31 1d adc r19, r1968e: 40 91 50 05 lds r20, 0x05509692: 42 9f mul r20, r189694: c0 01 movw r24, r09696: 43 9f mul r20, r199698: 90 0d add r25, r0969a: 11 24 eor r1, r1969c: aa 27 eor r26, r26969e: 97 fd sbrc r25, 796a0: a0 95 com r2696a2: ba 2f mov r27, r2696a4: 80 93 fa 03 sts 0x03FA, r2496a8: 90 93 fb 03 sts 0x03FB, r2596ac: a0 93 fc 03 sts 0x03FC, r2696b0: b0 93 fd 03 sts 0x03FD, r27HoehenReglerAktiv = 1;96b4: 81 e0 ldi r24, 0x01 ; 196b6: 80 93 1b 04 sts 0x041B, r24}// calculate cos of nick and roll angle used for projection of the vertical hoover gastmp_int = (int)(IntegralNick/GIER_GRAD_FAKTOR); // nick angle in deg96ba: 40 90 21 01 lds r4, 0x012196be: 50 90 22 01 lds r5, 0x012296c2: 60 90 23 01 lds r6, 0x012396c6: 70 90 24 01 lds r7, 0x0124tmp_int2 = (int)(IntegralRoll/GIER_GRAD_FAKTOR); // roll angle in deg96ca: 60 91 3e 04 lds r22, 0x043E96ce: 70 91 3f 04 lds r23, 0x043F96d2: 80 91 40 04 lds r24, 0x044096d6: 90 91 41 04 lds r25, 0x044196da: a3 01 movw r20, r696dc: 92 01 movw r18, r496de: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>96e2: 2d 83 std Y+5, r18 ; 0x0596e4: 3e 83 std Y+6, r19 ; 0x0696e6: 4f 83 std Y+7, r20 ; 0x0796e8: 58 87 std Y+8, r21 ; 0x08{SollHoehe = ((int16_t) ExternHoehenValue + (int16_t) Parameter_HoehenSchalter) * (int)EE_Parameter.Hoehe_Verstaerkung;HoehenReglerAktiv = 1;}// calculate cos of nick and roll angle used for projection of the vertical hoover gastmp_int = (int)(IntegralNick/GIER_GRAD_FAKTOR); // nick angle in deg96ea: 60 91 42 04 lds r22, 0x044296ee: 70 91 43 04 lds r23, 0x044396f2: 80 91 44 04 lds r24, 0x044496f6: 90 91 45 04 lds r25, 0x044596fa: a3 01 movw r20, r696fc: 92 01 movw r18, r496fe: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>tmp_int2 = (int)(IntegralRoll/GIER_GRAD_FAKTOR); // roll angle in degtmp_int = (int16_t)ihypot(tmp_int, tmp_int2); // phytagoras gives effective attitude angle in deg9702: 6d 81 ldd r22, Y+5 ; 0x059704: 7e 81 ldd r23, Y+6 ; 0x069706: c9 01 movw r24, r189708: 0e 94 a2 0d call 0x1b44 ; 0x1b44 <ihypot>tmp_int = (tmp_int * Parameter_Hoehe_TiltCompensation) / 100;970c: 20 91 36 01 lds r18, 0x01369710: fc 01 movw r30, r249712: 2e 9f mul r18, r309714: c0 01 movw r24, r09716: 2f 9f mul r18, r319718: 90 0d add r25, r0971a: 11 24 eor r1, r1971c: 64 e6 ldi r22, 0x64 ; 100971e: 70 e0 ldi r23, 0x00 ; 09720: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>9724: cb 01 movw r24, r22LIMIT_MAX(tmp_int, 60); // limit effective attitude angle9726: 6c 33 cpi r22, 0x3C ; 609728: 71 05 cpc r23, r1972a: 14 f0 brlt .+4 ; 0x9730 <MotorRegler+0x2724>972c: 8c e3 ldi r24, 0x3C ; 60972e: 90 e0 ldi r25, 0x00 ; 0CosAttitude = c_cos_8192(tmp_int); // cos of actual attitude9730: 0e 94 2d 91 call 0x1225a ; 0x1225a <c_cos_8192>9734: 90 93 2e 06 sts 0x062E, r259738: 80 93 2d 06 sts 0x062D, r24VarioCharacter = ' ';973c: 80 e2 ldi r24, 0x20 ; 32973e: 80 93 20 01 sts 0x0120, r24AltitudeSetpointTrimming = 0;9742: 10 92 f9 03 sts 0x03F9, r19746: 10 92 f8 03 sts 0x03F8, r1if(HoehenReglerAktiv && !(FC_StatusFlags & FC_STATUS_EMERGENCY_LANDING))974a: 80 91 1b 04 lds r24, 0x041B974e: 88 23 and r24, r249750: 09 f4 brne .+2 ; 0x9754 <MotorRegler+0x2748>9752: b5 c7 rjmp .+3946 ; 0xa6be <MotorRegler+0x36b2>9754: 80 91 cb 03 lds r24, 0x03CB9758: 84 fd sbrc r24, 4975a: b1 c7 rjmp .+3938 ; 0xa6be <MotorRegler+0x36b2>// Holger original version// start of height control algorithm// the height control is only an attenuation of the actual gas stick.// I.e. it will work only if the gas stick is higher than the hover gas// and the hover height will be allways larger than height setpoint.FC_StatusFlags2 |= FC_STATUS2_ALTITUDE_CONTROL;975c: 80 91 ca 03 lds r24, 0x03CA9760: 82 60 ori r24, 0x02 ; 29762: 80 93 ca 03 sts 0x03CA, r24if((Parameter_ExtraConfig & CFG2_HEIGHT_LIMIT) || !(Parameter_GlobalConfig & CFG_HOEHEN_SCHALTER)) // Regler wird über Schalter gesteuert)9766: e0 91 40 06 lds r30, 0x0640976a: e0 fd sbrc r30, 0976c: 04 c0 rjmp .+8 ; 0x9776 <MotorRegler+0x276a>976e: 80 91 5c 06 lds r24, 0x065C9772: 81 fd sbrc r24, 19774: 0b c0 rjmp .+22 ; 0x978c <MotorRegler+0x2780>{ // old versionHCGas = GasMischanteil; // take current stick gas as neutral point for the height controlHeightTrimming = 0;9776: 10 92 88 03 sts 0x0388, r1977a: 10 92 87 03 sts 0x0387, r1AltitudeSetpointTrimming = 0;// set both flags to indicate no vario modeFC_StatusFlags |= (FC_STATUS_VARIO_TRIM_UP|FC_STATUS_VARIO_TRIM_DOWN);977e: 80 91 cb 03 lds r24, 0x03CB9782: 80 6c ori r24, 0xC0 ; 1929784: 80 93 cb 03 sts 0x03CB, r24// I.e. it will work only if the gas stick is higher than the hover gas// and the hover height will be allways larger than height setpoint.FC_StatusFlags2 |= FC_STATUS2_ALTITUDE_CONTROL;if((Parameter_ExtraConfig & CFG2_HEIGHT_LIMIT) || !(Parameter_GlobalConfig & CFG_HOEHEN_SCHALTER)) // Regler wird über Schalter gesteuert){ // old versionHCGas = GasMischanteil; // take current stick gas as neutral point for the height control9788: f1 01 movw r30, r2HeightTrimming = 0;AltitudeSetpointTrimming = 0;// set both flags to indicate no vario modeFC_StatusFlags |= (FC_STATUS_VARIO_TRIM_UP|FC_STATUS_VARIO_TRIM_DOWN);978a: 20 c3 rjmp .+1600 ; 0x9dcc <MotorRegler+0x2dc0>{// alternative height control// PD-Control with respect to hoover point// the thrust loss out of horizontal attitude is compensated// the setpoint will be fine adjusted with the gas stick positionif(/*1 || */FC_StatusFlags & FC_STATUS_FLY) // trim setpoint only when flying978c: 80 91 cb 03 lds r24, 0x03CB9790: 81 ff sbrs r24, 19792: ea c2 rjmp .+1492 ; 0x9d68 <MotorRegler+0x2d5c>{ // gas stick is above hoover pointif(StickGas > (StickGasHover + HEIGHT_CONTROL_STICKTHRESHOLD) && !BaroAtUpperLimit)9794: 00 91 0e 04 lds r16, 0x040E9798: 10 91 0f 04 lds r17, 0x040F979c: c0 90 40 01 lds r12, 0x014097a0: d0 90 41 01 lds r13, 0x014197a4: c6 01 movw r24, r1297a6: 0f 96 adiw r24, 0x0f ; 1597a8: 80 17 cp r24, r1697aa: 91 07 cpc r25, r1797ac: 08 f0 brcs .+2 ; 0x97b0 <MotorRegler+0x27a4>97ae: 93 c0 rjmp .+294 ; 0x98d6 <MotorRegler+0x28ca>97b0: 80 91 89 03 lds r24, 0x038997b4: 81 11 cpse r24, r197b6: 8f c0 rjmp .+286 ; 0x98d6 <MotorRegler+0x28ca>{if(FC_StatusFlags & FC_STATUS_VARIO_TRIM_DOWN)97b8: 80 91 cb 03 lds r24, 0x03CB97bc: 88 23 and r24, r2497be: ac f4 brge .+42 ; 0x97ea <MotorRegler+0x27de>{FC_StatusFlags &= ~FC_STATUS_VARIO_TRIM_DOWN;97c0: 80 91 cb 03 lds r24, 0x03CB97c4: 8f 77 andi r24, 0x7F ; 12797c6: 80 93 cb 03 sts 0x03CB, r24SollHoehe = HoehenWertF; // update setpoint to current heigth97ca: 80 91 4a 03 lds r24, 0x034A97ce: 90 91 4b 03 lds r25, 0x034B97d2: a0 91 4c 03 lds r26, 0x034C97d6: b0 91 4d 03 lds r27, 0x034D97da: 80 93 fa 03 sts 0x03FA, r2497de: 90 93 fb 03 sts 0x03FB, r2597e2: a0 93 fc 03 sts 0x03FC, r2697e6: b0 93 fd 03 sts 0x03FD, r27}// Limit the maximum Altitudeif(Parameter_MaximumAltitude && (SollHoehe/100 > Parameter_MaximumAltitude))97ea: 40 90 24 06 lds r4, 0x062497ee: 44 20 and r4, r497f0: a1 f1 breq .+104 ; 0x985a <MotorRegler+0x284e>97f2: 51 2c mov r5, r197f4: 61 2c mov r6, r197f6: 71 2c mov r7, r197f8: 60 91 fa 03 lds r22, 0x03FA97fc: 70 91 fb 03 lds r23, 0x03FB9800: 80 91 fc 03 lds r24, 0x03FC9804: 90 91 fd 03 lds r25, 0x03FD9808: 24 e6 ldi r18, 0x64 ; 100980a: 30 e0 ldi r19, 0x00 ; 0980c: 40 e0 ldi r20, 0x00 ; 0980e: 50 e0 ldi r21, 0x00 ; 09810: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>9814: 42 16 cp r4, r189816: 53 06 cpc r5, r199818: 64 06 cpc r6, r20981a: 75 06 cpc r7, r21981c: f4 f4 brge .+60 ; 0x985a <MotorRegler+0x284e>{AltitudeSetpointTrimming = 0;#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))if(!SpeakHoTT && HoehenWert/95 > Parameter_MaximumAltitude) SpeakHoTT = SPEAK_MAX_ALTITUD;981e: 80 91 57 01 lds r24, 0x01579822: 81 11 cpse r24, r19824: 16 c0 rjmp .+44 ; 0x9852 <MotorRegler+0x2846>9826: 60 91 fe 03 lds r22, 0x03FE982a: 70 91 ff 03 lds r23, 0x03FF982e: 80 91 00 04 lds r24, 0x04009832: 90 91 01 04 lds r25, 0x04019836: 2f e5 ldi r18, 0x5F ; 959838: 30 e0 ldi r19, 0x00 ; 0983a: 40 e0 ldi r20, 0x00 ; 0983c: 50 e0 ldi r21, 0x00 ; 0983e: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>9842: 42 16 cp r4, r189844: 53 06 cpc r5, r199846: 64 06 cpc r6, r209848: 75 06 cpc r7, r21984a: 1c f4 brge .+6 ; 0x9852 <MotorRegler+0x2846>984c: 8a e1 ldi r24, 0x1A ; 26984e: 80 93 57 01 sts 0x0157, r24#endifVarioCharacter = '=';9852: 8d e3 ldi r24, 0x3D ; 619854: 80 93 20 01 sts 0x0120, r249858: 3b c0 rjmp .+118 ; 0x98d0 <MotorRegler+0x28c4>}else{if(HeightDeviation > 20) SollHoehe = HoehenWertF; // update setpoint to current heigth985a: 80 91 85 03 lds r24, 0x0385985e: 90 91 86 03 lds r25, 0x03869862: 45 97 sbiw r24, 0x15 ; 219864: 84 f0 brlt .+32 ; 0x9886 <MotorRegler+0x287a>9866: 80 91 4a 03 lds r24, 0x034A986a: 90 91 4b 03 lds r25, 0x034B986e: a0 91 4c 03 lds r26, 0x034C9872: b0 91 4d 03 lds r27, 0x034D9876: 80 93 fa 03 sts 0x03FA, r24987a: 90 93 fb 03 sts 0x03FB, r25987e: a0 93 fc 03 sts 0x03FC, r269882: b0 93 fd 03 sts 0x03FD, r27FC_StatusFlags |= FC_STATUS_VARIO_TRIM_UP;9886: 80 91 cb 03 lds r24, 0x03CB988a: 80 64 ori r24, 0x40 ; 64988c: 80 93 cb 03 sts 0x03CB, r24AltitudeSetpointTrimming = abs(StickGas - (StickGasHover + HEIGHT_CONTROL_STICKTHRESHOLD));9890: c8 01 movw r24, r169892: 8c 19 sub r24, r129894: 9d 09 sbc r25, r139896: 0f 97 sbiw r24, 0x0f ; 159898: 9c 01 movw r18, r24989a: 99 23 and r25, r25989c: 24 f4 brge .+8 ; 0x98a6 <MotorRegler+0x289a>989e: 22 27 eor r18, r1898a0: 33 27 eor r19, r1998a2: 28 1b sub r18, r2498a4: 39 0b sbc r19, r2598a6: 82 2f mov r24, r1898a8: 93 2f mov r25, r1998aa: 30 93 f9 03 sts 0x03F9, r1998ae: 20 93 f8 03 sts 0x03F8, r18if(LowVoltageLandingActive) AltitudeSetpointTrimming /= 3; // only 33% rising98b2: 20 91 c1 03 lds r18, 0x03C198b6: 22 23 and r18, r1898b8: 41 f0 breq .+16 ; 0x98ca <MotorRegler+0x28be>98ba: 63 e0 ldi r22, 0x03 ; 398bc: 70 e0 ldi r23, 0x00 ; 098be: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>98c2: 70 93 f9 03 sts 0x03F9, r2398c6: 60 93 f8 03 sts 0x03F8, r22VarioCharacter = '+';98ca: 8b e2 ldi r24, 0x2B ; 4398cc: 80 93 20 01 sts 0x0120, r24}WaypointTrimming = 0;98d0: 10 92 f2 03 sts 0x03F2, r198d4: 29 c1 rjmp .+594 ; 0x9b28 <MotorRegler+0x2b1c>} // gas stick is below hoover pointelse if(StickGas < (StickGasHover - HEIGHT_CONTROL_STICKTHRESHOLD) && !BaroAtLowerLimit ) // Minus98d6: c6 01 movw r24, r1298d8: 0f 97 sbiw r24, 0x0f ; 1598da: 08 17 cp r16, r2498dc: 19 07 cpc r17, r2598de: 08 f0 brcs .+2 ; 0x98e2 <MotorRegler+0x28d6>98e0: 42 c0 rjmp .+132 ; 0x9966 <MotorRegler+0x295a>98e2: 80 91 8a 03 lds r24, 0x038A98e6: 81 11 cpse r24, r198e8: 3e c0 rjmp .+124 ; 0x9966 <MotorRegler+0x295a>{if(FC_StatusFlags & FC_STATUS_VARIO_TRIM_UP || (HeightDeviation < -300))98ea: 80 91 cb 03 lds r24, 0x03CB98ee: 86 fd sbrc r24, 698f0: 07 c0 rjmp .+14 ; 0x9900 <MotorRegler+0x28f4>98f2: 80 91 85 03 lds r24, 0x038598f6: 90 91 86 03 lds r25, 0x038698fa: 84 3d cpi r24, 0xD4 ; 21298fc: 9e 4f sbci r25, 0xFE ; 25498fe: ac f4 brge .+42 ; 0x992a <MotorRegler+0x291e>{FC_StatusFlags &= ~FC_STATUS_VARIO_TRIM_UP;9900: 80 91 cb 03 lds r24, 0x03CB9904: 8f 7b andi r24, 0xBF ; 1919906: 80 93 cb 03 sts 0x03CB, r24SollHoehe = HoehenWertF; // update setpoint to current heigth990a: 80 91 4a 03 lds r24, 0x034A990e: 90 91 4b 03 lds r25, 0x034B9912: a0 91 4c 03 lds r26, 0x034C9916: b0 91 4d 03 lds r27, 0x034D991a: 80 93 fa 03 sts 0x03FA, r24991e: 90 93 fb 03 sts 0x03FB, r259922: a0 93 fc 03 sts 0x03FC, r269926: b0 93 fd 03 sts 0x03FD, r27}FC_StatusFlags |= FC_STATUS_VARIO_TRIM_DOWN;992a: 80 91 cb 03 lds r24, 0x03CB992e: 80 68 ori r24, 0x80 ; 1289930: 80 93 cb 03 sts 0x03CB, r24AltitudeSetpointTrimming = -abs(StickGas - (StickGasHover - HEIGHT_CONTROL_STICKTHRESHOLD));9934: 98 01 movw r18, r169936: 2c 19 sub r18, r129938: 3d 09 sbc r19, r13993a: 21 5f subi r18, 0xF1 ; 241993c: 3f 4f sbci r19, 0xFF ; 255993e: c9 01 movw r24, r189940: 99 23 and r25, r259942: 24 f4 brge .+8 ; 0x994c <MotorRegler+0x2940>9944: 88 27 eor r24, r249946: 99 27 eor r25, r259948: 82 1b sub r24, r18994a: 93 0b sbc r25, r19994c: 91 95 neg r25994e: 81 95 neg r249950: 91 09 sbc r25, r19952: 90 93 f9 03 sts 0x03F9, r259956: 80 93 f8 03 sts 0x03F8, r24VarioCharacter = '-';995a: 8d e2 ldi r24, 0x2D ; 45995c: 80 93 20 01 sts 0x0120, r24WaypointTrimming = 0;9960: 10 92 f2 03 sts 0x03F2, r19964: e1 c0 rjmp .+450 ; 0x9b28 <MotorRegler+0x2b1c>}else // Gas Stick in Hover Range{VarioCharacter = '=';9966: 8d e3 ldi r24, 0x3D ; 619968: 80 93 20 01 sts 0x0120, r24if(FromNC_AltitudeSpeed && FromNC_AltitudeSetpoint > SollHoehe) // von NC gesteuert -> Steigen996c: 20 91 f3 03 lds r18, 0x03F39970: 22 23 and r18, r189972: 09 f4 brne .+2 ; 0x9976 <MotorRegler+0x296a>9974: 74 c0 rjmp .+232 ; 0x9a5e <MotorRegler+0x2a52>9976: 40 91 f4 03 lds r20, 0x03F4997a: 50 91 f5 03 lds r21, 0x03F5997e: 60 91 f6 03 lds r22, 0x03F69982: 70 91 f7 03 lds r23, 0x03F79986: 80 91 fa 03 lds r24, 0x03FA998a: 90 91 fb 03 lds r25, 0x03FB998e: a0 91 fc 03 lds r26, 0x03FC9992: b0 91 fd 03 lds r27, 0x03FD9996: 84 17 cp r24, r209998: 95 07 cpc r25, r21999a: a6 07 cpc r26, r22999c: b7 07 cpc r27, r23999e: 64 f5 brge .+88 ; 0x99f8 <MotorRegler+0x29ec>{FC_StatusFlags |= FC_STATUS_VARIO_TRIM_UP;99a0: 80 91 cb 03 lds r24, 0x03CB99a4: 80 64 ori r24, 0x40 ; 6499a6: 80 93 cb 03 sts 0x03CB, r24AltitudeSetpointTrimming = FromNC_AltitudeSpeed;99aa: 82 2f mov r24, r1899ac: 90 e0 ldi r25, 0x00 ; 099ae: 90 93 f9 03 sts 0x03F9, r2599b2: 80 93 f8 03 sts 0x03F8, r24//HeightTrimming += FromNC_AltitudeSpeed;WaypointTrimming = 10;99b6: 8a e0 ldi r24, 0x0A ; 1099b8: 80 93 f2 03 sts 0x03F2, r24VarioCharacter = '^';99bc: 8e e5 ldi r24, 0x5E ; 9499be: 80 93 20 01 sts 0x0120, r24if(FC_StatusFlags & FC_STATUS_VARIO_TRIM_DOWN) // changed from sinking to rising99c2: 80 91 cb 03 lds r24, 0x03CB99c6: 88 23 and r24, r2499c8: 0c f0 brlt .+2 ; 0x99cc <MotorRegler+0x29c0>99ca: ae c0 rjmp .+348 ; 0x9b28 <MotorRegler+0x2b1c>{FC_StatusFlags &= ~FC_STATUS_VARIO_TRIM_DOWN;99cc: 80 91 cb 03 lds r24, 0x03CB99d0: 8f 77 andi r24, 0x7F ; 12799d2: 80 93 cb 03 sts 0x03CB, r24SollHoehe = HoehenWertF; // update setpoint to current heigth99d6: 80 91 4a 03 lds r24, 0x034A99da: 90 91 4b 03 lds r25, 0x034B99de: a0 91 4c 03 lds r26, 0x034C99e2: b0 91 4d 03 lds r27, 0x034D99e6: 80 93 fa 03 sts 0x03FA, r2499ea: 90 93 fb 03 sts 0x03FB, r2599ee: a0 93 fc 03 sts 0x03FC, r2699f2: b0 93 fd 03 sts 0x03FD, r2799f6: 98 c0 rjmp .+304 ; 0x9b28 <MotorRegler+0x2b1c>}}elseif(FromNC_AltitudeSpeed && FromNC_AltitudeSetpoint < SollHoehe) // von NC gesteuert -> sinken99f8: 48 17 cp r20, r2499fa: 59 07 cpc r21, r2599fc: 6a 07 cpc r22, r2699fe: 7b 07 cpc r23, r279a00: 74 f5 brge .+92 ; 0x9a5e <MotorRegler+0x2a52>{FC_StatusFlags |= FC_STATUS_VARIO_TRIM_DOWN;9a02: 80 91 cb 03 lds r24, 0x03CB9a06: 80 68 ori r24, 0x80 ; 1289a08: 80 93 cb 03 sts 0x03CB, r24AltitudeSetpointTrimming = -FromNC_AltitudeSpeed;9a0c: 82 2f mov r24, r189a0e: 90 e0 ldi r25, 0x00 ; 09a10: 91 95 neg r259a12: 81 95 neg r249a14: 91 09 sbc r25, r19a16: 90 93 f9 03 sts 0x03F9, r259a1a: 80 93 f8 03 sts 0x03F8, r24//HeightTrimming -= FromNC_AltitudeSpeed;WaypointTrimming = -10;9a1e: 86 ef ldi r24, 0xF6 ; 2469a20: 80 93 f2 03 sts 0x03F2, r24VarioCharacter = 'v';9a24: 86 e7 ldi r24, 0x76 ; 1189a26: 80 93 20 01 sts 0x0120, r24if(FC_StatusFlags & FC_STATUS_VARIO_TRIM_UP) // changed from rising to sinking9a2a: 80 91 cb 03 lds r24, 0x03CB9a2e: 86 ff sbrs r24, 69a30: 7b c0 rjmp .+246 ; 0x9b28 <MotorRegler+0x2b1c>{FC_StatusFlags &= ~FC_STATUS_VARIO_TRIM_UP;9a32: 80 91 cb 03 lds r24, 0x03CB9a36: 8f 7b andi r24, 0xBF ; 1919a38: 80 93 cb 03 sts 0x03CB, r24SollHoehe = HoehenWertF; // update setpoint to current heigth9a3c: 80 91 4a 03 lds r24, 0x034A9a40: 90 91 4b 03 lds r25, 0x034B9a44: a0 91 4c 03 lds r26, 0x034C9a48: b0 91 4d 03 lds r27, 0x034D9a4c: 80 93 fa 03 sts 0x03FA, r249a50: 90 93 fb 03 sts 0x03FB, r259a54: a0 93 fc 03 sts 0x03FC, r269a58: b0 93 fd 03 sts 0x03FD, r279a5c: 65 c0 rjmp .+202 ; 0x9b28 <MotorRegler+0x2b1c>}}elseif(FC_StatusFlags & (FC_STATUS_VARIO_TRIM_UP|FC_STATUS_VARIO_TRIM_DOWN))9a5e: 80 91 cb 03 lds r24, 0x03CB9a62: 80 7c andi r24, 0xC0 ; 1929a64: 09 f4 brne .+2 ; 0x9a68 <MotorRegler+0x2a5c>9a66: 60 c0 rjmp .+192 ; 0x9b28 <MotorRegler+0x2b1c>{if(!WaypointTrimming) LIMIT_MIN_MAX(SollHoehe, (HoehenWertF-200), (HoehenWertF+200)) // max. 2m Unterschied9a68: 80 91 f2 03 lds r24, 0x03F29a6c: 81 11 cpse r24, r19a6e: 36 c0 rjmp .+108 ; 0x9adc <MotorRegler+0x2ad0>9a70: 80 91 4a 03 lds r24, 0x034A9a74: 90 91 4b 03 lds r25, 0x034B9a78: a0 91 4c 03 lds r26, 0x034C9a7c: b0 91 4d 03 lds r27, 0x034D9a80: 8c 01 movw r16, r249a82: 9d 01 movw r18, r269a84: 08 5c subi r16, 0xC8 ; 2009a86: 11 09 sbc r17, r19a88: 21 09 sbc r18, r19a8a: 31 09 sbc r19, r19a8c: 40 91 fa 03 lds r20, 0x03FA9a90: 50 91 fb 03 lds r21, 0x03FB9a94: 60 91 fc 03 lds r22, 0x03FC9a98: 70 91 fd 03 lds r23, 0x03FD9a9c: 04 17 cp r16, r209a9e: 15 07 cpc r17, r219aa0: 26 07 cpc r18, r229aa2: 37 07 cpc r19, r239aa4: 4c f0 brlt .+18 ; 0x9ab8 <MotorRegler+0x2aac>9aa6: 00 93 fa 03 sts 0x03FA, r169aaa: 10 93 fb 03 sts 0x03FB, r179aae: 20 93 fc 03 sts 0x03FC, r189ab2: 30 93 fd 03 sts 0x03FD, r199ab6: 14 c0 rjmp .+40 ; 0x9ae0 <MotorRegler+0x2ad4>9ab8: 88 53 subi r24, 0x38 ; 569aba: 9f 4f sbci r25, 0xFF ; 2559abc: af 4f sbci r26, 0xFF ; 2559abe: bf 4f sbci r27, 0xFF ; 2559ac0: 48 17 cp r20, r249ac2: 59 07 cpc r21, r259ac4: 6a 07 cpc r22, r269ac6: 7b 07 cpc r23, r279ac8: 5c f0 brlt .+22 ; 0x9ae0 <MotorRegler+0x2ad4>9aca: 80 93 fa 03 sts 0x03FA, r249ace: 90 93 fb 03 sts 0x03FB, r259ad2: a0 93 fc 03 sts 0x03FC, r269ad6: b0 93 fd 03 sts 0x03FD, r279ada: 02 c0 rjmp .+4 ; 0x9ae0 <MotorRegler+0x2ad4>else WaypointTrimming = 0;9adc: 10 92 f2 03 sts 0x03F2, r1FC_StatusFlags &= ~(FC_STATUS_VARIO_TRIM_UP|FC_STATUS_VARIO_TRIM_DOWN);9ae0: 80 91 cb 03 lds r24, 0x03CB9ae4: 8f 73 andi r24, 0x3F ; 639ae6: 80 93 cb 03 sts 0x03CB, r24HeightTrimming = 0;9aea: 10 92 88 03 sts 0x0388, r19aee: 10 92 87 03 sts 0x0387, r1if(Parameter_ExtraConfig & CFG2_VARIO_BEEP) beeptime = 500;9af2: e1 ff sbrs r30, 19af4: 06 c0 rjmp .+12 ; 0x9b02 <MotorRegler+0x2af6>9af6: 84 ef ldi r24, 0xF4 ; 2449af8: 91 e0 ldi r25, 0x01 ; 19afa: 90 93 ce 04 sts 0x04CE, r259afe: 80 93 cd 04 sts 0x04CD, r24if(!StartTrigger && HoehenWert > 50)9b02: 80 91 02 04 lds r24, 0x04029b06: 81 11 cpse r24, r19b08: 0f c0 rjmp .+30 ; 0x9b28 <MotorRegler+0x2b1c>9b0a: 80 91 fe 03 lds r24, 0x03FE9b0e: 90 91 ff 03 lds r25, 0x03FF9b12: a0 91 00 04 lds r26, 0x04009b16: b0 91 01 04 lds r27, 0x04019b1a: c3 97 sbiw r24, 0x33 ; 519b1c: a1 05 cpc r26, r19b1e: b1 05 cpc r27, r19b20: 1c f0 brlt .+6 ; 0x9b28 <MotorRegler+0x2b1c>{StartTrigger = 1;9b22: 81 e0 ldi r24, 0x01 ; 19b24: 80 93 02 04 sts 0x0402, r24}}}// Trim height set pointHeightTrimming += AltitudeSetpointTrimming;9b28: 20 91 87 03 lds r18, 0x03879b2c: 30 91 88 03 lds r19, 0x03889b30: 80 91 f8 03 lds r24, 0x03F89b34: 90 91 f9 03 lds r25, 0x03F99b38: 28 0f add r18, r249b3a: 39 1f adc r19, r259b3c: 30 93 88 03 sts 0x0388, r199b40: 20 93 87 03 sts 0x0387, r18if(abs(HeightTrimming) > 500) // bei Waypoint-Flug ist das ca. die 500Hz9b44: c9 01 movw r24, r189b46: 33 23 and r19, r199b48: 24 f4 brge .+8 ; 0x9b52 <MotorRegler+0x2b46>9b4a: 88 27 eor r24, r249b4c: 99 27 eor r25, r259b4e: 82 1b sub r24, r189b50: 93 0b sbc r25, r199b52: 85 3f cpi r24, 0xF5 ; 2459b54: 91 40 sbci r25, 0x01 ; 19b56: 0c f4 brge .+2 ; 0x9b5a <MotorRegler+0x2b4e>9b58: ef c0 rjmp .+478 ; 0x9d38 <MotorRegler+0x2d2c>{if(WaypointTrimming)9b5a: e0 91 f2 03 lds r30, 0x03F29b5e: ee 23 and r30, r309b60: b1 f1 breq .+108 ; 0x9bce <MotorRegler+0x2bc2>{if(abs(FromNC_AltitudeSetpoint - SollHoehe) < 10) SollHoehe = FromNC_AltitudeSetpoint;9b62: 40 91 f4 03 lds r20, 0x03F49b66: 50 91 f5 03 lds r21, 0x03F59b6a: 60 91 f6 03 lds r22, 0x03F69b6e: 70 91 f7 03 lds r23, 0x03F79b72: 80 91 fa 03 lds r24, 0x03FA9b76: 90 91 fb 03 lds r25, 0x03FB9b7a: a0 91 fc 03 lds r26, 0x03FC9b7e: b0 91 fd 03 lds r27, 0x03FD9b82: 9a 01 movw r18, r209b84: 28 1b sub r18, r249b86: 39 0b sbc r19, r259b88: 27 3f cpi r18, 0xF7 ; 2479b8a: 1f ef ldi r17, 0xFF ; 2559b8c: 31 07 cpc r19, r179b8e: 64 f0 brlt .+24 ; 0x9ba8 <MotorRegler+0x2b9c>9b90: 2a 30 cpi r18, 0x0A ; 109b92: 31 05 cpc r19, r19b94: 4c f4 brge .+18 ; 0x9ba8 <MotorRegler+0x2b9c>9b96: 40 93 fa 03 sts 0x03FA, r209b9a: 50 93 fb 03 sts 0x03FB, r219b9e: 60 93 fc 03 sts 0x03FC, r229ba2: 70 93 fd 03 sts 0x03FD, r239ba6: 4d c0 rjmp .+154 ; 0x9c42 <MotorRegler+0x2c36>else SollHoehe += WaypointTrimming;9ba8: 4e 2f mov r20, r309baa: 55 27 eor r21, r219bac: 47 fd sbrc r20, 79bae: 50 95 com r219bb0: 65 2f mov r22, r219bb2: 75 2f mov r23, r219bb4: 84 0f add r24, r209bb6: 95 1f adc r25, r219bb8: a6 1f adc r26, r229bba: b7 1f adc r27, r239bbc: 80 93 fa 03 sts 0x03FA, r249bc0: 90 93 fb 03 sts 0x03FB, r259bc4: a0 93 fc 03 sts 0x03FC, r269bc8: b0 93 fd 03 sts 0x03FD, r279bcc: 3a c0 rjmp .+116 ; 0x9c42 <MotorRegler+0x2c36>}else{if(HeightTrimming > 0) SollHoehe += EE_Parameter.Hoehe_Verstaerkung / 3;9bce: 12 16 cp r1, r189bd0: 13 06 cpc r1, r199bd2: e4 f4 brge .+56 ; 0x9c0c <MotorRegler+0x2c00>9bd4: 20 91 50 05 lds r18, 0x05509bd8: 8b ea ldi r24, 0xAB ; 1719bda: 28 9f mul r18, r249bdc: 21 2d mov r18, r19bde: 11 24 eor r1, r19be0: 26 95 lsr r189be2: 80 91 fa 03 lds r24, 0x03FA9be6: 90 91 fb 03 lds r25, 0x03FB9bea: a0 91 fc 03 lds r26, 0x03FC9bee: b0 91 fd 03 lds r27, 0x03FD9bf2: 82 0f add r24, r189bf4: 91 1d adc r25, r19bf6: a1 1d adc r26, r19bf8: b1 1d adc r27, r19bfa: 80 93 fa 03 sts 0x03FA, r249bfe: 90 93 fb 03 sts 0x03FB, r259c02: a0 93 fc 03 sts 0x03FC, r269c06: b0 93 fd 03 sts 0x03FD, r279c0a: 1b c0 rjmp .+54 ; 0x9c42 <MotorRegler+0x2c36>else SollHoehe -= EE_Parameter.Hoehe_Verstaerkung / 3;9c0c: 20 91 50 05 lds r18, 0x05509c10: 8b ea ldi r24, 0xAB ; 1719c12: 28 9f mul r18, r249c14: 21 2d mov r18, r19c16: 11 24 eor r1, r19c18: 26 95 lsr r189c1a: 80 91 fa 03 lds r24, 0x03FA9c1e: 90 91 fb 03 lds r25, 0x03FB9c22: a0 91 fc 03 lds r26, 0x03FC9c26: b0 91 fd 03 lds r27, 0x03FD9c2a: 82 1b sub r24, r189c2c: 91 09 sbc r25, r19c2e: a1 09 sbc r26, r19c30: b1 09 sbc r27, r19c32: 80 93 fa 03 sts 0x03FA, r249c36: 90 93 fb 03 sts 0x03FB, r259c3a: a0 93 fc 03 sts 0x03FC, r269c3e: b0 93 fd 03 sts 0x03FD, r27}HeightTrimming = 0;9c42: 10 92 88 03 sts 0x0388, r19c46: 10 92 87 03 sts 0x0387, r1LIMIT_MIN_MAX(HoehenWertF, (HoehenWert-1024), (HoehenWert+1024)); // max. 10m Unterschied9c4a: 80 91 fe 03 lds r24, 0x03FE9c4e: 90 91 ff 03 lds r25, 0x03FF9c52: a0 91 00 04 lds r26, 0x04009c56: b0 91 01 04 lds r27, 0x04019c5a: 8c 01 movw r16, r249c5c: 9d 01 movw r18, r269c5e: 14 50 subi r17, 0x04 ; 49c60: 21 09 sbc r18, r19c62: 31 09 sbc r19, r19c64: 40 91 4a 03 lds r20, 0x034A9c68: 50 91 4b 03 lds r21, 0x034B9c6c: 60 91 4c 03 lds r22, 0x034C9c70: 70 91 4d 03 lds r23, 0x034D9c74: 04 17 cp r16, r209c76: 15 07 cpc r17, r219c78: 26 07 cpc r18, r229c7a: 37 07 cpc r19, r239c7c: 4c f0 brlt .+18 ; 0x9c90 <MotorRegler+0x2c84>9c7e: 00 93 4a 03 sts 0x034A, r169c82: 10 93 4b 03 sts 0x034B, r179c86: 20 93 4c 03 sts 0x034C, r189c8a: 30 93 4d 03 sts 0x034D, r199c8e: 10 c0 rjmp .+32 ; 0x9cb0 <MotorRegler+0x2ca4>9c90: 9c 5f subi r25, 0xFC ; 2529c92: af 4f sbci r26, 0xFF ; 2559c94: bf 4f sbci r27, 0xFF ; 2559c96: 48 17 cp r20, r249c98: 59 07 cpc r21, r259c9a: 6a 07 cpc r22, r269c9c: 7b 07 cpc r23, r279c9e: 44 f0 brlt .+16 ; 0x9cb0 <MotorRegler+0x2ca4>9ca0: 80 93 4a 03 sts 0x034A, r249ca4: 90 93 4b 03 sts 0x034B, r259ca8: a0 93 4c 03 sts 0x034C, r269cac: b0 93 4d 03 sts 0x034D, r27LIMIT_MIN_MAX(SollHoehe, (HoehenWertF-1024), (HoehenWertF+1500)); // max. 15m Unterschied9cb0: 80 91 4a 03 lds r24, 0x034A9cb4: 90 91 4b 03 lds r25, 0x034B9cb8: a0 91 4c 03 lds r26, 0x034C9cbc: b0 91 4d 03 lds r27, 0x034D9cc0: 8c 01 movw r16, r249cc2: 9d 01 movw r18, r269cc4: 14 50 subi r17, 0x04 ; 49cc6: 21 09 sbc r18, r19cc8: 31 09 sbc r19, r19cca: 40 91 fa 03 lds r20, 0x03FA9cce: 50 91 fb 03 lds r21, 0x03FB9cd2: 60 91 fc 03 lds r22, 0x03FC9cd6: 70 91 fd 03 lds r23, 0x03FD9cda: 04 17 cp r16, r209cdc: 15 07 cpc r17, r219cde: 26 07 cpc r18, r229ce0: 37 07 cpc r19, r239ce2: 4c f0 brlt .+18 ; 0x9cf6 <MotorRegler+0x2cea>9ce4: 00 93 fa 03 sts 0x03FA, r169ce8: 10 93 fb 03 sts 0x03FB, r179cec: 20 93 fc 03 sts 0x03FC, r189cf0: 30 93 fd 03 sts 0x03FD, r199cf4: 11 c0 rjmp .+34 ; 0x9d18 <MotorRegler+0x2d0c>9cf6: 84 52 subi r24, 0x24 ; 369cf8: 9a 4f sbci r25, 0xFA ; 2509cfa: af 4f sbci r26, 0xFF ; 2559cfc: bf 4f sbci r27, 0xFF ; 2559cfe: 48 17 cp r20, r249d00: 59 07 cpc r21, r259d02: 6a 07 cpc r22, r269d04: 7b 07 cpc r23, r279d06: 44 f0 brlt .+16 ; 0x9d18 <MotorRegler+0x2d0c>9d08: 80 93 fa 03 sts 0x03FA, r249d0c: 90 93 fb 03 sts 0x03FB, r259d10: a0 93 fc 03 sts 0x03FC, r269d14: b0 93 fd 03 sts 0x03FD, r27if(Parameter_ExtraConfig & CFG2_VARIO_BEEP) beeptime = 100;9d18: 80 91 40 06 lds r24, 0x06409d1c: 81 ff sbrs r24, 19d1e: 06 c0 rjmp .+12 ; 0x9d2c <MotorRegler+0x2d20>9d20: 84 e6 ldi r24, 0x64 ; 1009d22: 90 e0 ldi r25, 0x00 ; 09d24: 90 93 ce 04 sts 0x04CE, r259d28: 80 93 cd 04 sts 0x04CD, r24//update hoover gas stick value when setpoint is shiftedif(FromNC_AltitudeSpeed == 0) CalcStickGasHover();9d2c: 80 91 f3 03 lds r24, 0x03F39d30: 81 11 cpse r24, r19d32: 02 c0 rjmp .+4 ; 0x9d38 <MotorRegler+0x2d2c>9d34: 0e 94 c4 37 call 0x6f88 ; 0x6f88 <CalcStickGasHover>if(StickGasHover < 70) StickGasHover = 70;else if(StickGasHover > 175) StickGasHover = 175;}*/}if(BaroExpandActive) SollHoehe = HoehenWertF; // update setpoint to current altitude if Expanding is active9d38: 80 91 59 04 lds r24, 0x04599d3c: 90 91 5a 04 lds r25, 0x045A9d40: 89 2b or r24, r259d42: 09 f4 brne .+2 ; 0x9d46 <MotorRegler+0x2d3a>9d44: 3f c0 rjmp .+126 ; 0x9dc4 <MotorRegler+0x2db8>9d46: 80 91 4a 03 lds r24, 0x034A9d4a: 90 91 4b 03 lds r25, 0x034B9d4e: a0 91 4c 03 lds r26, 0x034C9d52: b0 91 4d 03 lds r27, 0x034D9d56: 80 93 fa 03 sts 0x03FA, r249d5a: 90 93 fb 03 sts 0x03FB, r259d5e: a0 93 fc 03 sts 0x03FC, r269d62: b0 93 fd 03 sts 0x03FD, r279d66: 2e c0 rjmp .+92 ; 0x9dc4 <MotorRegler+0x2db8>} //if FCFlags & MKFCFLAG_FLYelse{#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))ACC_AltitudeFusion(1); // init the ACC and Altitude fusion9d68: 81 e0 ldi r24, 0x01 ; 19d6a: 0e 94 a0 16 call 0x2d40 ; 0x2d40 <ACC_AltitudeFusion>#endifSollHoehe = HoehenWertF - 2000;9d6e: 80 91 4a 03 lds r24, 0x034A9d72: 90 91 4b 03 lds r25, 0x034B9d76: a0 91 4c 03 lds r26, 0x034C9d7a: b0 91 4d 03 lds r27, 0x034D9d7e: 80 5d subi r24, 0xD0 ; 2089d80: 97 40 sbci r25, 0x07 ; 79d82: a1 09 sbc r26, r19d84: b1 09 sbc r27, r19d86: 80 93 fa 03 sts 0x03FA, r249d8a: 90 93 fb 03 sts 0x03FB, r259d8e: a0 93 fc 03 sts 0x03FC, r269d92: b0 93 fd 03 sts 0x03FD, r27if(EE_Parameter.Hoehe_StickNeutralPoint) StickGasHover = EE_Parameter.Hoehe_StickNeutralPoint;9d96: 80 91 54 05 lds r24, 0x05549d9a: 88 23 and r24, r249d9c: 31 f0 breq .+12 ; 0x9daa <MotorRegler+0x2d9e>9d9e: 90 e0 ldi r25, 0x00 ; 09da0: 90 93 41 01 sts 0x0141, r259da4: 80 93 40 01 sts 0x0140, r249da8: 06 c0 rjmp .+12 ; 0x9db6 <MotorRegler+0x2daa>else StickGasHover = 127;9daa: 8f e7 ldi r24, 0x7F ; 1279dac: 90 e0 ldi r25, 0x00 ; 09dae: 90 93 41 01 sts 0x0141, r259db2: 80 93 40 01 sts 0x0140, r24HoverGas = GasMischanteil;9db6: 30 92 e9 03 sts 0x03E9, r39dba: 20 92 e8 03 sts 0x03E8, r2VarioCharacter = '.';9dbe: 8e e2 ldi r24, 0x2E ; 469dc0: 80 93 20 01 sts 0x0120, r24}HCGas = HoverGas; // take hover gas (neutral point)9dc4: e0 91 e8 03 lds r30, 0x03E89dc8: f0 91 e9 03 lds r31, 0x03E9}if(HoehenWertF > SollHoehe || !(Parameter_ExtraConfig & CFG2_HEIGHT_LIMIT))9dcc: 80 91 4a 03 lds r24, 0x034A9dd0: 90 91 4b 03 lds r25, 0x034B9dd4: a0 91 4c 03 lds r26, 0x034C9dd8: b0 91 4d 03 lds r27, 0x034D9ddc: 40 91 fa 03 lds r20, 0x03FA9de0: 50 91 fb 03 lds r21, 0x03FB9de4: 60 91 fc 03 lds r22, 0x03FC9de8: 70 91 fd 03 lds r23, 0x03FD9dec: 48 17 cp r20, r249dee: 59 07 cpc r21, r259df0: 6a 07 cpc r22, r269df2: 7b 07 cpc r23, r279df4: 24 f0 brlt .+8 ; 0x9dfe <MotorRegler+0x2df2>9df6: 20 91 40 06 lds r18, 0x06409dfa: 20 fd sbrc r18, 09dfc: 70 c4 rjmp .+2272 ; 0xa6de <MotorRegler+0x36d2>{if(!ACC_AltitudeControl)9dfe: 20 91 c2 03 lds r18, 0x03C29e02: 21 11 cpse r18, r19e04: 7e c2 rjmp .+1276 ; 0xa302 <MotorRegler+0x32f6>{// from this point the Heigth Control Algorithm is identical for both versionsif(BaroExpandActive) // baro range expanding active9e06: 20 91 59 04 lds r18, 0x04599e0a: 30 91 5a 04 lds r19, 0x045A9e0e: 23 2b or r18, r199e10: 59 f0 breq .+22 ; 0x9e28 <MotorRegler+0x2e1c>{HCGas = HoverGas; // hover while expanding baro adc range9e12: e0 91 e8 03 lds r30, 0x03E89e16: f0 91 e9 03 lds r31, 0x03E9HeightDeviation = 0;9e1a: 10 92 86 03 sts 0x0386, r19e1e: 10 92 85 03 sts 0x0385, r1if((Parameter_GlobalConfig & CFG_HOEHENREGELUNG) && !(Looping_Roll || Looping_Nick) && !(VersionInfo.HardwareError[0] & 0x7F)) // Höhenregelung{#define HOVER_GAS_AVERAGE 16384L // 16384 * 2ms = 32s averaging#define HC_GAS_AVERAGE 4 // 4 * 2ms= 8ms averagingint HCGas, GasReduction = 0;9e22: c1 2c mov r12, r19e24: d1 2c mov r13, r19e26: ea c0 rjmp .+468 ; 0x9ffc <MotorRegler+0x2ff0>HeightDeviation = 0;} // EOF // baro range expanding activeelse // valid data from air pressure sensor{// ------------------------- P-Part ----------------------------tmp_long = (HoehenWertF - SollHoehe); // positive when too high9e28: 84 1b sub r24, r209e2a: 95 0b sbc r25, r219e2c: a6 0b sbc r26, r229e2e: b7 0b sbc r27, r23LIMIT_MIN_MAX(tmp_long, -32767L, 32767L); // avoid overflov when casting to int16_t9e30: 82 30 cpi r24, 0x02 ; 29e32: 20 e8 ldi r18, 0x80 ; 1289e34: 92 07 cpc r25, r189e36: 2f ef ldi r18, 0xFF ; 2559e38: a2 07 cpc r26, r189e3a: b2 07 cpc r27, r189e3c: 6c f4 brge .+26 ; 0x9e58 <MotorRegler+0x2e4c>9e3e: 81 e0 ldi r24, 0x01 ; 19e40: 90 e8 ldi r25, 0x80 ; 1289e42: af ef ldi r26, 0xFF ; 2559e44: bf ef ldi r27, 0xFF ; 2559e46: 80 93 81 03 sts 0x0381, r249e4a: 90 93 82 03 sts 0x0382, r259e4e: a0 93 83 03 sts 0x0383, r269e52: b0 93 84 03 sts 0x0384, r279e56: 1b c0 rjmp .+54 ; 0x9e8e <MotorRegler+0x2e82>9e58: 8f 3f cpi r24, 0xFF ; 2559e5a: 3f e7 ldi r19, 0x7F ; 1279e5c: 93 07 cpc r25, r199e5e: a1 05 cpc r26, r19e60: b1 05 cpc r27, r19e62: 4c f4 brge .+18 ; 0x9e76 <MotorRegler+0x2e6a>HeightDeviation = 0;} // EOF // baro range expanding activeelse // valid data from air pressure sensor{// ------------------------- P-Part ----------------------------tmp_long = (HoehenWertF - SollHoehe); // positive when too high9e64: 80 93 81 03 sts 0x0381, r249e68: 90 93 82 03 sts 0x0382, r259e6c: a0 93 83 03 sts 0x0383, r269e70: b0 93 84 03 sts 0x0384, r279e74: 0c c0 rjmp .+24 ; 0x9e8e <MotorRegler+0x2e82>LIMIT_MIN_MAX(tmp_long, -32767L, 32767L); // avoid overflov when casting to int16_t9e76: 8f ef ldi r24, 0xFF ; 2559e78: 9f e7 ldi r25, 0x7F ; 1279e7a: a0 e0 ldi r26, 0x00 ; 09e7c: b0 e0 ldi r27, 0x00 ; 09e7e: 80 93 81 03 sts 0x0381, r249e82: 90 93 82 03 sts 0x0382, r259e86: a0 93 83 03 sts 0x0383, r269e8a: b0 93 84 03 sts 0x0384, r27HeightDeviation = (int)(tmp_long); // positive when too high9e8e: 20 91 81 03 lds r18, 0x03819e92: 30 91 82 03 lds r19, 0x03829e96: 40 91 83 03 lds r20, 0x03839e9a: 50 91 84 03 lds r21, 0x03849e9e: 30 93 86 03 sts 0x0386, r199ea2: 20 93 85 03 sts 0x0385, r18tmp_long = (tmp_long * (long)Parameter_Hoehe_P) / 32L; // p-part9ea6: a0 91 39 01 lds r26, 0x01399eaa: b0 e0 ldi r27, 0x00 ; 09eac: 0e 94 c8 b1 call 0x16390 ; 0x16390 <__muluhisi3>9eb0: 8b 01 movw r16, r229eb2: 9c 01 movw r18, r249eb4: 99 23 and r25, r259eb6: 24 f4 brge .+8 ; 0x9ec0 <MotorRegler+0x2eb4>9eb8: 01 5e subi r16, 0xE1 ; 2259eba: 1f 4f sbci r17, 0xFF ; 2559ebc: 2f 4f sbci r18, 0xFF ; 2559ebe: 3f 4f sbci r19, 0xFF ; 2559ec0: d9 01 movw r26, r189ec2: c8 01 movw r24, r169ec4: 68 94 set9ec6: 14 f8 bld r1, 49ec8: b5 95 asr r279eca: a7 95 ror r269ecc: 97 95 ror r259ece: 87 95 ror r249ed0: 16 94 lsr r19ed2: d1 f7 brne .-12 ; 0x9ec8 <MotorRegler+0x2ebc>LIMIT_MIN_MAX(tmp_long, -127 * STICK_GAIN, 256 * STICK_GAIN); // more than the full range makes no sense9ed4: 85 30 cpi r24, 0x05 ; 59ed6: 4e ef ldi r20, 0xFE ; 2549ed8: 94 07 cpc r25, r209eda: 4f ef ldi r20, 0xFF ; 2559edc: a4 07 cpc r26, r209ede: b4 07 cpc r27, r209ee0: 6c f4 brge .+26 ; 0x9efc <MotorRegler+0x2ef0>9ee2: 84 e0 ldi r24, 0x04 ; 49ee4: 9e ef ldi r25, 0xFE ; 2549ee6: af ef ldi r26, 0xFF ; 2559ee8: bf ef ldi r27, 0xFF ; 2559eea: 80 93 81 03 sts 0x0381, r249eee: 90 93 82 03 sts 0x0382, r259ef2: a0 93 83 03 sts 0x0383, r269ef6: b0 93 84 03 sts 0x0384, r279efa: 1b c0 rjmp .+54 ; 0x9f32 <MotorRegler+0x2f26>9efc: 81 15 cp r24, r19efe: 54 e0 ldi r21, 0x04 ; 49f00: 95 07 cpc r25, r219f02: a1 05 cpc r26, r19f04: b1 05 cpc r27, r19f06: 4c f4 brge .+18 ; 0x9f1a <MotorRegler+0x2f0e>{// ------------------------- P-Part ----------------------------tmp_long = (HoehenWertF - SollHoehe); // positive when too highLIMIT_MIN_MAX(tmp_long, -32767L, 32767L); // avoid overflov when casting to int16_tHeightDeviation = (int)(tmp_long); // positive when too hightmp_long = (tmp_long * (long)Parameter_Hoehe_P) / 32L; // p-part9f08: 80 93 81 03 sts 0x0381, r249f0c: 90 93 82 03 sts 0x0382, r259f10: a0 93 83 03 sts 0x0383, r269f14: b0 93 84 03 sts 0x0384, r279f18: 0c c0 rjmp .+24 ; 0x9f32 <MotorRegler+0x2f26>LIMIT_MIN_MAX(tmp_long, -127 * STICK_GAIN, 256 * STICK_GAIN); // more than the full range makes no sense9f1a: 80 e0 ldi r24, 0x00 ; 09f1c: 94 e0 ldi r25, 0x04 ; 49f1e: a0 e0 ldi r26, 0x00 ; 09f20: b0 e0 ldi r27, 0x00 ; 09f22: 80 93 81 03 sts 0x0381, r249f26: 90 93 82 03 sts 0x0382, r259f2a: a0 93 83 03 sts 0x0383, r269f2e: b0 93 84 03 sts 0x0384, r27GasReduction = tmp_long;9f32: 40 91 81 03 lds r20, 0x03819f36: 50 91 82 03 lds r21, 0x0382// ------------------------- D-Part 1: Vario Meter ----------------------------tmp_int = VarioMeter / 8;9f3a: a0 91 54 03 lds r26, 0x03549f3e: b0 91 55 03 lds r27, 0x03559f42: bb 23 and r27, r279f44: 0c f4 brge .+2 ; 0x9f48 <MotorRegler+0x2f3c>9f46: 17 96 adiw r26, 0x07 ; 79f48: b5 95 asr r279f4a: a7 95 ror r269f4c: b5 95 asr r279f4e: a7 95 ror r269f50: b5 95 asr r279f52: a7 95 ror r26LIMIT_MIN_MAX(tmp_int, -127, 128);9f54: a2 38 cpi r26, 0x82 ; 1309f56: 6f ef ldi r22, 0xFF ; 2559f58: b6 07 cpc r27, r229f5a: 24 f0 brlt .+8 ; 0x9f64 <MotorRegler+0x2f58>9f5c: a0 38 cpi r26, 0x80 ; 1289f5e: b1 05 cpc r27, r19f60: 24 f4 brge .+8 ; 0x9f6a <MotorRegler+0x2f5e>9f62: 05 c0 rjmp .+10 ; 0x9f6e <MotorRegler+0x2f62>9f64: a1 e8 ldi r26, 0x81 ; 1299f66: bf ef ldi r27, 0xFF ; 2559f68: 02 c0 rjmp .+4 ; 0x9f6e <MotorRegler+0x2f62>9f6a: a0 e8 ldi r26, 0x80 ; 1289f6c: b0 e0 ldi r27, 0x00 ; 0tmp_int = (tmp_int * (long)Parameter_Luftdruck_D) / 4L; // scale to d-gain parameter9f6e: 20 91 3a 01 lds r18, 0x013A9f72: 30 e0 ldi r19, 0x00 ; 09f74: 0e 94 c2 b1 call 0x16384 ; 0x16384 <__usmulhisi3>9f78: 8b 01 movw r16, r229f7a: 9c 01 movw r18, r249f7c: 99 23 and r25, r259f7e: 24 f4 brge .+8 ; 0x9f88 <MotorRegler+0x2f7c>9f80: 0d 5f subi r16, 0xFD ; 2539f82: 1f 4f sbci r17, 0xFF ; 2559f84: 2f 4f sbci r18, 0xFF ; 2559f86: 3f 4f sbci r19, 0xFF ; 2559f88: d9 01 movw r26, r189f8a: c8 01 movw r24, r169f8c: b5 95 asr r279f8e: a7 95 ror r269f90: 97 95 ror r259f92: 87 95 ror r249f94: b5 95 asr r279f96: a7 95 ror r269f98: 97 95 ror r259f9a: 87 95 ror r24LIMIT_MIN_MAX(tmp_int,-64 * STICK_GAIN, 64 * STICK_GAIN);9f9c: 81 30 cpi r24, 0x01 ; 19f9e: 7f ef ldi r23, 0xFF ; 2559fa0: 97 07 cpc r25, r239fa2: 2c f0 brlt .+10 ; 0x9fae <MotorRegler+0x2fa2>9fa4: 8f 3f cpi r24, 0xFF ; 2559fa6: 91 05 cpc r25, r19fa8: 09 f0 breq .+2 ; 0x9fac <MotorRegler+0x2fa0>9faa: 24 f4 brge .+8 ; 0x9fb4 <MotorRegler+0x2fa8>9fac: 05 c0 rjmp .+10 ; 0x9fb8 <MotorRegler+0x2fac>9fae: 80 e0 ldi r24, 0x00 ; 09fb0: 9f ef ldi r25, 0xFF ; 2559fb2: 02 c0 rjmp .+4 ; 0x9fb8 <MotorRegler+0x2fac>9fb4: 80 e0 ldi r24, 0x00 ; 09fb6: 91 e0 ldi r25, 0x01 ; 1if(FC_StatusFlags & (FC_STATUS_VARIO_TRIM_UP|FC_STATUS_VARIO_TRIM_DOWN)) tmp_int /= 4; // reduce d-part while trimming setpoint9fb8: 20 91 cb 03 lds r18, 0x03CB9fbc: 20 7c andi r18, 0xC0 ; 1929fbe: 59 f0 breq .+22 ; 0x9fd6 <MotorRegler+0x2fca>9fc0: 9c 01 movw r18, r249fc2: 99 23 and r25, r259fc4: 14 f4 brge .+4 ; 0x9fca <MotorRegler+0x2fbe>9fc6: 2d 5f subi r18, 0xFD ; 2539fc8: 3f 4f sbci r19, 0xFF ; 2559fca: c9 01 movw r24, r189fcc: 95 95 asr r259fce: 87 95 ror r249fd0: 95 95 asr r259fd2: 87 95 ror r249fd4: 10 c0 rjmp .+32 ; 0x9ff6 <MotorRegler+0x2fea>elseif(Parameter_ExtraConfig & CFG2_HEIGHT_LIMIT) tmp_int /= 8; // reduce d-part in "Deckel" mode9fd6: 20 91 40 06 lds r18, 0x06409fda: 20 ff sbrs r18, 09fdc: 0c c0 rjmp .+24 ; 0x9ff6 <MotorRegler+0x2fea>9fde: 9c 01 movw r18, r249fe0: 99 23 and r25, r259fe2: 14 f4 brge .+4 ; 0x9fe8 <MotorRegler+0x2fdc>9fe4: 29 5f subi r18, 0xF9 ; 2499fe6: 3f 4f sbci r19, 0xFF ; 2559fe8: c9 01 movw r24, r189fea: 95 95 asr r259fec: 87 95 ror r249fee: 95 95 asr r259ff0: 87 95 ror r249ff2: 95 95 asr r259ff4: 87 95 ror r24GasReduction += tmp_int;9ff6: 6a 01 movw r12, r209ff8: c8 0e add r12, r249ffa: d9 1e adc r13, r25} // EOF no baro range expanding// ------------------------ D-Part 2: ACC-Z Integral ------------------------if(Parameter_Hoehe_ACC_Wirkung)9ffc: a0 91 38 01 lds r26, 0x0138a000: aa 23 and r26, r26a002: 09 f4 brne .+2 ; 0xa006 <MotorRegler+0x2ffa>a004: 61 c0 rjmp .+194 ; 0xa0c8 <MotorRegler+0x30bc>{tmp_long = ((Mess_Integral_Hoch / 128L) * (int32_t) Parameter_Hoehe_ACC_Wirkung) / (128L / STICK_GAIN);a006: 40 91 1e 04 lds r20, 0x041Ea00a: 50 91 1f 04 lds r21, 0x041Fa00e: 60 91 20 04 lds r22, 0x0420a012: 70 91 21 04 lds r23, 0x0421a016: 77 23 and r23, r23a018: 24 f4 brge .+8 ; 0xa022 <MotorRegler+0x3016>a01a: 41 58 subi r20, 0x81 ; 129a01c: 5f 4f sbci r21, 0xFF ; 255a01e: 6f 4f sbci r22, 0xFF ; 255a020: 7f 4f sbci r23, 0xFF ; 255a022: 9a 01 movw r18, r20a024: ab 01 movw r20, r22a026: 68 94 seta028: 16 f8 bld r1, 6a02a: 55 95 asr r21a02c: 47 95 ror r20a02e: 37 95 ror r19a030: 27 95 ror r18a032: 16 94 lsr r1a034: d1 f7 brne .-12 ; 0xa02a <MotorRegler+0x301e>a036: b0 e0 ldi r27, 0x00 ; 0a038: 0e 94 c8 b1 call 0x16390 ; 0x16390 <__muluhisi3>a03c: 8b 01 movw r16, r22a03e: 9c 01 movw r18, r24a040: 99 23 and r25, r25a042: 24 f4 brge .+8 ; 0xa04c <MotorRegler+0x3040>a044: 01 5e subi r16, 0xE1 ; 225a046: 1f 4f sbci r17, 0xFF ; 255a048: 2f 4f sbci r18, 0xFF ; 255a04a: 3f 4f sbci r19, 0xFF ; 255a04c: d9 01 movw r26, r18a04e: c8 01 movw r24, r16a050: 68 94 seta052: 14 f8 bld r1, 4a054: b5 95 asr r27a056: a7 95 ror r26a058: 97 95 ror r25a05a: 87 95 ror r24a05c: 16 94 lsr r1a05e: d1 f7 brne .-12 ; 0xa054 <MotorRegler+0x3048>LIMIT_MIN_MAX(tmp_long, -32 * STICK_GAIN, 64 * STICK_GAIN);a060: 81 38 cpi r24, 0x81 ; 129a062: 0f ef ldi r16, 0xFF ; 255a064: 90 07 cpc r25, r16a066: a0 07 cpc r26, r16a068: b0 07 cpc r27, r16a06a: 6c f4 brge .+26 ; 0xa086 <MotorRegler+0x307a>a06c: 80 e8 ldi r24, 0x80 ; 128a06e: 9f ef ldi r25, 0xFF ; 255a070: af ef ldi r26, 0xFF ; 255a072: bf ef ldi r27, 0xFF ; 255a074: 80 93 81 03 sts 0x0381, r24a078: 90 93 82 03 sts 0x0382, r25a07c: a0 93 83 03 sts 0x0383, r26a080: b0 93 84 03 sts 0x0384, r27a084: 1b c0 rjmp .+54 ; 0xa0bc <MotorRegler+0x30b0>a086: 8f 3f cpi r24, 0xFF ; 255a088: 91 05 cpc r25, r1a08a: a1 05 cpc r26, r1a08c: b1 05 cpc r27, r1a08e: 09 f0 breq .+2 ; 0xa092 <MotorRegler+0x3086>a090: 4c f4 brge .+18 ; 0xa0a4 <MotorRegler+0x3098>GasReduction += tmp_int;} // EOF no baro range expanding// ------------------------ D-Part 2: ACC-Z Integral ------------------------if(Parameter_Hoehe_ACC_Wirkung){tmp_long = ((Mess_Integral_Hoch / 128L) * (int32_t) Parameter_Hoehe_ACC_Wirkung) / (128L / STICK_GAIN);a092: 80 93 81 03 sts 0x0381, r24a096: 90 93 82 03 sts 0x0382, r25a09a: a0 93 83 03 sts 0x0383, r26a09e: b0 93 84 03 sts 0x0384, r27a0a2: 0c c0 rjmp .+24 ; 0xa0bc <MotorRegler+0x30b0>LIMIT_MIN_MAX(tmp_long, -32 * STICK_GAIN, 64 * STICK_GAIN);a0a4: 80 e0 ldi r24, 0x00 ; 0a0a6: 91 e0 ldi r25, 0x01 ; 1a0a8: a0 e0 ldi r26, 0x00 ; 0a0aa: b0 e0 ldi r27, 0x00 ; 0a0ac: 80 93 81 03 sts 0x0381, r24a0b0: 90 93 82 03 sts 0x0382, r25a0b4: a0 93 83 03 sts 0x0383, r26a0b8: b0 93 84 03 sts 0x0384, r27GasReduction += tmp_long;a0bc: 80 91 81 03 lds r24, 0x0381a0c0: 90 91 82 03 lds r25, 0x0382a0c4: c8 0e add r12, r24a0c6: d9 1e adc r13, r25/* // ------------------------ D-Part 3: GpsZ ----------------------------------tmp_int = (Parameter_Hoehe_GPS_Z * (int)FromNaviCtrl_Value.GpsZ)/128L;LIMIT_MIN_MAX(tmp_int, -32 * STICK_GAIN, 64 * STICK_GAIN);GasReduction += tmp_int;*/GasReduction = (long)((long)GasReduction * HoverGas) / 512; // scale to the gas valuea0c8: 00 91 e8 03 lds r16, 0x03E8a0cc: 10 91 e9 03 lds r17, 0x03E9a0d0: 96 01 movw r18, r12a0d2: d8 01 movw r26, r16a0d4: 0e 94 ad b1 call 0x1635a ; 0x1635a <__mulhisi3>a0d8: 2b 01 movw r4, r22a0da: 3c 01 movw r6, r24a0dc: 99 23 and r25, r25a0de: 34 f4 brge .+12 ; 0xa0ec <MotorRegler+0x30e0>a0e0: 2f ef ldi r18, 0xFF ; 255a0e2: 42 0e add r4, r18a0e4: 21 e0 ldi r18, 0x01 ; 1a0e6: 52 1e adc r5, r18a0e8: 61 1c adc r6, r1a0ea: 71 1c adc r7, r1a0ec: d3 01 movw r26, r6a0ee: c2 01 movw r24, r4a0f0: 07 2e mov r0, r23a0f2: 79 e0 ldi r23, 0x09 ; 9a0f4: b5 95 asr r27a0f6: a7 95 ror r26a0f8: 97 95 ror r25a0fa: 87 95 ror r24a0fc: 7a 95 dec r23a0fe: d1 f7 brne .-12 ; 0xa0f4 <MotorRegler+0x30e8>a100: 70 2d mov r23, r0// ------------------------ ----------------------------------HCGas -= GasReduction;a102: bf 01 movw r22, r30a104: 68 1b sub r22, r24a106: 79 0b sbc r23, r25// limit deviation from hoover point within the target regionif(!AltitudeSetpointTrimming && HoverGas > 0) // height setpoint is not changed and hoover gas not zeroa108: 80 91 f8 03 lds r24, 0x03F8a10c: 90 91 f9 03 lds r25, 0x03F9a110: 89 2b or r24, r25a112: 09 f0 breq .+2 ; 0xa116 <MotorRegler+0x310a>a114: 79 c0 rjmp .+242 ; 0xa208 <MotorRegler+0x31fc>a116: 10 16 cp r1, r16a118: 11 06 cpc r1, r17a11a: 0c f0 brlt .+2 ; 0xa11e <MotorRegler+0x3112>a11c: 75 c0 rjmp .+234 ; 0xa208 <MotorRegler+0x31fc>{unsigned int tmp;tmp = abs(HeightDeviation);a11e: 20 91 85 03 lds r18, 0x0385a122: 30 91 86 03 lds r19, 0x0386a126: c9 01 movw r24, r18a128: 33 23 and r19, r19a12a: 24 f4 brge .+8 ; 0xa134 <MotorRegler+0x3128>a12c: 88 27 eor r24, r24a12e: 99 27 eor r25, r25a130: 82 1b sub r24, r18a132: 93 0b sbc r25, r19if(tmp <= 60)a134: 8d 33 cpi r24, 0x3D ; 61a136: 91 05 cpc r25, r1a138: 90 f4 brcc .+36 ; 0xa15e <MotorRegler+0x3152>{LIMIT_MIN_MAX(HCGas, HoverGasMin, HoverGasMax); // limit gas around the hoover pointa13a: 80 91 16 04 lds r24, 0x0416a13e: 90 91 17 04 lds r25, 0x0417a142: 86 17 cp r24, r22a144: 97 07 cpc r25, r23a146: 0c f0 brlt .+2 ; 0xa14a <MotorRegler+0x313e>a148: 5c c0 rjmp .+184 ; 0xa202 <MotorRegler+0x31f6>a14a: 80 91 3e 01 lds r24, 0x013Ea14e: 90 91 3f 01 lds r25, 0x013Fa152: 86 17 cp r24, r22a154: 97 07 cpc r25, r23a156: 0c f0 brlt .+2 ; 0xa15a <MotorRegler+0x314e>a158: 57 c0 rjmp .+174 ; 0xa208 <MotorRegler+0x31fc>a15a: bc 01 movw r22, r24a15c: 55 c0 rjmp .+170 ; 0xa208 <MotorRegler+0x31fc>}else{tmp = (tmp - 60) / 32;a15e: cc 97 sbiw r24, 0x3c ; 60a160: 96 95 lsr r25a162: 87 95 ror r24a164: 92 95 swap r25a166: 82 95 swap r24a168: 8f 70 andi r24, 0x0F ; 15a16a: 89 27 eor r24, r25a16c: 9f 70 andi r25, 0x0F ; 15a16e: 89 27 eor r24, r25a170: 80 31 cpi r24, 0x10 ; 16a172: 91 05 cpc r25, r1a174: 10 f0 brcs .+4 ; 0xa17a <MotorRegler+0x316e>a176: 8f e0 ldi r24, 0x0F ; 15a178: 90 e0 ldi r25, 0x00 ; 0if(tmp > 15) tmp = 15;if(HeightDeviation > 0)a17a: 12 16 cp r1, r18a17c: 13 06 cpc r1, r19a17e: 1c f5 brge .+70 ; 0xa1c6 <MotorRegler+0x31ba>{tmp = (HoverGasMin * (16 - tmp)) / 16;a180: 40 e1 ldi r20, 0x10 ; 16a182: 50 e0 ldi r21, 0x00 ; 0a184: 48 1b sub r20, r24a186: 59 0b sbc r21, r25a188: 20 91 16 04 lds r18, 0x0416a18c: 30 91 17 04 lds r19, 0x0417a190: 42 9f mul r20, r18a192: c0 01 movw r24, r0a194: 43 9f mul r20, r19a196: 90 0d add r25, r0a198: 52 9f mul r21, r18a19a: 90 0d add r25, r0a19c: 11 24 eor r1, r1a19e: 92 95 swap r25a1a0: 82 95 swap r24a1a2: 8f 70 andi r24, 0x0F ; 15a1a4: 89 27 eor r24, r25a1a6: 9f 70 andi r25, 0x0F ; 15a1a8: 89 27 eor r24, r25LIMIT_MIN_MAX(HCGas, tmp, HoverGasMax); // limit gas around the hoover pointa1aa: 86 17 cp r24, r22a1ac: 97 07 cpc r25, r23a1ae: 10 f0 brcs .+4 ; 0xa1b4 <MotorRegler+0x31a8>a1b0: bc 01 movw r22, r24a1b2: 2a c0 rjmp .+84 ; 0xa208 <MotorRegler+0x31fc>a1b4: 80 91 3e 01 lds r24, 0x013Ea1b8: 90 91 3f 01 lds r25, 0x013Fa1bc: 86 17 cp r24, r22a1be: 97 07 cpc r25, r23a1c0: 1c f5 brge .+70 ; 0xa208 <MotorRegler+0x31fc>a1c2: bc 01 movw r22, r24a1c4: 21 c0 rjmp .+66 ; 0xa208 <MotorRegler+0x31fc>}else{tmp = (HoverGasMax * (tmp + 16)) / 16;a1c6: 40 96 adiw r24, 0x10 ; 16a1c8: 40 91 3e 01 lds r20, 0x013Ea1cc: 50 91 3f 01 lds r21, 0x013Fa1d0: 84 9f mul r24, r20a1d2: 90 01 movw r18, r0a1d4: 85 9f mul r24, r21a1d6: 30 0d add r19, r0a1d8: 94 9f mul r25, r20a1da: 30 0d add r19, r0a1dc: 11 24 eor r1, r1a1de: 32 95 swap r19a1e0: 22 95 swap r18a1e2: 2f 70 andi r18, 0x0F ; 15a1e4: 23 27 eor r18, r19a1e6: 3f 70 andi r19, 0x0F ; 15a1e8: 23 27 eor r18, r19LIMIT_MIN_MAX(HCGas, HoverGasMin, tmp); // limit gas around the hoover pointa1ea: 80 91 16 04 lds r24, 0x0416a1ee: 90 91 17 04 lds r25, 0x0417a1f2: 86 17 cp r24, r22a1f4: 97 07 cpc r25, r23a1f6: 3c f4 brge .+14 ; 0xa206 <MotorRegler+0x31fa>a1f8: 62 17 cp r22, r18a1fa: 73 07 cpc r23, r19a1fc: 28 f0 brcs .+10 ; 0xa208 <MotorRegler+0x31fc>a1fe: b9 01 movw r22, r18a200: 03 c0 rjmp .+6 ; 0xa208 <MotorRegler+0x31fc>{unsigned int tmp;tmp = abs(HeightDeviation);if(tmp <= 60){LIMIT_MIN_MAX(HCGas, HoverGasMin, HoverGasMax); // limit gas around the hoover pointa202: bc 01 movw r22, r24a204: 01 c0 rjmp .+2 ; 0xa208 <MotorRegler+0x31fc>LIMIT_MIN_MAX(HCGas, tmp, HoverGasMax); // limit gas around the hoover point}else{tmp = (HoverGasMax * (tmp + 16)) / 16;LIMIT_MIN_MAX(HCGas, HoverGasMin, tmp); // limit gas around the hoover pointa206: bc 01 movw r22, r24}}}// strech control output by inverse attitude projection 1/cos// + 1/cos(angle) ++++++++++++++++++++++++++tmp_long2 = (int32_t)HCGas;a208: cb 01 movw r24, r22a20a: aa 27 eor r26, r26a20c: 97 fd sbrc r25, 7a20e: a0 95 com r26a210: ba 2f mov r27, r26tmp_long2 *= 8192L;a212: bc 01 movw r22, r24a214: cd 01 movw r24, r26a216: 05 2e mov r0, r21a218: 5d e0 ldi r21, 0x0D ; 13a21a: 66 0f add r22, r22a21c: 77 1f adc r23, r23a21e: 88 1f adc r24, r24a220: 99 1f adc r25, r25a222: 5a 95 dec r21a224: d1 f7 brne .-12 ; 0xa21a <MotorRegler+0x320e>a226: 50 2d mov r21, r0tmp_long2 /= CosAttitude;a228: 20 91 2d 06 lds r18, 0x062Da22c: 30 91 2e 06 lds r19, 0x062Ea230: 44 27 eor r20, r20a232: 37 fd sbrc r19, 7a234: 40 95 com r20a236: 54 2f mov r21, r20a238: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>a23c: 20 93 7d 03 sts 0x037D, r18a240: 30 93 7e 03 sts 0x037E, r19a244: 40 93 7f 03 sts 0x037F, r20a248: 50 93 80 03 sts 0x0380, r21HCGas = (int16_t)tmp_long2;// update height control gas averagingFilterHCGas = (FilterHCGas * (HC_GAS_AVERAGE - 1) + HCGas) / HC_GAS_AVERAGE;a24c: 80 91 7b 03 lds r24, 0x037Ba250: 90 91 7c 03 lds r25, 0x037Ca254: bc 01 movw r22, r24a256: 66 0f add r22, r22a258: 77 1f adc r23, r23a25a: 86 0f add r24, r22a25c: 97 1f adc r25, r23a25e: 28 0f add r18, r24a260: 39 1f adc r19, r25a262: 33 23 and r19, r19a264: 14 f4 brge .+4 ; 0xa26a <MotorRegler+0x325e>a266: 2d 5f subi r18, 0xFD ; 253a268: 3f 4f sbci r19, 0xFF ; 255a26a: 35 95 asr r19a26c: 27 95 ror r18a26e: 35 95 asr r19a270: 27 95 ror r18a272: 30 93 7c 03 sts 0x037C, r19a276: 20 93 7b 03 sts 0x037B, r18// limit height control gas pd-control outputLIMIT_MIN_MAX(FilterHCGas, EE_Parameter.Hoehe_MinGas * STICK_GAIN, (MAX_GAS - 20) * STICK_GAIN);a27a: 80 91 4c 05 lds r24, 0x054Ca27e: 90 e0 ldi r25, 0x00 ; 0a280: 88 0f add r24, r24a282: 99 1f adc r25, r25a284: 88 0f add r24, r24a286: 99 1f adc r25, r25a288: 82 17 cp r24, r18a28a: 93 07 cpc r25, r19a28c: 2c f0 brlt .+10 ; 0xa298 <MotorRegler+0x328c>a28e: 90 93 7c 03 sts 0x037C, r25a292: 80 93 7b 03 sts 0x037B, r24a296: 0f c0 rjmp .+30 ; 0xa2b6 <MotorRegler+0x32aa>a298: 80 91 64 06 lds r24, 0x0664a29c: 90 e0 ldi r25, 0x00 ; 0a29e: 44 97 sbiw r24, 0x14 ; 20a2a0: 88 0f add r24, r24a2a2: 99 1f adc r25, r25a2a4: 88 0f add r24, r24a2a6: 99 1f adc r25, r25a2a8: 28 17 cp r18, r24a2aa: 39 07 cpc r19, r25a2ac: 24 f0 brlt .+8 ; 0xa2b6 <MotorRegler+0x32aa>a2ae: 90 93 7c 03 sts 0x037C, r25a2b2: 80 93 7b 03 sts 0x037B, r24// set GasMischanteil to HeightControlGasFilterif(Parameter_ExtraConfig & CFG2_HEIGHT_LIMIT)a2b6: 80 91 40 06 lds r24, 0x0640a2ba: 80 ff sbrs r24, 0a2bc: 10 c0 rjmp .+32 ; 0xa2de <MotorRegler+0x32d2>{ // old versionLIMIT_MAX(FilterHCGas, GasMischanteil); // nicht mehr als Gasa2be: 80 91 7b 03 lds r24, 0x037Ba2c2: 90 91 7c 03 lds r25, 0x037Ca2c6: 82 15 cp r24, r2a2c8: 93 05 cpc r25, r3a2ca: 24 f0 brlt .+8 ; 0xa2d4 <MotorRegler+0x32c8>a2cc: 30 92 7c 03 sts 0x037C, r3a2d0: 20 92 7b 03 sts 0x037B, r2GasMischanteil = FilterHCGas;a2d4: 20 90 7b 03 lds r2, 0x037Ba2d8: 30 90 7c 03 lds r3, 0x037Ca2dc: 00 c2 rjmp .+1024 ; 0xa6de <MotorRegler+0x36d2>}else GasMischanteil = FilterHCGas + (GasMischanteil - HoverGas) / 4; // only in Vario-Modea2de: 20 1a sub r2, r16a2e0: 31 0a sbc r3, r17a2e2: c1 01 movw r24, r2a2e4: 99 23 and r25, r25a2e6: 0c f4 brge .+2 ; 0xa2ea <MotorRegler+0x32de>a2e8: 03 96 adiw r24, 0x03 ; 3a2ea: 95 95 asr r25a2ec: 87 95 ror r24a2ee: 95 95 asr r25a2f0: 87 95 ror r24a2f2: 20 91 7b 03 lds r18, 0x037Ba2f6: 30 91 7c 03 lds r19, 0x037Ca2fa: 1c 01 movw r2, r24a2fc: 22 0e add r2, r18a2fe: 33 1e adc r3, r19a300: ee c1 rjmp .+988 ; 0xa6de <MotorRegler+0x36d2>}#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))else // ACC-Altitude control{// from this point the Heigth Control Algorithm is identical for both versionsif(BaroExpandActive) // baro range expanding activea302: 20 91 59 04 lds r18, 0x0459a306: 30 91 5a 04 lds r19, 0x045Aa30a: 23 2b or r18, r19a30c: 59 f0 breq .+22 ; 0xa324 <MotorRegler+0x3318>{HCGas = HoverGas; // hover while expanding baro adc rangea30e: e0 91 e8 03 lds r30, 0x03E8a312: f0 91 e9 03 lds r31, 0x03E9HeightDeviation = 0;a316: 10 92 86 03 sts 0x0386, r1a31a: 10 92 85 03 sts 0x0385, r1if((Parameter_GlobalConfig & CFG_HOEHENREGELUNG) && !(Looping_Roll || Looping_Nick) && !(VersionInfo.HardwareError[0] & 0x7F)) // Höhenregelung{#define HOVER_GAS_AVERAGE 16384L // 16384 * 2ms = 32s averaging#define HC_GAS_AVERAGE 4 // 4 * 2ms= 8ms averagingint HCGas, GasReduction = 0;a31e: 41 2c mov r4, r1a320: 51 2c mov r5, r1a322: 3c c1 rjmp .+632 ; 0xa59c <MotorRegler+0x3590>HeightDeviation = 0;} // EOF // baro range expanding activeelse // valid data from air pressure sensor{// ------------------------- P-Part ----------------------------tmp_long = (HoehenWertF - SollHoehe); // positive when too higha324: 84 1b sub r24, r20a326: 95 0b sbc r25, r21a328: a6 0b sbc r26, r22a32a: b7 0b sbc r27, r23LIMIT_MIN_MAX(tmp_long, -32767L, 32767L); // avoid overflov when casting to int16_ta32c: 82 30 cpi r24, 0x02 ; 2a32e: 30 e8 ldi r19, 0x80 ; 128a330: 93 07 cpc r25, r19a332: 3f ef ldi r19, 0xFF ; 255a334: a3 07 cpc r26, r19a336: b3 07 cpc r27, r19a338: 6c f4 brge .+26 ; 0xa354 <MotorRegler+0x3348>a33a: 81 e0 ldi r24, 0x01 ; 1a33c: 90 e8 ldi r25, 0x80 ; 128a33e: af ef ldi r26, 0xFF ; 255a340: bf ef ldi r27, 0xFF ; 255a342: 80 93 81 03 sts 0x0381, r24a346: 90 93 82 03 sts 0x0382, r25a34a: a0 93 83 03 sts 0x0383, r26a34e: b0 93 84 03 sts 0x0384, r27a352: 1b c0 rjmp .+54 ; 0xa38a <MotorRegler+0x337e>a354: 8f 3f cpi r24, 0xFF ; 255a356: 4f e7 ldi r20, 0x7F ; 127a358: 94 07 cpc r25, r20a35a: a1 05 cpc r26, r1a35c: b1 05 cpc r27, r1a35e: 4c f4 brge .+18 ; 0xa372 <MotorRegler+0x3366>HeightDeviation = 0;} // EOF // baro range expanding activeelse // valid data from air pressure sensor{// ------------------------- P-Part ----------------------------tmp_long = (HoehenWertF - SollHoehe); // positive when too higha360: 80 93 81 03 sts 0x0381, r24a364: 90 93 82 03 sts 0x0382, r25a368: a0 93 83 03 sts 0x0383, r26a36c: b0 93 84 03 sts 0x0384, r27a370: 0c c0 rjmp .+24 ; 0xa38a <MotorRegler+0x337e>LIMIT_MIN_MAX(tmp_long, -32767L, 32767L); // avoid overflov when casting to int16_ta372: 8f ef ldi r24, 0xFF ; 255a374: 9f e7 ldi r25, 0x7F ; 127a376: a0 e0 ldi r26, 0x00 ; 0a378: b0 e0 ldi r27, 0x00 ; 0a37a: 80 93 81 03 sts 0x0381, r24a37e: 90 93 82 03 sts 0x0382, r25a382: a0 93 83 03 sts 0x0383, r26a386: b0 93 84 03 sts 0x0384, r27HeightDeviation = (int)(tmp_long); // positive when too higha38a: 20 91 81 03 lds r18, 0x0381a38e: 30 91 82 03 lds r19, 0x0382a392: 40 91 83 03 lds r20, 0x0383a396: 50 91 84 03 lds r21, 0x0384a39a: 30 93 86 03 sts 0x0386, r19a39e: 20 93 85 03 sts 0x0385, r18tmp_long = (tmp_long * (long)Parameter_Hoehe_P) / 32L; // p-parta3a2: a0 91 39 01 lds r26, 0x0139a3a6: b0 e0 ldi r27, 0x00 ; 0a3a8: 0e 94 c8 b1 call 0x16390 ; 0x16390 <__muluhisi3>a3ac: 8b 01 movw r16, r22a3ae: 9c 01 movw r18, r24a3b0: 99 23 and r25, r25a3b2: 24 f4 brge .+8 ; 0xa3bc <MotorRegler+0x33b0>a3b4: 01 5e subi r16, 0xE1 ; 225a3b6: 1f 4f sbci r17, 0xFF ; 255a3b8: 2f 4f sbci r18, 0xFF ; 255a3ba: 3f 4f sbci r19, 0xFF ; 255a3bc: d9 01 movw r26, r18a3be: c8 01 movw r24, r16a3c0: 68 94 seta3c2: 14 f8 bld r1, 4a3c4: b5 95 asr r27a3c6: a7 95 ror r26a3c8: 97 95 ror r25a3ca: 87 95 ror r24a3cc: 16 94 lsr r1a3ce: d1 f7 brne .-12 ; 0xa3c4 <MotorRegler+0x33b8>LIMIT_MIN_MAX(tmp_long, -511 * STICK_GAIN, 512 * STICK_GAIN); // more than full range makes sensea3d0: 85 30 cpi r24, 0x05 ; 5a3d2: 58 ef ldi r21, 0xF8 ; 248a3d4: 95 07 cpc r25, r21a3d6: 5f ef ldi r21, 0xFF ; 255a3d8: a5 07 cpc r26, r21a3da: b5 07 cpc r27, r21a3dc: 6c f4 brge .+26 ; 0xa3f8 <MotorRegler+0x33ec>a3de: 84 e0 ldi r24, 0x04 ; 4a3e0: 98 ef ldi r25, 0xF8 ; 248a3e2: af ef ldi r26, 0xFF ; 255a3e4: bf ef ldi r27, 0xFF ; 255a3e6: 80 93 81 03 sts 0x0381, r24a3ea: 90 93 82 03 sts 0x0382, r25a3ee: a0 93 83 03 sts 0x0383, r26a3f2: b0 93 84 03 sts 0x0384, r27a3f6: 1b c0 rjmp .+54 ; 0xa42e <MotorRegler+0x3422>a3f8: 81 15 cp r24, r1a3fa: 68 e0 ldi r22, 0x08 ; 8a3fc: 96 07 cpc r25, r22a3fe: a1 05 cpc r26, r1a400: b1 05 cpc r27, r1a402: 4c f4 brge .+18 ; 0xa416 <MotorRegler+0x340a>{// ------------------------- P-Part ----------------------------tmp_long = (HoehenWertF - SollHoehe); // positive when too highLIMIT_MIN_MAX(tmp_long, -32767L, 32767L); // avoid overflov when casting to int16_tHeightDeviation = (int)(tmp_long); // positive when too hightmp_long = (tmp_long * (long)Parameter_Hoehe_P) / 32L; // p-parta404: 80 93 81 03 sts 0x0381, r24a408: 90 93 82 03 sts 0x0382, r25a40c: a0 93 83 03 sts 0x0383, r26a410: b0 93 84 03 sts 0x0384, r27a414: 0c c0 rjmp .+24 ; 0xa42e <MotorRegler+0x3422>LIMIT_MIN_MAX(tmp_long, -511 * STICK_GAIN, 512 * STICK_GAIN); // more than full range makes sensea416: 80 e0 ldi r24, 0x00 ; 0a418: 98 e0 ldi r25, 0x08 ; 8a41a: a0 e0 ldi r26, 0x00 ; 0a41c: b0 e0 ldi r27, 0x00 ; 0a41e: 80 93 81 03 sts 0x0381, r24a422: 90 93 82 03 sts 0x0382, r25a426: a0 93 83 03 sts 0x0383, r26a42a: b0 93 84 03 sts 0x0384, r27GasReduction = tmp_long;a42e: 40 90 81 03 lds r4, 0x0381a432: 50 90 82 03 lds r5, 0x0382a436: 60 90 83 03 lds r6, 0x0383a43a: 70 90 84 03 lds r7, 0x0384// ------------------------ D-Part: ACC-Z Integral ------------------------tmp_long = VarioMeter + (AdWertAccHoch * Parameter_Hoehe_ACC_Wirkung)/256;a43e: 40 91 5b 03 lds r20, 0x035Ba442: 50 91 5c 03 lds r21, 0x035Ca446: 20 91 54 03 lds r18, 0x0354a44a: 30 91 55 03 lds r19, 0x0355a44e: 60 91 38 01 lds r22, 0x0138a452: 64 9f mul r22, r20a454: c0 01 movw r24, r0a456: 65 9f mul r22, r21a458: 90 0d add r25, r0a45a: 11 24 eor r1, r1a45c: 99 23 and r25, r25a45e: 14 f4 brge .+4 ; 0xa464 <MotorRegler+0x3458>a460: 81 50 subi r24, 0x01 ; 1a462: 9f 4f sbci r25, 0xFF ; 255a464: 89 2f mov r24, r25a466: 99 0f add r25, r25a468: 99 0b sbc r25, r25a46a: 8c 01 movw r16, r24a46c: 02 0f add r16, r18a46e: 13 1f adc r17, r19a470: 22 27 eor r18, r18a472: 17 fd sbrc r17, 7a474: 20 95 com r18a476: 32 2f mov r19, r18// ------------------------- D-Part: Vario Meter ----------------------------if(WaypointTrimming) {a478: 80 91 f2 03 lds r24, 0x03F2a47c: 88 23 and r24, r24a47e: 79 f0 breq .+30 ; 0xa49e <MotorRegler+0x3492>Variance = AltitudeSetpointTrimming * 8;a480: 80 91 f8 03 lds r24, 0x03F8a484: 90 91 f9 03 lds r25, 0x03F9a488: 88 0f add r24, r24a48a: 99 1f adc r25, r25a48c: 88 0f add r24, r24a48e: 99 1f adc r25, r25a490: 88 0f add r24, r24a492: 99 1f adc r25, r25a494: 90 93 c4 03 sts 0x03C4, r25a498: 80 93 c3 03 sts 0x03C3, r24a49c: 25 c0 rjmp .+74 ; 0xa4e8 <MotorRegler+0x34dc>} else {Variance = AltitudeSetpointTrimming * EE_Parameter.Hoehe_Verstaerkung*9/32;a49e: 60 91 50 05 lds r22, 0x0550a4a2: 40 91 f8 03 lds r20, 0x03F8a4a6: 50 91 f9 03 lds r21, 0x03F9a4aa: 64 9f mul r22, r20a4ac: c0 01 movw r24, r0a4ae: 65 9f mul r22, r21a4b0: 90 0d add r25, r0a4b2: 11 24 eor r1, r1a4b4: ac 01 movw r20, r24a4b6: 44 0f add r20, r20a4b8: 55 1f adc r21, r21a4ba: 44 0f add r20, r20a4bc: 55 1f adc r21, r21a4be: 44 0f add r20, r20a4c0: 55 1f adc r21, r21a4c2: 84 0f add r24, r20a4c4: 95 1f adc r25, r21a4c6: 99 23 and r25, r25a4c8: 0c f4 brge .+2 ; 0xa4cc <MotorRegler+0x34c0>a4ca: 4f 96 adiw r24, 0x1f ; 31a4cc: 95 95 asr r25a4ce: 87 95 ror r24a4d0: 95 95 asr r25a4d2: 87 95 ror r24a4d4: 95 95 asr r25a4d6: 87 95 ror r24a4d8: 95 95 asr r25a4da: 87 95 ror r24a4dc: 95 95 asr r25a4de: 87 95 ror r24a4e0: 90 93 c4 03 sts 0x03C4, r25a4e4: 80 93 c3 03 sts 0x03C3, r24}tmp_long -= (long)Variance;a4e8: 80 91 c3 03 lds r24, 0x03C3a4ec: 90 91 c4 03 lds r25, 0x03C4a4f0: aa 27 eor r26, r26a4f2: 97 fd sbrc r25, 7a4f4: a0 95 com r26a4f6: ba 2f mov r27, r26a4f8: a9 01 movw r20, r18a4fa: 98 01 movw r18, r16a4fc: 28 1b sub r18, r24a4fe: 39 0b sbc r19, r25a500: 4a 0b sbc r20, r26a502: 5b 0b sbc r21, r27tmp_long = (tmp_long * (long)Parameter_Luftdruck_D) / 32; // scale to d-gain parametera504: a0 91 3a 01 lds r26, 0x013Aa508: b0 e0 ldi r27, 0x00 ; 0a50a: 0e 94 c8 b1 call 0x16390 ; 0x16390 <__muluhisi3>a50e: 8b 01 movw r16, r22a510: 9c 01 movw r18, r24a512: 99 23 and r25, r25a514: 24 f4 brge .+8 ; 0xa51e <MotorRegler+0x3512>a516: 01 5e subi r16, 0xE1 ; 225a518: 1f 4f sbci r17, 0xFF ; 255a51a: 2f 4f sbci r18, 0xFF ; 255a51c: 3f 4f sbci r19, 0xFF ; 255a51e: d9 01 movw r26, r18a520: c8 01 movw r24, r16a522: 68 94 seta524: 14 f8 bld r1, 4a526: b5 95 asr r27a528: a7 95 ror r26a52a: 97 95 ror r25a52c: 87 95 ror r24a52e: 16 94 lsr r1a530: d1 f7 brne .-12 ; 0xa526 <MotorRegler+0x351a>LIMIT_MIN_MAX(tmp_long,-511 * STICK_GAIN, 512 * STICK_GAIN);a532: 85 30 cpi r24, 0x05 ; 5a534: 78 ef ldi r23, 0xF8 ; 248a536: 97 07 cpc r25, r23a538: 7f ef ldi r23, 0xFF ; 255a53a: a7 07 cpc r26, r23a53c: b7 07 cpc r27, r23a53e: 6c f4 brge .+26 ; 0xa55a <MotorRegler+0x354e>a540: 84 e0 ldi r24, 0x04 ; 4a542: 98 ef ldi r25, 0xF8 ; 248a544: af ef ldi r26, 0xFF ; 255a546: bf ef ldi r27, 0xFF ; 255a548: 80 93 81 03 sts 0x0381, r24a54c: 90 93 82 03 sts 0x0382, r25a550: a0 93 83 03 sts 0x0383, r26a554: b0 93 84 03 sts 0x0384, r27a558: 1b c0 rjmp .+54 ; 0xa590 <MotorRegler+0x3584>a55a: 81 15 cp r24, r1a55c: 08 e0 ldi r16, 0x08 ; 8a55e: 90 07 cpc r25, r16a560: a1 05 cpc r26, r1a562: b1 05 cpc r27, r1a564: 4c f4 brge .+18 ; 0xa578 <MotorRegler+0x356c>Variance = AltitudeSetpointTrimming * 8;} else {Variance = AltitudeSetpointTrimming * EE_Parameter.Hoehe_Verstaerkung*9/32;}tmp_long -= (long)Variance;tmp_long = (tmp_long * (long)Parameter_Luftdruck_D) / 32; // scale to d-gain parametera566: 80 93 81 03 sts 0x0381, r24a56a: 90 93 82 03 sts 0x0382, r25a56e: a0 93 83 03 sts 0x0383, r26a572: b0 93 84 03 sts 0x0384, r27a576: 0c c0 rjmp .+24 ; 0xa590 <MotorRegler+0x3584>LIMIT_MIN_MAX(tmp_long,-511 * STICK_GAIN, 512 * STICK_GAIN);a578: 80 e0 ldi r24, 0x00 ; 0a57a: 98 e0 ldi r25, 0x08 ; 8a57c: a0 e0 ldi r26, 0x00 ; 0a57e: b0 e0 ldi r27, 0x00 ; 0a580: 80 93 81 03 sts 0x0381, r24a584: 90 93 82 03 sts 0x0382, r25a588: a0 93 83 03 sts 0x0383, r26a58c: b0 93 84 03 sts 0x0384, r27GasReduction += tmp_long;a590: 80 91 81 03 lds r24, 0x0381a594: 90 91 82 03 lds r25, 0x0382a598: 48 0e add r4, r24a59a: 59 1e adc r5, r25} // EOF no baro range expandingHCGas -= GasReduction;a59c: e4 19 sub r30, r4a59e: f5 09 sbc r31, r5LIMIT_MIN_MAX(HCGas, HoverGasMin, HoverGasMax); // limits gas around hover pointa5a0: 60 91 16 04 lds r22, 0x0416a5a4: 70 91 17 04 lds r23, 0x0417a5a8: 6e 17 cp r22, r30a5aa: 7f 07 cpc r23, r31a5ac: 4c f4 brge .+18 ; 0xa5c0 <MotorRegler+0x35b4>a5ae: 80 91 3e 01 lds r24, 0x013Ea5b2: 90 91 3f 01 lds r25, 0x013Fa5b6: bf 01 movw r22, r30a5b8: 8e 17 cp r24, r30a5ba: 9f 07 cpc r25, r31a5bc: 0c f4 brge .+2 ; 0xa5c0 <MotorRegler+0x35b4>a5be: bc 01 movw r22, r24// strech control output by inverse attitude projection 1/cos// + 1/cos(angle) ++++++++++++++++++++++++++tmp_long2 = (int32_t)HCGas;a5c0: cb 01 movw r24, r22a5c2: aa 27 eor r26, r26a5c4: 97 fd sbrc r25, 7a5c6: a0 95 com r26a5c8: ba 2f mov r27, r26tmp_long2 *= 8192L;a5ca: bc 01 movw r22, r24a5cc: cd 01 movw r24, r26a5ce: 05 2e mov r0, r21a5d0: 5d e0 ldi r21, 0x0D ; 13a5d2: 66 0f add r22, r22a5d4: 77 1f adc r23, r23a5d6: 88 1f adc r24, r24a5d8: 99 1f adc r25, r25a5da: 5a 95 dec r21a5dc: d1 f7 brne .-12 ; 0xa5d2 <MotorRegler+0x35c6>a5de: 50 2d mov r21, r0tmp_long2 /= CosAttitude;a5e0: 20 91 2d 06 lds r18, 0x062Da5e4: 30 91 2e 06 lds r19, 0x062Ea5e8: 44 27 eor r20, r20a5ea: 37 fd sbrc r19, 7a5ec: 40 95 com r20a5ee: 54 2f mov r21, r20a5f0: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>a5f4: 20 93 7d 03 sts 0x037D, r18a5f8: 30 93 7e 03 sts 0x037E, r19a5fc: 40 93 7f 03 sts 0x037F, r20a600: 50 93 80 03 sts 0x0380, r21HCGas = (int16_t)tmp_long2;// update height control gas averagingFilterHCGas = (FilterHCGas * (HC_GAS_AVERAGE - 1) + HCGas) / HC_GAS_AVERAGE;a604: 80 91 7b 03 lds r24, 0x037Ba608: 90 91 7c 03 lds r25, 0x037Ca60c: bc 01 movw r22, r24a60e: 66 0f add r22, r22a610: 77 1f adc r23, r23a612: 86 0f add r24, r22a614: 97 1f adc r25, r23a616: 28 0f add r18, r24a618: 39 1f adc r19, r25a61a: 33 23 and r19, r19a61c: 14 f4 brge .+4 ; 0xa622 <MotorRegler+0x3616>a61e: 2d 5f subi r18, 0xFD ; 253a620: 3f 4f sbci r19, 0xFF ; 255a622: 35 95 asr r19a624: 27 95 ror r18a626: 35 95 asr r19a628: 27 95 ror r18a62a: 30 93 7c 03 sts 0x037C, r19a62e: 20 93 7b 03 sts 0x037B, r18// limit height control gas pd-control outputint min;if(GasIsZeroCnt > 400 || (FC_StatusFlags2 & FC_STATUS2_WAIT_FOR_TAKEOFF)) min = EE_Parameter.Gas_Min; else min = EE_Parameter.Hoehe_MinGas;a632: 80 91 c5 03 lds r24, 0x03C5a636: 90 91 c6 03 lds r25, 0x03C6a63a: 81 39 cpi r24, 0x91 ; 145a63c: 91 40 sbci r25, 0x01 ; 1a63e: 20 f4 brcc .+8 ; 0xa648 <MotorRegler+0x363c>a640: 80 91 ca 03 lds r24, 0x03CAa644: 85 ff sbrs r24, 5a646: 04 c0 rjmp .+8 ; 0xa650 <MotorRegler+0x3644>a648: 80 91 58 05 lds r24, 0x0558a64c: 90 e0 ldi r25, 0x00 ; 0a64e: 03 c0 rjmp .+6 ; 0xa656 <MotorRegler+0x364a>a650: 80 91 4c 05 lds r24, 0x054Ca654: 90 e0 ldi r25, 0x00 ; 0LIMIT_MIN_MAX(FilterHCGas, min * STICK_GAIN, (MAX_GAS - 20) * STICK_GAIN)a656: 88 0f add r24, r24a658: 99 1f adc r25, r25a65a: 88 0f add r24, r24a65c: 99 1f adc r25, r25a65e: 82 17 cp r24, r18a660: 93 07 cpc r25, r19a662: 2c f0 brlt .+10 ; 0xa66e <MotorRegler+0x3662>a664: 90 93 7c 03 sts 0x037C, r25a668: 80 93 7b 03 sts 0x037B, r24a66c: 0f c0 rjmp .+30 ; 0xa68c <MotorRegler+0x3680>a66e: 80 91 64 06 lds r24, 0x0664a672: 90 e0 ldi r25, 0x00 ; 0a674: 44 97 sbiw r24, 0x14 ; 20a676: 88 0f add r24, r24a678: 99 1f adc r25, r25a67a: 88 0f add r24, r24a67c: 99 1f adc r25, r25a67e: 28 17 cp r18, r24a680: 39 07 cpc r19, r25a682: 24 f0 brlt .+8 ; 0xa68c <MotorRegler+0x3680>a684: 90 93 7c 03 sts 0x037C, r25a688: 80 93 7b 03 sts 0x037B, r24// set GasMischanteil to HeightControlGasFilterif(Parameter_ExtraConfig & CFG2_HEIGHT_LIMIT)a68c: 80 91 40 06 lds r24, 0x0640a690: 80 ff sbrs r24, 0a692: 10 c0 rjmp .+32 ; 0xa6b4 <MotorRegler+0x36a8>{ // old versionLIMIT_MAX(FilterHCGas, GasMischanteil); // nicht mehr als Gasa694: 80 91 7b 03 lds r24, 0x037Ba698: 90 91 7c 03 lds r25, 0x037Ca69c: 82 15 cp r24, r2a69e: 93 05 cpc r25, r3a6a0: 24 f0 brlt .+8 ; 0xa6aa <MotorRegler+0x369e>a6a2: 30 92 7c 03 sts 0x037C, r3a6a6: 20 92 7b 03 sts 0x037B, r2GasMischanteil = FilterHCGas;a6aa: 20 90 7b 03 lds r2, 0x037Ba6ae: 30 90 7c 03 lds r3, 0x037Ca6b2: 15 c0 rjmp .+42 ; 0xa6de <MotorRegler+0x36d2>}else GasMischanteil = FilterHCGas;a6b4: 20 90 7b 03 lds r2, 0x037Ba6b8: 30 90 7c 03 lds r3, 0x037Ca6bc: 10 c0 rjmp .+32 ; 0xa6de <MotorRegler+0x36d2>}}// EOF height control activeelse // HC not active{//update hoover gas stick value when HC is not activeCalcStickGasHover();a6be: 0e 94 c4 37 call 0x6f88 ; 0x6f88 <CalcStickGasHover>StickGasHover = (unsigned int)((unsigned int) StickGasHover * UBat) / BattLowVoltageWarning;}else StickGasHover = EE_Parameter.Hoehe_StickNeutralPoint;LIMIT_MIN_MAX(StickGasHover, 70, 175); // reserve some range for trim up and down*/FilterHCGas = GasMischanteil;a6c2: 30 92 7c 03 sts 0x037C, r3a6c6: 20 92 7b 03 sts 0x037B, r2// set both flags to indicate no vario modeFC_StatusFlags |= (FC_STATUS_VARIO_TRIM_UP|FC_STATUS_VARIO_TRIM_DOWN);a6ca: 80 91 cb 03 lds r24, 0x03CBa6ce: 80 6c ori r24, 0xC0 ; 192a6d0: 80 93 cb 03 sts 0x03CB, r24FC_StatusFlags2 &= ~FC_STATUS2_ALTITUDE_CONTROL;a6d4: 80 91 ca 03 lds r24, 0x03CAa6d8: 8d 7f andi r24, 0xFD ; 253a6da: 80 93 ca 03 sts 0x03CA, r24}// Hover gas estimation by averaging gas control output on small z-velocities// this is done only if height contol option is selected in global config and aircraft is flyingif((FC_StatusFlags & FC_STATUS_FLY))// && !(FC_SatusFlags & FC_STATUS_EMERGENCY_LANDING))a6de: 80 91 cb 03 lds r24, 0x03CBa6e2: 81 ff sbrs r24, 1a6e4: 35 c1 rjmp .+618 ; 0xa950 <MotorRegler+0x3944>{//if(HoverGasFilter == 0 || StartTrigger == 1) HoverGasFilter = HOVER_GAS_AVERAGE * (unsigned long)(GasMischanteil); // init estimationif(HoverGasFilter == 0 || StartTrigger == 1) HoverGasFilter = HOVER_GAS_AVERAGE * (unsigned long)(HoverGas); // 0.90f: geänderta6e6: 80 91 77 03 lds r24, 0x0377a6ea: 90 91 78 03 lds r25, 0x0378a6ee: a0 91 79 03 lds r26, 0x0379a6f2: b0 91 7a 03 lds r27, 0x037Aa6f6: 89 2b or r24, r25a6f8: 8a 2b or r24, r26a6fa: 8b 2b or r24, r27a6fc: 21 f0 breq .+8 ; 0xa706 <MotorRegler+0x36fa>a6fe: 80 91 02 04 lds r24, 0x0402a702: 81 30 cpi r24, 0x01 ; 1a704: 01 f5 brne .+64 ; 0xa746 <MotorRegler+0x373a>a706: 80 91 e8 03 lds r24, 0x03E8a70a: 90 91 e9 03 lds r25, 0x03E9a70e: aa 27 eor r26, r26a710: 97 fd sbrc r25, 7a712: a0 95 com r26a714: ba 2f mov r27, r26a716: 07 2e mov r0, r23a718: 7e e0 ldi r23, 0x0E ; 14a71a: 88 0f add r24, r24a71c: 99 1f adc r25, r25a71e: aa 1f adc r26, r26a720: bb 1f adc r27, r27a722: 7a 95 dec r23a724: d1 f7 brne .-12 ; 0xa71a <MotorRegler+0x370e>a726: 70 2d mov r23, r0a728: 80 93 77 03 sts 0x0377, r24a72c: 90 93 78 03 sts 0x0378, r25a730: a0 93 79 03 sts 0x0379, r26a734: b0 93 7a 03 sts 0x037A, r27if(StartTrigger == 1) StartTrigger = 2;a738: 80 91 02 04 lds r24, 0x0402a73c: 81 30 cpi r24, 0x01 ; 1a73e: 19 f4 brne .+6 ; 0xa746 <MotorRegler+0x373a>a740: 82 e0 ldi r24, 0x02 ; 2a742: 80 93 02 04 sts 0x0402, r24tmp_long2 = (int32_t)GasMischanteil; // take current thrusttmp_long2 *= CosAttitude; // apply attitude projectiona746: a0 91 2d 06 lds r26, 0x062Da74a: b0 91 2e 06 lds r27, 0x062Ea74e: 91 01 movw r18, r2a750: 0e 94 ad b1 call 0x1635a ; 0x1635a <__mulhisi3>tmp_long2 /= 8192;a754: 8b 01 movw r16, r22a756: 9c 01 movw r18, r24a758: 99 23 and r25, r25a75a: 24 f4 brge .+8 ; 0xa764 <MotorRegler+0x3758>a75c: 01 50 subi r16, 0x01 ; 1a75e: 10 4e sbci r17, 0xE0 ; 224a760: 2f 4f sbci r18, 0xFF ; 255a762: 3f 4f sbci r19, 0xFF ; 255a764: d9 01 movw r26, r18a766: c8 01 movw r24, r16a768: 07 2e mov r0, r23a76a: 7d e0 ldi r23, 0x0D ; 13a76c: b5 95 asr r27a76e: a7 95 ror r26a770: 97 95 ror r25a772: 87 95 ror r24a774: 7a 95 dec r23a776: d1 f7 brne .-12 ; 0xa76c <MotorRegler+0x3760>a778: 70 2d mov r23, r0a77a: 80 93 7d 03 sts 0x037D, r24a77e: 90 93 7e 03 sts 0x037E, r25a782: a0 93 7f 03 sts 0x037F, r26a786: b0 93 80 03 sts 0x0380, r27// average vertical projected thrustif(modell_fliegt < 4000) // the first 8 secondsa78a: 20 91 cc 03 lds r18, 0x03CCa78e: 30 91 cd 03 lds r19, 0x03CDa792: 20 3a cpi r18, 0xA0 ; 160a794: 4f e0 ldi r20, 0x0F ; 15a796: 34 07 cpc r19, r20a798: a8 f5 brcc .+106 ; 0xa804 <MotorRegler+0x37f8>{ // reduce the time constant of averaging by factor of 4 to get much faster a stable valueHoverGasFilter -= HoverGasFilter/(HOVER_GAS_AVERAGE/16L);a79a: 40 91 77 03 lds r20, 0x0377a79e: 50 91 78 03 lds r21, 0x0378a7a2: 60 91 79 03 lds r22, 0x0379a7a6: 70 91 7a 03 lds r23, 0x037Aa7aa: 2a 01 movw r4, r20a7ac: 3b 01 movw r6, r22a7ae: 03 2e mov r0, r19a7b0: 3a e0 ldi r19, 0x0A ; 10a7b2: 76 94 lsr r7a7b4: 67 94 ror r6a7b6: 57 94 ror r5a7b8: 47 94 ror r4a7ba: 3a 95 dec r19a7bc: d1 f7 brne .-12 ; 0xa7b2 <MotorRegler+0x37a6>a7be: 30 2d mov r19, r0a7c0: 44 19 sub r20, r4a7c2: 55 09 sbc r21, r5a7c4: 66 09 sbc r22, r6a7c6: 77 09 sbc r23, r7HoverGasFilter += 16L * tmp_long2;a7c8: 2c 01 movw r4, r24a7ca: 3d 01 movw r6, r26a7cc: 44 0c add r4, r4a7ce: 55 1c adc r5, r5a7d0: 66 1c adc r6, r6a7d2: 77 1c adc r7, r7a7d4: 44 0c add r4, r4a7d6: 55 1c adc r5, r5a7d8: 66 1c adc r6, r6a7da: 77 1c adc r7, r7a7dc: 44 0c add r4, r4a7de: 55 1c adc r5, r5a7e0: 66 1c adc r6, r6a7e2: 77 1c adc r7, r7a7e4: 44 0c add r4, r4a7e6: 55 1c adc r5, r5a7e8: 66 1c adc r6, r6a7ea: 77 1c adc r7, r7a7ec: 44 0d add r20, r4a7ee: 55 1d adc r21, r5a7f0: 66 1d adc r22, r6a7f2: 77 1d adc r23, r7a7f4: 40 93 77 03 sts 0x0377, r20a7f8: 50 93 78 03 sts 0x0378, r21a7fc: 60 93 79 03 sts 0x0379, r22a800: 70 93 7a 03 sts 0x037A, r23}if(modell_fliegt < 8000) // the first 16 secondsa804: 20 34 cpi r18, 0x40 ; 64a806: 3f 41 sbci r19, 0x1F ; 31a808: 60 f5 brcc .+88 ; 0xa862 <MotorRegler+0x3856>{ // reduce the time constant of averaging by factor of 2 to get much faster a stable valueHoverGasFilter -= HoverGasFilter/(HOVER_GAS_AVERAGE/4L);a80a: 40 91 77 03 lds r20, 0x0377a80e: 50 91 78 03 lds r21, 0x0378a812: 60 91 79 03 lds r22, 0x0379a816: 70 91 7a 03 lds r23, 0x037Aa81a: 8a 01 movw r16, r20a81c: 9b 01 movw r18, r22a81e: 0f 2e mov r0, r31a820: fc e0 ldi r31, 0x0C ; 12a822: 36 95 lsr r19a824: 27 95 ror r18a826: 17 95 ror r17a828: 07 95 ror r16a82a: fa 95 dec r31a82c: d1 f7 brne .-12 ; 0xa822 <MotorRegler+0x3816>a82e: f0 2d mov r31, r0a830: 40 1b sub r20, r16a832: 51 0b sbc r21, r17a834: 62 0b sbc r22, r18a836: 73 0b sbc r23, r19HoverGasFilter += 4L * tmp_long2;a838: 88 0f add r24, r24a83a: 99 1f adc r25, r25a83c: aa 1f adc r26, r26a83e: bb 1f adc r27, r27a840: 88 0f add r24, r24a842: 99 1f adc r25, r25a844: aa 1f adc r26, r26a846: bb 1f adc r27, r27a848: 84 0f add r24, r20a84a: 95 1f adc r25, r21a84c: a6 1f adc r26, r22a84e: b7 1f adc r27, r23a850: 80 93 77 03 sts 0x0377, r24a854: 90 93 78 03 sts 0x0378, r25a858: a0 93 79 03 sts 0x0379, r26a85c: b0 93 7a 03 sts 0x037A, r27a860: 41 c0 rjmp .+130 ; 0xa8e4 <MotorRegler+0x38d8>}else //laterif(abs(VarioMeter) < 100 && abs(HoehenWertF - SollHoehe) < 256) // only on small vertical speed & difference is small (only descending)a862: 20 91 54 03 lds r18, 0x0354a866: 30 91 55 03 lds r19, 0x0355a86a: 33 23 and r19, r19a86c: 1c f4 brge .+6 ; 0xa874 <MotorRegler+0x3868>a86e: 31 95 neg r19a870: 21 95 neg r18a872: 31 09 sbc r19, r1a874: 24 36 cpi r18, 0x64 ; 100a876: 31 05 cpc r19, r1a878: ac f5 brge .+106 ; 0xa8e4 <MotorRegler+0x38d8>a87a: 20 91 4a 03 lds r18, 0x034Aa87e: 30 91 4b 03 lds r19, 0x034Ba882: 40 91 fa 03 lds r20, 0x03FAa886: 50 91 fb 03 lds r21, 0x03FBa88a: 24 1b sub r18, r20a88c: 35 0b sbc r19, r21a88e: 21 30 cpi r18, 0x01 ; 1a890: 6f ef ldi r22, 0xFF ; 255a892: 36 07 cpc r19, r22a894: 3c f1 brlt .+78 ; 0xa8e4 <MotorRegler+0x38d8>a896: 2f 3f cpi r18, 0xFF ; 255a898: 31 05 cpc r19, r1a89a: 09 f0 breq .+2 ; 0xa89e <MotorRegler+0x3892>a89c: 1c f5 brge .+70 ; 0xa8e4 <MotorRegler+0x38d8>{HoverGasFilter -= HoverGasFilter/HOVER_GAS_AVERAGE;a89e: 40 91 77 03 lds r20, 0x0377a8a2: 50 91 78 03 lds r21, 0x0378a8a6: 60 91 79 03 lds r22, 0x0379a8aa: 70 91 7a 03 lds r23, 0x037Aa8ae: 8a 01 movw r16, r20a8b0: 9b 01 movw r18, r22a8b2: 0f 2e mov r0, r31a8b4: fe e0 ldi r31, 0x0E ; 14a8b6: 36 95 lsr r19a8b8: 27 95 ror r18a8ba: 17 95 ror r17a8bc: 07 95 ror r16a8be: fa 95 dec r31a8c0: d1 f7 brne .-12 ; 0xa8b6 <MotorRegler+0x38aa>a8c2: f0 2d mov r31, r0a8c4: 40 1b sub r20, r16a8c6: 51 0b sbc r21, r17a8c8: 62 0b sbc r22, r18a8ca: 73 0b sbc r23, r19HoverGasFilter += tmp_long2;a8cc: 84 0f add r24, r20a8ce: 95 1f adc r25, r21a8d0: a6 1f adc r26, r22a8d2: b7 1f adc r27, r23a8d4: 80 93 77 03 sts 0x0377, r24a8d8: 90 93 78 03 sts 0x0378, r25a8dc: a0 93 79 03 sts 0x0379, r26a8e0: b0 93 7a 03 sts 0x037A, r27}HoverGas = (int16_t)(HoverGasFilter/HOVER_GAS_AVERAGE);a8e4: 00 91 77 03 lds r16, 0x0377a8e8: 10 91 78 03 lds r17, 0x0378a8ec: 20 91 79 03 lds r18, 0x0379a8f0: 30 91 7a 03 lds r19, 0x037Aa8f4: 0f 2e mov r0, r31a8f6: fe e0 ldi r31, 0x0E ; 14a8f8: 36 95 lsr r19a8fa: 27 95 ror r18a8fc: 17 95 ror r17a8fe: 07 95 ror r16a900: fa 95 dec r31a902: d1 f7 brne .-12 ; 0xa8f8 <MotorRegler+0x38ec>a904: f0 2d mov r31, r0a906: c8 01 movw r24, r16a908: 10 93 e9 03 sts 0x03E9, r17a90c: 00 93 e8 03 sts 0x03E8, r16if(EE_Parameter.Hoehe_HoverBand)a910: 60 91 52 05 lds r22, 0x0552a914: 66 23 and r22, r22a916: 89 f0 breq .+34 ; 0xa93a <MotorRegler+0x392e>{int16_t band;band = HoverGas / EE_Parameter.Hoehe_HoverBand; // the higher the parameter the smaller the rangea918: 70 e0 ldi r23, 0x00 ; 0a91a: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>HoverGasMin = HoverGas - band;a91e: c8 01 movw r24, r16a920: 86 1b sub r24, r22a922: 97 0b sbc r25, r23a924: 90 93 17 04 sts 0x0417, r25a928: 80 93 16 04 sts 0x0416, r24HoverGasMax = HoverGas + band;a92c: 06 0f add r16, r22a92e: 17 1f adc r17, r23a930: 10 93 3f 01 sts 0x013F, r17a934: 00 93 3e 01 sts 0x013E, r16a938: 1f c0 rjmp .+62 ; 0xa978 <MotorRegler+0x396c>}else{ // no limitHoverGasMin = 0;a93a: 10 92 17 04 sts 0x0417, r1a93e: 10 92 16 04 sts 0x0416, r1HoverGasMax = 1023;a942: 8f ef ldi r24, 0xFF ; 255a944: 93 e0 ldi r25, 0x03 ; 3a946: 90 93 3f 01 sts 0x013F, r25a94a: 80 93 3e 01 sts 0x013E, r24a94e: 14 c0 rjmp .+40 ; 0xa978 <MotorRegler+0x396c>}}else{StartTrigger = 0;a950: 10 92 02 04 sts 0x0402, r1HoverGasFilter = 0;a954: 10 92 77 03 sts 0x0377, r1a958: 10 92 78 03 sts 0x0378, r1a95c: 10 92 79 03 sts 0x0379, r1a960: 10 92 7a 03 sts 0x037A, r1HoverGas = 0;a964: 10 92 e9 03 sts 0x03E9, r1a968: 10 92 e8 03 sts 0x03E8, r1a96c: 05 c0 rjmp .+10 ; 0xa978 <MotorRegler+0x396c>}}// EOF Parameter_GlobalConfig & CFG_HEIGHT_CONTROLelse{// set undefined state to indicate vario offFC_StatusFlags |= (FC_STATUS_VARIO_TRIM_UP|FC_STATUS_VARIO_TRIM_DOWN);a96e: 80 91 cb 03 lds r24, 0x03CBa972: 80 6c ori r24, 0xC0 ; 192a974: 80 93 cb 03 sts 0x03CB, r24} // EOF no height control// Limits the maximum gas in case of "Out of Range emergency landing"if(NC_To_FC_Flags & NC_TO_FC_EMERGENCY_LANDING)a978: 80 91 b7 04 lds r24, 0x04B7a97c: 81 ff sbrs r24, 1a97e: 37 c0 rjmp .+110 ; 0xa9ee <MotorRegler+0x39e2>{if(GasMischanteil/STICK_GAIN > HooverGasEmergencyPercent && HoverGas) GasMischanteil = HooverGasEmergencyPercent * STICK_GAIN;a980: 80 91 c7 03 lds r24, 0x03C7a984: 90 91 c8 03 lds r25, 0x03C8a988: 91 01 movw r18, r2a98a: 33 20 and r3, r3a98c: 14 f4 brge .+4 ; 0xa992 <MotorRegler+0x3986>a98e: 2d 5f subi r18, 0xFD ; 253a990: 3f 4f sbci r19, 0xFF ; 255a992: 35 95 asr r19a994: 27 95 ror r18a996: 35 95 asr r19a998: 27 95 ror r18a99a: 82 17 cp r24, r18a99c: 93 07 cpc r25, r19a99e: 58 f4 brcc .+22 ; 0xa9b6 <MotorRegler+0x39aa>a9a0: 20 91 e8 03 lds r18, 0x03E8a9a4: 30 91 e9 03 lds r19, 0x03E9a9a8: 23 2b or r18, r19a9aa: 29 f0 breq .+10 ; 0xa9b6 <MotorRegler+0x39aa>a9ac: 1c 01 movw r2, r24a9ae: 22 0c add r2, r2a9b0: 33 1c adc r3, r3a9b2: 22 0c add r2, r2a9b4: 33 1c adc r3, r3SollHoehe = HoehenWertF; // update setpoint to current heigtha9b6: 80 91 4a 03 lds r24, 0x034Aa9ba: 90 91 4b 03 lds r25, 0x034Ba9be: a0 91 4c 03 lds r26, 0x034Ca9c2: b0 91 4d 03 lds r27, 0x034Da9c6: 80 93 fa 03 sts 0x03FA, r24a9ca: 90 93 fb 03 sts 0x03FB, r25a9ce: a0 93 fc 03 sts 0x03FC, r26a9d2: b0 93 fd 03 sts 0x03FD, r27beeptime = 15000;a9d6: 88 e9 ldi r24, 0x98 ; 152a9d8: 9a e3 ldi r25, 0x3A ; 58a9da: 90 93 ce 04 sts 0x04CE, r25a9de: 80 93 cd 04 sts 0x04CD, r24BeepMuster = 0x0E00;a9e2: 80 e0 ldi r24, 0x00 ; 0a9e4: 9e e0 ldi r25, 0x0E ; 14a9e6: 90 93 aa 02 sts 0x02AA, r25a9ea: 80 93 a9 02 sts 0x02A9, r24}// limit gas to parameter settingLIMIT_MIN(GasMischanteil, (MIN_GAS + 10) * STICK_GAIN);a9ee: 80 91 2c 06 lds r24, 0x062Ca9f2: 90 e0 ldi r25, 0x00 ; 0a9f4: 0a 96 adiw r24, 0x0a ; 10a9f6: 88 0f add r24, r24a9f8: 99 1f adc r25, r25a9fa: 88 0f add r24, r24a9fc: 99 1f adc r25, r25a9fe: 28 16 cp r2, r24aa00: 39 06 cpc r3, r25aa02: 0c f4 brge .+2 ; 0xaa06 <MotorRegler+0x39fa>aa04: 1c 01 movw r2, r24if(GasMischanteil > (MAX_GAS - 20) * STICK_GAIN) GasMischanteil = (MAX_GAS - 20) * STICK_GAIN;aa06: 20 91 64 06 lds r18, 0x0664aa0a: 30 e0 ldi r19, 0x00 ; 0aa0c: 24 51 subi r18, 0x14 ; 20aa0e: 31 09 sbc r19, r1aa10: 22 0f add r18, r18aa12: 33 1f adc r19, r19aa14: 22 0f add r18, r18aa16: 33 1f adc r19, r19aa18: 3e 82 std Y+6, r3 ; 0x06aa1a: 2d 82 std Y+5, r2 ; 0x05aa1c: 22 15 cp r18, r2aa1e: 33 05 cpc r19, r3aa20: 14 f4 brge .+4 ; 0xaa26 <MotorRegler+0x3a1a>aa22: 3e 83 std Y+6, r19 ; 0x06aa24: 2d 83 std Y+5, r18 ; 0x05// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++// all BL-Ctrl connected?// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++if(MissingMotor || Capacity.MinOfMaxPWM < 254 || NC_ErrorCode) // wait until all BL-Ctrls started and no Errorsaa26: 20 91 df 04 lds r18, 0x04DFaa2a: 21 11 cpse r18, r1aa2c: 08 c0 rjmp .+16 ; 0xaa3e <MotorRegler+0x3a32>aa2e: 20 91 1b 05 lds r18, 0x051Baa32: 2e 3f cpi r18, 0xFE ; 254aa34: 20 f0 brcs .+8 ; 0xaa3e <MotorRegler+0x3a32>aa36: 20 91 bb 04 lds r18, 0x04BBaa3a: 22 23 and r18, r18aa3c: 01 f1 breq .+64 ; 0xaa7e <MotorRegler+0x3a72>if(modell_fliegt > 1 && modell_fliegt < 50 && GasMischanteil > 0) // only during start-phaseaa3e: 20 91 cc 03 lds r18, 0x03CCaa42: 30 91 cd 03 lds r19, 0x03CDaa46: 22 50 subi r18, 0x02 ; 2aa48: 31 09 sbc r19, r1aa4a: 20 33 cpi r18, 0x30 ; 48aa4c: 31 05 cpc r19, r1aa4e: b8 f4 brcc .+46 ; 0xaa7e <MotorRegler+0x3a72>aa50: 8d 80 ldd r8, Y+5 ; 0x05aa52: 9e 80 ldd r9, Y+6 ; 0x06aa54: 18 14 cp r1, r8aa56: 19 04 cpc r1, r9aa58: 94 f4 brge .+36 ; 0xaa7e <MotorRegler+0x3a72>{modell_fliegt = 1;aa5a: 21 e0 ldi r18, 0x01 ; 1aa5c: 30 e0 ldi r19, 0x00 ; 0aa5e: 30 93 cd 03 sts 0x03CD, r19aa62: 20 93 cc 03 sts 0x03CC, r18GasMischanteil = (MIN_GAS + 10) * STICK_GAIN;#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))if(Capacity.MinOfMaxPWM < 40) SpeakHoTT = SPEAK_ERR_MOTOR;aa66: 20 91 1b 05 lds r18, 0x051Baa6a: 28 32 cpi r18, 0x28 ; 40aa6c: 30 f4 brcc .+12 ; 0xaa7a <MotorRegler+0x3a6e>aa6e: 29 e0 ldi r18, 0x09 ; 9aa70: 20 93 57 01 sts 0x0157, r18// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++if(MissingMotor || Capacity.MinOfMaxPWM < 254 || NC_ErrorCode) // wait until all BL-Ctrls started and no Errorsif(modell_fliegt > 1 && modell_fliegt < 50 && GasMischanteil > 0) // only during start-phase{modell_fliegt = 1;GasMischanteil = (MIN_GAS + 10) * STICK_GAIN;aa74: 9e 83 std Y+6, r25 ; 0x06aa76: 8d 83 std Y+5, r24 ; 0x05aa78: 02 c0 rjmp .+4 ; 0xaa7e <MotorRegler+0x3a72>aa7a: 9e 83 std Y+6, r25 ; 0x06aa7c: 8d 83 std Y+5, r24 ; 0x05#endif}// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++// send SPI pending bytesif(BytegapSPI == 0) SPI_TransmitByte();aa7e: 80 91 cc 04 lds r24, 0x04CCaa82: 81 11 cpse r24, r1aa84: 02 c0 rjmp .+4 ; 0xaa8a <MotorRegler+0x3a7e>aa86: 0e 94 de 95 call 0x12bbc ; 0x12bbc <SPI_TransmitByte>// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++// + Mischer und PI-Regler// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++DebugOut.Analog[7] = GasMischanteil; // achtung: Muss auf [7] bleiben wegen SPI.Caa8a: 0d 81 ldd r16, Y+5 ; 0x05aa8c: 1e 81 ldd r17, Y+6 ; 0x06aa8e: 10 93 57 0c sts 0x0C57, r17aa92: 00 93 56 0c sts 0x0C56, r16// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++// Gier-Anteil// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++GierMischanteil = MesswertGier - sollGier * STICK_GAIN; // Regler für Gieraa96: 20 91 9e 03 lds r18, 0x039Eaa9a: 30 91 9f 03 lds r19, 0x039Faa9e: 22 0f add r18, r18aaa0: 33 1f adc r19, r19aaa2: 22 0f add r18, r18aaa4: 33 1f adc r19, r19aaa6: 80 91 67 06 lds r24, 0x0667aaaa: 90 91 68 06 lds r25, 0x0668aaae: 82 1b sub r24, r18aab0: 93 0b sbc r25, r19#define MIN_GIERGAS (40*STICK_GAIN) // unter diesem Gaswert trotzdem Gierenif(GasMischanteil > MIN_GIERGAS)aab2: 01 3a cpi r16, 0xA1 ; 161aab4: 11 05 cpc r17, r1aab6: c4 f0 brlt .+48 ; 0xaae8 <MotorRegler+0x3adc>{if(GierMischanteil > (GasMischanteil / 2)) GierMischanteil = GasMischanteil / 2;aab8: 98 01 movw r18, r16aaba: 11 23 and r17, r17aabc: 14 f4 brge .+4 ; 0xaac2 <MotorRegler+0x3ab6>aabe: 2f 5f subi r18, 0xFF ; 255aac0: 3f 4f sbci r19, 0xFF ; 255aac2: 35 95 asr r19aac4: 27 95 ror r18aac6: 52 2f mov r21, r18aac8: 43 2f mov r20, r19aaca: 82 17 cp r24, r18aacc: 93 07 cpc r25, r19aace: 14 f4 brge .+4 ; 0xaad4 <MotorRegler+0x3ac8>aad0: 58 2f mov r21, r24aad2: 49 2f mov r20, r25if(GierMischanteil < -(GasMischanteil / 2)) GierMischanteil = -(GasMischanteil / 2);aad4: 31 95 neg r19aad6: 21 95 neg r18aad8: 31 09 sbc r19, r1aada: 85 2f mov r24, r21aadc: 94 2f mov r25, r20aade: 82 17 cp r24, r18aae0: 93 07 cpc r25, r19aae2: 6c f4 brge .+26 ; 0xaafe <MotorRegler+0x3af2>aae4: c9 01 movw r24, r18aae6: 0b c0 rjmp .+22 ; 0xaafe <MotorRegler+0x3af2>aae8: 81 35 cpi r24, 0x51 ; 81aaea: 91 05 cpc r25, r1aaec: 14 f0 brlt .+4 ; 0xaaf2 <MotorRegler+0x3ae6>aaee: 80 e5 ldi r24, 0x50 ; 80aaf0: 90 e0 ldi r25, 0x00 ; 0aaf2: 80 3b cpi r24, 0xB0 ; 176aaf4: 1f ef ldi r17, 0xFF ; 255aaf6: 91 07 cpc r25, r17aaf8: 14 f4 brge .+4 ; 0xaafe <MotorRegler+0x3af2>aafa: 80 eb ldi r24, 0xB0 ; 176aafc: 9f ef ldi r25, 0xFF ; 255else{if(GierMischanteil > (MIN_GIERGAS / 2)) GierMischanteil = MIN_GIERGAS / 2;if(GierMischanteil < -(MIN_GIERGAS / 2)) GierMischanteil = -(MIN_GIERGAS / 2);}tmp_int = MAX_GAS*STICK_GAIN;aafe: 20 91 64 06 lds r18, 0x0664ab02: 30 e0 ldi r19, 0x00 ; 0ab04: 22 0f add r18, r18ab06: 33 1f adc r19, r19ab08: 22 0f add r18, r18ab0a: 33 1f adc r19, r19if(GierMischanteil > ((tmp_int - GasMischanteil))) GierMischanteil = ((tmp_int - GasMischanteil));ab0c: a9 01 movw r20, r18ab0e: 8d 80 ldd r8, Y+5 ; 0x05ab10: 9e 80 ldd r9, Y+6 ; 0x06ab12: 48 19 sub r20, r8ab14: 59 09 sbc r21, r9ab16: 48 17 cp r20, r24ab18: 59 07 cpc r21, r25ab1a: 0c f4 brge .+2 ; 0xab1e <MotorRegler+0x3b12>ab1c: ca 01 movw r24, r20if(GierMischanteil < -((tmp_int - GasMischanteil))) GierMischanteil = -((tmp_int - GasMischanteil));ab1e: 0d 81 ldd r16, Y+5 ; 0x05ab20: 1e 81 ldd r17, Y+6 ; 0x06ab22: 02 1b sub r16, r18ab24: 13 0b sbc r17, r19ab26: 9a 87 std Y+10, r25 ; 0x0aab28: 89 87 std Y+9, r24 ; 0x09ab2a: 80 17 cp r24, r16ab2c: 91 07 cpc r25, r17ab2e: 14 f4 brge .+4 ; 0xab34 <MotorRegler+0x3b28>ab30: 1a 87 std Y+10, r17 ; 0x0aab32: 09 87 std Y+9, r16 ; 0x09// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++// Nick-Achse// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++DiffNick = MesswertNick - StickNick; // Differenz bestimmenab34: 80 91 14 04 lds r24, 0x0414ab38: 90 91 15 04 lds r25, 0x0415ab3c: 20 91 27 06 lds r18, 0x0627ab40: 30 91 28 06 lds r19, 0x0628ab44: 28 1b sub r18, r24ab46: 39 0b sbc r19, r25ab48: 30 93 33 06 sts 0x0633, r19ab4c: 20 93 32 06 sts 0x0632, r18if(IntegralFaktor) SummeNick += IntegralNickMalFaktor - StickNick; // I-Anteil bei Winkelregelungab50: 00 91 42 06 lds r16, 0x0642ab54: 00 23 and r16, r16ab56: e9 f0 breq .+58 ; 0xab92 <MotorRegler+0x3b86>ab58: a7 01 movw r20, r14ab5a: 48 1b sub r20, r24ab5c: 59 0b sbc r21, r25ab5e: ca 01 movw r24, r20ab60: aa 27 eor r26, r26ab62: 97 fd sbrc r25, 7ab64: a0 95 com r26ab66: ba 2f mov r27, r26ab68: 40 91 26 04 lds r20, 0x0426ab6c: 50 91 27 04 lds r21, 0x0427ab70: 60 91 28 04 lds r22, 0x0428ab74: 70 91 29 04 lds r23, 0x0429ab78: 84 0f add r24, r20ab7a: 95 1f adc r25, r21ab7c: a6 1f adc r26, r22ab7e: b7 1f adc r27, r23ab80: 80 93 26 04 sts 0x0426, r24ab84: 90 93 27 04 sts 0x0427, r25ab88: a0 93 28 04 sts 0x0428, r26ab8c: b0 93 29 04 sts 0x0429, r27ab90: 19 c0 rjmp .+50 ; 0xabc4 <MotorRegler+0x3bb8>else SummeNick += DiffNick; // I-Anteil bei HHab92: 40 91 26 04 lds r20, 0x0426ab96: 50 91 27 04 lds r21, 0x0427ab9a: 60 91 28 04 lds r22, 0x0428ab9e: 70 91 29 04 lds r23, 0x0429aba2: c9 01 movw r24, r18aba4: aa 27 eor r26, r26aba6: 97 fd sbrc r25, 7aba8: a0 95 com r26abaa: ba 2f mov r27, r26abac: 84 0f add r24, r20abae: 95 1f adc r25, r21abb0: a6 1f adc r26, r22abb2: b7 1f adc r27, r23abb4: 80 93 26 04 sts 0x0426, r24abb8: 90 93 27 04 sts 0x0427, r25abbc: a0 93 28 04 sts 0x0428, r26abc0: b0 93 29 04 sts 0x0429, r27if(SummeNick > (STICK_GAIN * 16000L)) SummeNick = (STICK_GAIN * 16000L);abc4: 80 91 26 04 lds r24, 0x0426abc8: 90 91 27 04 lds r25, 0x0427abcc: a0 91 28 04 lds r26, 0x0428abd0: b0 91 29 04 lds r27, 0x0429abd4: 81 30 cpi r24, 0x01 ; 1abd6: 5a ef ldi r21, 0xFA ; 250abd8: 95 07 cpc r25, r21abda: a1 05 cpc r26, r1abdc: b1 05 cpc r27, r1abde: 6c f0 brlt .+26 ; 0xabfa <MotorRegler+0x3bee>abe0: 80 e0 ldi r24, 0x00 ; 0abe2: 9a ef ldi r25, 0xFA ; 250abe4: a0 e0 ldi r26, 0x00 ; 0abe6: b0 e0 ldi r27, 0x00 ; 0abe8: 80 93 26 04 sts 0x0426, r24abec: 90 93 27 04 sts 0x0427, r25abf0: a0 93 28 04 sts 0x0428, r26abf4: b0 93 29 04 sts 0x0429, r27abf8: 11 c0 rjmp .+34 ; 0xac1c <MotorRegler+0x3c10>if(SummeNick < -(16000L * STICK_GAIN)) SummeNick = -(16000L * STICK_GAIN);abfa: 81 15 cp r24, r1abfc: 96 40 sbci r25, 0x06 ; 6abfe: af 4f sbci r26, 0xFF ; 255ac00: bf 4f sbci r27, 0xFF ; 255ac02: 64 f4 brge .+24 ; 0xac1c <MotorRegler+0x3c10>ac04: 80 e0 ldi r24, 0x00 ; 0ac06: 96 e0 ldi r25, 0x06 ; 6ac08: af ef ldi r26, 0xFF ; 255ac0a: bf ef ldi r27, 0xFF ; 255ac0c: 80 93 26 04 sts 0x0426, r24ac10: 90 93 27 04 sts 0x0427, r25ac14: a0 93 28 04 sts 0x0428, r26ac18: b0 93 29 04 sts 0x0429, r27if(EE_Parameter.Gyro_Stability <= 8) pd_ergebnis_nick = (EE_Parameter.Gyro_Stability * DiffNick) / 8; // PI-Regler für Nickac1c: 10 91 61 05 lds r17, 0x0561ac20: 19 30 cpi r17, 0x09 ; 9ac22: 88 f4 brcc .+34 ; 0xac46 <MotorRegler+0x3c3a>ac24: 12 9f mul r17, r18ac26: 70 01 movw r14, r0ac28: 13 9f mul r17, r19ac2a: f0 0c add r15, r0ac2c: 11 24 eor r1, r1ac2e: ff 20 and r15, r15ac30: 1c f4 brge .+6 ; 0xac38 <MotorRegler+0x3c2c>ac32: 77 e0 ldi r23, 0x07 ; 7ac34: e7 0e add r14, r23ac36: f1 1c adc r15, r1ac38: f5 94 asr r15ac3a: e7 94 ror r14ac3c: f5 94 asr r15ac3e: e7 94 ror r14ac40: f5 94 asr r15ac42: e7 94 ror r14ac44: 10 c0 rjmp .+32 ; 0xac66 <MotorRegler+0x3c5a>else pd_ergebnis_nick = ((EE_Parameter.Gyro_Stability / 2) * DiffNick) / 4; // Überlauf verhindernac46: 81 2f mov r24, r17ac48: 86 95 lsr r24ac4a: 82 9f mul r24, r18ac4c: 70 01 movw r14, r0ac4e: 83 9f mul r24, r19ac50: f0 0c add r15, r0ac52: 11 24 eor r1, r1ac54: ff 20 and r15, r15ac56: 1c f4 brge .+6 ; 0xac5e <MotorRegler+0x3c52>ac58: 83 e0 ldi r24, 0x03 ; 3ac5a: e8 0e add r14, r24ac5c: f1 1c adc r15, r1ac5e: f5 94 asr r15ac60: e7 94 ror r14ac62: f5 94 asr r15ac64: e7 94 ror r14pd_ergebnis_nick += SummeNick / Ki;ac66: 40 90 3b 01 lds r4, 0x013Bac6a: 50 90 3c 01 lds r5, 0x013Cac6e: 66 24 eor r6, r6ac70: 57 fc sbrc r5, 7ac72: 60 94 com r6ac74: 76 2c mov r7, r6ac76: 60 91 26 04 lds r22, 0x0426ac7a: 70 91 27 04 lds r23, 0x0427ac7e: 80 91 28 04 lds r24, 0x0428ac82: 90 91 29 04 lds r25, 0x0429ac86: a3 01 movw r20, r6ac88: 92 01 movw r18, r4ac8a: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>ac8e: 17 01 movw r2, r14ac90: 22 0e add r2, r18ac92: 33 1e adc r3, r19tmp_int = (long)((long)Parameter_DynamicStability * (long)(GasMischanteil + abs(GierMischanteil)/2)) / 64;ac94: 20 91 27 01 lds r18, 0x0127ac98: 30 e0 ldi r19, 0x00 ; 0ac9a: 40 e0 ldi r20, 0x00 ; 0ac9c: 50 e0 ldi r21, 0x00 ; 0ac9e: 89 85 ldd r24, Y+9 ; 0x09aca0: 9a 85 ldd r25, Y+10 ; 0x0aaca2: 99 23 and r25, r25aca4: 1c f4 brge .+6 ; 0xacac <MotorRegler+0x3ca0>aca6: 91 95 neg r25aca8: 81 95 neg r24acaa: 91 09 sbc r25, r1acac: dc 01 movw r26, r24acae: 99 23 and r25, r25acb0: 0c f4 brge .+2 ; 0xacb4 <MotorRegler+0x3ca8>acb2: 11 96 adiw r26, 0x01 ; 1acb4: b5 95 asr r27acb6: a7 95 ror r26acb8: 8d 80 ldd r8, Y+5 ; 0x05acba: 9e 80 ldd r9, Y+6 ; 0x06acbc: a8 0d add r26, r8acbe: b9 1d adc r27, r9acc0: 0e 94 d2 b1 call 0x163a4 ; 0x163a4 <__mulshisi3>acc4: 6b 01 movw r12, r22acc6: 7c 01 movw r14, r24acc8: 99 23 and r25, r25acca: 2c f4 brge .+10 ; 0xacd6 <MotorRegler+0x3cca>accc: 2f e3 ldi r18, 0x3F ; 63acce: c2 0e add r12, r18acd0: d1 1c adc r13, r1acd2: e1 1c adc r14, r1acd4: f1 1c adc r15, r1acd6: 68 94 setacd8: 15 f8 bld r1, 5acda: f5 94 asr r15acdc: e7 94 ror r14acde: d7 94 ror r13ace0: c7 94 ror r12ace2: 16 94 lsr r1ace4: d1 f7 brne .-12 ; 0xacda <MotorRegler+0x3cce>ace6: dc 86 std Y+12, r13 ; 0x0cace8: cb 86 std Y+11, r12 ; 0x0bacea: f1 01 movw r30, r2acec: c2 14 cp r12, r2acee: d3 04 cpc r13, r3acf0: 0c f4 brge .+2 ; 0xacf4 <MotorRegler+0x3ce8>acf2: f6 01 movw r30, r12if(pd_ergebnis_nick > tmp_int) pd_ergebnis_nick = tmp_int;if(pd_ergebnis_nick < -tmp_int) pd_ergebnis_nick = -tmp_int;acf4: 22 24 eor r2, r2acf6: 33 24 eor r3, r3acf8: 2c 18 sub r2, r12acfa: 3d 08 sbc r3, r13acfc: fe 87 std Y+14, r31 ; 0x0eacfe: ed 87 std Y+13, r30 ; 0x0dad00: e2 15 cp r30, r2ad02: f3 05 cpc r31, r3ad04: 14 f4 brge .+4 ; 0xad0a <MotorRegler+0x3cfe>ad06: 3e 86 std Y+14, r3 ; 0x0ead08: 2d 86 std Y+13, r2 ; 0x0d// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++// Roll-Achse// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++DiffRoll = MesswertRoll - StickRoll; // Differenz bestimmenad0a: 20 91 12 04 lds r18, 0x0412ad0e: 30 91 13 04 lds r19, 0x0413ad12: 80 91 1c 06 lds r24, 0x061Cad16: 90 91 1d 06 lds r25, 0x061Dad1a: 82 1b sub r24, r18ad1c: 93 0b sbc r25, r19ad1e: 90 93 1b 06 sts 0x061B, r25ad22: 80 93 1a 06 sts 0x061A, r24if(IntegralFaktor) SummeRoll += IntegralRollMalFaktor - StickRoll;// I-Anteil bei Winkelregelungad26: 00 23 and r16, r16ad28: 21 f1 breq .+72 ; 0xad72 <MotorRegler+0x3d66>ad2a: a2 1a sub r10, r18ad2c: b3 0a sbc r11, r19ad2e: 95 01 movw r18, r10ad30: 44 27 eor r20, r20ad32: 37 fd sbrc r19, 7ad34: 40 95 com r20ad36: 54 2f mov r21, r20ad38: 29 8b std Y+17, r18 ; 0x11ad3a: 3a 8b std Y+18, r19 ; 0x12ad3c: 4b 8b std Y+19, r20 ; 0x13ad3e: 5c 8b std Y+20, r21 ; 0x14ad40: 40 91 22 04 lds r20, 0x0422ad44: 50 91 23 04 lds r21, 0x0423ad48: 60 91 24 04 lds r22, 0x0424ad4c: 70 91 25 04 lds r23, 0x0425ad50: 89 88 ldd r8, Y+17 ; 0x11ad52: 9a 88 ldd r9, Y+18 ; 0x12ad54: ab 88 ldd r10, Y+19 ; 0x13ad56: bc 88 ldd r11, Y+20 ; 0x14ad58: 84 0e add r8, r20ad5a: 95 1e adc r9, r21ad5c: a6 1e adc r10, r22ad5e: b7 1e adc r11, r23ad60: 80 92 22 04 sts 0x0422, r8ad64: 90 92 23 04 sts 0x0423, r9ad68: a0 92 24 04 sts 0x0424, r10ad6c: b0 92 25 04 sts 0x0425, r11ad70: 21 c0 rjmp .+66 ; 0xadb4 <MotorRegler+0x3da8>else SummeRoll += DiffRoll; // I-Anteil bei HHad72: 20 91 22 04 lds r18, 0x0422ad76: 30 91 23 04 lds r19, 0x0423ad7a: 40 91 24 04 lds r20, 0x0424ad7e: 50 91 25 04 lds r21, 0x0425ad82: 29 83 std Y+1, r18 ; 0x01ad84: 3a 83 std Y+2, r19 ; 0x02ad86: 4b 83 std Y+3, r20 ; 0x03ad88: 5c 83 std Y+4, r21 ; 0x04ad8a: ac 01 movw r20, r24ad8c: 66 27 eor r22, r22ad8e: 57 fd sbrc r21, 7ad90: 60 95 com r22ad92: 76 2f mov r23, r22ad94: 89 80 ldd r8, Y+1 ; 0x01ad96: 9a 80 ldd r9, Y+2 ; 0x02ad98: ab 80 ldd r10, Y+3 ; 0x03ad9a: bc 80 ldd r11, Y+4 ; 0x04ad9c: 48 0d add r20, r8ad9e: 59 1d adc r21, r9ada0: 6a 1d adc r22, r10ada2: 7b 1d adc r23, r11ada4: 40 93 22 04 sts 0x0422, r20ada8: 50 93 23 04 sts 0x0423, r21adac: 60 93 24 04 sts 0x0424, r22adb0: 70 93 25 04 sts 0x0425, r23if(SummeRoll > (STICK_GAIN * 16000L)) SummeRoll = (STICK_GAIN * 16000L);adb4: 40 91 22 04 lds r20, 0x0422adb8: 50 91 23 04 lds r21, 0x0423adbc: 60 91 24 04 lds r22, 0x0424adc0: 70 91 25 04 lds r23, 0x0425adc4: 41 30 cpi r20, 0x01 ; 1adc6: 0a ef ldi r16, 0xFA ; 250adc8: 50 07 cpc r21, r16adca: 61 05 cpc r22, r1adcc: 71 05 cpc r23, r1adce: 6c f0 brlt .+26 ; 0xadea <MotorRegler+0x3dde>add0: 40 e0 ldi r20, 0x00 ; 0add2: 5a ef ldi r21, 0xFA ; 250add4: 60 e0 ldi r22, 0x00 ; 0add6: 70 e0 ldi r23, 0x00 ; 0add8: 40 93 22 04 sts 0x0422, r20addc: 50 93 23 04 sts 0x0423, r21ade0: 60 93 24 04 sts 0x0424, r22ade4: 70 93 25 04 sts 0x0425, r23ade8: 11 c0 rjmp .+34 ; 0xae0c <MotorRegler+0x3e00>if(SummeRoll < -(16000L * STICK_GAIN)) SummeRoll = -(16000L * STICK_GAIN);adea: 41 15 cp r20, r1adec: 56 40 sbci r21, 0x06 ; 6adee: 6f 4f sbci r22, 0xFF ; 255adf0: 7f 4f sbci r23, 0xFF ; 255adf2: 64 f4 brge .+24 ; 0xae0c <MotorRegler+0x3e00>adf4: 40 e0 ldi r20, 0x00 ; 0adf6: 56 e0 ldi r21, 0x06 ; 6adf8: 6f ef ldi r22, 0xFF ; 255adfa: 7f ef ldi r23, 0xFF ; 255adfc: 40 93 22 04 sts 0x0422, r20ae00: 50 93 23 04 sts 0x0423, r21ae04: 60 93 24 04 sts 0x0424, r22ae08: 70 93 25 04 sts 0x0425, r23if(EE_Parameter.Gyro_Stability <= 8) pd_ergebnis_roll = (EE_Parameter.Gyro_Stability * DiffRoll) / 8; // PI-Regler für Rollae0c: 19 30 cpi r17, 0x09 ; 9ae0e: 88 f4 brcc .+34 ; 0xae32 <MotorRegler+0x3e26>ae10: 18 9f mul r17, r24ae12: 50 01 movw r10, r0ae14: 19 9f mul r17, r25ae16: b0 0c add r11, r0ae18: 11 24 eor r1, r1ae1a: bb 20 and r11, r11ae1c: 1c f4 brge .+6 ; 0xae24 <MotorRegler+0x3e18>ae1e: 37 e0 ldi r19, 0x07 ; 7ae20: a3 0e add r10, r19ae22: b1 1c adc r11, r1ae24: b5 94 asr r11ae26: a7 94 ror r10ae28: b5 94 asr r11ae2a: a7 94 ror r10ae2c: b5 94 asr r11ae2e: a7 94 ror r10ae30: 0f c0 rjmp .+30 ; 0xae50 <MotorRegler+0x3e44>else pd_ergebnis_roll = ((EE_Parameter.Gyro_Stability / 2) * DiffRoll) / 4; // Überlauf verhindernae32: 16 95 lsr r17ae34: 18 9f mul r17, r24ae36: 50 01 movw r10, r0ae38: 19 9f mul r17, r25ae3a: b0 0c add r11, r0ae3c: 11 24 eor r1, r1ae3e: bb 20 and r11, r11ae40: 1c f4 brge .+6 ; 0xae48 <MotorRegler+0x3e3c>ae42: 43 e0 ldi r20, 0x03 ; 3ae44: a4 0e add r10, r20ae46: b1 1c adc r11, r1ae48: b5 94 asr r11ae4a: a7 94 ror r10ae4c: b5 94 asr r11ae4e: a7 94 ror r10pd_ergebnis_roll += SummeRoll / Ki;ae50: 60 91 22 04 lds r22, 0x0422ae54: 70 91 23 04 lds r23, 0x0423ae58: 80 91 24 04 lds r24, 0x0424ae5c: 90 91 25 04 lds r25, 0x0425ae60: a3 01 movw r20, r6ae62: 92 01 movw r18, r4ae64: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>ae68: 2a 0d add r18, r10ae6a: 3b 1d adc r19, r11ae6c: 8b 84 ldd r8, Y+11 ; 0x0bae6e: 9c 84 ldd r9, Y+12 ; 0x0cae70: 82 16 cp r8, r18ae72: 93 06 cpc r9, r19ae74: 0c f4 brge .+2 ; 0xae78 <MotorRegler+0x3e6c>ae76: 96 01 movw r18, r12ae78: 3c 87 std Y+12, r19 ; 0x0cae7a: 2b 87 std Y+11, r18 ; 0x0bae7c: 22 15 cp r18, r2ae7e: 33 05 cpc r19, r3ae80: 14 f4 brge .+4 ; 0xae86 <MotorRegler+0x3e7a>ae82: 3c 86 std Y+12, r3 ; 0x0cae84: 2b 86 std Y+11, r2 ; 0x0bif(pd_ergebnis_roll > tmp_int) pd_ergebnis_roll = tmp_int;if(pd_ergebnis_roll < -tmp_int) pd_ergebnis_roll = -tmp_int;// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++// send SPI pending bytesif(BytegapSPI == 0) SPI_TransmitByte();ae86: 80 91 cc 04 lds r24, 0x04CCae8a: 81 11 cpse r24, r1ae8c: 3d c1 rjmp .+634 ; 0xb108 <MotorRegler+0x40fc>ae8e: 0e 94 de 95 call 0x12bbc ; 0x12bbc <SPI_TransmitByte>ae92: 3a c1 rjmp .+628 ; 0xb108 <MotorRegler+0x40fc>ae94: 9e a2 std Y+38, r9 ; 0x26ae96: 8d a2 std Y+37, r8 ; 0x25ae98: f4 01 movw r30, r8ae9a: 33 97 sbiw r30, 0x03 ; 3// Universal Mixer// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++for(i=0; i<MAX_MOTORS; i++){signed int tmp_int;if(Mixer.Motor[i][0] > 0)ae9c: a0 81 ld r26, Zae9e: 1a 16 cp r1, r26aea0: 0c f0 brlt .+2 ; 0xaea4 <MotorRegler+0x3e98>aea2: 1d c1 rjmp .+570 ; 0xb0de <MotorRegler+0x40d2>{// Gasif(Mixer.Motor[i][0] == 64) tmp_int = GasMischanteil; else tmp_int = ((long)GasMischanteil * Mixer.Motor[i][0]) / 64L;aea4: a0 34 cpi r26, 0x40 ; 64aea6: e1 f0 breq .+56 ; 0xaee0 <MotorRegler+0x3ed4>aea8: bb 27 eor r27, r27aeaa: a7 fd sbrc r26, 7aeac: b0 95 com r27aeae: a7 01 movw r20, r14aeb0: 96 01 movw r18, r12aeb2: 0e 94 d2 b1 call 0x163a4 ; 0x163a4 <__mulshisi3>aeb6: 9b 01 movw r18, r22aeb8: ac 01 movw r20, r24aeba: 99 23 and r25, r25aebc: 24 f4 brge .+8 ; 0xaec6 <MotorRegler+0x3eba>aebe: 21 5c subi r18, 0xC1 ; 193aec0: 3f 4f sbci r19, 0xFF ; 255aec2: 4f 4f sbci r20, 0xFF ; 255aec4: 5f 4f sbci r21, 0xFF ; 255aec6: ba 01 movw r22, r20aec8: a9 01 movw r20, r18aeca: 68 94 setaecc: 15 f8 bld r1, 5aece: 75 95 asr r23aed0: 67 95 ror r22aed2: 57 95 ror r21aed4: 47 95 ror r20aed6: 16 94 lsr r1aed8: d1 f7 brne .-12 ; 0xaece <MotorRegler+0x3ec2>aeda: 5e 83 std Y+6, r21 ; 0x06aedc: 4d 83 std Y+5, r20 ; 0x05aede: 04 c0 rjmp .+8 ; 0xaee8 <MotorRegler+0x3edc>aee0: 0f 8d ldd r16, Y+31 ; 0x1faee2: 0d 83 std Y+5, r16 ; 0x05aee4: e8 a1 ldd r30, Y+32 ; 0x20aee6: ee 83 std Y+6, r30 ; 0x06aee8: ad a1 ldd r26, Y+37 ; 0x25aeea: be a1 ldd r27, Y+38 ; 0x26aeec: 12 97 sbiw r26, 0x02 ; 2// Nickif(Mixer.Motor[i][1] == 64) tmp_int += pd_ergebnis_nick;aeee: ac 91 ld r26, Xaef0: a0 34 cpi r26, 0x40 ; 64aef2: 49 f4 brne .+18 ; 0xaf06 <MotorRegler+0x3efa>aef4: ed 81 ldd r30, Y+5 ; 0x05aef6: fe 81 ldd r31, Y+6 ; 0x06aef8: 2d 85 ldd r18, Y+13 ; 0x0daefa: 3e 85 ldd r19, Y+14 ; 0x0eaefc: e2 0f add r30, r18aefe: f3 1f adc r31, r19af00: fe 83 std Y+6, r31 ; 0x06af02: ed 83 std Y+5, r30 ; 0x05af04: 2c c0 rjmp .+88 ; 0xaf5e <MotorRegler+0x3f52>else if(Mixer.Motor[i][1] == -64) tmp_int -= pd_ergebnis_nick;af06: a0 3c cpi r26, 0xC0 ; 192af08: 49 f4 brne .+18 ; 0xaf1c <MotorRegler+0x3f10>af0a: ed 81 ldd r30, Y+5 ; 0x05af0c: fe 81 ldd r31, Y+6 ; 0x06af0e: 2d 85 ldd r18, Y+13 ; 0x0daf10: 3e 85 ldd r19, Y+14 ; 0x0eaf12: e2 1b sub r30, r18af14: f3 0b sbc r31, r19af16: fe 83 std Y+6, r31 ; 0x06af18: ed 83 std Y+5, r30 ; 0x05af1a: 21 c0 rjmp .+66 ; 0xaf5e <MotorRegler+0x3f52>else tmp_int += ((long)pd_ergebnis_nick * Mixer.Motor[i][1]) / 64L;af1c: bb 27 eor r27, r27af1e: a7 fd sbrc r26, 7af20: b0 95 com r27af22: 29 8d ldd r18, Y+25 ; 0x19af24: 3a 8d ldd r19, Y+26 ; 0x1aaf26: 4b 8d ldd r20, Y+27 ; 0x1baf28: 5c 8d ldd r21, Y+28 ; 0x1caf2a: 0e 94 d2 b1 call 0x163a4 ; 0x163a4 <__mulshisi3>af2e: 9b 01 movw r18, r22af30: ac 01 movw r20, r24af32: 99 23 and r25, r25af34: 24 f4 brge .+8 ; 0xaf3e <MotorRegler+0x3f32>af36: 21 5c subi r18, 0xC1 ; 193af38: 3f 4f sbci r19, 0xFF ; 255af3a: 4f 4f sbci r20, 0xFF ; 255af3c: 5f 4f sbci r21, 0xFF ; 255af3e: ba 01 movw r22, r20af40: a9 01 movw r20, r18af42: 68 94 setaf44: 15 f8 bld r1, 5af46: 75 95 asr r23af48: 67 95 ror r22af4a: 57 95 ror r21af4c: 47 95 ror r20af4e: 16 94 lsr r1af50: d1 f7 brne .-12 ; 0xaf46 <MotorRegler+0x3f3a>af52: ed 81 ldd r30, Y+5 ; 0x05af54: fe 81 ldd r31, Y+6 ; 0x06af56: e4 0f add r30, r20af58: f5 1f adc r31, r21af5a: fe 83 std Y+6, r31 ; 0x06af5c: ed 83 std Y+5, r30 ; 0x05af5e: ad a1 ldd r26, Y+37 ; 0x25af60: be a1 ldd r27, Y+38 ; 0x26af62: 11 97 sbiw r26, 0x01 ; 1// Rollif(Mixer.Motor[i][2] == 64) tmp_int += pd_ergebnis_roll;af64: ac 91 ld r26, Xaf66: a0 34 cpi r26, 0x40 ; 64af68: 49 f4 brne .+18 ; 0xaf7c <MotorRegler+0x3f70>af6a: ed 81 ldd r30, Y+5 ; 0x05af6c: fe 81 ldd r31, Y+6 ; 0x06af6e: 2b 85 ldd r18, Y+11 ; 0x0baf70: 3c 85 ldd r19, Y+12 ; 0x0caf72: e2 0f add r30, r18af74: f3 1f adc r31, r19af76: fe 83 std Y+6, r31 ; 0x06af78: ed 83 std Y+5, r30 ; 0x05af7a: 2c c0 rjmp .+88 ; 0xafd4 <MotorRegler+0x3fc8>else if(Mixer.Motor[i][2] == -64) tmp_int -= pd_ergebnis_roll;af7c: a0 3c cpi r26, 0xC0 ; 192af7e: 49 f4 brne .+18 ; 0xaf92 <MotorRegler+0x3f86>af80: ed 81 ldd r30, Y+5 ; 0x05af82: fe 81 ldd r31, Y+6 ; 0x06af84: 2b 85 ldd r18, Y+11 ; 0x0baf86: 3c 85 ldd r19, Y+12 ; 0x0caf88: e2 1b sub r30, r18af8a: f3 0b sbc r31, r19af8c: fe 83 std Y+6, r31 ; 0x06af8e: ed 83 std Y+5, r30 ; 0x05af90: 21 c0 rjmp .+66 ; 0xafd4 <MotorRegler+0x3fc8>else tmp_int += ((long)pd_ergebnis_roll * Mixer.Motor[i][2]) / 64L;af92: bb 27 eor r27, r27af94: a7 fd sbrc r26, 7af96: b0 95 com r27af98: 2d 89 ldd r18, Y+21 ; 0x15af9a: 3e 89 ldd r19, Y+22 ; 0x16af9c: 4f 89 ldd r20, Y+23 ; 0x17af9e: 58 8d ldd r21, Y+24 ; 0x18afa0: 0e 94 d2 b1 call 0x163a4 ; 0x163a4 <__mulshisi3>afa4: 9b 01 movw r18, r22afa6: ac 01 movw r20, r24afa8: 99 23 and r25, r25afaa: 24 f4 brge .+8 ; 0xafb4 <MotorRegler+0x3fa8>afac: 21 5c subi r18, 0xC1 ; 193afae: 3f 4f sbci r19, 0xFF ; 255afb0: 4f 4f sbci r20, 0xFF ; 255afb2: 5f 4f sbci r21, 0xFF ; 255afb4: da 01 movw r26, r20afb6: c9 01 movw r24, r18afb8: 68 94 setafba: 15 f8 bld r1, 5afbc: b5 95 asr r27afbe: a7 95 ror r26afc0: 97 95 ror r25afc2: 87 95 ror r24afc4: 16 94 lsr r1afc6: d1 f7 brne .-12 ; 0xafbc <MotorRegler+0x3fb0>afc8: ed 81 ldd r30, Y+5 ; 0x05afca: fe 81 ldd r31, Y+6 ; 0x06afcc: e8 0f add r30, r24afce: f9 1f adc r31, r25afd0: fe 83 std Y+6, r31 ; 0x06afd2: ed 83 std Y+5, r30 ; 0x05// Gierif(Mixer.Motor[i][3] == 64) tmp_int += GierMischanteil;afd4: ed a1 ldd r30, Y+37 ; 0x25afd6: fe a1 ldd r31, Y+38 ; 0x26afd8: a0 81 ld r26, Zafda: a0 34 cpi r26, 0x40 ; 64afdc: 39 f4 brne .+14 ; 0xafec <MotorRegler+0x3fe0>afde: ed 81 ldd r30, Y+5 ; 0x05afe0: fe 81 ldd r31, Y+6 ; 0x06afe2: 29 85 ldd r18, Y+9 ; 0x09afe4: 3a 85 ldd r19, Y+10 ; 0x0aafe6: e2 0f add r30, r18afe8: f3 1f adc r31, r19afea: 28 c0 rjmp .+80 ; 0xb03c <MotorRegler+0x4030>else if(Mixer.Motor[i][3] == -64) tmp_int -= GierMischanteil;afec: a0 3c cpi r26, 0xC0 ; 192afee: 39 f4 brne .+14 ; 0xaffe <MotorRegler+0x3ff2>aff0: ed 81 ldd r30, Y+5 ; 0x05aff2: fe 81 ldd r31, Y+6 ; 0x06aff4: 49 85 ldd r20, Y+9 ; 0x09aff6: 5a 85 ldd r21, Y+10 ; 0x0aaff8: e4 1b sub r30, r20affa: f5 0b sbc r31, r21affc: 1f c0 rjmp .+62 ; 0xb03c <MotorRegler+0x4030>else tmp_int += ((long)GierMischanteil * Mixer.Motor[i][3]) / 64L;affe: bb 27 eor r27, r27b000: a7 fd sbrc r26, 7b002: b0 95 com r27b004: 29 89 ldd r18, Y+17 ; 0x11b006: 3a 89 ldd r19, Y+18 ; 0x12b008: 4b 89 ldd r20, Y+19 ; 0x13b00a: 5c 89 ldd r21, Y+20 ; 0x14b00c: 0e 94 d2 b1 call 0x163a4 ; 0x163a4 <__mulshisi3>b010: 9b 01 movw r18, r22b012: ac 01 movw r20, r24b014: 99 23 and r25, r25b016: 24 f4 brge .+8 ; 0xb020 <MotorRegler+0x4014>b018: 21 5c subi r18, 0xC1 ; 193b01a: 3f 4f sbci r19, 0xFF ; 255b01c: 4f 4f sbci r20, 0xFF ; 255b01e: 5f 4f sbci r21, 0xFF ; 255b020: da 01 movw r26, r20b022: c9 01 movw r24, r18b024: 68 94 setb026: 15 f8 bld r1, 5b028: b5 95 asr r27b02a: a7 95 ror r26b02c: 97 95 ror r25b02e: 87 95 ror r24b030: 16 94 lsr r1b032: d1 f7 brne .-12 ; 0xb028 <MotorRegler+0x401c>b034: ed 81 ldd r30, Y+5 ; 0x05b036: fe 81 ldd r31, Y+6 ; 0x06b038: e8 0f add r30, r24b03a: f9 1f adc r31, r25b03c: 92 01 movw r18, r4b03e: d2 01 movw r26, r4b040: 12 97 sbiw r26, 0x02 ; 2#ifdef REDUNDANT_FC_SLAVEtmp_int = (tmp_motorwert[i] + tmp_int) / 2;#elseif(Motor[i].Version & MOTOR_STATE_FAST_MODE || tmp_int > tmp_motorwert[i]) tmp_int = (tmp_motorwert[i] + tmp_int) / 2; // Beschleunigenb042: 8c 91 ld r24, Xb044: 81 fd sbrc r24, 1b046: 06 c0 rjmp .+12 ; 0xb054 <MotorRegler+0x4048>b048: d3 01 movw r26, r6b04a: 8d 91 ld r24, X+b04c: 9c 91 ld r25, Xb04e: 8e 17 cp r24, r30b050: 9f 07 cpc r25, r31b052: 5c f4 brge .+22 ; 0xb06a <MotorRegler+0x405e>b054: d3 01 movw r26, r6b056: 8d 91 ld r24, X+b058: 9c 91 ld r25, Xb05a: e8 0f add r30, r24b05c: f9 1f adc r31, r25b05e: ff 23 and r31, r31b060: 0c f4 brge .+2 ; 0xb064 <MotorRegler+0x4058>b062: 31 96 adiw r30, 0x01 ; 1b064: f5 95 asr r31b066: e7 95 ror r30b068: 11 c0 rjmp .+34 ; 0xb08c <MotorRegler+0x4080>else{ // BL-Ctrl 1.0 or 2.0if(EE_Parameter.MotorSmooth == 0)b06a: 11 11 cpse r17, r1b06c: 05 c0 rjmp .+10 ; 0xb078 <MotorRegler+0x406c>{tmp_int = 2 * tmp_int - tmp_motorwert[i]; // original MotorSmoothingb06e: ee 0f add r30, r30b070: ff 1f adc r31, r31b072: e8 1b sub r30, r24b074: f9 0b sbc r31, r25b076: 0a c0 rjmp .+20 ; 0xb08c <MotorRegler+0x4080>}else // 1 means tmp_int = tmp_int;if(EE_Parameter.MotorSmooth > 1)b078: 12 30 cpi r17, 0x02 ; 2b07a: 40 f0 brcs .+16 ; 0xb08c <MotorRegler+0x4080>{// If >= 2 then allow >= 50% of the intended step down to rapidly reach the intended value.tmp_int = tmp_int + ((tmp_motorwert[i] - tmp_int) / EE_Parameter.MotorSmooth);b07c: 8e 1b sub r24, r30b07e: 9f 0b sbc r25, r31b080: 6b a1 ldd r22, Y+35 ; 0x23b082: 7c a1 ldd r23, Y+36 ; 0x24b084: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>b088: e6 0f add r30, r22b08a: f7 1f adc r31, r23}}#endifLIMIT_MIN_MAX(tmp_int,(int) MIN_GAS * 4,(int) MAX_GAS * 4);b08c: 49 81 ldd r20, Y+1 ; 0x01b08e: 5a 81 ldd r21, Y+2 ; 0x02b090: 4e 17 cp r20, r30b092: 5f 07 cpc r21, r31b094: 44 f4 brge .+16 ; 0xb0a6 <MotorRegler+0x409a>b096: 6f 85 ldd r22, Y+15 ; 0x0fb098: 78 89 ldd r23, Y+16 ; 0x10b09a: 6e 17 cp r22, r30b09c: 7f 07 cpc r23, r31b09e: 2c f4 brge .+10 ; 0xb0aa <MotorRegler+0x409e>b0a0: e9 a1 ldd r30, Y+33 ; 0x21b0a2: fa a1 ldd r31, Y+34 ; 0x22b0a4: 02 c0 rjmp .+4 ; 0xb0aa <MotorRegler+0x409e>b0a6: ed 8d ldd r30, Y+29 ; 0x1db0a8: fe 8d ldd r31, Y+30 ; 0x1eMotor[i].SetPoint = tmp_int / 4;b0aa: cf 01 movw r24, r30b0ac: ff 23 and r31, r31b0ae: 0c f4 brge .+2 ; 0xb0b2 <MotorRegler+0x40a6>b0b0: 03 96 adiw r24, 0x03 ; 3b0b2: 95 95 asr r25b0b4: 87 95 ror r24b0b6: 95 95 asr r25b0b8: 87 95 ror r24b0ba: d5 01 movw r26, r10b0bc: 8c 93 st X, r24Motor[i].SetPointLowerBits = (tmp_int % 4)<<1; // (3 bits total)b0be: cf 01 movw r24, r30b0c0: 83 70 andi r24, 0x03 ; 3b0c2: 90 78 andi r25, 0x80 ; 128b0c4: 99 23 and r25, r25b0c6: 24 f4 brge .+8 ; 0xb0d0 <MotorRegler+0x40c4>b0c8: 01 97 sbiw r24, 0x01 ; 1b0ca: 8c 6f ori r24, 0xFC ; 252b0cc: 9f 6f ori r25, 0xFF ; 255b0ce: 01 96 adiw r24, 0x01 ; 1b0d0: 88 0f add r24, r24b0d2: d9 01 movw r26, r18b0d4: 8c 93 st X, r24tmp_motorwert[i] = tmp_int;b0d6: d3 01 movw r26, r6b0d8: ed 93 st X+, r30b0da: fc 93 st X, r31b0dc: 04 c0 rjmp .+8 ; 0xb0e6 <MotorRegler+0x40da>}else{Motor[i].SetPoint = 0;b0de: f5 01 movw r30, r10b0e0: 10 82 st Z, r1Motor[i].SetPointLowerBits = 0;b0e2: d2 01 movw r26, r4b0e4: 1c 92 st X, r1b0e6: bf e0 ldi r27, 0x0F ; 15b0e8: ab 0e add r10, r27b0ea: b1 1c adc r11, r1b0ec: ef e0 ldi r30, 0x0F ; 15b0ee: 4e 0e add r4, r30b0f0: 51 1c adc r5, r1b0f2: f2 e0 ldi r31, 0x02 ; 2b0f4: 6f 0e add r6, r31b0f6: 71 1c adc r7, r1b0f8: 04 e0 ldi r16, 0x04 ; 4b0fa: 80 0e add r8, r16b0fc: 91 1c adc r9, r1// send SPI pending bytesif(BytegapSPI == 0) SPI_TransmitByte();// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++// Universal Mixer// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++for(i=0; i<MAX_MOTORS; i++)b0fe: 42 14 cp r4, r2b100: 53 04 cpc r5, r3b102: 09 f0 breq .+2 ; 0xb106 <MotorRegler+0x40fa>b104: c7 ce rjmp .-626 ; 0xae94 <MotorRegler+0x3e88>b106: ae c0 rjmp .+348 ; 0xb264 <MotorRegler+0x4258>tmp_int = (tmp_motorwert[i] + tmp_int) / 2;#elseif(Motor[i].Version & MOTOR_STATE_FAST_MODE || tmp_int > tmp_motorwert[i]) tmp_int = (tmp_motorwert[i] + tmp_int) / 2; // Beschleunigenelse{ // BL-Ctrl 1.0 or 2.0if(EE_Parameter.MotorSmooth == 0)b108: 50 90 a4 05 lds r5, 0x05A4}else // 1 means tmp_int = tmp_int;if(EE_Parameter.MotorSmooth > 1){// If >= 2 then allow >= 50% of the intended step down to rapidly reach the intended value.tmp_int = tmp_int + ((tmp_motorwert[i] - tmp_int) / EE_Parameter.MotorSmooth);b10c: e5 2d mov r30, r5b10e: f0 e0 ldi r31, 0x00 ; 0b110: fc a3 std Y+36, r31 ; 0x24b112: eb a3 std Y+35, r30 ; 0x23}}#endifLIMIT_MIN_MAX(tmp_int,(int) MIN_GAS * 4,(int) MAX_GAS * 4);b114: 80 91 2c 06 lds r24, 0x062Cb118: 90 e0 ldi r25, 0x00 ; 0b11a: 4c 01 movw r8, r24b11c: 88 0c add r8, r8b11e: 99 1c adc r9, r9b120: 88 0c add r8, r8b122: 99 1c adc r9, r9b124: 9a 82 std Y+2, r9 ; 0x02b126: 89 82 std Y+1, r8 ; 0x01b128: 80 91 64 06 lds r24, 0x0664b12c: 90 e0 ldi r25, 0x00 ; 0b12e: 5c 01 movw r10, r24b130: aa 0c add r10, r10b132: bb 1c adc r11, r11b134: aa 0c add r10, r10b136: bb 1c adc r11, r11b138: b8 8a std Y+16, r11 ; 0x10b13a: af 86 std Y+15, r10 ; 0x0fb13c: 0f 2e mov r0, r31b13e: f8 e9 ldi r31, 0x98 ; 152b140: 6f 2e mov r6, r31b142: f9 e0 ldi r31, 0x09 ; 9b144: 7f 2e mov r7, r31b146: f0 2d mov r31, r0b148: 09 e9 ldi r16, 0x99 ; 153b14a: 19 e0 ldi r17, 0x09 ; 9b14c: 0f 2e mov r0, r31b14e: f3 e4 ldi r31, 0x43 ; 67b150: 8f 2e mov r8, r31b152: f6 e0 ldi r31, 0x06 ; 6b154: 9f 2e mov r9, r31b156: f0 2d mov r31, r0b158: 0f 2e mov r0, r31b15a: f7 ed ldi r31, 0xD7 ; 215b15c: af 2e mov r10, r31b15e: f5 e0 ldi r31, 0x05 ; 5b160: bf 2e mov r11, r31b162: f0 2d mov r31, r0b164: 0f 2e mov r0, r31b166: fd e4 ldi r31, 0x4D ; 77b168: 2f 2e mov r2, r31b16a: fa e0 ldi r31, 0x0A ; 10b16c: 3f 2e mov r3, r31b16e: f0 2d mov r31, r0b170: e9 80 ldd r14, Y+1 ; 0x01b172: ed 8e std Y+29, r14 ; 0x1db174: fa 80 ldd r15, Y+2 ; 0x02b176: fe 8e std Y+30, r15 ; 0x1eb178: ef 85 ldd r30, Y+15 ; 0x0fb17a: e9 a3 std Y+33, r30 ; 0x21b17c: f8 89 ldd r31, Y+16 ; 0x10b17e: fa a3 std Y+34, r31 ; 0x22else if(Mixer.Motor[i][2] == -64) tmp_int -= pd_ergebnis_roll;else tmp_int += ((long)pd_ergebnis_roll * Mixer.Motor[i][2]) / 64L;// Gierif(Mixer.Motor[i][3] == 64) tmp_int += GierMischanteil;else if(Mixer.Motor[i][3] == -64) tmp_int -= GierMischanteil;else tmp_int += ((long)GierMischanteil * Mixer.Motor[i][3]) / 64L;b180: 29 85 ldd r18, Y+9 ; 0x09b182: 3a 85 ldd r19, Y+10 ; 0x0ab184: 44 27 eor r20, r20b186: 37 fd sbrc r19, 7b188: 40 95 com r20b18a: 54 2f mov r21, r20b18c: 29 8b std Y+17, r18 ; 0x11b18e: 3a 8b std Y+18, r19 ; 0x12b190: 4b 8b std Y+19, r20 ; 0x13b192: 5c 8b std Y+20, r21 ; 0x14else if(Mixer.Motor[i][1] == -64) tmp_int -= pd_ergebnis_nick;else tmp_int += ((long)pd_ergebnis_nick * Mixer.Motor[i][1]) / 64L;// Rollif(Mixer.Motor[i][2] == 64) tmp_int += pd_ergebnis_roll;else if(Mixer.Motor[i][2] == -64) tmp_int -= pd_ergebnis_roll;else tmp_int += ((long)pd_ergebnis_roll * Mixer.Motor[i][2]) / 64L;b194: 4b 85 ldd r20, Y+11 ; 0x0bb196: 5c 85 ldd r21, Y+12 ; 0x0cb198: 66 27 eor r22, r22b19a: 57 fd sbrc r21, 7b19c: 60 95 com r22b19e: 76 2f mov r23, r22b1a0: 4d 8b std Y+21, r20 ; 0x15b1a2: 5e 8b std Y+22, r21 ; 0x16b1a4: 6f 8b std Y+23, r22 ; 0x17b1a6: 78 8f std Y+24, r23 ; 0x18// Gasif(Mixer.Motor[i][0] == 64) tmp_int = GasMischanteil; else tmp_int = ((long)GasMischanteil * Mixer.Motor[i][0]) / 64L;// Nickif(Mixer.Motor[i][1] == 64) tmp_int += pd_ergebnis_nick;else if(Mixer.Motor[i][1] == -64) tmp_int -= pd_ergebnis_nick;else tmp_int += ((long)pd_ergebnis_nick * Mixer.Motor[i][1]) / 64L;b1a8: 6d 85 ldd r22, Y+13 ; 0x0db1aa: 7e 85 ldd r23, Y+14 ; 0x0eb1ac: 88 27 eor r24, r24b1ae: 77 fd sbrc r23, 7b1b0: 80 95 com r24b1b2: 98 2f mov r25, r24b1b4: 69 8f std Y+25, r22 ; 0x19b1b6: 7a 8f std Y+26, r23 ; 0x1ab1b8: 8b 8f std Y+27, r24 ; 0x1bb1ba: 9c 8f std Y+28, r25 ; 0x1c{signed int tmp_int;if(Mixer.Motor[i][0] > 0){// Gasif(Mixer.Motor[i][0] == 64) tmp_int = GasMischanteil; else tmp_int = ((long)GasMischanteil * Mixer.Motor[i][0]) / 64L;b1bc: ed 81 ldd r30, Y+5 ; 0x05b1be: ef 8f std Y+31, r30 ; 0x1fb1c0: fe 81 ldd r31, Y+6 ; 0x06b1c2: f8 a3 std Y+32, r31 ; 0x20b1c4: 2d 81 ldd r18, Y+5 ; 0x05b1c6: 3e 81 ldd r19, Y+6 ; 0x06b1c8: 69 01 movw r12, r18b1ca: ee 24 eor r14, r14b1cc: d7 fc sbrc r13, 7b1ce: e0 94 com r14b1d0: fe 2c mov r15, r14b1d2: c4 01 movw r24, r8b1d4: 45 01 movw r8, r10b1d6: 53 01 movw r10, r6b1d8: 98 01 movw r18, r16b1da: 15 2d mov r17, r5b1dc: 29 01 movw r4, r18b1de: 3c 01 movw r6, r24b1e0: 59 ce rjmp .-846 ; 0xae94 <MotorRegler+0x3e88>MittelIntegralNick += IntegralNick; // Für die Mittelwertbildung aufsummierenMittelIntegralRoll += IntegralRoll;if(Looping_Nick || Looping_Roll){MittelIntegralNick = 0;b1e2: 10 92 34 06 sts 0x0634, r1b1e6: 10 92 35 06 sts 0x0635, r1b1ea: 10 92 36 06 sts 0x0636, r1b1ee: 10 92 37 06 sts 0x0637, r1MittelIntegralRoll = 0;b1f2: 10 92 3c 06 sts 0x063C, r1b1f6: 10 92 3d 06 sts 0x063D, r1b1fa: 10 92 3e 06 sts 0x063E, r1b1fe: 10 92 3f 06 sts 0x063F, r1ZaehlMessungen = 0;b202: 10 92 53 03 sts 0x0353, r1b206: 10 92 52 03 sts 0x0352, r1LageKorrekturNick = 0;b20a: 10 92 eb 03 sts 0x03EB, r1b20e: 10 92 ea 03 sts 0x03EA, r1LageKorrekturRoll = 0;b212: 10 92 ed 03 sts 0x03ED, r1b216: 10 92 ec 03 sts 0x03EC, r1}// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++if(!Looping_Nick && !Looping_Roll && (Aktuell_az > 512 || MotorenEin))b21a: 80 91 e6 03 lds r24, 0x03E6b21e: 81 11 cpse r24, r1b220: 0c 94 13 45 jmp 0x8a26 ; 0x8a26 <MotorRegler+0x1a1a>b224: 0c 94 27 43 jmp 0x864e ; 0x864e <MotorRegler+0x1642>MittelIntegralNick += IntegralNick; // Für die Mittelwertbildung aufsummierenMittelIntegralRoll += IntegralRoll;if(Looping_Nick || Looping_Roll){MittelIntegralNick = 0;b228: 10 92 34 06 sts 0x0634, r1b22c: 10 92 35 06 sts 0x0635, r1b230: 10 92 36 06 sts 0x0636, r1b234: 10 92 37 06 sts 0x0637, r1MittelIntegralRoll = 0;b238: 10 92 3c 06 sts 0x063C, r1b23c: 10 92 3d 06 sts 0x063D, r1b240: 10 92 3e 06 sts 0x063E, r1b244: 10 92 3f 06 sts 0x063F, r1ZaehlMessungen = 0;b248: 10 92 53 03 sts 0x0353, r1b24c: 10 92 52 03 sts 0x0352, r1LageKorrekturNick = 0;b250: 10 92 eb 03 sts 0x03EB, r1b254: 10 92 ea 03 sts 0x03EA, r1LageKorrekturRoll = 0;b258: 10 92 ed 03 sts 0x03ED, r1b25c: 10 92 ec 03 sts 0x03EC, r1b260: 0c 94 13 45 jmp 0x8a26 ; 0x8a26 <MotorRegler+0x1a1a>}}#ifdef REDUNDANT_FC_MASTERif(Parameter_UserParam6 > 230) Motor[0].SetPoint = 0;#endif}b264: a6 96 adiw r28, 0x26 ; 38b266: 0f b6 in r0, 0x3f ; 63b268: f8 94 clib26a: de bf out 0x3e, r29 ; 62b26c: 0f be out 0x3f, r0 ; 63b26e: cd bf out 0x3d, r28 ; 61b270: df 91 pop r29b272: cf 91 pop r28b274: 1f 91 pop r17b276: 0f 91 pop r16b278: ff 90 pop r15b27a: ef 90 pop r14b27c: df 90 pop r13b27e: cf 90 pop r12b280: bf 90 pop r11b282: af 90 pop r10b284: 9f 90 pop r9b286: 8f 90 pop r8b288: 7f 90 pop r7b28a: 6f 90 pop r6b28c: 5f 90 pop r5b28e: 4f 90 pop r4b290: 3f 90 pop r3b292: 2f 90 pop r2b294: 08 95 ret0000b296 <PrintLine>:unsigned char ActiveParamSet = 3;unsigned char LipoCells = 4;void PrintLine(void){printf("\n\r===================================");b296: 88 e6 ldi r24, 0x68 ; 104b298: 94 e0 ldi r25, 0x04 ; 4b29a: 9f 93 push r25b29c: 8f 93 push r24b29e: 87 eb ldi r24, 0xB7 ; 183b2a0: 9c ea ldi r25, 0xAC ; 172b2a2: 9f 93 push r25b2a4: 8f 93 push r24b2a6: e0 91 78 06 lds r30, 0x0678b2aa: f0 91 79 06 lds r31, 0x0679b2ae: 09 95 icallb2b0: 0f 90 pop r0b2b2: 0f 90 pop r0b2b4: 0f 90 pop r0b2b6: 0f 90 pop r0b2b8: 08 95 ret0000b2ba <CalMk3Mag>:void CalMk3Mag(void){static unsigned char stick = 1;if(PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] > -20) stick = 0;b2ba: 80 91 3f 05 lds r24, 0x053Fb2be: 90 e0 ldi r25, 0x00 ; 0b2c0: fc 01 movw r30, r24b2c2: ee 0f add r30, r30b2c4: ff 1f adc r31, r31b2c6: ef 5c subi r30, 0xCF ; 207b2c8: f7 4f sbci r31, 0xF7 ; 247b2ca: 20 81 ld r18, Zb2cc: 31 81 ldd r19, Z+1 ; 0x01b2ce: 2d 3e cpi r18, 0xED ; 237b2d0: 3f 4f sbci r19, 0xFF ; 255b2d2: 14 f0 brlt .+4 ; 0xb2d8 <CalMk3Mag+0x1e>b2d4: 10 92 50 01 sts 0x0150, r1if((PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] < -70) && !stick)b2d8: fc 01 movw r30, r24b2da: ee 0f add r30, r30b2dc: ff 1f adc r31, r31b2de: ef 5c subi r30, 0xCF ; 207b2e0: f7 4f sbci r31, 0xF7 ; 247b2e2: 80 81 ld r24, Zb2e4: 91 81 ldd r25, Z+1 ; 0x01b2e6: 8a 3b cpi r24, 0xBA ; 186b2e8: 9f 4f sbci r25, 0xFF ; 255b2ea: cc f4 brge .+50 ; 0xb31e <CalMk3Mag+0x64>b2ec: 80 91 50 01 lds r24, 0x0150b2f0: 81 11 cpse r24, r1b2f2: 15 c0 rjmp .+42 ; 0xb31e <CalMk3Mag+0x64>{stick = 1;b2f4: 81 e0 ldi r24, 0x01 ; 1b2f6: 80 93 50 01 sts 0x0150, r24WinkelOut.CalcState++;b2fa: ed e7 ldi r30, 0x7D ; 125b2fc: fa e0 ldi r31, 0x0A ; 10b2fe: 80 81 ld r24, Zb300: 8f 5f subi r24, 0xFF ; 255b302: 80 83 st Z, r24if(WinkelOut.CalcState > 4)b304: 85 30 cpi r24, 0x05 ; 5b306: 38 f0 brcs .+14 ; 0xb316 <CalMk3Mag+0x5c>{// WinkelOut.CalcState = 0; // in Uart.cbeeptime = 1000;b308: 88 ee ldi r24, 0xE8 ; 232b30a: 93 e0 ldi r25, 0x03 ; 3b30c: 90 93 ce 04 sts 0x04CE, r25b310: 80 93 cd 04 sts 0x04CD, r24b314: 08 95 ret}else Piep(WinkelOut.CalcState,150);b316: 66 e9 ldi r22, 0x96 ; 150b318: 70 e0 ldi r23, 0x00 ; 0b31a: 0c 94 ba 28 jmp 0x5174 ; 0x5174 <Piep>b31e: 08 95 ret0000b320 <LipoDetection>:}}void LipoDetection(unsigned char print){b320: cf 93 push r28b322: c8 2f mov r28, r24#define MAX_CELL_VOLTAGE 43 // max cell voltage for LiPOif(print)b324: 88 23 and r24, r24b326: 11 f1 breq .+68 ; 0xb36c <LipoDetection+0x4c>{printf("\n\rBatt:");b328: 20 e6 ldi r18, 0x60 ; 96b32a: 34 e0 ldi r19, 0x04 ; 4b32c: 3f 93 push r19b32e: 2f 93 push r18b330: 27 eb ldi r18, 0xB7 ; 183b332: 3c ea ldi r19, 0xAC ; 172b334: 3f 93 push r19b336: 2f 93 push r18b338: e0 91 78 06 lds r30, 0x0678b33c: f0 91 79 06 lds r31, 0x0679b340: 09 95 icallLipoCells = 1 + UBat / MAX_CELL_VOLTAGE;b342: 80 91 1a 01 lds r24, 0x011Ab346: 90 91 1b 01 lds r25, 0x011Bb34a: 6b e2 ldi r22, 0x2B ; 43b34c: 70 e0 ldi r23, 0x00 ; 0b34e: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>b352: 6f 5f subi r22, 0xFF ; 255if(LipoCells > 6) LipoCells = 6;b354: 0f 90 pop r0b356: 0f 90 pop r0b358: 0f 90 pop r0b35a: 0f 90 pop r0b35c: 67 30 cpi r22, 0x07 ; 7b35e: 18 f4 brcc .+6 ; 0xb366 <LipoDetection+0x46>{#define MAX_CELL_VOLTAGE 43 // max cell voltage for LiPOif(print){printf("\n\rBatt:");LipoCells = 1 + UBat / MAX_CELL_VOLTAGE;b360: 60 93 51 01 sts 0x0151, r22b364: 03 c0 rjmp .+6 ; 0xb36c <LipoDetection+0x4c>if(LipoCells > 6) LipoCells = 6;b366: 86 e0 ldi r24, 0x06 ; 6b368: 80 93 51 01 sts 0x0151, r24}if(EE_Parameter.UnterspannungsWarnung < 50)b36c: 90 91 62 05 lds r25, 0x0562b370: 92 33 cpi r25, 0x32 ; 50b372: 28 f5 brcc .+74 ; 0xb3be <LipoDetection+0x9e>{BattLowVoltageWarning = LipoCells * EE_Parameter.UnterspannungsWarnung;b374: 80 91 51 01 lds r24, 0x0151b378: 89 9f mul r24, r25b37a: 90 2d mov r25, r0b37c: 11 24 eor r1, r1b37e: 90 93 53 01 sts 0x0153, r25if(print)b382: cc 23 and r28, r28b384: f1 f0 breq .+60 ; 0xb3c2 <LipoDetection+0xa2>{Piep(LipoCells, 200);b386: 68 ec ldi r22, 0xC8 ; 200b388: 70 e0 ldi r23, 0x00 ; 0b38a: 0e 94 ba 28 call 0x5174 ; 0x5174 <Piep>printf(" %d Cells ", LipoCells);b38e: 80 91 51 01 lds r24, 0x0151b392: 1f 92 push r1b394: 8f 93 push r24b396: 25 e5 ldi r18, 0x55 ; 85b398: 34 e0 ldi r19, 0x04 ; 4b39a: 3f 93 push r19b39c: 2f 93 push r18b39e: 27 eb ldi r18, 0xB7 ; 183b3a0: 3c ea ldi r19, 0xAC ; 172b3a2: 3f 93 push r19b3a4: 2f 93 push r18b3a6: e0 91 78 06 lds r30, 0x0678b3aa: f0 91 79 06 lds r31, 0x0679b3ae: 09 95 icallb3b0: 0f 90 pop r0b3b2: 0f 90 pop r0b3b4: 0f 90 pop r0b3b6: 0f 90 pop r0b3b8: 0f 90 pop r0b3ba: 0f 90 pop r0b3bc: 02 c0 rjmp .+4 ; 0xb3c2 <LipoDetection+0xa2>}}else BattLowVoltageWarning = EE_Parameter.UnterspannungsWarnung;b3be: 90 93 53 01 sts 0x0153, r25// automatische Zellenerkennungif(EE_Parameter.AutoLandingVoltage < 50) BattAutoLandingVoltage = LipoCells * EE_Parameter.AutoLandingVoltage; else BattAutoLandingVoltage = EE_Parameter.AutoLandingVoltage;b3c2: 80 91 b2 05 lds r24, 0x05B2b3c6: 82 33 cpi r24, 0x32 ; 50b3c8: 40 f4 brcc .+16 ; 0xb3da <LipoDetection+0xba>b3ca: 90 91 51 01 lds r25, 0x0151b3ce: 98 9f mul r25, r24b3d0: 80 2d mov r24, r0b3d2: 11 24 eor r1, r1b3d4: 80 93 65 04 sts 0x0465, r24b3d8: 02 c0 rjmp .+4 ; 0xb3de <LipoDetection+0xbe>b3da: 80 93 65 04 sts 0x0465, r24if(EE_Parameter.ComingHomeVoltage < 50) BattComingHomeVoltage = LipoCells * EE_Parameter.ComingHomeVoltage; else BattComingHomeVoltage = EE_Parameter.ComingHomeVoltage;b3de: 80 91 b3 05 lds r24, 0x05B3b3e2: 82 33 cpi r24, 0x32 ; 50b3e4: 40 f4 brcc .+16 ; 0xb3f6 <LipoDetection+0xd6>b3e6: 90 91 51 01 lds r25, 0x0151b3ea: 98 9f mul r25, r24b3ec: 90 2d mov r25, r0b3ee: 11 24 eor r1, r1b3f0: 90 93 64 04 sts 0x0464, r25b3f4: 02 c0 rjmp .+4 ; 0xb3fa <LipoDetection+0xda>b3f6: 80 93 64 04 sts 0x0464, r24if(BattAutoLandingVoltage > BattLowVoltageWarning) BattAutoLandingVoltage = BattLowVoltageWarning - 1;b3fa: 90 91 53 01 lds r25, 0x0153b3fe: 20 91 65 04 lds r18, 0x0465b402: 92 17 cp r25, r18b404: 20 f4 brcc .+8 ; 0xb40e <LipoDetection+0xee>b406: 2f ef ldi r18, 0xFF ; 255b408: 29 0f add r18, r25b40a: 20 93 65 04 sts 0x0465, r18if(BattComingHomeVoltage >= BattLowVoltageWarning) BattComingHomeVoltage = BattLowVoltageWarning - 1;b40e: 20 91 64 04 lds r18, 0x0464b412: 29 17 cp r18, r25b414: 20 f0 brcs .+8 ; 0xb41e <LipoDetection+0xfe>b416: 2f ef ldi r18, 0xFF ; 255b418: 29 0f add r18, r25b41a: 20 93 64 04 sts 0x0464, r18if(BattAutoLandingVoltage >= BattComingHomeVoltage && EE_Parameter.ComingHomeVoltage) BattAutoLandingVoltage = BattComingHomeVoltage - 1;b41e: 20 91 64 04 lds r18, 0x0464b422: 30 91 65 04 lds r19, 0x0465b426: 32 17 cp r19, r18b428: 28 f0 brcs .+10 ; 0xb434 <LipoDetection+0x114>b42a: 88 23 and r24, r24b42c: 19 f0 breq .+6 ; 0xb434 <LipoDetection+0x114>b42e: 21 50 subi r18, 0x01 ; 1b430: 20 93 65 04 sts 0x0465, r18if(print)b434: cc 23 and r28, r28b436: 09 f4 brne .+2 ; 0xb43a <LipoDetection+0x11a>b438: 7f c0 rjmp .+254 ; 0xb538 <LipoDetection+0x218>{printf(" Low warning: %d.%dV",BattLowVoltageWarning/10,BattLowVoltageWarning%10);b43a: 8d ec ldi r24, 0xCD ; 205b43c: 98 9f mul r25, r24b43e: 81 2d mov r24, r1b440: 11 24 eor r1, r1b442: 86 95 lsr r24b444: 86 95 lsr r24b446: 86 95 lsr r24b448: 28 2f mov r18, r24b44a: 22 0f add r18, r18b44c: 32 2f mov r19, r18b44e: 33 0f add r19, r19b450: 33 0f add r19, r19b452: 23 0f add r18, r19b454: 92 1b sub r25, r18b456: 1f 92 push r1b458: 9f 93 push r25b45a: 1f 92 push r1b45c: 8f 93 push r24b45e: 80 e4 ldi r24, 0x40 ; 64b460: 94 e0 ldi r25, 0x04 ; 4b462: 9f 93 push r25b464: 8f 93 push r24b466: 87 eb ldi r24, 0xB7 ; 183b468: 9c ea ldi r25, 0xAC ; 172b46a: 9f 93 push r25b46c: 8f 93 push r24b46e: e0 91 78 06 lds r30, 0x0678b472: f0 91 79 06 lds r31, 0x0679b476: 09 95 icallif(BattComingHomeVoltage) printf(" Auto-CH: %d.%dV",BattComingHomeVoltage/10,BattComingHomeVoltage%10);b478: 80 91 64 04 lds r24, 0x0464b47c: 2d b7 in r18, 0x3d ; 61b47e: 3e b7 in r19, 0x3e ; 62b480: 28 5f subi r18, 0xF8 ; 248b482: 3f 4f sbci r19, 0xFF ; 255b484: 0f b6 in r0, 0x3f ; 63b486: f8 94 clib488: 3e bf out 0x3e, r19 ; 62b48a: 0f be out 0x3f, r0 ; 63b48c: 2d bf out 0x3d, r18 ; 61b48e: 88 23 and r24, r24b490: 39 f1 breq .+78 ; 0xb4e0 <LipoDetection+0x1c0>b492: 9d ec ldi r25, 0xCD ; 205b494: 89 9f mul r24, r25b496: 91 2d mov r25, r1b498: 11 24 eor r1, r1b49a: 96 95 lsr r25b49c: 96 95 lsr r25b49e: 96 95 lsr r25b4a0: 29 2f mov r18, r25b4a2: 22 0f add r18, r18b4a4: 32 2f mov r19, r18b4a6: 33 0f add r19, r19b4a8: 33 0f add r19, r19b4aa: 23 0f add r18, r19b4ac: 82 1b sub r24, r18b4ae: 1f 92 push r1b4b0: 8f 93 push r24b4b2: 1f 92 push r1b4b4: 9f 93 push r25b4b6: 8e e2 ldi r24, 0x2E ; 46b4b8: 94 e0 ldi r25, 0x04 ; 4b4ba: 9f 93 push r25b4bc: 8f 93 push r24b4be: 87 eb ldi r24, 0xB7 ; 183b4c0: 9c ea ldi r25, 0xAC ; 172b4c2: 9f 93 push r25b4c4: 8f 93 push r24b4c6: e0 91 78 06 lds r30, 0x0678b4ca: f0 91 79 06 lds r31, 0x0679b4ce: 09 95 icallb4d0: 8d b7 in r24, 0x3d ; 61b4d2: 9e b7 in r25, 0x3e ; 62b4d4: 08 96 adiw r24, 0x08 ; 8b4d6: 0f b6 in r0, 0x3f ; 63b4d8: f8 94 clib4da: 9e bf out 0x3e, r25 ; 62b4dc: 0f be out 0x3f, r0 ; 63b4de: 8d bf out 0x3d, r24 ; 61if(BattAutoLandingVoltage) printf(" Autolanding: %d.%dV",BattAutoLandingVoltage/10,BattAutoLandingVoltage%10);b4e0: 80 91 65 04 lds r24, 0x0465b4e4: 88 23 and r24, r24b4e6: 41 f1 breq .+80 ; 0xb538 <LipoDetection+0x218>b4e8: 9d ec ldi r25, 0xCD ; 205b4ea: 89 9f mul r24, r25b4ec: 91 2d mov r25, r1b4ee: 11 24 eor r1, r1b4f0: 96 95 lsr r25b4f2: 96 95 lsr r25b4f4: 96 95 lsr r25b4f6: 29 2f mov r18, r25b4f8: 22 0f add r18, r18b4fa: 32 2f mov r19, r18b4fc: 33 0f add r19, r19b4fe: 33 0f add r19, r19b500: 23 0f add r18, r19b502: 82 1b sub r24, r18b504: 1f 92 push r1b506: 8f 93 push r24b508: 1f 92 push r1b50a: 9f 93 push r25b50c: 88 e1 ldi r24, 0x18 ; 24b50e: 94 e0 ldi r25, 0x04 ; 4b510: 9f 93 push r25b512: 8f 93 push r24b514: 87 eb ldi r24, 0xB7 ; 183b516: 9c ea ldi r25, 0xAC ; 172b518: 9f 93 push r25b51a: 8f 93 push r24b51c: e0 91 78 06 lds r30, 0x0678b520: f0 91 79 06 lds r31, 0x0679b524: 09 95 icallb526: 2d b7 in r18, 0x3d ; 61b528: 3e b7 in r19, 0x3e ; 62b52a: 28 5f subi r18, 0xF8 ; 248b52c: 3f 4f sbci r19, 0xFF ; 255b52e: 0f b6 in r0, 0x3f ; 63b530: f8 94 clib532: 3e bf out 0x3e, r19 ; 62b534: 0f be out 0x3f, r0 ; 63b536: 2d bf out 0x3d, r18 ; 61}}b538: cf 91 pop r28b53a: 08 95 ret0000b53c <main>:int main (void)//############################################################################{unsigned int timer,i,timer2 = 0, timerPolling;unsigned char update_spi = 1;DDRB = 0x00;b53c: 14 b8 out 0x04, r1 ; 4PORTB = 0x00;b53e: 15 b8 out 0x05, r1 ; 5DDRD = 0x0A; // UART & J3 J4 J5b540: 8a e0 ldi r24, 0x0A ; 10b542: 8a b9 out 0x0a, r24 ; 10PORTD = 0x5F; // PPM-Input & UARTb544: 8f e5 ldi r24, 0x5F ; 95b546: 8b b9 out 0x0b, r24 ; 11b548: 88 ee ldi r24, 0xE8 ; 232b54a: 93 e0 ldi r25, 0x03 ; 3b54c: 01 97 sbiw r24, 0x01 ; 1for(timer = 0; timer < 1000; timer++); // verzögernb54e: 00 97 sbiw r24, 0x00 ; 0b550: e9 f7 brne .-6 ; 0xb54c <main+0x10>#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))unsigned char AccZ_ErrorCnt = 0;if(PINB & 0x02)b552: 19 9b sbis 0x03, 1 ; 3b554: 0d c0 rjmp .+26 ; 0xb570 <main+0x34>{if(PIND & 0x10) PlatinenVersion = 21; // No Bridge from J4 to GNDb556: 4c 9b sbis 0x09, 4 ; 9b558: 04 c0 rjmp .+8 ; 0xb562 <main+0x26>b55a: 85 e1 ldi r24, 0x15 ; 21b55c: 80 93 54 01 sts 0x0154, r24b560: 0d c0 rjmp .+26 ; 0xb57c <main+0x40>else { PlatinenVersion = 22; ACC_AltitudeControl = 1;};b562: 86 e1 ldi r24, 0x16 ; 22b564: 80 93 54 01 sts 0x0154, r24b568: 81 e0 ldi r24, 0x01 ; 1b56a: 80 93 c2 03 sts 0x03C2, r24b56e: 06 c0 rjmp .+12 ; 0xb57c <main+0x40>}else{PlatinenVersion = 25; ACC_AltitudeControl = 1;b570: 89 e1 ldi r24, 0x19 ; 25b572: 80 93 54 01 sts 0x0154, r24b576: 81 e0 ldi r24, 0x01 ; 1b578: 80 93 c2 03 sts 0x03C2, r24PORTD = 0x47; //}}#endifDDRC = 0x81; // I2C, Spakerb57c: 81 e8 ldi r24, 0x81 ; 129b57e: 87 b9 out 0x07, r24 ; 7DDRC |=0x40; // HEF4017 Resetb580: 3e 9a sbi 0x07, 6 ; 7PORTC = 0xff; // Pullup SDAb582: 8f ef ldi r24, 0xFF ; 255b584: 88 b9 out 0x08, r24 ; 8DDRB = 0x1B; // LEDs und Druckoffsetb586: 8b e1 ldi r24, 0x1B ; 27b588: 84 b9 out 0x04, r24 ; 4PORTB = 0x01; // LED_Rotb58a: 81 e0 ldi r24, 0x01 ; 1b58c: 85 b9 out 0x05, r24 ; 5HEF4017Reset_ON;b58e: 46 9a sbi 0x08, 6 ; 8MCUSR &=~(1<<WDRF);b590: 84 b7 in r24, 0x34 ; 52b592: 87 7f andi r24, 0xF7 ; 247b594: 84 bf out 0x34, r24 ; 52WDTCSR |= (1<<WDCE)|(1<<WDE);b596: e0 e6 ldi r30, 0x60 ; 96b598: f0 e0 ldi r31, 0x00 ; 0b59a: 80 81 ld r24, Zb59c: 88 61 ori r24, 0x18 ; 24b59e: 80 83 st Z, r24WDTCSR = 0;b5a0: 10 82 st Z, r1beeptime = 2500;b5a2: 84 ec ldi r24, 0xC4 ; 196b5a4: 99 e0 ldi r25, 0x09 ; 9b5a6: 90 93 ce 04 sts 0x04CE, r25b5aa: 80 93 cd 04 sts 0x04CD, r24StickGier = 0; PPM_in[K_GAS] = 0; StickRoll = 0; StickNick = 0;b5ae: 10 92 11 04 sts 0x0411, r1b5b2: 10 92 10 04 sts 0x0410, r1b5b6: 10 92 36 08 sts 0x0836, r1b5ba: 10 92 35 08 sts 0x0835, r1b5be: 10 92 13 04 sts 0x0413, r1b5c2: 10 92 12 04 sts 0x0412, r1b5c6: 10 92 15 04 sts 0x0415, r1b5ca: 10 92 14 04 sts 0x0414, r1if(PlatinenVersion >= 20) GIER_GRAD_FAKTOR = 1220; else GIER_GRAD_FAKTOR = 1291; // unterschiedlich für ME und ENCb5ce: 80 91 54 01 lds r24, 0x0154b5d2: 84 31 cpi r24, 0x14 ; 20b5d4: 68 f0 brcs .+26 ; 0xb5f0 <main+0xb4>b5d6: 84 ec ldi r24, 0xC4 ; 196b5d8: 94 e0 ldi r25, 0x04 ; 4b5da: a0 e0 ldi r26, 0x00 ; 0b5dc: b0 e0 ldi r27, 0x00 ; 0b5de: 80 93 21 01 sts 0x0121, r24b5e2: 90 93 22 01 sts 0x0122, r25b5e6: a0 93 23 01 sts 0x0123, r26b5ea: b0 93 24 01 sts 0x0124, r27b5ee: 0c c0 rjmp .+24 ; 0xb608 <main+0xcc>b5f0: 8b e0 ldi r24, 0x0B ; 11b5f2: 95 e0 ldi r25, 0x05 ; 5b5f4: a0 e0 ldi r26, 0x00 ; 0b5f6: b0 e0 ldi r27, 0x00 ; 0b5f8: 80 93 21 01 sts 0x0121, r24b5fc: 90 93 22 01 sts 0x0122, r25b600: a0 93 23 01 sts 0x0123, r26b604: b0 93 24 01 sts 0x0124, r27ROT_OFF;b608: 28 98 cbi 0x05, 0 ; 5GRN_ON;b60a: 80 91 54 01 lds r24, 0x0154b60e: 89 31 cpi r24, 0x19 ; 25b610: 11 f4 brne .+4 ; 0xb616 <main+0xda>b612: 29 9a sbi 0x05, 1 ; 5b614: 01 c0 rjmp .+2 ; 0xb618 <main+0xdc>b616: 29 98 cbi 0x05, 1 ; 5Timer_Init();b618: 0e 94 ba 9c call 0x13974 ; 0x13974 <Timer_Init>TIMER2_Init();b61c: 0e 94 93 9c call 0x13926 ; 0x13926 <TIMER2_Init>UART_Init();b620: 0e 94 bf ac call 0x1597e ; 0x1597e <UART_Init>rc_sum_init();b624: 0e 94 76 91 call 0x122ec ; 0x122ec <rc_sum_init>ADC_Init();b628: 0e 94 0e 1b call 0x361c ; 0x361c <ADC_Init>I2C_Init(1);b62c: 81 e0 ldi r24, 0x01 ; 1b62e: 0e 94 c9 a0 call 0x14192 ; 0x14192 <I2C_Init>SPI_MasterInit();b632: 0e 94 bd 95 call 0x12b7a ; 0x12b7a <SPI_MasterInit>Capacity_Init();b636: 0e 94 b7 21 call 0x436e ; 0x436e <Capacity_Init>LIBFC_Init(LIB_FC_COMPATIBLE);b63a: 87 e0 ldi r24, 0x07 ; 7b63c: 0e 94 19 19 call 0x3232 ; 0x3232 <LIBFC_Init>GRN_ON;b640: 80 91 54 01 lds r24, 0x0154b644: 89 31 cpi r24, 0x19 ; 25b646: 11 f4 brne .+4 ; 0xb64c <main+0x110>b648: 29 9a sbi 0x05, 1 ; 5b64a: 01 c0 rjmp .+2 ; 0xb64e <main+0x112>b64c: 29 98 cbi 0x05, 1 ; 5sei();b64e: 78 94 seiParamSet_Init();b650: 0e 94 af 26 call 0x4d5e ; 0x4d5e <ParamSet_Init>// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++if(PlatinenVersion < 20)b654: 80 91 54 01 lds r24, 0x0154b658: 84 31 cpi r24, 0x14 ; 20b65a: e8 f4 brcc .+58 ; 0xb696 <main+0x15a>{wdt_enable(WDTO_250MS); // Reset-Commandob65c: 2c e0 ldi r18, 0x0C ; 12b65e: 88 e1 ldi r24, 0x18 ; 24b660: 90 e0 ldi r25, 0x00 ; 0b662: 0f b6 in r0, 0x3f ; 63b664: f8 94 clib666: a8 95 wdrb668: 80 93 60 00 sts 0x0060, r24b66c: 0f be out 0x3f, r0 ; 63b66e: 20 93 60 00 sts 0x0060, r18while(1) printf("\n\rOld FC Hardware not supported by this Firmware!");b672: 06 ee ldi r16, 0xE6 ; 230b674: 13 e0 ldi r17, 0x03 ; 3b676: c7 eb ldi r28, 0xB7 ; 183b678: dc ea ldi r29, 0xAC ; 172b67a: 1f 93 push r17b67c: 0f 93 push r16b67e: df 93 push r29b680: cf 93 push r28b682: e0 91 78 06 lds r30, 0x0678b686: f0 91 79 06 lds r31, 0x0679b68a: 09 95 icallb68c: 0f 90 pop r0b68e: 0f 90 pop r0b690: 0f 90 pop r0b692: 0f 90 pop r0b694: f2 cf rjmp .-28 ; 0xb67a <main+0x13e>#ifndef REDUNDANT_FC_SLAVE// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++// + Check connected BL-Ctrls// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++// Check connected BL-CtrlsBLFlags |= BLFLAG_READ_VERSION;b696: 80 91 de 04 lds r24, 0x04DEb69a: 82 60 ori r24, 0x02 ; 2b69c: 80 93 de 04 sts 0x04DE, r24motor_read = 0; // read the first I2C-Datab6a0: 10 92 e1 04 sts 0x04E1, r1b6a4: c4 ef ldi r28, 0xF4 ; 244b6a6: d1 e0 ldi r29, 0x01 ; 1for(i=0; i < 500; i++){SendMotorData();b6a8: 0e 94 c7 33 call 0x678e ; 0x678e <SendMotorData>timer = SetDelay(5);b6ac: 85 e0 ldi r24, 0x05 ; 5b6ae: 90 e0 ldi r25, 0x00 ; 0b6b0: 0e 94 5a 9c call 0x138b4 ; 0x138b4 <SetDelay>b6b4: 5c 01 movw r10, r24while(!(BLFlags & BLFLAG_TX_COMPLETE) && !CheckDelay(timer)); //wait for complete transferb6b6: 80 91 de 04 lds r24, 0x04DEb6ba: 80 fd sbrc r24, 0b6bc: 05 c0 rjmp .+10 ; 0xb6c8 <main+0x18c>b6be: c5 01 movw r24, r10b6c0: 0e 94 63 9c call 0x138c6 ; 0x138c6 <CheckDelay>b6c4: 88 23 and r24, r24b6c6: b9 f3 breq .-18 ; 0xb6b6 <main+0x17a>b6c8: 21 97 sbiw r28, 0x01 ; 1// + Check connected BL-Ctrls// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++// Check connected BL-CtrlsBLFlags |= BLFLAG_READ_VERSION;motor_read = 0; // read the first I2C-Datafor(i=0; i < 500; i++)b6ca: 20 97 sbiw r28, 0x00 ; 0b6cc: 69 f7 brne .-38 ; 0xb6a8 <main+0x16c>{SendMotorData();timer = SetDelay(5);while(!(BLFlags & BLFLAG_TX_COMPLETE) && !CheckDelay(timer)); //wait for complete transfer}printf("\n\rFound BL-Ctrl: ");b6ce: 84 ed ldi r24, 0xD4 ; 212b6d0: 93 e0 ldi r25, 0x03 ; 3b6d2: 9f 93 push r25b6d4: 8f 93 push r24b6d6: 87 eb ldi r24, 0xB7 ; 183b6d8: 9c ea ldi r25, 0xAC ; 172b6da: 9f 93 push r25b6dc: 8f 93 push r24b6de: e0 91 78 06 lds r30, 0x0678b6e2: f0 91 79 06 lds r31, 0x0679b6e6: 09 95 icallb6e8: 0f 2e mov r0, r31b6ea: f4 ea ldi r31, 0xA4 ; 164b6ec: ef 2e mov r14, r31b6ee: f9 e0 ldi r31, 0x09 ; 9b6f0: ff 2e mov r15, r31b6f2: f0 2d mov r31, r0b6f4: 0f 90 pop r0b6f6: 0f 90 pop r0b6f8: 0f 90 pop r0b6fa: 0f 90 pop r0b6fc: ca e9 ldi r28, 0x9A ; 154b6fe: d9 e0 ldi r29, 0x09 ; 9b700: 0f 2e mov r0, r31b702: f4 ed ldi r31, 0xD4 ; 212b704: cf 2e mov r12, r31b706: f5 e0 ldi r31, 0x05 ; 5b708: df 2e mov r13, r31b70a: f0 2d mov r31, r0b70c: 01 e0 ldi r16, 0x01 ; 1b70e: 10 e0 ldi r17, 0x00 ; 0}}if(Motor[i].State & MOTOR_STATE_PRESENT_MASK){unsigned char vers;printf("%d",(i+1)%10);b710: 0f 2e mov r0, r31b712: f1 ed ldi r31, 0xD1 ; 209b714: 2f 2e mov r2, r31b716: f3 e0 ldi r31, 0x03 ; 3b718: 3f 2e mov r3, r31b71a: f0 2d mov r31, r0b71c: 0f 2e mov r0, r31b71e: f7 eb ldi r31, 0xB7 ; 183b720: 4f 2e mov r4, r31b722: fc ea ldi r31, 0xAC ; 172b724: 5f 2e mov r5, r31b726: f0 2d mov r31, r0FoundMotors++;vers = Motor[i].VersionMajor * 100 + Motor[i].VersionMinor; // creates 104 from 1.04b728: 0f 2e mov r0, r31b72a: f4 e6 ldi r31, 0x64 ; 100b72c: 9f 2e mov r9, r31b72e: f0 2d mov r31, r0if(vers && VersionInfo.BL_Firmware > vers) VersionInfo.BL_Firmware = vers;b730: 0f 2e mov r0, r31b732: f5 e6 ldi r31, 0x65 ; 101b734: 6f 2e mov r6, r31b736: fa e0 ldi r31, 0x0A ; 10b738: 7f 2e mov r7, r31b73a: f0 2d mov r31, r0// timer = SetDelay(1000);for(i=0; i < MAX_MOTORS; i++){// SendMotorData();// while(!(BLFlags & BLFLAG_TX_COMPLETE) && !CheckDelay(timer)); //wait for complete transferif(Mixer.Motor[i][0] > 0) // wait max 4 sec for the BL-Ctrls to wake upb73c: f6 01 movw r30, r12b73e: 80 81 ld r24, Zb740: 18 16 cp r1, r24b742: 64 f0 brlt .+24 ; 0xb75c <main+0x220>b744: 14 c0 rjmp .+40 ; 0xb76e <main+0x232>{while(!CheckDelay(timer) && !(Motor[i].State & MOTOR_STATE_PRESENT_MASK) ){SendMotorData();b746: 0e 94 c7 33 call 0x678e ; 0x678e <SendMotorData>while(!(BLFlags & BLFLAG_TX_COMPLETE) && !CheckDelay(timer)); //wait for complete transferb74a: 80 91 de 04 lds r24, 0x04DEb74e: 80 fd sbrc r24, 0b750: 05 c0 rjmp .+10 ; 0xb75c <main+0x220>b752: c5 01 movw r24, r10b754: 0e 94 63 9c call 0x138c6 ; 0x138c6 <CheckDelay>b758: 88 23 and r24, r24b75a: b9 f3 breq .-18 ; 0xb74a <main+0x20e>{// SendMotorData();// while(!(BLFlags & BLFLAG_TX_COMPLETE) && !CheckDelay(timer)); //wait for complete transferif(Mixer.Motor[i][0] > 0) // wait max 4 sec for the BL-Ctrls to wake up{while(!CheckDelay(timer) && !(Motor[i].State & MOTOR_STATE_PRESENT_MASK) )b75c: c5 01 movw r24, r10b75e: 0e 94 63 9c call 0x138c6 ; 0x138c6 <CheckDelay>b762: 81 11 cpse r24, r1b764: 04 c0 rjmp .+8 ; 0xb76e <main+0x232>b766: 88 81 ld r24, Yb768: 88 23 and r24, r24b76a: 6c f7 brge .-38 ; 0xb746 <main+0x20a>b76c: 04 c0 rjmp .+8 ; 0xb776 <main+0x23a>{SendMotorData();while(!(BLFlags & BLFLAG_TX_COMPLETE) && !CheckDelay(timer)); //wait for complete transfer}}if(Motor[i].State & MOTOR_STATE_PRESENT_MASK)b76e: 88 81 ld r24, Yb770: 88 23 and r24, r24b772: 0c f0 brlt .+2 ; 0xb776 <main+0x23a>b774: 3f c0 rjmp .+126 ; 0xb7f4 <main+0x2b8>{unsigned char vers;printf("%d",(i+1)%10);b776: 98 01 movw r18, r16b778: ad ec ldi r26, 0xCD ; 205b77a: bc ec ldi r27, 0xCC ; 204b77c: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>b780: 96 95 lsr r25b782: 87 95 ror r24b784: 96 95 lsr r25b786: 87 95 ror r24b788: 96 95 lsr r25b78a: 87 95 ror r24b78c: 9c 01 movw r18, r24b78e: 22 0f add r18, r18b790: 33 1f adc r19, r19b792: 88 0f add r24, r24b794: 99 1f adc r25, r25b796: 88 0f add r24, r24b798: 99 1f adc r25, r25b79a: 88 0f add r24, r24b79c: 99 1f adc r25, r25b79e: 82 0f add r24, r18b7a0: 93 1f adc r25, r19b7a2: 98 01 movw r18, r16b7a4: 28 1b sub r18, r24b7a6: 39 0b sbc r19, r25b7a8: c9 01 movw r24, r18b7aa: 9f 93 push r25b7ac: 2f 93 push r18b7ae: 3f 92 push r3b7b0: 2f 92 push r2b7b2: 5f 92 push r5b7b4: 4f 92 push r4b7b6: e0 91 78 06 lds r30, 0x0678b7ba: f0 91 79 06 lds r31, 0x0679b7be: 09 95 icallFoundMotors++;b7c0: 80 91 5d 04 lds r24, 0x045Db7c4: 8f 5f subi r24, 0xFF ; 255b7c6: 80 93 5d 04 sts 0x045D, r24b7ca: f7 01 movw r30, r14b7cc: 31 97 sbiw r30, 0x01 ; 1vers = Motor[i].VersionMajor * 100 + Motor[i].VersionMinor; // creates 104 from 1.04b7ce: 90 81 ld r25, Zb7d0: f7 01 movw r30, r14b7d2: 80 81 ld r24, Zb7d4: 99 9d mul r25, r9b7d6: 80 0d add r24, r0b7d8: 11 24 eor r1, r1if(vers && VersionInfo.BL_Firmware > vers) VersionInfo.BL_Firmware = vers;b7da: 0f 90 pop r0b7dc: 0f 90 pop r0b7de: 0f 90 pop r0b7e0: 0f 90 pop r0b7e2: 0f 90 pop r0b7e4: 0f 90 pop r0b7e6: 88 23 and r24, r24b7e8: 29 f0 breq .+10 ; 0xb7f4 <main+0x2b8>b7ea: f3 01 movw r30, r6b7ec: 90 81 ld r25, Zb7ee: 89 17 cp r24, r25b7f0: 08 f4 brcc .+2 ; 0xb7f4 <main+0x2b8>b7f2: 80 83 st Z, r24b7f4: 0f 5f subi r16, 0xFF ; 255b7f6: 1f 4f sbci r17, 0xFF ; 255b7f8: f4 e0 ldi r31, 0x04 ; 4b7fa: cf 0e add r12, r31b7fc: d1 1c adc r13, r1b7fe: 2f 96 adiw r28, 0x0f ; 15b800: 2f e0 ldi r18, 0x0F ; 15b802: e2 0e add r14, r18b804: f1 1c adc r15, r1timer = SetDelay(5);while(!(BLFlags & BLFLAG_TX_COMPLETE) && !CheckDelay(timer)); //wait for complete transfer}printf("\n\rFound BL-Ctrl: ");// timer = SetDelay(1000);for(i=0; i < MAX_MOTORS; i++)b806: 0d 30 cpi r16, 0x0D ; 13b808: 11 05 cpc r17, r1b80a: 09 f0 breq .+2 ; 0xb80e <main+0x2d2>b80c: 97 cf rjmp .-210 ; 0xb73c <main+0x200>b80e: 0f 2e mov r0, r31b810: f4 ed ldi r31, 0xD4 ; 212b812: ef 2e mov r14, r31b814: f5 e0 ldi r31, 0x05 ; 5b816: ff 2e mov r15, r31b818: f0 2d mov r31, r0b81a: 0a e9 ldi r16, 0x9A ; 154b81c: 19 e0 ldi r17, 0x09 ; 9b81e: c1 e0 ldi r28, 0x01 ; 1b820: d0 e0 ldi r29, 0x00 ; 0}for(i=0; i < MAX_MOTORS; i++){if(!(Motor[i].State & MOTOR_STATE_PRESENT_MASK) && Mixer.Motor[i][0] > 0){printf("\n\r\n\r!! MISSING BL-CTRL: %d !!",i+1);b822: 0f 2e mov r0, r31b824: f3 eb ldi r31, 0xB3 ; 179b826: af 2e mov r10, r31b828: f3 e0 ldi r31, 0x03 ; 3b82a: bf 2e mov r11, r31b82c: f0 2d mov r31, r0b82e: 0f 2e mov r0, r31b830: f7 eb ldi r31, 0xB7 ; 183b832: cf 2e mov r12, r31b834: fc ea ldi r31, 0xAC ; 172b836: df 2e mov r13, r31b838: f0 2d mov r31, r0ServoActive = 2; // just in case the FC would be used as camera-stabilizerb83a: 68 94 setb83c: 77 24 eor r7, r7b83e: 71 f8 bld r7, 1b840: 48 01 movw r8, r16// printf(":V%03d\n\r",vers);}}for(i=0; i < MAX_MOTORS; i++){if(!(Motor[i].State & MOTOR_STATE_PRESENT_MASK) && Mixer.Motor[i][0] > 0)b842: f8 01 movw r30, r16b844: 80 81 ld r24, Zb846: 88 23 and r24, r24b848: bc f0 brlt .+46 ; 0xb878 <main+0x33c>b84a: f7 01 movw r30, r14b84c: 80 81 ld r24, Zb84e: 18 16 cp r1, r24b850: 9c f4 brge .+38 ; 0xb878 <main+0x33c>{printf("\n\r\n\r!! MISSING BL-CTRL: %d !!",i+1);b852: df 93 push r29b854: cf 93 push r28b856: bf 92 push r11b858: af 92 push r10b85a: df 92 push r13b85c: cf 92 push r12b85e: e0 91 78 06 lds r30, 0x0678b862: f0 91 79 06 lds r31, 0x0679b866: 09 95 icallServoActive = 2; // just in case the FC would be used as camera-stabilizerb868: 70 92 cb 04 sts 0x04CB, r7b86c: 0f 90 pop r0b86e: 0f 90 pop r0b870: 0f 90 pop r0b872: 0f 90 pop r0b874: 0f 90 pop r0b876: 0f 90 pop r0}Motor[i].State &= ~MOTOR_STATE_ERROR_MASK; // clear error counterb878: f4 01 movw r30, r8b87a: 80 81 ld r24, Zb87c: 80 78 andi r24, 0x80 ; 128b87e: 80 83 st Z, r24b880: 21 96 adiw r28, 0x01 ; 1b882: 01 5f subi r16, 0xF1 ; 241b884: 1f 4f sbci r17, 0xFF ; 255b886: f4 e0 ldi r31, 0x04 ; 4b888: ef 0e add r14, r31b88a: f1 1c adc r15, r1// if(Motor[i].Version & MOTOR_STATE_FAST_MODE) printf("(fast)\n\r");// else if(Motor[i].Version & MOTOR_STATE_NEW_PROTOCOL_MASK) printf("(new)\n\r");// printf(":V%03d\n\r",vers);}}for(i=0; i < MAX_MOTORS; i++)b88c: cd 30 cpi r28, 0x0D ; 13b88e: d1 05 cpc r29, r1b890: b9 f6 brne .-82 ; 0xb840 <main+0x304>ServoActive = 2; // just in case the FC would be used as camera-stabilizer}Motor[i].State &= ~MOTOR_STATE_ERROR_MASK; // clear error counter}#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))if(VersionInfo.BL_Firmware != 255)b892: 80 91 65 0a lds r24, 0x0A65b896: 8f 3f cpi r24, 0xFF ; 255b898: d1 f1 breq .+116 ; 0xb90e <main+0x3d2>{printf("\n\rBL-Firmware %d.%02d",VersionInfo.BL_Firmware/100,VersionInfo.BL_Firmware%100);b89a: 99 e2 ldi r25, 0x29 ; 41b89c: 89 9f mul r24, r25b89e: 91 2d mov r25, r1b8a0: 11 24 eor r1, r1b8a2: 92 95 swap r25b8a4: 9f 70 andi r25, 0x0F ; 15b8a6: 24 e6 ldi r18, 0x64 ; 100b8a8: 92 9f mul r25, r18b8aa: 80 19 sub r24, r0b8ac: 11 24 eor r1, r1b8ae: 1f 92 push r1b8b0: 8f 93 push r24b8b2: 1f 92 push r1b8b4: 9f 93 push r25b8b6: 8d e9 ldi r24, 0x9D ; 157b8b8: 93 e0 ldi r25, 0x03 ; 3b8ba: 9f 93 push r25b8bc: 8f 93 push r24b8be: 87 eb ldi r24, 0xB7 ; 183b8c0: 9c ea ldi r25, 0xAC ; 172b8c2: 9f 93 push r25b8c4: 8f 93 push r24b8c6: e0 91 78 06 lds r30, 0x0678b8ca: f0 91 79 06 lds r31, 0x0679b8ce: 09 95 icallif(VersionInfo.BL_Firmware >= 100 && VersionInfo.BL_Firmware <= 102) printf("<-- warning old Version!");b8d0: 80 91 65 0a lds r24, 0x0A65b8d4: 84 56 subi r24, 0x64 ; 100b8d6: 4d b7 in r20, 0x3d ; 61b8d8: 5e b7 in r21, 0x3e ; 62b8da: 48 5f subi r20, 0xF8 ; 248b8dc: 5f 4f sbci r21, 0xFF ; 255b8de: 0f b6 in r0, 0x3f ; 63b8e0: f8 94 clib8e2: 5e bf out 0x3e, r21 ; 62b8e4: 0f be out 0x3f, r0 ; 63b8e6: 4d bf out 0x3d, r20 ; 61b8e8: 83 30 cpi r24, 0x03 ; 3b8ea: 88 f4 brcc .+34 ; 0xb90e <main+0x3d2>b8ec: 84 e8 ldi r24, 0x84 ; 132b8ee: 93 e0 ldi r25, 0x03 ; 3b8f0: 9f 93 push r25b8f2: 8f 93 push r24b8f4: 87 eb ldi r24, 0xB7 ; 183b8f6: 9c ea ldi r25, 0xAC ; 172b8f8: 9f 93 push r25b8fa: 8f 93 push r24b8fc: e0 91 78 06 lds r30, 0x0678b900: f0 91 79 06 lds r31, 0x0679b904: 09 95 icallb906: 0f 90 pop r0b908: 0f 90 pop r0b90a: 0f 90 pop r0b90c: 0f 90 pop r0}#endifPrintLine();// ("\n\r===================================");b90e: c3 dc rcall .-1658 ; 0xb296 <PrintLine>if(RequiredMotors < FoundMotors) VersionInfo.HardwareError[1] |= FC_ERROR1_MIXER;b910: 80 91 3d 05 lds r24, 0x053Db914: 90 91 5d 04 lds r25, 0x045Db918: 89 17 cp r24, r25b91a: 28 f4 brcc .+10 ; 0xb926 <main+0x3ea>b91c: e3 e6 ldi r30, 0x63 ; 99b91e: fa e0 ldi r31, 0x0A ; 10b920: 90 81 ld r25, Zb922: 90 61 ori r25, 0x10 ; 16b924: 90 83 st Z, r25if(RequiredMotors > 8) Max_I2C_Packets = 8; else Max_I2C_Packets = RequiredMotors;b926: 89 30 cpi r24, 0x09 ; 9b928: 20 f0 brcs .+8 ; 0xb932 <main+0x3f6>b92a: 88 e0 ldi r24, 0x08 ; 8b92c: 80 93 b2 02 sts 0x02B2, r24b930: 02 c0 rjmp .+4 ; 0xb936 <main+0x3fa>b932: 80 93 b2 02 sts 0x02B2, r24// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++// Calibrating altitude sensor// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++//if(EE_Parameter.GlobalConfig & CFG_HOEHENREGELUNG){printf("\n\rCalibrating pressure sensor..");b936: 84 e6 ldi r24, 0x64 ; 100b938: 93 e0 ldi r25, 0x03 ; 3b93a: 9f 93 push r25b93c: 8f 93 push r24b93e: 87 eb ldi r24, 0xB7 ; 183b940: 9c ea ldi r25, 0xAC ; 172b942: 9f 93 push r25b944: 8f 93 push r24b946: e0 91 78 06 lds r30, 0x0678b94a: f0 91 79 06 lds r31, 0x0679b94e: 09 95 icalltimer = SetDelay(1000);b950: 88 ee ldi r24, 0xE8 ; 232b952: 93 e0 ldi r25, 0x03 ; 3b954: 0e 94 5a 9c call 0x138b4 ; 0x138b4 <SetDelay>b958: ec 01 movw r28, r24SucheLuftruckOffset();b95a: 0e 94 4b 1b call 0x3696 ; 0x3696 <SucheLuftruckOffset>while (!CheckDelay(timer));b95e: 0f 90 pop r0b960: 0f 90 pop r0b962: 0f 90 pop r0b964: 0f 90 pop r0b966: ce 01 movw r24, r28b968: 0e 94 63 9c call 0x138c6 ; 0x138c6 <CheckDelay>b96c: 88 23 and r24, r24b96e: d9 f3 breq .-10 ; 0xb966 <main+0x42a>printf("OK\n\r");b970: 8f e5 ldi r24, 0x5F ; 95b972: 93 e0 ldi r25, 0x03 ; 3b974: 9f 93 push r25b976: 8f 93 push r24b978: 87 eb ldi r24, 0xB7 ; 183b97a: 9c ea ldi r25, 0xAC ; 172b97c: 9f 93 push r25b97e: 8f 93 push r24b980: e0 91 78 06 lds r30, 0x0678b984: f0 91 79 06 lds r31, 0x0679b988: 09 95 icall#ifdef REDUNDANT_FC_SLAVEVersionInfo.HardwareError[0] = 0;VersionInfo.HardwareError[1] = 0;#endifSetNeutral(0);b98a: 80 e0 ldi r24, 0x00 ; 0b98c: 0e 94 53 29 call 0x52a6 ; 0x52a6 <SetNeutral>ROT_OFF;b990: 28 98 cbi 0x05, 0 ; 5beeptime = 2000;b992: 80 ed ldi r24, 0xD0 ; 208b994: 97 e0 ldi r25, 0x07 ; 7b996: 90 93 ce 04 sts 0x04CE, r25b99a: 80 93 cd 04 sts 0x04CD, r24ExternControl.Digital[0] = 0x55;b99e: 85 e5 ldi r24, 0x55 ; 85b9a0: 80 93 7f 0a sts 0x0A7F, r24FlugMinuten = (unsigned int)GetParamByte(PID_FLIGHT_MINUTES) * 256 + (unsigned int)GetParamByte(PID_FLIGHT_MINUTES + 1);b9a4: 8e e0 ldi r24, 0x0E ; 14b9a6: 90 e0 ldi r25, 0x00 ; 0b9a8: 0e 94 42 25 call 0x4a84 ; 0x4a84 <GetParamByte>b9ac: c8 2f mov r28, r24b9ae: 8f e0 ldi r24, 0x0F ; 15b9b0: 90 e0 ldi r25, 0x00 ; 0b9b2: 0e 94 42 25 call 0x4a84 ; 0x4a84 <GetParamByte>b9b6: 2c 2f mov r18, r28b9b8: 30 e0 ldi r19, 0x00 ; 0b9ba: 32 2f mov r19, r18b9bc: 22 27 eor r18, r18b9be: 28 0f add r18, r24b9c0: 31 1d adc r19, r1b9c2: 30 93 63 04 sts 0x0463, r19b9c6: 20 93 62 04 sts 0x0462, r18FlugMinutenGesamt = (unsigned int)GetParamByte(PID_FLIGHT_MINUTES_TOTAL) * 256 + (unsigned int)GetParamByte(PID_FLIGHT_MINUTES_TOTAL + 1);b9ca: 8a e0 ldi r24, 0x0A ; 10b9cc: 90 e0 ldi r25, 0x00 ; 0b9ce: 0e 94 42 25 call 0x4a84 ; 0x4a84 <GetParamByte>b9d2: c8 2f mov r28, r24b9d4: 8b e0 ldi r24, 0x0B ; 11b9d6: 90 e0 ldi r25, 0x00 ; 0b9d8: 0e 94 42 25 call 0x4a84 ; 0x4a84 <GetParamByte>b9dc: 2c 2f mov r18, r28b9de: 30 e0 ldi r19, 0x00 ; 0b9e0: 32 2f mov r19, r18b9e2: 22 27 eor r18, r18b9e4: f9 01 movw r30, r18b9e6: e8 0f add r30, r24b9e8: f1 1d adc r31, r1b9ea: cf 01 movw r24, r30b9ec: f0 93 61 04 sts 0x0461, r31b9f0: e0 93 60 04 sts 0x0460, r30if((FlugMinutenGesamt == 0xFFFF) || (FlugMinuten == 0xFFFF))b9f4: 0f 90 pop r0b9f6: 0f 90 pop r0b9f8: 0f 90 pop r0b9fa: 0f 90 pop r0b9fc: 01 96 adiw r24, 0x01 ; 1b9fe: 31 f0 breq .+12 ; 0xba0c <main+0x4d0>ba00: 80 91 62 04 lds r24, 0x0462ba04: 90 91 63 04 lds r25, 0x0463ba08: 01 96 adiw r24, 0x01 ; 1ba0a: 41 f4 brne .+16 ; 0xba1c <main+0x4e0>{FlugMinuten = 0;ba0c: 10 92 63 04 sts 0x0463, r1ba10: 10 92 62 04 sts 0x0462, r1FlugMinutenGesamt = 0;ba14: 10 92 61 04 sts 0x0461, r1ba18: 10 92 60 04 sts 0x0460, r1}printf("\n\rFlight-time %u min Total:%u min", FlugMinuten, FlugMinutenGesamt);ba1c: 80 91 61 04 lds r24, 0x0461ba20: 8f 93 push r24ba22: 80 91 60 04 lds r24, 0x0460ba26: 8f 93 push r24ba28: 80 91 63 04 lds r24, 0x0463ba2c: 8f 93 push r24ba2e: 80 91 62 04 lds r24, 0x0462ba32: 8f 93 push r24ba34: 8d e3 ldi r24, 0x3D ; 61ba36: 93 e0 ldi r25, 0x03 ; 3ba38: 9f 93 push r25ba3a: 8f 93 push r24ba3c: 87 eb ldi r24, 0xB7 ; 183ba3e: 9c ea ldi r25, 0xAC ; 172ba40: 9f 93 push r25ba42: 8f 93 push r24ba44: e0 91 78 06 lds r30, 0x0678ba48: f0 91 79 06 lds r31, 0x0679ba4c: 09 95 icallLcdClear();ba4e: 0e 94 1d 87 call 0x10e3a ; 0x10e3a <LcdClear>I2CTimeout = 5000;ba52: 88 e8 ldi r24, 0x88 ; 136ba54: 93 e1 ldi r25, 0x13 ; 19ba56: 90 93 b1 02 sts 0x02B1, r25ba5a: 80 93 b0 02 sts 0x02B0, r24WinkelOut.Orientation = 1;ba5e: 81 e0 ldi r24, 0x01 ; 1ba60: 80 93 7e 0a sts 0x0A7E, r24LipoDetection(1);ba64: 5d dc rcall .-1862 ; 0xb320 <LipoDetection>LIBFC_ReceiverInit(EE_Parameter.Receiver);ba66: 80 91 65 05 lds r24, 0x0565ba6a: 0e 94 68 18 call 0x30d0 ; 0x30d0 <LIBFC_ReceiverInit>PrintLine();// ("\n\r===================================");ba6e: 13 dc rcall .-2010 ; 0xb296 <PrintLine>//SpektrumBinding();timer = SetDelay(2000);ba70: 80 ed ldi r24, 0xD0 ; 208ba72: 97 e0 ldi r25, 0x07 ; 7ba74: 0e 94 5a 9c call 0x138b4 ; 0x138b4 <SetDelay>ba78: 4c 01 movw r8, r24timerPolling = SetDelay(250);ba7a: 8a ef ldi r24, 0xFA ; 250ba7c: 90 e0 ldi r25, 0x00 ; 0ba7e: 0e 94 5a 9c call 0x138b4 ; 0x138b4 <SetDelay>Debug(ANSI_CLEAR "FC-Start!\n\rFlugzeit: %d min", FlugMinutenGesamt); // Note: this won't waste flash memory, if #DEBUG is not activeba82: 80 91 61 04 lds r24, 0x0461ba86: 8f 93 push r24ba88: 80 91 60 04 lds r24, 0x0460ba8c: 8f 93 push r24ba8e: 8d e1 ldi r24, 0x1D ; 29ba90: 93 e0 ldi r25, 0x03 ; 3ba92: 9f 93 push r25ba94: 8f 93 push r24ba96: 88 e1 ldi r24, 0x18 ; 24ba98: 93 e2 ldi r25, 0x23 ; 35ba9a: 9f 93 push r25ba9c: 8f 93 push r24ba9e: e0 91 78 06 lds r30, 0x0678baa2: f0 91 79 06 lds r31, 0x0679baa6: 09 95 icallbaa8: 80 e0 ldi r24, 0x00 ; 0baaa: 0e 94 2c 23 call 0x4658 ; 0x4658 <DebugSend>//printf("\n\rEE_Parameter size:%i\n\r", PARAMSET_STRUCT_LEN);DebugOut.Status[0] = 0x01 | 0x02;baae: 83 e0 ldi r24, 0x03 ; 3bab0: 80 93 46 0c sts 0x0C46, r24JetiBeep = 0;bab4: 10 92 5c 04 sts 0x045C, r1if(EE_Parameter.ExtraConfig & CFG_NO_RCOFF_BEEPING) DisableRcOffBeeping = 1;bab8: 80 91 b8 05 lds r24, 0x05B8babc: 4d b7 in r20, 0x3d ; 61babe: 5e b7 in r21, 0x3e ; 62bac0: 42 5f subi r20, 0xF2 ; 242bac2: 5f 4f sbci r21, 0xFF ; 255bac4: 0f b6 in r0, 0x3f ; 63bac6: f8 94 clibac8: 5e bf out 0x3e, r21 ; 62baca: 0f be out 0x3f, r0 ; 63bacc: 4d bf out 0x3d, r20 ; 61bace: 84 ff sbrs r24, 4bad0: 03 c0 rjmp .+6 ; 0xbad8 <main+0x59c>bad2: 81 e0 ldi r24, 0x01 ; 1bad4: 80 93 66 04 sts 0x0466, r24ReadBlSize = 3; // don't read the version any morebad8: 83 e0 ldi r24, 0x03 ; 3bada: 80 93 b3 02 sts 0x02B3, r24PORTB = 0x00;DDRD = 0x0A; // UART & J3 J4 J5PORTD = 0x5F; // PPM-Input & UARTfor(timer = 0; timer < 1000; timer++); // verzögern#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))unsigned char AccZ_ErrorCnt = 0;bade: 61 2c mov r6, r1//Hauptprogrammint main (void)//############################################################################{unsigned int timer,i,timer2 = 0, timerPolling;unsigned char update_spi = 1;bae0: 77 24 eor r7, r7bae2: 73 94 inc r7//############################################################################//Hauptprogrammint main (void)//############################################################################{unsigned int timer,i,timer2 = 0, timerPolling;bae4: c0 e0 ldi r28, 0x00 ; 0bae6: d0 e0 ldi r29, 0x00 ; 0if(UpdateMotor && AdReady) // ReglerIntervall{cli();UpdateMotor--;sei();if(WinkelOut.CalcState) CalMk3Mag();bae8: 0f 2e mov r0, r31baea: fd e7 ldi r31, 0x7D ; 125baec: af 2e mov r10, r31baee: fa e0 ldi r31, 0x0A ; 10baf0: bf 2e mov r11, r31baf2: f0 2d mov r31, r0{static unsigned char second;timer += 20; // 20 ms intervalCalcNickServoValue();#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))if(EE_Parameter.Receiver == RECEIVER_HOTT) HoTT_Menu();baf4: 0f 2e mov r0, r31baf6: f5 e6 ldi r31, 0x65 ; 101baf8: cf 2e mov r12, r31bafa: f5 e0 ldi r31, 0x05 ; 5bafc: df 2e mov r13, r31bafe: f0 2d mov r31, r0if(UBat <= BattLowVoltageWarning){FC_StatusFlags |= FC_STATUS_LOWBAT;if(BeepMuster == 0xffff && UBat > 10) // Do not beep, if the voltage reading is below 1V (Supplied via MKUSB){beeptime = 6000;bb00: 0f 2e mov r0, r31bb02: f0 e7 ldi r31, 0x70 ; 112bb04: ef 2e mov r14, r31bb06: f7 e1 ldi r31, 0x17 ; 23bb08: ff 2e mov r15, r31bb0a: f0 2d mov r31, r0GPS_Roll = 0;GPS_Aid_StickMultiplikator = 0;GPSInfo.Flags = 0;FromNaviCtrl_Value.Kalman_K = -1;FromNaviCtrl.AccErrorN = 0;FromNaviCtrl.AccErrorR = 0;bb0c: 0f 2e mov r0, r31bb0e: f7 e1 ldi r31, 0x17 ; 23bb10: 2f 2e mov r2, r31bb12: f9 e0 ldi r31, 0x09 ; 9bb14: 3f 2e mov r3, r31bb16: f0 2d mov r31, r0FromNaviCtrl.CompassValue = -1;bb18: 0f 2e mov r0, r31bb1a: f3 e1 ldi r31, 0x13 ; 19bb1c: 4f 2e mov r4, r31bb1e: f9 e0 ldi r31, 0x09 ; 9bb20: 5f 2e mov r5, r31bb22: f0 2d mov r31, r0bb24: 17 2d mov r17, r7bb26: 06 2d mov r16, r6bb28: 03 c0 rjmp .+6 ; 0xbb30 <main+0x5f4>} //else DebugOut.Analog[18]++;if(update_spi) update_spi--;} // 500Hzif(update_spi == 0) // 41Hz{if(SPI_StartTransmitPacket()) update_spi = 12;bb2a: 1c e0 ldi r17, 0x0C ; 12bb2c: 01 c0 rjmp .+2 ; 0xbb30 <main+0x5f4>bb2e: 10 e0 ldi r17, 0x00 ; 0while(!CheckDelay(timer));printf("\n\rStart\n\r");#endifwhile(1){EEAR = EE_DUMMY; // Set the EEPROM Address pointer to an unused spacebb30: 12 bc out 0x22, r1 ; 34bb32: 11 bc out 0x21, r1 ; 33if(ReceiverUpdateModeActive) while (1) PORTC &= ~(1<<7); // Beeper offbb34: 80 91 ec 04 lds r24, 0x04ECbb38: 88 23 and r24, r24bb3a: 11 f0 breq .+4 ; 0xbb40 <main+0x604>bb3c: 47 98 cbi 0x08, 7 ; 8bb3e: fe cf rjmp .-4 ; 0xbb3c <main+0x600>if(UpdateMotor && AdReady) // ReglerIntervallbb40: 80 91 d1 04 lds r24, 0x04D1bb44: 88 23 and r24, r24bb46: 09 f4 brne .+2 ; 0xbb4a <main+0x60e>bb48: bf c2 rjmp .+1406 ; 0xc0c8 <main+0xb8c>bb4a: 80 91 0f 01 lds r24, 0x010Fbb4e: 88 23 and r24, r24bb50: 09 f4 brne .+2 ; 0xbb54 <main+0x618>bb52: ba c2 rjmp .+1396 ; 0xc0c8 <main+0xb8c>{cli();bb54: f8 94 cliUpdateMotor--;bb56: 80 91 d1 04 lds r24, 0x04D1bb5a: 81 50 subi r24, 0x01 ; 1bb5c: 80 93 d1 04 sts 0x04D1, r24sei();bb60: 78 94 seiif(WinkelOut.CalcState) CalMk3Mag();bb62: f5 01 movw r30, r10bb64: 80 81 ld r24, Zbb66: 88 23 and r24, r24bb68: 11 f0 breq .+4 ; 0xbb6e <main+0x632>bb6a: a7 db rcall .-2226 ; 0xb2ba <CalMk3Mag>bb6c: 02 c0 rjmp .+4 ; 0xbb72 <main+0x636>else MotorRegler();bb6e: 0e 94 06 38 call 0x700c ; 0x700c <MotorRegler>SendMotorData();bb72: 0e 94 c7 33 call 0x678e ; 0x678e <SendMotorData>ROT_OFF;bb76: 28 98 cbi 0x05, 0 ; 5if(SenderOkay) { SenderOkay--; /*VersionInfo.HardwareError[1] &= ~FC_ERROR1_PPM;*/ }bb78: 80 91 04 04 lds r24, 0x0404bb7c: 88 23 and r24, r24bb7e: 31 f0 breq .+12 ; 0xbb8c <main+0x650>bb80: 80 91 04 04 lds r24, 0x0404bb84: 81 50 subi r24, 0x01 ; 1bb86: 80 93 04 04 sts 0x0404, r24bb8a: 3e c0 rjmp .+124 ; 0xbc08 <main+0x6cc>else{TIMSK1 |= _BV(ICIE1); // enable PPM-Inputbb8c: ef e6 ldi r30, 0x6F ; 111bb8e: f0 e0 ldi r31, 0x00 ; 0bb90: 80 81 ld r24, Zbb92: 80 62 ori r24, 0x20 ; 32bb94: 80 83 st Z, r24PPM_in[0] = 0; // set RSSI to zero on data timeoutbb96: 10 92 32 08 sts 0x0832, r1bb9a: 10 92 31 08 sts 0x0831, r1VersionInfo.HardwareError[1] |= FC_ERROR1_PPM;bb9e: e3 e6 ldi r30, 0x63 ; 99bba0: fa e0 ldi r31, 0x0A ; 10bba2: 80 81 ld r24, Zbba4: 88 60 ori r24, 0x08 ; 8bba6: 80 83 st Z, r24// Now clear the channel values - they would be wrongPPM_diff[EE_Parameter.Kanalbelegung[K_NICK]] = 0;bba8: 20 91 3f 05 lds r18, 0x053Fbbac: 30 e0 ldi r19, 0x00 ; 0bbae: 22 0f add r18, r18bbb0: 33 1f adc r19, r19bbb2: f9 01 movw r30, r18bbb4: e9 58 subi r30, 0x89 ; 137bbb6: f7 4f sbci r31, 0xF7 ; 247bbb8: 11 82 std Z+1, r1 ; 0x01bbba: 10 82 st Z, r1PPM_diff[EE_Parameter.Kanalbelegung[K_ROLL]] = 0;bbbc: 80 91 40 05 lds r24, 0x0540bbc0: 90 e0 ldi r25, 0x00 ; 0bbc2: 88 0f add r24, r24bbc4: 99 1f adc r25, r25bbc6: fc 01 movw r30, r24bbc8: e9 58 subi r30, 0x89 ; 137bbca: f7 4f sbci r31, 0xF7 ; 247bbcc: 11 82 std Z+1, r1 ; 0x01bbce: 10 82 st Z, r1PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] = 0;bbd0: f9 01 movw r30, r18bbd2: ef 5c subi r30, 0xCF ; 207bbd4: f7 4f sbci r31, 0xF7 ; 247bbd6: 11 82 std Z+1, r1 ; 0x01bbd8: 10 82 st Z, r1PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] = 0;bbda: fc 01 movw r30, r24bbdc: ef 5c subi r30, 0xCF ; 207bbde: f7 4f sbci r31, 0xF7 ; 247bbe0: 11 82 std Z+1, r1 ; 0x01bbe2: 10 82 st Z, r1PPM_in[EE_Parameter.Kanalbelegung[K_GIER]] = 0;bbe4: e0 91 42 05 lds r30, 0x0542bbe8: f0 e0 ldi r31, 0x00 ; 0bbea: ee 0f add r30, r30bbec: ff 1f adc r31, r31bbee: ef 5c subi r30, 0xCF ; 207bbf0: f7 4f sbci r31, 0xF7 ; 247bbf2: 11 82 std Z+1, r1 ; 0x01bbf4: 10 82 st Z, r1PPM_in[EE_Parameter.Kanalbelegung[K_GAS]] = 0;bbf6: e0 91 41 05 lds r30, 0x0541bbfa: f0 e0 ldi r31, 0x00 ; 0bbfc: ee 0f add r30, r30bbfe: ff 1f adc r31, r31bc00: ef 5c subi r30, 0xCF ; 207bc02: f7 4f sbci r31, 0xF7 ; 247bc04: 11 82 std Z+1, r1 ; 0x01bc06: 10 82 st Z, r1}//+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++//if(HoehenReglerAktiv && NaviDataOkay && SenderOkay < 160 && SenderOkay > 10 && FromNaviCtrl_Value.SerialDataOkay > 220) SenderOkay = 160;//if(HoehenReglerAktiv && NaviDataOkay && SenderOkay < 101 && SenderOkay > 10 && FromNaviCtrl_Value.SerialDataOkay > 1) SenderOkay = 101;//+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++if(!--I2CTimeout || MissingMotor)bc08: 80 91 b0 02 lds r24, 0x02B0bc0c: 90 91 b1 02 lds r25, 0x02B1bc10: 01 97 sbiw r24, 0x01 ; 1bc12: 90 93 b1 02 sts 0x02B1, r25bc16: 80 93 b0 02 sts 0x02B0, r24bc1a: 89 2b or r24, r25bc1c: 21 f0 breq .+8 ; 0xbc26 <main+0x6ea>bc1e: 80 91 df 04 lds r24, 0x04DFbc22: 88 23 and r24, r24bc24: b1 f1 breq .+108 ; 0xbc92 <main+0x756>{if(!I2CTimeout)bc26: 80 91 b0 02 lds r24, 0x02B0bc2a: 90 91 b1 02 lds r25, 0x02B1bc2e: 89 2b or r24, r25bc30: c9 f4 brne .+50 ; 0xbc64 <main+0x728>{I2C_Reset();bc32: 0e 94 09 a1 call 0x14212 ; 0x14212 <I2C_Reset>I2CTimeout = 5;bc36: 85 e0 ldi r24, 0x05 ; 5bc38: 90 e0 ldi r25, 0x00 ; 0bc3a: 90 93 b1 02 sts 0x02B1, r25bc3e: 80 93 b0 02 sts 0x02B0, r24DebugOut.Analog[28]++; // I2C-Errorbc42: e0 e8 ldi r30, 0x80 ; 128bc44: fc e0 ldi r31, 0x0C ; 12bc46: 80 81 ld r24, Zbc48: 91 81 ldd r25, Z+1 ; 0x01bc4a: 01 96 adiw r24, 0x01 ; 1bc4c: 91 83 std Z+1, r25 ; 0x01bc4e: 80 83 st Z, r24VersionInfo.HardwareError[1] |= FC_ERROR1_I2C;bc50: e3 e6 ldi r30, 0x63 ; 99bc52: fa e0 ldi r31, 0x0A ; 10bc54: 80 81 ld r24, Zbc56: 81 60 ori r24, 0x01 ; 1bc58: 80 83 st Z, r24DebugOut.Status[1] |= 0x02; // BL-Error-Statusbc5a: e7 e4 ldi r30, 0x47 ; 71bc5c: fc e0 ldi r31, 0x0C ; 12bc5e: 80 81 ld r24, Zbc60: 82 60 ori r24, 0x02 ; 2bc62: 80 83 st Z, r24}if((BeepMuster == 0xffff) && MotorenEin)bc64: 80 91 a9 02 lds r24, 0x02A9bc68: 90 91 aa 02 lds r25, 0x02AAbc6c: 01 96 adiw r24, 0x01 ; 1bc6e: 91 f4 brne .+36 ; 0xbc94 <main+0x758>bc70: 80 91 03 04 lds r24, 0x0403bc74: 88 23 and r24, r24bc76: 71 f0 breq .+28 ; 0xbc94 <main+0x758>{beeptime = 25000;bc78: 88 ea ldi r24, 0xA8 ; 168bc7a: 91 e6 ldi r25, 0x61 ; 97bc7c: 90 93 ce 04 sts 0x04CE, r25bc80: 80 93 cd 04 sts 0x04CD, r24BeepMuster = 0x0080;bc84: 80 e8 ldi r24, 0x80 ; 128bc86: 90 e0 ldi r25, 0x00 ; 0bc88: 90 93 aa 02 sts 0x02AA, r25bc8c: 80 93 a9 02 sts 0x02A9, r24bc90: 01 c0 rjmp .+2 ; 0xbc94 <main+0x758>}}else{ROT_OFF;bc92: 28 98 cbi 0x05, 0 ; 5}LIBFC_Polling();bc94: 0e 94 16 1a call 0x342c ; 0x342c <LIBFC_Polling>if(!UpdateMotor)bc98: 80 91 d1 04 lds r24, 0x04D1bc9c: 81 11 cpse r24, r1bc9e: 11 c2 rjmp .+1058 ; 0xc0c2 <main+0xb86>{#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))if(NewSBusData) ProcessSBus();bca0: 80 91 ab 04 lds r24, 0x04ABbca4: 88 23 and r24, r24bca6: 19 f0 breq .+6 ; 0xbcae <main+0x772>bca8: 0e 94 33 93 call 0x12666 ; 0x12666 <ProcessSBus>bcac: 0a c2 rjmp .+1044 ; 0xc0c2 <main+0xb86>else#endif{if(BytegapSPI == 0) SPI_TransmitByte();bcae: 80 91 cc 04 lds r24, 0x04CCbcb2: 81 11 cpse r24, r1bcb4: 02 c0 rjmp .+4 ; 0xbcba <main+0x77e>bcb6: 0e 94 de 95 call 0x12bbc ; 0x12bbc <SPI_TransmitByte>if(CalculateServoSignals) CalculateServo();bcba: 80 91 af 02 lds r24, 0x02AFbcbe: 81 11 cpse r24, r1bcc0: 0e 94 14 9d call 0x13a28 ; 0x13a28 <CalculateServo>DatenUebertragung();bcc4: 0e 94 00 ad call 0x15a00 ; 0x15a00 <DatenUebertragung>BearbeiteRxDaten();bcc8: 0e 94 5f a8 call 0x150be ; 0x150be <BearbeiteRxDaten>if(CheckDelay(timer))bccc: c4 01 movw r24, r8bcce: 0e 94 63 9c call 0x138c6 ; 0x138c6 <CheckDelay>bcd2: 88 23 and r24, r24bcd4: 09 f4 brne .+2 ; 0xbcd8 <main+0x79c>bcd6: f1 c1 rjmp .+994 ; 0xc0ba <main+0xb7e>{static unsigned char second;timer += 20; // 20 ms intervalbcd8: 24 e1 ldi r18, 0x14 ; 20bcda: 82 0e add r8, r18bcdc: 91 1c adc r9, r1CalcNickServoValue();bcde: 0e 94 d3 9c call 0x139a6 ; 0x139a6 <CalcNickServoValue>#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))if(EE_Parameter.Receiver == RECEIVER_HOTT) HoTT_Menu();bce2: f6 01 movw r30, r12bce4: 80 81 ld r24, Zbce6: 86 30 cpi r24, 0x06 ; 6bce8: 11 f4 brne .+4 ; 0xbcee <main+0x7b2>bcea: a9 d7 rcall .+3922 ; 0xcc3e <HoTT_Menu>bcec: 04 c0 rjmp .+8 ; 0xbcf6 <main+0x7ba>elseif(EE_Parameter.Receiver == RECEIVER_JETI) BuildJeti_Vario();bcee: 84 30 cpi r24, 0x04 ; 4bcf0: 11 f4 brne .+4 ; 0xbcf6 <main+0x7ba>bcf2: 0e 94 2c 84 call 0x10858 ; 0x10858 <BuildJeti_Vario>// ++++++++++++++++++++++++++++// + check the ACC-Z rangeif(ACC_AltitudeControl && ((Aktuell_az < 300) || (DebugOut.Analog[7] < (128 * 4) && Aktuell_az > 850))) // DebugOut.Analog[7] = GasMischanteilbcf6: 80 91 c2 03 lds r24, 0x03C2bcfa: 88 23 and r24, r24bcfc: 29 f1 breq .+74 ; 0xbd48 <main+0x80c>bcfe: 80 91 06 05 lds r24, 0x0506bd02: 90 91 07 05 lds r25, 0x0507bd06: 8c 32 cpi r24, 0x2C ; 44bd08: 91 40 sbci r25, 0x01 ; 1bd0a: 74 f0 brlt .+28 ; 0xbd28 <main+0x7ec>bd0c: 80 91 56 0c lds r24, 0x0C56bd10: 90 91 57 0c lds r25, 0x0C57bd14: 81 15 cp r24, r1bd16: 92 40 sbci r25, 0x02 ; 2bd18: cc f4 brge .+50 ; 0xbd4c <main+0x810>bd1a: 80 91 06 05 lds r24, 0x0506bd1e: 90 91 07 05 lds r25, 0x0507bd22: 83 35 cpi r24, 0x53 ; 83bd24: 93 40 sbci r25, 0x03 ; 3bd26: a4 f0 brlt .+40 ; 0xbd50 <main+0x814>{if(++AccZ_ErrorCnt > 50)bd28: 0f 5f subi r16, 0xFF ; 255bd2a: 03 33 cpi r16, 0x33 ; 51bd2c: 90 f0 brcs .+36 ; 0xbd52 <main+0x816>{if(MotorenEin) VersionInfo.HardwareError[0] |= FC_ERROR0_ACC_TOP;bd2e: 80 91 03 04 lds r24, 0x0403bd32: 88 23 and r24, r24bd34: 31 f0 breq .+12 ; 0xbd42 <main+0x806>bd36: e2 e6 ldi r30, 0x62 ; 98bd38: fa e0 ldi r31, 0x0A ; 10bd3a: 80 81 ld r24, Zbd3c: 80 62 ori r24, 0x20 ; 32bd3e: 80 83 st Z, r24bd40: 08 c0 rjmp .+16 ; 0xbd52 <main+0x816>else CalibrationDone = 0;bd42: 10 92 ef 03 sts 0x03EF, r1bd46: 05 c0 rjmp .+10 ; 0xbd52 <main+0x816>}}else AccZ_ErrorCnt = 0;bd48: 00 e0 ldi r16, 0x00 ; 0bd4a: 03 c0 rjmp .+6 ; 0xbd52 <main+0x816>bd4c: 00 e0 ldi r16, 0x00 ; 0bd4e: 01 c0 rjmp .+2 ; 0xbd52 <main+0x816>bd50: 00 e0 ldi r16, 0x00 ; 0// ++++++++++++++++++++++++++++#endifif(MissingMotor || Capacity.MinOfMaxPWM < 30)bd52: 80 91 df 04 lds r24, 0x04DFbd56: 81 11 cpse r24, r1bd58: 05 c0 rjmp .+10 ; 0xbd64 <main+0x828>bd5a: 80 91 1b 05 lds r24, 0x051Bbd5e: 8e 31 cpi r24, 0x1E ; 30bd60: 30 f0 brcs .+12 ; 0xbd6e <main+0x832>bd62: 0b c0 rjmp .+22 ; 0xbd7a <main+0x83e>{if(MissingMotor) VersionInfo.HardwareError[1] |= FC_ERROR1_BL_MISSING;bd64: e3 e6 ldi r30, 0x63 ; 99bd66: fa e0 ldi r31, 0x0A ; 10bd68: 80 81 ld r24, Zbd6a: 82 60 ori r24, 0x02 ; 2bd6c: 80 83 st Z, r24DebugOut.Status[1] |= 0x02; // BL-Error-Statusbd6e: e7 e4 ldi r30, 0x47 ; 71bd70: fc e0 ldi r31, 0x0C ; 12bd72: 80 81 ld r24, Zbd74: 82 60 ori r24, 0x02 ; 2bd76: 80 83 st Z, r24bd78: 11 c0 rjmp .+34 ; 0xbd9c <main+0x860>}else{if(!beeptime)bd7a: 80 91 cd 04 lds r24, 0x04CDbd7e: 90 91 ce 04 lds r25, 0x04CEbd82: 89 2b or r24, r25bd84: 59 f4 brne .+22 ; 0xbd9c <main+0x860>{if(I2CTimeout > 6) DebugOut.Status[1] &= ~0x02; // BL-Error-Statusbd86: 80 91 b0 02 lds r24, 0x02B0bd8a: 90 91 b1 02 lds r25, 0x02B1bd8e: 07 97 sbiw r24, 0x07 ; 7bd90: 28 f0 brcs .+10 ; 0xbd9c <main+0x860>bd92: e7 e4 ldi r30, 0x47 ; 71bd94: fc e0 ldi r31, 0x0C ; 12bd96: 80 81 ld r24, Zbd98: 8d 7f andi r24, 0xFD ; 253bd9a: 80 83 st Z, r24}}if(DisableRcOffBeeping) if(SenderOkay > 150) { DisableRcOffBeeping = 0; beeptime = 5000;};bd9c: 80 91 66 04 lds r24, 0x0466bda0: 88 23 and r24, r24bda2: 61 f0 breq .+24 ; 0xbdbc <main+0x880>bda4: 80 91 04 04 lds r24, 0x0404bda8: 87 39 cpi r24, 0x97 ; 151bdaa: 40 f0 brcs .+16 ; 0xbdbc <main+0x880>bdac: 10 92 66 04 sts 0x0466, r1bdb0: 88 e8 ldi r24, 0x88 ; 136bdb2: 93 e1 ldi r25, 0x13 ; 19bdb4: 90 93 ce 04 sts 0x04CE, r25bdb8: 80 93 cd 04 sts 0x04CD, r24if(PcZugriff) PcZugriff--;bdbc: 80 91 b5 02 lds r24, 0x02B5bdc0: 88 23 and r24, r24bdc2: 21 f0 breq .+8 ; 0xbdcc <main+0x890>bdc4: 81 50 subi r24, 0x01 ; 1bdc6: 80 93 b5 02 sts 0x02B5, r24bdca: 2d c0 rjmp .+90 ; 0xbe26 <main+0x8ea>else{ExternControl.Config = 0;bdcc: 10 92 89 0a sts 0x0A89, r1ExternStickNick = 0;bdd0: 10 92 d7 03 sts 0x03D7, r1bdd4: 10 92 d6 03 sts 0x03D6, r1ExternStickRoll = 0;bdd8: 10 92 d5 03 sts 0x03D5, r1bddc: 10 92 d4 03 sts 0x03D4, r1ExternStickGier = 0;bde0: 10 92 d3 03 sts 0x03D3, r1bde4: 10 92 d2 03 sts 0x03D2, r1if(!SenderOkay)bde8: 80 91 04 04 lds r24, 0x0404bdec: 81 11 cpse r24, r1bdee: 1b c0 rjmp .+54 ; 0xbe26 <main+0x8ea>{if(BeepMuster == 0xffff && DisableRcOffBeeping != 2)bdf0: 80 91 a9 02 lds r24, 0x02A9bdf4: 90 91 aa 02 lds r25, 0x02AAbdf8: 01 96 adiw r24, 0x01 ; 1bdfa: a9 f4 brne .+42 ; 0xbe26 <main+0x8ea>bdfc: 20 91 66 04 lds r18, 0x0466be00: 22 30 cpi r18, 0x02 ; 2be02: 89 f0 breq .+34 ; 0xbe26 <main+0x8ea>{beeptime = 15000;be04: 88 e9 ldi r24, 0x98 ; 152be06: 9a e3 ldi r25, 0x3A ; 58be08: 90 93 ce 04 sts 0x04CE, r25be0c: 80 93 cd 04 sts 0x04CD, r24BeepMuster = 0x0c00;be10: 80 e0 ldi r24, 0x00 ; 0be12: 9c e0 ldi r25, 0x0C ; 12be14: 90 93 aa 02 sts 0x02AA, r25be18: 80 93 a9 02 sts 0x02A9, r24if(DisableRcOffBeeping) DisableRcOffBeeping = 2;be1c: 22 23 and r18, r18be1e: 19 f0 breq .+6 ; 0xbe26 <main+0x8ea>be20: 82 e0 ldi r24, 0x02 ; 2be22: 80 93 66 04 sts 0x0466, r24}}}if(NaviDataOkay > 200)be26: 80 91 a4 02 lds r24, 0x02A4be2a: 89 3c cpi r24, 0xC9 ; 201be2c: 70 f0 brcs .+28 ; 0xbe4a <main+0x90e>{NaviDataOkay--;be2e: 81 50 subi r24, 0x01 ; 1be30: 80 93 a4 02 sts 0x02A4, r24VersionInfo.HardwareError[1] &= ~FC_ERROR1_SPI_RX;be34: e3 e6 ldi r30, 0x63 ; 99be36: fa e0 ldi r31, 0x0A ; 10be38: 80 81 ld r24, Zbe3a: 8b 7f andi r24, 0xFB ; 251be3c: 80 83 st Z, r24VersionInfo.Flags |= FC_VERSION_FLAG_NC_PRESENT;be3e: e6 e6 ldi r30, 0x66 ; 102be40: fa e0 ldi r31, 0x0A ; 10be42: 80 81 ld r24, Zbe44: 81 60 ori r24, 0x01 ; 1be46: 80 83 st Z, r24be48: 51 c0 rjmp .+162 ; 0xbeec <main+0x9b0>}else{if(NC_Version.Compatible)be4a: e4 ee ldi r30, 0xE4 ; 228be4c: f8 e0 ldi r31, 0x08 ; 8be4e: 80 81 ld r24, Zbe50: 88 23 and r24, r24be52: f1 f0 breq .+60 ; 0xbe90 <main+0x954>{VersionInfo.HardwareError[1] |= FC_ERROR1_SPI_RX;be54: e3 e6 ldi r30, 0x63 ; 99be56: fa e0 ldi r31, 0x0A ; 10be58: 80 81 ld r24, Zbe5a: 84 60 ori r24, 0x04 ; 4be5c: 80 83 st Z, r24NC_ErrorCode = 9; // "ERR: no NC communication"be5e: 89 e0 ldi r24, 0x09 ; 9be60: 80 93 bb 04 sts 0x04BB, r24if(BeepMuster == 0xffff && MotorenEin)be64: 80 91 a9 02 lds r24, 0x02A9be68: 90 91 aa 02 lds r25, 0x02AAbe6c: 01 96 adiw r24, 0x01 ; 1be6e: 81 f4 brne .+32 ; 0xbe90 <main+0x954>be70: 80 91 03 04 lds r24, 0x0403be74: 88 23 and r24, r24be76: 61 f0 breq .+24 ; 0xbe90 <main+0x954>{beeptime = 15000;be78: 88 e9 ldi r24, 0x98 ; 152be7a: 9a e3 ldi r25, 0x3A ; 58be7c: 90 93 ce 04 sts 0x04CE, r25be80: 80 93 cd 04 sts 0x04CD, r24BeepMuster = 0xA800;be84: 80 e0 ldi r24, 0x00 ; 0be86: 98 ea ldi r25, 0xA8 ; 168be88: 90 93 aa 02 sts 0x02AA, r25be8c: 80 93 a9 02 sts 0x02A9, r24}}GPS_Nick = 0;be90: 10 92 6b 04 sts 0x046B, r1be94: 10 92 6a 04 sts 0x046A, r1GPS_Roll = 0;be98: 10 92 69 04 sts 0x0469, r1be9c: 10 92 68 04 sts 0x0468, r1GPS_Aid_StickMultiplikator = 0;bea0: 10 92 67 04 sts 0x0467, r1GPSInfo.Flags = 0;bea4: e7 ed ldi r30, 0xD7 ; 215bea6: f8 e0 ldi r31, 0x08 ; 8bea8: 10 82 st Z, r1FromNaviCtrl_Value.Kalman_K = -1;beaa: 8f ef ldi r24, 0xFF ; 255beac: ec e4 ldi r30, 0x4C ; 76beae: f9 e0 ldi r31, 0x09 ; 9beb0: 80 83 st Z, r24FromNaviCtrl.AccErrorN = 0;beb2: e5 e1 ldi r30, 0x15 ; 21beb4: f9 e0 ldi r31, 0x09 ; 9beb6: 11 82 std Z+1, r1 ; 0x01beb8: 10 82 st Z, r1FromNaviCtrl.AccErrorR = 0;beba: f1 01 movw r30, r2bebc: 11 82 std Z+1, r1 ; 0x01bebe: 10 82 st Z, r1FromNaviCtrl.CompassValue = -1;bec0: 8f ef ldi r24, 0xFF ; 255bec2: 9f ef ldi r25, 0xFF ; 255bec4: f2 01 movw r30, r4bec6: 91 83 std Z+1, r25 ; 0x01bec8: 80 83 st Z, r24FromNC_AltitudeSpeed = 0;beca: 10 92 f3 03 sts 0x03F3, r1FromNC_AltitudeSetpoint = 0;bece: 10 92 f4 03 sts 0x03F4, r1bed2: 10 92 f5 03 sts 0x03F5, r1bed6: 10 92 f6 03 sts 0x03F6, r1beda: 10 92 f7 03 sts 0x03F7, r1VersionInfo.Flags &= ~FC_VERSION_FLAG_NC_PRESENT;bede: e6 e6 ldi r30, 0x66 ; 102bee0: fa e0 ldi r31, 0x0A ; 10bee2: 80 81 ld r24, Zbee4: 8e 7f andi r24, 0xFE ; 254bee6: 80 83 st Z, r24NaviDataOkay = 0;bee8: 10 92 a4 02 sts 0x02A4, r1}if(UBat <= BattLowVoltageWarning)beec: 20 91 53 01 lds r18, 0x0153bef0: 30 e0 ldi r19, 0x00 ; 0bef2: 80 91 1a 01 lds r24, 0x011Abef6: 90 91 1b 01 lds r25, 0x011Bbefa: 28 17 cp r18, r24befc: 39 07 cpc r19, r25befe: dc f0 brlt .+54 ; 0xbf36 <main+0x9fa>{FC_StatusFlags |= FC_STATUS_LOWBAT;bf00: 80 91 cb 03 lds r24, 0x03CBbf04: 80 62 ori r24, 0x20 ; 32bf06: 80 93 cb 03 sts 0x03CB, r24if(BeepMuster == 0xffff && UBat > 10) // Do not beep, if the voltage reading is below 1V (Supplied via MKUSB)bf0a: 80 91 a9 02 lds r24, 0x02A9bf0e: 90 91 aa 02 lds r25, 0x02AAbf12: 01 96 adiw r24, 0x01 ; 1bf14: 81 f4 brne .+32 ; 0xbf36 <main+0x9fa>bf16: 80 91 1a 01 lds r24, 0x011Abf1a: 90 91 1b 01 lds r25, 0x011Bbf1e: 0b 97 sbiw r24, 0x0b ; 11bf20: 54 f0 brlt .+20 ; 0xbf36 <main+0x9fa>{beeptime = 6000;bf22: f0 92 ce 04 sts 0x04CE, r15bf26: e0 92 cd 04 sts 0x04CD, r14BeepMuster = 0x0300;bf2a: 40 e0 ldi r20, 0x00 ; 0bf2c: 53 e0 ldi r21, 0x03 ; 3bf2e: 50 93 aa 02 sts 0x02AA, r21bf32: 40 93 a9 02 sts 0x02A9, r20}}// +++++++++++++++++++++++++++++++++// Sekundentaktif(++second == 49)bf36: 80 91 5b 04 lds r24, 0x045Bbf3a: 8f 5f subi r24, 0xFF ; 255bf3c: 80 93 5b 04 sts 0x045B, r24bf40: 81 33 cpi r24, 0x31 ; 49bf42: 09 f0 breq .+2 ; 0xbf46 <main+0xa0a>bf44: 82 c0 rjmp .+260 ; 0xc04a <main+0xb0e>{second = 0;bf46: 10 92 5b 04 sts 0x045B, r1#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))if(ShowSettingNameTime) ShowSettingNameTime--;bf4a: 80 91 80 04 lds r24, 0x0480bf4e: 88 23 and r24, r24bf50: 19 f0 breq .+6 ; 0xbf58 <main+0xa1c>bf52: 81 50 subi r24, 0x01 ; 1bf54: 80 93 80 04 sts 0x0480, r24#endifif(FC_StatusFlags & FC_STATUS_FLY) FlugSekunden++;bf58: 80 91 cb 03 lds r24, 0x03CBbf5c: 81 ff sbrs r24, 1bf5e: 0a c0 rjmp .+20 ; 0xbf74 <main+0xa38>bf60: 80 91 5e 04 lds r24, 0x045Ebf64: 90 91 5f 04 lds r25, 0x045Fbf68: 01 96 adiw r24, 0x01 ; 1bf6a: 90 93 5f 04 sts 0x045F, r25bf6e: 80 93 5e 04 sts 0x045E, r24bf72: 04 c0 rjmp .+8 ; 0xbf7c <main+0xa40>else timer2 = 1450; // 0,5 Minuten aufrundenbf74: 5a ea ldi r21, 0xAA ; 170bf76: c5 2f mov r28, r21bf78: 85 e0 ldi r24, 0x05 ; 5bf7a: d8 2f mov r29, r24if(modell_fliegt < 1024)bf7c: 80 91 cc 03 lds r24, 0x03CCbf80: 90 91 cd 03 lds r25, 0x03CDbf84: 81 15 cp r24, r1bf86: 94 40 sbci r25, 0x04 ; 4bf88: 08 f0 brcs .+2 ; 0xbf8c <main+0xa50>bf8a: 51 c0 rjmp .+162 ; 0xc02e <main+0xaf2>{if(StartLuftdruck < Luftdruck) StartLuftdruck += 5;bf8c: 40 91 08 05 lds r20, 0x0508bf90: 50 91 09 05 lds r21, 0x0509bf94: 60 91 0a 05 lds r22, 0x050Abf98: 70 91 0b 05 lds r23, 0x050Bbf9c: 80 91 12 01 lds r24, 0x0112bfa0: 90 91 13 01 lds r25, 0x0113bfa4: a0 91 14 01 lds r26, 0x0114bfa8: b0 91 15 01 lds r27, 0x0115bfac: 48 17 cp r20, r24bfae: 59 07 cpc r21, r25bfb0: 6a 07 cpc r22, r26bfb2: 7b 07 cpc r23, r27bfb4: a4 f4 brge .+40 ; 0xbfde <main+0xaa2>bfb6: 80 91 08 05 lds r24, 0x0508bfba: 90 91 09 05 lds r25, 0x0509bfbe: a0 91 0a 05 lds r26, 0x050Abfc2: b0 91 0b 05 lds r27, 0x050Bbfc6: 05 96 adiw r24, 0x05 ; 5bfc8: a1 1d adc r26, r1bfca: b1 1d adc r27, r1bfcc: 80 93 08 05 sts 0x0508, r24bfd0: 90 93 09 05 sts 0x0509, r25bfd4: a0 93 0a 05 sts 0x050A, r26bfd8: b0 93 0b 05 sts 0x050B, r27bfdc: 28 c0 rjmp .+80 ; 0xc02e <main+0xaf2>elseif(StartLuftdruck > Luftdruck) StartLuftdruck -= 5;bfde: 40 91 08 05 lds r20, 0x0508bfe2: 50 91 09 05 lds r21, 0x0509bfe6: 60 91 0a 05 lds r22, 0x050Abfea: 70 91 0b 05 lds r23, 0x050Bbfee: 80 91 12 01 lds r24, 0x0112bff2: 90 91 13 01 lds r25, 0x0113bff6: a0 91 14 01 lds r26, 0x0114bffa: b0 91 15 01 lds r27, 0x0115bffe: 84 17 cp r24, r20c000: 95 07 cpc r25, r21c002: a6 07 cpc r26, r22c004: b7 07 cpc r27, r23c006: 9c f4 brge .+38 ; 0xc02e <main+0xaf2>c008: 80 91 08 05 lds r24, 0x0508c00c: 90 91 09 05 lds r25, 0x0509c010: a0 91 0a 05 lds r26, 0x050Ac014: b0 91 0b 05 lds r27, 0x050Bc018: 05 97 sbiw r24, 0x05 ; 5c01a: a1 09 sbc r26, r1c01c: b1 09 sbc r27, r1c01e: 80 93 08 05 sts 0x0508, r24c022: 90 93 09 05 sts 0x0509, r25c026: a0 93 0a 05 sts 0x050A, r26c02a: b0 93 0b 05 sts 0x050B, r27}if(UBat > BattLowVoltageWarning + 1) FC_StatusFlags &= ~FC_STATUS_LOWBAT;c02e: 80 91 1a 01 lds r24, 0x011Ac032: 90 91 1b 01 lds r25, 0x011Bc036: 2f 5f subi r18, 0xFF ; 255c038: 3f 4f sbci r19, 0xFF ; 255c03a: 28 17 cp r18, r24c03c: 39 07 cpc r19, r25c03e: 2c f4 brge .+10 ; 0xc04a <main+0xb0e>c040: 80 91 cb 03 lds r24, 0x03CBc044: 8f 7d andi r24, 0xDF ; 223c046: 80 93 cb 03 sts 0x03CB, r24}// +++++++++++++++++++++++++++++++++if(++timer2 == 2930) // eine Minutec04a: 21 96 adiw r28, 0x01 ; 1c04c: c2 37 cpi r28, 0x72 ; 114c04e: fb e0 ldi r31, 0x0B ; 11c050: df 07 cpc r29, r31c052: 99 f5 brne .+102 ; 0xc0ba <main+0xb7e>{timer2 = 0;FlugMinuten++;c054: 80 91 62 04 lds r24, 0x0462c058: 90 91 63 04 lds r25, 0x0463c05c: 01 96 adiw r24, 0x01 ; 1c05e: 90 93 63 04 sts 0x0463, r25c062: 80 93 62 04 sts 0x0462, r24FlugMinutenGesamt++;c066: 20 91 60 04 lds r18, 0x0460c06a: 30 91 61 04 lds r19, 0x0461c06e: 2f 5f subi r18, 0xFF ; 255c070: 3f 4f sbci r19, 0xFF ; 255c072: 30 93 61 04 sts 0x0461, r19c076: 20 93 60 04 sts 0x0460, r18SetParamByte(PID_FLIGHT_MINUTES,FlugMinuten / 256);c07a: 69 2f mov r22, r25c07c: 8e e0 ldi r24, 0x0E ; 14c07e: 90 e0 ldi r25, 0x00 ; 0c080: 0e 94 45 25 call 0x4a8a ; 0x4a8a <SetParamByte>SetParamByte(PID_FLIGHT_MINUTES+1,FlugMinuten % 256);c084: e2 e6 ldi r30, 0x62 ; 98c086: f4 e0 ldi r31, 0x04 ; 4c088: 60 81 ld r22, Zc08a: 8f e0 ldi r24, 0x0F ; 15c08c: 90 e0 ldi r25, 0x00 ; 0c08e: 0e 94 45 25 call 0x4a8a ; 0x4a8a <SetParamByte>SetParamByte(PID_FLIGHT_MINUTES_TOTAL,FlugMinutenGesamt / 256);c092: 60 91 61 04 lds r22, 0x0461c096: 8a e0 ldi r24, 0x0A ; 10c098: 90 e0 ldi r25, 0x00 ; 0c09a: 0e 94 45 25 call 0x4a8a ; 0x4a8a <SetParamByte>SetParamByte(PID_FLIGHT_MINUTES_TOTAL+1,FlugMinutenGesamt % 256);c09e: e0 e6 ldi r30, 0x60 ; 96c0a0: f4 e0 ldi r31, 0x04 ; 4c0a2: 60 81 ld r22, Zc0a4: 8b e0 ldi r24, 0x0B ; 11c0a6: 90 e0 ldi r25, 0x00 ; 0c0a8: 0e 94 45 25 call 0x4a8a ; 0x4a8a <SetParamByte>timer = SetDelay(20); // falls "timer += 20;" mal nicht gehtc0ac: 84 e1 ldi r24, 0x14 ; 20c0ae: 90 e0 ldi r25, 0x00 ; 0c0b0: 0e 94 5a 9c call 0x138b4 ; 0x138b4 <SetDelay>c0b4: 4c 01 movw r8, r24if(UBat > BattLowVoltageWarning + 1) FC_StatusFlags &= ~FC_STATUS_LOWBAT;}// +++++++++++++++++++++++++++++++++if(++timer2 == 2930) // eine Minute{timer2 = 0;c0b6: c0 e0 ldi r28, 0x00 ; 0c0b8: d0 e0 ldi r29, 0x00 ; 0SetParamByte(PID_FLIGHT_MINUTES_TOTAL,FlugMinutenGesamt / 256);SetParamByte(PID_FLIGHT_MINUTES_TOTAL+1,FlugMinutenGesamt % 256);timer = SetDelay(20); // falls "timer += 20;" mal nicht geht}}LED_Update();c0ba: 0e 94 8f 85 call 0x10b1e ; 0x10b1e <LED_Update>Capacity_Update();c0be: 0e 94 fd 21 call 0x43fa ; 0x43fa <Capacity_Update>}} //else DebugOut.Analog[18]++;if(update_spi) update_spi--;c0c2: 11 23 and r17, r17c0c4: 19 f0 breq .+6 ; 0xc0cc <main+0xb90>c0c6: 11 50 subi r17, 0x01 ; 1} // 500Hzif(update_spi == 0) // 41Hzc0c8: 11 11 cpse r17, r1c0ca: 0c c0 rjmp .+24 ; 0xc0e4 <main+0xba8>{if(SPI_StartTransmitPacket()) update_spi = 12;c0cc: 0e 94 3a 9b call 0x13674 ; 0x13674 <SPI_StartTransmitPacket>c0d0: 81 11 cpse r24, r1c0d2: 2b cd rjmp .-1450 ; 0xbb2a <main+0x5ee>elseif(BytegapSPI == 0) SPI_TransmitByte();c0d4: 80 91 cc 04 lds r24, 0x04CCc0d8: 81 11 cpse r24, r1c0da: 29 cd rjmp .-1454 ; 0xbb2e <main+0x5f2>c0dc: 0e 94 de 95 call 0x12bbc ; 0x12bbc <SPI_TransmitByte>c0e0: 10 e0 ldi r17, 0x00 ; 0c0e2: 26 cd rjmp .-1460 ; 0xbb30 <main+0x5f4>}else if(BytegapSPI == 0) SPI_TransmitByte();c0e4: 80 91 cc 04 lds r24, 0x04CCc0e8: 81 11 cpse r24, r1c0ea: 22 cd rjmp .-1468 ; 0xbb30 <main+0x5f4>c0ec: 0e 94 de 95 call 0x12bbc ; 0x12bbc <SPI_TransmitByte>c0f0: 1f cd rjmp .-1474 ; 0xbb30 <main+0x5f4>0000c0f2 <GetHottestBl>:void GetHottestBl(void){static unsigned char search = 0,tmp_max,tmp_min,who;if(Motor[search].Temperature > tmp_max) { tmp_max = Motor[search].Temperature; who = search;}c0f2: 80 91 7d 04 lds r24, 0x047Dc0f6: 9f e0 ldi r25, 0x0F ; 15c0f8: 89 9f mul r24, r25c0fa: f0 01 movw r30, r0c0fc: 11 24 eor r1, r1c0fe: e9 56 subi r30, 0x69 ; 105c100: f6 4f sbci r31, 0xF6 ; 246c102: 97 81 ldd r25, Z+7 ; 0x07c104: 20 91 7c 04 lds r18, 0x047Cc108: 29 17 cp r18, r25c10a: 28 f4 brcc .+10 ; 0xc116 <GetHottestBl+0x24>c10c: 90 93 7c 04 sts 0x047C, r25c110: 80 93 7b 04 sts 0x047B, r24c114: 08 c0 rjmp .+16 ; 0xc126 <GetHottestBl+0x34>elseif(Motor[search].Temperature) if(Motor[search].Temperature < tmp_min) tmp_min = Motor[search].Temperature;c116: 99 23 and r25, r25c118: 31 f0 breq .+12 ; 0xc126 <GetHottestBl+0x34>c11a: 20 91 7a 04 lds r18, 0x047Ac11e: 92 17 cp r25, r18c120: 10 f4 brcc .+4 ; 0xc126 <GetHottestBl+0x34>c122: 90 93 7a 04 sts 0x047A, r25if(++search >= MAX_MOTORS)c126: 8f 5f subi r24, 0xFF ; 255c128: 8c 30 cpi r24, 0x0C ; 12c12a: 18 f4 brcc .+6 ; 0xc132 <GetHottestBl+0x40>c12c: 80 93 7d 04 sts 0x047D, r24c130: 08 95 ret{search = 0;c132: 10 92 7d 04 sts 0x047D, r1if(tmp_min != 255) MinBlTemperture = tmp_min; else MinBlTemperture = 0;c136: 80 91 7a 04 lds r24, 0x047Ac13a: 8f 3f cpi r24, 0xFF ; 255c13c: 19 f0 breq .+6 ; 0xc144 <GetHottestBl+0x52>c13e: 80 93 83 04 sts 0x0483, r24c142: 02 c0 rjmp .+4 ; 0xc148 <GetHottestBl+0x56>c144: 10 92 83 04 sts 0x0483, r1MaxBlTemperture = tmp_max;c148: 80 91 7c 04 lds r24, 0x047Cc14c: 80 93 84 04 sts 0x0484, r24HottestBl = who;c150: 80 91 7b 04 lds r24, 0x047Bc154: 80 93 82 04 sts 0x0482, r24tmp_min = 255;c158: 8f ef ldi r24, 0xFF ; 255c15a: 80 93 7a 04 sts 0x047A, r24tmp_max = 0;c15e: 10 92 7c 04 sts 0x047C, r1who = 0;c162: 10 92 7b 04 sts 0x047B, r1c166: 08 95 ret0000c168 <Hott_ClearLine>:}//---------------------------------------------------------------void Hott_ClearLine(unsigned char line){HoTT_printfxy(0,line," ");c168: 95 e1 ldi r25, 0x15 ; 21c16a: 89 9f mul r24, r25c16c: 80 2d mov r24, r0c16e: 11 24 eor r1, r1c170: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>c174: 80 e1 ldi r24, 0x10 ; 16c176: 9b e0 ldi r25, 0x0B ; 11c178: 9f 93 push r25c17a: 8f 93 push r24c17c: 8b e0 ldi r24, 0x0B ; 11c17e: 95 e1 ldi r25, 0x15 ; 21c180: 9f 93 push r25c182: 8f 93 push r24c184: e0 91 78 06 lds r30, 0x0678c188: f0 91 79 06 lds r31, 0x0679c18c: 09 95 icallc18e: 0f 90 pop r0c190: 0f 90 pop r0c192: 0f 90 pop r0c194: 0f 90 pop r0c196: 08 95 ret0000c198 <HoTT_Waring>:}//---------------------------------------------------------------unsigned char HoTT_Waring(void){c198: cf 93 push r28unsigned char status = 0;static char old_status = 0;static int repeat;//if(Parameter_UserParam1) return(Parameter_UserParam1);ToNC_SpeakHoTT = SpeakHoTT;c19a: c0 91 57 01 lds r28, 0x0157c19e: c0 93 81 04 sts 0x0481, r28if(FC_StatusFlags & FC_STATUS_LOWBAT)c1a2: 80 91 cb 03 lds r24, 0x03CBc1a6: 85 ff sbrs r24, 5c1a8: 14 c0 rjmp .+40 ; 0xc1d2 <HoTT_Waring+0x3a>{if(LowVoltageLandingActive && (EE_Parameter.Receiver == RECEIVER_HOTT)) status = SPEAK_LANDING;c1aa: 80 91 c1 03 lds r24, 0x03C1c1ae: 88 23 and r24, r24c1b0: 31 f0 breq .+12 ; 0xc1be <HoTT_Waring+0x26>c1b2: 80 91 65 05 lds r24, 0x0565c1b6: 86 30 cpi r24, 0x06 ; 6c1b8: 21 f0 breq .+8 ; 0xc1c2 <HoTT_Waring+0x2a>else status = VOICE_MINIMALE_EINGANSSPANNUNG; // Jeti hat kein wort: "LANDEN"c1ba: e0 e1 ldi r30, 0x10 ; 16c1bc: 03 c0 rjmp .+6 ; 0xc1c4 <HoTT_Waring+0x2c>c1be: e0 e1 ldi r30, 0x10 ; 16c1c0: 01 c0 rjmp .+2 ; 0xc1c4 <HoTT_Waring+0x2c>static int repeat;//if(Parameter_UserParam1) return(Parameter_UserParam1);ToNC_SpeakHoTT = SpeakHoTT;if(FC_StatusFlags & FC_STATUS_LOWBAT){if(LowVoltageLandingActive && (EE_Parameter.Receiver == RECEIVER_HOTT)) status = SPEAK_LANDING;c1c2: ee e0 ldi r30, 0x0E ; 14else status = VOICE_MINIMALE_EINGANSSPANNUNG; // Jeti hat kein wort: "LANDEN"if(SpeakHoTT && old_status == VOICE_MINIMALE_EINGANSSPANNUNG) status = SpeakHoTT; // das soll auch noch durch kommenc1c4: cc 23 and r28, r28c1c6: 01 f1 breq .+64 ; 0xc208 <HoTT_Waring+0x70>c1c8: 80 91 79 04 lds r24, 0x0479c1cc: 80 31 cpi r24, 0x10 ; 16c1ce: e1 f4 brne .+56 ; 0xc208 <HoTT_Waring+0x70>c1d0: 25 c0 rjmp .+74 ; 0xc21c <HoTT_Waring+0x84>}elseif(NC_ErrorCode && NC_ErrorCode < MAX_ERR_NUMBER) // Fehlercodesc1d2: 80 91 bb 04 lds r24, 0x04BBc1d6: 9f ef ldi r25, 0xFF ; 255c1d8: 98 0f add r25, r24c1da: 92 32 cpi r25, 0x22 ; 34c1dc: b8 f4 brcc .+46 ; 0xc20c <HoTT_Waring+0x74>{if(MotorenEin || !pgm_read_byte(&HOTT_ERROR[NC_ErrorCode][1])) status = pgm_read_byte(&HOTT_ERROR[NC_ErrorCode][0]);c1de: 90 91 03 04 lds r25, 0x0403c1e2: 91 11 cpse r25, r1c1e4: 0a c0 rjmp .+20 ; 0xc1fa <HoTT_Waring+0x62>c1e6: 28 2f mov r18, r24c1e8: 30 e0 ldi r19, 0x00 ; 0c1ea: f9 01 movw r30, r18c1ec: ee 0f add r30, r30c1ee: ff 1f adc r31, r31c1f0: e9 5d subi r30, 0xD9 ; 217c1f2: f4 4f sbci r31, 0xF4 ; 244c1f4: e4 91 lpm r30, Zc1f6: e1 11 cpse r30, r1c1f8: 09 c0 rjmp .+18 ; 0xc20c <HoTT_Waring+0x74>c1fa: e8 2f mov r30, r24c1fc: f0 e0 ldi r31, 0x00 ; 0c1fe: ee 0f add r30, r30c200: ff 1f adc r31, r31c202: ea 5d subi r30, 0xDA ; 218c204: f4 4f sbci r31, 0xF4 ; 244c206: e4 91 lpm r30, Z}if(!status) // Sprachansagenc208: e1 11 cpse r30, r1c20a: 09 c0 rjmp .+18 ; 0xc21e <HoTT_Waring+0x86>{// if(!(GetParamByte(PID_SPEAK_HOTT_CFG) & 0x01)) SpeakHoTT = 0; // is the voice wanted?if(!(EE_Parameter.GlobalConfig3 & CFG3_SPEAK_ALL)) SpeakHoTT = 0; // is the voice wanted?c20c: 80 91 b9 05 lds r24, 0x05B9c210: 86 fd sbrc r24, 6c212: 08 c0 rjmp .+16 ; 0xc224 <HoTT_Waring+0x8c>c214: 10 92 57 01 sts 0x0157, r1c218: c0 e0 ldi r28, 0x00 ; 0c21a: 04 c0 rjmp .+8 ; 0xc224 <HoTT_Waring+0x8c>ToNC_SpeakHoTT = SpeakHoTT;if(FC_StatusFlags & FC_STATUS_LOWBAT){if(LowVoltageLandingActive && (EE_Parameter.Receiver == RECEIVER_HOTT)) status = SPEAK_LANDING;else status = VOICE_MINIMALE_EINGANSSPANNUNG; // Jeti hat kein wort: "LANDEN"if(SpeakHoTT && old_status == VOICE_MINIMALE_EINGANSSPANNUNG) status = SpeakHoTT; // das soll auch noch durch kommenc21c: ec 2f mov r30, r28{// if(!(GetParamByte(PID_SPEAK_HOTT_CFG) & 0x01)) SpeakHoTT = 0; // is the voice wanted?if(!(EE_Parameter.GlobalConfig3 & CFG3_SPEAK_ALL)) SpeakHoTT = 0; // is the voice wanted?else status = SpeakHoTT;}else ToNC_SpeakHoTT = status;c21e: e0 93 81 04 sts 0x0481, r30c222: ce 2f mov r28, r30if(old_status == status) // Gleichen Fehler nur alle 4 sek bringenc224: 80 91 79 04 lds r24, 0x0479c228: 8c 13 cpse r24, r28c22a: 11 c0 rjmp .+34 ; 0xc24e <HoTT_Waring+0xb6>{if(!CheckDelay(repeat)) return(0);c22c: 80 91 77 04 lds r24, 0x0477c230: 90 91 78 04 lds r25, 0x0478c234: 0e 94 63 9c call 0x138c6 ; 0x138c6 <CheckDelay>c238: 88 23 and r24, r24c23a: e9 f0 breq .+58 ; 0xc276 <HoTT_Waring+0xde>repeat = SetDelay(4000);c23c: 80 ea ldi r24, 0xA0 ; 160c23e: 9f e0 ldi r25, 0x0F ; 15c240: 0e 94 5a 9c call 0x138b4 ; 0x138b4 <SetDelay>c244: 90 93 78 04 sts 0x0478, r25c248: 80 93 77 04 sts 0x0477, r24c24c: 08 c0 rjmp .+16 ; 0xc25e <HoTT_Waring+0xc6>}else repeat = SetDelay(2000);c24e: 80 ed ldi r24, 0xD0 ; 208c250: 97 e0 ldi r25, 0x07 ; 7c252: 0e 94 5a 9c call 0x138b4 ; 0x138b4 <SetDelay>c256: 90 93 78 04 sts 0x0478, r25c25a: 80 93 77 04 sts 0x0477, r24if(status)c25e: cc 23 and r28, r28c260: 31 f0 breq .+12 ; 0xc26e <HoTT_Waring+0xd6>{if(status == SpeakHoTT) SpeakHoTT = 0;c262: 80 91 57 01 lds r24, 0x0157c266: c8 13 cpse r28, r24c268: 02 c0 rjmp .+4 ; 0xc26e <HoTT_Waring+0xd6>c26a: 10 92 57 01 sts 0x0157, r1}old_status = status;c26e: c0 93 79 04 sts 0x0479, r28// DebugOut.Analog[16] = status;return(status);c272: 8c 2f mov r24, r28c274: 01 c0 rjmp .+2 ; 0xc278 <HoTT_Waring+0xe0>}else ToNC_SpeakHoTT = status;if(old_status == status) // Gleichen Fehler nur alle 4 sek bringen{if(!CheckDelay(repeat)) return(0);c276: 80 e0 ldi r24, 0x00 ; 0if(status == SpeakHoTT) SpeakHoTT = 0;}old_status = status;// DebugOut.Analog[16] = status;return(status);}c278: cf 91 pop r28c27a: 08 95 ret0000c27c <NC_Fills_HoTT_Telemety>://---------------------------------------------------------------void NC_Fills_HoTT_Telemety(void){unsigned char *ptr = NULL;unsigned char max = 0,i,z;switch(FromNaviCtrl.Param.Byte[11])c27c: 80 91 2a 09 lds r24, 0x092Ac280: 89 38 cpi r24, 0x89 ; 137c282: 31 f1 breq .+76 ; 0xc2d0 <NC_Fills_HoTT_Telemety+0x54>c284: 38 f4 brcc .+14 ; 0xc294 <NC_Fills_HoTT_Telemety+0x18>c286: 82 30 cpi r24, 0x02 ; 2c288: d9 f0 breq .+54 ; 0xc2c0 <NC_Fills_HoTT_Telemety+0x44>c28a: 83 30 cpi r24, 0x03 ; 3c28c: e9 f0 breq .+58 ; 0xc2c8 <NC_Fills_HoTT_Telemety+0x4c>c28e: 81 30 cpi r24, 0x01 ; 1c290: f1 f5 brne .+124 ; 0xc30e <NC_Fills_HoTT_Telemety+0x92>c292: 12 c0 rjmp .+36 ; 0xc2b8 <NC_Fills_HoTT_Telemety+0x3c>c294: 8d 38 cpi r24, 0x8D ; 141c296: 61 f0 breq .+24 ; 0xc2b0 <NC_Fills_HoTT_Telemety+0x34>c298: 8e 38 cpi r24, 0x8E ; 142c29a: 31 f0 breq .+12 ; 0xc2a8 <NC_Fills_HoTT_Telemety+0x2c>c29c: 8a 38 cpi r24, 0x8A ; 138c29e: b9 f5 brne .+110 ; 0xc30e <NC_Fills_HoTT_Telemety+0x92>ptr = (unsigned char *) &VarioPacket;max = sizeof(VarioPacket);break;case HOTT_GPS_PACKET_ID:ptr = (unsigned char *) &GPSPacket;max = sizeof(GPSPacket);c2a0: 5c e2 ldi r21, 0x2C ; 44case HOTT_VARIO_PACKET_ID:ptr = (unsigned char *) &VarioPacket;max = sizeof(VarioPacket);break;case HOTT_GPS_PACKET_ID:ptr = (unsigned char *) &GPSPacket;c2a2: 84 eb ldi r24, 0xB4 ; 180c2a4: 97 e0 ldi r25, 0x07 ; 7max = sizeof(GPSPacket);break;c2a6: 17 c0 rjmp .+46 ; 0xc2d6 <NC_Fills_HoTT_Telemety+0x5a>case HOTT_ELECTRIC_AIR_PACKET_ID:ptr = (unsigned char *) &ElectricAirPacket;max = sizeof(ElectricAirPacket);c2a8: 5c e2 ldi r21, 0x2C ; 44case HOTT_GPS_PACKET_ID:ptr = (unsigned char *) &GPSPacket;max = sizeof(GPSPacket);break;case HOTT_ELECTRIC_AIR_PACKET_ID:ptr = (unsigned char *) &ElectricAirPacket;c2aa: 8a e7 ldi r24, 0x7A ; 122c2ac: 96 e0 ldi r25, 0x06 ; 6max = sizeof(ElectricAirPacket);break;c2ae: 13 c0 rjmp .+38 ; 0xc2d6 <NC_Fills_HoTT_Telemety+0x5a>case HOTT_GENERAL_PACKET_ID:ptr = (unsigned char *) &HoTTGeneral;max = sizeof(HoTTGeneral);c2b0: 5c e2 ldi r21, 0x2C ; 44case HOTT_ELECTRIC_AIR_PACKET_ID:ptr = (unsigned char *) &ElectricAirPacket;max = sizeof(ElectricAirPacket);break;case HOTT_GENERAL_PACKET_ID:ptr = (unsigned char *) &HoTTGeneral;c2b2: 86 ea ldi r24, 0xA6 ; 166c2b4: 96 e0 ldi r25, 0x06 ; 6max = sizeof(HoTTGeneral);break;c2b6: 0f c0 rjmp .+30 ; 0xc2d6 <NC_Fills_HoTT_Telemety+0x5a>case JETI_GPS_PACKET_ID1:ptr = (unsigned char *) &JetiExData[14].Value;max = sizeof(JetiExData[14].Value);c2b8: 54 e0 ldi r21, 0x04 ; 4case HOTT_GENERAL_PACKET_ID:ptr = (unsigned char *) &HoTTGeneral;max = sizeof(HoTTGeneral);break;case JETI_GPS_PACKET_ID1:ptr = (unsigned char *) &JetiExData[14].Value;c2ba: 86 e7 ldi r24, 0x76 ; 118c2bc: 92 e0 ldi r25, 0x02 ; 2max = sizeof(JetiExData[14].Value);break;c2be: 0b c0 rjmp .+22 ; 0xc2d6 <NC_Fills_HoTT_Telemety+0x5a>case JETI_GPS_PACKET_ID2:ptr = (unsigned char *) &JetiExData[15].Value;max = sizeof(JetiExData[15].Value);c2c0: 54 e0 ldi r21, 0x04 ; 4case JETI_GPS_PACKET_ID1:ptr = (unsigned char *) &JetiExData[14].Value;max = sizeof(JetiExData[14].Value);break;case JETI_GPS_PACKET_ID2:ptr = (unsigned char *) &JetiExData[15].Value;c2c2: 89 e8 ldi r24, 0x89 ; 137c2c4: 92 e0 ldi r25, 0x02 ; 2max = sizeof(JetiExData[15].Value);break;c2c6: 07 c0 rjmp .+14 ; 0xc2d6 <NC_Fills_HoTT_Telemety+0x5a>case HOTT_WPL_NAME:ptr = (unsigned char *) WPL_Name;max = sizeof(WPL_Name)-1;c2c8: 59 e0 ldi r21, 0x09 ; 9case JETI_GPS_PACKET_ID2:ptr = (unsigned char *) &JetiExData[15].Value;max = sizeof(JetiExData[15].Value);break;case HOTT_WPL_NAME:ptr = (unsigned char *) WPL_Name;c2ca: 82 ed ldi r24, 0xD2 ; 210c2cc: 96 e0 ldi r25, 0x06 ; 6max = sizeof(WPL_Name)-1;break;c2ce: 03 c0 rjmp .+6 ; 0xc2d6 <NC_Fills_HoTT_Telemety+0x5a>unsigned char max = 0,i,z;switch(FromNaviCtrl.Param.Byte[11]){case HOTT_VARIO_PACKET_ID:ptr = (unsigned char *) &VarioPacket;max = sizeof(VarioPacket);c2d0: 5c e2 ldi r21, 0x2C ; 44unsigned char *ptr = NULL;unsigned char max = 0,i,z;switch(FromNaviCtrl.Param.Byte[11]){case HOTT_VARIO_PACKET_ID:ptr = (unsigned char *) &VarioPacket;c2d2: 8c ed ldi r24, 0xDC ; 220c2d4: 96 e0 ldi r25, 0x06 ; 6ptr = (unsigned char *) WPL_Name;max = sizeof(WPL_Name)-1;break;}z = FromNaviCtrl.Param.Byte[0]; // Data allocationc2d6: 20 91 1f 09 lds r18, 0x091Ffor(i=0; i < FromNaviCtrl.Param.Byte[1]; i++)c2da: 30 91 20 09 lds r19, 0x0920c2de: 33 23 and r19, r19c2e0: b1 f0 breq .+44 ; 0xc30e <NC_Fills_HoTT_Telemety+0x92>{if(z >= max) break;c2e2: 25 17 cp r18, r21c2e4: a0 f4 brcc .+40 ; 0xc30e <NC_Fills_HoTT_Telemety+0x92>break;}z = FromNaviCtrl.Param.Byte[0]; // Data allocationfor(i=0; i < FromNaviCtrl.Param.Byte[1]; i++)c2e6: 30 e0 ldi r19, 0x00 ; 0c2e8: a0 e2 ldi r26, 0x20 ; 32c2ea: b9 e0 ldi r27, 0x09 ; 9c2ec: 02 c0 rjmp .+4 ; 0xc2f2 <NC_Fills_HoTT_Telemety+0x76>{if(z >= max) break;c2ee: 25 17 cp r18, r21c2f0: 70 f4 brcc .+28 ; 0xc30e <NC_Fills_HoTT_Telemety+0x92>ptr[z] = FromNaviCtrl.Param.Byte[2+i];c2f2: e3 2f mov r30, r19c2f4: f0 e0 ldi r31, 0x00 ; 0c2f6: e4 5f subi r30, 0xF4 ; 244c2f8: f6 4f sbci r31, 0xF6 ; 246c2fa: 45 89 ldd r20, Z+21 ; 0x15c2fc: fc 01 movw r30, r24c2fe: e2 0f add r30, r18c300: f1 1d adc r31, r1c302: 40 83 st Z, r20z++;c304: 2f 5f subi r18, 0xFF ; 255break;}z = FromNaviCtrl.Param.Byte[0]; // Data allocationfor(i=0; i < FromNaviCtrl.Param.Byte[1]; i++)c306: 3f 5f subi r19, 0xFF ; 255c308: 4c 91 ld r20, Xc30a: 34 17 cp r19, r20c30c: 80 f3 brcs .-32 ; 0xc2ee <NC_Fills_HoTT_Telemety+0x72>c30e: 08 95 ret0000c310 <BuildHoTT_Vario>:}unsigned int BuildHoTT_Vario(void){unsigned int tmp = VARIO_ZERO;if(VarioCharacter == '+' || VarioCharacter == '-')c310: 80 91 20 01 lds r24, 0x0120c314: 8b 32 cpi r24, 0x2B ; 43c316: 11 f0 breq .+4 ; 0xc31c <BuildHoTT_Vario+0xc>c318: 8d 32 cpi r24, 0x2D ; 45c31a: c9 f4 brne .+50 ; 0xc34e <BuildHoTT_Vario+0x3e>{tmp = VARIO_ZERO + (AltitudeSetpointTrimming * EE_Parameter.Hoehe_Verstaerkung) / 3;c31c: 40 91 50 05 lds r20, 0x0550c320: 20 91 f8 03 lds r18, 0x03F8c324: 30 91 f9 03 lds r19, 0x03F9c328: 42 9f mul r20, r18c32a: c0 01 movw r24, r0c32c: 43 9f mul r20, r19c32e: 90 0d add r25, r0c330: 11 24 eor r1, r1c332: 63 e0 ldi r22, 0x03 ; 3c334: 70 e0 ldi r23, 0x00 ; 0c336: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>c33a: cb 01 movw r24, r22c33c: 80 5d subi r24, 0xD0 ; 208c33e: 9a 48 sbci r25, 0x8A ; 138if(tmp < VARIO_ZERO && tmp > VARIO_ZERO - 50) tmp = VARIO_ZERO - 50; // weil es sonst erst bei < 0,5m/sek pieptc340: 6f 5c subi r22, 0xCF ; 207c342: 7f 4f sbci r23, 0xFF ; 255c344: 61 33 cpi r22, 0x31 ; 49c346: 71 05 cpc r23, r1c348: 08 f4 brcc .+2 ; 0xc34c <BuildHoTT_Vario+0x3c>c34a: 40 c0 rjmp .+128 ; 0xc3cc <BuildHoTT_Vario+0xbc>c34c: 08 95 ret}elseif((VarioCharacter == ' ') && (FC_StatusFlags & FC_STATUS_FLY))c34e: 80 32 cpi r24, 0x20 ; 32c350: f9 f4 brne .+62 ; 0xc390 <BuildHoTT_Vario+0x80>c352: 80 91 cb 03 lds r24, 0x03CBc356: 81 ff sbrs r24, 1c358: 3c c0 rjmp .+120 ; 0xc3d2 <BuildHoTT_Vario+0xc2>{tmp = VARIO_ZERO + HoTTVarioMeter;c35a: 80 91 7e 04 lds r24, 0x047Ec35e: 90 91 7f 04 lds r25, 0x047Fc362: 80 5d subi r24, 0xD0 ; 208c364: 9a 48 sbci r25, 0x8A ; 138if(tmp > VARIO_ZERO)c366: 81 33 cpi r24, 0x31 ; 49c368: 25 e7 ldi r18, 0x75 ; 117c36a: 92 07 cpc r25, r18c36c: 30 f0 brcs .+12 ; 0xc37a <BuildHoTT_Vario+0x6a>{if(tmp < VARIO_ZERO + 100) tmp = VARIO_ZERO;c36e: 84 39 cpi r24, 0x94 ; 148c370: 35 e7 ldi r19, 0x75 ; 117c372: 93 07 cpc r25, r19c374: 88 f1 brcs .+98 ; 0xc3d8 <BuildHoTT_Vario+0xc8>else tmp -= 100;c376: 84 56 subi r24, 0x64 ; 100c378: 91 09 sbc r25, r1}if(tmp < VARIO_ZERO)c37a: 80 33 cpi r24, 0x30 ; 48c37c: 25 e7 ldi r18, 0x75 ; 117c37e: 92 07 cpc r25, r18c380: 98 f5 brcc .+102 ; 0xc3e8 <BuildHoTT_Vario+0xd8>{if(tmp > VARIO_ZERO - 100) tmp = VARIO_ZERO;c382: 8d 3c cpi r24, 0xCD ; 205c384: 34 e7 ldi r19, 0x74 ; 116c386: 93 07 cpc r25, r19c388: 50 f5 brcc .+84 ; 0xc3de <BuildHoTT_Vario+0xce>else tmp += 100;c38a: 8c 59 subi r24, 0x9C ; 156c38c: 9f 4f sbci r25, 0xFF ; 255c38e: 08 95 ret}}elseif(VarioCharacter == '^') tmp = VARIO_ZERO + FromNC_AltitudeSpeed * 10;c390: 8e 35 cpi r24, 0x5E ; 94c392: 89 f4 brne .+34 ; 0xc3b6 <BuildHoTT_Vario+0xa6>c394: 20 91 f3 03 lds r18, 0x03F3c398: 30 e0 ldi r19, 0x00 ; 0c39a: c9 01 movw r24, r18c39c: 88 0f add r24, r24c39e: 99 1f adc r25, r25c3a0: 22 0f add r18, r18c3a2: 33 1f adc r19, r19c3a4: 22 0f add r18, r18c3a6: 33 1f adc r19, r19c3a8: 22 0f add r18, r18c3aa: 33 1f adc r19, r19c3ac: 82 0f add r24, r18c3ae: 93 1f adc r25, r19c3b0: 80 5d subi r24, 0xD0 ; 208c3b2: 9a 48 sbci r25, 0x8A ; 138c3b4: 08 95 retelseif(VarioCharacter == 'v') tmp = VARIO_ZERO - FromNC_AltitudeSpeed * 10;c3b6: 86 37 cpi r24, 0x76 ; 118c3b8: a9 f4 brne .+42 ; 0xc3e4 <BuildHoTT_Vario+0xd4>c3ba: 20 91 f3 03 lds r18, 0x03F3c3be: 36 ef ldi r19, 0xF6 ; 246c3c0: 32 03 mulsu r19, r18c3c2: c0 01 movw r24, r0c3c4: 11 24 eor r1, r1c3c6: 80 5d subi r24, 0xD0 ; 208c3c8: 9a 48 sbci r25, 0x8A ; 138c3ca: 08 95 ret{unsigned int tmp = VARIO_ZERO;if(VarioCharacter == '+' || VarioCharacter == '-'){tmp = VARIO_ZERO + (AltitudeSetpointTrimming * EE_Parameter.Hoehe_Verstaerkung) / 3;if(tmp < VARIO_ZERO && tmp > VARIO_ZERO - 50) tmp = VARIO_ZERO - 50; // weil es sonst erst bei < 0,5m/sek pieptc3cc: 8e ef ldi r24, 0xFE ; 254c3ce: 94 e7 ldi r25, 0x74 ; 116c3d0: 08 95 ret}}unsigned int BuildHoTT_Vario(void){unsigned int tmp = VARIO_ZERO;c3d2: 80 e3 ldi r24, 0x30 ; 48c3d4: 95 e7 ldi r25, 0x75 ; 117c3d6: 08 95 retif((VarioCharacter == ' ') && (FC_StatusFlags & FC_STATUS_FLY)){tmp = VARIO_ZERO + HoTTVarioMeter;if(tmp > VARIO_ZERO){if(tmp < VARIO_ZERO + 100) tmp = VARIO_ZERO;c3d8: 80 e3 ldi r24, 0x30 ; 48c3da: 95 e7 ldi r25, 0x75 ; 117c3dc: 08 95 retelse tmp -= 100;}if(tmp < VARIO_ZERO){if(tmp > VARIO_ZERO - 100) tmp = VARIO_ZERO;c3de: 80 e3 ldi r24, 0x30 ; 48c3e0: 95 e7 ldi r25, 0x75 ; 117c3e2: 08 95 ret}}unsigned int BuildHoTT_Vario(void){unsigned int tmp = VARIO_ZERO;c3e4: 80 e3 ldi r24, 0x30 ; 48c3e6: 95 e7 ldi r25, 0x75 ; 117elseif(VarioCharacter == '^') tmp = VARIO_ZERO + FromNC_AltitudeSpeed * 10;elseif(VarioCharacter == 'v') tmp = VARIO_ZERO - FromNC_AltitudeSpeed * 10;return(tmp);}c3e8: 08 95 ret0000c3ea <HoTT_Telemety>://---------------------------------------------------------------unsigned char HoTT_Telemety(unsigned char packet_request){c3ea: cf 93 push r28unsigned char i = 0;//Debug("rqst: %02X",packet_request);switch(packet_request)c3ec: 8a 38 cpi r24, 0x8A ; 138c3ee: 09 f4 brne .+2 ; 0xc3f2 <HoTT_Telemety+0x8>c3f0: 36 c2 rjmp .+1132 ; 0xc85e <HoTT_Telemety+0x474>c3f2: 18 f4 brcc .+6 ; 0xc3fa <HoTT_Telemety+0x10>c3f4: 89 38 cpi r24, 0x89 ; 137c3f6: 41 f0 breq .+16 ; 0xc408 <HoTT_Telemety+0x1e>c3f8: 17 c4 rjmp .+2094 ; 0xcc28 <HoTT_Telemety+0x83e>c3fa: 8d 38 cpi r24, 0x8D ; 141c3fc: 09 f4 brne .+2 ; 0xc400 <HoTT_Telemety+0x16>c3fe: 42 c3 rjmp .+1668 ; 0xca84 <HoTT_Telemety+0x69a>c400: 8e 38 cpi r24, 0x8E ; 142c402: 09 f4 brne .+2 ; 0xc406 <HoTT_Telemety+0x1c>c404: 85 c2 rjmp .+1290 ; 0xc910 <HoTT_Telemety+0x526>c406: 10 c4 rjmp .+2080 ; 0xcc28 <HoTT_Telemety+0x83e>{case HOTT_VARIO_PACKET_ID:GPSPacket.WarnBeep = HoTT_Waring(); // Achtung: das ist richtig hier, damit der Varioton schon vorher abgestellt wirdc408: c7 de rcall .-626 ; 0xc198 <HoTT_Waring>c40a: c8 2f mov r28, r24c40c: 80 93 b6 07 sts 0x07B6, r24VarioPacket.Altitude = HoehenWert/100 + 500;c410: 60 91 fe 03 lds r22, 0x03FEc414: 70 91 ff 03 lds r23, 0x03FFc418: 80 91 00 04 lds r24, 0x0400c41c: 90 91 01 04 lds r25, 0x0401c420: 24 e6 ldi r18, 0x64 ; 100c422: 30 e0 ldi r19, 0x00 ; 0c424: 40 e0 ldi r20, 0x00 ; 0c426: 50 e0 ldi r21, 0x00 ; 0c428: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>c42c: 2c 50 subi r18, 0x0C ; 12c42e: 3e 4f sbci r19, 0xFE ; 254c430: 30 93 e2 06 sts 0x06E2, r19c434: 20 93 e1 06 sts 0x06E1, r18if(!GPSPacket.WarnBeep) VarioPacket.m_sec = BuildHoTT_Vario(); else VarioPacket.m_sec = VARIO_ZERO;c438: c1 11 cpse r28, r1c43a: 06 c0 rjmp .+12 ; 0xc448 <HoTT_Telemety+0x5e>c43c: 69 df rcall .-302 ; 0xc310 <BuildHoTT_Vario>c43e: 90 93 e8 06 sts 0x06E8, r25c442: 80 93 e7 06 sts 0x06E7, r24c446: 06 c0 rjmp .+12 ; 0xc454 <HoTT_Telemety+0x6a>c448: 80 e3 ldi r24, 0x30 ; 48c44a: 95 e7 ldi r25, 0x75 ; 117c44c: 90 93 e8 06 sts 0x06E8, r25c450: 80 93 e7 06 sts 0x06E7, r24VarioPacket.m_3sec = VarioPacket.m_sec;c454: 80 91 e7 06 lds r24, 0x06E7c458: 90 91 e8 06 lds r25, 0x06E8c45c: 90 93 ea 06 sts 0x06EA, r25c460: 80 93 e9 06 sts 0x06E9, r24VarioPacket.m_10sec = VarioPacket.m_sec;c464: 90 93 ec 06 sts 0x06EC, r25c468: 80 93 eb 06 sts 0x06EB, r24if (VarioPacket.Altitude < VarioPacket.MinAltitude) VarioPacket.MinAltitude = VarioPacket.Altitude;c46c: 80 91 e1 06 lds r24, 0x06E1c470: 90 91 e2 06 lds r25, 0x06E2c474: 20 91 e5 06 lds r18, 0x06E5c478: 30 91 e6 06 lds r19, 0x06E6c47c: 82 17 cp r24, r18c47e: 93 07 cpc r25, r19c480: 24 f4 brge .+8 ; 0xc48a <HoTT_Telemety+0xa0>c482: 90 93 e6 06 sts 0x06E6, r25c486: 80 93 e5 06 sts 0x06E5, r24if (VarioPacket.Altitude > VarioPacket.MaxAltitude) VarioPacket.MaxAltitude = VarioPacket.Altitude;c48a: 20 91 e3 06 lds r18, 0x06E3c48e: 30 91 e4 06 lds r19, 0x06E4c492: 28 17 cp r18, r24c494: 39 07 cpc r19, r25c496: 24 f4 brge .+8 ; 0xc4a0 <HoTT_Telemety+0xb6>c498: 90 93 e4 06 sts 0x06E4, r25c49c: 80 93 e3 06 sts 0x06E3, r24VarioPacket.WarnBeep = 0;//HoTT_Waring();c4a0: 10 92 de 06 sts 0x06DE, r1HoTT_DataPointer = (unsigned char *) &VarioPacket;c4a4: 8c ed ldi r24, 0xDC ; 220c4a6: 96 e0 ldi r25, 0x06 ; 6c4a8: 90 93 f1 02 sts 0x02F1, r25c4ac: 80 93 f0 02 sts 0x02F0, r24VarioPacket.FreeCharacters[0] = VarioCharacter;c4b0: 80 91 20 01 lds r24, 0x0120c4b4: 80 93 02 07 sts 0x0702, r24if(FC_StatusFlags2 & FC_STATUS2_CAREFREE) VarioPacket.FreeCharacters[1] = 'C'; else VarioPacket.FreeCharacters[1] = ' ';c4b8: 80 91 ca 03 lds r24, 0x03CAc4bc: 80 ff sbrs r24, 0c4be: 04 c0 rjmp .+8 ; 0xc4c8 <HoTT_Telemety+0xde>c4c0: 83 e4 ldi r24, 0x43 ; 67c4c2: 80 93 03 07 sts 0x0703, r24c4c6: 03 c0 rjmp .+6 ; 0xc4ce <HoTT_Telemety+0xe4>c4c8: 80 e2 ldi r24, 0x20 ; 32c4ca: 80 93 03 07 sts 0x0703, r24// VarioPacket.FreeCharacters[2] = ' ';if(NC_ErrorCode)c4ce: e0 91 bb 04 lds r30, 0x04BBc4d2: ee 23 and r30, r30c4d4: 81 f1 breq .+96 ; 0xc536 <HoTT_Telemety+0x14c>{VarioPacket.Text[0] = NC_ErrorCode/10 + '0';c4d6: 8d ec ldi r24, 0xCD ; 205c4d8: e8 9f mul r30, r24c4da: 81 2d mov r24, r1c4dc: 11 24 eor r1, r1c4de: 86 95 lsr r24c4e0: 86 95 lsr r24c4e2: 86 95 lsr r24c4e4: 90 e3 ldi r25, 0x30 ; 48c4e6: 98 0f add r25, r24c4e8: 90 93 ed 06 sts 0x06ED, r25VarioPacket.Text[1] = NC_ErrorCode%10 + '0';c4ec: 88 0f add r24, r24c4ee: 98 2f mov r25, r24c4f0: 99 0f add r25, r25c4f2: 99 0f add r25, r25c4f4: 89 0f add r24, r25c4f6: 2e 2f mov r18, r30c4f8: 28 1b sub r18, r24c4fa: 82 2f mov r24, r18c4fc: 80 5d subi r24, 0xD0 ; 208c4fe: 80 93 ee 06 sts 0x06EE, r24VarioPacket.Text[2] = ':';c502: 8a e3 ldi r24, 0x3A ; 58c504: 80 93 ef 06 sts 0x06EF, r24c508: 41 e1 ldi r20, 0x11 ; 17c50a: e4 9f mul r30, r20c50c: f0 01 movw r30, r0c50e: 11 24 eor r1, r1c510: e4 59 subi r30, 0x94 ; 148c512: f4 4f sbci r31, 0xF4 ; 244c514: a0 ef ldi r26, 0xF0 ; 240c516: b6 e0 ldi r27, 0x06 ; 6c518: 80 e0 ldi r24, 0x00 ; 0c51a: 97 e0 ldi r25, 0x07 ; 7for(i=0; i<16;i++) VarioPacket.Text[i+3] = pgm_read_byte(&NC_ERROR_TEXT[NC_ErrorCode][i]);c51c: 24 91 lpm r18, Zc51e: 2d 93 st X+, r18c520: 31 96 adiw r30, 0x01 ; 1c522: a8 17 cp r26, r24c524: b9 07 cpc r27, r25c526: d1 f7 brne .-12 ; 0xc51c <HoTT_Telemety+0x132>VarioPacket.Text[19] = ' ';c528: 80 e2 ldi r24, 0x20 ; 32c52a: 80 93 00 07 sts 0x0700, r24VarioPacket.Text[20] = ' ';c52e: 80 93 01 07 sts 0x0701, r24{if(FC_StatusFlags3 & FC_STATUS3_BOAT) for(i=0; i<21;i++) VarioPacket.Text[i] = pgm_read_byte(&BOAT_MODE[i]); // no Errorelse for(i=0; i<21;i++) VarioPacket.Text[i] = pgm_read_byte(&MIKROKOPTER[i]); // no Errorif(FC_StatusFlags3 & FC_STATUS3_REDUNDANCE) VarioPacket.Text[0] = 'R';}return(sizeof(VarioPacket));c532: 8c e2 ldi r24, 0x2C ; 44c534: 82 c3 rjmp .+1796 ; 0xcc3a <HoTT_Telemety+0x850>for(i=0; i<16;i++) VarioPacket.Text[i+3] = pgm_read_byte(&NC_ERROR_TEXT[NC_ErrorCode][i]);VarioPacket.Text[19] = ' ';VarioPacket.Text[20] = ' ';}elseif(LowVoltageLandingActive) for(i=0; i<21;i++) VarioPacket.Text[i] = pgm_read_byte(&LANDING[i]); // no Errorc536: 80 91 c1 03 lds r24, 0x03C1c53a: 88 23 and r24, r24c53c: 69 f0 breq .+26 ; 0xc558 <HoTT_Telemety+0x16e>c53e: e2 ef ldi r30, 0xF2 ; 242c540: fd e0 ldi r31, 0x0D ; 13c542: ad ee ldi r26, 0xED ; 237c544: b6 e0 ldi r27, 0x06 ; 6c546: 87 e0 ldi r24, 0x07 ; 7c548: 9e e0 ldi r25, 0x0E ; 14c54a: 24 91 lpm r18, Zc54c: 2d 93 st X+, r18c54e: 31 96 adiw r30, 0x01 ; 1c550: e8 17 cp r30, r24c552: f9 07 cpc r31, r25c554: d1 f7 brne .-12 ; 0xc54a <HoTT_Telemety+0x160>c556: 6a c3 rjmp .+1748 ; 0xcc2c <HoTT_Telemety+0x842>elseif(FC_StatusFlags & FC_STATUS_LOWBAT) for(i=0; i<21;i++) VarioPacket.Text[i] = pgm_read_byte(&UNDERVOLTAGE[i]); // no Errorc558: 80 91 cb 03 lds r24, 0x03CBc55c: 85 ff sbrs r24, 5c55e: 0d c0 rjmp .+26 ; 0xc57a <HoTT_Telemety+0x190>c560: e8 e0 ldi r30, 0x08 ; 8c562: fe e0 ldi r31, 0x0E ; 14c564: ad ee ldi r26, 0xED ; 237c566: b6 e0 ldi r27, 0x06 ; 6c568: 8d e1 ldi r24, 0x1D ; 29c56a: 9e e0 ldi r25, 0x0E ; 14c56c: 24 91 lpm r18, Zc56e: 2d 93 st X+, r18c570: 31 96 adiw r30, 0x01 ; 1c572: e8 17 cp r30, r24c574: f9 07 cpc r31, r25c576: d1 f7 brne .-12 ; 0xc56c <HoTT_Telemety+0x182>c578: 5b c3 rjmp .+1718 ; 0xcc30 <HoTT_Telemety+0x846>elseif(ShowSettingNameTime) // no Errorc57a: 80 91 80 04 lds r24, 0x0480c57e: 88 23 and r24, r24c580: b9 f1 breq .+110 ; 0xc5f0 <HoTT_Telemety+0x206>c582: ef eb ldi r30, 0xBF ; 191c584: fd e0 ldi r31, 0x0D ; 13c586: ad ee ldi r26, 0xED ; 237c588: b6 e0 ldi r27, 0x06 ; 6c58a: 86 ec ldi r24, 0xC6 ; 198c58c: 9d e0 ldi r25, 0x0D ; 13{for(i=0; i<sizeof(SETTING);i++) VarioPacket.Text[i] = pgm_read_byte(&SETTING[i]);c58e: 24 91 lpm r18, Zc590: 2d 93 st X+, r18c592: 31 96 adiw r30, 0x01 ; 1c594: e8 17 cp r30, r24c596: f9 07 cpc r31, r25c598: d1 f7 brne .-12 ; 0xc58e <HoTT_Telemety+0x1a4>VarioPacket.Text[4] = '0' + ActiveParamSet;c59a: 80 91 52 01 lds r24, 0x0152c59e: 80 5d subi r24, 0xD0 ; 208c5a0: 80 93 f1 06 sts 0x06F1, r24c5a4: ea eb ldi r30, 0xBA ; 186c5a6: f5 e0 ldi r31, 0x05 ; 5c5a8: a4 ef ldi r26, 0xF4 ; 244c5aa: b6 e0 ldi r27, 0x06 ; 6c5ac: 86 ec ldi r24, 0xC6 ; 198c5ae: 95 e0 ldi r25, 0x05 ; 5for(i=0; i<sizeof(EE_Parameter.Name);i++) VarioPacket.Text[i+7] = EE_Parameter.Name[i]; // no Errorc5b0: 21 91 ld r18, Z+c5b2: 2d 93 st X+, r18c5b4: e8 17 cp r30, r24c5b6: f9 07 cpc r31, r25c5b8: d9 f7 brne .-10 ; 0xc5b0 <HoTT_Telemety+0x1c6>if(FC_StatusFlags3 & FC_STATUS3_BOAT)c5ba: 80 91 c9 03 lds r24, 0x03C9c5be: 81 ff sbrs r24, 1c5c0: 0e c0 rjmp .+28 ; 0xc5de <HoTT_Telemety+0x1f4>{VarioPacket.Text[17] = 'B';c5c2: 82 e4 ldi r24, 0x42 ; 66c5c4: 80 93 fe 06 sts 0x06FE, r24VarioPacket.Text[18] = 'O';c5c8: 8f e4 ldi r24, 0x4F ; 79c5ca: 80 93 ff 06 sts 0x06FF, r24VarioPacket.Text[19] = 'A';c5ce: 81 e4 ldi r24, 0x41 ; 65c5d0: 80 93 00 07 sts 0x0700, r24VarioPacket.Text[20] = 'T';c5d4: 84 e5 ldi r24, 0x54 ; 84c5d6: 80 93 01 07 sts 0x0701, r24{if(FC_StatusFlags3 & FC_STATUS3_BOAT) for(i=0; i<21;i++) VarioPacket.Text[i] = pgm_read_byte(&BOAT_MODE[i]); // no Errorelse for(i=0; i<21;i++) VarioPacket.Text[i] = pgm_read_byte(&MIKROKOPTER[i]); // no Errorif(FC_StatusFlags3 & FC_STATUS3_REDUNDANCE) VarioPacket.Text[0] = 'R';}return(sizeof(VarioPacket));c5da: 8c e2 ldi r24, 0x2C ; 44c5dc: 2e c3 rjmp .+1628 ; 0xcc3a <HoTT_Telemety+0x850>VarioPacket.Text[19] = 'A';VarioPacket.Text[20] = 'T';}else{VarioPacket.Text[18] = ' ';c5de: 80 e2 ldi r24, 0x20 ; 32c5e0: 80 93 ff 06 sts 0x06FF, r24VarioPacket.Text[19] = ' ';c5e4: 80 93 00 07 sts 0x0700, r24VarioPacket.Text[20] = ' ';c5e8: 80 93 01 07 sts 0x0701, r24{if(FC_StatusFlags3 & FC_STATUS3_BOAT) for(i=0; i<21;i++) VarioPacket.Text[i] = pgm_read_byte(&BOAT_MODE[i]); // no Errorelse for(i=0; i<21;i++) VarioPacket.Text[i] = pgm_read_byte(&MIKROKOPTER[i]); // no Errorif(FC_StatusFlags3 & FC_STATUS3_REDUNDANCE) VarioPacket.Text[0] = 'R';}return(sizeof(VarioPacket));c5ec: 8c e2 ldi r24, 0x2C ; 44c5ee: 25 c3 rjmp .+1610 ; 0xcc3a <HoTT_Telemety+0x850>VarioPacket.Text[19] = ' ';VarioPacket.Text[20] = ' ';}}elseif(NaviData_WaypointNumber)c5f0: 80 91 8c 04 lds r24, 0x048Cc5f4: 88 23 and r24, r24c5f6: 09 f4 brne .+2 ; 0xc5fa <HoTT_Telemety+0x210>c5f8: da c0 rjmp .+436 ; 0xc7ae <HoTT_Telemety+0x3c4>{unsigned int tmp_int;unsigned char tmp;VarioPacket.Text[0] = 'W'; VarioPacket.Text[1] = 'P';c5fa: 97 e5 ldi r25, 0x57 ; 87c5fc: 90 93 ed 06 sts 0x06ED, r25c600: 90 e5 ldi r25, 0x50 ; 80c602: 90 93 ee 06 sts 0x06EE, r25VarioPacket.Text[2] = ' ';c606: 90 e2 ldi r25, 0x20 ; 32c608: 90 93 ef 06 sts 0x06EF, r25VarioPacket.Text[3] = '0'+(NaviData_WaypointIndex) / 10;c60c: 30 91 8d 04 lds r19, 0x048Dc610: 2d ec ldi r18, 0xCD ; 205c612: 32 9f mul r19, r18c614: 41 2d mov r20, r1c616: 11 24 eor r1, r1c618: 46 95 lsr r20c61a: 46 95 lsr r20c61c: 46 95 lsr r20c61e: 50 e3 ldi r21, 0x30 ; 48c620: 54 0f add r21, r20c622: 50 93 f0 06 sts 0x06F0, r21VarioPacket.Text[4] = '0'+(NaviData_WaypointIndex) % 10;c626: 44 0f add r20, r20c628: 54 2f mov r21, r20c62a: 55 0f add r21, r21c62c: 55 0f add r21, r21c62e: 45 0f add r20, r21c630: 34 1b sub r19, r20c632: 30 5d subi r19, 0xD0 ; 208c634: 30 93 f1 06 sts 0x06F1, r19VarioPacket.Text[5] = '/';c638: 3f e2 ldi r19, 0x2F ; 47c63a: 30 93 f2 06 sts 0x06F2, r19VarioPacket.Text[6] = '0'+(NaviData_WaypointNumber) / 10;c63e: 82 9f mul r24, r18c640: 21 2d mov r18, r1c642: 11 24 eor r1, r1c644: 26 95 lsr r18c646: 26 95 lsr r18c648: 26 95 lsr r18c64a: 30 e3 ldi r19, 0x30 ; 48c64c: 32 0f add r19, r18c64e: 30 93 f3 06 sts 0x06F3, r19VarioPacket.Text[7] = '0'+(NaviData_WaypointNumber) % 10;c652: 22 0f add r18, r18c654: 32 2f mov r19, r18c656: 33 0f add r19, r19c658: 33 0f add r19, r19c65a: 23 0f add r18, r19c65c: 82 1b sub r24, r18c65e: 80 5d subi r24, 0xD0 ; 208c660: 80 93 f4 06 sts 0x06F4, r24VarioPacket.Text[8] = ' ';c664: 90 93 f5 06 sts 0x06F5, r25tmp_int = NaviData_TargetDistance;c668: 40 91 85 04 lds r20, 0x0485c66c: 50 91 86 04 lds r21, 0x0486if(tmp_int > 1000) { VarioPacket.Text[9] = '0'+(tmp_int) / 1000; tmp_int %= 1000;}c670: 49 3e cpi r20, 0xE9 ; 233c672: 83 e0 ldi r24, 0x03 ; 3c674: 58 07 cpc r21, r24c676: 08 f1 brcs .+66 ; 0xc6ba <HoTT_Telemety+0x2d0>c678: 9a 01 movw r18, r20c67a: 36 95 lsr r19c67c: 27 95 ror r18c67e: 36 95 lsr r19c680: 27 95 ror r18c682: 36 95 lsr r19c684: 27 95 ror r18c686: a5 ec ldi r26, 0xC5 ; 197c688: b0 e2 ldi r27, 0x20 ; 32c68a: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>c68e: 92 95 swap r25c690: 82 95 swap r24c692: 8f 70 andi r24, 0x0F ; 15c694: 89 27 eor r24, r25c696: 9f 70 andi r25, 0x0F ; 15c698: 89 27 eor r24, r25c69a: 20 e3 ldi r18, 0x30 ; 48c69c: 28 0f add r18, r24c69e: 20 93 f6 06 sts 0x06F6, r18c6a2: 68 ee ldi r22, 0xE8 ; 232c6a4: 73 e0 ldi r23, 0x03 ; 3c6a6: 86 9f mul r24, r22c6a8: 90 01 movw r18, r0c6aa: 87 9f mul r24, r23c6ac: 30 0d add r19, r0c6ae: 96 9f mul r25, r22c6b0: 30 0d add r19, r0c6b2: 11 24 eor r1, r1c6b4: 42 1b sub r20, r18c6b6: 53 0b sbc r21, r19c6b8: 03 c0 rjmp .+6 ; 0xc6c0 <HoTT_Telemety+0x2d6>else VarioPacket.Text[9] = ' ';c6ba: 80 e2 ldi r24, 0x20 ; 32c6bc: 80 93 f6 06 sts 0x06F6, r24if(tmp_int > 100) { VarioPacket.Text[10] = '0'+(tmp_int) / 100; tmp_int %= 100;}c6c0: 45 36 cpi r20, 0x65 ; 101c6c2: 51 05 cpc r21, r1c6c4: c0 f0 brcs .+48 ; 0xc6f6 <HoTT_Telemety+0x30c>c6c6: 9a 01 movw r18, r20c6c8: 36 95 lsr r19c6ca: 27 95 ror r18c6cc: 36 95 lsr r19c6ce: 27 95 ror r18c6d0: ab e7 ldi r26, 0x7B ; 123c6d2: b4 e1 ldi r27, 0x14 ; 20c6d4: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>c6d8: 96 95 lsr r25c6da: 87 95 ror r24c6dc: 20 e3 ldi r18, 0x30 ; 48c6de: 28 0f add r18, r24c6e0: 20 93 f7 06 sts 0x06F7, r18c6e4: 64 e6 ldi r22, 0x64 ; 100c6e6: 68 9f mul r22, r24c6e8: 90 01 movw r18, r0c6ea: 69 9f mul r22, r25c6ec: 30 0d add r19, r0c6ee: 11 24 eor r1, r1c6f0: 42 1b sub r20, r18c6f2: 53 0b sbc r21, r19c6f4: 03 c0 rjmp .+6 ; 0xc6fc <HoTT_Telemety+0x312>else VarioPacket.Text[10] = ' ';c6f6: 80 e2 ldi r24, 0x20 ; 32c6f8: 80 93 f7 06 sts 0x06F7, r24VarioPacket.Text[11] = '0'+(tmp_int) / 10;c6fc: 9a 01 movw r18, r20c6fe: ad ec ldi r26, 0xCD ; 205c700: bc ec ldi r27, 0xCC ; 204c702: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>c706: 96 95 lsr r25c708: 87 95 ror r24c70a: 96 95 lsr r25c70c: 87 95 ror r24c70e: 96 95 lsr r25c710: 87 95 ror r24c712: 20 e3 ldi r18, 0x30 ; 48c714: 28 0f add r18, r24c716: 20 93 f8 06 sts 0x06F8, r18VarioPacket.Text[12] = '0'+(tmp_int) % 10;c71a: 9c 01 movw r18, r24c71c: 22 0f add r18, r18c71e: 33 1f adc r19, r19c720: 88 0f add r24, r24c722: 99 1f adc r25, r25c724: 88 0f add r24, r24c726: 99 1f adc r25, r25c728: 88 0f add r24, r24c72a: 99 1f adc r25, r25c72c: 82 0f add r24, r18c72e: 93 1f adc r25, r19c730: 48 1b sub r20, r24c732: 59 0b sbc r21, r25c734: 40 5d subi r20, 0xD0 ; 208c736: 40 93 f9 06 sts 0x06F9, r20VarioPacket.Text[13] = 'm';c73a: 8d e6 ldi r24, 0x6D ; 109c73c: 80 93 fa 06 sts 0x06FA, r24VarioPacket.Text[14] = ' ';c740: 80 e2 ldi r24, 0x20 ; 32c742: 80 93 fb 06 sts 0x06FB, r24tmp = NaviData_TargetHoldTime;c746: 80 91 8b 04 lds r24, 0x048Bif(tmp > 100) { VarioPacket.Text[15] = '0'+(tmp) / 100; tmp %= 100;} else VarioPacket.Text[15] = ' ';c74a: 85 36 cpi r24, 0x65 ; 101c74c: 78 f0 brcs .+30 ; 0xc76c <HoTT_Telemety+0x382>c74e: 99 e2 ldi r25, 0x29 ; 41c750: 89 9f mul r24, r25c752: 91 2d mov r25, r1c754: 11 24 eor r1, r1c756: 92 95 swap r25c758: 9f 70 andi r25, 0x0F ; 15c75a: 20 e3 ldi r18, 0x30 ; 48c75c: 29 0f add r18, r25c75e: 20 93 fc 06 sts 0x06FC, r18c762: 24 e6 ldi r18, 0x64 ; 100c764: 92 9f mul r25, r18c766: 80 19 sub r24, r0c768: 11 24 eor r1, r1c76a: 03 c0 rjmp .+6 ; 0xc772 <HoTT_Telemety+0x388>c76c: 90 e2 ldi r25, 0x20 ; 32c76e: 90 93 fc 06 sts 0x06FC, r25VarioPacket.Text[16] = '0'+(tmp) / 10;c772: 9d ec ldi r25, 0xCD ; 205c774: 89 9f mul r24, r25c776: 91 2d mov r25, r1c778: 11 24 eor r1, r1c77a: 96 95 lsr r25c77c: 96 95 lsr r25c77e: 96 95 lsr r25c780: 20 e3 ldi r18, 0x30 ; 48c782: 29 0f add r18, r25c784: 20 93 fd 06 sts 0x06FD, r18VarioPacket.Text[17] = '0'+(tmp) % 10;c788: 99 0f add r25, r25c78a: 29 2f mov r18, r25c78c: 22 0f add r18, r18c78e: 22 0f add r18, r18c790: 92 0f add r25, r18c792: 89 1b sub r24, r25c794: 80 5d subi r24, 0xD0 ; 208c796: 80 93 fe 06 sts 0x06FE, r24VarioPacket.Text[18] = 's';c79a: 83 e7 ldi r24, 0x73 ; 115c79c: 80 93 ff 06 sts 0x06FF, r24VarioPacket.Text[19] = ' ';c7a0: 80 e2 ldi r24, 0x20 ; 32c7a2: 80 93 00 07 sts 0x0700, r24VarioPacket.Text[20] = ' ';c7a6: 80 93 01 07 sts 0x0701, r24{if(FC_StatusFlags3 & FC_STATUS3_BOAT) for(i=0; i<21;i++) VarioPacket.Text[i] = pgm_read_byte(&BOAT_MODE[i]); // no Errorelse for(i=0; i<21;i++) VarioPacket.Text[i] = pgm_read_byte(&MIKROKOPTER[i]); // no Errorif(FC_StatusFlags3 & FC_STATUS3_REDUNDANCE) VarioPacket.Text[0] = 'R';}return(sizeof(VarioPacket));c7aa: 8c e2 ldi r24, 0x2C ; 44c7ac: 46 c2 rjmp .+1164 ; 0xcc3a <HoTT_Telemety+0x850>VarioPacket.Text[18] = 's';VarioPacket.Text[19] = ' ';VarioPacket.Text[20] = ' ';}elseif(NC_To_FC_Flags & NC_TO_FC_SIMULATION_ACTIVE)c7ae: 80 91 b7 04 lds r24, 0x04B7c7b2: 84 ff sbrs r24, 4c7b4: 0d c0 rjmp .+26 ; 0xc7d0 <HoTT_Telemety+0x3e6>c7b6: ec ed ldi r30, 0xDC ; 220c7b8: fd e0 ldi r31, 0x0D ; 13c7ba: ad ee ldi r26, 0xED ; 237c7bc: b6 e0 ldi r27, 0x06 ; 6c7be: 81 ef ldi r24, 0xF1 ; 241c7c0: 9d e0 ldi r25, 0x0D ; 13{for(i=0; i<21;i++) VarioPacket.Text[i] = pgm_read_byte(&SIMULATION[i]);c7c2: 24 91 lpm r18, Zc7c4: 2d 93 st X+, r18c7c6: 31 96 adiw r30, 0x01 ; 1c7c8: e8 17 cp r30, r24c7ca: f9 07 cpc r31, r25c7cc: d1 f7 brne .-12 ; 0xc7c2 <HoTT_Telemety+0x3d8>c7ce: 32 c2 rjmp .+1124 ; 0xcc34 <HoTT_Telemety+0x84a>}elseif(!CalibrationDone)c7d0: 80 91 ef 03 lds r24, 0x03EFc7d4: 81 11 cpse r24, r1c7d6: 1d c0 rjmp .+58 ; 0xc812 <HoTT_Telemety+0x428>c7d8: e0 e2 ldi r30, 0x20 ; 32c7da: fe e0 ldi r31, 0x0E ; 14c7dc: ad ee ldi r26, 0xED ; 237c7de: b6 e0 ldi r27, 0x06 ; 6c7e0: 81 e3 ldi r24, 0x31 ; 49c7e2: 9e e0 ldi r25, 0x0E ; 14{for(i=0; i<17;i++) VarioPacket.Text[i] = pgm_read_byte(&MIKROKOPTER[i+2]); // no Error and not calibratedc7e4: 24 91 lpm r18, Zc7e6: 2d 93 st X+, r18c7e8: 31 96 adiw r30, 0x01 ; 1c7ea: e8 17 cp r30, r24c7ec: f9 07 cpc r31, r25c7ee: d1 f7 brne .-12 ; 0xc7e4 <HoTT_Telemety+0x3fa>VarioPacket.Text[16] = '0'+VERSION_MAJOR;c7f0: 82 e3 ldi r24, 0x32 ; 50c7f2: 80 93 fd 06 sts 0x06FD, r24VarioPacket.Text[17] = '.';c7f6: 8e e2 ldi r24, 0x2E ; 46c7f8: 80 93 fe 06 sts 0x06FE, r24VarioPacket.Text[18] = '0'+VERSION_MINOR/10;c7fc: 80 e3 ldi r24, 0x30 ; 48c7fe: 80 93 ff 06 sts 0x06FF, r24VarioPacket.Text[19] = '0'+VERSION_MINOR%10;c802: 88 e3 ldi r24, 0x38 ; 56c804: 80 93 00 07 sts 0x0700, r24VarioPacket.Text[20] = 'a'+VERSION_PATCH;c808: 81 e6 ldi r24, 0x61 ; 97c80a: 80 93 01 07 sts 0x0701, r24{if(FC_StatusFlags3 & FC_STATUS3_BOAT) for(i=0; i<21;i++) VarioPacket.Text[i] = pgm_read_byte(&BOAT_MODE[i]); // no Errorelse for(i=0; i<21;i++) VarioPacket.Text[i] = pgm_read_byte(&MIKROKOPTER[i]); // no Errorif(FC_StatusFlags3 & FC_STATUS3_REDUNDANCE) VarioPacket.Text[0] = 'R';}return(sizeof(VarioPacket));c80e: 8c e2 ldi r24, 0x2C ; 44c810: 14 c2 rjmp .+1064 ; 0xcc3a <HoTT_Telemety+0x850>VarioPacket.Text[19] = '0'+VERSION_MINOR%10;VarioPacket.Text[20] = 'a'+VERSION_PATCH;}else{if(FC_StatusFlags3 & FC_STATUS3_BOAT) for(i=0; i<21;i++) VarioPacket.Text[i] = pgm_read_byte(&BOAT_MODE[i]); // no Errorc812: 80 91 c9 03 lds r24, 0x03C9c816: 81 ff sbrs r24, 1c818: 0d c0 rjmp .+26 ; 0xc834 <HoTT_Telemety+0x44a>c81a: e6 ec ldi r30, 0xC6 ; 198c81c: fd e0 ldi r31, 0x0D ; 13c81e: ad ee ldi r26, 0xED ; 237c820: b6 e0 ldi r27, 0x06 ; 6c822: 8b ed ldi r24, 0xDB ; 219c824: 9d e0 ldi r25, 0x0D ; 13c826: 24 91 lpm r18, Zc828: 2d 93 st X+, r18c82a: 31 96 adiw r30, 0x01 ; 1c82c: e8 17 cp r30, r24c82e: f9 07 cpc r31, r25c830: d1 f7 brne .-12 ; 0xc826 <HoTT_Telemety+0x43c>c832: 0c c0 rjmp .+24 ; 0xc84c <HoTT_Telemety+0x462>c834: ee e1 ldi r30, 0x1E ; 30c836: fe e0 ldi r31, 0x0E ; 14c838: ad ee ldi r26, 0xED ; 237c83a: b6 e0 ldi r27, 0x06 ; 6c83c: 83 e3 ldi r24, 0x33 ; 51c83e: 9e e0 ldi r25, 0x0E ; 14else for(i=0; i<21;i++) VarioPacket.Text[i] = pgm_read_byte(&MIKROKOPTER[i]); // no Errorc840: 24 91 lpm r18, Zc842: 2d 93 st X+, r18c844: 31 96 adiw r30, 0x01 ; 1c846: e8 17 cp r30, r24c848: f9 07 cpc r31, r25c84a: d1 f7 brne .-12 ; 0xc840 <HoTT_Telemety+0x456>if(FC_StatusFlags3 & FC_STATUS3_REDUNDANCE) VarioPacket.Text[0] = 'R';c84c: 80 91 c9 03 lds r24, 0x03C9c850: 80 ff sbrs r24, 0c852: f2 c1 rjmp .+996 ; 0xcc38 <HoTT_Telemety+0x84e>c854: 82 e5 ldi r24, 0x52 ; 82c856: 80 93 ed 06 sts 0x06ED, r24}return(sizeof(VarioPacket));c85a: 8c e2 ldi r24, 0x2C ; 44c85c: ee c1 rjmp .+988 ; 0xcc3a <HoTT_Telemety+0x850>break;case HOTT_GPS_PACKET_ID:GPSPacket.Altitude = HoehenWert/100 + 500;c85e: 60 91 fe 03 lds r22, 0x03FEc862: 70 91 ff 03 lds r23, 0x03FFc866: 80 91 00 04 lds r24, 0x0400c86a: 90 91 01 04 lds r25, 0x0401c86e: 24 e6 ldi r18, 0x64 ; 100c870: 30 e0 ldi r19, 0x00 ; 0c872: 40 e0 ldi r20, 0x00 ; 0c874: 50 e0 ldi r21, 0x00 ; 0c876: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>c87a: 2c 50 subi r18, 0x0C ; 12c87c: 3e 4f sbci r19, 0xFE ; 254c87e: 30 93 ca 07 sts 0x07CA, r19c882: 20 93 c9 07 sts 0x07C9, r18// GPSPacket.Distance = GPSInfo.HomeDistance/10; // macht die NC// GPSPacket.Heading = GPSInfo.HomeBearing/2; // macht die NC// GPSPacket.Speed = (GPSInfo.Speed * 36) / 10; // macht die NC// GPSPacket.WarnBeep = HoTT_Waring(); //(wird jetzt weiter oben gemacht)if(!GPSPacket.WarnBeep) GPSPacket.m_sec = BuildHoTT_Vario(); else GPSPacket.m_sec = VARIO_ZERO;c886: 80 91 b6 07 lds r24, 0x07B6c88a: 81 11 cpse r24, r1c88c: 06 c0 rjmp .+12 ; 0xc89a <HoTT_Telemety+0x4b0>c88e: 40 dd rcall .-1408 ; 0xc310 <BuildHoTT_Vario>c890: 90 93 cc 07 sts 0x07CC, r25c894: 80 93 cb 07 sts 0x07CB, r24c898: 06 c0 rjmp .+12 ; 0xc8a6 <HoTT_Telemety+0x4bc>c89a: 80 e3 ldi r24, 0x30 ; 48c89c: 95 e7 ldi r25, 0x75 ; 117c89e: 90 93 cc 07 sts 0x07CC, r25c8a2: 80 93 cb 07 sts 0x07CB, r24GPSPacket.m_3sec = 120;c8a6: 88 e7 ldi r24, 0x78 ; 120c8a8: 80 93 cd 07 sts 0x07CD, r24GPSPacket.NumOfSats = GPSInfo.NumOfSats;c8ac: 80 91 d8 08 lds r24, 0x08D8c8b0: 80 93 ce 07 sts 0x07CE, r24if(GPSInfo.Flags & FLAG_DIFFSOLN) GPSPacket.SatFix = 'D';c8b4: 80 91 d7 08 lds r24, 0x08D7c8b8: 81 ff sbrs r24, 1c8ba: 04 c0 rjmp .+8 ; 0xc8c4 <HoTT_Telemety+0x4da>c8bc: 84 e4 ldi r24, 0x44 ; 68c8be: 80 93 cf 07 sts 0x07CF, r24c8c2: 0b c0 rjmp .+22 ; 0xc8da <HoTT_Telemety+0x4f0>elseif(GPSInfo.SatFix == SATFIX_3D) GPSPacket.SatFix = ' ';c8c4: 80 91 d9 08 lds r24, 0x08D9c8c8: 83 30 cpi r24, 0x03 ; 3c8ca: 21 f4 brne .+8 ; 0xc8d4 <HoTT_Telemety+0x4ea>c8cc: 80 e2 ldi r24, 0x20 ; 32c8ce: 80 93 cf 07 sts 0x07CF, r24c8d2: 03 c0 rjmp .+6 ; 0xc8da <HoTT_Telemety+0x4f0>else GPSPacket.SatFix = '!';c8d4: 81 e2 ldi r24, 0x21 ; 33c8d6: 80 93 cf 07 sts 0x07CF, r24HoTT_DataPointer = (unsigned char *) &GPSPacket;c8da: 84 eb ldi r24, 0xB4 ; 180c8dc: 97 e0 ldi r25, 0x07 ; 7c8de: 90 93 f1 02 sts 0x02F1, r25c8e2: 80 93 f0 02 sts 0x02F0, r24GPSPacket.FreeCharacters[0] = NC_GPS_ModeCharacter;c8e6: 80 91 96 02 lds r24, 0x0296c8ea: 80 93 db 07 sts 0x07DB, r24GPSPacket.FreeCharacters[2] = GPSPacket.SatFix;c8ee: 80 91 cf 07 lds r24, 0x07CFc8f2: 80 93 dd 07 sts 0x07DD, r24GPSPacket.HomeDirection = GPSInfo.HomeBearing / 2;//230;c8f6: 80 91 dd 08 lds r24, 0x08DDc8fa: 90 91 de 08 lds r25, 0x08DEc8fe: 99 23 and r25, r25c900: 0c f4 brge .+2 ; 0xc904 <HoTT_Telemety+0x51a>c902: 01 96 adiw r24, 0x01 ; 1c904: 95 95 asr r25c906: 87 95 ror r24c908: 80 93 d0 07 sts 0x07D0, r24return(sizeof(GPSPacket));c90c: 8c e2 ldi r24, 0x2C ; 44c90e: 95 c1 rjmp .+810 ; 0xcc3a <HoTT_Telemety+0x850>break;case HOTT_ELECTRIC_AIR_PACKET_ID:GetHottestBl();c910: f0 db rcall .-2080 ; 0xc0f2 <GetHottestBl>ElectricAirPacket.Altitude = HoehenWert/100 + 500;c912: 60 91 fe 03 lds r22, 0x03FEc916: 70 91 ff 03 lds r23, 0x03FFc91a: 80 91 00 04 lds r24, 0x0400c91e: 90 91 01 04 lds r25, 0x0401c922: 24 e6 ldi r18, 0x64 ; 100c924: 30 e0 ldi r19, 0x00 ; 0c926: 40 e0 ldi r20, 0x00 ; 0c928: 50 e0 ldi r21, 0x00 ; 0c92a: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>c92e: 2c 50 subi r18, 0x0C ; 12c930: 3e 4f sbci r19, 0xFE ; 254c932: 30 93 95 06 sts 0x0695, r19c936: 20 93 94 06 sts 0x0694, r18ElectricAirPacket.Battery1 = UBat;c93a: 80 91 1a 01 lds r24, 0x011Ac93e: 90 91 1b 01 lds r25, 0x011Bc942: 90 93 8f 06 sts 0x068F, r25c946: 80 93 8e 06 sts 0x068E, r24ElectricAirPacket.Battery2 = UBat;c94a: 80 91 1a 01 lds r24, 0x011Ac94e: 90 91 1b 01 lds r25, 0x011Bc952: 90 93 91 06 sts 0x0691, r25c956: 80 93 90 06 sts 0x0690, r24ElectricAirPacket.VoltageCell1 = CompassCorrected / 2;c95a: 80 91 65 06 lds r24, 0x0665c95e: 90 91 66 06 lds r25, 0x0666c962: 99 23 and r25, r25c964: 0c f4 brge .+2 ; 0xc968 <HoTT_Telemety+0x57e>c966: 01 96 adiw r24, 0x01 ; 1c968: 95 95 asr r25c96a: 87 95 ror r24c96c: 80 93 80 06 sts 0x0680, r24ElectricAirPacket.VoltageCell8 = ElectricAirPacket.VoltageCell1;c970: 80 93 87 06 sts 0x0687, r24ElectricAirPacket.VoltageCell6 = GPSInfo.HomeBearing / 2;c974: 80 91 dd 08 lds r24, 0x08DDc978: 90 91 de 08 lds r25, 0x08DEc97c: 99 23 and r25, r25c97e: 0c f4 brge .+2 ; 0xc982 <HoTT_Telemety+0x598>c980: 01 96 adiw r24, 0x01 ; 1c982: ac 01 movw r20, r24c984: 55 95 asr r21c986: 47 95 ror r20c988: 40 93 85 06 sts 0x0685, r20ElectricAirPacket.VoltageCell7 = GPSInfo.HomeDistance/20;c98c: 20 91 db 08 lds r18, 0x08DBc990: 30 91 dc 08 lds r19, 0x08DCc994: ad ec ldi r26, 0xCD ; 205c996: bc ec ldi r27, 0xCC ; 204c998: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>c99c: 92 95 swap r25c99e: 82 95 swap r24c9a0: 8f 70 andi r24, 0x0F ; 15c9a2: 89 27 eor r24, r25c9a4: 9f 70 andi r25, 0x0F ; 15c9a6: 89 27 eor r24, r25c9a8: 80 93 86 06 sts 0x0686, r24ElectricAirPacket.VoltageCell13 = ElectricAirPacket.VoltageCell6;c9ac: 40 93 8c 06 sts 0x068C, r20ElectricAirPacket.VoltageCell14 = ElectricAirPacket.VoltageCell7;c9b0: 80 93 8d 06 sts 0x068D, r24if(!GPSPacket.WarnBeep) ElectricAirPacket.m_sec = BuildHoTT_Vario(); else ElectricAirPacket.m_sec = VARIO_ZERO;c9b4: 80 91 b6 07 lds r24, 0x07B6c9b8: 81 11 cpse r24, r1c9ba: 06 c0 rjmp .+12 ; 0xc9c8 <HoTT_Telemety+0x5de>c9bc: a9 dc rcall .-1710 ; 0xc310 <BuildHoTT_Vario>c9be: 90 93 9d 06 sts 0x069D, r25c9c2: 80 93 9c 06 sts 0x069C, r24c9c6: 06 c0 rjmp .+12 ; 0xc9d4 <HoTT_Telemety+0x5ea>c9c8: 80 e3 ldi r24, 0x30 ; 48c9ca: 95 e7 ldi r25, 0x75 ; 117c9cc: 90 93 9d 06 sts 0x069D, r25c9d0: 80 93 9c 06 sts 0x069C, r24ElectricAirPacket.m_3sec = 120;c9d4: 88 e7 ldi r24, 0x78 ; 120c9d6: 80 93 9e 06 sts 0x069E, r24ElectricAirPacket.InputVoltage = UBat;c9da: 80 91 1a 01 lds r24, 0x011Ac9de: 90 91 1b 01 lds r25, 0x011Bc9e2: 90 93 99 06 sts 0x0699, r25c9e6: 80 93 98 06 sts 0x0698, r24ElectricAirPacket.Temperature1 = MinBlTemperture + 20;c9ea: 80 91 83 04 lds r24, 0x0483c9ee: 8c 5e subi r24, 0xEC ; 236c9f0: 80 93 92 06 sts 0x0692, r24ElectricAirPacket.Temperature2 = MaxBlTemperture + 20;c9f4: 80 91 84 04 lds r24, 0x0484c9f8: 8c 5e subi r24, 0xEC ; 236c9fa: 80 93 93 06 sts 0x0693, r24ElectricAirPacket.Capacity = Capacity.UsedCapacity/10;c9fe: 20 91 19 05 lds r18, 0x0519ca02: 30 91 1a 05 lds r19, 0x051Aca06: ad ec ldi r26, 0xCD ; 205ca08: bc ec ldi r27, 0xCC ; 204ca0a: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>ca0e: 96 95 lsr r25ca10: 87 95 ror r24ca12: 96 95 lsr r25ca14: 87 95 ror r24ca16: 96 95 lsr r25ca18: 87 95 ror r24ca1a: 90 93 9b 06 sts 0x069B, r25ca1e: 80 93 9a 06 sts 0x069A, r24// ElectricAirPacket.WarnBeep = 0;//HoTT_Waring();ElectricAirPacket.WarnBeep = GPSPacket.WarnBeep;ca22: 80 91 b6 07 lds r24, 0x07B6ca26: 80 93 7c 06 sts 0x067C, r24ElectricAirPacket.Current = Capacity.ActualCurrent;ca2a: 80 91 15 05 lds r24, 0x0515ca2e: 90 91 16 05 lds r25, 0x0516ca32: 90 93 97 06 sts 0x0697, r25ca36: 80 93 96 06 sts 0x0696, r24HoTT_DataPointer = (unsigned char *) &ElectricAirPacket;ca3a: 8a e7 ldi r24, 0x7A ; 122ca3c: 96 e0 ldi r25, 0x06 ; 6ca3e: 90 93 f1 02 sts 0x02F1, r25ca42: 80 93 f0 02 sts 0x02F0, r24ElectricAirPacket.FlightTimeMinutes = FlugSekunden / 60;ca46: 40 91 5e 04 lds r20, 0x045Eca4a: 50 91 5f 04 lds r21, 0x045Fca4e: 9a 01 movw r18, r20ca50: a9 e8 ldi r26, 0x89 ; 137ca52: b8 e8 ldi r27, 0x88 ; 136ca54: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>ca58: 96 95 lsr r25ca5a: 87 95 ror r24ca5c: 92 95 swap r25ca5e: 82 95 swap r24ca60: 8f 70 andi r24, 0x0F ; 15ca62: 89 27 eor r24, r25ca64: 9f 70 andi r25, 0x0F ; 15ca66: 89 27 eor r24, r25ca68: 80 93 a1 06 sts 0x06A1, r24ElectricAirPacket.FlightTimeSeconds = FlugSekunden % 60;ca6c: 6c e3 ldi r22, 0x3C ; 60ca6e: 68 9f mul r22, r24ca70: 90 01 movw r18, r0ca72: 69 9f mul r22, r25ca74: 30 0d add r19, r0ca76: 11 24 eor r1, r1ca78: 42 1b sub r20, r18ca7a: 53 0b sbc r21, r19ca7c: 40 93 a2 06 sts 0x06A2, r20return(sizeof(ElectricAirPacket));ca80: 8c e2 ldi r24, 0x2C ; 44ca82: db c0 rjmp .+438 ; 0xcc3a <HoTT_Telemety+0x850>break;case HOTT_GENERAL_PACKET_ID:GetHottestBl();ca84: 36 db rcall .-2452 ; 0xc0f2 <GetHottestBl>HoTTGeneral.Rpm = GPSInfo.HomeDistance/100;ca86: 20 91 db 08 lds r18, 0x08DBca8a: 30 91 dc 08 lds r19, 0x08DCca8e: 36 95 lsr r19ca90: 27 95 ror r18ca92: 36 95 lsr r19ca94: 27 95 ror r18ca96: ab e7 ldi r26, 0x7B ; 123ca98: b4 e1 ldi r27, 0x14 ; 20ca9a: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>ca9e: 96 95 lsr r25caa0: 87 95 ror r24caa2: 90 93 bc 06 sts 0x06BC, r25caa6: 80 93 bb 06 sts 0x06BB, r24HoTTGeneral.VoltageCell1 = CompassCorrected / 2;caaa: 80 91 65 06 lds r24, 0x0665caae: 90 91 66 06 lds r25, 0x0666cab2: 99 23 and r25, r25cab4: 0c f4 brge .+2 ; 0xcab8 <HoTT_Telemety+0x6ce>cab6: 01 96 adiw r24, 0x01 ; 1cab8: 95 95 asr r25caba: 87 95 ror r24cabc: 80 93 ac 06 sts 0x06AC, r24HoTTGeneral.VoltageCell2 = KompassValue / 2;cac0: 80 91 4e 01 lds r24, 0x014Ecac4: 90 91 4f 01 lds r25, 0x014Fcac8: 99 23 and r25, r25caca: 0c f4 brge .+2 ; 0xcace <HoTT_Telemety+0x6e4>cacc: 01 96 adiw r24, 0x01 ; 1cace: 95 95 asr r25cad0: 87 95 ror r24cad2: 80 93 ad 06 sts 0x06AD, r24//HoTTGeneral.VoltageCell3 = Magnetstaerke -> macht NC//HoTTGeneral.VoltageCell4 = Inclinition -> macht NCHoTTGeneral.VoltageCell5 = DebugOut.Analog[28]; // I2C ErrorCountercad6: 80 91 80 0c lds r24, 0x0C80cada: 80 93 b0 06 sts 0x06B0, r24HoTTGeneral.VoltageCell6 = GPSInfo.HomeBearing / 2;cade: 80 91 dd 08 lds r24, 0x08DDcae2: 90 91 de 08 lds r25, 0x08DEcae6: 99 23 and r25, r25cae8: 0c f4 brge .+2 ; 0xcaec <HoTT_Telemety+0x702>caea: 01 96 adiw r24, 0x01 ; 1caec: 95 95 asr r25caee: 87 95 ror r24caf0: 80 93 b1 06 sts 0x06B1, r24if(UBat > BattLowVoltageWarning + 2) HoTTGeneral.FuelPercent = (UBat - (BattLowVoltageWarning + 2)) * 3;caf4: 80 91 53 01 lds r24, 0x0153caf8: 90 e0 ldi r25, 0x00 ; 0cafa: 20 91 1a 01 lds r18, 0x011Acafe: 30 91 1b 01 lds r19, 0x011Bcb02: ac 01 movw r20, r24cb04: 4e 5f subi r20, 0xFE ; 254cb06: 5f 4f sbci r21, 0xFF ; 255cb08: 42 17 cp r20, r18cb0a: 53 07 cpc r21, r19cb0c: 8c f4 brge .+34 ; 0xcb30 <HoTT_Telemety+0x746>cb0e: 20 91 1a 01 lds r18, 0x011Acb12: 30 91 1b 01 lds r19, 0x011Bcb16: a9 01 movw r20, r18cb18: 48 1b sub r20, r24cb1a: 59 0b sbc r21, r25cb1c: ca 01 movw r24, r20cb1e: 02 97 sbiw r24, 0x02 ; 2cb20: 98 2f mov r25, r24cb22: 99 0f add r25, r25cb24: 89 0f add r24, r25cb26: 80 93 b8 06 sts 0x06B8, r24else HoTTGeneral.FuelPercent = 0;if(HoTTGeneral.FuelPercent > 100) HoTTGeneral.FuelPercent = 100;cb2a: 85 36 cpi r24, 0x65 ; 101cb2c: 20 f4 brcc .+8 ; 0xcb36 <HoTT_Telemety+0x74c>cb2e: 06 c0 rjmp .+12 ; 0xcb3c <HoTT_Telemety+0x752>//HoTTGeneral.VoltageCell3 = Magnetstaerke -> macht NC//HoTTGeneral.VoltageCell4 = Inclinition -> macht NCHoTTGeneral.VoltageCell5 = DebugOut.Analog[28]; // I2C ErrorCounterHoTTGeneral.VoltageCell6 = GPSInfo.HomeBearing / 2;if(UBat > BattLowVoltageWarning + 2) HoTTGeneral.FuelPercent = (UBat - (BattLowVoltageWarning + 2)) * 3;else HoTTGeneral.FuelPercent = 0;cb30: 10 92 b8 06 sts 0x06B8, r1cb34: 03 c0 rjmp .+6 ; 0xcb3c <HoTT_Telemety+0x752>if(HoTTGeneral.FuelPercent > 100) HoTTGeneral.FuelPercent = 100;cb36: 84 e6 ldi r24, 0x64 ; 100cb38: 80 93 b8 06 sts 0x06B8, r24HoTTGeneral.FuelCapacity = NC_ErrorCode;//HoehenWert/100; // Oelpegelcb3c: 80 91 bb 04 lds r24, 0x04BBcb40: 90 e0 ldi r25, 0x00 ; 0cb42: 90 93 ba 06 sts 0x06BA, r25cb46: 80 93 b9 06 sts 0x06B9, r24// if(HoTTGeneral.FuelCapacity < 0) HoTTGeneral.FuelCapacity = 0;HoTTGeneral.Altitude = HoehenWert/100 + 500;cb4a: 60 91 fe 03 lds r22, 0x03FEcb4e: 70 91 ff 03 lds r23, 0x03FFcb52: 80 91 00 04 lds r24, 0x0400cb56: 90 91 01 04 lds r25, 0x0401cb5a: 24 e6 ldi r18, 0x64 ; 100cb5c: 30 e0 ldi r19, 0x00 ; 0cb5e: 40 e0 ldi r20, 0x00 ; 0cb60: 50 e0 ldi r21, 0x00 ; 0cb62: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>cb66: 2c 50 subi r18, 0x0C ; 12cb68: 3e 4f sbci r19, 0xFE ; 254cb6a: 30 93 be 06 sts 0x06BE, r19cb6e: 20 93 bd 06 sts 0x06BD, r18HoTTGeneral.Battery1 = UBat;cb72: 80 91 1a 01 lds r24, 0x011Acb76: 90 91 1b 01 lds r25, 0x011Bcb7a: 90 93 b3 06 sts 0x06B3, r25cb7e: 80 93 b2 06 sts 0x06B2, r24HoTTGeneral.Battery2 = UBat;cb82: 80 91 1a 01 lds r24, 0x011Acb86: 90 91 1b 01 lds r25, 0x011Bcb8a: 90 93 b5 06 sts 0x06B5, r25cb8e: 80 93 b4 06 sts 0x06B4, r24if(!GPSPacket.WarnBeep) HoTTGeneral.m_sec = BuildHoTT_Vario(); else HoTTGeneral.m_sec = VARIO_ZERO;cb92: 80 91 b6 07 lds r24, 0x07B6cb96: 81 11 cpse r24, r1cb98: 06 c0 rjmp .+12 ; 0xcba6 <HoTT_Telemety+0x7bc>cb9a: ba db rcall .-2188 ; 0xc310 <BuildHoTT_Vario>cb9c: 90 93 c0 06 sts 0x06C0, r25cba0: 80 93 bf 06 sts 0x06BF, r24cba4: 06 c0 rjmp .+12 ; 0xcbb2 <HoTT_Telemety+0x7c8>cba6: 80 e3 ldi r24, 0x30 ; 48cba8: 95 e7 ldi r25, 0x75 ; 117cbaa: 90 93 c0 06 sts 0x06C0, r25cbae: 80 93 bf 06 sts 0x06BF, r24HoTTGeneral.m_3sec = 120 + GPSPacket.WarnBeep;cbb2: 80 91 b6 07 lds r24, 0x07B6cbb6: 88 58 subi r24, 0x88 ; 136cbb8: 80 93 c1 06 sts 0x06C1, r24HoTTGeneral.InputVoltage = UBat;cbbc: 80 91 1a 01 lds r24, 0x011Acbc0: 90 91 1b 01 lds r25, 0x011Bcbc4: 90 93 c5 06 sts 0x06C5, r25cbc8: 80 93 c4 06 sts 0x06C4, r24HoTTGeneral.Temperature1 = MinBlTemperture + 20;cbcc: 80 91 83 04 lds r24, 0x0483cbd0: 8c 5e subi r24, 0xEC ; 236cbd2: 80 93 b6 06 sts 0x06B6, r24HoTTGeneral.Temperature2 = MaxBlTemperture + 20;cbd6: 80 91 84 04 lds r24, 0x0484cbda: 8c 5e subi r24, 0xEC ; 236cbdc: 80 93 b7 06 sts 0x06B7, r24HoTTGeneral.Capacity = Capacity.UsedCapacity/10;cbe0: 20 91 19 05 lds r18, 0x0519cbe4: 30 91 1a 05 lds r19, 0x051Acbe8: ad ec ldi r26, 0xCD ; 205cbea: bc ec ldi r27, 0xCC ; 204cbec: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>cbf0: 96 95 lsr r25cbf2: 87 95 ror r24cbf4: 96 95 lsr r25cbf6: 87 95 ror r24cbf8: 96 95 lsr r25cbfa: 87 95 ror r24cbfc: 90 93 c7 06 sts 0x06C7, r25cc00: 80 93 c6 06 sts 0x06C6, r24HoTTGeneral.WarnBeep = 0;//HoTT_Waring();cc04: 10 92 a8 06 sts 0x06A8, r1HoTTGeneral.Current = Capacity.ActualCurrent;cc08: 80 91 15 05 lds r24, 0x0515cc0c: 90 91 16 05 lds r25, 0x0516cc10: 90 93 c3 06 sts 0x06C3, r25cc14: 80 93 c2 06 sts 0x06C2, r24//HoTTGeneral.ErrorNumber = HoTTErrorCode();HoTT_DataPointer = (unsigned char *) &HoTTGeneral;cc18: 86 ea ldi r24, 0xA6 ; 166cc1a: 96 e0 ldi r25, 0x06 ; 6cc1c: 90 93 f1 02 sts 0x02F1, r25cc20: 80 93 f0 02 sts 0x02F0, r24return(sizeof(HoTTGeneral));cc24: 8c e2 ldi r24, 0x2C ; 44cc26: 09 c0 rjmp .+18 ; 0xcc3a <HoTT_Telemety+0x850>break;default: return(0);cc28: 80 e0 ldi r24, 0x00 ; 0cc2a: 07 c0 rjmp .+14 ; 0xcc3a <HoTT_Telemety+0x850>{if(FC_StatusFlags3 & FC_STATUS3_BOAT) for(i=0; i<21;i++) VarioPacket.Text[i] = pgm_read_byte(&BOAT_MODE[i]); // no Errorelse for(i=0; i<21;i++) VarioPacket.Text[i] = pgm_read_byte(&MIKROKOPTER[i]); // no Errorif(FC_StatusFlags3 & FC_STATUS3_REDUNDANCE) VarioPacket.Text[0] = 'R';}return(sizeof(VarioPacket));cc2c: 8c e2 ldi r24, 0x2C ; 44cc2e: 05 c0 rjmp .+10 ; 0xcc3a <HoTT_Telemety+0x850>cc30: 8c e2 ldi r24, 0x2C ; 44cc32: 03 c0 rjmp .+6 ; 0xcc3a <HoTT_Telemety+0x850>cc34: 8c e2 ldi r24, 0x2C ; 44cc36: 01 c0 rjmp .+2 ; 0xcc3a <HoTT_Telemety+0x850>cc38: 8c e2 ldi r24, 0x2C ; 44HoTT_DataPointer = (unsigned char *) &HoTTGeneral;return(sizeof(HoTTGeneral));break;default: return(0);}}cc3a: cf 91 pop r28cc3c: 08 95 ret0000cc3e <HoTT_Menu>://---------------------------------------------------------------void HoTT_Menu(void){cc3e: 2f 92 push r2cc40: 3f 92 push r3cc42: 4f 92 push r4cc44: 5f 92 push r5cc46: 6f 92 push r6cc48: 7f 92 push r7cc4a: 8f 92 push r8cc4c: 9f 92 push r9cc4e: af 92 push r10cc50: bf 92 push r11cc52: cf 92 push r12cc54: df 92 push r13cc56: ef 92 push r14cc58: ff 92 push r15cc5a: 0f 93 push r16cc5c: 1f 93 push r17cc5e: cf 93 push r28cc60: df 93 push r29cc62: 00 d0 rcall .+0 ; 0xcc64 <HoTT_Menu+0x26>cc64: 00 d0 rcall .+0 ; 0xcc66 <HoTT_Menu+0x28>cc66: cd b7 in r28, 0x3d ; 61cc68: de b7 in r29, 0x3e ; 62static unsigned char line, page = 0,show_current = 0,show_mag = 0, show_poti = 0;unsigned char tmp;HoTTVarioMeter = (HoTTVarioMeter * 7 + VarioMeter) / 8;cc6a: 40 91 54 03 lds r20, 0x0354cc6e: 50 91 55 03 lds r21, 0x0355cc72: 20 91 7e 04 lds r18, 0x047Ecc76: 30 91 7f 04 lds r19, 0x047Fcc7a: c9 01 movw r24, r18cc7c: 88 0f add r24, r24cc7e: 99 1f adc r25, r25cc80: 88 0f add r24, r24cc82: 99 1f adc r25, r25cc84: 88 0f add r24, r24cc86: 99 1f adc r25, r25cc88: 82 1b sub r24, r18cc8a: 93 0b sbc r25, r19cc8c: 84 0f add r24, r20cc8e: 95 1f adc r25, r21cc90: 99 23 and r25, r25cc92: 0c f4 brge .+2 ; 0xcc96 <HoTT_Menu+0x58>cc94: 07 96 adiw r24, 0x07 ; 7cc96: 95 95 asr r25cc98: 87 95 ror r24cc9a: 95 95 asr r25cc9c: 87 95 ror r24cc9e: 95 95 asr r25cca0: 87 95 ror r24cca2: 90 93 7f 04 sts 0x047F, r25cca6: 80 93 7e 04 sts 0x047E, r24// if(HottKeyboard) {beeptime = 1000;};switch(page)ccaa: 80 91 76 04 lds r24, 0x0476ccae: 90 e0 ldi r25, 0x00 ; 0ccb0: 87 30 cpi r24, 0x07 ; 7ccb2: 91 05 cpc r25, r1ccb4: 10 f0 brcs .+4 ; 0xccba <HoTT_Menu+0x7c>ccb6: 0c 94 97 7b jmp 0xf72e ; 0xf72e <HoTT_Menu+0x2af0>ccba: fc 01 movw r30, r24ccbc: e8 5a subi r30, 0xA8 ; 168ccbe: ff 4f sbci r31, 0xFF ; 255ccc0: 0c 94 a7 b1 jmp 0x1634e ; 0x1634e <__tablejump2__>{case 0:switch(line++)ccc4: 80 91 75 04 lds r24, 0x0475ccc8: 91 e0 ldi r25, 0x01 ; 1ccca: 98 0f add r25, r24cccc: 90 93 75 04 sts 0x0475, r25ccd0: 90 e0 ldi r25, 0x00 ; 0ccd2: 81 31 cpi r24, 0x11 ; 17ccd4: 91 05 cpc r25, r1ccd6: 08 f0 brcs .+2 ; 0xccda <HoTT_Menu+0x9c>ccd8: 37 c4 rjmp .+2158 ; 0xd548 <HoTT_Menu+0x90a>ccda: fc 01 movw r30, r24ccdc: e1 5a subi r30, 0xA1 ; 161ccde: ff 4f sbci r31, 0xFF ; 255cce0: 0c 94 a7 b1 jmp 0x1634e ; 0x1634e <__tablejump2__>{case 0:if(FC_StatusFlags & FC_STATUS_LOWBAT)cce4: 80 91 cb 03 lds r24, 0x03CBcce8: 85 ff sbrs r24, 5ccea: 2b c0 rjmp .+86 ; 0xcd42 <HoTT_Menu+0x104>HoTT_printfxy_BLINK(0,0," %2i.%1iV ",UBat/10, UBat%10)ccec: 80 e0 ldi r24, 0x00 ; 0ccee: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>ccf2: 80 91 1a 01 lds r24, 0x011Accf6: 90 91 1b 01 lds r25, 0x011Bccfa: e0 91 1a 01 lds r30, 0x011Accfe: f0 91 1b 01 lds r31, 0x011Bcd02: 2a e0 ldi r18, 0x0A ; 10cd04: 30 e0 ldi r19, 0x00 ; 0cd06: b9 01 movw r22, r18cd08: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>cd0c: 9f 93 push r25cd0e: 8f 93 push r24cd10: cf 01 movw r24, r30cd12: b9 01 movw r22, r18cd14: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>cd18: 7f 93 push r23cd1a: 6f 93 push r22cd1c: 83 e0 ldi r24, 0x03 ; 3cd1e: 9b e0 ldi r25, 0x0B ; 11cd20: 9f 93 push r25cd22: 8f 93 push r24cd24: 8c e2 ldi r24, 0x2C ; 44cd26: 95 e1 ldi r25, 0x15 ; 21cd28: 9f 93 push r25cd2a: 8f 93 push r24cd2c: e0 91 78 06 lds r30, 0x0678cd30: f0 91 79 06 lds r31, 0x0679cd34: 09 95 icallcd36: 0f b6 in r0, 0x3f ; 63cd38: f8 94 clicd3a: de bf out 0x3e, r29 ; 62cd3c: 0f be out 0x3f, r0 ; 63cd3e: cd bf out 0x3d, r28 ; 61cd40: 2a c0 rjmp .+84 ; 0xcd96 <HoTT_Menu+0x158>elseHoTT_printfxy(0,0," %2i.%1iV ",UBat/10, UBat%10)cd42: 80 e0 ldi r24, 0x00 ; 0cd44: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>cd48: 80 91 1a 01 lds r24, 0x011Acd4c: 90 91 1b 01 lds r25, 0x011Bcd50: e0 91 1a 01 lds r30, 0x011Acd54: f0 91 1b 01 lds r31, 0x011Bcd58: 2a e0 ldi r18, 0x0A ; 10cd5a: 30 e0 ldi r19, 0x00 ; 0cd5c: b9 01 movw r22, r18cd5e: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>cd62: 9f 93 push r25cd64: 8f 93 push r24cd66: cf 01 movw r24, r30cd68: b9 01 movw r22, r18cd6a: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>cd6e: 7f 93 push r23cd70: 6f 93 push r22cd72: 86 ef ldi r24, 0xF6 ; 246cd74: 9a e0 ldi r25, 0x0A ; 10cd76: 9f 93 push r25cd78: 8f 93 push r24cd7a: 8b e0 ldi r24, 0x0B ; 11cd7c: 95 e1 ldi r25, 0x15 ; 21cd7e: 9f 93 push r25cd80: 8f 93 push r24cd82: e0 91 78 06 lds r30, 0x0678cd86: f0 91 79 06 lds r31, 0x0679cd8a: 09 95 icallcd8c: 0f b6 in r0, 0x3f ; 63cd8e: f8 94 clicd90: de bf out 0x3e, r29 ; 62cd92: 0f be out 0x3f, r0 ; 63cd94: cd bf out 0x3d, r28 ; 61if(Parameter_GlobalConfig & CFG_HOEHENREGELUNG)cd96: 80 91 5c 06 lds r24, 0x065Ccd9a: 80 ff sbrs r24, 0cd9c: 57 c0 rjmp .+174 ; 0xce4c <HoTT_Menu+0x20e>{if(HoehenReglerAktiv) HoTT_printfxy_INV(10,0,"ALT:%4im %c", (int16_t)(HoehenWert/100),VarioCharacter)cd9e: 80 91 1b 04 lds r24, 0x041Bcda2: 88 23 and r24, r24cda4: 59 f1 breq .+86 ; 0xcdfc <HoTT_Menu+0x1be>cda6: 8a e0 ldi r24, 0x0A ; 10cda8: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>cdac: 80 91 20 01 lds r24, 0x0120cdb0: 1f 92 push r1cdb2: 8f 93 push r24cdb4: 60 91 fe 03 lds r22, 0x03FEcdb8: 70 91 ff 03 lds r23, 0x03FFcdbc: 80 91 00 04 lds r24, 0x0400cdc0: 90 91 01 04 lds r25, 0x0401cdc4: 24 e6 ldi r18, 0x64 ; 100cdc6: 30 e0 ldi r19, 0x00 ; 0cdc8: 40 e0 ldi r20, 0x00 ; 0cdca: 50 e0 ldi r21, 0x00 ; 0cdcc: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>cdd0: 3f 93 push r19cdd2: 2f 93 push r18cdd4: 8a ee ldi r24, 0xEA ; 234cdd6: 9a e0 ldi r25, 0x0A ; 10cdd8: 9f 93 push r25cdda: 8f 93 push r24cddc: 8b e1 ldi r24, 0x1B ; 27cdde: 95 e1 ldi r25, 0x15 ; 21cde0: 9f 93 push r25cde2: 8f 93 push r24cde4: e0 91 78 06 lds r30, 0x0678cde8: f0 91 79 06 lds r31, 0x0679cdec: 09 95 icallcdee: 0f b6 in r0, 0x3f ; 63cdf0: f8 94 clicdf2: de bf out 0x3e, r29 ; 62cdf4: 0f be out 0x3f, r0 ; 63cdf6: cd bf out 0x3d, r28 ; 61cdf8: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>else HoTT_printfxy(10,0,"ALT:%4im ", (int16_t)(HoehenWert/100))cdfc: 8a e0 ldi r24, 0x0A ; 10cdfe: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>ce02: 60 91 fe 03 lds r22, 0x03FEce06: 70 91 ff 03 lds r23, 0x03FFce0a: 80 91 00 04 lds r24, 0x0400ce0e: 90 91 01 04 lds r25, 0x0401ce12: 24 e6 ldi r18, 0x64 ; 100ce14: 30 e0 ldi r19, 0x00 ; 0ce16: 40 e0 ldi r20, 0x00 ; 0ce18: 50 e0 ldi r21, 0x00 ; 0ce1a: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>ce1e: 3f 93 push r19ce20: 2f 93 push r18ce22: 8f ed ldi r24, 0xDF ; 223ce24: 9a e0 ldi r25, 0x0A ; 10ce26: 9f 93 push r25ce28: 8f 93 push r24ce2a: 8b e0 ldi r24, 0x0B ; 11ce2c: 95 e1 ldi r25, 0x15 ; 21ce2e: 9f 93 push r25ce30: 8f 93 push r24ce32: e0 91 78 06 lds r30, 0x0678ce36: f0 91 79 06 lds r31, 0x0679ce3a: 09 95 icallce3c: 0f 90 pop r0ce3e: 0f 90 pop r0ce40: 0f 90 pop r0ce42: 0f 90 pop r0ce44: 0f 90 pop r0ce46: 0f 90 pop r0ce48: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>}else HoTT_printfxy(10,0,"ALT:---- ");ce4c: 8a e0 ldi r24, 0x0A ; 10ce4e: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>ce52: 85 ed ldi r24, 0xD5 ; 213ce54: 9a e0 ldi r25, 0x0A ; 10ce56: 9f 93 push r25ce58: 8f 93 push r24ce5a: 8b e0 ldi r24, 0x0B ; 11ce5c: 95 e1 ldi r25, 0x15 ; 21ce5e: 9f 93 push r25ce60: 8f 93 push r24ce62: e0 91 78 06 lds r30, 0x0678ce66: f0 91 79 06 lds r31, 0x0679ce6a: 09 95 icallce6c: 0f 90 pop r0ce6e: 0f 90 pop r0ce70: 0f 90 pop r0ce72: 0f 90 pop r0ce74: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>break;case 1:if(FC_StatusFlags & FC_STATUS_LOWBAT)ce78: 80 91 cb 03 lds r24, 0x03CBce7c: 85 ff sbrs r24, 5ce7e: 3f c0 rjmp .+126 ; 0xcefe <HoTT_Menu+0x2c0>HoTT_printfxy_BLINK(0,1," %2i:%02i ",FlugSekunden/60,FlugSekunden%60)ce80: 85 e1 ldi r24, 0x15 ; 21ce82: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>ce86: 40 91 5e 04 lds r20, 0x045Ece8a: 50 91 5f 04 lds r21, 0x045Fce8e: 9a 01 movw r18, r20ce90: a9 e8 ldi r26, 0x89 ; 137ce92: b8 e8 ldi r27, 0x88 ; 136ce94: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>ce98: 96 95 lsr r25ce9a: 87 95 ror r24ce9c: 92 95 swap r25ce9e: 82 95 swap r24cea0: 8f 70 andi r24, 0x0F ; 15cea2: 89 27 eor r24, r25cea4: 9f 70 andi r25, 0x0F ; 15cea6: 89 27 eor r24, r25cea8: 6c e3 ldi r22, 0x3C ; 60ceaa: 68 9f mul r22, r24ceac: 90 01 movw r18, r0ceae: 69 9f mul r22, r25ceb0: 30 0d add r19, r0ceb2: 11 24 eor r1, r1ceb4: ca 01 movw r24, r20ceb6: 82 1b sub r24, r18ceb8: 93 0b sbc r25, r19ceba: 9f 93 push r25cebc: 8f 93 push r24cebe: 9a 01 movw r18, r20cec0: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>cec4: 96 95 lsr r25cec6: 87 95 ror r24cec8: 92 95 swap r25ceca: 82 95 swap r24cecc: 8f 70 andi r24, 0x0F ; 15cece: 89 27 eor r24, r25ced0: 9f 70 andi r25, 0x0F ; 15ced2: 89 27 eor r24, r25ced4: 9f 93 push r25ced6: 8f 93 push r24ced8: 88 ec ldi r24, 0xC8 ; 200ceda: 9a e0 ldi r25, 0x0A ; 10cedc: 9f 93 push r25cede: 8f 93 push r24cee0: 8c e2 ldi r24, 0x2C ; 44cee2: 95 e1 ldi r25, 0x15 ; 21cee4: 9f 93 push r25cee6: 8f 93 push r24cee8: e0 91 78 06 lds r30, 0x0678ceec: f0 91 79 06 lds r31, 0x0679cef0: 09 95 icallcef2: 0f b6 in r0, 0x3f ; 63cef4: f8 94 clicef6: de bf out 0x3e, r29 ; 62cef8: 0f be out 0x3f, r0 ; 63cefa: cd bf out 0x3d, r28 ; 61cefc: 3e c0 rjmp .+124 ; 0xcf7a <HoTT_Menu+0x33c>else HoTT_printfxy(0,1," %2i:%02i ",FlugSekunden/60,FlugSekunden%60);cefe: 85 e1 ldi r24, 0x15 ; 21cf00: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>cf04: 40 91 5e 04 lds r20, 0x045Ecf08: 50 91 5f 04 lds r21, 0x045Fcf0c: 9a 01 movw r18, r20cf0e: a9 e8 ldi r26, 0x89 ; 137cf10: b8 e8 ldi r27, 0x88 ; 136cf12: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>cf16: 96 95 lsr r25cf18: 87 95 ror r24cf1a: 92 95 swap r25cf1c: 82 95 swap r24cf1e: 8f 70 andi r24, 0x0F ; 15cf20: 89 27 eor r24, r25cf22: 9f 70 andi r25, 0x0F ; 15cf24: 89 27 eor r24, r25cf26: 6c e3 ldi r22, 0x3C ; 60cf28: 68 9f mul r22, r24cf2a: 90 01 movw r18, r0cf2c: 69 9f mul r22, r25cf2e: 30 0d add r19, r0cf30: 11 24 eor r1, r1cf32: ca 01 movw r24, r20cf34: 82 1b sub r24, r18cf36: 93 0b sbc r25, r19cf38: 9f 93 push r25cf3a: 8f 93 push r24cf3c: 9a 01 movw r18, r20cf3e: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>cf42: 96 95 lsr r25cf44: 87 95 ror r24cf46: 92 95 swap r25cf48: 82 95 swap r24cf4a: 8f 70 andi r24, 0x0F ; 15cf4c: 89 27 eor r24, r25cf4e: 9f 70 andi r25, 0x0F ; 15cf50: 89 27 eor r24, r25cf52: 9f 93 push r25cf54: 8f 93 push r24cf56: 8b eb ldi r24, 0xBB ; 187cf58: 9a e0 ldi r25, 0x0A ; 10cf5a: 9f 93 push r25cf5c: 8f 93 push r24cf5e: 8b e0 ldi r24, 0x0B ; 11cf60: 95 e1 ldi r25, 0x15 ; 21cf62: 9f 93 push r25cf64: 8f 93 push r24cf66: e0 91 78 06 lds r30, 0x0678cf6a: f0 91 79 06 lds r31, 0x0679cf6e: 09 95 icallcf70: 0f b6 in r0, 0x3f ; 63cf72: f8 94 clicf74: de bf out 0x3e, r29 ; 62cf76: 0f be out 0x3f, r0 ; 63cf78: cd bf out 0x3d, r28 ; 61HoTT_printfxy(10,1,"DIR: %3d%c",CompassCorrected, HoTT_GRAD);cf7a: 8f e1 ldi r24, 0x1F ; 31cf7c: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>cf80: 1f 92 push r1cf82: 80 e6 ldi r24, 0x60 ; 96cf84: 8f 93 push r24cf86: 80 91 66 06 lds r24, 0x0666cf8a: 8f 93 push r24cf8c: 80 91 65 06 lds r24, 0x0665cf90: 8f 93 push r24cf92: 80 eb ldi r24, 0xB0 ; 176cf94: 9a e0 ldi r25, 0x0A ; 10cf96: 9f 93 push r25cf98: 8f 93 push r24cf9a: 8b e0 ldi r24, 0x0B ; 11cf9c: 95 e1 ldi r25, 0x15 ; 21cf9e: 9f 93 push r25cfa0: 8f 93 push r24cfa2: e0 91 78 06 lds r30, 0x0678cfa6: f0 91 79 06 lds r31, 0x0679cfaa: 09 95 icallif(FC_StatusFlags2 & FC_STATUS2_CAREFREE) HoTT_printfxy_INV(20,1,"C") else HoTT_printfxy(20,1," ");cfac: 80 91 ca 03 lds r24, 0x03CAcfb0: 0f b6 in r0, 0x3f ; 63cfb2: f8 94 clicfb4: de bf out 0x3e, r29 ; 62cfb6: 0f be out 0x3f, r0 ; 63cfb8: cd bf out 0x3d, r28 ; 61cfba: 80 ff sbrs r24, 0cfbc: 16 c0 rjmp .+44 ; 0xcfea <HoTT_Menu+0x3ac>cfbe: 89 e2 ldi r24, 0x29 ; 41cfc0: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>cfc4: 8e ea ldi r24, 0xAE ; 174cfc6: 9a e0 ldi r25, 0x0A ; 10cfc8: 9f 93 push r25cfca: 8f 93 push r24cfcc: 8b e1 ldi r24, 0x1B ; 27cfce: 95 e1 ldi r25, 0x15 ; 21cfd0: 9f 93 push r25cfd2: 8f 93 push r24cfd4: e0 91 78 06 lds r30, 0x0678cfd8: f0 91 79 06 lds r31, 0x0679cfdc: 09 95 icallcfde: 0f 90 pop r0cfe0: 0f 90 pop r0cfe2: 0f 90 pop r0cfe4: 0f 90 pop r0cfe6: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>cfea: 89 e2 ldi r24, 0x29 ; 41cfec: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>cff0: 8c ea ldi r24, 0xAC ; 172cff2: 9a e0 ldi r25, 0x0A ; 10cff4: 9f 93 push r25cff6: 8f 93 push r24cff8: 8b e0 ldi r24, 0x0B ; 11cffa: 95 e1 ldi r25, 0x15 ; 21cffc: 9f 93 push r25cffe: 8f 93 push r24d000: e0 91 78 06 lds r30, 0x0678d004: f0 91 79 06 lds r31, 0x0679d008: 09 95 icalld00a: 0f 90 pop r0d00c: 0f 90 pop r0d00e: 0f 90 pop r0d010: 0f 90 pop r0d012: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>break;case 2:if(FC_StatusFlags & FC_STATUS_LOWBAT)d016: 80 91 cb 03 lds r24, 0x03CBd01a: 85 ff sbrs r24, 5d01c: 1d c0 rjmp .+58 ; 0xd058 <HoTT_Menu+0x41a>HoTT_printfxy_BLINK(0,2," %5i ",Capacity.UsedCapacity)d01e: 8a e2 ldi r24, 0x2A ; 42d020: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>d024: e9 e1 ldi r30, 0x19 ; 25d026: f5 e0 ldi r31, 0x05 ; 5d028: 81 81 ldd r24, Z+1 ; 0x01d02a: 8f 93 push r24d02c: 80 81 ld r24, Zd02e: 8f 93 push r24d030: 84 ea ldi r24, 0xA4 ; 164d032: 9a e0 ldi r25, 0x0A ; 10d034: 9f 93 push r25d036: 8f 93 push r24d038: 8c e2 ldi r24, 0x2C ; 44d03a: 95 e1 ldi r25, 0x15 ; 21d03c: 9f 93 push r25d03e: 8f 93 push r24d040: e0 91 78 06 lds r30, 0x0678d044: f0 91 79 06 lds r31, 0x0679d048: 09 95 icalld04a: 0f 90 pop r0d04c: 0f 90 pop r0d04e: 0f 90 pop r0d050: 0f 90 pop r0d052: 0f 90 pop r0d054: 0f 90 pop r0d056: 1c c0 rjmp .+56 ; 0xd090 <HoTT_Menu+0x452>else HoTT_printfxy(0,2," %5i ",Capacity.UsedCapacity);d058: 8a e2 ldi r24, 0x2A ; 42d05a: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>d05e: e9 e1 ldi r30, 0x19 ; 25d060: f5 e0 ldi r31, 0x05 ; 5d062: 81 81 ldd r24, Z+1 ; 0x01d064: 8f 93 push r24d066: 80 81 ld r24, Zd068: 8f 93 push r24d06a: 8c e9 ldi r24, 0x9C ; 156d06c: 9a e0 ldi r25, 0x0A ; 10d06e: 9f 93 push r25d070: 8f 93 push r24d072: 8b e0 ldi r24, 0x0B ; 11d074: 95 e1 ldi r25, 0x15 ; 21d076: 9f 93 push r25d078: 8f 93 push r24d07a: e0 91 78 06 lds r30, 0x0678d07e: f0 91 79 06 lds r31, 0x0679d082: 09 95 icalld084: 0f 90 pop r0d086: 0f 90 pop r0d088: 0f 90 pop r0d08a: 0f 90 pop r0d08c: 0f 90 pop r0d08e: 0f 90 pop r0HoTT_printfxy(12,2,"I:%2i.%1iA ",Capacity.ActualCurrent/10, Capacity.ActualCurrent%10);d090: 86 e3 ldi r24, 0x36 ; 54d092: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>d096: 40 91 15 05 lds r20, 0x0515d09a: 50 91 16 05 lds r21, 0x0516d09e: 9a 01 movw r18, r20d0a0: ad ec ldi r26, 0xCD ; 205d0a2: bc ec ldi r27, 0xCC ; 204d0a4: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>d0a8: 96 95 lsr r25d0aa: 87 95 ror r24d0ac: 96 95 lsr r25d0ae: 87 95 ror r24d0b0: 96 95 lsr r25d0b2: 87 95 ror r24d0b4: 9c 01 movw r18, r24d0b6: 22 0f add r18, r18d0b8: 33 1f adc r19, r19d0ba: 88 0f add r24, r24d0bc: 99 1f adc r25, r25d0be: 88 0f add r24, r24d0c0: 99 1f adc r25, r25d0c2: 88 0f add r24, r24d0c4: 99 1f adc r25, r25d0c6: 82 0f add r24, r18d0c8: 93 1f adc r25, r19d0ca: 9a 01 movw r18, r20d0cc: 28 1b sub r18, r24d0ce: 39 0b sbc r19, r25d0d0: c9 01 movw r24, r18d0d2: 9f 93 push r25d0d4: 2f 93 push r18d0d6: 9a 01 movw r18, r20d0d8: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>d0dc: 96 95 lsr r25d0de: 87 95 ror r24d0e0: 96 95 lsr r25d0e2: 87 95 ror r24d0e4: 96 95 lsr r25d0e6: 87 95 ror r24d0e8: 9f 93 push r25d0ea: 8f 93 push r24d0ec: 80 e9 ldi r24, 0x90 ; 144d0ee: 9a e0 ldi r25, 0x0A ; 10d0f0: 9f 93 push r25d0f2: 8f 93 push r24d0f4: 8b e0 ldi r24, 0x0B ; 11d0f6: 95 e1 ldi r25, 0x15 ; 21d0f8: 9f 93 push r25d0fa: 8f 93 push r24d0fc: e0 91 78 06 lds r30, 0x0678d100: f0 91 79 06 lds r31, 0x0679d104: 09 95 icallbreak;d106: 0f b6 in r0, 0x3f ; 63d108: f8 94 clid10a: de bf out 0x3e, r29 ; 62d10c: 0f be out 0x3f, r0 ; 63d10e: cd bf out 0x3d, r28 ; 61d110: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>case 3:HoTT_printfxy(9,0,":");d114: 89 e0 ldi r24, 0x09 ; 9d116: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>d11a: 8e e8 ldi r24, 0x8E ; 142d11c: 9a e0 ldi r25, 0x0A ; 10d11e: 9f 93 push r25d120: 8f 93 push r24d122: 0b e0 ldi r16, 0x0B ; 11d124: 15 e1 ldi r17, 0x15 ; 21d126: 1f 93 push r17d128: 0f 93 push r16d12a: e0 91 78 06 lds r30, 0x0678d12e: f0 91 79 06 lds r31, 0x0679d132: 09 95 icallHoTT_printfxy(9,1,":");d134: 8e e1 ldi r24, 0x1E ; 30d136: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>d13a: 8c e8 ldi r24, 0x8C ; 140d13c: 9a e0 ldi r25, 0x0A ; 10d13e: 9f 93 push r25d140: 8f 93 push r24d142: 1f 93 push r17d144: 0f 93 push r16d146: e0 91 78 06 lds r30, 0x0678d14a: f0 91 79 06 lds r31, 0x0679d14e: 09 95 icallHoTT_printfxy(9,2,":");d150: 83 e3 ldi r24, 0x33 ; 51d152: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>d156: 8a e8 ldi r24, 0x8A ; 138d158: 9a e0 ldi r25, 0x0A ; 10d15a: 9f 93 push r25d15c: 8f 93 push r24d15e: 1f 93 push r17d160: 0f 93 push r16d162: e0 91 78 06 lds r30, 0x0678d166: f0 91 79 06 lds r31, 0x0679d16a: 09 95 icallHoTT_printfxy(0,3,"---------+-----------");d16c: 8f e3 ldi r24, 0x3F ; 63d16e: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>d172: 84 e7 ldi r24, 0x74 ; 116d174: 9a e0 ldi r25, 0x0A ; 10d176: 9f 93 push r25d178: 8f 93 push r24d17a: 1f 93 push r17d17c: 0f 93 push r16d17e: e0 91 78 06 lds r30, 0x0678d182: f0 91 79 06 lds r31, 0x0679d186: 09 95 icall// HoTT_printfxy(0,3,"---------------------");HoTT_printfxy(0,6,"---------------------");d188: 8e e7 ldi r24, 0x7E ; 126d18a: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>d18e: 8e e5 ldi r24, 0x5E ; 94d190: 9a e0 ldi r25, 0x0A ; 10d192: 9f 93 push r25d194: 8f 93 push r24d196: 1f 93 push r17d198: 0f 93 push r16d19a: e0 91 78 06 lds r30, 0x0678d19e: f0 91 79 06 lds r31, 0x0679d1a2: 09 95 icallbreak;d1a4: 0f b6 in r0, 0x3f ; 63d1a6: f8 94 clid1a8: de bf out 0x3e, r29 ; 62d1aa: 0f be out 0x3f, r0 ; 63d1ac: cd bf out 0x3d, r28 ; 61d1ae: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>case 4:if(NaviDataOkay)d1b2: 80 91 a4 02 lds r24, 0x02A4d1b6: 88 23 and r24, r24d1b8: 09 f4 brne .+2 ; 0xd1bc <HoTT_Menu+0x57e>d1ba: 8e c0 rjmp .+284 ; 0xd2d8 <HoTT_Menu+0x69a>{HoTT_printfxy(9,4,":");d1bc: 8d e5 ldi r24, 0x5D ; 93d1be: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>d1c2: 8c e5 ldi r24, 0x5C ; 92d1c4: 9a e0 ldi r25, 0x0A ; 10d1c6: 9f 93 push r25d1c8: 8f 93 push r24d1ca: 0b e0 ldi r16, 0x0B ; 11d1cc: 15 e1 ldi r17, 0x15 ; 21d1ce: 1f 93 push r17d1d0: 0f 93 push r16d1d2: e0 91 78 06 lds r30, 0x0678d1d6: f0 91 79 06 lds r31, 0x0679d1da: 09 95 icallHoTT_printfxy(0,4,"SAT:%2d ",GPSInfo.NumOfSats);d1dc: 84 e5 ldi r24, 0x54 ; 84d1de: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>d1e2: 80 91 d8 08 lds r24, 0x08D8d1e6: 1f 92 push r1d1e8: 8f 93 push r24d1ea: 83 e5 ldi r24, 0x53 ; 83d1ec: 9a e0 ldi r25, 0x0A ; 10d1ee: 9f 93 push r25d1f0: 8f 93 push r24d1f2: 1f 93 push r17d1f4: 0f 93 push r16d1f6: e0 91 78 06 lds r30, 0x0678d1fa: f0 91 79 06 lds r31, 0x0679d1fe: 09 95 icallHoTT_printfxy(10,4,"DIST:%3dm",GPSInfo.HomeDistance/10);d200: 8e e5 ldi r24, 0x5E ; 94d202: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>d206: 20 91 db 08 lds r18, 0x08DBd20a: 30 91 dc 08 lds r19, 0x08DCd20e: ad ec ldi r26, 0xCD ; 205d210: bc ec ldi r27, 0xCC ; 204d212: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>d216: 96 95 lsr r25d218: 87 95 ror r24d21a: 96 95 lsr r25d21c: 87 95 ror r24d21e: 96 95 lsr r25d220: 87 95 ror r24d222: 9f 93 push r25d224: 8f 93 push r24d226: 89 e4 ldi r24, 0x49 ; 73d228: 9a e0 ldi r25, 0x0A ; 10d22a: 9f 93 push r25d22c: 8f 93 push r24d22e: 1f 93 push r17d230: 0f 93 push r16d232: e0 91 78 06 lds r30, 0x0678d236: f0 91 79 06 lds r31, 0x0679d23a: 09 95 icallswitch (GPSInfo.SatFix)d23c: 0f b6 in r0, 0x3f ; 63d23e: f8 94 clid240: de bf out 0x3e, r29 ; 62d242: 0f be out 0x3f, r0 ; 63d244: cd bf out 0x3d, r28 ; 61d246: 80 91 d9 08 lds r24, 0x08D9d24a: 83 30 cpi r24, 0x03 ; 3d24c: 79 f5 brne .+94 ; 0xd2ac <HoTT_Menu+0x66e>{case SATFIX_3D:if(GPSInfo.Flags & FLAG_DIFFSOLN) HoTT_printfxy(7,4,"D ")d24e: 80 91 d7 08 lds r24, 0x08D7d252: 81 ff sbrs r24, 1d254: 15 c0 rjmp .+42 ; 0xd280 <HoTT_Menu+0x642>d256: 8b e5 ldi r24, 0x5B ; 91d258: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>d25c: 86 e4 ldi r24, 0x46 ; 70d25e: 9a e0 ldi r25, 0x0A ; 10d260: 9f 93 push r25d262: 8f 93 push r24d264: c8 01 movw r24, r16d266: 9f 93 push r25d268: 0f 93 push r16d26a: e0 91 78 06 lds r30, 0x0678d26e: f0 91 79 06 lds r31, 0x0679d272: 09 95 icalld274: 0f 90 pop r0d276: 0f 90 pop r0d278: 0f 90 pop r0d27a: 0f 90 pop r0d27c: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>else HoTT_printfxy(7,4,"3D");d280: 8b e5 ldi r24, 0x5B ; 91d282: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>d286: 83 e4 ldi r24, 0x43 ; 67d288: 9a e0 ldi r25, 0x0A ; 10d28a: 9f 93 push r25d28c: 8f 93 push r24d28e: 8b e0 ldi r24, 0x0B ; 11d290: 95 e1 ldi r25, 0x15 ; 21d292: 9f 93 push r25d294: 8f 93 push r24d296: e0 91 78 06 lds r30, 0x0678d29a: f0 91 79 06 lds r31, 0x0679d29e: 09 95 icalld2a0: 0f 90 pop r0d2a2: 0f 90 pop r0d2a4: 0f 90 pop r0d2a6: 0f 90 pop r0d2a8: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>break;default:HoTT_printfxy_BLINK(7,4,"!!");d2ac: 8b e5 ldi r24, 0x5B ; 91d2ae: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>d2b2: 80 e4 ldi r24, 0x40 ; 64d2b4: 9a e0 ldi r25, 0x0A ; 10d2b6: 9f 93 push r25d2b8: 8f 93 push r24d2ba: 8c e2 ldi r24, 0x2C ; 44d2bc: 95 e1 ldi r25, 0x15 ; 21d2be: 9f 93 push r25d2c0: 8f 93 push r24d2c2: e0 91 78 06 lds r30, 0x0678d2c6: f0 91 79 06 lds r31, 0x0679d2ca: 09 95 icallbreak;d2cc: 0f 90 pop r0d2ce: 0f 90 pop r0d2d0: 0f 90 pop r0d2d2: 0f 90 pop r0d2d4: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>}}else{Hott_ClearLine(4);d2d8: 84 e0 ldi r24, 0x04 ; 4d2da: 0e 94 b4 60 call 0xc168 ; 0xc168 <Hott_ClearLine>d2de: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>}break;case 5:if(NaviDataOkay)d2e2: 80 91 a4 02 lds r24, 0x02A4d2e6: 88 23 and r24, r24d2e8: 09 f4 brne .+2 ; 0xd2ec <HoTT_Menu+0x6ae>d2ea: 7f c0 rjmp .+254 ; 0xd3ea <HoTT_Menu+0x7ac>{if(show_mag)d2ec: 80 91 74 04 lds r24, 0x0474d2f0: 88 23 and r24, r24d2f2: 09 f4 brne .+2 ; 0xd2f6 <HoTT_Menu+0x6b8>d2f4: 52 c0 rjmp .+164 ; 0xd39a <HoTT_Menu+0x75c>{HoTT_printfxy(0,5,"MAG:%3u%% ",EarthMagneticField);d2f6: 89 e6 ldi r24, 0x69 ; 105d2f8: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>d2fc: 80 91 ba 04 lds r24, 0x04BAd300: 1f 92 push r1d302: 8f 93 push r24d304: 85 e3 ldi r24, 0x35 ; 53d306: 9a e0 ldi r25, 0x0A ; 10d308: 9f 93 push r25d30a: 8f 93 push r24d30c: 0f 2e mov r0, r31d30e: fb e0 ldi r31, 0x0B ; 11d310: ef 2e mov r14, r31d312: f5 e1 ldi r31, 0x15 ; 21d314: ff 2e mov r15, r31d316: f0 2d mov r31, r0d318: ff 92 push r15d31a: ef 92 push r14d31c: e0 91 78 06 lds r30, 0x0678d320: f0 91 79 06 lds r31, 0x0679d324: 09 95 icallHoTT_printfxy(12,5,"HM:%3d%c %c", GPSInfo.HomeBearing, HoTT_GRAD, NC_GPS_ModeCharacter);d326: 85 e7 ldi r24, 0x75 ; 117d328: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>d32c: 80 91 96 02 lds r24, 0x0296d330: 1f 92 push r1d332: 8f 93 push r24d334: 1f 92 push r1d336: 10 e6 ldi r17, 0x60 ; 96d338: 1f 93 push r17d33a: ed ed ldi r30, 0xDD ; 221d33c: f8 e0 ldi r31, 0x08 ; 8d33e: 81 81 ldd r24, Z+1 ; 0x01d340: 8f 93 push r24d342: 80 81 ld r24, Zd344: 8f 93 push r24d346: 89 e2 ldi r24, 0x29 ; 41d348: 9a e0 ldi r25, 0x0A ; 10d34a: 9f 93 push r25d34c: 8f 93 push r24d34e: ff 92 push r15d350: ef 92 push r14d352: e0 91 78 06 lds r30, 0x0678d356: f0 91 79 06 lds r31, 0x0679d35a: 09 95 icallHoTT_printfxy(9,5,"incl:%2d%c(%2i)",EarthMagneticInclination, HoTT_GRAD,EarthMagneticInclinationTheoretic);d35c: 82 e7 ldi r24, 0x72 ; 114d35e: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>d362: 80 91 b8 04 lds r24, 0x04B8d366: 1f 92 push r1d368: 8f 93 push r24d36a: 1f 92 push r1d36c: 1f 93 push r17d36e: 80 91 b9 04 lds r24, 0x04B9d372: 1f 92 push r1d374: 8f 93 push r24d376: 89 e1 ldi r24, 0x19 ; 25d378: 9a e0 ldi r25, 0x0A ; 10d37a: 9f 93 push r25d37c: 8f 93 push r24d37e: ff 92 push r15d380: ef 92 push r14d382: e0 91 78 06 lds r30, 0x0678d386: f0 91 79 06 lds r31, 0x0679d38a: 09 95 icalld38c: 0f b6 in r0, 0x3f ; 63d38e: f8 94 clid390: de bf out 0x3e, r29 ; 62d392: 0f be out 0x3f, r0 ; 63d394: cd bf out 0x3d, r28 ; 61d396: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>}else{HoTT_printfxy(0,5," %2um/s: HM:%3d%c %c",GPSInfo.Speed, GPSInfo.HomeBearing, HoTT_GRAD, NC_GPS_ModeCharacter);d39a: 89 e6 ldi r24, 0x69 ; 105d39c: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>d3a0: 80 91 96 02 lds r24, 0x0296d3a4: 1f 92 push r1d3a6: 8f 93 push r24d3a8: 1f 92 push r1d3aa: 80 e6 ldi r24, 0x60 ; 96d3ac: 8f 93 push r24d3ae: ed ed ldi r30, 0xDD ; 221d3b0: f8 e0 ldi r31, 0x08 ; 8d3b2: 81 81 ldd r24, Z+1 ; 0x01d3b4: 8f 93 push r24d3b6: 80 81 ld r24, Zd3b8: 8f 93 push r24d3ba: 80 91 da 08 lds r24, 0x08DAd3be: 1f 92 push r1d3c0: 8f 93 push r24d3c2: 80 e0 ldi r24, 0x00 ; 0d3c4: 9a e0 ldi r25, 0x0A ; 10d3c6: 9f 93 push r25d3c8: 8f 93 push r24d3ca: 8b e0 ldi r24, 0x0B ; 11d3cc: 95 e1 ldi r25, 0x15 ; 21d3ce: 9f 93 push r25d3d0: 8f 93 push r24d3d2: e0 91 78 06 lds r30, 0x0678d3d6: f0 91 79 06 lds r31, 0x0679d3da: 09 95 icalld3dc: 0f b6 in r0, 0x3f ; 63d3de: f8 94 clid3e0: de bf out 0x3e, r29 ; 62d3e2: 0f be out 0x3f, r0 ; 63d3e4: cd bf out 0x3d, r28 ; 61d3e6: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>}}else Hott_ClearLine(5);d3ea: 85 e0 ldi r24, 0x05 ; 5d3ec: 0e 94 b4 60 call 0xc168 ; 0xc168 <Hott_ClearLine>d3f0: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>break;case 6:break;case 7: if(NC_ErrorCode)d3f4: 80 91 bb 04 lds r24, 0x04BBd3f8: 88 23 and r24, r24d3fa: 09 f4 brne .+2 ; 0xd3fe <HoTT_Menu+0x7c0>d3fc: 4f c0 rjmp .+158 ; 0xd49c <HoTT_Menu+0x85e>{if(HoTTBlink && NC_ErrorCode < MAX_ERR_NUMBER)d3fe: 90 91 ed 02 lds r25, 0x02EDd402: 99 23 and r25, r25d404: 09 f1 breq .+66 ; 0xd448 <HoTT_Menu+0x80a>d406: 83 32 cpi r24, 0x23 ; 35d408: f8 f4 brcc .+62 ; 0xd448 <HoTT_Menu+0x80a>{Hott_ClearLine(7);d40a: 87 e0 ldi r24, 0x07 ; 7d40c: 0e 94 b4 60 call 0xc168 ; 0xc168 <Hott_ClearLine>HoTT_printfxy_INV(0,7,"ERR: %2d !",NC_ErrorCode);d410: 83 e9 ldi r24, 0x93 ; 147d412: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>d416: 80 91 bb 04 lds r24, 0x04BBd41a: 1f 92 push r1d41c: 8f 93 push r24d41e: 85 ef ldi r24, 0xF5 ; 245d420: 99 e0 ldi r25, 0x09 ; 9d422: 9f 93 push r25d424: 8f 93 push r24d426: 8b e1 ldi r24, 0x1B ; 27d428: 95 e1 ldi r25, 0x15 ; 21d42a: 9f 93 push r25d42c: 8f 93 push r24d42e: e0 91 78 06 lds r30, 0x0678d432: f0 91 79 06 lds r31, 0x0679d436: 09 95 icalld438: 0f 90 pop r0d43a: 0f 90 pop r0d43c: 0f 90 pop r0d43e: 0f 90 pop r0d440: 0f 90 pop r0d442: 0f 90 pop r0d444: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>}else{HoTT_printfxy(0,7,"ERR: "); _printf_P(&LIBFC_HoTT_Putchar, NC_ERROR_TEXT[NC_ErrorCode] , 0);};d448: 83 e9 ldi r24, 0x93 ; 147d44a: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>d44e: 8f ee ldi r24, 0xEF ; 239d450: 99 e0 ldi r25, 0x09 ; 9d452: 9f 93 push r25d454: 8f 93 push r24d456: 0b e0 ldi r16, 0x0B ; 11d458: 15 e1 ldi r17, 0x15 ; 21d45a: 1f 93 push r17d45c: 0f 93 push r16d45e: e0 91 78 06 lds r30, 0x0678d462: f0 91 79 06 lds r31, 0x0679d466: 09 95 icalld468: 1f 92 push r1d46a: 1f 92 push r1d46c: 80 91 bb 04 lds r24, 0x04BBd470: f1 e1 ldi r31, 0x11 ; 17d472: 8f 9f mul r24, r31d474: c0 01 movw r24, r0d476: 11 24 eor r1, r1d478: 84 59 subi r24, 0x94 ; 148d47a: 94 4f sbci r25, 0xF4 ; 244d47c: 9f 93 push r25d47e: 8f 93 push r24d480: 1f 93 push r17d482: 0f 93 push r16d484: e0 91 78 06 lds r30, 0x0678d488: f0 91 79 06 lds r31, 0x0679d48c: 09 95 icalld48e: 0f b6 in r0, 0x3f ; 63d490: f8 94 clid492: de bf out 0x3e, r29 ; 62d494: 0f be out 0x3f, r0 ; 63d496: cd bf out 0x3d, r28 ; 61d498: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>}elseif(FC_StatusFlags & FC_STATUS_LOWBAT) HoTT_printfxy(1,7,"!! LiPo voltage !!")d49c: 80 91 cb 03 lds r24, 0x03CBd4a0: 85 ff sbrs r24, 5d4a2: 16 c0 rjmp .+44 ; 0xd4d0 <HoTT_Menu+0x892>d4a4: 84 e9 ldi r24, 0x94 ; 148d4a6: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>d4aa: 8c ed ldi r24, 0xDC ; 220d4ac: 99 e0 ldi r25, 0x09 ; 9d4ae: 9f 93 push r25d4b0: 8f 93 push r24d4b2: 8b e0 ldi r24, 0x0B ; 11d4b4: 95 e1 ldi r25, 0x15 ; 21d4b6: 9f 93 push r25d4b8: 8f 93 push r24d4ba: e0 91 78 06 lds r30, 0x0678d4be: f0 91 79 06 lds r31, 0x0679d4c2: 09 95 icalld4c4: 0f 90 pop r0d4c6: 0f 90 pop r0d4c8: 0f 90 pop r0d4ca: 0f 90 pop r0d4cc: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>else HoTT_printfxy(0,7," www.MikroKopter.de ");d4d0: 83 e9 ldi r24, 0x93 ; 147d4d2: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>d4d6: 86 ec ldi r24, 0xC6 ; 198d4d8: 99 e0 ldi r25, 0x09 ; 9d4da: 9f 93 push r25d4dc: 8f 93 push r24d4de: 8b e0 ldi r24, 0x0B ; 11d4e0: 95 e1 ldi r25, 0x15 ; 21d4e2: 9f 93 push r25d4e4: 8f 93 push r24d4e6: e0 91 78 06 lds r30, 0x0678d4ea: f0 91 79 06 lds r31, 0x0679d4ee: 09 95 icalld4f0: 0f 90 pop r0d4f2: 0f 90 pop r0d4f4: 0f 90 pop r0d4f6: 0f 90 pop r0d4f8: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>case 12:case 13:case 14:case 15:case 16:if(HottKeyboard == HOTT_KEY_DOWN) { LIBFC_HoTT_Clear(); page = 5; line = 0;}d4fc: 80 91 a9 0c lds r24, 0x0CA9d500: 82 30 cpi r24, 0x02 ; 2d502: 41 f4 brne .+16 ; 0xd514 <HoTT_Menu+0x8d6>d504: 0e 94 3a 15 call 0x2a74 ; 0x2a74 <LIBFC_HoTT_Clear>d508: 85 e0 ldi r24, 0x05 ; 5d50a: 80 93 76 04 sts 0x0476, r24d50e: 10 92 75 04 sts 0x0475, r1d512: 16 c0 rjmp .+44 ; 0xd540 <HoTT_Menu+0x902>elseif(HottKeyboard == HOTT_KEY_SET) { if(show_mag) show_mag = 0; else show_mag = 1;}d514: 86 30 cpi r24, 0x06 ; 6d516: 59 f4 brne .+22 ; 0xd52e <HoTT_Menu+0x8f0>d518: 80 91 74 04 lds r24, 0x0474d51c: 88 23 and r24, r24d51e: 19 f0 breq .+6 ; 0xd526 <HoTT_Menu+0x8e8>d520: 10 92 74 04 sts 0x0474, r1d524: 0d c0 rjmp .+26 ; 0xd540 <HoTT_Menu+0x902>d526: 81 e0 ldi r24, 0x01 ; 1d528: 80 93 74 04 sts 0x0474, r24d52c: 09 c0 rjmp .+18 ; 0xd540 <HoTT_Menu+0x902>elseif(HottKeyboard == HOTT_KEY_LEFT) { LIBFC_HoTT_Clear(); page = 1; line = 0;};d52e: 88 30 cpi r24, 0x08 ; 8d530: 39 f4 brne .+14 ; 0xd540 <HoTT_Menu+0x902>d532: 0e 94 3a 15 call 0x2a74 ; 0x2a74 <LIBFC_HoTT_Clear>d536: 81 e0 ldi r24, 0x01 ; 1d538: 80 93 76 04 sts 0x0476, r24d53c: 10 92 75 04 sts 0x0475, r1HottKeyboard = 0;d540: 10 92 a9 0c sts 0x0CA9, r1break;d544: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>default: line = 0;d548: 10 92 75 04 sts 0x0475, r1break;d54c: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>}break;case 1:switch(line++)d550: 80 91 75 04 lds r24, 0x0475d554: 91 e0 ldi r25, 0x01 ; 1d556: 98 0f add r25, r24d558: 90 93 75 04 sts 0x0475, r25d55c: 90 e0 ldi r25, 0x00 ; 0d55e: 81 31 cpi r24, 0x11 ; 17d560: 91 05 cpc r25, r1d562: 08 f0 brcs .+2 ; 0xd566 <HoTT_Menu+0x928>d564: e9 c5 rjmp .+3026 ; 0xe138 <HoTT_Menu+0x14fa>d566: fc 01 movw r30, r24d568: e0 59 subi r30, 0x90 ; 144d56a: ff 4f sbci r31, 0xFF ; 255d56c: 0c 94 a7 b1 jmp 0x1634e ; 0x1634e <__tablejump2__>{case 0:if(FC_StatusFlags & FC_STATUS_LOWBAT)d570: 80 91 cb 03 lds r24, 0x03CBd574: 85 ff sbrs r24, 5d576: 5d c0 rjmp .+186 ; 0xd632 <HoTT_Menu+0x9f4>HoTT_printfxy_BLINK(0,0," %2i:%02i %2i.%1iV %4imAh",FlugSekunden/60,FlugSekunden%60,UBat/10, UBat%10,Capacity.UsedCapacity)d578: 80 e0 ldi r24, 0x00 ; 0d57a: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>d57e: 80 91 1a 01 lds r24, 0x011Ad582: 90 91 1b 01 lds r25, 0x011Bd586: 00 91 1a 01 lds r16, 0x011Ad58a: 10 91 1b 01 lds r17, 0x011Bd58e: e0 91 5e 04 lds r30, 0x045Ed592: f0 91 5f 04 lds r31, 0x045Fd596: a9 e1 ldi r26, 0x19 ; 25d598: b5 e0 ldi r27, 0x05 ; 5d59a: 11 96 adiw r26, 0x01 ; 1d59c: 2c 91 ld r18, Xd59e: 11 97 sbiw r26, 0x01 ; 1d5a0: 2f 93 push r18d5a2: 2c 91 ld r18, Xd5a4: 2f 93 push r18d5a6: 2a e0 ldi r18, 0x0A ; 10d5a8: 30 e0 ldi r19, 0x00 ; 0d5aa: b9 01 movw r22, r18d5ac: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>d5b0: 9f 93 push r25d5b2: 8f 93 push r24d5b4: c8 01 movw r24, r16d5b6: b9 01 movw r22, r18d5b8: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>d5bc: 7f 93 push r23d5be: 6f 93 push r22d5c0: 9f 01 movw r18, r30d5c2: a9 e8 ldi r26, 0x89 ; 137d5c4: b8 e8 ldi r27, 0x88 ; 136d5c6: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>d5ca: 96 95 lsr r25d5cc: 87 95 ror r24d5ce: 92 95 swap r25d5d0: 82 95 swap r24d5d2: 8f 70 andi r24, 0x0F ; 15d5d4: 89 27 eor r24, r25d5d6: 9f 70 andi r25, 0x0F ; 15d5d8: 89 27 eor r24, r25d5da: 4c e3 ldi r20, 0x3C ; 60d5dc: 48 9f mul r20, r24d5de: 90 01 movw r18, r0d5e0: 49 9f mul r20, r25d5e2: 30 0d add r19, r0d5e4: 11 24 eor r1, r1d5e6: cf 01 movw r24, r30d5e8: 82 1b sub r24, r18d5ea: 93 0b sbc r25, r19d5ec: 9f 93 push r25d5ee: 8f 93 push r24d5f0: 9f 01 movw r18, r30d5f2: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>d5f6: 96 95 lsr r25d5f8: 87 95 ror r24d5fa: 92 95 swap r25d5fc: 82 95 swap r24d5fe: 8f 70 andi r24, 0x0F ; 15d600: 89 27 eor r24, r25d602: 9f 70 andi r25, 0x0F ; 15d604: 89 27 eor r24, r25d606: 9f 93 push r25d608: 8f 93 push r24d60a: 8b ea ldi r24, 0xAB ; 171d60c: 99 e0 ldi r25, 0x09 ; 9d60e: 9f 93 push r25d610: 8f 93 push r24d612: 8c e2 ldi r24, 0x2C ; 44d614: 95 e1 ldi r25, 0x15 ; 21d616: 9f 93 push r25d618: 8f 93 push r24d61a: e0 91 78 06 lds r30, 0x0678d61e: f0 91 79 06 lds r31, 0x0679d622: 09 95 icalld624: 0f b6 in r0, 0x3f ; 63d626: f8 94 clid628: de bf out 0x3e, r29 ; 62d62a: 0f be out 0x3f, r0 ; 63d62c: cd bf out 0x3d, r28 ; 61d62e: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>else HoTT_printfxy(0,0," %2i:%02i %2i.%1iV %4imAh",FlugSekunden/60,FlugSekunden%60,UBat/10, UBat%10,Capacity.UsedCapacity);d632: 80 e0 ldi r24, 0x00 ; 0d634: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>d638: 80 91 1a 01 lds r24, 0x011Ad63c: 90 91 1b 01 lds r25, 0x011Bd640: 00 91 1a 01 lds r16, 0x011Ad644: 10 91 1b 01 lds r17, 0x011Bd648: e0 91 5e 04 lds r30, 0x045Ed64c: f0 91 5f 04 lds r31, 0x045Fd650: a9 e1 ldi r26, 0x19 ; 25d652: b5 e0 ldi r27, 0x05 ; 5d654: 11 96 adiw r26, 0x01 ; 1d656: 2c 91 ld r18, Xd658: 11 97 sbiw r26, 0x01 ; 1d65a: 2f 93 push r18d65c: 2c 91 ld r18, Xd65e: 2f 93 push r18d660: 2a e0 ldi r18, 0x0A ; 10d662: 30 e0 ldi r19, 0x00 ; 0d664: b9 01 movw r22, r18d666: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>d66a: 9f 93 push r25d66c: 8f 93 push r24d66e: c8 01 movw r24, r16d670: b9 01 movw r22, r18d672: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>d676: 7f 93 push r23d678: 6f 93 push r22d67a: 9f 01 movw r18, r30d67c: a9 e8 ldi r26, 0x89 ; 137d67e: b8 e8 ldi r27, 0x88 ; 136d680: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>d684: 96 95 lsr r25d686: 87 95 ror r24d688: 92 95 swap r25d68a: 82 95 swap r24d68c: 8f 70 andi r24, 0x0F ; 15d68e: 89 27 eor r24, r25d690: 9f 70 andi r25, 0x0F ; 15d692: 89 27 eor r24, r25d694: 4c e3 ldi r20, 0x3C ; 60d696: 48 9f mul r20, r24d698: 90 01 movw r18, r0d69a: 49 9f mul r20, r25d69c: 30 0d add r19, r0d69e: 11 24 eor r1, r1d6a0: cf 01 movw r24, r30d6a2: 82 1b sub r24, r18d6a4: 93 0b sbc r25, r19d6a6: 9f 93 push r25d6a8: 8f 93 push r24d6aa: 9f 01 movw r18, r30d6ac: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>d6b0: 96 95 lsr r25d6b2: 87 95 ror r24d6b4: 92 95 swap r25d6b6: 82 95 swap r24d6b8: 8f 70 andi r24, 0x0F ; 15d6ba: 89 27 eor r24, r25d6bc: 9f 70 andi r25, 0x0F ; 15d6be: 89 27 eor r24, r25d6c0: 9f 93 push r25d6c2: 8f 93 push r24d6c4: 80 e9 ldi r24, 0x90 ; 144d6c6: 99 e0 ldi r25, 0x09 ; 9d6c8: 9f 93 push r25d6ca: 8f 93 push r24d6cc: 8b e0 ldi r24, 0x0B ; 11d6ce: 95 e1 ldi r25, 0x15 ; 21d6d0: 9f 93 push r25d6d2: 8f 93 push r24d6d4: e0 91 78 06 lds r30, 0x0678d6d8: f0 91 79 06 lds r31, 0x0679d6dc: 09 95 icalld6de: 0f b6 in r0, 0x3f ; 63d6e0: f8 94 clid6e2: de bf out 0x3e, r29 ; 62d6e4: 0f be out 0x3f, r0 ; 63d6e6: cd bf out 0x3d, r28 ; 61d6e8: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>break;case 1:HoTT_printfxy(0,1,"DIR:%3d%c",CompassCorrected, HoTT_GRAD);d6ec: 85 e1 ldi r24, 0x15 ; 21d6ee: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>d6f2: 1f 92 push r1d6f4: 80 e6 ldi r24, 0x60 ; 96d6f6: 8f 93 push r24d6f8: 80 91 66 06 lds r24, 0x0666d6fc: 8f 93 push r24d6fe: 80 91 65 06 lds r24, 0x0665d702: 8f 93 push r24d704: 86 e8 ldi r24, 0x86 ; 134d706: 99 e0 ldi r25, 0x09 ; 9d708: 9f 93 push r25d70a: 8f 93 push r24d70c: 8b e0 ldi r24, 0x0B ; 11d70e: 95 e1 ldi r25, 0x15 ; 21d710: 9f 93 push r25d712: 8f 93 push r24d714: e0 91 78 06 lds r30, 0x0678d718: f0 91 79 06 lds r31, 0x0679d71c: 09 95 icallif(Parameter_GlobalConfig & CFG_HOEHENREGELUNG)d71e: 80 91 5c 06 lds r24, 0x065Cd722: 0f b6 in r0, 0x3f ; 63d724: f8 94 clid726: de bf out 0x3e, r29 ; 62d728: 0f be out 0x3f, r0 ; 63d72a: cd bf out 0x3d, r28 ; 61d72c: 80 ff sbrs r24, 0d72e: 52 c0 rjmp .+164 ; 0xd7d4 <HoTT_Menu+0xb96>{if(HoehenReglerAktiv) HoTT_printfxy_INV(10,1,"ALT:%4im", (int16_t)(HoehenWert/100))d730: 80 91 1b 04 lds r24, 0x041Bd734: 88 23 and r24, r24d736: 39 f1 breq .+78 ; 0xd786 <HoTT_Menu+0xb48>d738: 8f e1 ldi r24, 0x1F ; 31d73a: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>d73e: 60 91 fe 03 lds r22, 0x03FEd742: 70 91 ff 03 lds r23, 0x03FFd746: 80 91 00 04 lds r24, 0x0400d74a: 90 91 01 04 lds r25, 0x0401d74e: 24 e6 ldi r18, 0x64 ; 100d750: 30 e0 ldi r19, 0x00 ; 0d752: 40 e0 ldi r20, 0x00 ; 0d754: 50 e0 ldi r21, 0x00 ; 0d756: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>d75a: 3f 93 push r19d75c: 2f 93 push r18d75e: 8d e7 ldi r24, 0x7D ; 125d760: 99 e0 ldi r25, 0x09 ; 9d762: 9f 93 push r25d764: 8f 93 push r24d766: 8b e1 ldi r24, 0x1B ; 27d768: 95 e1 ldi r25, 0x15 ; 21d76a: 9f 93 push r25d76c: 8f 93 push r24d76e: e0 91 78 06 lds r30, 0x0678d772: f0 91 79 06 lds r31, 0x0679d776: 09 95 icalld778: 0f 90 pop r0d77a: 0f 90 pop r0d77c: 0f 90 pop r0d77e: 0f 90 pop r0d780: 0f 90 pop r0d782: 0f 90 pop r0d784: 3b c0 rjmp .+118 ; 0xd7fc <HoTT_Menu+0xbbe>else HoTT_printfxy(10,1,"ALT:%4im", (int16_t)(HoehenWert/100))d786: 8f e1 ldi r24, 0x1F ; 31d788: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>d78c: 60 91 fe 03 lds r22, 0x03FEd790: 70 91 ff 03 lds r23, 0x03FFd794: 80 91 00 04 lds r24, 0x0400d798: 90 91 01 04 lds r25, 0x0401d79c: 24 e6 ldi r18, 0x64 ; 100d79e: 30 e0 ldi r19, 0x00 ; 0d7a0: 40 e0 ldi r20, 0x00 ; 0d7a2: 50 e0 ldi r21, 0x00 ; 0d7a4: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>d7a8: 3f 93 push r19d7aa: 2f 93 push r18d7ac: 84 e7 ldi r24, 0x74 ; 116d7ae: 99 e0 ldi r25, 0x09 ; 9d7b0: 9f 93 push r25d7b2: 8f 93 push r24d7b4: 8b e0 ldi r24, 0x0B ; 11d7b6: 95 e1 ldi r25, 0x15 ; 21d7b8: 9f 93 push r25d7ba: 8f 93 push r24d7bc: e0 91 78 06 lds r30, 0x0678d7c0: f0 91 79 06 lds r31, 0x0679d7c4: 09 95 icalld7c6: 0f 90 pop r0d7c8: 0f 90 pop r0d7ca: 0f 90 pop r0d7cc: 0f 90 pop r0d7ce: 0f 90 pop r0d7d0: 0f 90 pop r0d7d2: 14 c0 rjmp .+40 ; 0xd7fc <HoTT_Menu+0xbbe>}else HoTT_printfxy(10,1,"ALT:---- ");d7d4: 8f e1 ldi r24, 0x1F ; 31d7d6: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>d7da: 8a e6 ldi r24, 0x6A ; 106d7dc: 99 e0 ldi r25, 0x09 ; 9d7de: 9f 93 push r25d7e0: 8f 93 push r24d7e2: 8b e0 ldi r24, 0x0B ; 11d7e4: 95 e1 ldi r25, 0x15 ; 21d7e6: 9f 93 push r25d7e8: 8f 93 push r24d7ea: e0 91 78 06 lds r30, 0x0678d7ee: f0 91 79 06 lds r31, 0x0679d7f2: 09 95 icalld7f4: 0f 90 pop r0d7f6: 0f 90 pop r0d7f8: 0f 90 pop r0d7fa: 0f 90 pop r0HoTT_printfxy(20,1,"%c",VarioCharacter);d7fc: 89 e2 ldi r24, 0x29 ; 41d7fe: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>d802: 80 91 20 01 lds r24, 0x0120d806: 1f 92 push r1d808: 8f 93 push r24d80a: 87 e6 ldi r24, 0x67 ; 103d80c: 99 e0 ldi r25, 0x09 ; 9d80e: 9f 93 push r25d810: 8f 93 push r24d812: 8b e0 ldi r24, 0x0B ; 11d814: 95 e1 ldi r25, 0x15 ; 21d816: 9f 93 push r25d818: 8f 93 push r24d81a: e0 91 78 06 lds r30, 0x0678d81e: f0 91 79 06 lds r31, 0x0679d822: 09 95 icallbreak;d824: 0f 90 pop r0d826: 0f 90 pop r0d828: 0f 90 pop r0d82a: 0f 90 pop r0d82c: 0f 90 pop r0d82e: 0f 90 pop r0d830: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>case 2:if(NaviDataOkay)d834: 80 91 a4 02 lds r24, 0x02A4d838: 88 23 and r24, r24d83a: a1 f1 breq .+104 ; 0xd8a4 <HoTT_Menu+0xc66>{HoTT_printfxy(1,2,"HM:%3d%c DIST:%3dm %c", GPSInfo.HomeBearing, HoTT_GRAD, GPSInfo.HomeDistance/10, NC_GPS_ModeCharacter);d83c: 8b e2 ldi r24, 0x2B ; 43d83e: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>d842: 80 91 96 02 lds r24, 0x0296d846: 1f 92 push r1d848: 8f 93 push r24d84a: 20 91 db 08 lds r18, 0x08DBd84e: 30 91 dc 08 lds r19, 0x08DCd852: ad ec ldi r26, 0xCD ; 205d854: bc ec ldi r27, 0xCC ; 204d856: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>d85a: 96 95 lsr r25d85c: 87 95 ror r24d85e: 96 95 lsr r25d860: 87 95 ror r24d862: 96 95 lsr r25d864: 87 95 ror r24d866: 9f 93 push r25d868: 8f 93 push r24d86a: 1f 92 push r1d86c: 80 e6 ldi r24, 0x60 ; 96d86e: 8f 93 push r24d870: ed ed ldi r30, 0xDD ; 221d872: f8 e0 ldi r31, 0x08 ; 8d874: 81 81 ldd r24, Z+1 ; 0x01d876: 8f 93 push r24d878: 80 81 ld r24, Zd87a: 8f 93 push r24d87c: 80 e5 ldi r24, 0x50 ; 80d87e: 99 e0 ldi r25, 0x09 ; 9d880: 9f 93 push r25d882: 8f 93 push r24d884: 8b e0 ldi r24, 0x0B ; 11d886: 95 e1 ldi r25, 0x15 ; 21d888: 9f 93 push r25d88a: 8f 93 push r24d88c: e0 91 78 06 lds r30, 0x0678d890: f0 91 79 06 lds r31, 0x0679d894: 09 95 icalld896: 0f b6 in r0, 0x3f ; 63d898: f8 94 clid89a: de bf out 0x3e, r29 ; 62d89c: 0f be out 0x3f, r0 ; 63d89e: cd bf out 0x3d, r28 ; 61d8a0: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>}else{Hott_ClearLine(2);d8a4: 82 e0 ldi r24, 0x02 ; 2d8a6: 0e 94 b4 60 call 0xc168 ; 0xc168 <Hott_ClearLine>d8aa: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>}break;case 3:HoTT_printfxy(0,3,"PWR:%2i.%1iA (%iW) ",Capacity.ActualCurrent/10, Capacity.ActualCurrent%10,Capacity.ActualPower);d8ae: 8f e3 ldi r24, 0x3F ; 63d8b0: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>d8b4: 40 91 15 05 lds r20, 0x0515d8b8: 50 91 16 05 lds r21, 0x0516d8bc: e7 e1 ldi r30, 0x17 ; 23d8be: f5 e0 ldi r31, 0x05 ; 5d8c0: 81 81 ldd r24, Z+1 ; 0x01d8c2: 8f 93 push r24d8c4: 80 81 ld r24, Zd8c6: 8f 93 push r24d8c8: 9a 01 movw r18, r20d8ca: ad ec ldi r26, 0xCD ; 205d8cc: bc ec ldi r27, 0xCC ; 204d8ce: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>d8d2: 96 95 lsr r25d8d4: 87 95 ror r24d8d6: 96 95 lsr r25d8d8: 87 95 ror r24d8da: 96 95 lsr r25d8dc: 87 95 ror r24d8de: 9c 01 movw r18, r24d8e0: 22 0f add r18, r18d8e2: 33 1f adc r19, r19d8e4: 88 0f add r24, r24d8e6: 99 1f adc r25, r25d8e8: 88 0f add r24, r24d8ea: 99 1f adc r25, r25d8ec: 88 0f add r24, r24d8ee: 99 1f adc r25, r25d8f0: 82 0f add r24, r18d8f2: 93 1f adc r25, r19d8f4: fa 01 movw r30, r20d8f6: e8 1b sub r30, r24d8f8: f9 0b sbc r31, r25d8fa: cf 01 movw r24, r30d8fc: 9f 93 push r25d8fe: ef 93 push r30d900: 9a 01 movw r18, r20d902: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>d906: 96 95 lsr r25d908: 87 95 ror r24d90a: 96 95 lsr r25d90c: 87 95 ror r24d90e: 96 95 lsr r25d910: 87 95 ror r24d912: 9f 93 push r25d914: 8f 93 push r24d916: 8c e3 ldi r24, 0x3C ; 60d918: 99 e0 ldi r25, 0x09 ; 9d91a: 9f 93 push r25d91c: 8f 93 push r24d91e: 8b e0 ldi r24, 0x0B ; 11d920: 95 e1 ldi r25, 0x15 ; 21d922: 9f 93 push r25d924: 8f 93 push r24d926: e0 91 78 06 lds r30, 0x0678d92a: f0 91 79 06 lds r31, 0x0679d92e: 09 95 icallif(FC_StatusFlags2 & FC_STATUS2_CAREFREE) HoTT_printfxy_INV(19,3,"CF") else HoTT_printfxy(19,3," ");d930: 80 91 ca 03 lds r24, 0x03CAd934: 0f b6 in r0, 0x3f ; 63d936: f8 94 clid938: de bf out 0x3e, r29 ; 62d93a: 0f be out 0x3f, r0 ; 63d93c: cd bf out 0x3d, r28 ; 61d93e: 80 ff sbrs r24, 0d940: 16 c0 rjmp .+44 ; 0xd96e <HoTT_Menu+0xd30>d942: 82 e5 ldi r24, 0x52 ; 82d944: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>d948: 89 e3 ldi r24, 0x39 ; 57d94a: 99 e0 ldi r25, 0x09 ; 9d94c: 9f 93 push r25d94e: 8f 93 push r24d950: 8b e1 ldi r24, 0x1B ; 27d952: 95 e1 ldi r25, 0x15 ; 21d954: 9f 93 push r25d956: 8f 93 push r24d958: e0 91 78 06 lds r30, 0x0678d95c: f0 91 79 06 lds r31, 0x0679d960: 09 95 icalld962: 0f 90 pop r0d964: 0f 90 pop r0d966: 0f 90 pop r0d968: 0f 90 pop r0d96a: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>d96e: 82 e5 ldi r24, 0x52 ; 82d970: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>d974: 86 e3 ldi r24, 0x36 ; 54d976: 99 e0 ldi r25, 0x09 ; 9d978: 9f 93 push r25d97a: 8f 93 push r24d97c: 8b e0 ldi r24, 0x0B ; 11d97e: 95 e1 ldi r25, 0x15 ; 21d980: 9f 93 push r25d982: 8f 93 push r24d984: e0 91 78 06 lds r30, 0x0678d988: f0 91 79 06 lds r31, 0x0679d98c: 09 95 icalld98e: 0f 90 pop r0d990: 0f 90 pop r0d992: 0f 90 pop r0d994: 0f 90 pop r0d996: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>break;case 4:if(NaviDataOkay)d99a: 80 91 a4 02 lds r24, 0x02A4d99e: 88 23 and r24, r24d9a0: 09 f4 brne .+2 ; 0xd9a4 <HoTT_Menu+0xd66>d9a2: 66 c0 rjmp .+204 ; 0xda70 <HoTT_Menu+0xe32>{HoTT_printfxy(0,4,"GPS:%2um/s SAT:%d ",GPSInfo.Speed,GPSInfo.NumOfSats);d9a4: 84 e5 ldi r24, 0x54 ; 84d9a6: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>d9aa: 80 91 d8 08 lds r24, 0x08D8d9ae: 1f 92 push r1d9b0: 8f 93 push r24d9b2: 80 91 da 08 lds r24, 0x08DAd9b6: 1f 92 push r1d9b8: 8f 93 push r24d9ba: 83 e2 ldi r24, 0x23 ; 35d9bc: 99 e0 ldi r25, 0x09 ; 9d9be: 9f 93 push r25d9c0: 8f 93 push r24d9c2: 8b e0 ldi r24, 0x0B ; 11d9c4: 95 e1 ldi r25, 0x15 ; 21d9c6: 9f 93 push r25d9c8: 8f 93 push r24d9ca: e0 91 78 06 lds r30, 0x0678d9ce: f0 91 79 06 lds r31, 0x0679d9d2: 09 95 icallswitch (GPSInfo.SatFix)d9d4: 0f b6 in r0, 0x3f ; 63d9d6: f8 94 clid9d8: de bf out 0x3e, r29 ; 62d9da: 0f be out 0x3f, r0 ; 63d9dc: cd bf out 0x3d, r28 ; 61d9de: 80 91 d9 08 lds r24, 0x08D9d9e2: 83 30 cpi r24, 0x03 ; 3d9e4: a9 f4 brne .+42 ; 0xda10 <HoTT_Menu+0xdd2>{case SATFIX_3D:HoTT_printfxy(16,4," 3D ");d9e6: 84 e6 ldi r24, 0x64 ; 100d9e8: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>d9ec: 8d e1 ldi r24, 0x1D ; 29d9ee: 99 e0 ldi r25, 0x09 ; 9d9f0: 9f 93 push r25d9f2: 8f 93 push r24d9f4: 8b e0 ldi r24, 0x0B ; 11d9f6: 95 e1 ldi r25, 0x15 ; 21d9f8: 9f 93 push r25d9fa: 8f 93 push r24d9fc: e0 91 78 06 lds r30, 0x0678da00: f0 91 79 06 lds r31, 0x0679da04: 09 95 icallbreak;da06: 0f 90 pop r0da08: 0f 90 pop r0da0a: 0f 90 pop r0da0c: 0f 90 pop r0da0e: 14 c0 rjmp .+40 ; 0xda38 <HoTT_Menu+0xdfa>//case SATFIX_2D://case SATFIX_NONE:default:HoTT_printfxy_BLINK(16,4,"NOFIX");da10: 84 e6 ldi r24, 0x64 ; 100da12: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>da16: 87 e1 ldi r24, 0x17 ; 23da18: 99 e0 ldi r25, 0x09 ; 9da1a: 9f 93 push r25da1c: 8f 93 push r24da1e: 8c e2 ldi r24, 0x2C ; 44da20: 95 e1 ldi r25, 0x15 ; 21da22: 9f 93 push r25da24: 8f 93 push r24da26: e0 91 78 06 lds r30, 0x0678da2a: f0 91 79 06 lds r31, 0x0679da2e: 09 95 icallbreak;da30: 0f 90 pop r0da32: 0f 90 pop r0da34: 0f 90 pop r0da36: 0f 90 pop r0}if(GPSInfo.Flags & FLAG_DIFFSOLN)da38: 80 91 d7 08 lds r24, 0x08D7da3c: 81 fd sbrc r24, 1da3e: 02 c0 rjmp .+4 ; 0xda44 <HoTT_Menu+0xe06>da40: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>{HoTT_printfxy(16,4,"DGPS ");da44: 84 e6 ldi r24, 0x64 ; 100da46: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>da4a: 81 e1 ldi r24, 0x11 ; 17da4c: 99 e0 ldi r25, 0x09 ; 9da4e: 9f 93 push r25da50: 8f 93 push r24da52: 8b e0 ldi r24, 0x0B ; 11da54: 95 e1 ldi r25, 0x15 ; 21da56: 9f 93 push r25da58: 8f 93 push r24da5a: e0 91 78 06 lds r30, 0x0678da5e: f0 91 79 06 lds r31, 0x0679da62: 09 95 icallda64: 0f 90 pop r0da66: 0f 90 pop r0da68: 0f 90 pop r0da6a: 0f 90 pop r0da6c: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>}}else{ //012345678901234567890HoTT_printfxy(0,4," No NaviCtrl ");da70: 84 e5 ldi r24, 0x54 ; 84da72: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>da76: 8b ef ldi r24, 0xFB ; 251da78: 98 e0 ldi r25, 0x08 ; 8da7a: 9f 93 push r25da7c: 8f 93 push r24da7e: 8b e0 ldi r24, 0x0B ; 11da80: 95 e1 ldi r25, 0x15 ; 21da82: 9f 93 push r25da84: 8f 93 push r24da86: e0 91 78 06 lds r30, 0x0678da8a: f0 91 79 06 lds r31, 0x0679da8e: 09 95 icallda90: 0f 90 pop r0da92: 0f 90 pop r0da94: 0f 90 pop r0da96: 0f 90 pop r0da98: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>}break;case 5:if(show_current)da9c: 80 91 73 04 lds r24, 0x0473daa0: 88 23 and r24, r24daa2: 09 f4 brne .+2 ; 0xdaa6 <HoTT_Menu+0xe68>daa4: c6 c0 rjmp .+396 ; 0xdc32 <HoTT_Menu+0xff4>{// HoTT_printfxy(0,5,"%2i.%i %2i.%i %2i.%i %2i.%iA", Motor[0].Current/10,Motor[0].Current%10,Motor[1].Current/10,Motor[1].Current%10,Motor[2].Current/10,Motor[2].Current%10,Motor[3].Current/10,Motor[3].Current%10);HoTT_printfxy(0,5,"%2i.%i %2i.%i %2i.%i %2i.%iA", BL3_Current(0)/10,BL3_Current(0)%10,BL3_Current(1)/10,BL3_Current(1)%10,BL3_Current(2)/10,BL3_Current(2)%10,BL3_Current(3)/10,BL3_Current(3)%10);daa6: 89 e6 ldi r24, 0x69 ; 105daa8: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>daac: 40 90 78 06 lds r4, 0x0678dab0: 50 90 79 06 lds r5, 0x0679dab4: 83 e0 ldi r24, 0x03 ; 3dab6: 0e 94 ce 21 call 0x439c ; 0x439c <BL3_Current>daba: 6c 01 movw r12, r24dabc: 83 e0 ldi r24, 0x03 ; 3dabe: 0e 94 ce 21 call 0x439c ; 0x439c <BL3_Current>dac2: 4c 01 movw r8, r24dac4: 82 e0 ldi r24, 0x02 ; 2dac6: 0e 94 ce 21 call 0x439c ; 0x439c <BL3_Current>daca: 7c 01 movw r14, r24dacc: 82 e0 ldi r24, 0x02 ; 2dace: 0e 94 ce 21 call 0x439c ; 0x439c <BL3_Current>dad2: 5c 01 movw r10, r24dad4: 81 e0 ldi r24, 0x01 ; 1dad6: 0e 94 ce 21 call 0x439c ; 0x439c <BL3_Current>dada: 8c 01 movw r16, r24dadc: 81 e0 ldi r24, 0x01 ; 1dade: 0e 94 ce 21 call 0x439c ; 0x439c <BL3_Current>dae2: 3c 01 movw r6, r24dae4: 80 e0 ldi r24, 0x00 ; 0dae6: 0e 94 ce 21 call 0x439c ; 0x439c <BL3_Current>daea: 1c 01 movw r2, r24daec: 80 e0 ldi r24, 0x00 ; 0daee: 0e 94 ce 21 call 0x439c ; 0x439c <BL3_Current>daf2: ac 01 movw r20, r24daf4: 96 01 movw r18, r12daf6: ad ec ldi r26, 0xCD ; 205daf8: bc ec ldi r27, 0xCC ; 204dafa: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>dafe: 96 95 lsr r25db00: 87 95 ror r24db02: 96 95 lsr r25db04: 87 95 ror r24db06: 96 95 lsr r25db08: 87 95 ror r24db0a: 9c 01 movw r18, r24db0c: 22 0f add r18, r18db0e: 33 1f adc r19, r19db10: 88 0f add r24, r24db12: 99 1f adc r25, r25db14: 88 0f add r24, r24db16: 99 1f adc r25, r25db18: 88 0f add r24, r24db1a: 99 1f adc r25, r25db1c: 82 0f add r24, r18db1e: 93 1f adc r25, r19db20: c8 1a sub r12, r24db22: d9 0a sbc r13, r25db24: df 92 push r13db26: cf 92 push r12db28: 94 01 movw r18, r8db2a: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>db2e: 96 95 lsr r25db30: 87 95 ror r24db32: 96 95 lsr r25db34: 87 95 ror r24db36: 96 95 lsr r25db38: 87 95 ror r24db3a: 9f 93 push r25db3c: 8f 93 push r24db3e: 97 01 movw r18, r14db40: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>db44: 96 95 lsr r25db46: 87 95 ror r24db48: 96 95 lsr r25db4a: 87 95 ror r24db4c: 96 95 lsr r25db4e: 87 95 ror r24db50: 9c 01 movw r18, r24db52: 22 0f add r18, r18db54: 33 1f adc r19, r19db56: 88 0f add r24, r24db58: 99 1f adc r25, r25db5a: 88 0f add r24, r24db5c: 99 1f adc r25, r25db5e: 88 0f add r24, r24db60: 99 1f adc r25, r25db62: 82 0f add r24, r18db64: 93 1f adc r25, r19db66: e8 1a sub r14, r24db68: f9 0a sbc r15, r25db6a: ff 92 push r15db6c: ef 92 push r14db6e: 95 01 movw r18, r10db70: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>db74: 96 95 lsr r25db76: 87 95 ror r24db78: 96 95 lsr r25db7a: 87 95 ror r24db7c: 96 95 lsr r25db7e: 87 95 ror r24db80: 9f 93 push r25db82: 8f 93 push r24db84: 98 01 movw r18, r16db86: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>db8a: 96 95 lsr r25db8c: 87 95 ror r24db8e: 96 95 lsr r25db90: 87 95 ror r24db92: 96 95 lsr r25db94: 87 95 ror r24db96: 9c 01 movw r18, r24db98: 22 0f add r18, r18db9a: 33 1f adc r19, r19db9c: 88 0f add r24, r24db9e: 99 1f adc r25, r25dba0: 88 0f add r24, r24dba2: 99 1f adc r25, r25dba4: 88 0f add r24, r24dba6: 99 1f adc r25, r25dba8: 82 0f add r24, r18dbaa: 93 1f adc r25, r19dbac: 08 1b sub r16, r24dbae: 19 0b sbc r17, r25dbb0: 1f 93 push r17dbb2: 0f 93 push r16dbb4: 93 01 movw r18, r6dbb6: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>dbba: 96 95 lsr r25dbbc: 87 95 ror r24dbbe: 96 95 lsr r25dbc0: 87 95 ror r24dbc2: 96 95 lsr r25dbc4: 87 95 ror r24dbc6: 9f 93 push r25dbc8: 8f 93 push r24dbca: 91 01 movw r18, r2dbcc: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>dbd0: 96 95 lsr r25dbd2: 87 95 ror r24dbd4: 96 95 lsr r25dbd6: 87 95 ror r24dbd8: 96 95 lsr r25dbda: 87 95 ror r24dbdc: 9c 01 movw r18, r24dbde: 22 0f add r18, r18dbe0: 33 1f adc r19, r19dbe2: 88 0f add r24, r24dbe4: 99 1f adc r25, r25dbe6: 88 0f add r24, r24dbe8: 99 1f adc r25, r25dbea: 88 0f add r24, r24dbec: 99 1f adc r25, r25dbee: 82 0f add r24, r18dbf0: 93 1f adc r25, r19dbf2: 28 1a sub r2, r24dbf4: 39 0a sbc r3, r25dbf6: 3f 92 push r3dbf8: 2f 92 push r2dbfa: 9a 01 movw r18, r20dbfc: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>dc00: 96 95 lsr r25dc02: 87 95 ror r24dc04: 96 95 lsr r25dc06: 87 95 ror r24dc08: 96 95 lsr r25dc0a: 87 95 ror r24dc0c: 9f 93 push r25dc0e: 8f 93 push r24dc10: 8e ed ldi r24, 0xDE ; 222dc12: 98 e0 ldi r25, 0x08 ; 8dc14: 9f 93 push r25dc16: 8f 93 push r24dc18: 8b e0 ldi r24, 0x0B ; 11dc1a: 95 e1 ldi r25, 0x15 ; 21dc1c: 9f 93 push r25dc1e: 8f 93 push r24dc20: f2 01 movw r30, r4dc22: 09 95 icalldc24: 0f b6 in r0, 0x3f ; 63dc26: f8 94 clidc28: de bf out 0x3e, r29 ; 62dc2a: 0f be out 0x3f, r0 ; 63dc2c: cd bf out 0x3d, r28 ; 61dc2e: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>}else{HoTT_printfxy(0,5,"%3i %3i %3i %3i%cC", Motor[0].Temperature, Motor[1].Temperature, Motor[2].Temperature, Motor[3].Temperature,HoTT_GRAD);dc32: 89 e6 ldi r24, 0x69 ; 105dc34: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>dc38: 1f 92 push r1dc3a: 80 e6 ldi r24, 0x60 ; 96dc3c: 8f 93 push r24dc3e: 80 91 cb 09 lds r24, 0x09CBdc42: 1f 92 push r1dc44: 8f 93 push r24dc46: 80 91 bc 09 lds r24, 0x09BCdc4a: 1f 92 push r1dc4c: 8f 93 push r24dc4e: 80 91 ad 09 lds r24, 0x09ADdc52: 1f 92 push r1dc54: 8f 93 push r24dc56: 80 91 9e 09 lds r24, 0x099Edc5a: 1f 92 push r1dc5c: 8f 93 push r24dc5e: 8b ec ldi r24, 0xCB ; 203dc60: 98 e0 ldi r25, 0x08 ; 8dc62: 9f 93 push r25dc64: 8f 93 push r24dc66: 8b e0 ldi r24, 0x0B ; 11dc68: 95 e1 ldi r25, 0x15 ; 21dc6a: 9f 93 push r25dc6c: 8f 93 push r24dc6e: e0 91 78 06 lds r30, 0x0678dc72: f0 91 79 06 lds r31, 0x0679dc76: 09 95 icalldc78: 0f b6 in r0, 0x3f ; 63dc7a: f8 94 clidc7c: de bf out 0x3e, r29 ; 62dc7e: 0f be out 0x3f, r0 ; 63dc80: cd bf out 0x3d, r28 ; 61dc82: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>}break;case 6:if(show_current)dc86: 80 91 73 04 lds r24, 0x0473dc8a: 88 23 and r24, r24dc8c: 09 f4 brne .+2 ; 0xdc90 <HoTT_Menu+0x1052>dc8e: 4a c1 rjmp .+660 ; 0xdf24 <HoTT_Menu+0x12e6>{if(RequiredMotors == 4) Hott_ClearLine(6);dc90: 80 91 3d 05 lds r24, 0x053Ddc94: 84 30 cpi r24, 0x04 ; 4dc96: 29 f4 brne .+10 ; 0xdca2 <HoTT_Menu+0x1064>dc98: 86 e0 ldi r24, 0x06 ; 6dc9a: 0e 94 b4 60 call 0xc168 ; 0xc168 <Hott_ClearLine>dc9e: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>else// if(RequiredMotors == 6) HoTT_printfxy(0,6,"%2i.%i %2i.%iA", Motor[4].Current/10,Motor[4].Current%10,Motor[5].Current/10,Motor[5].Current%10)if(RequiredMotors == 6) HoTT_printfxy(0,6,"%2i.%i %2i.%iA", BL3_Current(4)/10,BL3_Current(4)%10, BL3_Current(5)/10,BL3_Current(5)%10)dca2: 86 30 cpi r24, 0x06 ; 6dca4: 09 f0 breq .+2 ; 0xdca8 <HoTT_Menu+0x106a>dca6: 42 c0 rjmp .+132 ; 0xdd2c <HoTT_Menu+0x10ee>dca8: 8e e7 ldi r24, 0x7E ; 126dcaa: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>dcae: a0 90 78 06 lds r10, 0x0678dcb2: b0 90 79 06 lds r11, 0x0679dcb6: 85 e0 ldi r24, 0x05 ; 5dcb8: 0e 94 ce 21 call 0x439c ; 0x439c <BL3_Current>dcbc: 6c 01 movw r12, r24dcbe: 85 e0 ldi r24, 0x05 ; 5dcc0: 0e 94 ce 21 call 0x439c ; 0x439c <BL3_Current>dcc4: 7c 01 movw r14, r24dcc6: 84 e0 ldi r24, 0x04 ; 4dcc8: 0e 94 ce 21 call 0x439c ; 0x439c <BL3_Current>dccc: 8c 01 movw r16, r24dcce: 84 e0 ldi r24, 0x04 ; 4dcd0: 0e 94 ce 21 call 0x439c ; 0x439c <BL3_Current>dcd4: fc 01 movw r30, r24dcd6: 2a e0 ldi r18, 0x0A ; 10dcd8: 30 e0 ldi r19, 0x00 ; 0dcda: c6 01 movw r24, r12dcdc: b9 01 movw r22, r18dcde: 0e 94 42 b1 call 0x16284 ; 0x16284 <__udivmodhi4>dce2: 9f 93 push r25dce4: 8f 93 push r24dce6: c7 01 movw r24, r14dce8: b9 01 movw r22, r18dcea: 0e 94 42 b1 call 0x16284 ; 0x16284 <__udivmodhi4>dcee: 7f 93 push r23dcf0: 6f 93 push r22dcf2: c8 01 movw r24, r16dcf4: b9 01 movw r22, r18dcf6: 0e 94 42 b1 call 0x16284 ; 0x16284 <__udivmodhi4>dcfa: 9f 93 push r25dcfc: 8f 93 push r24dcfe: cf 01 movw r24, r30dd00: b9 01 movw r22, r18dd02: 0e 94 42 b1 call 0x16284 ; 0x16284 <__udivmodhi4>dd06: 7f 93 push r23dd08: 6f 93 push r22dd0a: 8c eb ldi r24, 0xBC ; 188dd0c: 98 e0 ldi r25, 0x08 ; 8dd0e: 9f 93 push r25dd10: 8f 93 push r24dd12: 8b e0 ldi r24, 0x0B ; 11dd14: 95 e1 ldi r25, 0x15 ; 21dd16: 9f 93 push r25dd18: 8f 93 push r24dd1a: f5 01 movw r30, r10dd1c: 09 95 icalldd1e: 0f b6 in r0, 0x3f ; 63dd20: f8 94 clidd22: de bf out 0x3e, r29 ; 62dd24: 0f be out 0x3f, r0 ; 63dd26: cd bf out 0x3d, r28 ; 61dd28: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>else// if(RequiredMotors > 6) HoTT_printfxy(0,6,"%2i.%i %2i.%i %2i.%i %2i.%iA", Motor[4].Current/10,Motor[4].Current%10,Motor[5].Current/10,Motor[5].Current%10,Motor[6].Current/10,Motor[6].Current%10,Motor[7].Current/10,Motor[7].Current%10);if(RequiredMotors > 6) HoTT_printfxy(0,6,"%2i.%i %2i.%i %2i.%i %2i.%iA", BL3_Current(4)/10,BL3_Current(4)%10,BL3_Current(5)/10,BL3_Current(5)%10,BL3_Current(6)/10,BL3_Current(6)%10,BL3_Current(7)/10,BL3_Current(7)%10,BL3_Current(8)/10,BL3_Current(8)%10);dd2c: 87 30 cpi r24, 0x07 ; 7dd2e: 10 f4 brcc .+4 ; 0xdd34 <HoTT_Menu+0x10f6>dd30: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>dd34: 8e e7 ldi r24, 0x7E ; 126dd36: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>dd3a: 80 91 78 06 lds r24, 0x0678dd3e: 90 91 79 06 lds r25, 0x0679dd42: 9a 83 std Y+2, r25 ; 0x02dd44: 89 83 std Y+1, r24 ; 0x01dd46: 88 e0 ldi r24, 0x08 ; 8dd48: 0e 94 ce 21 call 0x439c ; 0x439c <BL3_Current>dd4c: 5c 01 movw r10, r24dd4e: 88 e0 ldi r24, 0x08 ; 8dd50: 0e 94 ce 21 call 0x439c ; 0x439c <BL3_Current>dd54: 4c 01 movw r8, r24dd56: 87 e0 ldi r24, 0x07 ; 7dd58: 0e 94 ce 21 call 0x439c ; 0x439c <BL3_Current>dd5c: 6c 01 movw r12, r24dd5e: 87 e0 ldi r24, 0x07 ; 7dd60: 0e 94 ce 21 call 0x439c ; 0x439c <BL3_Current>dd64: 3c 01 movw r6, r24dd66: 86 e0 ldi r24, 0x06 ; 6dd68: 0e 94 ce 21 call 0x439c ; 0x439c <BL3_Current>dd6c: 7c 01 movw r14, r24dd6e: 86 e0 ldi r24, 0x06 ; 6dd70: 0e 94 ce 21 call 0x439c ; 0x439c <BL3_Current>dd74: 2c 01 movw r4, r24dd76: 85 e0 ldi r24, 0x05 ; 5dd78: 0e 94 ce 21 call 0x439c ; 0x439c <BL3_Current>dd7c: 8c 01 movw r16, r24dd7e: 85 e0 ldi r24, 0x05 ; 5dd80: 0e 94 ce 21 call 0x439c ; 0x439c <BL3_Current>dd84: 1c 01 movw r2, r24dd86: 84 e0 ldi r24, 0x04 ; 4dd88: 0e 94 ce 21 call 0x439c ; 0x439c <BL3_Current>dd8c: 9c 83 std Y+4, r25 ; 0x04dd8e: 8b 83 std Y+3, r24 ; 0x03dd90: 84 e0 ldi r24, 0x04 ; 4dd92: 0e 94 ce 21 call 0x439c ; 0x439c <BL3_Current>dd96: ac 01 movw r20, r24dd98: 95 01 movw r18, r10dd9a: ad ec ldi r26, 0xCD ; 205dd9c: bc ec ldi r27, 0xCC ; 204dd9e: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>dda2: 96 95 lsr r25dda4: 87 95 ror r24dda6: 96 95 lsr r25dda8: 87 95 ror r24ddaa: 96 95 lsr r25ddac: 87 95 ror r24ddae: 9c 01 movw r18, r24ddb0: 22 0f add r18, r18ddb2: 33 1f adc r19, r19ddb4: 88 0f add r24, r24ddb6: 99 1f adc r25, r25ddb8: 88 0f add r24, r24ddba: 99 1f adc r25, r25ddbc: 88 0f add r24, r24ddbe: 99 1f adc r25, r25ddc0: 82 0f add r24, r18ddc2: 93 1f adc r25, r19ddc4: a8 1a sub r10, r24ddc6: b9 0a sbc r11, r25ddc8: bf 92 push r11ddca: af 92 push r10ddcc: 94 01 movw r18, r8ddce: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>ddd2: 96 95 lsr r25ddd4: 87 95 ror r24ddd6: 96 95 lsr r25ddd8: 87 95 ror r24ddda: 96 95 lsr r25dddc: 87 95 ror r24ddde: 9f 93 push r25dde0: 8f 93 push r24dde2: 96 01 movw r18, r12dde4: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>dde8: 96 95 lsr r25ddea: 87 95 ror r24ddec: 96 95 lsr r25ddee: 87 95 ror r24ddf0: 96 95 lsr r25ddf2: 87 95 ror r24ddf4: 9c 01 movw r18, r24ddf6: 22 0f add r18, r18ddf8: 33 1f adc r19, r19ddfa: 88 0f add r24, r24ddfc: 99 1f adc r25, r25ddfe: 88 0f add r24, r24de00: 99 1f adc r25, r25de02: 88 0f add r24, r24de04: 99 1f adc r25, r25de06: 82 0f add r24, r18de08: 93 1f adc r25, r19de0a: c8 1a sub r12, r24de0c: d9 0a sbc r13, r25de0e: df 92 push r13de10: cf 92 push r12de12: 93 01 movw r18, r6de14: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>de18: 96 95 lsr r25de1a: 87 95 ror r24de1c: 96 95 lsr r25de1e: 87 95 ror r24de20: 96 95 lsr r25de22: 87 95 ror r24de24: 9f 93 push r25de26: 8f 93 push r24de28: 97 01 movw r18, r14de2a: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>de2e: 96 95 lsr r25de30: 87 95 ror r24de32: 96 95 lsr r25de34: 87 95 ror r24de36: 96 95 lsr r25de38: 87 95 ror r24de3a: 9c 01 movw r18, r24de3c: 22 0f add r18, r18de3e: 33 1f adc r19, r19de40: 88 0f add r24, r24de42: 99 1f adc r25, r25de44: 88 0f add r24, r24de46: 99 1f adc r25, r25de48: 88 0f add r24, r24de4a: 99 1f adc r25, r25de4c: 82 0f add r24, r18de4e: 93 1f adc r25, r19de50: e8 1a sub r14, r24de52: f9 0a sbc r15, r25de54: ff 92 push r15de56: ef 92 push r14de58: 92 01 movw r18, r4de5a: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>de5e: 96 95 lsr r25de60: 87 95 ror r24de62: 96 95 lsr r25de64: 87 95 ror r24de66: 96 95 lsr r25de68: 87 95 ror r24de6a: 9f 93 push r25de6c: 8f 93 push r24de6e: 98 01 movw r18, r16de70: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>de74: 96 95 lsr r25de76: 87 95 ror r24de78: 96 95 lsr r25de7a: 87 95 ror r24de7c: 96 95 lsr r25de7e: 87 95 ror r24de80: 9c 01 movw r18, r24de82: 22 0f add r18, r18de84: 33 1f adc r19, r19de86: 88 0f add r24, r24de88: 99 1f adc r25, r25de8a: 88 0f add r24, r24de8c: 99 1f adc r25, r25de8e: 88 0f add r24, r24de90: 99 1f adc r25, r25de92: 82 0f add r24, r18de94: 93 1f adc r25, r19de96: 08 1b sub r16, r24de98: 19 0b sbc r17, r25de9a: 1f 93 push r17de9c: 0f 93 push r16de9e: 91 01 movw r18, r2dea0: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>dea4: 96 95 lsr r25dea6: 87 95 ror r24dea8: 96 95 lsr r25deaa: 87 95 ror r24deac: 96 95 lsr r25deae: 87 95 ror r24deb0: 9f 93 push r25deb2: 8f 93 push r24deb4: 2b 81 ldd r18, Y+3 ; 0x03deb6: 3c 81 ldd r19, Y+4 ; 0x04deb8: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>debc: 96 95 lsr r25debe: 87 95 ror r24dec0: 96 95 lsr r25dec2: 87 95 ror r24dec4: 96 95 lsr r25dec6: 87 95 ror r24dec8: 9c 01 movw r18, r24deca: 22 0f add r18, r18decc: 33 1f adc r19, r19dece: 88 0f add r24, r24ded0: 99 1f adc r25, r25ded2: 88 0f add r24, r24ded4: 99 1f adc r25, r25ded6: 88 0f add r24, r24ded8: 99 1f adc r25, r25deda: 82 0f add r24, r18dedc: 93 1f adc r25, r19dede: 2b 81 ldd r18, Y+3 ; 0x03dee0: 3c 81 ldd r19, Y+4 ; 0x04dee2: 28 1b sub r18, r24dee4: 39 0b sbc r19, r25dee6: 3f 93 push r19dee8: 2f 93 push r18deea: 9a 01 movw r18, r20deec: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>def0: 96 95 lsr r25def2: 87 95 ror r24def4: 96 95 lsr r25def6: 87 95 ror r24def8: 96 95 lsr r25defa: 87 95 ror r24defc: 9f 93 push r25defe: 8f 93 push r24df00: 8f e9 ldi r24, 0x9F ; 159df02: 98 e0 ldi r25, 0x08 ; 8df04: 9f 93 push r25df06: 8f 93 push r24df08: 8b e0 ldi r24, 0x0B ; 11df0a: 95 e1 ldi r25, 0x15 ; 21df0c: 9f 93 push r25df0e: 8f 93 push r24df10: e9 81 ldd r30, Y+1 ; 0x01df12: fa 81 ldd r31, Y+2 ; 0x02df14: 09 95 icalldf16: 0f b6 in r0, 0x3f ; 63df18: f8 94 clidf1a: de bf out 0x3e, r29 ; 62df1c: 0f be out 0x3f, r0 ; 63df1e: cd bf out 0x3d, r28 ; 61df20: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>}else{if(RequiredMotors == 4) Hott_ClearLine(6);df24: 80 91 3d 05 lds r24, 0x053Ddf28: 84 30 cpi r24, 0x04 ; 4df2a: 29 f4 brne .+10 ; 0xdf36 <HoTT_Menu+0x12f8>df2c: 86 e0 ldi r24, 0x06 ; 6df2e: 0e 94 b4 60 call 0xc168 ; 0xc168 <Hott_ClearLine>df32: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>elseif(RequiredMotors == 6) HoTT_printfxy(0,6,"%3i %3i%cC ", Motor[4].Temperature, Motor[5].Temperature,HoTT_GRAD)df36: 86 30 cpi r24, 0x06 ; 6df38: 11 f5 brne .+68 ; 0xdf7e <HoTT_Menu+0x1340>df3a: 8e e7 ldi r24, 0x7E ; 126df3c: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>df40: 1f 92 push r1df42: 80 e6 ldi r24, 0x60 ; 96df44: 8f 93 push r24df46: 80 91 e9 09 lds r24, 0x09E9df4a: 1f 92 push r1df4c: 8f 93 push r24df4e: 80 91 da 09 lds r24, 0x09DAdf52: 1f 92 push r1df54: 8f 93 push r24df56: 8c e8 ldi r24, 0x8C ; 140df58: 98 e0 ldi r25, 0x08 ; 8df5a: 9f 93 push r25df5c: 8f 93 push r24df5e: 8b e0 ldi r24, 0x0B ; 11df60: 95 e1 ldi r25, 0x15 ; 21df62: 9f 93 push r25df64: 8f 93 push r24df66: e0 91 78 06 lds r30, 0x0678df6a: f0 91 79 06 lds r31, 0x0679df6e: 09 95 icalldf70: 0f b6 in r0, 0x3f ; 63df72: f8 94 clidf74: de bf out 0x3e, r29 ; 62df76: 0f be out 0x3f, r0 ; 63df78: cd bf out 0x3d, r28 ; 61df7a: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>elseif(RequiredMotors > 6) HoTT_printfxy(0,6,"%3i %3i %3i %3i%cC", Motor[4].Temperature, Motor[5].Temperature, Motor[6].Temperature, Motor[7].Temperature,HoTT_GRAD);df7e: 87 30 cpi r24, 0x07 ; 7df80: 10 f4 brcc .+4 ; 0xdf86 <HoTT_Menu+0x1348>df82: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>df86: 8e e7 ldi r24, 0x7E ; 126df88: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>df8c: 1f 92 push r1df8e: 80 e6 ldi r24, 0x60 ; 96df90: 8f 93 push r24df92: 80 91 07 0a lds r24, 0x0A07df96: 1f 92 push r1df98: 8f 93 push r24df9a: 80 91 f8 09 lds r24, 0x09F8df9e: 1f 92 push r1dfa0: 8f 93 push r24dfa2: 80 91 e9 09 lds r24, 0x09E9dfa6: 1f 92 push r1dfa8: 8f 93 push r24dfaa: 80 91 da 09 lds r24, 0x09DAdfae: 1f 92 push r1dfb0: 8f 93 push r24dfb2: 89 e7 ldi r24, 0x79 ; 121dfb4: 98 e0 ldi r25, 0x08 ; 8dfb6: 9f 93 push r25dfb8: 8f 93 push r24dfba: 8b e0 ldi r24, 0x0B ; 11dfbc: 95 e1 ldi r25, 0x15 ; 21dfbe: 9f 93 push r25dfc0: 8f 93 push r24dfc2: e0 91 78 06 lds r30, 0x0678dfc6: f0 91 79 06 lds r31, 0x0679dfca: 09 95 icalldfcc: 0f b6 in r0, 0x3f ; 63dfce: f8 94 clidfd0: de bf out 0x3e, r29 ; 62dfd2: 0f be out 0x3f, r0 ; 63dfd4: cd bf out 0x3d, r28 ; 61dfd6: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>}break;case 7: if(NC_ErrorCode)dfda: 80 91 bb 04 lds r24, 0x04BBdfde: 88 23 and r24, r24dfe0: 09 f4 brne .+2 ; 0xdfe4 <HoTT_Menu+0x13a6>dfe2: 4f c0 rjmp .+158 ; 0xe082 <HoTT_Menu+0x1444>{if(HoTTBlink && NC_ErrorCode < MAX_ERR_NUMBER)dfe4: 90 91 ed 02 lds r25, 0x02EDdfe8: 99 23 and r25, r25dfea: 09 f1 breq .+66 ; 0xe02e <HoTT_Menu+0x13f0>dfec: 83 32 cpi r24, 0x23 ; 35dfee: f8 f4 brcc .+62 ; 0xe02e <HoTT_Menu+0x13f0>{Hott_ClearLine(7);dff0: 87 e0 ldi r24, 0x07 ; 7dff2: 0e 94 b4 60 call 0xc168 ; 0xc168 <Hott_ClearLine>HoTT_printfxy_INV(0,7,"ERR: %2d !",NC_ErrorCode);dff6: 83 e9 ldi r24, 0x93 ; 147dff8: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>dffc: 80 91 bb 04 lds r24, 0x04BBe000: 1f 92 push r1e002: 8f 93 push r24e004: 8e e6 ldi r24, 0x6E ; 110e006: 98 e0 ldi r25, 0x08 ; 8e008: 9f 93 push r25e00a: 8f 93 push r24e00c: 8b e1 ldi r24, 0x1B ; 27e00e: 95 e1 ldi r25, 0x15 ; 21e010: 9f 93 push r25e012: 8f 93 push r24e014: e0 91 78 06 lds r30, 0x0678e018: f0 91 79 06 lds r31, 0x0679e01c: 09 95 icalle01e: 0f 90 pop r0e020: 0f 90 pop r0e022: 0f 90 pop r0e024: 0f 90 pop r0e026: 0f 90 pop r0e028: 0f 90 pop r0e02a: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>}else{HoTT_printfxy(0,7,"ERR: "); _printf_P(&LIBFC_HoTT_Putchar, NC_ERROR_TEXT[NC_ErrorCode] , 0);};e02e: 83 e9 ldi r24, 0x93 ; 147e030: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>e034: 88 e6 ldi r24, 0x68 ; 104e036: 98 e0 ldi r25, 0x08 ; 8e038: 9f 93 push r25e03a: 8f 93 push r24e03c: 0b e0 ldi r16, 0x0B ; 11e03e: 15 e1 ldi r17, 0x15 ; 21e040: 1f 93 push r17e042: 0f 93 push r16e044: e0 91 78 06 lds r30, 0x0678e048: f0 91 79 06 lds r31, 0x0679e04c: 09 95 icalle04e: 1f 92 push r1e050: 1f 92 push r1e052: 80 91 bb 04 lds r24, 0x04BBe056: f1 e1 ldi r31, 0x11 ; 17e058: 8f 9f mul r24, r31e05a: c0 01 movw r24, r0e05c: 11 24 eor r1, r1e05e: 84 59 subi r24, 0x94 ; 148e060: 94 4f sbci r25, 0xF4 ; 244e062: 9f 93 push r25e064: 8f 93 push r24e066: 1f 93 push r17e068: 0f 93 push r16e06a: e0 91 78 06 lds r30, 0x0678e06e: f0 91 79 06 lds r31, 0x0679e072: 09 95 icalle074: 0f b6 in r0, 0x3f ; 63e076: f8 94 clie078: de bf out 0x3e, r29 ; 62e07a: 0f be out 0x3f, r0 ; 63e07c: cd bf out 0x3d, r28 ; 61e07e: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>}elseif(FC_StatusFlags & FC_STATUS_LOWBAT) HoTT_printfxy(1,7,"!! LiPo voltage !!")e082: 80 91 cb 03 lds r24, 0x03CBe086: 85 ff sbrs r24, 5e088: 16 c0 rjmp .+44 ; 0xe0b6 <HoTT_Menu+0x1478>e08a: 84 e9 ldi r24, 0x94 ; 148e08c: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>e090: 85 e5 ldi r24, 0x55 ; 85e092: 98 e0 ldi r25, 0x08 ; 8e094: 9f 93 push r25e096: 8f 93 push r24e098: 8b e0 ldi r24, 0x0B ; 11e09a: 95 e1 ldi r25, 0x15 ; 21e09c: 9f 93 push r25e09e: 8f 93 push r24e0a0: e0 91 78 06 lds r30, 0x0678e0a4: f0 91 79 06 lds r31, 0x0679e0a8: 09 95 icalle0aa: 0f 90 pop r0e0ac: 0f 90 pop r0e0ae: 0f 90 pop r0e0b0: 0f 90 pop r0e0b2: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>else HoTT_printfxy(0,7," www.MikroKopter.de ");e0b6: 83 e9 ldi r24, 0x93 ; 147e0b8: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>e0bc: 8f e3 ldi r24, 0x3F ; 63e0be: 98 e0 ldi r25, 0x08 ; 8e0c0: 9f 93 push r25e0c2: 8f 93 push r24e0c4: 8b e0 ldi r24, 0x0B ; 11e0c6: 95 e1 ldi r25, 0x15 ; 21e0c8: 9f 93 push r25e0ca: 8f 93 push r24e0cc: e0 91 78 06 lds r30, 0x0678e0d0: f0 91 79 06 lds r31, 0x0679e0d4: 09 95 icalle0d6: 0f 90 pop r0e0d8: 0f 90 pop r0e0da: 0f 90 pop r0e0dc: 0f 90 pop r0e0de: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>case 12:case 13:case 14:case 15:case 16:if(HottKeyboard == HOTT_KEY_SET) { if(show_current) show_current = 0; else show_current = 1; Hott_ClearLine(5); Hott_ClearLine(6);}e0e2: 80 91 a9 0c lds r24, 0x0CA9e0e6: 86 30 cpi r24, 0x06 ; 6e0e8: 89 f4 brne .+34 ; 0xe10c <HoTT_Menu+0x14ce>e0ea: 80 91 73 04 lds r24, 0x0473e0ee: 88 23 and r24, r24e0f0: 19 f0 breq .+6 ; 0xe0f8 <HoTT_Menu+0x14ba>e0f2: 10 92 73 04 sts 0x0473, r1e0f6: 03 c0 rjmp .+6 ; 0xe0fe <HoTT_Menu+0x14c0>e0f8: 81 e0 ldi r24, 0x01 ; 1e0fa: 80 93 73 04 sts 0x0473, r24e0fe: 85 e0 ldi r24, 0x05 ; 5e100: 0e 94 b4 60 call 0xc168 ; 0xc168 <Hott_ClearLine>e104: 86 e0 ldi r24, 0x06 ; 6e106: 0e 94 b4 60 call 0xc168 ; 0xc168 <Hott_ClearLine>e10a: 12 c0 rjmp .+36 ; 0xe130 <HoTT_Menu+0x14f2>elseif(HottKeyboard == HOTT_KEY_LEFT) { LIBFC_HoTT_Clear(); page = 2; line = 0;}e10c: 88 30 cpi r24, 0x08 ; 8e10e: 41 f4 brne .+16 ; 0xe120 <HoTT_Menu+0x14e2>e110: 0e 94 3a 15 call 0x2a74 ; 0x2a74 <LIBFC_HoTT_Clear>e114: 82 e0 ldi r24, 0x02 ; 2e116: 80 93 76 04 sts 0x0476, r24e11a: 10 92 75 04 sts 0x0475, r1e11e: 08 c0 rjmp .+16 ; 0xe130 <HoTT_Menu+0x14f2>elseif(HottKeyboard == HOTT_KEY_RIGHT) { LIBFC_HoTT_Clear(); page = 0; line = 0;}e120: 81 30 cpi r24, 0x01 ; 1e122: 31 f4 brne .+12 ; 0xe130 <HoTT_Menu+0x14f2>e124: 0e 94 3a 15 call 0x2a74 ; 0x2a74 <LIBFC_HoTT_Clear>e128: 10 92 76 04 sts 0x0476, r1e12c: 10 92 75 04 sts 0x0475, r1//if(HottKeyboard) HoTT_printfxy(15,6,"%KEY:%02x ",HottKeyboard);HottKeyboard = 0;e130: 10 92 a9 0c sts 0x0CA9, r1break;e134: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>default: line = 0;e138: 10 92 75 04 sts 0x0475, r1break;e13c: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>}break;case 2:switch(line++)e140: 80 91 75 04 lds r24, 0x0475e144: 91 e0 ldi r25, 0x01 ; 1e146: 98 0f add r25, r24e148: 90 93 75 04 sts 0x0475, r25e14c: 90 e0 ldi r25, 0x00 ; 0e14e: 81 31 cpi r24, 0x11 ; 17e150: 91 05 cpc r25, r1e152: 08 f0 brcs .+2 ; 0xe156 <HoTT_Menu+0x1518>e154: 65 c3 rjmp .+1738 ; 0xe820 <HoTT_Menu+0x1be2>e156: fc 01 movw r30, r24e158: ef 57 subi r30, 0x7F ; 127e15a: ff 4f sbci r31, 0xFF ; 255e15c: 0c 94 a7 b1 jmp 0x1634e ; 0x1634e <__tablejump2__>{case 0:HoTT_printfxy_INV(0,0,"Setting:%u %s ",ActiveParamSet,EE_Parameter.Name);e160: 80 e0 ldi r24, 0x00 ; 0e162: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>e166: 8a eb ldi r24, 0xBA ; 186e168: 95 e0 ldi r25, 0x05 ; 5e16a: 9f 93 push r25e16c: 8f 93 push r24e16e: 80 91 52 01 lds r24, 0x0152e172: 1f 92 push r1e174: 8f 93 push r24e176: 80 e3 ldi r24, 0x30 ; 48e178: 98 e0 ldi r25, 0x08 ; 8e17a: 9f 93 push r25e17c: 8f 93 push r24e17e: 8b e1 ldi r24, 0x1B ; 27e180: 95 e1 ldi r25, 0x15 ; 21e182: 9f 93 push r25e184: 8f 93 push r24e186: e0 91 78 06 lds r30, 0x0678e18a: f0 91 79 06 lds r31, 0x0679e18e: 09 95 icallbreak;e190: 0f b6 in r0, 0x3f ; 63e192: f8 94 clie194: de bf out 0x3e, r29 ; 62e196: 0f be out 0x3f, r0 ; 63e198: cd bf out 0x3d, r28 ; 61e19a: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>case 1: HoTT_printfxy(0,1,"Min:%2i.%1iV %s ",BattLowVoltageWarning/10, BattLowVoltageWarning%10, Mixer.Name);e19e: 85 e1 ldi r24, 0x15 ; 21e1a0: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>e1a4: 20 91 53 01 lds r18, 0x0153e1a8: 88 ec ldi r24, 0xC8 ; 200e1aa: 95 e0 ldi r25, 0x05 ; 5e1ac: 9f 93 push r25e1ae: 8f 93 push r24e1b0: 8d ec ldi r24, 0xCD ; 205e1b2: 28 9f mul r18, r24e1b4: 81 2d mov r24, r1e1b6: 11 24 eor r1, r1e1b8: 86 95 lsr r24e1ba: 86 95 lsr r24e1bc: 86 95 lsr r24e1be: 98 2f mov r25, r24e1c0: 99 0f add r25, r25e1c2: 39 2f mov r19, r25e1c4: 33 0f add r19, r19e1c6: 33 0f add r19, r19e1c8: 93 0f add r25, r19e1ca: 29 1b sub r18, r25e1cc: 1f 92 push r1e1ce: 2f 93 push r18e1d0: 1f 92 push r1e1d2: 8f 93 push r24e1d4: 8f e1 ldi r24, 0x1F ; 31e1d6: 98 e0 ldi r25, 0x08 ; 8e1d8: 9f 93 push r25e1da: 8f 93 push r24e1dc: 8b e0 ldi r24, 0x0B ; 11e1de: 95 e1 ldi r25, 0x15 ; 21e1e0: 9f 93 push r25e1e2: 8f 93 push r24e1e4: e0 91 78 06 lds r30, 0x0678e1e8: f0 91 79 06 lds r31, 0x0679e1ec: 09 95 icallbreak;e1ee: 0f b6 in r0, 0x3f ; 63e1f0: f8 94 clie1f2: de bf out 0x3e, r29 ; 62e1f4: 0f be out 0x3f, r0 ; 63e1f6: cd bf out 0x3d, r28 ; 61e1f8: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>case 2: HoTT_printfxy(0,2,"ALT:");e1fc: 8a e2 ldi r24, 0x2A ; 42e1fe: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>e202: 8a e1 ldi r24, 0x1A ; 26e204: 98 e0 ldi r25, 0x08 ; 8e206: 9f 93 push r25e208: 8f 93 push r24e20a: 8b e0 ldi r24, 0x0B ; 11e20c: 95 e1 ldi r25, 0x15 ; 21e20e: 9f 93 push r25e210: 8f 93 push r24e212: e0 91 78 06 lds r30, 0x0678e216: f0 91 79 06 lds r31, 0x0679e21a: 09 95 icallif(Parameter_GlobalConfig & CFG_HOEHENREGELUNG)e21c: 80 91 5c 06 lds r24, 0x065Ce220: 0f 90 pop r0e222: 0f 90 pop r0e224: 0f 90 pop r0e226: 0f 90 pop r0e228: 80 ff sbrs r24, 0e22a: 7a c0 rjmp .+244 ; 0xe320 <HoTT_Menu+0x16e2>{if(!(EE_Parameter.GlobalConfig & CFG_HOEHEN_SCHALTER)) HoTT_printf("POTI:%3u ", Parameter_HoehenSchalter)e22c: 80 91 4b 05 lds r24, 0x054Be230: 81 fd sbrc r24, 1e232: 19 c0 rjmp .+50 ; 0xe266 <HoTT_Menu+0x1628>e234: 80 91 e1 03 lds r24, 0x03E1e238: 1f 92 push r1e23a: 8f 93 push r24e23c: 80 e1 ldi r24, 0x10 ; 16e23e: 98 e0 ldi r25, 0x08 ; 8e240: 9f 93 push r25e242: 8f 93 push r24e244: 8b e0 ldi r24, 0x0B ; 11e246: 95 e1 ldi r25, 0x15 ; 21e248: 9f 93 push r25e24a: 8f 93 push r24e24c: e0 91 78 06 lds r30, 0x0678e250: f0 91 79 06 lds r31, 0x0679e254: 09 95 icalle256: 0f 90 pop r0e258: 0f 90 pop r0e25a: 0f 90 pop r0e25c: 0f 90 pop r0e25e: 0f 90 pop r0e260: 0f 90 pop r0e262: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>else{if(Parameter_HoehenSchalter > 50) HoTT_printf("(ON) ") else HoTT_printf("(OFF) ");e266: 80 91 e1 03 lds r24, 0x03E1e26a: 83 33 cpi r24, 0x33 ; 51e26c: 90 f0 brcs .+36 ; 0xe292 <HoTT_Menu+0x1654>e26e: 89 e0 ldi r24, 0x09 ; 9e270: 98 e0 ldi r25, 0x08 ; 8e272: 9f 93 push r25e274: 8f 93 push r24e276: 8b e0 ldi r24, 0x0B ; 11e278: 95 e1 ldi r25, 0x15 ; 21e27a: 9f 93 push r25e27c: 8f 93 push r24e27e: e0 91 78 06 lds r30, 0x0678e282: f0 91 79 06 lds r31, 0x0679e286: 09 95 icalle288: 0f 90 pop r0e28a: 0f 90 pop r0e28c: 0f 90 pop r0e28e: 0f 90 pop r0e290: 11 c0 rjmp .+34 ; 0xe2b4 <HoTT_Menu+0x1676>e292: 82 e0 ldi r24, 0x02 ; 2e294: 98 e0 ldi r25, 0x08 ; 8e296: 9f 93 push r25e298: 8f 93 push r24e29a: 8b e0 ldi r24, 0x0B ; 11e29c: 95 e1 ldi r25, 0x15 ; 21e29e: 9f 93 push r25e2a0: 8f 93 push r24e2a2: e0 91 78 06 lds r30, 0x0678e2a6: f0 91 79 06 lds r31, 0x0679e2aa: 09 95 icalle2ac: 0f 90 pop r0e2ae: 0f 90 pop r0e2b0: 0f 90 pop r0e2b2: 0f 90 pop r0if((Parameter_ExtraConfig & CFG2_HEIGHT_LIMIT)) HoTT_printf("LIMIT", Parameter_HoehenSchalter)e2b4: 80 91 40 06 lds r24, 0x0640e2b8: 80 ff sbrs r24, 0e2ba: 19 c0 rjmp .+50 ; 0xe2ee <HoTT_Menu+0x16b0>e2bc: 80 91 e1 03 lds r24, 0x03E1e2c0: 1f 92 push r1e2c2: 8f 93 push r24e2c4: 8c ef ldi r24, 0xFC ; 252e2c6: 97 e0 ldi r25, 0x07 ; 7e2c8: 9f 93 push r25e2ca: 8f 93 push r24e2cc: 8b e0 ldi r24, 0x0B ; 11e2ce: 95 e1 ldi r25, 0x15 ; 21e2d0: 9f 93 push r25e2d2: 8f 93 push r24e2d4: e0 91 78 06 lds r30, 0x0678e2d8: f0 91 79 06 lds r31, 0x0679e2dc: 09 95 icalle2de: 0f 90 pop r0e2e0: 0f 90 pop r0e2e2: 0f 90 pop r0e2e4: 0f 90 pop r0e2e6: 0f 90 pop r0e2e8: 0f 90 pop r0e2ea: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>else HoTT_printf("VARIO", Parameter_HoehenSchalter);e2ee: 80 91 e1 03 lds r24, 0x03E1e2f2: 1f 92 push r1e2f4: 8f 93 push r24e2f6: 86 ef ldi r24, 0xF6 ; 246e2f8: 97 e0 ldi r25, 0x07 ; 7e2fa: 9f 93 push r25e2fc: 8f 93 push r24e2fe: 8b e0 ldi r24, 0x0B ; 11e300: 95 e1 ldi r25, 0x15 ; 21e302: 9f 93 push r25e304: 8f 93 push r24e306: e0 91 78 06 lds r30, 0x0678e30a: f0 91 79 06 lds r31, 0x0679e30e: 09 95 icalle310: 0f 90 pop r0e312: 0f 90 pop r0e314: 0f 90 pop r0e316: 0f 90 pop r0e318: 0f 90 pop r0e31a: 0f 90 pop r0e31c: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>}}elseHoTT_printf("DISABLED");e320: 8d ee ldi r24, 0xED ; 237e322: 97 e0 ldi r25, 0x07 ; 7e324: 9f 93 push r25e326: 8f 93 push r24e328: 8b e0 ldi r24, 0x0B ; 11e32a: 95 e1 ldi r25, 0x15 ; 21e32c: 9f 93 push r25e32e: 8f 93 push r24e330: e0 91 78 06 lds r30, 0x0678e334: f0 91 79 06 lds r31, 0x0679e338: 09 95 icalle33a: 0f 90 pop r0e33c: 0f 90 pop r0e33e: 0f 90 pop r0e340: 0f 90 pop r0e342: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>break;case 3: HoTT_printfxy(0,3,"CF:");e346: 8f e3 ldi r24, 0x3F ; 63e348: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>e34c: 89 ee ldi r24, 0xE9 ; 233e34e: 97 e0 ldi r25, 0x07 ; 7e350: 9f 93 push r25e352: 8f 93 push r24e354: 8b e0 ldi r24, 0x0B ; 11e356: 95 e1 ldi r25, 0x15 ; 21e358: 9f 93 push r25e35a: 8f 93 push r24e35c: e0 91 78 06 lds r30, 0x0678e360: f0 91 79 06 lds r31, 0x0679e364: 09 95 icallif(!EE_Parameter.CareFreeChannel) HoTT_printf("DISABLED")e366: 0f 90 pop r0e368: 0f 90 pop r0e36a: 0f 90 pop r0e36c: 0f 90 pop r0e36e: 80 91 a2 05 lds r24, 0x05A2e372: 81 11 cpse r24, r1e374: 13 c0 rjmp .+38 ; 0xe39c <HoTT_Menu+0x175e>e376: 80 ee ldi r24, 0xE0 ; 224e378: 97 e0 ldi r25, 0x07 ; 7e37a: 9f 93 push r25e37c: 8f 93 push r24e37e: 8b e0 ldi r24, 0x0B ; 11e380: 95 e1 ldi r25, 0x15 ; 21e382: 9f 93 push r25e384: 8f 93 push r24e386: e0 91 78 06 lds r30, 0x0678e38a: f0 91 79 06 lds r31, 0x0679e38e: 09 95 icalle390: 0f 90 pop r0e392: 0f 90 pop r0e394: 0f 90 pop r0e396: 0f 90 pop r0e398: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>else{if(CareFree) HoTT_printf(" (ON) ") else HoTT_printf(" (OFF)");e39c: 80 91 d8 03 lds r24, 0x03D8e3a0: 88 23 and r24, r24e3a2: 91 f0 breq .+36 ; 0xe3c8 <HoTT_Menu+0x178a>e3a4: 89 ed ldi r24, 0xD9 ; 217e3a6: 97 e0 ldi r25, 0x07 ; 7e3a8: 9f 93 push r25e3aa: 8f 93 push r24e3ac: 8b e0 ldi r24, 0x0B ; 11e3ae: 95 e1 ldi r25, 0x15 ; 21e3b0: 9f 93 push r25e3b2: 8f 93 push r24e3b4: e0 91 78 06 lds r30, 0x0678e3b8: f0 91 79 06 lds r31, 0x0679e3bc: 09 95 icalle3be: 0f 90 pop r0e3c0: 0f 90 pop r0e3c2: 0f 90 pop r0e3c4: 0f 90 pop r0e3c6: 11 c0 rjmp .+34 ; 0xe3ea <HoTT_Menu+0x17ac>e3c8: 82 ed ldi r24, 0xD2 ; 210e3ca: 97 e0 ldi r25, 0x07 ; 7e3cc: 9f 93 push r25e3ce: 8f 93 push r24e3d0: 8b e0 ldi r24, 0x0B ; 11e3d2: 95 e1 ldi r25, 0x15 ; 21e3d4: 9f 93 push r25e3d6: 8f 93 push r24e3d8: e0 91 78 06 lds r30, 0x0678e3dc: f0 91 79 06 lds r31, 0x0679e3e0: 09 95 icalle3e2: 0f 90 pop r0e3e4: 0f 90 pop r0e3e6: 0f 90 pop r0e3e8: 0f 90 pop r0if(EE_Parameter.ExtraConfig & CFG_LEARNABLE_CAREFREE) HoTT_printf(" TEACH");e3ea: 80 91 b8 05 lds r24, 0x05B8e3ee: 86 fd sbrc r24, 6e3f0: 02 c0 rjmp .+4 ; 0xe3f6 <HoTT_Menu+0x17b8>e3f2: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>e3f6: 8b ec ldi r24, 0xCB ; 203e3f8: 97 e0 ldi r25, 0x07 ; 7e3fa: 9f 93 push r25e3fc: 8f 93 push r24e3fe: 8b e0 ldi r24, 0x0B ; 11e400: 95 e1 ldi r25, 0x15 ; 21e402: 9f 93 push r25e404: 8f 93 push r24e406: e0 91 78 06 lds r30, 0x0678e40a: f0 91 79 06 lds r31, 0x0679e40e: 09 95 icalle410: 0f 90 pop r0e412: 0f 90 pop r0e414: 0f 90 pop r0e416: 0f 90 pop r0e418: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>}break;case 4: HoTT_printfxy(0,4,"GPS:");e41c: 84 e5 ldi r24, 0x54 ; 84e41e: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>e422: 86 ec ldi r24, 0xC6 ; 198e424: 97 e0 ldi r25, 0x07 ; 7e426: 9f 93 push r25e428: 8f 93 push r24e42a: 8b e0 ldi r24, 0x0B ; 11e42c: 95 e1 ldi r25, 0x15 ; 21e42e: 9f 93 push r25e430: 8f 93 push r24e432: e0 91 78 06 lds r30, 0x0678e436: f0 91 79 06 lds r31, 0x0679e43a: 09 95 icallif(!(Parameter_GlobalConfig & CFG_GPS_AKTIV)) HoTT_printf("DISABLED")e43c: 80 91 5c 06 lds r24, 0x065Ce440: 0f 90 pop r0e442: 0f 90 pop r0e444: 0f 90 pop r0e446: 0f 90 pop r0e448: 85 fd sbrc r24, 5e44a: 12 c0 rjmp .+36 ; 0xe470 <HoTT_Menu+0x1832>e44c: 8d eb ldi r24, 0xBD ; 189e44e: 97 e0 ldi r25, 0x07 ; 7e450: 9f 93 push r25e452: 8f 93 push r24e454: 8b e0 ldi r24, 0x0B ; 11e456: 95 e1 ldi r25, 0x15 ; 21e458: 9f 93 push r25e45a: 8f 93 push r24e45c: e0 91 78 06 lds r30, 0x0678e460: f0 91 79 06 lds r31, 0x0679e464: 09 95 icalle466: 0f 90 pop r0e468: 0f 90 pop r0e46a: 0f 90 pop r0e46c: 0f 90 pop r0e46e: 53 c0 rjmp .+166 ; 0xe516 <HoTT_Menu+0x18d8>else{tmp = GetChannelValue(EE_Parameter.NaviGpsModeChannel);e470: 80 91 8f 05 lds r24, 0x058Fe474: 0e 94 0e 34 call 0x681c ; 0x681c <GetChannelValue>if(tmp < 50) HoTT_printf("(FREE)")e478: 82 33 cpi r24, 0x32 ; 50e47a: 90 f4 brcc .+36 ; 0xe4a0 <HoTT_Menu+0x1862>e47c: 86 eb ldi r24, 0xB6 ; 182e47e: 97 e0 ldi r25, 0x07 ; 7e480: 9f 93 push r25e482: 8f 93 push r24e484: 8b e0 ldi r24, 0x0B ; 11e486: 95 e1 ldi r25, 0x15 ; 21e488: 9f 93 push r25e48a: 8f 93 push r24e48c: e0 91 78 06 lds r30, 0x0678e490: f0 91 79 06 lds r31, 0x0679e494: 09 95 icalle496: 0f 90 pop r0e498: 0f 90 pop r0e49a: 0f 90 pop r0e49c: 0f 90 pop r0e49e: 3b c0 rjmp .+118 ; 0xe516 <HoTT_Menu+0x18d8>elseif(tmp >= 180) HoTT_printf("(HOME)")e4a0: 84 3b cpi r24, 0xB4 ; 180e4a2: 90 f0 brcs .+36 ; 0xe4c8 <HoTT_Menu+0x188a>e4a4: 8f ea ldi r24, 0xAF ; 175e4a6: 97 e0 ldi r25, 0x07 ; 7e4a8: 9f 93 push r25e4aa: 8f 93 push r24e4ac: 8b e0 ldi r24, 0x0B ; 11e4ae: 95 e1 ldi r25, 0x15 ; 21e4b0: 9f 93 push r25e4b2: 8f 93 push r24e4b4: e0 91 78 06 lds r30, 0x0678e4b8: f0 91 79 06 lds r31, 0x0679e4bc: 09 95 icalle4be: 0f 90 pop r0e4c0: 0f 90 pop r0e4c2: 0f 90 pop r0e4c4: 0f 90 pop r0e4c6: 27 c0 rjmp .+78 ; 0xe516 <HoTT_Menu+0x18d8>elseif(EE_Parameter.ExtraConfig & CFG_GPS_AID) HoTT_printf("(AID) ")e4c8: 80 91 b8 05 lds r24, 0x05B8e4cc: 85 ff sbrs r24, 5e4ce: 12 c0 rjmp .+36 ; 0xe4f4 <HoTT_Menu+0x18b6>e4d0: 88 ea ldi r24, 0xA8 ; 168e4d2: 97 e0 ldi r25, 0x07 ; 7e4d4: 9f 93 push r25e4d6: 8f 93 push r24e4d8: 8b e0 ldi r24, 0x0B ; 11e4da: 95 e1 ldi r25, 0x15 ; 21e4dc: 9f 93 push r25e4de: 8f 93 push r24e4e0: e0 91 78 06 lds r30, 0x0678e4e4: f0 91 79 06 lds r31, 0x0679e4e8: 09 95 icalle4ea: 0f 90 pop r0e4ec: 0f 90 pop r0e4ee: 0f 90 pop r0e4f0: 0f 90 pop r0e4f2: 11 c0 rjmp .+34 ; 0xe516 <HoTT_Menu+0x18d8>else HoTT_printf("(HOLD)")e4f4: 81 ea ldi r24, 0xA1 ; 161e4f6: 97 e0 ldi r25, 0x07 ; 7e4f8: 9f 93 push r25e4fa: 8f 93 push r24e4fc: 8b e0 ldi r24, 0x0B ; 11e4fe: 95 e1 ldi r25, 0x15 ; 21e500: 9f 93 push r25e502: 8f 93 push r24e504: e0 91 78 06 lds r30, 0x0678e508: f0 91 79 06 lds r31, 0x0679e50c: 09 95 icalle50e: 0f 90 pop r0e510: 0f 90 pop r0e512: 0f 90 pop r0e514: 0f 90 pop r0}if(EE_Parameter.FailSafeTime) HoTT_printfxy(10,4," FS:%usek ",EE_Parameter.FailSafeTime)e516: 80 91 a6 05 lds r24, 0x05A6e51a: 88 23 and r24, r24e51c: 11 f4 brne .+4 ; 0xe522 <HoTT_Menu+0x18e4>e51e: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>e522: 8e e5 ldi r24, 0x5E ; 94e524: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>e528: 80 91 a6 05 lds r24, 0x05A6e52c: 1f 92 push r1e52e: 8f 93 push r24e530: 86 e9 ldi r24, 0x96 ; 150e532: 97 e0 ldi r25, 0x07 ; 7e534: 9f 93 push r25e536: 8f 93 push r24e538: 8b e0 ldi r24, 0x0B ; 11e53a: 95 e1 ldi r25, 0x15 ; 21e53c: 9f 93 push r25e53e: 8f 93 push r24e540: e0 91 78 06 lds r30, 0x0678e544: f0 91 79 06 lds r31, 0x0679e548: 09 95 icalle54a: 0f 90 pop r0e54c: 0f 90 pop r0e54e: 0f 90 pop r0e550: 0f 90 pop r0e552: 0f 90 pop r0e554: 0f 90 pop r0e556: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>break;case 5: HoTT_printfxy(0,5,"HOME ALT:");e55a: 89 e6 ldi r24, 0x69 ; 105e55c: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>e560: 8c e8 ldi r24, 0x8C ; 140e562: 97 e0 ldi r25, 0x07 ; 7e564: 9f 93 push r25e566: 8f 93 push r24e568: 8b e0 ldi r24, 0x0B ; 11e56a: 95 e1 ldi r25, 0x15 ; 21e56c: 9f 93 push r25e56e: 8f 93 push r24e570: e0 91 78 06 lds r30, 0x0678e574: f0 91 79 06 lds r31, 0x0679e578: 09 95 icallif(EE_Parameter.ComingHomeAltitude) HoTT_printf("%um",EE_Parameter.ComingHomeAltitude) else HoTT_printf("HOLD ");e57a: 80 91 a5 05 lds r24, 0x05A5e57e: 0f 90 pop r0e580: 0f 90 pop r0e582: 0f 90 pop r0e584: 0f 90 pop r0e586: 88 23 and r24, r24e588: b9 f0 breq .+46 ; 0xe5b8 <HoTT_Menu+0x197a>e58a: 1f 92 push r1e58c: 8f 93 push r24e58e: 88 e8 ldi r24, 0x88 ; 136e590: 97 e0 ldi r25, 0x07 ; 7e592: 9f 93 push r25e594: 8f 93 push r24e596: 8b e0 ldi r24, 0x0B ; 11e598: 95 e1 ldi r25, 0x15 ; 21e59a: 9f 93 push r25e59c: 8f 93 push r24e59e: e0 91 78 06 lds r30, 0x0678e5a2: f0 91 79 06 lds r31, 0x0679e5a6: 09 95 icalle5a8: 0f 90 pop r0e5aa: 0f 90 pop r0e5ac: 0f 90 pop r0e5ae: 0f 90 pop r0e5b0: 0f 90 pop r0e5b2: 0f 90 pop r0e5b4: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>e5b8: 82 e8 ldi r24, 0x82 ; 130e5ba: 97 e0 ldi r25, 0x07 ; 7e5bc: 9f 93 push r25e5be: 8f 93 push r24e5c0: 8b e0 ldi r24, 0x0B ; 11e5c2: 95 e1 ldi r25, 0x15 ; 21e5c4: 9f 93 push r25e5c6: 8f 93 push r24e5c8: e0 91 78 06 lds r30, 0x0678e5cc: f0 91 79 06 lds r31, 0x0679e5d0: 09 95 icalle5d2: 0f 90 pop r0e5d4: 0f 90 pop r0e5d6: 0f 90 pop r0e5d8: 0f 90 pop r0e5da: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>break;case 6:if(!show_poti)e5de: 80 91 72 04 lds r24, 0x0472e5e2: 81 11 cpse r24, r1e5e4: 57 c0 rjmp .+174 ; 0xe694 <HoTT_Menu+0x1a56>{HoTT_printfxy(0,6,"Ni:%4i Ro:%4i C:%3i",PPM_in[EE_Parameter.Kanalbelegung[K_NICK]],PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]], Parameter_ServoNickControl);e5e6: 8e e7 ldi r24, 0x7E ; 126e5e8: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>e5ec: e0 91 40 05 lds r30, 0x0540e5f0: f0 e0 ldi r31, 0x00 ; 0e5f2: ee 0f add r30, r30e5f4: ff 1f adc r31, r31e5f6: ef 5c subi r30, 0xCF ; 207e5f8: f7 4f sbci r31, 0xF7 ; 247e5fa: 20 81 ld r18, Ze5fc: 31 81 ldd r19, Z+1 ; 0x01e5fe: e0 91 3f 05 lds r30, 0x053Fe602: f0 e0 ldi r31, 0x00 ; 0e604: ee 0f add r30, r30e606: ff 1f adc r31, r31e608: ef 5c subi r30, 0xCF ; 207e60a: f7 4f sbci r31, 0xF7 ; 247e60c: 80 81 ld r24, Ze60e: 91 81 ldd r25, Z+1 ; 0x01e610: 40 91 2f 01 lds r20, 0x012Fe614: 1f 92 push r1e616: 4f 93 push r20e618: 3f 93 push r19e61a: 2f 93 push r18e61c: 9f 93 push r25e61e: 8f 93 push r24e620: 8e e6 ldi r24, 0x6E ; 110e622: 97 e0 ldi r25, 0x07 ; 7e624: 9f 93 push r25e626: 8f 93 push r24e628: 0b e0 ldi r16, 0x0B ; 11e62a: 15 e1 ldi r17, 0x15 ; 21e62c: 1f 93 push r17e62e: 0f 93 push r16e630: e0 91 78 06 lds r30, 0x0678e634: f0 91 79 06 lds r31, 0x0679e638: 09 95 icallHoTT_printfxy(0,7,"Gs:%4i Ya:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_GAS]]+127,PPM_in[EE_Parameter.Kanalbelegung[K_GIER]]);e63a: 83 e9 ldi r24, 0x93 ; 147e63c: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>e640: e0 91 42 05 lds r30, 0x0542e644: f0 e0 ldi r31, 0x00 ; 0e646: ee 0f add r30, r30e648: ff 1f adc r31, r31e64a: ef 5c subi r30, 0xCF ; 207e64c: f7 4f sbci r31, 0xF7 ; 247e64e: 20 81 ld r18, Ze650: 31 81 ldd r19, Z+1 ; 0x01e652: e0 91 41 05 lds r30, 0x0541e656: f0 e0 ldi r31, 0x00 ; 0e658: ee 0f add r30, r30e65a: ff 1f adc r31, r31e65c: ef 5c subi r30, 0xCF ; 207e65e: f7 4f sbci r31, 0xF7 ; 247e660: 80 81 ld r24, Ze662: 91 81 ldd r25, Z+1 ; 0x01e664: 3f 93 push r19e666: 2f 93 push r18e668: 81 58 subi r24, 0x81 ; 129e66a: 9f 4f sbci r25, 0xFF ; 255e66c: 9f 93 push r25e66e: 8f 93 push r24e670: 8f e5 ldi r24, 0x5F ; 95e672: 97 e0 ldi r25, 0x07 ; 7e674: 9f 93 push r25e676: 8f 93 push r24e678: 1f 93 push r17e67a: 0f 93 push r16e67c: e0 91 78 06 lds r30, 0x0678e680: f0 91 79 06 lds r31, 0x0679e684: 09 95 icalle686: 0f b6 in r0, 0x3f ; 63e688: f8 94 clie68a: de bf out 0x3e, r29 ; 62e68c: 0f be out 0x3f, r0 ; 63e68e: cd bf out 0x3d, r28 ; 61e690: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>}else{HoTT_printfxy(0,6,"P1:%4i P2:%4i 3:%3i",Poti1,Poti2, Poti3);e694: 8e e7 ldi r24, 0x7E ; 126e696: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>e69a: 80 91 07 04 lds r24, 0x0407e69e: 1f 92 push r1e6a0: 8f 93 push r24e6a2: 80 91 06 04 lds r24, 0x0406e6a6: 1f 92 push r1e6a8: 8f 93 push r24e6aa: 80 91 05 04 lds r24, 0x0405e6ae: 1f 92 push r1e6b0: 8f 93 push r24e6b2: 8b e4 ldi r24, 0x4B ; 75e6b4: 97 e0 ldi r25, 0x07 ; 7e6b6: 9f 93 push r25e6b8: 8f 93 push r24e6ba: 0b e0 ldi r16, 0x0B ; 11e6bc: 15 e1 ldi r17, 0x15 ; 21e6be: 1f 93 push r17e6c0: 0f 93 push r16e6c2: e0 91 78 06 lds r30, 0x0678e6c6: f0 91 79 06 lds r31, 0x0679e6ca: 09 95 icallHoTT_printfxy(0,7,"P4:%4i P5:%4i 6:%3i",Poti4,Poti5, Poti6);e6cc: 83 e9 ldi r24, 0x93 ; 147e6ce: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>e6d2: 80 91 0a 04 lds r24, 0x040Ae6d6: 1f 92 push r1e6d8: 8f 93 push r24e6da: 80 91 09 04 lds r24, 0x0409e6de: 1f 92 push r1e6e0: 8f 93 push r24e6e2: 80 91 08 04 lds r24, 0x0408e6e6: 1f 92 push r1e6e8: 8f 93 push r24e6ea: 87 e3 ldi r24, 0x37 ; 55e6ec: 97 e0 ldi r25, 0x07 ; 7e6ee: 9f 93 push r25e6f0: 8f 93 push r24e6f2: 1f 93 push r17e6f4: 0f 93 push r16e6f6: e0 91 78 06 lds r30, 0x0678e6fa: f0 91 79 06 lds r31, 0x0679e6fe: 09 95 icalle700: 0f b6 in r0, 0x3f ; 63e702: f8 94 clie704: de bf out 0x3e, r29 ; 62e706: 0f be out 0x3f, r0 ; 63e708: cd bf out 0x3d, r28 ; 61e70a: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>}break;case 7: //HoTT_printfxy(0,6,"WARNINGS:");if(HoTTBlink)e70e: 80 91 ed 02 lds r24, 0x02EDe712: 88 23 and r24, r24e714: 11 f4 brne .+4 ; 0xe71a <HoTT_Menu+0x1adc>e716: 0c 94 99 7b jmp 0xf732 ; 0xf732 <HoTT_Menu+0x2af4>{LIBFC_HoTT_SetPos(6 * 21);e71a: 8e e7 ldi r24, 0x7E ; 126e71c: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>if(!(Parameter_GlobalConfig & CFG_ACHSENKOPPLUNG_AKTIV)) HoTT_printf_BLINK("COUPLING OFF! ");e720: 80 91 5c 06 lds r24, 0x065Ce724: 86 fd sbrc r24, 6e726: 11 c0 rjmp .+34 ; 0xe74a <HoTT_Menu+0x1b0c>e728: 88 e2 ldi r24, 0x28 ; 40e72a: 97 e0 ldi r25, 0x07 ; 7e72c: 9f 93 push r25e72e: 8f 93 push r24e730: 8c e2 ldi r24, 0x2C ; 44e732: 95 e1 ldi r25, 0x15 ; 21e734: 9f 93 push r25e736: 8f 93 push r24e738: e0 91 78 06 lds r30, 0x0678e73c: f0 91 79 06 lds r31, 0x0679e740: 09 95 icalle742: 0f 90 pop r0e744: 0f 90 pop r0e746: 0f 90 pop r0e748: 0f 90 pop r0if(EE_Parameter.BitConfig & (CFG_LOOP_LINKS | CFG_LOOP_RECHTS | CFG_LOOP_UNTEN | CFG_LOOP_OBEN)) HoTT_printf_BLINK("LOOPING! ");e74a: 80 91 b6 05 lds r24, 0x05B6e74e: 8f 70 andi r24, 0x0F ; 15e750: 89 f0 breq .+34 ; 0xe774 <HoTT_Menu+0x1b36>e752: 8e e1 ldi r24, 0x1E ; 30e754: 97 e0 ldi r25, 0x07 ; 7e756: 9f 93 push r25e758: 8f 93 push r24e75a: 8c e2 ldi r24, 0x2C ; 44e75c: 95 e1 ldi r25, 0x15 ; 21e75e: 9f 93 push r25e760: 8f 93 push r24e762: e0 91 78 06 lds r30, 0x0678e766: f0 91 79 06 lds r31, 0x0679e76a: 09 95 icalle76c: 0f 90 pop r0e76e: 0f 90 pop r0e770: 0f 90 pop r0e772: 0f 90 pop r0if(Parameter_GlobalConfig & CFG_HEADING_HOLD) HoTT_printf_BLINK("HH! ");e774: 80 91 5c 06 lds r24, 0x065Ce778: 82 ff sbrs r24, 2e77a: 11 c0 rjmp .+34 ; 0xe79e <HoTT_Menu+0x1b60>e77c: 89 e1 ldi r24, 0x19 ; 25e77e: 97 e0 ldi r25, 0x07 ; 7e780: 9f 93 push r25e782: 8f 93 push r24e784: 8c e2 ldi r24, 0x2C ; 44e786: 95 e1 ldi r25, 0x15 ; 21e788: 9f 93 push r25e78a: 8f 93 push r24e78c: e0 91 78 06 lds r30, 0x0678e790: f0 91 79 06 lds r31, 0x0679e794: 09 95 icalle796: 0f 90 pop r0e798: 0f 90 pop r0e79a: 0f 90 pop r0e79c: 0f 90 pop r0if(!(Parameter_GlobalConfig & CFG_KOMPASS_AKTIV)) HoTT_printf_BLINK("COMPASS OFF! ");e79e: 80 91 5c 06 lds r24, 0x065Ce7a2: 83 fd sbrc r24, 3e7a4: c6 c7 rjmp .+3980 ; 0xf732 <HoTT_Menu+0x2af4>e7a6: 8b e0 ldi r24, 0x0B ; 11e7a8: 97 e0 ldi r25, 0x07 ; 7e7aa: 9f 93 push r25e7ac: 8f 93 push r24e7ae: 8c e2 ldi r24, 0x2C ; 44e7b0: 95 e1 ldi r25, 0x15 ; 21e7b2: 9f 93 push r25e7b4: 8f 93 push r24e7b6: e0 91 78 06 lds r30, 0x0678e7ba: f0 91 79 06 lds r31, 0x0679e7be: 09 95 icalle7c0: 0f 90 pop r0e7c2: 0f 90 pop r0e7c4: 0f 90 pop r0e7c6: 0f 90 pop r0e7c8: b4 c7 rjmp .+3944 ; 0xf732 <HoTT_Menu+0x2af4>case 12:case 13:case 14:case 15:case 16:if(HottKeyboard == HOTT_KEY_SET) { if(show_poti) show_poti = 0; else show_poti = 1; Hott_ClearLine(6); Hott_ClearLine(7);}e7ca: 80 91 a9 0c lds r24, 0x0CA9e7ce: 86 30 cpi r24, 0x06 ; 6e7d0: 89 f4 brne .+34 ; 0xe7f4 <HoTT_Menu+0x1bb6>e7d2: 80 91 72 04 lds r24, 0x0472e7d6: 88 23 and r24, r24e7d8: 19 f0 breq .+6 ; 0xe7e0 <HoTT_Menu+0x1ba2>e7da: 10 92 72 04 sts 0x0472, r1e7de: 03 c0 rjmp .+6 ; 0xe7e6 <HoTT_Menu+0x1ba8>e7e0: 81 e0 ldi r24, 0x01 ; 1e7e2: 80 93 72 04 sts 0x0472, r24e7e6: 86 e0 ldi r24, 0x06 ; 6e7e8: 0e 94 b4 60 call 0xc168 ; 0xc168 <Hott_ClearLine>e7ec: 87 e0 ldi r24, 0x07 ; 7e7ee: 0e 94 b4 60 call 0xc168 ; 0xc168 <Hott_ClearLine>e7f2: 13 c0 rjmp .+38 ; 0xe81a <HoTT_Menu+0x1bdc>elseif(HottKeyboard == HOTT_KEY_LEFT) { LIBFC_HoTT_Clear(); page = 3; line = 0;}e7f4: 88 30 cpi r24, 0x08 ; 8e7f6: 41 f4 brne .+16 ; 0xe808 <HoTT_Menu+0x1bca>e7f8: 0e 94 3a 15 call 0x2a74 ; 0x2a74 <LIBFC_HoTT_Clear>e7fc: 83 e0 ldi r24, 0x03 ; 3e7fe: 80 93 76 04 sts 0x0476, r24e802: 10 92 75 04 sts 0x0475, r1e806: 09 c0 rjmp .+18 ; 0xe81a <HoTT_Menu+0x1bdc>elseif(HottKeyboard == HOTT_KEY_RIGHT) { LIBFC_HoTT_Clear(); page = 1; line = 0;};e808: 81 30 cpi r24, 0x01 ; 1e80a: 39 f4 brne .+14 ; 0xe81a <HoTT_Menu+0x1bdc>e80c: 0e 94 3a 15 call 0x2a74 ; 0x2a74 <LIBFC_HoTT_Clear>e810: 81 e0 ldi r24, 0x01 ; 1e812: 80 93 76 04 sts 0x0476, r24e816: 10 92 75 04 sts 0x0475, r1HottKeyboard = 0;e81a: 10 92 a9 0c sts 0x0CA9, r1break;e81e: 89 c7 rjmp .+3858 ; 0xf732 <HoTT_Menu+0x2af4>default: line = 0;e820: 10 92 75 04 sts 0x0475, r1break;e824: 86 c7 rjmp .+3852 ; 0xf732 <HoTT_Menu+0x2af4>}break;case 3:switch(line++)e826: 80 91 75 04 lds r24, 0x0475e82a: 91 e0 ldi r25, 0x01 ; 1e82c: 98 0f add r25, r24e82e: 90 93 75 04 sts 0x0475, r25e832: 82 30 cpi r24, 0x02 ; 2e834: 09 f4 brne .+2 ; 0xe838 <HoTT_Menu+0x1bfa>e836: 65 c0 rjmp .+202 ; 0xe902 <HoTT_Menu+0x1cc4>e838: 28 f4 brcc .+10 ; 0xe844 <HoTT_Menu+0x1c06>e83a: 88 23 and r24, r24e83c: 39 f0 breq .+14 ; 0xe84c <HoTT_Menu+0x1c0e>e83e: 81 30 cpi r24, 0x01 ; 1e840: 49 f1 breq .+82 ; 0xe894 <HoTT_Menu+0x1c56>e842: aa c1 rjmp .+852 ; 0xeb98 <HoTT_Menu+0x1f5a>e844: 86 30 cpi r24, 0x06 ; 6e846: 08 f4 brcc .+2 ; 0xe84a <HoTT_Menu+0x1c0c>e848: 98 c0 rjmp .+304 ; 0xe97a <HoTT_Menu+0x1d3c>e84a: a6 c1 rjmp .+844 ; 0xeb98 <HoTT_Menu+0x1f5a>{static unsigned char load_waypoint_tmp2 = 1, changed2;case 0:HoTT_printfxy(0,0,"Load Waypoints");e84c: 80 e0 ldi r24, 0x00 ; 0e84e: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>e852: 8c ef ldi r24, 0xFC ; 252e854: 96 e0 ldi r25, 0x06 ; 6e856: 9f 93 push r25e858: 8f 93 push r24e85a: 0b e0 ldi r16, 0x0B ; 11e85c: 15 e1 ldi r17, 0x15 ; 21e85e: 1f 93 push r17e860: 0f 93 push r16e862: e0 91 78 06 lds r30, 0x0678e866: f0 91 79 06 lds r31, 0x0679e86a: 09 95 icallHoTT_printfxy(0,1,"(Relative Positions)");e86c: 85 e1 ldi r24, 0x15 ; 21e86e: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>e872: 87 ee ldi r24, 0xE7 ; 231e874: 96 e0 ldi r25, 0x06 ; 6e876: 9f 93 push r25e878: 8f 93 push r24e87a: 1f 93 push r17e87c: 0f 93 push r16e87e: e0 91 78 06 lds r30, 0x0678e882: f0 91 79 06 lds r31, 0x0679e886: 09 95 icall// HoTT_printfxy(0,1,"(Absolute)");break;e888: 0f b6 in r0, 0x3f ; 63e88a: f8 94 clie88c: de bf out 0x3e, r29 ; 62e88e: 0f be out 0x3f, r0 ; 63e890: cd bf out 0x3d, r28 ; 61e892: 4f c7 rjmp .+3742 ; 0xf732 <HoTT_Menu+0x2af4>case 1:if(NaviData_WaypointNumber) HoTT_printfxy(0,6,"Active WP:%2d/%d ",NaviData_WaypointIndex,NaviData_WaypointNumber)e894: 80 91 8c 04 lds r24, 0x048Ce898: 88 23 and r24, r24e89a: f1 f0 breq .+60 ; 0xe8d8 <HoTT_Menu+0x1c9a>e89c: 8e e7 ldi r24, 0x7E ; 126e89e: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>e8a2: 80 91 8c 04 lds r24, 0x048Ce8a6: 1f 92 push r1e8a8: 8f 93 push r24e8aa: 80 91 8d 04 lds r24, 0x048De8ae: 1f 92 push r1e8b0: 8f 93 push r24e8b2: 85 ed ldi r24, 0xD5 ; 213e8b4: 96 e0 ldi r25, 0x06 ; 6e8b6: 9f 93 push r25e8b8: 8f 93 push r24e8ba: 8b e0 ldi r24, 0x0B ; 11e8bc: 95 e1 ldi r25, 0x15 ; 21e8be: 9f 93 push r25e8c0: 8f 93 push r24e8c2: e0 91 78 06 lds r30, 0x0678e8c6: f0 91 79 06 lds r31, 0x0679e8ca: 09 95 icalle8cc: 0f b6 in r0, 0x3f ; 63e8ce: f8 94 clie8d0: de bf out 0x3e, r29 ; 62e8d2: 0f be out 0x3f, r0 ; 63e8d4: cd bf out 0x3d, r28 ; 61e8d6: 2d c7 rjmp .+3674 ; 0xf732 <HoTT_Menu+0x2af4>else HoTT_printfxy(0,6,"No WPs active ")e8d8: 8e e7 ldi r24, 0x7E ; 126e8da: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>e8de: 82 ec ldi r24, 0xC2 ; 194e8e0: 96 e0 ldi r25, 0x06 ; 6e8e2: 9f 93 push r25e8e4: 8f 93 push r24e8e6: 8b e0 ldi r24, 0x0B ; 11e8e8: 95 e1 ldi r25, 0x15 ; 21e8ea: 9f 93 push r25e8ec: 8f 93 push r24e8ee: e0 91 78 06 lds r30, 0x0678e8f2: f0 91 79 06 lds r31, 0x0679e8f6: 09 95 icalle8f8: 0f 90 pop r0e8fa: 0f 90 pop r0e8fc: 0f 90 pop r0e8fe: 0f 90 pop r0e900: 18 c7 rjmp .+3632 ; 0xf732 <HoTT_Menu+0x2af4>break;case 2:HoTT_printfxy(0,7,"%2i.%1iV ",UBat/10, UBat%10)e902: 83 e9 ldi r24, 0x93 ; 147e904: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>e908: 80 91 1a 01 lds r24, 0x011Ae90c: 90 91 1b 01 lds r25, 0x011Be910: e0 91 1a 01 lds r30, 0x011Ae914: f0 91 1b 01 lds r31, 0x011Be918: 2a e0 ldi r18, 0x0A ; 10e91a: 30 e0 ldi r19, 0x00 ; 0e91c: b9 01 movw r22, r18e91e: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>e922: 9f 93 push r25e924: 8f 93 push r24e926: cf 01 movw r24, r30e928: b9 01 movw r22, r18e92a: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>e92e: 7f 93 push r23e930: 6f 93 push r22e932: 88 eb ldi r24, 0xB8 ; 184e934: 96 e0 ldi r25, 0x06 ; 6e936: 9f 93 push r25e938: 8f 93 push r24e93a: 0b e0 ldi r16, 0x0B ; 11e93c: 15 e1 ldi r17, 0x15 ; 21e93e: 1f 93 push r17e940: 0f 93 push r16e942: e0 91 78 06 lds r30, 0x0678e946: f0 91 79 06 lds r31, 0x0679e94a: 09 95 icallHoTT_printfxy(11,7,"%s",WPL_Name)e94c: 8e e9 ldi r24, 0x9E ; 158e94e: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>e952: 82 ed ldi r24, 0xD2 ; 210e954: 96 e0 ldi r25, 0x06 ; 6e956: 9f 93 push r25e958: 8f 93 push r24e95a: 85 eb ldi r24, 0xB5 ; 181e95c: 96 e0 ldi r25, 0x06 ; 6e95e: 9f 93 push r25e960: 8f 93 push r24e962: 1f 93 push r17e964: 0f 93 push r16e966: e0 91 78 06 lds r30, 0x0678e96a: f0 91 79 06 lds r31, 0x0679e96e: 09 95 icalle970: 0f b6 in r0, 0x3f ; 63e972: f8 94 clie974: de bf out 0x3e, r29 ; 62e976: 0f be out 0x3f, r0 ; 63e978: cd bf out 0x3d, r28 ; 61case 3:case 4:case 5:if(load_waypoint_tmp2)e97a: 80 91 56 01 lds r24, 0x0156e97e: 88 23 and r24, r24e980: 09 f4 brne .+2 ; 0xe984 <HoTT_Menu+0x1d46>e982: 4c c0 rjmp .+152 ; 0xea1c <HoTT_Menu+0x1dde>{if(changed2 && HoTTBlink) HoTT_printfxy(10,3," ")e984: 80 91 71 04 lds r24, 0x0471e988: 88 23 and r24, r24e98a: c9 f0 breq .+50 ; 0xe9be <HoTT_Menu+0x1d80>e98c: 80 91 ed 02 lds r24, 0x02EDe990: 88 23 and r24, r24e992: a9 f0 breq .+42 ; 0xe9be <HoTT_Menu+0x1d80>e994: 89 e4 ldi r24, 0x49 ; 73e996: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>e99a: 81 eb ldi r24, 0xB1 ; 177e99c: 96 e0 ldi r25, 0x06 ; 6e99e: 9f 93 push r25e9a0: 8f 93 push r24e9a2: 8b e0 ldi r24, 0x0B ; 11e9a4: 95 e1 ldi r25, 0x15 ; 21e9a6: 9f 93 push r25e9a8: 8f 93 push r24e9aa: e0 91 78 06 lds r30, 0x0678e9ae: f0 91 79 06 lds r31, 0x0679e9b2: 09 95 icalle9b4: 0f 90 pop r0e9b6: 0f 90 pop r0e9b8: 0f 90 pop r0e9ba: 0f 90 pop r0e9bc: 1a c0 rjmp .+52 ; 0xe9f2 <HoTT_Menu+0x1db4>else HoTT_printfxy(10,3,"%2i ",load_waypoint_tmp2);e9be: 89 e4 ldi r24, 0x49 ; 73e9c0: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>e9c4: 80 91 56 01 lds r24, 0x0156e9c8: 1f 92 push r1e9ca: 8f 93 push r24e9cc: 8a ea ldi r24, 0xAA ; 170e9ce: 96 e0 ldi r25, 0x06 ; 6e9d0: 9f 93 push r25e9d2: 8f 93 push r24e9d4: 8b e0 ldi r24, 0x0B ; 11e9d6: 95 e1 ldi r25, 0x15 ; 21e9d8: 9f 93 push r25e9da: 8f 93 push r24e9dc: e0 91 78 06 lds r30, 0x0678e9e0: f0 91 79 06 lds r31, 0x0679e9e4: 09 95 icalle9e6: 0f 90 pop r0e9e8: 0f 90 pop r0e9ea: 0f 90 pop r0e9ec: 0f 90 pop r0e9ee: 0f 90 pop r0e9f0: 0f 90 pop r0HoTT_printfxy(0,3,"Load list:")e9f2: 8f e3 ldi r24, 0x3F ; 63e9f4: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>e9f8: 8f e9 ldi r24, 0x9F ; 159e9fa: 96 e0 ldi r25, 0x06 ; 6e9fc: 9f 93 push r25e9fe: 8f 93 push r24ea00: 8b e0 ldi r24, 0x0B ; 11ea02: 95 e1 ldi r25, 0x15 ; 21ea04: 9f 93 push r25ea06: 8f 93 push r24ea08: e0 91 78 06 lds r30, 0x0678ea0c: f0 91 79 06 lds r31, 0x0679ea10: 09 95 icallea12: 0f 90 pop r0ea14: 0f 90 pop r0ea16: 0f 90 pop r0ea18: 0f 90 pop r0ea1a: 14 c0 rjmp .+40 ; 0xea44 <HoTT_Menu+0x1e06>}else{HoTT_printfxy(0,3,"Load list: -- ");ea1c: 8f e3 ldi r24, 0x3F ; 63ea1e: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>ea22: 80 e9 ldi r24, 0x90 ; 144ea24: 96 e0 ldi r25, 0x06 ; 6ea26: 9f 93 push r25ea28: 8f 93 push r24ea2a: 8b e0 ldi r24, 0x0B ; 11ea2c: 95 e1 ldi r25, 0x15 ; 21ea2e: 9f 93 push r25ea30: 8f 93 push r24ea32: e0 91 78 06 lds r30, 0x0678ea36: f0 91 79 06 lds r31, 0x0679ea3a: 09 95 icallea3c: 0f 90 pop r0ea3e: 0f 90 pop r0ea40: 0f 90 pop r0ea42: 0f 90 pop r0}if(NaviData_MaxWpListIndex == 0) HoTT_printfxy(0,4,"No SD-Card ")ea44: 80 91 89 04 lds r24, 0x0489ea48: 81 11 cpse r24, r1ea4a: 15 c0 rjmp .+42 ; 0xea76 <HoTT_Menu+0x1e38>ea4c: 84 e5 ldi r24, 0x54 ; 84ea4e: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>ea52: 82 e8 ldi r24, 0x82 ; 130ea54: 96 e0 ldi r25, 0x06 ; 6ea56: 9f 93 push r25ea58: 8f 93 push r24ea5a: 8b e0 ldi r24, 0x0B ; 11ea5c: 95 e1 ldi r25, 0x15 ; 21ea5e: 9f 93 push r25ea60: 8f 93 push r24ea62: e0 91 78 06 lds r30, 0x0678ea66: f0 91 79 06 lds r31, 0x0679ea6a: 09 95 icallea6c: 0f 90 pop r0ea6e: 0f 90 pop r0ea70: 0f 90 pop r0ea72: 0f 90 pop r0ea74: 58 c0 rjmp .+176 ; 0xeb26 <HoTT_Menu+0x1ee8>else{if(GPSInfo.SatFix == SATFIX_3D)ea76: 80 91 d9 08 lds r24, 0x08D9ea7a: 83 30 cpi r24, 0x03 ; 3ea7c: 09 f0 breq .+2 ; 0xea80 <HoTT_Menu+0x1e42>ea7e: 3f c0 rjmp .+126 ; 0xeafe <HoTT_Menu+0x1ec0>{if(changed2 && load_waypoint_tmp2) HoTT_printfxy(0,4,"(Set -> Load)")ea80: 80 91 71 04 lds r24, 0x0471ea84: 88 23 and r24, r24ea86: c9 f0 breq .+50 ; 0xeaba <HoTT_Menu+0x1e7c>ea88: 80 91 56 01 lds r24, 0x0156ea8c: 88 23 and r24, r24ea8e: a9 f0 breq .+42 ; 0xeaba <HoTT_Menu+0x1e7c>ea90: 84 e5 ldi r24, 0x54 ; 84ea92: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>ea96: 84 e7 ldi r24, 0x74 ; 116ea98: 96 e0 ldi r25, 0x06 ; 6ea9a: 9f 93 push r25ea9c: 8f 93 push r24ea9e: 8b e0 ldi r24, 0x0B ; 11eaa0: 95 e1 ldi r25, 0x15 ; 21eaa2: 9f 93 push r25eaa4: 8f 93 push r24eaa6: e0 91 78 06 lds r30, 0x0678eaaa: f0 91 79 06 lds r31, 0x0679eaae: 09 95 icalleab0: 0f 90 pop r0eab2: 0f 90 pop r0eab4: 0f 90 pop r0eab6: 0f 90 pop r0eab8: 14 c0 rjmp .+40 ; 0xeae2 <HoTT_Menu+0x1ea4>else HoTT_printfxy(0,4," ");eaba: 84 e5 ldi r24, 0x54 ; 84eabc: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>eac0: 86 e6 ldi r24, 0x66 ; 102eac2: 96 e0 ldi r25, 0x06 ; 6eac4: 9f 93 push r25eac6: 8f 93 push r24eac8: 8b e0 ldi r24, 0x0B ; 11eaca: 95 e1 ldi r25, 0x15 ; 21eacc: 9f 93 push r25eace: 8f 93 push r24ead0: e0 91 78 06 lds r30, 0x0678ead4: f0 91 79 06 lds r31, 0x0679ead8: 09 95 icalleada: 0f 90 pop r0eadc: 0f 90 pop r0eade: 0f 90 pop r0eae0: 0f 90 pop r0if(HottKeyboard == HOTT_KEY_SET) { if(load_waypoint_tmp2) ToNC_Load_WP_List = load_waypoint_tmp2 | 128; changed2 = 0;}eae2: 80 91 a9 0c lds r24, 0x0CA9eae6: 86 30 cpi r24, 0x06 ; 6eae8: f1 f4 brne .+60 ; 0xeb26 <HoTT_Menu+0x1ee8>eaea: 80 91 56 01 lds r24, 0x0156eaee: 88 23 and r24, r24eaf0: 19 f0 breq .+6 ; 0xeaf8 <HoTT_Menu+0x1eba>eaf2: 80 68 ori r24, 0x80 ; 128eaf4: 80 93 8a 04 sts 0x048A, r24eaf8: 10 92 71 04 sts 0x0471, r1eafc: 14 c0 rjmp .+40 ; 0xeb26 <HoTT_Menu+0x1ee8>} else HoTT_printfxy(0,4,"!No GPS-Fix! ");eafe: 84 e5 ldi r24, 0x54 ; 84eb00: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>eb04: 88 e5 ldi r24, 0x58 ; 88eb06: 96 e0 ldi r25, 0x06 ; 6eb08: 9f 93 push r25eb0a: 8f 93 push r24eb0c: 8b e0 ldi r24, 0x0B ; 11eb0e: 95 e1 ldi r25, 0x15 ; 21eb10: 9f 93 push r25eb12: 8f 93 push r24eb14: e0 91 78 06 lds r30, 0x0678eb18: f0 91 79 06 lds r31, 0x0679eb1c: 09 95 icalleb1e: 0f 90 pop r0eb20: 0f 90 pop r0eb22: 0f 90 pop r0eb24: 0f 90 pop r0}if(HottKeyboard == HOTT_KEY_UP && load_waypoint_tmp2 < NaviData_MaxWpListIndex) { changed2 = 1; load_waypoint_tmp2++;HoTTBlink = 0;}eb26: 80 91 a9 0c lds r24, 0x0CA9eb2a: 84 30 cpi r24, 0x04 ; 4eb2c: 79 f4 brne .+30 ; 0xeb4c <HoTT_Menu+0x1f0e>eb2e: 80 91 56 01 lds r24, 0x0156eb32: 90 91 89 04 lds r25, 0x0489eb36: 89 17 cp r24, r25eb38: 08 f5 brcc .+66 ; 0xeb7c <HoTT_Menu+0x1f3e>eb3a: 91 e0 ldi r25, 0x01 ; 1eb3c: 90 93 71 04 sts 0x0471, r25eb40: 8f 5f subi r24, 0xFF ; 255eb42: 80 93 56 01 sts 0x0156, r24eb46: 10 92 ed 02 sts 0x02ED, r1eb4a: 18 c0 rjmp .+48 ; 0xeb7c <HoTT_Menu+0x1f3e>if(HottKeyboard == HOTT_KEY_DOWN && load_waypoint_tmp2 > 1) { changed2 = 1; load_waypoint_tmp2--;HoTTBlink = 0;};eb4c: 82 30 cpi r24, 0x02 ; 2eb4e: 69 f4 brne .+26 ; 0xeb6a <HoTT_Menu+0x1f2c>eb50: 80 91 56 01 lds r24, 0x0156eb54: 82 30 cpi r24, 0x02 ; 2eb56: 90 f0 brcs .+36 ; 0xeb7c <HoTT_Menu+0x1f3e>eb58: 91 e0 ldi r25, 0x01 ; 1eb5a: 90 93 71 04 sts 0x0471, r25eb5e: 81 50 subi r24, 0x01 ; 1eb60: 80 93 56 01 sts 0x0156, r24eb64: 10 92 ed 02 sts 0x02ED, r1eb68: 09 c0 rjmp .+18 ; 0xeb7c <HoTT_Menu+0x1f3e>if(HottKeyboard == HOTT_KEY_LEFT) { LIBFC_HoTT_Clear(); page = 4; line = 0;}eb6a: 88 30 cpi r24, 0x08 ; 8eb6c: 39 f4 brne .+14 ; 0xeb7c <HoTT_Menu+0x1f3e>eb6e: 0e 94 3a 15 call 0x2a74 ; 0x2a74 <LIBFC_HoTT_Clear>eb72: 84 e0 ldi r24, 0x04 ; 4eb74: 80 93 76 04 sts 0x0476, r24eb78: 10 92 75 04 sts 0x0475, r1if(HottKeyboard == HOTT_KEY_RIGHT) { LIBFC_HoTT_Clear(); page = 2; line = 0;};eb7c: 80 91 a9 0c lds r24, 0x0CA9eb80: 81 30 cpi r24, 0x01 ; 1eb82: 39 f4 brne .+14 ; 0xeb92 <HoTT_Menu+0x1f54>eb84: 0e 94 3a 15 call 0x2a74 ; 0x2a74 <LIBFC_HoTT_Clear>eb88: 82 e0 ldi r24, 0x02 ; 2eb8a: 80 93 76 04 sts 0x0476, r24eb8e: 10 92 75 04 sts 0x0475, r1HottKeyboard = 0;eb92: 10 92 a9 0c sts 0x0CA9, r1break;eb96: cd c5 rjmp .+2970 ; 0xf732 <HoTT_Menu+0x2af4>default: line = 0;eb98: 10 92 75 04 sts 0x0475, r1break;eb9c: ca c5 rjmp .+2964 ; 0xf732 <HoTT_Menu+0x2af4>}break;case 4:switch(line++)eb9e: 80 91 75 04 lds r24, 0x0475eba2: 91 e0 ldi r25, 0x01 ; 1eba4: 98 0f add r25, r24eba6: 90 93 75 04 sts 0x0475, r25ebaa: 82 30 cpi r24, 0x02 ; 2ebac: 09 f4 brne .+2 ; 0xebb0 <HoTT_Menu+0x1f72>ebae: 65 c0 rjmp .+202 ; 0xec7a <HoTT_Menu+0x203c>ebb0: 28 f4 brcc .+10 ; 0xebbc <HoTT_Menu+0x1f7e>ebb2: 88 23 and r24, r24ebb4: 39 f0 breq .+14 ; 0xebc4 <HoTT_Menu+0x1f86>ebb6: 81 30 cpi r24, 0x01 ; 1ebb8: 49 f1 breq .+82 ; 0xec0c <HoTT_Menu+0x1fce>ebba: 90 c1 rjmp .+800 ; 0xeedc <HoTT_Menu+0x229e>ebbc: 86 30 cpi r24, 0x06 ; 6ebbe: 08 f4 brcc .+2 ; 0xebc2 <HoTT_Menu+0x1f84>ebc0: 98 c0 rjmp .+304 ; 0xecf2 <HoTT_Menu+0x20b4>ebc2: 8c c1 rjmp .+792 ; 0xeedc <HoTT_Menu+0x229e>{static unsigned char load_waypoint_tmp = 1, changed;case 0:HoTT_printfxy(0,0,"Load Waypoints");ebc4: 80 e0 ldi r24, 0x00 ; 0ebc6: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>ebca: 89 e4 ldi r24, 0x49 ; 73ebcc: 96 e0 ldi r25, 0x06 ; 6ebce: 9f 93 push r25ebd0: 8f 93 push r24ebd2: 0b e0 ldi r16, 0x0B ; 11ebd4: 15 e1 ldi r17, 0x15 ; 21ebd6: 1f 93 push r17ebd8: 0f 93 push r16ebda: e0 91 78 06 lds r30, 0x0678ebde: f0 91 79 06 lds r31, 0x0679ebe2: 09 95 icallHoTT_printfxy(0,1,"(Fixed Positions)");ebe4: 85 e1 ldi r24, 0x15 ; 21ebe6: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>ebea: 87 e3 ldi r24, 0x37 ; 55ebec: 96 e0 ldi r25, 0x06 ; 6ebee: 9f 93 push r25ebf0: 8f 93 push r24ebf2: 1f 93 push r17ebf4: 0f 93 push r16ebf6: e0 91 78 06 lds r30, 0x0678ebfa: f0 91 79 06 lds r31, 0x0679ebfe: 09 95 icallbreak;ec00: 0f b6 in r0, 0x3f ; 63ec02: f8 94 cliec04: de bf out 0x3e, r29 ; 62ec06: 0f be out 0x3f, r0 ; 63ec08: cd bf out 0x3d, r28 ; 61ec0a: 93 c5 rjmp .+2854 ; 0xf732 <HoTT_Menu+0x2af4>case 1:if(NaviData_WaypointNumber) HoTT_printfxy(0,6,"Active WP:%2d/%d ",NaviData_WaypointIndex,NaviData_WaypointNumber)ec0c: 80 91 8c 04 lds r24, 0x048Cec10: 88 23 and r24, r24ec12: f1 f0 breq .+60 ; 0xec50 <HoTT_Menu+0x2012>ec14: 8e e7 ldi r24, 0x7E ; 126ec16: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>ec1a: 80 91 8c 04 lds r24, 0x048Cec1e: 1f 92 push r1ec20: 8f 93 push r24ec22: 80 91 8d 04 lds r24, 0x048Dec26: 1f 92 push r1ec28: 8f 93 push r24ec2a: 85 e2 ldi r24, 0x25 ; 37ec2c: 96 e0 ldi r25, 0x06 ; 6ec2e: 9f 93 push r25ec30: 8f 93 push r24ec32: 8b e0 ldi r24, 0x0B ; 11ec34: 95 e1 ldi r25, 0x15 ; 21ec36: 9f 93 push r25ec38: 8f 93 push r24ec3a: e0 91 78 06 lds r30, 0x0678ec3e: f0 91 79 06 lds r31, 0x0679ec42: 09 95 icallec44: 0f b6 in r0, 0x3f ; 63ec46: f8 94 cliec48: de bf out 0x3e, r29 ; 62ec4a: 0f be out 0x3f, r0 ; 63ec4c: cd bf out 0x3d, r28 ; 61ec4e: 71 c5 rjmp .+2786 ; 0xf732 <HoTT_Menu+0x2af4>else HoTT_printfxy(0,6,"No WPs active ")ec50: 8e e7 ldi r24, 0x7E ; 126ec52: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>ec56: 83 e1 ldi r24, 0x13 ; 19ec58: 96 e0 ldi r25, 0x06 ; 6ec5a: 9f 93 push r25ec5c: 8f 93 push r24ec5e: 8b e0 ldi r24, 0x0B ; 11ec60: 95 e1 ldi r25, 0x15 ; 21ec62: 9f 93 push r25ec64: 8f 93 push r24ec66: e0 91 78 06 lds r30, 0x0678ec6a: f0 91 79 06 lds r31, 0x0679ec6e: 09 95 icallec70: 0f 90 pop r0ec72: 0f 90 pop r0ec74: 0f 90 pop r0ec76: 0f 90 pop r0ec78: 5c c5 rjmp .+2744 ; 0xf732 <HoTT_Menu+0x2af4>break;case 2:HoTT_printfxy(0,7,"%2i.%1iV ",UBat/10, UBat%10)ec7a: 83 e9 ldi r24, 0x93 ; 147ec7c: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>ec80: 80 91 1a 01 lds r24, 0x011Aec84: 90 91 1b 01 lds r25, 0x011Bec88: e0 91 1a 01 lds r30, 0x011Aec8c: f0 91 1b 01 lds r31, 0x011Bec90: 2a e0 ldi r18, 0x0A ; 10ec92: 30 e0 ldi r19, 0x00 ; 0ec94: b9 01 movw r22, r18ec96: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>ec9a: 9f 93 push r25ec9c: 8f 93 push r24ec9e: cf 01 movw r24, r30eca0: b9 01 movw r22, r18eca2: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>eca6: 7f 93 push r23eca8: 6f 93 push r22ecaa: 89 e0 ldi r24, 0x09 ; 9ecac: 96 e0 ldi r25, 0x06 ; 6ecae: 9f 93 push r25ecb0: 8f 93 push r24ecb2: 0b e0 ldi r16, 0x0B ; 11ecb4: 15 e1 ldi r17, 0x15 ; 21ecb6: 1f 93 push r17ecb8: 0f 93 push r16ecba: e0 91 78 06 lds r30, 0x0678ecbe: f0 91 79 06 lds r31, 0x0679ecc2: 09 95 icallHoTT_printfxy(11,7,"%s",WPL_Name)ecc4: 8e e9 ldi r24, 0x9E ; 158ecc6: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>ecca: 82 ed ldi r24, 0xD2 ; 210eccc: 96 e0 ldi r25, 0x06 ; 6ecce: 9f 93 push r25ecd0: 8f 93 push r24ecd2: 86 e0 ldi r24, 0x06 ; 6ecd4: 96 e0 ldi r25, 0x06 ; 6ecd6: 9f 93 push r25ecd8: 8f 93 push r24ecda: 1f 93 push r17ecdc: 0f 93 push r16ecde: e0 91 78 06 lds r30, 0x0678ece2: f0 91 79 06 lds r31, 0x0679ece6: 09 95 icallece8: 0f b6 in r0, 0x3f ; 63ecea: f8 94 cliecec: de bf out 0x3e, r29 ; 62ecee: 0f be out 0x3f, r0 ; 63ecf0: cd bf out 0x3d, r28 ; 61case 3:case 4:case 5:HoTT_printfxy(0,3,"Load list:")ecf2: 8f e3 ldi r24, 0x3F ; 63ecf4: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>ecf8: 8b ef ldi r24, 0xFB ; 251ecfa: 95 e0 ldi r25, 0x05 ; 5ecfc: 9f 93 push r25ecfe: 8f 93 push r24ed00: 8b e0 ldi r24, 0x0B ; 11ed02: 95 e1 ldi r25, 0x15 ; 21ed04: 9f 93 push r25ed06: 8f 93 push r24ed08: e0 91 78 06 lds r30, 0x0678ed0c: f0 91 79 06 lds r31, 0x0679ed10: 09 95 icallif(load_waypoint_tmp)ed12: 0f 90 pop r0ed14: 0f 90 pop r0ed16: 0f 90 pop r0ed18: 0f 90 pop r0ed1a: 80 91 55 01 lds r24, 0x0155ed1e: 88 23 and r24, r24ed20: c1 f1 breq .+112 ; 0xed92 <HoTT_Menu+0x2154>{if(changed && HoTTBlink) HoTT_printfxy(10,3," ")ed22: 80 91 70 04 lds r24, 0x0470ed26: 88 23 and r24, r24ed28: c9 f0 breq .+50 ; 0xed5c <HoTT_Menu+0x211e>ed2a: 80 91 ed 02 lds r24, 0x02EDed2e: 88 23 and r24, r24ed30: a9 f0 breq .+42 ; 0xed5c <HoTT_Menu+0x211e>ed32: 89 e4 ldi r24, 0x49 ; 73ed34: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>ed38: 87 ef ldi r24, 0xF7 ; 247ed3a: 95 e0 ldi r25, 0x05 ; 5ed3c: 9f 93 push r25ed3e: 8f 93 push r24ed40: 8b e0 ldi r24, 0x0B ; 11ed42: 95 e1 ldi r25, 0x15 ; 21ed44: 9f 93 push r25ed46: 8f 93 push r24ed48: e0 91 78 06 lds r30, 0x0678ed4c: f0 91 79 06 lds r31, 0x0679ed50: 09 95 icalled52: 0f 90 pop r0ed54: 0f 90 pop r0ed56: 0f 90 pop r0ed58: 0f 90 pop r0ed5a: 2f c0 rjmp .+94 ; 0xedba <HoTT_Menu+0x217c>else HoTT_printfxy(10,3,"%2d (FIX)",load_waypoint_tmp);ed5c: 89 e4 ldi r24, 0x49 ; 73ed5e: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>ed62: 80 91 55 01 lds r24, 0x0155ed66: 1f 92 push r1ed68: 8f 93 push r24ed6a: 8d ee ldi r24, 0xED ; 237ed6c: 95 e0 ldi r25, 0x05 ; 5ed6e: 9f 93 push r25ed70: 8f 93 push r24ed72: 8b e0 ldi r24, 0x0B ; 11ed74: 95 e1 ldi r25, 0x15 ; 21ed76: 9f 93 push r25ed78: 8f 93 push r24ed7a: e0 91 78 06 lds r30, 0x0678ed7e: f0 91 79 06 lds r31, 0x0679ed82: 09 95 icalled84: 0f 90 pop r0ed86: 0f 90 pop r0ed88: 0f 90 pop r0ed8a: 0f 90 pop r0ed8c: 0f 90 pop r0ed8e: 0f 90 pop r0ed90: 14 c0 rjmp .+40 ; 0xedba <HoTT_Menu+0x217c>}else{HoTT_printfxy(10,3," --")ed92: 89 e4 ldi r24, 0x49 ; 73ed94: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>ed98: 89 ee ldi r24, 0xE9 ; 233ed9a: 95 e0 ldi r25, 0x05 ; 5ed9c: 9f 93 push r25ed9e: 8f 93 push r24eda0: 8b e0 ldi r24, 0x0B ; 11eda2: 95 e1 ldi r25, 0x15 ; 21eda4: 9f 93 push r25eda6: 8f 93 push r24eda8: e0 91 78 06 lds r30, 0x0678edac: f0 91 79 06 lds r31, 0x0679edb0: 09 95 icalledb2: 0f 90 pop r0edb4: 0f 90 pop r0edb6: 0f 90 pop r0edb8: 0f 90 pop r0}if(NaviData_MaxWpListIndex == 0) HoTT_printfxy(0,4,"No SD-Card ")edba: 80 91 89 04 lds r24, 0x0489edbe: 81 11 cpse r24, r1edc0: 15 c0 rjmp .+42 ; 0xedec <HoTT_Menu+0x21ae>edc2: 84 e5 ldi r24, 0x54 ; 84edc4: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>edc8: 8b ed ldi r24, 0xDB ; 219edca: 95 e0 ldi r25, 0x05 ; 5edcc: 9f 93 push r25edce: 8f 93 push r24edd0: 8b e0 ldi r24, 0x0B ; 11edd2: 95 e1 ldi r25, 0x15 ; 21edd4: 9f 93 push r25edd6: 8f 93 push r24edd8: e0 91 78 06 lds r30, 0x0678eddc: f0 91 79 06 lds r31, 0x0679ede0: 09 95 icallede2: 0f 90 pop r0ede4: 0f 90 pop r0ede6: 0f 90 pop r0ede8: 0f 90 pop r0edea: 31 c0 rjmp .+98 ; 0xee4e <HoTT_Menu+0x2210>else{if(changed && load_waypoint_tmp) HoTT_printfxy(0,4,"(Set -> Load)")edec: 80 91 70 04 lds r24, 0x0470edf0: 88 23 and r24, r24edf2: c9 f0 breq .+50 ; 0xee26 <HoTT_Menu+0x21e8>edf4: 80 91 55 01 lds r24, 0x0155edf8: 88 23 and r24, r24edfa: a9 f0 breq .+42 ; 0xee26 <HoTT_Menu+0x21e8>edfc: 84 e5 ldi r24, 0x54 ; 84edfe: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>ee02: 8d ec ldi r24, 0xCD ; 205ee04: 95 e0 ldi r25, 0x05 ; 5ee06: 9f 93 push r25ee08: 8f 93 push r24ee0a: 8b e0 ldi r24, 0x0B ; 11ee0c: 95 e1 ldi r25, 0x15 ; 21ee0e: 9f 93 push r25ee10: 8f 93 push r24ee12: e0 91 78 06 lds r30, 0x0678ee16: f0 91 79 06 lds r31, 0x0679ee1a: 09 95 icallee1c: 0f 90 pop r0ee1e: 0f 90 pop r0ee20: 0f 90 pop r0ee22: 0f 90 pop r0ee24: 14 c0 rjmp .+40 ; 0xee4e <HoTT_Menu+0x2210>else HoTT_printfxy(0,4," ");ee26: 84 e5 ldi r24, 0x54 ; 84ee28: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>ee2c: 8f eb ldi r24, 0xBF ; 191ee2e: 95 e0 ldi r25, 0x05 ; 5ee30: 9f 93 push r25ee32: 8f 93 push r24ee34: 8b e0 ldi r24, 0x0B ; 11ee36: 95 e1 ldi r25, 0x15 ; 21ee38: 9f 93 push r25ee3a: 8f 93 push r24ee3c: e0 91 78 06 lds r30, 0x0678ee40: f0 91 79 06 lds r31, 0x0679ee44: 09 95 icallee46: 0f 90 pop r0ee48: 0f 90 pop r0ee4a: 0f 90 pop r0ee4c: 0f 90 pop r0}if(HottKeyboard == HOTT_KEY_UP && load_waypoint_tmp < NaviData_MaxWpListIndex) { changed = 1; load_waypoint_tmp++; HoTTBlink = 0;}ee4e: 80 91 a9 0c lds r24, 0x0CA9ee52: 84 30 cpi r24, 0x04 ; 4ee54: 79 f4 brne .+30 ; 0xee74 <HoTT_Menu+0x2236>ee56: 90 91 55 01 lds r25, 0x0155ee5a: 20 91 89 04 lds r18, 0x0489ee5e: 92 17 cp r25, r18ee60: 10 f5 brcc .+68 ; 0xeea6 <HoTT_Menu+0x2268>ee62: 21 e0 ldi r18, 0x01 ; 1ee64: 20 93 70 04 sts 0x0470, r18ee68: 9f 5f subi r25, 0xFF ; 255ee6a: 90 93 55 01 sts 0x0155, r25ee6e: 10 92 ed 02 sts 0x02ED, r1ee72: 19 c0 rjmp .+50 ; 0xeea6 <HoTT_Menu+0x2268>if(HottKeyboard == HOTT_KEY_DOWN && load_waypoint_tmp > 1) { changed = 1; load_waypoint_tmp--; HoTTBlink = 0;};ee74: 82 30 cpi r24, 0x02 ; 2ee76: 69 f4 brne .+26 ; 0xee92 <HoTT_Menu+0x2254>ee78: 80 91 55 01 lds r24, 0x0155ee7c: 82 30 cpi r24, 0x02 ; 2ee7e: f0 f0 brcs .+60 ; 0xeebc <HoTT_Menu+0x227e>ee80: 91 e0 ldi r25, 0x01 ; 1ee82: 90 93 70 04 sts 0x0470, r25ee86: 81 50 subi r24, 0x01 ; 1ee88: 80 93 55 01 sts 0x0155, r24ee8c: 10 92 ed 02 sts 0x02ED, r1ee90: 15 c0 rjmp .+42 ; 0xeebc <HoTT_Menu+0x227e>if(HottKeyboard == HOTT_KEY_SET) { if(load_waypoint_tmp) ToNC_Load_WP_List = load_waypoint_tmp; changed = 0;}ee92: 86 30 cpi r24, 0x06 ; 6ee94: 41 f4 brne .+16 ; 0xeea6 <HoTT_Menu+0x2268>ee96: 80 91 55 01 lds r24, 0x0155ee9a: 81 11 cpse r24, r1ee9c: 80 93 8a 04 sts 0x048A, r24eea0: 10 92 70 04 sts 0x0470, r1eea4: 0b c0 rjmp .+22 ; 0xeebc <HoTT_Menu+0x227e>if(HottKeyboard == HOTT_KEY_LEFT) { LIBFC_HoTT_Clear(); page++; line = 0;}eea6: 88 30 cpi r24, 0x08 ; 8eea8: 49 f4 brne .+18 ; 0xeebc <HoTT_Menu+0x227e>eeaa: 0e 94 3a 15 call 0x2a74 ; 0x2a74 <LIBFC_HoTT_Clear>eeae: 80 91 76 04 lds r24, 0x0476eeb2: 8f 5f subi r24, 0xFF ; 255eeb4: 80 93 76 04 sts 0x0476, r24eeb8: 10 92 75 04 sts 0x0475, r1if(HottKeyboard == HOTT_KEY_RIGHT) { LIBFC_HoTT_Clear(); page--; line = 0;};eebc: 80 91 a9 0c lds r24, 0x0CA9eec0: 81 30 cpi r24, 0x01 ; 1eec2: 49 f4 brne .+18 ; 0xeed6 <HoTT_Menu+0x2298>eec4: 0e 94 3a 15 call 0x2a74 ; 0x2a74 <LIBFC_HoTT_Clear>eec8: 80 91 76 04 lds r24, 0x0476eecc: 81 50 subi r24, 0x01 ; 1eece: 80 93 76 04 sts 0x0476, r24eed2: 10 92 75 04 sts 0x0475, r1HottKeyboard = 0;eed6: 10 92 a9 0c sts 0x0CA9, r1break;eeda: 2b c4 rjmp .+2134 ; 0xf732 <HoTT_Menu+0x2af4>default: line = 0;eedc: 10 92 75 04 sts 0x0475, r1break;eee0: 28 c4 rjmp .+2128 ; 0xf732 <HoTT_Menu+0x2af4>}break;case 5:switch(line++)eee2: 80 91 75 04 lds r24, 0x0475eee6: 91 e0 ldi r25, 0x01 ; 1eee8: 98 0f add r25, r24eeea: 90 93 75 04 sts 0x0475, r25eeee: 82 30 cpi r24, 0x02 ; 2eef0: 09 f4 brne .+2 ; 0xeef4 <HoTT_Menu+0x22b6>eef2: 81 c0 rjmp .+258 ; 0xeff6 <HoTT_Menu+0x23b8>eef4: 28 f4 brcc .+10 ; 0xef00 <HoTT_Menu+0x22c2>eef6: 88 23 and r24, r24eef8: 39 f0 breq .+14 ; 0xef08 <HoTT_Menu+0x22ca>eefa: 81 30 cpi r24, 0x01 ; 1eefc: d1 f0 breq .+52 ; 0xef32 <HoTT_Menu+0x22f4>eefe: c9 c1 rjmp .+914 ; 0xf292 <HoTT_Menu+0x2654>ef00: 86 30 cpi r24, 0x06 ; 6ef02: 08 f4 brcc .+2 ; 0xef06 <HoTT_Menu+0x22c8>ef04: c7 c0 rjmp .+398 ; 0xf094 <HoTT_Menu+0x2456>ef06: c5 c1 rjmp .+906 ; 0xf292 <HoTT_Menu+0x2654>{static unsigned char wp_tmp, changed;case 0:HoTT_printfxy(0,0,"Store single Position");ef08: 80 e0 ldi r24, 0x00 ; 0ef0a: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>ef0e: 89 ea ldi r24, 0xA9 ; 169ef10: 95 e0 ldi r25, 0x05 ; 5ef12: 9f 93 push r25ef14: 8f 93 push r24ef16: 8b e0 ldi r24, 0x0B ; 11ef18: 95 e1 ldi r25, 0x15 ; 21ef1a: 9f 93 push r25ef1c: 8f 93 push r24ef1e: e0 91 78 06 lds r30, 0x0678ef22: f0 91 79 06 lds r31, 0x0679ef26: 09 95 icall// HoTT_printfxy(0,1,"(Fixed Positions)");break;ef28: 0f 90 pop r0ef2a: 0f 90 pop r0ef2c: 0f 90 pop r0ef2e: 0f 90 pop r0ef30: 00 c4 rjmp .+2048 ; 0xf732 <HoTT_Menu+0x2af4>case 1:HoTT_printfxy(0,2," %2i.%1iV ",UBat/10, UBat%10)ef32: 8a e2 ldi r24, 0x2A ; 42ef34: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>ef38: 80 91 1a 01 lds r24, 0x011Aef3c: 90 91 1b 01 lds r25, 0x011Bef40: e0 91 1a 01 lds r30, 0x011Aef44: f0 91 1b 01 lds r31, 0x011Bef48: 2a e0 ldi r18, 0x0A ; 10ef4a: 30 e0 ldi r19, 0x00 ; 0ef4c: b9 01 movw r22, r18ef4e: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>ef52: 9f 93 push r25ef54: 8f 93 push r24ef56: cf 01 movw r24, r30ef58: b9 01 movw r22, r18ef5a: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>ef5e: 7f 93 push r23ef60: 6f 93 push r22ef62: 8e e9 ldi r24, 0x9E ; 158ef64: 95 e0 ldi r25, 0x05 ; 5ef66: 9f 93 push r25ef68: 8f 93 push r24ef6a: 0b e0 ldi r16, 0x0B ; 11ef6c: 15 e1 ldi r17, 0x15 ; 21ef6e: 1f 93 push r17ef70: 0f 93 push r16ef72: e0 91 78 06 lds r30, 0x0678ef76: f0 91 79 06 lds r31, 0x0679ef7a: 09 95 icallHoTT_printfxy(0,3," %2i:%02i ",FlugSekunden/60,FlugSekunden%60);ef7c: 8f e3 ldi r24, 0x3F ; 63ef7e: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>ef82: 40 91 5e 04 lds r20, 0x045Eef86: 50 91 5f 04 lds r21, 0x045Fef8a: 9a 01 movw r18, r20ef8c: a9 e8 ldi r26, 0x89 ; 137ef8e: b8 e8 ldi r27, 0x88 ; 136ef90: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>ef94: 96 95 lsr r25ef96: 87 95 ror r24ef98: 92 95 swap r25ef9a: 82 95 swap r24ef9c: 8f 70 andi r24, 0x0F ; 15ef9e: 89 27 eor r24, r25efa0: 9f 70 andi r25, 0x0F ; 15efa2: 89 27 eor r24, r25efa4: 6c e3 ldi r22, 0x3C ; 60efa6: 68 9f mul r22, r24efa8: 90 01 movw r18, r0efaa: 69 9f mul r22, r25efac: 30 0d add r19, r0efae: 11 24 eor r1, r1efb0: ca 01 movw r24, r20efb2: 82 1b sub r24, r18efb4: 93 0b sbc r25, r19efb6: 9f 93 push r25efb8: 8f 93 push r24efba: 9a 01 movw r18, r20efbc: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>efc0: 96 95 lsr r25efc2: 87 95 ror r24efc4: 92 95 swap r25efc6: 82 95 swap r24efc8: 8f 70 andi r24, 0x0F ; 15efca: 89 27 eor r24, r25efcc: 9f 70 andi r25, 0x0F ; 15efce: 89 27 eor r24, r25efd0: 9f 93 push r25efd2: 8f 93 push r24efd4: 83 e9 ldi r24, 0x93 ; 147efd6: 95 e0 ldi r25, 0x05 ; 5efd8: 9f 93 push r25efda: 8f 93 push r24efdc: 1f 93 push r17efde: 0f 93 push r16efe0: e0 91 78 06 lds r30, 0x0678efe4: f0 91 79 06 lds r31, 0x0679efe8: 09 95 icall// HoTT_printfxy(0,4,"Dist:%3dm",NaviData_TargetDistance)break;efea: 0f b6 in r0, 0x3f ; 63efec: f8 94 cliefee: de bf out 0x3e, r29 ; 62eff0: 0f be out 0x3f, r0 ; 63eff2: cd bf out 0x3d, r28 ; 61eff4: 9e c3 rjmp .+1852 ; 0xf732 <HoTT_Menu+0x2af4>case 2:HoTT_printfxy(11,2,"ALT:%4im", (int16_t)(HoehenWert/100))eff6: 85 e3 ldi r24, 0x35 ; 53eff8: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>effc: 60 91 fe 03 lds r22, 0x03FEf000: 70 91 ff 03 lds r23, 0x03FFf004: 80 91 00 04 lds r24, 0x0400f008: 90 91 01 04 lds r25, 0x0401f00c: 24 e6 ldi r18, 0x64 ; 100f00e: 30 e0 ldi r19, 0x00 ; 0f010: 40 e0 ldi r20, 0x00 ; 0f012: 50 e0 ldi r21, 0x00 ; 0f014: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>f018: 3f 93 push r19f01a: 2f 93 push r18f01c: 8a e8 ldi r24, 0x8A ; 138f01e: 95 e0 ldi r25, 0x05 ; 5f020: 9f 93 push r25f022: 8f 93 push r24f024: 0b e0 ldi r16, 0x0B ; 11f026: 15 e1 ldi r17, 0x15 ; 21f028: 1f 93 push r17f02a: 0f 93 push r16f02c: e0 91 78 06 lds r30, 0x0678f030: f0 91 79 06 lds r31, 0x0679f034: 09 95 icallHoTT_printfxy(11,3,"DIR: %3d%c",CompassCorrected, HoTT_GRAD);f036: 8a e4 ldi r24, 0x4A ; 74f038: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>f03c: 1f 92 push r1f03e: 80 e6 ldi r24, 0x60 ; 96f040: 8f 93 push r24f042: 80 91 66 06 lds r24, 0x0666f046: 8f 93 push r24f048: 80 91 65 06 lds r24, 0x0665f04c: 8f 93 push r24f04e: 8f e7 ldi r24, 0x7F ; 127f050: 95 e0 ldi r25, 0x05 ; 5f052: 9f 93 push r25f054: 8f 93 push r24f056: 1f 93 push r17f058: 0f 93 push r16f05a: e0 91 78 06 lds r30, 0x0678f05e: f0 91 79 06 lds r31, 0x0679f062: 09 95 icallHoTT_printfxy(11,4,"Cam: %3i",Parameter_ServoNickControl);f064: 8f e5 ldi r24, 0x5F ; 95f066: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>f06a: 80 91 2f 01 lds r24, 0x012Ff06e: 1f 92 push r1f070: 8f 93 push r24f072: 86 e7 ldi r24, 0x76 ; 118f074: 95 e0 ldi r25, 0x05 ; 5f076: 9f 93 push r25f078: 8f 93 push r24f07a: 1f 93 push r17f07c: 0f 93 push r16f07e: e0 91 78 06 lds r30, 0x0678f082: f0 91 79 06 lds r31, 0x0679f086: 09 95 icallbreak;f088: 0f b6 in r0, 0x3f ; 63f08a: f8 94 clif08c: de bf out 0x3e, r29 ; 62f08e: 0f be out 0x3f, r0 ; 63f090: cd bf out 0x3d, r28 ; 61f092: 4f c3 rjmp .+1694 ; 0xf732 <HoTT_Menu+0x2af4>case 3:case 4:case 5:HoTT_printfxy(0,6,"Store point:")f094: 8e e7 ldi r24, 0x7E ; 126f096: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>f09a: 89 e6 ldi r24, 0x69 ; 105f09c: 95 e0 ldi r25, 0x05 ; 5f09e: 9f 93 push r25f0a0: 8f 93 push r24f0a2: 8b e0 ldi r24, 0x0B ; 11f0a4: 95 e1 ldi r25, 0x15 ; 21f0a6: 9f 93 push r25f0a8: 8f 93 push r24f0aa: e0 91 78 06 lds r30, 0x0678f0ae: f0 91 79 06 lds r31, 0x0679f0b2: 09 95 icallif(wp_tmp)f0b4: 0f 90 pop r0f0b6: 0f 90 pop r0f0b8: 0f 90 pop r0f0ba: 0f 90 pop r0f0bc: 80 91 6f 04 lds r24, 0x046Ff0c0: 88 23 and r24, r24f0c2: c1 f1 breq .+112 ; 0xf134 <HoTT_Menu+0x24f6>{if(changed && HoTTBlink) HoTT_printfxy(13,6," ")f0c4: 80 91 6e 04 lds r24, 0x046Ef0c8: 88 23 and r24, r24f0ca: c9 f0 breq .+50 ; 0xf0fe <HoTT_Menu+0x24c0>f0cc: 80 91 ed 02 lds r24, 0x02EDf0d0: 88 23 and r24, r24f0d2: a9 f0 breq .+42 ; 0xf0fe <HoTT_Menu+0x24c0>f0d4: 8b e8 ldi r24, 0x8B ; 139f0d6: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>f0da: 85 e6 ldi r24, 0x65 ; 101f0dc: 95 e0 ldi r25, 0x05 ; 5f0de: 9f 93 push r25f0e0: 8f 93 push r24f0e2: 8b e0 ldi r24, 0x0B ; 11f0e4: 95 e1 ldi r25, 0x15 ; 21f0e6: 9f 93 push r25f0e8: 8f 93 push r24f0ea: e0 91 78 06 lds r30, 0x0678f0ee: f0 91 79 06 lds r31, 0x0679f0f2: 09 95 icallf0f4: 0f 90 pop r0f0f6: 0f 90 pop r0f0f8: 0f 90 pop r0f0fa: 0f 90 pop r0f0fc: 2f c0 rjmp .+94 ; 0xf15c <HoTT_Menu+0x251e>else HoTT_printfxy(13,6,"%2d ",wp_tmp);f0fe: 8b e8 ldi r24, 0x8B ; 139f100: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>f104: 80 91 6f 04 lds r24, 0x046Ff108: 1f 92 push r1f10a: 8f 93 push r24f10c: 80 e6 ldi r24, 0x60 ; 96f10e: 95 e0 ldi r25, 0x05 ; 5f110: 9f 93 push r25f112: 8f 93 push r24f114: 8b e0 ldi r24, 0x0B ; 11f116: 95 e1 ldi r25, 0x15 ; 21f118: 9f 93 push r25f11a: 8f 93 push r24f11c: e0 91 78 06 lds r30, 0x0678f120: f0 91 79 06 lds r31, 0x0679f124: 09 95 icallf126: 0f 90 pop r0f128: 0f 90 pop r0f12a: 0f 90 pop r0f12c: 0f 90 pop r0f12e: 0f 90 pop r0f130: 0f 90 pop r0f132: 14 c0 rjmp .+40 ; 0xf15c <HoTT_Menu+0x251e>}else{HoTT_printfxy(13,6,"--")f134: 8b e8 ldi r24, 0x8B ; 139f136: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>f13a: 8d e5 ldi r24, 0x5D ; 93f13c: 95 e0 ldi r25, 0x05 ; 5f13e: 9f 93 push r25f140: 8f 93 push r24f142: 8b e0 ldi r24, 0x0B ; 11f144: 95 e1 ldi r25, 0x15 ; 21f146: 9f 93 push r25f148: 8f 93 push r24f14a: e0 91 78 06 lds r30, 0x0678f14e: f0 91 79 06 lds r31, 0x0679f152: 09 95 icallf154: 0f 90 pop r0f156: 0f 90 pop r0f158: 0f 90 pop r0f15a: 0f 90 pop r0}if(GPSInfo.SatFix == SATFIX_3D)f15c: 80 91 d9 08 lds r24, 0x08D9f160: 83 30 cpi r24, 0x03 ; 3f162: 09 f0 breq .+2 ; 0xf166 <HoTT_Menu+0x2528>f164: 45 c0 rjmp .+138 ; 0xf1f0 <HoTT_Menu+0x25b2>{if(NaviData_MaxWpListIndex == 0) HoTT_printfxy(0,7,"No SD-Card ")f166: 80 91 89 04 lds r24, 0x0489f16a: 81 11 cpse r24, r1f16c: 15 c0 rjmp .+42 ; 0xf198 <HoTT_Menu+0x255a>f16e: 83 e9 ldi r24, 0x93 ; 147f170: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>f174: 8f e4 ldi r24, 0x4F ; 79f176: 95 e0 ldi r25, 0x05 ; 5f178: 9f 93 push r25f17a: 8f 93 push r24f17c: 8b e0 ldi r24, 0x0B ; 11f17e: 95 e1 ldi r25, 0x15 ; 21f180: 9f 93 push r25f182: 8f 93 push r24f184: e0 91 78 06 lds r30, 0x0678f188: f0 91 79 06 lds r31, 0x0679f18c: 09 95 icallf18e: 0f 90 pop r0f190: 0f 90 pop r0f192: 0f 90 pop r0f194: 0f 90 pop r0f196: 20 c0 rjmp .+64 ; 0xf1d8 <HoTT_Menu+0x259a>else{if(changed && wp_tmp) HoTT_printfxy(0,7,"(Set -> Store)")f198: 80 91 6e 04 lds r24, 0x046Ef19c: 88 23 and r24, r24f19e: c9 f0 breq .+50 ; 0xf1d2 <HoTT_Menu+0x2594>f1a0: 80 91 6f 04 lds r24, 0x046Ff1a4: 88 23 and r24, r24f1a6: a9 f0 breq .+42 ; 0xf1d2 <HoTT_Menu+0x2594>f1a8: 83 e9 ldi r24, 0x93 ; 147f1aa: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>f1ae: 80 e4 ldi r24, 0x40 ; 64f1b0: 95 e0 ldi r25, 0x05 ; 5f1b2: 9f 93 push r25f1b4: 8f 93 push r24f1b6: 8b e0 ldi r24, 0x0B ; 11f1b8: 95 e1 ldi r25, 0x15 ; 21f1ba: 9f 93 push r25f1bc: 8f 93 push r24f1be: e0 91 78 06 lds r30, 0x0678f1c2: f0 91 79 06 lds r31, 0x0679f1c6: 09 95 icallf1c8: 0f 90 pop r0f1ca: 0f 90 pop r0f1cc: 0f 90 pop r0f1ce: 0f 90 pop r0f1d0: 03 c0 rjmp .+6 ; 0xf1d8 <HoTT_Menu+0x259a>else Hott_ClearLine(7);f1d2: 87 e0 ldi r24, 0x07 ; 7f1d4: 0e 94 b4 60 call 0xc168 ; 0xc168 <Hott_ClearLine>}if(HottKeyboard == HOTT_KEY_SET) { if(wp_tmp) ToNC_Store_SingePoint = wp_tmp; changed = 0;}f1d8: 80 91 a9 0c lds r24, 0x0CA9f1dc: 86 30 cpi r24, 0x06 ; 6f1de: e1 f4 brne .+56 ; 0xf218 <HoTT_Menu+0x25da>f1e0: 80 91 6f 04 lds r24, 0x046Ff1e4: 81 11 cpse r24, r1f1e6: 80 93 87 04 sts 0x0487, r24f1ea: 10 92 6e 04 sts 0x046E, r1f1ee: 14 c0 rjmp .+40 ; 0xf218 <HoTT_Menu+0x25da>}else HoTT_printfxy(0,7,"!No GPS-Fix! ");f1f0: 83 e9 ldi r24, 0x93 ; 147f1f2: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>f1f6: 82 e3 ldi r24, 0x32 ; 50f1f8: 95 e0 ldi r25, 0x05 ; 5f1fa: 9f 93 push r25f1fc: 8f 93 push r24f1fe: 8b e0 ldi r24, 0x0B ; 11f200: 95 e1 ldi r25, 0x15 ; 21f202: 9f 93 push r25f204: 8f 93 push r24f206: e0 91 78 06 lds r30, 0x0678f20a: f0 91 79 06 lds r31, 0x0679f20e: 09 95 icallf210: 0f 90 pop r0f212: 0f 90 pop r0f214: 0f 90 pop r0f216: 0f 90 pop r0if(HottKeyboard == HOTT_KEY_UP && wp_tmp < NaviData_MaxWpListIndex) { changed = 1; wp_tmp++; HoTTBlink = 0;}f218: 80 91 a9 0c lds r24, 0x0CA9f21c: 84 30 cpi r24, 0x04 ; 4f21e: 79 f4 brne .+30 ; 0xf23e <HoTT_Menu+0x2600>f220: 80 91 6f 04 lds r24, 0x046Ff224: 90 91 89 04 lds r25, 0x0489f228: 89 17 cp r24, r25f22a: 18 f5 brcc .+70 ; 0xf272 <HoTT_Menu+0x2634>f22c: 91 e0 ldi r25, 0x01 ; 1f22e: 90 93 6e 04 sts 0x046E, r25f232: 8f 5f subi r24, 0xFF ; 255f234: 80 93 6f 04 sts 0x046F, r24f238: 10 92 ed 02 sts 0x02ED, r1f23c: 1a c0 rjmp .+52 ; 0xf272 <HoTT_Menu+0x2634>if(HottKeyboard == HOTT_KEY_DOWN && wp_tmp > 1) { changed = 1; wp_tmp--; HoTTBlink = 0;};f23e: 82 30 cpi r24, 0x02 ; 2f240: 69 f4 brne .+26 ; 0xf25c <HoTT_Menu+0x261e>f242: 80 91 6f 04 lds r24, 0x046Ff246: 82 30 cpi r24, 0x02 ; 2f248: a0 f0 brcs .+40 ; 0xf272 <HoTT_Menu+0x2634>f24a: 91 e0 ldi r25, 0x01 ; 1f24c: 90 93 6e 04 sts 0x046E, r25f250: 81 50 subi r24, 0x01 ; 1f252: 80 93 6f 04 sts 0x046F, r24f256: 10 92 ed 02 sts 0x02ED, r1f25a: 0b c0 rjmp .+22 ; 0xf272 <HoTT_Menu+0x2634>if(HottKeyboard == HOTT_KEY_LEFT) { LIBFC_HoTT_Clear(); page++; line = 0;}f25c: 88 30 cpi r24, 0x08 ; 8f25e: 49 f4 brne .+18 ; 0xf272 <HoTT_Menu+0x2634>f260: 0e 94 3a 15 call 0x2a74 ; 0x2a74 <LIBFC_HoTT_Clear>f264: 80 91 76 04 lds r24, 0x0476f268: 8f 5f subi r24, 0xFF ; 255f26a: 80 93 76 04 sts 0x0476, r24f26e: 10 92 75 04 sts 0x0475, r1if(HottKeyboard == HOTT_KEY_RIGHT) { LIBFC_HoTT_Clear(); page--; line = 0;};f272: 80 91 a9 0c lds r24, 0x0CA9f276: 81 30 cpi r24, 0x01 ; 1f278: 49 f4 brne .+18 ; 0xf28c <HoTT_Menu+0x264e>f27a: 0e 94 3a 15 call 0x2a74 ; 0x2a74 <LIBFC_HoTT_Clear>f27e: 80 91 76 04 lds r24, 0x0476f282: 81 50 subi r24, 0x01 ; 1f284: 80 93 76 04 sts 0x0476, r24f288: 10 92 75 04 sts 0x0475, r1HottKeyboard = 0;f28c: 10 92 a9 0c sts 0x0CA9, r1break;f290: 50 c2 rjmp .+1184 ; 0xf732 <HoTT_Menu+0x2af4>default: line = 0;f292: 10 92 75 04 sts 0x0475, r1break;f296: 4d c2 rjmp .+1178 ; 0xf732 <HoTT_Menu+0x2af4>}break;case 6:switch(line++)f298: 80 91 75 04 lds r24, 0x0475f29c: 91 e0 ldi r25, 0x01 ; 1f29e: 98 0f add r25, r24f2a0: 90 93 75 04 sts 0x0475, r25f2a4: 82 30 cpi r24, 0x02 ; 2f2a6: 09 f4 brne .+2 ; 0xf2aa <HoTT_Menu+0x266c>f2a8: ab c0 rjmp .+342 ; 0xf400 <HoTT_Menu+0x27c2>f2aa: 28 f4 brcc .+10 ; 0xf2b6 <HoTT_Menu+0x2678>f2ac: 88 23 and r24, r24f2ae: 39 f0 breq .+14 ; 0xf2be <HoTT_Menu+0x2680>f2b0: 81 30 cpi r24, 0x01 ; 1f2b2: d1 f0 breq .+52 ; 0xf2e8 <HoTT_Menu+0x26aa>f2b4: 39 c2 rjmp .+1138 ; 0xf728 <HoTT_Menu+0x2aea>f2b6: 86 30 cpi r24, 0x06 ; 6f2b8: 08 f4 brcc .+2 ; 0xf2bc <HoTT_Menu+0x267e>f2ba: 36 c1 rjmp .+620 ; 0xf528 <HoTT_Menu+0x28ea>f2bc: 35 c2 rjmp .+1130 ; 0xf728 <HoTT_Menu+0x2aea>{static unsigned char wp_tmp, changed;case 0:HoTT_printfxy(0,0,"Load single Position");f2be: 80 e0 ldi r24, 0x00 ; 0f2c0: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>f2c4: 8d e1 ldi r24, 0x1D ; 29f2c6: 95 e0 ldi r25, 0x05 ; 5f2c8: 9f 93 push r25f2ca: 8f 93 push r24f2cc: 8b e0 ldi r24, 0x0B ; 11f2ce: 95 e1 ldi r25, 0x15 ; 21f2d0: 9f 93 push r25f2d2: 8f 93 push r24f2d4: e0 91 78 06 lds r30, 0x0678f2d8: f0 91 79 06 lds r31, 0x0679f2dc: 09 95 icall// HoTT_printfxy(0,1,"(Fixed Positions)");break;f2de: 0f 90 pop r0f2e0: 0f 90 pop r0f2e2: 0f 90 pop r0f2e4: 0f 90 pop r0f2e6: 25 c2 rjmp .+1098 ; 0xf732 <HoTT_Menu+0x2af4>case 1:HoTT_printfxy(0,2," %2i.%1iV ",UBat/10, UBat%10)f2e8: 8a e2 ldi r24, 0x2A ; 42f2ea: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>f2ee: 80 91 1a 01 lds r24, 0x011Af2f2: 90 91 1b 01 lds r25, 0x011Bf2f6: e0 91 1a 01 lds r30, 0x011Af2fa: f0 91 1b 01 lds r31, 0x011Bf2fe: 2a e0 ldi r18, 0x0A ; 10f300: 30 e0 ldi r19, 0x00 ; 0f302: b9 01 movw r22, r18f304: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>f308: 9f 93 push r25f30a: 8f 93 push r24f30c: cf 01 movw r24, r30f30e: b9 01 movw r22, r18f310: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>f314: 7f 93 push r23f316: 6f 93 push r22f318: 82 e1 ldi r24, 0x12 ; 18f31a: 95 e0 ldi r25, 0x05 ; 5f31c: 9f 93 push r25f31e: 8f 93 push r24f320: 0b e0 ldi r16, 0x0B ; 11f322: 15 e1 ldi r17, 0x15 ; 21f324: 1f 93 push r17f326: 0f 93 push r16f328: e0 91 78 06 lds r30, 0x0678f32c: f0 91 79 06 lds r31, 0x0679f330: 09 95 icallHoTT_printfxy(0,3," %2i:%02i ",FlugSekunden/60,FlugSekunden%60);f332: 8f e3 ldi r24, 0x3F ; 63f334: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>f338: 40 91 5e 04 lds r20, 0x045Ef33c: 50 91 5f 04 lds r21, 0x045Ff340: 9a 01 movw r18, r20f342: a9 e8 ldi r26, 0x89 ; 137f344: b8 e8 ldi r27, 0x88 ; 136f346: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>f34a: 96 95 lsr r25f34c: 87 95 ror r24f34e: 92 95 swap r25f350: 82 95 swap r24f352: 8f 70 andi r24, 0x0F ; 15f354: 89 27 eor r24, r25f356: 9f 70 andi r25, 0x0F ; 15f358: 89 27 eor r24, r25f35a: 6c e3 ldi r22, 0x3C ; 60f35c: 68 9f mul r22, r24f35e: 90 01 movw r18, r0f360: 69 9f mul r22, r25f362: 30 0d add r19, r0f364: 11 24 eor r1, r1f366: ca 01 movw r24, r20f368: 82 1b sub r24, r18f36a: 93 0b sbc r25, r19f36c: 9f 93 push r25f36e: 8f 93 push r24f370: 9a 01 movw r18, r20f372: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>f376: 96 95 lsr r25f378: 87 95 ror r24f37a: 92 95 swap r25f37c: 82 95 swap r24f37e: 8f 70 andi r24, 0x0F ; 15f380: 89 27 eor r24, r25f382: 9f 70 andi r25, 0x0F ; 15f384: 89 27 eor r24, r25f386: 9f 93 push r25f388: 8f 93 push r24f38a: 87 e0 ldi r24, 0x07 ; 7f38c: 95 e0 ldi r25, 0x05 ; 5f38e: 9f 93 push r25f390: 8f 93 push r24f392: 1f 93 push r17f394: 0f 93 push r16f396: e0 91 78 06 lds r30, 0x0678f39a: f0 91 79 06 lds r31, 0x0679f39e: 09 95 icall// HoTT_printfxy(0,4,"Dist:%3dm",NaviData_TargetDistance)if(NaviData_WaypointNumber) HoTT_printfxy(0,5,"WP:%2d/%d Dist:%3dm ",NaviData_WaypointIndex,NaviData_WaypointNumber,NaviData_TargetDistance)f3a0: 0f b6 in r0, 0x3f ; 63f3a2: f8 94 clif3a4: de bf out 0x3e, r29 ; 62f3a6: 0f be out 0x3f, r0 ; 63f3a8: cd bf out 0x3d, r28 ; 61f3aa: 80 91 8c 04 lds r24, 0x048Cf3ae: 88 23 and r24, r24f3b0: 19 f1 breq .+70 ; 0xf3f8 <HoTT_Menu+0x27ba>f3b2: 89 e6 ldi r24, 0x69 ; 105f3b4: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>f3b8: 80 91 86 04 lds r24, 0x0486f3bc: 8f 93 push r24f3be: 80 91 85 04 lds r24, 0x0485f3c2: 8f 93 push r24f3c4: 80 91 8c 04 lds r24, 0x048Cf3c8: 1f 92 push r1f3ca: 8f 93 push r24f3cc: 80 91 8d 04 lds r24, 0x048Df3d0: 1f 92 push r1f3d2: 8f 93 push r24f3d4: 82 ef ldi r24, 0xF2 ; 242f3d6: 94 e0 ldi r25, 0x04 ; 4f3d8: 9f 93 push r25f3da: 8f 93 push r24f3dc: c8 01 movw r24, r16f3de: 9f 93 push r25f3e0: 0f 93 push r16f3e2: e0 91 78 06 lds r30, 0x0678f3e6: f0 91 79 06 lds r31, 0x0679f3ea: 09 95 icallf3ec: 0f b6 in r0, 0x3f ; 63f3ee: f8 94 clif3f0: de bf out 0x3e, r29 ; 62f3f2: 0f be out 0x3f, r0 ; 63f3f4: cd bf out 0x3d, r28 ; 61f3f6: 9d c1 rjmp .+826 ; 0xf732 <HoTT_Menu+0x2af4>else Hott_ClearLine(5);f3f8: 85 e0 ldi r24, 0x05 ; 5f3fa: 0e 94 b4 60 call 0xc168 ; 0xc168 <Hott_ClearLine>f3fe: 99 c1 rjmp .+818 ; 0xf732 <HoTT_Menu+0x2af4>break;case 2:if(FromNC_AltitudeSpeed)f400: 80 91 f3 03 lds r24, 0x03F3f404: 88 23 and r24, r24f406: c9 f1 breq .+114 ; 0xf47a <HoTT_Menu+0x283c>HoTT_printfxy(8,2,"ALT:%4i/%im ", (int16_t)(HoehenWert/100),(int16_t)(FromNC_AltitudeSetpoint/100))f408: 82 e3 ldi r24, 0x32 ; 50f40a: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>f40e: 60 91 f4 03 lds r22, 0x03F4f412: 70 91 f5 03 lds r23, 0x03F5f416: 80 91 f6 03 lds r24, 0x03F6f41a: 90 91 f7 03 lds r25, 0x03F7f41e: 0f 2e mov r0, r31f420: f4 e6 ldi r31, 0x64 ; 100f422: cf 2e mov r12, r31f424: d1 2c mov r13, r1f426: e1 2c mov r14, r1f428: f1 2c mov r15, r1f42a: f0 2d mov r31, r0f42c: a7 01 movw r20, r14f42e: 96 01 movw r18, r12f430: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>f434: 3f 93 push r19f436: 2f 93 push r18f438: 60 91 fe 03 lds r22, 0x03FEf43c: 70 91 ff 03 lds r23, 0x03FFf440: 80 91 00 04 lds r24, 0x0400f444: 90 91 01 04 lds r25, 0x0401f448: a7 01 movw r20, r14f44a: 96 01 movw r18, r12f44c: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>f450: 3f 93 push r19f452: 2f 93 push r18f454: 85 ee ldi r24, 0xE5 ; 229f456: 94 e0 ldi r25, 0x04 ; 4f458: 9f 93 push r25f45a: 8f 93 push r24f45c: 8b e0 ldi r24, 0x0B ; 11f45e: 95 e1 ldi r25, 0x15 ; 21f460: 9f 93 push r25f462: 8f 93 push r24f464: e0 91 78 06 lds r30, 0x0678f468: f0 91 79 06 lds r31, 0x0679f46c: 09 95 icallf46e: 0f b6 in r0, 0x3f ; 63f470: f8 94 clif472: de bf out 0x3e, r29 ; 62f474: 0f be out 0x3f, r0 ; 63f476: cd bf out 0x3d, r28 ; 61f478: 26 c0 rjmp .+76 ; 0xf4c6 <HoTT_Menu+0x2888>elseHoTT_printfxy(8,2,"ALT:%4im ",(int16_t)(HoehenWert/100))f47a: 82 e3 ldi r24, 0x32 ; 50f47c: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>f480: 60 91 fe 03 lds r22, 0x03FEf484: 70 91 ff 03 lds r23, 0x03FFf488: 80 91 00 04 lds r24, 0x0400f48c: 90 91 01 04 lds r25, 0x0401f490: 24 e6 ldi r18, 0x64 ; 100f492: 30 e0 ldi r19, 0x00 ; 0f494: 40 e0 ldi r20, 0x00 ; 0f496: 50 e0 ldi r21, 0x00 ; 0f498: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>f49c: 3f 93 push r19f49e: 2f 93 push r18f4a0: 88 ed ldi r24, 0xD8 ; 216f4a2: 94 e0 ldi r25, 0x04 ; 4f4a4: 9f 93 push r25f4a6: 8f 93 push r24f4a8: 8b e0 ldi r24, 0x0B ; 11f4aa: 95 e1 ldi r25, 0x15 ; 21f4ac: 9f 93 push r25f4ae: 8f 93 push r24f4b0: e0 91 78 06 lds r30, 0x0678f4b4: f0 91 79 06 lds r31, 0x0679f4b8: 09 95 icallf4ba: 0f 90 pop r0f4bc: 0f 90 pop r0f4be: 0f 90 pop r0f4c0: 0f 90 pop r0f4c2: 0f 90 pop r0f4c4: 0f 90 pop r0HoTT_printfxy(8,3,"DIR: %3d%c",CompassCorrected, HoTT_GRAD);f4c6: 87 e4 ldi r24, 0x47 ; 71f4c8: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>f4cc: 1f 92 push r1f4ce: 80 e6 ldi r24, 0x60 ; 96f4d0: 8f 93 push r24f4d2: 80 91 66 06 lds r24, 0x0666f4d6: 8f 93 push r24f4d8: 80 91 65 06 lds r24, 0x0665f4dc: 8f 93 push r24f4de: 8d ec ldi r24, 0xCD ; 205f4e0: 94 e0 ldi r25, 0x04 ; 4f4e2: 9f 93 push r25f4e4: 8f 93 push r24f4e6: 0b e0 ldi r16, 0x0B ; 11f4e8: 15 e1 ldi r17, 0x15 ; 21f4ea: 1f 93 push r17f4ec: 0f 93 push r16f4ee: e0 91 78 06 lds r30, 0x0678f4f2: f0 91 79 06 lds r31, 0x0679f4f6: 09 95 icallHoTT_printfxy(8,4,"Cam: %3i",Parameter_ServoNickControl);f4f8: 8c e5 ldi r24, 0x5C ; 92f4fa: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>f4fe: 80 91 2f 01 lds r24, 0x012Ff502: 1f 92 push r1f504: 8f 93 push r24f506: 84 ec ldi r24, 0xC4 ; 196f508: 94 e0 ldi r25, 0x04 ; 4f50a: 9f 93 push r25f50c: 8f 93 push r24f50e: 1f 93 push r17f510: 0f 93 push r16f512: e0 91 78 06 lds r30, 0x0678f516: f0 91 79 06 lds r31, 0x0679f51a: 09 95 icallbreak;f51c: 0f b6 in r0, 0x3f ; 63f51e: f8 94 clif520: de bf out 0x3e, r29 ; 62f522: 0f be out 0x3f, r0 ; 63f524: cd bf out 0x3d, r28 ; 61f526: 05 c1 rjmp .+522 ; 0xf732 <HoTT_Menu+0x2af4>// HoTT_printfxy(11,7,"%s",WPL_Name)case 3:case 4:case 5:if(HottKeyboard) DebugOut.Analog[17]++;f528: 80 91 a9 0c lds r24, 0x0CA9f52c: 88 23 and r24, r24f52e: 39 f0 breq .+14 ; 0xf53e <HoTT_Menu+0x2900>f530: ea e6 ldi r30, 0x6A ; 106f532: fc e0 ldi r31, 0x0C ; 12f534: 80 81 ld r24, Zf536: 91 81 ldd r25, Z+1 ; 0x01f538: 01 96 adiw r24, 0x01 ; 1f53a: 91 83 std Z+1, r25 ; 0x01f53c: 80 83 st Z, r24HoTT_printfxy(0,6,"load point:")f53e: 8e e7 ldi r24, 0x7E ; 126f540: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>f544: 88 eb ldi r24, 0xB8 ; 184f546: 94 e0 ldi r25, 0x04 ; 4f548: 9f 93 push r25f54a: 8f 93 push r24f54c: 8b e0 ldi r24, 0x0B ; 11f54e: 95 e1 ldi r25, 0x15 ; 21f550: 9f 93 push r25f552: 8f 93 push r24f554: e0 91 78 06 lds r30, 0x0678f558: f0 91 79 06 lds r31, 0x0679f55c: 09 95 icallif(wp_tmp)f55e: 0f 90 pop r0f560: 0f 90 pop r0f562: 0f 90 pop r0f564: 0f 90 pop r0f566: 80 91 6d 04 lds r24, 0x046Df56a: 88 23 and r24, r24f56c: c1 f1 breq .+112 ; 0xf5de <HoTT_Menu+0x29a0>{if(changed && HoTTBlink) HoTT_printfxy(11,6," ")f56e: 80 91 6c 04 lds r24, 0x046Cf572: 88 23 and r24, r24f574: c9 f0 breq .+50 ; 0xf5a8 <HoTT_Menu+0x296a>f576: 80 91 ed 02 lds r24, 0x02EDf57a: 88 23 and r24, r24f57c: a9 f0 breq .+42 ; 0xf5a8 <HoTT_Menu+0x296a>f57e: 89 e8 ldi r24, 0x89 ; 137f580: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>f584: 84 eb ldi r24, 0xB4 ; 180f586: 94 e0 ldi r25, 0x04 ; 4f588: 9f 93 push r25f58a: 8f 93 push r24f58c: 8b e0 ldi r24, 0x0B ; 11f58e: 95 e1 ldi r25, 0x15 ; 21f590: 9f 93 push r25f592: 8f 93 push r24f594: e0 91 78 06 lds r30, 0x0678f598: f0 91 79 06 lds r31, 0x0679f59c: 09 95 icallf59e: 0f 90 pop r0f5a0: 0f 90 pop r0f5a2: 0f 90 pop r0f5a4: 0f 90 pop r0f5a6: 2f c0 rjmp .+94 ; 0xf606 <HoTT_Menu+0x29c8>else HoTT_printfxy(11,6,"%2d",wp_tmp);f5a8: 89 e8 ldi r24, 0x89 ; 137f5aa: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>f5ae: 80 91 6d 04 lds r24, 0x046Df5b2: 1f 92 push r1f5b4: 8f 93 push r24f5b6: 80 eb ldi r24, 0xB0 ; 176f5b8: 94 e0 ldi r25, 0x04 ; 4f5ba: 9f 93 push r25f5bc: 8f 93 push r24f5be: 8b e0 ldi r24, 0x0B ; 11f5c0: 95 e1 ldi r25, 0x15 ; 21f5c2: 9f 93 push r25f5c4: 8f 93 push r24f5c6: e0 91 78 06 lds r30, 0x0678f5ca: f0 91 79 06 lds r31, 0x0679f5ce: 09 95 icallf5d0: 0f 90 pop r0f5d2: 0f 90 pop r0f5d4: 0f 90 pop r0f5d6: 0f 90 pop r0f5d8: 0f 90 pop r0f5da: 0f 90 pop r0f5dc: 14 c0 rjmp .+40 ; 0xf606 <HoTT_Menu+0x29c8>}else{HoTT_printfxy(11,6,"--")f5de: 89 e8 ldi r24, 0x89 ; 137f5e0: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>f5e4: 8d ea ldi r24, 0xAD ; 173f5e6: 94 e0 ldi r25, 0x04 ; 4f5e8: 9f 93 push r25f5ea: 8f 93 push r24f5ec: 8b e0 ldi r24, 0x0B ; 11f5ee: 95 e1 ldi r25, 0x15 ; 21f5f0: 9f 93 push r25f5f2: 8f 93 push r24f5f4: e0 91 78 06 lds r30, 0x0678f5f8: f0 91 79 06 lds r31, 0x0679f5fc: 09 95 icallf5fe: 0f 90 pop r0f600: 0f 90 pop r0f602: 0f 90 pop r0f604: 0f 90 pop r0}if(NaviData_MaxWpListIndex == 0) HoTT_printfxy(0,7,"No SD-Card ")f606: 80 91 89 04 lds r24, 0x0489f60a: 81 11 cpse r24, r1f60c: 15 c0 rjmp .+42 ; 0xf638 <HoTT_Menu+0x29fa>f60e: 83 e9 ldi r24, 0x93 ; 147f610: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>f614: 8f e9 ldi r24, 0x9F ; 159f616: 94 e0 ldi r25, 0x04 ; 4f618: 9f 93 push r25f61a: 8f 93 push r24f61c: 8b e0 ldi r24, 0x0B ; 11f61e: 95 e1 ldi r25, 0x15 ; 21f620: 9f 93 push r25f622: 8f 93 push r24f624: e0 91 78 06 lds r30, 0x0678f628: f0 91 79 06 lds r31, 0x0679f62c: 09 95 icallf62e: 0f 90 pop r0f630: 0f 90 pop r0f632: 0f 90 pop r0f634: 0f 90 pop r0f636: 3e c0 rjmp .+124 ; 0xf6b4 <HoTT_Menu+0x2a76>else{if(changed && wp_tmp) HoTT_printfxy(0,7,"(Set -> Load)")f638: 80 91 6c 04 lds r24, 0x046Cf63c: 88 23 and r24, r24f63e: c9 f0 breq .+50 ; 0xf672 <HoTT_Menu+0x2a34>f640: 80 91 6d 04 lds r24, 0x046Df644: 88 23 and r24, r24f646: a9 f0 breq .+42 ; 0xf672 <HoTT_Menu+0x2a34>f648: 83 e9 ldi r24, 0x93 ; 147f64a: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>f64e: 81 e9 ldi r24, 0x91 ; 145f650: 94 e0 ldi r25, 0x04 ; 4f652: 9f 93 push r25f654: 8f 93 push r24f656: 8b e0 ldi r24, 0x0B ; 11f658: 95 e1 ldi r25, 0x15 ; 21f65a: 9f 93 push r25f65c: 8f 93 push r24f65e: e0 91 78 06 lds r30, 0x0678f662: f0 91 79 06 lds r31, 0x0679f666: 09 95 icallf668: 0f 90 pop r0f66a: 0f 90 pop r0f66c: 0f 90 pop r0f66e: 0f 90 pop r0f670: 21 c0 rjmp .+66 ; 0xf6b4 <HoTT_Menu+0x2a76>else{Hott_ClearLine(7);f672: 87 e0 ldi r24, 0x07 ; 7f674: 0e 94 b4 60 call 0xc168 ; 0xc168 <Hott_ClearLine>if(NaviData_WaypointNumber) HoTT_printfxy(0,7,"%s",WPL_Name);f678: 80 91 8c 04 lds r24, 0x048Cf67c: 88 23 and r24, r24f67e: d1 f0 breq .+52 ; 0xf6b4 <HoTT_Menu+0x2a76>f680: 83 e9 ldi r24, 0x93 ; 147f682: 0e 94 35 15 call 0x2a6a ; 0x2a6a <LIBFC_HoTT_SetPos>f686: 82 ed ldi r24, 0xD2 ; 210f688: 96 e0 ldi r25, 0x06 ; 6f68a: 9f 93 push r25f68c: 8f 93 push r24f68e: 8e e8 ldi r24, 0x8E ; 142f690: 94 e0 ldi r25, 0x04 ; 4f692: 9f 93 push r25f694: 8f 93 push r24f696: 8b e0 ldi r24, 0x0B ; 11f698: 95 e1 ldi r25, 0x15 ; 21f69a: 9f 93 push r25f69c: 8f 93 push r24f69e: e0 91 78 06 lds r30, 0x0678f6a2: f0 91 79 06 lds r31, 0x0679f6a6: 09 95 icallf6a8: 0f 90 pop r0f6aa: 0f 90 pop r0f6ac: 0f 90 pop r0f6ae: 0f 90 pop r0f6b0: 0f 90 pop r0f6b2: 0f 90 pop r0}}if(HottKeyboard == HOTT_KEY_UP && wp_tmp < NaviData_MaxWpListIndex) { changed = 1; wp_tmp++; HoTTBlink = 0;}f6b4: 80 91 a9 0c lds r24, 0x0CA9f6b8: 84 30 cpi r24, 0x04 ; 4f6ba: 79 f4 brne .+30 ; 0xf6da <HoTT_Menu+0x2a9c>f6bc: 90 91 6d 04 lds r25, 0x046Df6c0: 20 91 89 04 lds r18, 0x0489f6c4: 92 17 cp r25, r18f6c6: 10 f5 brcc .+68 ; 0xf70c <HoTT_Menu+0x2ace>f6c8: 21 e0 ldi r18, 0x01 ; 1f6ca: 20 93 6c 04 sts 0x046C, r18f6ce: 9f 5f subi r25, 0xFF ; 255f6d0: 90 93 6d 04 sts 0x046D, r25f6d4: 10 92 ed 02 sts 0x02ED, r1f6d8: 19 c0 rjmp .+50 ; 0xf70c <HoTT_Menu+0x2ace>if(HottKeyboard == HOTT_KEY_DOWN && wp_tmp > 1) { changed = 1; wp_tmp--; HoTTBlink = 0;};f6da: 82 30 cpi r24, 0x02 ; 2f6dc: 69 f4 brne .+26 ; 0xf6f8 <HoTT_Menu+0x2aba>f6de: 80 91 6d 04 lds r24, 0x046Df6e2: 82 30 cpi r24, 0x02 ; 2f6e4: f0 f0 brcs .+60 ; 0xf722 <HoTT_Menu+0x2ae4>f6e6: 91 e0 ldi r25, 0x01 ; 1f6e8: 90 93 6c 04 sts 0x046C, r25f6ec: 81 50 subi r24, 0x01 ; 1f6ee: 80 93 6d 04 sts 0x046D, r24f6f2: 10 92 ed 02 sts 0x02ED, r1f6f6: 15 c0 rjmp .+42 ; 0xf722 <HoTT_Menu+0x2ae4>if(HottKeyboard == HOTT_KEY_SET) { if(wp_tmp) ToNC_Load_SingePoint = wp_tmp; changed = 0;}f6f8: 86 30 cpi r24, 0x06 ; 6f6fa: 41 f4 brne .+16 ; 0xf70c <HoTT_Menu+0x2ace>f6fc: 80 91 6d 04 lds r24, 0x046Df700: 81 11 cpse r24, r1f702: 80 93 88 04 sts 0x0488, r24f706: 10 92 6c 04 sts 0x046C, r1f70a: 0b c0 rjmp .+22 ; 0xf722 <HoTT_Menu+0x2ae4>// if(HottKeyboard == HOTT_KEY_LEFT) { LIBFC_HoTT_Clear(); page++; line = 0;}if(HottKeyboard == HOTT_KEY_RIGHT) { LIBFC_HoTT_Clear(); page--; line = 0;};f70c: 81 30 cpi r24, 0x01 ; 1f70e: 49 f4 brne .+18 ; 0xf722 <HoTT_Menu+0x2ae4>f710: 0e 94 3a 15 call 0x2a74 ; 0x2a74 <LIBFC_HoTT_Clear>f714: 80 91 76 04 lds r24, 0x0476f718: 81 50 subi r24, 0x01 ; 1f71a: 80 93 76 04 sts 0x0476, r24f71e: 10 92 75 04 sts 0x0475, r1HottKeyboard = 0;f722: 10 92 a9 0c sts 0x0CA9, r1break;f726: 05 c0 rjmp .+10 ; 0xf732 <HoTT_Menu+0x2af4>default: line = 0;f728: 10 92 75 04 sts 0x0475, r1break;f72c: 02 c0 rjmp .+4 ; 0xf732 <HoTT_Menu+0x2af4>}break;default: page = 0;f72e: 10 92 76 04 sts 0x0476, r1break;}}f732: 0f 90 pop r0f734: 0f 90 pop r0f736: 0f 90 pop r0f738: 0f 90 pop r0f73a: df 91 pop r29f73c: cf 91 pop r28f73e: 1f 91 pop r17f740: 0f 91 pop r16f742: ff 90 pop r15f744: ef 90 pop r14f746: df 90 pop r13f748: cf 90 pop r12f74a: bf 90 pop r11f74c: af 90 pop r10f74e: 9f 90 pop r9f750: 8f 90 pop r8f752: 7f 90 pop r7f754: 6f 90 pop r6f756: 5f 90 pop r5f758: 4f 90 pop r4f75a: 3f 90 pop r3f75c: 2f 90 pop r2f75e: 08 95 ret0000f760 <Menu_Temperature>:#endif}void Menu_Temperature(uint8_t key){ //0123456789ABCDEFf760: cf 93 push r28f762: df 93 push r29#if !defined (RECEIVER_SPEKTRUM_DX7EXP) && !defined (RECEIVER_SPEKTRUM_DX8EXP)JetiBox_printfxy(0,0,"%3i %3i %3i %3i", Motor[0].Temperature, Motor[1].Temperature, Motor[2].Temperature, Motor[3].Temperature);f764: 80 e0 ldi r24, 0x00 ; 0f766: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>f76a: 80 91 cb 09 lds r24, 0x09CBf76e: 1f 92 push r1f770: 8f 93 push r24f772: 80 91 bc 09 lds r24, 0x09BCf776: 1f 92 push r1f778: 8f 93 push r24f77a: 80 91 ad 09 lds r24, 0x09ADf77e: 1f 92 push r1f780: 8f 93 push r24f782: 80 91 9e 09 lds r24, 0x099Ef786: 1f 92 push r1f788: 8f 93 push r24f78a: 82 e4 ldi r24, 0x42 ; 66f78c: 90 e1 ldi r25, 0x10 ; 16f78e: 9f 93 push r25f790: 8f 93 push r24f792: ce e6 ldi r28, 0x6E ; 110f794: df e0 ldi r29, 0x0F ; 15f796: df 93 push r29f798: cf 93 push r28f79a: e0 91 78 06 lds r30, 0x0678f79e: f0 91 79 06 lds r31, 0x0679f7a2: 09 95 icallJetiBox_printfxy(0,1,"%3i %3i %3i %3i", Motor[4].Temperature, Motor[5].Temperature, Motor[6].Temperature, Motor[7].Temperature);f7a4: 80 e1 ldi r24, 0x10 ; 16f7a6: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>f7aa: 80 91 07 0a lds r24, 0x0A07f7ae: 1f 92 push r1f7b0: 8f 93 push r24f7b2: 80 91 f8 09 lds r24, 0x09F8f7b6: 1f 92 push r1f7b8: 8f 93 push r24f7ba: 80 91 e9 09 lds r24, 0x09E9f7be: 1f 92 push r1f7c0: 8f 93 push r24f7c2: 80 91 da 09 lds r24, 0x09DAf7c6: 1f 92 push r1f7c8: 8f 93 push r24f7ca: 82 e3 ldi r24, 0x32 ; 50f7cc: 90 e1 ldi r25, 0x10 ; 16f7ce: 9f 93 push r25f7d0: 8f 93 push r24f7d2: df 93 push r29f7d4: cf 93 push r28f7d6: e0 91 78 06 lds r30, 0x0678f7da: f0 91 79 06 lds r31, 0x0679f7de: 09 95 icallif(RequiredMotors <= 4)f7e0: 80 91 3d 05 lds r24, 0x053Df7e4: 2d b7 in r18, 0x3d ; 61f7e6: 3e b7 in r19, 0x3e ; 62f7e8: 28 5e subi r18, 0xE8 ; 232f7ea: 3f 4f sbci r19, 0xFF ; 255f7ec: 0f b6 in r0, 0x3f ; 63f7ee: f8 94 clif7f0: 3e bf out 0x3e, r19 ; 62f7f2: 0f be out 0x3f, r0 ; 63f7f4: 2d bf out 0x3d, r18 ; 61f7f6: 85 30 cpi r24, 0x05 ; 5f7f8: a0 f4 brcc .+40 ; 0xf822 <Menu_Temperature+0xc2>{JetiBox_printfxy(0,1,"Temperatures ");f7fa: 80 e1 ldi r24, 0x10 ; 16f7fc: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>f800: 81 e2 ldi r24, 0x21 ; 33f802: 90 e1 ldi r25, 0x10 ; 16f804: 9f 93 push r25f806: 8f 93 push r24f808: ce 01 movw r24, r28f80a: 9f 93 push r25f80c: cf 93 push r28f80e: e0 91 78 06 lds r30, 0x0678f812: f0 91 79 06 lds r31, 0x0679f816: 09 95 icallf818: 0f 90 pop r0f81a: 0f 90 pop r0f81c: 0f 90 pop r0f81e: 0f 90 pop r0f820: 1b c0 rjmp .+54 ; 0xf858 <Menu_Temperature+0xf8>}elseif(RequiredMotors <= 6)f822: 87 30 cpi r24, 0x07 ; 7f824: c8 f4 brcc .+50 ; 0xf858 <Menu_Temperature+0xf8>{JetiBox_printfxy(8,1,"\%cC ",0xdf);f826: 88 e1 ldi r24, 0x18 ; 24f828: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>f82c: 1f 92 push r1f82e: 8f ed ldi r24, 0xDF ; 223f830: 8f 93 push r24f832: 88 e1 ldi r24, 0x18 ; 24f834: 90 e1 ldi r25, 0x10 ; 16f836: 9f 93 push r25f838: 8f 93 push r24f83a: 8e e6 ldi r24, 0x6E ; 110f83c: 9f e0 ldi r25, 0x0F ; 15f83e: 9f 93 push r25f840: 8f 93 push r24f842: e0 91 78 06 lds r30, 0x0678f846: f0 91 79 06 lds r31, 0x0679f84a: 09 95 icallf84c: 0f 90 pop r0f84e: 0f 90 pop r0f850: 0f 90 pop r0f852: 0f 90 pop r0f854: 0f 90 pop r0f856: 0f 90 pop r0}#endif}f858: df 91 pop r29f85a: cf 91 pop r28f85c: 08 95 ret0000f85e <Menu_Battery>:void Menu_Battery(uint8_t key){ //0123456789ABCDEFf85e: cf 93 push r28f860: df 93 push r29#if !defined (RECEIVER_SPEKTRUM_DX7EXP) && !defined (RECEIVER_SPEKTRUM_DX8EXP)JetiBox_printfxy(0,0,"%2i.%1iV %3i.%1iA", UBat/10, UBat%10, Capacity.ActualCurrent/10, Capacity.ActualCurrent%10);f862: 80 e0 ldi r24, 0x00 ; 0f864: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>f868: 40 91 15 05 lds r20, 0x0515f86c: 50 91 16 05 lds r21, 0x0516f870: c0 91 1a 01 lds r28, 0x011Af874: d0 91 1b 01 lds r29, 0x011Bf878: e0 91 1a 01 lds r30, 0x011Af87c: f0 91 1b 01 lds r31, 0x011Bf880: 9a 01 movw r18, r20f882: ad ec ldi r26, 0xCD ; 205f884: bc ec ldi r27, 0xCC ; 204f886: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>f88a: 9c 01 movw r18, r24f88c: 36 95 lsr r19f88e: 27 95 ror r18f890: 36 95 lsr r19f892: 27 95 ror r18f894: 36 95 lsr r19f896: 27 95 ror r18f898: c9 01 movw r24, r18f89a: 88 0f add r24, r24f89c: 99 1f adc r25, r25f89e: 22 0f add r18, r18f8a0: 33 1f adc r19, r19f8a2: 22 0f add r18, r18f8a4: 33 1f adc r19, r19f8a6: 22 0f add r18, r18f8a8: 33 1f adc r19, r19f8aa: 28 0f add r18, r24f8ac: 39 1f adc r19, r25f8ae: ca 01 movw r24, r20f8b0: 82 1b sub r24, r18f8b2: 93 0b sbc r25, r19f8b4: 9c 01 movw r18, r24f8b6: 3f 93 push r19f8b8: 8f 93 push r24f8ba: 9a 01 movw r18, r20f8bc: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>f8c0: 96 95 lsr r25f8c2: 87 95 ror r24f8c4: 96 95 lsr r25f8c6: 87 95 ror r24f8c8: 96 95 lsr r25f8ca: 87 95 ror r24f8cc: 9f 93 push r25f8ce: 8f 93 push r24f8d0: 2a e0 ldi r18, 0x0A ; 10f8d2: 30 e0 ldi r19, 0x00 ; 0f8d4: ce 01 movw r24, r28f8d6: b9 01 movw r22, r18f8d8: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>f8dc: 9f 93 push r25f8de: 8f 93 push r24f8e0: cf 01 movw r24, r30f8e2: b9 01 movw r22, r18f8e4: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>f8e8: 7f 93 push r23f8ea: 6f 93 push r22f8ec: 86 e0 ldi r24, 0x06 ; 6f8ee: 90 e1 ldi r25, 0x10 ; 16f8f0: 9f 93 push r25f8f2: 8f 93 push r24f8f4: ce e6 ldi r28, 0x6E ; 110f8f6: df e0 ldi r29, 0x0F ; 15f8f8: df 93 push r29f8fa: cf 93 push r28f8fc: e0 91 78 06 lds r30, 0x0678f900: f0 91 79 06 lds r31, 0x0679f904: 09 95 icallJetiBox_printfxy(0,1,"%4iW %6imAh",Capacity.ActualPower, Capacity.UsedCapacity);f906: 80 e1 ldi r24, 0x10 ; 16f908: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>f90c: e9 e1 ldi r30, 0x19 ; 25f90e: f5 e0 ldi r31, 0x05 ; 5f910: 81 81 ldd r24, Z+1 ; 0x01f912: 8f 93 push r24f914: 80 81 ld r24, Zf916: 8f 93 push r24f918: e7 e1 ldi r30, 0x17 ; 23f91a: f5 e0 ldi r31, 0x05 ; 5f91c: 81 81 ldd r24, Z+1 ; 0x01f91e: 8f 93 push r24f920: 80 81 ld r24, Zf922: 8f 93 push r24f924: 8a ef ldi r24, 0xFA ; 250f926: 9f e0 ldi r25, 0x0F ; 15f928: 9f 93 push r25f92a: 8f 93 push r24f92c: df 93 push r29f92e: cf 93 push r28f930: e0 91 78 06 lds r30, 0x0678f934: f0 91 79 06 lds r31, 0x0679f938: 09 95 icallf93a: 8d b7 in r24, 0x3d ; 61f93c: 9e b7 in r25, 0x3e ; 62f93e: 44 96 adiw r24, 0x14 ; 20f940: 0f b6 in r0, 0x3f ; 63f942: f8 94 clif944: 9e bf out 0x3e, r25 ; 62f946: 0f be out 0x3f, r0 ; 63f948: 8d bf out 0x3d, r24 ; 61#endif}f94a: df 91 pop r29f94c: cf 91 pop r28f94e: 08 95 ret0000f950 <Magnet_Values>:void Magnet_Values(uint8_t key){ //0123456789ABCDEFf950: 1f 93 push r17f952: cf 93 push r28f954: df 93 push r29#if !defined (RECEIVER_SPEKTRUM_DX7EXP) && !defined (RECEIVER_SPEKTRUM_DX8EXP)JetiBox_printfxy(0,0,"Magnet:%3i%% %3i%c",EarthMagneticField, KompassValue,0xDF);f956: 80 e0 ldi r24, 0x00 ; 0f958: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>f95c: 1f 92 push r1f95e: 1f ed ldi r17, 0xDF ; 223f960: 1f 93 push r17f962: 80 91 4f 01 lds r24, 0x014Ff966: 8f 93 push r24f968: 80 91 4e 01 lds r24, 0x014Ef96c: 8f 93 push r24f96e: 80 91 ba 04 lds r24, 0x04BAf972: 1f 92 push r1f974: 8f 93 push r24f976: 87 ee ldi r24, 0xE7 ; 231f978: 9f e0 ldi r25, 0x0F ; 15f97a: 9f 93 push r25f97c: 8f 93 push r24f97e: ce e6 ldi r28, 0x6E ; 110f980: df e0 ldi r29, 0x0F ; 15f982: df 93 push r29f984: cf 93 push r28f986: e0 91 78 06 lds r30, 0x0678f98a: f0 91 79 06 lds r31, 0x0679f98e: 09 95 icallJetiBox_printfxy(0,1,"Incli.:%3i%c (%i) ",EarthMagneticInclination, 0xDF,EarthMagneticInclinationTheoretic);f990: 80 e1 ldi r24, 0x10 ; 16f992: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>f996: 80 91 b8 04 lds r24, 0x04B8f99a: 1f 92 push r1f99c: 8f 93 push r24f99e: 1f 92 push r1f9a0: 1f 93 push r17f9a2: 80 91 b9 04 lds r24, 0x04B9f9a6: 1f 92 push r1f9a8: 8f 93 push r24f9aa: 84 ed ldi r24, 0xD4 ; 212f9ac: 9f e0 ldi r25, 0x0F ; 15f9ae: 9f 93 push r25f9b0: 8f 93 push r24f9b2: df 93 push r29f9b4: cf 93 push r28f9b6: e0 91 78 06 lds r30, 0x0678f9ba: f0 91 79 06 lds r31, 0x0679f9be: 09 95 icallf9c0: 8d b7 in r24, 0x3d ; 61f9c2: 9e b7 in r25, 0x3e ; 62f9c4: 44 96 adiw r24, 0x14 ; 20f9c6: 0f b6 in r0, 0x3f ; 63f9c8: f8 94 clif9ca: 9e bf out 0x3e, r25 ; 62f9cc: 0f be out 0x3f, r0 ; 63f9ce: 8d bf out 0x3d, r24 ; 61#endif}f9d0: df 91 pop r29f9d2: cf 91 pop r28f9d4: 1f 91 pop r17f9d6: 08 95 ret0000f9d8 <Menu_WPL_A1>:void Menu_WPL_A1(uint8_t key){ //0123456789ABCDEFf9d8: cf 93 push r28f9da: df 93 push r29#if !defined (RECEIVER_SPEKTRUM_DX7EXP) && !defined (RECEIVER_SPEKTRUM_DX8EXP)JetiBox_printfxy(0,0,"Load Waypoints");f9dc: 80 e0 ldi r24, 0x00 ; 0f9de: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>f9e2: 85 ec ldi r24, 0xC5 ; 197f9e4: 9f e0 ldi r25, 0x0F ; 15f9e6: 9f 93 push r25f9e8: 8f 93 push r24f9ea: ce e6 ldi r28, 0x6E ; 110f9ec: df e0 ldi r29, 0x0F ; 15f9ee: df 93 push r29f9f0: cf 93 push r28f9f2: e0 91 78 06 lds r30, 0x0678f9f6: f0 91 79 06 lds r31, 0x0679f9fa: 09 95 icallJetiBox_printfxy(0,1,"(Fixed) ");f9fc: 80 e1 ldi r24, 0x10 ; 16f9fe: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>fa02: 87 eb ldi r24, 0xB7 ; 183fa04: 9f e0 ldi r25, 0x0F ; 15fa06: 9f 93 push r25fa08: 8f 93 push r24fa0a: df 93 push r29fa0c: cf 93 push r28fa0e: e0 91 78 06 lds r30, 0x0678fa12: f0 91 79 06 lds r31, 0x0679fa16: 09 95 icallfa18: 8d b7 in r24, 0x3d ; 61fa1a: 9e b7 in r25, 0x3e ; 62fa1c: 08 96 adiw r24, 0x08 ; 8fa1e: 0f b6 in r0, 0x3f ; 63fa20: f8 94 clifa22: 9e bf out 0x3e, r25 ; 62fa24: 0f be out 0x3f, r0 ; 63fa26: 8d bf out 0x3d, r24 ; 61#endif}fa28: df 91 pop r29fa2a: cf 91 pop r28fa2c: 08 95 ret0000fa2e <Menu_WPL_R1>:void Menu_WPL_R1(uint8_t key){ //0123456789ABCDEFfa2e: cf 93 push r28fa30: df 93 push r29#if !defined (RECEIVER_SPEKTRUM_DX7EXP) && !defined (RECEIVER_SPEKTRUM_DX8EXP)JetiBox_printfxy(0,0,"Load Waypoints");fa32: 80 e0 ldi r24, 0x00 ; 0fa34: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>fa38: 88 ea ldi r24, 0xA8 ; 168fa3a: 9f e0 ldi r25, 0x0F ; 15fa3c: 9f 93 push r25fa3e: 8f 93 push r24fa40: ce e6 ldi r28, 0x6E ; 110fa42: df e0 ldi r29, 0x0F ; 15fa44: df 93 push r29fa46: cf 93 push r28fa48: e0 91 78 06 lds r30, 0x0678fa4c: f0 91 79 06 lds r31, 0x0679fa50: 09 95 icallJetiBox_printfxy(0,1,"(Relative) ");fa52: 80 e1 ldi r24, 0x10 ; 16fa54: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>fa58: 8a e9 ldi r24, 0x9A ; 154fa5a: 9f e0 ldi r25, 0x0F ; 15fa5c: 9f 93 push r25fa5e: 8f 93 push r24fa60: df 93 push r29fa62: cf 93 push r28fa64: e0 91 78 06 lds r30, 0x0678fa68: f0 91 79 06 lds r31, 0x0679fa6c: 09 95 icallfa6e: 8d b7 in r24, 0x3d ; 61fa70: 9e b7 in r25, 0x3e ; 62fa72: 08 96 adiw r24, 0x08 ; 8fa74: 0f b6 in r0, 0x3f ; 63fa76: f8 94 clifa78: 9e bf out 0x3e, r25 ; 62fa7a: 0f be out 0x3f, r0 ; 63fa7c: 8d bf out 0x3d, r24 ; 61#endif}fa7e: df 91 pop r29fa80: cf 91 pop r28fa82: 08 95 ret0000fa84 <Menu_POINT_LD>:#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))void Menu_POINT_LD(uint8_t key){ //0123456789ABCDEFJetiBox_printfxy(0,0,"Load singl.Point");fa84: 80 e0 ldi r24, 0x00 ; 0fa86: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>fa8a: 89 e8 ldi r24, 0x89 ; 137fa8c: 9f e0 ldi r25, 0x0F ; 15fa8e: 9f 93 push r25fa90: 8f 93 push r24fa92: 8e e6 ldi r24, 0x6E ; 110fa94: 9f e0 ldi r25, 0x0F ; 15fa96: 9f 93 push r25fa98: 8f 93 push r24fa9a: e0 91 78 06 lds r30, 0x0678fa9e: f0 91 79 06 lds r31, 0x0679faa2: 09 95 icallfaa4: 0f 90 pop r0faa6: 0f 90 pop r0faa8: 0f 90 pop r0faaa: 0f 90 pop r0faac: 08 95 ret0000faae <Menu_POINT_SV>:#endif#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))void Menu_POINT_SV(uint8_t key){ //0123456789ABCDEFJetiBox_printfxy(0,0,"Save singl.Point");faae: 80 e0 ldi r24, 0x00 ; 0fab0: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>fab4: 88 e7 ldi r24, 0x78 ; 120fab6: 9f e0 ldi r25, 0x0F ; 15fab8: 9f 93 push r25faba: 8f 93 push r24fabc: 8e e6 ldi r24, 0x6E ; 110fabe: 9f e0 ldi r25, 0x0F ; 15fac0: 9f 93 push r25fac2: 8f 93 push r24fac4: e0 91 78 06 lds r30, 0x0678fac8: f0 91 79 06 lds r31, 0x0679facc: 09 95 icallface: 0f 90 pop r0fad0: 0f 90 pop r0fad2: 0f 90 pop r0fad4: 0f 90 pop r0fad6: 08 95 ret0000fad8 <Menu_POINT_SV2>:}#endif#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))void Menu_POINT_SV2(uint8_t key){ //0123456789ABCDEFfad8: 1f 93 push r17fada: cf 93 push r28fadc: df 93 push r29fade: 18 2f mov r17, r24static unsigned char load_waypoint_tmp = 1, changed;// if(WPL_Name[0] == 0) JetiBox_printfxy(0,0,"Relative WPs ")// else JetiBox_printfxy(0,0,"Rel:%s",WPL_Name);JetiBox_printfxy(0,0,"Save Point:");fae0: 80 e0 ldi r24, 0x00 ; 0fae2: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>fae6: 2c e6 ldi r18, 0x6C ; 108fae8: 3f e0 ldi r19, 0x0F ; 15faea: 3f 93 push r19faec: 2f 93 push r18faee: 2e e6 ldi r18, 0x6E ; 110faf0: 3f e0 ldi r19, 0x0F ; 15faf2: 3f 93 push r19faf4: 2f 93 push r18faf6: e0 91 78 06 lds r30, 0x0678fafa: f0 91 79 06 lds r31, 0x0679fafe: 09 95 icallif(NaviData_MaxWpListIndex == 0) JetiBox_printfxy(0,1,"no SD-Card")fb00: 0f 90 pop r0fb02: 0f 90 pop r0fb04: 0f 90 pop r0fb06: 0f 90 pop r0fb08: 80 91 89 04 lds r24, 0x0489fb0c: 81 11 cpse r24, r1fb0e: 15 c0 rjmp .+42 ; 0xfb3a <Menu_POINT_SV2+0x62>fb10: 80 e1 ldi r24, 0x10 ; 16fb12: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>fb16: 81 e6 ldi r24, 0x61 ; 97fb18: 9f e0 ldi r25, 0x0F ; 15fb1a: 9f 93 push r25fb1c: 8f 93 push r24fb1e: 8e e6 ldi r24, 0x6E ; 110fb20: 9f e0 ldi r25, 0x0F ; 15fb22: 9f 93 push r25fb24: 8f 93 push r24fb26: e0 91 78 06 lds r30, 0x0678fb2a: f0 91 79 06 lds r31, 0x0679fb2e: 09 95 icallfb30: 0f 90 pop r0fb32: 0f 90 pop r0fb34: 0f 90 pop r0fb36: 0f 90 pop r0fb38: ab c0 rjmp .+342 ; 0xfc90 <Menu_POINT_SV2+0x1b8>elseif(GPSInfo.SatFix != SATFIX_3D) JetiBox_printfxy(0,1,"no GPS-Fix")fb3a: 80 91 d9 08 lds r24, 0x08D9fb3e: 83 30 cpi r24, 0x03 ; 3fb40: a9 f0 breq .+42 ; 0xfb6c <Menu_POINT_SV2+0x94>fb42: 80 e1 ldi r24, 0x10 ; 16fb44: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>fb48: 86 e5 ldi r24, 0x56 ; 86fb4a: 9f e0 ldi r25, 0x0F ; 15fb4c: 9f 93 push r25fb4e: 8f 93 push r24fb50: 8e e6 ldi r24, 0x6E ; 110fb52: 9f e0 ldi r25, 0x0F ; 15fb54: 9f 93 push r25fb56: 8f 93 push r24fb58: e0 91 78 06 lds r30, 0x0678fb5c: f0 91 79 06 lds r31, 0x0679fb60: 09 95 icallfb62: 0f 90 pop r0fb64: 0f 90 pop r0fb66: 0f 90 pop r0fb68: 0f 90 pop r0fb6a: 92 c0 rjmp .+292 ; 0xfc90 <Menu_POINT_SV2+0x1b8>else{JetiBox_printfxy(11,0,"%2d",load_waypoint_tmp);fb6c: 8b e0 ldi r24, 0x0B ; 11fb6e: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>fb72: 80 91 5c 01 lds r24, 0x015Cfb76: 1f 92 push r1fb78: 8f 93 push r24fb7a: 22 e5 ldi r18, 0x52 ; 82fb7c: 3f e0 ldi r19, 0x0F ; 15fb7e: 3f 93 push r19fb80: 2f 93 push r18fb82: ce e6 ldi r28, 0x6E ; 110fb84: df e0 ldi r29, 0x0F ; 15fb86: df 93 push r29fb88: cf 93 push r28fb8a: e0 91 78 06 lds r30, 0x0678fb8e: f0 91 79 06 lds r31, 0x0679fb92: 09 95 icall// if(NaviData_WaypointNumber) JetiBox_printfxy(8,1,"%2d/%d ",NaviData_WaypointIndex,NaviData_WaypointNumber)// else JetiBox_printfxy(8,1,"--/--")JetiBox_printfxy(0,1,"Dir:%3d Alt:%3dm",CompassCorrected,(int16_t)(HoehenWert/100))fb94: 80 e1 ldi r24, 0x10 ; 16fb96: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>fb9a: 60 91 fe 03 lds r22, 0x03FEfb9e: 70 91 ff 03 lds r23, 0x03FFfba2: 80 91 00 04 lds r24, 0x0400fba6: 90 91 01 04 lds r25, 0x0401fbaa: 24 e6 ldi r18, 0x64 ; 100fbac: 30 e0 ldi r19, 0x00 ; 0fbae: 40 e0 ldi r20, 0x00 ; 0fbb0: 50 e0 ldi r21, 0x00 ; 0fbb2: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>fbb6: 3f 93 push r19fbb8: 2f 93 push r18fbba: 80 91 66 06 lds r24, 0x0666fbbe: 8f 93 push r24fbc0: 80 91 65 06 lds r24, 0x0665fbc4: 8f 93 push r24fbc6: 21 e4 ldi r18, 0x41 ; 65fbc8: 3f e0 ldi r19, 0x0F ; 15fbca: 3f 93 push r19fbcc: 2f 93 push r18fbce: df 93 push r29fbd0: cf 93 push r28fbd2: e0 91 78 06 lds r30, 0x0678fbd6: f0 91 79 06 lds r31, 0x0679fbda: 09 95 icallif(changed) JetiBox_printfxy(14,0,"->")fbdc: 8d b7 in r24, 0x3d ; 61fbde: 9e b7 in r25, 0x3e ; 62fbe0: 0e 96 adiw r24, 0x0e ; 14fbe2: 0f b6 in r0, 0x3f ; 63fbe4: f8 94 clifbe6: 9e bf out 0x3e, r25 ; 62fbe8: 0f be out 0x3f, r0 ; 63fbea: 8d bf out 0x3d, r24 ; 61fbec: 80 91 94 04 lds r24, 0x0494fbf0: 88 23 and r24, r24fbf2: a1 f0 breq .+40 ; 0xfc1c <Menu_POINT_SV2+0x144>fbf4: 8e e0 ldi r24, 0x0E ; 14fbf6: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>fbfa: 8e e3 ldi r24, 0x3E ; 62fbfc: 9f e0 ldi r25, 0x0F ; 15fbfe: 9f 93 push r25fc00: 8f 93 push r24fc02: ce 01 movw r24, r28fc04: 9f 93 push r25fc06: cf 93 push r28fc08: e0 91 78 06 lds r30, 0x0678fc0c: f0 91 79 06 lds r31, 0x0679fc10: 09 95 icallfc12: 0f 90 pop r0fc14: 0f 90 pop r0fc16: 0f 90 pop r0fc18: 0f 90 pop r0fc1a: 14 c0 rjmp .+40 ; 0xfc44 <Menu_POINT_SV2+0x16c>else JetiBox_printfxy(14,0," ");fc1c: 8e e0 ldi r24, 0x0E ; 14fc1e: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>fc22: 8b e3 ldi r24, 0x3B ; 59fc24: 9f e0 ldi r25, 0x0F ; 15fc26: 9f 93 push r25fc28: 8f 93 push r24fc2a: 8e e6 ldi r24, 0x6E ; 110fc2c: 9f e0 ldi r25, 0x0F ; 15fc2e: 9f 93 push r25fc30: 8f 93 push r24fc32: e0 91 78 06 lds r30, 0x0678fc36: f0 91 79 06 lds r31, 0x0679fc3a: 09 95 icallfc3c: 0f 90 pop r0fc3e: 0f 90 pop r0fc40: 0f 90 pop r0fc42: 0f 90 pop r0if(key == JETIBOX_KEY_UP && load_waypoint_tmp < NaviData_MaxWpListIndex) { load_waypoint_tmp++; changed = 1;}fc44: 1f 32 cpi r17, 0x2F ; 47fc46: 69 f4 brne .+26 ; 0xfc62 <Menu_POINT_SV2+0x18a>fc48: 80 91 5c 01 lds r24, 0x015Cfc4c: 90 91 89 04 lds r25, 0x0489fc50: 89 17 cp r24, r25fc52: f0 f4 brcc .+60 ; 0xfc90 <Menu_POINT_SV2+0x1b8>fc54: 8f 5f subi r24, 0xFF ; 255fc56: 80 93 5c 01 sts 0x015C, r24fc5a: 81 e0 ldi r24, 0x01 ; 1fc5c: 80 93 94 04 sts 0x0494, r24fc60: 17 c0 rjmp .+46 ; 0xfc90 <Menu_POINT_SV2+0x1b8>if(key == JETIBOX_KEY_DOWN && load_waypoint_tmp > 1) { load_waypoint_tmp--; changed = 1; }fc62: 1f 34 cpi r17, 0x4F ; 79fc64: 59 f4 brne .+22 ; 0xfc7c <Menu_POINT_SV2+0x1a4>fc66: 80 91 5c 01 lds r24, 0x015Cfc6a: 82 30 cpi r24, 0x02 ; 2fc6c: 88 f0 brcs .+34 ; 0xfc90 <Menu_POINT_SV2+0x1b8>fc6e: 81 50 subi r24, 0x01 ; 1fc70: 80 93 5c 01 sts 0x015C, r24fc74: 81 e0 ldi r24, 0x01 ; 1fc76: 80 93 94 04 sts 0x0494, r24fc7a: 0a c0 rjmp .+20 ; 0xfc90 <Menu_POINT_SV2+0x1b8>if(key == JETIBOX_KEY_RIGHT && load_waypoint_tmp)fc7c: 1f 31 cpi r17, 0x1F ; 31fc7e: 41 f4 brne .+16 ; 0xfc90 <Menu_POINT_SV2+0x1b8>fc80: 80 91 5c 01 lds r24, 0x015Cfc84: 88 23 and r24, r24fc86: 21 f0 breq .+8 ; 0xfc90 <Menu_POINT_SV2+0x1b8>{ToNC_Store_SingePoint = load_waypoint_tmp;fc88: 80 93 87 04 sts 0x0487, r24changed = 0;fc8c: 10 92 94 04 sts 0x0494, r1}}}fc90: df 91 pop r29fc92: cf 91 pop r28fc94: 1f 91 pop r17fc96: 08 95 ret0000fc98 <Menu_POINT_LD2>:#endif#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))void Menu_POINT_LD2(uint8_t key){ //0123456789ABCDEFfc98: cf 93 push r28fc9a: c8 2f mov r28, r24static unsigned char load_waypoint_tmp = 1, changed;// if(WPL_Name[0] == 0) JetiBox_printfxy(0,0,"FIX Waypoints")// else JetiBox_printfxy(0,0,"FIX:%s",WPL_Name);JetiBox_printfxy(0,0,"Load Point")fc9c: 80 e0 ldi r24, 0x00 ; 0fc9e: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>fca2: 20 e3 ldi r18, 0x30 ; 48fca4: 3f e0 ldi r19, 0x0F ; 15fca6: 3f 93 push r19fca8: 2f 93 push r18fcaa: 2e e6 ldi r18, 0x6E ; 110fcac: 3f e0 ldi r19, 0x0F ; 15fcae: 3f 93 push r19fcb0: 2f 93 push r18fcb2: e0 91 78 06 lds r30, 0x0678fcb6: f0 91 79 06 lds r31, 0x0679fcba: 09 95 icallif(NaviData_MaxWpListIndex == 0) JetiBox_printfxy(0,1,"no SD-Card")fcbc: 0f 90 pop r0fcbe: 0f 90 pop r0fcc0: 0f 90 pop r0fcc2: 0f 90 pop r0fcc4: 80 91 89 04 lds r24, 0x0489fcc8: 81 11 cpse r24, r1fcca: 15 c0 rjmp .+42 ; 0xfcf6 <Menu_POINT_LD2+0x5e>fccc: 80 e1 ldi r24, 0x10 ; 16fcce: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>fcd2: 85 e2 ldi r24, 0x25 ; 37fcd4: 9f e0 ldi r25, 0x0F ; 15fcd6: 9f 93 push r25fcd8: 8f 93 push r24fcda: 8e e6 ldi r24, 0x6E ; 110fcdc: 9f e0 ldi r25, 0x0F ; 15fcde: 9f 93 push r25fce0: 8f 93 push r24fce2: e0 91 78 06 lds r30, 0x0678fce6: f0 91 79 06 lds r31, 0x0679fcea: 09 95 icallfcec: 0f 90 pop r0fcee: 0f 90 pop r0fcf0: 0f 90 pop r0fcf2: 0f 90 pop r0fcf4: b4 c0 rjmp .+360 ; 0xfe5e <Menu_POINT_LD2+0x1c6>else{JetiBox_printfxy(11,0,"%2d",load_waypoint_tmp);fcf6: 8b e0 ldi r24, 0x0B ; 11fcf8: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>fcfc: 80 91 5b 01 lds r24, 0x015Bfd00: 1f 92 push r1fd02: 8f 93 push r24fd04: 21 e2 ldi r18, 0x21 ; 33fd06: 3f e0 ldi r19, 0x0F ; 15fd08: 3f 93 push r19fd0a: 2f 93 push r18fd0c: 2e e6 ldi r18, 0x6E ; 110fd0e: 3f e0 ldi r19, 0x0F ; 15fd10: 3f 93 push r19fd12: 2f 93 push r18fd14: e0 91 78 06 lds r30, 0x0678fd18: f0 91 79 06 lds r31, 0x0679fd1c: 09 95 icallif(NaviData_WaypointNumber) JetiBox_printfxy(0,1,"Dist:%3d Alt:%3d ",NaviData_TargetDistance,(int16_t)(FromNC_AltitudeSetpoint/100))fd1e: 0f 90 pop r0fd20: 0f 90 pop r0fd22: 0f 90 pop r0fd24: 0f 90 pop r0fd26: 0f 90 pop r0fd28: 0f 90 pop r0fd2a: 80 91 8c 04 lds r24, 0x048Cfd2e: 88 23 and r24, r24fd30: 79 f1 breq .+94 ; 0xfd90 <Menu_POINT_LD2+0xf8>fd32: 80 e1 ldi r24, 0x10 ; 16fd34: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>fd38: 60 91 f4 03 lds r22, 0x03F4fd3c: 70 91 f5 03 lds r23, 0x03F5fd40: 80 91 f6 03 lds r24, 0x03F6fd44: 90 91 f7 03 lds r25, 0x03F7fd48: 24 e6 ldi r18, 0x64 ; 100fd4a: 30 e0 ldi r19, 0x00 ; 0fd4c: 40 e0 ldi r20, 0x00 ; 0fd4e: 50 e0 ldi r21, 0x00 ; 0fd50: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>fd54: 3f 93 push r19fd56: 2f 93 push r18fd58: 80 91 86 04 lds r24, 0x0486fd5c: 8f 93 push r24fd5e: 80 91 85 04 lds r24, 0x0485fd62: 8f 93 push r24fd64: 8f e0 ldi r24, 0x0F ; 15fd66: 9f e0 ldi r25, 0x0F ; 15fd68: 9f 93 push r25fd6a: 8f 93 push r24fd6c: 8e e6 ldi r24, 0x6E ; 110fd6e: 9f e0 ldi r25, 0x0F ; 15fd70: 9f 93 push r25fd72: 8f 93 push r24fd74: e0 91 78 06 lds r30, 0x0678fd78: f0 91 79 06 lds r31, 0x0679fd7c: 09 95 icallfd7e: 8d b7 in r24, 0x3d ; 61fd80: 9e b7 in r25, 0x3e ; 62fd82: 08 96 adiw r24, 0x08 ; 8fd84: 0f b6 in r0, 0x3f ; 63fd86: f8 94 clifd88: 9e bf out 0x3e, r25 ; 62fd8a: 0f be out 0x3f, r0 ; 63fd8c: 8d bf out 0x3d, r24 ; 61fd8e: 14 c0 rjmp .+40 ; 0xfdb8 <Menu_POINT_LD2+0x120>else JetiBox_printfxy(8,1," ");fd90: 88 e1 ldi r24, 0x18 ; 24fd92: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>fd96: 8e ef ldi r24, 0xFE ; 254fd98: 9e e0 ldi r25, 0x0E ; 14fd9a: 9f 93 push r25fd9c: 8f 93 push r24fd9e: 8e e6 ldi r24, 0x6E ; 110fda0: 9f e0 ldi r25, 0x0F ; 15fda2: 9f 93 push r25fda4: 8f 93 push r24fda6: e0 91 78 06 lds r30, 0x0678fdaa: f0 91 79 06 lds r31, 0x0679fdae: 09 95 icallfdb0: 0f 90 pop r0fdb2: 0f 90 pop r0fdb4: 0f 90 pop r0fdb6: 0f 90 pop r0if(changed) JetiBox_printfxy(14,0,"->")fdb8: 80 91 93 04 lds r24, 0x0493fdbc: 88 23 and r24, r24fdbe: a9 f0 breq .+42 ; 0xfdea <Menu_POINT_LD2+0x152>fdc0: 8e e0 ldi r24, 0x0E ; 14fdc2: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>fdc6: 8b ef ldi r24, 0xFB ; 251fdc8: 9e e0 ldi r25, 0x0E ; 14fdca: 9f 93 push r25fdcc: 8f 93 push r24fdce: 8e e6 ldi r24, 0x6E ; 110fdd0: 9f e0 ldi r25, 0x0F ; 15fdd2: 9f 93 push r25fdd4: 8f 93 push r24fdd6: e0 91 78 06 lds r30, 0x0678fdda: f0 91 79 06 lds r31, 0x0679fdde: 09 95 icallfde0: 0f 90 pop r0fde2: 0f 90 pop r0fde4: 0f 90 pop r0fde6: 0f 90 pop r0fde8: 14 c0 rjmp .+40 ; 0xfe12 <Menu_POINT_LD2+0x17a>else JetiBox_printfxy(14,0," ");fdea: 8e e0 ldi r24, 0x0E ; 14fdec: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>fdf0: 88 ef ldi r24, 0xF8 ; 248fdf2: 9e e0 ldi r25, 0x0E ; 14fdf4: 9f 93 push r25fdf6: 8f 93 push r24fdf8: 8e e6 ldi r24, 0x6E ; 110fdfa: 9f e0 ldi r25, 0x0F ; 15fdfc: 9f 93 push r25fdfe: 8f 93 push r24fe00: e0 91 78 06 lds r30, 0x0678fe04: f0 91 79 06 lds r31, 0x0679fe08: 09 95 icallfe0a: 0f 90 pop r0fe0c: 0f 90 pop r0fe0e: 0f 90 pop r0fe10: 0f 90 pop r0if(key == JETIBOX_KEY_UP && load_waypoint_tmp < NaviData_MaxWpListIndex) { load_waypoint_tmp++; changed = 1;}fe12: cf 32 cpi r28, 0x2F ; 47fe14: 69 f4 brne .+26 ; 0xfe30 <Menu_POINT_LD2+0x198>fe16: 80 91 5b 01 lds r24, 0x015Bfe1a: 90 91 89 04 lds r25, 0x0489fe1e: 89 17 cp r24, r25fe20: f0 f4 brcc .+60 ; 0xfe5e <Menu_POINT_LD2+0x1c6>fe22: 8f 5f subi r24, 0xFF ; 255fe24: 80 93 5b 01 sts 0x015B, r24fe28: 81 e0 ldi r24, 0x01 ; 1fe2a: 80 93 93 04 sts 0x0493, r24fe2e: 17 c0 rjmp .+46 ; 0xfe5e <Menu_POINT_LD2+0x1c6>if(key == JETIBOX_KEY_DOWN && load_waypoint_tmp > 1) { load_waypoint_tmp--; changed = 1; }fe30: cf 34 cpi r28, 0x4F ; 79fe32: 59 f4 brne .+22 ; 0xfe4a <Menu_POINT_LD2+0x1b2>fe34: 80 91 5b 01 lds r24, 0x015Bfe38: 82 30 cpi r24, 0x02 ; 2fe3a: 88 f0 brcs .+34 ; 0xfe5e <Menu_POINT_LD2+0x1c6>fe3c: 81 50 subi r24, 0x01 ; 1fe3e: 80 93 5b 01 sts 0x015B, r24fe42: 81 e0 ldi r24, 0x01 ; 1fe44: 80 93 93 04 sts 0x0493, r24fe48: 0a c0 rjmp .+20 ; 0xfe5e <Menu_POINT_LD2+0x1c6>if(key == JETIBOX_KEY_RIGHT && load_waypoint_tmp)fe4a: cf 31 cpi r28, 0x1F ; 31fe4c: 41 f4 brne .+16 ; 0xfe5e <Menu_POINT_LD2+0x1c6>fe4e: 80 91 5b 01 lds r24, 0x015Bfe52: 88 23 and r24, r24fe54: 21 f0 breq .+8 ; 0xfe5e <Menu_POINT_LD2+0x1c6>{ToNC_Load_SingePoint = load_waypoint_tmp;fe56: 80 93 88 04 sts 0x0488, r24changed = 0;fe5a: 10 92 93 04 sts 0x0493, r1}}}fe5e: cf 91 pop r28fe60: 08 95 ret0000fe62 <Menu_WPL_A2>:#endifvoid Menu_WPL_A2(uint8_t key){ //0123456789ABCDEFfe62: cf 93 push r28fe64: c8 2f mov r28, r24#if !defined (RECEIVER_SPEKTRUM_DX7EXP) && !defined (RECEIVER_SPEKTRUM_DX8EXP)static unsigned char load_waypoint_tmp = 1, changed;if(WPL_Name[0] == 0) JetiBox_printfxy(0,0,"FIX Waypoints")fe66: 80 91 d2 06 lds r24, 0x06D2fe6a: 81 11 cpse r24, r1fe6c: 14 c0 rjmp .+40 ; 0xfe96 <Menu_WPL_A2+0x34>fe6e: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>fe72: 2a ee ldi r18, 0xEA ; 234fe74: 3e e0 ldi r19, 0x0E ; 14fe76: 3f 93 push r19fe78: 2f 93 push r18fe7a: 2e e6 ldi r18, 0x6E ; 110fe7c: 3f e0 ldi r19, 0x0F ; 15fe7e: 3f 93 push r19fe80: 2f 93 push r18fe82: e0 91 78 06 lds r30, 0x0678fe86: f0 91 79 06 lds r31, 0x0679fe8a: 09 95 icallfe8c: 0f 90 pop r0fe8e: 0f 90 pop r0fe90: 0f 90 pop r0fe92: 0f 90 pop r0fe94: 1a c0 rjmp .+52 ; 0xfeca <Menu_WPL_A2+0x68>else JetiBox_printfxy(0,0,"FIX:%s",WPL_Name);fe96: 80 e0 ldi r24, 0x00 ; 0fe98: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>fe9c: 22 ed ldi r18, 0xD2 ; 210fe9e: 36 e0 ldi r19, 0x06 ; 6fea0: 3f 93 push r19fea2: 2f 93 push r18fea4: 23 ee ldi r18, 0xE3 ; 227fea6: 3e e0 ldi r19, 0x0E ; 14fea8: 3f 93 push r19feaa: 2f 93 push r18feac: 2e e6 ldi r18, 0x6E ; 110feae: 3f e0 ldi r19, 0x0F ; 15feb0: 3f 93 push r19feb2: 2f 93 push r18feb4: e0 91 78 06 lds r30, 0x0678feb8: f0 91 79 06 lds r31, 0x0679febc: 09 95 icallfebe: 0f 90 pop r0fec0: 0f 90 pop r0fec2: 0f 90 pop r0fec4: 0f 90 pop r0fec6: 0f 90 pop r0fec8: 0f 90 pop r0if(NaviData_MaxWpListIndex == 0) JetiBox_printfxy(0,1,"no SD-Card")feca: 80 91 89 04 lds r24, 0x0489fece: 81 11 cpse r24, r1fed0: 15 c0 rjmp .+42 ; 0xfefc <Menu_WPL_A2+0x9a>fed2: 80 e1 ldi r24, 0x10 ; 16fed4: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>fed8: 88 ed ldi r24, 0xD8 ; 216feda: 9e e0 ldi r25, 0x0E ; 14fedc: 9f 93 push r25fede: 8f 93 push r24fee0: 8e e6 ldi r24, 0x6E ; 110fee2: 9f e0 ldi r25, 0x0F ; 15fee4: 9f 93 push r25fee6: 8f 93 push r24fee8: e0 91 78 06 lds r30, 0x0678feec: f0 91 79 06 lds r31, 0x0679fef0: 09 95 icallfef2: 0f 90 pop r0fef4: 0f 90 pop r0fef6: 0f 90 pop r0fef8: 0f 90 pop r0fefa: a6 c0 rjmp .+332 ; 0x10048 <Menu_WPL_A2+0x1e6>else{JetiBox_printfxy(0,1,"#%2d WP:",load_waypoint_tmp);fefc: 80 e1 ldi r24, 0x10 ; 16fefe: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>ff02: 80 91 5a 01 lds r24, 0x015Aff06: 1f 92 push r1ff08: 8f 93 push r24ff0a: 2f ec ldi r18, 0xCF ; 207ff0c: 3e e0 ldi r19, 0x0E ; 14ff0e: 3f 93 push r19ff10: 2f 93 push r18ff12: 2e e6 ldi r18, 0x6E ; 110ff14: 3f e0 ldi r19, 0x0F ; 15ff16: 3f 93 push r19ff18: 2f 93 push r18ff1a: e0 91 78 06 lds r30, 0x0678ff1e: f0 91 79 06 lds r31, 0x0679ff22: 09 95 icallif(NaviData_WaypointNumber) JetiBox_printfxy(8,1,"%2d/%d ",NaviData_WaypointIndex,NaviData_WaypointNumber)ff24: 0f 90 pop r0ff26: 0f 90 pop r0ff28: 0f 90 pop r0ff2a: 0f 90 pop r0ff2c: 0f 90 pop r0ff2e: 0f 90 pop r0ff30: 80 91 8c 04 lds r24, 0x048Cff34: 88 23 and r24, r24ff36: 09 f1 breq .+66 ; 0xff7a <Menu_WPL_A2+0x118>ff38: 88 e1 ldi r24, 0x18 ; 24ff3a: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>ff3e: 80 91 8c 04 lds r24, 0x048Cff42: 1f 92 push r1ff44: 8f 93 push r24ff46: 80 91 8d 04 lds r24, 0x048Dff4a: 1f 92 push r1ff4c: 8f 93 push r24ff4e: 87 ec ldi r24, 0xC7 ; 199ff50: 9e e0 ldi r25, 0x0E ; 14ff52: 9f 93 push r25ff54: 8f 93 push r24ff56: 8e e6 ldi r24, 0x6E ; 110ff58: 9f e0 ldi r25, 0x0F ; 15ff5a: 9f 93 push r25ff5c: 8f 93 push r24ff5e: e0 91 78 06 lds r30, 0x0678ff62: f0 91 79 06 lds r31, 0x0679ff66: 09 95 icallff68: 8d b7 in r24, 0x3d ; 61ff6a: 9e b7 in r25, 0x3e ; 62ff6c: 08 96 adiw r24, 0x08 ; 8ff6e: 0f b6 in r0, 0x3f ; 63ff70: f8 94 cliff72: 9e bf out 0x3e, r25 ; 62ff74: 0f be out 0x3f, r0 ; 63ff76: 8d bf out 0x3d, r24 ; 61ff78: 14 c0 rjmp .+40 ; 0xffa2 <Menu_WPL_A2+0x140>else JetiBox_printfxy(8,1,"--/--")ff7a: 88 e1 ldi r24, 0x18 ; 24ff7c: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>ff80: 81 ec ldi r24, 0xC1 ; 193ff82: 9e e0 ldi r25, 0x0E ; 14ff84: 9f 93 push r25ff86: 8f 93 push r24ff88: 8e e6 ldi r24, 0x6E ; 110ff8a: 9f e0 ldi r25, 0x0F ; 15ff8c: 9f 93 push r25ff8e: 8f 93 push r24ff90: e0 91 78 06 lds r30, 0x0678ff94: f0 91 79 06 lds r31, 0x0679ff98: 09 95 icallff9a: 0f 90 pop r0ff9c: 0f 90 pop r0ff9e: 0f 90 pop r0ffa0: 0f 90 pop r0if(changed) JetiBox_printfxy(14,1,"->")ffa2: 80 91 92 04 lds r24, 0x0492ffa6: 88 23 and r24, r24ffa8: a9 f0 breq .+42 ; 0xffd4 <Menu_WPL_A2+0x172>ffaa: 8e e1 ldi r24, 0x1E ; 30ffac: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>ffb0: 8e eb ldi r24, 0xBE ; 190ffb2: 9e e0 ldi r25, 0x0E ; 14ffb4: 9f 93 push r25ffb6: 8f 93 push r24ffb8: 8e e6 ldi r24, 0x6E ; 110ffba: 9f e0 ldi r25, 0x0F ; 15ffbc: 9f 93 push r25ffbe: 8f 93 push r24ffc0: e0 91 78 06 lds r30, 0x0678ffc4: f0 91 79 06 lds r31, 0x0679ffc8: 09 95 icallffca: 0f 90 pop r0ffcc: 0f 90 pop r0ffce: 0f 90 pop r0ffd0: 0f 90 pop r0ffd2: 14 c0 rjmp .+40 ; 0xfffc <Menu_WPL_A2+0x19a>else JetiBox_printfxy(14,1," ");ffd4: 8e e1 ldi r24, 0x1E ; 30ffd6: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>ffda: 8b eb ldi r24, 0xBB ; 187ffdc: 9e e0 ldi r25, 0x0E ; 14ffde: 9f 93 push r25ffe0: 8f 93 push r24ffe2: 8e e6 ldi r24, 0x6E ; 110ffe4: 9f e0 ldi r25, 0x0F ; 15ffe6: 9f 93 push r25ffe8: 8f 93 push r24ffea: e0 91 78 06 lds r30, 0x0678ffee: f0 91 79 06 lds r31, 0x0679fff2: 09 95 icallfff4: 0f 90 pop r0fff6: 0f 90 pop r0fff8: 0f 90 pop r0fffa: 0f 90 pop r0if(key == JETIBOX_KEY_UP && load_waypoint_tmp < NaviData_MaxWpListIndex) { load_waypoint_tmp++; changed = 1;}fffc: cf 32 cpi r28, 0x2F ; 47fffe: 69 f4 brne .+26 ; 0x1001a <Menu_WPL_A2+0x1b8>10000: 80 91 5a 01 lds r24, 0x015A10004: 90 91 89 04 lds r25, 0x048910008: 89 17 cp r24, r251000a: f0 f4 brcc .+60 ; 0x10048 <Menu_WPL_A2+0x1e6>1000c: 8f 5f subi r24, 0xFF ; 2551000e: 80 93 5a 01 sts 0x015A, r2410012: 81 e0 ldi r24, 0x01 ; 110014: 80 93 92 04 sts 0x0492, r2410018: 17 c0 rjmp .+46 ; 0x10048 <Menu_WPL_A2+0x1e6>if(key == JETIBOX_KEY_DOWN && load_waypoint_tmp > 1) { load_waypoint_tmp--; changed = 1; }1001a: cf 34 cpi r28, 0x4F ; 791001c: 59 f4 brne .+22 ; 0x10034 <Menu_WPL_A2+0x1d2>1001e: 80 91 5a 01 lds r24, 0x015A10022: 82 30 cpi r24, 0x02 ; 210024: 88 f0 brcs .+34 ; 0x10048 <Menu_WPL_A2+0x1e6>10026: 81 50 subi r24, 0x01 ; 110028: 80 93 5a 01 sts 0x015A, r241002c: 81 e0 ldi r24, 0x01 ; 11002e: 80 93 92 04 sts 0x0492, r2410032: 0a c0 rjmp .+20 ; 0x10048 <Menu_WPL_A2+0x1e6>if(key == JETIBOX_KEY_RIGHT && load_waypoint_tmp)10034: cf 31 cpi r28, 0x1F ; 3110036: 41 f4 brne .+16 ; 0x10048 <Menu_WPL_A2+0x1e6>10038: 80 91 5a 01 lds r24, 0x015A1003c: 88 23 and r24, r241003e: 21 f0 breq .+8 ; 0x10048 <Menu_WPL_A2+0x1e6>{ToNC_Load_WP_List = load_waypoint_tmp;10040: 80 93 8a 04 sts 0x048A, r24changed = 0;10044: 10 92 92 04 sts 0x0492, r1}}#endif}10048: cf 91 pop r281004a: 08 95 ret0001004c <Menu_WPL_R2>:void Menu_WPL_R2(uint8_t key){ //0123456789ABCDEF1004c: cf 93 push r281004e: c8 2f mov r28, r24#if !defined (RECEIVER_SPEKTRUM_DX7EXP) && !defined (RECEIVER_SPEKTRUM_DX8EXP)static unsigned char load_waypoint_tmp = 1, changed;if(WPL_Name[0] == 0) JetiBox_printfxy(0,0,"Relative WPs ")10050: 80 91 d2 06 lds r24, 0x06D210054: 81 11 cpse r24, r110056: 14 c0 rjmp .+40 ; 0x10080 <Menu_WPL_R2+0x34>10058: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>1005c: 2d ea ldi r18, 0xAD ; 1731005e: 3e e0 ldi r19, 0x0E ; 1410060: 3f 93 push r1910062: 2f 93 push r1810064: 2e e6 ldi r18, 0x6E ; 11010066: 3f e0 ldi r19, 0x0F ; 1510068: 3f 93 push r191006a: 2f 93 push r181006c: e0 91 78 06 lds r30, 0x067810070: f0 91 79 06 lds r31, 0x067910074: 09 95 icall10076: 0f 90 pop r010078: 0f 90 pop r01007a: 0f 90 pop r01007c: 0f 90 pop r01007e: 1a c0 rjmp .+52 ; 0x100b4 <Menu_WPL_R2+0x68>else JetiBox_printfxy(0,0,"Rel:%s",WPL_Name);10080: 80 e0 ldi r24, 0x00 ; 010082: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>10086: 22 ed ldi r18, 0xD2 ; 21010088: 36 e0 ldi r19, 0x06 ; 61008a: 3f 93 push r191008c: 2f 93 push r181008e: 26 ea ldi r18, 0xA6 ; 16610090: 3e e0 ldi r19, 0x0E ; 1410092: 3f 93 push r1910094: 2f 93 push r1810096: 2e e6 ldi r18, 0x6E ; 11010098: 3f e0 ldi r19, 0x0F ; 151009a: 3f 93 push r191009c: 2f 93 push r181009e: e0 91 78 06 lds r30, 0x0678100a2: f0 91 79 06 lds r31, 0x0679100a6: 09 95 icall100a8: 0f 90 pop r0100aa: 0f 90 pop r0100ac: 0f 90 pop r0100ae: 0f 90 pop r0100b0: 0f 90 pop r0100b2: 0f 90 pop r0if(NaviData_MaxWpListIndex == 0) JetiBox_printfxy(0,1,"no SD-Card")100b4: 80 91 89 04 lds r24, 0x0489100b8: 81 11 cpse r24, r1100ba: 15 c0 rjmp .+42 ; 0x100e6 <Menu_WPL_R2+0x9a>100bc: 80 e1 ldi r24, 0x10 ; 16100be: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>100c2: 8b e9 ldi r24, 0x9B ; 155100c4: 9e e0 ldi r25, 0x0E ; 14100c6: 9f 93 push r25100c8: 8f 93 push r24100ca: 8e e6 ldi r24, 0x6E ; 110100cc: 9f e0 ldi r25, 0x0F ; 15100ce: 9f 93 push r25100d0: 8f 93 push r24100d2: e0 91 78 06 lds r30, 0x0678100d6: f0 91 79 06 lds r31, 0x0679100da: 09 95 icall100dc: 0f 90 pop r0100de: 0f 90 pop r0100e0: 0f 90 pop r0100e2: 0f 90 pop r0100e4: c0 c0 rjmp .+384 ; 0x10266 <Menu_WPL_R2+0x21a>elseif(GPSInfo.SatFix != SATFIX_3D) JetiBox_printfxy(0,1,"no GPS-Fix")100e6: 80 91 d9 08 lds r24, 0x08D9100ea: 83 30 cpi r24, 0x03 ; 3100ec: a9 f0 breq .+42 ; 0x10118 <Menu_WPL_R2+0xcc>100ee: 80 e1 ldi r24, 0x10 ; 16100f0: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>100f4: 80 e9 ldi r24, 0x90 ; 144100f6: 9e e0 ldi r25, 0x0E ; 14100f8: 9f 93 push r25100fa: 8f 93 push r24100fc: 8e e6 ldi r24, 0x6E ; 110100fe: 9f e0 ldi r25, 0x0F ; 1510100: 9f 93 push r2510102: 8f 93 push r2410104: e0 91 78 06 lds r30, 0x067810108: f0 91 79 06 lds r31, 0x06791010c: 09 95 icall1010e: 0f 90 pop r010110: 0f 90 pop r010112: 0f 90 pop r010114: 0f 90 pop r010116: a7 c0 rjmp .+334 ; 0x10266 <Menu_WPL_R2+0x21a>else{JetiBox_printfxy(0,1,"#%2d WPs:",load_waypoint_tmp);10118: 80 e1 ldi r24, 0x10 ; 161011a: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>1011e: 80 91 59 01 lds r24, 0x015910122: 1f 92 push r110124: 8f 93 push r2410126: 86 e8 ldi r24, 0x86 ; 13410128: 9e e0 ldi r25, 0x0E ; 141012a: 9f 93 push r251012c: 8f 93 push r241012e: 2e e6 ldi r18, 0x6E ; 11010130: 3f e0 ldi r19, 0x0F ; 1510132: 3f 93 push r1910134: 2f 93 push r1810136: e0 91 78 06 lds r30, 0x06781013a: f0 91 79 06 lds r31, 0x06791013e: 09 95 icallif(NaviData_WaypointNumber) JetiBox_printfxy(8,1,"%2d/%d ",NaviData_WaypointIndex,NaviData_WaypointNumber)10140: 0f 90 pop r010142: 0f 90 pop r010144: 0f 90 pop r010146: 0f 90 pop r010148: 0f 90 pop r01014a: 0f 90 pop r01014c: 80 91 8c 04 lds r24, 0x048C10150: 88 23 and r24, r2410152: 09 f1 breq .+66 ; 0x10196 <Menu_WPL_R2+0x14a>10154: 88 e1 ldi r24, 0x18 ; 2410156: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>1015a: 80 91 8c 04 lds r24, 0x048C1015e: 1f 92 push r110160: 8f 93 push r2410162: 80 91 8d 04 lds r24, 0x048D10166: 1f 92 push r110168: 8f 93 push r241016a: 8e e7 ldi r24, 0x7E ; 1261016c: 9e e0 ldi r25, 0x0E ; 141016e: 9f 93 push r2510170: 8f 93 push r2410172: 8e e6 ldi r24, 0x6E ; 11010174: 9f e0 ldi r25, 0x0F ; 1510176: 9f 93 push r2510178: 8f 93 push r241017a: e0 91 78 06 lds r30, 0x06781017e: f0 91 79 06 lds r31, 0x067910182: 09 95 icall10184: 8d b7 in r24, 0x3d ; 6110186: 9e b7 in r25, 0x3e ; 6210188: 08 96 adiw r24, 0x08 ; 81018a: 0f b6 in r0, 0x3f ; 631018c: f8 94 cli1018e: 9e bf out 0x3e, r25 ; 6210190: 0f be out 0x3f, r0 ; 6310192: 8d bf out 0x3d, r24 ; 6110194: 14 c0 rjmp .+40 ; 0x101be <Menu_WPL_R2+0x172>else JetiBox_printfxy(8,1,"--/--")10196: 88 e1 ldi r24, 0x18 ; 2410198: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>1019c: 88 e7 ldi r24, 0x78 ; 1201019e: 9e e0 ldi r25, 0x0E ; 14101a0: 9f 93 push r25101a2: 8f 93 push r24101a4: 8e e6 ldi r24, 0x6E ; 110101a6: 9f e0 ldi r25, 0x0F ; 15101a8: 9f 93 push r25101aa: 8f 93 push r24101ac: e0 91 78 06 lds r30, 0x0678101b0: f0 91 79 06 lds r31, 0x0679101b4: 09 95 icall101b6: 0f 90 pop r0101b8: 0f 90 pop r0101ba: 0f 90 pop r0101bc: 0f 90 pop r0if(changed) JetiBox_printfxy(14,1,"->")101be: 80 91 91 04 lds r24, 0x0491101c2: 88 23 and r24, r24101c4: a9 f0 breq .+42 ; 0x101f0 <Menu_WPL_R2+0x1a4>101c6: 8e e1 ldi r24, 0x1E ; 30101c8: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>101cc: 85 e7 ldi r24, 0x75 ; 117101ce: 9e e0 ldi r25, 0x0E ; 14101d0: 9f 93 push r25101d2: 8f 93 push r24101d4: 8e e6 ldi r24, 0x6E ; 110101d6: 9f e0 ldi r25, 0x0F ; 15101d8: 9f 93 push r25101da: 8f 93 push r24101dc: e0 91 78 06 lds r30, 0x0678101e0: f0 91 79 06 lds r31, 0x0679101e4: 09 95 icall101e6: 0f 90 pop r0101e8: 0f 90 pop r0101ea: 0f 90 pop r0101ec: 0f 90 pop r0101ee: 14 c0 rjmp .+40 ; 0x10218 <Menu_WPL_R2+0x1cc>else JetiBox_printfxy(14,1," ");101f0: 8e e1 ldi r24, 0x1E ; 30101f2: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>101f6: 82 e7 ldi r24, 0x72 ; 114101f8: 9e e0 ldi r25, 0x0E ; 14101fa: 9f 93 push r25101fc: 8f 93 push r24101fe: 8e e6 ldi r24, 0x6E ; 11010200: 9f e0 ldi r25, 0x0F ; 1510202: 9f 93 push r2510204: 8f 93 push r2410206: e0 91 78 06 lds r30, 0x06781020a: f0 91 79 06 lds r31, 0x06791020e: 09 95 icall10210: 0f 90 pop r010212: 0f 90 pop r010214: 0f 90 pop r010216: 0f 90 pop r0if(key == JETIBOX_KEY_UP && load_waypoint_tmp < NaviData_MaxWpListIndex) { load_waypoint_tmp++; changed = 1;}10218: cf 32 cpi r28, 0x2F ; 471021a: 69 f4 brne .+26 ; 0x10236 <Menu_WPL_R2+0x1ea>1021c: 80 91 59 01 lds r24, 0x015910220: 90 91 89 04 lds r25, 0x048910224: 89 17 cp r24, r2510226: f8 f4 brcc .+62 ; 0x10266 <Menu_WPL_R2+0x21a>10228: 8f 5f subi r24, 0xFF ; 2551022a: 80 93 59 01 sts 0x0159, r241022e: 81 e0 ldi r24, 0x01 ; 110230: 80 93 91 04 sts 0x0491, r2410234: 18 c0 rjmp .+48 ; 0x10266 <Menu_WPL_R2+0x21a>if(key == JETIBOX_KEY_DOWN && load_waypoint_tmp > 1) { load_waypoint_tmp--; changed = 1; }10236: cf 34 cpi r28, 0x4F ; 7910238: 59 f4 brne .+22 ; 0x10250 <Menu_WPL_R2+0x204>1023a: 80 91 59 01 lds r24, 0x01591023e: 82 30 cpi r24, 0x02 ; 210240: 90 f0 brcs .+36 ; 0x10266 <Menu_WPL_R2+0x21a>10242: 81 50 subi r24, 0x01 ; 110244: 80 93 59 01 sts 0x0159, r2410248: 81 e0 ldi r24, 0x01 ; 11024a: 80 93 91 04 sts 0x0491, r241024e: 0b c0 rjmp .+22 ; 0x10266 <Menu_WPL_R2+0x21a>if(key == JETIBOX_KEY_RIGHT && load_waypoint_tmp)10250: cf 31 cpi r28, 0x1F ; 3110252: 49 f4 brne .+18 ; 0x10266 <Menu_WPL_R2+0x21a>10254: 80 91 59 01 lds r24, 0x015910258: 88 23 and r24, r241025a: 29 f0 breq .+10 ; 0x10266 <Menu_WPL_R2+0x21a>{ToNC_Load_WP_List = load_waypoint_tmp | 0x80;1025c: 80 68 ori r24, 0x80 ; 1281025e: 80 93 8a 04 sts 0x048A, r24changed = 0;10262: 10 92 91 04 sts 0x0491, r1}}#endif}10266: cf 91 pop r2810268: 08 95 ret0001026a <Menu_PosInfo>:void Menu_PosInfo(uint8_t key){#if !defined (RECEIVER_SPEKTRUM_DX7EXP) && !defined (RECEIVER_SPEKTRUM_DX8EXP)if(NaviDataOkay)1026a: 80 91 a4 02 lds r24, 0x02A41026e: 88 23 and r24, r2410270: 09 f4 brne .+2 ; 0x10274 <Menu_PosInfo+0xa>10272: 9b c0 rjmp .+310 ; 0x103aa <Menu_PosInfo+0x140>{JetiBox_printfxy(0,0,"%2um/s Sat:%d ",GPSInfo.Speed,GPSInfo.NumOfSats);10274: 80 e0 ldi r24, 0x00 ; 010276: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>1027a: 80 91 d8 08 lds r24, 0x08D81027e: 1f 92 push r110280: 8f 93 push r2410282: 80 91 da 08 lds r24, 0x08DA10286: 1f 92 push r110288: 8f 93 push r241028a: 83 e6 ldi r24, 0x63 ; 991028c: 9e e0 ldi r25, 0x0E ; 141028e: 9f 93 push r2510290: 8f 93 push r2410292: 8e e6 ldi r24, 0x6E ; 11010294: 9f e0 ldi r25, 0x0F ; 1510296: 9f 93 push r2510298: 8f 93 push r241029a: e0 91 78 06 lds r30, 0x06781029e: f0 91 79 06 lds r31, 0x0679102a2: 09 95 icallswitch (GPSInfo.SatFix)102a4: 8d b7 in r24, 0x3d ; 61102a6: 9e b7 in r25, 0x3e ; 62102a8: 08 96 adiw r24, 0x08 ; 8102aa: 0f b6 in r0, 0x3f ; 63102ac: f8 94 cli102ae: 9e bf out 0x3e, r25 ; 62102b0: 0f be out 0x3f, r0 ; 63102b2: 8d bf out 0x3d, r24 ; 61102b4: 80 91 d9 08 lds r24, 0x08D9102b8: 83 30 cpi r24, 0x03 ; 3102ba: a9 f4 brne .+42 ; 0x102e6 <Menu_PosInfo+0x7c>{case SATFIX_3D:JetiBox_printfxy(12,0," 3D");102bc: 8c e0 ldi r24, 0x0C ; 12102be: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>102c2: 8e e5 ldi r24, 0x5E ; 94102c4: 9e e0 ldi r25, 0x0E ; 14102c6: 9f 93 push r25102c8: 8f 93 push r24102ca: 8e e6 ldi r24, 0x6E ; 110102cc: 9f e0 ldi r25, 0x0F ; 15102ce: 9f 93 push r25102d0: 8f 93 push r24102d2: e0 91 78 06 lds r30, 0x0678102d6: f0 91 79 06 lds r31, 0x0679102da: 09 95 icallbreak;102dc: 0f 90 pop r0102de: 0f 90 pop r0102e0: 0f 90 pop r0102e2: 0f 90 pop r0102e4: 14 c0 rjmp .+40 ; 0x1030e <Menu_PosInfo+0xa4>// case SATFIX_2D:// case SATFIX_NONE:default:JetiBox_printfxy(12,0,"NoFx");102e6: 8c e0 ldi r24, 0x0C ; 12102e8: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>102ec: 89 e5 ldi r24, 0x59 ; 89102ee: 9e e0 ldi r25, 0x0E ; 14102f0: 9f 93 push r25102f2: 8f 93 push r24102f4: 8e e6 ldi r24, 0x6E ; 110102f6: 9f e0 ldi r25, 0x0F ; 15102f8: 9f 93 push r25102fa: 8f 93 push r24102fc: e0 91 78 06 lds r30, 0x067810300: f0 91 79 06 lds r31, 0x067910304: 09 95 icallbreak;10306: 0f 90 pop r010308: 0f 90 pop r01030a: 0f 90 pop r01030c: 0f 90 pop r0}if(GPSInfo.Flags & FLAG_DIFFSOLN)1030e: 80 91 d7 08 lds r24, 0x08D710312: 81 ff sbrs r24, 110314: 14 c0 rjmp .+40 ; 0x1033e <Menu_PosInfo+0xd4>{JetiBox_printfxy(12,0,"DGPS");10316: 8c e0 ldi r24, 0x0C ; 1210318: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>1031c: 84 e5 ldi r24, 0x54 ; 841031e: 9e e0 ldi r25, 0x0E ; 1410320: 9f 93 push r2510322: 8f 93 push r2410324: 8e e6 ldi r24, 0x6E ; 11010326: 9f e0 ldi r25, 0x0F ; 1510328: 9f 93 push r251032a: 8f 93 push r241032c: e0 91 78 06 lds r30, 0x067810330: f0 91 79 06 lds r31, 0x067910334: 09 95 icall10336: 0f 90 pop r010338: 0f 90 pop r01033a: 0f 90 pop r01033c: 0f 90 pop r0}JetiBox_printfxy(0,1,"Home:%3dm %3d%c %c", GPSInfo.HomeDistance/10, GPSInfo.HomeBearing, 0xDF,NC_GPS_ModeCharacter);1033e: 80 e1 ldi r24, 0x10 ; 1610340: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>10344: 80 91 96 02 lds r24, 0x029610348: 1f 92 push r11034a: 8f 93 push r241034c: 1f 92 push r11034e: 8f ed ldi r24, 0xDF ; 22310350: 8f 93 push r2410352: ed ed ldi r30, 0xDD ; 22110354: f8 e0 ldi r31, 0x08 ; 810356: 81 81 ldd r24, Z+1 ; 0x0110358: 8f 93 push r241035a: 80 81 ld r24, Z1035c: 8f 93 push r241035e: 20 91 db 08 lds r18, 0x08DB10362: 30 91 dc 08 lds r19, 0x08DC10366: ad ec ldi r26, 0xCD ; 20510368: bc ec ldi r27, 0xCC ; 2041036a: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>1036e: 96 95 lsr r2510370: 87 95 ror r2410372: 96 95 lsr r2510374: 87 95 ror r2410376: 96 95 lsr r2510378: 87 95 ror r241037a: 9f 93 push r251037c: 8f 93 push r241037e: 81 e4 ldi r24, 0x41 ; 6510380: 9e e0 ldi r25, 0x0E ; 1410382: 9f 93 push r2510384: 8f 93 push r2410386: 8e e6 ldi r24, 0x6E ; 11010388: 9f e0 ldi r25, 0x0F ; 151038a: 9f 93 push r251038c: 8f 93 push r241038e: e0 91 78 06 lds r30, 0x067810392: f0 91 79 06 lds r31, 0x067910396: 09 95 icall10398: 8d b7 in r24, 0x3d ; 611039a: 9e b7 in r25, 0x3e ; 621039c: 0c 96 adiw r24, 0x0c ; 121039e: 0f b6 in r0, 0x3f ; 63103a0: f8 94 cli103a2: 9e bf out 0x3e, r25 ; 62103a4: 0f be out 0x3f, r0 ; 63103a6: 8d bf out 0x3d, r24 ; 61103a8: 08 95 ret}else{ //0123456789ABCDEFJetiBox_printfxy(2,0,"No NaviCtrl!");103aa: 82 e0 ldi r24, 0x02 ; 2103ac: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>103b0: 84 e3 ldi r24, 0x34 ; 52103b2: 9e e0 ldi r25, 0x0E ; 14103b4: 9f 93 push r25103b6: 8f 93 push r24103b8: 8e e6 ldi r24, 0x6E ; 110103ba: 9f e0 ldi r25, 0x0F ; 15103bc: 9f 93 push r25103be: 8f 93 push r24103c0: e0 91 78 06 lds r30, 0x0678103c4: f0 91 79 06 lds r31, 0x0679103c8: 09 95 icall103ca: 0f 90 pop r0103cc: 0f 90 pop r0103ce: 0f 90 pop r0103d0: 0f 90 pop r0103d2: 08 95 ret000103d4 <Menu_Status>:// the menu functions// -----------------------------------------------------------void Menu_Status(uint8_t key){ //0123456789ABCDEF#if !defined (RECEIVER_SPEKTRUM_DX7EXP) && !defined (RECEIVER_SPEKTRUM_DX8EXP)JetiBox_printfxy(0,0,"%2i.%1iV",UBat/10, UBat%10);103d4: 80 e0 ldi r24, 0x00 ; 0103d6: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>103da: 80 91 1a 01 lds r24, 0x011A103de: 90 91 1b 01 lds r25, 0x011B103e2: e0 91 1a 01 lds r30, 0x011A103e6: f0 91 1b 01 lds r31, 0x011B103ea: 2a e0 ldi r18, 0x0A ; 10103ec: 30 e0 ldi r19, 0x00 ; 0103ee: b9 01 movw r22, r18103f0: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>103f4: 9f 93 push r25103f6: 8f 93 push r24103f8: cf 01 movw r24, r30103fa: b9 01 movw r22, r18103fc: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>10400: 7f 93 push r2310402: 6f 93 push r2210404: 8c ea ldi r24, 0xAC ; 17210406: 90 e1 ldi r25, 0x10 ; 1610408: 9f 93 push r251040a: 8f 93 push r241040c: 8e e6 ldi r24, 0x6E ; 1101040e: 9f e0 ldi r25, 0x0F ; 1510410: 9f 93 push r2510412: 8f 93 push r2410414: e0 91 78 06 lds r30, 0x067810418: f0 91 79 06 lds r31, 0x06791041c: 09 95 icallif(NaviDataOkay)1041e: 2d b7 in r18, 0x3d ; 6110420: 3e b7 in r19, 0x3e ; 6210422: 28 5f subi r18, 0xF8 ; 24810424: 3f 4f sbci r19, 0xFF ; 25510426: 0f b6 in r0, 0x3f ; 6310428: f8 94 cli1042a: 3e bf out 0x3e, r19 ; 621042c: 0f be out 0x3f, r0 ; 631042e: 2d bf out 0x3d, r18 ; 6110430: 80 91 a4 02 lds r24, 0x02A410434: 88 23 and r24, r2410436: b1 f1 breq .+108 ; 0x104a4 <Menu_Status+0xd0>{JetiBox_printfxy(6,0,"%3d%c %3dm%c",CompassCorrected, 0xDF, GPSInfo.HomeDistance/10,NC_GPS_ModeCharacter);10438: 86 e0 ldi r24, 0x06 ; 61043a: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>1043e: 80 91 96 02 lds r24, 0x029610442: 1f 92 push r110444: 8f 93 push r2410446: 20 91 db 08 lds r18, 0x08DB1044a: 30 91 dc 08 lds r19, 0x08DC1044e: ad ec ldi r26, 0xCD ; 20510450: bc ec ldi r27, 0xCC ; 20410452: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>10456: 96 95 lsr r2510458: 87 95 ror r241045a: 96 95 lsr r251045c: 87 95 ror r241045e: 96 95 lsr r2510460: 87 95 ror r2410462: 9f 93 push r2510464: 8f 93 push r2410466: 1f 92 push r110468: 8f ed ldi r24, 0xDF ; 2231046a: 8f 93 push r241046c: 80 91 66 06 lds r24, 0x066610470: 8f 93 push r2410472: 80 91 65 06 lds r24, 0x066510476: 8f 93 push r2410478: 8f e9 ldi r24, 0x9F ; 1591047a: 90 e1 ldi r25, 0x10 ; 161047c: 9f 93 push r251047e: 8f 93 push r2410480: 8e e6 ldi r24, 0x6E ; 11010482: 9f e0 ldi r25, 0x0F ; 1510484: 9f 93 push r2510486: 8f 93 push r2410488: e0 91 78 06 lds r30, 0x06781048c: f0 91 79 06 lds r31, 0x067910490: 09 95 icall10492: 8d b7 in r24, 0x3d ; 6110494: 9e b7 in r25, 0x3e ; 6210496: 0c 96 adiw r24, 0x0c ; 1210498: 0f b6 in r0, 0x3f ; 631049a: f8 94 cli1049c: 9e bf out 0x3e, r25 ; 621049e: 0f be out 0x3f, r0 ; 63104a0: 8d bf out 0x3d, r24 ; 61104a2: 14 c0 rjmp .+40 ; 0x104cc <Menu_Status+0xf8>}else{JetiBox_printfxy(6,0,"Status ");104a4: 86 e0 ldi r24, 0x06 ; 6104a6: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>104aa: 84 e9 ldi r24, 0x94 ; 148104ac: 90 e1 ldi r25, 0x10 ; 16104ae: 9f 93 push r25104b0: 8f 93 push r24104b2: 8e e6 ldi r24, 0x6E ; 110104b4: 9f e0 ldi r25, 0x0F ; 15104b6: 9f 93 push r25104b8: 8f 93 push r24104ba: e0 91 78 06 lds r30, 0x0678104be: f0 91 79 06 lds r31, 0x0679104c2: 09 95 icall104c4: 0f 90 pop r0104c6: 0f 90 pop r0104c8: 0f 90 pop r0104ca: 0f 90 pop r0}#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))if(NC_ErrorCode)104cc: 80 91 bb 04 lds r24, 0x04BB104d0: 88 23 and r24, r24104d2: 09 f4 brne .+2 ; 0x104d6 <Menu_Status+0x102>104d4: 58 c0 rjmp .+176 ; 0x10586 <Menu_Status+0x1b2>{static unsigned int timer;static char toggle = 1;if(CheckDelay(timer)) { if(toggle) toggle = 0; else toggle = 1; timer = SetDelay(1500);};104d6: 80 91 95 04 lds r24, 0x0495104da: 90 91 96 04 lds r25, 0x0496104de: 0e 94 63 9c call 0x138c6 ; 0x138c6 <CheckDelay>104e2: 88 23 and r24, r24104e4: 91 f0 breq .+36 ; 0x1050a <Menu_Status+0x136>104e6: 80 91 5d 01 lds r24, 0x015D104ea: 88 23 and r24, r24104ec: 19 f0 breq .+6 ; 0x104f4 <Menu_Status+0x120>104ee: 10 92 5d 01 sts 0x015D, r1104f2: 03 c0 rjmp .+6 ; 0x104fa <Menu_Status+0x126>104f4: 81 e0 ldi r24, 0x01 ; 1104f6: 80 93 5d 01 sts 0x015D, r24104fa: 8c ed ldi r24, 0xDC ; 220104fc: 95 e0 ldi r25, 0x05 ; 5104fe: 0e 94 5a 9c call 0x138b4 ; 0x138b4 <SetDelay>10502: 90 93 96 04 sts 0x0496, r2510506: 80 93 95 04 sts 0x0495, r24if(toggle)1050a: 80 91 5d 01 lds r24, 0x015D1050e: 88 23 and r24, r2410510: f9 f0 breq .+62 ; 0x10550 <Menu_Status+0x17c>{LIBFC_JetiBox_SetPos(0);10512: 80 e0 ldi r24, 0x00 ; 010514: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>_printf_P(&LIBFC_JetiBox_Putchar, NC_ERROR_TEXT[NC_ErrorCode] , 0);10518: 1f 92 push r11051a: 1f 92 push r11051c: 80 91 bb 04 lds r24, 0x04BB10520: 21 e1 ldi r18, 0x11 ; 1710522: 82 9f mul r24, r1810524: c0 01 movw r24, r010526: 11 24 eor r1, r110528: 84 59 subi r24, 0x94 ; 1481052a: 94 4f sbci r25, 0xF4 ; 2441052c: 9f 93 push r251052e: 8f 93 push r2410530: 8e e6 ldi r24, 0x6E ; 11010532: 9f e0 ldi r25, 0x0F ; 1510534: 9f 93 push r2510536: 8f 93 push r2410538: e0 91 78 06 lds r30, 0x06781053c: f0 91 79 06 lds r31, 0x067910540: 09 95 icall10542: 0f 90 pop r010544: 0f 90 pop r010546: 0f 90 pop r010548: 0f 90 pop r01054a: 0f 90 pop r01054c: 0f 90 pop r01054e: 74 c0 rjmp .+232 ; 0x10638 <Menu_Status+0x264>}else{JetiBox_printfxy(6,0,"ERROR: %2d ",NC_ErrorCode);10550: 86 e0 ldi r24, 0x06 ; 610552: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>10556: 80 91 bb 04 lds r24, 0x04BB1055a: 1f 92 push r11055c: 8f 93 push r241055e: 88 e8 ldi r24, 0x88 ; 13610560: 90 e1 ldi r25, 0x10 ; 1610562: 9f 93 push r2510564: 8f 93 push r2410566: 8e e6 ldi r24, 0x6E ; 11010568: 9f e0 ldi r25, 0x0F ; 151056a: 9f 93 push r251056c: 8f 93 push r241056e: e0 91 78 06 lds r30, 0x067810572: f0 91 79 06 lds r31, 0x067910576: 09 95 icall10578: 0f 90 pop r01057a: 0f 90 pop r01057c: 0f 90 pop r01057e: 0f 90 pop r010580: 0f 90 pop r010582: 0f 90 pop r010584: 59 c0 rjmp .+178 ; 0x10638 <Menu_Status+0x264>// if(MotorenEin) JetiBeep = 'O';}}elseif(NC_To_FC_Flags & NC_TO_FC_SIMULATION_ACTIVE)10586: 80 91 b7 04 lds r24, 0x04B71058a: 84 ff sbrs r24, 41058c: 15 c0 rjmp .+42 ; 0x105b8 <Menu_Status+0x1e4>{JetiBox_printfxy(6,0,"SIMULATION");1058e: 86 e0 ldi r24, 0x06 ; 610590: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>10594: 8d e7 ldi r24, 0x7D ; 12510596: 90 e1 ldi r25, 0x10 ; 1610598: 9f 93 push r251059a: 8f 93 push r241059c: 8e e6 ldi r24, 0x6E ; 1101059e: 9f e0 ldi r25, 0x0F ; 15105a0: 9f 93 push r25105a2: 8f 93 push r24105a4: e0 91 78 06 lds r30, 0x0678105a8: f0 91 79 06 lds r31, 0x0679105ac: 09 95 icall105ae: 0f 90 pop r0105b0: 0f 90 pop r0105b2: 0f 90 pop r0105b4: 0f 90 pop r0105b6: 40 c0 rjmp .+128 ; 0x10638 <Menu_Status+0x264>}elseif(ShowSettingNameTime)105b8: 80 91 80 04 lds r24, 0x0480105bc: 88 23 and r24, r24105be: e1 f1 breq .+120 ; 0x10638 <Menu_Status+0x264>{LIBFC_JetiBox_Clear();105c0: 0e 94 81 0f call 0x1f02 ; 0x1f02 <LIBFC_JetiBox_Clear>JetiBox_printfxy(0,0,"Set%d:%s",ActiveParamSet,EE_Parameter.Name);105c4: 80 e0 ldi r24, 0x00 ; 0105c6: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>105ca: 8a eb ldi r24, 0xBA ; 186105cc: 95 e0 ldi r25, 0x05 ; 5105ce: 9f 93 push r25105d0: 8f 93 push r24105d2: 80 91 52 01 lds r24, 0x0152105d6: 1f 92 push r1105d8: 8f 93 push r24105da: 84 e7 ldi r24, 0x74 ; 116105dc: 90 e1 ldi r25, 0x10 ; 16105de: 9f 93 push r25105e0: 8f 93 push r24105e2: 8e e6 ldi r24, 0x6E ; 110105e4: 9f e0 ldi r25, 0x0F ; 15105e6: 9f 93 push r25105e8: 8f 93 push r24105ea: e0 91 78 06 lds r30, 0x0678105ee: f0 91 79 06 lds r31, 0x0679105f2: 09 95 icallif(FC_StatusFlags3 & FC_STATUS3_BOAT) JetiBox_printfxy(0,1,"(Boat-Mode)");105f4: 80 91 c9 03 lds r24, 0x03C9105f8: 2d b7 in r18, 0x3d ; 61105fa: 3e b7 in r19, 0x3e ; 62105fc: 28 5f subi r18, 0xF8 ; 248105fe: 3f 4f sbci r19, 0xFF ; 25510600: 0f b6 in r0, 0x3f ; 6310602: f8 94 cli10604: 3e bf out 0x3e, r19 ; 6210606: 0f be out 0x3f, r0 ; 6310608: 2d bf out 0x3d, r18 ; 611060a: 81 ff sbrs r24, 11060c: a5 c0 rjmp .+330 ; 0x10758 <Menu_Status+0x384>1060e: 80 e1 ldi r24, 0x10 ; 1610610: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>10614: 88 e6 ldi r24, 0x68 ; 10410616: 90 e1 ldi r25, 0x10 ; 1610618: 9f 93 push r251061a: 8f 93 push r241061c: 8e e6 ldi r24, 0x6E ; 1101061e: 9f e0 ldi r25, 0x0F ; 1510620: 9f 93 push r2510622: 8f 93 push r2410624: e0 91 78 06 lds r30, 0x067810628: f0 91 79 06 lds r31, 0x06791062c: 09 95 icall1062e: 0f 90 pop r010630: 0f 90 pop r010632: 0f 90 pop r010634: 0f 90 pop r010636: 08 95 ret}#elseif(NC_ErrorCode) { JetiBox_printfxy(6,0,"ERROR: %2d ",NC_ErrorCode); if(MotorenEin) JetiBeep = 'S';};#endifJetiBox_printfxy(0,1,"%4i %2i:%02i",Capacity.UsedCapacity,FlugSekunden/60,FlugSekunden%60);10638: 80 e1 ldi r24, 0x10 ; 161063a: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>1063e: 40 91 5e 04 lds r20, 0x045E10642: 50 91 5f 04 lds r21, 0x045F10646: 9a 01 movw r18, r2010648: a9 e8 ldi r26, 0x89 ; 1371064a: b8 e8 ldi r27, 0x88 ; 1361064c: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>10650: 96 95 lsr r2510652: 87 95 ror r2410654: 92 95 swap r2510656: 82 95 swap r2410658: 8f 70 andi r24, 0x0F ; 151065a: 89 27 eor r24, r251065c: 9f 70 andi r25, 0x0F ; 151065e: 89 27 eor r24, r2510660: 6c e3 ldi r22, 0x3C ; 6010662: 68 9f mul r22, r2410664: 90 01 movw r18, r010666: 69 9f mul r22, r2510668: 30 0d add r19, r01066a: 11 24 eor r1, r11066c: ca 01 movw r24, r201066e: 82 1b sub r24, r1810670: 93 0b sbc r25, r1910672: 9f 93 push r2510674: 8f 93 push r2410676: 9a 01 movw r18, r2010678: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>1067c: 96 95 lsr r251067e: 87 95 ror r2410680: 92 95 swap r2510682: 82 95 swap r2410684: 8f 70 andi r24, 0x0F ; 1510686: 89 27 eor r24, r2510688: 9f 70 andi r25, 0x0F ; 151068a: 89 27 eor r24, r251068c: 9f 93 push r251068e: 8f 93 push r2410690: e9 e1 ldi r30, 0x19 ; 2510692: f5 e0 ldi r31, 0x05 ; 510694: 81 81 ldd r24, Z+1 ; 0x0110696: 8f 93 push r2410698: 80 81 ld r24, Z1069a: 8f 93 push r241069c: 8b e5 ldi r24, 0x5B ; 911069e: 90 e1 ldi r25, 0x10 ; 16106a0: 9f 93 push r25106a2: 8f 93 push r24106a4: 8e e6 ldi r24, 0x6E ; 110106a6: 9f e0 ldi r25, 0x0F ; 15106a8: 9f 93 push r25106aa: 8f 93 push r24106ac: e0 91 78 06 lds r30, 0x0678106b0: f0 91 79 06 lds r31, 0x0679106b4: 09 95 icallif(Parameter_GlobalConfig & CFG_HOEHENREGELUNG)106b6: 80 91 5c 06 lds r24, 0x065C106ba: 2d b7 in r18, 0x3d ; 61106bc: 3e b7 in r19, 0x3e ; 62106be: 26 5f subi r18, 0xF6 ; 246106c0: 3f 4f sbci r19, 0xFF ; 255106c2: 0f b6 in r0, 0x3f ; 63106c4: f8 94 cli106c6: 3e bf out 0x3e, r19 ; 62106c8: 0f be out 0x3f, r0 ; 63106ca: 2d bf out 0x3d, r18 ; 61106cc: 80 ff sbrs r24, 0106ce: 2c c0 rjmp .+88 ; 0x10728 <Menu_Status+0x354>{JetiBox_printfxy(10,1,"%4im%c", (int16_t)(HoehenWert/100),VarioCharacter);106d0: 8a e1 ldi r24, 0x1A ; 26106d2: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>106d6: 80 91 20 01 lds r24, 0x0120106da: 1f 92 push r1106dc: 8f 93 push r24106de: 60 91 fe 03 lds r22, 0x03FE106e2: 70 91 ff 03 lds r23, 0x03FF106e6: 80 91 00 04 lds r24, 0x0400106ea: 90 91 01 04 lds r25, 0x0401106ee: 24 e6 ldi r18, 0x64 ; 100106f0: 30 e0 ldi r19, 0x00 ; 0106f2: 40 e0 ldi r20, 0x00 ; 0106f4: 50 e0 ldi r21, 0x00 ; 0106f6: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>106fa: 3f 93 push r19106fc: 2f 93 push r18106fe: 84 e5 ldi r24, 0x54 ; 8410700: 90 e1 ldi r25, 0x10 ; 1610702: 9f 93 push r2510704: 8f 93 push r2410706: 8e e6 ldi r24, 0x6E ; 11010708: 9f e0 ldi r25, 0x0F ; 151070a: 9f 93 push r251070c: 8f 93 push r241070e: e0 91 78 06 lds r30, 0x067810712: f0 91 79 06 lds r31, 0x067910716: 09 95 icall10718: 8d b7 in r24, 0x3d ; 611071a: 9e b7 in r25, 0x3e ; 621071c: 08 96 adiw r24, 0x08 ; 81071e: 0f b6 in r0, 0x3f ; 6310720: f8 94 cli10722: 9e bf out 0x3e, r25 ; 6210724: 0f be out 0x3f, r0 ; 6310726: 8d bf out 0x3d, r24 ; 61}if(FC_StatusFlags3 & FC_STATUS3_REDUNDANCE) JetiBox_printfxy(10,1,"R");10728: 80 91 c9 03 lds r24, 0x03C91072c: 80 ff sbrs r24, 01072e: 14 c0 rjmp .+40 ; 0x10758 <Menu_Status+0x384>10730: 8a e1 ldi r24, 0x1A ; 2610732: 0e 94 7b 0f call 0x1ef6 ; 0x1ef6 <LIBFC_JetiBox_SetPos>10736: 82 e5 ldi r24, 0x52 ; 8210738: 90 e1 ldi r25, 0x10 ; 161073a: 9f 93 push r251073c: 8f 93 push r241073e: 8e e6 ldi r24, 0x6E ; 11010740: 9f e0 ldi r25, 0x0F ; 1510742: 9f 93 push r2510744: 8f 93 push r2410746: e0 91 78 06 lds r30, 0x06781074a: f0 91 79 06 lds r31, 0x06791074e: 09 95 icall10750: 0f 90 pop r010752: 0f 90 pop r010754: 0f 90 pop r010756: 0f 90 pop r010758: 08 95 ret0001075a <JetiBox_Update>:// -----------------------------------------------------------// Update display buffer// -----------------------------------------------------------unsigned char JetiBox_Update(unsigned char key){1075a: cf 93 push r281075c: c8 2f mov r28, r24#if !defined (RECEIVER_SPEKTRUM_DX7EXP) && !defined (RECEIVER_SPEKTRUM_DX8EXP)static uint8_t item = 0, last_item = 0; // the menu itemstatic uint8_t updateDelay = 1 , last_key;// navigate within the menu by key actionlast_item = item;1075e: 40 91 90 04 lds r20, 0x049010762: 40 93 8f 04 sts 0x048F, r20switch(key)10766: 8f 32 cpi r24, 0x2F ; 4710768: 49 f1 breq .+82 ; 0x107bc <JetiBox_Update+0x62>1076a: 18 f4 brcc .+6 ; 0x10772 <JetiBox_Update+0x18>1076c: 8f 31 cpi r24, 0x1F ; 311076e: b1 f0 breq .+44 ; 0x1079c <JetiBox_Update+0x42>10770: 44 c0 rjmp .+136 ; 0x107fa <JetiBox_Update+0xa0>10772: 8f 34 cpi r24, 0x4F ; 7910774: 99 f1 breq .+102 ; 0x107dc <JetiBox_Update+0x82>10776: 8f 38 cpi r24, 0x8F ; 14310778: 09 f0 breq .+2 ; 0x1077c <JetiBox_Update+0x22>1077a: 3f c0 rjmp .+126 ; 0x107fa <JetiBox_Update+0xa0>{case JETIBOX_KEY_LEFT://if (item == 0) return (1); // switch back to jeti expander menu// elseitem = pgm_read_byte(&JetiBox_Menu[item].left); //trigger to left menu item1077c: 84 2f mov r24, r201077e: 90 e0 ldi r25, 0x00 ; 010780: fc 01 movw r30, r2410782: ee 0f add r30, r3010784: ff 1f adc r31, r3110786: 8e 0f add r24, r3010788: 9f 1f adc r25, r311078a: fc 01 movw r30, r241078c: ee 0f add r30, r301078e: ff 1f adc r31, r3110790: eb 54 subi r30, 0x4B ; 7510792: ff 4e sbci r31, 0xEF ; 23910794: e4 91 lpm r30, Z10796: e0 93 90 04 sts 0x0490, r30break;1079a: 2f c0 rjmp .+94 ; 0x107fa <JetiBox_Update+0xa0>case JETIBOX_KEY_RIGHT:item = pgm_read_byte(&JetiBox_Menu[item].right); //trigger to right menu item1079c: 84 2f mov r24, r201079e: 90 e0 ldi r25, 0x00 ; 0107a0: fc 01 movw r30, r24107a2: ee 0f add r30, r30107a4: ff 1f adc r31, r31107a6: 8e 0f add r24, r30107a8: 9f 1f adc r25, r31107aa: fc 01 movw r30, r24107ac: ee 0f add r30, r30107ae: ff 1f adc r31, r31107b0: ea 54 subi r30, 0x4A ; 74107b2: ff 4e sbci r31, 0xEF ; 239107b4: e4 91 lpm r30, Z107b6: e0 93 90 04 sts 0x0490, r30break;107ba: 1f c0 rjmp .+62 ; 0x107fa <JetiBox_Update+0xa0>case JETIBOX_KEY_UP:item = pgm_read_byte(&JetiBox_Menu[item].up); //trigger to up menu item107bc: 84 2f mov r24, r20107be: 90 e0 ldi r25, 0x00 ; 0107c0: fc 01 movw r30, r24107c2: ee 0f add r30, r30107c4: ff 1f adc r31, r31107c6: 8e 0f add r24, r30107c8: 9f 1f adc r25, r31107ca: fc 01 movw r30, r24107cc: ee 0f add r30, r30107ce: ff 1f adc r31, r31107d0: e9 54 subi r30, 0x49 ; 73107d2: ff 4e sbci r31, 0xEF ; 239107d4: e4 91 lpm r30, Z107d6: e0 93 90 04 sts 0x0490, r30break;107da: 0f c0 rjmp .+30 ; 0x107fa <JetiBox_Update+0xa0>case JETIBOX_KEY_DOWN:item = pgm_read_byte(&JetiBox_Menu[item].down); //trigger to down menu item107dc: 24 2f mov r18, r20107de: 30 e0 ldi r19, 0x00 ; 0107e0: f9 01 movw r30, r18107e2: ee 0f add r30, r30107e4: ff 1f adc r31, r31107e6: 2e 0f add r18, r30107e8: 3f 1f adc r19, r31107ea: f9 01 movw r30, r18107ec: ee 0f add r30, r30107ee: ff 1f adc r31, r31107f0: e8 54 subi r30, 0x48 ; 72107f2: ff 4e sbci r31, 0xEF ; 239107f4: e4 91 lpm r30, Z107f6: e0 93 90 04 sts 0x0490, r30default:break;}// if the menu item has been changed, do not pass the key to the item handler// to avoid jumping over to itemsif(item != last_item) key = JETIBOX_KEY_UNDEF;107fa: 80 91 90 04 lds r24, 0x0490107fe: 48 13 cpse r20, r2410800: 21 c0 rjmp .+66 ; 0x10844 <JetiBox_Update+0xea>// if((updateDelay++ & 0x01) || (key != last_key))if((updateDelay++ & 0x01) || (key != JETIBOX_KEY_NONE))10802: 80 91 58 01 lds r24, 0x015810806: 91 e0 ldi r25, 0x01 ; 110808: 98 0f add r25, r241080a: 90 93 58 01 sts 0x0158, r251080e: 80 fd sbrc r24, 010810: 02 c0 rjmp .+4 ; 0x10816 <JetiBox_Update+0xbc>10812: cf 30 cpi r28, 0x0F ; 1510814: f1 f0 breq .+60 ; 0x10852 <JetiBox_Update+0xf8>{last_key = key;10816: c0 93 8e 04 sts 0x048E, r28LIBFC_JetiBox_Clear();1081a: 0e 94 81 0f call 0x1f02 ; 0x1f02 <LIBFC_JetiBox_Clear>//execute menu item handler((pFctMenu)(pgm_read_word(&(JetiBox_Menu[item].pHandler))))(key);1081e: 20 91 90 04 lds r18, 0x049010822: 30 e0 ldi r19, 0x00 ; 010824: f9 01 movw r30, r1810826: ee 0f add r30, r3010828: ff 1f adc r31, r311082a: 2e 0f add r18, r301082c: 3f 1f adc r19, r311082e: f9 01 movw r30, r1810830: ee 0f add r30, r3010832: ff 1f adc r31, r3110834: e7 54 subi r30, 0x47 ; 7110836: ff 4e sbci r31, 0xEF ; 23910838: 25 91 lpm r18, Z+1083a: 34 91 lpm r19, Z1083c: 8c 2f mov r24, r281083e: f9 01 movw r30, r1810840: 09 95 icall10842: 07 c0 rjmp .+14 ; 0x10852 <JetiBox_Update+0xf8>// if the menu item has been changed, do not pass the key to the item handler// to avoid jumping over to itemsif(item != last_item) key = JETIBOX_KEY_UNDEF;// if((updateDelay++ & 0x01) || (key != last_key))if((updateDelay++ & 0x01) || (key != JETIBOX_KEY_NONE))10844: 80 91 58 01 lds r24, 0x015810848: 8f 5f subi r24, 0xFF ; 2551084a: 80 93 58 01 sts 0x0158, r24default:break;}// if the menu item has been changed, do not pass the key to the item handler// to avoid jumping over to itemsif(item != last_item) key = JETIBOX_KEY_UNDEF;1084e: c0 e0 ldi r28, 0x00 ; 010850: e2 cf rjmp .-60 ; 0x10816 <JetiBox_Update+0xbc>//execute menu item handler((pFctMenu)(pgm_read_word(&(JetiBox_Menu[item].pHandler))))(key);}#endifreturn (0);}10852: 80 e0 ldi r24, 0x00 ; 010854: cf 91 pop r2810856: 08 95 ret00010858 <BuildJeti_Vario>:void BuildJeti_Vario(void){signed int tmp = 0;static signed int JetiVarioMeter = 0;JetiVarioMeter = (JetiVarioMeter * 3 + VarioMeter) / 4;10858: 40 91 54 03 lds r20, 0x03541085c: 50 91 55 03 lds r21, 0x035510860: 20 91 97 04 lds r18, 0x049710864: 30 91 98 04 lds r19, 0x049810868: c9 01 movw r24, r181086a: 88 0f add r24, r241086c: 99 1f adc r25, r251086e: 82 0f add r24, r1810870: 93 1f adc r25, r1910872: 84 0f add r24, r2010874: 95 1f adc r25, r2110876: 99 23 and r25, r2510878: 0c f4 brge .+2 ; 0x1087c <BuildJeti_Vario+0x24>1087a: 03 96 adiw r24, 0x03 ; 31087c: 95 95 asr r251087e: 87 95 ror r2410880: 95 95 asr r2510882: 87 95 ror r2410884: 90 93 98 04 sts 0x0498, r2510888: 80 93 97 04 sts 0x0497, r24if(VarioCharacter == '+')1088c: 20 91 20 01 lds r18, 0x012010890: 2b 32 cpi r18, 0x2B ; 4310892: d1 f4 brne .+52 ; 0x108c8 <BuildJeti_Vario+0x70>{tmp = (AltitudeSetpointTrimming * EE_Parameter.Hoehe_Verstaerkung) / 32 + 5;10894: 40 91 50 05 lds r20, 0x055010898: 20 91 f8 03 lds r18, 0x03F81089c: 30 91 f9 03 lds r19, 0x03F9108a0: 42 9f mul r20, r18108a2: c0 01 movw r24, r0108a4: 43 9f mul r20, r19108a6: 90 0d add r25, r0108a8: 11 24 eor r1, r1108aa: 99 23 and r25, r25108ac: 0c f4 brge .+2 ; 0x108b0 <BuildJeti_Vario+0x58>108ae: 4f 96 adiw r24, 0x1f ; 31108b0: 95 95 asr r25108b2: 87 95 ror r24108b4: 95 95 asr r25108b6: 87 95 ror r24108b8: 95 95 asr r25108ba: 87 95 ror r24108bc: 95 95 asr r25108be: 87 95 ror r24108c0: 95 95 asr r25108c2: 87 95 ror r24108c4: 05 96 adiw r24, 0x05 ; 5108c6: 47 c0 rjmp .+142 ; 0x10956 <BuildJeti_Vario+0xfe>}elseif(VarioCharacter == '-')108c8: 2d 32 cpi r18, 0x2D ; 45108ca: d1 f4 brne .+52 ; 0x10900 <BuildJeti_Vario+0xa8>{tmp = (AltitudeSetpointTrimming * EE_Parameter.Hoehe_Verstaerkung) / 32 - 5;108cc: 40 91 50 05 lds r20, 0x0550108d0: 20 91 f8 03 lds r18, 0x03F8108d4: 30 91 f9 03 lds r19, 0x03F9108d8: 42 9f mul r20, r18108da: c0 01 movw r24, r0108dc: 43 9f mul r20, r19108de: 90 0d add r25, r0108e0: 11 24 eor r1, r1108e2: 99 23 and r25, r25108e4: 0c f4 brge .+2 ; 0x108e8 <BuildJeti_Vario+0x90>108e6: 4f 96 adiw r24, 0x1f ; 31108e8: 95 95 asr r25108ea: 87 95 ror r24108ec: 95 95 asr r25108ee: 87 95 ror r24108f0: 95 95 asr r25108f2: 87 95 ror r24108f4: 95 95 asr r25108f6: 87 95 ror r24108f8: 95 95 asr r25108fa: 87 95 ror r24108fc: 05 97 sbiw r24, 0x05 ; 5108fe: 2b c0 rjmp .+86 ; 0x10956 <BuildJeti_Vario+0xfe>}elseif((VarioCharacter == ' ') && (FC_StatusFlags & FC_STATUS_FLY))10900: 20 32 cpi r18, 0x20 ; 3210902: a9 f4 brne .+42 ; 0x1092e <BuildJeti_Vario+0xd6>10904: 20 91 cb 03 lds r18, 0x03CB10908: 21 ff sbrs r18, 11090a: 20 c0 rjmp .+64 ; 0x1094c <BuildJeti_Vario+0xf4>{tmp = (JetiVarioMeter/32);1090c: 9c 01 movw r18, r241090e: 99 23 and r25, r2510910: 14 f4 brge .+4 ; 0x10916 <BuildJeti_Vario+0xbe>10912: 21 5e subi r18, 0xE1 ; 22510914: 3f 4f sbci r19, 0xFF ; 25510916: c9 01 movw r24, r1810918: 95 95 asr r251091a: 87 95 ror r241091c: 95 95 asr r251091e: 87 95 ror r2410920: 95 95 asr r2510922: 87 95 ror r2410924: 95 95 asr r2510926: 87 95 ror r2410928: 95 95 asr r251092a: 87 95 ror r241092c: 14 c0 rjmp .+40 ; 0x10956 <BuildJeti_Vario+0xfe>}elseif(VarioCharacter == '^') tmp = FromNC_AltitudeSpeed;1092e: 2e 35 cpi r18, 0x5E ; 9410930: 21 f4 brne .+8 ; 0x1093a <BuildJeti_Vario+0xe2>10932: 80 91 f3 03 lds r24, 0x03F310936: 90 e0 ldi r25, 0x00 ; 010938: 0e c0 rjmp .+28 ; 0x10956 <BuildJeti_Vario+0xfe>elseif(VarioCharacter == 'v') tmp = tmp - FromNC_AltitudeSpeed;1093a: 26 37 cpi r18, 0x76 ; 1181093c: 51 f4 brne .+20 ; 0x10952 <BuildJeti_Vario+0xfa>1093e: 80 91 f3 03 lds r24, 0x03F310942: 90 e0 ldi r25, 0x00 ; 010944: 91 95 neg r2510946: 81 95 neg r2410948: 91 09 sbc r25, r11094a: 05 c0 rjmp .+10 ; 0x10956 <BuildJeti_Vario+0xfe>};void BuildJeti_Vario(void){signed int tmp = 0;1094c: 80 e0 ldi r24, 0x00 ; 01094e: 90 e0 ldi r25, 0x00 ; 010950: 02 c0 rjmp .+4 ; 0x10956 <BuildJeti_Vario+0xfe>10952: 80 e0 ldi r24, 0x00 ; 010954: 90 e0 ldi r25, 0x00 ; 0elseif(VarioCharacter == '^') tmp = FromNC_AltitudeSpeed;elseif(VarioCharacter == 'v') tmp = tmp - FromNC_AltitudeSpeed;JetiExData[12].Value = tmp;10956: aa 27 eor r26, r2610958: 97 fd sbrc r25, 71095a: a0 95 com r261095c: ba 2f mov r27, r261095e: 80 93 50 02 sts 0x0250, r2410962: 90 93 51 02 sts 0x0251, r2510966: a0 93 52 02 sts 0x0252, r261096a: b0 93 53 02 sts 0x0253, r271096e: 08 95 ret00010970 <JetiEX_Update>:// --------------------------------------------------------------------------------------------------void JetiEX_Update(void){GetHottestBl();10970: 0e 94 79 60 call 0xc0f2 ; 0xc0f2 <GetHottestBl>JetiExData[1].Value = UBat;10974: 80 91 1a 01 lds r24, 0x011A10978: 90 91 1b 01 lds r25, 0x011B1097c: aa 27 eor r26, r261097e: 97 fd sbrc r25, 710980: a0 95 com r2610982: ba 2f mov r27, r2610984: 80 93 7f 01 sts 0x017F, r2410988: 90 93 80 01 sts 0x0180, r251098c: a0 93 81 01 sts 0x0181, r2610990: b0 93 82 01 sts 0x0182, r27JetiExData[2].Value = Capacity.ActualCurrent;10994: 80 91 15 05 lds r24, 0x051510998: 90 91 16 05 lds r25, 0x05161099c: a0 e0 ldi r26, 0x00 ; 01099e: b0 e0 ldi r27, 0x00 ; 0109a0: 80 93 92 01 sts 0x0192, r24109a4: 90 93 93 01 sts 0x0193, r25109a8: a0 93 94 01 sts 0x0194, r26109ac: b0 93 95 01 sts 0x0195, r27JetiExData[3].Value = Capacity.UsedCapacity / 10;109b0: 20 91 19 05 lds r18, 0x0519109b4: 30 91 1a 05 lds r19, 0x051A109b8: ad ec ldi r26, 0xCD ; 205109ba: bc ec ldi r27, 0xCC ; 204109bc: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>109c0: 96 95 lsr r25109c2: 87 95 ror r24109c4: 96 95 lsr r25109c6: 87 95 ror r24109c8: 96 95 lsr r25109ca: 87 95 ror r24109cc: a0 e0 ldi r26, 0x00 ; 0109ce: b0 e0 ldi r27, 0x00 ; 0109d0: 80 93 a5 01 sts 0x01A5, r24109d4: 90 93 a6 01 sts 0x01A6, r25109d8: a0 93 a7 01 sts 0x01A7, r26109dc: b0 93 a8 01 sts 0x01A8, r27JetiExData[4].Value = HoehenWert / 100;109e0: 60 91 fe 03 lds r22, 0x03FE109e4: 70 91 ff 03 lds r23, 0x03FF109e8: 80 91 00 04 lds r24, 0x0400109ec: 90 91 01 04 lds r25, 0x0401109f0: 24 e6 ldi r18, 0x64 ; 100109f2: 30 e0 ldi r19, 0x00 ; 0109f4: 40 e0 ldi r20, 0x00 ; 0109f6: 50 e0 ldi r21, 0x00 ; 0109f8: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>109fc: 20 93 b8 01 sts 0x01B8, r1810a00: 30 93 b9 01 sts 0x01B9, r1910a04: 40 93 ba 01 sts 0x01BA, r2010a08: 50 93 bb 01 sts 0x01BB, r21JetiExData[5].Value = KompassValue;10a0c: 80 91 4e 01 lds r24, 0x014E10a10: 90 91 4f 01 lds r25, 0x014F10a14: aa 27 eor r26, r2610a16: 97 fd sbrc r25, 710a18: a0 95 com r2610a1a: ba 2f mov r27, r2610a1c: 80 93 cb 01 sts 0x01CB, r2410a20: 90 93 cc 01 sts 0x01CC, r2510a24: a0 93 cd 01 sts 0x01CD, r2610a28: b0 93 ce 01 sts 0x01CE, r27JetiExData[6].Value = GPSInfo.NumOfSats;10a2c: 80 91 d8 08 lds r24, 0x08D810a30: 90 e0 ldi r25, 0x00 ; 010a32: a0 e0 ldi r26, 0x00 ; 010a34: b0 e0 ldi r27, 0x00 ; 010a36: 80 93 de 01 sts 0x01DE, r2410a3a: 90 93 df 01 sts 0x01DF, r2510a3e: a0 93 e0 01 sts 0x01E0, r2610a42: b0 93 e1 01 sts 0x01E1, r27JetiExData[7].Value = GPSInfo.Speed;10a46: 80 91 da 08 lds r24, 0x08DA10a4a: 90 e0 ldi r25, 0x00 ; 010a4c: a0 e0 ldi r26, 0x00 ; 010a4e: b0 e0 ldi r27, 0x00 ; 010a50: 80 93 f1 01 sts 0x01F1, r2410a54: 90 93 f2 01 sts 0x01F2, r2510a58: a0 93 f3 01 sts 0x01F3, r2610a5c: b0 93 f4 01 sts 0x01F4, r27JetiExData[8].Value = GPSInfo.HomeDistance / 10;10a60: 20 91 db 08 lds r18, 0x08DB10a64: 30 91 dc 08 lds r19, 0x08DC10a68: ad ec ldi r26, 0xCD ; 20510a6a: bc ec ldi r27, 0xCC ; 20410a6c: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>10a70: 96 95 lsr r2510a72: 87 95 ror r2410a74: 96 95 lsr r2510a76: 87 95 ror r2410a78: 96 95 lsr r2510a7a: 87 95 ror r2410a7c: a0 e0 ldi r26, 0x00 ; 010a7e: b0 e0 ldi r27, 0x00 ; 010a80: 80 93 04 02 sts 0x0204, r2410a84: 90 93 05 02 sts 0x0205, r2510a88: a0 93 06 02 sts 0x0206, r2610a8c: b0 93 07 02 sts 0x0207, r27JetiExData[9].Value = GPSInfo.HomeBearing;10a90: 80 91 dd 08 lds r24, 0x08DD10a94: 90 91 de 08 lds r25, 0x08DE10a98: aa 27 eor r26, r2610a9a: 97 fd sbrc r25, 710a9c: a0 95 com r2610a9e: ba 2f mov r27, r2610aa0: 80 93 17 02 sts 0x0217, r2410aa4: 90 93 18 02 sts 0x0218, r2510aa8: a0 93 19 02 sts 0x0219, r2610aac: b0 93 1a 02 sts 0x021A, r27JetiExData[10].Value = MaxBlTemperture;10ab0: 80 91 84 04 lds r24, 0x048410ab4: 90 e0 ldi r25, 0x00 ; 010ab6: a0 e0 ldi r26, 0x00 ; 010ab8: b0 e0 ldi r27, 0x00 ; 010aba: 80 93 2a 02 sts 0x022A, r2410abe: 90 93 2b 02 sts 0x022B, r2510ac2: a0 93 2c 02 sts 0x022C, r2610ac6: b0 93 2d 02 sts 0x022D, r27JetiExData[11].Value = EarthMagneticField;10aca: 80 91 ba 04 lds r24, 0x04BA10ace: 90 e0 ldi r25, 0x00 ; 010ad0: a0 e0 ldi r26, 0x00 ; 010ad2: b0 e0 ldi r27, 0x00 ; 010ad4: 80 93 3d 02 sts 0x023D, r2410ad8: 90 93 3e 02 sts 0x023E, r2510adc: a0 93 3f 02 sts 0x023F, r2610ae0: b0 93 40 02 sts 0x0240, r27// JetiExData[12].Value = Vario; // wird in BuildJeti_Vario() gemachtJetiExData[13].Value = NC_ErrorCode;10ae4: 80 91 bb 04 lds r24, 0x04BB10ae8: 90 e0 ldi r25, 0x00 ; 010aea: a0 e0 ldi r26, 0x00 ; 010aec: b0 e0 ldi r27, 0x00 ; 010aee: 80 93 63 02 sts 0x0263, r2410af2: 90 93 64 02 sts 0x0264, r2510af6: a0 93 65 02 sts 0x0265, r2610afa: b0 93 66 02 sts 0x0266, r2710afe: 08 95 ret00010b00 <LED_Init>:// initializes the LED control outputs J16, J17void LED_Init(void){// set PC2 & PC3 as output (control of J16 & J17)DDRC |= (1<<DDRC2)|(1<<DDRC3);10b00: 87 b1 in r24, 0x07 ; 710b02: 8c 60 ori r24, 0x0C ; 1210b04: 87 b9 out 0x07, r24 ; 7J16_OFF;10b06: 42 98 cbi 0x08, 2 ; 8J17_OFF;10b08: 43 98 cbi 0x08, 3 ; 8J16Blinkcount = 0; J16Mask = 128;10b0a: 10 92 a1 04 sts 0x04A1, r110b0e: 80 e8 ldi r24, 0x80 ; 12810b10: 80 93 8f 02 sts 0x028F, r24J17Blinkcount = 0; J17Mask = 128;10b14: 10 92 a0 04 sts 0x04A0, r110b18: 80 93 8e 02 sts 0x028E, r2410b1c: 08 95 ret00010b1e <LED_Update>:static unsigned char J16Bitmask = 0;static unsigned char J17Bitmask = 0;static unsigned char J16Warn = 0, J17Warn = 0;static unsigned char from_nc = 0; // Copy for the timingif(FromNC_WP_EventChannel_New) from_nc = FromNC_WP_EventChannel_New;10b1e: 80 91 bd 04 lds r24, 0x04BD10b22: 81 11 cpse r24, r110b24: 80 93 9e 04 sts 0x049E, r24if(!delay--) // 20ms Intervall10b28: 80 91 9d 04 lds r24, 0x049D10b2c: 9f ef ldi r25, 0xFF ; 25510b2e: 98 0f add r25, r2410b30: 90 93 9d 04 sts 0x049D, r2510b34: 81 11 cpse r24, r110b36: 73 c1 rjmp .+742 ; 0x10e1e <LED_Update+0x300>{J16Bitmask = EE_Parameter.J16Bitmask;10b38: 80 91 88 05 lds r24, 0x058810b3c: 80 93 9c 04 sts 0x049C, r24J17Bitmask = EE_Parameter.J17Bitmask;10b40: 80 91 8a 05 lds r24, 0x058A10b44: 80 93 9b 04 sts 0x049B, r24delay = 9;10b48: 89 e0 ldi r24, 0x09 ; 910b4a: 80 93 9d 04 sts 0x049D, r24if(FC_StatusFlags & (FC_STATUS_LOWBAT | FC_STATUS_EMERGENCY_LANDING) || (VersionInfo.HardwareError[1] & FC_ERROR1_I2C))10b4e: 80 91 cb 03 lds r24, 0x03CB10b52: 80 73 andi r24, 0x30 ; 4810b54: 21 f4 brne .+8 ; 0x10b5e <LED_Update+0x40>10b56: 80 91 63 0a lds r24, 0x0A6310b5a: 80 ff sbrs r24, 010b5c: 1d c0 rjmp .+58 ; 0x10b98 <LED_Update+0x7a>{if(EE_Parameter.WARN_J16_Bitmask)10b5e: 80 91 8c 05 lds r24, 0x058C10b62: 88 23 and r24, r2410b64: 51 f0 breq .+20 ; 0x10b7a <LED_Update+0x5c>{if(!J16Warn) J16Blinkcount = 4;10b66: 80 91 9a 04 lds r24, 0x049A10b6a: 81 11 cpse r24, r110b6c: 03 c0 rjmp .+6 ; 0x10b74 <LED_Update+0x56>10b6e: 84 e0 ldi r24, 0x04 ; 410b70: 80 93 a1 04 sts 0x04A1, r24J16Warn = 1;10b74: 81 e0 ldi r24, 0x01 ; 110b76: 80 93 9a 04 sts 0x049A, r24}if(EE_Parameter.WARN_J17_Bitmask)10b7a: 80 91 8d 05 lds r24, 0x058D10b7e: 88 23 and r24, r2410b80: 79 f0 breq .+30 ; 0x10ba0 <LED_Update+0x82>{if(!J17Warn) J17Blinkcount = 4;10b82: 80 91 99 04 lds r24, 0x049910b86: 81 11 cpse r24, r110b88: 03 c0 rjmp .+6 ; 0x10b90 <LED_Update+0x72>10b8a: 84 e0 ldi r24, 0x04 ; 410b8c: 80 93 a0 04 sts 0x04A0, r24J17Warn = 1;10b90: 81 e0 ldi r24, 0x01 ; 110b92: 80 93 99 04 sts 0x0499, r2410b96: 04 c0 rjmp .+8 ; 0x10ba0 <LED_Update+0x82>}}else{J16Warn = 0;10b98: 10 92 9a 04 sts 0x049A, r1J17Warn = 0;10b9c: 10 92 99 04 sts 0x0499, r1}//DebugOut.Analog[29] = EE_Parameter.GlobalConfig3;// Output 1if(!J16Warn)10ba0: 80 91 9a 04 lds r24, 0x049A10ba4: 81 11 cpse r24, r110ba6: 95 c0 rjmp .+298 ; 0x10cd2 <LED_Update+0x1b4>{if((EE_Parameter.BitConfig & CFG_MOTOR_BLINK1) && !MotorenEin) {if(EE_Parameter.BitConfig & CFG_MOTOR_OFF_LED1) J16_ON; else J16_OFF;}10ba8: 80 91 b6 05 lds r24, 0x05B610bac: 84 ff sbrs r24, 410bae: 0a c0 rjmp .+20 ; 0x10bc4 <LED_Update+0xa6>10bb0: 90 91 03 04 lds r25, 0x040310bb4: 91 11 cpse r25, r110bb6: 06 c0 rjmp .+12 ; 0x10bc4 <LED_Update+0xa6>10bb8: 85 ff sbrs r24, 510bba: 02 c0 rjmp .+4 ; 0x10bc0 <LED_Update+0xa2>10bbc: 42 9a sbi 0x08, 2 ; 810bbe: a8 c0 rjmp .+336 ; 0x10d10 <LED_Update+0x1f2>10bc0: 42 98 cbi 0x08, 2 ; 810bc2: a6 c0 rjmp .+332 ; 0x10d10 <LED_Update+0x1f2>elseif((EE_Parameter.J16Timing > 247) && (Parameter_J16Timing > 220)) {if(J16Bitmask & 128) J16_OFF; else J16_ON; J16Mask = 1; NC_Wait_for_LED = 0;} // Manual overwrite10bc4: 80 91 89 05 lds r24, 0x058910bc8: 88 3f cpi r24, 0xF8 ; 24810bca: 00 f1 brcs .+64 ; 0x10c0c <LED_Update+0xee>10bcc: 80 91 3b 06 lds r24, 0x063B10bd0: 8d 3d cpi r24, 0xDD ; 22110bd2: 68 f0 brcs .+26 ; 0x10bee <LED_Update+0xd0>10bd4: 80 91 9c 04 lds r24, 0x049C10bd8: 88 23 and r24, r2410bda: 14 f4 brge .+4 ; 0x10be0 <LED_Update+0xc2>10bdc: 42 98 cbi 0x08, 2 ; 810bde: 01 c0 rjmp .+2 ; 0x10be2 <LED_Update+0xc4>10be0: 42 9a sbi 0x08, 2 ; 810be2: 81 e0 ldi r24, 0x01 ; 110be4: 80 93 8f 02 sts 0x028F, r2410be8: 10 92 9f 04 sts 0x049F, r110bec: 91 c0 rjmp .+290 ; 0x10d10 <LED_Update+0x1f2>elseif((EE_Parameter.J16Timing > 247) && (Parameter_J16Timing == 5)) {if(J16Bitmask & 128) J16_ON; else J16_OFF; J16Mask = 1; NC_Wait_for_LED = 0;} // Manual overwrite10bee: 85 30 cpi r24, 0x05 ; 510bf0: 69 f4 brne .+26 ; 0x10c0c <LED_Update+0xee>10bf2: 80 91 9c 04 lds r24, 0x049C10bf6: 88 23 and r24, r2410bf8: 14 f4 brge .+4 ; 0x10bfe <LED_Update+0xe0>10bfa: 42 9a sbi 0x08, 2 ; 810bfc: 01 c0 rjmp .+2 ; 0x10c00 <LED_Update+0xe2>10bfe: 42 98 cbi 0x08, 2 ; 810c00: 81 e0 ldi r24, 0x01 ; 110c02: 80 93 8f 02 sts 0x028F, r2410c06: 10 92 9f 04 sts 0x049F, r110c0a: 82 c0 rjmp .+260 ; 0x10d10 <LED_Update+0x1f2>elseif(!J16Blinkcount--)10c0c: 80 91 a1 04 lds r24, 0x04A110c10: 9f ef ldi r25, 0xFF ; 25510c12: 98 0f add r25, r2410c14: 90 93 a1 04 sts 0x04A1, r2510c18: 81 11 cpse r24, r110c1a: 7a c0 rjmp .+244 ; 0x10d10 <LED_Update+0x1f2>{if(EE_Parameter.GlobalConfig3 & CFG3_USE_NC_FOR_OUT1)10c1c: 80 91 b9 05 lds r24, 0x05B910c20: 85 ff sbrs r24, 510c22: 39 c0 rjmp .+114 ; 0x10c96 <LED_Update+0x178>{J16Blinkcount = from_nc / 2;10c24: 80 91 9e 04 lds r24, 0x049E10c28: 98 2f mov r25, r2410c2a: 96 95 lsr r2510c2c: 90 93 a1 04 sts 0x04A1, r25if(!from_nc) { NC_Wait_for_LED = 0; if(J16Bitmask & 128) J16_ON; else J16_OFF; J16Mask = 0; } // Ausschalten10c30: 81 11 cpse r24, r110c32: 0c c0 rjmp .+24 ; 0x10c4c <LED_Update+0x12e>10c34: 10 92 9f 04 sts 0x049F, r110c38: 80 91 9c 04 lds r24, 0x049C10c3c: 88 23 and r24, r2410c3e: 14 f4 brge .+4 ; 0x10c44 <LED_Update+0x126>10c40: 42 9a sbi 0x08, 2 ; 810c42: 01 c0 rjmp .+2 ; 0x10c46 <LED_Update+0x128>10c44: 42 98 cbi 0x08, 2 ; 810c46: 10 92 8f 02 sts 0x028F, r110c4a: 62 c0 rjmp .+196 ; 0x10d10 <LED_Update+0x1f2>else{NC_Wait_for_LED = 1;10c4c: 81 e0 ldi r24, 0x01 ; 110c4e: 80 93 9f 04 sts 0x049F, r24if(J16Mask == 0)10c52: 80 91 8f 02 lds r24, 0x028F10c56: 81 11 cpse r24, r110c58: 11 c0 rjmp .+34 ; 0x10c7c <LED_Update+0x15e>{from_nc = FromNC_WP_EventChannel_New;10c5a: 80 91 bd 04 lds r24, 0x04BD10c5e: 80 93 9e 04 sts 0x049E, r24FromNC_WP_EventChannel_New = 0;10c62: 10 92 bd 04 sts 0x04BD, r1J16Mask = 64;10c66: 80 e4 ldi r24, 0x40 ; 6410c68: 80 93 8f 02 sts 0x028F, r24if(J16Bitmask & 128) J16_ON; else J16_OFF; // Ausschalten10c6c: 80 91 9c 04 lds r24, 0x049C10c70: 88 23 and r24, r2410c72: 14 f4 brge .+4 ; 0x10c78 <LED_Update+0x15a>10c74: 42 9a sbi 0x08, 2 ; 810c76: 4c c0 rjmp .+152 ; 0x10d10 <LED_Update+0x1f2>10c78: 42 98 cbi 0x08, 2 ; 810c7a: 4a c0 rjmp .+148 ; 0x10d10 <LED_Update+0x1f2>}else{if(J16Mask & J16Bitmask) J16_ON; else J16_OFF;10c7c: 90 91 9c 04 lds r25, 0x049C10c80: 89 23 and r24, r2510c82: 11 f0 breq .+4 ; 0x10c88 <LED_Update+0x16a>10c84: 42 9a sbi 0x08, 2 ; 810c86: 01 c0 rjmp .+2 ; 0x10c8a <LED_Update+0x16c>10c88: 42 98 cbi 0x08, 2 ; 8J16Mask /= 2;10c8a: 80 91 8f 02 lds r24, 0x028F10c8e: 86 95 lsr r2410c90: 80 93 8f 02 sts 0x028F, r2410c94: 3d c0 rjmp .+122 ; 0x10d10 <LED_Update+0x1f2>}}}else{J16Blinkcount = Parameter_J16Timing / 2;10c96: 80 91 3b 06 lds r24, 0x063B10c9a: 86 95 lsr r2410c9c: 80 93 a1 04 sts 0x04A1, r24if(J16Mask == 1) { from_nc = 0; J16Mask = 64; } else J16Mask /= 2;10ca0: 80 91 8f 02 lds r24, 0x028F10ca4: 81 30 cpi r24, 0x01 ; 110ca6: 31 f4 brne .+12 ; 0x10cb4 <LED_Update+0x196>10ca8: 10 92 9e 04 sts 0x049E, r110cac: 80 e4 ldi r24, 0x40 ; 6410cae: 80 93 8f 02 sts 0x028F, r2410cb2: 03 c0 rjmp .+6 ; 0x10cba <LED_Update+0x19c>10cb4: 86 95 lsr r2410cb6: 80 93 8f 02 sts 0x028F, r24if(J16Mask & J16Bitmask) J16_ON; else J16_OFF;10cba: 90 91 9c 04 lds r25, 0x049C10cbe: 80 91 8f 02 lds r24, 0x028F10cc2: 89 23 and r24, r2510cc4: 11 f0 breq .+4 ; 0x10cca <LED_Update+0x1ac>10cc6: 42 9a sbi 0x08, 2 ; 810cc8: 01 c0 rjmp .+2 ; 0x10ccc <LED_Update+0x1ae>10cca: 42 98 cbi 0x08, 2 ; 8NC_Wait_for_LED = 0;10ccc: 10 92 9f 04 sts 0x049F, r110cd0: 1f c0 rjmp .+62 ; 0x10d10 <LED_Update+0x1f2>}}}else // warning caseif(!J16Blinkcount--)10cd2: 80 91 a1 04 lds r24, 0x04A110cd6: 88 23 and r24, r2410cd8: 21 f0 breq .+8 ; 0x10ce2 <LED_Update+0x1c4>10cda: 81 50 subi r24, 0x01 ; 110cdc: 80 93 a1 04 sts 0x04A1, r2410ce0: 17 c0 rjmp .+46 ; 0x10d10 <LED_Update+0x1f2>{J16Blinkcount = 10-1;10ce2: 89 e0 ldi r24, 0x09 ; 910ce4: 80 93 a1 04 sts 0x04A1, r24if(J16Mask == 1) J16Mask = 128; else J16Mask /= 2;10ce8: 80 91 8f 02 lds r24, 0x028F10cec: 81 30 cpi r24, 0x01 ; 110cee: 21 f4 brne .+8 ; 0x10cf8 <LED_Update+0x1da>10cf0: 80 e8 ldi r24, 0x80 ; 12810cf2: 80 93 8f 02 sts 0x028F, r2410cf6: 03 c0 rjmp .+6 ; 0x10cfe <LED_Update+0x1e0>10cf8: 86 95 lsr r2410cfa: 80 93 8f 02 sts 0x028F, r24if(J16Mask & EE_Parameter.WARN_J16_Bitmask) J16_ON; else J16_OFF;10cfe: 90 91 8f 02 lds r25, 0x028F10d02: 80 91 8c 05 lds r24, 0x058C10d06: 89 23 and r24, r2510d08: 11 f0 breq .+4 ; 0x10d0e <LED_Update+0x1f0>10d0a: 42 9a sbi 0x08, 2 ; 810d0c: 01 c0 rjmp .+2 ; 0x10d10 <LED_Update+0x1f2>10d0e: 42 98 cbi 0x08, 2 ; 8}// Output 2if(!J17Warn)10d10: 80 91 99 04 lds r24, 0x049910d14: 81 11 cpse r24, r110d16: 50 c0 rjmp .+160 ; 0x10db8 <LED_Update+0x29a>{if((EE_Parameter.BitConfig & CFG_MOTOR_BLINK2) && !MotorenEin) {if(EE_Parameter.BitConfig & CFG_MOTOR_OFF_LED2) J17_ON; else J17_OFF;}10d18: 80 91 b6 05 lds r24, 0x05B610d1c: 88 23 and r24, r2410d1e: 54 f4 brge .+20 ; 0x10d34 <LED_Update+0x216>10d20: 90 91 03 04 lds r25, 0x040310d24: 91 11 cpse r25, r110d26: 06 c0 rjmp .+12 ; 0x10d34 <LED_Update+0x216>10d28: 86 ff sbrs r24, 610d2a: 02 c0 rjmp .+4 ; 0x10d30 <LED_Update+0x212>10d2c: 43 9a sbi 0x08, 3 ; 810d2e: 63 c0 rjmp .+198 ; 0x10df6 <LED_Update+0x2d8>10d30: 43 98 cbi 0x08, 3 ; 810d32: 61 c0 rjmp .+194 ; 0x10df6 <LED_Update+0x2d8>elseif((EE_Parameter.J17Timing > 247) && (Parameter_J17Timing > 220)) {if(J17Bitmask & 128) J17_OFF; else J17_ON; J17Mask = 1;}10d34: 80 91 8b 05 lds r24, 0x058B10d38: 88 3f cpi r24, 0xF8 ; 24810d3a: e0 f0 brcs .+56 ; 0x10d74 <LED_Update+0x256>10d3c: 80 91 63 06 lds r24, 0x066310d40: 8d 3d cpi r24, 0xDD ; 22110d42: 58 f0 brcs .+22 ; 0x10d5a <LED_Update+0x23c>10d44: 80 91 9b 04 lds r24, 0x049B10d48: 88 23 and r24, r2410d4a: 14 f4 brge .+4 ; 0x10d50 <LED_Update+0x232>10d4c: 43 98 cbi 0x08, 3 ; 810d4e: 01 c0 rjmp .+2 ; 0x10d52 <LED_Update+0x234>10d50: 43 9a sbi 0x08, 3 ; 810d52: 81 e0 ldi r24, 0x01 ; 110d54: 80 93 8e 02 sts 0x028E, r2410d58: 4e c0 rjmp .+156 ; 0x10df6 <LED_Update+0x2d8>elseif((EE_Parameter.J17Timing > 247) && (Parameter_J17Timing == 5)) {if(J17Bitmask & 128) J17_ON; else J17_OFF; J17Mask = 1;}10d5a: 85 30 cpi r24, 0x05 ; 510d5c: 59 f4 brne .+22 ; 0x10d74 <LED_Update+0x256>10d5e: 80 91 9b 04 lds r24, 0x049B10d62: 88 23 and r24, r2410d64: 14 f4 brge .+4 ; 0x10d6a <LED_Update+0x24c>10d66: 43 9a sbi 0x08, 3 ; 810d68: 01 c0 rjmp .+2 ; 0x10d6c <LED_Update+0x24e>10d6a: 43 98 cbi 0x08, 3 ; 810d6c: 81 e0 ldi r24, 0x01 ; 110d6e: 80 93 8e 02 sts 0x028E, r2410d72: 41 c0 rjmp .+130 ; 0x10df6 <LED_Update+0x2d8>elseif(!J17Blinkcount--)10d74: 80 91 a0 04 lds r24, 0x04A010d78: 9f ef ldi r25, 0xFF ; 25510d7a: 98 0f add r25, r2410d7c: 90 93 a0 04 sts 0x04A0, r2510d80: 81 11 cpse r24, r110d82: 39 c0 rjmp .+114 ; 0x10df6 <LED_Update+0x2d8>{J17Blinkcount = Parameter_J17Timing / 2;10d84: 80 91 63 06 lds r24, 0x066310d88: 86 95 lsr r2410d8a: 80 93 a0 04 sts 0x04A0, r24if(J17Mask == 1) J17Mask = 64; else J17Mask /= 2;10d8e: 80 91 8e 02 lds r24, 0x028E10d92: 81 30 cpi r24, 0x01 ; 110d94: 21 f4 brne .+8 ; 0x10d9e <LED_Update+0x280>10d96: 80 e4 ldi r24, 0x40 ; 6410d98: 80 93 8e 02 sts 0x028E, r2410d9c: 03 c0 rjmp .+6 ; 0x10da4 <LED_Update+0x286>10d9e: 86 95 lsr r2410da0: 80 93 8e 02 sts 0x028E, r24if(J17Mask & J17Bitmask) J17_ON; else J17_OFF;10da4: 90 91 9b 04 lds r25, 0x049B10da8: 80 91 8e 02 lds r24, 0x028E10dac: 89 23 and r24, r2510dae: 11 f0 breq .+4 ; 0x10db4 <LED_Update+0x296>10db0: 43 9a sbi 0x08, 3 ; 810db2: 21 c0 rjmp .+66 ; 0x10df6 <LED_Update+0x2d8>10db4: 43 98 cbi 0x08, 3 ; 810db6: 1f c0 rjmp .+62 ; 0x10df6 <LED_Update+0x2d8>}}else // warning caseif(!J17Blinkcount--)10db8: 80 91 a0 04 lds r24, 0x04A010dbc: 88 23 and r24, r2410dbe: 21 f0 breq .+8 ; 0x10dc8 <LED_Update+0x2aa>10dc0: 81 50 subi r24, 0x01 ; 110dc2: 80 93 a0 04 sts 0x04A0, r2410dc6: 17 c0 rjmp .+46 ; 0x10df6 <LED_Update+0x2d8>{J17Blinkcount = 10-1;10dc8: 89 e0 ldi r24, 0x09 ; 910dca: 80 93 a0 04 sts 0x04A0, r24if(J17Mask == 1) J17Mask = 128; else J17Mask /= 2;10dce: 80 91 8e 02 lds r24, 0x028E10dd2: 81 30 cpi r24, 0x01 ; 110dd4: 21 f4 brne .+8 ; 0x10dde <LED_Update+0x2c0>10dd6: 80 e8 ldi r24, 0x80 ; 12810dd8: 80 93 8e 02 sts 0x028E, r2410ddc: 03 c0 rjmp .+6 ; 0x10de4 <LED_Update+0x2c6>10dde: 86 95 lsr r2410de0: 80 93 8e 02 sts 0x028E, r24if(J17Mask & EE_Parameter.WARN_J17_Bitmask) J17_ON; else J17_OFF;10de4: 90 91 8e 02 lds r25, 0x028E10de8: 80 91 8d 05 lds r24, 0x058D10dec: 89 23 and r24, r2510dee: 11 f0 breq .+4 ; 0x10df4 <LED_Update+0x2d6>10df0: 43 9a sbi 0x08, 3 ; 810df2: 01 c0 rjmp .+2 ; 0x10df6 <LED_Update+0x2d8>10df4: 43 98 cbi 0x08, 3 ; 8}if(PORTC & (1<<PORTC2)) FC_StatusFlags2 |= FC_STATUS2_OUT1_ACTIVE; //else FC_StatusFlags2 &= ~FC_STATUS2_OUT1_ACTIVE; // Out1 (J16) -> wird in der SPI zurück gesetzt10df6: 42 9b sbis 0x08, 2 ; 810df8: 05 c0 rjmp .+10 ; 0x10e04 <LED_Update+0x2e6>10dfa: 80 91 ca 03 lds r24, 0x03CA10dfe: 88 60 ori r24, 0x08 ; 810e00: 80 93 ca 03 sts 0x03CA, r24if(PORTC & (1<<PORTC3)) FC_StatusFlags2 |= FC_STATUS2_OUT2_ACTIVE; else FC_StatusFlags2 &= ~FC_STATUS2_OUT2_ACTIVE; // Out2 (J17)10e04: 43 9b sbis 0x08, 3 ; 810e06: 06 c0 rjmp .+12 ; 0x10e14 <LED_Update+0x2f6>10e08: 80 91 ca 03 lds r24, 0x03CA10e0c: 80 61 ori r24, 0x10 ; 1610e0e: 80 93 ca 03 sts 0x03CA, r2410e12: 08 95 ret10e14: 80 91 ca 03 lds r24, 0x03CA10e18: 8f 7e andi r24, 0xEF ; 23910e1a: 80 93 ca 03 sts 0x03CA, r2410e1e: 08 95 ret00010e20 <Menu_Putchar>:for(i=0;i<80;i++) DisplayBuff[i] = ' ';}void Menu_Putchar(char c){if(DispPtr < 80) DisplayBuff[DispPtr++] = c;10e20: e0 91 a4 04 lds r30, 0x04A410e24: e0 35 cpi r30, 0x50 ; 8010e26: 40 f4 brcc .+16 ; 0x10e38 <Menu_Putchar+0x18>10e28: 91 e0 ldi r25, 0x01 ; 110e2a: 9e 0f add r25, r3010e2c: 90 93 a4 04 sts 0x04A4, r2510e30: f0 e0 ldi r31, 0x00 ; 010e32: e0 52 subi r30, 0x20 ; 3210e34: f8 4f sbci r31, 0xF8 ; 24810e36: 80 83 st Z, r2410e38: 08 95 ret00010e3a <LcdClear>:#define KEY3 0x04#define KEY4 0x08#define KEY5 0x10void LcdClear(void){10e3a: e0 ee ldi r30, 0xE0 ; 22410e3c: f7 e0 ldi r31, 0x07 ; 710e3e: 80 e3 ldi r24, 0x30 ; 4810e40: 98 e0 ldi r25, 0x08 ; 8unsigned char i;for(i=0;i<80;i++) DisplayBuff[i] = ' ';10e42: 20 e2 ldi r18, 0x20 ; 3210e44: 21 93 st Z+, r1810e46: e8 17 cp r30, r2410e48: f9 07 cpc r31, r2510e4a: e1 f7 brne .-8 ; 0x10e44 <LcdClear+0xa>}10e4c: 08 95 ret00010e4e <Menu>:{if(DispPtr < 80) DisplayBuff[DispPtr++] = c;}void Menu(void){10e4e: 2f 92 push r210e50: 3f 92 push r310e52: 5f 92 push r510e54: 6f 92 push r610e56: 7f 92 push r710e58: 8f 92 push r810e5a: 9f 92 push r910e5c: af 92 push r1010e5e: bf 92 push r1110e60: cf 92 push r1210e62: df 92 push r1310e64: ef 92 push r1410e66: ff 92 push r1510e68: 0f 93 push r1610e6a: 1f 93 push r1710e6c: cf 93 push r2810e6e: df 93 push r29unsigned char i;if(RemoteKeys & KEY1) { if(MenuePunkt) MenuePunkt--; else MenuePunkt = MaxMenue;}10e70: 80 91 a2 04 lds r24, 0x04A210e74: 80 ff sbrs r24, 010e76: 0c c0 rjmp .+24 ; 0x10e90 <Menu+0x42>10e78: 90 91 a3 04 lds r25, 0x04A310e7c: 99 23 and r25, r2510e7e: 21 f0 breq .+8 ; 0x10e88 <Menu+0x3a>10e80: 91 50 subi r25, 0x01 ; 110e82: 90 93 a3 04 sts 0x04A3, r2510e86: 04 c0 rjmp .+8 ; 0x10e90 <Menu+0x42>10e88: 90 91 90 02 lds r25, 0x029010e8c: 90 93 a3 04 sts 0x04A3, r25if(RemoteKeys & KEY2) { if(MenuePunkt == MaxMenue) MenuePunkt = 0; else MenuePunkt++;}10e90: 81 ff sbrs r24, 110e92: 0c c0 rjmp .+24 ; 0x10eac <Menu+0x5e>10e94: 90 91 a3 04 lds r25, 0x04A310e98: 20 91 90 02 lds r18, 0x029010e9c: 92 13 cpse r25, r1810e9e: 03 c0 rjmp .+6 ; 0x10ea6 <Menu+0x58>10ea0: 10 92 a3 04 sts 0x04A3, r110ea4: 03 c0 rjmp .+6 ; 0x10eac <Menu+0x5e>10ea6: 9f 5f subi r25, 0xFF ; 25510ea8: 90 93 a3 04 sts 0x04A3, r2510eac: 83 70 andi r24, 0x03 ; 3if((RemoteKeys & KEY1) && (RemoteKeys & KEY2)) MenuePunkt = 0;10eae: 83 30 cpi r24, 0x03 ; 310eb0: 11 f4 brne .+4 ; 0x10eb6 <Menu+0x68>10eb2: 10 92 a3 04 sts 0x04A3, r1LcdClear();10eb6: c1 df rcall .-126 ; 0x10e3a <LcdClear>if(MenuePunkt < 10) {LCD_printfxy(17,0,"[%i]",MenuePunkt);}10eb8: 80 91 a3 04 lds r24, 0x04A310ebc: 8a 30 cpi r24, 0x0A ; 1010ebe: c8 f4 brcc .+50 ; 0x10ef2 <Menu+0xa4>10ec0: 91 e1 ldi r25, 0x11 ; 1710ec2: 90 93 a4 04 sts 0x04A4, r2510ec6: 1f 92 push r110ec8: 8f 93 push r2410eca: 86 e5 ldi r24, 0x56 ; 8610ecc: 95 e1 ldi r25, 0x15 ; 2110ece: 9f 93 push r2510ed0: 8f 93 push r2410ed2: 80 e1 ldi r24, 0x10 ; 1610ed4: 97 e8 ldi r25, 0x87 ; 13510ed6: 9f 93 push r2510ed8: 8f 93 push r2410eda: e0 91 78 06 lds r30, 0x067810ede: f0 91 79 06 lds r31, 0x067910ee2: 09 95 icall10ee4: 0f 90 pop r010ee6: 0f 90 pop r010ee8: 0f 90 pop r010eea: 0f 90 pop r010eec: 0f 90 pop r010eee: 0f 90 pop r010ef0: 18 c0 rjmp .+48 ; 0x10f22 <Menu+0xd4>else {LCD_printfxy(16,0,"[%i]",MenuePunkt);};10ef2: 90 e1 ldi r25, 0x10 ; 1610ef4: 90 93 a4 04 sts 0x04A4, r2510ef8: 1f 92 push r110efa: 8f 93 push r2410efc: 81 e5 ldi r24, 0x51 ; 8110efe: 95 e1 ldi r25, 0x15 ; 2110f00: 9f 93 push r2510f02: 8f 93 push r2410f04: 80 e1 ldi r24, 0x10 ; 1610f06: 97 e8 ldi r25, 0x87 ; 13510f08: 9f 93 push r2510f0a: 8f 93 push r2410f0c: e0 91 78 06 lds r30, 0x067810f10: f0 91 79 06 lds r31, 0x067910f14: 09 95 icall10f16: 0f 90 pop r010f18: 0f 90 pop r010f1a: 0f 90 pop r010f1c: 0f 90 pop r010f1e: 0f 90 pop r010f20: 0f 90 pop r0switch(MenuePunkt)10f22: 20 91 a3 04 lds r18, 0x04A310f26: 82 2f mov r24, r1810f28: 90 e0 ldi r25, 0x00 ; 010f2a: 84 31 cpi r24, 0x14 ; 2010f2c: 91 05 cpc r25, r110f2e: 10 f0 brcs .+4 ; 0x10f34 <Menu+0xe6>10f30: 0c 94 10 91 jmp 0x12220 ; 0x12220 <Menu+0x13d2>10f34: fc 01 movw r30, r2410f36: ee 56 subi r30, 0x6E ; 11010f38: ff 4f sbci r31, 0xFF ; 25510f3a: 0c 94 a7 b1 jmp 0x1634e ; 0x1634e <__tablejump2__>{case 0:LCD_printfxy(0,0,"+ MikroKopter +");10f3e: 10 92 a4 04 sts 0x04A4, r110f42: 81 e4 ldi r24, 0x41 ; 6510f44: 95 e1 ldi r25, 0x15 ; 2110f46: 9f 93 push r2510f48: 8f 93 push r2410f4a: c0 e1 ldi r28, 0x10 ; 1610f4c: d7 e8 ldi r29, 0x87 ; 13510f4e: df 93 push r2910f50: cf 93 push r2810f52: e0 91 78 06 lds r30, 0x067810f56: f0 91 79 06 lds r31, 0x067910f5a: 09 95 icallLCD_printfxy(0,1,"HW:V%d.%d SW:%d.%02d%c ",PlatinenVersion/10,PlatinenVersion%10, VERSION_MAJOR, VERSION_MINOR, VERSION_PATCH +'a');10f5c: 84 e1 ldi r24, 0x14 ; 2010f5e: 80 93 a4 04 sts 0x04A4, r2410f62: 90 91 54 01 lds r25, 0x015410f66: 1f 92 push r110f68: 81 e6 ldi r24, 0x61 ; 9710f6a: 8f 93 push r2410f6c: 1f 92 push r110f6e: 88 e0 ldi r24, 0x08 ; 810f70: 8f 93 push r2410f72: 1f 92 push r110f74: 82 e0 ldi r24, 0x02 ; 210f76: 8f 93 push r2410f78: 8d ec ldi r24, 0xCD ; 20510f7a: 98 9f mul r25, r2410f7c: 81 2d mov r24, r110f7e: 11 24 eor r1, r110f80: 86 95 lsr r2410f82: 86 95 lsr r2410f84: 86 95 lsr r2410f86: 28 2f mov r18, r2410f88: 22 0f add r18, r1810f8a: 32 2f mov r19, r1810f8c: 33 0f add r19, r1910f8e: 33 0f add r19, r1910f90: 23 0f add r18, r1910f92: 92 1b sub r25, r1810f94: 1f 92 push r110f96: 9f 93 push r2510f98: 1f 92 push r110f9a: 8f 93 push r2410f9c: 89 e2 ldi r24, 0x29 ; 4110f9e: 95 e1 ldi r25, 0x15 ; 2110fa0: 9f 93 push r2510fa2: 8f 93 push r2410fa4: df 93 push r2910fa6: cf 93 push r2810fa8: e0 91 78 06 lds r30, 0x067810fac: f0 91 79 06 lds r31, 0x067910fb0: 09 95 icallLCD_printfxy(0,2,"Set:%d %s", ActiveParamSet,Mixer.Name);10fb2: 88 e2 ldi r24, 0x28 ; 4010fb4: 80 93 a4 04 sts 0x04A4, r2410fb8: 88 ec ldi r24, 0xC8 ; 20010fba: 95 e0 ldi r25, 0x05 ; 510fbc: 9f 93 push r2510fbe: 8f 93 push r2410fc0: 80 91 52 01 lds r24, 0x015210fc4: 1f 92 push r110fc6: 8f 93 push r2410fc8: 8f e1 ldi r24, 0x1F ; 3110fca: 95 e1 ldi r25, 0x15 ; 2110fcc: 9f 93 push r2510fce: 8f 93 push r2410fd0: df 93 push r2910fd2: cf 93 push r2810fd4: e0 91 78 06 lds r30, 0x067810fd8: f0 91 79 06 lds r31, 0x067910fdc: 09 95 icallif(FC_StatusFlags3 & FC_STATUS3_BOAT) LCD_printfxy(16,2,"BOAT");10fde: 80 91 c9 03 lds r24, 0x03C910fe2: 2d b7 in r18, 0x3d ; 6110fe4: 3e b7 in r19, 0x3e ; 6210fe6: 26 5e subi r18, 0xE6 ; 23010fe8: 3f 4f sbci r19, 0xFF ; 25510fea: 0f b6 in r0, 0x3f ; 6310fec: f8 94 cli10fee: 3e bf out 0x3e, r19 ; 6210ff0: 0f be out 0x3f, r0 ; 6310ff2: 2d bf out 0x3d, r18 ; 6110ff4: 81 ff sbrs r24, 110ff6: 13 c0 rjmp .+38 ; 0x1101e <Menu+0x1d0>10ff8: 88 e3 ldi r24, 0x38 ; 5610ffa: 80 93 a4 04 sts 0x04A4, r2410ffe: 8a e1 ldi r24, 0x1A ; 2611000: 95 e1 ldi r25, 0x15 ; 2111002: 9f 93 push r2511004: 8f 93 push r2411006: ce 01 movw r24, r2811008: 9f 93 push r251100a: cf 93 push r281100c: e0 91 78 06 lds r30, 0x067811010: f0 91 79 06 lds r31, 0x067911014: 09 95 icall11016: 0f 90 pop r011018: 0f 90 pop r01101a: 0f 90 pop r01101c: 0f 90 pop r0if(VersionInfo.HardwareError[1] & FC_ERROR1_MIXER) LCD_printfxy(0,3,"Mixer Error!")1101e: 80 91 63 0a lds r24, 0x0A6311022: 84 ff sbrs r24, 411024: 16 c0 rjmp .+44 ; 0x11052 <Menu+0x204>11026: 8c e3 ldi r24, 0x3C ; 6011028: 80 93 a4 04 sts 0x04A4, r241102c: 8d e0 ldi r24, 0x0D ; 131102e: 95 e1 ldi r25, 0x15 ; 2111030: 9f 93 push r2511032: 8f 93 push r2411034: 80 e1 ldi r24, 0x10 ; 1611036: 97 e8 ldi r25, 0x87 ; 13511038: 9f 93 push r251103a: 8f 93 push r241103c: e0 91 78 06 lds r30, 0x067811040: f0 91 79 06 lds r31, 0x067911044: 09 95 icall11046: 0f 90 pop r011048: 0f 90 pop r01104a: 0f 90 pop r01104c: 0f 90 pop r01104e: 0c 94 19 91 jmp 0x12232 ; 0x12232 <Menu+0x13e4>else#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))if(NC_ErrorCode)11052: 80 91 bb 04 lds r24, 0x04BB11056: 88 23 and r24, r2411058: 79 f1 breq .+94 ; 0x110b8 <Menu+0x26a>{LCD_printfxy(0,3,"ERR%2d:",NC_ErrorCode);1105a: 9c e3 ldi r25, 0x3C ; 601105c: 90 93 a4 04 sts 0x04A4, r2511060: 1f 92 push r111062: 8f 93 push r2411064: 85 e0 ldi r24, 0x05 ; 511066: 95 e1 ldi r25, 0x15 ; 2111068: 9f 93 push r251106a: 8f 93 push r241106c: c0 e1 ldi r28, 0x10 ; 161106e: d7 e8 ldi r29, 0x87 ; 13511070: df 93 push r2911072: cf 93 push r2811074: e0 91 78 06 lds r30, 0x067811078: f0 91 79 06 lds r31, 0x06791107c: 09 95 icall_printf_P(&Menu_Putchar, NC_ERROR_TEXT[NC_ErrorCode] , 0);1107e: 1f 92 push r111080: 1f 92 push r111082: 80 91 bb 04 lds r24, 0x04BB11086: e1 e1 ldi r30, 0x11 ; 1711088: 8e 9f mul r24, r301108a: c0 01 movw r24, r01108c: 11 24 eor r1, r11108e: 84 59 subi r24, 0x94 ; 14811090: 94 4f sbci r25, 0xF4 ; 24411092: 9f 93 push r2511094: 8f 93 push r2411096: df 93 push r2911098: cf 93 push r281109a: e0 91 78 06 lds r30, 0x06781109e: f0 91 79 06 lds r31, 0x0679110a2: 09 95 icall110a4: 8d b7 in r24, 0x3d ; 61110a6: 9e b7 in r25, 0x3e ; 62110a8: 0c 96 adiw r24, 0x0c ; 12110aa: 0f b6 in r0, 0x3f ; 63110ac: f8 94 cli110ae: 9e bf out 0x3e, r25 ; 62110b0: 0f be out 0x3f, r0 ; 63110b2: 8d bf out 0x3d, r24 ; 61110b4: 0c 94 19 91 jmp 0x12232 ; 0x12232 <Menu+0x13e4>}else#endifif(VersionInfo.HardwareError[0]) LCD_printfxy(0,3,"Hardware Error 1:%d !!",VersionInfo.HardwareError[0])110b8: 80 91 62 0a lds r24, 0x0A62110bc: 88 23 and r24, r24110be: d1 f0 breq .+52 ; 0x110f4 <Menu+0x2a6>110c0: 9c e3 ldi r25, 0x3C ; 60110c2: 90 93 a4 04 sts 0x04A4, r25110c6: 1f 92 push r1110c8: 8f 93 push r24110ca: 8e ee ldi r24, 0xEE ; 238110cc: 94 e1 ldi r25, 0x14 ; 20110ce: 9f 93 push r25110d0: 8f 93 push r24110d2: 80 e1 ldi r24, 0x10 ; 16110d4: 97 e8 ldi r25, 0x87 ; 135110d6: 9f 93 push r25110d8: 8f 93 push r24110da: e0 91 78 06 lds r30, 0x0678110de: f0 91 79 06 lds r31, 0x0679110e2: 09 95 icall110e4: 0f 90 pop r0110e6: 0f 90 pop r0110e8: 0f 90 pop r0110ea: 0f 90 pop r0110ec: 0f 90 pop r0110ee: 0f 90 pop r0110f0: 0c 94 19 91 jmp 0x12232 ; 0x12232 <Menu+0x13e4>elseif(MissingMotor) LCD_printfxy(0,3,"Missing BL-Ctrl:%d !!",MissingMotor)110f4: 80 91 df 04 lds r24, 0x04DF110f8: 88 23 and r24, r24110fa: d1 f0 breq .+52 ; 0x11130 <Menu+0x2e2>110fc: 9c e3 ldi r25, 0x3C ; 60110fe: 90 93 a4 04 sts 0x04A4, r2511102: 1f 92 push r111104: 8f 93 push r2411106: 88 ed ldi r24, 0xD8 ; 21611108: 94 e1 ldi r25, 0x14 ; 201110a: 9f 93 push r251110c: 8f 93 push r241110e: 80 e1 ldi r24, 0x10 ; 1611110: 97 e8 ldi r25, 0x87 ; 13511112: 9f 93 push r2511114: 8f 93 push r2411116: e0 91 78 06 lds r30, 0x06781111a: f0 91 79 06 lds r31, 0x06791111e: 09 95 icall11120: 0f 90 pop r011122: 0f 90 pop r011124: 0f 90 pop r011126: 0f 90 pop r011128: 0f 90 pop r01112a: 0f 90 pop r01112c: 0c 94 19 91 jmp 0x12232 ; 0x12232 <Menu+0x13e4>LCD_printfxy(0,3,"! NC-ERR: %2d ! ",NC_ErrorCode);}#endif// if(VersionInfo.HardwareError[1]) LCD_printfxy(0,3,"Error 2:%d !!",VersionInfo.HardwareError[1])elseif(I2CTimeout < 6) LCD_printfxy(0,3,"I2C ERROR!!!")11130: 80 91 b0 02 lds r24, 0x02B011134: 90 91 b1 02 lds r25, 0x02B111138: 06 97 sbiw r24, 0x06 ; 61113a: b0 f4 brcc .+44 ; 0x11168 <Menu+0x31a>1113c: 8c e3 ldi r24, 0x3C ; 601113e: 80 93 a4 04 sts 0x04A4, r2411142: 8b ec ldi r24, 0xCB ; 20311144: 94 e1 ldi r25, 0x14 ; 2011146: 9f 93 push r2511148: 8f 93 push r241114a: 80 e1 ldi r24, 0x10 ; 161114c: 97 e8 ldi r25, 0x87 ; 1351114e: 9f 93 push r2511150: 8f 93 push r2411152: e0 91 78 06 lds r30, 0x067811156: f0 91 79 06 lds r31, 0x06791115a: 09 95 icall1115c: 0f 90 pop r01115e: 0f 90 pop r011160: 0f 90 pop r011162: 0f 90 pop r011164: 0c 94 19 91 jmp 0x12232 ; 0x12232 <Menu+0x13e4>elseif(Capacity.MinOfMaxPWM < 30) LCD_printfxy(0,3,"BL-Selftest Err:%2d",Capacity.MinOfMaxPWM)11168: 80 91 1b 05 lds r24, 0x051B1116c: 8e 31 cpi r24, 0x1E ; 301116e: 10 f0 brcs .+4 ; 0x11174 <Menu+0x326>11170: 0c 94 19 91 jmp 0x12232 ; 0x12232 <Menu+0x13e4>11174: 9c e3 ldi r25, 0x3C ; 6011176: 90 93 a4 04 sts 0x04A4, r251117a: 1f 92 push r11117c: 8f 93 push r241117e: 87 eb ldi r24, 0xB7 ; 18311180: 94 e1 ldi r25, 0x14 ; 2011182: 9f 93 push r2511184: 8f 93 push r2411186: 80 e1 ldi r24, 0x10 ; 1611188: 97 e8 ldi r25, 0x87 ; 1351118a: 9f 93 push r251118c: 8f 93 push r241118e: e0 91 78 06 lds r30, 0x067811192: f0 91 79 06 lds r31, 0x067911196: 09 95 icall11198: 0f 90 pop r01119a: 0f 90 pop r01119c: 0f 90 pop r01119e: 0f 90 pop r0111a0: 0f 90 pop r0111a2: 0f 90 pop r0111a4: 0c 94 19 91 jmp 0x12232 ; 0x12232 <Menu+0x13e4>break;case 1:LCD_printfxy(0,0,"Height: %5i",(int)(HoehenWert/5));111a8: 10 92 a4 04 sts 0x04A4, r1111ac: 60 91 fe 03 lds r22, 0x03FE111b0: 70 91 ff 03 lds r23, 0x03FF111b4: 80 91 00 04 lds r24, 0x0400111b8: 90 91 01 04 lds r25, 0x0401111bc: 0f 2e mov r0, r31111be: f5 e0 ldi r31, 0x05 ; 5111c0: cf 2e mov r12, r31111c2: d1 2c mov r13, r1111c4: e1 2c mov r14, r1111c6: f1 2c mov r15, r1111c8: f0 2d mov r31, r0111ca: a7 01 movw r20, r14111cc: 96 01 movw r18, r12111ce: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>111d2: 3f 93 push r19111d4: 2f 93 push r18111d6: 8a ea ldi r24, 0xAA ; 170111d8: 94 e1 ldi r25, 0x14 ; 20111da: 9f 93 push r25111dc: 8f 93 push r24111de: c0 e1 ldi r28, 0x10 ; 16111e0: d7 e8 ldi r29, 0x87 ; 135111e2: df 93 push r29111e4: cf 93 push r28111e6: e0 91 78 06 lds r30, 0x0678111ea: f0 91 79 06 lds r31, 0x0679111ee: 09 95 icallLCD_printfxy(0,1,"Setpoint:%5i",(int)(SollHoehe/5));111f0: 84 e1 ldi r24, 0x14 ; 20111f2: 80 93 a4 04 sts 0x04A4, r24111f6: 60 91 fa 03 lds r22, 0x03FA111fa: 70 91 fb 03 lds r23, 0x03FB111fe: 80 91 fc 03 lds r24, 0x03FC11202: 90 91 fd 03 lds r25, 0x03FD11206: a7 01 movw r20, r1411208: 96 01 movw r18, r121120a: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>1120e: 3f 93 push r1911210: 2f 93 push r1811212: 8d e9 ldi r24, 0x9D ; 15711214: 94 e1 ldi r25, 0x14 ; 2011216: 9f 93 push r2511218: 8f 93 push r241121a: df 93 push r291121c: cf 93 push r281121e: e0 91 78 06 lds r30, 0x067811222: f0 91 79 06 lds r31, 0x067911226: 09 95 icallLCD_printfxy(0,2,"Pressure:%5i",MessLuftdruck);11228: 88 e2 ldi r24, 0x28 ; 401122a: 80 93 a4 04 sts 0x04A4, r241122e: 80 91 10 01 lds r24, 0x011011232: 90 91 11 01 lds r25, 0x011111236: 9f 93 push r2511238: 8f 93 push r241123a: 80 e9 ldi r24, 0x90 ; 1441123c: 94 e1 ldi r25, 0x14 ; 201123e: 9f 93 push r2511240: 8f 93 push r2411242: df 93 push r2911244: cf 93 push r2811246: e0 91 78 06 lds r30, 0x06781124a: f0 91 79 06 lds r31, 0x06791124e: 09 95 icallLCD_printfxy(0,3,"Offset: %5i",OCR0A);11250: 8c e3 ldi r24, 0x3C ; 6011252: 80 93 a4 04 sts 0x04A4, r2411256: 87 b5 in r24, 0x27 ; 3911258: 1f 92 push r11125a: 8f 93 push r241125c: 83 e8 ldi r24, 0x83 ; 1311125e: 94 e1 ldi r25, 0x14 ; 2011260: 9f 93 push r2511262: 8f 93 push r2411264: df 93 push r2911266: cf 93 push r2811268: e0 91 78 06 lds r30, 0x06781126c: f0 91 79 06 lds r31, 0x067911270: 09 95 icall#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))if(ACC_AltitudeControl)11272: 2d b7 in r18, 0x3d ; 6111274: 3e b7 in r19, 0x3e ; 6211276: 28 5e subi r18, 0xE8 ; 23211278: 3f 4f sbci r19, 0xFF ; 2551127a: 0f b6 in r0, 0x3f ; 631127c: f8 94 cli1127e: 3e bf out 0x3e, r19 ; 6211280: 0f be out 0x3f, r0 ; 6311282: 2d bf out 0x3d, r18 ; 6111284: 80 91 c2 03 lds r24, 0x03C211288: 88 23 and r24, r241128a: 09 f4 brne .+2 ; 0x1128e <Menu+0x440>1128c: d2 c7 rjmp .+4004 ; 0x12232 <Menu+0x13e4>{LCD_printfxy(17,2,"(A)");1128e: 89 e3 ldi r24, 0x39 ; 5711290: 80 93 a4 04 sts 0x04A4, r2411294: 8f e7 ldi r24, 0x7F ; 12711296: 94 e1 ldi r25, 0x14 ; 2011298: 9f 93 push r251129a: 8f 93 push r241129c: df 93 push r291129e: cf 93 push r28112a0: e0 91 78 06 lds r30, 0x0678112a4: f0 91 79 06 lds r31, 0x0679112a8: 09 95 icallLCD_printfxy(17,3,"%i",CalAthmospheare);112aa: 8d e4 ldi r24, 0x4D ; 77112ac: 80 93 a4 04 sts 0x04A4, r24112b0: 80 91 0c 01 lds r24, 0x010C112b4: 1f 92 push r1112b6: 8f 93 push r24112b8: 8c e7 ldi r24, 0x7C ; 124112ba: 94 e1 ldi r25, 0x14 ; 20112bc: 9f 93 push r25112be: 8f 93 push r24112c0: df 93 push r29112c2: cf 93 push r28112c4: e0 91 78 06 lds r30, 0x0678112c8: f0 91 79 06 lds r31, 0x0679112cc: 09 95 icall112ce: 2d b7 in r18, 0x3d ; 61112d0: 3e b7 in r19, 0x3e ; 62112d2: 26 5f subi r18, 0xF6 ; 246112d4: 3f 4f sbci r19, 0xFF ; 255112d6: 0f b6 in r0, 0x3f ; 63112d8: f8 94 cli112da: 3e bf out 0x3e, r19 ; 62112dc: 0f be out 0x3f, r0 ; 63112de: 2d bf out 0x3d, r18 ; 61112e0: a8 c7 rjmp .+3920 ; 0x12232 <Menu+0x13e4>}#endifbreak;case 2:LCD_printfxy(0,0,"act. bearing");112e2: 10 92 a4 04 sts 0x04A4, r1112e6: 8f e6 ldi r24, 0x6F ; 111112e8: 94 e1 ldi r25, 0x14 ; 20112ea: 9f 93 push r25112ec: 8f 93 push r24112ee: 80 e1 ldi r24, 0x10 ; 16112f0: 97 e8 ldi r25, 0x87 ; 135112f2: 9f 93 push r25112f4: 8f 93 push r24112f6: e0 91 78 06 lds r30, 0x0678112fa: f0 91 79 06 lds r31, 0x0679112fe: 09 95 icallLCD_printfxy(0,1,"Nick: %5i",IntegralNick/1024);11300: 84 e1 ldi r24, 0x14 ; 2011302: 80 93 a4 04 sts 0x04A4, r2411306: 80 91 42 04 lds r24, 0x04421130a: 90 91 43 04 lds r25, 0x04431130e: a0 91 44 04 lds r26, 0x044411312: b0 91 45 04 lds r27, 0x044511316: bb 23 and r27, r2711318: 24 f4 brge .+8 ; 0x11322 <Menu+0x4d4>1131a: 81 50 subi r24, 0x01 ; 11131c: 9c 4f sbci r25, 0xFC ; 2521131e: af 4f sbci r26, 0xFF ; 25511320: bf 4f sbci r27, 0xFF ; 25511322: 07 2e mov r0, r2311324: 7a e0 ldi r23, 0x0A ; 1011326: b5 95 asr r2711328: a7 95 ror r261132a: 97 95 ror r251132c: 87 95 ror r241132e: 7a 95 dec r2311330: d1 f7 brne .-12 ; 0x11326 <Menu+0x4d8>11332: 70 2d mov r23, r011334: bf 93 push r2711336: af 93 push r2611338: 9f 93 push r251133a: 8f 93 push r241133c: 80 e6 ldi r24, 0x60 ; 961133e: 94 e1 ldi r25, 0x14 ; 2011340: 9f 93 push r2511342: 8f 93 push r2411344: 80 e1 ldi r24, 0x10 ; 1611346: 97 e8 ldi r25, 0x87 ; 13511348: 9f 93 push r251134a: 8f 93 push r241134c: e0 91 78 06 lds r30, 0x067811350: f0 91 79 06 lds r31, 0x067911354: 09 95 icallLCD_printfxy(0,2,"Roll: %5i",IntegralRoll/1024);11356: 88 e2 ldi r24, 0x28 ; 4011358: 80 93 a4 04 sts 0x04A4, r241135c: 80 91 3e 04 lds r24, 0x043E11360: 90 91 3f 04 lds r25, 0x043F11364: a0 91 40 04 lds r26, 0x044011368: b0 91 41 04 lds r27, 0x04411136c: bb 23 and r27, r271136e: 24 f4 brge .+8 ; 0x11378 <Menu+0x52a>11370: 81 50 subi r24, 0x01 ; 111372: 9c 4f sbci r25, 0xFC ; 25211374: af 4f sbci r26, 0xFF ; 25511376: bf 4f sbci r27, 0xFF ; 25511378: 07 2e mov r0, r231137a: 7a e0 ldi r23, 0x0A ; 101137c: b5 95 asr r271137e: a7 95 ror r2611380: 97 95 ror r2511382: 87 95 ror r2411384: 7a 95 dec r2311386: d1 f7 brne .-12 ; 0x1137c <Menu+0x52e>11388: 70 2d mov r23, r01138a: bf 93 push r271138c: af 93 push r261138e: 9f 93 push r2511390: 8f 93 push r2411392: 81 e5 ldi r24, 0x51 ; 8111394: 94 e1 ldi r25, 0x14 ; 2011396: 9f 93 push r2511398: 8f 93 push r241139a: c0 e1 ldi r28, 0x10 ; 161139c: d7 e8 ldi r29, 0x87 ; 1351139e: df 93 push r29113a0: cf 93 push r28113a2: e0 91 78 06 lds r30, 0x0678113a6: f0 91 79 06 lds r31, 0x0679113aa: 09 95 icallLCD_printfxy(0,3,"Compass: %5i",CompassCorrected);113ac: 8c e3 ldi r24, 0x3C ; 60113ae: 80 93 a4 04 sts 0x04A4, r24113b2: 80 91 66 06 lds r24, 0x0666113b6: 8f 93 push r24113b8: 80 91 65 06 lds r24, 0x0665113bc: 8f 93 push r24113be: 82 e4 ldi r24, 0x42 ; 66113c0: 94 e1 ldi r25, 0x14 ; 20113c2: 9f 93 push r25113c4: 8f 93 push r24113c6: df 93 push r29113c8: cf 93 push r28113ca: e0 91 78 06 lds r30, 0x0678113ce: f0 91 79 06 lds r31, 0x0679113d2: 09 95 icallbreak;113d4: 2d b7 in r18, 0x3d ; 61113d6: 3e b7 in r19, 0x3e ; 62113d8: 26 5e subi r18, 0xE6 ; 230113da: 3f 4f sbci r19, 0xFF ; 255113dc: 0f b6 in r0, 0x3f ; 63113de: f8 94 cli113e0: 3e bf out 0x3e, r19 ; 62113e2: 0f be out 0x3f, r0 ; 63113e4: 2d bf out 0x3d, r18 ; 61113e6: 25 c7 rjmp .+3658 ; 0x12232 <Menu+0x13e4>if((RemoteKeys & KEY1) && (RemoteKeys & KEY2)) MenuePunkt = 0;LcdClear();if(MenuePunkt < 10) {LCD_printfxy(17,0,"[%i]",MenuePunkt);}else {LCD_printfxy(16,0,"[%i]",MenuePunkt);};switch(MenuePunkt)113e8: c1 e0 ldi r28, 0x01 ; 1113ea: d0 e0 ldi r29, 0x00 ; 0LCD_printfxy(0,1,"Nick: %5i",IntegralNick/1024);LCD_printfxy(0,2,"Roll: %5i",IntegralRoll/1024);LCD_printfxy(0,3,"Compass: %5i",CompassCorrected);break;case 3:for(i=1;i<9;i+=2) LCD_printfxy(0,i/2,"K%i:%4i K%i:%4i ",i,PPM_in[i],i+1,PPM_in[i+1]);113ec: 0f 2e mov r0, r31113ee: f0 e3 ldi r31, 0x30 ; 48113f0: ef 2e mov r14, r31113f2: f4 e1 ldi r31, 0x14 ; 20113f4: ff 2e mov r15, r31113f6: f0 2d mov r31, r0113f8: 00 e1 ldi r16, 0x10 ; 16113fa: 17 e8 ldi r17, 0x87 ; 135113fc: 8c 2f mov r24, r28113fe: 86 95 lsr r2411400: 88 0f add r24, r2411402: 88 0f add r24, r2411404: 98 2f mov r25, r2411406: 99 0f add r25, r2511408: 99 0f add r25, r251140a: 89 0f add r24, r251140c: 80 93 a4 04 sts 0x04A4, r2411410: ce 01 movw r24, r2811412: 01 96 adiw r24, 0x01 ; 111414: fc 01 movw r30, r2411416: ee 0f add r30, r3011418: ff 1f adc r31, r311141a: ef 5c subi r30, 0xCF ; 2071141c: f7 4f sbci r31, 0xF7 ; 2471141e: 40 81 ld r20, Z11420: 51 81 ldd r21, Z+1 ; 0x0111422: fe 01 movw r30, r2811424: ee 0f add r30, r3011426: ff 1f adc r31, r3111428: ef 5c subi r30, 0xCF ; 2071142a: f7 4f sbci r31, 0xF7 ; 2471142c: 20 81 ld r18, Z1142e: 31 81 ldd r19, Z+1 ; 0x0111430: 5f 93 push r2111432: 4f 93 push r2011434: 9f 93 push r2511436: 8f 93 push r2411438: 3f 93 push r191143a: 2f 93 push r181143c: df 93 push r291143e: cf 93 push r2811440: ff 92 push r1511442: ef 92 push r1411444: 1f 93 push r1711446: 0f 93 push r1611448: e0 91 78 06 lds r30, 0x06781144c: f0 91 79 06 lds r31, 0x067911450: 09 95 icall11452: 22 96 adiw r28, 0x02 ; 211454: ed b7 in r30, 0x3d ; 6111456: fe b7 in r31, 0x3e ; 6211458: 3c 96 adiw r30, 0x0c ; 121145a: 0f b6 in r0, 0x3f ; 631145c: f8 94 cli1145e: fe bf out 0x3e, r31 ; 6211460: 0f be out 0x3f, r0 ; 6311462: ed bf out 0x3d, r30 ; 6111464: c9 30 cpi r28, 0x09 ; 911466: d1 05 cpc r29, r111468: 49 f6 brne .-110 ; 0x113fc <Menu+0x5ae>1146a: e3 c6 rjmp .+3526 ; 0x12232 <Menu+0x13e4>break;case 4:LCD_printfxy(0,0,"Ni:%4i Ro:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_NICK]],PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]]);1146c: 10 92 a4 04 sts 0x04A4, r111470: e0 91 40 05 lds r30, 0x054011474: f0 e0 ldi r31, 0x00 ; 011476: ee 0f add r30, r3011478: ff 1f adc r31, r311147a: ef 5c subi r30, 0xCF ; 2071147c: f7 4f sbci r31, 0xF7 ; 2471147e: 20 81 ld r18, Z11480: 31 81 ldd r19, Z+1 ; 0x0111482: e0 91 3f 05 lds r30, 0x053F11486: f0 e0 ldi r31, 0x00 ; 011488: ee 0f add r30, r301148a: ff 1f adc r31, r311148c: ef 5c subi r30, 0xCF ; 2071148e: f7 4f sbci r31, 0xF7 ; 24711490: 80 81 ld r24, Z11492: 91 81 ldd r25, Z+1 ; 0x0111494: 3f 93 push r1911496: 2f 93 push r1811498: 9f 93 push r251149a: 8f 93 push r241149c: 80 e2 ldi r24, 0x20 ; 321149e: 94 e1 ldi r25, 0x14 ; 20114a0: 9f 93 push r25114a2: 8f 93 push r24114a4: c0 e1 ldi r28, 0x10 ; 16114a6: d7 e8 ldi r29, 0x87 ; 135114a8: df 93 push r29114aa: cf 93 push r28114ac: e0 91 78 06 lds r30, 0x0678114b0: f0 91 79 06 lds r31, 0x0679114b4: 09 95 icallLCD_printfxy(0,1,"Gs:%4i Gi:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_GAS]]+127,PPM_in[EE_Parameter.Kanalbelegung[K_GIER]]);114b6: 84 e1 ldi r24, 0x14 ; 20114b8: 80 93 a4 04 sts 0x04A4, r24114bc: e0 91 42 05 lds r30, 0x0542114c0: f0 e0 ldi r31, 0x00 ; 0114c2: ee 0f add r30, r30114c4: ff 1f adc r31, r31114c6: ef 5c subi r30, 0xCF ; 207114c8: f7 4f sbci r31, 0xF7 ; 247114ca: 20 81 ld r18, Z114cc: 31 81 ldd r19, Z+1 ; 0x01114ce: e0 91 41 05 lds r30, 0x0541114d2: f0 e0 ldi r31, 0x00 ; 0114d4: ee 0f add r30, r30114d6: ff 1f adc r31, r31114d8: ef 5c subi r30, 0xCF ; 207114da: f7 4f sbci r31, 0xF7 ; 247114dc: 80 81 ld r24, Z114de: 91 81 ldd r25, Z+1 ; 0x01114e0: 3f 93 push r19114e2: 2f 93 push r18114e4: 81 58 subi r24, 0x81 ; 129114e6: 9f 4f sbci r25, 0xFF ; 255114e8: 9f 93 push r25114ea: 8f 93 push r24114ec: 80 e1 ldi r24, 0x10 ; 16114ee: 94 e1 ldi r25, 0x14 ; 20114f0: 9f 93 push r25114f2: 8f 93 push r24114f4: df 93 push r29114f6: cf 93 push r28114f8: e0 91 78 06 lds r30, 0x0678114fc: f0 91 79 06 lds r31, 0x067911500: 09 95 icallLCD_printfxy(0,2,"P1:%4i P2:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_POTI1]]+127,PPM_in[EE_Parameter.Kanalbelegung[K_POTI2]]+127);11502: 88 e2 ldi r24, 0x28 ; 4011504: 80 93 a4 04 sts 0x04A4, r2411508: e0 91 44 05 lds r30, 0x05441150c: f0 e0 ldi r31, 0x00 ; 01150e: ee 0f add r30, r3011510: ff 1f adc r31, r3111512: ef 5c subi r30, 0xCF ; 20711514: f7 4f sbci r31, 0xF7 ; 24711516: 20 81 ld r18, Z11518: 31 81 ldd r19, Z+1 ; 0x011151a: e0 91 43 05 lds r30, 0x05431151e: f0 e0 ldi r31, 0x00 ; 011520: ee 0f add r30, r3011522: ff 1f adc r31, r3111524: ef 5c subi r30, 0xCF ; 20711526: f7 4f sbci r31, 0xF7 ; 24711528: 80 81 ld r24, Z1152a: 91 81 ldd r25, Z+1 ; 0x011152c: 21 58 subi r18, 0x81 ; 1291152e: 3f 4f sbci r19, 0xFF ; 25511530: 3f 93 push r1911532: 2f 93 push r1811534: 81 58 subi r24, 0x81 ; 12911536: 9f 4f sbci r25, 0xFF ; 25511538: 9f 93 push r251153a: 8f 93 push r241153c: 80 e0 ldi r24, 0x00 ; 01153e: 94 e1 ldi r25, 0x14 ; 2011540: 9f 93 push r2511542: 8f 93 push r2411544: df 93 push r2911546: cf 93 push r2811548: e0 91 78 06 lds r30, 0x06781154c: f0 91 79 06 lds r31, 0x067911550: 09 95 icallLCD_printfxy(0,3,"P3:%4i P4:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_POTI3]]+127,PPM_in[EE_Parameter.Kanalbelegung[K_POTI4]]+127);11552: 8c e3 ldi r24, 0x3C ; 6011554: 80 93 a4 04 sts 0x04A4, r2411558: e0 91 46 05 lds r30, 0x05461155c: f0 e0 ldi r31, 0x00 ; 01155e: ee 0f add r30, r3011560: ff 1f adc r31, r3111562: ef 5c subi r30, 0xCF ; 20711564: f7 4f sbci r31, 0xF7 ; 24711566: 20 81 ld r18, Z11568: 31 81 ldd r19, Z+1 ; 0x011156a: e0 91 45 05 lds r30, 0x05451156e: f0 e0 ldi r31, 0x00 ; 011570: ee 0f add r30, r3011572: ff 1f adc r31, r3111574: ef 5c subi r30, 0xCF ; 20711576: f7 4f sbci r31, 0xF7 ; 24711578: 80 81 ld r24, Z1157a: 91 81 ldd r25, Z+1 ; 0x011157c: 21 58 subi r18, 0x81 ; 1291157e: 3f 4f sbci r19, 0xFF ; 25511580: 3f 93 push r1911582: 2f 93 push r1811584: 81 58 subi r24, 0x81 ; 12911586: 9f 4f sbci r25, 0xFF ; 25511588: 9f 93 push r251158a: 8f 93 push r241158c: 80 ef ldi r24, 0xF0 ; 2401158e: 93 e1 ldi r25, 0x13 ; 1911590: 9f 93 push r2511592: 8f 93 push r2411594: df 93 push r2911596: cf 93 push r2811598: e0 91 78 06 lds r30, 0x06781159c: f0 91 79 06 lds r31, 0x0679115a0: 09 95 icallbreak;115a2: 8d b7 in r24, 0x3d ; 61115a4: 9e b7 in r25, 0x3e ; 62115a6: 80 96 adiw r24, 0x20 ; 32115a8: 0f b6 in r0, 0x3f ; 63115aa: f8 94 cli115ac: 9e bf out 0x3e, r25 ; 62115ae: 0f be out 0x3f, r0 ; 63115b0: 8d bf out 0x3d, r24 ; 61115b2: 3f c6 rjmp .+3198 ; 0x12232 <Menu+0x13e4>case 5:LCD_printfxy(0,0,"Gyro - Sensor");115b4: 10 92 a4 04 sts 0x04A4, r1115b8: 82 ee ldi r24, 0xE2 ; 226115ba: 93 e1 ldi r25, 0x13 ; 19115bc: 9f 93 push r25115be: 8f 93 push r24115c0: 80 e1 ldi r24, 0x10 ; 16115c2: 97 e8 ldi r25, 0x87 ; 135115c4: 9f 93 push r25115c6: 8f 93 push r24115c8: e0 91 78 06 lds r30, 0x0678115cc: f0 91 79 06 lds r31, 0x0679115d0: 09 95 icallLCD_printfxy(0,1,"Nick %4i (%4i)",AdWertNick - AdNeutralNick/8, AdNeutralNick);115d2: 84 e1 ldi r24, 0x14 ; 20115d4: 80 93 a4 04 sts 0x04A4, r24115d8: 40 91 65 03 lds r20, 0x0365115dc: 50 91 66 03 lds r21, 0x0366115e0: 30 91 57 04 lds r19, 0x0457115e4: 20 91 58 04 lds r18, 0x0458115e8: 2f 93 push r18115ea: 3f 93 push r19115ec: 83 2f mov r24, r19115ee: 92 2f mov r25, r18115f0: 99 23 and r25, r25115f2: 0c f4 brge .+2 ; 0x115f6 <Menu+0x7a8>115f4: 07 96 adiw r24, 0x07 ; 7115f6: 9c 01 movw r18, r24115f8: 35 95 asr r19115fa: 27 95 ror r18115fc: 35 95 asr r19115fe: 27 95 ror r1811600: 35 95 asr r1911602: 27 95 ror r1811604: ca 01 movw r24, r2011606: 82 1b sub r24, r1811608: 93 0b sbc r25, r191160a: 9f 93 push r251160c: 8f 93 push r241160e: 83 ed ldi r24, 0xD3 ; 21111610: 93 e1 ldi r25, 0x13 ; 1911612: 9f 93 push r2511614: 8f 93 push r2411616: 80 e1 ldi r24, 0x10 ; 1611618: 97 e8 ldi r25, 0x87 ; 1351161a: 9f 93 push r251161c: 8f 93 push r241161e: e0 91 78 06 lds r30, 0x067811622: f0 91 79 06 lds r31, 0x067911626: 09 95 icallLCD_printfxy(0,2,"Roll %4i (%4i)",AdWertRoll - AdNeutralRoll/8, AdNeutralRoll);11628: 88 e2 ldi r24, 0x28 ; 401162a: 80 93 a4 04 sts 0x04A4, r241162e: 40 91 63 03 lds r20, 0x036311632: 50 91 64 03 lds r21, 0x036411636: 30 91 55 04 lds r19, 0x04551163a: 20 91 56 04 lds r18, 0x04561163e: 2f 93 push r1811640: 3f 93 push r1911642: 83 2f mov r24, r1911644: 92 2f mov r25, r1811646: 99 23 and r25, r2511648: 0c f4 brge .+2 ; 0x1164c <Menu+0x7fe>1164a: 07 96 adiw r24, 0x07 ; 71164c: 9c 01 movw r18, r241164e: 35 95 asr r1911650: 27 95 ror r1811652: 35 95 asr r1911654: 27 95 ror r1811656: 35 95 asr r1911658: 27 95 ror r181165a: ca 01 movw r24, r201165c: 82 1b sub r24, r181165e: 93 0b sbc r25, r1911660: 9f 93 push r2511662: 8f 93 push r2411664: 84 ec ldi r24, 0xC4 ; 19611666: 93 e1 ldi r25, 0x13 ; 1911668: 9f 93 push r251166a: 8f 93 push r241166c: c0 e1 ldi r28, 0x10 ; 161166e: d7 e8 ldi r29, 0x87 ; 13511670: df 93 push r2911672: cf 93 push r2811674: e0 91 78 06 lds r30, 0x067811678: f0 91 79 06 lds r31, 0x06791167c: 09 95 icallLCD_printfxy(0,3,"Yaw %4i (%4i)",AdNeutralGier - AdWertGier, AdNeutralGier);1167e: 8c e3 ldi r24, 0x3C ; 6011680: 80 93 a4 04 sts 0x04A4, r2411684: 80 91 53 04 lds r24, 0x045311688: 90 91 54 04 lds r25, 0x04541168c: 20 91 61 03 lds r18, 0x036111690: 30 91 62 03 lds r19, 0x036211694: 9f 93 push r2511696: 8f 93 push r2411698: 82 1b sub r24, r181169a: 93 0b sbc r25, r191169c: 9f 93 push r251169e: 8f 93 push r24116a0: 85 eb ldi r24, 0xB5 ; 181116a2: 93 e1 ldi r25, 0x13 ; 19116a4: 9f 93 push r25116a6: 8f 93 push r24116a8: df 93 push r29116aa: cf 93 push r28116ac: e0 91 78 06 lds r30, 0x0678116b0: f0 91 79 06 lds r31, 0x0679116b4: 09 95 icallLCD_printfxy(0,1,"Nick %4i (%3i)(%3i)",AdWertNick - AdNeutralNick/8, AdNeutralNick/16,AnalogOffsetNick);LCD_printfxy(0,2,"Roll %4i (%3i)(%3i)",AdWertRoll - AdNeutralRoll/8, AdNeutralRoll/16,AnalogOffsetRoll);LCD_printfxy(0,3,"Yaw %4i (%3i)(%3i)",AdNeutralGier - AdWertGier, AdNeutralGier/2,AnalogOffsetGier);}*/break;116b6: 8d b7 in r24, 0x3d ; 61116b8: 9e b7 in r25, 0x3e ; 62116ba: 4c 96 adiw r24, 0x1c ; 28116bc: 0f b6 in r0, 0x3f ; 63116be: f8 94 cli116c0: 9e bf out 0x3e, r25 ; 62116c2: 0f be out 0x3f, r0 ; 63116c4: 8d bf out 0x3d, r24 ; 61116c6: b5 c5 rjmp .+2922 ; 0x12232 <Menu+0x13e4>case 6:LCD_printfxy(0,0,"ACC - Sensor");116c8: 10 92 a4 04 sts 0x04A4, r1116cc: 88 ea ldi r24, 0xA8 ; 168116ce: 93 e1 ldi r25, 0x13 ; 19116d0: 9f 93 push r25116d2: 8f 93 push r24116d4: c0 e1 ldi r28, 0x10 ; 16116d6: d7 e8 ldi r29, 0x87 ; 135116d8: df 93 push r29116da: cf 93 push r28116dc: e0 91 78 06 lds r30, 0x0678116e0: f0 91 79 06 lds r31, 0x0679116e4: 09 95 icallLCD_printfxy(0,1,"Nick %4i (%3i)",AdWertAccNick,NeutralAccX);116e6: 84 e1 ldi r24, 0x14 ; 20116e8: 80 93 a4 04 sts 0x04A4, r24116ec: 80 91 5d 03 lds r24, 0x035D116f0: 90 91 5e 03 lds r25, 0x035E116f4: 20 91 4e 04 lds r18, 0x044E116f8: 2f 93 push r18116fa: 20 91 4d 04 lds r18, 0x044D116fe: 2f 93 push r1811700: 9f 93 push r2511702: 8f 93 push r2411704: 89 e9 ldi r24, 0x99 ; 15311706: 93 e1 ldi r25, 0x13 ; 1911708: 9f 93 push r251170a: 8f 93 push r241170c: df 93 push r291170e: cf 93 push r2811710: e0 91 78 06 lds r30, 0x067811714: f0 91 79 06 lds r31, 0x067911718: 09 95 icallLCD_printfxy(0,2,"Roll %4i (%3i)",AdWertAccRoll,NeutralAccY);1171a: 88 e2 ldi r24, 0x28 ; 401171c: 80 93 a4 04 sts 0x04A4, r2411720: 80 91 5f 03 lds r24, 0x035F11724: 90 91 60 03 lds r25, 0x036011728: 20 91 4c 04 lds r18, 0x044C1172c: 2f 93 push r181172e: 20 91 4b 04 lds r18, 0x044B11732: 2f 93 push r1811734: 9f 93 push r2511736: 8f 93 push r2411738: 8a e8 ldi r24, 0x8A ; 1381173a: 93 e1 ldi r25, 0x13 ; 191173c: 9f 93 push r251173e: 8f 93 push r2411740: df 93 push r2911742: cf 93 push r2811744: e0 91 78 06 lds r30, 0x067811748: f0 91 79 06 lds r31, 0x06791174c: 09 95 icallLCD_printfxy(0,3,"Z %4i (%3i)",AdWertAccHoch,(int)NeutralAccZ);1174e: 8c e3 ldi r24, 0x3C ; 6011750: 80 93 a4 04 sts 0x04A4, r2411754: 80 91 5b 03 lds r24, 0x035B11758: 90 91 5c 03 lds r25, 0x035C1175c: 20 91 48 04 lds r18, 0x044811760: 2f 93 push r1811762: 20 91 47 04 lds r18, 0x044711766: 2f 93 push r1811768: 9f 93 push r251176a: 8f 93 push r241176c: 8b e7 ldi r24, 0x7B ; 1231176e: 93 e1 ldi r25, 0x13 ; 1911770: 9f 93 push r2511772: 8f 93 push r2411774: df 93 push r2911776: cf 93 push r2811778: e0 91 78 06 lds r30, 0x06781177c: f0 91 79 06 lds r31, 0x067911780: 09 95 icallbreak;11782: 2d b7 in r18, 0x3d ; 6111784: 3e b7 in r19, 0x3e ; 6211786: 24 5e subi r18, 0xE4 ; 22811788: 3f 4f sbci r19, 0xFF ; 2551178a: 0f b6 in r0, 0x3f ; 631178c: f8 94 cli1178e: 3e bf out 0x3e, r19 ; 6211790: 0f be out 0x3f, r0 ; 6311792: 2d bf out 0x3d, r18 ; 6111794: 4e c5 rjmp .+2716 ; 0x12232 <Menu+0x13e4>case 7:LCD_printfxy(0,0,"Voltage: %3i.%1iV",UBat/10, UBat%10);11796: 10 92 a4 04 sts 0x04A4, r11179a: 80 91 1a 01 lds r24, 0x011A1179e: 90 91 1b 01 lds r25, 0x011B117a2: e0 91 1a 01 lds r30, 0x011A117a6: f0 91 1b 01 lds r31, 0x011B117aa: 2a e0 ldi r18, 0x0A ; 10117ac: 30 e0 ldi r19, 0x00 ; 0117ae: b9 01 movw r22, r18117b0: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>117b4: 9f 93 push r25117b6: 8f 93 push r24117b8: cf 01 movw r24, r30117ba: b9 01 movw r22, r18117bc: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>117c0: 7f 93 push r23117c2: 6f 93 push r22117c4: 87 e6 ldi r24, 0x67 ; 103117c6: 93 e1 ldi r25, 0x13 ; 19117c8: 9f 93 push r25117ca: 8f 93 push r24117cc: c0 e1 ldi r28, 0x10 ; 16117ce: d7 e8 ldi r29, 0x87 ; 135117d0: df 93 push r29117d2: cf 93 push r28117d4: e0 91 78 06 lds r30, 0x0678117d8: f0 91 79 06 lds r31, 0x0679117dc: 09 95 icallLCD_printfxy(0,1,"Current: %3i.%1iA",Capacity.ActualCurrent/10, Capacity.ActualCurrent%10);117de: 84 e1 ldi r24, 0x14 ; 20117e0: 80 93 a4 04 sts 0x04A4, r24117e4: 40 91 15 05 lds r20, 0x0515117e8: 50 91 16 05 lds r21, 0x0516117ec: 9a 01 movw r18, r20117ee: ad ec ldi r26, 0xCD ; 205117f0: bc ec ldi r27, 0xCC ; 204117f2: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>117f6: 96 95 lsr r25117f8: 87 95 ror r24117fa: 96 95 lsr r25117fc: 87 95 ror r24117fe: 96 95 lsr r2511800: 87 95 ror r2411802: 9c 01 movw r18, r2411804: 22 0f add r18, r1811806: 33 1f adc r19, r1911808: 88 0f add r24, r241180a: 99 1f adc r25, r251180c: 88 0f add r24, r241180e: 99 1f adc r25, r2511810: 88 0f add r24, r2411812: 99 1f adc r25, r2511814: 82 0f add r24, r1811816: 93 1f adc r25, r1911818: fa 01 movw r30, r201181a: e8 1b sub r30, r241181c: f9 0b sbc r31, r251181e: cf 01 movw r24, r3011820: 9f 93 push r2511822: ef 93 push r3011824: 9a 01 movw r18, r2011826: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>1182a: 96 95 lsr r251182c: 87 95 ror r241182e: 96 95 lsr r2511830: 87 95 ror r2411832: 96 95 lsr r2511834: 87 95 ror r2411836: 9f 93 push r2511838: 8f 93 push r241183a: 83 e5 ldi r24, 0x53 ; 831183c: 93 e1 ldi r25, 0x13 ; 191183e: 9f 93 push r2511840: 8f 93 push r2411842: df 93 push r2911844: cf 93 push r2811846: e0 91 78 06 lds r30, 0x06781184a: f0 91 79 06 lds r31, 0x06791184e: 09 95 icallLCD_printfxy(0,2,"Power: %4iW",Capacity.ActualPower);11850: 88 e2 ldi r24, 0x28 ; 4011852: 80 93 a4 04 sts 0x04A4, r2411856: e7 e1 ldi r30, 0x17 ; 2311858: f5 e0 ldi r31, 0x05 ; 51185a: 81 81 ldd r24, Z+1 ; 0x011185c: 8f 93 push r241185e: 80 81 ld r24, Z11860: 8f 93 push r2411862: 83 e4 ldi r24, 0x43 ; 6711864: 93 e1 ldi r25, 0x13 ; 1911866: 9f 93 push r2511868: 8f 93 push r241186a: df 93 push r291186c: cf 93 push r281186e: e0 91 78 06 lds r30, 0x067811872: f0 91 79 06 lds r31, 0x067911876: 09 95 icallLCD_printfxy(0,3,"Discharge: %5imAh", Capacity.UsedCapacity);11878: 8c e3 ldi r24, 0x3C ; 601187a: 80 93 a4 04 sts 0x04A4, r241187e: e9 e1 ldi r30, 0x19 ; 2511880: f5 e0 ldi r31, 0x05 ; 511882: 81 81 ldd r24, Z+1 ; 0x0111884: 8f 93 push r2411886: 80 81 ld r24, Z11888: 8f 93 push r241188a: 81 e3 ldi r24, 0x31 ; 491188c: 93 e1 ldi r25, 0x13 ; 191188e: 9f 93 push r2511890: 8f 93 push r2411892: df 93 push r2911894: cf 93 push r2811896: e0 91 78 06 lds r30, 0x06781189a: f0 91 79 06 lds r31, 0x06791189e: 09 95 icallbreak;118a0: 2d b7 in r18, 0x3d ; 61118a2: 3e b7 in r19, 0x3e ; 62118a4: 24 5e subi r18, 0xE4 ; 228118a6: 3f 4f sbci r19, 0xFF ; 255118a8: 0f b6 in r0, 0x3f ; 63118aa: f8 94 cli118ac: 3e bf out 0x3e, r19 ; 62118ae: 0f be out 0x3f, r0 ; 63118b0: 2d bf out 0x3d, r18 ; 61118b2: bf c4 rjmp .+2430 ; 0x12232 <Menu+0x13e4>case 8:LCD_printfxy(0,0,"Receiver");118b4: 10 92 a4 04 sts 0x04A4, r1118b8: 88 e2 ldi r24, 0x28 ; 40118ba: 93 e1 ldi r25, 0x13 ; 19118bc: 9f 93 push r25118be: 8f 93 push r24118c0: c0 e1 ldi r28, 0x10 ; 16118c2: d7 e8 ldi r29, 0x87 ; 135118c4: df 93 push r29118c6: cf 93 push r28118c8: e0 91 78 06 lds r30, 0x0678118cc: f0 91 79 06 lds r31, 0x0679118d0: 09 95 icallLCD_printfxy(0,2,"RC-Quality: %4i", SenderOkay);118d2: 88 e2 ldi r24, 0x28 ; 40118d4: 80 93 a4 04 sts 0x04A4, r24118d8: 80 91 04 04 lds r24, 0x0404118dc: 1f 92 push r1118de: 8f 93 push r24118e0: 88 e1 ldi r24, 0x18 ; 24118e2: 93 e1 ldi r25, 0x13 ; 19118e4: 9f 93 push r25118e6: 8f 93 push r24118e8: df 93 push r29118ea: cf 93 push r28118ec: e0 91 78 06 lds r30, 0x0678118f0: f0 91 79 06 lds r31, 0x0679118f4: 09 95 icallLCD_printfxy(0,3,"RC-Channels:%4i", Channels-1);118f6: 8c e3 ldi r24, 0x3C ; 60118f8: 80 93 a4 04 sts 0x04A4, r24118fc: 80 91 30 08 lds r24, 0x083011900: 90 e0 ldi r25, 0x00 ; 011902: 01 97 sbiw r24, 0x01 ; 111904: 9f 93 push r2511906: 8f 93 push r2411908: 88 e0 ldi r24, 0x08 ; 81190a: 93 e1 ldi r25, 0x13 ; 191190c: 9f 93 push r251190e: 8f 93 push r2411910: df 93 push r2911912: cf 93 push r2811914: e0 91 78 06 lds r30, 0x067811918: f0 91 79 06 lds r31, 0x06791191c: 09 95 icallbreak;1191e: 8d b7 in r24, 0x3d ; 6111920: 9e b7 in r25, 0x3e ; 6211922: 40 96 adiw r24, 0x10 ; 1611924: 0f b6 in r0, 0x3f ; 6311926: f8 94 cli11928: 9e bf out 0x3e, r25 ; 621192a: 0f be out 0x3f, r0 ; 631192c: 8d bf out 0x3d, r24 ; 611192e: 81 c4 rjmp .+2306 ; 0x12232 <Menu+0x13e4>case 9:LCD_printfxy(0,0,"Undervoltages " );11930: 10 92 a4 04 sts 0x04A4, r111934: 88 ef ldi r24, 0xF8 ; 24811936: 92 e1 ldi r25, 0x12 ; 1811938: 9f 93 push r251193a: 8f 93 push r241193c: c0 e1 ldi r28, 0x10 ; 161193e: d7 e8 ldi r29, 0x87 ; 13511940: df 93 push r2911942: cf 93 push r2811944: e0 91 78 06 lds r30, 0x067811948: f0 91 79 06 lds r31, 0x06791194c: 09 95 icallLCD_printfxy(0,1,"Warn: %2d.%dV",BattLowVoltageWarning/10,BattLowVoltageWarning%10);1194e: 84 e1 ldi r24, 0x14 ; 2011950: 80 93 a4 04 sts 0x04A4, r2411954: 90 91 53 01 lds r25, 0x015311958: 1d ec ldi r17, 0xCD ; 2051195a: 91 9f mul r25, r171195c: 81 2d mov r24, r11195e: 11 24 eor r1, r111960: 86 95 lsr r2411962: 86 95 lsr r2411964: 86 95 lsr r2411966: 28 2f mov r18, r2411968: 22 0f add r18, r181196a: 32 2f mov r19, r181196c: 33 0f add r19, r191196e: 33 0f add r19, r1911970: 23 0f add r18, r1911972: 92 1b sub r25, r1811974: 1f 92 push r111976: 9f 93 push r2511978: 1f 92 push r11197a: 8f 93 push r241197c: 8a ee ldi r24, 0xEA ; 2341197e: 92 e1 ldi r25, 0x12 ; 1811980: 9f 93 push r2511982: 8f 93 push r2411984: df 93 push r2911986: cf 93 push r2811988: e0 91 78 06 lds r30, 0x06781198c: f0 91 79 06 lds r31, 0x067911990: 09 95 icallLCD_printfxy(0,2,"Home: %2d.%dV",BattComingHomeVoltage/10,BattComingHomeVoltage%10);11992: 88 e2 ldi r24, 0x28 ; 4011994: 80 93 a4 04 sts 0x04A4, r2411998: 90 91 64 04 lds r25, 0x04641199c: 91 9f mul r25, r171199e: 81 2d mov r24, r1119a0: 11 24 eor r1, r1119a2: 86 95 lsr r24119a4: 86 95 lsr r24119a6: 86 95 lsr r24119a8: 28 2f mov r18, r24119aa: 22 0f add r18, r18119ac: 32 2f mov r19, r18119ae: 33 0f add r19, r19119b0: 33 0f add r19, r19119b2: 23 0f add r18, r19119b4: 92 1b sub r25, r18119b6: 1f 92 push r1119b8: 9f 93 push r25119ba: 1f 92 push r1119bc: 8f 93 push r24119be: 8c ed ldi r24, 0xDC ; 220119c0: 92 e1 ldi r25, 0x12 ; 18119c2: 9f 93 push r25119c4: 8f 93 push r24119c6: df 93 push r29119c8: cf 93 push r28119ca: e0 91 78 06 lds r30, 0x0678119ce: f0 91 79 06 lds r31, 0x0679119d2: 09 95 icallLCD_printfxy(0,3,"Land: %2d.%dV",BattAutoLandingVoltage/10,BattAutoLandingVoltage%10);119d4: 8c e3 ldi r24, 0x3C ; 60119d6: 80 93 a4 04 sts 0x04A4, r24119da: 80 91 65 04 lds r24, 0x0465119de: 81 9f mul r24, r17119e0: 11 2d mov r17, r1119e2: 11 24 eor r1, r1119e4: 16 95 lsr r17119e6: 16 95 lsr r17119e8: 16 95 lsr r17119ea: 91 2f mov r25, r17119ec: 99 0f add r25, r25119ee: 29 2f mov r18, r25119f0: 22 0f add r18, r18119f2: 22 0f add r18, r18119f4: 92 0f add r25, r18119f6: 89 1b sub r24, r25119f8: 1f 92 push r1119fa: 8f 93 push r24119fc: 1f 92 push r1119fe: 1f 93 push r1711a00: 8e ec ldi r24, 0xCE ; 20611a02: 92 e1 ldi r25, 0x12 ; 1811a04: 9f 93 push r2511a06: 8f 93 push r2411a08: df 93 push r2911a0a: cf 93 push r2811a0c: e0 91 78 06 lds r30, 0x067811a10: f0 91 79 06 lds r31, 0x067911a14: 09 95 icallbreak;11a16: 2d b7 in r18, 0x3d ; 6111a18: 3e b7 in r19, 0x3e ; 6211a1a: 24 5e subi r18, 0xE4 ; 22811a1c: 3f 4f sbci r19, 0xFF ; 25511a1e: 0f b6 in r0, 0x3f ; 6311a20: f8 94 cli11a22: 3e bf out 0x3e, r19 ; 6211a24: 0f be out 0x3f, r0 ; 6311a26: 2d bf out 0x3d, r18 ; 6111a28: 04 c4 rjmp .+2056 ; 0x12232 <Menu+0x13e4>11a2a: c5 e0 ldi r28, 0x05 ; 511a2c: d4 e0 ldi r29, 0x04 ; 4if((RemoteKeys & KEY1) && (RemoteKeys & KEY2)) MenuePunkt = 0;LcdClear();if(MenuePunkt < 10) {LCD_printfxy(17,0,"[%i]",MenuePunkt);}else {LCD_printfxy(16,0,"[%i]",MenuePunkt);};switch(MenuePunkt)11a2e: 10 e0 ldi r17, 0x00 ; 0LCD_printfxy(0,1,"Warn: %2d.%dV",BattLowVoltageWarning/10,BattLowVoltageWarning%10);LCD_printfxy(0,2,"Home: %2d.%dV",BattComingHomeVoltage/10,BattComingHomeVoltage%10);LCD_printfxy(0,3,"Land: %2d.%dV",BattAutoLandingVoltage/10,BattAutoLandingVoltage%10);break;case 10:for(i=0;i<4;i++) LCD_printfxy(0,i,"Poti%i: %3i",i+1,Poti[i]);11a30: 0f 2e mov r0, r3111a32: f1 ec ldi r31, 0xC1 ; 19311a34: ef 2e mov r14, r3111a36: f2 e1 ldi r31, 0x12 ; 1811a38: ff 2e mov r15, r3111a3a: f0 2d mov r31, r011a3c: 0f 2e mov r0, r3111a3e: f0 e1 ldi r31, 0x10 ; 1611a40: cf 2e mov r12, r3111a42: f7 e8 ldi r31, 0x87 ; 13511a44: df 2e mov r13, r3111a46: f0 2d mov r31, r011a48: 10 93 a4 04 sts 0x04A4, r1711a4c: 89 91 ld r24, Y+11a4e: 1f 92 push r111a50: 8f 93 push r2411a52: ce 01 movw r24, r2811a54: 85 50 subi r24, 0x05 ; 511a56: 94 40 sbci r25, 0x04 ; 411a58: 9f 93 push r2511a5a: 8f 93 push r2411a5c: ff 92 push r1511a5e: ef 92 push r1411a60: df 92 push r1311a62: cf 92 push r1211a64: e0 91 78 06 lds r30, 0x067811a68: f0 91 79 06 lds r31, 0x067911a6c: 09 95 icall11a6e: 1c 5e subi r17, 0xEC ; 23611a70: 8d b7 in r24, 0x3d ; 6111a72: 9e b7 in r25, 0x3e ; 6211a74: 08 96 adiw r24, 0x08 ; 811a76: 0f b6 in r0, 0x3f ; 6311a78: f8 94 cli11a7a: 9e bf out 0x3e, r25 ; 6211a7c: 0f be out 0x3f, r0 ; 6311a7e: 8d bf out 0x3d, r24 ; 6111a80: 10 35 cpi r17, 0x50 ; 8011a82: 11 f7 brne .-60 ; 0x11a48 <Menu+0xbfa>11a84: d6 c3 rjmp .+1964 ; 0x12232 <Menu+0x13e4>11a86: c9 e0 ldi r28, 0x09 ; 911a88: d4 e0 ldi r29, 0x04 ; 4if((RemoteKeys & KEY1) && (RemoteKeys & KEY2)) MenuePunkt = 0;LcdClear();if(MenuePunkt < 10) {LCD_printfxy(17,0,"[%i]",MenuePunkt);}else {LCD_printfxy(16,0,"[%i]",MenuePunkt);};switch(MenuePunkt)11a8a: 10 e0 ldi r17, 0x00 ; 0break;case 10:for(i=0;i<4;i++) LCD_printfxy(0,i,"Poti%i: %3i",i+1,Poti[i]);break;case 11:for(i=0;i<4;i++) LCD_printfxy(0,i,"Poti%i: %3i",i+5,Poti[i+4]);11a8c: 0f 2e mov r0, r3111a8e: f4 eb ldi r31, 0xB4 ; 18011a90: ef 2e mov r14, r3111a92: f2 e1 ldi r31, 0x12 ; 1811a94: ff 2e mov r15, r3111a96: f0 2d mov r31, r011a98: 0f 2e mov r0, r3111a9a: f0 e1 ldi r31, 0x10 ; 1611a9c: cf 2e mov r12, r3111a9e: f7 e8 ldi r31, 0x87 ; 13511aa0: df 2e mov r13, r3111aa2: f0 2d mov r31, r011aa4: 10 93 a4 04 sts 0x04A4, r1711aa8: 89 91 ld r24, Y+11aaa: 1f 92 push r111aac: 8f 93 push r2411aae: ce 01 movw r24, r2811ab0: 85 50 subi r24, 0x05 ; 511ab2: 94 40 sbci r25, 0x04 ; 411ab4: 9f 93 push r2511ab6: 8f 93 push r2411ab8: ff 92 push r1511aba: ef 92 push r1411abc: df 92 push r1311abe: cf 92 push r1211ac0: e0 91 78 06 lds r30, 0x067811ac4: f0 91 79 06 lds r31, 0x067911ac8: 09 95 icall11aca: 1c 5e subi r17, 0xEC ; 23611acc: ed b7 in r30, 0x3d ; 6111ace: fe b7 in r31, 0x3e ; 6211ad0: 38 96 adiw r30, 0x08 ; 811ad2: 0f b6 in r0, 0x3f ; 6311ad4: f8 94 cli11ad6: fe bf out 0x3e, r31 ; 6211ad8: 0f be out 0x3f, r0 ; 6311ada: ed bf out 0x3d, r30 ; 6111adc: 10 35 cpi r17, 0x50 ; 8011ade: 11 f7 brne .-60 ; 0x11aa4 <Menu+0xc56>11ae0: a8 c3 rjmp .+1872 ; 0x12232 <Menu+0x13e4>break;case 12:LCD_printfxy(0,0,"Flight-Time " );11ae2: 10 92 a4 04 sts 0x04A4, r111ae6: 86 ea ldi r24, 0xA6 ; 16611ae8: 92 e1 ldi r25, 0x12 ; 1811aea: 9f 93 push r2511aec: 8f 93 push r2411aee: c0 e1 ldi r28, 0x10 ; 1611af0: d7 e8 ldi r29, 0x87 ; 13511af2: df 93 push r2911af4: cf 93 push r2811af6: e0 91 78 06 lds r30, 0x067811afa: f0 91 79 06 lds r31, 0x067911afe: 09 95 icallLCD_printfxy(0,1,"Total:%5umin",FlugMinutenGesamt);11b00: 84 e1 ldi r24, 0x14 ; 2011b02: 80 93 a4 04 sts 0x04A4, r2411b06: 80 91 61 04 lds r24, 0x046111b0a: 8f 93 push r2411b0c: 80 91 60 04 lds r24, 0x046011b10: 8f 93 push r2411b12: 89 e9 ldi r24, 0x99 ; 15311b14: 92 e1 ldi r25, 0x12 ; 1811b16: 9f 93 push r2511b18: 8f 93 push r2411b1a: df 93 push r2911b1c: cf 93 push r2811b1e: e0 91 78 06 lds r30, 0x067811b22: f0 91 79 06 lds r31, 0x067911b26: 09 95 icallLCD_printfxy(0,2,"Act: %5umin",FlugMinuten);11b28: 88 e2 ldi r24, 0x28 ; 4011b2a: 80 93 a4 04 sts 0x04A4, r2411b2e: 80 91 63 04 lds r24, 0x046311b32: 8f 93 push r2411b34: 80 91 62 04 lds r24, 0x046211b38: 8f 93 push r2411b3a: 8c e8 ldi r24, 0x8C ; 14011b3c: 92 e1 ldi r25, 0x12 ; 1811b3e: 9f 93 push r2511b40: 8f 93 push r2411b42: df 93 push r2911b44: cf 93 push r2811b46: e0 91 78 06 lds r30, 0x067811b4a: f0 91 79 06 lds r31, 0x067911b4e: 09 95 icallLCD_printfxy(13,3,"(reset)");11b50: 89 e4 ldi r24, 0x49 ; 7311b52: 80 93 a4 04 sts 0x04A4, r2411b56: 84 e8 ldi r24, 0x84 ; 13211b58: 92 e1 ldi r25, 0x12 ; 1811b5a: 9f 93 push r2511b5c: 8f 93 push r2411b5e: df 93 push r2911b60: cf 93 push r2811b62: e0 91 78 06 lds r30, 0x067811b66: f0 91 79 06 lds r31, 0x067911b6a: 09 95 icallif(RemoteKeys & KEY4)11b6c: 80 91 a2 04 lds r24, 0x04A211b70: ed b7 in r30, 0x3d ; 6111b72: fe b7 in r31, 0x3e ; 6211b74: 74 96 adiw r30, 0x14 ; 2011b76: 0f b6 in r0, 0x3f ; 6311b78: f8 94 cli11b7a: fe bf out 0x3e, r31 ; 6211b7c: 0f be out 0x3f, r0 ; 6311b7e: ed bf out 0x3d, r30 ; 6111b80: 83 ff sbrs r24, 311b82: 57 c3 rjmp .+1710 ; 0x12232 <Menu+0x13e4>{FlugMinuten = 0;11b84: 10 92 63 04 sts 0x0463, r111b88: 10 92 62 04 sts 0x0462, r1SetParamWord(PID_FLIGHT_MINUTES, FlugMinuten);11b8c: 60 e0 ldi r22, 0x00 ; 011b8e: 70 e0 ldi r23, 0x00 ; 011b90: 8e e0 ldi r24, 0x0E ; 1411b92: 90 e0 ldi r25, 0x00 ; 011b94: 0e 94 4b 25 call 0x4a96 ; 0x4a96 <SetParamWord>11b98: 4c c3 rjmp .+1688 ; 0x12232 <Menu+0x13e4>}break;#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))case 13:LCD_printfxy(0,0,"Compass");11b9a: 10 92 a4 04 sts 0x04A4, r111b9e: 8c e7 ldi r24, 0x7C ; 12411ba0: 92 e1 ldi r25, 0x12 ; 1811ba2: 9f 93 push r2511ba4: 8f 93 push r2411ba6: c0 e1 ldi r28, 0x10 ; 1611ba8: d7 e8 ldi r29, 0x87 ; 13511baa: df 93 push r2911bac: cf 93 push r2811bae: e0 91 78 06 lds r30, 0x067811bb2: f0 91 79 06 lds r31, 0x067911bb6: 09 95 icallLCD_printfxy(0,1,"Magnet: %5i",KompassValue);11bb8: 84 e1 ldi r24, 0x14 ; 2011bba: 80 93 a4 04 sts 0x04A4, r2411bbe: 80 91 4f 01 lds r24, 0x014F11bc2: 8f 93 push r2411bc4: 80 91 4e 01 lds r24, 0x014E11bc8: 8f 93 push r2411bca: 8e e6 ldi r24, 0x6E ; 11011bcc: 92 e1 ldi r25, 0x12 ; 1811bce: 9f 93 push r2511bd0: 8f 93 push r2411bd2: df 93 push r2911bd4: cf 93 push r2811bd6: e0 91 78 06 lds r30, 0x067811bda: f0 91 79 06 lds r31, 0x067911bde: 09 95 icallLCD_printfxy(0,2,"Gyro: %5i",ErsatzKompassInGrad);11be0: 88 e2 ldi r24, 0x28 ; 4011be2: 80 93 a4 04 sts 0x04A4, r2411be6: 80 91 22 06 lds r24, 0x062211bea: 8f 93 push r2411bec: 80 91 21 06 lds r24, 0x062111bf0: 8f 93 push r2411bf2: 80 e6 ldi r24, 0x60 ; 9611bf4: 92 e1 ldi r25, 0x12 ; 1811bf6: 9f 93 push r2511bf8: 8f 93 push r2411bfa: df 93 push r2911bfc: cf 93 push r2811bfe: e0 91 78 06 lds r30, 0x067811c02: f0 91 79 06 lds r31, 0x067911c06: 09 95 icallLCD_printfxy(0,3,"True: %5i",CompassCorrected);11c08: 8c e3 ldi r24, 0x3C ; 6011c0a: 80 93 a4 04 sts 0x04A4, r2411c0e: 80 91 66 06 lds r24, 0x066611c12: 8f 93 push r2411c14: 80 91 65 06 lds r24, 0x066511c18: 8f 93 push r2411c1a: 82 e5 ldi r24, 0x52 ; 8211c1c: 92 e1 ldi r25, 0x12 ; 1811c1e: 9f 93 push r2511c20: 8f 93 push r2411c22: df 93 push r2911c24: cf 93 push r2811c26: e0 91 78 06 lds r30, 0x067811c2a: f0 91 79 06 lds r31, 0x067911c2e: 09 95 icallbreak;11c30: 8d b7 in r24, 0x3d ; 6111c32: 9e b7 in r25, 0x3e ; 6211c34: 46 96 adiw r24, 0x16 ; 2211c36: 0f b6 in r0, 0x3f ; 6311c38: f8 94 cli11c3a: 9e bf out 0x3e, r25 ; 6211c3c: 0f be out 0x3f, r0 ; 6311c3e: 8d bf out 0x3d, r24 ; 6111c40: f8 c2 rjmp .+1520 ; 0x12232 <Menu+0x13e4>case 14:LCD_printfxy(0,0,"Servo " );11c42: 10 92 a4 04 sts 0x04A4, r111c46: 8a e4 ldi r24, 0x4A ; 7411c48: 92 e1 ldi r25, 0x12 ; 1811c4a: 9f 93 push r2511c4c: 8f 93 push r2411c4e: c0 e1 ldi r28, 0x10 ; 1611c50: d7 e8 ldi r29, 0x87 ; 13511c52: df 93 push r2911c54: cf 93 push r2811c56: e0 91 78 06 lds r30, 0x067811c5a: f0 91 79 06 lds r31, 0x067911c5e: 09 95 icallLCD_printfxy(0,1,"Setpoint %3i",Parameter_ServoNickControl);11c60: 84 e1 ldi r24, 0x14 ; 2011c62: 80 93 a4 04 sts 0x04A4, r2411c66: 80 91 2f 01 lds r24, 0x012F11c6a: 1f 92 push r111c6c: 8f 93 push r2411c6e: 8c e3 ldi r24, 0x3C ; 6011c70: 92 e1 ldi r25, 0x12 ; 1811c72: 9f 93 push r2511c74: 8f 93 push r2411c76: df 93 push r2911c78: cf 93 push r2811c7a: e0 91 78 06 lds r30, 0x067811c7e: f0 91 79 06 lds r31, 0x067911c82: 09 95 icallLCD_printfxy(0,2,"Position: %3i",ServoNickValue/4);11c84: 88 e2 ldi r24, 0x28 ; 4011c86: 80 93 a4 04 sts 0x04A4, r2411c8a: 80 91 c6 04 lds r24, 0x04C611c8e: 90 91 c7 04 lds r25, 0x04C711c92: 99 23 and r25, r2511c94: 0c f4 brge .+2 ; 0x11c98 <Menu+0xe4a>11c96: 03 96 adiw r24, 0x03 ; 311c98: 95 95 asr r2511c9a: 87 95 ror r2411c9c: 95 95 asr r2511c9e: 87 95 ror r2411ca0: 9f 93 push r2511ca2: 8f 93 push r2411ca4: 8e e2 ldi r24, 0x2E ; 4611ca6: 92 e1 ldi r25, 0x12 ; 1811ca8: 9f 93 push r2511caa: 8f 93 push r2411cac: c0 e1 ldi r28, 0x10 ; 1611cae: d7 e8 ldi r29, 0x87 ; 13511cb0: df 93 push r2911cb2: cf 93 push r2811cb4: e0 91 78 06 lds r30, 0x067811cb8: f0 91 79 06 lds r31, 0x067911cbc: 09 95 icallLCD_printfxy(0,3,"Range:%3i-%3i",EE_Parameter.ServoNickMin,EE_Parameter.ServoNickMax);11cbe: 8c e3 ldi r24, 0x3C ; 6011cc0: 80 93 a4 04 sts 0x04A4, r2411cc4: 80 91 6e 05 lds r24, 0x056E11cc8: 1f 92 push r111cca: 8f 93 push r2411ccc: 80 91 6d 05 lds r24, 0x056D11cd0: 1f 92 push r111cd2: 8f 93 push r2411cd4: 80 e2 ldi r24, 0x20 ; 3211cd6: 92 e1 ldi r25, 0x12 ; 1811cd8: 9f 93 push r2511cda: 8f 93 push r2411cdc: df 93 push r2911cde: cf 93 push r2811ce0: e0 91 78 06 lds r30, 0x067811ce4: f0 91 79 06 lds r31, 0x067911ce8: 09 95 icallbreak;11cea: 2d b7 in r18, 0x3d ; 6111cec: 3e b7 in r19, 0x3e ; 6211cee: 28 5e subi r18, 0xE8 ; 23211cf0: 3f 4f sbci r19, 0xFF ; 25511cf2: 0f b6 in r0, 0x3f ; 6311cf4: f8 94 cli11cf6: 3e bf out 0x3e, r19 ; 6211cf8: 0f be out 0x3f, r0 ; 6311cfa: 2d bf out 0x3d, r18 ; 6111cfc: 9a c2 rjmp .+1332 ; 0x12232 <Menu+0x13e4>case 15:LCD_printfxy(0,0,"BL-Ctrl Errors " );11cfe: 10 92 a4 04 sts 0x04A4, r111d02: 80 e1 ldi r24, 0x10 ; 1611d04: 92 e1 ldi r25, 0x12 ; 1811d06: 9f 93 push r2511d08: 8f 93 push r2411d0a: 80 e1 ldi r24, 0x10 ; 1611d0c: 97 e8 ldi r25, 0x87 ; 13511d0e: 9f 93 push r2511d10: 8f 93 push r2411d12: e0 91 78 06 lds r30, 0x067811d16: f0 91 79 06 lds r31, 0x067911d1a: 09 95 icall11d1c: c7 ec ldi r28, 0xC7 ; 19911d1e: d9 e0 ldi r29, 0x09 ; 911d20: 0f 90 pop r011d22: 0f 90 pop r011d24: 0f 90 pop r011d26: 0f 90 pop r011d28: 14 e1 ldi r17, 0x14 ; 20for(i=0;i<3;i++){LCD_printfxy(0,i+1,"%3d %3d %3d %3d ",Motor[i*4].State & MOTOR_STATE_ERROR_MASK,Motor[i*4+1].State & MOTOR_STATE_ERROR_MASK,Motor[i*4+2].State & MOTOR_STATE_ERROR_MASK,Motor[i*4+3].State & MOTOR_STATE_ERROR_MASK);11d2a: 0f 2e mov r0, r3111d2c: ff ef ldi r31, 0xFF ; 25511d2e: ef 2e mov r14, r3111d30: f1 e1 ldi r31, 0x11 ; 1711d32: ff 2e mov r15, r3111d34: f0 2d mov r31, r011d36: 0f 2e mov r0, r3111d38: f0 e1 ldi r31, 0x10 ; 1611d3a: cf 2e mov r12, r3111d3c: f7 e8 ldi r31, 0x87 ; 13511d3e: df 2e mov r13, r3111d40: f0 2d mov r31, r011d42: 10 93 a4 04 sts 0x04A4, r1711d46: 88 81 ld r24, Y11d48: 8f 77 andi r24, 0x7F ; 12711d4a: 1f 92 push r111d4c: 8f 93 push r2411d4e: fe 01 movw r30, r2811d50: 3f 97 sbiw r30, 0x0f ; 1511d52: 80 81 ld r24, Z11d54: 8f 77 andi r24, 0x7F ; 12711d56: 1f 92 push r111d58: 8f 93 push r2411d5a: 3f 97 sbiw r30, 0x0f ; 1511d5c: 80 81 ld r24, Z11d5e: 8f 77 andi r24, 0x7F ; 12711d60: 1f 92 push r111d62: 8f 93 push r2411d64: 3f 97 sbiw r30, 0x0f ; 1511d66: 80 81 ld r24, Z11d68: 8f 77 andi r24, 0x7F ; 12711d6a: 1f 92 push r111d6c: 8f 93 push r2411d6e: ff 92 push r1511d70: ef 92 push r1411d72: df 92 push r1311d74: cf 92 push r1211d76: e0 91 78 06 lds r30, 0x067811d7a: f0 91 79 06 lds r31, 0x067911d7e: 09 95 icall11d80: 1c 5e subi r17, 0xEC ; 23611d82: ec 96 adiw r28, 0x3c ; 60LCD_printfxy(0,2,"Position: %3i",ServoNickValue/4);LCD_printfxy(0,3,"Range:%3i-%3i",EE_Parameter.ServoNickMin,EE_Parameter.ServoNickMax);break;case 15:LCD_printfxy(0,0,"BL-Ctrl Errors " );for(i=0;i<3;i++)11d84: 8d b7 in r24, 0x3d ; 6111d86: 9e b7 in r25, 0x3e ; 6211d88: 0c 96 adiw r24, 0x0c ; 1211d8a: 0f b6 in r0, 0x3f ; 6311d8c: f8 94 cli11d8e: 9e bf out 0x3e, r25 ; 6211d90: 0f be out 0x3f, r0 ; 6311d92: 8d bf out 0x3d, r24 ; 6111d94: 10 35 cpi r17, 0x50 ; 8011d96: a9 f6 brne .-86 ; 0x11d42 <Menu+0xef4>11d98: 4c c2 rjmp .+1176 ; 0x12232 <Menu+0x13e4>{LCD_printfxy(0,i+1,"%3d %3d %3d %3d ",Motor[i*4].State & MOTOR_STATE_ERROR_MASK,Motor[i*4+1].State & MOTOR_STATE_ERROR_MASK,Motor[i*4+2].State & MOTOR_STATE_ERROR_MASK,Motor[i*4+3].State & MOTOR_STATE_ERROR_MASK);}break;case 16:LCD_printfxy(0,0,"BL Temperature" );11d9a: 10 92 a4 04 sts 0x04A4, r111d9e: 80 ef ldi r24, 0xF0 ; 24011da0: 91 e1 ldi r25, 0x11 ; 1711da2: 9f 93 push r2511da4: 8f 93 push r2411da6: 80 e1 ldi r24, 0x10 ; 1611da8: 97 e8 ldi r25, 0x87 ; 13511daa: 9f 93 push r2511dac: 8f 93 push r2411dae: e0 91 78 06 lds r30, 0x067811db2: f0 91 79 06 lds r31, 0x067911db6: 09 95 icall11db8: cb ec ldi r28, 0xCB ; 20311dba: d9 e0 ldi r29, 0x09 ; 911dbc: 0f 90 pop r011dbe: 0f 90 pop r011dc0: 0f 90 pop r011dc2: 0f 90 pop r011dc4: 14 e1 ldi r17, 0x14 ; 20for(i=0;i<3;i++){LCD_printfxy(0,i+1,"%3d %3d %3d %3d ",Motor[i*4].Temperature,Motor[i*4+1].Temperature,Motor[i*4+2].Temperature,Motor[i*4+3].Temperature);11dc6: 0f 2e mov r0, r3111dc8: ff ed ldi r31, 0xDF ; 22311dca: ef 2e mov r14, r3111dcc: f1 e1 ldi r31, 0x11 ; 1711dce: ff 2e mov r15, r3111dd0: f0 2d mov r31, r011dd2: 0f 2e mov r0, r3111dd4: f0 e1 ldi r31, 0x10 ; 1611dd6: cf 2e mov r12, r3111dd8: f7 e8 ldi r31, 0x87 ; 13511dda: df 2e mov r13, r3111ddc: f0 2d mov r31, r011dde: 10 93 a4 04 sts 0x04A4, r1711de2: 88 81 ld r24, Y11de4: 1f 92 push r111de6: 8f 93 push r2411de8: fe 01 movw r30, r2811dea: 3f 97 sbiw r30, 0x0f ; 1511dec: 80 81 ld r24, Z11dee: 1f 92 push r111df0: 8f 93 push r2411df2: 3f 97 sbiw r30, 0x0f ; 1511df4: 80 81 ld r24, Z11df6: 1f 92 push r111df8: 8f 93 push r2411dfa: 3f 97 sbiw r30, 0x0f ; 1511dfc: 80 81 ld r24, Z11dfe: 1f 92 push r111e00: 8f 93 push r2411e02: ff 92 push r1511e04: ef 92 push r1411e06: df 92 push r1311e08: cf 92 push r1211e0a: e0 91 78 06 lds r30, 0x067811e0e: f0 91 79 06 lds r31, 0x067911e12: 09 95 icall11e14: 1c 5e subi r17, 0xEC ; 23611e16: ec 96 adiw r28, 0x3c ; 60LCD_printfxy(0,i+1,"%3d %3d %3d %3d ",Motor[i*4].State & MOTOR_STATE_ERROR_MASK,Motor[i*4+1].State & MOTOR_STATE_ERROR_MASK,Motor[i*4+2].State & MOTOR_STATE_ERROR_MASK,Motor[i*4+3].State & MOTOR_STATE_ERROR_MASK);}break;case 16:LCD_printfxy(0,0,"BL Temperature" );for(i=0;i<3;i++)11e18: ed b7 in r30, 0x3d ; 6111e1a: fe b7 in r31, 0x3e ; 6211e1c: 3c 96 adiw r30, 0x0c ; 1211e1e: 0f b6 in r0, 0x3f ; 6311e20: f8 94 cli11e22: fe bf out 0x3e, r31 ; 6211e24: 0f be out 0x3f, r0 ; 6311e26: ed bf out 0x3d, r30 ; 6111e28: 10 35 cpi r17, 0x50 ; 8011e2a: c9 f6 brne .-78 ; 0x11dde <Menu+0xf90>11e2c: 02 c2 rjmp .+1028 ; 0x12232 <Menu+0x13e4>{LCD_printfxy(0,i+1,"%3d %3d %3d %3d ",Motor[i*4].Temperature,Motor[i*4+1].Temperature,Motor[i*4+2].Temperature,Motor[i*4+3].Temperature);}break;case 17:LCD_printfxy(0,0,"BL Current" );11e2e: 10 92 a4 04 sts 0x04A4, r111e32: 84 ed ldi r24, 0xD4 ; 21211e34: 91 e1 ldi r25, 0x11 ; 1711e36: 9f 93 push r2511e38: 8f 93 push r2411e3a: c0 e1 ldi r28, 0x10 ; 1611e3c: d7 e8 ldi r29, 0x87 ; 13511e3e: df 93 push r2911e40: cf 93 push r2811e42: e0 91 78 06 lds r30, 0x067811e46: f0 91 79 06 lds r31, 0x067911e4a: 09 95 icallLCD_printfxy(11,3,"(in 0.1A)" );11e4c: 87 e4 ldi r24, 0x47 ; 7111e4e: 80 93 a4 04 sts 0x04A4, r2411e52: 8a ec ldi r24, 0xCA ; 20211e54: 91 e1 ldi r25, 0x11 ; 1711e56: 9f 93 push r2511e58: 8f 93 push r2411e5a: df 93 push r2911e5c: cf 93 push r2811e5e: e0 91 78 06 lds r30, 0x067811e62: f0 91 79 06 lds r31, 0x067911e66: 09 95 icall11e68: ed b7 in r30, 0x3d ; 6111e6a: fe b7 in r31, 0x3e ; 6211e6c: 38 96 adiw r30, 0x08 ; 811e6e: 0f b6 in r0, 0x3f ; 6311e70: f8 94 cli11e72: fe bf out 0x3e, r31 ; 6211e74: 0f be out 0x3f, r0 ; 6311e76: ed bf out 0x3d, r30 ; 6111e78: c4 e0 ldi r28, 0x04 ; 411e7a: d0 e0 ldi r29, 0x00 ; 011e7c: 14 e1 ldi r17, 0x14 ; 20for(i=0;i<3;i++){LCD_printfxy(0,i+1,"%3d %3d %3d %3d ",BL3_Current(i*4),BL3_Current(i*4+1),BL3_Current(i*4+2),BL3_Current(i*4+3));11e7e: 0f 2e mov r0, r3111e80: f9 eb ldi r31, 0xB9 ; 18511e82: ef 2e mov r14, r3111e84: f1 e1 ldi r31, 0x11 ; 1711e86: ff 2e mov r15, r3111e88: f0 2d mov r31, r011e8a: 0f 2e mov r0, r3111e8c: f0 e1 ldi r31, 0x10 ; 1611e8e: 2f 2e mov r2, r3111e90: f7 e8 ldi r31, 0x87 ; 13511e92: 3f 2e mov r3, r3111e94: f0 2d mov r31, r011e96: 10 93 a4 04 sts 0x04A4, r1711e9a: c0 90 78 06 lds r12, 0x067811e9e: d0 90 79 06 lds r13, 0x067911ea2: 8c 2f mov r24, r2811ea4: 81 50 subi r24, 0x01 ; 111ea6: 0e 94 ce 21 call 0x439c ; 0x439c <BL3_Current>11eaa: 68 2e mov r6, r2411eac: 59 2e mov r5, r2511eae: 8c 2f mov r24, r2811eb0: 82 50 subi r24, 0x02 ; 211eb2: 0e 94 ce 21 call 0x439c ; 0x439c <BL3_Current>11eb6: 88 2e mov r8, r2411eb8: 79 2e mov r7, r2511eba: 8c 2f mov r24, r2811ebc: 83 50 subi r24, 0x03 ; 311ebe: 0e 94 ce 21 call 0x439c ; 0x439c <BL3_Current>11ec2: a8 2e mov r10, r2411ec4: 99 2e mov r9, r2511ec6: 8c 2f mov r24, r2811ec8: 84 50 subi r24, 0x04 ; 411eca: 0e 94 ce 21 call 0x439c ; 0x439c <BL3_Current>11ece: 5f 92 push r511ed0: 6f 92 push r611ed2: 7f 92 push r711ed4: 8f 92 push r811ed6: 9f 92 push r911ed8: af 92 push r1011eda: 9f 93 push r2511edc: 8f 93 push r2411ede: ff 92 push r1511ee0: ef 92 push r1411ee2: 3f 92 push r311ee4: 2f 92 push r211ee6: f6 01 movw r30, r1211ee8: 09 95 icallif(4 + i * 4 >= RequiredMotors) break;11eea: 80 91 3d 05 lds r24, 0x053D11eee: 90 e0 ldi r25, 0x00 ; 011ef0: 2d b7 in r18, 0x3d ; 6111ef2: 3e b7 in r19, 0x3e ; 6211ef4: 24 5f subi r18, 0xF4 ; 24411ef6: 3f 4f sbci r19, 0xFF ; 25511ef8: 0f b6 in r0, 0x3f ; 6311efa: f8 94 cli11efc: 3e bf out 0x3e, r19 ; 6211efe: 0f be out 0x3f, r0 ; 6311f00: 2d bf out 0x3d, r18 ; 6111f02: c8 17 cp r28, r2411f04: d9 07 cpc r29, r2511f06: 0c f0 brlt .+2 ; 0x11f0a <Menu+0x10bc>11f08: 94 c1 rjmp .+808 ; 0x12232 <Menu+0x13e4>11f0a: 1c 5e subi r17, 0xEC ; 23611f0c: 24 96 adiw r28, 0x04 ; 4}break;case 17:LCD_printfxy(0,0,"BL Current" );LCD_printfxy(11,3,"(in 0.1A)" );for(i=0;i<3;i++)11f0e: 10 35 cpi r17, 0x50 ; 8011f10: 11 f6 brne .-124 ; 0x11e96 <Menu+0x1048>11f12: 8f c1 rjmp .+798 ; 0x12232 <Menu+0x13e4>LCD_printfxy(0,i+1,"%3d %3d %3d %3d ",BL3_Current(i*4),BL3_Current(i*4+1),BL3_Current(i*4+2),BL3_Current(i*4+3));if(4 + i * 4 >= RequiredMotors) break;}break;case 18:LCD_printfxy(0,0,"BL-Ctrl found " );11f14: 10 92 a4 04 sts 0x04A4, r111f18: 8a ea ldi r24, 0xAA ; 17011f1a: 91 e1 ldi r25, 0x11 ; 1711f1c: 9f 93 push r2511f1e: 8f 93 push r2411f20: c0 e1 ldi r28, 0x10 ; 1611f22: d7 e8 ldi r29, 0x87 ; 13511f24: df 93 push r2911f26: cf 93 push r2811f28: e0 91 78 06 lds r30, 0x067811f2c: f0 91 79 06 lds r31, 0x067911f30: 09 95 icallLCD_printfxy(0,1," %c %c %c %c ",'-' + 4 * (Motor[0].State>>7),'-' + 5 * (Motor[1].State>>7),'-' + 6 * (Motor[2].State>>7),'-' + 7 * (Motor[3].State>>7));11f32: 84 e1 ldi r24, 0x14 ; 2011f34: 80 93 a4 04 sts 0x04A4, r2411f38: 20 91 c7 09 lds r18, 0x09C711f3c: 22 1f adc r18, r1811f3e: 22 27 eor r18, r1811f40: 22 1f adc r18, r1811f42: 30 e0 ldi r19, 0x00 ; 011f44: c9 01 movw r24, r1811f46: 88 0f add r24, r2411f48: 99 1f adc r25, r2511f4a: 88 0f add r24, r2411f4c: 99 1f adc r25, r2511f4e: 88 0f add r24, r2411f50: 99 1f adc r25, r2511f52: 82 1b sub r24, r1811f54: 93 0b sbc r25, r1911f56: 8d 96 adiw r24, 0x2d ; 4511f58: 9f 93 push r2511f5a: 8f 93 push r2411f5c: 80 91 b8 09 lds r24, 0x09B811f60: 88 1f adc r24, r2411f62: 88 27 eor r24, r2411f64: 88 1f adc r24, r2411f66: 90 e0 ldi r25, 0x00 ; 011f68: 9c 01 movw r18, r2411f6a: 22 0f add r18, r1811f6c: 33 1f adc r19, r1911f6e: 82 0f add r24, r1811f70: 93 1f adc r25, r1911f72: 88 0f add r24, r2411f74: 99 1f adc r25, r2511f76: 8d 96 adiw r24, 0x2d ; 4511f78: 9f 93 push r2511f7a: 8f 93 push r2411f7c: 80 91 a9 09 lds r24, 0x09A911f80: 88 1f adc r24, r2411f82: 88 27 eor r24, r2411f84: 88 1f adc r24, r2411f86: 90 e0 ldi r25, 0x00 ; 011f88: 9c 01 movw r18, r2411f8a: 22 0f add r18, r1811f8c: 33 1f adc r19, r1911f8e: 22 0f add r18, r1811f90: 33 1f adc r19, r1911f92: 82 0f add r24, r1811f94: 93 1f adc r25, r1911f96: 8d 96 adiw r24, 0x2d ; 4511f98: 9f 93 push r2511f9a: 8f 93 push r2411f9c: 80 91 9a 09 lds r24, 0x099A11fa0: 88 1f adc r24, r2411fa2: 88 27 eor r24, r2411fa4: 88 1f adc r24, r2411fa6: 90 e0 ldi r25, 0x00 ; 011fa8: 88 0f add r24, r2411faa: 99 1f adc r25, r2511fac: 88 0f add r24, r2411fae: 99 1f adc r25, r2511fb0: 8d 96 adiw r24, 0x2d ; 4511fb2: 9f 93 push r2511fb4: 8f 93 push r2411fb6: 86 e9 ldi r24, 0x96 ; 15011fb8: 91 e1 ldi r25, 0x11 ; 1711fba: 9f 93 push r2511fbc: 8f 93 push r2411fbe: df 93 push r2911fc0: cf 93 push r2811fc2: e0 91 78 06 lds r30, 0x067811fc6: f0 91 79 06 lds r31, 0x067911fca: 09 95 icallLCD_printfxy(0,2," %c %c %c %c ",'-' + 8 * (Motor[4].State>>7),'-' + 9 * (Motor[5].State>>7),'-' + 10 * (Motor[6].State>>7),'-' + 11 * (Motor[7].State>>7));11fcc: 88 e2 ldi r24, 0x28 ; 4011fce: 80 93 a4 04 sts 0x04A4, r2411fd2: 80 91 03 0a lds r24, 0x0A0311fd6: 88 1f adc r24, r2411fd8: 88 27 eor r24, r2411fda: 88 1f adc r24, r2411fdc: fb e0 ldi r31, 0x0B ; 1111fde: 8f 9f mul r24, r3111fe0: c0 01 movw r24, r011fe2: 11 24 eor r1, r111fe4: 8d 96 adiw r24, 0x2d ; 4511fe6: 9f 93 push r2511fe8: 8f 93 push r2411fea: 20 91 f4 09 lds r18, 0x09F411fee: 22 1f adc r18, r1811ff0: 22 27 eor r18, r1811ff2: 22 1f adc r18, r1811ff4: 30 e0 ldi r19, 0x00 ; 011ff6: c9 01 movw r24, r1811ff8: 88 0f add r24, r2411ffa: 99 1f adc r25, r2511ffc: 22 0f add r18, r1811ffe: 33 1f adc r19, r1912000: 22 0f add r18, r1812002: 33 1f adc r19, r1912004: 22 0f add r18, r1812006: 33 1f adc r19, r1912008: 82 0f add r24, r181200a: 93 1f adc r25, r191200c: 8d 96 adiw r24, 0x2d ; 451200e: 9f 93 push r2512010: 8f 93 push r2412012: 80 91 e5 09 lds r24, 0x09E512016: 88 1f adc r24, r2412018: 88 27 eor r24, r241201a: 88 1f adc r24, r241201c: 90 e0 ldi r25, 0x00 ; 01201e: 9c 01 movw r18, r2412020: 22 0f add r18, r1812022: 33 1f adc r19, r1912024: 22 0f add r18, r1812026: 33 1f adc r19, r1912028: 22 0f add r18, r181202a: 33 1f adc r19, r191202c: 82 0f add r24, r181202e: 93 1f adc r25, r1912030: 8d 96 adiw r24, 0x2d ; 4512032: 9f 93 push r2512034: 8f 93 push r2412036: 80 91 d6 09 lds r24, 0x09D61203a: 88 1f adc r24, r241203c: 88 27 eor r24, r241203e: 88 1f adc r24, r2412040: 90 e0 ldi r25, 0x00 ; 012042: 88 0f add r24, r2412044: 99 1f adc r25, r2512046: 88 0f add r24, r2412048: 99 1f adc r25, r251204a: 88 0f add r24, r241204c: 99 1f adc r25, r251204e: 8d 96 adiw r24, 0x2d ; 4512050: 9f 93 push r2512052: 8f 93 push r2412054: 82 e8 ldi r24, 0x82 ; 13012056: 91 e1 ldi r25, 0x11 ; 1712058: 9f 93 push r251205a: 8f 93 push r241205c: df 93 push r291205e: cf 93 push r2812060: e0 91 78 06 lds r30, 0x067812064: f0 91 79 06 lds r31, 0x067912068: 09 95 icallLCD_printfxy(0,3," %c - - - ",'-' + 12 * (Motor[8].State>>7));1206a: 8c e3 ldi r24, 0x3C ; 601206c: 80 93 a4 04 sts 0x04A4, r2412070: 80 91 12 0a lds r24, 0x0A1212074: 88 1f adc r24, r2412076: 88 27 eor r24, r2412078: 88 1f adc r24, r241207a: 90 e0 ldi r25, 0x00 ; 01207c: 9c 01 movw r18, r241207e: 22 0f add r18, r1812080: 33 1f adc r19, r1912082: 82 0f add r24, r1812084: 93 1f adc r25, r1912086: 88 0f add r24, r2412088: 99 1f adc r25, r251208a: 88 0f add r24, r241208c: 99 1f adc r25, r251208e: 8d 96 adiw r24, 0x2d ; 4512090: 9f 93 push r2512092: 8f 93 push r2412094: 81 e7 ldi r24, 0x71 ; 11312096: 91 e1 ldi r25, 0x11 ; 1712098: 9f 93 push r251209a: 8f 93 push r241209c: df 93 push r291209e: cf 93 push r28120a0: e0 91 78 06 lds r30, 0x0678120a4: f0 91 79 06 lds r31, 0x0679120a8: 09 95 icallif(Motor[9].State>>7) LCD_printfxy(4,3,"10");120aa: ed b7 in r30, 0x3d ; 61120ac: fe b7 in r31, 0x3e ; 62120ae: b2 96 adiw r30, 0x22 ; 34120b0: 0f b6 in r0, 0x3f ; 63120b2: f8 94 cli120b4: fe bf out 0x3e, r31 ; 62120b6: 0f be out 0x3f, r0 ; 63120b8: ed bf out 0x3d, r30 ; 61120ba: 80 91 21 0a lds r24, 0x0A21120be: 88 23 and r24, r24120c0: 9c f4 brge .+38 ; 0x120e8 <Menu+0x129a>120c2: 80 e4 ldi r24, 0x40 ; 64120c4: 80 93 a4 04 sts 0x04A4, r24120c8: 8e e6 ldi r24, 0x6E ; 110120ca: 91 e1 ldi r25, 0x11 ; 17120cc: 9f 93 push r25120ce: 8f 93 push r24120d0: ce 01 movw r24, r28120d2: 9f 93 push r25120d4: cf 93 push r28120d6: e0 91 78 06 lds r30, 0x0678120da: f0 91 79 06 lds r31, 0x0679120de: 09 95 icall120e0: 0f 90 pop r0120e2: 0f 90 pop r0120e4: 0f 90 pop r0120e6: 0f 90 pop r0if(Motor[10].State>>7) LCD_printfxy(8,3,"11");120e8: 80 91 30 0a lds r24, 0x0A30120ec: 88 23 and r24, r24120ee: a4 f4 brge .+40 ; 0x12118 <Menu+0x12ca>120f0: 84 e4 ldi r24, 0x44 ; 68120f2: 80 93 a4 04 sts 0x04A4, r24120f6: 8b e6 ldi r24, 0x6B ; 107120f8: 91 e1 ldi r25, 0x11 ; 17120fa: 9f 93 push r25120fc: 8f 93 push r24120fe: 80 e1 ldi r24, 0x10 ; 1612100: 97 e8 ldi r25, 0x87 ; 13512102: 9f 93 push r2512104: 8f 93 push r2412106: e0 91 78 06 lds r30, 0x06781210a: f0 91 79 06 lds r31, 0x06791210e: 09 95 icall12110: 0f 90 pop r012112: 0f 90 pop r012114: 0f 90 pop r012116: 0f 90 pop r0if(Motor[11].State>>7) LCD_printfxy(12,3,"12");12118: 80 91 3f 0a lds r24, 0x0A3F1211c: 88 23 and r24, r241211e: 0c f0 brlt .+2 ; 0x12122 <Menu+0x12d4>12120: 88 c0 rjmp .+272 ; 0x12232 <Menu+0x13e4>12122: 88 e4 ldi r24, 0x48 ; 7212124: 80 93 a4 04 sts 0x04A4, r2412128: 88 e6 ldi r24, 0x68 ; 1041212a: 91 e1 ldi r25, 0x11 ; 171212c: 9f 93 push r251212e: 8f 93 push r2412130: 80 e1 ldi r24, 0x10 ; 1612132: 97 e8 ldi r25, 0x87 ; 13512134: 9f 93 push r2512136: 8f 93 push r2412138: e0 91 78 06 lds r30, 0x06781213c: f0 91 79 06 lds r31, 0x067912140: 09 95 icall12142: 0f 90 pop r012144: 0f 90 pop r012146: 0f 90 pop r012148: 0f 90 pop r01214a: 73 c0 rjmp .+230 ; 0x12232 <Menu+0x13e4>break;case 19:LCD_printfxy(0,0,"BL Versions" );1214c: 10 92 a4 04 sts 0x04A4, r112150: 8c e5 ldi r24, 0x5C ; 9212152: 91 e1 ldi r25, 0x11 ; 1712154: 9f 93 push r2512156: 8f 93 push r2412158: 80 e1 ldi r24, 0x10 ; 161215a: 97 e8 ldi r25, 0x87 ; 1351215c: 9f 93 push r251215e: 8f 93 push r2412160: e0 91 78 06 lds r30, 0x067812164: f0 91 79 06 lds r31, 0x067912168: 09 95 icall1216a: c1 ed ldi r28, 0xD1 ; 2091216c: d9 e0 ldi r29, 0x09 ; 91216e: 0f 90 pop r012170: 0f 90 pop r012172: 0f 90 pop r012174: 0f 90 pop r012176: 04 e0 ldi r16, 0x04 ; 412178: 10 e0 ldi r17, 0x00 ; 01217a: 0f 2e mov r0, r311217c: f4 e1 ldi r31, 0x14 ; 201217e: bf 2e mov r11, r3112180: f0 2d mov r31, r0for(i=0;i<3;i++){LCD_printfxy(0,i+1,"%1d.%02d %1d.%02d %1d.%02d %1d.%02d",Motor[i*4].VersionMajor,Motor[i*4].VersionMinor,Motor[i*4+1].VersionMajor,Motor[i*4+1].VersionMinor,Motor[i*4+2].VersionMajor,Motor[i*4+2].VersionMinor,Motor[i*4+3].VersionMajor,Motor[i*4+3].VersionMinor);12182: 0f 2e mov r0, r3112184: f8 e3 ldi r31, 0x38 ; 5612186: cf 2e mov r12, r3112188: f1 e1 ldi r31, 0x11 ; 171218a: df 2e mov r13, r311218c: f0 2d mov r31, r01218e: 0f 2e mov r0, r3112190: f0 e1 ldi r31, 0x10 ; 1612192: ef 2e mov r14, r3112194: f7 e8 ldi r31, 0x87 ; 13512196: ff 2e mov r15, r3112198: f0 2d mov r31, r01219a: b0 92 a4 04 sts 0x04A4, r111219e: 88 81 ld r24, Y121a0: 1f 92 push r1121a2: 8f 93 push r24121a4: fe 01 movw r30, r28121a6: 31 97 sbiw r30, 0x01 ; 1121a8: 80 81 ld r24, Z121aa: 1f 92 push r1121ac: 8f 93 push r24121ae: 3e 97 sbiw r30, 0x0e ; 14121b0: 80 81 ld r24, Z121b2: 1f 92 push r1121b4: 8f 93 push r24121b6: 31 97 sbiw r30, 0x01 ; 1121b8: 80 81 ld r24, Z121ba: 1f 92 push r1121bc: 8f 93 push r24121be: 3e 97 sbiw r30, 0x0e ; 14121c0: 80 81 ld r24, Z121c2: 1f 92 push r1121c4: 8f 93 push r24121c6: 31 97 sbiw r30, 0x01 ; 1121c8: 80 81 ld r24, Z121ca: 1f 92 push r1121cc: 8f 93 push r24121ce: 3e 97 sbiw r30, 0x0e ; 14121d0: 80 81 ld r24, Z121d2: 1f 92 push r1121d4: 8f 93 push r24121d6: 31 97 sbiw r30, 0x01 ; 1121d8: 80 81 ld r24, Z121da: 1f 92 push r1121dc: 8f 93 push r24121de: df 92 push r13121e0: cf 92 push r12121e2: ff 92 push r15121e4: ef 92 push r14121e6: e0 91 78 06 lds r30, 0x0678121ea: f0 91 79 06 lds r31, 0x0679121ee: 09 95 icallif(4 + i * 4 >= RequiredMotors) break;121f0: 80 91 3d 05 lds r24, 0x053D121f4: 90 e0 ldi r25, 0x00 ; 0121f6: 2d b7 in r18, 0x3d ; 61121f8: 3e b7 in r19, 0x3e ; 62121fa: 2c 5e subi r18, 0xEC ; 236121fc: 3f 4f sbci r19, 0xFF ; 255121fe: 0f b6 in r0, 0x3f ; 6312200: f8 94 cli12202: 3e bf out 0x3e, r19 ; 6212204: 0f be out 0x3f, r0 ; 6312206: 2d bf out 0x3d, r18 ; 6112208: 08 17 cp r16, r241220a: 19 07 cpc r17, r251220c: 94 f4 brge .+36 ; 0x12232 <Menu+0x13e4>1220e: 34 e1 ldi r19, 0x14 ; 2012210: b3 0e add r11, r1912212: ec 96 adiw r28, 0x3c ; 6012214: 0c 5f subi r16, 0xFC ; 25212216: 1f 4f sbci r17, 0xFF ; 255if(Motor[10].State>>7) LCD_printfxy(8,3,"11");if(Motor[11].State>>7) LCD_printfxy(12,3,"12");break;case 19:LCD_printfxy(0,0,"BL Versions" );for(i=0;i<3;i++)12218: 80 e5 ldi r24, 0x50 ; 801221a: b8 12 cpse r11, r241221c: be cf rjmp .-132 ; 0x1219a <Menu+0x134c>1221e: 09 c0 rjmp .+18 ; 0x12232 <Menu+0x13e4>}break;*/#endifdefault:if(MenuePunkt == MaxMenue) MaxMenue--;12220: 80 91 90 02 lds r24, 0x029012224: 28 13 cpse r18, r2412226: 03 c0 rjmp .+6 ; 0x1222e <Menu+0x13e0>12228: 21 50 subi r18, 0x01 ; 11222a: 20 93 90 02 sts 0x0290, r18MenuePunkt = 0;1222e: 10 92 a3 04 sts 0x04A3, r1break;}RemoteKeys = 0;12232: 10 92 a2 04 sts 0x04A2, r1}12236: df 91 pop r2912238: cf 91 pop r281223a: 1f 91 pop r171223c: 0f 91 pop r161223e: ff 90 pop r1512240: ef 90 pop r1412242: df 90 pop r1312244: cf 90 pop r1212246: bf 90 pop r1112248: af 90 pop r101224a: 9f 90 pop r91224c: 8f 90 pop r81224e: 7f 90 pop r712250: 6f 90 pop r612252: 5f 90 pop r512254: 3f 90 pop r312256: 2f 90 pop r212258: 08 95 ret0001225a <c_cos_8192>:// Sinus with argument in degree at an angular resolution of 1 degree and a discretisation of 13 bit.const uint16_t pgm_sinlookup[91] PROGMEM = {0, 143, 286, 429, 571, 714, 856, 998, 1140, 1282, 1423, 1563, 1703, 1843, 1982, 2120, 2258, 2395, 2531, 2667, 2802, 2936, 3069, 3201, 3332, 3462, 3591, 3719, 3846, 3972, 4096, 4219, 4341, 4462, 4581, 4699, 4815, 4930, 5043, 5155, 5266, 5374, 5482, 5587, 5691, 5793, 5893, 5991, 6088, 6183, 6275, 6366, 6455, 6542, 6627, 6710, 6791, 6870, 6947, 7022, 7094, 7165, 7233, 7299, 7363, 7424, 7484, 7541, 7595, 7648, 7698, 7746, 7791, 7834, 7875, 7913, 7949, 7982, 8013, 8041, 8068, 8091, 8112, 8131, 8147, 8161, 8172, 8181, 8187, 8191, 8192};int16_t c_cos_8192(int16_t angle){1225a: 1f 93 push r17int8_t m,n;int16_t sinus;angle = 90 - angle; // we need the cosinus and not the sinus1225c: 2a e5 ldi r18, 0x5A ; 901225e: 30 e0 ldi r19, 0x00 ; 012260: a9 01 movw r20, r1812262: 48 1b sub r20, r2412264: 59 0b sbc r21, r2512266: ca 01 movw r24, r20// avoid negative anglesif (angle < 0)12268: 99 23 and r25, r251226a: 3c f4 brge .+14 ; 0x1227a <c_cos_8192+0x20>{m = -1;angle = abs(angle);1226c: 99 23 and r25, r251226e: 1c f4 brge .+6 ; 0x12276 <c_cos_8192+0x1c>12270: 91 95 neg r2512272: 81 95 neg r2412274: 91 09 sbc r25, r1int16_t sinus;angle = 90 - angle; // we need the cosinus and not the sinus// avoid negative anglesif (angle < 0){m = -1;12276: 1f ef ldi r17, 0xFF ; 25512278: 01 c0 rjmp .+2 ; 0x1227c <c_cos_8192+0x22>angle = abs(angle);}else m = +1;1227a: 11 e0 ldi r17, 0x01 ; 1// fold angle to intervall 0 to 359angle %= 360;1227c: 68 e6 ldi r22, 0x68 ; 1041227e: 71 e0 ldi r23, 0x01 ; 112280: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>12284: fc 01 movw r30, r24// check quadrantif (angle <= 90) n=1; // first quadrant12286: 8b 35 cpi r24, 0x5B ; 9112288: 91 05 cpc r25, r11228a: ec f0 brlt .+58 ; 0x122c6 <c_cos_8192+0x6c>else if ((angle > 90) && (angle <= 180)) {angle = 180 - angle; n = 1;} // second quadrant1228c: 9c 01 movw r18, r241228e: 2b 55 subi r18, 0x5B ; 9112290: 31 09 sbc r19, r112292: 2a 35 cpi r18, 0x5A ; 9012294: 31 05 cpc r19, r112296: 30 f4 brcc .+12 ; 0x122a4 <c_cos_8192+0x4a>12298: e4 eb ldi r30, 0xB4 ; 1801229a: f0 e0 ldi r31, 0x00 ; 01229c: e8 1b sub r30, r241229e: f9 0b sbc r31, r25122a0: 61 e0 ldi r22, 0x01 ; 1122a2: 12 c0 rjmp .+36 ; 0x122c8 <c_cos_8192+0x6e>else if ((angle > 180) && (angle <= 270)) {angle = angle - 180; n = -1;} // third quadrant122a4: 9c 01 movw r18, r24122a6: 25 5b subi r18, 0xB5 ; 181122a8: 31 09 sbc r19, r1122aa: 2a 35 cpi r18, 0x5A ; 90122ac: 31 05 cpc r19, r1122ae: 28 f4 brcc .+10 ; 0x122ba <c_cos_8192+0x60>122b0: fc 01 movw r30, r24122b2: e4 5b subi r30, 0xB4 ; 180122b4: f1 09 sbc r31, r1122b6: 6f ef ldi r22, 0xFF ; 255122b8: 07 c0 rjmp .+14 ; 0x122c8 <c_cos_8192+0x6e>else {angle = 360 - angle; n = -1;} //fourth quadrant122ba: e8 e6 ldi r30, 0x68 ; 104122bc: f1 e0 ldi r31, 0x01 ; 1122be: e8 1b sub r30, r24122c0: f9 0b sbc r31, r25122c2: 6f ef ldi r22, 0xFF ; 255122c4: 01 c0 rjmp .+2 ; 0x122c8 <c_cos_8192+0x6e>// fold angle to intervall 0 to 359angle %= 360;// check quadrantif (angle <= 90) n=1; // first quadrant122c6: 61 e0 ldi r22, 0x01 ; 1else if ((angle > 90) && (angle <= 180)) {angle = 180 - angle; n = 1;} // second quadrantelse if ((angle > 180) && (angle <= 270)) {angle = angle - 180; n = -1;} // third quadrantelse {angle = 360 - angle; n = -1;} //fourth quadrant// get lookup valuesinus = pgm_read_word(&pgm_sinlookup[angle]);122c8: ee 0f add r30, r30122ca: ff 1f adc r31, r31122cc: e5 5a subi r30, 0xA5 ; 165122ce: fa 4e sbci r31, 0xEA ; 234122d0: 25 91 lpm r18, Z+122d2: 34 91 lpm r19, Z// calculate sinus valuereturn (sinus * m * n);122d4: 12 03 mulsu r17, r18122d6: a0 01 movw r20, r0122d8: 13 9f mul r17, r19122da: 50 0d add r21, r0122dc: 11 24 eor r1, r1}122de: 64 03 mulsu r22, r20122e0: c0 01 movw r24, r0122e2: 65 9f mul r22, r21122e4: 90 0d add r25, r0122e6: 11 24 eor r1, r1122e8: 1f 91 pop r17122ea: 08 95 ret000122ec <rc_sum_init>://############################################################################// Clear the valuesvoid rc_sum_init(void)//############################################################################{122ec: 80 e0 ldi r24, 0x00 ; 0122ee: 90 e0 ldi r25, 0x00 ; 0unsigned char i;for(i=0;i<MAX_RC_IN;i++){if(i < 5) PPM_in[i] = 0; else PPM_in[i] = -127;122f0: 21 e8 ldi r18, 0x81 ; 129122f2: 3f ef ldi r19, 0xFF ; 255122f4: 85 30 cpi r24, 0x05 ; 5122f6: 40 f4 brcc .+16 ; 0x12308 <rc_sum_init+0x1c>122f8: fc 01 movw r30, r24122fa: ee 0f add r30, r30122fc: ff 1f adc r31, r31122fe: ef 5c subi r30, 0xCF ; 20712300: f7 4f sbci r31, 0xF7 ; 24712302: 11 82 std Z+1, r1 ; 0x0112304: 10 82 st Z, r112306: 07 c0 rjmp .+14 ; 0x12316 <rc_sum_init+0x2a>12308: fc 01 movw r30, r241230a: ee 0f add r30, r301230c: ff 1f adc r31, r311230e: ef 5c subi r30, 0xCF ; 20712310: f7 4f sbci r31, 0xF7 ; 24712312: 31 83 std Z+1, r19 ; 0x0112314: 20 83 st Z, r18PPM_diff[i] = 0;12316: fc 01 movw r30, r2412318: ee 0f add r30, r301231a: ff 1f adc r31, r311231c: e9 58 subi r30, 0x89 ; 1371231e: f7 4f sbci r31, 0xF7 ; 24712320: 11 82 std Z+1, r1 ; 0x0112322: 10 82 st Z, r112324: 01 96 adiw r24, 0x01 ; 1// Clear the valuesvoid rc_sum_init(void)//############################################################################{unsigned char i;for(i=0;i<MAX_RC_IN;i++)12326: 83 32 cpi r24, 0x23 ; 3512328: 91 05 cpc r25, r11232a: 21 f7 brne .-56 ; 0x122f4 <rc_sum_init+0x8>{if(i < 5) PPM_in[i] = 0; else PPM_in[i] = -127;PPM_diff[i] = 0;}PPM_in[PPM_IN_MAX] = +127;1232c: 8f e7 ldi r24, 0x7F ; 1271232e: 90 e0 ldi r25, 0x00 ; 012330: 90 93 70 08 sts 0x0870, r2512334: 80 93 6f 08 sts 0x086F, r24PPM_in[PPM_IN_OFF] = -127;12338: 81 e8 ldi r24, 0x81 ; 1291233a: 9f ef ldi r25, 0xFF ; 2551233c: 90 93 6e 08 sts 0x086E, r2512340: 80 93 6d 08 sts 0x086D, r24PPM_in[PPM_IN_MID] = 0;12344: 10 92 72 08 sts 0x0872, r112348: 10 92 71 08 sts 0x0871, r1AdNeutralGier = 0;1234c: 10 92 54 04 sts 0x0454, r112350: 10 92 53 04 sts 0x0453, r1AdNeutralRoll = 0;12354: 10 92 56 04 sts 0x0456, r112358: 10 92 55 04 sts 0x0455, r1AdNeutralNick = 0;1235c: 10 92 58 04 sts 0x0458, r112360: 10 92 57 04 sts 0x0457, r112364: 08 95 ret00012366 <__vector_12>:#ifndef ACT_S3D_SUMMENSIGNAL//############################################################################// Interrupt function for the PPM-InputISR(TIMER1_CAPT_vect)//############################################################################{12366: 1f 92 push r112368: 0f 92 push r01236a: 0f b6 in r0, 0x3f ; 631236c: 0f 92 push r01236e: 11 24 eor r1, r112370: 0b b6 in r0, 0x3b ; 5912372: 0f 92 push r012374: 2f 93 push r1812376: 3f 93 push r1912378: 4f 93 push r201237a: 5f 93 push r211237c: 6f 93 push r221237e: 7f 93 push r2312380: 8f 93 push r2412382: 9f 93 push r2512384: af 93 push r2612386: bf 93 push r2712388: cf 93 push r281238a: df 93 push r291238c: ef 93 push r301238e: ff 93 push r31static unsigned int AltICR=0;signed int signal = 0,tmp;static int index;signal = (unsigned int) ICR1 - AltICR;12390: e6 e8 ldi r30, 0x86 ; 13412392: f0 e0 ldi r31, 0x00 ; 012394: 80 81 ld r24, Z12396: 91 81 ldd r25, Z+1 ; 0x0112398: 20 91 a7 04 lds r18, 0x04A71239c: 30 91 a8 04 lds r19, 0x04A8123a0: 82 1b sub r24, r18123a2: 93 0b sbc r25, r19AltICR = ICR1;123a4: 20 81 ld r18, Z123a6: 31 81 ldd r19, Z+1 ; 0x01123a8: 30 93 a8 04 sts 0x04A8, r19123ac: 20 93 a7 04 sts 0x04A7, r18//Syncronisationspause? (3.52 ms < signal < 25.6 ms)if((signal > 1100) && (signal < 8000))123b0: 9c 01 movw r18, r24123b2: 2d 54 subi r18, 0x4D ; 77123b4: 34 40 sbci r19, 0x04 ; 4123b6: 23 3f cpi r18, 0xF3 ; 243123b8: 3a 41 sbci r19, 0x1A ; 26123ba: 88 f4 brcc .+34 ; 0x123de <__vector_12+0x78>{Channels = index;123bc: 80 91 a5 04 lds r24, 0x04A5123c0: 90 91 a6 04 lds r25, 0x04A6123c4: 80 93 30 08 sts 0x0830, r24if(index >= 4) NewPpmData = 0; // Null bedeutet: Neue Daten123c8: 04 97 sbiw r24, 0x04 ; 4123ca: 14 f0 brlt .+4 ; 0x123d0 <__vector_12+0x6a>123cc: 10 92 93 02 sts 0x0293, r1index = 1;123d0: 81 e0 ldi r24, 0x01 ; 1123d2: 90 e0 ldi r25, 0x00 ; 0123d4: 90 93 a6 04 sts 0x04A6, r25123d8: 80 93 a5 04 sts 0x04A5, r24123dc: c1 c0 rjmp .+386 ; 0x12560 <__vector_12+0x1fa>}else{if(index < 13+4)123de: 20 91 a5 04 lds r18, 0x04A5123e2: 30 91 a6 04 lds r19, 0x04A6123e6: 21 31 cpi r18, 0x11 ; 17123e8: 31 05 cpc r19, r1123ea: 0c f0 brlt .+2 ; 0x123ee <__vector_12+0x88>123ec: b9 c0 rjmp .+370 ; 0x12560 <__vector_12+0x1fa>{if((signal > 250) && (signal < 687))123ee: ac 01 movw r20, r24123f0: 4b 5f subi r20, 0xFB ; 251123f2: 51 09 sbc r21, r1123f4: 44 3b cpi r20, 0xB4 ; 180123f6: 51 40 sbci r21, 0x01 ; 1123f8: 08 f0 brcs .+2 ; 0x123fc <__vector_12+0x96>123fa: ac c0 rjmp .+344 ; 0x12554 <__vector_12+0x1ee>{signal -= PPM_Neutral;123fc: 40 91 91 02 lds r20, 0x029112400: 50 91 92 02 lds r21, 0x029212404: 84 1b sub r24, r2012406: 95 0b sbc r25, r21// Stabiles Signalif(EE_Parameter.FailsafeChannel == 0 || PPM_in[EE_Parameter.FailsafeChannel] < 100) // forces Failsafe if the receiver doesn't have 'signal loss' on Failsafe12408: e0 91 a8 05 lds r30, 0x05A81240c: ee 23 and r30, r301240e: 51 f0 breq .+20 ; 0x12424 <__vector_12+0xbe>12410: f0 e0 ldi r31, 0x00 ; 012412: ee 0f add r30, r3012414: ff 1f adc r31, r3112416: ef 5c subi r30, 0xCF ; 20712418: f7 4f sbci r31, 0xF7 ; 2471241a: 40 81 ld r20, Z1241c: 51 81 ldd r21, Z+1 ; 0x011241e: 44 36 cpi r20, 0x64 ; 10012420: 51 05 cpc r21, r112422: 04 f5 brge .+64 ; 0x12464 <__vector_12+0xfe>{if(abs(signal - PPM_in[index]) < 6) { if(SenderOkay < 200) SenderOkay += 10; else SenderOkay = 200;}12424: f9 01 movw r30, r1812426: ee 0f add r30, r3012428: ff 1f adc r31, r311242a: ef 5c subi r30, 0xCF ; 2071242c: f7 4f sbci r31, 0xF7 ; 2471242e: 40 81 ld r20, Z12430: 51 81 ldd r21, Z+1 ; 0x0112432: bc 01 movw r22, r2412434: 64 1b sub r22, r2012436: 75 0b sbc r23, r2112438: ab 01 movw r20, r221243a: 22 f4 brpl .+8 ; 0x12444 <__vector_12+0xde>1243c: 44 27 eor r20, r201243e: 55 27 eor r21, r2112440: 46 1b sub r20, r2212442: 57 0b sbc r21, r2312444: 46 30 cpi r20, 0x06 ; 612446: 51 05 cpc r21, r112448: 6c f4 brge .+26 ; 0x12464 <__vector_12+0xfe>1244a: 40 91 04 04 lds r20, 0x04041244e: 48 3c cpi r20, 0xC8 ; 20012450: 30 f4 brcc .+12 ; 0x1245e <__vector_12+0xf8>12452: 40 91 04 04 lds r20, 0x040412456: 46 5f subi r20, 0xF6 ; 24612458: 40 93 04 04 sts 0x0404, r201245c: 03 c0 rjmp .+6 ; 0x12464 <__vector_12+0xfe>1245e: 48 ec ldi r20, 0xC8 ; 20012460: 40 93 04 04 sts 0x0404, r20}tmp = (3 * (PPM_in[index]) + signal) / 4;12464: f9 01 movw r30, r1812466: ee 0f add r30, r3012468: ff 1f adc r31, r311246a: ef 5c subi r30, 0xCF ; 2071246c: f7 4f sbci r31, 0xF7 ; 2471246e: 40 81 ld r20, Z12470: 51 81 ldd r21, Z+1 ; 0x0112472: fa 01 movw r30, r2012474: ee 0f add r30, r3012476: ff 1f adc r31, r3112478: e4 0f add r30, r201247a: f5 1f adc r31, r211247c: e8 0f add r30, r241247e: f9 1f adc r31, r2512480: ff 23 and r31, r3112482: 0c f4 brge .+2 ; 0x12486 <__vector_12+0x120>12484: 33 96 adiw r30, 0x03 ; 312486: f5 95 asr r3112488: e7 95 ror r301248a: f5 95 asr r311248c: e7 95 ror r30if(tmp > signal+1) tmp--; else1248e: ac 01 movw r20, r2412490: 4f 5f subi r20, 0xFF ; 25512492: 5f 4f sbci r21, 0xFF ; 25512494: 4e 17 cp r20, r3012496: 5f 07 cpc r21, r3112498: 14 f4 brge .+4 ; 0x1249e <__vector_12+0x138>1249a: 31 97 sbiw r30, 0x01 ; 11249c: 05 c0 rjmp .+10 ; 0x124a8 <__vector_12+0x142>if(tmp < signal-1) tmp++;1249e: 01 97 sbiw r24, 0x01 ; 1124a0: e8 17 cp r30, r24124a2: f9 07 cpc r31, r25124a4: 0c f4 brge .+2 ; 0x124a8 <__vector_12+0x142>124a6: 31 96 adiw r30, 0x01 ; 1if(SenderOkay >= 195) PPM_diff[index] = ((tmp - PPM_in[index]) / 3) * 3;124a8: 80 91 04 04 lds r24, 0x0404124ac: 83 3c cpi r24, 0xC3 ; 195124ae: d0 f0 brcs .+52 ; 0x124e4 <__vector_12+0x17e>124b0: e9 01 movw r28, r18124b2: cc 0f add r28, r28124b4: dd 1f adc r29, r29124b6: de 01 movw r26, r28124b8: af 5c subi r26, 0xCF ; 207124ba: b7 4f sbci r27, 0xF7 ; 247124bc: 8d 91 ld r24, X+124be: 9c 91 ld r25, X124c0: af 01 movw r20, r30124c2: 48 1b sub r20, r24124c4: 59 0b sbc r21, r25124c6: ca 01 movw r24, r20124c8: 63 e0 ldi r22, 0x03 ; 3124ca: 70 e0 ldi r23, 0x00 ; 0124cc: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>124d0: cb 01 movw r24, r22124d2: 88 0f add r24, r24124d4: 99 1f adc r25, r25124d6: 68 0f add r22, r24124d8: 79 1f adc r23, r25124da: c9 58 subi r28, 0x89 ; 137124dc: d7 4f sbci r29, 0xF7 ; 247124de: 79 83 std Y+1, r23 ; 0x01124e0: 68 83 st Y, r22124e2: 08 c0 rjmp .+16 ; 0x124f4 <__vector_12+0x18e>else PPM_diff[index] = 0;124e4: d9 01 movw r26, r18124e6: aa 0f add r26, r26124e8: bb 1f adc r27, r27124ea: a9 58 subi r26, 0x89 ; 137124ec: b7 4f sbci r27, 0xF7 ; 247124ee: 11 96 adiw r26, 0x01 ; 1124f0: 1c 92 st X, r1124f2: 1e 92 st -X, r1PPM_in[index] = tmp;124f4: d9 01 movw r26, r18124f6: aa 0f add r26, r26124f8: bb 1f adc r27, r27124fa: af 5c subi r26, 0xCF ; 207124fc: b7 4f sbci r27, 0xF7 ; 247124fe: 11 96 adiw r26, 0x01 ; 112500: fc 93 st X, r3112502: ee 93 st -X, r30if(SenderOkay < 50)12504: 80 91 04 04 lds r24, 0x040412508: 82 33 cpi r24, 0x32 ; 501250a: 20 f5 brcc .+72 ; 0x12554 <__vector_12+0x1ee>{PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] = 0;1250c: e0 91 3f 05 lds r30, 0x053F12510: f0 e0 ldi r31, 0x00 ; 012512: ee 0f add r30, r3012514: ff 1f adc r31, r3112516: ef 5c subi r30, 0xCF ; 20712518: f7 4f sbci r31, 0xF7 ; 2471251a: 11 82 std Z+1, r1 ; 0x011251c: 10 82 st Z, r1PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]] = 0;1251e: e0 91 40 05 lds r30, 0x054012522: f0 e0 ldi r31, 0x00 ; 012524: ee 0f add r30, r3012526: ff 1f adc r31, r3112528: ef 5c subi r30, 0xCF ; 2071252a: f7 4f sbci r31, 0xF7 ; 2471252c: 11 82 std Z+1, r1 ; 0x011252e: 10 82 st Z, r1PPM_in[EE_Parameter.Kanalbelegung[K_GIER]] = 0;12530: e0 91 42 05 lds r30, 0x054212534: f0 e0 ldi r31, 0x00 ; 012536: ee 0f add r30, r3012538: ff 1f adc r31, r311253a: ef 5c subi r30, 0xCF ; 2071253c: f7 4f sbci r31, 0xF7 ; 2471253e: 11 82 std Z+1, r1 ; 0x0112540: 10 82 st Z, r1PPM_in[EE_Parameter.Kanalbelegung[K_GAS]] = 0;12542: e0 91 41 05 lds r30, 0x054112546: f0 e0 ldi r31, 0x00 ; 012548: ee 0f add r30, r301254a: ff 1f adc r31, r311254c: ef 5c subi r30, 0xCF ; 2071254e: f7 4f sbci r31, 0xF7 ; 24712550: 11 82 std Z+1, r1 ; 0x0112552: 10 82 st Z, r1}}index++;12554: 2f 5f subi r18, 0xFF ; 25512556: 3f 4f sbci r19, 0xFF ; 25512558: 30 93 a6 04 sts 0x04A6, r191255c: 20 93 a5 04 sts 0x04A5, r18if(index == 7) J5High; else J5Low; // Servosignal an J5 anlegen}*/}}}12560: ff 91 pop r3112562: ef 91 pop r3012564: df 91 pop r2912566: cf 91 pop r2812568: bf 91 pop r271256a: af 91 pop r261256c: 9f 91 pop r251256e: 8f 91 pop r2412570: 7f 91 pop r2312572: 6f 91 pop r2212574: 5f 91 pop r2112576: 4f 91 pop r2012578: 3f 91 pop r191257a: 2f 91 pop r181257c: 0f 90 pop r01257e: 0b be out 0x3b, r0 ; 5912580: 0f 90 pop r012582: 0f be out 0x3f, r0 ; 6312584: 0f 90 pop r012586: 1f 90 pop r112588: 18 95 reti0001258a <SbusUartInit>://############################################################################// USART1 initialisation from killagregvoid SbusUartInit(void)//############################################################################{1258a: cf 93 push r281258c: df 93 push r29// -- Start of USART1 initialisation for Spekturm seriell-mode// USART1 Control and Status Register A, B, C and baud rate registeruint8_t sreg = SREG;1258e: 9f b7 in r25, 0x3f ; 63uint16_t ubrr = (uint16_t) ((uint32_t) SYSCLK/(8 * 100000) - 1);// disable all interrupts before reconfigurationcli();12590: f8 94 cli// disable RX-InterruptUCSR1B &= ~(1 << RXCIE1);12592: a9 ec ldi r26, 0xC9 ; 20112594: b0 e0 ldi r27, 0x00 ; 012596: 8c 91 ld r24, X12598: 8f 77 andi r24, 0x7F ; 1271259a: 8c 93 st X, r24// disable TX-InterruptUCSR1B &= ~(1 << TXCIE1);1259c: 8c 91 ld r24, X1259e: 8f 7b andi r24, 0xBF ; 191125a0: 8c 93 st X, r24// disable DRE-InterruptUCSR1B &= ~(1 << UDRIE1);125a2: 8c 91 ld r24, X125a4: 8f 7d andi r24, 0xDF ; 223125a6: 8c 93 st X, r24PORTD |= (1 << PORTD3);DDRD |= (1 << DDD3);*/// USART0 Baud Rate Register// set clock dividerUBRR1H = (uint8_t)(ubrr>>8);125a8: 10 92 cd 00 sts 0x00CD, r1UBRR1L = (uint8_t)ubrr;125ac: 88 e1 ldi r24, 0x18 ; 24125ae: 80 93 cc 00 sts 0x00CC, r24// enable double speed operationUCSR1A |= (1 << U2X1);125b2: c8 ec ldi r28, 0xC8 ; 200125b4: d0 e0 ldi r29, 0x00 ; 0125b6: 88 81 ld r24, Y125b8: 82 60 ori r24, 0x02 ; 2125ba: 88 83 st Y, r24// enable receiver and transmitter//UCSR1B = (1<<RXEN1)|(1<<TXEN1);UCSR1B = (1<<RXEN1);125bc: 80 e1 ldi r24, 0x10 ; 16125be: 8c 93 st X, r24// set asynchronous modeUCSR1C &= ~(1 << UMSEL11);125c0: ea ec ldi r30, 0xCA ; 202125c2: f0 e0 ldi r31, 0x00 ; 0125c4: 80 81 ld r24, Z125c6: 8f 77 andi r24, 0x7F ; 127125c8: 80 83 st Z, r24UCSR1C &= ~(1 << UMSEL10);125ca: 80 81 ld r24, Z125cc: 8f 7b andi r24, 0xBF ; 191125ce: 80 83 st Z, r24// parityUCSR1C <= (1 << UPM11); // even125d0: 80 81 ld r24, ZUCSR1C &= ~(1 << UPM10);125d2: 80 81 ld r24, Z125d4: 8f 7e andi r24, 0xEF ; 239125d6: 80 83 st Z, r24// stop bitUCSR1C |= (1 << USBS1); // two125d8: 80 81 ld r24, Z125da: 88 60 ori r24, 0x08 ; 8125dc: 80 83 st Z, r24// 8-bitUCSR1B &= ~(1 << UCSZ12);125de: 8c 91 ld r24, X125e0: 8b 7f andi r24, 0xFB ; 251125e2: 8c 93 st X, r24UCSR1C |= (1 << UCSZ11);125e4: 80 81 ld r24, Z125e6: 84 60 ori r24, 0x04 ; 4125e8: 80 83 st Z, r24UCSR1C |= (1 << UCSZ10);125ea: 80 81 ld r24, Z125ec: 82 60 ori r24, 0x02 ; 2125ee: 80 83 st Z, r24// flush receive buffer explicitwhile(UCSR1A & (1<<RXC1)) UDR1;125f0: 88 81 ld r24, Y125f2: 88 23 and r24, r24125f4: 44 f4 brge .+16 ; 0x12606 <SbusUartInit+0x7c>125f6: ae ec ldi r26, 0xCE ; 206125f8: b0 e0 ldi r27, 0x00 ; 0125fa: e8 ec ldi r30, 0xC8 ; 200125fc: f0 e0 ldi r31, 0x00 ; 0125fe: 8c 91 ld r24, X12600: 80 81 ld r24, Z12602: 88 23 and r24, r2412604: e4 f3 brlt .-8 ; 0x125fe <SbusUartInit+0x74>// enable RX-interrupts at the endUCSR1B |= (1 << RXCIE1);12606: e9 ec ldi r30, 0xC9 ; 20112608: f0 e0 ldi r31, 0x00 ; 01260a: 80 81 ld r24, Z1260c: 80 68 ori r24, 0x80 ; 1281260e: 80 83 st Z, r24// -- End of USART1 initialisation// restore global interrupt flagssBusBuffer[23] |= 4; // This Bit contains the 'Signal loss'12610: e4 ed ldi r30, 0xD4 ; 21212612: f8 e0 ldi r31, 0x08 ; 812614: 80 81 ld r24, Z12616: 84 60 ori r24, 0x04 ; 412618: 80 83 st Z, r24SREG = sreg;1261a: 9f bf out 0x3f, r25 ; 63return;}1261c: df 91 pop r291261e: cf 91 pop r2812620: 08 95 ret00012622 <SbusParser>:// Is called by the uart RX interrupt//############################################################################void SbusParser(unsigned char udr){static unsigned char ptr = 0;if(!SpektrumTimer && udr == 0x0f) // wait for the start12622: 90 91 b0 04 lds r25, 0x04B012626: 91 11 cpse r25, r112628: 08 c0 rjmp .+16 ; 0x1263a <SbusParser+0x18>1262a: 8f 30 cpi r24, 0x0F ; 151262c: 31 f4 brne .+12 ; 0x1263a <SbusParser+0x18>{ptr = 0;1262e: 10 92 aa 04 sts 0x04AA, r1SpektrumTimer = 80; // 8ms gap12632: 80 e5 ldi r24, 0x50 ; 8012634: 80 93 b0 04 sts 0x04B0, r2412638: 08 95 ret}else{if(++ptr == 24) // last byte1263a: e0 91 aa 04 lds r30, 0x04AA1263e: ef 5f subi r30, 0xFF ; 25512640: e0 93 aa 04 sts 0x04AA, r3012644: e8 31 cpi r30, 0x18 ; 2412646: 21 f4 brne .+8 ; 0x12650 <SbusParser+0x2e>{NewSBusData = 1;12648: 81 e0 ldi r24, 0x01 ; 11264a: 80 93 ab 04 sts 0x04AB, r241264e: 08 95 ret}elseif(ptr > 24) ptr = 25;12650: e9 31 cpi r30, 0x19 ; 2512652: 20 f0 brcs .+8 ; 0x1265c <SbusParser+0x3a>12654: 89 e1 ldi r24, 0x19 ; 2512656: 80 93 aa 04 sts 0x04AA, r241265a: 08 95 retelse{sBusBuffer[ptr] = udr; // collect all bytes1265c: f0 e0 ldi r31, 0x00 ; 01265e: e3 54 subi r30, 0x43 ; 6712660: f7 4f sbci r31, 0xF7 ; 24712662: 80 83 st Z, r2412664: 08 95 ret00012666 <ProcessSBus>:}}}void ProcessSBus(void){12666: 5f 92 push r512668: 6f 92 push r61266a: 7f 92 push r71266c: 8f 92 push r81266e: 9f 92 push r912670: af 92 push r1012672: bf 92 push r1112674: cf 92 push r1212676: df 92 push r1312678: ef 92 push r141267a: ff 92 push r151267c: 0f 93 push r161267e: 1f 93 push r1712680: cf 93 push r2812682: df 93 push r29static unsigned char load = 0;unsigned char bitmask8 = 1, sbyte = 2, i, index = 1, process;unsigned int bitmask11 = 256;signed int signal = 0,tmp;if(!(sBusBuffer[23] & 4)) // This Bit contains the 'Signal loss'12684: 80 91 d4 08 lds r24, 0x08D412688: 82 fd sbrc r24, 21268a: a4 c0 rjmp .+328 ; 0x127d4 <ProcessSBus+0x16e>{TIMSK1 &= ~_BV(ICIE1); // disable PPM-Input1268c: ef e6 ldi r30, 0x6F ; 1111268e: f0 e0 ldi r31, 0x00 ; 012690: 80 81 ld r24, Z12692: 8f 7d andi r24, 0xDF ; 22312694: 80 83 st Z, r24if(EE_Parameter.FailsafeChannel == 0 || PPM_in[EE_Parameter.FailsafeChannel] < 100) // forces Failsafe if the receiver doesn't have 'signal loss' on Failsafe12696: e0 91 a8 05 lds r30, 0x05A81269a: ee 23 and r30, r301269c: 51 f0 breq .+20 ; 0x126b2 <ProcessSBus+0x4c>1269e: f0 e0 ldi r31, 0x00 ; 0126a0: ee 0f add r30, r30126a2: ff 1f adc r31, r31126a4: ef 5c subi r30, 0xCF ; 207126a6: f7 4f sbci r31, 0xF7 ; 247126a8: 80 81 ld r24, Z126aa: 91 81 ldd r25, Z+1 ; 0x01126ac: 84 36 cpi r24, 0x64 ; 100126ae: 91 05 cpc r25, r1126b0: 6c f4 brge .+26 ; 0x126cc <ProcessSBus+0x66>{if(SenderOkay < 200) SenderOkay += 20; else SenderOkay = 200;126b2: 80 91 04 04 lds r24, 0x0404126b6: 88 3c cpi r24, 0xC8 ; 200126b8: 30 f4 brcc .+12 ; 0x126c6 <ProcessSBus+0x60>126ba: 80 91 04 04 lds r24, 0x0404126be: 8c 5e subi r24, 0xEC ; 236126c0: 80 93 04 04 sts 0x0404, r24126c4: 03 c0 rjmp .+6 ; 0x126cc <ProcessSBus+0x66>126c6: 88 ec ldi r24, 0xC8 ; 200126c8: 80 93 04 04 sts 0x0404, r24}signal = sBusBuffer[1];126cc: 80 91 be 08 lds r24, 0x08BE126d0: 90 e0 ldi r25, 0x00 ; 0if(!load--) { process = (16*11 - 8); load = 2;} else process = (4*11 - 8); // lowers the processor load126d2: 20 91 a9 04 lds r18, 0x04A9126d6: 21 11 cpse r18, r1126d8: 80 c0 rjmp .+256 ; 0x127da <ProcessSBus+0x174>126da: 22 e0 ldi r18, 0x02 ; 2126dc: 20 93 a9 04 sts 0x04A9, r18126e0: 0f 2e mov r0, r31126e2: f8 ea ldi r31, 0xA8 ; 168126e4: bf 2e mov r11, r31126e6: f0 2d mov r31, r0126e8: 7f c0 rjmp .+254 ; 0x127e8 <ProcessSBus+0x182>for(i = 0; i < process; i++) // collect the single bits{if(sBusBuffer[sbyte] & bitmask8) signal |= bitmask11;126ea: ec 2d mov r30, r12126ec: f0 e0 ldi r31, 0x00 ; 0126ee: e3 54 subi r30, 0x43 ; 67126f0: f7 4f sbci r31, 0xF7 ; 247126f2: 50 81 ld r21, Z126f4: 54 23 and r21, r20126f6: 11 f0 breq .+4 ; 0x126fc <ProcessSBus+0x96>126f8: 82 2b or r24, r18126fa: 93 2b or r25, r19bitmask8 *= 2;126fc: 44 0f add r20, r20if(!bitmask8)126fe: 11 f4 brne .+4 ; 0x12704 <ProcessSBus+0x9e>{bitmask8 = 1;sbyte++;12700: c3 94 inc r12{if(sBusBuffer[sbyte] & bitmask8) signal |= bitmask11;bitmask8 *= 2;if(!bitmask8){bitmask8 = 1;12702: 49 2d mov r20, r9sbyte++;}bitmask11 *= 2;12704: 22 0f add r18, r1812706: 33 1f adc r19, r19if(bitmask11 == 2048)12708: 21 15 cp r18, r11270a: 58 e0 ldi r21, 0x08 ; 81270c: 35 07 cpc r19, r211270e: 09 f0 breq .+2 ; 0x12712 <ProcessSBus+0xac>12710: 5b c0 rjmp .+182 ; 0x127c8 <ProcessSBus+0x162>{bitmask11 = 1;signal = (signal-1024) / 5; // the resolution is higher than required12712: 94 50 subi r25, 0x04 ; 412714: b8 01 movw r22, r1612716: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>tmp = (3 * (PPM_in[index]) + signal) / 4;1271a: ea 2d mov r30, r101271c: f0 e0 ldi r31, 0x00 ; 01271e: df 01 movw r26, r3012720: aa 0f add r26, r2612722: bb 1f adc r27, r2712724: af 5c subi r26, 0xCF ; 20712726: b7 4f sbci r27, 0xF7 ; 24712728: 8d 91 ld r24, X+1272a: 9c 91 ld r25, X1272c: 9c 01 movw r18, r241272e: 22 0f add r18, r1812730: 33 1f adc r19, r1912732: 28 0f add r18, r2412734: 39 1f adc r19, r2512736: 26 0f add r18, r2212738: 37 1f adc r19, r231273a: 33 23 and r19, r191273c: 14 f4 brge .+4 ; 0x12742 <ProcessSBus+0xdc>1273e: 2d 5f subi r18, 0xFD ; 25312740: 3f 4f sbci r19, 0xFF ; 25512742: 35 95 asr r1912744: 27 95 ror r1812746: 35 95 asr r1912748: 27 95 ror r18if(tmp > signal+1) tmp--; else1274a: cb 01 movw r24, r221274c: 01 96 adiw r24, 0x01 ; 11274e: 82 17 cp r24, r1812750: 93 07 cpc r25, r1912752: 1c f4 brge .+6 ; 0x1275a <ProcessSBus+0xf4>12754: 21 50 subi r18, 0x01 ; 112756: 31 09 sbc r19, r112758: 07 c0 rjmp .+14 ; 0x12768 <ProcessSBus+0x102>if(tmp < signal-1) tmp++;1275a: 61 50 subi r22, 0x01 ; 11275c: 71 09 sbc r23, r11275e: 26 17 cp r18, r2212760: 37 07 cpc r19, r2312762: 14 f4 brge .+4 ; 0x12768 <ProcessSBus+0x102>12764: 2f 5f subi r18, 0xFF ; 25512766: 3f 4f sbci r19, 0xFF ; 255if(SenderOkay >= 195) PPM_diff[index] = ((tmp - PPM_in[index]) / 3) * 3;12768: 80 91 04 04 lds r24, 0x04041276c: 83 3c cpi r24, 0xC3 ; 1951276e: c8 f0 brcs .+50 ; 0x127a2 <ProcessSBus+0x13c>12770: ef 01 movw r28, r3012772: cc 0f add r28, r2812774: dd 1f adc r29, r2912776: de 01 movw r26, r2812778: af 5c subi r26, 0xCF ; 2071277a: b7 4f sbci r27, 0xF7 ; 2471277c: 8d 91 ld r24, X+1277e: 9c 91 ld r25, X12780: b9 01 movw r22, r1812782: 68 1b sub r22, r2412784: 79 0b sbc r23, r2512786: cb 01 movw r24, r2212788: b7 01 movw r22, r141278a: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>1278e: cb 01 movw r24, r2212790: 88 0f add r24, r2412792: 99 1f adc r25, r2512794: 68 0f add r22, r2412796: 79 1f adc r23, r2512798: c9 58 subi r28, 0x89 ; 1371279a: d7 4f sbci r29, 0xF7 ; 2471279c: 79 83 std Y+1, r23 ; 0x011279e: 68 83 st Y, r22127a0: 08 c0 rjmp .+16 ; 0x127b2 <ProcessSBus+0x14c>else PPM_diff[index] = 0;127a2: df 01 movw r26, r30127a4: aa 0f add r26, r26127a6: bb 1f adc r27, r27127a8: a9 58 subi r26, 0x89 ; 137127aa: b7 4f sbci r27, 0xF7 ; 247127ac: 11 96 adiw r26, 0x01 ; 1127ae: 1c 92 st X, r1127b0: 1e 92 st -X, r1PPM_in[index] = tmp;127b2: ee 0f add r30, r30127b4: ff 1f adc r31, r31127b6: ef 5c subi r30, 0xCF ; 207127b8: f7 4f sbci r31, 0xF7 ; 247127ba: 31 83 std Z+1, r19 ; 0x01127bc: 20 83 st Z, r18signal = 0;index++; // next channel127be: a3 94 inc r10if(tmp > signal+1) tmp--; elseif(tmp < signal-1) tmp++;if(SenderOkay >= 195) PPM_diff[index] = ((tmp - PPM_in[index]) / 3) * 3;else PPM_diff[index] = 0;PPM_in[index] = tmp;signal = 0;127c0: 88 2d mov r24, r8127c2: 97 2d mov r25, r7sbyte++;}bitmask11 *= 2;if(bitmask11 == 2048){bitmask11 = 1;127c4: 26 2d mov r18, r6127c6: 35 2d mov r19, r5{if(SenderOkay < 200) SenderOkay += 20; else SenderOkay = 200;}signal = sBusBuffer[1];if(!load--) { process = (16*11 - 8); load = 2;} else process = (4*11 - 8); // lowers the processor loadfor(i = 0; i < process; i++) // collect the single bits127c8: d3 94 inc r13127ca: db 14 cp r13, r11127cc: 08 f4 brcc .+2 ; 0x127d0 <ProcessSBus+0x16a>127ce: 8d cf rjmp .-230 ; 0x126ea <ProcessSBus+0x84>PPM_in[index] = tmp;signal = 0;index++; // next channel}}NewPpmData = 0; // Null bedeutet: Neue Daten127d0: 10 92 93 02 sts 0x0293, r1}NewSBusData = 0;127d4: 10 92 ab 04 sts 0x04AB, r1127d8: 1f c0 rjmp .+62 ; 0x12818 <ProcessSBus+0x1b2>if(EE_Parameter.FailsafeChannel == 0 || PPM_in[EE_Parameter.FailsafeChannel] < 100) // forces Failsafe if the receiver doesn't have 'signal loss' on Failsafe{if(SenderOkay < 200) SenderOkay += 20; else SenderOkay = 200;}signal = sBusBuffer[1];if(!load--) { process = (16*11 - 8); load = 2;} else process = (4*11 - 8); // lowers the processor load127da: 21 50 subi r18, 0x01 ; 1127dc: 20 93 a9 04 sts 0x04A9, r18127e0: 0f 2e mov r0, r31127e2: f4 e2 ldi r31, 0x24 ; 36127e4: bf 2e mov r11, r31127e6: f0 2d mov r31, r0void ProcessSBus(void){static unsigned char load = 0;unsigned char bitmask8 = 1, sbyte = 2, i, index = 1, process;unsigned int bitmask11 = 256;127e8: 20 e0 ldi r18, 0x00 ; 0127ea: 31 e0 ldi r19, 0x01 ; 1}void ProcessSBus(void){static unsigned char load = 0;unsigned char bitmask8 = 1, sbyte = 2, i, index = 1, process;127ec: aa 24 eor r10, r10127ee: a3 94 inc r10{if(SenderOkay < 200) SenderOkay += 20; else SenderOkay = 200;}signal = sBusBuffer[1];if(!load--) { process = (16*11 - 8); load = 2;} else process = (4*11 - 8); // lowers the processor loadfor(i = 0; i < process; i++) // collect the single bits127f0: d1 2c mov r13, r1}void ProcessSBus(void){static unsigned char load = 0;unsigned char bitmask8 = 1, sbyte = 2, i, index = 1, process;127f2: 68 94 set127f4: cc 24 eor r12, r12127f6: c1 f8 bld r12, 1127f8: 41 e0 ldi r20, 0x01 ; 1{if(sBusBuffer[sbyte] & bitmask8) signal |= bitmask11;bitmask8 *= 2;if(!bitmask8){bitmask8 = 1;127fa: 99 24 eor r9, r9127fc: 93 94 inc r9}bitmask11 *= 2;if(bitmask11 == 2048){bitmask11 = 1;signal = (signal-1024) / 5; // the resolution is higher than required127fe: 05 e0 ldi r16, 0x05 ; 512800: 10 e0 ldi r17, 0x00 ; 0if(tmp > signal+1) tmp--; elseif(tmp < signal-1) tmp++;if(SenderOkay >= 195) PPM_diff[index] = ((tmp - PPM_in[index]) / 3) * 3;else PPM_diff[index] = 0;PPM_in[index] = tmp;signal = 0;12802: 81 2c mov r8, r112804: 71 2c mov r7, r1sbyte++;}bitmask11 *= 2;if(bitmask11 == 2048){bitmask11 = 1;12806: 66 24 eor r6, r612808: 63 94 inc r61280a: 51 2c mov r5, r1signal = (signal-1024) / 5; // the resolution is higher than requiredtmp = (3 * (PPM_in[index]) + signal) / 4;if(tmp > signal+1) tmp--; elseif(tmp < signal-1) tmp++;if(SenderOkay >= 195) PPM_diff[index] = ((tmp - PPM_in[index]) / 3) * 3;1280c: 0f 2e mov r0, r311280e: f3 e0 ldi r31, 0x03 ; 312810: ef 2e mov r14, r3112812: f1 2c mov r15, r112814: f0 2d mov r31, r012816: 69 cf rjmp .-302 ; 0x126ea <ProcessSBus+0x84>}}NewPpmData = 0; // Null bedeutet: Neue Daten}NewSBusData = 0;}12818: df 91 pop r291281a: cf 91 pop r281281c: 1f 91 pop r171281e: 0f 91 pop r1612820: ff 90 pop r1512822: ef 90 pop r1412824: df 90 pop r1312826: cf 90 pop r1212828: bf 90 pop r111282a: af 90 pop r101282c: 9f 90 pop r91282e: 8f 90 pop r812830: 7f 90 pop r712832: 6f 90 pop r612834: 5f 90 pop r512836: 08 95 ret00012838 <SpektrumUartInit>://############################################################################// USART1 initialisation from killagregvoid SpektrumUartInit(void)//############################################################################{12838: cf 93 push r281283a: df 93 push r29// -- Start of USART1 initialisation for Spekturm seriell-mode// USART1 Control and Status Register A, B, C and baud rate registeruint8_t sreg = SREG;1283c: 9f b7 in r25, 0x3f ; 63uint16_t ubrr = (uint16_t) ((uint32_t) SYSCLK/(8 * 115200) - 1);// disable all interrupts before reconfigurationcli();1283e: f8 94 cli// disable RX-InterruptUCSR1B &= ~(1 << RXCIE1);12840: a9 ec ldi r26, 0xC9 ; 20112842: b0 e0 ldi r27, 0x00 ; 012844: 8c 91 ld r24, X12846: 8f 77 andi r24, 0x7F ; 12712848: 8c 93 st X, r24// disable TX-InterruptUCSR1B &= ~(1 << TXCIE1);1284a: 8c 91 ld r24, X1284c: 8f 7b andi r24, 0xBF ; 1911284e: 8c 93 st X, r24// disable DRE-InterruptUCSR1B &= ~(1 << UDRIE1);12850: 8c 91 ld r24, X12852: 8f 7d andi r24, 0xDF ; 22312854: 8c 93 st X, r24PORTD |= (1 << PORTD3);DDRD |= (1 << DDD3);*/// USART0 Baud Rate Register// set clock dividerUBRR1H = (uint8_t)(ubrr>>8);12856: 10 92 cd 00 sts 0x00CD, r1UBRR1L = (uint8_t)ubrr;1285a: 84 e1 ldi r24, 0x14 ; 201285c: 80 93 cc 00 sts 0x00CC, r24// enable double speed operationUCSR1A |= (1 << U2X1);12860: c8 ec ldi r28, 0xC8 ; 20012862: d0 e0 ldi r29, 0x00 ; 012864: 88 81 ld r24, Y12866: 82 60 ori r24, 0x02 ; 212868: 88 83 st Y, r24// enable receiver and transmitter//UCSR1B = (1<<RXEN1)|(1<<TXEN1);UCSR1B = (1<<RXEN1);1286a: 80 e1 ldi r24, 0x10 ; 161286c: 8c 93 st X, r24// set asynchronous modeUCSR1C &= ~(1 << UMSEL11);1286e: ea ec ldi r30, 0xCA ; 20212870: f0 e0 ldi r31, 0x00 ; 012872: 80 81 ld r24, Z12874: 8f 77 andi r24, 0x7F ; 12712876: 80 83 st Z, r24UCSR1C &= ~(1 << UMSEL10);12878: 80 81 ld r24, Z1287a: 8f 7b andi r24, 0xBF ; 1911287c: 80 83 st Z, r24// no parityUCSR1C &= ~(1 << UPM11);1287e: 80 81 ld r24, Z12880: 8f 7d andi r24, 0xDF ; 22312882: 80 83 st Z, r24UCSR1C &= ~(1 << UPM10);12884: 80 81 ld r24, Z12886: 8f 7e andi r24, 0xEF ; 23912888: 80 83 st Z, r24// 1 stop bitUCSR1C &= ~(1 << USBS1);1288a: 80 81 ld r24, Z1288c: 87 7f andi r24, 0xF7 ; 2471288e: 80 83 st Z, r24// 8-bitUCSR1B &= ~(1 << UCSZ12);12890: 8c 91 ld r24, X12892: 8b 7f andi r24, 0xFB ; 25112894: 8c 93 st X, r24UCSR1C |= (1 << UCSZ11);12896: 80 81 ld r24, Z12898: 84 60 ori r24, 0x04 ; 41289a: 80 83 st Z, r24UCSR1C |= (1 << UCSZ10);1289c: 80 81 ld r24, Z1289e: 82 60 ori r24, 0x02 ; 2128a0: 80 83 st Z, r24// flush receive buffer explicitwhile(UCSR1A & (1<<RXC1)) UDR1;128a2: 88 81 ld r24, Y128a4: 88 23 and r24, r24128a6: 44 f4 brge .+16 ; 0x128b8 <SpektrumUartInit+0x80>128a8: ae ec ldi r26, 0xCE ; 206128aa: b0 e0 ldi r27, 0x00 ; 0128ac: e8 ec ldi r30, 0xC8 ; 200128ae: f0 e0 ldi r31, 0x00 ; 0128b0: 8c 91 ld r24, X128b2: 80 81 ld r24, Z128b4: 88 23 and r24, r24128b6: e4 f3 brlt .-8 ; 0x128b0 <SpektrumUartInit+0x78>// enable RX-interrupts at the endUCSR1B |= (1 << RXCIE1);128b8: e9 ec ldi r30, 0xC9 ; 201128ba: f0 e0 ldi r31, 0x00 ; 0128bc: 80 81 ld r24, Z128be: 80 68 ori r24, 0x80 ; 128128c0: 80 83 st Z, r24// -- End of USART1 initialisation// restore global interrupt flagsSREG = sreg;128c2: 9f bf out 0x3f, r25 ; 63return;}128c4: df 91 pop r29128c6: cf 91 pop r28128c8: 08 95 ret000128ca <SpektrumParser>://############################################################################// Wird im UART-Interrupt aufgerufen//############################################################################void SpektrumParser(unsigned char c){128ca: cf 93 push r28128cc: df 93 push r29static unsigned char Sync=0, FrameCnt=0, ByteHigh=0, ReSync=1, Frame2=0;unsigned int Channel, index = 0;signed int signal = 0, tmp;int bCheckDelay;// c = UDR1; // get data byteif(ReSync == 1)128ce: 90 91 94 02 lds r25, 0x0294128d2: 91 30 cpi r25, 0x01 ; 1128d4: 61 f4 brne .+24 ; 0x128ee <SpektrumParser+0x24>{// wait for beginning of new frameReSync = 0;128d6: 10 92 94 02 sts 0x0294, r1SpektrumTimer = MIN_FRAMEGAP;128da: 84 e4 ldi r24, 0x44 ; 68128dc: 80 93 b0 04 sts 0x04B0, r24FrameCnt = 0;128e0: 10 92 af 04 sts 0x04AF, r1Sync = 0;128e4: 10 92 ae 04 sts 0x04AE, r1ByteHigh = 0;128e8: 10 92 ad 04 sts 0x04AD, r1128ec: 43 c1 rjmp .+646 ; 0x12b74 <SpektrumParser+0x2aa>}else{if(!SpektrumTimer) bCheckDelay = 1; else bCheckDelay = 0;//CheckDelay(FrameTimer);128ee: 41 e0 ldi r20, 0x01 ; 1128f0: 90 e0 ldi r25, 0x00 ; 0128f2: 20 91 b0 04 lds r18, 0x04B0128f6: 21 11 cpse r18, r1128f8: 40 e0 ldi r20, 0x00 ; 0128fa: 24 2f mov r18, r20128fc: 39 2f mov r19, r25if ( Sync == 0 )128fe: 90 91 ae 04 lds r25, 0x04AE12902: 91 11 cpse r25, r112904: 18 c0 rjmp .+48 ; 0x12936 <SpektrumParser+0x6c>{if(bCheckDelay)12906: 23 2b or r18, r1912908: 61 f0 breq .+24 ; 0x12922 <SpektrumParser+0x58>{// nach einer Pause von mind. 7ms erstes Sync-Character gefunden// Zeichen ignorieren, da Bedeutung unbekanntSync = 1;1290a: 81 e0 ldi r24, 0x01 ; 11290c: 80 93 ae 04 sts 0x04AE, r24FrameCnt ++;12910: 80 91 af 04 lds r24, 0x04AF12914: 8f 5f subi r24, 0xFF ; 25512916: 80 93 af 04 sts 0x04AF, r24SpektrumTimer = MAX_BYTEGAP;1291a: 83 e0 ldi r24, 0x03 ; 31291c: 80 93 b0 04 sts 0x04B0, r2412920: 12 c1 rjmp .+548 ; 0x12b46 <SpektrumParser+0x27c>}else{// Zeichen kam vor Ablauf der 7ms Sync-Pause// warten auf erstes Sync-ZeichenSpektrumTimer = MIN_FRAMEGAP;12922: 84 e4 ldi r24, 0x44 ; 6812924: 80 93 b0 04 sts 0x04B0, r24FrameCnt = 0;12928: 10 92 af 04 sts 0x04AF, r1Sync = 0;1292c: 10 92 ae 04 sts 0x04AE, r1ByteHigh = 0;12930: 10 92 ad 04 sts 0x04AD, r112934: 08 c1 rjmp .+528 ; 0x12b46 <SpektrumParser+0x27c>}}else if((Sync == 1) && !bCheckDelay)12936: 91 30 cpi r25, 0x01 ; 112938: 79 f4 brne .+30 ; 0x12958 <SpektrumParser+0x8e>1293a: 23 2b or r18, r191293c: 09 f0 breq .+2 ; 0x12940 <SpektrumParser+0x76>1293e: f9 c0 rjmp .+498 ; 0x12b32 <SpektrumParser+0x268>{// zweites Sync-Character ignorieren, Bedeutung unbekanntSync = 2;12940: 82 e0 ldi r24, 0x02 ; 212942: 80 93 ae 04 sts 0x04AE, r24FrameCnt ++;12946: 80 91 af 04 lds r24, 0x04AF1294a: 8f 5f subi r24, 0xFF ; 2551294c: 80 93 af 04 sts 0x04AF, r24SpektrumTimer = MAX_BYTEGAP;12950: 83 e0 ldi r24, 0x03 ; 312952: 80 93 b0 04 sts 0x04B0, r2412956: f7 c0 rjmp .+494 ; 0x12b46 <SpektrumParser+0x27c>}else if((Sync == 2) && !bCheckDelay)12958: 92 30 cpi r25, 0x02 ; 21295a: d9 f4 brne .+54 ; 0x12992 <SpektrumParser+0xc8>1295c: 23 2b or r18, r191295e: 09 f0 breq .+2 ; 0x12962 <SpektrumParser+0x98>12960: e8 c0 rjmp .+464 ; 0x12b32 <SpektrumParser+0x268>{SpektrumTimer = MAX_BYTEGAP;12962: 93 e0 ldi r25, 0x03 ; 312964: 90 93 b0 04 sts 0x04B0, r25// Datenbyte highByteHigh = c;12968: 80 93 ad 04 sts 0x04AD, r24if (FrameCnt == 2)1296c: 90 91 af 04 lds r25, 0x04AF12970: 92 30 cpi r25, 0x02 ; 212972: 41 f4 brne .+16 ; 0x12984 <SpektrumParser+0xba>{// is 1st Byte of Channel-data// Frame 1 with Channel 1-7 comming nextFrame2 = 0;if(ByteHigh & 0x80)12974: 88 23 and r24, r2412976: 1c f0 brlt .+6 ; 0x1297e <SpektrumParser+0xb4>ByteHigh = c;if (FrameCnt == 2){// is 1st Byte of Channel-data// Frame 1 with Channel 1-7 comming nextFrame2 = 0;12978: 10 92 ac 04 sts 0x04AC, r11297c: 03 c0 rjmp .+6 ; 0x12984 <SpektrumParser+0xba>if(ByteHigh & 0x80){// DS9: Frame 2 with Channel 8-9 comming nextFrame2 = 1;1297e: 81 e0 ldi r24, 0x01 ; 112980: 80 93 ac 04 sts 0x04AC, r24}}Sync = 3;12984: 83 e0 ldi r24, 0x03 ; 312986: 80 93 ae 04 sts 0x04AE, r24FrameCnt ++;1298a: 9f 5f subi r25, 0xFF ; 2551298c: 90 93 af 04 sts 0x04AF, r2512990: da c0 rjmp .+436 ; 0x12b46 <SpektrumParser+0x27c>}else if((Sync == 3) && !bCheckDelay)12992: 93 30 cpi r25, 0x03 ; 312994: 09 f0 breq .+2 ; 0x12998 <SpektrumParser+0xce>12996: cd c0 rjmp .+410 ; 0x12b32 <SpektrumParser+0x268>12998: 23 2b or r18, r191299a: 09 f0 breq .+2 ; 0x1299e <SpektrumParser+0xd4>1299c: ca c0 rjmp .+404 ; 0x12b32 <SpektrumParser+0x268>{// Datenbyte low// High-Byte for next channel comes nextSpektrumTimer = MAX_BYTEGAP;1299e: 90 93 b0 04 sts 0x04B0, r25Sync = 2;129a2: 92 e0 ldi r25, 0x02 ; 2129a4: 90 93 ae 04 sts 0x04AE, r25FrameCnt ++;129a8: 90 91 af 04 lds r25, 0x04AF129ac: 9f 5f subi r25, 0xFF ; 255129ae: 90 93 af 04 sts 0x04AF, r25Channel = ((unsigned int)ByteHigh << 8) | c;129b2: 20 91 ad 04 lds r18, 0x04AD129b6: 90 e0 ldi r25, 0x00 ; 0129b8: 92 2b or r25, r18if(EE_Parameter.Receiver == RECEIVER_SPEKTRUM)129ba: 30 91 65 05 lds r19, 0x0565129be: 31 30 cpi r19, 0x01 ; 1129c0: 59 f4 brne .+22 ; 0x129d8 <SpektrumParser+0x10e>{signal = Channel & 0x3ff;129c2: 93 70 andi r25, 0x03 ; 3signal -= 0x200; // Offset, range 0x000..0x3ff?129c4: 92 50 subi r25, 0x02 ; 2signal = signal/3; // scaling to fit PPM resolution129c6: 63 e0 ldi r22, 0x03 ; 3129c8: 70 e0 ldi r23, 0x00 ; 0129ca: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>index = (ByteHigh >> 2) & 0x0f;129ce: 26 95 lsr r18129d0: 26 95 lsr r18129d2: 2f 70 andi r18, 0x0F ; 15129d4: 30 e0 ldi r19, 0x00 ; 0129d6: 1c c0 rjmp .+56 ; 0x12a10 <SpektrumParser+0x146>}elseif(EE_Parameter.Receiver == RECEIVER_SPEKTRUM_HI_RES)129d8: 32 30 cpi r19, 0x02 ; 2129da: 61 f4 brne .+24 ; 0x129f4 <SpektrumParser+0x12a>{signal = Channel & 0x7ff;129dc: 97 70 andi r25, 0x07 ; 7signal -= 0x400; // Offset, range 0x000..0x7ff?129de: 94 50 subi r25, 0x04 ; 4signal = signal/6; // scaling to fit PPM resolution129e0: 66 e0 ldi r22, 0x06 ; 6129e2: 70 e0 ldi r23, 0x00 ; 0129e4: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>index = (ByteHigh >> 3) & 0x0f;129e8: 26 95 lsr r18129ea: 26 95 lsr r18129ec: 26 95 lsr r18129ee: 2f 70 andi r18, 0x0F ; 15129f0: 30 e0 ldi r19, 0x00 ; 0129f2: 0e c0 rjmp .+28 ; 0x12a10 <SpektrumParser+0x146>}else//if(EE_Parameter.Receiver == RECEIVER_SPEKTRUM_LOW_RES){signal = Channel & 0x3ff;129f4: 93 70 andi r25, 0x03 ; 3signal -= 360; // Offset, range 0x000..0x3ff?129f6: 88 56 subi r24, 0x68 ; 104129f8: 91 40 sbci r25, 0x01 ; 1signal = signal/2; // scaling to fit PPM resolution129fa: bc 01 movw r22, r24129fc: 99 23 and r25, r25129fe: 14 f4 brge .+4 ; 0x12a04 <SpektrumParser+0x13a>12a00: 6f 5f subi r22, 0xFF ; 25512a02: 7f 4f sbci r23, 0xFF ; 25512a04: 75 95 asr r2312a06: 67 95 ror r22index = (ByteHigh >> 2) & 0x0f;12a08: 26 95 lsr r1812a0a: 26 95 lsr r1812a0c: 2f 70 andi r18, 0x0F ; 1512a0e: 30 e0 ldi r19, 0x00 ; 0}index++;12a10: 2f 5f subi r18, 0xFF ; 25512a12: 3f 4f sbci r19, 0xFF ; 255if(index < 13)12a14: 2d 30 cpi r18, 0x0D ; 1312a16: 31 05 cpc r19, r112a18: 08 f0 brcs .+2 ; 0x12a1c <SpektrumParser+0x152>12a1a: 84 c0 rjmp .+264 ; 0x12b24 <SpektrumParser+0x25a>// Stabiles Signal#if defined (RECEIVER_SPEKTRUM_DX7EXP) || defined (RECEIVER_SPEKTRUM_DX8EXP)if (index == 2) index = 4; // Analog channel reassigment (2 <-> 4) for logical numbering (1,2,3,4)else if (index == 4) index = 2;#endifif(abs(signal - PPM_in[index]) < 6)12a1c: f9 01 movw r30, r1812a1e: ee 0f add r30, r3012a20: ff 1f adc r31, r3112a22: ef 5c subi r30, 0xCF ; 20712a24: f7 4f sbci r31, 0xF7 ; 24712a26: 80 81 ld r24, Z12a28: 91 81 ldd r25, Z+1 ; 0x0112a2a: ab 01 movw r20, r2212a2c: 48 1b sub r20, r2412a2e: 59 0b sbc r21, r2512a30: ca 01 movw r24, r2012a32: 99 23 and r25, r2512a34: 24 f4 brge .+8 ; 0x12a3e <SpektrumParser+0x174>12a36: 88 27 eor r24, r2412a38: 99 27 eor r25, r2512a3a: 84 1b sub r24, r2012a3c: 95 0b sbc r25, r2112a3e: 06 97 sbiw r24, 0x06 ; 612a40: 04 f5 brge .+64 ; 0x12a82 <SpektrumParser+0x1b8>{if(EE_Parameter.FailsafeChannel == 0 || PPM_in[EE_Parameter.FailsafeChannel] < 100) // forces Failsafe if the receiver doesn't have 'signal loss' on Failsafe12a42: e0 91 a8 05 lds r30, 0x05A812a46: ee 23 and r30, r3012a48: 51 f0 breq .+20 ; 0x12a5e <SpektrumParser+0x194>12a4a: f0 e0 ldi r31, 0x00 ; 012a4c: ee 0f add r30, r3012a4e: ff 1f adc r31, r3112a50: ef 5c subi r30, 0xCF ; 20712a52: f7 4f sbci r31, 0xF7 ; 24712a54: 80 81 ld r24, Z12a56: 91 81 ldd r25, Z+1 ; 0x0112a58: 84 36 cpi r24, 0x64 ; 10012a5a: 91 05 cpc r25, r112a5c: 94 f4 brge .+36 ; 0x12a82 <SpektrumParser+0x1b8>{if(SenderOkay < 200) SenderOkay += 10;12a5e: 80 91 04 04 lds r24, 0x040412a62: 88 3c cpi r24, 0xC8 ; 20012a64: 30 f4 brcc .+12 ; 0x12a72 <SpektrumParser+0x1a8>12a66: 80 91 04 04 lds r24, 0x040412a6a: 86 5f subi r24, 0xF6 ; 24612a6c: 80 93 04 04 sts 0x0404, r2412a70: 08 c0 rjmp .+16 ; 0x12a82 <SpektrumParser+0x1b8>else{SenderOkay = 200;12a72: 88 ec ldi r24, 0xC8 ; 20012a74: 80 93 04 04 sts 0x0404, r24TIMSK1 &= ~_BV(ICIE1); // disable PPM-Input12a78: ef e6 ldi r30, 0x6F ; 11112a7a: f0 e0 ldi r31, 0x00 ; 012a7c: 80 81 ld r24, Z12a7e: 8f 7d andi r24, 0xDF ; 22312a80: 80 83 st Z, r24}}}tmp = (3 * (PPM_in[index]) + signal) / 4;12a82: f9 01 movw r30, r1812a84: ee 0f add r30, r3012a86: ff 1f adc r31, r3112a88: ef 5c subi r30, 0xCF ; 20712a8a: f7 4f sbci r31, 0xF7 ; 24712a8c: 80 81 ld r24, Z12a8e: 91 81 ldd r25, Z+1 ; 0x0112a90: fc 01 movw r30, r2412a92: ee 0f add r30, r3012a94: ff 1f adc r31, r3112a96: e8 0f add r30, r2412a98: f9 1f adc r31, r2512a9a: e6 0f add r30, r2212a9c: f7 1f adc r31, r2312a9e: ff 23 and r31, r3112aa0: 0c f4 brge .+2 ; 0x12aa4 <SpektrumParser+0x1da>12aa2: 33 96 adiw r30, 0x03 ; 312aa4: f5 95 asr r3112aa6: e7 95 ror r3012aa8: f5 95 asr r3112aaa: e7 95 ror r30if(tmp > signal+1) tmp--; else12aac: cb 01 movw r24, r2212aae: 01 96 adiw r24, 0x01 ; 112ab0: 8e 17 cp r24, r3012ab2: 9f 07 cpc r25, r3112ab4: 14 f4 brge .+4 ; 0x12aba <SpektrumParser+0x1f0>12ab6: 31 97 sbiw r30, 0x01 ; 112ab8: 06 c0 rjmp .+12 ; 0x12ac6 <SpektrumParser+0x1fc>if(tmp < signal-1) tmp++;12aba: 61 50 subi r22, 0x01 ; 112abc: 71 09 sbc r23, r112abe: e6 17 cp r30, r2212ac0: f7 07 cpc r31, r2312ac2: 0c f4 brge .+2 ; 0x12ac6 <SpektrumParser+0x1fc>12ac4: 31 96 adiw r30, 0x01 ; 1else if (index == 7) s_update(7,signal); // R Trim (CH7)else if (index == 5) s_update(8,signal); // AUX2 (CH8)else if (index == 8) s_update(11,signal); // AUX3 (CH11)#elseif(SenderOkay >= 180) PPM_diff[index] = ((tmp - PPM_in[index]) / 3) * 3;12ac6: 80 91 04 04 lds r24, 0x040412aca: 84 3b cpi r24, 0xB4 ; 18012acc: d0 f0 brcs .+52 ; 0x12b02 <SpektrumParser+0x238>12ace: e9 01 movw r28, r1812ad0: cc 0f add r28, r2812ad2: dd 1f adc r29, r2912ad4: de 01 movw r26, r2812ad6: af 5c subi r26, 0xCF ; 20712ad8: b7 4f sbci r27, 0xF7 ; 24712ada: 8d 91 ld r24, X+12adc: 9c 91 ld r25, X12ade: af 01 movw r20, r3012ae0: 48 1b sub r20, r2412ae2: 59 0b sbc r21, r2512ae4: ca 01 movw r24, r2012ae6: 63 e0 ldi r22, 0x03 ; 312ae8: 70 e0 ldi r23, 0x00 ; 012aea: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>12aee: cb 01 movw r24, r2212af0: 88 0f add r24, r2412af2: 99 1f adc r25, r2512af4: 68 0f add r22, r2412af6: 79 1f adc r23, r2512af8: c9 58 subi r28, 0x89 ; 13712afa: d7 4f sbci r29, 0xF7 ; 24712afc: 79 83 std Y+1, r23 ; 0x0112afe: 68 83 st Y, r2212b00: 08 c0 rjmp .+16 ; 0x12b12 <SpektrumParser+0x248>else PPM_diff[index] = 0;12b02: d9 01 movw r26, r1812b04: aa 0f add r26, r2612b06: bb 1f adc r27, r2712b08: a9 58 subi r26, 0x89 ; 13712b0a: b7 4f sbci r27, 0xF7 ; 24712b0c: 11 96 adiw r26, 0x01 ; 112b0e: 1c 92 st X, r112b10: 1e 92 st -X, r1PPM_in[index] = tmp;12b12: d9 01 movw r26, r1812b14: aa 0f add r26, r2612b16: bb 1f adc r27, r2712b18: af 5c subi r26, 0xCF ; 20712b1a: b7 4f sbci r27, 0xF7 ; 24712b1c: 11 96 adiw r26, 0x01 ; 112b1e: fc 93 st X, r3112b20: ee 93 st -X, r3012b22: 11 c0 rjmp .+34 ; 0x12b46 <SpektrumParser+0x27c>#endif}else if(index > 17) ReSync = 1; // hier stimmt was nicht: neu synchronisieren12b24: 22 31 cpi r18, 0x12 ; 1812b26: 31 05 cpc r19, r112b28: 70 f0 brcs .+28 ; 0x12b46 <SpektrumParser+0x27c>12b2a: 81 e0 ldi r24, 0x01 ; 112b2c: 80 93 94 02 sts 0x0294, r2412b30: 0a c0 rjmp .+20 ; 0x12b46 <SpektrumParser+0x27c>}else{// hier stimmt was nicht: neu synchronisierenReSync = 1;12b32: 81 e0 ldi r24, 0x01 ; 112b34: 80 93 94 02 sts 0x0294, r24FrameCnt = 0;12b38: 10 92 af 04 sts 0x04AF, r1Frame2 = 0;12b3c: 10 92 ac 04 sts 0x04AC, r1// new frame next, nach fruehestens 7ms erwartetSpektrumTimer = MIN_FRAMEGAP;12b40: 84 e4 ldi r24, 0x44 ; 6812b42: 80 93 b0 04 sts 0x04B0, r24}// 16 Bytes eingetroffen -> Komplettif(FrameCnt >= 16)12b46: 80 91 af 04 lds r24, 0x04AF12b4a: 80 31 cpi r24, 0x10 ; 1612b4c: 98 f0 brcs .+38 ; 0x12b74 <SpektrumParser+0x2aa>{// Frame completeif(Frame2 == 0)12b4e: 80 91 ac 04 lds r24, 0x04AC12b52: 81 11 cpse r24, r112b54: 06 c0 rjmp .+12 ; 0x12b62 <SpektrumParser+0x298>{// Null bedeutet: Neue Daten// nur beim ersten Frame (CH 0-7) setzenif(!ReSync) NewPpmData = 0;12b56: 80 91 94 02 lds r24, 0x029412b5a: 81 11 cpse r24, r112b5c: 02 c0 rjmp .+4 ; 0x12b62 <SpektrumParser+0x298>12b5e: 10 92 93 02 sts 0x0293, r1}FrameCnt = 0;12b62: 10 92 af 04 sts 0x04AF, r1Frame2 = 0;12b66: 10 92 ac 04 sts 0x04AC, r1Sync = 0;12b6a: 10 92 ae 04 sts 0x04AE, r1SpektrumTimer = MIN_FRAMEGAP;12b6e: 84 e4 ldi r24, 0x44 ; 6812b70: 80 93 b0 04 sts 0x04B0, r24}}}12b74: df 91 pop r2912b76: cf 91 pop r2812b78: 08 95 ret00012b7a <SPI_MasterInit>:#ifdef USE_SPI_COMMUNICATION//------------------------------------------------------void SPI_MasterInit(void){DDR_SPI |= (1<<DD_MOSI)|(1<<DD_SCK); // Set MOSI and SCK output, all others input12b7a: 84 b1 in r24, 0x04 ; 412b7c: 80 6a ori r24, 0xA0 ; 16012b7e: 84 b9 out 0x04, r24 ; 4SLAVE_SELECT_DDR_PORT |= (1 << SPI_SLAVE_SELECT);12b80: 3d 9a sbi 0x07, 5 ; 7SPCR = (1<<SPE)|(1<<MSTR)|(1<<SPR1)|(0<<SPR0)|(0<<SPIE); // Enable SPI, Master, set clock rate fck/6412b82: 82 e5 ldi r24, 0x52 ; 8212b84: 8c bd out 0x2c, r24 ; 44SPSR = 0;//(1<<SPI2X);12b86: 1d bc out 0x2d, r1 ; 45SLAVE_SELECT_PORT |= (1 << SPI_SLAVE_SELECT);12b88: 45 9a sbi 0x08, 5 ; 8SPITransferCompleted = 1;12b8a: 81 e0 ldi r24, 0x01 ; 112b8c: 80 93 d6 08 sts 0x08D6, r24//SPDR = 0x00; // dummy writeToNaviCtrl.Sync1 = 0xAA;12b90: 8a ea ldi r24, 0xAA ; 17012b92: 80 93 e7 08 sts 0x08E7, r24ToNaviCtrl.Sync2 = 0x83;12b96: 83 e8 ldi r24, 0x83 ; 13112b98: 80 93 e8 08 sts 0x08E8, r24ToNaviCtrl.Command = SPI_FCCMD_USER;12b9c: 8a e0 ldi r24, 0x0A ; 1012b9e: 80 93 e9 08 sts 0x08E9, r24ToNaviCtrl.IntegralNick = 0;12ba2: 10 92 eb 08 sts 0x08EB, r112ba6: 10 92 ea 08 sts 0x08EA, r1ToNaviCtrl.IntegralRoll = 0;12baa: 10 92 ed 08 sts 0x08ED, r112bae: 10 92 ec 08 sts 0x08EC, r1FromNaviCtrl_Value.SerialDataOkay = 0;12bb2: 10 92 4f 09 sts 0x094F, r1SPI_RxDataValid = 0;12bb6: 10 92 0b 09 sts 0x090B, r112bba: 08 95 ret00012bbc <SPI_TransmitByte>:{static unsigned char SPI_RXState = 0;unsigned char rxdata;static unsigned char rxchksum;if (SPITransferCompleted) return;12bbc: 80 91 d6 08 lds r24, 0x08D612bc0: 81 11 cpse r24, r112bc2: 79 c0 rjmp .+242 ; 0x12cb6 <SPI_TransmitByte+0xfa>if (!(SPSR & (1 << SPIF))) return;12bc4: 0d b4 in r0, 0x2d ; 4512bc6: 07 fe sbrs r0, 712bc8: 76 c0 rjmp .+236 ; 0x12cb6 <SPI_TransmitByte+0xfa>BytegapSPI = SPI_BYTEGAP;12bca: 85 e0 ldi r24, 0x05 ; 512bcc: 80 93 cc 04 sts 0x04CC, r24// _delay_us(30);SLAVE_SELECT_PORT |= (1 << SPI_SLAVE_SELECT); // DeselectSlave12bd0: 45 9a sbi 0x08, 5 ; 8rxdata = SPDR;12bd2: 9e b5 in r25, 0x2e ; 46switch ( SPI_RXState)12bd4: 80 91 b4 04 lds r24, 0x04B412bd8: 81 30 cpi r24, 0x01 ; 112bda: 71 f0 breq .+28 ; 0x12bf8 <SPI_TransmitByte+0x3c>12bdc: 18 f0 brcs .+6 ; 0x12be4 <SPI_TransmitByte+0x28>12bde: 82 30 cpi r24, 0x02 ; 212be0: c9 f0 breq .+50 ; 0x12c14 <SPI_TransmitByte+0x58>12be2: 3f c0 rjmp .+126 ; 0x12c62 <SPI_TransmitByte+0xa6>{case 0:SPI_RxBufferIndex = 0;12be4: 10 92 0a 09 sts 0x090A, r1rxchksum = rxdata;12be8: 90 93 b3 04 sts 0x04B3, r25if (rxdata == 0x81 ) { SPI_RXState = 1; } // 1. Syncbyte ok12bec: 91 38 cpi r25, 0x81 ; 12912bee: c9 f5 brne .+114 ; 0x12c62 <SPI_TransmitByte+0xa6>12bf0: 81 e0 ldi r24, 0x01 ; 112bf2: 80 93 b4 04 sts 0x04B4, r2412bf6: 35 c0 rjmp .+106 ; 0x12c62 <SPI_TransmitByte+0xa6>break;case 1:if (rxdata == 0x55) { rxchksum += rxdata; SPI_RXState = 2; } // 2. Syncbyte ok12bf8: 95 35 cpi r25, 0x55 ; 8512bfa: 49 f4 brne .+18 ; 0x12c0e <SPI_TransmitByte+0x52>12bfc: 80 91 b3 04 lds r24, 0x04B312c00: 8b 5a subi r24, 0xAB ; 17112c02: 80 93 b3 04 sts 0x04B3, r2412c06: 82 e0 ldi r24, 0x02 ; 212c08: 80 93 b4 04 sts 0x04B4, r2412c0c: 2a c0 rjmp .+84 ; 0x12c62 <SPI_TransmitByte+0xa6>else SPI_RXState = 0;12c0e: 10 92 b4 04 sts 0x04B4, r112c12: 27 c0 rjmp .+78 ; 0x12c62 <SPI_TransmitByte+0xa6>break;case 2:SPI_Buffer[SPI_RxBufferIndex++]= rxdata; // get data12c14: e0 91 0a 09 lds r30, 0x090A12c18: 81 e0 ldi r24, 0x01 ; 112c1a: 8e 0f add r24, r3012c1c: 80 93 0a 09 sts 0x090A, r2412c20: f0 e0 ldi r31, 0x00 ; 012c22: e4 5d subi r30, 0xD4 ; 21212c24: f6 4f sbci r31, 0xF6 ; 24612c26: 90 83 st Z, r25//DebugOut.Analog[19]++;if (SPI_RxBufferIndex >= sizeof(FromNaviCtrl))12c28: 80 32 cpi r24, 0x20 ; 3212c2a: b0 f0 brcs .+44 ; 0x12c58 <SPI_TransmitByte+0x9c>{if (rxdata == rxchksum)12c2c: 80 91 b3 04 lds r24, 0x04B312c30: 98 13 cpse r25, r2412c32: 0d c0 rjmp .+26 ; 0x12c4e <SPI_TransmitByte+0x92>{unsigned char *ptr = (unsigned char *)&FromNaviCtrl;memcpy(ptr, (unsigned char *) SPI_Buffer, sizeof(SPI_Buffer));12c34: 80 e2 ldi r24, 0x20 ; 3212c36: ec e2 ldi r30, 0x2C ; 4412c38: f9 e0 ldi r31, 0x09 ; 912c3a: ac e0 ldi r26, 0x0C ; 1212c3c: b9 e0 ldi r27, 0x09 ; 912c3e: 01 90 ld r0, Z+12c40: 0d 92 st X+, r012c42: 8a 95 dec r2412c44: e1 f7 brne .-8 ; 0x12c3e <SPI_TransmitByte+0x82>SPI_RxDataValid = 1;12c46: 81 e0 ldi r24, 0x01 ; 112c48: 80 93 0b 09 sts 0x090B, r2412c4c: 02 c0 rjmp .+4 ; 0x12c52 <SPI_TransmitByte+0x96>}else{SPI_RxDataValid = 0;12c4e: 10 92 0b 09 sts 0x090B, r1}SPI_RXState = 0;12c52: 10 92 b4 04 sts 0x04B4, r112c56: 05 c0 rjmp .+10 ; 0x12c62 <SPI_TransmitByte+0xa6>}else rxchksum += rxdata;12c58: 80 91 b3 04 lds r24, 0x04B312c5c: 98 0f add r25, r2412c5e: 90 93 b3 04 sts 0x04B3, r25break;}if (SPI_BufferIndex < sizeof(ToNaviCtrl))12c62: 80 91 e6 08 lds r24, 0x08E612c66: 82 32 cpi r24, 0x22 ; 3412c68: f0 f4 brcc .+60 ; 0x12ca6 <SPI_TransmitByte+0xea>{SLAVE_SELECT_PORT &= ~(1 << SPI_SLAVE_SELECT); // SelectSlave12c6a: 45 98 cbi 0x08, 5 ; 8...asm volatile ("nop"); asm volatile ("nop"); asm volatile ("nop"); asm volatile ("nop");SPDR = SPI_TX_Buffer[SPI_BufferIndex];12c74: 80 91 e6 08 lds r24, 0x08E612c78: e0 91 df 08 lds r30, 0x08DF12c7c: f0 91 e0 08 lds r31, 0x08E012c80: e8 0f add r30, r2412c82: f1 1d adc r31, r112c84: 80 81 ld r24, Z12c86: 8e bd out 0x2e, r24 ; 46ToNaviCtrl.Chksum += SPI_TX_Buffer[SPI_BufferIndex];12c88: e8 e0 ldi r30, 0x08 ; 812c8a: f9 e0 ldi r31, 0x09 ; 912c8c: 80 91 e6 08 lds r24, 0x08E612c90: a0 91 df 08 lds r26, 0x08DF12c94: b0 91 e0 08 lds r27, 0x08E012c98: a8 0f add r26, r2412c9a: b1 1d adc r27, r112c9c: 9c 91 ld r25, X12c9e: 80 81 ld r24, Z12ca0: 89 0f add r24, r2512ca2: 80 83 st Z, r2412ca4: 03 c0 rjmp .+6 ; 0x12cac <SPI_TransmitByte+0xf0>}else SPITransferCompleted = 1;12ca6: 81 e0 ldi r24, 0x01 ; 112ca8: 80 93 d6 08 sts 0x08D6, r24SPI_BufferIndex++;12cac: 80 91 e6 08 lds r24, 0x08E612cb0: 8f 5f subi r24, 0xFF ; 25512cb2: 80 93 e6 08 sts 0x08E6, r2412cb6: 08 95 ret00012cb8 <UpdateSPI_Buffer>:}//------------------------------------------------------void UpdateSPI_Buffer(void){12cb8: cf 92 push r1212cba: df 92 push r1312cbc: ef 92 push r1412cbe: ff 92 push r1512cc0: 0f 93 push r1612cc2: 1f 93 push r17signed int tmp;static unsigned char motorindex, oldcommand = SPI_NCCMD_VERSION, slow_command;ToNaviCtrl.IntegralNick = (int) (IntegralNick / (long)(EE_Parameter.GyroAccFaktor * 4)); // etwa in 0.1 Grad12cc4: c0 90 5a 05 lds r12, 0x055A12cc8: d1 2c mov r13, r112cca: cc 0c add r12, r1212ccc: dd 1c adc r13, r1312cce: cc 0c add r12, r1212cd0: dd 1c adc r13, r1312cd2: ee 24 eor r14, r1412cd4: d7 fc sbrc r13, 712cd6: e0 94 com r1412cd8: fe 2c mov r15, r1412cda: 60 91 42 04 lds r22, 0x044212cde: 70 91 43 04 lds r23, 0x044312ce2: 80 91 44 04 lds r24, 0x044412ce6: 90 91 45 04 lds r25, 0x044512cea: a7 01 movw r20, r1412cec: 96 01 movw r18, r1212cee: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>12cf2: 30 93 eb 08 sts 0x08EB, r1912cf6: 20 93 ea 08 sts 0x08EA, r18ToNaviCtrl.IntegralRoll = (int) (IntegralRoll / (long)(EE_Parameter.GyroAccFaktor * 4)); // etwa in 0.1 Grad12cfa: 60 91 3e 04 lds r22, 0x043E12cfe: 70 91 3f 04 lds r23, 0x043F12d02: 80 91 40 04 lds r24, 0x044012d06: 90 91 41 04 lds r25, 0x044112d0a: a7 01 movw r20, r1412d0c: 96 01 movw r18, r1212d0e: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>12d12: 30 93 ed 08 sts 0x08ED, r1912d16: 20 93 ec 08 sts 0x08EC, r18ToNaviCtrl.GyroCompass = (10 * ErsatzKompass) / GIER_GRAD_FAKTOR;12d1a: 80 91 6e 06 lds r24, 0x066E12d1e: 90 91 6f 06 lds r25, 0x066F12d22: a0 91 70 06 lds r26, 0x067012d26: b0 91 71 06 lds r27, 0x067112d2a: 88 0f add r24, r2412d2c: 99 1f adc r25, r2512d2e: aa 1f adc r26, r2612d30: bb 1f adc r27, r2712d32: ac 01 movw r20, r2412d34: bd 01 movw r22, r2612d36: 44 0f add r20, r2012d38: 55 1f adc r21, r2112d3a: 66 1f adc r22, r2212d3c: 77 1f adc r23, r2312d3e: 44 0f add r20, r2012d40: 55 1f adc r21, r2112d42: 66 1f adc r22, r2212d44: 77 1f adc r23, r2312d46: 8c 01 movw r16, r2412d48: 9d 01 movw r18, r2612d4a: 04 0f add r16, r2012d4c: 15 1f adc r17, r2112d4e: 26 1f adc r18, r2212d50: 37 1f adc r19, r2312d52: c9 01 movw r24, r1812d54: b8 01 movw r22, r1612d56: 20 91 21 01 lds r18, 0x012112d5a: 30 91 22 01 lds r19, 0x012212d5e: 40 91 23 01 lds r20, 0x012312d62: 50 91 24 01 lds r21, 0x012412d66: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>12d6a: 30 93 f3 08 sts 0x08F3, r1912d6e: 20 93 f2 08 sts 0x08F2, r18ToNaviCtrl.GyroGier = (signed int) AdNeutralGier - AdWertGier;12d72: e0 90 53 04 lds r14, 0x045312d76: f0 90 54 04 lds r15, 0x045412d7a: 80 91 61 03 lds r24, 0x036112d7e: 90 91 62 03 lds r25, 0x036212d82: 97 01 movw r18, r1412d84: 28 1b sub r18, r2412d86: 39 0b sbc r19, r2512d88: 30 93 f9 08 sts 0x08F9, r1912d8c: 20 93 f8 08 sts 0x08F8, r18ToNaviCtrl.AccNick = ((int) ACC_AMPLIFY * (NaviAccNick / NaviCntAcc))/4;12d90: 20 91 49 04 lds r18, 0x044912d94: 30 91 4a 04 lds r19, 0x044A12d98: 80 91 39 06 lds r24, 0x063912d9c: 90 91 3a 06 lds r25, 0x063A12da0: b9 01 movw r22, r1812da2: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>12da6: cb 01 movw r24, r2212da8: 88 0f add r24, r2412daa: 99 1f adc r25, r2512dac: 68 0f add r22, r2412dae: 79 1f adc r23, r2512db0: 66 0f add r22, r2212db2: 77 1f adc r23, r2312db4: cb 01 movw r24, r2212db6: 99 23 and r25, r2512db8: 0c f4 brge .+2 ; 0x12dbc <UpdateSPI_Buffer+0x104>12dba: 03 96 adiw r24, 0x03 ; 312dbc: 95 95 asr r2512dbe: 87 95 ror r2412dc0: 95 95 asr r2512dc2: 87 95 ror r2412dc4: 90 93 ef 08 sts 0x08EF, r2512dc8: 80 93 ee 08 sts 0x08EE, r24ToNaviCtrl.AccRoll = ((int) ACC_AMPLIFY * (NaviAccRoll / NaviCntAcc))/4;12dcc: 80 91 6a 06 lds r24, 0x066A12dd0: 90 91 6b 06 lds r25, 0x066B12dd4: b9 01 movw r22, r1812dd6: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>12dda: cb 01 movw r24, r2212ddc: 88 0f add r24, r2412dde: 99 1f adc r25, r2512de0: 68 0f add r22, r2412de2: 79 1f adc r23, r2512de4: 66 0f add r22, r2212de6: 77 1f adc r23, r2312de8: cb 01 movw r24, r2212dea: 99 23 and r25, r2512dec: 0c f4 brge .+2 ; 0x12df0 <UpdateSPI_Buffer+0x138>12dee: 03 96 adiw r24, 0x03 ; 312df0: 95 95 asr r2512df2: 87 95 ror r2412df4: 95 95 asr r2512df6: 87 95 ror r2412df8: 90 93 f1 08 sts 0x08F1, r2512dfc: 80 93 f0 08 sts 0x08F0, r24NaviCntAcc = 0; NaviAccNick = 0; NaviAccRoll = 0;12e00: 10 92 4a 04 sts 0x044A, r112e04: 10 92 49 04 sts 0x0449, r112e08: 10 92 3a 06 sts 0x063A, r112e0c: 10 92 39 06 sts 0x0639, r112e10: 10 92 6b 06 sts 0x066B, r112e14: 10 92 6a 06 sts 0x066A, r1// ToNaviCtrl.User8 = Parameter_UserParam8;// ToNaviCtrl.CalState = WinkelOut.CalcState;switch(ToNaviCtrl.Command) //12e18: 80 91 e9 08 lds r24, 0x08E912e1c: 90 e0 ldi r25, 0x00 ; 012e1e: 0a 97 sbiw r24, 0x0a ; 1012e20: 8a 30 cpi r24, 0x0A ; 1012e22: 91 05 cpc r25, r112e24: 08 f0 brcs .+2 ; 0x12e28 <UpdateSPI_Buffer+0x170>12e26: a1 c2 rjmp .+1346 ; 0x1336a <UpdateSPI_Buffer+0x6b2>12e28: 8a 55 subi r24, 0x5A ; 9012e2a: 9f 4f sbci r25, 0xFF ; 25512e2c: fc 01 movw r30, r2412e2e: 0c 94 a7 b1 jmp 0x1634e ; 0x1634e <__tablejump2__>{case SPI_FCCMD_USER:ToNaviCtrl.Param.Byte[0] = Parameter_UserParam1;12e32: 80 91 e0 03 lds r24, 0x03E012e36: 80 93 fc 08 sts 0x08FC, r24ToNaviCtrl.Param.Byte[1] = Parameter_UserParam2;12e3a: 80 91 df 03 lds r24, 0x03DF12e3e: 80 93 fd 08 sts 0x08FD, r24ToNaviCtrl.Param.Byte[2] = Parameter_UserParam3;12e42: 80 91 de 03 lds r24, 0x03DE12e46: 80 93 fe 08 sts 0x08FE, r24ToNaviCtrl.Param.Byte[3] = Parameter_UserParam4;12e4a: 80 91 dd 03 lds r24, 0x03DD12e4e: 80 93 ff 08 sts 0x08FF, r24ToNaviCtrl.Param.Byte[4] = Parameter_UserParam5;12e52: 80 91 dc 03 lds r24, 0x03DC12e56: 80 93 00 09 sts 0x0900, r24ToNaviCtrl.Param.Byte[5] = Parameter_UserParam6;12e5a: 80 91 db 03 lds r24, 0x03DB12e5e: 80 93 01 09 sts 0x0901, r24ToNaviCtrl.Param.Byte[6] = Parameter_UserParam7;12e62: 80 91 da 03 lds r24, 0x03DA12e66: 80 93 02 09 sts 0x0902, r24ToNaviCtrl.Param.Byte[7] = Parameter_UserParam8;12e6a: 80 91 d9 03 lds r24, 0x03D912e6e: 80 93 03 09 sts 0x0903, r24ToNaviCtrl.Param.Byte[8] = FC_StatusFlags;12e72: 80 91 cb 03 lds r24, 0x03CB12e76: 80 93 04 09 sts 0x0904, r24//if(FC_StatusFlags2 & FC_STATUS2_WAIT_FOR_TAKEOFF) ToNaviCtrl.Param.Byte[8] &= ~FC_STATUS_FLY;FC_StatusFlags &= ~(FC_STATUS_CALIBRATE | FC_STATUS_START);12e7a: 80 91 cb 03 lds r24, 0x03CB12e7e: 83 7f andi r24, 0xF3 ; 24312e80: 80 93 cb 03 sts 0x03CB, r24ToNaviCtrl.Param.Byte[9] = ActiveParamSet;12e84: 80 91 52 01 lds r24, 0x015212e88: 80 93 05 09 sts 0x0905, r24ToNaviCtrl.Param.Byte[10] = (unsigned char) UBat; // 0.1V12e8c: 80 91 1a 01 lds r24, 0x011A12e90: 90 91 1b 01 lds r25, 0x011B12e94: 80 93 06 09 sts 0x0906, r24ToNaviCtrl.Param.Byte[11] = FC_StatusFlags2;12e98: 80 91 ca 03 lds r24, 0x03CA12e9c: 80 93 07 09 sts 0x0907, r24if(!(PORTC & (1<<PORTC2))) FC_StatusFlags2 &= ~FC_STATUS2_OUT1_ACTIVE; // Out1 (J16)12ea0: 42 99 sbic 0x08, 2 ; 812ea2: 63 c2 rjmp .+1222 ; 0x1336a <UpdateSPI_Buffer+0x6b2>12ea4: 80 91 ca 03 lds r24, 0x03CA12ea8: 87 7f andi r24, 0xF7 ; 24712eaa: 80 93 ca 03 sts 0x03CA, r2412eae: 5d c2 rjmp .+1210 ; 0x1336a <UpdateSPI_Buffer+0x6b2>break;case SPI_FCCMD_BL_ACCU:ToNaviCtrl.Param.Int[0] = Capacity.ActualCurrent; // 0.1A12eb0: 80 91 15 05 lds r24, 0x051512eb4: 90 91 16 05 lds r25, 0x051612eb8: 90 93 fd 08 sts 0x08FD, r2512ebc: 80 93 fc 08 sts 0x08FC, r24ToNaviCtrl.Param.Byte[2] = motorindex;12ec0: 80 91 b2 04 lds r24, 0x04B212ec4: 80 93 fe 08 sts 0x08FE, r24ToNaviCtrl.Param.Byte[3] = Capacity.MinOfMaxPWM;12ec8: 80 91 1b 05 lds r24, 0x051B12ecc: 80 93 ff 08 sts 0x08FF, r24ToNaviCtrl.Param.Byte[4] = GetChannelValue(EE_Parameter.NaviGpsModeChannel); // GPS-Mode control12ed0: 80 91 8f 05 lds r24, 0x058F12ed4: 0e 94 0e 34 call 0x681c ; 0x681c <GetChannelValue>12ed8: 80 93 00 09 sts 0x0900, r24ToNaviCtrl.Param.Byte[5] = VarioCharacter;12edc: 80 91 20 01 lds r24, 0x012012ee0: 80 93 01 09 sts 0x0901, r24ToNaviCtrl.Param.Byte[6] = Motor[motorindex].NotReadyCnt;12ee4: 20 91 b2 04 lds r18, 0x04B212ee8: 0f e0 ldi r16, 0x0F ; 1512eea: 20 9f mul r18, r1612eec: f0 01 movw r30, r012eee: 11 24 eor r1, r112ef0: e9 56 subi r30, 0x69 ; 10512ef2: f6 4f sbci r31, 0xF6 ; 24612ef4: 86 85 ldd r24, Z+14 ; 0x0e12ef6: 80 93 02 09 sts 0x0902, r24ToNaviCtrl.Param.Byte[7] = Motor[motorindex].Version;12efa: 80 81 ld r24, Z12efc: 80 93 03 09 sts 0x0903, r24ToNaviCtrl.Param.Byte[8] = Motor[motorindex].MaxPWM;12f00: 86 81 ldd r24, Z+6 ; 0x0612f02: 80 93 04 09 sts 0x0904, r24ToNaviCtrl.Param.Byte[9] = Motor[motorindex].State;12f06: 83 81 ldd r24, Z+3 ; 0x0312f08: 80 93 05 09 sts 0x0905, r24ToNaviCtrl.Param.Byte[10] = Motor[motorindex].Temperature;12f0c: 87 81 ldd r24, Z+7 ; 0x0712f0e: 80 93 06 09 sts 0x0906, r24ToNaviCtrl.Param.Byte[11] = Motor[motorindex].Current;12f12: 85 81 ldd r24, Z+5 ; 0x0512f14: 80 93 07 09 sts 0x0907, r24if(Mixer.Motor[++motorindex][0] <= 0) // next motor is not used ?12f18: 2f 5f subi r18, 0xFF ; 25512f1a: 20 93 b2 04 sts 0x04B2, r1812f1e: 82 2f mov r24, r1812f20: 90 e0 ldi r25, 0x00 ; 012f22: fc 01 movw r30, r2412f24: ee 0f add r30, r3012f26: ff 1f adc r31, r3112f28: ee 0f add r30, r3012f2a: ff 1f adc r31, r3112f2c: e9 53 subi r30, 0x39 ; 5712f2e: fa 4f sbci r31, 0xFA ; 25012f30: 35 85 ldd r19, Z+13 ; 0x0d12f32: 13 16 cp r1, r1912f34: 0c f4 brge .+2 ; 0x12f38 <UpdateSPI_Buffer+0x280>12f36: 19 c2 rjmp .+1074 ; 0x1336a <UpdateSPI_Buffer+0x6b2>while(Mixer.Motor[motorindex][0] <= 0 && motorindex) motorindex = (motorindex + 1) % 13;12f38: 22 23 and r18, r1812f3a: 09 f4 brne .+2 ; 0x12f3e <UpdateSPI_Buffer+0x286>12f3c: 16 c2 rjmp .+1068 ; 0x1336a <UpdateSPI_Buffer+0x6b2>12f3e: 2d e0 ldi r18, 0x0D ; 1312f40: 30 e0 ldi r19, 0x00 ; 012f42: 01 96 adiw r24, 0x01 ; 112f44: b9 01 movw r22, r1812f46: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>12f4a: 48 2f mov r20, r2412f4c: 99 27 eor r25, r2512f4e: fc 01 movw r30, r2412f50: ee 0f add r30, r3012f52: ff 1f adc r31, r3112f54: ee 0f add r30, r3012f56: ff 1f adc r31, r3112f58: e9 53 subi r30, 0x39 ; 5712f5a: fa 4f sbci r31, 0xFA ; 25012f5c: 55 85 ldd r21, Z+13 ; 0x0d12f5e: 15 16 cp r1, r2112f60: 1c f4 brge .+6 ; 0x12f68 <UpdateSPI_Buffer+0x2b0>12f62: 40 93 b2 04 sts 0x04B2, r2012f66: 01 c2 rjmp .+1026 ; 0x1336a <UpdateSPI_Buffer+0x6b2>12f68: 41 11 cpse r20, r112f6a: eb cf rjmp .-42 ; 0x12f42 <UpdateSPI_Buffer+0x28a>12f6c: 40 93 b2 04 sts 0x04B2, r2012f70: fc c1 rjmp .+1016 ; 0x1336a <UpdateSPI_Buffer+0x6b2>break;case SPI_FCCMD_SLOW:switch(slow_command)12f72: 80 91 b1 04 lds r24, 0x04B112f76: 81 11 cpse r24, r112f78: 37 c0 rjmp .+110 ; 0x12fe8 <UpdateSPI_Buffer+0x330>{case 0:ToNaviCtrl.Command = SPI_FCCMD_PARAMETER1; slow_command = 1;12f7a: 8d e0 ldi r24, 0x0D ; 1312f7c: 80 93 e9 08 sts 0x08E9, r2412f80: 81 e0 ldi r24, 0x01 ; 112f82: 80 93 b1 04 sts 0x04B1, r24ToNaviCtrl.Param.Byte[0] = (unsigned char) BattLowVoltageWarning; //0.1V12f86: 80 91 53 01 lds r24, 0x015312f8a: 80 93 fc 08 sts 0x08FC, r24ToNaviCtrl.Param.Byte[1] = EE_Parameter.NaviGpsGain; // Parameters for the Naviboard12f8e: 80 91 90 05 lds r24, 0x059012f92: 80 93 fd 08 sts 0x08FD, r24ToNaviCtrl.Param.Byte[2] = EE_Parameter.NaviGpsP;12f96: 80 91 91 05 lds r24, 0x059112f9a: 80 93 fe 08 sts 0x08FE, r24ToNaviCtrl.Param.Byte[3] = EE_Parameter.NaviGpsI;12f9e: 80 91 92 05 lds r24, 0x059212fa2: 80 93 ff 08 sts 0x08FF, r24ToNaviCtrl.Param.Byte[4] = EE_Parameter.NaviGpsD;12fa6: 80 91 93 05 lds r24, 0x059312faa: 80 93 00 09 sts 0x0900, r24ToNaviCtrl.Param.Byte[5] = EE_Parameter.NaviGpsA;12fae: 80 91 97 05 lds r24, 0x059712fb2: 80 93 01 09 sts 0x0901, r24ToNaviCtrl.Param.Byte[6] = EE_Parameter.NaviGpsMinSat;12fb6: 80 91 98 05 lds r24, 0x059812fba: 80 93 02 09 sts 0x0902, r24ToNaviCtrl.Param.Byte[7] = EE_Parameter.NaviStickThreshold;12fbe: 80 91 99 05 lds r24, 0x059912fc2: 80 93 03 09 sts 0x0903, r24ToNaviCtrl.Param.Byte[8] = EE_Parameter.NaviMaxFlyingRange;12fc6: 80 91 9c 05 lds r24, 0x059C12fca: 80 93 04 09 sts 0x0904, r24ToNaviCtrl.Param.Byte[9] = EE_Parameter.NaviWindCorrection;12fce: 80 91 9a 05 lds r24, 0x059A12fd2: 80 93 05 09 sts 0x0905, r24ToNaviCtrl.Param.Byte[10] = EE_Parameter.NaviAccCompensation;12fd6: 80 91 9b 05 lds r24, 0x059B12fda: 80 93 06 09 sts 0x0906, r24ToNaviCtrl.Param.Byte[11] = EE_Parameter.NaviAngleLimitation;12fde: 80 91 9d 05 lds r24, 0x059D12fe2: 80 93 07 09 sts 0x0907, r24break;12fe6: c1 c1 rjmp .+898 ; 0x1336a <UpdateSPI_Buffer+0x6b2>default:ToNaviCtrl.Command = SPI_FCCMD_NEUTRAL; slow_command = 0;12fe8: 82 e1 ldi r24, 0x12 ; 1812fea: 80 93 e9 08 sts 0x08E9, r2412fee: 10 92 b1 04 sts 0x04B1, r1ToNaviCtrl.Param.Int[0] = AdNeutralNick; // 0 & 112ff2: 80 91 57 04 lds r24, 0x045712ff6: 90 91 58 04 lds r25, 0x045812ffa: 90 93 fd 08 sts 0x08FD, r2512ffe: 80 93 fc 08 sts 0x08FC, r24ToNaviCtrl.Param.Int[1] = AdNeutralRoll; // 2 & 313002: 80 91 55 04 lds r24, 0x045513006: 90 91 56 04 lds r25, 0x04561300a: 90 93 ff 08 sts 0x08FF, r251300e: 80 93 fe 08 sts 0x08FE, r24ToNaviCtrl.Param.Int[2] = AdNeutralGier; // 4 & 513012: f0 92 01 09 sts 0x0901, r1513016: e0 92 00 09 sts 0x0900, r14ToNaviCtrl.Param.Byte[6] = EE_Parameter.Driftkomp;1301a: 80 91 82 05 lds r24, 0x05821301e: 80 93 02 09 sts 0x0902, r24ToNaviCtrl.Param.Byte[7] = HoverGas / 4;13022: 80 91 e8 03 lds r24, 0x03E813026: 90 91 e9 03 lds r25, 0x03E91302a: 99 23 and r25, r251302c: 0c f4 brge .+2 ; 0x13030 <UpdateSPI_Buffer+0x378>1302e: 03 96 adiw r24, 0x03 ; 313030: 95 95 asr r2513032: 87 95 ror r2413034: 95 95 asr r2513036: 87 95 ror r2413038: 80 93 03 09 sts 0x0903, r24ToNaviCtrl.Param.Byte[8] = 0;1303c: 10 92 04 09 sts 0x0904, r1ToNaviCtrl.Param.Byte[9] = 0;13040: 10 92 05 09 sts 0x0905, r1ToNaviCtrl.Param.Byte[10] = 0;13044: 10 92 06 09 sts 0x0906, r1ToNaviCtrl.Param.Byte[11] = 0;13048: 10 92 07 09 sts 0x0907, r1break;1304c: 8e c1 rjmp .+796 ; 0x1336a <UpdateSPI_Buffer+0x6b2>}break;case SPI_FCCMD_PARAMETER2:ToNaviCtrl.Param.Byte[0] = EE_Parameter.AutoPhotoDistance; // Distance between Photo releases1304e: 80 91 8e 05 lds r24, 0x058E13052: 80 93 fc 08 sts 0x08FC, r24#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))// create the ToNC_SpeakHoTTif(EE_Parameter.Receiver != RECEIVER_HOTT)13056: 80 91 65 05 lds r24, 0x05651305a: 86 30 cpi r24, 0x06 ; 61305c: 81 f0 breq .+32 ; 0x1307e <UpdateSPI_Buffer+0x3c6>{if(JetiBeep != 'B') JetiBeep = pgm_read_byte(&JETI_CODE[HoTT_Waring()]);1305e: 80 91 5c 04 lds r24, 0x045C13062: 82 34 cpi r24, 0x42 ; 6613064: 51 f0 breq .+20 ; 0x1307a <UpdateSPI_Buffer+0x3c2>13066: 0e 94 cc 60 call 0xc198 ; 0xc198 <HoTT_Waring>1306a: e8 2f mov r30, r241306c: f0 e0 ldi r31, 0x00 ; 01306e: ed 5f subi r30, 0xFD ; 25313070: fe 4e sbci r31, 0xEE ; 23813072: e4 91 lpm r30, Z13074: e0 93 5c 04 sts 0x045C, r3013078: 02 c0 rjmp .+4 ; 0x1307e <UpdateSPI_Buffer+0x3c6>else HoTT_Waring();1307a: 0e 94 cc 60 call 0xc198 ; 0xc198 <HoTT_Waring>}ToNaviCtrl.Param.Byte[1] = ToNC_SpeakHoTT;1307e: 80 91 81 04 lds r24, 0x048113082: 80 93 fd 08 sts 0x08FD, r24#elseToNaviCtrl.Param.Byte[1] = 0;#endifToNaviCtrl.Param.Byte[2] = EE_Parameter.LandingSpeed;13086: 80 91 b0 05 lds r24, 0x05B01308a: 80 93 fe 08 sts 0x08FE, r24ToNaviCtrl.Param.Byte[3] = EE_Parameter.ComingHomeAltitude;1308e: 80 91 a5 05 lds r24, 0x05A513092: 80 93 ff 08 sts 0x08FF, r24ToNaviCtrl.Param.Byte[4] = LowVoltageHomeActive;13096: 80 91 c0 03 lds r24, 0x03C01309a: 80 93 00 09 sts 0x0900, r24ToNaviCtrl.Param.Byte[5] = ToNC_Load_WP_List;1309e: 80 91 8a 04 lds r24, 0x048A130a2: 80 93 01 09 sts 0x0901, r24ToNaviCtrl.Param.Byte[6] = ToNC_Load_SingePoint;130a6: 80 91 88 04 lds r24, 0x0488130aa: 80 93 02 09 sts 0x0902, r24ToNaviCtrl.Param.Byte[7] = ToNC_Store_SingePoint;130ae: 80 91 87 04 lds r24, 0x0487130b2: 80 93 03 09 sts 0x0903, r24ToNC_Load_WP_List = 0;130b6: 10 92 8a 04 sts 0x048A, r1ToNC_Load_SingePoint = 0;130ba: 10 92 88 04 sts 0x0488, r1ToNC_Store_SingePoint = 0;130be: 10 92 87 04 sts 0x0487, r1if(Parameter_KompassWirkung) ToNaviCtrl.Param.sInt[4] = KompassSollWert; // Pos. 8 & 9130c2: 80 91 37 01 lds r24, 0x0137130c6: 88 23 and r24, r24130c8: 49 f0 breq .+18 ; 0x130dc <UpdateSPI_Buffer+0x424>130ca: 80 91 1c 04 lds r24, 0x041C130ce: 90 91 1d 04 lds r25, 0x041D130d2: 90 93 05 09 sts 0x0905, r25130d6: 80 93 04 09 sts 0x0904, r24130da: 08 c0 rjmp .+16 ; 0x130ec <UpdateSPI_Buffer+0x434>else ToNaviCtrl.Param.sInt[4] = ErsatzKompassInGrad; // answer with the compass value if the Compass effect is zero130dc: 80 91 21 06 lds r24, 0x0621130e0: 90 91 22 06 lds r25, 0x0622130e4: 90 93 05 09 sts 0x0905, r25130e8: 80 93 04 09 sts 0x0904, r24ToNaviCtrl.Param.Byte[10] = EE_Parameter.AutoPhotoAtitudes;130ec: 80 91 b4 05 lds r24, 0x05B4130f0: 80 93 06 09 sts 0x0906, r24ToNaviCtrl.Param.Byte[11] = EE_Parameter.SingleWpSpeed;130f4: 80 91 b5 05 lds r24, 0x05B5130f8: 80 93 07 09 sts 0x0907, r24break;130fc: 36 c1 rjmp .+620 ; 0x1336a <UpdateSPI_Buffer+0x6b2>case SPI_FCCMD_STICK:cli();130fe: f8 94 clitmp = PPM_in[EE_Parameter.Kanalbelegung[K_GAS]]; if(tmp > 127) tmp = 127; else if(tmp < -127) tmp = -127;13100: e0 91 41 05 lds r30, 0x054113104: f0 e0 ldi r31, 0x00 ; 013106: ee 0f add r30, r3013108: ff 1f adc r31, r311310a: ef 5c subi r30, 0xCF ; 2071310c: f7 4f sbci r31, 0xF7 ; 2471310e: 80 81 ld r24, Z13110: 91 81 ldd r25, Z+1 ; 0x0113112: 81 38 cpi r24, 0x81 ; 12913114: 1f ef ldi r17, 0xFF ; 25513116: 91 07 cpc r25, r1713118: 14 f4 brge .+4 ; 0x1311e <UpdateSPI_Buffer+0x466>1311a: 81 e8 ldi r24, 0x81 ; 1291311c: 9f ef ldi r25, 0xFF ; 2551311e: 80 38 cpi r24, 0x80 ; 12813120: 91 05 cpc r25, r113122: 14 f0 brlt .+4 ; 0x13128 <UpdateSPI_Buffer+0x470>13124: 8f e7 ldi r24, 0x7F ; 12713126: 90 e0 ldi r25, 0x00 ; 0ToNaviCtrl.Param.Byte[0] = (char) tmp;13128: 80 93 fc 08 sts 0x08FC, r24tmp = PPM_in[EE_Parameter.Kanalbelegung[K_GIER]]; if(tmp > 127) tmp = 127; else if(tmp < -127) tmp = -127;1312c: e0 91 42 05 lds r30, 0x054213130: f0 e0 ldi r31, 0x00 ; 013132: ee 0f add r30, r3013134: ff 1f adc r31, r3113136: ef 5c subi r30, 0xCF ; 20713138: f7 4f sbci r31, 0xF7 ; 2471313a: 80 81 ld r24, Z1313c: 91 81 ldd r25, Z+1 ; 0x011313e: 81 38 cpi r24, 0x81 ; 12913140: 2f ef ldi r18, 0xFF ; 25513142: 92 07 cpc r25, r1813144: 14 f4 brge .+4 ; 0x1314a <UpdateSPI_Buffer+0x492>13146: 81 e8 ldi r24, 0x81 ; 12913148: 9f ef ldi r25, 0xFF ; 2551314a: 80 38 cpi r24, 0x80 ; 1281314c: 91 05 cpc r25, r11314e: 14 f0 brlt .+4 ; 0x13154 <UpdateSPI_Buffer+0x49c>13150: 8f e7 ldi r24, 0x7F ; 12713152: 90 e0 ldi r25, 0x00 ; 0ToNaviCtrl.Param.Byte[1] = (char) tmp;13154: 80 93 fd 08 sts 0x08FD, r24tmp = PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]]; if(tmp > 127) tmp = 127; else if(tmp < -127) tmp = -127;13158: e0 91 40 05 lds r30, 0x05401315c: f0 e0 ldi r31, 0x00 ; 01315e: ee 0f add r30, r3013160: ff 1f adc r31, r3113162: ef 5c subi r30, 0xCF ; 20713164: f7 4f sbci r31, 0xF7 ; 24713166: 80 81 ld r24, Z13168: 91 81 ldd r25, Z+1 ; 0x011316a: 81 38 cpi r24, 0x81 ; 1291316c: 3f ef ldi r19, 0xFF ; 2551316e: 93 07 cpc r25, r1913170: 14 f4 brge .+4 ; 0x13176 <UpdateSPI_Buffer+0x4be>13172: 81 e8 ldi r24, 0x81 ; 12913174: 9f ef ldi r25, 0xFF ; 25513176: 80 38 cpi r24, 0x80 ; 12813178: 91 05 cpc r25, r11317a: 14 f0 brlt .+4 ; 0x13180 <UpdateSPI_Buffer+0x4c8>1317c: 8f e7 ldi r24, 0x7F ; 1271317e: 90 e0 ldi r25, 0x00 ; 0ToNaviCtrl.Param.Byte[2] = (char) tmp;13180: 80 93 fe 08 sts 0x08FE, r24tmp = PPM_in[EE_Parameter.Kanalbelegung[K_NICK]]; if(tmp > 127) tmp = 127; else if(tmp < -127) tmp = -127;13184: e0 91 3f 05 lds r30, 0x053F13188: f0 e0 ldi r31, 0x00 ; 01318a: ee 0f add r30, r301318c: ff 1f adc r31, r311318e: ef 5c subi r30, 0xCF ; 20713190: f7 4f sbci r31, 0xF7 ; 24713192: 80 81 ld r24, Z13194: 91 81 ldd r25, Z+1 ; 0x0113196: 81 38 cpi r24, 0x81 ; 12913198: 4f ef ldi r20, 0xFF ; 2551319a: 94 07 cpc r25, r201319c: 14 f4 brge .+4 ; 0x131a2 <UpdateSPI_Buffer+0x4ea>1319e: 81 e8 ldi r24, 0x81 ; 129131a0: 9f ef ldi r25, 0xFF ; 255sei();131a2: 78 94 sei131a4: 80 38 cpi r24, 0x80 ; 128131a6: 91 05 cpc r25, r1131a8: 14 f0 brlt .+4 ; 0x131ae <UpdateSPI_Buffer+0x4f6>131aa: 8f e7 ldi r24, 0x7F ; 127131ac: 90 e0 ldi r25, 0x00 ; 0ToNaviCtrl.Param.Byte[3] = (char) tmp;131ae: 80 93 ff 08 sts 0x08FF, r24ToNaviCtrl.Param.Byte[4] = (unsigned char) Poti[0];131b2: 80 91 05 04 lds r24, 0x0405131b6: 80 93 00 09 sts 0x0900, r24ToNaviCtrl.Param.Byte[5] = (unsigned char) Poti[1];131ba: 80 91 06 04 lds r24, 0x0406131be: 80 93 01 09 sts 0x0901, r24ToNaviCtrl.Param.Byte[6] = (unsigned char) Poti[2];131c2: 80 91 07 04 lds r24, 0x0407131c6: 80 93 02 09 sts 0x0902, r24ToNaviCtrl.Param.Byte[7] = (unsigned char) Poti[3];131ca: 80 91 08 04 lds r24, 0x0408131ce: 80 93 03 09 sts 0x0903, r24ToNaviCtrl.Param.Byte[8] = (unsigned char) Poti[4];131d2: 80 91 09 04 lds r24, 0x0409131d6: 80 93 04 09 sts 0x0904, r24ToNaviCtrl.Param.Byte[9] = (unsigned char) Poti[5];131da: 80 91 0a 04 lds r24, 0x040A131de: 80 93 05 09 sts 0x0905, r24ToNaviCtrl.Param.Byte[10] = (unsigned char) Poti[6];131e2: 80 91 0b 04 lds r24, 0x040B131e6: 80 93 06 09 sts 0x0906, r24ToNaviCtrl.Param.Byte[11] = (unsigned char) Poti[7];131ea: 80 91 0c 04 lds r24, 0x040C131ee: 80 93 07 09 sts 0x0907, r24break;131f2: bb c0 rjmp .+374 ; 0x1336a <UpdateSPI_Buffer+0x6b2>case SPI_FCCMD_MISC:if(WinkelOut.CalcState >= 5)131f4: 80 91 7d 0a lds r24, 0x0A7D131f8: 85 30 cpi r24, 0x05 ; 5131fa: 30 f0 brcs .+12 ; 0x13208 <UpdateSPI_Buffer+0x550>{WinkelOut.CalcState = 0;131fc: 10 92 7d 0a sts 0x0A7D, r1ToNaviCtrl.Param.Byte[0] = 5;13200: 85 e0 ldi r24, 0x05 ; 513202: 80 93 fc 08 sts 0x08FC, r2413206: 02 c0 rjmp .+4 ; 0x1320c <UpdateSPI_Buffer+0x554>}else ToNaviCtrl.Param.Byte[0] = WinkelOut.CalcState;13208: 80 93 fc 08 sts 0x08FC, r24ToNaviCtrl.Param.Byte[1] = EE_Parameter.NaviPH_LoginTime;1320c: 80 91 9e 05 lds r24, 0x059E13210: 80 93 fd 08 sts 0x08FD, r24ToNaviCtrl.Param.Int[1] = (int)(HoehenWert/5);13214: 60 91 fe 03 lds r22, 0x03FE13218: 70 91 ff 03 lds r23, 0x03FF1321c: 80 91 00 04 lds r24, 0x040013220: 90 91 01 04 lds r25, 0x040113224: 0f 2e mov r0, r3113226: f5 e0 ldi r31, 0x05 ; 513228: cf 2e mov r12, r311322a: d1 2c mov r13, r11322c: e1 2c mov r14, r11322e: f1 2c mov r15, r113230: f0 2d mov r31, r013232: a7 01 movw r20, r1413234: 96 01 movw r18, r1213236: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>1323a: 30 93 ff 08 sts 0x08FF, r191323e: 20 93 fe 08 sts 0x08FE, r18ToNaviCtrl.Param.Int[2] = (int)(SollHoehe/5);13242: 60 91 fa 03 lds r22, 0x03FA13246: 70 91 fb 03 lds r23, 0x03FB1324a: 80 91 fc 03 lds r24, 0x03FC1324e: 90 91 fd 03 lds r25, 0x03FD13252: a7 01 movw r20, r1413254: 96 01 movw r18, r1213256: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>1325a: 30 93 01 09 sts 0x0901, r191325e: 20 93 00 09 sts 0x0900, r18ToNaviCtrl.Param.Byte[6] = EE_Parameter.NaviGpsPLimit;13262: 80 91 94 05 lds r24, 0x059413266: 80 93 02 09 sts 0x0902, r24ToNaviCtrl.Param.Byte[7] = EE_Parameter.NaviGpsILimit;1326a: 80 91 95 05 lds r24, 0x05951326e: 80 93 03 09 sts 0x0903, r24ToNaviCtrl.Param.Byte[8] = EE_Parameter.NaviGpsDLimit;13272: 80 91 96 05 lds r24, 0x059613276: 80 93 04 09 sts 0x0904, r24ToNaviCtrl.Param.Byte[9] = (unsigned char) SenderOkay;1327a: 80 91 04 04 lds r24, 0x04041327e: 80 93 05 09 sts 0x0905, r24ToNaviCtrl.Param.Byte[10] = NC_Wait_for_LED;13282: 80 91 9f 04 lds r24, 0x049F13286: 80 93 06 09 sts 0x0906, r24ToNaviCtrl.Param.Byte[11] = DebugOut.Analog[7] / 4; //GasMischanteil1328a: 80 91 56 0c lds r24, 0x0C561328e: 90 91 57 0c lds r25, 0x0C5713292: 99 23 and r25, r2513294: 0c f4 brge .+2 ; 0x13298 <UpdateSPI_Buffer+0x5e0>13296: 03 96 adiw r24, 0x03 ; 313298: 95 95 asr r251329a: 87 95 ror r241329c: 95 95 asr r251329e: 87 95 ror r24132a0: 80 93 07 09 sts 0x0907, r24break;132a4: 62 c0 rjmp .+196 ; 0x1336a <UpdateSPI_Buffer+0x6b2>case SPI_FCCMD_VERSION:ToNaviCtrl.Param.Byte[0] = VERSION_MAJOR;132a6: 82 e0 ldi r24, 0x02 ; 2132a8: 80 93 fc 08 sts 0x08FC, r24ToNaviCtrl.Param.Byte[1] = VERSION_MINOR;132ac: 88 e0 ldi r24, 0x08 ; 8132ae: 80 93 fd 08 sts 0x08FD, r24ToNaviCtrl.Param.Byte[2] = VERSION_PATCH;132b2: 10 92 fe 08 sts 0x08FE, r1ToNaviCtrl.Param.Byte[3] = NC_SPI_COMPATIBLE;132b6: 87 e4 ldi r24, 0x47 ; 71132b8: 80 93 ff 08 sts 0x08FF, r24ToNaviCtrl.Param.Byte[4] = PlatinenVersion;132bc: 80 91 54 01 lds r24, 0x0154132c0: 80 93 00 09 sts 0x0900, r24ToNaviCtrl.Param.Byte[5] = VersionInfo.HardwareError[0];132c4: a2 e6 ldi r26, 0x62 ; 98132c6: ba e0 ldi r27, 0x0A ; 10132c8: 9c 91 ld r25, X132ca: 90 93 01 09 sts 0x0901, r25ToNaviCtrl.Param.Byte[6] = VersionInfo.HardwareError[1];132ce: e3 e6 ldi r30, 0x63 ; 99132d0: fa e0 ldi r31, 0x0A ; 10132d2: 80 81 ld r24, Z132d4: 80 93 02 09 sts 0x0902, r24VersionInfo.HardwareError[0] &= ~FC_ERROR0_CAREFREE; // VersionInfo.HardwareError[0] = 0;132d8: 9f 77 andi r25, 0x7F ; 127132da: 9c 93 st X, r25VersionInfo.HardwareError[1] &= FC_ERROR1_MIXER;132dc: 80 71 andi r24, 0x10 ; 16132de: 80 83 st Z, r24ToNaviCtrl.Param.Byte[7] = EE_Parameter.CompassOffset;132e0: 80 91 b1 05 lds r24, 0x05B1132e4: 80 93 03 09 sts 0x0903, r24ToNaviCtrl.Param.Byte[8] = Parameter_GlobalConfig;132e8: 80 91 5c 06 lds r24, 0x065C132ec: 80 93 04 09 sts 0x0904, r24ToNaviCtrl.Param.Byte[9] = Parameter_ExtraConfig;132f0: 80 91 40 06 lds r24, 0x0640132f4: 80 93 05 09 sts 0x0905, r24ToNaviCtrl.Param.Byte[10] = EE_Parameter.OrientationAngle;132f8: 80 91 a1 05 lds r24, 0x05A1132fc: 80 93 06 09 sts 0x0906, r24ToNaviCtrl.Param.Byte[11] = EE_Parameter.GlobalConfig3;13300: 80 91 b9 05 lds r24, 0x05B913304: 80 93 07 09 sts 0x0907, r24break;13308: 30 c0 rjmp .+96 ; 0x1336a <UpdateSPI_Buffer+0x6b2>case SPI_FCCMD_SERVOS:ToNaviCtrl.Param.Int[0] = Capacity.UsedCapacity; // mAh1330a: 80 91 19 05 lds r24, 0x05191330e: 90 91 1a 05 lds r25, 0x051A13312: 90 93 fd 08 sts 0x08FD, r2513316: 80 93 fc 08 sts 0x08FC, r24ToNaviCtrl.Param.Byte[2] = Parameter_ServoNickControl;1331a: 80 91 2f 01 lds r24, 0x012F1331e: 80 93 fe 08 sts 0x08FE, r24ToNaviCtrl.Param.Byte[3] = Parameter_ServoRollControl;13322: 80 91 2e 01 lds r24, 0x012E13326: 80 93 ff 08 sts 0x08FF, r24ToNaviCtrl.Param.Byte[4] = DebugOut.Analog[28]; // I2C-Error counter1332a: 80 91 80 0c lds r24, 0x0C801332e: 80 93 00 09 sts 0x0900, r24ToNaviCtrl.Param.Byte[5] = FC_StatusFlags3;13332: 80 91 c9 03 lds r24, 0x03C913336: 80 93 01 09 sts 0x0901, r24ToNaviCtrl.Param.Byte[6] = EE_Parameter.NaviDescendRange; // in 10m1333a: 80 91 9f 05 lds r24, 0x059F1333e: 80 93 02 09 sts 0x0902, r24ToNaviCtrl.Param.Byte[7] = Parameter_MaximumAltitude;13342: 80 91 24 06 lds r24, 0x062413346: 80 93 03 09 sts 0x0903, r24ToNaviCtrl.Param.Int[4] = FlugMinutenGesamt; // 8 & 91334a: 80 91 60 04 lds r24, 0x04601334e: 90 91 61 04 lds r25, 0x046113352: 90 93 05 09 sts 0x0905, r2513356: 80 93 04 09 sts 0x0904, r24ToNaviCtrl.Param.Byte[10] = EE_Parameter.CamOrientation;1335a: 80 91 75 05 lds r24, 0x05751335e: 80 93 06 09 sts 0x0906, r24ToNaviCtrl.Param.Byte[11] = VersionInfo.BL_Firmware;13362: 80 91 65 0a lds r24, 0x0A6513366: 80 93 07 09 sts 0x0907, r24break;}if(SPI_RxDataValid)1336a: 80 91 0b 09 lds r24, 0x090B1336e: 88 23 and r24, r2413370: 09 f4 brne .+2 ; 0x13374 <UpdateSPI_Buffer+0x6bc>13372: 71 c1 rjmp .+738 ; 0x13656 <UpdateSPI_Buffer+0x99e>{if(FromNaviCtrl.Command != oldcommand) NaviDataOkay = 250;13374: 60 91 0c 09 lds r22, 0x090C13378: 80 91 95 02 lds r24, 0x02951337c: 68 17 cp r22, r241337e: 19 f0 breq .+6 ; 0x13386 <UpdateSPI_Buffer+0x6ce>13380: 8a ef ldi r24, 0xFA ; 25013382: 80 93 a4 02 sts 0x02A4, r24oldcommand = FromNaviCtrl.Command;13386: 60 93 95 02 sts 0x0295, r22CalculateCompassTimer = 1;1338a: 81 e0 ldi r24, 0x01 ; 11338c: 80 93 4d 01 sts 0x014D, r24if(abs(FromNaviCtrl.GPS_Nick) < 512 && abs(FromNaviCtrl.GPS_Roll) < 512 && (EE_Parameter.GlobalConfig & CFG_GPS_AKTIV))13390: 80 91 0d 09 lds r24, 0x090D13394: 90 91 0e 09 lds r25, 0x090E13398: 9c 01 movw r18, r241339a: 21 50 subi r18, 0x01 ; 11339c: 3e 4f sbci r19, 0xFE ; 2541339e: 2f 3f cpi r18, 0xFF ; 255133a0: 33 40 sbci r19, 0x03 ; 3133a2: b0 f4 brcc .+44 ; 0x133d0 <UpdateSPI_Buffer+0x718>133a4: 20 91 0f 09 lds r18, 0x090F133a8: 30 91 10 09 lds r19, 0x0910133ac: a9 01 movw r20, r18133ae: 41 50 subi r20, 0x01 ; 1133b0: 5e 4f sbci r21, 0xFE ; 254133b2: 4f 3f cpi r20, 0xFF ; 255133b4: 53 40 sbci r21, 0x03 ; 3133b6: 60 f4 brcc .+24 ; 0x133d0 <UpdateSPI_Buffer+0x718>133b8: 40 91 4b 05 lds r20, 0x054B133bc: 45 ff sbrs r20, 5133be: 08 c0 rjmp .+16 ; 0x133d0 <UpdateSPI_Buffer+0x718>{GPS_Nick = FromNaviCtrl.GPS_Nick;133c0: 90 93 6b 04 sts 0x046B, r25133c4: 80 93 6a 04 sts 0x046A, r24GPS_Roll = FromNaviCtrl.GPS_Roll;133c8: 30 93 69 04 sts 0x0469, r19133cc: 20 93 68 04 sts 0x0468, r18// update compass readings// MagVec.x = FromNaviCtrl.MagVecX;// MagVec.y = FromNaviCtrl.MagVecY;// MagVec.z = FromNaviCtrl.MagVecZ;if(FromNaviCtrl.CompassValue <= 360) KompassValue = FromNaviCtrl.CompassValue;133d0: 80 91 13 09 lds r24, 0x0913133d4: 90 91 14 09 lds r25, 0x0914133d8: 89 36 cpi r24, 0x69 ; 105133da: f1 e0 ldi r31, 0x01 ; 1133dc: 9f 07 cpc r25, r31133de: 24 f4 brge .+8 ; 0x133e8 <UpdateSPI_Buffer+0x730>133e0: 90 93 4f 01 sts 0x014F, r25133e4: 80 93 4e 01 sts 0x014E, r24// KompassRichtung = ((540 + KompassValue - KompassSollWert) % 360) - 180;if(FromNaviCtrl.BeepTime > beeptime && !DisableRcOffBeeping) beeptime = FromNaviCtrl.BeepTime;133e8: 80 91 1d 09 lds r24, 0x091D133ec: 90 91 1e 09 lds r25, 0x091E133f0: 20 91 cd 04 lds r18, 0x04CD133f4: 30 91 ce 04 lds r19, 0x04CE133f8: 28 17 cp r18, r24133fa: 39 07 cpc r19, r25133fc: 40 f4 brcc .+16 ; 0x1340e <UpdateSPI_Buffer+0x756>133fe: 20 91 66 04 lds r18, 0x046613402: 21 11 cpse r18, r113404: 04 c0 rjmp .+8 ; 0x1340e <UpdateSPI_Buffer+0x756>13406: 90 93 ce 04 sts 0x04CE, r251340a: 80 93 cd 04 sts 0x04CD, r24switch (FromNaviCtrl.Command)1340e: 69 36 cpi r22, 0x69 ; 10513410: 09 f4 brne .+2 ; 0x13414 <UpdateSPI_Buffer+0x75c>13412: 85 c0 rjmp .+266 ; 0x1351e <UpdateSPI_Buffer+0x866>13414: 30 f4 brcc .+12 ; 0x13422 <UpdateSPI_Buffer+0x76a>13416: 67 36 cpi r22, 0x67 ; 10313418: 59 f0 breq .+22 ; 0x13430 <UpdateSPI_Buffer+0x778>1341a: 68 36 cpi r22, 0x68 ; 1041341c: 09 f4 brne .+2 ; 0x13420 <UpdateSPI_Buffer+0x768>1341e: 4a c0 rjmp .+148 ; 0x134b4 <UpdateSPI_Buffer+0x7fc>13420: 22 c1 rjmp .+580 ; 0x13666 <UpdateSPI_Buffer+0x9ae>13422: 6a 36 cpi r22, 0x6A ; 10613424: 09 f4 brne .+2 ; 0x13428 <UpdateSPI_Buffer+0x770>13426: 14 c1 rjmp .+552 ; 0x13650 <UpdateSPI_Buffer+0x998>13428: 6b 36 cpi r22, 0x6B ; 1071342a: 09 f4 brne .+2 ; 0x1342e <UpdateSPI_Buffer+0x776>1342c: d7 c0 rjmp .+430 ; 0x135dc <UpdateSPI_Buffer+0x924>1342e: 1b c1 rjmp .+566 ; 0x13666 <UpdateSPI_Buffer+0x9ae>{case SPI_NCCMD_KALMAN:FromNaviCtrl_Value.Kalman_K = FromNaviCtrl.Param.sByte[0];13430: 80 91 1f 09 lds r24, 0x091F13434: 80 93 4c 09 sts 0x094C, r24FromNaviCtrl_Value.Kalman_MaxFusion = FromNaviCtrl.Param.sByte[1];13438: 80 91 20 09 lds r24, 0x09201343c: 80 93 4e 09 sts 0x094E, r24FromNaviCtrl_Value.Kalman_MaxDrift = FromNaviCtrl.Param.sByte[2];13440: 80 91 21 09 lds r24, 0x092113444: 80 93 4d 09 sts 0x094D, r24KompassFusion = FromNaviCtrl.Param.sByte[3];13448: 80 91 22 09 lds r24, 0x09221344c: 80 93 4c 01 sts 0x014C, r24FromNaviCtrl_Value.GpsZ = FromNaviCtrl.Param.Byte[4];13450: 80 91 23 09 lds r24, 0x092313454: 80 93 50 09 sts 0x0950, r24FromNC_Rotate_C = FromNaviCtrl.Param.Byte[5];13458: 80 91 24 09 lds r24, 0x09241345c: 80 93 a5 02 sts 0x02A5, r24FromNC_Rotate_S = FromNaviCtrl.Param.Byte[6];13460: 80 91 25 09 lds r24, 0x092513464: 80 93 be 04 sts 0x04BE, r24GPS_Aid_StickMultiplikator = FromNaviCtrl.Param.Byte[7];13468: 80 91 26 09 lds r24, 0x09261346c: 80 93 67 04 sts 0x0467, r24if(CareFree && FromNaviCtrl.Param.sInt[4] >= 0)13470: 80 91 d8 03 lds r24, 0x03D813474: 88 23 and r24, r2413476: 51 f0 breq .+20 ; 0x1348c <UpdateSPI_Buffer+0x7d4>13478: 80 91 27 09 lds r24, 0x09271347c: 90 91 28 09 lds r25, 0x092813480: 99 23 and r25, r2513482: 24 f0 brlt .+8 ; 0x1348c <UpdateSPI_Buffer+0x7d4>{KompassSollWert = FromNaviCtrl.Param.sInt[4]; // bei Carefree kann NC den Kompass-Sollwinkel vorgeben13484: 90 93 1d 04 sts 0x041D, r2513488: 80 93 1c 04 sts 0x041C, r24KompassSollWert += 360 - ((unsigned int) EE_Parameter.CamOrientation * 15);KompassSollWert %= 360;}*/}POI_KameraNick = (POI_KameraNick + FromNaviCtrl.Param.sInt[5]) / 2; // FromNaviCtrl.Param.sInt[5]; // Nickwinkel1348c: 20 91 29 09 lds r18, 0x092913490: 30 91 2a 09 lds r19, 0x092A13494: 80 91 b5 04 lds r24, 0x04B513498: 90 91 b6 04 lds r25, 0x04B61349c: 82 0f add r24, r181349e: 93 1f adc r25, r19134a0: 99 23 and r25, r25134a2: 0c f4 brge .+2 ; 0x134a6 <UpdateSPI_Buffer+0x7ee>134a4: 01 96 adiw r24, 0x01 ; 1134a6: 95 95 asr r25134a8: 87 95 ror r24134aa: 90 93 b6 04 sts 0x04B6, r25134ae: 80 93 b5 04 sts 0x04B5, r24break;134b2: d9 c0 rjmp .+434 ; 0x13666 <UpdateSPI_Buffer+0x9ae>case SPI_NCCMD_VERSION:NC_Version.Major = FromNaviCtrl.Param.Byte[0];134b4: 80 91 1f 09 lds r24, 0x091F134b8: 80 93 e1 08 sts 0x08E1, r24NC_Version.Minor = FromNaviCtrl.Param.Byte[1];134bc: 80 91 20 09 lds r24, 0x0920134c0: 80 93 e2 08 sts 0x08E2, r24NC_Version.Patch = FromNaviCtrl.Param.Byte[2];134c4: 80 91 21 09 lds r24, 0x0921134c8: 80 93 e3 08 sts 0x08E3, r24NC_Version.Compatible = FromNaviCtrl.Param.Byte[3];134cc: 80 91 22 09 lds r24, 0x0922134d0: 80 93 e4 08 sts 0x08E4, r24NC_Version.Hardware = FromNaviCtrl.Param.Byte[4];134d4: 80 91 23 09 lds r24, 0x0923134d8: 80 93 e5 08 sts 0x08E5, r24DebugOut.Status[0] |= FromNaviCtrl.Param.Byte[5];134dc: e6 e4 ldi r30, 0x46 ; 70134de: fc e0 ldi r31, 0x0C ; 12134e0: 90 91 24 09 lds r25, 0x0924134e4: 80 81 ld r24, Z134e6: 89 2b or r24, r25134e8: 80 83 st Z, r24DebugOut.Status[1] = (DebugOut.Status[1] & (0x01|0x02)) | (FromNaviCtrl.Param.Byte[6] & (0x04 | 0x08));134ea: e7 e4 ldi r30, 0x47 ; 71134ec: fc e0 ldi r31, 0x0C ; 12134ee: 90 91 25 09 lds r25, 0x0925134f2: 9c 70 andi r25, 0x0C ; 12134f4: 80 81 ld r24, Z134f6: 83 70 andi r24, 0x03 ; 3134f8: 89 2b or r24, r25134fa: 80 83 st Z, r24NC_ErrorCode = FromNaviCtrl.Param.Byte[7];134fc: 80 91 26 09 lds r24, 0x092613500: 80 93 bb 04 sts 0x04BB, r24NC_GPS_ModeCharacter = FromNaviCtrl.Param.Byte[8];13504: 80 91 27 09 lds r24, 0x092713508: 80 93 96 02 sts 0x0296, r24FromNaviCtrl_Value.SerialDataOkay = FromNaviCtrl.Param.Byte[9];1350c: 80 91 28 09 lds r24, 0x092813510: 80 93 4f 09 sts 0x094F, r24NC_To_FC_Flags = FromNaviCtrl.Param.Byte[10];13514: 80 91 29 09 lds r24, 0x092913518: 80 93 b7 04 sts 0x04B7, r24//NC_To_FC_MaxAltitude = FromNaviCtrl.Param.Byte[11];break;1351c: a4 c0 rjmp .+328 ; 0x13666 <UpdateSPI_Buffer+0x9ae>case SPI_NCCMD_GPSINFO:GPSInfo.Flags = FromNaviCtrl.Param.Byte[0];1351e: 80 91 1f 09 lds r24, 0x091F13522: 80 93 d7 08 sts 0x08D7, r24GPSInfo.NumOfSats = FromNaviCtrl.Param.Byte[1];13526: 80 91 20 09 lds r24, 0x09201352a: 80 93 d8 08 sts 0x08D8, r24GPSInfo.SatFix = FromNaviCtrl.Param.Byte[2];1352e: 80 91 21 09 lds r24, 0x092113532: 80 93 d9 08 sts 0x08D9, r24GPSInfo.Speed = FromNaviCtrl.Param.Byte[3];13536: 80 91 22 09 lds r24, 0x09221353a: 80 93 da 08 sts 0x08DA, r24GPSInfo.HomeDistance = FromNaviCtrl.Param.Int[2];1353e: 80 91 23 09 lds r24, 0x092313542: 90 91 24 09 lds r25, 0x092413546: 90 93 dc 08 sts 0x08DC, r251354a: 80 93 db 08 sts 0x08DB, r24GPSInfo.HomeBearing = FromNaviCtrl.Param.sInt[3];1354e: 80 91 25 09 lds r24, 0x092513552: 90 91 26 09 lds r25, 0x092613556: 90 93 de 08 sts 0x08DE, r251355a: 80 93 dd 08 sts 0x08DD, r24if((signed char) PPM_in[WP_EVENT_PPM_IN] == -127) // zuletzt war der WP-Event auf Null1355e: 80 91 6b 08 lds r24, 0x086B13562: 90 91 6c 08 lds r25, 0x086C13566: 81 38 cpi r24, 0x81 ; 12913568: 49 f4 brne .+18 ; 0x1357c <UpdateSPI_Buffer+0x8c4>{if(!FromNC_WP_EventChannel_New) FromNC_WP_EventChannel_New = (unsigned char) FromNaviCtrl.Param.Byte[8] + 127; // zwischenspeichern, damit keiner verpasst wird1356a: 80 91 bd 04 lds r24, 0x04BD1356e: 81 11 cpse r24, r113570: 05 c0 rjmp .+10 ; 0x1357c <UpdateSPI_Buffer+0x8c4>13572: 80 91 27 09 lds r24, 0x092713576: 81 58 subi r24, 0x81 ; 12913578: 80 93 bd 04 sts 0x04BD, r24}PPM_in[WP_EVENT_PPM_IN] = (signed char) FromNaviCtrl.Param.Byte[8]; // WP_EVENT-Channel-Value (FromNC_WP_EventChannel)1357c: 80 91 27 09 lds r24, 0x092713580: 99 27 eor r25, r2513582: 87 fd sbrc r24, 713584: 90 95 com r2513586: 90 93 6c 08 sts 0x086C, r251358a: 80 93 6b 08 sts 0x086B, r24FromNC_AltitudeSpeed = FromNaviCtrl.Param.Byte[9];1358e: 80 91 28 09 lds r24, 0x092813592: 80 93 f3 03 sts 0x03F3, r24FromNC_AltitudeSetpoint = (long) FromNaviCtrl.Param.sInt[5] * 10; // in cm13596: 80 91 29 09 lds r24, 0x09291359a: 90 91 2a 09 lds r25, 0x092A1359e: aa 27 eor r26, r26135a0: 97 fd sbrc r25, 7135a2: a0 95 com r26135a4: ba 2f mov r27, r26135a6: 88 0f add r24, r24135a8: 99 1f adc r25, r25135aa: aa 1f adc r26, r26135ac: bb 1f adc r27, r27135ae: ac 01 movw r20, r24135b0: bd 01 movw r22, r26135b2: 44 0f add r20, r20135b4: 55 1f adc r21, r21135b6: 66 1f adc r22, r22135b8: 77 1f adc r23, r23135ba: 44 0f add r20, r20135bc: 55 1f adc r21, r21135be: 66 1f adc r22, r22135c0: 77 1f adc r23, r23135c2: 84 0f add r24, r20135c4: 95 1f adc r25, r21135c6: a6 1f adc r26, r22135c8: b7 1f adc r27, r23135ca: 80 93 f4 03 sts 0x03F4, r24135ce: 90 93 f5 03 sts 0x03F5, r25135d2: a0 93 f6 03 sts 0x03F6, r26135d6: b0 93 f7 03 sts 0x03F7, r27break;135da: 45 c0 rjmp .+138 ; 0x13666 <UpdateSPI_Buffer+0x9ae>case SPI_MISC:EarthMagneticField = FromNaviCtrl.Param.Byte[0];135dc: 80 91 1f 09 lds r24, 0x091F135e0: 80 93 ba 04 sts 0x04BA, r24EarthMagneticInclination = FromNaviCtrl.Param.Byte[1];135e4: 80 91 20 09 lds r24, 0x0920135e8: 80 93 b9 04 sts 0x04B9, r24EarthMagneticInclinationTheoretic = FromNaviCtrl.Param.Byte[2];135ec: 80 91 21 09 lds r24, 0x0921135f0: 80 93 b8 04 sts 0x04B8, r24#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))if(FromNaviCtrl.Param.Byte[3])135f4: 80 91 22 09 lds r24, 0x0922135f8: 88 23 and r24, r24135fa: 49 f0 breq .+18 ; 0x1360e <UpdateSPI_Buffer+0x956>if(!SpeakHoTT || (SpeakHoTT >= SPEAK_GPS_HOLD && SpeakHoTT <= SPEAK_GPS_OFF)) SpeakHoTT = FromNaviCtrl.Param.Byte[3];135fc: 90 91 57 01 lds r25, 0x015713600: 99 23 and r25, r2513602: 19 f0 breq .+6 ; 0x1360a <UpdateSPI_Buffer+0x952>13604: 91 51 subi r25, 0x11 ; 1713606: 93 30 cpi r25, 0x03 ; 313608: 10 f4 brcc .+4 ; 0x1360e <UpdateSPI_Buffer+0x956>1360a: 80 93 57 01 sts 0x0157, r24NaviData_TargetDistance = FromNaviCtrl.Param.Int[3];1360e: 80 91 25 09 lds r24, 0x092513612: 90 91 26 09 lds r25, 0x092613616: 90 93 86 04 sts 0x0486, r251361a: 80 93 85 04 sts 0x0485, r24#endifNaviData_WaypointIndex = FromNaviCtrl.Param.Byte[4];1361e: 80 91 23 09 lds r24, 0x092313622: 80 93 8d 04 sts 0x048D, r24NaviData_WaypointNumber = FromNaviCtrl.Param.Byte[5];13626: 80 91 24 09 lds r24, 0x09241362a: 80 93 8c 04 sts 0x048C, r24NaviData_TargetHoldTime = FromNaviCtrl.Param.Byte[8];1362e: 80 91 27 09 lds r24, 0x092713632: 80 93 8b 04 sts 0x048B, r24NaviData_MaxWpListIndex = FromNaviCtrl.Param.Byte[9];13636: 80 91 28 09 lds r24, 0x09281363a: 80 93 89 04 sts 0x0489, r24CompassCorrected = FromNaviCtrl.Param.sInt[5]; // Bytes 10 & 111363e: 80 91 29 09 lds r24, 0x092913642: 90 91 2a 09 lds r25, 0x092A13646: 90 93 66 06 sts 0x0666, r251364a: 80 93 65 06 sts 0x0665, r24break;1364e: 0b c0 rjmp .+22 ; 0x13666 <UpdateSPI_Buffer+0x9ae>#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))case SPI_NCCMD_HOTT_DATA://if(EE_Parameter.Receiver == RECEIVER_HOTT)NC_Fills_HoTT_Telemety();13650: 0e 94 3e 61 call 0xc27c ; 0xc27c <NC_Fills_HoTT_Telemety>break;13654: 08 c0 rjmp .+16 ; 0x13666 <UpdateSPI_Buffer+0x9ae>}else{// KompassValue = 0;// KompassRichtung = 0;GPS_Nick = 0;13656: 10 92 6b 04 sts 0x046B, r11365a: 10 92 6a 04 sts 0x046A, r1GPS_Roll = 0;1365e: 10 92 69 04 sts 0x0469, r113662: 10 92 68 04 sts 0x0468, r1}}13666: 1f 91 pop r1713668: 0f 91 pop r161366a: ff 90 pop r151366c: ef 90 pop r141366e: df 90 pop r1313670: cf 90 pop r1213672: 08 95 ret00013674 <SPI_StartTransmitPacket>:}//------------------------------------------------------unsigned char SPI_StartTransmitPacket(void){if(!SPITransferCompleted) return(0);13674: 80 91 d6 08 lds r24, 0x08D613678: 88 23 and r24, r241367a: 21 f1 breq .+72 ; 0x136c4 <SPI_StartTransmitPacket+0x50>SLAVE_SELECT_PORT &= ~(1 << SPI_SLAVE_SELECT); // SelectSlave1367c: 45 98 cbi 0x08, 5 ; 8SPI_TX_Buffer = (unsigned char *) &ToNaviCtrl;1367e: 87 ee ldi r24, 0xE7 ; 23113680: 98 e0 ldi r25, 0x08 ; 813682: 90 93 e0 08 sts 0x08E0, r2513686: 80 93 df 08 sts 0x08DF, r24ToNaviCtrl.Command = SPI_CommandSequence[SPI_CommandCounter++];1368a: e0 91 bc 04 lds r30, 0x04BC1368e: 81 e0 ldi r24, 0x01 ; 113690: 8e 0f add r24, r3013692: 80 93 bc 04 sts 0x04BC, r2413696: f0 e0 ldi r31, 0x00 ; 013698: e9 56 subi r30, 0x69 ; 1051369a: fd 4f sbci r31, 0xFD ; 2531369c: 90 81 ld r25, Z1369e: 90 93 e9 08 sts 0x08E9, r25if (SPI_CommandCounter >= sizeof(SPI_CommandSequence)) SPI_CommandCounter = 0;136a2: 8d 30 cpi r24, 0x0D ; 13136a4: 10 f0 brcs .+4 ; 0x136aa <SPI_StartTransmitPacket+0x36>136a6: 10 92 bc 04 sts 0x04BC, r1SPITransferCompleted = 0;136aa: 10 92 d6 08 sts 0x08D6, r1UpdateSPI_Buffer(); // update buffer136ae: 04 db rcall .-2552 ; 0x12cb8 <UpdateSPI_Buffer>SPI_BufferIndex = 1;136b0: 81 e0 ldi r24, 0x01 ; 1136b2: 80 93 e6 08 sts 0x08E6, r24ToNaviCtrl.Chksum = ToNaviCtrl.Sync1;136b6: 80 91 e7 08 lds r24, 0x08E7136ba: 80 93 08 09 sts 0x0908, r24SPDR = ToNaviCtrl.Sync1; // Start transmission136be: 8e bd out 0x2e, r24 ; 46return(1);136c0: 81 e0 ldi r24, 0x01 ; 1136c2: 08 95 ret}//------------------------------------------------------unsigned char SPI_StartTransmitPacket(void){if(!SPITransferCompleted) return(0);136c4: 80 e0 ldi r24, 0x00 ; 0UpdateSPI_Buffer(); // update bufferSPI_BufferIndex = 1;ToNaviCtrl.Chksum = ToNaviCtrl.Sync1;SPDR = ToNaviCtrl.Sync1; // Start transmissionreturn(1);}136c6: 08 95 ret000136c8 <__vector_18>:void Delay_ms(unsigned int w){unsigned int akt;akt = SetDelay(w);while (!CheckDelay(akt));}136c8: 1f 92 push r1136ca: 0f 92 push r0136cc: 0f b6 in r0, 0x3f ; 63136ce: 0f 92 push r0136d0: 11 24 eor r1, r1136d2: 0b b6 in r0, 0x3b ; 59136d4: 0f 92 push r0136d6: 2f 93 push r18136d8: 3f 93 push r19136da: 4f 93 push r20136dc: 5f 93 push r21136de: 6f 93 push r22136e0: 7f 93 push r23136e2: 8f 93 push r24136e4: 9f 93 push r25136e6: af 93 push r26136e8: bf 93 push r27136ea: ef 93 push r30136ec: ff 93 push r31136ee: 80 91 cc 04 lds r24, 0x04CC136f2: 88 23 and r24, r24136f4: 29 f0 breq .+10 ; 0x13700 <__vector_18+0x38>136f6: 80 91 cc 04 lds r24, 0x04CC136fa: 81 50 subi r24, 0x01 ; 1136fc: 80 93 cc 04 sts 0x04CC, r2413700: 80 91 b0 04 lds r24, 0x04B013704: 88 23 and r24, r2413706: 19 f0 breq .+6 ; 0x1370e <__vector_18+0x46>13708: 81 50 subi r24, 0x01 ; 11370a: 80 93 b0 04 sts 0x04B0, r241370e: 80 91 c3 04 lds r24, 0x04C313712: 88 23 and r24, r2413714: 21 f0 breq .+8 ; 0x1371e <__vector_18+0x56>13716: 81 50 subi r24, 0x01 ; 113718: 80 93 c3 04 sts 0x04C3, r241371c: 53 c0 rjmp .+166 ; 0x137c4 <__vector_18+0xfc>1371e: 89 e0 ldi r24, 0x09 ; 913720: 80 93 c3 04 sts 0x04C3, r2413724: 80 91 d2 04 lds r24, 0x04D213728: 90 91 d3 04 lds r25, 0x04D31372c: 01 96 adiw r24, 0x01 ; 11372e: 90 93 d3 04 sts 0x04D3, r2513732: 80 93 d2 04 sts 0x04D2, r2413736: 80 91 a6 02 lds r24, 0x02A61373a: 8f 5f subi r24, 0xFF ; 2551373c: 81 70 andi r24, 0x01 ; 11373e: 80 93 a6 02 sts 0x02A6, r2413742: 81 11 cpse r24, r113744: 09 c0 rjmp .+18 ; 0x13758 <__vector_18+0x90>13746: 80 91 d1 04 lds r24, 0x04D11374a: 84 30 cpi r24, 0x04 ; 41374c: 28 f4 brcc .+10 ; 0x13758 <__vector_18+0x90>1374e: 80 91 d1 04 lds r24, 0x04D113752: 8f 5f subi r24, 0xFF ; 25513754: 80 93 d1 04 sts 0x04D1, r2413758: 34 99 sbic 0x06, 4 ; 61375a: 03 c0 rjmp .+6 ; 0x13762 <__vector_18+0x9a>1375c: 81 e0 ldi r24, 0x01 ; 11375e: 80 93 ca 04 sts 0x04CA, r2413762: 80 91 cd 04 lds r24, 0x04CD13766: 90 91 ce 04 lds r25, 0x04CE1376a: 89 2b or r24, r251376c: 09 f1 breq .+66 ; 0x137b0 <__vector_18+0xe8>1376e: 80 91 cd 04 lds r24, 0x04CD13772: 90 91 ce 04 lds r25, 0x04CE13776: 0b 97 sbiw r24, 0x0b ; 1113778: 50 f0 brcs .+20 ; 0x1378e <__vector_18+0xc6>1377a: 80 91 cd 04 lds r24, 0x04CD1377e: 90 91 ce 04 lds r25, 0x04CE13782: 0a 97 sbiw r24, 0x0a ; 1013784: 90 93 ce 04 sts 0x04CE, r2513788: 80 93 cd 04 sts 0x04CD, r241378c: 04 c0 rjmp .+8 ; 0x13796 <__vector_18+0xce>1378e: 10 92 ce 04 sts 0x04CE, r113792: 10 92 cd 04 sts 0x04CD, r113796: 20 91 cd 04 lds r18, 0x04CD1379a: 30 91 ce 04 lds r19, 0x04CE1379e: 80 91 a9 02 lds r24, 0x02A9137a2: 90 91 aa 02 lds r25, 0x02AA137a6: 82 23 and r24, r18137a8: 93 23 and r25, r19137aa: 89 2b or r24, r25137ac: 41 f4 brne .+16 ; 0x137be <__vector_18+0xf6>137ae: 09 c0 rjmp .+18 ; 0x137c2 <__vector_18+0xfa>137b0: 8f ef ldi r24, 0xFF ; 255137b2: 9f ef ldi r25, 0xFF ; 255137b4: 90 93 aa 02 sts 0x02AA, r25137b8: 80 93 a9 02 sts 0x02A9, r24137bc: 02 c0 rjmp .+4 ; 0x137c2 <__vector_18+0xfa>137be: 47 9a sbi 0x08, 7 ; 8137c0: 01 c0 rjmp .+2 ; 0x137c4 <__vector_18+0xfc>137c2: 47 98 cbi 0x08, 7 ; 8137c4: 80 91 ca 04 lds r24, 0x04CA137c8: 88 23 and r24, r24137ca: 09 f4 brne .+2 ; 0x137ce <__vector_18+0x106>137cc: 60 c0 rjmp .+192 ; 0x1388e <__vector_18+0x1c6>137ce: 80 91 a4 02 lds r24, 0x02A4137d2: 81 11 cpse r24, r1137d4: 5c c0 rjmp .+184 ; 0x1388e <__vector_18+0x1c6>137d6: 80 91 5c 06 lds r24, 0x065C137da: 83 ff sbrs r24, 3137dc: 58 c0 rjmp .+176 ; 0x1388e <__vector_18+0x1c6>137de: 34 9b sbis 0x06, 4 ; 6137e0: 10 c0 rjmp .+32 ; 0x13802 <__vector_18+0x13a>137e2: 80 91 cf 04 lds r24, 0x04CF137e6: 90 91 d0 04 lds r25, 0x04D0137ea: 01 96 adiw r24, 0x01 ; 1137ec: 90 93 d0 04 sts 0x04D0, r25137f0: 80 93 cf 04 sts 0x04CF, r24137f4: 89 3e cpi r24, 0xE9 ; 233137f6: 93 40 sbci r25, 0x03 ; 3137f8: 08 f4 brcc .+2 ; 0x137fc <__vector_18+0x134>137fa: 49 c0 rjmp .+146 ; 0x1388e <__vector_18+0x1c6>137fc: 10 92 ca 04 sts 0x04CA, r113800: 46 c0 rjmp .+140 ; 0x1388e <__vector_18+0x1c6>13802: 80 91 cf 04 lds r24, 0x04CF13806: 90 91 d0 04 lds r25, 0x04D01380a: 89 2b or r24, r251380c: e1 f1 breq .+120 ; 0x13886 <__vector_18+0x1be>1380e: 80 91 cf 04 lds r24, 0x04CF13812: 90 91 d0 04 lds r25, 0x04D013816: 8a 36 cpi r24, 0x6A ; 10613818: 91 40 sbci r25, 0x01 ; 11381a: a8 f5 brcc .+106 ; 0x13886 <__vector_18+0x1be>1381c: 40 91 cf 04 lds r20, 0x04CF13820: 50 91 d0 04 lds r21, 0x04D013824: e0 91 cf 04 lds r30, 0x04CF13828: f0 91 d0 04 lds r31, 0x04D01382c: 9a 01 movw r18, r201382e: ad e9 ldi r26, 0x9D ; 15713830: bf e8 ldi r27, 0x8F ; 14313832: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>13836: 48 1b sub r20, r2413838: 59 0b sbc r21, r251383a: 56 95 lsr r211383c: 47 95 ror r201383e: 84 0f add r24, r2013840: 95 1f adc r25, r2113842: 96 95 lsr r2513844: 87 95 ror r2413846: 92 95 swap r2513848: 82 95 swap r241384a: 8f 70 andi r24, 0x0F ; 151384c: 89 27 eor r24, r251384e: 9f 70 andi r25, 0x0F ; 1513850: 89 27 eor r24, r2513852: e8 0f add r30, r2413854: f9 1f adc r31, r2513856: f0 93 d0 04 sts 0x04D0, r311385a: e0 93 cf 04 sts 0x04CF, r301385e: 80 91 cf 04 lds r24, 0x04CF13862: 90 91 d0 04 lds r25, 0x04D013866: 0b 97 sbiw r24, 0x0b ; 1113868: 50 f0 brcs .+20 ; 0x1387e <__vector_18+0x1b6>1386a: 80 91 cf 04 lds r24, 0x04CF1386e: 90 91 d0 04 lds r25, 0x04D013872: 0a 97 sbiw r24, 0x0a ; 1013874: 90 93 4f 01 sts 0x014F, r2513878: 80 93 4e 01 sts 0x014E, r241387c: 04 c0 rjmp .+8 ; 0x13886 <__vector_18+0x1be>1387e: 10 92 4f 01 sts 0x014F, r113882: 10 92 4e 01 sts 0x014E, r113886: 10 92 d0 04 sts 0x04D0, r11388a: 10 92 cf 04 sts 0x04CF, r11388e: ff 91 pop r3113890: ef 91 pop r3013892: bf 91 pop r2713894: af 91 pop r2613896: 9f 91 pop r2513898: 8f 91 pop r241389a: 7f 91 pop r231389c: 6f 91 pop r221389e: 5f 91 pop r21138a0: 4f 91 pop r20138a2: 3f 91 pop r19138a4: 2f 91 pop r18138a6: 0f 90 pop r0138a8: 0b be out 0x3b, r0 ; 59138aa: 0f 90 pop r0138ac: 0f be out 0x3f, r0 ; 63138ae: 0f 90 pop r0138b0: 1f 90 pop r1138b2: 18 95 reti000138b4 <SetDelay>:138b4: 20 91 d2 04 lds r18, 0x04D2138b8: 30 91 d3 04 lds r19, 0x04D3138bc: 2f 5f subi r18, 0xFF ; 255138be: 3f 4f sbci r19, 0xFF ; 255138c0: 82 0f add r24, r18138c2: 93 1f adc r25, r19138c4: 08 95 ret000138c6 <CheckDelay>:138c6: 20 91 d2 04 lds r18, 0x04D2138ca: 30 91 d3 04 lds r19, 0x04D3138ce: 82 1b sub r24, r18138d0: 93 0b sbc r25, r19138d2: 88 27 eor r24, r24138d4: 90 78 andi r25, 0x80 ; 128138d6: 89 2f mov r24, r25138d8: 86 95 lsr r24138da: 08 95 ret000138dc <Delay_ms_Mess>:void Delay_ms_Mess(unsigned int w){138dc: ff 92 push r15138de: 0f 93 push r16138e0: 1f 93 push r17138e2: cf 93 push r28138e4: df 93 push r29// -----------------------------------------------------------------------unsigned int SetDelay(unsigned int t){// TIMSK0 &= ~_BV(TOIE0);return(CountMilliseconds + t + 1);138e6: c0 91 d2 04 lds r28, 0x04D2138ea: d0 91 d3 04 lds r29, 0x04D3138ee: 21 96 adiw r28, 0x01 ; 1138f0: c8 0f add r28, r24138f2: d9 1f adc r29, r25void Delay_ms_Mess(unsigned int w){unsigned int akt;akt = SetDelay(w);while (!CheckDelay(akt)) if(AdReady) {AdReady = 0; ANALOG_ON;}138f4: 0a e7 ldi r16, 0x7A ; 122138f6: 10 e0 ldi r17, 0x00 ; 0138f8: 0f 2e mov r0, r31138fa: ff ec ldi r31, 0xCF ; 207138fc: ff 2e mov r15, r31138fe: f0 2d mov r31, r013900: 08 c0 rjmp .+16 ; 0x13912 <Delay_ms_Mess+0x36>13902: 80 91 0f 01 lds r24, 0x010F13906: 88 23 and r24, r2413908: 21 f0 breq .+8 ; 0x13912 <Delay_ms_Mess+0x36>1390a: 10 92 0f 01 sts 0x010F, r11390e: f8 01 movw r30, r1613910: f0 82 st Z, r1513912: ce 01 movw r24, r2813914: d8 df rcall .-80 ; 0x138c6 <CheckDelay>13916: 88 23 and r24, r2413918: a1 f3 breq .-24 ; 0x13902 <Delay_ms_Mess+0x26>}1391a: df 91 pop r291391c: cf 91 pop r281391e: 1f 91 pop r1713920: 0f 91 pop r1613922: ff 90 pop r1513924: 08 95 ret00013926 <TIMER2_Init>:/*****************************************************/// The timer 2 is used to generate the PWM at PD7 (J7)// to control a camera servo for nick compensation.void TIMER2_Init(void){uint8_t sreg = SREG;13926: 8f b7 in r24, 0x3f ; 63// disable all interrupts before reconfigurationcli();13928: f8 94 cliPORTD &= ~(1<<PORTD7); // set PD7 to low1392a: 5f 98 cbi 0x0b, 7 ; 11DDRC |= (1<<DDRC6); // set PC6 as output (Reset for HEF4017)1392c: 3e 9a sbi 0x07, 6 ; 7HEF4017Reset_ON;1392e: 46 9a sbi 0x08, 6 ; 8// Timer/Counter 2 Control Register A// Timer Mode is FastPWM with timer reload at OCR2A (Bits: WGM22 = 1, WGM21 = 1, WGM20 = 1)// PD7: Normal port operation, OC2A disconnected, (Bits: COM2A1 = 0, COM2A0 = 0)// PD6: Normal port operation, OC2B disconnected, (Bits: COM2B1 = 0, COM2B0 = 0)TCCR2A &= ~((1<<COM2A1)|(1<<COM2A0)|(1<<COM2B1)|(1<<COM2B0));13930: e0 eb ldi r30, 0xB0 ; 17613932: f0 e0 ldi r31, 0x00 ; 013934: 90 81 ld r25, Z13936: 9f 70 andi r25, 0x0F ; 1513938: 90 83 st Z, r25TCCR2A |= (1<<WGM21)|(1<<WGM20);1393a: 90 81 ld r25, Z1393c: 93 60 ori r25, 0x03 ; 31393e: 90 83 st Z, r25// Set clock divider for timer 2 to SYSKLOCK/32 = 20MHz / 32 = 625 kHz// The timer increments from 0x00 to 0xFF with an update rate of 625 kHz or 1.6 us// hence the timer overflow interrupt frequency is 625 kHz / 256 = 2.44 kHz or 0.4096 ms// divider 32 (Bits: CS022 = 0, CS21 = 1, CS20 = 1)TCCR2B &= ~((1<<FOC2A)|(1<<FOC2B)|(1<<CS22));13940: a1 eb ldi r26, 0xB1 ; 17713942: b0 e0 ldi r27, 0x00 ; 013944: 9c 91 ld r25, X13946: 9b 73 andi r25, 0x3B ; 5913948: 9c 93 st X, r25TCCR2B |= (1<<CS21)|(1<<CS20)|(1<<WGM22);1394a: 9c 91 ld r25, X1394c: 9b 60 ori r25, 0x0B ; 111394e: 9c 93 st X, r25// Initialize the Timer/Counter 2 RegisterTCNT2 = 0;13950: 10 92 b2 00 sts 0x00B2, r1// Initialize the Output Compare Register A used for PWM generation on port PD7.OCR2A = 255;13954: 9f ef ldi r25, 0xFF ; 25513956: 90 93 b3 00 sts 0x00B3, r25TCCR2A |= (1<<COM2A1); // set or clear at compare match depends on value of COM2A01395a: 90 81 ld r25, Z1395c: 90 68 ori r25, 0x80 ; 1281395e: 90 83 st Z, r25// Timer/Counter 2 Interrupt Mask Register// Enable timer output compare match A Interrupt onlyTIMSK2 &= ~((1<<OCIE2B)|(1<<TOIE2));13960: e0 e7 ldi r30, 0x70 ; 11213962: f0 e0 ldi r31, 0x00 ; 013964: 90 81 ld r25, Z13966: 9a 7f andi r25, 0xFA ; 25013968: 90 83 st Z, r25TIMSK2 |= (1<<OCIE2A);1396a: 90 81 ld r25, Z1396c: 92 60 ori r25, 0x02 ; 21396e: 90 83 st Z, r25SREG = sreg;13970: 8f bf out 0x3f, r24 ; 6313972: 08 95 ret00013974 <Timer_Init>:// -----------------------------------------------------------------------unsigned int SetDelay(unsigned int t){// TIMSK0 &= ~_BV(TOIE0);return(CountMilliseconds + t + 1);13974: 80 91 d2 04 lds r24, 0x04D213978: 90 91 d3 04 lds r25, 0x04D31397c: 0b 96 adiw r24, 0x0b ; 11}//----------------------------void Timer_Init(void){tim_main = SetDelay(10);1397e: 90 93 52 09 sts 0x0952, r2513982: 80 93 51 09 sts 0x0951, r24TCCR0B = CK8;13986: 82 e0 ldi r24, 0x02 ; 213988: 85 bd out 0x25, r24 ; 37// TCCR0A = (1<<COM0A1)|(1<<COM0B1)|3;//fast PWMTCCR0A = (1<<COM0A1)|(1<<COM0B1)|(1<<COM0B0)|3;//fast PWM1398a: 83 eb ldi r24, 0xB3 ; 1791398c: 84 bd out 0x24, r24 ; 36OCR0B = 255;1398e: 8f ef ldi r24, 0xFF ; 25513990: 88 bd out 0x28, r24 ; 40OCR0A = 180;13992: 84 eb ldi r24, 0xB4 ; 18013994: 87 bd out 0x27, r24 ; 39TCNT0 = (unsigned char)-TIMER_RELOAD_VALUE; // reload13996: 86 e0 ldi r24, 0x06 ; 613998: 86 bd out 0x26, r24 ; 38//OCR1 = 0x00;TIMSK0 |= _BV(TOIE0);1399a: ee e6 ldi r30, 0x6E ; 1101399c: f0 e0 ldi r31, 0x00 ; 01399e: 80 81 ld r24, Z139a0: 81 60 ori r24, 0x01 ; 1139a2: 80 83 st Z, r24139a4: 08 95 ret000139a6 <CalcNickServoValue>:/*****************************************************/void CalcNickServoValue(void){signed int max, min;if(EE_Parameter.ServoCompInvert & SERVO_RELATIVE) // relative moving of the servo value139a6: 80 91 b7 05 lds r24, 0x05B7139aa: 82 ff sbrs r24, 2139ac: 32 c0 rjmp .+100 ; 0x13a12 <CalcNickServoValue+0x6c>{max = ((unsigned int) EE_Parameter.ServoNickMax * MULTIPLYER * 15);139ae: 50 91 6e 05 lds r21, 0x056Emin = ((unsigned int) EE_Parameter.ServoNickMin * MULTIPLYER * 20);139b2: 20 91 6d 05 lds r18, 0x056D139b6: 40 e5 ldi r20, 0x50 ; 80139b8: 24 9f mul r18, r20139ba: 90 01 movw r18, r0139bc: 11 24 eor r1, r1NickServoValue -= ((signed char) (Parameter_ServoNickControl - 128) / 4) * 6;139be: 80 91 2f 01 lds r24, 0x012F139c2: 80 58 subi r24, 0x80 ; 128139c4: 0a f4 brpl .+2 ; 0x139c8 <CalcNickServoValue+0x22>139c6: 8d 5f subi r24, 0xFD ; 253139c8: 48 2f mov r20, r24139ca: 45 95 asr r20139cc: 45 95 asr r20139ce: 80 91 a7 02 lds r24, 0x02A7139d2: 90 91 a8 02 lds r25, 0x02A8139d6: 66 e0 ldi r22, 0x06 ; 6139d8: 46 02 muls r20, r22139da: 80 19 sub r24, r0139dc: 91 09 sbc r25, r1139de: 11 24 eor r1, r1LIMIT_MIN_MAX(NickServoValue,min, max);139e0: 28 17 cp r18, r24139e2: 39 07 cpc r19, r25139e4: 2c f0 brlt .+10 ; 0x139f0 <CalcNickServoValue+0x4a>139e6: 30 93 a8 02 sts 0x02A8, r19139ea: 20 93 a7 02 sts 0x02A7, r18139ee: 08 95 ret{signed int max, min;if(EE_Parameter.ServoCompInvert & SERVO_RELATIVE) // relative moving of the servo value{max = ((unsigned int) EE_Parameter.ServoNickMax * MULTIPLYER * 15);139f0: 4c e3 ldi r20, 0x3C ; 60139f2: 54 9f mul r21, r20139f4: 90 01 movw r18, r0139f6: 11 24 eor r1, r1min = ((unsigned int) EE_Parameter.ServoNickMin * MULTIPLYER * 20);NickServoValue -= ((signed char) (Parameter_ServoNickControl - 128) / 4) * 6;LIMIT_MIN_MAX(NickServoValue,min, max);139f8: 82 17 cp r24, r18139fa: 93 07 cpc r25, r19139fc: 2c f4 brge .+10 ; 0x13a08 <CalcNickServoValue+0x62>if(EE_Parameter.ServoCompInvert & SERVO_RELATIVE) // relative moving of the servo value{max = ((unsigned int) EE_Parameter.ServoNickMax * MULTIPLYER * 15);min = ((unsigned int) EE_Parameter.ServoNickMin * MULTIPLYER * 20);NickServoValue -= ((signed char) (Parameter_ServoNickControl - 128) / 4) * 6;139fe: 90 93 a8 02 sts 0x02A8, r2513a02: 80 93 a7 02 sts 0x02A7, r2413a06: 08 95 retLIMIT_MIN_MAX(NickServoValue,min, max);13a08: 30 93 a8 02 sts 0x02A8, r1913a0c: 20 93 a7 02 sts 0x02A7, r1813a10: 08 95 ret}else NickServoValue = (int16_t)Parameter_ServoNickControl * (MULTIPLYER*16); // direct poti control13a12: 80 91 2f 01 lds r24, 0x012F13a16: 60 e4 ldi r22, 0x40 ; 6413a18: 86 9f mul r24, r2213a1a: c0 01 movw r24, r013a1c: 11 24 eor r1, r113a1e: 90 93 a8 02 sts 0x02A8, r2513a22: 80 93 a7 02 sts 0x02A7, r2413a26: 08 95 ret00013a28 <CalculateServo>:}void CalculateServo(void){13a28: 8f 92 push r813a2a: 9f 92 push r913a2c: af 92 push r1013a2e: bf 92 push r1113a30: cf 92 push r1213a32: df 92 push r1313a34: ef 92 push r1413a36: ff 92 push r1513a38: 0f 93 push r1613a3a: 1f 93 push r17signed char cosinus, sinus;signed long nick, roll;cosinus = sintab[EE_Parameter.CamOrientation + 6];13a3c: e0 91 75 05 lds r30, 0x057513a40: f0 e0 ldi r31, 0x00 ; 013a42: e5 53 subi r30, 0x35 ; 5313a44: fd 4f sbci r31, 0xFD ; 25313a46: a6 81 ldd r26, Z+6 ; 0x06sinus = sintab[EE_Parameter.CamOrientation];13a48: e0 81 ld r30, Zif(CalculateServoSignals == 1)13a4a: 80 91 af 02 lds r24, 0x02AF13a4e: 81 30 cpi r24, 0x01 ; 113a50: 09 f0 breq .+2 ; 0x13a54 <CalculateServo+0x2c>13a52: 31 c1 rjmp .+610 ; 0x13cb6 <CalculateServo+0x28e>{if(EE_Parameter.GlobalConfig3 & CFG3_SERVO_NICK_COMP_OFF) nick = 0;13a54: 80 91 b9 05 lds r24, 0x05B913a58: 88 23 and r24, r2413a5a: 0c f4 brge .+2 ; 0x13a5e <CalculateServo+0x36>13a5c: 47 c0 rjmp .+142 ; 0x13aec <CalculateServo+0xc4>else nick = (cosinus * IntegralNick) / 128L - (sinus * IntegralRoll) / 128L;13a5e: 20 91 42 04 lds r18, 0x044213a62: 30 91 43 04 lds r19, 0x044313a66: 40 91 44 04 lds r20, 0x044413a6a: 50 91 45 04 lds r21, 0x044513a6e: bb 27 eor r27, r2713a70: a7 fd sbrc r26, 713a72: b0 95 com r2713a74: 0e 94 d2 b1 call 0x163a4 ; 0x163a4 <__mulshisi3>13a78: 8b 01 movw r16, r2213a7a: 9c 01 movw r18, r2413a7c: 99 23 and r25, r2513a7e: 24 f4 brge .+8 ; 0x13a88 <CalculateServo+0x60>13a80: 01 58 subi r16, 0x81 ; 12913a82: 1f 4f sbci r17, 0xFF ; 25513a84: 2f 4f sbci r18, 0xFF ; 25513a86: 3f 4f sbci r19, 0xFF ; 25513a88: 68 01 movw r12, r1613a8a: 79 01 movw r14, r1813a8c: 68 94 set13a8e: 16 f8 bld r1, 613a90: f5 94 asr r1513a92: e7 94 ror r1413a94: d7 94 ror r1313a96: c7 94 ror r1213a98: 16 94 lsr r113a9a: d1 f7 brne .-12 ; 0x13a90 <CalculateServo+0x68>13a9c: 20 91 3e 04 lds r18, 0x043E13aa0: 30 91 3f 04 lds r19, 0x043F13aa4: 40 91 40 04 lds r20, 0x044013aa8: 50 91 41 04 lds r21, 0x044113aac: ae 2f mov r26, r3013aae: bb 27 eor r27, r2713ab0: a7 fd sbrc r26, 713ab2: b0 95 com r2713ab4: 0e 94 d2 b1 call 0x163a4 ; 0x163a4 <__mulshisi3>13ab8: 4b 01 movw r8, r2213aba: 5c 01 movw r10, r2413abc: 99 23 and r25, r2513abe: 2c f4 brge .+10 ; 0x13aca <CalculateServo+0xa2>13ac0: 2f e7 ldi r18, 0x7F ; 12713ac2: 82 0e add r8, r1813ac4: 91 1c adc r9, r113ac6: a1 1c adc r10, r113ac8: b1 1c adc r11, r113aca: d5 01 movw r26, r1013acc: c4 01 movw r24, r813ace: 68 94 set13ad0: 16 f8 bld r1, 613ad2: b5 95 asr r2713ad4: a7 95 ror r2613ad6: 97 95 ror r2513ad8: 87 95 ror r2413ada: 16 94 lsr r113adc: d1 f7 brne .-12 ; 0x13ad2 <CalculateServo+0xaa>13ade: 97 01 movw r18, r1413ae0: 86 01 movw r16, r1213ae2: 08 1b sub r16, r2413ae4: 19 0b sbc r17, r2513ae6: 2a 0b sbc r18, r2613ae8: 3b 0b sbc r19, r2713aea: 03 c0 rjmp .+6 ; 0x13af2 <CalculateServo+0xca>cosinus = sintab[EE_Parameter.CamOrientation + 6];sinus = sintab[EE_Parameter.CamOrientation];if(CalculateServoSignals == 1){if(EE_Parameter.GlobalConfig3 & CFG3_SERVO_NICK_COMP_OFF) nick = 0;13aec: 00 e0 ldi r16, 0x00 ; 013aee: 10 e0 ldi r17, 0x00 ; 013af0: 98 01 movw r18, r16else nick = (cosinus * IntegralNick) / 128L - (sinus * IntegralRoll) / 128L;nick -= POI_KameraNick * 7;nick = ((long)Parameter_ServoNickComp * nick) / 512L;13af2: e0 91 2d 01 lds r30, 0x012Dif(CalculateServoSignals == 1){if(EE_Parameter.GlobalConfig3 & CFG3_SERVO_NICK_COMP_OFF) nick = 0;else nick = (cosinus * IntegralNick) / 128L - (sinus * IntegralRoll) / 128L;nick -= POI_KameraNick * 7;13af6: 60 91 b5 04 lds r22, 0x04B513afa: 70 91 b6 04 lds r23, 0x04B613afe: cb 01 movw r24, r2213b00: 88 0f add r24, r2413b02: 99 1f adc r25, r2513b04: 88 0f add r24, r2413b06: 99 1f adc r25, r2513b08: 88 0f add r24, r2413b0a: 99 1f adc r25, r2513b0c: 86 1b sub r24, r2213b0e: 97 0b sbc r25, r2313b10: aa 27 eor r26, r2613b12: 97 fd sbrc r25, 713b14: a0 95 com r2613b16: ba 2f mov r27, r2613b18: a9 01 movw r20, r1813b1a: 98 01 movw r18, r1613b1c: 28 1b sub r18, r2413b1e: 39 0b sbc r19, r2513b20: 4a 0b sbc r20, r2613b22: 5b 0b sbc r21, r27nick = ((long)Parameter_ServoNickComp * nick) / 512L;13b24: ae 2f mov r26, r3013b26: b0 e0 ldi r27, 0x00 ; 013b28: 0e 94 c8 b1 call 0x16390 ; 0x16390 <__muluhisi3>13b2c: 6b 01 movw r12, r2213b2e: 7c 01 movw r14, r2413b30: 99 23 and r25, r2513b32: 34 f4 brge .+12 ; 0x13b40 <CalculateServo+0x118>13b34: 3f ef ldi r19, 0xFF ; 25513b36: c3 0e add r12, r1913b38: 31 e0 ldi r19, 0x01 ; 113b3a: d3 1e adc r13, r1913b3c: e1 1c adc r14, r113b3e: f1 1c adc r15, r113b40: 0b 2e mov r0, r2713b42: b9 e0 ldi r27, 0x09 ; 913b44: f5 94 asr r1513b46: e7 94 ror r1413b48: d7 94 ror r1313b4a: c7 94 ror r1213b4c: ba 95 dec r2713b4e: d1 f7 brne .-12 ; 0x13b44 <CalculateServo+0x11c>13b50: b0 2d mov r27, r0// offset (Range from 0 to 255 * 3 = 765)if(EE_Parameter.ServoCompInvert & SERVO_RELATIVE) ServoNickOffset = NickServoValue;13b52: e0 91 b7 05 lds r30, 0x05B713b56: e2 ff sbrs r30, 213b58: 09 c0 rjmp .+18 ; 0x13b6c <CalculateServo+0x144>13b5a: 80 91 a7 02 lds r24, 0x02A713b5e: 90 91 a8 02 lds r25, 0x02A813b62: 90 93 ae 02 sts 0x02AE, r2513b66: 80 93 ad 02 sts 0x02AD, r2413b6a: 19 c0 rjmp .+50 ; 0x13b9e <CalculateServo+0x176>else ServoNickOffset += (NickServoValue - ServoNickOffset) / EE_Parameter.ServoManualControlSpeed;13b6c: 40 91 ad 02 lds r20, 0x02AD13b70: 50 91 ae 02 lds r21, 0x02AE13b74: 20 91 ad 02 lds r18, 0x02AD13b78: 30 91 ae 02 lds r19, 0x02AE13b7c: 80 91 a7 02 lds r24, 0x02A713b80: 90 91 a8 02 lds r25, 0x02A813b84: 84 1b sub r24, r2013b86: 95 0b sbc r25, r2113b88: 60 91 74 05 lds r22, 0x057413b8c: 70 e0 ldi r23, 0x00 ; 013b8e: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>13b92: 26 0f add r18, r2213b94: 37 1f adc r19, r2313b96: 30 93 ae 02 sts 0x02AE, r1913b9a: 20 93 ad 02 sts 0x02AD, r18if(EE_Parameter.ServoCompInvert & SERVO_NICK_INV) // inverting movement of servo13b9e: e0 ff sbrs r30, 013ba0: 18 c0 rjmp .+48 ; 0x13bd2 <CalculateServo+0x1aa>{nick = ServoNickOffset / 16 + nick;13ba2: 80 91 ad 02 lds r24, 0x02AD13ba6: 90 91 ae 02 lds r25, 0x02AE13baa: 99 23 and r25, r2513bac: 0c f4 brge .+2 ; 0x13bb0 <CalculateServo+0x188>13bae: 0f 96 adiw r24, 0x0f ; 1513bb0: 95 95 asr r2513bb2: 87 95 ror r2413bb4: 95 95 asr r2513bb6: 87 95 ror r2413bb8: 95 95 asr r2513bba: 87 95 ror r2413bbc: 95 95 asr r2513bbe: 87 95 ror r2413bc0: aa 27 eor r26, r2613bc2: 97 fd sbrc r25, 713bc4: a0 95 com r2613bc6: ba 2f mov r27, r2613bc8: c8 0e add r12, r2413bca: d9 1e adc r13, r2513bcc: ea 1e adc r14, r2613bce: fb 1e adc r15, r2713bd0: 1b c0 rjmp .+54 ; 0x13c08 <CalculateServo+0x1e0>}else{ // inverting movement of servonick = ServoNickOffset / 16 - nick;13bd2: 80 91 ad 02 lds r24, 0x02AD13bd6: 90 91 ae 02 lds r25, 0x02AE13bda: 99 23 and r25, r2513bdc: 0c f4 brge .+2 ; 0x13be0 <CalculateServo+0x1b8>13bde: 0f 96 adiw r24, 0x0f ; 1513be0: 95 95 asr r2513be2: 87 95 ror r2413be4: 95 95 asr r2513be6: 87 95 ror r2413be8: 95 95 asr r2513bea: 87 95 ror r2413bec: 95 95 asr r2513bee: 87 95 ror r2413bf0: aa 27 eor r26, r2613bf2: 97 fd sbrc r25, 713bf4: a0 95 com r2613bf6: ba 2f mov r27, r2613bf8: 9c 01 movw r18, r2413bfa: ad 01 movw r20, r2613bfc: 2c 19 sub r18, r1213bfe: 3d 09 sbc r19, r1313c00: 4e 09 sbc r20, r1413c02: 5f 09 sbc r21, r1513c04: 69 01 movw r12, r1813c06: 7a 01 movw r14, r20}if(EE_Parameter.ServoFilterNick) ServoNickValue = ((ServoNickValue * EE_Parameter.ServoFilterNick) + nick) / (EE_Parameter.ServoFilterNick + 1);13c08: 20 91 a9 05 lds r18, 0x05A913c0c: 22 23 and r18, r1813c0e: 21 f1 breq .+72 ; 0x13c58 <CalculateServo+0x230>13c10: 30 e0 ldi r19, 0x00 ; 013c12: 80 91 c6 04 lds r24, 0x04C613c16: 90 91 c7 04 lds r25, 0x04C713c1a: 28 9f mul r18, r2413c1c: b0 01 movw r22, r013c1e: 29 9f mul r18, r2513c20: 70 0d add r23, r013c22: 38 9f mul r19, r2413c24: 70 0d add r23, r013c26: 11 24 eor r1, r113c28: cb 01 movw r24, r2213c2a: aa 27 eor r26, r2613c2c: 97 fd sbrc r25, 713c2e: a0 95 com r2613c30: ba 2f mov r27, r2613c32: bc 01 movw r22, r2413c34: cd 01 movw r24, r2613c36: 6c 0d add r22, r1213c38: 7d 1d adc r23, r1313c3a: 8e 1d adc r24, r1413c3c: 9f 1d adc r25, r1513c3e: 2f 5f subi r18, 0xFF ; 25513c40: 3f 4f sbci r19, 0xFF ; 25513c42: 44 27 eor r20, r2013c44: 37 fd sbrc r19, 713c46: 40 95 com r2013c48: 54 2f mov r21, r2013c4a: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>13c4e: 30 93 c7 04 sts 0x04C7, r1913c52: 20 93 c6 04 sts 0x04C6, r1813c56: 04 c0 rjmp .+8 ; 0x13c60 <CalculateServo+0x238>else ServoNickValue = nick;13c58: d0 92 c7 04 sts 0x04C7, r1313c5c: c0 92 c6 04 sts 0x04C6, r12// limit servo value to its parameter range definitionif(ServoNickValue < ((int16_t)EE_Parameter.ServoNickMin * MULTIPLYER))13c60: 80 91 6d 05 lds r24, 0x056D13c64: 90 e0 ldi r25, 0x00 ; 013c66: 88 0f add r24, r2413c68: 99 1f adc r25, r2513c6a: 88 0f add r24, r2413c6c: 99 1f adc r25, r2513c6e: 20 91 c6 04 lds r18, 0x04C613c72: 30 91 c7 04 lds r19, 0x04C713c76: 28 17 cp r18, r2413c78: 39 07 cpc r19, r2513c7a: 2c f4 brge .+10 ; 0x13c86 <CalculateServo+0x25e>{ServoNickValue = (int16_t)EE_Parameter.ServoNickMin * MULTIPLYER;13c7c: 90 93 c7 04 sts 0x04C7, r2513c80: 80 93 c6 04 sts 0x04C6, r2413c84: 12 c0 rjmp .+36 ; 0x13caa <CalculateServo+0x282>}elseif(ServoNickValue > ((int16_t)EE_Parameter.ServoNickMax * MULTIPLYER))13c86: 80 91 6e 05 lds r24, 0x056E13c8a: 90 e0 ldi r25, 0x00 ; 013c8c: 88 0f add r24, r2413c8e: 99 1f adc r25, r2513c90: 88 0f add r24, r2413c92: 99 1f adc r25, r2513c94: 20 91 c6 04 lds r18, 0x04C613c98: 30 91 c7 04 lds r19, 0x04C713c9c: 82 17 cp r24, r1813c9e: 93 07 cpc r25, r1913ca0: 24 f4 brge .+8 ; 0x13caa <CalculateServo+0x282>{ServoNickValue = (int16_t)EE_Parameter.ServoNickMax * MULTIPLYER;13ca2: 90 93 c7 04 sts 0x04C7, r2513ca6: 80 93 c6 04 sts 0x04C6, r24}// if(PlatinenVersion < 20) CalculateServoSignals = 0; elseCalculateServoSignals++;13caa: 80 91 af 02 lds r24, 0x02AF13cae: 8f 5f subi r24, 0xFF ; 25513cb0: 80 93 af 02 sts 0x02AF, r2413cb4: 07 c1 rjmp .+526 ; 0x13ec4 <CalculateServo+0x49c>}else{roll = (cosinus * IntegralRoll) / 128L + (sinus * IntegralNick) / 128L;roll = ((long)Parameter_ServoRollComp * roll) / 512L;13cb6: c0 90 2c 01 lds r12, 0x012C13cba: d1 2c mov r13, r113cbc: e1 2c mov r14, r113cbe: f1 2c mov r15, r1// if(PlatinenVersion < 20) CalculateServoSignals = 0; elseCalculateServoSignals++;}else{roll = (cosinus * IntegralRoll) / 128L + (sinus * IntegralNick) / 128L;13cc0: 20 91 3e 04 lds r18, 0x043E13cc4: 30 91 3f 04 lds r19, 0x043F13cc8: 40 91 40 04 lds r20, 0x044013ccc: 50 91 41 04 lds r21, 0x044113cd0: bb 27 eor r27, r2713cd2: a7 fd sbrc r26, 713cd4: b0 95 com r2713cd6: 0e 94 d2 b1 call 0x163a4 ; 0x163a4 <__mulshisi3>13cda: 8b 01 movw r16, r2213cdc: 9c 01 movw r18, r2413cde: 99 23 and r25, r2513ce0: 24 f4 brge .+8 ; 0x13cea <CalculateServo+0x2c2>13ce2: 01 58 subi r16, 0x81 ; 12913ce4: 1f 4f sbci r17, 0xFF ; 25513ce6: 2f 4f sbci r18, 0xFF ; 25513ce8: 3f 4f sbci r19, 0xFF ; 25513cea: 48 01 movw r8, r1613cec: 59 01 movw r10, r1813cee: 68 94 set13cf0: 16 f8 bld r1, 613cf2: b5 94 asr r1113cf4: a7 94 ror r1013cf6: 97 94 ror r913cf8: 87 94 ror r813cfa: 16 94 lsr r113cfc: d1 f7 brne .-12 ; 0x13cf2 <CalculateServo+0x2ca>13cfe: 20 91 42 04 lds r18, 0x044213d02: 30 91 43 04 lds r19, 0x044313d06: 40 91 44 04 lds r20, 0x044413d0a: 50 91 45 04 lds r21, 0x044513d0e: ae 2f mov r26, r3013d10: bb 27 eor r27, r2713d12: a7 fd sbrc r26, 713d14: b0 95 com r2713d16: 0e 94 d2 b1 call 0x163a4 ; 0x163a4 <__mulshisi3>13d1a: 8b 01 movw r16, r2213d1c: 9c 01 movw r18, r2413d1e: 99 23 and r25, r2513d20: 24 f4 brge .+8 ; 0x13d2a <CalculateServo+0x302>13d22: 01 58 subi r16, 0x81 ; 12913d24: 1f 4f sbci r17, 0xFF ; 25513d26: 2f 4f sbci r18, 0xFF ; 25513d28: 3f 4f sbci r19, 0xFF ; 25513d2a: d9 01 movw r26, r1813d2c: c8 01 movw r24, r1613d2e: 68 94 set13d30: 16 f8 bld r1, 613d32: b5 95 asr r2713d34: a7 95 ror r2613d36: 97 95 ror r2513d38: 87 95 ror r2413d3a: 16 94 lsr r113d3c: d1 f7 brne .-12 ; 0x13d32 <CalculateServo+0x30a>13d3e: bc 01 movw r22, r2413d40: cd 01 movw r24, r2613d42: 68 0d add r22, r813d44: 79 1d adc r23, r913d46: 8a 1d adc r24, r1013d48: 9b 1d adc r25, r11roll = ((long)Parameter_ServoRollComp * roll) / 512L;13d4a: a7 01 movw r20, r1413d4c: 96 01 movw r18, r1213d4e: 0e 94 27 b1 call 0x1624e ; 0x1624e <__mulsi3>13d52: 6b 01 movw r12, r2213d54: 7c 01 movw r14, r2413d56: 99 23 and r25, r2513d58: 34 f4 brge .+12 ; 0x13d66 <CalculateServo+0x33e>13d5a: 3f ef ldi r19, 0xFF ; 25513d5c: c3 0e add r12, r1913d5e: 31 e0 ldi r19, 0x01 ; 113d60: d3 1e adc r13, r1913d62: e1 1c adc r14, r113d64: f1 1c adc r15, r113d66: 0b 2e mov r0, r2713d68: b9 e0 ldi r27, 0x09 ; 913d6a: f5 94 asr r1513d6c: e7 94 ror r1413d6e: d7 94 ror r1313d70: c7 94 ror r1213d72: ba 95 dec r2713d74: d1 f7 brne .-12 ; 0x13d6a <CalculateServo+0x342>13d76: b0 2d mov r27, r0ServoRollOffset += ((int16_t)Parameter_ServoRollControl * (MULTIPLYER*16) - ServoRollOffset) / EE_Parameter.ServoManualControlSpeed;13d78: 40 91 ab 02 lds r20, 0x02AB13d7c: 50 91 ac 02 lds r21, 0x02AC13d80: 20 91 ab 02 lds r18, 0x02AB13d84: 30 91 ac 02 lds r19, 0x02AC13d88: 80 91 2e 01 lds r24, 0x012E13d8c: 60 e4 ldi r22, 0x40 ; 6413d8e: 86 9f mul r24, r2213d90: c0 01 movw r24, r013d92: 11 24 eor r1, r113d94: 84 1b sub r24, r2013d96: 95 0b sbc r25, r2113d98: 60 91 74 05 lds r22, 0x057413d9c: 70 e0 ldi r23, 0x00 ; 013d9e: 0e 94 56 b1 call 0x162ac ; 0x162ac <__divmodhi4>13da2: 26 0f add r18, r2213da4: 37 1f adc r19, r2313da6: 30 93 ac 02 sts 0x02AC, r1913daa: 20 93 ab 02 sts 0x02AB, r18if(EE_Parameter.ServoCompInvert & SERVO_ROLL_INV)13dae: 80 91 b7 05 lds r24, 0x05B713db2: 81 ff sbrs r24, 113db4: 18 c0 rjmp .+48 ; 0x13de6 <CalculateServo+0x3be>{ // inverting movement of servoroll = ServoRollOffset / 16 + roll;13db6: 80 91 ab 02 lds r24, 0x02AB13dba: 90 91 ac 02 lds r25, 0x02AC13dbe: 99 23 and r25, r2513dc0: 0c f4 brge .+2 ; 0x13dc4 <CalculateServo+0x39c>13dc2: 0f 96 adiw r24, 0x0f ; 1513dc4: 95 95 asr r2513dc6: 87 95 ror r2413dc8: 95 95 asr r2513dca: 87 95 ror r2413dcc: 95 95 asr r2513dce: 87 95 ror r2413dd0: 95 95 asr r2513dd2: 87 95 ror r2413dd4: aa 27 eor r26, r2613dd6: 97 fd sbrc r25, 713dd8: a0 95 com r2613dda: ba 2f mov r27, r2613ddc: c8 0e add r12, r2413dde: d9 1e adc r13, r2513de0: ea 1e adc r14, r2613de2: fb 1e adc r15, r2713de4: 1b c0 rjmp .+54 ; 0x13e1c <CalculateServo+0x3f4>}else{ // inverting movement of servoroll = ServoRollOffset / 16 - roll;13de6: 80 91 ab 02 lds r24, 0x02AB13dea: 90 91 ac 02 lds r25, 0x02AC13dee: 99 23 and r25, r2513df0: 0c f4 brge .+2 ; 0x13df4 <CalculateServo+0x3cc>13df2: 0f 96 adiw r24, 0x0f ; 1513df4: 95 95 asr r2513df6: 87 95 ror r2413df8: 95 95 asr r2513dfa: 87 95 ror r2413dfc: 95 95 asr r2513dfe: 87 95 ror r2413e00: 95 95 asr r2513e02: 87 95 ror r2413e04: aa 27 eor r26, r2613e06: 97 fd sbrc r25, 713e08: a0 95 com r2613e0a: ba 2f mov r27, r2613e0c: 9c 01 movw r18, r2413e0e: ad 01 movw r20, r2613e10: 2c 19 sub r18, r1213e12: 3d 09 sbc r19, r1313e14: 4e 09 sbc r20, r1413e16: 5f 09 sbc r21, r1513e18: 69 01 movw r12, r1813e1a: 7a 01 movw r14, r20}if(EE_Parameter.ServoFilterRoll) ServoRollValue = ((ServoRollValue * EE_Parameter.ServoFilterRoll) + roll) / (EE_Parameter.ServoFilterRoll + 1);13e1c: 40 91 aa 05 lds r20, 0x05AA13e20: 44 23 and r20, r2013e22: 29 f1 breq .+74 ; 0x13e6e <CalculateServo+0x446>13e24: 50 e0 ldi r21, 0x00 ; 013e26: 80 91 c4 04 lds r24, 0x04C413e2a: 90 91 c5 04 lds r25, 0x04C513e2e: 48 9f mul r20, r2413e30: b0 01 movw r22, r013e32: 49 9f mul r20, r2513e34: 70 0d add r23, r013e36: 58 9f mul r21, r2413e38: 70 0d add r23, r013e3a: 11 24 eor r1, r113e3c: cb 01 movw r24, r2213e3e: aa 27 eor r26, r2613e40: 97 fd sbrc r25, 713e42: a0 95 com r2613e44: ba 2f mov r27, r2613e46: bc 01 movw r22, r2413e48: cd 01 movw r24, r2613e4a: 6c 0d add r22, r1213e4c: 7d 1d adc r23, r1313e4e: 8e 1d adc r24, r1413e50: 9f 1d adc r25, r1513e52: 9a 01 movw r18, r2013e54: 2f 5f subi r18, 0xFF ; 25513e56: 3f 4f sbci r19, 0xFF ; 25513e58: 44 27 eor r20, r2013e5a: 37 fd sbrc r19, 713e5c: 40 95 com r2013e5e: 54 2f mov r21, r2013e60: 0e 94 8b b1 call 0x16316 ; 0x16316 <__divmodsi4>13e64: 30 93 c5 04 sts 0x04C5, r1913e68: 20 93 c4 04 sts 0x04C4, r1813e6c: 04 c0 rjmp .+8 ; 0x13e76 <CalculateServo+0x44e>else ServoRollValue = roll;13e6e: d0 92 c5 04 sts 0x04C5, r1313e72: c0 92 c4 04 sts 0x04C4, r12// limit servo value to its parameter range definitionif(ServoRollValue < ((int16_t)EE_Parameter.ServoRollMin * MULTIPLYER))13e76: 80 91 71 05 lds r24, 0x057113e7a: 90 e0 ldi r25, 0x00 ; 013e7c: 88 0f add r24, r2413e7e: 99 1f adc r25, r2513e80: 88 0f add r24, r2413e82: 99 1f adc r25, r2513e84: 20 91 c4 04 lds r18, 0x04C413e88: 30 91 c5 04 lds r19, 0x04C513e8c: 28 17 cp r18, r2413e8e: 39 07 cpc r19, r2513e90: 2c f4 brge .+10 ; 0x13e9c <CalculateServo+0x474>{ServoRollValue = (int16_t)EE_Parameter.ServoRollMin * MULTIPLYER;13e92: 90 93 c5 04 sts 0x04C5, r2513e96: 80 93 c4 04 sts 0x04C4, r2413e9a: 12 c0 rjmp .+36 ; 0x13ec0 <CalculateServo+0x498>}elseif(ServoRollValue > ((int16_t)EE_Parameter.ServoRollMax * MULTIPLYER))13e9c: 80 91 72 05 lds r24, 0x057213ea0: 90 e0 ldi r25, 0x00 ; 013ea2: 88 0f add r24, r2413ea4: 99 1f adc r25, r2513ea6: 88 0f add r24, r2413ea8: 99 1f adc r25, r2513eaa: 20 91 c4 04 lds r18, 0x04C413eae: 30 91 c5 04 lds r19, 0x04C513eb2: 82 17 cp r24, r1813eb4: 93 07 cpc r25, r1913eb6: 24 f4 brge .+8 ; 0x13ec0 <CalculateServo+0x498>{ServoRollValue = (int16_t)EE_Parameter.ServoRollMax * MULTIPLYER;13eb8: 90 93 c5 04 sts 0x04C5, r2513ebc: 80 93 c4 04 sts 0x04C4, r24}CalculateServoSignals = 0;13ec0: 10 92 af 02 sts 0x02AF, r1}}13ec4: 1f 91 pop r1713ec6: 0f 91 pop r1613ec8: ff 90 pop r1513eca: ef 90 pop r1413ecc: df 90 pop r1313ece: cf 90 pop r1213ed0: bf 90 pop r1113ed2: af 90 pop r1013ed4: 9f 90 pop r913ed6: 8f 90 pop r813ed8: 08 95 ret00013eda <__vector_9>:ISR(TIMER2_COMPA_vect){13eda: 1f 92 push r113edc: 0f 92 push r013ede: 0f b6 in r0, 0x3f ; 6313ee0: 0f 92 push r013ee2: 11 24 eor r1, r113ee4: 0b b6 in r0, 0x3b ; 5913ee6: 0f 92 push r013ee8: 2f 93 push r1813eea: 3f 93 push r1913eec: 4f 93 push r2013eee: 8f 93 push r2413ef0: 9f 93 push r2513ef2: ef 93 push r3013ef4: ff 93 push r31*/{//-----------------------------------------------------// PPM state machine, onboard demultiplexed by HEF4017//-----------------------------------------------------if(!PulseOutput) // pulse output complete13ef6: 80 91 c2 04 lds r24, 0x04C213efa: 81 11 cpse r24, r113efc: f9 c0 rjmp .+498 ; 0x140f0 <__vector_9+0x216>{if(TCCR2A & (1<<COM2A0)) // we had a low pulse13efe: 80 91 b0 00 lds r24, 0x00B013f02: 86 ff sbrs r24, 613f04: bc c0 rjmp .+376 ; 0x1407e <__vector_9+0x1a4>{TCCR2A &= ~(1<<COM2A0);// make a high pulse13f06: e0 eb ldi r30, 0xB0 ; 17613f08: f0 e0 ldi r31, 0x00 ; 013f0a: 80 81 ld r24, Z13f0c: 8f 7b andi r24, 0xBF ; 19113f0e: 80 83 st Z, r24if(ServoIndex == 0) // if we are at the sync gap13f10: e0 91 c1 04 lds r30, 0x04C113f14: e1 11 cpse r30, r113f16: 19 c0 rjmp .+50 ; 0x13f4a <__vector_9+0x70>{RemainingPulse = PPM_FRAMELEN - ServoFrameTime; // generate sync gap by filling time to full frame time13f18: 40 91 73 05 lds r20, 0x057313f1c: 2d ed ldi r18, 0xDD ; 22113f1e: 36 e0 ldi r19, 0x06 ; 613f20: 42 9f mul r20, r1813f22: c0 01 movw r24, r013f24: 43 9f mul r20, r1913f26: 90 0d add r25, r013f28: 11 24 eor r1, r113f2a: 20 91 bf 04 lds r18, 0x04BF13f2e: 30 91 c0 04 lds r19, 0x04C013f32: 82 1b sub r24, r1813f34: 93 0b sbc r25, r1913f36: 90 93 c9 04 sts 0x04C9, r2513f3a: 80 93 c8 04 sts 0x04C8, r24ServoFrameTime = 0; // reset servo frame time13f3e: 10 92 c0 04 sts 0x04C0, r113f42: 10 92 bf 04 sts 0x04BF, r1HEF4017Reset_ON; // enable HEF4017 reset13f46: 46 9a sbi 0x08, 6 ; 813f48: d0 c0 rjmp .+416 ; 0x140ea <__vector_9+0x210>}else // servo channelsif(ServoIndex > EE_Parameter.ServoNickRefresh)13f4a: 80 91 73 05 lds r24, 0x057313f4e: 8e 17 cp r24, r3013f50: 38 f4 brcc .+14 ; 0x13f60 <__vector_9+0x86>{RemainingPulse = 10; // end it here13f52: 8a e0 ldi r24, 0x0A ; 1013f54: 90 e0 ldi r25, 0x00 ; 013f56: 90 93 c9 04 sts 0x04C9, r2513f5a: 80 93 c8 04 sts 0x04C8, r2413f5e: c5 c0 rjmp .+394 ; 0x140ea <__vector_9+0x210>}else{RemainingPulse = MINSERVOPULSE + SERVORANGE/2; // center position ~ 1.5ms13f60: 89 ea ldi r24, 0xA9 ; 16913f62: 93 e0 ldi r25, 0x03 ; 313f64: 90 93 c9 04 sts 0x04C9, r2513f68: 80 93 c8 04 sts 0x04C8, r24switch(ServoIndex) // map servo channels13f6c: e3 30 cpi r30, 0x03 ; 313f6e: 09 f1 breq .+66 ; 0x13fb2 <__vector_9+0xd8>13f70: 28 f4 brcc .+10 ; 0x13f7c <__vector_9+0xa2>13f72: e1 30 cpi r30, 0x01 ; 113f74: 41 f0 breq .+16 ; 0x13f86 <__vector_9+0xac>13f76: e2 30 cpi r30, 0x02 ; 213f78: 89 f0 breq .+34 ; 0x13f9c <__vector_9+0xc2>13f7a: 45 c0 rjmp .+138 ; 0x14006 <__vector_9+0x12c>13f7c: e4 30 cpi r30, 0x04 ; 413f7e: 39 f1 breq .+78 ; 0x13fce <__vector_9+0xf4>13f80: e5 30 cpi r30, 0x05 ; 513f82: 99 f1 breq .+102 ; 0x13fea <__vector_9+0x110>13f84: 40 c0 rjmp .+128 ; 0x14006 <__vector_9+0x12c>{case 1: // Nick Compensation ServoRemainingPulse += ServoNickValue - (256 / 2) * MULTIPLYER; // shift ServoNickValue to center position13f86: 80 91 c6 04 lds r24, 0x04C613f8a: 90 91 c7 04 lds r25, 0x04C713f8e: 87 55 subi r24, 0x57 ; 8713f90: 9e 4f sbci r25, 0xFE ; 25413f92: 90 93 c9 04 sts 0x04C9, r2513f96: 80 93 c8 04 sts 0x04C8, r24break;13f9a: 44 c0 rjmp .+136 ; 0x14024 <__vector_9+0x14a>case 2: // Roll Compensation ServoRemainingPulse += ServoRollValue - (256 / 2) * MULTIPLYER; // shift ServoNickValue to center position13f9c: 80 91 c4 04 lds r24, 0x04C413fa0: 90 91 c5 04 lds r25, 0x04C513fa4: 87 55 subi r24, 0x57 ; 8713fa6: 9e 4f sbci r25, 0xFE ; 25413fa8: 90 93 c9 04 sts 0x04C9, r2513fac: 80 93 c8 04 sts 0x04C8, r24break;13fb0: 39 c0 rjmp .+114 ; 0x14024 <__vector_9+0x14a>case 3:RemainingPulse += ((int16_t)Parameter_Servo3 * MULTIPLYER) - (256 / 2) * MULTIPLYER;13fb2: 80 91 38 06 lds r24, 0x063813fb6: 90 e0 ldi r25, 0x00 ; 013fb8: 88 0f add r24, r2413fba: 99 1f adc r25, r2513fbc: 88 0f add r24, r2413fbe: 99 1f adc r25, r2513fc0: 87 55 subi r24, 0x57 ; 8713fc2: 9e 4f sbci r25, 0xFE ; 25413fc4: 90 93 c9 04 sts 0x04C9, r2513fc8: 80 93 c8 04 sts 0x04C8, r24break;13fcc: 2b c0 rjmp .+86 ; 0x14024 <__vector_9+0x14a>case 4:RemainingPulse += ((int16_t)Parameter_Servo4 * MULTIPLYER) - (256 / 2) * MULTIPLYER;13fce: 80 91 19 06 lds r24, 0x061913fd2: 90 e0 ldi r25, 0x00 ; 013fd4: 88 0f add r24, r2413fd6: 99 1f adc r25, r2513fd8: 88 0f add r24, r2413fda: 99 1f adc r25, r2513fdc: 87 55 subi r24, 0x57 ; 8713fde: 9e 4f sbci r25, 0xFE ; 25413fe0: 90 93 c9 04 sts 0x04C9, r2513fe4: 80 93 c8 04 sts 0x04C8, r24break;13fe8: 1d c0 rjmp .+58 ; 0x14024 <__vector_9+0x14a>case 5:RemainingPulse += ((int16_t)Parameter_Servo5 * MULTIPLYER) - (256 / 2) * MULTIPLYER;13fea: 80 91 41 06 lds r24, 0x064113fee: 90 e0 ldi r25, 0x00 ; 013ff0: 88 0f add r24, r2413ff2: 99 1f adc r25, r2513ff4: 88 0f add r24, r2413ff6: 99 1f adc r25, r2513ff8: 87 55 subi r24, 0x57 ; 8713ffa: 9e 4f sbci r25, 0xFE ; 25413ffc: 90 93 c9 04 sts 0x04C9, r2514000: 80 93 c8 04 sts 0x04C8, r24break;14004: 0f c0 rjmp .+30 ; 0x14024 <__vector_9+0x14a>default: // other servo channelsRemainingPulse += 2 * PPM_in[ServoIndex]; // add channel value, factor of 2 because timer 1 increments 3.2µs14006: f0 e0 ldi r31, 0x00 ; 014008: ee 0f add r30, r301400a: ff 1f adc r31, r311400c: ef 5c subi r30, 0xCF ; 2071400e: f7 4f sbci r31, 0xF7 ; 24714010: 80 81 ld r24, Z14012: 91 81 ldd r25, Z+1 ; 0x0114014: 88 0f add r24, r2414016: 99 1f adc r25, r2514018: 87 55 subi r24, 0x57 ; 871401a: 9c 4f sbci r25, 0xFC ; 2521401c: 90 93 c9 04 sts 0x04C9, r2514020: 80 93 c8 04 sts 0x04C8, r24break;}// range servo pulse widthif(RemainingPulse > MAXSERVOPULSE) RemainingPulse = MAXSERVOPULSE; // upper servo pulse limit14024: 80 91 c8 04 lds r24, 0x04C814028: 90 91 c9 04 lds r25, 0x04C91402c: 8d 3d cpi r24, 0xDD ; 2211402e: 25 e0 ldi r18, 0x05 ; 514030: 92 07 cpc r25, r1814032: 38 f0 brcs .+14 ; 0x14042 <__vector_9+0x168>14034: 8c ed ldi r24, 0xDC ; 22014036: 95 e0 ldi r25, 0x05 ; 514038: 90 93 c9 04 sts 0x04C9, r251403c: 80 93 c8 04 sts 0x04C8, r2414040: 09 c0 rjmp .+18 ; 0x14054 <__vector_9+0x17a>else if(RemainingPulse < MINSERVOPULSE) RemainingPulse = MINSERVOPULSE; // lower servo pulse limit14042: 87 37 cpi r24, 0x77 ; 11914044: 91 40 sbci r25, 0x01 ; 114046: 30 f4 brcc .+12 ; 0x14054 <__vector_9+0x17a>14048: 87 e7 ldi r24, 0x77 ; 1191404a: 91 e0 ldi r25, 0x01 ; 11404c: 90 93 c9 04 sts 0x04C9, r2514050: 80 93 c8 04 sts 0x04C8, r24// substract stop pulse widthRemainingPulse -= PPM_STOPPULSE;14054: 80 91 c8 04 lds r24, 0x04C814058: 90 91 c9 04 lds r25, 0x04C91405c: 8c 5b subi r24, 0xBC ; 1881405e: 91 09 sbc r25, r114060: 90 93 c9 04 sts 0x04C9, r2514064: 80 93 c8 04 sts 0x04C8, r24// accumulate time for correct sync gapServoFrameTime += RemainingPulse;14068: 20 91 bf 04 lds r18, 0x04BF1406c: 30 91 c0 04 lds r19, 0x04C014070: 82 0f add r24, r1814072: 93 1f adc r25, r1914074: 90 93 c0 04 sts 0x04C0, r2514078: 80 93 bf 04 sts 0x04BF, r241407c: 36 c0 rjmp .+108 ; 0x140ea <__vector_9+0x210>}}else // we had a high pulse{TCCR2A |= (1<<COM2A0); // make a low pulse1407e: e0 eb ldi r30, 0xB0 ; 17614080: f0 e0 ldi r31, 0x00 ; 014082: 80 81 ld r24, Z14084: 80 64 ori r24, 0x40 ; 6414086: 80 83 st Z, r24// set pulsewidth to stop pulse widthRemainingPulse = PPM_STOPPULSE;14088: 8c eb ldi r24, 0xBC ; 1881408a: 90 e0 ldi r25, 0x00 ; 01408c: 90 93 c9 04 sts 0x04C9, r2514090: 80 93 c8 04 sts 0x04C8, r24// accumulate time for correct sync gapServoFrameTime += RemainingPulse;14094: 80 91 bf 04 lds r24, 0x04BF14098: 90 91 c0 04 lds r25, 0x04C01409c: 84 54 subi r24, 0x44 ; 681409e: 9f 4f sbci r25, 0xFF ; 255140a0: 90 93 c0 04 sts 0x04C0, r25140a4: 80 93 bf 04 sts 0x04BF, r24if((ServoActive && SenderOkay) || ServoActive == 2) HEF4017Reset_OFF; // disable HEF4017 reset140a8: 80 91 cb 04 lds r24, 0x04CB140ac: 88 23 and r24, r24140ae: 21 f0 breq .+8 ; 0x140b8 <__vector_9+0x1de>140b0: 80 91 04 04 lds r24, 0x0404140b4: 81 11 cpse r24, r1140b6: 04 c0 rjmp .+8 ; 0x140c0 <__vector_9+0x1e6>140b8: 80 91 cb 04 lds r24, 0x04CB140bc: 82 30 cpi r24, 0x02 ; 2140be: 11 f4 brne .+4 ; 0x140c4 <__vector_9+0x1ea>140c0: 46 98 cbi 0x08, 6 ; 8140c2: 01 c0 rjmp .+2 ; 0x140c6 <__vector_9+0x1ec>else HEF4017Reset_ON;140c4: 46 9a sbi 0x08, 6 ; 8ServoIndex++;140c6: 20 91 c1 04 lds r18, 0x04C1140ca: 2f 5f subi r18, 0xFF ; 255140cc: 20 93 c1 04 sts 0x04C1, r18if(ServoIndex > EE_Parameter.ServoNickRefresh+1)140d0: 30 e0 ldi r19, 0x00 ; 0140d2: 80 91 73 05 lds r24, 0x0573140d6: 90 e0 ldi r25, 0x00 ; 0140d8: 01 96 adiw r24, 0x01 ; 1140da: 82 17 cp r24, r18140dc: 93 07 cpc r25, r19140de: 2c f4 brge .+10 ; 0x140ea <__vector_9+0x210>{CalculateServoSignals = 1;140e0: 81 e0 ldi r24, 0x01 ; 1140e2: 80 93 af 02 sts 0x02AF, r24ServoIndex = 0; // reset to the sync gap140e6: 10 92 c1 04 sts 0x04C1, r1}}// set pulse output activePulseOutput = 1;140ea: 81 e0 ldi r24, 0x01 ; 1140ec: 80 93 c2 04 sts 0x04C2, r24}} // EOF PPM state machine// General pulse output generatorif(RemainingPulse > (255 + IRS_RUNTIME))140f0: 80 91 c8 04 lds r24, 0x04C8140f4: 90 91 c9 04 lds r25, 0x04C9140f8: 8f 37 cpi r24, 0x7F ; 127140fa: 21 e0 ldi r18, 0x01 ; 1140fc: 92 07 cpc r25, r18140fe: 70 f0 brcs .+28 ; 0x1411c <__vector_9+0x242>{OCR2A = 255;14100: 8f ef ldi r24, 0xFF ; 25514102: 80 93 b3 00 sts 0x00B3, r24RemainingPulse -= 255;14106: 80 91 c8 04 lds r24, 0x04C81410a: 90 91 c9 04 lds r25, 0x04C91410e: 8f 5f subi r24, 0xFF ; 25514110: 91 09 sbc r25, r114112: 90 93 c9 04 sts 0x04C9, r2514116: 80 93 c8 04 sts 0x04C8, r241411a: 2d c0 rjmp .+90 ; 0x14176 <__vector_9+0x29c>}else{if(RemainingPulse > 255) // this is the 2nd last part1411c: 8f 3f cpi r24, 0xFF ; 2551411e: 91 05 cpc r25, r114120: 11 f1 breq .+68 ; 0x14166 <__vector_9+0x28c>14122: 08 f1 brcs .+66 ; 0x14166 <__vector_9+0x28c>{if((RemainingPulse - 255) < IRS_RUNTIME)14124: 8f 5f subi r24, 0xFF ; 25514126: 91 09 sbc r25, r114128: 8f 37 cpi r24, 0x7F ; 1271412a: 91 05 cpc r25, r11412c: 70 f4 brcc .+28 ; 0x1414a <__vector_9+0x270>{OCR2A = 255 - IRS_RUNTIME;1412e: 80 e8 ldi r24, 0x80 ; 12814130: 80 93 b3 00 sts 0x00B3, r24RemainingPulse -= 255 - IRS_RUNTIME;14134: 80 91 c8 04 lds r24, 0x04C814138: 90 91 c9 04 lds r25, 0x04C91413c: 80 58 subi r24, 0x80 ; 1281413e: 91 09 sbc r25, r114140: 90 93 c9 04 sts 0x04C9, r2514144: 80 93 c8 04 sts 0x04C8, r2414148: 16 c0 rjmp .+44 ; 0x14176 <__vector_9+0x29c>}else // last part > ISR_RUNTIME{OCR2A = 255;1414a: 8f ef ldi r24, 0xFF ; 2551414c: 80 93 b3 00 sts 0x00B3, r24RemainingPulse -= 255;14150: 80 91 c8 04 lds r24, 0x04C814154: 90 91 c9 04 lds r25, 0x04C914158: 8f 5f subi r24, 0xFF ; 2551415a: 91 09 sbc r25, r11415c: 90 93 c9 04 sts 0x04C9, r2514160: 80 93 c8 04 sts 0x04C8, r2414164: 08 c0 rjmp .+16 ; 0x14176 <__vector_9+0x29c>}}else // this is the last part{OCR2A = RemainingPulse;14166: 80 93 b3 00 sts 0x00B3, r24RemainingPulse = 0;1416a: 10 92 c9 04 sts 0x04C9, r11416e: 10 92 c8 04 sts 0x04C8, r1PulseOutput = 0; // trigger to stop pulse14172: 10 92 c2 04 sts 0x04C2, r1}} // EOF general pulse output generator}14176: ff 91 pop r3114178: ef 91 pop r301417a: 9f 91 pop r251417c: 8f 91 pop r241417e: 4f 91 pop r2014180: 3f 91 pop r1914182: 2f 91 pop r1814184: 0f 90 pop r014186: 0b be out 0x3b, r0 ; 5914188: 0f 90 pop r01418a: 0f be out 0x3f, r0 ; 631418c: 0f 90 pop r01418e: 1f 90 pop r114190: 18 95 reti00014192 <I2C_Init>:/**************************************************/void I2C_Init(char clear){uint8_t i;uint8_t sreg = SREG;14192: 2f b7 in r18, 0x3f ; 63cli();14194: f8 94 cli// SDA is INPUTDDRC &= ~(1<<DDRC1);14196: 39 98 cbi 0x07, 1 ; 7// SCL is outputDDRC |= (1<<DDRC0);14198: 38 9a sbi 0x07, 0 ; 7// pull up SDAPORTC |= (1<<PORTC0)|(1<<PORTC1);1419a: 98 b1 in r25, 0x08 ; 81419c: 93 60 ori r25, 0x03 ; 31419e: 98 b9 out 0x08, r25 ; 8// TWI Status Register// prescaler 1 (TWPS1 = 0, TWPS0 = 0)TWSR &= ~((1<<TWPS1)|(1<<TWPS0));141a0: e9 eb ldi r30, 0xB9 ; 185141a2: f0 e0 ldi r31, 0x00 ; 0141a4: 90 81 ld r25, Z141a6: 9c 7f andi r25, 0xFC ; 252141a8: 90 83 st Z, r25// set TWI Bit Rate RegisterTWBR = ((F_CPU/SCL_CLOCK)-16)/2;141aa: 9a e2 ldi r25, 0x2A ; 42141ac: 90 93 b8 00 sts 0x00B8, r25twi_state = TWI_STATE_MOTOR_TX;141b0: 10 92 e3 04 sts 0x04E3, r1motor_write = 0;141b4: 10 92 e2 04 sts 0x04E2, r1motor_read = 0;141b8: 10 92 e1 04 sts 0x04E1, r1if(clear) for(i=0; i < MAX_MOTORS; i++)141bc: 88 23 and r24, r24141be: 31 f1 breq .+76 ; 0x1420c <I2C_Init+0x7a>141c0: e5 ea ldi r30, 0xA5 ; 165141c2: f9 e0 ldi r31, 0x09 ; 9141c4: 89 e5 ldi r24, 0x59 ; 89141c6: 9a e0 ldi r25, 0x0A ; 10141c8: df 01 movw r26, r30141ca: 1e 97 sbiw r26, 0x0e ; 14{Motor[i].Version = 0;141cc: 1c 92 st X, r1141ce: 11 96 adiw r26, 0x01 ; 1Motor[i].SetPoint = 0;141d0: 1c 92 st X, r1141d2: 11 96 adiw r26, 0x01 ; 1Motor[i].SetPointLowerBits = 0;141d4: 1c 92 st X, r1141d6: 11 96 adiw r26, 0x01 ; 1Motor[i].State = 0;141d8: 1c 92 st X, r1141da: 11 96 adiw r26, 0x01 ; 1Motor[i].ReadMode = BL_READMODE_STATUS;141dc: 1c 92 st X, r1141de: 11 96 adiw r26, 0x01 ; 1Motor[i].Current = 0;141e0: 1c 92 st X, r1141e2: 11 96 adiw r26, 0x01 ; 1Motor[i].MaxPWM = 0;141e4: 1c 92 st X, r1141e6: 11 96 adiw r26, 0x01 ; 1Motor[i].Temperature = 0;141e8: 1c 92 st X, r1Motor[i].NotReadyCnt = 0;141ea: 10 82 st Z, r1141ec: 11 96 adiw r26, 0x01 ; 1Motor[i].RPM = 0;141ee: 1c 92 st X, r1141f0: 11 96 adiw r26, 0x01 ; 1Motor[i].reserved1 = 0;141f2: 1c 92 st X, r1141f4: 11 96 adiw r26, 0x01 ; 1Motor[i].Voltage = 0;141f6: 1c 92 st X, r1141f8: 11 96 adiw r26, 0x01 ; 1Motor[i].SlaveI2cError = 0;141fa: 1c 92 st X, r1141fc: 11 96 adiw r26, 0x01 ; 1Motor[i].VersionMajor = 0;141fe: 1c 92 st X, r114200: 11 96 adiw r26, 0x01 ; 1Motor[i].VersionMinor = 0;14202: 1c 92 st X, r114204: 3f 96 adiw r30, 0x0f ; 15twi_state = TWI_STATE_MOTOR_TX;motor_write = 0;motor_read = 0;if(clear) for(i=0; i < MAX_MOTORS; i++)14206: e8 17 cp r30, r2414208: f9 07 cpc r31, r251420a: f1 f6 brne .-68 ; 0x141c8 <I2C_Init+0x36>Motor[i].Voltage = 0;Motor[i].SlaveI2cError = 0;Motor[i].VersionMajor = 0;Motor[i].VersionMinor = 0;}sei();1420c: 78 94 seiSREG = sreg;1420e: 2f bf out 0x3f, r18 ; 6314210: 08 95 ret00014212 <I2C_Reset>:}void I2C_Reset(void){14212: 0f 93 push r1614214: 1f 93 push r1714216: cf 93 push r2814218: df 93 push r29// stop i2c busI2C_Stop(TWI_STATE_MOTOR_TX);1421a: 10 92 e3 04 sts 0x04E3, r11421e: cc eb ldi r28, 0xBC ; 18814220: d0 e0 ldi r29, 0x00 ; 014222: 84 e9 ldi r24, 0x94 ; 14814224: 88 83 st Y, r24TWCR = (1<<TWINT); // reset to original state incl. interrupt flag reset14226: 80 e8 ldi r24, 0x80 ; 12814228: 88 83 st Y, r24TWAMR = 0;1422a: 10 92 bd 00 sts 0x00BD, r1TWAR = 0;1422e: 10 92 ba 00 sts 0x00BA, r1TWDR = 0;14232: 0b eb ldi r16, 0xBB ; 18714234: 10 e0 ldi r17, 0x00 ; 014236: f8 01 movw r30, r1614238: 10 82 st Z, r1TWSR = 0;1423a: 10 92 b9 00 sts 0x00B9, r1TWBR = 0;1423e: 10 92 b8 00 sts 0x00B8, r1I2C_TransferActive = 0;14242: 10 92 e0 04 sts 0x04E0, r1I2C_Init(0);14246: 80 e0 ldi r24, 0x00 ; 014248: a4 df rcall .-184 ; 0x14192 <I2C_Init>I2C_WriteByte(0);1424a: f8 01 movw r30, r161424c: 10 82 st Z, r11424e: 85 e8 ldi r24, 0x85 ; 13314250: 88 83 st Y, r24BLFlags |= BLFLAG_READ_VERSION;14252: 80 91 de 04 lds r24, 0x04DE14256: 82 60 ori r24, 0x02 ; 214258: 80 93 de 04 sts 0x04DE, r24}1425c: df 91 pop r291425e: cf 91 pop r2814260: 1f 91 pop r1714262: 0f 91 pop r1614264: 08 95 ret00014266 <__vector_26>:/****************************************//* I2C ISR *//****************************************/ISR (TWI_vect){14266: 1f 92 push r114268: 0f 92 push r01426a: 0f b6 in r0, 0x3f ; 631426c: 0f 92 push r01426e: 11 24 eor r1, r114270: 0b b6 in r0, 0x3b ; 5914272: 0f 92 push r014274: 2f 93 push r1814276: 3f 93 push r1914278: 4f 93 push r201427a: 8f 93 push r241427c: 9f 93 push r251427e: af 93 push r2614280: bf 93 push r2714282: ef 93 push r3014284: ff 93 push r31static uint8_t missing_motor = 0, motor_read_temperature = 0;static uint8_t *pBuff = 0;static uint8_t BuffLen = 0;static uint8_t max_packets = 0;switch (twi_state++)14286: 80 91 e3 04 lds r24, 0x04E31428a: 91 e0 ldi r25, 0x01 ; 11428c: 98 0f add r25, r241428e: 90 93 e3 04 sts 0x04E3, r2514292: 90 e0 ldi r25, 0x00 ; 014294: 87 30 cpi r24, 0x07 ; 714296: 91 05 cpc r25, r114298: 08 f0 brcs .+2 ; 0x1429c <__vector_26+0x36>1429a: d8 c2 rjmp .+1456 ; 0x1484c <__vector_26+0x5e6>1429c: fc 01 movw r30, r241429e: e0 55 subi r30, 0x50 ; 80142a0: ff 4f sbci r31, 0xFF ; 255142a2: 0c 94 a7 b1 jmp 0x1634e ; 0x1634e <__tablejump2__>{// Master Transmitcase 0: // TWI_STATE_MOTOR_TXI2C_TransferActive = 1;142a6: 81 e0 ldi r24, 0x01 ; 1142a8: 80 93 e0 04 sts 0x04E0, r24// skip motor if not used in mixerwhile((Mixer.Motor[motor_write][MIX_GAS] <= 0) && (motor_write < MAX_MOTORS)) motor_write++;142ac: e0 91 e2 04 lds r30, 0x04E2142b0: f0 e0 ldi r31, 0x00 ; 0142b2: ee 0f add r30, r30142b4: ff 1f adc r31, r31142b6: ee 0f add r30, r30142b8: ff 1f adc r31, r31142ba: e9 53 subi r30, 0x39 ; 57142bc: fa 4f sbci r31, 0xFA ; 250142be: 85 85 ldd r24, Z+13 ; 0x0d142c0: 18 16 cp r1, r24142c2: cc f0 brlt .+50 ; 0x142f6 <__vector_26+0x90>142c4: 80 91 e2 04 lds r24, 0x04E2142c8: 8c 30 cpi r24, 0x0C ; 12142ca: a8 f4 brcc .+42 ; 0x142f6 <__vector_26+0x90>142cc: 80 91 e2 04 lds r24, 0x04E2142d0: 8f 5f subi r24, 0xFF ; 255142d2: 80 93 e2 04 sts 0x04E2, r24142d6: e0 91 e2 04 lds r30, 0x04E2142da: f0 e0 ldi r31, 0x00 ; 0142dc: ee 0f add r30, r30142de: ff 1f adc r31, r31142e0: ee 0f add r30, r30142e2: ff 1f adc r31, r31142e4: e9 53 subi r30, 0x39 ; 57142e6: fa 4f sbci r31, 0xFA ; 250142e8: 85 85 ldd r24, Z+13 ; 0x0d142ea: 18 16 cp r1, r24142ec: 24 f0 brlt .+8 ; 0x142f6 <__vector_26+0x90>142ee: 80 91 e2 04 lds r24, 0x04E2142f2: 8c 30 cpi r24, 0x0C ; 12142f4: 58 f3 brcs .-42 ; 0x142cc <__vector_26+0x66>motor_write %= MAX_MOTORS;142f6: 90 91 e2 04 lds r25, 0x04E2142fa: 8b ea ldi r24, 0xAB ; 171142fc: 98 9f mul r25, r24142fe: 81 2d mov r24, r114300: 11 24 eor r1, r114302: 86 95 lsr r2414304: 86 95 lsr r2414306: 86 95 lsr r2414308: 28 2f mov r18, r241430a: 22 0f add r18, r181430c: 82 0f add r24, r181430e: 88 0f add r24, r2414310: 88 0f add r24, r2414312: 98 1b sub r25, r2414314: 90 93 e2 04 sts 0x04E2, r25if(++max_packets > Max_I2C_Packets) // writing finished, read now14318: 80 91 d9 04 lds r24, 0x04D91431c: 8f 5f subi r24, 0xFF ; 2551431e: 80 93 d9 04 sts 0x04D9, r2414322: 90 91 b2 02 lds r25, 0x02B214326: 98 17 cp r25, r2414328: 98 f4 brcc .+38 ; 0x14350 <__vector_26+0xea>{max_packets = 0;1432a: 10 92 d9 04 sts 0x04D9, r1BLConfig_WriteMask = 0; // reset configuration bitmask1432e: 10 92 dd 04 sts 0x04DD, r114332: 10 92 dc 04 sts 0x04DC, r1//motor_write = 0; // reset motor write counter for next cycletwi_state = TWI_STATE_MOTOR_RX;14336: 85 e0 ldi r24, 0x05 ; 514338: 80 93 e3 04 sts 0x04E3, r24I2C_WriteByte(TWI_BASE_ADDRESS + TW_READ + (motor_read<<1) ); // select slave address in rx mode1433c: 80 91 e1 04 lds r24, 0x04E114340: 88 0f add r24, r2414342: 8d 5a subi r24, 0xAD ; 17314344: 80 93 bb 00 sts 0x00BB, r2414348: 85 e8 ldi r24, 0x85 ; 1331434a: 80 93 bc 00 sts 0x00BC, r241434e: 94 c2 rjmp .+1320 ; 0x14878 <__vector_26+0x612>}else I2C_WriteByte(TWI_BASE_ADDRESS + TW_WRITE + (motor_write<<1) ); // select slave address in tx mode14350: 80 91 e2 04 lds r24, 0x04E214354: 88 0f add r24, r2414356: 8e 5a subi r24, 0xAE ; 17414358: 80 93 bb 00 sts 0x00BB, r241435c: 85 e8 ldi r24, 0x85 ; 1331435e: 80 93 bc 00 sts 0x00BC, r2414362: 8a c2 rjmp .+1300 ; 0x14878 <__vector_26+0x612>break;case 1: // Send Data to SlaveI2C_WriteByte(Motor[motor_write].SetPoint); // transmit setpoint14364: a0 91 e2 04 lds r26, 0x04E214368: 8f e0 ldi r24, 0x0F ; 151436a: 8a 9f mul r24, r261436c: d0 01 movw r26, r01436e: 11 24 eor r1, r114370: a9 56 subi r26, 0x69 ; 10514372: b6 4f sbci r27, 0xF6 ; 24614374: 11 96 adiw r26, 0x01 ; 114376: 9c 91 ld r25, X14378: 90 93 bb 00 sts 0x00BB, r251437c: 95 e8 ldi r25, 0x85 ; 1331437e: 90 93 bc 00 sts 0x00BC, r25// if old version has been detectedif(!(Motor[motor_write].Version & MOTOR_STATE_NEW_PROTOCOL_MASK))14382: e0 91 e2 04 lds r30, 0x04E214386: 8e 9f mul r24, r3014388: f0 01 movw r30, r01438a: 11 24 eor r1, r11438c: e9 56 subi r30, 0x69 ; 1051438e: f6 4f sbci r31, 0xF6 ; 24614390: 80 81 ld r24, Z14392: 80 fd sbrc r24, 014394: 04 c0 rjmp .+8 ; 0x1439e <__vector_26+0x138>{twi_state = 4; //jump over sending more data14396: 84 e0 ldi r24, 0x04 ; 414398: 80 93 e3 04 sts 0x04E3, r241439c: 6d c2 rjmp .+1242 ; 0x14878 <__vector_26+0x612>}// the new version has been detectedelse if(!( (Motor[motor_write].SetPointLowerBits && (RequiredMotors < 7)) || BLConfig_WriteMask || BLConfig_ReadMask ) )1439e: e0 91 e2 04 lds r30, 0x04E2143a2: 2f e0 ldi r18, 0x0F ; 15143a4: e2 9f mul r30, r18143a6: f0 01 movw r30, r0143a8: 11 24 eor r1, r1143aa: e9 56 subi r30, 0x69 ; 105143ac: f6 4f sbci r31, 0xF6 ; 246143ae: 82 81 ldd r24, Z+2 ; 0x02143b0: 88 23 and r24, r24143b2: 29 f0 breq .+10 ; 0x143be <__vector_26+0x158>143b4: 80 91 3d 05 lds r24, 0x053D143b8: 87 30 cpi r24, 0x07 ; 7143ba: 08 f4 brcc .+2 ; 0x143be <__vector_26+0x158>143bc: 5d c2 rjmp .+1210 ; 0x14878 <__vector_26+0x612>143be: 80 91 dc 04 lds r24, 0x04DC143c2: 90 91 dd 04 lds r25, 0x04DD143c6: 89 2b or r24, r25143c8: 09 f0 breq .+2 ; 0x143cc <__vector_26+0x166>143ca: 56 c2 rjmp .+1196 ; 0x14878 <__vector_26+0x612>143cc: 80 91 da 04 lds r24, 0x04DA143d0: 90 91 db 04 lds r25, 0x04DB143d4: 89 2b or r24, r25143d6: 09 f0 breq .+2 ; 0x143da <__vector_26+0x174>143d8: 4f c2 rjmp .+1182 ; 0x14878 <__vector_26+0x612>{ // or LowerBits are zero and no BlConfig should be sent (saves round trip time)twi_state = 4; //jump over sending more data143da: 84 e0 ldi r24, 0x04 ; 4143dc: 80 93 e3 04 sts 0x04E3, r24143e0: 4b c2 rjmp .+1174 ; 0x14878 <__vector_26+0x612>}break;case 2: // lower bits of setpoint (higher resolution)if ((0x0001<<motor_write) & BLConfig_ReadMask)143e2: 40 91 e2 04 lds r20, 0x04E2143e6: 20 91 da 04 lds r18, 0x04DA143ea: 30 91 db 04 lds r19, 0x04DB143ee: 81 e0 ldi r24, 0x01 ; 1143f0: 90 e0 ldi r25, 0x00 ; 0143f2: 02 c0 rjmp .+4 ; 0x143f8 <__vector_26+0x192>143f4: 88 0f add r24, r24143f6: 99 1f adc r25, r25143f8: 4a 95 dec r20143fa: e2 f7 brpl .-8 ; 0x143f4 <__vector_26+0x18e>143fc: 82 23 and r24, r18143fe: 93 23 and r25, r1914400: 89 2b or r24, r2514402: 59 f0 breq .+22 ; 0x1441a <__vector_26+0x1b4>{Motor[motor_write].ReadMode = BL_READMODE_CONFIG; // configuration request14404: e0 91 e2 04 lds r30, 0x04E214408: 8f e0 ldi r24, 0x0F ; 151440a: e8 9f mul r30, r241440c: f0 01 movw r30, r01440e: 11 24 eor r1, r114410: e9 56 subi r30, 0x69 ; 10514412: f6 4f sbci r31, 0xF6 ; 24614414: 80 e1 ldi r24, 0x10 ; 1614416: 84 83 std Z+4, r24 ; 0x0414418: 09 c0 rjmp .+18 ; 0x1442c <__vector_26+0x1c6>}else{Motor[motor_write].ReadMode = BL_READMODE_STATUS; // normal status request1441a: e0 91 e2 04 lds r30, 0x04E21441e: 2f e0 ldi r18, 0x0F ; 1514420: e2 9f mul r30, r1814422: f0 01 movw r30, r014424: 11 24 eor r1, r114426: e9 56 subi r30, 0x69 ; 10514428: f6 4f sbci r31, 0xF6 ; 2461442a: 14 82 std Z+4, r1 ; 0x04}// send read mode and the lower bits of setpointI2C_WriteByte((Motor[motor_write].ReadMode<<3)|(Motor[motor_write].SetPointLowerBits & 0x07));1442c: a0 91 e2 04 lds r26, 0x04E214430: e0 91 e2 04 lds r30, 0x04E214434: 8f e0 ldi r24, 0x0F ; 1514436: 8a 9f mul r24, r2614438: d0 01 movw r26, r01443a: 11 24 eor r1, r11443c: a9 56 subi r26, 0x69 ; 1051443e: b6 4f sbci r27, 0xF6 ; 24614440: 14 96 adiw r26, 0x04 ; 414442: 9c 91 ld r25, X14444: 99 0f add r25, r2514446: 99 0f add r25, r2514448: 99 0f add r25, r251444a: 8e 9f mul r24, r301444c: f0 01 movw r30, r01444e: 11 24 eor r1, r114450: e9 56 subi r30, 0x69 ; 10514452: f6 4f sbci r31, 0xF6 ; 24614454: 82 81 ldd r24, Z+2 ; 0x0214456: 87 70 andi r24, 0x07 ; 714458: 89 2b or r24, r251445a: 80 93 bb 00 sts 0x00BB, r241445e: 85 e8 ldi r24, 0x85 ; 13314460: 80 93 bc 00 sts 0x00BC, r24// configuration tranmission request?if((0x0001<<motor_write) & BLConfig_WriteMask)14464: 40 91 e2 04 lds r20, 0x04E214468: 20 91 dc 04 lds r18, 0x04DC1446c: 30 91 dd 04 lds r19, 0x04DD14470: 81 e0 ldi r24, 0x01 ; 114472: 90 e0 ldi r25, 0x00 ; 014474: 02 c0 rjmp .+4 ; 0x1447a <__vector_26+0x214>14476: 88 0f add r24, r2414478: 99 1f adc r25, r251447a: 4a 95 dec r201447c: e2 f7 brpl .-8 ; 0x14476 <__vector_26+0x210>1447e: 82 23 and r24, r1814480: 93 23 and r25, r1914482: 89 2b or r24, r2514484: 51 f0 breq .+20 ; 0x1449a <__vector_26+0x234>{ // redirect tx pointer to configuration datapBuff = (uint8_t*)&BLConfig; // select config for motor14486: 8f e8 ldi r24, 0x8F ; 14314488: 99 e0 ldi r25, 0x09 ; 91448a: 90 93 d8 04 sts 0x04D8, r251448e: 80 93 d7 04 sts 0x04D7, r24BuffLen = sizeof(BLConfig_t);14492: 88 e0 ldi r24, 0x08 ; 814494: 80 93 d6 04 sts 0x04D6, r2414498: ef c1 rjmp .+990 ; 0x14878 <__vector_26+0x612>}else{ // jump to end of transmission for that motortwi_state = 4;1449a: 84 e0 ldi r24, 0x04 ; 41449c: 80 93 e3 04 sts 0x04E3, r24144a0: eb c1 rjmp .+982 ; 0x14878 <__vector_26+0x612>}break;case 3: // send configurationI2C_WriteByte(*pBuff);144a2: e0 91 d7 04 lds r30, 0x04D7144a6: f0 91 d8 04 lds r31, 0x04D8144aa: 80 81 ld r24, Z144ac: 80 93 bb 00 sts 0x00BB, r24144b0: 85 e8 ldi r24, 0x85 ; 133144b2: 80 93 bc 00 sts 0x00BC, r24pBuff++;144b6: 80 91 d7 04 lds r24, 0x04D7144ba: 90 91 d8 04 lds r25, 0x04D8144be: 01 96 adiw r24, 0x01 ; 1144c0: 90 93 d8 04 sts 0x04D8, r25144c4: 80 93 d7 04 sts 0x04D7, r24if(--BuffLen > 0) twi_state = 3; // if there are some bytes left144c8: 80 91 d6 04 lds r24, 0x04D6144cc: 81 50 subi r24, 0x01 ; 1144ce: 80 93 d6 04 sts 0x04D6, r24144d2: 88 23 and r24, r24144d4: 09 f4 brne .+2 ; 0x144d8 <__vector_26+0x272>144d6: d0 c1 rjmp .+928 ; 0x14878 <__vector_26+0x612>144d8: 83 e0 ldi r24, 0x03 ; 3144da: 80 93 e3 04 sts 0x04E3, r24144de: cc c1 rjmp .+920 ; 0x14878 <__vector_26+0x612>break;case 4: // repeat case 0-4 for all motorsif(TWSR == TW_MT_DATA_NACK) // Data transmitted, NACK received144e0: 80 91 b9 00 lds r24, 0x00B9144e4: 80 33 cpi r24, 0x30 ; 48144e6: 11 f5 brne .+68 ; 0x1452c <__vector_26+0x2c6>{if(!missing_motor) missing_motor = motor_write + 1;144e8: 80 91 d5 04 lds r24, 0x04D5144ec: 81 11 cpse r24, r1144ee: 05 c0 rjmp .+10 ; 0x144fa <__vector_26+0x294>144f0: 80 91 e2 04 lds r24, 0x04E2144f4: 8f 5f subi r24, 0xFF ; 255144f6: 80 93 d5 04 sts 0x04D5, r24if((Motor[motor_write].State & MOTOR_STATE_ERROR_MASK) < MOTOR_STATE_ERROR_MASK) Motor[motor_write].State++; // increment error counter and handle overflow144fa: e0 91 e2 04 lds r30, 0x04E2144fe: 8f e0 ldi r24, 0x0F ; 1514500: e8 9f mul r30, r2414502: f0 01 movw r30, r014504: 11 24 eor r1, r114506: e9 56 subi r30, 0x69 ; 10514508: f6 4f sbci r31, 0xF6 ; 2461450a: 83 81 ldd r24, Z+3 ; 0x031450c: 8f 77 andi r24, 0x7F ; 1271450e: 90 e0 ldi r25, 0x00 ; 014510: 8f 37 cpi r24, 0x7F ; 12714512: 91 05 cpc r25, r114514: 5c f4 brge .+22 ; 0x1452c <__vector_26+0x2c6>14516: e0 91 e2 04 lds r30, 0x04E21451a: 2f e0 ldi r18, 0x0F ; 151451c: e2 9f mul r30, r181451e: f0 01 movw r30, r014520: 11 24 eor r1, r114522: e9 56 subi r30, 0x69 ; 10514524: f6 4f sbci r31, 0xF6 ; 24614526: 83 81 ldd r24, Z+3 ; 0x0314528: 8f 5f subi r24, 0xFF ; 2551452a: 83 83 std Z+3, r24 ; 0x03}I2C_Stop(TWI_STATE_MOTOR_TX);1452c: 10 92 e3 04 sts 0x04E3, r114530: ec eb ldi r30, 0xBC ; 18814532: f0 e0 ldi r31, 0x00 ; 014534: 84 e9 ldi r24, 0x94 ; 14814536: 80 83 st Z, r24I2CTimeout = 10;14538: 8a e0 ldi r24, 0x0A ; 101453a: 90 e0 ldi r25, 0x00 ; 01453c: 90 93 b1 02 sts 0x02B1, r2514540: 80 93 b0 02 sts 0x02B0, r24motor_write++; // next motor14544: 80 91 e2 04 lds r24, 0x04E214548: 8f 5f subi r24, 0xFF ; 2551454a: 80 93 e2 04 sts 0x04E2, r24I2C_Start(TWI_STATE_MOTOR_TX); // Repeated start -> switch slave or switch Master Transmit -> Master Receive1454e: 10 92 e3 04 sts 0x04E3, r114552: 80 91 de 04 lds r24, 0x04DE14556: 8e 7f andi r24, 0xFE ; 25414558: 80 93 de 04 sts 0x04DE, r241455c: 85 ea ldi r24, 0xA5 ; 1651455e: 80 83 st Z, r24break;14560: 8b c1 rjmp .+790 ; 0x14878 <__vector_26+0x612>// Master Receive Datacase 5: // TWI_STATE_MOTOR_RXif(TWSR != TW_MR_SLA_ACK) // SLA+R transmitted but no ACK received14562: 80 91 b9 00 lds r24, 0x00B914566: 80 34 cpi r24, 0x40 ; 6414568: a1 f1 breq .+104 ; 0x145d2 <__vector_26+0x36c>{ // no response from the addressed slave receivedMotor[motor_read].State &= ~MOTOR_STATE_PRESENT_MASK; // clear present bit1456a: e0 91 e1 04 lds r30, 0x04E11456e: 8f e0 ldi r24, 0x0F ; 1514570: e8 9f mul r30, r2414572: f0 01 movw r30, r014574: 11 24 eor r1, r114576: e9 56 subi r30, 0x69 ; 10514578: f6 4f sbci r31, 0xF6 ; 2461457a: 83 81 ldd r24, Z+3 ; 0x031457c: 8f 77 andi r24, 0x7F ; 1271457e: 83 83 std Z+3, r24 ; 0x03if(++motor_read >= MAX_MOTORS)14580: 80 91 e1 04 lds r24, 0x04E114584: 8f 5f subi r24, 0xFF ; 25514586: 80 93 e1 04 sts 0x04E1, r241458a: 8c 30 cpi r24, 0x0C ; 121458c: a8 f0 brcs .+42 ; 0x145b8 <__vector_26+0x352>{ // all motors readmotor_read = 0; // restart from beginning1458e: 10 92 e1 04 sts 0x04E1, r1BLConfig_ReadMask = 0; // reset read configuration bitmask14592: 10 92 db 04 sts 0x04DB, r114596: 10 92 da 04 sts 0x04DA, r1if(++motor_read_temperature >= MAX_MOTORS)1459a: 80 91 d4 04 lds r24, 0x04D41459e: 8f 5f subi r24, 0xFF ; 255145a0: 8c 30 cpi r24, 0x0C ; 12145a2: 18 f4 brcc .+6 ; 0x145aa <__vector_26+0x344>145a4: 80 93 d4 04 sts 0x04D4, r24145a8: 07 c0 rjmp .+14 ; 0x145b8 <__vector_26+0x352>{motor_read_temperature = 0;145aa: 10 92 d4 04 sts 0x04D4, r1BLFlags &= ~BLFLAG_READ_VERSION;145ae: 80 91 de 04 lds r24, 0x04DE145b2: 8d 7f andi r24, 0xFD ; 253145b4: 80 93 de 04 sts 0x04DE, r24}}BLFlags |= BLFLAG_TX_COMPLETE;145b8: 80 91 de 04 lds r24, 0x04DE145bc: 81 60 ori r24, 0x01 ; 1145be: 80 93 de 04 sts 0x04DE, r24I2C_Stop(TWI_STATE_MOTOR_TX);145c2: 10 92 e3 04 sts 0x04E3, r1145c6: 84 e9 ldi r24, 0x94 ; 148145c8: 80 93 bc 00 sts 0x00BC, r24I2C_TransferActive = 0;145cc: 10 92 e0 04 sts 0x04E0, r1145d0: 7a c0 rjmp .+244 ; 0x146c6 <__vector_26+0x460>}else{ // motor successfully addressedMotor[motor_read].State |= MOTOR_STATE_PRESENT_MASK; // set present bit145d2: e0 91 e1 04 lds r30, 0x04E1145d6: 8f e0 ldi r24, 0x0F ; 15145d8: 8e 9f mul r24, r30145da: f0 01 movw r30, r0145dc: 11 24 eor r1, r1145de: e9 56 subi r30, 0x69 ; 105145e0: f6 4f sbci r31, 0xF6 ; 246145e2: 93 81 ldd r25, Z+3 ; 0x03145e4: 90 68 ori r25, 0x80 ; 128145e6: 93 83 std Z+3, r25 ; 0x03if(Motor[motor_read].Version & MOTOR_STATE_NEW_PROTOCOL_MASK)145e8: e0 91 e1 04 lds r30, 0x04E1145ec: 8e 9f mul r24, r30145ee: f0 01 movw r30, r0145f0: 11 24 eor r1, r1145f2: e9 56 subi r30, 0x69 ; 105145f4: f6 4f sbci r31, 0xF6 ; 246145f6: 80 81 ld r24, Z145f8: 80 ff sbrs r24, 0145fa: 3c c0 rjmp .+120 ; 0x14674 <__vector_26+0x40e>{// new BL foundswitch(Motor[motor_read].ReadMode)145fc: e0 91 e1 04 lds r30, 0x04E114600: 2f e0 ldi r18, 0x0F ; 1514602: e2 9f mul r30, r1814604: f0 01 movw r30, r014606: 11 24 eor r1, r114608: e9 56 subi r30, 0x69 ; 1051460a: f6 4f sbci r31, 0xF6 ; 2461460c: 84 81 ldd r24, Z+4 ; 0x041460e: 88 23 and r24, r2414610: b1 f0 breq .+44 ; 0x1463e <__vector_26+0x3d8>14612: 80 31 cpi r24, 0x10 ; 1614614: 09 f0 breq .+2 ; 0x14618 <__vector_26+0x3b2>14616: 4c c0 rjmp .+152 ; 0x146b0 <__vector_26+0x44a>{case BL_READMODE_CONFIG:pBuff = (uint8_t*)&BLConfig;14618: 8f e8 ldi r24, 0x8F ; 1431461a: 99 e0 ldi r25, 0x09 ; 91461c: 90 93 d8 04 sts 0x04D8, r2514620: 80 93 d7 04 sts 0x04D7, r24BuffLen = sizeof(BLConfig_t);14624: 88 e0 ldi r24, 0x08 ; 814626: 80 93 d6 04 sts 0x04D6, r24Motor[motor_read].ReadMode = BL_READMODE_STATUS; // only once1462a: e0 91 e1 04 lds r30, 0x04E11462e: 8f e0 ldi r24, 0x0F ; 1514630: e8 9f mul r30, r2414632: f0 01 movw r30, r014634: 11 24 eor r1, r114636: e9 56 subi r30, 0x69 ; 10514638: f6 4f sbci r31, 0xF6 ; 2461463a: 14 82 std Z+4, r1 ; 0x04break;1463c: 39 c0 rjmp .+114 ; 0x146b0 <__vector_26+0x44a>case BL_READMODE_STATUS:pBuff = (uint8_t*)&(Motor[motor_read].Current);1463e: 80 91 e1 04 lds r24, 0x04E114642: 2f e0 ldi r18, 0x0F ; 1514644: 82 9f mul r24, r1814646: c0 01 movw r24, r014648: 11 24 eor r1, r11464a: 84 56 subi r24, 0x64 ; 1001464c: 96 4f sbci r25, 0xF6 ; 2461464e: 90 93 d8 04 sts 0x04D8, r2514652: 80 93 d7 04 sts 0x04D7, r24if(motor_read == motor_read_temperature) BuffLen = ReadBlSize; // read Current, MaxPwm & Temp (is 3 or 9)14656: 90 91 e1 04 lds r25, 0x04E11465a: 80 91 d4 04 lds r24, 0x04D41465e: 98 13 cpse r25, r2414660: 05 c0 rjmp .+10 ; 0x1466c <__vector_26+0x406>14662: 80 91 b3 02 lds r24, 0x02B314666: 80 93 d6 04 sts 0x04D6, r241466a: 22 c0 rjmp .+68 ; 0x146b0 <__vector_26+0x44a>else BuffLen = 1;// read Current only1466c: 81 e0 ldi r24, 0x01 ; 11466e: 80 93 d6 04 sts 0x04D6, r2414672: 22 c0 rjmp .+68 ; 0x146b8 <__vector_26+0x452>break;}}else // old BL version{pBuff = (uint8_t*)&(Motor[motor_read].Current);14674: 80 91 e1 04 lds r24, 0x04E114678: 2f e0 ldi r18, 0x0F ; 151467a: 82 9f mul r24, r181467c: c0 01 movw r24, r01467e: 11 24 eor r1, r114680: 84 56 subi r24, 0x64 ; 10014682: 96 4f sbci r25, 0xF6 ; 24614684: 90 93 d8 04 sts 0x04D8, r2514688: 80 93 d7 04 sts 0x04D7, r24if((BLFlags & BLFLAG_READ_VERSION) || (motor_read == motor_read_temperature)) BuffLen = 2; // Current & MaxPwm1468c: 80 91 de 04 lds r24, 0x04DE14690: 81 fd sbrc r24, 114692: 06 c0 rjmp .+12 ; 0x146a0 <__vector_26+0x43a>14694: 90 91 e1 04 lds r25, 0x04E114698: 80 91 d4 04 lds r24, 0x04D41469c: 98 13 cpse r25, r241469e: 04 c0 rjmp .+8 ; 0x146a8 <__vector_26+0x442>146a0: 82 e0 ldi r24, 0x02 ; 2146a2: 80 93 d6 04 sts 0x04D6, r24146a6: 0c c0 rjmp .+24 ; 0x146c0 <__vector_26+0x45a>else BuffLen = 1; // read Current only146a8: 81 e0 ldi r24, 0x01 ; 1146aa: 80 93 d6 04 sts 0x04D6, r24146ae: 04 c0 rjmp .+8 ; 0x146b8 <__vector_26+0x452>}if(BuffLen == 1)146b0: 80 91 d6 04 lds r24, 0x04D6146b4: 81 30 cpi r24, 0x01 ; 1146b6: 21 f4 brne .+8 ; 0x146c0 <__vector_26+0x45a>{I2C_ReceiveLastByte(); // read last byte146b8: 85 e8 ldi r24, 0x85 ; 133146ba: 80 93 bc 00 sts 0x00BC, r24146be: 03 c0 rjmp .+6 ; 0x146c6 <__vector_26+0x460>}else{I2C_ReceiveByte(); // read next byte146c0: 85 ec ldi r24, 0xC5 ; 197146c2: 80 93 bc 00 sts 0x00BC, r24}}MissingMotor = missing_motor;146c6: 80 91 d5 04 lds r24, 0x04D5146ca: 80 93 df 04 sts 0x04DF, r24missing_motor = 0;146ce: 10 92 d5 04 sts 0x04D5, r1break;146d2: d2 c0 rjmp .+420 ; 0x14878 <__vector_26+0x612>case 6: // receive bytes*pBuff = TWDR;146d4: 80 91 bb 00 lds r24, 0x00BB146d8: e0 91 d7 04 lds r30, 0x04D7146dc: f0 91 d8 04 lds r31, 0x04D8146e0: 81 93 st Z+, r24pBuff++; // set Pointer to next element : Motor[].Current,Motor[].Temperature146e2: f0 93 d8 04 sts 0x04D8, r31146e6: e0 93 d7 04 sts 0x04D7, r30BuffLen--;146ea: 80 91 d6 04 lds r24, 0x04D6146ee: 81 50 subi r24, 0x01 ; 1146f0: 80 93 d6 04 sts 0x04D6, r24if(BuffLen>1)146f4: 82 30 cpi r24, 0x02 ; 2146f6: 20 f0 brcs .+8 ; 0x14700 <__vector_26+0x49a>{I2C_ReceiveByte(); // read next byte146f8: 85 ec ldi r24, 0xC5 ; 197146fa: 80 93 bc 00 sts 0x00BC, r24146fe: a2 c0 rjmp .+324 ; 0x14844 <__vector_26+0x5de>}else if (BuffLen == 1)14700: 81 30 cpi r24, 0x01 ; 114702: 21 f4 brne .+8 ; 0x1470c <__vector_26+0x4a6>{I2C_ReceiveLastByte(); // read last byte14704: 85 e8 ldi r24, 0x85 ; 13314706: 80 93 bc 00 sts 0x00BC, r241470a: 9c c0 rjmp .+312 ; 0x14844 <__vector_26+0x5de>}else // nothing left -> ready{if(BLFlags & BLFLAG_READ_VERSION)1470c: 80 91 de 04 lds r24, 0x04DE14710: 81 ff sbrs r24, 114712: 52 c0 rjmp .+164 ; 0x147b8 <__vector_26+0x552>{if(!(FC_StatusFlags & FC_STATUS_MOTOR_RUN))14714: 80 91 cb 03 lds r24, 0x03CB14718: 80 fd sbrc r24, 01471a: 4e c0 rjmp .+156 ; 0x147b8 <__vector_26+0x552>{if((Motor[motor_read].MaxPWM & 252) == 248) Motor[motor_read].Version |= MOTOR_STATE_NEW_PROTOCOL_MASK;1471c: e0 91 e1 04 lds r30, 0x04E114720: 8f e0 ldi r24, 0x0F ; 1514722: e8 9f mul r30, r2414724: f0 01 movw r30, r014726: 11 24 eor r1, r114728: e9 56 subi r30, 0x69 ; 1051472a: f6 4f sbci r31, 0xF6 ; 2461472c: 86 81 ldd r24, Z+6 ; 0x061472e: 8c 7f andi r24, 0xFC ; 25214730: 88 3f cpi r24, 0xF8 ; 24814732: 61 f4 brne .+24 ; 0x1474c <__vector_26+0x4e6>14734: e0 91 e1 04 lds r30, 0x04E114738: 2f e0 ldi r18, 0x0F ; 151473a: e2 9f mul r30, r181473c: f0 01 movw r30, r01473e: 11 24 eor r1, r114740: e9 56 subi r30, 0x69 ; 10514742: f6 4f sbci r31, 0xF6 ; 24614744: 80 81 ld r24, Z14746: 81 60 ori r24, 0x01 ; 114748: 80 83 st Z, r241474a: 09 c0 rjmp .+18 ; 0x1475e <__vector_26+0x4f8>else Motor[motor_read].Version = 0;1474c: e0 91 e1 04 lds r30, 0x04E114750: 8f e0 ldi r24, 0x0F ; 1514752: e8 9f mul r30, r2414754: f0 01 movw r30, r014756: 11 24 eor r1, r114758: e9 56 subi r30, 0x69 ; 1051475a: f6 4f sbci r31, 0xF6 ; 2461475c: 10 82 st Z, r1if(Motor[motor_read].MaxPWM == 248) Motor[motor_read].Version |= (MOTOR_STATE_FAST_MODE | MOTOR_STATE_BL30);1475e: e0 91 e1 04 lds r30, 0x04E114762: 2f e0 ldi r18, 0x0F ; 1514764: e2 9f mul r30, r1814766: f0 01 movw r30, r014768: 11 24 eor r1, r11476a: e9 56 subi r30, 0x69 ; 1051476c: f6 4f sbci r31, 0xF6 ; 2461476e: 86 81 ldd r24, Z+6 ; 0x0614770: 88 3f cpi r24, 0xF8 ; 24814772: 61 f4 brne .+24 ; 0x1478c <__vector_26+0x526>14774: e0 91 e1 04 lds r30, 0x04E114778: 8f e0 ldi r24, 0x0F ; 151477a: e8 9f mul r30, r241477c: f0 01 movw r30, r01477e: 11 24 eor r1, r114780: e9 56 subi r30, 0x69 ; 10514782: f6 4f sbci r31, 0xF6 ; 24614784: 80 81 ld r24, Z14786: 86 60 ori r24, 0x06 ; 614788: 80 83 st Z, r241478a: 16 c0 rjmp .+44 ; 0x147b8 <__vector_26+0x552>elseif(Motor[motor_read].MaxPWM == 249) Motor[motor_read].Version |= MOTOR_STATE_BL30;1478c: e0 91 e1 04 lds r30, 0x04E114790: 2f e0 ldi r18, 0x0F ; 1514792: e2 9f mul r30, r1814794: f0 01 movw r30, r014796: 11 24 eor r1, r114798: e9 56 subi r30, 0x69 ; 1051479a: f6 4f sbci r31, 0xF6 ; 2461479c: 86 81 ldd r24, Z+6 ; 0x061479e: 89 3f cpi r24, 0xF9 ; 249147a0: 59 f4 brne .+22 ; 0x147b8 <__vector_26+0x552>147a2: e0 91 e1 04 lds r30, 0x04E1147a6: 8f e0 ldi r24, 0x0F ; 15147a8: e8 9f mul r30, r24147aa: f0 01 movw r30, r0147ac: 11 24 eor r1, r1147ae: e9 56 subi r30, 0x69 ; 105147b0: f6 4f sbci r31, 0xF6 ; 246147b2: 80 81 ld r24, Z147b4: 84 60 ori r24, 0x04 ; 4147b6: 80 83 st Z, r24}}if(FC_StatusFlags & FC_STATUS_FLY)147b8: 80 91 cb 03 lds r24, 0x03CB147bc: 81 ff sbrs r24, 1147be: 19 c0 rjmp .+50 ; 0x147f2 <__vector_26+0x58c>{// Starting -> 40// I2C-Setpoint is zero -> 250// 255 -> Running and no Redundancy// 254 -> Running and active Redundancyif(Motor[motor_read].MaxPWM < 254)147c0: e0 91 e1 04 lds r30, 0x04E1147c4: 2f e0 ldi r18, 0x0F ; 15147c6: e2 9f mul r30, r18147c8: f0 01 movw r30, r0147ca: 11 24 eor r1, r1147cc: e9 56 subi r30, 0x69 ; 105147ce: f6 4f sbci r31, 0xF6 ; 246147d0: 86 81 ldd r24, Z+6 ; 0x06147d2: 8e 3f cpi r24, 0xFE ; 254147d4: 70 f4 brcc .+28 ; 0x147f2 <__vector_26+0x58c>{Motor[motor_read].NotReadyCnt++;147d6: e0 91 e1 04 lds r30, 0x04E1147da: 8f e0 ldi r24, 0x0F ; 15147dc: e8 9f mul r30, r24147de: f0 01 movw r30, r0147e0: 11 24 eor r1, r1147e2: e9 56 subi r30, 0x69 ; 105147e4: f6 4f sbci r31, 0xF6 ; 246147e6: 86 85 ldd r24, Z+14 ; 0x0e147e8: 8f 5f subi r24, 0xFF ; 255147ea: 86 87 std Z+14, r24 ; 0x0e#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))SpeakHoTT = SPEAK_ERR_MOTOR;147ec: 89 e0 ldi r24, 0x09 ; 9147ee: 80 93 57 01 sts 0x0157, r24#endif}}if(++motor_read >= MAX_MOTORS)147f2: 80 91 e1 04 lds r24, 0x04E1147f6: 8f 5f subi r24, 0xFF ; 255147f8: 80 93 e1 04 sts 0x04E1, r24147fc: 8c 30 cpi r24, 0x0C ; 12147fe: a8 f0 brcs .+42 ; 0x1482a <__vector_26+0x5c4>{motor_read = 0; // restart from beginning14800: 10 92 e1 04 sts 0x04E1, r1BLConfig_ReadMask = 0; // reset read configuration bitmask14804: 10 92 db 04 sts 0x04DB, r114808: 10 92 da 04 sts 0x04DA, r1if(++motor_read_temperature >= MAX_MOTORS)1480c: 80 91 d4 04 lds r24, 0x04D414810: 8f 5f subi r24, 0xFF ; 25514812: 8c 30 cpi r24, 0x0C ; 1214814: 18 f4 brcc .+6 ; 0x1481c <__vector_26+0x5b6>14816: 80 93 d4 04 sts 0x04D4, r241481a: 07 c0 rjmp .+14 ; 0x1482a <__vector_26+0x5c4>{motor_read_temperature = 0;1481c: 10 92 d4 04 sts 0x04D4, r1BLFlags &= ~BLFLAG_READ_VERSION;14820: 80 91 de 04 lds r24, 0x04DE14824: 8d 7f andi r24, 0xFD ; 25314826: 80 93 de 04 sts 0x04DE, r24}}I2C_Stop(TWI_STATE_MOTOR_TX);1482a: 10 92 e3 04 sts 0x04E3, r11482e: 84 e9 ldi r24, 0x94 ; 14814830: 80 93 bc 00 sts 0x00BC, r24BLFlags |= BLFLAG_TX_COMPLETE;14834: 80 91 de 04 lds r24, 0x04DE14838: 81 60 ori r24, 0x01 ; 11483a: 80 93 de 04 sts 0x04DE, r24I2C_TransferActive = 0;1483e: 10 92 e0 04 sts 0x04E0, r1return;14842: 1a c0 rjmp .+52 ; 0x14878 <__vector_26+0x612>}twi_state = 6; // if there are some bytes left14844: 86 e0 ldi r24, 0x06 ; 614846: 80 93 e3 04 sts 0x04E3, r24break;1484a: 16 c0 rjmp .+44 ; 0x14878 <__vector_26+0x612>BLFlags |= BLFLAG_TX_COMPLETE;}break;*/default:I2C_Stop(TWI_STATE_MOTOR_TX);1484c: 10 92 e3 04 sts 0x04E3, r114850: 84 e9 ldi r24, 0x94 ; 14814852: 80 93 bc 00 sts 0x00BC, r24BLFlags |= BLFLAG_TX_COMPLETE;14856: 80 91 de 04 lds r24, 0x04DE1485a: 81 60 ori r24, 0x01 ; 11485c: 80 93 de 04 sts 0x04DE, r24I2CTimeout = 10;14860: 8a e0 ldi r24, 0x0A ; 1014862: 90 e0 ldi r25, 0x00 ; 014864: 90 93 b1 02 sts 0x02B1, r2514868: 80 93 b0 02 sts 0x02B0, r24motor_write = 0;1486c: 10 92 e2 04 sts 0x04E2, r1motor_read = 0;14870: 10 92 e1 04 sts 0x04E1, r1I2C_TransferActive = 0;14874: 10 92 e0 04 sts 0x04E0, r1break;}}14878: ff 91 pop r311487a: ef 91 pop r301487c: bf 91 pop r271487e: af 91 pop r2614880: 9f 91 pop r2514882: 8f 91 pop r2414884: 4f 91 pop r2014886: 3f 91 pop r1914888: 2f 91 pop r181488a: 0f 90 pop r01488c: 0b be out 0x3b, r0 ; 591488e: 0f 90 pop r014890: 0f be out 0x3f, r0 ; 6314892: 0f 90 pop r014894: 1f 90 pop r114896: 18 95 reti00014898 <I2C_WriteBLConfig>:uint8_t I2C_WriteBLConfig(uint8_t motor){14898: ef 92 push r141489a: ff 92 push r151489c: 0f 93 push r161489e: 1f 93 push r17148a0: cf 93 push r28148a2: df 93 push r29148a4: 18 2f mov r17, r24uint8_t i, packets;uint16_t timer;if(MotorenEin || PC_MotortestActive) return(BLCONFIG_ERR_MOTOR_RUNNING); // not when motors are running!148a6: 90 91 03 04 lds r25, 0x0403148aa: 91 11 cpse r25, r1148ac: 98 c0 rjmp .+304 ; 0x149de <I2C_WriteBLConfig+0x146>148ae: 80 91 f5 04 lds r24, 0x04F5148b2: 81 11 cpse r24, r1148b4: 96 c0 rjmp .+300 ; 0x149e2 <I2C_WriteBLConfig+0x14a>if(motor > MAX_MOTORS) return (BLCONFIG_ERR_MOTOR_NOT_EXIST); // motor does not exist!148b6: 1d 30 cpi r17, 0x0D ; 13148b8: 08 f0 brcs .+2 ; 0x148bc <I2C_WriteBLConfig+0x24>148ba: 95 c0 rjmp .+298 ; 0x149e6 <I2C_WriteBLConfig+0x14e>if(motor)148bc: 11 23 and r17, r17148be: d9 f0 breq .+54 ; 0x148f6 <I2C_WriteBLConfig+0x5e>{if(!(Motor[motor-1].State & MOTOR_STATE_PRESENT_MASK)) return(BLCONFIG_ERR_MOTOR_NOT_EXIST); // motor does not exist!148c0: 21 2f mov r18, r17148c2: 30 e0 ldi r19, 0x00 ; 0148c4: 21 50 subi r18, 0x01 ; 1148c6: 31 09 sbc r19, r1148c8: 8f e0 ldi r24, 0x0F ; 15148ca: 82 9f mul r24, r18148cc: f0 01 movw r30, r0148ce: 83 9f mul r24, r19148d0: f0 0d add r31, r0148d2: 11 24 eor r1, r1148d4: e9 56 subi r30, 0x69 ; 105148d6: f6 4f sbci r31, 0xF6 ; 246148d8: 83 81 ldd r24, Z+3 ; 0x03148da: 88 23 and r24, r24148dc: 0c f0 brlt .+2 ; 0x148e0 <I2C_WriteBLConfig+0x48>148de: 85 c0 rjmp .+266 ; 0x149ea <I2C_WriteBLConfig+0x152>if(!(Motor[motor-1].Version & MOTOR_STATE_NEW_PROTOCOL_MASK)) return(BLCONFIG_ERR_HW_NOT_COMPATIBLE); // not a new BL!148e0: 8f e0 ldi r24, 0x0F ; 15148e2: 82 9f mul r24, r18148e4: f0 01 movw r30, r0148e6: 83 9f mul r24, r19148e8: f0 0d add r31, r0148ea: 11 24 eor r1, r1148ec: e9 56 subi r30, 0x69 ; 105148ee: f6 4f sbci r31, 0xF6 ; 246148f0: 80 81 ld r24, Z148f2: 80 ff sbrs r24, 0148f4: 7c c0 rjmp .+248 ; 0x149ee <I2C_WriteBLConfig+0x156>}// check BL configuration to sendif((BLConfig.Revision & 0x0B) != BLCONFIG_REVISION) return (BLCONFIG_ERR_SW_NOT_COMPATIBLE); // bad revison148f6: 80 91 8f 09 lds r24, 0x098F148fa: 8b 70 andi r24, 0x0B ; 11148fc: 82 30 cpi r24, 0x02 ; 2148fe: 09 f0 breq .+2 ; 0x14902 <I2C_WriteBLConfig+0x6a>14900: 78 c0 rjmp .+240 ; 0x149f2 <I2C_WriteBLConfig+0x15a>i = RAM_Checksum((uint8_t*)&BLConfig, sizeof(BLConfig_t) - 1);14902: 67 e0 ldi r22, 0x07 ; 714904: 70 e0 ldi r23, 0x00 ; 014906: 8f e8 ldi r24, 0x8F ; 14314908: 99 e0 ldi r25, 0x09 ; 91490a: 0e 94 3e 23 call 0x467c ; 0x467c <RAM_Checksum>if(i != BLConfig.crc) return(BLCONFIG_ERR_CHECKSUM); // bad checksum1490e: 90 91 96 09 lds r25, 0x099614912: 98 13 cpse r25, r2414914: 70 c0 rjmp .+224 ; 0x149f6 <I2C_WriteBLConfig+0x15e>packets = Max_I2C_Packets;14916: f0 90 b2 02 lds r15, 0x02B2Max_I2C_Packets = 12;1491a: 8c e0 ldi r24, 0x0C ; 121491c: 80 93 b2 02 sts 0x02B2, r24I2CTimeout = 100;14920: 24 e6 ldi r18, 0x64 ; 10014922: 30 e0 ldi r19, 0x00 ; 014924: 30 93 b1 02 sts 0x02B1, r1914928: 20 93 b0 02 sts 0x02B0, r18timer = SetDelay(100);1492c: 84 e6 ldi r24, 0x64 ; 1001492e: 90 e0 ldi r25, 0x00 ; 014930: 0e 94 5a 9c call 0x138b4 ; 0x138b4 <SetDelay>14934: ec 01 movw r28, r24while(!(BLFlags & BLFLAG_TX_COMPLETE) && !CheckDelay(timer)); //wait for complete transfer14936: 80 91 de 04 lds r24, 0x04DE1493a: 80 fd sbrc r24, 01493c: 05 c0 rjmp .+10 ; 0x14948 <I2C_WriteBLConfig+0xb0>1493e: ce 01 movw r24, r2814940: 0e 94 63 9c call 0x138c6 ; 0x138c6 <CheckDelay>14944: 88 23 and r24, r2414946: b9 f3 breq .-18 ; 0x14936 <I2C_WriteBLConfig+0x9e>// prepare the bitmaskif(!motor) BLConfig_WriteMask = 0x0FFF; // 0 means all -> all motors at once with the same configuration14948: 11 11 cpse r17, r11494a: 07 c0 rjmp .+14 ; 0x1495a <I2C_WriteBLConfig+0xc2>1494c: 8f ef ldi r24, 0xFF ; 2551494e: 9f e0 ldi r25, 0x0F ; 1514950: 90 93 dd 04 sts 0x04DD, r2514954: 80 93 dc 04 sts 0x04DC, r2414958: 0c c0 rjmp .+24 ; 0x14972 <I2C_WriteBLConfig+0xda>else BLConfig_WriteMask = 0x0001<<(motor-1); //only one specific motor1495a: 11 50 subi r17, 0x01 ; 11495c: 81 e0 ldi r24, 0x01 ; 11495e: 90 e0 ldi r25, 0x00 ; 014960: 02 c0 rjmp .+4 ; 0x14966 <I2C_WriteBLConfig+0xce>14962: 88 0f add r24, r2414964: 99 1f adc r25, r2514966: 1a 95 dec r1714968: e2 f7 brpl .-8 ; 0x14962 <I2C_WriteBLConfig+0xca>1496a: 90 93 dd 04 sts 0x04DD, r251496e: 80 93 dc 04 sts 0x04DC, r24motor_write = 0;14972: 10 92 e2 04 sts 0x04E2, r1motor_read = 0;14976: 10 92 e1 04 sts 0x04E1, r1// needs at least MAX_MOTORS loops of 2 ms (12*2ms = 24ms)timer = SetDelay(1000);1497a: 88 ee ldi r24, 0xE8 ; 2321497c: 93 e0 ldi r25, 0x03 ; 31497e: 0e 94 5a 9c call 0x138b4 ; 0x138b4 <SetDelay>14982: ec 01 movw r28, r24do{I2C_Start(TWI_STATE_MOTOR_TX); // start an i2c transmission14984: 0c eb ldi r16, 0xBC ; 18814986: 10 e0 ldi r17, 0x00 ; 014988: 0f 2e mov r0, r311498a: f5 ea ldi r31, 0xA5 ; 1651498c: ef 2e mov r14, r311498e: f0 2d mov r31, r014990: 10 92 e3 04 sts 0x04E3, r114994: 80 91 de 04 lds r24, 0x04DE14998: 8e 7f andi r24, 0xFE ; 2541499a: 80 93 de 04 sts 0x04DE, r241499e: f8 01 movw r30, r16149a0: e0 82 st Z, r14while(!(BLFlags & BLFLAG_TX_COMPLETE) && !CheckDelay(timer)); //wait for complete transfer149a2: 80 91 de 04 lds r24, 0x04DE149a6: 80 fd sbrc r24, 0149a8: 05 c0 rjmp .+10 ; 0x149b4 <I2C_WriteBLConfig+0x11c>149aa: ce 01 movw r24, r28149ac: 0e 94 63 9c call 0x138c6 ; 0x138c6 <CheckDelay>149b0: 88 23 and r24, r24149b2: b9 f3 breq .-18 ; 0x149a2 <I2C_WriteBLConfig+0x10a>} while(BLConfig_WriteMask && !CheckDelay(timer)); // repeat until the BL config has been sent149b4: 80 91 dc 04 lds r24, 0x04DC149b8: 90 91 dd 04 lds r25, 0x04DD149bc: 89 2b or r24, r25149be: 29 f0 breq .+10 ; 0x149ca <I2C_WriteBLConfig+0x132>149c0: ce 01 movw r24, r28149c2: 0e 94 63 9c call 0x138c6 ; 0x138c6 <CheckDelay>149c6: 88 23 and r24, r24149c8: 19 f3 breq .-58 ; 0x14990 <I2C_WriteBLConfig+0xf8>Max_I2C_Packets = packets;149ca: f0 92 b2 02 sts 0x02B2, r15if(BLConfig_WriteMask) return(BLCONFIG_ERR_MOTOR_NOT_EXIST);149ce: 80 91 dc 04 lds r24, 0x04DC149d2: 90 91 dd 04 lds r25, 0x04DD149d6: 89 2b or r24, r25149d8: 81 f0 breq .+32 ; 0x149fa <I2C_WriteBLConfig+0x162>149da: 82 e0 ldi r24, 0x02 ; 2149dc: 0f c0 rjmp .+30 ; 0x149fc <I2C_WriteBLConfig+0x164>uint8_t I2C_WriteBLConfig(uint8_t motor){uint8_t i, packets;uint16_t timer;if(MotorenEin || PC_MotortestActive) return(BLCONFIG_ERR_MOTOR_RUNNING); // not when motors are running!149de: 81 e0 ldi r24, 0x01 ; 1149e0: 0d c0 rjmp .+26 ; 0x149fc <I2C_WriteBLConfig+0x164>149e2: 81 e0 ldi r24, 0x01 ; 1149e4: 0b c0 rjmp .+22 ; 0x149fc <I2C_WriteBLConfig+0x164>if(motor > MAX_MOTORS) return (BLCONFIG_ERR_MOTOR_NOT_EXIST); // motor does not exist!149e6: 82 e0 ldi r24, 0x02 ; 2149e8: 09 c0 rjmp .+18 ; 0x149fc <I2C_WriteBLConfig+0x164>if(motor){if(!(Motor[motor-1].State & MOTOR_STATE_PRESENT_MASK)) return(BLCONFIG_ERR_MOTOR_NOT_EXIST); // motor does not exist!149ea: 82 e0 ldi r24, 0x02 ; 2149ec: 07 c0 rjmp .+14 ; 0x149fc <I2C_WriteBLConfig+0x164>if(!(Motor[motor-1].Version & MOTOR_STATE_NEW_PROTOCOL_MASK)) return(BLCONFIG_ERR_HW_NOT_COMPATIBLE); // not a new BL!149ee: 83 e0 ldi r24, 0x03 ; 3149f0: 05 c0 rjmp .+10 ; 0x149fc <I2C_WriteBLConfig+0x164>}// check BL configuration to sendif((BLConfig.Revision & 0x0B) != BLCONFIG_REVISION) return (BLCONFIG_ERR_SW_NOT_COMPATIBLE); // bad revison149f2: 84 e0 ldi r24, 0x04 ; 4149f4: 03 c0 rjmp .+6 ; 0x149fc <I2C_WriteBLConfig+0x164>i = RAM_Checksum((uint8_t*)&BLConfig, sizeof(BLConfig_t) - 1);if(i != BLConfig.crc) return(BLCONFIG_ERR_CHECKSUM); // bad checksum149f6: 85 e0 ldi r24, 0x05 ; 5149f8: 01 c0 rjmp .+2 ; 0x149fc <I2C_WriteBLConfig+0x164>I2C_Start(TWI_STATE_MOTOR_TX); // start an i2c transmissionwhile(!(BLFlags & BLFLAG_TX_COMPLETE) && !CheckDelay(timer)); //wait for complete transfer} while(BLConfig_WriteMask && !CheckDelay(timer)); // repeat until the BL config has been sentMax_I2C_Packets = packets;if(BLConfig_WriteMask) return(BLCONFIG_ERR_MOTOR_NOT_EXIST);return(BLCONFIG_SUCCESS);149fa: 80 e0 ldi r24, 0x00 ; 0}149fc: df 91 pop r29149fe: cf 91 pop r2814a00: 1f 91 pop r1714a02: 0f 91 pop r1614a04: ff 90 pop r1514a06: ef 90 pop r1414a08: 08 95 ret00014a0a <I2C_ReadBLConfig>:uint8_t I2C_ReadBLConfig(uint8_t motor){14a0a: ff 92 push r1514a0c: 0f 93 push r1614a0e: 1f 93 push r1714a10: cf 93 push r2814a12: df 93 push r29uint8_t i;uint16_t timer;if(MotorenEin || PC_MotortestActive) return(BLCONFIG_ERR_MOTOR_RUNNING); // not when motors are running!14a14: 90 91 03 04 lds r25, 0x040314a18: 91 11 cpse r25, r114a1a: 7b c0 rjmp .+246 ; 0x14b12 <I2C_ReadBLConfig+0x108>14a1c: 90 91 f5 04 lds r25, 0x04F514a20: 91 11 cpse r25, r114a22: 79 c0 rjmp .+242 ; 0x14b16 <I2C_ReadBLConfig+0x10c>if(motor > MAX_MOTORS) return (BLCONFIG_ERR_MOTOR_NOT_EXIST); // motor does not exist!14a24: 8d 30 cpi r24, 0x0D ; 1314a26: 08 f0 brcs .+2 ; 0x14a2a <I2C_ReadBLConfig+0x20>14a28: 78 c0 rjmp .+240 ; 0x14b1a <I2C_ReadBLConfig+0x110>if(motor == 0) return (BLCONFIG_ERR_READ_NOT_POSSIBLE);14a2a: 88 23 and r24, r2414a2c: 09 f4 brne .+2 ; 0x14a30 <I2C_ReadBLConfig+0x26>14a2e: 77 c0 rjmp .+238 ; 0x14b1e <I2C_ReadBLConfig+0x114>if(!(Motor[motor-1].State & MOTOR_STATE_PRESENT_MASK)) return(BLCONFIG_ERR_MOTOR_NOT_EXIST); // motor does not exist!14a30: 08 2f mov r16, r2414a32: 10 e0 ldi r17, 0x00 ; 014a34: 01 50 subi r16, 0x01 ; 114a36: 11 09 sbc r17, r114a38: 8f e0 ldi r24, 0x0F ; 1514a3a: 80 9f mul r24, r1614a3c: f0 01 movw r30, r014a3e: 81 9f mul r24, r1714a40: f0 0d add r31, r014a42: 11 24 eor r1, r114a44: e9 56 subi r30, 0x69 ; 10514a46: f6 4f sbci r31, 0xF6 ; 24614a48: 83 81 ldd r24, Z+3 ; 0x0314a4a: 88 23 and r24, r2414a4c: 0c f0 brlt .+2 ; 0x14a50 <I2C_ReadBLConfig+0x46>14a4e: 69 c0 rjmp .+210 ; 0x14b22 <I2C_ReadBLConfig+0x118>if(!(Motor[motor-1].Version & MOTOR_STATE_NEW_PROTOCOL_MASK)) return(BLCONFIG_ERR_HW_NOT_COMPATIBLE); // not a new BL!14a50: 8f e0 ldi r24, 0x0F ; 1514a52: 80 9f mul r24, r1614a54: f0 01 movw r30, r014a56: 81 9f mul r24, r1714a58: f0 0d add r31, r014a5a: 11 24 eor r1, r114a5c: e9 56 subi r30, 0x69 ; 10514a5e: f6 4f sbci r31, 0xF6 ; 24614a60: 80 81 ld r24, Z14a62: 80 ff sbrs r24, 014a64: 60 c0 rjmp .+192 ; 0x14b26 <I2C_ReadBLConfig+0x11c>timer = SetDelay(1000);14a66: 88 ee ldi r24, 0xE8 ; 23214a68: 93 e0 ldi r25, 0x03 ; 314a6a: 0e 94 5a 9c call 0x138b4 ; 0x138b4 <SetDelay>14a6e: ec 01 movw r28, r24while(!(BLFlags & BLFLAG_TX_COMPLETE) && !CheckDelay(timer)); //wait for complete transfer14a70: 80 91 de 04 lds r24, 0x04DE14a74: 80 fd sbrc r24, 014a76: 05 c0 rjmp .+10 ; 0x14a82 <I2C_ReadBLConfig+0x78>14a78: ce 01 movw r24, r2814a7a: 0e 94 63 9c call 0x138c6 ; 0x138c6 <CheckDelay>14a7e: 88 23 and r24, r2414a80: b9 f3 breq .-18 ; 0x14a70 <I2C_ReadBLConfig+0x66>// prepare the bitmaskBLConfig_ReadMask = 0x0001<<(motor-1);14a82: 81 e0 ldi r24, 0x01 ; 114a84: 90 e0 ldi r25, 0x00 ; 014a86: 9c 01 movw r18, r2414a88: 02 c0 rjmp .+4 ; 0x14a8e <I2C_ReadBLConfig+0x84>14a8a: 22 0f add r18, r1814a8c: 33 1f adc r19, r1914a8e: 0a 95 dec r1614a90: e2 f7 brpl .-8 ; 0x14a8a <I2C_ReadBLConfig+0x80>14a92: 30 93 db 04 sts 0x04DB, r1914a96: 20 93 da 04 sts 0x04DA, r18motor_write = 0;14a9a: 10 92 e2 04 sts 0x04E2, r1motor_read = 0;14a9e: 10 92 e1 04 sts 0x04E1, r1BLConfig.Revision = 0; // bad revision14aa2: 10 92 8f 09 sts 0x098F, r1BLConfig.crc = 0; // bad checksum14aa6: 10 92 96 09 sts 0x0996, r1// needs at least MAX_MOTORS loops of 2 ms (12*2ms = 24ms)do{I2C_Start(TWI_STATE_MOTOR_TX); // start an i2c transmission14aaa: 0c eb ldi r16, 0xBC ; 18814aac: 10 e0 ldi r17, 0x00 ; 014aae: 0f 2e mov r0, r3114ab0: f5 ea ldi r31, 0xA5 ; 16514ab2: ff 2e mov r15, r3114ab4: f0 2d mov r31, r014ab6: 10 92 e3 04 sts 0x04E3, r114aba: 80 91 de 04 lds r24, 0x04DE14abe: 8e 7f andi r24, 0xFE ; 25414ac0: 80 93 de 04 sts 0x04DE, r2414ac4: f8 01 movw r30, r1614ac6: f0 82 st Z, r15while(!(BLFlags & BLFLAG_TX_COMPLETE) && !CheckDelay(timer)); //wait for complete transfer14ac8: 80 91 de 04 lds r24, 0x04DE14acc: 80 fd sbrc r24, 014ace: 05 c0 rjmp .+10 ; 0x14ada <I2C_ReadBLConfig+0xd0>14ad0: ce 01 movw r24, r2814ad2: 0e 94 63 9c call 0x138c6 ; 0x138c6 <CheckDelay>14ad6: 88 23 and r24, r2414ad8: b9 f3 breq .-18 ; 0x14ac8 <I2C_ReadBLConfig+0xbe>} while(BLConfig_ReadMask && !CheckDelay(timer)); // repeat until the BL config has been received from all motors14ada: 80 91 da 04 lds r24, 0x04DA14ade: 90 91 db 04 lds r25, 0x04DB14ae2: 89 2b or r24, r2514ae4: 29 f0 breq .+10 ; 0x14af0 <I2C_ReadBLConfig+0xe6>14ae6: ce 01 movw r24, r2814ae8: 0e 94 63 9c call 0x138c6 ; 0x138c6 <CheckDelay>14aec: 88 23 and r24, r2414aee: 19 f3 breq .-58 ; 0x14ab6 <I2C_ReadBLConfig+0xac>// validate resultif((BLConfig.Revision & 0x0B) != BLCONFIG_REVISION) return (BLCONFIG_ERR_SW_NOT_COMPATIBLE); // bad revison14af0: 80 91 8f 09 lds r24, 0x098F14af4: 8b 70 andi r24, 0x0B ; 1114af6: 82 30 cpi r24, 0x02 ; 214af8: c1 f4 brne .+48 ; 0x14b2a <I2C_ReadBLConfig+0x120>i = RAM_Checksum((uint8_t*)&BLConfig, sizeof(BLConfig_t) - 1);14afa: 67 e0 ldi r22, 0x07 ; 714afc: 70 e0 ldi r23, 0x00 ; 014afe: 8f e8 ldi r24, 0x8F ; 14314b00: 99 e0 ldi r25, 0x09 ; 914b02: 0e 94 3e 23 call 0x467c ; 0x467c <RAM_Checksum>if(i != BLConfig.crc) return(BLCONFIG_ERR_CHECKSUM); // bad checksum14b06: 90 91 96 09 lds r25, 0x099614b0a: 98 17 cp r25, r2414b0c: 81 f0 breq .+32 ; 0x14b2e <I2C_ReadBLConfig+0x124>14b0e: 85 e0 ldi r24, 0x05 ; 514b10: 0f c0 rjmp .+30 ; 0x14b30 <I2C_ReadBLConfig+0x126>uint8_t I2C_ReadBLConfig(uint8_t motor){uint8_t i;uint16_t timer;if(MotorenEin || PC_MotortestActive) return(BLCONFIG_ERR_MOTOR_RUNNING); // not when motors are running!14b12: 81 e0 ldi r24, 0x01 ; 114b14: 0d c0 rjmp .+26 ; 0x14b30 <I2C_ReadBLConfig+0x126>14b16: 81 e0 ldi r24, 0x01 ; 114b18: 0b c0 rjmp .+22 ; 0x14b30 <I2C_ReadBLConfig+0x126>if(motor > MAX_MOTORS) return (BLCONFIG_ERR_MOTOR_NOT_EXIST); // motor does not exist!14b1a: 82 e0 ldi r24, 0x02 ; 214b1c: 09 c0 rjmp .+18 ; 0x14b30 <I2C_ReadBLConfig+0x126>if(motor == 0) return (BLCONFIG_ERR_READ_NOT_POSSIBLE);14b1e: 86 e0 ldi r24, 0x06 ; 614b20: 07 c0 rjmp .+14 ; 0x14b30 <I2C_ReadBLConfig+0x126>if(!(Motor[motor-1].State & MOTOR_STATE_PRESENT_MASK)) return(BLCONFIG_ERR_MOTOR_NOT_EXIST); // motor does not exist!14b22: 82 e0 ldi r24, 0x02 ; 214b24: 05 c0 rjmp .+10 ; 0x14b30 <I2C_ReadBLConfig+0x126>if(!(Motor[motor-1].Version & MOTOR_STATE_NEW_PROTOCOL_MASK)) return(BLCONFIG_ERR_HW_NOT_COMPATIBLE); // not a new BL!14b26: 83 e0 ldi r24, 0x03 ; 314b28: 03 c0 rjmp .+6 ; 0x14b30 <I2C_ReadBLConfig+0x126>{I2C_Start(TWI_STATE_MOTOR_TX); // start an i2c transmissionwhile(!(BLFlags & BLFLAG_TX_COMPLETE) && !CheckDelay(timer)); //wait for complete transfer} while(BLConfig_ReadMask && !CheckDelay(timer)); // repeat until the BL config has been received from all motors// validate resultif((BLConfig.Revision & 0x0B) != BLCONFIG_REVISION) return (BLCONFIG_ERR_SW_NOT_COMPATIBLE); // bad revison14b2a: 84 e0 ldi r24, 0x04 ; 414b2c: 01 c0 rjmp .+2 ; 0x14b30 <I2C_ReadBLConfig+0x126>i = RAM_Checksum((uint8_t*)&BLConfig, sizeof(BLConfig_t) - 1);if(i != BLConfig.crc) return(BLCONFIG_ERR_CHECKSUM); // bad checksumreturn(BLCONFIG_SUCCESS);14b2e: 80 e0 ldi r24, 0x00 ; 0}14b30: df 91 pop r2914b32: cf 91 pop r2814b34: 1f 91 pop r1714b36: 0f 91 pop r1614b38: ff 90 pop r1514b3a: 08 95 ret00014b3c <__vector_22>://+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++//++ Sende-Part der Datenübertragung//+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ISR(USART0_TX_vect){14b3c: 1f 92 push r114b3e: 0f 92 push r014b40: 0f b6 in r0, 0x3f ; 6314b42: 0f 92 push r014b44: 11 24 eor r1, r114b46: 0b b6 in r0, 0x3b ; 5914b48: 0f 92 push r014b4a: 2f 93 push r1814b4c: 8f 93 push r2414b4e: 9f 93 push r2514b50: ef 93 push r3014b52: ff 93 push r31static unsigned int ptr = 0;unsigned char tmp_tx;if(!UebertragungAbgeschlossen)14b54: 80 91 b7 02 lds r24, 0x02B714b58: 81 11 cpse r24, r114b5a: 1c c0 rjmp .+56 ; 0x14b94 <__vector_22+0x58>{ptr++; // die [0] wurde schon gesendet14b5c: 80 91 ea 04 lds r24, 0x04EA14b60: 90 91 eb 04 lds r25, 0x04EB14b64: 01 96 adiw r24, 0x01 ; 114b66: 90 93 eb 04 sts 0x04EB, r2514b6a: 80 93 ea 04 sts 0x04EA, r24tmp_tx = TxdBuffer[ptr];14b6e: fc 01 movw r30, r2414b70: e6 59 subi r30, 0x96 ; 15014b72: f4 4f sbci r31, 0xF4 ; 24414b74: 20 81 ld r18, Zif((tmp_tx == '\r') || (ptr == MAX_SENDE_BUFF))14b76: 2d 30 cpi r18, 0x0D ; 1314b78: 19 f0 breq .+6 ; 0x14b80 <__vector_22+0x44>14b7a: 8c 3d cpi r24, 0xDC ; 22014b7c: 91 05 cpc r25, r114b7e: 39 f4 brne .+14 ; 0x14b8e <__vector_22+0x52>{ptr = 0;14b80: 10 92 eb 04 sts 0x04EB, r114b84: 10 92 ea 04 sts 0x04EA, r1UebertragungAbgeschlossen = 1;14b88: 81 e0 ldi r24, 0x01 ; 114b8a: 80 93 b7 02 sts 0x02B7, r24}UDR0 = tmp_tx;14b8e: 20 93 c6 00 sts 0x00C6, r1814b92: 04 c0 rjmp .+8 ; 0x14b9c <__vector_22+0x60>}else ptr = 0;14b94: 10 92 eb 04 sts 0x04EB, r114b98: 10 92 ea 04 sts 0x04EA, r1}14b9c: ff 91 pop r3114b9e: ef 91 pop r3014ba0: 9f 91 pop r2514ba2: 8f 91 pop r2414ba4: 2f 91 pop r1814ba6: 0f 90 pop r014ba8: 0b be out 0x3b, r0 ; 5914baa: 0f 90 pop r014bac: 0f be out 0x3f, r0 ; 6314bae: 0f 90 pop r014bb0: 1f 90 pop r114bb2: 18 95 reti00014bb4 <__vector_20>://+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++//++ Empfangs-Part der Datenübertragung, incl. CRC-Auswertung//+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ISR(USART0_RX_vect){14bb4: 1f 92 push r114bb6: 0f 92 push r014bb8: 0f b6 in r0, 0x3f ; 6314bba: 0f 92 push r014bbc: 11 24 eor r1, r114bbe: 0b b6 in r0, 0x3b ; 5914bc0: 0f 92 push r014bc2: 1f 93 push r1714bc4: 2f 93 push r1814bc6: 3f 93 push r1914bc8: 4f 93 push r2014bca: 5f 93 push r2114bcc: 6f 93 push r2214bce: 7f 93 push r2314bd0: 8f 93 push r2414bd2: 9f 93 push r2514bd4: af 93 push r2614bd6: bf 93 push r2714bd8: cf 93 push r2814bda: df 93 push r2914bdc: ef 93 push r3014bde: ff 93 push r31static unsigned int crc;static unsigned char crc1,crc2,buf_ptr;static unsigned char UartState = 0;unsigned char CrcOkay = 0;if (ReceiverUpdateModeActive == 1) { UDR1 = UDR0; return; } // 1 = Update14be0: 80 91 ec 04 lds r24, 0x04EC14be4: 81 30 cpi r24, 0x01 ; 114be6: 29 f4 brne .+10 ; 0x14bf2 <__vector_20+0x3e>14be8: 80 91 c6 00 lds r24, 0x00C614bec: 80 93 ce 00 sts 0x00CE, r2414bf0: de c0 rjmp .+444 ; 0x14dae <__vector_20+0x1fa>if (ReceiverUpdateModeActive == 2) { RxdBuffer[0] = UDR0; return; } // 2 = JetiBox-Simulation14bf2: 80 91 ec 04 lds r24, 0x04EC14bf6: 82 30 cpi r24, 0x02 ; 214bf8: 29 f4 brne .+10 ; 0x14c04 <__vector_20+0x50>14bfa: 80 91 c6 00 lds r24, 0x00C614bfe: 80 93 8c 0a sts 0x0A8C, r2414c02: d5 c0 rjmp .+426 ; 0x14dae <__vector_20+0x1fa>SioTmp = UDR0;14c04: 80 91 c6 00 lds r24, 0x00C614c08: 80 93 fc 04 sts 0x04FC, r24if(buf_ptr >= MAX_SENDE_BUFF) UartState = 0;14c0c: 10 91 e9 04 lds r17, 0x04E914c10: 1c 3d cpi r17, 0xDC ; 22014c12: 10 f0 brcs .+4 ; 0x14c18 <__vector_20+0x64>14c14: 10 92 e8 04 sts 0x04E8, r1if(SioTmp == '\r' && UartState == 2)14c18: 80 91 fc 04 lds r24, 0x04FC14c1c: 8d 30 cpi r24, 0x0D ; 1314c1e: 09 f0 breq .+2 ; 0x14c22 <__vector_20+0x6e>14c20: 65 c0 rjmp .+202 ; 0x14cec <__vector_20+0x138>14c22: 80 91 e8 04 lds r24, 0x04E814c26: 82 30 cpi r24, 0x02 ; 214c28: 09 f0 breq .+2 ; 0x14c2c <__vector_20+0x78>14c2a: 60 c0 rjmp .+192 ; 0x14cec <__vector_20+0x138>{UartState = 0;14c2c: 10 92 e8 04 sts 0x04E8, r1crc -= RxdBuffer[buf_ptr-2];14c30: 21 2f mov r18, r1714c32: 30 e0 ldi r19, 0x00 ; 014c34: d9 01 movw r26, r1814c36: a6 57 subi r26, 0x76 ; 11814c38: b5 4f sbci r27, 0xF5 ; 24514c3a: 7c 91 ld r23, Xcrc -= RxdBuffer[buf_ptr-1];14c3c: a9 01 movw r20, r1814c3e: 41 50 subi r20, 0x01 ; 114c40: 51 09 sbc r21, r114c42: ea 01 movw r28, r2014c44: c4 57 subi r28, 0x74 ; 11614c46: d5 4f sbci r29, 0xF5 ; 24514c48: 68 81 ld r22, Yif(buf_ptr >= MAX_SENDE_BUFF) UartState = 0;if(SioTmp == '\r' && UartState == 2){UartState = 0;crc -= RxdBuffer[buf_ptr-2];14c4a: 80 91 e6 04 lds r24, 0x04E614c4e: 90 91 e7 04 lds r25, 0x04E714c52: 87 1b sub r24, r2314c54: 91 09 sbc r25, r1crc -= RxdBuffer[buf_ptr-1];14c56: 86 1b sub r24, r2214c58: 91 09 sbc r25, r1crc %= 4096;14c5a: 9f 70 andi r25, 0x0F ; 1514c5c: 90 93 e7 04 sts 0x04E7, r2514c60: 80 93 e6 04 sts 0x04E6, r24crc1 = '=' + crc / 64;14c64: bc 01 movw r22, r2414c66: 00 24 eor r0, r014c68: 66 0f add r22, r2214c6a: 77 1f adc r23, r2314c6c: 00 1c adc r0, r014c6e: 66 0f add r22, r2214c70: 77 1f adc r23, r2314c72: 00 1c adc r0, r014c74: 67 2f mov r22, r2314c76: 70 2d mov r23, r014c78: 63 5c subi r22, 0xC3 ; 19514c7a: 60 93 e5 04 sts 0x04E5, r22crc2 = '=' + crc % 64;14c7e: 8f 73 andi r24, 0x3F ; 6314c80: 83 5c subi r24, 0xC3 ; 19514c82: 80 93 e4 04 sts 0x04E4, r24CrcOkay = 0;if((crc1 == RxdBuffer[buf_ptr-2]) && (crc2 == RxdBuffer[buf_ptr-1])) CrcOkay = 1; else { CrcOkay = 0; CntCrcError++;};14c86: 9c 91 ld r25, X14c88: 69 13 cpse r22, r2514c8a: 04 c0 rjmp .+8 ; 0x14c94 <__vector_20+0xe0>14c8c: 98 81 ld r25, Y14c8e: 89 17 cp r24, r2514c90: 09 f4 brne .+2 ; 0x14c94 <__vector_20+0xe0>14c92: 88 c0 rjmp .+272 ; 0x14da4 <__vector_20+0x1f0>14c94: 80 91 fa 04 lds r24, 0x04FA14c98: 8f 5f subi r24, 0xFF ; 25514c9a: 80 93 fa 04 sts 0x04FA, r24if(!NeuerDatensatzEmpfangen && CrcOkay) // Datensatz schon verarbeitet14c9e: 80 91 fb 04 lds r24, 0x04FB14ca2: 85 c0 rjmp .+266 ; 0x14dae <__vector_20+0x1fa>{NeuerDatensatzEmpfangen = 1;14ca4: 81 e0 ldi r24, 0x01 ; 114ca6: 80 93 fb 04 sts 0x04FB, r24AnzahlEmpfangsBytes = buf_ptr + 1;14caa: 1f 5f subi r17, 0xFF ; 25514cac: 10 93 f9 04 sts 0x04F9, r17RxdBuffer[buf_ptr] = '\r';14cb0: f9 01 movw r30, r1814cb2: e4 57 subi r30, 0x74 ; 11614cb4: f5 4f sbci r31, 0xF5 ; 24514cb6: 8d e0 ldi r24, 0x0D ; 1314cb8: 80 83 st Z, r24if(RxdBuffer[2] == 'R' && !MotorenEin)14cba: 80 91 8e 0a lds r24, 0x0A8E14cbe: 82 35 cpi r24, 0x52 ; 8214cc0: 09 f0 breq .+2 ; 0x14cc4 <__vector_20+0x110>14cc2: 75 c0 rjmp .+234 ; 0x14dae <__vector_20+0x1fa>14cc4: 80 91 03 04 lds r24, 0x040314cc8: 81 11 cpse r24, r114cca: 71 c0 rjmp .+226 ; 0x14dae <__vector_20+0x1fa>{LcdClear();14ccc: 0e 94 1d 87 call 0x10e3a ; 0x10e3a <LcdClear>wdt_enable(WDTO_250MS); // Reset-Commando14cd0: 2c e0 ldi r18, 0x0C ; 1214cd2: 88 e1 ldi r24, 0x18 ; 2414cd4: 90 e0 ldi r25, 0x00 ; 014cd6: 0f b6 in r0, 0x3f ; 6314cd8: f8 94 cli14cda: a8 95 wdr14cdc: 80 93 60 00 sts 0x0060, r2414ce0: 0f be out 0x3f, r0 ; 6314ce2: 20 93 60 00 sts 0x0060, r18ServoActive = 0;14ce6: 10 92 cb 04 sts 0x04CB, r114cea: 61 c0 rjmp .+194 ; 0x14dae <__vector_20+0x1fa>}}}elseswitch(UartState)14cec: 80 91 e8 04 lds r24, 0x04E814cf0: 81 30 cpi r24, 0x01 ; 114cf2: f1 f0 breq .+60 ; 0x14d30 <__vector_20+0x17c>14cf4: 18 f0 brcs .+6 ; 0x14cfc <__vector_20+0x148>14cf6: 82 30 cpi r24, 0x02 ; 214cf8: b1 f1 breq .+108 ; 0x14d66 <__vector_20+0x1b2>14cfa: 51 c0 rjmp .+162 ; 0x14d9e <__vector_20+0x1ea>{case 0:if(SioTmp == '#' && !NeuerDatensatzEmpfangen) UartState = 1; // Startzeichen und Daten schon verarbeitet14cfc: 80 91 fc 04 lds r24, 0x04FC14d00: 83 32 cpi r24, 0x23 ; 3514d02: 39 f4 brne .+14 ; 0x14d12 <__vector_20+0x15e>14d04: 80 91 fb 04 lds r24, 0x04FB14d08: 81 11 cpse r24, r114d0a: 03 c0 rjmp .+6 ; 0x14d12 <__vector_20+0x15e>14d0c: 81 e0 ldi r24, 0x01 ; 114d0e: 80 93 e8 04 sts 0x04E8, r24buf_ptr = 0;RxdBuffer[buf_ptr++] = SioTmp;14d12: 81 e0 ldi r24, 0x01 ; 114d14: 80 93 e9 04 sts 0x04E9, r2414d18: 80 91 fc 04 lds r24, 0x04FC14d1c: 80 93 8c 0a sts 0x0A8C, r24crc = SioTmp;14d20: 80 91 fc 04 lds r24, 0x04FC14d24: 90 e0 ldi r25, 0x00 ; 014d26: 90 93 e7 04 sts 0x04E7, r2514d2a: 80 93 e6 04 sts 0x04E6, r24break;14d2e: 3f c0 rjmp .+126 ; 0x14dae <__vector_20+0x1fa>case 1: // Adresse auswertenUartState++;14d30: 82 e0 ldi r24, 0x02 ; 214d32: 80 93 e8 04 sts 0x04E8, r24RxdBuffer[buf_ptr++] = SioTmp;14d36: 81 e0 ldi r24, 0x01 ; 114d38: 81 0f add r24, r1714d3a: 80 93 e9 04 sts 0x04E9, r2414d3e: e1 2f mov r30, r1714d40: f0 e0 ldi r31, 0x00 ; 014d42: 80 91 fc 04 lds r24, 0x04FC14d46: e4 57 subi r30, 0x74 ; 11614d48: f5 4f sbci r31, 0xF5 ; 24514d4a: 80 83 st Z, r24crc += SioTmp;14d4c: 20 91 fc 04 lds r18, 0x04FC14d50: 80 91 e6 04 lds r24, 0x04E614d54: 90 91 e7 04 lds r25, 0x04E714d58: 82 0f add r24, r1814d5a: 91 1d adc r25, r114d5c: 90 93 e7 04 sts 0x04E7, r2514d60: 80 93 e6 04 sts 0x04E6, r24break;14d64: 24 c0 rjmp .+72 ; 0x14dae <__vector_20+0x1fa>case 2: // Eingangsdaten sammelnRxdBuffer[buf_ptr] = SioTmp;14d66: e1 2f mov r30, r1714d68: f0 e0 ldi r31, 0x00 ; 014d6a: 80 91 fc 04 lds r24, 0x04FC14d6e: e4 57 subi r30, 0x74 ; 11614d70: f5 4f sbci r31, 0xF5 ; 24514d72: 80 83 st Z, r24if(buf_ptr < MAX_EMPFANGS_BUFF) buf_ptr++;14d74: 1c 3d cpi r17, 0xDC ; 22014d76: 20 f4 brcc .+8 ; 0x14d80 <__vector_20+0x1cc>14d78: 1f 5f subi r17, 0xFF ; 25514d7a: 10 93 e9 04 sts 0x04E9, r1714d7e: 02 c0 rjmp .+4 ; 0x14d84 <__vector_20+0x1d0>else UartState = 0;14d80: 10 92 e8 04 sts 0x04E8, r1//if(DebugOut.Analog[] < buf_ptr) DebugOut.Analog[] = buf_ptr;crc += SioTmp;14d84: 20 91 fc 04 lds r18, 0x04FC14d88: 80 91 e6 04 lds r24, 0x04E614d8c: 90 91 e7 04 lds r25, 0x04E714d90: 82 0f add r24, r1814d92: 91 1d adc r25, r114d94: 90 93 e7 04 sts 0x04E7, r2514d98: 80 93 e6 04 sts 0x04E6, r24break;14d9c: 08 c0 rjmp .+16 ; 0x14dae <__vector_20+0x1fa>default:UartState = 0;14d9e: 10 92 e8 04 sts 0x04E8, r1break;14da2: 05 c0 rjmp .+10 ; 0x14dae <__vector_20+0x1fa>crc %= 4096;crc1 = '=' + crc / 64;crc2 = '=' + crc % 64;CrcOkay = 0;if((crc1 == RxdBuffer[buf_ptr-2]) && (crc2 == RxdBuffer[buf_ptr-1])) CrcOkay = 1; else { CrcOkay = 0; CntCrcError++;};if(!NeuerDatensatzEmpfangen && CrcOkay) // Datensatz schon verarbeitet14da4: 80 91 fb 04 lds r24, 0x04FB14da8: 88 23 and r24, r2414daa: 09 f4 brne .+2 ; 0x14dae <__vector_20+0x1fa>14dac: 7b cf rjmp .-266 ; 0x14ca4 <__vector_20+0xf0>break;default:UartState = 0;break;}}14dae: ff 91 pop r3114db0: ef 91 pop r3014db2: df 91 pop r2914db4: cf 91 pop r2814db6: bf 91 pop r2714db8: af 91 pop r2614dba: 9f 91 pop r2514dbc: 8f 91 pop r2414dbe: 7f 91 pop r2314dc0: 6f 91 pop r2214dc2: 5f 91 pop r2114dc4: 4f 91 pop r2014dc6: 3f 91 pop r1914dc8: 2f 91 pop r1814dca: 1f 91 pop r1714dcc: 0f 90 pop r014dce: 0b be out 0x3b, r0 ; 5914dd0: 0f 90 pop r014dd2: 0f be out 0x3f, r0 ; 6314dd4: 0f 90 pop r014dd6: 1f 90 pop r114dd8: 18 95 reti00014dda <AddCRC>:// --------------------------------------------------------------------------void AddCRC(unsigned int wieviele){unsigned int tmpCRC = 0,i;for(i = 0; i < wieviele;i++)14dda: 00 97 sbiw r24, 0x00 ; 014ddc: 81 f0 breq .+32 ; 0x14dfe <AddCRC+0x24>14dde: 20 e0 ldi r18, 0x00 ; 014de0: 30 e0 ldi r19, 0x00 ; 0// --------------------------------------------------------------------------void AddCRC(unsigned int wieviele){unsigned int tmpCRC = 0,i;14de2: 40 e0 ldi r20, 0x00 ; 014de4: 50 e0 ldi r21, 0x00 ; 0for(i = 0; i < wieviele;i++){tmpCRC += TxdBuffer[i];14de6: f9 01 movw r30, r1814de8: e6 59 subi r30, 0x96 ; 15014dea: f4 4f sbci r31, 0xF4 ; 24414dec: 60 81 ld r22, Z14dee: 46 0f add r20, r2214df0: 51 1d adc r21, r1// --------------------------------------------------------------------------void AddCRC(unsigned int wieviele){unsigned int tmpCRC = 0,i;for(i = 0; i < wieviele;i++)14df2: 2f 5f subi r18, 0xFF ; 25514df4: 3f 4f sbci r19, 0xFF ; 25514df6: 28 17 cp r18, r2414df8: 39 07 cpc r19, r2514dfa: a9 f7 brne .-22 ; 0x14de6 <AddCRC+0xc>14dfc: 02 c0 rjmp .+4 ; 0x14e02 <AddCRC+0x28>// --------------------------------------------------------------------------void AddCRC(unsigned int wieviele){unsigned int tmpCRC = 0,i;14dfe: 40 e0 ldi r20, 0x00 ; 014e00: 50 e0 ldi r21, 0x00 ; 0for(i = 0; i < wieviele;i++){tmpCRC += TxdBuffer[i];}// if(i > MAX_SENDE_BUFF - 3) tmpCRC += 11;tmpCRC %= 4096;14e02: 5f 70 andi r21, 0x0F ; 15TxdBuffer[i++] = '=' + tmpCRC / 64;14e04: 9a 01 movw r18, r2014e06: 00 24 eor r0, r014e08: 22 0f add r18, r1814e0a: 33 1f adc r19, r1914e0c: 00 1c adc r0, r014e0e: 22 0f add r18, r1814e10: 33 1f adc r19, r1914e12: 00 1c adc r0, r014e14: 23 2f mov r18, r1914e16: 30 2d mov r19, r014e18: 23 5c subi r18, 0xC3 ; 19514e1a: fc 01 movw r30, r2414e1c: e6 59 subi r30, 0x96 ; 15014e1e: f4 4f sbci r31, 0xF4 ; 24414e20: 20 83 st Z, r18TxdBuffer[i++] = '=' + tmpCRC % 64;14e22: 4f 73 andi r20, 0x3F ; 6314e24: 43 5c subi r20, 0xC3 ; 19514e26: fc 01 movw r30, r2414e28: e5 59 subi r30, 0x95 ; 14914e2a: f4 4f sbci r31, 0xF4 ; 24414e2c: 40 83 st Z, r20TxdBuffer[i++] = '\r';14e2e: fc 01 movw r30, r2414e30: e4 59 subi r30, 0x94 ; 14814e32: f4 4f sbci r31, 0xF4 ; 24414e34: 2d e0 ldi r18, 0x0D ; 1314e36: 20 83 st Z, r18UebertragungAbgeschlossen = 0;14e38: 10 92 b7 02 sts 0x02B7, r1UDR0 = TxdBuffer[0];14e3c: 80 91 6a 0b lds r24, 0x0B6A14e40: 80 93 c6 00 sts 0x00C6, r2414e44: 08 95 ret00014e46 <SendOutData>:}// --------------------------------------------------------------------------void SendOutData(unsigned char cmd,unsigned char address, unsigned char BufferAnzahl, ...) //unsigned char *snd, unsigned char len){14e46: df 92 push r1314e48: ef 92 push r1414e4a: ff 92 push r1514e4c: 0f 93 push r1614e4e: 1f 93 push r1714e50: cf 93 push r2814e52: df 93 push r2914e54: cd b7 in r28, 0x3d ; 6114e56: de b7 in r29, 0x3e ; 6214e58: 0c 85 ldd r16, Y+12 ; 0x0cunsigned char ptr = 0;unsigned char *snd = 0;int len = 0;TxdBuffer[pt++] = '#'; // Startzeichen14e5a: 83 e2 ldi r24, 0x23 ; 3514e5c: 80 93 6a 0b sts 0x0B6A, r24TxdBuffer[pt++] = 'a' + address; // Adresse (a=0; b=1,...)14e60: 8b 85 ldd r24, Y+11 ; 0x0b14e62: 8f 59 subi r24, 0x9F ; 15914e64: 80 93 6b 0b sts 0x0B6B, r24TxdBuffer[pt++] = cmd; // Commando14e68: 8a 85 ldd r24, Y+10 ; 0x0a14e6a: 80 93 6c 0b sts 0x0B6C, r24va_start(ap, BufferAnzahl);if(BufferAnzahl)14e6e: 00 23 and r16, r1614e70: 09 f4 brne .+2 ; 0x14e74 <SendOutData+0x2e>14e72: a1 c0 rjmp .+322 ; 0x14fb6 <SendOutData+0x170>{snd = va_arg(ap, unsigned char*);14e74: 6d 85 ldd r22, Y+13 ; 0x0d14e76: 7e 85 ldd r23, Y+14 ; 0x0elen = va_arg(ap, int);14e78: ad e0 ldi r26, 0x0D ; 1314e7a: b0 e0 ldi r27, 0x00 ; 014e7c: ac 0f add r26, r2814e7e: bd 1f adc r27, r2914e80: 14 96 adiw r26, 0x04 ; 414e82: 2f 85 ldd r18, Y+15 ; 0x0f14e84: 38 89 ldd r19, Y+16 ; 0x10ptr = 0;BufferAnzahl--;14e86: 01 50 subi r16, 0x01 ; 1}while(len)14e88: 21 15 cp r18, r114e8a: 31 05 cpc r19, r114e8c: 09 f4 brne .+2 ; 0x14e90 <SendOutData+0x4a>14e8e: 96 c0 rjmp .+300 ; 0x14fbc <SendOutData+0x176>14e90: d1 2c mov r13, r114e92: 83 e0 ldi r24, 0x03 ; 314e94: 90 e0 ldi r25, 0x00 ; 0len = va_arg(ap, int);ptr = 0;BufferAnzahl--;}}else c = 0;14e96: 10 e0 ldi r17, 0x00 ; 0ptr = 0;BufferAnzahl--;}while(len){if(len)14e98: 21 15 cp r18, r114e9a: 31 05 cpc r19, r114e9c: 09 f4 brne .+2 ; 0x14ea0 <SendOutData+0x5a>14e9e: 92 c0 rjmp .+292 ; 0x14fc4 <SendOutData+0x17e>{a = snd[ptr++];14ea0: ff 24 eor r15, r1514ea2: f3 94 inc r1514ea4: fd 0c add r15, r1314ea6: fb 01 movw r30, r2214ea8: ed 0d add r30, r1314eaa: f1 1d adc r31, r114eac: 40 81 ld r20, Zlen--;14eae: 21 50 subi r18, 0x01 ; 114eb0: 31 09 sbc r19, r1if((!len) && BufferAnzahl)14eb2: 21 15 cp r18, r114eb4: 31 05 cpc r19, r114eb6: 99 f4 brne .+38 ; 0x14ede <SendOutData+0x98>14eb8: 00 23 and r16, r1614eba: 09 f4 brne .+2 ; 0x14ebe <SendOutData+0x78>14ebc: 85 c0 rjmp .+266 ; 0x14fc8 <SendOutData+0x182>{snd = va_arg(ap, unsigned char*);14ebe: 6d 91 ld r22, X+14ec0: 7c 91 ld r23, X14ec2: 11 97 sbiw r26, 0x01 ; 1len = va_arg(ap, int);14ec4: fd 01 movw r30, r2614ec6: 34 96 adiw r30, 0x04 ; 414ec8: 12 96 adiw r26, 0x02 ; 214eca: 2d 91 ld r18, X+14ecc: 3c 91 ld r19, X14ece: 13 97 sbiw r26, 0x03 ; 3ptr = 0;BufferAnzahl--;14ed0: 01 50 subi r16, 0x01 ; 1}}else a = 0;if(len)14ed2: 21 15 cp r18, r114ed4: 31 05 cpc r19, r114ed6: 09 f4 brne .+2 ; 0x14eda <SendOutData+0x94>14ed8: 7a c0 rjmp .+244 ; 0x14fce <SendOutData+0x188>a = snd[ptr++];len--;if((!len) && BufferAnzahl){snd = va_arg(ap, unsigned char*);len = va_arg(ap, int);14eda: df 01 movw r26, r30ptr = 0;14edc: f1 2e mov r15, r17}}else a = 0;if(len){b = snd[ptr++];14ede: 51 e0 ldi r21, 0x01 ; 114ee0: 5f 0d add r21, r1514ee2: fb 01 movw r30, r2214ee4: ef 0d add r30, r1514ee6: f1 1d adc r31, r114ee8: e0 80 ld r14, Zlen--;14eea: 21 50 subi r18, 0x01 ; 114eec: 31 09 sbc r19, r1if((!len) && BufferAnzahl)14eee: 21 15 cp r18, r114ef0: 31 05 cpc r19, r114ef2: 91 f4 brne .+36 ; 0x14f18 <SendOutData+0xd2>14ef4: 00 23 and r16, r1614ef6: 09 f4 brne .+2 ; 0x14efa <SendOutData+0xb4>14ef8: 6e c0 rjmp .+220 ; 0x14fd6 <SendOutData+0x190>{snd = va_arg(ap, unsigned char*);14efa: 6d 91 ld r22, X+14efc: 7c 91 ld r23, X14efe: 11 97 sbiw r26, 0x01 ; 1len = va_arg(ap, int);14f00: fd 01 movw r30, r2614f02: 34 96 adiw r30, 0x04 ; 414f04: 12 96 adiw r26, 0x02 ; 214f06: 2d 91 ld r18, X+14f08: 3c 91 ld r19, X14f0a: 13 97 sbiw r26, 0x03 ; 3ptr = 0;BufferAnzahl--;14f0c: 01 50 subi r16, 0x01 ; 1}}else b = 0;if(len)14f0e: 21 15 cp r18, r114f10: 31 05 cpc r19, r114f12: d9 f0 breq .+54 ; 0x14f4a <SendOutData+0x104>b = snd[ptr++];len--;if((!len) && BufferAnzahl){snd = va_arg(ap, unsigned char*);len = va_arg(ap, int);14f14: df 01 movw r26, r30ptr = 0;14f16: 51 2f mov r21, r17}}else b = 0;if(len){c = snd[ptr++];14f18: dd 24 eor r13, r1314f1a: d3 94 inc r1314f1c: d5 0e add r13, r2114f1e: fb 01 movw r30, r2214f20: e5 0f add r30, r2114f22: f1 1d adc r31, r114f24: f0 80 ld r15, Zlen--;14f26: 21 50 subi r18, 0x01 ; 114f28: 31 09 sbc r19, r1if((!len) && BufferAnzahl)14f2a: 21 15 cp r18, r114f2c: 31 05 cpc r19, r114f2e: 81 f4 brne .+32 ; 0x14f50 <SendOutData+0x10a>14f30: 00 23 and r16, r1614f32: 71 f0 breq .+28 ; 0x14f50 <SendOutData+0x10a>{snd = va_arg(ap, unsigned char*);14f34: 6d 91 ld r22, X+14f36: 7c 91 ld r23, X14f38: 11 97 sbiw r26, 0x01 ; 1len = va_arg(ap, int);14f3a: 12 96 adiw r26, 0x02 ; 214f3c: 2d 91 ld r18, X+14f3e: 3c 91 ld r19, X14f40: 13 97 sbiw r26, 0x03 ; 3ptr = 0;BufferAnzahl--;14f42: 01 50 subi r16, 0x01 ; 1c = snd[ptr++];len--;if((!len) && BufferAnzahl){snd = va_arg(ap, unsigned char*);len = va_arg(ap, int);14f44: 14 96 adiw r26, 0x04 ; 4ptr = 0;14f46: d1 2e mov r13, r1714f48: 03 c0 rjmp .+6 ; 0x14f50 <SendOutData+0x10a>b = snd[ptr++];len--;if((!len) && BufferAnzahl){snd = va_arg(ap, unsigned char*);len = va_arg(ap, int);14f4a: df 01 movw r26, r30ptr = 0;14f4c: d1 2e mov r13, r17len = va_arg(ap, int);ptr = 0;BufferAnzahl--;}}else c = 0;14f4e: f1 2e mov r15, r17TxdBuffer[pt++] = '=' + (a >> 2);14f50: 54 2f mov r21, r2014f52: 56 95 lsr r2114f54: 56 95 lsr r2114f56: 53 5c subi r21, 0xC3 ; 19514f58: fc 01 movw r30, r2414f5a: e6 59 subi r30, 0x96 ; 15014f5c: f4 4f sbci r31, 0xF4 ; 24414f5e: 50 83 st Z, r21TxdBuffer[pt++] = '=' + (((a & 0x03) << 4) | ((b & 0xf0) >> 4));14f60: 43 70 andi r20, 0x03 ; 314f62: e0 e1 ldi r30, 0x10 ; 1614f64: 4e 9f mul r20, r3014f66: a0 01 movw r20, r014f68: 11 24 eor r1, r114f6a: 5e 2d mov r21, r1414f6c: 52 95 swap r2114f6e: 5f 70 andi r21, 0x0F ; 1514f70: 45 2b or r20, r2114f72: 43 5c subi r20, 0xC3 ; 19514f74: fc 01 movw r30, r2414f76: e5 59 subi r30, 0x95 ; 14914f78: f4 4f sbci r31, 0xF4 ; 24414f7a: 40 83 st Z, r20TxdBuffer[pt++] = '=' + (((b & 0x0f) << 2) | ((c & 0xc0) >> 6));14f7c: 4e 2d mov r20, r1414f7e: 4f 70 andi r20, 0x0F ; 1514f80: 44 0f add r20, r2014f82: 44 0f add r20, r2014f84: 5f 2d mov r21, r1514f86: 52 95 swap r2114f88: 56 95 lsr r2114f8a: 56 95 lsr r2114f8c: 53 70 andi r21, 0x03 ; 314f8e: 45 2b or r20, r2114f90: 43 5c subi r20, 0xC3 ; 19514f92: fc 01 movw r30, r2414f94: e4 59 subi r30, 0x94 ; 14814f96: f4 4f sbci r31, 0xF4 ; 24414f98: 40 83 st Z, r20TxdBuffer[pt++] = '=' + ( c & 0x3f);14f9a: 4f 2d mov r20, r1514f9c: 4f 73 andi r20, 0x3F ; 6314f9e: 43 5c subi r20, 0xC3 ; 19514fa0: fc 01 movw r30, r2414fa2: 33 96 adiw r30, 0x03 ; 314fa4: e6 59 subi r30, 0x96 ; 15014fa6: f4 4f sbci r31, 0xF4 ; 24414fa8: 04 96 adiw r24, 0x04 ; 414faa: 40 83 st Z, r20snd = va_arg(ap, unsigned char*);len = va_arg(ap, int);ptr = 0;BufferAnzahl--;}while(len)14fac: 21 15 cp r18, r114fae: 31 05 cpc r19, r114fb0: 09 f0 breq .+2 ; 0x14fb4 <SendOutData+0x16e>14fb2: 72 cf rjmp .-284 ; 0x14e98 <SendOutData+0x52>14fb4: 05 c0 rjmp .+10 ; 0x14fc0 <SendOutData+0x17a>14fb6: 83 e0 ldi r24, 0x03 ; 314fb8: 90 e0 ldi r25, 0x00 ; 014fba: 02 c0 rjmp .+4 ; 0x14fc0 <SendOutData+0x17a>14fbc: 83 e0 ldi r24, 0x03 ; 314fbe: 90 e0 ldi r25, 0x00 ; 0TxdBuffer[pt++] = '=' + (((a & 0x03) << 4) | ((b & 0xf0) >> 4));TxdBuffer[pt++] = '=' + (((b & 0x0f) << 2) | ((c & 0xc0) >> 6));TxdBuffer[pt++] = '=' + ( c & 0x3f);}va_end(ap);AddCRC(pt);14fc0: 0c df rcall .-488 ; 0x14dda <AddCRC>14fc2: 0c c0 rjmp .+24 ; 0x14fdc <SendOutData+0x196>len = va_arg(ap, int);ptr = 0;BufferAnzahl--;}}else a = 0;14fc4: 41 2f mov r20, r1714fc6: 01 c0 rjmp .+2 ; 0x14fca <SendOutData+0x184>}while(len){if(len){a = snd[ptr++];14fc8: df 2c mov r13, r15len = va_arg(ap, int);ptr = 0;BufferAnzahl--;}}else b = 0;14fca: e1 2e mov r14, r1714fcc: 05 c0 rjmp .+10 ; 0x14fd8 <SendOutData+0x192>a = snd[ptr++];len--;if((!len) && BufferAnzahl){snd = va_arg(ap, unsigned char*);len = va_arg(ap, int);14fce: df 01 movw r26, r30ptr = 0;14fd0: d1 2e mov r13, r17len = va_arg(ap, int);ptr = 0;BufferAnzahl--;}}else b = 0;14fd2: e1 2e mov r14, r1714fd4: 01 c0 rjmp .+2 ; 0x14fd8 <SendOutData+0x192>}}else a = 0;if(len){b = snd[ptr++];14fd6: d5 2e mov r13, r21len = va_arg(ap, int);ptr = 0;BufferAnzahl--;}}else c = 0;14fd8: f1 2e mov r15, r1714fda: ba cf rjmp .-140 ; 0x14f50 <SendOutData+0x10a>TxdBuffer[pt++] = '=' + (((b & 0x0f) << 2) | ((c & 0xc0) >> 6));TxdBuffer[pt++] = '=' + ( c & 0x3f);}va_end(ap);AddCRC(pt);}14fdc: df 91 pop r2914fde: cf 91 pop r2814fe0: 1f 91 pop r1714fe2: 0f 91 pop r1614fe4: ff 90 pop r1514fe6: ef 90 pop r1414fe8: df 90 pop r1314fea: 08 95 ret00014fec <Decode64>:{unsigned char a,b,c,d;unsigned char x,y,z;unsigned char ptrIn = 3; // start at begin of data blockunsigned char ptrOut = 3;unsigned char len = AnzahlEmpfangsBytes - 6; // von der Gesamtbytezahl eines Frames gehen 3 Bytes des Headers ('#',Addr, Cmd) und 3 Bytes des Footers (CRC1, CRC2, '\r') ab.14fec: 70 91 f9 04 lds r23, 0x04F914ff0: 6a ef ldi r22, 0xFA ; 25014ff2: 67 0f add r22, r23while(len)14ff4: 09 f4 brne .+2 ; 0x14ff8 <Decode64+0xc>14ff6: 54 c0 rjmp .+168 ; 0x150a0 <Decode64+0xb4>14ff8: ab ef ldi r26, 0xFB ; 25114ffa: a7 0f add r26, r2314ffc: 74 50 subi r23, 0x04 ; 4void Decode64(void) // die daten werden im rx buffer dekodiert, das geht nur, weil aus 4 byte immer 3 gemacht werden.{unsigned char a,b,c,d;unsigned char x,y,z;unsigned char ptrIn = 3; // start at begin of data blockunsigned char ptrOut = 3;14ffe: 43 e0 ldi r20, 0x03 ; 3// --------------------------------------------------------------------------void Decode64(void) // die daten werden im rx buffer dekodiert, das geht nur, weil aus 4 byte immer 3 gemacht werden.{unsigned char a,b,c,d;unsigned char x,y,z;unsigned char ptrIn = 3; // start at begin of data block15000: 53 e0 ldi r21, 0x03 ; 3unsigned char ptrOut = 3;unsigned char len = AnzahlEmpfangsBytes - 6; // von der Gesamtbytezahl eines Frames gehen 3 Bytes des Headers ('#',Addr, Cmd) und 3 Bytes des Footers (CRC1, CRC2, '\r') ab.while(len){a = RxdBuffer[ptrIn++] - '=';15002: e5 2f mov r30, r2115004: f0 e0 ldi r31, 0x00 ; 015006: e4 57 subi r30, 0x74 ; 11615008: f5 4f sbci r31, 0xF5 ; 2451500a: 30 81 ld r19, Z1500c: e1 e0 ldi r30, 0x01 ; 11500e: e5 0f add r30, r21b = RxdBuffer[ptrIn++] - '=';15010: f0 e0 ldi r31, 0x00 ; 015012: e4 57 subi r30, 0x74 ; 11615014: f5 4f sbci r31, 0xF5 ; 24515016: 20 81 ld r18, Z15018: 2d 53 subi r18, 0x3D ; 611501a: e2 e0 ldi r30, 0x02 ; 21501c: e5 0f add r30, r21c = RxdBuffer[ptrIn++] - '=';1501e: f0 e0 ldi r31, 0x00 ; 015020: e4 57 subi r30, 0x74 ; 11615022: f5 4f sbci r31, 0xF5 ; 24515024: 80 81 ld r24, Z15026: 8d 53 subi r24, 0x3D ; 61d = RxdBuffer[ptrIn++] - '=';15028: e3 e0 ldi r30, 0x03 ; 31502a: e5 0f add r30, r211502c: f0 e0 ldi r31, 0x00 ; 01502e: 5c 5f subi r21, 0xFC ; 25215030: e4 57 subi r30, 0x74 ; 11615032: f5 4f sbci r31, 0xF5 ; 24515034: e0 81 ld r30, Zx = (a << 2) | (b >> 4);15036: 92 2f mov r25, r1815038: 92 95 swap r251503a: 9f 70 andi r25, 0x0F ; 15unsigned char ptrOut = 3;unsigned char len = AnzahlEmpfangsBytes - 6; // von der Gesamtbytezahl eines Frames gehen 3 Bytes des Headers ('#',Addr, Cmd) und 3 Bytes des Footers (CRC1, CRC2, '\r') ab.while(len){a = RxdBuffer[ptrIn++] - '=';1503c: 3d 53 subi r19, 0x3D ; 61b = RxdBuffer[ptrIn++] - '=';c = RxdBuffer[ptrIn++] - '=';d = RxdBuffer[ptrIn++] - '=';x = (a << 2) | (b >> 4);1503e: 33 0f add r19, r1915040: 33 0f add r19, r1915042: b3 2f mov r27, r1915044: b9 2b or r27, r25y = ((b & 0x0f) << 4) | (c >> 2);15046: 90 e1 ldi r25, 0x10 ; 1615048: 29 9f mul r18, r251504a: 90 01 movw r18, r01504c: 11 24 eor r1, r11504e: 98 2f mov r25, r2415050: 96 95 lsr r2515052: 96 95 lsr r2515054: 29 2b or r18, r25z = ((c & 0x03) << 6) | d;15056: 30 e4 ldi r19, 0x40 ; 6415058: 83 9f mul r24, r191505a: c0 01 movw r24, r01505c: 11 24 eor r1, r1while(len){a = RxdBuffer[ptrIn++] - '=';b = RxdBuffer[ptrIn++] - '=';c = RxdBuffer[ptrIn++] - '=';d = RxdBuffer[ptrIn++] - '=';1505e: 93 ec ldi r25, 0xC3 ; 19515060: 9e 0f add r25, r30x = (a << 2) | (b >> 4);y = ((b & 0x0f) << 4) | (c >> 2);z = ((c & 0x03) << 6) | d;15062: 89 2b or r24, r25if(len--) RxdBuffer[ptrOut++] = x; else break;15064: 66 23 and r22, r2215066: 09 f1 breq .+66 ; 0x150aa <Decode64+0xbe>15068: 31 e0 ldi r19, 0x01 ; 11506a: 34 0f add r19, r201506c: e4 2f mov r30, r201506e: f0 e0 ldi r31, 0x00 ; 015070: e4 57 subi r30, 0x74 ; 11615072: f5 4f sbci r31, 0xF5 ; 24515074: b0 83 st Z, r27if(len--) RxdBuffer[ptrOut++] = y; else break;15076: 47 17 cp r20, r2315078: a9 f0 breq .+42 ; 0x150a4 <Decode64+0xb8>1507a: 92 e0 ldi r25, 0x02 ; 21507c: 94 0f add r25, r201507e: e3 2f mov r30, r1915080: f0 e0 ldi r31, 0x00 ; 015082: e4 57 subi r30, 0x74 ; 11615084: f5 4f sbci r31, 0xF5 ; 24515086: 20 83 st Z, r18if(len--) RxdBuffer[ptrOut++] = z; else break;15088: 63 50 subi r22, 0x03 ; 31508a: 4a 17 cp r20, r261508c: 69 f0 breq .+26 ; 0x150a8 <Decode64+0xbc>1508e: 4d 5f subi r20, 0xFD ; 25315090: e9 2f mov r30, r2515092: f0 e0 ldi r31, 0x00 ; 015094: e4 57 subi r30, 0x74 ; 11615096: f5 4f sbci r31, 0xF5 ; 24515098: 80 83 st Z, r24unsigned char x,y,z;unsigned char ptrIn = 3; // start at begin of data blockunsigned char ptrOut = 3;unsigned char len = AnzahlEmpfangsBytes - 6; // von der Gesamtbytezahl eines Frames gehen 3 Bytes des Headers ('#',Addr, Cmd) und 3 Bytes des Footers (CRC1, CRC2, '\r') ab.while(len)1509a: 61 11 cpse r22, r11509c: b2 cf rjmp .-156 ; 0x15002 <Decode64+0x16>1509e: 05 c0 rjmp .+10 ; 0x150aa <Decode64+0xbe>void Decode64(void) // die daten werden im rx buffer dekodiert, das geht nur, weil aus 4 byte immer 3 gemacht werden.{unsigned char a,b,c,d;unsigned char x,y,z;unsigned char ptrIn = 3; // start at begin of data blockunsigned char ptrOut = 3;150a0: 43 e0 ldi r20, 0x03 ; 3150a2: 03 c0 rjmp .+6 ; 0x150aa <Decode64+0xbe>x = (a << 2) | (b >> 4);y = ((b & 0x0f) << 4) | (c >> 2);z = ((c & 0x03) << 6) | d;if(len--) RxdBuffer[ptrOut++] = x; else break;150a4: 43 2f mov r20, r19150a6: 01 c0 rjmp .+2 ; 0x150aa <Decode64+0xbe>if(len--) RxdBuffer[ptrOut++] = y; else break;150a8: 49 2f mov r20, r25if(len--) RxdBuffer[ptrOut++] = z; else break;}pRxData = (unsigned char*)&RxdBuffer[3]; // decodierte Daten beginnen beim 4. Byte150aa: 8f e8 ldi r24, 0x8F ; 143150ac: 9a e0 ldi r25, 0x0A ; 10150ae: 90 93 f8 04 sts 0x04F8, r25150b2: 80 93 f7 04 sts 0x04F7, r24RxDataLen = ptrOut - 3; // wie viele Bytes wurden dekodiert?150b6: 43 50 subi r20, 0x03 ; 3150b8: 40 93 f6 04 sts 0x04F6, r20150bc: 08 95 ret000150be <BearbeiteRxDaten>:}// --------------------------------------------------------------------------void BearbeiteRxDaten(void){150be: cf 93 push r28150c0: df 93 push r29150c2: 00 d0 rcall .+0 ; 0x150c4 <BearbeiteRxDaten+0x6>150c4: cd b7 in r28, 0x3d ; 61150c6: de b7 in r29, 0x3e ; 62if(!NeuerDatensatzEmpfangen) return;150c8: 80 91 fb 04 lds r24, 0x04FB150cc: 88 23 and r24, r24150ce: 09 f4 brne .+2 ; 0x150d2 <BearbeiteRxDaten+0x14>150d0: 49 c4 rjmp .+2194 ; 0x15964 <BearbeiteRxDaten+0x8a6>unsigned char tempchar1, tempchar2;Decode64(); // dekodiere datenblock im Empfangsbuffer150d2: 8c df rcall .-232 ; 0x14fec <Decode64>switch(RxdBuffer[1]-'a') // check for Slave Address150d4: 80 91 8d 0a lds r24, 0x0A8D150d8: 82 36 cpi r24, 0x62 ; 98150da: 09 f0 breq .+2 ; 0x150de <BearbeiteRxDaten+0x20>150dc: 04 c3 rjmp .+1544 ; 0x156e6 <BearbeiteRxDaten+0x628>{case FC_ADDRESS: // FC special commandsswitch(RxdBuffer[2])150de: 80 91 8e 0a lds r24, 0x0A8E150e2: 90 e0 ldi r25, 0x00 ; 0150e4: fc 01 movw r30, r24150e6: eb 54 subi r30, 0x4B ; 75150e8: f1 09 sbc r31, r1150ea: ef 32 cpi r30, 0x2F ; 47150ec: f1 05 cpc r31, r1150ee: 08 f0 brcs .+2 ; 0x150f2 <BearbeiteRxDaten+0x34>150f0: fa c2 rjmp .+1524 ; 0x156e6 <BearbeiteRxDaten+0x628>150f2: e9 54 subi r30, 0x49 ; 73150f4: ff 4f sbci r31, 0xFF ; 255150f6: 0c 94 a7 b1 jmp 0x1634e ; 0x1634e <__tablejump2__>{case 'K':// Kompasswertmemcpy((unsigned char *)&KompassValue , (unsigned char *)pRxData, sizeof(KompassValue));150fa: e0 91 f7 04 lds r30, 0x04F7150fe: f0 91 f8 04 lds r31, 0x04F815102: 80 81 ld r24, Z15104: 91 81 ldd r25, Z+1 ; 0x0115106: 90 93 4f 01 sts 0x014F, r251510a: 80 93 4e 01 sts 0x014E, r24// KompassRichtung = ((540 + KompassValue - KompassSollWert) % 360) - 180;break;1510e: eb c2 rjmp .+1494 ; 0x156e6 <BearbeiteRxDaten+0x628>case 't':// Motortestif(AnzahlEmpfangsBytes > 20) memcpy(&MotorTest[0], (unsigned char *)pRxData, sizeof(MotorTest));15110: 80 91 f9 04 lds r24, 0x04F915114: 85 31 cpi r24, 0x15 ; 2115116: 60 f0 brcs .+24 ; 0x15130 <BearbeiteRxDaten+0x72>15118: e0 91 f7 04 lds r30, 0x04F71511c: f0 91 f8 04 lds r31, 0x04F815120: 80 e1 ldi r24, 0x10 ; 1615122: a7 e6 ldi r26, 0x67 ; 10315124: ba e0 ldi r27, 0x0A ; 1015126: 01 90 ld r0, Z+15128: 0d 92 st X+, r01512a: 8a 95 dec r241512c: e1 f7 brne .-8 ; 0x15126 <BearbeiteRxDaten+0x68>1512e: 10 c0 rjmp .+32 ; 0x15150 <BearbeiteRxDaten+0x92>else memcpy(&MotorTest[0], (unsigned char *)pRxData, 4);15130: e0 91 f7 04 lds r30, 0x04F715134: f0 91 f8 04 lds r31, 0x04F815138: 80 81 ld r24, Z1513a: 91 81 ldd r25, Z+1 ; 0x011513c: a2 81 ldd r26, Z+2 ; 0x021513e: b3 81 ldd r27, Z+3 ; 0x0315140: 80 93 67 0a sts 0x0A67, r2415144: 90 93 68 0a sts 0x0A68, r2515148: a0 93 69 0a sts 0x0A69, r261514c: b0 93 6a 0a sts 0x0A6A, r27PC_MotortestActive = 240;15150: 80 ef ldi r24, 0xF0 ; 24015152: 80 93 f5 04 sts 0x04F5, r24//while(!UebertragungAbgeschlossen);//SendOutData('T', MeineSlaveAdresse, 0);PcZugriff = 255;15156: 8f ef ldi r24, 0xFF ; 25515158: 80 93 b5 02 sts 0x02B5, r24break;1515c: c4 c2 rjmp .+1416 ; 0x156e6 <BearbeiteRxDaten+0x628>case 'n':// "Get Mixerwhile(!UebertragungAbgeschlossen);1515e: 80 91 b7 02 lds r24, 0x02B715162: 88 23 and r24, r2415164: e1 f3 breq .-8 ; 0x1515e <BearbeiteRxDaten+0xa0>SendOutData('N', FC_ADDRESS, 1, (unsigned char *) &Mixer, sizeof(Mixer) - 1);15166: 1f 92 push r115168: 8d e4 ldi r24, 0x4D ; 771516a: 8f 93 push r241516c: 87 ec ldi r24, 0xC7 ; 1991516e: 95 e0 ldi r25, 0x05 ; 515170: 9f 93 push r2515172: 8f 93 push r2415174: 81 e0 ldi r24, 0x01 ; 115176: 8f 93 push r2415178: 8f 93 push r241517a: 8e e4 ldi r24, 0x4E ; 781517c: 8f 93 push r241517e: 63 de rcall .-826 ; 0x14e46 <SendOutData>Debug("Mixer lesen");15180: 83 e6 ldi r24, 0x63 ; 9915182: 96 e1 ldi r25, 0x16 ; 2215184: 9f 93 push r2515186: 8f 93 push r2415188: 88 e1 ldi r24, 0x18 ; 241518a: 93 e2 ldi r25, 0x23 ; 351518c: 9f 93 push r251518e: 8f 93 push r2415190: e0 91 78 06 lds r30, 0x067815194: f0 91 79 06 lds r31, 0x067915198: 09 95 icall1519a: 80 e0 ldi r24, 0x00 ; 01519c: 0e 94 2c 23 call 0x4658 ; 0x4658 <DebugSend>break;151a0: 0f b6 in r0, 0x3f ; 63151a2: f8 94 cli151a4: de bf out 0x3e, r29 ; 62151a6: 0f be out 0x3f, r0 ; 63151a8: cd bf out 0x3d, r28 ; 61151aa: 9d c2 rjmp .+1338 ; 0x156e6 <BearbeiteRxDaten+0x628>case 'm':// "Write Mixerif(pRxData[0] == EEMIXER_REVISION)151ac: e0 91 f7 04 lds r30, 0x04F7151b0: f0 91 f8 04 lds r31, 0x04F8151b4: 80 81 ld r24, Z151b6: 81 30 cpi r24, 0x01 ; 1151b8: 89 f4 brne .+34 ; 0x151dc <BearbeiteRxDaten+0x11e>{memcpy(&Mixer, (unsigned char *)pRxData, sizeof(Mixer) - 1);151ba: 8d e4 ldi r24, 0x4D ; 77151bc: a7 ec ldi r26, 0xC7 ; 199151be: b5 e0 ldi r27, 0x05 ; 5151c0: 01 90 ld r0, Z+151c2: 0d 92 st X+, r0151c4: 8a 95 dec r24151c6: e1 f7 brne .-8 ; 0x151c0 <BearbeiteRxDaten+0x102>MixerTable_WriteToEEProm();151c8: 0e 94 ac 25 call 0x4b58 ; 0x4b58 <MixerTable_WriteToEEProm>tempchar1 = 1;151cc: 81 e0 ldi r24, 0x01 ; 1151ce: 89 83 std Y+1, r24 ; 0x01VersionInfo.HardwareError[1] &= ~FC_ERROR1_MIXER;151d0: e3 e6 ldi r30, 0x63 ; 99151d2: fa e0 ldi r31, 0x0A ; 10151d4: 80 81 ld r24, Z151d6: 8f 7e andi r24, 0xEF ; 239151d8: 80 83 st Z, r24151da: 01 c0 rjmp .+2 ; 0x151de <BearbeiteRxDaten+0x120>}else{tempchar1 = 0;151dc: 19 82 std Y+1, r1 ; 0x01}while(!UebertragungAbgeschlossen);151de: 80 91 b7 02 lds r24, 0x02B7151e2: 88 23 and r24, r24151e4: e1 f3 breq .-8 ; 0x151de <BearbeiteRxDaten+0x120>SendOutData('M', FC_ADDRESS, 1, &tempchar1, sizeof(tempchar1));151e6: 1f 92 push r1151e8: 21 e0 ldi r18, 0x01 ; 1151ea: 2f 93 push r18151ec: ce 01 movw r24, r28151ee: 01 96 adiw r24, 0x01 ; 1151f0: 9f 93 push r25151f2: 8f 93 push r24151f4: 2f 93 push r18151f6: 2f 93 push r18151f8: 8d e4 ldi r24, 0x4D ; 77151fa: 8f 93 push r24151fc: 24 de rcall .-952 ; 0x14e46 <SendOutData>break;151fe: 0f b6 in r0, 0x3f ; 6315200: f8 94 cli15202: de bf out 0x3e, r29 ; 6215204: 0f be out 0x3f, r0 ; 6315206: cd bf out 0x3d, r28 ; 6115208: 6e c2 rjmp .+1244 ; 0x156e6 <BearbeiteRxDaten+0x628>case 'p': // get PPM ChannelsGetPPMChannelAnforderung = 1;1520a: 81 e0 ldi r24, 0x01 ; 11520c: 80 93 fe 04 sts 0x04FE, r24PcZugriff = 255;15210: 8f ef ldi r24, 0xFF ; 25515212: 80 93 b5 02 sts 0x02B5, r24break;15216: 67 c2 rjmp .+1230 ; 0x156e6 <BearbeiteRxDaten+0x628>case 'q':// "Get"-Anforderung für Settings// Bei Get werden die vom PC einstellbaren Werte vom PC zurückgelesenif(!MotorenEin)15218: 80 91 03 04 lds r24, 0x04031521c: 81 11 cpse r24, r11521e: 44 c0 rjmp .+136 ; 0x152a8 <BearbeiteRxDaten+0x1ea>{if((10 <= pRxData[0]) && (pRxData[0] < 20))15220: e0 91 f7 04 lds r30, 0x04F715224: f0 91 f8 04 lds r31, 0x04F815228: 80 81 ld r24, Z1522a: 96 ef ldi r25, 0xF6 ; 2461522c: 98 0f add r25, r241522e: 9a 30 cpi r25, 0x0A ; 1015230: 80 f4 brcc .+32 ; 0x15252 <BearbeiteRxDaten+0x194>{tempchar1 = pRxData[0] - 10;if(tempchar1< 1) tempchar1 = 1; // limit to 115232: 91 11 cpse r25, r115234: 03 c0 rjmp .+6 ; 0x1523c <BearbeiteRxDaten+0x17e>15236: 81 e0 ldi r24, 0x01 ; 115238: 89 83 std Y+1, r24 ; 0x011523a: 06 c0 rjmp .+12 ; 0x15248 <BearbeiteRxDaten+0x18a>else if(tempchar1 > 5) tempchar1 = 5; // limit to 51523c: 96 30 cpi r25, 0x06 ; 61523e: 10 f4 brcc .+4 ; 0x15244 <BearbeiteRxDaten+0x186>// Bei Get werden die vom PC einstellbaren Werte vom PC zurückgelesenif(!MotorenEin){if((10 <= pRxData[0]) && (pRxData[0] < 20)){tempchar1 = pRxData[0] - 10;15240: 99 83 std Y+1, r25 ; 0x0115242: 02 c0 rjmp .+4 ; 0x15248 <BearbeiteRxDaten+0x18a>if(tempchar1< 1) tempchar1 = 1; // limit to 1else if(tempchar1 > 5) tempchar1 = 5; // limit to 515244: 85 e0 ldi r24, 0x05 ; 515246: 89 83 std Y+1, r24 ; 0x01SetDefaultParameter(tempchar1, 1);15248: 61 e0 ldi r22, 0x01 ; 11524a: 89 81 ldd r24, Y+1 ; 0x011524c: 0e 94 78 26 call 0x4cf0 ; 0x4cf0 <SetDefaultParameter>15250: 27 c0 rjmp .+78 ; 0x152a0 <BearbeiteRxDaten+0x1e2>}else if((20 <= pRxData[0]) && (pRxData[0] < 30))15252: 9c ee ldi r25, 0xEC ; 23615254: 98 0f add r25, r2415256: 9a 30 cpi r25, 0x0A ; 1015258: 80 f4 brcc .+32 ; 0x1527a <BearbeiteRxDaten+0x1bc>{tempchar1 = pRxData[0] - 20;if(tempchar1< 1) tempchar1 = 1; // limit to 11525a: 91 11 cpse r25, r11525c: 03 c0 rjmp .+6 ; 0x15264 <BearbeiteRxDaten+0x1a6>1525e: 81 e0 ldi r24, 0x01 ; 115260: 89 83 std Y+1, r24 ; 0x0115262: 06 c0 rjmp .+12 ; 0x15270 <BearbeiteRxDaten+0x1b2>else if(tempchar1 > 5) tempchar1 = 5; // limit to 515264: 96 30 cpi r25, 0x06 ; 615266: 10 f4 brcc .+4 ; 0x1526c <BearbeiteRxDaten+0x1ae>else if(tempchar1 > 5) tempchar1 = 5; // limit to 5SetDefaultParameter(tempchar1, 1);}else if((20 <= pRxData[0]) && (pRxData[0] < 30)){tempchar1 = pRxData[0] - 20;15268: 99 83 std Y+1, r25 ; 0x011526a: 02 c0 rjmp .+4 ; 0x15270 <BearbeiteRxDaten+0x1b2>if(tempchar1< 1) tempchar1 = 1; // limit to 1else if(tempchar1 > 5) tempchar1 = 5; // limit to 51526c: 85 e0 ldi r24, 0x05 ; 51526e: 89 83 std Y+1, r24 ; 0x01SetDefaultParameter(tempchar1, 0);15270: 60 e0 ldi r22, 0x00 ; 015272: 89 81 ldd r24, Y+1 ; 0x0115274: 0e 94 78 26 call 0x4cf0 ; 0x4cf0 <SetDefaultParameter>15278: 13 c0 rjmp .+38 ; 0x152a0 <BearbeiteRxDaten+0x1e2>}else{tempchar1 = pRxData[0];1527a: 89 83 std Y+1, r24 ; 0x01if(tempchar1 == 0xFF)1527c: 8f 3f cpi r24, 0xFF ; 2551527e: 19 f4 brne .+6 ; 0x15286 <BearbeiteRxDaten+0x1c8>{tempchar1 = GetActiveParamSet();15280: 0e 94 09 26 call 0x4c12 ; 0x4c12 <GetActiveParamSet>15284: 89 83 std Y+1, r24 ; 0x01}if(tempchar1< 1) tempchar1 = 1; // limit to 115286: 89 81 ldd r24, Y+1 ; 0x0115288: 81 11 cpse r24, r11528a: 03 c0 rjmp .+6 ; 0x15292 <BearbeiteRxDaten+0x1d4>1528c: 81 e0 ldi r24, 0x01 ; 11528e: 89 83 std Y+1, r24 ; 0x0115290: 04 c0 rjmp .+8 ; 0x1529a <BearbeiteRxDaten+0x1dc>else if(tempchar1 > 5) tempchar1 = 5; // limit to 515292: 86 30 cpi r24, 0x06 ; 615294: 10 f0 brcs .+4 ; 0x1529a <BearbeiteRxDaten+0x1dc>15296: 85 e0 ldi r24, 0x05 ; 515298: 89 83 std Y+1, r24 ; 0x01// load requested parameter setParamSet_ReadFromEEProm(tempchar1);1529a: 89 81 ldd r24, Y+1 ; 0x011529c: 0e 94 4e 25 call 0x4a9c ; 0x4a9c <ParamSet_ReadFromEEProm>}LipoDetection(0);152a0: 80 e0 ldi r24, 0x00 ; 0152a2: 0e 94 90 59 call 0xb320 ; 0xb320 <LipoDetection>152a6: 03 c0 rjmp .+6 ; 0x152ae <BearbeiteRxDaten+0x1f0>} else tempchar1 = GetActiveParamSet();152a8: 0e 94 09 26 call 0x4c12 ; 0x4c12 <GetActiveParamSet>152ac: 89 83 std Y+1, r24 ; 0x01while(!UebertragungAbgeschlossen);152ae: 80 91 b7 02 lds r24, 0x02B7152b2: 88 23 and r24, r24152b4: e1 f3 breq .-8 ; 0x152ae <BearbeiteRxDaten+0x1f0>SendOutData('Q', FC_ADDRESS, 2, &tempchar1, sizeof(tempchar1), (unsigned char *) &EE_Parameter, sizeof(EE_Parameter) - 1);152b6: 1f 92 push r1152b8: 88 e8 ldi r24, 0x88 ; 136152ba: 8f 93 push r24152bc: 8e e3 ldi r24, 0x3E ; 62152be: 95 e0 ldi r25, 0x05 ; 5152c0: 9f 93 push r25152c2: 8f 93 push r24152c4: 1f 92 push r1152c6: 21 e0 ldi r18, 0x01 ; 1152c8: 2f 93 push r18152ca: ce 01 movw r24, r28152cc: 01 96 adiw r24, 0x01 ; 1152ce: 9f 93 push r25152d0: 8f 93 push r24152d2: 82 e0 ldi r24, 0x02 ; 2152d4: 8f 93 push r24152d6: 2f 93 push r18152d8: 81 e5 ldi r24, 0x51 ; 81152da: 8f 93 push r24152dc: b4 dd rcall .-1176 ; 0x14e46 <SendOutData>Debug("Lese Setting %d", tempchar1);152de: 89 81 ldd r24, Y+1 ; 0x01152e0: 1f 92 push r1152e2: 8f 93 push r24152e4: 83 e5 ldi r24, 0x53 ; 83152e6: 96 e1 ldi r25, 0x16 ; 22152e8: 9f 93 push r25152ea: 8f 93 push r24152ec: 88 e1 ldi r24, 0x18 ; 24152ee: 93 e2 ldi r25, 0x23 ; 35152f0: 9f 93 push r25152f2: 8f 93 push r24152f4: e0 91 78 06 lds r30, 0x0678152f8: f0 91 79 06 lds r31, 0x0679152fc: 09 95 icall152fe: 80 e0 ldi r24, 0x00 ; 015300: 0e 94 2c 23 call 0x4658 ; 0x4658 <DebugSend>break;15304: 0f b6 in r0, 0x3f ; 6315306: f8 94 cli15308: de bf out 0x3e, r29 ; 621530a: 0f be out 0x3f, r0 ; 631530c: cd bf out 0x3d, r28 ; 611530e: eb c1 rjmp .+982 ; 0x156e6 <BearbeiteRxDaten+0x628>case 's': // Parametersatz speichernif((1 <= pRxData[0]) && (pRxData[0] <= 5) && (pRxData[1] == EEPARAM_REVISION) && MotorenEin == 0) // check for setting to be in range15310: 80 91 f7 04 lds r24, 0x04F715314: 90 91 f8 04 lds r25, 0x04F815318: fc 01 movw r30, r241531a: 20 81 ld r18, Z1531c: 21 50 subi r18, 0x01 ; 11531e: 25 30 cpi r18, 0x05 ; 515320: 90 f5 brcc .+100 ; 0x15386 <BearbeiteRxDaten+0x2c8>15322: 21 81 ldd r18, Z+1 ; 0x0115324: 27 36 cpi r18, 0x67 ; 10315326: 79 f5 brne .+94 ; 0x15386 <BearbeiteRxDaten+0x2c8>15328: 20 91 03 04 lds r18, 0x04031532c: 21 11 cpse r18, r11532e: 2b c0 rjmp .+86 ; 0x15386 <BearbeiteRxDaten+0x2c8>{memcpy(&EE_Parameter, (uint8_t*)&pRxData[1], sizeof(EE_Parameter) - 1);15330: 31 96 adiw r30, 0x01 ; 115332: 28 e8 ldi r18, 0x88 ; 13615334: ae e3 ldi r26, 0x3E ; 6215336: b5 e0 ldi r27, 0x05 ; 515338: 01 90 ld r0, Z+1533a: 0d 92 st X+, r01533c: 2a 95 dec r181533e: e1 f7 brne .-8 ; 0x15338 <BearbeiteRxDaten+0x27a>ParamSet_WriteToEEProm(pRxData[0]);15340: fc 01 movw r30, r2415342: 80 81 ld r24, Z15344: 0e 94 26 26 call 0x4c4c ; 0x4c4c <ParamSet_WriteToEEProm>Umschlag180Nick = (long) EE_Parameter.WinkelUmschlagNick * 2500L;15348: 20 91 7f 05 lds r18, 0x057F1534c: 30 e0 ldi r19, 0x00 ; 01534e: a4 ec ldi r26, 0xC4 ; 19615350: b9 e0 ldi r27, 0x09 ; 915352: 0e 94 b3 b1 call 0x16366 ; 0x16366 <__umulhisi3>15356: 60 93 46 01 sts 0x0146, r221535a: 70 93 47 01 sts 0x0147, r231535e: 80 93 48 01 sts 0x0148, r2415362: 90 93 49 01 sts 0x0149, r25Umschlag180Roll = (long) EE_Parameter.WinkelUmschlagRoll * 2500L;15366: 20 91 80 05 lds r18, 0x05801536a: 30 e0 ldi r19, 0x00 ; 01536c: fc d7 rcall .+4088 ; 0x16366 <__umulhisi3>1536e: 60 93 42 01 sts 0x0142, r2215372: 70 93 43 01 sts 0x0143, r2315376: 80 93 44 01 sts 0x0144, r241537a: 90 93 45 01 sts 0x0145, r25tempchar1 = GetActiveParamSet();1537e: 0e 94 09 26 call 0x4c12 ; 0x4c12 <GetActiveParamSet>15382: 89 83 std Y+1, r24 ; 0x0115384: 01 c0 rjmp .+2 ; 0x15388 <BearbeiteRxDaten+0x2ca>}else{tempchar1 = 0; // mark in response an invlid setting15386: 19 82 std Y+1, r1 ; 0x01}while(!UebertragungAbgeschlossen);15388: 80 91 b7 02 lds r24, 0x02B71538c: 88 23 and r24, r241538e: e1 f3 breq .-8 ; 0x15388 <BearbeiteRxDaten+0x2ca>SendOutData('S', FC_ADDRESS, 1, &tempchar1, sizeof(tempchar1));15390: 1f 92 push r115392: 21 e0 ldi r18, 0x01 ; 115394: 2f 93 push r1815396: ce 01 movw r24, r2815398: 01 96 adiw r24, 0x01 ; 11539a: 9f 93 push r251539c: 8f 93 push r241539e: 2f 93 push r18153a0: 2f 93 push r18153a2: 83 e5 ldi r24, 0x53 ; 83153a4: 8f 93 push r24153a6: 4f dd rcall .-1378 ; 0x14e46 <SendOutData>if(!MotorenEin)153a8: 0f b6 in r0, 0x3f ; 63153aa: f8 94 cli153ac: de bf out 0x3e, r29 ; 62153ae: 0f be out 0x3f, r0 ; 63153b0: cd bf out 0x3d, r28 ; 61153b2: 80 91 03 04 lds r24, 0x0403153b6: 81 11 cpse r24, r1153b8: 08 c0 rjmp .+16 ; 0x153ca <BearbeiteRxDaten+0x30c>{Piep(tempchar1,110);153ba: 6e e6 ldi r22, 0x6E ; 110153bc: 70 e0 ldi r23, 0x00 ; 0153be: 89 81 ldd r24, Y+1 ; 0x01153c0: 0e 94 ba 28 call 0x5174 ; 0x5174 <Piep>LipoDetection(0);153c4: 80 e0 ldi r24, 0x00 ; 0153c6: 0e 94 90 59 call 0xb320 ; 0xb320 <LipoDetection>}LIBFC_ReceiverInit(EE_Parameter.Receiver);153ca: 80 91 65 05 lds r24, 0x0565153ce: 0e 94 68 18 call 0x30d0 ; 0x30d0 <LIBFC_ReceiverInit>break;153d2: 89 c1 rjmp .+786 ; 0x156e6 <BearbeiteRxDaten+0x628>case 'f': // auf anderen Parametersatz umschaltenif(MotorenEin) break;153d4: 80 91 03 04 lds r24, 0x0403153d8: 81 11 cpse r24, r1153da: 85 c1 rjmp .+778 ; 0x156e6 <BearbeiteRxDaten+0x628>if((1 <= pRxData[0]) && (pRxData[0] <= 5)) ParamSet_ReadFromEEProm(pRxData[0]);153dc: e0 91 f7 04 lds r30, 0x04F7153e0: f0 91 f8 04 lds r31, 0x04F8153e4: 80 81 ld r24, Z153e6: 9f ef ldi r25, 0xFF ; 255153e8: 98 0f add r25, r24153ea: 95 30 cpi r25, 0x05 ; 5153ec: 10 f4 brcc .+4 ; 0x153f2 <BearbeiteRxDaten+0x334>153ee: 0e 94 4e 25 call 0x4a9c ; 0x4a9c <ParamSet_ReadFromEEProm>tempchar1 = GetActiveParamSet();153f2: 0e 94 09 26 call 0x4c12 ; 0x4c12 <GetActiveParamSet>153f6: 89 83 std Y+1, r24 ; 0x01while(!UebertragungAbgeschlossen);153f8: 80 91 b7 02 lds r24, 0x02B7153fc: 88 23 and r24, r24153fe: e1 f3 breq .-8 ; 0x153f8 <BearbeiteRxDaten+0x33a>SendOutData('F', FC_ADDRESS, 1, &tempchar1, sizeof(tempchar1));15400: 1f 92 push r115402: 21 e0 ldi r18, 0x01 ; 115404: 2f 93 push r1815406: ce 01 movw r24, r2815408: 01 96 adiw r24, 0x01 ; 11540a: 9f 93 push r251540c: 8f 93 push r241540e: 2f 93 push r1815410: 2f 93 push r1815412: 86 e4 ldi r24, 0x46 ; 7015414: 8f 93 push r2415416: 17 dd rcall .-1490 ; 0x14e46 <SendOutData>if(!MotorenEin)15418: 0f b6 in r0, 0x3f ; 631541a: f8 94 cli1541c: de bf out 0x3e, r29 ; 621541e: 0f be out 0x3f, r0 ; 6315420: cd bf out 0x3d, r28 ; 6115422: 80 91 03 04 lds r24, 0x040315426: 81 11 cpse r24, r115428: 08 c0 rjmp .+16 ; 0x1543a <BearbeiteRxDaten+0x37c>{Piep(tempchar1,110);1542a: 6e e6 ldi r22, 0x6E ; 1101542c: 70 e0 ldi r23, 0x00 ; 01542e: 89 81 ldd r24, Y+1 ; 0x0115430: 0e 94 ba 28 call 0x5174 ; 0x5174 <Piep>LipoDetection(0);15434: 80 e0 ldi r24, 0x00 ; 015436: 0e 94 90 59 call 0xb320 ; 0xb320 <LipoDetection>}LIBFC_ReceiverInit(EE_Parameter.Receiver);1543a: 80 91 65 05 lds r24, 0x05651543e: 0e 94 68 18 call 0x30d0 ; 0x30d0 <LIBFC_ReceiverInit>break;15442: 51 c1 rjmp .+674 ; 0x156e6 <BearbeiteRxDaten+0x628>case 'y':// serial Potisfor(tempchar1 = 0; tempchar1 < 12; tempchar1++) PPM_in[SERIAL_POTI_START + tempchar1] = (signed char) pRxData[tempchar1];15444: 19 82 std Y+1, r1 ; 0x0115446: 40 91 f7 04 lds r20, 0x04F71544a: e4 2f mov r30, r201544c: f0 91 f8 04 lds r31, 0x04F815450: 81 e1 ldi r24, 0x11 ; 1715452: 90 e0 ldi r25, 0x00 ; 015454: 21 91 ld r18, Z+15456: 33 27 eor r19, r1915458: 27 fd sbrc r18, 71545a: 30 95 com r191545c: dc 01 movw r26, r241545e: aa 0f add r26, r2615460: bb 1f adc r27, r2715462: af 5c subi r26, 0xCF ; 20715464: b7 4f sbci r27, 0xF7 ; 24715466: 11 96 adiw r26, 0x01 ; 115468: 3c 93 st X, r191546a: 2e 93 st -X, r181546c: 2e 2f mov r18, r301546e: 24 1b sub r18, r2015470: 29 83 std Y+1, r18 ; 0x0115472: 01 96 adiw r24, 0x01 ; 115474: 8d 31 cpi r24, 0x1D ; 2915476: 91 05 cpc r25, r115478: 69 f7 brne .-38 ; 0x15454 <BearbeiteRxDaten+0x396>1547a: 35 c1 rjmp .+618 ; 0x156e6 <BearbeiteRxDaten+0x628>break;case 'u': // request BL parameterDebug("Reading BL %d", pRxData[0]);1547c: e0 91 f7 04 lds r30, 0x04F715480: f0 91 f8 04 lds r31, 0x04F815484: 80 81 ld r24, Z15486: 1f 92 push r115488: 8f 93 push r241548a: 85 e4 ldi r24, 0x45 ; 691548c: 96 e1 ldi r25, 0x16 ; 221548e: 9f 93 push r2515490: 8f 93 push r2415492: 88 e1 ldi r24, 0x18 ; 2415494: 93 e2 ldi r25, 0x23 ; 3515496: 9f 93 push r2515498: 8f 93 push r241549a: e0 91 78 06 lds r30, 0x06781549e: f0 91 79 06 lds r31, 0x0679154a2: 09 95 icall154a4: 80 e0 ldi r24, 0x00 ; 0154a6: 0e 94 2c 23 call 0x4658 ; 0x4658 <DebugSend>// try to read BL configurationtempchar2 = I2C_ReadBLConfig(pRxData[0]);154aa: e0 91 f7 04 lds r30, 0x04F7154ae: f0 91 f8 04 lds r31, 0x04F8154b2: 80 81 ld r24, Z154b4: aa da rcall .-2732 ; 0x14a0a <I2C_ReadBLConfig>154b6: 8a 83 std Y+2, r24 ; 0x02if(tempchar2 == BLCONFIG_SUCCESS) tempchar1 = 1;154b8: 0f 90 pop r0154ba: 0f 90 pop r0154bc: 0f 90 pop r0154be: 0f 90 pop r0154c0: 0f 90 pop r0154c2: 0f 90 pop r0154c4: 81 11 cpse r24, r1154c6: 03 c0 rjmp .+6 ; 0x154ce <BearbeiteRxDaten+0x410>154c8: 81 e0 ldi r24, 0x01 ; 1154ca: 89 83 std Y+1, r24 ; 0x01154cc: 01 c0 rjmp .+2 ; 0x154d0 <BearbeiteRxDaten+0x412>else tempchar1 = 0;154ce: 19 82 std Y+1, r1 ; 0x01while(!UebertragungAbgeschlossen); // wait for previous frame to be sent154d0: 80 91 b7 02 lds r24, 0x02B7154d4: 88 23 and r24, r24154d6: e1 f3 breq .-8 ; 0x154d0 <BearbeiteRxDaten+0x412>SendOutData('U', FC_ADDRESS, 4, &tempchar1, sizeof(tempchar1), &tempchar2, sizeof(tempchar2), &pRxData[0], 1, &BLConfig, sizeof(BLConfig_t));154d8: 1f 92 push r1154da: 88 e0 ldi r24, 0x08 ; 8154dc: 8f 93 push r24154de: 8f e8 ldi r24, 0x8F ; 143154e0: 99 e0 ldi r25, 0x09 ; 9154e2: 9f 93 push r25154e4: 8f 93 push r24154e6: 1f 92 push r1154e8: 21 e0 ldi r18, 0x01 ; 1154ea: 2f 93 push r18154ec: 80 91 f8 04 lds r24, 0x04F8154f0: 8f 93 push r24154f2: 80 91 f7 04 lds r24, 0x04F7154f6: 8f 93 push r24154f8: 1f 92 push r1154fa: 2f 93 push r18154fc: ce 01 movw r24, r28154fe: 02 96 adiw r24, 0x02 ; 215500: 9f 93 push r2515502: 8f 93 push r2415504: 1f 92 push r115506: 2f 93 push r1815508: 01 97 sbiw r24, 0x01 ; 11550a: 9f 93 push r251550c: 8f 93 push r241550e: 84 e0 ldi r24, 0x04 ; 415510: 8f 93 push r2415512: 2f 93 push r1815514: 85 e5 ldi r24, 0x55 ; 8515516: 8f 93 push r2415518: 96 dc rcall .-1748 ; 0x14e46 <SendOutData>break;1551a: 0f b6 in r0, 0x3f ; 631551c: f8 94 cli1551e: de bf out 0x3e, r29 ; 6215520: 0f be out 0x3f, r0 ; 6315522: cd bf out 0x3d, r28 ; 6115524: e0 c0 rjmp .+448 ; 0x156e6 <BearbeiteRxDaten+0x628>case 'w': // write BL parameterDebug("Writing BL %d", pRxData[0]);15526: e0 91 f7 04 lds r30, 0x04F71552a: f0 91 f8 04 lds r31, 0x04F81552e: 80 81 ld r24, Z15530: 1f 92 push r115532: 8f 93 push r2415534: 87 e3 ldi r24, 0x37 ; 5515536: 96 e1 ldi r25, 0x16 ; 2215538: 9f 93 push r251553a: 8f 93 push r241553c: 88 e1 ldi r24, 0x18 ; 241553e: 93 e2 ldi r25, 0x23 ; 3515540: 9f 93 push r2515542: 8f 93 push r2415544: e0 91 78 06 lds r30, 0x067815548: f0 91 79 06 lds r31, 0x06791554c: 09 95 icall1554e: 80 e0 ldi r24, 0x00 ; 015550: 0e 94 2c 23 call 0x4658 ; 0x4658 <DebugSend>if(RxDataLen >= 1+sizeof(BLConfig_t))15554: 0f 90 pop r015556: 0f 90 pop r015558: 0f 90 pop r01555a: 0f 90 pop r01555c: 0f 90 pop r01555e: 0f 90 pop r015560: 80 91 f6 04 lds r24, 0x04F615564: 89 30 cpi r24, 0x09 ; 915566: 08 f4 brcc .+2 ; 0x1556a <BearbeiteRxDaten+0x4ac>15568: be c0 rjmp .+380 ; 0x156e6 <BearbeiteRxDaten+0x628>{memcpy(&BLConfig, (uint8_t*)(&pRxData[1]), sizeof(BLConfig_t));1556a: 80 91 f7 04 lds r24, 0x04F71556e: 90 91 f8 04 lds r25, 0x04F815572: 28 e0 ldi r18, 0x08 ; 815574: fc 01 movw r30, r2415576: 31 96 adiw r30, 0x01 ; 115578: af e8 ldi r26, 0x8F ; 1431557a: b9 e0 ldi r27, 0x09 ; 91557c: 01 90 ld r0, Z+1557e: 0d 92 st X+, r015580: 2a 95 dec r1815582: e1 f7 brne .-8 ; 0x1557c <BearbeiteRxDaten+0x4be>tempchar2 = I2C_WriteBLConfig(pRxData[0]);15584: fc 01 movw r30, r2415586: 80 81 ld r24, Z15588: 87 d9 rcall .-3314 ; 0x14898 <I2C_WriteBLConfig>1558a: 8a 83 std Y+2, r24 ; 0x02if(tempchar2 == BLCONFIG_SUCCESS) tempchar1 = 1;1558c: 81 11 cpse r24, r11558e: 03 c0 rjmp .+6 ; 0x15596 <BearbeiteRxDaten+0x4d8>15590: 81 e0 ldi r24, 0x01 ; 115592: 89 83 std Y+1, r24 ; 0x0115594: 01 c0 rjmp .+2 ; 0x15598 <BearbeiteRxDaten+0x4da>else tempchar1 = 0; // indicate error15596: 19 82 std Y+1, r1 ; 0x01while(!UebertragungAbgeschlossen); // wait for previous frame to be sent15598: 80 91 b7 02 lds r24, 0x02B71559c: 88 23 and r24, r241559e: e1 f3 breq .-8 ; 0x15598 <BearbeiteRxDaten+0x4da>SendOutData('W', FC_ADDRESS,2, &tempchar1, sizeof(tempchar1), &tempchar2, sizeof(tempchar2));155a0: 1f 92 push r1155a2: 21 e0 ldi r18, 0x01 ; 1155a4: 2f 93 push r18155a6: ce 01 movw r24, r28155a8: 02 96 adiw r24, 0x02 ; 2155aa: 9f 93 push r25155ac: 8f 93 push r24155ae: 1f 92 push r1155b0: 2f 93 push r18155b2: 01 97 sbiw r24, 0x01 ; 1155b4: 9f 93 push r25155b6: 8f 93 push r24155b8: 82 e0 ldi r24, 0x02 ; 2155ba: 8f 93 push r24155bc: 2f 93 push r18155be: 87 e5 ldi r24, 0x57 ; 87155c0: 8f 93 push r24155c2: 41 dc rcall .-1918 ; 0x14e46 <SendOutData>155c4: 0f b6 in r0, 0x3f ; 63155c6: f8 94 cli155c8: de bf out 0x3e, r29 ; 62155ca: 0f be out 0x3f, r0 ; 63155cc: cd bf out 0x3d, r28 ; 61155ce: 8b c0 rjmp .+278 ; 0x156e6 <BearbeiteRxDaten+0x628>}break;case 'j':if(MotorenEin) break;155d0: 80 91 03 04 lds r24, 0x0403155d4: 81 11 cpse r24, r1155d6: 87 c0 rjmp .+270 ; 0x156e6 <BearbeiteRxDaten+0x628>tempchar1 = LIBFC_GetCPUType();155d8: 0e 94 1f 18 call 0x303e ; 0x303e <LIBFC_GetCPUType>155dc: 89 83 std Y+1, r24 ; 0x01if((tempchar1 == CPU_ATMEGA644P) || (tempchar1 == CPU_ATMEGA1284P))155de: 82 30 cpi r24, 0x02 ; 2155e0: 19 f0 breq .+6 ; 0x155e8 <BearbeiteRxDaten+0x52a>155e2: 84 30 cpi r24, 0x04 ; 4155e4: 09 f0 breq .+2 ; 0x155e8 <BearbeiteRxDaten+0x52a>155e6: 7f c0 rjmp .+254 ; 0x156e6 <BearbeiteRxDaten+0x628>{uint16_t ubrr = (uint16_t) ((uint32_t) F_CPU/ (8 * 38400L) - 1);cli();155e8: f8 94 cli// UART0 & UART1 disable RX and TX-InterruptUCSR0B &= ~((1 << RXCIE0)|(1 << TXCIE0));155ea: a1 ec ldi r26, 0xC1 ; 193155ec: b0 e0 ldi r27, 0x00 ; 0155ee: 8c 91 ld r24, X155f0: 8f 73 andi r24, 0x3F ; 63155f2: 8c 93 st X, r24UCSR1B &= ~((1 << RXCIE1)|(1 << TXCIE1));155f4: e9 ec ldi r30, 0xC9 ; 201155f6: f0 e0 ldi r31, 0x00 ; 0155f8: 80 81 ld r24, Z155fa: 8f 73 andi r24, 0x3F ; 63155fc: 80 83 st Z, r24// UART0 & UART1 disable receiver and transmitterUCSR0B &= ~((1 << TXEN0) | (1 << RXEN0));155fe: 8c 91 ld r24, X15600: 87 7e andi r24, 0xE7 ; 23115602: 8c 93 st X, r24UCSR1B &= ~((1 << TXEN1) | (1 << RXEN1));15604: 80 81 ld r24, Z15606: 87 7e andi r24, 0xE7 ; 23115608: 80 83 st Z, r24// UART0 & UART1 flush receive buffer explicitwhile ( UCSR1A & (1<<RXC1) ) UDR1;1560a: 80 91 c8 00 lds r24, 0x00C81560e: 88 23 and r24, r2415610: 44 f4 brge .+16 ; 0x15622 <BearbeiteRxDaten+0x564>15612: ae ec ldi r26, 0xCE ; 20615614: b0 e0 ldi r27, 0x00 ; 015616: e8 ec ldi r30, 0xC8 ; 20015618: f0 e0 ldi r31, 0x00 ; 01561a: 8c 91 ld r24, X1561c: 80 81 ld r24, Z1561e: 88 23 and r24, r2415620: e4 f3 brlt .-8 ; 0x1561a <BearbeiteRxDaten+0x55c>while ( UCSR0A & (1<<RXC0) ) UDR0;15622: 80 91 c0 00 lds r24, 0x00C015626: 88 23 and r24, r2415628: 44 f4 brge .+16 ; 0x1563a <BearbeiteRxDaten+0x57c>1562a: a6 ec ldi r26, 0xC6 ; 1981562c: b0 e0 ldi r27, 0x00 ; 01562e: e0 ec ldi r30, 0xC0 ; 19215630: f0 e0 ldi r31, 0x00 ; 015632: 8c 91 ld r24, X15634: 80 81 ld r24, Z15636: 88 23 and r24, r2415638: e4 f3 brlt .-8 ; 0x15632 <BearbeiteRxDaten+0x574>if(pRxData[0] == 1) ReceiverUpdateModeActive = 2;1563a: e0 91 f7 04 lds r30, 0x04F71563e: f0 91 f8 04 lds r31, 0x04F815642: 80 81 ld r24, Z15644: 81 30 cpi r24, 0x01 ; 115646: 21 f4 brne .+8 ; 0x15650 <BearbeiteRxDaten+0x592>15648: 82 e0 ldi r24, 0x02 ; 21564a: 80 93 ec 04 sts 0x04EC, r241564e: 27 c0 rjmp .+78 ; 0x1569e <BearbeiteRxDaten+0x5e0>else{ // Jeti or HoTT update//#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))if(pRxData[0] == 100) ubrr = (uint16_t) ((uint32_t) F_CPU/ (8 * 19200L) - 1); // HoTT15650: 84 36 cpi r24, 0x64 ; 10015652: 11 f0 breq .+4 ; 0x15658 <BearbeiteRxDaten+0x59a>case 'j':if(MotorenEin) break;tempchar1 = LIBFC_GetCPUType();if((tempchar1 == CPU_ATMEGA644P) || (tempchar1 == CPU_ATMEGA1284P)){uint16_t ubrr = (uint16_t) ((uint32_t) F_CPU/ (8 * 38400L) - 1);15654: 80 e4 ldi r24, 0x40 ; 6415656: 01 c0 rjmp .+2 ; 0x1565a <BearbeiteRxDaten+0x59c>if(pRxData[0] == 1) ReceiverUpdateModeActive = 2;else{ // Jeti or HoTT update//#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))if(pRxData[0] == 100) ubrr = (uint16_t) ((uint32_t) F_CPU/ (8 * 19200L) - 1); // HoTT15658: 81 e8 ldi r24, 0x81 ; 129//#endifReceiverUpdateModeActive = 1;1565a: 91 e0 ldi r25, 0x01 ; 11565c: 90 93 ec 04 sts 0x04EC, r25// UART0 & UART1 set baudrateUBRR1H = (uint8_t)(ubrr>>8);15660: ad ec ldi r26, 0xCD ; 20515662: b0 e0 ldi r27, 0x00 ; 015664: 1c 92 st X, r1UBRR1L = (uint8_t)ubrr;15666: ec ec ldi r30, 0xCC ; 20415668: f0 e0 ldi r31, 0x00 ; 01566a: 80 83 st Z, r24UBRR0H = UBRR1H;1566c: 8c 91 ld r24, X1566e: 80 93 c5 00 sts 0x00C5, r24UBRR0L = UBRR1L;15672: 80 81 ld r24, Z15674: 80 93 c4 00 sts 0x00C4, r24// UART1 no parityUCSR1C &= ~(1 << UPM11);15678: ea ec ldi r30, 0xCA ; 2021567a: f0 e0 ldi r31, 0x00 ; 01567c: 80 81 ld r24, Z1567e: 8f 7d andi r24, 0xDF ; 22315680: 80 83 st Z, r24UCSR1C &= ~(1 << UPM10);15682: 80 81 ld r24, Z15684: 8f 7e andi r24, 0xEF ; 23915686: 80 83 st Z, r24// UART1 8-bitUCSR1B &= ~(1 << UCSZ12);15688: a9 ec ldi r26, 0xC9 ; 2011568a: b0 e0 ldi r27, 0x00 ; 01568c: 8c 91 ld r24, X1568e: 8b 7f andi r24, 0xFB ; 25115690: 8c 93 st X, r24UCSR1C |= (1 << UCSZ11);15692: 80 81 ld r24, Z15694: 84 60 ori r24, 0x04 ; 415696: 80 83 st Z, r24UCSR1C |= (1 << UCSZ10);15698: 80 81 ld r24, Z1569a: 82 60 ori r24, 0x02 ; 21569c: 80 83 st Z, r24}// UART0 & UART1 1 stop bitUCSR1C &= ~(1 << USBS1);1569e: ea ec ldi r30, 0xCA ; 202156a0: f0 e0 ldi r31, 0x00 ; 0156a2: 80 81 ld r24, Z156a4: 87 7f andi r24, 0xF7 ; 247156a6: 80 83 st Z, r24UCSR0C &= ~(1 << USBS0);156a8: e2 ec ldi r30, 0xC2 ; 194156aa: f0 e0 ldi r31, 0x00 ; 0156ac: 80 81 ld r24, Z156ae: 87 7f andi r24, 0xF7 ; 247156b0: 80 83 st Z, r24// UART1 clear 9th bitUCSR1B &= ~(1<<TXB81);156b2: e9 ec ldi r30, 0xC9 ; 201156b4: f0 e0 ldi r31, 0x00 ; 0156b6: 80 81 ld r24, Z156b8: 8e 7f andi r24, 0xFE ; 254156ba: 80 83 st Z, r24// enable receiver and transmitter for UART0 and UART1UCSR0B |= (1 << TXEN0) | (1 << RXEN0);156bc: a1 ec ldi r26, 0xC1 ; 193156be: b0 e0 ldi r27, 0x00 ; 0156c0: 8c 91 ld r24, X156c2: 88 61 ori r24, 0x18 ; 24156c4: 8c 93 st X, r24UCSR1B |= (1 << TXEN1) | (1 << RXEN1);156c6: 80 81 ld r24, Z156c8: 88 61 ori r24, 0x18 ; 24156ca: 80 83 st Z, r24// enable RX-Interrupt for UART0 and UART1UCSR0B |= (1 << RXCIE0);156cc: 8c 91 ld r24, X156ce: 80 68 ori r24, 0x80 ; 128156d0: 8c 93 st X, r24UCSR1B |= (1 << RXCIE1);156d2: 80 81 ld r24, Z156d4: 80 68 ori r24, 0x80 ; 128156d6: 80 83 st Z, r24// disable other InterruptsTIMSK0 = 0;156d8: 10 92 6e 00 sts 0x006E, r1TIMSK1 = 0;156dc: 10 92 6f 00 sts 0x006F, r1TIMSK2 = 0;156e0: 10 92 70 00 sts 0x0070, r1sei();156e4: 78 94 sei} // case FC_ADDRESS:default: // any Slave Addressswitch(RxdBuffer[2])156e6: 80 91 8e 0a lds r24, 0x0A8E156ea: 90 e0 ldi r25, 0x00 ; 0156ec: fc 01 movw r30, r24156ee: eb 54 subi r30, 0x4B ; 75156f0: f1 09 sbc r31, r1156f2: ec 32 cpi r30, 0x2C ; 44156f4: f1 05 cpc r31, r1156f6: 08 f0 brcs .+2 ; 0x156fa <BearbeiteRxDaten+0x63c>156f8: 2d c1 rjmp .+602 ; 0x15954 <BearbeiteRxDaten+0x896>156fa: ea 51 subi r30, 0x1A ; 26156fc: ff 4f sbci r31, 0xFF ; 255156fe: 27 c6 rjmp .+3150 ; 0x1634e <__tablejump2__>//DebugOut.Analog[18] = tempchar1;break;#endif// 't' comand placed here only for compatibility to BLcase 't':// Motortestif(AnzahlEmpfangsBytes >= sizeof(MotorTest)) memcpy(&MotorTest[0], (unsigned char *)pRxData, sizeof(MotorTest));15700: 80 91 f9 04 lds r24, 0x04F915704: 80 31 cpi r24, 0x10 ; 1615706: 60 f0 brcs .+24 ; 0x15720 <BearbeiteRxDaten+0x662>15708: e0 91 f7 04 lds r30, 0x04F71570c: f0 91 f8 04 lds r31, 0x04F815710: 80 e1 ldi r24, 0x10 ; 1615712: a7 e6 ldi r26, 0x67 ; 10315714: ba e0 ldi r27, 0x0A ; 1015716: 01 90 ld r0, Z+15718: 0d 92 st X+, r01571a: 8a 95 dec r241571c: e1 f7 brne .-8 ; 0x15716 <BearbeiteRxDaten+0x658>1571e: 10 c0 rjmp .+32 ; 0x15740 <BearbeiteRxDaten+0x682>else memcpy(&MotorTest[0], (unsigned char *)pRxData, 4);15720: e0 91 f7 04 lds r30, 0x04F715724: f0 91 f8 04 lds r31, 0x04F815728: 80 81 ld r24, Z1572a: 91 81 ldd r25, Z+1 ; 0x011572c: a2 81 ldd r26, Z+2 ; 0x021572e: b3 81 ldd r27, Z+3 ; 0x0315730: 80 93 67 0a sts 0x0A67, r2415734: 90 93 68 0a sts 0x0A68, r2515738: a0 93 69 0a sts 0x0A69, r261573c: b0 93 6a 0a sts 0x0A6A, r27while(!UebertragungAbgeschlossen);15740: 80 91 b7 02 lds r24, 0x02B715744: 88 23 and r24, r2415746: e1 f3 breq .-8 ; 0x15740 <BearbeiteRxDaten+0x682>SendOutData('T', MeineSlaveAdresse, 0);15748: 1f 92 push r11574a: 80 91 b4 02 lds r24, 0x02B41574e: 8f 93 push r2415750: 84 e5 ldi r24, 0x54 ; 8415752: 8f 93 push r2415754: 78 db rcall .-2320 ; 0x14e46 <SendOutData>PC_MotortestActive = 250;15756: 8a ef ldi r24, 0xFA ; 25015758: 80 93 f5 04 sts 0x04F5, r24PcZugriff = 255;1575c: 8f ef ldi r24, 0xFF ; 2551575e: 80 93 b5 02 sts 0x02B5, r24AboTimeOut = SetDelay(ABO_TIMEOUT);15762: 80 ea ldi r24, 0xA0 ; 16015764: 9f e0 ldi r25, 0x0F ; 1515766: 0e 94 5a 9c call 0x138b4 ; 0x138b4 <SetDelay>1576a: 90 93 ee 04 sts 0x04EE, r251576e: 80 93 ed 04 sts 0x04ED, r24break;15772: 0f 90 pop r015774: 0f 90 pop r015776: 0f 90 pop r015778: ed c0 rjmp .+474 ; 0x15954 <BearbeiteRxDaten+0x896>// 'K' comand placed here only for compatibility to old MK3MAG software, that does not send the right Slave Addresscase 'K':// Kompasswertmemcpy((unsigned char *)&KompassValue , (unsigned char *)pRxData, sizeof(KompassValue));1577a: e0 91 f7 04 lds r30, 0x04F71577e: f0 91 f8 04 lds r31, 0x04F815782: 80 81 ld r24, Z15784: 91 81 ldd r25, Z+1 ; 0x0115786: 90 93 4f 01 sts 0x014F, r251578a: 80 93 4e 01 sts 0x014E, r24// KompassRichtung = ((540 + KompassValue - KompassSollWert) % 360) - 180;break;1578e: e2 c0 rjmp .+452 ; 0x15954 <BearbeiteRxDaten+0x896>case 'a':// Texte der AnalogwerteDebugTextAnforderung = pRxData[0];15790: e0 91 f7 04 lds r30, 0x04F715794: f0 91 f8 04 lds r31, 0x04F815798: 80 81 ld r24, Zif (DebugTextAnforderung > 31) DebugTextAnforderung = 31;1579a: 80 32 cpi r24, 0x20 ; 321579c: 18 f4 brcc .+6 ; 0x157a4 <BearbeiteRxDaten+0x6e6>case 'K':// Kompasswertmemcpy((unsigned char *)&KompassValue , (unsigned char *)pRxData, sizeof(KompassValue));// KompassRichtung = ((540 + KompassValue - KompassSollWert) % 360) - 180;break;case 'a':// Texte der AnalogwerteDebugTextAnforderung = pRxData[0];1579e: 80 93 b6 02 sts 0x02B6, r24157a2: 03 c0 rjmp .+6 ; 0x157aa <BearbeiteRxDaten+0x6ec>if (DebugTextAnforderung > 31) DebugTextAnforderung = 31;157a4: 8f e1 ldi r24, 0x1F ; 31157a6: 80 93 b6 02 sts 0x02B6, r24PcZugriff = 255;157aa: 8f ef ldi r24, 0xFF ; 255157ac: 80 93 b5 02 sts 0x02B5, r24break;157b0: d1 c0 rjmp .+418 ; 0x15954 <BearbeiteRxDaten+0x896>case 'b':memcpy((unsigned char *)&ExternControl, (unsigned char *)pRxData, sizeof(ExternControl));157b2: e0 91 f7 04 lds r30, 0x04F7157b6: f0 91 f8 04 lds r31, 0x04F8157ba: 8b e0 ldi r24, 0x0B ; 11157bc: af e7 ldi r26, 0x7F ; 127157be: ba e0 ldi r27, 0x0A ; 10157c0: 01 90 ld r0, Z+157c2: 0d 92 st X+, r0157c4: 8a 95 dec r24157c6: e1 f7 brne .-8 ; 0x157c0 <BearbeiteRxDaten+0x702>ConfirmFrame = ExternControl.Frame;157c8: 80 91 88 0a lds r24, 0x0A88157cc: 80 93 88 0c sts 0x0C88, r24PcZugriff = 255;157d0: 8f ef ldi r24, 0xFF ; 255157d2: 80 93 b5 02 sts 0x02B5, r24break;157d6: be c0 rjmp .+380 ; 0x15954 <BearbeiteRxDaten+0x896>case 'c': // Poll the 3D-Dataif(!Intervall3D) { if(pRxData[0]) Timer3D = SetDelay(pRxData[0] * 10);}157d8: 80 91 f1 04 lds r24, 0x04F1157dc: 90 91 f2 04 lds r25, 0x04F2157e0: 89 2b or r24, r25157e2: c9 f4 brne .+50 ; 0x15816 <BearbeiteRxDaten+0x758>157e4: e0 91 f7 04 lds r30, 0x04F7157e8: f0 91 f8 04 lds r31, 0x04F8157ec: 20 81 ld r18, Z157ee: 22 23 and r18, r18157f0: 91 f0 breq .+36 ; 0x15816 <BearbeiteRxDaten+0x758>157f2: 30 e0 ldi r19, 0x00 ; 0157f4: c9 01 movw r24, r18157f6: 88 0f add r24, r24157f8: 99 1f adc r25, r25157fa: 22 0f add r18, r18157fc: 33 1f adc r19, r19157fe: 22 0f add r18, r1815800: 33 1f adc r19, r1915802: 22 0f add r18, r1815804: 33 1f adc r19, r1915806: 82 0f add r24, r1815808: 93 1f adc r25, r191580a: 0e 94 5a 9c call 0x138b4 ; 0x138b4 <SetDelay>1580e: 90 93 5a 0a sts 0x0A5A, r2515812: 80 93 59 0a sts 0x0A59, r24Intervall3D = pRxData[0] * 10;15816: e0 91 f7 04 lds r30, 0x04F71581a: f0 91 f8 04 lds r31, 0x04F81581e: 80 81 ld r24, Z15820: 90 e0 ldi r25, 0x00 ; 015822: 9c 01 movw r18, r2415824: 22 0f add r18, r1815826: 33 1f adc r19, r1915828: 88 0f add r24, r241582a: 99 1f adc r25, r251582c: 88 0f add r24, r241582e: 99 1f adc r25, r2515830: 88 0f add r24, r2415832: 99 1f adc r25, r2515834: 82 0f add r24, r1815836: 93 1f adc r25, r1915838: 90 93 f2 04 sts 0x04F2, r251583c: 80 93 f1 04 sts 0x04F1, r24AboTimeOut = SetDelay(ABO_TIMEOUT);15840: 80 ea ldi r24, 0xA0 ; 16015842: 9f e0 ldi r25, 0x0F ; 1515844: 0e 94 5a 9c call 0x138b4 ; 0x138b4 <SetDelay>15848: 90 93 ee 04 sts 0x04EE, r251584c: 80 93 ed 04 sts 0x04ED, r24break;15850: 81 c0 rjmp .+258 ; 0x15954 <BearbeiteRxDaten+0x896>case 'd': // Poll the debug dataPcZugriff = 255;15852: 8f ef ldi r24, 0xFF ; 25515854: 80 93 b5 02 sts 0x02B5, r24DebugDataIntervall = (unsigned int)pRxData[0] * 10;15858: e0 91 f7 04 lds r30, 0x04F71585c: f0 91 f8 04 lds r31, 0x04F815860: 20 81 ld r18, Z15862: 30 e0 ldi r19, 0x00 ; 015864: c9 01 movw r24, r1815866: 88 0f add r24, r2415868: 99 1f adc r25, r251586a: 22 0f add r18, r181586c: 33 1f adc r19, r191586e: 22 0f add r18, r1815870: 33 1f adc r19, r1915872: 22 0f add r18, r1815874: 33 1f adc r19, r1915876: 82 0f add r24, r1815878: 93 1f adc r25, r191587a: 90 93 f4 04 sts 0x04F4, r251587e: 80 93 f3 04 sts 0x04F3, r24if(DebugDataIntervall > 0) DebugDataAnforderung = 1;15882: 89 2b or r24, r2515884: 19 f0 breq .+6 ; 0x1588c <BearbeiteRxDaten+0x7ce>15886: 81 e0 ldi r24, 0x01 ; 115888: 80 93 00 05 sts 0x0500, r24AboTimeOut = SetDelay(ABO_TIMEOUT);1588c: 80 ea ldi r24, 0xA0 ; 1601588e: 9f e0 ldi r25, 0x0F ; 1515890: 0e 94 5a 9c call 0x138b4 ; 0x138b4 <SetDelay>15894: 90 93 ee 04 sts 0x04EE, r2515898: 80 93 ed 04 sts 0x04ED, r24break;1589c: 5b c0 rjmp .+182 ; 0x15954 <BearbeiteRxDaten+0x896>case 'h':// x-1 DisplayzeilenPcZugriff = 255;1589e: 8f ef ldi r24, 0xFF ; 255158a0: 80 93 b5 02 sts 0x02B5, r24if((pRxData[0] & 0x80) == 0x00) // old format158a4: e0 91 f7 04 lds r30, 0x04F7158a8: f0 91 f8 04 lds r31, 0x04F8158ac: 80 81 ld r24, Z158ae: 88 23 and r24, r24158b0: 44 f0 brlt .+16 ; 0x158c2 <BearbeiteRxDaten+0x804>{DisplayLine = 2;158b2: 82 e0 ldi r24, 0x02 ; 2158b4: 80 93 fd 04 sts 0x04FD, r24Display_Interval = 0;158b8: 10 92 f0 04 sts 0x04F0, r1158bc: 10 92 ef 04 sts 0x04EF, r1158c0: 22 c0 rjmp .+68 ; 0x15906 <BearbeiteRxDaten+0x848>}else // new format{RemoteKeys |= ~pRxData[0];158c2: 80 95 com r24158c4: 90 91 a2 04 lds r25, 0x04A2158c8: 89 2b or r24, r25158ca: 80 93 a2 04 sts 0x04A2, r24Display_Interval = (unsigned int)pRxData[1] * 10;158ce: 81 81 ldd r24, Z+1 ; 0x01158d0: 90 e0 ldi r25, 0x00 ; 0158d2: 9c 01 movw r18, r24158d4: 22 0f add r18, r18158d6: 33 1f adc r19, r19158d8: 88 0f add r24, r24158da: 99 1f adc r25, r25158dc: 88 0f add r24, r24158de: 99 1f adc r25, r25158e0: 88 0f add r24, r24158e2: 99 1f adc r25, r25158e4: 82 0f add r24, r18158e6: 93 1f adc r25, r19158e8: 90 93 f0 04 sts 0x04F0, r25158ec: 80 93 ef 04 sts 0x04EF, r24DisplayLine = 4;158f0: 84 e0 ldi r24, 0x04 ; 4158f2: 80 93 fd 04 sts 0x04FD, r24AboTimeOut = SetDelay(ABO_TIMEOUT);158f6: 80 ea ldi r24, 0xA0 ; 160158f8: 9f e0 ldi r25, 0x0F ; 15158fa: 0e 94 5a 9c call 0x138b4 ; 0x138b4 <SetDelay>158fe: 90 93 ee 04 sts 0x04EE, r2515902: 80 93 ed 04 sts 0x04ED, r24}DebugDisplayAnforderung = 1;15906: 81 e0 ldi r24, 0x01 ; 115908: 80 93 01 05 sts 0x0501, r24break;1590c: 23 c0 rjmp .+70 ; 0x15954 <BearbeiteRxDaten+0x896>case 'l':// x-1 DisplayzeilenPcZugriff = 255;1590e: 8f ef ldi r24, 0xFF ; 25515910: 80 93 b5 02 sts 0x02B5, r24MenuePunkt = pRxData[0];15914: e0 91 f7 04 lds r30, 0x04F715918: f0 91 f8 04 lds r31, 0x04F81591c: 80 81 ld r24, Z1591e: 80 93 a3 04 sts 0x04A3, r24DebugDisplayAnforderung1 = 1;15922: 81 e0 ldi r24, 0x01 ; 115924: 80 93 02 05 sts 0x0502, r24break;15928: 15 c0 rjmp .+42 ; 0x15954 <BearbeiteRxDaten+0x896>case 'v': // Version-Anforderung und Ausbaustufe#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))if(RxDataLen > 0 && pRxData[0] == 2) GetVersionAnforderung = 2;1592a: 80 91 f6 04 lds r24, 0x04F61592e: 88 23 and r24, r2415930: 51 f0 breq .+20 ; 0x15946 <BearbeiteRxDaten+0x888>15932: e0 91 f7 04 lds r30, 0x04F715936: f0 91 f8 04 lds r31, 0x04F81593a: 80 81 ld r24, Z1593c: 82 30 cpi r24, 0x02 ; 21593e: 19 f4 brne .+6 ; 0x15946 <BearbeiteRxDaten+0x888>15940: 80 93 ff 04 sts 0x04FF, r2415944: 07 c0 rjmp .+14 ; 0x15954 <BearbeiteRxDaten+0x896>else#endifGetVersionAnforderung = 1;15946: 81 e0 ldi r24, 0x01 ; 115948: 80 93 ff 04 sts 0x04FF, r241594c: 03 c0 rjmp .+6 ; 0x15954 <BearbeiteRxDaten+0x896>break;case 'g'://GetExternalControl = 1;1594e: 81 e0 ldi r24, 0x01 ; 115950: 80 93 03 05 sts 0x0503, r24//unsupported command receivedbreak;}break; // default:}NeuerDatensatzEmpfangen = 0;15954: 10 92 fb 04 sts 0x04FB, r1pRxData = 0;15958: 10 92 f8 04 sts 0x04F8, r11595c: 10 92 f7 04 sts 0x04F7, r1RxDataLen = 0;15960: 10 92 f6 04 sts 0x04F6, r1}15964: 0f 90 pop r015966: 0f 90 pop r015968: df 91 pop r291596a: cf 91 pop r281596c: 08 95 ret0001596e <uart_putchar>://Routine für die Serielle Ausgabevoid uart_putchar (char c)//############################################################################{//Warten solange bis Zeichen gesendet wurdeloop_until_bit_is_set(UCSR0A, UDRE0);1596e: e0 ec ldi r30, 0xC0 ; 19215970: f0 e0 ldi r31, 0x00 ; 015972: 90 81 ld r25, Z15974: 95 ff sbrs r25, 515976: fd cf rjmp .-6 ; 0x15972 <uart_putchar+0x4>//Ausgabe des ZeichensUDR0 = c;15978: 80 93 c6 00 sts 0x00C6, r241597c: 08 95 ret0001597e <UART_Init>://############################################################################{unsigned int ubrr = (unsigned int) ((unsigned long) F_CPU/(8 * USART0_BAUD) - 1);//Enable TXEN im Register UCR TX-Data Enable & RX EnableUCSR0B = (1 << TXEN0) | (1 << RXEN0);1597e: e1 ec ldi r30, 0xC1 ; 19315980: f0 e0 ldi r31, 0x00 ; 015982: 88 e1 ldi r24, 0x18 ; 2415984: 80 83 st Z, r24// UART Double Speed (U2X)UCSR0A |= (1 << U2X0);15986: a0 ec ldi r26, 0xC0 ; 19215988: b0 e0 ldi r27, 0x00 ; 01598a: 8c 91 ld r24, X1598c: 82 60 ori r24, 0x02 ; 21598e: 8c 93 st X, r24// RX-Interrupt FreigabeUCSR0B |= (1 << RXCIE0);15990: 80 81 ld r24, Z15992: 80 68 ori r24, 0x80 ; 12815994: 80 83 st Z, r24// TX-Interrupt FreigabeUCSR0B |= (1 << TXCIE0);15996: 80 81 ld r24, Z15998: 80 64 ori r24, 0x40 ; 641599a: 80 83 st Z, r24// USART0 Baud Rate Register// set clock dividerUBRR0H = (uint8_t)(ubrr >> 8);1599c: 10 92 c5 00 sts 0x00C5, r1UBRR0L = (uint8_t)ubrr;159a0: 8a e2 ldi r24, 0x2A ; 42159a2: 80 93 c4 00 sts 0x00C4, r24Debug_Timer = SetDelay(DebugDataIntervall);159a6: 80 91 f3 04 lds r24, 0x04F3159aa: 90 91 f4 04 lds r25, 0x04F4159ae: 0e 94 5a 9c call 0x138b4 ; 0x138b4 <SetDelay>159b2: 90 93 5c 0a sts 0x0A5C, r25159b6: 80 93 5b 0a sts 0x0A5B, r24Kompass_Timer = SetDelay(220);159ba: 8c ed ldi r24, 0xDC ; 220159bc: 90 e0 ldi r25, 0x00 ; 0159be: 0e 94 5a 9c call 0x138b4 ; 0x138b4 <SetDelay>159c2: 90 93 8b 0a sts 0x0A8B, r25159c6: 80 93 8a 0a sts 0x0A8A, r24VersionInfo.SWMajor = VERSION_MAJOR;159ca: 82 e0 ldi r24, 0x02 ; 2159cc: 80 93 5d 0a sts 0x0A5D, r24VersionInfo.SWMinor = VERSION_MINOR;159d0: 88 e0 ldi r24, 0x08 ; 8159d2: 80 93 5e 0a sts 0x0A5E, r24VersionInfo.SWPatch = VERSION_PATCH;159d6: 10 92 61 0a sts 0x0A61, r1VersionInfo.ProtoMajor = VERSION_SERIAL_MAJOR;159da: 8b e0 ldi r24, 0x0B ; 11159dc: 80 93 5f 0a sts 0x0A5F, r24VersionInfo.reserved1 = 0;159e0: 10 92 60 0a sts 0x0A60, r1VersionInfo.BL_Firmware = 255;159e4: 8f ef ldi r24, 0xFF ; 255159e6: 80 93 65 0a sts 0x0A65, r24VersionInfo.HWMajor = PlatinenVersion;159ea: 80 91 54 01 lds r24, 0x0154159ee: 80 93 64 0a sts 0x0A64, r24pRxData = 0;159f2: 10 92 f8 04 sts 0x04F8, r1159f6: 10 92 f7 04 sts 0x04F7, r1RxDataLen = 0;159fa: 10 92 f6 04 sts 0x04F6, r1159fe: 08 95 ret00015a00 <DatenUebertragung>:}//---------------------------------------------------------------------------------------------void DatenUebertragung(void){15a00: cf 92 push r1215a02: df 92 push r1315a04: ef 92 push r1415a06: ff 92 push r1515a08: 0f 93 push r1615a0a: 1f 93 push r1715a0c: cf 93 push r2815a0e: df 93 push r2915a10: cd b7 in r28, 0x3d ; 6115a12: de b7 in r29, 0x3e ; 6215a14: 60 97 sbiw r28, 0x10 ; 1615a16: 0f b6 in r0, 0x3f ; 6315a18: f8 94 cli15a1a: de bf out 0x3e, r29 ; 6215a1c: 0f be out 0x3f, r0 ; 6315a1e: cd bf out 0x3d, r28 ; 61if(!UebertragungAbgeschlossen) return;15a20: 80 91 b7 02 lds r24, 0x02B715a24: 88 23 and r24, r2415a26: 09 f4 brne .+2 ; 0x15a2a <DatenUebertragung+0x2a>15a28: e2 c2 rjmp .+1476 ; 0x15fee <DatenUebertragung+0x5ee>if(CheckDelay(AboTimeOut))15a2a: 80 91 ed 04 lds r24, 0x04ED15a2e: 90 91 ee 04 lds r25, 0x04EE15a32: 0e 94 63 9c call 0x138c6 ; 0x138c6 <CheckDelay>15a36: 88 23 and r24, r2415a38: 61 f0 breq .+24 ; 0x15a52 <DatenUebertragung+0x52>{Display_Interval = 0;15a3a: 10 92 f0 04 sts 0x04F0, r115a3e: 10 92 ef 04 sts 0x04EF, r1DebugDataIntervall = 0;15a42: 10 92 f4 04 sts 0x04F4, r115a46: 10 92 f3 04 sts 0x04F3, r1Intervall3D = 0;15a4a: 10 92 f2 04 sts 0x04F2, r115a4e: 10 92 f1 04 sts 0x04F1, r1}if(((Display_Interval>0 && CheckDelay(Display_Timer)) || DebugDisplayAnforderung) && UebertragungAbgeschlossen)15a52: 80 91 ef 04 lds r24, 0x04EF15a56: 90 91 f0 04 lds r25, 0x04F015a5a: 89 2b or r24, r2515a5c: 41 f0 breq .+16 ; 0x15a6e <DatenUebertragung+0x6e>15a5e: 80 91 68 0b lds r24, 0x0B6815a62: 90 91 69 0b lds r25, 0x0B6915a66: 0e 94 63 9c call 0x138c6 ; 0x138c6 <CheckDelay>15a6a: 81 11 cpse r24, r115a6c: 05 c0 rjmp .+10 ; 0x15a78 <DatenUebertragung+0x78>15a6e: 80 91 01 05 lds r24, 0x050115a72: 88 23 and r24, r2415a74: 09 f4 brne .+2 ; 0x15a78 <DatenUebertragung+0x78>15a76: 5c c0 rjmp .+184 ; 0x15b30 <DatenUebertragung+0x130>15a78: 80 91 b7 02 lds r24, 0x02B715a7c: 88 23 and r24, r2415a7e: 09 f4 brne .+2 ; 0x15a82 <DatenUebertragung+0x82>15a80: 57 c0 rjmp .+174 ; 0x15b30 <DatenUebertragung+0x130>{if(DisplayLine > 3)// new format15a82: 80 91 fd 04 lds r24, 0x04FD15a86: 84 30 cpi r24, 0x04 ; 415a88: a8 f0 brcs .+42 ; 0x15ab4 <DatenUebertragung+0xb4>{Menu();15a8a: 0e 94 27 87 call 0x10e4e ; 0x10e4e <Menu>SendOutData('H', FC_ADDRESS, 1, (uint8_t *)DisplayBuff, 80);15a8e: 1f 92 push r115a90: 80 e5 ldi r24, 0x50 ; 8015a92: 8f 93 push r2415a94: 80 ee ldi r24, 0xE0 ; 22415a96: 97 e0 ldi r25, 0x07 ; 715a98: 9f 93 push r2515a9a: 8f 93 push r2415a9c: 81 e0 ldi r24, 0x01 ; 115a9e: 8f 93 push r2415aa0: 8f 93 push r2415aa2: 88 e4 ldi r24, 0x48 ; 7215aa4: 8f 93 push r2415aa6: cf d9 rcall .-3170 ; 0x14e46 <SendOutData>15aa8: 0f b6 in r0, 0x3f ; 6315aaa: f8 94 cli15aac: de bf out 0x3e, r29 ; 6215aae: 0f be out 0x3f, r0 ; 6315ab0: cd bf out 0x3d, r28 ; 6115ab2: 32 c0 rjmp .+100 ; 0x15b18 <DatenUebertragung+0x118>}else // old format{LCD_printfxy(0,0,"!!! INCOMPATIBLE !!!");15ab4: 10 92 a4 04 sts 0x04A4, r115ab8: 82 e2 ldi r24, 0x22 ; 3415aba: 96 e1 ldi r25, 0x16 ; 2215abc: 9f 93 push r2515abe: 8f 93 push r2415ac0: 80 e1 ldi r24, 0x10 ; 1615ac2: 97 e8 ldi r25, 0x87 ; 13515ac4: 9f 93 push r2515ac6: 8f 93 push r2415ac8: e0 91 78 06 lds r30, 0x067815acc: f0 91 79 06 lds r31, 0x067915ad0: 09 95 icallSendOutData('H', FC_ADDRESS, 2, &DisplayLine, sizeof(DisplayLine), (uint8_t *)DisplayBuff, 20);15ad2: 1f 92 push r115ad4: 84 e1 ldi r24, 0x14 ; 2015ad6: 8f 93 push r2415ad8: 80 ee ldi r24, 0xE0 ; 22415ada: 97 e0 ldi r25, 0x07 ; 715adc: 9f 93 push r2515ade: 8f 93 push r2415ae0: 1f 92 push r115ae2: 21 e0 ldi r18, 0x01 ; 115ae4: 2f 93 push r1815ae6: 8d ef ldi r24, 0xFD ; 25315ae8: 94 e0 ldi r25, 0x04 ; 415aea: 9f 93 push r2515aec: 8f 93 push r2415aee: 82 e0 ldi r24, 0x02 ; 215af0: 8f 93 push r2415af2: 2f 93 push r1815af4: 88 e4 ldi r24, 0x48 ; 7215af6: 8f 93 push r2415af8: a6 d9 rcall .-3252 ; 0x14e46 <SendOutData>if(DisplayLine++ > 3) DisplayLine = 0;15afa: 80 91 fd 04 lds r24, 0x04FD15afe: 0f b6 in r0, 0x3f ; 6315b00: f8 94 cli15b02: de bf out 0x3e, r29 ; 6215b04: 0f be out 0x3f, r0 ; 6315b06: cd bf out 0x3d, r28 ; 6115b08: 84 30 cpi r24, 0x04 ; 415b0a: 20 f4 brcc .+8 ; 0x15b14 <DatenUebertragung+0x114>15b0c: 8f 5f subi r24, 0xFF ; 25515b0e: 80 93 fd 04 sts 0x04FD, r2415b12: 02 c0 rjmp .+4 ; 0x15b18 <DatenUebertragung+0x118>15b14: 10 92 fd 04 sts 0x04FD, r1}Display_Timer = SetDelay(Display_Interval);15b18: 80 91 ef 04 lds r24, 0x04EF15b1c: 90 91 f0 04 lds r25, 0x04F015b20: 0e 94 5a 9c call 0x138b4 ; 0x138b4 <SetDelay>15b24: 90 93 69 0b sts 0x0B69, r2515b28: 80 93 68 0b sts 0x0B68, r24DebugDisplayAnforderung = 0;15b2c: 10 92 01 05 sts 0x0501, r1}if(DebugDisplayAnforderung1 && UebertragungAbgeschlossen)15b30: 80 91 02 05 lds r24, 0x050215b34: 88 23 and r24, r2415b36: 39 f1 breq .+78 ; 0x15b86 <DatenUebertragung+0x186>15b38: 80 91 b7 02 lds r24, 0x02B715b3c: 88 23 and r24, r2415b3e: 19 f1 breq .+70 ; 0x15b86 <DatenUebertragung+0x186>{Menu();15b40: 0e 94 27 87 call 0x10e4e ; 0x10e4e <Menu>SendOutData('L', FC_ADDRESS, 3, &MenuePunkt, sizeof(MenuePunkt), &MaxMenue, sizeof(MaxMenue), DisplayBuff, sizeof(DisplayBuff));15b44: 1f 92 push r115b46: 80 e5 ldi r24, 0x50 ; 8015b48: 8f 93 push r2415b4a: 80 ee ldi r24, 0xE0 ; 22415b4c: 97 e0 ldi r25, 0x07 ; 715b4e: 9f 93 push r2515b50: 8f 93 push r2415b52: 1f 92 push r115b54: 21 e0 ldi r18, 0x01 ; 115b56: 2f 93 push r1815b58: 80 e9 ldi r24, 0x90 ; 14415b5a: 92 e0 ldi r25, 0x02 ; 215b5c: 9f 93 push r2515b5e: 8f 93 push r2415b60: 1f 92 push r115b62: 2f 93 push r1815b64: 83 ea ldi r24, 0xA3 ; 16315b66: 94 e0 ldi r25, 0x04 ; 415b68: 9f 93 push r2515b6a: 8f 93 push r2415b6c: 83 e0 ldi r24, 0x03 ; 315b6e: 8f 93 push r2415b70: 2f 93 push r1815b72: 8c e4 ldi r24, 0x4C ; 7615b74: 8f 93 push r2415b76: 67 d9 rcall .-3378 ; 0x14e46 <SendOutData>DebugDisplayAnforderung1 = 0;15b78: 10 92 02 05 sts 0x0502, r115b7c: 0f b6 in r0, 0x3f ; 6315b7e: f8 94 cli15b80: de bf out 0x3e, r29 ; 6215b82: 0f be out 0x3f, r0 ; 6315b84: cd bf out 0x3d, r28 ; 61}if(GetVersionAnforderung && UebertragungAbgeschlossen)15b86: 80 91 ff 04 lds r24, 0x04FF15b8a: 88 23 and r24, r2415b8c: 09 f4 brne .+2 ; 0x15b90 <DatenUebertragung+0x190>15b8e: 5b c0 rjmp .+182 ; 0x15c46 <DatenUebertragung+0x246>15b90: 90 91 b7 02 lds r25, 0x02B715b94: 99 23 and r25, r2515b96: 09 f4 brne .+2 ; 0x15b9a <DatenUebertragung+0x19a>15b98: 56 c0 rjmp .+172 ; 0x15c46 <DatenUebertragung+0x246>{#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))if(GetVersionAnforderung == 2) // poll version of NC15b9a: 82 30 cpi r24, 0x02 ; 215b9c: 61 f5 brne .+88 ; 0x15bf6 <DatenUebertragung+0x1f6>{struct str_VersionInfo nc;nc.SWMajor = NC_Version.Major;15b9e: 80 91 e1 08 lds r24, 0x08E115ba2: 89 83 std Y+1, r24 ; 0x01nc.SWMinor = NC_Version.Minor;15ba4: 80 91 e2 08 lds r24, 0x08E215ba8: 8a 83 std Y+2, r24 ; 0x02nc.SWPatch = NC_Version.Patch;15baa: 80 91 e3 08 lds r24, 0x08E315bae: 8d 83 std Y+5, r24 ; 0x05nc.HWMajor = NC_Version.Hardware;15bb0: 80 91 e5 08 lds r24, 0x08E515bb4: 88 87 std Y+8, r24 ; 0x08nc.HardwareError[0] = 0xff;15bb6: 8f ef ldi r24, 0xFF ; 25515bb8: 8e 83 std Y+6, r24 ; 0x06nc.HardwareError[1] = 0xff;15bba: 8f 83 std Y+7, r24 ; 0x07nc.ProtoMajor = VersionInfo.ProtoMajor;15bbc: 80 91 5f 0a lds r24, 0x0A5F15bc0: 8b 83 std Y+3, r24 ; 0x03nc.BL_Firmware = VersionInfo.BL_Firmware;15bc2: 80 91 65 0a lds r24, 0x0A6515bc6: 89 87 std Y+9, r24 ; 0x09nc.Flags = VersionInfo.Flags;15bc8: 80 91 66 0a lds r24, 0x0A6615bcc: 8a 87 std Y+10, r24 ; 0x0anc.reserved1 = 0;15bce: 1c 82 std Y+4, r1 ; 0x04SendOutData('V', FC_ADDRESS, 1, (unsigned char *) &nc, sizeof(nc));15bd0: 1f 92 push r115bd2: 8a e0 ldi r24, 0x0A ; 1015bd4: 8f 93 push r2415bd6: ce 01 movw r24, r2815bd8: 01 96 adiw r24, 0x01 ; 115bda: 9f 93 push r2515bdc: 8f 93 push r2415bde: 81 e0 ldi r24, 0x01 ; 115be0: 8f 93 push r2415be2: 8f 93 push r2415be4: 86 e5 ldi r24, 0x56 ; 8615be6: 8f 93 push r2415be8: 2e d9 rcall .-3492 ; 0x14e46 <SendOutData>15bea: 0f b6 in r0, 0x3f ; 6315bec: f8 94 cli15bee: de bf out 0x3e, r29 ; 6215bf0: 0f be out 0x3f, r0 ; 6315bf2: cd bf out 0x3d, r28 ; 6115bf4: 12 c0 rjmp .+36 ; 0x15c1a <DatenUebertragung+0x21a>}else#endif{SendOutData('V', FC_ADDRESS, 1, (unsigned char *) &VersionInfo, sizeof(VersionInfo));15bf6: 1f 92 push r115bf8: 8a e0 ldi r24, 0x0A ; 1015bfa: 8f 93 push r2415bfc: 8d e5 ldi r24, 0x5D ; 9315bfe: 9a e0 ldi r25, 0x0A ; 1015c00: 9f 93 push r2515c02: 8f 93 push r2415c04: 81 e0 ldi r24, 0x01 ; 115c06: 8f 93 push r2415c08: 8f 93 push r2415c0a: 86 e5 ldi r24, 0x56 ; 8615c0c: 8f 93 push r2415c0e: 1b d9 rcall .-3530 ; 0x14e46 <SendOutData>15c10: 0f b6 in r0, 0x3f ; 6315c12: f8 94 cli15c14: de bf out 0x3e, r29 ; 6215c16: 0f be out 0x3f, r0 ; 6315c18: cd bf out 0x3d, r28 ; 61}GetVersionAnforderung = 0;15c1a: 10 92 ff 04 sts 0x04FF, r1Debug_OK("Version gesendet");15c1e: 81 e1 ldi r24, 0x11 ; 1715c20: 96 e1 ldi r25, 0x16 ; 2215c22: 9f 93 push r2515c24: 8f 93 push r2415c26: 88 e1 ldi r24, 0x18 ; 2415c28: 93 e2 ldi r25, 0x23 ; 3515c2a: 9f 93 push r2515c2c: 8f 93 push r2415c2e: e0 91 78 06 lds r30, 0x067815c32: f0 91 79 06 lds r31, 0x067915c36: 09 95 icall15c38: 88 e0 ldi r24, 0x08 ; 815c3a: 0e 94 2c 23 call 0x4658 ; 0x4658 <DebugSend>15c3e: 0f 90 pop r015c40: 0f 90 pop r015c42: 0f 90 pop r015c44: 0f 90 pop r0}if(GetExternalControl && UebertragungAbgeschlossen) // Bei Get werden die vom PC einstellbaren Werte vom PC zurückgelesen15c46: 80 91 03 05 lds r24, 0x050315c4a: 88 23 and r24, r2415c4c: d1 f0 breq .+52 ; 0x15c82 <DatenUebertragung+0x282>15c4e: 80 91 b7 02 lds r24, 0x02B715c52: 88 23 and r24, r2415c54: b1 f0 breq .+44 ; 0x15c82 <DatenUebertragung+0x282>{SendOutData('G',MeineSlaveAdresse, 1, (unsigned char *) &ExternControl, sizeof(ExternControl));15c56: 1f 92 push r115c58: 8b e0 ldi r24, 0x0B ; 1115c5a: 8f 93 push r2415c5c: 8f e7 ldi r24, 0x7F ; 12715c5e: 9a e0 ldi r25, 0x0A ; 1015c60: 9f 93 push r2515c62: 8f 93 push r2415c64: 81 e0 ldi r24, 0x01 ; 115c66: 8f 93 push r2415c68: 80 91 b4 02 lds r24, 0x02B415c6c: 8f 93 push r2415c6e: 87 e4 ldi r24, 0x47 ; 7115c70: 8f 93 push r2415c72: e9 d8 rcall .-3630 ; 0x14e46 <SendOutData>GetExternalControl = 0;15c74: 10 92 03 05 sts 0x0503, r115c78: 0f b6 in r0, 0x3f ; 6315c7a: f8 94 cli15c7c: de bf out 0x3e, r29 ; 6215c7e: 0f be out 0x3f, r0 ; 6315c80: cd bf out 0x3d, r28 ; 61}if(((DebugDataIntervall>0 && CheckDelay(Debug_Timer)) || DebugDataAnforderung) && UebertragungAbgeschlossen)15c82: 80 91 f3 04 lds r24, 0x04F315c86: 90 91 f4 04 lds r25, 0x04F415c8a: 89 2b or r24, r2515c8c: 41 f0 breq .+16 ; 0x15c9e <DatenUebertragung+0x29e>15c8e: 80 91 5b 0a lds r24, 0x0A5B15c92: 90 91 5c 0a lds r25, 0x0A5C15c96: 0e 94 63 9c call 0x138c6 ; 0x138c6 <CheckDelay>15c9a: 81 11 cpse r24, r115c9c: 04 c0 rjmp .+8 ; 0x15ca6 <DatenUebertragung+0x2a6>15c9e: 80 91 00 05 lds r24, 0x050015ca2: 88 23 and r24, r2415ca4: 31 f1 breq .+76 ; 0x15cf2 <DatenUebertragung+0x2f2>15ca6: 80 91 b7 02 lds r24, 0x02B715caa: 88 23 and r24, r2415cac: 11 f1 breq .+68 ; 0x15cf2 <DatenUebertragung+0x2f2>{CopyDebugValues();15cae: 0e 94 c1 27 call 0x4f82 ; 0x4f82 <CopyDebugValues>SendOutData('D', FC_ADDRESS, 1, (unsigned char *) &DebugOut,sizeof(DebugOut));15cb2: 1f 92 push r115cb4: 82 e4 ldi r24, 0x42 ; 6615cb6: 8f 93 push r2415cb8: 86 e4 ldi r24, 0x46 ; 7015cba: 9c e0 ldi r25, 0x0C ; 1215cbc: 9f 93 push r2515cbe: 8f 93 push r2415cc0: 81 e0 ldi r24, 0x01 ; 115cc2: 8f 93 push r2415cc4: 8f 93 push r2415cc6: 84 e4 ldi r24, 0x44 ; 6815cc8: 8f 93 push r2415cca: bd d8 rcall .-3718 ; 0x14e46 <SendOutData>DebugDataAnforderung = 0;15ccc: 10 92 00 05 sts 0x0500, r1if(DebugDataIntervall>0) Debug_Timer = SetDelay(DebugDataIntervall);15cd0: 80 91 f3 04 lds r24, 0x04F315cd4: 90 91 f4 04 lds r25, 0x04F415cd8: 0f b6 in r0, 0x3f ; 6315cda: f8 94 cli15cdc: de bf out 0x3e, r29 ; 6215cde: 0f be out 0x3f, r0 ; 6315ce0: cd bf out 0x3d, r28 ; 6115ce2: 00 97 sbiw r24, 0x00 ; 015ce4: 31 f0 breq .+12 ; 0x15cf2 <DatenUebertragung+0x2f2>15ce6: 0e 94 5a 9c call 0x138b4 ; 0x138b4 <SetDelay>15cea: 90 93 5c 0a sts 0x0A5C, r2515cee: 80 93 5b 0a sts 0x0A5B, r24}if(Intervall3D > 0 && CheckDelay(Timer3D) && UebertragungAbgeschlossen)15cf2: 80 91 f1 04 lds r24, 0x04F115cf6: 90 91 f2 04 lds r25, 0x04F215cfa: 89 2b or r24, r2515cfc: 09 f4 brne .+2 ; 0x15d00 <DatenUebertragung+0x300>15cfe: 9d c0 rjmp .+314 ; 0x15e3a <DatenUebertragung+0x43a>15d00: 80 91 59 0a lds r24, 0x0A5915d04: 90 91 5a 0a lds r25, 0x0A5A15d08: 0e 94 63 9c call 0x138c6 ; 0x138c6 <CheckDelay>15d0c: 88 23 and r24, r2415d0e: 09 f4 brne .+2 ; 0x15d12 <DatenUebertragung+0x312>15d10: 94 c0 rjmp .+296 ; 0x15e3a <DatenUebertragung+0x43a>15d12: 80 91 b7 02 lds r24, 0x02B715d16: 88 23 and r24, r2415d18: 09 f4 brne .+2 ; 0x15d1c <DatenUebertragung+0x31c>15d1a: 8f c0 rjmp .+286 ; 0x15e3a <DatenUebertragung+0x43a>{Data3D.Winkel[0] = ToNaviCtrl.IntegralNick;//(int) (IntegralNick / (EE_Parameter.GyroAccFaktor * 4)); // etwa in 0.1 Grad15d1c: 0b e4 ldi r16, 0x4B ; 7515d1e: 1a e0 ldi r17, 0x0A ; 1015d20: 80 91 ea 08 lds r24, 0x08EA15d24: 90 91 eb 08 lds r25, 0x08EB15d28: f8 01 movw r30, r1615d2a: 91 83 std Z+1, r25 ; 0x0115d2c: 80 83 st Z, r24Data3D.Winkel[1] = ToNaviCtrl.IntegralRoll;//(int) (IntegralRoll / (EE_Parameter.GyroAccFaktor * 4)); // etwa in 0.1 Grad15d2e: 80 91 ec 08 lds r24, 0x08EC15d32: 90 91 ed 08 lds r25, 0x08ED15d36: 90 93 4e 0a sts 0x0A4E, r2515d3a: 80 93 4d 0a sts 0x0A4D, r24Data3D.Winkel[2] = (int) ((10 * ErsatzKompass) / GIER_GRAD_FAKTOR);15d3e: 80 91 6e 06 lds r24, 0x066E15d42: 90 91 6f 06 lds r25, 0x066F15d46: a0 91 70 06 lds r26, 0x067015d4a: b0 91 71 06 lds r27, 0x067115d4e: 88 0f add r24, r2415d50: 99 1f adc r25, r2515d52: aa 1f adc r26, r2615d54: bb 1f adc r27, r2715d56: ac 01 movw r20, r2415d58: bd 01 movw r22, r2615d5a: 44 0f add r20, r2015d5c: 55 1f adc r21, r2115d5e: 66 1f adc r22, r2215d60: 77 1f adc r23, r2315d62: 44 0f add r20, r2015d64: 55 1f adc r21, r2115d66: 66 1f adc r22, r2215d68: 77 1f adc r23, r2315d6a: 6c 01 movw r12, r2415d6c: 7d 01 movw r14, r2615d6e: c4 0e add r12, r2015d70: d5 1e adc r13, r2115d72: e6 1e adc r14, r2215d74: f7 1e adc r15, r2315d76: c7 01 movw r24, r1415d78: b6 01 movw r22, r1215d7a: 20 91 21 01 lds r18, 0x012115d7e: 30 91 22 01 lds r19, 0x012215d82: 40 91 23 01 lds r20, 0x012315d86: 50 91 24 01 lds r21, 0x012415d8a: c5 d2 rcall .+1418 ; 0x16316 <__divmodsi4>15d8c: 30 93 50 0a sts 0x0A50, r1915d90: 20 93 4f 0a sts 0x0A4F, r18Data3D.Centroid[0] = SummeNick >> 9;15d94: 80 91 26 04 lds r24, 0x042615d98: 90 91 27 04 lds r25, 0x042715d9c: a0 91 28 04 lds r26, 0x042815da0: b0 91 29 04 lds r27, 0x042915da4: 07 2e mov r0, r2315da6: 79 e0 ldi r23, 0x09 ; 915da8: b5 95 asr r2715daa: a7 95 ror r2615dac: 97 95 ror r2515dae: 87 95 ror r2415db0: 7a 95 dec r2315db2: d1 f7 brne .-12 ; 0x15da8 <DatenUebertragung+0x3a8>15db4: 70 2d mov r23, r015db6: 80 93 51 0a sts 0x0A51, r24Data3D.Centroid[1] = SummeRoll >> 9;15dba: 80 91 22 04 lds r24, 0x042215dbe: 90 91 23 04 lds r25, 0x042315dc2: a0 91 24 04 lds r26, 0x042415dc6: b0 91 25 04 lds r27, 0x042515dca: 07 2e mov r0, r2315dcc: 79 e0 ldi r23, 0x09 ; 915dce: b5 95 asr r2715dd0: a7 95 ror r2615dd2: 97 95 ror r2515dd4: 87 95 ror r2415dd6: 7a 95 dec r2315dd8: d1 f7 brne .-12 ; 0x15dce <DatenUebertragung+0x3ce>15dda: 70 2d mov r23, r015ddc: 80 93 52 0a sts 0x0A52, r24Data3D.Centroid[2] = Mess_Integral_Gier >> 9;15de0: 80 91 2e 04 lds r24, 0x042E15de4: 90 91 2f 04 lds r25, 0x042F15de8: a0 91 30 04 lds r26, 0x043015dec: b0 91 31 04 lds r27, 0x043115df0: 07 2e mov r0, r2315df2: 79 e0 ldi r23, 0x09 ; 915df4: b5 95 asr r2715df6: a7 95 ror r2615df8: 97 95 ror r2515dfa: 87 95 ror r2415dfc: 7a 95 dec r2315dfe: d1 f7 brne .-12 ; 0x15df4 <DatenUebertragung+0x3f4>15e00: 70 2d mov r23, r015e02: 80 93 53 0a sts 0x0A53, r24SendOutData('C', FC_ADDRESS, 1, (unsigned char *) &Data3D,sizeof(Data3D));15e06: 1f 92 push r115e08: 8e e0 ldi r24, 0x0E ; 1415e0a: 8f 93 push r2415e0c: 1f 93 push r1715e0e: 0f 93 push r1615e10: 81 e0 ldi r24, 0x01 ; 115e12: 8f 93 push r2415e14: 8f 93 push r2415e16: 83 e4 ldi r24, 0x43 ; 6715e18: 8f 93 push r2415e1a: 15 d8 rcall .-4054 ; 0x14e46 <SendOutData>Timer3D = SetDelay(Intervall3D);15e1c: 80 91 f1 04 lds r24, 0x04F115e20: 90 91 f2 04 lds r25, 0x04F215e24: 0e 94 5a 9c call 0x138b4 ; 0x138b4 <SetDelay>15e28: 90 93 5a 0a sts 0x0A5A, r2515e2c: 80 93 59 0a sts 0x0A59, r2415e30: 0f b6 in r0, 0x3f ; 6315e32: f8 94 cli15e34: de bf out 0x3e, r29 ; 6215e36: 0f be out 0x3f, r0 ; 6315e38: cd bf out 0x3d, r28 ; 61}if(DebugTextAnforderung != 255) // Texte für die Analogdaten15e3a: 60 91 b6 02 lds r22, 0x02B615e3e: 6f 3f cpi r22, 0xFF ; 25515e40: 41 f1 breq .+80 ; 0x15e92 <DatenUebertragung+0x492>{unsigned char label[16]; // local sram buffermemcpy_P(label, ANALOG_TEXT[DebugTextAnforderung], 16); // read lable from flash to sra15e42: 30 e1 ldi r19, 0x10 ; 1615e44: 63 9f mul r22, r1915e46: b0 01 movw r22, r015e48: 11 24 eor r1, r115e4a: 61 59 subi r22, 0x91 ; 14515e4c: 79 4e sbci r23, 0xE9 ; 23315e4e: 40 e1 ldi r20, 0x10 ; 1615e50: 50 e0 ldi r21, 0x00 ; 015e52: 8e 01 movw r16, r2815e54: 0f 5f subi r16, 0xFF ; 25515e56: 1f 4f sbci r17, 0xFF ; 25515e58: c8 01 movw r24, r1615e5a: e1 d2 rcall .+1474 ; 0x1641e <memcpy_P>SendOutData('A', FC_ADDRESS, 2, (unsigned char *)&DebugTextAnforderung, sizeof(DebugTextAnforderung),label, 16);15e5c: 1f 92 push r115e5e: 80 e1 ldi r24, 0x10 ; 1615e60: 8f 93 push r2415e62: 1f 93 push r1715e64: 0f 93 push r1615e66: 1f 92 push r115e68: 21 e0 ldi r18, 0x01 ; 115e6a: 2f 93 push r1815e6c: 86 eb ldi r24, 0xB6 ; 18215e6e: 92 e0 ldi r25, 0x02 ; 215e70: 9f 93 push r2515e72: 8f 93 push r2415e74: 82 e0 ldi r24, 0x02 ; 215e76: 8f 93 push r2415e78: 2f 93 push r1815e7a: 81 e4 ldi r24, 0x41 ; 6515e7c: 8f 93 push r2415e7e: 0e 94 23 a7 call 0x14e46 ; 0x14e46 <SendOutData>DebugTextAnforderung = 255;15e82: 8f ef ldi r24, 0xFF ; 25515e84: 80 93 b6 02 sts 0x02B6, r2415e88: 0f b6 in r0, 0x3f ; 6315e8a: f8 94 cli15e8c: de bf out 0x3e, r29 ; 6215e8e: 0f be out 0x3f, r0 ; 6315e90: cd bf out 0x3d, r28 ; 61}if(ConfirmFrame && UebertragungAbgeschlossen) // Datensatz bestätigen15e92: 80 91 88 0c lds r24, 0x0C8815e96: 88 23 and r24, r2415e98: c1 f0 breq .+48 ; 0x15eca <DatenUebertragung+0x4ca>15e9a: 80 91 b7 02 lds r24, 0x02B715e9e: 88 23 and r24, r2415ea0: a1 f0 breq .+40 ; 0x15eca <DatenUebertragung+0x4ca>{SendOutData('B', FC_ADDRESS, 1, (uint8_t*)&ConfirmFrame, sizeof(ConfirmFrame));15ea2: 1f 92 push r115ea4: 21 e0 ldi r18, 0x01 ; 115ea6: 2f 93 push r1815ea8: 88 e8 ldi r24, 0x88 ; 13615eaa: 9c e0 ldi r25, 0x0C ; 1215eac: 9f 93 push r2515eae: 8f 93 push r2415eb0: 2f 93 push r1815eb2: 2f 93 push r1815eb4: 82 e4 ldi r24, 0x42 ; 6615eb6: 8f 93 push r2415eb8: 0e 94 23 a7 call 0x14e46 ; 0x14e46 <SendOutData>ConfirmFrame = 0;15ebc: 10 92 88 0c sts 0x0C88, r115ec0: 0f b6 in r0, 0x3f ; 6315ec2: f8 94 cli15ec4: de bf out 0x3e, r29 ; 6215ec6: 0f be out 0x3f, r0 ; 6315ec8: cd bf out 0x3d, r28 ; 61}if(GetPPMChannelAnforderung && UebertragungAbgeschlossen)15eca: 80 91 fe 04 lds r24, 0x04FE15ece: 88 23 and r24, r2415ed0: c9 f0 breq .+50 ; 0x15f04 <DatenUebertragung+0x504>15ed2: 80 91 b7 02 lds r24, 0x02B715ed6: 88 23 and r24, r2415ed8: a9 f0 breq .+42 ; 0x15f04 <DatenUebertragung+0x504>{SendOutData('P', FC_ADDRESS, 1, (unsigned char *) &PPM_in, sizeof(PPM_in));15eda: 1f 92 push r115edc: 86 e4 ldi r24, 0x46 ; 7015ede: 8f 93 push r2415ee0: 81 e3 ldi r24, 0x31 ; 4915ee2: 98 e0 ldi r25, 0x08 ; 815ee4: 9f 93 push r2515ee6: 8f 93 push r2415ee8: 81 e0 ldi r24, 0x01 ; 115eea: 8f 93 push r2415eec: 8f 93 push r2415eee: 80 e5 ldi r24, 0x50 ; 8015ef0: 8f 93 push r2415ef2: 0e 94 23 a7 call 0x14e46 ; 0x14e46 <SendOutData>GetPPMChannelAnforderung = 0;15ef6: 10 92 fe 04 sts 0x04FE, r115efa: 0f b6 in r0, 0x3f ; 6315efc: f8 94 cli15efe: de bf out 0x3e, r29 ; 6215f00: 0f be out 0x3f, r0 ; 6315f02: cd bf out 0x3d, r28 ; 61}#ifndef REDUNDANT_FC_SLAVEif((CheckDelay(Kompass_Timer)) && UebertragungAbgeschlossen)15f04: 80 91 8a 0a lds r24, 0x0A8A15f08: 90 91 8b 0a lds r25, 0x0A8B15f0c: 0e 94 63 9c call 0x138c6 ; 0x138c6 <CheckDelay>15f10: 88 23 and r24, r2415f12: 09 f4 brne .+2 ; 0x15f16 <DatenUebertragung+0x516>15f14: 4f c0 rjmp .+158 ; 0x15fb4 <DatenUebertragung+0x5b4>15f16: 80 91 b7 02 lds r24, 0x02B715f1a: 88 23 and r24, r2415f1c: 09 f4 brne .+2 ; 0x15f20 <DatenUebertragung+0x520>15f1e: 4a c0 rjmp .+148 ; 0x15fb4 <DatenUebertragung+0x5b4>{if(!NaviDataOkay) // no external compass needed15f20: 80 91 a4 02 lds r24, 0x02A415f24: 81 11 cpse r24, r115f26: 2a c0 rjmp .+84 ; 0x15f7c <DatenUebertragung+0x57c>{WinkelOut.Winkel[0] = ToNaviCtrl.IntegralNick;//(int) (IntegralNick / (EE_Parameter.GyroAccFaktor * 4)); // etwa in 0.1 Grad15f28: e7 e7 ldi r30, 0x77 ; 11915f2a: fa e0 ldi r31, 0x0A ; 1015f2c: 80 91 ea 08 lds r24, 0x08EA15f30: 90 91 eb 08 lds r25, 0x08EB15f34: 91 83 std Z+1, r25 ; 0x0115f36: 80 83 st Z, r24WinkelOut.Winkel[1] = ToNaviCtrl.IntegralRoll;//(int) (IntegralRoll / (EE_Parameter.GyroAccFaktor * 4)); // etwa in 0.1 Grad15f38: 80 91 ec 08 lds r24, 0x08EC15f3c: 90 91 ed 08 lds r25, 0x08ED15f40: 90 93 7a 0a sts 0x0A7A, r2515f44: 80 93 79 0a sts 0x0A79, r24WinkelOut.UserParameter[0] = Parameter_UserParam1;15f48: 80 91 e0 03 lds r24, 0x03E015f4c: 80 93 7b 0a sts 0x0A7B, r24WinkelOut.UserParameter[1] = Parameter_UserParam2;15f50: 80 91 df 03 lds r24, 0x03DF15f54: 80 93 7c 0a sts 0x0A7C, r24SendOutData('k', MK3MAG_ADDRESS, 1, (unsigned char *) &WinkelOut,sizeof(WinkelOut));15f58: 1f 92 push r115f5a: 88 e0 ldi r24, 0x08 ; 815f5c: 8f 93 push r2415f5e: ff 93 push r3115f60: ef 93 push r3015f62: 81 e0 ldi r24, 0x01 ; 115f64: 8f 93 push r2415f66: 83 e0 ldi r24, 0x03 ; 315f68: 8f 93 push r2415f6a: 8b e6 ldi r24, 0x6B ; 10715f6c: 8f 93 push r2415f6e: 0e 94 23 a7 call 0x14e46 ; 0x14e46 <SendOutData>15f72: 0f b6 in r0, 0x3f ; 6315f74: f8 94 cli15f76: de bf out 0x3e, r29 ; 6215f78: 0f be out 0x3f, r0 ; 6315f7a: cd bf out 0x3d, r28 ; 61}if(WinkelOut.CalcState > 4) WinkelOut.CalcState = 6; // wird dann in SPI auf Null gesetzt15f7c: 80 91 7d 0a lds r24, 0x0A7D15f80: 85 30 cpi r24, 0x05 ; 515f82: 18 f0 brcs .+6 ; 0x15f8a <DatenUebertragung+0x58a>15f84: 86 e0 ldi r24, 0x06 ; 615f86: 80 93 7d 0a sts 0x0A7D, r24if(JustMK3MagConnected) Kompass_Timer = SetDelay(99);15f8a: 80 91 ca 04 lds r24, 0x04CA15f8e: 88 23 and r24, r2415f90: 49 f0 breq .+18 ; 0x15fa4 <DatenUebertragung+0x5a4>15f92: 83 e6 ldi r24, 0x63 ; 9915f94: 90 e0 ldi r25, 0x00 ; 015f96: 0e 94 5a 9c call 0x138b4 ; 0x138b4 <SetDelay>15f9a: 90 93 8b 0a sts 0x0A8B, r2515f9e: 80 93 8a 0a sts 0x0A8A, r2415fa2: 08 c0 rjmp .+16 ; 0x15fb4 <DatenUebertragung+0x5b4>else Kompass_Timer = SetDelay(999);15fa4: 87 ee ldi r24, 0xE7 ; 23115fa6: 93 e0 ldi r25, 0x03 ; 315fa8: 0e 94 5a 9c call 0x138b4 ; 0x138b4 <SetDelay>15fac: 90 93 8b 0a sts 0x0A8B, r2515fb0: 80 93 8a 0a sts 0x0A8A, r24SendOutData('!', FC_ADDRESS, 1, (unsigned char *) &SendRedundantMotor, RequiredMotors+1);}#endif#ifdef DEBUG // only include functions if DEBUG is definedif(SendDebugOutput && UebertragungAbgeschlossen)15fb4: 80 91 76 03 lds r24, 0x037615fb8: 88 23 and r24, r2415fba: c9 f0 breq .+50 ; 0x15fee <DatenUebertragung+0x5ee>15fbc: 80 91 b7 02 lds r24, 0x02B715fc0: 88 23 and r24, r2415fc2: a9 f0 breq .+42 ; 0x15fee <DatenUebertragung+0x5ee>{SendOutData('0', FC_ADDRESS, 1, (unsigned char *) &tDebug, sizeof(tDebug));15fc4: 1f 92 push r115fc6: 81 e2 ldi r24, 0x21 ; 3315fc8: 8f 93 push r2415fca: 8c e1 ldi r24, 0x1C ; 2815fcc: 95 e0 ldi r25, 0x05 ; 515fce: 9f 93 push r2515fd0: 8f 93 push r2415fd2: 81 e0 ldi r24, 0x01 ; 115fd4: 8f 93 push r2415fd6: 8f 93 push r2415fd8: 80 e3 ldi r24, 0x30 ; 4815fda: 8f 93 push r2415fdc: 0e 94 23 a7 call 0x14e46 ; 0x14e46 <SendOutData>SendDebugOutput = 0;15fe0: 10 92 76 03 sts 0x0376, r115fe4: 0f b6 in r0, 0x3f ; 6315fe6: f8 94 cli15fe8: de bf out 0x3e, r29 ; 6215fea: 0f be out 0x3f, r0 ; 6315fec: cd bf out 0x3d, r28 ; 61}#endif}15fee: 60 96 adiw r28, 0x10 ; 1615ff0: 0f b6 in r0, 0x3f ; 6315ff2: f8 94 cli15ff4: de bf out 0x3e, r29 ; 6215ff6: 0f be out 0x3f, r0 ; 6315ff8: cd bf out 0x3d, r28 ; 6115ffa: df 91 pop r2915ffc: cf 91 pop r2815ffe: 1f 91 pop r1716000: 0f 91 pop r1616002: ff 90 pop r1516004: ef 90 pop r1416006: df 90 pop r1316008: cf 90 pop r121600a: 08 95 ret0001600c <User_Receiver_Init>://############################################################################// Initialize the UART here//############################################################################void User_Receiver_Init(void){1600c: 08 95 ret0001600e <User_RX_Parser>://############################################################################// Is called by the uart RX interrupt// UDR contains the received byte//############################################################################void User_RX_Parser(unsigned char udr){1600e: 08 95 ret00016010 <__subsf3>:16010: 50 58 subi r21, 0x80 ; 12800016012 <__addsf3>:16012: bb 27 eor r27, r2716014: aa 27 eor r26, r2616016: 0e d0 rcall .+28 ; 0x16034 <__addsf3x>16018: e0 c0 rjmp .+448 ; 0x161da <__fp_round>1601a: d1 d0 rcall .+418 ; 0x161be <__fp_pscA>1601c: 30 f0 brcs .+12 ; 0x1602a <__addsf3+0x18>1601e: d6 d0 rcall .+428 ; 0x161cc <__fp_pscB>16020: 20 f0 brcs .+8 ; 0x1602a <__addsf3+0x18>16022: 31 f4 brne .+12 ; 0x16030 <__addsf3+0x1e>16024: 9f 3f cpi r25, 0xFF ; 25516026: 11 f4 brne .+4 ; 0x1602c <__addsf3+0x1a>16028: 1e f4 brtc .+6 ; 0x16030 <__addsf3+0x1e>1602a: c6 c0 rjmp .+396 ; 0x161b8 <__fp_nan>1602c: 0e f4 brtc .+2 ; 0x16030 <__addsf3+0x1e>1602e: e0 95 com r3016030: e7 fb bst r30, 716032: bc c0 rjmp .+376 ; 0x161ac <__fp_inf>00016034 <__addsf3x>:16034: e9 2f mov r30, r2516036: e2 d0 rcall .+452 ; 0x161fc <__fp_split3>16038: 80 f3 brcs .-32 ; 0x1601a <__addsf3+0x8>1603a: ba 17 cp r27, r261603c: 62 07 cpc r22, r181603e: 73 07 cpc r23, r1916040: 84 07 cpc r24, r2016042: 95 07 cpc r25, r2116044: 18 f0 brcs .+6 ; 0x1604c <__addsf3x+0x18>16046: 71 f4 brne .+28 ; 0x16064 <__addsf3x+0x30>16048: 9e f5 brtc .+102 ; 0x160b0 <__addsf3x+0x7c>1604a: fa c0 rjmp .+500 ; 0x16240 <__fp_zero>1604c: 0e f4 brtc .+2 ; 0x16050 <__addsf3x+0x1c>1604e: e0 95 com r3016050: 0b 2e mov r0, r2716052: ba 2f mov r27, r2616054: a0 2d mov r26, r016056: 0b 01 movw r0, r2216058: b9 01 movw r22, r181605a: 90 01 movw r18, r01605c: 0c 01 movw r0, r241605e: ca 01 movw r24, r2016060: a0 01 movw r20, r016062: 11 24 eor r1, r116064: ff 27 eor r31, r3116066: 59 1b sub r21, r2516068: 99 f0 breq .+38 ; 0x16090 <__addsf3x+0x5c>1606a: 59 3f cpi r21, 0xF9 ; 2491606c: 50 f4 brcc .+20 ; 0x16082 <__addsf3x+0x4e>1606e: 50 3e cpi r21, 0xE0 ; 22416070: 68 f1 brcs .+90 ; 0x160cc <__addsf3x+0x98>16072: 1a 16 cp r1, r2616074: f0 40 sbci r31, 0x00 ; 016076: a2 2f mov r26, r1816078: 23 2f mov r18, r191607a: 34 2f mov r19, r201607c: 44 27 eor r20, r201607e: 58 5f subi r21, 0xF8 ; 24816080: f3 cf rjmp .-26 ; 0x16068 <__addsf3x+0x34>16082: 46 95 lsr r2016084: 37 95 ror r1916086: 27 95 ror r1816088: a7 95 ror r261608a: f0 40 sbci r31, 0x00 ; 01608c: 53 95 inc r211608e: c9 f7 brne .-14 ; 0x16082 <__addsf3x+0x4e>16090: 7e f4 brtc .+30 ; 0x160b0 <__addsf3x+0x7c>16092: 1f 16 cp r1, r3116094: ba 0b sbc r27, r2616096: 62 0b sbc r22, r1816098: 73 0b sbc r23, r191609a: 84 0b sbc r24, r201609c: ba f0 brmi .+46 ; 0x160cc <__addsf3x+0x98>1609e: 91 50 subi r25, 0x01 ; 1160a0: a1 f0 breq .+40 ; 0x160ca <__addsf3x+0x96>160a2: ff 0f add r31, r31160a4: bb 1f adc r27, r27160a6: 66 1f adc r22, r22160a8: 77 1f adc r23, r23160aa: 88 1f adc r24, r24160ac: c2 f7 brpl .-16 ; 0x1609e <__addsf3x+0x6a>160ae: 0e c0 rjmp .+28 ; 0x160cc <__addsf3x+0x98>160b0: ba 0f add r27, r26160b2: 62 1f adc r22, r18160b4: 73 1f adc r23, r19160b6: 84 1f adc r24, r20160b8: 48 f4 brcc .+18 ; 0x160cc <__addsf3x+0x98>160ba: 87 95 ror r24160bc: 77 95 ror r23160be: 67 95 ror r22160c0: b7 95 ror r27160c2: f7 95 ror r31160c4: 9e 3f cpi r25, 0xFE ; 254160c6: 08 f0 brcs .+2 ; 0x160ca <__addsf3x+0x96>160c8: b3 cf rjmp .-154 ; 0x16030 <__addsf3+0x1e>160ca: 93 95 inc r25160cc: 88 0f add r24, r24160ce: 08 f0 brcs .+2 ; 0x160d2 <__addsf3x+0x9e>160d0: 99 27 eor r25, r25160d2: ee 0f add r30, r30160d4: 97 95 ror r25160d6: 87 95 ror r24160d8: 08 95 ret000160da <__fixunssfsi>:160da: 98 d0 rcall .+304 ; 0x1620c <__fp_splitA>160dc: 88 f0 brcs .+34 ; 0x16100 <__fixunssfsi+0x26>160de: 9f 57 subi r25, 0x7F ; 127160e0: 90 f0 brcs .+36 ; 0x16106 <__fixunssfsi+0x2c>160e2: b9 2f mov r27, r25160e4: 99 27 eor r25, r25160e6: b7 51 subi r27, 0x17 ; 23160e8: a0 f0 brcs .+40 ; 0x16112 <__fixunssfsi+0x38>160ea: d1 f0 breq .+52 ; 0x16120 <__fixunssfsi+0x46>160ec: 66 0f add r22, r22160ee: 77 1f adc r23, r23160f0: 88 1f adc r24, r24160f2: 99 1f adc r25, r25160f4: 1a f0 brmi .+6 ; 0x160fc <__fixunssfsi+0x22>160f6: ba 95 dec r27160f8: c9 f7 brne .-14 ; 0x160ec <__fixunssfsi+0x12>160fa: 12 c0 rjmp .+36 ; 0x16120 <__fixunssfsi+0x46>160fc: b1 30 cpi r27, 0x01 ; 1160fe: 81 f0 breq .+32 ; 0x16120 <__fixunssfsi+0x46>16100: 9f d0 rcall .+318 ; 0x16240 <__fp_zero>16102: b1 e0 ldi r27, 0x01 ; 116104: 08 95 ret16106: 9c c0 rjmp .+312 ; 0x16240 <__fp_zero>16108: 67 2f mov r22, r231610a: 78 2f mov r23, r241610c: 88 27 eor r24, r241610e: b8 5f subi r27, 0xF8 ; 24816110: 39 f0 breq .+14 ; 0x16120 <__fixunssfsi+0x46>16112: b9 3f cpi r27, 0xF9 ; 24916114: cc f3 brlt .-14 ; 0x16108 <__fixunssfsi+0x2e>16116: 86 95 lsr r2416118: 77 95 ror r231611a: 67 95 ror r221611c: b3 95 inc r271611e: d9 f7 brne .-10 ; 0x16116 <__fixunssfsi+0x3c>16120: 3e f4 brtc .+14 ; 0x16130 <__fixunssfsi+0x56>16122: 90 95 com r2516124: 80 95 com r2416126: 70 95 com r2316128: 61 95 neg r221612a: 7f 4f sbci r23, 0xFF ; 2551612c: 8f 4f sbci r24, 0xFF ; 2551612e: 9f 4f sbci r25, 0xFF ; 25516130: 08 95 ret00016132 <__floatunsisf>:16132: e8 94 clt16134: 09 c0 rjmp .+18 ; 0x16148 <__floatsisf+0x12>00016136 <__floatsisf>:16136: 97 fb bst r25, 716138: 3e f4 brtc .+14 ; 0x16148 <__floatsisf+0x12>1613a: 90 95 com r251613c: 80 95 com r241613e: 70 95 com r2316140: 61 95 neg r2216142: 7f 4f sbci r23, 0xFF ; 25516144: 8f 4f sbci r24, 0xFF ; 25516146: 9f 4f sbci r25, 0xFF ; 25516148: 99 23 and r25, r251614a: a9 f0 breq .+42 ; 0x16176 <__floatsisf+0x40>1614c: f9 2f mov r31, r251614e: 96 e9 ldi r25, 0x96 ; 15016150: bb 27 eor r27, r2716152: 93 95 inc r2516154: f6 95 lsr r3116156: 87 95 ror r2416158: 77 95 ror r231615a: 67 95 ror r221615c: b7 95 ror r271615e: f1 11 cpse r31, r116160: f8 cf rjmp .-16 ; 0x16152 <__floatsisf+0x1c>16162: fa f4 brpl .+62 ; 0x161a2 <__floatsisf+0x6c>16164: bb 0f add r27, r2716166: 11 f4 brne .+4 ; 0x1616c <__floatsisf+0x36>16168: 60 ff sbrs r22, 01616a: 1b c0 rjmp .+54 ; 0x161a2 <__floatsisf+0x6c>1616c: 6f 5f subi r22, 0xFF ; 2551616e: 7f 4f sbci r23, 0xFF ; 25516170: 8f 4f sbci r24, 0xFF ; 25516172: 9f 4f sbci r25, 0xFF ; 25516174: 16 c0 rjmp .+44 ; 0x161a2 <__floatsisf+0x6c>16176: 88 23 and r24, r2416178: 11 f0 breq .+4 ; 0x1617e <__floatsisf+0x48>1617a: 96 e9 ldi r25, 0x96 ; 1501617c: 11 c0 rjmp .+34 ; 0x161a0 <__floatsisf+0x6a>1617e: 77 23 and r23, r2316180: 21 f0 breq .+8 ; 0x1618a <__floatsisf+0x54>16182: 9e e8 ldi r25, 0x8E ; 14216184: 87 2f mov r24, r2316186: 76 2f mov r23, r2216188: 05 c0 rjmp .+10 ; 0x16194 <__floatsisf+0x5e>1618a: 66 23 and r22, r221618c: 71 f0 breq .+28 ; 0x161aa <__floatsisf+0x74>1618e: 96 e8 ldi r25, 0x86 ; 13416190: 86 2f mov r24, r2216192: 70 e0 ldi r23, 0x00 ; 016194: 60 e0 ldi r22, 0x00 ; 016196: 2a f0 brmi .+10 ; 0x161a2 <__floatsisf+0x6c>16198: 9a 95 dec r251619a: 66 0f add r22, r221619c: 77 1f adc r23, r231619e: 88 1f adc r24, r24161a0: da f7 brpl .-10 ; 0x16198 <__floatsisf+0x62>161a2: 88 0f add r24, r24161a4: 96 95 lsr r25161a6: 87 95 ror r24161a8: 97 f9 bld r25, 7161aa: 08 95 ret000161ac <__fp_inf>:161ac: 97 f9 bld r25, 7161ae: 9f 67 ori r25, 0x7F ; 127161b0: 80 e8 ldi r24, 0x80 ; 128161b2: 70 e0 ldi r23, 0x00 ; 0161b4: 60 e0 ldi r22, 0x00 ; 0161b6: 08 95 ret000161b8 <__fp_nan>:161b8: 9f ef ldi r25, 0xFF ; 255161ba: 80 ec ldi r24, 0xC0 ; 192161bc: 08 95 ret000161be <__fp_pscA>:161be: 00 24 eor r0, r0161c0: 0a 94 dec r0161c2: 16 16 cp r1, r22161c4: 17 06 cpc r1, r23161c6: 18 06 cpc r1, r24161c8: 09 06 cpc r0, r25161ca: 08 95 ret000161cc <__fp_pscB>:161cc: 00 24 eor r0, r0161ce: 0a 94 dec r0161d0: 12 16 cp r1, r18161d2: 13 06 cpc r1, r19161d4: 14 06 cpc r1, r20161d6: 05 06 cpc r0, r21161d8: 08 95 ret000161da <__fp_round>:161da: 09 2e mov r0, r25161dc: 03 94 inc r0161de: 00 0c add r0, r0161e0: 11 f4 brne .+4 ; 0x161e6 <__fp_round+0xc>161e2: 88 23 and r24, r24161e4: 52 f0 brmi .+20 ; 0x161fa <__fp_round+0x20>161e6: bb 0f add r27, r27161e8: 40 f4 brcc .+16 ; 0x161fa <__fp_round+0x20>161ea: bf 2b or r27, r31161ec: 11 f4 brne .+4 ; 0x161f2 <__fp_round+0x18>161ee: 60 ff sbrs r22, 0161f0: 04 c0 rjmp .+8 ; 0x161fa <__fp_round+0x20>161f2: 6f 5f subi r22, 0xFF ; 255161f4: 7f 4f sbci r23, 0xFF ; 255161f6: 8f 4f sbci r24, 0xFF ; 255161f8: 9f 4f sbci r25, 0xFF ; 255161fa: 08 95 ret000161fc <__fp_split3>:161fc: 57 fd sbrc r21, 7161fe: 90 58 subi r25, 0x80 ; 12816200: 44 0f add r20, r2016202: 55 1f adc r21, r2116204: 59 f0 breq .+22 ; 0x1621c <__fp_splitA+0x10>16206: 5f 3f cpi r21, 0xFF ; 25516208: 71 f0 breq .+28 ; 0x16226 <__fp_splitA+0x1a>1620a: 47 95 ror r200001620c <__fp_splitA>:1620c: 88 0f add r24, r241620e: 97 fb bst r25, 716210: 99 1f adc r25, r2516212: 61 f0 breq .+24 ; 0x1622c <__fp_splitA+0x20>16214: 9f 3f cpi r25, 0xFF ; 25516216: 79 f0 breq .+30 ; 0x16236 <__fp_splitA+0x2a>16218: 87 95 ror r241621a: 08 95 ret1621c: 12 16 cp r1, r181621e: 13 06 cpc r1, r1916220: 14 06 cpc r1, r2016222: 55 1f adc r21, r2116224: f2 cf rjmp .-28 ; 0x1620a <__fp_split3+0xe>16226: 46 95 lsr r2016228: f1 df rcall .-30 ; 0x1620c <__fp_splitA>1622a: 08 c0 rjmp .+16 ; 0x1623c <__fp_splitA+0x30>1622c: 16 16 cp r1, r221622e: 17 06 cpc r1, r2316230: 18 06 cpc r1, r2416232: 99 1f adc r25, r2516234: f1 cf rjmp .-30 ; 0x16218 <__fp_splitA+0xc>16236: 86 95 lsr r2416238: 71 05 cpc r23, r11623a: 61 05 cpc r22, r11623c: 08 94 sec1623e: 08 95 ret00016240 <__fp_zero>:16240: e8 94 clt00016242 <__fp_szero>:16242: bb 27 eor r27, r2716244: 66 27 eor r22, r2216246: 77 27 eor r23, r2316248: cb 01 movw r24, r221624a: 97 f9 bld r25, 71624c: 08 95 ret0001624e <__mulsi3>:1624e: db 01 movw r26, r2216250: 8f 93 push r2416252: 9f 93 push r2516254: 9d d0 rcall .+314 ; 0x16390 <__muluhisi3>16256: bf 91 pop r2716258: af 91 pop r261625a: a2 9f mul r26, r181625c: 80 0d add r24, r01625e: 91 1d adc r25, r116260: a3 9f mul r26, r1916262: 90 0d add r25, r016264: b2 9f mul r27, r1816266: 90 0d add r25, r016268: 11 24 eor r1, r11626a: 08 95 ret0001626c <__udivmodqi4>:1626c: 99 1b sub r25, r251626e: 79 e0 ldi r23, 0x09 ; 916270: 04 c0 rjmp .+8 ; 0x1627a <__udivmodqi4_ep>00016272 <__udivmodqi4_loop>:16272: 99 1f adc r25, r2516274: 96 17 cp r25, r2216276: 08 f0 brcs .+2 ; 0x1627a <__udivmodqi4_ep>16278: 96 1b sub r25, r220001627a <__udivmodqi4_ep>:1627a: 88 1f adc r24, r241627c: 7a 95 dec r231627e: c9 f7 brne .-14 ; 0x16272 <__udivmodqi4_loop>16280: 80 95 com r2416282: 08 95 ret00016284 <__udivmodhi4>:16284: aa 1b sub r26, r2616286: bb 1b sub r27, r2716288: 51 e1 ldi r21, 0x11 ; 171628a: 07 c0 rjmp .+14 ; 0x1629a <__udivmodhi4_ep>0001628c <__udivmodhi4_loop>:1628c: aa 1f adc r26, r261628e: bb 1f adc r27, r2716290: a6 17 cp r26, r2216292: b7 07 cpc r27, r2316294: 10 f0 brcs .+4 ; 0x1629a <__udivmodhi4_ep>16296: a6 1b sub r26, r2216298: b7 0b sbc r27, r230001629a <__udivmodhi4_ep>:1629a: 88 1f adc r24, r241629c: 99 1f adc r25, r251629e: 5a 95 dec r21162a0: a9 f7 brne .-22 ; 0x1628c <__udivmodhi4_loop>162a2: 80 95 com r24162a4: 90 95 com r25162a6: bc 01 movw r22, r24162a8: cd 01 movw r24, r26162aa: 08 95 ret000162ac <__divmodhi4>:162ac: 97 fb bst r25, 7162ae: 07 2e mov r0, r23162b0: 16 f4 brtc .+4 ; 0x162b6 <__divmodhi4+0xa>162b2: 00 94 com r0162b4: 06 d0 rcall .+12 ; 0x162c2 <__divmodhi4_neg1>162b6: 77 fd sbrc r23, 7162b8: 08 d0 rcall .+16 ; 0x162ca <__divmodhi4_neg2>162ba: e4 df rcall .-56 ; 0x16284 <__udivmodhi4>162bc: 07 fc sbrc r0, 7162be: 05 d0 rcall .+10 ; 0x162ca <__divmodhi4_neg2>162c0: 3e f4 brtc .+14 ; 0x162d0 <__divmodhi4_exit>000162c2 <__divmodhi4_neg1>:162c2: 90 95 com r25162c4: 81 95 neg r24162c6: 9f 4f sbci r25, 0xFF ; 255162c8: 08 95 ret000162ca <__divmodhi4_neg2>:162ca: 70 95 com r23162cc: 61 95 neg r22162ce: 7f 4f sbci r23, 0xFF ; 255000162d0 <__divmodhi4_exit>:162d0: 08 95 ret000162d2 <__udivmodsi4>:162d2: a1 e2 ldi r26, 0x21 ; 33162d4: 1a 2e mov r1, r26162d6: aa 1b sub r26, r26162d8: bb 1b sub r27, r27162da: fd 01 movw r30, r26162dc: 0d c0 rjmp .+26 ; 0x162f8 <__udivmodsi4_ep>000162de <__udivmodsi4_loop>:162de: aa 1f adc r26, r26162e0: bb 1f adc r27, r27162e2: ee 1f adc r30, r30162e4: ff 1f adc r31, r31162e6: a2 17 cp r26, r18162e8: b3 07 cpc r27, r19162ea: e4 07 cpc r30, r20162ec: f5 07 cpc r31, r21162ee: 20 f0 brcs .+8 ; 0x162f8 <__udivmodsi4_ep>162f0: a2 1b sub r26, r18162f2: b3 0b sbc r27, r19162f4: e4 0b sbc r30, r20162f6: f5 0b sbc r31, r21000162f8 <__udivmodsi4_ep>:162f8: 66 1f adc r22, r22162fa: 77 1f adc r23, r23162fc: 88 1f adc r24, r24162fe: 99 1f adc r25, r2516300: 1a 94 dec r116302: 69 f7 brne .-38 ; 0x162de <__udivmodsi4_loop>16304: 60 95 com r2216306: 70 95 com r2316308: 80 95 com r241630a: 90 95 com r251630c: 9b 01 movw r18, r221630e: ac 01 movw r20, r2416310: bd 01 movw r22, r2616312: cf 01 movw r24, r3016314: 08 95 ret00016316 <__divmodsi4>:16316: 05 2e mov r0, r2116318: 97 fb bst r25, 71631a: 16 f4 brtc .+4 ; 0x16320 <__divmodsi4+0xa>1631c: 00 94 com r01631e: 0f d0 rcall .+30 ; 0x1633e <__negsi2>16320: 57 fd sbrc r21, 716322: 05 d0 rcall .+10 ; 0x1632e <__divmodsi4_neg2>16324: d6 df rcall .-84 ; 0x162d2 <__udivmodsi4>16326: 07 fc sbrc r0, 716328: 02 d0 rcall .+4 ; 0x1632e <__divmodsi4_neg2>1632a: 46 f4 brtc .+16 ; 0x1633c <__divmodsi4_exit>1632c: 08 c0 rjmp .+16 ; 0x1633e <__negsi2>0001632e <__divmodsi4_neg2>:1632e: 50 95 com r2116330: 40 95 com r2016332: 30 95 com r1916334: 21 95 neg r1816336: 3f 4f sbci r19, 0xFF ; 25516338: 4f 4f sbci r20, 0xFF ; 2551633a: 5f 4f sbci r21, 0xFF ; 2550001633c <__divmodsi4_exit>:1633c: 08 95 ret0001633e <__negsi2>:1633e: 90 95 com r2516340: 80 95 com r2416342: 70 95 com r2316344: 61 95 neg r2216346: 7f 4f sbci r23, 0xFF ; 25516348: 8f 4f sbci r24, 0xFF ; 2551634a: 9f 4f sbci r25, 0xFF ; 2551634c: 08 95 ret0001634e <__tablejump2__>:1634e: ee 0f add r30, r3016350: ff 1f adc r31, r3100016352 <__tablejump__>:16352: 05 90 lpm r0, Z+16354: f4 91 lpm r31, Z16356: e0 2d mov r30, r016358: 09 94 ijmp0001635a <__mulhisi3>:1635a: 05 d0 rcall .+10 ; 0x16366 <__umulhisi3>1635c: 33 23 and r19, r191635e: 12 f4 brpl .+4 ; 0x16364 <__mulhisi3+0xa>16360: 8a 1b sub r24, r2616362: 9b 0b sbc r25, r2716364: 10 c0 rjmp .+32 ; 0x16386 <__usmulhisi3_tail>00016366 <__umulhisi3>:16366: a2 9f mul r26, r1816368: b0 01 movw r22, r01636a: b3 9f mul r27, r191636c: c0 01 movw r24, r01636e: a3 9f mul r26, r1916370: 70 0d add r23, r016372: 81 1d adc r24, r116374: 11 24 eor r1, r116376: 91 1d adc r25, r116378: b2 9f mul r27, r181637a: 70 0d add r23, r01637c: 81 1d adc r24, r11637e: 11 24 eor r1, r116380: 91 1d adc r25, r116382: 08 95 ret00016384 <__usmulhisi3>:16384: f0 df rcall .-32 ; 0x16366 <__umulhisi3>00016386 <__usmulhisi3_tail>:16386: b7 ff sbrs r27, 716388: 08 95 ret1638a: 82 1b sub r24, r181638c: 93 0b sbc r25, r191638e: 08 95 ret00016390 <__muluhisi3>:16390: ea df rcall .-44 ; 0x16366 <__umulhisi3>16392: a5 9f mul r26, r2116394: 90 0d add r25, r016396: b4 9f mul r27, r2016398: 90 0d add r25, r01639a: a4 9f mul r26, r201639c: 80 0d add r24, r01639e: 91 1d adc r25, r1163a0: 11 24 eor r1, r1163a2: 08 95 ret000163a4 <__mulshisi3>:163a4: b7 ff sbrs r27, 7163a6: f4 cf rjmp .-24 ; 0x16390 <__muluhisi3>000163a8 <__mulohisi3>:163a8: f3 df rcall .-26 ; 0x16390 <__muluhisi3>163aa: 82 1b sub r24, r18163ac: 93 0b sbc r25, r19163ae: 08 95 ret000163b0 <__prologue_saves__>:163b0: 2f 92 push r2163b2: 3f 92 push r3163b4: 4f 92 push r4163b6: 5f 92 push r5163b8: 6f 92 push r6163ba: 7f 92 push r7163bc: 8f 92 push r8163be: 9f 92 push r9163c0: af 92 push r10163c2: bf 92 push r11163c4: cf 92 push r12163c6: df 92 push r13163c8: ef 92 push r14163ca: ff 92 push r15163cc: 0f 93 push r16163ce: 1f 93 push r17163d0: cf 93 push r28163d2: df 93 push r29163d4: cd b7 in r28, 0x3d ; 61163d6: de b7 in r29, 0x3e ; 62163d8: ca 1b sub r28, r26163da: db 0b sbc r29, r27163dc: 0f b6 in r0, 0x3f ; 63163de: f8 94 cli163e0: de bf out 0x3e, r29 ; 62163e2: 0f be out 0x3f, r0 ; 63163e4: cd bf out 0x3d, r28 ; 61163e6: 09 94 ijmp000163e8 <__epilogue_restores__>:163e8: 2a 88 ldd r2, Y+18 ; 0x12163ea: 39 88 ldd r3, Y+17 ; 0x11163ec: 48 88 ldd r4, Y+16 ; 0x10163ee: 5f 84 ldd r5, Y+15 ; 0x0f163f0: 6e 84 ldd r6, Y+14 ; 0x0e163f2: 7d 84 ldd r7, Y+13 ; 0x0d163f4: 8c 84 ldd r8, Y+12 ; 0x0c163f6: 9b 84 ldd r9, Y+11 ; 0x0b163f8: aa 84 ldd r10, Y+10 ; 0x0a163fa: b9 84 ldd r11, Y+9 ; 0x09163fc: c8 84 ldd r12, Y+8 ; 0x08163fe: df 80 ldd r13, Y+7 ; 0x0716400: ee 80 ldd r14, Y+6 ; 0x0616402: fd 80 ldd r15, Y+5 ; 0x0516404: 0c 81 ldd r16, Y+4 ; 0x0416406: 1b 81 ldd r17, Y+3 ; 0x0316408: aa 81 ldd r26, Y+2 ; 0x021640a: b9 81 ldd r27, Y+1 ; 0x011640c: ce 0f add r28, r301640e: d1 1d adc r29, r116410: 0f b6 in r0, 0x3f ; 6316412: f8 94 cli16414: de bf out 0x3e, r29 ; 6216416: 0f be out 0x3f, r0 ; 6316418: cd bf out 0x3d, r28 ; 611641a: ed 01 movw r28, r261641c: 08 95 ret0001641e <memcpy_P>:1641e: fb 01 movw r30, r2216420: dc 01 movw r26, r2416422: 02 c0 rjmp .+4 ; 0x16428 <memcpy_P+0xa>16424: 05 90 lpm r0, Z+16426: 0d 92 st X+, r016428: 41 50 subi r20, 0x01 ; 11642a: 50 40 sbci r21, 0x00 ; 01642c: d8 f7 brcc .-10 ; 0x16424 <memcpy_P+0x6>1642e: 08 95 ret00016430 <memchr>:16430: fc 01 movw r30, r2416432: 41 50 subi r20, 0x01 ; 116434: 50 40 sbci r21, 0x00 ; 016436: 30 f0 brcs .+12 ; 0x16444 <memchr+0x14>16438: 01 90 ld r0, Z+1643a: 06 16 cp r0, r221643c: d1 f7 brne .-12 ; 0x16432 <memchr+0x2>1643e: 31 97 sbiw r30, 0x01 ; 116440: cf 01 movw r24, r3016442: 08 95 ret16444: 88 27 eor r24, r2416446: 99 27 eor r25, r2516448: 08 95 ret0001644a <memcpy>:1644a: fb 01 movw r30, r221644c: dc 01 movw r26, r241644e: 02 c0 rjmp .+4 ; 0x16454 <memcpy+0xa>16450: 01 90 ld r0, Z+16452: 0d 92 st X+, r016454: 41 50 subi r20, 0x01 ; 116456: 50 40 sbci r21, 0x00 ; 016458: d8 f7 brcc .-10 ; 0x16450 <memcpy+0x6>1645a: 08 95 ret0001645c <__eerd_block_m1284>:1645c: dc 01 movw r26, r241645e: cb 01 movw r24, r2200016460 <__eerd_blraw_m1284>:16460: fc 01 movw r30, r2416462: f9 99 sbic 0x1f, 1 ; 3116464: fe cf rjmp .-4 ; 0x16462 <__eerd_blraw_m1284+0x2>16466: 06 c0 rjmp .+12 ; 0x16474 <__eerd_blraw_m1284+0x14>16468: f2 bd out 0x22, r31 ; 341646a: e1 bd out 0x21, r30 ; 331646c: f8 9a sbi 0x1f, 0 ; 311646e: 31 96 adiw r30, 0x01 ; 116470: 00 b4 in r0, 0x20 ; 3216472: 0d 92 st X+, r016474: 41 50 subi r20, 0x01 ; 116476: 50 40 sbci r21, 0x00 ; 016478: b8 f7 brcc .-18 ; 0x16468 <__eerd_blraw_m1284+0x8>1647a: 08 95 ret0001647c <__eerd_byte_m1284>:1647c: f9 99 sbic 0x1f, 1 ; 311647e: fe cf rjmp .-4 ; 0x1647c <__eerd_byte_m1284>16480: 92 bd out 0x22, r25 ; 3416482: 81 bd out 0x21, r24 ; 3316484: f8 9a sbi 0x1f, 0 ; 3116486: 99 27 eor r25, r2516488: 80 b5 in r24, 0x20 ; 321648a: 08 95 ret0001648c <__eerd_word_m1284>:1648c: a8 e1 ldi r26, 0x18 ; 241648e: b0 e0 ldi r27, 0x00 ; 016490: 42 e0 ldi r20, 0x02 ; 216492: 50 e0 ldi r21, 0x00 ; 016494: e5 cf rjmp .-54 ; 0x16460 <__eerd_blraw_m1284>00016496 <__eewr_block_m1284>:16496: dc 01 movw r26, r2416498: cb 01 movw r24, r221649a: 02 c0 rjmp .+4 ; 0x164a0 <__eewr_block_m1284+0xa>1649c: 2d 91 ld r18, X+1649e: 05 d0 rcall .+10 ; 0x164aa <__eewr_r18_m1284>164a0: 41 50 subi r20, 0x01 ; 1164a2: 50 40 sbci r21, 0x00 ; 0164a4: d8 f7 brcc .-10 ; 0x1649c <__eewr_block_m1284+0x6>164a6: 08 95 ret000164a8 <__eewr_byte_m1284>:164a8: 26 2f mov r18, r22000164aa <__eewr_r18_m1284>:164aa: f9 99 sbic 0x1f, 1 ; 31164ac: fe cf rjmp .-4 ; 0x164aa <__eewr_r18_m1284>164ae: 1f ba out 0x1f, r1 ; 31164b0: 92 bd out 0x22, r25 ; 34164b2: 81 bd out 0x21, r24 ; 33164b4: 20 bd out 0x20, r18 ; 32164b6: 0f b6 in r0, 0x3f ; 63164b8: f8 94 cli164ba: fa 9a sbi 0x1f, 2 ; 31164bc: f9 9a sbi 0x1f, 1 ; 31164be: 0f be out 0x3f, r0 ; 63164c0: 01 96 adiw r24, 0x01 ; 1164c2: 08 95 ret000164c4 <__eewr_word_m1284>:164c4: f1 df rcall .-30 ; 0x164a8 <__eewr_byte_m1284>164c6: 27 2f mov r18, r23164c8: f0 cf rjmp .-32 ; 0x164aa <__eewr_r18_m1284>000164ca <_exit>:164ca: f8 94 cli000164cc <__stop_program>:164cc: ff cf rjmp .-2 ; 0x164cc <__stop_program>