Details | Last modification | View Log | RSS feed
Rev | Author | Line No. | Line |
---|---|---|---|
2248 | - | 1 | 1 .file "main.c" |
2 | 2 .arch atmega644 |
||
3 | 3 __SREG__ = 0x3f |
||
4 | 4 __SP_H__ = 0x3e |
||
5 | 5 __SP_L__ = 0x3d |
||
6 | 6 __tmp_reg__ = 0 |
||
7 | 7 __zero_reg__ = 1 |
||
8 | 8 .global __do_copy_data |
||
9 | 9 .global __do_clear_bss |
||
10 | 10 .global FlugMinutenGesamt |
||
11 | 11 .global FlugMinutenGesamt |
||
12 | 12 .section .bss |
||
13 | 15 FlugMinutenGesamt: |
||
14 | 16 0000 0000 .skip 2,0 |
||
15 | 17 .global FlugMinuten |
||
16 | 18 .global FlugMinuten |
||
17 | 21 FlugMinuten: |
||
18 | 22 0002 0000 .skip 2,0 |
||
19 | 23 .global BattLowVoltageWarning |
||
20 | 24 .data |
||
21 | 27 BattLowVoltageWarning: |
||
22 | 28 0000 5E .byte 94 |
||
23 | 29 .global SendVersionToNavi |
||
24 | 32 SendVersionToNavi: |
||
25 | 33 0001 01 .byte 1 |
||
26 | 34 .global PlatinenVersion |
||
27 | 37 PlatinenVersion: |
||
28 | 38 0002 0D .byte 13 |
||
29 | 39 .text |
||
30 | 41 eeprom_read_byte: |
||
31 | 42 /* prologue: frame size=0 */ |
||
32 | 43 /* prologue end (size=0) */ |
||
33 | 44 .L2: |
||
34 | 45 0000 F999 sbic 63-0x20,1 |
||
35 | 46 0002 00C0 rjmp .L2 |
||
36 | 47 0004 92BD out (65)+1-0x20,r25 |
||
37 | 48 0006 81BD out 65-0x20,r24 |
||
38 | 49 /* #APP */ |
||
39 | 50 /* START EEPROM READ CRITICAL SECTION */ |
||
40 | 51 0008 F89A sbi 31, 0 |
||
41 | 52 000a 80B5 in r24, 32 |
||
42 | 53 /* END EEPROM READ CRITICAL SECTION */ |
||
43 | 54 |
||
44 | 55 /* #NOAPP */ |
||
45 | 56 000c 9927 clr r25 |
||
46 | 57 /* epilogue: frame size=0 */ |
||
47 | 58 000e 0895 ret |
||
48 | 59 /* epilogue end (size=1) */ |
||
49 | 60 /* function eeprom_read_byte size 16 (15) */ |
||
50 | 63 eeprom_write_byte: |
||
51 | 64 /* prologue: frame size=0 */ |
||
52 | 65 /* prologue end (size=0) */ |
||
53 | 66 .L7: |
||
54 | 67 0010 F999 sbic 63-0x20,1 |
||
55 | 68 0012 00C0 rjmp .L7 |
||
56 | 69 0014 1FBA out 63-0x20,__zero_reg__ |
||
57 | 70 0016 92BD out (65)+1-0x20,r25 |
||
58 | 71 0018 81BD out 65-0x20,r24 |
||
59 | 72 001a 60BD out 64-0x20,r22 |
||
60 | 73 /* #APP */ |
||
61 | 74 /* START EEPROM WRITE CRITICAL SECTION */ |
||
62 | 75 001c 0FB6 in r0, 63 |
||
63 | 76 001e F894 cli |
||
64 | 77 0020 FA9A sbi 31, 2 |
||
65 | 78 0022 F99A sbi 31, 1 |
||
66 | 79 0024 0FBE out 63, r0 |
||
67 | 80 /* END EEPROM WRITE CRITICAL SECTION */ |
||
68 | 81 /* #NOAPP */ |
||
69 | 82 /* epilogue: frame size=0 */ |
||
70 | 83 0026 0895 ret |
||
71 | 84 /* epilogue end (size=1) */ |
||
72 | 85 /* function eeprom_write_byte size 21 (20) */ |
||
73 | 87 .data |
||
74 | 90 stick.25: |
||
75 | 91 0003 01 .byte 1 |
||
76 | 92 .text |
||
77 | 93 .global CalMk3Mag |
||
78 | 95 CalMk3Mag: |
||
79 | 96 /* prologue: frame size=0 */ |
||
80 | 97 /* prologue end (size=0) */ |
||
81 | 98 0028 8091 0000 lds r24,EE_Parameter |
||
82 | 99 002c E82F mov r30,r24 |
||
83 | 100 002e FF27 clr r31 |
||
84 | 101 0030 EE0F add r30,r30 |
||
85 | 102 0032 FF1F adc r31,r31 |
||
86 | 103 0034 E050 subi r30,lo8(-(PPM_in)) |
||
87 | 104 0036 F040 sbci r31,hi8(-(PPM_in)) |
||
88 | 105 0038 8081 ld r24,Z |
||
89 | 106 003a 9181 ldd r25,Z+1 |
||
90 | 107 003c 8D5E subi r24,lo8(-19) |
||
91 | 108 003e 9F4F sbci r25,hi8(-19) |
||
92 | 109 0040 04F0 brlt .L11 |
||
93 | 110 0042 1092 0000 sts stick.25,__zero_reg__ |
||
94 | 111 .L11: |
||
95 | 112 0046 8081 ld r24,Z |
||
96 | 113 0048 9181 ldd r25,Z+1 |
||
97 | 114 004a 8A5B subi r24,lo8(-70) |
||
98 | 115 004c 9F4F sbci r25,hi8(-70) |
||
99 | 116 004e 04F4 brge .L16 |
||
100 | 117 0050 8091 0000 lds r24,stick.25 |
||
101 | 118 0054 8823 tst r24 |
||
102 | 119 0056 01F0 breq .L17 |
||
103 | 120 .L16: |
||
104 | 121 0058 2091 0000 lds r18,WinkelOut+6 |
||
105 | 122 005c 00C0 rjmp .L12 |
||
106 | 123 .L17: |
||
107 | 124 005e 81E0 ldi r24,lo8(1) |
||
108 | 125 0060 8093 0000 sts stick.25,r24 |
||
109 | 126 0064 2091 0000 lds r18,WinkelOut+6 |
||
110 | 127 0068 280F add r18,r24 |
||
111 | 128 006a 2093 0000 sts WinkelOut+6,r18 |
||
112 | 129 006e 2530 cpi r18,lo8(5) |
||
113 | 130 0070 00F0 brlo .L13 |
||
114 | 131 0072 88EE ldi r24,lo8(1000) |
||
115 | 132 0074 93E0 ldi r25,hi8(1000) |
||
116 | 133 0076 9093 0000 sts (beeptime)+1,r25 |
||
117 | 134 007a 8093 0000 sts beeptime,r24 |
||
118 | 135 007e 00C0 rjmp .L12 |
||
119 | 136 .L13: |
||
120 | 137 0080 66E9 ldi r22,lo8(150) |
||
121 | 138 0082 70E0 ldi r23,hi8(150) |
||
122 | 139 0084 822F mov r24,r18 |
||
123 | 140 0086 0E94 0000 call Piep |
||
124 | 141 008a 00C0 rjmp .L16 |
||
125 | 142 .L12: |
||
126 | 143 008c 822F mov r24,r18 |
||
127 | 144 008e 9927 clr r25 |
||
128 | 145 0090 9093 0000 sts (DebugOut+40)+1,r25 |
||
129 | 146 0094 8093 0000 sts DebugOut+40,r24 |
||
130 | 147 /* epilogue: frame size=0 */ |
||
131 | 148 0098 0895 ret |
||
132 | 149 /* epilogue end (size=1) */ |
||
133 | 150 /* function CalMk3Mag size 59 (58) */ |
||
134 | 152 .section .progmem.data,"a",@progbits |
||
135 | 155 __c.21: |
||
136 | 156 0000 0A0D 4261 .string "\n\rBatt:" |
||
137 | 156 7474 3A00 |
||
138 | 159 __c.22: |
||
139 | 160 0008 2033 2043 .string " 3 Cells " |
||
140 | 160 656C 6C73 |
||
141 | 160 2020 00 |
||
142 | 163 __c.23: |
||
143 | 164 0013 2034 2043 .string " 4 Cells " |
||
144 | 164 656C 6C73 |
||
145 | 164 2020 00 |
||
146 | 167 __c.24: |
||
147 | 168 001e 204C 6F77 .string " Low warning level: %d.%d" |
||
148 | 168 2077 6172 |
||
149 | 168 6E69 6E67 |
||
150 | 168 206C 6576 |
||
151 | 168 656C 3A20 |
||
152 | 169 .text |
||
153 | 170 .global LipoDetection |
||
154 | 172 LipoDetection: |
||
155 | 173 /* prologue: frame size=0 */ |
||
156 | 174 009a 1F93 push r17 |
||
157 | 175 009c CF93 push r28 |
||
158 | 176 009e DF93 push r29 |
||
159 | 177 /* prologue end (size=3) */ |
||
160 | 178 00a0 182F mov r17,r24 |
||
161 | 179 00a2 8823 tst r24 |
||
162 | 180 00a4 01F4 brne .L33 |
||
163 | 181 00a6 8091 0000 lds r24,EE_Parameter+30 |
||
164 | 182 00aa 8233 cpi r24,lo8(50) |
||
165 | 183 00ac 00F0 brlo .L34 |
||
166 | 184 .L20: |
||
167 | 185 00ae 8093 0000 sts BattLowVoltageWarning,r24 |
||
168 | 186 .L29: |
||
169 | 187 00b2 1123 tst r17 |
||
170 | 188 00b4 01F4 brne .+2 |
||
171 | 189 00b6 00C0 rjmp .L18 |
||
172 | 190 00b8 00C0 rjmp .L35 |
||
173 | 191 .L33: |
||
174 | 192 00ba 80E0 ldi r24,lo8(__c.21) |
||
175 | 193 00bc 90E0 ldi r25,hi8(__c.21) |
||
176 | 194 00be 9F93 push r25 |
||
177 | 195 00c0 8F93 push r24 |
||
178 | 196 00c2 1F92 push __zero_reg__ |
||
179 | 197 00c4 0E94 0000 call _printf_P |
||
180 | 198 00c8 0F90 pop __tmp_reg__ |
||
181 | 199 00ca 0F90 pop __tmp_reg__ |
||
182 | 200 00cc 0F90 pop __tmp_reg__ |
||
183 | 201 00ce 8091 0000 lds r24,EE_Parameter+30 |
||
184 | 202 00d2 8233 cpi r24,lo8(50) |
||
185 | 203 00d4 00F4 brsh .L20 |
||
186 | 204 .L34: |
||
187 | 205 00d6 84EF ldi r24,lo8(500) |
||
188 | 206 00d8 91E0 ldi r25,hi8(500) |
||
189 | 207 00da 0E94 0000 call SetDelay |
||
190 | 208 00de EC01 movw r28,r24 |
||
191 | 209 00e0 1123 tst r17 |
||
192 | 210 00e2 01F4 brne .L22 |
||
193 | 211 .L21: |
||
194 | 212 00e4 8091 0000 lds r24,UBat |
||
195 | 213 00e8 9091 0000 lds r25,(UBat)+1 |
||
196 | 214 00ec 8238 cpi r24,130 |
||
197 | 215 00ee 9105 cpc r25,__zero_reg__ |
||
198 | 216 00f0 04F0 brlt .+2 |
||
199 | 217 00f2 00C0 rjmp .L25 |
||
200 | 218 00f4 8091 0000 lds r24,EE_Parameter+30 |
||
201 | 219 00f8 23E0 ldi r18,lo8(3) |
||
202 | 220 00fa 829F mul r24,r18 |
||
203 | 221 00fc C001 movw r24,r0 |
||
204 | 222 00fe 1124 clr r1 |
||
205 | 223 0100 8093 0000 sts BattLowVoltageWarning,r24 |
||
206 | 224 0104 1123 tst r17 |
||
207 | 225 0106 01F0 breq .L29 |
||
208 | 226 0108 68EC ldi r22,lo8(200) |
||
209 | 227 010a 70E0 ldi r23,hi8(200) |
||
210 | 228 010c 822F mov r24,r18 |
||
211 | 229 010e 0E94 0000 call Piep |
||
212 | 230 0112 80E0 ldi r24,lo8(__c.22) |
||
213 | 231 0114 90E0 ldi r25,hi8(__c.22) |
||
214 | 232 .L31: |
||
215 | 233 0116 9F93 push r25 |
||
216 | 234 0118 8F93 push r24 |
||
217 | 235 011a 1F92 push __zero_reg__ |
||
218 | 236 011c 0E94 0000 call _printf_P |
||
219 | 237 0120 0F90 pop __tmp_reg__ |
||
220 | 238 0122 0F90 pop __tmp_reg__ |
||
221 | 239 0124 0F90 pop __tmp_reg__ |
||
222 | 240 0126 00C0 rjmp .L29 |
||
223 | 241 .L35: |
||
224 | 242 0128 8091 0000 lds r24,BattLowVoltageWarning |
||
225 | 243 012c 6AE0 ldi r22,lo8(10) |
||
226 | 244 012e 0E94 0000 call __udivmodqi4 |
||
227 | 245 0132 892F mov r24,r25 |
||
228 | 246 0134 9927 clr r25 |
||
229 | 247 0136 9F93 push r25 |
||
230 | 248 0138 8F93 push r24 |
||
231 | 249 013a 8091 0000 lds r24,BattLowVoltageWarning |
||
232 | 250 013e 0E94 0000 call __udivmodqi4 |
||
233 | 251 0142 9927 clr r25 |
||
234 | 252 0144 9F93 push r25 |
||
235 | 253 0146 8F93 push r24 |
||
236 | 254 0148 80E0 ldi r24,lo8(__c.24) |
||
237 | 255 014a 90E0 ldi r25,hi8(__c.24) |
||
238 | 256 014c 9F93 push r25 |
||
239 | 257 014e 8F93 push r24 |
||
240 | 258 0150 1F92 push __zero_reg__ |
||
241 | 259 0152 0E94 0000 call _printf_P |
||
242 | 260 0156 8DB7 in r24,__SP_L__ |
||
243 | 261 0158 9EB7 in r25,__SP_H__ |
||
244 | 262 015a 0796 adiw r24,7 |
||
245 | 263 015c 8DBF out __SP_L__,r24 |
||
246 | 264 015e 00C0 rjmp .L18 |
||
247 | 265 .L22: |
||
248 | 266 0160 CE01 movw r24,r28 |
||
249 | 267 0162 0E94 0000 call CheckDelay |
||
250 | 268 0166 8823 tst r24 |
||
251 | 269 0168 01F0 breq .+2 |
||
252 | 270 016a 00C0 rjmp .L21 |
||
253 | 271 016c CE01 movw r24,r28 |
||
254 | 272 016e 0E94 0000 call CheckDelay |
||
255 | 273 0172 8823 tst r24 |
||
256 | 274 0174 01F0 breq .L22 |
||
257 | 275 0176 00C0 rjmp .L21 |
||
258 | 276 .L25: |
||
259 | 277 0178 8091 0000 lds r24,EE_Parameter+30 |
||
260 | 278 017c 9927 clr r25 |
||
261 | 279 017e 880F lsl r24 |
||
262 | 280 0180 991F rol r25 |
||
263 | 281 0182 880F lsl r24 |
||
264 | 282 0184 991F rol r25 |
||
265 | 283 0186 8093 0000 sts BattLowVoltageWarning,r24 |
||
266 | 284 018a 1123 tst r17 |
||
267 | 285 018c 01F4 brne .+2 |
||
268 | 286 018e 00C0 rjmp .L29 |
||
269 | 287 0190 68EC ldi r22,lo8(200) |
||
270 | 288 0192 70E0 ldi r23,hi8(200) |
||
271 | 289 0194 84E0 ldi r24,lo8(4) |
||
272 | 290 0196 0E94 0000 call Piep |
||
273 | 291 019a 80E0 ldi r24,lo8(__c.23) |
||
274 | 292 019c 90E0 ldi r25,hi8(__c.23) |
||
275 | 293 019e 00C0 rjmp .L31 |
||
276 | 294 .L18: |
||
277 | 295 /* epilogue: frame size=0 */ |
||
278 | 296 01a0 DF91 pop r29 |
||
279 | 297 01a2 CF91 pop r28 |
||
280 | 298 01a4 1F91 pop r17 |
||
281 | 299 01a6 0895 ret |
||
282 | 300 /* epilogue end (size=4) */ |
||
283 | 301 /* function LipoDetection size 135 (128) */ |
||
284 | 303 .section .progmem.data |
||
285 | 306 __c.0: |
||
286 | 307 0038 0A0D 3D3D .string "\n\r===================================" |
||
287 | 307 3D3D 3D3D |
||
288 | 307 3D3D 3D3D |
||
289 | 307 3D3D 3D3D |
||
290 | 307 3D3D 3D3D |
||
291 | 310 __c.1: |
||
292 | 311 005e 0A0D 466C .string "\n\rFlightControl\n\rHardware:%d.%d\n\rSoftware:V%d.%d%c " |
||
293 | 311 6967 6874 |
||
294 | 311 436F 6E74 |
||
295 | 311 726F 6C0A |
||
296 | 311 0D48 6172 |
||
297 | 314 __c.2: |
||
298 | 315 0092 0A0D 6578 .string "\n\rexperimental version" |
||
299 | 315 7065 7269 |
||
300 | 315 6D65 6E74 |
||
301 | 315 616C 2076 |
||
302 | 315 6572 7369 |
||
303 | 318 __c.3: |
||
304 | 319 00a9 0A0D 3D3D .string "\n\r===================================" |
||
305 | 319 3D3D 3D3D |
||
306 | 319 3D3D 3D3D |
||
307 | 319 3D3D 3D3D |
||
308 | 319 3D3D 3D3D |
||
309 | 322 __c.4: |
||
310 | 323 00cf 0A0D 6572 .string "\n\rerzeugt default Mixer Table" |
||
311 | 323 7A65 7567 |
||
312 | 323 7420 6465 |
||
313 | 323 6661 756C |
||
314 | 323 7420 4D69 |
||
315 | 326 __c.5: |
||
316 | 327 00ed 0A0D 4D69 .string "\n\rMixer-Config: '%s' (%u Motors)" |
||
317 | 327 7865 722D |
||
318 | 327 436F 6E66 |
||
319 | 327 6967 3A20 |
||
320 | 327 2725 7327 |
||
321 | 330 __c.6: |
||
322 | 331 010e 0A0D 2E2E .string "\n\r...BL-Ctrl...." |
||
323 | 331 2E42 4C2D |
||
324 | 331 4374 726C |
||
325 | 331 2E2E 2E2E |
||
326 | 331 00 |
||
327 | 334 __c.7: |
||
328 | 335 011f 2564 2000 .string "%d " |
||
329 | 338 __c.8: |
||
330 | 339 0123 0A0D 0A0D .string "\n\r\n\r!! missing BL-CTRL: %d !!" |
||
331 | 339 2121 206D |
||
332 | 339 6973 7369 |
||
333 | 339 6E67 2042 |
||
334 | 339 4C2D 4354 |
||
335 | 342 __c.9: |
||
336 | 343 0141 0A0D 3D3D .string "\n\r===================================" |
||
337 | 343 3D3D 3D3D |
||
338 | 343 3D3D 3D3D |
||
339 | 343 3D3D 3D3D |
||
340 | 343 3D3D 3D3D |
||
341 | 346 __c.10: |
||
342 | 347 0167 0A0D 496E .string "\n\rInit. EEPROM" |
||
343 | 347 6974 2E20 |
||
344 | 347 4545 5052 |
||
345 | 347 4F4D 00 |
||
346 | 350 __c.11: |
||
347 | 351 0176 3A20 4765 .string ": Generating Default-Parameter using old Stick Settings" |
||
348 | 351 6E65 7261 |
||
349 | 351 7469 6E67 |
||
350 | 351 2044 6566 |
||
351 | 351 6175 6C74 |
||
352 | 354 __c.12: |
||
353 | 355 01ae 0A0D 466C .string "\n\rFlight-time %u min Total:%u min" |
||
354 | 355 6967 6874 |
||
355 | 355 2D74 696D |
||
356 | 355 6520 2575 |
||
357 | 355 206D 696E |
||
358 | 358 __c.13: |
||
359 | 359 01d1 0A0D 4143 .string "\n\rACC noch nicht calibriert !" |
||
360 | 359 4320 6E6F |
||
361 | 359 6368 206E |
||
362 | 359 6963 6874 |
||
363 | 359 2063 616C |
||
364 | 362 __c.14: |
||
365 | 363 01ef 0A0D 5573 .string "\n\rUsing parameterset %d" |
||
366 | 363 696E 6720 |
||
367 | 363 7061 7261 |
||
368 | 363 6D65 7465 |
||
369 | 363 7273 6574 |
||
370 | 366 __c.15: |
||
371 | 367 0207 0A0D 4B61 .string "\n\rKalibrieren des Drucksensors." |
||
372 | 367 6C69 6272 |
||
373 | 367 6965 7265 |
||
374 | 367 6E20 6465 |
||
375 | 367 7320 4472 |
||
376 | 370 __c.16: |
||
377 | 371 0227 4F4B 0A0D .string "OK\n\r" |
||
378 | 371 00 |
||
379 | 374 __c.17: |
||
380 | 375 022c 0A0D 436F .string "\n\rControl: " |
||
381 | 375 6E74 726F |
||
382 | 375 6C3A 2000 |
||
383 | 378 __c.18: |
||
384 | 379 0238 4865 6164 .string "HeadingHold" |
||
385 | 379 696E 6748 |
||
386 | 379 6F6C 6400 |
||
387 | 382 __c.19: |
||
388 | 383 0244 6E6F 726D .string "normaler (ACC-Mode)" |
||
389 | 383 616C 6572 |
||
390 | 383 2028 4143 |
||
391 | 383 432D 4D6F |
||
392 | 383 6465 2900 |
||
393 | 386 __c.20: |
||
394 | 387 0258 0A0D 3D3D .string "\n\r===================================\n\r" |
||
395 | 387 3D3D 3D3D |
||
396 | 387 3D3D 3D3D |
||
397 | 387 3D3D 3D3D |
||
398 | 387 3D3D 3D3D |
||
399 | 388 .data |
||
400 | 389 .LC0: |
||
401 | 390 0004 5175 6164 .string "Quadro" |
||
402 | 390 726F 00 |
||
403 | 391 000b 00 .string "" |
||
404 | 392 .text |
||
405 | 393 .global main |
||
406 | 395 main: |
||
407 | 396 /* prologue: frame size=0 */ |
||
408 | 397 01a8 C0E0 ldi r28,lo8(__stack - 0) |
||
409 | 398 01aa D0E0 ldi r29,hi8(__stack - 0) |
||
410 | 399 01ac DEBF out __SP_H__,r29 |
||
411 | 400 01ae CDBF out __SP_L__,r28 |
||
412 | 401 /* prologue end (size=4) */ |
||
413 | 402 01b0 EE24 clr r14 |
||
414 | 403 01b2 FF24 clr r15 |
||
415 | 404 01b4 14B8 out 36-0x20,__zero_reg__ |
||
416 | 405 01b6 15B8 out 37-0x20,__zero_reg__ |
||
417 | 406 01b8 C7EE ldi r28,lo8(999) |
||
418 | 407 01ba D3E0 ldi r29,hi8(999) |
||
419 | 408 .L40: |
||
420 | 409 01bc E297 sbiw r28,50 |
||
421 | 410 01be D7FF sbrs r29,7 |
||
422 | 411 01c0 00C0 rjmp .L40 |
||
423 | 412 01c2 2DE0 ldi r18,lo8(13) |
||
424 | 413 01c4 2093 0000 sts PlatinenVersion,r18 |
||
425 | 414 01c8 81E8 ldi r24,lo8(-127) |
||
426 | 415 01ca 87B9 out 39-0x20,r24 |
||
427 | 416 01cc 8FEF ldi r24,lo8(-1) |
||
428 | 417 01ce 88B9 out 40-0x20,r24 |
||
429 | 418 01d0 8BE1 ldi r24,lo8(27) |
||
430 | 419 01d2 84B9 out 36-0x20,r24 |
||
431 | 420 01d4 81E0 ldi r24,lo8(1) |
||
432 | 421 01d6 85B9 out 37-0x20,r24 |
||
433 | 422 01d8 8EE3 ldi r24,lo8(62) |
||
434 | 423 01da 8AB9 out 42-0x20,r24 |
||
435 | 424 01dc 87E4 ldi r24,lo8(71) |
||
436 | 425 01de 8BB9 out 43-0x20,r24 |
||
437 | 426 01e0 4698 cbi 40-0x20,6 |
||
438 | 427 01e2 84B7 in r24,84-0x20 |
||
439 | 428 01e4 877F andi r24,lo8(-9) |
||
440 | 429 01e6 84BF out 84-0x20,r24 |
||
441 | 430 01e8 8091 6000 lds r24,96 |
||
442 | 431 01ec 8861 ori r24,lo8(24) |
||
443 | 432 01ee 8093 6000 sts 96,r24 |
||
444 | 433 01f2 1092 6000 sts 96,__zero_reg__ |
||
445 | 434 01f6 80ED ldi r24,lo8(2000) |
||
446 | 435 01f8 97E0 ldi r25,hi8(2000) |
||
447 | 436 01fa 9093 0000 sts (beeptime)+1,r25 |
||
448 | 437 01fe 8093 0000 sts beeptime,r24 |
||
449 | 438 0202 1092 0000 sts (StickGier)+1,__zero_reg__ |
||
450 | 439 0206 1092 0000 sts StickGier,__zero_reg__ |
||
451 | 440 020a 1092 0000 sts (PPM_in+4)+1,__zero_reg__ |
||
452 | 441 020e 1092 0000 sts PPM_in+4,__zero_reg__ |
||
453 | 442 0212 1092 0000 sts (StickRoll)+1,__zero_reg__ |
||
454 | 443 0216 1092 0000 sts StickRoll,__zero_reg__ |
||
455 | 444 021a 1092 0000 sts (StickNick)+1,__zero_reg__ |
||
456 | 445 021e 1092 0000 sts StickNick,__zero_reg__ |
||
457 | 446 0222 8BE0 ldi r24,lo8(1291) |
||
458 | 447 0224 95E0 ldi r25,hi8(1291) |
||
459 | 448 0226 A0E0 ldi r26,hlo8(1291) |
||
460 | 449 0228 B0E0 ldi r27,hhi8(1291) |
||
461 | 450 022a 8093 0000 sts GIER_GRAD_FAKTOR,r24 |
||
462 | 451 022e 9093 0000 sts (GIER_GRAD_FAKTOR)+1,r25 |
||
463 | 452 0232 A093 0000 sts (GIER_GRAD_FAKTOR)+2,r26 |
||
464 | 453 0236 B093 0000 sts (GIER_GRAD_FAKTOR)+3,r27 |
||
465 | 454 023a 289A sbi 37-0x20,0 |
||
466 | 455 023c 0E94 0000 call Timer_Init |
||
467 | 456 0240 0E94 0000 call TIMER2_Init |
||
468 | 457 0244 0E94 0000 call UART_Init |
||
469 | 458 0248 0E94 0000 call rc_sum_init |
||
470 | 459 024c 0E94 0000 call ADC_Init |
||
471 | 460 0250 0E94 0000 call i2c_init |
||
472 | 461 /* #APP */ |
||
473 | 462 0254 7894 sei |
||
474 | 463 /* #NOAPP */ |
||
475 | 464 0256 80E0 ldi r24,lo8(__c.0) |
||
476 | 465 0258 90E0 ldi r25,hi8(__c.0) |
||
477 | 466 025a 9F93 push r25 |
||
478 | 467 025c 8F93 push r24 |
||
479 | 468 025e 1F92 push __zero_reg__ |
||
480 | 469 0260 0E94 0000 call _printf_P |
||
481 | 470 0264 0F90 pop __tmp_reg__ |
||
482 | 471 0266 0F90 pop __tmp_reg__ |
||
483 | 472 0268 0F90 pop __tmp_reg__ |
||
484 | 473 026a 87E6 ldi r24,lo8(103) |
||
485 | 474 026c 90E0 ldi r25,hi8(103) |
||
486 | 475 026e 9F93 push r25 |
||
487 | 476 0270 8F93 push r24 |
||
488 | 477 0272 8CE4 ldi r24,lo8(76) |
||
489 | 478 0274 90E0 ldi r25,hi8(76) |
||
490 | 479 0276 9F93 push r25 |
||
491 | 480 0278 8F93 push r24 |
||
492 | 481 027a 1F92 push __zero_reg__ |
||
493 | 482 027c 1F92 push __zero_reg__ |
||
494 | 483 027e 8091 0000 lds r24,PlatinenVersion |
||
495 | 484 0282 6AE0 ldi r22,lo8(10) |
||
496 | 485 0284 0E94 0000 call __udivmodqi4 |
||
497 | 486 0288 892F mov r24,r25 |
||
498 | 487 028a 9927 clr r25 |
||
499 | 488 028c 9F93 push r25 |
||
500 | 489 028e 8F93 push r24 |
||
501 | 490 0290 8091 0000 lds r24,PlatinenVersion |
||
502 | 491 0294 0E94 0000 call __udivmodqi4 |
||
503 | 492 0298 9927 clr r25 |
||
504 | 493 029a 9F93 push r25 |
||
505 | 494 029c 8F93 push r24 |
||
506 | 495 029e 80E0 ldi r24,lo8(__c.1) |
||
507 | 496 02a0 90E0 ldi r25,hi8(__c.1) |
||
508 | 497 02a2 9F93 push r25 |
||
509 | 498 02a4 8F93 push r24 |
||
510 | 499 02a6 1F92 push __zero_reg__ |
||
511 | 500 02a8 0E94 0000 call _printf_P |
||
512 | 501 02ac 8DB7 in r24,__SP_L__ |
||
513 | 502 02ae 9EB7 in r25,__SP_H__ |
||
514 | 503 02b0 0D96 adiw r24,13 |
||
515 | 504 02b2 8DBF out __SP_L__,r24 |
||
516 | 505 02b4 80E0 ldi r24,lo8(__c.2) |
||
517 | 506 02b6 90E0 ldi r25,hi8(__c.2) |
||
518 | 507 02b8 9F93 push r25 |
||
519 | 508 02ba 8F93 push r24 |
||
520 | 509 02bc 1F92 push __zero_reg__ |
||
521 | 510 02be 0E94 0000 call _printf_P |
||
522 | 511 02c2 0F90 pop __tmp_reg__ |
||
523 | 512 02c4 0F90 pop __tmp_reg__ |
||
524 | 513 02c6 0F90 pop __tmp_reg__ |
||
525 | 514 02c8 80E0 ldi r24,lo8(__c.3) |
||
526 | 515 02ca 90E0 ldi r25,hi8(__c.3) |
||
527 | 516 02cc 9F93 push r25 |
||
528 | 517 02ce 8F93 push r24 |
||
529 | 518 02d0 1F92 push __zero_reg__ |
||
530 | 519 02d2 0E94 0000 call _printf_P |
||
531 | 520 02d6 8091 0000 lds r24,PlatinenVersion |
||
532 | 521 02da 0F90 pop __tmp_reg__ |
||
533 | 522 02dc 0F90 pop __tmp_reg__ |
||
534 | 523 02de 0F90 pop __tmp_reg__ |
||
535 | 524 02e0 8C30 cpi r24,lo8(12) |
||
536 | 525 02e2 00F0 brlo .+2 |
||
537 | 526 02e4 00C0 rjmp .L44 |
||
538 | 527 02e6 299A sbi 37-0x20,1 |
||
539 | 528 .L45: |
||
540 | 529 02e8 49E0 ldi r20,lo8(9) |
||
541 | 530 02ea 60E0 ldi r22,lo8(EE_Parameter) |
||
542 | 531 02ec 70E0 ldi r23,hi8(EE_Parameter) |
||
543 | 532 02ee 83E0 ldi r24,lo8(3) |
||
544 | 533 02f0 0E94 0000 call ReadParameterSet |
||
545 | 534 .L47: |
||
546 | 535 02f4 F999 sbic 63-0x20,1 |
||
547 | 536 02f6 00C0 rjmp .L47 |
||
548 | 537 02f8 80E0 ldi r24,lo8(EEPromArray+1000) |
||
549 | 538 02fa 90E0 ldi r25,hi8(EEPromArray+1000) |
||
550 | 539 02fc 92BD out (65)+1-0x20,r25 |
||
551 | 540 02fe 81BD out 65-0x20,r24 |
||
552 | 541 /* #APP */ |
||
553 | 542 /* START EEPROM READ CRITICAL SECTION */ |
||
554 | 543 0300 F89A sbi 31, 0 |
||
555 | 544 0302 80B5 in r24, 32 |
||
556 | 545 /* END EEPROM READ CRITICAL SECTION */ |
||
557 | 546 |
||
558 | 547 /* #NOAPP */ |
||
559 | 548 0304 8130 cpi r24,lo8(1) |
||
560 | 549 0306 01F4 brne .L46 |
||
561 | 550 .L51: |
||
562 | 551 0308 F999 sbic 63-0x20,1 |
||
563 | 552 030a 00C0 rjmp .L51 |
||
564 | 553 030c 80E0 ldi r24,lo8(EEPromArray+1) |
||
565 | 554 030e 90E0 ldi r25,hi8(EEPromArray+1) |
||
566 | 555 0310 92BD out (65)+1-0x20,r25 |
||
567 | 556 0312 81BD out 65-0x20,r24 |
||
568 | 557 /* #APP */ |
||
569 | 558 /* START EEPROM READ CRITICAL SECTION */ |
||
570 | 559 0314 F89A sbi 31, 0 |
||
571 | 560 0316 80B5 in r24, 32 |
||
572 | 561 /* END EEPROM READ CRITICAL SECTION */ |
||
573 | 562 |
||
574 | 563 /* #NOAPP */ |
||
575 | 564 0318 8F3F cpi r24,lo8(-1) |
||
576 | 565 031a 01F0 breq .L46 |
||
577 | 566 031c 1092 0000 sts RequiredMotors,__zero_reg__ |
||
578 | 567 0320 20E0 ldi r18,lo8(pm(eeprom_read_byte)) |
||
579 | 568 0322 30E0 ldi r19,hi8(pm(eeprom_read_byte)) |
||
580 | 569 0324 4DE4 ldi r20,lo8(77) |
||
581 | 570 0326 50E0 ldi r21,hi8(77) |
||
582 | 571 0328 60E0 ldi r22,lo8(EEPromArray+1000) |
||
583 | 572 032a 70E0 ldi r23,hi8(EEPromArray+1000) |
||
584 | 573 032c 80E0 ldi r24,lo8(Mixer) |
||
585 | 574 032e 90E0 ldi r25,hi8(Mixer) |
||
586 | 575 0330 0E94 0000 call __eerd_block |
||
587 | 576 0334 9091 0000 lds r25,RequiredMotors |
||
588 | 577 0338 E0E0 ldi r30,lo8(Mixer+13) |
||
589 | 578 033a F0E0 ldi r31,hi8(Mixer+13) |
||
590 | 579 033c 2FE0 ldi r18,lo8(15) |
||
591 | 580 .L60: |
||
592 | 581 033e 8081 ld r24,Z |
||
593 | 582 0340 3496 adiw r30,4 |
||
594 | 583 0342 1816 cp __zero_reg__,r24 |
||
595 | 584 0344 04F4 brge .L58 |
||
596 | 585 0346 9F5F subi r25,lo8(-(1)) |
||
597 | 586 .L58: |
||
598 | 587 0348 2150 subi r18,lo8(-(-1)) |
||
599 | 588 034a 27FF sbrs r18,7 |
||
600 | 589 034c 00C0 rjmp .L60 |
||
601 | 590 034e 9093 0000 sts RequiredMotors,r25 |
||
602 | 591 0352 C0E0 ldi r28,lo8(Mixer+1) |
||
603 | 592 0354 D0E0 ldi r29,hi8(Mixer+1) |
||
604 | 593 0356 00C0 rjmp .L61 |
||
605 | 594 .L44: |
||
606 | 595 0358 2998 cbi 37-0x20,1 |
||
607 | 596 035a 00C0 rjmp .L45 |
||
608 | 597 .L46: |
||
609 | 598 035c 80E0 ldi r24,lo8(__c.4) |
||
610 | 599 035e 90E0 ldi r25,hi8(__c.4) |
||
611 | 600 0360 9F93 push r25 |
||
612 | 601 0362 8F93 push r24 |
||
613 | 602 0364 1F92 push __zero_reg__ |
||
614 | 603 0366 0E94 0000 call _printf_P |
||
615 | 604 036a 0F90 pop __tmp_reg__ |
||
616 | 605 036c 0F90 pop __tmp_reg__ |
||
617 | 606 036e 0F90 pop __tmp_reg__ |
||
618 | 607 0370 E0E0 ldi r30,lo8(Mixer) |
||
619 | 608 0372 F0E0 ldi r31,hi8(Mixer) |
||
620 | 609 0374 8FE0 ldi r24,lo8(15) |
||
621 | 610 .L65: |
||
622 | 611 0376 1586 std Z+13,__zero_reg__ |
||
623 | 612 0378 1686 std Z+14,__zero_reg__ |
||
624 | 613 037a 1786 std Z+15,__zero_reg__ |
||
625 | 614 037c 108A std Z+16,__zero_reg__ |
||
626 | 615 037e 8150 subi r24,lo8(-(-1)) |
||
627 | 616 0380 3496 adiw r30,4 |
||
628 | 617 0382 87FF sbrs r24,7 |
||
629 | 618 0384 00C0 rjmp .L65 |
||
630 | 619 0386 80E4 ldi r24,lo8(64) |
||
631 | 620 0388 8093 0000 sts Mixer+13,r24 |
||
632 | 621 038c 8093 0000 sts Mixer+14,r24 |
||
633 | 622 0390 1092 0000 sts Mixer+15,__zero_reg__ |
||
634 | 623 0394 8093 0000 sts Mixer+16,r24 |
||
635 | 624 0398 8093 0000 sts Mixer+17,r24 |
||
636 | 625 039c 90EC ldi r25,lo8(-64) |
||
637 | 626 039e 9093 0000 sts Mixer+18,r25 |
||
638 | 627 03a2 1092 0000 sts Mixer+19,__zero_reg__ |
||
639 | 628 03a6 8093 0000 sts Mixer+20,r24 |
||
640 | 629 03aa 8093 0000 sts Mixer+21,r24 |
||
641 | 630 03ae 1092 0000 sts Mixer+22,__zero_reg__ |
||
642 | 631 03b2 9093 0000 sts Mixer+23,r25 |
||
643 | 632 03b6 9093 0000 sts Mixer+24,r25 |
||
644 | 633 03ba 8093 0000 sts Mixer+25,r24 |
||
645 | 634 03be 1092 0000 sts Mixer+26,__zero_reg__ |
||
646 | 635 03c2 8093 0000 sts Mixer+27,r24 |
||
647 | 636 03c6 9093 0000 sts Mixer+28,r25 |
||
648 | 637 03ca 81E0 ldi r24,lo8(1) |
||
649 | 638 03cc 8093 0000 sts Mixer,r24 |
||
650 | 639 03d0 C0E0 ldi r28,lo8(Mixer+1) |
||
651 | 640 03d2 D0E0 ldi r29,hi8(Mixer+1) |
||
652 | 641 03d4 8BE0 ldi r24,lo8(11) |
||
653 | 642 03d6 E0E0 ldi r30,lo8(.LC0) |
||
654 | 643 03d8 F0E0 ldi r31,hi8(.LC0) |
||
655 | 644 03da DE01 movw r26,r28 |
||
656 | 645 03dc 0190 ld __tmp_reg__,Z+ |
||
657 | 646 03de 0D92 st X+,__tmp_reg__ |
||
658 | 647 03e0 8A95 dec r24 |
||
659 | 648 03e2 01F4 brne .-8 |
||
660 | 649 03e4 20E0 ldi r18,lo8(pm(eeprom_write_byte)) |
||
661 | 650 03e6 30E0 ldi r19,hi8(pm(eeprom_write_byte)) |
||
662 | 651 03e8 4DE4 ldi r20,lo8(77) |
||
663 | 652 03ea 50E0 ldi r21,hi8(77) |
||
664 | 653 03ec BE01 movw r22,r28 |
||
665 | 654 03ee 6150 subi r22,lo8(-(-1)) |
||
666 | 655 03f0 7040 sbci r23,hi8(-(-1)) |
||
667 | 656 03f2 80E0 ldi r24,lo8(EEPromArray+1000) |
||
668 | 657 03f4 90E0 ldi r25,hi8(EEPromArray+1000) |
||
669 | 658 03f6 0E94 0000 call __eewr_block |
||
670 | 659 .L61: |
||
671 | 660 03fa 8091 0000 lds r24,RequiredMotors |
||
672 | 661 03fe 9927 clr r25 |
||
673 | 662 0400 9F93 push r25 |
||
674 | 663 0402 8F93 push r24 |
||
675 | 664 0404 DF93 push r29 |
||
676 | 665 0406 CF93 push r28 |
||
677 | 666 0408 80E0 ldi r24,lo8(__c.5) |
||
678 | 667 040a 90E0 ldi r25,hi8(__c.5) |
||
679 | 668 040c 9F93 push r25 |
||
680 | 669 040e 8F93 push r24 |
||
681 | 670 0410 1F92 push __zero_reg__ |
||
682 | 671 0412 0E94 0000 call _printf_P |
||
683 | 672 0416 EDB7 in r30,__SP_L__ |
||
684 | 673 0418 FEB7 in r31,__SP_H__ |
||
685 | 674 041a 3796 adiw r30,7 |
||
686 | 675 041c EDBF out __SP_L__,r30 |
||
687 | 676 041e 80E0 ldi r24,lo8(__c.6) |
||
688 | 677 0420 90E0 ldi r25,hi8(__c.6) |
||
689 | 678 0422 9F93 push r25 |
||
690 | 679 0424 8F93 push r24 |
||
691 | 680 0426 1F92 push __zero_reg__ |
||
692 | 681 0428 0E94 0000 call _printf_P |
||
693 | 682 042c 1092 0000 sts motorread,__zero_reg__ |
||
694 | 683 0430 1092 0000 sts UpdateMotor,__zero_reg__ |
||
695 | 684 0434 0E94 0000 call SendMotorData |
||
696 | 685 0438 0F90 pop __tmp_reg__ |
||
697 | 686 043a 0F90 pop __tmp_reg__ |
||
698 | 687 043c 0F90 pop __tmp_reg__ |
||
699 | 688 .L67: |
||
700 | 689 043e 8091 0000 lds r24,UpdateMotor |
||
701 | 690 0442 8823 tst r24 |
||
702 | 691 0444 01F0 breq .L67 |
||
703 | 692 0446 1092 0000 sts motorread,__zero_reg__ |
||
704 | 693 044a 80ED ldi r24,lo8(2000) |
||
705 | 694 044c 97E0 ldi r25,hi8(2000) |
||
706 | 695 044e 0E94 0000 call SetDelay |
||
707 | 696 0452 EC01 movw r28,r24 |
||
708 | 697 0454 CC24 clr r12 |
||
709 | 698 0456 DD24 clr r13 |
||
710 | 699 0458 B0E0 ldi r27,lo8(__c.7) |
||
711 | 700 045a AB2E mov r10,r27 |
||
712 | 701 045c B0E0 ldi r27,hi8(__c.7) |
||
713 | 702 045e BB2E mov r11,r27 |
||
714 | 703 .L84: |
||
715 | 704 0460 1092 0000 sts UpdateMotor,__zero_reg__ |
||
716 | 705 0464 0E94 0000 call SendMotorData |
||
717 | 706 .L73: |
||
718 | 707 0468 8091 0000 lds r24,UpdateMotor |
||
719 | 708 046c 8823 tst r24 |
||
720 | 709 046e 01F0 breq .L73 |
||
721 | 710 0470 F601 movw r30,r12 |
||
722 | 711 0472 EE0F lsl r30 |
||
723 | 712 0474 FF1F rol r31 |
||
724 | 713 0476 EE0F lsl r30 |
||
725 | 714 0478 FF1F rol r31 |
||
726 | 715 047a E050 subi r30,lo8(-(Mixer)) |
||
727 | 716 047c F040 sbci r31,hi8(-(Mixer)) |
||
728 | 717 047e 8585 ldd r24,Z+13 |
||
729 | 718 0480 1816 cp __zero_reg__,r24 |
||
730 | 719 0482 04F0 brlt .+2 |
||
731 | 720 0484 00C0 rjmp .L248 |
||
732 | 721 0486 8601 movw r16,r12 |
||
733 | 722 0488 0050 subi r16,lo8(-(MotorPresent)) |
||
734 | 723 048a 1040 sbci r17,hi8(-(MotorPresent)) |
||
735 | 724 048c CE01 movw r24,r28 |
||
736 | 725 048e 0E94 0000 call CheckDelay |
||
737 | 726 0492 8823 tst r24 |
||
738 | 727 0494 01F4 brne .L76 |
||
739 | 728 .L361: |
||
740 | 729 0496 D801 movw r26,r16 |
||
741 | 730 0498 8C91 ld r24,X |
||
742 | 731 049a 8823 tst r24 |
||
743 | 732 049c 01F4 brne .L76 |
||
744 | 733 049e 8093 0000 sts UpdateMotor,r24 |
||
745 | 734 04a2 0E94 0000 call SendMotorData |
||
746 | 735 .L79: |
||
747 | 736 04a6 8091 0000 lds r24,UpdateMotor |
||
748 | 737 04aa 8823 tst r24 |
||
749 | 738 04ac 01F0 breq .L79 |
||
750 | 739 04ae CE01 movw r24,r28 |
||
751 | 740 04b0 0E94 0000 call CheckDelay |
||
752 | 741 04b4 8823 tst r24 |
||
753 | 742 04b6 01F0 breq .L361 |
||
754 | 743 .L76: |
||
755 | 744 04b8 F801 movw r30,r16 |
||
756 | 745 04ba 8081 ld r24,Z |
||
757 | 746 04bc 8823 tst r24 |
||
758 | 747 04be 01F4 brne .L362 |
||
759 | 748 04c0 8601 movw r16,r12 |
||
760 | 749 04c2 0F5F subi r16,lo8(-(1)) |
||
761 | 750 04c4 1F4F sbci r17,hi8(-(1)) |
||
762 | 751 .L72: |
||
763 | 752 04c6 6801 movw r12,r16 |
||
764 | 753 04c8 0230 cpi r16,2 |
||
765 | 754 04ca 1105 cpc r17,__zero_reg__ |
||
766 | 755 04cc 00F0 brlo .L84 |
||
767 | 756 04ce CC24 clr r12 |
||
768 | 757 04d0 DD24 clr r13 |
||
769 | 758 04d2 E0E0 ldi r30,lo8(__c.8) |
||
770 | 759 04d4 AE2E mov r10,r30 |
||
771 | 760 04d6 E0E0 ldi r30,hi8(__c.8) |
||
772 | 761 04d8 BE2E mov r11,r30 |
||
773 | 762 04da C1E0 ldi r28,lo8(1) |
||
774 | 763 04dc 00C0 rjmp .L89 |
||
775 | 764 .L364: |
||
776 | 765 04de F601 movw r30,r12 |
||
777 | 766 04e0 EE0F lsl r30 |
||
778 | 767 04e2 FF1F rol r31 |
||
779 | 768 04e4 EE0F lsl r30 |
||
780 | 769 04e6 FF1F rol r31 |
||
781 | 770 04e8 E050 subi r30,lo8(-(Mixer)) |
||
782 | 771 04ea F040 sbci r31,hi8(-(Mixer)) |
||
783 | 772 04ec 8585 ldd r24,Z+13 |
||
784 | 773 04ee 1816 cp __zero_reg__,r24 |
||
785 | 774 04f0 04F4 brge .L251 |
||
786 | 775 04f2 8601 movw r16,r12 |
||
787 | 776 04f4 0F5F subi r16,lo8(-(1)) |
||
788 | 777 04f6 1F4F sbci r17,hi8(-(1)) |
||
789 | 778 04f8 1F93 push r17 |
||
790 | 779 04fa 0F93 push r16 |
||
791 | 780 04fc BF92 push r11 |
||
792 | 781 04fe AF92 push r10 |
||
793 | 782 0500 9F93 push r25 |
||
794 | 783 0502 0E94 0000 call _printf_P |
||
795 | 784 0506 C093 0000 sts ServoActive,r28 |
||
796 | 785 050a 0F90 pop __tmp_reg__ |
||
797 | 786 050c 0F90 pop __tmp_reg__ |
||
798 | 787 050e 0F90 pop __tmp_reg__ |
||
799 | 788 0510 0F90 pop __tmp_reg__ |
||
800 | 789 0512 0F90 pop __tmp_reg__ |
||
801 | 790 .L88: |
||
802 | 791 0514 80E0 ldi r24,lo8(MotorError) |
||
803 | 792 0516 90E0 ldi r25,hi8(MotorError) |
||
804 | 793 0518 C80E add r12,r24 |
||
805 | 794 051a D91E adc r13,r25 |
||
806 | 795 051c D601 movw r26,r12 |
||
807 | 796 051e 1C92 st X,__zero_reg__ |
||
808 | 797 0520 6801 movw r12,r16 |
||
809 | 798 0522 0230 cpi r16,2 |
||
810 | 799 0524 1105 cpc r17,__zero_reg__ |
||
811 | 800 0526 00F4 brsh .L363 |
||
812 | 801 .L89: |
||
813 | 802 0528 F601 movw r30,r12 |
||
814 | 803 052a E050 subi r30,lo8(-(MotorPresent)) |
||
815 | 804 052c F040 sbci r31,hi8(-(MotorPresent)) |
||
816 | 805 052e 9081 ld r25,Z |
||
817 | 806 0530 9923 tst r25 |
||
818 | 807 0532 01F0 breq .L364 |
||
819 | 808 .L251: |
||
820 | 809 0534 8601 movw r16,r12 |
||
821 | 810 0536 0F5F subi r16,lo8(-(1)) |
||
822 | 811 0538 1F4F sbci r17,hi8(-(1)) |
||
823 | 812 053a 00C0 rjmp .L88 |
||
824 | 813 .L362: |
||
825 | 814 053c 8601 movw r16,r12 |
||
826 | 815 053e 0F5F subi r16,lo8(-(1)) |
||
827 | 816 0540 1F4F sbci r17,hi8(-(1)) |
||
828 | 817 0542 1F93 push r17 |
||
829 | 818 0544 0F93 push r16 |
||
830 | 819 0546 BF92 push r11 |
||
831 | 820 0548 AF92 push r10 |
||
832 | 821 054a 1F92 push __zero_reg__ |
||
833 | 822 054c 0E94 0000 call _printf_P |
||
834 | 823 0550 0F90 pop __tmp_reg__ |
||
835 | 824 0552 0F90 pop __tmp_reg__ |
||
836 | 825 0554 0F90 pop __tmp_reg__ |
||
837 | 826 0556 0F90 pop __tmp_reg__ |
||
838 | 827 0558 0F90 pop __tmp_reg__ |
||
839 | 828 055a 00C0 rjmp .L72 |
||
840 | 829 .L248: |
||
841 | 830 055c 8601 movw r16,r12 |
||
842 | 831 055e 0050 subi r16,lo8(-(MotorPresent)) |
||
843 | 832 0560 1040 sbci r17,hi8(-(MotorPresent)) |
||
844 | 833 0562 00C0 rjmp .L76 |
||
845 | 834 .L363: |
||
846 | 835 0564 80E0 ldi r24,lo8(__c.9) |
||
847 | 836 0566 90E0 ldi r25,hi8(__c.9) |
||
848 | 837 0568 9F93 push r25 |
||
849 | 838 056a 8F93 push r24 |
||
850 | 839 056c 1F92 push __zero_reg__ |
||
851 | 840 056e 0E94 0000 call _printf_P |
||
852 | 841 0572 0E94 0000 call SendMotorData |
||
853 | 842 0576 0F90 pop __tmp_reg__ |
||
854 | 843 0578 0F90 pop __tmp_reg__ |
||
855 | 844 057a 0F90 pop __tmp_reg__ |
||
856 | 845 .L91: |
||
857 | 846 057c F999 sbic 63-0x20,1 |
||
858 | 847 057e 00C0 rjmp .L91 |
||
859 | 848 0580 80E0 ldi r24,lo8(EEPromArray+1) |
||
860 | 849 0582 90E0 ldi r25,hi8(EEPromArray+1) |
||
861 | 850 0584 92BD out (65)+1-0x20,r25 |
||
862 | 851 0586 81BD out 65-0x20,r24 |
||
863 | 852 /* #APP */ |
||
864 | 853 /* START EEPROM READ CRITICAL SECTION */ |
||
865 | 854 0588 F89A sbi 31, 0 |
||
866 | 855 058a 80B5 in r24, 32 |
||
867 | 856 /* END EEPROM READ CRITICAL SECTION */ |
||
868 | 857 |
||
869 | 858 /* #NOAPP */ |
||
870 | 859 058c 8035 cpi r24,lo8(80) |
||
871 | 860 058e 01F0 breq .+2 |
||
872 | 861 0590 00C0 rjmp .L365 |
||
873 | 862 .L157: |
||
874 | 863 0592 F999 sbic 63-0x20,1 |
||
875 | 864 0594 00C0 rjmp .L157 |
||
876 | 865 0596 80E0 ldi r24,lo8(EEPromArray+14) |
||
877 | 866 0598 90E0 ldi r25,hi8(EEPromArray+14) |
||
878 | 867 059a 92BD out (65)+1-0x20,r25 |
||
879 | 868 059c 81BD out 65-0x20,r24 |
||
880 | 869 /* #APP */ |
||
881 | 870 /* START EEPROM READ CRITICAL SECTION */ |
||
882 | 871 059e F89A sbi 31, 0 |
||
883 | 872 05a0 80B5 in r24, 32 |
||
884 | 873 /* END EEPROM READ CRITICAL SECTION */ |
||
885 | 874 |
||
886 | 875 /* #NOAPP */ |
||
887 | 876 05a2 9927 clr r25 |
||
888 | 877 05a4 382F mov r19,r24 |
||
889 | 878 05a6 2227 clr r18 |
||
890 | 879 .L161: |
||
891 | 880 05a8 F999 sbic 63-0x20,1 |
||
892 | 881 05aa 00C0 rjmp .L161 |
||
893 | 882 05ac 80E0 ldi r24,lo8(EEPromArray+15) |
||
894 | 883 05ae 90E0 ldi r25,hi8(EEPromArray+15) |
||
895 | 884 05b0 92BD out (65)+1-0x20,r25 |
||
896 | 885 05b2 81BD out 65-0x20,r24 |
||
897 | 886 /* #APP */ |
||
898 | 887 /* START EEPROM READ CRITICAL SECTION */ |
||
899 | 888 05b4 F89A sbi 31, 0 |
||
900 | 889 05b6 80B5 in r24, 32 |
||
901 | 890 /* END EEPROM READ CRITICAL SECTION */ |
||
902 | 891 |
||
903 | 892 /* #NOAPP */ |
||
904 | 893 05b8 B901 movw r22,r18 |
||
905 | 894 05ba 680F add r22,r24 |
||
906 | 895 05bc 711D adc r23,__zero_reg__ |
||
907 | 896 .L165: |
||
908 | 897 05be F999 sbic 63-0x20,1 |
||
909 | 898 05c0 00C0 rjmp .L165 |
||
910 | 899 05c2 80E0 ldi r24,lo8(EEPromArray+10) |
||
911 | 900 05c4 90E0 ldi r25,hi8(EEPromArray+10) |
||
912 | 901 05c6 92BD out (65)+1-0x20,r25 |
||
913 | 902 05c8 81BD out 65-0x20,r24 |
||
914 | 903 /* #APP */ |
||
915 | 904 /* START EEPROM READ CRITICAL SECTION */ |
||
916 | 905 05ca F89A sbi 31, 0 |
||
917 | 906 05cc 80B5 in r24, 32 |
||
918 | 907 /* END EEPROM READ CRITICAL SECTION */ |
||
919 | 908 |
||
920 | 909 /* #NOAPP */ |
||
921 | 910 05ce 9927 clr r25 |
||
922 | 911 05d0 382F mov r19,r24 |
||
923 | 912 05d2 2227 clr r18 |
||
924 | 913 .L169: |
||
925 | 914 05d4 8FB3 in r24,63-0x20 |
||
926 | 915 05d6 9927 clr r25 |
||
927 | 916 05d8 AC01 movw r20,r24 |
||
928 | 917 05da 4270 andi r20,lo8(2) |
||
929 | 918 05dc 5070 andi r21,hi8(2) |
||
930 | 919 05de 81FD sbrc r24,1 |
||
931 | 920 05e0 00C0 rjmp .L169 |
||
932 | 921 05e2 80E0 ldi r24,lo8(EEPromArray+11) |
||
933 | 922 05e4 90E0 ldi r25,hi8(EEPromArray+11) |
||
934 | 923 05e6 92BD out (65)+1-0x20,r25 |
||
935 | 924 05e8 81BD out 65-0x20,r24 |
||
936 | 925 /* #APP */ |
||
937 | 926 /* START EEPROM READ CRITICAL SECTION */ |
||
938 | 927 05ea F89A sbi 31, 0 |
||
939 | 928 05ec 80B5 in r24, 32 |
||
940 | 929 /* END EEPROM READ CRITICAL SECTION */ |
||
941 | 930 |
||
942 | 931 /* #NOAPP */ |
||
943 | 932 05ee 280F add r18,r24 |
||
944 | 933 05f0 311D adc r19,__zero_reg__ |
||
945 | 934 05f2 C901 movw r24,r18 |
||
946 | 935 05f4 2F5F subi r18,lo8(-1) |
||
947 | 936 05f6 3F4F sbci r19,hi8(-1) |
||
948 | 937 05f8 01F4 brne .+2 |
||
949 | 938 05fa 00C0 rjmp .L174 |
||
950 | 939 05fc 7093 0000 sts (FlugMinuten)+1,r23 |
||
951 | 940 0600 6093 0000 sts FlugMinuten,r22 |
||
952 | 941 0604 9B01 movw r18,r22 |
||
953 | 942 0606 6F5F subi r22,lo8(-1) |
||
954 | 943 0608 7F4F sbci r23,hi8(-1) |
||
955 | 944 060a 01F4 brne .+2 |
||
956 | 945 060c 00C0 rjmp .L174 |
||
957 | 946 060e 9093 0000 sts (FlugMinutenGesamt)+1,r25 |
||
958 | 947 0612 8093 0000 sts FlugMinutenGesamt,r24 |
||
959 | 948 .L173: |
||
960 | 949 0616 8091 0000 lds r24,FlugMinutenGesamt |
||
961 | 950 061a 9091 0000 lds r25,(FlugMinutenGesamt)+1 |
||
962 | 951 061e 9F93 push r25 |
||
963 | 952 0620 8F93 push r24 |
||
964 | 953 0622 3F93 push r19 |
||
965 | 954 0624 2F93 push r18 |
||
966 | 955 0626 80E0 ldi r24,lo8(__c.12) |
||
967 | 956 0628 90E0 ldi r25,hi8(__c.12) |
||
968 | 957 062a 9F93 push r25 |
||
969 | 958 062c 8F93 push r24 |
||
970 | 959 062e 1F92 push __zero_reg__ |
||
971 | 960 0630 0E94 0000 call _printf_P |
||
972 | 961 0634 8DB7 in r24,__SP_L__ |
||
973 | 962 0636 9EB7 in r25,__SP_H__ |
||
974 | 963 0638 0796 adiw r24,7 |
||
975 | 964 063a 8DBF out __SP_L__,r24 |
||
976 | 965 .L176: |
||
977 | 966 063c F999 sbic 63-0x20,1 |
||
978 | 967 063e 00C0 rjmp .L176 |
||
979 | 968 0640 80E0 ldi r24,lo8(EEPromArray+4) |
||
980 | 969 0642 90E0 ldi r25,hi8(EEPromArray+4) |
||
981 | 970 0644 92BD out (65)+1-0x20,r25 |
||
982 | 971 0646 81BD out 65-0x20,r24 |
||
983 | 972 /* #APP */ |
||
984 | 973 /* START EEPROM READ CRITICAL SECTION */ |
||
985 | 974 0648 F89A sbi 31, 0 |
||
986 | 975 064a 80B5 in r24, 32 |
||
987 | 976 /* END EEPROM READ CRITICAL SECTION */ |
||
988 | 977 |
||
989 | 978 /* #NOAPP */ |
||
990 | 979 064c 8530 cpi r24,lo8(5) |
||
991 | 980 064e 00F0 brlo .+2 |
||
992 | 981 0650 00C0 rjmp .L366 |
||
993 | 982 .L175: |
||
994 | 983 0652 0E94 0000 call GetActiveParamSetNumber |
||
995 | 984 0656 45E6 ldi r20,lo8(101) |
||
996 | 985 0658 60E0 ldi r22,lo8(EE_Parameter) |
||
997 | 986 065a 70E0 ldi r23,hi8(EE_Parameter) |
||
998 | 987 065c 0E94 0000 call ReadParameterSet |
||
999 | 988 0660 0E94 0000 call GetActiveParamSetNumber |
||
1000 | 989 0664 9927 clr r25 |
||
1001 | 990 0666 9F93 push r25 |
||
1002 | 991 0668 8F93 push r24 |
||
1003 | 992 066a 80E0 ldi r24,lo8(__c.14) |
||
1004 | 993 066c 90E0 ldi r25,hi8(__c.14) |
||
1005 | 994 066e 9F93 push r25 |
||
1006 | 995 0670 8F93 push r24 |
||
1007 | 996 0672 1F92 push __zero_reg__ |
||
1008 | 997 0674 0E94 0000 call _printf_P |
||
1009 | 998 0678 8091 0000 lds r24,EE_Parameter+8 |
||
1010 | 999 067c 0F90 pop __tmp_reg__ |
||
1011 | 1000 067e 0F90 pop __tmp_reg__ |
||
1012 | 1001 0680 0F90 pop __tmp_reg__ |
||
1013 | 1002 0682 0F90 pop __tmp_reg__ |
||
1014 | 1003 0684 0F90 pop __tmp_reg__ |
||
1015 | 1004 0686 80FD sbrc r24,0 |
||
1016 | 1005 0688 00C0 rjmp .L367 |
||
1017 | 1006 .L180: |
||
1018 | 1007 068a 0E94 0000 call SetNeutral |
||
1019 | 1008 068e 8091 0000 lds r24,PlatinenVersion |
||
1020 | 1009 0692 8A30 cpi r24,lo8(10) |
||
1021 | 1010 0694 01F4 brne .+2 |
||
1022 | 1011 0696 00C0 rjmp .L185 |
||
1023 | 1012 0698 8431 cpi r24,lo8(20) |
||
1024 | 1013 069a 01F4 brne .+2 |
||
1025 | 1014 069c 00C0 rjmp .L185 |
||
1026 | 1015 069e 289A sbi 37-0x20,0 |
||
1027 | 1016 .L186: |
||
1028 | 1017 06a0 80ED ldi r24,lo8(2000) |
||
1029 | 1018 06a2 97E0 ldi r25,hi8(2000) |
||
1030 | 1019 06a4 9093 0000 sts (beeptime)+1,r25 |
||
1031 | 1020 06a8 8093 0000 sts beeptime,r24 |
||
1032 | 1021 06ac 85E5 ldi r24,lo8(85) |
||
1033 | 1022 06ae 8093 0000 sts ExternControl,r24 |
||
1034 | 1023 06b2 80E0 ldi r24,lo8(__c.17) |
||
1035 | 1024 06b4 90E0 ldi r25,hi8(__c.17) |
||
1036 | 1025 06b6 9F93 push r25 |
||
1037 | 1026 06b8 8F93 push r24 |
||
1038 | 1027 06ba 1F92 push __zero_reg__ |
||
1039 | 1028 06bc 0E94 0000 call _printf_P |
||
1040 | 1029 06c0 8091 0000 lds r24,EE_Parameter+8 |
||
1041 | 1030 06c4 0F90 pop __tmp_reg__ |
||
1042 | 1031 06c6 0F90 pop __tmp_reg__ |
||
1043 | 1032 06c8 0F90 pop __tmp_reg__ |
||
1044 | 1033 06ca 82FF sbrs r24,2 |
||
1045 | 1034 06cc 00C0 rjmp .L187 |
||
1046 | 1035 06ce 80E0 ldi r24,lo8(__c.18) |
||
1047 | 1036 06d0 90E0 ldi r25,hi8(__c.18) |
||
1048 | 1037 .L359: |
||
1049 | 1038 06d2 9F93 push r25 |
||
1050 | 1039 06d4 8F93 push r24 |
||
1051 | 1040 06d6 1F92 push __zero_reg__ |
||
1052 | 1041 06d8 0E94 0000 call _printf_P |
||
1053 | 1042 06dc 0F90 pop __tmp_reg__ |
||
1054 | 1043 06de 0F90 pop __tmp_reg__ |
||
1055 | 1044 06e0 0F90 pop __tmp_reg__ |
||
1056 | 1045 06e2 0E94 0000 call LcdClear |
||
1057 | 1046 06e6 88E8 ldi r24,lo8(5000) |
||
1058 | 1047 06e8 93E1 ldi r25,hi8(5000) |
||
1059 | 1048 06ea 9093 0000 sts (I2CTimeout)+1,r25 |
||
1060 | 1049 06ee 8093 0000 sts I2CTimeout,r24 |
||
1061 | 1050 06f2 81E0 ldi r24,lo8(1) |
||
1062 | 1051 06f4 8093 0000 sts WinkelOut+7,r24 |
||
1063 | 1052 06f8 0E94 0000 call LipoDetection |
||
1064 | 1053 06fc 80E0 ldi r24,lo8(__c.20) |
||
1065 | 1054 06fe 90E0 ldi r25,hi8(__c.20) |
||
1066 | 1055 0700 9F93 push r25 |
||
1067 | 1056 0702 8F93 push r24 |
||
1068 | 1057 0704 1F92 push __zero_reg__ |
||
1069 | 1058 0706 0E94 0000 call _printf_P |
||
1070 | 1059 070a 80ED ldi r24,lo8(2000) |
||
1071 | 1060 070c 97E0 ldi r25,hi8(2000) |
||
1072 | 1061 070e 0E94 0000 call SetDelay |
||
1073 | 1062 0712 EC01 movw r28,r24 |
||
1074 | 1063 0714 0F90 pop __tmp_reg__ |
||
1075 | 1064 0716 0F90 pop __tmp_reg__ |
||
1076 | 1065 0718 0F90 pop __tmp_reg__ |
||
1077 | 1066 .L360: |
||
1078 | 1067 071a 8091 0000 lds r24,UpdateMotor |
||
1079 | 1068 071e 8823 tst r24 |
||
1080 | 1069 0720 01F0 breq .L360 |
||
1081 | 1070 0722 8091 0000 lds r24,AdReady |
||
1082 | 1071 0726 8823 tst r24 |
||
1083 | 1072 0728 01F0 breq .L360 |
||
1084 | 1073 072a 1092 0000 sts UpdateMotor,__zero_reg__ |
||
1085 | 1074 072e 8091 0000 lds r24,WinkelOut+6 |
||
1086 | 1075 0732 8823 tst r24 |
||
1087 | 1076 0734 01F4 brne .+2 |
||
1088 | 1077 0736 00C0 rjmp .L192 |
||
1089 | 1078 0738 0E94 0000 call CalMk3Mag |
||
1090 | 1079 073c 0E94 0000 call SendMotorData |
||
1091 | 1080 0740 2091 0000 lds r18,PlatinenVersion |
||
1092 | 1081 0744 2A30 cpi r18,lo8(10) |
||
1093 | 1082 0746 01F4 brne .+2 |
||
1094 | 1083 0748 00C0 rjmp .L195 |
||
1095 | 1084 .L372: |
||
1096 | 1085 074a 2431 cpi r18,lo8(20) |
||
1097 | 1086 074c 01F4 brne .+2 |
||
1098 | 1087 074e 00C0 rjmp .L195 |
||
1099 | 1088 0750 289A sbi 37-0x20,0 |
||
1100 | 1089 .L196: |
||
1101 | 1090 0752 8091 0000 lds r24,SenderOkay |
||
1102 | 1091 0756 8823 tst r24 |
||
1103 | 1092 0758 01F4 brne .+2 |
||
1104 | 1093 075a 00C0 rjmp .L197 |
||
1105 | 1094 075c 8091 0000 lds r24,SenderOkay |
||
1106 | 1095 0760 8150 subi r24,lo8(-(-1)) |
||
1107 | 1096 0762 8093 0000 sts SenderOkay,r24 |
||
1108 | 1097 .L198: |
||
1109 | 1098 0766 8091 0000 lds r24,I2CTimeout |
||
1110 | 1099 076a 9091 0000 lds r25,(I2CTimeout)+1 |
||
1111 | 1100 076e 0197 sbiw r24,1 |
||
1112 | 1101 0770 9093 0000 sts (I2CTimeout)+1,r25 |
||
1113 | 1102 0774 8093 0000 sts I2CTimeout,r24 |
||
1114 | 1103 0778 8091 0000 lds r24,I2CTimeout |
||
1115 | 1104 077c 9091 0000 lds r25,(I2CTimeout)+1 |
||
1116 | 1105 0780 892B or r24,r25 |
||
1117 | 1106 0782 01F0 breq .L200 |
||
1118 | 1107 0784 8091 0000 lds r24,MissingMotor |
||
1119 | 1108 0788 8823 tst r24 |
||
1120 | 1109 078a 01F4 brne .+2 |
||
1121 | 1110 078c 00C0 rjmp .L199 |
||
1122 | 1111 .L200: |
||
1123 | 1112 078e 8091 0000 lds r24,I2CTimeout |
||
1124 | 1113 0792 9091 0000 lds r25,(I2CTimeout)+1 |
||
1125 | 1114 0796 892B or r24,r25 |
||
1126 | 1115 0798 01F4 brne .+2 |
||
1127 | 1116 079a 00C0 rjmp .L368 |
||
1128 | 1117 079c 8091 0000 lds r24,BeepMuster |
||
1129 | 1118 07a0 9091 0000 lds r25,(BeepMuster)+1 |
||
1130 | 1119 07a4 8F5F subi r24,lo8(-1) |
||
1131 | 1120 07a6 9F4F sbci r25,hi8(-1) |
||
1132 | 1121 07a8 01F4 brne .+2 |
||
1133 | 1122 07aa 00C0 rjmp .L369 |
||
1134 | 1123 .L203: |
||
1135 | 1124 07ac 8091 0000 lds r24,UpdateMotor |
||
1136 | 1125 07b0 8823 tst r24 |
||
1137 | 1126 07b2 01F0 breq .L208 |
||
1138 | 1127 07b4 8091 0000 lds r24,MotorenEin |
||
1139 | 1128 07b8 8823 tst r24 |
||
1140 | 1129 07ba 01F4 brne .L207 |
||
1141 | 1130 .L208: |
||
1142 | 1131 07bc 0E94 0000 call DatenUebertragung |
||
1143 | 1132 .L207: |
||
1144 | 1133 07c0 0E94 0000 call BearbeiteRxDaten |
||
1145 | 1134 07c4 CE01 movw r24,r28 |
||
1146 | 1135 07c6 0E94 0000 call CheckDelay |
||
1147 | 1136 07ca 8823 tst r24 |
||
1148 | 1137 07cc 01F0 breq .L210 |
||
1149 | 1138 07ce 6496 adiw r28,20 |
||
1150 | 1139 07d0 8091 0000 lds r24,PcZugriff |
||
1151 | 1140 07d4 8823 tst r24 |
||
1152 | 1141 07d6 01F4 brne .+2 |
||
1153 | 1142 07d8 00C0 rjmp .L211 |
||
1154 | 1143 07da 8150 subi r24,lo8(-(-1)) |
||
1155 | 1144 07dc 8093 0000 sts PcZugriff,r24 |
||
1156 | 1145 .L212: |
||
1157 | 1146 07e0 8091 0000 lds r24,BattLowVoltageWarning |
||
1158 | 1147 07e4 282F mov r18,r24 |
||
1159 | 1148 07e6 3327 clr r19 |
||
1160 | 1149 07e8 8091 0000 lds r24,UBat |
||
1161 | 1150 07ec 9091 0000 lds r25,(UBat)+1 |
||
1162 | 1151 07f0 8217 cp r24,r18 |
||
1163 | 1152 07f2 9307 cpc r25,r19 |
||
1164 | 1153 07f4 04F0 brlt .+2 |
||
1165 | 1154 07f6 00C0 rjmp .L214 |
||
1166 | 1155 07f8 8091 0000 lds r24,MikroKopterFlags |
||
1167 | 1156 07fc 8062 ori r24,lo8(32) |
||
1168 | 1157 07fe 8093 0000 sts MikroKopterFlags,r24 |
||
1169 | 1158 0802 8091 0000 lds r24,BeepMuster |
||
1170 | 1159 0806 9091 0000 lds r25,(BeepMuster)+1 |
||
1171 | 1160 080a 8F5F subi r24,lo8(-1) |
||
1172 | 1161 080c 9F4F sbci r25,hi8(-1) |
||
1173 | 1162 080e 01F4 brne .+2 |
||
1174 | 1163 0810 00C0 rjmp .L370 |
||
1175 | 1164 .L216: |
||
1176 | 1165 0812 84E0 ldi r24,lo8(4) |
||
1177 | 1166 0814 8093 0000 sts SendSPI,r24 |
||
1178 | 1167 0818 8091 0000 lds r24,MotorenEin |
||
1179 | 1168 081c 8823 tst r24 |
||
1180 | 1169 081e 01F4 brne .L217 |
||
1181 | 1170 0820 4AEA ldi r20,lo8(1450) |
||
1182 | 1171 0822 E42E mov r14,r20 |
||
1183 | 1172 0824 45E0 ldi r20,hi8(1450) |
||
1184 | 1173 0826 F42E mov r15,r20 |
||
1185 | 1174 .L217: |
||
1186 | 1175 0828 0894 sec |
||
1187 | 1176 082a E11C adc r14,__zero_reg__ |
||
1188 | 1177 082c F11C adc r15,__zero_reg__ |
||
1189 | 1178 082e F2E7 ldi r31,lo8(2930) |
||
1190 | 1179 0830 EF16 cp r14,r31 |
||
1191 | 1180 0832 FBE0 ldi r31,hi8(2930) |
||
1192 | 1181 0834 FF06 cpc r15,r31 |
||
1193 | 1182 0836 01F0 breq .L371 |
||
1194 | 1183 .L210: |
||
1195 | 1184 0838 0E94 0000 call LED_Update |
||
1196 | 1185 083c 00C0 rjmp .L360 |
||
1197 | 1186 .L371: |
||
1198 | 1187 083e EE24 clr r14 |
||
1199 | 1188 0840 FF24 clr r15 |
||
1200 | 1189 0842 8091 0000 lds r24,FlugMinuten |
||
1201 | 1190 0846 9091 0000 lds r25,(FlugMinuten)+1 |
||
1202 | 1191 084a 0196 adiw r24,1 |
||
1203 | 1192 084c 9093 0000 sts (FlugMinuten)+1,r25 |
||
1204 | 1193 0850 8093 0000 sts FlugMinuten,r24 |
||
1205 | 1194 0854 2091 0000 lds r18,FlugMinutenGesamt |
||
1206 | 1195 0858 3091 0000 lds r19,(FlugMinutenGesamt)+1 |
||
1207 | 1196 085c 2F5F subi r18,lo8(-(1)) |
||
1208 | 1197 085e 3F4F sbci r19,hi8(-(1)) |
||
1209 | 1198 0860 3093 0000 sts (FlugMinutenGesamt)+1,r19 |
||
1210 | 1199 0864 2093 0000 sts FlugMinutenGesamt,r18 |
||
1211 | 1200 0868 892F mov r24,r25 |
||
1212 | 1201 086a 9927 clr r25 |
||
1213 | 1202 086c 282F mov r18,r24 |
||
1214 | 1203 .L219: |
||
1215 | 1204 086e F999 sbic 63-0x20,1 |
||
1216 | 1205 0870 00C0 rjmp .L219 |
||
1217 | 1206 0872 1FBA out 63-0x20,__zero_reg__ |
||
1218 | 1207 0874 80E0 ldi r24,lo8(EEPromArray+14) |
||
1219 | 1208 0876 90E0 ldi r25,hi8(EEPromArray+14) |
||
1220 | 1209 0878 92BD out (65)+1-0x20,r25 |
||
1221 | 1210 087a 81BD out 65-0x20,r24 |
||
1222 | 1211 087c 20BD out 64-0x20,r18 |
||
1223 | 1212 /* #APP */ |
||
1224 | 1213 /* START EEPROM WRITE CRITICAL SECTION */ |
||
1225 | 1214 087e 0FB6 in r0, 63 |
||
1226 | 1215 0880 F894 cli |
||
1227 | 1216 0882 FA9A sbi 31, 2 |
||
1228 | 1217 0884 F99A sbi 31, 1 |
||
1229 | 1218 0886 0FBE out 63, r0 |
||
1230 | 1219 /* END EEPROM WRITE CRITICAL SECTION */ |
||
1231 | 1220 /* #NOAPP */ |
||
1232 | 1221 0888 2091 0000 lds r18,FlugMinuten |
||
1233 | 1222 .L223: |
||
1234 | 1223 088c F999 sbic 63-0x20,1 |
||
1235 | 1224 088e 00C0 rjmp .L223 |
||
1236 | 1225 0890 1FBA out 63-0x20,__zero_reg__ |
||
1237 | 1226 0892 80E0 ldi r24,lo8(EEPromArray+15) |
||
1238 | 1227 0894 90E0 ldi r25,hi8(EEPromArray+15) |
||
1239 | 1228 0896 92BD out (65)+1-0x20,r25 |
||
1240 | 1229 0898 81BD out 65-0x20,r24 |
||
1241 | 1230 089a 20BD out 64-0x20,r18 |
||
1242 | 1231 /* #APP */ |
||
1243 | 1232 /* START EEPROM WRITE CRITICAL SECTION */ |
||
1244 | 1233 089c 0FB6 in r0, 63 |
||
1245 | 1234 089e F894 cli |
||
1246 | 1235 08a0 FA9A sbi 31, 2 |
||
1247 | 1236 08a2 F99A sbi 31, 1 |
||
1248 | 1237 08a4 0FBE out 63, r0 |
||
1249 | 1238 /* END EEPROM WRITE CRITICAL SECTION */ |
||
1250 | 1239 /* #NOAPP */ |
||
1251 | 1240 08a6 2091 0000 lds r18,FlugMinutenGesamt |
||
1252 | 1241 08aa 3091 0000 lds r19,(FlugMinutenGesamt)+1 |
||
1253 | 1242 08ae 4091 0000 lds r20,FlugMinutenGesamt+1 |
||
1254 | 1243 .L227: |
||
1255 | 1244 08b2 F999 sbic 63-0x20,1 |
||
1256 | 1245 08b4 00C0 rjmp .L227 |
||
1257 | 1246 08b6 1FBA out 63-0x20,__zero_reg__ |
||
1258 | 1247 08b8 80E0 ldi r24,lo8(EEPromArray+10) |
||
1259 | 1248 08ba 90E0 ldi r25,hi8(EEPromArray+10) |
||
1260 | 1249 08bc 92BD out (65)+1-0x20,r25 |
||
1261 | 1250 08be 81BD out 65-0x20,r24 |
||
1262 | 1251 08c0 40BD out 64-0x20,r20 |
||
1263 | 1252 /* #APP */ |
||
1264 | 1253 /* START EEPROM WRITE CRITICAL SECTION */ |
||
1265 | 1254 08c2 0FB6 in r0, 63 |
||
1266 | 1255 08c4 F894 cli |
||
1267 | 1256 08c6 FA9A sbi 31, 2 |
||
1268 | 1257 08c8 F99A sbi 31, 1 |
||
1269 | 1258 08ca 0FBE out 63, r0 |
||
1270 | 1259 /* END EEPROM WRITE CRITICAL SECTION */ |
||
1271 | 1260 /* #NOAPP */ |
||
1272 | 1261 .L231: |
||
1273 | 1262 08cc F999 sbic 63-0x20,1 |
||
1274 | 1263 08ce 00C0 rjmp .L231 |
||
1275 | 1264 08d0 1FBA out 63-0x20,__zero_reg__ |
||
1276 | 1265 08d2 80E0 ldi r24,lo8(EEPromArray+11) |
||
1277 | 1266 08d4 90E0 ldi r25,hi8(EEPromArray+11) |
||
1278 | 1267 08d6 92BD out (65)+1-0x20,r25 |
||
1279 | 1268 08d8 81BD out 65-0x20,r24 |
||
1280 | 1269 08da 20BD out 64-0x20,r18 |
||
1281 | 1270 /* #APP */ |
||
1282 | 1271 /* START EEPROM WRITE CRITICAL SECTION */ |
||
1283 | 1272 08dc 0FB6 in r0, 63 |
||
1284 | 1273 08de F894 cli |
||
1285 | 1274 08e0 FA9A sbi 31, 2 |
||
1286 | 1275 08e2 F99A sbi 31, 1 |
||
1287 | 1276 08e4 0FBE out 63, r0 |
||
1288 | 1277 /* END EEPROM WRITE CRITICAL SECTION */ |
||
1289 | 1278 /* #NOAPP */ |
||
1290 | 1279 08e6 84E1 ldi r24,lo8(20) |
||
1291 | 1280 08e8 90E0 ldi r25,hi8(20) |
||
1292 | 1281 08ea 0E94 0000 call SetDelay |
||
1293 | 1282 08ee EC01 movw r28,r24 |
||
1294 | 1283 08f0 0E94 0000 call LED_Update |
||
1295 | 1284 08f4 00C0 rjmp .L360 |
||
1296 | 1285 .L197: |
||
1297 | 1286 08f6 8091 6F00 lds r24,111 |
||
1298 | 1287 08fa 8062 ori r24,lo8(32) |
||
1299 | 1288 08fc 8093 6F00 sts 111,r24 |
||
1300 | 1289 0900 00C0 rjmp .L198 |
||
1301 | 1290 .L192: |
||
1302 | 1291 0902 0E94 0000 call MotorRegler |
||
1303 | 1292 0906 0E94 0000 call SendMotorData |
||
1304 | 1293 090a 2091 0000 lds r18,PlatinenVersion |
||
1305 | 1294 090e 2A30 cpi r18,lo8(10) |
||
1306 | 1295 0910 01F0 breq .+2 |
||
1307 | 1296 0912 00C0 rjmp .L372 |
||
1308 | 1297 .L195: |
||
1309 | 1298 0914 2898 cbi 37-0x20,0 |
||
1310 | 1299 0916 00C0 rjmp .L196 |
||
1311 | 1300 .L214: |
||
1312 | 1301 0918 8091 0000 lds r24,MikroKopterFlags |
||
1313 | 1302 091c 8F7D andi r24,lo8(-33) |
||
1314 | 1303 091e 8093 0000 sts MikroKopterFlags,r24 |
||
1315 | 1304 0922 00C0 rjmp .L216 |
||
1316 | 1305 .L211: |
||
1317 | 1306 0924 8093 0000 sts ExternControl+10,r24 |
||
1318 | 1307 0928 1092 0000 sts (ExternStickNick)+1,__zero_reg__ |
||
1319 | 1308 092c 1092 0000 sts ExternStickNick,__zero_reg__ |
||
1320 | 1309 0930 1092 0000 sts (ExternStickRoll)+1,__zero_reg__ |
||
1321 | 1310 0934 1092 0000 sts ExternStickRoll,__zero_reg__ |
||
1322 | 1311 0938 1092 0000 sts (ExternStickGier)+1,__zero_reg__ |
||
1323 | 1312 093c 1092 0000 sts ExternStickGier,__zero_reg__ |
||
1324 | 1313 0940 8091 0000 lds r24,BeepMuster |
||
1325 | 1314 0944 9091 0000 lds r25,(BeepMuster)+1 |
||
1326 | 1315 0948 8F5F subi r24,lo8(-1) |
||
1327 | 1316 094a 9F4F sbci r25,hi8(-1) |
||
1328 | 1317 094c 01F0 breq .+2 |
||
1329 | 1318 094e 00C0 rjmp .L212 |
||
1330 | 1319 0950 8091 0000 lds r24,SenderOkay |
||
1331 | 1320 0954 8823 tst r24 |
||
1332 | 1321 0956 01F0 breq .+2 |
||
1333 | 1322 0958 00C0 rjmp .L212 |
||
1334 | 1323 095a 88E9 ldi r24,lo8(15000) |
||
1335 | 1324 095c 9AE3 ldi r25,hi8(15000) |
||
1336 | 1325 095e 9093 0000 sts (beeptime)+1,r25 |
||
1337 | 1326 0962 8093 0000 sts beeptime,r24 |
||
1338 | 1327 0966 80E0 ldi r24,lo8(3072) |
||
1339 | 1328 0968 9CE0 ldi r25,hi8(3072) |
||
1340 | 1329 096a 9093 0000 sts (BeepMuster)+1,r25 |
||
1341 | 1330 096e 8093 0000 sts BeepMuster,r24 |
||
1342 | 1331 0972 00C0 rjmp .L212 |
||
1343 | 1332 .L199: |
||
1344 | 1333 0974 2A30 cpi r18,lo8(10) |
||
1345 | 1334 0976 01F0 breq .L205 |
||
1346 | 1335 0978 2431 cpi r18,lo8(20) |
||
1347 | 1336 097a 01F0 breq .L205 |
||
1348 | 1337 097c 289A sbi 37-0x20,0 |
||
1349 | 1338 097e 00C0 rjmp .L203 |
||
1350 | 1339 .L368: |
||
1351 | 1340 0980 0E94 0000 call i2c_reset |
||
1352 | 1341 0984 85E0 ldi r24,lo8(5) |
||
1353 | 1342 0986 90E0 ldi r25,hi8(5) |
||
1354 | 1343 0988 9093 0000 sts (I2CTimeout)+1,r25 |
||
1355 | 1344 098c 8093 0000 sts I2CTimeout,r24 |
||
1356 | 1345 0990 8091 0000 lds r24,DebugOut+58 |
||
1357 | 1346 0994 9091 0000 lds r25,(DebugOut+58)+1 |
||
1358 | 1347 0998 0196 adiw r24,1 |
||
1359 | 1348 099a 9093 0000 sts (DebugOut+58)+1,r25 |
||
1360 | 1349 099e 8093 0000 sts DebugOut+58,r24 |
||
1361 | 1350 09a2 8091 0000 lds r24,BeepMuster |
||
1362 | 1351 09a6 9091 0000 lds r25,(BeepMuster)+1 |
||
1363 | 1352 09aa 8F5F subi r24,lo8(-1) |
||
1364 | 1353 09ac 9F4F sbci r25,hi8(-1) |
||
1365 | 1354 09ae 01F0 breq .+2 |
||
1366 | 1355 09b0 00C0 rjmp .L203 |
||
1367 | 1356 .L369: |
||
1368 | 1357 09b2 8091 0000 lds r24,MotorenEin |
||
1369 | 1358 09b6 8823 tst r24 |
||
1370 | 1359 09b8 01F4 brne .+2 |
||
1371 | 1360 09ba 00C0 rjmp .L203 |
||
1372 | 1361 09bc 80E1 ldi r24,lo8(10000) |
||
1373 | 1362 09be 97E2 ldi r25,hi8(10000) |
||
1374 | 1363 09c0 9093 0000 sts (beeptime)+1,r25 |
||
1375 | 1364 09c4 8093 0000 sts beeptime,r24 |
||
1376 | 1365 09c8 80E8 ldi r24,lo8(128) |
||
1377 | 1366 09ca 90E0 ldi r25,hi8(128) |
||
1378 | 1367 09cc 9093 0000 sts (BeepMuster)+1,r25 |
||
1379 | 1368 09d0 8093 0000 sts BeepMuster,r24 |
||
1380 | 1369 09d4 00C0 rjmp .L203 |
||
1381 | 1370 .L205: |
||
1382 | 1371 09d6 2898 cbi 37-0x20,0 |
||
1383 | 1372 09d8 00C0 rjmp .L203 |
||
1384 | 1373 .L370: |
||
1385 | 1374 09da 80E7 ldi r24,lo8(6000) |
||
1386 | 1375 09dc 97E1 ldi r25,hi8(6000) |
||
1387 | 1376 09de 9093 0000 sts (beeptime)+1,r25 |
||
1388 | 1377 09e2 8093 0000 sts beeptime,r24 |
||
1389 | 1378 09e6 80E0 ldi r24,lo8(768) |
||
1390 | 1379 09e8 93E0 ldi r25,hi8(768) |
||
1391 | 1380 09ea 9093 0000 sts (BeepMuster)+1,r25 |
||
1392 | 1381 09ee 8093 0000 sts BeepMuster,r24 |
||
1393 | 1382 09f2 00C0 rjmp .L216 |
||
1394 | 1383 .L365: |
||
1395 | 1384 09f4 0E94 0000 call DefaultKonstanten1 |
||
1396 | 1385 09f8 80E0 ldi r24,lo8(__c.10) |
||
1397 | 1386 09fa 90E0 ldi r25,hi8(__c.10) |
||
1398 | 1387 09fc 9F93 push r25 |
||
1399 | 1388 09fe 8F93 push r24 |
||
1400 | 1389 0a00 1F92 push __zero_reg__ |
||
1401 | 1390 0a02 0E94 0000 call _printf_P |
||
1402 | 1391 0a06 C1E0 ldi r28,lo8(1) |
||
1403 | 1392 0a08 0F90 pop __tmp_reg__ |
||
1404 | 1393 0a0a 0F90 pop __tmp_reg__ |
||
1405 | 1394 0a0c 0F90 pop __tmp_reg__ |
||
1406 | 1395 0a0e 00E0 ldi r16,lo8(__c.11) |
||
1407 | 1396 0a10 10E0 ldi r17,hi8(__c.11) |
||
1408 | 1397 .L152: |
||
1409 | 1398 0a12 C230 cpi r28,lo8(2) |
||
1410 | 1399 0a14 01F4 brne .+2 |
||
1411 | 1400 0a16 00C0 rjmp .L358 |
||
1412 | 1401 0a18 C330 cpi r28,lo8(3) |
||
1413 | 1402 0a1a 01F4 brne .+2 |
||
1414 | 1403 0a1c 00C0 rjmp .L373 |
||
1415 | 1404 0a1e C430 cpi r28,lo8(4) |
||
1416 | 1405 0a20 00F0 brlo .+2 |
||
1417 | 1406 0a22 00C0 rjmp .L358 |
||
1418 | 1407 .L102: |
||
1419 | 1408 0a24 F999 sbic 63-0x20,1 |
||
1420 | 1409 0a26 00C0 rjmp .L102 |
||
1421 | 1410 0a28 80E0 ldi r24,lo8(EEPromArray+80) |
||
1422 | 1411 0a2a 90E0 ldi r25,hi8(EEPromArray+80) |
||
1423 | 1412 0a2c 92BD out (65)+1-0x20,r25 |
||
1424 | 1413 0a2e 81BD out 65-0x20,r24 |
||
1425 | 1414 /* #APP */ |
||
1426 | 1415 /* START EEPROM READ CRITICAL SECTION */ |
||
1427 | 1416 0a30 F89A sbi 31, 0 |
||
1428 | 1417 0a32 80B5 in r24, 32 |
||
1429 | 1418 /* END EEPROM READ CRITICAL SECTION */ |
||
1430 | 1419 |
||
1431 | 1420 /* #NOAPP */ |
||
1432 | 1421 0a34 8C30 cpi r24,lo8(12) |
||
1433 | 1422 0a36 00F0 brlo .+2 |
||
1434 | 1423 0a38 00C0 rjmp .L101 |
||
1435 | 1424 .L106: |
||
1436 | 1425 0a3a F999 sbic 63-0x20,1 |
||
1437 | 1426 0a3c 00C0 rjmp .L106 |
||
1438 | 1427 0a3e 80E0 ldi r24,lo8(EEPromArray+81) |
||
1439 | 1428 0a40 90E0 ldi r25,hi8(EEPromArray+81) |
||
1440 | 1429 0a42 92BD out (65)+1-0x20,r25 |
||
1441 | 1430 0a44 81BD out 65-0x20,r24 |
||
1442 | 1431 /* #APP */ |
||
1443 | 1432 /* START EEPROM READ CRITICAL SECTION */ |
||
1444 | 1433 0a46 F89A sbi 31, 0 |
||
1445 | 1434 0a48 80B5 in r24, 32 |
||
1446 | 1435 /* END EEPROM READ CRITICAL SECTION */ |
||
1447 | 1436 |
||
1448 | 1437 /* #NOAPP */ |
||
1449 | 1438 0a4a 8C30 cpi r24,lo8(12) |
||
1450 | 1439 0a4c 00F0 brlo .+2 |
||
1451 | 1440 0a4e 00C0 rjmp .L101 |
||
1452 | 1441 .L110: |
||
1453 | 1442 0a50 F999 sbic 63-0x20,1 |
||
1454 | 1443 0a52 00C0 rjmp .L110 |
||
1455 | 1444 0a54 80E0 ldi r24,lo8(EEPromArray+82) |
||
1456 | 1445 0a56 90E0 ldi r25,hi8(EEPromArray+82) |
||
1457 | 1446 0a58 92BD out (65)+1-0x20,r25 |
||
1458 | 1447 0a5a 81BD out 65-0x20,r24 |
||
1459 | 1448 /* #APP */ |
||
1460 | 1449 /* START EEPROM READ CRITICAL SECTION */ |
||
1461 | 1450 0a5c F89A sbi 31, 0 |
||
1462 | 1451 0a5e 80B5 in r24, 32 |
||
1463 | 1452 /* END EEPROM READ CRITICAL SECTION */ |
||
1464 | 1453 |
||
1465 | 1454 /* #NOAPP */ |
||
1466 | 1455 0a60 8C30 cpi r24,lo8(12) |
||
1467 | 1456 0a62 00F0 brlo .+2 |
||
1468 | 1457 0a64 00C0 rjmp .L101 |
||
1469 | 1458 .L114: |
||
1470 | 1459 0a66 F999 sbic 63-0x20,1 |
||
1471 | 1460 0a68 00C0 rjmp .L114 |
||
1472 | 1461 0a6a 80E0 ldi r24,lo8(EEPromArray+83) |
||
1473 | 1462 0a6c 90E0 ldi r25,hi8(EEPromArray+83) |
||
1474 | 1463 0a6e 92BD out (65)+1-0x20,r25 |
||
1475 | 1464 0a70 81BD out 65-0x20,r24 |
||
1476 | 1465 /* #APP */ |
||
1477 | 1466 /* START EEPROM READ CRITICAL SECTION */ |
||
1478 | 1467 0a72 F89A sbi 31, 0 |
||
1479 | 1468 0a74 80B5 in r24, 32 |
||
1480 | 1469 /* END EEPROM READ CRITICAL SECTION */ |
||
1481 | 1470 |
||
1482 | 1471 /* #NOAPP */ |
||
1483 | 1472 0a76 8C30 cpi r24,lo8(12) |
||
1484 | 1473 0a78 00F0 brlo .+2 |
||
1485 | 1474 0a7a 00C0 rjmp .L101 |
||
1486 | 1475 .L118: |
||
1487 | 1476 0a7c F999 sbic 63-0x20,1 |
||
1488 | 1477 0a7e 00C0 rjmp .L118 |
||
1489 | 1478 0a80 80E0 ldi r24,lo8(EEPromArray+80) |
||
1490 | 1479 0a82 90E0 ldi r25,hi8(EEPromArray+80) |
||
1491 | 1480 0a84 92BD out (65)+1-0x20,r25 |
||
1492 | 1481 0a86 81BD out 65-0x20,r24 |
||
1493 | 1482 /* #APP */ |
||
1494 | 1483 /* START EEPROM READ CRITICAL SECTION */ |
||
1495 | 1484 0a88 F89A sbi 31, 0 |
||
1496 | 1485 0a8a 80B5 in r24, 32 |
||
1497 | 1486 /* END EEPROM READ CRITICAL SECTION */ |
||
1498 | 1487 |
||
1499 | 1488 /* #NOAPP */ |
||
1500 | 1489 0a8c 8093 0000 sts EE_Parameter,r24 |
||
1501 | 1490 .L122: |
||
1502 | 1491 0a90 F999 sbic 63-0x20,1 |
||
1503 | 1492 0a92 00C0 rjmp .L122 |
||
1504 | 1493 0a94 80E0 ldi r24,lo8(EEPromArray+81) |
||
1505 | 1494 0a96 90E0 ldi r25,hi8(EEPromArray+81) |
||
1506 | 1495 0a98 92BD out (65)+1-0x20,r25 |
||
1507 | 1496 0a9a 81BD out 65-0x20,r24 |
||
1508 | 1497 /* #APP */ |
||
1509 | 1498 /* START EEPROM READ CRITICAL SECTION */ |
||
1510 | 1499 0a9c F89A sbi 31, 0 |
||
1511 | 1500 0a9e 80B5 in r24, 32 |
||
1512 | 1501 /* END EEPROM READ CRITICAL SECTION */ |
||
1513 | 1502 |
||
1514 | 1503 /* #NOAPP */ |
||
1515 | 1504 0aa0 8093 0000 sts EE_Parameter+1,r24 |
||
1516 | 1505 .L126: |
||
1517 | 1506 0aa4 F999 sbic 63-0x20,1 |
||
1518 | 1507 0aa6 00C0 rjmp .L126 |
||
1519 | 1508 0aa8 80E0 ldi r24,lo8(EEPromArray+82) |
||
1520 | 1509 0aaa 90E0 ldi r25,hi8(EEPromArray+82) |
||
1521 | 1510 0aac 92BD out (65)+1-0x20,r25 |
||
1522 | 1511 0aae 81BD out 65-0x20,r24 |
||
1523 | 1512 /* #APP */ |
||
1524 | 1513 /* START EEPROM READ CRITICAL SECTION */ |
||
1525 | 1514 0ab0 F89A sbi 31, 0 |
||
1526 | 1515 0ab2 80B5 in r24, 32 |
||
1527 | 1516 /* END EEPROM READ CRITICAL SECTION */ |
||
1528 | 1517 |
||
1529 | 1518 /* #NOAPP */ |
||
1530 | 1519 0ab4 8093 0000 sts EE_Parameter+2,r24 |
||
1531 | 1520 .L130: |
||
1532 | 1521 0ab8 F999 sbic 63-0x20,1 |
||
1533 | 1522 0aba 00C0 rjmp .L130 |
||
1534 | 1523 0abc 80E0 ldi r24,lo8(EEPromArray+83) |
||
1535 | 1524 0abe 90E0 ldi r25,hi8(EEPromArray+83) |
||
1536 | 1525 0ac0 92BD out (65)+1-0x20,r25 |
||
1537 | 1526 0ac2 81BD out 65-0x20,r24 |
||
1538 | 1527 /* #APP */ |
||
1539 | 1528 /* START EEPROM READ CRITICAL SECTION */ |
||
1540 | 1529 0ac4 F89A sbi 31, 0 |
||
1541 | 1530 0ac6 80B5 in r24, 32 |
||
1542 | 1531 /* END EEPROM READ CRITICAL SECTION */ |
||
1543 | 1532 |
||
1544 | 1533 /* #NOAPP */ |
||
1545 | 1534 0ac8 8093 0000 sts EE_Parameter+3,r24 |
||
1546 | 1535 .L134: |
||
1547 | 1536 0acc F999 sbic 63-0x20,1 |
||
1548 | 1537 0ace 00C0 rjmp .L134 |
||
1549 | 1538 0ad0 80E0 ldi r24,lo8(EEPromArray+84) |
||
1550 | 1539 0ad2 90E0 ldi r25,hi8(EEPromArray+84) |
||
1551 | 1540 0ad4 92BD out (65)+1-0x20,r25 |
||
1552 | 1541 0ad6 81BD out 65-0x20,r24 |
||
1553 | 1542 /* #APP */ |
||
1554 | 1543 /* START EEPROM READ CRITICAL SECTION */ |
||
1555 | 1544 0ad8 F89A sbi 31, 0 |
||
1556 | 1545 0ada 80B5 in r24, 32 |
||
1557 | 1546 /* END EEPROM READ CRITICAL SECTION */ |
||
1558 | 1547 |
||
1559 | 1548 /* #NOAPP */ |
||
1560 | 1549 0adc 8093 0000 sts EE_Parameter+4,r24 |
||
1561 | 1550 .L138: |
||
1562 | 1551 0ae0 F999 sbic 63-0x20,1 |
||
1563 | 1552 0ae2 00C0 rjmp .L138 |
||
1564 | 1553 0ae4 80E0 ldi r24,lo8(EEPromArray+85) |
||
1565 | 1554 0ae6 90E0 ldi r25,hi8(EEPromArray+85) |
||
1566 | 1555 0ae8 92BD out (65)+1-0x20,r25 |
||
1567 | 1556 0aea 81BD out 65-0x20,r24 |
||
1568 | 1557 /* #APP */ |
||
1569 | 1558 /* START EEPROM READ CRITICAL SECTION */ |
||
1570 | 1559 0aec F89A sbi 31, 0 |
||
1571 | 1560 0aee 80B5 in r24, 32 |
||
1572 | 1561 /* END EEPROM READ CRITICAL SECTION */ |
||
1573 | 1562 |
||
1574 | 1563 /* #NOAPP */ |
||
1575 | 1564 0af0 8093 0000 sts EE_Parameter+5,r24 |
||
1576 | 1565 .L142: |
||
1577 | 1566 0af4 F999 sbic 63-0x20,1 |
||
1578 | 1567 0af6 00C0 rjmp .L142 |
||
1579 | 1568 0af8 80E0 ldi r24,lo8(EEPromArray+86) |
||
1580 | 1569 0afa 90E0 ldi r25,hi8(EEPromArray+86) |
||
1581 | 1570 0afc 92BD out (65)+1-0x20,r25 |
||
1582 | 1571 0afe 81BD out 65-0x20,r24 |
||
1583 | 1572 /* #APP */ |
||
1584 | 1573 /* START EEPROM READ CRITICAL SECTION */ |
||
1585 | 1574 0b00 F89A sbi 31, 0 |
||
1586 | 1575 0b02 80B5 in r24, 32 |
||
1587 | 1576 /* END EEPROM READ CRITICAL SECTION */ |
||
1588 | 1577 |
||
1589 | 1578 /* #NOAPP */ |
||
1590 | 1579 0b04 8093 0000 sts EE_Parameter+6,r24 |
||
1591 | 1580 .L146: |
||
1592 | 1581 0b08 F999 sbic 63-0x20,1 |
||
1593 | 1582 0b0a 00C0 rjmp .L146 |
||
1594 | 1583 0b0c 80E0 ldi r24,lo8(EEPromArray+87) |
||
1595 | 1584 0b0e 90E0 ldi r25,hi8(EEPromArray+87) |
||
1596 | 1585 0b10 92BD out (65)+1-0x20,r25 |
||
1597 | 1586 0b12 81BD out 65-0x20,r24 |
||
1598 | 1587 /* #APP */ |
||
1599 | 1588 /* START EEPROM READ CRITICAL SECTION */ |
||
1600 | 1589 0b14 F89A sbi 31, 0 |
||
1601 | 1590 0b16 80B5 in r24, 32 |
||
1602 | 1591 /* END EEPROM READ CRITICAL SECTION */ |
||
1603 | 1592 |
||
1604 | 1593 /* #NOAPP */ |
||
1605 | 1594 0b18 8093 0000 sts EE_Parameter+7,r24 |
||
1606 | 1595 0b1c C130 cpi r28,lo8(1) |
||
1607 | 1596 0b1e 01F4 brne .L151 |
||
1608 | 1597 0b20 1F93 push r17 |
||
1609 | 1598 0b22 0F93 push r16 |
||
1610 | 1599 0b24 1F92 push __zero_reg__ |
||
1611 | 1600 0b26 0E94 0000 call _printf_P |
||
1612 | 1601 0b2a 0F90 pop __tmp_reg__ |
||
1613 | 1602 0b2c 0F90 pop __tmp_reg__ |
||
1614 | 1603 0b2e 0F90 pop __tmp_reg__ |
||
1615 | 1604 0b30 00C0 rjmp .L151 |
||
1616 | 1605 .L101: |
||
1617 | 1606 0b32 0E94 0000 call DefaultStickMapping |
||
1618 | 1607 .L151: |
||
1619 | 1608 0b36 45E6 ldi r20,lo8(101) |
||
1620 | 1609 0b38 60E0 ldi r22,lo8(EE_Parameter) |
||
1621 | 1610 0b3a 70E0 ldi r23,hi8(EE_Parameter) |
||
1622 | 1611 0b3c 8C2F mov r24,r28 |
||
1623 | 1612 0b3e 0E94 0000 call WriteParameterSet |
||
1624 | 1613 0b42 CF5F subi r28,lo8(-(1)) |
||
1625 | 1614 0b44 C630 cpi r28,lo8(6) |
||
1626 | 1615 0b46 00F4 brsh .+2 |
||
1627 | 1616 0b48 00C0 rjmp .L152 |
||
1628 | 1617 0b4a 83E0 ldi r24,lo8(3) |
||
1629 | 1618 0b4c 0E94 0000 call SetActiveParamSetNumber |
||
1630 | 1619 .L153: |
||
1631 | 1620 0b50 F999 sbic 63-0x20,1 |
||
1632 | 1621 0b52 00C0 rjmp .L153 |
||
1633 | 1622 0b54 1FBA out 63-0x20,__zero_reg__ |
||
1634 | 1623 0b56 80E0 ldi r24,lo8(EEPromArray+1) |
||
1635 | 1624 0b58 90E0 ldi r25,hi8(EEPromArray+1) |
||
1636 | 1625 0b5a 92BD out (65)+1-0x20,r25 |
||
1637 | 1626 0b5c 81BD out 65-0x20,r24 |
||
1638 | 1627 0b5e 80E5 ldi r24,lo8(80) |
||
1639 | 1628 0b60 80BD out 64-0x20,r24 |
||
1640 | 1629 /* #APP */ |
||
1641 | 1630 /* START EEPROM WRITE CRITICAL SECTION */ |
||
1642 | 1631 0b62 0FB6 in r0, 63 |
||
1643 | 1632 0b64 F894 cli |
||
1644 | 1633 0b66 FA9A sbi 31, 2 |
||
1645 | 1634 0b68 F99A sbi 31, 1 |
||
1646 | 1635 0b6a 0FBE out 63, r0 |
||
1647 | 1636 /* END EEPROM WRITE CRITICAL SECTION */ |
||
1648 | 1637 /* #NOAPP */ |
||
1649 | 1638 0b6c 00C0 rjmp .L157 |
||
1650 | 1639 .L358: |
||
1651 | 1640 0b6e 0E94 0000 call DefaultKonstanten2 |
||
1652 | 1641 0b72 00C0 rjmp .L102 |
||
1653 | 1642 .L373: |
||
1654 | 1643 0b74 0E94 0000 call DefaultKonstanten3 |
||
1655 | 1644 0b78 00C0 rjmp .L102 |
||
1656 | 1645 .L174: |
||
1657 | 1646 0b7a 5093 0000 sts (FlugMinuten)+1,r21 |
||
1658 | 1647 0b7e 4093 0000 sts FlugMinuten,r20 |
||
1659 | 1648 0b82 5093 0000 sts (FlugMinutenGesamt)+1,r21 |
||
1660 | 1649 0b86 4093 0000 sts FlugMinutenGesamt,r20 |
||
1661 | 1650 0b8a 9A01 movw r18,r20 |
||
1662 | 1651 0b8c 00C0 rjmp .L173 |
||
1663 | 1652 .L187: |
||
1664 | 1653 0b8e 80E0 ldi r24,lo8(__c.19) |
||
1665 | 1654 0b90 90E0 ldi r25,hi8(__c.19) |
||
1666 | 1655 0b92 00C0 rjmp .L359 |
||
1667 | 1656 .L367: |
||
1668 | 1657 0b94 80E0 ldi r24,lo8(__c.15) |
||
1669 | 1658 0b96 90E0 ldi r25,hi8(__c.15) |
||
1670 | 1659 0b98 9F93 push r25 |
||
1671 | 1660 0b9a 8F93 push r24 |
||
1672 | 1661 0b9c 1F92 push __zero_reg__ |
||
1673 | 1662 0b9e 0E94 0000 call _printf_P |
||
1674 | 1663 0ba2 88EE ldi r24,lo8(1000) |
||
1675 | 1664 0ba4 93E0 ldi r25,hi8(1000) |
||
1676 | 1665 0ba6 0E94 0000 call SetDelay |
||
1677 | 1666 0baa EC01 movw r28,r24 |
||
1678 | 1667 0bac 0E94 0000 call SucheLuftruckOffset |
||
1679 | 1668 0bb0 0F90 pop __tmp_reg__ |
||
1680 | 1669 0bb2 0F90 pop __tmp_reg__ |
||
1681 | 1670 0bb4 0F90 pop __tmp_reg__ |
||
1682 | 1671 .L181: |
||
1683 | 1672 0bb6 CE01 movw r24,r28 |
||
1684 | 1673 0bb8 0E94 0000 call CheckDelay |
||
1685 | 1674 0bbc 8823 tst r24 |
||
1686 | 1675 0bbe 01F0 breq .L181 |
||
1687 | 1676 0bc0 80E0 ldi r24,lo8(__c.16) |
||
1688 | 1677 0bc2 90E0 ldi r25,hi8(__c.16) |
||
1689 | 1678 0bc4 9F93 push r25 |
||
1690 | 1679 0bc6 8F93 push r24 |
||
1691 | 1680 0bc8 1F92 push __zero_reg__ |
||
1692 | 1681 0bca 0E94 0000 call _printf_P |
||
1693 | 1682 0bce 0F90 pop __tmp_reg__ |
||
1694 | 1683 0bd0 0F90 pop __tmp_reg__ |
||
1695 | 1684 0bd2 0F90 pop __tmp_reg__ |
||
1696 | 1685 0bd4 00C0 rjmp .L180 |
||
1697 | 1686 .L366: |
||
1698 | 1687 0bd6 80E0 ldi r24,lo8(__c.13) |
||
1699 | 1688 0bd8 90E0 ldi r25,hi8(__c.13) |
||
1700 | 1689 0bda 9F93 push r25 |
||
1701 | 1690 0bdc 8F93 push r24 |
||
1702 | 1691 0bde 1F92 push __zero_reg__ |
||
1703 | 1692 0be0 0E94 0000 call _printf_P |
||
1704 | 1693 0be4 0F90 pop __tmp_reg__ |
||
1705 | 1694 0be6 0F90 pop __tmp_reg__ |
||
1706 | 1695 0be8 0F90 pop __tmp_reg__ |
||
1707 | 1696 0bea 00C0 rjmp .L175 |
||
1708 | 1697 .L185: |
||
1709 | 1698 0bec 2898 cbi 37-0x20,0 |
||
1710 | 1699 0bee 00C0 rjmp .L186 |
||
1711 | 1700 /* epilogue: frame size=0 */ |
||
1712 | 1701 /* epilogue: noreturn */ |
||
1713 | 1702 /* epilogue end (size=0) */ |
||
1714 | 1703 /* function main size 1528 (1524) */ |
||
1715 | 1705 .comm Mixer,77,1 |
||
1716 | 1706 /* File "main.c": code 1759 = 0x06df (1745), prologues 7, epilogues 7 */ |
||
1717 | DEFINED SYMBOLS |
||
1718 | *ABS*:00000000 main.c |
||
1719 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:3 *ABS*:0000003f __SREG__ |
||
1720 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:4 *ABS*:0000003e __SP_H__ |
||
1721 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:5 *ABS*:0000003d __SP_L__ |
||
1722 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:6 *ABS*:00000000 __tmp_reg__ |
||
1723 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:7 *ABS*:00000001 __zero_reg__ |
||
1724 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:15 .bss:00000000 FlugMinutenGesamt |
||
1725 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:21 .bss:00000002 FlugMinuten |
||
1726 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:27 .data:00000000 BattLowVoltageWarning |
||
1727 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:32 .data:00000001 SendVersionToNavi |
||
1728 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:37 .data:00000002 PlatinenVersion |
||
1729 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:41 .text:00000000 eeprom_read_byte |
||
1730 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:63 .text:00000010 eeprom_write_byte |
||
1731 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:90 .data:00000003 stick.25 |
||
1732 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:95 .text:00000028 CalMk3Mag |
||
1733 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:155 .progmem.data:00000000 __c.21 |
||
1734 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:159 .progmem.data:00000008 __c.22 |
||
1735 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:163 .progmem.data:00000013 __c.23 |
||
1736 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:167 .progmem.data:0000001e __c.24 |
||
1737 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:172 .text:0000009a LipoDetection |
||
1738 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:306 .progmem.data:00000038 __c.0 |
||
1739 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:310 .progmem.data:0000005e __c.1 |
||
1740 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:314 .progmem.data:00000092 __c.2 |
||
1741 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:318 .progmem.data:000000a9 __c.3 |
||
1742 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:322 .progmem.data:000000cf __c.4 |
||
1743 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:326 .progmem.data:000000ed __c.5 |
||
1744 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:330 .progmem.data:0000010e __c.6 |
||
1745 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:334 .progmem.data:0000011f __c.7 |
||
1746 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:338 .progmem.data:00000123 __c.8 |
||
1747 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:342 .progmem.data:00000141 __c.9 |
||
1748 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:346 .progmem.data:00000167 __c.10 |
||
1749 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:350 .progmem.data:00000176 __c.11 |
||
1750 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:354 .progmem.data:000001ae __c.12 |
||
1751 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:358 .progmem.data:000001d1 __c.13 |
||
1752 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:362 .progmem.data:000001ef __c.14 |
||
1753 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:366 .progmem.data:00000207 __c.15 |
||
1754 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:370 .progmem.data:00000227 __c.16 |
||
1755 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:374 .progmem.data:0000022c __c.17 |
||
1756 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:378 .progmem.data:00000238 __c.18 |
||
1757 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:382 .progmem.data:00000244 __c.19 |
||
1758 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:386 .progmem.data:00000258 __c.20 |
||
1759 | C:\Users\Bernd\AppData\Local\Temp/ccjJE4Oj.s:395 .text:000001a8 main |
||
1760 | *COM*:0000004d Mixer |
||
1761 | |||
1762 | UNDEFINED SYMBOLS |
||
1763 | __do_copy_data |
||
1764 | __do_clear_bss |
||
1765 | EE_Parameter |
||
1766 | PPM_in |
||
1767 | WinkelOut |
||
1768 | beeptime |
||
1769 | Piep |
||
1770 | DebugOut |
||
1771 | _printf_P |
||
1772 | SetDelay |
||
1773 | UBat |
||
1774 | __udivmodqi4 |
||
1775 | CheckDelay |
||
1776 | __stack |
||
1777 | StickGier |
||
1778 | StickRoll |
||
1779 | StickNick |
||
1780 | GIER_GRAD_FAKTOR |
||
1781 | Timer_Init |
||
1782 | TIMER2_Init |
||
1783 | UART_Init |
||
1784 | rc_sum_init |
||
1785 | ADC_Init |
||
1786 | i2c_init |
||
1787 | ReadParameterSet |
||
1788 | EEPromArray |
||
1789 | RequiredMotors |
||
1790 | __eerd_block |
||
1791 | __eewr_block |
||
1792 | motorread |
||
1793 | UpdateMotor |
||
1794 | SendMotorData |
||
1795 | MotorPresent |
||
1796 | ServoActive |
||
1797 | MotorError |
||
1798 | GetActiveParamSetNumber |
||
1799 | SetNeutral |
||
1800 | ExternControl |
||
1801 | LcdClear |
||
1802 | I2CTimeout |
||
1803 | AdReady |
||
1804 | SenderOkay |
||
1805 | MissingMotor |
||
1806 | BeepMuster |
||
1807 | MotorenEin |
||
1808 | DatenUebertragung |
||
1809 | BearbeiteRxDaten |
||
1810 | PcZugriff |
||
1811 | MikroKopterFlags |
||
1812 | SendSPI |
||
1813 | LED_Update |
||
1814 | MotorRegler |
||
1815 | ExternStickNick |
||
1816 | ExternStickRoll |
||
1817 | ExternStickGier |
||
1818 | i2c_reset |
||
1819 | DefaultKonstanten1 |
||
1820 | DefaultStickMapping |
||
1821 | WriteParameterSet |
||
1822 | SetActiveParamSetNumber |
||
1823 | DefaultKonstanten2 |
||
1824 | DefaultKonstanten3 |
||
1825 | SucheLuftruckOffset |