Go to most recent revision | Details | Last modification | View Log | RSS feed
Rev | Author | Line No. | Line |
---|---|---|---|
99 | gunterl | 1 | 1 .file "fc.c" |
2 | 2 .arch atmega644p |
||
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=2 */ |
||
14 | 15 0000 2F92 push r2 |
||
15 | 16 0002 3F92 push r3 |
||
16 | 17 0004 4F92 push r4 |
||
17 | 18 0006 5F92 push r5 |
||
18 | 19 0008 6F92 push r6 |
||
19 | 20 000a 7F92 push r7 |
||
20 | 21 000c 8F92 push r8 |
||
21 | 22 000e 9F92 push r9 |
||
22 | 23 0010 AF92 push r10 |
||
23 | 24 0012 BF92 push r11 |
||
24 | 25 0014 CF92 push r12 |
||
25 | 26 0016 DF92 push r13 |
||
26 | 27 0018 EF92 push r14 |
||
27 | 28 001a FF92 push r15 |
||
28 | 29 001c 0F93 push r16 |
||
29 | 30 001e 1F93 push r17 |
||
30 | 31 0020 CF93 push r28 |
||
31 | 32 0022 DF93 push r29 |
||
32 | 33 0024 CDB7 in r28,__SP_L__ |
||
33 | 34 0026 DEB7 in r29,__SP_H__ |
||
34 | 35 0028 2297 sbiw r28,2 |
||
35 | 36 002a 0FB6 in __tmp_reg__,__SREG__ |
||
36 | 37 002c F894 cli |
||
37 | 38 002e DEBF out __SP_H__,r29 |
||
38 | 39 0030 0FBE out __SREG__,__tmp_reg__ |
||
39 | 40 0032 CDBF out __SP_L__,r28 |
||
40 | 41 /* prologue end (size=26) */ |
||
41 | 42 0034 8091 0000 lds r24,AdNeutralGier |
||
42 | 43 0038 9091 0000 lds r25,(AdNeutralGier)+1 |
||
43 | 44 003c 2091 0000 lds r18,AdWertGier |
||
44 | 45 0040 3091 0000 lds r19,(AdWertGier)+1 |
||
45 | 46 0044 821B sub r24,r18 |
||
46 | 47 0046 930B sbc r25,r19 |
||
47 | 48 0048 9093 0000 sts (MesswertGier)+1,r25 |
||
48 | 49 004c 8093 0000 sts MesswertGier,r24 |
||
49 | 50 0050 8091 0000 lds r24,AdWertRoll |
||
50 | 51 0054 9091 0000 lds r25,(AdWertRoll)+1 |
||
51 | 52 0058 2091 0000 lds r18,AdNeutralRoll |
||
52 | 53 005c 3091 0000 lds r19,(AdNeutralRoll)+1 |
||
53 | 54 0060 821B sub r24,r18 |
||
54 | 55 0062 930B sbc r25,r19 |
||
55 | 56 0064 9093 0000 sts (MesswertRoll)+1,r25 |
||
56 | 57 0068 8093 0000 sts MesswertRoll,r24 |
||
57 | 58 006c 8091 0000 lds r24,AdWertNick |
||
58 | 59 0070 9091 0000 lds r25,(AdWertNick)+1 |
||
59 | 60 0074 2091 0000 lds r18,AdNeutralNick |
||
60 | 61 0078 3091 0000 lds r19,(AdNeutralNick)+1 |
||
61 | 62 007c 821B sub r24,r18 |
||
62 | 63 007e 930B sbc r25,r19 |
||
63 | 64 0080 9093 0000 sts (MesswertNick)+1,r25 |
||
64 | 65 0084 8093 0000 sts MesswertNick,r24 |
||
65 | 66 0088 E090 0000 lds r14,Mittelwert_AccNick |
||
66 | 67 008c F090 0000 lds r15,(Mittelwert_AccNick)+1 |
||
67 | 68 0090 6091 0000 lds r22,AdWertAccNick |
||
68 | 69 0094 7091 0000 lds r23,(AdWertAccNick)+1 |
||
69 | 70 0098 0027 clr r16 |
||
70 | 71 009a F7FC sbrc r15,7 |
||
71 | 72 009c 0095 com r16 |
||
72 | 73 009e 102F mov r17,r16 |
||
73 | 74 00a0 8827 clr r24 |
||
74 | 75 00a2 77FD sbrc r23,7 |
||
75 | 76 00a4 8095 com r24 |
||
76 | 77 00a6 982F mov r25,r24 |
||
77 | 78 00a8 2CE0 ldi r18,lo8(12) |
||
78 | 79 00aa 30E0 ldi r19,hi8(12) |
||
79 | 80 00ac 40E0 ldi r20,hlo8(12) |
||
80 | 81 00ae 50E0 ldi r21,hhi8(12) |
||
81 | 82 00b0 0E94 0000 call __mulsi3 |
||
82 | 83 00b4 E60E add r14,r22 |
||
83 | 84 00b6 F71E adc r15,r23 |
||
84 | 85 00b8 081F adc r16,r24 |
||
85 | 86 00ba 191F adc r17,r25 |
||
86 | 87 00bc C801 movw r24,r16 |
||
87 | 88 00be B701 movw r22,r14 |
||
88 | 89 00c0 22E0 ldi r18,lo8(2) |
||
89 | 90 00c2 30E0 ldi r19,hi8(2) |
||
90 | 91 00c4 40E0 ldi r20,hlo8(2) |
||
91 | 92 00c6 50E0 ldi r21,hhi8(2) |
||
92 | 93 00c8 0E94 0000 call __divmodsi4 |
||
93 | 94 00cc 3093 0000 sts (Mittelwert_AccNick)+1,r19 |
||
94 | 95 00d0 2093 0000 sts Mittelwert_AccNick,r18 |
||
95 | 96 00d4 E090 0000 lds r14,Mittelwert_AccRoll |
||
96 | 97 00d8 F090 0000 lds r15,(Mittelwert_AccRoll)+1 |
||
97 | 98 00dc 6091 0000 lds r22,AdWertAccRoll |
||
98 | 99 00e0 7091 0000 lds r23,(AdWertAccRoll)+1 |
||
99 | 100 00e4 0027 clr r16 |
||
100 | 101 00e6 F7FC sbrc r15,7 |
||
101 | 102 00e8 0095 com r16 |
||
102 | 103 00ea 102F mov r17,r16 |
||
103 | 104 00ec 8827 clr r24 |
||
104 | 105 00ee 77FD sbrc r23,7 |
||
105 | 106 00f0 8095 com r24 |
||
106 | 107 00f2 982F mov r25,r24 |
||
107 | 108 00f4 2CE0 ldi r18,lo8(12) |
||
108 | 109 00f6 30E0 ldi r19,hi8(12) |
||
109 | 110 00f8 40E0 ldi r20,hlo8(12) |
||
110 | 111 00fa 50E0 ldi r21,hhi8(12) |
||
111 | 112 00fc 0E94 0000 call __mulsi3 |
||
112 | 113 0100 E60E add r14,r22 |
||
113 | 114 0102 F71E adc r15,r23 |
||
114 | 115 0104 081F adc r16,r24 |
||
115 | 116 0106 191F adc r17,r25 |
||
116 | 117 0108 C801 movw r24,r16 |
||
117 | 118 010a B701 movw r22,r14 |
||
118 | 119 010c 22E0 ldi r18,lo8(2) |
||
119 | 120 010e 30E0 ldi r19,hi8(2) |
||
120 | 121 0110 40E0 ldi r20,hlo8(2) |
||
121 | 122 0112 50E0 ldi r21,hhi8(2) |
||
122 | 123 0114 0E94 0000 call __divmodsi4 |
||
123 | 124 0118 3093 0000 sts (Mittelwert_AccRoll)+1,r19 |
||
124 | 125 011c 2093 0000 sts Mittelwert_AccRoll,r18 |
||
125 | 126 0120 6091 0000 lds r22,Mittelwert_AccHoch |
||
126 | 127 0124 7091 0000 lds r23,(Mittelwert_AccHoch)+1 |
||
127 | 128 0128 2091 0000 lds r18,AdWertAccHoch |
||
128 | 129 012c 3091 0000 lds r19,(AdWertAccHoch)+1 |
||
129 | 130 0130 8827 clr r24 |
||
130 | 131 0132 77FD sbrc r23,7 |
||
131 | 132 0134 8095 com r24 |
||
132 | 133 0136 982F mov r25,r24 |
||
133 | 134 0138 4427 clr r20 |
||
134 | 135 013a 37FD sbrc r19,7 |
||
135 | 136 013c 4095 com r20 |
||
136 | 137 013e 542F mov r21,r20 |
||
137 | 138 0140 620F add r22,r18 |
||
138 | 139 0142 731F adc r23,r19 |
||
139 | 140 0144 841F adc r24,r20 |
||
140 | 141 0146 951F adc r25,r21 |
||
141 | 142 0148 22E0 ldi r18,lo8(2) |
||
142 | 143 014a 30E0 ldi r19,hi8(2) |
||
143 | 144 014c 40E0 ldi r20,hlo8(2) |
||
144 | 145 014e 50E0 ldi r21,hhi8(2) |
||
145 | 146 0150 0E94 0000 call __divmodsi4 |
||
146 | 147 0154 3093 0000 sts (Mittelwert_AccHoch)+1,r19 |
||
147 | 148 0158 2093 0000 sts Mittelwert_AccHoch,r18 |
||
148 | 149 015c 2091 0000 lds r18,IntegralAccNick |
||
149 | 150 0160 3091 0000 lds r19,(IntegralAccNick)+1 |
||
150 | 151 0164 4091 0000 lds r20,(IntegralAccNick)+2 |
||
151 | 152 0168 5091 0000 lds r21,(IntegralAccNick)+3 |
||
152 | 153 016c 6091 0000 lds r22,AdWertAccNick |
||
153 | 154 0170 7091 0000 lds r23,(AdWertAccNick)+1 |
||
154 | 155 0174 CB01 movw r24,r22 |
||
155 | 156 0176 880F lsl r24 |
||
156 | 157 0178 991F rol r25 |
||
157 | 158 017a 860F add r24,r22 |
||
158 | 159 017c 971F adc r25,r23 |
||
159 | 160 017e 880F lsl r24 |
||
160 | 161 0180 991F rol r25 |
||
161 | 162 0182 880F lsl r24 |
||
162 | 163 0184 991F rol r25 |
||
163 | 164 0186 AA27 clr r26 |
||
164 | 165 0188 97FD sbrc r25,7 |
||
165 | 166 018a A095 com r26 |
||
166 | 167 018c BA2F mov r27,r26 |
||
167 | 168 018e 280F add r18,r24 |
||
168 | 169 0190 391F adc r19,r25 |
||
169 | 170 0192 4A1F adc r20,r26 |
||
170 | 171 0194 5B1F adc r21,r27 |
||
171 | 172 0196 2093 0000 sts IntegralAccNick,r18 |
||
172 | 173 019a 3093 0000 sts (IntegralAccNick)+1,r19 |
||
173 | 174 019e 4093 0000 sts (IntegralAccNick)+2,r20 |
||
174 | 175 01a2 5093 0000 sts (IntegralAccNick)+3,r21 |
||
175 | 176 01a6 2091 0000 lds r18,IntegralAccRoll |
||
176 | 177 01aa 3091 0000 lds r19,(IntegralAccRoll)+1 |
||
177 | 178 01ae 4091 0000 lds r20,(IntegralAccRoll)+2 |
||
178 | 179 01b2 5091 0000 lds r21,(IntegralAccRoll)+3 |
||
179 | 180 01b6 6091 0000 lds r22,AdWertAccRoll |
||
180 | 181 01ba 7091 0000 lds r23,(AdWertAccRoll)+1 |
||
181 | 182 01be CB01 movw r24,r22 |
||
182 | 183 01c0 880F lsl r24 |
||
183 | 184 01c2 991F rol r25 |
||
184 | 185 01c4 860F add r24,r22 |
||
185 | 186 01c6 971F adc r25,r23 |
||
186 | 187 01c8 880F lsl r24 |
||
187 | 188 01ca 991F rol r25 |
||
188 | 189 01cc 880F lsl r24 |
||
189 | 190 01ce 991F rol r25 |
||
190 | 191 01d0 AA27 clr r26 |
||
191 | 192 01d2 97FD sbrc r25,7 |
||
192 | 193 01d4 A095 com r26 |
||
193 | 194 01d6 BA2F mov r27,r26 |
||
194 | 195 01d8 280F add r18,r24 |
||
195 | 196 01da 391F adc r19,r25 |
||
196 | 197 01dc 4A1F adc r20,r26 |
||
197 | 198 01de 5B1F adc r21,r27 |
||
198 | 199 01e0 2093 0000 sts IntegralAccRoll,r18 |
||
199 | 200 01e4 3093 0000 sts (IntegralAccRoll)+1,r19 |
||
200 | 201 01e8 4093 0000 sts (IntegralAccRoll)+2,r20 |
||
201 | 202 01ec 5093 0000 sts (IntegralAccRoll)+3,r21 |
||
202 | 203 01f0 6091 0000 lds r22,IntegralAccZ |
||
203 | 204 01f4 7091 0000 lds r23,(IntegralAccZ)+1 |
||
204 | 205 01f8 8091 0000 lds r24,(IntegralAccZ)+2 |
||
205 | 206 01fc 9091 0000 lds r25,(IntegralAccZ)+3 |
||
206 | 207 0200 E090 0000 lds r14,Aktuell_az |
||
207 | 208 0204 F090 0000 lds r15,(Aktuell_az)+1 |
||
208 | 209 0208 A090 0000 lds r10,NeutralAccZ |
||
209 | 210 020c B090 0000 lds r11,(NeutralAccZ)+1 |
||
210 | 211 0210 C090 0000 lds r12,(NeutralAccZ)+2 |
||
211 | 212 0214 D090 0000 lds r13,(NeutralAccZ)+3 |
||
212 | 213 0218 0E94 0000 call __floatsisf |
||
213 | 214 021c 3B01 movw r6,r22 |
||
214 | 215 021e 4C01 movw r8,r24 |
||
215 | 216 0220 0027 clr r16 |
||
216 | 217 0222 F7FC sbrc r15,7 |
||
217 | 218 0224 0095 com r16 |
||
218 | 219 0226 102F mov r17,r16 |
||
219 | 220 0228 C801 movw r24,r16 |
||
220 | 221 022a B701 movw r22,r14 |
||
221 | 222 022c 0E94 0000 call __floatsisf |
||
222 | 223 0230 A601 movw r20,r12 |
||
223 | 224 0232 9501 movw r18,r10 |
||
224 | 225 0234 0E94 0000 call __subsf3 |
||
225 | 226 0238 9B01 movw r18,r22 |
||
226 | 227 023a AC01 movw r20,r24 |
||
227 | 228 023c C401 movw r24,r8 |
||
228 | 229 023e B301 movw r22,r6 |
||
229 | 230 0240 0E94 0000 call __addsf3 |
||
230 | 231 0244 0E94 0000 call __fixsfsi |
||
231 | 232 0248 6093 0000 sts IntegralAccZ,r22 |
||
232 | 233 024c 7093 0000 sts (IntegralAccZ)+1,r23 |
||
233 | 234 0250 8093 0000 sts (IntegralAccZ)+2,r24 |
||
234 | 235 0254 9093 0000 sts (IntegralAccZ)+3,r25 |
||
235 | 236 0258 2091 0000 lds r18,Mess_Integral_Gier |
||
236 | 237 025c 3091 0000 lds r19,(Mess_Integral_Gier)+1 |
||
237 | 238 0260 4091 0000 lds r20,(Mess_Integral_Gier)+2 |
||
238 | 239 0264 5091 0000 lds r21,(Mess_Integral_Gier)+3 |
||
239 | 240 0268 8091 0000 lds r24,MesswertGier |
||
240 | 241 026c 9091 0000 lds r25,(MesswertGier)+1 |
||
241 | 242 0270 AA27 clr r26 |
||
242 | 243 0272 97FD sbrc r25,7 |
||
243 | 244 0274 A095 com r26 |
||
244 | 245 0276 BA2F mov r27,r26 |
||
245 | 246 0278 280F add r18,r24 |
||
246 | 247 027a 391F adc r19,r25 |
||
247 | 248 027c 4A1F adc r20,r26 |
||
248 | 249 027e 5B1F adc r21,r27 |
||
249 | 250 0280 2093 0000 sts Mess_Integral_Gier,r18 |
||
250 | 251 0284 3093 0000 sts (Mess_Integral_Gier)+1,r19 |
||
251 | 252 0288 4093 0000 sts (Mess_Integral_Gier)+2,r20 |
||
252 | 253 028c 5093 0000 sts (Mess_Integral_Gier)+3,r21 |
||
253 | 254 0290 2091 0000 lds r18,Mess_Integral_Gier2 |
||
254 | 255 0294 3091 0000 lds r19,(Mess_Integral_Gier2)+1 |
||
255 | 256 0298 4091 0000 lds r20,(Mess_Integral_Gier2)+2 |
||
256 | 257 029c 5091 0000 lds r21,(Mess_Integral_Gier2)+3 |
||
257 | 258 02a0 8091 0000 lds r24,MesswertGier |
||
258 | 259 02a4 9091 0000 lds r25,(MesswertGier)+1 |
||
259 | 260 02a8 AA27 clr r26 |
||
260 | 261 02aa 97FD sbrc r25,7 |
||
261 | 262 02ac A095 com r26 |
||
262 | 263 02ae BA2F mov r27,r26 |
||
263 | 264 02b0 280F add r18,r24 |
||
264 | 265 02b2 391F adc r19,r25 |
||
265 | 266 02b4 4A1F adc r20,r26 |
||
266 | 267 02b6 5B1F adc r21,r27 |
||
267 | 268 02b8 2093 0000 sts Mess_Integral_Gier2,r18 |
||
268 | 269 02bc 3093 0000 sts (Mess_Integral_Gier2)+1,r19 |
||
269 | 270 02c0 4093 0000 sts (Mess_Integral_Gier2)+2,r20 |
||
270 | 271 02c4 5093 0000 sts (Mess_Integral_Gier2)+3,r21 |
||
271 | 272 02c8 2091 0000 lds r18,Looping_Nick |
||
272 | 273 02cc 2A83 std Y+2,r18 |
||
273 | 274 02ce 2223 tst r18 |
||
274 | 275 02d0 01F0 breq .+2 |
||
275 | 276 02d2 00C0 rjmp .L2 |
||
276 | 277 02d4 8091 0000 lds r24,Looping_Roll |
||
277 | 278 02d8 8823 tst r24 |
||
278 | 279 02da 01F0 breq .+2 |
||
279 | 280 02dc 00C0 rjmp .L2 |
||
280 | 281 02de 8091 0000 lds r24,EE_Parameter+8 |
||
281 | 282 02e2 86FF sbrs r24,6 |
||
282 | 283 02e4 00C0 rjmp .L2 |
||
283 | 284 02e6 6091 0000 lds r22,Mess_IntegralNick |
||
284 | 285 02ea 7091 0000 lds r23,(Mess_IntegralNick)+1 |
||
285 | 286 02ee 8091 0000 lds r24,(Mess_IntegralNick)+2 |
||
286 | 287 02f2 9091 0000 lds r25,(Mess_IntegralNick)+3 |
||
287 | 288 02f6 E090 0000 lds r14,MesswertGier |
||
288 | 289 02fa F090 0000 lds r15,(MesswertGier)+1 |
||
289 | 290 02fe A090 0000 lds r10,Parameter_AchsKopplung1 |
||
290 | 291 0302 BB24 clr r11 |
||
291 | 292 0304 CC24 clr r12 |
||
292 | 293 0306 DD24 clr r13 |
||
293 | 294 0308 20E0 ldi r18,lo8(4096) |
||
294 | 295 030a 30E1 ldi r19,hi8(4096) |
||
295 | 296 030c 40E0 ldi r20,hlo8(4096) |
||
296 | 297 030e 50E0 ldi r21,hhi8(4096) |
||
297 | 298 0310 0E94 0000 call __divmodsi4 |
||
298 | 299 0314 0027 clr r16 |
||
299 | 300 0316 F7FC sbrc r15,7 |
||
300 | 301 0318 0095 com r16 |
||
301 | 302 031a 102F mov r17,r16 |
||
302 | 303 031c CA01 movw r24,r20 |
||
303 | 304 031e B901 movw r22,r18 |
||
304 | 305 0320 A801 movw r20,r16 |
||
305 | 306 0322 9701 movw r18,r14 |
||
306 | 307 0324 0E94 0000 call __mulsi3 |
||
307 | 308 0328 A601 movw r20,r12 |
||
308 | 309 032a 9501 movw r18,r10 |
||
309 | 310 032c 0E94 0000 call __mulsi3 |
||
310 | 311 0330 20E0 ldi r18,lo8(2048) |
||
311 | 312 0332 38E0 ldi r19,hi8(2048) |
||
312 | 313 0334 40E0 ldi r20,hlo8(2048) |
||
313 | 314 0336 50E0 ldi r21,hhi8(2048) |
||
314 | 315 0338 0E94 0000 call __divmodsi4 |
||
315 | 316 033c 2093 0000 sts tmpl.2203,r18 |
||
316 | 317 0340 3093 0000 sts (tmpl.2203)+1,r19 |
||
317 | 318 0344 4093 0000 sts (tmpl.2203)+2,r20 |
||
318 | 319 0348 5093 0000 sts (tmpl.2203)+3,r21 |
||
319 | 320 034c 6091 0000 lds r22,Mess_IntegralRoll |
||
320 | 321 0350 7091 0000 lds r23,(Mess_IntegralRoll)+1 |
||
321 | 322 0354 8091 0000 lds r24,(Mess_IntegralRoll)+2 |
||
322 | 323 0358 9091 0000 lds r25,(Mess_IntegralRoll)+3 |
||
323 | 324 035c E090 0000 lds r14,MesswertGier |
||
324 | 325 0360 F090 0000 lds r15,(MesswertGier)+1 |
||
325 | 326 0364 20E0 ldi r18,lo8(4096) |
||
326 | 327 0366 30E1 ldi r19,hi8(4096) |
||
327 | 328 0368 40E0 ldi r20,hlo8(4096) |
||
328 | 329 036a 50E0 ldi r21,hhi8(4096) |
||
329 | 330 036c 0E94 0000 call __divmodsi4 |
||
330 | 331 0370 0027 clr r16 |
||
331 | 332 0372 F7FC sbrc r15,7 |
||
332 | 333 0374 0095 com r16 |
||
333 | 334 0376 102F mov r17,r16 |
||
334 | 335 0378 CA01 movw r24,r20 |
||
335 | 336 037a B901 movw r22,r18 |
||
336 | 337 037c A801 movw r20,r16 |
||
337 | 338 037e 9701 movw r18,r14 |
||
338 | 339 0380 0E94 0000 call __mulsi3 |
||
339 | 340 0384 A601 movw r20,r12 |
||
340 | 341 0386 9501 movw r18,r10 |
||
341 | 342 0388 0E94 0000 call __mulsi3 |
||
342 | 343 038c 20E0 ldi r18,lo8(2048) |
||
343 | 344 038e 38E0 ldi r19,hi8(2048) |
||
344 | 345 0390 40E0 ldi r20,hlo8(2048) |
||
345 | 346 0392 50E0 ldi r21,hhi8(2048) |
||
346 | 347 0394 0E94 0000 call __divmodsi4 |
||
347 | 348 0398 2093 0000 sts tmpl2.2204,r18 |
||
348 | 349 039c 3093 0000 sts (tmpl2.2204)+1,r19 |
||
349 | 350 03a0 4093 0000 sts (tmpl2.2204)+2,r20 |
||
350 | 351 03a4 5093 0000 sts (tmpl2.2204)+3,r21 |
||
351 | 352 03a8 00C0 rjmp .L6 |
||
352 | 353 .L2: |
||
353 | 354 03aa 1092 0000 sts tmpl2.2204,__zero_reg__ |
||
354 | 355 03ae 1092 0000 sts (tmpl2.2204)+1,__zero_reg__ |
||
355 | 356 03b2 1092 0000 sts (tmpl2.2204)+2,__zero_reg__ |
||
356 | 357 03b6 1092 0000 sts (tmpl2.2204)+3,__zero_reg__ |
||
357 | 358 03ba 1092 0000 sts tmpl.2203,__zero_reg__ |
||
358 | 359 03be 1092 0000 sts (tmpl.2203)+1,__zero_reg__ |
||
359 | 360 03c2 1092 0000 sts (tmpl.2203)+2,__zero_reg__ |
||
360 | 361 03c6 1092 0000 sts (tmpl.2203)+3,__zero_reg__ |
||
361 | 362 .L6: |
||
362 | 363 03ca 8091 0000 lds r24,MesswertRoll |
||
363 | 364 03ce 9091 0000 lds r25,(MesswertRoll)+1 |
||
364 | 365 03d2 2090 0000 lds r2,tmpl.2203 |
||
365 | 366 03d6 3090 0000 lds r3,(tmpl.2203)+1 |
||
366 | 367 03da 4090 0000 lds r4,(tmpl.2203)+2 |
||
367 | 368 03de 5090 0000 lds r5,(tmpl.2203)+3 |
||
368 | 369 03e2 820D add r24,r2 |
||
369 | 370 03e4 931D adc r25,r3 |
||
370 | 371 03e6 9093 0000 sts (MesswertRoll)+1,r25 |
||
371 | 372 03ea 8093 0000 sts MesswertRoll,r24 |
||
372 | 373 03ee 0091 0000 lds r16,MesswertRoll |
||
373 | 374 03f2 1091 0000 lds r17,(MesswertRoll)+1 |
||
374 | 375 03f6 A090 0000 lds r10,tmpl2.2204 |
||
375 | 376 03fa B090 0000 lds r11,(tmpl2.2204)+1 |
||
376 | 377 03fe C090 0000 lds r12,(tmpl2.2204)+2 |
||
377 | 378 0402 D090 0000 lds r13,(tmpl2.2204)+3 |
||
378 | 379 0406 8091 0000 lds r24,Parameter_AchsGegenKopplung1 |
||
379 | 380 040a 682E mov r6,r24 |
||
380 | 381 040c 7724 clr r7 |
||
381 | 382 040e 8824 clr r8 |
||
382 | 383 0410 9924 clr r9 |
||
383 | 384 0412 C601 movw r24,r12 |
||
384 | 385 0414 B501 movw r22,r10 |
||
385 | 386 0416 A401 movw r20,r8 |
||
386 | 387 0418 9301 movw r18,r6 |
||
387 | 388 041a 0E94 0000 call __mulsi3 |
||
388 | 389 041e 20E0 ldi r18,lo8(512) |
||
389 | 390 0420 32E0 ldi r19,hi8(512) |
||
390 | 391 0422 40E0 ldi r20,hlo8(512) |
||
391 | 392 0424 50E0 ldi r21,hhi8(512) |
||
392 | 393 0426 0E94 0000 call __divmodsi4 |
||
393 | 394 042a 020F add r16,r18 |
||
394 | 395 042c 131F adc r17,r19 |
||
395 | 396 042e 1093 0000 sts (MesswertRoll)+1,r17 |
||
396 | 397 0432 0093 0000 sts MesswertRoll,r16 |
||
397 | 398 0436 2091 0000 lds r18,Mess_IntegralRoll2 |
||
398 | 399 043a 3091 0000 lds r19,(Mess_IntegralRoll2)+1 |
||
399 | 400 043e 4091 0000 lds r20,(Mess_IntegralRoll2)+2 |
||
400 | 401 0442 5091 0000 lds r21,(Mess_IntegralRoll2)+3 |
||
401 | 402 0446 8091 0000 lds r24,MesswertRoll |
||
402 | 403 044a 9091 0000 lds r25,(MesswertRoll)+1 |
||
403 | 404 044e AA27 clr r26 |
||
404 | 405 0450 97FD sbrc r25,7 |
||
405 | 406 0452 A095 com r26 |
||
406 | 407 0454 BA2F mov r27,r26 |
||
407 | 408 0456 280F add r18,r24 |
||
408 | 409 0458 391F adc r19,r25 |
||
409 | 410 045a 4A1F adc r20,r26 |
||
410 | 411 045c 5B1F adc r21,r27 |
||
411 | 412 045e 2093 0000 sts Mess_IntegralRoll2,r18 |
||
412 | 413 0462 3093 0000 sts (Mess_IntegralRoll2)+1,r19 |
||
413 | 414 0466 4093 0000 sts (Mess_IntegralRoll2)+2,r20 |
||
414 | 415 046a 5093 0000 sts (Mess_IntegralRoll2)+3,r21 |
||
415 | 416 046e 2091 0000 lds r18,Mess_IntegralRoll |
||
416 | 417 0472 3091 0000 lds r19,(Mess_IntegralRoll)+1 |
||
417 | 418 0476 4091 0000 lds r20,(Mess_IntegralRoll)+2 |
||
418 | 419 047a 5091 0000 lds r21,(Mess_IntegralRoll)+3 |
||
419 | 420 047e 8091 0000 lds r24,MesswertRoll |
||
420 | 421 0482 9091 0000 lds r25,(MesswertRoll)+1 |
||
421 | 422 0486 6091 0000 lds r22,LageKorrekturRoll |
||
422 | 423 048a 7091 0000 lds r23,(LageKorrekturRoll)+1 |
||
423 | 424 048e 861B sub r24,r22 |
||
424 | 425 0490 970B sbc r25,r23 |
||
425 | 426 0492 AA27 clr r26 |
||
426 | 427 0494 97FD sbrc r25,7 |
||
427 | 428 0496 A095 com r26 |
||
428 | 429 0498 BA2F mov r27,r26 |
||
429 | 430 049a 280F add r18,r24 |
||
430 | 431 049c 391F adc r19,r25 |
||
431 | 432 049e 4A1F adc r20,r26 |
||
432 | 433 04a0 5B1F adc r21,r27 |
||
433 | 434 04a2 2093 0000 sts Mess_IntegralRoll,r18 |
||
434 | 435 04a6 3093 0000 sts (Mess_IntegralRoll)+1,r19 |
||
435 | 436 04aa 4093 0000 sts (Mess_IntegralRoll)+2,r20 |
||
436 | 437 04ae 5093 0000 sts (Mess_IntegralRoll)+3,r21 |
||
437 | 438 04b2 8091 0000 lds r24,Mess_IntegralRoll |
||
438 | 439 04b6 9091 0000 lds r25,(Mess_IntegralRoll)+1 |
||
439 | 440 04ba A091 0000 lds r26,(Mess_IntegralRoll)+2 |
||
440 | 441 04be B091 0000 lds r27,(Mess_IntegralRoll)+3 |
||
441 | 442 04c2 E090 0000 lds r14,Umschlag180Roll |
||
442 | 443 04c6 F090 0000 lds r15,(Umschlag180Roll)+1 |
||
443 | 444 04ca 0091 0000 lds r16,(Umschlag180Roll)+2 |
||
444 | 445 04ce 1091 0000 lds r17,(Umschlag180Roll)+3 |
||
445 | 446 04d2 E816 cp r14,r24 |
||
446 | 447 04d4 F906 cpc r15,r25 |
||
447 | 448 04d6 0A07 cpc r16,r26 |
||
448 | 449 04d8 1B07 cpc r17,r27 |
||
449 | 450 04da 04F4 brge .L7 |
||
450 | 451 04dc 80E1 ldi r24,lo8(10000) |
||
451 | 452 04de 97E2 ldi r25,hi8(10000) |
||
452 | 453 04e0 A0E0 ldi r26,hlo8(10000) |
||
453 | 454 04e2 B0E0 ldi r27,hhi8(10000) |
||
454 | 455 04e4 8E19 sub r24,r14 |
||
455 | 456 04e6 9F09 sbc r25,r15 |
||
456 | 457 04e8 A00B sbc r26,r16 |
||
457 | 458 04ea B10B sbc r27,r17 |
||
458 | 459 04ec 8093 0000 sts Mess_IntegralRoll,r24 |
||
459 | 460 04f0 9093 0000 sts (Mess_IntegralRoll)+1,r25 |
||
460 | 461 04f4 A093 0000 sts (Mess_IntegralRoll)+2,r26 |
||
461 | 462 04f8 B093 0000 sts (Mess_IntegralRoll)+3,r27 |
||
462 | 463 04fc 8091 0000 lds r24,Mess_IntegralRoll |
||
463 | 464 0500 9091 0000 lds r25,(Mess_IntegralRoll)+1 |
||
464 | 465 0504 A091 0000 lds r26,(Mess_IntegralRoll)+2 |
||
465 | 466 0508 B091 0000 lds r27,(Mess_IntegralRoll)+3 |
||
466 | 467 050c 8093 0000 sts Mess_IntegralRoll2,r24 |
||
467 | 468 0510 9093 0000 sts (Mess_IntegralRoll2)+1,r25 |
||
468 | 469 0514 A093 0000 sts (Mess_IntegralRoll2)+2,r26 |
||
469 | 470 0518 B093 0000 sts (Mess_IntegralRoll2)+3,r27 |
||
470 | 471 .L7: |
||
471 | 472 051c 2091 0000 lds r18,Mess_IntegralRoll |
||
472 | 473 0520 3091 0000 lds r19,(Mess_IntegralRoll)+1 |
||
473 | 474 0524 4091 0000 lds r20,(Mess_IntegralRoll)+2 |
||
474 | 475 0528 5091 0000 lds r21,(Mess_IntegralRoll)+3 |
||
475 | 476 052c 8827 clr r24 |
||
476 | 477 052e 9927 clr r25 |
||
477 | 478 0530 DC01 movw r26,r24 |
||
478 | 479 0532 8E19 sub r24,r14 |
||
479 | 480 0534 9F09 sbc r25,r15 |
||
480 | 481 0536 A00B sbc r26,r16 |
||
481 | 482 0538 B10B sbc r27,r17 |
||
482 | 483 053a 2817 cp r18,r24 |
||
483 | 484 053c 3907 cpc r19,r25 |
||
484 | 485 053e 4A07 cpc r20,r26 |
||
485 | 486 0540 5B07 cpc r21,r27 |
||
486 | 487 0542 04F4 brge .L9 |
||
487 | 488 0544 80EF ldi r24,lo8(-10000) |
||
488 | 489 0546 98ED ldi r25,hi8(-10000) |
||
489 | 490 0548 AFEF ldi r26,hlo8(-10000) |
||
490 | 491 054a BFEF ldi r27,hhi8(-10000) |
||
491 | 492 054c E80E add r14,r24 |
||
492 | 493 054e F91E adc r15,r25 |
||
493 | 494 0550 0A1F adc r16,r26 |
||
494 | 495 0552 1B1F adc r17,r27 |
||
495 | 496 0554 E092 0000 sts Mess_IntegralRoll,r14 |
||
496 | 497 0558 F092 0000 sts (Mess_IntegralRoll)+1,r15 |
||
497 | 498 055c 0093 0000 sts (Mess_IntegralRoll)+2,r16 |
||
498 | 499 0560 1093 0000 sts (Mess_IntegralRoll)+3,r17 |
||
499 | 500 0564 8091 0000 lds r24,Mess_IntegralRoll |
||
500 | 501 0568 9091 0000 lds r25,(Mess_IntegralRoll)+1 |
||
501 | 502 056c A091 0000 lds r26,(Mess_IntegralRoll)+2 |
||
502 | 503 0570 B091 0000 lds r27,(Mess_IntegralRoll)+3 |
||
503 | 504 0574 8093 0000 sts Mess_IntegralRoll2,r24 |
||
504 | 505 0578 9093 0000 sts (Mess_IntegralRoll2)+1,r25 |
||
505 | 506 057c A093 0000 sts (Mess_IntegralRoll2)+2,r26 |
||
506 | 507 0580 B093 0000 sts (Mess_IntegralRoll2)+3,r27 |
||
507 | 508 .L9: |
||
508 | 509 0584 8091 0000 lds r24,AdWertRoll |
||
509 | 510 0588 9091 0000 lds r25,(AdWertRoll)+1 |
||
510 | 511 058c 0F97 sbiw r24,15 |
||
511 | 512 058e 04F4 brge .L11 |
||
512 | 513 0590 88E1 ldi r24,lo8(-1000) |
||
513 | 514 0592 9CEF ldi r25,hi8(-1000) |
||
514 | 515 0594 9093 0000 sts (MesswertRoll)+1,r25 |
||
515 | 516 0598 8093 0000 sts MesswertRoll,r24 |
||
516 | 517 .L11: |
||
517 | 518 059c 8091 0000 lds r24,AdWertRoll |
||
518 | 519 05a0 9091 0000 lds r25,(AdWertRoll)+1 |
||
519 | 520 05a4 0797 sbiw r24,7 |
||
520 | 521 05a6 04F4 brge .L13 |
||
521 | 522 05a8 80E3 ldi r24,lo8(-2000) |
||
522 | 523 05aa 98EF ldi r25,hi8(-2000) |
||
523 | 524 05ac 9093 0000 sts (MesswertRoll)+1,r25 |
||
524 | 525 05b0 8093 0000 sts MesswertRoll,r24 |
||
525 | 526 .L13: |
||
526 | 527 05b4 9091 0000 lds r25,PlatinenVersion |
||
527 | 528 05b8 9983 std Y+1,r25 |
||
528 | 529 05ba 9A30 cpi r25,lo8(10) |
||
529 | 530 05bc 01F4 brne .L15 |
||
530 | 531 05be 8091 0000 lds r24,AdWertRoll |
||
531 | 532 05c2 9091 0000 lds r25,(AdWertRoll)+1 |
||
532 | 533 05c6 835F subi r24,lo8(1011) |
||
533 | 534 05c8 9340 sbci r25,hi8(1011) |
||
534 | 535 05ca 04F0 brlt .L17 |
||
535 | 536 05cc 88EE ldi r24,lo8(1000) |
||
536 | 537 05ce 93E0 ldi r25,hi8(1000) |
||
537 | 538 05d0 9093 0000 sts (MesswertRoll)+1,r25 |
||
538 | 539 05d4 8093 0000 sts MesswertRoll,r24 |
||
539 | 540 .L17: |
||
540 | 541 05d8 8091 0000 lds r24,AdWertRoll |
||
541 | 542 05dc 9091 0000 lds r25,(AdWertRoll)+1 |
||
542 | 543 05e0 8A5F subi r24,lo8(1018) |
||
543 | 544 05e2 9340 sbci r25,hi8(1018) |
||
544 | 545 05e4 04F0 brlt .L19 |
||
545 | 546 05e6 00C0 rjmp .L89 |
||
546 | 547 .L15: |
||
547 | 548 05e8 8091 0000 lds r24,AdWertRoll |
||
548 | 549 05ec 9091 0000 lds r25,(AdWertRoll)+1 |
||
549 | 550 05f0 855E subi r24,lo8(2021) |
||
550 | 551 05f2 9740 sbci r25,hi8(2021) |
||
551 | 552 05f4 04F0 brlt .L21 |
||
552 | 553 05f6 88EE ldi r24,lo8(1000) |
||
553 | 554 05f8 93E0 ldi r25,hi8(1000) |
||
554 | 555 05fa 9093 0000 sts (MesswertRoll)+1,r25 |
||
555 | 556 05fe 8093 0000 sts MesswertRoll,r24 |
||
556 | 557 .L21: |
||
557 | 558 0602 8091 0000 lds r24,AdWertRoll |
||
558 | 559 0606 9091 0000 lds r25,(AdWertRoll)+1 |
||
559 | 560 060a 835F subi r24,lo8(2035) |
||
560 | 561 060c 9740 sbci r25,hi8(2035) |
||
561 | 562 060e 04F0 brlt .L19 |
||
562 | 563 .L89: |
||
563 | 564 0610 80ED ldi r24,lo8(2000) |
||
564 | 565 0612 97E0 ldi r25,hi8(2000) |
||
565 | 566 0614 9093 0000 sts (MesswertRoll)+1,r25 |
||
566 | 567 0618 8093 0000 sts MesswertRoll,r24 |
||
567 | 568 .L19: |
||
568 | 569 061c 8091 0000 lds r24,MesswertNick |
||
569 | 570 0620 9091 0000 lds r25,(MesswertNick)+1 |
||
570 | 571 0624 8A19 sub r24,r10 |
||
571 | 572 0626 9B09 sbc r25,r11 |
||
572 | 573 0628 9093 0000 sts (MesswertNick)+1,r25 |
||
573 | 574 062c 8093 0000 sts MesswertNick,r24 |
||
574 | 575 0630 0091 0000 lds r16,MesswertNick |
||
575 | 576 0634 1091 0000 lds r17,(MesswertNick)+1 |
||
576 | 577 0638 C201 movw r24,r4 |
||
577 | 578 063a B101 movw r22,r2 |
||
578 | 579 063c A401 movw r20,r8 |
||
579 | 580 063e 9301 movw r18,r6 |
||
580 | 581 0640 0E94 0000 call __mulsi3 |
||
581 | 582 0644 20E0 ldi r18,lo8(512) |
||
582 | 583 0646 32E0 ldi r19,hi8(512) |
||
583 | 584 0648 40E0 ldi r20,hlo8(512) |
||
584 | 585 064a 50E0 ldi r21,hhi8(512) |
||
585 | 586 064c 0E94 0000 call __divmodsi4 |
||
586 | 587 0650 021B sub r16,r18 |
||
587 | 588 0652 130B sbc r17,r19 |
||
588 | 589 0654 1093 0000 sts (MesswertNick)+1,r17 |
||
589 | 590 0658 0093 0000 sts MesswertNick,r16 |
||
590 | 591 065c 2091 0000 lds r18,Mess_IntegralNick2 |
||
591 | 592 0660 3091 0000 lds r19,(Mess_IntegralNick2)+1 |
||
592 | 593 0664 4091 0000 lds r20,(Mess_IntegralNick2)+2 |
||
593 | 594 0668 5091 0000 lds r21,(Mess_IntegralNick2)+3 |
||
594 | 595 066c 8091 0000 lds r24,MesswertNick |
||
595 | 596 0670 9091 0000 lds r25,(MesswertNick)+1 |
||
596 | 597 0674 AA27 clr r26 |
||
597 | 598 0676 97FD sbrc r25,7 |
||
598 | 599 0678 A095 com r26 |
||
599 | 600 067a BA2F mov r27,r26 |
||
600 | 601 067c 280F add r18,r24 |
||
601 | 602 067e 391F adc r19,r25 |
||
602 | 603 0680 4A1F adc r20,r26 |
||
603 | 604 0682 5B1F adc r21,r27 |
||
604 | 605 0684 2093 0000 sts Mess_IntegralNick2,r18 |
||
605 | 606 0688 3093 0000 sts (Mess_IntegralNick2)+1,r19 |
||
606 | 607 068c 4093 0000 sts (Mess_IntegralNick2)+2,r20 |
||
607 | 608 0690 5093 0000 sts (Mess_IntegralNick2)+3,r21 |
||
608 | 609 0694 2091 0000 lds r18,Mess_IntegralNick |
||
609 | 610 0698 3091 0000 lds r19,(Mess_IntegralNick)+1 |
||
610 | 611 069c 4091 0000 lds r20,(Mess_IntegralNick)+2 |
||
611 | 612 06a0 5091 0000 lds r21,(Mess_IntegralNick)+3 |
||
612 | 613 06a4 8091 0000 lds r24,MesswertNick |
||
613 | 614 06a8 9091 0000 lds r25,(MesswertNick)+1 |
||
614 | 615 06ac 6091 0000 lds r22,LageKorrekturNick |
||
615 | 616 06b0 7091 0000 lds r23,(LageKorrekturNick)+1 |
||
616 | 617 06b4 861B sub r24,r22 |
||
617 | 618 06b6 970B sbc r25,r23 |
||
618 | 619 06b8 AA27 clr r26 |
||
619 | 620 06ba 97FD sbrc r25,7 |
||
620 | 621 06bc A095 com r26 |
||
621 | 622 06be BA2F mov r27,r26 |
||
622 | 623 06c0 280F add r18,r24 |
||
623 | 624 06c2 391F adc r19,r25 |
||
624 | 625 06c4 4A1F adc r20,r26 |
||
625 | 626 06c6 5B1F adc r21,r27 |
||
626 | 627 06c8 2093 0000 sts Mess_IntegralNick,r18 |
||
627 | 628 06cc 3093 0000 sts (Mess_IntegralNick)+1,r19 |
||
628 | 629 06d0 4093 0000 sts (Mess_IntegralNick)+2,r20 |
||
629 | 630 06d4 5093 0000 sts (Mess_IntegralNick)+3,r21 |
||
630 | 631 06d8 8091 0000 lds r24,Mess_IntegralNick |
||
631 | 632 06dc 9091 0000 lds r25,(Mess_IntegralNick)+1 |
||
632 | 633 06e0 A091 0000 lds r26,(Mess_IntegralNick)+2 |
||
633 | 634 06e4 B091 0000 lds r27,(Mess_IntegralNick)+3 |
||
634 | 635 06e8 E090 0000 lds r14,Umschlag180Nick |
||
635 | 636 06ec F090 0000 lds r15,(Umschlag180Nick)+1 |
||
636 | 637 06f0 0091 0000 lds r16,(Umschlag180Nick)+2 |
||
637 | 638 06f4 1091 0000 lds r17,(Umschlag180Nick)+3 |
||
638 | 639 06f8 E816 cp r14,r24 |
||
639 | 640 06fa F906 cpc r15,r25 |
||
640 | 641 06fc 0A07 cpc r16,r26 |
||
641 | 642 06fe 1B07 cpc r17,r27 |
||
642 | 643 0700 04F4 brge .L24 |
||
643 | 644 0702 80E1 ldi r24,lo8(10000) |
||
644 | 645 0704 97E2 ldi r25,hi8(10000) |
||
645 | 646 0706 A0E0 ldi r26,hlo8(10000) |
||
646 | 647 0708 B0E0 ldi r27,hhi8(10000) |
||
647 | 648 070a 8E19 sub r24,r14 |
||
648 | 649 070c 9F09 sbc r25,r15 |
||
649 | 650 070e A00B sbc r26,r16 |
||
650 | 651 0710 B10B sbc r27,r17 |
||
651 | 652 0712 8093 0000 sts Mess_IntegralNick,r24 |
||
652 | 653 0716 9093 0000 sts (Mess_IntegralNick)+1,r25 |
||
653 | 654 071a A093 0000 sts (Mess_IntegralNick)+2,r26 |
||
654 | 655 071e B093 0000 sts (Mess_IntegralNick)+3,r27 |
||
655 | 656 0722 8091 0000 lds r24,Mess_IntegralNick |
||
656 | 657 0726 9091 0000 lds r25,(Mess_IntegralNick)+1 |
||
657 | 658 072a A091 0000 lds r26,(Mess_IntegralNick)+2 |
||
658 | 659 072e B091 0000 lds r27,(Mess_IntegralNick)+3 |
||
659 | 660 0732 8093 0000 sts Mess_IntegralNick2,r24 |
||
660 | 661 0736 9093 0000 sts (Mess_IntegralNick2)+1,r25 |
||
661 | 662 073a A093 0000 sts (Mess_IntegralNick2)+2,r26 |
||
662 | 663 073e B093 0000 sts (Mess_IntegralNick2)+3,r27 |
||
663 | 664 .L24: |
||
664 | 665 0742 2091 0000 lds r18,Mess_IntegralNick |
||
665 | 666 0746 3091 0000 lds r19,(Mess_IntegralNick)+1 |
||
666 | 667 074a 4091 0000 lds r20,(Mess_IntegralNick)+2 |
||
667 | 668 074e 5091 0000 lds r21,(Mess_IntegralNick)+3 |
||
668 | 669 0752 8827 clr r24 |
||
669 | 670 0754 9927 clr r25 |
||
670 | 671 0756 DC01 movw r26,r24 |
||
671 | 672 0758 8E19 sub r24,r14 |
||
672 | 673 075a 9F09 sbc r25,r15 |
||
673 | 674 075c A00B sbc r26,r16 |
||
674 | 675 075e B10B sbc r27,r17 |
||
675 | 676 0760 2817 cp r18,r24 |
||
676 | 677 0762 3907 cpc r19,r25 |
||
677 | 678 0764 4A07 cpc r20,r26 |
||
678 | 679 0766 5B07 cpc r21,r27 |
||
679 | 680 0768 04F4 brge .L26 |
||
680 | 681 076a 80EF ldi r24,lo8(-10000) |
||
681 | 682 076c 98ED ldi r25,hi8(-10000) |
||
682 | 683 076e AFEF ldi r26,hlo8(-10000) |
||
683 | 684 0770 BFEF ldi r27,hhi8(-10000) |
||
684 | 685 0772 E80E add r14,r24 |
||
685 | 686 0774 F91E adc r15,r25 |
||
686 | 687 0776 0A1F adc r16,r26 |
||
687 | 688 0778 1B1F adc r17,r27 |
||
688 | 689 077a E092 0000 sts Mess_IntegralNick,r14 |
||
689 | 690 077e F092 0000 sts (Mess_IntegralNick)+1,r15 |
||
690 | 691 0782 0093 0000 sts (Mess_IntegralNick)+2,r16 |
||
691 | 692 0786 1093 0000 sts (Mess_IntegralNick)+3,r17 |
||
692 | 693 078a 8091 0000 lds r24,Mess_IntegralNick |
||
693 | 694 078e 9091 0000 lds r25,(Mess_IntegralNick)+1 |
||
694 | 695 0792 A091 0000 lds r26,(Mess_IntegralNick)+2 |
||
695 | 696 0796 B091 0000 lds r27,(Mess_IntegralNick)+3 |
||
696 | 697 079a 8093 0000 sts Mess_IntegralNick2,r24 |
||
697 | 698 079e 9093 0000 sts (Mess_IntegralNick2)+1,r25 |
||
698 | 699 07a2 A093 0000 sts (Mess_IntegralNick2)+2,r26 |
||
699 | 700 07a6 B093 0000 sts (Mess_IntegralNick2)+3,r27 |
||
700 | 701 .L26: |
||
701 | 702 07aa 8091 0000 lds r24,AdWertNick |
||
702 | 703 07ae 9091 0000 lds r25,(AdWertNick)+1 |
||
703 | 704 07b2 0F97 sbiw r24,15 |
||
704 | 705 07b4 04F4 brge .L28 |
||
705 | 706 07b6 88E1 ldi r24,lo8(-1000) |
||
706 | 707 07b8 9CEF ldi r25,hi8(-1000) |
||
707 | 708 07ba 9093 0000 sts (MesswertNick)+1,r25 |
||
708 | 709 07be 8093 0000 sts MesswertNick,r24 |
||
709 | 710 .L28: |
||
710 | 711 07c2 8091 0000 lds r24,AdWertNick |
||
711 | 712 07c6 9091 0000 lds r25,(AdWertNick)+1 |
||
712 | 713 07ca 0797 sbiw r24,7 |
||
713 | 714 07cc 04F4 brge .L30 |
||
714 | 715 07ce 80E3 ldi r24,lo8(-2000) |
||
715 | 716 07d0 98EF ldi r25,hi8(-2000) |
||
716 | 717 07d2 9093 0000 sts (MesswertNick)+1,r25 |
||
717 | 718 07d6 8093 0000 sts MesswertNick,r24 |
||
718 | 719 .L30: |
||
719 | 720 07da 9981 ldd r25,Y+1 |
||
720 | 721 07dc 9A30 cpi r25,lo8(10) |
||
721 | 722 07de 01F4 brne .L32 |
||
722 | 723 07e0 8091 0000 lds r24,AdWertNick |
||
723 | 724 07e4 9091 0000 lds r25,(AdWertNick)+1 |
||
724 | 725 07e8 835F subi r24,lo8(1011) |
||
725 | 726 07ea 9340 sbci r25,hi8(1011) |
||
726 | 727 07ec 04F0 brlt .L34 |
||
727 | 728 07ee 88EE ldi r24,lo8(1000) |
||
728 | 729 07f0 93E0 ldi r25,hi8(1000) |
||
729 | 730 07f2 9093 0000 sts (MesswertNick)+1,r25 |
||
730 | 731 07f6 8093 0000 sts MesswertNick,r24 |
||
731 | 732 .L34: |
||
732 | 733 07fa 8091 0000 lds r24,AdWertNick |
||
733 | 734 07fe 9091 0000 lds r25,(AdWertNick)+1 |
||
734 | 735 0802 8A5F subi r24,lo8(1018) |
||
735 | 736 0804 9340 sbci r25,hi8(1018) |
||
736 | 737 0806 04F0 brlt .L36 |
||
737 | 738 0808 00C0 rjmp .L90 |
||
738 | 739 .L32: |
||
739 | 740 080a 8091 0000 lds r24,AdWertNick |
||
740 | 741 080e 9091 0000 lds r25,(AdWertNick)+1 |
||
741 | 742 0812 855E subi r24,lo8(2021) |
||
742 | 743 0814 9740 sbci r25,hi8(2021) |
||
743 | 744 0816 04F0 brlt .L38 |
||
744 | 745 0818 88EE ldi r24,lo8(1000) |
||
745 | 746 081a 93E0 ldi r25,hi8(1000) |
||
746 | 747 081c 9093 0000 sts (MesswertNick)+1,r25 |
||
747 | 748 0820 8093 0000 sts MesswertNick,r24 |
||
748 | 749 .L38: |
||
749 | 750 0824 8091 0000 lds r24,AdWertNick |
||
750 | 751 0828 9091 0000 lds r25,(AdWertNick)+1 |
||
751 | 752 082c 835F subi r24,lo8(2035) |
||
752 | 753 082e 9740 sbci r25,hi8(2035) |
||
753 | 754 0830 04F0 brlt .L36 |
||
754 | 755 .L90: |
||
755 | 756 0832 80ED ldi r24,lo8(2000) |
||
756 | 757 0834 97E0 ldi r25,hi8(2000) |
||
757 | 758 0836 9093 0000 sts (MesswertNick)+1,r25 |
||
758 | 759 083a 8093 0000 sts MesswertNick,r24 |
||
759 | 760 .L36: |
||
760 | 761 083e 8FEE ldi r24,lo8(-17) |
||
761 | 762 0840 8093 7A00 sts 122,r24 |
||
762 | 763 0844 8091 0000 lds r24,Mess_Integral_Gier |
||
763 | 764 0848 9091 0000 lds r25,(Mess_Integral_Gier)+1 |
||
764 | 765 084c A091 0000 lds r26,(Mess_Integral_Gier)+2 |
||
765 | 766 0850 B091 0000 lds r27,(Mess_Integral_Gier)+3 |
||
766 | 767 0854 8093 0000 sts Integral_Gier,r24 |
||
767 | 768 0858 9093 0000 sts (Integral_Gier)+1,r25 |
||
768 | 769 085c A093 0000 sts (Integral_Gier)+2,r26 |
||
769 | 770 0860 B093 0000 sts (Integral_Gier)+3,r27 |
||
770 | 771 0864 8091 0000 lds r24,Mess_IntegralNick |
||
771 | 772 0868 9091 0000 lds r25,(Mess_IntegralNick)+1 |
||
772 | 773 086c A091 0000 lds r26,(Mess_IntegralNick)+2 |
||
773 | 774 0870 B091 0000 lds r27,(Mess_IntegralNick)+3 |
||
774 | 775 0874 8093 0000 sts IntegralNick,r24 |
||
775 | 776 0878 9093 0000 sts (IntegralNick)+1,r25 |
||
776 | 777 087c A093 0000 sts (IntegralNick)+2,r26 |
||
777 | 778 0880 B093 0000 sts (IntegralNick)+3,r27 |
||
778 | 779 0884 8091 0000 lds r24,Mess_IntegralRoll |
||
779 | 780 0888 9091 0000 lds r25,(Mess_IntegralRoll)+1 |
||
780 | 781 088c A091 0000 lds r26,(Mess_IntegralRoll)+2 |
||
781 | 782 0890 B091 0000 lds r27,(Mess_IntegralRoll)+3 |
||
782 | 783 0894 8093 0000 sts IntegralRoll,r24 |
||
783 | 784 0898 9093 0000 sts (IntegralRoll)+1,r25 |
||
784 | 785 089c A093 0000 sts (IntegralRoll)+2,r26 |
||
785 | 786 08a0 B093 0000 sts (IntegralRoll)+3,r27 |
||
786 | 787 08a4 8091 0000 lds r24,Mess_IntegralNick2 |
||
787 | 788 08a8 9091 0000 lds r25,(Mess_IntegralNick2)+1 |
||
788 | 789 08ac A091 0000 lds r26,(Mess_IntegralNick2)+2 |
||
789 | 790 08b0 B091 0000 lds r27,(Mess_IntegralNick2)+3 |
||
790 | 791 08b4 8093 0000 sts IntegralNick2,r24 |
||
791 | 792 08b8 9093 0000 sts (IntegralNick2)+1,r25 |
||
792 | 793 08bc A093 0000 sts (IntegralNick2)+2,r26 |
||
793 | 794 08c0 B093 0000 sts (IntegralNick2)+3,r27 |
||
794 | 795 08c4 8091 0000 lds r24,Mess_IntegralRoll2 |
||
795 | 796 08c8 9091 0000 lds r25,(Mess_IntegralRoll2)+1 |
||
796 | 797 08cc A091 0000 lds r26,(Mess_IntegralRoll2)+2 |
||
797 | 798 08d0 B091 0000 lds r27,(Mess_IntegralRoll2)+3 |
||
798 | 799 08d4 8093 0000 sts IntegralRoll2,r24 |
||
799 | 800 08d8 9093 0000 sts (IntegralRoll2)+1,r25 |
||
800 | 801 08dc A093 0000 sts (IntegralRoll2)+2,r26 |
||
801 | 802 08e0 B093 0000 sts (IntegralRoll2)+3,r27 |
||
802 | 803 08e4 8091 0000 lds r24,EE_Parameter+8 |
||
803 | 804 08e8 87FF sbrs r24,7 |
||
804 | 805 08ea 00C0 rjmp .L41 |
||
805 | 806 08ec 2A81 ldd r18,Y+2 |
||
806 | 807 08ee 2223 tst r18 |
||
807 | 808 08f0 01F0 breq .+2 |
||
808 | 809 08f2 00C0 rjmp .L41 |
||
809 | 810 08f4 8091 0000 lds r24,Looping_Roll |
||
810 | 811 08f8 8823 tst r24 |
||
811 | 812 08fa 01F0 breq .+2 |
||
812 | 813 08fc 00C0 rjmp .L41 |
||
813 | 814 08fe 8091 0000 lds r24,MesswertNick |
||
814 | 815 0902 9091 0000 lds r25,(MesswertNick)+1 |
||
815 | 816 0906 893C cpi r24,201 |
||
816 | 817 0908 9105 cpc r25,__zero_reg__ |
||
817 | 818 090a 04F0 brlt .L45 |
||
818 | 819 090c 2091 0000 lds r18,MesswertNick |
||
819 | 820 0910 3091 0000 lds r19,(MesswertNick)+1 |
||
820 | 821 0914 8091 0000 lds r24,MesswertNick |
||
821 | 822 0918 9091 0000 lds r25,(MesswertNick)+1 |
||
822 | 823 091c 880F lsl r24 |
||
823 | 824 091e 991F rol r25 |
||
824 | 825 0920 880F lsl r24 |
||
825 | 826 0922 991F rol r25 |
||
826 | 827 0924 2052 subi r18,lo8(-(-800)) |
||
827 | 828 0926 3340 sbci r19,hi8(-(-800)) |
||
828 | 829 0928 00C0 rjmp .L91 |
||
829 | 830 .L45: |
||
830 | 831 092a 8091 0000 lds r24,MesswertNick |
||
831 | 832 092e 9091 0000 lds r25,(MesswertNick)+1 |
||
832 | 833 0932 8853 subi r24,lo8(-200) |
||
833 | 834 0934 9F4F sbci r25,hi8(-200) |
||
834 | 835 0936 04F4 brge .L47 |
||
835 | 836 0938 2091 0000 lds r18,MesswertNick |
||
836 | 837 093c 3091 0000 lds r19,(MesswertNick)+1 |
||
837 | 838 0940 8091 0000 lds r24,MesswertNick |
||
838 | 839 0944 9091 0000 lds r25,(MesswertNick)+1 |
||
839 | 840 0948 880F lsl r24 |
||
840 | 841 094a 991F rol r25 |
||
841 | 842 094c 880F lsl r24 |
||
842 | 843 094e 991F rol r25 |
||
843 | 844 0950 205E subi r18,lo8(-(800)) |
||
844 | 845 0952 3C4F sbci r19,hi8(-(800)) |
||
845 | 846 .L91: |
||
846 | 847 0954 820F add r24,r18 |
||
847 | 848 0956 931F adc r25,r19 |
||
848 | 849 0958 9093 0000 sts (MesswertNick)+1,r25 |
||
849 | 850 095c 8093 0000 sts MesswertNick,r24 |
||
850 | 851 .L47: |
||
851 | 852 0960 8091 0000 lds r24,MesswertRoll |
||
852 | 853 0964 9091 0000 lds r25,(MesswertRoll)+1 |
||
853 | 854 0968 893C cpi r24,201 |
||
854 | 855 096a 9105 cpc r25,__zero_reg__ |
||
855 | 856 096c 04F0 brlt .L49 |
||
856 | 857 096e 2091 0000 lds r18,MesswertRoll |
||
857 | 858 0972 3091 0000 lds r19,(MesswertRoll)+1 |
||
858 | 859 0976 8091 0000 lds r24,MesswertRoll |
||
859 | 860 097a 9091 0000 lds r25,(MesswertRoll)+1 |
||
860 | 861 097e 880F lsl r24 |
||
861 | 862 0980 991F rol r25 |
||
862 | 863 0982 880F lsl r24 |
||
863 | 864 0984 991F rol r25 |
||
864 | 865 0986 2052 subi r18,lo8(-(-800)) |
||
865 | 866 0988 3340 sbci r19,hi8(-(-800)) |
||
866 | 867 098a 00C0 rjmp .L92 |
||
867 | 868 .L49: |
||
868 | 869 098c 8091 0000 lds r24,MesswertRoll |
||
869 | 870 0990 9091 0000 lds r25,(MesswertRoll)+1 |
||
870 | 871 0994 8853 subi r24,lo8(-200) |
||
871 | 872 0996 9F4F sbci r25,hi8(-200) |
||
872 | 873 0998 04F4 brge .L41 |
||
873 | 874 099a 2091 0000 lds r18,MesswertRoll |
||
874 | 875 099e 3091 0000 lds r19,(MesswertRoll)+1 |
||
875 | 876 09a2 8091 0000 lds r24,MesswertRoll |
||
876 | 877 09a6 9091 0000 lds r25,(MesswertRoll)+1 |
||
877 | 878 09aa 880F lsl r24 |
||
878 | 879 09ac 991F rol r25 |
||
879 | 880 09ae 880F lsl r24 |
||
880 | 881 09b0 991F rol r25 |
||
881 | 882 09b2 205E subi r18,lo8(-(800)) |
||
882 | 883 09b4 3C4F sbci r19,hi8(-(800)) |
||
883 | 884 .L92: |
||
884 | 885 09b6 820F add r24,r18 |
||
885 | 886 09b8 931F adc r25,r19 |
||
886 | 887 09ba 9093 0000 sts (MesswertRoll)+1,r25 |
||
887 | 888 09be 8093 0000 sts MesswertRoll,r24 |
||
888 | 889 .L41: |
||
889 | 890 09c2 2091 0000 lds r18,Poti1 |
||
890 | 891 09c6 3091 0000 lds r19,(Poti1)+1 |
||
891 | 892 09ca 8091 0000 lds r24,EE_Parameter+4 |
||
892 | 893 09ce E82F mov r30,r24 |
||
893 | 894 09d0 FF27 clr r31 |
||
894 | 895 09d2 EE0F lsl r30 |
||
895 | 896 09d4 FF1F rol r31 |
||
896 | 897 09d6 E050 subi r30,lo8(-(PPM_in)) |
||
897 | 898 09d8 F040 sbci r31,hi8(-(PPM_in)) |
||
898 | 899 09da 8081 ld r24,Z |
||
899 | 900 09dc 9181 ldd r25,Z+1 |
||
900 | 901 09de 8259 subi r24,lo8(-(110)) |
||
901 | 902 09e0 9F4F sbci r25,hi8(-(110)) |
||
902 | 903 09e2 2817 cp r18,r24 |
||
903 | 904 09e4 3907 cpc r19,r25 |
||
904 | 905 09e6 04F4 brge .L52 |
||
905 | 906 09e8 2F5F subi r18,lo8(-(1)) |
||
906 | 907 09ea 3F4F sbci r19,hi8(-(1)) |
||
907 | 908 09ec 00C0 rjmp .L93 |
||
908 | 909 .L52: |
||
909 | 910 09ee 8081 ld r24,Z |
||
910 | 911 09f0 9181 ldd r25,Z+1 |
||
911 | 912 09f2 8259 subi r24,lo8(-(110)) |
||
912 | 913 09f4 9F4F sbci r25,hi8(-(110)) |
||
913 | 914 09f6 8217 cp r24,r18 |
||
914 | 915 09f8 9307 cpc r25,r19 |
||
915 | 916 09fa 04F4 brge .L54 |
||
916 | 917 09fc 2115 cp r18,__zero_reg__ |
||
917 | 918 09fe 3105 cpc r19,__zero_reg__ |
||
918 | 919 0a00 01F0 breq .L54 |
||
919 | 920 0a02 2150 subi r18,lo8(-(-1)) |
||
920 | 921 0a04 3040 sbci r19,hi8(-(-1)) |
||
921 | 922 .L93: |
||
922 | 923 0a06 3093 0000 sts (Poti1)+1,r19 |
||
923 | 924 0a0a 2093 0000 sts Poti1,r18 |
||
924 | 925 .L54: |
||
925 | 926 0a0e 2091 0000 lds r18,Poti2 |
||
926 | 927 0a12 3091 0000 lds r19,(Poti2)+1 |
||
927 | 928 0a16 8091 0000 lds r24,EE_Parameter+5 |
||
928 | 929 0a1a E82F mov r30,r24 |
||
929 | 930 0a1c FF27 clr r31 |
||
930 | 931 0a1e EE0F lsl r30 |
||
931 | 932 0a20 FF1F rol r31 |
||
932 | 933 0a22 E050 subi r30,lo8(-(PPM_in)) |
||
933 | 934 0a24 F040 sbci r31,hi8(-(PPM_in)) |
||
934 | 935 0a26 8081 ld r24,Z |
||
935 | 936 0a28 9181 ldd r25,Z+1 |
||
936 | 937 0a2a 8259 subi r24,lo8(-(110)) |
||
937 | 938 0a2c 9F4F sbci r25,hi8(-(110)) |
||
938 | 939 0a2e 2817 cp r18,r24 |
||
939 | 940 0a30 3907 cpc r19,r25 |
||
940 | 941 0a32 04F4 brge .L57 |
||
941 | 942 0a34 2F5F subi r18,lo8(-(1)) |
||
942 | 943 0a36 3F4F sbci r19,hi8(-(1)) |
||
943 | 944 0a38 00C0 rjmp .L94 |
||
944 | 945 .L57: |
||
945 | 946 0a3a 8081 ld r24,Z |
||
946 | 947 0a3c 9181 ldd r25,Z+1 |
||
947 | 948 0a3e 8259 subi r24,lo8(-(110)) |
||
948 | 949 0a40 9F4F sbci r25,hi8(-(110)) |
||
949 | 950 0a42 8217 cp r24,r18 |
||
950 | 951 0a44 9307 cpc r25,r19 |
||
951 | 952 0a46 04F4 brge .L59 |
||
952 | 953 0a48 2115 cp r18,__zero_reg__ |
||
953 | 954 0a4a 3105 cpc r19,__zero_reg__ |
||
954 | 955 0a4c 01F0 breq .L59 |
||
955 | 956 0a4e 2150 subi r18,lo8(-(-1)) |
||
956 | 957 0a50 3040 sbci r19,hi8(-(-1)) |
||
957 | 958 .L94: |
||
958 | 959 0a52 3093 0000 sts (Poti2)+1,r19 |
||
959 | 960 0a56 2093 0000 sts Poti2,r18 |
||
960 | 961 .L59: |
||
961 | 962 0a5a 2091 0000 lds r18,Poti3 |
||
962 | 963 0a5e 3091 0000 lds r19,(Poti3)+1 |
||
963 | 964 0a62 8091 0000 lds r24,EE_Parameter+6 |
||
964 | 965 0a66 E82F mov r30,r24 |
||
965 | 966 0a68 FF27 clr r31 |
||
966 | 967 0a6a EE0F lsl r30 |
||
967 | 968 0a6c FF1F rol r31 |
||
968 | 969 0a6e E050 subi r30,lo8(-(PPM_in)) |
||
969 | 970 0a70 F040 sbci r31,hi8(-(PPM_in)) |
||
970 | 971 0a72 8081 ld r24,Z |
||
971 | 972 0a74 9181 ldd r25,Z+1 |
||
972 | 973 0a76 8259 subi r24,lo8(-(110)) |
||
973 | 974 0a78 9F4F sbci r25,hi8(-(110)) |
||
974 | 975 0a7a 2817 cp r18,r24 |
||
975 | 976 0a7c 3907 cpc r19,r25 |
||
976 | 977 0a7e 04F4 brge .L62 |
||
977 | 978 0a80 2F5F subi r18,lo8(-(1)) |
||
978 | 979 0a82 3F4F sbci r19,hi8(-(1)) |
||
979 | 980 0a84 00C0 rjmp .L95 |
||
980 | 981 .L62: |
||
981 | 982 0a86 8081 ld r24,Z |
||
982 | 983 0a88 9181 ldd r25,Z+1 |
||
983 | 984 0a8a 8259 subi r24,lo8(-(110)) |
||
984 | 985 0a8c 9F4F sbci r25,hi8(-(110)) |
||
985 | 986 0a8e 8217 cp r24,r18 |
||
986 | 987 0a90 9307 cpc r25,r19 |
||
987 | 988 0a92 04F4 brge .L64 |
||
988 | 989 0a94 2115 cp r18,__zero_reg__ |
||
989 | 990 0a96 3105 cpc r19,__zero_reg__ |
||
990 | 991 0a98 01F0 breq .L64 |
||
991 | 992 0a9a 2150 subi r18,lo8(-(-1)) |
||
992 | 993 0a9c 3040 sbci r19,hi8(-(-1)) |
||
993 | 994 .L95: |
||
994 | 995 0a9e 3093 0000 sts (Poti3)+1,r19 |
||
995 | 996 0aa2 2093 0000 sts Poti3,r18 |
||
996 | 997 .L64: |
||
997 | 998 0aa6 2091 0000 lds r18,Poti4 |
||
998 | 999 0aaa 3091 0000 lds r19,(Poti4)+1 |
||
999 | 1000 0aae 8091 0000 lds r24,EE_Parameter+7 |
||
1000 | 1001 0ab2 E82F mov r30,r24 |
||
1001 | 1002 0ab4 FF27 clr r31 |
||
1002 | 1003 0ab6 EE0F lsl r30 |
||
1003 | 1004 0ab8 FF1F rol r31 |
||
1004 | 1005 0aba E050 subi r30,lo8(-(PPM_in)) |
||
1005 | 1006 0abc F040 sbci r31,hi8(-(PPM_in)) |
||
1006 | 1007 0abe 8081 ld r24,Z |
||
1007 | 1008 0ac0 9181 ldd r25,Z+1 |
||
1008 | 1009 0ac2 8259 subi r24,lo8(-(110)) |
||
1009 | 1010 0ac4 9F4F sbci r25,hi8(-(110)) |
||
1010 | 1011 0ac6 2817 cp r18,r24 |
||
1011 | 1012 0ac8 3907 cpc r19,r25 |
||
1012 | 1013 0aca 04F4 brge .L67 |
||
1013 | 1014 0acc 2F5F subi r18,lo8(-(1)) |
||
1014 | 1015 0ace 3F4F sbci r19,hi8(-(1)) |
||
1015 | 1016 0ad0 00C0 rjmp .L96 |
||
1016 | 1017 .L67: |
||
1017 | 1018 0ad2 8081 ld r24,Z |
||
1018 | 1019 0ad4 9181 ldd r25,Z+1 |
||
1019 | 1020 0ad6 8259 subi r24,lo8(-(110)) |
||
1020 | 1021 0ad8 9F4F sbci r25,hi8(-(110)) |
||
1021 | 1022 0ada 8217 cp r24,r18 |
||
1022 | 1023 0adc 9307 cpc r25,r19 |
||
1023 | 1024 0ade 04F4 brge .L69 |
||
1024 | 1025 0ae0 2115 cp r18,__zero_reg__ |
||
1025 | 1026 0ae2 3105 cpc r19,__zero_reg__ |
||
1026 | 1027 0ae4 01F0 breq .L69 |
||
1027 | 1028 0ae6 2150 subi r18,lo8(-(-1)) |
||
1028 | 1029 0ae8 3040 sbci r19,hi8(-(-1)) |
||
1029 | 1030 .L96: |
||
1030 | 1031 0aea 3093 0000 sts (Poti4)+1,r19 |
||
1031 | 1032 0aee 2093 0000 sts Poti4,r18 |
||
1032 | 1033 .L69: |
||
1033 | 1034 0af2 8091 0000 lds r24,Poti1 |
||
1034 | 1035 0af6 9091 0000 lds r25,(Poti1)+1 |
||
1035 | 1036 0afa 97FF sbrs r25,7 |
||
1036 | 1037 0afc 00C0 rjmp .L72 |
||
1037 | 1038 0afe 1092 0000 sts (Poti1)+1,__zero_reg__ |
||
1038 | 1039 0b02 1092 0000 sts Poti1,__zero_reg__ |
||
1039 | 1040 0b06 00C0 rjmp .L74 |
||
1040 | 1041 .L72: |
||
1041 | 1042 0b08 8F3F cpi r24,255 |
||
1042 | 1043 0b0a 9105 cpc r25,__zero_reg__ |
||
1043 | 1044 0b0c 01F0 breq .L74 |
||
1044 | 1045 0b0e 04F0 brlt .L74 |
||
1045 | 1046 0b10 8FEF ldi r24,lo8(255) |
||
1046 | 1047 0b12 90E0 ldi r25,hi8(255) |
||
1047 | 1048 0b14 9093 0000 sts (Poti1)+1,r25 |
||
1048 | 1049 0b18 8093 0000 sts Poti1,r24 |
||
1049 | 1050 .L74: |
||
1050 | 1051 0b1c 8091 0000 lds r24,Poti2 |
||
1051 | 1052 0b20 9091 0000 lds r25,(Poti2)+1 |
||
1052 | 1053 0b24 97FF sbrs r25,7 |
||
1053 | 1054 0b26 00C0 rjmp .L76 |
||
1054 | 1055 0b28 1092 0000 sts (Poti2)+1,__zero_reg__ |
||
1055 | 1056 0b2c 1092 0000 sts Poti2,__zero_reg__ |
||
1056 | 1057 0b30 00C0 rjmp .L78 |
||
1057 | 1058 .L76: |
||
1058 | 1059 0b32 8F3F cpi r24,255 |
||
1059 | 1060 0b34 9105 cpc r25,__zero_reg__ |
||
1060 | 1061 0b36 01F0 breq .L78 |
||
1061 | 1062 0b38 04F0 brlt .L78 |
||
1062 | 1063 0b3a 8FEF ldi r24,lo8(255) |
||
1063 | 1064 0b3c 90E0 ldi r25,hi8(255) |
||
1064 | 1065 0b3e 9093 0000 sts (Poti2)+1,r25 |
||
1065 | 1066 0b42 8093 0000 sts Poti2,r24 |
||
1066 | 1067 .L78: |
||
1067 | 1068 0b46 8091 0000 lds r24,Poti3 |
||
1068 | 1069 0b4a 9091 0000 lds r25,(Poti3)+1 |
||
1069 | 1070 0b4e 97FF sbrs r25,7 |
||
1070 | 1071 0b50 00C0 rjmp .L80 |
||
1071 | 1072 0b52 1092 0000 sts (Poti3)+1,__zero_reg__ |
||
1072 | 1073 0b56 1092 0000 sts Poti3,__zero_reg__ |
||
1073 | 1074 0b5a 00C0 rjmp .L82 |
||
1074 | 1075 .L80: |
||
1075 | 1076 0b5c 8F3F cpi r24,255 |
||
1076 | 1077 0b5e 9105 cpc r25,__zero_reg__ |
||
1077 | 1078 0b60 01F0 breq .L82 |
||
1078 | 1079 0b62 04F0 brlt .L82 |
||
1079 | 1080 0b64 8FEF ldi r24,lo8(255) |
||
1080 | 1081 0b66 90E0 ldi r25,hi8(255) |
||
1081 | 1082 0b68 9093 0000 sts (Poti3)+1,r25 |
||
1082 | 1083 0b6c 8093 0000 sts Poti3,r24 |
||
1083 | 1084 .L82: |
||
1084 | 1085 0b70 8091 0000 lds r24,Poti4 |
||
1085 | 1086 0b74 9091 0000 lds r25,(Poti4)+1 |
||
1086 | 1087 0b78 97FF sbrs r25,7 |
||
1087 | 1088 0b7a 00C0 rjmp .L84 |
||
1088 | 1089 0b7c 1092 0000 sts (Poti4)+1,__zero_reg__ |
||
1089 | 1090 0b80 1092 0000 sts Poti4,__zero_reg__ |
||
1090 | 1091 0b84 00C0 rjmp .L88 |
||
1091 | 1092 .L84: |
||
1092 | 1093 0b86 8F3F cpi r24,255 |
||
1093 | 1094 0b88 9105 cpc r25,__zero_reg__ |
||
1094 | 1095 0b8a 01F0 breq .L88 |
||
1095 | 1096 0b8c 04F0 brlt .L88 |
||
1096 | 1097 0b8e 8FEF ldi r24,lo8(255) |
||
1097 | 1098 0b90 90E0 ldi r25,hi8(255) |
||
1098 | 1099 0b92 9093 0000 sts (Poti4)+1,r25 |
||
1099 | 1100 0b96 8093 0000 sts Poti4,r24 |
||
1100 | 1101 .L88: |
||
1101 | 1102 /* epilogue: frame size=2 */ |
||
1102 | 1103 0b9a 2296 adiw r28,2 |
||
1103 | 1104 0b9c 0FB6 in __tmp_reg__,__SREG__ |
||
1104 | 1105 0b9e F894 cli |
||
1105 | 1106 0ba0 DEBF out __SP_H__,r29 |
||
1106 | 1107 0ba2 0FBE out __SREG__,__tmp_reg__ |
||
1107 | 1108 0ba4 CDBF out __SP_L__,r28 |
||
1108 | 1109 0ba6 DF91 pop r29 |
||
1109 | 1110 0ba8 CF91 pop r28 |
||
1110 | 1111 0baa 1F91 pop r17 |
||
1111 | 1112 0bac 0F91 pop r16 |
||
1112 | 1113 0bae FF90 pop r15 |
||
1113 | 1114 0bb0 EF90 pop r14 |
||
1114 | 1115 0bb2 DF90 pop r13 |
||
1115 | 1116 0bb4 CF90 pop r12 |
||
1116 | 1117 0bb6 BF90 pop r11 |
||
1117 | 1118 0bb8 AF90 pop r10 |
||
1118 | 1119 0bba 9F90 pop r9 |
||
1119 | 1120 0bbc 8F90 pop r8 |
||
1120 | 1121 0bbe 7F90 pop r7 |
||
1121 | 1122 0bc0 6F90 pop r6 |
||
1122 | 1123 0bc2 5F90 pop r5 |
||
1123 | 1124 0bc4 4F90 pop r4 |
||
1124 | 1125 0bc6 3F90 pop r3 |
||
1125 | 1126 0bc8 2F90 pop r2 |
||
1126 | 1127 0bca 0895 ret |
||
1127 | 1128 /* epilogue end (size=25) */ |
||
1128 | 1129 /* function Mittelwert size 1524 (1473) */ |
||
1129 | 1131 .global CalibrierMittelwert |
||
1130 | 1133 CalibrierMittelwert: |
||
1131 | 1134 /* prologue: frame size=0 */ |
||
1132 | 1135 /* prologue end (size=0) */ |
||
1133 | 1136 0bcc 1092 7A00 sts 122,__zero_reg__ |
||
1134 | 1137 0bd0 8091 0000 lds r24,AdWertNick |
||
1135 | 1138 0bd4 9091 0000 lds r25,(AdWertNick)+1 |
||
1136 | 1139 0bd8 9093 0000 sts (MesswertNick)+1,r25 |
||
1137 | 1140 0bdc 8093 0000 sts MesswertNick,r24 |
||
1138 | 1141 0be0 8091 0000 lds r24,AdWertRoll |
||
1139 | 1142 0be4 9091 0000 lds r25,(AdWertRoll)+1 |
||
1140 | 1143 0be8 9093 0000 sts (MesswertRoll)+1,r25 |
||
1141 | 1144 0bec 8093 0000 sts MesswertRoll,r24 |
||
1142 | 1145 0bf0 8091 0000 lds r24,AdWertGier |
||
1143 | 1146 0bf4 9091 0000 lds r25,(AdWertGier)+1 |
||
1144 | 1147 0bf8 9093 0000 sts (MesswertGier)+1,r25 |
||
1145 | 1148 0bfc 8093 0000 sts MesswertGier,r24 |
||
1146 | 1149 0c00 6091 0000 lds r22,AdWertAccNick |
||
1147 | 1150 0c04 7091 0000 lds r23,(AdWertAccNick)+1 |
||
1148 | 1151 0c08 8827 clr r24 |
||
1149 | 1152 0c0a 77FD sbrc r23,7 |
||
1150 | 1153 0c0c 8095 com r24 |
||
1151 | 1154 0c0e 982F mov r25,r24 |
||
1152 | 1155 0c10 2CE0 ldi r18,lo8(12) |
||
1153 | 1156 0c12 30E0 ldi r19,hi8(12) |
||
1154 | 1157 0c14 40E0 ldi r20,hlo8(12) |
||
1155 | 1158 0c16 50E0 ldi r21,hhi8(12) |
||
1156 | 1159 0c18 0E94 0000 call __mulsi3 |
||
1157 | 1160 0c1c 7093 0000 sts (Mittelwert_AccNick)+1,r23 |
||
1158 | 1161 0c20 6093 0000 sts Mittelwert_AccNick,r22 |
||
1159 | 1162 0c24 6091 0000 lds r22,AdWertAccRoll |
||
1160 | 1163 0c28 7091 0000 lds r23,(AdWertAccRoll)+1 |
||
1161 | 1164 0c2c 8827 clr r24 |
||
1162 | 1165 0c2e 77FD sbrc r23,7 |
||
1163 | 1166 0c30 8095 com r24 |
||
1164 | 1167 0c32 982F mov r25,r24 |
||
1165 | 1168 0c34 0E94 0000 call __mulsi3 |
||
1166 | 1169 0c38 7093 0000 sts (Mittelwert_AccRoll)+1,r23 |
||
1167 | 1170 0c3c 6093 0000 sts Mittelwert_AccRoll,r22 |
||
1168 | 1171 0c40 8091 0000 lds r24,AdWertAccHoch |
||
1169 | 1172 0c44 9091 0000 lds r25,(AdWertAccHoch)+1 |
||
1170 | 1173 0c48 9093 0000 sts (Mittelwert_AccHoch)+1,r25 |
||
1171 | 1174 0c4c 8093 0000 sts Mittelwert_AccHoch,r24 |
||
1172 | 1175 0c50 8FEE ldi r24,lo8(-17) |
||
1173 | 1176 0c52 8093 7A00 sts 122,r24 |
||
1174 | 1177 0c56 2091 0000 lds r18,Poti1 |
||
1175 | 1178 0c5a 3091 0000 lds r19,(Poti1)+1 |
||
1176 | 1179 0c5e 8091 0000 lds r24,EE_Parameter+4 |
||
1177 | 1180 0c62 E82F mov r30,r24 |
||
1178 | 1181 0c64 FF27 clr r31 |
||
1179 | 1182 0c66 EE0F lsl r30 |
||
1180 | 1183 0c68 FF1F rol r31 |
||
1181 | 1184 0c6a E050 subi r30,lo8(-(PPM_in)) |
||
1182 | 1185 0c6c F040 sbci r31,hi8(-(PPM_in)) |
||
1183 | 1186 0c6e 8081 ld r24,Z |
||
1184 | 1187 0c70 9181 ldd r25,Z+1 |
||
1185 | 1188 0c72 8259 subi r24,lo8(-(110)) |
||
1186 | 1189 0c74 9F4F sbci r25,hi8(-(110)) |
||
1187 | 1190 0c76 2817 cp r18,r24 |
||
1188 | 1191 0c78 3907 cpc r19,r25 |
||
1189 | 1192 0c7a 04F4 brge .L98 |
||
1190 | 1193 0c7c 2F5F subi r18,lo8(-(1)) |
||
1191 | 1194 0c7e 3F4F sbci r19,hi8(-(1)) |
||
1192 | 1195 0c80 00C0 rjmp .L135 |
||
1193 | 1196 .L98: |
||
1194 | 1197 0c82 8081 ld r24,Z |
||
1195 | 1198 0c84 9181 ldd r25,Z+1 |
||
1196 | 1199 0c86 8259 subi r24,lo8(-(110)) |
||
1197 | 1200 0c88 9F4F sbci r25,hi8(-(110)) |
||
1198 | 1201 0c8a 8217 cp r24,r18 |
||
1199 | 1202 0c8c 9307 cpc r25,r19 |
||
1200 | 1203 0c8e 04F4 brge .L100 |
||
1201 | 1204 0c90 2115 cp r18,__zero_reg__ |
||
1202 | 1205 0c92 3105 cpc r19,__zero_reg__ |
||
1203 | 1206 0c94 01F0 breq .L100 |
||
1204 | 1207 0c96 2150 subi r18,lo8(-(-1)) |
||
1205 | 1208 0c98 3040 sbci r19,hi8(-(-1)) |
||
1206 | 1209 .L135: |
||
1207 | 1210 0c9a 3093 0000 sts (Poti1)+1,r19 |
||
1208 | 1211 0c9e 2093 0000 sts Poti1,r18 |
||
1209 | 1212 .L100: |
||
1210 | 1213 0ca2 2091 0000 lds r18,Poti2 |
||
1211 | 1214 0ca6 3091 0000 lds r19,(Poti2)+1 |
||
1212 | 1215 0caa 8091 0000 lds r24,EE_Parameter+5 |
||
1213 | 1216 0cae E82F mov r30,r24 |
||
1214 | 1217 0cb0 FF27 clr r31 |
||
1215 | 1218 0cb2 EE0F lsl r30 |
||
1216 | 1219 0cb4 FF1F rol r31 |
||
1217 | 1220 0cb6 E050 subi r30,lo8(-(PPM_in)) |
||
1218 | 1221 0cb8 F040 sbci r31,hi8(-(PPM_in)) |
||
1219 | 1222 0cba 8081 ld r24,Z |
||
1220 | 1223 0cbc 9181 ldd r25,Z+1 |
||
1221 | 1224 0cbe 8259 subi r24,lo8(-(110)) |
||
1222 | 1225 0cc0 9F4F sbci r25,hi8(-(110)) |
||
1223 | 1226 0cc2 2817 cp r18,r24 |
||
1224 | 1227 0cc4 3907 cpc r19,r25 |
||
1225 | 1228 0cc6 04F4 brge .L103 |
||
1226 | 1229 0cc8 2F5F subi r18,lo8(-(1)) |
||
1227 | 1230 0cca 3F4F sbci r19,hi8(-(1)) |
||
1228 | 1231 0ccc 00C0 rjmp .L136 |
||
1229 | 1232 .L103: |
||
1230 | 1233 0cce 8081 ld r24,Z |
||
1231 | 1234 0cd0 9181 ldd r25,Z+1 |
||
1232 | 1235 0cd2 8259 subi r24,lo8(-(110)) |
||
1233 | 1236 0cd4 9F4F sbci r25,hi8(-(110)) |
||
1234 | 1237 0cd6 8217 cp r24,r18 |
||
1235 | 1238 0cd8 9307 cpc r25,r19 |
||
1236 | 1239 0cda 04F4 brge .L105 |
||
1237 | 1240 0cdc 2115 cp r18,__zero_reg__ |
||
1238 | 1241 0cde 3105 cpc r19,__zero_reg__ |
||
1239 | 1242 0ce0 01F0 breq .L105 |
||
1240 | 1243 0ce2 2150 subi r18,lo8(-(-1)) |
||
1241 | 1244 0ce4 3040 sbci r19,hi8(-(-1)) |
||
1242 | 1245 .L136: |
||
1243 | 1246 0ce6 3093 0000 sts (Poti2)+1,r19 |
||
1244 | 1247 0cea 2093 0000 sts Poti2,r18 |
||
1245 | 1248 .L105: |
||
1246 | 1249 0cee 2091 0000 lds r18,Poti3 |
||
1247 | 1250 0cf2 3091 0000 lds r19,(Poti3)+1 |
||
1248 | 1251 0cf6 8091 0000 lds r24,EE_Parameter+6 |
||
1249 | 1252 0cfa E82F mov r30,r24 |
||
1250 | 1253 0cfc FF27 clr r31 |
||
1251 | 1254 0cfe EE0F lsl r30 |
||
1252 | 1255 0d00 FF1F rol r31 |
||
1253 | 1256 0d02 E050 subi r30,lo8(-(PPM_in)) |
||
1254 | 1257 0d04 F040 sbci r31,hi8(-(PPM_in)) |
||
1255 | 1258 0d06 8081 ld r24,Z |
||
1256 | 1259 0d08 9181 ldd r25,Z+1 |
||
1257 | 1260 0d0a 8259 subi r24,lo8(-(110)) |
||
1258 | 1261 0d0c 9F4F sbci r25,hi8(-(110)) |
||
1259 | 1262 0d0e 2817 cp r18,r24 |
||
1260 | 1263 0d10 3907 cpc r19,r25 |
||
1261 | 1264 0d12 04F4 brge .L108 |
||
1262 | 1265 0d14 2F5F subi r18,lo8(-(1)) |
||
1263 | 1266 0d16 3F4F sbci r19,hi8(-(1)) |
||
1264 | 1267 0d18 00C0 rjmp .L137 |
||
1265 | 1268 .L108: |
||
1266 | 1269 0d1a 8081 ld r24,Z |
||
1267 | 1270 0d1c 9181 ldd r25,Z+1 |
||
1268 | 1271 0d1e 8259 subi r24,lo8(-(110)) |
||
1269 | 1272 0d20 9F4F sbci r25,hi8(-(110)) |
||
1270 | 1273 0d22 8217 cp r24,r18 |
||
1271 | 1274 0d24 9307 cpc r25,r19 |
||
1272 | 1275 0d26 04F4 brge .L110 |
||
1273 | 1276 0d28 2115 cp r18,__zero_reg__ |
||
1274 | 1277 0d2a 3105 cpc r19,__zero_reg__ |
||
1275 | 1278 0d2c 01F0 breq .L110 |
||
1276 | 1279 0d2e 2150 subi r18,lo8(-(-1)) |
||
1277 | 1280 0d30 3040 sbci r19,hi8(-(-1)) |
||
1278 | 1281 .L137: |
||
1279 | 1282 0d32 3093 0000 sts (Poti3)+1,r19 |
||
1280 | 1283 0d36 2093 0000 sts Poti3,r18 |
||
1281 | 1284 .L110: |
||
1282 | 1285 0d3a 2091 0000 lds r18,Poti4 |
||
1283 | 1286 0d3e 3091 0000 lds r19,(Poti4)+1 |
||
1284 | 1287 0d42 8091 0000 lds r24,EE_Parameter+7 |
||
1285 | 1288 0d46 E82F mov r30,r24 |
||
1286 | 1289 0d48 FF27 clr r31 |
||
1287 | 1290 0d4a EE0F lsl r30 |
||
1288 | 1291 0d4c FF1F rol r31 |
||
1289 | 1292 0d4e E050 subi r30,lo8(-(PPM_in)) |
||
1290 | 1293 0d50 F040 sbci r31,hi8(-(PPM_in)) |
||
1291 | 1294 0d52 8081 ld r24,Z |
||
1292 | 1295 0d54 9181 ldd r25,Z+1 |
||
1293 | 1296 0d56 8259 subi r24,lo8(-(110)) |
||
1294 | 1297 0d58 9F4F sbci r25,hi8(-(110)) |
||
1295 | 1298 0d5a 2817 cp r18,r24 |
||
1296 | 1299 0d5c 3907 cpc r19,r25 |
||
1297 | 1300 0d5e 04F4 brge .L113 |
||
1298 | 1301 0d60 2F5F subi r18,lo8(-(1)) |
||
1299 | 1302 0d62 3F4F sbci r19,hi8(-(1)) |
||
1300 | 1303 0d64 00C0 rjmp .L138 |
||
1301 | 1304 .L113: |
||
1302 | 1305 0d66 8081 ld r24,Z |
||
1303 | 1306 0d68 9181 ldd r25,Z+1 |
||
1304 | 1307 0d6a 8259 subi r24,lo8(-(110)) |
||
1305 | 1308 0d6c 9F4F sbci r25,hi8(-(110)) |
||
1306 | 1309 0d6e 8217 cp r24,r18 |
||
1307 | 1310 0d70 9307 cpc r25,r19 |
||
1308 | 1311 0d72 04F4 brge .L115 |
||
1309 | 1312 0d74 2115 cp r18,__zero_reg__ |
||
1310 | 1313 0d76 3105 cpc r19,__zero_reg__ |
||
1311 | 1314 0d78 01F0 breq .L115 |
||
1312 | 1315 0d7a 2150 subi r18,lo8(-(-1)) |
||
1313 | 1316 0d7c 3040 sbci r19,hi8(-(-1)) |
||
1314 | 1317 .L138: |
||
1315 | 1318 0d7e 3093 0000 sts (Poti4)+1,r19 |
||
1316 | 1319 0d82 2093 0000 sts Poti4,r18 |
||
1317 | 1320 .L115: |
||
1318 | 1321 0d86 8091 0000 lds r24,Poti1 |
||
1319 | 1322 0d8a 9091 0000 lds r25,(Poti1)+1 |
||
1320 | 1323 0d8e 97FF sbrs r25,7 |
||
1321 | 1324 0d90 00C0 rjmp .L118 |
||
1322 | 1325 0d92 1092 0000 sts (Poti1)+1,__zero_reg__ |
||
1323 | 1326 0d96 1092 0000 sts Poti1,__zero_reg__ |
||
1324 | 1327 0d9a 00C0 rjmp .L120 |
||
1325 | 1328 .L118: |
||
1326 | 1329 0d9c 8F3F cpi r24,255 |
||
1327 | 1330 0d9e 9105 cpc r25,__zero_reg__ |
||
1328 | 1331 0da0 01F0 breq .L120 |
||
1329 | 1332 0da2 04F0 brlt .L120 |
||
1330 | 1333 0da4 8FEF ldi r24,lo8(255) |
||
1331 | 1334 0da6 90E0 ldi r25,hi8(255) |
||
1332 | 1335 0da8 9093 0000 sts (Poti1)+1,r25 |
||
1333 | 1336 0dac 8093 0000 sts Poti1,r24 |
||
1334 | 1337 .L120: |
||
1335 | 1338 0db0 8091 0000 lds r24,Poti2 |
||
1336 | 1339 0db4 9091 0000 lds r25,(Poti2)+1 |
||
1337 | 1340 0db8 97FF sbrs r25,7 |
||
1338 | 1341 0dba 00C0 rjmp .L122 |
||
1339 | 1342 0dbc 1092 0000 sts (Poti2)+1,__zero_reg__ |
||
1340 | 1343 0dc0 1092 0000 sts Poti2,__zero_reg__ |
||
1341 | 1344 0dc4 00C0 rjmp .L124 |
||
1342 | 1345 .L122: |
||
1343 | 1346 0dc6 8F3F cpi r24,255 |
||
1344 | 1347 0dc8 9105 cpc r25,__zero_reg__ |
||
1345 | 1348 0dca 01F0 breq .L124 |
||
1346 | 1349 0dcc 04F0 brlt .L124 |
||
1347 | 1350 0dce 8FEF ldi r24,lo8(255) |
||
1348 | 1351 0dd0 90E0 ldi r25,hi8(255) |
||
1349 | 1352 0dd2 9093 0000 sts (Poti2)+1,r25 |
||
1350 | 1353 0dd6 8093 0000 sts Poti2,r24 |
||
1351 | 1354 .L124: |
||
1352 | 1355 0dda 8091 0000 lds r24,Poti3 |
||
1353 | 1356 0dde 9091 0000 lds r25,(Poti3)+1 |
||
1354 | 1357 0de2 97FF sbrs r25,7 |
||
1355 | 1358 0de4 00C0 rjmp .L126 |
||
1356 | 1359 0de6 1092 0000 sts (Poti3)+1,__zero_reg__ |
||
1357 | 1360 0dea 1092 0000 sts Poti3,__zero_reg__ |
||
1358 | 1361 0dee 00C0 rjmp .L128 |
||
1359 | 1362 .L126: |
||
1360 | 1363 0df0 8F3F cpi r24,255 |
||
1361 | 1364 0df2 9105 cpc r25,__zero_reg__ |
||
1362 | 1365 0df4 01F0 breq .L128 |
||
1363 | 1366 0df6 04F0 brlt .L128 |
||
1364 | 1367 0df8 8FEF ldi r24,lo8(255) |
||
1365 | 1368 0dfa 90E0 ldi r25,hi8(255) |
||
1366 | 1369 0dfc 9093 0000 sts (Poti3)+1,r25 |
||
1367 | 1370 0e00 8093 0000 sts Poti3,r24 |
||
1368 | 1371 .L128: |
||
1369 | 1372 0e04 8091 0000 lds r24,Poti4 |
||
1370 | 1373 0e08 9091 0000 lds r25,(Poti4)+1 |
||
1371 | 1374 0e0c 97FF sbrs r25,7 |
||
1372 | 1375 0e0e 00C0 rjmp .L130 |
||
1373 | 1376 0e10 1092 0000 sts (Poti4)+1,__zero_reg__ |
||
1374 | 1377 0e14 1092 0000 sts Poti4,__zero_reg__ |
||
1375 | 1378 0e18 00C0 rjmp .L132 |
||
1376 | 1379 .L130: |
||
1377 | 1380 0e1a 8F3F cpi r24,255 |
||
1378 | 1381 0e1c 9105 cpc r25,__zero_reg__ |
||
1379 | 1382 0e1e 01F0 breq .L132 |
||
1380 | 1383 0e20 04F0 brlt .L132 |
||
1381 | 1384 0e22 8FEF ldi r24,lo8(255) |
||
1382 | 1385 0e24 90E0 ldi r25,hi8(255) |
||
1383 | 1386 0e26 9093 0000 sts (Poti4)+1,r25 |
||
1384 | 1387 0e2a 8093 0000 sts Poti4,r24 |
||
1385 | 1388 .L132: |
||
1386 | 1389 0e2e 6091 0000 lds r22,EE_Parameter+43 |
||
1387 | 1390 0e32 7727 clr r23 |
||
1388 | 1391 0e34 8827 clr r24 |
||
1389 | 1392 0e36 9927 clr r25 |
||
1390 | 1393 0e38 24EC ldi r18,lo8(2500) |
||
1391 | 1394 0e3a 39E0 ldi r19,hi8(2500) |
||
1392 | 1395 0e3c 40E0 ldi r20,hlo8(2500) |
||
1393 | 1396 0e3e 50E0 ldi r21,hhi8(2500) |
||
1394 | 1397 0e40 0E94 0000 call __mulsi3 |
||
1395 | 1398 0e44 6093 0000 sts Umschlag180Nick,r22 |
||
1396 | 1399 0e48 7093 0000 sts (Umschlag180Nick)+1,r23 |
||
1397 | 1400 0e4c 8093 0000 sts (Umschlag180Nick)+2,r24 |
||
1398 | 1401 0e50 9093 0000 sts (Umschlag180Nick)+3,r25 |
||
1399 | 1402 0e54 6093 0000 sts Umschlag180Roll,r22 |
||
1400 | 1403 0e58 7093 0000 sts (Umschlag180Roll)+1,r23 |
||
1401 | 1404 0e5c 8093 0000 sts (Umschlag180Roll)+2,r24 |
||
1402 | 1405 0e60 9093 0000 sts (Umschlag180Roll)+3,r25 |
||
1403 | 1406 /* epilogue: frame size=0 */ |
||
1404 | 1407 0e64 0895 ret |
||
1405 | 1408 /* epilogue end (size=1) */ |
||
1406 | 1409 /* function CalibrierMittelwert size 333 (332) */ |
||
1407 | 1411 .global ParameterZuordnung |
||
1408 | 1413 ParameterZuordnung: |
||
1409 | 1414 /* prologue: frame size=0 */ |
||
1410 | 1415 0e66 1F93 push r17 |
||
1411 | 1416 /* prologue end (size=1) */ |
||
1412 | 1417 0e68 8091 0000 lds r24,EE_Parameter+11 |
||
1413 | 1418 0e6c 8B3F cpi r24,lo8(-5) |
||
1414 | 1419 0e6e 00F0 brlo .L140 |
||
1415 | 1420 0e70 8B3F cpi r24,lo8(-5) |
||
1416 | 1421 0e72 01F4 brne .L142 |
||
1417 | 1422 0e74 8091 0000 lds r24,Poti1 |
||
1418 | 1423 0e78 00C0 rjmp .L140 |
||
1419 | 1424 .L142: |
||
1420 | 1425 0e7a 8C3F cpi r24,lo8(-4) |
||
1421 | 1426 0e7c 01F4 brne .L145 |
||
1422 | 1427 0e7e 8091 0000 lds r24,Poti2 |
||
1423 | 1428 0e82 00C0 rjmp .L140 |
||
1424 | 1429 .L145: |
||
1425 | 1430 0e84 8D3F cpi r24,lo8(-3) |
||
1426 | 1431 0e86 01F4 brne .L147 |
||
1427 | 1432 0e88 8091 0000 lds r24,Poti3 |
||
1428 | 1433 0e8c 00C0 rjmp .L140 |
||
1429 | 1434 .L147: |
||
1430 | 1435 0e8e 8E3F cpi r24,lo8(-2) |
||
1431 | 1436 0e90 01F4 brne .L144 |
||
1432 | 1437 0e92 8091 0000 lds r24,Poti4 |
||
1433 | 1438 .L140: |
||
1434 | 1439 0e96 8093 0000 sts Parameter_MaxHoehe,r24 |
||
1435 | 1440 .L144: |
||
1436 | 1441 0e9a 8091 0000 lds r24,Parameter_MaxHoehe |
||
1437 | 1442 0e9e 8823 tst r24 |
||
1438 | 1443 0ea0 01F4 brne .L150 |
||
1439 | 1444 0ea2 1092 0000 sts Parameter_MaxHoehe,__zero_reg__ |
||
1440 | 1445 0ea6 00C0 rjmp .L152 |
||
1441 | 1446 .L150: |
||
1442 | 1447 0ea8 8F3F cpi r24,lo8(-1) |
||
1443 | 1448 0eaa 01F4 brne .L152 |
||
1444 | 1449 0eac 8093 0000 sts Parameter_MaxHoehe,r24 |
||
1445 | 1450 .L152: |
||
1446 | 1451 0eb0 8091 0000 lds r24,EE_Parameter+10 |
||
1447 | 1452 0eb4 8B3F cpi r24,lo8(-5) |
||
1448 | 1453 0eb6 00F0 brlo .L154 |
||
1449 | 1454 0eb8 8B3F cpi r24,lo8(-5) |
||
1450 | 1455 0eba 01F4 brne .L156 |
||
1451 | 1456 0ebc 8091 0000 lds r24,Poti1 |
||
1452 | 1457 0ec0 00C0 rjmp .L154 |
||
1453 | 1458 .L156: |
||
1454 | 1459 0ec2 8C3F cpi r24,lo8(-4) |
||
1455 | 1460 0ec4 01F4 brne .L159 |
||
1456 | 1461 0ec6 8091 0000 lds r24,Poti2 |
||
1457 | 1462 0eca 00C0 rjmp .L154 |
||
1458 | 1463 .L159: |
||
1459 | 1464 0ecc 8D3F cpi r24,lo8(-3) |
||
1460 | 1465 0ece 01F4 brne .L161 |
||
1461 | 1466 0ed0 8091 0000 lds r24,Poti3 |
||
1462 | 1467 0ed4 00C0 rjmp .L154 |
||
1463 | 1468 .L161: |
||
1464 | 1469 0ed6 8E3F cpi r24,lo8(-2) |
||
1465 | 1470 0ed8 01F4 brne .L158 |
||
1466 | 1471 0eda 8091 0000 lds r24,Poti4 |
||
1467 | 1472 .L154: |
||
1468 | 1473 0ede 8093 0000 sts Parameter_Luftdruck_D,r24 |
||
1469 | 1474 .L158: |
||
1470 | 1475 0ee2 8091 0000 lds r24,Parameter_Luftdruck_D |
||
1471 | 1476 0ee6 8823 tst r24 |
||
1472 | 1477 0ee8 01F4 brne .L164 |
||
1473 | 1478 0eea 1092 0000 sts Parameter_Luftdruck_D,__zero_reg__ |
||
1474 | 1479 0eee 00C0 rjmp .L166 |
||
1475 | 1480 .L164: |
||
1476 | 1481 0ef0 8436 cpi r24,lo8(100) |
||
1477 | 1482 0ef2 00F0 brlo .L166 |
||
1478 | 1483 0ef4 84E6 ldi r24,lo8(100) |
||
1479 | 1484 0ef6 8093 0000 sts Parameter_Luftdruck_D,r24 |
||
1480 | 1485 .L166: |
||
1481 | 1486 0efa 8091 0000 lds r24,EE_Parameter+12 |
||
1482 | 1487 0efe 8B3F cpi r24,lo8(-5) |
||
1483 | 1488 0f00 00F0 brlo .L168 |
||
1484 | 1489 0f02 8B3F cpi r24,lo8(-5) |
||
1485 | 1490 0f04 01F4 brne .L170 |
||
1486 | 1491 0f06 8091 0000 lds r24,Poti1 |
||
1487 | 1492 0f0a 00C0 rjmp .L168 |
||
1488 | 1493 .L170: |
||
1489 | 1494 0f0c 8C3F cpi r24,lo8(-4) |
||
1490 | 1495 0f0e 01F4 brne .L173 |
||
1491 | 1496 0f10 8091 0000 lds r24,Poti2 |
||
1492 | 1497 0f14 00C0 rjmp .L168 |
||
1493 | 1498 .L173: |
||
1494 | 1499 0f16 8D3F cpi r24,lo8(-3) |
||
1495 | 1500 0f18 01F4 brne .L175 |
||
1496 | 1501 0f1a 8091 0000 lds r24,Poti3 |
||
1497 | 1502 0f1e 00C0 rjmp .L168 |
||
1498 | 1503 .L175: |
||
1499 | 1504 0f20 8E3F cpi r24,lo8(-2) |
||
1500 | 1505 0f22 01F4 brne .L172 |
||
1501 | 1506 0f24 8091 0000 lds r24,Poti4 |
||
1502 | 1507 .L168: |
||
1503 | 1508 0f28 8093 0000 sts Parameter_Hoehe_P,r24 |
||
1504 | 1509 .L172: |
||
1505 | 1510 0f2c 8091 0000 lds r24,Parameter_Hoehe_P |
||
1506 | 1511 0f30 8823 tst r24 |
||
1507 | 1512 0f32 01F4 brne .L178 |
||
1508 | 1513 0f34 1092 0000 sts Parameter_Hoehe_P,__zero_reg__ |
||
1509 | 1514 0f38 00C0 rjmp .L180 |
||
1510 | 1515 .L178: |
||
1511 | 1516 0f3a 8436 cpi r24,lo8(100) |
||
1512 | 1517 0f3c 00F0 brlo .L180 |
||
1513 | 1518 0f3e 84E6 ldi r24,lo8(100) |
||
1514 | 1519 0f40 8093 0000 sts Parameter_Hoehe_P,r24 |
||
1515 | 1520 .L180: |
||
1516 | 1521 0f44 8091 0000 lds r24,EE_Parameter+14 |
||
1517 | 1522 0f48 8B3F cpi r24,lo8(-5) |
||
1518 | 1523 0f4a 00F0 brlo .L182 |
||
1519 | 1524 0f4c 8B3F cpi r24,lo8(-5) |
||
1520 | 1525 0f4e 01F4 brne .L184 |
||
1521 | 1526 0f50 8091 0000 lds r24,Poti1 |
||
1522 | 1527 0f54 00C0 rjmp .L182 |
||
1523 | 1528 .L184: |
||
1524 | 1529 0f56 8C3F cpi r24,lo8(-4) |
||
1525 | 1530 0f58 01F4 brne .L187 |
||
1526 | 1531 0f5a 8091 0000 lds r24,Poti2 |
||
1527 | 1532 0f5e 00C0 rjmp .L182 |
||
1528 | 1533 .L187: |
||
1529 | 1534 0f60 8D3F cpi r24,lo8(-3) |
||
1530 | 1535 0f62 01F4 brne .L189 |
||
1531 | 1536 0f64 8091 0000 lds r24,Poti3 |
||
1532 | 1537 0f68 00C0 rjmp .L182 |
||
1533 | 1538 .L189: |
||
1534 | 1539 0f6a 8E3F cpi r24,lo8(-2) |
||
1535 | 1540 0f6c 01F4 brne .L186 |
||
1536 | 1541 0f6e 8091 0000 lds r24,Poti4 |
||
1537 | 1542 .L182: |
||
1538 | 1543 0f72 8093 0000 sts Parameter_Hoehe_ACC_Wirkung,r24 |
||
1539 | 1544 .L186: |
||
1540 | 1545 0f76 8091 0000 lds r24,Parameter_Hoehe_ACC_Wirkung |
||
1541 | 1546 0f7a 8823 tst r24 |
||
1542 | 1547 0f7c 01F4 brne .L192 |
||
1543 | 1548 0f7e 1092 0000 sts Parameter_Hoehe_ACC_Wirkung,__zero_reg__ |
||
1544 | 1549 0f82 00C0 rjmp .L194 |
||
1545 | 1550 .L192: |
||
1546 | 1551 0f84 8F3F cpi r24,lo8(-1) |
||
1547 | 1552 0f86 01F4 brne .L194 |
||
1548 | 1553 0f88 8093 0000 sts Parameter_Hoehe_ACC_Wirkung,r24 |
||
1549 | 1554 .L194: |
||
1550 | 1555 0f8c 8091 0000 lds r24,EE_Parameter+21 |
||
1551 | 1556 0f90 8B3F cpi r24,lo8(-5) |
||
1552 | 1557 0f92 00F0 brlo .L196 |
||
1553 | 1558 0f94 8B3F cpi r24,lo8(-5) |
||
1554 | 1559 0f96 01F4 brne .L198 |
||
1555 | 1560 0f98 8091 0000 lds r24,Poti1 |
||
1556 | 1561 0f9c 00C0 rjmp .L196 |
||
1557 | 1562 .L198: |
||
1558 | 1563 0f9e 8C3F cpi r24,lo8(-4) |
||
1559 | 1564 0fa0 01F4 brne .L201 |
||
1560 | 1565 0fa2 8091 0000 lds r24,Poti2 |
||
1561 | 1566 0fa6 00C0 rjmp .L196 |
||
1562 | 1567 .L201: |
||
1563 | 1568 0fa8 8D3F cpi r24,lo8(-3) |
||
1564 | 1569 0faa 01F4 brne .L203 |
||
1565 | 1570 0fac 8091 0000 lds r24,Poti3 |
||
1566 | 1571 0fb0 00C0 rjmp .L196 |
||
1567 | 1572 .L203: |
||
1568 | 1573 0fb2 8E3F cpi r24,lo8(-2) |
||
1569 | 1574 0fb4 01F4 brne .L200 |
||
1570 | 1575 0fb6 8091 0000 lds r24,Poti4 |
||
1571 | 1576 .L196: |
||
1572 | 1577 0fba 8093 0000 sts Parameter_KompassWirkung,r24 |
||
1573 | 1578 .L200: |
||
1574 | 1579 0fbe 8091 0000 lds r24,Parameter_KompassWirkung |
||
1575 | 1580 0fc2 8823 tst r24 |
||
1576 | 1581 0fc4 01F4 brne .L206 |
||
1577 | 1582 0fc6 1092 0000 sts Parameter_KompassWirkung,__zero_reg__ |
||
1578 | 1583 0fca 00C0 rjmp .L208 |
||
1579 | 1584 .L206: |
||
1580 | 1585 0fcc 8F3F cpi r24,lo8(-1) |
||
1581 | 1586 0fce 01F4 brne .L208 |
||
1582 | 1587 0fd0 8093 0000 sts Parameter_KompassWirkung,r24 |
||
1583 | 1588 .L208: |
||
1584 | 1589 0fd4 8091 0000 lds r24,EE_Parameter+22 |
||
1585 | 1590 0fd8 8B3F cpi r24,lo8(-5) |
||
1586 | 1591 0fda 00F0 brlo .L210 |
||
1587 | 1592 0fdc 8B3F cpi r24,lo8(-5) |
||
1588 | 1593 0fde 01F4 brne .L212 |
||
1589 | 1594 0fe0 8091 0000 lds r24,Poti1 |
||
1590 | 1595 0fe4 00C0 rjmp .L210 |
||
1591 | 1596 .L212: |
||
1592 | 1597 0fe6 8C3F cpi r24,lo8(-4) |
||
1593 | 1598 0fe8 01F4 brne .L215 |
||
1594 | 1599 0fea 8091 0000 lds r24,Poti2 |
||
1595 | 1600 0fee 00C0 rjmp .L210 |
||
1596 | 1601 .L215: |
||
1597 | 1602 0ff0 8D3F cpi r24,lo8(-3) |
||
1598 | 1603 0ff2 01F4 brne .L217 |
||
1599 | 1604 0ff4 8091 0000 lds r24,Poti3 |
||
1600 | 1605 0ff8 00C0 rjmp .L210 |
||
1601 | 1606 .L217: |
||
1602 | 1607 0ffa 8E3F cpi r24,lo8(-2) |
||
1603 | 1608 0ffc 01F4 brne .L214 |
||
1604 | 1609 0ffe 8091 0000 lds r24,Poti4 |
||
1605 | 1610 .L210: |
||
1606 | 1611 1002 8093 0000 sts Parameter_Gyro_P,r24 |
||
1607 | 1612 .L214: |
||
1608 | 1613 1006 8091 0000 lds r24,Parameter_Gyro_P |
||
1609 | 1614 100a 8B30 cpi r24,lo8(11) |
||
1610 | 1615 100c 00F4 brsh .L220 |
||
1611 | 1616 100e 8AE0 ldi r24,lo8(10) |
||
1612 | 1617 1010 00C0 rjmp .L436 |
||
1613 | 1618 .L220: |
||
1614 | 1619 1012 8F3F cpi r24,lo8(-1) |
||
1615 | 1620 1014 01F4 brne .L222 |
||
1616 | 1621 .L436: |
||
1617 | 1622 1016 8093 0000 sts Parameter_Gyro_P,r24 |
||
1618 | 1623 .L222: |
||
1619 | 1624 101a 8091 0000 lds r24,EE_Parameter+23 |
||
1620 | 1625 101e 8B3F cpi r24,lo8(-5) |
||
1621 | 1626 1020 00F0 brlo .L224 |
||
1622 | 1627 1022 8B3F cpi r24,lo8(-5) |
||
1623 | 1628 1024 01F4 brne .L226 |
||
1624 | 1629 1026 8091 0000 lds r24,Poti1 |
||
1625 | 1630 102a 00C0 rjmp .L224 |
||
1626 | 1631 .L226: |
||
1627 | 1632 102c 8C3F cpi r24,lo8(-4) |
||
1628 | 1633 102e 01F4 brne .L229 |
||
1629 | 1634 1030 8091 0000 lds r24,Poti2 |
||
1630 | 1635 1034 00C0 rjmp .L224 |
||
1631 | 1636 .L229: |
||
1632 | 1637 1036 8D3F cpi r24,lo8(-3) |
||
1633 | 1638 1038 01F4 brne .L231 |
||
1634 | 1639 103a 8091 0000 lds r24,Poti3 |
||
1635 | 1640 103e 00C0 rjmp .L224 |
||
1636 | 1641 .L231: |
||
1637 | 1642 1040 8E3F cpi r24,lo8(-2) |
||
1638 | 1643 1042 01F4 brne .L228 |
||
1639 | 1644 1044 8091 0000 lds r24,Poti4 |
||
1640 | 1645 .L224: |
||
1641 | 1646 1048 8093 0000 sts Parameter_Gyro_I,r24 |
||
1642 | 1647 .L228: |
||
1643 | 1648 104c 8091 0000 lds r24,Parameter_Gyro_I |
||
1644 | 1649 1050 8823 tst r24 |
||
1645 | 1650 1052 01F4 brne .L234 |
||
1646 | 1651 1054 1092 0000 sts Parameter_Gyro_I,__zero_reg__ |
||
1647 | 1652 1058 00C0 rjmp .L236 |
||
1648 | 1653 .L234: |
||
1649 | 1654 105a 8F3F cpi r24,lo8(-1) |
||
1650 | 1655 105c 01F4 brne .L236 |
||
1651 | 1656 105e 8093 0000 sts Parameter_Gyro_I,r24 |
||
1652 | 1657 .L236: |
||
1653 | 1658 1062 8091 0000 lds r24,EE_Parameter+28 |
||
1654 | 1659 1066 8B3F cpi r24,lo8(-5) |
||
1655 | 1660 1068 00F0 brlo .L238 |
||
1656 | 1661 106a 8B3F cpi r24,lo8(-5) |
||
1657 | 1662 106c 01F4 brne .L240 |
||
1658 | 1663 106e 8091 0000 lds r24,Poti1 |
||
1659 | 1664 1072 00C0 rjmp .L238 |
||
1660 | 1665 .L240: |
||
1661 | 1666 1074 8C3F cpi r24,lo8(-4) |
||
1662 | 1667 1076 01F4 brne .L243 |
||
1663 | 1668 1078 8091 0000 lds r24,Poti2 |
||
1664 | 1669 107c 00C0 rjmp .L238 |
||
1665 | 1670 .L243: |
||
1666 | 1671 107e 8D3F cpi r24,lo8(-3) |
||
1667 | 1672 1080 01F4 brne .L245 |
||
1668 | 1673 1082 8091 0000 lds r24,Poti3 |
||
1669 | 1674 1086 00C0 rjmp .L238 |
||
1670 | 1675 .L245: |
||
1671 | 1676 1088 8E3F cpi r24,lo8(-2) |
||
1672 | 1677 108a 01F4 brne .L242 |
||
1673 | 1678 108c 8091 0000 lds r24,Poti4 |
||
1674 | 1679 .L238: |
||
1675 | 1680 1090 8093 0000 sts Parameter_I_Faktor,r24 |
||
1676 | 1681 .L242: |
||
1677 | 1682 1094 8091 0000 lds r24,Parameter_I_Faktor |
||
1678 | 1683 1098 8823 tst r24 |
||
1679 | 1684 109a 01F4 brne .L248 |
||
1680 | 1685 109c 1092 0000 sts Parameter_I_Faktor,__zero_reg__ |
||
1681 | 1686 10a0 00C0 rjmp .L250 |
||
1682 | 1687 .L248: |
||
1683 | 1688 10a2 8F3F cpi r24,lo8(-1) |
||
1684 | 1689 10a4 01F4 brne .L250 |
||
1685 | 1690 10a6 8093 0000 sts Parameter_I_Faktor,r24 |
||
1686 | 1691 .L250: |
||
1687 | 1692 10aa 8091 0000 lds r24,EE_Parameter+29 |
||
1688 | 1693 10ae 8B3F cpi r24,lo8(-5) |
||
1689 | 1694 10b0 00F0 brlo .L252 |
||
1690 | 1695 10b2 8B3F cpi r24,lo8(-5) |
||
1691 | 1696 10b4 01F4 brne .L254 |
||
1692 | 1697 10b6 8091 0000 lds r24,Poti1 |
||
1693 | 1698 10ba 00C0 rjmp .L252 |
||
1694 | 1699 .L254: |
||
1695 | 1700 10bc 8C3F cpi r24,lo8(-4) |
||
1696 | 1701 10be 01F4 brne .L257 |
||
1697 | 1702 10c0 8091 0000 lds r24,Poti2 |
||
1698 | 1703 10c4 00C0 rjmp .L252 |
||
1699 | 1704 .L257: |
||
1700 | 1705 10c6 8D3F cpi r24,lo8(-3) |
||
1701 | 1706 10c8 01F4 brne .L259 |
||
1702 | 1707 10ca 8091 0000 lds r24,Poti3 |
||
1703 | 1708 10ce 00C0 rjmp .L252 |
||
1704 | 1709 .L259: |
||
1705 | 1710 10d0 8E3F cpi r24,lo8(-2) |
||
1706 | 1711 10d2 01F4 brne .L256 |
||
1707 | 1712 10d4 8091 0000 lds r24,Poti4 |
||
1708 | 1713 .L252: |
||
1709 | 1714 10d8 8093 0000 sts Parameter_UserParam1,r24 |
||
1710 | 1715 .L256: |
||
1711 | 1716 10dc 8091 0000 lds r24,Parameter_UserParam1 |
||
1712 | 1717 10e0 8823 tst r24 |
||
1713 | 1718 10e2 01F4 brne .L262 |
||
1714 | 1719 10e4 1092 0000 sts Parameter_UserParam1,__zero_reg__ |
||
1715 | 1720 10e8 00C0 rjmp .L264 |
||
1716 | 1721 .L262: |
||
1717 | 1722 10ea 8F3F cpi r24,lo8(-1) |
||
1718 | 1723 10ec 01F4 brne .L264 |
||
1719 | 1724 10ee 8093 0000 sts Parameter_UserParam1,r24 |
||
1720 | 1725 .L264: |
||
1721 | 1726 10f2 8091 0000 lds r24,EE_Parameter+30 |
||
1722 | 1727 10f6 8B3F cpi r24,lo8(-5) |
||
1723 | 1728 10f8 00F0 brlo .L266 |
||
1724 | 1729 10fa 8B3F cpi r24,lo8(-5) |
||
1725 | 1730 10fc 01F4 brne .L268 |
||
1726 | 1731 10fe 8091 0000 lds r24,Poti1 |
||
1727 | 1732 1102 00C0 rjmp .L266 |
||
1728 | 1733 .L268: |
||
1729 | 1734 1104 8C3F cpi r24,lo8(-4) |
||
1730 | 1735 1106 01F4 brne .L271 |
||
1731 | 1736 1108 8091 0000 lds r24,Poti2 |
||
1732 | 1737 110c 00C0 rjmp .L266 |
||
1733 | 1738 .L271: |
||
1734 | 1739 110e 8D3F cpi r24,lo8(-3) |
||
1735 | 1740 1110 01F4 brne .L273 |
||
1736 | 1741 1112 8091 0000 lds r24,Poti3 |
||
1737 | 1742 1116 00C0 rjmp .L266 |
||
1738 | 1743 .L273: |
||
1739 | 1744 1118 8E3F cpi r24,lo8(-2) |
||
1740 | 1745 111a 01F4 brne .L270 |
||
1741 | 1746 111c 8091 0000 lds r24,Poti4 |
||
1742 | 1747 .L266: |
||
1743 | 1748 1120 8093 0000 sts Parameter_UserParam2,r24 |
||
1744 | 1749 .L270: |
||
1745 | 1750 1124 8091 0000 lds r24,Parameter_UserParam2 |
||
1746 | 1751 1128 8823 tst r24 |
||
1747 | 1752 112a 01F4 brne .L276 |
||
1748 | 1753 112c 1092 0000 sts Parameter_UserParam2,__zero_reg__ |
||
1749 | 1754 1130 00C0 rjmp .L278 |
||
1750 | 1755 .L276: |
||
1751 | 1756 1132 8F3F cpi r24,lo8(-1) |
||
1752 | 1757 1134 01F4 brne .L278 |
||
1753 | 1758 1136 8093 0000 sts Parameter_UserParam2,r24 |
||
1754 | 1759 .L278: |
||
1755 | 1760 113a 8091 0000 lds r24,EE_Parameter+31 |
||
1756 | 1761 113e 8B3F cpi r24,lo8(-5) |
||
1757 | 1762 1140 00F0 brlo .L280 |
||
1758 | 1763 1142 8B3F cpi r24,lo8(-5) |
||
1759 | 1764 1144 01F4 brne .L282 |
||
1760 | 1765 1146 8091 0000 lds r24,Poti1 |
||
1761 | 1766 114a 00C0 rjmp .L280 |
||
1762 | 1767 .L282: |
||
1763 | 1768 114c 8C3F cpi r24,lo8(-4) |
||
1764 | 1769 114e 01F4 brne .L285 |
||
1765 | 1770 1150 8091 0000 lds r24,Poti2 |
||
1766 | 1771 1154 00C0 rjmp .L280 |
||
1767 | 1772 .L285: |
||
1768 | 1773 1156 8D3F cpi r24,lo8(-3) |
||
1769 | 1774 1158 01F4 brne .L287 |
||
1770 | 1775 115a 8091 0000 lds r24,Poti3 |
||
1771 | 1776 115e 00C0 rjmp .L280 |
||
1772 | 1777 .L287: |
||
1773 | 1778 1160 8E3F cpi r24,lo8(-2) |
||
1774 | 1779 1162 01F4 brne .L284 |
||
1775 | 1780 1164 8091 0000 lds r24,Poti4 |
||
1776 | 1781 .L280: |
||
1777 | 1782 1168 8093 0000 sts Parameter_UserParam3,r24 |
||
1778 | 1783 .L284: |
||
1779 | 1784 116c 8091 0000 lds r24,Parameter_UserParam3 |
||
1780 | 1785 1170 8823 tst r24 |
||
1781 | 1786 1172 01F4 brne .L290 |
||
1782 | 1787 1174 1092 0000 sts Parameter_UserParam3,__zero_reg__ |
||
1783 | 1788 1178 00C0 rjmp .L292 |
||
1784 | 1789 .L290: |
||
1785 | 1790 117a 8F3F cpi r24,lo8(-1) |
||
1786 | 1791 117c 01F4 brne .L292 |
||
1787 | 1792 117e 8093 0000 sts Parameter_UserParam3,r24 |
||
1788 | 1793 .L292: |
||
1789 | 1794 1182 8091 0000 lds r24,EE_Parameter+32 |
||
1790 | 1795 1186 8B3F cpi r24,lo8(-5) |
||
1791 | 1796 1188 00F0 brlo .L294 |
||
1792 | 1797 118a 8B3F cpi r24,lo8(-5) |
||
1793 | 1798 118c 01F4 brne .L296 |
||
1794 | 1799 118e 8091 0000 lds r24,Poti1 |
||
1795 | 1800 1192 00C0 rjmp .L294 |
||
1796 | 1801 .L296: |
||
1797 | 1802 1194 8C3F cpi r24,lo8(-4) |
||
1798 | 1803 1196 01F4 brne .L299 |
||
1799 | 1804 1198 8091 0000 lds r24,Poti2 |
||
1800 | 1805 119c 00C0 rjmp .L294 |
||
1801 | 1806 .L299: |
||
1802 | 1807 119e 8D3F cpi r24,lo8(-3) |
||
1803 | 1808 11a0 01F4 brne .L301 |
||
1804 | 1809 11a2 8091 0000 lds r24,Poti3 |
||
1805 | 1810 11a6 00C0 rjmp .L294 |
||
1806 | 1811 .L301: |
||
1807 | 1812 11a8 8E3F cpi r24,lo8(-2) |
||
1808 | 1813 11aa 01F4 brne .L298 |
||
1809 | 1814 11ac 8091 0000 lds r24,Poti4 |
||
1810 | 1815 .L294: |
||
1811 | 1816 11b0 8093 0000 sts Parameter_UserParam4,r24 |
||
1812 | 1817 .L298: |
||
1813 | 1818 11b4 8091 0000 lds r24,Parameter_UserParam4 |
||
1814 | 1819 11b8 8823 tst r24 |
||
1815 | 1820 11ba 01F4 brne .L304 |
||
1816 | 1821 11bc 1092 0000 sts Parameter_UserParam4,__zero_reg__ |
||
1817 | 1822 11c0 00C0 rjmp .L306 |
||
1818 | 1823 .L304: |
||
1819 | 1824 11c2 8F3F cpi r24,lo8(-1) |
||
1820 | 1825 11c4 01F4 brne .L306 |
||
1821 | 1826 11c6 8093 0000 sts Parameter_UserParam4,r24 |
||
1822 | 1827 .L306: |
||
1823 | 1828 11ca 8091 0000 lds r24,EE_Parameter+48 |
||
1824 | 1829 11ce 8B3F cpi r24,lo8(-5) |
||
1825 | 1830 11d0 00F0 brlo .L308 |
||
1826 | 1831 11d2 8B3F cpi r24,lo8(-5) |
||
1827 | 1832 11d4 01F4 brne .L310 |
||
1828 | 1833 11d6 8091 0000 lds r24,Poti1 |
||
1829 | 1834 11da 00C0 rjmp .L308 |
||
1830 | 1835 .L310: |
||
1831 | 1836 11dc 8C3F cpi r24,lo8(-4) |
||
1832 | 1837 11de 01F4 brne .L313 |
||
1833 | 1838 11e0 8091 0000 lds r24,Poti2 |
||
1834 | 1839 11e4 00C0 rjmp .L308 |
||
1835 | 1840 .L313: |
||
1836 | 1841 11e6 8D3F cpi r24,lo8(-3) |
||
1837 | 1842 11e8 01F4 brne .L315 |
||
1838 | 1843 11ea 8091 0000 lds r24,Poti3 |
||
1839 | 1844 11ee 00C0 rjmp .L308 |
||
1840 | 1845 .L315: |
||
1841 | 1846 11f0 8E3F cpi r24,lo8(-2) |
||
1842 | 1847 11f2 01F4 brne .L312 |
||
1843 | 1848 11f4 8091 0000 lds r24,Poti4 |
||
1844 | 1849 .L308: |
||
1845 | 1850 11f8 8093 0000 sts Parameter_UserParam5,r24 |
||
1846 | 1851 .L312: |
||
1847 | 1852 11fc 8091 0000 lds r24,Parameter_UserParam5 |
||
1848 | 1853 1200 8823 tst r24 |
||
1849 | 1854 1202 01F4 brne .L318 |
||
1850 | 1855 1204 1092 0000 sts Parameter_UserParam5,__zero_reg__ |
||
1851 | 1856 1208 00C0 rjmp .L320 |
||
1852 | 1857 .L318: |
||
1853 | 1858 120a 8F3F cpi r24,lo8(-1) |
||
1854 | 1859 120c 01F4 brne .L320 |
||
1855 | 1860 120e 8093 0000 sts Parameter_UserParam5,r24 |
||
1856 | 1861 .L320: |
||
1857 | 1862 1212 8091 0000 lds r24,EE_Parameter+49 |
||
1858 | 1863 1216 8B3F cpi r24,lo8(-5) |
||
1859 | 1864 1218 00F0 brlo .L322 |
||
1860 | 1865 121a 8B3F cpi r24,lo8(-5) |
||
1861 | 1866 121c 01F4 brne .L324 |
||
1862 | 1867 121e 8091 0000 lds r24,Poti1 |
||
1863 | 1868 1222 00C0 rjmp .L322 |
||
1864 | 1869 .L324: |
||
1865 | 1870 1224 8C3F cpi r24,lo8(-4) |
||
1866 | 1871 1226 01F4 brne .L327 |
||
1867 | 1872 1228 8091 0000 lds r24,Poti2 |
||
1868 | 1873 122c 00C0 rjmp .L322 |
||
1869 | 1874 .L327: |
||
1870 | 1875 122e 8D3F cpi r24,lo8(-3) |
||
1871 | 1876 1230 01F4 brne .L329 |
||
1872 | 1877 1232 8091 0000 lds r24,Poti3 |
||
1873 | 1878 1236 00C0 rjmp .L322 |
||
1874 | 1879 .L329: |
||
1875 | 1880 1238 8E3F cpi r24,lo8(-2) |
||
1876 | 1881 123a 01F4 brne .L326 |
||
1877 | 1882 123c 8091 0000 lds r24,Poti4 |
||
1878 | 1883 .L322: |
||
1879 | 1884 1240 8093 0000 sts Parameter_UserParam6,r24 |
||
1880 | 1885 .L326: |
||
1881 | 1886 1244 8091 0000 lds r24,Parameter_UserParam6 |
||
1882 | 1887 1248 8823 tst r24 |
||
1883 | 1888 124a 01F4 brne .L332 |
||
1884 | 1889 124c 1092 0000 sts Parameter_UserParam6,__zero_reg__ |
||
1885 | 1890 1250 00C0 rjmp .L334 |
||
1886 | 1891 .L332: |
||
1887 | 1892 1252 8F3F cpi r24,lo8(-1) |
||
1888 | 1893 1254 01F4 brne .L334 |
||
1889 | 1894 1256 8093 0000 sts Parameter_UserParam6,r24 |
||
1890 | 1895 .L334: |
||
1891 | 1896 125a 8091 0000 lds r24,EE_Parameter+50 |
||
1892 | 1897 125e 8B3F cpi r24,lo8(-5) |
||
1893 | 1898 1260 00F0 brlo .L336 |
||
1894 | 1899 1262 8B3F cpi r24,lo8(-5) |
||
1895 | 1900 1264 01F4 brne .L338 |
||
1896 | 1901 1266 8091 0000 lds r24,Poti1 |
||
1897 | 1902 126a 00C0 rjmp .L336 |
||
1898 | 1903 .L338: |
||
1899 | 1904 126c 8C3F cpi r24,lo8(-4) |
||
1900 | 1905 126e 01F4 brne .L341 |
||
1901 | 1906 1270 8091 0000 lds r24,Poti2 |
||
1902 | 1907 1274 00C0 rjmp .L336 |
||
1903 | 1908 .L341: |
||
1904 | 1909 1276 8D3F cpi r24,lo8(-3) |
||
1905 | 1910 1278 01F4 brne .L343 |
||
1906 | 1911 127a 8091 0000 lds r24,Poti3 |
||
1907 | 1912 127e 00C0 rjmp .L336 |
||
1908 | 1913 .L343: |
||
1909 | 1914 1280 8E3F cpi r24,lo8(-2) |
||
1910 | 1915 1282 01F4 brne .L340 |
||
1911 | 1916 1284 8091 0000 lds r24,Poti4 |
||
1912 | 1917 .L336: |
||
1913 | 1918 1288 8093 0000 sts Parameter_UserParam7,r24 |
||
1914 | 1919 .L340: |
||
1915 | 1920 128c 8091 0000 lds r24,Parameter_UserParam7 |
||
1916 | 1921 1290 8823 tst r24 |
||
1917 | 1922 1292 01F4 brne .L346 |
||
1918 | 1923 1294 1092 0000 sts Parameter_UserParam7,__zero_reg__ |
||
1919 | 1924 1298 00C0 rjmp .L348 |
||
1920 | 1925 .L346: |
||
1921 | 1926 129a 8F3F cpi r24,lo8(-1) |
||
1922 | 1927 129c 01F4 brne .L348 |
||
1923 | 1928 129e 8093 0000 sts Parameter_UserParam7,r24 |
||
1924 | 1929 .L348: |
||
1925 | 1930 12a2 8091 0000 lds r24,EE_Parameter+51 |
||
1926 | 1931 12a6 8B3F cpi r24,lo8(-5) |
||
1927 | 1932 12a8 00F0 brlo .L350 |
||
1928 | 1933 12aa 8B3F cpi r24,lo8(-5) |
||
1929 | 1934 12ac 01F4 brne .L352 |
||
1930 | 1935 12ae 8091 0000 lds r24,Poti1 |
||
1931 | 1936 12b2 00C0 rjmp .L350 |
||
1932 | 1937 .L352: |
||
1933 | 1938 12b4 8C3F cpi r24,lo8(-4) |
||
1934 | 1939 12b6 01F4 brne .L355 |
||
1935 | 1940 12b8 8091 0000 lds r24,Poti2 |
||
1936 | 1941 12bc 00C0 rjmp .L350 |
||
1937 | 1942 .L355: |
||
1938 | 1943 12be 8D3F cpi r24,lo8(-3) |
||
1939 | 1944 12c0 01F4 brne .L357 |
||
1940 | 1945 12c2 8091 0000 lds r24,Poti3 |
||
1941 | 1946 12c6 00C0 rjmp .L350 |
||
1942 | 1947 .L357: |
||
1943 | 1948 12c8 8E3F cpi r24,lo8(-2) |
||
1944 | 1949 12ca 01F4 brne .L354 |
||
1945 | 1950 12cc 8091 0000 lds r24,Poti4 |
||
1946 | 1951 .L350: |
||
1947 | 1952 12d0 8093 0000 sts Parameter_UserParam8,r24 |
||
1948 | 1953 .L354: |
||
1949 | 1954 12d4 8091 0000 lds r24,Parameter_UserParam8 |
||
1950 | 1955 12d8 8823 tst r24 |
||
1951 | 1956 12da 01F4 brne .L360 |
||
1952 | 1957 12dc 1092 0000 sts Parameter_UserParam8,__zero_reg__ |
||
1953 | 1958 12e0 00C0 rjmp .L362 |
||
1954 | 1959 .L360: |
||
1955 | 1960 12e2 8F3F cpi r24,lo8(-1) |
||
1956 | 1961 12e4 01F4 brne .L362 |
||
1957 | 1962 12e6 8093 0000 sts Parameter_UserParam8,r24 |
||
1958 | 1963 .L362: |
||
1959 | 1964 12ea 8091 0000 lds r24,EE_Parameter+33 |
||
1960 | 1965 12ee 8B3F cpi r24,lo8(-5) |
||
1961 | 1966 12f0 00F0 brlo .L364 |
||
1962 | 1967 12f2 8B3F cpi r24,lo8(-5) |
||
1963 | 1968 12f4 01F4 brne .L366 |
||
1964 | 1969 12f6 8091 0000 lds r24,Poti1 |
||
1965 | 1970 12fa 00C0 rjmp .L364 |
||
1966 | 1971 .L366: |
||
1967 | 1972 12fc 8C3F cpi r24,lo8(-4) |
||
1968 | 1973 12fe 01F4 brne .L369 |
||
1969 | 1974 1300 8091 0000 lds r24,Poti2 |
||
1970 | 1975 1304 00C0 rjmp .L364 |
||
1971 | 1976 .L369: |
||
1972 | 1977 1306 8D3F cpi r24,lo8(-3) |
||
1973 | 1978 1308 01F4 brne .L371 |
||
1974 | 1979 130a 8091 0000 lds r24,Poti3 |
||
1975 | 1980 130e 00C0 rjmp .L364 |
||
1976 | 1981 .L371: |
||
1977 | 1982 1310 8E3F cpi r24,lo8(-2) |
||
1978 | 1983 1312 01F4 brne .L368 |
||
1979 | 1984 1314 8091 0000 lds r24,Poti4 |
||
1980 | 1985 .L364: |
||
1981 | 1986 1318 8093 0000 sts Parameter_ServoNickControl,r24 |
||
1982 | 1987 .L368: |
||
1983 | 1988 131c 8091 0000 lds r24,Parameter_ServoNickControl |
||
1984 | 1989 1320 8823 tst r24 |
||
1985 | 1990 1322 01F4 brne .L374 |
||
1986 | 1991 1324 1092 0000 sts Parameter_ServoNickControl,__zero_reg__ |
||
1987 | 1992 1328 00C0 rjmp .L376 |
||
1988 | 1993 .L374: |
||
1989 | 1994 132a 8F3F cpi r24,lo8(-1) |
||
1990 | 1995 132c 01F4 brne .L376 |
||
1991 | 1996 132e 8093 0000 sts Parameter_ServoNickControl,r24 |
||
1992 | 1997 .L376: |
||
1993 | 1998 1332 8091 0000 lds r24,EE_Parameter+38 |
||
1994 | 1999 1336 8B3F cpi r24,lo8(-5) |
||
1995 | 2000 1338 00F0 brlo .L378 |
||
1996 | 2001 133a 8B3F cpi r24,lo8(-5) |
||
1997 | 2002 133c 01F4 brne .L380 |
||
1998 | 2003 133e 8091 0000 lds r24,Poti1 |
||
1999 | 2004 1342 00C0 rjmp .L378 |
||
2000 | 2005 .L380: |
||
2001 | 2006 1344 8C3F cpi r24,lo8(-4) |
||
2002 | 2007 1346 01F4 brne .L383 |
||
2003 | 2008 1348 8091 0000 lds r24,Poti2 |
||
2004 | 2009 134c 00C0 rjmp .L378 |
||
2005 | 2010 .L383: |
||
2006 | 2011 134e 8D3F cpi r24,lo8(-3) |
||
2007 | 2012 1350 01F4 brne .L385 |
||
2008 | 2013 1352 8091 0000 lds r24,Poti3 |
||
2009 | 2014 1356 00C0 rjmp .L378 |
||
2010 | 2015 .L385: |
||
2011 | 2016 1358 8E3F cpi r24,lo8(-2) |
||
2012 | 2017 135a 01F4 brne .L382 |
||
2013 | 2018 135c 8091 0000 lds r24,Poti4 |
||
2014 | 2019 .L378: |
||
2015 | 2020 1360 8093 0000 sts Parameter_LoopGasLimit,r24 |
||
2016 | 2021 .L382: |
||
2017 | 2022 1364 8091 0000 lds r24,Parameter_LoopGasLimit |
||
2018 | 2023 1368 8823 tst r24 |
||
2019 | 2024 136a 01F4 brne .L388 |
||
2020 | 2025 136c 1092 0000 sts Parameter_LoopGasLimit,__zero_reg__ |
||
2021 | 2026 1370 00C0 rjmp .L390 |
||
2022 | 2027 .L388: |
||
2023 | 2028 1372 8F3F cpi r24,lo8(-1) |
||
2024 | 2029 1374 01F4 brne .L390 |
||
2025 | 2030 1376 8093 0000 sts Parameter_LoopGasLimit,r24 |
||
2026 | 2031 .L390: |
||
2027 | 2032 137a 8091 0000 lds r24,EE_Parameter+41 |
||
2028 | 2033 137e 8B3F cpi r24,lo8(-5) |
||
2029 | 2034 1380 00F0 brlo .L392 |
||
2030 | 2035 1382 8B3F cpi r24,lo8(-5) |
||
2031 | 2036 1384 01F4 brne .L394 |
||
2032 | 2037 1386 8091 0000 lds r24,Poti1 |
||
2033 | 2038 138a 00C0 rjmp .L392 |
||
2034 | 2039 .L394: |
||
2035 | 2040 138c 8C3F cpi r24,lo8(-4) |
||
2036 | 2041 138e 01F4 brne .L397 |
||
2037 | 2042 1390 8091 0000 lds r24,Poti2 |
||
2038 | 2043 1394 00C0 rjmp .L392 |
||
2039 | 2044 .L397: |
||
2040 | 2045 1396 8D3F cpi r24,lo8(-3) |
||
2041 | 2046 1398 01F4 brne .L399 |
||
2042 | 2047 139a 8091 0000 lds r24,Poti3 |
||
2043 | 2048 139e 00C0 rjmp .L392 |
||
2044 | 2049 .L399: |
||
2045 | 2050 13a0 8E3F cpi r24,lo8(-2) |
||
2046 | 2051 13a2 01F4 brne .L396 |
||
2047 | 2052 13a4 8091 0000 lds r24,Poti4 |
||
2048 | 2053 .L392: |
||
2049 | 2054 13a8 8093 0000 sts Parameter_AchsKopplung1,r24 |
||
2050 | 2055 .L396: |
||
2051 | 2056 13ac 8091 0000 lds r24,Parameter_AchsKopplung1 |
||
2052 | 2057 13b0 8823 tst r24 |
||
2053 | 2058 13b2 01F4 brne .L402 |
||
2054 | 2059 13b4 1092 0000 sts Parameter_AchsKopplung1,__zero_reg__ |
||
2055 | 2060 13b8 00C0 rjmp .L404 |
||
2056 | 2061 .L402: |
||
2057 | 2062 13ba 8F3F cpi r24,lo8(-1) |
||
2058 | 2063 13bc 01F4 brne .L404 |
||
2059 | 2064 13be 8093 0000 sts Parameter_AchsKopplung1,r24 |
||
2060 | 2065 .L404: |
||
2061 | 2066 13c2 8091 0000 lds r24,EE_Parameter+42 |
||
2062 | 2067 13c6 8B3F cpi r24,lo8(-5) |
||
2063 | 2068 13c8 00F0 brlo .L406 |
||
2064 | 2069 13ca 8B3F cpi r24,lo8(-5) |
||
2065 | 2070 13cc 01F4 brne .L408 |
||
2066 | 2071 13ce 8091 0000 lds r24,Poti1 |
||
2067 | 2072 13d2 00C0 rjmp .L406 |
||
2068 | 2073 .L408: |
||
2069 | 2074 13d4 8C3F cpi r24,lo8(-4) |
||
2070 | 2075 13d6 01F4 brne .L411 |
||
2071 | 2076 13d8 8091 0000 lds r24,Poti2 |
||
2072 | 2077 13dc 00C0 rjmp .L406 |
||
2073 | 2078 .L411: |
||
2074 | 2079 13de 8D3F cpi r24,lo8(-3) |
||
2075 | 2080 13e0 01F4 brne .L413 |
||
2076 | 2081 13e2 8091 0000 lds r24,Poti3 |
||
2077 | 2082 13e6 00C0 rjmp .L406 |
||
2078 | 2083 .L413: |
||
2079 | 2084 13e8 8E3F cpi r24,lo8(-2) |
||
2080 | 2085 13ea 01F4 brne .L410 |
||
2081 | 2086 13ec 8091 0000 lds r24,Poti4 |
||
2082 | 2087 .L406: |
||
2083 | 2088 13f0 8093 0000 sts Parameter_AchsGegenKopplung1,r24 |
||
2084 | 2089 .L410: |
||
2085 | 2090 13f4 8091 0000 lds r24,Parameter_AchsGegenKopplung1 |
||
2086 | 2091 13f8 8823 tst r24 |
||
2087 | 2092 13fa 01F4 brne .L416 |
||
2088 | 2093 13fc 1092 0000 sts Parameter_AchsGegenKopplung1,__zero_reg__ |
||
2089 | 2094 1400 00C0 rjmp .L418 |
||
2090 | 2095 .L416: |
||
2091 | 2096 1402 8F3F cpi r24,lo8(-1) |
||
2092 | 2097 1404 01F4 brne .L418 |
||
2093 | 2098 1406 8093 0000 sts Parameter_AchsGegenKopplung1,r24 |
||
2094 | 2099 .L418: |
||
2095 | 2100 140a 8091 0000 lds r24,EE_Parameter+47 |
||
2096 | 2101 140e 8B3F cpi r24,lo8(-5) |
||
2097 | 2102 1410 00F0 brlo .L420 |
||
2098 | 2103 1412 8B3F cpi r24,lo8(-5) |
||
2099 | 2104 1414 01F4 brne .L422 |
||
2100 | 2105 1416 8091 0000 lds r24,Poti1 |
||
2101 | 2106 141a 00C0 rjmp .L420 |
||
2102 | 2107 .L422: |
||
2103 | 2108 141c 8C3F cpi r24,lo8(-4) |
||
2104 | 2109 141e 01F4 brne .L425 |
||
2105 | 2110 1420 8091 0000 lds r24,Poti2 |
||
2106 | 2111 1424 00C0 rjmp .L420 |
||
2107 | 2112 .L425: |
||
2108 | 2113 1426 8D3F cpi r24,lo8(-3) |
||
2109 | 2114 1428 01F4 brne .L427 |
||
2110 | 2115 142a 8091 0000 lds r24,Poti3 |
||
2111 | 2116 142e 00C0 rjmp .L420 |
||
2112 | 2117 .L427: |
||
2113 | 2118 1430 8E3F cpi r24,lo8(-2) |
||
2114 | 2119 1432 01F4 brne .L424 |
||
2115 | 2120 1434 8091 0000 lds r24,Poti4 |
||
2116 | 2121 .L420: |
||
2117 | 2122 1438 8093 0000 sts Parameter_DynamicStability,r24 |
||
2118 | 2123 .L424: |
||
2119 | 2124 143c 8091 0000 lds r24,Parameter_DynamicStability |
||
2120 | 2125 1440 8823 tst r24 |
||
2121 | 2126 1442 01F4 brne .L430 |
||
2122 | 2127 1444 1092 0000 sts Parameter_DynamicStability,__zero_reg__ |
||
2123 | 2128 1448 00C0 rjmp .L432 |
||
2124 | 2129 .L430: |
||
2125 | 2130 144a 8F3F cpi r24,lo8(-1) |
||
2126 | 2131 144c 01F4 brne .L432 |
||
2127 | 2132 144e 8093 0000 sts Parameter_DynamicStability,r24 |
||
2128 | 2133 .L432: |
||
2129 | 2134 1452 1091 0000 lds r17,Parameter_I_Faktor |
||
2130 | 2135 1456 612F mov r22,r17 |
||
2131 | 2136 1458 7727 clr r23 |
||
2132 | 2137 145a 67FD sbrc r22,7 |
||
2133 | 2138 145c 7095 com r23 |
||
2134 | 2139 145e 872F mov r24,r23 |
||
2135 | 2140 1460 972F mov r25,r23 |
||
2136 | 2141 1462 0E94 0000 call __floatsisf |
||
2137 | 2142 1466 17FF sbrs r17,7 |
||
2138 | 2143 1468 00C0 rjmp .L434 |
||
2139 | 2144 146a 20E0 ldi r18,lo8(0x43800000) |
||
2140 | 2145 146c 30E0 ldi r19,hi8(0x43800000) |
||
2141 | 2146 146e 40E8 ldi r20,hlo8(0x43800000) |
||
2142 | 2147 1470 53E4 ldi r21,hhi8(0x43800000) |
||
2143 | 2148 1472 0E94 0000 call __addsf3 |
||
2144 | 2149 .L434: |
||
2145 | 2150 1476 27E1 ldi r18,lo8(0x38d1b717) |
||
2146 | 2151 1478 37EB ldi r19,hi8(0x38d1b717) |
||
2147 | 2152 147a 41ED ldi r20,hlo8(0x38d1b717) |
||
2148 | 2153 147c 58E3 ldi r21,hhi8(0x38d1b717) |
||
2149 | 2154 147e 0E94 0000 call __mulsf3 |
||
2150 | 2155 1482 6093 0000 sts Ki,r22 |
||
2151 | 2156 1486 7093 0000 sts (Ki)+1,r23 |
||
2152 | 2157 148a 8093 0000 sts (Ki)+2,r24 |
||
2153 | 2158 148e 9093 0000 sts (Ki)+3,r25 |
||
2154 | 2159 1492 8091 0000 lds r24,EE_Parameter+19 |
||
2155 | 2160 1496 8093 0000 sts MAX_GAS,r24 |
||
2156 | 2161 149a 8091 0000 lds r24,EE_Parameter+18 |
||
2157 | 2162 149e 8093 0000 sts MIN_GAS,r24 |
||
2158 | 2163 /* epilogue: frame size=0 */ |
||
2159 | 2164 14a2 1F91 pop r17 |
||
2160 | 2165 14a4 0895 ret |
||
2161 | 2166 /* epilogue end (size=2) */ |
||
2162 | 2167 /* function ParameterZuordnung size 800 (797) */ |
||
2163 | 2169 .global SendMotorData |
||
2164 | 2171 SendMotorData: |
||
2165 | 2172 /* prologue: frame size=0 */ |
||
2166 | 2173 /* prologue end (size=0) */ |
||
2167 | 2174 14a6 8091 0000 lds r24,MotorenEin |
||
2168 | 2175 14aa 8823 tst r24 |
||
2169 | 2176 14ac 01F4 brne .L438 |
||
2170 | 2177 14ae 1092 0000 sts Motor_Hinten,__zero_reg__ |
||
2171 | 2178 14b2 1092 0000 sts Motor_Vorne,__zero_reg__ |
||
2172 | 2179 14b6 1092 0000 sts Motor_Rechts,__zero_reg__ |
||
2173 | 2180 14ba 1092 0000 sts Motor_Links,__zero_reg__ |
||
2174 | 2181 14be 8091 0000 lds r24,MotorTest |
||
2175 | 2182 14c2 8823 tst r24 |
||
2176 | 2183 14c4 01F0 breq .L440 |
||
2177 | 2184 14c6 8093 0000 sts Motor_Vorne,r24 |
||
2178 | 2185 .L440: |
||
2179 | 2186 14ca 8091 0000 lds r24,MotorTest+1 |
||
2180 | 2187 14ce 8823 tst r24 |
||
2181 | 2188 14d0 01F0 breq .L442 |
||
2182 | 2189 14d2 8093 0000 sts Motor_Hinten,r24 |
||
2183 | 2190 .L442: |
||
2184 | 2191 14d6 8091 0000 lds r24,MotorTest+2 |
||
2185 | 2192 14da 8823 tst r24 |
||
2186 | 2193 14dc 01F0 breq .L444 |
||
2187 | 2194 14de 8093 0000 sts Motor_Links,r24 |
||
2188 | 2195 .L444: |
||
2189 | 2196 14e2 8091 0000 lds r24,MotorTest+3 |
||
2190 | 2197 14e6 8823 tst r24 |
||
2191 | 2198 14e8 01F0 breq .L438 |
||
2192 | 2199 14ea 8093 0000 sts Motor_Rechts,r24 |
||
2193 | 2200 .L438: |
||
2194 | 2201 14ee 8091 0000 lds r24,Motor_Vorne |
||
2195 | 2202 14f2 9927 clr r25 |
||
2196 | 2203 14f4 9093 0000 sts (DebugOut+26)+1,r25 |
||
2197 | 2204 14f8 8093 0000 sts DebugOut+26,r24 |
||
2198 | 2205 14fc 8091 0000 lds r24,Motor_Hinten |
||
2199 | 2206 1500 9927 clr r25 |
||
2200 | 2207 1502 9093 0000 sts (DebugOut+28)+1,r25 |
||
2201 | 2208 1506 8093 0000 sts DebugOut+28,r24 |
||
2202 | 2209 150a 8091 0000 lds r24,Motor_Links |
||
2203 | 2210 150e 9927 clr r25 |
||
2204 | 2211 1510 9093 0000 sts (DebugOut+30)+1,r25 |
||
2205 | 2212 1514 8093 0000 sts DebugOut+30,r24 |
||
2206 | 2213 1518 8091 0000 lds r24,Motor_Rechts |
||
2207 | 2214 151c 9927 clr r25 |
||
2208 | 2215 151e 9093 0000 sts (DebugOut+32)+1,r25 |
||
2209 | 2216 1522 8093 0000 sts DebugOut+32,r24 |
||
2210 | 2217 1526 1092 0000 sts twi_state,__zero_reg__ |
||
2211 | 2218 152a 1092 0000 sts motor,__zero_reg__ |
||
2212 | 2219 152e 0E94 0000 call i2c_start |
||
2213 | 2220 /* epilogue: frame size=0 */ |
||
2214 | 2221 1532 0895 ret |
||
2215 | 2222 /* epilogue end (size=1) */ |
||
2216 | 2223 /* function SendMotorData size 71 (70) */ |
||
2217 | 2225 .global SetNeutral |
||
2218 | 2227 SetNeutral: |
||
2219 | 2228 /* prologue: frame size=0 */ |
||
2220 | 2229 /* prologue end (size=0) */ |
||
2221 | 2230 1534 1092 0000 sts (NeutralAccX)+1,__zero_reg__ |
||
2222 | 2231 1538 1092 0000 sts NeutralAccX,__zero_reg__ |
||
2223 | 2232 153c 1092 0000 sts (NeutralAccY)+1,__zero_reg__ |
||
2224 | 2233 1540 1092 0000 sts NeutralAccY,__zero_reg__ |
||
2225 | 2234 1544 80E0 ldi r24,lo8(0x0) |
||
2226 | 2235 1546 90E0 ldi r25,hi8(0x0) |
||
2227 | 2236 1548 A0E0 ldi r26,hlo8(0x0) |
||
2228 | 2237 154a B0E0 ldi r27,hhi8(0x0) |
||
2229 | 2238 154c 8093 0000 sts NeutralAccZ,r24 |
||
2230 | 2239 1550 9093 0000 sts (NeutralAccZ)+1,r25 |
||
2231 | 2240 1554 A093 0000 sts (NeutralAccZ)+2,r26 |
||
2232 | 2241 1558 B093 0000 sts (NeutralAccZ)+3,r27 |
||
2233 | 2242 155c 1092 0000 sts (AdNeutralNick)+1,__zero_reg__ |
||
2234 | 2243 1560 1092 0000 sts AdNeutralNick,__zero_reg__ |
||
2235 | 2244 1564 1092 0000 sts (AdNeutralRoll)+1,__zero_reg__ |
||
2236 | 2245 1568 1092 0000 sts AdNeutralRoll,__zero_reg__ |
||
2237 | 2246 156c 1092 0000 sts (AdNeutralGier)+1,__zero_reg__ |
||
2238 | 2247 1570 1092 0000 sts AdNeutralGier,__zero_reg__ |
||
2239 | 2248 1574 1092 0000 sts Parameter_AchsKopplung1,__zero_reg__ |
||
2240 | 2249 1578 1092 0000 sts Parameter_AchsGegenKopplung1,__zero_reg__ |
||
2241 | 2250 157c 0E94 0000 call CalibrierMittelwert |
||
2242 | 2251 1580 84E6 ldi r24,lo8(100) |
||
2243 | 2252 1582 90E0 ldi r25,hi8(100) |
||
2244 | 2253 1584 0E94 0000 call Delay_ms_Mess |
||
2245 | 2254 1588 0E94 0000 call CalibrierMittelwert |
||
2246 | 2255 158c 8091 0000 lds r24,EE_Parameter+8 |
||
2247 | 2256 1590 80FF sbrs r24,0 |
||
2248 | 2257 1592 00C0 rjmp .L449 |
||
2249 | 2258 1594 8091 0000 lds r24,MessLuftdruck |
||
2250 | 2259 1598 9091 0000 lds r25,(MessLuftdruck)+1 |
||
2251 | 2260 159c 875B subi r24,lo8(951) |
||
2252 | 2261 159e 9340 sbci r25,hi8(951) |
||
2253 | 2262 15a0 00F4 brsh .L451 |
||
2254 | 2263 15a2 8091 0000 lds r24,MessLuftdruck |
||
2255 | 2264 15a6 9091 0000 lds r25,(MessLuftdruck)+1 |
||
2256 | 2265 15aa 8E5E subi r24,lo8(750) |
||
2257 | 2266 15ac 9240 sbci r25,hi8(750) |
||
2258 | 2267 15ae 00F4 brsh .L449 |
||
2259 | 2268 .L451: |
||
2260 | 2269 15b0 0E94 0000 call SucheLuftruckOffset |
||
2261 | 2270 .L449: |
||
2262 | 2271 15b4 8091 0000 lds r24,AdWertNick |
||
2263 | 2272 15b8 9091 0000 lds r25,(AdWertNick)+1 |
||
2264 | 2273 15bc 9093 0000 sts (AdNeutralNick)+1,r25 |
||
2265 | 2274 15c0 8093 0000 sts AdNeutralNick,r24 |
||
2266 | 2275 15c4 8091 0000 lds r24,AdWertRoll |
||
2267 | 2276 15c8 9091 0000 lds r25,(AdWertRoll)+1 |
||
2268 | 2277 15cc 9093 0000 sts (AdNeutralRoll)+1,r25 |
||
2269 | 2278 15d0 8093 0000 sts AdNeutralRoll,r24 |
||
2270 | 2279 15d4 8091 0000 lds r24,AdWertGier |
||
2271 | 2280 15d8 9091 0000 lds r25,(AdWertGier)+1 |
||
2272 | 2281 15dc 9093 0000 sts (AdNeutralGier)+1,r25 |
||
2273 | 2282 15e0 8093 0000 sts AdNeutralGier,r24 |
||
2274 | 2283 15e4 8091 0000 lds r24,AdNeutralRoll |
||
2275 | 2284 15e8 9091 0000 lds r25,(AdNeutralRoll)+1 |
||
2276 | 2285 15ec 9093 0000 sts (StartNeutralRoll)+1,r25 |
||
2277 | 2286 15f0 8093 0000 sts StartNeutralRoll,r24 |
||
2278 | 2287 15f4 8091 0000 lds r24,AdNeutralNick |
||
2279 | 2288 15f8 9091 0000 lds r25,(AdNeutralNick)+1 |
||
2280 | 2289 15fc 9093 0000 sts (StartNeutralNick)+1,r25 |
||
2281 | 2290 1600 8093 0000 sts StartNeutralNick,r24 |
||
2282 | 2291 1604 40E0 ldi r20,lo8(EEPromArray+4) |
||
2283 | 2292 1606 50E0 ldi r21,hi8(EEPromArray+4) |
||
2284 | 2293 1608 DA01 movw r26,r20 |
||
2285 | 2294 /* #APP */ |
||
2286 | 2295 160a 0E94 0000 call __eeprom_read_byte_1F2021 |
||
2287 | 2296 160e 802D mov r24,__tmp_reg__ |
||
2288 | 2297 /* #NOAPP */ |
||
2289 | 2298 1610 8530 cpi r24,lo8(5) |
||
2290 | 2299 1612 00F0 brlo .L453 |
||
2291 | 2300 1614 8091 0000 lds r24,Mittelwert_AccRoll |
||
2292 | 2301 1618 9091 0000 lds r25,(Mittelwert_AccRoll)+1 |
||
2293 | 2302 161c 97FF sbrs r25,7 |
||
2294 | 2303 161e 00C0 rjmp .L455 |
||
2295 | 2304 1620 9095 com r25 |
||
2296 | 2305 1622 8195 neg r24 |
||
2297 | 2306 1624 9F4F sbci r25,lo8(-1) |
||
2298 | 2307 .L455: |
||
2299 | 2308 1626 6CE0 ldi r22,lo8(12) |
||
2300 | 2309 1628 70E0 ldi r23,hi8(12) |
||
2301 | 2310 162a 0E94 0000 call __divmodhi4 |
||
2302 | 2311 162e 7093 0000 sts (NeutralAccY)+1,r23 |
||
2303 | 2312 1632 6093 0000 sts NeutralAccY,r22 |
||
2304 | 2313 1636 8091 0000 lds r24,Mittelwert_AccNick |
||
2305 | 2314 163a 9091 0000 lds r25,(Mittelwert_AccNick)+1 |
||
2306 | 2315 163e 97FF sbrs r25,7 |
||
2307 | 2316 1640 00C0 rjmp .L456 |
||
2308 | 2317 1642 9095 com r25 |
||
2309 | 2318 1644 8195 neg r24 |
||
2310 | 2319 1646 9F4F sbci r25,lo8(-1) |
||
2311 | 2320 .L456: |
||
2312 | 2321 1648 6CE0 ldi r22,lo8(12) |
||
2313 | 2322 164a 70E0 ldi r23,hi8(12) |
||
2314 | 2323 164c 0E94 0000 call __divmodhi4 |
||
2315 | 2324 1650 7093 0000 sts (NeutralAccX)+1,r23 |
||
2316 | 2325 1654 6093 0000 sts NeutralAccX,r22 |
||
2317 | 2326 1658 6091 0000 lds r22,Aktuell_az |
||
2318 | 2327 165c 7091 0000 lds r23,(Aktuell_az)+1 |
||
2319 | 2328 1660 00C0 rjmp .L459 |
||
2320 | 2329 .L453: |
||
2321 | 2330 1662 DA01 movw r26,r20 |
||
2322 | 2331 /* #APP */ |
||
2323 | 2332 1664 0E94 0000 call __eeprom_read_byte_1F2021 |
||
2324 | 2333 1668 802D mov r24,__tmp_reg__ |
||
2325 | 2334 /* #NOAPP */ |
||
2326 | 2335 166a 4F5F subi r20,lo8(-(1)) |
||
2327 | 2336 166c 5F4F sbci r21,hi8(-(1)) |
||
2328 | 2337 166e DA01 movw r26,r20 |
||
2329 | 2338 /* #APP */ |
||
2330 | 2339 1670 0E94 0000 call __eeprom_read_byte_1F2021 |
||
2331 | 2340 1674 202D mov r18,__tmp_reg__ |
||
2332 | 2341 /* #NOAPP */ |
||
2333 | 2342 1676 9927 clr r25 |
||
2334 | 2343 1678 982F mov r25,r24 |
||
2335 | 2344 167a 8827 clr r24 |
||
2336 | 2345 167c 820F add r24,r18 |
||
2337 | 2346 167e 911D adc r25,__zero_reg__ |
||
2338 | 2347 1680 9093 0000 sts (NeutralAccX)+1,r25 |
||
2339 | 2348 1684 8093 0000 sts NeutralAccX,r24 |
||
2340 | 2349 1688 4F5F subi r20,lo8(-(1)) |
||
2341 | 2350 168a 5F4F sbci r21,hi8(-(1)) |
||
2342 | 2351 168c DA01 movw r26,r20 |
||
2343 | 2352 /* #APP */ |
||
2344 | 2353 168e 0E94 0000 call __eeprom_read_byte_1F2021 |
||
2345 | 2354 1692 802D mov r24,__tmp_reg__ |
||
2346 | 2355 /* #NOAPP */ |
||
2347 | 2356 1694 4F5F subi r20,lo8(-(1)) |
||
2348 | 2357 1696 5F4F sbci r21,hi8(-(1)) |
||
2349 | 2358 1698 DA01 movw r26,r20 |
||
2350 | 2359 /* #APP */ |
||
2351 | 2360 169a 0E94 0000 call __eeprom_read_byte_1F2021 |
||
2352 | 2361 169e 202D mov r18,__tmp_reg__ |
||
2353 | 2362 /* #NOAPP */ |
||
2354 | 2363 16a0 9927 clr r25 |
||
2355 | 2364 16a2 982F mov r25,r24 |
||
2356 | 2365 16a4 8827 clr r24 |
||
2357 | 2366 16a6 820F add r24,r18 |
||
2358 | 2367 16a8 911D adc r25,__zero_reg__ |
||
2359 | 2368 16aa 9093 0000 sts (NeutralAccY)+1,r25 |
||
2360 | 2369 16ae 8093 0000 sts NeutralAccY,r24 |
||
2361 | 2370 16b2 4F5F subi r20,lo8(-(1)) |
||
2362 | 2371 16b4 5F4F sbci r21,hi8(-(1)) |
||
2363 | 2372 16b6 DA01 movw r26,r20 |
||
2364 | 2373 /* #APP */ |
||
2365 | 2374 16b8 0E94 0000 call __eeprom_read_byte_1F2021 |
||
2366 | 2375 16bc 602D mov r22,__tmp_reg__ |
||
2367 | 2376 /* #NOAPP */ |
||
2368 | 2377 16be 4F5F subi r20,lo8(-(1)) |
||
2369 | 2378 16c0 5F4F sbci r21,hi8(-(1)) |
||
2370 | 2379 16c2 DA01 movw r26,r20 |
||
2371 | 2380 /* #APP */ |
||
2372 | 2381 16c4 0E94 0000 call __eeprom_read_byte_1F2021 |
||
2373 | 2382 16c8 202D mov r18,__tmp_reg__ |
||
2374 | 2383 /* #NOAPP */ |
||
2375 | 2384 16ca 7727 clr r23 |
||
2376 | 2385 16cc 762F mov r23,r22 |
||
2377 | 2386 16ce 6627 clr r22 |
||
2378 | 2387 16d0 620F add r22,r18 |
||
2379 | 2388 16d2 711D adc r23,__zero_reg__ |
||
2380 | 2389 .L459: |
||
2381 | 2390 16d4 8827 clr r24 |
||
2382 | 2391 16d6 77FD sbrc r23,7 |
||
2383 | 2392 16d8 8095 com r24 |
||
2384 | 2393 16da 982F mov r25,r24 |
||
2385 | 2394 16dc 0E94 0000 call __floatsisf |
||
2386 | 2395 16e0 6093 0000 sts NeutralAccZ,r22 |
||
2387 | 2396 16e4 7093 0000 sts (NeutralAccZ)+1,r23 |
||
2388 | 2397 16e8 8093 0000 sts (NeutralAccZ)+2,r24 |
||
2389 | 2398 16ec 9093 0000 sts (NeutralAccZ)+3,r25 |
||
2390 | 2399 16f0 1092 0000 sts Mess_IntegralNick,__zero_reg__ |
||
2391 | 2400 16f4 1092 0000 sts (Mess_IntegralNick)+1,__zero_reg__ |
||
2392 | 2401 16f8 1092 0000 sts (Mess_IntegralNick)+2,__zero_reg__ |
||
2393 | 2402 16fc 1092 0000 sts (Mess_IntegralNick)+3,__zero_reg__ |
||
2394 | 2403 1700 1092 0000 sts Mess_IntegralNick2,__zero_reg__ |
||
2395 | 2404 1704 1092 0000 sts (Mess_IntegralNick2)+1,__zero_reg__ |
||
2396 | 2405 1708 1092 0000 sts (Mess_IntegralNick2)+2,__zero_reg__ |
||
2397 | 2406 170c 1092 0000 sts (Mess_IntegralNick2)+3,__zero_reg__ |
||
2398 | 2407 1710 1092 0000 sts Mess_IntegralRoll,__zero_reg__ |
||
2399 | 2408 1714 1092 0000 sts (Mess_IntegralRoll)+1,__zero_reg__ |
||
2400 | 2409 1718 1092 0000 sts (Mess_IntegralRoll)+2,__zero_reg__ |
||
2401 | 2410 171c 1092 0000 sts (Mess_IntegralRoll)+3,__zero_reg__ |
||
2402 | 2411 1720 1092 0000 sts Mess_IntegralRoll2,__zero_reg__ |
||
2403 | 2412 1724 1092 0000 sts (Mess_IntegralRoll2)+1,__zero_reg__ |
||
2404 | 2413 1728 1092 0000 sts (Mess_IntegralRoll2)+2,__zero_reg__ |
||
2405 | 2414 172c 1092 0000 sts (Mess_IntegralRoll2)+3,__zero_reg__ |
||
2406 | 2415 1730 1092 0000 sts Mess_Integral_Gier,__zero_reg__ |
||
2407 | 2416 1734 1092 0000 sts (Mess_Integral_Gier)+1,__zero_reg__ |
||
2408 | 2417 1738 1092 0000 sts (Mess_Integral_Gier)+2,__zero_reg__ |
||
2409 | 2418 173c 1092 0000 sts (Mess_Integral_Gier)+3,__zero_reg__ |
||
2410 | 2419 1740 1092 0000 sts (MesswertNick)+1,__zero_reg__ |
||
2411 | 2420 1744 1092 0000 sts MesswertNick,__zero_reg__ |
||
2412 | 2421 1748 1092 0000 sts (MesswertRoll)+1,__zero_reg__ |
||
2413 | 2422 174c 1092 0000 sts MesswertRoll,__zero_reg__ |
||
2414 | 2423 1750 1092 0000 sts (MesswertGier)+1,__zero_reg__ |
||
2415 | 2424 1754 1092 0000 sts MesswertGier,__zero_reg__ |
||
2416 | 2425 1758 8091 0000 lds r24,Luftdruck |
||
2417 | 2426 175c 9091 0000 lds r25,(Luftdruck)+1 |
||
2418 | 2427 1760 A091 0000 lds r26,(Luftdruck)+2 |
||
2419 | 2428 1764 B091 0000 lds r27,(Luftdruck)+3 |
||
2420 | 2429 1768 9093 0000 sts (StartLuftdruck)+1,r25 |
||
2421 | 2430 176c 8093 0000 sts StartLuftdruck,r24 |
||
2422 | 2431 1770 1092 0000 sts (HoeheD)+1,__zero_reg__ |
||
2423 | 2432 1774 1092 0000 sts HoeheD,__zero_reg__ |
||
2424 | 2433 1778 1092 0000 sts Mess_Integral_Hoch,__zero_reg__ |
||
2425 | 2434 177c 1092 0000 sts (Mess_Integral_Hoch)+1,__zero_reg__ |
||
2426 | 2435 1780 1092 0000 sts (Mess_Integral_Hoch)+2,__zero_reg__ |
||
2427 | 2436 1784 1092 0000 sts (Mess_Integral_Hoch)+3,__zero_reg__ |
||
2428 | 2437 1788 8091 0000 lds r24,KompassValue |
||
2429 | 2438 178c 9091 0000 lds r25,(KompassValue)+1 |
||
2430 | 2439 1790 9093 0000 sts (KompassStartwert)+1,r25 |
||
2431 | 2440 1794 8093 0000 sts KompassStartwert,r24 |
||
2432 | 2441 1798 0E94 0000 call GPS_Neutral |
||
2433 | 2442 179c 82E3 ldi r24,lo8(50) |
||
2434 | 2443 179e 90E0 ldi r25,hi8(50) |
||
2435 | 2444 17a0 9093 0000 sts (beeptime)+1,r25 |
||
2436 | 2445 17a4 8093 0000 sts beeptime,r24 |
||
2437 | 2446 17a8 6091 0000 lds r22,EE_Parameter+43 |
||
2438 | 2447 17ac 7727 clr r23 |
||
2439 | 2448 17ae 8827 clr r24 |
||
2440 | 2449 17b0 9927 clr r25 |
||
2441 | 2450 17b2 24EC ldi r18,lo8(2500) |
||
2442 | 2451 17b4 39E0 ldi r19,hi8(2500) |
||
2443 | 2452 17b6 40E0 ldi r20,hlo8(2500) |
||
2444 | 2453 17b8 50E0 ldi r21,hhi8(2500) |
||
2445 | 2454 17ba 0E94 0000 call __mulsi3 |
||
2446 | 2455 17be 6093 0000 sts Umschlag180Nick,r22 |
||
2447 | 2456 17c2 7093 0000 sts (Umschlag180Nick)+1,r23 |
||
2448 | 2457 17c6 8093 0000 sts (Umschlag180Nick)+2,r24 |
||
2449 | 2458 17ca 9093 0000 sts (Umschlag180Nick)+3,r25 |
||
2450 | 2459 17ce 6091 0000 lds r22,EE_Parameter+44 |
||
2451 | 2460 17d2 7727 clr r23 |
||
2452 | 2461 17d4 8827 clr r24 |
||
2453 | 2462 17d6 9927 clr r25 |
||
2454 | 2463 17d8 0E94 0000 call __mulsi3 |
||
2455 | 2464 17dc 6093 0000 sts Umschlag180Roll,r22 |
||
2456 | 2465 17e0 7093 0000 sts (Umschlag180Roll)+1,r23 |
||
2457 | 2466 17e4 8093 0000 sts (Umschlag180Roll)+2,r24 |
||
2458 | 2467 17e8 9093 0000 sts (Umschlag180Roll)+3,r25 |
||
2459 | 2468 17ec 1092 0000 sts (ExternHoehenValue)+1,__zero_reg__ |
||
2460 | 2469 17f0 1092 0000 sts ExternHoehenValue,__zero_reg__ |
||
2461 | 2470 /* epilogue: frame size=0 */ |
||
2462 | 2471 17f4 0895 ret |
||
2463 | 2472 /* epilogue end (size=1) */ |
||
2464 | 2473 /* function SetNeutral size 362 (361) */ |
||
2465 | 2475 .global Piep |
||
2466 | 2477 Piep: |
||
2467 | 2478 /* prologue: frame size=0 */ |
||
2468 | 2479 17f6 1F93 push r17 |
||
2469 | 2480 /* prologue end (size=1) */ |
||
2470 | 2481 17f8 182F mov r17,r24 |
||
2471 | 2482 17fa 00C0 rjmp .L461 |
||
2472 | 2483 .L462: |
||
2473 | 2484 17fc 8091 0000 lds r24,MotorenEin |
||
2474 | 2485 1800 8823 tst r24 |
||
2475 | 2486 1802 01F4 brne .L465 |
||
2476 | 2487 1804 84E6 ldi r24,lo8(100) |
||
2477 | 2488 1806 90E0 ldi r25,hi8(100) |
||
2478 | 2489 1808 9093 0000 sts (beeptime)+1,r25 |
||
2479 | 2490 180c 8093 0000 sts beeptime,r24 |
||
2480 | 2491 1810 8AEF ldi r24,lo8(250) |
||
2481 | 2492 1812 90E0 ldi r25,hi8(250) |
||
2482 | 2493 1814 0E94 0000 call Delay_ms |
||
2483 | 2494 .L461: |
||
2484 | 2495 1818 1150 subi r17,1 |
||
2485 | 2496 181a 00F4 brcc .L462 |
||
2486 | 2497 .L465: |
||
2487 | 2498 /* epilogue: frame size=0 */ |
||
2488 | 2499 181c 1F91 pop r17 |
||
2489 | 2500 181e 0895 ret |
||
2490 | 2501 /* epilogue end (size=2) */ |
||
2491 | 2502 /* function Piep size 22 (19) */ |
||
2492 | 2504 .data |
||
2493 | 2505 .LC0: |
||
2494 | 2506 0000 4265 6769 .string "Beginner" |
||
2495 | 2506 6E6E 6572 |
||
2496 | 2506 00 |
||
2497 | 2507 0009 00 .string "" |
||
2498 | 2508 .text |
||
2499 | 2509 .global DefaultKonstanten3 |
||
2500 | 2511 DefaultKonstanten3: |
||
2501 | 2512 /* prologue: frame size=0 */ |
||
2502 | 2513 /* prologue end (size=0) */ |
||
2503 | 2514 1820 81E0 ldi r24,lo8(1) |
||
2504 | 2515 1822 8093 0000 sts EE_Parameter,r24 |
||
2505 | 2516 1826 62E0 ldi r22,lo8(2) |
||
2506 | 2517 1828 6093 0000 sts EE_Parameter+1,r22 |
||
2507 | 2518 182c 53E0 ldi r21,lo8(3) |
||
2508 | 2519 182e 5093 0000 sts EE_Parameter+2,r21 |
||
2509 | 2520 1832 E4E0 ldi r30,lo8(4) |
||
2510 | 2521 1834 E093 0000 sts EE_Parameter+3,r30 |
||
2511 | 2522 1838 75E0 ldi r23,lo8(5) |
||
2512 | 2523 183a 7093 0000 sts EE_Parameter+4,r23 |
||
2513 | 2524 183e 86E0 ldi r24,lo8(6) |
||
2514 | 2525 1840 8093 0000 sts EE_Parameter+5,r24 |
||
2515 | 2526 1844 87E0 ldi r24,lo8(7) |
||
2516 | 2527 1846 8093 0000 sts EE_Parameter+6,r24 |
||
2517 | 2528 184a 38E0 ldi r19,lo8(8) |
||
2518 | 2529 184c 3093 0000 sts EE_Parameter+7,r19 |
||
2519 | 2530 1850 81EC ldi r24,lo8(-63) |
||
2520 | 2531 1852 8093 0000 sts EE_Parameter+8,r24 |
||
2521 | 2532 1856 8EE1 ldi r24,lo8(30) |
||
2522 | 2533 1858 8093 0000 sts EE_Parameter+9,r24 |
||
2523 | 2534 185c 24E6 ldi r18,lo8(100) |
||
2524 | 2535 185e 2093 0000 sts EE_Parameter+11,r18 |
||
2525 | 2536 1862 4AE0 ldi r20,lo8(10) |
||
2526 | 2537 1864 4093 0000 sts EE_Parameter+12,r20 |
||
2527 | 2538 1868 92E3 ldi r25,lo8(50) |
||
2528 | 2539 186a 9093 0000 sts EE_Parameter+10,r25 |
||
2529 | 2540 186e 9093 0000 sts EE_Parameter+14,r25 |
||
2530 | 2541 1872 6093 0000 sts EE_Parameter+13,r22 |
||
2531 | 2542 1876 5093 0000 sts EE_Parameter+15,r21 |
||
2532 | 2543 187a 1092 0000 sts EE_Parameter+16,__zero_reg__ |
||
2533 | 2544 187e 3093 0000 sts EE_Parameter+17,r19 |
||
2534 | 2545 1882 8FE0 ldi r24,lo8(15) |
||
2535 | 2546 1884 8093 0000 sts EE_Parameter+18,r24 |
||
2536 | 2547 1888 8AEF ldi r24,lo8(-6) |
||
2537 | 2548 188a 8093 0000 sts EE_Parameter+19,r24 |
||
2538 | 2549 188e 8AE1 ldi r24,lo8(26) |
||
2539 | 2550 1890 8093 0000 sts EE_Parameter+20,r24 |
||
2540 | 2551 1894 80E8 ldi r24,lo8(-128) |
||
2541 | 2552 1896 8093 0000 sts EE_Parameter+21,r24 |
||
2542 | 2553 189a 88EC ldi r24,lo8(-56) |
||
2543 | 2554 189c 8093 0000 sts EE_Parameter+22,r24 |
||
2544 | 2555 18a0 8FEA ldi r24,lo8(-81) |
||
2545 | 2556 18a2 8093 0000 sts EE_Parameter+23,r24 |
||
2546 | 2557 18a6 8EE5 ldi r24,lo8(94) |
||
2547 | 2558 18a8 8093 0000 sts EE_Parameter+24,r24 |
||
2548 | 2559 18ac 83E2 ldi r24,lo8(35) |
||
2549 | 2560 18ae 8093 0000 sts EE_Parameter+25,r24 |
||
2550 | 2561 18b2 84E1 ldi r24,lo8(20) |
||
2551 | 2562 18b4 8093 0000 sts EE_Parameter+26,r24 |
||
2552 | 2563 18b8 1092 0000 sts EE_Parameter+27,__zero_reg__ |
||
2553 | 2564 18bc 4093 0000 sts EE_Parameter+28,r20 |
||
2554 | 2565 18c0 80E5 ldi r24,lo8(80) |
||
2555 | 2566 18c2 8093 0000 sts EE_Parameter+29,r24 |
||
2556 | 2567 18c6 1092 0000 sts EE_Parameter+30,__zero_reg__ |
||
2557 | 2568 18ca 1092 0000 sts EE_Parameter+31,__zero_reg__ |
||
2558 | 2569 18ce 1092 0000 sts EE_Parameter+32,__zero_reg__ |
||
2559 | 2570 18d2 1092 0000 sts EE_Parameter+48,__zero_reg__ |
||
2560 | 2571 18d6 1092 0000 sts EE_Parameter+49,__zero_reg__ |
||
2561 | 2572 18da 1092 0000 sts EE_Parameter+50,__zero_reg__ |
||
2562 | 2573 18de 1092 0000 sts EE_Parameter+51,__zero_reg__ |
||
2563 | 2574 18e2 2093 0000 sts EE_Parameter+33,r18 |
||
2564 | 2575 18e6 88E2 ldi r24,lo8(40) |
||
2565 | 2576 18e8 8093 0000 sts EE_Parameter+34,r24 |
||
2566 | 2577 18ec 1092 0000 sts EE_Parameter+53,__zero_reg__ |
||
2567 | 2578 18f0 9093 0000 sts EE_Parameter+35,r25 |
||
2568 | 2579 18f4 86E9 ldi r24,lo8(-106) |
||
2569 | 2580 18f6 8093 0000 sts EE_Parameter+36,r24 |
||
2570 | 2581 18fa 7093 0000 sts EE_Parameter+37,r23 |
||
2571 | 2582 18fe 9093 0000 sts EE_Parameter+38,r25 |
||
2572 | 2583 1902 8AE5 ldi r24,lo8(90) |
||
2573 | 2584 1904 8093 0000 sts EE_Parameter+39,r24 |
||
2574 | 2585 1908 9093 0000 sts EE_Parameter+40,r25 |
||
2575 | 2586 190c 1092 0000 sts EE_Parameter+52,__zero_reg__ |
||
2576 | 2587 1910 2093 0000 sts EE_Parameter+41,r18 |
||
2577 | 2588 1914 4093 0000 sts EE_Parameter+42,r20 |
||
2578 | 2589 1918 2093 0000 sts EE_Parameter+43,r18 |
||
2579 | 2590 191c 2093 0000 sts EE_Parameter+44,r18 |
||
2580 | 2591 1920 2093 0000 sts EE_Parameter+45,r18 |
||
2581 | 2592 1924 E093 0000 sts EE_Parameter+46,r30 |
||
2582 | 2593 1928 9093 0000 sts EE_Parameter+47,r25 |
||
2583 | 2594 192c A0E0 ldi r26,lo8(EE_Parameter+58) |
||
2584 | 2595 192e B0E0 ldi r27,hi8(EE_Parameter+58) |
||
2585 | 2596 1930 E0E0 ldi r30,lo8(.LC0) |
||
2586 | 2597 1932 F0E0 ldi r31,hi8(.LC0) |
||
2587 | 2598 1934 8CE0 ldi r24,lo8(12) |
||
2588 | 2599 .L467: |
||
2589 | 2600 1936 0190 ld r0,Z+ |
||
2590 | 2601 1938 0D92 st X+,r0 |
||
2591 | 2602 193a 8150 subi r24,lo8(-(-1)) |
||
2592 | 2603 193c 01F4 brne .L467 |
||
2593 | 2604 /* epilogue: frame size=0 */ |
||
2594 | 2605 193e 0895 ret |
||
2595 | 2606 /* epilogue end (size=1) */ |
||
2596 | 2607 /* function DefaultKonstanten3 size 145 (144) */ |
||
2597 | 2609 .data |
||
2598 | 2610 .LC1: |
||
2599 | 2611 000a 4E6F 726D .string "Normal" |
||
2600 | 2611 616C 00 |
||
2601 | 2612 0011 00 .string "" |
||
2602 | 2613 .text |
||
2603 | 2614 .global DefaultKonstanten2 |
||
2604 | 2616 DefaultKonstanten2: |
||
2605 | 2617 /* prologue: frame size=0 */ |
||
2606 | 2618 /* prologue end (size=0) */ |
||
2607 | 2619 1940 81E0 ldi r24,lo8(1) |
||
2608 | 2620 1942 8093 0000 sts EE_Parameter,r24 |
||
2609 | 2621 1946 92E0 ldi r25,lo8(2) |
||
2610 | 2622 1948 9093 0000 sts EE_Parameter+1,r25 |
||
2611 | 2623 194c 83E0 ldi r24,lo8(3) |
||
2612 | 2624 194e 8093 0000 sts EE_Parameter+2,r24 |
||
2613 | 2625 1952 44E0 ldi r20,lo8(4) |
||
2614 | 2626 1954 4093 0000 sts EE_Parameter+3,r20 |
||
2615 | 2627 1958 55E0 ldi r21,lo8(5) |
||
2616 | 2628 195a 5093 0000 sts EE_Parameter+4,r21 |
||
2617 | 2629 195e 86E0 ldi r24,lo8(6) |
||
2618 | 2630 1960 8093 0000 sts EE_Parameter+5,r24 |
||
2619 | 2631 1964 87E0 ldi r24,lo8(7) |
||
2620 | 2632 1966 8093 0000 sts EE_Parameter+6,r24 |
||
2621 | 2633 196a 88E0 ldi r24,lo8(8) |
||
2622 | 2634 196c 8093 0000 sts EE_Parameter+7,r24 |
||
2623 | 2635 1970 80E4 ldi r24,lo8(64) |
||
2624 | 2636 1972 8093 0000 sts EE_Parameter+8,r24 |
||
2625 | 2637 1976 8EE1 ldi r24,lo8(30) |
||
2626 | 2638 1978 8093 0000 sts EE_Parameter+9,r24 |
||
2627 | 2639 197c 8BEF ldi r24,lo8(-5) |
||
2628 | 2640 197e 8093 0000 sts EE_Parameter+11,r24 |
||
2629 | 2641 1982 3AE0 ldi r19,lo8(10) |
||
2630 | 2642 1984 3093 0000 sts EE_Parameter+12,r19 |
||
2631 | 2643 1988 22E3 ldi r18,lo8(50) |
||
2632 | 2644 198a 2093 0000 sts EE_Parameter+10,r18 |
||
2633 | 2645 198e 2093 0000 sts EE_Parameter+14,r18 |
||
2634 | 2646 1992 9093 0000 sts EE_Parameter+13,r25 |
||
2635 | 2647 1996 4093 0000 sts EE_Parameter+15,r20 |
||
2636 | 2648 199a 1092 0000 sts EE_Parameter+16,__zero_reg__ |
||
2637 | 2649 199e 3093 0000 sts EE_Parameter+17,r19 |
||
2638 | 2650 19a2 8FE0 ldi r24,lo8(15) |
||
2639 | 2651 19a4 8093 0000 sts EE_Parameter+18,r24 |
||
2640 | 2652 19a8 8AEF ldi r24,lo8(-6) |
||
2641 | 2653 19aa 8093 0000 sts EE_Parameter+19,r24 |
||
2642 | 2654 19ae 8AE1 ldi r24,lo8(26) |
||
2643 | 2655 19b0 8093 0000 sts EE_Parameter+20,r24 |
||
2644 | 2656 19b4 80E8 ldi r24,lo8(-128) |
||
2645 | 2657 19b6 8093 0000 sts EE_Parameter+21,r24 |
||
2646 | 2658 19ba 8FEA ldi r24,lo8(-81) |
||
2647 | 2659 19bc 8093 0000 sts EE_Parameter+22,r24 |
||
2648 | 2660 19c0 8093 0000 sts EE_Parameter+23,r24 |
||
2649 | 2661 19c4 8EE5 ldi r24,lo8(94) |
||
2650 | 2662 19c6 8093 0000 sts EE_Parameter+24,r24 |
||
2651 | 2663 19ca 83E2 ldi r24,lo8(35) |
||
2652 | 2664 19cc 8093 0000 sts EE_Parameter+25,r24 |
||
2653 | 2665 19d0 84E1 ldi r24,lo8(20) |
||
2654 | 2666 19d2 8093 0000 sts EE_Parameter+26,r24 |
||
2655 | 2667 19d6 1092 0000 sts EE_Parameter+27,__zero_reg__ |
||
2656 | 2668 19da 80E2 ldi r24,lo8(32) |
||
2657 | 2669 19dc 8093 0000 sts EE_Parameter+28,r24 |
||
2658 | 2670 19e0 80E5 ldi r24,lo8(80) |
||
2659 | 2671 19e2 8093 0000 sts EE_Parameter+29,r24 |
||
2660 | 2672 19e6 1092 0000 sts EE_Parameter+30,__zero_reg__ |
||
2661 | 2673 19ea 1092 0000 sts EE_Parameter+31,__zero_reg__ |
||
2662 | 2674 19ee 1092 0000 sts EE_Parameter+32,__zero_reg__ |
||
2663 | 2675 19f2 1092 0000 sts EE_Parameter+48,__zero_reg__ |
||
2664 | 2676 19f6 1092 0000 sts EE_Parameter+49,__zero_reg__ |
||
2665 | 2677 19fa 1092 0000 sts EE_Parameter+50,__zero_reg__ |
||
2666 | 2678 19fe 1092 0000 sts EE_Parameter+51,__zero_reg__ |
||
2667 | 2679 1a02 94E6 ldi r25,lo8(100) |
||
2668 | 2680 1a04 9093 0000 sts EE_Parameter+33,r25 |
||
2669 | 2681 1a08 88E2 ldi r24,lo8(40) |
||
2670 | 2682 1a0a 8093 0000 sts EE_Parameter+34,r24 |
||
2671 | 2683 1a0e 1092 0000 sts EE_Parameter+53,__zero_reg__ |
||
2672 | 2684 1a12 2093 0000 sts EE_Parameter+35,r18 |
||
2673 | 2685 1a16 86E9 ldi r24,lo8(-106) |
||
2674 | 2686 1a18 8093 0000 sts EE_Parameter+36,r24 |
||
2675 | 2687 1a1c 5093 0000 sts EE_Parameter+37,r21 |
||
2676 | 2688 1a20 2093 0000 sts EE_Parameter+38,r18 |
||
2677 | 2689 1a24 8AE5 ldi r24,lo8(90) |
||
2678 | 2690 1a26 8093 0000 sts EE_Parameter+39,r24 |
||
2679 | 2691 1a2a 2093 0000 sts EE_Parameter+40,r18 |
||
2680 | 2692 1a2e 1092 0000 sts EE_Parameter+52,__zero_reg__ |
||
2681 | 2693 1a32 9093 0000 sts EE_Parameter+41,r25 |
||
2682 | 2694 1a36 3093 0000 sts EE_Parameter+42,r19 |
||
2683 | 2695 1a3a 9093 0000 sts EE_Parameter+43,r25 |
||
2684 | 2696 1a3e 9093 0000 sts EE_Parameter+44,r25 |
||
2685 | 2697 1a42 9093 0000 sts EE_Parameter+45,r25 |
||
2686 | 2698 1a46 4093 0000 sts EE_Parameter+46,r20 |
||
2687 | 2699 1a4a 8BE4 ldi r24,lo8(75) |
||
2688 | 2700 1a4c 8093 0000 sts EE_Parameter+47,r24 |
||
2689 | 2701 1a50 A0E0 ldi r26,lo8(EE_Parameter+58) |
||
2690 | 2702 1a52 B0E0 ldi r27,hi8(EE_Parameter+58) |
||
2691 | 2703 1a54 E0E0 ldi r30,lo8(.LC1) |
||
2692 | 2704 1a56 F0E0 ldi r31,hi8(.LC1) |
||
2693 | 2705 1a58 8CE0 ldi r24,lo8(12) |
||
2694 | 2706 .L472: |
||
2695 | 2707 1a5a 0190 ld r0,Z+ |
||
2696 | 2708 1a5c 0D92 st X+,r0 |
||
2697 | 2709 1a5e 8150 subi r24,lo8(-(-1)) |
||
2698 | 2710 1a60 01F4 brne .L472 |
||
2699 | 2711 /* epilogue: frame size=0 */ |
||
2700 | 2712 1a62 0895 ret |
||
2701 | 2713 /* epilogue end (size=1) */ |
||
2702 | 2714 /* function DefaultKonstanten2 size 147 (146) */ |
||
2703 | 2716 .data |
||
2704 | 2717 .LC2: |
||
2705 | 2718 0012 5370 6F72 .string "Sport" |
||
2706 | 2718 7400 |
||
2707 | 2719 0018 00 .string "" |
||
2708 | 2720 .text |
||
2709 | 2721 .global DefaultKonstanten1 |
||
2710 | 2723 DefaultKonstanten1: |
||
2711 | 2724 /* prologue: frame size=0 */ |
||
2712 | 2725 /* prologue end (size=0) */ |
||
2713 | 2726 1a64 81E0 ldi r24,lo8(1) |
||
2714 | 2727 1a66 8093 0000 sts EE_Parameter,r24 |
||
2715 | 2728 1a6a 82E0 ldi r24,lo8(2) |
||
2716 | 2729 1a6c 8093 0000 sts EE_Parameter+1,r24 |
||
2717 | 2730 1a70 83E0 ldi r24,lo8(3) |
||
2718 | 2731 1a72 8093 0000 sts EE_Parameter+2,r24 |
||
2719 | 2732 1a76 34E0 ldi r19,lo8(4) |
||
2720 | 2733 1a78 3093 0000 sts EE_Parameter+3,r19 |
||
2721 | 2734 1a7c 65E0 ldi r22,lo8(5) |
||
2722 | 2735 1a7e 6093 0000 sts EE_Parameter+4,r22 |
||
2723 | 2736 1a82 86E0 ldi r24,lo8(6) |
||
2724 | 2737 1a84 8093 0000 sts EE_Parameter+5,r24 |
||
2725 | 2738 1a88 87E0 ldi r24,lo8(7) |
||
2726 | 2739 1a8a 8093 0000 sts EE_Parameter+6,r24 |
||
2727 | 2740 1a8e 98E0 ldi r25,lo8(8) |
||
2728 | 2741 1a90 9093 0000 sts EE_Parameter+7,r25 |
||
2729 | 2742 1a94 80E4 ldi r24,lo8(64) |
||
2730 | 2743 1a96 8093 0000 sts EE_Parameter+8,r24 |
||
2731 | 2744 1a9a 8EE1 ldi r24,lo8(30) |
||
2732 | 2745 1a9c 8093 0000 sts EE_Parameter+9,r24 |
||
2733 | 2746 1aa0 8BEF ldi r24,lo8(-5) |
||
2734 | 2747 1aa2 8093 0000 sts EE_Parameter+11,r24 |
||
2735 | 2748 1aa6 5AE0 ldi r21,lo8(10) |
||
2736 | 2749 1aa8 5093 0000 sts EE_Parameter+12,r21 |
||
2737 | 2750 1aac 22E3 ldi r18,lo8(50) |
||
2738 | 2751 1aae 2093 0000 sts EE_Parameter+10,r18 |
||
2739 | 2752 1ab2 2093 0000 sts EE_Parameter+14,r18 |
||
2740 | 2753 1ab6 3093 0000 sts EE_Parameter+13,r19 |
||
2741 | 2754 1aba 3093 0000 sts EE_Parameter+15,r19 |
||
2742 | 2755 1abe 9093 0000 sts EE_Parameter+16,r25 |
||
2743 | 2756 1ac2 8EE0 ldi r24,lo8(14) |
||
2744 | 2757 1ac4 8093 0000 sts EE_Parameter+17,r24 |
||
2745 | 2758 1ac8 8FE0 ldi r24,lo8(15) |
||
2746 | 2759 1aca 8093 0000 sts EE_Parameter+18,r24 |
||
2747 | 2760 1ace 8AEF ldi r24,lo8(-6) |
||
2748 | 2761 1ad0 8093 0000 sts EE_Parameter+19,r24 |
||
2749 | 2762 1ad4 8AE1 ldi r24,lo8(26) |
||
2750 | 2763 1ad6 8093 0000 sts EE_Parameter+20,r24 |
||
2751 | 2764 1ada 90E8 ldi r25,lo8(-128) |
||
2752 | 2765 1adc 9093 0000 sts EE_Parameter+21,r25 |
||
2753 | 2766 1ae0 88E7 ldi r24,lo8(120) |
||
2754 | 2767 1ae2 8093 0000 sts EE_Parameter+22,r24 |
||
2755 | 2768 1ae6 46E9 ldi r20,lo8(-106) |
||
2756 | 2769 1ae8 4093 0000 sts EE_Parameter+23,r20 |
||
2757 | 2770 1aec 8EE5 ldi r24,lo8(94) |
||
2758 | 2771 1aee 8093 0000 sts EE_Parameter+24,r24 |
||
2759 | 2772 1af2 83E2 ldi r24,lo8(35) |
||
2760 | 2773 1af4 8093 0000 sts EE_Parameter+25,r24 |
||
2761 | 2774 1af8 84E1 ldi r24,lo8(20) |
||
2762 | 2775 1afa 8093 0000 sts EE_Parameter+26,r24 |
||
2763 | 2776 1afe 1092 0000 sts EE_Parameter+27,__zero_reg__ |
||
2764 | 2777 1b02 80E2 ldi r24,lo8(32) |
||
2765 | 2778 1b04 8093 0000 sts EE_Parameter+28,r24 |
||
2766 | 2779 1b08 9093 0000 sts EE_Parameter+29,r25 |
||
2767 | 2780 1b0c 1092 0000 sts EE_Parameter+30,__zero_reg__ |
||
2768 | 2781 1b10 1092 0000 sts EE_Parameter+31,__zero_reg__ |
||
2769 | 2782 1b14 1092 0000 sts EE_Parameter+32,__zero_reg__ |
||
2770 | 2783 1b18 1092 0000 sts EE_Parameter+48,__zero_reg__ |
||
2771 | 2784 1b1c 1092 0000 sts EE_Parameter+49,__zero_reg__ |
||
2772 | 2785 1b20 1092 0000 sts EE_Parameter+50,__zero_reg__ |
||
2773 | 2786 1b24 1092 0000 sts EE_Parameter+51,__zero_reg__ |
||
2774 | 2787 1b28 94E6 ldi r25,lo8(100) |
||
2775 | 2788 1b2a 9093 0000 sts EE_Parameter+33,r25 |
||
2776 | 2789 1b2e 88E2 ldi r24,lo8(40) |
||
2777 | 2790 1b30 8093 0000 sts EE_Parameter+34,r24 |
||
2778 | 2791 1b34 1092 0000 sts EE_Parameter+53,__zero_reg__ |
||
2779 | 2792 1b38 2093 0000 sts EE_Parameter+35,r18 |
||
2780 | 2793 1b3c 4093 0000 sts EE_Parameter+36,r20 |
||
2781 | 2794 1b40 6093 0000 sts EE_Parameter+37,r22 |
||
2782 | 2795 1b44 2093 0000 sts EE_Parameter+38,r18 |
||
2783 | 2796 1b48 8AE5 ldi r24,lo8(90) |
||
2784 | 2797 1b4a 8093 0000 sts EE_Parameter+39,r24 |
||
2785 | 2798 1b4e 2093 0000 sts EE_Parameter+40,r18 |
||
2786 | 2799 1b52 1092 0000 sts EE_Parameter+52,__zero_reg__ |
||
2787 | 2800 1b56 9093 0000 sts EE_Parameter+41,r25 |
||
2788 | 2801 1b5a 5093 0000 sts EE_Parameter+42,r21 |
||
2789 | 2802 1b5e 9093 0000 sts EE_Parameter+43,r25 |
||
2790 | 2803 1b62 9093 0000 sts EE_Parameter+44,r25 |
||
2791 | 2804 1b66 2093 0000 sts EE_Parameter+45,r18 |
||
2792 | 2805 1b6a 3093 0000 sts EE_Parameter+46,r19 |
||
2793 | 2806 1b6e 9093 0000 sts EE_Parameter+47,r25 |
||
2794 | 2807 1b72 A0E0 ldi r26,lo8(EE_Parameter+58) |
||
2795 | 2808 1b74 B0E0 ldi r27,hi8(EE_Parameter+58) |
||
2796 | 2809 1b76 E0E0 ldi r30,lo8(.LC2) |
||
2797 | 2810 1b78 F0E0 ldi r31,hi8(.LC2) |
||
2798 | 2811 1b7a 8CE0 ldi r24,lo8(12) |
||
2799 | 2812 .L477: |
||
2800 | 2813 1b7c 0190 ld r0,Z+ |
||
2801 | 2814 1b7e 0D92 st X+,r0 |
||
2802 | 2815 1b80 8150 subi r24,lo8(-(-1)) |
||
2803 | 2816 1b82 01F4 brne .L477 |
||
2804 | 2817 /* epilogue: frame size=0 */ |
||
2805 | 2818 1b84 0895 ret |
||
2806 | 2819 /* epilogue end (size=1) */ |
||
2807 | 2820 /* function DefaultKonstanten1 size 146 (145) */ |
||
2808 | 2822 .global MotorRegler |
||
2809 | 2824 MotorRegler: |
||
2810 | 2825 /* prologue: frame size=26 */ |
||
2811 | 2826 1b86 2F92 push r2 |
||
2812 | 2827 1b88 3F92 push r3 |
||
2813 | 2828 1b8a 4F92 push r4 |
||
2814 | 2829 1b8c 5F92 push r5 |
||
2815 | 2830 1b8e 6F92 push r6 |
||
2816 | 2831 1b90 7F92 push r7 |
||
2817 | 2832 1b92 8F92 push r8 |
||
2818 | 2833 1b94 9F92 push r9 |
||
2819 | 2834 1b96 AF92 push r10 |
||
2820 | 2835 1b98 BF92 push r11 |
||
2821 | 2836 1b9a CF92 push r12 |
||
2822 | 2837 1b9c DF92 push r13 |
||
2823 | 2838 1b9e EF92 push r14 |
||
2824 | 2839 1ba0 FF92 push r15 |
||
2825 | 2840 1ba2 0F93 push r16 |
||
2826 | 2841 1ba4 1F93 push r17 |
||
2827 | 2842 1ba6 CF93 push r28 |
||
2828 | 2843 1ba8 DF93 push r29 |
||
2829 | 2844 1baa CDB7 in r28,__SP_L__ |
||
2830 | 2845 1bac DEB7 in r29,__SP_H__ |
||
2831 | 2846 1bae 6A97 sbiw r28,26 |
||
2832 | 2847 1bb0 0FB6 in __tmp_reg__,__SREG__ |
||
2833 | 2848 1bb2 F894 cli |
||
2834 | 2849 1bb4 DEBF out __SP_H__,r29 |
||
2835 | 2850 1bb6 0FBE out __SREG__,__tmp_reg__ |
||
2836 | 2851 1bb8 CDBF out __SP_L__,r28 |
||
2837 | 2852 /* prologue end (size=26) */ |
||
2838 | 2853 1bba 0E94 0000 call Mittelwert |
||
2839 | 2854 1bbe 299A sbi 37-0x20,1 |
||
2840 | 2855 1bc0 E091 0000 lds r30,EE_Parameter+2 |
||
2841 | 2856 1bc4 FF27 clr r31 |
||
2842 | 2857 1bc6 EE0F lsl r30 |
||
2843 | 2858 1bc8 FF1F rol r31 |
||
2844 | 2859 1bca E050 subi r30,lo8(-(PPM_in)) |
||
2845 | 2860 1bcc F040 sbci r31,hi8(-(PPM_in)) |
||
2846 | 2861 1bce 0190 ld __tmp_reg__,Z+ |
||
2847 | 2862 1bd0 F081 ld r31,Z |
||
2848 | 2863 1bd2 E02D mov r30,__tmp_reg__ |
||
2849 | 2864 1bd4 E858 subi r30,lo8(-(120)) |
||
2850 | 2865 1bd6 FF4F sbci r31,hi8(-(120)) |
||
2851 | 2866 1bd8 8091 0000 lds r24,Parameter_UserParam2 |
||
2852 | 2867 1bdc 8B30 cpi r24,lo8(11) |
||
2853 | 2868 1bde 00F0 brlo .L482 |
||
2854 | 2869 1be0 8091 0000 lds r24,ControlIn+6 |
||
2855 | 2870 1be4 9091 0000 lds r25,(ControlIn+6)+1 |
||
2856 | 2871 1be8 E80F add r30,r24 |
||
2857 | 2872 1bea F91F adc r31,r25 |
||
2858 | 2873 .L482: |
||
2859 | 2874 1bec 8091 0000 lds r24,MAX_GAS |
||
2860 | 2875 1bf0 9927 clr r25 |
||
2861 | 2876 1bf2 4497 sbiw r24,20 |
||
2862 | 2877 1bf4 E817 cp r30,r24 |
||
2863 | 2878 1bf6 F907 cpc r31,r25 |
||
2864 | 2879 1bf8 04F4 brge .L484 |
||
2865 | 2880 1bfa CF01 movw r24,r30 |
||
2866 | 2881 .L484: |
||
2867 | 2882 1bfc 9A83 std Y+2,r25 |
||
2868 | 2883 1bfe 8983 std Y+1,r24 |
||
2869 | 2884 1c00 97FF sbrs r25,7 |
||
2870 | 2885 1c02 00C0 rjmp .L485 |
||
2871 | 2886 1c04 1A82 std Y+2,__zero_reg__ |
||
2872 | 2887 1c06 1982 std Y+1,__zero_reg__ |
||
2873 | 2888 .L485: |
||
2874 | 2889 1c08 8091 0000 lds r24,SenderOkay |
||
2875 | 2890 1c0c 8436 cpi r24,lo8(100) |
||
2876 | 2891 1c0e 00F0 brlo .+2 |
||
2877 | 2892 1c10 00C0 rjmp .L486 |
||
2878 | 2893 1c12 8091 0000 lds r24,PcZugriff |
||
2879 | 2894 1c16 8823 tst r24 |
||
2880 | 2895 1c18 01F4 brne .L488 |
||
2881 | 2896 1c1a 8091 0000 lds r24,BeepMuster |
||
2882 | 2897 1c1e 9091 0000 lds r25,(BeepMuster)+1 |
||
2883 | 2898 1c22 8F5F subi r24,lo8(-1) |
||
2884 | 2899 1c24 9F4F sbci r25,hi8(-1) |
||
2885 | 2900 1c26 01F4 brne .L488 |
||
2886 | 2901 1c28 88E9 ldi r24,lo8(15000) |
||
2887 | 2902 1c2a 9AE3 ldi r25,hi8(15000) |
||
2888 | 2903 1c2c 9093 0000 sts (beeptime)+1,r25 |
||
2889 | 2904 1c30 8093 0000 sts beeptime,r24 |
||
2890 | 2905 1c34 80E0 ldi r24,lo8(3072) |
||
2891 | 2906 1c36 9CE0 ldi r25,hi8(3072) |
||
2892 | 2907 1c38 9093 0000 sts (BeepMuster)+1,r25 |
||
2893 | 2908 1c3c 8093 0000 sts BeepMuster,r24 |
||
2894 | 2909 .L488: |
||
2895 | 2910 1c40 8091 0000 lds r24,RcLostTimer.2576 |
||
2896 | 2911 1c44 9091 0000 lds r25,(RcLostTimer.2576)+1 |
||
2897 | 2912 1c48 0097 sbiw r24,0 |
||
2898 | 2913 1c4a 01F0 breq .L491 |
||
2899 | 2914 1c4c 0197 sbiw r24,1 |
||
2900 | 2915 1c4e 9093 0000 sts (RcLostTimer.2576)+1,r25 |
||
2901 | 2916 1c52 8093 0000 sts RcLostTimer.2576,r24 |
||
2902 | 2917 1c56 00C0 rjmp .L493 |
||
2903 | 2918 .L491: |
||
2904 | 2919 1c58 1092 0000 sts MotorenEin,__zero_reg__ |
||
2905 | 2920 1c5c 1092 0000 sts Notlandung,__zero_reg__ |
||
2906 | 2921 .L493: |
||
2907 | 2922 1c60 8091 0000 lds r24,PlatinenVersion |
||
2908 | 2923 1c64 8A30 cpi r24,lo8(10) |
||
2909 | 2924 1c66 01F4 brne .L494 |
||
2910 | 2925 1c68 289A sbi 37-0x20,0 |
||
2911 | 2926 1c6a 00C0 rjmp .L496 |
||
2912 | 2927 .L494: |
||
2913 | 2928 1c6c 2898 cbi 37-0x20,0 |
||
2914 | 2929 .L496: |
||
2915 | 2930 1c6e 8091 0000 lds r24,modell_fliegt.2580 |
||
2916 | 2931 1c72 9091 0000 lds r25,(modell_fliegt.2580)+1 |
||
2917 | 2932 1c76 815D subi r24,lo8(2001) |
||
2918 | 2933 1c78 9740 sbci r25,hi8(2001) |
||
2919 | 2934 1c7a 00F0 brlo .L497 |
||
2920 | 2935 1c7c 8091 0000 lds r24,EE_Parameter+25 |
||
2921 | 2936 1c80 482F mov r20,r24 |
||
2922 | 2937 1c82 5527 clr r21 |
||
2923 | 2938 1c84 5A83 std Y+2,r21 |
||
2924 | 2939 1c86 4983 std Y+1,r20 |
||
2925 | 2940 1c88 81E0 ldi r24,lo8(1) |
||
2926 | 2941 1c8a 8093 0000 sts Notlandung,r24 |
||
2927 | 2942 1c8e E091 0000 lds r30,EE_Parameter |
||
2928 | 2943 1c92 FF27 clr r31 |
||
2929 | 2944 1c94 EE0F lsl r30 |
||
2930 | 2945 1c96 FF1F rol r31 |
||
2931 | 2946 1c98 E050 subi r30,lo8(-(PPM_in)) |
||
2932 | 2947 1c9a F040 sbci r31,hi8(-(PPM_in)) |
||
2933 | 2948 1c9c 1182 std Z+1,__zero_reg__ |
||
2934 | 2949 1c9e 1082 st Z,__zero_reg__ |
||
2935 | 2950 1ca0 E091 0000 lds r30,EE_Parameter+1 |
||
2936 | 2951 1ca4 FF27 clr r31 |
||
2937 | 2952 1ca6 EE0F lsl r30 |
||
2938 | 2953 1ca8 FF1F rol r31 |
||
2939 | 2954 1caa E050 subi r30,lo8(-(PPM_in)) |
||
2940 | 2955 1cac F040 sbci r31,hi8(-(PPM_in)) |
||
2941 | 2956 1cae 1182 std Z+1,__zero_reg__ |
||
2942 | 2957 1cb0 1082 st Z,__zero_reg__ |
||
2943 | 2958 1cb2 E091 0000 lds r30,EE_Parameter+3 |
||
2944 | 2959 1cb6 FF27 clr r31 |
||
2945 | 2960 1cb8 EE0F lsl r30 |
||
2946 | 2961 1cba FF1F rol r31 |
||
2947 | 2962 1cbc E050 subi r30,lo8(-(PPM_in)) |
||
2948 | 2963 1cbe F040 sbci r31,hi8(-(PPM_in)) |
||
2949 | 2964 1cc0 1182 std Z+1,__zero_reg__ |
||
2950 | 2965 1cc2 1082 st Z,__zero_reg__ |
||
2951 | 2966 1cc4 00C0 rjmp .L499 |
||
2952 | 2967 .L497: |
||
2953 | 2968 1cc6 1092 0000 sts MotorenEin,__zero_reg__ |
||
2954 | 2969 1cca 00C0 rjmp .L499 |
||
2955 | 2970 .L486: |
||
2956 | 2971 1ccc 8091 0000 lds r24,SenderOkay |
||
2957 | 2972 1cd0 8D38 cpi r24,lo8(-115) |
||
2958 | 2973 1cd2 00F4 brsh .+2 |
||
2959 | 2974 1cd4 00C0 rjmp .L499 |
||
2960 | 2975 1cd6 1092 0000 sts Notlandung,__zero_reg__ |
||
2961 | 2976 1cda 8091 0000 lds r24,EE_Parameter+26 |
||
2962 | 2977 1cde 22E3 ldi r18,lo8(50) |
||
2963 | 2978 1ce0 829F mul r24,r18 |
||
2964 | 2979 1ce2 C001 movw r24,r0 |
||
2965 | 2980 1ce4 1124 clr r1 |
||
2966 | 2981 1ce6 9093 0000 sts (RcLostTimer.2576)+1,r25 |
||
2967 | 2982 1cea 8093 0000 sts RcLostTimer.2576,r24 |
||
2968 | 2983 1cee 6981 ldd r22,Y+1 |
||
2969 | 2984 1cf0 7A81 ldd r23,Y+2 |
||
2970 | 2985 1cf2 6932 cpi r22,41 |
||
2971 | 2986 1cf4 7105 cpc r23,__zero_reg__ |
||
2972 | 2987 1cf6 04F0 brlt .L501 |
||
2973 | 2988 1cf8 8091 0000 lds r24,modell_fliegt.2580 |
||
2974 | 2989 1cfc 9091 0000 lds r25,(modell_fliegt.2580)+1 |
||
2975 | 2990 1d00 7FEF ldi r23,hi8(-1) |
||
2976 | 2991 1d02 8F3F cpi r24,lo8(-1) |
||
2977 | 2992 1d04 9707 cpc r25,r23 |
||
2978 | 2993 1d06 01F0 breq .L503 |
||
2979 | 2994 1d08 0196 adiw r24,1 |
||
2980 | 2995 1d0a 9093 0000 sts (modell_fliegt.2580)+1,r25 |
||
2981 | 2996 1d0e 8093 0000 sts modell_fliegt.2580,r24 |
||
2982 | 2997 .L501: |
||
2983 | 2998 1d12 8091 0000 lds r24,modell_fliegt.2580 |
||
2984 | 2999 1d16 9091 0000 lds r25,(modell_fliegt.2580)+1 |
||
2985 | 3000 1d1a 883C cpi r24,200 |
||
2986 | 3001 1d1c 9105 cpc r25,__zero_reg__ |
||
2987 | 3002 1d1e 00F0 brlo .L505 |
||
2988 | 3003 1d20 8981 ldd r24,Y+1 |
||
2989 | 3004 1d22 9A81 ldd r25,Y+2 |
||
2990 | 3005 1d24 8897 sbiw r24,40 |
||
2991 | 3006 1d26 04F4 brge .L503 |
||
2992 | 3007 .L505: |
||
2993 | 3008 1d28 1092 0000 sts SummeNick.2569,__zero_reg__ |
||
2994 | 3009 1d2c 1092 0000 sts (SummeNick.2569)+1,__zero_reg__ |
||
2995 | 3010 1d30 1092 0000 sts (SummeNick.2569)+2,__zero_reg__ |
||
2996 | 3011 1d34 1092 0000 sts (SummeNick.2569)+3,__zero_reg__ |
||
2997 | 3012 1d38 1092 0000 sts SummeRoll.2570,__zero_reg__ |
||
2998 | 3013 1d3c 1092 0000 sts (SummeRoll.2570)+1,__zero_reg__ |
||
2999 | 3014 1d40 1092 0000 sts (SummeRoll.2570)+2,__zero_reg__ |
||
3000 | 3015 1d44 1092 0000 sts (SummeRoll.2570)+3,__zero_reg__ |
||
3001 | 3016 1d48 1092 0000 sts Mess_Integral_Gier,__zero_reg__ |
||
3002 | 3017 1d4c 1092 0000 sts (Mess_Integral_Gier)+1,__zero_reg__ |
||
3003 | 3018 1d50 1092 0000 sts (Mess_Integral_Gier)+2,__zero_reg__ |
||
3004 | 3019 1d54 1092 0000 sts (Mess_Integral_Gier)+3,__zero_reg__ |
||
3005 | 3020 1d58 1092 0000 sts Mess_Integral_Gier2,__zero_reg__ |
||
3006 | 3021 1d5c 1092 0000 sts (Mess_Integral_Gier2)+1,__zero_reg__ |
||
3007 | 3022 1d60 1092 0000 sts (Mess_Integral_Gier2)+2,__zero_reg__ |
||
3008 | 3023 1d64 1092 0000 sts (Mess_Integral_Gier2)+3,__zero_reg__ |
||
3009 | 3024 .L503: |
||
3010 | 3025 1d68 A981 ldd r26,Y+1 |
||
3011 | 3026 1d6a BA81 ldd r27,Y+2 |
||
3012 | 3027 1d6c A93C cpi r26,201 |
||
3013 | 3028 1d6e B105 cpc r27,__zero_reg__ |
||
3014 | 3029 1d70 04F4 brge .+2 |
||
3015 | 3030 1d72 00C0 rjmp .L507 |
||
3016 | 3031 1d74 8091 0000 lds r24,MotorenEin |
||
3017 | 3032 1d78 8823 tst r24 |
||
3018 | 3033 1d7a 01F0 breq .+2 |
||
3019 | 3034 1d7c 00C0 rjmp .L499 |
||
3020 | 3035 1d7e 8091 0000 lds r24,EE_Parameter+3 |
||
3021 | 3036 1d82 E82F mov r30,r24 |
||
3022 | 3037 1d84 FF27 clr r31 |
||
3023 | 3038 1d86 EE0F lsl r30 |
||
3024 | 3039 1d88 FF1F rol r31 |
||
3025 | 3040 1d8a E050 subi r30,lo8(-(PPM_in)) |
||
3026 | 3041 1d8c F040 sbci r31,hi8(-(PPM_in)) |
||
3027 | 3042 1d8e 8081 ld r24,Z |
||
3028 | 3043 1d90 9181 ldd r25,Z+1 |
||
3029 | 3044 1d92 8C34 cpi r24,76 |
||
3030 | 3045 1d94 9105 cpc r25,__zero_reg__ |
||
3031 | 3046 1d96 04F4 brge .+2 |
||
3032 | 3047 1d98 00C0 rjmp .L510 |
||
3033 | 3048 1d9a 8091 0000 lds r24,delay_neutral.2577 |
||
3034 | 3049 1d9e 8F5F subi r24,lo8(-(1)) |
||
3035 | 3050 1da0 8093 0000 sts delay_neutral.2577,r24 |
||
3036 | 3051 1da4 893C cpi r24,lo8(-55) |
||
3037 | 3052 1da6 00F4 brsh .+2 |
||
3038 | 3053 1da8 00C0 rjmp .L499 |
||
3039 | 3054 1daa 2998 cbi 37-0x20,1 |
||
3040 | 3055 1dac 1092 0000 sts MotorenEin,__zero_reg__ |
||
3041 | 3056 1db0 1092 0000 sts delay_neutral.2577,__zero_reg__ |
||
3042 | 3057 1db4 1092 0000 sts (modell_fliegt.2580)+1,__zero_reg__ |
||
3043 | 3058 1db8 1092 0000 sts modell_fliegt.2580,__zero_reg__ |
||
3044 | 3059 1dbc 8091 0000 lds r24,EE_Parameter |
||
3045 | 3060 1dc0 282F mov r18,r24 |
||
3046 | 3061 1dc2 3327 clr r19 |
||
3047 | 3062 1dc4 F901 movw r30,r18 |
||
3048 | 3063 1dc6 EE0F lsl r30 |
||
3049 | 3064 1dc8 FF1F rol r31 |
||
3050 | 3065 1dca E050 subi r30,lo8(-(PPM_in)) |
||
3051 | 3066 1dcc F040 sbci r31,hi8(-(PPM_in)) |
||
3052 | 3067 1dce 8081 ld r24,Z |
||
3053 | 3068 1dd0 9181 ldd r25,Z+1 |
||
3054 | 3069 1dd2 8734 cpi r24,71 |
||
3055 | 3070 1dd4 9105 cpc r25,__zero_reg__ |
||
3056 | 3071 1dd6 04F4 brge .L513 |
||
3057 | 3072 1dd8 E091 0000 lds r30,EE_Parameter+1 |
||
3058 | 3073 1ddc FF27 clr r31 |
||
3059 | 3074 1dde EE0F lsl r30 |
||
3060 | 3075 1de0 FF1F rol r31 |
||
3061 | 3076 1de2 E050 subi r30,lo8(-(PPM_in)) |
||
3062 | 3077 1de4 F040 sbci r31,hi8(-(PPM_in)) |
||
3063 | 3078 1de6 0190 ld __tmp_reg__,Z+ |
||
3064 | 3079 1de8 F081 ld r31,Z |
||
3065 | 3080 1dea E02D mov r30,__tmp_reg__ |
||
3066 | 3081 1dec F7FF sbrs r31,7 |
||
3067 | 3082 1dee 00C0 rjmp .L516 |
||
3068 | 3083 1df0 F095 com r31 |
||
3069 | 3084 1df2 E195 neg r30 |
||
3070 | 3085 1df4 FF4F sbci r31,lo8(-1) |
||
3071 | 3086 .L516: |
||
3072 | 3087 1df6 E734 cpi r30,71 |
||
3073 | 3088 1df8 F105 cpc r31,__zero_reg__ |
||
3074 | 3089 1dfa 04F4 brge .+2 |
||
3075 | 3090 1dfc 00C0 rjmp .L515 |
||
3076 | 3091 .L513: |
||
3077 | 3092 1dfe 8091 0000 lds r24,EE_Parameter+1 |
||
3078 | 3093 1e02 682F mov r22,r24 |
||
3079 | 3094 1e04 7727 clr r23 |
||
3080 | 3095 1e06 DB01 movw r26,r22 |
||
3081 | 3096 1e08 AA0F lsl r26 |
||
3082 | 3097 1e0a BB1F rol r27 |
||
3083 | 3098 1e0c A050 subi r26,lo8(-(PPM_in)) |
||
3084 | 3099 1e0e B040 sbci r27,hi8(-(PPM_in)) |
||
3085 | 3100 1e10 8D91 ld r24,X+ |
||
3086 | 3101 1e12 9C91 ld r25,X |
||
3087 | 3102 1e14 1197 sbiw r26,1 |
||
3088 | 3103 1e16 8734 cpi r24,71 |
||
3089 | 3104 1e18 9105 cpc r25,__zero_reg__ |
||
3090 | 3105 1e1a 04F0 brlt .L517 |
||
3091 | 3106 1e1c F901 movw r30,r18 |
||
3092 | 3107 1e1e EE0F lsl r30 |
||
3093 | 3108 1e20 FF1F rol r31 |
||
3094 | 3109 1e22 E050 subi r30,lo8(-(PPM_in)) |
||
3095 | 3110 1e24 F040 sbci r31,hi8(-(PPM_in)) |
||
3096 | 3111 1e26 8081 ld r24,Z |
||
3097 | 3112 1e28 9181 ldd r25,Z+1 |
||
3098 | 3113 .L517: |
||
3099 | 3114 1e2a 8D91 ld r24,X+ |
||
3100 | 3115 1e2c 9C91 ld r25,X |
||
3101 | 3116 1e2e 8734 cpi r24,71 |
||
3102 | 3117 1e30 9105 cpc r25,__zero_reg__ |
||
3103 | 3118 1e32 04F0 brlt .L519 |
||
3104 | 3119 1e34 F901 movw r30,r18 |
||
3105 | 3120 1e36 EE0F lsl r30 |
||
3106 | 3121 1e38 FF1F rol r31 |
||
3107 | 3122 1e3a E050 subi r30,lo8(-(PPM_in)) |
||
3108 | 3123 1e3c F040 sbci r31,hi8(-(PPM_in)) |
||
3109 | 3124 1e3e 8081 ld r24,Z |
||
3110 | 3125 1e40 9181 ldd r25,Z+1 |
||
3111 | 3126 1e42 8734 cpi r24,71 |
||
3112 | 3127 1e44 9105 cpc r25,__zero_reg__ |
||
3113 | 3128 1e46 04F0 brlt .L519 |
||
3114 | 3129 1e48 42E0 ldi r20,lo8(2) |
||
3115 | 3130 1e4a 00C0 rjmp .L522 |
||
3116 | 3131 .L519: |
||
3117 | 3132 1e4c 41E0 ldi r20,lo8(1) |
||
3118 | 3133 .L522: |
||
3119 | 3134 1e4e FB01 movw r30,r22 |
||
3120 | 3135 1e50 EE0F lsl r30 |
||
3121 | 3136 1e52 FF1F rol r31 |
||
3122 | 3137 1e54 E050 subi r30,lo8(-(PPM_in)) |
||
3123 | 3138 1e56 F040 sbci r31,hi8(-(PPM_in)) |
||
3124 | 3139 1e58 8081 ld r24,Z |
||
3125 | 3140 1e5a 9181 ldd r25,Z+1 |
||
3126 | 3141 1e5c 8634 cpi r24,70 |
||
3127 | 3142 1e5e 9105 cpc r25,__zero_reg__ |
||
3128 | 3143 1e60 04F4 brge .L523 |
||
3129 | 3144 1e62 F901 movw r30,r18 |
||
3130 | 3145 1e64 EE0F lsl r30 |
||
3131 | 3146 1e66 FF1F rol r31 |
||
3132 | 3147 1e68 E050 subi r30,lo8(-(PPM_in)) |
||
3133 | 3148 1e6a F040 sbci r31,hi8(-(PPM_in)) |
||
3134 | 3149 1e6c 8081 ld r24,Z |
||
3135 | 3150 1e6e 9181 ldd r25,Z+1 |
||
3136 | 3151 1e70 8734 cpi r24,71 |
||
3137 | 3152 1e72 9105 cpc r25,__zero_reg__ |
||
3138 | 3153 1e74 04F0 brlt .L523 |
||
3139 | 3154 1e76 43E0 ldi r20,lo8(3) |
||
3140 | 3155 .L523: |
||
3141 | 3156 1e78 FB01 movw r30,r22 |
||
3142 | 3157 1e7a EE0F lsl r30 |
||
3143 | 3158 1e7c FF1F rol r31 |
||
3144 | 3159 1e7e E050 subi r30,lo8(-(PPM_in)) |
||
3145 | 3160 1e80 F040 sbci r31,hi8(-(PPM_in)) |
||
3146 | 3161 1e82 8081 ld r24,Z |
||
3147 | 3162 1e84 9181 ldd r25,Z+1 |
||
3148 | 3163 1e86 8A5B subi r24,lo8(-70) |
||
3149 | 3164 1e88 9F4F sbci r25,hi8(-70) |
||
3150 | 3165 1e8a 04F4 brge .L526 |
||
3151 | 3166 1e8c F901 movw r30,r18 |
||
3152 | 3167 1e8e EE0F lsl r30 |
||
3153 | 3168 1e90 FF1F rol r31 |
||
3154 | 3169 1e92 E050 subi r30,lo8(-(PPM_in)) |
||
3155 | 3170 1e94 F040 sbci r31,hi8(-(PPM_in)) |
||
3156 | 3171 1e96 8081 ld r24,Z |
||
3157 | 3172 1e98 9181 ldd r25,Z+1 |
||
3158 | 3173 1e9a 8734 cpi r24,71 |
||
3159 | 3174 1e9c 9105 cpc r25,__zero_reg__ |
||
3160 | 3175 1e9e 04F0 brlt .L526 |
||
3161 | 3176 1ea0 44E0 ldi r20,lo8(4) |
||
3162 | 3177 .L526: |
||
3163 | 3178 1ea2 660F lsl r22 |
||
3164 | 3179 1ea4 771F rol r23 |
||
3165 | 3180 1ea6 6050 subi r22,lo8(-(PPM_in)) |
||
3166 | 3181 1ea8 7040 sbci r23,hi8(-(PPM_in)) |
||
3167 | 3182 1eaa FB01 movw r30,r22 |
||
3168 | 3183 1eac 8081 ld r24,Z |
||
3169 | 3184 1eae 9181 ldd r25,Z+1 |
||
3170 | 3185 1eb0 8A5B subi r24,lo8(-70) |
||
3171 | 3186 1eb2 9F4F sbci r25,hi8(-70) |
||
3172 | 3187 1eb4 04F4 brge .L529 |
||
3173 | 3188 1eb6 220F lsl r18 |
||
3174 | 3189 1eb8 331F rol r19 |
||
3175 | 3190 1eba 2050 subi r18,lo8(-(PPM_in)) |
||
3176 | 3191 1ebc 3040 sbci r19,hi8(-(PPM_in)) |
||
3177 | 3192 1ebe D901 movw r26,r18 |
||
3178 | 3193 1ec0 8D91 ld r24,X+ |
||
3179 | 3194 1ec2 9C91 ld r25,X |
||
3180 | 3195 1ec4 8634 cpi r24,70 |
||
3181 | 3196 1ec6 9105 cpc r25,__zero_reg__ |
||
3182 | 3197 1ec8 04F4 brge .L529 |
||
3183 | 3198 1eca 45E0 ldi r20,lo8(5) |
||
3184 | 3199 .L529: |
||
3185 | 3200 1ecc A0E0 ldi r26,lo8(EEPromArray+2) |
||
3186 | 3201 1ece B0E0 ldi r27,hi8(EEPromArray+2) |
||
3187 | 3202 /* #APP */ |
||
3188 | 3203 1ed0 042E mov __tmp_reg__,r20 |
||
3189 | 3204 1ed2 0E94 0000 call __eeprom_write_byte_1F2021 |
||
3190 | 3205 /* #NOAPP */ |
||
3191 | 3206 .L515: |
||
3192 | 3207 1ed6 8091 0000 lds r24,EE_Parameter+8 |
||
3193 | 3208 1eda 80FF sbrs r24,0 |
||
3194 | 3209 1edc 00C0 rjmp .L532 |
||
3195 | 3210 1ede 8091 0000 lds r24,MessLuftdruck |
||
3196 | 3211 1ee2 9091 0000 lds r25,(MessLuftdruck)+1 |
||
3197 | 3212 1ee6 875B subi r24,lo8(951) |
||
3198 | 3213 1ee8 9340 sbci r25,hi8(951) |
||
3199 | 3214 1eea 00F4 brsh .L534 |
||
3200 | 3215 1eec 8091 0000 lds r24,MessLuftdruck |
||
3201 | 3216 1ef0 9091 0000 lds r25,(MessLuftdruck)+1 |
||
3202 | 3217 1ef4 8E5E subi r24,lo8(750) |
||
3203 | 3218 1ef6 9240 sbci r25,hi8(750) |
||
3204 | 3219 1ef8 00F4 brsh .L532 |
||
3205 | 3220 .L534: |
||
3206 | 3221 1efa 0E94 0000 call SucheLuftruckOffset |
||
3207 | 3222 .L532: |
||
3208 | 3223 1efe 0E94 0000 call GetActiveParamSetNumber |
||
3209 | 3224 1f02 47E4 ldi r20,lo8(71) |
||
3210 | 3225 1f04 60E0 ldi r22,lo8(EE_Parameter) |
||
3211 | 3226 1f06 70E0 ldi r23,hi8(EE_Parameter) |
||
3212 | 3227 1f08 0E94 0000 call ReadParameterSet |
||
3213 | 3228 1f0c 0E94 0000 call SetNeutral |
||
3214 | 3229 1f10 00C0 rjmp .L817 |
||
3215 | 3230 .L510: |
||
3216 | 3231 1f12 8081 ld r24,Z |
||
3217 | 3232 1f14 9181 ldd r25,Z+1 |
||
3218 | 3233 1f16 855B subi r24,lo8(-75) |
||
3219 | 3234 1f18 9F4F sbci r25,hi8(-75) |
||
3220 | 3235 1f1a 04F0 brlt .+2 |
||
3221 | 3236 1f1c 00C0 rjmp .L536 |
||
3222 | 3237 1f1e 8091 0000 lds r24,delay_neutral.2577 |
||
3223 | 3238 1f22 8F5F subi r24,lo8(-(1)) |
||
3224 | 3239 1f24 8093 0000 sts delay_neutral.2577,r24 |
||
3225 | 3240 1f28 893C cpi r24,lo8(-55) |
||
3226 | 3241 1f2a 00F4 brsh .+2 |
||
3227 | 3242 1f2c 00C0 rjmp .L499 |
||
3228 | 3243 1f2e 2998 cbi 37-0x20,1 |
||
3229 | 3244 1f30 8FEF ldi r24,lo8(-1) |
||
3230 | 3245 1f32 00E0 ldi r16,lo8(EEPromArray+4) |
||
3231 | 3246 1f34 10E0 ldi r17,hi8(EEPromArray+4) |
||
3232 | 3247 1f36 D801 movw r26,r16 |
||
3233 | 3248 /* #APP */ |
||
3234 | 3249 1f38 082E mov __tmp_reg__,r24 |
||
3235 | 3250 1f3a 0E94 0000 call __eeprom_write_byte_1F2021 |
||
3236 | 3251 /* #NOAPP */ |
||
3237 | 3252 1f3e 1092 0000 sts MotorenEin,__zero_reg__ |
||
3238 | 3253 1f42 1092 0000 sts delay_neutral.2577,__zero_reg__ |
||
3239 | 3254 1f46 1092 0000 sts (modell_fliegt.2580)+1,__zero_reg__ |
||
3240 | 3255 1f4a 1092 0000 sts modell_fliegt.2580,__zero_reg__ |
||
3241 | 3256 1f4e 0E94 0000 call SetNeutral |
||
3242 | 3257 1f52 8091 0000 lds r24,NeutralAccX |
||
3243 | 3258 1f56 9091 0000 lds r25,(NeutralAccX)+1 |
||
3244 | 3259 1f5a 60E0 ldi r22,lo8(256) |
||
3245 | 3260 1f5c 71E0 ldi r23,hi8(256) |
||
3246 | 3261 1f5e 0E94 0000 call __divmodhi4 |
||
3247 | 3262 1f62 D801 movw r26,r16 |
||
3248 | 3263 /* #APP */ |
||
3249 | 3264 1f64 062E mov __tmp_reg__,r22 |
||
3250 | 3265 1f66 0E94 0000 call __eeprom_write_byte_1F2021 |
||
3251 | 3266 /* #NOAPP */ |
||
3252 | 3267 1f6a 8091 0000 lds r24,NeutralAccX |
||
3253 | 3268 1f6e 9091 0000 lds r25,(NeutralAccX)+1 |
||
3254 | 3269 1f72 60E0 ldi r22,lo8(256) |
||
3255 | 3270 1f74 71E0 ldi r23,hi8(256) |
||
3256 | 3271 1f76 0E94 0000 call __divmodhi4 |
||
3257 | 3272 1f7a 0F5F subi r16,lo8(-(1)) |
||
3258 | 3273 1f7c 1F4F sbci r17,hi8(-(1)) |
||
3259 | 3274 1f7e D801 movw r26,r16 |
||
3260 | 3275 /* #APP */ |
||
3261 | 3276 1f80 082E mov __tmp_reg__,r24 |
||
3262 | 3277 1f82 0E94 0000 call __eeprom_write_byte_1F2021 |
||
3263 | 3278 /* #NOAPP */ |
||
3264 | 3279 1f86 8091 0000 lds r24,NeutralAccY |
||
3265 | 3280 1f8a 9091 0000 lds r25,(NeutralAccY)+1 |
||
3266 | 3281 1f8e 60E0 ldi r22,lo8(256) |
||
3267 | 3282 1f90 71E0 ldi r23,hi8(256) |
||
3268 | 3283 1f92 0E94 0000 call __divmodhi4 |
||
3269 | 3284 1f96 0F5F subi r16,lo8(-(1)) |
||
3270 | 3285 1f98 1F4F sbci r17,hi8(-(1)) |
||
3271 | 3286 1f9a D801 movw r26,r16 |
||
3272 | 3287 /* #APP */ |
||
3273 | 3288 1f9c 062E mov __tmp_reg__,r22 |
||
3274 | 3289 1f9e 0E94 0000 call __eeprom_write_byte_1F2021 |
||
3275 | 3290 /* #NOAPP */ |
||
3276 | 3291 1fa2 8091 0000 lds r24,NeutralAccY |
||
3277 | 3292 1fa6 9091 0000 lds r25,(NeutralAccY)+1 |
||
3278 | 3293 1faa 60E0 ldi r22,lo8(256) |
||
3279 | 3294 1fac 71E0 ldi r23,hi8(256) |
||
3280 | 3295 1fae 0E94 0000 call __divmodhi4 |
||
3281 | 3296 1fb2 0F5F subi r16,lo8(-(1)) |
||
3282 | 3297 1fb4 1F4F sbci r17,hi8(-(1)) |
||
3283 | 3298 1fb6 D801 movw r26,r16 |
||
3284 | 3299 /* #APP */ |
||
3285 | 3300 1fb8 082E mov __tmp_reg__,r24 |
||
3286 | 3301 1fba 0E94 0000 call __eeprom_write_byte_1F2021 |
||
3287 | 3302 /* #NOAPP */ |
||
3288 | 3303 1fbe 6091 0000 lds r22,NeutralAccZ |
||
3289 | 3304 1fc2 7091 0000 lds r23,(NeutralAccZ)+1 |
||
3290 | 3305 1fc6 8091 0000 lds r24,(NeutralAccZ)+2 |
||
3291 | 3306 1fca 9091 0000 lds r25,(NeutralAccZ)+3 |
||
3292 | 3307 1fce 0E94 0000 call __fixsfsi |
||
3293 | 3308 1fd2 DC01 movw r26,r24 |
||
3294 | 3309 1fd4 CB01 movw r24,r22 |
||
3295 | 3310 1fd6 60E0 ldi r22,lo8(256) |
||
3296 | 3311 1fd8 71E0 ldi r23,hi8(256) |
||
3297 | 3312 1fda 0E94 0000 call __divmodhi4 |
||
3298 | 3313 1fde 0F5F subi r16,lo8(-(1)) |
||
3299 | 3314 1fe0 1F4F sbci r17,hi8(-(1)) |
||
3300 | 3315 1fe2 D801 movw r26,r16 |
||
3301 | 3316 /* #APP */ |
||
3302 | 3317 1fe4 062E mov __tmp_reg__,r22 |
||
3303 | 3318 1fe6 0E94 0000 call __eeprom_write_byte_1F2021 |
||
3304 | 3319 /* #NOAPP */ |
||
3305 | 3320 1fea 6091 0000 lds r22,NeutralAccZ |
||
3306 | 3321 1fee 7091 0000 lds r23,(NeutralAccZ)+1 |
||
3307 | 3322 1ff2 8091 0000 lds r24,(NeutralAccZ)+2 |
||
3308 | 3323 1ff6 9091 0000 lds r25,(NeutralAccZ)+3 |
||
3309 | 3324 1ffa 0E94 0000 call __fixsfsi |
||
3310 | 3325 1ffe DC01 movw r26,r24 |
||
3311 | 3326 2000 CB01 movw r24,r22 |
||
3312 | 3327 2002 60E0 ldi r22,lo8(256) |
||
3313 | 3328 2004 71E0 ldi r23,hi8(256) |
||
3314 | 3329 2006 0E94 0000 call __divmodhi4 |
||
3315 | 3330 200a 0F5F subi r16,lo8(-(1)) |
||
3316 | 3331 200c 1F4F sbci r17,hi8(-(1)) |
||
3317 | 3332 200e D801 movw r26,r16 |
||
3318 | 3333 /* #APP */ |
||
3319 | 3334 2010 082E mov __tmp_reg__,r24 |
||
3320 | 3335 2012 0E94 0000 call __eeprom_write_byte_1F2021 |
||
3321 | 3336 /* #NOAPP */ |
||
3322 | 3337 .L817: |
||
3323 | 3338 2016 0E94 0000 call GetActiveParamSetNumber |
||
3324 | 3339 201a 0E94 0000 call Piep |
||
3325 | 3340 201e 00C0 rjmp .L499 |
||
3326 | 3341 .L536: |
||
3327 | 3342 2020 1092 0000 sts delay_neutral.2577,__zero_reg__ |
||
3328 | 3343 2024 00C0 rjmp .L499 |
||
3329 | 3344 .L507: |
||
3330 | 3345 2026 E981 ldd r30,Y+1 |
||
3331 | 3346 2028 FA81 ldd r31,Y+2 |
||
3332 | 3347 202a B397 sbiw r30,35 |
||
3333 | 3348 202c 04F0 brlt .+2 |
||
3334 | 3349 202e 00C0 rjmp .L499 |
||
3335 | 3350 2030 8091 0000 lds r24,EE_Parameter+3 |
||
3336 | 3351 2034 482F mov r20,r24 |
||
3337 | 3352 2036 5527 clr r21 |
||
3338 | 3353 2038 FA01 movw r30,r20 |
||
3339 | 3354 203a EE0F lsl r30 |
||
3340 | 3355 203c FF1F rol r31 |
||
3341 | 3356 203e E050 subi r30,lo8(-(PPM_in)) |
||
3342 | 3357 2040 F040 sbci r31,hi8(-(PPM_in)) |
||
3343 | 3358 2042 8081 ld r24,Z |
||
3344 | 3359 2044 9181 ldd r25,Z+1 |
||
3345 | 3360 2046 855B subi r24,lo8(-75) |
||
3346 | 3361 2048 9F4F sbci r25,hi8(-75) |
||
3347 | 3362 204a 04F0 brlt .+2 |
||
3348 | 3363 204c 00C0 rjmp .L540 |
||
3349 | 3364 204e 8091 0000 lds r24,delay_einschalten.2578 |
||
3350 | 3365 2052 8F5F subi r24,lo8(-(1)) |
||
3351 | 3366 2054 8093 0000 sts delay_einschalten.2578,r24 |
||
3352 | 3367 2058 893C cpi r24,lo8(-55) |
||
3353 | 3368 205a 00F4 brsh .+2 |
||
3354 | 3369 205c 00C0 rjmp .L542 |
||
3355 | 3370 205e 88EC ldi r24,lo8(-56) |
||
3356 | 3371 2060 8093 0000 sts delay_einschalten.2578,r24 |
||
3357 | 3372 2064 81E0 ldi r24,lo8(1) |
||
3358 | 3373 2066 90E0 ldi r25,hi8(1) |
||
3359 | 3374 2068 9093 0000 sts (modell_fliegt.2580)+1,r25 |
||
3360 | 3375 206c 8093 0000 sts modell_fliegt.2580,r24 |
||
3361 | 3376 2070 81E0 ldi r24,lo8(1) |
||
3362 | 3377 2072 8093 0000 sts MotorenEin,r24 |
||
3363 | 3378 2076 1092 0000 sts sollGier.2571,__zero_reg__ |
||
3364 | 3379 207a 1092 0000 sts (sollGier.2571)+1,__zero_reg__ |
||
3365 | 3380 207e 1092 0000 sts (sollGier.2571)+2,__zero_reg__ |
||
3366 | 3381 2082 1092 0000 sts (sollGier.2571)+3,__zero_reg__ |
||
3367 | 3382 2086 1092 0000 sts Mess_Integral_Gier,__zero_reg__ |
||
3368 | 3383 208a 1092 0000 sts (Mess_Integral_Gier)+1,__zero_reg__ |
||
3369 | 3384 208e 1092 0000 sts (Mess_Integral_Gier)+2,__zero_reg__ |
||
3370 | 3385 2092 1092 0000 sts (Mess_Integral_Gier)+3,__zero_reg__ |
||
3371 | 3386 2096 1092 0000 sts Mess_Integral_Gier2,__zero_reg__ |
||
3372 | 3387 209a 1092 0000 sts (Mess_Integral_Gier2)+1,__zero_reg__ |
||
3373 | 3388 209e 1092 0000 sts (Mess_Integral_Gier2)+2,__zero_reg__ |
||
3374 | 3389 20a2 1092 0000 sts (Mess_Integral_Gier2)+3,__zero_reg__ |
||
3375 | 3390 20a6 1092 0000 sts Mess_IntegralNick,__zero_reg__ |
||
3376 | 3391 20aa 1092 0000 sts (Mess_IntegralNick)+1,__zero_reg__ |
||
3377 | 3392 20ae 1092 0000 sts (Mess_IntegralNick)+2,__zero_reg__ |
||
3378 | 3393 20b2 1092 0000 sts (Mess_IntegralNick)+3,__zero_reg__ |
||
3379 | 3394 20b6 1092 0000 sts Mess_IntegralRoll,__zero_reg__ |
||
3380 | 3395 20ba 1092 0000 sts (Mess_IntegralRoll)+1,__zero_reg__ |
||
3381 | 3396 20be 1092 0000 sts (Mess_IntegralRoll)+2,__zero_reg__ |
||
3382 | 3397 20c2 1092 0000 sts (Mess_IntegralRoll)+3,__zero_reg__ |
||
3383 | 3398 20c6 8091 0000 lds r24,IntegralNick |
||
3384 | 3399 20ca 9091 0000 lds r25,(IntegralNick)+1 |
||
3385 | 3400 20ce A091 0000 lds r26,(IntegralNick)+2 |
||
3386 | 3401 20d2 B091 0000 lds r27,(IntegralNick)+3 |
||
3387 | 3402 20d6 8093 0000 sts Mess_IntegralNick2,r24 |
||
3388 | 3403 20da 9093 0000 sts (Mess_IntegralNick2)+1,r25 |
||
3389 | 3404 20de A093 0000 sts (Mess_IntegralNick2)+2,r26 |
||
3390 | 3405 20e2 B093 0000 sts (Mess_IntegralNick2)+3,r27 |
||
3391 | 3406 20e6 8091 0000 lds r24,IntegralRoll |
||
3392 | 3407 20ea 9091 0000 lds r25,(IntegralRoll)+1 |
||
3393 | 3408 20ee A091 0000 lds r26,(IntegralRoll)+2 |
||
3394 | 3409 20f2 B091 0000 lds r27,(IntegralRoll)+3 |
||
3395 | 3410 20f6 8093 0000 sts Mess_IntegralRoll2,r24 |
||
3396 | 3411 20fa 9093 0000 sts (Mess_IntegralRoll2)+1,r25 |
||
3397 | 3412 20fe A093 0000 sts (Mess_IntegralRoll2)+2,r26 |
||
3398 | 3413 2102 B093 0000 sts (Mess_IntegralRoll2)+3,r27 |
||
3399 | 3414 2106 1092 0000 sts SummeNick.2569,__zero_reg__ |
||
3400 | 3415 210a 1092 0000 sts (SummeNick.2569)+1,__zero_reg__ |
||
3401 | 3416 210e 1092 0000 sts (SummeNick.2569)+2,__zero_reg__ |
||
3402 | 3417 2112 1092 0000 sts (SummeNick.2569)+3,__zero_reg__ |
||
3403 | 3418 2116 1092 0000 sts SummeRoll.2570,__zero_reg__ |
||
3404 | 3419 211a 1092 0000 sts (SummeRoll.2570)+1,__zero_reg__ |
||
3405 | 3420 211e 1092 0000 sts (SummeRoll.2570)+2,__zero_reg__ |
||
3406 | 3421 2122 1092 0000 sts (SummeRoll.2570)+3,__zero_reg__ |
||
3407 | 3422 2126 00C0 rjmp .L542 |
||
3408 | 3423 .L540: |
||
3409 | 3424 2128 1092 0000 sts delay_einschalten.2578,__zero_reg__ |
||
3410 | 3425 .L542: |
||
3411 | 3426 212c 440F lsl r20 |
||
3412 | 3427 212e 551F rol r21 |
||
3413 | 3428 2130 4050 subi r20,lo8(-(PPM_in)) |
||
3414 | 3429 2132 5040 sbci r21,hi8(-(PPM_in)) |
||
3415 | 3430 2134 DA01 movw r26,r20 |
||
3416 | 3431 2136 8D91 ld r24,X+ |
||
3417 | 3432 2138 9C91 ld r25,X |
||
3418 | 3433 213a 8C34 cpi r24,76 |
||
3419 | 3434 213c 9105 cpc r25,__zero_reg__ |
||
3420 | 3435 213e 04F0 brlt .L544 |
||
3421 | 3436 2140 8091 0000 lds r24,delay_ausschalten.2579 |
||
3422 | 3437 2144 8F5F subi r24,lo8(-(1)) |
||
3423 | 3438 2146 8093 0000 sts delay_ausschalten.2579,r24 |
||
3424 | 3439 214a 893C cpi r24,lo8(-55) |
||
3425 | 3440 214c 00F0 brlo .L499 |
||
3426 | 3441 214e 1092 0000 sts MotorenEin,__zero_reg__ |
||
3427 | 3442 2152 88EC ldi r24,lo8(-56) |
||
3428 | 3443 2154 8093 0000 sts delay_ausschalten.2579,r24 |
||
3429 | 3444 2158 1092 0000 sts (modell_fliegt.2580)+1,__zero_reg__ |
||
3430 | 3445 215c 1092 0000 sts modell_fliegt.2580,__zero_reg__ |
||
3431 | 3446 2160 00C0 rjmp .L499 |
||
3432 | 3447 .L544: |
||
3433 | 3448 2162 1092 0000 sts delay_ausschalten.2579,__zero_reg__ |
||
3434 | 3449 .L499: |
||
3435 | 3450 2166 8091 0000 lds r24,NewPpmData |
||
3436 | 3451 216a 8150 subi r24,lo8(-(-1)) |
||
3437 | 3452 216c 8093 0000 sts NewPpmData,r24 |
||
3438 | 3453 2170 8091 0000 lds r24,NewPpmData |
||
3439 | 3454 2174 8F3F cpi r24,lo8(-1) |
||
3440 | 3455 2176 01F0 breq .L547 |
||
3441 | 3456 2178 8091 0000 lds r24,Notlandung |
||
3442 | 3457 217c 8823 tst r24 |
||
3443 | 3458 217e 01F4 brne .+2 |
||
3444 | 3459 2180 00C0 rjmp .L549 |
||
3445 | 3460 .L547: |
||
3446 | 3461 2182 0E94 0000 call ParameterZuordnung |
||
3447 | 3462 2186 8091 0000 lds r24,EE_Parameter |
||
3448 | 3463 218a 882E mov r8,r24 |
||
3449 | 3464 218c 9924 clr r9 |
||
3450 | 3465 218e D401 movw r26,r8 |
||
3451 | 3466 2190 AA0F lsl r26 |
||
3452 | 3467 2192 BB1F rol r27 |
||
3453 | 3468 2194 CD01 movw r24,r26 |
||
3454 | 3469 2196 8050 subi r24,lo8(-(PPM_in)) |
||
3455 | 3470 2198 9040 sbci r25,hi8(-(PPM_in)) |
||
3456 | 3471 219a FC01 movw r30,r24 |
||
3457 | 3472 219c 8081 ld r24,Z |
||
3458 | 3473 219e 9181 ldd r25,Z+1 |
||
3459 | 3474 21a0 9E8B std Y+22,r25 |
||
3460 | 3475 21a2 8D8B std Y+21,r24 |
||
3461 | 3476 21a4 8091 0000 lds r24,EE_Parameter+15 |
||
3462 | 3477 21a8 C82E mov r12,r24 |
||
3463 | 3478 21aa DD24 clr r13 |
||
3464 | 3479 21ac A050 subi r26,lo8(-(PPM_diff)) |
||
3465 | 3480 21ae B040 sbci r27,hi8(-(PPM_diff)) |
||
3466 | 3481 21b0 0D90 ld __tmp_reg__,X+ |
||
3467 | 3482 21b2 BC91 ld r27,X |
||
3468 | 3483 21b4 A02D mov r26,__tmp_reg__ |
||
3469 | 3484 21b6 BC8B std Y+20,r27 |
||
3470 | 3485 21b8 AB8B std Y+19,r26 |
||
3471 | 3486 21ba 8091 0000 lds r24,EE_Parameter+16 |
||
3472 | 3487 21be 282E mov r2,r24 |
||
3473 | 3488 21c0 3324 clr r3 |
||
3474 | 3489 21c2 8091 0000 lds r24,EE_Parameter+1 |
||
3475 | 3490 21c6 A82E mov r10,r24 |
||
3476 | 3491 21c8 BB24 clr r11 |
||
3477 | 3492 21ca C501 movw r24,r10 |
||
3478 | 3493 21cc 880F lsl r24 |
||
3479 | 3494 21ce 991F rol r25 |
||
3480 | 3495 21d0 DC01 movw r26,r24 |
||
3481 | 3496 21d2 A050 subi r26,lo8(-(PPM_in)) |
||
3482 | 3497 21d4 B040 sbci r27,hi8(-(PPM_in)) |
||
3483 | 3498 21d6 0D90 ld __tmp_reg__,X+ |
||
3484 | 3499 21d8 BC91 ld r27,X |
||
3485 | 3500 21da A02D mov r26,__tmp_reg__ |
||
3486 | 3501 21dc BA8B std Y+18,r27 |
||
3487 | 3502 21de A98B std Y+17,r26 |
||
3488 | 3503 21e0 8050 subi r24,lo8(-(PPM_diff)) |
||
3489 | 3504 21e2 9040 sbci r25,hi8(-(PPM_diff)) |
||
3490 | 3505 21e4 DC01 movw r26,r24 |
||
3491 | 3506 21e6 ED90 ld r14,X+ |
||
3492 | 3507 21e8 FC90 ld r15,X |
||
3493 | 3508 21ea E091 0000 lds r30,EE_Parameter+3 |
||
3494 | 3509 21ee AE2F mov r26,r30 |
||
3495 | 3510 21f0 BB27 clr r27 |
||
3496 | 3511 21f2 AA0F lsl r26 |
||
3497 | 3512 21f4 BB1F rol r27 |
||
3498 | 3513 21f6 A050 subi r26,lo8(-(PPM_in)) |
||
3499 | 3514 21f8 B040 sbci r27,hi8(-(PPM_in)) |
||
3500 | 3515 21fa 0D90 ld __tmp_reg__,X+ |
||
3501 | 3516 21fc BC91 ld r27,X |
||
3502 | 3517 21fe A02D mov r26,__tmp_reg__ |
||
3503 | 3518 2200 BE87 std Y+14,r27 |
||
3504 | 3519 2202 AD87 std Y+13,r26 |
||
3505 | 3520 2204 1091 0000 lds r17,Parameter_Gyro_P |
||
3506 | 3521 2208 612F mov r22,r17 |
||
3507 | 3522 220a 7727 clr r23 |
||
3508 | 3523 220c 67FD sbrc r22,7 |
||
3509 | 3524 220e 7095 com r23 |
||
3510 | 3525 2210 872F mov r24,r23 |
||
3511 | 3526 2212 972F mov r25,r23 |
||
3512 | 3527 2214 0E94 0000 call __floatsisf |
||
3513 | 3528 2218 17FF sbrs r17,7 |
||
3514 | 3529 221a 00C0 rjmp .L550 |
||
3515 | 3530 221c 20E0 ldi r18,lo8(0x43800000) |
||
3516 | 3531 221e 30E0 ldi r19,hi8(0x43800000) |
||
3517 | 3532 2220 40E8 ldi r20,hlo8(0x43800000) |
||
3518 | 3533 2222 53E4 ldi r21,hhi8(0x43800000) |
||
3519 | 3534 2224 0E94 0000 call __addsf3 |
||
3520 | 3535 .L550: |
||
3521 | 3536 2228 20E0 ldi r18,lo8(0x41200000) |
||
3522 | 3537 222a 30E0 ldi r19,hi8(0x41200000) |
||
3523 | 3538 222c 40E2 ldi r20,hlo8(0x41200000) |
||
3524 | 3539 222e 51E4 ldi r21,hhi8(0x41200000) |
||
3525 | 3540 2230 0E94 0000 call __addsf3 |
||
3526 | 3541 2234 20E0 ldi r18,lo8(0x3b800000) |
||
3527 | 3542 2236 30E0 ldi r19,hi8(0x3b800000) |
||
3528 | 3543 2238 40E8 ldi r20,hlo8(0x3b800000) |
||
3529 | 3544 223a 5BE3 ldi r21,hhi8(0x3b800000) |
||
3530 | 3545 223c 0E94 0000 call __mulsf3 |
||
3531 | 3546 2240 2B01 movw r4,r22 |
||
3532 | 3547 2242 3C01 movw r6,r24 |
||
3533 | 3548 2244 6093 0000 sts GyroFaktor,r22 |
||
3534 | 3549 2248 7093 0000 sts (GyroFaktor)+1,r23 |
||
3535 | 3550 224c 8093 0000 sts (GyroFaktor)+2,r24 |
||
3536 | 3551 2250 9093 0000 sts (GyroFaktor)+3,r25 |
||
3537 | 3552 2254 1091 0000 lds r17,Parameter_Gyro_I |
||
3538 | 3553 2258 612F mov r22,r17 |
||
3539 | 3554 225a 7727 clr r23 |
||
3540 | 3555 225c 67FD sbrc r22,7 |
||
3541 | 3556 225e 7095 com r23 |
||
3542 | 3557 2260 872F mov r24,r23 |
||
3543 | 3558 2262 972F mov r25,r23 |
||
3544 | 3559 2264 0E94 0000 call __floatsisf |
||
3545 | 3560 2268 17FF sbrs r17,7 |
||
3546 | 3561 226a 00C0 rjmp .L551 |
||
3547 | 3562 226c 20E0 ldi r18,lo8(0x43800000) |
||
3548 | 3563 226e 30E0 ldi r19,hi8(0x43800000) |
||
3549 | 3564 2270 40E8 ldi r20,hlo8(0x43800000) |
||
3550 | 3565 2272 53E4 ldi r21,hhi8(0x43800000) |
||
3551 | 3566 2274 0E94 0000 call __addsf3 |
||
3552 | 3567 .L551: |
||
3553 | 3568 2278 20E0 ldi r18,lo8(0x472be000) |
||
3554 | 3569 227a 30EE ldi r19,hi8(0x472be000) |
||
3555 | 3570 227c 4BE2 ldi r20,hlo8(0x472be000) |
||
3556 | 3571 227e 57E4 ldi r21,hhi8(0x472be000) |
||
3557 | 3572 2280 0E94 0000 call __divsf3 |
||
3558 | 3573 2284 6093 0000 sts IntegralFaktor,r22 |
||
3559 | 3574 2288 7093 0000 sts (IntegralFaktor)+1,r23 |
||
3560 | 3575 228c 8093 0000 sts (IntegralFaktor)+2,r24 |
||
3561 | 3576 2290 9093 0000 sts (IntegralFaktor)+3,r25 |
||
3562 | 3577 2294 2091 0000 lds r18,DubWiseKeys+1 |
||
3563 | 3578 2298 2223 tst r18 |
||
3564 | 3579 229a 01F4 brne .+4 |
||
3565 | 3580 229c 0C94 0000 jmp .L552 |
||
3566 | 3581 22a0 8AE0 ldi r24,lo8(10) |
||
3567 | 3582 22a2 90E0 ldi r25,hi8(10) |
||
3568 | 3583 22a4 9093 0000 sts (beeptime)+1,r25 |
||
3569 | 3584 22a8 8093 0000 sts beeptime,r24 |
||
3570 | 3585 22ac E22F mov r30,r18 |
||
3571 | 3586 22ae FF27 clr r31 |
||
3572 | 3587 22b0 E2FF sbrs r30,2 |
||
3573 | 3588 22b2 00C0 rjmp .L554 |
||
3574 | 3589 22b4 8091 0000 lds r24,Parameter_UserParam1 |
||
3575 | 3590 22b8 482F mov r20,r24 |
||
3576 | 3591 22ba 5527 clr r21 |
||
3577 | 3592 22bc 440F lsl r20 |
||
3578 | 3593 22be 551F rol r21 |
||
3579 | 3594 22c0 440F lsl r20 |
||
3580 | 3595 22c2 551F rol r21 |
||
3581 | 3596 22c4 00C0 rjmp .L556 |
||
3582 | 3597 .L554: |
||
3583 | 3598 22c6 E3FD sbrc r30,3 |
||
3584 | 3599 22c8 00C0 rjmp .L557 |
||
3585 | 3600 22ca 40E0 ldi r20,lo8(0) |
||
3586 | 3601 22cc 50E0 ldi r21,hi8(0) |
||
3587 | 3602 22ce 00C0 rjmp .L556 |
||
3588 | 3603 .L557: |
||
3589 | 3604 22d0 8091 0000 lds r24,Parameter_UserParam1 |
||
3590 | 3605 22d4 9927 clr r25 |
||
3591 | 3606 22d6 880F lsl r24 |
||
3592 | 3607 22d8 991F rol r25 |
||
3593 | 3608 22da 880F lsl r24 |
||
3594 | 3609 22dc 991F rol r25 |
||
3595 | 3610 22de 4427 clr r20 |
||
3596 | 3611 22e0 5527 clr r21 |
||
3597 | 3612 22e2 481B sub r20,r24 |
||
3598 | 3613 22e4 590B sbc r21,r25 |
||
3599 | 3614 .L556: |
||
3600 | 3615 22e6 2091 0000 lds r18,ExternStickNick |
||
3601 | 3616 22ea 3091 0000 lds r19,(ExternStickNick)+1 |
||
3602 | 3617 22ee C901 movw r24,r18 |
||
3603 | 3618 22f0 03E0 ldi r16,3 |
||
3604 | 3619 22f2 880F 1: lsl r24 |
||
3605 | 3620 22f4 991F rol r25 |
||
3606 | 3621 22f6 0A95 dec r16 |
||
3607 | 3622 22f8 01F4 brne 1b |
||
3608 | 3623 22fa 821B sub r24,r18 |
||
3609 | 3624 22fc 930B sbc r25,r19 |
||
3610 | 3625 22fe 840F add r24,r20 |
||
3611 | 3626 2300 951F adc r25,r21 |
||
3612 | 3627 2302 68E0 ldi r22,lo8(8) |
||
3613 | 3628 2304 70E0 ldi r23,hi8(8) |
||
3614 | 3629 2306 0E94 0000 call __divmodhi4 |
||
3615 | 3630 230a 788F std Y+24,r23 |
||
3616 | 3631 230c 6F8B std Y+23,r22 |
||
3617 | 3632 230e 7093 0000 sts (ExternStickNick)+1,r23 |
||
3618 | 3633 2312 6093 0000 sts ExternStickNick,r22 |
||
3619 | 3634 2316 E4FF sbrs r30,4 |
||
3620 | 3635 2318 00C0 rjmp .L559 |
||
3621 | 3636 231a 8091 0000 lds r24,Parameter_UserParam1 |
||
3622 | 3637 231e 482F mov r20,r24 |
||
3623 | 3638 2320 5527 clr r21 |
||
3624 | 3639 2322 440F lsl r20 |
||
3625 | 3640 2324 551F rol r21 |
||
3626 | 3641 2326 440F lsl r20 |
||
3627 | 3642 2328 551F rol r21 |
||
3628 | 3643 232a 00C0 rjmp .L561 |
||
3629 | 3644 .L559: |
||
3630 | 3645 232c E5FD sbrc r30,5 |
||
3631 | 3646 232e 00C0 rjmp .+4 |
||
3632 | 3647 2330 0C94 0000 jmp .L818 |
||
3633 | 3648 2334 8091 0000 lds r24,Parameter_UserParam1 |
||
3634 | 3649 2338 9927 clr r25 |
||
3635 | 3650 233a 880F lsl r24 |
||
3636 | 3651 233c 991F rol r25 |
||
3637 | 3652 233e 880F lsl r24 |
||
3638 | 3653 2340 991F rol r25 |
||
3639 | 3654 2342 4427 clr r20 |
||
3640 | 3655 2344 5527 clr r21 |
||
3641 | 3656 2346 481B sub r20,r24 |
||
3642 | 3657 2348 590B sbc r21,r25 |
||
3643 | 3658 .L561: |
||
3644 | 3659 234a 2091 0000 lds r18,ExternStickRoll |
||
3645 | 3660 234e 3091 0000 lds r19,(ExternStickRoll)+1 |
||
3646 | 3661 2352 C901 movw r24,r18 |
||
3647 | 3662 2354 A3E0 ldi r26,3 |
||
3648 | 3663 2356 880F 1: lsl r24 |
||
3649 | 3664 2358 991F rol r25 |
||
3650 | 3665 235a AA95 dec r26 |
||
3651 | 3666 235c 01F4 brne 1b |
||
3652 | 3667 235e 821B sub r24,r18 |
||
3653 | 3668 2360 930B sbc r25,r19 |
||
3654 | 3669 2362 840F add r24,r20 |
||
3655 | 3670 2364 951F adc r25,r21 |
||
3656 | 3671 2366 68E0 ldi r22,lo8(8) |
||
3657 | 3672 2368 70E0 ldi r23,hi8(8) |
||
3658 | 3673 236a 0E94 0000 call __divmodhi4 |
||
3659 | 3674 236e 8B01 movw r16,r22 |
||
3660 | 3675 2370 7093 0000 sts (ExternStickRoll)+1,r23 |
||
3661 | 3676 2374 6093 0000 sts ExternStickRoll,r22 |
||
3662 | 3677 2378 8091 0000 lds r24,DubWiseKeys |
||
3663 | 3678 237c 282F mov r18,r24 |
||
3664 | 3679 237e 3327 clr r19 |
||
3665 | 3680 2380 23FF sbrs r18,3 |
||
3666 | 3681 2382 00C0 rjmp .L564 |
||
3667 | 3682 2384 82E3 ldi r24,lo8(50) |
||
3668 | 3683 2386 90E0 ldi r25,hi8(50) |
||
3669 | 3684 2388 00C0 rjmp .L819 |
||
3670 | 3685 .L564: |
||
3671 | 3686 238a 22FF sbrs r18,2 |
||
3672 | 3687 238c 00C0 rjmp .L567 |
||
3673 | 3688 238e 8EEC ldi r24,lo8(-50) |
||
3674 | 3689 2390 9FEF ldi r25,hi8(-50) |
||
3675 | 3690 .L819: |
||
3676 | 3691 2392 9093 0000 sts (ExternStickGier)+1,r25 |
||
3677 | 3692 2396 8093 0000 sts ExternStickGier,r24 |
||
3678 | 3693 239a 00C0 rjmp .L566 |
||
3679 | 3694 .L567: |
||
3680 | 3695 239c 1092 0000 sts (ExternStickGier)+1,__zero_reg__ |
||
3681 | 3696 23a0 1092 0000 sts ExternStickGier,__zero_reg__ |
||
3682 | 3697 .L566: |
||
3683 | 3698 23a4 21FF sbrs r18,1 |
||
3684 | 3699 23a6 00C0 rjmp .L569 |
||
3685 | 3700 23a8 8091 0000 lds r24,ExternHoehenValue |
||
3686 | 3701 23ac 9091 0000 lds r25,(ExternHoehenValue)+1 |
||
3687 | 3702 23b0 0196 adiw r24,1 |
||
3688 | 3703 23b2 9093 0000 sts (ExternHoehenValue)+1,r25 |
||
3689 | 3704 23b6 8093 0000 sts ExternHoehenValue,r24 |
||
3690 | 3705 .L569: |
||
3691 | 3706 23ba 24FF sbrs r18,4 |
||
3692 | 3707 23bc 00C0 rjmp .L571 |
||
3693 | 3708 23be 8091 0000 lds r24,ExternHoehenValue |
||
3694 | 3709 23c2 9091 0000 lds r25,(ExternHoehenValue)+1 |
||
3695 | 3710 23c6 0197 sbiw r24,1 |
||
3696 | 3711 23c8 9093 0000 sts (ExternHoehenValue)+1,r25 |
||
3697 | 3712 23cc 8093 0000 sts ExternHoehenValue,r24 |
||
3698 | 3713 .L571: |
||
3699 | 3714 23d0 2D89 ldd r18,Y+21 |
||
3700 | 3715 23d2 3E89 ldd r19,Y+22 |
||
3701 | 3716 23d4 2C9D mul r18,r12 |
||
3702 | 3717 23d6 F001 movw r30,r0 |
||
3703 | 3718 23d8 2D9D mul r18,r13 |
||
3704 | 3719 23da F00D add r31,r0 |
||
3705 | 3720 23dc 3C9D mul r19,r12 |
||
3706 | 3721 23de F00D add r31,r0 |
||
3707 | 3722 23e0 1124 clr r1 |
||
3708 | 3723 23e2 4B89 ldd r20,Y+19 |
||
3709 | 3724 23e4 5C89 ldd r21,Y+20 |
||
3710 | 3725 23e6 429D mul r20,r2 |
||
3711 | 3726 23e8 C001 movw r24,r0 |
||
3712 | 3727 23ea 439D mul r20,r3 |
||
3713 | 3728 23ec 900D add r25,r0 |
||
3714 | 3729 23ee 529D mul r21,r2 |
||
3715 | 3730 23f0 900D add r25,r0 |
||
3716 | 3731 23f2 1124 clr r1 |
||
3717 | 3732 23f4 E80F add r30,r24 |
||
3718 | 3733 23f6 F91F adc r31,r25 |
||
3719 | 3734 23f8 8F89 ldd r24,Y+23 |
||
3720 | 3735 23fa 988D ldd r25,Y+24 |
||
3721 | 3736 23fc 68E0 ldi r22,lo8(8) |
||
3722 | 3737 23fe 70E0 ldi r23,hi8(8) |
||
3723 | 3738 2400 0E94 0000 call __divmodhi4 |
||
3724 | 3739 2404 E60F add r30,r22 |
||
3725 | 3740 2406 F71F adc r31,r23 |
||
3726 | 3741 2408 FA8F std Y+26,r31 |
||
3727 | 3742 240a E98F std Y+25,r30 |
||
3728 | 3743 240c F093 0000 sts (StickNick)+1,r31 |
||
3729 | 3744 2410 E093 0000 sts StickNick,r30 |
||
3730 | 3745 2414 6989 ldd r22,Y+17 |
||
3731 | 3746 2416 7A89 ldd r23,Y+18 |
||
3732 | 3747 2418 6C9D mul r22,r12 |
||
3733 | 3748 241a 9001 movw r18,r0 |
||
3734 | 3749 241c 6D9D mul r22,r13 |
||
3735 | 3750 241e 300D add r19,r0 |
||
3736 | 3751 2420 7C9D mul r23,r12 |
||
3737 | 3752 2422 300D add r19,r0 |
||
3738 | 3753 2424 1124 clr r1 |
||
3739 | 3754 2426 E29C mul r14,r2 |
||
3740 | 3755 2428 C001 movw r24,r0 |
||
3741 | 3756 242a E39C mul r14,r3 |
||
3742 | 3757 242c 900D add r25,r0 |
||
3743 | 3758 242e F29C mul r15,r2 |
||
3744 | 3759 2430 900D add r25,r0 |
||
3745 | 3760 2432 1124 clr r1 |
||
3746 | 3761 2434 280F add r18,r24 |
||
3747 | 3762 2436 391F adc r19,r25 |
||
3748 | 3763 2438 C801 movw r24,r16 |
||
3749 | 3764 243a 68E0 ldi r22,lo8(8) |
||
3750 | 3765 243c 70E0 ldi r23,hi8(8) |
||
3751 | 3766 243e 0E94 0000 call __divmodhi4 |
||
3752 | 3767 2442 260F add r18,r22 |
||
3753 | 3768 2444 371F adc r19,r23 |
||
3754 | 3769 2446 3093 0000 sts (StickRoll)+1,r19 |
||
3755 | 3770 244a 2093 0000 sts StickRoll,r18 |
||
3756 | 3771 244e 4091 0000 lds r20,ExternStickGier |
||
3757 | 3772 2452 5091 0000 lds r21,(ExternStickGier)+1 |
||
3758 | 3773 2456 8D85 ldd r24,Y+13 |
||
3759 | 3774 2458 9E85 ldd r25,Y+14 |
||
3760 | 3775 245a 481B sub r20,r24 |
||
3761 | 3776 245c 590B sbc r21,r25 |
||
3762 | 3777 245e 5093 0000 sts (StickGier)+1,r21 |
||
3763 | 3778 2462 4093 0000 sts StickGier,r20 |
||
3764 | 3779 2466 8091 0000 lds r24,Parameter_UserParam2 |
||
3765 | 3780 246a 8B30 cpi r24,lo8(11) |
||
3766 | 3781 246c 00F0 brlo .L573 |
||
3767 | 3782 246e 8091 0000 lds r24,ControlIn+2 |
||
3768 | 3783 2472 9091 0000 lds r25,(ControlIn+2)+1 |
||
3769 | 3784 2476 E80F add r30,r24 |
||
3770 | 3785 2478 F91F adc r31,r25 |
||
3771 | 3786 247a F093 0000 sts (StickNick)+1,r31 |
||
3772 | 3787 247e E093 0000 sts StickNick,r30 |
||
3773 | 3788 2482 8091 0000 lds r24,ControlIn |
||
3774 | 3789 2486 9091 0000 lds r25,(ControlIn)+1 |
||
3775 | 3790 248a 280F add r18,r24 |
||
3776 | 3791 248c 391F adc r19,r25 |
||
3777 | 3792 248e 3093 0000 sts (StickRoll)+1,r19 |
||
3778 | 3793 2492 2093 0000 sts StickRoll,r18 |
||
3779 | 3794 2496 8091 0000 lds r24,ControlIn+4 |
||
3780 | 3795 249a 9091 0000 lds r25,(ControlIn+4)+1 |
||
3781 | 3796 249e 480F add r20,r24 |
||
3782 | 3797 24a0 591F adc r21,r25 |
||
3783 | 3798 24a2 5093 0000 sts (StickGier)+1,r21 |
||
3784 | 3799 24a6 4093 0000 sts StickGier,r20 |
||
3785 | 3800 .L573: |
||
3786 | 3801 24aa 8091 0000 lds r24,EE_Parameter+8 |
||
3787 | 3802 24ae 82FF sbrs r24,2 |
||
3788 | 3803 24b0 00C0 rjmp .L575 |
||
3789 | 3804 24b2 80E0 ldi r24,lo8(0x0) |
||
3790 | 3805 24b4 90E0 ldi r25,hi8(0x0) |
||
3791 | 3806 24b6 A0E0 ldi r26,hlo8(0x0) |
||
3792 | 3807 24b8 B0E0 ldi r27,hhi8(0x0) |
||
3793 | 3808 24ba 8093 0000 sts IntegralFaktor,r24 |
||
3794 | 3809 24be 9093 0000 sts (IntegralFaktor)+1,r25 |
||
3795 | 3810 24c2 A093 0000 sts (IntegralFaktor)+2,r26 |
||
3796 | 3811 24c6 B093 0000 sts (IntegralFaktor)+3,r27 |
||
3797 | 3812 .L575: |
||
3798 | 3813 24ca 20E0 ldi r18,lo8(0x0) |
||
3799 | 3814 24cc 30E0 ldi r19,hi8(0x0) |
||
3800 | 3815 24ce 40E0 ldi r20,hlo8(0x0) |
||
3801 | 3816 24d0 50E0 ldi r21,hhi8(0x0) |
||
3802 | 3817 24d2 C301 movw r24,r6 |
||
3803 | 3818 24d4 B201 movw r22,r4 |
||
3804 | 3819 24d6 0E94 0000 call __ltsf2 |
||
3805 | 3820 24da 8823 tst r24 |
||
3806 | 3821 24dc 04F4 brge .L577 |
||
3807 | 3822 24de 80E0 ldi r24,lo8(0x0) |
||
3808 | 3823 24e0 90E0 ldi r25,hi8(0x0) |
||
3809 | 3824 24e2 A0E0 ldi r26,hlo8(0x0) |
||
3810 | 3825 24e4 B0E0 ldi r27,hhi8(0x0) |
||
3811 | 3826 24e6 8093 0000 sts GyroFaktor,r24 |
||
3812 | 3827 24ea 9093 0000 sts (GyroFaktor)+1,r25 |
||
3813 | 3828 24ee A093 0000 sts (GyroFaktor)+2,r26 |
||
3814 | 3829 24f2 B093 0000 sts (GyroFaktor)+3,r27 |
||
3815 | 3830 .L577: |
||
3816 | 3831 24f6 20E0 ldi r18,lo8(0x0) |
||
3817 | 3832 24f8 30E0 ldi r19,hi8(0x0) |
||
3818 | 3833 24fa 40E0 ldi r20,hlo8(0x0) |
||
3819 | 3834 24fc 50E0 ldi r21,hhi8(0x0) |
||
3820 | 3835 24fe 6091 0000 lds r22,IntegralFaktor |
||
3821 | 3836 2502 7091 0000 lds r23,(IntegralFaktor)+1 |
||
3822 | 3837 2506 8091 0000 lds r24,(IntegralFaktor)+2 |
||
3823 | 3838 250a 9091 0000 lds r25,(IntegralFaktor)+3 |
||
3824 | 3839 250e 0E94 0000 call __ltsf2 |
||
3825 | 3840 2512 8823 tst r24 |
||
3826 | 3841 2514 04F4 brge .L580 |
||
3827 | 3842 2516 80E0 ldi r24,lo8(0x0) |
||
3828 | 3843 2518 90E0 ldi r25,hi8(0x0) |
||
3829 | 3844 251a A0E0 ldi r26,hlo8(0x0) |
||
3830 | 3845 251c B0E0 ldi r27,hhi8(0x0) |
||
3831 | 3846 251e 8093 0000 sts IntegralFaktor,r24 |
||
3832 | 3847 2522 9093 0000 sts (IntegralFaktor)+1,r25 |
||
3833 | 3848 2526 A093 0000 sts (IntegralFaktor)+2,r26 |
||
3834 | 3849 252a B093 0000 sts (IntegralFaktor)+3,r27 |
||
3835 | 3850 .L580: |
||
3836 | 3851 252e 8091 0000 lds r24,EE_Parameter+52 |
||
3837 | 3852 2532 682F mov r22,r24 |
||
3838 | 3853 2534 7727 clr r23 |
||
3839 | 3854 2536 8B01 movw r16,r22 |
||
3840 | 3855 2538 0470 andi r16,lo8(4) |
||
3841 | 3856 253a 1070 andi r17,hi8(4) |
||
3842 | 3857 253c 62FD sbrc r22,2 |
||
3843 | 3858 253e 00C0 rjmp .L583 |
||
3844 | 3859 2540 63FD sbrc r22,3 |
||
3845 | 3860 2542 00C0 rjmp .L583 |
||
3846 | 3861 2544 8091 0000 lds r24,IntegralNick |
||
3847 | 3862 2548 9091 0000 lds r25,(IntegralNick)+1 |
||
3848 | 3863 254c A091 0000 lds r26,(IntegralNick)+2 |
||
3849 | 3864 2550 B091 0000 lds r27,(IntegralNick)+3 |
||
3850 | 3865 2554 8156 subi r24,lo8(60001) |
||
3851 | 3866 2556 9A4E sbci r25,hi8(60001) |
||
3852 | 3867 2558 A040 sbci r26,hlo8(60001) |
||
3853 | 3868 255a B040 sbci r27,hhi8(60001) |
||
3854 | 3869 255c 04F0 brlt .L586 |
||
3855 | 3870 255e 2091 0000 lds r18,StickNick |
||
3856 | 3871 2562 3091 0000 lds r19,(StickNick)+1 |
||
3857 | 3872 2566 C601 movw r24,r12 |
||
3858 | 3873 2568 F3E0 ldi r31,3 |
||
3859 | 3874 256a 880F 1: lsl r24 |
||
3860 | 3875 256c 991F rol r25 |
||
3861 | 3876 256e FA95 dec r31 |
||
3862 | 3877 2570 01F4 brne 1b |
||
3863 | 3878 2572 281B sub r18,r24 |
||
3864 | 3879 2574 390B sbc r19,r25 |
||
3865 | 3880 2576 3093 0000 sts (StickNick)+1,r19 |
||
3866 | 3881 257a 2093 0000 sts StickNick,r18 |
||
3867 | 3882 257e 8091 0000 lds r24,IntegralNick |
||
3868 | 3883 2582 9091 0000 lds r25,(IntegralNick)+1 |
||
3869 | 3884 2586 A091 0000 lds r26,(IntegralNick)+2 |
||
3870 | 3885 258a B091 0000 lds r27,(IntegralNick)+3 |
||
3871 | 3886 258e 8158 subi r24,lo8(80001) |
||
3872 | 3887 2590 9843 sbci r25,hi8(80001) |
||
3873 | 3888 2592 A140 sbci r26,hlo8(80001) |
||
3874 | 3889 2594 B040 sbci r27,hhi8(80001) |
||
3875 | 3890 2596 04F0 brlt .L588 |
||
3876 | 3891 2598 00C0 rjmp .L820 |
||
3877 | 3892 .L586: |
||
3878 | 3893 259a 8091 0000 lds r24,IntegralNick |
||
3879 | 3894 259e 9091 0000 lds r25,(IntegralNick)+1 |
||
3880 | 3895 25a2 A091 0000 lds r26,(IntegralNick)+2 |
||
3881 | 3896 25a6 B091 0000 lds r27,(IntegralNick)+3 |
||
3882 | 3897 25aa 805A subi r24,lo8(-60000) |
||
3883 | 3898 25ac 9541 sbci r25,hi8(-60000) |
||
3884 | 3899 25ae AF4F sbci r26,hlo8(-60000) |
||
3885 | 3900 25b0 BF4F sbci r27,hhi8(-60000) |
||
3886 | 3901 25b2 04F4 brge .L588 |
||
3887 | 3902 25b4 2091 0000 lds r18,StickNick |
||
3888 | 3903 25b8 3091 0000 lds r19,(StickNick)+1 |
||
3889 | 3904 25bc C601 movw r24,r12 |
||
3890 | 3905 25be E3E0 ldi r30,3 |
||
3891 | 3906 25c0 880F 1: lsl r24 |
||
3892 | 3907 25c2 991F rol r25 |
||
3893 | 3908 25c4 EA95 dec r30 |
||
3894 | 3909 25c6 01F4 brne 1b |
||
3895 | 3910 25c8 280F add r18,r24 |
||
3896 | 3911 25ca 391F adc r19,r25 |
||
3897 | 3912 25cc 3093 0000 sts (StickNick)+1,r19 |
||
3898 | 3913 25d0 2093 0000 sts StickNick,r18 |
||
3899 | 3914 25d4 8091 0000 lds r24,IntegralNick |
||
3900 | 3915 25d8 9091 0000 lds r25,(IntegralNick)+1 |
||
3901 | 3916 25dc A091 0000 lds r26,(IntegralNick)+2 |
||
3902 | 3917 25e0 B091 0000 lds r27,(IntegralNick)+3 |
||
3903 | 3918 25e4 8158 subi r24,lo8(80001) |
||
3904 | 3919 25e6 9843 sbci r25,hi8(80001) |
||
3905 | 3920 25e8 A140 sbci r26,hlo8(80001) |
||
3906 | 3921 25ea B040 sbci r27,hhi8(80001) |
||
3907 | 3922 25ec 04F0 brlt .L588 |
||
3908 | 3923 .L820: |
||
3909 | 3924 25ee C601 movw r24,r12 |
||
3910 | 3925 25f0 74E0 ldi r23,4 |
||
3911 | 3926 25f2 880F 1: lsl r24 |
||
3912 | 3927 25f4 991F rol r25 |
||
3913 | 3928 25f6 7A95 dec r23 |
||
3914 | 3929 25f8 01F4 brne 1b |
||
3915 | 3930 25fa 281B sub r18,r24 |
||
3916 | 3931 25fc 390B sbc r19,r25 |
||
3917 | 3932 25fe 3093 0000 sts (StickNick)+1,r19 |
||
3918 | 3933 2602 2093 0000 sts StickNick,r18 |
||
3919 | 3934 .L588: |
||
3920 | 3935 2606 8091 0000 lds r24,IntegralRoll |
||
3921 | 3936 260a 9091 0000 lds r25,(IntegralRoll)+1 |
||
3922 | 3937 260e A091 0000 lds r26,(IntegralRoll)+2 |
||
3923 | 3938 2612 B091 0000 lds r27,(IntegralRoll)+3 |
||
3924 | 3939 2616 8156 subi r24,lo8(60001) |
||
3925 | 3940 2618 9A4E sbci r25,hi8(60001) |
||
3926 | 3941 261a A040 sbci r26,hlo8(60001) |
||
3927 | 3942 261c B040 sbci r27,hhi8(60001) |
||
3928 | 3943 261e 04F0 brlt .L592 |
||
3929 | 3944 2620 2091 0000 lds r18,StickRoll |
||
3930 | 3945 2624 3091 0000 lds r19,(StickRoll)+1 |
||
3931 | 3946 2628 C601 movw r24,r12 |
||
3932 | 3947 262a 53E0 ldi r21,3 |
||
3933 | 3948 262c 880F 1: lsl r24 |
||
3934 | 3949 262e 991F rol r25 |
||
3935 | 3950 2630 5A95 dec r21 |
||
3936 | 3951 2632 01F4 brne 1b |
||
3937 | 3952 2634 281B sub r18,r24 |
||
3938 | 3953 2636 390B sbc r19,r25 |
||
3939 | 3954 2638 3093 0000 sts (StickRoll)+1,r19 |
||
3940 | 3955 263c 2093 0000 sts StickRoll,r18 |
||
3941 | 3956 2640 8091 0000 lds r24,IntegralRoll |
||
3942 | 3957 2644 9091 0000 lds r25,(IntegralRoll)+1 |
||
3943 | 3958 2648 A091 0000 lds r26,(IntegralRoll)+2 |
||
3944 | 3959 264c B091 0000 lds r27,(IntegralRoll)+3 |
||
3945 | 3960 2650 8158 subi r24,lo8(80001) |
||
3946 | 3961 2652 9843 sbci r25,hi8(80001) |
||
3947 | 3962 2654 A140 sbci r26,hlo8(80001) |
||
3948 | 3963 2656 B040 sbci r27,hhi8(80001) |
||
3949 | 3964 2658 04F0 brlt .L583 |
||
3950 | 3965 265a 00C0 rjmp .L821 |
||
3951 | 3966 .L592: |
||
3952 | 3967 265c 8091 0000 lds r24,IntegralRoll |
||
3953 | 3968 2660 9091 0000 lds r25,(IntegralRoll)+1 |
||
3954 | 3969 2664 A091 0000 lds r26,(IntegralRoll)+2 |
||
3955 | 3970 2668 B091 0000 lds r27,(IntegralRoll)+3 |
||
3956 | 3971 266c 805A subi r24,lo8(-60000) |
||
3957 | 3972 266e 9541 sbci r25,hi8(-60000) |
||
3958 | 3973 2670 AF4F sbci r26,hlo8(-60000) |
||
3959 | 3974 2672 BF4F sbci r27,hhi8(-60000) |
||
3960 | 3975 2674 04F4 brge .L583 |
||
3961 | 3976 2676 2091 0000 lds r18,StickRoll |
||
3962 | 3977 267a 3091 0000 lds r19,(StickRoll)+1 |
||
3963 | 3978 267e C601 movw r24,r12 |
||
3964 | 3979 2680 43E0 ldi r20,3 |
||
3965 | 3980 2682 880F 1: lsl r24 |
||
3966 | 3981 2684 991F rol r25 |
||
3967 | 3982 2686 4A95 dec r20 |
||
3968 | 3983 2688 01F4 brne 1b |
||
3969 | 3984 268a 280F add r18,r24 |
||
3970 | 3985 268c 391F adc r19,r25 |
||
3971 | 3986 268e 3093 0000 sts (StickRoll)+1,r19 |
||
3972 | 3987 2692 2093 0000 sts StickRoll,r18 |
||
3973 | 3988 2696 8091 0000 lds r24,IntegralRoll |
||
3974 | 3989 269a 9091 0000 lds r25,(IntegralRoll)+1 |
||
3975 | 3990 269e A091 0000 lds r26,(IntegralRoll)+2 |
||
3976 | 3991 26a2 B091 0000 lds r27,(IntegralRoll)+3 |
||
3977 | 3992 26a6 8158 subi r24,lo8(80001) |
||
3978 | 3993 26a8 9843 sbci r25,hi8(80001) |
||
3979 | 3994 26aa A140 sbci r26,hlo8(80001) |
||
3980 | 3995 26ac B040 sbci r27,hhi8(80001) |
||
3981 | 3996 26ae 04F0 brlt .L583 |
||
3982 | 3997 .L821: |
||
3983 | 3998 26b0 B4E0 ldi r27,4 |
||
3984 | 3999 26b2 CC0C 1: lsl r12 |
||
3985 | 4000 26b4 DD1C rol r13 |
||
3986 | 4001 26b6 BA95 dec r27 |
||
3987 | 4002 26b8 01F4 brne 1b |
||
3988 | 4003 26ba 2C19 sub r18,r12 |
||
3989 | 4004 26bc 3D09 sbc r19,r13 |
||
3990 | 4005 26be 3093 0000 sts (StickRoll)+1,r19 |
||
3991 | 4006 26c2 2093 0000 sts StickRoll,r18 |
||
3992 | 4007 .L583: |
||
3993 | 4008 26c6 F501 movw r30,r10 |
||
3994 | 4009 26c8 EE0F lsl r30 |
||
3995 | 4010 26ca FF1F rol r31 |
||
3996 | 4011 26cc E050 subi r30,lo8(-(PPM_in)) |
||
3997 | 4012 26ce F040 sbci r31,hi8(-(PPM_in)) |
||
3998 | 4013 26d0 2081 ld r18,Z |
||
3999 | 4014 26d2 3181 ldd r19,Z+1 |
||
4000 | 4015 26d4 8091 0000 lds r24,EE_Parameter+39 |
||
4001 | 4016 26d8 482F mov r20,r24 |
||
4002 | 4017 26da 5527 clr r21 |
||
4003 | 4018 26dc 4217 cp r20,r18 |
||
4004 | 4019 26de 5307 cpc r21,r19 |
||
4005 | 4020 26e0 04F4 brge .L597 |
||
4006 | 4021 26e2 012B or r16,r17 |
||
4007 | 4022 26e4 01F0 breq .L597 |
||
4008 | 4023 26e6 81E0 ldi r24,lo8(1) |
||
4009 | 4024 26e8 8093 0000 sts Looping_Links,r24 |
||
4010 | 4025 26ec 00C0 rjmp .L600 |
||
4011 | 4026 .L597: |
||
4012 | 4027 26ee F501 movw r30,r10 |
||
4013 | 4028 26f0 EE0F lsl r30 |
||
4014 | 4029 26f2 FF1F rol r31 |
||
4015 | 4030 26f4 E050 subi r30,lo8(-(PPM_in)) |
||
4016 | 4031 26f6 F040 sbci r31,hi8(-(PPM_in)) |
||
4017 | 4032 26f8 2081 ld r18,Z |
||
4018 | 4033 26fa 3181 ldd r19,Z+1 |
||
4019 | 4034 26fc 8091 0000 lds r24,EE_Parameter+40 |
||
4020 | 4035 2700 DA01 movw r26,r20 |
||
4021 | 4036 2702 A81B sub r26,r24 |
||
4022 | 4037 2704 B109 sbc r27,__zero_reg__ |
||
4023 | 4038 2706 2A17 cp r18,r26 |
||
4024 | 4039 2708 3B07 cpc r19,r27 |
||
4025 | 4040 270a 04F4 brge .L600 |
||
4026 | 4041 270c 1092 0000 sts Looping_Links,__zero_reg__ |
||
4027 | 4042 .L600: |
||
4028 | 4043 2710 F501 movw r30,r10 |
||
4029 | 4044 2712 EE0F lsl r30 |
||
4030 | 4045 2714 FF1F rol r31 |
||
4031 | 4046 2716 E050 subi r30,lo8(-(PPM_in)) |
||
4032 | 4047 2718 F040 sbci r31,hi8(-(PPM_in)) |
||
4033 | 4048 271a 8081 ld r24,Z |
||
4034 | 4049 271c 9181 ldd r25,Z+1 |
||
4035 | 4050 271e AA27 clr r26 |
||
4036 | 4051 2720 BB27 clr r27 |
||
4037 | 4052 2722 A41B sub r26,r20 |
||
4038 | 4053 2724 B50B sbc r27,r21 |
||
4039 | 4054 2726 8A17 cp r24,r26 |
||
4040 | 4055 2728 9B07 cpc r25,r27 |
||
4041 | 4056 272a 04F4 brge .L602 |
||
4042 | 4057 272c 63FF sbrs r22,3 |
||
4043 | 4058 272e 00C0 rjmp .L602 |
||
4044 | 4059 2730 81E0 ldi r24,lo8(1) |
||
4045 | 4060 2732 8093 0000 sts Looping_Rechts,r24 |
||
4046 | 4061 2736 00C0 rjmp .L605 |
||
4047 | 4062 .L602: |
||
4048 | 4063 2738 8091 0000 lds r24,Looping_Rechts |
||
4049 | 4064 273c 8823 tst r24 |
||
4050 | 4065 273e 01F0 breq .L605 |
||
4051 | 4066 2740 AA0C lsl r10 |
||
4052 | 4067 2742 BB1C rol r11 |
||
4053 | 4068 2744 E0E0 ldi r30,lo8(PPM_in) |
||
4054 | 4069 2746 F0E0 ldi r31,hi8(PPM_in) |
||
4055 | 4070 2748 AE0E add r10,r30 |
||
4056 | 4071 274a BF1E adc r11,r31 |
||
4057 | 4072 274c F501 movw r30,r10 |
||
4058 | 4073 274e 2081 ld r18,Z |
||
4059 | 4074 2750 3181 ldd r19,Z+1 |
||
4060 | 4075 2752 8091 0000 lds r24,EE_Parameter+40 |
||
4061 | 4076 2756 9927 clr r25 |
||
4062 | 4077 2758 841B sub r24,r20 |
||
4063 | 4078 275a 950B sbc r25,r21 |
||
4064 | 4079 275c 8217 cp r24,r18 |
||
4065 | 4080 275e 9307 cpc r25,r19 |
||
4066 | 4081 2760 04F4 brge .L605 |
||
4067 | 4082 2762 1092 0000 sts Looping_Rechts,__zero_reg__ |
||
4068 | 4083 .L605: |
||
4069 | 4084 2766 F401 movw r30,r8 |
||
4070 | 4085 2768 EE0F lsl r30 |
||
4071 | 4086 276a FF1F rol r31 |
||
4072 | 4087 276c E050 subi r30,lo8(-(PPM_in)) |
||
4073 | 4088 276e F040 sbci r31,hi8(-(PPM_in)) |
||
4074 | 4089 2770 8081 ld r24,Z |
||
4075 | 4090 2772 9181 ldd r25,Z+1 |
||
4076 | 4091 2774 4817 cp r20,r24 |
||
4077 | 4092 2776 5907 cpc r21,r25 |
||
4078 | 4093 2778 04F4 brge .L608 |
||
4079 | 4094 277a 60FF sbrs r22,0 |
||
4080 | 4095 277c 00C0 rjmp .L608 |
||
4081 | 4096 277e 81E0 ldi r24,lo8(1) |
||
4082 | 4097 2780 8093 0000 sts Looping_Oben,r24 |
||
4083 | 4098 2784 00C0 rjmp .L611 |
||
4084 | 4099 .L608: |
||
4085 | 4100 2786 8091 0000 lds r24,Looping_Oben |
||
4086 | 4101 278a 8823 tst r24 |
||
4087 | 4102 278c 01F0 breq .L611 |
||
4088 | 4103 278e F401 movw r30,r8 |
||
4089 | 4104 2790 EE0F lsl r30 |
||
4090 | 4105 2792 FF1F rol r31 |
||
4091 | 4106 2794 E050 subi r30,lo8(-(PPM_in)) |
||
4092 | 4107 2796 F040 sbci r31,hi8(-(PPM_in)) |
||
4093 | 4108 2798 2081 ld r18,Z |
||
4094 | 4109 279a 3181 ldd r19,Z+1 |
||
4095 | 4110 279c 8091 0000 lds r24,EE_Parameter+40 |
||
4096 | 4111 27a0 FA01 movw r30,r20 |
||
4097 | 4112 27a2 E81B sub r30,r24 |
||
4098 | 4113 27a4 F109 sbc r31,__zero_reg__ |
||
4099 | 4114 27a6 2E17 cp r18,r30 |
||
4100 | 4115 27a8 3F07 cpc r19,r31 |
||
4101 | 4116 27aa 04F4 brge .L611 |
||
4102 | 4117 27ac 1092 0000 sts Looping_Oben,__zero_reg__ |
||
4103 | 4118 .L611: |
||
4104 | 4119 27b0 F401 movw r30,r8 |
||
4105 | 4120 27b2 EE0F lsl r30 |
||
4106 | 4121 27b4 FF1F rol r31 |
||
4107 | 4122 27b6 E050 subi r30,lo8(-(PPM_in)) |
||
4108 | 4123 27b8 F040 sbci r31,hi8(-(PPM_in)) |
||
4109 | 4124 27ba 8081 ld r24,Z |
||
4110 | 4125 27bc 9181 ldd r25,Z+1 |
||
4111 | 4126 27be 8A17 cp r24,r26 |
||
4112 | 4127 27c0 9B07 cpc r25,r27 |
||
4113 | 4128 27c2 04F4 brge .L614 |
||
4114 | 4129 27c4 61FF sbrs r22,1 |
||
4115 | 4130 27c6 00C0 rjmp .L614 |
||
4116 | 4131 27c8 81E0 ldi r24,lo8(1) |
||
4117 | 4132 27ca 8093 0000 sts Looping_Unten,r24 |
||
4118 | 4133 27ce 00C0 rjmp .L617 |
||
4119 | 4134 .L614: |
||
4120 | 4135 27d0 8091 0000 lds r24,Looping_Unten |
||
4121 | 4136 27d4 8823 tst r24 |
||
4122 | 4137 27d6 01F0 breq .L617 |
||
4123 | 4138 27d8 880C lsl r8 |
||
4124 | 4139 27da 991C rol r9 |
||
4125 | 4140 27dc 20E0 ldi r18,lo8(PPM_in) |
||
4126 | 4141 27de 30E0 ldi r19,hi8(PPM_in) |
||
4127 | 4142 27e0 820E add r8,r18 |
||
4128 | 4143 27e2 931E adc r9,r19 |
||
4129 | 4144 27e4 D401 movw r26,r8 |
||
4130 | 4145 27e6 2D91 ld r18,X+ |
||
4131 | 4146 27e8 3C91 ld r19,X |
||
4132 | 4147 27ea 8091 0000 lds r24,EE_Parameter+40 |
||
4133 | 4148 27ee 9927 clr r25 |
||
4134 | 4149 27f0 841B sub r24,r20 |
||
4135 | 4150 27f2 950B sbc r25,r21 |
||
4136 | 4151 27f4 8217 cp r24,r18 |
||
4137 | 4152 27f6 9307 cpc r25,r19 |
||
4138 | 4153 27f8 04F4 brge .L617 |
||
4139 | 4154 27fa 1092 0000 sts Looping_Unten,__zero_reg__ |
||
4140 | 4155 .L617: |
||
4141 | 4156 27fe 8091 0000 lds r24,Looping_Links |
||
4142 | 4157 2802 8823 tst r24 |
||
4143 | 4158 2804 01F4 brne .L620 |
||
4144 | 4159 2806 8091 0000 lds r24,Looping_Rechts |
||
4145 | 4160 280a 8823 tst r24 |
||
4146 | 4161 280c 01F0 breq .L622 |
||
4147 | 4162 .L620: |
||
4148 | 4163 280e 81E0 ldi r24,lo8(1) |
||
4149 | 4164 2810 8093 0000 sts Looping_Roll,r24 |
||
4150 | 4165 2814 00C0 rjmp .L623 |
||
4151 | 4166 .L622: |
||
4152 | 4167 2816 1092 0000 sts Looping_Roll,__zero_reg__ |
||
4153 | 4168 .L623: |
||
4154 | 4169 281a 8091 0000 lds r24,Looping_Oben |
||
4155 | 4170 281e 8823 tst r24 |
||
4156 | 4171 2820 01F4 brne .L624 |
||
4157 | 4172 2822 8091 0000 lds r24,Looping_Unten |
||
4158 | 4173 2826 8823 tst r24 |
||
4159 | 4174 2828 01F0 breq .L626 |
||
4160 | 4175 .L624: |
||
4161 | 4176 282a 81E0 ldi r24,lo8(1) |
||
4162 | 4177 282c 8093 0000 sts Looping_Nick,r24 |
||
4163 | 4178 2830 1092 0000 sts Looping_Roll,__zero_reg__ |
||
4164 | 4179 2834 1092 0000 sts Looping_Links,__zero_reg__ |
||
4165 | 4180 2838 1092 0000 sts Looping_Rechts,__zero_reg__ |
||
4166 | 4181 283c 00C0 rjmp .L627 |
||
4167 | 4182 .L626: |
||
4168 | 4183 283e 1092 0000 sts Looping_Nick,__zero_reg__ |
||
4169 | 4184 .L549: |
||
4170 | 4185 2842 8091 0000 lds r24,Looping_Roll |
||
4171 | 4186 2846 8823 tst r24 |
||
4172 | 4187 2848 01F4 brne .+4 |
||
4173 | 4188 284a 0C94 0000 jmp .L628 |
||
4174 | 4189 284e 84E6 ldi r24,lo8(100) |
||
4175 | 4190 2850 90E0 ldi r25,hi8(100) |
||
4176 | 4191 2852 9093 0000 sts (beeptime)+1,r25 |
||
4177 | 4192 2856 8093 0000 sts beeptime,r24 |
||
4178 | 4193 .L627: |
||
4179 | 4194 285a 8091 0000 lds r24,EE_Parameter+38 |
||
4180 | 4195 285e 9927 clr r25 |
||
4181 | 4196 2860 E981 ldd r30,Y+1 |
||
4182 | 4197 2862 FA81 ldd r31,Y+2 |
||
4183 | 4198 2864 8E17 cp r24,r30 |
||
4184 | 4199 2866 9F07 cpc r25,r31 |
||
4185 | 4200 2868 04F4 brge .L630 |
||
4186 | 4201 286a 9A83 std Y+2,r25 |
||
4187 | 4202 286c 8983 std Y+1,r24 |
||
4188 | 4203 .L630: |
||
4189 | 4204 286e 2090 0000 lds r2,Notlandung |
||
4190 | 4205 2872 2220 tst r2 |
||
4191 | 4206 2874 01F0 breq .L632 |
||
4192 | 4207 2876 1092 0000 sts (StickGier)+1,__zero_reg__ |
||
4193 | 4208 287a 1092 0000 sts StickGier,__zero_reg__ |
||
4194 | 4209 287e 1092 0000 sts (StickNick)+1,__zero_reg__ |
||
4195 | 4210 2882 1092 0000 sts StickNick,__zero_reg__ |
||
4196 | 4211 2886 1092 0000 sts (StickRoll)+1,__zero_reg__ |
||
4197 | 4212 288a 1092 0000 sts StickRoll,__zero_reg__ |
||
4198 | 4213 288e 8DEC ldi r24,lo8(0x3dcccccd) |
||
4199 | 4214 2890 9CEC ldi r25,hi8(0x3dcccccd) |
||
4200 | 4215 2892 ACEC ldi r26,hlo8(0x3dcccccd) |
||
4201 | 4216 2894 BDE3 ldi r27,hhi8(0x3dcccccd) |
||
4202 | 4217 2896 8093 0000 sts GyroFaktor,r24 |
||
4203 | 4218 289a 9093 0000 sts (GyroFaktor)+1,r25 |
||
4204 | 4219 289e A093 0000 sts (GyroFaktor)+2,r26 |
||
4205 | 4220 28a2 B093 0000 sts (GyroFaktor)+3,r27 |
||
4206 | 4221 28a6 8AE0 ldi r24,lo8(0x3ba3d70a) |
||
4207 | 4222 28a8 97ED ldi r25,hi8(0x3ba3d70a) |
||
4208 | 4223 28aa A3EA ldi r26,hlo8(0x3ba3d70a) |
||
4209 | 4224 28ac BBE3 ldi r27,hhi8(0x3ba3d70a) |
||
4210 | 4225 28ae 8093 0000 sts IntegralFaktor,r24 |
||
4211 | 4226 28b2 9093 0000 sts (IntegralFaktor)+1,r25 |
||
4212 | 4227 28b6 A093 0000 sts (IntegralFaktor)+2,r26 |
||
4213 | 4228 28ba B093 0000 sts (IntegralFaktor)+3,r27 |
||
4214 | 4229 28be 1092 0000 sts Looping_Roll,__zero_reg__ |
||
4215 | 4230 28c2 1092 0000 sts Looping_Nick,__zero_reg__ |
||
4216 | 4231 .L632: |
||
4217 | 4232 28c6 8091 0000 lds r24,MittelIntegralNick |
||
4218 | 4233 28ca 9091 0000 lds r25,(MittelIntegralNick)+1 |
||
4219 | 4234 28ce A091 0000 lds r26,(MittelIntegralNick)+2 |
||
4220 | 4235 28d2 B091 0000 lds r27,(MittelIntegralNick)+3 |
||
4221 | 4236 28d6 2091 0000 lds r18,IntegralNick |
||
4222 | 4237 28da 3091 0000 lds r19,(IntegralNick)+1 |
||
4223 | 4238 28de 4091 0000 lds r20,(IntegralNick)+2 |
||
4224 | 4239 28e2 5091 0000 lds r21,(IntegralNick)+3 |
||
4225 | 4240 28e6 820F add r24,r18 |
||
4226 | 4241 28e8 931F adc r25,r19 |
||
4227 | 4242 28ea A41F adc r26,r20 |
||
4228 | 4243 28ec B51F adc r27,r21 |
||
4229 | 4244 28ee 8093 0000 sts MittelIntegralNick,r24 |
||
4230 | 4245 28f2 9093 0000 sts (MittelIntegralNick)+1,r25 |
||
4231 | 4246 28f6 A093 0000 sts (MittelIntegralNick)+2,r26 |
||
4232 | 4247 28fa B093 0000 sts (MittelIntegralNick)+3,r27 |
||
4233 | 4248 28fe 8091 0000 lds r24,MittelIntegralRoll |
||
4234 | 4249 2902 9091 0000 lds r25,(MittelIntegralRoll)+1 |
||
4235 | 4250 2906 A091 0000 lds r26,(MittelIntegralRoll)+2 |
||
4236 | 4251 290a B091 0000 lds r27,(MittelIntegralRoll)+3 |
||
4237 | 4252 290e 2091 0000 lds r18,IntegralRoll |
||
4238 | 4253 2912 3091 0000 lds r19,(IntegralRoll)+1 |
||
4239 | 4254 2916 4091 0000 lds r20,(IntegralRoll)+2 |
||
4240 | 4255 291a 5091 0000 lds r21,(IntegralRoll)+3 |
||
4241 | 4256 291e 820F add r24,r18 |
||
4242 | 4257 2920 931F adc r25,r19 |
||
4243 | 4258 2922 A41F adc r26,r20 |
||
4244 | 4259 2924 B51F adc r27,r21 |
||
4245 | 4260 2926 8093 0000 sts MittelIntegralRoll,r24 |
||
4246 | 4261 292a 9093 0000 sts (MittelIntegralRoll)+1,r25 |
||
4247 | 4262 292e A093 0000 sts (MittelIntegralRoll)+2,r26 |
||
4248 | 4263 2932 B093 0000 sts (MittelIntegralRoll)+3,r27 |
||
4249 | 4264 2936 8091 0000 lds r24,MittelIntegralNick2 |
||
4250 | 4265 293a 9091 0000 lds r25,(MittelIntegralNick2)+1 |
||
4251 | 4266 293e A091 0000 lds r26,(MittelIntegralNick2)+2 |
||
4252 | 4267 2942 B091 0000 lds r27,(MittelIntegralNick2)+3 |
||
4253 | 4268 2946 2091 0000 lds r18,IntegralNick2 |
||
4254 | 4269 294a 3091 0000 lds r19,(IntegralNick2)+1 |
||
4255 | 4270 294e 4091 0000 lds r20,(IntegralNick2)+2 |
||
4256 | 4271 2952 5091 0000 lds r21,(IntegralNick2)+3 |
||
4257 | 4272 2956 820F add r24,r18 |
||
4258 | 4273 2958 931F adc r25,r19 |
||
4259 | 4274 295a A41F adc r26,r20 |
||
4260 | 4275 295c B51F adc r27,r21 |
||
4261 | 4276 295e 8093 0000 sts MittelIntegralNick2,r24 |
||
4262 | 4277 2962 9093 0000 sts (MittelIntegralNick2)+1,r25 |
||
4263 | 4278 2966 A093 0000 sts (MittelIntegralNick2)+2,r26 |
||
4264 | 4279 296a B093 0000 sts (MittelIntegralNick2)+3,r27 |
||
4265 | 4280 296e 8091 0000 lds r24,MittelIntegralRoll2 |
||
4266 | 4281 2972 9091 0000 lds r25,(MittelIntegralRoll2)+1 |
||
4267 | 4282 2976 A091 0000 lds r26,(MittelIntegralRoll2)+2 |
||
4268 | 4283 297a B091 0000 lds r27,(MittelIntegralRoll2)+3 |
||
4269 | 4284 297e 2091 0000 lds r18,IntegralRoll2 |
||
4270 | 4285 2982 3091 0000 lds r19,(IntegralRoll2)+1 |
||
4271 | 4286 2986 4091 0000 lds r20,(IntegralRoll2)+2 |
||
4272 | 4287 298a 5091 0000 lds r21,(IntegralRoll2)+3 |
||
4273 | 4288 298e 820F add r24,r18 |
||
4274 | 4289 2990 931F adc r25,r19 |
||
4275 | 4290 2992 A41F adc r26,r20 |
||
4276 | 4291 2994 B51F adc r27,r21 |
||
4277 | 4292 2996 8093 0000 sts MittelIntegralRoll2,r24 |
||
4278 | 4293 299a 9093 0000 sts (MittelIntegralRoll2)+1,r25 |
||
4279 | 4294 299e A093 0000 sts (MittelIntegralRoll2)+2,r26 |
||
4280 | 4295 29a2 B093 0000 sts (MittelIntegralRoll2)+3,r27 |
||
4281 | 4296 29a6 3090 0000 lds r3,Looping_Nick |
||
4282 | 4297 29aa 3320 tst r3 |
||
4283 | 4298 29ac 01F0 breq .+4 |
||
4284 | 4299 29ae 0C94 0000 jmp .L636 |
||
4285 | 4300 29b2 8091 0000 lds r24,Looping_Roll |
||
4286 | 4301 29b6 8823 tst r24 |
||
4287 | 4302 29b8 01F0 breq .+4 |
||
4288 | 4303 29ba 0C94 0000 jmp .L636 |
||
4289 | 4304 29be 0C94 0000 jmp .L816 |
||
4290 | 4305 .L639: |
||
4291 | 4306 29c2 F0EE ldi r31,lo8(-32) |
||
4292 | 4307 29c4 6F16 cp r6,r31 |
||
4293 | 4308 29c6 FFEF ldi r31,hi8(-32) |
||
4294 | 4309 29c8 7F06 cpc r7,r31 |
||
4295 | 4310 29ca FFEF ldi r31,hlo8(-32) |
||
4296 | 4311 29cc 8F06 cpc r8,r31 |
||
4297 | 4312 29ce FFEF ldi r31,hhi8(-32) |
||
4298 | 4313 29d0 9F06 cpc r9,r31 |
||
4299 | 4314 29d2 04F4 brge .L640 |
||
4300 | 4315 29d4 B0EE ldi r27,lo8(-32) |
||
4301 | 4316 29d6 6B2E mov r6,r27 |
||
4302 | 4317 29d8 BFEF ldi r27,hi8(-32) |
||
4303 | 4318 29da 7B2E mov r7,r27 |
||
4304 | 4319 29dc BFEF ldi r27,hlo8(-32) |
||
4305 | 4320 29de 8B2E mov r8,r27 |
||
4306 | 4321 29e0 BFEF ldi r27,hhi8(-32) |
||
4307 | 4322 29e2 9B2E mov r9,r27 |
||
4308 | 4323 .L640: |
||
4309 | 4324 29e4 2132 cpi r18,lo8(33) |
||
4310 | 4325 29e6 3105 cpc r19,__zero_reg__ |
||
4311 | 4326 29e8 4105 cpc r20,__zero_reg__ |
||
4312 | 4327 29ea 5105 cpc r21,__zero_reg__ |
||
4313 | 4328 29ec 04F0 brlt .L642 |
||
4314 | 4329 29ee A0E2 ldi r26,lo8(32) |
||
4315 | 4330 29f0 AA2E mov r10,r26 |
||
4316 | 4331 29f2 B12C mov r11,__zero_reg__ |
||
4317 | 4332 29f4 C12C mov r12,__zero_reg__ |
||
4318 | 4333 29f6 D12C mov r13,__zero_reg__ |
||
4319 | 4334 29f8 00C0 rjmp .L644 |
||
4320 | 4335 .L642: |
||
4321 | 4336 29fa 205E subi r18,lo8(-32) |
||
4322 | 4337 29fc 3F4F sbci r19,hi8(-32) |
||
4323 | 4338 29fe 4F4F sbci r20,hlo8(-32) |
||
4324 | 4339 2a00 5F4F sbci r21,hhi8(-32) |
||
4325 | 4340 2a02 04F4 brge .L644 |
||
4326 | 4341 2a04 F0EE ldi r31,lo8(-32) |
||
4327 | 4342 2a06 AF2E mov r10,r31 |
||
4328 | 4343 2a08 FFEF ldi r31,hi8(-32) |
||
4329 | 4344 2a0a BF2E mov r11,r31 |
||
4330 | 4345 2a0c FFEF ldi r31,hlo8(-32) |
||
4331 | 4346 2a0e CF2E mov r12,r31 |
||
4332 | 4347 2a10 FFEF ldi r31,hhi8(-32) |
||
4333 | 4348 2a12 DF2E mov r13,r31 |
||
4334 | 4349 .L644: |
||
4335 | 4350 2a14 8091 0000 lds r24,Mess_IntegralNick |
||
4336 | 4351 2a18 9091 0000 lds r25,(Mess_IntegralNick)+1 |
||
4337 | 4352 2a1c A091 0000 lds r26,(Mess_IntegralNick)+2 |
||
4338 | 4353 2a20 B091 0000 lds r27,(Mess_IntegralNick)+3 |
||
4339 | 4354 2a24 8619 sub r24,r6 |
||
4340 | 4355 2a26 9709 sbc r25,r7 |
||
4341 | 4356 2a28 A809 sbc r26,r8 |
||
4342 | 4357 2a2a B909 sbc r27,r9 |
||
4343 | 4358 2a2c 8093 0000 sts Mess_IntegralNick,r24 |
||
4344 | 4359 2a30 9093 0000 sts (Mess_IntegralNick)+1,r25 |
||
4345 | 4360 2a34 A093 0000 sts (Mess_IntegralNick)+2,r26 |
||
4346 | 4361 2a38 B093 0000 sts (Mess_IntegralNick)+3,r27 |
||
4347 | 4362 2a3c 8091 0000 lds r24,Mess_IntegralRoll |
||
4348 | 4363 2a40 9091 0000 lds r25,(Mess_IntegralRoll)+1 |
||
4349 | 4364 2a44 A091 0000 lds r26,(Mess_IntegralRoll)+2 |
||
4350 | 4365 2a48 B091 0000 lds r27,(Mess_IntegralRoll)+3 |
||
4351 | 4366 2a4c 8A19 sub r24,r10 |
||
4352 | 4367 2a4e 9B09 sbc r25,r11 |
||
4353 | 4368 2a50 AC09 sbc r26,r12 |
||
4354 | 4369 2a52 BD09 sbc r27,r13 |
||
4355 | 4370 2a54 8093 0000 sts Mess_IntegralRoll,r24 |
||
4356 | 4371 2a58 9093 0000 sts (Mess_IntegralRoll)+1,r25 |
||
4357 | 4372 2a5c A093 0000 sts (Mess_IntegralRoll)+2,r26 |
||
4358 | 4373 2a60 B093 0000 sts (Mess_IntegralRoll)+3,r27 |
||
4359 | 4374 .L638: |
||
4360 | 4375 2a64 8091 0000 lds r24,ZaehlMessungen |
||
4361 | 4376 2a68 9091 0000 lds r25,(ZaehlMessungen)+1 |
||
4362 | 4377 2a6c 8F3F cpi r24,255 |
||
4363 | 4378 2a6e 9105 cpc r25,__zero_reg__ |
||
4364 | 4379 2a70 01F0 breq .+2 |
||
4365 | 4380 2a72 00F4 brsh .+2 |
||
4366 | 4381 2a74 00C0 rjmp .L646 |
||
4367 | 4382 2a76 3320 tst r3 |
||
4368 | 4383 2a78 01F0 breq .+2 |
||
4369 | 4384 2a7a 00C0 rjmp .L648 |
||
4370 | 4385 2a7c 8091 0000 lds r24,Looping_Roll |
||
4371 | 4386 2a80 8823 tst r24 |
||
4372 | 4387 2a82 01F0 breq .+2 |
||
4373 | 4388 2a84 00C0 rjmp .L648 |
||
4374 | 4389 2a86 6091 0000 lds r22,MittelIntegralNick |
||
4375 | 4390 2a8a 7091 0000 lds r23,(MittelIntegralNick)+1 |
||
4376 | 4391 2a8e 8091 0000 lds r24,(MittelIntegralNick)+2 |
||
4377 | 4392 2a92 9091 0000 lds r25,(MittelIntegralNick)+3 |
||
4378 | 4393 2a96 20E0 ldi r18,lo8(256) |
||
4379 | 4394 2a98 31E0 ldi r19,hi8(256) |
||
4380 | 4395 2a9a 40E0 ldi r20,hlo8(256) |
||
4381 | 4396 2a9c 50E0 ldi r21,hhi8(256) |
||
4382 | 4397 2a9e 0E94 0000 call __divmodsi4 |
||
4383 | 4398 2aa2 2093 0000 sts MittelIntegralNick,r18 |
||
4384 | 4399 2aa6 3093 0000 sts (MittelIntegralNick)+1,r19 |
||
4385 | 4400 2aaa 4093 0000 sts (MittelIntegralNick)+2,r20 |
||
4386 | 4401 2aae 5093 0000 sts (MittelIntegralNick)+3,r21 |
||
4387 | 4402 2ab2 6091 0000 lds r22,MittelIntegralRoll |
||
4388 | 4403 2ab6 7091 0000 lds r23,(MittelIntegralRoll)+1 |
||
4389 | 4404 2aba 8091 0000 lds r24,(MittelIntegralRoll)+2 |
||
4390 | 4405 2abe 9091 0000 lds r25,(MittelIntegralRoll)+3 |
||
4391 | 4406 2ac2 20E0 ldi r18,lo8(256) |
||
4392 | 4407 2ac4 31E0 ldi r19,hi8(256) |
||
4393 | 4408 2ac6 40E0 ldi r20,hlo8(256) |
||
4394 | 4409 2ac8 50E0 ldi r21,hhi8(256) |
||
4395 | 4410 2aca 0E94 0000 call __divmodsi4 |
||
4396 | 4411 2ace 2093 0000 sts MittelIntegralRoll,r18 |
||
4397 | 4412 2ad2 3093 0000 sts (MittelIntegralRoll)+1,r19 |
||
4398 | 4413 2ad6 4093 0000 sts (MittelIntegralRoll)+2,r20 |
||
4399 | 4414 2ada 5093 0000 sts (MittelIntegralRoll)+3,r21 |
||
4400 | 4415 2ade E090 0000 lds r14,EE_Parameter+20 |
||
4401 | 4416 2ae2 FF24 clr r15 |
||
4402 | 4417 2ae4 0027 clr r16 |
||
4403 | 4418 2ae6 1127 clr r17 |
||
4404 | 4419 2ae8 2091 0000 lds r18,IntegralAccNick |
||
4405 | 4420 2aec 3091 0000 lds r19,(IntegralAccNick)+1 |
||
4406 | 4421 2af0 4091 0000 lds r20,(IntegralAccNick)+2 |
||
4407 | 4422 2af4 5091 0000 lds r21,(IntegralAccNick)+3 |
||
4408 | 4423 2af8 C801 movw r24,r16 |
||
4409 | 4424 2afa B701 movw r22,r14 |
||
4410 | 4425 2afc 0E94 0000 call __mulsi3 |
||
4411 | 4426 2b00 20E0 ldi r18,lo8(256) |
||
4412 | 4427 2b02 31E0 ldi r19,hi8(256) |
||
4413 | 4428 2b04 40E0 ldi r20,hlo8(256) |
||
4414 | 4429 2b06 50E0 ldi r21,hhi8(256) |
||
4415 | 4430 2b08 0E94 0000 call __divmodsi4 |
||
4416 | 4431 2b0c 2093 0000 sts IntegralAccNick,r18 |
||
4417 | 4432 2b10 3093 0000 sts (IntegralAccNick)+1,r19 |
||
4418 | 4433 2b14 4093 0000 sts (IntegralAccNick)+2,r20 |
||
4419 | 4434 2b18 5093 0000 sts (IntegralAccNick)+3,r21 |
||
4420 | 4435 2b1c 2091 0000 lds r18,IntegralAccRoll |
||
4421 | 4436 2b20 3091 0000 lds r19,(IntegralAccRoll)+1 |
||
4422 | 4437 2b24 4091 0000 lds r20,(IntegralAccRoll)+2 |
||
4423 | 4438 2b28 5091 0000 lds r21,(IntegralAccRoll)+3 |
||
4424 | 4439 2b2c C801 movw r24,r16 |
||
4425 | 4440 2b2e B701 movw r22,r14 |
||
4426 | 4441 2b30 0E94 0000 call __mulsi3 |
||
4427 | 4442 2b34 20E0 ldi r18,lo8(256) |
||
4428 | 4443 2b36 31E0 ldi r19,hi8(256) |
||
4429 | 4444 2b38 40E0 ldi r20,hlo8(256) |
||
4430 | 4445 2b3a 50E0 ldi r21,hhi8(256) |
||
4431 | 4446 2b3c 0E94 0000 call __divmodsi4 |
||
4432 | 4447 2b40 2093 0000 sts IntegralAccRoll,r18 |
||
4433 | 4448 2b44 3093 0000 sts (IntegralAccRoll)+1,r19 |
||
4434 | 4449 2b48 4093 0000 sts (IntegralAccRoll)+2,r20 |
||
4435 | 4450 2b4c 5093 0000 sts (IntegralAccRoll)+3,r21 |
||
4436 | 4451 2b50 6091 0000 lds r22,IntegralAccZ |
||
4437 | 4452 2b54 7091 0000 lds r23,(IntegralAccZ)+1 |
||
4438 | 4453 2b58 8091 0000 lds r24,(IntegralAccZ)+2 |
||
4439 | 4454 2b5c 9091 0000 lds r25,(IntegralAccZ)+3 |
||
4440 | 4455 2b60 20E0 ldi r18,lo8(256) |
||
4441 | 4456 2b62 31E0 ldi r19,hi8(256) |
||
4442 | 4457 2b64 40E0 ldi r20,hlo8(256) |
||
4443 | 4458 2b66 50E0 ldi r21,hhi8(256) |
||
4444 | 4459 2b68 0E94 0000 call __divmodsi4 |
||
4445 | 4460 2b6c 2093 0000 sts IntegralAccZ,r18 |
||
4446 | 4461 2b70 3093 0000 sts (IntegralAccZ)+1,r19 |
||
4447 | 4462 2b74 4093 0000 sts (IntegralAccZ)+2,r20 |
||
4448 | 4463 2b78 5093 0000 sts (IntegralAccZ)+3,r21 |
||
4449 | 4464 2b7c 6091 0000 lds r22,MittelIntegralNick |
||
4450 | 4465 2b80 7091 0000 lds r23,(MittelIntegralNick)+1 |
||
4451 | 4466 2b84 8091 0000 lds r24,(MittelIntegralNick)+2 |
||
4452 | 4467 2b88 9091 0000 lds r25,(MittelIntegralNick)+3 |
||
4453 | 4468 2b8c 2091 0000 lds r18,IntegralAccNick |
||
4454 | 4469 2b90 3091 0000 lds r19,(IntegralAccNick)+1 |
||
4455 | 4470 2b94 4091 0000 lds r20,(IntegralAccNick)+2 |
||
4456 | 4471 2b98 5091 0000 lds r21,(IntegralAccNick)+3 |
||
4457 | 4472 2b9c E090 0000 lds r14,EE_Parameter+45 |
||
4458 | 4473 2ba0 FF24 clr r15 |
||
4459 | 4474 2ba2 0027 clr r16 |
||
4460 | 4475 2ba4 1127 clr r17 |
||
4461 | 4476 2ba6 621B sub r22,r18 |
||
4462 | 4477 2ba8 730B sbc r23,r19 |
||
4463 | 4478 2baa 840B sbc r24,r20 |
||
4464 | 4479 2bac 950B sbc r25,r21 |
||
4465 | 4480 2bae A801 movw r20,r16 |
||
4466 | 4481 2bb0 9701 movw r18,r14 |
||
4467 | 4482 2bb2 0E94 0000 call __divmodsi4 |
||
4468 | 4483 2bb6 2093 0000 sts ausgleichNick.2584,r18 |
||
4469 | 4484 2bba 3093 0000 sts (ausgleichNick.2584)+1,r19 |
||
4470 | 4485 2bbe 4093 0000 sts (ausgleichNick.2584)+2,r20 |
||
4471 | 4486 2bc2 5093 0000 sts (ausgleichNick.2584)+3,r21 |
||
4472 | 4487 2bc6 CA01 movw r24,r20 |
||
4473 | 4488 2bc8 B901 movw r22,r18 |
||
4474 | 4489 2bca 20E0 ldi r18,lo8(256) |
||
4475 | 4490 2bcc 31E0 ldi r19,hi8(256) |
||
4476 | 4491 2bce 40E0 ldi r20,hlo8(256) |
||
4477 | 4492 2bd0 50E0 ldi r21,hhi8(256) |
||
4478 | 4493 2bd2 0E94 0000 call __divmodsi4 |
||
4479 | 4494 2bd6 2901 movw r4,r18 |
||
4480 | 4495 2bd8 3093 0000 sts (LageKorrekturNick)+1,r19 |
||
4481 | 4496 2bdc 2093 0000 sts LageKorrekturNick,r18 |
||
4482 | 4497 2be0 6091 0000 lds r22,MittelIntegralRoll |
||
4483 | 4498 2be4 7091 0000 lds r23,(MittelIntegralRoll)+1 |
||
4484 | 4499 2be8 8091 0000 lds r24,(MittelIntegralRoll)+2 |
||
4485 | 4500 2bec 9091 0000 lds r25,(MittelIntegralRoll)+3 |
||
4486 | 4501 2bf0 2091 0000 lds r18,IntegralAccRoll |
||
4487 | 4502 2bf4 3091 0000 lds r19,(IntegralAccRoll)+1 |
||
4488 | 4503 2bf8 4091 0000 lds r20,(IntegralAccRoll)+2 |
||
4489 | 4504 2bfc 5091 0000 lds r21,(IntegralAccRoll)+3 |
||
4490 | 4505 2c00 621B sub r22,r18 |
||
4491 | 4506 2c02 730B sbc r23,r19 |
||
4492 | 4507 2c04 840B sbc r24,r20 |
||
4493 | 4508 2c06 950B sbc r25,r21 |
||
4494 | 4509 2c08 A801 movw r20,r16 |
||
4495 | 4510 2c0a 9701 movw r18,r14 |
||
4496 | 4511 2c0c 0E94 0000 call __divmodsi4 |
||
4497 | 4512 2c10 7901 movw r14,r18 |
||
4498 | 4513 2c12 8A01 movw r16,r20 |
||
4499 | 4514 2c14 CA01 movw r24,r20 |
||
4500 | 4515 2c16 B901 movw r22,r18 |
||
4501 | 4516 2c18 20E0 ldi r18,lo8(256) |
||
4502 | 4517 2c1a 31E0 ldi r19,hi8(256) |
||
4503 | 4518 2c1c 40E0 ldi r20,hlo8(256) |
||
4504 | 4519 2c1e 50E0 ldi r21,hhi8(256) |
||
4505 | 4520 2c20 0E94 0000 call __divmodsi4 |
||
4506 | 4521 2c24 388F std Y+24,r19 |
||
4507 | 4522 2c26 2F8B std Y+23,r18 |
||
4508 | 4523 2c28 3093 0000 sts (LageKorrekturRoll)+1,r19 |
||
4509 | 4524 2c2c 2093 0000 sts LageKorrekturRoll,r18 |
||
4510 | 4525 2c30 6091 0000 lds r22,MittelIntegralNick2 |
||
4511 | 4526 2c34 7091 0000 lds r23,(MittelIntegralNick2)+1 |
||
4512 | 4527 2c38 8091 0000 lds r24,(MittelIntegralNick2)+2 |
||
4513 | 4528 2c3c 9091 0000 lds r25,(MittelIntegralNick2)+3 |
||
4514 | 4529 2c40 20E0 ldi r18,lo8(256) |
||
4515 | 4530 2c42 31E0 ldi r19,hi8(256) |
||
4516 | 4531 2c44 40E0 ldi r20,hlo8(256) |
||
4517 | 4532 2c46 50E0 ldi r21,hhi8(256) |
||
4518 | 4533 2c48 0E94 0000 call __divmodsi4 |
||
4519 | 4534 2c4c 2093 0000 sts MittelIntegralNick2,r18 |
||
4520 | 4535 2c50 3093 0000 sts (MittelIntegralNick2)+1,r19 |
||
4521 | 4536 2c54 4093 0000 sts (MittelIntegralNick2)+2,r20 |
||
4522 | 4537 2c58 5093 0000 sts (MittelIntegralNick2)+3,r21 |
||
4523 | 4538 2c5c 6091 0000 lds r22,MittelIntegralRoll2 |
||
4524 | 4539 2c60 7091 0000 lds r23,(MittelIntegralRoll2)+1 |
||
4525 | 4540 2c64 8091 0000 lds r24,(MittelIntegralRoll2)+2 |
||
4526 | 4541 2c68 9091 0000 lds r25,(MittelIntegralRoll2)+3 |
||
4527 | 4542 2c6c 20E0 ldi r18,lo8(256) |
||
4528 | 4543 2c6e 31E0 ldi r19,hi8(256) |
||
4529 | 4544 2c70 40E0 ldi r20,hlo8(256) |
||
4530 | 4545 2c72 50E0 ldi r21,hhi8(256) |
||
4531 | 4546 2c74 0E94 0000 call __divmodsi4 |
||
4532 | 4547 2c78 2093 0000 sts MittelIntegralRoll2,r18 |
||
4533 | 4548 2c7c 3093 0000 sts (MittelIntegralRoll2)+1,r19 |
||
4534 | 4549 2c80 4093 0000 sts (MittelIntegralRoll2)+2,r20 |
||
4535 | 4550 2c84 5093 0000 sts (MittelIntegralRoll2)+3,r21 |
||
4536 | 4551 2c88 A090 0000 lds r10,IntegralNick2 |
||
4537 | 4552 2c8c B090 0000 lds r11,(IntegralNick2)+1 |
||
4538 | 4553 2c90 C090 0000 lds r12,(IntegralNick2)+2 |
||
4539 | 4554 2c94 D090 0000 lds r13,(IntegralNick2)+3 |
||
4540 | 4555 2c98 8091 0000 lds r24,IntegralNick |
||
4541 | 4556 2c9c 9091 0000 lds r25,(IntegralNick)+1 |
||
4542 | 4557 2ca0 A091 0000 lds r26,(IntegralNick)+2 |
||
4543 | 4558 2ca4 B091 0000 lds r27,(IntegralNick)+3 |
||
4544 | 4559 2ca8 A81A sub r10,r24 |
||
4545 | 4560 2caa B90A sbc r11,r25 |
||
4546 | 4561 2cac CA0A sbc r12,r26 |
||
4547 | 4562 2cae DB0A sbc r13,r27 |
||
4548 | 4563 2cb0 A092 0000 sts tmp_long.2572,r10 |
||
4549 | 4564 2cb4 B092 0000 sts (tmp_long.2572)+1,r11 |
||
4550 | 4565 2cb8 C092 0000 sts (tmp_long.2572)+2,r12 |
||
4551 | 4566 2cbc D092 0000 sts (tmp_long.2572)+3,r13 |
||
4552 | 4567 2cc0 6090 0000 lds r6,IntegralRoll2 |
||
4553 | 4568 2cc4 7090 0000 lds r7,(IntegralRoll2)+1 |
||
4554 | 4569 2cc8 8090 0000 lds r8,(IntegralRoll2)+2 |
||
4555 | 4570 2ccc 9090 0000 lds r9,(IntegralRoll2)+3 |
||
4556 | 4571 2cd0 8091 0000 lds r24,IntegralRoll |
||
4557 | 4572 2cd4 9091 0000 lds r25,(IntegralRoll)+1 |
||
4558 | 4573 2cd8 A091 0000 lds r26,(IntegralRoll)+2 |
||
4559 | 4574 2cdc B091 0000 lds r27,(IntegralRoll)+3 |
||
4560 | 4575 2ce0 681A sub r6,r24 |
||
4561 | 4576 2ce2 790A sbc r7,r25 |
||
4562 | 4577 2ce4 8A0A sbc r8,r26 |
||
4563 | 4578 2ce6 9B0A sbc r9,r27 |
||
4564 | 4579 2ce8 6092 0000 sts tmp_long2.2573,r6 |
||
4565 | 4580 2cec 7092 0000 sts (tmp_long2.2573)+1,r7 |
||
4566 | 4581 2cf0 8092 0000 sts (tmp_long2.2573)+2,r8 |
||
4567 | 4582 2cf4 9092 0000 sts (tmp_long2.2573)+3,r9 |
||
4568 | 4583 2cf8 A092 0000 sts IntegralFehlerNick.2574,r10 |
||
4569 | 4584 2cfc B092 0000 sts (IntegralFehlerNick.2574)+1,r11 |
||
4570 | 4585 2d00 C092 0000 sts (IntegralFehlerNick.2574)+2,r12 |
||
4571 | 4586 2d04 D092 0000 sts (IntegralFehlerNick.2574)+3,r13 |
||
4572 | 4587 2d08 6092 0000 sts IntegralFehlerRoll.2575,r6 |
||
4573 | 4588 2d0c 7092 0000 sts (IntegralFehlerRoll.2575)+1,r7 |
||
4574 | 4589 2d10 8092 0000 sts (IntegralFehlerRoll.2575)+2,r8 |
||
4575 | 4590 2d14 9092 0000 sts (IntegralFehlerRoll.2575)+3,r9 |
||
4576 | 4591 2d18 8091 0000 lds r24,Mess_IntegralNick2 |
||
4577 | 4592 2d1c 9091 0000 lds r25,(Mess_IntegralNick2)+1 |
||
4578 | 4593 2d20 A091 0000 lds r26,(Mess_IntegralNick2)+2 |
||
4579 | 4594 2d24 B091 0000 lds r27,(Mess_IntegralNick2)+3 |
||
4580 | 4595 2d28 8A19 sub r24,r10 |
||
4581 | 4596 2d2a 9B09 sbc r25,r11 |
||
4582 | 4597 2d2c AC09 sbc r26,r12 |
||
4583 | 4598 2d2e BD09 sbc r27,r13 |
||
4584 | 4599 2d30 8093 0000 sts Mess_IntegralNick2,r24 |
||
4585 | 4600 2d34 9093 0000 sts (Mess_IntegralNick2)+1,r25 |
||
4586 | 4601 2d38 A093 0000 sts (Mess_IntegralNick2)+2,r26 |
||
4587 | 4602 2d3c B093 0000 sts (Mess_IntegralNick2)+3,r27 |
||
4588 | 4603 2d40 8091 0000 lds r24,Mess_IntegralRoll2 |
||
4589 | 4604 2d44 9091 0000 lds r25,(Mess_IntegralRoll2)+1 |
||
4590 | 4605 2d48 A091 0000 lds r26,(Mess_IntegralRoll2)+2 |
||
4591 | 4606 2d4c B091 0000 lds r27,(Mess_IntegralRoll2)+3 |
||
4592 | 4607 2d50 8619 sub r24,r6 |
||
4593 | 4608 2d52 9709 sbc r25,r7 |
||
4594 | 4609 2d54 A809 sbc r26,r8 |
||
4595 | 4610 2d56 B909 sbc r27,r9 |
||
4596 | 4611 2d58 8093 0000 sts Mess_IntegralRoll2,r24 |
||
4597 | 4612 2d5c 9093 0000 sts (Mess_IntegralRoll2)+1,r25 |
||
4598 | 4613 2d60 A093 0000 sts (Mess_IntegralRoll2)+2,r26 |
||
4599 | 4614 2d64 B093 0000 sts (Mess_IntegralRoll2)+3,r27 |
||
4600 | 4615 2d68 6091 0000 lds r22,IntegralAccNick |
||
4601 | 4616 2d6c 7091 0000 lds r23,(IntegralAccNick)+1 |
||
4602 | 4617 2d70 8091 0000 lds r24,(IntegralAccNick)+2 |
||
4603 | 4618 2d74 9091 0000 lds r25,(IntegralAccNick)+3 |
||
4604 | 4619 2d78 2AE1 ldi r18,lo8(26) |
||
4605 | 4620 2d7a 30E0 ldi r19,hi8(26) |
||
4606 | 4621 2d7c 40E0 ldi r20,hlo8(26) |
||
4607 | 4622 2d7e 50E0 ldi r21,hhi8(26) |
||
4608 | 4623 2d80 0E94 0000 call __divmodsi4 |
||
4609 | 4624 2d84 3093 0000 sts (DebugOut+36)+1,r19 |
||
4610 | 4625 2d88 2093 0000 sts DebugOut+36,r18 |
||
4611 | 4626 2d8c 6091 0000 lds r22,IntegralAccRoll |
||
4612 | 4627 2d90 7091 0000 lds r23,(IntegralAccRoll)+1 |
||
4613 | 4628 2d94 8091 0000 lds r24,(IntegralAccRoll)+2 |
||
4614 | 4629 2d98 9091 0000 lds r25,(IntegralAccRoll)+3 |
||
4615 | 4630 2d9c 2AE1 ldi r18,lo8(26) |
||
4616 | 4631 2d9e 30E0 ldi r19,hi8(26) |
||
4617 | 4632 2da0 40E0 ldi r20,hlo8(26) |
||
4618 | 4633 2da2 50E0 ldi r21,hhi8(26) |
||
4619 | 4634 2da4 0E94 0000 call __divmodsi4 |
||
4620 | 4635 2da8 3093 0000 sts (DebugOut+38)+1,r19 |
||
4621 | 4636 2dac 2093 0000 sts DebugOut+38,r18 |
||
4622 | 4637 2db0 B092 0000 sts (DebugOut+40)+1,r11 |
||
4623 | 4638 2db4 A092 0000 sts DebugOut+40,r10 |
||
4624 | 4639 2db8 7092 0000 sts (DebugOut+42)+1,r7 |
||
4625 | 4640 2dbc 6092 0000 sts DebugOut+42,r6 |
||
4626 | 4641 2dc0 6091 0000 lds r22,MittelIntegralNick |
||
4627 | 4642 2dc4 7091 0000 lds r23,(MittelIntegralNick)+1 |
||
4628 | 4643 2dc8 8091 0000 lds r24,(MittelIntegralNick)+2 |
||
4629 | 4644 2dcc 9091 0000 lds r25,(MittelIntegralNick)+3 |
||
4630 | 4645 2dd0 2AE1 ldi r18,lo8(26) |
||
4631 | 4646 2dd2 30E0 ldi r19,hi8(26) |
||
4632 | 4647 2dd4 40E0 ldi r20,hlo8(26) |
||
4633 | 4648 2dd6 50E0 ldi r21,hhi8(26) |
||
4634 | 4649 2dd8 0E94 0000 call __divmodsi4 |
||
4635 | 4650 2ddc 3093 0000 sts (DebugOut+44)+1,r19 |
||
4636 | 4651 2de0 2093 0000 sts DebugOut+44,r18 |
||
4637 | 4652 2de4 6091 0000 lds r22,MittelIntegralRoll |
||
4638 | 4653 2de8 7091 0000 lds r23,(MittelIntegralRoll)+1 |
||
4639 | 4654 2dec 8091 0000 lds r24,(MittelIntegralRoll)+2 |
||
4640 | 4655 2df0 9091 0000 lds r25,(MittelIntegralRoll)+3 |
||
4641 | 4656 2df4 2AE1 ldi r18,lo8(26) |
||
4642 | 4657 2df6 30E0 ldi r19,hi8(26) |
||
4643 | 4658 2df8 40E0 ldi r20,hlo8(26) |
||
4644 | 4659 2dfa 50E0 ldi r21,hhi8(26) |
||
4645 | 4660 2dfc 0E94 0000 call __divmodsi4 |
||
4646 | 4661 2e00 3093 0000 sts (DebugOut+46)+1,r19 |
||
4647 | 4662 2e04 2093 0000 sts DebugOut+46,r18 |
||
4648 | 4663 2e08 F092 0000 sts (DebugOut+60)+1,r15 |
||
4649 | 4664 2e0c E092 0000 sts DebugOut+60,r14 |
||
4650 | 4665 2e10 8F89 ldd r24,Y+23 |
||
4651 | 4666 2e12 988D ldd r25,Y+24 |
||
4652 | 4667 2e14 880F lsl r24 |
||
4653 | 4668 2e16 991F rol r25 |
||
4654 | 4669 2e18 2F89 ldd r18,Y+23 |
||
4655 | 4670 2e1a 388D ldd r19,Y+24 |
||
4656 | 4671 2e1c 73E0 ldi r23,3 |
||
4657 | 4672 2e1e 220F 1: lsl r18 |
||
4658 | 4673 2e20 331F rol r19 |
||
4659 | 4674 2e22 7A95 dec r23 |
||
4660 | 4675 2e24 01F4 brne 1b |
||
4661 | 4676 2e26 820F add r24,r18 |
||
4662 | 4677 2e28 931F adc r25,r19 |
||
4663 | 4678 2e2a 9093 0000 sts (DebugOut+62)+1,r25 |
||
4664 | 4679 2e2e 8093 0000 sts DebugOut+62,r24 |
||
4665 | 4680 2e32 81E0 ldi r24,lo8(1) |
||
4666 | 4681 2e34 90E0 ldi r25,hi8(1) |
||
4667 | 4682 2e36 9093 0000 sts (cnt.2590)+1,r25 |
||
4668 | 4683 2e3a 8093 0000 sts cnt.2590,r24 |
||
4669 | 4684 2e3e 8091 0000 lds r24,MittelIntegralNick |
||
4670 | 4685 2e42 9091 0000 lds r25,(MittelIntegralNick)+1 |
||
4671 | 4686 2e46 A091 0000 lds r26,(MittelIntegralNick)+2 |
||
4672 | 4687 2e4a B091 0000 lds r27,(MittelIntegralNick)+3 |
||
4673 | 4688 2e4e 2091 0000 lds r18,MittelIntegralNick_Alt.2595 |
||
4674 | 4689 2e52 3091 0000 lds r19,(MittelIntegralNick_Alt.2595)+1 |
||
4675 | 4690 2e56 4091 0000 lds r20,(MittelIntegralNick_Alt.2595)+2 |
||
4676 | 4691 2e5a 5091 0000 lds r21,(MittelIntegralNick_Alt.2595)+3 |
||
4677 | 4692 2e5e 281B sub r18,r24 |
||
4678 | 4693 2e60 390B sbc r19,r25 |
||
4679 | 4694 2e62 4A0B sbc r20,r26 |
||
4680 | 4695 2e64 5B0B sbc r21,r27 |
||
4681 | 4696 2e66 57FF sbrs r21,7 |
||
4682 | 4697 2e68 00C0 rjmp .L652 |
||
4683 | 4698 2e6a 5095 com r21 |
||
4684 | 4699 2e6c 4095 com r20 |
||
4685 | 4700 2e6e 3095 com r19 |
||
4686 | 4701 2e70 2195 neg r18 |
||
4687 | 4702 2e72 3F4F sbci r19,lo8(-1) |
||
4688 | 4703 2e74 4F4F sbci r20,lo8(-1) |
||
4689 | 4704 2e76 5F4F sbci r21,lo8(-1) |
||
4690 | 4705 .L652: |
||
4691 | 4706 2e78 2052 subi r18,lo8(20000) |
||
4692 | 4707 2e7a 3E44 sbci r19,hi8(20000) |
||
4693 | 4708 2e7c 4040 sbci r20,hlo8(20000) |
||
4694 | 4709 2e7e 5040 sbci r21,hhi8(20000) |
||
4695 | 4710 2e80 04F0 brlt .+2 |
||
4696 | 4711 2e82 00C0 rjmp .L651 |
||
4697 | 4712 2e84 81E0 ldi r24,lo8(4097) |
||
4698 | 4713 2e86 A816 cp r10,r24 |
||
4699 | 4714 2e88 80E1 ldi r24,hi8(4097) |
||
4700 | 4715 2e8a B806 cpc r11,r24 |
||
4701 | 4716 2e8c 80E0 ldi r24,hlo8(4097) |
||
4702 | 4717 2e8e C806 cpc r12,r24 |
||
4703 | 4718 2e90 80E0 ldi r24,hhi8(4097) |
||
4704 | 4719 2e92 D806 cpc r13,r24 |
||
4705 | 4720 2e94 04F4 brge .+2 |
||
4706 | 4721 2e96 00C0 rjmp .L654 |
||
4707 | 4722 2e98 8091 0000 lds r24,last_n_p.2591 |
||
4708 | 4723 2e9c 8823 tst r24 |
||
4709 | 4724 2e9e 01F4 brne .+2 |
||
4710 | 4725 2ea0 00C0 rjmp .L656 |
||
4711 | 4726 2ea2 D601 movw r26,r12 |
||
4712 | 4727 2ea4 C501 movw r24,r10 |
||
4713 | 4728 2ea6 6CE0 ldi r22,12 |
||
4714 | 4729 2ea8 B595 1: asr r27 |
||
4715 | 4730 2eaa A795 ror r26 |
||
4716 | 4731 2eac 9795 ror r25 |
||
4717 | 4732 2eae 8795 ror r24 |
||
4718 | 4733 2eb0 6A95 dec r22 |
||
4719 | 4734 2eb2 01F4 brne 1b |
||
4720 | 4735 2eb4 0196 adiw r24,1 |
||
4721 | 4736 2eb6 9093 0000 sts (cnt.2590)+1,r25 |
||
4722 | 4737 2eba 8093 0000 sts cnt.2590,r24 |
||
4723 | 4738 2ebe D601 movw r26,r12 |
||
4724 | 4739 2ec0 C501 movw r24,r10 |
||
4725 | 4740 2ec2 53E0 ldi r21,3 |
||
4726 | 4741 2ec4 B595 1: asr r27 |
||
4727 | 4742 2ec6 A795 ror r26 |
||
4728 | 4743 2ec8 9795 ror r25 |
||
4729 | 4744 2eca 8795 ror r24 |
||
4730 | 4745 2ecc 5A95 dec r21 |
||
4731 | 4746 2ece 01F4 brne 1b |
||
4732 | 4747 2ed0 8093 0000 sts ausgleichNick.2584,r24 |
||
4733 | 4748 2ed4 9093 0000 sts (ausgleichNick.2584)+1,r25 |
||
4734 | 4749 2ed8 A093 0000 sts (ausgleichNick.2584)+2,r26 |
||
4735 | 4750 2edc B093 0000 sts (ausgleichNick.2584)+3,r27 |
||
4736 | 4751 2ee0 8958 subi r24,lo8(5001) |
||
4737 | 4752 2ee2 9341 sbci r25,hi8(5001) |
||
4738 | 4753 2ee4 A040 sbci r26,hlo8(5001) |
||
4739 | 4754 2ee6 B040 sbci r27,hhi8(5001) |
||
4740 | 4755 2ee8 04F0 brlt .L658 |
||
4741 | 4756 2eea 88E8 ldi r24,lo8(5000) |
||
4742 | 4757 2eec 93E1 ldi r25,hi8(5000) |
||
4743 | 4758 2eee A0E0 ldi r26,hlo8(5000) |
||
4744 | 4759 2ef0 B0E0 ldi r27,hhi8(5000) |
||
4745 | 4760 2ef2 8093 0000 sts ausgleichNick.2584,r24 |
||
4746 | 4761 2ef6 9093 0000 sts (ausgleichNick.2584)+1,r25 |
||
4747 | 4762 2efa A093 0000 sts (ausgleichNick.2584)+2,r26 |
||
4748 | 4763 2efe B093 0000 sts (ausgleichNick.2584)+3,r27 |
||
4749 | 4764 .L658: |
||
4750 | 4765 2f02 6091 0000 lds r22,ausgleichNick.2584 |
||
4751 | 4766 2f06 7091 0000 lds r23,(ausgleichNick.2584)+1 |
||
4752 | 4767 2f0a 8091 0000 lds r24,(ausgleichNick.2584)+2 |
||
4753 | 4768 2f0e 9091 0000 lds r25,(ausgleichNick.2584)+3 |
||
4754 | 4769 2f12 20E0 ldi r18,lo8(256) |
||
4755 | 4770 2f14 31E0 ldi r19,hi8(256) |
||
4756 | 4771 2f16 40E0 ldi r20,hlo8(256) |
||
4757 | 4772 2f18 50E0 ldi r21,hhi8(256) |
||
4758 | 4773 2f1a 0E94 0000 call __divmodsi4 |
||
4759 | 4774 2f1e 420E add r4,r18 |
||
4760 | 4775 2f20 531E adc r5,r19 |
||
4761 | 4776 2f22 5092 0000 sts (LageKorrekturNick)+1,r5 |
||
4762 | 4777 2f26 4092 0000 sts LageKorrekturNick,r4 |
||
4763 | 4778 2f2a 00C0 rjmp .L660 |
||
4764 | 4779 .L656: |
||
4765 | 4780 2f2c 81E0 ldi r24,lo8(1) |
||
4766 | 4781 2f2e 8093 0000 sts last_n_p.2591,r24 |
||
4767 | 4782 2f32 00C0 rjmp .L660 |
||
4768 | 4783 .L654: |
||
4769 | 4784 2f34 1092 0000 sts last_n_p.2591,__zero_reg__ |
||
4770 | 4785 2f38 F0E0 ldi r31,lo8(-4096) |
||
4771 | 4786 2f3a AF16 cp r10,r31 |
||
4772 | 4787 2f3c F0EF ldi r31,hi8(-4096) |
||
4773 | 4788 2f3e BF06 cpc r11,r31 |
||
4774 | 4789 2f40 FFEF ldi r31,hlo8(-4096) |
||
4775 | 4790 2f42 CF06 cpc r12,r31 |
||
4776 | 4791 2f44 FFEF ldi r31,hhi8(-4096) |
||
4777 | 4792 2f46 DF06 cpc r13,r31 |
||
4778 | 4793 2f48 04F0 brlt .+2 |
||
4779 | 4794 2f4a 00C0 rjmp .L660 |
||
4780 | 4795 2f4c 8091 0000 lds r24,last_n_n.2592 |
||
4781 | 4796 2f50 8823 tst r24 |
||
4782 | 4797 2f52 01F4 brne .+2 |
||
4783 | 4798 2f54 00C0 rjmp .L662 |
||
4784 | 4799 2f56 8827 clr r24 |
||
4785 | 4800 2f58 9927 clr r25 |
||
4786 | 4801 2f5a DC01 movw r26,r24 |
||
4787 | 4802 2f5c 8A19 sub r24,r10 |
||
4788 | 4803 2f5e 9B09 sbc r25,r11 |
||
4789 | 4804 2f60 AC09 sbc r26,r12 |
||
4790 | 4805 2f62 BD09 sbc r27,r13 |
||
4791 | 4806 2f64 4CE0 ldi r20,12 |
||
4792 | 4807 2f66 B595 1: asr r27 |
||
4793 | 4808 2f68 A795 ror r26 |
||
4794 | 4809 2f6a 9795 ror r25 |
||
4795 | 4810 2f6c 8795 ror r24 |
||
4796 | 4811 2f6e 4A95 dec r20 |
||
4797 | 4812 2f70 01F4 brne 1b |
||
4798 | 4813 2f72 0196 adiw r24,1 |
||
4799 | 4814 2f74 9093 0000 sts (cnt.2590)+1,r25 |
||
4800 | 4815 2f78 8093 0000 sts cnt.2590,r24 |
||
4801 | 4816 2f7c C601 movw r24,r12 |
||
4802 | 4817 2f7e B501 movw r22,r10 |
||
4803 | 4818 2f80 28E0 ldi r18,lo8(8) |
||
4804 | 4819 2f82 30E0 ldi r19,hi8(8) |
||
4805 | 4820 2f84 40E0 ldi r20,hlo8(8) |
||
4806 | 4821 2f86 50E0 ldi r21,hhi8(8) |
||
4807 | 4822 2f88 0E94 0000 call __divmodsi4 |
||
4808 | 4823 2f8c 2093 0000 sts ausgleichNick.2584,r18 |
||
4809 | 4824 2f90 3093 0000 sts (ausgleichNick.2584)+1,r19 |
||
4810 | 4825 2f94 4093 0000 sts (ausgleichNick.2584)+2,r20 |
||
4811 | 4826 2f98 5093 0000 sts (ausgleichNick.2584)+3,r21 |
||
4812 | 4827 2f9c 2857 subi r18,lo8(-5000) |
||
4813 | 4828 2f9e 3C4E sbci r19,hi8(-5000) |
||
4814 | 4829 2fa0 4F4F sbci r20,hlo8(-5000) |
||
4815 | 4830 2fa2 5F4F sbci r21,hhi8(-5000) |
||
4816 | 4831 2fa4 04F4 brge .L664 |
||
4817 | 4832 2fa6 88E7 ldi r24,lo8(-5000) |
||
4818 | 4833 2fa8 9CEE ldi r25,hi8(-5000) |
||
4819 | 4834 2faa AFEF ldi r26,hlo8(-5000) |
||
4820 | 4835 2fac BFEF ldi r27,hhi8(-5000) |
||
4821 | 4836 2fae 8093 0000 sts ausgleichNick.2584,r24 |
||
4822 | 4837 2fb2 9093 0000 sts (ausgleichNick.2584)+1,r25 |
||
4823 | 4838 2fb6 A093 0000 sts (ausgleichNick.2584)+2,r26 |
||
4824 | 4839 2fba B093 0000 sts (ausgleichNick.2584)+3,r27 |
||
4825 | 4840 .L664: |
||
4826 | 4841 2fbe 6091 0000 lds r22,ausgleichNick.2584 |
||
4827 | 4842 2fc2 7091 0000 lds r23,(ausgleichNick.2584)+1 |
||
4828 | 4843 2fc6 8091 0000 lds r24,(ausgleichNick.2584)+2 |
||
4829 | 4844 2fca 9091 0000 lds r25,(ausgleichNick.2584)+3 |
||
4830 | 4845 2fce 20E0 ldi r18,lo8(256) |
||
4831 | 4846 2fd0 31E0 ldi r19,hi8(256) |
||
4832 | 4847 2fd2 40E0 ldi r20,hlo8(256) |
||
4833 | 4848 2fd4 50E0 ldi r21,hhi8(256) |
||
4834 | 4849 2fd6 0E94 0000 call __divmodsi4 |
||
4835 | 4850 2fda 420E add r4,r18 |
||
4836 | 4851 2fdc 531E adc r5,r19 |
||
4837 | 4852 2fde 5092 0000 sts (LageKorrekturNick)+1,r5 |
||
4838 | 4853 2fe2 4092 0000 sts LageKorrekturNick,r4 |
||
4839 | 4854 2fe6 00C0 rjmp .L666 |
||
4840 | 4855 .L662: |
||
4841 | 4856 2fe8 81E0 ldi r24,lo8(1) |
||
4842 | 4857 2fea 8093 0000 sts last_n_n.2592,r24 |
||
4843 | 4858 2fee 00C0 rjmp .L666 |
||
4844 | 4859 .L660: |
||
4845 | 4860 2ff0 1092 0000 sts last_n_n.2592,__zero_reg__ |
||
4846 | 4861 2ff4 00C0 rjmp .L666 |
||
4847 | 4862 .L651: |
||
4848 | 4863 2ff6 1092 0000 sts (cnt.2590)+1,__zero_reg__ |
||
4849 | 4864 2ffa 1092 0000 sts cnt.2590,__zero_reg__ |
||
4850 | 4865 .L666: |
||
4851 | 4866 2ffe 8091 0000 lds r24,EE_Parameter+46 |
||
4852 | 4867 3002 082F mov r16,r24 |
||
4853 | 4868 3004 1127 clr r17 |
||
4854 | 4869 3006 8091 0000 lds r24,cnt.2590 |
||
4855 | 4870 300a 9091 0000 lds r25,(cnt.2590)+1 |
||
4856 | 4871 300e 0817 cp r16,r24 |
||
4857 | 4872 3010 1907 cpc r17,r25 |
||
4858 | 4873 3012 04F4 brge .L667 |
||
4859 | 4874 3014 1093 0000 sts (cnt.2590)+1,r17 |
||
4860 | 4875 3018 0093 0000 sts cnt.2590,r16 |
||
4861 | 4876 .L667: |
||
4862 | 4877 301c 71E0 ldi r23,lo8(1025) |
||
4863 | 4878 301e A716 cp r10,r23 |
||
4864 | 4879 3020 74E0 ldi r23,hi8(1025) |
||
4865 | 4880 3022 B706 cpc r11,r23 |
||
4866 | 4881 3024 70E0 ldi r23,hlo8(1025) |
||
4867 | 4882 3026 C706 cpc r12,r23 |
||
4868 | 4883 3028 70E0 ldi r23,hhi8(1025) |
||
4869 | 4884 302a D706 cpc r13,r23 |
||
4870 | 4885 302c 04F0 brlt .L669 |
||
4871 | 4886 302e 8091 0000 lds r24,AdNeutralNick |
||
4872 | 4887 3032 9091 0000 lds r25,(AdNeutralNick)+1 |
||
4873 | 4888 3036 2091 0000 lds r18,cnt.2590 |
||
4874 | 4889 303a 3091 0000 lds r19,(cnt.2590)+1 |
||
4875 | 4890 303e 820F add r24,r18 |
||
4876 | 4891 3040 931F adc r25,r19 |
||
4877 | 4892 3042 00C0 rjmp .L822 |
||
4878 | 4893 .L669: |
||
4879 | 4894 3044 80E0 ldi r24,lo8(-1024) |
||
4880 | 4895 3046 A816 cp r10,r24 |
||
4881 | 4896 3048 8CEF ldi r24,hi8(-1024) |
||
4882 | 4897 304a B806 cpc r11,r24 |
||
4883 | 4898 304c 8FEF ldi r24,hlo8(-1024) |
||
4884 | 4899 304e C806 cpc r12,r24 |
||
4885 | 4900 3050 8FEF ldi r24,hhi8(-1024) |
||
4886 | 4901 3052 D806 cpc r13,r24 |
||
4887 | 4902 3054 04F4 brge .L671 |
||
4888 | 4903 3056 8091 0000 lds r24,AdNeutralNick |
||
4889 | 4904 305a 9091 0000 lds r25,(AdNeutralNick)+1 |
||
4890 | 4905 305e 2091 0000 lds r18,cnt.2590 |
||
4891 | 4906 3062 3091 0000 lds r19,(cnt.2590)+1 |
||
4892 | 4907 3066 821B sub r24,r18 |
||
4893 | 4908 3068 930B sbc r25,r19 |
||
4894 | 4909 .L822: |
||
4895 | 4910 306a 9093 0000 sts (AdNeutralNick)+1,r25 |
||
4896 | 4911 306e 8093 0000 sts AdNeutralNick,r24 |
||
4897 | 4912 .L671: |
||
4898 | 4913 3072 81E0 ldi r24,lo8(1) |
||
4899 | 4914 3074 90E0 ldi r25,hi8(1) |
||
4900 | 4915 3076 9093 0000 sts (cnt.2590)+1,r25 |
||
4901 | 4916 307a 8093 0000 sts cnt.2590,r24 |
||
4902 | 4917 307e 1092 0000 sts ausgleichRoll.2585,__zero_reg__ |
||
4903 | 4918 3082 1092 0000 sts (ausgleichRoll.2585)+1,__zero_reg__ |
||
4904 | 4919 3086 1092 0000 sts (ausgleichRoll.2585)+2,__zero_reg__ |
||
4905 | 4920 308a 1092 0000 sts (ausgleichRoll.2585)+3,__zero_reg__ |
||
4906 | 4921 308e 8091 0000 lds r24,MittelIntegralRoll |
||
4907 | 4922 3092 9091 0000 lds r25,(MittelIntegralRoll)+1 |
||
4908 | 4923 3096 A091 0000 lds r26,(MittelIntegralRoll)+2 |
||
4909 | 4924 309a B091 0000 lds r27,(MittelIntegralRoll)+3 |
||
4910 | 4925 309e 2091 0000 lds r18,MittelIntegralRoll_Alt.2596 |
||
4911 | 4926 30a2 3091 0000 lds r19,(MittelIntegralRoll_Alt.2596)+1 |
||
4912 | 4927 30a6 4091 0000 lds r20,(MittelIntegralRoll_Alt.2596)+2 |
||
4913 | 4928 30aa 5091 0000 lds r21,(MittelIntegralRoll_Alt.2596)+3 |
||
4914 | 4929 30ae 281B sub r18,r24 |
||
4915 | 4930 30b0 390B sbc r19,r25 |
||
4916 | 4931 30b2 4A0B sbc r20,r26 |
||
4917 | 4932 30b4 5B0B sbc r21,r27 |
||
4918 | 4933 30b6 57FF sbrs r21,7 |
||
4919 | 4934 30b8 00C0 rjmp .L674 |
||
4920 | 4935 30ba 5095 com r21 |
||
4921 | 4936 30bc 4095 com r20 |
||
4922 | 4937 30be 3095 com r19 |
||
4923 | 4938 30c0 2195 neg r18 |
||
4924 | 4939 30c2 3F4F sbci r19,lo8(-1) |
||
4925 | 4940 30c4 4F4F sbci r20,lo8(-1) |
||
4926 | 4941 30c6 5F4F sbci r21,lo8(-1) |
||
4927 | 4942 .L674: |
||
4928 | 4943 30c8 2052 subi r18,lo8(20000) |
||
4929 | 4944 30ca 3E44 sbci r19,hi8(20000) |
||
4930 | 4945 30cc 4040 sbci r20,hlo8(20000) |
||
4931 | 4946 30ce 5040 sbci r21,hhi8(20000) |
||
4932 | 4947 30d0 04F0 brlt .+2 |
||
4933 | 4948 30d2 00C0 rjmp .L673 |
||
4934 | 4949 30d4 A1E0 ldi r26,lo8(4097) |
||
4935 | 4950 30d6 6A16 cp r6,r26 |
||
4936 | 4951 30d8 A0E1 ldi r26,hi8(4097) |
||
4937 | 4952 30da 7A06 cpc r7,r26 |
||
4938 | 4953 30dc A0E0 ldi r26,hlo8(4097) |
||
4939 | 4954 30de 8A06 cpc r8,r26 |
||
4940 | 4955 30e0 A0E0 ldi r26,hhi8(4097) |
||
4941 | 4956 30e2 9A06 cpc r9,r26 |
||
4942 | 4957 30e4 04F4 brge .+2 |
||
4943 | 4958 30e6 00C0 rjmp .L676 |
||
4944 | 4959 30e8 8091 0000 lds r24,last_r_p.2593 |
||
4945 | 4960 30ec 8823 tst r24 |
||
4946 | 4961 30ee 01F4 brne .+2 |
||
4947 | 4962 30f0 00C0 rjmp .L678 |
||
4948 | 4963 30f2 D401 movw r26,r8 |
||
4949 | 4964 30f4 C301 movw r24,r6 |
||
4950 | 4965 30f6 3CE0 ldi r19,12 |
||
4951 | 4966 30f8 B595 1: asr r27 |
||
4952 | 4967 30fa A795 ror r26 |
||
4953 | 4968 30fc 9795 ror r25 |
||
4954 | 4969 30fe 8795 ror r24 |
||
4955 | 4970 3100 3A95 dec r19 |
||
4956 | 4971 3102 01F4 brne 1b |
||
4957 | 4972 3104 0196 adiw r24,1 |
||
4958 | 4973 3106 9093 0000 sts (cnt.2590)+1,r25 |
||
4959 | 4974 310a 8093 0000 sts cnt.2590,r24 |
||
4960 | 4975 310e D401 movw r26,r8 |
||
4961 | 4976 3110 C301 movw r24,r6 |
||
4962 | 4977 3112 23E0 ldi r18,3 |
||
4963 | 4978 3114 B595 1: asr r27 |
||
4964 | 4979 3116 A795 ror r26 |
||
4965 | 4980 3118 9795 ror r25 |
||
4966 | 4981 311a 8795 ror r24 |
||
4967 | 4982 311c 2A95 dec r18 |
||
4968 | 4983 311e 01F4 brne 1b |
||
4969 | 4984 3120 8093 0000 sts ausgleichRoll.2585,r24 |
||
4970 | 4985 3124 9093 0000 sts (ausgleichRoll.2585)+1,r25 |
||
4971 | 4986 3128 A093 0000 sts (ausgleichRoll.2585)+2,r26 |
||
4972 | 4987 312c B093 0000 sts (ausgleichRoll.2585)+3,r27 |
||
4973 | 4988 3130 8958 subi r24,lo8(5001) |
||
4974 | 4989 3132 9341 sbci r25,hi8(5001) |
||
4975 | 4990 3134 A040 sbci r26,hlo8(5001) |
||
4976 | 4991 3136 B040 sbci r27,hhi8(5001) |
||
4977 | 4992 3138 04F0 brlt .L680 |
||
4978 | 4993 313a 88E8 ldi r24,lo8(5000) |
||
4979 | 4994 313c 93E1 ldi r25,hi8(5000) |
||
4980 | 4995 313e A0E0 ldi r26,hlo8(5000) |
||
4981 | 4996 3140 B0E0 ldi r27,hhi8(5000) |
||
4982 | 4997 3142 8093 0000 sts ausgleichRoll.2585,r24 |
||
4983 | 4998 3146 9093 0000 sts (ausgleichRoll.2585)+1,r25 |
||
4984 | 4999 314a A093 0000 sts (ausgleichRoll.2585)+2,r26 |
||
4985 | 5000 314e B093 0000 sts (ausgleichRoll.2585)+3,r27 |
||
4986 | 5001 .L680: |
||
4987 | 5002 3152 6091 0000 lds r22,ausgleichRoll.2585 |
||
4988 | 5003 3156 7091 0000 lds r23,(ausgleichRoll.2585)+1 |
||
4989 | 5004 315a 8091 0000 lds r24,(ausgleichRoll.2585)+2 |
||
4990 | 5005 315e 9091 0000 lds r25,(ausgleichRoll.2585)+3 |
||
4991 | 5006 3162 20E0 ldi r18,lo8(256) |
||
4992 | 5007 3164 31E0 ldi r19,hi8(256) |
||
4993 | 5008 3166 40E0 ldi r20,hlo8(256) |
||
4994 | 5009 3168 50E0 ldi r21,hhi8(256) |
||
4995 | 5010 316a 0E94 0000 call __divmodsi4 |
||
4996 | 5011 316e 6F89 ldd r22,Y+23 |
||
4997 | 5012 3170 788D ldd r23,Y+24 |
||
4998 | 5013 3172 620F add r22,r18 |
||
4999 | 5014 3174 731F adc r23,r19 |
||
5000 | 5015 3176 7093 0000 sts (LageKorrekturRoll)+1,r23 |
||
5001 | 5016 317a 6093 0000 sts LageKorrekturRoll,r22 |
||
5002 | 5017 317e 00C0 rjmp .L682 |
||
5003 | 5018 .L678: |
||
5004 | 5019 3180 81E0 ldi r24,lo8(1) |
||
5005 | 5020 3182 8093 0000 sts last_r_p.2593,r24 |
||
5006 | 5021 3186 00C0 rjmp .L682 |
||
5007 | 5022 .L676: |
||
5008 | 5023 3188 1092 0000 sts last_r_p.2593,__zero_reg__ |
||
5009 | 5024 318c 70E0 ldi r23,lo8(-4096) |
||
5010 | 5025 318e 6716 cp r6,r23 |
||
5011 | 5026 3190 70EF ldi r23,hi8(-4096) |
||
5012 | 5027 3192 7706 cpc r7,r23 |
||
5013 | 5028 3194 7FEF ldi r23,hlo8(-4096) |
||
5014 | 5029 3196 8706 cpc r8,r23 |
||
5015 | 5030 3198 7FEF ldi r23,hhi8(-4096) |
||
5016 | 5031 319a 9706 cpc r9,r23 |
||
5017 | 5032 319c 04F0 brlt .+2 |
||
5018 | 5033 319e 00C0 rjmp .L682 |
||
5019 | 5034 31a0 8091 0000 lds r24,last_r_n.2594 |
||
5020 | 5035 31a4 8823 tst r24 |
||
5021 | 5036 31a6 01F4 brne .+2 |
||
5022 | 5037 31a8 00C0 rjmp .L684 |
||
5023 | 5038 31aa 8827 clr r24 |
||
5024 | 5039 31ac 9927 clr r25 |
||
5025 | 5040 31ae DC01 movw r26,r24 |
||
5026 | 5041 31b0 8619 sub r24,r6 |
||
5027 | 5042 31b2 9709 sbc r25,r7 |
||
5028 | 5043 31b4 A809 sbc r26,r8 |
||
5029 | 5044 31b6 B909 sbc r27,r9 |
||
5030 | 5045 31b8 FCE0 ldi r31,12 |
||
5031 | 5046 31ba B595 1: asr r27 |
||
5032 | 5047 31bc A795 ror r26 |
||
5033 | 5048 31be 9795 ror r25 |
||
5034 | 5049 31c0 8795 ror r24 |
||
5035 | 5050 31c2 FA95 dec r31 |
||
5036 | 5051 31c4 01F4 brne 1b |
||
5037 | 5052 31c6 0196 adiw r24,1 |
||
5038 | 5053 31c8 9093 0000 sts (cnt.2590)+1,r25 |
||
5039 | 5054 31cc 8093 0000 sts cnt.2590,r24 |
||
5040 | 5055 31d0 C401 movw r24,r8 |
||
5041 | 5056 31d2 B301 movw r22,r6 |
||
5042 | 5057 31d4 28E0 ldi r18,lo8(8) |
||
5043 | 5058 31d6 30E0 ldi r19,hi8(8) |
||
5044 | 5059 31d8 40E0 ldi r20,hlo8(8) |
||
5045 | 5060 31da 50E0 ldi r21,hhi8(8) |
||
5046 | 5061 31dc 0E94 0000 call __divmodsi4 |
||
5047 | 5062 31e0 2093 0000 sts ausgleichRoll.2585,r18 |
||
5048 | 5063 31e4 3093 0000 sts (ausgleichRoll.2585)+1,r19 |
||
5049 | 5064 31e8 4093 0000 sts (ausgleichRoll.2585)+2,r20 |
||
5050 | 5065 31ec 5093 0000 sts (ausgleichRoll.2585)+3,r21 |
||
5051 | 5066 31f0 2857 subi r18,lo8(-5000) |
||
5052 | 5067 31f2 3C4E sbci r19,hi8(-5000) |
||
5053 | 5068 31f4 4F4F sbci r20,hlo8(-5000) |
||
5054 | 5069 31f6 5F4F sbci r21,hhi8(-5000) |
||
5055 | 5070 31f8 04F4 brge .L686 |
||
5056 | 5071 31fa 88E7 ldi r24,lo8(-5000) |
||
5057 | 5072 31fc 9CEE ldi r25,hi8(-5000) |
||
5058 | 5073 31fe AFEF ldi r26,hlo8(-5000) |
||
5059 | 5074 3200 BFEF ldi r27,hhi8(-5000) |
||
5060 | 5075 3202 8093 0000 sts ausgleichRoll.2585,r24 |
||
5061 | 5076 3206 9093 0000 sts (ausgleichRoll.2585)+1,r25 |
||
5062 | 5077 320a A093 0000 sts (ausgleichRoll.2585)+2,r26 |
||
5063 | 5078 320e B093 0000 sts (ausgleichRoll.2585)+3,r27 |
||
5064 | 5079 .L686: |
||
5065 | 5080 3212 6091 0000 lds r22,ausgleichRoll.2585 |
||
5066 | 5081 3216 7091 0000 lds r23,(ausgleichRoll.2585)+1 |
||
5067 | 5082 321a 8091 0000 lds r24,(ausgleichRoll.2585)+2 |
||
5068 | 5083 321e 9091 0000 lds r25,(ausgleichRoll.2585)+3 |
||
5069 | 5084 3222 20E0 ldi r18,lo8(256) |
||
5070 | 5085 3224 31E0 ldi r19,hi8(256) |
||
5071 | 5086 3226 40E0 ldi r20,hlo8(256) |
||
5072 | 5087 3228 50E0 ldi r21,hhi8(256) |
||
5073 | 5088 322a 0E94 0000 call __divmodsi4 |
||
5074 | 5089 322e AF89 ldd r26,Y+23 |
||
5075 | 5090 3230 B88D ldd r27,Y+24 |
||
5076 | 5091 3232 A20F add r26,r18 |
||
5077 | 5092 3234 B31F adc r27,r19 |
||
5078 | 5093 3236 B093 0000 sts (LageKorrekturRoll)+1,r27 |
||
5079 | 5094 323a A093 0000 sts LageKorrekturRoll,r26 |
||
5080 | 5095 323e 00C0 rjmp .L688 |
||
5081 | 5096 .L684: |
||
5082 | 5097 3240 81E0 ldi r24,lo8(1) |
||
5083 | 5098 3242 8093 0000 sts last_r_n.2594,r24 |
||
5084 | 5099 3246 00C0 rjmp .L688 |
||
5085 | 5100 .L682: |
||
5086 | 5101 3248 1092 0000 sts last_r_n.2594,__zero_reg__ |
||
5087 | 5102 324c 00C0 rjmp .L688 |
||
5088 | 5103 .L673: |
||
5089 | 5104 324e 1092 0000 sts (cnt.2590)+1,__zero_reg__ |
||
5090 | 5105 3252 1092 0000 sts cnt.2590,__zero_reg__ |
||
5091 | 5106 .L688: |
||
5092 | 5107 3256 8091 0000 lds r24,ausgleichRoll.2585 |
||
5093 | 5108 325a 9091 0000 lds r25,(ausgleichRoll.2585)+1 |
||
5094 | 5109 325e 9093 0000 sts (DebugOut+56)+1,r25 |
||
5095 | 5110 3262 8093 0000 sts DebugOut+56,r24 |
||
5096 | 5111 3266 8091 0000 lds r24,cnt.2590 |
||
5097 | 5112 326a 9091 0000 lds r25,(cnt.2590)+1 |
||
5098 | 5113 326e 0817 cp r16,r24 |
||
5099 | 5114 3270 1907 cpc r17,r25 |
||
5100 | 5115 3272 04F4 brge .L689 |
||
5101 | 5116 3274 1093 0000 sts (cnt.2590)+1,r17 |
||
5102 | 5117 3278 0093 0000 sts cnt.2590,r16 |
||
5103 | 5118 .L689: |
||
5104 | 5119 327c B1E0 ldi r27,lo8(1025) |
||
5105 | 5120 327e 6B16 cp r6,r27 |
||
5106 | 5121 3280 B4E0 ldi r27,hi8(1025) |
||
5107 | 5122 3282 7B06 cpc r7,r27 |
||
5108 | 5123 3284 B0E0 ldi r27,hlo8(1025) |
||
5109 | 5124 3286 8B06 cpc r8,r27 |
||
5110 | 5125 3288 B0E0 ldi r27,hhi8(1025) |
||
5111 | 5126 328a 9B06 cpc r9,r27 |
||
5112 | 5127 328c 04F0 brlt .L691 |
||
5113 | 5128 328e 8091 0000 lds r24,AdNeutralRoll |
||
5114 | 5129 3292 9091 0000 lds r25,(AdNeutralRoll)+1 |
||
5115 | 5130 3296 2091 0000 lds r18,cnt.2590 |
||
5116 | 5131 329a 3091 0000 lds r19,(cnt.2590)+1 |
||
5117 | 5132 329e 820F add r24,r18 |
||
5118 | 5133 32a0 931F adc r25,r19 |
||
5119 | 5134 32a2 00C0 rjmp .L823 |
||
5120 | 5135 .L691: |
||
5121 | 5136 32a4 E0E0 ldi r30,lo8(-1024) |
||
5122 | 5137 32a6 6E16 cp r6,r30 |
||
5123 | 5138 32a8 ECEF ldi r30,hi8(-1024) |
||
5124 | 5139 32aa 7E06 cpc r7,r30 |
||
5125 | 5140 32ac EFEF ldi r30,hlo8(-1024) |
||
5126 | 5141 32ae 8E06 cpc r8,r30 |
||
5127 | 5142 32b0 EFEF ldi r30,hhi8(-1024) |
||
5128 | 5143 32b2 9E06 cpc r9,r30 |
||
5129 | 5144 32b4 04F4 brge .L693 |
||
5130 | 5145 32b6 8091 0000 lds r24,AdNeutralRoll |
||
5131 | 5146 32ba 9091 0000 lds r25,(AdNeutralRoll)+1 |
||
5132 | 5147 32be 2091 0000 lds r18,cnt.2590 |
||
5133 | 5148 32c2 3091 0000 lds r19,(cnt.2590)+1 |
||
5134 | 5149 32c6 821B sub r24,r18 |
||
5135 | 5150 32c8 930B sbc r25,r19 |
||
5136 | 5151 .L823: |
||
5137 | 5152 32ca 9093 0000 sts (AdNeutralRoll)+1,r25 |
||
5138 | 5153 32ce 8093 0000 sts AdNeutralRoll,r24 |
||
5139 | 5154 .L693: |
||
5140 | 5155 32d2 8091 0000 lds r24,AdNeutralNick |
||
5141 | 5156 32d6 9091 0000 lds r25,(AdNeutralNick)+1 |
||
5142 | 5157 32da 9093 0000 sts (DebugOut+48)+1,r25 |
||
5143 | 5158 32de 8093 0000 sts DebugOut+48,r24 |
||
5144 | 5159 32e2 8091 0000 lds r24,AdNeutralRoll |
||
5145 | 5160 32e6 9091 0000 lds r25,(AdNeutralRoll)+1 |
||
5146 | 5161 32ea 2091 0000 lds r18,StartNeutralRoll |
||
5147 | 5162 32ee 3091 0000 lds r19,(StartNeutralRoll)+1 |
||
5148 | 5163 32f2 821B sub r24,r18 |
||
5149 | 5164 32f4 930B sbc r25,r19 |
||
5150 | 5165 32f6 9C01 movw r18,r24 |
||
5151 | 5166 32f8 E3E0 ldi r30,3 |
||
5152 | 5167 32fa 220F 1: lsl r18 |
||
5153 | 5168 32fc 331F rol r19 |
||
5154 | 5169 32fe EA95 dec r30 |
||
5155 | 5170 3300 01F4 brne 1b |
||
5156 | 5171 3302 880F lsl r24 |
||
5157 | 5172 3304 991F rol r25 |
||
5158 | 5173 3306 820F add r24,r18 |
||
5159 | 5174 3308 931F adc r25,r19 |
||
5160 | 5175 330a 9093 0000 sts (DebugOut+50)+1,r25 |
||
5161 | 5176 330e 8093 0000 sts DebugOut+50,r24 |
||
5162 | 5177 3312 00C0 rjmp .L695 |
||
5163 | 5178 .L648: |
||
5164 | 5179 3314 1092 0000 sts (LageKorrekturRoll)+1,__zero_reg__ |
||
5165 | 5180 3318 1092 0000 sts LageKorrekturRoll,__zero_reg__ |
||
5166 | 5181 331c 1092 0000 sts (LageKorrekturNick)+1,__zero_reg__ |
||
5167 | 5182 3320 1092 0000 sts LageKorrekturNick,__zero_reg__ |
||
5168 | 5183 .L695: |
||
5169 | 5184 3324 20E0 ldi r18,lo8(0x0) |
||
5170 | 5185 3326 30E0 ldi r19,hi8(0x0) |
||
5171 | 5186 3328 40E0 ldi r20,hlo8(0x0) |
||
5172 | 5187 332a 50E0 ldi r21,hhi8(0x0) |
||
5173 | 5188 332c 6091 0000 lds r22,IntegralFaktor |
||
5174 | 5189 3330 7091 0000 lds r23,(IntegralFaktor)+1 |
||
5175 | 5190 3334 8091 0000 lds r24,(IntegralFaktor)+2 |
||
5176 | 5191 3338 9091 0000 lds r25,(IntegralFaktor)+3 |
||
5177 | 5192 333c 0E94 0000 call __nesf2 |
||
5178 | 5193 3340 8823 tst r24 |
||
5179 | 5194 3342 01F4 brne .L696 |
||
5180 | 5195 3344 1092 0000 sts (LageKorrekturRoll)+1,__zero_reg__ |
||
5181 | 5196 3348 1092 0000 sts LageKorrekturRoll,__zero_reg__ |
||
5182 | 5197 334c 1092 0000 sts (LageKorrekturNick)+1,__zero_reg__ |
||
5183 | 5198 3350 1092 0000 sts LageKorrekturNick,__zero_reg__ |
||
5184 | 5199 .L696: |
||
5185 | 5200 3354 8091 0000 lds r24,MittelIntegralNick |
||
5186 | 5201 3358 9091 0000 lds r25,(MittelIntegralNick)+1 |
||
5187 | 5202 335c A091 0000 lds r26,(MittelIntegralNick)+2 |
||
5188 | 5203 3360 B091 0000 lds r27,(MittelIntegralNick)+3 |
||
5189 | 5204 3364 8093 0000 sts MittelIntegralNick_Alt.2595,r24 |
||
5190 | 5205 3368 9093 0000 sts (MittelIntegralNick_Alt.2595)+1,r25 |
||
5191 | 5206 336c A093 0000 sts (MittelIntegralNick_Alt.2595)+2,r26 |
||
5192 | 5207 3370 B093 0000 sts (MittelIntegralNick_Alt.2595)+3,r27 |
||
5193 | 5208 3374 8091 0000 lds r24,MittelIntegralRoll |
||
5194 | 5209 3378 9091 0000 lds r25,(MittelIntegralRoll)+1 |
||
5195 | 5210 337c A091 0000 lds r26,(MittelIntegralRoll)+2 |
||
5196 | 5211 3380 B091 0000 lds r27,(MittelIntegralRoll)+3 |
||
5197 | 5212 3384 8093 0000 sts MittelIntegralRoll_Alt.2596,r24 |
||
5198 | 5213 3388 9093 0000 sts (MittelIntegralRoll_Alt.2596)+1,r25 |
||
5199 | 5214 338c A093 0000 sts (MittelIntegralRoll_Alt.2596)+2,r26 |
||
5200 | 5215 3390 B093 0000 sts (MittelIntegralRoll_Alt.2596)+3,r27 |
||
5201 | 5216 3394 1092 0000 sts IntegralAccNick,__zero_reg__ |
||
5202 | 5217 3398 1092 0000 sts (IntegralAccNick)+1,__zero_reg__ |
||
5203 | 5218 339c 1092 0000 sts (IntegralAccNick)+2,__zero_reg__ |
||
5204 | 5219 33a0 1092 0000 sts (IntegralAccNick)+3,__zero_reg__ |
||
5205 | 5220 33a4 1092 0000 sts IntegralAccRoll,__zero_reg__ |
||
5206 | 5221 33a8 1092 0000 sts (IntegralAccRoll)+1,__zero_reg__ |
||
5207 | 5222 33ac 1092 0000 sts (IntegralAccRoll)+2,__zero_reg__ |
||
5208 | 5223 33b0 1092 0000 sts (IntegralAccRoll)+3,__zero_reg__ |
||
5209 | 5224 33b4 1092 0000 sts IntegralAccZ,__zero_reg__ |
||
5210 | 5225 33b8 1092 0000 sts (IntegralAccZ)+1,__zero_reg__ |
||
5211 | 5226 33bc 1092 0000 sts (IntegralAccZ)+2,__zero_reg__ |
||
5212 | 5227 33c0 1092 0000 sts (IntegralAccZ)+3,__zero_reg__ |
||
5213 | 5228 33c4 1092 0000 sts MittelIntegralNick,__zero_reg__ |
||
5214 | 5229 33c8 1092 0000 sts (MittelIntegralNick)+1,__zero_reg__ |
||
5215 | 5230 33cc 1092 0000 sts (MittelIntegralNick)+2,__zero_reg__ |
||
5216 | 5231 33d0 1092 0000 sts (MittelIntegralNick)+3,__zero_reg__ |
||
5217 | 5232 33d4 1092 0000 sts MittelIntegralRoll,__zero_reg__ |
||
5218 | 5233 33d8 1092 0000 sts (MittelIntegralRoll)+1,__zero_reg__ |
||
5219 | 5234 33dc 1092 0000 sts (MittelIntegralRoll)+2,__zero_reg__ |
||
5220 | 5235 33e0 1092 0000 sts (MittelIntegralRoll)+3,__zero_reg__ |
||
5221 | 5236 33e4 1092 0000 sts MittelIntegralNick2,__zero_reg__ |
||
5222 | 5237 33e8 1092 0000 sts (MittelIntegralNick2)+1,__zero_reg__ |
||
5223 | 5238 33ec 1092 0000 sts (MittelIntegralNick2)+2,__zero_reg__ |
||
5224 | 5239 33f0 1092 0000 sts (MittelIntegralNick2)+3,__zero_reg__ |
||
5225 | 5240 33f4 1092 0000 sts MittelIntegralRoll2,__zero_reg__ |
||
5226 | 5241 33f8 1092 0000 sts (MittelIntegralRoll2)+1,__zero_reg__ |
||
5227 | 5242 33fc 1092 0000 sts (MittelIntegralRoll2)+2,__zero_reg__ |
||
5228 | 5243 3400 1092 0000 sts (MittelIntegralRoll2)+3,__zero_reg__ |
||
5229 | 5244 3404 1092 0000 sts (ZaehlMessungen)+1,__zero_reg__ |
||
5230 | 5245 3408 1092 0000 sts ZaehlMessungen,__zero_reg__ |
||
5231 | 5246 .L646: |
||
5232 | 5247 340c 8090 0000 lds r8,StickGier |
||
5233 | 5248 3410 9090 0000 lds r9,(StickGier)+1 |
||
5234 | 5249 3414 5401 movw r10,r8 |
||
5235 | 5250 3416 97FE sbrs r9,7 |
||
5236 | 5251 3418 00C0 rjmp .L698 |
||
5237 | 5252 341a AA24 clr r10 |
||
5238 | 5253 341c BB24 clr r11 |
||
5239 | 5254 341e A818 sub r10,r8 |
||
5240 | 5255 3420 B908 sbc r11,r9 |
||
5241 | 5256 .L698: |
||
5242 | 5257 3422 F5E1 ldi r31,lo8(21) |
||
5243 | 5258 3424 AF16 cp r10,r31 |
||
5244 | 5259 3426 B104 cpc r11,__zero_reg__ |
||
5245 | 5260 3428 04F0 brlt .L699 |
||
5246 | 5261 342a 8091 0000 lds r24,EE_Parameter+8 |
||
5247 | 5262 342e 84FD sbrc r24,4 |
||
5248 | 5263 3430 00C0 rjmp .L699 |
||
5249 | 5264 3432 81E0 ldi r24,lo8(1) |
||
5250 | 5265 3434 8093 0000 sts NeueKompassRichtungMerken.2583,r24 |
||
5251 | 5266 .L699: |
||
5252 | 5267 3438 E090 0000 lds r14,EE_Parameter+17 |
||
5253 | 5268 343c CC24 clr r12 |
||
5254 | 5269 343e B7FC sbrc r11,7 |
||
5255 | 5270 3440 C094 com r12 |
||
5256 | 5271 3442 DC2C mov r13,r12 |
||
5257 | 5272 3444 B401 movw r22,r8 |
||
5258 | 5273 3446 8827 clr r24 |
||
5259 | 5274 3448 77FD sbrc r23,7 |
||
5260 | 5275 344a 8095 com r24 |
||
5261 | 5276 344c 982F mov r25,r24 |
||
5262 | 5277 344e 2E2D mov r18,r14 |
||
5263 | 5278 3450 3327 clr r19 |
||
5264 | 5279 3452 4427 clr r20 |
||
5265 | 5280 3454 5527 clr r21 |
||
5266 | 5281 3456 0E94 0000 call __mulsi3 |
||
5267 | 5282 345a 9B01 movw r18,r22 |
||
5268 | 5283 345c AC01 movw r20,r24 |
||
5269 | 5284 345e C601 movw r24,r12 |
||
5270 | 5285 3460 B501 movw r22,r10 |
||
5271 | 5286 3462 0E94 0000 call __mulsi3 |
||
5272 | 5287 3466 20E0 ldi r18,lo8(512) |
||
5273 | 5288 3468 32E0 ldi r19,hi8(512) |
||
5274 | 5289 346a 40E0 ldi r20,hlo8(512) |
||
5275 | 5290 346c 50E0 ldi r21,hhi8(512) |
||
5276 | 5291 346e 0E94 0000 call __divmodsi4 |
||
5277 | 5292 3472 8901 movw r16,r18 |
||
5278 | 5293 3474 9A01 movw r18,r20 |
||
5279 | 5294 3476 FF24 clr r15 |
||
5280 | 5295 3478 E89C mul r14,r8 |
||
5281 | 5296 347a C001 movw r24,r0 |
||
5282 | 5297 347c E99C mul r14,r9 |
||
5283 | 5298 347e 900D add r25,r0 |
||
5284 | 5299 3480 F89C mul r15,r8 |
||
5285 | 5300 3482 900D add r25,r0 |
||
5286 | 5301 3484 1124 clr r1 |
||
5287 | 5302 3486 64E0 ldi r22,lo8(4) |
||
5288 | 5303 3488 70E0 ldi r23,hi8(4) |
||
5289 | 5304 348a 0E94 0000 call __divmodhi4 |
||
5290 | 5305 348e 600F add r22,r16 |
||
5291 | 5306 3490 711F adc r23,r17 |
||
5292 | 5307 3492 3B01 movw r6,r22 |
||
5293 | 5308 3494 8824 clr r8 |
||
5294 | 5309 3496 77FC sbrc r7,7 |
||
5295 | 5310 3498 8094 com r8 |
||
5296 | 5311 349a 982C mov r9,r8 |
||
5297 | 5312 349c 6092 0000 sts sollGier.2571,r6 |
||
5298 | 5313 34a0 7092 0000 sts (sollGier.2571)+1,r7 |
||
5299 | 5314 34a4 8092 0000 sts (sollGier.2571)+2,r8 |
||
5300 | 5315 34a8 9092 0000 sts (sollGier.2571)+3,r9 |
||
5301 | 5316 34ac 8091 0000 lds r24,Mess_Integral_Gier |
||
5302 | 5317 34b0 9091 0000 lds r25,(Mess_Integral_Gier)+1 |
||
5303 | 5318 34b4 A091 0000 lds r26,(Mess_Integral_Gier)+2 |
||
5304 | 5319 34b8 B091 0000 lds r27,(Mess_Integral_Gier)+3 |
||
5305 | 5320 34bc 8619 sub r24,r6 |
||
5306 | 5321 34be 9709 sbc r25,r7 |
||
5307 | 5322 34c0 A809 sbc r26,r8 |
||
5308 | 5323 34c2 B909 sbc r27,r9 |
||
5309 | 5324 34c4 8093 0000 sts Mess_Integral_Gier,r24 |
||
5310 | 5325 34c8 9093 0000 sts (Mess_Integral_Gier)+1,r25 |
||
5311 | 5326 34cc A093 0000 sts (Mess_Integral_Gier)+2,r26 |
||
5312 | 5327 34d0 B093 0000 sts (Mess_Integral_Gier)+3,r27 |
||
5313 | 5328 34d4 8091 0000 lds r24,Mess_Integral_Gier |
||
5314 | 5329 34d8 9091 0000 lds r25,(Mess_Integral_Gier)+1 |
||
5315 | 5330 34dc A091 0000 lds r26,(Mess_Integral_Gier)+2 |
||
5316 | 5331 34e0 B091 0000 lds r27,(Mess_Integral_Gier)+3 |
||
5317 | 5332 34e4 8155 subi r24,lo8(50001) |
||
5318 | 5333 34e6 934C sbci r25,hi8(50001) |
||
5319 | 5334 34e8 A040 sbci r26,hlo8(50001) |
||
5320 | 5335 34ea B040 sbci r27,hhi8(50001) |
||
5321 | 5336 34ec 04F0 brlt .L702 |
||
5322 | 5337 34ee 80E5 ldi r24,lo8(50000) |
||
5323 | 5338 34f0 93EC ldi r25,hi8(50000) |
||
5324 | 5339 34f2 A0E0 ldi r26,hlo8(50000) |
||
5325 | 5340 34f4 B0E0 ldi r27,hhi8(50000) |
||
5326 | 5341 34f6 8093 0000 sts Mess_Integral_Gier,r24 |
||
5327 | 5342 34fa 9093 0000 sts (Mess_Integral_Gier)+1,r25 |
||
5328 | 5343 34fe A093 0000 sts (Mess_Integral_Gier)+2,r26 |
||
5329 | 5344 3502 B093 0000 sts (Mess_Integral_Gier)+3,r27 |
||
5330 | 5345 .L702: |
||
5331 | 5346 3506 8091 0000 lds r24,Mess_Integral_Gier |
||
5332 | 5347 350a 9091 0000 lds r25,(Mess_Integral_Gier)+1 |
||
5333 | 5348 350e A091 0000 lds r26,(Mess_Integral_Gier)+2 |
||
5334 | 5349 3512 B091 0000 lds r27,(Mess_Integral_Gier)+3 |
||
5335 | 5350 3516 805B subi r24,lo8(-50000) |
||
5336 | 5351 3518 9C43 sbci r25,hi8(-50000) |
||
5337 | 5352 351a AF4F sbci r26,hlo8(-50000) |
||
5338 | 5353 351c BF4F sbci r27,hhi8(-50000) |
||
5339 | 5354 351e 04F4 brge .L704 |
||
5340 | 5355 3520 80EB ldi r24,lo8(-50000) |
||
5341 | 5356 3522 9CE3 ldi r25,hi8(-50000) |
||
5342 | 5357 3524 AFEF ldi r26,hlo8(-50000) |
||
5343 | 5358 3526 BFEF ldi r27,hhi8(-50000) |
||
5344 | 5359 3528 8093 0000 sts Mess_Integral_Gier,r24 |
||
5345 | 5360 352c 9093 0000 sts (Mess_Integral_Gier)+1,r25 |
||
5346 | 5361 3530 A093 0000 sts (Mess_Integral_Gier)+2,r26 |
||
5347 | 5362 3534 B093 0000 sts (Mess_Integral_Gier)+3,r27 |
||
5348 | 5363 .L704: |
||
5349 | 5364 3538 8091 0000 lds r24,KompassValue |
||
5350 | 5365 353c 9091 0000 lds r25,(KompassValue)+1 |
||
5351 | 5366 3540 892B or r24,r25 |
||
5352 | 5367 3542 01F4 brne .+2 |
||
5353 | 5368 3544 00C0 rjmp .L706 |
||
5354 | 5369 3546 8091 0000 lds r24,EE_Parameter+8 |
||
5355 | 5370 354a 83FF sbrs r24,3 |
||
5356 | 5371 354c 00C0 rjmp .L706 |
||
5357 | 5372 354e 6091 0000 lds r22,IntegralNick |
||
5358 | 5373 3552 7091 0000 lds r23,(IntegralNick)+1 |
||
5359 | 5374 3556 8091 0000 lds r24,(IntegralNick)+2 |
||
5360 | 5375 355a 9091 0000 lds r25,(IntegralNick)+3 |
||
5361 | 5376 355e 20E0 ldi r18,lo8(512) |
||
5362 | 5377 3560 32E0 ldi r19,hi8(512) |
||
5363 | 5378 3562 40E0 ldi r20,hlo8(512) |
||
5364 | 5379 3564 50E0 ldi r21,hhi8(512) |
||
5365 | 5380 3566 0E94 0000 call __divmodsi4 |
||
5366 | 5381 356a 8901 movw r16,r18 |
||
5367 | 5382 356c 37FF sbrs r19,7 |
||
5368 | 5383 356e 00C0 rjmp .L709 |
||
5369 | 5384 3570 1095 com r17 |
||
5370 | 5385 3572 0195 neg r16 |
||
5371 | 5386 3574 1F4F sbci r17,lo8(-1) |
||
5372 | 5387 .L709: |
||
5373 | 5388 3576 6091 0000 lds r22,IntegralRoll |
||
5374 | 5389 357a 7091 0000 lds r23,(IntegralRoll)+1 |
||
5375 | 5390 357e 8091 0000 lds r24,(IntegralRoll)+2 |
||
5376 | 5391 3582 9091 0000 lds r25,(IntegralRoll)+3 |
||
5377 | 5392 3586 20E0 ldi r18,lo8(512) |
||
5378 | 5393 3588 32E0 ldi r19,hi8(512) |
||
5379 | 5394 358a 40E0 ldi r20,hlo8(512) |
||
5380 | 5395 358c 50E0 ldi r21,hhi8(512) |
||
5381 | 5396 358e 0E94 0000 call __divmodsi4 |
||
5382 | 5397 3592 B901 movw r22,r18 |
||
5383 | 5398 3594 37FF sbrs r19,7 |
||
5384 | 5399 3596 00C0 rjmp .L710 |
||
5385 | 5400 3598 7095 com r23 |
||
5386 | 5401 359a 6195 neg r22 |
||
5387 | 5402 359c 7F4F sbci r23,lo8(-1) |
||
5388 | 5403 .L710: |
||
5389 | 5404 359e 6017 cp r22,r16 |
||
5390 | 5405 35a0 7107 cpc r23,r17 |
||
5391 | 5406 35a2 04F4 brge .L711 |
||
5392 | 5407 35a4 B801 movw r22,r16 |
||
5393 | 5408 .L711: |
||
5394 | 5409 35a6 6931 cpi r22,25 |
||
5395 | 5410 35a8 7105 cpc r23,__zero_reg__ |
||
5396 | 5411 35aa 04F4 brge .L712 |
||
5397 | 5412 35ac 8091 0000 lds r24,NeueKompassRichtungMerken.2583 |
||
5398 | 5413 35b0 8823 tst r24 |
||
5399 | 5414 35b2 01F0 breq .L712 |
||
5400 | 5415 35b4 8091 0000 lds r24,SignalSchlecht.2599 |
||
5401 | 5416 35b8 9091 0000 lds r25,(SignalSchlecht.2599)+1 |
||
5402 | 5417 35bc 892B or r24,r25 |
||
5403 | 5418 35be 01F4 brne .L712 |
||
5404 | 5419 35c0 8091 0000 lds r24,KompassValue |
||
5405 | 5420 35c4 9091 0000 lds r25,(KompassValue)+1 |
||
5406 | 5421 35c8 9093 0000 sts (KompassStartwert)+1,r25 |
||
5407 | 5422 35cc 8093 0000 sts KompassStartwert,r24 |
||
5408 | 5423 35d0 1092 0000 sts NeueKompassRichtungMerken.2583,__zero_reg__ |
||
5409 | 5424 .L712: |
||
5410 | 5425 35d4 2091 0000 lds r18,Parameter_KompassWirkung |
||
5411 | 5426 35d8 3327 clr r19 |
||
5412 | 5427 35da 629F mul r22,r18 |
||
5413 | 5428 35dc C001 movw r24,r0 |
||
5414 | 5429 35de 639F mul r22,r19 |
||
5415 | 5430 35e0 900D add r25,r0 |
||
5416 | 5431 35e2 729F mul r23,r18 |
||
5417 | 5432 35e4 900D add r25,r0 |
||
5418 | 5433 35e6 1124 clr r1 |
||
5419 | 5434 35e8 60E4 ldi r22,lo8(64) |
||
5420 | 5435 35ea 70E0 ldi r23,hi8(64) |
||
5421 | 5436 35ec 0E94 0000 call __divmodhi4 |
||
5422 | 5437 35f0 A901 movw r20,r18 |
||
5423 | 5438 35f2 461B sub r20,r22 |
||
5424 | 5439 35f4 570B sbc r21,r23 |
||
5425 | 5440 35f6 1416 cp __zero_reg__,r20 |
||
5426 | 5441 35f8 1506 cpc __zero_reg__,r21 |
||
5427 | 5442 35fa 04F4 brge .L716 |
||
5428 | 5443 35fc 8091 0000 lds r24,SignalSchlecht.2599 |
||
5429 | 5444 3600 9091 0000 lds r25,(SignalSchlecht.2599)+1 |
||
5430 | 5445 3604 0097 sbiw r24,0 |
||
5431 | 5446 3606 01F4 brne .L718 |
||
5432 | 5447 3608 0091 0000 lds r16,Mess_Integral_Gier |
||
5433 | 5448 360c 1091 0000 lds r17,(Mess_Integral_Gier)+1 |
||
5434 | 5449 3610 2091 0000 lds r18,(Mess_Integral_Gier)+2 |
||
5435 | 5450 3614 3091 0000 lds r19,(Mess_Integral_Gier)+3 |
||
5436 | 5451 3618 8091 0000 lds r24,KompassRichtung |
||
5437 | 5452 361c 9091 0000 lds r25,(KompassRichtung)+1 |
||
5438 | 5453 3620 BC01 movw r22,r24 |
||
5439 | 5454 3622 649F mul r22,r20 |
||
5440 | 5455 3624 C001 movw r24,r0 |
||
5441 | 5456 3626 659F mul r22,r21 |
||
5442 | 5457 3628 900D add r25,r0 |
||
5443 | 5458 362a 749F mul r23,r20 |
||
5444 | 5459 362c 900D add r25,r0 |
||
5445 | 5460 362e 1124 clr r1 |
||
5446 | 5461 3630 60E2 ldi r22,lo8(32) |
||
5447 | 5462 3632 70E0 ldi r23,hi8(32) |
||
5448 | 5463 3634 0E94 0000 call __divmodhi4 |
||
5449 | 5464 3638 8827 clr r24 |
||
5450 | 5465 363a 77FD sbrc r23,7 |
||
5451 | 5466 363c 8095 com r24 |
||
5452 | 5467 363e 982F mov r25,r24 |
||
5453 | 5468 3640 060F add r16,r22 |
||
5454 | 5469 3642 171F adc r17,r23 |
||
5455 | 5470 3644 281F adc r18,r24 |
||
5456 | 5471 3646 391F adc r19,r25 |
||
5457 | 5472 3648 0093 0000 sts Mess_Integral_Gier,r16 |
||
5458 | 5473 364c 1093 0000 sts (Mess_Integral_Gier)+1,r17 |
||
5459 | 5474 3650 2093 0000 sts (Mess_Integral_Gier)+2,r18 |
||
5460 | 5475 3654 3093 0000 sts (Mess_Integral_Gier)+3,r19 |
||
5461 | 5476 3658 00C0 rjmp .L706 |
||
5462 | 5477 .L718: |
||
5463 | 5478 365a 0197 sbiw r24,1 |
||
5464 | 5479 365c 00C0 rjmp .L824 |
||
5465 | 5480 .L716: |
||
5466 | 5481 365e 84EF ldi r24,lo8(500) |
||
5467 | 5482 3660 91E0 ldi r25,hi8(500) |
||
5468 | 5483 .L824: |
||
5469 | 5484 3662 9093 0000 sts (SignalSchlecht.2599)+1,r25 |
||
5470 | 5485 3666 8093 0000 sts SignalSchlecht.2599,r24 |
||
5471 | 5486 .L706: |
||
5472 | 5487 366a 8091 0000 lds r24,TimerWerteausgabe.2582 |
||
5473 | 5488 366e 8150 subi r24,lo8(-(-1)) |
||
5474 | 5489 3670 8093 0000 sts TimerWerteausgabe.2582,r24 |
||
5475 | 5490 3674 8F3F cpi r24,lo8(-1) |
||
5476 | 5491 3676 01F0 breq .+2 |
||
5477 | 5492 3678 00C0 rjmp .L720 |
||
5478 | 5493 367a 88E1 ldi r24,lo8(24) |
||
5479 | 5494 367c 8093 0000 sts TimerWerteausgabe.2582,r24 |
||
5480 | 5495 3680 6091 0000 lds r22,IntegralNick |
||
5481 | 5496 3684 7091 0000 lds r23,(IntegralNick)+1 |
||
5482 | 5497 3688 8091 0000 lds r24,(IntegralNick)+2 |
||
5483 | 5498 368c 9091 0000 lds r25,(IntegralNick)+3 |
||
5484 | 5499 3690 E090 0000 lds r14,EE_Parameter+20 |
||
5485 | 5500 3694 FF24 clr r15 |
||
5486 | 5501 3696 0027 clr r16 |
||
5487 | 5502 3698 1127 clr r17 |
||
5488 | 5503 369a A801 movw r20,r16 |
||
5489 | 5504 369c 9701 movw r18,r14 |
||
5490 | 5505 369e 0E94 0000 call __divmodsi4 |
||
5491 | 5506 36a2 3093 0000 sts (DebugOut+2)+1,r19 |
||
5492 | 5507 36a6 2093 0000 sts DebugOut+2,r18 |
||
5493 | 5508 36aa 6091 0000 lds r22,IntegralRoll |
||
5494 | 5509 36ae 7091 0000 lds r23,(IntegralRoll)+1 |
||
5495 | 5510 36b2 8091 0000 lds r24,(IntegralRoll)+2 |
||
5496 | 5511 36b6 9091 0000 lds r25,(IntegralRoll)+3 |
||
5497 | 5512 36ba A801 movw r20,r16 |
||
5498 | 5513 36bc 9701 movw r18,r14 |
||
5499 | 5514 36be 0E94 0000 call __divmodsi4 |
||
5500 | 5515 36c2 3093 0000 sts (DebugOut+4)+1,r19 |
||
5501 | 5516 36c6 2093 0000 sts DebugOut+4,r18 |
||
5502 | 5517 36ca 8091 0000 lds r24,Mittelwert_AccNick |
||
5503 | 5518 36ce 9091 0000 lds r25,(Mittelwert_AccNick)+1 |
||
5504 | 5519 36d2 9093 0000 sts (DebugOut+6)+1,r25 |
||
5505 | 5520 36d6 8093 0000 sts DebugOut+6,r24 |
||
5506 | 5521 36da 8091 0000 lds r24,Mittelwert_AccRoll |
||
5507 | 5522 36de 9091 0000 lds r25,(Mittelwert_AccRoll)+1 |
||
5508 | 5523 36e2 9093 0000 sts (DebugOut+8)+1,r25 |
||
5509 | 5524 36e6 8093 0000 sts DebugOut+8,r24 |
||
5510 | 5525 36ea 8091 0000 lds r24,MesswertGier |
||
5511 | 5526 36ee 9091 0000 lds r25,(MesswertGier)+1 |
||
5512 | 5527 36f2 9093 0000 sts (DebugOut+10)+1,r25 |
||
5513 | 5528 36f6 8093 0000 sts DebugOut+10,r24 |
||
5514 | 5529 36fa 8091 0000 lds r24,HoehenWert |
||
5515 | 5530 36fe 9091 0000 lds r25,(HoehenWert)+1 |
||
5516 | 5531 3702 9093 0000 sts (DebugOut+12)+1,r25 |
||
5517 | 5532 3706 8093 0000 sts DebugOut+12,r24 |
||
5518 | 5533 370a 6091 0000 lds r22,Mess_Integral_Hoch |
||
5519 | 5534 370e 7091 0000 lds r23,(Mess_Integral_Hoch)+1 |
||
5520 | 5535 3712 8091 0000 lds r24,(Mess_Integral_Hoch)+2 |
||
5521 | 5536 3716 9091 0000 lds r25,(Mess_Integral_Hoch)+3 |
||
5522 | 5537 371a 20E0 ldi r18,lo8(512) |
||
5523 | 5538 371c 32E0 ldi r19,hi8(512) |
||
5524 | 5539 371e 40E0 ldi r20,hlo8(512) |
||
5525 | 5540 3720 50E0 ldi r21,hhi8(512) |
||
5526 | 5541 3722 0E94 0000 call __divmodsi4 |
||
5527 | 5542 3726 3093 0000 sts (DebugOut+14)+1,r19 |
||
5528 | 5543 372a 2093 0000 sts DebugOut+14,r18 |
||
5529 | 5544 372e 8091 0000 lds r24,KompassValue |
||
5530 | 5545 3732 9091 0000 lds r25,(KompassValue)+1 |
||
5531 | 5546 3736 9093 0000 sts (DebugOut+18)+1,r25 |
||
5532 | 5547 373a 8093 0000 sts DebugOut+18,r24 |
||
5533 | 5548 373e 8091 0000 lds r24,UBat |
||
5534 | 5549 3742 9091 0000 lds r25,(UBat)+1 |
||
5535 | 5550 3746 9093 0000 sts (DebugOut+20)+1,r25 |
||
5536 | 5551 374a 8093 0000 sts DebugOut+20,r24 |
||
5537 | 5552 374e 8091 0000 lds r24,SenderOkay |
||
5538 | 5553 3752 9927 clr r25 |
||
5539 | 5554 3754 9093 0000 sts (DebugOut+22)+1,r25 |
||
5540 | 5555 3758 8093 0000 sts DebugOut+22,r24 |
||
5541 | 5556 375c 8091 0000 lds r24,Mittelwert_AccHoch |
||
5542 | 5557 3760 9091 0000 lds r25,(Mittelwert_AccHoch)+1 |
||
5543 | 5558 3764 9093 0000 sts (DebugOut+34)+1,r25 |
||
5544 | 5559 3768 8093 0000 sts DebugOut+34,r24 |
||
5545 | 5560 .L720: |
||
5546 | 5561 376c 3320 tst r3 |
||
5547 | 5562 376e 01F0 breq .L722 |
||
5548 | 5563 3770 6091 0000 lds r22,MesswertNick |
||
5549 | 5564 3774 7091 0000 lds r23,(MesswertNick)+1 |
||
5550 | 5565 3778 8827 clr r24 |
||
5551 | 5566 377a 77FD sbrc r23,7 |
||
5552 | 5567 377c 8095 com r24 |
||
5553 | 5568 377e 982F mov r25,r24 |
||
5554 | 5569 3780 0E94 0000 call __floatsisf |
||
5555 | 5570 3784 2091 0000 lds r18,GyroFaktor |
||
5556 | 5571 3788 3091 0000 lds r19,(GyroFaktor)+1 |
||
5557 | 5572 378c 4091 0000 lds r20,(GyroFaktor)+2 |
||
5558 | 5573 3790 5091 0000 lds r21,(GyroFaktor)+3 |
||
5559 | 5574 3794 0E94 0000 call __mulsf3 |
||
5560 | 5575 3798 00C0 rjmp .L825 |
||
5561 | 5576 .L722: |
||
5562 | 5577 379a 6091 0000 lds r22,IntegralNick |
||
5563 | 5578 379e 7091 0000 lds r23,(IntegralNick)+1 |
||
5564 | 5579 37a2 8091 0000 lds r24,(IntegralNick)+2 |
||
5565 | 5580 37a6 9091 0000 lds r25,(IntegralNick)+3 |
||
5566 | 5581 37aa E090 0000 lds r14,MesswertNick |
||
5567 | 5582 37ae F090 0000 lds r15,(MesswertNick)+1 |
||
5568 | 5583 37b2 0E94 0000 call __floatsisf |
||
5569 | 5584 37b6 2091 0000 lds r18,IntegralFaktor |
||
5570 | 5585 37ba 3091 0000 lds r19,(IntegralFaktor)+1 |
||
5571 | 5586 37be 4091 0000 lds r20,(IntegralFaktor)+2 |
||
5572 | 5587 37c2 5091 0000 lds r21,(IntegralFaktor)+3 |
||
5573 | 5588 37c6 0E94 0000 call __mulsf3 |
||
5574 | 5589 37ca 5B01 movw r10,r22 |
||
5575 | 5590 37cc 6C01 movw r12,r24 |
||
5576 | 5591 37ce 0027 clr r16 |
||
5577 | 5592 37d0 F7FC sbrc r15,7 |
||
5578 | 5593 37d2 0095 com r16 |
||
5579 | 5594 37d4 102F mov r17,r16 |
||
5580 | 5595 37d6 C801 movw r24,r16 |
||
5581 | 5596 37d8 B701 movw r22,r14 |
||
5582 | 5597 37da 0E94 0000 call __floatsisf |
||
5583 | 5598 37de 2091 0000 lds r18,GyroFaktor |
||
5584 | 5599 37e2 3091 0000 lds r19,(GyroFaktor)+1 |
||
5585 | 5600 37e6 4091 0000 lds r20,(GyroFaktor)+2 |
||
5586 | 5601 37ea 5091 0000 lds r21,(GyroFaktor)+3 |
||
5587 | 5602 37ee 0E94 0000 call __mulsf3 |
||
5588 | 5603 37f2 9B01 movw r18,r22 |
||
5589 | 5604 37f4 AC01 movw r20,r24 |
||
5590 | 5605 37f6 C601 movw r24,r12 |
||
5591 | 5606 37f8 B501 movw r22,r10 |
||
5592 | 5607 37fa 0E94 0000 call __addsf3 |
||
5593 | 5608 .L825: |
||
5594 | 5609 37fe 0E94 0000 call __fixsfsi |
||
5595 | 5610 3802 7093 0000 sts (MesswertNick)+1,r23 |
||
5596 | 5611 3806 6093 0000 sts MesswertNick,r22 |
||
5597 | 5612 380a 8091 0000 lds r24,Looping_Roll |
||
5598 | 5613 380e 8823 tst r24 |
||
5599 | 5614 3810 01F0 breq .L725 |
||
5600 | 5615 3812 6091 0000 lds r22,MesswertRoll |
||
5601 | 5616 3816 7091 0000 lds r23,(MesswertRoll)+1 |
||
5602 | 5617 381a 8827 clr r24 |
||
5603 | 5618 381c 77FD sbrc r23,7 |
||
5604 | 5619 381e 8095 com r24 |
||
5605 | 5620 3820 982F mov r25,r24 |
||
5606 | 5621 3822 0E94 0000 call __floatsisf |
||
5607 | 5622 3826 2091 0000 lds r18,GyroFaktor |
||
5608 | 5623 382a 3091 0000 lds r19,(GyroFaktor)+1 |
||
5609 | 5624 382e 4091 0000 lds r20,(GyroFaktor)+2 |
||
5610 | 5625 3832 5091 0000 lds r21,(GyroFaktor)+3 |
||
5611 | 5626 3836 0E94 0000 call __mulsf3 |
||
5612 | 5627 383a 00C0 rjmp .L826 |
||
5613 | 5628 .L725: |
||
5614 | 5629 383c 6091 0000 lds r22,IntegralRoll |
||
5615 | 5630 3840 7091 0000 lds r23,(IntegralRoll)+1 |
||
5616 | 5631 3844 8091 0000 lds r24,(IntegralRoll)+2 |
||
5617 | 5632 3848 9091 0000 lds r25,(IntegralRoll)+3 |
||
5618 | 5633 384c E090 0000 lds r14,MesswertRoll |
||
5619 | 5634 3850 F090 0000 lds r15,(MesswertRoll)+1 |
||
5620 | 5635 3854 0E94 0000 call __floatsisf |
||
5621 | 5636 3858 2091 0000 lds r18,IntegralFaktor |
||
5622 | 5637 385c 3091 0000 lds r19,(IntegralFaktor)+1 |
||
5623 | 5638 3860 4091 0000 lds r20,(IntegralFaktor)+2 |
||
5624 | 5639 3864 5091 0000 lds r21,(IntegralFaktor)+3 |
||
5625 | 5640 3868 0E94 0000 call __mulsf3 |
||
5626 | 5641 386c 5B01 movw r10,r22 |
||
5627 | 5642 386e 6C01 movw r12,r24 |
||
5628 | 5643 3870 0027 clr r16 |
||
5629 | 5644 3872 F7FC sbrc r15,7 |
||
5630 | 5645 3874 0095 com r16 |
||
5631 | 5646 3876 102F mov r17,r16 |
||
5632 | 5647 3878 C801 movw r24,r16 |
||
5633 | 5648 387a B701 movw r22,r14 |
||
5634 | 5649 387c 0E94 0000 call __floatsisf |
||
5635 | 5650 3880 2091 0000 lds r18,GyroFaktor |
||
5636 | 5651 3884 3091 0000 lds r19,(GyroFaktor)+1 |
||
5637 | 5652 3888 4091 0000 lds r20,(GyroFaktor)+2 |
||
5638 | 5653 388c 5091 0000 lds r21,(GyroFaktor)+3 |
||
5639 | 5654 3890 0E94 0000 call __mulsf3 |
||
5640 | 5655 3894 9B01 movw r18,r22 |
||
5641 | 5656 3896 AC01 movw r20,r24 |
||
5642 | 5657 3898 C601 movw r24,r12 |
||
5643 | 5658 389a B501 movw r22,r10 |
||
5644 | 5659 389c 0E94 0000 call __addsf3 |
||
5645 | 5660 .L826: |
||
5646 | 5661 38a0 0E94 0000 call __fixsfsi |
||
5647 | 5662 38a4 7093 0000 sts (MesswertRoll)+1,r23 |
||
5648 | 5663 38a8 6093 0000 sts MesswertRoll,r22 |
||
5649 | 5664 38ac 6091 0000 lds r22,MesswertGier |
||
5650 | 5665 38b0 7091 0000 lds r23,(MesswertGier)+1 |
||
5651 | 5666 38b4 E090 0000 lds r14,Integral_Gier |
||
5652 | 5667 38b8 F090 0000 lds r15,(Integral_Gier)+1 |
||
5653 | 5668 38bc 0091 0000 lds r16,(Integral_Gier)+2 |
||
5654 | 5669 38c0 1091 0000 lds r17,(Integral_Gier)+3 |
||
5655 | 5670 38c4 8091 0000 lds r24,IntegralFaktor |
||
5656 | 5671 38c8 9091 0000 lds r25,(IntegralFaktor)+1 |
||
5657 | 5672 38cc A091 0000 lds r26,(IntegralFaktor)+2 |
||
5658 | 5673 38d0 B091 0000 lds r27,(IntegralFaktor)+3 |
||
5659 | 5674 38d4 8987 std Y+9,r24 |
||
5660 | 5675 38d6 9A87 std Y+10,r25 |
||
5661 | 5676 38d8 AB87 std Y+11,r26 |
||
5662 | 5677 38da BC87 std Y+12,r27 |
||
5663 | 5678 38dc 8827 clr r24 |
||
5664 | 5679 38de 77FD sbrc r23,7 |
||
5665 | 5680 38e0 8095 com r24 |
||
5666 | 5681 38e2 982F mov r25,r24 |
||
5667 | 5682 38e4 0E94 0000 call __floatsisf |
||
5668 | 5683 38e8 2091 0000 lds r18,GyroFaktor |
||
5669 | 5684 38ec 3091 0000 lds r19,(GyroFaktor)+1 |
||
5670 | 5685 38f0 4091 0000 lds r20,(GyroFaktor)+2 |
||
5671 | 5686 38f4 5091 0000 lds r21,(GyroFaktor)+3 |
||
5672 | 5687 38f8 0E94 0000 call __mulsf3 |
||
5673 | 5688 38fc 5B01 movw r10,r22 |
||
5674 | 5689 38fe 6C01 movw r12,r24 |
||
5675 | 5690 3900 C801 movw r24,r16 |
||
5676 | 5691 3902 B701 movw r22,r14 |
||
5677 | 5692 3904 0E94 0000 call __floatsisf |
||
5678 | 5693 3908 2985 ldd r18,Y+9 |
||
5679 | 5694 390a 3A85 ldd r19,Y+10 |
||
5680 | 5695 390c 4B85 ldd r20,Y+11 |
||
5681 | 5696 390e 5C85 ldd r21,Y+12 |
||
5682 | 5697 3910 0E94 0000 call __mulsf3 |
||
5683 | 5698 3914 20E0 ldi r18,lo8(0x3f000000) |
||
5684 | 5699 3916 30E0 ldi r19,hi8(0x3f000000) |
||
5685 | 5700 3918 40E0 ldi r20,hlo8(0x3f000000) |
||
5686 | 5701 391a 5FE3 ldi r21,hhi8(0x3f000000) |
||
5687 | 5702 391c 0E94 0000 call __mulsf3 |
||
5688 | 5703 3920 9B01 movw r18,r22 |
||
5689 | 5704 3922 AC01 movw r20,r24 |
||
5690 | 5705 3924 C601 movw r24,r12 |
||
5691 | 5706 3926 B501 movw r22,r10 |
||
5692 | 5707 3928 0E94 0000 call __addsf3 |
||
5693 | 5708 392c 0E94 0000 call __fixsfsi |
||
5694 | 5709 3930 7093 0000 sts (MesswertGier)+1,r23 |
||
5695 | 5710 3934 6093 0000 sts MesswertGier,r22 |
||
5696 | 5711 3938 8091 0000 lds r24,MesswertRoll |
||
5697 | 5712 393c 9091 0000 lds r25,(MesswertRoll)+1 |
||
5698 | 5713 3940 9093 0000 sts (DebugOut+58)+1,r25 |
||
5699 | 5714 3944 8093 0000 sts DebugOut+58,r24 |
||
5700 | 5715 3948 6091 0000 lds r22,IntegralRoll |
||
5701 | 5716 394c 7091 0000 lds r23,(IntegralRoll)+1 |
||
5702 | 5717 3950 8091 0000 lds r24,(IntegralRoll)+2 |
||
5703 | 5718 3954 9091 0000 lds r25,(IntegralRoll)+3 |
||
5704 | 5719 3958 0E94 0000 call __floatsisf |
||
5705 | 5720 395c 2985 ldd r18,Y+9 |
||
5706 | 5721 395e 3A85 ldd r19,Y+10 |
||
5707 | 5722 3960 4B85 ldd r20,Y+11 |
||
5708 | 5723 3962 5C85 ldd r21,Y+12 |
||
5709 | 5724 3964 0E94 0000 call __mulsf3 |
||
5710 | 5725 3968 0E94 0000 call __fixunssfsi |
||
5711 | 5726 396c 7093 0000 sts (DebugOut+52)+1,r23 |
||
5712 | 5727 3970 6093 0000 sts DebugOut+52,r22 |
||
5713 | 5728 3974 A091 0000 lds r26,StickRoll |
||
5714 | 5729 3978 B091 0000 lds r27,(StickRoll)+1 |
||
5715 | 5730 397c B88B std Y+16,r27 |
||
5716 | 5731 397e AF87 std Y+15,r26 |
||
5717 | 5732 3980 B093 0000 sts (DebugOut+64)+1,r27 |
||
5718 | 5733 3984 A093 0000 sts DebugOut+64,r26 |
||
5719 | 5734 3988 8091 0000 lds r24,MesswertNick |
||
5720 | 5735 398c 9091 0000 lds r25,(MesswertNick)+1 |
||
5721 | 5736 3990 8150 subi r24,lo8(2049) |
||
5722 | 5737 3992 9840 sbci r25,hi8(2049) |
||
5723 | 5738 3994 04F0 brlt .L728 |
||
5724 | 5739 3996 80E0 ldi r24,lo8(2048) |
||
5725 | 5740 3998 98E0 ldi r25,hi8(2048) |
||
5726 | 5741 399a 9093 0000 sts (MesswertNick)+1,r25 |
||
5727 | 5742 399e 8093 0000 sts MesswertNick,r24 |
||
5728 | 5743 .L728: |
||
5729 | 5744 39a2 8091 0000 lds r24,MesswertNick |
||
5730 | 5745 39a6 9091 0000 lds r25,(MesswertNick)+1 |
||
5731 | 5746 39aa 8050 subi r24,lo8(-2048) |
||
5732 | 5747 39ac 984F sbci r25,hi8(-2048) |
||
5733 | 5748 39ae 04F4 brge .L730 |
||
5734 | 5749 39b0 80E0 ldi r24,lo8(-2048) |
||
5735 | 5750 39b2 98EF ldi r25,hi8(-2048) |
||
5736 | 5751 39b4 9093 0000 sts (MesswertNick)+1,r25 |
||
5737 | 5752 39b8 8093 0000 sts MesswertNick,r24 |
||
5738 | 5753 .L730: |
||
5739 | 5754 39bc 8091 0000 lds r24,MesswertRoll |
||
5740 | 5755 39c0 9091 0000 lds r25,(MesswertRoll)+1 |
||
5741 | 5756 39c4 8150 subi r24,lo8(2049) |
||
5742 | 5757 39c6 9840 sbci r25,hi8(2049) |
||
5743 | 5758 39c8 04F0 brlt .L732 |
||
5744 | 5759 39ca 80E0 ldi r24,lo8(2048) |
||
5745 | 5760 39cc 98E0 ldi r25,hi8(2048) |
||
5746 | 5761 39ce 9093 0000 sts (MesswertRoll)+1,r25 |
||
5747 | 5762 39d2 8093 0000 sts MesswertRoll,r24 |
||
5748 | 5763 .L732: |
||
5749 | 5764 39d6 8091 0000 lds r24,MesswertRoll |
||
5750 | 5765 39da 9091 0000 lds r25,(MesswertRoll)+1 |
||
5751 | 5766 39de 8050 subi r24,lo8(-2048) |
||
5752 | 5767 39e0 984F sbci r25,hi8(-2048) |
||
5753 | 5768 39e2 04F4 brge .L734 |
||
5754 | 5769 39e4 80E0 ldi r24,lo8(-2048) |
||
5755 | 5770 39e6 98EF ldi r25,hi8(-2048) |
||
5756 | 5771 39e8 9093 0000 sts (MesswertRoll)+1,r25 |
||
5757 | 5772 39ec 8093 0000 sts MesswertRoll,r24 |
||
5758 | 5773 .L734: |
||
5759 | 5774 39f0 8091 0000 lds r24,MesswertGier |
||
5760 | 5775 39f4 9091 0000 lds r25,(MesswertGier)+1 |
||
5761 | 5776 39f8 8150 subi r24,lo8(2049) |
||
5762 | 5777 39fa 9840 sbci r25,hi8(2049) |
||
5763 | 5778 39fc 04F0 brlt .L736 |
||
5764 | 5779 39fe 80E0 ldi r24,lo8(2048) |
||
5765 | 5780 3a00 98E0 ldi r25,hi8(2048) |
||
5766 | 5781 3a02 9093 0000 sts (MesswertGier)+1,r25 |
||
5767 | 5782 3a06 8093 0000 sts MesswertGier,r24 |
||
5768 | 5783 .L736: |
||
5769 | 5784 3a0a 8091 0000 lds r24,MesswertGier |
||
5770 | 5785 3a0e 9091 0000 lds r25,(MesswertGier)+1 |
||
5771 | 5786 3a12 8050 subi r24,lo8(-2048) |
||
5772 | 5787 3a14 984F sbci r25,hi8(-2048) |
||
5773 | 5788 3a16 04F4 brge .L738 |
||
5774 | 5789 3a18 80E0 ldi r24,lo8(-2048) |
||
5775 | 5790 3a1a 98EF ldi r25,hi8(-2048) |
||
5776 | 5791 3a1c 9093 0000 sts (MesswertGier)+1,r25 |
||
5777 | 5792 3a20 8093 0000 sts MesswertGier,r24 |
||
5778 | 5793 .L738: |
||
5779 | 5794 3a24 8091 0000 lds r24,EE_Parameter+8 |
||
5780 | 5795 3a28 9927 clr r25 |
||
5781 | 5796 3a2a 80FF sbrs r24,0 |
||
5782 | 5797 3a2c 00C0 rjmp .L740 |
||
5783 | 5798 3a2e 4091 0000 lds r20,Parameter_MaxHoehe |
||
5784 | 5799 3a32 81FF sbrs r24,1 |
||
5785 | 5800 3a34 00C0 rjmp .L742 |
||
5786 | 5801 3a36 4233 cpi r20,lo8(50) |
||
5787 | 5802 3a38 00F4 brsh .L827 |
||
5788 | 5803 3a3a 8091 0000 lds r24,HoehenWert |
||
5789 | 5804 3a3e 9091 0000 lds r25,(HoehenWert)+1 |
||
5790 | 5805 3a42 4497 sbiw r24,20 |
||
5791 | 5806 3a44 9093 0000 sts (SollHoehe)+1,r25 |
||
5792 | 5807 3a48 8093 0000 sts SollHoehe,r24 |
||
5793 | 5808 3a4c 1092 0000 sts HoehenReglerAktiv,__zero_reg__ |
||
5794 | 5809 3a50 00C0 rjmp .L746 |
||
5795 | 5810 .L742: |
||
5796 | 5811 3a52 2091 0000 lds r18,ExternHoehenValue |
||
5797 | 5812 3a56 3091 0000 lds r19,(ExternHoehenValue)+1 |
||
5798 | 5813 3a5a 240F add r18,r20 |
||
5799 | 5814 3a5c 311D adc r19,__zero_reg__ |
||
5800 | 5815 3a5e 8091 0000 lds r24,EE_Parameter+13 |
||
5801 | 5816 3a62 9927 clr r25 |
||
5802 | 5817 3a64 BC01 movw r22,r24 |
||
5803 | 5818 3a66 269F mul r18,r22 |
||
5804 | 5819 3a68 C001 movw r24,r0 |
||
5805 | 5820 3a6a 279F mul r18,r23 |
||
5806 | 5821 3a6c 900D add r25,r0 |
||
5807 | 5822 3a6e 369F mul r19,r22 |
||
5808 | 5823 3a70 900D add r25,r0 |
||
5809 | 5824 3a72 1124 clr r1 |
||
5810 | 5825 3a74 4497 sbiw r24,20 |
||
5811 | 5826 3a76 9093 0000 sts (SollHoehe)+1,r25 |
||
5812 | 5827 3a7a 8093 0000 sts SollHoehe,r24 |
||
5813 | 5828 .L827: |
||
5814 | 5829 3a7e 81E0 ldi r24,lo8(1) |
||
5815 | 5830 3a80 8093 0000 sts HoehenReglerAktiv,r24 |
||
5816 | 5831 .L746: |
||
5817 | 5832 3a84 2220 tst r2 |
||
5818 | 5833 3a86 01F0 breq .L747 |
||
5819 | 5834 3a88 1092 0000 sts (SollHoehe)+1,__zero_reg__ |
||
5820 | 5835 3a8c 1092 0000 sts SollHoehe,__zero_reg__ |
||
5821 | 5836 .L747: |
||
5822 | 5837 3a90 2091 0000 lds r18,HoehenWert |
||
5823 | 5838 3a94 3091 0000 lds r19,(HoehenWert)+1 |
||
5824 | 5839 3a98 4091 0000 lds r20,SollHoehe |
||
5825 | 5840 3a9c 5091 0000 lds r21,(SollHoehe)+1 |
||
5826 | 5841 3aa0 4217 cp r20,r18 |
||
5827 | 5842 3aa2 5307 cpc r21,r19 |
||
5828 | 5843 3aa4 04F0 brlt .+2 |
||
5829 | 5844 3aa6 00C0 rjmp .L740 |
||
5830 | 5845 3aa8 8091 0000 lds r24,HoehenReglerAktiv |
||
5831 | 5846 3aac 8823 tst r24 |
||
5832 | 5847 3aae 01F4 brne .+2 |
||
5833 | 5848 3ab0 00C0 rjmp .L740 |
||
5834 | 5849 3ab2 241B sub r18,r20 |
||
5835 | 5850 3ab4 350B sbc r19,r21 |
||
5836 | 5851 3ab6 8091 0000 lds r24,Parameter_Hoehe_P |
||
5837 | 5852 3aba 9927 clr r25 |
||
5838 | 5853 3abc DC01 movw r26,r24 |
||
5839 | 5854 3abe 2A9F mul r18,r26 |
||
5840 | 5855 3ac0 C001 movw r24,r0 |
||
5841 | 5856 3ac2 2B9F mul r18,r27 |
||
5842 | 5857 3ac4 900D add r25,r0 |
||
5843 | 5858 3ac6 3A9F mul r19,r26 |
||
5844 | 5859 3ac8 900D add r25,r0 |
||
5845 | 5860 3aca 1124 clr r1 |
||
5846 | 5861 3acc 60E1 ldi r22,lo8(16) |
||
5847 | 5862 3ace 70E0 ldi r23,hi8(16) |
||
5848 | 5863 3ad0 0E94 0000 call __divmodhi4 |
||
5849 | 5864 3ad4 0981 ldd r16,Y+1 |
||
5850 | 5865 3ad6 1A81 ldd r17,Y+2 |
||
5851 | 5866 3ad8 061B sub r16,r22 |
||
5852 | 5867 3ada 170B sbc r17,r23 |
||
5853 | 5868 3adc 2091 0000 lds r18,HoeheD |
||
5854 | 5869 3ae0 3091 0000 lds r19,(HoeheD)+1 |
||
5855 | 5870 3ae4 8091 0000 lds r24,Parameter_Luftdruck_D |
||
5856 | 5871 3ae8 9927 clr r25 |
||
5857 | 5872 3aea FC01 movw r30,r24 |
||
5858 | 5873 3aec 2E9F mul r18,r30 |
||
5859 | 5874 3aee C001 movw r24,r0 |
||
5860 | 5875 3af0 2F9F mul r18,r31 |
||
5861 | 5876 3af2 900D add r25,r0 |
||
5862 | 5877 3af4 3E9F mul r19,r30 |
||
5863 | 5878 3af6 900D add r25,r0 |
||
5864 | 5879 3af8 1124 clr r1 |
||
5865 | 5880 3afa 68E0 ldi r22,lo8(8) |
||
5866 | 5881 3afc 70E0 ldi r23,hi8(8) |
||
5867 | 5882 3afe 0E94 0000 call __divmodhi4 |
||
5868 | 5883 3b02 061B sub r16,r22 |
||
5869 | 5884 3b04 170B sbc r17,r23 |
||
5870 | 5885 3b06 6091 0000 lds r22,Mess_Integral_Hoch |
||
5871 | 5886 3b0a 7091 0000 lds r23,(Mess_Integral_Hoch)+1 |
||
5872 | 5887 3b0e 8091 0000 lds r24,(Mess_Integral_Hoch)+2 |
||
5873 | 5888 3b12 9091 0000 lds r25,(Mess_Integral_Hoch)+3 |
||
5874 | 5889 3b16 20E0 ldi r18,lo8(512) |
||
5875 | 5890 3b18 32E0 ldi r19,hi8(512) |
||
5876 | 5891 3b1a 40E0 ldi r20,hlo8(512) |
||
5877 | 5892 3b1c 50E0 ldi r21,hhi8(512) |
||
5878 | 5893 3b1e 0E94 0000 call __divmodsi4 |
||
5879 | 5894 3b22 CA01 movw r24,r20 |
||
5880 | 5895 3b24 B901 movw r22,r18 |
||
5881 | 5896 3b26 2091 0000 lds r18,Parameter_Hoehe_ACC_Wirkung |
||
5882 | 5897 3b2a 3327 clr r19 |
||
5883 | 5898 3b2c 4427 clr r20 |
||
5884 | 5899 3b2e 5527 clr r21 |
||
5885 | 5900 3b30 0E94 0000 call __mulsi3 |
||
5886 | 5901 3b34 20E2 ldi r18,lo8(32) |
||
5887 | 5902 3b36 30E0 ldi r19,hi8(32) |
||
5888 | 5903 3b38 40E0 ldi r20,hlo8(32) |
||
5889 | 5904 3b3a 50E0 ldi r21,hhi8(32) |
||
5890 | 5905 3b3c 0E94 0000 call __divmodsi4 |
||
5891 | 5906 3b40 FFEF ldi r31,hi8(-50) |
||
5892 | 5907 3b42 2E3C cpi r18,lo8(-50) |
||
5893 | 5908 3b44 3F07 cpc r19,r31 |
||
5894 | 5909 3b46 04F4 brge .L751 |
||
5895 | 5910 3b48 2EEC ldi r18,lo8(-50) |
||
5896 | 5911 3b4a 3FEF ldi r19,hi8(-50) |
||
5897 | 5912 .L751: |
||
5898 | 5913 3b4c 8091 0000 lds r24,hoehenregler.2581 |
||
5899 | 5914 3b50 9091 0000 lds r25,(hoehenregler.2581)+1 |
||
5900 | 5915 3b54 AC01 movw r20,r24 |
||
5901 | 5916 3b56 64E0 ldi r22,4 |
||
5902 | 5917 3b58 440F 1: lsl r20 |
||
5903 | 5918 3b5a 551F rol r21 |
||
5904 | 5919 3b5c 6A95 dec r22 |
||
5905 | 5920 3b5e 01F4 brne 1b |
||
5906 | 5921 3b60 481B sub r20,r24 |
||
5907 | 5922 3b62 590B sbc r21,r25 |
||
5908 | 5923 3b64 2333 cpi r18,51 |
||
5909 | 5924 3b66 3105 cpc r19,__zero_reg__ |
||
5910 | 5925 3b68 04F0 brlt .L752 |
||
5911 | 5926 3b6a 22E3 ldi r18,lo8(50) |
||
5912 | 5927 3b6c 30E0 ldi r19,hi8(50) |
||
5913 | 5928 .L752: |
||
5914 | 5929 3b6e 021B sub r16,r18 |
||
5915 | 5930 3b70 130B sbc r17,r19 |
||
5916 | 5931 3b72 CA01 movw r24,r20 |
||
5917 | 5932 3b74 800F add r24,r16 |
||
5918 | 5933 3b76 911F adc r25,r17 |
||
5919 | 5934 3b78 60E1 ldi r22,lo8(16) |
||
5920 | 5935 3b7a 70E0 ldi r23,hi8(16) |
||
5921 | 5936 3b7c 0E94 0000 call __divmodhi4 |
||
5922 | 5937 3b80 7093 0000 sts (hoehenregler.2581)+1,r23 |
||
5923 | 5938 3b84 6093 0000 sts hoehenregler.2581,r22 |
||
5924 | 5939 3b88 8091 0000 lds r24,EE_Parameter+9 |
||
5925 | 5940 3b8c 9927 clr r25 |
||
5926 | 5941 3b8e 6817 cp r22,r24 |
||
5927 | 5942 3b90 7907 cpc r23,r25 |
||
5928 | 5943 3b92 04F4 brge .L753 |
||
5929 | 5944 3b94 2981 ldd r18,Y+1 |
||
5930 | 5945 3b96 3A81 ldd r19,Y+2 |
||
5931 | 5946 3b98 2817 cp r18,r24 |
||
5932 | 5947 3b9a 3907 cpc r19,r25 |
||
5933 | 5948 3b9c 04F0 brlt .L755 |
||
5934 | 5949 3b9e 9093 0000 sts (hoehenregler.2581)+1,r25 |
||
5935 | 5950 3ba2 8093 0000 sts hoehenregler.2581,r24 |
||
5936 | 5951 3ba6 00C0 rjmp .L753 |
||
5937 | 5952 .L755: |
||
5938 | 5953 3ba8 4981 ldd r20,Y+1 |
||
5939 | 5954 3baa 5A81 ldd r21,Y+2 |
||
5940 | 5955 3bac 5093 0000 sts (hoehenregler.2581)+1,r21 |
||
5941 | 5956 3bb0 4093 0000 sts hoehenregler.2581,r20 |
||
5942 | 5957 3bb4 00C0 rjmp .L757 |
||
5943 | 5958 .L753: |
||
5944 | 5959 3bb6 8091 0000 lds r24,hoehenregler.2581 |
||
5945 | 5960 3bba 9091 0000 lds r25,(hoehenregler.2581)+1 |
||
5946 | 5961 3bbe 6981 ldd r22,Y+1 |
||
5947 | 5962 3bc0 7A81 ldd r23,Y+2 |
||
5948 | 5963 3bc2 6817 cp r22,r24 |
||
5949 | 5964 3bc4 7907 cpc r23,r25 |
||
5950 | 5965 3bc6 04F4 brge .L757 |
||
5951 | 5966 3bc8 7093 0000 sts (hoehenregler.2581)+1,r23 |
||
5952 | 5967 3bcc 6093 0000 sts hoehenregler.2581,r22 |
||
5953 | 5968 .L757: |
||
5954 | 5969 3bd0 8091 0000 lds r24,hoehenregler.2581 |
||
5955 | 5970 3bd4 9091 0000 lds r25,(hoehenregler.2581)+1 |
||
5956 | 5971 3bd8 9A83 std Y+2,r25 |
||
5957 | 5972 3bda 8983 std Y+1,r24 |
||
5958 | 5973 .L740: |
||
5959 | 5974 3bdc A981 ldd r26,Y+1 |
||
5960 | 5975 3bde BA81 ldd r27,Y+2 |
||
5961 | 5976 3be0 B093 0000 sts (DebugOut+16)+1,r27 |
||
5962 | 5977 3be4 A093 0000 sts DebugOut+16,r26 |
||
5963 | 5978 3be8 0091 0000 lds r16,MesswertGier |
||
5964 | 5979 3bec 1091 0000 lds r17,(MesswertGier)+1 |
||
5965 | 5980 3bf0 8091 0000 lds r24,MAX_GAS |
||
5966 | 5981 3bf4 482E mov r4,r24 |
||
5967 | 5982 3bf6 5524 clr r5 |
||
5968 | 5983 3bf8 5497 sbiw r26,20 |
||
5969 | 5984 3bfa 04F4 brge .L759 |
||
5970 | 5985 3bfc 1C82 std Y+4,__zero_reg__ |
||
5971 | 5986 3bfe 1B82 std Y+3,__zero_reg__ |
||
5972 | 5987 3c00 00C0 rjmp .L761 |
||
5973 | 5988 .L759: |
||
5974 | 5989 3c02 8981 ldd r24,Y+1 |
||
5975 | 5990 3c04 9A81 ldd r25,Y+2 |
||
5976 | 5991 3c06 62E0 ldi r22,lo8(2) |
||
5977 | 5992 3c08 70E0 ldi r23,hi8(2) |
||
5978 | 5993 3c0a 0E94 0000 call __divmodhi4 |
||
5979 | 5994 3c0e 9B01 movw r18,r22 |
||
5980 | 5995 3c10 C201 movw r24,r4 |
||
5981 | 5996 3c12 E981 ldd r30,Y+1 |
||
5982 | 5997 3c14 FA81 ldd r31,Y+2 |
||
5983 | 5998 3c16 8E1B sub r24,r30 |
||
5984 | 5999 3c18 9F0B sbc r25,r31 |
||
5985 | 6000 3c1a 62E0 ldi r22,lo8(2) |
||
5986 | 6001 3c1c 70E0 ldi r23,hi8(2) |
||
5987 | 6002 3c1e 0E94 0000 call __divmodhi4 |
||
5988 | 6003 3c22 AB01 movw r20,r22 |
||
5989 | 6004 3c24 B801 movw r22,r16 |
||
5990 | 6005 3c26 6619 sub r22,r6 |
||
5991 | 6006 3c28 7709 sbc r23,r7 |
||
5992 | 6007 3c2a C901 movw r24,r18 |
||
5993 | 6008 3c2c 6217 cp r22,r18 |
||
5994 | 6009 3c2e 7307 cpc r23,r19 |
||
5995 | 6010 3c30 04F4 brge .L762 |
||
5996 | 6011 3c32 CB01 movw r24,r22 |
||
5997 | 6012 .L762: |
||
5998 | 6013 3c34 6627 clr r22 |
||
5999 | 6014 3c36 7727 clr r23 |
||
6000 | 6015 3c38 621B sub r22,r18 |
||
6001 | 6016 3c3a 730B sbc r23,r19 |
||
6002 | 6017 3c3c 6817 cp r22,r24 |
||
6003 | 6018 3c3e 7907 cpc r23,r25 |
||
6004 | 6019 3c40 04F4 brge .L763 |
||
6005 | 6020 3c42 BC01 movw r22,r24 |
||
6006 | 6021 .L763: |
||
6007 | 6022 3c44 CA01 movw r24,r20 |
||
6008 | 6023 3c46 6417 cp r22,r20 |
||
6009 | 6024 3c48 7507 cpc r23,r21 |
||
6010 | 6025 3c4a 04F4 brge .L764 |
||
6011 | 6026 3c4c CB01 movw r24,r22 |
||
6012 | 6027 .L764: |
||
6013 | 6028 3c4e 2227 clr r18 |
||
6014 | 6029 3c50 3327 clr r19 |
||
6015 | 6030 3c52 241B sub r18,r20 |
||
6016 | 6031 3c54 350B sbc r19,r21 |
||
6017 | 6032 3c56 3C83 std Y+4,r19 |
||
6018 | 6033 3c58 2B83 std Y+3,r18 |
||
6019 | 6034 3c5a 2817 cp r18,r24 |
||
6020 | 6035 3c5c 3907 cpc r19,r25 |
||
6021 | 6036 3c5e 04F4 brge .L761 |
||
6022 | 6037 3c60 9C83 std Y+4,r25 |
||
6023 | 6038 3c62 8B83 std Y+3,r24 |
||
6024 | 6039 .L761: |
||
6025 | 6040 3c64 2091 0000 lds r18,MesswertNick |
||
6026 | 6041 3c68 3091 0000 lds r19,(MesswertNick)+1 |
||
6027 | 6042 3c6c 8090 0000 lds r8,StickNick |
||
6028 | 6043 3c70 9090 0000 lds r9,(StickNick)+1 |
||
6029 | 6044 3c74 8091 0000 lds r24,GPS_Nick |
||
6030 | 6045 3c78 9091 0000 lds r25,(GPS_Nick)+1 |
||
6031 | 6046 3c7c 881A sub r8,r24 |
||
6032 | 6047 3c7e 990A sbc r9,r25 |
||
6033 | 6048 3c80 2819 sub r18,r8 |
||
6034 | 6049 3c82 3909 sbc r19,r9 |
||
6035 | 6050 3c84 3093 0000 sts (DiffNick)+1,r19 |
||
6036 | 6051 3c88 2093 0000 sts DiffNick,r18 |
||
6037 | 6052 3c8c 20E0 ldi r18,lo8(0x0) |
||
6038 | 6053 3c8e 30E0 ldi r19,hi8(0x0) |
||
6039 | 6054 3c90 40E0 ldi r20,hlo8(0x0) |
||
6040 | 6055 3c92 50E0 ldi r21,hhi8(0x0) |
||
6041 | 6056 3c94 6985 ldd r22,Y+9 |
||
6042 | 6057 3c96 7A85 ldd r23,Y+10 |
||
6043 | 6058 3c98 8B85 ldd r24,Y+11 |
||
6044 | 6059 3c9a 9C85 ldd r25,Y+12 |
||
6045 | 6060 3c9c 0E94 0000 call __nesf2 |
||
6046 | 6061 3ca0 8823 tst r24 |
||
6047 | 6062 3ca2 01F0 breq .L766 |
||
6048 | 6063 3ca4 E090 0000 lds r14,IntegralNick |
||
6049 | 6064 3ca8 F090 0000 lds r15,(IntegralNick)+1 |
||
6050 | 6065 3cac 0091 0000 lds r16,(IntegralNick)+2 |
||
6051 | 6066 3cb0 1091 0000 lds r17,(IntegralNick)+3 |
||
6052 | 6067 3cb4 6091 0000 lds r22,SummeNick.2569 |
||
6053 | 6068 3cb8 7091 0000 lds r23,(SummeNick.2569)+1 |
||
6054 | 6069 3cbc 8091 0000 lds r24,(SummeNick.2569)+2 |
||
6055 | 6070 3cc0 9091 0000 lds r25,(SummeNick.2569)+3 |
||
6056 | 6071 3cc4 0E94 0000 call __floatsisf |
||
6057 | 6072 3cc8 5B01 movw r10,r22 |
||
6058 | 6073 3cca 6C01 movw r12,r24 |
||
6059 | 6074 3ccc C801 movw r24,r16 |
||
6060 | 6075 3cce B701 movw r22,r14 |
||
6061 | 6076 3cd0 0E94 0000 call __floatsisf |
||
6062 | 6077 3cd4 2985 ldd r18,Y+9 |
||
6063 | 6078 3cd6 3A85 ldd r19,Y+10 |
||
6064 | 6079 3cd8 4B85 ldd r20,Y+11 |
||
6065 | 6080 3cda 5C85 ldd r21,Y+12 |
||
6066 | 6081 3cdc 0E94 0000 call __mulsf3 |
||
6067 | 6082 3ce0 7B01 movw r14,r22 |
||
6068 | 6083 3ce2 8C01 movw r16,r24 |
||
6069 | 6084 3ce4 B401 movw r22,r8 |
||
6070 | 6085 3ce6 8827 clr r24 |
||
6071 | 6086 3ce8 77FD sbrc r23,7 |
||
6072 | 6087 3cea 8095 com r24 |
||
6073 | 6088 3cec 982F mov r25,r24 |
||
6074 | 6089 3cee 0E94 0000 call __floatsisf |
||
6075 | 6090 3cf2 9B01 movw r18,r22 |
||
6076 | 6091 3cf4 AC01 movw r20,r24 |
||
6077 | 6092 3cf6 C801 movw r24,r16 |
||
6078 | 6093 3cf8 B701 movw r22,r14 |
||
6079 | 6094 3cfa 0E94 0000 call __subsf3 |
||
6080 | 6095 3cfe 9B01 movw r18,r22 |
||
6081 | 6096 3d00 AC01 movw r20,r24 |
||
6082 | 6097 3d02 C601 movw r24,r12 |
||
6083 | 6098 3d04 B501 movw r22,r10 |
||
6084 | 6099 3d06 0E94 0000 call __addsf3 |
||
6085 | 6100 3d0a 0E94 0000 call __fixsfsi |
||
6086 | 6101 3d0e 6093 0000 sts SummeNick.2569,r22 |
||
6087 | 6102 3d12 7093 0000 sts (SummeNick.2569)+1,r23 |
||
6088 | 6103 3d16 8093 0000 sts (SummeNick.2569)+2,r24 |
||
6089 | 6104 3d1a 9093 0000 sts (SummeNick.2569)+3,r25 |
||
6090 | 6105 3d1e 00C0 rjmp .L769 |
||
6091 | 6106 .L766: |
||
6092 | 6107 3d20 2091 0000 lds r18,DiffNick |
||
6093 | 6108 3d24 3091 0000 lds r19,(DiffNick)+1 |
||
6094 | 6109 3d28 4427 clr r20 |
||
6095 | 6110 3d2a 37FD sbrc r19,7 |
||
6096 | 6111 3d2c 4095 com r20 |
||
6097 | 6112 3d2e 542F mov r21,r20 |
||
6098 | 6113 3d30 8091 0000 lds r24,SummeNick.2569 |
||
6099 | 6114 3d34 9091 0000 lds r25,(SummeNick.2569)+1 |
||
6100 | 6115 3d38 A091 0000 lds r26,(SummeNick.2569)+2 |
||
6101 | 6116 3d3c B091 0000 lds r27,(SummeNick.2569)+3 |
||
6102 | 6117 3d40 820F add r24,r18 |
||
6103 | 6118 3d42 931F adc r25,r19 |
||
6104 | 6119 3d44 A41F adc r26,r20 |
||
6105 | 6120 3d46 B51F adc r27,r21 |
||
6106 | 6121 3d48 8093 0000 sts SummeNick.2569,r24 |
||
6107 | 6122 3d4c 9093 0000 sts (SummeNick.2569)+1,r25 |
||
6108 | 6123 3d50 A093 0000 sts (SummeNick.2569)+2,r26 |
||
6109 | 6124 3d54 B093 0000 sts (SummeNick.2569)+3,r27 |
||
6110 | 6125 .L769: |
||
6111 | 6126 3d58 8091 0000 lds r24,SummeNick.2569 |
||
6112 | 6127 3d5c 9091 0000 lds r25,(SummeNick.2569)+1 |
||
6113 | 6128 3d60 A091 0000 lds r26,(SummeNick.2569)+2 |
||
6114 | 6129 3d64 B091 0000 lds r27,(SummeNick.2569)+3 |
||
6115 | 6130 3d68 1816 cp __zero_reg__,r24 |
||
6116 | 6131 3d6a 1906 cpc __zero_reg__,r25 |
||
6117 | 6132 3d6c 1A06 cpc __zero_reg__,r26 |
||
6118 | 6133 3d6e 1B06 cpc __zero_reg__,r27 |
||
6119 | 6134 3d70 04F4 brge .L770 |
||
6120 | 6135 3d72 0297 sbiw r24,2 |
||
6121 | 6136 3d74 A109 sbc r26,__zero_reg__ |
||
6122 | 6137 3d76 B109 sbc r27,__zero_reg__ |
||
6123 | 6138 3d78 00C0 rjmp .L828 |
||
6124 | 6139 .L770: |
||
6125 | 6140 3d7a 0296 adiw r24,2 |
||
6126 | 6141 3d7c A11D adc r26,__zero_reg__ |
||
6127 | 6142 3d7e B11D adc r27,__zero_reg__ |
||
6128 | 6143 .L828: |
||
6129 | 6144 3d80 8093 0000 sts SummeNick.2569,r24 |
||
6130 | 6145 3d84 9093 0000 sts (SummeNick.2569)+1,r25 |
||
6131 | 6146 3d88 A093 0000 sts (SummeNick.2569)+2,r26 |
||
6132 | 6147 3d8c B093 0000 sts (SummeNick.2569)+3,r27 |
||
6133 | 6148 3d90 8091 0000 lds r24,SummeNick.2569 |
||
6134 | 6149 3d94 9091 0000 lds r25,(SummeNick.2569)+1 |
||
6135 | 6150 3d98 A091 0000 lds r26,(SummeNick.2569)+2 |
||
6136 | 6151 3d9c B091 0000 lds r27,(SummeNick.2569)+3 |
||
6137 | 6152 3da0 8138 cpi r24,lo8(16001) |
||
6138 | 6153 3da2 3EE3 ldi r19,hi8(16001) |
||
6139 | 6154 3da4 9307 cpc r25,r19 |
||
6140 | 6155 3da6 30E0 ldi r19,hlo8(16001) |
||
6141 | 6156 3da8 A307 cpc r26,r19 |
||
6142 | 6157 3daa 30E0 ldi r19,hhi8(16001) |
||
6143 | 6158 3dac B307 cpc r27,r19 |
||
6144 | 6159 3dae 04F0 brlt .L773 |
||
6145 | 6160 3db0 80E8 ldi r24,lo8(16000) |
||
6146 | 6161 3db2 9EE3 ldi r25,hi8(16000) |
||
6147 | 6162 3db4 A0E0 ldi r26,hlo8(16000) |
||
6148 | 6163 3db6 B0E0 ldi r27,hhi8(16000) |
||
6149 | 6164 3db8 00C0 rjmp .L829 |
||
6150 | 6165 .L773: |
||
6151 | 6166 3dba 8058 subi r24,lo8(-16000) |
||
6152 | 6167 3dbc 914C sbci r25,hi8(-16000) |
||
6153 | 6168 3dbe AF4F sbci r26,hlo8(-16000) |
||
6154 | 6169 3dc0 BF4F sbci r27,hhi8(-16000) |
||
6155 | 6170 3dc2 04F4 brge .L775 |
||
6156 | 6171 3dc4 80E8 ldi r24,lo8(-16000) |
||
6157 | 6172 3dc6 91EC ldi r25,hi8(-16000) |
||
6158 | 6173 3dc8 AFEF ldi r26,hlo8(-16000) |
||
6159 | 6174 3dca BFEF ldi r27,hhi8(-16000) |
||
6160 | 6175 .L829: |
||
6161 | 6176 3dcc 8093 0000 sts SummeNick.2569,r24 |
||
6162 | 6177 3dd0 9093 0000 sts (SummeNick.2569)+1,r25 |
||
6163 | 6178 3dd4 A093 0000 sts (SummeNick.2569)+2,r26 |
||
6164 | 6179 3dd8 B093 0000 sts (SummeNick.2569)+3,r27 |
||
6165 | 6180 .L775: |
||
6166 | 6181 3ddc 6091 0000 lds r22,DiffNick |
||
6167 | 6182 3de0 7091 0000 lds r23,(DiffNick)+1 |
||
6168 | 6183 3de4 8091 0000 lds r24,Ki |
||
6169 | 6184 3de8 9091 0000 lds r25,(Ki)+1 |
||
6170 | 6185 3dec A091 0000 lds r26,(Ki)+2 |
||
6171 | 6186 3df0 B091 0000 lds r27,(Ki)+3 |
||
6172 | 6187 3df4 8D83 std Y+5,r24 |
||
6173 | 6188 3df6 9E83 std Y+6,r25 |
||
6174 | 6189 3df8 AF83 std Y+7,r26 |
||
6175 | 6190 3dfa B887 std Y+8,r27 |
||
6176 | 6191 3dfc 8827 clr r24 |
||
6177 | 6192 3dfe 77FD sbrc r23,7 |
||
6178 | 6193 3e00 8095 com r24 |
||
6179 | 6194 3e02 982F mov r25,r24 |
||
6180 | 6195 3e04 0E94 0000 call __floatsisf |
||
6181 | 6196 3e08 7B01 movw r14,r22 |
||
6182 | 6197 3e0a 8C01 movw r16,r24 |
||
6183 | 6198 3e0c 6091 0000 lds r22,SummeNick.2569 |
||
6184 | 6199 3e10 7091 0000 lds r23,(SummeNick.2569)+1 |
||
6185 | 6200 3e14 8091 0000 lds r24,(SummeNick.2569)+2 |
||
6186 | 6201 3e18 9091 0000 lds r25,(SummeNick.2569)+3 |
||
6187 | 6202 3e1c 0E94 0000 call __floatsisf |
||
6188 | 6203 3e20 9B01 movw r18,r22 |
||
6189 | 6204 3e22 AC01 movw r20,r24 |
||
6190 | 6205 3e24 6D81 ldd r22,Y+5 |
||
6191 | 6206 3e26 7E81 ldd r23,Y+6 |
||
6192 | 6207 3e28 8F81 ldd r24,Y+7 |
||
6193 | 6208 3e2a 9885 ldd r25,Y+8 |
||
6194 | 6209 3e2c 0E94 0000 call __mulsf3 |
||
6195 | 6210 3e30 9B01 movw r18,r22 |
||
6196 | 6211 3e32 AC01 movw r20,r24 |
||
6197 | 6212 3e34 C801 movw r24,r16 |
||
6198 | 6213 3e36 B701 movw r22,r14 |
||
6199 | 6214 3e38 0E94 0000 call __addsf3 |
||
6200 | 6215 3e3c 0E94 0000 call __fixsfsi |
||
6201 | 6216 3e40 3B01 movw r6,r22 |
||
6202 | 6217 3e42 4C01 movw r8,r24 |
||
6203 | 6218 3e44 8B01 movw r16,r22 |
||
6204 | 6219 3e46 8091 0000 lds r24,Parameter_DynamicStability |
||
6205 | 6220 3e4a A82E mov r10,r24 |
||
6206 | 6221 3e4c BB24 clr r11 |
||
6207 | 6222 3e4e CC24 clr r12 |
||
6208 | 6223 3e50 DD24 clr r13 |
||
6209 | 6224 3e52 8B81 ldd r24,Y+3 |
||
6210 | 6225 3e54 9C81 ldd r25,Y+4 |
||
6211 | 6226 3e56 97FF sbrs r25,7 |
||
6212 | 6227 3e58 00C0 rjmp .L777 |
||
6213 | 6228 3e5a 9095 com r25 |
||
6214 | 6229 3e5c 8195 neg r24 |
||
6215 | 6230 3e5e 9F4F sbci r25,lo8(-1) |
||
6216 | 6231 .L777: |
||
6217 | 6232 3e60 62E0 ldi r22,lo8(2) |
||
6218 | 6233 3e62 70E0 ldi r23,hi8(2) |
||
6219 | 6234 3e64 0E94 0000 call __divmodhi4 |
||
6220 | 6235 3e68 9B01 movw r18,r22 |
||
6221 | 6236 3e6a A981 ldd r26,Y+1 |
||
6222 | 6237 3e6c BA81 ldd r27,Y+2 |
||
6223 | 6238 3e6e 2A0F add r18,r26 |
||
6224 | 6239 3e70 3B1F adc r19,r27 |
||
6225 | 6240 3e72 4427 clr r20 |
||
6226 | 6241 3e74 37FD sbrc r19,7 |
||
6227 | 6242 3e76 4095 com r20 |
||
6228 | 6243 3e78 542F mov r21,r20 |
||
6229 | 6244 3e7a C601 movw r24,r12 |
||
6230 | 6245 3e7c B501 movw r22,r10 |
||
6231 | 6246 3e7e 0E94 0000 call __mulsi3 |
||
6232 | 6247 3e82 20E4 ldi r18,lo8(64) |
||
6233 | 6248 3e84 30E0 ldi r19,hi8(64) |
||
6234 | 6249 3e86 40E0 ldi r20,hlo8(64) |
||
6235 | 6250 3e88 50E0 ldi r21,hhi8(64) |
||
6236 | 6251 3e8a 0E94 0000 call __divmodsi4 |
||
6237 | 6252 3e8e 1901 movw r2,r18 |
||
6238 | 6253 3e90 0217 cp r16,r18 |
||
6239 | 6254 3e92 1307 cpc r17,r19 |
||
6240 | 6255 3e94 04F4 brge .L778 |
||
6241 | 6256 3e96 9301 movw r18,r6 |
||
6242 | 6257 .L778: |
||
6243 | 6258 3e98 6624 clr r6 |
||
6244 | 6259 3e9a 7724 clr r7 |
||
6245 | 6260 3e9c 6218 sub r6,r2 |
||
6246 | 6261 3e9e 7308 sbc r7,r3 |
||
6247 | 6262 3ea0 A301 movw r20,r6 |
||
6248 | 6263 3ea2 6216 cp r6,r18 |
||
6249 | 6264 3ea4 7306 cpc r7,r19 |
||
6250 | 6265 3ea6 04F4 brge .L779 |
||
6251 | 6266 3ea8 A901 movw r20,r18 |
||
6252 | 6267 .L779: |
||
6253 | 6268 3eaa 8981 ldd r24,Y+1 |
||
6254 | 6269 3eac 9A81 ldd r25,Y+2 |
||
6255 | 6270 3eae EB81 ldd r30,Y+3 |
||
6256 | 6271 3eb0 FC81 ldd r31,Y+4 |
||
6257 | 6272 3eb2 8E0F add r24,r30 |
||
6258 | 6273 3eb4 9F1F adc r25,r31 |
||
6259 | 6274 3eb6 840F add r24,r20 |
||
6260 | 6275 3eb8 951F adc r25,r21 |
||
6261 | 6276 3eba 97FF sbrs r25,7 |
||
6262 | 6277 3ebc 00C0 rjmp .L780 |
||
6263 | 6278 3ebe 20E0 ldi r18,lo8(0) |
||
6264 | 6279 3ec0 30E0 ldi r19,hi8(0) |
||
6265 | 6280 3ec2 00C0 rjmp .L782 |
||
6266 | 6281 .L780: |
||
6267 | 6282 3ec4 9201 movw r18,r4 |
||
6268 | 6283 3ec6 8415 cp r24,r4 |
||
6269 | 6284 3ec8 9505 cpc r25,r5 |
||
6270 | 6285 3eca 04F4 brge .L782 |
||
6271 | 6286 3ecc 9C01 movw r18,r24 |
||
6272 | 6287 .L782: |
||
6273 | 6288 3ece 8091 0000 lds r24,MIN_GAS |
||
6274 | 6289 3ed2 682F mov r22,r24 |
||
6275 | 6290 3ed4 7727 clr r23 |
||
6276 | 6291 3ed6 788F std Y+24,r23 |
||
6277 | 6292 3ed8 6F8B std Y+23,r22 |
||
6278 | 6293 3eda CB01 movw r24,r22 |
||
6279 | 6294 3edc 6217 cp r22,r18 |
||
6280 | 6295 3ede 7307 cpc r23,r19 |
||
6281 | 6296 3ee0 04F4 brge .L784 |
||
6282 | 6297 3ee2 C901 movw r24,r18 |
||
6283 | 6298 .L784: |
||
6284 | 6299 3ee4 8093 0000 sts Motor_Vorne,r24 |
||
6285 | 6300 3ee8 8981 ldd r24,Y+1 |
||
6286 | 6301 3eea 9A81 ldd r25,Y+2 |
||
6287 | 6302 3eec 841B sub r24,r20 |
||
6288 | 6303 3eee 950B sbc r25,r21 |
||
6289 | 6304 3ef0 AB81 ldd r26,Y+3 |
||
6290 | 6305 3ef2 BC81 ldd r27,Y+4 |
||
6291 | 6306 3ef4 8A0F add r24,r26 |
||
6292 | 6307 3ef6 9B1F adc r25,r27 |
||
6293 | 6308 3ef8 97FF sbrs r25,7 |
||
6294 | 6309 3efa 00C0 rjmp .L785 |
||
6295 | 6310 3efc 20E0 ldi r18,lo8(0) |
||
6296 | 6311 3efe 30E0 ldi r19,hi8(0) |
||
6297 | 6312 3f00 00C0 rjmp .L787 |
||
6298 | 6313 .L785: |
||
6299 | 6314 3f02 9201 movw r18,r4 |
||
6300 | 6315 3f04 8415 cp r24,r4 |
||
6301 | 6316 3f06 9505 cpc r25,r5 |
||
6302 | 6317 3f08 04F4 brge .L787 |
||
6303 | 6318 3f0a 9C01 movw r18,r24 |
||
6304 | 6319 .L787: |
||
6305 | 6320 3f0c 8F89 ldd r24,Y+23 |
||
6306 | 6321 3f0e 988D ldd r25,Y+24 |
||
6307 | 6322 3f10 8217 cp r24,r18 |
||
6308 | 6323 3f12 9307 cpc r25,r19 |
||
6309 | 6324 3f14 04F4 brge .L789 |
||
6310 | 6325 3f16 C901 movw r24,r18 |
||
6311 | 6326 .L789: |
||
6312 | 6327 3f18 8093 0000 sts Motor_Hinten,r24 |
||
6313 | 6328 3f1c 8091 0000 lds r24,MesswertRoll |
||
6314 | 6329 3f20 9091 0000 lds r25,(MesswertRoll)+1 |
||
6315 | 6330 3f24 2091 0000 lds r18,GPS_Roll |
||
6316 | 6331 3f28 3091 0000 lds r19,(GPS_Roll)+1 |
||
6317 | 6332 3f2c 8F84 ldd r8,Y+15 |
||
6318 | 6333 3f2e 9888 ldd r9,Y+16 |
||
6319 | 6334 3f30 821A sub r8,r18 |
||
6320 | 6335 3f32 930A sbc r9,r19 |
||
6321 | 6336 3f34 8819 sub r24,r8 |
||
6322 | 6337 3f36 9909 sbc r25,r9 |
||
6323 | 6338 3f38 9093 0000 sts (DiffRoll)+1,r25 |
||
6324 | 6339 3f3c 8093 0000 sts DiffRoll,r24 |
||
6325 | 6340 3f40 20E0 ldi r18,lo8(0x0) |
||
6326 | 6341 3f42 30E0 ldi r19,hi8(0x0) |
||
6327 | 6342 3f44 40E0 ldi r20,hlo8(0x0) |
||
6328 | 6343 3f46 50E0 ldi r21,hhi8(0x0) |
||
6329 | 6344 3f48 6985 ldd r22,Y+9 |
||
6330 | 6345 3f4a 7A85 ldd r23,Y+10 |
||
6331 | 6346 3f4c 8B85 ldd r24,Y+11 |
||
6332 | 6347 3f4e 9C85 ldd r25,Y+12 |
||
6333 | 6348 3f50 0E94 0000 call __nesf2 |
||
6334 | 6349 3f54 8823 tst r24 |
||
6335 | 6350 3f56 01F0 breq .L790 |
||
6336 | 6351 3f58 E090 0000 lds r14,IntegralRoll |
||
6337 | 6352 3f5c F090 0000 lds r15,(IntegralRoll)+1 |
||
6338 | 6353 3f60 0091 0000 lds r16,(IntegralRoll)+2 |
||
6339 | 6354 3f64 1091 0000 lds r17,(IntegralRoll)+3 |
||
6340 | 6355 3f68 6091 0000 lds r22,SummeRoll.2570 |
||
6341 | 6356 3f6c 7091 0000 lds r23,(SummeRoll.2570)+1 |
||
6342 | 6357 3f70 8091 0000 lds r24,(SummeRoll.2570)+2 |
||
6343 | 6358 3f74 9091 0000 lds r25,(SummeRoll.2570)+3 |
||
6344 | 6359 3f78 0E94 0000 call __floatsisf |
||
6345 | 6360 3f7c 5B01 movw r10,r22 |
||
6346 | 6361 3f7e 6C01 movw r12,r24 |
||
6347 | 6362 3f80 C801 movw r24,r16 |
||
6348 | 6363 3f82 B701 movw r22,r14 |
||
6349 | 6364 3f84 0E94 0000 call __floatsisf |
||
6350 | 6365 3f88 2985 ldd r18,Y+9 |
||
6351 | 6366 3f8a 3A85 ldd r19,Y+10 |
||
6352 | 6367 3f8c 4B85 ldd r20,Y+11 |
||
6353 | 6368 3f8e 5C85 ldd r21,Y+12 |
||
6354 | 6369 3f90 0E94 0000 call __mulsf3 |
||
6355 | 6370 3f94 7B01 movw r14,r22 |
||
6356 | 6371 3f96 8C01 movw r16,r24 |
||
6357 | 6372 3f98 B401 movw r22,r8 |
||
6358 | 6373 3f9a 8827 clr r24 |
||
6359 | 6374 3f9c 77FD sbrc r23,7 |
||
6360 | 6375 3f9e 8095 com r24 |
||
6361 | 6376 3fa0 982F mov r25,r24 |
||
6362 | 6377 3fa2 0E94 0000 call __floatsisf |
||
6363 | 6378 3fa6 9B01 movw r18,r22 |
||
6364 | 6379 3fa8 AC01 movw r20,r24 |
||
6365 | 6380 3faa C801 movw r24,r16 |
||
6366 | 6381 3fac B701 movw r22,r14 |
||
6367 | 6382 3fae 0E94 0000 call __subsf3 |
||
6368 | 6383 3fb2 9B01 movw r18,r22 |
||
6369 | 6384 3fb4 AC01 movw r20,r24 |
||
6370 | 6385 3fb6 C601 movw r24,r12 |
||
6371 | 6386 3fb8 B501 movw r22,r10 |
||
6372 | 6387 3fba 0E94 0000 call __addsf3 |
||
6373 | 6388 3fbe 0E94 0000 call __fixsfsi |
||
6374 | 6389 3fc2 6093 0000 sts SummeRoll.2570,r22 |
||
6375 | 6390 3fc6 7093 0000 sts (SummeRoll.2570)+1,r23 |
||
6376 | 6391 3fca 8093 0000 sts (SummeRoll.2570)+2,r24 |
||
6377 | 6392 3fce 9093 0000 sts (SummeRoll.2570)+3,r25 |
||
6378 | 6393 3fd2 00C0 rjmp .L793 |
||
6379 | 6394 .L790: |
||
6380 | 6395 3fd4 2091 0000 lds r18,DiffRoll |
||
6381 | 6396 3fd8 3091 0000 lds r19,(DiffRoll)+1 |
||
6382 | 6397 3fdc 4427 clr r20 |
||
6383 | 6398 3fde 37FD sbrc r19,7 |
||
6384 | 6399 3fe0 4095 com r20 |
||
6385 | 6400 3fe2 542F mov r21,r20 |
||
6386 | 6401 3fe4 8091 0000 lds r24,SummeRoll.2570 |
||
6387 | 6402 3fe8 9091 0000 lds r25,(SummeRoll.2570)+1 |
||
6388 | 6403 3fec A091 0000 lds r26,(SummeRoll.2570)+2 |
||
6389 | 6404 3ff0 B091 0000 lds r27,(SummeRoll.2570)+3 |
||
6390 | 6405 3ff4 820F add r24,r18 |
||
6391 | 6406 3ff6 931F adc r25,r19 |
||
6392 | 6407 3ff8 A41F adc r26,r20 |
||
6393 | 6408 3ffa B51F adc r27,r21 |
||
6394 | 6409 3ffc 8093 0000 sts SummeRoll.2570,r24 |
||
6395 | 6410 4000 9093 0000 sts (SummeRoll.2570)+1,r25 |
||
6396 | 6411 4004 A093 0000 sts (SummeRoll.2570)+2,r26 |
||
6397 | 6412 4008 B093 0000 sts (SummeRoll.2570)+3,r27 |
||
6398 | 6413 .L793: |
||
6399 | 6414 400c 8091 0000 lds r24,SummeRoll.2570 |
||
6400 | 6415 4010 9091 0000 lds r25,(SummeRoll.2570)+1 |
||
6401 | 6416 4014 A091 0000 lds r26,(SummeRoll.2570)+2 |
||
6402 | 6417 4018 B091 0000 lds r27,(SummeRoll.2570)+3 |
||
6403 | 6418 401c 1816 cp __zero_reg__,r24 |
||
6404 | 6419 401e 1906 cpc __zero_reg__,r25 |
||
6405 | 6420 4020 1A06 cpc __zero_reg__,r26 |
||
6406 | 6421 4022 1B06 cpc __zero_reg__,r27 |
||
6407 | 6422 4024 04F4 brge .L794 |
||
6408 | 6423 4026 0297 sbiw r24,2 |
||
6409 | 6424 4028 A109 sbc r26,__zero_reg__ |
||
6410 | 6425 402a B109 sbc r27,__zero_reg__ |
||
6411 | 6426 402c 00C0 rjmp .L830 |
||
6412 | 6427 .L794: |
||
6413 | 6428 402e 0296 adiw r24,2 |
||
6414 | 6429 4030 A11D adc r26,__zero_reg__ |
||
6415 | 6430 4032 B11D adc r27,__zero_reg__ |
||
6416 | 6431 .L830: |
||
6417 | 6432 4034 8093 0000 sts SummeRoll.2570,r24 |
||
6418 | 6433 4038 9093 0000 sts (SummeRoll.2570)+1,r25 |
||
6419 | 6434 403c A093 0000 sts (SummeRoll.2570)+2,r26 |
||
6420 | 6435 4040 B093 0000 sts (SummeRoll.2570)+3,r27 |
||
6421 | 6436 4044 8091 0000 lds r24,SummeRoll.2570 |
||
6422 | 6437 4048 9091 0000 lds r25,(SummeRoll.2570)+1 |
||
6423 | 6438 404c A091 0000 lds r26,(SummeRoll.2570)+2 |
||
6424 | 6439 4050 B091 0000 lds r27,(SummeRoll.2570)+3 |
||
6425 | 6440 4054 8138 cpi r24,lo8(16001) |
||
6426 | 6441 4056 EEE3 ldi r30,hi8(16001) |
||
6427 | 6442 4058 9E07 cpc r25,r30 |
||
6428 | 6443 405a E0E0 ldi r30,hlo8(16001) |
||
6429 | 6444 405c AE07 cpc r26,r30 |
||
6430 | 6445 405e E0E0 ldi r30,hhi8(16001) |
||
6431 | 6446 4060 BE07 cpc r27,r30 |
||
6432 | 6447 4062 04F0 brlt .L797 |
||
6433 | 6448 4064 80E8 ldi r24,lo8(16000) |
||
6434 | 6449 4066 9EE3 ldi r25,hi8(16000) |
||
6435 | 6450 4068 A0E0 ldi r26,hlo8(16000) |
||
6436 | 6451 406a B0E0 ldi r27,hhi8(16000) |
||
6437 | 6452 406c 00C0 rjmp .L831 |
||
6438 | 6453 .L797: |
||
6439 | 6454 406e 8058 subi r24,lo8(-16000) |
||
6440 | 6455 4070 914C sbci r25,hi8(-16000) |
||
6441 | 6456 4072 AF4F sbci r26,hlo8(-16000) |
||
6442 | 6457 4074 BF4F sbci r27,hhi8(-16000) |
||
6443 | 6458 4076 04F4 brge .L799 |
||
6444 | 6459 4078 80E8 ldi r24,lo8(-16000) |
||
6445 | 6460 407a 91EC ldi r25,hi8(-16000) |
||
6446 | 6461 407c AFEF ldi r26,hlo8(-16000) |
||
6447 | 6462 407e BFEF ldi r27,hhi8(-16000) |
||
6448 | 6463 .L831: |
||
6449 | 6464 4080 8093 0000 sts SummeRoll.2570,r24 |
||
6450 | 6465 4084 9093 0000 sts (SummeRoll.2570)+1,r25 |
||
6451 | 6466 4088 A093 0000 sts (SummeRoll.2570)+2,r26 |
||
6452 | 6467 408c B093 0000 sts (SummeRoll.2570)+3,r27 |
||
6453 | 6468 .L799: |
||
6454 | 6469 4090 6091 0000 lds r22,DiffRoll |
||
6455 | 6470 4094 7091 0000 lds r23,(DiffRoll)+1 |
||
6456 | 6471 4098 8827 clr r24 |
||
6457 | 6472 409a 77FD sbrc r23,7 |
||
6458 | 6473 409c 8095 com r24 |
||
6459 | 6474 409e 982F mov r25,r24 |
||
6460 | 6475 40a0 0E94 0000 call __floatsisf |
||
6461 | 6476 40a4 7B01 movw r14,r22 |
||
6462 | 6477 40a6 8C01 movw r16,r24 |
||
6463 | 6478 40a8 6091 0000 lds r22,SummeRoll.2570 |
||
6464 | 6479 40ac 7091 0000 lds r23,(SummeRoll.2570)+1 |
||
6465 | 6480 40b0 8091 0000 lds r24,(SummeRoll.2570)+2 |
||
6466 | 6481 40b4 9091 0000 lds r25,(SummeRoll.2570)+3 |
||
6467 | 6482 40b8 0E94 0000 call __floatsisf |
||
6468 | 6483 40bc 9B01 movw r18,r22 |
||
6469 | 6484 40be AC01 movw r20,r24 |
||
6470 | 6485 40c0 6D81 ldd r22,Y+5 |
||
6471 | 6486 40c2 7E81 ldd r23,Y+6 |
||
6472 | 6487 40c4 8F81 ldd r24,Y+7 |
||
6473 | 6488 40c6 9885 ldd r25,Y+8 |
||
6474 | 6489 40c8 0E94 0000 call __mulsf3 |
||
6475 | 6490 40cc 9B01 movw r18,r22 |
||
6476 | 6491 40ce AC01 movw r20,r24 |
||
6477 | 6492 40d0 C801 movw r24,r16 |
||
6478 | 6493 40d2 B701 movw r22,r14 |
||
6479 | 6494 40d4 0E94 0000 call __addsf3 |
||
6480 | 6495 40d8 0E94 0000 call __fixsfsi |
||
6481 | 6496 40dc 9101 movw r18,r2 |
||
6482 | 6497 40de 6215 cp r22,r2 |
||
6483 | 6498 40e0 7305 cpc r23,r3 |
||
6484 | 6499 40e2 04F4 brge .L801 |
||
6485 | 6500 40e4 9B01 movw r18,r22 |
||
6486 | 6501 .L801: |
||
6487 | 6502 40e6 C301 movw r24,r6 |
||
6488 | 6503 40e8 6216 cp r6,r18 |
||
6489 | 6504 40ea 7306 cpc r7,r19 |
||
6490 | 6505 40ec 04F4 brge .L802 |
||
6491 | 6506 40ee C901 movw r24,r18 |
||
6492 | 6507 .L802: |
||
6493 | 6508 40f0 4981 ldd r20,Y+1 |
||
6494 | 6509 40f2 5A81 ldd r21,Y+2 |
||
6495 | 6510 40f4 480F add r20,r24 |
||
6496 | 6511 40f6 591F adc r21,r25 |
||
6497 | 6512 40f8 2B81 ldd r18,Y+3 |
||
6498 | 6513 40fa 3C81 ldd r19,Y+4 |
||
6499 | 6514 40fc 421B sub r20,r18 |
||
6500 | 6515 40fe 530B sbc r21,r19 |
||
6501 | 6516 4100 57FF sbrs r21,7 |
||
6502 | 6517 4102 00C0 rjmp .L803 |
||
6503 | 6518 4104 60E0 ldi r22,lo8(0) |
||
6504 | 6519 4106 70E0 ldi r23,hi8(0) |
||
6505 | 6520 4108 00C0 rjmp .L805 |
||
6506 | 6521 .L803: |
||
6507 | 6522 410a B201 movw r22,r4 |
||
6508 | 6523 410c 4415 cp r20,r4 |
||
6509 | 6524 410e 5505 cpc r21,r5 |
||
6510 | 6525 4110 04F4 brge .L805 |
||
6511 | 6526 4112 BA01 movw r22,r20 |
||
6512 | 6527 .L805: |
||
6513 | 6528 4114 4F89 ldd r20,Y+23 |
||
6514 | 6529 4116 588D ldd r21,Y+24 |
||
6515 | 6530 4118 4617 cp r20,r22 |
||
6516 | 6531 411a 5707 cpc r21,r23 |
||
6517 | 6532 411c 04F4 brge .L807 |
||
6518 | 6533 411e AB01 movw r20,r22 |
||
6519 | 6534 .L807: |
||
6520 | 6535 4120 4093 0000 sts Motor_Links,r20 |
||
6521 | 6536 4124 2981 ldd r18,Y+1 |
||
6522 | 6537 4126 3A81 ldd r19,Y+2 |
||
6523 | 6538 4128 281B sub r18,r24 |
||
6524 | 6539 412a 390B sbc r19,r25 |
||
6525 | 6540 412c 4B81 ldd r20,Y+3 |
||
6526 | 6541 412e 5C81 ldd r21,Y+4 |
||
6527 | 6542 4130 241B sub r18,r20 |
||
6528 | 6543 4132 350B sbc r19,r21 |
||
6529 | 6544 4134 37FF sbrs r19,7 |
||
6530 | 6545 4136 00C0 rjmp .L808 |
||
6531 | 6546 4138 80E0 ldi r24,lo8(0) |
||
6532 | 6547 413a 90E0 ldi r25,hi8(0) |
||
6533 | 6548 413c 00C0 rjmp .L810 |
||
6534 | 6549 .L808: |
||
6535 | 6550 413e C201 movw r24,r4 |
||
6536 | 6551 4140 2415 cp r18,r4 |
||
6537 | 6552 4142 3505 cpc r19,r5 |
||
6538 | 6553 4144 04F4 brge .L810 |
||
6539 | 6554 4146 C901 movw r24,r18 |
||
6540 | 6555 .L810: |
||
6541 | 6556 4148 2F89 ldd r18,Y+23 |
||
6542 | 6557 414a 388D ldd r19,Y+24 |
||
6543 | 6558 414c 2817 cp r18,r24 |
||
6544 | 6559 414e 3907 cpc r19,r25 |
||
6545 | 6560 4150 04F0 brlt .+2 |
||
6546 | 6561 4152 00C0 rjmp .L812 |
||
6547 | 6562 4154 9C01 movw r18,r24 |
||
6548 | 6563 4156 00C0 rjmp .L812 |
||
6549 | 6564 .L552: |
||
6550 | 6565 4158 2091 0000 lds r18,ExternStickNick |
||
6551 | 6566 415c 3091 0000 lds r19,(ExternStickNick)+1 |
||
6552 | 6567 4160 C901 movw r24,r18 |
||
6553 | 6568 4162 13E0 ldi r17,3 |
||
6554 | 6569 4164 880F 1: lsl r24 |
||
6555 | 6570 4166 991F rol r25 |
||
6556 | 6571 4168 1A95 dec r17 |
||
6557 | 6572 416a 01F4 brne 1b |
||
6558 | 6573 416c 821B sub r24,r18 |
||
6559 | 6574 416e 930B sbc r25,r19 |
||
6560 | 6575 4170 68E0 ldi r22,lo8(8) |
||
6561 | 6576 4172 70E0 ldi r23,hi8(8) |
||
6562 | 6577 4174 0E94 0000 call __divmodhi4 |
||
6563 | 6578 4178 788F std Y+24,r23 |
||
6564 | 6579 417a 6F8B std Y+23,r22 |
||
6565 | 6580 417c 7093 0000 sts (ExternStickNick)+1,r23 |
||
6566 | 6581 4180 6093 0000 sts ExternStickNick,r22 |
||
6567 | 6582 .L818: |
||
6568 | 6583 4184 40E0 ldi r20,lo8(0) |
||
6569 | 6584 4186 50E0 ldi r21,hi8(0) |
||
6570 | 6585 4188 0C94 0000 jmp .L561 |
||
6571 | 6586 .L628: |
||
6572 | 6587 418c 8091 0000 lds r24,Looping_Nick |
||
6573 | 6588 4190 8823 tst r24 |
||
6574 | 6589 4192 01F4 brne .+4 |
||
6575 | 6590 4194 0C94 0000 jmp .L630 |
||
6576 | 6591 4198 0C94 0000 jmp .L627 |
||
6577 | 6592 .L816: |
||
6578 | 6593 419c 6091 0000 lds r22,IntegralNick |
||
6579 | 6594 41a0 7091 0000 lds r23,(IntegralNick)+1 |
||
6580 | 6595 41a4 8091 0000 lds r24,(IntegralNick)+2 |
||
6581 | 6596 41a8 9091 0000 lds r25,(IntegralNick)+3 |
||
6582 | 6597 41ac A090 0000 lds r10,EE_Parameter+20 |
||
6583 | 6598 41b0 BB24 clr r11 |
||
6584 | 6599 41b2 CC24 clr r12 |
||
6585 | 6600 41b4 DD24 clr r13 |
||
6586 | 6601 41b6 E090 0000 lds r14,Mittelwert_AccNick |
||
6587 | 6602 41ba F090 0000 lds r15,(Mittelwert_AccNick)+1 |
||
6588 | 6603 41be A601 movw r20,r12 |
||
6589 | 6604 41c0 9501 movw r18,r10 |
||
6590 | 6605 41c2 0E94 0000 call __divmodsi4 |
||
6591 | 6606 41c6 0027 clr r16 |
||
6592 | 6607 41c8 F7FC sbrc r15,7 |
||
6593 | 6608 41ca 0095 com r16 |
||
6594 | 6609 41cc 102F mov r17,r16 |
||
6595 | 6610 41ce 2E19 sub r18,r14 |
||
6596 | 6611 41d0 3F09 sbc r19,r15 |
||
6597 | 6612 41d2 400B sbc r20,r16 |
||
6598 | 6613 41d4 510B sbc r21,r17 |
||
6599 | 6614 41d6 CA01 movw r24,r20 |
||
6600 | 6615 41d8 B901 movw r22,r18 |
||
6601 | 6616 41da 20E1 ldi r18,lo8(16) |
||
6602 | 6617 41dc 30E0 ldi r19,hi8(16) |
||
6603 | 6618 41de 40E0 ldi r20,hlo8(16) |
||
6604 | 6619 41e0 50E0 ldi r21,hhi8(16) |
||
6605 | 6620 41e2 0E94 0000 call __divmodsi4 |
||
6606 | 6621 41e6 3901 movw r6,r18 |
||
6607 | 6622 41e8 4A01 movw r8,r20 |
||
6608 | 6623 41ea 6091 0000 lds r22,IntegralRoll |
||
6609 | 6624 41ee 7091 0000 lds r23,(IntegralRoll)+1 |
||
6610 | 6625 41f2 8091 0000 lds r24,(IntegralRoll)+2 |
||
6611 | 6626 41f6 9091 0000 lds r25,(IntegralRoll)+3 |
||
6612 | 6627 41fa E090 0000 lds r14,Mittelwert_AccRoll |
||
6613 | 6628 41fe F090 0000 lds r15,(Mittelwert_AccRoll)+1 |
||
6614 | 6629 4202 A601 movw r20,r12 |
||
6615 | 6630 4204 9501 movw r18,r10 |
||
6616 | 6631 4206 0E94 0000 call __divmodsi4 |
||
6617 | 6632 420a 0027 clr r16 |
||
6618 | 6633 420c F7FC sbrc r15,7 |
||
6619 | 6634 420e 0095 com r16 |
||
6620 | 6635 4210 102F mov r17,r16 |
||
6621 | 6636 4212 2E19 sub r18,r14 |
||
6622 | 6637 4214 3F09 sbc r19,r15 |
||
6623 | 6638 4216 400B sbc r20,r16 |
||
6624 | 6639 4218 510B sbc r21,r17 |
||
6625 | 6640 421a CA01 movw r24,r20 |
||
6626 | 6641 421c B901 movw r22,r18 |
||
6627 | 6642 421e 20E1 ldi r18,lo8(16) |
||
6628 | 6643 4220 30E0 ldi r19,hi8(16) |
||
6629 | 6644 4222 40E0 ldi r20,hlo8(16) |
||
6630 | 6645 4224 50E0 ldi r21,hhi8(16) |
||
6631 | 6646 4226 0E94 0000 call __divmodsi4 |
||
6632 | 6647 422a 5901 movw r10,r18 |
||
6633 | 6648 422c 6A01 movw r12,r20 |
||
6634 | 6649 422e 61E2 ldi r22,lo8(33) |
||
6635 | 6650 4230 6616 cp r6,r22 |
||
6636 | 6651 4232 7104 cpc r7,__zero_reg__ |
||
6637 | 6652 4234 8104 cpc r8,__zero_reg__ |
||
6638 | 6653 4236 9104 cpc r9,__zero_reg__ |
||
6639 | 6654 4238 04F4 brge .+4 |
||
6640 | 6655 423a 0C94 0000 jmp .L639 |
||
6641 | 6656 423e B0E2 ldi r27,lo8(32) |
||
6642 | 6657 4240 6B2E mov r6,r27 |
||
6643 | 6658 4242 712C mov r7,__zero_reg__ |
||
6644 | 6659 4244 812C mov r8,__zero_reg__ |
||
6645 | 6660 4246 912C mov r9,__zero_reg__ |
||
6646 | 6661 4248 0C94 0000 jmp .L640 |
||
6647 | 6662 .L636: |
||
6648 | 6663 424c 1092 0000 sts IntegralAccNick,__zero_reg__ |
||
6649 | 6664 4250 1092 0000 sts (IntegralAccNick)+1,__zero_reg__ |
||
6650 | 6665 4254 1092 0000 sts (IntegralAccNick)+2,__zero_reg__ |
||
6651 | 6666 4258 1092 0000 sts (IntegralAccNick)+3,__zero_reg__ |
||
6652 | 6667 425c 1092 0000 sts IntegralAccRoll,__zero_reg__ |
||
6653 | 6668 4260 1092 0000 sts (IntegralAccRoll)+1,__zero_reg__ |
||
6654 | 6669 4264 1092 0000 sts (IntegralAccRoll)+2,__zero_reg__ |
||
6655 | 6670 4268 1092 0000 sts (IntegralAccRoll)+3,__zero_reg__ |
||
6656 | 6671 426c 1092 0000 sts MittelIntegralNick,__zero_reg__ |
||
6657 | 6672 4270 1092 0000 sts (MittelIntegralNick)+1,__zero_reg__ |
||
6658 | 6673 4274 1092 0000 sts (MittelIntegralNick)+2,__zero_reg__ |
||
6659 | 6674 4278 1092 0000 sts (MittelIntegralNick)+3,__zero_reg__ |
||
6660 | 6675 427c 1092 0000 sts MittelIntegralRoll,__zero_reg__ |
||
6661 | 6676 4280 1092 0000 sts (MittelIntegralRoll)+1,__zero_reg__ |
||
6662 | 6677 4284 1092 0000 sts (MittelIntegralRoll)+2,__zero_reg__ |
||
6663 | 6678 4288 1092 0000 sts (MittelIntegralRoll)+3,__zero_reg__ |
||
6664 | 6679 428c 1092 0000 sts MittelIntegralNick2,__zero_reg__ |
||
6665 | 6680 4290 1092 0000 sts (MittelIntegralNick2)+1,__zero_reg__ |
||
6666 | 6681 4294 1092 0000 sts (MittelIntegralNick2)+2,__zero_reg__ |
||
6667 | 6682 4298 1092 0000 sts (MittelIntegralNick2)+3,__zero_reg__ |
||
6668 | 6683 429c 1092 0000 sts MittelIntegralRoll2,__zero_reg__ |
||
6669 | 6684 42a0 1092 0000 sts (MittelIntegralRoll2)+1,__zero_reg__ |
||
6670 | 6685 42a4 1092 0000 sts (MittelIntegralRoll2)+2,__zero_reg__ |
||
6671 | 6686 42a8 1092 0000 sts (MittelIntegralRoll2)+3,__zero_reg__ |
||
6672 | 6687 42ac 8091 0000 lds r24,Mess_IntegralNick |
||
6673 | 6688 42b0 9091 0000 lds r25,(Mess_IntegralNick)+1 |
||
6674 | 6689 42b4 A091 0000 lds r26,(Mess_IntegralNick)+2 |
||
6675 | 6690 42b8 B091 0000 lds r27,(Mess_IntegralNick)+3 |
||
6676 | 6691 42bc 8093 0000 sts Mess_IntegralNick2,r24 |
||
6677 | 6692 42c0 9093 0000 sts (Mess_IntegralNick2)+1,r25 |
||
6678 | 6693 42c4 A093 0000 sts (Mess_IntegralNick2)+2,r26 |
||
6679 | 6694 42c8 B093 0000 sts (Mess_IntegralNick2)+3,r27 |
||
6680 | 6695 42cc 8091 0000 lds r24,Mess_IntegralRoll |
||
6681 | 6696 42d0 9091 0000 lds r25,(Mess_IntegralRoll)+1 |
||
6682 | 6697 42d4 A091 0000 lds r26,(Mess_IntegralRoll)+2 |
||
6683 | 6698 42d8 B091 0000 lds r27,(Mess_IntegralRoll)+3 |
||
6684 | 6699 42dc 8093 0000 sts Mess_IntegralRoll2,r24 |
||
6685 | 6700 42e0 9093 0000 sts (Mess_IntegralRoll2)+1,r25 |
||
6686 | 6701 42e4 A093 0000 sts (Mess_IntegralRoll2)+2,r26 |
||
6687 | 6702 42e8 B093 0000 sts (Mess_IntegralRoll2)+3,r27 |
||
6688 | 6703 42ec 1092 0000 sts (ZaehlMessungen)+1,__zero_reg__ |
||
6689 | 6704 42f0 1092 0000 sts ZaehlMessungen,__zero_reg__ |
||
6690 | 6705 42f4 1092 0000 sts (LageKorrekturNick)+1,__zero_reg__ |
||
6691 | 6706 42f8 1092 0000 sts LageKorrekturNick,__zero_reg__ |
||
6692 | 6707 42fc 1092 0000 sts (LageKorrekturRoll)+1,__zero_reg__ |
||
6693 | 6708 4300 1092 0000 sts LageKorrekturRoll,__zero_reg__ |
||
6694 | 6709 4304 0C94 0000 jmp .L638 |
||
6695 | 6710 .L812: |
||
6696 | 6711 4308 2093 0000 sts Motor_Rechts,r18 |
||
6697 | 6712 /* epilogue: frame size=26 */ |
||
6698 | 6713 430c 6A96 adiw r28,26 |
||
6699 | 6714 430e 0FB6 in __tmp_reg__,__SREG__ |
||
6700 | 6715 4310 F894 cli |
||
6701 | 6716 4312 DEBF out __SP_H__,r29 |
||
6702 | 6717 4314 0FBE out __SREG__,__tmp_reg__ |
||
6703 | 6718 4316 CDBF out __SP_L__,r28 |
||
6704 | 6719 4318 DF91 pop r29 |
||
6705 | 6720 431a CF91 pop r28 |
||
6706 | 6721 431c 1F91 pop r17 |
||
6707 | 6722 431e 0F91 pop r16 |
||
6708 | 6723 4320 FF90 pop r15 |
||
6709 | 6724 4322 EF90 pop r14 |
||
6710 | 6725 4324 DF90 pop r13 |
||
6711 | 6726 4326 CF90 pop r12 |
||
6712 | 6727 4328 BF90 pop r11 |
||
6713 | 6728 432a AF90 pop r10 |
||
6714 | 6729 432c 9F90 pop r9 |
||
6715 | 6730 432e 8F90 pop r8 |
||
6716 | 6731 4330 7F90 pop r7 |
||
6717 | 6732 4332 6F90 pop r6 |
||
6718 | 6733 4334 5F90 pop r5 |
||
6719 | 6734 4336 4F90 pop r4 |
||
6720 | 6735 4338 3F90 pop r3 |
||
6721 | 6736 433a 2F90 pop r2 |
||
6722 | 6737 433c 0895 ret |
||
6723 | 6738 /* epilogue end (size=25) */ |
||
6724 | 6739 /* function MotorRegler size 5168 (5117) */ |
||
6725 | 6741 .global I2CTimeout |
||
6726 | 6742 .data |
||
6727 | 6745 I2CTimeout: |
||
6728 | 6746 0019 6400 .word 100 |
||
6729 | 6747 .global AdNeutralNick |
||
6730 | 6748 .global AdNeutralNick |
||
6731 | 6749 .section .bss |
||
6732 | 6752 AdNeutralNick: |
||
6733 | 6753 0000 0000 .skip 2,0 |
||
6734 | 6754 .global AdNeutralRoll |
||
6735 | 6755 .global AdNeutralRoll |
||
6736 | 6758 AdNeutralRoll: |
||
6737 | 6759 0002 0000 .skip 2,0 |
||
6738 | 6760 .global AdNeutralGier |
||
6739 | 6761 .global AdNeutralGier |
||
6740 | 6764 AdNeutralGier: |
||
6741 | 6765 0004 0000 .skip 2,0 |
||
6742 | 6766 .global StartNeutralRoll |
||
6743 | 6767 .global StartNeutralRoll |
||
6744 | 6770 StartNeutralRoll: |
||
6745 | 6771 0006 0000 .skip 2,0 |
||
6746 | 6772 .global StartNeutralNick |
||
6747 | 6773 .global StartNeutralNick |
||
6748 | 6776 StartNeutralNick: |
||
6749 | 6777 0008 0000 .skip 2,0 |
||
6750 | 6778 .global NeutralAccX |
||
6751 | 6779 .global NeutralAccX |
||
6752 | 6782 NeutralAccX: |
||
6753 | 6783 000a 0000 .skip 2,0 |
||
6754 | 6784 .global NeutralAccY |
||
6755 | 6785 .global NeutralAccY |
||
6756 | 6788 NeutralAccY: |
||
6757 | 6789 000c 0000 .skip 2,0 |
||
6758 | 6790 .global NeutralAccZ |
||
6759 | 6791 .global NeutralAccZ |
||
6760 | 6794 NeutralAccZ: |
||
6761 | 6795 000e 0000 0000 .skip 4,0 |
||
6762 | 6796 .global CosinusNickWinkel |
||
6763 | 6797 .global CosinusNickWinkel |
||
6764 | 6800 CosinusNickWinkel: |
||
6765 | 6801 0012 00 .skip 1,0 |
||
6766 | 6802 .global CosinusRollWinkel |
||
6767 | 6803 .global CosinusRollWinkel |
||
6768 | 6806 CosinusRollWinkel: |
||
6769 | 6807 0013 00 .skip 1,0 |
||
6770 | 6808 .global IntegralNick |
||
6771 | 6809 .global IntegralNick |
||
6772 | 6812 IntegralNick: |
||
6773 | 6813 0014 0000 0000 .skip 4,0 |
||
6774 | 6814 .global IntegralNick2 |
||
6775 | 6815 .global IntegralNick2 |
||
6776 | 6818 IntegralNick2: |
||
6777 | 6819 0018 0000 0000 .skip 4,0 |
||
6778 | 6820 .global IntegralRoll |
||
6779 | 6821 .global IntegralRoll |
||
6780 | 6824 IntegralRoll: |
||
6781 | 6825 001c 0000 0000 .skip 4,0 |
||
6782 | 6826 .global IntegralRoll2 |
||
6783 | 6827 .global IntegralRoll2 |
||
6784 | 6830 IntegralRoll2: |
||
6785 | 6831 0020 0000 0000 .skip 4,0 |
||
6786 | 6832 .global IntegralAccNick |
||
6787 | 6833 .global IntegralAccNick |
||
6788 | 6836 IntegralAccNick: |
||
6789 | 6837 0024 0000 0000 .skip 4,0 |
||
6790 | 6838 .global IntegralAccRoll |
||
6791 | 6839 .global IntegralAccRoll |
||
6792 | 6842 IntegralAccRoll: |
||
6793 | 6843 0028 0000 0000 .skip 4,0 |
||
6794 | 6844 .global IntegralAccZ |
||
6795 | 6845 .global IntegralAccZ |
||
6796 | 6848 IntegralAccZ: |
||
6797 | 6849 002c 0000 0000 .skip 4,0 |
||
6798 | 6850 .global Integral_Gier |
||
6799 | 6851 .global Integral_Gier |
||
6800 | 6854 Integral_Gier: |
||
6801 | 6855 0030 0000 0000 .skip 4,0 |
||
6802 | 6856 .global Mess_IntegralNick |
||
6803 | 6857 .global Mess_IntegralNick |
||
6804 | 6860 Mess_IntegralNick: |
||
6805 | 6861 0034 0000 0000 .skip 4,0 |
||
6806 | 6862 .global Mess_IntegralNick2 |
||
6807 | 6863 .global Mess_IntegralNick2 |
||
6808 | 6866 Mess_IntegralNick2: |
||
6809 | 6867 0038 0000 0000 .skip 4,0 |
||
6810 | 6868 .global Mess_IntegralRoll |
||
6811 | 6869 .global Mess_IntegralRoll |
||
6812 | 6872 Mess_IntegralRoll: |
||
6813 | 6873 003c 0000 0000 .skip 4,0 |
||
6814 | 6874 .global Mess_IntegralRoll2 |
||
6815 | 6875 .global Mess_IntegralRoll2 |
||
6816 | 6878 Mess_IntegralRoll2: |
||
6817 | 6879 0040 0000 0000 .skip 4,0 |
||
6818 | 6880 .global Mess_Integral_Gier |
||
6819 | 6881 .global Mess_Integral_Gier |
||
6820 | 6884 Mess_Integral_Gier: |
||
6821 | 6885 0044 0000 0000 .skip 4,0 |
||
6822 | 6886 .global Mess_Integral_Gier2 |
||
6823 | 6887 .global Mess_Integral_Gier2 |
||
6824 | 6890 Mess_Integral_Gier2: |
||
6825 | 6891 0048 0000 0000 .skip 4,0 |
||
6826 | 6892 .global Mess_Integral_Hoch |
||
6827 | 6893 .global Mess_Integral_Hoch |
||
6828 | 6896 Mess_Integral_Hoch: |
||
6829 | 6897 004c 0000 0000 .skip 4,0 |
||
6830 | 6898 .global KompassValue |
||
6831 | 6899 .global KompassValue |
||
6832 | 6902 KompassValue: |
||
6833 | 6903 0050 0000 .skip 2,0 |
||
6834 | 6904 .global KompassStartwert |
||
6835 | 6905 .global KompassStartwert |
||
6836 | 6908 KompassStartwert: |
||
6837 | 6909 0052 0000 .skip 2,0 |
||
6838 | 6910 .global KompassRichtung |
||
6839 | 6911 .global KompassRichtung |
||
6840 | 6914 KompassRichtung: |
||
6841 | 6915 0054 0000 .skip 2,0 |
||
6842 | 6916 .global Notlandung |
||
6843 | 6917 .global Notlandung |
||
6844 | 6920 Notlandung: |
||
6845 | 6921 0056 00 .skip 1,0 |
||
6846 | 6922 .global HoehenReglerAktiv |
||
6847 | 6923 .global HoehenReglerAktiv |
||
6848 | 6926 HoehenReglerAktiv: |
||
6849 | 6927 0057 00 .skip 1,0 |
||
6850 | 6928 .global Umschlag180Nick |
||
6851 | 6929 .data |
||
6852 | 6932 Umschlag180Nick: |
||
6853 | 6933 001b 90 .byte -112 |
||
6854 | 6934 001c D0 .byte -48 |
||
6855 | 6935 001d 03 .byte 3 |
||
6856 | 6936 001e 00 .byte 0 |
||
6857 | 6937 .global Umschlag180Roll |
||
6858 | 6940 Umschlag180Roll: |
||
6859 | 6941 001f 90 .byte -112 |
||
6860 | 6942 0020 D0 .byte -48 |
||
6861 | 6943 0021 03 .byte 3 |
||
6862 | 6944 0022 00 .byte 0 |
||
6863 | 6945 .global Poti1 |
||
6864 | 6946 .global Poti1 |
||
6865 | 6947 .section .bss |
||
6866 | 6950 Poti1: |
||
6867 | 6951 0058 0000 .skip 2,0 |
||
6868 | 6952 .global Poti2 |
||
6869 | 6953 .global Poti2 |
||
6870 | 6956 Poti2: |
||
6871 | 6957 005a 0000 .skip 2,0 |
||
6872 | 6958 .global Poti3 |
||
6873 | 6959 .global Poti3 |
||
6874 | 6962 Poti3: |
||
6875 | 6963 005c 0000 .skip 2,0 |
||
6876 | 6964 .global Poti4 |
||
6877 | 6965 .global Poti4 |
||
6878 | 6968 Poti4: |
||
6879 | 6969 005e 0000 .skip 2,0 |
||
6880 | 6970 .global SenderOkay |
||
6881 | 6971 .global SenderOkay |
||
6882 | 6974 SenderOkay: |
||
6883 | 6975 0060 00 .skip 1,0 |
||
6884 | 6976 .global StickNick |
||
6885 | 6977 .global StickNick |
||
6886 | 6980 StickNick: |
||
6887 | 6981 0061 0000 .skip 2,0 |
||
6888 | 6982 .global StickRoll |
||
6889 | 6983 .global StickRoll |
||
6890 | 6986 StickRoll: |
||
6891 | 6987 0063 0000 .skip 2,0 |
||
6892 | 6988 .global StickGier |
||
6893 | 6989 .global StickGier |
||
6894 | 6992 StickGier: |
||
6895 | 6993 0065 0000 .skip 2,0 |
||
6896 | 6994 .global MotorenEin |
||
6897 | 6995 .global MotorenEin |
||
6898 | 6998 MotorenEin: |
||
6899 | 6999 0067 00 .skip 1,0 |
||
6900 | 7000 .global HoehenWert |
||
6901 | 7001 .global HoehenWert |
||
6902 | 7004 HoehenWert: |
||
6903 | 7005 0068 0000 .skip 2,0 |
||
6904 | 7006 .global SollHoehe |
||
6905 | 7007 .global SollHoehe |
||
6906 | 7010 SollHoehe: |
||
6907 | 7011 006a 0000 .skip 2,0 |
||
6908 | 7012 .global LageKorrekturRoll |
||
6909 | 7013 .global LageKorrekturRoll |
||
6910 | 7016 LageKorrekturRoll: |
||
6911 | 7017 006c 0000 .skip 2,0 |
||
6912 | 7018 .global LageKorrekturNick |
||
6913 | 7019 .global LageKorrekturNick |
||
6914 | 7022 LageKorrekturNick: |
||
6915 | 7023 006e 0000 .skip 2,0 |
||
6916 | 7024 .global Ki |
||
6917 | 7025 .data |
||
6918 | 7028 Ki: |
||
6919 | 7029 0023 17 .byte 23 |
||
6920 | 7030 0024 B7 .byte -73 |
||
6921 | 7031 0025 D1 .byte -47 |
||
6922 | 7032 0026 38 .byte 56 |
||
6923 | 7033 .global Looping_Nick |
||
6924 | 7034 .global Looping_Nick |
||
6925 | 7035 .section .bss |
||
6926 | 7038 Looping_Nick: |
||
6927 | 7039 0070 00 .skip 1,0 |
||
6928 | 7040 .global Looping_Roll |
||
6929 | 7041 .global Looping_Roll |
||
6930 | 7044 Looping_Roll: |
||
6931 | 7045 0071 00 .skip 1,0 |
||
6932 | 7046 .global Looping_Links |
||
6933 | 7047 .global Looping_Links |
||
6934 | 7050 Looping_Links: |
||
6935 | 7051 0072 00 .skip 1,0 |
||
6936 | 7052 .global Looping_Rechts |
||
6937 | 7053 .global Looping_Rechts |
||
6938 | 7056 Looping_Rechts: |
||
6939 | 7057 0073 00 .skip 1,0 |
||
6940 | 7058 .global Looping_Unten |
||
6941 | 7059 .global Looping_Unten |
||
6942 | 7062 Looping_Unten: |
||
6943 | 7063 0074 00 .skip 1,0 |
||
6944 | 7064 .global Looping_Oben |
||
6945 | 7065 .global Looping_Oben |
||
6946 | 7068 Looping_Oben: |
||
6947 | 7069 0075 00 .skip 1,0 |
||
6948 | 7070 .global Parameter_Luftdruck_D |
||
6949 | 7071 .data |
||
6950 | 7074 Parameter_Luftdruck_D: |
||
6951 | 7075 0027 30 .byte 48 |
||
6952 | 7076 .global Parameter_MaxHoehe |
||
6953 | 7079 Parameter_MaxHoehe: |
||
6954 | 7080 0028 FB .byte -5 |
||
6955 | 7081 .global Parameter_Hoehe_P |
||
6956 | 7084 Parameter_Hoehe_P: |
||
6957 | 7085 0029 10 .byte 16 |
||
6958 | 7086 .global Parameter_Hoehe_ACC_Wirkung |
||
6959 | 7089 Parameter_Hoehe_ACC_Wirkung: |
||
6960 | 7090 002a 3A .byte 58 |
||
6961 | 7091 .global Parameter_KompassWirkung |
||
6962 | 7094 Parameter_KompassWirkung: |
||
6963 | 7095 002b 40 .byte 64 |
||
6964 | 7096 .global Parameter_Gyro_P |
||
6965 | 7099 Parameter_Gyro_P: |
||
6966 | 7100 002c 96 .byte -106 |
||
6967 | 7101 .global Parameter_Gyro_I |
||
6968 | 7104 Parameter_Gyro_I: |
||
6969 | 7105 002d 96 .byte -106 |
||
6970 | 7106 .global Parameter_Gier_P |
||
6971 | 7109 Parameter_Gier_P: |
||
6972 | 7110 002e 02 .byte 2 |
||
6973 | 7111 .global Parameter_I_Faktor |
||
6974 | 7114 Parameter_I_Faktor: |
||
6975 | 7115 002f 0A .byte 10 |
||
6976 | 7116 .global Parameter_UserParam1 |
||
6977 | 7117 .global Parameter_UserParam1 |
||
6978 | 7118 .section .bss |
||
6979 | 7121 Parameter_UserParam1: |
||
6980 | 7122 0076 00 .skip 1,0 |
||
6981 | 7123 .global Parameter_UserParam2 |
||
6982 | 7124 .global Parameter_UserParam2 |
||
6983 | 7127 Parameter_UserParam2: |
||
6984 | 7128 0077 00 .skip 1,0 |
||
6985 | 7129 .global Parameter_UserParam3 |
||
6986 | 7130 .global Parameter_UserParam3 |
||
6987 | 7133 Parameter_UserParam3: |
||
6988 | 7134 0078 00 .skip 1,0 |
||
6989 | 7135 .global Parameter_UserParam4 |
||
6990 | 7136 .global Parameter_UserParam4 |
||
6991 | 7139 Parameter_UserParam4: |
||
6992 | 7140 0079 00 .skip 1,0 |
||
6993 | 7141 .global Parameter_UserParam5 |
||
6994 | 7142 .global Parameter_UserParam5 |
||
6995 | 7145 Parameter_UserParam5: |
||
6996 | 7146 007a 00 .skip 1,0 |
||
6997 | 7147 .global Parameter_UserParam6 |
||
6998 | 7148 .global Parameter_UserParam6 |
||
6999 | 7151 Parameter_UserParam6: |
||
7000 | 7152 007b 00 .skip 1,0 |
||
7001 | 7153 .global Parameter_UserParam7 |
||
7002 | 7154 .global Parameter_UserParam7 |
||
7003 | 7157 Parameter_UserParam7: |
||
7004 | 7158 007c 00 .skip 1,0 |
||
7005 | 7159 .global Parameter_UserParam8 |
||
7006 | 7160 .global Parameter_UserParam8 |
||
7007 | 7163 Parameter_UserParam8: |
||
7008 | 7164 007d 00 .skip 1,0 |
||
7009 | 7165 .global Parameter_ServoNickControl |
||
7010 | 7166 .data |
||
7011 | 7169 Parameter_ServoNickControl: |
||
7012 | 7170 0030 64 .byte 100 |
||
7013 | 7171 .global Parameter_LoopGasLimit |
||
7014 | 7174 Parameter_LoopGasLimit: |
||
7015 | 7175 0031 46 .byte 70 |
||
7016 | 7176 .global Parameter_AchsKopplung1 |
||
7017 | 7177 .global Parameter_AchsKopplung1 |
||
7018 | 7178 .section .bss |
||
7019 | 7181 Parameter_AchsKopplung1: |
||
7020 | 7182 007e 00 .skip 1,0 |
||
7021 | 7183 .global Parameter_AchsGegenKopplung1 |
||
7022 | 7184 .global Parameter_AchsGegenKopplung1 |
||
7023 | 7187 Parameter_AchsGegenKopplung1: |
||
7024 | 7188 007f 00 .skip 1,0 |
||
7025 | 7189 .global Parameter_DynamicStability |
||
7026 | 7190 .data |
||
7027 | 7193 Parameter_DynamicStability: |
||
7028 | 7194 0032 64 .byte 100 |
||
7029 | 7195 .global ExternStickNick |
||
7030 | 7196 .global ExternStickNick |
||
7031 | 7197 .section .bss |
||
7032 | 7200 ExternStickNick: |
||
7033 | 7201 0080 0000 .skip 2,0 |
||
7034 | 7202 .global ExternStickRoll |
||
7035 | 7203 .global ExternStickRoll |
||
7036 | 7206 ExternStickRoll: |
||
7037 | 7207 0082 0000 .skip 2,0 |
||
7038 | 7208 .global ExternStickGier |
||
7039 | 7209 .global ExternStickGier |
||
7040 | 7212 ExternStickGier: |
||
7041 | 7213 0084 0000 .skip 2,0 |
||
7042 | 7214 .global ExternHoehenValue |
||
7043 | 7215 .data |
||
7044 | 7218 ExternHoehenValue: |
||
7045 | 7219 0033 ECFF .word -20 |
||
7046 | 7220 .lcomm SignalSchlecht.2599,2 |
||
7047 | 7221 .lcomm MittelIntegralRoll_Alt.2596,4 |
||
7048 | 7222 .lcomm MittelIntegralNick_Alt.2595,4 |
||
7049 | 7223 .lcomm last_r_n.2594,1 |
||
7050 | 7224 .lcomm last_r_p.2593,1 |
||
7051 | 7225 .lcomm last_n_n.2592,1 |
||
7052 | 7226 .lcomm last_n_p.2591,1 |
||
7053 | 7227 .lcomm cnt.2590,2 |
||
7054 | 7228 .lcomm ausgleichRoll.2585,4 |
||
7055 | 7229 .lcomm ausgleichNick.2584,4 |
||
7056 | 7230 .lcomm NeueKompassRichtungMerken.2583,1 |
||
7057 | 7231 .lcomm TimerWerteausgabe.2582,1 |
||
7058 | 7232 .lcomm hoehenregler.2581,2 |
||
7059 | 7233 .lcomm modell_fliegt.2580,2 |
||
7060 | 7234 .lcomm delay_ausschalten.2579,1 |
||
7061 | 7235 .lcomm delay_einschalten.2578,1 |
||
7062 | 7236 .lcomm delay_neutral.2577,1 |
||
7063 | 7237 .lcomm RcLostTimer.2576,2 |
||
7064 | 7238 .lcomm IntegralFehlerRoll.2575,4 |
||
7065 | 7239 .lcomm IntegralFehlerNick.2574,4 |
||
7066 | 7240 .lcomm tmp_long2.2573,4 |
||
7067 | 7241 .lcomm tmp_long.2572,4 |
||
7068 | 7242 .lcomm sollGier.2571,4 |
||
7069 | 7243 .lcomm SummeRoll.2570,4 |
||
7070 | 7244 .lcomm SummeNick.2569,4 |
||
7071 | 7245 .lcomm tmpl2.2204,4 |
||
7072 | 7246 .lcomm tmpl.2203,4 |
||
7073 | 7247 .comm DiffNick,2,1 |
||
7074 | 7248 .comm DiffRoll,2,1 |
||
7075 | 7249 .comm MesswertNick,2,1 |
||
7076 | 7250 .comm MesswertRoll,2,1 |
||
7077 | 7251 .comm MesswertGier,2,1 |
||
7078 | 7252 .comm Mittelwert_AccNick,2,1 |
||
7079 | 7253 .comm Mittelwert_AccRoll,2,1 |
||
7080 | 7254 .comm Mittelwert_AccHoch,2,1 |
||
7081 | 7255 .comm h,1,1 |
||
7082 | 7256 .comm m,1,1 |
||
7083 | 7257 .comm s,1,1 |
||
7084 | 7258 .comm Motor_Vorne,1,1 |
||
7085 | 7259 .comm Motor_Hinten,1,1 |
||
7086 | 7260 .comm Motor_Rechts,1,1 |
||
7087 | 7261 .comm Motor_Links,1,1 |
||
7088 | 7262 .comm Count,1,1 |
||
7089 | 7263 .comm MotorWert,5,1 |
||
7090 | 7264 .comm EE_Parameter,70,1 |
||
7091 | 7265 .comm MittelIntegralNick,4,1 |
||
7092 | 7266 .comm MittelIntegralRoll,4,1 |
||
7093 | 7267 .comm MittelIntegralNick2,4,1 |
||
7094 | 7268 .comm MittelIntegralRoll2,4,1 |
||
7095 | 7269 .comm MAX_GAS,1,1 |
||
7096 | 7270 .comm MIN_GAS,1,1 |
||
7097 | 7271 .comm GyroFaktor,4,1 |
||
7098 | 7272 .comm IntegralFaktor,4,1 |
||
7099 | 7273 /* File "fc.c": code 8718 = 0x220e (8604), prologues 54, epilogues 60 */ |
||
7100 | DEFINED SYMBOLS |
||
7101 | *ABS*:00000000 fc.c |
||
7102 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:3 *ABS*:0000003f __SREG__ |
||
7103 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:4 *ABS*:0000003e __SP_H__ |
||
7104 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:5 *ABS*:0000003d __SP_L__ |
||
7105 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6 *ABS*:00000000 __tmp_reg__ |
||
7106 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7 *ABS*:00000001 __zero_reg__ |
||
7107 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:13 .text:00000000 Mittelwert |
||
7108 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6764 .bss:00000004 AdNeutralGier |
||
7109 | *COM*:00000002 MesswertGier |
||
7110 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6758 .bss:00000002 AdNeutralRoll |
||
7111 | *COM*:00000002 MesswertRoll |
||
7112 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6752 .bss:00000000 AdNeutralNick |
||
7113 | *COM*:00000002 MesswertNick |
||
7114 | *COM*:00000002 Mittelwert_AccNick |
||
7115 | *COM*:00000002 Mittelwert_AccRoll |
||
7116 | *COM*:00000002 Mittelwert_AccHoch |
||
7117 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6836 .bss:00000024 IntegralAccNick |
||
7118 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6842 .bss:00000028 IntegralAccRoll |
||
7119 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6848 .bss:0000002c IntegralAccZ |
||
7120 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6794 .bss:0000000e NeutralAccZ |
||
7121 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6884 .bss:00000044 Mess_Integral_Gier |
||
7122 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6890 .bss:00000048 Mess_Integral_Gier2 |
||
7123 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7038 .bss:00000070 Looping_Nick |
||
7124 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7044 .bss:00000071 Looping_Roll |
||
7125 | *COM*:00000046 EE_Parameter |
||
7126 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6860 .bss:00000034 Mess_IntegralNick |
||
7127 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7181 .bss:0000007e Parameter_AchsKopplung1 |
||
7128 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7245 .bss:000000c9 tmpl.2203 |
||
7129 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6872 .bss:0000003c Mess_IntegralRoll |
||
7130 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7244 .bss:000000c5 tmpl2.2204 |
||
7131 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7187 .bss:0000007f Parameter_AchsGegenKopplung1 |
||
7132 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6878 .bss:00000040 Mess_IntegralRoll2 |
||
7133 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7016 .bss:0000006c LageKorrekturRoll |
||
7134 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6940 .data:0000001f Umschlag180Roll |
||
7135 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6866 .bss:00000038 Mess_IntegralNick2 |
||
7136 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7022 .bss:0000006e LageKorrekturNick |
||
7137 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6932 .data:0000001b Umschlag180Nick |
||
7138 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6854 .bss:00000030 Integral_Gier |
||
7139 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6812 .bss:00000014 IntegralNick |
||
7140 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6824 .bss:0000001c IntegralRoll |
||
7141 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6818 .bss:00000018 IntegralNick2 |
||
7142 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6830 .bss:00000020 IntegralRoll2 |
||
7143 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6950 .bss:00000058 Poti1 |
||
7144 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6956 .bss:0000005a Poti2 |
||
7145 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6962 .bss:0000005c Poti3 |
||
7146 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6968 .bss:0000005e Poti4 |
||
7147 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:1133 .text:00000bcc CalibrierMittelwert |
||
7148 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:1413 .text:00000e66 ParameterZuordnung |
||
7149 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7079 .data:00000028 Parameter_MaxHoehe |
||
7150 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7074 .data:00000027 Parameter_Luftdruck_D |
||
7151 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7084 .data:00000029 Parameter_Hoehe_P |
||
7152 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7089 .data:0000002a Parameter_Hoehe_ACC_Wirkung |
||
7153 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7094 .data:0000002b Parameter_KompassWirkung |
||
7154 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7099 .data:0000002c Parameter_Gyro_P |
||
7155 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7104 .data:0000002d Parameter_Gyro_I |
||
7156 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7114 .data:0000002f Parameter_I_Faktor |
||
7157 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7121 .bss:00000076 Parameter_UserParam1 |
||
7158 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7127 .bss:00000077 Parameter_UserParam2 |
||
7159 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7133 .bss:00000078 Parameter_UserParam3 |
||
7160 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7139 .bss:00000079 Parameter_UserParam4 |
||
7161 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7145 .bss:0000007a Parameter_UserParam5 |
||
7162 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7151 .bss:0000007b Parameter_UserParam6 |
||
7163 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7157 .bss:0000007c Parameter_UserParam7 |
||
7164 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7163 .bss:0000007d Parameter_UserParam8 |
||
7165 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7169 .data:00000030 Parameter_ServoNickControl |
||
7166 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7174 .data:00000031 Parameter_LoopGasLimit |
||
7167 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7193 .data:00000032 Parameter_DynamicStability |
||
7168 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7028 .data:00000023 Ki |
||
7169 | *COM*:00000001 MAX_GAS |
||
7170 | *COM*:00000001 MIN_GAS |
||
7171 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:2171 .text:000014a6 SendMotorData |
||
7172 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6998 .bss:00000067 MotorenEin |
||
7173 | *COM*:00000001 Motor_Hinten |
||
7174 | *COM*:00000001 Motor_Vorne |
||
7175 | *COM*:00000001 Motor_Rechts |
||
7176 | *COM*:00000001 Motor_Links |
||
7177 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:2227 .text:00001534 SetNeutral |
||
7178 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6782 .bss:0000000a NeutralAccX |
||
7179 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6788 .bss:0000000c NeutralAccY |
||
7180 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6770 .bss:00000006 StartNeutralRoll |
||
7181 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6776 .bss:00000008 StartNeutralNick |
||
7182 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6896 .bss:0000004c Mess_Integral_Hoch |
||
7183 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6902 .bss:00000050 KompassValue |
||
7184 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6908 .bss:00000052 KompassStartwert |
||
7185 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7218 .data:00000033 ExternHoehenValue |
||
7186 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:2477 .text:000017f6 Piep |
||
7187 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:2511 .text:00001820 DefaultKonstanten3 |
||
7188 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:2616 .text:00001940 DefaultKonstanten2 |
||
7189 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:2723 .text:00001a64 DefaultKonstanten1 |
||
7190 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:2824 .text:00001b86 MotorRegler |
||
7191 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6974 .bss:00000060 SenderOkay |
||
7192 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7236 .bss:000000a7 RcLostTimer.2576 |
||
7193 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6920 .bss:00000056 Notlandung |
||
7194 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7232 .bss:000000a2 modell_fliegt.2580 |
||
7195 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7243 .bss:000000c1 SummeNick.2569 |
||
7196 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7242 .bss:000000bd SummeRoll.2570 |
||
7197 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7235 .bss:000000a6 delay_neutral.2577 |
||
7198 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7234 .bss:000000a5 delay_einschalten.2578 |
||
7199 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7241 .bss:000000b9 sollGier.2571 |
||
7200 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7233 .bss:000000a4 delay_ausschalten.2579 |
||
7201 | *COM*:00000004 GyroFaktor |
||
7202 | *COM*:00000004 IntegralFaktor |
||
7203 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7200 .bss:00000080 ExternStickNick |
||
7204 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7206 .bss:00000082 ExternStickRoll |
||
7205 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7212 .bss:00000084 ExternStickGier |
||
7206 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6980 .bss:00000061 StickNick |
||
7207 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6986 .bss:00000063 StickRoll |
||
7208 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6992 .bss:00000065 StickGier |
||
7209 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7050 .bss:00000072 Looping_Links |
||
7210 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7056 .bss:00000073 Looping_Rechts |
||
7211 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7068 .bss:00000075 Looping_Oben |
||
7212 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7062 .bss:00000074 Looping_Unten |
||
7213 | *COM*:00000004 MittelIntegralNick |
||
7214 | *COM*:00000004 MittelIntegralRoll |
||
7215 | *COM*:00000004 MittelIntegralNick2 |
||
7216 | *COM*:00000004 MittelIntegralRoll2 |
||
7217 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7228 .bss:0000009a ausgleichNick.2584 |
||
7218 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7240 .bss:000000b5 tmp_long.2572 |
||
7219 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7239 .bss:000000b1 tmp_long2.2573 |
||
7220 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7238 .bss:000000ad IntegralFehlerNick.2574 |
||
7221 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7237 .bss:000000a9 IntegralFehlerRoll.2575 |
||
7222 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7226 .bss:00000094 cnt.2590 |
||
7223 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7221 .bss:0000008c MittelIntegralNick_Alt.2595 |
||
7224 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7225 .bss:00000093 last_n_p.2591 |
||
7225 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7224 .bss:00000092 last_n_n.2592 |
||
7226 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7227 .bss:00000096 ausgleichRoll.2585 |
||
7227 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7220 .bss:00000088 MittelIntegralRoll_Alt.2596 |
||
7228 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7223 .bss:00000091 last_r_p.2593 |
||
7229 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7222 .bss:00000090 last_r_n.2594 |
||
7230 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7229 .bss:0000009e NeueKompassRichtungMerken.2583 |
||
7231 | .bss:00000086 SignalSchlecht.2599 |
||
7232 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6914 .bss:00000054 KompassRichtung |
||
7233 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7230 .bss:0000009f TimerWerteausgabe.2582 |
||
7234 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7004 .bss:00000068 HoehenWert |
||
7235 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7010 .bss:0000006a SollHoehe |
||
7236 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6926 .bss:00000057 HoehenReglerAktiv |
||
7237 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7231 .bss:000000a0 hoehenregler.2581 |
||
7238 | *COM*:00000002 DiffNick |
||
7239 | *COM*:00000002 DiffRoll |
||
7240 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6745 .data:00000019 I2CTimeout |
||
7241 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6800 .bss:00000012 CosinusNickWinkel |
||
7242 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:6806 .bss:00000013 CosinusRollWinkel |
||
7243 | C:\Users\gunterl\AppData\Local\Temp/ccWnqmMy.s:7109 .data:0000002e Parameter_Gier_P |
||
7244 | *COM*:00000001 h |
||
7245 | *COM*:00000001 m |
||
7246 | *COM*:00000001 s |
||
7247 | *COM*:00000001 Count |
||
7248 | *COM*:00000005 MotorWert |
||
7249 | |||
7250 | UNDEFINED SYMBOLS |
||
7251 | __do_copy_data |
||
7252 | __do_clear_bss |
||
7253 | AdWertGier |
||
7254 | AdWertRoll |
||
7255 | AdWertNick |
||
7256 | AdWertAccNick |
||
7257 | __mulsi3 |
||
7258 | __divmodsi4 |
||
7259 | AdWertAccRoll |
||
7260 | AdWertAccHoch |
||
7261 | Aktuell_az |
||
7262 | __floatsisf |
||
7263 | __subsf3 |
||
7264 | __addsf3 |
||
7265 | __fixsfsi |
||
7266 | PlatinenVersion |
||
7267 | PPM_in |
||
7268 | __mulsf3 |
||
7269 | MotorTest |
||
7270 | DebugOut |
||
7271 | twi_state |
||
7272 | motor |
||
7273 | i2c_start |
||
7274 | Delay_ms_Mess |
||
7275 | MessLuftdruck |
||
7276 | SucheLuftruckOffset |
||
7277 | EEPromArray |
||
7278 | __eeprom_read_byte_1F2021 |
||
7279 | __divmodhi4 |
||
7280 | Luftdruck |
||
7281 | StartLuftdruck |
||
7282 | HoeheD |
||
7283 | GPS_Neutral |
||
7284 | beeptime |
||
7285 | Delay_ms |
||
7286 | ControlIn |
||
7287 | PcZugriff |
||
7288 | BeepMuster |
||
7289 | __eeprom_write_byte_1F2021 |
||
7290 | GetActiveParamSetNumber |
||
7291 | ReadParameterSet |
||
7292 | NewPpmData |
||
7293 | PPM_diff |
||
7294 | __divsf3 |
||
7295 | DubWiseKeys |
||
7296 | __ltsf2 |
||
7297 | ZaehlMessungen |
||
7298 | __nesf2 |
||
7299 | UBat |
||
7300 | __fixunssfsi |
||
7301 | GPS_Nick |
||
7302 | GPS_Roll |