0,0 → 1,4489 |
1 .file "fc.c" |
2 .arch atmega644 |
3 __SREG__ = 0x3f |
4 __SP_H__ = 0x3e |
5 __SP_L__ = 0x3d |
6 __tmp_reg__ = 0 |
7 __zero_reg__ = 1 |
8 .global __do_copy_data |
9 .global __do_clear_bss |
10 .text |
11 .global Mittelwert |
13 Mittelwert: |
14 /* prologue: frame size=0 */ |
15 0000 AF92 push r10 |
16 0002 BF92 push r11 |
17 0004 CF92 push r12 |
18 0006 DF92 push r13 |
19 0008 EF92 push r14 |
20 000a FF92 push r15 |
21 000c 0F93 push r16 |
22 000e 1F93 push r17 |
23 /* prologue end (size=8) */ |
24 0010 1092 7A00 sts 122,__zero_reg__ |
25 0014 8091 0000 lds r24,MessanzahlNick |
26 0018 8823 tst r24 |
27 001a 01F0 breq .L2 |
28 001c 8091 0000 lds r24,AccumulateNick |
29 0020 9091 0000 lds r25,(AccumulateNick)+1 |
30 0024 6091 0000 lds r22,MessanzahlNick |
31 0028 7727 clr r23 |
32 002a 0E94 0000 call __divmodhi4 |
33 002e 7093 0000 sts (MesswertNick)+1,r23 |
34 0032 6093 0000 sts MesswertNick,r22 |
35 .L2: |
36 0036 8091 0000 lds r24,MessanzahlRoll |
37 003a 8823 tst r24 |
38 003c 01F0 breq .L4 |
39 003e 8091 0000 lds r24,AccumulateRoll |
40 0042 9091 0000 lds r25,(AccumulateRoll)+1 |
41 0046 6091 0000 lds r22,MessanzahlRoll |
42 004a 7727 clr r23 |
43 004c 0E94 0000 call __divmodhi4 |
44 0050 7093 0000 sts (MesswertRoll)+1,r23 |
45 0054 6093 0000 sts MesswertRoll,r22 |
46 .L4: |
47 0058 8091 0000 lds r24,MessanzahlGier |
48 005c 8823 tst r24 |
49 005e 01F0 breq .L6 |
50 0060 8091 0000 lds r24,AccumulateGier |
51 0064 9091 0000 lds r25,(AccumulateGier)+1 |
52 0068 6091 0000 lds r22,MessanzahlGier |
53 006c 7727 clr r23 |
54 006e 0E94 0000 call __divmodhi4 |
55 0072 7093 0000 sts (MesswertGier)+1,r23 |
56 0076 6093 0000 sts MesswertGier,r22 |
57 .L6: |
58 007a 8091 0000 lds r24,messanzahl_AccNick |
59 007e 8823 tst r24 |
60 0080 01F0 breq .L8 |
61 0082 E090 0000 lds r14,Mittelwert_AccNick |
62 0086 F090 0000 lds r15,(Mittelwert_AccNick)+1 |
63 008a 6091 0000 lds r22,accumulate_AccNick |
64 008e 7091 0000 lds r23,(accumulate_AccNick)+1 |
65 0092 2091 0000 lds r18,messanzahl_AccNick |
66 0096 0027 clr r16 |
67 0098 F7FC sbrc r15,7 |
68 009a 0095 com r16 |
69 009c 102F mov r17,r16 |
70 009e 5701 movw r10,r14 |
71 00a0 6801 movw r12,r16 |
72 00a2 43E0 ldi r20,3 |
73 00a4 AA0C 1: lsl r10 |
74 00a6 BB1C rol r11 |
75 00a8 CC1C rol r12 |
76 00aa DD1C rol r13 |
77 00ac 4A95 dec r20 |
78 00ae 01F4 brne 1b |
79 00b0 AE18 sub r10,r14 |
80 00b2 BF08 sbc r11,r15 |
81 00b4 C00A sbc r12,r16 |
82 00b6 D10A sbc r13,r17 |
83 00b8 8827 clr r24 |
84 00ba 77FD sbrc r23,7 |
85 00bc 8095 com r24 |
86 00be 982F mov r25,r24 |
87 00c0 34E0 ldi r19,4 |
88 00c2 660F 1: lsl r22 |
89 00c4 771F rol r23 |
90 00c6 881F rol r24 |
91 00c8 991F rol r25 |
92 00ca 3A95 dec r19 |
93 00cc 01F4 brne 1b |
94 00ce 3327 clr r19 |
95 00d0 4427 clr r20 |
96 00d2 5527 clr r21 |
97 00d4 0E94 0000 call __divmodsi4 |
98 00d8 A20E add r10,r18 |
99 00da B31E adc r11,r19 |
100 00dc C41E adc r12,r20 |
101 00de D51E adc r13,r21 |
102 00e0 C601 movw r24,r12 |
103 00e2 B501 movw r22,r10 |
104 00e4 28E0 ldi r18,lo8(8) |
105 00e6 30E0 ldi r19,hi8(8) |
106 00e8 40E0 ldi r20,hlo8(8) |
107 00ea 50E0 ldi r21,hhi8(8) |
108 00ec 0E94 0000 call __divmodsi4 |
109 00f0 3093 0000 sts (Mittelwert_AccNick)+1,r19 |
110 00f4 2093 0000 sts Mittelwert_AccNick,r18 |
111 .L8: |
112 00f8 8091 0000 lds r24,messanzahl_AccRoll |
113 00fc 8823 tst r24 |
114 00fe 01F0 breq .L10 |
115 0100 E090 0000 lds r14,Mittelwert_AccRoll |
116 0104 F090 0000 lds r15,(Mittelwert_AccRoll)+1 |
117 0108 6091 0000 lds r22,accumulate_AccRoll |
118 010c 7091 0000 lds r23,(accumulate_AccRoll)+1 |
119 0110 2091 0000 lds r18,messanzahl_AccRoll |
120 0114 0027 clr r16 |
121 0116 F7FC sbrc r15,7 |
122 0118 0095 com r16 |
123 011a 102F mov r17,r16 |
124 011c 5701 movw r10,r14 |
125 011e 6801 movw r12,r16 |
126 0120 83E0 ldi r24,3 |
127 0122 AA0C 1: lsl r10 |
128 0124 BB1C rol r11 |
129 0126 CC1C rol r12 |
130 0128 DD1C rol r13 |
131 012a 8A95 dec r24 |
132 012c 01F4 brne 1b |
133 012e AE18 sub r10,r14 |
134 0130 BF08 sbc r11,r15 |
135 0132 C00A sbc r12,r16 |
136 0134 D10A sbc r13,r17 |
137 0136 8827 clr r24 |
138 0138 77FD sbrc r23,7 |
139 013a 8095 com r24 |
140 013c 982F mov r25,r24 |
141 013e B4E0 ldi r27,4 |
142 0140 660F 1: lsl r22 |
143 0142 771F rol r23 |
144 0144 881F rol r24 |
145 0146 991F rol r25 |
146 0148 BA95 dec r27 |
147 014a 01F4 brne 1b |
148 014c 3327 clr r19 |
149 014e 4427 clr r20 |
150 0150 5527 clr r21 |
151 0152 0E94 0000 call __divmodsi4 |
152 0156 A20E add r10,r18 |
153 0158 B31E adc r11,r19 |
154 015a C41E adc r12,r20 |
155 015c D51E adc r13,r21 |
156 015e C601 movw r24,r12 |
157 0160 B501 movw r22,r10 |
158 0162 28E0 ldi r18,lo8(8) |
159 0164 30E0 ldi r19,hi8(8) |
160 0166 40E0 ldi r20,hlo8(8) |
161 0168 50E0 ldi r21,hhi8(8) |
162 016a 0E94 0000 call __divmodsi4 |
163 016e 3093 0000 sts (Mittelwert_AccRoll)+1,r19 |
164 0172 2093 0000 sts Mittelwert_AccRoll,r18 |
165 .L10: |
166 0176 8091 0000 lds r24,messanzahl_AccHoch |
167 017a 8823 tst r24 |
168 017c 01F0 breq .L12 |
169 017e E090 0000 lds r14,Mittelwert_AccHoch |
170 0182 F090 0000 lds r15,(Mittelwert_AccHoch)+1 |
171 0186 6091 0000 lds r22,accumulate_AccHoch |
172 018a 7091 0000 lds r23,(accumulate_AccHoch)+1 |
173 018e 2091 0000 lds r18,messanzahl_AccHoch |
174 0192 0027 clr r16 |
175 0194 F7FC sbrc r15,7 |
176 0196 0095 com r16 |
177 0198 102F mov r17,r16 |
178 019a 5701 movw r10,r14 |
179 019c 6801 movw r12,r16 |
180 019e A3E0 ldi r26,3 |
181 01a0 AA0C 1: lsl r10 |
182 01a2 BB1C rol r11 |
183 01a4 CC1C rol r12 |
184 01a6 DD1C rol r13 |
185 01a8 AA95 dec r26 |
186 01aa 01F4 brne 1b |
187 01ac AE18 sub r10,r14 |
188 01ae BF08 sbc r11,r15 |
189 01b0 C00A sbc r12,r16 |
190 01b2 D10A sbc r13,r17 |
191 01b4 8827 clr r24 |
192 01b6 77FD sbrc r23,7 |
193 01b8 8095 com r24 |
194 01ba 982F mov r25,r24 |
195 01bc 3327 clr r19 |
196 01be 4427 clr r20 |
197 01c0 5527 clr r21 |
198 01c2 0E94 0000 call __divmodsi4 |
199 01c6 A20E add r10,r18 |
200 01c8 B31E adc r11,r19 |
201 01ca C41E adc r12,r20 |
202 01cc D51E adc r13,r21 |
203 01ce C601 movw r24,r12 |
204 01d0 B501 movw r22,r10 |
205 01d2 28E0 ldi r18,lo8(8) |
206 01d4 30E0 ldi r19,hi8(8) |
207 01d6 40E0 ldi r20,hlo8(8) |
208 01d8 50E0 ldi r21,hhi8(8) |
209 01da 0E94 0000 call __divmodsi4 |
210 01de 3093 0000 sts (Mittelwert_AccHoch)+1,r19 |
211 01e2 2093 0000 sts Mittelwert_AccHoch,r18 |
212 .L12: |
213 01e6 1092 0000 sts (AccumulateNick)+1,__zero_reg__ |
214 01ea 1092 0000 sts AccumulateNick,__zero_reg__ |
215 01ee 1092 0000 sts MessanzahlNick,__zero_reg__ |
216 01f2 1092 0000 sts (AccumulateRoll)+1,__zero_reg__ |
217 01f6 1092 0000 sts AccumulateRoll,__zero_reg__ |
218 01fa 1092 0000 sts MessanzahlRoll,__zero_reg__ |
219 01fe 1092 0000 sts (AccumulateGier)+1,__zero_reg__ |
220 0202 1092 0000 sts AccumulateGier,__zero_reg__ |
221 0206 1092 0000 sts MessanzahlGier,__zero_reg__ |
222 020a 1092 0000 sts (accumulate_AccRoll)+1,__zero_reg__ |
223 020e 1092 0000 sts accumulate_AccRoll,__zero_reg__ |
224 0212 1092 0000 sts messanzahl_AccRoll,__zero_reg__ |
225 0216 1092 0000 sts (accumulate_AccNick)+1,__zero_reg__ |
226 021a 1092 0000 sts accumulate_AccNick,__zero_reg__ |
227 021e 1092 0000 sts messanzahl_AccNick,__zero_reg__ |
228 0222 1092 0000 sts (accumulate_AccHoch)+1,__zero_reg__ |
229 0226 1092 0000 sts accumulate_AccHoch,__zero_reg__ |
230 022a 1092 0000 sts messanzahl_AccHoch,__zero_reg__ |
231 022e 8091 0000 lds r24,Mess_Integral_Gier |
232 0232 9091 0000 lds r25,(Mess_Integral_Gier)+1 |
233 0236 A091 0000 lds r26,(Mess_Integral_Gier)+2 |
234 023a B091 0000 lds r27,(Mess_Integral_Gier)+3 |
235 023e 8093 0000 sts Integral_Gier,r24 |
236 0242 9093 0000 sts (Integral_Gier)+1,r25 |
237 0246 A093 0000 sts (Integral_Gier)+2,r26 |
238 024a B093 0000 sts (Integral_Gier)+3,r27 |
239 024e 8091 0000 lds r24,Mess_IntegralNick |
240 0252 9091 0000 lds r25,(Mess_IntegralNick)+1 |
241 0256 A091 0000 lds r26,(Mess_IntegralNick)+2 |
242 025a B091 0000 lds r27,(Mess_IntegralNick)+3 |
243 025e 8093 0000 sts IntegralNick,r24 |
244 0262 9093 0000 sts (IntegralNick)+1,r25 |
245 0266 A093 0000 sts (IntegralNick)+2,r26 |
246 026a B093 0000 sts (IntegralNick)+3,r27 |
247 026e 8091 0000 lds r24,Mess_IntegralRoll |
248 0272 9091 0000 lds r25,(Mess_IntegralRoll)+1 |
249 0276 A091 0000 lds r26,(Mess_IntegralRoll)+2 |
250 027a B091 0000 lds r27,(Mess_IntegralRoll)+3 |
251 027e 8093 0000 sts IntegralRoll,r24 |
252 0282 9093 0000 sts (IntegralRoll)+1,r25 |
253 0286 A093 0000 sts (IntegralRoll)+2,r26 |
254 028a B093 0000 sts (IntegralRoll)+3,r27 |
255 028e 8091 0000 lds r24,Mess_IntegralNick2 |
256 0292 9091 0000 lds r25,(Mess_IntegralNick2)+1 |
257 0296 A091 0000 lds r26,(Mess_IntegralNick2)+2 |
258 029a B091 0000 lds r27,(Mess_IntegralNick2)+3 |
259 029e 8093 0000 sts IntegralNick2,r24 |
260 02a2 9093 0000 sts (IntegralNick2)+1,r25 |
261 02a6 A093 0000 sts (IntegralNick2)+2,r26 |
262 02aa B093 0000 sts (IntegralNick2)+3,r27 |
263 02ae 8091 0000 lds r24,Mess_IntegralRoll2 |
264 02b2 9091 0000 lds r25,(Mess_IntegralRoll2)+1 |
265 02b6 A091 0000 lds r26,(Mess_IntegralRoll2)+2 |
266 02ba B091 0000 lds r27,(Mess_IntegralRoll2)+3 |
267 02be 8093 0000 sts IntegralRoll2,r24 |
268 02c2 9093 0000 sts (IntegralRoll2)+1,r25 |
269 02c6 A093 0000 sts (IntegralRoll2)+2,r26 |
270 02ca B093 0000 sts (IntegralRoll2)+3,r27 |
271 02ce 8FEE ldi r24,lo8(-17) |
272 02d0 8093 7A00 sts 122,r24 |
273 02d4 8091 0000 lds r24,MesswertNick |
274 02d8 9091 0000 lds r25,(MesswertNick)+1 |
275 02dc 893C cpi r24,201 |
276 02de 9105 cpc r25,__zero_reg__ |
277 02e0 04F0 brlt .L14 |
278 02e2 2091 0000 lds r18,MesswertNick |
279 02e6 3091 0000 lds r19,(MesswertNick)+1 |
280 02ea 8091 0000 lds r24,MesswertNick |
281 02ee 9091 0000 lds r25,(MesswertNick)+1 |
282 02f2 880F lsl r24 |
283 02f4 991F rol r25 |
284 02f6 880F lsl r24 |
285 02f8 991F rol r25 |
286 02fa 2052 subi r18,lo8(-(-800)) |
287 02fc 3340 sbci r19,hi8(-(-800)) |
288 02fe 00C0 rjmp .L59 |
289 .L14: |
290 0300 8091 0000 lds r24,MesswertNick |
291 0304 9091 0000 lds r25,(MesswertNick)+1 |
292 0308 8853 subi r24,lo8(-200) |
293 030a 9F4F sbci r25,hi8(-200) |
294 030c 04F4 brge .L16 |
295 030e 2091 0000 lds r18,MesswertNick |
296 0312 3091 0000 lds r19,(MesswertNick)+1 |
297 0316 8091 0000 lds r24,MesswertNick |
298 031a 9091 0000 lds r25,(MesswertNick)+1 |
299 031e 880F lsl r24 |
300 0320 991F rol r25 |
301 0322 880F lsl r24 |
302 0324 991F rol r25 |
303 0326 205E subi r18,lo8(-(800)) |
304 0328 3C4F sbci r19,hi8(-(800)) |
305 .L59: |
306 032a 820F add r24,r18 |
307 032c 931F adc r25,r19 |
308 032e 9093 0000 sts (MesswertNick)+1,r25 |
309 0332 8093 0000 sts MesswertNick,r24 |
310 .L16: |
311 0336 8091 0000 lds r24,MesswertRoll |
312 033a 9091 0000 lds r25,(MesswertRoll)+1 |
313 033e 893C cpi r24,201 |
314 0340 9105 cpc r25,__zero_reg__ |
315 0342 04F0 brlt .L18 |
316 0344 2091 0000 lds r18,MesswertRoll |
317 0348 3091 0000 lds r19,(MesswertRoll)+1 |
318 034c 8091 0000 lds r24,MesswertRoll |
319 0350 9091 0000 lds r25,(MesswertRoll)+1 |
320 0354 880F lsl r24 |
321 0356 991F rol r25 |
322 0358 880F lsl r24 |
323 035a 991F rol r25 |
324 035c 2052 subi r18,lo8(-(-800)) |
325 035e 3340 sbci r19,hi8(-(-800)) |
326 0360 00C0 rjmp .L60 |
327 .L18: |
328 0362 8091 0000 lds r24,MesswertRoll |
329 0366 9091 0000 lds r25,(MesswertRoll)+1 |
330 036a 8853 subi r24,lo8(-200) |
331 036c 9F4F sbci r25,hi8(-200) |
332 036e 04F4 brge .L20 |
333 0370 2091 0000 lds r18,MesswertRoll |
334 0374 3091 0000 lds r19,(MesswertRoll)+1 |
335 0378 8091 0000 lds r24,MesswertRoll |
336 037c 9091 0000 lds r25,(MesswertRoll)+1 |
337 0380 880F lsl r24 |
338 0382 991F rol r25 |
339 0384 880F lsl r24 |
340 0386 991F rol r25 |
341 0388 205E subi r18,lo8(-(800)) |
342 038a 3C4F sbci r19,hi8(-(800)) |
343 .L60: |
344 038c 820F add r24,r18 |
345 038e 931F adc r25,r19 |
346 0390 9093 0000 sts (MesswertRoll)+1,r25 |
347 0394 8093 0000 sts MesswertRoll,r24 |
348 .L20: |
349 0398 2091 0000 lds r18,Poti1 |
350 039c 3091 0000 lds r19,(Poti1)+1 |
351 03a0 8091 0000 lds r24,EE_Parameter+4 |
352 03a4 E82F mov r30,r24 |
353 03a6 FF27 clr r31 |
354 03a8 EE0F lsl r30 |
355 03aa FF1F rol r31 |
356 03ac E050 subi r30,lo8(-(PPM_in)) |
357 03ae F040 sbci r31,hi8(-(PPM_in)) |
358 03b0 8081 ld r24,Z |
359 03b2 9181 ldd r25,Z+1 |
360 03b4 8259 subi r24,lo8(-(110)) |
361 03b6 9F4F sbci r25,hi8(-(110)) |
362 03b8 2817 cp r18,r24 |
363 03ba 3907 cpc r19,r25 |
364 03bc 04F4 brge .L22 |
365 03be 2F5F subi r18,lo8(-(1)) |
366 03c0 3F4F sbci r19,hi8(-(1)) |
367 03c2 00C0 rjmp .L61 |
368 .L22: |
369 03c4 8081 ld r24,Z |
370 03c6 9181 ldd r25,Z+1 |
371 03c8 8259 subi r24,lo8(-(110)) |
372 03ca 9F4F sbci r25,hi8(-(110)) |
373 03cc 8217 cp r24,r18 |
374 03ce 9307 cpc r25,r19 |
375 03d0 04F4 brge .L24 |
376 03d2 2115 cp r18,__zero_reg__ |
377 03d4 3105 cpc r19,__zero_reg__ |
378 03d6 01F0 breq .L24 |
379 03d8 2150 subi r18,lo8(-(-1)) |
380 03da 3040 sbci r19,hi8(-(-1)) |
381 .L61: |
382 03dc 3093 0000 sts (Poti1)+1,r19 |
383 03e0 2093 0000 sts Poti1,r18 |
384 .L24: |
385 03e4 2091 0000 lds r18,Poti2 |
386 03e8 3091 0000 lds r19,(Poti2)+1 |
387 03ec 8091 0000 lds r24,EE_Parameter+5 |
388 03f0 E82F mov r30,r24 |
389 03f2 FF27 clr r31 |
390 03f4 EE0F lsl r30 |
391 03f6 FF1F rol r31 |
392 03f8 E050 subi r30,lo8(-(PPM_in)) |
393 03fa F040 sbci r31,hi8(-(PPM_in)) |
394 03fc 8081 ld r24,Z |
395 03fe 9181 ldd r25,Z+1 |
396 0400 8259 subi r24,lo8(-(110)) |
397 0402 9F4F sbci r25,hi8(-(110)) |
398 0404 2817 cp r18,r24 |
399 0406 3907 cpc r19,r25 |
400 0408 04F4 brge .L27 |
401 040a 2F5F subi r18,lo8(-(1)) |
402 040c 3F4F sbci r19,hi8(-(1)) |
403 040e 00C0 rjmp .L62 |
404 .L27: |
405 0410 8081 ld r24,Z |
406 0412 9181 ldd r25,Z+1 |
407 0414 8259 subi r24,lo8(-(110)) |
408 0416 9F4F sbci r25,hi8(-(110)) |
409 0418 8217 cp r24,r18 |
410 041a 9307 cpc r25,r19 |
411 041c 04F4 brge .L29 |
412 041e 2115 cp r18,__zero_reg__ |
413 0420 3105 cpc r19,__zero_reg__ |
414 0422 01F0 breq .L29 |
415 0424 2150 subi r18,lo8(-(-1)) |
416 0426 3040 sbci r19,hi8(-(-1)) |
417 .L62: |
418 0428 3093 0000 sts (Poti2)+1,r19 |
419 042c 2093 0000 sts Poti2,r18 |
420 .L29: |
421 0430 2091 0000 lds r18,Poti3 |
422 0434 3091 0000 lds r19,(Poti3)+1 |
423 0438 8091 0000 lds r24,EE_Parameter+6 |
424 043c E82F mov r30,r24 |
425 043e FF27 clr r31 |
426 0440 EE0F lsl r30 |
427 0442 FF1F rol r31 |
428 0444 E050 subi r30,lo8(-(PPM_in)) |
429 0446 F040 sbci r31,hi8(-(PPM_in)) |
430 0448 8081 ld r24,Z |
431 044a 9181 ldd r25,Z+1 |
432 044c 8259 subi r24,lo8(-(110)) |
433 044e 9F4F sbci r25,hi8(-(110)) |
434 0450 2817 cp r18,r24 |
435 0452 3907 cpc r19,r25 |
436 0454 04F4 brge .L32 |
437 0456 2F5F subi r18,lo8(-(1)) |
438 0458 3F4F sbci r19,hi8(-(1)) |
439 045a 00C0 rjmp .L63 |
440 .L32: |
441 045c 8081 ld r24,Z |
442 045e 9181 ldd r25,Z+1 |
443 0460 8259 subi r24,lo8(-(110)) |
444 0462 9F4F sbci r25,hi8(-(110)) |
445 0464 8217 cp r24,r18 |
446 0466 9307 cpc r25,r19 |
447 0468 04F4 brge .L34 |
448 046a 2115 cp r18,__zero_reg__ |
449 046c 3105 cpc r19,__zero_reg__ |
450 046e 01F0 breq .L34 |
451 0470 2150 subi r18,lo8(-(-1)) |
452 0472 3040 sbci r19,hi8(-(-1)) |
453 .L63: |
454 0474 3093 0000 sts (Poti3)+1,r19 |
455 0478 2093 0000 sts Poti3,r18 |
456 .L34: |
457 047c 2091 0000 lds r18,Poti4 |
458 0480 3091 0000 lds r19,(Poti4)+1 |
459 0484 8091 0000 lds r24,EE_Parameter+7 |
460 0488 E82F mov r30,r24 |
461 048a FF27 clr r31 |
462 048c EE0F lsl r30 |
463 048e FF1F rol r31 |
464 0490 E050 subi r30,lo8(-(PPM_in)) |
465 0492 F040 sbci r31,hi8(-(PPM_in)) |
466 0494 8081 ld r24,Z |
467 0496 9181 ldd r25,Z+1 |
468 0498 8259 subi r24,lo8(-(110)) |
469 049a 9F4F sbci r25,hi8(-(110)) |
470 049c 2817 cp r18,r24 |
471 049e 3907 cpc r19,r25 |
472 04a0 04F4 brge .L37 |
473 04a2 2F5F subi r18,lo8(-(1)) |
474 04a4 3F4F sbci r19,hi8(-(1)) |
475 04a6 00C0 rjmp .L64 |
476 .L37: |
477 04a8 8081 ld r24,Z |
478 04aa 9181 ldd r25,Z+1 |
479 04ac 8259 subi r24,lo8(-(110)) |
480 04ae 9F4F sbci r25,hi8(-(110)) |
481 04b0 8217 cp r24,r18 |
482 04b2 9307 cpc r25,r19 |
483 04b4 04F4 brge .L39 |
484 04b6 2115 cp r18,__zero_reg__ |
485 04b8 3105 cpc r19,__zero_reg__ |
486 04ba 01F0 breq .L39 |
487 04bc 2150 subi r18,lo8(-(-1)) |
488 04be 3040 sbci r19,hi8(-(-1)) |
489 .L64: |
490 04c0 3093 0000 sts (Poti4)+1,r19 |
491 04c4 2093 0000 sts Poti4,r18 |
492 .L39: |
493 04c8 8091 0000 lds r24,Poti1 |
494 04cc 9091 0000 lds r25,(Poti1)+1 |
495 04d0 97FF sbrs r25,7 |
496 04d2 00C0 rjmp .L42 |
497 04d4 1092 0000 sts (Poti1)+1,__zero_reg__ |
498 04d8 1092 0000 sts Poti1,__zero_reg__ |
499 04dc 00C0 rjmp .L44 |
500 .L42: |
501 04de 8F3F cpi r24,255 |
502 04e0 9105 cpc r25,__zero_reg__ |
503 04e2 01F0 breq .L44 |
504 04e4 04F0 brlt .L44 |
505 04e6 8FEF ldi r24,lo8(255) |
506 04e8 90E0 ldi r25,hi8(255) |
507 04ea 9093 0000 sts (Poti1)+1,r25 |
508 04ee 8093 0000 sts Poti1,r24 |
509 .L44: |
510 04f2 8091 0000 lds r24,Poti2 |
511 04f6 9091 0000 lds r25,(Poti2)+1 |
512 04fa 97FF sbrs r25,7 |
513 04fc 00C0 rjmp .L46 |
514 04fe 1092 0000 sts (Poti2)+1,__zero_reg__ |
515 0502 1092 0000 sts Poti2,__zero_reg__ |
516 0506 00C0 rjmp .L48 |
517 .L46: |
518 0508 8F3F cpi r24,255 |
519 050a 9105 cpc r25,__zero_reg__ |
520 050c 01F0 breq .L48 |
521 050e 04F0 brlt .L48 |
522 0510 8FEF ldi r24,lo8(255) |
523 0512 90E0 ldi r25,hi8(255) |
524 0514 9093 0000 sts (Poti2)+1,r25 |
525 0518 8093 0000 sts Poti2,r24 |
526 .L48: |
527 051c 8091 0000 lds r24,Poti3 |
528 0520 9091 0000 lds r25,(Poti3)+1 |
529 0524 97FF sbrs r25,7 |
530 0526 00C0 rjmp .L50 |
531 0528 1092 0000 sts (Poti3)+1,__zero_reg__ |
532 052c 1092 0000 sts Poti3,__zero_reg__ |
533 0530 00C0 rjmp .L52 |
534 .L50: |
535 0532 8F3F cpi r24,255 |
536 0534 9105 cpc r25,__zero_reg__ |
537 0536 01F0 breq .L52 |
538 0538 04F0 brlt .L52 |
539 053a 8FEF ldi r24,lo8(255) |
540 053c 90E0 ldi r25,hi8(255) |
541 053e 9093 0000 sts (Poti3)+1,r25 |
542 0542 8093 0000 sts Poti3,r24 |
543 .L52: |
544 0546 8091 0000 lds r24,Poti4 |
545 054a 9091 0000 lds r25,(Poti4)+1 |
546 054e 97FF sbrs r25,7 |
547 0550 00C0 rjmp .L54 |
548 0552 1092 0000 sts (Poti4)+1,__zero_reg__ |
549 0556 1092 0000 sts Poti4,__zero_reg__ |
550 055a 00C0 rjmp .L58 |
551 .L54: |
552 055c 8F3F cpi r24,255 |
553 055e 9105 cpc r25,__zero_reg__ |
554 0560 01F0 breq .L58 |
555 0562 04F0 brlt .L58 |
556 0564 8FEF ldi r24,lo8(255) |
557 0566 90E0 ldi r25,hi8(255) |
558 0568 9093 0000 sts (Poti4)+1,r25 |
559 056c 8093 0000 sts Poti4,r24 |
560 .L58: |
561 /* epilogue: frame size=0 */ |
562 0570 1F91 pop r17 |
563 0572 0F91 pop r16 |
564 0574 FF90 pop r15 |
565 0576 EF90 pop r14 |
566 0578 DF90 pop r13 |
567 057a CF90 pop r12 |
568 057c BF90 pop r11 |
569 057e AF90 pop r10 |
570 0580 0895 ret |
571 /* epilogue end (size=9) */ |
572 /* function Mittelwert size 707 (690) */ |
574 .global CalibrierMittelwert |
576 CalibrierMittelwert: |
577 /* prologue: frame size=0 */ |
578 /* prologue end (size=0) */ |
579 0582 1092 7A00 sts 122,__zero_reg__ |
580 0586 8091 0000 lds r24,MessanzahlNick |
581 058a 8823 tst r24 |
582 058c 01F0 breq .L66 |
583 058e 8091 0000 lds r24,AccumulateNick |
584 0592 9091 0000 lds r25,(AccumulateNick)+1 |
585 0596 6091 0000 lds r22,MessanzahlNick |
586 059a 7727 clr r23 |
587 059c 0E94 0000 call __divmodhi4 |
588 05a0 7093 0000 sts (MesswertNick)+1,r23 |
589 05a4 6093 0000 sts MesswertNick,r22 |
590 .L66: |
591 05a8 8091 0000 lds r24,MessanzahlRoll |
592 05ac 8823 tst r24 |
593 05ae 01F0 breq .L68 |
594 05b0 8091 0000 lds r24,AccumulateRoll |
595 05b4 9091 0000 lds r25,(AccumulateRoll)+1 |
596 05b8 6091 0000 lds r22,MessanzahlRoll |
597 05bc 7727 clr r23 |
598 05be 0E94 0000 call __divmodhi4 |
599 05c2 7093 0000 sts (MesswertRoll)+1,r23 |
600 05c6 6093 0000 sts MesswertRoll,r22 |
601 .L68: |
602 05ca 8091 0000 lds r24,MessanzahlGier |
603 05ce 8823 tst r24 |
604 05d0 01F0 breq .L70 |
605 05d2 8091 0000 lds r24,AccumulateGier |
606 05d6 9091 0000 lds r25,(AccumulateGier)+1 |
607 05da 6091 0000 lds r22,MessanzahlGier |
608 05de 7727 clr r23 |
609 05e0 0E94 0000 call __divmodhi4 |
610 05e4 7093 0000 sts (MesswertGier)+1,r23 |
611 05e8 6093 0000 sts MesswertGier,r22 |
612 .L70: |
613 05ec 8091 0000 lds r24,messanzahl_AccNick |
614 05f0 8823 tst r24 |
615 05f2 01F0 breq .L72 |
616 05f4 6091 0000 lds r22,accumulate_AccNick |
617 05f8 7091 0000 lds r23,(accumulate_AccNick)+1 |
618 05fc 2091 0000 lds r18,messanzahl_AccNick |
619 0600 8827 clr r24 |
620 0602 77FD sbrc r23,7 |
621 0604 8095 com r24 |
622 0606 982F mov r25,r24 |
623 0608 34E0 ldi r19,4 |
624 060a 660F 1: lsl r22 |
625 060c 771F rol r23 |
626 060e 881F rol r24 |
627 0610 991F rol r25 |
628 0612 3A95 dec r19 |
629 0614 01F4 brne 1b |
630 0616 3327 clr r19 |
631 0618 4427 clr r20 |
632 061a 5527 clr r21 |
633 061c 0E94 0000 call __divmodsi4 |
634 0620 3093 0000 sts (Mittelwert_AccNick)+1,r19 |
635 0624 2093 0000 sts Mittelwert_AccNick,r18 |
636 .L72: |
637 0628 8091 0000 lds r24,messanzahl_AccRoll |
638 062c 8823 tst r24 |
639 062e 01F0 breq .L74 |
640 0630 6091 0000 lds r22,accumulate_AccRoll |
641 0634 7091 0000 lds r23,(accumulate_AccRoll)+1 |
642 0638 2091 0000 lds r18,messanzahl_AccRoll |
643 063c 8827 clr r24 |
644 063e 77FD sbrc r23,7 |
645 0640 8095 com r24 |
646 0642 982F mov r25,r24 |
647 0644 B4E0 ldi r27,4 |
648 0646 660F 1: lsl r22 |
649 0648 771F rol r23 |
650 064a 881F rol r24 |
651 064c 991F rol r25 |
652 064e BA95 dec r27 |
653 0650 01F4 brne 1b |
654 0652 3327 clr r19 |
655 0654 4427 clr r20 |
656 0656 5527 clr r21 |
657 0658 0E94 0000 call __divmodsi4 |
658 065c 3093 0000 sts (Mittelwert_AccRoll)+1,r19 |
659 0660 2093 0000 sts Mittelwert_AccRoll,r18 |
660 .L74: |
661 0664 8091 0000 lds r24,messanzahl_AccHoch |
662 0668 8823 tst r24 |
663 066a 01F0 breq .L76 |
664 066c 6091 0000 lds r22,accumulate_AccHoch |
665 0670 7091 0000 lds r23,(accumulate_AccHoch)+1 |
666 0674 2091 0000 lds r18,messanzahl_AccHoch |
667 0678 8827 clr r24 |
668 067a 77FD sbrc r23,7 |
669 067c 8095 com r24 |
670 067e 982F mov r25,r24 |
671 0680 3327 clr r19 |
672 0682 4427 clr r20 |
673 0684 5527 clr r21 |
674 0686 0E94 0000 call __divmodsi4 |
675 068a 3093 0000 sts (Mittelwert_AccHoch)+1,r19 |
676 068e 2093 0000 sts Mittelwert_AccHoch,r18 |
677 .L76: |
678 0692 1092 0000 sts (AccumulateNick)+1,__zero_reg__ |
679 0696 1092 0000 sts AccumulateNick,__zero_reg__ |
680 069a 1092 0000 sts MessanzahlNick,__zero_reg__ |
681 069e 1092 0000 sts (AccumulateRoll)+1,__zero_reg__ |
682 06a2 1092 0000 sts AccumulateRoll,__zero_reg__ |
683 06a6 1092 0000 sts MessanzahlRoll,__zero_reg__ |
684 06aa 1092 0000 sts (AccumulateGier)+1,__zero_reg__ |
685 06ae 1092 0000 sts AccumulateGier,__zero_reg__ |
686 06b2 1092 0000 sts MessanzahlGier,__zero_reg__ |
687 06b6 1092 0000 sts (accumulate_AccRoll)+1,__zero_reg__ |
688 06ba 1092 0000 sts accumulate_AccRoll,__zero_reg__ |
689 06be 1092 0000 sts messanzahl_AccRoll,__zero_reg__ |
690 06c2 1092 0000 sts (accumulate_AccNick)+1,__zero_reg__ |
691 06c6 1092 0000 sts accumulate_AccNick,__zero_reg__ |
692 06ca 1092 0000 sts messanzahl_AccNick,__zero_reg__ |
693 06ce 1092 0000 sts (accumulate_AccHoch)+1,__zero_reg__ |
694 06d2 1092 0000 sts accumulate_AccHoch,__zero_reg__ |
695 06d6 1092 0000 sts messanzahl_AccHoch,__zero_reg__ |
696 06da 8FEE ldi r24,lo8(-17) |
697 06dc 8093 7A00 sts 122,r24 |
698 06e0 2091 0000 lds r18,Poti1 |
699 06e4 3091 0000 lds r19,(Poti1)+1 |
700 06e8 8091 0000 lds r24,EE_Parameter+4 |
701 06ec E82F mov r30,r24 |
702 06ee FF27 clr r31 |
703 06f0 EE0F lsl r30 |
704 06f2 FF1F rol r31 |
705 06f4 E050 subi r30,lo8(-(PPM_in)) |
706 06f6 F040 sbci r31,hi8(-(PPM_in)) |
707 06f8 8081 ld r24,Z |
708 06fa 9181 ldd r25,Z+1 |
709 06fc 8259 subi r24,lo8(-(110)) |
710 06fe 9F4F sbci r25,hi8(-(110)) |
711 0700 2817 cp r18,r24 |
712 0702 3907 cpc r19,r25 |
713 0704 04F4 brge .L78 |
714 0706 2F5F subi r18,lo8(-(1)) |
715 0708 3F4F sbci r19,hi8(-(1)) |
716 070a 00C0 rjmp .L115 |
717 .L78: |
718 070c 8081 ld r24,Z |
719 070e 9181 ldd r25,Z+1 |
720 0710 8259 subi r24,lo8(-(110)) |
721 0712 9F4F sbci r25,hi8(-(110)) |
722 0714 8217 cp r24,r18 |
723 0716 9307 cpc r25,r19 |
724 0718 04F4 brge .L80 |
725 071a 2115 cp r18,__zero_reg__ |
726 071c 3105 cpc r19,__zero_reg__ |
727 071e 01F0 breq .L80 |
728 0720 2150 subi r18,lo8(-(-1)) |
729 0722 3040 sbci r19,hi8(-(-1)) |
730 .L115: |
731 0724 3093 0000 sts (Poti1)+1,r19 |
732 0728 2093 0000 sts Poti1,r18 |
733 .L80: |
734 072c 2091 0000 lds r18,Poti2 |
735 0730 3091 0000 lds r19,(Poti2)+1 |
736 0734 8091 0000 lds r24,EE_Parameter+5 |
737 0738 E82F mov r30,r24 |
738 073a FF27 clr r31 |
739 073c EE0F lsl r30 |
740 073e FF1F rol r31 |
741 0740 E050 subi r30,lo8(-(PPM_in)) |
742 0742 F040 sbci r31,hi8(-(PPM_in)) |
743 0744 8081 ld r24,Z |
744 0746 9181 ldd r25,Z+1 |
745 0748 8259 subi r24,lo8(-(110)) |
746 074a 9F4F sbci r25,hi8(-(110)) |
747 074c 2817 cp r18,r24 |
748 074e 3907 cpc r19,r25 |
749 0750 04F4 brge .L83 |
750 0752 2F5F subi r18,lo8(-(1)) |
751 0754 3F4F sbci r19,hi8(-(1)) |
752 0756 00C0 rjmp .L116 |
753 .L83: |
754 0758 8081 ld r24,Z |
755 075a 9181 ldd r25,Z+1 |
756 075c 8259 subi r24,lo8(-(110)) |
757 075e 9F4F sbci r25,hi8(-(110)) |
758 0760 8217 cp r24,r18 |
759 0762 9307 cpc r25,r19 |
760 0764 04F4 brge .L85 |
761 0766 2115 cp r18,__zero_reg__ |
762 0768 3105 cpc r19,__zero_reg__ |
763 076a 01F0 breq .L85 |
764 076c 2150 subi r18,lo8(-(-1)) |
765 076e 3040 sbci r19,hi8(-(-1)) |
766 .L116: |
767 0770 3093 0000 sts (Poti2)+1,r19 |
768 0774 2093 0000 sts Poti2,r18 |
769 .L85: |
770 0778 2091 0000 lds r18,Poti3 |
771 077c 3091 0000 lds r19,(Poti3)+1 |
772 0780 8091 0000 lds r24,EE_Parameter+6 |
773 0784 E82F mov r30,r24 |
774 0786 FF27 clr r31 |
775 0788 EE0F lsl r30 |
776 078a FF1F rol r31 |
777 078c E050 subi r30,lo8(-(PPM_in)) |
778 078e F040 sbci r31,hi8(-(PPM_in)) |
779 0790 8081 ld r24,Z |
780 0792 9181 ldd r25,Z+1 |
781 0794 8259 subi r24,lo8(-(110)) |
782 0796 9F4F sbci r25,hi8(-(110)) |
783 0798 2817 cp r18,r24 |
784 079a 3907 cpc r19,r25 |
785 079c 04F4 brge .L88 |
786 079e 2F5F subi r18,lo8(-(1)) |
787 07a0 3F4F sbci r19,hi8(-(1)) |
788 07a2 00C0 rjmp .L117 |
789 .L88: |
790 07a4 8081 ld r24,Z |
791 07a6 9181 ldd r25,Z+1 |
792 07a8 8259 subi r24,lo8(-(110)) |
793 07aa 9F4F sbci r25,hi8(-(110)) |
794 07ac 8217 cp r24,r18 |
795 07ae 9307 cpc r25,r19 |
796 07b0 04F4 brge .L90 |
797 07b2 2115 cp r18,__zero_reg__ |
798 07b4 3105 cpc r19,__zero_reg__ |
799 07b6 01F0 breq .L90 |
800 07b8 2150 subi r18,lo8(-(-1)) |
801 07ba 3040 sbci r19,hi8(-(-1)) |
802 .L117: |
803 07bc 3093 0000 sts (Poti3)+1,r19 |
804 07c0 2093 0000 sts Poti3,r18 |
805 .L90: |
806 07c4 2091 0000 lds r18,Poti4 |
807 07c8 3091 0000 lds r19,(Poti4)+1 |
808 07cc 8091 0000 lds r24,EE_Parameter+7 |
809 07d0 E82F mov r30,r24 |
810 07d2 FF27 clr r31 |
811 07d4 EE0F lsl r30 |
812 07d6 FF1F rol r31 |
813 07d8 E050 subi r30,lo8(-(PPM_in)) |
814 07da F040 sbci r31,hi8(-(PPM_in)) |
815 07dc 8081 ld r24,Z |
816 07de 9181 ldd r25,Z+1 |
817 07e0 8259 subi r24,lo8(-(110)) |
818 07e2 9F4F sbci r25,hi8(-(110)) |
819 07e4 2817 cp r18,r24 |
820 07e6 3907 cpc r19,r25 |
821 07e8 04F4 brge .L93 |
822 07ea 2F5F subi r18,lo8(-(1)) |
823 07ec 3F4F sbci r19,hi8(-(1)) |
824 07ee 00C0 rjmp .L118 |
825 .L93: |
826 07f0 8081 ld r24,Z |
827 07f2 9181 ldd r25,Z+1 |
828 07f4 8259 subi r24,lo8(-(110)) |
829 07f6 9F4F sbci r25,hi8(-(110)) |
830 07f8 8217 cp r24,r18 |
831 07fa 9307 cpc r25,r19 |
832 07fc 04F4 brge .L95 |
833 07fe 2115 cp r18,__zero_reg__ |
834 0800 3105 cpc r19,__zero_reg__ |
835 0802 01F0 breq .L95 |
836 0804 2150 subi r18,lo8(-(-1)) |
837 0806 3040 sbci r19,hi8(-(-1)) |
838 .L118: |
839 0808 3093 0000 sts (Poti4)+1,r19 |
840 080c 2093 0000 sts Poti4,r18 |
841 .L95: |
842 0810 8091 0000 lds r24,Poti1 |
843 0814 9091 0000 lds r25,(Poti1)+1 |
844 0818 97FF sbrs r25,7 |
845 081a 00C0 rjmp .L98 |
846 081c 1092 0000 sts (Poti1)+1,__zero_reg__ |
847 0820 1092 0000 sts Poti1,__zero_reg__ |
848 0824 00C0 rjmp .L100 |
849 .L98: |
850 0826 8F3F cpi r24,255 |
851 0828 9105 cpc r25,__zero_reg__ |
852 082a 01F0 breq .L100 |
853 082c 04F0 brlt .L100 |
854 082e 8FEF ldi r24,lo8(255) |
855 0830 90E0 ldi r25,hi8(255) |
856 0832 9093 0000 sts (Poti1)+1,r25 |
857 0836 8093 0000 sts Poti1,r24 |
858 .L100: |
859 083a 8091 0000 lds r24,Poti2 |
860 083e 9091 0000 lds r25,(Poti2)+1 |
861 0842 97FF sbrs r25,7 |
862 0844 00C0 rjmp .L102 |
863 0846 1092 0000 sts (Poti2)+1,__zero_reg__ |
864 084a 1092 0000 sts Poti2,__zero_reg__ |
865 084e 00C0 rjmp .L104 |
866 .L102: |
867 0850 8F3F cpi r24,255 |
868 0852 9105 cpc r25,__zero_reg__ |
869 0854 01F0 breq .L104 |
870 0856 04F0 brlt .L104 |
871 0858 8FEF ldi r24,lo8(255) |
872 085a 90E0 ldi r25,hi8(255) |
873 085c 9093 0000 sts (Poti2)+1,r25 |
874 0860 8093 0000 sts Poti2,r24 |
875 .L104: |
876 0864 8091 0000 lds r24,Poti3 |
877 0868 9091 0000 lds r25,(Poti3)+1 |
878 086c 97FF sbrs r25,7 |
879 086e 00C0 rjmp .L106 |
880 0870 1092 0000 sts (Poti3)+1,__zero_reg__ |
881 0874 1092 0000 sts Poti3,__zero_reg__ |
882 0878 00C0 rjmp .L108 |
883 .L106: |
884 087a 8F3F cpi r24,255 |
885 087c 9105 cpc r25,__zero_reg__ |
886 087e 01F0 breq .L108 |
887 0880 04F0 brlt .L108 |
888 0882 8FEF ldi r24,lo8(255) |
889 0884 90E0 ldi r25,hi8(255) |
890 0886 9093 0000 sts (Poti3)+1,r25 |
891 088a 8093 0000 sts Poti3,r24 |
892 .L108: |
893 088e 8091 0000 lds r24,Poti4 |
894 0892 9091 0000 lds r25,(Poti4)+1 |
895 0896 97FF sbrs r25,7 |
896 0898 00C0 rjmp .L110 |
897 089a 1092 0000 sts (Poti4)+1,__zero_reg__ |
898 089e 1092 0000 sts Poti4,__zero_reg__ |
899 08a2 0895 ret |
900 .L110: |
901 08a4 8F3F cpi r24,255 |
902 08a6 9105 cpc r25,__zero_reg__ |
903 08a8 01F0 breq .L114 |
904 08aa 04F0 brlt .L114 |
905 08ac 8FEF ldi r24,lo8(255) |
906 08ae 90E0 ldi r25,hi8(255) |
907 08b0 9093 0000 sts (Poti4)+1,r25 |
908 08b4 8093 0000 sts Poti4,r24 |
909 .L114: |
910 08b8 0895 ret |
911 /* epilogue: frame size=0 */ |
912 /* epilogue: noreturn */ |
913 /* epilogue end (size=0) */ |
914 /* function CalibrierMittelwert size 412 (412) */ |
916 .global ParameterZuordnung |
918 ParameterZuordnung: |
919 /* prologue: frame size=0 */ |
920 08ba 1F93 push r17 |
921 /* prologue end (size=1) */ |
922 08bc 8091 0000 lds r24,EE_Parameter+11 |
923 08c0 8B3F cpi r24,lo8(-5) |
924 08c2 00F0 brlo .L120 |
925 08c4 8B3F cpi r24,lo8(-5) |
926 08c6 01F4 brne .L122 |
927 08c8 8091 0000 lds r24,Poti1 |
928 08cc 00C0 rjmp .L120 |
929 .L122: |
930 08ce 8C3F cpi r24,lo8(-4) |
931 08d0 01F4 brne .L125 |
932 08d2 8091 0000 lds r24,Poti2 |
933 08d6 00C0 rjmp .L120 |
934 .L125: |
935 08d8 8D3F cpi r24,lo8(-3) |
936 08da 01F4 brne .L127 |
937 08dc 8091 0000 lds r24,Poti3 |
938 08e0 00C0 rjmp .L120 |
939 .L127: |
940 08e2 8E3F cpi r24,lo8(-2) |
941 08e4 01F4 brne .L124 |
942 08e6 8091 0000 lds r24,Poti4 |
943 .L120: |
944 08ea 8093 0000 sts Parameter_MaxHoehe,r24 |
945 .L124: |
946 08ee 8091 0000 lds r24,Parameter_MaxHoehe |
947 08f2 8823 tst r24 |
948 08f4 01F4 brne .L130 |
949 08f6 1092 0000 sts Parameter_MaxHoehe,__zero_reg__ |
950 08fa 00C0 rjmp .L132 |
951 .L130: |
952 08fc 8F3F cpi r24,lo8(-1) |
953 08fe 01F4 brne .L132 |
954 0900 8093 0000 sts Parameter_MaxHoehe,r24 |
955 .L132: |
956 0904 8091 0000 lds r24,EE_Parameter+10 |
957 0908 8B3F cpi r24,lo8(-5) |
958 090a 00F0 brlo .L134 |
959 090c 8B3F cpi r24,lo8(-5) |
960 090e 01F4 brne .L136 |
961 0910 8091 0000 lds r24,Poti1 |
962 0914 00C0 rjmp .L134 |
963 .L136: |
964 0916 8C3F cpi r24,lo8(-4) |
965 0918 01F4 brne .L139 |
966 091a 8091 0000 lds r24,Poti2 |
967 091e 00C0 rjmp .L134 |
968 .L139: |
969 0920 8D3F cpi r24,lo8(-3) |
970 0922 01F4 brne .L141 |
971 0924 8091 0000 lds r24,Poti3 |
972 0928 00C0 rjmp .L134 |
973 .L141: |
974 092a 8E3F cpi r24,lo8(-2) |
975 092c 01F4 brne .L138 |
976 092e 8091 0000 lds r24,Poti4 |
977 .L134: |
978 0932 8093 0000 sts Parameter_Luftdruck_D,r24 |
979 .L138: |
980 0936 8091 0000 lds r24,Parameter_Luftdruck_D |
981 093a 8823 tst r24 |
982 093c 01F4 brne .L144 |
983 093e 1092 0000 sts Parameter_Luftdruck_D,__zero_reg__ |
984 0942 00C0 rjmp .L146 |
985 .L144: |
986 0944 8436 cpi r24,lo8(100) |
987 0946 00F0 brlo .L146 |
988 0948 84E6 ldi r24,lo8(100) |
989 094a 8093 0000 sts Parameter_Luftdruck_D,r24 |
990 .L146: |
991 094e 8091 0000 lds r24,EE_Parameter+12 |
992 0952 8B3F cpi r24,lo8(-5) |
993 0954 00F0 brlo .L148 |
994 0956 8B3F cpi r24,lo8(-5) |
995 0958 01F4 brne .L150 |
996 095a 8091 0000 lds r24,Poti1 |
997 095e 00C0 rjmp .L148 |
998 .L150: |
999 0960 8C3F cpi r24,lo8(-4) |
1000 0962 01F4 brne .L153 |
1001 0964 8091 0000 lds r24,Poti2 |
1002 0968 00C0 rjmp .L148 |
1003 .L153: |
1004 096a 8D3F cpi r24,lo8(-3) |
1005 096c 01F4 brne .L155 |
1006 096e 8091 0000 lds r24,Poti3 |
1007 0972 00C0 rjmp .L148 |
1008 .L155: |
1009 0974 8E3F cpi r24,lo8(-2) |
1010 0976 01F4 brne .L152 |
1011 0978 8091 0000 lds r24,Poti4 |
1012 .L148: |
1013 097c 8093 0000 sts Parameter_Hoehe_P,r24 |
1014 .L152: |
1015 0980 8091 0000 lds r24,Parameter_Hoehe_P |
1016 0984 8823 tst r24 |
1017 0986 01F4 brne .L158 |
1018 0988 1092 0000 sts Parameter_Hoehe_P,__zero_reg__ |
1019 098c 00C0 rjmp .L160 |
1020 .L158: |
1021 098e 8436 cpi r24,lo8(100) |
1022 0990 00F0 brlo .L160 |
1023 0992 84E6 ldi r24,lo8(100) |
1024 0994 8093 0000 sts Parameter_Hoehe_P,r24 |
1025 .L160: |
1026 0998 8091 0000 lds r24,EE_Parameter+14 |
1027 099c 8B3F cpi r24,lo8(-5) |
1028 099e 00F0 brlo .L162 |
1029 09a0 8B3F cpi r24,lo8(-5) |
1030 09a2 01F4 brne .L164 |
1031 09a4 8091 0000 lds r24,Poti1 |
1032 09a8 00C0 rjmp .L162 |
1033 .L164: |
1034 09aa 8C3F cpi r24,lo8(-4) |
1035 09ac 01F4 brne .L167 |
1036 09ae 8091 0000 lds r24,Poti2 |
1037 09b2 00C0 rjmp .L162 |
1038 .L167: |
1039 09b4 8D3F cpi r24,lo8(-3) |
1040 09b6 01F4 brne .L169 |
1041 09b8 8091 0000 lds r24,Poti3 |
1042 09bc 00C0 rjmp .L162 |
1043 .L169: |
1044 09be 8E3F cpi r24,lo8(-2) |
1045 09c0 01F4 brne .L166 |
1046 09c2 8091 0000 lds r24,Poti4 |
1047 .L162: |
1048 09c6 8093 0000 sts Parameter_Hoehe_ACC_Wirkung,r24 |
1049 .L166: |
1050 09ca 8091 0000 lds r24,Parameter_Hoehe_ACC_Wirkung |
1051 09ce 8823 tst r24 |
1052 09d0 01F4 brne .L172 |
1053 09d2 1092 0000 sts Parameter_Hoehe_ACC_Wirkung,__zero_reg__ |
1054 09d6 00C0 rjmp .L174 |
1055 .L172: |
1056 09d8 8F3F cpi r24,lo8(-1) |
1057 09da 01F4 brne .L174 |
1058 09dc 8093 0000 sts Parameter_Hoehe_ACC_Wirkung,r24 |
1059 .L174: |
1060 09e0 8091 0000 lds r24,EE_Parameter+21 |
1061 09e4 8B3F cpi r24,lo8(-5) |
1062 09e6 00F0 brlo .L176 |
1063 09e8 8B3F cpi r24,lo8(-5) |
1064 09ea 01F4 brne .L178 |
1065 09ec 8091 0000 lds r24,Poti1 |
1066 09f0 00C0 rjmp .L176 |
1067 .L178: |
1068 09f2 8C3F cpi r24,lo8(-4) |
1069 09f4 01F4 brne .L181 |
1070 09f6 8091 0000 lds r24,Poti2 |
1071 09fa 00C0 rjmp .L176 |
1072 .L181: |
1073 09fc 8D3F cpi r24,lo8(-3) |
1074 09fe 01F4 brne .L183 |
1075 0a00 8091 0000 lds r24,Poti3 |
1076 0a04 00C0 rjmp .L176 |
1077 .L183: |
1078 0a06 8E3F cpi r24,lo8(-2) |
1079 0a08 01F4 brne .L180 |
1080 0a0a 8091 0000 lds r24,Poti4 |
1081 .L176: |
1082 0a0e 8093 0000 sts Parameter_KompassWirkung,r24 |
1083 .L180: |
1084 0a12 8091 0000 lds r24,Parameter_KompassWirkung |
1085 0a16 8823 tst r24 |
1086 0a18 01F4 brne .L186 |
1087 0a1a 1092 0000 sts Parameter_KompassWirkung,__zero_reg__ |
1088 0a1e 00C0 rjmp .L188 |
1089 .L186: |
1090 0a20 8F3F cpi r24,lo8(-1) |
1091 0a22 01F4 brne .L188 |
1092 0a24 8093 0000 sts Parameter_KompassWirkung,r24 |
1093 .L188: |
1094 0a28 8091 0000 lds r24,EE_Parameter+22 |
1095 0a2c 8B3F cpi r24,lo8(-5) |
1096 0a2e 00F0 brlo .L190 |
1097 0a30 8B3F cpi r24,lo8(-5) |
1098 0a32 01F4 brne .L192 |
1099 0a34 8091 0000 lds r24,Poti1 |
1100 0a38 00C0 rjmp .L190 |
1101 .L192: |
1102 0a3a 8C3F cpi r24,lo8(-4) |
1103 0a3c 01F4 brne .L195 |
1104 0a3e 8091 0000 lds r24,Poti2 |
1105 0a42 00C0 rjmp .L190 |
1106 .L195: |
1107 0a44 8D3F cpi r24,lo8(-3) |
1108 0a46 01F4 brne .L197 |
1109 0a48 8091 0000 lds r24,Poti3 |
1110 0a4c 00C0 rjmp .L190 |
1111 .L197: |
1112 0a4e 8E3F cpi r24,lo8(-2) |
1113 0a50 01F4 brne .L194 |
1114 0a52 8091 0000 lds r24,Poti4 |
1115 .L190: |
1116 0a56 8093 0000 sts Parameter_Gyro_P,r24 |
1117 .L194: |
1118 0a5a 8091 0000 lds r24,Parameter_Gyro_P |
1119 0a5e 8B30 cpi r24,lo8(11) |
1120 0a60 00F4 brsh .L200 |
1121 0a62 8AE0 ldi r24,lo8(10) |
1122 0a64 00C0 rjmp .L332 |
1123 .L200: |
1124 0a66 8F3F cpi r24,lo8(-1) |
1125 0a68 01F4 brne .L202 |
1126 .L332: |
1127 0a6a 8093 0000 sts Parameter_Gyro_P,r24 |
1128 .L202: |
1129 0a6e 8091 0000 lds r24,EE_Parameter+23 |
1130 0a72 8B3F cpi r24,lo8(-5) |
1131 0a74 00F0 brlo .L204 |
1132 0a76 8B3F cpi r24,lo8(-5) |
1133 0a78 01F4 brne .L206 |
1134 0a7a 8091 0000 lds r24,Poti1 |
1135 0a7e 00C0 rjmp .L204 |
1136 .L206: |
1137 0a80 8C3F cpi r24,lo8(-4) |
1138 0a82 01F4 brne .L209 |
1139 0a84 8091 0000 lds r24,Poti2 |
1140 0a88 00C0 rjmp .L204 |
1141 .L209: |
1142 0a8a 8D3F cpi r24,lo8(-3) |
1143 0a8c 01F4 brne .L211 |
1144 0a8e 8091 0000 lds r24,Poti3 |
1145 0a92 00C0 rjmp .L204 |
1146 .L211: |
1147 0a94 8E3F cpi r24,lo8(-2) |
1148 0a96 01F4 brne .L208 |
1149 0a98 8091 0000 lds r24,Poti4 |
1150 .L204: |
1151 0a9c 8093 0000 sts Parameter_Gyro_I,r24 |
1152 .L208: |
1153 0aa0 8091 0000 lds r24,Parameter_Gyro_I |
1154 0aa4 8823 tst r24 |
1155 0aa6 01F4 brne .L214 |
1156 0aa8 1092 0000 sts Parameter_Gyro_I,__zero_reg__ |
1157 0aac 00C0 rjmp .L216 |
1158 .L214: |
1159 0aae 8F3F cpi r24,lo8(-1) |
1160 0ab0 01F4 brne .L216 |
1161 0ab2 8093 0000 sts Parameter_Gyro_I,r24 |
1162 .L216: |
1163 0ab6 8091 0000 lds r24,EE_Parameter+28 |
1164 0aba 8B3F cpi r24,lo8(-5) |
1165 0abc 00F0 brlo .L218 |
1166 0abe 8B3F cpi r24,lo8(-5) |
1167 0ac0 01F4 brne .L220 |
1168 0ac2 8091 0000 lds r24,Poti1 |
1169 0ac6 00C0 rjmp .L218 |
1170 .L220: |
1171 0ac8 8C3F cpi r24,lo8(-4) |
1172 0aca 01F4 brne .L223 |
1173 0acc 8091 0000 lds r24,Poti2 |
1174 0ad0 00C0 rjmp .L218 |
1175 .L223: |
1176 0ad2 8D3F cpi r24,lo8(-3) |
1177 0ad4 01F4 brne .L225 |
1178 0ad6 8091 0000 lds r24,Poti3 |
1179 0ada 00C0 rjmp .L218 |
1180 .L225: |
1181 0adc 8E3F cpi r24,lo8(-2) |
1182 0ade 01F4 brne .L222 |
1183 0ae0 8091 0000 lds r24,Poti4 |
1184 .L218: |
1185 0ae4 8093 0000 sts Parameter_I_Faktor,r24 |
1186 .L222: |
1187 0ae8 8091 0000 lds r24,Parameter_I_Faktor |
1188 0aec 8823 tst r24 |
1189 0aee 01F4 brne .L228 |
1190 0af0 1092 0000 sts Parameter_I_Faktor,__zero_reg__ |
1191 0af4 00C0 rjmp .L230 |
1192 .L228: |
1193 0af6 8F3F cpi r24,lo8(-1) |
1194 0af8 01F4 brne .L230 |
1195 0afa 8093 0000 sts Parameter_I_Faktor,r24 |
1196 .L230: |
1197 0afe 8091 0000 lds r24,EE_Parameter+29 |
1198 0b02 8B3F cpi r24,lo8(-5) |
1199 0b04 00F0 brlo .L232 |
1200 0b06 8B3F cpi r24,lo8(-5) |
1201 0b08 01F4 brne .L234 |
1202 0b0a 8091 0000 lds r24,Poti1 |
1203 0b0e 00C0 rjmp .L232 |
1204 .L234: |
1205 0b10 8C3F cpi r24,lo8(-4) |
1206 0b12 01F4 brne .L237 |
1207 0b14 8091 0000 lds r24,Poti2 |
1208 0b18 00C0 rjmp .L232 |
1209 .L237: |
1210 0b1a 8D3F cpi r24,lo8(-3) |
1211 0b1c 01F4 brne .L239 |
1212 0b1e 8091 0000 lds r24,Poti3 |
1213 0b22 00C0 rjmp .L232 |
1214 .L239: |
1215 0b24 8E3F cpi r24,lo8(-2) |
1216 0b26 01F4 brne .L236 |
1217 0b28 8091 0000 lds r24,Poti4 |
1218 .L232: |
1219 0b2c 8093 0000 sts Parameter_UserParam1,r24 |
1220 .L236: |
1221 0b30 8091 0000 lds r24,Parameter_UserParam1 |
1222 0b34 8823 tst r24 |
1223 0b36 01F4 brne .L242 |
1224 0b38 1092 0000 sts Parameter_UserParam1,__zero_reg__ |
1225 0b3c 00C0 rjmp .L244 |
1226 .L242: |
1227 0b3e 8F3F cpi r24,lo8(-1) |
1228 0b40 01F4 brne .L244 |
1229 0b42 8093 0000 sts Parameter_UserParam1,r24 |
1230 .L244: |
1231 0b46 8091 0000 lds r24,EE_Parameter+30 |
1232 0b4a 8B3F cpi r24,lo8(-5) |
1233 0b4c 00F0 brlo .L246 |
1234 0b4e 8B3F cpi r24,lo8(-5) |
1235 0b50 01F4 brne .L248 |
1236 0b52 8091 0000 lds r24,Poti1 |
1237 0b56 00C0 rjmp .L246 |
1238 .L248: |
1239 0b58 8C3F cpi r24,lo8(-4) |
1240 0b5a 01F4 brne .L251 |
1241 0b5c 8091 0000 lds r24,Poti2 |
1242 0b60 00C0 rjmp .L246 |
1243 .L251: |
1244 0b62 8D3F cpi r24,lo8(-3) |
1245 0b64 01F4 brne .L253 |
1246 0b66 8091 0000 lds r24,Poti3 |
1247 0b6a 00C0 rjmp .L246 |
1248 .L253: |
1249 0b6c 8E3F cpi r24,lo8(-2) |
1250 0b6e 01F4 brne .L250 |
1251 0b70 8091 0000 lds r24,Poti4 |
1252 .L246: |
1253 0b74 8093 0000 sts Parameter_UserParam2,r24 |
1254 .L250: |
1255 0b78 8091 0000 lds r24,Parameter_UserParam2 |
1256 0b7c 8823 tst r24 |
1257 0b7e 01F4 brne .L256 |
1258 0b80 1092 0000 sts Parameter_UserParam2,__zero_reg__ |
1259 0b84 00C0 rjmp .L258 |
1260 .L256: |
1261 0b86 8F3F cpi r24,lo8(-1) |
1262 0b88 01F4 brne .L258 |
1263 0b8a 8093 0000 sts Parameter_UserParam2,r24 |
1264 .L258: |
1265 0b8e 8091 0000 lds r24,EE_Parameter+31 |
1266 0b92 8B3F cpi r24,lo8(-5) |
1267 0b94 00F0 brlo .L260 |
1268 0b96 8B3F cpi r24,lo8(-5) |
1269 0b98 01F4 brne .L262 |
1270 0b9a 8091 0000 lds r24,Poti1 |
1271 0b9e 00C0 rjmp .L260 |
1272 .L262: |
1273 0ba0 8C3F cpi r24,lo8(-4) |
1274 0ba2 01F4 brne .L265 |
1275 0ba4 8091 0000 lds r24,Poti2 |
1276 0ba8 00C0 rjmp .L260 |
1277 .L265: |
1278 0baa 8D3F cpi r24,lo8(-3) |
1279 0bac 01F4 brne .L267 |
1280 0bae 8091 0000 lds r24,Poti3 |
1281 0bb2 00C0 rjmp .L260 |
1282 .L267: |
1283 0bb4 8E3F cpi r24,lo8(-2) |
1284 0bb6 01F4 brne .L264 |
1285 0bb8 8091 0000 lds r24,Poti4 |
1286 .L260: |
1287 0bbc 8093 0000 sts Parameter_UserParam3,r24 |
1288 .L264: |
1289 0bc0 8091 0000 lds r24,Parameter_UserParam3 |
1290 0bc4 8823 tst r24 |
1291 0bc6 01F4 brne .L270 |
1292 0bc8 1092 0000 sts Parameter_UserParam3,__zero_reg__ |
1293 0bcc 00C0 rjmp .L272 |
1294 .L270: |
1295 0bce 8F3F cpi r24,lo8(-1) |
1296 0bd0 01F4 brne .L272 |
1297 0bd2 8093 0000 sts Parameter_UserParam3,r24 |
1298 .L272: |
1299 0bd6 8091 0000 lds r24,EE_Parameter+32 |
1300 0bda 8B3F cpi r24,lo8(-5) |
1301 0bdc 00F0 brlo .L274 |
1302 0bde 8B3F cpi r24,lo8(-5) |
1303 0be0 01F4 brne .L276 |
1304 0be2 8091 0000 lds r24,Poti1 |
1305 0be6 00C0 rjmp .L274 |
1306 .L276: |
1307 0be8 8C3F cpi r24,lo8(-4) |
1308 0bea 01F4 brne .L279 |
1309 0bec 8091 0000 lds r24,Poti2 |
1310 0bf0 00C0 rjmp .L274 |
1311 .L279: |
1312 0bf2 8D3F cpi r24,lo8(-3) |
1313 0bf4 01F4 brne .L281 |
1314 0bf6 8091 0000 lds r24,Poti3 |
1315 0bfa 00C0 rjmp .L274 |
1316 .L281: |
1317 0bfc 8E3F cpi r24,lo8(-2) |
1318 0bfe 01F4 brne .L278 |
1319 0c00 8091 0000 lds r24,Poti4 |
1320 .L274: |
1321 0c04 8093 0000 sts Parameter_UserParam4,r24 |
1322 .L278: |
1323 0c08 8091 0000 lds r24,Parameter_UserParam4 |
1324 0c0c 8823 tst r24 |
1325 0c0e 01F4 brne .L284 |
1326 0c10 1092 0000 sts Parameter_UserParam4,__zero_reg__ |
1327 0c14 00C0 rjmp .L286 |
1328 .L284: |
1329 0c16 8F3F cpi r24,lo8(-1) |
1330 0c18 01F4 brne .L286 |
1331 0c1a 8093 0000 sts Parameter_UserParam4,r24 |
1332 .L286: |
1333 0c1e 9091 0000 lds r25,EE_Parameter+33 |
1334 0c22 9B3F cpi r25,lo8(-5) |
1335 0c24 00F0 brlo .L288 |
1336 0c26 9B3F cpi r25,lo8(-5) |
1337 0c28 01F4 brne .L290 |
1338 0c2a 8091 0000 lds r24,Poti1 |
1339 0c2e 00C0 rjmp .L333 |
1340 .L290: |
1341 0c30 9C3F cpi r25,lo8(-4) |
1342 0c32 01F4 brne .L293 |
1343 0c34 8091 0000 lds r24,Poti2 |
1344 .L333: |
1345 0c38 8093 0000 sts Parameter_ServoNickControl,r24 |
1346 0c3c 00C0 rjmp .L292 |
1347 .L293: |
1348 0c3e 9D3F cpi r25,lo8(-3) |
1349 0c40 01F4 brne .L295 |
1350 0c42 8091 0000 lds r24,Poti3 |
1351 0c46 00C0 rjmp .L333 |
1352 .L295: |
1353 0c48 9E3F cpi r25,lo8(-2) |
1354 0c4a 01F4 brne .L292 |
1355 0c4c 8091 0000 lds r24,Poti4 |
1356 0c50 00C0 rjmp .L333 |
1357 .L288: |
1358 0c52 9093 0000 sts Parameter_ServoNickControl,r25 |
1359 .L292: |
1360 0c56 8091 0000 lds r24,Parameter_ServoNickControl |
1361 0c5a 8823 tst r24 |
1362 0c5c 01F4 brne .L298 |
1363 0c5e 1092 0000 sts Parameter_ServoNickControl,__zero_reg__ |
1364 0c62 00C0 rjmp .L300 |
1365 .L298: |
1366 0c64 8F3F cpi r24,lo8(-1) |
1367 0c66 01F4 brne .L300 |
1368 0c68 8093 0000 sts Parameter_ServoNickControl,r24 |
1369 .L300: |
1370 0c6c 9B3F cpi r25,lo8(-5) |
1371 0c6e 00F0 brlo .L302 |
1372 0c70 9B3F cpi r25,lo8(-5) |
1373 0c72 01F4 brne .L304 |
1374 0c74 8091 0000 lds r24,Poti1 |
1375 0c78 00C0 rjmp .L334 |
1376 .L304: |
1377 0c7a 9C3F cpi r25,lo8(-4) |
1378 0c7c 01F4 brne .L307 |
1379 0c7e 8091 0000 lds r24,Poti2 |
1380 .L334: |
1381 0c82 8093 0000 sts Parameter_ServoNickControl,r24 |
1382 0c86 00C0 rjmp .L306 |
1383 .L307: |
1384 0c88 9D3F cpi r25,lo8(-3) |
1385 0c8a 01F4 brne .L309 |
1386 0c8c 8091 0000 lds r24,Poti3 |
1387 0c90 00C0 rjmp .L334 |
1388 .L309: |
1389 0c92 9E3F cpi r25,lo8(-2) |
1390 0c94 01F4 brne .L306 |
1391 0c96 8091 0000 lds r24,Poti4 |
1392 0c9a 00C0 rjmp .L334 |
1393 .L302: |
1394 0c9c 9093 0000 sts Parameter_ServoNickControl,r25 |
1395 .L306: |
1396 0ca0 8091 0000 lds r24,Parameter_ServoNickControl |
1397 0ca4 8823 tst r24 |
1398 0ca6 01F4 brne .L312 |
1399 0ca8 1092 0000 sts Parameter_ServoNickControl,__zero_reg__ |
1400 0cac 00C0 rjmp .L314 |
1401 .L312: |
1402 0cae 8F3F cpi r24,lo8(-1) |
1403 0cb0 01F4 brne .L314 |
1404 0cb2 8093 0000 sts Parameter_ServoNickControl,r24 |
1405 .L314: |
1406 0cb6 9B3F cpi r25,lo8(-5) |
1407 0cb8 00F0 brlo .L316 |
1408 0cba 9B3F cpi r25,lo8(-5) |
1409 0cbc 01F4 brne .L318 |
1410 0cbe 8091 0000 lds r24,Poti1 |
1411 0cc2 00C0 rjmp .L335 |
1412 .L318: |
1413 0cc4 9C3F cpi r25,lo8(-4) |
1414 0cc6 01F4 brne .L321 |
1415 0cc8 8091 0000 lds r24,Poti2 |
1416 .L335: |
1417 0ccc 8093 0000 sts Parameter_ServoNickControl,r24 |
1418 0cd0 00C0 rjmp .L320 |
1419 .L321: |
1420 0cd2 9D3F cpi r25,lo8(-3) |
1421 0cd4 01F4 brne .L323 |
1422 0cd6 8091 0000 lds r24,Poti3 |
1423 0cda 00C0 rjmp .L335 |
1424 .L323: |
1425 0cdc 9E3F cpi r25,lo8(-2) |
1426 0cde 01F4 brne .L320 |
1427 0ce0 8091 0000 lds r24,Poti4 |
1428 0ce4 00C0 rjmp .L335 |
1429 .L316: |
1430 0ce6 9093 0000 sts Parameter_ServoNickControl,r25 |
1431 .L320: |
1432 0cea 8091 0000 lds r24,Parameter_ServoNickControl |
1433 0cee 8823 tst r24 |
1434 0cf0 01F4 brne .L326 |
1435 0cf2 1092 0000 sts Parameter_ServoNickControl,__zero_reg__ |
1436 0cf6 00C0 rjmp .L328 |
1437 .L326: |
1438 0cf8 8F3F cpi r24,lo8(-1) |
1439 0cfa 01F4 brne .L328 |
1440 0cfc 8093 0000 sts Parameter_ServoNickControl,r24 |
1441 .L328: |
1442 0d00 1091 0000 lds r17,Parameter_I_Faktor |
1443 0d04 612F mov r22,r17 |
1444 0d06 7727 clr r23 |
1445 0d08 67FD sbrc r22,7 |
1446 0d0a 7095 com r23 |
1447 0d0c 872F mov r24,r23 |
1448 0d0e 972F mov r25,r23 |
1449 0d10 0E94 0000 call __floatsisf |
1450 0d14 17FF sbrs r17,7 |
1451 0d16 00C0 rjmp .L330 |
1452 0d18 20E0 ldi r18,lo8(0x43800000) |
1453 0d1a 30E0 ldi r19,hi8(0x43800000) |
1454 0d1c 40E8 ldi r20,hlo8(0x43800000) |
1455 0d1e 53E4 ldi r21,hhi8(0x43800000) |
1456 0d20 0E94 0000 call __addsf3 |
1457 .L330: |
1458 0d24 27E1 ldi r18,lo8(0x38d1b717) |
1459 0d26 37EB ldi r19,hi8(0x38d1b717) |
1460 0d28 41ED ldi r20,hlo8(0x38d1b717) |
1461 0d2a 58E3 ldi r21,hhi8(0x38d1b717) |
1462 0d2c 0E94 0000 call __mulsf3 |
1463 0d30 6093 0000 sts Ki,r22 |
1464 0d34 7093 0000 sts (Ki)+1,r23 |
1465 0d38 8093 0000 sts (Ki)+2,r24 |
1466 0d3c 9093 0000 sts (Ki)+3,r25 |
1467 0d40 8091 0000 lds r24,EE_Parameter+19 |
1468 0d44 8093 0000 sts MAX_GAS,r24 |
1469 0d48 8091 0000 lds r24,EE_Parameter+18 |
1470 0d4c 8093 0000 sts MIN_GAS,r24 |
1471 /* epilogue: frame size=0 */ |
1472 0d50 1F91 pop r17 |
1473 0d52 0895 ret |
1474 /* epilogue end (size=2) */ |
1475 /* function ParameterZuordnung size 589 (586) */ |
1477 .data |
1478 .LC0: |
1479 0000 4B61 6D65 .string "Kamera" |
1479 7261 00 |
1480 0007 00 .string "" |
1481 .text |
1482 .global DefaultKonstanten2 |
1484 DefaultKonstanten2: |
1485 /* prologue: frame size=0 */ |
1486 /* prologue end (size=0) */ |
1487 0d54 81E0 ldi r24,lo8(1) |
1488 0d56 8093 0000 sts EE_Parameter,r24 |
1489 0d5a 42E0 ldi r20,lo8(2) |
1490 0d5c 4093 0000 sts EE_Parameter+1,r20 |
1491 0d60 83E0 ldi r24,lo8(3) |
1492 0d62 8093 0000 sts EE_Parameter+2,r24 |
1493 0d66 24E0 ldi r18,lo8(4) |
1494 0d68 2093 0000 sts EE_Parameter+3,r18 |
1495 0d6c 35E0 ldi r19,lo8(5) |
1496 0d6e 3093 0000 sts EE_Parameter+4,r19 |
1497 0d72 86E0 ldi r24,lo8(6) |
1498 0d74 8093 0000 sts EE_Parameter+5,r24 |
1499 0d78 87E0 ldi r24,lo8(7) |
1500 0d7a 8093 0000 sts EE_Parameter+6,r24 |
1501 0d7e 1092 0000 sts EE_Parameter+8,__zero_reg__ |
1502 0d82 8EE1 ldi r24,lo8(30) |
1503 0d84 8093 0000 sts EE_Parameter+9,r24 |
1504 0d88 8BEF ldi r24,lo8(-5) |
1505 0d8a 8093 0000 sts EE_Parameter+11,r24 |
1506 0d8e 8AE0 ldi r24,lo8(10) |
1507 0d90 8093 0000 sts EE_Parameter+12,r24 |
1508 0d94 92E3 ldi r25,lo8(50) |
1509 0d96 9093 0000 sts EE_Parameter+10,r25 |
1510 0d9a 9093 0000 sts EE_Parameter+14,r25 |
1511 0d9e 4093 0000 sts EE_Parameter+13,r20 |
1512 0da2 2093 0000 sts EE_Parameter+15,r18 |
1513 0da6 1092 0000 sts EE_Parameter+16,__zero_reg__ |
1514 0daa 80E1 ldi r24,lo8(16) |
1515 0dac 8093 0000 sts EE_Parameter+17,r24 |
1516 0db0 8FE0 ldi r24,lo8(15) |
1517 0db2 8093 0000 sts EE_Parameter+18,r24 |
1518 0db6 8AEF ldi r24,lo8(-6) |
1519 0db8 8093 0000 sts EE_Parameter+19,r24 |
1520 0dbc 8AE1 ldi r24,lo8(26) |
1521 0dbe 8093 0000 sts EE_Parameter+20,r24 |
1522 0dc2 80E8 ldi r24,lo8(-128) |
1523 0dc4 8093 0000 sts EE_Parameter+21,r24 |
1524 0dc8 8FEA ldi r24,lo8(-81) |
1525 0dca 8093 0000 sts EE_Parameter+22,r24 |
1526 0dce 8093 0000 sts EE_Parameter+23,r24 |
1527 0dd2 8AE5 ldi r24,lo8(90) |
1528 0dd4 8093 0000 sts EE_Parameter+24,r24 |
1529 0dd8 83E2 ldi r24,lo8(35) |
1530 0dda 8093 0000 sts EE_Parameter+25,r24 |
1531 0dde 84E1 ldi r24,lo8(20) |
1532 0de0 8093 0000 sts EE_Parameter+26,r24 |
1533 0de4 1092 0000 sts EE_Parameter+27,__zero_reg__ |
1534 0de8 3093 0000 sts EE_Parameter+28,r19 |
1535 0dec 1092 0000 sts EE_Parameter+29,__zero_reg__ |
1536 0df0 1092 0000 sts EE_Parameter+30,__zero_reg__ |
1537 0df4 1092 0000 sts EE_Parameter+31,__zero_reg__ |
1538 0df8 1092 0000 sts EE_Parameter+32,__zero_reg__ |
1539 0dfc 84E6 ldi r24,lo8(100) |
1540 0dfe 8093 0000 sts EE_Parameter+33,r24 |
1541 0e02 88E2 ldi r24,lo8(40) |
1542 0e04 8093 0000 sts EE_Parameter+34,r24 |
1543 0e08 1092 0000 sts EE_Parameter+38,__zero_reg__ |
1544 0e0c 9093 0000 sts EE_Parameter+35,r25 |
1545 0e10 86E9 ldi r24,lo8(-106) |
1546 0e12 8093 0000 sts EE_Parameter+36,r24 |
1547 0e16 3093 0000 sts EE_Parameter+37,r19 |
1548 0e1a A0E0 ldi r26,lo8(EE_Parameter+46) |
1549 0e1c B0E0 ldi r27,hi8(EE_Parameter+46) |
1550 0e1e E0E0 ldi r30,lo8(.LC0) |
1551 0e20 F0E0 ldi r31,hi8(.LC0) |
1552 0e22 8CE0 ldi r24,lo8(12) |
1553 .L337: |
1554 0e24 0190 ld r0,Z+ |
1555 0e26 0D92 st X+,r0 |
1556 0e28 8150 subi r24,lo8(-(-1)) |
1557 0e2a 01F4 brne .L337 |
1558 /* epilogue: frame size=0 */ |
1559 0e2c 0895 ret |
1560 /* epilogue end (size=1) */ |
1561 /* function DefaultKonstanten2 size 110 (109) */ |
1563 .data |
1564 .LC1: |
1565 0008 4E6F 726D .string "Normal" |
1565 616C 00 |
1566 000f 00 .string "" |
1567 .text |
1568 .global DefaultKonstanten1 |
1570 DefaultKonstanten1: |
1571 /* prologue: frame size=0 */ |
1572 /* prologue end (size=0) */ |
1573 0e2e 81E0 ldi r24,lo8(1) |
1574 0e30 8093 0000 sts EE_Parameter,r24 |
1575 0e34 52E0 ldi r21,lo8(2) |
1576 0e36 5093 0000 sts EE_Parameter+1,r21 |
1577 0e3a 83E0 ldi r24,lo8(3) |
1578 0e3c 8093 0000 sts EE_Parameter+2,r24 |
1579 0e40 44E0 ldi r20,lo8(4) |
1580 0e42 4093 0000 sts EE_Parameter+3,r20 |
1581 0e46 35E0 ldi r19,lo8(5) |
1582 0e48 3093 0000 sts EE_Parameter+4,r19 |
1583 0e4c 86E0 ldi r24,lo8(6) |
1584 0e4e 8093 0000 sts EE_Parameter+5,r24 |
1585 0e52 87E0 ldi r24,lo8(7) |
1586 0e54 8093 0000 sts EE_Parameter+6,r24 |
1587 0e58 28E0 ldi r18,lo8(8) |
1588 0e5a 2093 0000 sts EE_Parameter+7,r18 |
1589 0e5e 1092 0000 sts EE_Parameter+8,__zero_reg__ |
1590 0e62 9EE1 ldi r25,lo8(30) |
1591 0e64 9093 0000 sts EE_Parameter+9,r25 |
1592 0e68 8BEF ldi r24,lo8(-5) |
1593 0e6a 8093 0000 sts EE_Parameter+11,r24 |
1594 0e6e 8AE0 ldi r24,lo8(10) |
1595 0e70 8093 0000 sts EE_Parameter+12,r24 |
1596 0e74 86E4 ldi r24,lo8(70) |
1597 0e76 8093 0000 sts EE_Parameter+10,r24 |
1598 0e7a 9093 0000 sts EE_Parameter+14,r25 |
1599 0e7e 5093 0000 sts EE_Parameter+13,r21 |
1600 0e82 4093 0000 sts EE_Parameter+15,r20 |
1601 0e86 2093 0000 sts EE_Parameter+16,r18 |
1602 0e8a 80E1 ldi r24,lo8(16) |
1603 0e8c 8093 0000 sts EE_Parameter+17,r24 |
1604 0e90 8FE0 ldi r24,lo8(15) |
1605 0e92 8093 0000 sts EE_Parameter+18,r24 |
1606 0e96 8AEF ldi r24,lo8(-6) |
1607 0e98 8093 0000 sts EE_Parameter+19,r24 |
1608 0e9c 8AE1 ldi r24,lo8(26) |
1609 0e9e 8093 0000 sts EE_Parameter+20,r24 |
1610 0ea2 80E8 ldi r24,lo8(-128) |
1611 0ea4 8093 0000 sts EE_Parameter+21,r24 |
1612 0ea8 88E7 ldi r24,lo8(120) |
1613 0eaa 8093 0000 sts EE_Parameter+22,r24 |
1614 0eae 96E9 ldi r25,lo8(-106) |
1615 0eb0 9093 0000 sts EE_Parameter+23,r25 |
1616 0eb4 8AE5 ldi r24,lo8(90) |
1617 0eb6 8093 0000 sts EE_Parameter+24,r24 |
1618 0eba 83E2 ldi r24,lo8(35) |
1619 0ebc 8093 0000 sts EE_Parameter+25,r24 |
1620 0ec0 84E1 ldi r24,lo8(20) |
1621 0ec2 8093 0000 sts EE_Parameter+26,r24 |
1622 0ec6 1092 0000 sts EE_Parameter+27,__zero_reg__ |
1623 0eca 3093 0000 sts EE_Parameter+28,r19 |
1624 0ece 1092 0000 sts EE_Parameter+29,__zero_reg__ |
1625 0ed2 1092 0000 sts EE_Parameter+30,__zero_reg__ |
1626 0ed6 1092 0000 sts EE_Parameter+31,__zero_reg__ |
1627 0eda 1092 0000 sts EE_Parameter+32,__zero_reg__ |
1628 0ede 84E6 ldi r24,lo8(100) |
1629 0ee0 8093 0000 sts EE_Parameter+33,r24 |
1630 0ee4 88E2 ldi r24,lo8(40) |
1631 0ee6 8093 0000 sts EE_Parameter+34,r24 |
1632 0eea 1092 0000 sts EE_Parameter+38,__zero_reg__ |
1633 0eee 82E3 ldi r24,lo8(50) |
1634 0ef0 8093 0000 sts EE_Parameter+35,r24 |
1635 0ef4 9093 0000 sts EE_Parameter+36,r25 |
1636 0ef8 3093 0000 sts EE_Parameter+37,r19 |
1637 0efc A0E0 ldi r26,lo8(EE_Parameter+46) |
1638 0efe B0E0 ldi r27,hi8(EE_Parameter+46) |
1639 0f00 E0E0 ldi r30,lo8(.LC1) |
1640 0f02 F0E0 ldi r31,hi8(.LC1) |
1641 0f04 8CE0 ldi r24,lo8(12) |
1642 .L342: |
1643 0f06 0190 ld r0,Z+ |
1644 0f08 0D92 st X+,r0 |
1645 0f0a 8150 subi r24,lo8(-(-1)) |
1646 0f0c 01F4 brne .L342 |
1647 /* epilogue: frame size=0 */ |
1648 0f0e 0895 ret |
1649 /* epilogue end (size=1) */ |
1650 /* function DefaultKonstanten1 size 114 (113) */ |
1652 .global SendMotorData |
1654 SendMotorData: |
1655 /* prologue: frame size=0 */ |
1656 /* prologue end (size=0) */ |
1657 0f10 8091 0000 lds r24,MotorenEin |
1658 0f14 8823 tst r24 |
1659 0f16 01F4 brne .L347 |
1660 0f18 1092 0000 sts Motor_Hinten,__zero_reg__ |
1661 0f1c 1092 0000 sts Motor_Vorne,__zero_reg__ |
1662 0f20 1092 0000 sts Motor_Rechts,__zero_reg__ |
1663 0f24 1092 0000 sts Motor_Links,__zero_reg__ |
1664 0f28 8091 0000 lds r24,MotorTest |
1665 0f2c 8823 tst r24 |
1666 0f2e 01F0 breq .L349 |
1667 0f30 8093 0000 sts Motor_Vorne,r24 |
1668 .L349: |
1669 0f34 8091 0000 lds r24,MotorTest+1 |
1670 0f38 8823 tst r24 |
1671 0f3a 01F0 breq .L351 |
1672 0f3c 8093 0000 sts Motor_Hinten,r24 |
1673 .L351: |
1674 0f40 8091 0000 lds r24,MotorTest+2 |
1675 0f44 8823 tst r24 |
1676 0f46 01F0 breq .L353 |
1677 0f48 8093 0000 sts Motor_Links,r24 |
1678 .L353: |
1679 0f4c 8091 0000 lds r24,MotorTest+3 |
1680 0f50 8823 tst r24 |
1681 0f52 01F0 breq .L347 |
1682 0f54 8093 0000 sts Motor_Rechts,r24 |
1683 .L347: |
1684 0f58 8091 0000 lds r24,Motor_Vorne |
1685 0f5c 9927 clr r25 |
1686 0f5e 9093 0000 sts (DebugOut+42)+1,r25 |
1687 0f62 8093 0000 sts DebugOut+42,r24 |
1688 0f66 8091 0000 lds r24,Motor_Hinten |
1689 0f6a 9927 clr r25 |
1690 0f6c 9093 0000 sts (DebugOut+44)+1,r25 |
1691 0f70 8093 0000 sts DebugOut+44,r24 |
1692 0f74 8091 0000 lds r24,Motor_Links |
1693 0f78 9927 clr r25 |
1694 0f7a 9093 0000 sts (DebugOut+46)+1,r25 |
1695 0f7e 8093 0000 sts DebugOut+46,r24 |
1696 0f82 8091 0000 lds r24,Motor_Rechts |
1697 0f86 9927 clr r25 |
1698 0f88 9093 0000 sts (DebugOut+48)+1,r25 |
1699 0f8c 8093 0000 sts DebugOut+48,r24 |
1700 0f90 1092 0000 sts twi_state,__zero_reg__ |
1701 0f94 1092 0000 sts motor,__zero_reg__ |
1702 0f98 0E94 0000 call i2c_start |
1703 /* epilogue: frame size=0 */ |
1704 0f9c 0895 ret |
1705 /* epilogue end (size=1) */ |
1706 /* function SendMotorData size 71 (70) */ |
1708 .global SetNeutral |
1710 SetNeutral: |
1711 /* prologue: frame size=0 */ |
1712 0f9e CF93 push r28 |
1713 0fa0 DF93 push r29 |
1714 /* prologue end (size=2) */ |
1715 0fa2 1092 0000 sts (NeutralAccX)+1,__zero_reg__ |
1716 0fa6 1092 0000 sts NeutralAccX,__zero_reg__ |
1717 0faa 1092 0000 sts (NeutralAccY)+1,__zero_reg__ |
1718 0fae 1092 0000 sts NeutralAccY,__zero_reg__ |
1719 0fb2 80E0 ldi r24,lo8(0x0) |
1720 0fb4 90E0 ldi r25,hi8(0x0) |
1721 0fb6 A0E0 ldi r26,hlo8(0x0) |
1722 0fb8 B0E0 ldi r27,hhi8(0x0) |
1723 0fba 8093 0000 sts NeutralAccZ,r24 |
1724 0fbe 9093 0000 sts (NeutralAccZ)+1,r25 |
1725 0fc2 A093 0000 sts (NeutralAccZ)+2,r26 |
1726 0fc6 B093 0000 sts (NeutralAccZ)+3,r27 |
1727 0fca 1092 0000 sts (AdNeutralNick)+1,__zero_reg__ |
1728 0fce 1092 0000 sts AdNeutralNick,__zero_reg__ |
1729 0fd2 1092 0000 sts (AdNeutralRoll)+1,__zero_reg__ |
1730 0fd6 1092 0000 sts AdNeutralRoll,__zero_reg__ |
1731 0fda 1092 0000 sts (AdNeutralGier)+1,__zero_reg__ |
1732 0fde 1092 0000 sts AdNeutralGier,__zero_reg__ |
1733 0fe2 0E94 0000 call CalibrierMittelwert |
1734 0fe6 85E0 ldi r24,lo8(5) |
1735 0fe8 90E0 ldi r25,hi8(5) |
1736 0fea 0E94 0000 call SetDelay |
1737 0fee EC01 movw r28,r24 |
1738 .L358: |
1739 0ff0 CE01 movw r24,r28 |
1740 0ff2 0E94 0000 call CheckDelay |
1741 0ff6 8823 tst r24 |
1742 0ff8 01F0 breq .L358 |
1743 0ffa 0E94 0000 call CalibrierMittelwert |
1744 0ffe 8091 0000 lds r24,EE_Parameter+8 |
1745 1002 80FF sbrs r24,0 |
1746 1004 00C0 rjmp .L360 |
1747 1006 8091 0000 lds r24,MessLuftdruck |
1748 100a 9091 0000 lds r25,(MessLuftdruck)+1 |
1749 100e 875B subi r24,lo8(951) |
1750 1010 9340 sbci r25,hi8(951) |
1751 1012 00F4 brsh .L362 |
1752 1014 8091 0000 lds r24,MessLuftdruck |
1753 1018 9091 0000 lds r25,(MessLuftdruck)+1 |
1754 101c 8E5E subi r24,lo8(750) |
1755 101e 9240 sbci r25,hi8(750) |
1756 1020 00F4 brsh .L360 |
1757 .L362: |
1758 1022 0E94 0000 call SucheLuftruckOffset |
1759 .L360: |
1760 1026 8091 0000 lds r24,MesswertNick |
1761 102a 9091 0000 lds r25,(MesswertNick)+1 |
1762 102e 97FF sbrs r25,7 |
1763 1030 00C0 rjmp .L364 |
1764 1032 9095 com r25 |
1765 1034 8195 neg r24 |
1766 1036 9F4F sbci r25,lo8(-1) |
1767 .L364: |
1768 1038 9093 0000 sts (AdNeutralNick)+1,r25 |
1769 103c 8093 0000 sts AdNeutralNick,r24 |
1770 1040 8091 0000 lds r24,MesswertRoll |
1771 1044 9091 0000 lds r25,(MesswertRoll)+1 |
1772 1048 97FF sbrs r25,7 |
1773 104a 00C0 rjmp .L365 |
1774 104c 9095 com r25 |
1775 104e 8195 neg r24 |
1776 1050 9F4F sbci r25,lo8(-1) |
1777 .L365: |
1778 1052 9093 0000 sts (AdNeutralRoll)+1,r25 |
1779 1056 8093 0000 sts AdNeutralRoll,r24 |
1780 105a 8091 0000 lds r24,MesswertGier |
1781 105e 9091 0000 lds r25,(MesswertGier)+1 |
1782 1062 97FF sbrs r25,7 |
1783 1064 00C0 rjmp .L366 |
1784 1066 9095 com r25 |
1785 1068 8195 neg r24 |
1786 106a 9F4F sbci r25,lo8(-1) |
1787 .L366: |
1788 106c 9093 0000 sts (AdNeutralGier)+1,r25 |
1789 1070 8093 0000 sts AdNeutralGier,r24 |
1790 1074 8091 0000 lds r24,Mittelwert_AccRoll |
1791 1078 9091 0000 lds r25,(Mittelwert_AccRoll)+1 |
1792 107c 97FF sbrs r25,7 |
1793 107e 00C0 rjmp .L367 |
1794 1080 9095 com r25 |
1795 1082 8195 neg r24 |
1796 1084 9F4F sbci r25,lo8(-1) |
1797 .L367: |
1798 1086 60E1 ldi r22,lo8(16) |
1799 1088 70E0 ldi r23,hi8(16) |
1800 108a 0E94 0000 call __divmodhi4 |
1801 108e 7093 0000 sts (NeutralAccY)+1,r23 |
1802 1092 6093 0000 sts NeutralAccY,r22 |
1803 1096 8091 0000 lds r24,Mittelwert_AccNick |
1804 109a 9091 0000 lds r25,(Mittelwert_AccNick)+1 |
1805 109e 97FF sbrs r25,7 |
1806 10a0 00C0 rjmp .L368 |
1807 10a2 9095 com r25 |
1808 10a4 8195 neg r24 |
1809 10a6 9F4F sbci r25,lo8(-1) |
1810 .L368: |
1811 10a8 60E1 ldi r22,lo8(16) |
1812 10aa 70E0 ldi r23,hi8(16) |
1813 10ac 0E94 0000 call __divmodhi4 |
1814 10b0 7093 0000 sts (NeutralAccX)+1,r23 |
1815 10b4 6093 0000 sts NeutralAccX,r22 |
1816 10b8 6091 0000 lds r22,Aktuell_az |
1817 10bc 7091 0000 lds r23,(Aktuell_az)+1 |
1818 10c0 8827 clr r24 |
1819 10c2 77FD sbrc r23,7 |
1820 10c4 8095 com r24 |
1821 10c6 982F mov r25,r24 |
1822 10c8 0E94 0000 call __floatsisf |
1823 10cc 6093 0000 sts NeutralAccZ,r22 |
1824 10d0 7093 0000 sts (NeutralAccZ)+1,r23 |
1825 10d4 8093 0000 sts (NeutralAccZ)+2,r24 |
1826 10d8 9093 0000 sts (NeutralAccZ)+3,r25 |
1827 10dc 1092 0000 sts Mess_IntegralNick,__zero_reg__ |
1828 10e0 1092 0000 sts (Mess_IntegralNick)+1,__zero_reg__ |
1829 10e4 1092 0000 sts (Mess_IntegralNick)+2,__zero_reg__ |
1830 10e8 1092 0000 sts (Mess_IntegralNick)+3,__zero_reg__ |
1831 10ec 1092 0000 sts Mess_IntegralNick2,__zero_reg__ |
1832 10f0 1092 0000 sts (Mess_IntegralNick2)+1,__zero_reg__ |
1833 10f4 1092 0000 sts (Mess_IntegralNick2)+2,__zero_reg__ |
1834 10f8 1092 0000 sts (Mess_IntegralNick2)+3,__zero_reg__ |
1835 10fc 1092 0000 sts Mess_IntegralRoll,__zero_reg__ |
1836 1100 1092 0000 sts (Mess_IntegralRoll)+1,__zero_reg__ |
1837 1104 1092 0000 sts (Mess_IntegralRoll)+2,__zero_reg__ |
1838 1108 1092 0000 sts (Mess_IntegralRoll)+3,__zero_reg__ |
1839 110c 1092 0000 sts Mess_IntegralRoll2,__zero_reg__ |
1840 1110 1092 0000 sts (Mess_IntegralRoll2)+1,__zero_reg__ |
1841 1114 1092 0000 sts (Mess_IntegralRoll2)+2,__zero_reg__ |
1842 1118 1092 0000 sts (Mess_IntegralRoll2)+3,__zero_reg__ |
1843 111c 1092 0000 sts Mess_Integral_Gier,__zero_reg__ |
1844 1120 1092 0000 sts (Mess_Integral_Gier)+1,__zero_reg__ |
1845 1124 1092 0000 sts (Mess_Integral_Gier)+2,__zero_reg__ |
1846 1128 1092 0000 sts (Mess_Integral_Gier)+3,__zero_reg__ |
1847 112c 1092 0000 sts (MesswertNick)+1,__zero_reg__ |
1848 1130 1092 0000 sts MesswertNick,__zero_reg__ |
1849 1134 1092 0000 sts (MesswertRoll)+1,__zero_reg__ |
1850 1138 1092 0000 sts MesswertRoll,__zero_reg__ |
1851 113c 1092 0000 sts (MesswertGier)+1,__zero_reg__ |
1852 1140 1092 0000 sts MesswertGier,__zero_reg__ |
1853 1144 8091 0000 lds r24,Luftdruck |
1854 1148 9091 0000 lds r25,(Luftdruck)+1 |
1855 114c A091 0000 lds r26,(Luftdruck)+2 |
1856 1150 B091 0000 lds r27,(Luftdruck)+3 |
1857 1154 9093 0000 sts (StartLuftdruck)+1,r25 |
1858 1158 8093 0000 sts StartLuftdruck,r24 |
1859 115c 1092 0000 sts (HoeheD)+1,__zero_reg__ |
1860 1160 1092 0000 sts HoeheD,__zero_reg__ |
1861 1164 1092 0000 sts Mess_Integral_Hoch,__zero_reg__ |
1862 1168 1092 0000 sts (Mess_Integral_Hoch)+1,__zero_reg__ |
1863 116c 1092 0000 sts (Mess_Integral_Hoch)+2,__zero_reg__ |
1864 1170 1092 0000 sts (Mess_Integral_Hoch)+3,__zero_reg__ |
1865 1174 8091 0000 lds r24,KompassValue |
1866 1178 9091 0000 lds r25,(KompassValue)+1 |
1867 117c 9093 0000 sts (KompassStartwert)+1,r25 |
1868 1180 8093 0000 sts KompassStartwert,r24 |
1869 1184 82E3 ldi r24,lo8(50) |
1870 1186 90E0 ldi r25,hi8(50) |
1871 1188 9093 0000 sts (beeptime)+1,r25 |
1872 118c 8093 0000 sts beeptime,r24 |
1873 /* epilogue: frame size=0 */ |
1874 1190 DF91 pop r29 |
1875 1192 CF91 pop r28 |
1876 1194 0895 ret |
1877 /* epilogue end (size=3) */ |
1878 /* function SetNeutral size 254 (249) */ |
1880 .global Piep |
1882 Piep: |
1883 /* prologue: frame size=0 */ |
1884 1196 1F93 push r17 |
1885 /* prologue end (size=1) */ |
1886 1198 182F mov r17,r24 |
1887 119a 00C0 rjmp .L373 |
1888 .L374: |
1889 119c 8091 0000 lds r24,MotorenEin |
1890 11a0 8823 tst r24 |
1891 11a2 01F4 brne .L377 |
1892 11a4 84E6 ldi r24,lo8(100) |
1893 11a6 90E0 ldi r25,hi8(100) |
1894 11a8 9093 0000 sts (beeptime)+1,r25 |
1895 11ac 8093 0000 sts beeptime,r24 |
1896 11b0 8AEF ldi r24,lo8(250) |
1897 11b2 90E0 ldi r25,hi8(250) |
1898 11b4 0E94 0000 call Delay_ms |
1899 .L373: |
1900 11b8 1150 subi r17,1 |
1901 11ba 00F4 brcc .L374 |
1902 .L377: |
1903 /* epilogue: frame size=0 */ |
1904 11bc 1F91 pop r17 |
1905 11be 0895 ret |
1906 /* epilogue end (size=2) */ |
1907 /* function Piep size 22 (19) */ |
1909 .global MotorRegler |
1911 MotorRegler: |
1912 /* prologue: frame size=4 */ |
1913 11c0 2F92 push r2 |
1914 11c2 3F92 push r3 |
1915 11c4 4F92 push r4 |
1916 11c6 5F92 push r5 |
1917 11c8 6F92 push r6 |
1918 11ca 7F92 push r7 |
1919 11cc 8F92 push r8 |
1920 11ce 9F92 push r9 |
1921 11d0 AF92 push r10 |
1922 11d2 BF92 push r11 |
1923 11d4 CF92 push r12 |
1924 11d6 DF92 push r13 |
1925 11d8 EF92 push r14 |
1926 11da FF92 push r15 |
1927 11dc 0F93 push r16 |
1928 11de 1F93 push r17 |
1929 11e0 CF93 push r28 |
1930 11e2 DF93 push r29 |
1931 11e4 CDB7 in r28,__SP_L__ |
1932 11e6 DEB7 in r29,__SP_H__ |
1933 11e8 2497 sbiw r28,4 |
1934 11ea 0FB6 in __tmp_reg__,__SREG__ |
1935 11ec F894 cli |
1936 11ee DEBF out __SP_H__,r29 |
1937 11f0 0FBE out __SREG__,__tmp_reg__ |
1938 11f2 CDBF out __SP_L__,r28 |
1939 /* prologue end (size=26) */ |
1940 11f4 0E94 0000 call Mittelwert |
1941 11f8 299A sbi 37-0x20,1 |
1942 11fa E091 0000 lds r30,EE_Parameter+2 |
1943 11fe AE2F mov r26,r30 |
1944 1200 BB27 clr r27 |
1945 1202 AA0F lsl r26 |
1946 1204 BB1F rol r27 |
1947 1206 A050 subi r26,lo8(-(PPM_in)) |
1948 1208 B040 sbci r27,hi8(-(PPM_in)) |
1949 120a 0D90 ld __tmp_reg__,X+ |
1950 120c BC91 ld r27,X |
1951 120e A02D mov r26,__tmp_reg__ |
1952 1210 9D01 movw r18,r26 |
1953 1212 2858 subi r18,lo8(-(120)) |
1954 1214 3F4F sbci r19,hi8(-(120)) |
1955 1216 3A83 std Y+2,r19 |
1956 1218 2983 std Y+1,r18 |
1957 121a 37FF sbrs r19,7 |
1958 121c 00C0 rjmp .L379 |
1959 121e 1A82 std Y+2,__zero_reg__ |
1960 1220 1982 std Y+1,__zero_reg__ |
1961 .L379: |
1962 1222 8091 0000 lds r24,SenderOkay |
1963 1226 8436 cpi r24,lo8(100) |
1964 1228 00F0 brlo .+2 |
1965 122a 00C0 rjmp .L380 |
1966 122c 8091 0000 lds r24,PcZugriff |
1967 1230 8823 tst r24 |
1968 1232 01F4 brne .L382 |
1969 1234 84EF ldi r24,lo8(500) |
1970 1236 91E0 ldi r25,hi8(500) |
1971 1238 9093 0000 sts (beeptime)+1,r25 |
1972 123c 8093 0000 sts beeptime,r24 |
1973 .L382: |
1974 1240 8091 0000 lds r24,RcLostTimer.2356 |
1975 1244 9091 0000 lds r25,(RcLostTimer.2356)+1 |
1976 1248 0097 sbiw r24,0 |
1977 124a 01F0 breq .L384 |
1978 124c 0197 sbiw r24,1 |
1979 124e 9093 0000 sts (RcLostTimer.2356)+1,r25 |
1980 1252 8093 0000 sts RcLostTimer.2356,r24 |
1981 1256 00C0 rjmp .L386 |
1982 .L384: |
1983 1258 1092 0000 sts MotorenEin,__zero_reg__ |
1984 125c 1092 0000 sts Notlandung,__zero_reg__ |
1985 .L386: |
1986 1260 289A sbi 37-0x20,0 |
1987 1262 8091 0000 lds r24,modell_fliegt.2360 |
1988 1266 9091 0000 lds r25,(modell_fliegt.2360)+1 |
1989 126a 815D subi r24,lo8(2001) |
1990 126c 9740 sbci r25,hi8(2001) |
1991 126e 00F0 brlo .L387 |
1992 1270 8091 0000 lds r24,EE_Parameter+25 |
1993 1274 482F mov r20,r24 |
1994 1276 5527 clr r21 |
1995 1278 5A83 std Y+2,r21 |
1996 127a 4983 std Y+1,r20 |
1997 127c 81E0 ldi r24,lo8(1) |
1998 127e 8093 0000 sts Notlandung,r24 |
1999 1282 E091 0000 lds r30,EE_Parameter |
2000 1286 FF27 clr r31 |
2001 1288 EE0F lsl r30 |
2002 128a FF1F rol r31 |
2003 128c E050 subi r30,lo8(-(PPM_in)) |
2004 128e F040 sbci r31,hi8(-(PPM_in)) |
2005 1290 1182 std Z+1,__zero_reg__ |
2006 1292 1082 st Z,__zero_reg__ |
2007 1294 E091 0000 lds r30,EE_Parameter+1 |
2008 1298 FF27 clr r31 |
2009 129a EE0F lsl r30 |
2010 129c FF1F rol r31 |
2011 129e E050 subi r30,lo8(-(PPM_in)) |
2012 12a0 F040 sbci r31,hi8(-(PPM_in)) |
2013 12a2 1182 std Z+1,__zero_reg__ |
2014 12a4 1082 st Z,__zero_reg__ |
2015 12a6 E091 0000 lds r30,EE_Parameter+3 |
2016 12aa FF27 clr r31 |
2017 12ac EE0F lsl r30 |
2018 12ae FF1F rol r31 |
2019 12b0 E050 subi r30,lo8(-(PPM_in)) |
2020 12b2 F040 sbci r31,hi8(-(PPM_in)) |
2021 12b4 1182 std Z+1,__zero_reg__ |
2022 12b6 1082 st Z,__zero_reg__ |
2023 12b8 00C0 rjmp .L389 |
2024 .L387: |
2025 12ba 1092 0000 sts MotorenEin,__zero_reg__ |
2026 12be 00C0 rjmp .L389 |
2027 .L380: |
2028 12c0 8091 0000 lds r24,SenderOkay |
2029 12c4 8D38 cpi r24,lo8(-115) |
2030 12c6 00F4 brsh .+2 |
2031 12c8 00C0 rjmp .L389 |
2032 12ca 1092 0000 sts Notlandung,__zero_reg__ |
2033 12ce 8091 0000 lds r24,EE_Parameter+26 |
2034 12d2 22E3 ldi r18,lo8(50) |
2035 12d4 829F mul r24,r18 |
2036 12d6 C001 movw r24,r0 |
2037 12d8 1124 clr r1 |
2038 12da 9093 0000 sts (RcLostTimer.2356)+1,r25 |
2039 12de 8093 0000 sts RcLostTimer.2356,r24 |
2040 12e2 6981 ldd r22,Y+1 |
2041 12e4 7A81 ldd r23,Y+2 |
2042 12e6 6932 cpi r22,41 |
2043 12e8 7105 cpc r23,__zero_reg__ |
2044 12ea 04F0 brlt .L391 |
2045 12ec 8091 0000 lds r24,modell_fliegt.2360 |
2046 12f0 9091 0000 lds r25,(modell_fliegt.2360)+1 |
2047 12f4 7FEF ldi r23,hi8(-1) |
2048 12f6 8F3F cpi r24,lo8(-1) |
2049 12f8 9707 cpc r25,r23 |
2050 12fa 01F0 breq .L393 |
2051 12fc 0196 adiw r24,1 |
2052 12fe 9093 0000 sts (modell_fliegt.2360)+1,r25 |
2053 1302 8093 0000 sts modell_fliegt.2360,r24 |
2054 .L391: |
2055 1306 8091 0000 lds r24,modell_fliegt.2360 |
2056 130a 9091 0000 lds r25,(modell_fliegt.2360)+1 |
2057 130e 883C cpi r24,200 |
2058 1310 9105 cpc r25,__zero_reg__ |
2059 1312 00F0 brlo .L395 |
2060 1314 8981 ldd r24,Y+1 |
2061 1316 9A81 ldd r25,Y+2 |
2062 1318 8897 sbiw r24,40 |
2063 131a 04F4 brge .L393 |
2064 .L395: |
2065 131c 1092 0000 sts SummeNick.2349,__zero_reg__ |
2066 1320 1092 0000 sts (SummeNick.2349)+1,__zero_reg__ |
2067 1324 1092 0000 sts (SummeNick.2349)+2,__zero_reg__ |
2068 1328 1092 0000 sts (SummeNick.2349)+3,__zero_reg__ |
2069 132c 1092 0000 sts SummeRoll.2350,__zero_reg__ |
2070 1330 1092 0000 sts (SummeRoll.2350)+1,__zero_reg__ |
2071 1334 1092 0000 sts (SummeRoll.2350)+2,__zero_reg__ |
2072 1338 1092 0000 sts (SummeRoll.2350)+3,__zero_reg__ |
2073 133c 1092 0000 sts Mess_Integral_Gier,__zero_reg__ |
2074 1340 1092 0000 sts (Mess_Integral_Gier)+1,__zero_reg__ |
2075 1344 1092 0000 sts (Mess_Integral_Gier)+2,__zero_reg__ |
2076 1348 1092 0000 sts (Mess_Integral_Gier)+3,__zero_reg__ |
2077 134c 1092 0000 sts Mess_Integral_Gier2,__zero_reg__ |
2078 1350 1092 0000 sts (Mess_Integral_Gier2)+1,__zero_reg__ |
2079 1354 1092 0000 sts (Mess_Integral_Gier2)+2,__zero_reg__ |
2080 1358 1092 0000 sts (Mess_Integral_Gier2)+3,__zero_reg__ |
2081 .L393: |
2082 135c E981 ldd r30,Y+1 |
2083 135e FA81 ldd r31,Y+2 |
2084 1360 E93C cpi r30,201 |
2085 1362 F105 cpc r31,__zero_reg__ |
2086 1364 04F4 brge .+2 |
2087 1366 00C0 rjmp .L397 |
2088 1368 8091 0000 lds r24,MotorenEin |
2089 136c 8823 tst r24 |
2090 136e 01F0 breq .+2 |
2091 1370 00C0 rjmp .L389 |
2092 1372 E091 0000 lds r30,EE_Parameter+3 |
2093 1376 FF27 clr r31 |
2094 1378 EE0F lsl r30 |
2095 137a FF1F rol r31 |
2096 137c E050 subi r30,lo8(-(PPM_in)) |
2097 137e F040 sbci r31,hi8(-(PPM_in)) |
2098 1380 8081 ld r24,Z |
2099 1382 9181 ldd r25,Z+1 |
2100 1384 8C34 cpi r24,76 |
2101 1386 9105 cpc r25,__zero_reg__ |
2102 1388 04F4 brge .+2 |
2103 138a 00C0 rjmp .L400 |
2104 138c 8091 0000 lds r24,delay_neutral.2357 |
2105 1390 8F5F subi r24,lo8(-(1)) |
2106 1392 8093 0000 sts delay_neutral.2357,r24 |
2107 1396 893C cpi r24,lo8(-55) |
2108 1398 00F4 brsh .+2 |
2109 139a 00C0 rjmp .L389 |
2110 139c 2998 cbi 37-0x20,1 |
2111 139e 0E94 0000 call SetNeutral |
2112 13a2 1092 0000 sts MotorenEin,__zero_reg__ |
2113 13a6 1092 0000 sts delay_neutral.2357,__zero_reg__ |
2114 13aa 1092 0000 sts (modell_fliegt.2360)+1,__zero_reg__ |
2115 13ae 1092 0000 sts modell_fliegt.2360,__zero_reg__ |
2116 13b2 8091 0000 lds r24,EE_Parameter |
2117 13b6 282F mov r18,r24 |
2118 13b8 3327 clr r19 |
2119 13ba F901 movw r30,r18 |
2120 13bc EE0F lsl r30 |
2121 13be FF1F rol r31 |
2122 13c0 E050 subi r30,lo8(-(PPM_in)) |
2123 13c2 F040 sbci r31,hi8(-(PPM_in)) |
2124 13c4 8081 ld r24,Z |
2125 13c6 9181 ldd r25,Z+1 |
2126 13c8 8734 cpi r24,71 |
2127 13ca 9105 cpc r25,__zero_reg__ |
2128 13cc 04F4 brge .L403 |
2129 13ce E091 0000 lds r30,EE_Parameter+1 |
2130 13d2 FF27 clr r31 |
2131 13d4 EE0F lsl r30 |
2132 13d6 FF1F rol r31 |
2133 13d8 E050 subi r30,lo8(-(PPM_in)) |
2134 13da F040 sbci r31,hi8(-(PPM_in)) |
2135 13dc 0190 ld __tmp_reg__,Z+ |
2136 13de F081 ld r31,Z |
2137 13e0 E02D mov r30,__tmp_reg__ |
2138 13e2 F7FF sbrs r31,7 |
2139 13e4 00C0 rjmp .L406 |
2140 13e6 F095 com r31 |
2141 13e8 E195 neg r30 |
2142 13ea FF4F sbci r31,lo8(-1) |
2143 .L406: |
2144 13ec E734 cpi r30,71 |
2145 13ee F105 cpc r31,__zero_reg__ |
2146 13f0 04F4 brge .+2 |
2147 13f2 00C0 rjmp .L405 |
2148 .L403: |
2149 13f4 8091 0000 lds r24,EE_Parameter+1 |
2150 13f8 682F mov r22,r24 |
2151 13fa 7727 clr r23 |
2152 13fc DB01 movw r26,r22 |
2153 13fe AA0F lsl r26 |
2154 1400 BB1F rol r27 |
2155 1402 A050 subi r26,lo8(-(PPM_in)) |
2156 1404 B040 sbci r27,hi8(-(PPM_in)) |
2157 1406 8D91 ld r24,X+ |
2158 1408 9C91 ld r25,X |
2159 140a 1197 sbiw r26,1 |
2160 140c 8734 cpi r24,71 |
2161 140e 9105 cpc r25,__zero_reg__ |
2162 1410 04F0 brlt .L407 |
2163 1412 F901 movw r30,r18 |
2164 1414 EE0F lsl r30 |
2165 1416 FF1F rol r31 |
2166 1418 E050 subi r30,lo8(-(PPM_in)) |
2167 141a F040 sbci r31,hi8(-(PPM_in)) |
2168 141c 8081 ld r24,Z |
2169 141e 9181 ldd r25,Z+1 |
2170 .L407: |
2171 1420 8D91 ld r24,X+ |
2172 1422 9C91 ld r25,X |
2173 1424 8734 cpi r24,71 |
2174 1426 9105 cpc r25,__zero_reg__ |
2175 1428 04F0 brlt .L409 |
2176 142a F901 movw r30,r18 |
2177 142c EE0F lsl r30 |
2178 142e FF1F rol r31 |
2179 1430 E050 subi r30,lo8(-(PPM_in)) |
2180 1432 F040 sbci r31,hi8(-(PPM_in)) |
2181 1434 8081 ld r24,Z |
2182 1436 9181 ldd r25,Z+1 |
2183 1438 8734 cpi r24,71 |
2184 143a 9105 cpc r25,__zero_reg__ |
2185 143c 04F0 brlt .L409 |
2186 143e 42E0 ldi r20,lo8(2) |
2187 1440 00C0 rjmp .L412 |
2188 .L409: |
2189 1442 41E0 ldi r20,lo8(1) |
2190 .L412: |
2191 1444 FB01 movw r30,r22 |
2192 1446 EE0F lsl r30 |
2193 1448 FF1F rol r31 |
2194 144a E050 subi r30,lo8(-(PPM_in)) |
2195 144c F040 sbci r31,hi8(-(PPM_in)) |
2196 144e 8081 ld r24,Z |
2197 1450 9181 ldd r25,Z+1 |
2198 1452 8634 cpi r24,70 |
2199 1454 9105 cpc r25,__zero_reg__ |
2200 1456 04F4 brge .L413 |
2201 1458 F901 movw r30,r18 |
2202 145a EE0F lsl r30 |
2203 145c FF1F rol r31 |
2204 145e E050 subi r30,lo8(-(PPM_in)) |
2205 1460 F040 sbci r31,hi8(-(PPM_in)) |
2206 1462 8081 ld r24,Z |
2207 1464 9181 ldd r25,Z+1 |
2208 1466 8734 cpi r24,71 |
2209 1468 9105 cpc r25,__zero_reg__ |
2210 146a 04F0 brlt .L413 |
2211 146c 43E0 ldi r20,lo8(3) |
2212 .L413: |
2213 146e FB01 movw r30,r22 |
2214 1470 EE0F lsl r30 |
2215 1472 FF1F rol r31 |
2216 1474 E050 subi r30,lo8(-(PPM_in)) |
2217 1476 F040 sbci r31,hi8(-(PPM_in)) |
2218 1478 8081 ld r24,Z |
2219 147a 9181 ldd r25,Z+1 |
2220 147c 8A5B subi r24,lo8(-70) |
2221 147e 9F4F sbci r25,hi8(-70) |
2222 1480 04F4 brge .L416 |
2223 1482 F901 movw r30,r18 |
2224 1484 EE0F lsl r30 |
2225 1486 FF1F rol r31 |
2226 1488 E050 subi r30,lo8(-(PPM_in)) |
2227 148a F040 sbci r31,hi8(-(PPM_in)) |
2228 148c 8081 ld r24,Z |
2229 148e 9181 ldd r25,Z+1 |
2230 1490 8734 cpi r24,71 |
2231 1492 9105 cpc r25,__zero_reg__ |
2232 1494 04F0 brlt .L416 |
2233 1496 44E0 ldi r20,lo8(4) |
2234 .L416: |
2235 1498 660F lsl r22 |
2236 149a 771F rol r23 |
2237 149c 6050 subi r22,lo8(-(PPM_in)) |
2238 149e 7040 sbci r23,hi8(-(PPM_in)) |
2239 14a0 FB01 movw r30,r22 |
2240 14a2 8081 ld r24,Z |
2241 14a4 9181 ldd r25,Z+1 |
2242 14a6 8A5B subi r24,lo8(-70) |
2243 14a8 9F4F sbci r25,hi8(-70) |
2244 14aa 04F4 brge .L419 |
2245 14ac 220F lsl r18 |
2246 14ae 331F rol r19 |
2247 14b0 2050 subi r18,lo8(-(PPM_in)) |
2248 14b2 3040 sbci r19,hi8(-(PPM_in)) |
2249 14b4 F901 movw r30,r18 |
2250 14b6 8081 ld r24,Z |
2251 14b8 9181 ldd r25,Z+1 |
2252 14ba 8634 cpi r24,70 |
2253 14bc 9105 cpc r25,__zero_reg__ |
2254 14be 04F4 brge .L419 |
2255 14c0 45E0 ldi r20,lo8(5) |
2256 .L419: |
2257 14c2 A0E0 ldi r26,lo8(EEPromArray+2) |
2258 14c4 B0E0 ldi r27,hi8(EEPromArray+2) |
2259 /* #APP */ |
2260 14c6 042E mov __tmp_reg__,r20 |
2261 14c8 0E94 0000 call __eeprom_write_byte_1F2021 |
2262 /* #NOAPP */ |
2263 .L405: |
2264 14cc 0E94 0000 call GetActiveParamSetNumber |
2265 14d0 4AE3 ldi r20,lo8(58) |
2266 14d2 60E0 ldi r22,lo8(EE_Parameter) |
2267 14d4 70E0 ldi r23,hi8(EE_Parameter) |
2268 14d6 0E94 0000 call ReadParameterSet |
2269 14da 0E94 0000 call GetActiveParamSetNumber |
2270 14de 0E94 0000 call Piep |
2271 14e2 8091 0000 lds r24,EE_Parameter+8 |
2272 14e6 80FF sbrs r24,0 |
2273 14e8 00C0 rjmp .L389 |
2274 14ea 8091 0000 lds r24,MessLuftdruck |
2275 14ee 9091 0000 lds r25,(MessLuftdruck)+1 |
2276 14f2 875B subi r24,lo8(951) |
2277 14f4 9340 sbci r25,hi8(951) |
2278 14f6 00F4 brsh .L423 |
2279 14f8 8091 0000 lds r24,MessLuftdruck |
2280 14fc 9091 0000 lds r25,(MessLuftdruck)+1 |
2281 1500 8E5E subi r24,lo8(750) |
2282 1502 9240 sbci r25,hi8(750) |
2283 1504 00F0 brlo .+2 |
2284 1506 00C0 rjmp .L389 |
2285 .L423: |
2286 1508 0E94 0000 call SucheLuftruckOffset |
2287 150c 00C0 rjmp .L389 |
2288 .L400: |
2289 150e 1092 0000 sts delay_neutral.2357,__zero_reg__ |
2290 1512 00C0 rjmp .L389 |
2291 .L397: |
2292 1514 4981 ldd r20,Y+1 |
2293 1516 5A81 ldd r21,Y+2 |
2294 1518 4332 cpi r20,35 |
2295 151a 5105 cpc r21,__zero_reg__ |
2296 151c 04F0 brlt .+2 |
2297 151e 00C0 rjmp .L389 |
2298 1520 8091 0000 lds r24,EE_Parameter+3 |
2299 1524 482F mov r20,r24 |
2300 1526 5527 clr r21 |
2301 1528 FA01 movw r30,r20 |
2302 152a EE0F lsl r30 |
2303 152c FF1F rol r31 |
2304 152e E050 subi r30,lo8(-(PPM_in)) |
2305 1530 F040 sbci r31,hi8(-(PPM_in)) |
2306 1532 8081 ld r24,Z |
2307 1534 9181 ldd r25,Z+1 |
2308 1536 855B subi r24,lo8(-75) |
2309 1538 9F4F sbci r25,hi8(-75) |
2310 153a 04F0 brlt .+2 |
2311 153c 00C0 rjmp .L426 |
2312 153e 8091 0000 lds r24,delay_einschalten.2358 |
2313 1542 8F5F subi r24,lo8(-(1)) |
2314 1544 8093 0000 sts delay_einschalten.2358,r24 |
2315 1548 893C cpi r24,lo8(-55) |
2316 154a 00F4 brsh .+2 |
2317 154c 00C0 rjmp .L428 |
2318 154e 88EC ldi r24,lo8(-56) |
2319 1550 8093 0000 sts delay_einschalten.2358,r24 |
2320 1554 81E0 ldi r24,lo8(1) |
2321 1556 90E0 ldi r25,hi8(1) |
2322 1558 9093 0000 sts (modell_fliegt.2360)+1,r25 |
2323 155c 8093 0000 sts modell_fliegt.2360,r24 |
2324 1560 81E0 ldi r24,lo8(1) |
2325 1562 8093 0000 sts MotorenEin,r24 |
2326 1566 1092 0000 sts sollGier.2351,__zero_reg__ |
2327 156a 1092 0000 sts (sollGier.2351)+1,__zero_reg__ |
2328 156e 1092 0000 sts (sollGier.2351)+2,__zero_reg__ |
2329 1572 1092 0000 sts (sollGier.2351)+3,__zero_reg__ |
2330 1576 1092 0000 sts Mess_Integral_Gier,__zero_reg__ |
2331 157a 1092 0000 sts (Mess_Integral_Gier)+1,__zero_reg__ |
2332 157e 1092 0000 sts (Mess_Integral_Gier)+2,__zero_reg__ |
2333 1582 1092 0000 sts (Mess_Integral_Gier)+3,__zero_reg__ |
2334 1586 1092 0000 sts Mess_Integral_Gier2,__zero_reg__ |
2335 158a 1092 0000 sts (Mess_Integral_Gier2)+1,__zero_reg__ |
2336 158e 1092 0000 sts (Mess_Integral_Gier2)+2,__zero_reg__ |
2337 1592 1092 0000 sts (Mess_Integral_Gier2)+3,__zero_reg__ |
2338 1596 1092 0000 sts Mess_IntegralNick,__zero_reg__ |
2339 159a 1092 0000 sts (Mess_IntegralNick)+1,__zero_reg__ |
2340 159e 1092 0000 sts (Mess_IntegralNick)+2,__zero_reg__ |
2341 15a2 1092 0000 sts (Mess_IntegralNick)+3,__zero_reg__ |
2342 15a6 1092 0000 sts Mess_IntegralRoll,__zero_reg__ |
2343 15aa 1092 0000 sts (Mess_IntegralRoll)+1,__zero_reg__ |
2344 15ae 1092 0000 sts (Mess_IntegralRoll)+2,__zero_reg__ |
2345 15b2 1092 0000 sts (Mess_IntegralRoll)+3,__zero_reg__ |
2346 15b6 8091 0000 lds r24,IntegralNick |
2347 15ba 9091 0000 lds r25,(IntegralNick)+1 |
2348 15be A091 0000 lds r26,(IntegralNick)+2 |
2349 15c2 B091 0000 lds r27,(IntegralNick)+3 |
2350 15c6 8093 0000 sts Mess_IntegralNick2,r24 |
2351 15ca 9093 0000 sts (Mess_IntegralNick2)+1,r25 |
2352 15ce A093 0000 sts (Mess_IntegralNick2)+2,r26 |
2353 15d2 B093 0000 sts (Mess_IntegralNick2)+3,r27 |
2354 15d6 8091 0000 lds r24,IntegralRoll |
2355 15da 9091 0000 lds r25,(IntegralRoll)+1 |
2356 15de A091 0000 lds r26,(IntegralRoll)+2 |
2357 15e2 B091 0000 lds r27,(IntegralRoll)+3 |
2358 15e6 8093 0000 sts Mess_IntegralRoll2,r24 |
2359 15ea 9093 0000 sts (Mess_IntegralRoll2)+1,r25 |
2360 15ee A093 0000 sts (Mess_IntegralRoll2)+2,r26 |
2361 15f2 B093 0000 sts (Mess_IntegralRoll2)+3,r27 |
2362 15f6 1092 0000 sts SummeNick.2349,__zero_reg__ |
2363 15fa 1092 0000 sts (SummeNick.2349)+1,__zero_reg__ |
2364 15fe 1092 0000 sts (SummeNick.2349)+2,__zero_reg__ |
2365 1602 1092 0000 sts (SummeNick.2349)+3,__zero_reg__ |
2366 1606 1092 0000 sts SummeRoll.2350,__zero_reg__ |
2367 160a 1092 0000 sts (SummeRoll.2350)+1,__zero_reg__ |
2368 160e 1092 0000 sts (SummeRoll.2350)+2,__zero_reg__ |
2369 1612 1092 0000 sts (SummeRoll.2350)+3,__zero_reg__ |
2370 1616 00C0 rjmp .L428 |
2371 .L426: |
2372 1618 1092 0000 sts delay_einschalten.2358,__zero_reg__ |
2373 .L428: |
2374 161c 440F lsl r20 |
2375 161e 551F rol r21 |
2376 1620 4050 subi r20,lo8(-(PPM_in)) |
2377 1622 5040 sbci r21,hi8(-(PPM_in)) |
2378 1624 FA01 movw r30,r20 |
2379 1626 8081 ld r24,Z |
2380 1628 9181 ldd r25,Z+1 |
2381 162a 8C34 cpi r24,76 |
2382 162c 9105 cpc r25,__zero_reg__ |
2383 162e 04F0 brlt .L430 |
2384 1630 8091 0000 lds r24,delay_ausschalten.2359 |
2385 1634 8F5F subi r24,lo8(-(1)) |
2386 1636 8093 0000 sts delay_ausschalten.2359,r24 |
2387 163a 893C cpi r24,lo8(-55) |
2388 163c 00F0 brlo .L389 |
2389 163e 1092 0000 sts MotorenEin,__zero_reg__ |
2390 1642 88EC ldi r24,lo8(-56) |
2391 1644 8093 0000 sts delay_ausschalten.2359,r24 |
2392 1648 1092 0000 sts (modell_fliegt.2360)+1,__zero_reg__ |
2393 164c 1092 0000 sts modell_fliegt.2360,__zero_reg__ |
2394 1650 00C0 rjmp .L389 |
2395 .L430: |
2396 1652 1092 0000 sts delay_ausschalten.2359,__zero_reg__ |
2397 .L389: |
2398 1656 8091 0000 lds r24,NewPpmData |
2399 165a 8150 subi r24,lo8(-(-1)) |
2400 165c 8093 0000 sts NewPpmData,r24 |
2401 1660 8091 0000 lds r24,NewPpmData |
2402 1664 8F3F cpi r24,lo8(-1) |
2403 1666 01F0 breq .L433 |
2404 1668 8091 0000 lds r24,Notlandung |
2405 166c 8823 tst r24 |
2406 166e 01F4 brne .+2 |
2407 1670 00C0 rjmp .L435 |
2408 .L433: |
2409 1672 0E94 0000 call ParameterZuordnung |
2410 1676 E091 0000 lds r30,EE_Parameter |
2411 167a FF27 clr r31 |
2412 167c EE0F lsl r30 |
2413 167e FF1F rol r31 |
2414 1680 DF01 movw r26,r30 |
2415 1682 A050 subi r26,lo8(-(PPM_in)) |
2416 1684 B040 sbci r27,hi8(-(PPM_in)) |
2417 1686 8D91 ld r24,X+ |
2418 1688 9C91 ld r25,X |
2419 168a 6091 0000 lds r22,EE_Parameter+15 |
2420 168e 7727 clr r23 |
2421 1690 E050 subi r30,lo8(-(PPM_diff)) |
2422 1692 F040 sbci r31,hi8(-(PPM_diff)) |
2423 1694 2081 ld r18,Z |
2424 1696 3181 ldd r19,Z+1 |
2425 1698 4091 0000 lds r20,EE_Parameter+16 |
2426 169c 5527 clr r21 |
2427 169e FC01 movw r30,r24 |
2428 16a0 E69F mul r30,r22 |
2429 16a2 C001 movw r24,r0 |
2430 16a4 E79F mul r30,r23 |
2431 16a6 900D add r25,r0 |
2432 16a8 F69F mul r31,r22 |
2433 16aa 900D add r25,r0 |
2434 16ac 1124 clr r1 |
2435 16ae F901 movw r30,r18 |
2436 16b0 E49F mul r30,r20 |
2437 16b2 9001 movw r18,r0 |
2438 16b4 E59F mul r30,r21 |
2439 16b6 300D add r19,r0 |
2440 16b8 F49F mul r31,r20 |
2441 16ba 300D add r19,r0 |
2442 16bc 1124 clr r1 |
2443 16be 820F add r24,r18 |
2444 16c0 931F adc r25,r19 |
2445 16c2 9093 0000 sts (StickNick)+1,r25 |
2446 16c6 8093 0000 sts StickNick,r24 |
2447 16ca E091 0000 lds r30,EE_Parameter+1 |
2448 16ce FF27 clr r31 |
2449 16d0 EE0F lsl r30 |
2450 16d2 FF1F rol r31 |
2451 16d4 DF01 movw r26,r30 |
2452 16d6 A050 subi r26,lo8(-(PPM_in)) |
2453 16d8 B040 sbci r27,hi8(-(PPM_in)) |
2454 16da 8D91 ld r24,X+ |
2455 16dc 9C91 ld r25,X |
2456 16de E050 subi r30,lo8(-(PPM_diff)) |
2457 16e0 F040 sbci r31,hi8(-(PPM_diff)) |
2458 16e2 2081 ld r18,Z |
2459 16e4 3181 ldd r19,Z+1 |
2460 16e6 FC01 movw r30,r24 |
2461 16e8 E69F mul r30,r22 |
2462 16ea C001 movw r24,r0 |
2463 16ec E79F mul r30,r23 |
2464 16ee 900D add r25,r0 |
2465 16f0 F69F mul r31,r22 |
2466 16f2 900D add r25,r0 |
2467 16f4 1124 clr r1 |
2468 16f6 B901 movw r22,r18 |
2469 16f8 649F mul r22,r20 |
2470 16fa 9001 movw r18,r0 |
2471 16fc 659F mul r22,r21 |
2472 16fe 300D add r19,r0 |
2473 1700 749F mul r23,r20 |
2474 1702 300D add r19,r0 |
2475 1704 1124 clr r1 |
2476 1706 820F add r24,r18 |
2477 1708 931F adc r25,r19 |
2478 170a 9093 0000 sts (StickRoll)+1,r25 |
2479 170e 8093 0000 sts StickRoll,r24 |
2480 1712 E091 0000 lds r30,EE_Parameter+3 |
2481 1716 FF27 clr r31 |
2482 1718 EE0F lsl r30 |
2483 171a FF1F rol r31 |
2484 171c E050 subi r30,lo8(-(PPM_in)) |
2485 171e F040 sbci r31,hi8(-(PPM_in)) |
2486 1720 8081 ld r24,Z |
2487 1722 9181 ldd r25,Z+1 |
2488 1724 9095 com r25 |
2489 1726 8195 neg r24 |
2490 1728 9F4F sbci r25,lo8(-1) |
2491 172a 9093 0000 sts (StickGier)+1,r25 |
2492 172e 8093 0000 sts StickGier,r24 |
2493 1732 1091 0000 lds r17,Parameter_Gyro_P |
2494 1736 612F mov r22,r17 |
2495 1738 7727 clr r23 |
2496 173a 67FD sbrc r22,7 |
2497 173c 7095 com r23 |
2498 173e 872F mov r24,r23 |
2499 1740 972F mov r25,r23 |
2500 1742 0E94 0000 call __floatsisf |
2501 1746 17FF sbrs r17,7 |
2502 1748 00C0 rjmp .L436 |
2503 174a 20E0 ldi r18,lo8(0x43800000) |
2504 174c 30E0 ldi r19,hi8(0x43800000) |
2505 174e 40E8 ldi r20,hlo8(0x43800000) |
2506 1750 53E4 ldi r21,hhi8(0x43800000) |
2507 1752 0E94 0000 call __addsf3 |
2508 .L436: |
2509 1756 20E0 ldi r18,lo8(0x41200000) |
2510 1758 30E0 ldi r19,hi8(0x41200000) |
2511 175a 40E2 ldi r20,hlo8(0x41200000) |
2512 175c 51E4 ldi r21,hhi8(0x41200000) |
2513 175e 0E94 0000 call __addsf3 |
2514 1762 20E0 ldi r18,lo8(0x3b800000) |
2515 1764 30E0 ldi r19,hi8(0x3b800000) |
2516 1766 40E8 ldi r20,hlo8(0x3b800000) |
2517 1768 5BE3 ldi r21,hhi8(0x3b800000) |
2518 176a 0E94 0000 call __mulsf3 |
2519 176e 5B01 movw r10,r22 |
2520 1770 6C01 movw r12,r24 |
2521 1772 6093 0000 sts GyroFaktor,r22 |
2522 1776 7093 0000 sts (GyroFaktor)+1,r23 |
2523 177a 8093 0000 sts (GyroFaktor)+2,r24 |
2524 177e 9093 0000 sts (GyroFaktor)+3,r25 |
2525 1782 1091 0000 lds r17,Parameter_Gyro_I |
2526 1786 612F mov r22,r17 |
2527 1788 7727 clr r23 |
2528 178a 67FD sbrc r22,7 |
2529 178c 7095 com r23 |
2530 178e 872F mov r24,r23 |
2531 1790 972F mov r25,r23 |
2532 1792 0E94 0000 call __floatsisf |
2533 1796 17FF sbrs r17,7 |
2534 1798 00C0 rjmp .L437 |
2535 179a 20E0 ldi r18,lo8(0x43800000) |
2536 179c 30E0 ldi r19,hi8(0x43800000) |
2537 179e 40E8 ldi r20,hlo8(0x43800000) |
2538 17a0 53E4 ldi r21,hhi8(0x43800000) |
2539 17a2 0E94 0000 call __addsf3 |
2540 .L437: |
2541 17a6 20E0 ldi r18,lo8(0x472be000) |
2542 17a8 30EE ldi r19,hi8(0x472be000) |
2543 17aa 4BE2 ldi r20,hlo8(0x472be000) |
2544 17ac 57E4 ldi r21,hhi8(0x472be000) |
2545 17ae 0E94 0000 call __divsf3 |
2546 17b2 6093 0000 sts IntegralFaktor,r22 |
2547 17b6 7093 0000 sts (IntegralFaktor)+1,r23 |
2548 17ba 8093 0000 sts (IntegralFaktor)+2,r24 |
2549 17be 9093 0000 sts (IntegralFaktor)+3,r25 |
2550 17c2 8091 0000 lds r24,EE_Parameter+8 |
2551 17c6 82FF sbrs r24,2 |
2552 17c8 00C0 rjmp .L438 |
2553 17ca 80E0 ldi r24,lo8(0x0) |
2554 17cc 90E0 ldi r25,hi8(0x0) |
2555 17ce A0E0 ldi r26,hlo8(0x0) |
2556 17d0 B0E0 ldi r27,hhi8(0x0) |
2557 17d2 8093 0000 sts IntegralFaktor,r24 |
2558 17d6 9093 0000 sts (IntegralFaktor)+1,r25 |
2559 17da A093 0000 sts (IntegralFaktor)+2,r26 |
2560 17de B093 0000 sts (IntegralFaktor)+3,r27 |
2561 .L438: |
2562 17e2 20E0 ldi r18,lo8(0x0) |
2563 17e4 30E0 ldi r19,hi8(0x0) |
2564 17e6 40E0 ldi r20,hlo8(0x0) |
2565 17e8 50E0 ldi r21,hhi8(0x0) |
2566 17ea C601 movw r24,r12 |
2567 17ec B501 movw r22,r10 |
2568 17ee 0E94 0000 call __ltsf2 |
2569 17f2 8823 tst r24 |
2570 17f4 04F4 brge .L440 |
2571 17f6 80E0 ldi r24,lo8(0x0) |
2572 17f8 90E0 ldi r25,hi8(0x0) |
2573 17fa A0E0 ldi r26,hlo8(0x0) |
2574 17fc B0E0 ldi r27,hhi8(0x0) |
2575 17fe 8093 0000 sts GyroFaktor,r24 |
2576 1802 9093 0000 sts (GyroFaktor)+1,r25 |
2577 1806 A093 0000 sts (GyroFaktor)+2,r26 |
2578 180a B093 0000 sts (GyroFaktor)+3,r27 |
2579 .L440: |
2580 180e 20E0 ldi r18,lo8(0x0) |
2581 1810 30E0 ldi r19,hi8(0x0) |
2582 1812 40E0 ldi r20,hlo8(0x0) |
2583 1814 50E0 ldi r21,hhi8(0x0) |
2584 1816 6091 0000 lds r22,IntegralFaktor |
2585 181a 7091 0000 lds r23,(IntegralFaktor)+1 |
2586 181e 8091 0000 lds r24,(IntegralFaktor)+2 |
2587 1822 9091 0000 lds r25,(IntegralFaktor)+3 |
2588 1826 0E94 0000 call __ltsf2 |
2589 182a 8823 tst r24 |
2590 182c 04F4 brge .L443 |
2591 182e 80E0 ldi r24,lo8(0x0) |
2592 1830 90E0 ldi r25,hi8(0x0) |
2593 1832 A0E0 ldi r26,hlo8(0x0) |
2594 1834 B0E0 ldi r27,hhi8(0x0) |
2595 1836 8093 0000 sts IntegralFaktor,r24 |
2596 183a 9093 0000 sts (IntegralFaktor)+1,r25 |
2597 183e A093 0000 sts (IntegralFaktor)+2,r26 |
2598 1842 B093 0000 sts (IntegralFaktor)+3,r27 |
2599 .L443: |
2600 1846 8091 0000 lds r24,Notlandung |
2601 184a 8823 tst r24 |
2602 184c 01F0 breq .L435 |
2603 184e 1092 0000 sts (StickGier)+1,__zero_reg__ |
2604 1852 1092 0000 sts StickGier,__zero_reg__ |
2605 1856 1092 0000 sts (StickNick)+1,__zero_reg__ |
2606 185a 1092 0000 sts StickNick,__zero_reg__ |
2607 185e 1092 0000 sts (StickRoll)+1,__zero_reg__ |
2608 1862 1092 0000 sts StickRoll,__zero_reg__ |
2609 1866 8DEC ldi r24,lo8(0x3dcccccd) |
2610 1868 9CEC ldi r25,hi8(0x3dcccccd) |
2611 186a ACEC ldi r26,hlo8(0x3dcccccd) |
2612 186c BDE3 ldi r27,hhi8(0x3dcccccd) |
2613 186e 8093 0000 sts GyroFaktor,r24 |
2614 1872 9093 0000 sts (GyroFaktor)+1,r25 |
2615 1876 A093 0000 sts (GyroFaktor)+2,r26 |
2616 187a B093 0000 sts (GyroFaktor)+3,r27 |
2617 187e 8AE0 ldi r24,lo8(0x3ba3d70a) |
2618 1880 97ED ldi r25,hi8(0x3ba3d70a) |
2619 1882 A3EA ldi r26,hlo8(0x3ba3d70a) |
2620 1884 BBE3 ldi r27,hhi8(0x3ba3d70a) |
2621 1886 8093 0000 sts IntegralFaktor,r24 |
2622 188a 9093 0000 sts (IntegralFaktor)+1,r25 |
2623 188e A093 0000 sts (IntegralFaktor)+2,r26 |
2624 1892 B093 0000 sts (IntegralFaktor)+3,r27 |
2625 .L435: |
2626 1896 8091 0000 lds r24,ZaehlMessungen |
2627 189a 9091 0000 lds r25,(ZaehlMessungen)+1 |
2628 189e 8D54 subi r24,lo8(333) |
2629 18a0 9140 sbci r25,hi8(333) |
2630 18a2 00F4 brsh .+2 |
2631 18a4 00C0 rjmp .L447 |
2632 18a6 2091 0000 lds r18,IntegralNick2 |
2633 18aa 3091 0000 lds r19,(IntegralNick2)+1 |
2634 18ae 4091 0000 lds r20,(IntegralNick2)+2 |
2635 18b2 5091 0000 lds r21,(IntegralNick2)+3 |
2636 18b6 8091 0000 lds r24,IntegralNick |
2637 18ba 9091 0000 lds r25,(IntegralNick)+1 |
2638 18be A091 0000 lds r26,(IntegralNick)+2 |
2639 18c2 B091 0000 lds r27,(IntegralNick)+3 |
2640 18c6 B901 movw r22,r18 |
2641 18c8 681B sub r22,r24 |
2642 18ca 790B sbc r23,r25 |
2643 18cc 7093 0000 sts (IntegralFehlerNick.2354)+1,r23 |
2644 18d0 6093 0000 sts IntegralFehlerNick.2354,r22 |
2645 18d4 2091 0000 lds r18,IntegralRoll2 |
2646 18d8 3091 0000 lds r19,(IntegralRoll2)+1 |
2647 18dc 4091 0000 lds r20,(IntegralRoll2)+2 |
2648 18e0 5091 0000 lds r21,(IntegralRoll2)+3 |
2649 18e4 8091 0000 lds r24,IntegralRoll |
2650 18e8 9091 0000 lds r25,(IntegralRoll)+1 |
2651 18ec A091 0000 lds r26,(IntegralRoll)+2 |
2652 18f0 B091 0000 lds r27,(IntegralRoll)+3 |
2653 18f4 281B sub r18,r24 |
2654 18f6 390B sbc r19,r25 |
2655 18f8 3093 0000 sts (IntegralFehlerRoll.2355)+1,r19 |
2656 18fc 2093 0000 sts IntegralFehlerRoll.2355,r18 |
2657 1900 1092 0000 sts (ZaehlMessungen)+1,__zero_reg__ |
2658 1904 1092 0000 sts ZaehlMessungen,__zero_reg__ |
2659 1908 673A cpi r22,167 |
2660 190a 7105 cpc r23,__zero_reg__ |
2661 190c 04F0 brlt .L449 |
2662 190e 8091 0000 lds r24,AdNeutralNick |
2663 1912 9091 0000 lds r25,(AdNeutralNick)+1 |
2664 1916 0196 adiw r24,1 |
2665 1918 00C0 rjmp .L576 |
2666 .L449: |
2667 191a 6A55 subi r22,lo8(-166) |
2668 191c 7F4F sbci r23,hi8(-166) |
2669 191e 04F4 brge .L451 |
2670 1920 8091 0000 lds r24,AdNeutralNick |
2671 1924 9091 0000 lds r25,(AdNeutralNick)+1 |
2672 1928 0197 sbiw r24,1 |
2673 .L576: |
2674 192a 9093 0000 sts (AdNeutralNick)+1,r25 |
2675 192e 8093 0000 sts AdNeutralNick,r24 |
2676 .L451: |
2677 1932 273A cpi r18,167 |
2678 1934 3105 cpc r19,__zero_reg__ |
2679 1936 04F0 brlt .L453 |
2680 1938 8091 0000 lds r24,AdNeutralRoll |
2681 193c 9091 0000 lds r25,(AdNeutralRoll)+1 |
2682 1940 0196 adiw r24,1 |
2683 1942 00C0 rjmp .L577 |
2684 .L453: |
2685 1944 2A55 subi r18,lo8(-166) |
2686 1946 3F4F sbci r19,hi8(-166) |
2687 1948 04F4 brge .L455 |
2688 194a 8091 0000 lds r24,AdNeutralRoll |
2689 194e 9091 0000 lds r25,(AdNeutralRoll)+1 |
2690 1952 0197 sbiw r24,1 |
2691 .L577: |
2692 1954 9093 0000 sts (AdNeutralRoll)+1,r25 |
2693 1958 8093 0000 sts AdNeutralRoll,r24 |
2694 .L455: |
2695 195c 8091 0000 lds r24,Mess_Integral_Gier2 |
2696 1960 9091 0000 lds r25,(Mess_Integral_Gier2)+1 |
2697 1964 A091 0000 lds r26,(Mess_Integral_Gier2)+2 |
2698 1968 B091 0000 lds r27,(Mess_Integral_Gier2)+3 |
2699 196c 873A cpi r24,lo8(167) |
2700 196e 9105 cpc r25,__zero_reg__ |
2701 1970 A105 cpc r26,__zero_reg__ |
2702 1972 B105 cpc r27,__zero_reg__ |
2703 1974 04F0 brlt .L457 |
2704 1976 8091 0000 lds r24,AdNeutralGier |
2705 197a 9091 0000 lds r25,(AdNeutralGier)+1 |
2706 197e 0197 sbiw r24,1 |
2707 1980 9093 0000 sts (AdNeutralGier)+1,r25 |
2708 1984 8093 0000 sts AdNeutralGier,r24 |
2709 .L457: |
2710 1988 8091 0000 lds r24,Mess_Integral_Gier2 |
2711 198c 9091 0000 lds r25,(Mess_Integral_Gier2)+1 |
2712 1990 A091 0000 lds r26,(Mess_Integral_Gier2)+2 |
2713 1994 B091 0000 lds r27,(Mess_Integral_Gier2)+3 |
2714 1998 8A55 subi r24,lo8(-166) |
2715 199a 9F4F sbci r25,hi8(-166) |
2716 199c AF4F sbci r26,hlo8(-166) |
2717 199e BF4F sbci r27,hhi8(-166) |
2718 19a0 04F4 brge .L459 |
2719 19a2 8091 0000 lds r24,AdNeutralGier |
2720 19a6 9091 0000 lds r25,(AdNeutralGier)+1 |
2721 19aa 0196 adiw r24,1 |
2722 19ac 9093 0000 sts (AdNeutralGier)+1,r25 |
2723 19b0 8093 0000 sts AdNeutralGier,r24 |
2724 .L459: |
2725 19b4 1092 7A00 sts 122,__zero_reg__ |
2726 19b8 8091 0000 lds r24,IntegralNick |
2727 19bc 9091 0000 lds r25,(IntegralNick)+1 |
2728 19c0 A091 0000 lds r26,(IntegralNick)+2 |
2729 19c4 B091 0000 lds r27,(IntegralNick)+3 |
2730 19c8 8093 0000 sts Mess_IntegralNick2,r24 |
2731 19cc 9093 0000 sts (Mess_IntegralNick2)+1,r25 |
2732 19d0 A093 0000 sts (Mess_IntegralNick2)+2,r26 |
2733 19d4 B093 0000 sts (Mess_IntegralNick2)+3,r27 |
2734 19d8 8091 0000 lds r24,IntegralRoll |
2735 19dc 9091 0000 lds r25,(IntegralRoll)+1 |
2736 19e0 A091 0000 lds r26,(IntegralRoll)+2 |
2737 19e4 B091 0000 lds r27,(IntegralRoll)+3 |
2738 19e8 8093 0000 sts Mess_IntegralRoll2,r24 |
2739 19ec 9093 0000 sts (Mess_IntegralRoll2)+1,r25 |
2740 19f0 A093 0000 sts (Mess_IntegralRoll2)+2,r26 |
2741 19f4 B093 0000 sts (Mess_IntegralRoll2)+3,r27 |
2742 19f8 8091 0000 lds r24,Integral_Gier |
2743 19fc 9091 0000 lds r25,(Integral_Gier)+1 |
2744 1a00 A091 0000 lds r26,(Integral_Gier)+2 |
2745 1a04 B091 0000 lds r27,(Integral_Gier)+3 |
2746 1a08 8093 0000 sts Mess_Integral_Gier2,r24 |
2747 1a0c 9093 0000 sts (Mess_Integral_Gier2)+1,r25 |
2748 1a10 A093 0000 sts (Mess_Integral_Gier2)+2,r26 |
2749 1a14 B093 0000 sts (Mess_Integral_Gier2)+3,r27 |
2750 1a18 8FEE ldi r24,lo8(-17) |
2751 1a1a 8093 7A00 sts 122,r24 |
2752 .L447: |
2753 1a1e 6091 0000 lds r22,IntegralNick |
2754 1a22 7091 0000 lds r23,(IntegralNick)+1 |
2755 1a26 8091 0000 lds r24,(IntegralNick)+2 |
2756 1a2a 9091 0000 lds r25,(IntegralNick)+3 |
2757 1a2e A090 0000 lds r10,EE_Parameter+20 |
2758 1a32 BB24 clr r11 |
2759 1a34 CC24 clr r12 |
2760 1a36 DD24 clr r13 |
2761 1a38 E090 0000 lds r14,Mittelwert_AccNick |
2762 1a3c F090 0000 lds r15,(Mittelwert_AccNick)+1 |
2763 1a40 A601 movw r20,r12 |
2764 1a42 9501 movw r18,r10 |
2765 1a44 0E94 0000 call __divmodsi4 |
2766 1a48 0027 clr r16 |
2767 1a4a F7FC sbrc r15,7 |
2768 1a4c 0095 com r16 |
2769 1a4e 102F mov r17,r16 |
2770 1a50 2E19 sub r18,r14 |
2771 1a52 3F09 sbc r19,r15 |
2772 1a54 400B sbc r20,r16 |
2773 1a56 510B sbc r21,r17 |
2774 1a58 CA01 movw r24,r20 |
2775 1a5a B901 movw r22,r18 |
2776 1a5c 20E1 ldi r18,lo8(16) |
2777 1a5e 30E0 ldi r19,hi8(16) |
2778 1a60 40E0 ldi r20,hlo8(16) |
2779 1a62 50E0 ldi r21,hhi8(16) |
2780 1a64 0E94 0000 call __divmodsi4 |
2781 1a68 3901 movw r6,r18 |
2782 1a6a 4A01 movw r8,r20 |
2783 1a6c 2093 0000 sts tmp_long.2352,r18 |
2784 1a70 3093 0000 sts (tmp_long.2352)+1,r19 |
2785 1a74 4093 0000 sts (tmp_long.2352)+2,r20 |
2786 1a78 5093 0000 sts (tmp_long.2352)+3,r21 |
2787 1a7c 6091 0000 lds r22,IntegralRoll |
2788 1a80 7091 0000 lds r23,(IntegralRoll)+1 |
2789 1a84 8091 0000 lds r24,(IntegralRoll)+2 |
2790 1a88 9091 0000 lds r25,(IntegralRoll)+3 |
2791 1a8c E090 0000 lds r14,Mittelwert_AccRoll |
2792 1a90 F090 0000 lds r15,(Mittelwert_AccRoll)+1 |
2793 1a94 A601 movw r20,r12 |
2794 1a96 9501 movw r18,r10 |
2795 1a98 0E94 0000 call __divmodsi4 |
2796 1a9c 0027 clr r16 |
2797 1a9e F7FC sbrc r15,7 |
2798 1aa0 0095 com r16 |
2799 1aa2 102F mov r17,r16 |
2800 1aa4 2E19 sub r18,r14 |
2801 1aa6 3F09 sbc r19,r15 |
2802 1aa8 400B sbc r20,r16 |
2803 1aaa 510B sbc r21,r17 |
2804 1aac CA01 movw r24,r20 |
2805 1aae B901 movw r22,r18 |
2806 1ab0 20E1 ldi r18,lo8(16) |
2807 1ab2 30E0 ldi r19,hi8(16) |
2808 1ab4 40E0 ldi r20,hlo8(16) |
2809 1ab6 50E0 ldi r21,hhi8(16) |
2810 1ab8 0E94 0000 call __divmodsi4 |
2811 1abc 2093 0000 sts tmp_long2.2353,r18 |
2812 1ac0 3093 0000 sts (tmp_long2.2353)+1,r19 |
2813 1ac4 4093 0000 sts (tmp_long2.2353)+2,r20 |
2814 1ac8 5093 0000 sts (tmp_long2.2353)+3,r21 |
2815 1acc F5EF ldi r31,lo8(501) |
2816 1ace 6F16 cp r6,r31 |
2817 1ad0 F1E0 ldi r31,hi8(501) |
2818 1ad2 7F06 cpc r7,r31 |
2819 1ad4 F0E0 ldi r31,hlo8(501) |
2820 1ad6 8F06 cpc r8,r31 |
2821 1ad8 F0E0 ldi r31,hhi8(501) |
2822 1ada 9F06 cpc r9,r31 |
2823 1adc 04F0 brlt .L461 |
2824 1ade 84EF ldi r24,lo8(500) |
2825 1ae0 91E0 ldi r25,hi8(500) |
2826 1ae2 A0E0 ldi r26,hlo8(500) |
2827 1ae4 B0E0 ldi r27,hhi8(500) |
2828 1ae6 00C0 rjmp .L578 |
2829 .L461: |
2830 1ae8 6CE0 ldi r22,lo8(-500) |
2831 1aea 6616 cp r6,r22 |
2832 1aec 6EEF ldi r22,hi8(-500) |
2833 1aee 7606 cpc r7,r22 |
2834 1af0 6FEF ldi r22,hlo8(-500) |
2835 1af2 8606 cpc r8,r22 |
2836 1af4 6FEF ldi r22,hhi8(-500) |
2837 1af6 9606 cpc r9,r22 |
2838 1af8 04F4 brge .L463 |
2839 1afa 8CE0 ldi r24,lo8(-500) |
2840 1afc 9EEF ldi r25,hi8(-500) |
2841 1afe AFEF ldi r26,hlo8(-500) |
2842 1b00 BFEF ldi r27,hhi8(-500) |
2843 .L578: |
2844 1b02 8093 0000 sts tmp_long.2352,r24 |
2845 1b06 9093 0000 sts (tmp_long.2352)+1,r25 |
2846 1b0a A093 0000 sts (tmp_long.2352)+2,r26 |
2847 1b0e B093 0000 sts (tmp_long.2352)+3,r27 |
2848 .L463: |
2849 1b12 253F cpi r18,lo8(501) |
2850 1b14 71E0 ldi r23,hi8(501) |
2851 1b16 3707 cpc r19,r23 |
2852 1b18 70E0 ldi r23,hlo8(501) |
2853 1b1a 4707 cpc r20,r23 |
2854 1b1c 70E0 ldi r23,hhi8(501) |
2855 1b1e 5707 cpc r21,r23 |
2856 1b20 04F0 brlt .L465 |
2857 1b22 84EF ldi r24,lo8(500) |
2858 1b24 91E0 ldi r25,hi8(500) |
2859 1b26 A0E0 ldi r26,hlo8(500) |
2860 1b28 B0E0 ldi r27,hhi8(500) |
2861 1b2a 00C0 rjmp .L579 |
2862 .L465: |
2863 1b2c 2C50 subi r18,lo8(-500) |
2864 1b2e 3E4F sbci r19,hi8(-500) |
2865 1b30 4F4F sbci r20,hlo8(-500) |
2866 1b32 5F4F sbci r21,hhi8(-500) |
2867 1b34 04F4 brge .L467 |
2868 1b36 8CE0 ldi r24,lo8(-500) |
2869 1b38 9EEF ldi r25,hi8(-500) |
2870 1b3a AFEF ldi r26,hlo8(-500) |
2871 1b3c BFEF ldi r27,hhi8(-500) |
2872 .L579: |
2873 1b3e 8093 0000 sts tmp_long2.2353,r24 |
2874 1b42 9093 0000 sts (tmp_long2.2353)+1,r25 |
2875 1b46 A093 0000 sts (tmp_long2.2353)+2,r26 |
2876 1b4a B093 0000 sts (tmp_long2.2353)+3,r27 |
2877 .L467: |
2878 1b4e 1092 7A00 sts 122,__zero_reg__ |
2879 1b52 8091 0000 lds r24,Mess_IntegralNick |
2880 1b56 9091 0000 lds r25,(Mess_IntegralNick)+1 |
2881 1b5a A091 0000 lds r26,(Mess_IntegralNick)+2 |
2882 1b5e B091 0000 lds r27,(Mess_IntegralNick)+3 |
2883 1b62 2091 0000 lds r18,tmp_long.2352 |
2884 1b66 3091 0000 lds r19,(tmp_long.2352)+1 |
2885 1b6a 4091 0000 lds r20,(tmp_long.2352)+2 |
2886 1b6e 5091 0000 lds r21,(tmp_long.2352)+3 |
2887 1b72 821B sub r24,r18 |
2888 1b74 930B sbc r25,r19 |
2889 1b76 A40B sbc r26,r20 |
2890 1b78 B50B sbc r27,r21 |
2891 1b7a 8093 0000 sts Mess_IntegralNick,r24 |
2892 1b7e 9093 0000 sts (Mess_IntegralNick)+1,r25 |
2893 1b82 A093 0000 sts (Mess_IntegralNick)+2,r26 |
2894 1b86 B093 0000 sts (Mess_IntegralNick)+3,r27 |
2895 1b8a 8091 0000 lds r24,Mess_IntegralRoll |
2896 1b8e 9091 0000 lds r25,(Mess_IntegralRoll)+1 |
2897 1b92 A091 0000 lds r26,(Mess_IntegralRoll)+2 |
2898 1b96 B091 0000 lds r27,(Mess_IntegralRoll)+3 |
2899 1b9a 2091 0000 lds r18,tmp_long2.2353 |
2900 1b9e 3091 0000 lds r19,(tmp_long2.2353)+1 |
2901 1ba2 4091 0000 lds r20,(tmp_long2.2353)+2 |
2902 1ba6 5091 0000 lds r21,(tmp_long2.2353)+3 |
2903 1baa 821B sub r24,r18 |
2904 1bac 930B sbc r25,r19 |
2905 1bae A40B sbc r26,r20 |
2906 1bb0 B50B sbc r27,r21 |
2907 1bb2 8093 0000 sts Mess_IntegralRoll,r24 |
2908 1bb6 9093 0000 sts (Mess_IntegralRoll)+1,r25 |
2909 1bba A093 0000 sts (Mess_IntegralRoll)+2,r26 |
2910 1bbe B093 0000 sts (Mess_IntegralRoll)+3,r27 |
2911 1bc2 8091 0000 lds r24,StickGier |
2912 1bc6 9091 0000 lds r25,(StickGier)+1 |
2913 1bca 5C01 movw r10,r24 |
2914 1bcc CC24 clr r12 |
2915 1bce B7FC sbrc r11,7 |
2916 1bd0 C094 com r12 |
2917 1bd2 DC2C mov r13,r12 |
2918 1bd4 A092 0000 sts sollGier.2351,r10 |
2919 1bd8 B092 0000 sts (sollGier.2351)+1,r11 |
2920 1bdc C092 0000 sts (sollGier.2351)+2,r12 |
2921 1be0 D092 0000 sts (sollGier.2351)+3,r13 |
2922 1be4 97FF sbrs r25,7 |
2923 1be6 00C0 rjmp .L470 |
2924 1be8 9095 com r25 |
2925 1bea 8195 neg r24 |
2926 1bec 9F4F sbci r25,lo8(-1) |
2927 .L470: |
2928 1bee 8497 sbiw r24,36 |
2929 1bf0 04F0 brlt .L469 |
2930 1bf2 8091 0000 lds r24,EE_Parameter+8 |
2931 1bf6 84FD sbrc r24,4 |
2932 1bf8 00C0 rjmp .L469 |
2933 1bfa 81E0 ldi r24,lo8(1) |
2934 1bfc 8093 0000 sts NeueKompassRichtungMerken.2363,r24 |
2935 .L469: |
2936 1c00 6090 0000 lds r6,Mess_Integral_Gier |
2937 1c04 7090 0000 lds r7,(Mess_Integral_Gier)+1 |
2938 1c08 8090 0000 lds r8,(Mess_Integral_Gier)+2 |
2939 1c0c 9090 0000 lds r9,(Mess_Integral_Gier)+3 |
2940 1c10 C501 movw r24,r10 |
2941 1c12 B7FE sbrs r11,7 |
2942 1c14 00C0 rjmp .L473 |
2943 1c16 9095 com r25 |
2944 1c18 8195 neg r24 |
2945 1c1a 9F4F sbci r25,lo8(-1) |
2946 .L473: |
2947 1c1c 7C01 movw r14,r24 |
2948 1c1e 0027 clr r16 |
2949 1c20 F7FC sbrc r15,7 |
2950 1c22 0095 com r16 |
2951 1c24 102F mov r17,r16 |
2952 1c26 2091 0000 lds r18,EE_Parameter+17 |
2953 1c2a 3327 clr r19 |
2954 1c2c 4427 clr r20 |
2955 1c2e 5527 clr r21 |
2956 1c30 C601 movw r24,r12 |
2957 1c32 B501 movw r22,r10 |
2958 1c34 0E94 0000 call __mulsi3 |
2959 1c38 9B01 movw r18,r22 |
2960 1c3a AC01 movw r20,r24 |
2961 1c3c C801 movw r24,r16 |
2962 1c3e B701 movw r22,r14 |
2963 1c40 0E94 0000 call __mulsi3 |
2964 1c44 20E0 ldi r18,lo8(256) |
2965 1c46 31E0 ldi r19,hi8(256) |
2966 1c48 40E0 ldi r20,hlo8(256) |
2967 1c4a 50E0 ldi r21,hhi8(256) |
2968 1c4c 0E94 0000 call __divmodsi4 |
2969 1c50 4427 clr r20 |
2970 1c52 37FD sbrc r19,7 |
2971 1c54 4095 com r20 |
2972 1c56 542F mov r21,r20 |
2973 1c58 621A sub r6,r18 |
2974 1c5a 730A sbc r7,r19 |
2975 1c5c 840A sbc r8,r20 |
2976 1c5e 950A sbc r9,r21 |
2977 1c60 6092 0000 sts Mess_Integral_Gier,r6 |
2978 1c64 7092 0000 sts (Mess_Integral_Gier)+1,r7 |
2979 1c68 8092 0000 sts (Mess_Integral_Gier)+2,r8 |
2980 1c6c 9092 0000 sts (Mess_Integral_Gier)+3,r9 |
2981 1c70 8091 0000 lds r24,Mess_Integral_Gier |
2982 1c74 9091 0000 lds r25,(Mess_Integral_Gier)+1 |
2983 1c78 A091 0000 lds r26,(Mess_Integral_Gier)+2 |
2984 1c7c B091 0000 lds r27,(Mess_Integral_Gier)+3 |
2985 1c80 8153 subi r24,lo8(30001) |
2986 1c82 9547 sbci r25,hi8(30001) |
2987 1c84 A040 sbci r26,hlo8(30001) |
2988 1c86 B040 sbci r27,hhi8(30001) |
2989 1c88 04F0 brlt .L474 |
2990 1c8a 80E3 ldi r24,lo8(30000) |
2991 1c8c 95E7 ldi r25,hi8(30000) |
2992 1c8e A0E0 ldi r26,hlo8(30000) |
2993 1c90 B0E0 ldi r27,hhi8(30000) |
2994 1c92 8093 0000 sts Mess_Integral_Gier,r24 |
2995 1c96 9093 0000 sts (Mess_Integral_Gier)+1,r25 |
2996 1c9a A093 0000 sts (Mess_Integral_Gier)+2,r26 |
2997 1c9e B093 0000 sts (Mess_Integral_Gier)+3,r27 |
2998 .L474: |
2999 1ca2 8091 0000 lds r24,Mess_Integral_Gier |
3000 1ca6 9091 0000 lds r25,(Mess_Integral_Gier)+1 |
3001 1caa A091 0000 lds r26,(Mess_Integral_Gier)+2 |
3002 1cae B091 0000 lds r27,(Mess_Integral_Gier)+3 |
3003 1cb2 805D subi r24,lo8(-30000) |
3004 1cb4 9A48 sbci r25,hi8(-30000) |
3005 1cb6 AF4F sbci r26,hlo8(-30000) |
3006 1cb8 BF4F sbci r27,hhi8(-30000) |
3007 1cba 04F4 brge .L476 |
3008 1cbc 80ED ldi r24,lo8(-30000) |
3009 1cbe 9AE8 ldi r25,hi8(-30000) |
3010 1cc0 AFEF ldi r26,hlo8(-30000) |
3011 1cc2 BFEF ldi r27,hhi8(-30000) |
3012 1cc4 8093 0000 sts Mess_Integral_Gier,r24 |
3013 1cc8 9093 0000 sts (Mess_Integral_Gier)+1,r25 |
3014 1ccc A093 0000 sts (Mess_Integral_Gier)+2,r26 |
3015 1cd0 B093 0000 sts (Mess_Integral_Gier)+3,r27 |
3016 .L476: |
3017 1cd4 8FEE ldi r24,lo8(-17) |
3018 1cd6 8093 7A00 sts 122,r24 |
3019 1cda 8091 0000 lds r24,KompassValue |
3020 1cde 9091 0000 lds r25,(KompassValue)+1 |
3021 1ce2 892B or r24,r25 |
3022 1ce4 01F4 brne .+2 |
3023 1ce6 00C0 rjmp .L478 |
3024 1ce8 8091 0000 lds r24,EE_Parameter+8 |
3025 1cec 83FF sbrs r24,3 |
3026 1cee 00C0 rjmp .L478 |
3027 1cf0 6091 0000 lds r22,IntegralNick |
3028 1cf4 7091 0000 lds r23,(IntegralNick)+1 |
3029 1cf8 8091 0000 lds r24,(IntegralNick)+2 |
3030 1cfc 9091 0000 lds r25,(IntegralNick)+3 |
3031 1d00 20E0 ldi r18,lo8(512) |
3032 1d02 32E0 ldi r19,hi8(512) |
3033 1d04 40E0 ldi r20,hlo8(512) |
3034 1d06 50E0 ldi r21,hhi8(512) |
3035 1d08 0E94 0000 call __divmodsi4 |
3036 1d0c 8901 movw r16,r18 |
3037 1d0e 37FF sbrs r19,7 |
3038 1d10 00C0 rjmp .L481 |
3039 1d12 1095 com r17 |
3040 1d14 0195 neg r16 |
3041 1d16 1F4F sbci r17,lo8(-1) |
3042 .L481: |
3043 1d18 6091 0000 lds r22,IntegralRoll |
3044 1d1c 7091 0000 lds r23,(IntegralRoll)+1 |
3045 1d20 8091 0000 lds r24,(IntegralRoll)+2 |
3046 1d24 9091 0000 lds r25,(IntegralRoll)+3 |
3047 1d28 20E0 ldi r18,lo8(512) |
3048 1d2a 32E0 ldi r19,hi8(512) |
3049 1d2c 40E0 ldi r20,hlo8(512) |
3050 1d2e 50E0 ldi r21,hhi8(512) |
3051 1d30 0E94 0000 call __divmodsi4 |
3052 1d34 B901 movw r22,r18 |
3053 1d36 37FF sbrs r19,7 |
3054 1d38 00C0 rjmp .L482 |
3055 1d3a 7095 com r23 |
3056 1d3c 6195 neg r22 |
3057 1d3e 7F4F sbci r23,lo8(-1) |
3058 .L482: |
3059 1d40 6017 cp r22,r16 |
3060 1d42 7107 cpc r23,r17 |
3061 1d44 04F4 brge .L483 |
3062 1d46 B801 movw r22,r16 |
3063 .L483: |
3064 1d48 6931 cpi r22,25 |
3065 1d4a 7105 cpc r23,__zero_reg__ |
3066 1d4c 04F4 brge .L484 |
3067 1d4e 8091 0000 lds r24,NeueKompassRichtungMerken.2363 |
3068 1d52 8823 tst r24 |
3069 1d54 01F0 breq .L484 |
3070 1d56 8091 0000 lds r24,SignalSchlecht.2367 |
3071 1d5a 9091 0000 lds r25,(SignalSchlecht.2367)+1 |
3072 1d5e 892B or r24,r25 |
3073 1d60 01F4 brne .L484 |
3074 1d62 8091 0000 lds r24,KompassValue |
3075 1d66 9091 0000 lds r25,(KompassValue)+1 |
3076 1d6a 9093 0000 sts (KompassStartwert)+1,r25 |
3077 1d6e 8093 0000 sts KompassStartwert,r24 |
3078 1d72 1092 0000 sts NeueKompassRichtungMerken.2363,__zero_reg__ |
3079 .L484: |
3080 1d76 2091 0000 lds r18,Parameter_KompassWirkung |
3081 1d7a 3327 clr r19 |
3082 1d7c 629F mul r22,r18 |
3083 1d7e C001 movw r24,r0 |
3084 1d80 639F mul r22,r19 |
3085 1d82 900D add r25,r0 |
3086 1d84 729F mul r23,r18 |
3087 1d86 900D add r25,r0 |
3088 1d88 1124 clr r1 |
3089 1d8a 60E4 ldi r22,lo8(64) |
3090 1d8c 70E0 ldi r23,hi8(64) |
3091 1d8e 0E94 0000 call __divmodhi4 |
3092 1d92 A901 movw r20,r18 |
3093 1d94 461B sub r20,r22 |
3094 1d96 570B sbc r21,r23 |
3095 1d98 1416 cp __zero_reg__,r20 |
3096 1d9a 1506 cpc __zero_reg__,r21 |
3097 1d9c 04F0 brlt .+2 |
3098 1d9e 00C0 rjmp .L488 |
3099 1da0 1092 7A00 sts 122,__zero_reg__ |
3100 1da4 2091 0000 lds r18,SignalSchlecht.2367 |
3101 1da8 3091 0000 lds r19,(SignalSchlecht.2367)+1 |
3102 1dac 2115 cp r18,__zero_reg__ |
3103 1dae 3105 cpc r19,__zero_reg__ |
3104 1db0 01F4 brne .L490 |
3105 1db2 0091 0000 lds r16,Mess_Integral_Gier |
3106 1db6 1091 0000 lds r17,(Mess_Integral_Gier)+1 |
3107 1dba 2091 0000 lds r18,(Mess_Integral_Gier)+2 |
3108 1dbe 3091 0000 lds r19,(Mess_Integral_Gier)+3 |
3109 1dc2 8091 0000 lds r24,KompassRichtung |
3110 1dc6 9091 0000 lds r25,(KompassRichtung)+1 |
3111 1dca BC01 movw r22,r24 |
3112 1dcc 649F mul r22,r20 |
3113 1dce C001 movw r24,r0 |
3114 1dd0 659F mul r22,r21 |
3115 1dd2 900D add r25,r0 |
3116 1dd4 749F mul r23,r20 |
3117 1dd6 900D add r25,r0 |
3118 1dd8 1124 clr r1 |
3119 1dda 60E2 ldi r22,lo8(32) |
3120 1ddc 70E0 ldi r23,hi8(32) |
3121 1dde 0E94 0000 call __divmodhi4 |
3122 1de2 8827 clr r24 |
3123 1de4 77FD sbrc r23,7 |
3124 1de6 8095 com r24 |
3125 1de8 982F mov r25,r24 |
3126 1dea 060F add r16,r22 |
3127 1dec 171F adc r17,r23 |
3128 1dee 281F adc r18,r24 |
3129 1df0 391F adc r19,r25 |
3130 1df2 0093 0000 sts Mess_Integral_Gier,r16 |
3131 1df6 1093 0000 sts (Mess_Integral_Gier)+1,r17 |
3132 1dfa 2093 0000 sts (Mess_Integral_Gier)+2,r18 |
3133 1dfe 3093 0000 sts (Mess_Integral_Gier)+3,r19 |
3134 1e02 8FEE ldi r24,lo8(-17) |
3135 1e04 8093 7A00 sts 122,r24 |
3136 1e08 00C0 rjmp .L478 |
3137 .L490: |
3138 1e0a 8FEE ldi r24,lo8(-17) |
3139 1e0c 8093 7A00 sts 122,r24 |
3140 1e10 2150 subi r18,lo8(-(-1)) |
3141 1e12 3040 sbci r19,hi8(-(-1)) |
3142 1e14 3093 0000 sts (SignalSchlecht.2367)+1,r19 |
3143 1e18 2093 0000 sts SignalSchlecht.2367,r18 |
3144 1e1c 00C0 rjmp .L478 |
3145 .L488: |
3146 1e1e 84EF ldi r24,lo8(500) |
3147 1e20 91E0 ldi r25,hi8(500) |
3148 1e22 9093 0000 sts (SignalSchlecht.2367)+1,r25 |
3149 1e26 8093 0000 sts SignalSchlecht.2367,r24 |
3150 .L478: |
3151 1e2a 8091 0000 lds r24,EE_Parameter+8 |
3152 1e2e 85FF sbrs r24,5 |
3153 1e30 00C0 rjmp .L492 |
3154 1e32 8091 0000 lds r24,Parameter_UserParam1 |
3155 1e36 9927 clr r25 |
3156 1e38 9093 0000 sts (gps_p)+1,r25 |
3157 1e3c 8093 0000 sts gps_p,r24 |
3158 1e40 8091 0000 lds r24,Parameter_UserParam2 |
3159 1e44 9927 clr r25 |
3160 1e46 9093 0000 sts (gps_d)+1,r25 |
3161 1e4a 8093 0000 sts gps_d,r24 |
3162 1e4e 8091 0000 lds r24,Parameter_UserParam3 |
3163 1e52 9927 clr r25 |
3164 1e54 9093 0000 sts (skal)+1,r25 |
3165 1e58 8093 0000 sts skal,r24 |
3166 1e5c 0E94 0000 call gps_main |
3167 1e60 00C0 rjmp .L494 |
3168 .L492: |
3169 1e62 1092 0000 sts (GPS_Nick)+1,__zero_reg__ |
3170 1e66 1092 0000 sts GPS_Nick,__zero_reg__ |
3171 1e6a 1092 0000 sts (GPS_Roll)+1,__zero_reg__ |
3172 1e6e 1092 0000 sts GPS_Roll,__zero_reg__ |
3173 .L494: |
3174 1e72 8091 0000 lds r24,DebugOut+17 |
3175 1e76 8F5F subi r24,lo8(-(1)) |
3176 1e78 8093 0000 sts DebugOut+17,r24 |
3177 1e7c 8091 0000 lds r24,TimerWerteausgabe.2362 |
3178 1e80 8150 subi r24,lo8(-(-1)) |
3179 1e82 8093 0000 sts TimerWerteausgabe.2362,r24 |
3180 1e86 8F3F cpi r24,lo8(-1) |
3181 1e88 01F0 breq .+2 |
3182 1e8a 00C0 rjmp .L495 |
3183 1e8c 81E3 ldi r24,lo8(49) |
3184 1e8e 8093 0000 sts TimerWerteausgabe.2362,r24 |
3185 1e92 6091 0000 lds r22,IntegralNick |
3186 1e96 7091 0000 lds r23,(IntegralNick)+1 |
3187 1e9a 8091 0000 lds r24,(IntegralNick)+2 |
3188 1e9e 9091 0000 lds r25,(IntegralNick)+3 |
3189 1ea2 E090 0000 lds r14,EE_Parameter+20 |
3190 1ea6 FF24 clr r15 |
3191 1ea8 0027 clr r16 |
3192 1eaa 1127 clr r17 |
3193 1eac A801 movw r20,r16 |
3194 1eae 9701 movw r18,r14 |
3195 1eb0 0E94 0000 call __divmodsi4 |
3196 1eb4 3093 0000 sts (DebugOut+18)+1,r19 |
3197 1eb8 2093 0000 sts DebugOut+18,r18 |
3198 1ebc 6091 0000 lds r22,IntegralRoll |
3199 1ec0 7091 0000 lds r23,(IntegralRoll)+1 |
3200 1ec4 8091 0000 lds r24,(IntegralRoll)+2 |
3201 1ec8 9091 0000 lds r25,(IntegralRoll)+3 |
3202 1ecc A801 movw r20,r16 |
3203 1ece 9701 movw r18,r14 |
3204 1ed0 0E94 0000 call __divmodsi4 |
3205 1ed4 3093 0000 sts (DebugOut+20)+1,r19 |
3206 1ed8 2093 0000 sts DebugOut+20,r18 |
3207 1edc 8091 0000 lds r24,Mittelwert_AccNick |
3208 1ee0 9091 0000 lds r25,(Mittelwert_AccNick)+1 |
3209 1ee4 9093 0000 sts (DebugOut+22)+1,r25 |
3210 1ee8 8093 0000 sts DebugOut+22,r24 |
3211 1eec 8091 0000 lds r24,Mittelwert_AccRoll |
3212 1ef0 9091 0000 lds r25,(Mittelwert_AccRoll)+1 |
3213 1ef4 9093 0000 sts (DebugOut+24)+1,r25 |
3214 1ef8 8093 0000 sts DebugOut+24,r24 |
3215 1efc 8091 0000 lds r24,MesswertGier |
3216 1f00 9091 0000 lds r25,(MesswertGier)+1 |
3217 1f04 9093 0000 sts (DebugOut+26)+1,r25 |
3218 1f08 8093 0000 sts DebugOut+26,r24 |
3219 1f0c 8091 0000 lds r24,HoehenWert |
3220 1f10 9091 0000 lds r25,(HoehenWert)+1 |
3221 1f14 9093 0000 sts (DebugOut+28)+1,r25 |
3222 1f18 8093 0000 sts DebugOut+28,r24 |
3223 1f1c 6091 0000 lds r22,Mess_Integral_Hoch |
3224 1f20 7091 0000 lds r23,(Mess_Integral_Hoch)+1 |
3225 1f24 8091 0000 lds r24,(Mess_Integral_Hoch)+2 |
3226 1f28 9091 0000 lds r25,(Mess_Integral_Hoch)+3 |
3227 1f2c 20E0 ldi r18,lo8(512) |
3228 1f2e 32E0 ldi r19,hi8(512) |
3229 1f30 40E0 ldi r20,hlo8(512) |
3230 1f32 50E0 ldi r21,hhi8(512) |
3231 1f34 0E94 0000 call __divmodsi4 |
3232 1f38 3093 0000 sts (DebugOut+30)+1,r19 |
3233 1f3c 2093 0000 sts DebugOut+30,r18 |
3234 1f40 8981 ldd r24,Y+1 |
3235 1f42 9A81 ldd r25,Y+2 |
3236 1f44 9093 0000 sts (DebugOut+32)+1,r25 |
3237 1f48 8093 0000 sts DebugOut+32,r24 |
3238 1f4c 8091 0000 lds r24,KompassValue |
3239 1f50 9091 0000 lds r25,(KompassValue)+1 |
3240 1f54 9093 0000 sts (DebugOut+34)+1,r25 |
3241 1f58 8093 0000 sts DebugOut+34,r24 |
3242 .L495: |
3243 1f5c 6091 0000 lds r22,IntegralNick |
3244 1f60 7091 0000 lds r23,(IntegralNick)+1 |
3245 1f64 8091 0000 lds r24,(IntegralNick)+2 |
3246 1f68 9091 0000 lds r25,(IntegralNick)+3 |
3247 1f6c 2090 0000 lds r2,IntegralFaktor |
3248 1f70 3090 0000 lds r3,(IntegralFaktor)+1 |
3249 1f74 4090 0000 lds r4,(IntegralFaktor)+2 |
3250 1f78 5090 0000 lds r5,(IntegralFaktor)+3 |
3251 1f7c E090 0000 lds r14,MesswertNick |
3252 1f80 F090 0000 lds r15,(MesswertNick)+1 |
3253 1f84 6090 0000 lds r6,GyroFaktor |
3254 1f88 7090 0000 lds r7,(GyroFaktor)+1 |
3255 1f8c 8090 0000 lds r8,(GyroFaktor)+2 |
3256 1f90 9090 0000 lds r9,(GyroFaktor)+3 |
3257 1f94 0E94 0000 call __floatsisf |
3258 1f98 A201 movw r20,r4 |
3259 1f9a 9101 movw r18,r2 |
3260 1f9c 0E94 0000 call __mulsf3 |
3261 1fa0 5B01 movw r10,r22 |
3262 1fa2 6C01 movw r12,r24 |
3263 1fa4 0027 clr r16 |
3264 1fa6 F7FC sbrc r15,7 |
3265 1fa8 0095 com r16 |
3266 1faa 102F mov r17,r16 |
3267 1fac C801 movw r24,r16 |
3268 1fae B701 movw r22,r14 |
3269 1fb0 0E94 0000 call __floatsisf |
3270 1fb4 A401 movw r20,r8 |
3271 1fb6 9301 movw r18,r6 |
3272 1fb8 0E94 0000 call __mulsf3 |
3273 1fbc 9B01 movw r18,r22 |
3274 1fbe AC01 movw r20,r24 |
3275 1fc0 C601 movw r24,r12 |
3276 1fc2 B501 movw r22,r10 |
3277 1fc4 0E94 0000 call __addsf3 |
3278 1fc8 0E94 0000 call __fixsfsi |
3279 1fcc 7093 0000 sts (MesswertNick)+1,r23 |
3280 1fd0 6093 0000 sts MesswertNick,r22 |
3281 1fd4 6091 0000 lds r22,IntegralRoll |
3282 1fd8 7091 0000 lds r23,(IntegralRoll)+1 |
3283 1fdc 8091 0000 lds r24,(IntegralRoll)+2 |
3284 1fe0 9091 0000 lds r25,(IntegralRoll)+3 |
3285 1fe4 E090 0000 lds r14,MesswertRoll |
3286 1fe8 F090 0000 lds r15,(MesswertRoll)+1 |
3287 1fec 0E94 0000 call __floatsisf |
3288 1ff0 A201 movw r20,r4 |
3289 1ff2 9101 movw r18,r2 |
3290 1ff4 0E94 0000 call __mulsf3 |
3291 1ff8 5B01 movw r10,r22 |
3292 1ffa 6C01 movw r12,r24 |
3293 1ffc 0027 clr r16 |
3294 1ffe F7FC sbrc r15,7 |
3295 2000 0095 com r16 |
3296 2002 102F mov r17,r16 |
3297 2004 C801 movw r24,r16 |
3298 2006 B701 movw r22,r14 |
3299 2008 0E94 0000 call __floatsisf |
3300 200c A401 movw r20,r8 |
3301 200e 9301 movw r18,r6 |
3302 2010 0E94 0000 call __mulsf3 |
3303 2014 9B01 movw r18,r22 |
3304 2016 AC01 movw r20,r24 |
3305 2018 C601 movw r24,r12 |
3306 201a B501 movw r22,r10 |
3307 201c 0E94 0000 call __addsf3 |
3308 2020 0E94 0000 call __fixsfsi |
3309 2024 7093 0000 sts (MesswertRoll)+1,r23 |
3310 2028 6093 0000 sts MesswertRoll,r22 |
3311 202c 6091 0000 lds r22,MesswertGier |
3312 2030 7091 0000 lds r23,(MesswertGier)+1 |
3313 2034 A090 0000 lds r10,Integral_Gier |
3314 2038 B090 0000 lds r11,(Integral_Gier)+1 |
3315 203c C090 0000 lds r12,(Integral_Gier)+2 |
3316 2040 D090 0000 lds r13,(Integral_Gier)+3 |
3317 2044 8827 clr r24 |
3318 2046 77FD sbrc r23,7 |
3319 2048 8095 com r24 |
3320 204a 982F mov r25,r24 |
3321 204c 0E94 0000 call __floatsisf |
3322 2050 7B01 movw r14,r22 |
3323 2052 8C01 movw r16,r24 |
3324 2054 20E0 ldi r18,lo8(0x3f000000) |
3325 2056 30E0 ldi r19,hi8(0x3f000000) |
3326 2058 40E0 ldi r20,hlo8(0x3f000000) |
3327 205a 5FE3 ldi r21,hhi8(0x3f000000) |
3328 205c C401 movw r24,r8 |
3329 205e B301 movw r22,r6 |
3330 2060 0E94 0000 call __mulsf3 |
3331 2064 9B01 movw r18,r22 |
3332 2066 AC01 movw r20,r24 |
3333 2068 C801 movw r24,r16 |
3334 206a B701 movw r22,r14 |
3335 206c 0E94 0000 call __mulsf3 |
3336 2070 7B01 movw r14,r22 |
3337 2072 8C01 movw r16,r24 |
3338 2074 C601 movw r24,r12 |
3339 2076 B501 movw r22,r10 |
3340 2078 0E94 0000 call __floatsisf |
3341 207c A201 movw r20,r4 |
3342 207e 9101 movw r18,r2 |
3343 2080 0E94 0000 call __mulsf3 |
3344 2084 9B01 movw r18,r22 |
3345 2086 AC01 movw r20,r24 |
3346 2088 C801 movw r24,r16 |
3347 208a B701 movw r22,r14 |
3348 208c 0E94 0000 call __addsf3 |
3349 2090 0E94 0000 call __fixsfsi |
3350 2094 7093 0000 sts (MesswertGier)+1,r23 |
3351 2098 6093 0000 sts MesswertGier,r22 |
3352 209c 8091 0000 lds r24,MesswertNick |
3353 20a0 9091 0000 lds r25,(MesswertNick)+1 |
3354 20a4 8150 subi r24,lo8(2049) |
3355 20a6 9840 sbci r25,hi8(2049) |
3356 20a8 04F0 brlt .L497 |
3357 20aa 80E0 ldi r24,lo8(2048) |
3358 20ac 98E0 ldi r25,hi8(2048) |
3359 20ae 9093 0000 sts (MesswertNick)+1,r25 |
3360 20b2 8093 0000 sts MesswertNick,r24 |
3361 .L497: |
3362 20b6 8091 0000 lds r24,MesswertNick |
3363 20ba 9091 0000 lds r25,(MesswertNick)+1 |
3364 20be 8050 subi r24,lo8(-2048) |
3365 20c0 984F sbci r25,hi8(-2048) |
3366 20c2 04F4 brge .L499 |
3367 20c4 80E0 ldi r24,lo8(-2048) |
3368 20c6 98EF ldi r25,hi8(-2048) |
3369 20c8 9093 0000 sts (MesswertNick)+1,r25 |
3370 20cc 8093 0000 sts MesswertNick,r24 |
3371 .L499: |
3372 20d0 8091 0000 lds r24,MesswertRoll |
3373 20d4 9091 0000 lds r25,(MesswertRoll)+1 |
3374 20d8 8150 subi r24,lo8(2049) |
3375 20da 9840 sbci r25,hi8(2049) |
3376 20dc 04F0 brlt .L501 |
3377 20de 80E0 ldi r24,lo8(2048) |
3378 20e0 98E0 ldi r25,hi8(2048) |
3379 20e2 9093 0000 sts (MesswertRoll)+1,r25 |
3380 20e6 8093 0000 sts MesswertRoll,r24 |
3381 .L501: |
3382 20ea 8091 0000 lds r24,MesswertRoll |
3383 20ee 9091 0000 lds r25,(MesswertRoll)+1 |
3384 20f2 8050 subi r24,lo8(-2048) |
3385 20f4 984F sbci r25,hi8(-2048) |
3386 20f6 04F4 brge .L503 |
3387 20f8 80E0 ldi r24,lo8(-2048) |
3388 20fa 98EF ldi r25,hi8(-2048) |
3389 20fc 9093 0000 sts (MesswertRoll)+1,r25 |
3390 2100 8093 0000 sts MesswertRoll,r24 |
3391 .L503: |
3392 2104 8091 0000 lds r24,MesswertGier |
3393 2108 9091 0000 lds r25,(MesswertGier)+1 |
3394 210c 8150 subi r24,lo8(2049) |
3395 210e 9840 sbci r25,hi8(2049) |
3396 2110 04F0 brlt .L505 |
3397 2112 80E0 ldi r24,lo8(2048) |
3398 2114 98E0 ldi r25,hi8(2048) |
3399 2116 9093 0000 sts (MesswertGier)+1,r25 |
3400 211a 8093 0000 sts MesswertGier,r24 |
3401 .L505: |
3402 211e 8091 0000 lds r24,MesswertGier |
3403 2122 9091 0000 lds r25,(MesswertGier)+1 |
3404 2126 8050 subi r24,lo8(-2048) |
3405 2128 984F sbci r25,hi8(-2048) |
3406 212a 04F4 brge .L507 |
3407 212c 80E0 ldi r24,lo8(-2048) |
3408 212e 98EF ldi r25,hi8(-2048) |
3409 2130 9093 0000 sts (MesswertGier)+1,r25 |
3410 2134 8093 0000 sts MesswertGier,r24 |
3411 .L507: |
3412 2138 8091 0000 lds r24,EE_Parameter+8 |
3413 213c 9927 clr r25 |
3414 213e 80FF sbrs r24,0 |
3415 2140 00C0 rjmp .L509 |
3416 2142 2091 0000 lds r18,Parameter_MaxHoehe |
3417 2146 81FF sbrs r24,1 |
3418 2148 00C0 rjmp .L511 |
3419 214a 2233 cpi r18,lo8(50) |
3420 214c 00F4 brsh .L580 |
3421 214e 8091 0000 lds r24,HoehenWert |
3422 2152 9091 0000 lds r25,(HoehenWert)+1 |
3423 2156 4497 sbiw r24,20 |
3424 2158 9093 0000 sts (SollHoehe)+1,r25 |
3425 215c 8093 0000 sts SollHoehe,r24 |
3426 2160 1092 0000 sts HoehenReglerAktiv,__zero_reg__ |
3427 2164 00C0 rjmp .L515 |
3428 .L511: |
3429 2166 8091 0000 lds r24,EE_Parameter+13 |
3430 216a 289F mul r18,r24 |
3431 216c C001 movw r24,r0 |
3432 216e 1124 clr r1 |
3433 2170 4497 sbiw r24,20 |
3434 2172 9093 0000 sts (SollHoehe)+1,r25 |
3435 2176 8093 0000 sts SollHoehe,r24 |
3436 .L580: |
3437 217a 81E0 ldi r24,lo8(1) |
3438 217c 8093 0000 sts HoehenReglerAktiv,r24 |
3439 .L515: |
3440 2180 8091 0000 lds r24,Notlandung |
3441 2184 8823 tst r24 |
3442 2186 01F0 breq .L516 |
3443 2188 1092 0000 sts (SollHoehe)+1,__zero_reg__ |
3444 218c 1092 0000 sts SollHoehe,__zero_reg__ |
3445 .L516: |
3446 2190 2091 0000 lds r18,HoehenWert |
3447 2194 3091 0000 lds r19,(HoehenWert)+1 |
3448 2198 4091 0000 lds r20,SollHoehe |
3449 219c 5091 0000 lds r21,(SollHoehe)+1 |
3450 21a0 4217 cp r20,r18 |
3451 21a2 5307 cpc r21,r19 |
3452 21a4 04F0 brlt .+2 |
3453 21a6 00C0 rjmp .L509 |
3454 21a8 8091 0000 lds r24,HoehenReglerAktiv |
3455 21ac 8823 tst r24 |
3456 21ae 01F4 brne .+2 |
3457 21b0 00C0 rjmp .L509 |
3458 21b2 241B sub r18,r20 |
3459 21b4 350B sbc r19,r21 |
3460 21b6 8091 0000 lds r24,Parameter_Hoehe_P |
3461 21ba 9927 clr r25 |
3462 21bc BC01 movw r22,r24 |
3463 21be 269F mul r18,r22 |
3464 21c0 C001 movw r24,r0 |
3465 21c2 279F mul r18,r23 |
3466 21c4 900D add r25,r0 |
3467 21c6 369F mul r19,r22 |
3468 21c8 900D add r25,r0 |
3469 21ca 1124 clr r1 |
3470 21cc 60E1 ldi r22,lo8(16) |
3471 21ce 70E0 ldi r23,hi8(16) |
3472 21d0 0E94 0000 call __divmodhi4 |
3473 21d4 0981 ldd r16,Y+1 |
3474 21d6 1A81 ldd r17,Y+2 |
3475 21d8 061B sub r16,r22 |
3476 21da 170B sbc r17,r23 |
3477 21dc 2091 0000 lds r18,HoeheD |
3478 21e0 3091 0000 lds r19,(HoeheD)+1 |
3479 21e4 8091 0000 lds r24,Parameter_Luftdruck_D |
3480 21e8 9927 clr r25 |
3481 21ea FC01 movw r30,r24 |
3482 21ec 2E9F mul r18,r30 |
3483 21ee C001 movw r24,r0 |
3484 21f0 2F9F mul r18,r31 |
3485 21f2 900D add r25,r0 |
3486 21f4 3E9F mul r19,r30 |
3487 21f6 900D add r25,r0 |
3488 21f8 1124 clr r1 |
3489 21fa 68E0 ldi r22,lo8(8) |
3490 21fc 70E0 ldi r23,hi8(8) |
3491 21fe 0E94 0000 call __divmodhi4 |
3492 2202 061B sub r16,r22 |
3493 2204 170B sbc r17,r23 |
3494 2206 6091 0000 lds r22,Mess_Integral_Hoch |
3495 220a 7091 0000 lds r23,(Mess_Integral_Hoch)+1 |
3496 220e 8091 0000 lds r24,(Mess_Integral_Hoch)+2 |
3497 2212 9091 0000 lds r25,(Mess_Integral_Hoch)+3 |
3498 2216 20E0 ldi r18,lo8(512) |
3499 2218 32E0 ldi r19,hi8(512) |
3500 221a 40E0 ldi r20,hlo8(512) |
3501 221c 50E0 ldi r21,hhi8(512) |
3502 221e 0E94 0000 call __divmodsi4 |
3503 2222 CA01 movw r24,r20 |
3504 2224 B901 movw r22,r18 |
3505 2226 2091 0000 lds r18,Parameter_Hoehe_ACC_Wirkung |
3506 222a 3327 clr r19 |
3507 222c 4427 clr r20 |
3508 222e 5527 clr r21 |
3509 2230 0E94 0000 call __mulsi3 |
3510 2234 20E2 ldi r18,lo8(32) |
3511 2236 30E0 ldi r19,hi8(32) |
3512 2238 40E0 ldi r20,hlo8(32) |
3513 223a 50E0 ldi r21,hhi8(32) |
3514 223c 0E94 0000 call __divmodsi4 |
3515 2240 FFEF ldi r31,hi8(-50) |
3516 2242 2E3C cpi r18,lo8(-50) |
3517 2244 3F07 cpc r19,r31 |
3518 2246 04F4 brge .L520 |
3519 2248 2EEC ldi r18,lo8(-50) |
3520 224a 3FEF ldi r19,hi8(-50) |
3521 .L520: |
3522 224c 8091 0000 lds r24,hoehenregler.2361 |
3523 2250 9091 0000 lds r25,(hoehenregler.2361)+1 |
3524 2254 AC01 movw r20,r24 |
3525 2256 74E0 ldi r23,4 |
3526 2258 440F 1: lsl r20 |
3527 225a 551F rol r21 |
3528 225c 7A95 dec r23 |
3529 225e 01F4 brne 1b |
3530 2260 481B sub r20,r24 |
3531 2262 590B sbc r21,r25 |
3532 2264 2333 cpi r18,51 |
3533 2266 3105 cpc r19,__zero_reg__ |
3534 2268 04F0 brlt .L521 |
3535 226a 22E3 ldi r18,lo8(50) |
3536 226c 30E0 ldi r19,hi8(50) |
3537 .L521: |
3538 226e 021B sub r16,r18 |
3539 2270 130B sbc r17,r19 |
3540 2272 CA01 movw r24,r20 |
3541 2274 800F add r24,r16 |
3542 2276 911F adc r25,r17 |
3543 2278 60E1 ldi r22,lo8(16) |
3544 227a 70E0 ldi r23,hi8(16) |
3545 227c 0E94 0000 call __divmodhi4 |
3546 2280 7093 0000 sts (hoehenregler.2361)+1,r23 |
3547 2284 6093 0000 sts hoehenregler.2361,r22 |
3548 2288 8091 0000 lds r24,EE_Parameter+9 |
3549 228c 9927 clr r25 |
3550 228e 6817 cp r22,r24 |
3551 2290 7907 cpc r23,r25 |
3552 2292 04F4 brge .L522 |
3553 2294 2981 ldd r18,Y+1 |
3554 2296 3A81 ldd r19,Y+2 |
3555 2298 2817 cp r18,r24 |
3556 229a 3907 cpc r19,r25 |
3557 229c 04F0 brlt .L524 |
3558 229e 9093 0000 sts (hoehenregler.2361)+1,r25 |
3559 22a2 8093 0000 sts hoehenregler.2361,r24 |
3560 22a6 00C0 rjmp .L522 |
3561 .L524: |
3562 22a8 4981 ldd r20,Y+1 |
3563 22aa 5A81 ldd r21,Y+2 |
3564 22ac 5093 0000 sts (hoehenregler.2361)+1,r21 |
3565 22b0 4093 0000 sts hoehenregler.2361,r20 |
3566 22b4 00C0 rjmp .L526 |
3567 .L522: |
3568 22b6 8091 0000 lds r24,hoehenregler.2361 |
3569 22ba 9091 0000 lds r25,(hoehenregler.2361)+1 |
3570 22be 6981 ldd r22,Y+1 |
3571 22c0 7A81 ldd r23,Y+2 |
3572 22c2 6817 cp r22,r24 |
3573 22c4 7907 cpc r23,r25 |
3574 22c6 04F4 brge .L526 |
3575 22c8 7093 0000 sts (hoehenregler.2361)+1,r23 |
3576 22cc 6093 0000 sts hoehenregler.2361,r22 |
3577 .L526: |
3578 22d0 8091 0000 lds r24,hoehenregler.2361 |
3579 22d4 9091 0000 lds r25,(hoehenregler.2361)+1 |
3580 22d8 9A83 std Y+2,r25 |
3581 22da 8983 std Y+1,r24 |
3582 .L509: |
3583 22dc C090 0000 lds r12,MesswertGier |
3584 22e0 D090 0000 lds r13,(MesswertGier)+1 |
3585 22e4 8091 0000 lds r24,sollGier.2351 |
3586 22e8 9091 0000 lds r25,(sollGier.2351)+1 |
3587 22ec C81A sub r12,r24 |
3588 22ee D90A sbc r13,r25 |
3589 22f0 95E6 ldi r25,lo8(101) |
3590 22f2 C916 cp r12,r25 |
3591 22f4 D104 cpc r13,__zero_reg__ |
3592 22f6 04F0 brlt .L528 |
3593 22f8 64E6 ldi r22,lo8(100) |
3594 22fa C62E mov r12,r22 |
3595 22fc D12C mov r13,__zero_reg__ |
3596 22fe 00C0 rjmp .L530 |
3597 .L528: |
3598 2300 ECE9 ldi r30,lo8(-100) |
3599 2302 CE16 cp r12,r30 |
3600 2304 EFEF ldi r30,hi8(-100) |
3601 2306 DE06 cpc r13,r30 |
3602 2308 04F4 brge .L530 |
3603 230a 5CE9 ldi r21,lo8(-100) |
3604 230c C52E mov r12,r21 |
3605 230e 5FEF ldi r21,hi8(-100) |
3606 2310 D52E mov r13,r21 |
3607 .L530: |
3608 2312 4090 0000 lds r4,Kp |
3609 2316 5090 0000 lds r5,(Kp)+1 |
3610 231a 6090 0000 lds r6,(Kp)+2 |
3611 231e 7090 0000 lds r7,(Kp)+3 |
3612 2322 6091 0000 lds r22,MesswertNick |
3613 2326 7091 0000 lds r23,(MesswertNick)+1 |
3614 232a 2091 0000 lds r18,StickNick |
3615 232e 3091 0000 lds r19,(StickNick)+1 |
3616 2332 4091 0000 lds r20,GPS_Nick |
3617 2336 5091 0000 lds r21,(GPS_Nick)+1 |
3618 233a 241B sub r18,r20 |
3619 233c 350B sbc r19,r21 |
3620 233e 621B sub r22,r18 |
3621 2340 730B sbc r23,r19 |
3622 2342 8827 clr r24 |
3623 2344 77FD sbrc r23,7 |
3624 2346 8095 com r24 |
3625 2348 982F mov r25,r24 |
3626 234a 0E94 0000 call __floatsisf |
3627 234e 9B01 movw r18,r22 |
3628 2350 AC01 movw r20,r24 |
3629 2352 C301 movw r24,r6 |
3630 2354 B201 movw r22,r4 |
3631 2356 0E94 0000 call __mulsf3 |
3632 235a 0E94 0000 call __fixsfsi |
3633 235e 7093 0000 sts (DiffNick)+1,r23 |
3634 2362 6093 0000 sts DiffNick,r22 |
3635 2366 8091 0000 lds r24,DiffNick |
3636 236a 9091 0000 lds r25,(DiffNick)+1 |
3637 236e 8C01 movw r16,r24 |
3638 2370 2227 clr r18 |
3639 2372 17FD sbrc r17,7 |
3640 2374 2095 com r18 |
3641 2376 322F mov r19,r18 |
3642 2378 8091 0000 lds r24,SummeNick.2349 |
3643 237c 9091 0000 lds r25,(SummeNick.2349)+1 |
3644 2380 A091 0000 lds r26,(SummeNick.2349)+2 |
3645 2384 B091 0000 lds r27,(SummeNick.2349)+3 |
3646 2388 080F add r16,r24 |
3647 238a 191F adc r17,r25 |
3648 238c 2A1F adc r18,r26 |
3649 238e 3B1F adc r19,r27 |
3650 2390 0093 0000 sts SummeNick.2349,r16 |
3651 2394 1093 0000 sts (SummeNick.2349)+1,r17 |
3652 2398 2093 0000 sts (SummeNick.2349)+2,r18 |
3653 239c 3093 0000 sts (SummeNick.2349)+3,r19 |
3654 23a0 1016 cp __zero_reg__,r16 |
3655 23a2 1106 cpc __zero_reg__,r17 |
3656 23a4 1206 cpc __zero_reg__,r18 |
3657 23a6 1306 cpc __zero_reg__,r19 |
3658 23a8 04F4 brge .L532 |
3659 23aa C801 movw r24,r16 |
3660 23ac 17FF sbrs r17,7 |
3661 23ae 00C0 rjmp .L534 |
3662 23b0 9095 com r25 |
3663 23b2 8195 neg r24 |
3664 23b4 9F4F sbci r25,lo8(-1) |
3665 .L534: |
3666 23b6 60E0 ldi r22,lo8(256) |
3667 23b8 71E0 ldi r23,hi8(256) |
3668 23ba 0E94 0000 call __divmodhi4 |
3669 23be 6F5F subi r22,lo8(-(1)) |
3670 23c0 7F4F sbci r23,hi8(-(1)) |
3671 23c2 8827 clr r24 |
3672 23c4 77FD sbrc r23,7 |
3673 23c6 8095 com r24 |
3674 23c8 982F mov r25,r24 |
3675 23ca 061B sub r16,r22 |
3676 23cc 170B sbc r17,r23 |
3677 23ce 280B sbc r18,r24 |
3678 23d0 390B sbc r19,r25 |
3679 23d2 00C0 rjmp .L581 |
3680 .L532: |
3681 23d4 C801 movw r24,r16 |
3682 23d6 17FF sbrs r17,7 |
3683 23d8 00C0 rjmp .L536 |
3684 23da 9095 com r25 |
3685 23dc 8195 neg r24 |
3686 23de 9F4F sbci r25,lo8(-1) |
3687 .L536: |
3688 23e0 60E0 ldi r22,lo8(256) |
3689 23e2 71E0 ldi r23,hi8(256) |
3690 23e4 0E94 0000 call __divmodhi4 |
3691 23e8 6F5F subi r22,lo8(-(1)) |
3692 23ea 7F4F sbci r23,hi8(-(1)) |
3693 23ec 8827 clr r24 |
3694 23ee 77FD sbrc r23,7 |
3695 23f0 8095 com r24 |
3696 23f2 982F mov r25,r24 |
3697 23f4 060F add r16,r22 |
3698 23f6 171F adc r17,r23 |
3699 23f8 281F adc r18,r24 |
3700 23fa 391F adc r19,r25 |
3701 .L581: |
3702 23fc 0093 0000 sts SummeNick.2349,r16 |
3703 2400 1093 0000 sts (SummeNick.2349)+1,r17 |
3704 2404 2093 0000 sts (SummeNick.2349)+2,r18 |
3705 2408 3093 0000 sts (SummeNick.2349)+3,r19 |
3706 240c 8091 0000 lds r24,SummeNick.2349 |
3707 2410 9091 0000 lds r25,(SummeNick.2349)+1 |
3708 2414 A091 0000 lds r26,(SummeNick.2349)+2 |
3709 2418 B091 0000 lds r27,(SummeNick.2349)+3 |
3710 241c 8138 cpi r24,lo8(16001) |
3711 241e FEE3 ldi r31,hi8(16001) |
3712 2420 9F07 cpc r25,r31 |
3713 2422 F0E0 ldi r31,hlo8(16001) |
3714 2424 AF07 cpc r26,r31 |
3715 2426 F0E0 ldi r31,hhi8(16001) |
3716 2428 BF07 cpc r27,r31 |
3717 242a 04F0 brlt .L537 |
3718 242c 80E8 ldi r24,lo8(16000) |
3719 242e 9EE3 ldi r25,hi8(16000) |
3720 2430 A0E0 ldi r26,hlo8(16000) |
3721 2432 B0E0 ldi r27,hhi8(16000) |
3722 2434 00C0 rjmp .L582 |
3723 .L537: |
3724 2436 8058 subi r24,lo8(-16000) |
3725 2438 914C sbci r25,hi8(-16000) |
3726 243a AF4F sbci r26,hlo8(-16000) |
3727 243c BF4F sbci r27,hhi8(-16000) |
3728 243e 04F4 brge .L539 |
3729 2440 80E8 ldi r24,lo8(-16000) |
3730 2442 91EC ldi r25,hi8(-16000) |
3731 2444 AFEF ldi r26,hlo8(-16000) |
3732 2446 BFEF ldi r27,hhi8(-16000) |
3733 .L582: |
3734 2448 8093 0000 sts SummeNick.2349,r24 |
3735 244c 9093 0000 sts (SummeNick.2349)+1,r25 |
3736 2450 A093 0000 sts (SummeNick.2349)+2,r26 |
3737 2454 B093 0000 sts (SummeNick.2349)+3,r27 |
3738 .L539: |
3739 2458 6091 0000 lds r22,DiffNick |
3740 245c 7091 0000 lds r23,(DiffNick)+1 |
3741 2460 8090 0000 lds r8,Ki |
3742 2464 9090 0000 lds r9,(Ki)+1 |
3743 2468 A090 0000 lds r10,(Ki)+2 |
3744 246c B090 0000 lds r11,(Ki)+3 |
3745 2470 8827 clr r24 |
3746 2472 77FD sbrc r23,7 |
3747 2474 8095 com r24 |
3748 2476 982F mov r25,r24 |
3749 2478 0E94 0000 call __floatsisf |
3750 247c 7B01 movw r14,r22 |
3751 247e 8C01 movw r16,r24 |
3752 2480 6091 0000 lds r22,SummeNick.2349 |
3753 2484 7091 0000 lds r23,(SummeNick.2349)+1 |
3754 2488 8091 0000 lds r24,(SummeNick.2349)+2 |
3755 248c 9091 0000 lds r25,(SummeNick.2349)+3 |
3756 2490 0E94 0000 call __floatsisf |
3757 2494 9B01 movw r18,r22 |
3758 2496 AC01 movw r20,r24 |
3759 2498 C501 movw r24,r10 |
3760 249a B401 movw r22,r8 |
3761 249c 0E94 0000 call __mulsf3 |
3762 24a0 9B01 movw r18,r22 |
3763 24a2 AC01 movw r20,r24 |
3764 24a4 C801 movw r24,r16 |
3765 24a6 B701 movw r22,r14 |
3766 24a8 0E94 0000 call __addsf3 |
3767 24ac 0E94 0000 call __fixsfsi |
3768 24b0 9601 movw r18,r12 |
3769 24b2 260F add r18,r22 |
3770 24b4 371F adc r19,r23 |
3771 24b6 4981 ldd r20,Y+1 |
3772 24b8 5A81 ldd r21,Y+2 |
3773 24ba 240F add r18,r20 |
3774 24bc 351F adc r19,r21 |
3775 24be 2224 clr r2 |
3776 24c0 4A30 cpi r20,10 |
3777 24c2 5105 cpc r21,__zero_reg__ |
3778 24c4 04F4 brge .L541 |
3779 24c6 41E0 ldi r20,lo8(1) |
3780 24c8 242E mov r2,r20 |
3781 .L541: |
3782 24ca 37FD sbrc r19,7 |
3783 24cc 00C0 rjmp .L544 |
3784 24ce 2220 tst r2 |
3785 24d0 01F0 breq .L542 |
3786 .L544: |
3787 24d2 40E0 ldi r20,lo8(0) |
3788 24d4 50E0 ldi r21,hi8(0) |
3789 24d6 00C0 rjmp .L545 |
3790 .L542: |
3791 24d8 8091 0000 lds r24,MAX_GAS |
3792 24dc 482F mov r20,r24 |
3793 24de 5527 clr r21 |
3794 24e0 2417 cp r18,r20 |
3795 24e2 3507 cpc r19,r21 |
3796 24e4 04F4 brge .L545 |
3797 24e6 A901 movw r20,r18 |
3798 .L545: |
3799 24e8 8091 0000 lds r24,MIN_GAS |
3800 24ec E82F mov r30,r24 |
3801 24ee FF27 clr r31 |
3802 24f0 FC83 std Y+4,r31 |
3803 24f2 EB83 std Y+3,r30 |
3804 24f4 9F01 movw r18,r30 |
3805 24f6 E417 cp r30,r20 |
3806 24f8 F507 cpc r31,r21 |
3807 24fa 04F4 brge .L547 |
3808 24fc 9A01 movw r18,r20 |
3809 .L547: |
3810 24fe 2093 0000 sts Motor_Vorne,r18 |
3811 2502 2981 ldd r18,Y+1 |
3812 2504 3A81 ldd r19,Y+2 |
3813 2506 261B sub r18,r22 |
3814 2508 370B sbc r19,r23 |
3815 250a B901 movw r22,r18 |
3816 250c 6C0D add r22,r12 |
3817 250e 7D1D adc r23,r13 |
3818 2510 77FD sbrc r23,7 |
3819 2512 00C0 rjmp .L550 |
3820 2514 2220 tst r2 |
3821 2516 01F0 breq .L548 |
3822 .L550: |
3823 2518 80E0 ldi r24,lo8(0) |
3824 251a 90E0 ldi r25,hi8(0) |
3825 251c 00C0 rjmp .L551 |
3826 .L548: |
3827 251e 8091 0000 lds r24,MAX_GAS |
3828 2522 9927 clr r25 |
3829 2524 6817 cp r22,r24 |
3830 2526 7907 cpc r23,r25 |
3831 2528 04F4 brge .L551 |
3832 252a CB01 movw r24,r22 |
3833 .L551: |
3834 252c 2B81 ldd r18,Y+3 |
3835 252e 3C81 ldd r19,Y+4 |
3836 2530 2817 cp r18,r24 |
3837 2532 3907 cpc r19,r25 |
3838 2534 04F4 brge .L553 |
3839 2536 9C01 movw r18,r24 |
3840 .L553: |
3841 2538 2093 0000 sts Motor_Hinten,r18 |
3842 253c 6091 0000 lds r22,MesswertRoll |
3843 2540 7091 0000 lds r23,(MesswertRoll)+1 |
3844 2544 2091 0000 lds r18,StickRoll |
3845 2548 3091 0000 lds r19,(StickRoll)+1 |
3846 254c 4091 0000 lds r20,GPS_Roll |
3847 2550 5091 0000 lds r21,(GPS_Roll)+1 |
3848 2554 241B sub r18,r20 |
3849 2556 350B sbc r19,r21 |
3850 2558 621B sub r22,r18 |
3851 255a 730B sbc r23,r19 |
3852 255c 8827 clr r24 |
3853 255e 77FD sbrc r23,7 |
3854 2560 8095 com r24 |
3855 2562 982F mov r25,r24 |
3856 2564 0E94 0000 call __floatsisf |
3857 2568 9B01 movw r18,r22 |
3858 256a AC01 movw r20,r24 |
3859 256c C301 movw r24,r6 |
3860 256e B201 movw r22,r4 |
3861 2570 0E94 0000 call __mulsf3 |
3862 2574 0E94 0000 call __fixsfsi |
3863 2578 7093 0000 sts (DiffRoll)+1,r23 |
3864 257c 6093 0000 sts DiffRoll,r22 |
3865 2580 8091 0000 lds r24,DiffRoll |
3866 2584 9091 0000 lds r25,(DiffRoll)+1 |
3867 2588 8C01 movw r16,r24 |
3868 258a 2227 clr r18 |
3869 258c 17FD sbrc r17,7 |
3870 258e 2095 com r18 |
3871 2590 322F mov r19,r18 |
3872 2592 8091 0000 lds r24,SummeRoll.2350 |
3873 2596 9091 0000 lds r25,(SummeRoll.2350)+1 |
3874 259a A091 0000 lds r26,(SummeRoll.2350)+2 |
3875 259e B091 0000 lds r27,(SummeRoll.2350)+3 |
3876 25a2 080F add r16,r24 |
3877 25a4 191F adc r17,r25 |
3878 25a6 2A1F adc r18,r26 |
3879 25a8 3B1F adc r19,r27 |
3880 25aa 0093 0000 sts SummeRoll.2350,r16 |
3881 25ae 1093 0000 sts (SummeRoll.2350)+1,r17 |
3882 25b2 2093 0000 sts (SummeRoll.2350)+2,r18 |
3883 25b6 3093 0000 sts (SummeRoll.2350)+3,r19 |
3884 25ba 1016 cp __zero_reg__,r16 |
3885 25bc 1106 cpc __zero_reg__,r17 |
3886 25be 1206 cpc __zero_reg__,r18 |
3887 25c0 1306 cpc __zero_reg__,r19 |
3888 25c2 04F4 brge .L554 |
3889 25c4 C801 movw r24,r16 |
3890 25c6 17FF sbrs r17,7 |
3891 25c8 00C0 rjmp .L556 |
3892 25ca 9095 com r25 |
3893 25cc 8195 neg r24 |
3894 25ce 9F4F sbci r25,lo8(-1) |
3895 .L556: |
3896 25d0 60E0 ldi r22,lo8(256) |
3897 25d2 71E0 ldi r23,hi8(256) |
3898 25d4 0E94 0000 call __divmodhi4 |
3899 25d8 6F5F subi r22,lo8(-(1)) |
3900 25da 7F4F sbci r23,hi8(-(1)) |
3901 25dc 8827 clr r24 |
3902 25de 77FD sbrc r23,7 |
3903 25e0 8095 com r24 |
3904 25e2 982F mov r25,r24 |
3905 25e4 061B sub r16,r22 |
3906 25e6 170B sbc r17,r23 |
3907 25e8 280B sbc r18,r24 |
3908 25ea 390B sbc r19,r25 |
3909 25ec 00C0 rjmp .L583 |
3910 .L554: |
3911 25ee C801 movw r24,r16 |
3912 25f0 17FF sbrs r17,7 |
3913 25f2 00C0 rjmp .L558 |
3914 25f4 9095 com r25 |
3915 25f6 8195 neg r24 |
3916 25f8 9F4F sbci r25,lo8(-1) |
3917 .L558: |
3918 25fa 60E0 ldi r22,lo8(256) |
3919 25fc 71E0 ldi r23,hi8(256) |
3920 25fe 0E94 0000 call __divmodhi4 |
3921 2602 6F5F subi r22,lo8(-(1)) |
3922 2604 7F4F sbci r23,hi8(-(1)) |
3923 2606 8827 clr r24 |
3924 2608 77FD sbrc r23,7 |
3925 260a 8095 com r24 |
3926 260c 982F mov r25,r24 |
3927 260e 060F add r16,r22 |
3928 2610 171F adc r17,r23 |
3929 2612 281F adc r18,r24 |
3930 2614 391F adc r19,r25 |
3931 .L583: |
3932 2616 0093 0000 sts SummeRoll.2350,r16 |
3933 261a 1093 0000 sts (SummeRoll.2350)+1,r17 |
3934 261e 2093 0000 sts (SummeRoll.2350)+2,r18 |
3935 2622 3093 0000 sts (SummeRoll.2350)+3,r19 |
3936 2626 8091 0000 lds r24,SummeRoll.2350 |
3937 262a 9091 0000 lds r25,(SummeRoll.2350)+1 |
3938 262e A091 0000 lds r26,(SummeRoll.2350)+2 |
3939 2632 B091 0000 lds r27,(SummeRoll.2350)+3 |
3940 2636 8138 cpi r24,lo8(16001) |
3941 2638 3EE3 ldi r19,hi8(16001) |
3942 263a 9307 cpc r25,r19 |
3943 263c 30E0 ldi r19,hlo8(16001) |
3944 263e A307 cpc r26,r19 |
3945 2640 30E0 ldi r19,hhi8(16001) |
3946 2642 B307 cpc r27,r19 |
3947 2644 04F0 brlt .L559 |
3948 2646 80E8 ldi r24,lo8(16000) |
3949 2648 9EE3 ldi r25,hi8(16000) |
3950 264a A0E0 ldi r26,hlo8(16000) |
3951 264c B0E0 ldi r27,hhi8(16000) |
3952 264e 00C0 rjmp .L584 |
3953 .L559: |
3954 2650 8058 subi r24,lo8(-16000) |
3955 2652 914C sbci r25,hi8(-16000) |
3956 2654 AF4F sbci r26,hlo8(-16000) |
3957 2656 BF4F sbci r27,hhi8(-16000) |
3958 2658 04F4 brge .L561 |
3959 265a 80E8 ldi r24,lo8(-16000) |
3960 265c 91EC ldi r25,hi8(-16000) |
3961 265e AFEF ldi r26,hlo8(-16000) |
3962 2660 BFEF ldi r27,hhi8(-16000) |
3963 .L584: |
3964 2662 8093 0000 sts SummeRoll.2350,r24 |
3965 2666 9093 0000 sts (SummeRoll.2350)+1,r25 |
3966 266a A093 0000 sts (SummeRoll.2350)+2,r26 |
3967 266e B093 0000 sts (SummeRoll.2350)+3,r27 |
3968 .L561: |
3969 2672 6091 0000 lds r22,DiffRoll |
3970 2676 7091 0000 lds r23,(DiffRoll)+1 |
3971 267a 8827 clr r24 |
3972 267c 77FD sbrc r23,7 |
3973 267e 8095 com r24 |
3974 2680 982F mov r25,r24 |
3975 2682 0E94 0000 call __floatsisf |
3976 2686 7B01 movw r14,r22 |
3977 2688 8C01 movw r16,r24 |
3978 268a 6091 0000 lds r22,SummeRoll.2350 |
3979 268e 7091 0000 lds r23,(SummeRoll.2350)+1 |
3980 2692 8091 0000 lds r24,(SummeRoll.2350)+2 |
3981 2696 9091 0000 lds r25,(SummeRoll.2350)+3 |
3982 269a 0E94 0000 call __floatsisf |
3983 269e 9B01 movw r18,r22 |
3984 26a0 AC01 movw r20,r24 |
3985 26a2 C501 movw r24,r10 |
3986 26a4 B401 movw r22,r8 |
3987 26a6 0E94 0000 call __mulsf3 |
3988 26aa 9B01 movw r18,r22 |
3989 26ac AC01 movw r20,r24 |
3990 26ae C801 movw r24,r16 |
3991 26b0 B701 movw r22,r14 |
3992 26b2 0E94 0000 call __addsf3 |
3993 26b6 0E94 0000 call __fixsfsi |
3994 26ba 2981 ldd r18,Y+1 |
3995 26bc 3A81 ldd r19,Y+2 |
3996 26be 260F add r18,r22 |
3997 26c0 371F adc r19,r23 |
3998 26c2 2C19 sub r18,r12 |
3999 26c4 3D09 sbc r19,r13 |
4000 26c6 37FD sbrc r19,7 |
4001 26c8 00C0 rjmp .L565 |
4002 26ca 2220 tst r2 |
4003 26cc 01F0 breq .L563 |
4004 .L565: |
4005 26ce 40E0 ldi r20,lo8(0) |
4006 26d0 50E0 ldi r21,hi8(0) |
4007 26d2 00C0 rjmp .L566 |
4008 .L563: |
4009 26d4 8091 0000 lds r24,MAX_GAS |
4010 26d8 482F mov r20,r24 |
4011 26da 5527 clr r21 |
4012 26dc 2417 cp r18,r20 |
4013 26de 3507 cpc r19,r21 |
4014 26e0 04F4 brge .L566 |
4015 26e2 A901 movw r20,r18 |
4016 .L566: |
4017 26e4 2B81 ldd r18,Y+3 |
4018 26e6 3C81 ldd r19,Y+4 |
4019 26e8 2417 cp r18,r20 |
4020 26ea 3507 cpc r19,r21 |
4021 26ec 04F4 brge .L568 |
4022 26ee 9A01 movw r18,r20 |
4023 .L568: |
4024 26f0 2093 0000 sts Motor_Links,r18 |
4025 26f4 8981 ldd r24,Y+1 |
4026 26f6 9A81 ldd r25,Y+2 |
4027 26f8 861B sub r24,r22 |
4028 26fa 970B sbc r25,r23 |
4029 26fc BC01 movw r22,r24 |
4030 26fe 6C19 sub r22,r12 |
4031 2700 7D09 sbc r23,r13 |
4032 2702 77FD sbrc r23,7 |
4033 2704 00C0 rjmp .L571 |
4034 2706 2220 tst r2 |
4035 2708 01F0 breq .L569 |
4036 .L571: |
4037 270a 20E0 ldi r18,lo8(0) |
4038 270c 30E0 ldi r19,hi8(0) |
4039 270e 00C0 rjmp .L572 |
4040 .L569: |
4041 2710 8091 0000 lds r24,MAX_GAS |
4042 2714 282F mov r18,r24 |
4043 2716 3327 clr r19 |
4044 2718 6217 cp r22,r18 |
4045 271a 7307 cpc r23,r19 |
4046 271c 04F4 brge .L572 |
4047 271e 9B01 movw r18,r22 |
4048 .L572: |
4049 2720 8B81 ldd r24,Y+3 |
4050 2722 9C81 ldd r25,Y+4 |
4051 2724 8217 cp r24,r18 |
4052 2726 9307 cpc r25,r19 |
4053 2728 04F4 brge .L574 |
4054 272a C901 movw r24,r18 |
4055 .L574: |
4056 272c 8093 0000 sts Motor_Rechts,r24 |
4057 /* epilogue: frame size=4 */ |
4058 2730 2496 adiw r28,4 |
4059 2732 0FB6 in __tmp_reg__,__SREG__ |
4060 2734 F894 cli |
4061 2736 DEBF out __SP_H__,r29 |
4062 2738 0FBE out __SREG__,__tmp_reg__ |
4063 273a CDBF out __SP_L__,r28 |
4064 273c DF91 pop r29 |
4065 273e CF91 pop r28 |
4066 2740 1F91 pop r17 |
4067 2742 0F91 pop r16 |
4068 2744 FF90 pop r15 |
4069 2746 EF90 pop r14 |
4070 2748 DF90 pop r13 |
4071 274a CF90 pop r12 |
4072 274c BF90 pop r11 |
4073 274e AF90 pop r10 |
4074 2750 9F90 pop r9 |
4075 2752 8F90 pop r8 |
4076 2754 7F90 pop r7 |
4077 2756 6F90 pop r6 |
4078 2758 5F90 pop r5 |
4079 275a 4F90 pop r4 |
4080 275c 3F90 pop r3 |
4081 275e 2F90 pop r2 |
4082 2760 0895 ret |
4083 /* epilogue end (size=25) */ |
4084 /* function MotorRegler size 2806 (2755) */ |
4086 .global Timeout |
4087 .global Timeout |
4088 .section .bss |
4091 Timeout: |
4092 0000 00 .skip 1,0 |
4093 .global AdNeutralNick |
4094 .global AdNeutralNick |
4097 AdNeutralNick: |
4098 0001 0000 .skip 2,0 |
4099 .global AdNeutralRoll |
4100 .global AdNeutralRoll |
4103 AdNeutralRoll: |
4104 0003 0000 .skip 2,0 |
4105 .global AdNeutralGier |
4106 .global AdNeutralGier |
4109 AdNeutralGier: |
4110 0005 0000 .skip 2,0 |
4111 .global NeutralAccX |
4112 .global NeutralAccX |
4115 NeutralAccX: |
4116 0007 0000 .skip 2,0 |
4117 .global NeutralAccY |
4118 .global NeutralAccY |
4121 NeutralAccY: |
4122 0009 0000 .skip 2,0 |
4123 .global NeutralAccZ |
4124 .global NeutralAccZ |
4127 NeutralAccZ: |
4128 000b 0000 0000 .skip 4,0 |
4129 .global CosinusNickWinkel |
4130 .global CosinusNickWinkel |
4133 CosinusNickWinkel: |
4134 000f 00 .skip 1,0 |
4135 .global CosinusRollWinkel |
4136 .global CosinusRollWinkel |
4139 CosinusRollWinkel: |
4140 0010 00 .skip 1,0 |
4141 .global IntegralNick |
4142 .global IntegralNick |
4145 IntegralNick: |
4146 0011 0000 0000 .skip 4,0 |
4147 .global IntegralNick2 |
4148 .global IntegralNick2 |
4151 IntegralNick2: |
4152 0015 0000 0000 .skip 4,0 |
4153 .global IntegralRoll |
4154 .global IntegralRoll |
4157 IntegralRoll: |
4158 0019 0000 0000 .skip 4,0 |
4159 .global IntegralRoll2 |
4160 .global IntegralRoll2 |
4163 IntegralRoll2: |
4164 001d 0000 0000 .skip 4,0 |
4165 .global Integral_Gier |
4166 .global Integral_Gier |
4169 Integral_Gier: |
4170 0021 0000 0000 .skip 4,0 |
4171 .global Mess_IntegralNick |
4172 .global Mess_IntegralNick |
4175 Mess_IntegralNick: |
4176 0025 0000 0000 .skip 4,0 |
4177 .global Mess_IntegralNick2 |
4178 .global Mess_IntegralNick2 |
4181 Mess_IntegralNick2: |
4182 0029 0000 0000 .skip 4,0 |
4183 .global Mess_IntegralRoll |
4184 .global Mess_IntegralRoll |
4187 Mess_IntegralRoll: |
4188 002d 0000 0000 .skip 4,0 |
4189 .global Mess_IntegralRoll2 |
4190 .global Mess_IntegralRoll2 |
4193 Mess_IntegralRoll2: |
4194 0031 0000 0000 .skip 4,0 |
4195 .global Mess_Integral_Gier |
4196 .global Mess_Integral_Gier |
4199 Mess_Integral_Gier: |
4200 0035 0000 0000 .skip 4,0 |
4201 .global Mess_Integral_Gier2 |
4202 .global Mess_Integral_Gier2 |
4205 Mess_Integral_Gier2: |
4206 0039 0000 0000 .skip 4,0 |
4207 .global Mess_Integral_Hoch |
4208 .global Mess_Integral_Hoch |
4211 Mess_Integral_Hoch: |
4212 003d 0000 0000 .skip 4,0 |
4213 .global KompassValue |
4214 .global KompassValue |
4217 KompassValue: |
4218 0041 0000 .skip 2,0 |
4219 .global KompassStartwert |
4220 .global KompassStartwert |
4223 KompassStartwert: |
4224 0043 0000 .skip 2,0 |
4225 .global KompassRichtung |
4226 .global KompassRichtung |
4229 KompassRichtung: |
4230 0045 0000 .skip 2,0 |
4231 .global Notlandung |
4232 .global Notlandung |
4235 Notlandung: |
4236 0047 00 .skip 1,0 |
4237 .global HoehenReglerAktiv |
4238 .global HoehenReglerAktiv |
4241 HoehenReglerAktiv: |
4242 0048 00 .skip 1,0 |
4243 .global Poti1 |
4244 .global Poti1 |
4247 Poti1: |
4248 0049 0000 .skip 2,0 |
4249 .global Poti2 |
4250 .global Poti2 |
4253 Poti2: |
4254 004b 0000 .skip 2,0 |
4255 .global Poti3 |
4256 .global Poti3 |
4259 Poti3: |
4260 004d 0000 .skip 2,0 |
4261 .global Poti4 |
4262 .global Poti4 |
4265 Poti4: |
4266 004f 0000 .skip 2,0 |
4267 .global SenderOkay |
4268 .global SenderOkay |
4271 SenderOkay: |
4272 0051 00 .skip 1,0 |
4273 .global StickNick |
4274 .global StickNick |
4277 StickNick: |
4278 0052 0000 .skip 2,0 |
4279 .global StickRoll |
4280 .global StickRoll |
4283 StickRoll: |
4284 0054 0000 .skip 2,0 |
4285 .global StickGier |
4286 .global StickGier |
4289 StickGier: |
4290 0056 0000 .skip 2,0 |
4291 .global MotorenEin |
4292 .global MotorenEin |
4295 MotorenEin: |
4296 0058 00 .skip 1,0 |
4297 .global HoehenWert |
4298 .global HoehenWert |
4301 HoehenWert: |
4302 0059 0000 .skip 2,0 |
4303 .global SollHoehe |
4304 .global SollHoehe |
4307 SollHoehe: |
4308 005b 0000 .skip 2,0 |
4309 .global Kp |
4310 .data |
4313 Kp: |
4314 0010 00 .byte 0 |
4315 0011 00 .byte 0 |
4316 0012 80 .byte -128 |
4317 0013 3F .byte 63 |
4318 .global Ki |
4321 Ki: |
4322 0014 17 .byte 23 |
4323 0015 B7 .byte -73 |
4324 0016 D1 .byte -47 |
4325 0017 38 .byte 56 |
4326 .global Parameter_Luftdruck_D |
4329 Parameter_Luftdruck_D: |
4330 0018 30 .byte 48 |
4331 .global Parameter_MaxHoehe |
4334 Parameter_MaxHoehe: |
4335 0019 FB .byte -5 |
4336 .global Parameter_Hoehe_P |
4339 Parameter_Hoehe_P: |
4340 001a 10 .byte 16 |
4341 .global Parameter_Hoehe_ACC_Wirkung |
4344 Parameter_Hoehe_ACC_Wirkung: |
4345 001b 3A .byte 58 |
4346 .global Parameter_KompassWirkung |
4349 Parameter_KompassWirkung: |
4350 001c 40 .byte 64 |
4351 .global Parameter_Gyro_P |
4354 Parameter_Gyro_P: |
4355 001d 32 .byte 50 |
4356 .global Parameter_Gyro_I |
4359 Parameter_Gyro_I: |
4360 001e 96 .byte -106 |
4361 .global Parameter_Gier_P |
4364 Parameter_Gier_P: |
4365 001f 02 .byte 2 |
4366 .global Parameter_I_Faktor |
4369 Parameter_I_Faktor: |
4370 0020 0A .byte 10 |
4371 .global Parameter_UserParam1 |
4372 .global Parameter_UserParam1 |
4373 .section .bss |
4376 Parameter_UserParam1: |
4377 005d 00 .skip 1,0 |
4378 .global Parameter_UserParam2 |
4379 .global Parameter_UserParam2 |
4382 Parameter_UserParam2: |
4383 005e 00 .skip 1,0 |
4384 .global Parameter_UserParam3 |
4385 .global Parameter_UserParam3 |
4388 Parameter_UserParam3: |
4389 005f 00 .skip 1,0 |
4390 .global Parameter_UserParam4 |
4391 .global Parameter_UserParam4 |
4394 Parameter_UserParam4: |
4395 0060 00 .skip 1,0 |
4396 .global Parameter_ServoNickControl |
4397 .data |
4400 Parameter_ServoNickControl: |
4401 0021 64 .byte 100 |
4402 .lcomm SignalSchlecht.2367,2 |
4403 .lcomm NeueKompassRichtungMerken.2363,1 |
4404 .lcomm TimerWerteausgabe.2362,1 |
4405 .lcomm hoehenregler.2361,2 |
4406 .lcomm modell_fliegt.2360,2 |
4407 .lcomm delay_ausschalten.2359,1 |
4408 .lcomm delay_einschalten.2358,1 |
4409 .lcomm delay_neutral.2357,1 |
4410 .lcomm RcLostTimer.2356,2 |
4411 .lcomm IntegralFehlerRoll.2355,2 |
4412 .lcomm IntegralFehlerNick.2354,2 |
4413 .lcomm tmp_long2.2353,4 |
4414 .lcomm tmp_long.2352,4 |
4415 .lcomm sollGier.2351,4 |
4416 .lcomm SummeRoll.2350,4 |
4417 .lcomm SummeNick.2349,4 |
4418 .comm DiffNick,2,1 |
4419 .comm DiffRoll,2,1 |
4420 .comm durchschnitt_northing,4,1 |
4421 .comm durchschnitt_easting,4,1 |
4422 .comm gps_p,2,1 |
4423 .comm gps_d,2,1 |
4424 .comm skal,2,1 |
4425 .comm RemoteTasten,1,1 |
4426 .comm MesswertNick,2,1 |
4427 .comm MesswertRoll,2,1 |
4428 .comm MesswertGier,2,1 |
4429 .comm Mittelwert_AccNick,2,1 |
4430 .comm Mittelwert_AccRoll,2,1 |
4431 .comm Mittelwert_AccHoch,2,1 |
4432 .comm h,1,1 |
4433 .comm m,1,1 |
4434 .comm s,1,1 |
4435 .comm Motor_Vorne,1,1 |
4436 .comm Motor_Hinten,1,1 |
4437 .comm Motor_Rechts,1,1 |
4438 .comm Motor_Links,1,1 |
4439 .comm Count,1,1 |
4440 .comm MotorWert,5,1 |
4441 .comm EE_Parameter,58,1 |
4442 .comm MAX_GAS,1,1 |
4443 .comm MIN_GAS,1,1 |
4444 .comm GyroFaktor,4,1 |
4445 .comm IntegralFaktor,4,1 |
4446 /* File "fc.c": code 5085 = 0x13dd (5003), prologues 38, epilogues 44 */ |
DEFINED SYMBOLS |
*ABS*:00000000 fc.c |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:3 *ABS*:0000003f __SREG__ |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4 *ABS*:0000003e __SP_H__ |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:5 *ABS*:0000003d __SP_L__ |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:6 *ABS*:00000000 __tmp_reg__ |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:7 *ABS*:00000001 __zero_reg__ |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:13 .text:00000000 Mittelwert |
*COM*:00000002 MesswertNick |
*COM*:00000002 MesswertRoll |
*COM*:00000002 MesswertGier |
*COM*:00000002 Mittelwert_AccNick |
*COM*:00000002 Mittelwert_AccRoll |
*COM*:00000002 Mittelwert_AccHoch |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4199 .bss:00000035 Mess_Integral_Gier |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4169 .bss:00000021 Integral_Gier |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4175 .bss:00000025 Mess_IntegralNick |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4145 .bss:00000011 IntegralNick |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4187 .bss:0000002d Mess_IntegralRoll |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4157 .bss:00000019 IntegralRoll |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4181 .bss:00000029 Mess_IntegralNick2 |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4151 .bss:00000015 IntegralNick2 |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4193 .bss:00000031 Mess_IntegralRoll2 |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4163 .bss:0000001d IntegralRoll2 |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4247 .bss:00000049 Poti1 |
*COM*:0000003a EE_Parameter |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4253 .bss:0000004b Poti2 |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4259 .bss:0000004d Poti3 |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4265 .bss:0000004f Poti4 |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:576 .text:00000582 CalibrierMittelwert |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:918 .text:000008ba ParameterZuordnung |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4334 .data:00000019 Parameter_MaxHoehe |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4329 .data:00000018 Parameter_Luftdruck_D |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4339 .data:0000001a Parameter_Hoehe_P |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4344 .data:0000001b Parameter_Hoehe_ACC_Wirkung |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4349 .data:0000001c Parameter_KompassWirkung |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4354 .data:0000001d Parameter_Gyro_P |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4359 .data:0000001e Parameter_Gyro_I |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4369 .data:00000020 Parameter_I_Faktor |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4376 .bss:0000005d Parameter_UserParam1 |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4382 .bss:0000005e Parameter_UserParam2 |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4388 .bss:0000005f Parameter_UserParam3 |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4394 .bss:00000060 Parameter_UserParam4 |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4400 .data:00000021 Parameter_ServoNickControl |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4321 .data:00000014 Ki |
*COM*:00000001 MAX_GAS |
*COM*:00000001 MIN_GAS |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:1484 .text:00000d54 DefaultKonstanten2 |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:1570 .text:00000e2e DefaultKonstanten1 |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:1654 .text:00000f10 SendMotorData |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4295 .bss:00000058 MotorenEin |
*COM*:00000001 Motor_Hinten |
*COM*:00000001 Motor_Vorne |
*COM*:00000001 Motor_Rechts |
*COM*:00000001 Motor_Links |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:1710 .text:00000f9e SetNeutral |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4115 .bss:00000007 NeutralAccX |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4121 .bss:00000009 NeutralAccY |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4127 .bss:0000000b NeutralAccZ |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4097 .bss:00000001 AdNeutralNick |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4103 .bss:00000003 AdNeutralRoll |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4109 .bss:00000005 AdNeutralGier |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4211 .bss:0000003d Mess_Integral_Hoch |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4217 .bss:00000041 KompassValue |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4223 .bss:00000043 KompassStartwert |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:1882 .text:00001196 Piep |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:1911 .text:000011c0 MotorRegler |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4271 .bss:00000051 SenderOkay |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4409 .bss:0000006c RcLostTimer.2356 |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4235 .bss:00000047 Notlandung |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4405 .bss:00000067 modell_fliegt.2360 |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4416 .bss:00000082 SummeNick.2349 |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4415 .bss:0000007e SummeRoll.2350 |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4205 .bss:00000039 Mess_Integral_Gier2 |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4408 .bss:0000006b delay_neutral.2357 |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4407 .bss:0000006a delay_einschalten.2358 |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4414 .bss:0000007a sollGier.2351 |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4406 .bss:00000069 delay_ausschalten.2359 |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4277 .bss:00000052 StickNick |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4283 .bss:00000054 StickRoll |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4289 .bss:00000056 StickGier |
*COM*:00000004 GyroFaktor |
*COM*:00000004 IntegralFaktor |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4411 .bss:00000070 IntegralFehlerNick.2354 |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4410 .bss:0000006e IntegralFehlerRoll.2355 |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4413 .bss:00000076 tmp_long.2352 |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4412 .bss:00000072 tmp_long2.2353 |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4402 .bss:00000063 NeueKompassRichtungMerken.2363 |
.bss:00000061 SignalSchlecht.2367 |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4229 .bss:00000045 KompassRichtung |
*COM*:00000002 gps_p |
*COM*:00000002 gps_d |
*COM*:00000002 skal |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4403 .bss:00000064 TimerWerteausgabe.2362 |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4301 .bss:00000059 HoehenWert |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4307 .bss:0000005b SollHoehe |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4241 .bss:00000048 HoehenReglerAktiv |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4404 .bss:00000065 hoehenregler.2361 |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4313 .data:00000010 Kp |
*COM*:00000002 DiffNick |
*COM*:00000002 DiffRoll |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4091 .bss:00000000 Timeout |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4133 .bss:0000000f CosinusNickWinkel |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4139 .bss:00000010 CosinusRollWinkel |
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccPBHCUy.s:4364 .data:0000001f Parameter_Gier_P |
*COM*:00000004 durchschnitt_northing |
*COM*:00000004 durchschnitt_easting |
*COM*:00000001 RemoteTasten |
*COM*:00000001 h |
*COM*:00000001 m |
*COM*:00000001 s |
*COM*:00000001 Count |
*COM*:00000005 MotorWert |
|
UNDEFINED SYMBOLS |
__do_copy_data |
__do_clear_bss |
MessanzahlNick |
AccumulateNick |
__divmodhi4 |
MessanzahlRoll |
AccumulateRoll |
MessanzahlGier |
AccumulateGier |
messanzahl_AccNick |
accumulate_AccNick |
__divmodsi4 |
messanzahl_AccRoll |
accumulate_AccRoll |
messanzahl_AccHoch |
accumulate_AccHoch |
PPM_in |
__floatsisf |
__addsf3 |
__mulsf3 |
MotorTest |
DebugOut |
twi_state |
motor |
i2c_start |
SetDelay |
CheckDelay |
MessLuftdruck |
SucheLuftruckOffset |
Aktuell_az |
Luftdruck |
StartLuftdruck |
HoeheD |
beeptime |
Delay_ms |
PcZugriff |
EEPromArray |
__eeprom_write_byte_1F2021 |
GetActiveParamSetNumber |
ReadParameterSet |
NewPpmData |
PPM_diff |
__divsf3 |
__ltsf2 |
ZaehlMessungen |
__mulsi3 |
gps_main |
GPS_Nick |
GPS_Roll |
__fixsfsi |