| 0,0 → 1,9596 |
|---|
| 1 .file "fc.c" |
| 2 __SREG__ = 0x3f |
| 3 __SP_H__ = 0x3e |
| 4 __SP_L__ = 0x3d |
| 5 __tmp_reg__ = 0 |
| 6 __zero_reg__ = 1 |
| 7 .global __do_copy_data |
| 8 .global __do_clear_bss |
| 9 .text |
| 10 .global DefaultStickMapping |
| 12 DefaultStickMapping: |
| 13 /* prologue: frame size=0 */ |
| 14 /* prologue end (size=0) */ |
| 15 0000 81E0 ldi r24,lo8(1) |
| 16 0002 8093 0000 sts EE_Parameter,r24 |
| 17 0006 82E0 ldi r24,lo8(2) |
| 18 0008 8093 0000 sts EE_Parameter+1,r24 |
| 19 000c 83E0 ldi r24,lo8(3) |
| 20 000e 8093 0000 sts EE_Parameter+2,r24 |
| 21 0012 84E0 ldi r24,lo8(4) |
| 22 0014 8093 0000 sts EE_Parameter+3,r24 |
| 23 0018 85E0 ldi r24,lo8(5) |
| 24 001a 8093 0000 sts EE_Parameter+4,r24 |
| 25 001e 86E0 ldi r24,lo8(6) |
| 26 0020 8093 0000 sts EE_Parameter+5,r24 |
| 27 0024 87E0 ldi r24,lo8(7) |
| 28 0026 8093 0000 sts EE_Parameter+6,r24 |
| 29 002a 88E0 ldi r24,lo8(8) |
| 30 002c 8093 0000 sts EE_Parameter+7,r24 |
| 31 /* epilogue: frame size=0 */ |
| 32 0030 0895 ret |
| 33 /* epilogue end (size=1) */ |
| 34 /* function DefaultStickMapping size 25 (24) */ |
| 36 .global MotorSmoothing |
| 38 MotorSmoothing: |
| 39 /* prologue: frame size=0 */ |
| 40 /* prologue end (size=0) */ |
| 41 0032 6817 cp r22,r24 |
| 42 0034 7907 cpc r23,r25 |
| 43 0036 04F4 brge .L4 |
| 44 0038 680F add r22,r24 |
| 45 003a 791F adc r23,r25 |
| 46 003c 77FD sbrc r23,7 |
| 47 003e 00C0 rjmp .L10 |
| 48 0040 CB01 movw r24,r22 |
| 49 0042 9595 asr r25 |
| 50 0044 8795 ror r24 |
| 51 0046 0895 ret |
| 52 .L4: |
| 53 0048 681B sub r22,r24 |
| 54 004a 790B sbc r23,r25 |
| 55 004c 861B sub r24,r22 |
| 56 004e 970B sbc r25,r23 |
| 57 0050 0895 ret |
| 58 .L10: |
| 59 0052 6F5F subi r22,lo8(-(1)) |
| 60 0054 7F4F sbci r23,hi8(-(1)) |
| 61 0056 CB01 movw r24,r22 |
| 62 0058 9595 asr r25 |
| 63 005a 8795 ror r24 |
| 64 005c 0895 ret |
| 65 /* epilogue: frame size=0 */ |
| 66 /* epilogue: noreturn */ |
| 67 /* epilogue end (size=0) */ |
| 68 /* function MotorSmoothing size 22 (22) */ |
| 70 .global Mittelwert |
| 72 Mittelwert: |
| 73 /* prologue: frame size=27 */ |
| 74 005e 2F92 push r2 |
| 75 0060 3F92 push r3 |
| 76 0062 4F92 push r4 |
| 77 0064 5F92 push r5 |
| 78 0066 6F92 push r6 |
| 79 0068 7F92 push r7 |
| 80 006a 8F92 push r8 |
| 81 006c 9F92 push r9 |
| 82 006e AF92 push r10 |
| 83 0070 BF92 push r11 |
| 84 0072 CF92 push r12 |
| 85 0074 DF92 push r13 |
| 86 0076 EF92 push r14 |
| 87 0078 FF92 push r15 |
| 88 007a 0F93 push r16 |
| 89 007c 1F93 push r17 |
| 90 007e CF93 push r28 |
| 91 0080 DF93 push r29 |
| 92 0082 CDB7 in r28,__SP_L__ |
| 93 0084 DEB7 in r29,__SP_H__ |
| 94 0086 6B97 sbiw r28,27 |
| 95 0088 0FB6 in __tmp_reg__,__SREG__ |
| 96 008a F894 cli |
| 97 008c DEBF out __SP_H__,r29 |
| 98 008e 0FBE out __SREG__,__tmp_reg__ |
| 99 0090 CDBF out __SP_L__,r28 |
| 100 /* prologue end (size=26) */ |
| 101 0092 8091 0000 lds r24,AdWertGier |
| 102 0096 9091 0000 lds r25,(AdWertGier)+1 |
| 103 009a 4090 0000 lds r4,AdNeutralGier |
| 104 009e 5090 0000 lds r5,(AdNeutralGier)+1 |
| 105 00a2 481A sub r4,r24 |
| 106 00a4 590A sbc r5,r25 |
| 107 00a6 5092 0000 sts (MesswertGier)+1,r5 |
| 108 00aa 4092 0000 sts MesswertGier,r4 |
| 109 00ae 2091 0000 lds r18,AdWertNickFilter |
| 110 00b2 3091 0000 lds r19,(AdWertNickFilter)+1 |
| 111 00b6 37FF sbrs r19,7 |
| 112 00b8 00C0 rjmp .+4 |
| 113 00ba 0C94 0000 jmp .L146 |
| 114 .L12: |
| 115 00be 3595 asr r19 |
| 116 00c0 2795 ror r18 |
| 117 00c2 3595 asr r19 |
| 118 00c4 2795 ror r18 |
| 119 00c6 3595 asr r19 |
| 120 00c8 2795 ror r18 |
| 121 00ca 3B8F std Y+27,r19 |
| 122 00cc 2A8F std Y+26,r18 |
| 123 00ce 2091 0000 lds r18,AdWertRollFilter |
| 124 00d2 3091 0000 lds r19,(AdWertRollFilter)+1 |
| 125 00d6 37FD sbrc r19,7 |
| 126 00d8 00C0 rjmp .L147 |
| 127 .L13: |
| 128 00da 3595 asr r19 |
| 129 00dc 2795 ror r18 |
| 130 00de 3595 asr r19 |
| 131 00e0 2795 ror r18 |
| 132 00e2 3595 asr r19 |
| 133 00e4 2795 ror r18 |
| 134 00e6 3C8B std Y+20,r19 |
| 135 00e8 2B8B std Y+19,r18 |
| 136 00ea 2A8D ldd r18,Y+26 |
| 137 00ec 3B8D ldd r19,Y+27 |
| 138 00ee 3093 0000 sts (RohMesswertNick)+1,r19 |
| 139 00f2 2093 0000 sts RohMesswertNick,r18 |
| 140 00f6 8B89 ldd r24,Y+19 |
| 141 00f8 9C89 ldd r25,Y+20 |
| 142 00fa 9093 0000 sts (RohMesswertRoll)+1,r25 |
| 143 00fe 8093 0000 sts RohMesswertRoll,r24 |
| 144 0102 6091 0000 lds r22,AdWertAccNick |
| 145 0106 7091 0000 lds r23,(AdWertAccNick)+1 |
| 146 010a 8827 clr r24 |
| 147 010c 77FD sbrc r23,7 |
| 148 010e 8095 com r24 |
| 149 0110 982F mov r25,r24 |
| 150 0112 26E0 ldi r18,lo8(6) |
| 151 0114 30E0 ldi r19,hi8(6) |
| 152 0116 40E0 ldi r20,hlo8(6) |
| 153 0118 50E0 ldi r21,hhi8(6) |
| 154 011a 0E94 0000 call __mulsi3 |
| 155 011e 7B01 movw r14,r22 |
| 156 0120 8C01 movw r16,r24 |
| 157 0122 2091 0000 lds r18,Mittelwert_AccNick |
| 158 0126 3091 0000 lds r19,(Mittelwert_AccNick)+1 |
| 159 012a 4427 clr r20 |
| 160 012c 37FD sbrc r19,7 |
| 161 012e 4095 com r20 |
| 162 0130 542F mov r21,r20 |
| 163 0132 CA01 movw r24,r20 |
| 164 0134 B901 movw r22,r18 |
| 165 0136 660F lsl r22 |
| 166 0138 771F rol r23 |
| 167 013a 881F rol r24 |
| 168 013c 991F rol r25 |
| 169 013e 620F add r22,r18 |
| 170 0140 731F adc r23,r19 |
| 171 0142 841F adc r24,r20 |
| 172 0144 951F adc r25,r21 |
| 173 0146 6E0D add r22,r14 |
| 174 0148 7F1D adc r23,r15 |
| 175 014a 801F adc r24,r16 |
| 176 014c 911F adc r25,r17 |
| 177 014e 24E0 ldi r18,lo8(4) |
| 178 0150 30E0 ldi r19,hi8(4) |
| 179 0152 40E0 ldi r20,hlo8(4) |
| 180 0154 50E0 ldi r21,hhi8(4) |
| 181 0156 0E94 0000 call __divmodsi4 |
| 182 015a 3093 0000 sts (Mittelwert_AccNick)+1,r19 |
| 183 015e 2093 0000 sts Mittelwert_AccNick,r18 |
| 184 0162 6091 0000 lds r22,AdWertAccRoll |
| 185 0166 7091 0000 lds r23,(AdWertAccRoll)+1 |
| 186 016a 8827 clr r24 |
| 187 016c 77FD sbrc r23,7 |
| 188 016e 8095 com r24 |
| 189 0170 982F mov r25,r24 |
| 190 0172 26E0 ldi r18,lo8(6) |
| 191 0174 30E0 ldi r19,hi8(6) |
| 192 0176 40E0 ldi r20,hlo8(6) |
| 193 0178 50E0 ldi r21,hhi8(6) |
| 194 017a 0E94 0000 call __mulsi3 |
| 195 017e 7B01 movw r14,r22 |
| 196 0180 8C01 movw r16,r24 |
| 197 0182 2091 0000 lds r18,Mittelwert_AccRoll |
| 198 0186 3091 0000 lds r19,(Mittelwert_AccRoll)+1 |
| 199 018a 4427 clr r20 |
| 200 018c 37FD sbrc r19,7 |
| 201 018e 4095 com r20 |
| 202 0190 542F mov r21,r20 |
| 203 0192 CA01 movw r24,r20 |
| 204 0194 B901 movw r22,r18 |
| 205 0196 660F lsl r22 |
| 206 0198 771F rol r23 |
| 207 019a 881F rol r24 |
| 208 019c 991F rol r25 |
| 209 019e 620F add r22,r18 |
| 210 01a0 731F adc r23,r19 |
| 211 01a2 841F adc r24,r20 |
| 212 01a4 951F adc r25,r21 |
| 213 01a6 6E0D add r22,r14 |
| 214 01a8 7F1D adc r23,r15 |
| 215 01aa 801F adc r24,r16 |
| 216 01ac 911F adc r25,r17 |
| 217 01ae 24E0 ldi r18,lo8(4) |
| 218 01b0 30E0 ldi r19,hi8(4) |
| 219 01b2 40E0 ldi r20,hlo8(4) |
| 220 01b4 50E0 ldi r21,hhi8(4) |
| 221 01b6 0E94 0000 call __divmodsi4 |
| 222 01ba 3093 0000 sts (Mittelwert_AccRoll)+1,r19 |
| 223 01be 2093 0000 sts Mittelwert_AccRoll,r18 |
| 224 01c2 E090 0000 lds r14,AdWertAccHoch |
| 225 01c6 F090 0000 lds r15,(AdWertAccHoch)+1 |
| 226 01ca 2091 0000 lds r18,Mittelwert_AccHoch |
| 227 01ce 3091 0000 lds r19,(Mittelwert_AccHoch)+1 |
| 228 01d2 4427 clr r20 |
| 229 01d4 37FD sbrc r19,7 |
| 230 01d6 4095 com r20 |
| 231 01d8 542F mov r21,r20 |
| 232 01da CA01 movw r24,r20 |
| 233 01dc B901 movw r22,r18 |
| 234 01de 660F lsl r22 |
| 235 01e0 771F rol r23 |
| 236 01e2 881F rol r24 |
| 237 01e4 991F rol r25 |
| 238 01e6 620F add r22,r18 |
| 239 01e8 731F adc r23,r19 |
| 240 01ea 841F adc r24,r20 |
| 241 01ec 951F adc r25,r21 |
| 242 01ee 0027 clr r16 |
| 243 01f0 F7FC sbrc r15,7 |
| 244 01f2 0095 com r16 |
| 245 01f4 102F mov r17,r16 |
| 246 01f6 6E0D add r22,r14 |
| 247 01f8 7F1D adc r23,r15 |
| 248 01fa 801F adc r24,r16 |
| 249 01fc 911F adc r25,r17 |
| 250 01fe 24E0 ldi r18,lo8(4) |
| 251 0200 30E0 ldi r19,hi8(4) |
| 252 0202 40E0 ldi r20,hlo8(4) |
| 253 0204 50E0 ldi r21,hhi8(4) |
| 254 0206 0E94 0000 call __divmodsi4 |
| 255 020a 3093 0000 sts (Mittelwert_AccHoch)+1,r19 |
| 256 020e 2093 0000 sts Mittelwert_AccHoch,r18 |
| 257 0212 2091 0000 lds r18,AdWertAccNick |
| 258 0216 3091 0000 lds r19,(AdWertAccNick)+1 |
| 259 021a C901 movw r24,r18 |
| 260 021c 880F lsl r24 |
| 261 021e 991F rol r25 |
| 262 0220 820F add r24,r18 |
| 263 0222 931F adc r25,r19 |
| 264 0224 880F lsl r24 |
| 265 0226 991F rol r25 |
| 266 0228 AA27 clr r26 |
| 267 022a 97FD sbrc r25,7 |
| 268 022c A095 com r26 |
| 269 022e BA2F mov r27,r26 |
| 270 0230 2091 0000 lds r18,IntegralAccNick |
| 271 0234 3091 0000 lds r19,(IntegralAccNick)+1 |
| 272 0238 4091 0000 lds r20,(IntegralAccNick)+2 |
| 273 023c 5091 0000 lds r21,(IntegralAccNick)+3 |
| 274 0240 280F add r18,r24 |
| 275 0242 391F adc r19,r25 |
| 276 0244 4A1F adc r20,r26 |
| 277 0246 5B1F adc r21,r27 |
| 278 0248 2093 0000 sts IntegralAccNick,r18 |
| 279 024c 3093 0000 sts (IntegralAccNick)+1,r19 |
| 280 0250 4093 0000 sts (IntegralAccNick)+2,r20 |
| 281 0254 5093 0000 sts (IntegralAccNick)+3,r21 |
| 282 0258 2091 0000 lds r18,AdWertAccRoll |
| 283 025c 3091 0000 lds r19,(AdWertAccRoll)+1 |
| 284 0260 C901 movw r24,r18 |
| 285 0262 880F lsl r24 |
| 286 0264 991F rol r25 |
| 287 0266 820F add r24,r18 |
| 288 0268 931F adc r25,r19 |
| 289 026a 880F lsl r24 |
| 290 026c 991F rol r25 |
| 291 026e AA27 clr r26 |
| 292 0270 97FD sbrc r25,7 |
| 293 0272 A095 com r26 |
| 294 0274 BA2F mov r27,r26 |
| 295 0276 2091 0000 lds r18,IntegralAccRoll |
| 296 027a 3091 0000 lds r19,(IntegralAccRoll)+1 |
| 297 027e 4091 0000 lds r20,(IntegralAccRoll)+2 |
| 298 0282 5091 0000 lds r21,(IntegralAccRoll)+3 |
| 299 0286 280F add r18,r24 |
| 300 0288 391F adc r19,r25 |
| 301 028a 4A1F adc r20,r26 |
| 302 028c 5B1F adc r21,r27 |
| 303 028e 2093 0000 sts IntegralAccRoll,r18 |
| 304 0292 3093 0000 sts (IntegralAccRoll)+1,r19 |
| 305 0296 4093 0000 sts (IntegralAccRoll)+2,r20 |
| 306 029a 5093 0000 sts (IntegralAccRoll)+3,r21 |
| 307 029e 2091 0000 lds r18,AdWertAccNick |
| 308 02a2 3091 0000 lds r19,(AdWertAccNick)+1 |
| 309 02a6 8091 0000 lds r24,NaviAccNick |
| 310 02aa 9091 0000 lds r25,(NaviAccNick)+1 |
| 311 02ae 820F add r24,r18 |
| 312 02b0 931F adc r25,r19 |
| 313 02b2 9093 0000 sts (NaviAccNick)+1,r25 |
| 314 02b6 8093 0000 sts NaviAccNick,r24 |
| 315 02ba 2091 0000 lds r18,AdWertAccRoll |
| 316 02be 3091 0000 lds r19,(AdWertAccRoll)+1 |
| 317 02c2 8091 0000 lds r24,NaviAccRoll |
| 318 02c6 9091 0000 lds r25,(NaviAccRoll)+1 |
| 319 02ca 820F add r24,r18 |
| 320 02cc 931F adc r25,r19 |
| 321 02ce 9093 0000 sts (NaviAccRoll)+1,r25 |
| 322 02d2 8093 0000 sts NaviAccRoll,r24 |
| 323 02d6 8091 0000 lds r24,NaviCntAcc |
| 324 02da 9091 0000 lds r25,(NaviCntAcc)+1 |
| 325 02de 0196 adiw r24,1 |
| 326 02e0 9093 0000 sts (NaviCntAcc)+1,r25 |
| 327 02e4 8093 0000 sts NaviCntAcc,r24 |
| 328 02e8 E090 0000 lds r14,Aktuell_az |
| 329 02ec F090 0000 lds r15,(Aktuell_az)+1 |
| 330 02f0 A090 0000 lds r10,NeutralAccZ |
| 331 02f4 B090 0000 lds r11,(NeutralAccZ)+1 |
| 332 02f8 C090 0000 lds r12,(NeutralAccZ)+2 |
| 333 02fc D090 0000 lds r13,(NeutralAccZ)+3 |
| 334 0300 6091 0000 lds r22,IntegralAccZ |
| 335 0304 7091 0000 lds r23,(IntegralAccZ)+1 |
| 336 0308 8091 0000 lds r24,(IntegralAccZ)+2 |
| 337 030c 9091 0000 lds r25,(IntegralAccZ)+3 |
| 338 0310 0E94 0000 call __floatsisf |
| 339 0314 3B01 movw r6,r22 |
| 340 0316 4C01 movw r8,r24 |
| 341 0318 0027 clr r16 |
| 342 031a F7FC sbrc r15,7 |
| 343 031c 0095 com r16 |
| 344 031e 102F mov r17,r16 |
| 345 0320 C801 movw r24,r16 |
| 346 0322 B701 movw r22,r14 |
| 347 0324 0E94 0000 call __floatsisf |
| 348 0328 A601 movw r20,r12 |
| 349 032a 9501 movw r18,r10 |
| 350 032c 0E94 0000 call __subsf3 |
| 351 0330 9B01 movw r18,r22 |
| 352 0332 AC01 movw r20,r24 |
| 353 0334 C401 movw r24,r8 |
| 354 0336 B301 movw r22,r6 |
| 355 0338 0E94 0000 call __addsf3 |
| 356 033c 0E94 0000 call __fixsfsi |
| 357 0340 6093 0000 sts IntegralAccZ,r22 |
| 358 0344 7093 0000 sts (IntegralAccZ)+1,r23 |
| 359 0348 8093 0000 sts (IntegralAccZ)+2,r24 |
| 360 034c 9093 0000 sts (IntegralAccZ)+3,r25 |
| 361 0350 8FEC ldi r24,lo8(-49) |
| 362 0352 8093 7A00 sts 122,r24 |
| 363 0356 1092 0000 sts AdReady,__zero_reg__ |
| 364 035a 8091 0000 lds r24,Mess_IntegralRoll |
| 365 035e 9091 0000 lds r25,(Mess_IntegralRoll)+1 |
| 366 0362 A091 0000 lds r26,(Mess_IntegralRoll)+2 |
| 367 0366 B091 0000 lds r27,(Mess_IntegralRoll)+3 |
| 368 036a 8F87 std Y+15,r24 |
| 369 036c 988B std Y+16,r25 |
| 370 036e A98B std Y+17,r26 |
| 371 0370 BA8B std Y+18,r27 |
| 372 0372 8091 0000 lds r24,Mess_IntegralNick |
| 373 0376 9091 0000 lds r25,(Mess_IntegralNick)+1 |
| 374 037a A091 0000 lds r26,(Mess_IntegralNick)+2 |
| 375 037e B091 0000 lds r27,(Mess_IntegralNick)+3 |
| 376 0382 8B87 std Y+11,r24 |
| 377 0384 9C87 std Y+12,r25 |
| 378 0386 AD87 std Y+13,r26 |
| 379 0388 BE87 std Y+14,r27 |
| 380 038a 3201 movw r6,r4 |
| 381 038c 8824 clr r8 |
| 382 038e 77FC sbrc r7,7 |
| 383 0390 8094 com r8 |
| 384 0392 982C mov r9,r8 |
| 385 0394 8091 0000 lds r24,Mess_Integral_Gier |
| 386 0398 9091 0000 lds r25,(Mess_Integral_Gier)+1 |
| 387 039c A091 0000 lds r26,(Mess_Integral_Gier)+2 |
| 388 03a0 B091 0000 lds r27,(Mess_Integral_Gier)+3 |
| 389 03a4 860D add r24,r6 |
| 390 03a6 971D adc r25,r7 |
| 391 03a8 A81D adc r26,r8 |
| 392 03aa B91D adc r27,r9 |
| 393 03ac 8E8B std Y+22,r24 |
| 394 03ae 9F8B std Y+23,r25 |
| 395 03b0 A88F std Y+24,r26 |
| 396 03b2 B98F std Y+25,r27 |
| 397 03b4 8093 0000 sts Mess_Integral_Gier,r24 |
| 398 03b8 9093 0000 sts (Mess_Integral_Gier)+1,r25 |
| 399 03bc A093 0000 sts (Mess_Integral_Gier)+2,r26 |
| 400 03c0 B093 0000 sts (Mess_Integral_Gier)+3,r27 |
| 401 03c4 2090 0000 lds r2,ErsatzKompass |
| 402 03c8 3090 0000 lds r3,(ErsatzKompass)+1 |
| 403 03cc 4090 0000 lds r4,(ErsatzKompass)+2 |
| 404 03d0 5090 0000 lds r5,(ErsatzKompass)+3 |
| 405 03d4 260C add r2,r6 |
| 406 03d6 371C adc r3,r7 |
| 407 03d8 481C adc r4,r8 |
| 408 03da 591C adc r5,r9 |
| 409 03dc 2092 0000 sts ErsatzKompass,r2 |
| 410 03e0 3092 0000 sts (ErsatzKompass)+1,r3 |
| 411 03e4 4092 0000 sts (ErsatzKompass)+2,r4 |
| 412 03e8 5092 0000 sts (ErsatzKompass)+3,r5 |
| 413 03ec 9091 0000 lds r25,Looping_Nick |
| 414 03f0 9A87 std Y+10,r25 |
| 415 03f2 9923 tst r25 |
| 416 03f4 01F4 brne .L14 |
| 417 03f6 8091 0000 lds r24,Looping_Roll |
| 418 03fa 8823 tst r24 |
| 419 03fc 01F4 brne .+2 |
| 420 03fe 00C0 rjmp .L148 |
| 421 .L14: |
| 422 0400 A091 0000 lds r26,EE_Parameter+8 |
| 423 0404 A983 std Y+1,r26 |
| 424 .L18: |
| 425 0406 1092 0000 sts (KopplungsteilRollNick)+1,__zero_reg__ |
| 426 040a 1092 0000 sts KopplungsteilRollNick,__zero_reg__ |
| 427 040e 1092 0000 sts (KopplungsteilNickRoll)+1,__zero_reg__ |
| 428 0412 1092 0000 sts KopplungsteilNickRoll,__zero_reg__ |
| 429 0416 1092 0000 sts tmpl2.2653,__zero_reg__ |
| 430 041a 1092 0000 sts (tmpl2.2653)+1,__zero_reg__ |
| 431 041e 1092 0000 sts (tmpl2.2653)+2,__zero_reg__ |
| 432 0422 1092 0000 sts (tmpl2.2653)+3,__zero_reg__ |
| 433 0426 1092 0000 sts tmpl.2652,__zero_reg__ |
| 434 042a 1092 0000 sts (tmpl.2652)+1,__zero_reg__ |
| 435 042e 1092 0000 sts (tmpl.2652)+2,__zero_reg__ |
| 436 0432 1092 0000 sts (tmpl.2652)+3,__zero_reg__ |
| 437 0436 B091 0000 lds r27,Parameter_CouplingYawCorrection |
| 438 043a BD8B std Y+21,r27 |
| 439 .L29: |
| 440 043c E090 0000 lds r14,tmpl.2652 |
| 441 0440 F090 0000 lds r15,(tmpl.2652)+1 |
| 442 0444 0091 0000 lds r16,(tmpl.2652)+2 |
| 443 0448 1091 0000 lds r17,(tmpl.2652)+3 |
| 444 044c A090 0000 lds r10,tmpl2.2653 |
| 445 0450 B090 0000 lds r11,(tmpl2.2653)+1 |
| 446 0454 C090 0000 lds r12,(tmpl2.2653)+2 |
| 447 0458 D090 0000 lds r13,(tmpl2.2653)+3 |
| 448 045c C601 movw r24,r12 |
| 449 045e B501 movw r22,r10 |
| 450 0460 24E6 ldi r18,lo8(100) |
| 451 0462 30E0 ldi r19,hi8(100) |
| 452 0464 40E0 ldi r20,hlo8(100) |
| 453 0466 50E0 ldi r21,hhi8(100) |
| 454 0468 0E94 0000 call __divmodsi4 |
| 455 046c 4701 movw r8,r14 |
| 456 046e 821A sub r8,r18 |
| 457 0470 930A sbc r9,r19 |
| 458 0472 9092 0000 sts (TrimRoll)+1,r9 |
| 459 0476 8092 0000 sts TrimRoll,r8 |
| 460 047a C801 movw r24,r16 |
| 461 047c B701 movw r22,r14 |
| 462 047e 24E6 ldi r18,lo8(100) |
| 463 0480 30E0 ldi r19,hi8(100) |
| 464 0482 40E0 ldi r20,hlo8(100) |
| 465 0484 50E0 ldi r21,hhi8(100) |
| 466 0486 0E94 0000 call __divmodsi4 |
| 467 048a 3901 movw r6,r18 |
| 468 048c 6A18 sub r6,r10 |
| 469 048e 7B08 sbc r7,r11 |
| 470 0490 7092 0000 sts (TrimNick)+1,r7 |
| 471 0494 6092 0000 sts TrimNick,r6 |
| 472 0498 6091 0000 lds r22,GIER_GRAD_FAKTOR |
| 473 049c 7091 0000 lds r23,(GIER_GRAD_FAKTOR)+1 |
| 474 04a0 8091 0000 lds r24,(GIER_GRAD_FAKTOR)+2 |
| 475 04a4 9091 0000 lds r25,(GIER_GRAD_FAKTOR)+3 |
| 476 04a8 28E6 ldi r18,lo8(360) |
| 477 04aa 31E0 ldi r19,hi8(360) |
| 478 04ac 40E0 ldi r20,hlo8(360) |
| 479 04ae 50E0 ldi r21,hhi8(360) |
| 480 04b0 0E94 0000 call __mulsi3 |
| 481 04b4 2616 cp r2,r22 |
| 482 04b6 3706 cpc r3,r23 |
| 483 04b8 4806 cpc r4,r24 |
| 484 04ba 5906 cpc r5,r25 |
| 485 04bc 04F0 brlt .L31 |
| 486 04be 261A sub r2,r22 |
| 487 04c0 370A sbc r3,r23 |
| 488 04c2 480A sbc r4,r24 |
| 489 04c4 590A sbc r5,r25 |
| 490 04c6 2092 0000 sts ErsatzKompass,r2 |
| 491 04ca 3092 0000 sts (ErsatzKompass)+1,r3 |
| 492 04ce 4092 0000 sts (ErsatzKompass)+2,r4 |
| 493 04d2 5092 0000 sts (ErsatzKompass)+3,r5 |
| 494 .L31: |
| 495 04d6 57FC sbrc r5,7 |
| 496 04d8 00C0 rjmp .L149 |
| 497 .L33: |
| 498 04da 6B89 ldd r22,Y+19 |
| 499 04dc 7C89 ldd r23,Y+20 |
| 500 04de 680D add r22,r8 |
| 501 04e0 791D adc r23,r9 |
| 502 04e2 9B01 movw r18,r22 |
| 503 04e4 4427 clr r20 |
| 504 04e6 37FD sbrc r19,7 |
| 505 04e8 4095 com r20 |
| 506 04ea 542F mov r21,r20 |
| 507 04ec 8091 0000 lds r24,Mess_IntegralRoll2 |
| 508 04f0 9091 0000 lds r25,(Mess_IntegralRoll2)+1 |
| 509 04f4 A091 0000 lds r26,(Mess_IntegralRoll2)+2 |
| 510 04f8 B091 0000 lds r27,(Mess_IntegralRoll2)+3 |
| 511 04fc 820F add r24,r18 |
| 512 04fe 931F adc r25,r19 |
| 513 0500 A41F adc r26,r20 |
| 514 0502 B51F adc r27,r21 |
| 515 0504 8093 0000 sts Mess_IntegralRoll2,r24 |
| 516 0508 9093 0000 sts (Mess_IntegralRoll2)+1,r25 |
| 517 050c A093 0000 sts (Mess_IntegralRoll2)+2,r26 |
| 518 0510 B093 0000 sts (Mess_IntegralRoll2)+3,r27 |
| 519 0514 8091 0000 lds r24,LageKorrekturRoll |
| 520 0518 9091 0000 lds r25,(LageKorrekturRoll)+1 |
| 521 051c 681B sub r22,r24 |
| 522 051e 790B sbc r23,r25 |
| 523 0520 7B01 movw r14,r22 |
| 524 0522 0027 clr r16 |
| 525 0524 F7FC sbrc r15,7 |
| 526 0526 0095 com r16 |
| 527 0528 102F mov r17,r16 |
| 528 052a 8F85 ldd r24,Y+15 |
| 529 052c 9889 ldd r25,Y+16 |
| 530 052e A989 ldd r26,Y+17 |
| 531 0530 BA89 ldd r27,Y+18 |
| 532 0532 E80E add r14,r24 |
| 533 0534 F91E adc r15,r25 |
| 534 0536 0A1F adc r16,r26 |
| 535 0538 1B1F adc r17,r27 |
| 536 053a E092 0000 sts Mess_IntegralRoll,r14 |
| 537 053e F092 0000 sts (Mess_IntegralRoll)+1,r15 |
| 538 0542 0093 0000 sts (Mess_IntegralRoll)+2,r16 |
| 539 0546 1093 0000 sts (Mess_IntegralRoll)+3,r17 |
| 540 054a 2091 0000 lds r18,Umschlag180Roll |
| 541 054e 3091 0000 lds r19,(Umschlag180Roll)+1 |
| 542 0552 4091 0000 lds r20,(Umschlag180Roll)+2 |
| 543 0556 5091 0000 lds r21,(Umschlag180Roll)+3 |
| 544 055a 2E15 cp r18,r14 |
| 545 055c 3F05 cpc r19,r15 |
| 546 055e 4007 cpc r20,r16 |
| 547 0560 5107 cpc r21,r17 |
| 548 0562 04F4 brge .L35 |
| 549 0564 78EA ldi r23,lo8(25000) |
| 550 0566 E72E mov r14,r23 |
| 551 0568 71E6 ldi r23,hi8(25000) |
| 552 056a F72E mov r15,r23 |
| 553 056c 012D mov r16,__zero_reg__ |
| 554 056e 112D mov r17,__zero_reg__ |
| 555 0570 E21A sub r14,r18 |
| 556 0572 F30A sbc r15,r19 |
| 557 0574 040B sbc r16,r20 |
| 558 0576 150B sbc r17,r21 |
| 559 0578 E092 0000 sts Mess_IntegralRoll,r14 |
| 560 057c F092 0000 sts (Mess_IntegralRoll)+1,r15 |
| 561 0580 0093 0000 sts (Mess_IntegralRoll)+2,r16 |
| 562 0584 1093 0000 sts (Mess_IntegralRoll)+3,r17 |
| 563 0588 E092 0000 sts Mess_IntegralRoll2,r14 |
| 564 058c F092 0000 sts (Mess_IntegralRoll2)+1,r15 |
| 565 0590 0093 0000 sts (Mess_IntegralRoll2)+2,r16 |
| 566 0594 1093 0000 sts (Mess_IntegralRoll2)+3,r17 |
| 567 .L35: |
| 568 0598 8827 clr r24 |
| 569 059a 9927 clr r25 |
| 570 059c DC01 movw r26,r24 |
| 571 059e 821B sub r24,r18 |
| 572 05a0 930B sbc r25,r19 |
| 573 05a2 A40B sbc r26,r20 |
| 574 05a4 B50B sbc r27,r21 |
| 575 05a6 E090 0000 lds r14,Mess_IntegralRoll |
| 576 05aa F090 0000 lds r15,(Mess_IntegralRoll)+1 |
| 577 05ae 0091 0000 lds r16,(Mess_IntegralRoll)+2 |
| 578 05b2 1091 0000 lds r17,(Mess_IntegralRoll)+3 |
| 579 05b6 E816 cp r14,r24 |
| 580 05b8 F906 cpc r15,r25 |
| 581 05ba 0A07 cpc r16,r26 |
| 582 05bc 1B07 cpc r17,r27 |
| 583 05be 04F4 brge .L37 |
| 584 05c0 68E5 ldi r22,lo8(-25000) |
| 585 05c2 E62E mov r14,r22 |
| 586 05c4 6EE9 ldi r22,hi8(-25000) |
| 587 05c6 F62E mov r15,r22 |
| 588 05c8 6FEF ldi r22,hlo8(-25000) |
| 589 05ca 062F mov r16,r22 |
| 590 05cc 6FEF ldi r22,hhi8(-25000) |
| 591 05ce 162F mov r17,r22 |
| 592 05d0 E20E add r14,r18 |
| 593 05d2 F31E adc r15,r19 |
| 594 05d4 041F adc r16,r20 |
| 595 05d6 151F adc r17,r21 |
| 596 05d8 E092 0000 sts Mess_IntegralRoll,r14 |
| 597 05dc F092 0000 sts (Mess_IntegralRoll)+1,r15 |
| 598 05e0 0093 0000 sts (Mess_IntegralRoll)+2,r16 |
| 599 05e4 1093 0000 sts (Mess_IntegralRoll)+3,r17 |
| 600 05e8 E092 0000 sts Mess_IntegralRoll2,r14 |
| 601 05ec F092 0000 sts (Mess_IntegralRoll2)+1,r15 |
| 602 05f0 0093 0000 sts (Mess_IntegralRoll2)+2,r16 |
| 603 05f4 1093 0000 sts (Mess_IntegralRoll2)+3,r17 |
| 604 .L37: |
| 605 05f8 6A8D ldd r22,Y+26 |
| 606 05fa 7B8D ldd r23,Y+27 |
| 607 05fc 660D add r22,r6 |
| 608 05fe 771D adc r23,r7 |
| 609 0600 9B01 movw r18,r22 |
| 610 0602 4427 clr r20 |
| 611 0604 37FD sbrc r19,7 |
| 612 0606 4095 com r20 |
| 613 0608 542F mov r21,r20 |
| 614 060a 8091 0000 lds r24,Mess_IntegralNick2 |
| 615 060e 9091 0000 lds r25,(Mess_IntegralNick2)+1 |
| 616 0612 A091 0000 lds r26,(Mess_IntegralNick2)+2 |
| 617 0616 B091 0000 lds r27,(Mess_IntegralNick2)+3 |
| 618 061a 820F add r24,r18 |
| 619 061c 931F adc r25,r19 |
| 620 061e A41F adc r26,r20 |
| 621 0620 B51F adc r27,r21 |
| 622 0622 8093 0000 sts Mess_IntegralNick2,r24 |
| 623 0626 9093 0000 sts (Mess_IntegralNick2)+1,r25 |
| 624 062a A093 0000 sts (Mess_IntegralNick2)+2,r26 |
| 625 062e B093 0000 sts (Mess_IntegralNick2)+3,r27 |
| 626 0632 8091 0000 lds r24,LageKorrekturNick |
| 627 0636 9091 0000 lds r25,(LageKorrekturNick)+1 |
| 628 063a 681B sub r22,r24 |
| 629 063c 790B sbc r23,r25 |
| 630 063e 9B01 movw r18,r22 |
| 631 0640 4427 clr r20 |
| 632 0642 37FD sbrc r19,7 |
| 633 0644 4095 com r20 |
| 634 0646 542F mov r21,r20 |
| 635 0648 8B85 ldd r24,Y+11 |
| 636 064a 9C85 ldd r25,Y+12 |
| 637 064c AD85 ldd r26,Y+13 |
| 638 064e BE85 ldd r27,Y+14 |
| 639 0650 280F add r18,r24 |
| 640 0652 391F adc r19,r25 |
| 641 0654 4A1F adc r20,r26 |
| 642 0656 5B1F adc r21,r27 |
| 643 0658 2093 0000 sts Mess_IntegralNick,r18 |
| 644 065c 3093 0000 sts (Mess_IntegralNick)+1,r19 |
| 645 0660 4093 0000 sts (Mess_IntegralNick)+2,r20 |
| 646 0664 5093 0000 sts (Mess_IntegralNick)+3,r21 |
| 647 0668 A090 0000 lds r10,Umschlag180Nick |
| 648 066c B090 0000 lds r11,(Umschlag180Nick)+1 |
| 649 0670 C090 0000 lds r12,(Umschlag180Nick)+2 |
| 650 0674 D090 0000 lds r13,(Umschlag180Nick)+3 |
| 651 0678 A216 cp r10,r18 |
| 652 067a B306 cpc r11,r19 |
| 653 067c C406 cpc r12,r20 |
| 654 067e D506 cpc r13,r21 |
| 655 0680 04F4 brge .L39 |
| 656 0682 28EA ldi r18,lo8(25000) |
| 657 0684 31E6 ldi r19,hi8(25000) |
| 658 0686 40E0 ldi r20,hlo8(25000) |
| 659 0688 50E0 ldi r21,hhi8(25000) |
| 660 068a 2A19 sub r18,r10 |
| 661 068c 3B09 sbc r19,r11 |
| 662 068e 4C09 sbc r20,r12 |
| 663 0690 5D09 sbc r21,r13 |
| 664 0692 2093 0000 sts Mess_IntegralNick,r18 |
| 665 0696 3093 0000 sts (Mess_IntegralNick)+1,r19 |
| 666 069a 4093 0000 sts (Mess_IntegralNick)+2,r20 |
| 667 069e 5093 0000 sts (Mess_IntegralNick)+3,r21 |
| 668 06a2 2093 0000 sts Mess_IntegralNick2,r18 |
| 669 06a6 3093 0000 sts (Mess_IntegralNick2)+1,r19 |
| 670 06aa 4093 0000 sts (Mess_IntegralNick2)+2,r20 |
| 671 06ae 5093 0000 sts (Mess_IntegralNick2)+3,r21 |
| 672 .L39: |
| 673 06b2 8827 clr r24 |
| 674 06b4 9927 clr r25 |
| 675 06b6 DC01 movw r26,r24 |
| 676 06b8 8A19 sub r24,r10 |
| 677 06ba 9B09 sbc r25,r11 |
| 678 06bc AC09 sbc r26,r12 |
| 679 06be BD09 sbc r27,r13 |
| 680 06c0 2091 0000 lds r18,Mess_IntegralNick |
| 681 06c4 3091 0000 lds r19,(Mess_IntegralNick)+1 |
| 682 06c8 4091 0000 lds r20,(Mess_IntegralNick)+2 |
| 683 06cc 5091 0000 lds r21,(Mess_IntegralNick)+3 |
| 684 06d0 2817 cp r18,r24 |
| 685 06d2 3907 cpc r19,r25 |
| 686 06d4 4A07 cpc r20,r26 |
| 687 06d6 5B07 cpc r21,r27 |
| 688 06d8 04F4 brge .L41 |
| 689 06da A601 movw r20,r12 |
| 690 06dc 9501 movw r18,r10 |
| 691 06de 285A subi r18,lo8(-(-25000)) |
| 692 06e0 3146 sbci r19,hi8(-(-25000)) |
| 693 06e2 4040 sbci r20,hlo8(-(-25000)) |
| 694 06e4 5040 sbci r21,hhi8(-(-25000)) |
| 695 06e6 2093 0000 sts Mess_IntegralNick,r18 |
| 696 06ea 3093 0000 sts (Mess_IntegralNick)+1,r19 |
| 697 06ee 4093 0000 sts (Mess_IntegralNick)+2,r20 |
| 698 06f2 5093 0000 sts (Mess_IntegralNick)+3,r21 |
| 699 06f6 2093 0000 sts Mess_IntegralNick2,r18 |
| 700 06fa 3093 0000 sts (Mess_IntegralNick2)+1,r19 |
| 701 06fe 4093 0000 sts (Mess_IntegralNick2)+2,r20 |
| 702 0702 5093 0000 sts (Mess_IntegralNick2)+3,r21 |
| 703 .L41: |
| 704 0706 8E89 ldd r24,Y+22 |
| 705 0708 9F89 ldd r25,Y+23 |
| 706 070a A88D ldd r26,Y+24 |
| 707 070c B98D ldd r27,Y+25 |
| 708 070e 8093 0000 sts Integral_Gier,r24 |
| 709 0712 9093 0000 sts (Integral_Gier)+1,r25 |
| 710 0716 A093 0000 sts (Integral_Gier)+2,r26 |
| 711 071a B093 0000 sts (Integral_Gier)+3,r27 |
| 712 071e 2093 0000 sts IntegralNick,r18 |
| 713 0722 3093 0000 sts (IntegralNick)+1,r19 |
| 714 0726 4093 0000 sts (IntegralNick)+2,r20 |
| 715 072a 5093 0000 sts (IntegralNick)+3,r21 |
| 716 072e E092 0000 sts IntegralRoll,r14 |
| 717 0732 F092 0000 sts (IntegralRoll)+1,r15 |
| 718 0736 0093 0000 sts (IntegralRoll)+2,r16 |
| 719 073a 1093 0000 sts (IntegralRoll)+3,r17 |
| 720 073e 8091 0000 lds r24,Mess_IntegralNick2 |
| 721 0742 9091 0000 lds r25,(Mess_IntegralNick2)+1 |
| 722 0746 A091 0000 lds r26,(Mess_IntegralNick2)+2 |
| 723 074a B091 0000 lds r27,(Mess_IntegralNick2)+3 |
| 724 074e 8093 0000 sts IntegralNick2,r24 |
| 725 0752 9093 0000 sts (IntegralNick2)+1,r25 |
| 726 0756 A093 0000 sts (IntegralNick2)+2,r26 |
| 727 075a B093 0000 sts (IntegralNick2)+3,r27 |
| 728 075e 8091 0000 lds r24,Mess_IntegralRoll2 |
| 729 0762 9091 0000 lds r25,(Mess_IntegralRoll2)+1 |
| 730 0766 A091 0000 lds r26,(Mess_IntegralRoll2)+2 |
| 731 076a B091 0000 lds r27,(Mess_IntegralRoll2)+3 |
| 732 076e 8093 0000 sts IntegralRoll2,r24 |
| 733 0772 9093 0000 sts (IntegralRoll2)+1,r25 |
| 734 0776 A093 0000 sts (IntegralRoll2)+2,r26 |
| 735 077a B093 0000 sts (IntegralRoll2)+3,r27 |
| 736 077e 8091 0000 lds r24,HiResNick |
| 737 0782 9091 0000 lds r25,(HiResNick)+1 |
| 738 0786 97FD sbrc r25,7 |
| 739 0788 00C0 rjmp .L150 |
| 740 .L43: |
| 741 078a 9595 asr r25 |
| 742 078c 8795 ror r24 |
| 743 078e 9595 asr r25 |
| 744 0790 8795 ror r24 |
| 745 0792 9595 asr r25 |
| 746 0794 8795 ror r24 |
| 747 0796 9093 0000 sts (MesswertNick)+1,r25 |
| 748 079a 8093 0000 sts MesswertNick,r24 |
| 749 079e 8091 0000 lds r24,HiResRoll |
| 750 07a2 9091 0000 lds r25,(HiResRoll)+1 |
| 751 07a6 97FD sbrc r25,7 |
| 752 07a8 00C0 rjmp .L151 |
| 753 .L44: |
| 754 07aa 9595 asr r25 |
| 755 07ac 8795 ror r24 |
| 756 07ae 9595 asr r25 |
| 757 07b0 8795 ror r24 |
| 758 07b2 9595 asr r25 |
| 759 07b4 8795 ror r24 |
| 760 07b6 9093 0000 sts (MesswertRoll)+1,r25 |
| 761 07ba 8093 0000 sts MesswertRoll,r24 |
| 762 07be 8091 0000 lds r24,AdWertNick |
| 763 07c2 9091 0000 lds r25,(AdWertNick)+1 |
| 764 07c6 0F97 sbiw r24,15 |
| 765 07c8 04F4 brge .L45 |
| 766 07ca 88E1 ldi r24,lo8(-1000) |
| 767 07cc 9CEF ldi r25,hi8(-1000) |
| 768 07ce 9093 0000 sts (MesswertNick)+1,r25 |
| 769 07d2 8093 0000 sts MesswertNick,r24 |
| 770 .L45: |
| 771 07d6 8091 0000 lds r24,AdWertNick |
| 772 07da 9091 0000 lds r25,(AdWertNick)+1 |
| 773 07de 0797 sbiw r24,7 |
| 774 07e0 04F4 brge .L47 |
| 775 07e2 80E3 ldi r24,lo8(-2000) |
| 776 07e4 98EF ldi r25,hi8(-2000) |
| 777 07e6 9093 0000 sts (MesswertNick)+1,r25 |
| 778 07ea 8093 0000 sts MesswertNick,r24 |
| 779 .L47: |
| 780 07ee 2091 0000 lds r18,PlatinenVersion |
| 781 07f2 2A30 cpi r18,lo8(10) |
| 782 07f4 01F4 brne .+2 |
| 783 07f6 00C0 rjmp .L152 |
| 784 07f8 8091 0000 lds r24,AdWertNick |
| 785 07fc 9091 0000 lds r25,(AdWertNick)+1 |
| 786 0800 815D subi r24,lo8(2001) |
| 787 0802 9740 sbci r25,hi8(2001) |
| 788 0804 04F0 brlt .L55 |
| 789 0806 88EE ldi r24,lo8(1000) |
| 790 0808 93E0 ldi r25,hi8(1000) |
| 791 080a 9093 0000 sts (MesswertNick)+1,r25 |
| 792 080e 8093 0000 sts MesswertNick,r24 |
| 793 .L55: |
| 794 0812 8091 0000 lds r24,AdWertNick |
| 795 0816 9091 0000 lds r25,(AdWertNick)+1 |
| 796 081a 805E subi r24,lo8(2016) |
| 797 081c 9740 sbci r25,hi8(2016) |
| 798 081e 04F0 brlt .+2 |
| 799 0820 00C0 rjmp .L144 |
| 800 .L53: |
| 801 0822 8091 0000 lds r24,AdWertRoll |
| 802 0826 9091 0000 lds r25,(AdWertRoll)+1 |
| 803 082a 0F97 sbiw r24,15 |
| 804 082c 04F4 brge .L58 |
| 805 082e 88E1 ldi r24,lo8(-1000) |
| 806 0830 9CEF ldi r25,hi8(-1000) |
| 807 0832 9093 0000 sts (MesswertRoll)+1,r25 |
| 808 0836 8093 0000 sts MesswertRoll,r24 |
| 809 .L58: |
| 810 083a 8091 0000 lds r24,AdWertRoll |
| 811 083e 9091 0000 lds r25,(AdWertRoll)+1 |
| 812 0842 0797 sbiw r24,7 |
| 813 0844 04F4 brge .L60 |
| 814 0846 80E3 ldi r24,lo8(-2000) |
| 815 0848 98EF ldi r25,hi8(-2000) |
| 816 084a 9093 0000 sts (MesswertRoll)+1,r25 |
| 817 084e 8093 0000 sts MesswertRoll,r24 |
| 818 .L60: |
| 819 0852 2A30 cpi r18,lo8(10) |
| 820 0854 01F4 brne .+2 |
| 821 0856 00C0 rjmp .L153 |
| 822 0858 8091 0000 lds r24,AdWertRoll |
| 823 085c 9091 0000 lds r25,(AdWertRoll)+1 |
| 824 0860 815D subi r24,lo8(2001) |
| 825 0862 9740 sbci r25,hi8(2001) |
| 826 0864 04F0 brlt .L68 |
| 827 0866 88EE ldi r24,lo8(1000) |
| 828 0868 93E0 ldi r25,hi8(1000) |
| 829 086a 9093 0000 sts (MesswertRoll)+1,r25 |
| 830 086e 8093 0000 sts MesswertRoll,r24 |
| 831 .L68: |
| 832 0872 8091 0000 lds r24,AdWertRoll |
| 833 0876 9091 0000 lds r25,(AdWertRoll)+1 |
| 834 087a 805E subi r24,lo8(2016) |
| 835 087c 9740 sbci r25,hi8(2016) |
| 836 087e 04F0 brlt .+2 |
| 837 0880 00C0 rjmp .L145 |
| 838 .L66: |
| 839 0882 6091 0000 lds r22,Parameter_Gyro_D |
| 840 0886 6623 tst r22 |
| 841 0888 01F4 brne .+2 |
| 842 088a 00C0 rjmp .L71 |
| 843 088c 4091 0000 lds r20,HiResNick |
| 844 0890 5091 0000 lds r21,(HiResNick)+1 |
| 845 0894 8091 0000 lds r24,oldNick.2656 |
| 846 0898 9091 0000 lds r25,(oldNick.2656)+1 |
| 847 089c 481B sub r20,r24 |
| 848 089e 590B sbc r21,r25 |
| 849 08a0 5093 0000 sts (d2Nick.2659)+1,r21 |
| 850 08a4 4093 0000 sts d2Nick.2659,r20 |
| 851 08a8 2091 0000 lds r18,HiResNick |
| 852 08ac 3091 0000 lds r19,(HiResNick)+1 |
| 853 08b0 280F add r18,r24 |
| 854 08b2 391F adc r19,r25 |
| 855 08b4 37FD sbrc r19,7 |
| 856 08b6 00C0 rjmp .L154 |
| 857 .L73: |
| 858 08b8 3595 asr r19 |
| 859 08ba 2795 ror r18 |
| 860 08bc 3093 0000 sts (oldNick.2656)+1,r19 |
| 861 08c0 2093 0000 sts oldNick.2656,r18 |
| 862 08c4 4138 cpi r20,129 |
| 863 08c6 5105 cpc r21,__zero_reg__ |
| 864 08c8 04F4 brge .+2 |
| 865 08ca 00C0 rjmp .L74 |
| 866 08cc 80E8 ldi r24,lo8(128) |
| 867 08ce 90E0 ldi r25,hi8(128) |
| 868 08d0 9093 0000 sts (d2Nick.2659)+1,r25 |
| 869 08d4 8093 0000 sts d2Nick.2659,r24 |
| 870 .L76: |
| 871 08d8 E62F mov r30,r22 |
| 872 08da F0E0 ldi r31,lo8(0) |
| 873 08dc 8091 0000 lds r24,d2Nick.2659 |
| 874 08e0 9091 0000 lds r25,(d2Nick.2659)+1 |
| 875 08e4 E89F mul r30,r24 |
| 876 08e6 B001 movw r22,r0 |
| 877 08e8 E99F mul r30,r25 |
| 878 08ea 700D add r23,r0 |
| 879 08ec F89F mul r31,r24 |
| 880 08ee 700D add r23,r0 |
| 881 08f0 1124 clr r1 |
| 882 08f2 9B01 movw r18,r22 |
| 883 08f4 77FD sbrc r23,7 |
| 884 08f6 00C0 rjmp .L155 |
| 885 .L78: |
| 886 08f8 3595 asr r19 |
| 887 08fa 2795 ror r18 |
| 888 08fc 3595 asr r19 |
| 889 08fe 2795 ror r18 |
| 890 0900 3595 asr r19 |
| 891 0902 2795 ror r18 |
| 892 0904 3595 asr r19 |
| 893 0906 2795 ror r18 |
| 894 0908 8091 0000 lds r24,MesswertNick |
| 895 090c 9091 0000 lds r25,(MesswertNick)+1 |
| 896 0910 820F add r24,r18 |
| 897 0912 931F adc r25,r19 |
| 898 0914 9093 0000 sts (MesswertNick)+1,r25 |
| 899 0918 8093 0000 sts MesswertNick,r24 |
| 900 091c 4091 0000 lds r20,HiResRoll |
| 901 0920 5091 0000 lds r21,(HiResRoll)+1 |
| 902 0924 8091 0000 lds r24,oldRoll.2657 |
| 903 0928 9091 0000 lds r25,(oldRoll.2657)+1 |
| 904 092c 481B sub r20,r24 |
| 905 092e 590B sbc r21,r25 |
| 906 0930 5093 0000 sts (d2Roll.2658)+1,r21 |
| 907 0934 4093 0000 sts d2Roll.2658,r20 |
| 908 0938 2091 0000 lds r18,HiResRoll |
| 909 093c 3091 0000 lds r19,(HiResRoll)+1 |
| 910 0940 280F add r18,r24 |
| 911 0942 391F adc r19,r25 |
| 912 0944 37FD sbrc r19,7 |
| 913 0946 00C0 rjmp .L156 |
| 914 .L79: |
| 915 0948 3595 asr r19 |
| 916 094a 2795 ror r18 |
| 917 094c 3093 0000 sts (oldRoll.2657)+1,r19 |
| 918 0950 2093 0000 sts oldRoll.2657,r18 |
| 919 0954 4138 cpi r20,129 |
| 920 0956 5105 cpc r21,__zero_reg__ |
| 921 0958 04F4 brge .+2 |
| 922 095a 00C0 rjmp .L80 |
| 923 095c 80E8 ldi r24,lo8(128) |
| 924 095e 90E0 ldi r25,hi8(128) |
| 925 0960 9093 0000 sts (d2Roll.2658)+1,r25 |
| 926 0964 8093 0000 sts d2Roll.2658,r24 |
| 927 .L82: |
| 928 0968 8091 0000 lds r24,d2Roll.2658 |
| 929 096c 9091 0000 lds r25,(d2Roll.2658)+1 |
| 930 0970 E89F mul r30,r24 |
| 931 0972 A001 movw r20,r0 |
| 932 0974 E99F mul r30,r25 |
| 933 0976 500D add r21,r0 |
| 934 0978 F89F mul r31,r24 |
| 935 097a 500D add r21,r0 |
| 936 097c 1124 clr r1 |
| 937 097e 9A01 movw r18,r20 |
| 938 0980 57FD sbrc r21,7 |
| 939 0982 00C0 rjmp .L157 |
| 940 .L84: |
| 941 0984 3595 asr r19 |
| 942 0986 2795 ror r18 |
| 943 0988 3595 asr r19 |
| 944 098a 2795 ror r18 |
| 945 098c 3595 asr r19 |
| 946 098e 2795 ror r18 |
| 947 0990 3595 asr r19 |
| 948 0992 2795 ror r18 |
| 949 0994 8091 0000 lds r24,MesswertRoll |
| 950 0998 9091 0000 lds r25,(MesswertRoll)+1 |
| 951 099c 820F add r24,r18 |
| 952 099e 931F adc r25,r19 |
| 953 09a0 9093 0000 sts (MesswertRoll)+1,r25 |
| 954 09a4 8093 0000 sts MesswertRoll,r24 |
| 955 09a8 8091 0000 lds r24,HiResNick |
| 956 09ac 9091 0000 lds r25,(HiResNick)+1 |
| 957 09b0 680F add r22,r24 |
| 958 09b2 791F adc r23,r25 |
| 959 09b4 7093 0000 sts (HiResNick)+1,r23 |
| 960 09b8 6093 0000 sts HiResNick,r22 |
| 961 09bc 8091 0000 lds r24,HiResRoll |
| 962 09c0 9091 0000 lds r25,(HiResRoll)+1 |
| 963 09c4 480F add r20,r24 |
| 964 09c6 591F adc r21,r25 |
| 965 09c8 5093 0000 sts (HiResRoll)+1,r21 |
| 966 09cc 4093 0000 sts HiResRoll,r20 |
| 967 .L71: |
| 968 09d0 8B89 ldd r24,Y+19 |
| 969 09d2 9C89 ldd r25,Y+20 |
| 970 09d4 1816 cp __zero_reg__,r24 |
| 971 09d6 1906 cpc __zero_reg__,r25 |
| 972 09d8 04F0 brlt .+2 |
| 973 09da 00C0 rjmp .L85 |
| 974 09dc 9D89 ldd r25,Y+21 |
| 975 09de E92E mov r14,r25 |
| 976 09e0 FF24 clr r15 |
| 977 09e2 00E0 ldi r16,lo8(0) |
| 978 09e4 10E0 ldi r17,hi8(0) |
| 979 09e6 6091 0000 lds r22,KopplungsteilNickRoll |
| 980 09ea 7091 0000 lds r23,(KopplungsteilNickRoll)+1 |
| 981 09ee 77FD sbrc r23,7 |
| 982 09f0 00C0 rjmp .L158 |
| 983 .L87: |
| 984 09f2 8827 clr r24 |
| 985 09f4 77FD sbrc r23,7 |
| 986 09f6 8095 com r24 |
| 987 09f8 982F mov r25,r24 |
| 988 09fa A801 movw r20,r16 |
| 989 09fc 9701 movw r18,r14 |
| 990 09fe 0E94 0000 call __mulsi3 |
| 991 0a02 20E4 ldi r18,lo8(64) |
| 992 0a04 30E0 ldi r19,hi8(64) |
| 993 0a06 40E0 ldi r20,hlo8(64) |
| 994 0a08 50E0 ldi r21,hhi8(64) |
| 995 0a0a 0E94 0000 call __divmodsi4 |
| 996 0a0e 820E add r8,r18 |
| 997 0a10 931E adc r9,r19 |
| 998 0a12 9092 0000 sts (TrimRoll)+1,r9 |
| 999 0a16 8092 0000 sts TrimRoll,r8 |
| 1000 0a1a EA8D ldd r30,Y+26 |
| 1001 0a1c FB8D ldd r31,Y+27 |
| 1002 0a1e 1E16 cp __zero_reg__,r30 |
| 1003 0a20 1F06 cpc __zero_reg__,r31 |
| 1004 0a22 04F0 brlt .+2 |
| 1005 0a24 00C0 rjmp .L90 |
| 1006 .L171: |
| 1007 0a26 2091 0000 lds r18,KopplungsteilRollNick |
| 1008 0a2a 3091 0000 lds r19,(KopplungsteilRollNick)+1 |
| 1009 0a2e 37FD sbrc r19,7 |
| 1010 0a30 00C0 rjmp .L159 |
| 1011 .L92: |
| 1012 0a32 4427 clr r20 |
| 1013 0a34 37FD sbrc r19,7 |
| 1014 0a36 4095 com r20 |
| 1015 0a38 542F mov r21,r20 |
| 1016 0a3a C801 movw r24,r16 |
| 1017 0a3c B701 movw r22,r14 |
| 1018 0a3e 0E94 0000 call __mulsi3 |
| 1019 0a42 20E4 ldi r18,lo8(64) |
| 1020 0a44 30E0 ldi r19,hi8(64) |
| 1021 0a46 40E0 ldi r20,hlo8(64) |
| 1022 0a48 50E0 ldi r21,hhi8(64) |
| 1023 0a4a 0E94 0000 call __divmodsi4 |
| 1024 0a4e 620E add r6,r18 |
| 1025 0a50 731E adc r7,r19 |
| 1026 0a52 7092 0000 sts (TrimNick)+1,r7 |
| 1027 0a56 6092 0000 sts TrimNick,r6 |
| 1028 0a5a F981 ldd r31,Y+1 |
| 1029 0a5c F7FD sbrc r31,7 |
| 1030 0a5e 00C0 rjmp .L160 |
| 1031 .L95: |
| 1032 0a60 8091 0000 lds r24,EE_Parameter+4 |
| 1033 0a64 E82F mov r30,r24 |
| 1034 0a66 F0E0 ldi r31,lo8(0) |
| 1035 0a68 EE0F lsl r30 |
| 1036 0a6a FF1F rol r31 |
| 1037 0a6c E050 subi r30,lo8(-(PPM_in)) |
| 1038 0a6e F040 sbci r31,hi8(-(PPM_in)) |
| 1039 0a70 8081 ld r24,Z |
| 1040 0a72 9181 ldd r25,Z+1 |
| 1041 0a74 A091 0000 lds r26,Poti1 |
| 1042 0a78 B091 0000 lds r27,(Poti1)+1 |
| 1043 0a7c 8259 subi r24,lo8(-(110)) |
| 1044 0a7e 9F4F sbci r25,hi8(-(110)) |
| 1045 0a80 A817 cp r26,r24 |
| 1046 0a82 B907 cpc r27,r25 |
| 1047 0a84 04F0 brlt .+2 |
| 1048 0a86 00C0 rjmp .L106 |
| 1049 0a88 1196 adiw r26,1 |
| 1050 0a8a B093 0000 sts (Poti1)+1,r27 |
| 1051 0a8e A093 0000 sts Poti1,r26 |
| 1052 .L108: |
| 1053 0a92 8091 0000 lds r24,EE_Parameter+5 |
| 1054 0a96 E82F mov r30,r24 |
| 1055 0a98 F0E0 ldi r31,lo8(0) |
| 1056 0a9a EE0F lsl r30 |
| 1057 0a9c FF1F rol r31 |
| 1058 0a9e E050 subi r30,lo8(-(PPM_in)) |
| 1059 0aa0 F040 sbci r31,hi8(-(PPM_in)) |
| 1060 0aa2 8081 ld r24,Z |
| 1061 0aa4 9181 ldd r25,Z+1 |
| 1062 0aa6 6091 0000 lds r22,Poti2 |
| 1063 0aaa 7091 0000 lds r23,(Poti2)+1 |
| 1064 0aae 8259 subi r24,lo8(-(110)) |
| 1065 0ab0 9F4F sbci r25,hi8(-(110)) |
| 1066 0ab2 6817 cp r22,r24 |
| 1067 0ab4 7907 cpc r23,r25 |
| 1068 0ab6 04F0 brlt .+2 |
| 1069 0ab8 00C0 rjmp .L111 |
| 1070 0aba 6F5F subi r22,lo8(-(1)) |
| 1071 0abc 7F4F sbci r23,hi8(-(1)) |
| 1072 0abe 7093 0000 sts (Poti2)+1,r23 |
| 1073 0ac2 6093 0000 sts Poti2,r22 |
| 1074 .L113: |
| 1075 0ac6 8091 0000 lds r24,EE_Parameter+6 |
| 1076 0aca E82F mov r30,r24 |
| 1077 0acc F0E0 ldi r31,lo8(0) |
| 1078 0ace EE0F lsl r30 |
| 1079 0ad0 FF1F rol r31 |
| 1080 0ad2 E050 subi r30,lo8(-(PPM_in)) |
| 1081 0ad4 F040 sbci r31,hi8(-(PPM_in)) |
| 1082 0ad6 8081 ld r24,Z |
| 1083 0ad8 9181 ldd r25,Z+1 |
| 1084 0ada 4091 0000 lds r20,Poti3 |
| 1085 0ade 5091 0000 lds r21,(Poti3)+1 |
| 1086 0ae2 8259 subi r24,lo8(-(110)) |
| 1087 0ae4 9F4F sbci r25,hi8(-(110)) |
| 1088 0ae6 4817 cp r20,r24 |
| 1089 0ae8 5907 cpc r21,r25 |
| 1090 0aea 04F0 brlt .+2 |
| 1091 0aec 00C0 rjmp .L116 |
| 1092 0aee 4F5F subi r20,lo8(-(1)) |
| 1093 0af0 5F4F sbci r21,hi8(-(1)) |
| 1094 0af2 5093 0000 sts (Poti3)+1,r21 |
| 1095 0af6 4093 0000 sts Poti3,r20 |
| 1096 .L118: |
| 1097 0afa 8091 0000 lds r24,EE_Parameter+7 |
| 1098 0afe E82F mov r30,r24 |
| 1099 0b00 F0E0 ldi r31,lo8(0) |
| 1100 0b02 EE0F lsl r30 |
| 1101 0b04 FF1F rol r31 |
| 1102 0b06 E050 subi r30,lo8(-(PPM_in)) |
| 1103 0b08 F040 sbci r31,hi8(-(PPM_in)) |
| 1104 0b0a 8081 ld r24,Z |
| 1105 0b0c 9181 ldd r25,Z+1 |
| 1106 0b0e 2091 0000 lds r18,Poti4 |
| 1107 0b12 3091 0000 lds r19,(Poti4)+1 |
| 1108 0b16 8259 subi r24,lo8(-(110)) |
| 1109 0b18 9F4F sbci r25,hi8(-(110)) |
| 1110 0b1a 2817 cp r18,r24 |
| 1111 0b1c 3907 cpc r19,r25 |
| 1112 0b1e 04F0 brlt .+2 |
| 1113 0b20 00C0 rjmp .L121 |
| 1114 0b22 2F5F subi r18,lo8(-(1)) |
| 1115 0b24 3F4F sbci r19,hi8(-(1)) |
| 1116 0b26 3093 0000 sts (Poti4)+1,r19 |
| 1117 0b2a 2093 0000 sts Poti4,r18 |
| 1118 .L123: |
| 1119 0b2e B7FD sbrc r27,7 |
| 1120 0b30 00C0 rjmp .L161 |
| 1121 .L126: |
| 1122 0b32 AF3F cpi r26,255 |
| 1123 0b34 B105 cpc r27,__zero_reg__ |
| 1124 0b36 01F0 breq .+4 |
| 1125 0b38 04F0 brlt .+2 |
| 1126 0b3a 00C0 rjmp .L162 |
| 1127 .L128: |
| 1128 0b3c 77FD sbrc r23,7 |
| 1129 0b3e 00C0 rjmp .L163 |
| 1130 .L130: |
| 1131 0b40 6F3F cpi r22,255 |
| 1132 0b42 7105 cpc r23,__zero_reg__ |
| 1133 0b44 01F0 breq .+4 |
| 1134 0b46 04F0 brlt .+2 |
| 1135 0b48 00C0 rjmp .L164 |
| 1136 .L132: |
| 1137 0b4a 57FD sbrc r21,7 |
| 1138 0b4c 00C0 rjmp .L165 |
| 1139 .L134: |
| 1140 0b4e 4F3F cpi r20,255 |
| 1141 0b50 5105 cpc r21,__zero_reg__ |
| 1142 0b52 01F0 breq .+4 |
| 1143 0b54 04F0 brlt .+2 |
| 1144 0b56 00C0 rjmp .L166 |
| 1145 .L136: |
| 1146 0b58 37FD sbrc r19,7 |
| 1147 0b5a 00C0 rjmp .L167 |
| 1148 .L138: |
| 1149 0b5c 2F3F cpi r18,255 |
| 1150 0b5e 3105 cpc r19,__zero_reg__ |
| 1151 0b60 01F0 breq .+2 |
| 1152 0b62 04F4 brge .+2 |
| 1153 0b64 00C0 rjmp .L142 |
| 1154 0b66 8FEF ldi r24,lo8(255) |
| 1155 0b68 90E0 ldi r25,hi8(255) |
| 1156 0b6a 9093 0000 sts (Poti4)+1,r25 |
| 1157 0b6e 8093 0000 sts Poti4,r24 |
| 1158 0b72 00C0 rjmp .L142 |
| 1159 .L153: |
| 1160 0b74 8091 0000 lds r24,AdWertRoll |
| 1161 0b78 9091 0000 lds r25,(AdWertRoll)+1 |
| 1162 0b7c 835F subi r24,lo8(1011) |
| 1163 0b7e 9340 sbci r25,hi8(1011) |
| 1164 0b80 04F0 brlt .L64 |
| 1165 0b82 88EE ldi r24,lo8(1000) |
| 1166 0b84 93E0 ldi r25,hi8(1000) |
| 1167 0b86 9093 0000 sts (MesswertRoll)+1,r25 |
| 1168 0b8a 8093 0000 sts MesswertRoll,r24 |
| 1169 .L64: |
| 1170 0b8e 8091 0000 lds r24,AdWertRoll |
| 1171 0b92 9091 0000 lds r25,(AdWertRoll)+1 |
| 1172 0b96 8A5F subi r24,lo8(1018) |
| 1173 0b98 9340 sbci r25,hi8(1018) |
| 1174 0b9a 04F4 brge .+2 |
| 1175 0b9c 00C0 rjmp .L66 |
| 1176 .L145: |
| 1177 0b9e 80ED ldi r24,lo8(2000) |
| 1178 0ba0 97E0 ldi r25,hi8(2000) |
| 1179 0ba2 9093 0000 sts (MesswertRoll)+1,r25 |
| 1180 0ba6 8093 0000 sts MesswertRoll,r24 |
| 1181 0baa 00C0 rjmp .L66 |
| 1182 .L152: |
| 1183 0bac 8091 0000 lds r24,AdWertNick |
| 1184 0bb0 9091 0000 lds r25,(AdWertNick)+1 |
| 1185 0bb4 835F subi r24,lo8(1011) |
| 1186 0bb6 9340 sbci r25,hi8(1011) |
| 1187 0bb8 04F0 brlt .L51 |
| 1188 0bba 88EE ldi r24,lo8(1000) |
| 1189 0bbc 93E0 ldi r25,hi8(1000) |
| 1190 0bbe 9093 0000 sts (MesswertNick)+1,r25 |
| 1191 0bc2 8093 0000 sts MesswertNick,r24 |
| 1192 .L51: |
| 1193 0bc6 8091 0000 lds r24,AdWertNick |
| 1194 0bca 9091 0000 lds r25,(AdWertNick)+1 |
| 1195 0bce 8A5F subi r24,lo8(1018) |
| 1196 0bd0 9340 sbci r25,hi8(1018) |
| 1197 0bd2 04F4 brge .+2 |
| 1198 0bd4 00C0 rjmp .L53 |
| 1199 .L144: |
| 1200 0bd6 80ED ldi r24,lo8(2000) |
| 1201 0bd8 97E0 ldi r25,hi8(2000) |
| 1202 0bda 9093 0000 sts (MesswertNick)+1,r25 |
| 1203 0bde 8093 0000 sts MesswertNick,r24 |
| 1204 0be2 00C0 rjmp .L53 |
| 1205 .L121: |
| 1206 0be4 8081 ld r24,Z |
| 1207 0be6 9181 ldd r25,Z+1 |
| 1208 0be8 8259 subi r24,lo8(-(110)) |
| 1209 0bea 9F4F sbci r25,hi8(-(110)) |
| 1210 0bec 8217 cp r24,r18 |
| 1211 0bee 9307 cpc r25,r19 |
| 1212 0bf0 04F0 brlt .+2 |
| 1213 0bf2 00C0 rjmp .L123 |
| 1214 0bf4 2115 cp r18,__zero_reg__ |
| 1215 0bf6 3105 cpc r19,__zero_reg__ |
| 1216 0bf8 01F4 brne .+2 |
| 1217 0bfa 00C0 rjmp .L123 |
| 1218 0bfc 2150 subi r18,lo8(-(-1)) |
| 1219 0bfe 3040 sbci r19,hi8(-(-1)) |
| 1220 0c00 3093 0000 sts (Poti4)+1,r19 |
| 1221 0c04 2093 0000 sts Poti4,r18 |
| 1222 0c08 B7FF sbrs r27,7 |
| 1223 0c0a 00C0 rjmp .L126 |
| 1224 .L161: |
| 1225 0c0c 1092 0000 sts (Poti1)+1,__zero_reg__ |
| 1226 0c10 1092 0000 sts Poti1,__zero_reg__ |
| 1227 0c14 77FF sbrs r23,7 |
| 1228 0c16 00C0 rjmp .L130 |
| 1229 .L163: |
| 1230 0c18 1092 0000 sts (Poti2)+1,__zero_reg__ |
| 1231 0c1c 1092 0000 sts Poti2,__zero_reg__ |
| 1232 0c20 57FF sbrs r21,7 |
| 1233 0c22 00C0 rjmp .L134 |
| 1234 .L165: |
| 1235 0c24 1092 0000 sts (Poti3)+1,__zero_reg__ |
| 1236 0c28 1092 0000 sts Poti3,__zero_reg__ |
| 1237 0c2c 37FF sbrs r19,7 |
| 1238 0c2e 00C0 rjmp .L138 |
| 1239 .L167: |
| 1240 0c30 1092 0000 sts (Poti4)+1,__zero_reg__ |
| 1241 0c34 1092 0000 sts Poti4,__zero_reg__ |
| 1242 0c38 00C0 rjmp .L142 |
| 1243 .L116: |
| 1244 0c3a 8081 ld r24,Z |
| 1245 0c3c 9181 ldd r25,Z+1 |
| 1246 0c3e 8259 subi r24,lo8(-(110)) |
| 1247 0c40 9F4F sbci r25,hi8(-(110)) |
| 1248 0c42 8417 cp r24,r20 |
| 1249 0c44 9507 cpc r25,r21 |
| 1250 0c46 04F0 brlt .+2 |
| 1251 0c48 00C0 rjmp .L118 |
| 1252 0c4a 4115 cp r20,__zero_reg__ |
| 1253 0c4c 5105 cpc r21,__zero_reg__ |
| 1254 0c4e 01F4 brne .+2 |
| 1255 0c50 00C0 rjmp .L118 |
| 1256 0c52 4150 subi r20,lo8(-(-1)) |
| 1257 0c54 5040 sbci r21,hi8(-(-1)) |
| 1258 0c56 5093 0000 sts (Poti3)+1,r21 |
| 1259 0c5a 4093 0000 sts Poti3,r20 |
| 1260 0c5e 00C0 rjmp .L118 |
| 1261 .L111: |
| 1262 0c60 8081 ld r24,Z |
| 1263 0c62 9181 ldd r25,Z+1 |
| 1264 0c64 8259 subi r24,lo8(-(110)) |
| 1265 0c66 9F4F sbci r25,hi8(-(110)) |
| 1266 0c68 8617 cp r24,r22 |
| 1267 0c6a 9707 cpc r25,r23 |
| 1268 0c6c 04F0 brlt .+2 |
| 1269 0c6e 00C0 rjmp .L113 |
| 1270 0c70 6115 cp r22,__zero_reg__ |
| 1271 0c72 7105 cpc r23,__zero_reg__ |
| 1272 0c74 01F4 brne .+2 |
| 1273 0c76 00C0 rjmp .L113 |
| 1274 0c78 6150 subi r22,lo8(-(-1)) |
| 1275 0c7a 7040 sbci r23,hi8(-(-1)) |
| 1276 0c7c 7093 0000 sts (Poti2)+1,r23 |
| 1277 0c80 6093 0000 sts Poti2,r22 |
| 1278 0c84 00C0 rjmp .L113 |
| 1279 .L106: |
| 1280 0c86 8081 ld r24,Z |
| 1281 0c88 9181 ldd r25,Z+1 |
| 1282 0c8a 8259 subi r24,lo8(-(110)) |
| 1283 0c8c 9F4F sbci r25,hi8(-(110)) |
| 1284 0c8e 8A17 cp r24,r26 |
| 1285 0c90 9B07 cpc r25,r27 |
| 1286 0c92 04F0 brlt .+2 |
| 1287 0c94 00C0 rjmp .L108 |
| 1288 0c96 1097 sbiw r26,0 |
| 1289 0c98 01F4 brne .+2 |
| 1290 0c9a 00C0 rjmp .L108 |
| 1291 0c9c 1197 sbiw r26,1 |
| 1292 0c9e B093 0000 sts (Poti1)+1,r27 |
| 1293 0ca2 A093 0000 sts Poti1,r26 |
| 1294 0ca6 00C0 rjmp .L108 |
| 1295 .L166: |
| 1296 0ca8 8FEF ldi r24,lo8(255) |
| 1297 0caa 90E0 ldi r25,hi8(255) |
| 1298 0cac 9093 0000 sts (Poti3)+1,r25 |
| 1299 0cb0 8093 0000 sts Poti3,r24 |
| 1300 0cb4 00C0 rjmp .L136 |
| 1301 .L164: |
| 1302 0cb6 8FEF ldi r24,lo8(255) |
| 1303 0cb8 90E0 ldi r25,hi8(255) |
| 1304 0cba 9093 0000 sts (Poti2)+1,r25 |
| 1305 0cbe 8093 0000 sts Poti2,r24 |
| 1306 0cc2 00C0 rjmp .L132 |
| 1307 .L162: |
| 1308 0cc4 8FEF ldi r24,lo8(255) |
| 1309 0cc6 90E0 ldi r25,hi8(255) |
| 1310 0cc8 9093 0000 sts (Poti1)+1,r25 |
| 1311 0ccc 8093 0000 sts Poti1,r24 |
| 1312 0cd0 00C0 rjmp .L128 |
| 1313 .L74: |
| 1314 0cd2 4058 subi r20,lo8(-128) |
| 1315 0cd4 5F4F sbci r21,hi8(-128) |
| 1316 0cd6 04F0 brlt .+2 |
| 1317 0cd8 00C0 rjmp .L76 |
| 1318 0cda 80E8 ldi r24,lo8(-128) |
| 1319 0cdc 9FEF ldi r25,hi8(-128) |
| 1320 0cde 9093 0000 sts (d2Nick.2659)+1,r25 |
| 1321 0ce2 8093 0000 sts d2Nick.2659,r24 |
| 1322 0ce6 00C0 rjmp .L76 |
| 1323 .L148: |
| 1324 0ce8 B091 0000 lds r27,EE_Parameter+8 |
| 1325 0cec B983 std Y+1,r27 |
| 1326 0cee B6FF sbrs r27,6 |
| 1327 0cf0 00C0 rjmp .L18 |
| 1328 0cf2 2F85 ldd r18,Y+15 |
| 1329 0cf4 3889 ldd r19,Y+16 |
| 1330 0cf6 4989 ldd r20,Y+17 |
| 1331 0cf8 5A89 ldd r21,Y+18 |
| 1332 0cfa 283B cpi r18,lo8(-93000) |
| 1333 0cfc E4E9 ldi r30,hi8(-93000) |
| 1334 0cfe 3E07 cpc r19,r30 |
| 1335 0d00 EEEF ldi r30,hlo8(-93000) |
| 1336 0d02 4E07 cpc r20,r30 |
| 1337 0d04 EFEF ldi r30,hhi8(-93000) |
| 1338 0d06 5E07 cpc r21,r30 |
| 1339 0d08 04F4 brge .L20 |
| 1340 0d0a 28EB ldi r18,lo8(-93000) |
| 1341 0d0c 34E9 ldi r19,hi8(-93000) |
| 1342 0d0e 4EEF ldi r20,hlo8(-93000) |
| 1343 0d10 5FEF ldi r21,hhi8(-93000) |
| 1344 .L20: |
| 1345 0d12 2A83 std Y+2,r18 |
| 1346 0d14 3B83 std Y+3,r19 |
| 1347 0d16 4C83 std Y+4,r20 |
| 1348 0d18 5D83 std Y+5,r21 |
| 1349 0d1a 2954 subi r18,lo8(93001) |
| 1350 0d1c 3B46 sbci r19,hi8(93001) |
| 1351 0d1e 4140 sbci r20,hlo8(93001) |
| 1352 0d20 5040 sbci r21,hhi8(93001) |
| 1353 0d22 04F0 brlt .L21 |
| 1354 0d24 88E4 ldi r24,lo8(93000) |
| 1355 0d26 9BE6 ldi r25,hi8(93000) |
| 1356 0d28 A1E0 ldi r26,hlo8(93000) |
| 1357 0d2a B0E0 ldi r27,hhi8(93000) |
| 1358 0d2c 8A83 std Y+2,r24 |
| 1359 0d2e 9B83 std Y+3,r25 |
| 1360 0d30 AC83 std Y+4,r26 |
| 1361 0d32 BD83 std Y+5,r27 |
| 1362 .L21: |
| 1363 0d34 2B85 ldd r18,Y+11 |
| 1364 0d36 3C85 ldd r19,Y+12 |
| 1365 0d38 4D85 ldd r20,Y+13 |
| 1366 0d3a 5E85 ldd r21,Y+14 |
| 1367 0d3c 283B cpi r18,lo8(-93000) |
| 1368 0d3e 94E9 ldi r25,hi8(-93000) |
| 1369 0d40 3907 cpc r19,r25 |
| 1370 0d42 9EEF ldi r25,hlo8(-93000) |
| 1371 0d44 4907 cpc r20,r25 |
| 1372 0d46 9FEF ldi r25,hhi8(-93000) |
| 1373 0d48 5907 cpc r21,r25 |
| 1374 0d4a 04F4 brge .L22 |
| 1375 0d4c 28EB ldi r18,lo8(-93000) |
| 1376 0d4e 34E9 ldi r19,hi8(-93000) |
| 1377 0d50 4EEF ldi r20,hlo8(-93000) |
| 1378 0d52 5FEF ldi r21,hhi8(-93000) |
| 1379 .L22: |
| 1380 0d54 2E83 std Y+6,r18 |
| 1381 0d56 3F83 std Y+7,r19 |
| 1382 0d58 4887 std Y+8,r20 |
| 1383 0d5a 5987 std Y+9,r21 |
| 1384 0d5c 2954 subi r18,lo8(93001) |
| 1385 0d5e 3B46 sbci r19,hi8(93001) |
| 1386 0d60 4140 sbci r20,hlo8(93001) |
| 1387 0d62 5040 sbci r21,hhi8(93001) |
| 1388 0d64 04F0 brlt .L23 |
| 1389 0d66 88E4 ldi r24,lo8(93000) |
| 1390 0d68 9BE6 ldi r25,hi8(93000) |
| 1391 0d6a A1E0 ldi r26,hlo8(93000) |
| 1392 0d6c B0E0 ldi r27,hhi8(93000) |
| 1393 0d6e 8E83 std Y+6,r24 |
| 1394 0d70 9F83 std Y+7,r25 |
| 1395 0d72 A887 std Y+8,r26 |
| 1396 0d74 B987 std Y+9,r27 |
| 1397 .L23: |
| 1398 0d76 A090 0000 lds r10,Parameter_AchsKopplung2 |
| 1399 0d7a BB24 clr r11 |
| 1400 0d7c CC24 clr r12 |
| 1401 0d7e DD24 clr r13 |
| 1402 0d80 AB89 ldd r26,Y+19 |
| 1403 0d82 BC89 ldd r27,Y+20 |
| 1404 0d84 9D01 movw r18,r26 |
| 1405 0d86 4427 clr r20 |
| 1406 0d88 37FD sbrc r19,7 |
| 1407 0d8a 4095 com r20 |
| 1408 0d8c 542F mov r21,r20 |
| 1409 0d8e 6E81 ldd r22,Y+6 |
| 1410 0d90 7F81 ldd r23,Y+7 |
| 1411 0d92 8885 ldd r24,Y+8 |
| 1412 0d94 9985 ldd r25,Y+9 |
| 1413 0d96 0E94 0000 call __mulsi3 |
| 1414 0d9a 20E0 ldi r18,lo8(2048) |
| 1415 0d9c 38E0 ldi r19,hi8(2048) |
| 1416 0d9e 40E0 ldi r20,hlo8(2048) |
| 1417 0da0 50E0 ldi r21,hhi8(2048) |
| 1418 0da2 0E94 0000 call __divmodsi4 |
| 1419 0da6 CA01 movw r24,r20 |
| 1420 0da8 B901 movw r22,r18 |
| 1421 0daa A601 movw r20,r12 |
| 1422 0dac 9501 movw r18,r10 |
| 1423 0dae 0E94 0000 call __mulsi3 |
| 1424 0db2 20E0 ldi r18,lo8(4096) |
| 1425 0db4 30E1 ldi r19,hi8(4096) |
| 1426 0db6 40E0 ldi r20,hlo8(4096) |
| 1427 0db8 50E0 ldi r21,hhi8(4096) |
| 1428 0dba 0E94 0000 call __divmodsi4 |
| 1429 0dbe 7901 movw r14,r18 |
| 1430 0dc0 8A01 movw r16,r20 |
| 1431 0dc2 2093 0000 sts tmpl3.2654,r18 |
| 1432 0dc6 3093 0000 sts (tmpl3.2654)+1,r19 |
| 1433 0dca 4093 0000 sts (tmpl3.2654)+2,r20 |
| 1434 0dce 5093 0000 sts (tmpl3.2654)+3,r21 |
| 1435 0dd2 EA8D ldd r30,Y+26 |
| 1436 0dd4 FB8D ldd r31,Y+27 |
| 1437 0dd6 9F01 movw r18,r30 |
| 1438 0dd8 4427 clr r20 |
| 1439 0dda 37FD sbrc r19,7 |
| 1440 0ddc 4095 com r20 |
| 1441 0dde 542F mov r21,r20 |
| 1442 0de0 6A81 ldd r22,Y+2 |
| 1443 0de2 7B81 ldd r23,Y+3 |
| 1444 0de4 8C81 ldd r24,Y+4 |
| 1445 0de6 9D81 ldd r25,Y+5 |
| 1446 0de8 0E94 0000 call __mulsi3 |
| 1447 0dec 20E0 ldi r18,lo8(2048) |
| 1448 0dee 38E0 ldi r19,hi8(2048) |
| 1449 0df0 40E0 ldi r20,hlo8(2048) |
| 1450 0df2 50E0 ldi r21,hhi8(2048) |
| 1451 0df4 0E94 0000 call __divmodsi4 |
| 1452 0df8 CA01 movw r24,r20 |
| 1453 0dfa B901 movw r22,r18 |
| 1454 0dfc A601 movw r20,r12 |
| 1455 0dfe 9501 movw r18,r10 |
| 1456 0e00 0E94 0000 call __mulsi3 |
| 1457 0e04 20E0 ldi r18,lo8(4096) |
| 1458 0e06 30E1 ldi r19,hi8(4096) |
| 1459 0e08 40E0 ldi r20,hlo8(4096) |
| 1460 0e0a 50E0 ldi r21,hhi8(4096) |
| 1461 0e0c 0E94 0000 call __divmodsi4 |
| 1462 0e10 F092 0000 sts (KopplungsteilNickRoll)+1,r15 |
| 1463 0e14 E092 0000 sts KopplungsteilNickRoll,r14 |
| 1464 0e18 3093 0000 sts (KopplungsteilRollNick)+1,r19 |
| 1465 0e1c 2093 0000 sts KopplungsteilRollNick,r18 |
| 1466 0e20 2E19 sub r18,r14 |
| 1467 0e22 3F09 sbc r19,r15 |
| 1468 0e24 400B sbc r20,r16 |
| 1469 0e26 510B sbc r21,r17 |
| 1470 0e28 7901 movw r14,r18 |
| 1471 0e2a 8A01 movw r16,r20 |
| 1472 0e2c 2093 0000 sts tmpl4.2655,r18 |
| 1473 0e30 3093 0000 sts (tmpl4.2655)+1,r19 |
| 1474 0e34 4093 0000 sts (tmpl4.2655)+2,r20 |
| 1475 0e38 5093 0000 sts (tmpl4.2655)+3,r21 |
| 1476 0e3c 220E add r2,r18 |
| 1477 0e3e 331E adc r3,r19 |
| 1478 0e40 441E adc r4,r20 |
| 1479 0e42 551E adc r5,r21 |
| 1480 0e44 2092 0000 sts ErsatzKompass,r2 |
| 1481 0e48 3092 0000 sts (ErsatzKompass)+1,r3 |
| 1482 0e4c 4092 0000 sts (ErsatzKompass)+2,r4 |
| 1483 0e50 5092 0000 sts (ErsatzKompass)+3,r5 |
| 1484 0e54 F091 0000 lds r31,Parameter_CouplingYawCorrection |
| 1485 0e58 FD8B std Y+21,r31 |
| 1486 0e5a FF23 tst r31 |
| 1487 0e5c 01F4 brne .L24 |
| 1488 0e5e CA01 movw r24,r20 |
| 1489 0e60 B901 movw r22,r18 |
| 1490 0e62 22E0 ldi r18,lo8(2) |
| 1491 0e64 30E0 ldi r19,hi8(2) |
| 1492 0e66 40E0 ldi r20,hlo8(2) |
| 1493 0e68 50E0 ldi r21,hhi8(2) |
| 1494 0e6a 0E94 0000 call __divmodsi4 |
| 1495 0e6e 8E89 ldd r24,Y+22 |
| 1496 0e70 9F89 ldd r25,Y+23 |
| 1497 0e72 A88D ldd r26,Y+24 |
| 1498 0e74 B98D ldd r27,Y+25 |
| 1499 0e76 821B sub r24,r18 |
| 1500 0e78 930B sbc r25,r19 |
| 1501 0e7a A40B sbc r26,r20 |
| 1502 0e7c B50B sbc r27,r21 |
| 1503 0e7e 8E8B std Y+22,r24 |
| 1504 0e80 9F8B std Y+23,r25 |
| 1505 0e82 A88F std Y+24,r26 |
| 1506 0e84 B98F std Y+25,r27 |
| 1507 0e86 8093 0000 sts Mess_Integral_Gier,r24 |
| 1508 0e8a 9093 0000 sts (Mess_Integral_Gier)+1,r25 |
| 1509 0e8e A093 0000 sts (Mess_Integral_Gier)+2,r26 |
| 1510 0e92 B093 0000 sts (Mess_Integral_Gier)+3,r27 |
| 1511 .L24: |
| 1512 0e96 6E0C add r6,r14 |
| 1513 0e98 7F1C adc r7,r15 |
| 1514 0e9a 801E adc r8,r16 |
| 1515 0e9c 911E adc r9,r17 |
| 1516 0e9e E090 0000 lds r14,Parameter_AchsKopplung1 |
| 1517 0ea2 FF24 clr r15 |
| 1518 0ea4 00E0 ldi r16,lo8(0) |
| 1519 0ea6 10E0 ldi r17,hi8(0) |
| 1520 0ea8 C401 movw r24,r8 |
| 1521 0eaa B301 movw r22,r6 |
| 1522 0eac 2E81 ldd r18,Y+6 |
| 1523 0eae 3F81 ldd r19,Y+7 |
| 1524 0eb0 4885 ldd r20,Y+8 |
| 1525 0eb2 5985 ldd r21,Y+9 |
| 1526 0eb4 0E94 0000 call __mulsi3 |
| 1527 0eb8 20E0 ldi r18,lo8(2048) |
| 1528 0eba 38E0 ldi r19,hi8(2048) |
| 1529 0ebc 40E0 ldi r20,hlo8(2048) |
| 1530 0ebe 50E0 ldi r21,hhi8(2048) |
| 1531 0ec0 0E94 0000 call __divmodsi4 |
| 1532 0ec4 CA01 movw r24,r20 |
| 1533 0ec6 B901 movw r22,r18 |
| 1534 0ec8 A801 movw r20,r16 |
| 1535 0eca 9701 movw r18,r14 |
| 1536 0ecc 0E94 0000 call __mulsi3 |
| 1537 0ed0 20E0 ldi r18,lo8(4096) |
| 1538 0ed2 30E1 ldi r19,hi8(4096) |
| 1539 0ed4 40E0 ldi r20,hlo8(4096) |
| 1540 0ed6 50E0 ldi r21,hhi8(4096) |
| 1541 0ed8 0E94 0000 call __divmodsi4 |
| 1542 0edc 5901 movw r10,r18 |
| 1543 0ede 6A01 movw r12,r20 |
| 1544 0ee0 2093 0000 sts tmpl.2652,r18 |
| 1545 0ee4 3093 0000 sts (tmpl.2652)+1,r19 |
| 1546 0ee8 4093 0000 sts (tmpl.2652)+2,r20 |
| 1547 0eec 5093 0000 sts (tmpl.2652)+3,r21 |
| 1548 0ef0 C401 movw r24,r8 |
| 1549 0ef2 B301 movw r22,r6 |
| 1550 0ef4 2A81 ldd r18,Y+2 |
| 1551 0ef6 3B81 ldd r19,Y+3 |
| 1552 0ef8 4C81 ldd r20,Y+4 |
| 1553 0efa 5D81 ldd r21,Y+5 |
| 1554 0efc 0E94 0000 call __mulsi3 |
| 1555 0f00 20E0 ldi r18,lo8(2048) |
| 1556 0f02 38E0 ldi r19,hi8(2048) |
| 1557 0f04 40E0 ldi r20,hlo8(2048) |
| 1558 0f06 50E0 ldi r21,hhi8(2048) |
| 1559 0f08 0E94 0000 call __divmodsi4 |
| 1560 0f0c CA01 movw r24,r20 |
| 1561 0f0e B901 movw r22,r18 |
| 1562 0f10 A801 movw r20,r16 |
| 1563 0f12 9701 movw r18,r14 |
| 1564 0f14 0E94 0000 call __mulsi3 |
| 1565 0f18 20E0 ldi r18,lo8(4096) |
| 1566 0f1a 30E1 ldi r19,hi8(4096) |
| 1567 0f1c 40E0 ldi r20,hlo8(4096) |
| 1568 0f1e 50E0 ldi r21,hhi8(4096) |
| 1569 0f20 0E94 0000 call __divmodsi4 |
| 1570 0f24 2093 0000 sts tmpl2.2653,r18 |
| 1571 0f28 3093 0000 sts (tmpl2.2653)+1,r19 |
| 1572 0f2c 4093 0000 sts (tmpl2.2653)+2,r20 |
| 1573 0f30 5093 0000 sts (tmpl2.2653)+3,r21 |
| 1574 0f34 D7FC sbrc r13,7 |
| 1575 0f36 00C0 rjmp .L168 |
| 1576 .L27: |
| 1577 0f38 91E8 ldi r25,lo8(129) |
| 1578 0f3a A916 cp r10,r25 |
| 1579 0f3c B104 cpc r11,__zero_reg__ |
| 1580 0f3e C104 cpc r12,__zero_reg__ |
| 1581 0f40 D104 cpc r13,__zero_reg__ |
| 1582 0f42 04F4 brge .L26 |
| 1583 0f44 57FD sbrc r21,7 |
| 1584 0f46 00C0 rjmp .L169 |
| 1585 .L30: |
| 1586 0f48 2138 cpi r18,lo8(129) |
| 1587 0f4a 3105 cpc r19,__zero_reg__ |
| 1588 0f4c 4105 cpc r20,__zero_reg__ |
| 1589 0f4e 5105 cpc r21,__zero_reg__ |
| 1590 0f50 04F4 brge .+2 |
| 1591 0f52 00C0 rjmp .L29 |
| 1592 .L26: |
| 1593 0f54 81E0 ldi r24,lo8(1) |
| 1594 0f56 8093 0000 sts TrichterFlug,r24 |
| 1595 0f5a 2090 0000 lds r2,ErsatzKompass |
| 1596 0f5e 3090 0000 lds r3,(ErsatzKompass)+1 |
| 1597 0f62 4090 0000 lds r4,(ErsatzKompass)+2 |
| 1598 0f66 5090 0000 lds r5,(ErsatzKompass)+3 |
| 1599 0f6a 00C0 rjmp .L29 |
| 1600 .L80: |
| 1601 0f6c 4058 subi r20,lo8(-128) |
| 1602 0f6e 5F4F sbci r21,hi8(-128) |
| 1603 0f70 04F0 brlt .+2 |
| 1604 0f72 00C0 rjmp .L82 |
| 1605 0f74 80E8 ldi r24,lo8(-128) |
| 1606 0f76 9FEF ldi r25,hi8(-128) |
| 1607 0f78 9093 0000 sts (d2Roll.2658)+1,r25 |
| 1608 0f7c 8093 0000 sts d2Roll.2658,r24 |
| 1609 0f80 00C0 rjmp .L82 |
| 1610 .L150: |
| 1611 0f82 0796 adiw r24,7 |
| 1612 0f84 00C0 rjmp .L43 |
| 1613 .L149: |
| 1614 0f86 260E add r2,r22 |
| 1615 0f88 371E adc r3,r23 |
| 1616 0f8a 481E adc r4,r24 |
| 1617 0f8c 591E adc r5,r25 |
| 1618 0f8e 2092 0000 sts ErsatzKompass,r2 |
| 1619 0f92 3092 0000 sts (ErsatzKompass)+1,r3 |
| 1620 0f96 4092 0000 sts (ErsatzKompass)+2,r4 |
| 1621 0f9a 5092 0000 sts (ErsatzKompass)+3,r5 |
| 1622 0f9e 00C0 rjmp .L33 |
| 1623 .L85: |
| 1624 0fa0 AD89 ldd r26,Y+21 |
| 1625 0fa2 EA2E mov r14,r26 |
| 1626 0fa4 FF24 clr r15 |
| 1627 0fa6 00E0 ldi r16,lo8(0) |
| 1628 0fa8 10E0 ldi r17,hi8(0) |
| 1629 0faa 6091 0000 lds r22,KopplungsteilNickRoll |
| 1630 0fae 7091 0000 lds r23,(KopplungsteilNickRoll)+1 |
| 1631 0fb2 77FD sbrc r23,7 |
| 1632 0fb4 00C0 rjmp .L170 |
| 1633 .L89: |
| 1634 0fb6 8827 clr r24 |
| 1635 0fb8 77FD sbrc r23,7 |
| 1636 0fba 8095 com r24 |
| 1637 0fbc 982F mov r25,r24 |
| 1638 0fbe A801 movw r20,r16 |
| 1639 0fc0 9701 movw r18,r14 |
| 1640 0fc2 0E94 0000 call __mulsi3 |
| 1641 0fc6 20E4 ldi r18,lo8(64) |
| 1642 0fc8 30E0 ldi r19,hi8(64) |
| 1643 0fca 40E0 ldi r20,hlo8(64) |
| 1644 0fcc 50E0 ldi r21,hhi8(64) |
| 1645 0fce 0E94 0000 call __divmodsi4 |
| 1646 0fd2 821A sub r8,r18 |
| 1647 0fd4 930A sbc r9,r19 |
| 1648 0fd6 9092 0000 sts (TrimRoll)+1,r9 |
| 1649 0fda 8092 0000 sts TrimRoll,r8 |
| 1650 0fde EA8D ldd r30,Y+26 |
| 1651 0fe0 FB8D ldd r31,Y+27 |
| 1652 0fe2 1E16 cp __zero_reg__,r30 |
| 1653 0fe4 1F06 cpc __zero_reg__,r31 |
| 1654 0fe6 04F4 brge .+2 |
| 1655 0fe8 00C0 rjmp .L171 |
| 1656 .L90: |
| 1657 0fea 2091 0000 lds r18,KopplungsteilRollNick |
| 1658 0fee 3091 0000 lds r19,(KopplungsteilRollNick)+1 |
| 1659 0ff2 37FD sbrc r19,7 |
| 1660 0ff4 00C0 rjmp .L172 |
| 1661 .L94: |
| 1662 0ff6 4427 clr r20 |
| 1663 0ff8 37FD sbrc r19,7 |
| 1664 0ffa 4095 com r20 |
| 1665 0ffc 542F mov r21,r20 |
| 1666 0ffe C801 movw r24,r16 |
| 1667 1000 B701 movw r22,r14 |
| 1668 1002 0E94 0000 call __mulsi3 |
| 1669 1006 20E4 ldi r18,lo8(64) |
| 1670 1008 30E0 ldi r19,hi8(64) |
| 1671 100a 40E0 ldi r20,hlo8(64) |
| 1672 100c 50E0 ldi r21,hhi8(64) |
| 1673 100e 0E94 0000 call __divmodsi4 |
| 1674 1012 621A sub r6,r18 |
| 1675 1014 730A sbc r7,r19 |
| 1676 1016 7092 0000 sts (TrimNick)+1,r7 |
| 1677 101a 6092 0000 sts TrimNick,r6 |
| 1678 101e F981 ldd r31,Y+1 |
| 1679 1020 F7FF sbrs r31,7 |
| 1680 1022 00C0 rjmp .L95 |
| 1681 .L160: |
| 1682 1024 2A85 ldd r18,Y+10 |
| 1683 1026 2223 tst r18 |
| 1684 1028 01F0 breq .+2 |
| 1685 102a 00C0 rjmp .L95 |
| 1686 102c 8091 0000 lds r24,Looping_Roll |
| 1687 1030 8823 tst r24 |
| 1688 1032 01F0 breq .+2 |
| 1689 1034 00C0 rjmp .L95 |
| 1690 1036 8A8D ldd r24,Y+26 |
| 1691 1038 9B8D ldd r25,Y+27 |
| 1692 103a 8150 subi r24,lo8(257) |
| 1693 103c 9140 sbci r25,hi8(257) |
| 1694 103e 04F0 brlt .+2 |
| 1695 1040 00C0 rjmp .L173 |
| 1696 1042 2A8D ldd r18,Y+26 |
| 1697 1044 3B8D ldd r19,Y+27 |
| 1698 1046 6FEF ldi r22,hi8(-256) |
| 1699 1048 2030 cpi r18,lo8(-256) |
| 1700 104a 3607 cpc r19,r22 |
| 1701 104c 04F4 brge .L101 |
| 1702 104e 8091 0000 lds r24,MesswertNick |
| 1703 1052 9091 0000 lds r25,(MesswertNick)+1 |
| 1704 1056 8050 subi r24,lo8(-(256)) |
| 1705 1058 9F4F sbci r25,hi8(-(256)) |
| 1706 105a 820F add r24,r18 |
| 1707 105c 931F adc r25,r19 |
| 1708 105e 9093 0000 sts (MesswertNick)+1,r25 |
| 1709 1062 8093 0000 sts MesswertNick,r24 |
| 1710 .L101: |
| 1711 1066 8B89 ldd r24,Y+19 |
| 1712 1068 9C89 ldd r25,Y+20 |
| 1713 106a 8150 subi r24,lo8(257) |
| 1714 106c 9140 sbci r25,hi8(257) |
| 1715 106e 04F4 brge .+2 |
| 1716 1070 00C0 rjmp .L103 |
| 1717 1072 8091 0000 lds r24,MesswertRoll |
| 1718 1076 9091 0000 lds r25,(MesswertRoll)+1 |
| 1719 107a 8050 subi r24,lo8(-(-256)) |
| 1720 107c 9140 sbci r25,hi8(-(-256)) |
| 1721 107e EB89 ldd r30,Y+19 |
| 1722 1080 FC89 ldd r31,Y+20 |
| 1723 1082 8E0F add r24,r30 |
| 1724 1084 9F1F adc r25,r31 |
| 1725 1086 9093 0000 sts (MesswertRoll)+1,r25 |
| 1726 108a 8093 0000 sts MesswertRoll,r24 |
| 1727 108e 00C0 rjmp .L95 |
| 1728 .L151: |
| 1729 1090 0796 adiw r24,7 |
| 1730 1092 00C0 rjmp .L44 |
| 1731 .L147: |
| 1732 1094 295F subi r18,lo8(-(7)) |
| 1733 1096 3F4F sbci r19,hi8(-(7)) |
| 1734 1098 00C0 rjmp .L13 |
| 1735 .L146: |
| 1736 109a 295F subi r18,lo8(-(7)) |
| 1737 109c 3F4F sbci r19,hi8(-(7)) |
| 1738 109e 0C94 0000 jmp .L12 |
| 1739 .L154: |
| 1740 10a2 2F5F subi r18,lo8(-(1)) |
| 1741 10a4 3F4F sbci r19,hi8(-(1)) |
| 1742 10a6 00C0 rjmp .L73 |
| 1743 .L159: |
| 1744 10a8 3095 com r19 |
| 1745 10aa 2195 neg r18 |
| 1746 10ac 3F4F sbci r19,lo8(-1) |
| 1747 10ae 00C0 rjmp .L92 |
| 1748 .L158: |
| 1749 10b0 7095 com r23 |
| 1750 10b2 6195 neg r22 |
| 1751 10b4 7F4F sbci r23,lo8(-1) |
| 1752 10b6 00C0 rjmp .L87 |
| 1753 .L155: |
| 1754 10b8 215F subi r18,lo8(-(15)) |
| 1755 10ba 3F4F sbci r19,hi8(-(15)) |
| 1756 10bc 00C0 rjmp .L78 |
| 1757 .L157: |
| 1758 10be 215F subi r18,lo8(-(15)) |
| 1759 10c0 3F4F sbci r19,hi8(-(15)) |
| 1760 10c2 00C0 rjmp .L84 |
| 1761 .L156: |
| 1762 10c4 2F5F subi r18,lo8(-(1)) |
| 1763 10c6 3F4F sbci r19,hi8(-(1)) |
| 1764 10c8 00C0 rjmp .L79 |
| 1765 .L170: |
| 1766 10ca 7095 com r23 |
| 1767 10cc 6195 neg r22 |
| 1768 10ce 7F4F sbci r23,lo8(-1) |
| 1769 10d0 00C0 rjmp .L89 |
| 1770 .L172: |
| 1771 10d2 3095 com r19 |
| 1772 10d4 2195 neg r18 |
| 1773 10d6 3F4F sbci r19,lo8(-1) |
| 1774 10d8 00C0 rjmp .L94 |
| 1775 .L173: |
| 1776 10da 8091 0000 lds r24,MesswertNick |
| 1777 10de 9091 0000 lds r25,(MesswertNick)+1 |
| 1778 10e2 8050 subi r24,lo8(-(-256)) |
| 1779 10e4 9140 sbci r25,hi8(-(-256)) |
| 1780 10e6 EA8D ldd r30,Y+26 |
| 1781 10e8 FB8D ldd r31,Y+27 |
| 1782 10ea 8E0F add r24,r30 |
| 1783 10ec 9F1F adc r25,r31 |
| 1784 10ee 9093 0000 sts (MesswertNick)+1,r25 |
| 1785 10f2 8093 0000 sts MesswertNick,r24 |
| 1786 10f6 00C0 rjmp .L101 |
| 1787 .L169: |
| 1788 10f8 5095 com r21 |
| 1789 10fa 4095 com r20 |
| 1790 10fc 3095 com r19 |
| 1791 10fe 2195 neg r18 |
| 1792 1100 3F4F sbci r19,lo8(-1) |
| 1793 1102 4F4F sbci r20,lo8(-1) |
| 1794 1104 5F4F sbci r21,lo8(-1) |
| 1795 1106 00C0 rjmp .L30 |
| 1796 .L168: |
| 1797 1108 D094 com r13 |
| 1798 110a C094 com r12 |
| 1799 110c B094 com r11 |
| 1800 110e A094 com r10 |
| 1801 1110 A11C adc r10,__zero_reg__ |
| 1802 1112 B11C adc r11,__zero_reg__ |
| 1803 1114 C11C adc r12,__zero_reg__ |
| 1804 1116 D11C adc r13,__zero_reg__ |
| 1805 1118 00C0 rjmp .L27 |
| 1806 .L103: |
| 1807 111a 2B89 ldd r18,Y+19 |
| 1808 111c 3C89 ldd r19,Y+20 |
| 1809 111e 6FEF ldi r22,hi8(-256) |
| 1810 1120 2030 cpi r18,lo8(-256) |
| 1811 1122 3607 cpc r19,r22 |
| 1812 1124 04F0 brlt .+2 |
| 1813 1126 00C0 rjmp .L95 |
| 1814 1128 8091 0000 lds r24,MesswertRoll |
| 1815 112c 9091 0000 lds r25,(MesswertRoll)+1 |
| 1816 1130 8050 subi r24,lo8(-(256)) |
| 1817 1132 9F4F sbci r25,hi8(-(256)) |
| 1818 1134 820F add r24,r18 |
| 1819 1136 931F adc r25,r19 |
| 1820 1138 9093 0000 sts (MesswertRoll)+1,r25 |
| 1821 113c 8093 0000 sts MesswertRoll,r24 |
| 1822 1140 00C0 rjmp .L95 |
| 1823 .L142: |
| 1824 /* epilogue: frame size=27 */ |
| 1825 1142 6B96 adiw r28,27 |
| 1826 1144 0FB6 in __tmp_reg__,__SREG__ |
| 1827 1146 F894 cli |
| 1828 1148 DEBF out __SP_H__,r29 |
| 1829 114a 0FBE out __SREG__,__tmp_reg__ |
| 1830 114c CDBF out __SP_L__,r28 |
| 1831 114e DF91 pop r29 |
| 1832 1150 CF91 pop r28 |
| 1833 1152 1F91 pop r17 |
| 1834 1154 0F91 pop r16 |
| 1835 1156 FF90 pop r15 |
| 1836 1158 EF90 pop r14 |
| 1837 115a DF90 pop r13 |
| 1838 115c CF90 pop r12 |
| 1839 115e BF90 pop r11 |
| 1840 1160 AF90 pop r10 |
| 1841 1162 9F90 pop r9 |
| 1842 1164 8F90 pop r8 |
| 1843 1166 7F90 pop r7 |
| 1844 1168 6F90 pop r6 |
| 1845 116a 5F90 pop r5 |
| 1846 116c 4F90 pop r4 |
| 1847 116e 3F90 pop r3 |
| 1848 1170 2F90 pop r2 |
| 1849 1172 0895 ret |
| 1850 /* epilogue end (size=25) */ |
| 1851 /* function Mittelwert size 2210 (2159) */ |
| 1853 .global ParameterZuordnung |
| 1855 ParameterZuordnung: |
| 1856 /* prologue: frame size=0 */ |
| 1857 /* prologue end (size=0) */ |
| 1858 1174 8091 0000 lds r24,EE_Parameter+11 |
| 1859 1178 8B3F cpi r24,lo8(-5) |
| 1860 117a 00F0 brlo .L175 |
| 1861 117c 8B3F cpi r24,lo8(-5) |
| 1862 117e 01F4 brne .+2 |
| 1863 1180 00C0 rjmp .L456 |
| 1864 1182 8C3F cpi r24,lo8(-4) |
| 1865 1184 01F4 brne .+2 |
| 1866 1186 00C0 rjmp .L457 |
| 1867 1188 8D3F cpi r24,lo8(-3) |
| 1868 118a 01F4 brne .+2 |
| 1869 118c 00C0 rjmp .L458 |
| 1870 118e 8E3F cpi r24,lo8(-2) |
| 1871 1190 01F4 brne .L179 |
| 1872 1192 8091 0000 lds r24,Poti4 |
| 1873 1196 8093 0000 sts Parameter_MaxHoehe,r24 |
| 1874 119a 00C0 rjmp .L179 |
| 1875 .L175: |
| 1876 119c 8093 0000 sts Parameter_MaxHoehe,r24 |
| 1877 .L179: |
| 1878 11a0 8091 0000 lds r24,EE_Parameter+10 |
| 1879 11a4 8B3F cpi r24,lo8(-5) |
| 1880 11a6 00F0 brlo .L185 |
| 1881 11a8 8B3F cpi r24,lo8(-5) |
| 1882 11aa 01F4 brne .+2 |
| 1883 11ac 00C0 rjmp .L459 |
| 1884 11ae 8C3F cpi r24,lo8(-4) |
| 1885 11b0 01F4 brne .+2 |
| 1886 11b2 00C0 rjmp .L460 |
| 1887 11b4 8D3F cpi r24,lo8(-3) |
| 1888 11b6 01F4 brne .+2 |
| 1889 11b8 00C0 rjmp .L461 |
| 1890 11ba 8E3F cpi r24,lo8(-2) |
| 1891 11bc 01F4 brne .L189 |
| 1892 11be 8091 0000 lds r24,Poti4 |
| 1893 11c2 8093 0000 sts Parameter_Luftdruck_D,r24 |
| 1894 11c6 00C0 rjmp .L189 |
| 1895 .L185: |
| 1896 11c8 8093 0000 sts Parameter_Luftdruck_D,r24 |
| 1897 .L189: |
| 1898 11cc 8091 0000 lds r24,Parameter_Luftdruck_D |
| 1899 11d0 8823 tst r24 |
| 1900 11d2 01F4 brne .L195 |
| 1901 11d4 1092 0000 sts Parameter_Luftdruck_D,__zero_reg__ |
| 1902 .L197: |
| 1903 11d8 8091 0000 lds r24,EE_Parameter+12 |
| 1904 11dc 8B3F cpi r24,lo8(-5) |
| 1905 11de 00F0 brlo .L199 |
| 1906 .L465: |
| 1907 11e0 8B3F cpi r24,lo8(-5) |
| 1908 11e2 01F4 brne .+2 |
| 1909 11e4 00C0 rjmp .L462 |
| 1910 11e6 8C3F cpi r24,lo8(-4) |
| 1911 11e8 01F4 brne .+2 |
| 1912 11ea 00C0 rjmp .L463 |
| 1913 11ec 8D3F cpi r24,lo8(-3) |
| 1914 11ee 01F4 brne .+2 |
| 1915 11f0 00C0 rjmp .L464 |
| 1916 11f2 8E3F cpi r24,lo8(-2) |
| 1917 11f4 01F4 brne .L203 |
| 1918 11f6 8091 0000 lds r24,Poti4 |
| 1919 11fa 8093 0000 sts Parameter_Hoehe_P,r24 |
| 1920 11fe 00C0 rjmp .L203 |
| 1921 .L195: |
| 1922 1200 8436 cpi r24,lo8(100) |
| 1923 1202 00F0 brlo .L197 |
| 1924 1204 84E6 ldi r24,lo8(100) |
| 1925 1206 8093 0000 sts Parameter_Luftdruck_D,r24 |
| 1926 120a 8091 0000 lds r24,EE_Parameter+12 |
| 1927 120e 8B3F cpi r24,lo8(-5) |
| 1928 1210 00F4 brsh .L465 |
| 1929 .L199: |
| 1930 1212 8093 0000 sts Parameter_Hoehe_P,r24 |
| 1931 .L203: |
| 1932 1216 8091 0000 lds r24,Parameter_Hoehe_P |
| 1933 121a 8823 tst r24 |
| 1934 121c 01F4 brne .L209 |
| 1935 121e 1092 0000 sts Parameter_Hoehe_P,__zero_reg__ |
| 1936 .L211: |
| 1937 1222 8091 0000 lds r24,EE_Parameter+14 |
| 1938 1226 8B3F cpi r24,lo8(-5) |
| 1939 1228 00F0 brlo .L213 |
| 1940 .L469: |
| 1941 122a 8B3F cpi r24,lo8(-5) |
| 1942 122c 01F4 brne .+2 |
| 1943 122e 00C0 rjmp .L466 |
| 1944 1230 8C3F cpi r24,lo8(-4) |
| 1945 1232 01F4 brne .+2 |
| 1946 1234 00C0 rjmp .L467 |
| 1947 1236 8D3F cpi r24,lo8(-3) |
| 1948 1238 01F4 brne .+2 |
| 1949 123a 00C0 rjmp .L468 |
| 1950 123c 8E3F cpi r24,lo8(-2) |
| 1951 123e 01F4 brne .L217 |
| 1952 1240 8091 0000 lds r24,Poti4 |
| 1953 1244 8093 0000 sts Parameter_Hoehe_ACC_Wirkung,r24 |
| 1954 1248 00C0 rjmp .L217 |
| 1955 .L209: |
| 1956 124a 8436 cpi r24,lo8(100) |
| 1957 124c 00F0 brlo .L211 |
| 1958 124e 84E6 ldi r24,lo8(100) |
| 1959 1250 8093 0000 sts Parameter_Hoehe_P,r24 |
| 1960 1254 8091 0000 lds r24,EE_Parameter+14 |
| 1961 1258 8B3F cpi r24,lo8(-5) |
| 1962 125a 00F4 brsh .L469 |
| 1963 .L213: |
| 1964 125c 8093 0000 sts Parameter_Hoehe_ACC_Wirkung,r24 |
| 1965 .L217: |
| 1966 1260 8091 0000 lds r24,EE_Parameter+21 |
| 1967 1264 8B3F cpi r24,lo8(-5) |
| 1968 1266 00F0 brlo .L223 |
| 1969 1268 8B3F cpi r24,lo8(-5) |
| 1970 126a 01F4 brne .+2 |
| 1971 126c 00C0 rjmp .L470 |
| 1972 126e 8C3F cpi r24,lo8(-4) |
| 1973 1270 01F4 brne .+2 |
| 1974 1272 00C0 rjmp .L471 |
| 1975 1274 8D3F cpi r24,lo8(-3) |
| 1976 1276 01F4 brne .+2 |
| 1977 1278 00C0 rjmp .L472 |
| 1978 127a 8E3F cpi r24,lo8(-2) |
| 1979 127c 01F4 brne .L227 |
| 1980 127e 8091 0000 lds r24,Poti4 |
| 1981 1282 8093 0000 sts Parameter_KompassWirkung,r24 |
| 1982 1286 00C0 rjmp .L227 |
| 1983 .L223: |
| 1984 1288 8093 0000 sts Parameter_KompassWirkung,r24 |
| 1985 .L227: |
| 1986 128c 8091 0000 lds r24,EE_Parameter+22 |
| 1987 1290 8B3F cpi r24,lo8(-5) |
| 1988 1292 00F0 brlo .L233 |
| 1989 1294 8B3F cpi r24,lo8(-5) |
| 1990 1296 01F4 brne .+2 |
| 1991 1298 00C0 rjmp .L473 |
| 1992 129a 8C3F cpi r24,lo8(-4) |
| 1993 129c 01F4 brne .+2 |
| 1994 129e 00C0 rjmp .L474 |
| 1995 12a0 8D3F cpi r24,lo8(-3) |
| 1996 12a2 01F4 brne .+2 |
| 1997 12a4 00C0 rjmp .L475 |
| 1998 12a6 8E3F cpi r24,lo8(-2) |
| 1999 12a8 01F4 brne .L237 |
| 2000 12aa 8091 0000 lds r24,Poti4 |
| 2001 12ae 8093 0000 sts Parameter_Gyro_P,r24 |
| 2002 12b2 00C0 rjmp .L237 |
| 2003 .L233: |
| 2004 12b4 8093 0000 sts Parameter_Gyro_P,r24 |
| 2005 .L237: |
| 2006 12b8 8091 0000 lds r24,Parameter_Gyro_P |
| 2007 12bc 8B30 cpi r24,lo8(11) |
| 2008 12be 00F4 brsh .L243 |
| 2009 12c0 8AE0 ldi r24,lo8(10) |
| 2010 12c2 8093 0000 sts Parameter_Gyro_P,r24 |
| 2011 .L245: |
| 2012 12c6 8091 0000 lds r24,EE_Parameter+23 |
| 2013 12ca 8B3F cpi r24,lo8(-5) |
| 2014 12cc 00F0 brlo .L247 |
| 2015 .L479: |
| 2016 12ce 8B3F cpi r24,lo8(-5) |
| 2017 12d0 01F4 brne .+2 |
| 2018 12d2 00C0 rjmp .L476 |
| 2019 12d4 8C3F cpi r24,lo8(-4) |
| 2020 12d6 01F4 brne .+2 |
| 2021 12d8 00C0 rjmp .L477 |
| 2022 12da 8D3F cpi r24,lo8(-3) |
| 2023 12dc 01F4 brne .+2 |
| 2024 12de 00C0 rjmp .L478 |
| 2025 12e0 8E3F cpi r24,lo8(-2) |
| 2026 12e2 01F4 brne .L251 |
| 2027 12e4 8091 0000 lds r24,Poti4 |
| 2028 12e8 8093 0000 sts Parameter_Gyro_I,r24 |
| 2029 12ec 00C0 rjmp .L251 |
| 2030 .L243: |
| 2031 12ee 8F3F cpi r24,lo8(-1) |
| 2032 12f0 01F4 brne .L245 |
| 2033 12f2 8093 0000 sts Parameter_Gyro_P,r24 |
| 2034 12f6 8091 0000 lds r24,EE_Parameter+23 |
| 2035 12fa 8B3F cpi r24,lo8(-5) |
| 2036 12fc 00F4 brsh .L479 |
| 2037 .L247: |
| 2038 12fe 8093 0000 sts Parameter_Gyro_I,r24 |
| 2039 .L251: |
| 2040 1302 8091 0000 lds r24,EE_Parameter+24 |
| 2041 1306 8B3F cpi r24,lo8(-5) |
| 2042 1308 00F0 brlo .L257 |
| 2043 130a 8B3F cpi r24,lo8(-5) |
| 2044 130c 01F4 brne .+2 |
| 2045 130e 00C0 rjmp .L480 |
| 2046 1310 8C3F cpi r24,lo8(-4) |
| 2047 1312 01F4 brne .+2 |
| 2048 1314 00C0 rjmp .L481 |
| 2049 1316 8D3F cpi r24,lo8(-3) |
| 2050 1318 01F4 brne .+2 |
| 2051 131a 00C0 rjmp .L482 |
| 2052 131c 8E3F cpi r24,lo8(-2) |
| 2053 131e 01F4 brne .L261 |
| 2054 1320 8091 0000 lds r24,Poti4 |
| 2055 1324 8093 0000 sts Parameter_Gyro_D,r24 |
| 2056 1328 00C0 rjmp .L261 |
| 2057 .L257: |
| 2058 132a 8093 0000 sts Parameter_Gyro_D,r24 |
| 2059 .L261: |
| 2060 132e 8091 0000 lds r24,EE_Parameter+29 |
| 2061 1332 8B3F cpi r24,lo8(-5) |
| 2062 1334 00F0 brlo .L267 |
| 2063 1336 8B3F cpi r24,lo8(-5) |
| 2064 1338 01F4 brne .+2 |
| 2065 133a 00C0 rjmp .L483 |
| 2066 133c 8C3F cpi r24,lo8(-4) |
| 2067 133e 01F4 brne .+2 |
| 2068 1340 00C0 rjmp .L484 |
| 2069 1342 8D3F cpi r24,lo8(-3) |
| 2070 1344 01F4 brne .+2 |
| 2071 1346 00C0 rjmp .L485 |
| 2072 1348 8E3F cpi r24,lo8(-2) |
| 2073 134a 01F4 brne .L271 |
| 2074 134c 8091 0000 lds r24,Poti4 |
| 2075 1350 8093 0000 sts Parameter_I_Faktor,r24 |
| 2076 1354 00C0 rjmp .L271 |
| 2077 .L267: |
| 2078 1356 8093 0000 sts Parameter_I_Faktor,r24 |
| 2079 .L271: |
| 2080 135a 8091 0000 lds r24,EE_Parameter+30 |
| 2081 135e 8B3F cpi r24,lo8(-5) |
| 2082 1360 00F0 brlo .L277 |
| 2083 1362 8B3F cpi r24,lo8(-5) |
| 2084 1364 01F4 brne .+2 |
| 2085 1366 00C0 rjmp .L486 |
| 2086 1368 8C3F cpi r24,lo8(-4) |
| 2087 136a 01F4 brne .+2 |
| 2088 136c 00C0 rjmp .L487 |
| 2089 136e 8D3F cpi r24,lo8(-3) |
| 2090 1370 01F4 brne .+2 |
| 2091 1372 00C0 rjmp .L488 |
| 2092 1374 8E3F cpi r24,lo8(-2) |
| 2093 1376 01F4 brne .L281 |
| 2094 1378 8091 0000 lds r24,Poti4 |
| 2095 137c 8093 0000 sts Parameter_UserParam1,r24 |
| 2096 1380 00C0 rjmp .L281 |
| 2097 .L277: |
| 2098 1382 8093 0000 sts Parameter_UserParam1,r24 |
| 2099 .L281: |
| 2100 1386 8091 0000 lds r24,EE_Parameter+31 |
| 2101 138a 8B3F cpi r24,lo8(-5) |
| 2102 138c 00F0 brlo .L287 |
| 2103 138e 8B3F cpi r24,lo8(-5) |
| 2104 1390 01F4 brne .+2 |
| 2105 1392 00C0 rjmp .L489 |
| 2106 1394 8C3F cpi r24,lo8(-4) |
| 2107 1396 01F4 brne .+2 |
| 2108 1398 00C0 rjmp .L490 |
| 2109 139a 8D3F cpi r24,lo8(-3) |
| 2110 139c 01F4 brne .+2 |
| 2111 139e 00C0 rjmp .L491 |
| 2112 13a0 8E3F cpi r24,lo8(-2) |
| 2113 13a2 01F4 brne .L291 |
| 2114 13a4 8091 0000 lds r24,Poti4 |
| 2115 13a8 8093 0000 sts Parameter_UserParam2,r24 |
| 2116 13ac 00C0 rjmp .L291 |
| 2117 .L287: |
| 2118 13ae 8093 0000 sts Parameter_UserParam2,r24 |
| 2119 .L291: |
| 2120 13b2 8091 0000 lds r24,EE_Parameter+32 |
| 2121 13b6 8B3F cpi r24,lo8(-5) |
| 2122 13b8 00F0 brlo .L297 |
| 2123 13ba 8B3F cpi r24,lo8(-5) |
| 2124 13bc 01F4 brne .+2 |
| 2125 13be 00C0 rjmp .L492 |
| 2126 13c0 8C3F cpi r24,lo8(-4) |
| 2127 13c2 01F4 brne .+2 |
| 2128 13c4 00C0 rjmp .L493 |
| 2129 13c6 8D3F cpi r24,lo8(-3) |
| 2130 13c8 01F4 brne .+2 |
| 2131 13ca 00C0 rjmp .L494 |
| 2132 13cc 8E3F cpi r24,lo8(-2) |
| 2133 13ce 01F4 brne .L301 |
| 2134 13d0 8091 0000 lds r24,Poti4 |
| 2135 13d4 8093 0000 sts Parameter_UserParam3,r24 |
| 2136 13d8 00C0 rjmp .L301 |
| 2137 .L297: |
| 2138 13da 8093 0000 sts Parameter_UserParam3,r24 |
| 2139 .L301: |
| 2140 13de 8091 0000 lds r24,EE_Parameter+33 |
| 2141 13e2 8B3F cpi r24,lo8(-5) |
| 2142 13e4 00F0 brlo .L307 |
| 2143 13e6 8B3F cpi r24,lo8(-5) |
| 2144 13e8 01F4 brne .+2 |
| 2145 13ea 00C0 rjmp .L495 |
| 2146 13ec 8C3F cpi r24,lo8(-4) |
| 2147 13ee 01F4 brne .+2 |
| 2148 13f0 00C0 rjmp .L496 |
| 2149 13f2 8D3F cpi r24,lo8(-3) |
| 2150 13f4 01F4 brne .+2 |
| 2151 13f6 00C0 rjmp .L497 |
| 2152 13f8 8E3F cpi r24,lo8(-2) |
| 2153 13fa 01F4 brne .L311 |
| 2154 13fc 8091 0000 lds r24,Poti4 |
| 2155 1400 8093 0000 sts Parameter_UserParam4,r24 |
| 2156 1404 00C0 rjmp .L311 |
| 2157 .L307: |
| 2158 1406 8093 0000 sts Parameter_UserParam4,r24 |
| 2159 .L311: |
| 2160 140a 8091 0000 lds r24,EE_Parameter+50 |
| 2161 140e 8B3F cpi r24,lo8(-5) |
| 2162 1410 00F0 brlo .L317 |
| 2163 1412 8B3F cpi r24,lo8(-5) |
| 2164 1414 01F4 brne .+2 |
| 2165 1416 00C0 rjmp .L498 |
| 2166 1418 8C3F cpi r24,lo8(-4) |
| 2167 141a 01F4 brne .+2 |
| 2168 141c 00C0 rjmp .L499 |
| 2169 141e 8D3F cpi r24,lo8(-3) |
| 2170 1420 01F4 brne .+2 |
| 2171 1422 00C0 rjmp .L500 |
| 2172 1424 8E3F cpi r24,lo8(-2) |
| 2173 1426 01F4 brne .L321 |
| 2174 1428 8091 0000 lds r24,Poti4 |
| 2175 142c 8093 0000 sts Parameter_UserParam5,r24 |
| 2176 1430 00C0 rjmp .L321 |
| 2177 .L317: |
| 2178 1432 8093 0000 sts Parameter_UserParam5,r24 |
| 2179 .L321: |
| 2180 1436 8091 0000 lds r24,EE_Parameter+51 |
| 2181 143a 8B3F cpi r24,lo8(-5) |
| 2182 143c 00F0 brlo .L327 |
| 2183 143e 8B3F cpi r24,lo8(-5) |
| 2184 1440 01F4 brne .+2 |
| 2185 1442 00C0 rjmp .L501 |
| 2186 1444 8C3F cpi r24,lo8(-4) |
| 2187 1446 01F4 brne .+2 |
| 2188 1448 00C0 rjmp .L502 |
| 2189 144a 8D3F cpi r24,lo8(-3) |
| 2190 144c 01F4 brne .+2 |
| 2191 144e 00C0 rjmp .L503 |
| 2192 1450 8E3F cpi r24,lo8(-2) |
| 2193 1452 01F4 brne .L331 |
| 2194 1454 8091 0000 lds r24,Poti4 |
| 2195 1458 8093 0000 sts Parameter_UserParam6,r24 |
| 2196 145c 00C0 rjmp .L331 |
| 2197 .L327: |
| 2198 145e 8093 0000 sts Parameter_UserParam6,r24 |
| 2199 .L331: |
| 2200 1462 8091 0000 lds r24,EE_Parameter+52 |
| 2201 1466 8B3F cpi r24,lo8(-5) |
| 2202 1468 00F0 brlo .L337 |
| 2203 146a 8B3F cpi r24,lo8(-5) |
| 2204 146c 01F4 brne .+2 |
| 2205 146e 00C0 rjmp .L504 |
| 2206 1470 8C3F cpi r24,lo8(-4) |
| 2207 1472 01F4 brne .+2 |
| 2208 1474 00C0 rjmp .L505 |
| 2209 1476 8D3F cpi r24,lo8(-3) |
| 2210 1478 01F4 brne .+2 |
| 2211 147a 00C0 rjmp .L506 |
| 2212 147c 8E3F cpi r24,lo8(-2) |
| 2213 147e 01F4 brne .L341 |
| 2214 1480 8091 0000 lds r24,Poti4 |
| 2215 1484 8093 0000 sts Parameter_UserParam7,r24 |
| 2216 1488 00C0 rjmp .L341 |
| 2217 .L337: |
| 2218 148a 8093 0000 sts Parameter_UserParam7,r24 |
| 2219 .L341: |
| 2220 148e 8091 0000 lds r24,EE_Parameter+53 |
| 2221 1492 8B3F cpi r24,lo8(-5) |
| 2222 1494 00F0 brlo .L347 |
| 2223 1496 8B3F cpi r24,lo8(-5) |
| 2224 1498 01F4 brne .+2 |
| 2225 149a 00C0 rjmp .L507 |
| 2226 149c 8C3F cpi r24,lo8(-4) |
| 2227 149e 01F4 brne .+2 |
| 2228 14a0 00C0 rjmp .L508 |
| 2229 14a2 8D3F cpi r24,lo8(-3) |
| 2230 14a4 01F4 brne .+2 |
| 2231 14a6 00C0 rjmp .L509 |
| 2232 14a8 8E3F cpi r24,lo8(-2) |
| 2233 14aa 01F4 brne .L351 |
| 2234 14ac 8091 0000 lds r24,Poti4 |
| 2235 14b0 8093 0000 sts Parameter_UserParam8,r24 |
| 2236 14b4 00C0 rjmp .L351 |
| 2237 .L347: |
| 2238 14b6 8093 0000 sts Parameter_UserParam8,r24 |
| 2239 .L351: |
| 2240 14ba 8091 0000 lds r24,EE_Parameter+34 |
| 2241 14be 8B3F cpi r24,lo8(-5) |
| 2242 14c0 00F0 brlo .L357 |
| 2243 14c2 8B3F cpi r24,lo8(-5) |
| 2244 14c4 01F4 brne .+2 |
| 2245 14c6 00C0 rjmp .L510 |
| 2246 14c8 8C3F cpi r24,lo8(-4) |
| 2247 14ca 01F4 brne .+2 |
| 2248 14cc 00C0 rjmp .L511 |
| 2249 14ce 8D3F cpi r24,lo8(-3) |
| 2250 14d0 01F4 brne .+2 |
| 2251 14d2 00C0 rjmp .L512 |
| 2252 14d4 8E3F cpi r24,lo8(-2) |
| 2253 14d6 01F4 brne .L361 |
| 2254 14d8 8091 0000 lds r24,Poti4 |
| 2255 14dc 8093 0000 sts Parameter_ServoNickControl,r24 |
| 2256 14e0 00C0 rjmp .L361 |
| 2257 .L357: |
| 2258 14e2 8093 0000 sts Parameter_ServoNickControl,r24 |
| 2259 .L361: |
| 2260 14e6 8091 0000 lds r24,EE_Parameter+39 |
| 2261 14ea 8B3F cpi r24,lo8(-5) |
| 2262 14ec 00F0 brlo .L367 |
| 2263 14ee 8B3F cpi r24,lo8(-5) |
| 2264 14f0 01F4 brne .+2 |
| 2265 14f2 00C0 rjmp .L513 |
| 2266 14f4 8C3F cpi r24,lo8(-4) |
| 2267 14f6 01F4 brne .+2 |
| 2268 14f8 00C0 rjmp .L514 |
| 2269 14fa 8D3F cpi r24,lo8(-3) |
| 2270 14fc 01F4 brne .+2 |
| 2271 14fe 00C0 rjmp .L515 |
| 2272 1500 8E3F cpi r24,lo8(-2) |
| 2273 1502 01F4 brne .L371 |
| 2274 1504 8091 0000 lds r24,Poti4 |
| 2275 1508 8093 0000 sts Parameter_LoopGasLimit,r24 |
| 2276 150c 00C0 rjmp .L371 |
| 2277 .L367: |
| 2278 150e 8093 0000 sts Parameter_LoopGasLimit,r24 |
| 2279 .L371: |
| 2280 1512 8091 0000 lds r24,EE_Parameter+42 |
| 2281 1516 8B3F cpi r24,lo8(-5) |
| 2282 1518 00F0 brlo .L377 |
| 2283 151a 8B3F cpi r24,lo8(-5) |
| 2284 151c 01F4 brne .+2 |
| 2285 151e 00C0 rjmp .L516 |
| 2286 1520 8C3F cpi r24,lo8(-4) |
| 2287 1522 01F4 brne .+2 |
| 2288 1524 00C0 rjmp .L517 |
| 2289 1526 8D3F cpi r24,lo8(-3) |
| 2290 1528 01F4 brne .+2 |
| 2291 152a 00C0 rjmp .L518 |
| 2292 152c 8E3F cpi r24,lo8(-2) |
| 2293 152e 01F4 brne .L381 |
| 2294 1530 8091 0000 lds r24,Poti4 |
| 2295 1534 8093 0000 sts Parameter_AchsKopplung1,r24 |
| 2296 1538 00C0 rjmp .L381 |
| 2297 .L377: |
| 2298 153a 8093 0000 sts Parameter_AchsKopplung1,r24 |
| 2299 .L381: |
| 2300 153e 8091 0000 lds r24,EE_Parameter+43 |
| 2301 1542 8B3F cpi r24,lo8(-5) |
| 2302 1544 00F0 brlo .L387 |
| 2303 1546 8B3F cpi r24,lo8(-5) |
| 2304 1548 01F4 brne .+2 |
| 2305 154a 00C0 rjmp .L519 |
| 2306 154c 8C3F cpi r24,lo8(-4) |
| 2307 154e 01F4 brne .+2 |
| 2308 1550 00C0 rjmp .L520 |
| 2309 1552 8D3F cpi r24,lo8(-3) |
| 2310 1554 01F4 brne .+2 |
| 2311 1556 00C0 rjmp .L521 |
| 2312 1558 8E3F cpi r24,lo8(-2) |
| 2313 155a 01F4 brne .L391 |
| 2314 155c 8091 0000 lds r24,Poti4 |
| 2315 1560 8093 0000 sts Parameter_AchsKopplung2,r24 |
| 2316 1564 00C0 rjmp .L391 |
| 2317 .L387: |
| 2318 1566 8093 0000 sts Parameter_AchsKopplung2,r24 |
| 2319 .L391: |
| 2320 156a 8091 0000 lds r24,EE_Parameter+44 |
| 2321 156e 8B3F cpi r24,lo8(-5) |
| 2322 1570 00F0 brlo .L397 |
| 2323 1572 8B3F cpi r24,lo8(-5) |
| 2324 1574 01F4 brne .+2 |
| 2325 1576 00C0 rjmp .L522 |
| 2326 1578 8C3F cpi r24,lo8(-4) |
| 2327 157a 01F4 brne .+2 |
| 2328 157c 00C0 rjmp .L523 |
| 2329 157e 8D3F cpi r24,lo8(-3) |
| 2330 1580 01F4 brne .+2 |
| 2331 1582 00C0 rjmp .L524 |
| 2332 1584 8E3F cpi r24,lo8(-2) |
| 2333 1586 01F4 brne .L401 |
| 2334 1588 8091 0000 lds r24,Poti4 |
| 2335 158c 8093 0000 sts Parameter_CouplingYawCorrection,r24 |
| 2336 1590 00C0 rjmp .L401 |
| 2337 .L397: |
| 2338 1592 8093 0000 sts Parameter_CouplingYawCorrection,r24 |
| 2339 .L401: |
| 2340 1596 8091 0000 lds r24,EE_Parameter+49 |
| 2341 159a 8B3F cpi r24,lo8(-5) |
| 2342 159c 00F0 brlo .L407 |
| 2343 159e 8B3F cpi r24,lo8(-5) |
| 2344 15a0 01F4 brne .+2 |
| 2345 15a2 00C0 rjmp .L525 |
| 2346 15a4 8C3F cpi r24,lo8(-4) |
| 2347 15a6 01F4 brne .+2 |
| 2348 15a8 00C0 rjmp .L526 |
| 2349 15aa 8D3F cpi r24,lo8(-3) |
| 2350 15ac 01F4 brne .+2 |
| 2351 15ae 00C0 rjmp .L527 |
| 2352 15b0 8E3F cpi r24,lo8(-2) |
| 2353 15b2 01F4 brne .L411 |
| 2354 15b4 8091 0000 lds r24,Poti4 |
| 2355 15b8 8093 0000 sts Parameter_DynamicStability,r24 |
| 2356 15bc 00C0 rjmp .L411 |
| 2357 .L407: |
| 2358 15be 8093 0000 sts Parameter_DynamicStability,r24 |
| 2359 .L411: |
| 2360 15c2 8091 0000 lds r24,EE_Parameter+55 |
| 2361 15c6 8B3F cpi r24,lo8(-5) |
| 2362 15c8 00F0 brlo .L417 |
| 2363 15ca 8B3F cpi r24,lo8(-5) |
| 2364 15cc 01F4 brne .+2 |
| 2365 15ce 00C0 rjmp .L528 |
| 2366 15d0 8C3F cpi r24,lo8(-4) |
| 2367 15d2 01F4 brne .+2 |
| 2368 15d4 00C0 rjmp .L529 |
| 2369 15d6 8D3F cpi r24,lo8(-3) |
| 2370 15d8 01F4 brne .+2 |
| 2371 15da 00C0 rjmp .L530 |
| 2372 15dc 8E3F cpi r24,lo8(-2) |
| 2373 15de 01F4 brne .L421 |
| 2374 15e0 8091 0000 lds r24,Poti4 |
| 2375 15e4 8093 0000 sts Parameter_J16Timing,r24 |
| 2376 15e8 00C0 rjmp .L421 |
| 2377 .L417: |
| 2378 15ea 8093 0000 sts Parameter_J16Timing,r24 |
| 2379 .L421: |
| 2380 15ee 8091 0000 lds r24,Parameter_J16Timing |
| 2381 15f2 8230 cpi r24,lo8(2) |
| 2382 15f4 00F4 brsh .+2 |
| 2383 15f6 00C0 rjmp .L531 |
| 2384 15f8 8F3F cpi r24,lo8(-1) |
| 2385 15fa 01F0 breq .L532 |
| 2386 .L429: |
| 2387 15fc 8091 0000 lds r24,EE_Parameter+57 |
| 2388 1600 8B3F cpi r24,lo8(-5) |
| 2389 1602 00F0 brlo .L431 |
| 2390 1604 8B3F cpi r24,lo8(-5) |
| 2391 1606 01F4 brne .+2 |
| 2392 1608 00C0 rjmp .L533 |
| 2393 160a 8C3F cpi r24,lo8(-4) |
| 2394 160c 01F4 brne .+2 |
| 2395 160e 00C0 rjmp .L534 |
| 2396 1610 8D3F cpi r24,lo8(-3) |
| 2397 1612 01F4 brne .+2 |
| 2398 1614 00C0 rjmp .L535 |
| 2399 1616 8E3F cpi r24,lo8(-2) |
| 2400 1618 01F4 brne .L435 |
| 2401 161a 8091 0000 lds r24,Poti4 |
| 2402 161e 8093 0000 sts Parameter_J17Timing,r24 |
| 2403 1622 00C0 rjmp .L435 |
| 2404 .L431: |
| 2405 1624 8093 0000 sts Parameter_J17Timing,r24 |
| 2406 .L435: |
| 2407 1628 8091 0000 lds r24,Parameter_J17Timing |
| 2408 162c 8230 cpi r24,lo8(2) |
| 2409 162e 00F0 brlo .L536 |
| 2410 1630 8F3F cpi r24,lo8(-1) |
| 2411 1632 01F0 breq .L537 |
| 2412 .L443: |
| 2413 1634 8091 0000 lds r24,EE_Parameter+74 |
| 2414 1638 8B3F cpi r24,lo8(-5) |
| 2415 163a 00F0 brlo .L445 |
| 2416 163c 8B3F cpi r24,lo8(-5) |
| 2417 163e 01F4 brne .+2 |
| 2418 1640 00C0 rjmp .L538 |
| 2419 1642 8C3F cpi r24,lo8(-4) |
| 2420 1644 01F4 brne .+2 |
| 2421 1646 00C0 rjmp .L539 |
| 2422 1648 8D3F cpi r24,lo8(-3) |
| 2423 164a 01F4 brne .+2 |
| 2424 164c 00C0 rjmp .L540 |
| 2425 164e 8E3F cpi r24,lo8(-2) |
| 2426 1650 01F0 breq .+2 |
| 2427 1652 00C0 rjmp .L449 |
| 2428 1654 8091 0000 lds r24,Poti4 |
| 2429 1658 8093 0000 sts Parameter_ExternalControl,r24 |
| 2430 165c 00C0 rjmp .L449 |
| 2431 .L445: |
| 2432 165e 8093 0000 sts Parameter_ExternalControl,r24 |
| 2433 1662 00C0 rjmp .L449 |
| 2434 .L537: |
| 2435 1664 8093 0000 sts Parameter_J17Timing,r24 |
| 2436 1668 00C0 rjmp .L443 |
| 2437 .L532: |
| 2438 166a 8093 0000 sts Parameter_J16Timing,r24 |
| 2439 166e 00C0 rjmp .L429 |
| 2440 .L536: |
| 2441 1670 81E0 ldi r24,lo8(1) |
| 2442 1672 8093 0000 sts Parameter_J17Timing,r24 |
| 2443 1676 00C0 rjmp .L443 |
| 2444 .L531: |
| 2445 1678 81E0 ldi r24,lo8(1) |
| 2446 167a 8093 0000 sts Parameter_J16Timing,r24 |
| 2447 167e 00C0 rjmp .L429 |
| 2448 .L501: |
| 2449 1680 8091 0000 lds r24,Poti1 |
| 2450 1684 8093 0000 sts Parameter_UserParam6,r24 |
| 2451 1688 00C0 rjmp .L331 |
| 2452 .L504: |
| 2453 168a 8091 0000 lds r24,Poti1 |
| 2454 168e 8093 0000 sts Parameter_UserParam7,r24 |
| 2455 1692 00C0 rjmp .L341 |
| 2456 .L507: |
| 2457 1694 8091 0000 lds r24,Poti1 |
| 2458 1698 8093 0000 sts Parameter_UserParam8,r24 |
| 2459 169c 00C0 rjmp .L351 |
| 2460 .L510: |
| 2461 169e 8091 0000 lds r24,Poti1 |
| 2462 16a2 8093 0000 sts Parameter_ServoNickControl,r24 |
| 2463 16a6 00C0 rjmp .L361 |
| 2464 .L513: |
| 2465 16a8 8091 0000 lds r24,Poti1 |
| 2466 16ac 8093 0000 sts Parameter_LoopGasLimit,r24 |
| 2467 16b0 00C0 rjmp .L371 |
| 2468 .L516: |
| 2469 16b2 8091 0000 lds r24,Poti1 |
| 2470 16b6 8093 0000 sts Parameter_AchsKopplung1,r24 |
| 2471 16ba 00C0 rjmp .L381 |
| 2472 .L519: |
| 2473 16bc 8091 0000 lds r24,Poti1 |
| 2474 16c0 8093 0000 sts Parameter_AchsKopplung2,r24 |
| 2475 16c4 00C0 rjmp .L391 |
| 2476 .L522: |
| 2477 16c6 8091 0000 lds r24,Poti1 |
| 2478 16ca 8093 0000 sts Parameter_CouplingYawCorrection,r24 |
| 2479 16ce 00C0 rjmp .L401 |
| 2480 .L489: |
| 2481 16d0 8091 0000 lds r24,Poti1 |
| 2482 16d4 8093 0000 sts Parameter_UserParam2,r24 |
| 2483 16d8 00C0 rjmp .L291 |
| 2484 .L492: |
| 2485 16da 8091 0000 lds r24,Poti1 |
| 2486 16de 8093 0000 sts Parameter_UserParam3,r24 |
| 2487 16e2 00C0 rjmp .L301 |
| 2488 .L495: |
| 2489 16e4 8091 0000 lds r24,Poti1 |
| 2490 16e8 8093 0000 sts Parameter_UserParam4,r24 |
| 2491 16ec 00C0 rjmp .L311 |
| 2492 .L498: |
| 2493 16ee 8091 0000 lds r24,Poti1 |
| 2494 16f2 8093 0000 sts Parameter_UserParam5,r24 |
| 2495 16f6 00C0 rjmp .L321 |
| 2496 .L480: |
| 2497 16f8 8091 0000 lds r24,Poti1 |
| 2498 16fc 8093 0000 sts Parameter_Gyro_D,r24 |
| 2499 1700 00C0 rjmp .L261 |
| 2500 .L483: |
| 2501 1702 8091 0000 lds r24,Poti1 |
| 2502 1706 8093 0000 sts Parameter_I_Faktor,r24 |
| 2503 170a 00C0 rjmp .L271 |
| 2504 .L486: |
| 2505 170c 8091 0000 lds r24,Poti1 |
| 2506 1710 8093 0000 sts Parameter_UserParam1,r24 |
| 2507 1714 00C0 rjmp .L281 |
| 2508 .L525: |
| 2509 1716 8091 0000 lds r24,Poti1 |
| 2510 171a 8093 0000 sts Parameter_DynamicStability,r24 |
| 2511 171e 00C0 rjmp .L411 |
| 2512 .L528: |
| 2513 1720 8091 0000 lds r24,Poti1 |
| 2514 1724 8093 0000 sts Parameter_J16Timing,r24 |
| 2515 1728 00C0 rjmp .L421 |
| 2516 .L533: |
| 2517 172a 8091 0000 lds r24,Poti1 |
| 2518 172e 8093 0000 sts Parameter_J17Timing,r24 |
| 2519 1732 00C0 rjmp .L435 |
| 2520 .L538: |
| 2521 1734 8091 0000 lds r24,Poti1 |
| 2522 1738 8093 0000 sts Parameter_ExternalControl,r24 |
| 2523 173c 00C0 rjmp .L449 |
| 2524 .L459: |
| 2525 173e 8091 0000 lds r24,Poti1 |
| 2526 1742 8093 0000 sts Parameter_Luftdruck_D,r24 |
| 2527 1746 00C0 rjmp .L189 |
| 2528 .L462: |
| 2529 1748 8091 0000 lds r24,Poti1 |
| 2530 174c 8093 0000 sts Parameter_Hoehe_P,r24 |
| 2531 1750 00C0 rjmp .L203 |
| 2532 .L466: |
| 2533 1752 8091 0000 lds r24,Poti1 |
| 2534 1756 8093 0000 sts Parameter_Hoehe_ACC_Wirkung,r24 |
| 2535 175a 00C0 rjmp .L217 |
| 2536 .L456: |
| 2537 175c 8091 0000 lds r24,Poti1 |
| 2538 1760 8093 0000 sts Parameter_MaxHoehe,r24 |
| 2539 1764 00C0 rjmp .L179 |
| 2540 .L473: |
| 2541 1766 8091 0000 lds r24,Poti1 |
| 2542 176a 8093 0000 sts Parameter_Gyro_P,r24 |
| 2543 176e 00C0 rjmp .L237 |
| 2544 .L476: |
| 2545 1770 8091 0000 lds r24,Poti1 |
| 2546 1774 8093 0000 sts Parameter_Gyro_I,r24 |
| 2547 1778 00C0 rjmp .L251 |
| 2548 .L470: |
| 2549 177a 8091 0000 lds r24,Poti1 |
| 2550 177e 8093 0000 sts Parameter_KompassWirkung,r24 |
| 2551 1782 00C0 rjmp .L227 |
| 2552 .L535: |
| 2553 1784 8091 0000 lds r24,Poti3 |
| 2554 1788 8093 0000 sts Parameter_J17Timing,r24 |
| 2555 178c 00C0 rjmp .L435 |
| 2556 .L540: |
| 2557 178e 8091 0000 lds r24,Poti3 |
| 2558 1792 8093 0000 sts Parameter_ExternalControl,r24 |
| 2559 1796 00C0 rjmp .L449 |
| 2560 .L482: |
| 2561 1798 8091 0000 lds r24,Poti3 |
| 2562 179c 8093 0000 sts Parameter_Gyro_D,r24 |
| 2563 17a0 00C0 rjmp .L261 |
| 2564 .L472: |
| 2565 17a2 8091 0000 lds r24,Poti3 |
| 2566 17a6 8093 0000 sts Parameter_KompassWirkung,r24 |
| 2567 17aa 00C0 rjmp .L227 |
| 2568 .L475: |
| 2569 17ac 8091 0000 lds r24,Poti3 |
| 2570 17b0 8093 0000 sts Parameter_Gyro_P,r24 |
| 2571 17b4 00C0 rjmp .L237 |
| 2572 .L478: |
| 2573 17b6 8091 0000 lds r24,Poti3 |
| 2574 17ba 8093 0000 sts Parameter_Gyro_I,r24 |
| 2575 17be 00C0 rjmp .L251 |
| 2576 .L461: |
| 2577 17c0 8091 0000 lds r24,Poti3 |
| 2578 17c4 8093 0000 sts Parameter_Luftdruck_D,r24 |
| 2579 17c8 00C0 rjmp .L189 |
| 2580 .L464: |
| 2581 17ca 8091 0000 lds r24,Poti3 |
| 2582 17ce 8093 0000 sts Parameter_Hoehe_P,r24 |
| 2583 17d2 00C0 rjmp .L203 |
| 2584 .L468: |
| 2585 17d4 8091 0000 lds r24,Poti3 |
| 2586 17d8 8093 0000 sts Parameter_Hoehe_ACC_Wirkung,r24 |
| 2587 17dc 00C0 rjmp .L217 |
| 2588 .L458: |
| 2589 17de 8091 0000 lds r24,Poti3 |
| 2590 17e2 8093 0000 sts Parameter_MaxHoehe,r24 |
| 2591 17e6 00C0 rjmp .L179 |
| 2592 .L530: |
| 2593 17e8 8091 0000 lds r24,Poti3 |
| 2594 17ec 8093 0000 sts Parameter_J16Timing,r24 |
| 2595 17f0 00C0 rjmp .L421 |
| 2596 .L521: |
| 2597 17f2 8091 0000 lds r24,Poti3 |
| 2598 17f6 8093 0000 sts Parameter_AchsKopplung2,r24 |
| 2599 17fa 00C0 rjmp .L391 |
| 2600 .L524: |
| 2601 17fc 8091 0000 lds r24,Poti3 |
| 2602 1800 8093 0000 sts Parameter_CouplingYawCorrection,r24 |
| 2603 1804 00C0 rjmp .L401 |
| 2604 .L527: |
| 2605 1806 8091 0000 lds r24,Poti3 |
| 2606 180a 8093 0000 sts Parameter_DynamicStability,r24 |
| 2607 180e 00C0 rjmp .L411 |
| 2608 .L512: |
| 2609 1810 8091 0000 lds r24,Poti3 |
| 2610 1814 8093 0000 sts Parameter_ServoNickControl,r24 |
| 2611 1818 00C0 rjmp .L361 |
| 2612 .L515: |
| 2613 181a 8091 0000 lds r24,Poti3 |
| 2614 181e 8093 0000 sts Parameter_LoopGasLimit,r24 |
| 2615 1822 00C0 rjmp .L371 |
| 2616 .L518: |
| 2617 1824 8091 0000 lds r24,Poti3 |
| 2618 1828 8093 0000 sts Parameter_AchsKopplung1,r24 |
| 2619 182c 00C0 rjmp .L381 |
| 2620 .L509: |
| 2621 182e 8091 0000 lds r24,Poti3 |
| 2622 1832 8093 0000 sts Parameter_UserParam8,r24 |
| 2623 1836 00C0 rjmp .L351 |
| 2624 .L488: |
| 2625 1838 8091 0000 lds r24,Poti3 |
| 2626 183c 8093 0000 sts Parameter_UserParam1,r24 |
| 2627 1840 00C0 rjmp .L281 |
| 2628 .L491: |
| 2629 1842 8091 0000 lds r24,Poti3 |
| 2630 1846 8093 0000 sts Parameter_UserParam2,r24 |
| 2631 184a 00C0 rjmp .L291 |
| 2632 .L494: |
| 2633 184c 8091 0000 lds r24,Poti3 |
| 2634 1850 8093 0000 sts Parameter_UserParam3,r24 |
| 2635 1854 00C0 rjmp .L301 |
| 2636 .L485: |
| 2637 1856 8091 0000 lds r24,Poti3 |
| 2638 185a 8093 0000 sts Parameter_I_Faktor,r24 |
| 2639 185e 00C0 rjmp .L271 |
| 2640 .L506: |
| 2641 1860 8091 0000 lds r24,Poti3 |
| 2642 1864 8093 0000 sts Parameter_UserParam7,r24 |
| 2643 1868 00C0 rjmp .L341 |
| 2644 .L497: |
| 2645 186a 8091 0000 lds r24,Poti3 |
| 2646 186e 8093 0000 sts Parameter_UserParam4,r24 |
| 2647 1872 00C0 rjmp .L311 |
| 2648 .L500: |
| 2649 1874 8091 0000 lds r24,Poti3 |
| 2650 1878 8093 0000 sts Parameter_UserParam5,r24 |
| 2651 187c 00C0 rjmp .L321 |
| 2652 .L503: |
| 2653 187e 8091 0000 lds r24,Poti3 |
| 2654 1882 8093 0000 sts Parameter_UserParam6,r24 |
| 2655 1886 00C0 rjmp .L331 |
| 2656 .L499: |
| 2657 1888 8091 0000 lds r24,Poti2 |
| 2658 188c 8093 0000 sts Parameter_UserParam5,r24 |
| 2659 1890 00C0 rjmp .L321 |
| 2660 .L502: |
| 2661 1892 8091 0000 lds r24,Poti2 |
| 2662 1896 8093 0000 sts Parameter_UserParam6,r24 |
| 2663 189a 00C0 rjmp .L331 |
| 2664 .L487: |
| 2665 189c 8091 0000 lds r24,Poti2 |
| 2666 18a0 8093 0000 sts Parameter_UserParam1,r24 |
| 2667 18a4 00C0 rjmp .L281 |
| 2668 .L490: |
| 2669 18a6 8091 0000 lds r24,Poti2 |
| 2670 18aa 8093 0000 sts Parameter_UserParam2,r24 |
| 2671 18ae 00C0 rjmp .L291 |
| 2672 .L517: |
| 2673 18b0 8091 0000 lds r24,Poti2 |
| 2674 18b4 8093 0000 sts Parameter_AchsKopplung1,r24 |
| 2675 18b8 00C0 rjmp .L381 |
| 2676 .L508: |
| 2677 18ba 8091 0000 lds r24,Poti2 |
| 2678 18be 8093 0000 sts Parameter_UserParam8,r24 |
| 2679 18c2 00C0 rjmp .L351 |
| 2680 .L505: |
| 2681 18c4 8091 0000 lds r24,Poti2 |
| 2682 18c8 8093 0000 sts Parameter_UserParam7,r24 |
| 2683 18cc 00C0 rjmp .L341 |
| 2684 .L496: |
| 2685 18ce 8091 0000 lds r24,Poti2 |
| 2686 18d2 8093 0000 sts Parameter_UserParam4,r24 |
| 2687 18d6 00C0 rjmp .L311 |
| 2688 .L493: |
| 2689 18d8 8091 0000 lds r24,Poti2 |
| 2690 18dc 8093 0000 sts Parameter_UserParam3,r24 |
| 2691 18e0 00C0 rjmp .L301 |
| 2692 .L484: |
| 2693 18e2 8091 0000 lds r24,Poti2 |
| 2694 18e6 8093 0000 sts Parameter_I_Faktor,r24 |
| 2695 18ea 00C0 rjmp .L271 |
| 2696 .L529: |
| 2697 18ec 8091 0000 lds r24,Poti2 |
| 2698 18f0 8093 0000 sts Parameter_J16Timing,r24 |
| 2699 18f4 00C0 rjmp .L421 |
| 2700 .L520: |
| 2701 18f6 8091 0000 lds r24,Poti2 |
| 2702 18fa 8093 0000 sts Parameter_AchsKopplung2,r24 |
| 2703 18fe 00C0 rjmp .L391 |
| 2704 .L467: |
| 2705 1900 8091 0000 lds r24,Poti2 |
| 2706 1904 8093 0000 sts Parameter_Hoehe_ACC_Wirkung,r24 |
| 2707 1908 00C0 rjmp .L217 |
| 2708 .L457: |
| 2709 190a 8091 0000 lds r24,Poti2 |
| 2710 190e 8093 0000 sts Parameter_MaxHoehe,r24 |
| 2711 1912 00C0 rjmp .L179 |
| 2712 .L511: |
| 2713 1914 8091 0000 lds r24,Poti2 |
| 2714 1918 8093 0000 sts Parameter_ServoNickControl,r24 |
| 2715 191c 00C0 rjmp .L361 |
| 2716 .L514: |
| 2717 191e 8091 0000 lds r24,Poti2 |
| 2718 1922 8093 0000 sts Parameter_LoopGasLimit,r24 |
| 2719 1926 00C0 rjmp .L371 |
| 2720 .L523: |
| 2721 1928 8091 0000 lds r24,Poti2 |
| 2722 192c 8093 0000 sts Parameter_CouplingYawCorrection,r24 |
| 2723 1930 00C0 rjmp .L401 |
| 2724 .L526: |
| 2725 1932 8091 0000 lds r24,Poti2 |
| 2726 1936 8093 0000 sts Parameter_DynamicStability,r24 |
| 2727 193a 00C0 rjmp .L411 |
| 2728 .L481: |
| 2729 193c 8091 0000 lds r24,Poti2 |
| 2730 1940 8093 0000 sts Parameter_Gyro_D,r24 |
| 2731 1944 00C0 rjmp .L261 |
| 2732 .L471: |
| 2733 1946 8091 0000 lds r24,Poti2 |
| 2734 194a 8093 0000 sts Parameter_KompassWirkung,r24 |
| 2735 194e 00C0 rjmp .L227 |
| 2736 .L534: |
| 2737 1950 8091 0000 lds r24,Poti2 |
| 2738 1954 8093 0000 sts Parameter_J17Timing,r24 |
| 2739 1958 00C0 rjmp .L435 |
| 2740 .L539: |
| 2741 195a 8091 0000 lds r24,Poti2 |
| 2742 195e 8093 0000 sts Parameter_ExternalControl,r24 |
| 2743 1962 00C0 rjmp .L449 |
| 2744 .L460: |
| 2745 1964 8091 0000 lds r24,Poti2 |
| 2746 1968 8093 0000 sts Parameter_Luftdruck_D,r24 |
| 2747 196c 00C0 rjmp .L189 |
| 2748 .L463: |
| 2749 196e 8091 0000 lds r24,Poti2 |
| 2750 1972 8093 0000 sts Parameter_Hoehe_P,r24 |
| 2751 1976 00C0 rjmp .L203 |
| 2752 .L474: |
| 2753 1978 8091 0000 lds r24,Poti2 |
| 2754 197c 8093 0000 sts Parameter_Gyro_P,r24 |
| 2755 1980 00C0 rjmp .L237 |
| 2756 .L477: |
| 2757 1982 8091 0000 lds r24,Poti2 |
| 2758 1986 8093 0000 sts Parameter_Gyro_I,r24 |
| 2759 198a 00C0 rjmp .L251 |
| 2760 .L449: |
| 2761 198c 6091 0000 lds r22,Parameter_I_Faktor |
| 2762 1990 70E0 ldi r23,lo8(0) |
| 2763 1992 6F5F subi r22,lo8(-(1)) |
| 2764 1994 7F4F sbci r23,hi8(-(1)) |
| 2765 1996 8CE3 ldi r24,lo8(10300) |
| 2766 1998 98E2 ldi r25,hi8(10300) |
| 2767 199a 0E94 0000 call __divmodhi4 |
| 2768 199e 7093 0000 sts (Ki)+1,r23 |
| 2769 19a2 6093 0000 sts Ki,r22 |
| 2770 19a6 8091 0000 lds r24,EE_Parameter+19 |
| 2771 19aa 8093 0000 sts MAX_GAS,r24 |
| 2772 19ae 8091 0000 lds r24,EE_Parameter+18 |
| 2773 19b2 8093 0000 sts MIN_GAS,r24 |
| 2774 /* epilogue: frame size=0 */ |
| 2775 19b6 0895 ret |
| 2776 /* epilogue end (size=1) */ |
| 2777 /* function ParameterZuordnung size 1058 (1057) */ |
| 2779 .global SendMotorData |
| 2781 SendMotorData: |
| 2782 /* prologue: frame size=0 */ |
| 2783 /* prologue end (size=0) */ |
| 2784 19b8 8091 0000 lds r24,MotorenEin |
| 2785 19bc 8823 tst r24 |
| 2786 19be 01F4 brne .L542 |
| 2787 19c0 1092 0000 sts Motor_Hinten,__zero_reg__ |
| 2788 19c4 1092 0000 sts Motor_Vorne,__zero_reg__ |
| 2789 19c8 1092 0000 sts Motor_Rechts,__zero_reg__ |
| 2790 19cc 1092 0000 sts Motor_Links,__zero_reg__ |
| 2791 19d0 8091 0000 lds r24,MotorTest |
| 2792 19d4 8823 tst r24 |
| 2793 19d6 01F0 breq .L544 |
| 2794 19d8 8093 0000 sts Motor_Vorne,r24 |
| 2795 .L544: |
| 2796 19dc 8091 0000 lds r24,MotorTest+1 |
| 2797 19e0 8823 tst r24 |
| 2798 19e2 01F0 breq .L546 |
| 2799 19e4 8093 0000 sts Motor_Hinten,r24 |
| 2800 .L546: |
| 2801 19e8 8091 0000 lds r24,MotorTest+2 |
| 2802 19ec 8823 tst r24 |
| 2803 19ee 01F0 breq .L548 |
| 2804 19f0 8093 0000 sts Motor_Links,r24 |
| 2805 .L548: |
| 2806 19f4 8091 0000 lds r24,MotorTest+3 |
| 2807 19f8 8823 tst r24 |
| 2808 19fa 01F4 brne .L554 |
| 2809 .L550: |
| 2810 19fc 8091 0000 lds r24,MikroKopterFlags |
| 2811 1a00 8C7F andi r24,lo8(-4) |
| 2812 1a02 8093 0000 sts MikroKopterFlags,r24 |
| 2813 1a06 00C0 rjmp .L552 |
| 2814 .L542: |
| 2815 1a08 8091 0000 lds r24,MikroKopterFlags |
| 2816 1a0c 8160 ori r24,lo8(1) |
| 2817 1a0e 8093 0000 sts MikroKopterFlags,r24 |
| 2818 1a12 00C0 rjmp .L552 |
| 2819 .L554: |
| 2820 1a14 8093 0000 sts Motor_Rechts,r24 |
| 2821 1a18 00C0 rjmp .L550 |
| 2822 .L552: |
| 2823 1a1a 8091 0000 lds r24,Motor_Vorne |
| 2824 1a1e 90E0 ldi r25,lo8(0) |
| 2825 1a20 9093 0000 sts (DebugOut+26)+1,r25 |
| 2826 1a24 8093 0000 sts DebugOut+26,r24 |
| 2827 1a28 8091 0000 lds r24,Motor_Hinten |
| 2828 1a2c 90E0 ldi r25,lo8(0) |
| 2829 1a2e 9093 0000 sts (DebugOut+28)+1,r25 |
| 2830 1a32 8093 0000 sts DebugOut+28,r24 |
| 2831 1a36 8091 0000 lds r24,Motor_Links |
| 2832 1a3a 90E0 ldi r25,lo8(0) |
| 2833 1a3c 9093 0000 sts (DebugOut+30)+1,r25 |
| 2834 1a40 8093 0000 sts DebugOut+30,r24 |
| 2835 1a44 8091 0000 lds r24,Motor_Rechts |
| 2836 1a48 90E0 ldi r25,lo8(0) |
| 2837 1a4a 9093 0000 sts (DebugOut+32)+1,r25 |
| 2838 1a4e 8093 0000 sts DebugOut+32,r24 |
| 2839 1a52 1092 0000 sts twi_state,__zero_reg__ |
| 2840 1a56 1092 0000 sts motor,__zero_reg__ |
| 2841 1a5a 0E94 0000 call i2c_start |
| 2842 /* epilogue: frame size=0 */ |
| 2843 1a5e 0895 ret |
| 2844 /* epilogue end (size=1) */ |
| 2845 /* function SendMotorData size 84 (83) */ |
| 2847 .global CalibrierMittelwert |
| 2849 CalibrierMittelwert: |
| 2850 /* prologue: frame size=0 */ |
| 2851 /* prologue end (size=0) */ |
| 2852 1a60 8091 0000 lds r24,PlatinenVersion |
| 2853 1a64 8D30 cpi r24,lo8(13) |
| 2854 1a66 01F4 brne .+2 |
| 2855 1a68 00C0 rjmp .L595 |
| 2856 .L556: |
| 2857 1a6a 1092 7A00 sts 122,__zero_reg__ |
| 2858 1a6e 8091 0000 lds r24,AdWertNick |
| 2859 1a72 9091 0000 lds r25,(AdWertNick)+1 |
| 2860 1a76 9093 0000 sts (MesswertNick)+1,r25 |
| 2861 1a7a 8093 0000 sts MesswertNick,r24 |
| 2862 1a7e 8091 0000 lds r24,AdWertRoll |
| 2863 1a82 9091 0000 lds r25,(AdWertRoll)+1 |
| 2864 1a86 9093 0000 sts (MesswertRoll)+1,r25 |
| 2865 1a8a 8093 0000 sts MesswertRoll,r24 |
| 2866 1a8e 8091 0000 lds r24,AdWertGier |
| 2867 1a92 9091 0000 lds r25,(AdWertGier)+1 |
| 2868 1a96 9093 0000 sts (MesswertGier)+1,r25 |
| 2869 1a9a 8093 0000 sts MesswertGier,r24 |
| 2870 1a9e 6091 0000 lds r22,AdWertAccNick |
| 2871 1aa2 7091 0000 lds r23,(AdWertAccNick)+1 |
| 2872 1aa6 8827 clr r24 |
| 2873 1aa8 77FD sbrc r23,7 |
| 2874 1aaa 8095 com r24 |
| 2875 1aac 982F mov r25,r24 |
| 2876 1aae 26E0 ldi r18,lo8(6) |
| 2877 1ab0 30E0 ldi r19,hi8(6) |
| 2878 1ab2 40E0 ldi r20,hlo8(6) |
| 2879 1ab4 50E0 ldi r21,hhi8(6) |
| 2880 1ab6 0E94 0000 call __mulsi3 |
| 2881 1aba 7093 0000 sts (Mittelwert_AccNick)+1,r23 |
| 2882 1abe 6093 0000 sts Mittelwert_AccNick,r22 |
| 2883 1ac2 6091 0000 lds r22,AdWertAccRoll |
| 2884 1ac6 7091 0000 lds r23,(AdWertAccRoll)+1 |
| 2885 1aca 8827 clr r24 |
| 2886 1acc 77FD sbrc r23,7 |
| 2887 1ace 8095 com r24 |
| 2888 1ad0 982F mov r25,r24 |
| 2889 1ad2 0E94 0000 call __mulsi3 |
| 2890 1ad6 7093 0000 sts (Mittelwert_AccRoll)+1,r23 |
| 2891 1ada 6093 0000 sts Mittelwert_AccRoll,r22 |
| 2892 1ade 8091 0000 lds r24,AdWertAccHoch |
| 2893 1ae2 9091 0000 lds r25,(AdWertAccHoch)+1 |
| 2894 1ae6 9093 0000 sts (Mittelwert_AccHoch)+1,r25 |
| 2895 1aea 8093 0000 sts Mittelwert_AccHoch,r24 |
| 2896 1aee 8FEC ldi r24,lo8(-49) |
| 2897 1af0 8093 7A00 sts 122,r24 |
| 2898 1af4 8091 0000 lds r24,EE_Parameter+4 |
| 2899 1af8 E82F mov r30,r24 |
| 2900 1afa F0E0 ldi r31,lo8(0) |
| 2901 1afc EE0F lsl r30 |
| 2902 1afe FF1F rol r31 |
| 2903 1b00 E050 subi r30,lo8(-(PPM_in)) |
| 2904 1b02 F040 sbci r31,hi8(-(PPM_in)) |
| 2905 1b04 8081 ld r24,Z |
| 2906 1b06 9181 ldd r25,Z+1 |
| 2907 1b08 A091 0000 lds r26,Poti1 |
| 2908 1b0c B091 0000 lds r27,(Poti1)+1 |
| 2909 1b10 8259 subi r24,lo8(-(110)) |
| 2910 1b12 9F4F sbci r25,hi8(-(110)) |
| 2911 1b14 A817 cp r26,r24 |
| 2912 1b16 B907 cpc r27,r25 |
| 2913 1b18 04F0 brlt .+2 |
| 2914 1b1a 00C0 rjmp .L558 |
| 2915 1b1c 1196 adiw r26,1 |
| 2916 1b1e B093 0000 sts (Poti1)+1,r27 |
| 2917 1b22 A093 0000 sts Poti1,r26 |
| 2918 .L560: |
| 2919 1b26 8091 0000 lds r24,EE_Parameter+5 |
| 2920 1b2a E82F mov r30,r24 |
| 2921 1b2c F0E0 ldi r31,lo8(0) |
| 2922 1b2e EE0F lsl r30 |
| 2923 1b30 FF1F rol r31 |
| 2924 1b32 E050 subi r30,lo8(-(PPM_in)) |
| 2925 1b34 F040 sbci r31,hi8(-(PPM_in)) |
| 2926 1b36 8081 ld r24,Z |
| 2927 1b38 9181 ldd r25,Z+1 |
| 2928 1b3a 6091 0000 lds r22,Poti2 |
| 2929 1b3e 7091 0000 lds r23,(Poti2)+1 |
| 2930 1b42 8259 subi r24,lo8(-(110)) |
| 2931 1b44 9F4F sbci r25,hi8(-(110)) |
| 2932 1b46 6817 cp r22,r24 |
| 2933 1b48 7907 cpc r23,r25 |
| 2934 1b4a 04F0 brlt .+2 |
| 2935 1b4c 00C0 rjmp .L563 |
| 2936 1b4e 6F5F subi r22,lo8(-(1)) |
| 2937 1b50 7F4F sbci r23,hi8(-(1)) |
| 2938 1b52 7093 0000 sts (Poti2)+1,r23 |
| 2939 1b56 6093 0000 sts Poti2,r22 |
| 2940 .L565: |
| 2941 1b5a 8091 0000 lds r24,EE_Parameter+6 |
| 2942 1b5e E82F mov r30,r24 |
| 2943 1b60 F0E0 ldi r31,lo8(0) |
| 2944 1b62 EE0F lsl r30 |
| 2945 1b64 FF1F rol r31 |
| 2946 1b66 E050 subi r30,lo8(-(PPM_in)) |
| 2947 1b68 F040 sbci r31,hi8(-(PPM_in)) |
| 2948 1b6a 8081 ld r24,Z |
| 2949 1b6c 9181 ldd r25,Z+1 |
| 2950 1b6e 4091 0000 lds r20,Poti3 |
| 2951 1b72 5091 0000 lds r21,(Poti3)+1 |
| 2952 1b76 8259 subi r24,lo8(-(110)) |
| 2953 1b78 9F4F sbci r25,hi8(-(110)) |
| 2954 1b7a 4817 cp r20,r24 |
| 2955 1b7c 5907 cpc r21,r25 |
| 2956 1b7e 04F0 brlt .+2 |
| 2957 1b80 00C0 rjmp .L568 |
| 2958 1b82 4F5F subi r20,lo8(-(1)) |
| 2959 1b84 5F4F sbci r21,hi8(-(1)) |
| 2960 1b86 5093 0000 sts (Poti3)+1,r21 |
| 2961 1b8a 4093 0000 sts Poti3,r20 |
| 2962 .L570: |
| 2963 1b8e 8091 0000 lds r24,EE_Parameter+7 |
| 2964 1b92 E82F mov r30,r24 |
| 2965 1b94 F0E0 ldi r31,lo8(0) |
| 2966 1b96 EE0F lsl r30 |
| 2967 1b98 FF1F rol r31 |
| 2968 1b9a E050 subi r30,lo8(-(PPM_in)) |
| 2969 1b9c F040 sbci r31,hi8(-(PPM_in)) |
| 2970 1b9e 8081 ld r24,Z |
| 2971 1ba0 9181 ldd r25,Z+1 |
| 2972 1ba2 2091 0000 lds r18,Poti4 |
| 2973 1ba6 3091 0000 lds r19,(Poti4)+1 |
| 2974 1baa 8259 subi r24,lo8(-(110)) |
| 2975 1bac 9F4F sbci r25,hi8(-(110)) |
| 2976 1bae 2817 cp r18,r24 |
| 2977 1bb0 3907 cpc r19,r25 |
| 2978 1bb2 04F4 brge .L573 |
| 2979 1bb4 2F5F subi r18,lo8(-(1)) |
| 2980 1bb6 3F4F sbci r19,hi8(-(1)) |
| 2981 1bb8 3093 0000 sts (Poti4)+1,r19 |
| 2982 1bbc 2093 0000 sts Poti4,r18 |
| 2983 .L575: |
| 2984 1bc0 B7FD sbrc r27,7 |
| 2985 1bc2 00C0 rjmp .L596 |
| 2986 .L578: |
| 2987 1bc4 AF3F cpi r26,255 |
| 2988 1bc6 B105 cpc r27,__zero_reg__ |
| 2989 1bc8 01F0 breq .+4 |
| 2990 1bca 04F0 brlt .+2 |
| 2991 1bcc 00C0 rjmp .L597 |
| 2992 .L580: |
| 2993 1bce 77FD sbrc r23,7 |
| 2994 1bd0 00C0 rjmp .L598 |
| 2995 .L582: |
| 2996 1bd2 6F3F cpi r22,255 |
| 2997 1bd4 7105 cpc r23,__zero_reg__ |
| 2998 1bd6 01F0 breq .+4 |
| 2999 1bd8 04F0 brlt .+2 |
| 3000 1bda 00C0 rjmp .L599 |
| 3001 .L584: |
| 3002 1bdc 57FD sbrc r21,7 |
| 3003 1bde 00C0 rjmp .L600 |
| 3004 .L586: |
| 3005 1be0 4F3F cpi r20,255 |
| 3006 1be2 5105 cpc r21,__zero_reg__ |
| 3007 1be4 01F0 breq .+4 |
| 3008 1be6 04F0 brlt .+2 |
| 3009 1be8 00C0 rjmp .L601 |
| 3010 .L588: |
| 3011 1bea 37FD sbrc r19,7 |
| 3012 1bec 00C0 rjmp .L602 |
| 3013 .L590: |
| 3014 1bee 2F3F cpi r18,255 |
| 3015 1bf0 3105 cpc r19,__zero_reg__ |
| 3016 1bf2 01F0 breq .+2 |
| 3017 1bf4 04F4 brge .+2 |
| 3018 1bf6 00C0 rjmp .L592 |
| 3019 1bf8 8FEF ldi r24,lo8(255) |
| 3020 1bfa 90E0 ldi r25,hi8(255) |
| 3021 1bfc 9093 0000 sts (Poti4)+1,r25 |
| 3022 1c00 8093 0000 sts Poti4,r24 |
| 3023 1c04 00C0 rjmp .L592 |
| 3024 .L573: |
| 3025 1c06 8081 ld r24,Z |
| 3026 1c08 9181 ldd r25,Z+1 |
| 3027 1c0a 8259 subi r24,lo8(-(110)) |
| 3028 1c0c 9F4F sbci r25,hi8(-(110)) |
| 3029 1c0e 8217 cp r24,r18 |
| 3030 1c10 9307 cpc r25,r19 |
| 3031 1c12 04F4 brge .L575 |
| 3032 1c14 2115 cp r18,__zero_reg__ |
| 3033 1c16 3105 cpc r19,__zero_reg__ |
| 3034 1c18 01F0 breq .L575 |
| 3035 1c1a 2150 subi r18,lo8(-(-1)) |
| 3036 1c1c 3040 sbci r19,hi8(-(-1)) |
| 3037 1c1e 3093 0000 sts (Poti4)+1,r19 |
| 3038 1c22 2093 0000 sts Poti4,r18 |
| 3039 1c26 B7FF sbrs r27,7 |
| 3040 1c28 00C0 rjmp .L578 |
| 3041 .L596: |
| 3042 1c2a 1092 0000 sts (Poti1)+1,__zero_reg__ |
| 3043 1c2e 1092 0000 sts Poti1,__zero_reg__ |
| 3044 1c32 77FF sbrs r23,7 |
| 3045 1c34 00C0 rjmp .L582 |
| 3046 .L598: |
| 3047 1c36 1092 0000 sts (Poti2)+1,__zero_reg__ |
| 3048 1c3a 1092 0000 sts Poti2,__zero_reg__ |
| 3049 1c3e 57FF sbrs r21,7 |
| 3050 1c40 00C0 rjmp .L586 |
| 3051 .L600: |
| 3052 1c42 1092 0000 sts (Poti3)+1,__zero_reg__ |
| 3053 1c46 1092 0000 sts Poti3,__zero_reg__ |
| 3054 1c4a 37FF sbrs r19,7 |
| 3055 1c4c 00C0 rjmp .L590 |
| 3056 .L602: |
| 3057 1c4e 1092 0000 sts (Poti4)+1,__zero_reg__ |
| 3058 1c52 1092 0000 sts Poti4,__zero_reg__ |
| 3059 1c56 00C0 rjmp .L592 |
| 3060 .L568: |
| 3061 1c58 8081 ld r24,Z |
| 3062 1c5a 9181 ldd r25,Z+1 |
| 3063 1c5c 8259 subi r24,lo8(-(110)) |
| 3064 1c5e 9F4F sbci r25,hi8(-(110)) |
| 3065 1c60 8417 cp r24,r20 |
| 3066 1c62 9507 cpc r25,r21 |
| 3067 1c64 04F0 brlt .+2 |
| 3068 1c66 00C0 rjmp .L570 |
| 3069 1c68 4115 cp r20,__zero_reg__ |
| 3070 1c6a 5105 cpc r21,__zero_reg__ |
| 3071 1c6c 01F4 brne .+2 |
| 3072 1c6e 00C0 rjmp .L570 |
| 3073 1c70 4150 subi r20,lo8(-(-1)) |
| 3074 1c72 5040 sbci r21,hi8(-(-1)) |
| 3075 1c74 5093 0000 sts (Poti3)+1,r21 |
| 3076 1c78 4093 0000 sts Poti3,r20 |
| 3077 1c7c 00C0 rjmp .L570 |
| 3078 .L563: |
| 3079 1c7e 8081 ld r24,Z |
| 3080 1c80 9181 ldd r25,Z+1 |
| 3081 1c82 8259 subi r24,lo8(-(110)) |
| 3082 1c84 9F4F sbci r25,hi8(-(110)) |
| 3083 1c86 8617 cp r24,r22 |
| 3084 1c88 9707 cpc r25,r23 |
| 3085 1c8a 04F0 brlt .+2 |
| 3086 1c8c 00C0 rjmp .L565 |
| 3087 1c8e 6115 cp r22,__zero_reg__ |
| 3088 1c90 7105 cpc r23,__zero_reg__ |
| 3089 1c92 01F4 brne .+2 |
| 3090 1c94 00C0 rjmp .L565 |
| 3091 1c96 6150 subi r22,lo8(-(-1)) |
| 3092 1c98 7040 sbci r23,hi8(-(-1)) |
| 3093 1c9a 7093 0000 sts (Poti2)+1,r23 |
| 3094 1c9e 6093 0000 sts Poti2,r22 |
| 3095 1ca2 00C0 rjmp .L565 |
| 3096 .L558: |
| 3097 1ca4 8081 ld r24,Z |
| 3098 1ca6 9181 ldd r25,Z+1 |
| 3099 1ca8 8259 subi r24,lo8(-(110)) |
| 3100 1caa 9F4F sbci r25,hi8(-(110)) |
| 3101 1cac 8A17 cp r24,r26 |
| 3102 1cae 9B07 cpc r25,r27 |
| 3103 1cb0 04F0 brlt .+2 |
| 3104 1cb2 00C0 rjmp .L560 |
| 3105 1cb4 1097 sbiw r26,0 |
| 3106 1cb6 01F4 brne .+2 |
| 3107 1cb8 00C0 rjmp .L560 |
| 3108 1cba 1197 sbiw r26,1 |
| 3109 1cbc B093 0000 sts (Poti1)+1,r27 |
| 3110 1cc0 A093 0000 sts Poti1,r26 |
| 3111 1cc4 00C0 rjmp .L560 |
| 3112 .L601: |
| 3113 1cc6 8FEF ldi r24,lo8(255) |
| 3114 1cc8 90E0 ldi r25,hi8(255) |
| 3115 1cca 9093 0000 sts (Poti3)+1,r25 |
| 3116 1cce 8093 0000 sts Poti3,r24 |
| 3117 1cd2 00C0 rjmp .L588 |
| 3118 .L599: |
| 3119 1cd4 8FEF ldi r24,lo8(255) |
| 3120 1cd6 90E0 ldi r25,hi8(255) |
| 3121 1cd8 9093 0000 sts (Poti2)+1,r25 |
| 3122 1cdc 8093 0000 sts Poti2,r24 |
| 3123 1ce0 00C0 rjmp .L584 |
| 3124 .L597: |
| 3125 1ce2 8FEF ldi r24,lo8(255) |
| 3126 1ce4 90E0 ldi r25,hi8(255) |
| 3127 1ce6 9093 0000 sts (Poti1)+1,r25 |
| 3128 1cea 8093 0000 sts Poti1,r24 |
| 3129 1cee 00C0 rjmp .L580 |
| 3130 .L595: |
| 3131 1cf0 0E94 0000 call SucheGyroOffset |
| 3132 1cf4 00C0 rjmp .L556 |
| 3133 .L592: |
| 3134 1cf6 6091 0000 lds r22,EE_Parameter+45 |
| 3135 1cfa 70E0 ldi r23,lo8(0) |
| 3136 1cfc 80E0 ldi r24,lo8(0) |
| 3137 1cfe 90E0 ldi r25,hi8(0) |
| 3138 1d00 24EC ldi r18,lo8(2500) |
| 3139 1d02 39E0 ldi r19,hi8(2500) |
| 3140 1d04 40E0 ldi r20,hlo8(2500) |
| 3141 1d06 50E0 ldi r21,hhi8(2500) |
| 3142 1d08 0E94 0000 call __mulsi3 |
| 3143 1d0c 6093 0000 sts Umschlag180Nick,r22 |
| 3144 1d10 7093 0000 sts (Umschlag180Nick)+1,r23 |
| 3145 1d14 8093 0000 sts (Umschlag180Nick)+2,r24 |
| 3146 1d18 9093 0000 sts (Umschlag180Nick)+3,r25 |
| 3147 1d1c 6091 0000 lds r22,EE_Parameter+46 |
| 3148 1d20 70E0 ldi r23,lo8(0) |
| 3149 1d22 80E0 ldi r24,lo8(0) |
| 3150 1d24 90E0 ldi r25,hi8(0) |
| 3151 1d26 0E94 0000 call __mulsi3 |
| 3152 1d2a 6093 0000 sts Umschlag180Roll,r22 |
| 3153 1d2e 7093 0000 sts (Umschlag180Roll)+1,r23 |
| 3154 1d32 8093 0000 sts (Umschlag180Roll)+2,r24 |
| 3155 1d36 9093 0000 sts (Umschlag180Roll)+3,r25 |
| 3156 /* epilogue: frame size=0 */ |
| 3157 1d3a 0895 ret |
| 3158 /* epilogue end (size=1) */ |
| 3159 /* function CalibrierMittelwert size 366 (365) */ |
| 3161 .global SetNeutral |
| 3163 SetNeutral: |
| 3164 /* prologue: frame size=0 */ |
| 3165 1d3c 6F92 push r6 |
| 3166 1d3e 7F92 push r7 |
| 3167 1d40 8F92 push r8 |
| 3168 1d42 9F92 push r9 |
| 3169 1d44 AF92 push r10 |
| 3170 1d46 BF92 push r11 |
| 3171 1d48 CF92 push r12 |
| 3172 1d4a DF92 push r13 |
| 3173 1d4c EF92 push r14 |
| 3174 1d4e FF92 push r15 |
| 3175 1d50 0F93 push r16 |
| 3176 1d52 1F93 push r17 |
| 3177 1d54 CF93 push r28 |
| 3178 1d56 DF93 push r29 |
| 3179 /* prologue end (size=14) */ |
| 3180 1d58 1092 0000 sts ServoActive,__zero_reg__ |
| 3181 1d5c 469A sbi 40-0x20,6 |
| 3182 1d5e 1092 0000 sts (NeutralAccX)+1,__zero_reg__ |
| 3183 1d62 1092 0000 sts NeutralAccX,__zero_reg__ |
| 3184 1d66 1092 0000 sts (NeutralAccY)+1,__zero_reg__ |
| 3185 1d6a 1092 0000 sts NeutralAccY,__zero_reg__ |
| 3186 1d6e 80E0 ldi r24,lo8(0x0) |
| 3187 1d70 90E0 ldi r25,hi8(0x0) |
| 3188 1d72 A0E0 ldi r26,hlo8(0x0) |
| 3189 1d74 B0E0 ldi r27,hhi8(0x0) |
| 3190 1d76 8093 0000 sts NeutralAccZ,r24 |
| 3191 1d7a 9093 0000 sts (NeutralAccZ)+1,r25 |
| 3192 1d7e A093 0000 sts (NeutralAccZ)+2,r26 |
| 3193 1d82 B093 0000 sts (NeutralAccZ)+3,r27 |
| 3194 1d86 1092 0000 sts (AdNeutralNick)+1,__zero_reg__ |
| 3195 1d8a 1092 0000 sts AdNeutralNick,__zero_reg__ |
| 3196 1d8e 1092 0000 sts (AdNeutralRoll)+1,__zero_reg__ |
| 3197 1d92 1092 0000 sts AdNeutralRoll,__zero_reg__ |
| 3198 1d96 1092 0000 sts (AdNeutralGier)+1,__zero_reg__ |
| 3199 1d9a 1092 0000 sts AdNeutralGier,__zero_reg__ |
| 3200 1d9e 1092 0000 sts (AdNeutralGierBias)+1,__zero_reg__ |
| 3201 1da2 1092 0000 sts AdNeutralGierBias,__zero_reg__ |
| 3202 1da6 1092 0000 sts Parameter_AchsKopplung1,__zero_reg__ |
| 3203 1daa 1092 0000 sts Parameter_AchsKopplung2,__zero_reg__ |
| 3204 1dae 1092 0000 sts ExpandBaro,__zero_reg__ |
| 3205 1db2 0E94 0000 call CalibrierMittelwert |
| 3206 1db6 84E6 ldi r24,lo8(100) |
| 3207 1db8 90E0 ldi r25,hi8(100) |
| 3208 1dba 0E94 0000 call Delay_ms_Mess |
| 3209 1dbe 0E94 0000 call CalibrierMittelwert |
| 3210 1dc2 8091 0000 lds r24,EE_Parameter+8 |
| 3211 1dc6 80FF sbrs r24,0 |
| 3212 1dc8 00C0 rjmp .L604 |
| 3213 1dca 8091 0000 lds r24,MessLuftdruck |
| 3214 1dce 9091 0000 lds r25,(MessLuftdruck)+1 |
| 3215 1dd2 875B subi r24,lo8(951) |
| 3216 1dd4 9340 sbci r25,hi8(951) |
| 3217 1dd6 00F0 brlo .+2 |
| 3218 1dd8 00C0 rjmp .L606 |
| 3219 1dda 8091 0000 lds r24,MessLuftdruck |
| 3220 1dde 9091 0000 lds r25,(MessLuftdruck)+1 |
| 3221 1de2 8E5E subi r24,lo8(750) |
| 3222 1de4 9240 sbci r25,hi8(750) |
| 3223 1de6 00F4 brsh .+2 |
| 3224 1de8 00C0 rjmp .L606 |
| 3225 .L604: |
| 3226 1dea EE24 clr r14 |
| 3227 1dec CC24 clr r12 |
| 3228 1dee DD24 clr r13 |
| 3229 1df0 C0E0 ldi r28,lo8(0) |
| 3230 1df2 D0E0 ldi r29,hi8(0) |
| 3231 1df4 00E0 ldi r16,lo8(0) |
| 3232 1df6 10E0 ldi r17,hi8(0) |
| 3233 .L608: |
| 3234 1df8 8AE0 ldi r24,lo8(10) |
| 3235 1dfa 90E0 ldi r25,hi8(10) |
| 3236 1dfc 0E94 0000 call Delay_ms_Mess |
| 3237 1e00 8091 0000 lds r24,AdWertGier |
| 3238 1e04 9091 0000 lds r25,(AdWertGier)+1 |
| 3239 1e08 C80E add r12,r24 |
| 3240 1e0a D91E adc r13,r25 |
| 3241 1e0c 8091 0000 lds r24,AdWertNick |
| 3242 1e10 9091 0000 lds r25,(AdWertNick)+1 |
| 3243 1e14 C80F add r28,r24 |
| 3244 1e16 D91F adc r29,r25 |
| 3245 1e18 8091 0000 lds r24,AdWertRoll |
| 3246 1e1c 9091 0000 lds r25,(AdWertRoll)+1 |
| 3247 1e20 080F add r16,r24 |
| 3248 1e22 191F adc r17,r25 |
| 3249 1e24 E394 inc r14 |
| 3250 1e26 80E2 ldi r24,lo8(32) |
| 3251 1e28 E816 cp r14,r24 |
| 3252 1e2a 01F4 brne .L608 |
| 3253 1e2c AE01 movw r20,r28 |
| 3254 1e2e 405F subi r20,lo8(-(16)) |
| 3255 1e30 5F4F sbci r21,hi8(-(16)) |
| 3256 1e32 5695 lsr r21 |
| 3257 1e34 4795 ror r20 |
| 3258 1e36 5695 lsr r21 |
| 3259 1e38 4795 ror r20 |
| 3260 1e3a 5093 0000 sts (AdNeutralNick)+1,r21 |
| 3261 1e3e 4093 0000 sts AdNeutralNick,r20 |
| 3262 1e42 9801 movw r18,r16 |
| 3263 1e44 205F subi r18,lo8(-(16)) |
| 3264 1e46 3F4F sbci r19,hi8(-(16)) |
| 3265 1e48 3695 lsr r19 |
| 3266 1e4a 2795 ror r18 |
| 3267 1e4c 3695 lsr r19 |
| 3268 1e4e 2795 ror r18 |
| 3269 1e50 3093 0000 sts (AdNeutralRoll)+1,r19 |
| 3270 1e54 2093 0000 sts AdNeutralRoll,r18 |
| 3271 1e58 C601 movw r24,r12 |
| 3272 1e5a 4096 adiw r24,16 |
| 3273 1e5c 9695 lsr r25 |
| 3274 1e5e 8795 ror r24 |
| 3275 1e60 9295 swap r25 |
| 3276 1e62 8295 swap r24 |
| 3277 1e64 8F70 andi r24,0x0f |
| 3278 1e66 8927 eor r24,r25 |
| 3279 1e68 9F70 andi r25,0x0f |
| 3280 1e6a 8927 eor r24,r25 |
| 3281 1e6c 9093 0000 sts (AdNeutralGier)+1,r25 |
| 3282 1e70 8093 0000 sts AdNeutralGier,r24 |
| 3283 1e74 9093 0000 sts (AdNeutralGierBias)+1,r25 |
| 3284 1e78 8093 0000 sts AdNeutralGierBias,r24 |
| 3285 1e7c 3093 0000 sts (StartNeutralRoll)+1,r19 |
| 3286 1e80 2093 0000 sts StartNeutralRoll,r18 |
| 3287 1e84 5093 0000 sts (StartNeutralNick)+1,r21 |
| 3288 1e88 4093 0000 sts StartNeutralNick,r20 |
| 3289 1e8c 40E0 ldi r20,lo8(EEPromArray+4) |
| 3290 1e8e 50E0 ldi r21,hi8(EEPromArray+4) |
| 3291 1e90 DA01 movw r26,r20 |
| 3292 /* #APP */ |
| 3293 1e92 0E94 0000 call __eeprom_read_byte_1F2021 |
| 3294 1e96 802D mov r24,__tmp_reg__ |
| 3295 /* #NOAPP */ |
| 3296 1e98 8530 cpi r24,lo8(5) |
| 3297 1e9a 00F0 brlo .L610 |
| 3298 1e9c 8091 0000 lds r24,Mittelwert_AccRoll |
| 3299 1ea0 9091 0000 lds r25,(Mittelwert_AccRoll)+1 |
| 3300 1ea4 97FD sbrc r25,7 |
| 3301 1ea6 00C0 rjmp .L618 |
| 3302 .L612: |
| 3303 1ea8 6CE0 ldi r22,lo8(12) |
| 3304 1eaa 70E0 ldi r23,hi8(12) |
| 3305 1eac 0E94 0000 call __divmodhi4 |
| 3306 1eb0 7093 0000 sts (NeutralAccY)+1,r23 |
| 3307 1eb4 6093 0000 sts NeutralAccY,r22 |
| 3308 1eb8 8091 0000 lds r24,Mittelwert_AccNick |
| 3309 1ebc 9091 0000 lds r25,(Mittelwert_AccNick)+1 |
| 3310 1ec0 97FD sbrc r25,7 |
| 3311 1ec2 00C0 rjmp .L619 |
| 3312 .L613: |
| 3313 1ec4 6CE0 ldi r22,lo8(12) |
| 3314 1ec6 70E0 ldi r23,hi8(12) |
| 3315 1ec8 0E94 0000 call __divmodhi4 |
| 3316 1ecc 7093 0000 sts (NeutralAccX)+1,r23 |
| 3317 1ed0 6093 0000 sts NeutralAccX,r22 |
| 3318 1ed4 6091 0000 lds r22,Aktuell_az |
| 3319 1ed8 7091 0000 lds r23,(Aktuell_az)+1 |
| 3320 1edc 8827 clr r24 |
| 3321 1ede 77FD sbrc r23,7 |
| 3322 1ee0 8095 com r24 |
| 3323 1ee2 982F mov r25,r24 |
| 3324 1ee4 0E94 0000 call __floatsisf |
| 3325 1ee8 6093 0000 sts NeutralAccZ,r22 |
| 3326 1eec 7093 0000 sts (NeutralAccZ)+1,r23 |
| 3327 1ef0 8093 0000 sts (NeutralAccZ)+2,r24 |
| 3328 1ef4 9093 0000 sts (NeutralAccZ)+3,r25 |
| 3329 1ef8 00C0 rjmp .L614 |
| 3330 .L610: |
| 3331 1efa DA01 movw r26,r20 |
| 3332 /* #APP */ |
| 3333 1efc 0E94 0000 call __eeprom_read_byte_1F2021 |
| 3334 1f00 802D mov r24,__tmp_reg__ |
| 3335 /* #NOAPP */ |
| 3336 1f02 4F5F subi r20,lo8(-(1)) |
| 3337 1f04 5F4F sbci r21,hi8(-(1)) |
| 3338 1f06 DA01 movw r26,r20 |
| 3339 /* #APP */ |
| 3340 1f08 0E94 0000 call __eeprom_read_byte_1F2021 |
| 3341 1f0c 202D mov r18,__tmp_reg__ |
| 3342 /* #NOAPP */ |
| 3343 1f0e 90E0 ldi r25,lo8(0) |
| 3344 1f10 982F mov r25,r24 |
| 3345 1f12 8827 clr r24 |
| 3346 1f14 820F add r24,r18 |
| 3347 1f16 911D adc r25,__zero_reg__ |
| 3348 1f18 9093 0000 sts (NeutralAccX)+1,r25 |
| 3349 1f1c 8093 0000 sts NeutralAccX,r24 |
| 3350 1f20 4F5F subi r20,lo8(-(1)) |
| 3351 1f22 5F4F sbci r21,hi8(-(1)) |
| 3352 1f24 DA01 movw r26,r20 |
| 3353 /* #APP */ |
| 3354 1f26 0E94 0000 call __eeprom_read_byte_1F2021 |
| 3355 1f2a 802D mov r24,__tmp_reg__ |
| 3356 /* #NOAPP */ |
| 3357 1f2c 4F5F subi r20,lo8(-(1)) |
| 3358 1f2e 5F4F sbci r21,hi8(-(1)) |
| 3359 1f30 DA01 movw r26,r20 |
| 3360 /* #APP */ |
| 3361 1f32 0E94 0000 call __eeprom_read_byte_1F2021 |
| 3362 1f36 202D mov r18,__tmp_reg__ |
| 3363 /* #NOAPP */ |
| 3364 1f38 90E0 ldi r25,lo8(0) |
| 3365 1f3a 982F mov r25,r24 |
| 3366 1f3c 8827 clr r24 |
| 3367 1f3e 820F add r24,r18 |
| 3368 1f40 911D adc r25,__zero_reg__ |
| 3369 1f42 9093 0000 sts (NeutralAccY)+1,r25 |
| 3370 1f46 8093 0000 sts NeutralAccY,r24 |
| 3371 1f4a 4F5F subi r20,lo8(-(1)) |
| 3372 1f4c 5F4F sbci r21,hi8(-(1)) |
| 3373 1f4e DA01 movw r26,r20 |
| 3374 /* #APP */ |
| 3375 1f50 0E94 0000 call __eeprom_read_byte_1F2021 |
| 3376 1f54 602D mov r22,__tmp_reg__ |
| 3377 /* #NOAPP */ |
| 3378 1f56 4F5F subi r20,lo8(-(1)) |
| 3379 1f58 5F4F sbci r21,hi8(-(1)) |
| 3380 1f5a DA01 movw r26,r20 |
| 3381 /* #APP */ |
| 3382 1f5c 0E94 0000 call __eeprom_read_byte_1F2021 |
| 3383 1f60 202D mov r18,__tmp_reg__ |
| 3384 /* #NOAPP */ |
| 3385 1f62 70E0 ldi r23,lo8(0) |
| 3386 1f64 762F mov r23,r22 |
| 3387 1f66 6627 clr r22 |
| 3388 1f68 620F add r22,r18 |
| 3389 1f6a 711D adc r23,__zero_reg__ |
| 3390 1f6c 8827 clr r24 |
| 3391 1f6e 77FD sbrc r23,7 |
| 3392 1f70 8095 com r24 |
| 3393 1f72 982F mov r25,r24 |
| 3394 1f74 0E94 0000 call __floatsisf |
| 3395 1f78 6093 0000 sts NeutralAccZ,r22 |
| 3396 1f7c 7093 0000 sts (NeutralAccZ)+1,r23 |
| 3397 1f80 8093 0000 sts (NeutralAccZ)+2,r24 |
| 3398 1f84 9093 0000 sts (NeutralAccZ)+3,r25 |
| 3399 1f88 00C0 rjmp .L614 |
| 3400 .L606: |
| 3401 1f8a 0E94 0000 call SucheLuftruckOffset |
| 3402 1f8e 00C0 rjmp .L604 |
| 3403 .L619: |
| 3404 1f90 9095 com r25 |
| 3405 1f92 8195 neg r24 |
| 3406 1f94 9F4F sbci r25,lo8(-1) |
| 3407 1f96 00C0 rjmp .L613 |
| 3408 .L618: |
| 3409 1f98 9095 com r25 |
| 3410 1f9a 8195 neg r24 |
| 3411 1f9c 9F4F sbci r25,lo8(-1) |
| 3412 1f9e 00C0 rjmp .L612 |
| 3413 .L614: |
| 3414 1fa0 1092 0000 sts (MesswertNick)+1,__zero_reg__ |
| 3415 1fa4 1092 0000 sts MesswertNick,__zero_reg__ |
| 3416 1fa8 1092 0000 sts (MesswertRoll)+1,__zero_reg__ |
| 3417 1fac 1092 0000 sts MesswertRoll,__zero_reg__ |
| 3418 1fb0 1092 0000 sts (MesswertGier)+1,__zero_reg__ |
| 3419 1fb4 1092 0000 sts MesswertGier,__zero_reg__ |
| 3420 1fb8 84E6 ldi r24,lo8(100) |
| 3421 1fba 90E0 ldi r25,hi8(100) |
| 3422 1fbc 0E94 0000 call Delay_ms_Mess |
| 3423 1fc0 6091 0000 lds r22,AdWertAccNick |
| 3424 1fc4 7091 0000 lds r23,(AdWertAccNick)+1 |
| 3425 1fc8 8827 clr r24 |
| 3426 1fca 77FD sbrc r23,7 |
| 3427 1fcc 8095 com r24 |
| 3428 1fce 982F mov r25,r24 |
| 3429 1fd0 26E0 ldi r18,lo8(6) |
| 3430 1fd2 30E0 ldi r19,hi8(6) |
| 3431 1fd4 40E0 ldi r20,hlo8(6) |
| 3432 1fd6 50E0 ldi r21,hhi8(6) |
| 3433 1fd8 0E94 0000 call __mulsi3 |
| 3434 1fdc 3B01 movw r6,r22 |
| 3435 1fde 4C01 movw r8,r24 |
| 3436 1fe0 7093 0000 sts (Mittelwert_AccNick)+1,r23 |
| 3437 1fe4 6093 0000 sts Mittelwert_AccNick,r22 |
| 3438 1fe8 6091 0000 lds r22,AdWertAccRoll |
| 3439 1fec 7091 0000 lds r23,(AdWertAccRoll)+1 |
| 3440 1ff0 8827 clr r24 |
| 3441 1ff2 77FD sbrc r23,7 |
| 3442 1ff4 8095 com r24 |
| 3443 1ff6 982F mov r25,r24 |
| 3444 1ff8 0E94 0000 call __mulsi3 |
| 3445 1ffc 5B01 movw r10,r22 |
| 3446 1ffe 6C01 movw r12,r24 |
| 3447 2000 7093 0000 sts (Mittelwert_AccRoll)+1,r23 |
| 3448 2004 6093 0000 sts Mittelwert_AccRoll,r22 |
| 3449 2008 E090 0000 lds r14,EE_Parameter+20 |
| 3450 200c FF24 clr r15 |
| 3451 200e 00E0 ldi r16,lo8(0) |
| 3452 2010 10E0 ldi r17,hi8(0) |
| 3453 2012 8824 clr r8 |
| 3454 2014 77FC sbrc r7,7 |
| 3455 2016 8094 com r8 |
| 3456 2018 982C mov r9,r8 |
| 3457 201a C401 movw r24,r8 |
| 3458 201c B301 movw r22,r6 |
| 3459 201e A801 movw r20,r16 |
| 3460 2020 9701 movw r18,r14 |
| 3461 2022 0E94 0000 call __mulsi3 |
| 3462 2026 3B01 movw r6,r22 |
| 3463 2028 4C01 movw r8,r24 |
| 3464 202a 6093 0000 sts IntegralNick,r22 |
| 3465 202e 7093 0000 sts (IntegralNick)+1,r23 |
| 3466 2032 8093 0000 sts (IntegralNick)+2,r24 |
| 3467 2036 9093 0000 sts (IntegralNick)+3,r25 |
| 3468 203a CC24 clr r12 |
| 3469 203c B7FC sbrc r11,7 |
| 3470 203e C094 com r12 |
| 3471 2040 DC2C mov r13,r12 |
| 3472 2042 C601 movw r24,r12 |
| 3473 2044 B501 movw r22,r10 |
| 3474 2046 0E94 0000 call __mulsi3 |
| 3475 204a 6093 0000 sts IntegralRoll,r22 |
| 3476 204e 7093 0000 sts (IntegralRoll)+1,r23 |
| 3477 2052 8093 0000 sts (IntegralRoll)+2,r24 |
| 3478 2056 9093 0000 sts (IntegralRoll)+3,r25 |
| 3479 205a 6092 0000 sts Mess_IntegralNick2,r6 |
| 3480 205e 7092 0000 sts (Mess_IntegralNick2)+1,r7 |
| 3481 2062 8092 0000 sts (Mess_IntegralNick2)+2,r8 |
| 3482 2066 9092 0000 sts (Mess_IntegralNick2)+3,r9 |
| 3483 206a 6093 0000 sts Mess_IntegralRoll2,r22 |
| 3484 206e 7093 0000 sts (Mess_IntegralRoll2)+1,r23 |
| 3485 2072 8093 0000 sts (Mess_IntegralRoll2)+2,r24 |
| 3486 2076 9093 0000 sts (Mess_IntegralRoll2)+3,r25 |
| 3487 207a 1092 0000 sts Mess_Integral_Gier,__zero_reg__ |
| 3488 207e 1092 0000 sts (Mess_Integral_Gier)+1,__zero_reg__ |
| 3489 2082 1092 0000 sts (Mess_Integral_Gier)+2,__zero_reg__ |
| 3490 2086 1092 0000 sts (Mess_Integral_Gier)+3,__zero_reg__ |
| 3491 208a 8091 0000 lds r24,Luftdruck |
| 3492 208e 9091 0000 lds r25,(Luftdruck)+1 |
| 3493 2092 A091 0000 lds r26,(Luftdruck)+2 |
| 3494 2096 B091 0000 lds r27,(Luftdruck)+3 |
| 3495 209a 9093 0000 sts (StartLuftdruck)+1,r25 |
| 3496 209e 8093 0000 sts StartLuftdruck,r24 |
| 3497 20a2 1092 0000 sts (HoeheD)+1,__zero_reg__ |
| 3498 20a6 1092 0000 sts HoeheD,__zero_reg__ |
| 3499 20aa 1092 0000 sts Mess_Integral_Hoch,__zero_reg__ |
| 3500 20ae 1092 0000 sts (Mess_Integral_Hoch)+1,__zero_reg__ |
| 3501 20b2 1092 0000 sts (Mess_Integral_Hoch)+2,__zero_reg__ |
| 3502 20b6 1092 0000 sts (Mess_Integral_Hoch)+3,__zero_reg__ |
| 3503 20ba 8091 0000 lds r24,KompassValue |
| 3504 20be 9091 0000 lds r25,(KompassValue)+1 |
| 3505 20c2 9093 0000 sts (KompassStartwert)+1,r25 |
| 3506 20c6 8093 0000 sts KompassStartwert,r24 |
| 3507 20ca 0E94 0000 call GPS_Neutral |
| 3508 20ce 82E3 ldi r24,lo8(50) |
| 3509 20d0 90E0 ldi r25,hi8(50) |
| 3510 20d2 9093 0000 sts (beeptime)+1,r25 |
| 3511 20d6 8093 0000 sts beeptime,r24 |
| 3512 20da 6091 0000 lds r22,EE_Parameter+45 |
| 3513 20de 70E0 ldi r23,lo8(0) |
| 3514 20e0 80E0 ldi r24,lo8(0) |
| 3515 20e2 90E0 ldi r25,hi8(0) |
| 3516 20e4 24EC ldi r18,lo8(2500) |
| 3517 20e6 39E0 ldi r19,hi8(2500) |
| 3518 20e8 40E0 ldi r20,hlo8(2500) |
| 3519 20ea 50E0 ldi r21,hhi8(2500) |
| 3520 20ec 0E94 0000 call __mulsi3 |
| 3521 20f0 6856 subi r22,lo8(-(15000)) |
| 3522 20f2 754C sbci r23,hi8(-(15000)) |
| 3523 20f4 8F4F sbci r24,hlo8(-(15000)) |
| 3524 20f6 9F4F sbci r25,hhi8(-(15000)) |
| 3525 20f8 6093 0000 sts Umschlag180Nick,r22 |
| 3526 20fc 7093 0000 sts (Umschlag180Nick)+1,r23 |
| 3527 2100 8093 0000 sts (Umschlag180Nick)+2,r24 |
| 3528 2104 9093 0000 sts (Umschlag180Nick)+3,r25 |
| 3529 2108 6091 0000 lds r22,EE_Parameter+46 |
| 3530 210c 70E0 ldi r23,lo8(0) |
| 3531 210e 80E0 ldi r24,lo8(0) |
| 3532 2110 90E0 ldi r25,hi8(0) |
| 3533 2112 0E94 0000 call __mulsi3 |
| 3534 2116 6856 subi r22,lo8(-(15000)) |
| 3535 2118 754C sbci r23,hi8(-(15000)) |
| 3536 211a 8F4F sbci r24,hlo8(-(15000)) |
| 3537 211c 9F4F sbci r25,hhi8(-(15000)) |
| 3538 211e 6093 0000 sts Umschlag180Roll,r22 |
| 3539 2122 7093 0000 sts (Umschlag180Roll)+1,r23 |
| 3540 2126 8093 0000 sts (Umschlag180Roll)+2,r24 |
| 3541 212a 9093 0000 sts (Umschlag180Roll)+3,r25 |
| 3542 212e 1092 0000 sts (ExternHoehenValue)+1,__zero_reg__ |
| 3543 2132 1092 0000 sts ExternHoehenValue,__zero_reg__ |
| 3544 2136 6091 0000 lds r22,KompassValue |
| 3545 213a 7091 0000 lds r23,(KompassValue)+1 |
| 3546 213e 8827 clr r24 |
| 3547 2140 77FD sbrc r23,7 |
| 3548 2142 8095 com r24 |
| 3549 2144 982F mov r25,r24 |
| 3550 2146 2091 0000 lds r18,GIER_GRAD_FAKTOR |
| 3551 214a 3091 0000 lds r19,(GIER_GRAD_FAKTOR)+1 |
| 3552 214e 4091 0000 lds r20,(GIER_GRAD_FAKTOR)+2 |
| 3553 2152 5091 0000 lds r21,(GIER_GRAD_FAKTOR)+3 |
| 3554 2156 0E94 0000 call __mulsi3 |
| 3555 215a 6093 0000 sts ErsatzKompass,r22 |
| 3556 215e 7093 0000 sts (ErsatzKompass)+1,r23 |
| 3557 2162 8093 0000 sts (ErsatzKompass)+2,r24 |
| 3558 2166 9093 0000 sts (ErsatzKompass)+3,r25 |
| 3559 216a 1092 0000 sts (GierGyroFehler)+1,__zero_reg__ |
| 3560 216e 1092 0000 sts GierGyroFehler,__zero_reg__ |
| 3561 2172 11E0 ldi r17,lo8(1) |
| 3562 2174 1093 0000 sts SendVersionToNavi,r17 |
| 3563 2178 0E94 0000 call LED_Init |
| 3564 217c 8091 0000 lds r24,MikroKopterFlags |
| 3565 2180 8460 ori r24,lo8(4) |
| 3566 2182 8093 0000 sts MikroKopterFlags,r24 |
| 3567 2186 8FEF ldi r24,lo8(-1) |
| 3568 2188 8093 0000 sts FromNaviCtrl_Value,r24 |
| 3569 218c 1092 0000 sts FromNaviCtrl_Value+1,__zero_reg__ |
| 3570 2190 80E2 ldi r24,lo8(32) |
| 3571 2192 8093 0000 sts FromNaviCtrl_Value+2,r24 |
| 3572 2196 E091 0000 lds r30,EE_Parameter+4 |
| 3573 219a F0E0 ldi r31,lo8(0) |
| 3574 219c EE0F lsl r30 |
| 3575 219e FF1F rol r31 |
| 3576 21a0 E050 subi r30,lo8(-(PPM_in)) |
| 3577 21a2 F040 sbci r31,hi8(-(PPM_in)) |
| 3578 21a4 8081 ld r24,Z |
| 3579 21a6 9181 ldd r25,Z+1 |
| 3580 21a8 8259 subi r24,lo8(-(110)) |
| 3581 21aa 9F4F sbci r25,hi8(-(110)) |
| 3582 21ac 9093 0000 sts (Poti1)+1,r25 |
| 3583 21b0 8093 0000 sts Poti1,r24 |
| 3584 21b4 E091 0000 lds r30,EE_Parameter+5 |
| 3585 21b8 F0E0 ldi r31,lo8(0) |
| 3586 21ba EE0F lsl r30 |
| 3587 21bc FF1F rol r31 |
| 3588 21be E050 subi r30,lo8(-(PPM_in)) |
| 3589 21c0 F040 sbci r31,hi8(-(PPM_in)) |
| 3590 21c2 8081 ld r24,Z |
| 3591 21c4 9181 ldd r25,Z+1 |
| 3592 21c6 8259 subi r24,lo8(-(110)) |
| 3593 21c8 9F4F sbci r25,hi8(-(110)) |
| 3594 21ca 9093 0000 sts (Poti2)+1,r25 |
| 3595 21ce 8093 0000 sts Poti2,r24 |
| 3596 21d2 E091 0000 lds r30,EE_Parameter+6 |
| 3597 21d6 F0E0 ldi r31,lo8(0) |
| 3598 21d8 EE0F lsl r30 |
| 3599 21da FF1F rol r31 |
| 3600 21dc E050 subi r30,lo8(-(PPM_in)) |
| 3601 21de F040 sbci r31,hi8(-(PPM_in)) |
| 3602 21e0 8081 ld r24,Z |
| 3603 21e2 9181 ldd r25,Z+1 |
| 3604 21e4 8259 subi r24,lo8(-(110)) |
| 3605 21e6 9F4F sbci r25,hi8(-(110)) |
| 3606 21e8 9093 0000 sts (Poti3)+1,r25 |
| 3607 21ec 8093 0000 sts Poti3,r24 |
| 3608 21f0 E091 0000 lds r30,EE_Parameter+7 |
| 3609 21f4 F0E0 ldi r31,lo8(0) |
| 3610 21f6 EE0F lsl r30 |
| 3611 21f8 FF1F rol r31 |
| 3612 21fa E050 subi r30,lo8(-(PPM_in)) |
| 3613 21fc F040 sbci r31,hi8(-(PPM_in)) |
| 3614 21fe 8081 ld r24,Z |
| 3615 2200 9181 ldd r25,Z+1 |
| 3616 2202 8259 subi r24,lo8(-(110)) |
| 3617 2204 9F4F sbci r25,hi8(-(110)) |
| 3618 2206 9093 0000 sts (Poti4)+1,r25 |
| 3619 220a 8093 0000 sts Poti4,r24 |
| 3620 220e 1093 0000 sts ServoActive,r17 |
| 3621 2212 84E6 ldi r24,lo8(100) |
| 3622 2214 8093 0000 sts SenderOkay,r24 |
| 3623 /* epilogue: frame size=0 */ |
| 3624 2218 DF91 pop r29 |
| 3625 221a CF91 pop r28 |
| 3626 221c 1F91 pop r17 |
| 3627 221e 0F91 pop r16 |
| 3628 2220 FF90 pop r15 |
| 3629 2222 EF90 pop r14 |
| 3630 2224 DF90 pop r13 |
| 3631 2226 CF90 pop r12 |
| 3632 2228 BF90 pop r11 |
| 3633 222a AF90 pop r10 |
| 3634 222c 9F90 pop r9 |
| 3635 222e 8F90 pop r8 |
| 3636 2230 7F90 pop r7 |
| 3637 2232 6F90 pop r6 |
| 3638 2234 0895 ret |
| 3639 /* epilogue end (size=15) */ |
| 3640 /* function SetNeutral size 646 (617) */ |
| 3642 .global Piep |
| 3644 Piep: |
| 3645 /* prologue: frame size=0 */ |
| 3646 2236 1F93 push r17 |
| 3647 /* prologue end (size=1) */ |
| 3648 2238 182F mov r17,r24 |
| 3649 223a 1150 subi r17,lo8(-(-1)) |
| 3650 223c 1F3F cpi r17,lo8(-1) |
| 3651 223e 01F0 breq .L625 |
| 3652 2240 8091 0000 lds r24,MotorenEin |
| 3653 2244 8823 tst r24 |
| 3654 2246 01F0 breq .L626 |
| 3655 2248 00C0 rjmp .L625 |
| 3656 .L624: |
| 3657 224a 8091 0000 lds r24,MotorenEin |
| 3658 224e 8823 tst r24 |
| 3659 2250 01F4 brne .L625 |
| 3660 .L626: |
| 3661 2252 84E6 ldi r24,lo8(100) |
| 3662 2254 90E0 ldi r25,hi8(100) |
| 3663 2256 9093 0000 sts (beeptime)+1,r25 |
| 3664 225a 8093 0000 sts beeptime,r24 |
| 3665 225e 8AEF ldi r24,lo8(250) |
| 3666 2260 90E0 ldi r25,hi8(250) |
| 3667 2262 0E94 0000 call Delay_ms |
| 3668 2266 1150 subi r17,1 |
| 3669 2268 00F4 brcc .L624 |
| 3670 .L625: |
| 3671 /* epilogue: frame size=0 */ |
| 3672 226a 1F91 pop r17 |
| 3673 226c 0895 ret |
| 3674 /* epilogue end (size=2) */ |
| 3675 /* function Piep size 29 (26) */ |
| 3677 .data |
| 3678 .LC0: |
| 3679 0000 4265 6769 .string "Beginner" |
| 3679 6E6E 6572 |
| 3679 00 |
| 3680 0009 00 .string "" |
| 3681 .text |
| 3682 .global DefaultKonstanten3 |
| 3684 DefaultKonstanten3: |
| 3685 /* prologue: frame size=0 */ |
| 3686 /* prologue end (size=0) */ |
| 3687 226e 88EE ldi r24,lo8(-24) |
| 3688 2270 8093 0000 sts EE_Parameter+8,r24 |
| 3689 2274 3EE1 ldi r19,lo8(30) |
| 3690 2276 3093 0000 sts EE_Parameter+9,r19 |
| 3691 227a 8BEF ldi r24,lo8(-5) |
| 3692 227c 8093 0000 sts EE_Parameter+11,r24 |
| 3693 2280 8AE0 ldi r24,lo8(10) |
| 3694 2282 8093 0000 sts EE_Parameter+12,r24 |
| 3695 2286 3093 0000 sts EE_Parameter+10,r19 |
| 3696 228a 3093 0000 sts EE_Parameter+14,r19 |
| 3697 228e 93E0 ldi r25,lo8(3) |
| 3698 2290 9093 0000 sts EE_Parameter+13,r25 |
| 3699 2294 58E0 ldi r21,lo8(8) |
| 3700 2296 5093 0000 sts EE_Parameter+15,r21 |
| 3701 229a 20E1 ldi r18,lo8(16) |
| 3702 229c 2093 0000 sts EE_Parameter+16,r18 |
| 3703 22a0 66E0 ldi r22,lo8(6) |
| 3704 22a2 6093 0000 sts EE_Parameter+17,r22 |
| 3705 22a6 5093 0000 sts EE_Parameter+18,r21 |
| 3706 22aa 86EE ldi r24,lo8(-26) |
| 3707 22ac 8093 0000 sts EE_Parameter+19,r24 |
| 3708 22b0 3093 0000 sts EE_Parameter+20,r19 |
| 3709 22b4 80E8 ldi r24,lo8(-128) |
| 3710 22b6 8093 0000 sts EE_Parameter+21,r24 |
| 3711 22ba 44E6 ldi r20,lo8(100) |
| 3712 22bc 4093 0000 sts EE_Parameter+22,r20 |
| 3713 22c0 88E7 ldi r24,lo8(120) |
| 3714 22c2 8093 0000 sts EE_Parameter+23,r24 |
| 3715 22c6 9093 0000 sts EE_Parameter+24,r25 |
| 3716 22ca 8EE5 ldi r24,lo8(94) |
| 3717 22cc 8093 0000 sts EE_Parameter+25,r24 |
| 3718 22d0 83E2 ldi r24,lo8(35) |
| 3719 22d2 8093 0000 sts EE_Parameter+26,r24 |
| 3720 22d6 84E1 ldi r24,lo8(20) |
| 3721 22d8 8093 0000 sts EE_Parameter+27,r24 |
| 3722 22dc 1092 0000 sts EE_Parameter+28,__zero_reg__ |
| 3723 22e0 2093 0000 sts EE_Parameter+29,r18 |
| 3724 22e4 1092 0000 sts EE_Parameter+30,__zero_reg__ |
| 3725 22e8 1092 0000 sts EE_Parameter+31,__zero_reg__ |
| 3726 22ec 1092 0000 sts EE_Parameter+32,__zero_reg__ |
| 3727 22f0 1092 0000 sts EE_Parameter+33,__zero_reg__ |
| 3728 22f4 1092 0000 sts EE_Parameter+50,__zero_reg__ |
| 3729 22f8 1092 0000 sts EE_Parameter+51,__zero_reg__ |
| 3730 22fc 1092 0000 sts EE_Parameter+52,__zero_reg__ |
| 3731 2300 1092 0000 sts EE_Parameter+53,__zero_reg__ |
| 3732 2304 4093 0000 sts EE_Parameter+34,r20 |
| 3733 2308 88E2 ldi r24,lo8(40) |
| 3734 230a 8093 0000 sts EE_Parameter+35,r24 |
| 3735 230e 1092 0000 sts EE_Parameter+76,__zero_reg__ |
| 3736 2312 92E3 ldi r25,lo8(50) |
| 3737 2314 9093 0000 sts EE_Parameter+36,r25 |
| 3738 2318 86E9 ldi r24,lo8(-106) |
| 3739 231a 8093 0000 sts EE_Parameter+37,r24 |
| 3740 231e 85E0 ldi r24,lo8(5) |
| 3741 2320 8093 0000 sts EE_Parameter+38,r24 |
| 3742 2324 9093 0000 sts EE_Parameter+39,r25 |
| 3743 2328 2AE5 ldi r18,lo8(90) |
| 3744 232a 2093 0000 sts EE_Parameter+40,r18 |
| 3745 232e 9093 0000 sts EE_Parameter+41,r25 |
| 3746 2332 1092 0000 sts EE_Parameter+75,__zero_reg__ |
| 3747 2336 2093 0000 sts EE_Parameter+42,r18 |
| 3748 233a 83E4 ldi r24,lo8(67) |
| 3749 233c 8093 0000 sts EE_Parameter+43,r24 |
| 3750 2340 86E4 ldi r24,lo8(70) |
| 3751 2342 8093 0000 sts EE_Parameter+44,r24 |
| 3752 2346 85E5 ldi r24,lo8(85) |
| 3753 2348 8093 0000 sts EE_Parameter+45,r24 |
| 3754 234c 8093 0000 sts EE_Parameter+46,r24 |
| 3755 2350 80E2 ldi r24,lo8(32) |
| 3756 2352 8093 0000 sts EE_Parameter+47,r24 |
| 3757 2356 8093 0000 sts EE_Parameter+48,r24 |
| 3758 235a 9093 0000 sts EE_Parameter+49,r25 |
| 3759 235e 8FE5 ldi r24,lo8(95) |
| 3760 2360 8093 0000 sts EE_Parameter+54,r24 |
| 3761 2364 83EF ldi r24,lo8(-13) |
| 3762 2366 8093 0000 sts EE_Parameter+56,r24 |
| 3763 236a 3093 0000 sts EE_Parameter+55,r19 |
| 3764 236e 3093 0000 sts EE_Parameter+57,r19 |
| 3765 2372 8DEF ldi r24,lo8(-3) |
| 3766 2374 8093 0000 sts EE_Parameter+58,r24 |
| 3767 2378 4093 0000 sts EE_Parameter+59,r20 |
| 3768 237c 2093 0000 sts EE_Parameter+60,r18 |
| 3769 2380 2093 0000 sts EE_Parameter+61,r18 |
| 3770 2384 2093 0000 sts EE_Parameter+62,r18 |
| 3771 2388 8BE4 ldi r24,lo8(75) |
| 3772 238a 8093 0000 sts EE_Parameter+63,r24 |
| 3773 238e 8093 0000 sts EE_Parameter+64,r24 |
| 3774 2392 8093 0000 sts EE_Parameter+65,r24 |
| 3775 2396 1092 0000 sts EE_Parameter+66,__zero_reg__ |
| 3776 239a 6093 0000 sts EE_Parameter+67,r22 |
| 3777 239e 5093 0000 sts EE_Parameter+68,r21 |
| 3778 23a2 2093 0000 sts EE_Parameter+69,r18 |
| 3779 23a6 3093 0000 sts EE_Parameter+70,r19 |
| 3780 23aa 4093 0000 sts EE_Parameter+71,r20 |
| 3781 23ae 4093 0000 sts EE_Parameter+72,r20 |
| 3782 23b2 84E0 ldi r24,lo8(4) |
| 3783 23b4 8093 0000 sts EE_Parameter+73,r24 |
| 3784 23b8 A0E0 ldi r26,lo8(EE_Parameter+81) |
| 3785 23ba B0E0 ldi r27,hi8(EE_Parameter+81) |
| 3786 23bc E0E0 ldi r30,lo8(.LC0) |
| 3787 23be F0E0 ldi r31,hi8(.LC0) |
| 3788 23c0 8CE0 ldi r24,lo8(12) |
| 3789 .L628: |
| 3790 23c2 0190 ld r0,Z+ |
| 3791 23c4 0D92 st X+,r0 |
| 3792 23c6 8150 subi r24,lo8(-(-1)) |
| 3793 23c8 01F4 brne .L628 |
| 3794 /* epilogue: frame size=0 */ |
| 3795 23ca 0895 ret |
| 3796 /* epilogue end (size=1) */ |
| 3797 /* function DefaultKonstanten3 size 176 (175) */ |
| 3799 .data |
| 3800 .LC1: |
| 3801 000a 4E6F 726D .string "Normal" |
| 3801 616C 00 |
| 3802 0011 00 .string "" |
| 3803 .text |
| 3804 .global DefaultKonstanten2 |
| 3806 DefaultKonstanten2: |
| 3807 /* prologue: frame size=0 */ |
| 3808 /* prologue end (size=0) */ |
| 3809 23cc 88E6 ldi r24,lo8(104) |
| 3810 23ce 8093 0000 sts EE_Parameter+8,r24 |
| 3811 23d2 5EE1 ldi r21,lo8(30) |
| 3812 23d4 5093 0000 sts EE_Parameter+9,r21 |
| 3813 23d8 8BEF ldi r24,lo8(-5) |
| 3814 23da 8093 0000 sts EE_Parameter+11,r24 |
| 3815 23de 8AE0 ldi r24,lo8(10) |
| 3816 23e0 8093 0000 sts EE_Parameter+12,r24 |
| 3817 23e4 5093 0000 sts EE_Parameter+10,r21 |
| 3818 23e8 5093 0000 sts EE_Parameter+14,r21 |
| 3819 23ec 93E0 ldi r25,lo8(3) |
| 3820 23ee 9093 0000 sts EE_Parameter+13,r25 |
| 3821 23f2 8CE0 ldi r24,lo8(12) |
| 3822 23f4 8093 0000 sts EE_Parameter+15,r24 |
| 3823 23f8 80E1 ldi r24,lo8(16) |
| 3824 23fa 8093 0000 sts EE_Parameter+16,r24 |
| 3825 23fe 76E0 ldi r23,lo8(6) |
| 3826 2400 7093 0000 sts EE_Parameter+17,r23 |
| 3827 2404 68E0 ldi r22,lo8(8) |
| 3828 2406 6093 0000 sts EE_Parameter+18,r22 |
| 3829 240a 86EE ldi r24,lo8(-26) |
| 3830 240c 8093 0000 sts EE_Parameter+19,r24 |
| 3831 2410 5093 0000 sts EE_Parameter+20,r21 |
| 3832 2414 80E8 ldi r24,lo8(-128) |
| 3833 2416 8093 0000 sts EE_Parameter+21,r24 |
| 3834 241a 80E5 ldi r24,lo8(80) |
| 3835 241c 8093 0000 sts EE_Parameter+22,r24 |
| 3836 2420 88E7 ldi r24,lo8(120) |
| 3837 2422 8093 0000 sts EE_Parameter+23,r24 |
| 3838 2426 9093 0000 sts EE_Parameter+24,r25 |
| 3839 242a 8EE5 ldi r24,lo8(94) |
| 3840 242c 8093 0000 sts EE_Parameter+25,r24 |
| 3841 2430 83E2 ldi r24,lo8(35) |
| 3842 2432 8093 0000 sts EE_Parameter+26,r24 |
| 3843 2436 5093 0000 sts EE_Parameter+27,r21 |
| 3844 243a 1092 0000 sts EE_Parameter+28,__zero_reg__ |
| 3845 243e 30E2 ldi r19,lo8(32) |
| 3846 2440 3093 0000 sts EE_Parameter+29,r19 |
| 3847 2444 1092 0000 sts EE_Parameter+30,__zero_reg__ |
| 3848 2448 1092 0000 sts EE_Parameter+31,__zero_reg__ |
| 3849 244c 1092 0000 sts EE_Parameter+32,__zero_reg__ |
| 3850 2450 1092 0000 sts EE_Parameter+33,__zero_reg__ |
| 3851 2454 1092 0000 sts EE_Parameter+50,__zero_reg__ |
| 3852 2458 1092 0000 sts EE_Parameter+51,__zero_reg__ |
| 3853 245c 1092 0000 sts EE_Parameter+52,__zero_reg__ |
| 3854 2460 1092 0000 sts EE_Parameter+53,__zero_reg__ |
| 3855 2464 44E6 ldi r20,lo8(100) |
| 3856 2466 4093 0000 sts EE_Parameter+34,r20 |
| 3857 246a 88E2 ldi r24,lo8(40) |
| 3858 246c 8093 0000 sts EE_Parameter+35,r24 |
| 3859 2470 1092 0000 sts EE_Parameter+76,__zero_reg__ |
| 3860 2474 92E3 ldi r25,lo8(50) |
| 3861 2476 9093 0000 sts EE_Parameter+36,r25 |
| 3862 247a 86E9 ldi r24,lo8(-106) |
| 3863 247c 8093 0000 sts EE_Parameter+37,r24 |
| 3864 2480 85E0 ldi r24,lo8(5) |
| 3865 2482 8093 0000 sts EE_Parameter+38,r24 |
| 3866 2486 9093 0000 sts EE_Parameter+39,r25 |
| 3867 248a 2AE5 ldi r18,lo8(90) |
| 3868 248c 2093 0000 sts EE_Parameter+40,r18 |
| 3869 2490 9093 0000 sts EE_Parameter+41,r25 |
| 3870 2494 1092 0000 sts EE_Parameter+75,__zero_reg__ |
| 3871 2498 2093 0000 sts EE_Parameter+42,r18 |
| 3872 249c 83E4 ldi r24,lo8(67) |
| 3873 249e 8093 0000 sts EE_Parameter+43,r24 |
| 3874 24a2 8CE3 ldi r24,lo8(60) |
| 3875 24a4 8093 0000 sts EE_Parameter+44,r24 |
| 3876 24a8 85E5 ldi r24,lo8(85) |
| 3877 24aa 8093 0000 sts EE_Parameter+45,r24 |
| 3878 24ae 8093 0000 sts EE_Parameter+46,r24 |
| 3879 24b2 3093 0000 sts EE_Parameter+47,r19 |
| 3880 24b6 3093 0000 sts EE_Parameter+48,r19 |
| 3881 24ba 9BE4 ldi r25,lo8(75) |
| 3882 24bc 9093 0000 sts EE_Parameter+49,r25 |
| 3883 24c0 8FE5 ldi r24,lo8(95) |
| 3884 24c2 8093 0000 sts EE_Parameter+54,r24 |
| 3885 24c6 83EF ldi r24,lo8(-13) |
| 3886 24c8 8093 0000 sts EE_Parameter+56,r24 |
| 3887 24cc 84E1 ldi r24,lo8(20) |
| 3888 24ce 8093 0000 sts EE_Parameter+55,r24 |
| 3889 24d2 8093 0000 sts EE_Parameter+57,r24 |
| 3890 24d6 8DEF ldi r24,lo8(-3) |
| 3891 24d8 8093 0000 sts EE_Parameter+58,r24 |
| 3892 24dc 4093 0000 sts EE_Parameter+59,r20 |
| 3893 24e0 2093 0000 sts EE_Parameter+60,r18 |
| 3894 24e4 2093 0000 sts EE_Parameter+61,r18 |
| 3895 24e8 2093 0000 sts EE_Parameter+62,r18 |
| 3896 24ec 9093 0000 sts EE_Parameter+63,r25 |
| 3897 24f0 9093 0000 sts EE_Parameter+64,r25 |
| 3898 24f4 9093 0000 sts EE_Parameter+65,r25 |
| 3899 24f8 1092 0000 sts EE_Parameter+66,__zero_reg__ |
| 3900 24fc 7093 0000 sts EE_Parameter+67,r23 |
| 3901 2500 6093 0000 sts EE_Parameter+68,r22 |
| 3902 2504 2093 0000 sts EE_Parameter+69,r18 |
| 3903 2508 5093 0000 sts EE_Parameter+70,r21 |
| 3904 250c 4093 0000 sts EE_Parameter+71,r20 |
| 3905 2510 4093 0000 sts EE_Parameter+72,r20 |
| 3906 2514 84E0 ldi r24,lo8(4) |
| 3907 2516 8093 0000 sts EE_Parameter+73,r24 |
| 3908 251a A0E0 ldi r26,lo8(EE_Parameter+81) |
| 3909 251c B0E0 ldi r27,hi8(EE_Parameter+81) |
| 3910 251e E0E0 ldi r30,lo8(.LC1) |
| 3911 2520 F0E0 ldi r31,hi8(.LC1) |
| 3912 2522 8CE0 ldi r24,lo8(12) |
| 3913 .L633: |
| 3914 2524 0190 ld r0,Z+ |
| 3915 2526 0D92 st X+,r0 |
| 3916 2528 8150 subi r24,lo8(-(-1)) |
| 3917 252a 01F4 brne .L633 |
| 3918 /* epilogue: frame size=0 */ |
| 3919 252c 0895 ret |
| 3920 /* epilogue end (size=1) */ |
| 3921 /* function DefaultKonstanten2 size 178 (177) */ |
| 3923 .data |
| 3924 .LC2: |
| 3925 0012 5370 6F72 .string "Sport" |
| 3925 7400 |
| 3926 0018 00 .string "" |
| 3927 .text |
| 3928 .global DefaultKonstanten1 |
| 3930 DefaultKonstanten1: |
| 3931 /* prologue: frame size=0 */ |
| 3932 /* prologue end (size=0) */ |
| 3933 252e 88E6 ldi r24,lo8(104) |
| 3934 2530 8093 0000 sts EE_Parameter+8,r24 |
| 3935 2534 3EE1 ldi r19,lo8(30) |
| 3936 2536 3093 0000 sts EE_Parameter+9,r19 |
| 3937 253a 8BEF ldi r24,lo8(-5) |
| 3938 253c 8093 0000 sts EE_Parameter+11,r24 |
| 3939 2540 8AE0 ldi r24,lo8(10) |
| 3940 2542 8093 0000 sts EE_Parameter+12,r24 |
| 3941 2546 3093 0000 sts EE_Parameter+10,r19 |
| 3942 254a 3093 0000 sts EE_Parameter+14,r19 |
| 3943 254e E4E0 ldi r30,lo8(4) |
| 3944 2550 E093 0000 sts EE_Parameter+13,r30 |
| 3945 2554 5FE0 ldi r21,lo8(15) |
| 3946 2556 5093 0000 sts EE_Parameter+15,r21 |
| 3947 255a 3093 0000 sts EE_Parameter+16,r19 |
| 3948 255e 8CE0 ldi r24,lo8(12) |
| 3949 2560 8093 0000 sts EE_Parameter+17,r24 |
| 3950 2564 78E0 ldi r23,lo8(8) |
| 3951 2566 7093 0000 sts EE_Parameter+18,r23 |
| 3952 256a 86EE ldi r24,lo8(-26) |
| 3953 256c 8093 0000 sts EE_Parameter+19,r24 |
| 3954 2570 3093 0000 sts EE_Parameter+20,r19 |
| 3955 2574 80E8 ldi r24,lo8(-128) |
| 3956 2576 8093 0000 sts EE_Parameter+21,r24 |
| 3957 257a 80E5 ldi r24,lo8(80) |
| 3958 257c 8093 0000 sts EE_Parameter+22,r24 |
| 3959 2580 26E9 ldi r18,lo8(-106) |
| 3960 2582 2093 0000 sts EE_Parameter+23,r18 |
| 3961 2586 83E0 ldi r24,lo8(3) |
| 3962 2588 8093 0000 sts EE_Parameter+24,r24 |
| 3963 258c 8EE5 ldi r24,lo8(94) |
| 3964 258e 8093 0000 sts EE_Parameter+25,r24 |
| 3965 2592 83E2 ldi r24,lo8(35) |
| 3966 2594 8093 0000 sts EE_Parameter+26,r24 |
| 3967 2598 3093 0000 sts EE_Parameter+27,r19 |
| 3968 259c 1092 0000 sts EE_Parameter+28,__zero_reg__ |
| 3969 25a0 60E2 ldi r22,lo8(32) |
| 3970 25a2 6093 0000 sts EE_Parameter+29,r22 |
| 3971 25a6 1092 0000 sts EE_Parameter+30,__zero_reg__ |
| 3972 25aa 1092 0000 sts EE_Parameter+31,__zero_reg__ |
| 3973 25ae 1092 0000 sts EE_Parameter+32,__zero_reg__ |
| 3974 25b2 1092 0000 sts EE_Parameter+33,__zero_reg__ |
| 3975 25b6 1092 0000 sts EE_Parameter+50,__zero_reg__ |
| 3976 25ba 1092 0000 sts EE_Parameter+51,__zero_reg__ |
| 3977 25be 1092 0000 sts EE_Parameter+52,__zero_reg__ |
| 3978 25c2 1092 0000 sts EE_Parameter+53,__zero_reg__ |
| 3979 25c6 44E6 ldi r20,lo8(100) |
| 3980 25c8 4093 0000 sts EE_Parameter+34,r20 |
| 3981 25cc 88E2 ldi r24,lo8(40) |
| 3982 25ce 8093 0000 sts EE_Parameter+35,r24 |
| 3983 25d2 1092 0000 sts EE_Parameter+76,__zero_reg__ |
| 3984 25d6 92E3 ldi r25,lo8(50) |
| 3985 25d8 9093 0000 sts EE_Parameter+36,r25 |
| 3986 25dc 2093 0000 sts EE_Parameter+37,r18 |
| 3987 25e0 85E0 ldi r24,lo8(5) |
| 3988 25e2 8093 0000 sts EE_Parameter+38,r24 |
| 3989 25e6 9093 0000 sts EE_Parameter+39,r25 |
| 3990 25ea 2AE5 ldi r18,lo8(90) |
| 3991 25ec 2093 0000 sts EE_Parameter+40,r18 |
| 3992 25f0 9093 0000 sts EE_Parameter+41,r25 |
| 3993 25f4 1092 0000 sts EE_Parameter+75,__zero_reg__ |
| 3994 25f8 2093 0000 sts EE_Parameter+42,r18 |
| 3995 25fc 83E4 ldi r24,lo8(67) |
| 3996 25fe 8093 0000 sts EE_Parameter+43,r24 |
| 3997 2602 1092 0000 sts EE_Parameter+44,__zero_reg__ |
| 3998 2606 85E5 ldi r24,lo8(85) |
| 3999 2608 8093 0000 sts EE_Parameter+45,r24 |
| 4000 260c 8093 0000 sts EE_Parameter+46,r24 |
| 4001 2610 80E1 ldi r24,lo8(16) |
| 4002 2612 8093 0000 sts EE_Parameter+47,r24 |
| 4003 2616 6093 0000 sts EE_Parameter+48,r22 |
| 4004 261a 4093 0000 sts EE_Parameter+49,r20 |
| 4005 261e 8FE5 ldi r24,lo8(95) |
| 4006 2620 8093 0000 sts EE_Parameter+54,r24 |
| 4007 2624 83EF ldi r24,lo8(-13) |
| 4008 2626 8093 0000 sts EE_Parameter+56,r24 |
| 4009 262a 5093 0000 sts EE_Parameter+55,r21 |
| 4010 262e 5093 0000 sts EE_Parameter+57,r21 |
| 4011 2632 8DEF ldi r24,lo8(-3) |
| 4012 2634 8093 0000 sts EE_Parameter+58,r24 |
| 4013 2638 4093 0000 sts EE_Parameter+59,r20 |
| 4014 263c 2093 0000 sts EE_Parameter+60,r18 |
| 4015 2640 2093 0000 sts EE_Parameter+61,r18 |
| 4016 2644 2093 0000 sts EE_Parameter+62,r18 |
| 4017 2648 8BE4 ldi r24,lo8(75) |
| 4018 264a 8093 0000 sts EE_Parameter+63,r24 |
| 4019 264e 8093 0000 sts EE_Parameter+64,r24 |
| 4020 2652 8093 0000 sts EE_Parameter+65,r24 |
| 4021 2656 1092 0000 sts EE_Parameter+66,__zero_reg__ |
| 4022 265a 86E0 ldi r24,lo8(6) |
| 4023 265c 8093 0000 sts EE_Parameter+67,r24 |
| 4024 2660 7093 0000 sts EE_Parameter+68,r23 |
| 4025 2664 2093 0000 sts EE_Parameter+69,r18 |
| 4026 2668 3093 0000 sts EE_Parameter+70,r19 |
| 4027 266c 4093 0000 sts EE_Parameter+71,r20 |
| 4028 2670 4093 0000 sts EE_Parameter+72,r20 |
| 4029 2674 E093 0000 sts EE_Parameter+73,r30 |
| 4030 2678 A0E0 ldi r26,lo8(EE_Parameter+81) |
| 4031 267a B0E0 ldi r27,hi8(EE_Parameter+81) |
| 4032 267c E0E0 ldi r30,lo8(.LC2) |
| 4033 267e F0E0 ldi r31,hi8(.LC2) |
| 4034 2680 8CE0 ldi r24,lo8(12) |
| 4035 .L638: |
| 4036 2682 0190 ld r0,Z+ |
| 4037 2684 0D92 st X+,r0 |
| 4038 2686 8150 subi r24,lo8(-(-1)) |
| 4039 2688 01F4 brne .L638 |
| 4040 /* epilogue: frame size=0 */ |
| 4041 268a 0895 ret |
| 4042 /* epilogue end (size=1) */ |
| 4043 /* function DefaultKonstanten1 size 176 (175) */ |
| 4045 .global MotorRegler |
| 4047 MotorRegler: |
| 4048 /* prologue: frame size=46 */ |
| 4049 268c 2F92 push r2 |
| 4050 268e 3F92 push r3 |
| 4051 2690 4F92 push r4 |
| 4052 2692 5F92 push r5 |
| 4053 2694 6F92 push r6 |
| 4054 2696 7F92 push r7 |
| 4055 2698 8F92 push r8 |
| 4056 269a 9F92 push r9 |
| 4057 269c AF92 push r10 |
| 4058 269e BF92 push r11 |
| 4059 26a0 CF92 push r12 |
| 4060 26a2 DF92 push r13 |
| 4061 26a4 EF92 push r14 |
| 4062 26a6 FF92 push r15 |
| 4063 26a8 0F93 push r16 |
| 4064 26aa 1F93 push r17 |
| 4065 26ac CF93 push r28 |
| 4066 26ae DF93 push r29 |
| 4067 26b0 CDB7 in r28,__SP_L__ |
| 4068 26b2 DEB7 in r29,__SP_H__ |
| 4069 26b4 AE97 sbiw r28,46 |
| 4070 26b6 0FB6 in __tmp_reg__,__SREG__ |
| 4071 26b8 F894 cli |
| 4072 26ba DEBF out __SP_H__,r29 |
| 4073 26bc 0FBE out __SREG__,__tmp_reg__ |
| 4074 26be CDBF out __SP_L__,r28 |
| 4075 /* prologue end (size=26) */ |
| 4076 26c0 0E94 0000 call Mittelwert |
| 4077 26c4 4091 0000 lds r20,PlatinenVersion |
| 4078 26c8 4C30 cpi r20,lo8(12) |
| 4079 26ca 00F0 brlo .+2 |
| 4080 26cc 00C0 rjmp .L643 |
| 4081 26ce 299A sbi 37-0x20,1 |
| 4082 .L645: |
| 4083 26d0 2091 0000 lds r18,StickGas |
| 4084 26d4 3091 0000 lds r19,(StickGas)+1 |
| 4085 26d8 8091 0000 lds r24,MIN_GAS |
| 4086 26dc 682F mov r22,r24 |
| 4087 26de 70E0 ldi r23,lo8(0) |
| 4088 26e0 665F subi r22,lo8(-(10)) |
| 4089 26e2 7F4F sbci r23,hi8(-(10)) |
| 4090 26e4 798B std Y+17,r23 |
| 4091 26e6 688B std Y+16,r22 |
| 4092 26e8 6217 cp r22,r18 |
| 4093 26ea 7307 cpc r23,r19 |
| 4094 26ec 04F4 brge .L646 |
| 4095 26ee 398B std Y+17,r19 |
| 4096 26f0 288B std Y+16,r18 |
| 4097 .L646: |
| 4098 26f2 8091 0000 lds r24,SenderOkay |
| 4099 26f6 8436 cpi r24,lo8(100) |
| 4100 26f8 00F0 brlo .+2 |
| 4101 26fa 00C0 rjmp .L647 |
| 4102 26fc 8091 0000 lds r24,PcZugriff |
| 4103 2700 8823 tst r24 |
| 4104 2702 01F4 brne .L649 |
| 4105 2704 8091 0000 lds r24,BeepMuster |
| 4106 2708 9091 0000 lds r25,(BeepMuster)+1 |
| 4107 270c 8F5F subi r24,lo8(-1) |
| 4108 270e 9F4F sbci r25,hi8(-1) |
| 4109 2710 01F4 brne .+4 |
| 4110 2712 0C94 0000 jmp .L1055 |
| 4111 .L649: |
| 4112 2716 8091 0000 lds r24,RcLostTimer.3074 |
| 4113 271a 9091 0000 lds r25,(RcLostTimer.3074)+1 |
| 4114 271e 0097 sbiw r24,0 |
| 4115 2720 01F4 brne .+2 |
| 4116 2722 00C0 rjmp .L652 |
| 4117 2724 0197 sbiw r24,1 |
| 4118 2726 9093 0000 sts (RcLostTimer.3074)+1,r25 |
| 4119 272a 8093 0000 sts RcLostTimer.3074,r24 |
| 4120 272e 4A30 cpi r20,lo8(10) |
| 4121 2730 01F4 brne .+2 |
| 4122 2732 00C0 rjmp .L655 |
| 4123 .L1094: |
| 4124 2734 4431 cpi r20,lo8(20) |
| 4125 2736 01F4 brne .+2 |
| 4126 2738 00C0 rjmp .L655 |
| 4127 273a 2898 cbi 37-0x20,0 |
| 4128 .L658: |
| 4129 273c 8091 0000 lds r24,modell_fliegt |
| 4130 2740 9091 0000 lds r25,(modell_fliegt)+1 |
| 4131 2744 895E subi r24,lo8(1001) |
| 4132 2746 9340 sbci r25,hi8(1001) |
| 4133 2748 00F4 brsh .+4 |
| 4134 274a 0C94 0000 jmp .L659 |
| 4135 274e 8091 0000 lds r24,EE_Parameter+26 |
| 4136 2752 E82F mov r30,r24 |
| 4137 2754 F0E0 ldi r31,lo8(0) |
| 4138 2756 F98B std Y+17,r31 |
| 4139 2758 E88B std Y+16,r30 |
| 4140 275a F1E0 ldi r31,lo8(1) |
| 4141 275c F093 0000 sts Notlandung,r31 |
| 4142 2760 A091 0000 lds r26,EE_Parameter |
| 4143 2764 B0E0 ldi r27,lo8(0) |
| 4144 2766 AA0F lsl r26 |
| 4145 2768 BB1F rol r27 |
| 4146 276a FD01 movw r30,r26 |
| 4147 276c E050 subi r30,lo8(-(PPM_diff)) |
| 4148 276e F040 sbci r31,hi8(-(PPM_diff)) |
| 4149 2770 1182 std Z+1,__zero_reg__ |
| 4150 2772 1082 st Z,__zero_reg__ |
| 4151 2774 E091 0000 lds r30,EE_Parameter+1 |
| 4152 2778 2E2F mov r18,r30 |
| 4153 277a 30E0 ldi r19,lo8(0) |
| 4154 277c 220F lsl r18 |
| 4155 277e 331F rol r19 |
| 4156 2780 C901 movw r24,r18 |
| 4157 2782 8050 subi r24,lo8(-(PPM_diff)) |
| 4158 2784 9040 sbci r25,hi8(-(PPM_diff)) |
| 4159 2786 FC01 movw r30,r24 |
| 4160 2788 1182 std Z+1,__zero_reg__ |
| 4161 278a 1082 st Z,__zero_reg__ |
| 4162 278c A050 subi r26,lo8(-(PPM_in)) |
| 4163 278e B040 sbci r27,hi8(-(PPM_in)) |
| 4164 2790 1196 adiw r26,1 |
| 4165 2792 1C92 st X,__zero_reg__ |
| 4166 2794 1E92 st -X,__zero_reg__ |
| 4167 2796 2050 subi r18,lo8(-(PPM_in)) |
| 4168 2798 3040 sbci r19,hi8(-(PPM_in)) |
| 4169 279a D901 movw r26,r18 |
| 4170 279c 1196 adiw r26,1 |
| 4171 279e 1C92 st X,__zero_reg__ |
| 4172 27a0 1E92 st -X,__zero_reg__ |
| 4173 27a2 E091 0000 lds r30,EE_Parameter+3 |
| 4174 27a6 F0E0 ldi r31,lo8(0) |
| 4175 27a8 EE0F lsl r30 |
| 4176 27aa FF1F rol r31 |
| 4177 27ac E050 subi r30,lo8(-(PPM_in)) |
| 4178 27ae F040 sbci r31,hi8(-(PPM_in)) |
| 4179 27b0 1182 std Z+1,__zero_reg__ |
| 4180 27b2 1082 st Z,__zero_reg__ |
| 4181 .L661: |
| 4182 27b4 8091 0000 lds r24,NewPpmData |
| 4183 27b8 8150 subi r24,lo8(-(-1)) |
| 4184 27ba 8093 0000 sts NewPpmData,r24 |
| 4185 27be 8091 0000 lds r24,NewPpmData |
| 4186 27c2 8F3F cpi r24,lo8(-1) |
| 4187 27c4 01F4 brne .+2 |
| 4188 27c6 00C0 rjmp .L725 |
| 4189 27c8 B091 0000 lds r27,Notlandung |
| 4190 27cc BFA3 std Y+39,r27 |
| 4191 27ce BB23 tst r27 |
| 4192 27d0 01F0 breq .+2 |
| 4193 27d2 00C0 rjmp .L725 |
| 4194 27d4 B091 0000 lds r27,EE_Parameter+8 |
| 4195 .L727: |
| 4196 27d8 2091 0000 lds r18,Looping_Roll |
| 4197 27dc 2223 tst r18 |
| 4198 27de 01F4 brne .+4 |
| 4199 27e0 0C94 0000 jmp .L1056 |
| 4200 .L791: |
| 4201 27e4 8091 0000 lds r24,EE_Parameter+39 |
| 4202 27e8 90E0 ldi r25,lo8(0) |
| 4203 27ea 6889 ldd r22,Y+16 |
| 4204 27ec 7989 ldd r23,Y+17 |
| 4205 27ee 8617 cp r24,r22 |
| 4206 27f0 9707 cpc r25,r23 |
| 4207 27f2 04F4 brge .L794 |
| 4208 27f4 998B std Y+17,r25 |
| 4209 27f6 888B std Y+16,r24 |
| 4210 .L794: |
| 4211 27f8 71E0 ldi r23,lo8(1) |
| 4212 27fa 7093 0000 sts TrichterFlug,r23 |
| 4213 27fe 8B2F mov r24,r27 |
| 4214 2800 90E0 ldi r25,lo8(0) |
| 4215 2802 9B87 std Y+11,r25 |
| 4216 2804 8A87 std Y+10,r24 |
| 4217 .L793: |
| 4218 2806 9FA1 ldd r25,Y+39 |
| 4219 2808 9923 tst r25 |
| 4220 280a 01F0 breq .L795 |
| 4221 280c 1092 0000 sts (StickGier)+1,__zero_reg__ |
| 4222 2810 1092 0000 sts StickGier,__zero_reg__ |
| 4223 2814 1092 0000 sts (StickNick)+1,__zero_reg__ |
| 4224 2818 1092 0000 sts StickNick,__zero_reg__ |
| 4225 281c 1092 0000 sts (StickRoll)+1,__zero_reg__ |
| 4226 2820 1092 0000 sts StickRoll,__zero_reg__ |
| 4227 2824 8AE5 ldi r24,lo8(90) |
| 4228 2826 8093 0000 sts GyroFaktor,r24 |
| 4229 282a A8E7 ldi r26,lo8(120) |
| 4230 282c A093 0000 sts IntegralFaktor,r26 |
| 4231 2830 1092 0000 sts Looping_Roll,__zero_reg__ |
| 4232 2834 1092 0000 sts Looping_Nick,__zero_reg__ |
| 4233 .L795: |
| 4234 2838 2091 0000 lds r18,IntegralNick |
| 4235 283c 3091 0000 lds r19,(IntegralNick)+1 |
| 4236 2840 4091 0000 lds r20,(IntegralNick)+2 |
| 4237 2844 5091 0000 lds r21,(IntegralNick)+3 |
| 4238 2848 2983 std Y+1,r18 |
| 4239 284a 3A83 std Y+2,r19 |
| 4240 284c 4B83 std Y+3,r20 |
| 4241 284e 5C83 std Y+4,r21 |
| 4242 2850 4091 0000 lds r20,MittelIntegralNick |
| 4243 2854 5091 0000 lds r21,(MittelIntegralNick)+1 |
| 4244 2858 6091 0000 lds r22,(MittelIntegralNick)+2 |
| 4245 285c 7091 0000 lds r23,(MittelIntegralNick)+3 |
| 4246 2860 48A7 std Y+40,r20 |
| 4247 2862 59A7 std Y+41,r21 |
| 4248 2864 6AA7 std Y+42,r22 |
| 4249 2866 7BA7 std Y+43,r23 |
| 4250 2868 8981 ldd r24,Y+1 |
| 4251 286a 9A81 ldd r25,Y+2 |
| 4252 286c AB81 ldd r26,Y+3 |
| 4253 286e BC81 ldd r27,Y+4 |
| 4254 2870 480F add r20,r24 |
| 4255 2872 591F adc r21,r25 |
| 4256 2874 6A1F adc r22,r26 |
| 4257 2876 7B1F adc r23,r27 |
| 4258 2878 4093 0000 sts MittelIntegralNick,r20 |
| 4259 287c 5093 0000 sts (MittelIntegralNick)+1,r21 |
| 4260 2880 6093 0000 sts (MittelIntegralNick)+2,r22 |
| 4261 2884 7093 0000 sts (MittelIntegralNick)+3,r23 |
| 4262 2888 2091 0000 lds r18,IntegralRoll |
| 4263 288c 3091 0000 lds r19,(IntegralRoll)+1 |
| 4264 2890 4091 0000 lds r20,(IntegralRoll)+2 |
| 4265 2894 5091 0000 lds r21,(IntegralRoll)+3 |
| 4266 2898 2D83 std Y+5,r18 |
| 4267 289a 3E83 std Y+6,r19 |
| 4268 289c 4F83 std Y+7,r20 |
| 4269 289e 5887 std Y+8,r21 |
| 4270 28a0 2090 0000 lds r2,MittelIntegralRoll |
| 4271 28a4 3090 0000 lds r3,(MittelIntegralRoll)+1 |
| 4272 28a8 4090 0000 lds r4,(MittelIntegralRoll)+2 |
| 4273 28ac 5090 0000 lds r5,(MittelIntegralRoll)+3 |
| 4274 28b0 220E add r2,r18 |
| 4275 28b2 331E adc r3,r19 |
| 4276 28b4 441E adc r4,r20 |
| 4277 28b6 551E adc r5,r21 |
| 4278 28b8 2092 0000 sts MittelIntegralRoll,r2 |
| 4279 28bc 3092 0000 sts (MittelIntegralRoll)+1,r3 |
| 4280 28c0 4092 0000 sts (MittelIntegralRoll)+2,r4 |
| 4281 28c4 5092 0000 sts (MittelIntegralRoll)+3,r5 |
| 4282 28c8 4091 0000 lds r20,IntegralNick2 |
| 4283 28cc 5091 0000 lds r21,(IntegralNick2)+1 |
| 4284 28d0 6091 0000 lds r22,(IntegralNick2)+2 |
| 4285 28d4 7091 0000 lds r23,(IntegralNick2)+3 |
| 4286 28d8 49A3 std Y+33,r20 |
| 4287 28da 5AA3 std Y+34,r21 |
| 4288 28dc 6BA3 std Y+35,r22 |
| 4289 28de 7CA3 std Y+36,r23 |
| 4290 28e0 8091 0000 lds r24,MittelIntegralNick2 |
| 4291 28e4 9091 0000 lds r25,(MittelIntegralNick2)+1 |
| 4292 28e8 A091 0000 lds r26,(MittelIntegralNick2)+2 |
| 4293 28ec B091 0000 lds r27,(MittelIntegralNick2)+3 |
| 4294 28f0 840F add r24,r20 |
| 4295 28f2 951F adc r25,r21 |
| 4296 28f4 A61F adc r26,r22 |
| 4297 28f6 B71F adc r27,r23 |
| 4298 28f8 8093 0000 sts MittelIntegralNick2,r24 |
| 4299 28fc 9093 0000 sts (MittelIntegralNick2)+1,r25 |
| 4300 2900 A093 0000 sts (MittelIntegralNick2)+2,r26 |
| 4301 2904 B093 0000 sts (MittelIntegralNick2)+3,r27 |
| 4302 2908 6091 0000 lds r22,IntegralRoll2 |
| 4303 290c 7091 0000 lds r23,(IntegralRoll2)+1 |
| 4304 2910 8091 0000 lds r24,(IntegralRoll2)+2 |
| 4305 2914 9091 0000 lds r25,(IntegralRoll2)+3 |
| 4306 2918 6D8F std Y+29,r22 |
| 4307 291a 7E8F std Y+30,r23 |
| 4308 291c 8F8F std Y+31,r24 |
| 4309 291e 98A3 std Y+32,r25 |
| 4310 2920 8091 0000 lds r24,MittelIntegralRoll2 |
| 4311 2924 9091 0000 lds r25,(MittelIntegralRoll2)+1 |
| 4312 2928 A091 0000 lds r26,(MittelIntegralRoll2)+2 |
| 4313 292c B091 0000 lds r27,(MittelIntegralRoll2)+3 |
| 4314 2930 2D8D ldd r18,Y+29 |
| 4315 2932 3E8D ldd r19,Y+30 |
| 4316 2934 4F8D ldd r20,Y+31 |
| 4317 2936 58A1 ldd r21,Y+32 |
| 4318 2938 820F add r24,r18 |
| 4319 293a 931F adc r25,r19 |
| 4320 293c A41F adc r26,r20 |
| 4321 293e B51F adc r27,r21 |
| 4322 2940 8093 0000 sts MittelIntegralRoll2,r24 |
| 4323 2944 9093 0000 sts (MittelIntegralRoll2)+1,r25 |
| 4324 2948 A093 0000 sts (MittelIntegralRoll2)+2,r26 |
| 4325 294c B093 0000 sts (MittelIntegralRoll2)+3,r27 |
| 4326 2950 3091 0000 lds r19,Looping_Nick |
| 4327 2954 3987 std Y+9,r19 |
| 4328 2956 3323 tst r19 |
| 4329 2958 01F4 brne .+4 |
| 4330 295a 0C94 0000 jmp .L1057 |
| 4331 295e 1092 0000 sts IntegralAccNick,__zero_reg__ |
| 4332 2962 1092 0000 sts (IntegralAccNick)+1,__zero_reg__ |
| 4333 2966 1092 0000 sts (IntegralAccNick)+2,__zero_reg__ |
| 4334 296a 1092 0000 sts (IntegralAccNick)+3,__zero_reg__ |
| 4335 296e 1092 0000 sts IntegralAccRoll,__zero_reg__ |
| 4336 2972 1092 0000 sts (IntegralAccRoll)+1,__zero_reg__ |
| 4337 2976 1092 0000 sts (IntegralAccRoll)+2,__zero_reg__ |
| 4338 297a 1092 0000 sts (IntegralAccRoll)+3,__zero_reg__ |
| 4339 297e 1092 0000 sts MittelIntegralNick,__zero_reg__ |
| 4340 2982 1092 0000 sts (MittelIntegralNick)+1,__zero_reg__ |
| 4341 2986 1092 0000 sts (MittelIntegralNick)+2,__zero_reg__ |
| 4342 298a 1092 0000 sts (MittelIntegralNick)+3,__zero_reg__ |
| 4343 298e 1092 0000 sts MittelIntegralRoll,__zero_reg__ |
| 4344 2992 1092 0000 sts (MittelIntegralRoll)+1,__zero_reg__ |
| 4345 2996 1092 0000 sts (MittelIntegralRoll)+2,__zero_reg__ |
| 4346 299a 1092 0000 sts (MittelIntegralRoll)+3,__zero_reg__ |
| 4347 299e 1092 0000 sts MittelIntegralNick2,__zero_reg__ |
| 4348 29a2 1092 0000 sts (MittelIntegralNick2)+1,__zero_reg__ |
| 4349 29a6 1092 0000 sts (MittelIntegralNick2)+2,__zero_reg__ |
| 4350 29aa 1092 0000 sts (MittelIntegralNick2)+3,__zero_reg__ |
| 4351 29ae 1092 0000 sts MittelIntegralRoll2,__zero_reg__ |
| 4352 29b2 1092 0000 sts (MittelIntegralRoll2)+1,__zero_reg__ |
| 4353 29b6 1092 0000 sts (MittelIntegralRoll2)+2,__zero_reg__ |
| 4354 29ba 1092 0000 sts (MittelIntegralRoll2)+3,__zero_reg__ |
| 4355 29be 8091 0000 lds r24,Mess_IntegralNick |
| 4356 29c2 9091 0000 lds r25,(Mess_IntegralNick)+1 |
| 4357 29c6 A091 0000 lds r26,(Mess_IntegralNick)+2 |
| 4358 29ca B091 0000 lds r27,(Mess_IntegralNick)+3 |
| 4359 29ce 8093 0000 sts Mess_IntegralNick2,r24 |
| 4360 29d2 9093 0000 sts (Mess_IntegralNick2)+1,r25 |
| 4361 29d6 A093 0000 sts (Mess_IntegralNick2)+2,r26 |
| 4362 29da B093 0000 sts (Mess_IntegralNick2)+3,r27 |
| 4363 29de 8091 0000 lds r24,Mess_IntegralRoll |
| 4364 29e2 9091 0000 lds r25,(Mess_IntegralRoll)+1 |
| 4365 29e6 A091 0000 lds r26,(Mess_IntegralRoll)+2 |
| 4366 29ea B091 0000 lds r27,(Mess_IntegralRoll)+3 |
| 4367 29ee 8093 0000 sts Mess_IntegralRoll2,r24 |
| 4368 29f2 9093 0000 sts (Mess_IntegralRoll2)+1,r25 |
| 4369 29f6 A093 0000 sts (Mess_IntegralRoll2)+2,r26 |
| 4370 29fa B093 0000 sts (Mess_IntegralRoll2)+3,r27 |
| 4371 29fe 1092 0000 sts (ZaehlMessungen)+1,__zero_reg__ |
| 4372 2a02 1092 0000 sts ZaehlMessungen,__zero_reg__ |
| 4373 2a06 1092 0000 sts (LageKorrekturNick)+1,__zero_reg__ |
| 4374 2a0a 1092 0000 sts LageKorrekturNick,__zero_reg__ |
| 4375 2a0e 1092 0000 sts (LageKorrekturRoll)+1,__zero_reg__ |
| 4376 2a12 1092 0000 sts LageKorrekturRoll,__zero_reg__ |
| 4377 2a16 5091 0000 lds r21,Looping_Roll |
| 4378 2a1a 5CA7 std Y+44,r21 |
| 4379 .L801: |
| 4380 2a1c 8091 0000 lds r24,ZaehlMessungen |
| 4381 2a20 9091 0000 lds r25,(ZaehlMessungen)+1 |
| 4382 2a24 8F3F cpi r24,255 |
| 4383 2a26 9105 cpc r25,__zero_reg__ |
| 4384 2a28 01F0 breq .+2 |
| 4385 2a2a 00F4 brsh .+4 |
| 4386 2a2c 0C94 0000 jmp .L1046 |
| 4387 2a30 B985 ldd r27,Y+9 |
| 4388 2a32 BB23 tst r27 |
| 4389 2a34 01F4 brne .L831 |
| 4390 2a36 ECA5 ldd r30,Y+44 |
| 4391 2a38 EE23 tst r30 |
| 4392 2a3a 01F4 brne .+4 |
| 4393 2a3c 0C94 0000 jmp .L1058 |
| 4394 .L831: |
| 4395 2a40 1092 0000 sts (LageKorrekturRoll)+1,__zero_reg__ |
| 4396 2a44 1092 0000 sts LageKorrekturRoll,__zero_reg__ |
| 4397 2a48 1092 0000 sts (LageKorrekturNick)+1,__zero_reg__ |
| 4398 2a4c 1092 0000 sts LageKorrekturNick,__zero_reg__ |
| 4399 2a50 1EA2 std Y+38,__zero_reg__ |
| 4400 2a52 1092 0000 sts TrichterFlug,__zero_reg__ |
| 4401 2a56 2091 0000 lds r18,MittelIntegralNick |
| 4402 2a5a 3091 0000 lds r19,(MittelIntegralNick)+1 |
| 4403 2a5e 4091 0000 lds r20,(MittelIntegralNick)+2 |
| 4404 2a62 5091 0000 lds r21,(MittelIntegralNick)+3 |
| 4405 2a66 28A7 std Y+40,r18 |
| 4406 2a68 39A7 std Y+41,r19 |
| 4407 2a6a 4AA7 std Y+42,r20 |
| 4408 2a6c 5BA7 std Y+43,r21 |
| 4409 2a6e 2090 0000 lds r2,MittelIntegralRoll |
| 4410 2a72 3090 0000 lds r3,(MittelIntegralRoll)+1 |
| 4411 2a76 4090 0000 lds r4,(MittelIntegralRoll)+2 |
| 4412 2a7a 5090 0000 lds r5,(MittelIntegralRoll)+3 |
| 4413 .L896: |
| 4414 2a7e 3091 0000 lds r19,IntegralFaktor |
| 4415 2a82 3DA3 std Y+37,r19 |
| 4416 2a84 3323 tst r19 |
| 4417 2a86 01F4 brne .L898 |
| 4418 2a88 1092 0000 sts (LageKorrekturRoll)+1,__zero_reg__ |
| 4419 2a8c 1092 0000 sts LageKorrekturRoll,__zero_reg__ |
| 4420 2a90 1092 0000 sts (LageKorrekturNick)+1,__zero_reg__ |
| 4421 2a94 1092 0000 sts LageKorrekturNick,__zero_reg__ |
| 4422 .L898: |
| 4423 2a98 48A5 ldd r20,Y+40 |
| 4424 2a9a 59A5 ldd r21,Y+41 |
| 4425 2a9c 6AA5 ldd r22,Y+42 |
| 4426 2a9e 7BA5 ldd r23,Y+43 |
| 4427 2aa0 4093 0000 sts MittelIntegralNick_Alt.3104,r20 |
| 4428 2aa4 5093 0000 sts (MittelIntegralNick_Alt.3104)+1,r21 |
| 4429 2aa8 6093 0000 sts (MittelIntegralNick_Alt.3104)+2,r22 |
| 4430 2aac 7093 0000 sts (MittelIntegralNick_Alt.3104)+3,r23 |
| 4431 2ab0 2092 0000 sts MittelIntegralRoll_Alt.3105,r2 |
| 4432 2ab4 3092 0000 sts (MittelIntegralRoll_Alt.3105)+1,r3 |
| 4433 2ab8 4092 0000 sts (MittelIntegralRoll_Alt.3105)+2,r4 |
| 4434 2abc 5092 0000 sts (MittelIntegralRoll_Alt.3105)+3,r5 |
| 4435 2ac0 1092 0000 sts IntegralAccNick,__zero_reg__ |
| 4436 2ac4 1092 0000 sts (IntegralAccNick)+1,__zero_reg__ |
| 4437 2ac8 1092 0000 sts (IntegralAccNick)+2,__zero_reg__ |
| 4438 2acc 1092 0000 sts (IntegralAccNick)+3,__zero_reg__ |
| 4439 2ad0 1092 0000 sts IntegralAccRoll,__zero_reg__ |
| 4440 2ad4 1092 0000 sts (IntegralAccRoll)+1,__zero_reg__ |
| 4441 2ad8 1092 0000 sts (IntegralAccRoll)+2,__zero_reg__ |
| 4442 2adc 1092 0000 sts (IntegralAccRoll)+3,__zero_reg__ |
| 4443 2ae0 1092 0000 sts IntegralAccZ,__zero_reg__ |
| 4444 2ae4 1092 0000 sts (IntegralAccZ)+1,__zero_reg__ |
| 4445 2ae8 1092 0000 sts (IntegralAccZ)+2,__zero_reg__ |
| 4446 2aec 1092 0000 sts (IntegralAccZ)+3,__zero_reg__ |
| 4447 2af0 1092 0000 sts MittelIntegralNick,__zero_reg__ |
| 4448 2af4 1092 0000 sts (MittelIntegralNick)+1,__zero_reg__ |
| 4449 2af8 1092 0000 sts (MittelIntegralNick)+2,__zero_reg__ |
| 4450 2afc 1092 0000 sts (MittelIntegralNick)+3,__zero_reg__ |
| 4451 2b00 1092 0000 sts MittelIntegralRoll,__zero_reg__ |
| 4452 2b04 1092 0000 sts (MittelIntegralRoll)+1,__zero_reg__ |
| 4453 2b08 1092 0000 sts (MittelIntegralRoll)+2,__zero_reg__ |
| 4454 2b0c 1092 0000 sts (MittelIntegralRoll)+3,__zero_reg__ |
| 4455 2b10 1092 0000 sts MittelIntegralNick2,__zero_reg__ |
| 4456 2b14 1092 0000 sts (MittelIntegralNick2)+1,__zero_reg__ |
| 4457 2b18 1092 0000 sts (MittelIntegralNick2)+2,__zero_reg__ |
| 4458 2b1c 1092 0000 sts (MittelIntegralNick2)+3,__zero_reg__ |
| 4459 2b20 1092 0000 sts MittelIntegralRoll2,__zero_reg__ |
| 4460 2b24 1092 0000 sts (MittelIntegralRoll2)+1,__zero_reg__ |
| 4461 2b28 1092 0000 sts (MittelIntegralRoll2)+2,__zero_reg__ |
| 4462 2b2c 1092 0000 sts (MittelIntegralRoll2)+3,__zero_reg__ |
| 4463 2b30 1092 0000 sts (ZaehlMessungen)+1,__zero_reg__ |
| 4464 2b34 1092 0000 sts ZaehlMessungen,__zero_reg__ |
| 4465 2b38 E090 0000 lds r14,StickGier |
| 4466 2b3c F090 0000 lds r15,(StickGier)+1 |
| 4467 2b40 6701 movw r12,r14 |
| 4468 2b42 F7FE sbrs r15,7 |
| 4469 2b44 00C0 rjmp .+4 |
| 4470 2b46 0C94 0000 jmp .L1059 |
| 4471 .L900: |
| 4472 2b4a 70E1 ldi r23,lo8(16) |
| 4473 2b4c C716 cp r12,r23 |
| 4474 2b4e D104 cpc r13,__zero_reg__ |
| 4475 2b50 04F0 brlt .L901 |
| 4476 2b52 88EE ldi r24,lo8(1000) |
| 4477 2b54 93E0 ldi r25,hi8(1000) |
| 4478 2b56 9093 0000 sts (KompassSignalSchlecht)+1,r25 |
| 4479 2b5a 8093 0000 sts KompassSignalSchlecht,r24 |
| 4480 2b5e 8A85 ldd r24,Y+10 |
| 4481 2b60 84FD sbrc r24,4 |
| 4482 2b62 00C0 rjmp .L901 |
| 4483 2b64 81E0 ldi r24,lo8(1) |
| 4484 2b66 8093 0000 sts NeueKompassRichtungMerken.3088,r24 |
| 4485 .L901: |
| 4486 2b6a 0091 0000 lds r16,EE_Parameter+17 |
| 4487 2b6e B701 movw r22,r14 |
| 4488 2b70 8827 clr r24 |
| 4489 2b72 77FD sbrc r23,7 |
| 4490 2b74 8095 com r24 |
| 4491 2b76 982F mov r25,r24 |
| 4492 2b78 202F mov r18,r16 |
| 4493 2b7a 30E0 ldi r19,lo8(0) |
| 4494 2b7c 40E0 ldi r20,lo8(0) |
| 4495 2b7e 50E0 ldi r21,hi8(0) |
| 4496 2b80 0E94 0000 call __mulsi3 |
| 4497 2b84 9601 movw r18,r12 |
| 4498 2b86 4427 clr r20 |
| 4499 2b88 37FD sbrc r19,7 |
| 4500 2b8a 4095 com r20 |
| 4501 2b8c 542F mov r21,r20 |
| 4502 2b8e 0E94 0000 call __mulsi3 |
| 4503 2b92 20E0 ldi r18,lo8(512) |
| 4504 2b94 32E0 ldi r19,hi8(512) |
| 4505 2b96 40E0 ldi r20,hlo8(512) |
| 4506 2b98 50E0 ldi r21,hhi8(512) |
| 4507 2b9a 0E94 0000 call __divmodsi4 |
| 4508 2b9e 10E0 ldi r17,lo8(0) |
| 4509 2ba0 0E9D mul r16,r14 |
| 4510 2ba2 B001 movw r22,r0 |
| 4511 2ba4 0F9D mul r16,r15 |
| 4512 2ba6 700D add r23,r0 |
| 4513 2ba8 1E9D mul r17,r14 |
| 4514 2baa 700D add r23,r0 |
| 4515 2bac 1124 clr r1 |
| 4516 2bae 77FF sbrs r23,7 |
| 4517 2bb0 00C0 rjmp .+4 |
| 4518 2bb2 0C94 0000 jmp .L1060 |
| 4519 .L904: |
| 4520 2bb6 7595 asr r23 |
| 4521 2bb8 6795 ror r22 |
| 4522 2bba 7595 asr r23 |
| 4523 2bbc 6795 ror r22 |
| 4524 2bbe 260F add r18,r22 |
| 4525 2bc0 371F adc r19,r23 |
| 4526 2bc2 A901 movw r20,r18 |
| 4527 2bc4 6627 clr r22 |
| 4528 2bc6 57FD sbrc r21,7 |
| 4529 2bc8 6095 com r22 |
| 4530 2bca 762F mov r23,r22 |
| 4531 2bcc 488F std Y+24,r20 |
| 4532 2bce 598F std Y+25,r21 |
| 4533 2bd0 6A8F std Y+26,r22 |
| 4534 2bd2 7B8F std Y+27,r23 |
| 4535 2bd4 4093 0000 sts sollGier.3069,r20 |
| 4536 2bd8 5093 0000 sts (sollGier.3069)+1,r21 |
| 4537 2bdc 6093 0000 sts (sollGier.3069)+2,r22 |
| 4538 2be0 7093 0000 sts (sollGier.3069)+3,r23 |
| 4539 2be4 8091 0000 lds r24,Mess_Integral_Gier |
| 4540 2be8 9091 0000 lds r25,(Mess_Integral_Gier)+1 |
| 4541 2bec A091 0000 lds r26,(Mess_Integral_Gier)+2 |
| 4542 2bf0 B091 0000 lds r27,(Mess_Integral_Gier)+3 |
| 4543 2bf4 841B sub r24,r20 |
| 4544 2bf6 950B sbc r25,r21 |
| 4545 2bf8 A60B sbc r26,r22 |
| 4546 2bfa B70B sbc r27,r23 |
| 4547 2bfc 8093 0000 sts Mess_Integral_Gier,r24 |
| 4548 2c00 9093 0000 sts (Mess_Integral_Gier)+1,r25 |
| 4549 2c04 A093 0000 sts (Mess_Integral_Gier)+2,r26 |
| 4550 2c08 B093 0000 sts (Mess_Integral_Gier)+3,r27 |
| 4551 2c0c 8135 cpi r24,lo8(50001) |
| 4552 2c0e 53EC ldi r21,hi8(50001) |
| 4553 2c10 9507 cpc r25,r21 |
| 4554 2c12 50E0 ldi r21,hlo8(50001) |
| 4555 2c14 A507 cpc r26,r21 |
| 4556 2c16 50E0 ldi r21,hhi8(50001) |
| 4557 2c18 B507 cpc r27,r21 |
| 4558 2c1a 04F4 brge .+4 |
| 4559 2c1c 0C94 0000 jmp .L905 |
| 4560 2c20 80E5 ldi r24,lo8(50000) |
| 4561 2c22 93EC ldi r25,hi8(50000) |
| 4562 2c24 A0E0 ldi r26,hlo8(50000) |
| 4563 2c26 B0E0 ldi r27,hhi8(50000) |
| 4564 2c28 8093 0000 sts Mess_Integral_Gier,r24 |
| 4565 2c2c 9093 0000 sts (Mess_Integral_Gier)+1,r25 |
| 4566 2c30 A093 0000 sts (Mess_Integral_Gier)+2,r26 |
| 4567 2c34 B093 0000 sts (Mess_Integral_Gier)+3,r27 |
| 4568 .L907: |
| 4569 2c38 2090 0000 lds r2,KompassValue |
| 4570 2c3c 3090 0000 lds r3,(KompassValue)+1 |
| 4571 2c40 2114 cp r2,__zero_reg__ |
| 4572 2c42 3104 cpc r3,__zero_reg__ |
| 4573 2c44 01F4 brne .+2 |
| 4574 2c46 00C0 rjmp .L1049 |
| 4575 2c48 7A85 ldd r23,Y+10 |
| 4576 2c4a 73FF sbrs r23,3 |
| 4577 2c4c 00C0 rjmp .L1049 |
| 4578 2c4e 6981 ldd r22,Y+1 |
| 4579 2c50 7A81 ldd r23,Y+2 |
| 4580 2c52 8B81 ldd r24,Y+3 |
| 4581 2c54 9C81 ldd r25,Y+4 |
| 4582 2c56 20E0 ldi r18,lo8(512) |
| 4583 2c58 32E0 ldi r19,hi8(512) |
| 4584 2c5a 40E0 ldi r20,hlo8(512) |
| 4585 2c5c 50E0 ldi r21,hhi8(512) |
| 4586 2c5e 0E94 0000 call __divmodsi4 |
| 4587 2c62 8901 movw r16,r18 |
| 4588 2c64 37FF sbrs r19,7 |
| 4589 2c66 00C0 rjmp .+4 |
| 4590 2c68 0C94 0000 jmp .L1061 |
| 4591 .L912: |
| 4592 2c6c 6D81 ldd r22,Y+5 |
| 4593 2c6e 7E81 ldd r23,Y+6 |
| 4594 2c70 8F81 ldd r24,Y+7 |
| 4595 2c72 9885 ldd r25,Y+8 |
| 4596 2c74 20E0 ldi r18,lo8(512) |
| 4597 2c76 32E0 ldi r19,hi8(512) |
| 4598 2c78 40E0 ldi r20,hlo8(512) |
| 4599 2c7a 50E0 ldi r21,hhi8(512) |
| 4600 2c7c 0E94 0000 call __divmodsi4 |
| 4601 2c80 6901 movw r12,r18 |
| 4602 2c82 37FF sbrs r19,7 |
| 4603 2c84 00C0 rjmp .+4 |
| 4604 2c86 0C94 0000 jmp .L1062 |
| 4605 .L913: |
| 4606 2c8a C016 cp r12,r16 |
| 4607 2c8c D106 cpc r13,r17 |
| 4608 2c8e 04F4 brge .+4 |
| 4609 2c90 0C94 0000 jmp .L1063 |
| 4610 .L914: |
| 4611 2c94 4090 0000 lds r4,ErsatzKompass |
| 4612 2c98 5090 0000 lds r5,(ErsatzKompass)+1 |
| 4613 2c9c 6090 0000 lds r6,(ErsatzKompass)+2 |
| 4614 2ca0 7090 0000 lds r7,(ErsatzKompass)+3 |
| 4615 2ca4 8091 0000 lds r24,GIER_GRAD_FAKTOR |
| 4616 2ca8 9091 0000 lds r25,(GIER_GRAD_FAKTOR)+1 |
| 4617 2cac A091 0000 lds r26,(GIER_GRAD_FAKTOR)+2 |
| 4618 2cb0 B091 0000 lds r27,(GIER_GRAD_FAKTOR)+3 |
| 4619 2cb4 8C8B std Y+20,r24 |
| 4620 2cb6 9D8B std Y+21,r25 |
| 4621 2cb8 AE8B std Y+22,r26 |
| 4622 2cba BF8B std Y+23,r27 |
| 4623 2cbc 8090 0000 lds r8,MesswertGier |
| 4624 2cc0 9090 0000 lds r9,(MesswertGier)+1 |
| 4625 2cc4 C401 movw r24,r8 |
| 4626 2cc6 97FE sbrs r9,7 |
| 4627 2cc8 00C0 rjmp .+4 |
| 4628 2cca 0C94 0000 jmp .L1064 |
| 4629 .L916: |
| 4630 2cce 8138 cpi r24,129 |
| 4631 2cd0 9105 cpc r25,__zero_reg__ |
| 4632 2cd2 04F0 brlt .+4 |
| 4633 2cd4 0C94 0000 jmp .L1065 |
| 4634 2cd8 ACE1 ldi r26,lo8(540) |
| 4635 2cda B2E0 ldi r27,hi8(540) |
| 4636 2cdc 2A0E add r2,r26 |
| 4637 2cde 3B1E adc r3,r27 |
| 4638 2ce0 7101 movw r14,r2 |
| 4639 2ce2 0027 clr r16 |
| 4640 2ce4 F7FC sbrc r15,7 |
| 4641 2ce6 0095 com r16 |
| 4642 2ce8 102F mov r17,r16 |
| 4643 2cea E4EE ldi r30,lo8(-540) |
| 4644 2cec FDEF ldi r31,hi8(-540) |
| 4645 2cee 2E0E add r2,r30 |
| 4646 2cf0 3F1E adc r3,r31 |
| 4647 2cf2 C301 movw r24,r6 |
| 4648 2cf4 B201 movw r22,r4 |
| 4649 2cf6 2C89 ldd r18,Y+20 |
| 4650 2cf8 3D89 ldd r19,Y+21 |
| 4651 2cfa 4E89 ldd r20,Y+22 |
| 4652 2cfc 5F89 ldd r21,Y+23 |
| 4653 2cfe 0E94 0000 call __divmodsi4 |
| 4654 2d02 E21A sub r14,r18 |
| 4655 2d04 F30A sbc r15,r19 |
| 4656 2d06 040B sbc r16,r20 |
| 4657 2d08 150B sbc r17,r21 |
| 4658 2d0a C801 movw r24,r16 |
| 4659 2d0c B701 movw r22,r14 |
| 4660 2d0e 28E6 ldi r18,lo8(360) |
| 4661 2d10 31E0 ldi r19,hi8(360) |
| 4662 2d12 40E0 ldi r20,hlo8(360) |
| 4663 2d14 50E0 ldi r21,hhi8(360) |
| 4664 2d16 0E94 0000 call __divmodsi4 |
| 4665 2d1a 645B subi r22,lo8(-(-180)) |
| 4666 2d1c 7040 sbci r23,hi8(-(-180)) |
| 4667 2d1e 8B01 movw r16,r22 |
| 4668 2d20 000F lsl r16 |
| 4669 2d22 111F rol r17 |
| 4670 2d24 000F lsl r16 |
| 4671 2d26 111F rol r17 |
| 4672 2d28 000F lsl r16 |
| 4673 2d2a 111F rol r17 |
| 4674 .L918: |
| 4675 2d2c 2091 0000 lds r18,NeueKompassRichtungMerken.3088 |
| 4676 2d30 E090 0000 lds r14,KompassSignalSchlecht |
| 4677 2d34 F090 0000 lds r15,(KompassSignalSchlecht)+1 |
| 4678 2d38 E114 cp r14,__zero_reg__ |
| 4679 2d3a F104 cpc r15,__zero_reg__ |
| 4680 2d3c 01F4 brne .L919 |
| 4681 2d3e F9E1 ldi r31,lo8(25) |
| 4682 2d40 CF16 cp r12,r31 |
| 4683 2d42 D104 cpc r13,__zero_reg__ |
| 4684 2d44 04F4 brge .L919 |
| 4685 2d46 8091 0000 lds r24,GierGyroFehler |
| 4686 2d4a 9091 0000 lds r25,(GierGyroFehler)+1 |
| 4687 2d4e 860F add r24,r22 |
| 4688 2d50 971F adc r25,r23 |
| 4689 2d52 9093 0000 sts (GierGyroFehler)+1,r25 |
| 4690 2d56 8093 0000 sts GierGyroFehler,r24 |
| 4691 2d5a 2223 tst r18 |
| 4692 2d5c 01F0 breq .+4 |
| 4693 2d5e 0C94 0000 jmp .L1066 |
| 4694 .L919: |
| 4695 2d62 B601 movw r22,r12 |
| 4696 2d64 D7FE sbrs r13,7 |
| 4697 2d66 00C0 rjmp .+4 |
| 4698 2d68 0C94 0000 jmp .L1067 |
| 4699 .L923: |
| 4700 2d6c 7595 asr r23 |
| 4701 2d6e 6795 ror r22 |
| 4702 2d70 7595 asr r23 |
| 4703 2d72 6795 ror r22 |
| 4704 2d74 7595 asr r23 |
| 4705 2d76 6795 ror r22 |
| 4706 2d78 6F5F subi r22,lo8(-(1)) |
| 4707 2d7a 7F4F sbci r23,hi8(-(1)) |
| 4708 2d7c C801 movw r24,r16 |
| 4709 2d7e 0E94 0000 call __divmodhi4 |
| 4710 2d82 9B01 movw r18,r22 |
| 4711 2d84 A901 movw r20,r18 |
| 4712 2d86 6627 clr r22 |
| 4713 2d88 57FD sbrc r21,7 |
| 4714 2d8a 6095 com r22 |
| 4715 2d8c 762F mov r23,r22 |
| 4716 2d8e 440D add r20,r4 |
| 4717 2d90 551D adc r21,r5 |
| 4718 2d92 661D adc r22,r6 |
| 4719 2d94 771D adc r23,r7 |
| 4720 2d96 4093 0000 sts ErsatzKompass,r20 |
| 4721 2d9a 5093 0000 sts (ErsatzKompass)+1,r21 |
| 4722 2d9e 6093 0000 sts (ErsatzKompass)+2,r22 |
| 4723 2da2 7093 0000 sts (ErsatzKompass)+3,r23 |
| 4724 2da6 8091 0000 lds r24,Parameter_KompassWirkung |
| 4725 2daa A82E mov r10,r24 |
| 4726 2dac BB24 clr r11 |
| 4727 2dae CA9C mul r12,r10 |
| 4728 2db0 9001 movw r18,r0 |
| 4729 2db2 CB9C mul r12,r11 |
| 4730 2db4 300D add r19,r0 |
| 4731 2db6 DA9C mul r13,r10 |
| 4732 2db8 300D add r19,r0 |
| 4733 2dba 1124 clr r1 |
| 4734 2dbc 37FF sbrs r19,7 |
| 4735 2dbe 00C0 rjmp .+4 |
| 4736 2dc0 0C94 0000 jmp .L1068 |
| 4737 .L924: |
| 4738 2dc4 3595 asr r19 |
| 4739 2dc6 2795 ror r18 |
| 4740 2dc8 3595 asr r19 |
| 4741 2dca 2795 ror r18 |
| 4742 2dcc 3595 asr r19 |
| 4743 2dce 2795 ror r18 |
| 4744 2dd0 3595 asr r19 |
| 4745 2dd2 2795 ror r18 |
| 4746 2dd4 3595 asr r19 |
| 4747 2dd6 2795 ror r18 |
| 4748 2dd8 6501 movw r12,r10 |
| 4749 2dda C21A sub r12,r18 |
| 4750 2ddc D30A sbc r13,r19 |
| 4751 2dde D7FE sbrs r13,7 |
| 4752 2de0 00C0 rjmp .+4 |
| 4753 2de2 0C94 0000 jmp .L925 |
| 4754 2de6 E114 cp r14,__zero_reg__ |
| 4755 2de8 F104 cpc r15,__zero_reg__ |
| 4756 2dea 01F0 breq .+4 |
| 4757 2dec 0C94 0000 jmp .L927 |
| 4758 2df0 6090 0000 lds r6,MaxStickRoll |
| 4759 2df4 7090 0000 lds r7,(MaxStickRoll)+1 |
| 4760 2df8 8091 0000 lds r24,MaxStickNick |
| 4761 2dfc 9091 0000 lds r25,(MaxStickNick)+1 |
| 4762 2e00 680E add r6,r24 |
| 4763 2e02 791E adc r7,r25 |
| 4764 2e04 77FE sbrs r7,7 |
| 4765 2e06 00C0 rjmp .+4 |
| 4766 2e08 0C94 0000 jmp .L1069 |
| 4767 .L929: |
| 4768 2e0c 7594 asr r7 |
| 4769 2e0e 6794 ror r6 |
| 4770 2e10 7594 asr r7 |
| 4771 2e12 6794 ror r6 |
| 4772 2e14 7594 asr r7 |
| 4773 2e16 6794 ror r6 |
| 4774 2e18 A0E4 ldi r26,lo8(64) |
| 4775 2e1a B0E0 ldi r27,hi8(64) |
| 4776 2e1c 6A0E add r6,r26 |
| 4777 2e1e 7B1E adc r7,r27 |
| 4778 2e20 8091 0000 lds r24,KompassStartwert |
| 4779 2e24 9091 0000 lds r25,(KompassStartwert)+1 |
| 4780 2e28 AA27 clr r26 |
| 4781 2e2a 97FD sbrc r25,7 |
| 4782 2e2c A095 com r26 |
| 4783 2e2e BA2F mov r27,r26 |
| 4784 2e30 ECE1 ldi r30,lo8(540) |
| 4785 2e32 EE2E mov r14,r30 |
| 4786 2e34 E2E0 ldi r30,hi8(540) |
| 4787 2e36 FE2E mov r15,r30 |
| 4788 2e38 012D mov r16,__zero_reg__ |
| 4789 2e3a 112D mov r17,__zero_reg__ |
| 4790 2e3c E81A sub r14,r24 |
| 4791 2e3e F90A sbc r15,r25 |
| 4792 2e40 0A0B sbc r16,r26 |
| 4793 2e42 1B0B sbc r17,r27 |
| 4794 2e44 CB01 movw r24,r22 |
| 4795 2e46 BA01 movw r22,r20 |
| 4796 2e48 2C89 ldd r18,Y+20 |
| 4797 2e4a 3D89 ldd r19,Y+21 |
| 4798 2e4c 4E89 ldd r20,Y+22 |
| 4799 2e4e 5F89 ldd r21,Y+23 |
| 4800 2e50 0E94 0000 call __divmodsi4 |
| 4801 2e54 E20E add r14,r18 |
| 4802 2e56 F31E adc r15,r19 |
| 4803 2e58 041F adc r16,r20 |
| 4804 2e5a 151F adc r17,r21 |
| 4805 2e5c C801 movw r24,r16 |
| 4806 2e5e B701 movw r22,r14 |
| 4807 2e60 28E6 ldi r18,lo8(360) |
| 4808 2e62 31E0 ldi r19,hi8(360) |
| 4809 2e64 40E0 ldi r20,hlo8(360) |
| 4810 2e66 50E0 ldi r21,hhi8(360) |
| 4811 2e68 0E94 0000 call __divmodsi4 |
| 4812 2e6c 645B subi r22,lo8(-(-180)) |
| 4813 2e6e 7040 sbci r23,hi8(-(-180)) |
| 4814 2e70 6C9D mul r22,r12 |
| 4815 2e72 C001 movw r24,r0 |
| 4816 2e74 6D9D mul r22,r13 |
| 4817 2e76 900D add r25,r0 |
| 4818 2e78 7C9D mul r23,r12 |
| 4819 2e7a 900D add r25,r0 |
| 4820 2e7c 1124 clr r1 |
| 4821 2e7e B301 movw r22,r6 |
| 4822 2e80 0E94 0000 call __divmodhi4 |
| 4823 2e84 9501 movw r18,r10 |
| 4824 2e86 220F lsl r18 |
| 4825 2e88 331F rol r19 |
| 4826 2e8a 2A0D add r18,r10 |
| 4827 2e8c 3B1D adc r19,r11 |
| 4828 2e8e 2617 cp r18,r22 |
| 4829 2e90 3707 cpc r19,r23 |
| 4830 2e92 04F4 brge .+4 |
| 4831 2e94 0C94 0000 jmp .L930 |
| 4832 2e98 3095 com r19 |
| 4833 2e9a 2195 neg r18 |
| 4834 2e9c 3F4F sbci r19,lo8(-1) |
| 4835 2e9e 6217 cp r22,r18 |
| 4836 2ea0 7307 cpc r23,r19 |
| 4837 2ea2 04F4 brge .L932 |
| 4838 2ea4 B901 movw r22,r18 |
| 4839 .L932: |
| 4840 2ea6 9B01 movw r18,r22 |
| 4841 2ea8 4427 clr r20 |
| 4842 2eaa 37FD sbrc r19,7 |
| 4843 2eac 4095 com r20 |
| 4844 2eae 542F mov r21,r20 |
| 4845 2eb0 8091 0000 lds r24,Mess_Integral_Gier |
| 4846 2eb4 9091 0000 lds r25,(Mess_Integral_Gier)+1 |
| 4847 2eb8 A091 0000 lds r26,(Mess_Integral_Gier)+2 |
| 4848 2ebc B091 0000 lds r27,(Mess_Integral_Gier)+3 |
| 4849 2ec0 820F add r24,r18 |
| 4850 2ec2 931F adc r25,r19 |
| 4851 2ec4 A41F adc r26,r20 |
| 4852 2ec6 B51F adc r27,r21 |
| 4853 2ec8 8093 0000 sts Mess_Integral_Gier,r24 |
| 4854 2ecc 9093 0000 sts (Mess_Integral_Gier)+1,r25 |
| 4855 2ed0 A093 0000 sts (Mess_Integral_Gier)+2,r26 |
| 4856 2ed4 B093 0000 sts (Mess_Integral_Gier)+3,r27 |
| 4857 2ed8 00C0 rjmp .L909 |
| 4858 .L647: |
| 4859 2eda 8091 0000 lds r24,SenderOkay |
| 4860 2ede 8D38 cpi r24,lo8(-115) |
| 4861 2ee0 00F4 brsh .+2 |
| 4862 2ee2 00C0 rjmp .L661 |
| 4863 2ee4 1092 0000 sts Notlandung,__zero_reg__ |
| 4864 2ee8 8091 0000 lds r24,EE_Parameter+27 |
| 4865 2eec 22E3 ldi r18,lo8(50) |
| 4866 2eee 829F mul r24,r18 |
| 4867 2ef0 C001 movw r24,r0 |
| 4868 2ef2 1124 clr r1 |
| 4869 2ef4 9093 0000 sts (RcLostTimer.3074)+1,r25 |
| 4870 2ef8 8093 0000 sts RcLostTimer.3074,r24 |
| 4871 2efc E889 ldd r30,Y+16 |
| 4872 2efe F989 ldd r31,Y+17 |
| 4873 2f00 B997 sbiw r30,41 |
| 4874 2f02 04F0 brlt .L663 |
| 4875 2f04 8091 0000 lds r24,MotorenEin |
| 4876 2f08 8823 tst r24 |
| 4877 2f0a 01F0 breq .L663 |
| 4878 2f0c 8091 0000 lds r24,modell_fliegt |
| 4879 2f10 9091 0000 lds r25,(modell_fliegt)+1 |
| 4880 2f14 FFEF ldi r31,hi8(-1) |
| 4881 2f16 8F3F cpi r24,lo8(-1) |
| 4882 2f18 9F07 cpc r25,r31 |
| 4883 2f1a 01F0 breq .L666 |
| 4884 2f1c 0196 adiw r24,1 |
| 4885 2f1e 9093 0000 sts (modell_fliegt)+1,r25 |
| 4886 2f22 8093 0000 sts modell_fliegt,r24 |
| 4887 .L663: |
| 4888 2f26 8091 0000 lds r24,modell_fliegt |
| 4889 2f2a 9091 0000 lds r25,(modell_fliegt)+1 |
| 4890 2f2e 8F3F cpi r24,255 |
| 4891 2f30 9105 cpc r25,__zero_reg__ |
| 4892 2f32 01F0 breq .+2 |
| 4893 2f34 00F4 brsh .+4 |
| 4894 2f36 0C94 0000 jmp .L1070 |
| 4895 .L666: |
| 4896 2f3a 8091 0000 lds r24,MikroKopterFlags |
| 4897 2f3e 8260 ori r24,lo8(2) |
| 4898 2f40 8093 0000 sts MikroKopterFlags,r24 |
| 4899 .L669: |
| 4900 2f44 8091 0000 lds r24,EE_Parameter+2 |
| 4901 2f48 A82F mov r26,r24 |
| 4902 2f4a B0E0 ldi r27,lo8(0) |
| 4903 2f4c AA0F lsl r26 |
| 4904 2f4e BB1F rol r27 |
| 4905 2f50 FD01 movw r30,r26 |
| 4906 2f52 E050 subi r30,lo8(-(PPM_in)) |
| 4907 2f54 F040 sbci r31,hi8(-(PPM_in)) |
| 4908 2f56 8081 ld r24,Z |
| 4909 2f58 9181 ldd r25,Z+1 |
| 4910 2f5a 8135 cpi r24,81 |
| 4911 2f5c 9105 cpc r25,__zero_reg__ |
| 4912 2f5e 04F4 brge .+2 |
| 4913 2f60 00C0 rjmp .L671 |
| 4914 2f62 8091 0000 lds r24,MotorenEin |
| 4915 2f66 8823 tst r24 |
| 4916 2f68 01F0 breq .+2 |
| 4917 2f6a 00C0 rjmp .L671 |
| 4918 2f6c 8091 0000 lds r24,EE_Parameter+3 |
| 4919 2f70 E82F mov r30,r24 |
| 4920 2f72 F0E0 ldi r31,lo8(0) |
| 4921 2f74 EE0F lsl r30 |
| 4922 2f76 FF1F rol r31 |
| 4923 2f78 E050 subi r30,lo8(-(PPM_in)) |
| 4924 2f7a F040 sbci r31,hi8(-(PPM_in)) |
| 4925 2f7c 8081 ld r24,Z |
| 4926 2f7e 9181 ldd r25,Z+1 |
| 4927 2f80 8C34 cpi r24,76 |
| 4928 2f82 9105 cpc r25,__zero_reg__ |
| 4929 2f84 04F4 brge .+4 |
| 4930 2f86 0C94 0000 jmp .L674 |
| 4931 2f8a 8091 0000 lds r24,delay_neutral.3075 |
| 4932 2f8e 8F5F subi r24,lo8(-(1)) |
| 4933 2f90 8093 0000 sts delay_neutral.3075,r24 |
| 4934 2f94 893C cpi r24,lo8(-55) |
| 4935 2f96 00F4 brsh .+2 |
| 4936 2f98 00C0 rjmp .L671 |
| 4937 2f9a 4C30 cpi r20,lo8(12) |
| 4938 2f9c 00F0 brlo .+4 |
| 4939 2f9e 0C94 0000 jmp .L677 |
| 4940 2fa2 2998 cbi 37-0x20,1 |
| 4941 .L679: |
| 4942 2fa4 1092 0000 sts MotorenEin,__zero_reg__ |
| 4943 2fa8 1092 0000 sts delay_neutral.3075,__zero_reg__ |
| 4944 2fac 1092 0000 sts (modell_fliegt)+1,__zero_reg__ |
| 4945 2fb0 1092 0000 sts modell_fliegt,__zero_reg__ |
| 4946 2fb4 8091 0000 lds r24,EE_Parameter |
| 4947 2fb8 282F mov r18,r24 |
| 4948 2fba 30E0 ldi r19,lo8(0) |
| 4949 2fbc 220F lsl r18 |
| 4950 2fbe 331F rol r19 |
| 4951 2fc0 F901 movw r30,r18 |
| 4952 2fc2 E050 subi r30,lo8(-(PPM_in)) |
| 4953 2fc4 F040 sbci r31,hi8(-(PPM_in)) |
| 4954 2fc6 8081 ld r24,Z |
| 4955 2fc8 9181 ldd r25,Z+1 |
| 4956 2fca 8734 cpi r24,71 |
| 4957 2fcc 9105 cpc r25,__zero_reg__ |
| 4958 2fce 04F4 brge .+4 |
| 4959 2fd0 0C94 0000 jmp .L680 |
| 4960 2fd4 8091 0000 lds r24,EE_Parameter+1 |
| 4961 2fd8 A82F mov r26,r24 |
| 4962 2fda B0E0 ldi r27,lo8(0) |
| 4963 2fdc AA0F lsl r26 |
| 4964 2fde BB1F rol r27 |
| 4965 .L682: |
| 4966 2fe0 AD01 movw r20,r26 |
| 4967 2fe2 4050 subi r20,lo8(-(PPM_in)) |
| 4968 2fe4 5040 sbci r21,hi8(-(PPM_in)) |
| 4969 2fe6 FA01 movw r30,r20 |
| 4970 2fe8 8081 ld r24,Z |
| 4971 2fea 9181 ldd r25,Z+1 |
| 4972 2fec 8734 cpi r24,71 |
| 4973 2fee 9105 cpc r25,__zero_reg__ |
| 4974 2ff0 04F0 brlt .L685 |
| 4975 2ff2 F901 movw r30,r18 |
| 4976 2ff4 E050 subi r30,lo8(-(PPM_in)) |
| 4977 2ff6 F040 sbci r31,hi8(-(PPM_in)) |
| 4978 2ff8 8081 ld r24,Z |
| 4979 2ffa 9181 ldd r25,Z+1 |
| 4980 .L685: |
| 4981 2ffc FA01 movw r30,r20 |
| 4982 2ffe 8081 ld r24,Z |
| 4983 3000 9181 ldd r25,Z+1 |
| 4984 3002 8734 cpi r24,71 |
| 4985 3004 9105 cpc r25,__zero_reg__ |
| 4986 3006 04F4 brge .+4 |
| 4987 3008 0C94 0000 jmp .L687 |
| 4988 300c F901 movw r30,r18 |
| 4989 300e E050 subi r30,lo8(-(PPM_in)) |
| 4990 3010 F040 sbci r31,hi8(-(PPM_in)) |
| 4991 3012 8081 ld r24,Z |
| 4992 3014 9181 ldd r25,Z+1 |
| 4993 3016 8734 cpi r24,71 |
| 4994 3018 9105 cpc r25,__zero_reg__ |
| 4995 301a 04F4 brge .+4 |
| 4996 301c 0C94 0000 jmp .L687 |
| 4997 3020 42E0 ldi r20,lo8(2) |
| 4998 .L690: |
| 4999 3022 FD01 movw r30,r26 |
| 5000 3024 E050 subi r30,lo8(-(PPM_in)) |
| 5001 3026 F040 sbci r31,hi8(-(PPM_in)) |
| 5002 3028 8081 ld r24,Z |
| 5003 302a 9181 ldd r25,Z+1 |
| 5004 302c 8634 cpi r24,70 |
| 5005 302e 9105 cpc r25,__zero_reg__ |
| 5006 3030 04F4 brge .L691 |
| 5007 3032 F901 movw r30,r18 |
| 5008 3034 E050 subi r30,lo8(-(PPM_in)) |
| 5009 3036 F040 sbci r31,hi8(-(PPM_in)) |
| 5010 3038 8081 ld r24,Z |
| 5011 303a 9181 ldd r25,Z+1 |
| 5012 303c 8734 cpi r24,71 |
| 5013 303e 9105 cpc r25,__zero_reg__ |
| 5014 3040 04F0 brlt .L691 |
| 5015 3042 43E0 ldi r20,lo8(3) |
| 5016 .L691: |
| 5017 3044 FD01 movw r30,r26 |
| 5018 3046 E050 subi r30,lo8(-(PPM_in)) |
| 5019 3048 F040 sbci r31,hi8(-(PPM_in)) |
| 5020 304a 8081 ld r24,Z |
| 5021 304c 9181 ldd r25,Z+1 |
| 5022 304e 8A5B subi r24,lo8(-70) |
| 5023 3050 9F4F sbci r25,hi8(-70) |
| 5024 3052 04F4 brge .L694 |
| 5025 3054 F901 movw r30,r18 |
| 5026 3056 E050 subi r30,lo8(-(PPM_in)) |
| 5027 3058 F040 sbci r31,hi8(-(PPM_in)) |
| 5028 305a 8081 ld r24,Z |
| 5029 305c 9181 ldd r25,Z+1 |
| 5030 305e 8734 cpi r24,71 |
| 5031 3060 9105 cpc r25,__zero_reg__ |
| 5032 3062 04F0 brlt .L694 |
| 5033 3064 44E0 ldi r20,lo8(4) |
| 5034 .L694: |
| 5035 3066 A050 subi r26,lo8(-(PPM_in)) |
| 5036 3068 B040 sbci r27,hi8(-(PPM_in)) |
| 5037 306a 8D91 ld r24,X+ |
| 5038 306c 9C91 ld r25,X |
| 5039 306e 8A5B subi r24,lo8(-70) |
| 5040 3070 9F4F sbci r25,hi8(-70) |
| 5041 3072 04F4 brge .L697 |
| 5042 3074 2050 subi r18,lo8(-(PPM_in)) |
| 5043 3076 3040 sbci r19,hi8(-(PPM_in)) |
| 5044 3078 D901 movw r26,r18 |
| 5045 307a 8D91 ld r24,X+ |
| 5046 307c 9C91 ld r25,X |
| 5047 307e 8634 cpi r24,70 |
| 5048 3080 9105 cpc r25,__zero_reg__ |
| 5049 3082 04F4 brge .L697 |
| 5050 3084 45E0 ldi r20,lo8(5) |
| 5051 .L697: |
| 5052 3086 842F mov r24,r20 |
| 5053 3088 0E94 0000 call SetActiveParamSetNumber |
| 5054 308c 8091 0000 lds r24,EE_Parameter+1 |
| 5055 3090 A82F mov r26,r24 |
| 5056 3092 B0E0 ldi r27,lo8(0) |
| 5057 3094 AA0F lsl r26 |
| 5058 3096 BB1F rol r27 |
| 5059 .L683: |
| 5060 3098 A050 subi r26,lo8(-(PPM_in)) |
| 5061 309a B040 sbci r27,hi8(-(PPM_in)) |
| 5062 309c 8D91 ld r24,X+ |
| 5063 309e 9C91 ld r25,X |
| 5064 30a0 97FF sbrs r25,7 |
| 5065 30a2 00C0 rjmp .+4 |
| 5066 30a4 0C94 0000 jmp .L1071 |
| 5067 .L701: |
| 5068 30a8 4E97 sbiw r24,30 |
| 5069 30aa 04F0 brlt .+4 |
| 5070 30ac 0C94 0000 jmp .L700 |
| 5071 30b0 E091 0000 lds r30,EE_Parameter |
| 5072 30b4 F0E0 ldi r31,lo8(0) |
| 5073 30b6 EE0F lsl r30 |
| 5074 30b8 FF1F rol r31 |
| 5075 30ba E050 subi r30,lo8(-(PPM_in)) |
| 5076 30bc F040 sbci r31,hi8(-(PPM_in)) |
| 5077 30be 8081 ld r24,Z |
| 5078 30c0 9181 ldd r25,Z+1 |
| 5079 30c2 8A5B subi r24,lo8(-70) |
| 5080 30c4 9F4F sbci r25,hi8(-70) |
| 5081 30c6 04F0 brlt .+4 |
| 5082 30c8 0C94 0000 jmp .L700 |
| 5083 30cc 81E0 ldi r24,lo8(1) |
| 5084 30ce 8093 0000 sts WinkelOut+6,r24 |
| 5085 30d2 88EE ldi r24,lo8(1000) |
| 5086 30d4 93E0 ldi r25,hi8(1000) |
| 5087 30d6 9093 0000 sts (beeptime)+1,r25 |
| 5088 30da 8093 0000 sts beeptime,r24 |
| 5089 30de 8091 0000 lds r24,EE_Parameter+2 |
| 5090 30e2 A82F mov r26,r24 |
| 5091 30e4 B0E0 ldi r27,lo8(0) |
| 5092 30e6 AA0F lsl r26 |
| 5093 30e8 BB1F rol r27 |
| 5094 .L671: |
| 5095 30ea A050 subi r26,lo8(-(PPM_in)) |
| 5096 30ec B040 sbci r27,hi8(-(PPM_in)) |
| 5097 30ee 8D91 ld r24,X+ |
| 5098 30f0 9C91 ld r25,X |
| 5099 30f2 8B5A subi r24,lo8(-85) |
| 5100 30f4 9F4F sbci r25,hi8(-85) |
| 5101 30f6 04F0 brlt .+2 |
| 5102 30f8 00C0 rjmp .L661 |
| 5103 30fa 8091 0000 lds r24,EE_Parameter+3 |
| 5104 30fe C82E mov r12,r24 |
| 5105 3100 DD24 clr r13 |
| 5106 3102 CC0C lsl r12 |
| 5107 3104 DD1C rol r13 |
| 5108 3106 F601 movw r30,r12 |
| 5109 3108 E050 subi r30,lo8(-(PPM_in)) |
| 5110 310a F040 sbci r31,hi8(-(PPM_in)) |
| 5111 310c 8081 ld r24,Z |
| 5112 310e 9181 ldd r25,Z+1 |
| 5113 3110 855B subi r24,lo8(-75) |
| 5114 3112 9F4F sbci r25,hi8(-75) |
| 5115 3114 04F0 brlt .+4 |
| 5116 3116 0C94 0000 jmp .L718 |
| 5117 311a 8091 0000 lds r24,delay_einschalten.3076 |
| 5118 311e 8F5F subi r24,lo8(-(1)) |
| 5119 3120 8093 0000 sts delay_einschalten.3076,r24 |
| 5120 3124 893C cpi r24,lo8(-55) |
| 5121 3126 00F0 brlo .+4 |
| 5122 3128 0C94 0000 jmp .L1072 |
| 5123 .L720: |
| 5124 312c 60E0 ldi r22,lo8(PPM_in) |
| 5125 312e 70E0 ldi r23,hi8(PPM_in) |
| 5126 3130 C60E add r12,r22 |
| 5127 3132 D71E adc r13,r23 |
| 5128 3134 D601 movw r26,r12 |
| 5129 3136 8D91 ld r24,X+ |
| 5130 3138 9C91 ld r25,X |
| 5131 313a 8C34 cpi r24,76 |
| 5132 313c 9105 cpc r25,__zero_reg__ |
| 5133 313e 04F4 brge .+4 |
| 5134 3140 0C94 0000 jmp .L722 |
| 5135 3144 8091 0000 lds r24,delay_ausschalten.3077 |
| 5136 3148 8F5F subi r24,lo8(-(1)) |
| 5137 314a 8093 0000 sts delay_ausschalten.3077,r24 |
| 5138 314e 893C cpi r24,lo8(-55) |
| 5139 3150 00F4 brsh .+2 |
| 5140 3152 00C0 rjmp .L661 |
| 5141 3154 1092 0000 sts MotorenEin,__zero_reg__ |
| 5142 3158 88EC ldi r24,lo8(-56) |
| 5143 315a 8093 0000 sts delay_ausschalten.3077,r24 |
| 5144 315e 1092 0000 sts (modell_fliegt)+1,__zero_reg__ |
| 5145 3162 1092 0000 sts modell_fliegt,__zero_reg__ |
| 5146 3166 00C0 rjmp .L661 |
| 5147 .L725: |
| 5148 3168 0E94 0000 call ParameterZuordnung |
| 5149 316c 8091 0000 lds r24,EE_Parameter |
| 5150 3170 A82E mov r10,r24 |
| 5151 3172 BB24 clr r11 |
| 5152 3174 AA0C lsl r10 |
| 5153 3176 BB1C rol r11 |
| 5154 3178 F501 movw r30,r10 |
| 5155 317a E050 subi r30,lo8(-(PPM_in)) |
| 5156 317c F040 sbci r31,hi8(-(PPM_in)) |
| 5157 317e 2081 ld r18,Z |
| 5158 3180 3181 ldd r19,Z+1 |
| 5159 3182 8091 0000 lds r24,EE_Parameter+15 |
| 5160 3186 882E mov r8,r24 |
| 5161 3188 9924 clr r9 |
| 5162 318a F501 movw r30,r10 |
| 5163 318c E050 subi r30,lo8(-(PPM_diff)) |
| 5164 318e F040 sbci r31,hi8(-(PPM_diff)) |
| 5165 3190 0190 ld __tmp_reg__,Z+ |
| 5166 3192 F081 ld r31,Z |
| 5167 3194 E02D mov r30,__tmp_reg__ |
| 5168 3196 8091 0000 lds r24,EE_Parameter+16 |
| 5169 319a 682F mov r22,r24 |
| 5170 319c 70E0 ldi r23,lo8(0) |
| 5171 319e 289D mul r18,r8 |
| 5172 31a0 A001 movw r20,r0 |
| 5173 31a2 299D mul r18,r9 |
| 5174 31a4 500D add r21,r0 |
| 5175 31a6 389D mul r19,r8 |
| 5176 31a8 500D add r21,r0 |
| 5177 31aa 1124 clr r1 |
| 5178 31ac 2091 0000 lds r18,stick_nick.3095 |
| 5179 31b0 3091 0000 lds r19,(stick_nick.3095)+1 |
| 5180 31b4 C901 movw r24,r18 |
| 5181 31b6 880F lsl r24 |
| 5182 31b8 991F rol r25 |
| 5183 31ba 820F add r24,r18 |
| 5184 31bc 931F adc r25,r19 |
| 5185 31be 480F add r20,r24 |
| 5186 31c0 591F adc r21,r25 |
| 5187 31c2 57FF sbrs r21,7 |
| 5188 31c4 00C0 rjmp .+4 |
| 5189 31c6 0C94 0000 jmp .L1073 |
| 5190 .L728: |
| 5191 31ca 9A01 movw r18,r20 |
| 5192 31cc 3595 asr r19 |
| 5193 31ce 2795 ror r18 |
| 5194 31d0 3595 asr r19 |
| 5195 31d2 2795 ror r18 |
| 5196 31d4 E69F mul r30,r22 |
| 5197 31d6 C001 movw r24,r0 |
| 5198 31d8 E79F mul r30,r23 |
| 5199 31da 900D add r25,r0 |
| 5200 31dc F69F mul r31,r22 |
| 5201 31de 900D add r25,r0 |
| 5202 31e0 1124 clr r1 |
| 5203 31e2 280F add r18,r24 |
| 5204 31e4 391F adc r19,r25 |
| 5205 31e6 3093 0000 sts (stick_nick.3095)+1,r19 |
| 5206 31ea 2093 0000 sts stick_nick.3095,r18 |
| 5207 31ee 8091 0000 lds r24,GPS_Nick2 |
| 5208 31f2 9091 0000 lds r25,(GPS_Nick2)+1 |
| 5209 31f6 4091 0000 lds r20,GPS_Nick |
| 5210 31fa 5091 0000 lds r21,(GPS_Nick)+1 |
| 5211 31fe 6901 movw r12,r18 |
| 5212 3200 C81A sub r12,r24 |
| 5213 3202 D90A sbc r13,r25 |
| 5214 3204 C41A sub r12,r20 |
| 5215 3206 D50A sbc r13,r21 |
| 5216 3208 D092 0000 sts (StickNick)+1,r13 |
| 5217 320c C092 0000 sts StickNick,r12 |
| 5218 3210 8091 0000 lds r24,EE_Parameter+1 |
| 5219 3214 E82E mov r14,r24 |
| 5220 3216 FF24 clr r15 |
| 5221 3218 EE0C lsl r14 |
| 5222 321a FF1C rol r15 |
| 5223 321c F701 movw r30,r14 |
| 5224 321e E050 subi r30,lo8(-(PPM_in)) |
| 5225 3220 F040 sbci r31,hi8(-(PPM_in)) |
| 5226 3222 8081 ld r24,Z |
| 5227 3224 9181 ldd r25,Z+1 |
| 5228 3226 F701 movw r30,r14 |
| 5229 3228 E050 subi r30,lo8(-(PPM_diff)) |
| 5230 322a F040 sbci r31,hi8(-(PPM_diff)) |
| 5231 322c 0190 ld __tmp_reg__,Z+ |
| 5232 322e F081 ld r31,Z |
| 5233 3230 E02D mov r30,__tmp_reg__ |
| 5234 3232 889D mul r24,r8 |
| 5235 3234 A001 movw r20,r0 |
| 5236 3236 899D mul r24,r9 |
| 5237 3238 500D add r21,r0 |
| 5238 323a 989D mul r25,r8 |
| 5239 323c 500D add r21,r0 |
| 5240 323e 1124 clr r1 |
| 5241 3240 2091 0000 lds r18,stick_roll.3096 |
| 5242 3244 3091 0000 lds r19,(stick_roll.3096)+1 |
| 5243 3248 C901 movw r24,r18 |
| 5244 324a 880F lsl r24 |
| 5245 324c 991F rol r25 |
| 5246 324e 820F add r24,r18 |
| 5247 3250 931F adc r25,r19 |
| 5248 3252 480F add r20,r24 |
| 5249 3254 591F adc r21,r25 |
| 5250 3256 57FF sbrs r21,7 |
| 5251 3258 00C0 rjmp .+4 |
| 5252 325a 0C94 0000 jmp .L1074 |
| 5253 .L729: |
| 5254 325e 9A01 movw r18,r20 |
| 5255 3260 3595 asr r19 |
| 5256 3262 2795 ror r18 |
| 5257 3264 3595 asr r19 |
| 5258 3266 2795 ror r18 |
| 5259 3268 E69F mul r30,r22 |
| 5260 326a C001 movw r24,r0 |
| 5261 326c E79F mul r30,r23 |
| 5262 326e 900D add r25,r0 |
| 5263 3270 F69F mul r31,r22 |
| 5264 3272 900D add r25,r0 |
| 5265 3274 1124 clr r1 |
| 5266 3276 280F add r18,r24 |
| 5267 3278 391F adc r19,r25 |
| 5268 327a 3093 0000 sts (stick_roll.3096)+1,r19 |
| 5269 327e 2093 0000 sts stick_roll.3096,r18 |
| 5270 3282 8091 0000 lds r24,GPS_Roll2 |
| 5271 3286 9091 0000 lds r25,(GPS_Roll2)+1 |
| 5272 328a 4091 0000 lds r20,GPS_Roll |
| 5273 328e 5091 0000 lds r21,(GPS_Roll)+1 |
| 5274 3292 8901 movw r16,r18 |
| 5275 3294 081B sub r16,r24 |
| 5276 3296 190B sbc r17,r25 |
| 5277 3298 041B sub r16,r20 |
| 5278 329a 150B sbc r17,r21 |
| 5279 329c 1093 0000 sts (StickRoll)+1,r17 |
| 5280 32a0 0093 0000 sts StickRoll,r16 |
| 5281 32a4 E091 0000 lds r30,EE_Parameter+3 |
| 5282 32a8 F0E0 ldi r31,lo8(0) |
| 5283 32aa EE0F lsl r30 |
| 5284 32ac FF1F rol r31 |
| 5285 32ae E050 subi r30,lo8(-(PPM_in)) |
| 5286 32b0 F040 sbci r31,hi8(-(PPM_in)) |
| 5287 32b2 8081 ld r24,Z |
| 5288 32b4 9181 ldd r25,Z+1 |
| 5289 32b6 9095 com r25 |
| 5290 32b8 8195 neg r24 |
| 5291 32ba 9F4F sbci r25,lo8(-1) |
| 5292 32bc 9093 0000 sts (StickGier)+1,r25 |
| 5293 32c0 8093 0000 sts StickGier,r24 |
| 5294 32c4 8330 cpi r24,3 |
| 5295 32c6 9105 cpc r25,__zero_reg__ |
| 5296 32c8 04F4 brge .+2 |
| 5297 32ca 00C0 rjmp .L730 |
| 5298 32cc 0297 sbiw r24,2 |
| 5299 32ce 9093 0000 sts (StickGier)+1,r25 |
| 5300 32d2 8093 0000 sts StickGier,r24 |
| 5301 .L732: |
| 5302 32d6 E091 0000 lds r30,EE_Parameter+2 |
| 5303 32da F0E0 ldi r31,lo8(0) |
| 5304 32dc EE0F lsl r30 |
| 5305 32de FF1F rol r31 |
| 5306 32e0 E050 subi r30,lo8(-(PPM_in)) |
| 5307 32e2 F040 sbci r31,hi8(-(PPM_in)) |
| 5308 32e4 6080 ld r6,Z |
| 5309 32e6 7180 ldd r7,Z+1 |
| 5310 32e8 28E7 ldi r18,lo8(120) |
| 5311 32ea 30E0 ldi r19,hi8(120) |
| 5312 32ec 620E add r6,r18 |
| 5313 32ee 731E adc r7,r19 |
| 5314 32f0 7092 0000 sts (StickGas)+1,r7 |
| 5315 32f4 6092 0000 sts StickGas,r6 |
| 5316 32f8 6091 0000 lds r22,Parameter_Gyro_P |
| 5317 32fc 70E0 ldi r23,lo8(0) |
| 5318 32fe 8827 clr r24 |
| 5319 3300 77FD sbrc r23,7 |
| 5320 3302 8095 com r24 |
| 5321 3304 982F mov r25,r24 |
| 5322 3306 0E94 0000 call __floatsisf |
| 5323 330a 20E0 ldi r18,lo8(0x41200000) |
| 5324 330c 30E0 ldi r19,hi8(0x41200000) |
| 5325 330e 40E2 ldi r20,hlo8(0x41200000) |
| 5326 3310 51E4 ldi r21,hhi8(0x41200000) |
| 5327 3312 0E94 0000 call __addsf3 |
| 5328 3316 0E94 0000 call __fixunssfsi |
| 5329 331a 6093 0000 sts GyroFaktor,r22 |
| 5330 331e 3091 0000 lds r19,Parameter_Gyro_I |
| 5331 3322 3093 0000 sts IntegralFaktor,r19 |
| 5332 3326 8091 0000 lds r24,ExternControl+10 |
| 5333 332a 80FF sbrs r24,0 |
| 5334 332c 00C0 rjmp .L735 |
| 5335 332e 8091 0000 lds r24,Parameter_ExternalControl |
| 5336 3332 8138 cpi r24,lo8(-127) |
| 5337 3334 00F0 brlo .+4 |
| 5338 3336 0C94 0000 jmp .L1075 |
| 5339 .L735: |
| 5340 333a 8091 0000 lds r24,StickGas |
| 5341 333e 9091 0000 lds r25,(StickGas)+1 |
| 5342 3342 97FF sbrs r25,7 |
| 5343 3344 00C0 rjmp .+4 |
| 5344 3346 0C94 0000 jmp .L1076 |
| 5345 .L739: |
| 5346 334a B091 0000 lds r27,EE_Parameter+8 |
| 5347 334e B2FF sbrs r27,2 |
| 5348 3350 00C0 rjmp .L741 |
| 5349 3352 1092 0000 sts IntegralFaktor,__zero_reg__ |
| 5350 .L741: |
| 5351 3356 2091 0000 lds r18,StickNick |
| 5352 335a 3091 0000 lds r19,(StickNick)+1 |
| 5353 335e 4091 0000 lds r20,MaxStickNick |
| 5354 3362 5091 0000 lds r21,(MaxStickNick)+1 |
| 5355 3366 C901 movw r24,r18 |
| 5356 3368 37FF sbrs r19,7 |
| 5357 336a 00C0 rjmp .+4 |
| 5358 336c 0C94 0000 jmp .L1077 |
| 5359 .L744: |
| 5360 3370 9595 asr r25 |
| 5361 3372 8795 ror r24 |
| 5362 3374 9595 asr r25 |
| 5363 3376 8795 ror r24 |
| 5364 3378 97FF sbrs r25,7 |
| 5365 337a 00C0 rjmp .+4 |
| 5366 337c 0C94 0000 jmp .L1078 |
| 5367 .L745: |
| 5368 3380 4817 cp r20,r24 |
| 5369 3382 5907 cpc r21,r25 |
| 5370 3384 04F0 brlt .+2 |
| 5371 3386 00C0 rjmp .L743 |
| 5372 3388 C901 movw r24,r18 |
| 5373 338a 37FF sbrs r19,7 |
| 5374 338c 00C0 rjmp .+4 |
| 5375 338e 0C94 0000 jmp .L1079 |
| 5376 .L747: |
| 5377 3392 97FF sbrs r25,7 |
| 5378 3394 00C0 rjmp .+4 |
| 5379 3396 0C94 0000 jmp .L1080 |
| 5380 .L748: |
| 5381 339a 9595 asr r25 |
| 5382 339c 8795 ror r24 |
| 5383 339e 9595 asr r25 |
| 5384 33a0 8795 ror r24 |
| 5385 33a2 9093 0000 sts (MaxStickNick)+1,r25 |
| 5386 33a6 8093 0000 sts MaxStickNick,r24 |
| 5387 33aa 8536 cpi r24,101 |
| 5388 33ac 9105 cpc r25,__zero_reg__ |
| 5389 33ae 04F0 brlt .+4 |
| 5390 33b0 0C94 0000 jmp .L1081 |
| 5391 .L749: |
| 5392 33b4 2091 0000 lds r18,StickRoll |
| 5393 33b8 3091 0000 lds r19,(StickRoll)+1 |
| 5394 33bc 4091 0000 lds r20,MaxStickRoll |
| 5395 33c0 5091 0000 lds r21,(MaxStickRoll)+1 |
| 5396 33c4 C901 movw r24,r18 |
| 5397 33c6 37FF sbrs r19,7 |
| 5398 33c8 00C0 rjmp .+4 |
| 5399 33ca 0C94 0000 jmp .L1082 |
| 5400 33ce 9595 asr r25 |
| 5401 33d0 8795 ror r24 |
| 5402 33d2 9595 asr r25 |
| 5403 33d4 8795 ror r24 |
| 5404 33d6 97FF sbrs r25,7 |
| 5405 33d8 00C0 rjmp .+4 |
| 5406 33da 0C94 0000 jmp .L1083 |
| 5407 .L753: |
| 5408 33de 4817 cp r20,r24 |
| 5409 33e0 5907 cpc r21,r25 |
| 5410 33e2 04F0 brlt .+2 |
| 5411 33e4 00C0 rjmp .L751 |
| 5412 33e6 C901 movw r24,r18 |
| 5413 33e8 37FF sbrs r19,7 |
| 5414 33ea 00C0 rjmp .+4 |
| 5415 33ec 0C94 0000 jmp .L1084 |
| 5416 .L755: |
| 5417 33f0 97FF sbrs r25,7 |
| 5418 33f2 00C0 rjmp .+4 |
| 5419 33f4 0C94 0000 jmp .L1085 |
| 5420 .L756: |
| 5421 33f8 9595 asr r25 |
| 5422 33fa 8795 ror r24 |
| 5423 33fc 9595 asr r25 |
| 5424 33fe 8795 ror r24 |
| 5425 3400 9093 0000 sts (MaxStickRoll)+1,r25 |
| 5426 3404 8093 0000 sts MaxStickRoll,r24 |
| 5427 3408 8536 cpi r24,101 |
| 5428 340a 9105 cpc r25,__zero_reg__ |
| 5429 340c 04F0 brlt .+2 |
| 5430 340e 00C0 rjmp .L1086 |
| 5431 .L757: |
| 5432 3410 E091 0000 lds r30,Notlandung |
| 5433 3414 EFA3 std Y+39,r30 |
| 5434 3416 EE23 tst r30 |
| 5435 3418 01F0 breq .L759 |
| 5436 341a 1092 0000 sts (MaxStickNick)+1,__zero_reg__ |
| 5437 341e 1092 0000 sts MaxStickNick,__zero_reg__ |
| 5438 3422 1092 0000 sts (MaxStickRoll)+1,__zero_reg__ |
| 5439 3426 1092 0000 sts MaxStickRoll,__zero_reg__ |
| 5440 .L759: |
| 5441 342a F701 movw r30,r14 |
| 5442 342c E050 subi r30,lo8(-(PPM_in)) |
| 5443 342e F040 sbci r31,hi8(-(PPM_in)) |
| 5444 3430 2081 ld r18,Z |
| 5445 3432 3181 ldd r19,Z+1 |
| 5446 3434 8091 0000 lds r24,EE_Parameter+40 |
| 5447 3438 482F mov r20,r24 |
| 5448 343a 50E0 ldi r21,lo8(0) |
| 5449 343c 4217 cp r20,r18 |
| 5450 343e 5307 cpc r21,r19 |
| 5451 3440 04F4 brge .L761 |
| 5452 3442 8091 0000 lds r24,EE_Parameter+75 |
| 5453 3446 82FD sbrc r24,2 |
| 5454 3448 00C0 rjmp .L1087 |
| 5455 .L761: |
| 5456 344a F701 movw r30,r14 |
| 5457 344c E050 subi r30,lo8(-(PPM_in)) |
| 5458 344e F040 sbci r31,hi8(-(PPM_in)) |
| 5459 3450 2081 ld r18,Z |
| 5460 3452 3181 ldd r19,Z+1 |
| 5461 3454 8091 0000 lds r24,EE_Parameter+41 |
| 5462 3458 BA01 movw r22,r20 |
| 5463 345a 681B sub r22,r24 |
| 5464 345c 7109 sbc r23,__zero_reg__ |
| 5465 345e 2617 cp r18,r22 |
| 5466 3460 3707 cpc r19,r23 |
| 5467 3462 04F4 brge .L764 |
| 5468 3464 1092 0000 sts Looping_Links,__zero_reg__ |
| 5469 .L764: |
| 5470 3468 F701 movw r30,r14 |
| 5471 346a E050 subi r30,lo8(-(PPM_in)) |
| 5472 346c F040 sbci r31,hi8(-(PPM_in)) |
| 5473 346e 8081 ld r24,Z |
| 5474 3470 9181 ldd r25,Z+1 |
| 5475 3472 6627 clr r22 |
| 5476 3474 7727 clr r23 |
| 5477 3476 641B sub r22,r20 |
| 5478 3478 750B sbc r23,r21 |
| 5479 347a 8617 cp r24,r22 |
| 5480 347c 9707 cpc r25,r23 |
| 5481 347e 04F4 brge .L766 |
| 5482 3480 8091 0000 lds r24,EE_Parameter+75 |
| 5483 3484 83FD sbrc r24,3 |
| 5484 3486 00C0 rjmp .L1088 |
| 5485 .L766: |
| 5486 3488 8091 0000 lds r24,Looping_Rechts |
| 5487 348c 8823 tst r24 |
| 5488 348e 01F0 breq .L769 |
| 5489 3490 80E0 ldi r24,lo8(PPM_in) |
| 5490 3492 90E0 ldi r25,hi8(PPM_in) |
| 5491 3494 E80E add r14,r24 |
| 5492 3496 F91E adc r15,r25 |
| 5493 3498 F701 movw r30,r14 |
| 5494 349a 2081 ld r18,Z |
| 5495 349c 3181 ldd r19,Z+1 |
| 5496 349e 8091 0000 lds r24,EE_Parameter+41 |
| 5497 34a2 90E0 ldi r25,lo8(0) |
| 5498 34a4 841B sub r24,r20 |
| 5499 34a6 950B sbc r25,r21 |
| 5500 34a8 8217 cp r24,r18 |
| 5501 34aa 9307 cpc r25,r19 |
| 5502 34ac 04F4 brge .+4 |
| 5503 34ae 0C94 0000 jmp .L1089 |
| 5504 .L769: |
| 5505 34b2 F501 movw r30,r10 |
| 5506 34b4 E050 subi r30,lo8(-(PPM_in)) |
| 5507 34b6 F040 sbci r31,hi8(-(PPM_in)) |
| 5508 34b8 8081 ld r24,Z |
| 5509 34ba 9181 ldd r25,Z+1 |
| 5510 34bc 4817 cp r20,r24 |
| 5511 34be 5907 cpc r21,r25 |
| 5512 34c0 04F4 brge .L772 |
| 5513 34c2 8091 0000 lds r24,EE_Parameter+75 |
| 5514 34c6 80FD sbrc r24,0 |
| 5515 34c8 00C0 rjmp .L1090 |
| 5516 .L772: |
| 5517 34ca A091 0000 lds r26,Looping_Oben |
| 5518 34ce AA23 tst r26 |
| 5519 34d0 01F0 breq .L775 |
| 5520 34d2 F501 movw r30,r10 |
| 5521 34d4 E050 subi r30,lo8(-(PPM_in)) |
| 5522 34d6 F040 sbci r31,hi8(-(PPM_in)) |
| 5523 34d8 2081 ld r18,Z |
| 5524 34da 3181 ldd r19,Z+1 |
| 5525 34dc 8091 0000 lds r24,EE_Parameter+41 |
| 5526 34e0 FA01 movw r30,r20 |
| 5527 34e2 E81B sub r30,r24 |
| 5528 34e4 F109 sbc r31,__zero_reg__ |
| 5529 34e6 2E17 cp r18,r30 |
| 5530 34e8 3F07 cpc r19,r31 |
| 5531 34ea 04F4 brge .+4 |
| 5532 34ec 0C94 0000 jmp .L1091 |
| 5533 .L775: |
| 5534 34f0 F501 movw r30,r10 |
| 5535 34f2 E050 subi r30,lo8(-(PPM_in)) |
| 5536 34f4 F040 sbci r31,hi8(-(PPM_in)) |
| 5537 34f6 8081 ld r24,Z |
| 5538 34f8 9181 ldd r25,Z+1 |
| 5539 34fa 8617 cp r24,r22 |
| 5540 34fc 9707 cpc r25,r23 |
| 5541 34fe 04F4 brge .L778 |
| 5542 3500 8091 0000 lds r24,EE_Parameter+75 |
| 5543 3504 81FD sbrc r24,1 |
| 5544 3506 00C0 rjmp .L1092 |
| 5545 .L778: |
| 5546 3508 8091 0000 lds r24,Looping_Unten |
| 5547 350c 8823 tst r24 |
| 5548 350e 01F0 breq .L781 |
| 5549 3510 20E0 ldi r18,lo8(PPM_in) |
| 5550 3512 30E0 ldi r19,hi8(PPM_in) |
| 5551 3514 A20E add r10,r18 |
| 5552 3516 B31E adc r11,r19 |
| 5553 3518 F501 movw r30,r10 |
| 5554 351a 2081 ld r18,Z |
| 5555 351c 3181 ldd r19,Z+1 |
| 5556 351e 8091 0000 lds r24,EE_Parameter+41 |
| 5557 3522 90E0 ldi r25,lo8(0) |
| 5558 3524 841B sub r24,r20 |
| 5559 3526 950B sbc r25,r21 |
| 5560 3528 8217 cp r24,r18 |
| 5561 352a 9307 cpc r25,r19 |
| 5562 352c 04F4 brge .+4 |
| 5563 352e 0C94 0000 jmp .L1093 |
| 5564 .L781: |
| 5565 3532 8091 0000 lds r24,Looping_Links |
| 5566 3536 8823 tst r24 |
| 5567 3538 01F4 brne .L784 |
| 5568 353a 8091 0000 lds r24,Looping_Rechts |
| 5569 353e 8823 tst r24 |
| 5570 3540 01F4 brne .+2 |
| 5571 3542 00C0 rjmp .L786 |
| 5572 .L784: |
| 5573 3544 F1E0 ldi r31,lo8(1) |
| 5574 3546 F093 0000 sts Looping_Roll,r31 |
| 5575 .L787: |
| 5576 354a AA23 tst r26 |
| 5577 354c 01F4 brne .L788 |
| 5578 354e 8091 0000 lds r24,Looping_Unten |
| 5579 3552 8823 tst r24 |
| 5580 3554 01F4 brne .+2 |
| 5581 3556 00C0 rjmp .L790 |
| 5582 .L788: |
| 5583 3558 81E0 ldi r24,lo8(1) |
| 5584 355a 8093 0000 sts Looping_Nick,r24 |
| 5585 355e 1092 0000 sts Looping_Roll,__zero_reg__ |
| 5586 3562 1092 0000 sts Looping_Links,__zero_reg__ |
| 5587 3566 1092 0000 sts Looping_Rechts,__zero_reg__ |
| 5588 356a 00C0 rjmp .L791 |
| 5589 .L643: |
| 5590 356c 2998 cbi 37-0x20,1 |
| 5591 356e 00C0 rjmp .L645 |
| 5592 .L730: |
| 5593 3570 EFEF ldi r30,hi8(-2) |
| 5594 3572 8E3F cpi r24,lo8(-2) |
| 5595 3574 9E07 cpc r25,r30 |
| 5596 3576 04F0 brlt .+2 |
| 5597 3578 00C0 rjmp .L733 |
| 5598 357a 0296 adiw r24,2 |
| 5599 357c 9093 0000 sts (StickGier)+1,r25 |
| 5600 3580 8093 0000 sts StickGier,r24 |
| 5601 3584 00C0 rjmp .L732 |
| 5602 .L652: |
| 5603 3586 1092 0000 sts MotorenEin,__zero_reg__ |
| 5604 358a 1092 0000 sts Notlandung,__zero_reg__ |
| 5605 358e 4A30 cpi r20,lo8(10) |
| 5606 3590 01F0 breq .+2 |
| 5607 3592 00C0 rjmp .L1094 |
| 5608 .L655: |
| 5609 3594 289A sbi 37-0x20,0 |
| 5610 3596 00C0 rjmp .L658 |
| 5611 .L1049: |
| 5612 3598 8090 0000 lds r8,MesswertGier |
| 5613 359c 9090 0000 lds r9,(MesswertGier)+1 |
| 5614 .L909: |
| 5615 35a0 8091 0000 lds r24,TimerWerteausgabe.3087 |
| 5616 35a4 8150 subi r24,lo8(-(-1)) |
| 5617 35a6 8093 0000 sts TimerWerteausgabe.3087,r24 |
| 5618 35aa 8F3F cpi r24,lo8(-1) |
| 5619 35ac 01F4 brne .+2 |
| 5620 35ae 00C0 rjmp .L1095 |
| 5621 .L933: |
| 5622 35b0 BEA1 ldd r27,Y+38 |
| 5623 35b2 BB23 tst r27 |
| 5624 35b4 01F0 breq .L937 |
| 5625 35b6 1092 0000 sts SummeRoll.3068,__zero_reg__ |
| 5626 35ba 1092 0000 sts (SummeRoll.3068)+1,__zero_reg__ |
| 5627 35be 1092 0000 sts (SummeRoll.3068)+2,__zero_reg__ |
| 5628 35c2 1092 0000 sts (SummeRoll.3068)+3,__zero_reg__ |
| 5629 35c6 1092 0000 sts SummeNick.3067,__zero_reg__ |
| 5630 35ca 1092 0000 sts (SummeNick.3067)+1,__zero_reg__ |
| 5631 35ce 1092 0000 sts (SummeNick.3067)+2,__zero_reg__ |
| 5632 35d2 1092 0000 sts (SummeNick.3067)+3,__zero_reg__ |
| 5633 .L937: |
| 5634 35d6 E985 ldd r30,Y+9 |
| 5635 35d8 EE23 tst r30 |
| 5636 35da 01F4 brne .+2 |
| 5637 35dc 00C0 rjmp .L939 |
| 5638 35de 1F86 std Y+15,__zero_reg__ |
| 5639 35e0 1E86 std Y+14,__zero_reg__ |
| 5640 35e2 4424 clr r4 |
| 5641 35e4 5524 clr r5 |
| 5642 .L941: |
| 5643 35e6 2CA5 ldd r18,Y+44 |
| 5644 35e8 2223 tst r18 |
| 5645 35ea 01F4 brne .+2 |
| 5646 35ec 00C0 rjmp .L942 |
| 5647 35ee 1D86 std Y+13,__zero_reg__ |
| 5648 35f0 1C86 std Y+12,__zero_reg__ |
| 5649 35f2 2224 clr r2 |
| 5650 35f4 3324 clr r3 |
| 5651 .L944: |
| 5652 35f6 8091 0000 lds r24,TrimNick |
| 5653 35fa 9091 0000 lds r25,(TrimNick)+1 |
| 5654 35fe 893C cpi r24,201 |
| 5655 3600 9105 cpc r25,__zero_reg__ |
| 5656 3602 04F4 brge .+2 |
| 5657 3604 00C0 rjmp .L945 |
| 5658 3606 88EC ldi r24,lo8(200) |
| 5659 3608 90E0 ldi r25,hi8(200) |
| 5660 360a 9093 0000 sts (TrimNick)+1,r25 |
| 5661 360e 8093 0000 sts TrimNick,r24 |
| 5662 .L947: |
| 5663 3612 6091 0000 lds r22,TrimRoll |
| 5664 3616 7091 0000 lds r23,(TrimRoll)+1 |
| 5665 361a 7EA7 std Y+46,r23 |
| 5666 361c 6DA7 std Y+45,r22 |
| 5667 361e 693C cpi r22,201 |
| 5668 3620 7105 cpc r23,__zero_reg__ |
| 5669 3622 04F4 brge .+2 |
| 5670 3624 00C0 rjmp .L949 |
| 5671 3626 A8EC ldi r26,lo8(200) |
| 5672 3628 B0E0 ldi r27,hi8(200) |
| 5673 362a BEA7 std Y+46,r27 |
| 5674 362c ADA7 std Y+45,r26 |
| 5675 362e B093 0000 sts (TrimRoll)+1,r27 |
| 5676 3632 A093 0000 sts TrimRoll,r26 |
| 5677 .L951: |
| 5678 3636 A090 0000 lds r10,GyroFaktor |
| 5679 363a BB24 clr r11 |
| 5680 363c CC24 clr r12 |
| 5681 363e DD24 clr r13 |
| 5682 3640 7C01 movw r14,r24 |
| 5683 3642 0027 clr r16 |
| 5684 3644 F7FC sbrc r15,7 |
| 5685 3646 0095 com r16 |
| 5686 3648 102F mov r17,r16 |
| 5687 364a EE0C lsl r14 |
| 5688 364c FF1C rol r15 |
| 5689 364e 001F rol r16 |
| 5690 3650 111F rol r17 |
| 5691 3652 EE0C lsl r14 |
| 5692 3654 FF1C rol r15 |
| 5693 3656 001F rol r16 |
| 5694 3658 111F rol r17 |
| 5695 365a EE0C lsl r14 |
| 5696 365c FF1C rol r15 |
| 5697 365e 001F rol r16 |
| 5698 3660 111F rol r17 |
| 5699 3662 EE0C lsl r14 |
| 5700 3664 FF1C rol r15 |
| 5701 3666 001F rol r16 |
| 5702 3668 111F rol r17 |
| 5703 366a EE0C lsl r14 |
| 5704 366c FF1C rol r15 |
| 5705 366e 001F rol r16 |
| 5706 3670 111F rol r17 |
| 5707 3672 EE0C lsl r14 |
| 5708 3674 FF1C rol r15 |
| 5709 3676 001F rol r16 |
| 5710 3678 111F rol r17 |
| 5711 367a EE0C lsl r14 |
| 5712 367c FF1C rol r15 |
| 5713 367e 001F rol r16 |
| 5714 3680 111F rol r17 |
| 5715 3682 6090 0000 lds r6,MesswertNick |
| 5716 3686 7090 0000 lds r7,(MesswertNick)+1 |
| 5717 368a 9301 movw r18,r6 |
| 5718 368c 4427 clr r20 |
| 5719 368e 37FD sbrc r19,7 |
| 5720 3690 4095 com r20 |
| 5721 3692 542F mov r21,r20 |
| 5722 3694 C601 movw r24,r12 |
| 5723 3696 B501 movw r22,r10 |
| 5724 3698 0E94 0000 call __mulsi3 |
| 5725 369c E60E add r14,r22 |
| 5726 369e F71E adc r15,r23 |
| 5727 36a0 081F adc r16,r24 |
| 5728 36a2 191F adc r17,r25 |
| 5729 36a4 C801 movw r24,r16 |
| 5730 36a6 B701 movw r22,r14 |
| 5731 36a8 20E4 ldi r18,lo8(64) |
| 5732 36aa 30E0 ldi r19,hi8(64) |
| 5733 36ac 40E0 ldi r20,hlo8(64) |
| 5734 36ae 50E0 ldi r21,hhi8(64) |
| 5735 36b0 0E94 0000 call __divmodsi4 |
| 5736 36b4 3201 movw r6,r4 |
| 5737 36b6 620E add r6,r18 |
| 5738 36b8 731E adc r7,r19 |
| 5739 36ba 7092 0000 sts (MesswertNick)+1,r7 |
| 5740 36be 6092 0000 sts MesswertNick,r6 |
| 5741 36c2 6DA5 ldd r22,Y+45 |
| 5742 36c4 7EA5 ldd r23,Y+46 |
| 5743 36c6 7B01 movw r14,r22 |
| 5744 36c8 0027 clr r16 |
| 5745 36ca F7FC sbrc r15,7 |
| 5746 36cc 0095 com r16 |
| 5747 36ce 102F mov r17,r16 |
| 5748 36d0 EE0C lsl r14 |
| 5749 36d2 FF1C rol r15 |
| 5750 36d4 001F rol r16 |
| 5751 36d6 111F rol r17 |
| 5752 36d8 EE0C lsl r14 |
| 5753 36da FF1C rol r15 |
| 5754 36dc 001F rol r16 |
| 5755 36de 111F rol r17 |
| 5756 36e0 EE0C lsl r14 |
| 5757 36e2 FF1C rol r15 |
| 5758 36e4 001F rol r16 |
| 5759 36e6 111F rol r17 |
| 5760 36e8 EE0C lsl r14 |
| 5761 36ea FF1C rol r15 |
| 5762 36ec 001F rol r16 |
| 5763 36ee 111F rol r17 |
| 5764 36f0 EE0C lsl r14 |
| 5765 36f2 FF1C rol r15 |
| 5766 36f4 001F rol r16 |
| 5767 36f6 111F rol r17 |
| 5768 36f8 EE0C lsl r14 |
| 5769 36fa FF1C rol r15 |
| 5770 36fc 001F rol r16 |
| 5771 36fe 111F rol r17 |
| 5772 3700 EE0C lsl r14 |
| 5773 3702 FF1C rol r15 |
| 5774 3704 001F rol r16 |
| 5775 3706 111F rol r17 |
| 5776 3708 4090 0000 lds r4,MesswertRoll |
| 5777 370c 5090 0000 lds r5,(MesswertRoll)+1 |
| 5778 3710 B201 movw r22,r4 |
| 5779 3712 8827 clr r24 |
| 5780 3714 77FD sbrc r23,7 |
| 5781 3716 8095 com r24 |
| 5782 3718 982F mov r25,r24 |
| 5783 371a A601 movw r20,r12 |
| 5784 371c 9501 movw r18,r10 |
| 5785 371e 0E94 0000 call __mulsi3 |
| 5786 3722 E60E add r14,r22 |
| 5787 3724 F71E adc r15,r23 |
| 5788 3726 081F adc r16,r24 |
| 5789 3728 191F adc r17,r25 |
| 5790 372a C801 movw r24,r16 |
| 5791 372c B701 movw r22,r14 |
| 5792 372e 20E4 ldi r18,lo8(64) |
| 5793 3730 30E0 ldi r19,hi8(64) |
| 5794 3732 40E0 ldi r20,hlo8(64) |
| 5795 3734 50E0 ldi r21,hhi8(64) |
| 5796 3736 0E94 0000 call __divmodsi4 |
| 5797 373a 2101 movw r4,r2 |
| 5798 373c 420E add r4,r18 |
| 5799 373e 531E adc r5,r19 |
| 5800 3740 5092 0000 sts (MesswertRoll)+1,r5 |
| 5801 3744 4092 0000 sts MesswertRoll,r4 |
| 5802 3748 880C lsl r8 |
| 5803 374a 991C rol r9 |
| 5804 374c B401 movw r22,r8 |
| 5805 374e 8827 clr r24 |
| 5806 3750 77FD sbrc r23,7 |
| 5807 3752 8095 com r24 |
| 5808 3754 982F mov r25,r24 |
| 5809 3756 A601 movw r20,r12 |
| 5810 3758 9501 movw r18,r10 |
| 5811 375a 0E94 0000 call __mulsi3 |
| 5812 375e 20E4 ldi r18,lo8(64) |
| 5813 3760 30E0 ldi r19,hi8(64) |
| 5814 3762 40E0 ldi r20,hlo8(64) |
| 5815 3764 50E0 ldi r21,hhi8(64) |
| 5816 3766 0E94 0000 call __divmodsi4 |
| 5817 376a 7901 movw r14,r18 |
| 5818 376c 8A01 movw r16,r20 |
| 5819 376e ADA1 ldd r26,Y+37 |
| 5820 3770 6A2F mov r22,r26 |
| 5821 3772 70E0 ldi r23,lo8(0) |
| 5822 3774 80E0 ldi r24,lo8(0) |
| 5823 3776 90E0 ldi r25,hi8(0) |
| 5824 3778 2091 0000 lds r18,Integral_Gier |
| 5825 377c 3091 0000 lds r19,(Integral_Gier)+1 |
| 5826 3780 4091 0000 lds r20,(Integral_Gier)+2 |
| 5827 3784 5091 0000 lds r21,(Integral_Gier)+3 |
| 5828 3788 0E94 0000 call __mulsi3 |
| 5829 378c 20EF ldi r18,lo8(22000) |
| 5830 378e 35E5 ldi r19,hi8(22000) |
| 5831 3790 40E0 ldi r20,hlo8(22000) |
| 5832 3792 50E0 ldi r21,hhi8(22000) |
| 5833 3794 0E94 0000 call __divmodsi4 |
| 5834 3798 4701 movw r8,r14 |
| 5835 379a 820E add r8,r18 |
| 5836 379c 931E adc r9,r19 |
| 5837 379e 9092 0000 sts (MesswertGier)+1,r9 |
| 5838 37a2 8092 0000 sts MesswertGier,r8 |
| 5839 37a6 B1E0 ldi r27,lo8(16385) |
| 5840 37a8 6B16 cp r6,r27 |
| 5841 37aa B0E4 ldi r27,hi8(16385) |
| 5842 37ac 7B06 cpc r7,r27 |
| 5843 37ae 04F4 brge .+2 |
| 5844 37b0 00C0 rjmp .L953 |
| 5845 37b2 612C mov r6,__zero_reg__ |
| 5846 37b4 40E4 ldi r20,hi8(16384) |
| 5847 37b6 742E mov r7,r20 |
| 5848 37b8 7092 0000 sts (MesswertNick)+1,r7 |
| 5849 37bc 6092 0000 sts MesswertNick,r6 |
| 5850 .L955: |
| 5851 37c0 F1E0 ldi r31,lo8(16385) |
| 5852 37c2 4F16 cp r4,r31 |
| 5853 37c4 F0E4 ldi r31,hi8(16385) |
| 5854 37c6 5F06 cpc r5,r31 |
| 5855 37c8 04F4 brge .+2 |
| 5856 37ca 00C0 rjmp .L957 |
| 5857 37cc 412C mov r4,__zero_reg__ |
| 5858 37ce 20E4 ldi r18,hi8(16384) |
| 5859 37d0 522E mov r5,r18 |
| 5860 37d2 5092 0000 sts (MesswertRoll)+1,r5 |
| 5861 37d6 4092 0000 sts MesswertRoll,r4 |
| 5862 .L959: |
| 5863 37da 31E0 ldi r19,lo8(16385) |
| 5864 37dc 8316 cp r8,r19 |
| 5865 37de 30E4 ldi r19,hi8(16385) |
| 5866 37e0 9306 cpc r9,r19 |
| 5867 37e2 04F4 brge .+2 |
| 5868 37e4 00C0 rjmp .L961 |
| 5869 37e6 812C mov r8,__zero_reg__ |
| 5870 37e8 80E4 ldi r24,hi8(16384) |
| 5871 37ea 982E mov r9,r24 |
| 5872 37ec 9092 0000 sts (MesswertGier)+1,r9 |
| 5873 37f0 8092 0000 sts MesswertGier,r8 |
| 5874 .L963: |
| 5875 37f4 6889 ldd r22,Y+16 |
| 5876 37f6 7989 ldd r23,Y+17 |
| 5877 37f8 660F lsl r22 |
| 5878 37fa 771F rol r23 |
| 5879 37fc 660F lsl r22 |
| 5880 37fe 771F rol r23 |
| 5881 3800 7EA7 std Y+46,r23 |
| 5882 3802 6DA7 std Y+45,r22 |
| 5883 3804 7A85 ldd r23,Y+10 |
| 5884 3806 70FF sbrs r23,0 |
| 5885 3808 00C0 rjmp .L965 |
| 5886 380a 71FF sbrs r23,1 |
| 5887 380c 00C0 rjmp .L967 |
| 5888 380e 8091 0000 lds r24,EE_Parameter+75 |
| 5889 3812 84FD sbrc r24,4 |
| 5890 3814 00C0 rjmp .+4 |
| 5891 3816 0C94 0000 jmp .L969 |
| 5892 381a 8091 0000 lds r24,Parameter_MaxHoehe |
| 5893 381e 8155 subi r24,lo8(-(-81)) |
| 5894 3820 8B33 cpi r24,lo8(59) |
| 5895 3822 00F0 brlo .+4 |
| 5896 3824 0C94 0000 jmp .L972 |
| 5897 .L971: |
| 5898 3828 8091 0000 lds r24,delay.3112 |
| 5899 382c 8150 subi r24,lo8(-(-1)) |
| 5900 382e 8093 0000 sts delay.3112,r24 |
| 5901 3832 8F3F cpi r24,lo8(-1) |
| 5902 3834 01F4 brne .+4 |
| 5903 3836 0C94 0000 jmp .L1096 |
| 5904 383a 2091 0000 lds r18,HoehenWert |
| 5905 383e 3091 0000 lds r19,(HoehenWert)+1 |
| 5906 3842 00C0 rjmp .L973 |
| 5907 .L988: |
| 5908 3844 EDA5 ldd r30,Y+45 |
| 5909 3846 FEA5 ldd r31,Y+46 |
| 5910 3848 E217 cp r30,r18 |
| 5911 384a F307 cpc r31,r19 |
| 5912 384c 04F4 brge .L992 |
| 5913 384e F093 0000 sts (hoehenregler.3078)+1,r31 |
| 5914 3852 E093 0000 sts hoehenregler.3078,r30 |
| 5915 .L992: |
| 5916 3856 2091 0000 lds r18,hoehenregler.3078 |
| 5917 385a 3091 0000 lds r19,(hoehenregler.3078)+1 |
| 5918 385e 3EA7 std Y+46,r19 |
| 5919 3860 2DA7 std Y+45,r18 |
| 5920 .L965: |
| 5921 3862 8091 0000 lds r24,MAX_GAS |
| 5922 3866 282E mov r2,r24 |
| 5923 3868 3324 clr r3 |
| 5924 386a A101 movw r20,r2 |
| 5925 386c 440F lsl r20 |
| 5926 386e 551F rol r21 |
| 5927 3870 440F lsl r20 |
| 5928 3872 551F rol r21 |
| 5929 3874 CA01 movw r24,r20 |
| 5930 3876 8055 subi r24,lo8(-(-80)) |
| 5931 3878 9040 sbci r25,hi8(-(-80)) |
| 5932 387a 0DA5 ldd r16,Y+45 |
| 5933 387c 1EA5 ldd r17,Y+46 |
| 5934 387e 8017 cp r24,r16 |
| 5935 3880 9107 cpc r25,r17 |
| 5936 3882 04F4 brge .L994 |
| 5937 3884 8C01 movw r16,r24 |
| 5938 .L994: |
| 5939 3886 1093 0000 sts (DebugOut+16)+1,r17 |
| 5940 388a 0093 0000 sts DebugOut+16,r16 |
| 5941 388e 688D ldd r22,Y+24 |
| 5942 3890 798D ldd r23,Y+25 |
| 5943 3892 8A8D ldd r24,Y+26 |
| 5944 3894 9B8D ldd r25,Y+27 |
| 5945 3896 660F lsl r22 |
| 5946 3898 771F rol r23 |
| 5947 389a 881F rol r24 |
| 5948 389c 991F rol r25 |
| 5949 389e 660F lsl r22 |
| 5950 38a0 771F rol r23 |
| 5951 38a2 881F rol r24 |
| 5952 38a4 991F rol r25 |
| 5953 38a6 7401 movw r14,r8 |
| 5954 38a8 E61A sub r14,r22 |
| 5955 38aa F70A sbc r15,r23 |
| 5956 38ac 013A cpi r16,161 |
| 5957 38ae 1105 cpc r17,__zero_reg__ |
| 5958 38b0 04F4 brge .+2 |
| 5959 38b2 00C0 rjmp .L995 |
| 5960 38b4 9801 movw r18,r16 |
| 5961 38b6 3595 asr r19 |
| 5962 38b8 2795 ror r18 |
| 5963 38ba 2E15 cp r18,r14 |
| 5964 38bc 3F05 cpc r19,r15 |
| 5965 38be 04F0 brlt .L997 |
| 5966 38c0 F801 movw r30,r16 |
| 5967 38c2 17FF sbrs r17,7 |
| 5968 38c4 00C0 rjmp .+4 |
| 5969 38c6 0C94 0000 jmp .L1097 |
| 5970 .L999: |
| 5971 38ca F595 asr r31 |
| 5972 38cc E795 ror r30 |
| 5973 38ce 2227 clr r18 |
| 5974 38d0 3327 clr r19 |
| 5975 38d2 2E1B sub r18,r30 |
| 5976 38d4 3F0B sbc r19,r31 |
| 5977 38d6 2E15 cp r18,r14 |
| 5978 38d8 3F05 cpc r19,r15 |
| 5979 38da 04F4 brge .+4 |
| 5980 38dc 0C94 0000 jmp .L1098 |
| 5981 .L997: |
| 5982 38e0 CA01 movw r24,r20 |
| 5983 38e2 801B sub r24,r16 |
| 5984 38e4 910B sbc r25,r17 |
| 5985 38e6 8217 cp r24,r18 |
| 5986 38e8 9307 cpc r25,r19 |
| 5987 38ea 04F4 brge .L1003 |
| 5988 38ec 9C01 movw r18,r24 |
| 5989 .L1003: |
| 5990 38ee C801 movw r24,r16 |
| 5991 38f0 841B sub r24,r20 |
| 5992 38f2 950B sbc r25,r21 |
| 5993 38f4 5901 movw r10,r18 |
| 5994 38f6 2817 cp r18,r24 |
| 5995 38f8 3907 cpc r19,r25 |
| 5996 38fa 04F4 brge .L1004 |
| 5997 38fc 5C01 movw r10,r24 |
| 5998 .L1004: |
| 5999 38fe 8091 0000 lds r24,StickNick |
| 6000 3902 9091 0000 lds r25,(StickNick)+1 |
| 6001 3906 6301 movw r12,r6 |
| 6002 3908 C81A sub r12,r24 |
| 6003 390a D90A sbc r13,r25 |
| 6004 390c D092 0000 sts (DiffNick)+1,r13 |
| 6005 3910 C092 0000 sts DiffNick,r12 |
| 6006 3914 ADA1 ldd r26,Y+37 |
| 6007 3916 AA23 tst r26 |
| 6008 3918 01F4 brne .+2 |
| 6009 391a 00C0 rjmp .L1005 |
| 6010 391c EE85 ldd r30,Y+14 |
| 6011 391e FF85 ldd r31,Y+15 |
| 6012 3920 E81B sub r30,r24 |
| 6013 3922 F90B sbc r31,r25 |
| 6014 3924 CF01 movw r24,r30 |
| 6015 3926 AA27 clr r26 |
| 6016 3928 97FD sbrc r25,7 |
| 6017 392a A095 com r26 |
| 6018 392c BA2F mov r27,r26 |
| 6019 392e 2091 0000 lds r18,SummeNick.3067 |
| 6020 3932 3091 0000 lds r19,(SummeNick.3067)+1 |
| 6021 3936 4091 0000 lds r20,(SummeNick.3067)+2 |
| 6022 393a 5091 0000 lds r21,(SummeNick.3067)+3 |
| 6023 393e 280F add r18,r24 |
| 6024 3940 391F adc r19,r25 |
| 6025 3942 4A1F adc r20,r26 |
| 6026 3944 5B1F adc r21,r27 |
| 6027 3946 2093 0000 sts SummeNick.3067,r18 |
| 6028 394a 3093 0000 sts (SummeNick.3067)+1,r19 |
| 6029 394e 4093 0000 sts (SummeNick.3067)+2,r20 |
| 6030 3952 5093 0000 sts (SummeNick.3067)+3,r21 |
| 6031 .L1007: |
| 6032 3956 2130 cpi r18,lo8(64001) |
| 6033 3958 FAEF ldi r31,hi8(64001) |
| 6034 395a 3F07 cpc r19,r31 |
| 6035 395c F0E0 ldi r31,hlo8(64001) |
| 6036 395e 4F07 cpc r20,r31 |
| 6037 3960 F0E0 ldi r31,hhi8(64001) |
| 6038 3962 5F07 cpc r21,r31 |
| 6039 3964 04F4 brge .+2 |
| 6040 3966 00C0 rjmp .L1008 |
| 6041 3968 20E0 ldi r18,lo8(64000) |
| 6042 396a 3AEF ldi r19,hi8(64000) |
| 6043 396c 40E0 ldi r20,hlo8(64000) |
| 6044 396e 50E0 ldi r21,hhi8(64000) |
| 6045 3970 2093 0000 sts SummeNick.3067,r18 |
| 6046 3974 3093 0000 sts (SummeNick.3067)+1,r19 |
| 6047 3978 4093 0000 sts (SummeNick.3067)+2,r20 |
| 6048 397c 5093 0000 sts (SummeNick.3067)+3,r21 |
| 6049 .L1010: |
| 6050 3980 8091 0000 lds r24,Ki |
| 6051 3984 9091 0000 lds r25,(Ki)+1 |
| 6052 3988 3C01 movw r6,r24 |
| 6053 398a 8824 clr r8 |
| 6054 398c 77FC sbrc r7,7 |
| 6055 398e 8094 com r8 |
| 6056 3990 982C mov r9,r8 |
| 6057 3992 CA01 movw r24,r20 |
| 6058 3994 B901 movw r22,r18 |
| 6059 3996 A401 movw r20,r8 |
| 6060 3998 9301 movw r18,r6 |
| 6061 399a 0E94 0000 call __divmodsi4 |
| 6062 399e C20E add r12,r18 |
| 6063 39a0 D31E adc r13,r19 |
| 6064 39a2 B501 movw r22,r10 |
| 6065 39a4 B7FC sbrc r11,7 |
| 6066 39a6 00C0 rjmp .L1099 |
| 6067 .L1012: |
| 6068 39a8 77FD sbrc r23,7 |
| 6069 39aa 00C0 rjmp .L1100 |
| 6070 .L1013: |
| 6071 39ac 7595 asr r23 |
| 6072 39ae 6795 ror r22 |
| 6073 39b0 600F add r22,r16 |
| 6074 39b2 711F adc r23,r17 |
| 6075 39b4 8827 clr r24 |
| 6076 39b6 77FD sbrc r23,7 |
| 6077 39b8 8095 com r24 |
| 6078 39ba 982F mov r25,r24 |
| 6079 39bc 2091 0000 lds r18,Parameter_DynamicStability |
| 6080 39c0 30E0 ldi r19,lo8(0) |
| 6081 39c2 40E0 ldi r20,lo8(0) |
| 6082 39c4 50E0 ldi r21,hi8(0) |
| 6083 39c6 0E94 0000 call __mulsi3 |
| 6084 39ca 20E4 ldi r18,lo8(64) |
| 6085 39cc 30E0 ldi r19,hi8(64) |
| 6086 39ce 40E0 ldi r20,hlo8(64) |
| 6087 39d0 50E0 ldi r21,hhi8(64) |
| 6088 39d2 0E94 0000 call __divmodsi4 |
| 6089 39d6 7901 movw r14,r18 |
| 6090 39d8 C216 cp r12,r18 |
| 6091 39da D306 cpc r13,r19 |
| 6092 39dc 04F4 brge .L1014 |
| 6093 39de 9601 movw r18,r12 |
| 6094 .L1014: |
| 6095 39e0 CC24 clr r12 |
| 6096 39e2 DD24 clr r13 |
| 6097 39e4 CE18 sub r12,r14 |
| 6098 39e6 DF08 sbc r13,r15 |
| 6099 39e8 DB8A std Y+19,r13 |
| 6100 39ea CA8A std Y+18,r12 |
| 6101 39ec C216 cp r12,r18 |
| 6102 39ee D306 cpc r13,r19 |
| 6103 39f0 04F4 brge .L1015 |
| 6104 39f2 6901 movw r12,r18 |
| 6105 .L1015: |
| 6106 39f4 8091 0000 lds r24,StickRoll |
| 6107 39f8 9091 0000 lds r25,(StickRoll)+1 |
| 6108 39fc 481A sub r4,r24 |
| 6109 39fe 590A sbc r5,r25 |
| 6110 3a00 5092 0000 sts (DiffRoll)+1,r5 |
| 6111 3a04 4092 0000 sts DiffRoll,r4 |
| 6112 3a08 7DA1 ldd r23,Y+37 |
| 6113 3a0a 7723 tst r23 |
| 6114 3a0c 01F4 brne .+2 |
| 6115 3a0e 00C0 rjmp .L1016 |
| 6116 3a10 AC85 ldd r26,Y+12 |
| 6117 3a12 BD85 ldd r27,Y+13 |
| 6118 3a14 A81B sub r26,r24 |
| 6119 3a16 B90B sbc r27,r25 |
| 6120 3a18 FD01 movw r30,r26 |
| 6121 3a1a CF01 movw r24,r30 |
| 6122 3a1c AA27 clr r26 |
| 6123 3a1e 97FD sbrc r25,7 |
| 6124 3a20 A095 com r26 |
| 6125 3a22 BA2F mov r27,r26 |
| 6126 3a24 2091 0000 lds r18,SummeRoll.3068 |
| 6127 3a28 3091 0000 lds r19,(SummeRoll.3068)+1 |
| 6128 3a2c 4091 0000 lds r20,(SummeRoll.3068)+2 |
| 6129 3a30 5091 0000 lds r21,(SummeRoll.3068)+3 |
| 6130 3a34 280F add r18,r24 |
| 6131 3a36 391F adc r19,r25 |
| 6132 3a38 4A1F adc r20,r26 |
| 6133 3a3a 5B1F adc r21,r27 |
| 6134 3a3c 2093 0000 sts SummeRoll.3068,r18 |
| 6135 3a40 3093 0000 sts (SummeRoll.3068)+1,r19 |
| 6136 3a44 4093 0000 sts (SummeRoll.3068)+2,r20 |
| 6137 3a48 5093 0000 sts (SummeRoll.3068)+3,r21 |
| 6138 .L1018: |
| 6139 3a4c 2130 cpi r18,lo8(64001) |
| 6140 3a4e FAEF ldi r31,hi8(64001) |
| 6141 3a50 3F07 cpc r19,r31 |
| 6142 3a52 F0E0 ldi r31,hlo8(64001) |
| 6143 3a54 4F07 cpc r20,r31 |
| 6144 3a56 F0E0 ldi r31,hhi8(64001) |
| 6145 3a58 5F07 cpc r21,r31 |
| 6146 3a5a 04F4 brge .+2 |
| 6147 3a5c 00C0 rjmp .L1019 |
| 6148 3a5e 20E0 ldi r18,lo8(64000) |
| 6149 3a60 3AEF ldi r19,hi8(64000) |
| 6150 3a62 40E0 ldi r20,hlo8(64000) |
| 6151 3a64 50E0 ldi r21,hhi8(64000) |
| 6152 3a66 2093 0000 sts SummeRoll.3068,r18 |
| 6153 3a6a 3093 0000 sts (SummeRoll.3068)+1,r19 |
| 6154 3a6e 4093 0000 sts (SummeRoll.3068)+2,r20 |
| 6155 3a72 5093 0000 sts (SummeRoll.3068)+3,r21 |
| 6156 .L1021: |
| 6157 3a76 CA01 movw r24,r20 |
| 6158 3a78 B901 movw r22,r18 |
| 6159 3a7a A401 movw r20,r8 |
| 6160 3a7c 9301 movw r18,r6 |
| 6161 3a7e 0E94 0000 call __divmodsi4 |
| 6162 3a82 B201 movw r22,r4 |
| 6163 3a84 620F add r22,r18 |
| 6164 3a86 731F adc r23,r19 |
| 6165 3a88 9701 movw r18,r14 |
| 6166 3a8a 6E15 cp r22,r14 |
| 6167 3a8c 7F05 cpc r23,r15 |
| 6168 3a8e 04F4 brge .L1023 |
| 6169 3a90 9B01 movw r18,r22 |
| 6170 .L1023: |
| 6171 3a92 7901 movw r14,r18 |
| 6172 3a94 8A89 ldd r24,Y+18 |
| 6173 3a96 9B89 ldd r25,Y+19 |
| 6174 3a98 2817 cp r18,r24 |
| 6175 3a9a 3907 cpc r19,r25 |
| 6176 3a9c 04F4 brge .L1024 |
| 6177 3a9e 7C01 movw r14,r24 |
| 6178 .L1024: |
| 6179 3aa0 4501 movw r8,r10 |
| 6180 3aa2 800E add r8,r16 |
| 6181 3aa4 911E adc r9,r17 |
| 6182 3aa6 6091 0000 lds r22,motorwert1.3079 |
| 6183 3aaa 7091 0000 lds r23,(motorwert1.3079)+1 |
| 6184 3aae C601 movw r24,r12 |
| 6185 3ab0 880D add r24,r8 |
| 6186 3ab2 991D adc r25,r9 |
| 6187 3ab4 0E94 0000 call MotorSmoothing |
| 6188 3ab8 9093 0000 sts (motorwert1.3079)+1,r25 |
| 6189 3abc 8093 0000 sts motorwert1.3079,r24 |
| 6190 3ac0 97FD sbrc r25,7 |
| 6191 3ac2 00C0 rjmp .L1101 |
| 6192 .L1025: |
| 6193 3ac4 9C01 movw r18,r24 |
| 6194 3ac6 3595 asr r19 |
| 6195 3ac8 2795 ror r18 |
| 6196 3aca 3595 asr r19 |
| 6197 3acc 2795 ror r18 |
| 6198 3ace 8091 0000 lds r24,MIN_GAS |
| 6199 3ad2 682E mov r6,r24 |
| 6200 3ad4 7724 clr r7 |
| 6201 3ad6 2615 cp r18,r6 |
| 6202 3ad8 3705 cpc r19,r7 |
| 6203 3ada 04F0 brlt .+2 |
| 6204 3adc 00C0 rjmp .L1026 |
| 6205 3ade C301 movw r24,r6 |
| 6206 .L1028: |
| 6207 3ae0 8093 0000 sts Motor_Vorne,r24 |
| 6208 3ae4 6091 0000 lds r22,motorwert2.3080 |
| 6209 3ae8 7091 0000 lds r23,(motorwert2.3080)+1 |
| 6210 3aec C401 movw r24,r8 |
| 6211 3aee 8C19 sub r24,r12 |
| 6212 3af0 9D09 sbc r25,r13 |
| 6213 3af2 0E94 0000 call MotorSmoothing |
| 6214 3af6 9093 0000 sts (motorwert2.3080)+1,r25 |
| 6215 3afa 8093 0000 sts motorwert2.3080,r24 |
| 6216 3afe 97FD sbrc r25,7 |
| 6217 3b00 00C0 rjmp .L1102 |
| 6218 .L1030: |
| 6219 3b02 9595 asr r25 |
| 6220 3b04 8795 ror r24 |
| 6221 3b06 9595 asr r25 |
| 6222 3b08 8795 ror r24 |
| 6223 3b0a 8615 cp r24,r6 |
| 6224 3b0c 9705 cpc r25,r7 |
| 6225 3b0e 04F0 brlt .+2 |
| 6226 3b10 00C0 rjmp .L1031 |
| 6227 3b12 C301 movw r24,r6 |
| 6228 .L1033: |
| 6229 3b14 8093 0000 sts Motor_Hinten,r24 |
| 6230 3b18 6091 0000 lds r22,motorwert3.3081 |
| 6231 3b1c 7091 0000 lds r23,(motorwert3.3081)+1 |
| 6232 3b20 C801 movw r24,r16 |
| 6233 3b22 8A19 sub r24,r10 |
| 6234 3b24 9B09 sbc r25,r11 |
| 6235 3b26 8E0D add r24,r14 |
| 6236 3b28 9F1D adc r25,r15 |
| 6237 3b2a 0E94 0000 call MotorSmoothing |
| 6238 3b2e 9093 0000 sts (motorwert3.3081)+1,r25 |
| 6239 3b32 8093 0000 sts motorwert3.3081,r24 |
| 6240 3b36 97FD sbrc r25,7 |
| 6241 3b38 00C0 rjmp .L1103 |
| 6242 .L1035: |
| 6243 3b3a 9595 asr r25 |
| 6244 3b3c 8795 ror r24 |
| 6245 3b3e 9595 asr r25 |
| 6246 3b40 8795 ror r24 |
| 6247 3b42 8615 cp r24,r6 |
| 6248 3b44 9705 cpc r25,r7 |
| 6249 3b46 04F4 brge .L1036 |
| 6250 3b48 C301 movw r24,r6 |
| 6251 .L1038: |
| 6252 3b4a 8093 0000 sts Motor_Links,r24 |
| 6253 3b4e 6091 0000 lds r22,motorwert4.3082 |
| 6254 3b52 7091 0000 lds r23,(motorwert4.3082)+1 |
| 6255 3b56 0E19 sub r16,r14 |
| 6256 3b58 1F09 sbc r17,r15 |
| 6257 3b5a C801 movw r24,r16 |
| 6258 3b5c 8A19 sub r24,r10 |
| 6259 3b5e 9B09 sbc r25,r11 |
| 6260 3b60 0E94 0000 call MotorSmoothing |
| 6261 3b64 9093 0000 sts (motorwert4.3082)+1,r25 |
| 6262 3b68 8093 0000 sts motorwert4.3082,r24 |
| 6263 3b6c 97FD sbrc r25,7 |
| 6264 3b6e 00C0 rjmp .L1104 |
| 6265 .L1040: |
| 6266 3b70 9595 asr r25 |
| 6267 3b72 8795 ror r24 |
| 6268 3b74 9595 asr r25 |
| 6269 3b76 8795 ror r24 |
| 6270 3b78 8615 cp r24,r6 |
| 6271 3b7a 9705 cpc r25,r7 |
| 6272 3b7c 04F4 brge .+4 |
| 6273 3b7e 0C94 0000 jmp .L1041 |
| 6274 3b82 3C01 movw r6,r24 |
| 6275 3b84 2816 cp r2,r24 |
| 6276 3b86 3906 cpc r3,r25 |
| 6277 3b88 04F0 brlt .+4 |
| 6278 3b8a 0C94 0000 jmp .L1041 |
| 6279 3b8e 3101 movw r6,r2 |
| 6280 3b90 0C94 0000 jmp .L1041 |
| 6281 .L1036: |
| 6282 3b94 2816 cp r2,r24 |
| 6283 3b96 3906 cpc r3,r25 |
| 6284 3b98 04F4 brge .L1038 |
| 6285 3b9a C101 movw r24,r2 |
| 6286 3b9c 00C0 rjmp .L1038 |
| 6287 .L1031: |
| 6288 3b9e 2816 cp r2,r24 |
| 6289 3ba0 3906 cpc r3,r25 |
| 6290 3ba2 04F0 brlt .+2 |
| 6291 3ba4 00C0 rjmp .L1033 |
| 6292 3ba6 C101 movw r24,r2 |
| 6293 3ba8 00C0 rjmp .L1033 |
| 6294 .L1026: |
| 6295 3baa C901 movw r24,r18 |
| 6296 3bac 2216 cp r2,r18 |
| 6297 3bae 3306 cpc r3,r19 |
| 6298 3bb0 04F0 brlt .+2 |
| 6299 3bb2 00C0 rjmp .L1028 |
| 6300 3bb4 C101 movw r24,r2 |
| 6301 3bb6 00C0 rjmp .L1028 |
| 6302 .L1019: |
| 6303 3bb8 2030 cpi r18,lo8(-64000) |
| 6304 3bba 66E0 ldi r22,hi8(-64000) |
| 6305 3bbc 3607 cpc r19,r22 |
| 6306 3bbe 6FEF ldi r22,hlo8(-64000) |
| 6307 3bc0 4607 cpc r20,r22 |
| 6308 3bc2 6FEF ldi r22,hhi8(-64000) |
| 6309 3bc4 5607 cpc r21,r22 |
| 6310 3bc6 04F0 brlt .+2 |
| 6311 3bc8 00C0 rjmp .L1021 |
| 6312 3bca 20E0 ldi r18,lo8(-64000) |
| 6313 3bcc 36E0 ldi r19,hi8(-64000) |
| 6314 3bce 4FEF ldi r20,hlo8(-64000) |
| 6315 3bd0 5FEF ldi r21,hhi8(-64000) |
| 6316 3bd2 2093 0000 sts SummeRoll.3068,r18 |
| 6317 3bd6 3093 0000 sts (SummeRoll.3068)+1,r19 |
| 6318 3bda 4093 0000 sts (SummeRoll.3068)+2,r20 |
| 6319 3bde 5093 0000 sts (SummeRoll.3068)+3,r21 |
| 6320 3be2 00C0 rjmp .L1021 |
| 6321 .L1016: |
| 6322 3be4 C201 movw r24,r4 |
| 6323 3be6 AA27 clr r26 |
| 6324 3be8 97FD sbrc r25,7 |
| 6325 3bea A095 com r26 |
| 6326 3bec BA2F mov r27,r26 |
| 6327 3bee 2091 0000 lds r18,SummeRoll.3068 |
| 6328 3bf2 3091 0000 lds r19,(SummeRoll.3068)+1 |
| 6329 3bf6 4091 0000 lds r20,(SummeRoll.3068)+2 |
| 6330 3bfa 5091 0000 lds r21,(SummeRoll.3068)+3 |
| 6331 3bfe 280F add r18,r24 |
| 6332 3c00 391F adc r19,r25 |
| 6333 3c02 4A1F adc r20,r26 |
| 6334 3c04 5B1F adc r21,r27 |
| 6335 3c06 2093 0000 sts SummeRoll.3068,r18 |
| 6336 3c0a 3093 0000 sts (SummeRoll.3068)+1,r19 |
| 6337 3c0e 4093 0000 sts (SummeRoll.3068)+2,r20 |
| 6338 3c12 5093 0000 sts (SummeRoll.3068)+3,r21 |
| 6339 3c16 00C0 rjmp .L1018 |
| 6340 .L1008: |
| 6341 3c18 2030 cpi r18,lo8(-64000) |
| 6342 3c1a 66E0 ldi r22,hi8(-64000) |
| 6343 3c1c 3607 cpc r19,r22 |
| 6344 3c1e 6FEF ldi r22,hlo8(-64000) |
| 6345 3c20 4607 cpc r20,r22 |
| 6346 3c22 6FEF ldi r22,hhi8(-64000) |
| 6347 3c24 5607 cpc r21,r22 |
| 6348 3c26 04F0 brlt .+2 |
| 6349 3c28 00C0 rjmp .L1010 |
| 6350 3c2a 20E0 ldi r18,lo8(-64000) |
| 6351 3c2c 36E0 ldi r19,hi8(-64000) |
| 6352 3c2e 4FEF ldi r20,hlo8(-64000) |
| 6353 3c30 5FEF ldi r21,hhi8(-64000) |
| 6354 3c32 2093 0000 sts SummeNick.3067,r18 |
| 6355 3c36 3093 0000 sts (SummeNick.3067)+1,r19 |
| 6356 3c3a 4093 0000 sts (SummeNick.3067)+2,r20 |
| 6357 3c3e 5093 0000 sts (SummeNick.3067)+3,r21 |
| 6358 3c42 00C0 rjmp .L1010 |
| 6359 .L1005: |
| 6360 3c44 C601 movw r24,r12 |
| 6361 3c46 AA27 clr r26 |
| 6362 3c48 97FD sbrc r25,7 |
| 6363 3c4a A095 com r26 |
| 6364 3c4c BA2F mov r27,r26 |
| 6365 3c4e 2091 0000 lds r18,SummeNick.3067 |
| 6366 3c52 3091 0000 lds r19,(SummeNick.3067)+1 |
| 6367 3c56 4091 0000 lds r20,(SummeNick.3067)+2 |
| 6368 3c5a 5091 0000 lds r21,(SummeNick.3067)+3 |
| 6369 3c5e 280F add r18,r24 |
| 6370 3c60 391F adc r19,r25 |
| 6371 3c62 4A1F adc r20,r26 |
| 6372 3c64 5B1F adc r21,r27 |
| 6373 3c66 2093 0000 sts SummeNick.3067,r18 |
| 6374 3c6a 3093 0000 sts (SummeNick.3067)+1,r19 |
| 6375 3c6e 4093 0000 sts (SummeNick.3067)+2,r20 |
| 6376 3c72 5093 0000 sts (SummeNick.3067)+3,r21 |
| 6377 3c76 00C0 rjmp .L1007 |
| 6378 .L995: |
| 6379 3c78 9701 movw r18,r14 |
| 6380 3c7a 7FEF ldi r23,hi8(-80) |
| 6381 3c7c 203B cpi r18,lo8(-80) |
| 6382 3c7e 3707 cpc r19,r23 |
| 6383 3c80 04F4 brge .L1001 |
| 6384 3c82 20EB ldi r18,lo8(-80) |
| 6385 3c84 3FEF ldi r19,hi8(-80) |
| 6386 .L1001: |
| 6387 3c86 2135 cpi r18,81 |
| 6388 3c88 3105 cpc r19,__zero_reg__ |
| 6389 3c8a 04F4 brge .+2 |
| 6390 3c8c 00C0 rjmp .L997 |
| 6391 3c8e 20E5 ldi r18,lo8(80) |
| 6392 3c90 30E0 ldi r19,hi8(80) |
| 6393 3c92 00C0 rjmp .L997 |
| 6394 .L961: |
| 6395 3c94 40E0 ldi r20,lo8(-16384) |
| 6396 3c96 8416 cp r8,r20 |
| 6397 3c98 40EC ldi r20,hi8(-16384) |
| 6398 3c9a 9406 cpc r9,r20 |
| 6399 3c9c 04F0 brlt .+2 |
| 6400 3c9e 00C0 rjmp .L963 |
| 6401 3ca0 812C mov r8,__zero_reg__ |
| 6402 3ca2 00EC ldi r16,hi8(-16384) |
| 6403 3ca4 902E mov r9,r16 |
| 6404 3ca6 9092 0000 sts (MesswertGier)+1,r9 |
| 6405 3caa 8092 0000 sts MesswertGier,r8 |
| 6406 3cae 00C0 rjmp .L963 |
| 6407 .L957: |
| 6408 3cb0 20E0 ldi r18,lo8(-16384) |
| 6409 3cb2 4216 cp r4,r18 |
| 6410 3cb4 20EC ldi r18,hi8(-16384) |
| 6411 3cb6 5206 cpc r5,r18 |
| 6412 3cb8 04F0 brlt .+2 |
| 6413 3cba 00C0 rjmp .L959 |
| 6414 3cbc 412C mov r4,__zero_reg__ |
| 6415 3cbe 90EC ldi r25,hi8(-16384) |
| 6416 3cc0 592E mov r5,r25 |
| 6417 3cc2 5092 0000 sts (MesswertRoll)+1,r5 |
| 6418 3cc6 4092 0000 sts MesswertRoll,r4 |
| 6419 3cca 00C0 rjmp .L959 |
| 6420 .L953: |
| 6421 3ccc E0E0 ldi r30,lo8(-16384) |
| 6422 3cce 6E16 cp r6,r30 |
| 6423 3cd0 E0EC ldi r30,hi8(-16384) |
| 6424 3cd2 7E06 cpc r7,r30 |
| 6425 3cd4 04F0 brlt .+2 |
| 6426 3cd6 00C0 rjmp .L955 |
| 6427 3cd8 612C mov r6,__zero_reg__ |
| 6428 3cda 30EC ldi r19,hi8(-16384) |
| 6429 3cdc 732E mov r7,r19 |
| 6430 3cde 7092 0000 sts (MesswertNick)+1,r7 |
| 6431 3ce2 6092 0000 sts MesswertNick,r6 |
| 6432 3ce6 00C0 rjmp .L955 |
| 6433 .L949: |
| 6434 3ce8 EDA5 ldd r30,Y+45 |
| 6435 3cea FEA5 ldd r31,Y+46 |
| 6436 3cec E853 subi r30,lo8(-200) |
| 6437 3cee FF4F sbci r31,hi8(-200) |
| 6438 3cf0 04F0 brlt .+2 |
| 6439 3cf2 00C0 rjmp .L951 |
| 6440 3cf4 48E3 ldi r20,lo8(-200) |
| 6441 3cf6 5FEF ldi r21,hi8(-200) |
| 6442 3cf8 5EA7 std Y+46,r21 |
| 6443 3cfa 4DA7 std Y+45,r20 |
| 6444 3cfc 5093 0000 sts (TrimRoll)+1,r21 |
| 6445 3d00 4093 0000 sts TrimRoll,r20 |
| 6446 3d04 00C0 rjmp .L951 |
| 6447 .L945: |
| 6448 3d06 4FEF ldi r20,hi8(-200) |
| 6449 3d08 8833 cpi r24,lo8(-200) |
| 6450 3d0a 9407 cpc r25,r20 |
| 6451 3d0c 04F0 brlt .+2 |
| 6452 3d0e 00C0 rjmp .L947 |
| 6453 3d10 88E3 ldi r24,lo8(-200) |
| 6454 3d12 9FEF ldi r25,hi8(-200) |
| 6455 3d14 9093 0000 sts (TrimNick)+1,r25 |
| 6456 3d18 8093 0000 sts TrimNick,r24 |
| 6457 3d1c 00C0 rjmp .L947 |
| 6458 .L942: |
| 6459 3d1e 3DA1 ldd r19,Y+37 |
| 6460 3d20 632F mov r22,r19 |
| 6461 3d22 70E0 ldi r23,lo8(0) |
| 6462 3d24 80E0 ldi r24,lo8(0) |
| 6463 3d26 90E0 ldi r25,hi8(0) |
| 6464 3d28 2D81 ldd r18,Y+5 |
| 6465 3d2a 3E81 ldd r19,Y+6 |
| 6466 3d2c 4F81 ldd r20,Y+7 |
| 6467 3d2e 5885 ldd r21,Y+8 |
| 6468 3d30 0E94 0000 call __mulsi3 |
| 6469 3d34 28EF ldi r18,lo8(11000) |
| 6470 3d36 3AE2 ldi r19,hi8(11000) |
| 6471 3d38 40E0 ldi r20,hlo8(11000) |
| 6472 3d3a 50E0 ldi r21,hhi8(11000) |
| 6473 3d3c 0E94 0000 call __divmodsi4 |
| 6474 3d40 3D87 std Y+13,r19 |
| 6475 3d42 2C87 std Y+12,r18 |
| 6476 3d44 1901 movw r2,r18 |
| 6477 3d46 00C0 rjmp .L944 |
| 6478 .L939: |
| 6479 3d48 FDA1 ldd r31,Y+37 |
| 6480 3d4a 6F2F mov r22,r31 |
| 6481 3d4c 70E0 ldi r23,lo8(0) |
| 6482 3d4e 80E0 ldi r24,lo8(0) |
| 6483 3d50 90E0 ldi r25,hi8(0) |
| 6484 3d52 2981 ldd r18,Y+1 |
| 6485 3d54 3A81 ldd r19,Y+2 |
| 6486 3d56 4B81 ldd r20,Y+3 |
| 6487 3d58 5C81 ldd r21,Y+4 |
| 6488 3d5a 0E94 0000 call __mulsi3 |
| 6489 3d5e 28EF ldi r18,lo8(11000) |
| 6490 3d60 3AE2 ldi r19,hi8(11000) |
| 6491 3d62 40E0 ldi r20,hlo8(11000) |
| 6492 3d64 50E0 ldi r21,hhi8(11000) |
| 6493 3d66 0E94 0000 call __divmodsi4 |
| 6494 3d6a 3F87 std Y+15,r19 |
| 6495 3d6c 2E87 std Y+14,r18 |
| 6496 3d6e 2901 movw r4,r18 |
| 6497 3d70 00C0 rjmp .L941 |
| 6498 .L905: |
| 6499 3d72 805B subi r24,lo8(-50000) |
| 6500 3d74 9C43 sbci r25,hi8(-50000) |
| 6501 3d76 AF4F sbci r26,hlo8(-50000) |
| 6502 3d78 BF4F sbci r27,hhi8(-50000) |
| 6503 3d7a 04F0 brlt .+4 |
| 6504 3d7c 0C94 0000 jmp .L907 |
| 6505 3d80 80EB ldi r24,lo8(-50000) |
| 6506 3d82 9CE3 ldi r25,hi8(-50000) |
| 6507 3d84 AFEF ldi r26,hlo8(-50000) |
| 6508 3d86 BFEF ldi r27,hhi8(-50000) |
| 6509 3d88 8093 0000 sts Mess_Integral_Gier,r24 |
| 6510 3d8c 9093 0000 sts (Mess_Integral_Gier)+1,r25 |
| 6511 3d90 A093 0000 sts (Mess_Integral_Gier)+2,r26 |
| 6512 3d94 B093 0000 sts (Mess_Integral_Gier)+3,r27 |
| 6513 3d98 0C94 0000 jmp .L907 |
| 6514 .L1046: |
| 6515 3d9c 5091 0000 lds r21,TrichterFlug |
| 6516 3da0 5EA3 std Y+38,r21 |
| 6517 3da2 6091 0000 lds r22,IntegralFaktor |
| 6518 3da6 6DA3 std Y+37,r22 |
| 6519 3da8 E090 0000 lds r14,StickGier |
| 6520 3dac F090 0000 lds r15,(StickGier)+1 |
| 6521 3db0 6701 movw r12,r14 |
| 6522 3db2 F7FC sbrc r15,7 |
| 6523 3db4 00C0 rjmp .+4 |
| 6524 3db6 0C94 0000 jmp .L900 |
| 6525 .L1059: |
| 6526 3dba CC24 clr r12 |
| 6527 3dbc DD24 clr r13 |
| 6528 3dbe CE18 sub r12,r14 |
| 6529 3dc0 DF08 sbc r13,r15 |
| 6530 3dc2 0C94 0000 jmp .L900 |
| 6531 .L1057: |
| 6532 3dc6 4091 0000 lds r20,Looping_Roll |
| 6533 3dca 4CA7 std Y+44,r20 |
| 6534 3dcc 4423 tst r20 |
| 6535 3dce 01F4 brne .+2 |
| 6536 3dd0 00C0 rjmp .L1105 |
| 6537 3dd2 1092 0000 sts IntegralAccNick,__zero_reg__ |
| 6538 3dd6 1092 0000 sts (IntegralAccNick)+1,__zero_reg__ |
| 6539 3dda 1092 0000 sts (IntegralAccNick)+2,__zero_reg__ |
| 6540 3dde 1092 0000 sts (IntegralAccNick)+3,__zero_reg__ |
| 6541 3de2 1092 0000 sts IntegralAccRoll,__zero_reg__ |
| 6542 3de6 1092 0000 sts (IntegralAccRoll)+1,__zero_reg__ |
| 6543 3dea 1092 0000 sts (IntegralAccRoll)+2,__zero_reg__ |
| 6544 3dee 1092 0000 sts (IntegralAccRoll)+3,__zero_reg__ |
| 6545 3df2 1092 0000 sts MittelIntegralNick,__zero_reg__ |
| 6546 3df6 1092 0000 sts (MittelIntegralNick)+1,__zero_reg__ |
| 6547 3dfa 1092 0000 sts (MittelIntegralNick)+2,__zero_reg__ |
| 6548 3dfe 1092 0000 sts (MittelIntegralNick)+3,__zero_reg__ |
| 6549 3e02 1092 0000 sts MittelIntegralRoll,__zero_reg__ |
| 6550 3e06 1092 0000 sts (MittelIntegralRoll)+1,__zero_reg__ |
| 6551 3e0a 1092 0000 sts (MittelIntegralRoll)+2,__zero_reg__ |
| 6552 3e0e 1092 0000 sts (MittelIntegralRoll)+3,__zero_reg__ |
| 6553 3e12 1092 0000 sts MittelIntegralNick2,__zero_reg__ |
| 6554 3e16 1092 0000 sts (MittelIntegralNick2)+1,__zero_reg__ |
| 6555 3e1a 1092 0000 sts (MittelIntegralNick2)+2,__zero_reg__ |
| 6556 3e1e 1092 0000 sts (MittelIntegralNick2)+3,__zero_reg__ |
| 6557 3e22 1092 0000 sts MittelIntegralRoll2,__zero_reg__ |
| 6558 3e26 1092 0000 sts (MittelIntegralRoll2)+1,__zero_reg__ |
| 6559 3e2a 1092 0000 sts (MittelIntegralRoll2)+2,__zero_reg__ |
| 6560 3e2e 1092 0000 sts (MittelIntegralRoll2)+3,__zero_reg__ |
| 6561 3e32 8091 0000 lds r24,Mess_IntegralNick |
| 6562 3e36 9091 0000 lds r25,(Mess_IntegralNick)+1 |
| 6563 3e3a A091 0000 lds r26,(Mess_IntegralNick)+2 |
| 6564 3e3e B091 0000 lds r27,(Mess_IntegralNick)+3 |
| 6565 3e42 8093 0000 sts Mess_IntegralNick2,r24 |
| 6566 3e46 9093 0000 sts (Mess_IntegralNick2)+1,r25 |
| 6567 3e4a A093 0000 sts (Mess_IntegralNick2)+2,r26 |
| 6568 3e4e B093 0000 sts (Mess_IntegralNick2)+3,r27 |
| 6569 3e52 8091 0000 lds r24,Mess_IntegralRoll |
| 6570 3e56 9091 0000 lds r25,(Mess_IntegralRoll)+1 |
| 6571 3e5a A091 0000 lds r26,(Mess_IntegralRoll)+2 |
| 6572 3e5e B091 0000 lds r27,(Mess_IntegralRoll)+3 |
| 6573 3e62 8093 0000 sts Mess_IntegralRoll2,r24 |
| 6574 3e66 9093 0000 sts (Mess_IntegralRoll2)+1,r25 |
| 6575 3e6a A093 0000 sts (Mess_IntegralRoll2)+2,r26 |
| 6576 3e6e B093 0000 sts (Mess_IntegralRoll2)+3,r27 |
| 6577 3e72 1092 0000 sts (ZaehlMessungen)+1,__zero_reg__ |
| 6578 3e76 1092 0000 sts ZaehlMessungen,__zero_reg__ |
| 6579 3e7a 1092 0000 sts (LageKorrekturNick)+1,__zero_reg__ |
| 6580 3e7e 1092 0000 sts LageKorrekturNick,__zero_reg__ |
| 6581 3e82 1092 0000 sts (LageKorrekturRoll)+1,__zero_reg__ |
| 6582 3e86 1092 0000 sts LageKorrekturRoll,__zero_reg__ |
| 6583 3e8a 0C94 0000 jmp .L801 |
| 6584 .L1105: |
| 6585 3e8e 8091 0000 lds r24,Aktuell_az |
| 6586 3e92 9091 0000 lds r25,(Aktuell_az)+1 |
| 6587 3e96 8150 subi r24,lo8(513) |
| 6588 3e98 9240 sbci r25,hi8(513) |
| 6589 3e9a 04F4 brge .+4 |
| 6590 3e9c 0C94 0000 jmp .L801 |
| 6591 3ea0 8091 0000 lds r24,FromNaviCtrl_Value |
| 6592 3ea4 8F3F cpi r24,lo8(-1) |
| 6593 3ea6 01F4 brne .+4 |
| 6594 3ea8 0C94 0000 jmp .L803 |
| 6595 3eac E090 0000 lds r14,EE_Parameter+20 |
| 6596 3eb0 FF24 clr r15 |
| 6597 3eb2 00E0 ldi r16,lo8(0) |
| 6598 3eb4 10E0 ldi r17,hi8(0) |
| 6599 3eb6 A82E mov r10,r24 |
| 6600 3eb8 BB24 clr r11 |
| 6601 3eba A7FC sbrc r10,7 |
| 6602 3ebc B094 com r11 |
| 6603 3ebe CB2C mov r12,r11 |
| 6604 3ec0 DB2C mov r13,r11 |
| 6605 3ec2 6981 ldd r22,Y+1 |
| 6606 3ec4 7A81 ldd r23,Y+2 |
| 6607 3ec6 8B81 ldd r24,Y+3 |
| 6608 3ec8 9C81 ldd r25,Y+4 |
| 6609 3eca A801 movw r20,r16 |
| 6610 3ecc 9701 movw r18,r14 |
| 6611 3ece 0E94 0000 call __divmodsi4 |
| 6612 3ed2 8091 0000 lds r24,Mittelwert_AccNick |
| 6613 3ed6 9091 0000 lds r25,(Mittelwert_AccNick)+1 |
| 6614 3eda AA27 clr r26 |
| 6615 3edc 97FD sbrc r25,7 |
| 6616 3ede A095 com r26 |
| 6617 3ee0 BA2F mov r27,r26 |
| 6618 3ee2 281B sub r18,r24 |
| 6619 3ee4 390B sbc r19,r25 |
| 6620 3ee6 4A0B sbc r20,r26 |
| 6621 3ee8 5B0B sbc r21,r27 |
| 6622 3eea CA01 movw r24,r20 |
| 6623 3eec B901 movw r22,r18 |
| 6624 3eee A601 movw r20,r12 |
| 6625 3ef0 9501 movw r18,r10 |
| 6626 3ef2 0E94 0000 call __mulsi3 |
| 6627 3ef6 20E0 ldi r18,lo8(512) |
| 6628 3ef8 32E0 ldi r19,hi8(512) |
| 6629 3efa 40E0 ldi r20,hlo8(512) |
| 6630 3efc 50E0 ldi r21,hhi8(512) |
| 6631 3efe 0E94 0000 call __divmodsi4 |
| 6632 3f02 3901 movw r6,r18 |
| 6633 3f04 4A01 movw r8,r20 |
| 6634 3f06 6D81 ldd r22,Y+5 |
| 6635 3f08 7E81 ldd r23,Y+6 |
| 6636 3f0a 8F81 ldd r24,Y+7 |
| 6637 3f0c 9885 ldd r25,Y+8 |
| 6638 3f0e A801 movw r20,r16 |
| 6639 3f10 9701 movw r18,r14 |
| 6640 3f12 0E94 0000 call __divmodsi4 |
| 6641 3f16 8091 0000 lds r24,Mittelwert_AccRoll |
| 6642 3f1a 9091 0000 lds r25,(Mittelwert_AccRoll)+1 |
| 6643 3f1e AA27 clr r26 |
| 6644 3f20 97FD sbrc r25,7 |
| 6645 3f22 A095 com r26 |
| 6646 3f24 BA2F mov r27,r26 |
| 6647 3f26 281B sub r18,r24 |
| 6648 3f28 390B sbc r19,r25 |
| 6649 3f2a 4A0B sbc r20,r26 |
| 6650 3f2c 5B0B sbc r21,r27 |
| 6651 3f2e CA01 movw r24,r20 |
| 6652 3f30 B901 movw r22,r18 |
| 6653 3f32 A601 movw r20,r12 |
| 6654 3f34 9501 movw r18,r10 |
| 6655 3f36 0E94 0000 call __mulsi3 |
| 6656 3f3a 20E0 ldi r18,lo8(512) |
| 6657 3f3c 32E0 ldi r19,hi8(512) |
| 6658 3f3e 40E0 ldi r20,hlo8(512) |
| 6659 3f40 50E0 ldi r21,hhi8(512) |
| 6660 3f42 0E94 0000 call __divmodsi4 |
| 6661 3f46 5901 movw r10,r18 |
| 6662 3f48 6A01 movw r12,r20 |
| 6663 3f4a 8091 0000 lds r24,MaxStickNick |
| 6664 3f4e 9091 0000 lds r25,(MaxStickNick)+1 |
| 6665 3f52 8134 cpi r24,65 |
| 6666 3f54 9105 cpc r25,__zero_reg__ |
| 6667 3f56 04F0 brlt .+2 |
| 6668 3f58 00C0 rjmp .L805 |
| 6669 3f5a 8091 0000 lds r24,MaxStickRoll |
| 6670 3f5e 9091 0000 lds r25,(MaxStickRoll)+1 |
| 6671 3f62 8134 cpi r24,65 |
| 6672 3f64 9105 cpc r25,__zero_reg__ |
| 6673 3f66 04F0 brlt .+2 |
| 6674 3f68 00C0 rjmp .L805 |
| 6675 .L807: |
| 6676 3f6a E091 0000 lds r30,EE_Parameter+3 |
| 6677 3f6e F0E0 ldi r31,lo8(0) |
| 6678 3f70 EE0F lsl r30 |
| 6679 3f72 FF1F rol r31 |
| 6680 3f74 E050 subi r30,lo8(-(PPM_in)) |
| 6681 3f76 F040 sbci r31,hi8(-(PPM_in)) |
| 6682 3f78 0190 ld __tmp_reg__,Z+ |
| 6683 3f7a F081 ld r31,Z |
| 6684 3f7c E02D mov r30,__tmp_reg__ |
| 6685 3f7e F7FF sbrs r31,7 |
| 6686 3f80 00C0 rjmp .+4 |
| 6687 3f82 0C94 0000 jmp .L1106 |
| 6688 .L809: |
| 6689 3f86 7A97 sbiw r30,26 |
| 6690 3f88 04F0 brlt .L808 |
| 6691 3f8a C401 movw r24,r8 |
| 6692 3f8c B301 movw r22,r6 |
| 6693 3f8e 23E0 ldi r18,lo8(3) |
| 6694 3f90 30E0 ldi r19,hi8(3) |
| 6695 3f92 40E0 ldi r20,hlo8(3) |
| 6696 3f94 50E0 ldi r21,hhi8(3) |
| 6697 3f96 0E94 0000 call __divmodsi4 |
| 6698 3f9a 3901 movw r6,r18 |
| 6699 3f9c 4A01 movw r8,r20 |
| 6700 3f9e C601 movw r24,r12 |
| 6701 3fa0 B501 movw r22,r10 |
| 6702 3fa2 23E0 ldi r18,lo8(3) |
| 6703 3fa4 30E0 ldi r19,hi8(3) |
| 6704 3fa6 40E0 ldi r20,hlo8(3) |
| 6705 3fa8 50E0 ldi r21,hhi8(3) |
| 6706 3faa 0E94 0000 call __divmodsi4 |
| 6707 3fae 5901 movw r10,r18 |
| 6708 3fb0 6A01 movw r12,r20 |
| 6709 .L808: |
| 6710 3fb2 8091 0000 lds r24,FromNaviCtrl_Value+2 |
| 6711 3fb6 E82E mov r14,r24 |
| 6712 3fb8 FF24 clr r15 |
| 6713 3fba E7FC sbrc r14,7 |
| 6714 3fbc F094 com r15 |
| 6715 3fbe 0F2D mov r16,r15 |
| 6716 3fc0 1F2D mov r17,r15 |
| 6717 3fc2 A401 movw r20,r8 |
| 6718 3fc4 9301 movw r18,r6 |
| 6719 3fc6 E614 cp r14,r6 |
| 6720 3fc8 F704 cpc r15,r7 |
| 6721 3fca 0805 cpc r16,r8 |
| 6722 3fcc 1905 cpc r17,r9 |
| 6723 3fce 04F4 brge .L811 |
| 6724 3fd0 A801 movw r20,r16 |
| 6725 3fd2 9701 movw r18,r14 |
| 6726 .L811: |
| 6727 3fd4 9927 clr r25 |
| 6728 3fd6 87FD sbrc r24,7 |
| 6729 3fd8 9095 com r25 |
| 6730 3fda 9095 com r25 |
| 6731 3fdc 8195 neg r24 |
| 6732 3fde 9F4F sbci r25,lo8(-1) |
| 6733 3fe0 AA27 clr r26 |
| 6734 3fe2 97FD sbrc r25,7 |
| 6735 3fe4 A095 com r26 |
| 6736 3fe6 BA2F mov r27,r26 |
| 6737 3fe8 3901 movw r6,r18 |
| 6738 3fea 4A01 movw r8,r20 |
| 6739 3fec 2817 cp r18,r24 |
| 6740 3fee 3907 cpc r19,r25 |
| 6741 3ff0 4A07 cpc r20,r26 |
| 6742 3ff2 5B07 cpc r21,r27 |
| 6743 3ff4 04F4 brge .L812 |
| 6744 3ff6 3C01 movw r6,r24 |
| 6745 3ff8 4D01 movw r8,r26 |
| 6746 .L812: |
| 6747 3ffa EA14 cp r14,r10 |
| 6748 3ffc FB04 cpc r15,r11 |
| 6749 3ffe 0C05 cpc r16,r12 |
| 6750 4000 1D05 cpc r17,r13 |
| 6751 4002 04F4 brge .L813 |
| 6752 4004 5701 movw r10,r14 |
| 6753 4006 6801 movw r12,r16 |
| 6754 .L813: |
| 6755 4008 A816 cp r10,r24 |
| 6756 400a B906 cpc r11,r25 |
| 6757 400c CA06 cpc r12,r26 |
| 6758 400e DB06 cpc r13,r27 |
| 6759 4010 04F4 brge .L814 |
| 6760 4012 5C01 movw r10,r24 |
| 6761 4014 6D01 movw r12,r26 |
| 6762 .L814: |
| 6763 4016 8091 0000 lds r24,Mess_IntegralNick |
| 6764 401a 9091 0000 lds r25,(Mess_IntegralNick)+1 |
| 6765 401e A091 0000 lds r26,(Mess_IntegralNick)+2 |
| 6766 4022 B091 0000 lds r27,(Mess_IntegralNick)+3 |
| 6767 4026 8619 sub r24,r6 |
| 6768 4028 9709 sbc r25,r7 |
| 6769 402a A809 sbc r26,r8 |
| 6770 402c B909 sbc r27,r9 |
| 6771 402e 8093 0000 sts Mess_IntegralNick,r24 |
| 6772 4032 9093 0000 sts (Mess_IntegralNick)+1,r25 |
| 6773 4036 A093 0000 sts (Mess_IntegralNick)+2,r26 |
| 6774 403a B093 0000 sts (Mess_IntegralNick)+3,r27 |
| 6775 403e 8091 0000 lds r24,Mess_IntegralRoll |
| 6776 4042 9091 0000 lds r25,(Mess_IntegralRoll)+1 |
| 6777 4046 A091 0000 lds r26,(Mess_IntegralRoll)+2 |
| 6778 404a B091 0000 lds r27,(Mess_IntegralRoll)+3 |
| 6779 404e 8A19 sub r24,r10 |
| 6780 4050 9B09 sbc r25,r11 |
| 6781 4052 AC09 sbc r26,r12 |
| 6782 4054 BD09 sbc r27,r13 |
| 6783 4056 8093 0000 sts Mess_IntegralRoll,r24 |
| 6784 405a 9093 0000 sts (Mess_IntegralRoll)+1,r25 |
| 6785 405e A093 0000 sts (Mess_IntegralRoll)+2,r26 |
| 6786 4062 B093 0000 sts (Mess_IntegralRoll)+3,r27 |
| 6787 4066 0C94 0000 jmp .L801 |
| 6788 .L1095: |
| 6789 406a 88E1 ldi r24,lo8(24) |
| 6790 406c 8093 0000 sts TimerWerteausgabe.3087,r24 |
| 6791 4070 E090 0000 lds r14,EE_Parameter+20 |
| 6792 4074 FF24 clr r15 |
| 6793 4076 EE0C lsl r14 |
| 6794 4078 FF1C rol r15 |
| 6795 407a EE0C lsl r14 |
| 6796 407c FF1C rol r15 |
| 6797 407e 0027 clr r16 |
| 6798 4080 F7FC sbrc r15,7 |
| 6799 4082 0095 com r16 |
| 6800 4084 102F mov r17,r16 |
| 6801 4086 6981 ldd r22,Y+1 |
| 6802 4088 7A81 ldd r23,Y+2 |
| 6803 408a 8B81 ldd r24,Y+3 |
| 6804 408c 9C81 ldd r25,Y+4 |
| 6805 408e A801 movw r20,r16 |
| 6806 4090 9701 movw r18,r14 |
| 6807 4092 0E94 0000 call __divmodsi4 |
| 6808 4096 3093 0000 sts (DebugOut+2)+1,r19 |
| 6809 409a 2093 0000 sts DebugOut+2,r18 |
| 6810 409e 6D81 ldd r22,Y+5 |
| 6811 40a0 7E81 ldd r23,Y+6 |
| 6812 40a2 8F81 ldd r24,Y+7 |
| 6813 40a4 9885 ldd r25,Y+8 |
| 6814 40a6 A801 movw r20,r16 |
| 6815 40a8 9701 movw r18,r14 |
| 6816 40aa 0E94 0000 call __divmodsi4 |
| 6817 40ae 3093 0000 sts (DebugOut+4)+1,r19 |
| 6818 40b2 2093 0000 sts DebugOut+4,r18 |
| 6819 40b6 8091 0000 lds r24,Mittelwert_AccNick |
| 6820 40ba 9091 0000 lds r25,(Mittelwert_AccNick)+1 |
| 6821 40be 97FD sbrc r25,7 |
| 6822 40c0 00C0 rjmp .L1107 |
| 6823 .L935: |
| 6824 40c2 9595 asr r25 |
| 6825 40c4 8795 ror r24 |
| 6826 40c6 9595 asr r25 |
| 6827 40c8 8795 ror r24 |
| 6828 40ca 9093 0000 sts (DebugOut+6)+1,r25 |
| 6829 40ce 8093 0000 sts DebugOut+6,r24 |
| 6830 40d2 8091 0000 lds r24,Mittelwert_AccRoll |
| 6831 40d6 9091 0000 lds r25,(Mittelwert_AccRoll)+1 |
| 6832 40da 97FD sbrc r25,7 |
| 6833 40dc 00C0 rjmp .L1108 |
| 6834 .L936: |
| 6835 40de 9595 asr r25 |
| 6836 40e0 8795 ror r24 |
| 6837 40e2 9595 asr r25 |
| 6838 40e4 8795 ror r24 |
| 6839 40e6 9093 0000 sts (DebugOut+8)+1,r25 |
| 6840 40ea 8093 0000 sts DebugOut+8,r24 |
| 6841 40ee 9092 0000 sts (DebugOut+10)+1,r9 |
| 6842 40f2 8092 0000 sts DebugOut+10,r8 |
| 6843 40f6 2091 0000 lds r18,HoehenWert |
| 6844 40fa 3091 0000 lds r19,(HoehenWert)+1 |
| 6845 40fe 3093 0000 sts (DebugOut+12)+1,r19 |
| 6846 4102 2093 0000 sts DebugOut+12,r18 |
| 6847 4106 6091 0000 lds r22,Mess_Integral_Hoch |
| 6848 410a 7091 0000 lds r23,(Mess_Integral_Hoch)+1 |
| 6849 410e 8091 0000 lds r24,(Mess_Integral_Hoch)+2 |
| 6850 4112 9091 0000 lds r25,(Mess_Integral_Hoch)+3 |
| 6851 4116 20E0 ldi r18,lo8(512) |
| 6852 4118 32E0 ldi r19,hi8(512) |
| 6853 411a 40E0 ldi r20,hlo8(512) |
| 6854 411c 50E0 ldi r21,hhi8(512) |
| 6855 411e 0E94 0000 call __divmodsi4 |
| 6856 4122 3093 0000 sts (DebugOut+14)+1,r19 |
| 6857 4126 2093 0000 sts DebugOut+14,r18 |
| 6858 412a 3092 0000 sts (DebugOut+18)+1,r3 |
| 6859 412e 2092 0000 sts DebugOut+18,r2 |
| 6860 4132 8091 0000 lds r24,UBat |
| 6861 4136 9091 0000 lds r25,(UBat)+1 |
| 6862 413a 9093 0000 sts (DebugOut+20)+1,r25 |
| 6863 413e 8093 0000 sts DebugOut+20,r24 |
| 6864 4142 6091 0000 lds r22,ErsatzKompass |
| 6865 4146 7091 0000 lds r23,(ErsatzKompass)+1 |
| 6866 414a 8091 0000 lds r24,(ErsatzKompass)+2 |
| 6867 414e 9091 0000 lds r25,(ErsatzKompass)+3 |
| 6868 4152 2091 0000 lds r18,GIER_GRAD_FAKTOR |
| 6869 4156 3091 0000 lds r19,(GIER_GRAD_FAKTOR)+1 |
| 6870 415a 4091 0000 lds r20,(GIER_GRAD_FAKTOR)+2 |
| 6871 415e 5091 0000 lds r21,(GIER_GRAD_FAKTOR)+3 |
| 6872 4162 0E94 0000 call __divmodsi4 |
| 6873 4166 3093 0000 sts (DebugOut+24)+1,r19 |
| 6874 416a 2093 0000 sts DebugOut+24,r18 |
| 6875 416e 8091 0000 lds r24,SenderOkay |
| 6876 4172 90E0 ldi r25,lo8(0) |
| 6877 4174 9093 0000 sts (DebugOut+22)+1,r25 |
| 6878 4178 8093 0000 sts DebugOut+22,r24 |
| 6879 417c 8091 0000 lds r24,WinkelOut+6 |
| 6880 4180 90E0 ldi r25,lo8(0) |
| 6881 4182 9093 0000 sts (DebugOut+40)+1,r25 |
| 6882 4186 8093 0000 sts DebugOut+40,r24 |
| 6883 418a 8091 0000 lds r24,ServoValue |
| 6884 418e 9091 0000 lds r25,(ServoValue)+1 |
| 6885 4192 9093 0000 sts (DebugOut+42)+1,r25 |
| 6886 4196 8093 0000 sts DebugOut+42,r24 |
| 6887 419a 8091 0000 lds r24,FromNaviCtrl_Value+1 |
| 6888 419e 9927 clr r25 |
| 6889 41a0 87FD sbrc r24,7 |
| 6890 41a2 9095 com r25 |
| 6891 41a4 9093 0000 sts (DebugOut+56)+1,r25 |
| 6892 41a8 8093 0000 sts DebugOut+56,r24 |
| 6893 41ac 8091 0000 lds r24,GPS_Nick |
| 6894 41b0 9091 0000 lds r25,(GPS_Nick)+1 |
| 6895 41b4 9093 0000 sts (DebugOut+62)+1,r25 |
| 6896 41b8 8093 0000 sts DebugOut+62,r24 |
| 6897 41bc 8091 0000 lds r24,GPS_Roll |
| 6898 41c0 9091 0000 lds r25,(GPS_Roll)+1 |
| 6899 41c4 9093 0000 sts (DebugOut+64)+1,r25 |
| 6900 41c8 8093 0000 sts DebugOut+64,r24 |
| 6901 41cc 00C0 rjmp .L933 |
| 6902 .L751: |
| 6903 41ce 4150 subi r20,lo8(-(-1)) |
| 6904 41d0 5040 sbci r21,hi8(-(-1)) |
| 6905 41d2 5093 0000 sts (MaxStickRoll)+1,r21 |
| 6906 41d6 4093 0000 sts MaxStickRoll,r20 |
| 6907 41da 00C0 rjmp .L757 |
| 6908 .L743: |
| 6909 41dc 4150 subi r20,lo8(-(-1)) |
| 6910 41de 5040 sbci r21,hi8(-(-1)) |
| 6911 41e0 5093 0000 sts (MaxStickNick)+1,r21 |
| 6912 41e4 4093 0000 sts MaxStickNick,r20 |
| 6913 41e8 00C0 rjmp .L749 |
| 6914 .L967: |
| 6915 41ea 8091 0000 lds r24,Parameter_MaxHoehe |
| 6916 41ee 2091 0000 lds r18,ExternHoehenValue |
| 6917 41f2 3091 0000 lds r19,(ExternHoehenValue)+1 |
| 6918 41f6 280F add r18,r24 |
| 6919 41f8 311D adc r19,__zero_reg__ |
| 6920 41fa 8091 0000 lds r24,EE_Parameter+13 |
| 6921 41fe 90E0 ldi r25,lo8(0) |
| 6922 4200 FC01 movw r30,r24 |
| 6923 4202 2E9F mul r18,r30 |
| 6924 4204 C001 movw r24,r0 |
| 6925 4206 2F9F mul r18,r31 |
| 6926 4208 900D add r25,r0 |
| 6927 420a 3E9F mul r19,r30 |
| 6928 420c 900D add r25,r0 |
| 6929 420e 1124 clr r1 |
| 6930 4210 4497 sbiw r24,20 |
| 6931 4212 9093 0000 sts (SollHoehe)+1,r25 |
| 6932 4216 8093 0000 sts SollHoehe,r24 |
| 6933 421a 81E0 ldi r24,lo8(1) |
| 6934 421c 8093 0000 sts HoehenReglerAktiv,r24 |
| 6935 4220 2091 0000 lds r18,HoehenWert |
| 6936 4224 3091 0000 lds r19,(HoehenWert)+1 |
| 6937 .L973: |
| 6938 4228 FFA1 ldd r31,Y+39 |
| 6939 422a FF23 tst r31 |
| 6940 422c 01F0 breq .L979 |
| 6941 422e 1092 0000 sts (SollHoehe)+1,__zero_reg__ |
| 6942 4232 1092 0000 sts SollHoehe,__zero_reg__ |
| 6943 .L979: |
| 6944 4236 4091 0000 lds r20,SollHoehe |
| 6945 423a 5091 0000 lds r21,(SollHoehe)+1 |
| 6946 423e 4217 cp r20,r18 |
| 6947 4240 5307 cpc r21,r19 |
| 6948 4242 04F0 brlt .+2 |
| 6949 4244 00C0 rjmp .L965 |
| 6950 4246 8091 0000 lds r24,HoehenReglerAktiv |
| 6951 424a 8823 tst r24 |
| 6952 424c 01F4 brne .+2 |
| 6953 424e 00C0 rjmp .L965 |
| 6954 4250 8091 0000 lds r24,Parameter_Hoehe_P |
| 6955 4254 90E0 ldi r25,lo8(0) |
| 6956 4256 241B sub r18,r20 |
| 6957 4258 350B sbc r19,r21 |
| 6958 425a AC01 movw r20,r24 |
| 6959 425c 429F mul r20,r18 |
| 6960 425e C001 movw r24,r0 |
| 6961 4260 439F mul r20,r19 |
| 6962 4262 900D add r25,r0 |
| 6963 4264 529F mul r21,r18 |
| 6964 4266 900D add r25,r0 |
| 6965 4268 1124 clr r1 |
| 6966 426a 97FD sbrc r25,7 |
| 6967 426c 00C0 rjmp .L1109 |
| 6968 .L983: |
| 6969 426e 5C01 movw r10,r24 |
| 6970 4270 B594 asr r11 |
| 6971 4272 A794 ror r10 |
| 6972 4274 B594 asr r11 |
| 6973 4276 A794 ror r10 |
| 6974 4278 C090 0000 lds r12,HoeheD |
| 6975 427c D090 0000 lds r13,(HoeheD)+1 |
| 6976 4280 6091 0000 lds r22,Mess_Integral_Hoch |
| 6977 4284 7091 0000 lds r23,(Mess_Integral_Hoch)+1 |
| 6978 4288 8091 0000 lds r24,(Mess_Integral_Hoch)+2 |
| 6979 428c 9091 0000 lds r25,(Mess_Integral_Hoch)+3 |
| 6980 4290 E090 0000 lds r14,Parameter_Hoehe_ACC_Wirkung |
| 6981 4294 FF24 clr r15 |
| 6982 4296 00E0 ldi r16,lo8(0) |
| 6983 4298 10E0 ldi r17,hi8(0) |
| 6984 429a 20E8 ldi r18,lo8(128) |
| 6985 429c 30E0 ldi r19,hi8(128) |
| 6986 429e 40E0 ldi r20,hlo8(128) |
| 6987 42a0 50E0 ldi r21,hhi8(128) |
| 6988 42a2 0E94 0000 call __divmodsi4 |
| 6989 42a6 C801 movw r24,r16 |
| 6990 42a8 B701 movw r22,r14 |
| 6991 42aa 0E94 0000 call __mulsi3 |
| 6992 42ae 20E2 ldi r18,lo8(32) |
| 6993 42b0 30E0 ldi r19,hi8(32) |
| 6994 42b2 40E0 ldi r20,hlo8(32) |
| 6995 42b4 50E0 ldi r21,hhi8(32) |
| 6996 42b6 0E94 0000 call __divmodsi4 |
| 6997 42ba A901 movw r20,r18 |
| 6998 42bc 285E subi r18,lo8(-280) |
| 6999 42be 3E4F sbci r19,hi8(-280) |
| 7000 42c0 04F4 brge .L984 |
| 7001 42c2 48EE ldi r20,lo8(-280) |
| 7002 42c4 5EEF ldi r21,hi8(-280) |
| 7003 .L984: |
| 7004 42c6 2091 0000 lds r18,hoehenregler.3078 |
| 7005 42ca 3091 0000 lds r19,(hoehenregler.3078)+1 |
| 7006 42ce C901 movw r24,r18 |
| 7007 42d0 880F lsl r24 |
| 7008 42d2 991F rol r25 |
| 7009 42d4 820F add r24,r18 |
| 7010 42d6 931F adc r25,r19 |
| 7011 42d8 BC01 movw r22,r24 |
| 7012 42da 660F lsl r22 |
| 7013 42dc 771F rol r23 |
| 7014 42de 660F lsl r22 |
| 7015 42e0 771F rol r23 |
| 7016 42e2 680F add r22,r24 |
| 7017 42e4 791F adc r23,r25 |
| 7018 42e6 9601 movw r18,r12 |
| 7019 42e8 D7FC sbrc r13,7 |
| 7020 42ea 00C0 rjmp .L1110 |
| 7021 .L985: |
| 7022 42ec 3595 asr r19 |
| 7023 42ee 2795 ror r18 |
| 7024 42f0 CB01 movw r24,r22 |
| 7025 42f2 821B sub r24,r18 |
| 7026 42f4 930B sbc r25,r19 |
| 7027 42f6 9A01 movw r18,r20 |
| 7028 42f8 4951 subi r20,lo8(281) |
| 7029 42fa 5140 sbci r21,hi8(281) |
| 7030 42fc 04F0 brlt .L986 |
| 7031 42fe 28E1 ldi r18,lo8(280) |
| 7032 4300 31E0 ldi r19,hi8(280) |
| 7033 .L986: |
| 7034 4302 821B sub r24,r18 |
| 7035 4304 930B sbc r25,r19 |
| 7036 4306 9C01 movw r18,r24 |
| 7037 4308 8DA5 ldd r24,Y+45 |
| 7038 430a 9EA5 ldd r25,Y+46 |
| 7039 430c 8A19 sub r24,r10 |
| 7040 430e 9B09 sbc r25,r11 |
| 7041 4310 280F add r18,r24 |
| 7042 4312 391F adc r19,r25 |
| 7043 4314 37FD sbrc r19,7 |
| 7044 4316 00C0 rjmp .L1111 |
| 7045 .L987: |
| 7046 4318 3595 asr r19 |
| 7047 431a 2795 ror r18 |
| 7048 431c 3595 asr r19 |
| 7049 431e 2795 ror r18 |
| 7050 4320 3595 asr r19 |
| 7051 4322 2795 ror r18 |
| 7052 4324 3595 asr r19 |
| 7053 4326 2795 ror r18 |
| 7054 4328 3093 0000 sts (hoehenregler.3078)+1,r19 |
| 7055 432c 2093 0000 sts hoehenregler.3078,r18 |
| 7056 4330 8091 0000 lds r24,EE_Parameter+9 |
| 7057 4334 682F mov r22,r24 |
| 7058 4336 70E0 ldi r23,lo8(0) |
| 7059 4338 660F lsl r22 |
| 7060 433a 771F rol r23 |
| 7061 433c 660F lsl r22 |
| 7062 433e 771F rol r23 |
| 7063 4340 2617 cp r18,r22 |
| 7064 4342 3707 cpc r19,r23 |
| 7065 4344 04F0 brlt .+2 |
| 7066 4346 00C0 rjmp .L988 |
| 7067 4348 8DA5 ldd r24,Y+45 |
| 7068 434a 9EA5 ldd r25,Y+46 |
| 7069 434c 8617 cp r24,r22 |
| 7070 434e 9707 cpc r25,r23 |
| 7071 4350 04F4 brge .+2 |
| 7072 4352 00C0 rjmp .L990 |
| 7073 4354 7093 0000 sts (hoehenregler.3078)+1,r23 |
| 7074 4358 6093 0000 sts hoehenregler.3078,r22 |
| 7075 435c 00C0 rjmp .L992 |
| 7076 .L659: |
| 7077 435e 1092 0000 sts MotorenEin,__zero_reg__ |
| 7078 4362 0C94 0000 jmp .L661 |
| 7079 .L1060: |
| 7080 4366 6D5F subi r22,lo8(-(3)) |
| 7081 4368 7F4F sbci r23,hi8(-(3)) |
| 7082 436a 0C94 0000 jmp .L904 |
| 7083 .L1100: |
| 7084 436e 6F5F subi r22,lo8(-(1)) |
| 7085 4370 7F4F sbci r23,hi8(-(1)) |
| 7086 4372 00C0 rjmp .L1013 |
| 7087 .L1099: |
| 7088 4374 6627 clr r22 |
| 7089 4376 7727 clr r23 |
| 7090 4378 6A19 sub r22,r10 |
| 7091 437a 7B09 sbc r23,r11 |
| 7092 437c 00C0 rjmp .L1012 |
| 7093 .L1102: |
| 7094 437e 0396 adiw r24,3 |
| 7095 4380 00C0 rjmp .L1030 |
| 7096 .L1101: |
| 7097 4382 0396 adiw r24,3 |
| 7098 4384 00C0 rjmp .L1025 |
| 7099 .L1104: |
| 7100 4386 0396 adiw r24,3 |
| 7101 4388 00C0 rjmp .L1040 |
| 7102 .L1103: |
| 7103 438a 0396 adiw r24,3 |
| 7104 438c 00C0 rjmp .L1035 |
| 7105 .L790: |
| 7106 438e 1092 0000 sts Looping_Nick,__zero_reg__ |
| 7107 4392 0C94 0000 jmp .L727 |
| 7108 .L786: |
| 7109 4396 1092 0000 sts Looping_Roll,__zero_reg__ |
| 7110 439a 00C0 rjmp .L787 |
| 7111 .L1092: |
| 7112 439c 81E0 ldi r24,lo8(1) |
| 7113 439e 8093 0000 sts Looping_Unten,r24 |
| 7114 43a2 00C0 rjmp .L781 |
| 7115 .L1090: |
| 7116 43a4 A1E0 ldi r26,lo8(1) |
| 7117 43a6 A093 0000 sts Looping_Oben,r26 |
| 7118 43aa 00C0 rjmp .L775 |
| 7119 .L1088: |
| 7120 43ac 81E0 ldi r24,lo8(1) |
| 7121 43ae 8093 0000 sts Looping_Rechts,r24 |
| 7122 43b2 00C0 rjmp .L769 |
| 7123 .L1087: |
| 7124 43b4 81E0 ldi r24,lo8(1) |
| 7125 43b6 8093 0000 sts Looping_Links,r24 |
| 7126 43ba 00C0 rjmp .L764 |
| 7127 .L1086: |
| 7128 43bc 84E6 ldi r24,lo8(100) |
| 7129 43be 90E0 ldi r25,hi8(100) |
| 7130 43c0 9093 0000 sts (MaxStickRoll)+1,r25 |
| 7131 43c4 8093 0000 sts MaxStickRoll,r24 |
| 7132 43c8 00C0 rjmp .L757 |
| 7133 .L1081: |
| 7134 43ca 84E6 ldi r24,lo8(100) |
| 7135 43cc 90E0 ldi r25,hi8(100) |
| 7136 43ce 9093 0000 sts (MaxStickNick)+1,r25 |
| 7137 43d2 8093 0000 sts MaxStickNick,r24 |
| 7138 43d6 0C94 0000 jmp .L749 |
| 7139 .L1075: |
| 7140 43da 8091 0000 lds r24,ExternControl+3 |
| 7141 43de 9927 clr r25 |
| 7142 43e0 87FD sbrc r24,7 |
| 7143 43e2 9095 com r25 |
| 7144 43e4 AC01 movw r20,r24 |
| 7145 43e6 489D mul r20,r8 |
| 7146 43e8 C001 movw r24,r0 |
| 7147 43ea 499D mul r20,r9 |
| 7148 43ec 900D add r25,r0 |
| 7149 43ee 589D mul r21,r8 |
| 7150 43f0 900D add r25,r0 |
| 7151 43f2 1124 clr r1 |
| 7152 43f4 C80E add r12,r24 |
| 7153 43f6 D91E adc r13,r25 |
| 7154 43f8 D092 0000 sts (StickNick)+1,r13 |
| 7155 43fc C092 0000 sts StickNick,r12 |
| 7156 4400 8091 0000 lds r24,ExternControl+4 |
| 7157 4404 9927 clr r25 |
| 7158 4406 87FD sbrc r24,7 |
| 7159 4408 9095 com r25 |
| 7160 440a BC01 movw r22,r24 |
| 7161 440c 689D mul r22,r8 |
| 7162 440e C001 movw r24,r0 |
| 7163 4410 699D mul r22,r9 |
| 7164 4412 900D add r25,r0 |
| 7165 4414 789D mul r23,r8 |
| 7166 4416 900D add r25,r0 |
| 7167 4418 1124 clr r1 |
| 7168 441a 080F add r16,r24 |
| 7169 441c 191F adc r17,r25 |
| 7170 441e 1093 0000 sts (StickRoll)+1,r17 |
| 7171 4422 0093 0000 sts StickRoll,r16 |
| 7172 4426 2091 0000 lds r18,ExternControl+5 |
| 7173 442a 3327 clr r19 |
| 7174 442c 27FD sbrc r18,7 |
| 7175 442e 3095 com r19 |
| 7176 4430 8091 0000 lds r24,StickGier |
| 7177 4434 9091 0000 lds r25,(StickGier)+1 |
| 7178 4438 820F add r24,r18 |
| 7179 443a 931F adc r25,r19 |
| 7180 443c 9093 0000 sts (StickGier)+1,r25 |
| 7181 4440 8093 0000 sts StickGier,r24 |
| 7182 4444 2091 0000 lds r18,EE_Parameter+13 |
| 7183 4448 30E0 ldi r19,lo8(0) |
| 7184 444a 8091 0000 lds r24,ExternControl+7 |
| 7185 444e 9927 clr r25 |
| 7186 4450 87FD sbrc r24,7 |
| 7187 4452 9095 com r25 |
| 7188 4454 DC01 movw r26,r24 |
| 7189 4456 2A9F mul r18,r26 |
| 7190 4458 C001 movw r24,r0 |
| 7191 445a 2B9F mul r18,r27 |
| 7192 445c 900D add r25,r0 |
| 7193 445e 3A9F mul r19,r26 |
| 7194 4460 900D add r25,r0 |
| 7195 4462 1124 clr r1 |
| 7196 4464 9093 0000 sts (ExternHoehenValue)+1,r25 |
| 7197 4468 8093 0000 sts ExternHoehenValue,r24 |
| 7198 446c 8091 0000 lds r24,ExternControl+6 |
| 7199 4470 90E0 ldi r25,lo8(0) |
| 7200 4472 8615 cp r24,r6 |
| 7201 4474 9705 cpc r25,r7 |
| 7202 4476 04F0 brlt .+4 |
| 7203 4478 0C94 0000 jmp .L735 |
| 7204 447c 9093 0000 sts (StickGas)+1,r25 |
| 7205 4480 8093 0000 sts StickGas,r24 |
| 7206 4484 0C94 0000 jmp .L735 |
| 7207 .L733: |
| 7208 4488 1092 0000 sts (StickGier)+1,__zero_reg__ |
| 7209 448c 1092 0000 sts StickGier,__zero_reg__ |
| 7210 4490 0C94 0000 jmp .L732 |
| 7211 .L1058: |
| 7212 4494 F091 0000 lds r31,TrichterFlug |
| 7213 4498 FEA3 std Y+38,r31 |
| 7214 449a FF23 tst r31 |
| 7215 449c 01F0 breq .+4 |
| 7216 449e 0C94 0000 jmp .L831 |
| 7217 44a2 2091 0000 lds r18,EE_Parameter+48 |
| 7218 44a6 2C8F std Y+28,r18 |
| 7219 44a8 2223 tst r18 |
| 7220 44aa 01F4 brne .+4 |
| 7221 44ac 0C94 0000 jmp .L831 |
| 7222 44b0 4091 0000 lds r20,MittelIntegralNick |
| 7223 44b4 5091 0000 lds r21,(MittelIntegralNick)+1 |
| 7224 44b8 6091 0000 lds r22,(MittelIntegralNick)+2 |
| 7225 44bc 7091 0000 lds r23,(MittelIntegralNick)+3 |
| 7226 44c0 CB01 movw r24,r22 |
| 7227 44c2 BA01 movw r22,r20 |
| 7228 44c4 20E0 ldi r18,lo8(256) |
| 7229 44c6 31E0 ldi r19,hi8(256) |
| 7230 44c8 40E0 ldi r20,hlo8(256) |
| 7231 44ca 50E0 ldi r21,hhi8(256) |
| 7232 44cc 0E94 0000 call __divmodsi4 |
| 7233 44d0 28A7 std Y+40,r18 |
| 7234 44d2 39A7 std Y+41,r19 |
| 7235 44d4 4AA7 std Y+42,r20 |
| 7236 44d6 5BA7 std Y+43,r21 |
| 7237 44d8 2093 0000 sts MittelIntegralNick,r18 |
| 7238 44dc 3093 0000 sts (MittelIntegralNick)+1,r19 |
| 7239 44e0 4093 0000 sts (MittelIntegralNick)+2,r20 |
| 7240 44e4 5093 0000 sts (MittelIntegralNick)+3,r21 |
| 7241 44e8 2090 0000 lds r2,MittelIntegralRoll |
| 7242 44ec 3090 0000 lds r3,(MittelIntegralRoll)+1 |
| 7243 44f0 4090 0000 lds r4,(MittelIntegralRoll)+2 |
| 7244 44f4 5090 0000 lds r5,(MittelIntegralRoll)+3 |
| 7245 44f8 C201 movw r24,r4 |
| 7246 44fa B101 movw r22,r2 |
| 7247 44fc 20E0 ldi r18,lo8(256) |
| 7248 44fe 31E0 ldi r19,hi8(256) |
| 7249 4500 40E0 ldi r20,hlo8(256) |
| 7250 4502 50E0 ldi r21,hhi8(256) |
| 7251 4504 0E94 0000 call __divmodsi4 |
| 7252 4508 1901 movw r2,r18 |
| 7253 450a 2A01 movw r4,r20 |
| 7254 450c 2093 0000 sts MittelIntegralRoll,r18 |
| 7255 4510 3093 0000 sts (MittelIntegralRoll)+1,r19 |
| 7256 4514 4093 0000 sts (MittelIntegralRoll)+2,r20 |
| 7257 4518 5093 0000 sts (MittelIntegralRoll)+3,r21 |
| 7258 451c E090 0000 lds r14,EE_Parameter+20 |
| 7259 4520 FF24 clr r15 |
| 7260 4522 00E0 ldi r16,lo8(0) |
| 7261 4524 10E0 ldi r17,hi8(0) |
| 7262 4526 2091 0000 lds r18,IntegralAccNick |
| 7263 452a 3091 0000 lds r19,(IntegralAccNick)+1 |
| 7264 452e 4091 0000 lds r20,(IntegralAccNick)+2 |
| 7265 4532 5091 0000 lds r21,(IntegralAccNick)+3 |
| 7266 4536 C801 movw r24,r16 |
| 7267 4538 B701 movw r22,r14 |
| 7268 453a 0E94 0000 call __mulsi3 |
| 7269 453e 20E0 ldi r18,lo8(256) |
| 7270 4540 31E0 ldi r19,hi8(256) |
| 7271 4542 40E0 ldi r20,hlo8(256) |
| 7272 4544 50E0 ldi r21,hhi8(256) |
| 7273 4546 0E94 0000 call __divmodsi4 |
| 7274 454a 5901 movw r10,r18 |
| 7275 454c 6A01 movw r12,r20 |
| 7276 454e 2093 0000 sts IntegralAccNick,r18 |
| 7277 4552 3093 0000 sts (IntegralAccNick)+1,r19 |
| 7278 4556 4093 0000 sts (IntegralAccNick)+2,r20 |
| 7279 455a 5093 0000 sts (IntegralAccNick)+3,r21 |
| 7280 455e 2091 0000 lds r18,IntegralAccRoll |
| 7281 4562 3091 0000 lds r19,(IntegralAccRoll)+1 |
| 7282 4566 4091 0000 lds r20,(IntegralAccRoll)+2 |
| 7283 456a 5091 0000 lds r21,(IntegralAccRoll)+3 |
| 7284 456e C801 movw r24,r16 |
| 7285 4570 B701 movw r22,r14 |
| 7286 4572 0E94 0000 call __mulsi3 |
| 7287 4576 20E0 ldi r18,lo8(256) |
| 7288 4578 31E0 ldi r19,hi8(256) |
| 7289 457a 40E0 ldi r20,hlo8(256) |
| 7290 457c 50E0 ldi r21,hhi8(256) |
| 7291 457e 0E94 0000 call __divmodsi4 |
| 7292 4582 3901 movw r6,r18 |
| 7293 4584 4A01 movw r8,r20 |
| 7294 4586 2093 0000 sts IntegralAccRoll,r18 |
| 7295 458a 3093 0000 sts (IntegralAccRoll)+1,r19 |
| 7296 458e 4093 0000 sts (IntegralAccRoll)+2,r20 |
| 7297 4592 5093 0000 sts (IntegralAccRoll)+3,r21 |
| 7298 4596 6091 0000 lds r22,IntegralAccZ |
| 7299 459a 7091 0000 lds r23,(IntegralAccZ)+1 |
| 7300 459e 8091 0000 lds r24,(IntegralAccZ)+2 |
| 7301 45a2 9091 0000 lds r25,(IntegralAccZ)+3 |
| 7302 45a6 20E0 ldi r18,lo8(256) |
| 7303 45a8 31E0 ldi r19,hi8(256) |
| 7304 45aa 40E0 ldi r20,hlo8(256) |
| 7305 45ac 50E0 ldi r21,hhi8(256) |
| 7306 45ae 0E94 0000 call __divmodsi4 |
| 7307 45b2 2093 0000 sts IntegralAccZ,r18 |
| 7308 45b6 3093 0000 sts (IntegralAccZ)+1,r19 |
| 7309 45ba 4093 0000 sts (IntegralAccZ)+2,r20 |
| 7310 45be 5093 0000 sts (IntegralAccZ)+3,r21 |
| 7311 45c2 E090 0000 lds r14,EE_Parameter+47 |
| 7312 45c6 FF24 clr r15 |
| 7313 45c8 00E0 ldi r16,lo8(0) |
| 7314 45ca 10E0 ldi r17,hi8(0) |
| 7315 45cc 68A5 ldd r22,Y+40 |
| 7316 45ce 79A5 ldd r23,Y+41 |
| 7317 45d0 8AA5 ldd r24,Y+42 |
| 7318 45d2 9BA5 ldd r25,Y+43 |
| 7319 45d4 6A19 sub r22,r10 |
| 7320 45d6 7B09 sbc r23,r11 |
| 7321 45d8 8C09 sbc r24,r12 |
| 7322 45da 9D09 sbc r25,r13 |
| 7323 45dc A801 movw r20,r16 |
| 7324 45de 9701 movw r18,r14 |
| 7325 45e0 0E94 0000 call __divmodsi4 |
| 7326 45e4 2093 0000 sts ausgleichNick.3089,r18 |
| 7327 45e8 3093 0000 sts (ausgleichNick.3089)+1,r19 |
| 7328 45ec 4093 0000 sts (ausgleichNick.3089)+2,r20 |
| 7329 45f0 5093 0000 sts (ausgleichNick.3089)+3,r21 |
| 7330 45f4 CA01 movw r24,r20 |
| 7331 45f6 B901 movw r22,r18 |
| 7332 45f8 20E0 ldi r18,lo8(256) |
| 7333 45fa 31E0 ldi r19,hi8(256) |
| 7334 45fc 40E0 ldi r20,hlo8(256) |
| 7335 45fe 50E0 ldi r21,hhi8(256) |
| 7336 4600 0E94 0000 call __divmodsi4 |
| 7337 4604 6901 movw r12,r18 |
| 7338 4606 3093 0000 sts (LageKorrekturNick)+1,r19 |
| 7339 460a 2093 0000 sts LageKorrekturNick,r18 |
| 7340 460e C201 movw r24,r4 |
| 7341 4610 B101 movw r22,r2 |
| 7342 4612 6619 sub r22,r6 |
| 7343 4614 7709 sbc r23,r7 |
| 7344 4616 8809 sbc r24,r8 |
| 7345 4618 9909 sbc r25,r9 |
| 7346 461a A801 movw r20,r16 |
| 7347 461c 9701 movw r18,r14 |
| 7348 461e 0E94 0000 call __divmodsi4 |
| 7349 4622 CA01 movw r24,r20 |
| 7350 4624 B901 movw r22,r18 |
| 7351 4626 20E0 ldi r18,lo8(256) |
| 7352 4628 31E0 ldi r19,hi8(256) |
| 7353 462a 40E0 ldi r20,hlo8(256) |
| 7354 462c 50E0 ldi r21,hhi8(256) |
| 7355 462e 0E94 0000 call __divmodsi4 |
| 7356 4632 B901 movw r22,r18 |
| 7357 4634 3093 0000 sts (LageKorrekturRoll)+1,r19 |
| 7358 4638 2093 0000 sts LageKorrekturRoll,r18 |
| 7359 463c 8091 0000 lds r24,MaxStickNick |
| 7360 4640 9091 0000 lds r25,(MaxStickNick)+1 |
| 7361 4644 8134 cpi r24,65 |
| 7362 4646 9105 cpc r25,__zero_reg__ |
| 7363 4648 04F4 brge .L836 |
| 7364 464a 8091 0000 lds r24,MaxStickRoll |
| 7365 464e 9091 0000 lds r25,(MaxStickRoll)+1 |
| 7366 4652 8134 cpi r24,65 |
| 7367 4654 9105 cpc r25,__zero_reg__ |
| 7368 4656 04F4 brge .L836 |
| 7369 4658 E091 0000 lds r30,EE_Parameter+3 |
| 7370 465c F0E0 ldi r31,lo8(0) |
| 7371 465e EE0F lsl r30 |
| 7372 4660 FF1F rol r31 |
| 7373 4662 E050 subi r30,lo8(-(PPM_in)) |
| 7374 4664 F040 sbci r31,hi8(-(PPM_in)) |
| 7375 4666 0190 ld __tmp_reg__,Z+ |
| 7376 4668 F081 ld r31,Z |
| 7377 466a E02D mov r30,__tmp_reg__ |
| 7378 466c F7FD sbrc r31,7 |
| 7379 466e 00C0 rjmp .L1112 |
| 7380 .L840: |
| 7381 4670 7A97 sbiw r30,26 |
| 7382 4672 04F0 brlt .L839 |
| 7383 .L836: |
| 7384 4674 8091 0000 lds r24,FromNaviCtrl_Value |
| 7385 4678 8F3F cpi r24,lo8(-1) |
| 7386 467a 01F4 brne .+2 |
| 7387 467c 00C0 rjmp .L1113 |
| 7388 .L839: |
| 7389 467e 6091 0000 lds r22,MittelIntegralNick2 |
| 7390 4682 7091 0000 lds r23,(MittelIntegralNick2)+1 |
| 7391 4686 8091 0000 lds r24,(MittelIntegralNick2)+2 |
| 7392 468a 9091 0000 lds r25,(MittelIntegralNick2)+3 |
| 7393 468e 20E0 ldi r18,lo8(256) |
| 7394 4690 31E0 ldi r19,hi8(256) |
| 7395 4692 40E0 ldi r20,hlo8(256) |
| 7396 4694 50E0 ldi r21,hhi8(256) |
| 7397 4696 0E94 0000 call __divmodsi4 |
| 7398 469a 2093 0000 sts MittelIntegralNick2,r18 |
| 7399 469e 3093 0000 sts (MittelIntegralNick2)+1,r19 |
| 7400 46a2 4093 0000 sts (MittelIntegralNick2)+2,r20 |
| 7401 46a6 5093 0000 sts (MittelIntegralNick2)+3,r21 |
| 7402 46aa 6091 0000 lds r22,MittelIntegralRoll2 |
| 7403 46ae 7091 0000 lds r23,(MittelIntegralRoll2)+1 |
| 7404 46b2 8091 0000 lds r24,(MittelIntegralRoll2)+2 |
| 7405 46b6 9091 0000 lds r25,(MittelIntegralRoll2)+3 |
| 7406 46ba 20E0 ldi r18,lo8(256) |
| 7407 46bc 31E0 ldi r19,hi8(256) |
| 7408 46be 40E0 ldi r20,hlo8(256) |
| 7409 46c0 50E0 ldi r21,hhi8(256) |
| 7410 46c2 0E94 0000 call __divmodsi4 |
| 7411 46c6 2093 0000 sts MittelIntegralRoll2,r18 |
| 7412 46ca 3093 0000 sts (MittelIntegralRoll2)+1,r19 |
| 7413 46ce 4093 0000 sts (MittelIntegralRoll2)+2,r20 |
| 7414 46d2 5093 0000 sts (MittelIntegralRoll2)+3,r21 |
| 7415 46d6 E9A0 ldd r14,Y+33 |
| 7416 46d8 FAA0 ldd r15,Y+34 |
| 7417 46da 0BA1 ldd r16,Y+35 |
| 7418 46dc 1CA1 ldd r17,Y+36 |
| 7419 46de 6981 ldd r22,Y+1 |
| 7420 46e0 7A81 ldd r23,Y+2 |
| 7421 46e2 8B81 ldd r24,Y+3 |
| 7422 46e4 9C81 ldd r25,Y+4 |
| 7423 46e6 E61A sub r14,r22 |
| 7424 46e8 F70A sbc r15,r23 |
| 7425 46ea 080B sbc r16,r24 |
| 7426 46ec 190B sbc r17,r25 |
| 7427 46ee E092 0000 sts tmp_long.3070,r14 |
| 7428 46f2 F092 0000 sts (tmp_long.3070)+1,r15 |
| 7429 46f6 0093 0000 sts (tmp_long.3070)+2,r16 |
| 7430 46fa 1093 0000 sts (tmp_long.3070)+3,r17 |
| 7431 46fe AD8C ldd r10,Y+29 |
| 7432 4700 BE8C ldd r11,Y+30 |
| 7433 4702 CF8C ldd r12,Y+31 |
| 7434 4704 D8A0 ldd r13,Y+32 |
| 7435 4706 8D81 ldd r24,Y+5 |
| 7436 4708 9E81 ldd r25,Y+6 |
| 7437 470a AF81 ldd r26,Y+7 |
| 7438 470c B885 ldd r27,Y+8 |
| 7439 470e A81A sub r10,r24 |
| 7440 4710 B90A sbc r11,r25 |
| 7441 4712 CA0A sbc r12,r26 |
| 7442 4714 DB0A sbc r13,r27 |
| 7443 4716 A092 0000 sts tmp_long2.3071,r10 |
| 7444 471a B092 0000 sts (tmp_long2.3071)+1,r11 |
| 7445 471e C092 0000 sts (tmp_long2.3071)+2,r12 |
| 7446 4722 D092 0000 sts (tmp_long2.3071)+3,r13 |
| 7447 4726 E092 0000 sts IntegralFehlerNick.3072,r14 |
| 7448 472a F092 0000 sts (IntegralFehlerNick.3072)+1,r15 |
| 7449 472e 0093 0000 sts (IntegralFehlerNick.3072)+2,r16 |
| 7450 4732 1093 0000 sts (IntegralFehlerNick.3072)+3,r17 |
| 7451 4736 A092 0000 sts IntegralFehlerRoll.3073,r10 |
| 7452 473a B092 0000 sts (IntegralFehlerRoll.3073)+1,r11 |
| 7453 473e C092 0000 sts (IntegralFehlerRoll.3073)+2,r12 |
| 7454 4742 D092 0000 sts (IntegralFehlerRoll.3073)+3,r13 |
| 7455 4746 8091 0000 lds r24,Mess_IntegralNick2 |
| 7456 474a 9091 0000 lds r25,(Mess_IntegralNick2)+1 |
| 7457 474e A091 0000 lds r26,(Mess_IntegralNick2)+2 |
| 7458 4752 B091 0000 lds r27,(Mess_IntegralNick2)+3 |
| 7459 4756 8E19 sub r24,r14 |
| 7460 4758 9F09 sbc r25,r15 |
| 7461 475a A00B sbc r26,r16 |
| 7462 475c B10B sbc r27,r17 |
| 7463 475e 8093 0000 sts Mess_IntegralNick2,r24 |
| 7464 4762 9093 0000 sts (Mess_IntegralNick2)+1,r25 |
| 7465 4766 A093 0000 sts (Mess_IntegralNick2)+2,r26 |
| 7466 476a B093 0000 sts (Mess_IntegralNick2)+3,r27 |
| 7467 476e 8091 0000 lds r24,Mess_IntegralRoll2 |
| 7468 4772 9091 0000 lds r25,(Mess_IntegralRoll2)+1 |
| 7469 4776 A091 0000 lds r26,(Mess_IntegralRoll2)+2 |
| 7470 477a B091 0000 lds r27,(Mess_IntegralRoll2)+3 |
| 7471 477e 8A19 sub r24,r10 |
| 7472 4780 9B09 sbc r25,r11 |
| 7473 4782 AC09 sbc r26,r12 |
| 7474 4784 BD09 sbc r27,r13 |
| 7475 4786 8093 0000 sts Mess_IntegralRoll2,r24 |
| 7476 478a 9093 0000 sts (Mess_IntegralRoll2)+1,r25 |
| 7477 478e A093 0000 sts (Mess_IntegralRoll2)+2,r26 |
| 7478 4792 B093 0000 sts (Mess_IntegralRoll2)+3,r27 |
| 7479 4796 2091 0000 lds r18,GierGyroFehler |
| 7480 479a 3091 0000 lds r19,(GierGyroFehler)+1 |
| 7481 479e 2138 cpi r18,129 |
| 7482 47a0 3105 cpc r19,__zero_reg__ |
| 7483 47a2 04F0 brlt .L844 |
| 7484 47a4 8091 0000 lds r24,AdNeutralGier |
| 7485 47a8 9091 0000 lds r25,(AdNeutralGier)+1 |
| 7486 47ac 0196 adiw r24,1 |
| 7487 47ae 9093 0000 sts (AdNeutralGier)+1,r25 |
| 7488 47b2 8093 0000 sts AdNeutralGier,r24 |
| 7489 47b6 8091 0000 lds r24,AdNeutralGierBias |
| 7490 47ba 9091 0000 lds r25,(AdNeutralGierBias)+1 |
| 7491 47be 0196 adiw r24,1 |
| 7492 47c0 9093 0000 sts (AdNeutralGierBias)+1,r25 |
| 7493 47c4 8093 0000 sts AdNeutralGierBias,r24 |
| 7494 .L844: |
| 7495 47c8 2058 subi r18,lo8(-128) |
| 7496 47ca 3F4F sbci r19,hi8(-128) |
| 7497 47cc 04F4 brge .L846 |
| 7498 47ce 8091 0000 lds r24,AdNeutralGier |
| 7499 47d2 9091 0000 lds r25,(AdNeutralGier)+1 |
| 7500 47d6 0197 sbiw r24,1 |
| 7501 47d8 9093 0000 sts (AdNeutralGier)+1,r25 |
| 7502 47dc 8093 0000 sts AdNeutralGier,r24 |
| 7503 47e0 8091 0000 lds r24,AdNeutralGierBias |
| 7504 47e4 9091 0000 lds r25,(AdNeutralGierBias)+1 |
| 7505 47e8 0197 sbiw r24,1 |
| 7506 47ea 9093 0000 sts (AdNeutralGierBias)+1,r25 |
| 7507 47ee 8093 0000 sts AdNeutralGierBias,r24 |
| 7508 .L846: |
| 7509 47f2 1092 0000 sts (GierGyroFehler)+1,__zero_reg__ |
| 7510 47f6 1092 0000 sts GierGyroFehler,__zero_reg__ |
| 7511 47fa 81E0 ldi r24,lo8(1) |
| 7512 47fc 90E0 ldi r25,hi8(1) |
| 7513 47fe 9093 0000 sts (cnt.3099)+1,r25 |
| 7514 4802 8093 0000 sts cnt.3099,r24 |
| 7515 4806 8091 0000 lds r24,MittelIntegralNick_Alt.3104 |
| 7516 480a 9091 0000 lds r25,(MittelIntegralNick_Alt.3104)+1 |
| 7517 480e A091 0000 lds r26,(MittelIntegralNick_Alt.3104)+2 |
| 7518 4812 B091 0000 lds r27,(MittelIntegralNick_Alt.3104)+3 |
| 7519 4816 28A5 ldd r18,Y+40 |
| 7520 4818 39A5 ldd r19,Y+41 |
| 7521 481a 4AA5 ldd r20,Y+42 |
| 7522 481c 5BA5 ldd r21,Y+43 |
| 7523 481e 821B sub r24,r18 |
| 7524 4820 930B sbc r25,r19 |
| 7525 4822 A40B sbc r26,r20 |
| 7526 4824 B50B sbc r27,r21 |
| 7527 4826 815E subi r24,lo8(-(19999)) |
| 7528 4828 914B sbci r25,hi8(-(19999)) |
| 7529 482a AF4F sbci r26,hlo8(-(19999)) |
| 7530 482c BF4F sbci r27,hhi8(-(19999)) |
| 7531 482e 8F53 subi r24,lo8(39999) |
| 7532 4830 9C49 sbci r25,hi8(39999) |
| 7533 4832 A040 sbci r26,hlo8(39999) |
| 7534 4834 B040 sbci r27,hhi8(39999) |
| 7535 4836 00F4 brsh .+2 |
| 7536 4838 00C0 rjmp .L1047 |
| 7537 483a 9090 0000 lds r9,FromNaviCtrl_Value+1 |
| 7538 483e 48E1 ldi r20,lo8(24) |
| 7539 4840 4915 cp r20,r9 |
| 7540 4842 04F4 brge .+2 |
| 7541 4844 00C0 rjmp .L848 |
| 7542 4846 1092 0000 sts (cnt.3099)+1,__zero_reg__ |
| 7543 484a 1092 0000 sts cnt.3099,__zero_reg__ |
| 7544 484e 88EE ldi r24,lo8(1000) |
| 7545 4850 93E0 ldi r25,hi8(1000) |
| 7546 4852 9093 0000 sts (KompassSignalSchlecht)+1,r25 |
| 7547 4856 8093 0000 sts KompassSignalSchlecht,r24 |
| 7548 .L863: |
| 7549 485a 9C8D ldd r25,Y+28 |
| 7550 485c 692E mov r6,r25 |
| 7551 485e 7724 clr r7 |
| 7552 4860 8091 0000 lds r24,cnt.3099 |
| 7553 4864 9091 0000 lds r25,(cnt.3099)+1 |
| 7554 4868 6816 cp r6,r24 |
| 7555 486a 7906 cpc r7,r25 |
| 7556 486c 04F4 brge .L864 |
| 7557 486e 7092 0000 sts (cnt.3099)+1,r7 |
| 7558 4872 6092 0000 sts cnt.3099,r6 |
| 7559 .L864: |
| 7560 4876 9920 tst r9 |
| 7561 4878 01F0 breq .L866 |
| 7562 487a 292D mov r18,r9 |
| 7563 487c 3327 clr r19 |
| 7564 487e 27FD sbrc r18,7 |
| 7565 4880 3095 com r19 |
| 7566 4882 8091 0000 lds r24,cnt.3099 |
| 7567 4886 9091 0000 lds r25,(cnt.3099)+1 |
| 7568 488a 2817 cp r18,r24 |
| 7569 488c 3907 cpc r19,r25 |
| 7570 488e 04F4 brge .L866 |
| 7571 4890 3093 0000 sts (cnt.3099)+1,r19 |
| 7572 4894 2093 0000 sts cnt.3099,r18 |
| 7573 .L866: |
| 7574 4898 A1E0 ldi r26,lo8(1025) |
| 7575 489a EA16 cp r14,r26 |
| 7576 489c A4E0 ldi r26,hi8(1025) |
| 7577 489e FA06 cpc r15,r26 |
| 7578 48a0 A0E0 ldi r26,hlo8(1025) |
| 7579 48a2 0A07 cpc r16,r26 |
| 7580 48a4 A0E0 ldi r26,hhi8(1025) |
| 7581 48a6 1A07 cpc r17,r26 |
| 7582 48a8 04F0 brlt .L869 |
| 7583 48aa 8091 0000 lds r24,AdNeutralNick |
| 7584 48ae 9091 0000 lds r25,(AdNeutralNick)+1 |
| 7585 48b2 2091 0000 lds r18,cnt.3099 |
| 7586 48b6 3091 0000 lds r19,(cnt.3099)+1 |
| 7587 48ba 820F add r24,r18 |
| 7588 48bc 931F adc r25,r19 |
| 7589 48be 9093 0000 sts (AdNeutralNick)+1,r25 |
| 7590 48c2 8093 0000 sts AdNeutralNick,r24 |
| 7591 .L869: |
| 7592 48c6 B0E0 ldi r27,lo8(-1024) |
| 7593 48c8 EB16 cp r14,r27 |
| 7594 48ca BCEF ldi r27,hi8(-1024) |
| 7595 48cc FB06 cpc r15,r27 |
| 7596 48ce BFEF ldi r27,hlo8(-1024) |
| 7597 48d0 0B07 cpc r16,r27 |
| 7598 48d2 BFEF ldi r27,hhi8(-1024) |
| 7599 48d4 1B07 cpc r17,r27 |
| 7600 48d6 04F4 brge .L871 |
| 7601 48d8 8091 0000 lds r24,AdNeutralNick |
| 7602 48dc 9091 0000 lds r25,(AdNeutralNick)+1 |
| 7603 48e0 2091 0000 lds r18,cnt.3099 |
| 7604 48e4 3091 0000 lds r19,(cnt.3099)+1 |
| 7605 48e8 821B sub r24,r18 |
| 7606 48ea 930B sbc r25,r19 |
| 7607 48ec 9093 0000 sts (AdNeutralNick)+1,r25 |
| 7608 48f0 8093 0000 sts AdNeutralNick,r24 |
| 7609 .L871: |
| 7610 48f4 81E0 ldi r24,lo8(1) |
| 7611 48f6 90E0 ldi r25,hi8(1) |
| 7612 48f8 9093 0000 sts (cnt.3099)+1,r25 |
| 7613 48fc 8093 0000 sts cnt.3099,r24 |
| 7614 4900 1092 0000 sts ausgleichRoll.3090,__zero_reg__ |
| 7615 4904 1092 0000 sts (ausgleichRoll.3090)+1,__zero_reg__ |
| 7616 4908 1092 0000 sts (ausgleichRoll.3090)+2,__zero_reg__ |
| 7617 490c 1092 0000 sts (ausgleichRoll.3090)+3,__zero_reg__ |
| 7618 4910 8091 0000 lds r24,MittelIntegralRoll_Alt.3105 |
| 7619 4914 9091 0000 lds r25,(MittelIntegralRoll_Alt.3105)+1 |
| 7620 4918 A091 0000 lds r26,(MittelIntegralRoll_Alt.3105)+2 |
| 7621 491c B091 0000 lds r27,(MittelIntegralRoll_Alt.3105)+3 |
| 7622 4920 8219 sub r24,r2 |
| 7623 4922 9309 sbc r25,r3 |
| 7624 4924 A409 sbc r26,r4 |
| 7625 4926 B509 sbc r27,r5 |
| 7626 4928 815E subi r24,lo8(-(19999)) |
| 7627 492a 914B sbci r25,hi8(-(19999)) |
| 7628 492c AF4F sbci r26,hlo8(-(19999)) |
| 7629 492e BF4F sbci r27,hhi8(-(19999)) |
| 7630 4930 8F53 subi r24,lo8(39999) |
| 7631 4932 9C49 sbci r25,hi8(39999) |
| 7632 4934 A040 sbci r26,hlo8(39999) |
| 7633 4936 B040 sbci r27,hhi8(39999) |
| 7634 4938 00F4 brsh .+2 |
| 7635 493a 00C0 rjmp .L873 |
| 7636 493c F8E1 ldi r31,lo8(24) |
| 7637 493e F915 cp r31,r9 |
| 7638 4940 04F4 brge .+2 |
| 7639 4942 00C0 rjmp .L873 |
| 7640 4944 1092 0000 sts (cnt.3099)+1,__zero_reg__ |
| 7641 4948 1092 0000 sts cnt.3099,__zero_reg__ |
| 7642 494c 88EE ldi r24,lo8(1000) |
| 7643 494e 93E0 ldi r25,hi8(1000) |
| 7644 4950 9093 0000 sts (KompassSignalSchlecht)+1,r25 |
| 7645 4954 8093 0000 sts KompassSignalSchlecht,r24 |
| 7646 .L888: |
| 7647 4958 8091 0000 lds r24,cnt.3099 |
| 7648 495c 9091 0000 lds r25,(cnt.3099)+1 |
| 7649 4960 6816 cp r6,r24 |
| 7650 4962 7906 cpc r7,r25 |
| 7651 4964 04F4 brge .L889 |
| 7652 4966 7092 0000 sts (cnt.3099)+1,r7 |
| 7653 496a 6092 0000 sts cnt.3099,r6 |
| 7654 .L889: |
| 7655 496e 9920 tst r9 |
| 7656 4970 01F0 breq .L891 |
| 7657 4972 292D mov r18,r9 |
| 7658 4974 3327 clr r19 |
| 7659 4976 27FD sbrc r18,7 |
| 7660 4978 3095 com r19 |
| 7661 497a 8091 0000 lds r24,cnt.3099 |
| 7662 497e 9091 0000 lds r25,(cnt.3099)+1 |
| 7663 4982 2817 cp r18,r24 |
| 7664 4984 3907 cpc r19,r25 |
| 7665 4986 04F4 brge .L891 |
| 7666 4988 3093 0000 sts (cnt.3099)+1,r19 |
| 7667 498c 2093 0000 sts cnt.3099,r18 |
| 7668 .L891: |
| 7669 4990 71E0 ldi r23,lo8(1025) |
| 7670 4992 A716 cp r10,r23 |
| 7671 4994 74E0 ldi r23,hi8(1025) |
| 7672 4996 B706 cpc r11,r23 |
| 7673 4998 70E0 ldi r23,hlo8(1025) |
| 7674 499a C706 cpc r12,r23 |
| 7675 499c 70E0 ldi r23,hhi8(1025) |
| 7676 499e D706 cpc r13,r23 |
| 7677 49a0 04F0 brlt .L894 |
| 7678 49a2 8091 0000 lds r24,AdNeutralRoll |
| 7679 49a6 9091 0000 lds r25,(AdNeutralRoll)+1 |
| 7680 49aa 2091 0000 lds r18,cnt.3099 |
| 7681 49ae 3091 0000 lds r19,(cnt.3099)+1 |
| 7682 49b2 820F add r24,r18 |
| 7683 49b4 931F adc r25,r19 |
| 7684 49b6 9093 0000 sts (AdNeutralRoll)+1,r25 |
| 7685 49ba 8093 0000 sts AdNeutralRoll,r24 |
| 7686 .L894: |
| 7687 49be 80E0 ldi r24,lo8(-1024) |
| 7688 49c0 A816 cp r10,r24 |
| 7689 49c2 8CEF ldi r24,hi8(-1024) |
| 7690 49c4 B806 cpc r11,r24 |
| 7691 49c6 8FEF ldi r24,hlo8(-1024) |
| 7692 49c8 C806 cpc r12,r24 |
| 7693 49ca 8FEF ldi r24,hhi8(-1024) |
| 7694 49cc D806 cpc r13,r24 |
| 7695 49ce 04F0 brlt .+4 |
| 7696 49d0 0C94 0000 jmp .L896 |
| 7697 49d4 8091 0000 lds r24,AdNeutralRoll |
| 7698 49d8 9091 0000 lds r25,(AdNeutralRoll)+1 |
| 7699 49dc 2091 0000 lds r18,cnt.3099 |
| 7700 49e0 3091 0000 lds r19,(cnt.3099)+1 |
| 7701 49e4 821B sub r24,r18 |
| 7702 49e6 930B sbc r25,r19 |
| 7703 49e8 9093 0000 sts (AdNeutralRoll)+1,r25 |
| 7704 49ec 8093 0000 sts AdNeutralRoll,r24 |
| 7705 49f0 0C94 0000 jmp .L896 |
| 7706 .L1098: |
| 7707 49f4 9701 movw r18,r14 |
| 7708 49f6 0C94 0000 jmp .L997 |
| 7709 .L1063: |
| 7710 49fa 6801 movw r12,r16 |
| 7711 49fc 0C94 0000 jmp .L914 |
| 7712 .L1065: |
| 7713 4a00 60E0 ldi r22,lo8(0) |
| 7714 4a02 70E0 ldi r23,hi8(0) |
| 7715 4a04 00E0 ldi r16,lo8(0) |
| 7716 4a06 10E0 ldi r17,hi8(0) |
| 7717 4a08 0C94 0000 jmp .L918 |
| 7718 .L969: |
| 7719 4a0c 8091 0000 lds r24,Parameter_MaxHoehe |
| 7720 4a10 8233 cpi r24,lo8(50) |
| 7721 4a12 00F4 brsh .+4 |
| 7722 4a14 0C94 0000 jmp .L971 |
| 7723 .L972: |
| 7724 4a18 81E0 ldi r24,lo8(1) |
| 7725 4a1a 8093 0000 sts HoehenReglerAktiv,r24 |
| 7726 4a1e 88EC ldi r24,lo8(-56) |
| 7727 4a20 8093 0000 sts delay.3112,r24 |
| 7728 4a24 2091 0000 lds r18,HoehenWert |
| 7729 4a28 3091 0000 lds r19,(HoehenWert)+1 |
| 7730 4a2c 00C0 rjmp .L973 |
| 7731 .L1073: |
| 7732 4a2e 4D5F subi r20,lo8(-(3)) |
| 7733 4a30 5F4F sbci r21,hi8(-(3)) |
| 7734 4a32 0C94 0000 jmp .L728 |
| 7735 .L1074: |
| 7736 4a36 4D5F subi r20,lo8(-(3)) |
| 7737 4a38 5F4F sbci r21,hi8(-(3)) |
| 7738 4a3a 0C94 0000 jmp .L729 |
| 7739 .L1070: |
| 7740 4a3e 1092 0000 sts SummeNick.3067,__zero_reg__ |
| 7741 4a42 1092 0000 sts (SummeNick.3067)+1,__zero_reg__ |
| 7742 4a46 1092 0000 sts (SummeNick.3067)+2,__zero_reg__ |
| 7743 4a4a 1092 0000 sts (SummeNick.3067)+3,__zero_reg__ |
| 7744 4a4e 1092 0000 sts SummeRoll.3068,__zero_reg__ |
| 7745 4a52 1092 0000 sts (SummeRoll.3068)+1,__zero_reg__ |
| 7746 4a56 1092 0000 sts (SummeRoll.3068)+2,__zero_reg__ |
| 7747 4a5a 1092 0000 sts (SummeRoll.3068)+3,__zero_reg__ |
| 7748 4a5e 8A3F cpi r24,250 |
| 7749 4a60 9105 cpc r25,__zero_reg__ |
| 7750 4a62 01F0 breq .+4 |
| 7751 4a64 0C94 0000 jmp .L669 |
| 7752 4a68 81E0 ldi r24,lo8(1) |
| 7753 4a6a 8093 0000 sts NeueKompassRichtungMerken.3088,r24 |
| 7754 4a6e 1092 0000 sts sollGier.3069,__zero_reg__ |
| 7755 4a72 1092 0000 sts (sollGier.3069)+1,__zero_reg__ |
| 7756 4a76 1092 0000 sts (sollGier.3069)+2,__zero_reg__ |
| 7757 4a7a 1092 0000 sts (sollGier.3069)+3,__zero_reg__ |
| 7758 4a7e 1092 0000 sts Mess_Integral_Gier,__zero_reg__ |
| 7759 4a82 1092 0000 sts (Mess_Integral_Gier)+1,__zero_reg__ |
| 7760 4a86 1092 0000 sts (Mess_Integral_Gier)+2,__zero_reg__ |
| 7761 4a8a 1092 0000 sts (Mess_Integral_Gier)+3,__zero_reg__ |
| 7762 4a8e 0C94 0000 jmp .L669 |
| 7763 .L1091: |
| 7764 4a92 A0E0 ldi r26,lo8(0) |
| 7765 4a94 1092 0000 sts Looping_Oben,__zero_reg__ |
| 7766 4a98 0C94 0000 jmp .L775 |
| 7767 .L1093: |
| 7768 4a9c 1092 0000 sts Looping_Unten,__zero_reg__ |
| 7769 4aa0 0C94 0000 jmp .L781 |
| 7770 .L1089: |
| 7771 4aa4 1092 0000 sts Looping_Rechts,__zero_reg__ |
| 7772 4aa8 0C94 0000 jmp .L769 |
| 7773 .L1055: |
| 7774 4aac 88E9 ldi r24,lo8(15000) |
| 7775 4aae 9AE3 ldi r25,hi8(15000) |
| 7776 4ab0 9093 0000 sts (beeptime)+1,r25 |
| 7777 4ab4 8093 0000 sts beeptime,r24 |
| 7778 4ab8 80E0 ldi r24,lo8(3072) |
| 7779 4aba 9CE0 ldi r25,hi8(3072) |
| 7780 4abc 9093 0000 sts (BeepMuster)+1,r25 |
| 7781 4ac0 8093 0000 sts BeepMuster,r24 |
| 7782 4ac4 0C94 0000 jmp .L649 |
| 7783 .L1062: |
| 7784 4ac8 D094 com r13 |
| 7785 4aca C194 neg r12 |
| 7786 4acc D108 sbc r13,__zero_reg__ |
| 7787 4ace D394 inc r13 |
| 7788 4ad0 0C94 0000 jmp .L913 |
| 7789 .L1061: |
| 7790 4ad4 1095 com r17 |
| 7791 4ad6 0195 neg r16 |
| 7792 4ad8 1F4F sbci r17,lo8(-1) |
| 7793 4ada 0C94 0000 jmp .L912 |
| 7794 .L1064: |
| 7795 4ade 8827 clr r24 |
| 7796 4ae0 9927 clr r25 |
| 7797 4ae2 8819 sub r24,r8 |
| 7798 4ae4 9909 sbc r25,r9 |
| 7799 4ae6 0C94 0000 jmp .L916 |
| 7800 .L1097: |
| 7801 4aea 3196 adiw r30,1 |
| 7802 4aec 0C94 0000 jmp .L999 |
| 7803 .L805: |
| 7804 4af0 C401 movw r24,r8 |
| 7805 4af2 B301 movw r22,r6 |
| 7806 4af4 22E0 ldi r18,lo8(2) |
| 7807 4af6 30E0 ldi r19,hi8(2) |
| 7808 4af8 40E0 ldi r20,hlo8(2) |
| 7809 4afa 50E0 ldi r21,hhi8(2) |
| 7810 4afc 0E94 0000 call __divmodsi4 |
| 7811 4b00 3901 movw r6,r18 |
| 7812 4b02 4A01 movw r8,r20 |
| 7813 4b04 C601 movw r24,r12 |
| 7814 4b06 B501 movw r22,r10 |
| 7815 4b08 22E0 ldi r18,lo8(2) |
| 7816 4b0a 30E0 ldi r19,hi8(2) |
| 7817 4b0c 40E0 ldi r20,hlo8(2) |
| 7818 4b0e 50E0 ldi r21,hhi8(2) |
| 7819 4b10 0E94 0000 call __divmodsi4 |
| 7820 4b14 5901 movw r10,r18 |
| 7821 4b16 6A01 movw r12,r20 |
| 7822 4b18 00C0 rjmp .L807 |
| 7823 .L1076: |
| 7824 4b1a 1092 0000 sts (StickGas)+1,__zero_reg__ |
| 7825 4b1e 1092 0000 sts StickGas,__zero_reg__ |
| 7826 4b22 0C94 0000 jmp .L739 |
| 7827 .L1078: |
| 7828 4b26 9095 com r25 |
| 7829 4b28 8195 neg r24 |
| 7830 4b2a 9F4F sbci r25,lo8(-1) |
| 7831 4b2c 0C94 0000 jmp .L745 |
| 7832 .L1077: |
| 7833 4b30 0396 adiw r24,3 |
| 7834 4b32 0C94 0000 jmp .L744 |
| 7835 .L1082: |
| 7836 4b36 0396 adiw r24,3 |
| 7837 4b38 9595 asr r25 |
| 7838 4b3a 8795 ror r24 |
| 7839 4b3c 9595 asr r25 |
| 7840 4b3e 8795 ror r24 |
| 7841 4b40 97FD sbrc r25,7 |
| 7842 4b42 00C0 rjmp .+4 |
| 7843 4b44 0C94 0000 jmp .L753 |
| 7844 .L1083: |
| 7845 4b48 9095 com r25 |
| 7846 4b4a 8195 neg r24 |
| 7847 4b4c 9F4F sbci r25,lo8(-1) |
| 7848 4b4e 0C94 0000 jmp .L753 |
| 7849 .L927: |
| 7850 4b52 0894 sec |
| 7851 4b54 E108 sbc r14,__zero_reg__ |
| 7852 4b56 F108 sbc r15,__zero_reg__ |
| 7853 4b58 F092 0000 sts (KompassSignalSchlecht)+1,r15 |
| 7854 4b5c E092 0000 sts KompassSignalSchlecht,r14 |
| 7855 4b60 0C94 0000 jmp .L909 |
| 7856 .L1056: |
| 7857 4b64 4B2F mov r20,r27 |
| 7858 4b66 50E0 ldi r21,lo8(0) |
| 7859 4b68 5B87 std Y+11,r21 |
| 7860 4b6a 4A87 std Y+10,r20 |
| 7861 4b6c 8091 0000 lds r24,Looping_Nick |
| 7862 4b70 8823 tst r24 |
| 7863 4b72 01F4 brne .+4 |
| 7864 4b74 0C94 0000 jmp .L793 |
| 7865 4b78 0C94 0000 jmp .L791 |
| 7866 .L718: |
| 7867 4b7c 1092 0000 sts delay_einschalten.3076,__zero_reg__ |
| 7868 4b80 0C94 0000 jmp .L720 |
| 7869 .L722: |
| 7870 4b84 1092 0000 sts delay_ausschalten.3077,__zero_reg__ |
| 7871 4b88 0C94 0000 jmp .L661 |
| 7872 .L1108: |
| 7873 4b8c 0396 adiw r24,3 |
| 7874 4b8e 00C0 rjmp .L936 |
| 7875 .L1107: |
| 7876 4b90 0396 adiw r24,3 |
| 7877 4b92 00C0 rjmp .L935 |
| 7878 .L1085: |
| 7879 4b94 0396 adiw r24,3 |
| 7880 4b96 0C94 0000 jmp .L756 |
| 7881 .L1084: |
| 7882 4b9a 9095 com r25 |
| 7883 4b9c 8195 neg r24 |
| 7884 4b9e 9F4F sbci r25,lo8(-1) |
| 7885 4ba0 0C94 0000 jmp .L755 |
| 7886 .L1080: |
| 7887 4ba4 0396 adiw r24,3 |
| 7888 4ba6 0C94 0000 jmp .L748 |
| 7889 .L1079: |
| 7890 4baa 9095 com r25 |
| 7891 4bac 8195 neg r24 |
| 7892 4bae 9F4F sbci r25,lo8(-1) |
| 7893 4bb0 0C94 0000 jmp .L747 |
| 7894 .L925: |
| 7895 4bb4 84EF ldi r24,lo8(500) |
| 7896 4bb6 91E0 ldi r25,hi8(500) |
| 7897 4bb8 9093 0000 sts (KompassSignalSchlecht)+1,r25 |
| 7898 4bbc 8093 0000 sts KompassSignalSchlecht,r24 |
| 7899 4bc0 0C94 0000 jmp .L909 |
| 7900 .L1068: |
| 7901 4bc4 215E subi r18,lo8(-(31)) |
| 7902 4bc6 3F4F sbci r19,hi8(-(31)) |
| 7903 4bc8 0C94 0000 jmp .L924 |
| 7904 .L1067: |
| 7905 4bcc 695F subi r22,lo8(-(7)) |
| 7906 4bce 7F4F sbci r23,hi8(-(7)) |
| 7907 4bd0 0C94 0000 jmp .L923 |
| 7908 .L930: |
| 7909 4bd4 4427 clr r20 |
| 7910 4bd6 37FD sbrc r19,7 |
| 7911 4bd8 4095 com r20 |
| 7912 4bda 542F mov r21,r20 |
| 7913 4bdc 8091 0000 lds r24,Mess_Integral_Gier |
| 7914 4be0 9091 0000 lds r25,(Mess_Integral_Gier)+1 |
| 7915 4be4 A091 0000 lds r26,(Mess_Integral_Gier)+2 |
| 7916 4be8 B091 0000 lds r27,(Mess_Integral_Gier)+3 |
| 7917 4bec 820F add r24,r18 |
| 7918 4bee 931F adc r25,r19 |
| 7919 4bf0 A41F adc r26,r20 |
| 7920 4bf2 B51F adc r27,r21 |
| 7921 4bf4 8093 0000 sts Mess_Integral_Gier,r24 |
| 7922 4bf8 9093 0000 sts (Mess_Integral_Gier)+1,r25 |
| 7923 4bfc A093 0000 sts (Mess_Integral_Gier)+2,r26 |
| 7924 4c00 B093 0000 sts (Mess_Integral_Gier)+3,r27 |
| 7925 4c04 0C94 0000 jmp .L909 |
| 7926 .L674: |
| 7927 4c08 8081 ld r24,Z |
| 7928 4c0a 9181 ldd r25,Z+1 |
| 7929 4c0c 855B subi r24,lo8(-75) |
| 7930 4c0e 9F4F sbci r25,hi8(-75) |
| 7931 4c10 04F0 brlt .+2 |
| 7932 4c12 00C0 rjmp .L708 |
| 7933 4c14 8091 0000 lds r24,delay_neutral.3075 |
| 7934 4c18 8F5F subi r24,lo8(-(1)) |
| 7935 4c1a 8093 0000 sts delay_neutral.3075,r24 |
| 7936 4c1e 893C cpi r24,lo8(-55) |
| 7937 4c20 00F4 brsh .+4 |
| 7938 4c22 0C94 0000 jmp .L671 |
| 7939 4c26 4C30 cpi r20,lo8(12) |
| 7940 4c28 00F0 brlo .+2 |
| 7941 4c2a 00C0 rjmp .L711 |
| 7942 4c2c 2998 cbi 37-0x20,1 |
| 7943 .L713: |
| 7944 4c2e 8FEF ldi r24,lo8(-1) |
| 7945 4c30 00E0 ldi r16,lo8(EEPromArray+4) |
| 7946 4c32 10E0 ldi r17,hi8(EEPromArray+4) |
| 7947 4c34 D801 movw r26,r16 |
| 7948 /* #APP */ |
| 7949 4c36 082E mov __tmp_reg__,r24 |
| 7950 4c38 0E94 0000 call __eeprom_write_byte_1F2021 |
| 7951 /* #NOAPP */ |
| 7952 4c3c 1092 0000 sts MotorenEin,__zero_reg__ |
| 7953 4c40 1092 0000 sts delay_neutral.3075,__zero_reg__ |
| 7954 4c44 1092 0000 sts (modell_fliegt)+1,__zero_reg__ |
| 7955 4c48 1092 0000 sts modell_fliegt,__zero_reg__ |
| 7956 4c4c 0E94 0000 call SetNeutral |
| 7957 4c50 8091 0000 lds r24,NeutralAccX |
| 7958 4c54 9091 0000 lds r25,(NeutralAccX)+1 |
| 7959 4c58 97FD sbrc r25,7 |
| 7960 4c5a 00C0 rjmp .L1114 |
| 7961 .L714: |
| 7962 4c5c 892F mov r24,r25 |
| 7963 4c5e 990F lsl r25 |
| 7964 4c60 990B sbc r25,r25 |
| 7965 4c62 D801 movw r26,r16 |
| 7966 /* #APP */ |
| 7967 4c64 082E mov __tmp_reg__,r24 |
| 7968 4c66 0E94 0000 call __eeprom_write_byte_1F2021 |
| 7969 /* #NOAPP */ |
| 7970 4c6a 8091 0000 lds r24,NeutralAccX |
| 7971 4c6e 9091 0000 lds r25,(NeutralAccX)+1 |
| 7972 4c72 60E0 ldi r22,lo8(256) |
| 7973 4c74 71E0 ldi r23,hi8(256) |
| 7974 4c76 0E94 0000 call __divmodhi4 |
| 7975 4c7a 0F5F subi r16,lo8(-(1)) |
| 7976 4c7c 1F4F sbci r17,hi8(-(1)) |
| 7977 4c7e D801 movw r26,r16 |
| 7978 /* #APP */ |
| 7979 4c80 082E mov __tmp_reg__,r24 |
| 7980 4c82 0E94 0000 call __eeprom_write_byte_1F2021 |
| 7981 /* #NOAPP */ |
| 7982 4c86 0150 subi r16,lo8(-(-1)) |
| 7983 4c88 1040 sbci r17,hi8(-(-1)) |
| 7984 4c8a 2091 0000 lds r18,NeutralAccY |
| 7985 4c8e 3091 0000 lds r19,(NeutralAccY)+1 |
| 7986 4c92 37FD sbrc r19,7 |
| 7987 4c94 00C0 rjmp .L1115 |
| 7988 .L715: |
| 7989 4c96 832F mov r24,r19 |
| 7990 4c98 9927 clr r25 |
| 7991 4c9a 87FD sbrc r24,7 |
| 7992 4c9c 9A95 dec r25 |
| 7993 4c9e 0E5F subi r16,lo8(-(2)) |
| 7994 4ca0 1F4F sbci r17,hi8(-(2)) |
| 7995 4ca2 D801 movw r26,r16 |
| 7996 /* #APP */ |
| 7997 4ca4 082E mov __tmp_reg__,r24 |
| 7998 4ca6 0E94 0000 call __eeprom_write_byte_1F2021 |
| 7999 /* #NOAPP */ |
| 8000 4caa 8091 0000 lds r24,NeutralAccY |
| 8001 4cae 9091 0000 lds r25,(NeutralAccY)+1 |
| 8002 4cb2 60E0 ldi r22,lo8(256) |
| 8003 4cb4 71E0 ldi r23,hi8(256) |
| 8004 4cb6 0E94 0000 call __divmodhi4 |
| 8005 4cba 0F5F subi r16,lo8(-(1)) |
| 8006 4cbc 1F4F sbci r17,hi8(-(1)) |
| 8007 4cbe D801 movw r26,r16 |
| 8008 /* #APP */ |
| 8009 4cc0 082E mov __tmp_reg__,r24 |
| 8010 4cc2 0E94 0000 call __eeprom_write_byte_1F2021 |
| 8011 /* #NOAPP */ |
| 8012 4cc6 0350 subi r16,lo8(-(-3)) |
| 8013 4cc8 1040 sbci r17,hi8(-(-3)) |
| 8014 4cca 6091 0000 lds r22,NeutralAccZ |
| 8015 4cce 7091 0000 lds r23,(NeutralAccZ)+1 |
| 8016 4cd2 8091 0000 lds r24,(NeutralAccZ)+2 |
| 8017 4cd6 9091 0000 lds r25,(NeutralAccZ)+3 |
| 8018 4cda 0E94 0000 call __fixsfsi |
| 8019 4cde 9B01 movw r18,r22 |
| 8020 4ce0 77FD sbrc r23,7 |
| 8021 4ce2 00C0 rjmp .L1116 |
| 8022 .L716: |
| 8023 4ce4 832F mov r24,r19 |
| 8024 4ce6 9927 clr r25 |
| 8025 4ce8 87FD sbrc r24,7 |
| 8026 4cea 9A95 dec r25 |
| 8027 4cec 0C5F subi r16,lo8(-(4)) |
| 8028 4cee 1F4F sbci r17,hi8(-(4)) |
| 8029 4cf0 D801 movw r26,r16 |
| 8030 /* #APP */ |
| 8031 4cf2 082E mov __tmp_reg__,r24 |
| 8032 4cf4 0E94 0000 call __eeprom_write_byte_1F2021 |
| 8033 /* #NOAPP */ |
| 8034 4cf8 6091 0000 lds r22,NeutralAccZ |
| 8035 4cfc 7091 0000 lds r23,(NeutralAccZ)+1 |
| 8036 4d00 8091 0000 lds r24,(NeutralAccZ)+2 |
| 8037 4d04 9091 0000 lds r25,(NeutralAccZ)+3 |
| 8038 4d08 0E94 0000 call __fixsfsi |
| 8039 4d0c DC01 movw r26,r24 |
| 8040 4d0e CB01 movw r24,r22 |
| 8041 4d10 60E0 ldi r22,lo8(256) |
| 8042 4d12 71E0 ldi r23,hi8(256) |
| 8043 4d14 0E94 0000 call __divmodhi4 |
| 8044 4d18 0F5F subi r16,lo8(-(1)) |
| 8045 4d1a 1F4F sbci r17,hi8(-(1)) |
| 8046 4d1c D801 movw r26,r16 |
| 8047 /* #APP */ |
| 8048 4d1e 082E mov __tmp_reg__,r24 |
| 8049 4d20 0E94 0000 call __eeprom_write_byte_1F2021 |
| 8050 /* #NOAPP */ |
| 8051 .L1053: |
| 8052 4d24 0E94 0000 call GetActiveParamSetNumber |
| 8053 4d28 0E94 0000 call Piep |
| 8054 4d2c 8091 0000 lds r24,EE_Parameter+2 |
| 8055 4d30 A82F mov r26,r24 |
| 8056 4d32 B0E0 ldi r27,lo8(0) |
| 8057 4d34 AA0F lsl r26 |
| 8058 4d36 BB1F rol r27 |
| 8059 4d38 0C94 0000 jmp .L671 |
| 8060 .L1066: |
| 8061 4d3c 88EC ldi r24,lo8(200) |
| 8062 4d3e 90E0 ldi r25,hi8(200) |
| 8063 4d40 9093 0000 sts (beeptime)+1,r25 |
| 8064 4d44 8093 0000 sts beeptime,r24 |
| 8065 4d48 B101 movw r22,r2 |
| 8066 4d4a 8827 clr r24 |
| 8067 4d4c 77FD sbrc r23,7 |
| 8068 4d4e 8095 com r24 |
| 8069 4d50 982F mov r25,r24 |
| 8070 4d52 2C89 ldd r18,Y+20 |
| 8071 4d54 3D89 ldd r19,Y+21 |
| 8072 4d56 4E89 ldd r20,Y+22 |
| 8073 4d58 5F89 ldd r21,Y+23 |
| 8074 4d5a 0E94 0000 call __mulsi3 |
| 8075 4d5e 2B01 movw r4,r22 |
| 8076 4d60 3C01 movw r6,r24 |
| 8077 4d62 6093 0000 sts ErsatzKompass,r22 |
| 8078 4d66 7093 0000 sts (ErsatzKompass)+1,r23 |
| 8079 4d6a 8093 0000 sts (ErsatzKompass)+2,r24 |
| 8080 4d6e 9093 0000 sts (ErsatzKompass)+3,r25 |
| 8081 4d72 0E94 0000 call __divmodsi4 |
| 8082 4d76 3093 0000 sts (KompassStartwert)+1,r19 |
| 8083 4d7a 2093 0000 sts KompassStartwert,r18 |
| 8084 4d7e 1092 0000 sts NeueKompassRichtungMerken.3088,__zero_reg__ |
| 8085 4d82 0C94 0000 jmp .L919 |
| 8086 .L1072: |
| 8087 4d86 88EC ldi r24,lo8(-56) |
| 8088 4d88 8093 0000 sts delay_einschalten.3076,r24 |
| 8089 4d8c 81E0 ldi r24,lo8(1) |
| 8090 4d8e 90E0 ldi r25,hi8(1) |
| 8091 4d90 9093 0000 sts (modell_fliegt)+1,r25 |
| 8092 4d94 8093 0000 sts modell_fliegt,r24 |
| 8093 4d98 81E0 ldi r24,lo8(1) |
| 8094 4d9a 8093 0000 sts MotorenEin,r24 |
| 8095 4d9e 1092 0000 sts sollGier.3069,__zero_reg__ |
| 8096 4da2 1092 0000 sts (sollGier.3069)+1,__zero_reg__ |
| 8097 4da6 1092 0000 sts (sollGier.3069)+2,__zero_reg__ |
| 8098 4daa 1092 0000 sts (sollGier.3069)+3,__zero_reg__ |
| 8099 4dae 1092 0000 sts Mess_Integral_Gier,__zero_reg__ |
| 8100 4db2 1092 0000 sts (Mess_Integral_Gier)+1,__zero_reg__ |
| 8101 4db6 1092 0000 sts (Mess_Integral_Gier)+2,__zero_reg__ |
| 8102 4dba 1092 0000 sts (Mess_Integral_Gier)+3,__zero_reg__ |
| 8103 4dbe 1092 0000 sts Mess_Integral_Gier2,__zero_reg__ |
| 8104 4dc2 1092 0000 sts (Mess_Integral_Gier2)+1,__zero_reg__ |
| 8105 4dc6 1092 0000 sts (Mess_Integral_Gier2)+2,__zero_reg__ |
| 8106 4dca 1092 0000 sts (Mess_Integral_Gier2)+3,__zero_reg__ |
| 8107 4dce E090 0000 lds r14,EE_Parameter+20 |
| 8108 4dd2 FF24 clr r15 |
| 8109 4dd4 00E0 ldi r16,lo8(0) |
| 8110 4dd6 10E0 ldi r17,hi8(0) |
| 8111 4dd8 6091 0000 lds r22,Mittelwert_AccNick |
| 8112 4ddc 7091 0000 lds r23,(Mittelwert_AccNick)+1 |
| 8113 4de0 8827 clr r24 |
| 8114 4de2 77FD sbrc r23,7 |
| 8115 4de4 8095 com r24 |
| 8116 4de6 982F mov r25,r24 |
| 8117 4de8 A801 movw r20,r16 |
| 8118 4dea 9701 movw r18,r14 |
| 8119 4dec 0E94 0000 call __mulsi3 |
| 8120 4df0 6093 0000 sts Mess_IntegralNick,r22 |
| 8121 4df4 7093 0000 sts (Mess_IntegralNick)+1,r23 |
| 8122 4df8 8093 0000 sts (Mess_IntegralNick)+2,r24 |
| 8123 4dfc 9093 0000 sts (Mess_IntegralNick)+3,r25 |
| 8124 4e00 6091 0000 lds r22,Mittelwert_AccRoll |
| 8125 4e04 7091 0000 lds r23,(Mittelwert_AccRoll)+1 |
| 8126 4e08 8827 clr r24 |
| 8127 4e0a 77FD sbrc r23,7 |
| 8128 4e0c 8095 com r24 |
| 8129 4e0e 982F mov r25,r24 |
| 8130 4e10 0E94 0000 call __mulsi3 |
| 8131 4e14 6093 0000 sts Mess_IntegralRoll,r22 |
| 8132 4e18 7093 0000 sts (Mess_IntegralRoll)+1,r23 |
| 8133 4e1c 8093 0000 sts (Mess_IntegralRoll)+2,r24 |
| 8134 4e20 9093 0000 sts (Mess_IntegralRoll)+3,r25 |
| 8135 4e24 8091 0000 lds r24,IntegralNick |
| 8136 4e28 9091 0000 lds r25,(IntegralNick)+1 |
| 8137 4e2c A091 0000 lds r26,(IntegralNick)+2 |
| 8138 4e30 B091 0000 lds r27,(IntegralNick)+3 |
| 8139 4e34 8093 0000 sts Mess_IntegralNick2,r24 |
| 8140 4e38 9093 0000 sts (Mess_IntegralNick2)+1,r25 |
| 8141 4e3c A093 0000 sts (Mess_IntegralNick2)+2,r26 |
| 8142 4e40 B093 0000 sts (Mess_IntegralNick2)+3,r27 |
| 8143 4e44 8091 0000 lds r24,IntegralRoll |
| 8144 4e48 9091 0000 lds r25,(IntegralRoll)+1 |
| 8145 4e4c A091 0000 lds r26,(IntegralRoll)+2 |
| 8146 4e50 B091 0000 lds r27,(IntegralRoll)+3 |
| 8147 4e54 8093 0000 sts Mess_IntegralRoll2,r24 |
| 8148 4e58 9093 0000 sts (Mess_IntegralRoll2)+1,r25 |
| 8149 4e5c A093 0000 sts (Mess_IntegralRoll2)+2,r26 |
| 8150 4e60 B093 0000 sts (Mess_IntegralRoll2)+3,r27 |
| 8151 4e64 1092 0000 sts SummeNick.3067,__zero_reg__ |
| 8152 4e68 1092 0000 sts (SummeNick.3067)+1,__zero_reg__ |
| 8153 4e6c 1092 0000 sts (SummeNick.3067)+2,__zero_reg__ |
| 8154 4e70 1092 0000 sts (SummeNick.3067)+3,__zero_reg__ |
| 8155 4e74 1092 0000 sts SummeRoll.3068,__zero_reg__ |
| 8156 4e78 1092 0000 sts (SummeRoll.3068)+1,__zero_reg__ |
| 8157 4e7c 1092 0000 sts (SummeRoll.3068)+2,__zero_reg__ |
| 8158 4e80 1092 0000 sts (SummeRoll.3068)+3,__zero_reg__ |
| 8159 4e84 8091 0000 lds r24,MikroKopterFlags |
| 8160 4e88 8860 ori r24,lo8(8) |
| 8161 4e8a 8093 0000 sts MikroKopterFlags,r24 |
| 8162 4e8e 0C94 0000 jmp .L720 |
| 8163 .L990: |
| 8164 4e92 ADA5 ldd r26,Y+45 |
| 8165 4e94 BEA5 ldd r27,Y+46 |
| 8166 4e96 B093 0000 sts (hoehenregler.3078)+1,r27 |
| 8167 4e9a A093 0000 sts hoehenregler.3078,r26 |
| 8168 4e9e 0C94 0000 jmp .L992 |
| 8169 .L803: |
| 8170 4ea2 E090 0000 lds r14,EE_Parameter+20 |
| 8171 4ea6 FF24 clr r15 |
| 8172 4ea8 00E0 ldi r16,lo8(0) |
| 8173 4eaa 10E0 ldi r17,hi8(0) |
| 8174 4eac 6981 ldd r22,Y+1 |
| 8175 4eae 7A81 ldd r23,Y+2 |
| 8176 4eb0 8B81 ldd r24,Y+3 |
| 8177 4eb2 9C81 ldd r25,Y+4 |
| 8178 4eb4 A801 movw r20,r16 |
| 8179 4eb6 9701 movw r18,r14 |
| 8180 4eb8 0E94 0000 call __divmodsi4 |
| 8181 4ebc 5901 movw r10,r18 |
| 8182 4ebe 6A01 movw r12,r20 |
| 8183 4ec0 8091 0000 lds r24,Mittelwert_AccNick |
| 8184 4ec4 9091 0000 lds r25,(Mittelwert_AccNick)+1 |
| 8185 4ec8 AA27 clr r26 |
| 8186 4eca 97FD sbrc r25,7 |
| 8187 4ecc A095 com r26 |
| 8188 4ece BA2F mov r27,r26 |
| 8189 4ed0 A81A sub r10,r24 |
| 8190 4ed2 B90A sbc r11,r25 |
| 8191 4ed4 CA0A sbc r12,r26 |
| 8192 4ed6 DB0A sbc r13,r27 |
| 8193 4ed8 6D81 ldd r22,Y+5 |
| 8194 4eda 7E81 ldd r23,Y+6 |
| 8195 4edc 8F81 ldd r24,Y+7 |
| 8196 4ede 9885 ldd r25,Y+8 |
| 8197 4ee0 A801 movw r20,r16 |
| 8198 4ee2 9701 movw r18,r14 |
| 8199 4ee4 0E94 0000 call __divmodsi4 |
| 8200 4ee8 7901 movw r14,r18 |
| 8201 4eea 8A01 movw r16,r20 |
| 8202 4eec 8091 0000 lds r24,Mittelwert_AccRoll |
| 8203 4ef0 9091 0000 lds r25,(Mittelwert_AccRoll)+1 |
| 8204 4ef4 AA27 clr r26 |
| 8205 4ef6 97FD sbrc r25,7 |
| 8206 4ef8 A095 com r26 |
| 8207 4efa BA2F mov r27,r26 |
| 8208 4efc E81A sub r14,r24 |
| 8209 4efe F90A sbc r15,r25 |
| 8210 4f00 0A0B sbc r16,r26 |
| 8211 4f02 1B0B sbc r17,r27 |
| 8212 4f04 C601 movw r24,r12 |
| 8213 4f06 B501 movw r22,r10 |
| 8214 4f08 20E1 ldi r18,lo8(16) |
| 8215 4f0a 30E0 ldi r19,hi8(16) |
| 8216 4f0c 40E0 ldi r20,hlo8(16) |
| 8217 4f0e 50E0 ldi r21,hhi8(16) |
| 8218 4f10 0E94 0000 call __divmodsi4 |
| 8219 4f14 3901 movw r6,r18 |
| 8220 4f16 4A01 movw r8,r20 |
| 8221 4f18 C801 movw r24,r16 |
| 8222 4f1a B701 movw r22,r14 |
| 8223 4f1c 20E1 ldi r18,lo8(16) |
| 8224 4f1e 30E0 ldi r19,hi8(16) |
| 8225 4f20 40E0 ldi r20,hlo8(16) |
| 8226 4f22 50E0 ldi r21,hhi8(16) |
| 8227 4f24 0E94 0000 call __divmodsi4 |
| 8228 4f28 5901 movw r10,r18 |
| 8229 4f2a 6A01 movw r12,r20 |
| 8230 4f2c 8091 0000 lds r24,MaxStickNick |
| 8231 4f30 9091 0000 lds r25,(MaxStickNick)+1 |
| 8232 4f34 8134 cpi r24,65 |
| 8233 4f36 9105 cpc r25,__zero_reg__ |
| 8234 4f38 04F4 brge .L816 |
| 8235 4f3a 8091 0000 lds r24,MaxStickRoll |
| 8236 4f3e 9091 0000 lds r25,(MaxStickRoll)+1 |
| 8237 4f42 8134 cpi r24,65 |
| 8238 4f44 9105 cpc r25,__zero_reg__ |
| 8239 4f46 04F0 brlt .L818 |
| 8240 .L816: |
| 8241 4f48 C401 movw r24,r8 |
| 8242 4f4a B301 movw r22,r6 |
| 8243 4f4c 23E0 ldi r18,lo8(3) |
| 8244 4f4e 30E0 ldi r19,hi8(3) |
| 8245 4f50 40E0 ldi r20,hlo8(3) |
| 8246 4f52 50E0 ldi r21,hhi8(3) |
| 8247 4f54 0E94 0000 call __divmodsi4 |
| 8248 4f58 3901 movw r6,r18 |
| 8249 4f5a 4A01 movw r8,r20 |
| 8250 4f5c C601 movw r24,r12 |
| 8251 4f5e B501 movw r22,r10 |
| 8252 4f60 23E0 ldi r18,lo8(3) |
| 8253 4f62 30E0 ldi r19,hi8(3) |
| 8254 4f64 40E0 ldi r20,hlo8(3) |
| 8255 4f66 50E0 ldi r21,hhi8(3) |
| 8256 4f68 0E94 0000 call __divmodsi4 |
| 8257 4f6c 5901 movw r10,r18 |
| 8258 4f6e 6A01 movw r12,r20 |
| 8259 .L818: |
| 8260 4f70 E091 0000 lds r30,EE_Parameter+3 |
| 8261 4f74 F0E0 ldi r31,lo8(0) |
| 8262 4f76 EE0F lsl r30 |
| 8263 4f78 FF1F rol r31 |
| 8264 4f7a E050 subi r30,lo8(-(PPM_in)) |
| 8265 4f7c F040 sbci r31,hi8(-(PPM_in)) |
| 8266 4f7e 0190 ld __tmp_reg__,Z+ |
| 8267 4f80 F081 ld r31,Z |
| 8268 4f82 E02D mov r30,__tmp_reg__ |
| 8269 4f84 F7FD sbrc r31,7 |
| 8270 4f86 00C0 rjmp .L1117 |
| 8271 .L820: |
| 8272 4f88 7A97 sbiw r30,26 |
| 8273 4f8a 04F0 brlt .L819 |
| 8274 4f8c C401 movw r24,r8 |
| 8275 4f8e B301 movw r22,r6 |
| 8276 4f90 23E0 ldi r18,lo8(3) |
| 8277 4f92 30E0 ldi r19,hi8(3) |
| 8278 4f94 40E0 ldi r20,hlo8(3) |
| 8279 4f96 50E0 ldi r21,hhi8(3) |
| 8280 4f98 0E94 0000 call __divmodsi4 |
| 8281 4f9c 3901 movw r6,r18 |
| 8282 4f9e 4A01 movw r8,r20 |
| 8283 4fa0 C601 movw r24,r12 |
| 8284 4fa2 B501 movw r22,r10 |
| 8285 4fa4 23E0 ldi r18,lo8(3) |
| 8286 4fa6 30E0 ldi r19,hi8(3) |
| 8287 4fa8 40E0 ldi r20,hlo8(3) |
| 8288 4faa 50E0 ldi r21,hhi8(3) |
| 8289 4fac 0E94 0000 call __divmodsi4 |
| 8290 4fb0 5901 movw r10,r18 |
| 8291 4fb2 6A01 movw r12,r20 |
| 8292 .L819: |
| 8293 4fb4 71E2 ldi r23,lo8(33) |
| 8294 4fb6 6716 cp r6,r23 |
| 8295 4fb8 7104 cpc r7,__zero_reg__ |
| 8296 4fba 8104 cpc r8,__zero_reg__ |
| 8297 4fbc 9104 cpc r9,__zero_reg__ |
| 8298 4fbe 04F4 brge .+2 |
| 8299 4fc0 00C0 rjmp .L822 |
| 8300 4fc2 80E2 ldi r24,lo8(32) |
| 8301 4fc4 682E mov r6,r24 |
| 8302 4fc6 712C mov r7,__zero_reg__ |
| 8303 4fc8 812C mov r8,__zero_reg__ |
| 8304 4fca 912C mov r9,__zero_reg__ |
| 8305 .L824: |
| 8306 4fcc 91E2 ldi r25,lo8(33) |
| 8307 4fce A916 cp r10,r25 |
| 8308 4fd0 B104 cpc r11,__zero_reg__ |
| 8309 4fd2 C104 cpc r12,__zero_reg__ |
| 8310 4fd4 D104 cpc r13,__zero_reg__ |
| 8311 4fd6 04F4 brge .+2 |
| 8312 4fd8 00C0 rjmp .L826 |
| 8313 4fda 10E2 ldi r17,lo8(32) |
| 8314 4fdc A12E mov r10,r17 |
| 8315 4fde B12C mov r11,__zero_reg__ |
| 8316 4fe0 C12C mov r12,__zero_reg__ |
| 8317 4fe2 D12C mov r13,__zero_reg__ |
| 8318 4fe4 00C0 rjmp .L814 |
| 8319 .L1096: |
| 8320 4fe6 8091 0000 lds r24,MessLuftdruck |
| 8321 4fea 9091 0000 lds r25,(MessLuftdruck)+1 |
| 8322 4fee 895E subi r24,lo8(1001) |
| 8323 4ff0 9340 sbci r25,hi8(1001) |
| 8324 4ff2 00F4 brsh .+2 |
| 8325 4ff4 00C0 rjmp .L975 |
| 8326 4ff6 9091 0000 lds r25,ExpandBaro |
| 8327 4ffa 9A50 subi r25,lo8(-(-10)) |
| 8328 .L1054: |
| 8329 4ffc 9093 0000 sts ExpandBaro,r25 |
| 8330 5000 8091 0000 lds r24,DruckOffsetSetting |
| 8331 5004 891B sub r24,r25 |
| 8332 5006 87BD out 71-0x20,r24 |
| 8333 5008 8CE2 ldi r24,lo8(300) |
| 8334 500a 91E0 ldi r25,hi8(300) |
| 8335 500c 9093 0000 sts (beeptime)+1,r25 |
| 8336 5010 8093 0000 sts beeptime,r24 |
| 8337 5014 8AEF ldi r24,lo8(-6) |
| 8338 5016 8093 0000 sts delay.3112,r24 |
| 8339 501a 2091 0000 lds r18,HoehenWert |
| 8340 501e 3091 0000 lds r19,(HoehenWert)+1 |
| 8341 5022 00C0 rjmp .L973 |
| 8342 .L1109: |
| 8343 5024 0396 adiw r24,3 |
| 8344 5026 00C0 rjmp .L983 |
| 8345 .L1111: |
| 8346 5028 215F subi r18,lo8(-(15)) |
| 8347 502a 3F4F sbci r19,hi8(-(15)) |
| 8348 502c 00C0 rjmp .L987 |
| 8349 .L1110: |
| 8350 502e 2F5F subi r18,lo8(-(1)) |
| 8351 5030 3F4F sbci r19,hi8(-(1)) |
| 8352 5032 00C0 rjmp .L985 |
| 8353 .L873: |
| 8354 5034 21E0 ldi r18,lo8(4097) |
| 8355 5036 A216 cp r10,r18 |
| 8356 5038 20E1 ldi r18,hi8(4097) |
| 8357 503a B206 cpc r11,r18 |
| 8358 503c 20E0 ldi r18,hlo8(4097) |
| 8359 503e C206 cpc r12,r18 |
| 8360 5040 20E0 ldi r18,hhi8(4097) |
| 8361 5042 D206 cpc r13,r18 |
| 8362 5044 04F4 brge .+2 |
| 8363 5046 00C0 rjmp .L876 |
| 8364 5048 8091 0000 lds r24,last_r_p.3102 |
| 8365 504c 8823 tst r24 |
| 8366 504e 01F4 brne .+2 |
| 8367 5050 00C0 rjmp .L878 |
| 8368 5052 D601 movw r26,r12 |
| 8369 5054 C501 movw r24,r10 |
| 8370 5056 49E0 ldi r20,9 |
| 8371 5058 B595 1: asr r27 |
| 8372 505a A795 ror r26 |
| 8373 505c 9795 ror r25 |
| 8374 505e 8795 ror r24 |
| 8375 5060 4A95 dec r20 |
| 8376 5062 01F4 brne 1b |
| 8377 5064 0196 adiw r24,1 |
| 8378 5066 9093 0000 sts (cnt.3099)+1,r25 |
| 8379 506a 8093 0000 sts cnt.3099,r24 |
| 8380 506e D601 movw r26,r12 |
| 8381 5070 C501 movw r24,r10 |
| 8382 5072 33E0 ldi r19,3 |
| 8383 5074 B595 1: asr r27 |
| 8384 5076 A795 ror r26 |
| 8385 5078 9795 ror r25 |
| 8386 507a 8795 ror r24 |
| 8387 507c 3A95 dec r19 |
| 8388 507e 01F4 brne 1b |
| 8389 5080 8093 0000 sts ausgleichRoll.3090,r24 |
| 8390 5084 9093 0000 sts (ausgleichRoll.3090)+1,r25 |
| 8391 5088 A093 0000 sts (ausgleichRoll.3090)+2,r26 |
| 8392 508c B093 0000 sts (ausgleichRoll.3090)+3,r27 |
| 8393 5090 8958 subi r24,lo8(5001) |
| 8394 5092 9341 sbci r25,hi8(5001) |
| 8395 5094 A040 sbci r26,hlo8(5001) |
| 8396 5096 B040 sbci r27,hhi8(5001) |
| 8397 5098 04F0 brlt .L880 |
| 8398 509a 88E8 ldi r24,lo8(5000) |
| 8399 509c 93E1 ldi r25,hi8(5000) |
| 8400 509e A0E0 ldi r26,hlo8(5000) |
| 8401 50a0 B0E0 ldi r27,hhi8(5000) |
| 8402 50a2 8093 0000 sts ausgleichRoll.3090,r24 |
| 8403 50a6 9093 0000 sts (ausgleichRoll.3090)+1,r25 |
| 8404 50aa A093 0000 sts (ausgleichRoll.3090)+2,r26 |
| 8405 50ae B093 0000 sts (ausgleichRoll.3090)+3,r27 |
| 8406 .L880: |
| 8407 50b2 6091 0000 lds r22,ausgleichRoll.3090 |
| 8408 50b6 7091 0000 lds r23,(ausgleichRoll.3090)+1 |
| 8409 50ba 8091 0000 lds r24,(ausgleichRoll.3090)+2 |
| 8410 50be 9091 0000 lds r25,(ausgleichRoll.3090)+3 |
| 8411 50c2 20E0 ldi r18,lo8(256) |
| 8412 50c4 31E0 ldi r19,hi8(256) |
| 8413 50c6 40E0 ldi r20,hlo8(256) |
| 8414 50c8 50E0 ldi r21,hhi8(256) |
| 8415 50ca 0E94 0000 call __divmodsi4 |
| 8416 50ce 8091 0000 lds r24,LageKorrekturRoll |
| 8417 50d2 9091 0000 lds r25,(LageKorrekturRoll)+1 |
| 8418 50d6 820F add r24,r18 |
| 8419 50d8 931F adc r25,r19 |
| 8420 50da 9093 0000 sts (LageKorrekturRoll)+1,r25 |
| 8421 50de 8093 0000 sts LageKorrekturRoll,r24 |
| 8422 .L882: |
| 8423 50e2 1092 0000 sts last_r_n.3103,__zero_reg__ |
| 8424 50e6 00C0 rjmp .L888 |
| 8425 .L1047: |
| 8426 50e8 9090 0000 lds r9,FromNaviCtrl_Value+1 |
| 8427 .L848: |
| 8428 50ec 51E0 ldi r21,lo8(4097) |
| 8429 50ee E516 cp r14,r21 |
| 8430 50f0 50E1 ldi r21,hi8(4097) |
| 8431 50f2 F506 cpc r15,r21 |
| 8432 50f4 50E0 ldi r21,hlo8(4097) |
| 8433 50f6 0507 cpc r16,r21 |
| 8434 50f8 50E0 ldi r21,hhi8(4097) |
| 8435 50fa 1507 cpc r17,r21 |
| 8436 50fc 04F4 brge .+2 |
| 8437 50fe 00C0 rjmp .L851 |
| 8438 5100 8091 0000 lds r24,last_n_p.3100 |
| 8439 5104 8823 tst r24 |
| 8440 5106 01F4 brne .+2 |
| 8441 5108 00C0 rjmp .L853 |
| 8442 510a D801 movw r26,r16 |
| 8443 510c C701 movw r24,r14 |
| 8444 510e 79E0 ldi r23,9 |
| 8445 5110 B595 1: asr r27 |
| 8446 5112 A795 ror r26 |
| 8447 5114 9795 ror r25 |
| 8448 5116 8795 ror r24 |
| 8449 5118 7A95 dec r23 |
| 8450 511a 01F4 brne 1b |
| 8451 511c 0196 adiw r24,1 |
| 8452 511e 9093 0000 sts (cnt.3099)+1,r25 |
| 8453 5122 8093 0000 sts cnt.3099,r24 |
| 8454 5126 D801 movw r26,r16 |
| 8455 5128 C701 movw r24,r14 |
| 8456 512a 63E0 ldi r22,3 |
| 8457 512c B595 1: asr r27 |
| 8458 512e A795 ror r26 |
| 8459 5130 9795 ror r25 |
| 8460 5132 8795 ror r24 |
| 8461 5134 6A95 dec r22 |
| 8462 5136 01F4 brne 1b |
| 8463 5138 8093 0000 sts ausgleichNick.3089,r24 |
| 8464 513c 9093 0000 sts (ausgleichNick.3089)+1,r25 |
| 8465 5140 A093 0000 sts (ausgleichNick.3089)+2,r26 |
| 8466 5144 B093 0000 sts (ausgleichNick.3089)+3,r27 |
| 8467 5148 8958 subi r24,lo8(5001) |
| 8468 514a 9341 sbci r25,hi8(5001) |
| 8469 514c A040 sbci r26,hlo8(5001) |
| 8470 514e B040 sbci r27,hhi8(5001) |
| 8471 5150 04F0 brlt .L855 |
| 8472 5152 88E8 ldi r24,lo8(5000) |
| 8473 5154 93E1 ldi r25,hi8(5000) |
| 8474 5156 A0E0 ldi r26,hlo8(5000) |
| 8475 5158 B0E0 ldi r27,hhi8(5000) |
| 8476 515a 8093 0000 sts ausgleichNick.3089,r24 |
| 8477 515e 9093 0000 sts (ausgleichNick.3089)+1,r25 |
| 8478 5162 A093 0000 sts (ausgleichNick.3089)+2,r26 |
| 8479 5166 B093 0000 sts (ausgleichNick.3089)+3,r27 |
| 8480 .L855: |
| 8481 516a 6091 0000 lds r22,ausgleichNick.3089 |
| 8482 516e 7091 0000 lds r23,(ausgleichNick.3089)+1 |
| 8483 5172 8091 0000 lds r24,(ausgleichNick.3089)+2 |
| 8484 5176 9091 0000 lds r25,(ausgleichNick.3089)+3 |
| 8485 517a 20E0 ldi r18,lo8(256) |
| 8486 517c 31E0 ldi r19,hi8(256) |
| 8487 517e 40E0 ldi r20,hlo8(256) |
| 8488 5180 50E0 ldi r21,hhi8(256) |
| 8489 5182 0E94 0000 call __divmodsi4 |
| 8490 5186 8091 0000 lds r24,LageKorrekturNick |
| 8491 518a 9091 0000 lds r25,(LageKorrekturNick)+1 |
| 8492 518e 820F add r24,r18 |
| 8493 5190 931F adc r25,r19 |
| 8494 5192 9093 0000 sts (LageKorrekturNick)+1,r25 |
| 8495 5196 8093 0000 sts LageKorrekturNick,r24 |
| 8496 .L857: |
| 8497 519a 1092 0000 sts last_n_n.3101,__zero_reg__ |
| 8498 519e 00C0 rjmp .L863 |
| 8499 .L1106: |
| 8500 51a0 F095 com r31 |
| 8501 51a2 E195 neg r30 |
| 8502 51a4 FF4F sbci r31,lo8(-1) |
| 8503 51a6 0C94 0000 jmp .L809 |
| 8504 .L826: |
| 8505 51aa A0EE ldi r26,lo8(-32) |
| 8506 51ac AA16 cp r10,r26 |
| 8507 51ae AFEF ldi r26,hi8(-32) |
| 8508 51b0 BA06 cpc r11,r26 |
| 8509 51b2 AFEF ldi r26,hlo8(-32) |
| 8510 51b4 CA06 cpc r12,r26 |
| 8511 51b6 AFEF ldi r26,hhi8(-32) |
| 8512 51b8 DA06 cpc r13,r26 |
| 8513 51ba 04F0 brlt .+4 |
| 8514 51bc 0C94 0000 jmp .L814 |
| 8515 51c0 B0EE ldi r27,lo8(-32) |
| 8516 51c2 AB2E mov r10,r27 |
| 8517 51c4 BFEF ldi r27,hi8(-32) |
| 8518 51c6 BB2E mov r11,r27 |
| 8519 51c8 BFEF ldi r27,hlo8(-32) |
| 8520 51ca CB2E mov r12,r27 |
| 8521 51cc BFEF ldi r27,hhi8(-32) |
| 8522 51ce DB2E mov r13,r27 |
| 8523 51d0 0C94 0000 jmp .L814 |
| 8524 .L822: |
| 8525 51d4 80EE ldi r24,lo8(-32) |
| 8526 51d6 6816 cp r6,r24 |
| 8527 51d8 8FEF ldi r24,hi8(-32) |
| 8528 51da 7806 cpc r7,r24 |
| 8529 51dc 8FEF ldi r24,hlo8(-32) |
| 8530 51de 8806 cpc r8,r24 |
| 8531 51e0 8FEF ldi r24,hhi8(-32) |
| 8532 51e2 9806 cpc r9,r24 |
| 8533 51e4 04F0 brlt .+2 |
| 8534 51e6 00C0 rjmp .L824 |
| 8535 51e8 00EE ldi r16,lo8(-32) |
| 8536 51ea 602E mov r6,r16 |
| 8537 51ec 0FEF ldi r16,hi8(-32) |
| 8538 51ee 702E mov r7,r16 |
| 8539 51f0 0FEF ldi r16,hlo8(-32) |
| 8540 51f2 802E mov r8,r16 |
| 8541 51f4 0FEF ldi r16,hhi8(-32) |
| 8542 51f6 902E mov r9,r16 |
| 8543 51f8 00C0 rjmp .L824 |
| 8544 .L1069: |
| 8545 51fa 87E0 ldi r24,lo8(7) |
| 8546 51fc 90E0 ldi r25,hi8(7) |
| 8547 51fe 680E add r6,r24 |
| 8548 5200 791E adc r7,r25 |
| 8549 5202 0C94 0000 jmp .L929 |
| 8550 .L975: |
| 8551 5206 8091 0000 lds r24,MessLuftdruck |
| 8552 520a 9091 0000 lds r25,(MessLuftdruck)+1 |
| 8553 520e 8436 cpi r24,100 |
| 8554 5210 9105 cpc r25,__zero_reg__ |
| 8555 5212 00F0 brlo .+2 |
| 8556 5214 00C0 rjmp .L977 |
| 8557 5216 9091 0000 lds r25,ExpandBaro |
| 8558 521a 965F subi r25,lo8(-(10)) |
| 8559 521c 00C0 rjmp .L1054 |
| 8560 .L708: |
| 8561 521e 1092 0000 sts delay_neutral.3075,__zero_reg__ |
| 8562 5222 0C94 0000 jmp .L671 |
| 8563 .L851: |
| 8564 5226 1092 0000 sts last_n_p.3100,__zero_reg__ |
| 8565 522a 70E0 ldi r23,lo8(-4096) |
| 8566 522c E716 cp r14,r23 |
| 8567 522e 70EF ldi r23,hi8(-4096) |
| 8568 5230 F706 cpc r15,r23 |
| 8569 5232 7FEF ldi r23,hlo8(-4096) |
| 8570 5234 0707 cpc r16,r23 |
| 8571 5236 7FEF ldi r23,hhi8(-4096) |
| 8572 5238 1707 cpc r17,r23 |
| 8573 523a 04F0 brlt .+2 |
| 8574 523c 00C0 rjmp .L857 |
| 8575 523e 8091 0000 lds r24,last_n_n.3101 |
| 8576 5242 8823 tst r24 |
| 8577 5244 01F4 brne .+2 |
| 8578 5246 00C0 rjmp .L859 |
| 8579 5248 8827 clr r24 |
| 8580 524a 9927 clr r25 |
| 8581 524c DC01 movw r26,r24 |
| 8582 524e 8E19 sub r24,r14 |
| 8583 5250 9F09 sbc r25,r15 |
| 8584 5252 A00B sbc r26,r16 |
| 8585 5254 B10B sbc r27,r17 |
| 8586 5256 59E0 ldi r21,9 |
| 8587 5258 B595 1: asr r27 |
| 8588 525a A795 ror r26 |
| 8589 525c 9795 ror r25 |
| 8590 525e 8795 ror r24 |
| 8591 5260 5A95 dec r21 |
| 8592 5262 01F4 brne 1b |
| 8593 5264 0196 adiw r24,1 |
| 8594 5266 9093 0000 sts (cnt.3099)+1,r25 |
| 8595 526a 8093 0000 sts cnt.3099,r24 |
| 8596 526e C801 movw r24,r16 |
| 8597 5270 B701 movw r22,r14 |
| 8598 5272 28E0 ldi r18,lo8(8) |
| 8599 5274 30E0 ldi r19,hi8(8) |
| 8600 5276 40E0 ldi r20,hlo8(8) |
| 8601 5278 50E0 ldi r21,hhi8(8) |
| 8602 527a 0E94 0000 call __divmodsi4 |
| 8603 527e 2093 0000 sts ausgleichNick.3089,r18 |
| 8604 5282 3093 0000 sts (ausgleichNick.3089)+1,r19 |
| 8605 5286 4093 0000 sts (ausgleichNick.3089)+2,r20 |
| 8606 528a 5093 0000 sts (ausgleichNick.3089)+3,r21 |
| 8607 528e 2857 subi r18,lo8(-5000) |
| 8608 5290 3C4E sbci r19,hi8(-5000) |
| 8609 5292 4F4F sbci r20,hlo8(-5000) |
| 8610 5294 5F4F sbci r21,hhi8(-5000) |
| 8611 5296 04F4 brge .L861 |
| 8612 5298 88E7 ldi r24,lo8(-5000) |
| 8613 529a 9CEE ldi r25,hi8(-5000) |
| 8614 529c AFEF ldi r26,hlo8(-5000) |
| 8615 529e BFEF ldi r27,hhi8(-5000) |
| 8616 52a0 8093 0000 sts ausgleichNick.3089,r24 |
| 8617 52a4 9093 0000 sts (ausgleichNick.3089)+1,r25 |
| 8618 52a8 A093 0000 sts (ausgleichNick.3089)+2,r26 |
| 8619 52ac B093 0000 sts (ausgleichNick.3089)+3,r27 |
| 8620 .L861: |
| 8621 52b0 6091 0000 lds r22,ausgleichNick.3089 |
| 8622 52b4 7091 0000 lds r23,(ausgleichNick.3089)+1 |
| 8623 52b8 8091 0000 lds r24,(ausgleichNick.3089)+2 |
| 8624 52bc 9091 0000 lds r25,(ausgleichNick.3089)+3 |
| 8625 52c0 20E0 ldi r18,lo8(256) |
| 8626 52c2 31E0 ldi r19,hi8(256) |
| 8627 52c4 40E0 ldi r20,hlo8(256) |
| 8628 52c6 50E0 ldi r21,hhi8(256) |
| 8629 52c8 0E94 0000 call __divmodsi4 |
| 8630 52cc 8091 0000 lds r24,LageKorrekturNick |
| 8631 52d0 9091 0000 lds r25,(LageKorrekturNick)+1 |
| 8632 52d4 820F add r24,r18 |
| 8633 52d6 931F adc r25,r19 |
| 8634 52d8 9093 0000 sts (LageKorrekturNick)+1,r25 |
| 8635 52dc 8093 0000 sts LageKorrekturNick,r24 |
| 8636 52e0 00C0 rjmp .L863 |
| 8637 .L876: |
| 8638 52e2 1092 0000 sts last_r_p.3102,__zero_reg__ |
| 8639 52e6 40E0 ldi r20,lo8(-4096) |
| 8640 52e8 A416 cp r10,r20 |
| 8641 52ea 40EF ldi r20,hi8(-4096) |
| 8642 52ec B406 cpc r11,r20 |
| 8643 52ee 4FEF ldi r20,hlo8(-4096) |
| 8644 52f0 C406 cpc r12,r20 |
| 8645 52f2 4FEF ldi r20,hhi8(-4096) |
| 8646 52f4 D406 cpc r13,r20 |
| 8647 52f6 04F0 brlt .+2 |
| 8648 52f8 00C0 rjmp .L882 |
| 8649 52fa 8091 0000 lds r24,last_r_n.3103 |
| 8650 52fe 8823 tst r24 |
| 8651 5300 01F4 brne .+2 |
| 8652 5302 00C0 rjmp .L884 |
| 8653 5304 8827 clr r24 |
| 8654 5306 9927 clr r25 |
| 8655 5308 DC01 movw r26,r24 |
| 8656 530a 8A19 sub r24,r10 |
| 8657 530c 9B09 sbc r25,r11 |
| 8658 530e AC09 sbc r26,r12 |
| 8659 5310 BD09 sbc r27,r13 |
| 8660 5312 29E0 ldi r18,9 |
| 8661 5314 B595 1: asr r27 |
| 8662 5316 A795 ror r26 |
| 8663 5318 9795 ror r25 |
| 8664 531a 8795 ror r24 |
| 8665 531c 2A95 dec r18 |
| 8666 531e 01F4 brne 1b |
| 8667 5320 0196 adiw r24,1 |
| 8668 5322 9093 0000 sts (cnt.3099)+1,r25 |
| 8669 5326 8093 0000 sts cnt.3099,r24 |
| 8670 532a C601 movw r24,r12 |
| 8671 532c B501 movw r22,r10 |
| 8672 532e 28E0 ldi r18,lo8(8) |
| 8673 5330 30E0 ldi r19,hi8(8) |
| 8674 5332 40E0 ldi r20,hlo8(8) |
| 8675 5334 50E0 ldi r21,hhi8(8) |
| 8676 5336 0E94 0000 call __divmodsi4 |
| 8677 533a 2093 0000 sts ausgleichRoll.3090,r18 |
| 8678 533e 3093 0000 sts (ausgleichRoll.3090)+1,r19 |
| 8679 5342 4093 0000 sts (ausgleichRoll.3090)+2,r20 |
| 8680 5346 5093 0000 sts (ausgleichRoll.3090)+3,r21 |
| 8681 534a 2857 subi r18,lo8(-5000) |
| 8682 534c 3C4E sbci r19,hi8(-5000) |
| 8683 534e 4F4F sbci r20,hlo8(-5000) |
| 8684 5350 5F4F sbci r21,hhi8(-5000) |
| 8685 5352 04F4 brge .L886 |
| 8686 5354 88E7 ldi r24,lo8(-5000) |
| 8687 5356 9CEE ldi r25,hi8(-5000) |
| 8688 5358 AFEF ldi r26,hlo8(-5000) |
| 8689 535a BFEF ldi r27,hhi8(-5000) |
| 8690 535c 8093 0000 sts ausgleichRoll.3090,r24 |
| 8691 5360 9093 0000 sts (ausgleichRoll.3090)+1,r25 |
| 8692 5364 A093 0000 sts (ausgleichRoll.3090)+2,r26 |
| 8693 5368 B093 0000 sts (ausgleichRoll.3090)+3,r27 |
| 8694 .L886: |
| 8695 536c 6091 0000 lds r22,ausgleichRoll.3090 |
| 8696 5370 7091 0000 lds r23,(ausgleichRoll.3090)+1 |
| 8697 5374 8091 0000 lds r24,(ausgleichRoll.3090)+2 |
| 8698 5378 9091 0000 lds r25,(ausgleichRoll.3090)+3 |
| 8699 537c 20E0 ldi r18,lo8(256) |
| 8700 537e 31E0 ldi r19,hi8(256) |
| 8701 5380 40E0 ldi r20,hlo8(256) |
| 8702 5382 50E0 ldi r21,hhi8(256) |
| 8703 5384 0E94 0000 call __divmodsi4 |
| 8704 5388 8091 0000 lds r24,LageKorrekturRoll |
| 8705 538c 9091 0000 lds r25,(LageKorrekturRoll)+1 |
| 8706 5390 820F add r24,r18 |
| 8707 5392 931F adc r25,r19 |
| 8708 5394 9093 0000 sts (LageKorrekturRoll)+1,r25 |
| 8709 5398 8093 0000 sts LageKorrekturRoll,r24 |
| 8710 539c 00C0 rjmp .L888 |
| 8711 .L700: |
| 8712 539e 0E94 0000 call GetActiveParamSetNumber |
| 8713 53a2 4CE5 ldi r20,lo8(92) |
| 8714 53a4 60E0 ldi r22,lo8(EE_Parameter) |
| 8715 53a6 70E0 ldi r23,hi8(EE_Parameter) |
| 8716 53a8 0E94 0000 call ReadParameterSet |
| 8717 53ac 8091 0000 lds r24,EE_Parameter+8 |
| 8718 53b0 80FF sbrs r24,0 |
| 8719 53b2 00C0 rjmp .L704 |
| 8720 53b4 8091 0000 lds r24,MessLuftdruck |
| 8721 53b8 9091 0000 lds r25,(MessLuftdruck)+1 |
| 8722 53bc 875B subi r24,lo8(951) |
| 8723 53be 9340 sbci r25,hi8(951) |
| 8724 53c0 00F4 brsh .L706 |
| 8725 53c2 8091 0000 lds r24,MessLuftdruck |
| 8726 53c6 9091 0000 lds r25,(MessLuftdruck)+1 |
| 8727 53ca 8E5E subi r24,lo8(750) |
| 8728 53cc 9240 sbci r25,hi8(750) |
| 8729 53ce 00F4 brsh .L704 |
| 8730 .L706: |
| 8731 53d0 0E94 0000 call SucheLuftruckOffset |
| 8732 .L704: |
| 8733 53d4 0E94 0000 call SetNeutral |
| 8734 53d8 00C0 rjmp .L1053 |
| 8735 .L1117: |
| 8736 53da F095 com r31 |
| 8737 53dc E195 neg r30 |
| 8738 53de FF4F sbci r31,lo8(-1) |
| 8739 53e0 00C0 rjmp .L820 |
| 8740 .L977: |
| 8741 53e2 2091 0000 lds r18,HoehenWert |
| 8742 53e6 3091 0000 lds r19,(HoehenWert)+1 |
| 8743 53ea 2451 subi r18,lo8(-(-20)) |
| 8744 53ec 3040 sbci r19,hi8(-(-20)) |
| 8745 53ee 3093 0000 sts (SollHoehe)+1,r19 |
| 8746 53f2 2093 0000 sts SollHoehe,r18 |
| 8747 53f6 2C5E subi r18,lo8(-(20)) |
| 8748 53f8 3F4F sbci r19,hi8(-(20)) |
| 8749 53fa 1092 0000 sts HoehenReglerAktiv,__zero_reg__ |
| 8750 53fe 81E0 ldi r24,lo8(1) |
| 8751 5400 8093 0000 sts delay.3112,r24 |
| 8752 5404 0C94 0000 jmp .L973 |
| 8753 .L687: |
| 8754 5408 41E0 ldi r20,lo8(1) |
| 8755 540a 0C94 0000 jmp .L690 |
| 8756 .L1113: |
| 8757 540e 9601 movw r18,r12 |
| 8758 5410 D7FC sbrc r13,7 |
| 8759 5412 00C0 rjmp .L1118 |
| 8760 .L842: |
| 8761 5414 3595 asr r19 |
| 8762 5416 2795 ror r18 |
| 8763 5418 3093 0000 sts (LageKorrekturNick)+1,r19 |
| 8764 541c 2093 0000 sts LageKorrekturNick,r18 |
| 8765 5420 9B01 movw r18,r22 |
| 8766 5422 77FD sbrc r23,7 |
| 8767 5424 00C0 rjmp .L1119 |
| 8768 .L843: |
| 8769 5426 3595 asr r19 |
| 8770 5428 2795 ror r18 |
| 8771 542a 3093 0000 sts (LageKorrekturRoll)+1,r19 |
| 8772 542e 2093 0000 sts LageKorrekturRoll,r18 |
| 8773 5432 00C0 rjmp .L839 |
| 8774 .L680: |
| 8775 5434 8091 0000 lds r24,EE_Parameter+1 |
| 8776 5438 A82F mov r26,r24 |
| 8777 543a B0E0 ldi r27,lo8(0) |
| 8778 543c AA0F lsl r26 |
| 8779 543e BB1F rol r27 |
| 8780 5440 FD01 movw r30,r26 |
| 8781 5442 E050 subi r30,lo8(-(PPM_in)) |
| 8782 5444 F040 sbci r31,hi8(-(PPM_in)) |
| 8783 5446 0190 ld __tmp_reg__,Z+ |
| 8784 5448 F081 ld r31,Z |
| 8785 544a E02D mov r30,__tmp_reg__ |
| 8786 544c F7FD sbrc r31,7 |
| 8787 544e 00C0 rjmp .L1120 |
| 8788 .L684: |
| 8789 5450 E734 cpi r30,71 |
| 8790 5452 F105 cpc r31,__zero_reg__ |
| 8791 5454 04F4 brge .+4 |
| 8792 5456 0C94 0000 jmp .L683 |
| 8793 545a 0C94 0000 jmp .L682 |
| 8794 .L677: |
| 8795 545e 299A sbi 37-0x20,1 |
| 8796 5460 0C94 0000 jmp .L679 |
| 8797 .L853: |
| 8798 5464 81E0 ldi r24,lo8(1) |
| 8799 5466 8093 0000 sts last_n_p.3100,r24 |
| 8800 546a 00C0 rjmp .L857 |
| 8801 .L878: |
| 8802 546c 81E0 ldi r24,lo8(1) |
| 8803 546e 8093 0000 sts last_r_p.3102,r24 |
| 8804 5472 00C0 rjmp .L882 |
| 8805 .L711: |
| 8806 5474 299A sbi 37-0x20,1 |
| 8807 5476 00C0 rjmp .L713 |
| 8808 .L1071: |
| 8809 5478 9095 com r25 |
| 8810 547a 8195 neg r24 |
| 8811 547c 9F4F sbci r25,lo8(-1) |
| 8812 547e 0C94 0000 jmp .L701 |
| 8813 .L884: |
| 8814 5482 81E0 ldi r24,lo8(1) |
| 8815 5484 8093 0000 sts last_r_n.3103,r24 |
| 8816 5488 00C0 rjmp .L888 |
| 8817 .L859: |
| 8818 548a 81E0 ldi r24,lo8(1) |
| 8819 548c 8093 0000 sts last_n_n.3101,r24 |
| 8820 5490 00C0 rjmp .L863 |
| 8821 .L1119: |
| 8822 5492 2F5F subi r18,lo8(-(1)) |
| 8823 5494 3F4F sbci r19,hi8(-(1)) |
| 8824 5496 00C0 rjmp .L843 |
| 8825 .L1118: |
| 8826 5498 2F5F subi r18,lo8(-(1)) |
| 8827 549a 3F4F sbci r19,hi8(-(1)) |
| 8828 549c 00C0 rjmp .L842 |
| 8829 .L1112: |
| 8830 549e F095 com r31 |
| 8831 54a0 E195 neg r30 |
| 8832 54a2 FF4F sbci r31,lo8(-1) |
| 8833 54a4 00C0 rjmp .L840 |
| 8834 .L1115: |
| 8835 54a6 2150 subi r18,lo8(-(255)) |
| 8836 54a8 3F4F sbci r19,hi8(-(255)) |
| 8837 54aa 00C0 rjmp .L715 |
| 8838 .L1114: |
| 8839 54ac 8150 subi r24,lo8(-(255)) |
| 8840 54ae 9F4F sbci r25,hi8(-(255)) |
| 8841 54b0 00C0 rjmp .L714 |
| 8842 .L1116: |
| 8843 54b2 2150 subi r18,lo8(-(255)) |
| 8844 54b4 3F4F sbci r19,hi8(-(255)) |
| 8845 54b6 00C0 rjmp .L716 |
| 8846 .L1120: |
| 8847 54b8 F095 com r31 |
| 8848 54ba E195 neg r30 |
| 8849 54bc FF4F sbci r31,lo8(-1) |
| 8850 54be 00C0 rjmp .L684 |
| 8851 .L1041: |
| 8852 54c0 6092 0000 sts Motor_Rechts,r6 |
| 8853 /* epilogue: frame size=46 */ |
| 8854 54c4 AE96 adiw r28,46 |
| 8855 54c6 0FB6 in __tmp_reg__,__SREG__ |
| 8856 54c8 F894 cli |
| 8857 54ca DEBF out __SP_H__,r29 |
| 8858 54cc 0FBE out __SREG__,__tmp_reg__ |
| 8859 54ce CDBF out __SP_L__,r28 |
| 8860 54d0 DF91 pop r29 |
| 8861 54d2 CF91 pop r28 |
| 8862 54d4 1F91 pop r17 |
| 8863 54d6 0F91 pop r16 |
| 8864 54d8 FF90 pop r15 |
| 8865 54da EF90 pop r14 |
| 8866 54dc DF90 pop r13 |
| 8867 54de CF90 pop r12 |
| 8868 54e0 BF90 pop r11 |
| 8869 54e2 AF90 pop r10 |
| 8870 54e4 9F90 pop r9 |
| 8871 54e6 8F90 pop r8 |
| 8872 54e8 7F90 pop r7 |
| 8873 54ea 6F90 pop r6 |
| 8874 54ec 5F90 pop r5 |
| 8875 54ee 4F90 pop r4 |
| 8876 54f0 3F90 pop r3 |
| 8877 54f2 2F90 pop r2 |
| 8878 54f4 0895 ret |
| 8879 /* epilogue end (size=25) */ |
| 8880 /* function MotorRegler size 5990 (5939) */ |
| 8882 .global I2CTimeout |
| 8883 .data |
| 8886 I2CTimeout: |
| 8887 0019 6400 .word 100 |
| 8888 .global AdNeutralNick |
| 8889 .global AdNeutralNick |
| 8890 .section .bss |
| 8893 AdNeutralNick: |
| 8894 0000 0000 .skip 2,0 |
| 8895 .global AdNeutralRoll |
| 8896 .global AdNeutralRoll |
| 8899 AdNeutralRoll: |
| 8900 0002 0000 .skip 2,0 |
| 8901 .global AdNeutralGier |
| 8902 .global AdNeutralGier |
| 8905 AdNeutralGier: |
| 8906 0004 0000 .skip 2,0 |
| 8907 .global StartNeutralRoll |
| 8908 .global StartNeutralRoll |
| 8911 StartNeutralRoll: |
| 8912 0006 0000 .skip 2,0 |
| 8913 .global StartNeutralNick |
| 8914 .global StartNeutralNick |
| 8917 StartNeutralNick: |
| 8918 0008 0000 .skip 2,0 |
| 8919 .global NeutralAccX |
| 8920 .global NeutralAccX |
| 8923 NeutralAccX: |
| 8924 000a 0000 .skip 2,0 |
| 8925 .global NeutralAccY |
| 8926 .global NeutralAccY |
| 8929 NeutralAccY: |
| 8930 000c 0000 .skip 2,0 |
| 8931 .global NaviCntAcc |
| 8932 .global NaviCntAcc |
| 8935 NaviCntAcc: |
| 8936 000e 0000 .skip 2,0 |
| 8937 .global NeutralAccZ |
| 8938 .global NeutralAccZ |
| 8941 NeutralAccZ: |
| 8942 0010 0000 0000 .skip 4,0 |
| 8943 .global CosinusNickWinkel |
| 8944 .global CosinusNickWinkel |
| 8947 CosinusNickWinkel: |
| 8948 0014 00 .skip 1,0 |
| 8949 .global CosinusRollWinkel |
| 8950 .global CosinusRollWinkel |
| 8953 CosinusRollWinkel: |
| 8954 0015 00 .skip 1,0 |
| 8955 .global IntegralNick |
| 8956 .global IntegralNick |
| 8959 IntegralNick: |
| 8960 0016 0000 0000 .skip 4,0 |
| 8961 .global IntegralNick2 |
| 8962 .global IntegralNick2 |
| 8965 IntegralNick2: |
| 8966 001a 0000 0000 .skip 4,0 |
| 8967 .global IntegralRoll |
| 8968 .global IntegralRoll |
| 8971 IntegralRoll: |
| 8972 001e 0000 0000 .skip 4,0 |
| 8973 .global IntegralRoll2 |
| 8974 .global IntegralRoll2 |
| 8977 IntegralRoll2: |
| 8978 0022 0000 0000 .skip 4,0 |
| 8979 .global IntegralAccNick |
| 8980 .global IntegralAccNick |
| 8983 IntegralAccNick: |
| 8984 0026 0000 0000 .skip 4,0 |
| 8985 .global IntegralAccRoll |
| 8986 .global IntegralAccRoll |
| 8989 IntegralAccRoll: |
| 8990 002a 0000 0000 .skip 4,0 |
| 8991 .global IntegralAccZ |
| 8992 .global IntegralAccZ |
| 8995 IntegralAccZ: |
| 8996 002e 0000 0000 .skip 4,0 |
| 8997 .global Integral_Gier |
| 8998 .global Integral_Gier |
| 9001 Integral_Gier: |
| 9002 0032 0000 0000 .skip 4,0 |
| 9003 .global Mess_IntegralNick |
| 9004 .global Mess_IntegralNick |
| 9007 Mess_IntegralNick: |
| 9008 0036 0000 0000 .skip 4,0 |
| 9009 .global Mess_IntegralNick2 |
| 9010 .global Mess_IntegralNick2 |
| 9013 Mess_IntegralNick2: |
| 9014 003a 0000 0000 .skip 4,0 |
| 9015 .global Mess_IntegralRoll |
| 9016 .global Mess_IntegralRoll |
| 9019 Mess_IntegralRoll: |
| 9020 003e 0000 0000 .skip 4,0 |
| 9021 .global Mess_IntegralRoll2 |
| 9022 .global Mess_IntegralRoll2 |
| 9025 Mess_IntegralRoll2: |
| 9026 0042 0000 0000 .skip 4,0 |
| 9027 .global Mess_Integral_Gier |
| 9028 .global Mess_Integral_Gier |
| 9031 Mess_Integral_Gier: |
| 9032 0046 0000 0000 .skip 4,0 |
| 9033 .global Mess_Integral_Gier2 |
| 9034 .global Mess_Integral_Gier2 |
| 9037 Mess_Integral_Gier2: |
| 9038 004a 0000 0000 .skip 4,0 |
| 9039 .global Mess_Integral_Hoch |
| 9040 .global Mess_Integral_Hoch |
| 9043 Mess_Integral_Hoch: |
| 9044 004e 0000 0000 .skip 4,0 |
| 9045 .global KompassValue |
| 9046 .global KompassValue |
| 9049 KompassValue: |
| 9050 0052 0000 .skip 2,0 |
| 9051 .global KompassStartwert |
| 9052 .global KompassStartwert |
| 9055 KompassStartwert: |
| 9056 0054 0000 .skip 2,0 |
| 9057 .global KompassRichtung |
| 9058 .global KompassRichtung |
| 9061 KompassRichtung: |
| 9062 0056 0000 .skip 2,0 |
| 9063 .global KompassSignalSchlecht |
| 9064 .data |
| 9067 KompassSignalSchlecht: |
| 9068 001b F401 .word 500 |
| 9069 .global Notlandung |
| 9070 .global Notlandung |
| 9071 .section .bss |
| 9074 Notlandung: |
| 9075 0058 00 .skip 1,0 |
| 9076 .global HoehenReglerAktiv |
| 9077 .global HoehenReglerAktiv |
| 9080 HoehenReglerAktiv: |
| 9081 0059 00 .skip 1,0 |
| 9082 .global TrichterFlug |
| 9083 .global TrichterFlug |
| 9086 TrichterFlug: |
| 9087 005a 00 .skip 1,0 |
| 9088 .global Umschlag180Nick |
| 9089 .data |
| 9092 Umschlag180Nick: |
| 9093 001d 90 .byte -112 |
| 9094 001e D0 .byte -48 |
| 9095 001f 03 .byte 3 |
| 9096 0020 00 .byte 0 |
| 9097 .global Umschlag180Roll |
| 9100 Umschlag180Roll: |
| 9101 0021 90 .byte -112 |
| 9102 0022 D0 .byte -48 |
| 9103 0023 03 .byte 3 |
| 9104 0024 00 .byte 0 |
| 9105 .global GierGyroFehler |
| 9106 .global GierGyroFehler |
| 9107 .section .bss |
| 9110 GierGyroFehler: |
| 9111 005b 0000 .skip 2,0 |
| 9112 .global Poti1 |
| 9113 .global Poti1 |
| 9116 Poti1: |
| 9117 005d 0000 .skip 2,0 |
| 9118 .global Poti2 |
| 9119 .global Poti2 |
| 9122 Poti2: |
| 9123 005f 0000 .skip 2,0 |
| 9124 .global Poti3 |
| 9125 .global Poti3 |
| 9128 Poti3: |
| 9129 0061 0000 .skip 2,0 |
| 9130 .global Poti4 |
| 9131 .global Poti4 |
| 9134 Poti4: |
| 9135 0063 0000 .skip 2,0 |
| 9136 .global SenderOkay |
| 9137 .global SenderOkay |
| 9140 SenderOkay: |
| 9141 0065 00 .skip 1,0 |
| 9142 .global StickNick |
| 9143 .global StickNick |
| 9146 StickNick: |
| 9147 0066 0000 .skip 2,0 |
| 9148 .global StickRoll |
| 9149 .global StickRoll |
| 9152 StickRoll: |
| 9153 0068 0000 .skip 2,0 |
| 9154 .global StickGier |
| 9155 .global StickGier |
| 9158 StickGier: |
| 9159 006a 0000 .skip 2,0 |
| 9160 .global StickGas |
| 9161 .global StickGas |
| 9164 StickGas: |
| 9165 006c 0000 .skip 2,0 |
| 9166 .global MotorenEin |
| 9167 .global MotorenEin |
| 9170 MotorenEin: |
| 9171 006e 00 .skip 1,0 |
| 9172 .global HoehenWert |
| 9173 .global HoehenWert |
| 9176 HoehenWert: |
| 9177 006f 0000 .skip 2,0 |
| 9178 .global SollHoehe |
| 9179 .global SollHoehe |
| 9182 SollHoehe: |
| 9183 0071 0000 .skip 2,0 |
| 9184 .global LageKorrekturRoll |
| 9185 .global LageKorrekturRoll |
| 9188 LageKorrekturRoll: |
| 9189 0073 0000 .skip 2,0 |
| 9190 .global LageKorrekturNick |
| 9191 .global LageKorrekturNick |
| 9194 LageKorrekturNick: |
| 9195 0075 0000 .skip 2,0 |
| 9196 .global Ki |
| 9197 .data |
| 9200 Ki: |
| 9201 0025 3801 .word 312 |
| 9202 .global Looping_Nick |
| 9203 .global Looping_Nick |
| 9204 .section .bss |
| 9207 Looping_Nick: |
| 9208 0077 00 .skip 1,0 |
| 9209 .global Looping_Roll |
| 9210 .global Looping_Roll |
| 9213 Looping_Roll: |
| 9214 0078 00 .skip 1,0 |
| 9215 .global Looping_Links |
| 9216 .global Looping_Links |
| 9219 Looping_Links: |
| 9220 0079 00 .skip 1,0 |
| 9221 .global Looping_Rechts |
| 9222 .global Looping_Rechts |
| 9225 Looping_Rechts: |
| 9226 007a 00 .skip 1,0 |
| 9227 .global Looping_Unten |
| 9228 .global Looping_Unten |
| 9231 Looping_Unten: |
| 9232 007b 00 .skip 1,0 |
| 9233 .global Looping_Oben |
| 9234 .global Looping_Oben |
| 9237 Looping_Oben: |
| 9238 007c 00 .skip 1,0 |
| 9239 .global Parameter_Luftdruck_D |
| 9240 .data |
| 9243 Parameter_Luftdruck_D: |
| 9244 0027 30 .byte 48 |
| 9245 .global Parameter_MaxHoehe |
| 9248 Parameter_MaxHoehe: |
| 9249 0028 FB .byte -5 |
| 9250 .global Parameter_Hoehe_P |
| 9253 Parameter_Hoehe_P: |
| 9254 0029 10 .byte 16 |
| 9255 .global Parameter_Hoehe_ACC_Wirkung |
| 9258 Parameter_Hoehe_ACC_Wirkung: |
| 9259 002a 3A .byte 58 |
| 9260 .global Parameter_KompassWirkung |
| 9263 Parameter_KompassWirkung: |
| 9264 002b 40 .byte 64 |
| 9265 .global Parameter_Gyro_D |
| 9268 Parameter_Gyro_D: |
| 9269 002c 08 .byte 8 |
| 9270 .global Parameter_Gyro_P |
| 9273 Parameter_Gyro_P: |
| 9274 002d 96 .byte -106 |
| 9275 .global Parameter_Gyro_I |
| 9278 Parameter_Gyro_I: |
| 9279 002e 96 .byte -106 |
| 9280 .global Parameter_Gier_P |
| 9283 Parameter_Gier_P: |
| 9284 002f 02 .byte 2 |
| 9285 .global Parameter_I_Faktor |
| 9288 Parameter_I_Faktor: |
| 9289 0030 0A .byte 10 |
| 9290 .global Parameter_UserParam1 |
| 9291 .global Parameter_UserParam1 |
| 9292 .section .bss |
| 9295 Parameter_UserParam1: |
| 9296 007d 00 .skip 1,0 |
| 9297 .global Parameter_UserParam2 |
| 9298 .global Parameter_UserParam2 |
| 9301 Parameter_UserParam2: |
| 9302 007e 00 .skip 1,0 |
| 9303 .global Parameter_UserParam3 |
| 9304 .global Parameter_UserParam3 |
| 9307 Parameter_UserParam3: |
| 9308 007f 00 .skip 1,0 |
| 9309 .global Parameter_UserParam4 |
| 9310 .global Parameter_UserParam4 |
| 9313 Parameter_UserParam4: |
| 9314 0080 00 .skip 1,0 |
| 9315 .global Parameter_UserParam5 |
| 9316 .global Parameter_UserParam5 |
| 9319 Parameter_UserParam5: |
| 9320 0081 00 .skip 1,0 |
| 9321 .global Parameter_UserParam6 |
| 9322 .global Parameter_UserParam6 |
| 9325 Parameter_UserParam6: |
| 9326 0082 00 .skip 1,0 |
| 9327 .global Parameter_UserParam7 |
| 9328 .global Parameter_UserParam7 |
| 9331 Parameter_UserParam7: |
| 9332 0083 00 .skip 1,0 |
| 9333 .global Parameter_UserParam8 |
| 9334 .global Parameter_UserParam8 |
| 9337 Parameter_UserParam8: |
| 9338 0084 00 .skip 1,0 |
| 9339 .global Parameter_ServoNickControl |
| 9340 .data |
| 9343 Parameter_ServoNickControl: |
| 9344 0031 64 .byte 100 |
| 9345 .global Parameter_LoopGasLimit |
| 9348 Parameter_LoopGasLimit: |
| 9349 0032 46 .byte 70 |
| 9350 .global Parameter_AchsKopplung1 |
| 9353 Parameter_AchsKopplung1: |
| 9354 0033 5A .byte 90 |
| 9355 .global Parameter_AchsKopplung2 |
| 9358 Parameter_AchsKopplung2: |
| 9359 0034 41 .byte 65 |
| 9360 .global Parameter_CouplingYawCorrection |
| 9363 Parameter_CouplingYawCorrection: |
| 9364 0035 40 .byte 64 |
| 9365 .global Parameter_DynamicStability |
| 9368 Parameter_DynamicStability: |
| 9369 0036 64 .byte 100 |
| 9370 .global ExternStickNick |
| 9371 .global ExternStickNick |
| 9372 .section .bss |
| 9375 ExternStickNick: |
| 9376 0085 0000 .skip 2,0 |
| 9377 .global ExternStickRoll |
| 9378 .global ExternStickRoll |
| 9381 ExternStickRoll: |
| 9382 0087 0000 .skip 2,0 |
| 9383 .global ExternStickGier |
| 9384 .global ExternStickGier |
| 9387 ExternStickGier: |
| 9388 0089 0000 .skip 2,0 |
| 9389 .global ExternHoehenValue |
| 9390 .data |
| 9393 ExternHoehenValue: |
| 9394 0037 ECFF .word -20 |
| 9395 .global MaxStickNick |
| 9396 .global MaxStickNick |
| 9397 .section .bss |
| 9400 MaxStickNick: |
| 9401 008b 0000 .skip 2,0 |
| 9402 .global MaxStickRoll |
| 9403 .global MaxStickRoll |
| 9406 MaxStickRoll: |
| 9407 008d 0000 .skip 2,0 |
| 9408 .global modell_fliegt |
| 9409 .global modell_fliegt |
| 9412 modell_fliegt: |
| 9413 008f 0000 .skip 2,0 |
| 9414 .global MikroKopterFlags |
| 9415 .global MikroKopterFlags |
| 9418 MikroKopterFlags: |
| 9419 0091 00 .skip 1,0 |
| 9420 .global GIER_GRAD_FAKTOR |
| 9421 .data |
| 9424 GIER_GRAD_FAKTOR: |
| 9425 0039 0B .byte 11 |
| 9426 003a 05 .byte 5 |
| 9427 003b 00 .byte 0 |
| 9428 003c 00 .byte 0 |
| 9431 delay.3112: |
| 9432 003d 64 .byte 100 |
| 9433 .lcomm MittelIntegralRoll_Alt.3105,4 |
| 9434 .lcomm MittelIntegralNick_Alt.3104,4 |
| 9435 .lcomm last_r_n.3103,1 |
| 9436 .lcomm last_r_p.3102,1 |
| 9437 .lcomm last_n_n.3101,1 |
| 9438 .lcomm last_n_p.3100,1 |
| 9439 .lcomm cnt.3099,2 |
| 9440 .lcomm stick_roll.3096,2 |
| 9441 .lcomm stick_nick.3095,2 |
| 9442 .lcomm ausgleichRoll.3090,4 |
| 9443 .lcomm ausgleichNick.3089,4 |
| 9444 .lcomm NeueKompassRichtungMerken.3088,1 |
| 9445 .lcomm TimerWerteausgabe.3087,1 |
| 9446 .lcomm motorwert4.3082,2 |
| 9447 .lcomm motorwert3.3081,2 |
| 9448 .lcomm motorwert2.3080,2 |
| 9449 .lcomm motorwert1.3079,2 |
| 9450 .lcomm hoehenregler.3078,2 |
| 9451 .lcomm delay_ausschalten.3077,1 |
| 9452 .lcomm delay_einschalten.3076,1 |
| 9453 .lcomm delay_neutral.3075,1 |
| 9454 .lcomm RcLostTimer.3074,2 |
| 9455 .lcomm IntegralFehlerRoll.3073,4 |
| 9456 .lcomm IntegralFehlerNick.3072,4 |
| 9457 .lcomm tmp_long2.3071,4 |
| 9458 .lcomm tmp_long.3070,4 |
| 9459 .lcomm sollGier.3069,4 |
| 9460 .lcomm SummeRoll.3068,4 |
| 9461 .lcomm SummeNick.3067,4 |
| 9462 .lcomm d2Nick.2659,2 |
| 9463 .lcomm d2Roll.2658,2 |
| 9464 .lcomm oldRoll.2657,2 |
| 9465 .lcomm oldNick.2656,2 |
| 9466 .lcomm tmpl4.2655,4 |
| 9467 .lcomm tmpl3.2654,4 |
| 9468 .lcomm tmpl2.2653,4 |
| 9469 .lcomm tmpl.2652,4 |
| 9470 .comm TrimNick,2,1 |
| 9471 .comm TrimRoll,2,1 |
| 9472 .comm ErsatzKompass,4,1 |
| 9473 .comm ErsatzKompassInGrad,2,1 |
| 9474 .comm MesswertNick,2,1 |
| 9475 .comm MesswertRoll,2,1 |
| 9476 .comm MesswertGier,2,1 |
| 9477 .comm Mittelwert_AccNick,2,1 |
| 9478 .comm Mittelwert_AccRoll,2,1 |
| 9479 .comm Mittelwert_AccHoch,2,1 |
| 9480 .comm NaviAccNick,2,1 |
| 9481 .comm NaviAccRoll,2,1 |
| 9482 .comm h,1,1 |
| 9483 .comm m,1,1 |
| 9484 .comm s,1,1 |
| 9485 .comm DiffNick,2,1 |
| 9486 .comm DiffRoll,2,1 |
| 9487 .comm Motor_Vorne,1,1 |
| 9488 .comm Motor_Hinten,1,1 |
| 9489 .comm Motor_Rechts,1,1 |
| 9490 .comm Motor_Links,1,1 |
| 9491 .comm Motor1,1,1 |
| 9492 .comm Motor2,1,1 |
| 9493 .comm Motor3,1,1 |
| 9494 .comm Motor4,1,1 |
| 9495 .comm Motor5,1,1 |
| 9496 .comm Motor6,1,1 |
| 9497 .comm Motor7,1,1 |
| 9498 .comm Motor8,1,1 |
| 9499 .comm EE_Parameter,93,1 |
| 9500 .comm Parameter_J16Bitmask,1,1 |
| 9501 .comm Parameter_J16Timing,1,1 |
| 9502 .comm Parameter_J17Bitmask,1,1 |
| 9503 .comm Parameter_J17Timing,1,1 |
| 9504 .comm Parameter_NaviGpsModeControl,1,1 |
| 9505 .comm MesswertGierBias,2,1 |
| 9506 .comm RohMesswertNick,2,1 |
| 9507 .comm RohMesswertRoll,2,1 |
| 9508 .comm AdNeutralGierBias,2,1 |
| 9509 .comm MittelIntegralNick,4,1 |
| 9510 .comm MittelIntegralRoll,4,1 |
| 9511 .comm MittelIntegralNick2,4,1 |
| 9512 .comm MittelIntegralRoll2,4,1 |
| 9513 .comm MAX_GAS,1,1 |
| 9514 .comm MIN_GAS,1,1 |
| 9515 .comm GyroFaktor,1,1 |
| 9516 .comm IntegralFaktor,1,1 |
| 9517 .comm Parameter_NaviGpsGain,1,1 |
| 9518 .comm Parameter_NaviGpsP,1,1 |
| 9519 .comm Parameter_NaviGpsI,1,1 |
| 9520 .comm Parameter_NaviGpsD,1,1 |
| 9521 .comm Parameter_NaviGpsACC,1,1 |
| 9522 .comm Parameter_NaviOperatingRadius,1,1 |
| 9523 .comm Parameter_NaviWindCorrection,1,1 |
| 9524 .comm Parameter_NaviSpeedCompensation,1,1 |
| 9525 .comm Parameter_ExternalControl,1,1 |
| 9526 .comm KopplungsteilNickRoll,2,1 |
| 9527 .comm KopplungsteilRollNick,2,1 |
| 9528 /* File "fc.c": code 10960 = 0x2ad0 (10819), prologues 67, epilogues 74 */ |
| DEFINED SYMBOLS |
| *ABS*:00000000 fc.c |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:2 *ABS*:0000003f __SREG__ |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:3 *ABS*:0000003e __SP_H__ |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:4 *ABS*:0000003d __SP_L__ |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:5 *ABS*:00000000 __tmp_reg__ |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:6 *ABS*:00000001 __zero_reg__ |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:12 .text:00000000 DefaultStickMapping |
| *COM*:0000005d EE_Parameter |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:38 .text:00000032 MotorSmoothing |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:72 .text:0000005e Mittelwert |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:8905 .bss:00000004 AdNeutralGier |
| *COM*:00000002 MesswertGier |
| *COM*:00000002 RohMesswertNick |
| *COM*:00000002 RohMesswertRoll |
| *COM*:00000002 Mittelwert_AccNick |
| *COM*:00000002 Mittelwert_AccRoll |
| *COM*:00000002 Mittelwert_AccHoch |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:8983 .bss:00000026 IntegralAccNick |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:8989 .bss:0000002a IntegralAccRoll |
| *COM*:00000002 NaviAccNick |
| *COM*:00000002 NaviAccRoll |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:8935 .bss:0000000e NaviCntAcc |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:8941 .bss:00000010 NeutralAccZ |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:8995 .bss:0000002e IntegralAccZ |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9019 .bss:0000003e Mess_IntegralRoll |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9007 .bss:00000036 Mess_IntegralNick |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9031 .bss:00000046 Mess_Integral_Gier |
| *COM*:00000004 ErsatzKompass |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9207 .bss:00000077 Looping_Nick |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9213 .bss:00000078 Looping_Roll |
| *COM*:00000002 KopplungsteilRollNick |
| *COM*:00000002 KopplungsteilNickRoll |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9467 .bss:000000e9 tmpl2.2653 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9468 .bss:000000ed tmpl.2652 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9363 .data:00000035 Parameter_CouplingYawCorrection |
| *COM*:00000002 TrimRoll |
| *COM*:00000002 TrimNick |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9424 .data:00000039 GIER_GRAD_FAKTOR |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9025 .bss:00000042 Mess_IntegralRoll2 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9188 .bss:00000073 LageKorrekturRoll |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9100 .data:00000021 Umschlag180Roll |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9013 .bss:0000003a Mess_IntegralNick2 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9194 .bss:00000075 LageKorrekturNick |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9092 .data:0000001d Umschlag180Nick |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9001 .bss:00000032 Integral_Gier |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:8959 .bss:00000016 IntegralNick |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:8971 .bss:0000001e IntegralRoll |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:8965 .bss:0000001a IntegralNick2 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:8977 .bss:00000022 IntegralRoll2 |
| *COM*:00000002 MesswertNick |
| *COM*:00000002 MesswertRoll |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9268 .data:0000002c Parameter_Gyro_D |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9464 .bss:000000df oldNick.2656 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9461 .bss:000000d9 d2Nick.2659 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9463 .bss:000000dd oldRoll.2657 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9462 .bss:000000db d2Roll.2658 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9116 .bss:0000005d Poti1 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9122 .bss:0000005f Poti2 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9128 .bss:00000061 Poti3 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9134 .bss:00000063 Poti4 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9358 .data:00000034 Parameter_AchsKopplung2 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9466 .bss:000000e5 tmpl3.2654 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9465 .bss:000000e1 tmpl4.2655 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9353 .data:00000033 Parameter_AchsKopplung1 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9086 .bss:0000005a TrichterFlug |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:1855 .text:00001174 ParameterZuordnung |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9248 .data:00000028 Parameter_MaxHoehe |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9243 .data:00000027 Parameter_Luftdruck_D |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9253 .data:00000029 Parameter_Hoehe_P |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9258 .data:0000002a Parameter_Hoehe_ACC_Wirkung |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9263 .data:0000002b Parameter_KompassWirkung |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9273 .data:0000002d Parameter_Gyro_P |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9278 .data:0000002e Parameter_Gyro_I |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9288 .data:00000030 Parameter_I_Faktor |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9295 .bss:0000007d Parameter_UserParam1 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9301 .bss:0000007e Parameter_UserParam2 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9307 .bss:0000007f Parameter_UserParam3 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9313 .bss:00000080 Parameter_UserParam4 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9319 .bss:00000081 Parameter_UserParam5 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9325 .bss:00000082 Parameter_UserParam6 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9331 .bss:00000083 Parameter_UserParam7 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9337 .bss:00000084 Parameter_UserParam8 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9343 .data:00000031 Parameter_ServoNickControl |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9348 .data:00000032 Parameter_LoopGasLimit |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9368 .data:00000036 Parameter_DynamicStability |
| *COM*:00000001 Parameter_J16Timing |
| *COM*:00000001 Parameter_J17Timing |
| *COM*:00000001 Parameter_ExternalControl |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9200 .data:00000025 Ki |
| *COM*:00000001 MAX_GAS |
| *COM*:00000001 MIN_GAS |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:2781 .text:000019b8 SendMotorData |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9170 .bss:0000006e MotorenEin |
| *COM*:00000001 Motor_Hinten |
| *COM*:00000001 Motor_Vorne |
| *COM*:00000001 Motor_Rechts |
| *COM*:00000001 Motor_Links |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9418 .bss:00000091 MikroKopterFlags |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:2849 .text:00001a60 CalibrierMittelwert |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:3163 .text:00001d3c SetNeutral |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:8923 .bss:0000000a NeutralAccX |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:8929 .bss:0000000c NeutralAccY |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:8893 .bss:00000000 AdNeutralNick |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:8899 .bss:00000002 AdNeutralRoll |
| *COM*:00000002 AdNeutralGierBias |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:8911 .bss:00000006 StartNeutralRoll |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:8917 .bss:00000008 StartNeutralNick |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9043 .bss:0000004e Mess_Integral_Hoch |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9049 .bss:00000052 KompassValue |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9055 .bss:00000054 KompassStartwert |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9393 .data:00000037 ExternHoehenValue |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9110 .bss:0000005b GierGyroFehler |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9140 .bss:00000065 SenderOkay |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:3644 .text:00002236 Piep |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:3684 .text:0000226e DefaultKonstanten3 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:3806 .text:000023cc DefaultKonstanten2 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:3930 .text:0000252e DefaultKonstanten1 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:4047 .text:0000268c MotorRegler |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9164 .bss:0000006c StickGas |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9453 .bss:000000bb RcLostTimer.3074 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9412 .bss:0000008f modell_fliegt |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9074 .bss:00000058 Notlandung |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9158 .bss:0000006a StickGier |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9146 .bss:00000066 StickNick |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9152 .bss:00000068 StickRoll |
| *COM*:00000001 GyroFaktor |
| *COM*:00000001 IntegralFaktor |
| *COM*:00000004 MittelIntegralNick |
| *COM*:00000004 MittelIntegralRoll |
| *COM*:00000004 MittelIntegralNick2 |
| *COM*:00000004 MittelIntegralRoll2 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9433 .bss:00000096 MittelIntegralNick_Alt.3104 |
| .bss:00000092 MittelIntegralRoll_Alt.3105 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9067 .data:0000001b KompassSignalSchlecht |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9443 .bss:000000ac NeueKompassRichtungMerken.3088 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9458 .bss:000000cd sollGier.3069 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9406 .bss:0000008d MaxStickRoll |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9400 .bss:0000008b MaxStickNick |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9452 .bss:000000ba delay_neutral.3075 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9451 .bss:000000b9 delay_einschalten.3076 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9450 .bss:000000b8 delay_ausschalten.3077 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9440 .bss:000000a2 stick_nick.3095 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9439 .bss:000000a0 stick_roll.3096 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9219 .bss:00000079 Looping_Links |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9225 .bss:0000007a Looping_Rechts |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9237 .bss:0000007c Looping_Oben |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9231 .bss:0000007b Looping_Unten |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9444 .bss:000000ad TimerWerteausgabe.3087 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9459 .bss:000000d1 SummeRoll.3068 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9460 .bss:000000d5 SummeNick.3067 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9431 .data:0000003d delay.3112 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9176 .bss:0000006f HoehenWert |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9449 .bss:000000b6 hoehenregler.3078 |
| *COM*:00000002 DiffNick |
| *COM*:00000002 DiffRoll |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9448 .bss:000000b4 motorwert1.3079 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9447 .bss:000000b2 motorwert2.3080 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9446 .bss:000000b0 motorwert3.3081 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9445 .bss:000000ae motorwert4.3082 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9182 .bss:00000071 SollHoehe |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9080 .bss:00000059 HoehenReglerAktiv |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9442 .bss:000000a8 ausgleichNick.3089 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9457 .bss:000000c9 tmp_long.3070 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9456 .bss:000000c5 tmp_long2.3071 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9455 .bss:000000c1 IntegralFehlerNick.3072 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9454 .bss:000000bd IntegralFehlerRoll.3073 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9438 .bss:0000009e cnt.3099 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9441 .bss:000000a4 ausgleichRoll.3090 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9037 .bss:0000004a Mess_Integral_Gier2 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9435 .bss:0000009b last_r_p.3102 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9434 .bss:0000009a last_r_n.3103 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9437 .bss:0000009d last_n_p.3100 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9436 .bss:0000009c last_n_n.3101 |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:8886 .data:00000019 I2CTimeout |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:8947 .bss:00000014 CosinusNickWinkel |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:8953 .bss:00000015 CosinusRollWinkel |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9061 .bss:00000056 KompassRichtung |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9283 .data:0000002f Parameter_Gier_P |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9375 .bss:00000085 ExternStickNick |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9381 .bss:00000087 ExternStickRoll |
| C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccmyRWWq.s:9387 .bss:00000089 ExternStickGier |
| *COM*:00000002 ErsatzKompassInGrad |
| *COM*:00000001 h |
| *COM*:00000001 m |
| *COM*:00000001 s |
| *COM*:00000001 Motor1 |
| *COM*:00000001 Motor2 |
| *COM*:00000001 Motor3 |
| *COM*:00000001 Motor4 |
| *COM*:00000001 Motor5 |
| *COM*:00000001 Motor6 |
| *COM*:00000001 Motor7 |
| *COM*:00000001 Motor8 |
| *COM*:00000001 Parameter_J16Bitmask |
| *COM*:00000001 Parameter_J17Bitmask |
| *COM*:00000001 Parameter_NaviGpsModeControl |
| *COM*:00000002 MesswertGierBias |
| *COM*:00000001 Parameter_NaviGpsGain |
| *COM*:00000001 Parameter_NaviGpsP |
| *COM*:00000001 Parameter_NaviGpsI |
| *COM*:00000001 Parameter_NaviGpsD |
| *COM*:00000001 Parameter_NaviGpsACC |
| *COM*:00000001 Parameter_NaviOperatingRadius |
| *COM*:00000001 Parameter_NaviWindCorrection |
| *COM*:00000001 Parameter_NaviSpeedCompensation |
| |
| UNDEFINED SYMBOLS |
| __do_copy_data |
| __do_clear_bss |
| AdWertGier |
| AdWertNickFilter |
| AdWertRollFilter |
| AdWertAccNick |
| __mulsi3 |
| __divmodsi4 |
| AdWertAccRoll |
| AdWertAccHoch |
| Aktuell_az |
| __floatsisf |
| __subsf3 |
| __addsf3 |
| __fixsfsi |
| AdReady |
| HiResNick |
| HiResRoll |
| AdWertNick |
| PlatinenVersion |
| AdWertRoll |
| PPM_in |
| __divmodhi4 |
| MotorTest |
| DebugOut |
| twi_state |
| motor |
| i2c_start |
| SucheGyroOffset |
| ServoActive |
| ExpandBaro |
| Delay_ms_Mess |
| MessLuftdruck |
| EEPromArray |
| __eeprom_read_byte_1F2021 |
| SucheLuftruckOffset |
| Luftdruck |
| StartLuftdruck |
| HoeheD |
| GPS_Neutral |
| beeptime |
| SendVersionToNavi |
| LED_Init |
| FromNaviCtrl_Value |
| Delay_ms |
| PcZugriff |
| BeepMuster |
| PPM_diff |
| NewPpmData |
| ZaehlMessungen |
| SetActiveParamSetNumber |
| WinkelOut |
| GPS_Nick2 |
| GPS_Nick |
| GPS_Roll2 |
| GPS_Roll |
| __fixunssfsi |
| ExternControl |
| UBat |
| ServoValue |
| __eeprom_write_byte_1F2021 |
| GetActiveParamSetNumber |
| DruckOffsetSetting |
| ReadParameterSet |