Go to most recent revision | Details | Last modification | View Log | RSS feed
| Rev | Author | Line No. | Line |
|---|---|---|---|
| 1997 | - | 1 | 1 .file "main.c" |
| 2 | 2 .arch atmega1284p |
||
| 3 | 3 __SREG__ = 0x3f |
||
| 4 | 4 __SP_H__ = 0x3e |
||
| 5 | 5 __SP_L__ = 0x3d |
||
| 6 | 6 __tmp_reg__ = 0 |
||
| 7 | 7 __zero_reg__ = 1 |
||
| 8 | 8 .global __do_copy_data |
||
| 9 | 9 .global __do_clear_bss |
||
| 10 | 10 .global JetiBeep |
||
| 11 | 11 .global JetiBeep |
||
| 12 | 12 .section .bss |
||
| 13 | 15 JetiBeep: |
||
| 14 | 16 0000 00 .skip 1,0 |
||
| 15 | 17 .global FoundMotors |
||
| 16 | 18 .global FoundMotors |
||
| 17 | 21 FoundMotors: |
||
| 18 | 22 0001 00 .skip 1,0 |
||
| 19 | 23 .global FlugSekunden |
||
| 20 | 24 .global FlugSekunden |
||
| 21 | 27 FlugSekunden: |
||
| 22 | 28 0002 0000 .skip 2,0 |
||
| 23 | 29 .global FlugMinutenGesamt |
||
| 24 | 30 .global FlugMinutenGesamt |
||
| 25 | 33 FlugMinutenGesamt: |
||
| 26 | 34 0004 0000 .skip 2,0 |
||
| 27 | 35 .global FlugMinuten |
||
| 28 | 36 .global FlugMinuten |
||
| 29 | 39 FlugMinuten: |
||
| 30 | 40 0006 0000 .skip 2,0 |
||
| 31 | 41 .global BattLowVoltageWarning |
||
| 32 | 42 .data |
||
| 33 | 45 BattLowVoltageWarning: |
||
| 34 | 46 0000 5E .byte 94 |
||
| 35 | 47 .global SendVersionToNavi |
||
| 36 | 50 SendVersionToNavi: |
||
| 37 | 51 0001 01 .byte 1 |
||
| 38 | 52 .global PlatinenVersion |
||
| 39 | 55 PlatinenVersion: |
||
| 40 | 56 0002 0A .byte 10 |
||
| 41 | 57 .global DisableRcOffBeeping |
||
| 42 | 58 .global DisableRcOffBeeping |
||
| 43 | 59 .section .bss |
||
| 44 | 62 DisableRcOffBeeping: |
||
| 45 | 63 0008 00 .skip 1,0 |
||
| 46 | 64 .data |
||
| 47 | 67 stick.16: |
||
| 48 | 68 0003 01 .byte 1 |
||
| 49 | 69 .text |
||
| 50 | 70 .global CalMk3Mag |
||
| 51 | 72 CalMk3Mag: |
||
| 52 | 73 /* prologue: frame size=0 */ |
||
| 53 | 74 /* prologue end (size=0) */ |
||
| 54 | 75 0000 8091 0000 lds r24,EE_Parameter+1 |
||
| 55 | 76 0004 E82F mov r30,r24 |
||
| 56 | 77 0006 FF27 clr r31 |
||
| 57 | 78 0008 EE0F add r30,r30 |
||
| 58 | 79 000a FF1F adc r31,r31 |
||
| 59 | 80 000c E050 subi r30,lo8(-(PPM_in)) |
||
| 60 | 81 000e F040 sbci r31,hi8(-(PPM_in)) |
||
| 61 | 82 0010 8081 ld r24,Z |
||
| 62 | 83 0012 9181 ldd r25,Z+1 |
||
| 63 | 84 0014 8D5E subi r24,lo8(-19) |
||
| 64 | 85 0016 9F4F sbci r25,hi8(-19) |
||
| 65 | 86 0018 04F0 brlt .L2 |
||
| 66 | 87 001a 1092 0000 sts stick.16,__zero_reg__ |
||
| 67 | 88 .L2: |
||
| 68 | 89 001e 8081 ld r24,Z |
||
| 69 | 90 0020 9181 ldd r25,Z+1 |
||
| 70 | 91 0022 8A5B subi r24,lo8(-70) |
||
| 71 | 92 0024 9F4F sbci r25,hi8(-70) |
||
| 72 | 93 0026 04F4 brge .L3 |
||
| 73 | 94 0028 8091 0000 lds r24,stick.16 |
||
| 74 | 95 002c 8823 tst r24 |
||
| 75 | 96 002e 01F4 brne .L3 |
||
| 76 | 97 0030 81E0 ldi r24,lo8(1) |
||
| 77 | 98 0032 8093 0000 sts stick.16,r24 |
||
| 78 | 99 0036 8091 0000 lds r24,WinkelOut+6 |
||
| 79 | 100 003a 8F5F subi r24,lo8(-(1)) |
||
| 80 | 101 003c 8093 0000 sts WinkelOut+6,r24 |
||
| 81 | 102 0040 8530 cpi r24,lo8(5) |
||
| 82 | 103 0042 00F0 brlo .L4 |
||
| 83 | 104 0044 88EE ldi r24,lo8(1000) |
||
| 84 | 105 0046 93E0 ldi r25,hi8(1000) |
||
| 85 | 106 0048 9093 0000 sts (beeptime)+1,r25 |
||
| 86 | 107 004c 8093 0000 sts beeptime,r24 |
||
| 87 | 108 0050 00C0 rjmp .L3 |
||
| 88 | 109 .L4: |
||
| 89 | 110 0052 66E9 ldi r22,lo8(150) |
||
| 90 | 111 0054 70E0 ldi r23,hi8(150) |
||
| 91 | 112 0056 0E94 0000 call Piep |
||
| 92 | 113 .L3: |
||
| 93 | 114 005a 8091 0000 lds r24,WinkelOut+6 |
||
| 94 | 115 005e 9927 clr r25 |
||
| 95 | 116 0060 9093 0000 sts (DebugOut+40)+1,r25 |
||
| 96 | 117 0064 8093 0000 sts DebugOut+40,r24 |
||
| 97 | 118 /* epilogue: frame size=0 */ |
||
| 98 | 119 0068 0895 ret |
||
| 99 | 120 /* epilogue end (size=1) */ |
||
| 100 | 121 /* function CalMk3Mag size 55 (54) */ |
||
| 101 | 123 .section .progmem.data,"a",@progbits |
||
| 102 | 126 __c.13: |
||
| 103 | 127 0000 0A0D 4261 .string "\n\rBatt:" |
||
| 104 | 127 7474 3A00 |
||
| 105 | 130 __c.14: |
||
| 106 | 131 0008 2025 6420 .string " %d Cells " |
||
| 107 | 131 4365 6C6C |
||
| 108 | 131 7320 00 |
||
| 109 | 134 __c.15: |
||
| 110 | 135 0013 4C6F 7720 .string "Low Batt level: %d.%d" |
||
| 111 | 135 4261 7474 |
||
| 112 | 135 206C 6576 |
||
| 113 | 135 656C 3A20 |
||
| 114 | 135 2564 2E25 |
||
| 115 | 136 .text |
||
| 116 | 137 .global LipoDetection |
||
| 117 | 139 LipoDetection: |
||
| 118 | 140 /* prologue: frame size=0 */ |
||
| 119 | 141 006a 1F93 push r17 |
||
| 120 | 142 006c CF93 push r28 |
||
| 121 | 143 006e DF93 push r29 |
||
| 122 | 144 /* prologue end (size=3) */ |
||
| 123 | 145 0070 182F mov r17,r24 |
||
| 124 | 146 0072 8823 tst r24 |
||
| 125 | 147 0074 01F0 breq .L7 |
||
| 126 | 148 0076 80E0 ldi r24,lo8(__c.13) |
||
| 127 | 149 0078 90E0 ldi r25,hi8(__c.13) |
||
| 128 | 150 007a 9F93 push r25 |
||
| 129 | 151 007c 8F93 push r24 |
||
| 130 | 152 007e 80E0 ldi r24,lo8(pm(uart_putchar)) |
||
| 131 | 153 0080 90E0 ldi r25,hi8(pm(uart_putchar)) |
||
| 132 | 154 0082 9F93 push r25 |
||
| 133 | 155 0084 8F93 push r24 |
||
| 134 | 156 0086 E091 0000 lds r30,_printf_P |
||
| 135 | 157 008a F091 0000 lds r31,(_printf_P)+1 |
||
| 136 | 158 008e 0995 icall |
||
| 137 | 159 0090 0F90 pop __tmp_reg__ |
||
| 138 | 160 0092 0F90 pop __tmp_reg__ |
||
| 139 | 161 0094 0F90 pop __tmp_reg__ |
||
| 140 | 162 0096 0F90 pop __tmp_reg__ |
||
| 141 | 163 .L7: |
||
| 142 | 164 0098 8091 0000 lds r24,EE_Parameter+36 |
||
| 143 | 165 009c 8233 cpi r24,lo8(50) |
||
| 144 | 166 009e 00F0 brlo .+2 |
||
| 145 | 167 00a0 00C0 rjmp .L8 |
||
| 146 | 168 00a2 84EF ldi r24,lo8(500) |
||
| 147 | 169 00a4 91E0 ldi r25,hi8(500) |
||
| 148 | 170 00a6 0E94 0000 call SetDelay |
||
| 149 | 171 00aa EC01 movw r28,r24 |
||
| 150 | 172 00ac 1123 tst r17 |
||
| 151 | 173 00ae 01F0 breq .L9 |
||
| 152 | 174 .L10: |
||
| 153 | 175 00b0 CE01 movw r24,r28 |
||
| 154 | 176 00b2 0E94 0000 call CheckDelay |
||
| 155 | 177 00b6 8823 tst r24 |
||
| 156 | 178 00b8 01F0 breq .L10 |
||
| 157 | 179 .L9: |
||
| 158 | 180 00ba C2E0 ldi r28,lo8(2) |
||
| 159 | 181 00bc D0E0 ldi r29,hi8(2) |
||
| 160 | 182 00be 26E5 ldi r18,lo8(86) |
||
| 161 | 183 00c0 30E0 ldi r19,hi8(86) |
||
| 162 | 184 .L17: |
||
| 163 | 185 00c2 8091 0000 lds r24,UBat |
||
| 164 | 186 00c6 9091 0000 lds r25,(UBat)+1 |
||
| 165 | 187 00ca 8217 cp r24,r18 |
||
| 166 | 188 00cc 9307 cpc r25,r19 |
||
| 167 | 189 00ce 00F0 brlo .L14 |
||
| 168 | 190 00d0 2196 adiw r28,1 |
||
| 169 | 191 00d2 255D subi r18,lo8(-(43)) |
||
| 170 | 192 00d4 3F4F sbci r19,hi8(-(43)) |
||
| 171 | 193 00d6 C730 cpi r28,7 |
||
| 172 | 194 00d8 D105 cpc r29,__zero_reg__ |
||
| 173 | 195 00da 00F0 brlo .L17 |
||
| 174 | 196 .L14: |
||
| 175 | 197 00dc 8091 0000 lds r24,EE_Parameter+36 |
||
| 176 | 198 00e0 9927 clr r25 |
||
| 177 | 199 00e2 C89F mul r28,r24 |
||
| 178 | 200 00e4 9001 movw r18,r0 |
||
| 179 | 201 00e6 C99F mul r28,r25 |
||
| 180 | 202 00e8 300D add r19,r0 |
||
| 181 | 203 00ea D89F mul r29,r24 |
||
| 182 | 204 00ec 300D add r19,r0 |
||
| 183 | 205 00ee 1124 clr r1 |
||
| 184 | 206 00f0 2093 0000 sts BattLowVoltageWarning,r18 |
||
| 185 | 207 00f4 1123 tst r17 |
||
| 186 | 208 00f6 01F0 breq .L19 |
||
| 187 | 209 00f8 68EC ldi r22,lo8(200) |
||
| 188 | 210 00fa 70E0 ldi r23,hi8(200) |
||
| 189 | 211 00fc 8C2F mov r24,r28 |
||
| 190 | 212 00fe 0E94 0000 call Piep |
||
| 191 | 213 0102 DF93 push r29 |
||
| 192 | 214 0104 CF93 push r28 |
||
| 193 | 215 0106 80E0 ldi r24,lo8(__c.14) |
||
| 194 | 216 0108 90E0 ldi r25,hi8(__c.14) |
||
| 195 | 217 010a 9F93 push r25 |
||
| 196 | 218 010c 8F93 push r24 |
||
| 197 | 219 010e 80E0 ldi r24,lo8(pm(uart_putchar)) |
||
| 198 | 220 0110 90E0 ldi r25,hi8(pm(uart_putchar)) |
||
| 199 | 221 0112 9F93 push r25 |
||
| 200 | 222 0114 8F93 push r24 |
||
| 201 | 223 0116 E091 0000 lds r30,_printf_P |
||
| 202 | 224 011a F091 0000 lds r31,(_printf_P)+1 |
||
| 203 | 225 011e 0995 icall |
||
| 204 | 226 0120 8DB7 in r24,__SP_L__ |
||
| 205 | 227 0122 9EB7 in r25,__SP_H__ |
||
| 206 | 228 0124 0696 adiw r24,6 |
||
| 207 | 229 0126 8DBF out __SP_L__,r24 |
||
| 208 | 230 0128 00C0 rjmp .L19 |
||
| 209 | 231 .L8: |
||
| 210 | 232 012a 8093 0000 sts BattLowVoltageWarning,r24 |
||
| 211 | 233 .L19: |
||
| 212 | 234 012e 1123 tst r17 |
||
| 213 | 235 0130 01F0 breq .L6 |
||
| 214 | 236 0132 8091 0000 lds r24,BattLowVoltageWarning |
||
| 215 | 237 0136 6AE0 ldi r22,lo8(10) |
||
| 216 | 238 0138 0E94 0000 call __udivmodqi4 |
||
| 217 | 239 013c 892F mov r24,r25 |
||
| 218 | 240 013e 9927 clr r25 |
||
| 219 | 241 0140 9F93 push r25 |
||
| 220 | 242 0142 8F93 push r24 |
||
| 221 | 243 0144 8091 0000 lds r24,BattLowVoltageWarning |
||
| 222 | 244 0148 0E94 0000 call __udivmodqi4 |
||
| 223 | 245 014c 9927 clr r25 |
||
| 224 | 246 014e 9F93 push r25 |
||
| 225 | 247 0150 8F93 push r24 |
||
| 226 | 248 0152 80E0 ldi r24,lo8(__c.15) |
||
| 227 | 249 0154 90E0 ldi r25,hi8(__c.15) |
||
| 228 | 250 0156 9F93 push r25 |
||
| 229 | 251 0158 8F93 push r24 |
||
| 230 | 252 015a 80E0 ldi r24,lo8(pm(uart_putchar)) |
||
| 231 | 253 015c 90E0 ldi r25,hi8(pm(uart_putchar)) |
||
| 232 | 254 015e 9F93 push r25 |
||
| 233 | 255 0160 8F93 push r24 |
||
| 234 | 256 0162 E091 0000 lds r30,_printf_P |
||
| 235 | 257 0166 F091 0000 lds r31,(_printf_P)+1 |
||
| 236 | 258 016a 0995 icall |
||
| 237 | 259 016c 2DB7 in r18,__SP_L__ |
||
| 238 | 260 016e 3EB7 in r19,__SP_H__ |
||
| 239 | 261 0170 285F subi r18,lo8(-(8)) |
||
| 240 | 262 0172 3F4F sbci r19,hi8(-(8)) |
||
| 241 | 263 0174 2DBF out __SP_L__,r18 |
||
| 242 | 264 .L6: |
||
| 243 | 265 /* epilogue: frame size=0 */ |
||
| 244 | 266 0176 DF91 pop r29 |
||
| 245 | 267 0178 CF91 pop r28 |
||
| 246 | 268 017a 1F91 pop r17 |
||
| 247 | 269 017c 0895 ret |
||
| 248 | 270 /* epilogue end (size=4) */ |
||
| 249 | 271 /* function LipoDetection size 138 (131) */ |
||
| 250 | 273 .section .progmem.data |
||
| 251 | 276 __c.0: |
||
| 252 | 277 0029 0A0D 466F .string "\n\rFound BL-Ctrl: " |
||
| 253 | 277 756E 6420 |
||
| 254 | 277 424C 2D43 |
||
| 255 | 277 7472 6C3A |
||
| 256 | 277 2000 |
||
| 257 | 280 __c.1: |
||
| 258 | 281 003b 2564 00 .string "%d" |
||
| 259 | 284 __c.2: |
||
| 260 | 285 003e 0A0D 0A0D .string "\n\r\n\r!!MISSING BL-CTRL: %d!!" |
||
| 261 | 285 2121 4D49 |
||
| 262 | 285 5353 494E |
||
| 263 | 285 4720 424C |
||
| 264 | 285 2D43 5452 |
||
| 265 | 288 __c.3: |
||
| 266 | 289 005a 0A0D 3D00 .string "\n\r=" |
||
| 267 | 292 __c.4: |
||
| 268 | 293 005e 0A0D 4361 .string "\n\rCal. pressure sensor" |
||
| 269 | 293 6C2E 2070 |
||
| 270 | 293 7265 7373 |
||
| 271 | 293 7572 6520 |
||
| 272 | 293 7365 6E73 |
||
| 273 | 296 __c.5: |
||
| 274 | 297 0075 4F4B 0A0D .string "OK\n\r" |
||
| 275 | 297 00 |
||
| 276 | 300 __c.6: |
||
| 277 | 301 007a 0A0D 466C .string "\n\rFlight-time %u min Total:%u min" |
||
| 278 | 301 6967 6874 |
||
| 279 | 301 2D74 696D |
||
| 280 | 301 6520 2575 |
||
| 281 | 301 206D 696E |
||
| 282 | 304 __c.7: |
||
| 283 | 305 009d 0A0D 436F .string "\n\rControl: " |
||
| 284 | 305 6E74 726F |
||
| 285 | 305 6C3A 2000 |
||
| 286 | 308 __c.8: |
||
| 287 | 309 00a9 4865 6164 .string "HeadingHold" |
||
| 288 | 309 696E 6748 |
||
| 289 | 309 6F6C 6400 |
||
| 290 | 312 __c.9: |
||
| 291 | 313 00b5 4E6F 726D .string "Normal (ACC-Mode)" |
||
| 292 | 313 616C 2028 |
||
| 293 | 313 4143 432D |
||
| 294 | 313 4D6F 6465 |
||
| 295 | 313 2900 |
||
| 296 | 316 __c.10: |
||
| 297 | 317 00c7 0A0D 3D0A .string "\n\r=\n\r" |
||
| 298 | 317 0D00 |
||
| 299 | 320 __c.11: |
||
| 300 | 321 00cd 0A0D .ascii "\n\r" |
||
| 301 | 322 00cf 4A45 5449 .string "JETI+ Version sponsored by Flyinghigh.ch, progammed by MartinW\n\r" |
||
| 302 | 322 2B20 5665 |
||
| 303 | 322 7273 696F |
||
| 304 | 322 6E20 7370 |
||
| 305 | 322 6F6E 736F |
||
| 306 | 323 .lcomm second.12,1 |
||
| 307 | 324 .text |
||
| 308 | 325 .global main |
||
| 309 | 327 main: |
||
| 310 | 328 /* prologue: frame size=0 */ |
||
| 311 | 329 017e C0E0 ldi r28,lo8(__stack - 0) |
||
| 312 | 330 0180 D0E0 ldi r29,hi8(__stack - 0) |
||
| 313 | 331 0182 DEBF out __SP_H__,r29 |
||
| 314 | 332 0184 CDBF out __SP_L__,r28 |
||
| 315 | 333 /* prologue end (size=4) */ |
||
| 316 | 334 0186 8824 clr r8 |
||
| 317 | 335 0188 9924 clr r9 |
||
| 318 | 336 018a 14B8 out 36-0x20,__zero_reg__ |
||
| 319 | 337 018c 15B8 out 37-0x20,__zero_reg__ |
||
| 320 | 338 018e B7EE ldi r27,lo8(999) |
||
| 321 | 339 0190 EB2E mov r14,r27 |
||
| 322 | 340 0192 B3E0 ldi r27,hi8(999) |
||
| 323 | 341 0194 FB2E mov r15,r27 |
||
| 324 | 342 .L26: |
||
| 325 | 343 0196 8EEC ldi r24,lo8(-50) |
||
| 326 | 344 0198 9FEF ldi r25,hi8(-50) |
||
| 327 | 345 019a E80E add r14,r24 |
||
| 328 | 346 019c F91E adc r15,r25 |
||
| 329 | 347 019e F7FE sbrs r15,7 |
||
| 330 | 348 01a0 00C0 rjmp .L26 |
||
| 331 | 349 01a2 85E1 ldi r24,lo8(21) |
||
| 332 | 350 01a4 8093 0000 sts PlatinenVersion,r24 |
||
| 333 | 351 01a8 81E8 ldi r24,lo8(-127) |
||
| 334 | 352 01aa 87B9 out 39-0x20,r24 |
||
| 335 | 353 01ac 3E9A sbi 39-0x20,6 |
||
| 336 | 354 01ae 8FEF ldi r24,lo8(-1) |
||
| 337 | 355 01b0 88B9 out 40-0x20,r24 |
||
| 338 | 356 01b2 8BE1 ldi r24,lo8(27) |
||
| 339 | 357 01b4 84B9 out 36-0x20,r24 |
||
| 340 | 358 01b6 11E0 ldi r17,lo8(1) |
||
| 341 | 359 01b8 15B9 out 37-0x20,r17 |
||
| 342 | 360 01ba 8EE3 ldi r24,lo8(62) |
||
| 343 | 361 01bc 8AB9 out 42-0x20,r24 |
||
| 344 | 362 01be 87E4 ldi r24,lo8(71) |
||
| 345 | 363 01c0 8BB9 out 43-0x20,r24 |
||
| 346 | 364 01c2 469A sbi 40-0x20,6 |
||
| 347 | 365 01c4 84B7 in r24,84-0x20 |
||
| 348 | 366 01c6 877F andi r24,lo8(-9) |
||
| 349 | 367 01c8 84BF out 84-0x20,r24 |
||
| 350 | 368 01ca 8091 6000 lds r24,96 |
||
| 351 | 369 01ce 8861 ori r24,lo8(24) |
||
| 352 | 370 01d0 8093 6000 sts 96,r24 |
||
| 353 | 371 01d4 1092 6000 sts 96,__zero_reg__ |
||
| 354 | 372 01d8 84EC ldi r24,lo8(2500) |
||
| 355 | 373 01da 99E0 ldi r25,hi8(2500) |
||
| 356 | 374 01dc 9093 0000 sts (beeptime)+1,r25 |
||
| 357 | 375 01e0 8093 0000 sts beeptime,r24 |
||
| 358 | 376 01e4 1092 0000 sts (StickGier)+1,__zero_reg__ |
||
| 359 | 377 01e8 1092 0000 sts StickGier,__zero_reg__ |
||
| 360 | 378 01ec 1092 0000 sts (PPM_in+4)+1,__zero_reg__ |
||
| 361 | 379 01f0 1092 0000 sts PPM_in+4,__zero_reg__ |
||
| 362 | 380 01f4 1092 0000 sts (StickRoll)+1,__zero_reg__ |
||
| 363 | 381 01f8 1092 0000 sts StickRoll,__zero_reg__ |
||
| 364 | 382 01fc 1092 0000 sts (StickNick)+1,__zero_reg__ |
||
| 365 | 383 0200 1092 0000 sts StickNick,__zero_reg__ |
||
| 366 | 384 0204 84EC ldi r24,lo8(1220) |
||
| 367 | 385 0206 94E0 ldi r25,hi8(1220) |
||
| 368 | 386 0208 A0E0 ldi r26,hlo8(1220) |
||
| 369 | 387 020a B0E0 ldi r27,hhi8(1220) |
||
| 370 | 388 020c 8093 0000 sts GIER_GRAD_FAKTOR,r24 |
||
| 371 | 389 0210 9093 0000 sts (GIER_GRAD_FAKTOR)+1,r25 |
||
| 372 | 390 0214 A093 0000 sts (GIER_GRAD_FAKTOR)+2,r26 |
||
| 373 | 391 0218 B093 0000 sts (GIER_GRAD_FAKTOR)+3,r27 |
||
| 374 | 392 021c 2898 cbi 37-0x20,0 |
||
| 375 | 393 021e 0E94 0000 call Timer_Init |
||
| 376 | 394 0222 0E94 0000 call TIMER2_Init |
||
| 377 | 395 0226 0E94 0000 call UART_Init |
||
| 378 | 396 022a 0E94 0000 call rc_sum_init |
||
| 379 | 397 022e 0E94 0000 call ADC_Init |
||
| 380 | 398 0232 812F mov r24,r17 |
||
| 381 | 399 0234 0E94 0000 call I2C_Init |
||
| 382 | 400 0238 0E94 0000 call SPI_MasterInit |
||
| 383 | 401 023c 0E94 0000 call LIBFC_Init |
||
| 384 | 402 0240 8091 0000 lds r24,PlatinenVersion |
||
| 385 | 403 0244 8C30 cpi r24,lo8(12) |
||
| 386 | 404 0246 00F4 brsh .L32 |
||
| 387 | 405 0248 299A sbi 37-0x20,1 |
||
| 388 | 406 024a 00C0 rjmp .L33 |
||
| 389 | 407 .L32: |
||
| 390 | 408 024c 2998 cbi 37-0x20,1 |
||
| 391 | 409 .L33: |
||
| 392 | 410 /* #APP */ |
||
| 393 | 411 024e 7894 sei |
||
| 394 | 412 /* #NOAPP */ |
||
| 395 | 413 0250 0E94 0000 call ParamSet_Init |
||
| 396 | 414 0254 0E94 0000 call Capacity_Init |
||
| 397 | 415 0258 8091 0000 lds r24,BLFlags |
||
| 398 | 416 025c 8260 ori r24,lo8(2) |
||
| 399 | 417 025e 8093 0000 sts BLFlags,r24 |
||
| 400 | 418 0262 1092 0000 sts motor_read,__zero_reg__ |
||
| 401 | 419 0266 0E94 0000 call SendMotorData |
||
| 402 | 420 026a 84EF ldi r24,lo8(500) |
||
| 403 | 421 026c 91E0 ldi r25,hi8(500) |
||
| 404 | 422 026e 0E94 0000 call SetDelay |
||
| 405 | 423 0272 7C01 movw r14,r24 |
||
| 406 | 424 .L34: |
||
| 407 | 425 0274 8091 0000 lds r24,BLFlags |
||
| 408 | 426 0278 80FD sbrc r24,0 |
||
| 409 | 427 027a 00C0 rjmp .L35 |
||
| 410 | 428 027c C701 movw r24,r14 |
||
| 411 | 429 027e 0E94 0000 call CheckDelay |
||
| 412 | 430 0282 8823 tst r24 |
||
| 413 | 431 0284 01F0 breq .L34 |
||
| 414 | 432 .L35: |
||
| 415 | 433 0286 80E0 ldi r24,lo8(__c.0) |
||
| 416 | 434 0288 90E0 ldi r25,hi8(__c.0) |
||
| 417 | 435 028a 9F93 push r25 |
||
| 418 | 436 028c 8F93 push r24 |
||
| 419 | 437 028e A0E0 ldi r26,lo8(pm(uart_putchar)) |
||
| 420 | 438 0290 AA2E mov r10,r26 |
||
| 421 | 439 0292 A0E0 ldi r26,hi8(pm(uart_putchar)) |
||
| 422 | 440 0294 BA2E mov r11,r26 |
||
| 423 | 441 0296 BF92 push r11 |
||
| 424 | 442 0298 AF92 push r10 |
||
| 425 | 443 029a E091 0000 lds r30,_printf_P |
||
| 426 | 444 029e F091 0000 lds r31,(_printf_P)+1 |
||
| 427 | 445 02a2 0995 icall |
||
| 428 | 446 02a4 80EA ldi r24,lo8(4000) |
||
| 429 | 447 02a6 9FE0 ldi r25,hi8(4000) |
||
| 430 | 448 02a8 0E94 0000 call SetDelay |
||
| 431 | 449 02ac 7C01 movw r14,r24 |
||
| 432 | 450 02ae 00E0 ldi r16,lo8(0) |
||
| 433 | 451 02b0 10E0 ldi r17,hi8(0) |
||
| 434 | 452 02b2 0F90 pop __tmp_reg__ |
||
| 435 | 453 02b4 0F90 pop __tmp_reg__ |
||
| 436 | 454 02b6 0F90 pop __tmp_reg__ |
||
| 437 | 455 02b8 0F90 pop __tmp_reg__ |
||
| 438 | 456 02ba C0E0 ldi r28,lo8(Motor+3) |
||
| 439 | 457 02bc D0E0 ldi r29,hi8(Motor+3) |
||
| 440 | 458 02be F0E0 ldi r31,lo8(Mixer+13) |
||
| 441 | 459 02c0 CF2E mov r12,r31 |
||
| 442 | 460 02c2 F0E0 ldi r31,hi8(Mixer+13) |
||
| 443 | 461 02c4 DF2E mov r13,r31 |
||
| 444 | 462 .L51: |
||
| 445 | 463 02c6 0E94 0000 call SendMotorData |
||
| 446 | 464 .L40: |
||
| 447 | 465 02ca 8091 0000 lds r24,BLFlags |
||
| 448 | 466 02ce 80FD sbrc r24,0 |
||
| 449 | 467 02d0 00C0 rjmp .L41 |
||
| 450 | 468 02d2 C701 movw r24,r14 |
||
| 451 | 469 02d4 0E94 0000 call CheckDelay |
||
| 452 | 470 02d8 8823 tst r24 |
||
| 453 | 471 02da 01F0 breq .L40 |
||
| 454 | 472 .L41: |
||
| 455 | 473 02dc F601 movw r30,r12 |
||
| 456 | 474 02de 8081 ld r24,Z |
||
| 457 | 475 02e0 1816 cp __zero_reg__,r24 |
||
| 458 | 476 02e2 04F4 brge .L43 |
||
| 459 | 477 02e4 00C0 rjmp .L230 |
||
| 460 | 478 .L49: |
||
| 461 | 479 02e6 0E94 0000 call SendMotorData |
||
| 462 | 480 .L46: |
||
| 463 | 481 02ea 8091 0000 lds r24,BLFlags |
||
| 464 | 482 02ee 80FD sbrc r24,0 |
||
| 465 | 483 02f0 00C0 rjmp .L230 |
||
| 466 | 484 02f2 C701 movw r24,r14 |
||
| 467 | 485 02f4 0E94 0000 call CheckDelay |
||
| 468 | 486 02f8 8823 tst r24 |
||
| 469 | 487 02fa 01F0 breq .L46 |
||
| 470 | 488 .L230: |
||
| 471 | 489 02fc C701 movw r24,r14 |
||
| 472 | 490 02fe 0E94 0000 call CheckDelay |
||
| 473 | 491 0302 8823 tst r24 |
||
| 474 | 492 0304 01F4 brne .L43 |
||
| 475 | 493 0306 8881 ld r24,Y |
||
| 476 | 494 0308 8823 tst r24 |
||
| 477 | 495 030a 04F4 brge .L49 |
||
| 478 | 496 .L43: |
||
| 479 | 497 030c 8881 ld r24,Y |
||
| 480 | 498 030e 87FF sbrs r24,7 |
||
| 481 | 499 0310 00C0 rjmp .L39 |
||
| 482 | 500 0312 0F5F subi r16,lo8(-(1)) |
||
| 483 | 501 0314 1F4F sbci r17,hi8(-(1)) |
||
| 484 | 502 0316 1F93 push r17 |
||
| 485 | 503 0318 0F93 push r16 |
||
| 486 | 504 031a 0150 subi r16,lo8(-(-1)) |
||
| 487 | 505 031c 1040 sbci r17,hi8(-(-1)) |
||
| 488 | 506 031e 80E0 ldi r24,lo8(__c.1) |
||
| 489 | 507 0320 90E0 ldi r25,hi8(__c.1) |
||
| 490 | 508 0322 9F93 push r25 |
||
| 491 | 509 0324 8F93 push r24 |
||
| 492 | 510 0326 BF92 push r11 |
||
| 493 | 511 0328 AF92 push r10 |
||
| 494 | 512 032a E091 0000 lds r30,_printf_P |
||
| 495 | 513 032e F091 0000 lds r31,(_printf_P)+1 |
||
| 496 | 514 0332 0995 icall |
||
| 497 | 515 0334 8091 0000 lds r24,FoundMotors |
||
| 498 | 516 0338 8F5F subi r24,lo8(-(1)) |
||
| 499 | 517 033a 8093 0000 sts FoundMotors,r24 |
||
| 500 | 518 033e 8DB7 in r24,__SP_L__ |
||
| 501 | 519 0340 9EB7 in r25,__SP_H__ |
||
| 502 | 520 0342 0696 adiw r24,6 |
||
| 503 | 521 0344 8DBF out __SP_L__,r24 |
||
| 504 | 522 .L39: |
||
| 505 | 523 0346 0F5F subi r16,lo8(-(1)) |
||
| 506 | 524 0348 1F4F sbci r17,hi8(-(1)) |
||
| 507 | 525 034a E4E0 ldi r30,lo8(4) |
||
| 508 | 526 034c F0E0 ldi r31,hi8(4) |
||
| 509 | 527 034e CE0E add r12,r30 |
||
| 510 | 528 0350 DF1E adc r13,r31 |
||
| 511 | 529 0352 2896 adiw r28,8 |
||
| 512 | 530 0354 0C30 cpi r16,12 |
||
| 513 | 531 0356 1105 cpc r17,__zero_reg__ |
||
| 514 | 532 0358 00F4 brsh .+2 |
||
| 515 | 533 035a 00C0 rjmp .L51 |
||
| 516 | 534 035c 00E0 ldi r16,lo8(0) |
||
| 517 | 535 035e 10E0 ldi r17,hi8(0) |
||
| 518 | 536 0360 C0E0 ldi r28,lo8(Motor) |
||
| 519 | 537 0362 D0E0 ldi r29,hi8(Motor) |
||
| 520 | 538 0364 E0E0 ldi r30,lo8(Mixer+13) |
||
| 521 | 539 0366 EE2E mov r14,r30 |
||
| 522 | 540 0368 E0E0 ldi r30,hi8(Mixer+13) |
||
| 523 | 541 036a FE2E mov r15,r30 |
||
| 524 | 542 .L56: |
||
| 525 | 543 036c 8B81 ldd r24,Y+3 |
||
| 526 | 544 036e 87FD sbrc r24,7 |
||
| 527 | 545 0370 00C0 rjmp .L55 |
||
| 528 | 546 0372 F701 movw r30,r14 |
||
| 529 | 547 0374 8081 ld r24,Z |
||
| 530 | 548 0376 1816 cp __zero_reg__,r24 |
||
| 531 | 549 0378 04F4 brge .L55 |
||
| 532 | 550 037a 0F5F subi r16,lo8(-(1)) |
||
| 533 | 551 037c 1F4F sbci r17,hi8(-(1)) |
||
| 534 | 552 037e 1F93 push r17 |
||
| 535 | 553 0380 0F93 push r16 |
||
| 536 | 554 0382 0150 subi r16,lo8(-(-1)) |
||
| 537 | 555 0384 1040 sbci r17,hi8(-(-1)) |
||
| 538 | 556 0386 80E0 ldi r24,lo8(__c.2) |
||
| 539 | 557 0388 90E0 ldi r25,hi8(__c.2) |
||
| 540 | 558 038a 9F93 push r25 |
||
| 541 | 559 038c 8F93 push r24 |
||
| 542 | 560 038e 80E0 ldi r24,lo8(pm(uart_putchar)) |
||
| 543 | 561 0390 90E0 ldi r25,hi8(pm(uart_putchar)) |
||
| 544 | 562 0392 9F93 push r25 |
||
| 545 | 563 0394 8F93 push r24 |
||
| 546 | 564 0396 E091 0000 lds r30,_printf_P |
||
| 547 | 565 039a F091 0000 lds r31,(_printf_P)+1 |
||
| 548 | 566 039e 0995 icall |
||
| 549 | 567 03a0 82E0 ldi r24,lo8(2) |
||
| 550 | 568 03a2 8093 0000 sts ServoActive,r24 |
||
| 551 | 569 03a6 8DB7 in r24,__SP_L__ |
||
| 552 | 570 03a8 9EB7 in r25,__SP_H__ |
||
| 553 | 571 03aa 0696 adiw r24,6 |
||
| 554 | 572 03ac 8DBF out __SP_L__,r24 |
||
| 555 | 573 .L55: |
||
| 556 | 574 03ae 8B81 ldd r24,Y+3 |
||
| 557 | 575 03b0 8078 andi r24,lo8(-128) |
||
| 558 | 576 03b2 8B83 std Y+3,r24 |
||
| 559 | 577 03b4 0F5F subi r16,lo8(-(1)) |
||
| 560 | 578 03b6 1F4F sbci r17,hi8(-(1)) |
||
| 561 | 579 03b8 E4E0 ldi r30,lo8(4) |
||
| 562 | 580 03ba F0E0 ldi r31,hi8(4) |
||
| 563 | 581 03bc EE0E add r14,r30 |
||
| 564 | 582 03be FF1E adc r15,r31 |
||
| 565 | 583 03c0 2896 adiw r28,8 |
||
| 566 | 584 03c2 0C30 cpi r16,12 |
||
| 567 | 585 03c4 1105 cpc r17,__zero_reg__ |
||
| 568 | 586 03c6 00F0 brlo .L56 |
||
| 569 | 587 03c8 80E0 ldi r24,lo8(__c.3) |
||
| 570 | 588 03ca 90E0 ldi r25,hi8(__c.3) |
||
| 571 | 589 03cc 9F93 push r25 |
||
| 572 | 590 03ce 8F93 push r24 |
||
| 573 | 591 03d0 C0E0 ldi r28,lo8(pm(uart_putchar)) |
||
| 574 | 592 03d2 D0E0 ldi r29,hi8(pm(uart_putchar)) |
||
| 575 | 593 03d4 DF93 push r29 |
||
| 576 | 594 03d6 CF93 push r28 |
||
| 577 | 595 03d8 E091 0000 lds r30,_printf_P |
||
| 578 | 596 03dc F091 0000 lds r31,(_printf_P)+1 |
||
| 579 | 597 03e0 0995 icall |
||
| 580 | 598 03e2 9091 0000 lds r25,RequiredMotors |
||
| 581 | 599 03e6 8091 0000 lds r24,FoundMotors |
||
| 582 | 600 03ea 0F90 pop __tmp_reg__ |
||
| 583 | 601 03ec 0F90 pop __tmp_reg__ |
||
| 584 | 602 03ee 0F90 pop __tmp_reg__ |
||
| 585 | 603 03f0 0F90 pop __tmp_reg__ |
||
| 586 | 604 03f2 9817 cp r25,r24 |
||
| 587 | 605 03f4 00F4 brsh .L57 |
||
| 588 | 606 03f6 8091 0000 lds r24,VersionInfo+6 |
||
| 589 | 607 03fa 8061 ori r24,lo8(16) |
||
| 590 | 608 03fc 8093 0000 sts VersionInfo+6,r24 |
||
| 591 | 609 .L57: |
||
| 592 | 610 0400 80E0 ldi r24,lo8(__c.4) |
||
| 593 | 611 0402 90E0 ldi r25,hi8(__c.4) |
||
| 594 | 612 0404 9F93 push r25 |
||
| 595 | 613 0406 8F93 push r24 |
||
| 596 | 614 0408 DF93 push r29 |
||
| 597 | 615 040a CF93 push r28 |
||
| 598 | 616 040c E091 0000 lds r30,_printf_P |
||
| 599 | 617 0410 F091 0000 lds r31,(_printf_P)+1 |
||
| 600 | 618 0414 0995 icall |
||
| 601 | 619 0416 88EE ldi r24,lo8(1000) |
||
| 602 | 620 0418 93E0 ldi r25,hi8(1000) |
||
| 603 | 621 041a 0E94 0000 call SetDelay |
||
| 604 | 622 041e 7C01 movw r14,r24 |
||
| 605 | 623 0420 0E94 0000 call SucheLuftruckOffset |
||
| 606 | 624 0424 0F90 pop __tmp_reg__ |
||
| 607 | 625 0426 0F90 pop __tmp_reg__ |
||
| 608 | 626 0428 0F90 pop __tmp_reg__ |
||
| 609 | 627 042a 0F90 pop __tmp_reg__ |
||
| 610 | 628 .L58: |
||
| 611 | 629 042c C701 movw r24,r14 |
||
| 612 | 630 042e 0E94 0000 call CheckDelay |
||
| 613 | 631 0432 8823 tst r24 |
||
| 614 | 632 0434 01F0 breq .L58 |
||
| 615 | 633 0436 80E0 ldi r24,lo8(__c.5) |
||
| 616 | 634 0438 90E0 ldi r25,hi8(__c.5) |
||
| 617 | 635 043a 9F93 push r25 |
||
| 618 | 636 043c 8F93 push r24 |
||
| 619 | 637 043e DF93 push r29 |
||
| 620 | 638 0440 CF93 push r28 |
||
| 621 | 639 0442 E091 0000 lds r30,_printf_P |
||
| 622 | 640 0446 F091 0000 lds r31,(_printf_P)+1 |
||
| 623 | 641 044a 0995 icall |
||
| 624 | 642 044c 80E0 ldi r24,lo8(0) |
||
| 625 | 643 044e 0E94 0000 call SetNeutral |
||
| 626 | 644 0452 8091 0000 lds r24,PlatinenVersion |
||
| 627 | 645 0456 0F90 pop __tmp_reg__ |
||
| 628 | 646 0458 0F90 pop __tmp_reg__ |
||
| 629 | 647 045a 0F90 pop __tmp_reg__ |
||
| 630 | 648 045c 0F90 pop __tmp_reg__ |
||
| 631 | 649 045e 8A30 cpi r24,lo8(10) |
||
| 632 | 650 0460 01F0 breq .L62 |
||
| 633 | 651 0462 8431 cpi r24,lo8(20) |
||
| 634 | 652 0464 00F0 brlo .L61 |
||
| 635 | 653 .L62: |
||
| 636 | 654 0466 2898 cbi 37-0x20,0 |
||
| 637 | 655 0468 00C0 rjmp .L63 |
||
| 638 | 656 .L61: |
||
| 639 | 657 046a 289A sbi 37-0x20,0 |
||
| 640 | 658 .L63: |
||
| 641 | 659 046c 80ED ldi r24,lo8(2000) |
||
| 642 | 660 046e 97E0 ldi r25,hi8(2000) |
||
| 643 | 661 0470 9093 0000 sts (beeptime)+1,r25 |
||
| 644 | 662 0474 8093 0000 sts beeptime,r24 |
||
| 645 | 663 0478 85E5 ldi r24,lo8(85) |
||
| 646 | 664 047a 8093 0000 sts ExternControl,r24 |
||
| 647 | 665 047e 8EE0 ldi r24,lo8(14) |
||
| 648 | 666 0480 90E0 ldi r25,hi8(14) |
||
| 649 | 667 0482 0E94 0000 call GetParamByte |
||
| 650 | 668 0486 9927 clr r25 |
||
| 651 | 669 0488 182F mov r17,r24 |
||
| 652 | 670 048a 0027 clr r16 |
||
| 653 | 671 048c 8FE0 ldi r24,lo8(15) |
||
| 654 | 672 048e 90E0 ldi r25,hi8(15) |
||
| 655 | 673 0490 0E94 0000 call GetParamByte |
||
| 656 | 674 0494 080F add r16,r24 |
||
| 657 | 675 0496 111D adc r17,__zero_reg__ |
||
| 658 | 676 0498 1093 0000 sts (FlugMinuten)+1,r17 |
||
| 659 | 677 049c 0093 0000 sts FlugMinuten,r16 |
||
| 660 | 678 04a0 8AE0 ldi r24,lo8(10) |
||
| 661 | 679 04a2 90E0 ldi r25,hi8(10) |
||
| 662 | 680 04a4 0E94 0000 call GetParamByte |
||
| 663 | 681 04a8 9927 clr r25 |
||
| 664 | 682 04aa 182F mov r17,r24 |
||
| 665 | 683 04ac 0027 clr r16 |
||
| 666 | 684 04ae 8BE0 ldi r24,lo8(11) |
||
| 667 | 685 04b0 90E0 ldi r25,hi8(11) |
||
| 668 | 686 04b2 0E94 0000 call GetParamByte |
||
| 669 | 687 04b6 080F add r16,r24 |
||
| 670 | 688 04b8 111D adc r17,__zero_reg__ |
||
| 671 | 689 04ba 1093 0000 sts (FlugMinutenGesamt)+1,r17 |
||
| 672 | 690 04be 0093 0000 sts FlugMinutenGesamt,r16 |
||
| 673 | 691 04c2 0F5F subi r16,lo8(-1) |
||
| 674 | 692 04c4 1F4F sbci r17,hi8(-1) |
||
| 675 | 693 04c6 01F0 breq .L65 |
||
| 676 | 694 04c8 8091 0000 lds r24,FlugMinuten |
||
| 677 | 695 04cc 9091 0000 lds r25,(FlugMinuten)+1 |
||
| 678 | 696 04d0 8F5F subi r24,lo8(-1) |
||
| 679 | 697 04d2 9F4F sbci r25,hi8(-1) |
||
| 680 | 698 04d4 01F4 brne .L64 |
||
| 681 | 699 .L65: |
||
| 682 | 700 04d6 1092 0000 sts (FlugMinuten)+1,__zero_reg__ |
||
| 683 | 701 04da 1092 0000 sts FlugMinuten,__zero_reg__ |
||
| 684 | 702 04de 1092 0000 sts (FlugMinutenGesamt)+1,__zero_reg__ |
||
| 685 | 703 04e2 1092 0000 sts FlugMinutenGesamt,__zero_reg__ |
||
| 686 | 704 .L64: |
||
| 687 | 705 04e6 8091 0000 lds r24,FlugMinutenGesamt |
||
| 688 | 706 04ea 9091 0000 lds r25,(FlugMinutenGesamt)+1 |
||
| 689 | 707 04ee 9F93 push r25 |
||
| 690 | 708 04f0 8F93 push r24 |
||
| 691 | 709 04f2 8091 0000 lds r24,FlugMinuten |
||
| 692 | 710 04f6 9091 0000 lds r25,(FlugMinuten)+1 |
||
| 693 | 711 04fa 9F93 push r25 |
||
| 694 | 712 04fc 8F93 push r24 |
||
| 695 | 713 04fe 80E0 ldi r24,lo8(__c.6) |
||
| 696 | 714 0500 90E0 ldi r25,hi8(__c.6) |
||
| 697 | 715 0502 9F93 push r25 |
||
| 698 | 716 0504 8F93 push r24 |
||
| 699 | 717 0506 DF93 push r29 |
||
| 700 | 718 0508 CF93 push r28 |
||
| 701 | 719 050a E091 0000 lds r30,_printf_P |
||
| 702 | 720 050e F091 0000 lds r31,(_printf_P)+1 |
||
| 703 | 721 0512 0995 icall |
||
| 704 | 722 0514 8DB7 in r24,__SP_L__ |
||
| 705 | 723 0516 9EB7 in r25,__SP_H__ |
||
| 706 | 724 0518 0896 adiw r24,8 |
||
| 707 | 725 051a 8DBF out __SP_L__,r24 |
||
| 708 | 726 051c 80E0 ldi r24,lo8(__c.7) |
||
| 709 | 727 051e 90E0 ldi r25,hi8(__c.7) |
||
| 710 | 728 0520 9F93 push r25 |
||
| 711 | 729 0522 8F93 push r24 |
||
| 712 | 730 0524 DF93 push r29 |
||
| 713 | 731 0526 CF93 push r28 |
||
| 714 | 732 0528 E091 0000 lds r30,_printf_P |
||
| 715 | 733 052c F091 0000 lds r31,(_printf_P)+1 |
||
| 716 | 734 0530 0995 icall |
||
| 717 | 735 0532 8091 0000 lds r24,EE_Parameter+13 |
||
| 718 | 736 0536 0F90 pop __tmp_reg__ |
||
| 719 | 737 0538 0F90 pop __tmp_reg__ |
||
| 720 | 738 053a 0F90 pop __tmp_reg__ |
||
| 721 | 739 053c 0F90 pop __tmp_reg__ |
||
| 722 | 740 053e E091 0000 lds r30,_printf_P |
||
| 723 | 741 0542 F091 0000 lds r31,(_printf_P)+1 |
||
| 724 | 742 0546 82FF sbrs r24,2 |
||
| 725 | 743 0548 00C0 rjmp .L66 |
||
| 726 | 744 054a 80E0 ldi r24,lo8(__c.8) |
||
| 727 | 745 054c 90E0 ldi r25,hi8(__c.8) |
||
| 728 | 746 054e 9F93 push r25 |
||
| 729 | 747 0550 8F93 push r24 |
||
| 730 | 748 0552 DF93 push r29 |
||
| 731 | 749 0554 CF93 push r28 |
||
| 732 | 750 0556 00C0 rjmp .L228 |
||
| 733 | 751 .L66: |
||
| 734 | 752 0558 80E0 ldi r24,lo8(__c.9) |
||
| 735 | 753 055a 90E0 ldi r25,hi8(__c.9) |
||
| 736 | 754 055c 9F93 push r25 |
||
| 737 | 755 055e 8F93 push r24 |
||
| 738 | 756 0560 80E0 ldi r24,lo8(pm(uart_putchar)) |
||
| 739 | 757 0562 90E0 ldi r25,hi8(pm(uart_putchar)) |
||
| 740 | 758 0564 9F93 push r25 |
||
| 741 | 759 0566 8F93 push r24 |
||
| 742 | 760 .L228: |
||
| 743 | 761 0568 0995 icall |
||
| 744 | 762 056a 0F90 pop __tmp_reg__ |
||
| 745 | 763 056c 0F90 pop __tmp_reg__ |
||
| 746 | 764 056e 0F90 pop __tmp_reg__ |
||
| 747 | 765 0570 0F90 pop __tmp_reg__ |
||
| 748 | 766 0572 0E94 0000 call LcdClear |
||
| 749 | 767 0576 88E8 ldi r24,lo8(5000) |
||
| 750 | 768 0578 93E1 ldi r25,hi8(5000) |
||
| 751 | 769 057a 9093 0000 sts (I2CTimeout)+1,r25 |
||
| 752 | 770 057e 8093 0000 sts I2CTimeout,r24 |
||
| 753 | 771 0582 11E0 ldi r17,lo8(1) |
||
| 754 | 772 0584 1093 0000 sts WinkelOut+7,r17 |
||
| 755 | 773 0588 812F mov r24,r17 |
||
| 756 | 774 058a 0E94 0000 call LipoDetection |
||
| 757 | 775 058e 8091 0000 lds r24,EE_Parameter+39 |
||
| 758 | 776 0592 0E94 0000 call LIBFC_ReceiverInit |
||
| 759 | 777 0596 80E0 ldi r24,lo8(__c.10) |
||
| 760 | 778 0598 90E0 ldi r25,hi8(__c.10) |
||
| 761 | 779 059a 9F93 push r25 |
||
| 762 | 780 059c 8F93 push r24 |
||
| 763 | 781 059e DF93 push r29 |
||
| 764 | 782 05a0 CF93 push r28 |
||
| 765 | 783 05a2 E091 0000 lds r30,_printf_P |
||
| 766 | 784 05a6 F091 0000 lds r31,(_printf_P)+1 |
||
| 767 | 785 05aa 0995 icall |
||
| 768 | 786 05ac 80ED ldi r24,lo8(2000) |
||
| 769 | 787 05ae 97E0 ldi r25,hi8(2000) |
||
| 770 | 788 05b0 0E94 0000 call SetDelay |
||
| 771 | 789 05b4 7C01 movw r14,r24 |
||
| 772 | 790 05b6 8AEF ldi r24,lo8(250) |
||
| 773 | 791 05b8 90E0 ldi r25,hi8(250) |
||
| 774 | 792 05ba 0E94 0000 call SetDelay |
||
| 775 | 793 05be 83E0 ldi r24,lo8(3) |
||
| 776 | 794 05c0 8093 0000 sts DebugOut,r24 |
||
| 777 | 795 05c4 1092 0000 sts JetiBeep,__zero_reg__ |
||
| 778 | 796 05c8 8091 0000 lds r24,EE_Parameter+106 |
||
| 779 | 797 05cc 0F90 pop __tmp_reg__ |
||
| 780 | 798 05ce 0F90 pop __tmp_reg__ |
||
| 781 | 799 05d0 0F90 pop __tmp_reg__ |
||
| 782 | 800 05d2 0F90 pop __tmp_reg__ |
||
| 783 | 801 05d4 84FF sbrs r24,4 |
||
| 784 | 802 05d6 00C0 rjmp .L68 |
||
| 785 | 803 05d8 1093 0000 sts DisableRcOffBeeping,r17 |
||
| 786 | 804 .L68: |
||
| 787 | 805 05dc 80E0 ldi r24,lo8(__c.11) |
||
| 788 | 806 05de 90E0 ldi r25,hi8(__c.11) |
||
| 789 | 807 05e0 9F93 push r25 |
||
| 790 | 808 05e2 8F93 push r24 |
||
| 791 | 809 05e4 80E0 ldi r24,lo8(pm(uart_putchar)) |
||
| 792 | 810 05e6 90E0 ldi r25,hi8(pm(uart_putchar)) |
||
| 793 | 811 05e8 9F93 push r25 |
||
| 794 | 812 05ea 8F93 push r24 |
||
| 795 | 813 05ec E091 0000 lds r30,_printf_P |
||
| 796 | 814 05f0 F091 0000 lds r31,(_printf_P)+1 |
||
| 797 | 815 05f4 0995 icall |
||
| 798 | 816 05f6 0F90 pop __tmp_reg__ |
||
| 799 | 817 05f8 0F90 pop __tmp_reg__ |
||
| 800 | 818 05fa 0F90 pop __tmp_reg__ |
||
| 801 | 819 05fc 0F90 pop __tmp_reg__ |
||
| 802 | 820 .L231: |
||
| 803 | 821 05fe 8091 0000 lds r24,ReceiverUpdateModeActive |
||
| 804 | 822 0602 8823 tst r24 |
||
| 805 | 823 0604 01F0 breq .L71 |
||
| 806 | 824 .L72: |
||
| 807 | 825 0606 4798 cbi 40-0x20,7 |
||
| 808 | 826 0608 00C0 rjmp .L72 |
||
| 809 | 827 .L71: |
||
| 810 | 828 060a 8091 0000 lds r24,UpdateMotor |
||
| 811 | 829 060e 8823 tst r24 |
||
| 812 | 830 0610 01F4 brne .+2 |
||
| 813 | 831 0612 00C0 rjmp .L74 |
||
| 814 | 832 0614 8091 0000 lds r24,AdReady |
||
| 815 | 833 0618 8823 tst r24 |
||
| 816 | 834 061a 01F4 brne .+2 |
||
| 817 | 835 061c 00C0 rjmp .L74 |
||
| 818 | 836 061e 1092 0000 sts UpdateMotor,__zero_reg__ |
||
| 819 | 837 0622 8091 0000 lds r24,WinkelOut+6 |
||
| 820 | 838 0626 8823 tst r24 |
||
| 821 | 839 0628 01F0 breq .L75 |
||
| 822 | 840 062a 0E94 0000 call CalMk3Mag |
||
| 823 | 841 062e 00C0 rjmp .L76 |
||
| 824 | 842 .L75: |
||
| 825 | 843 0630 0E94 0000 call MotorRegler |
||
| 826 | 844 .L76: |
||
| 827 | 845 0634 0E94 0000 call SendMotorData |
||
| 828 | 846 0638 2091 0000 lds r18,PlatinenVersion |
||
| 829 | 847 063c 2A30 cpi r18,lo8(10) |
||
| 830 | 848 063e 01F0 breq .L78 |
||
| 831 | 849 0640 2431 cpi r18,lo8(20) |
||
| 832 | 850 0642 00F0 brlo .L77 |
||
| 833 | 851 .L78: |
||
| 834 | 852 0644 2898 cbi 37-0x20,0 |
||
| 835 | 853 0646 00C0 rjmp .L79 |
||
| 836 | 854 .L77: |
||
| 837 | 855 0648 289A sbi 37-0x20,0 |
||
| 838 | 856 .L79: |
||
| 839 | 857 064a 8091 0000 lds r24,SenderOkay |
||
| 840 | 858 064e 8823 tst r24 |
||
| 841 | 859 0650 01F0 breq .L80 |
||
| 842 | 860 0652 8091 0000 lds r24,SenderOkay |
||
| 843 | 861 0656 8150 subi r24,lo8(-(-1)) |
||
| 844 | 862 0658 8093 0000 sts SenderOkay,r24 |
||
| 845 | 863 065c 00C0 rjmp .L81 |
||
| 846 | 864 .L80: |
||
| 847 | 865 065e 8091 6F00 lds r24,111 |
||
| 848 | 866 0662 8062 ori r24,lo8(32) |
||
| 849 | 867 0664 8093 6F00 sts 111,r24 |
||
| 850 | 868 0668 1092 0000 sts (PPM_in)+1,__zero_reg__ |
||
| 851 | 869 066c 1092 0000 sts PPM_in,__zero_reg__ |
||
| 852 | 870 0670 8091 0000 lds r24,VersionInfo+6 |
||
| 853 | 871 0674 8860 ori r24,lo8(8) |
||
| 854 | 872 0676 8093 0000 sts VersionInfo+6,r24 |
||
| 855 | 873 .L81: |
||
| 856 | 874 067a 8091 0000 lds r24,I2CTimeout |
||
| 857 | 875 067e 9091 0000 lds r25,(I2CTimeout)+1 |
||
| 858 | 876 0682 0197 sbiw r24,1 |
||
| 859 | 877 0684 9093 0000 sts (I2CTimeout)+1,r25 |
||
| 860 | 878 0688 8093 0000 sts I2CTimeout,r24 |
||
| 861 | 879 068c 8091 0000 lds r24,I2CTimeout |
||
| 862 | 880 0690 9091 0000 lds r25,(I2CTimeout)+1 |
||
| 863 | 881 0694 892B or r24,r25 |
||
| 864 | 882 0696 01F0 breq .L83 |
||
| 865 | 883 0698 8091 0000 lds r24,MissingMotor |
||
| 866 | 884 069c 8823 tst r24 |
||
| 867 | 885 069e 01F0 breq .L82 |
||
| 868 | 886 .L83: |
||
| 869 | 887 06a0 8091 0000 lds r24,I2CTimeout |
||
| 870 | 888 06a4 9091 0000 lds r25,(I2CTimeout)+1 |
||
| 871 | 889 06a8 892B or r24,r25 |
||
| 872 | 890 06aa 01F4 brne .L84 |
||
| 873 | 891 06ac 0E94 0000 call I2C_Reset |
||
| 874 | 892 06b0 85E0 ldi r24,lo8(5) |
||
| 875 | 893 06b2 90E0 ldi r25,hi8(5) |
||
| 876 | 894 06b4 9093 0000 sts (I2CTimeout)+1,r25 |
||
| 877 | 895 06b8 8093 0000 sts I2CTimeout,r24 |
||
| 878 | 896 06bc 8091 0000 lds r24,DebugOut+58 |
||
| 879 | 897 06c0 9091 0000 lds r25,(DebugOut+58)+1 |
||
| 880 | 898 06c4 0196 adiw r24,1 |
||
| 881 | 899 06c6 9093 0000 sts (DebugOut+58)+1,r25 |
||
| 882 | 900 06ca 8093 0000 sts DebugOut+58,r24 |
||
| 883 | 901 06ce 8091 0000 lds r24,VersionInfo+6 |
||
| 884 | 902 06d2 8160 ori r24,lo8(1) |
||
| 885 | 903 06d4 8093 0000 sts VersionInfo+6,r24 |
||
| 886 | 904 06d8 8091 0000 lds r24,DebugOut+1 |
||
| 887 | 905 06dc 8260 ori r24,lo8(2) |
||
| 888 | 906 06de 8093 0000 sts DebugOut+1,r24 |
||
| 889 | 907 .L84: |
||
| 890 | 908 06e2 8091 0000 lds r24,BeepMuster |
||
| 891 | 909 06e6 9091 0000 lds r25,(BeepMuster)+1 |
||
| 892 | 910 06ea 8F5F subi r24,lo8(-1) |
||
| 893 | 911 06ec 9F4F sbci r25,hi8(-1) |
||
| 894 | 912 06ee 01F4 brne .L86 |
||
| 895 | 913 06f0 8091 0000 lds r24,MotorenEin |
||
| 896 | 914 06f4 8823 tst r24 |
||
| 897 | 915 06f6 01F0 breq .L86 |
||
| 898 | 916 06f8 88EA ldi r24,lo8(25000) |
||
| 899 | 917 06fa 91E6 ldi r25,hi8(25000) |
||
| 900 | 918 06fc 9093 0000 sts (beeptime)+1,r25 |
||
| 901 | 919 0700 8093 0000 sts beeptime,r24 |
||
| 902 | 920 0704 80E8 ldi r24,lo8(128) |
||
| 903 | 921 0706 90E0 ldi r25,hi8(128) |
||
| 904 | 922 0708 9093 0000 sts (BeepMuster)+1,r25 |
||
| 905 | 923 070c 8093 0000 sts BeepMuster,r24 |
||
| 906 | 924 0710 00C0 rjmp .L86 |
||
| 907 | 925 .L82: |
||
| 908 | 926 0712 2A30 cpi r18,lo8(10) |
||
| 909 | 927 0714 01F0 breq .L88 |
||
| 910 | 928 0716 2431 cpi r18,lo8(20) |
||
| 911 | 929 0718 00F0 brlo .L87 |
||
| 912 | 930 .L88: |
||
| 913 | 931 071a 2898 cbi 37-0x20,0 |
||
| 914 | 932 071c 00C0 rjmp .L86 |
||
| 915 | 933 .L87: |
||
| 916 | 934 071e 289A sbi 37-0x20,0 |
||
| 917 | 935 .L86: |
||
| 918 | 936 0720 0E94 0000 call LIBFC_Polling |
||
| 919 | 937 0724 8091 0000 lds r24,UpdateMotor |
||
| 920 | 938 0728 8823 tst r24 |
||
| 921 | 939 072a 01F0 breq .+2 |
||
| 922 | 940 072c 00C0 rjmp .L74 |
||
| 923 | 941 072e 8091 0000 lds r24,CalculateServoSignals |
||
| 924 | 942 0732 8823 tst r24 |
||
| 925 | 943 0734 01F0 breq .L91 |
||
| 926 | 944 0736 0E94 0000 call CalculateServo |
||
| 927 | 945 .L91: |
||
| 928 | 946 073a 0E94 0000 call DatenUebertragung |
||
| 929 | 947 073e 0E94 0000 call BearbeiteRxDaten |
||
| 930 | 948 0742 C701 movw r24,r14 |
||
| 931 | 949 0744 0E94 0000 call CheckDelay |
||
| 932 | 950 0748 8823 tst r24 |
||
| 933 | 951 074a 01F4 brne .+2 |
||
| 934 | 952 074c 00C0 rjmp .L92 |
||
| 935 | 953 074e 84E1 ldi r24,lo8(20) |
||
| 936 | 954 0750 90E0 ldi r25,hi8(20) |
||
| 937 | 955 0752 E80E add r14,r24 |
||
| 938 | 956 0754 F91E adc r15,r25 |
||
| 939 | 957 0756 8091 0000 lds r24,MissingMotor |
||
| 940 | 958 075a 8823 tst r24 |
||
| 941 | 959 075c 01F0 breq .L93 |
||
| 942 | 960 075e 8091 0000 lds r24,VersionInfo+6 |
||
| 943 | 961 0762 8260 ori r24,lo8(2) |
||
| 944 | 962 0764 8093 0000 sts VersionInfo+6,r24 |
||
| 945 | 963 0768 8091 0000 lds r24,DebugOut+1 |
||
| 946 | 964 076c 8260 ori r24,lo8(2) |
||
| 947 | 965 076e 00C0 rjmp .L229 |
||
| 948 | 966 .L93: |
||
| 949 | 967 0770 8091 0000 lds r24,beeptime |
||
| 950 | 968 0774 9091 0000 lds r25,(beeptime)+1 |
||
| 951 | 969 0778 892B or r24,r25 |
||
| 952 | 970 077a 01F4 brne .L94 |
||
| 953 | 971 077c 8091 0000 lds r24,I2CTimeout |
||
| 954 | 972 0780 9091 0000 lds r25,(I2CTimeout)+1 |
||
| 955 | 973 0784 0797 sbiw r24,7 |
||
| 956 | 974 0786 00F0 brlo .L94 |
||
| 957 | 975 0788 8091 0000 lds r24,DebugOut+1 |
||
| 958 | 976 078c 8D7F andi r24,lo8(-3) |
||
| 959 | 977 .L229: |
||
| 960 | 978 078e 8093 0000 sts DebugOut+1,r24 |
||
| 961 | 979 .L94: |
||
| 962 | 980 0792 8091 0000 lds r24,SenderOkay |
||
| 963 | 981 0796 8823 tst r24 |
||
| 964 | 982 0798 01F0 breq .L97 |
||
| 965 | 983 079a 8091 0000 lds r24,DisableRcOffBeeping |
||
| 966 | 984 079e 8823 tst r24 |
||
| 967 | 985 07a0 01F0 breq .L97 |
||
| 968 | 986 07a2 1092 0000 sts DisableRcOffBeeping,__zero_reg__ |
||
| 969 | 987 07a6 88E8 ldi r24,lo8(5000) |
||
| 970 | 988 07a8 93E1 ldi r25,hi8(5000) |
||
| 971 | 989 07aa 9093 0000 sts (beeptime)+1,r25 |
||
| 972 | 990 07ae 8093 0000 sts beeptime,r24 |
||
| 973 | 991 .L97: |
||
| 974 | 992 07b2 8091 0000 lds r24,PcZugriff |
||
| 975 | 993 07b6 8823 tst r24 |
||
| 976 | 994 07b8 01F0 breq .L98 |
||
| 977 | 995 07ba 8150 subi r24,lo8(-(-1)) |
||
| 978 | 996 07bc 8093 0000 sts PcZugriff,r24 |
||
| 979 | 997 07c0 00C0 rjmp .L99 |
||
| 980 | 998 .L98: |
||
| 981 | 999 07c2 8093 0000 sts ExternControl+10,r24 |
||
| 982 | 1000 07c6 1092 0000 sts (ExternStickNick)+1,__zero_reg__ |
||
| 983 | 1001 07ca 1092 0000 sts ExternStickNick,__zero_reg__ |
||
| 984 | 1002 07ce 1092 0000 sts (ExternStickRoll)+1,__zero_reg__ |
||
| 985 | 1003 07d2 1092 0000 sts ExternStickRoll,__zero_reg__ |
||
| 986 | 1004 07d6 1092 0000 sts (ExternStickGier)+1,__zero_reg__ |
||
| 987 | 1005 07da 1092 0000 sts ExternStickGier,__zero_reg__ |
||
| 988 | 1006 07de 8091 0000 lds r24,SenderOkay |
||
| 989 | 1007 07e2 8823 tst r24 |
||
| 990 | 1008 07e4 01F4 brne .L99 |
||
| 991 | 1009 07e6 8091 0000 lds r24,BeepMuster |
||
| 992 | 1010 07ea 9091 0000 lds r25,(BeepMuster)+1 |
||
| 993 | 1011 07ee 8F5F subi r24,lo8(-1) |
||
| 994 | 1012 07f0 9F4F sbci r25,hi8(-1) |
||
| 995 | 1013 07f2 01F4 brne .L99 |
||
| 996 | 1014 07f4 2091 0000 lds r18,DisableRcOffBeeping |
||
| 997 | 1015 07f8 2230 cpi r18,lo8(2) |
||
| 998 | 1016 07fa 01F0 breq .L99 |
||
| 999 | 1017 07fc 88E9 ldi r24,lo8(15000) |
||
| 1000 | 1018 07fe 9AE3 ldi r25,hi8(15000) |
||
| 1001 | 1019 0800 9093 0000 sts (beeptime)+1,r25 |
||
| 1002 | 1020 0804 8093 0000 sts beeptime,r24 |
||
| 1003 | 1021 0808 80E0 ldi r24,lo8(3072) |
||
| 1004 | 1022 080a 9CE0 ldi r25,hi8(3072) |
||
| 1005 | 1023 080c 9093 0000 sts (BeepMuster)+1,r25 |
||
| 1006 | 1024 0810 8093 0000 sts BeepMuster,r24 |
||
| 1007 | 1025 0814 2223 tst r18 |
||
| 1008 | 1026 0816 01F0 breq .L99 |
||
| 1009 | 1027 0818 82E0 ldi r24,lo8(2) |
||
| 1010 | 1028 081a 8093 0000 sts DisableRcOffBeeping,r24 |
||
| 1011 | 1029 .L99: |
||
| 1012 | 1030 081e 8091 0000 lds r24,NaviDataOkay |
||
| 1013 | 1031 0822 893C cpi r24,lo8(-55) |
||
| 1014 | 1032 0824 00F0 brlo .L103 |
||
| 1015 | 1033 0826 8150 subi r24,lo8(-(-1)) |
||
| 1016 | 1034 0828 8093 0000 sts NaviDataOkay,r24 |
||
| 1017 | 1035 082c 8091 0000 lds r24,VersionInfo+6 |
||
| 1018 | 1036 0830 8B7F andi r24,lo8(-5) |
||
| 1019 | 1037 0832 8093 0000 sts VersionInfo+6,r24 |
||
| 1020 | 1038 0836 00C0 rjmp .L104 |
||
| 1021 | 1039 .L103: |
||
| 1022 | 1040 0838 8091 0000 lds r24,NC_Version+3 |
||
| 1023 | 1041 083c 8823 tst r24 |
||
| 1024 | 1042 083e 01F0 breq .L105 |
||
| 1025 | 1043 0840 8091 0000 lds r24,VersionInfo+6 |
||
| 1026 | 1044 0844 8460 ori r24,lo8(4) |
||
| 1027 | 1045 0846 8093 0000 sts VersionInfo+6,r24 |
||
| 1028 | 1046 084a 89E0 ldi r24,lo8(9) |
||
| 1029 | 1047 084c 8093 0000 sts NC_ErrorCode,r24 |
||
| 1030 | 1048 0850 8091 0000 lds r24,BeepMuster |
||
| 1031 | 1049 0854 9091 0000 lds r25,(BeepMuster)+1 |
||
| 1032 | 1050 0858 8F5F subi r24,lo8(-1) |
||
| 1033 | 1051 085a 9F4F sbci r25,hi8(-1) |
||
| 1034 | 1052 085c 01F4 brne .L105 |
||
| 1035 | 1053 085e 8091 0000 lds r24,MotorenEin |
||
| 1036 | 1054 0862 8823 tst r24 |
||
| 1037 | 1055 0864 01F0 breq .L105 |
||
| 1038 | 1056 0866 88E9 ldi r24,lo8(15000) |
||
| 1039 | 1057 0868 9AE3 ldi r25,hi8(15000) |
||
| 1040 | 1058 086a 9093 0000 sts (beeptime)+1,r25 |
||
| 1041 | 1059 086e 8093 0000 sts beeptime,r24 |
||
| 1042 | 1060 0872 80E0 ldi r24,lo8(-22528) |
||
| 1043 | 1061 0874 98EA ldi r25,hi8(-22528) |
||
| 1044 | 1062 0876 9093 0000 sts (BeepMuster)+1,r25 |
||
| 1045 | 1063 087a 8093 0000 sts BeepMuster,r24 |
||
| 1046 | 1064 .L105: |
||
| 1047 | 1065 087e 1092 0000 sts (GPS_Nick)+1,__zero_reg__ |
||
| 1048 | 1066 0882 1092 0000 sts GPS_Nick,__zero_reg__ |
||
| 1049 | 1067 0886 1092 0000 sts (GPS_Roll)+1,__zero_reg__ |
||
| 1050 | 1068 088a 1092 0000 sts GPS_Roll,__zero_reg__ |
||
| 1051 | 1069 088e 1092 0000 sts GPS_Aid_StickMultiplikator,__zero_reg__ |
||
| 1052 | 1070 0892 1092 0000 sts GPSInfo,__zero_reg__ |
||
| 1053 | 1071 0896 1092 0000 sts (FromNaviCtrl+9)+1,__zero_reg__ |
||
| 1054 | 1072 089a 1092 0000 sts FromNaviCtrl+9,__zero_reg__ |
||
| 1055 | 1073 089e 1092 0000 sts (FromNaviCtrl+11)+1,__zero_reg__ |
||
| 1056 | 1074 08a2 1092 0000 sts FromNaviCtrl+11,__zero_reg__ |
||
| 1057 | 1075 08a6 8FEF ldi r24,lo8(-1) |
||
| 1058 | 1076 08a8 9FEF ldi r25,hi8(-1) |
||
| 1059 | 1077 08aa 9093 0000 sts (FromNaviCtrl+7)+1,r25 |
||
| 1060 | 1078 08ae 8093 0000 sts FromNaviCtrl+7,r24 |
||
| 1061 | 1079 08b2 1092 0000 sts NaviDataOkay,__zero_reg__ |
||
| 1062 | 1080 .L104: |
||
| 1063 | 1081 08b6 8091 0000 lds r24,BattLowVoltageWarning |
||
| 1064 | 1082 08ba 282F mov r18,r24 |
||
| 1065 | 1083 08bc 3327 clr r19 |
||
| 1066 | 1084 08be 8091 0000 lds r24,UBat |
||
| 1067 | 1085 08c2 9091 0000 lds r25,(UBat)+1 |
||
| 1068 | 1086 08c6 8217 cp r24,r18 |
||
| 1069 | 1087 08c8 9307 cpc r25,r19 |
||
| 1070 | 1088 08ca 04F4 brge .L107 |
||
| 1071 | 1089 08cc 8091 0000 lds r24,FC_StatusFlags |
||
| 1072 | 1090 08d0 8062 ori r24,lo8(32) |
||
| 1073 | 1091 08d2 8093 0000 sts FC_StatusFlags,r24 |
||
| 1074 | 1092 08d6 8091 0000 lds r24,BeepMuster |
||
| 1075 | 1093 08da 9091 0000 lds r25,(BeepMuster)+1 |
||
| 1076 | 1094 08de 8F5F subi r24,lo8(-1) |
||
| 1077 | 1095 08e0 9F4F sbci r25,hi8(-1) |
||
| 1078 | 1096 08e2 01F4 brne .L109 |
||
| 1079 | 1097 08e4 80E7 ldi r24,lo8(6000) |
||
| 1080 | 1098 08e6 97E1 ldi r25,hi8(6000) |
||
| 1081 | 1099 08e8 9093 0000 sts (beeptime)+1,r25 |
||
| 1082 | 1100 08ec 8093 0000 sts beeptime,r24 |
||
| 1083 | 1101 08f0 80E0 ldi r24,lo8(768) |
||
| 1084 | 1102 08f2 93E0 ldi r25,hi8(768) |
||
| 1085 | 1103 08f4 9093 0000 sts (BeepMuster)+1,r25 |
||
| 1086 | 1104 08f8 8093 0000 sts BeepMuster,r24 |
||
| 1087 | 1105 08fc 00C0 rjmp .L109 |
||
| 1088 | 1106 .L107: |
||
| 1089 | 1107 08fe 8091 0000 lds r24,beeptime |
||
| 1090 | 1108 0902 9091 0000 lds r25,(beeptime)+1 |
||
| 1091 | 1109 0906 892B or r24,r25 |
||
| 1092 | 1110 0908 01F4 brne .L109 |
||
| 1093 | 1111 090a 8091 0000 lds r24,FC_StatusFlags |
||
| 1094 | 1112 090e 8F7D andi r24,lo8(-33) |
||
| 1095 | 1113 0910 8093 0000 sts FC_StatusFlags,r24 |
||
| 1096 | 1114 .L109: |
||
| 1097 | 1115 0914 0E94 0000 call SPI_StartTransmitPacket |
||
| 1098 | 1116 0918 84E0 ldi r24,lo8(4) |
||
| 1099 | 1117 091a 8093 0000 sts SendSPI,r24 |
||
| 1100 | 1118 091e 8091 0000 lds r24,FC_StatusFlags |
||
| 1101 | 1119 0922 81FD sbrc r24,1 |
||
| 1102 | 1120 0924 00C0 rjmp .L111 |
||
| 1103 | 1121 0926 5AEA ldi r21,lo8(1450) |
||
| 1104 | 1122 0928 852E mov r8,r21 |
||
| 1105 | 1123 092a 55E0 ldi r21,hi8(1450) |
||
| 1106 | 1124 092c 952E mov r9,r21 |
||
| 1107 | 1125 092e 00C0 rjmp .L112 |
||
| 1108 | 1126 .L111: |
||
| 1109 | 1127 0930 8091 0000 lds r24,second.12 |
||
| 1110 | 1128 0934 8F5F subi r24,lo8(-(1)) |
||
| 1111 | 1129 0936 8093 0000 sts second.12,r24 |
||
| 1112 | 1130 093a 8133 cpi r24,lo8(49) |
||
| 1113 | 1131 093c 01F4 brne .L112 |
||
| 1114 | 1132 093e 1092 0000 sts second.12,__zero_reg__ |
||
| 1115 | 1133 0942 8091 0000 lds r24,FlugSekunden |
||
| 1116 | 1134 0946 9091 0000 lds r25,(FlugSekunden)+1 |
||
| 1117 | 1135 094a 0196 adiw r24,1 |
||
| 1118 | 1136 094c 9093 0000 sts (FlugSekunden)+1,r25 |
||
| 1119 | 1137 0950 8093 0000 sts FlugSekunden,r24 |
||
| 1120 | 1138 .L112: |
||
| 1121 | 1139 0954 0894 sec |
||
| 1122 | 1140 0956 811C adc r8,__zero_reg__ |
||
| 1123 | 1141 0958 911C adc r9,__zero_reg__ |
||
| 1124 | 1142 095a 82E7 ldi r24,lo8(2930) |
||
| 1125 | 1143 095c 8816 cp r8,r24 |
||
| 1126 | 1144 095e 8BE0 ldi r24,hi8(2930) |
||
| 1127 | 1145 0960 9806 cpc r9,r24 |
||
| 1128 | 1146 0962 01F0 breq .+2 |
||
| 1129 | 1147 0964 00C0 rjmp .L92 |
||
| 1130 | 1148 0966 8824 clr r8 |
||
| 1131 | 1149 0968 9924 clr r9 |
||
| 1132 | 1150 096a 2091 0000 lds r18,FlugMinuten |
||
| 1133 | 1151 096e 3091 0000 lds r19,(FlugMinuten)+1 |
||
| 1134 | 1152 0972 2F5F subi r18,lo8(-(1)) |
||
| 1135 | 1153 0974 3F4F sbci r19,hi8(-(1)) |
||
| 1136 | 1154 0976 3093 0000 sts (FlugMinuten)+1,r19 |
||
| 1137 | 1155 097a 2093 0000 sts FlugMinuten,r18 |
||
| 1138 | 1156 097e 8091 0000 lds r24,FlugMinutenGesamt |
||
| 1139 | 1157 0982 9091 0000 lds r25,(FlugMinutenGesamt)+1 |
||
| 1140 | 1158 0986 0196 adiw r24,1 |
||
| 1141 | 1159 0988 9093 0000 sts (FlugMinutenGesamt)+1,r25 |
||
| 1142 | 1160 098c 8093 0000 sts FlugMinutenGesamt,r24 |
||
| 1143 | 1161 0990 832F mov r24,r19 |
||
| 1144 | 1162 0992 9927 clr r25 |
||
| 1145 | 1163 0994 682F mov r22,r24 |
||
| 1146 | 1164 0996 8EE0 ldi r24,lo8(14) |
||
| 1147 | 1165 0998 90E0 ldi r25,hi8(14) |
||
| 1148 | 1166 099a 0E94 0000 call SetParamByte |
||
| 1149 | 1167 099e 8091 0000 lds r24,FlugMinuten |
||
| 1150 | 1168 09a2 9091 0000 lds r25,(FlugMinuten)+1 |
||
| 1151 | 1169 09a6 9070 andi r25,hi8(255) |
||
| 1152 | 1170 09a8 682F mov r22,r24 |
||
| 1153 | 1171 09aa 8FE0 ldi r24,lo8(15) |
||
| 1154 | 1172 09ac 90E0 ldi r25,hi8(15) |
||
| 1155 | 1173 09ae 0E94 0000 call SetParamByte |
||
| 1156 | 1174 09b2 8091 0000 lds r24,FlugMinutenGesamt |
||
| 1157 | 1175 09b6 9091 0000 lds r25,(FlugMinutenGesamt)+1 |
||
| 1158 | 1176 09ba 892F mov r24,r25 |
||
| 1159 | 1177 09bc 9927 clr r25 |
||
| 1160 | 1178 09be 682F mov r22,r24 |
||
| 1161 | 1179 09c0 8AE0 ldi r24,lo8(10) |
||
| 1162 | 1180 09c2 90E0 ldi r25,hi8(10) |
||
| 1163 | 1181 09c4 0E94 0000 call SetParamByte |
||
| 1164 | 1182 09c8 8091 0000 lds r24,FlugMinutenGesamt |
||
| 1165 | 1183 09cc 9091 0000 lds r25,(FlugMinutenGesamt)+1 |
||
| 1166 | 1184 09d0 9070 andi r25,hi8(255) |
||
| 1167 | 1185 09d2 682F mov r22,r24 |
||
| 1168 | 1186 09d4 8BE0 ldi r24,lo8(11) |
||
| 1169 | 1187 09d6 90E0 ldi r25,hi8(11) |
||
| 1170 | 1188 09d8 0E94 0000 call SetParamByte |
||
| 1171 | 1189 09dc 84E1 ldi r24,lo8(20) |
||
| 1172 | 1190 09de 90E0 ldi r25,hi8(20) |
||
| 1173 | 1191 09e0 0E94 0000 call SetDelay |
||
| 1174 | 1192 09e4 7C01 movw r14,r24 |
||
| 1175 | 1193 .L92: |
||
| 1176 | 1194 09e6 0E94 0000 call LED_Update |
||
| 1177 | 1195 09ea 0E94 0000 call Capacity_Update |
||
| 1178 | 1196 .L74: |
||
| 1179 | 1197 09ee 8091 0000 lds r24,SendSPI |
||
| 1180 | 1198 09f2 8823 tst r24 |
||
| 1181 | 1199 09f4 01F0 breq .+2 |
||
| 1182 | 1200 09f6 00C0 rjmp .L231 |
||
| 1183 | 1201 09f8 0E94 0000 call SPI_TransmitByte |
||
| 1184 | 1202 09fc 00C0 rjmp .L231 |
||
| 1185 | 1203 /* epilogue: frame size=0 */ |
||
| 1186 | 1204 /* epilogue: noreturn */ |
||
| 1187 | 1205 /* epilogue end (size=0) */ |
||
| 1188 | 1206 /* function main size 1099 (1095) */ |
||
| 1189 | 1208 .comm _printf_P,2,1 |
||
| 1190 | 1209 .comm Motorsmax,8,1 |
||
| 1191 | 1210 .comm MotorsTmax,2,1 |
||
| 1192 | 1211 /* File "main.c": code 1292 = 0x050c (1280), prologues 7, epilogues 5 */ |
||
| 1193 | DEFINED SYMBOLS |
||
| 1194 | *ABS*:00000000 main.c |
||
| 1195 | C:\Users\Thomas\AppData\Local\Temp/ccskjFil.s:3 *ABS*:0000003f __SREG__ |
||
| 1196 | C:\Users\Thomas\AppData\Local\Temp/ccskjFil.s:4 *ABS*:0000003e __SP_H__ |
||
| 1197 | C:\Users\Thomas\AppData\Local\Temp/ccskjFil.s:5 *ABS*:0000003d __SP_L__ |
||
| 1198 | C:\Users\Thomas\AppData\Local\Temp/ccskjFil.s:6 *ABS*:00000000 __tmp_reg__ |
||
| 1199 | C:\Users\Thomas\AppData\Local\Temp/ccskjFil.s:7 *ABS*:00000001 __zero_reg__ |
||
| 1200 | C:\Users\Thomas\AppData\Local\Temp/ccskjFil.s:15 .bss:00000000 JetiBeep |
||
| 1201 | C:\Users\Thomas\AppData\Local\Temp/ccskjFil.s:21 .bss:00000001 FoundMotors |
||
| 1202 | C:\Users\Thomas\AppData\Local\Temp/ccskjFil.s:27 .bss:00000002 FlugSekunden |
||
| 1203 | C:\Users\Thomas\AppData\Local\Temp/ccskjFil.s:33 .bss:00000004 FlugMinutenGesamt |
||
| 1204 | C:\Users\Thomas\AppData\Local\Temp/ccskjFil.s:39 .bss:00000006 FlugMinuten |
||
| 1205 | C:\Users\Thomas\AppData\Local\Temp/ccskjFil.s:45 .data:00000000 BattLowVoltageWarning |
||
| 1206 | C:\Users\Thomas\AppData\Local\Temp/ccskjFil.s:50 .data:00000001 SendVersionToNavi |
||
| 1207 | C:\Users\Thomas\AppData\Local\Temp/ccskjFil.s:55 .data:00000002 PlatinenVersion |
||
| 1208 | C:\Users\Thomas\AppData\Local\Temp/ccskjFil.s:62 .bss:00000008 DisableRcOffBeeping |
||
| 1209 | C:\Users\Thomas\AppData\Local\Temp/ccskjFil.s:67 .data:00000003 stick.16 |
||
| 1210 | C:\Users\Thomas\AppData\Local\Temp/ccskjFil.s:72 .text:00000000 CalMk3Mag |
||
| 1211 | C:\Users\Thomas\AppData\Local\Temp/ccskjFil.s:126 .progmem.data:00000000 __c.13 |
||
| 1212 | C:\Users\Thomas\AppData\Local\Temp/ccskjFil.s:130 .progmem.data:00000008 __c.14 |
||
| 1213 | C:\Users\Thomas\AppData\Local\Temp/ccskjFil.s:134 .progmem.data:00000013 __c.15 |
||
| 1214 | C:\Users\Thomas\AppData\Local\Temp/ccskjFil.s:139 .text:0000006a LipoDetection |
||
| 1215 | *COM*:00000002 _printf_P |
||
| 1216 | C:\Users\Thomas\AppData\Local\Temp/ccskjFil.s:276 .progmem.data:00000029 __c.0 |
||
| 1217 | C:\Users\Thomas\AppData\Local\Temp/ccskjFil.s:280 .progmem.data:0000003b __c.1 |
||
| 1218 | C:\Users\Thomas\AppData\Local\Temp/ccskjFil.s:284 .progmem.data:0000003e __c.2 |
||
| 1219 | C:\Users\Thomas\AppData\Local\Temp/ccskjFil.s:288 .progmem.data:0000005a __c.3 |
||
| 1220 | C:\Users\Thomas\AppData\Local\Temp/ccskjFil.s:292 .progmem.data:0000005e __c.4 |
||
| 1221 | C:\Users\Thomas\AppData\Local\Temp/ccskjFil.s:296 .progmem.data:00000075 __c.5 |
||
| 1222 | C:\Users\Thomas\AppData\Local\Temp/ccskjFil.s:300 .progmem.data:0000007a __c.6 |
||
| 1223 | C:\Users\Thomas\AppData\Local\Temp/ccskjFil.s:304 .progmem.data:0000009d __c.7 |
||
| 1224 | C:\Users\Thomas\AppData\Local\Temp/ccskjFil.s:308 .progmem.data:000000a9 __c.8 |
||
| 1225 | C:\Users\Thomas\AppData\Local\Temp/ccskjFil.s:312 .progmem.data:000000b5 __c.9 |
||
| 1226 | C:\Users\Thomas\AppData\Local\Temp/ccskjFil.s:316 .progmem.data:000000c7 __c.10 |
||
| 1227 | C:\Users\Thomas\AppData\Local\Temp/ccskjFil.s:320 .progmem.data:000000cd __c.11 |
||
| 1228 | .bss:00000009 second.12 |
||
| 1229 | C:\Users\Thomas\AppData\Local\Temp/ccskjFil.s:327 .text:0000017e main |
||
| 1230 | *COM*:00000008 Motorsmax |
||
| 1231 | *COM*:00000002 MotorsTmax |
||
| 1232 | |||
| 1233 | UNDEFINED SYMBOLS |
||
| 1234 | __do_copy_data |
||
| 1235 | __do_clear_bss |
||
| 1236 | EE_Parameter |
||
| 1237 | PPM_in |
||
| 1238 | WinkelOut |
||
| 1239 | beeptime |
||
| 1240 | Piep |
||
| 1241 | DebugOut |
||
| 1242 | uart_putchar |
||
| 1243 | SetDelay |
||
| 1244 | CheckDelay |
||
| 1245 | UBat |
||
| 1246 | __udivmodqi4 |
||
| 1247 | __stack |
||
| 1248 | StickGier |
||
| 1249 | StickRoll |
||
| 1250 | StickNick |
||
| 1251 | GIER_GRAD_FAKTOR |
||
| 1252 | Timer_Init |
||
| 1253 | TIMER2_Init |
||
| 1254 | UART_Init |
||
| 1255 | rc_sum_init |
||
| 1256 | ADC_Init |
||
| 1257 | I2C_Init |
||
| 1258 | SPI_MasterInit |
||
| 1259 | LIBFC_Init |
||
| 1260 | ParamSet_Init |
||
| 1261 | Capacity_Init |
||
| 1262 | BLFlags |
||
| 1263 | motor_read |
||
| 1264 | SendMotorData |
||
| 1265 | Motor |
||
| 1266 | Mixer |
||
| 1267 | ServoActive |
||
| 1268 | RequiredMotors |
||
| 1269 | VersionInfo |
||
| 1270 | SucheLuftruckOffset |
||
| 1271 | SetNeutral |
||
| 1272 | ExternControl |
||
| 1273 | GetParamByte |
||
| 1274 | LcdClear |
||
| 1275 | I2CTimeout |
||
| 1276 | LIBFC_ReceiverInit |
||
| 1277 | ReceiverUpdateModeActive |
||
| 1278 | UpdateMotor |
||
| 1279 | AdReady |
||
| 1280 | MotorRegler |
||
| 1281 | SenderOkay |
||
| 1282 | MissingMotor |
||
| 1283 | I2C_Reset |
||
| 1284 | BeepMuster |
||
| 1285 | MotorenEin |
||
| 1286 | LIBFC_Polling |
||
| 1287 | CalculateServoSignals |
||
| 1288 | CalculateServo |
||
| 1289 | DatenUebertragung |
||
| 1290 | BearbeiteRxDaten |
||
| 1291 | PcZugriff |
||
| 1292 | ExternStickNick |
||
| 1293 | ExternStickRoll |
||
| 1294 | ExternStickGier |
||
| 1295 | NaviDataOkay |
||
| 1296 | NC_Version |
||
| 1297 | NC_ErrorCode |
||
| 1298 | GPS_Nick |
||
| 1299 | GPS_Roll |
||
| 1300 | GPS_Aid_StickMultiplikator |
||
| 1301 | GPSInfo |
||
| 1302 | FromNaviCtrl |
||
| 1303 | FC_StatusFlags |
||
| 1304 | SPI_StartTransmitPacket |
||
| 1305 | SendSPI |
||
| 1306 | SetParamByte |
||
| 1307 | LED_Update |
||
| 1308 | Capacity_Update |
||
| 1309 | SPI_TransmitByte |