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