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