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