Rev 1755 | Details | Compare with Previous | Last modification | View Log | RSS feed
Rev | Author | Line No. | Line |
---|---|---|---|
1755 | - | 1 | 1 .file "main.c" |
1789 | - | 2 | 2 __SREG__ = 0x3f |
3 | 3 __SP_H__ = 0x3e |
||
4 | 4 __SP_L__ = 0x3d |
||
5 | 5 __CCP__ = 0x34 |
||
1755 | - | 6 | 6 __tmp_reg__ = 0 |
7 | 7 __zero_reg__ = 1 |
||
1789 | - | 8 | 8 .text |
9 | 9 .global LipoDetection |
||
10 | 11 LipoDetection: |
||
11 | 12 0000 1F93 push r17 |
||
12 | 13 0002 CF93 push r28 |
||
13 | 14 0004 DF93 push r29 |
||
14 | 15 /* prologue: function */ |
||
15 | 16 /* frame size = 0 */ |
||
16 | 17 0006 182F mov r17,r24 |
||
17 | 18 0008 8823 tst r24 |
||
18 | 19 000a 01F0 breq .L2 |
||
19 | 20 000c 00D0 rcall . |
||
20 | 21 000e 00D0 rcall . |
||
21 | 22 0010 80E0 ldi r24,lo8(gs(uart_putchar)) |
||
22 | 23 0012 90E0 ldi r25,hi8(gs(uart_putchar)) |
||
23 | 24 0014 ADB7 in r26,__SP_L__ |
||
24 | 25 0016 BEB7 in r27,__SP_H__ |
||
25 | 26 0018 1296 adiw r26,1+1 |
||
26 | 27 001a 9C93 st X,r25 |
||
27 | 28 001c 8E93 st -X,r24 |
||
28 | 29 001e 1197 sbiw r26,1 |
||
29 | 30 0020 80E0 ldi r24,lo8(__c.2236) |
||
30 | 31 0022 90E0 ldi r25,hi8(__c.2236) |
||
31 | 32 0024 1496 adiw r26,3+1 |
||
32 | 33 0026 9C93 st X,r25 |
||
33 | 34 0028 8E93 st -X,r24 |
||
34 | 35 002a 1397 sbiw r26,3 |
||
35 | 36 002c E091 0000 lds r30,_printf_P |
||
36 | 37 0030 F091 0000 lds r31,(_printf_P)+1 |
||
37 | 38 0034 0995 icall |
||
38 | 39 0036 0F90 pop __tmp_reg__ |
||
39 | 40 0038 0F90 pop __tmp_reg__ |
||
40 | 41 003a 0F90 pop __tmp_reg__ |
||
41 | 42 003c 0F90 pop __tmp_reg__ |
||
42 | 43 .L2: |
||
43 | 44 003e 8091 0000 lds r24,EE_Parameter+36 |
||
44 | 45 0042 8233 cpi r24,lo8(50) |
||
45 | 46 0044 00F0 brlo .+2 |
||
46 | 47 0046 00C0 rjmp .L3 |
||
47 | 48 0048 84EF ldi r24,lo8(500) |
||
48 | 49 004a 91E0 ldi r25,hi8(500) |
||
49 | 50 004c 0E94 0000 call SetDelay |
||
50 | 51 0050 EC01 movw r28,r24 |
||
51 | 52 0052 1123 tst r17 |
||
52 | 53 0054 01F0 breq .L4 |
||
53 | 54 .L11: |
||
54 | 55 0056 CE01 movw r24,r28 |
||
55 | 56 0058 0E94 0000 call CheckDelay |
||
56 | 57 005c 8823 tst r24 |
||
57 | 58 005e 01F0 breq .L11 |
||
58 | 59 .L4: |
||
59 | 60 0060 C2E0 ldi r28,lo8(2) |
||
60 | 61 0062 D0E0 ldi r29,hi8(2) |
||
61 | 62 0064 26E5 ldi r18,lo8(86) |
||
62 | 63 0066 30E0 ldi r19,hi8(86) |
||
63 | 64 .L7: |
||
64 | 65 0068 8091 0000 lds r24,UBat |
||
65 | 66 006c 9091 0000 lds r25,(UBat)+1 |
||
66 | 67 0070 8217 cp r24,r18 |
||
67 | 68 0072 9307 cpc r25,r19 |
||
68 | 69 0074 00F0 brlo .L6 |
||
69 | 70 0076 2196 adiw r28,1 |
||
70 | 71 0078 255D subi r18,lo8(-(43)) |
||
71 | 72 007a 3F4F sbci r19,hi8(-(43)) |
||
72 | 73 007c C730 cpi r28,7 |
||
73 | 74 007e D105 cpc r29,__zero_reg__ |
||
74 | 75 0080 01F4 brne .L7 |
||
75 | 76 .L6: |
||
76 | 77 0082 8091 0000 lds r24,EE_Parameter+36 |
||
77 | 78 0086 90E0 ldi r25,lo8(0) |
||
78 | 79 0088 FC01 movw r30,r24 |
||
79 | 80 008a CE9F mul r28,r30 |
||
80 | 81 008c C001 movw r24,r0 |
||
81 | 82 008e CF9F mul r28,r31 |
||
82 | 83 0090 900D add r25,r0 |
||
83 | 84 0092 DE9F mul r29,r30 |
||
84 | 85 0094 900D add r25,r0 |
||
85 | 86 0096 1124 clr r1 |
||
86 | 87 0098 8093 0000 sts BattLowVoltageWarning,r24 |
||
87 | 88 009c 1123 tst r17 |
||
88 | 89 009e 01F4 brne .+2 |
||
89 | 90 00a0 00C0 rjmp .L10 |
||
90 | 91 00a2 8C2F mov r24,r28 |
||
91 | 92 00a4 68EC ldi r22,lo8(200) |
||
92 | 93 00a6 70E0 ldi r23,hi8(200) |
||
93 | 94 00a8 0E94 0000 call Piep |
||
94 | 95 00ac 00D0 rcall . |
||
95 | 96 00ae 00D0 rcall . |
||
96 | 97 00b0 00D0 rcall . |
||
97 | 98 00b2 EDB7 in r30,__SP_L__ |
||
98 | 99 00b4 FEB7 in r31,__SP_H__ |
||
99 | 100 00b6 3196 adiw r30,1 |
||
100 | 101 00b8 80E0 ldi r24,lo8(gs(uart_putchar)) |
||
101 | 102 00ba 90E0 ldi r25,hi8(gs(uart_putchar)) |
||
102 | 103 00bc ADB7 in r26,__SP_L__ |
||
103 | 104 00be BEB7 in r27,__SP_H__ |
||
104 | 105 00c0 1296 adiw r26,1+1 |
||
105 | 106 00c2 9C93 st X,r25 |
||
106 | 107 00c4 8E93 st -X,r24 |
||
107 | 108 00c6 1197 sbiw r26,1 |
||
108 | 109 00c8 80E0 ldi r24,lo8(__c.2244) |
||
109 | 110 00ca 90E0 ldi r25,hi8(__c.2244) |
||
110 | 111 00cc 9383 std Z+3,r25 |
||
111 | 112 00ce 8283 std Z+2,r24 |
||
112 | 113 00d0 D583 std Z+5,r29 |
||
113 | 114 00d2 C483 std Z+4,r28 |
||
114 | 115 00d4 E091 0000 lds r30,_printf_P |
||
115 | 116 00d8 F091 0000 lds r31,(_printf_P)+1 |
||
116 | 117 00dc 0995 icall |
||
117 | 118 00de EDB7 in r30,__SP_L__ |
||
118 | 119 00e0 FEB7 in r31,__SP_H__ |
||
119 | 120 00e2 3696 adiw r30,6 |
||
120 | 121 00e4 EDBF out __SP_L__,r30 |
||
121 | 122 00e6 00C0 rjmp .L9 |
||
122 | 123 .L3: |
||
123 | 124 00e8 8093 0000 sts BattLowVoltageWarning,r24 |
||
124 | 125 00ec 1123 tst r17 |
||
125 | 126 00ee 01F0 breq .L10 |
||
126 | 127 .L9: |
||
127 | 128 00f0 2091 0000 lds r18,BattLowVoltageWarning |
||
128 | 129 00f4 8DB7 in r24,__SP_L__ |
||
129 | 130 00f6 9EB7 in r25,__SP_H__ |
||
130 | 131 00f8 0897 sbiw r24,8 |
||
131 | 132 00fa 8DBF out __SP_L__,r24 |
||
132 | 133 00fc EDB7 in r30,__SP_L__ |
||
133 | 134 00fe FEB7 in r31,__SP_H__ |
||
134 | 135 0100 3196 adiw r30,1 |
||
135 | 136 0102 80E0 ldi r24,lo8(gs(uart_putchar)) |
||
136 | 137 0104 90E0 ldi r25,hi8(gs(uart_putchar)) |
||
137 | 138 0106 ADB7 in r26,__SP_L__ |
||
138 | 139 0108 BEB7 in r27,__SP_H__ |
||
139 | 140 010a 1296 adiw r26,1+1 |
||
140 | 141 010c 9C93 st X,r25 |
||
141 | 142 010e 8E93 st -X,r24 |
||
142 | 143 0110 1197 sbiw r26,1 |
||
143 | 144 0112 80E0 ldi r24,lo8(__c.2246) |
||
144 | 145 0114 90E0 ldi r25,hi8(__c.2246) |
||
145 | 146 0116 9383 std Z+3,r25 |
||
146 | 147 0118 8283 std Z+2,r24 |
||
147 | 148 011a 822F mov r24,r18 |
||
148 | 149 011c 6AE0 ldi r22,lo8(10) |
||
149 | 150 011e 0E94 0000 call __udivmodqi4 |
||
150 | 151 0122 8483 std Z+4,r24 |
||
151 | 152 0124 1582 std Z+5,__zero_reg__ |
||
152 | 153 0126 822F mov r24,r18 |
||
153 | 154 0128 0E94 0000 call __udivmodqi4 |
||
154 | 155 012c 9683 std Z+6,r25 |
||
155 | 156 012e 1782 std Z+7,__zero_reg__ |
||
156 | 157 0130 E091 0000 lds r30,_printf_P |
||
157 | 158 0134 F091 0000 lds r31,(_printf_P)+1 |
||
158 | 159 0138 0995 icall |
||
159 | 160 013a EDB7 in r30,__SP_L__ |
||
160 | 161 013c FEB7 in r31,__SP_H__ |
||
161 | 162 013e 3896 adiw r30,8 |
||
162 | 163 0140 EDBF out __SP_L__,r30 |
||
163 | 164 .L10: |
||
164 | 165 /* epilogue start */ |
||
165 | 166 0142 DF91 pop r29 |
||
166 | 167 0144 CF91 pop r28 |
||
167 | 168 0146 1F91 pop r17 |
||
168 | 169 0148 0895 ret |
||
169 | 171 .global CalMk3Mag |
||
170 | 173 CalMk3Mag: |
||
171 | 174 /* prologue: function */ |
||
172 | 175 /* frame size = 0 */ |
||
173 | 176 014a 8091 0000 lds r24,EE_Parameter+1 |
||
174 | 177 014e A82F mov r26,r24 |
||
175 | 178 0150 B0E0 ldi r27,lo8(0) |
||
176 | 179 0152 FD01 movw r30,r26 |
||
177 | 180 0154 EE0F lsl r30 |
||
178 | 181 0156 FF1F rol r31 |
||
179 | 182 0158 E050 subi r30,lo8(-(PPM_in)) |
||
180 | 183 015a F040 sbci r31,hi8(-(PPM_in)) |
||
181 | 184 015c 8081 ld r24,Z |
||
182 | 185 015e 9181 ldd r25,Z+1 |
||
183 | 186 0160 8D5E subi r24,lo8(-19) |
||
184 | 187 0162 9F4F sbci r25,hi8(-19) |
||
185 | 188 0164 04F0 brlt .L15 |
||
186 | 189 0166 1092 0000 sts stick.2222,__zero_reg__ |
||
187 | 190 .L15: |
||
188 | 191 016a AA0F lsl r26 |
||
189 | 192 016c BB1F rol r27 |
||
190 | 193 016e A050 subi r26,lo8(-(PPM_in)) |
||
191 | 194 0170 B040 sbci r27,hi8(-(PPM_in)) |
||
192 | 195 0172 8D91 ld r24,X+ |
||
193 | 196 0174 9C91 ld r25,X |
||
194 | 197 0176 8A5B subi r24,lo8(-70) |
||
195 | 198 0178 9F4F sbci r25,hi8(-70) |
||
196 | 199 017a 04F4 brge .L16 |
||
197 | 200 017c 8091 0000 lds r24,stick.2222 |
||
198 | 201 0180 8823 tst r24 |
||
199 | 202 0182 01F4 brne .L16 |
||
200 | 203 0184 81E0 ldi r24,lo8(1) |
||
201 | 204 0186 8093 0000 sts stick.2222,r24 |
||
202 | 205 018a 8091 0000 lds r24,WinkelOut+6 |
||
203 | 206 018e 8F5F subi r24,lo8(-(1)) |
||
204 | 207 0190 8093 0000 sts WinkelOut+6,r24 |
||
205 | 208 0194 8530 cpi r24,lo8(5) |
||
206 | 209 0196 00F0 brlo .L17 |
||
207 | 210 0198 88EE ldi r24,lo8(1000) |
||
208 | 211 019a 93E0 ldi r25,hi8(1000) |
||
209 | 212 019c 9093 0000 sts (beeptime)+1,r25 |
||
210 | 213 01a0 8093 0000 sts beeptime,r24 |
||
211 | 214 01a4 00C0 rjmp .L16 |
||
212 | 215 .L17: |
||
213 | 216 01a6 66E9 ldi r22,lo8(150) |
||
214 | 217 01a8 70E0 ldi r23,hi8(150) |
||
215 | 218 01aa 0E94 0000 call Piep |
||
216 | 219 .L16: |
||
217 | 220 01ae 8091 0000 lds r24,WinkelOut+6 |
||
218 | 221 01b2 8093 0000 sts DebugOut+40,r24 |
||
219 | 222 01b6 1092 0000 sts DebugOut+41,__zero_reg__ |
||
220 | 223 /* epilogue start */ |
||
221 | 224 01ba 0895 ret |
||
222 | 226 .global main |
||
223 | 228 main: |
||
224 | 229 01bc A0E0 ldi r26,lo8(0) |
||
225 | 230 01be B0E0 ldi r27,hi8(0) |
||
226 | 231 01c0 E0E0 ldi r30,lo8(gs(1f)) |
||
227 | 232 01c2 F0E0 ldi r31,hi8(gs(1f)) |
||
228 | 233 01c4 0C94 0000 jmp __prologue_saves__+((18 - 18) * 2) |
||
229 | 234 1: |
||
230 | 235 /* prologue: function */ |
||
231 | 236 /* frame size = 0 */ |
||
232 | 237 01c8 14B8 out 36-32,__zero_reg__ |
||
233 | 238 01ca 15B8 out 37-32,__zero_reg__ |
||
234 | 239 01cc 189B sbis 35-32,0 |
||
235 | 240 01ce 00C0 rjmp .L20 |
||
236 | 241 01d0 199B sbis 35-32,1 |
||
237 | 242 01d2 00C0 rjmp .L21 |
||
238 | 243 01d4 8DE0 ldi r24,lo8(13) |
||
239 | 244 01d6 00C0 rjmp .L97 |
||
240 | 245 .L21: |
||
241 | 246 01d8 8BE0 ldi r24,lo8(11) |
||
242 | 247 01da 00C0 rjmp .L97 |
||
243 | 248 .L20: |
||
244 | 249 01dc 199B sbis 35-32,1 |
||
245 | 250 01de 00C0 rjmp .L23 |
||
246 | 251 01e0 84E1 ldi r24,lo8(20) |
||
247 | 252 01e2 00C0 rjmp .L97 |
||
248 | 253 .L23: |
||
249 | 254 01e4 8AE0 ldi r24,lo8(10) |
||
250 | 255 .L97: |
||
251 | 256 01e6 8093 0000 sts PlatinenVersion,r24 |
||
252 | 257 01ea 81E8 ldi r24,lo8(-127) |
||
253 | 258 01ec 87B9 out 39-32,r24 |
||
254 | 259 01ee 3E9A sbi 39-32,6 |
||
255 | 260 01f0 8FEF ldi r24,lo8(-1) |
||
256 | 261 01f2 88B9 out 40-32,r24 |
||
257 | 262 01f4 8BE1 ldi r24,lo8(27) |
||
258 | 263 01f6 84B9 out 36-32,r24 |
||
259 | 264 01f8 81E0 ldi r24,lo8(1) |
||
260 | 265 01fa 85B9 out 37-32,r24 |
||
261 | 266 01fc 8EE3 ldi r24,lo8(62) |
||
262 | 267 01fe 8AB9 out 42-32,r24 |
||
263 | 268 0200 87E4 ldi r24,lo8(71) |
||
264 | 269 0202 8BB9 out 43-32,r24 |
||
265 | 270 0204 469A sbi 40-32,6 |
||
266 | 271 0206 84B7 in r24,84-32 |
||
267 | 272 0208 877F andi r24,lo8(-9) |
||
268 | 273 020a 84BF out 84-32,r24 |
||
269 | 274 020c 8091 6000 lds r24,96 |
||
270 | 275 0210 8861 ori r24,lo8(24) |
||
271 | 276 0212 8093 6000 sts 96,r24 |
||
272 | 277 0216 1092 6000 sts 96,__zero_reg__ |
||
273 | 278 021a 84EC ldi r24,lo8(2500) |
||
274 | 279 021c 99E0 ldi r25,hi8(2500) |
||
275 | 280 021e 9093 0000 sts (beeptime)+1,r25 |
||
276 | 281 0222 8093 0000 sts beeptime,r24 |
||
277 | 282 0226 1092 0000 sts (StickGier)+1,__zero_reg__ |
||
278 | 283 022a 1092 0000 sts StickGier,__zero_reg__ |
||
279 | 284 022e 1092 0000 sts (PPM_in+4)+1,__zero_reg__ |
||
280 | 285 0232 1092 0000 sts PPM_in+4,__zero_reg__ |
||
281 | 286 0236 1092 0000 sts (StickRoll)+1,__zero_reg__ |
||
282 | 287 023a 1092 0000 sts StickRoll,__zero_reg__ |
||
283 | 288 023e 1092 0000 sts (StickNick)+1,__zero_reg__ |
||
284 | 289 0242 1092 0000 sts StickNick,__zero_reg__ |
||
285 | 290 0246 8091 0000 lds r24,PlatinenVersion |
||
286 | 291 024a 8431 cpi r24,lo8(20) |
||
287 | 292 024c 00F0 brlo .L24 |
||
288 | 293 024e 84EC ldi r24,lo8(1220) |
||
289 | 294 0250 94E0 ldi r25,hi8(1220) |
||
290 | 295 0252 A0E0 ldi r26,hlo8(1220) |
||
291 | 296 0254 B0E0 ldi r27,hhi8(1220) |
||
292 | 297 0256 00C0 rjmp .L98 |
||
293 | 298 .L24: |
||
294 | 299 0258 8BE0 ldi r24,lo8(1291) |
||
295 | 300 025a 95E0 ldi r25,hi8(1291) |
||
296 | 301 025c A0E0 ldi r26,hlo8(1291) |
||
297 | 302 025e B0E0 ldi r27,hhi8(1291) |
||
298 | 303 .L98: |
||
299 | 304 0260 8093 0000 sts GIER_GRAD_FAKTOR,r24 |
||
300 | 305 0264 9093 0000 sts (GIER_GRAD_FAKTOR)+1,r25 |
||
301 | 306 0268 A093 0000 sts (GIER_GRAD_FAKTOR)+2,r26 |
||
302 | 307 026c B093 0000 sts (GIER_GRAD_FAKTOR)+3,r27 |
||
303 | 308 0270 8091 0000 lds r24,PlatinenVersion |
||
304 | 309 0274 8A30 cpi r24,lo8(10) |
||
305 | 310 0276 01F0 breq .L26 |
||
306 | 311 0278 8431 cpi r24,lo8(20) |
||
307 | 312 027a 00F0 brlo .L27 |
||
308 | 313 .L26: |
||
309 | 314 027c 2898 cbi 37-32,0 |
||
310 | 315 027e 00C0 rjmp .L28 |
||
311 | 316 .L27: |
||
312 | 317 0280 289A sbi 37-32,0 |
||
313 | 318 .L28: |
||
314 | 319 0282 0E94 0000 call Timer_Init |
||
315 | 320 0286 0E94 0000 call TIMER2_Init |
||
316 | 321 028a 0E94 0000 call UART_Init |
||
317 | 322 028e 0E94 0000 call rc_sum_init |
||
318 | 323 0292 0E94 0000 call ADC_Init |
||
319 | 324 0296 0E94 0000 call I2C_Init |
||
320 | 325 029a 0E94 0000 call SPI_MasterInit |
||
321 | 326 029e 0E94 0000 call Capacity_Init |
||
322 | 327 02a2 0E94 0000 call LIBFC_Init |
||
323 | 328 02a6 8091 0000 lds r24,PlatinenVersion |
||
324 | 329 02aa 8C30 cpi r24,lo8(12) |
||
325 | 330 02ac 00F4 brsh .L29 |
||
326 | 331 02ae 299A sbi 37-32,1 |
||
327 | 332 02b0 00C0 rjmp .L30 |
||
328 | 333 .L29: |
||
329 | 334 02b2 2998 cbi 37-32,1 |
||
330 | 335 .L30: |
||
331 | 336 /* #APP */ |
||
332 | 337 ; 164 "main.c" 1 |
||
333 | 338 02b4 7894 sei |
||
334 | 339 ; 0 "" 2 |
||
335 | 340 /* #NOAPP */ |
||
336 | 341 02b6 0E94 0000 call ParamSet_Init |
||
337 | 342 02ba 8091 0000 lds r24,BLFlags |
||
338 | 343 02be 8260 ori r24,lo8(2) |
||
339 | 344 02c0 8093 0000 sts BLFlags,r24 |
||
340 | 345 02c4 1092 0000 sts motor_read,__zero_reg__ |
||
341 | 346 02c8 0E94 0000 call SendMotorData |
||
342 | 347 02cc 84EF ldi r24,lo8(500) |
||
343 | 348 02ce 91E0 ldi r25,hi8(500) |
||
344 | 349 02d0 0E94 0000 call SetDelay |
||
345 | 350 02d4 8C01 movw r16,r24 |
||
346 | 351 .L32: |
||
347 | 352 02d6 8091 0000 lds r24,BLFlags |
||
348 | 353 02da 80FD sbrc r24,0 |
||
349 | 354 02dc 00C0 rjmp .L31 |
||
350 | 355 02de C801 movw r24,r16 |
||
351 | 356 02e0 0E94 0000 call CheckDelay |
||
352 | 357 02e4 8823 tst r24 |
||
353 | 358 02e6 01F0 breq .L32 |
||
354 | 359 .L31: |
||
355 | 360 02e8 00D0 rcall . |
||
356 | 361 02ea 00D0 rcall . |
||
357 | 362 02ec 00E0 ldi r16,lo8(gs(uart_putchar)) |
||
358 | 363 02ee 10E0 ldi r17,hi8(gs(uart_putchar)) |
||
359 | 364 02f0 ADB7 in r26,__SP_L__ |
||
360 | 365 02f2 BEB7 in r27,__SP_H__ |
||
361 | 366 02f4 1296 adiw r26,1+1 |
||
362 | 367 02f6 1C93 st X,r17 |
||
363 | 368 02f8 0E93 st -X,r16 |
||
364 | 369 02fa 1197 sbiw r26,1 |
||
365 | 370 02fc 80E0 ldi r24,lo8(__c.2277) |
||
366 | 371 02fe 90E0 ldi r25,hi8(__c.2277) |
||
367 | 372 0300 1496 adiw r26,3+1 |
||
368 | 373 0302 9C93 st X,r25 |
||
369 | 374 0304 8E93 st -X,r24 |
||
370 | 375 0306 1397 sbiw r26,3 |
||
371 | 376 0308 E091 0000 lds r30,_printf_P |
||
372 | 377 030c F091 0000 lds r31,(_printf_P)+1 |
||
373 | 378 0310 0995 icall |
||
374 | 379 0312 0F90 pop __tmp_reg__ |
||
375 | 380 0314 0F90 pop __tmp_reg__ |
||
376 | 381 0316 0F90 pop __tmp_reg__ |
||
377 | 382 0318 0F90 pop __tmp_reg__ |
||
378 | 383 031a 80EA ldi r24,lo8(4000) |
||
379 | 384 031c 9FE0 ldi r25,hi8(4000) |
||
380 | 385 031e 0E94 0000 call SetDelay |
||
381 | 386 0322 4C01 movw r8,r24 |
||
382 | 387 0324 B0E0 ldi r27,lo8(Motor+3) |
||
383 | 388 0326 CB2E mov r12,r27 |
||
384 | 389 0328 B0E0 ldi r27,hi8(Motor+3) |
||
385 | 390 032a DB2E mov r13,r27 |
||
386 | 391 032c A0E0 ldi r26,lo8(Mixer+13) |
||
387 | 392 032e 6A2E mov r6,r26 |
||
388 | 393 0330 A0E0 ldi r26,hi8(Mixer+13) |
||
389 | 394 0332 7A2E mov r7,r26 |
||
390 | 395 0334 7601 movw r14,r12 |
||
391 | 396 0336 5301 movw r10,r6 |
||
392 | 397 0338 C1E0 ldi r28,lo8(1) |
||
393 | 398 033a D0E0 ldi r29,hi8(1) |
||
394 | 399 033c 2801 movw r4,r16 |
||
395 | 400 033e 00E0 ldi r16,lo8(__c.2288) |
||
396 | 401 0340 10E0 ldi r17,hi8(__c.2288) |
||
397 | 402 .L40: |
||
398 | 403 0342 0E94 0000 call SendMotorData |
||
399 | 404 .L34: |
||
400 | 405 0346 8091 0000 lds r24,BLFlags |
||
401 | 406 034a 80FD sbrc r24,0 |
||
402 | 407 034c 00C0 rjmp .L33 |
||
403 | 408 034e C401 movw r24,r8 |
||
404 | 409 0350 0E94 0000 call CheckDelay |
||
405 | 410 0354 8823 tst r24 |
||
406 | 411 0356 01F0 breq .L34 |
||
407 | 412 .L33: |
||
408 | 413 0358 F501 movw r30,r10 |
||
409 | 414 035a 8081 ld r24,Z |
||
410 | 415 035c 1816 cp __zero_reg__,r24 |
||
411 | 416 035e 04F0 brlt .L95 |
||
412 | 417 0360 00C0 rjmp .L36 |
||
413 | 418 .L38: |
||
414 | 419 0362 0E94 0000 call SendMotorData |
||
415 | 420 .L37: |
||
416 | 421 0366 8091 0000 lds r24,BLFlags |
||
417 | 422 036a 80FD sbrc r24,0 |
||
418 | 423 036c 00C0 rjmp .L95 |
||
419 | 424 036e C401 movw r24,r8 |
||
420 | 425 0370 0E94 0000 call CheckDelay |
||
421 | 426 0374 8823 tst r24 |
||
422 | 427 0376 01F0 breq .L37 |
||
423 | 428 .L95: |
||
424 | 429 0378 C401 movw r24,r8 |
||
425 | 430 037a 0E94 0000 call CheckDelay |
||
426 | 431 037e 8823 tst r24 |
||
427 | 432 0380 01F4 brne .L36 |
||
428 | 433 0382 D701 movw r26,r14 |
||
429 | 434 0384 8C91 ld r24,X |
||
430 | 435 0386 87FF sbrs r24,7 |
||
431 | 436 0388 00C0 rjmp .L38 |
||
432 | 437 .L36: |
||
433 | 438 038a F701 movw r30,r14 |
||
434 | 439 038c 8081 ld r24,Z |
||
435 | 440 038e 87FF sbrs r24,7 |
||
436 | 441 0390 00C0 rjmp .L39 |
||
437 | 442 0392 00D0 rcall . |
||
438 | 443 0394 00D0 rcall . |
||
439 | 444 0396 00D0 rcall . |
||
440 | 445 0398 EDB7 in r30,__SP_L__ |
||
441 | 446 039a FEB7 in r31,__SP_H__ |
||
442 | 447 039c 3196 adiw r30,1 |
||
443 | 448 039e ADB7 in r26,__SP_L__ |
||
444 | 449 03a0 BEB7 in r27,__SP_H__ |
||
445 | 450 03a2 1196 adiw r26,1 |
||
446 | 451 03a4 4C92 st X,r4 |
||
447 | 452 03a6 1197 sbiw r26,1 |
||
448 | 453 03a8 1296 adiw r26,2 |
||
449 | 454 03aa 5C92 st X,r5 |
||
450 | 455 03ac 1383 std Z+3,r17 |
||
451 | 456 03ae 0283 std Z+2,r16 |
||
452 | 457 03b0 D583 std Z+5,r29 |
||
453 | 458 03b2 C483 std Z+4,r28 |
||
454 | 459 03b4 E091 0000 lds r30,_printf_P |
||
455 | 460 03b8 F091 0000 lds r31,(_printf_P)+1 |
||
456 | 461 03bc 0995 icall |
||
457 | 462 03be 8091 0000 lds r24,FoundMotors |
||
458 | 463 03c2 8F5F subi r24,lo8(-(1)) |
||
459 | 464 03c4 8093 0000 sts FoundMotors,r24 |
||
460 | 465 03c8 EDB7 in r30,__SP_L__ |
||
461 | 466 03ca FEB7 in r31,__SP_H__ |
||
462 | 467 03cc 3696 adiw r30,6 |
||
463 | 468 03ce EDBF out __SP_L__,r30 |
||
464 | 469 .L39: |
||
465 | 470 03d0 2196 adiw r28,1 |
||
466 | 471 03d2 88E0 ldi r24,lo8(8) |
||
467 | 472 03d4 90E0 ldi r25,hi8(8) |
||
468 | 473 03d6 E80E add r14,r24 |
||
469 | 474 03d8 F91E adc r15,r25 |
||
470 | 475 03da A4E0 ldi r26,lo8(4) |
||
471 | 476 03dc B0E0 ldi r27,hi8(4) |
||
472 | 477 03de AA0E add r10,r26 |
||
473 | 478 03e0 BB1E adc r11,r27 |
||
474 | 479 03e2 CD30 cpi r28,13 |
||
475 | 480 03e4 D105 cpc r29,__zero_reg__ |
||
476 | 481 03e6 01F0 breq .+2 |
||
477 | 482 03e8 00C0 rjmp .L40 |
||
478 | 483 03ea 01E0 ldi r16,lo8(1) |
||
479 | 484 03ec 10E0 ldi r17,hi8(1) |
||
480 | 485 03ee F0E0 ldi r31,lo8(gs(uart_putchar)) |
||
481 | 486 03f0 EF2E mov r14,r31 |
||
482 | 487 03f2 F0E0 ldi r31,hi8(gs(uart_putchar)) |
||
483 | 488 03f4 FF2E mov r15,r31 |
||
484 | 489 03f6 C0E0 ldi r28,lo8(__c.2293) |
||
485 | 490 03f8 D0E0 ldi r29,hi8(__c.2293) |
||
486 | 491 03fa E2E0 ldi r30,lo8(2) |
||
487 | 492 03fc BE2E mov r11,r30 |
||
488 | 493 .L42: |
||
489 | 494 03fe F601 movw r30,r12 |
||
490 | 495 0400 8081 ld r24,Z |
||
491 | 496 0402 87FD sbrc r24,7 |
||
492 | 497 0404 00C0 rjmp .L41 |
||
493 | 498 0406 D301 movw r26,r6 |
||
494 | 499 0408 8C91 ld r24,X |
||
495 | 500 040a 1816 cp __zero_reg__,r24 |
||
496 | 501 040c 04F4 brge .L41 |
||
497 | 502 040e 00D0 rcall . |
||
498 | 503 0410 00D0 rcall . |
||
499 | 504 0412 00D0 rcall . |
||
500 | 505 0414 EDB7 in r30,__SP_L__ |
||
501 | 506 0416 FEB7 in r31,__SP_H__ |
||
502 | 507 0418 3196 adiw r30,1 |
||
503 | 508 041a ADB7 in r26,__SP_L__ |
||
504 | 509 041c BEB7 in r27,__SP_H__ |
||
505 | 510 041e 1296 adiw r26,1+1 |
||
506 | 511 0420 FC92 st X,r15 |
||
507 | 512 0422 EE92 st -X,r14 |
||
508 | 513 0424 1197 sbiw r26,1 |
||
509 | 514 0426 D383 std Z+3,r29 |
||
510 | 515 0428 C283 std Z+2,r28 |
||
511 | 516 042a 1583 std Z+5,r17 |
||
512 | 517 042c 0483 std Z+4,r16 |
||
513 | 518 042e E091 0000 lds r30,_printf_P |
||
514 | 519 0432 F091 0000 lds r31,(_printf_P)+1 |
||
515 | 520 0436 0995 icall |
||
516 | 521 0438 B092 0000 sts ServoActive,r11 |
||
517 | 522 043c EDB7 in r30,__SP_L__ |
||
518 | 523 043e FEB7 in r31,__SP_H__ |
||
519 | 524 0440 3696 adiw r30,6 |
||
520 | 525 0442 EDBF out __SP_L__,r30 |
||
521 | 526 .L41: |
||
522 | 527 0444 D601 movw r26,r12 |
||
523 | 528 0446 8C91 ld r24,X |
||
524 | 529 0448 8078 andi r24,lo8(-128) |
||
525 | 530 044a 8C93 st X,r24 |
||
526 | 531 044c 0F5F subi r16,lo8(-(1)) |
||
527 | 532 044e 1F4F sbci r17,hi8(-(1)) |
||
528 | 533 0450 E8E0 ldi r30,lo8(8) |
||
529 | 534 0452 F0E0 ldi r31,hi8(8) |
||
530 | 535 0454 CE0E add r12,r30 |
||
531 | 536 0456 DF1E adc r13,r31 |
||
532 | 537 0458 84E0 ldi r24,lo8(4) |
||
533 | 538 045a 90E0 ldi r25,hi8(4) |
||
534 | 539 045c 680E add r6,r24 |
||
535 | 540 045e 791E adc r7,r25 |
||
536 | 541 0460 0D30 cpi r16,13 |
||
537 | 542 0462 1105 cpc r17,__zero_reg__ |
||
538 | 543 0464 01F4 brne .L42 |
||
539 | 544 0466 00D0 rcall . |
||
540 | 545 0468 00D0 rcall . |
||
541 | 546 046a 80E0 ldi r24,lo8(gs(uart_putchar)) |
||
542 | 547 046c 90E0 ldi r25,hi8(gs(uart_putchar)) |
||
543 | 548 046e ADB7 in r26,__SP_L__ |
||
544 | 549 0470 BEB7 in r27,__SP_H__ |
||
545 | 550 0472 1296 adiw r26,1+1 |
||
546 | 551 0474 9C93 st X,r25 |
||
547 | 552 0476 8E93 st -X,r24 |
||
548 | 553 0478 1197 sbiw r26,1 |
||
549 | 554 047a 80E0 ldi r24,lo8(__c.2298) |
||
550 | 555 047c 90E0 ldi r25,hi8(__c.2298) |
||
551 | 556 047e 1496 adiw r26,3+1 |
||
552 | 557 0480 9C93 st X,r25 |
||
553 | 558 0482 8E93 st -X,r24 |
||
554 | 559 0484 1397 sbiw r26,3 |
||
555 | 560 0486 E091 0000 lds r30,_printf_P |
||
556 | 561 048a F091 0000 lds r31,(_printf_P)+1 |
||
557 | 562 048e 0995 icall |
||
558 | 563 0490 0F90 pop __tmp_reg__ |
||
559 | 564 0492 0F90 pop __tmp_reg__ |
||
560 | 565 0494 0F90 pop __tmp_reg__ |
||
561 | 566 0496 0F90 pop __tmp_reg__ |
||
562 | 567 0498 9091 0000 lds r25,RequiredMotors |
||
563 | 568 049c 8091 0000 lds r24,FoundMotors |
||
564 | 569 04a0 9817 cp r25,r24 |
||
565 | 570 04a2 00F4 brsh .L43 |
||
566 | 571 04a4 8091 0000 lds r24,VersionInfo+6 |
||
567 | 572 04a8 8061 ori r24,lo8(16) |
||
568 | 573 04aa 8093 0000 sts VersionInfo+6,r24 |
||
569 | 574 .L43: |
||
570 | 575 04ae 00D0 rcall . |
||
571 | 576 04b0 00D0 rcall . |
||
572 | 577 04b2 80E0 ldi r24,lo8(gs(uart_putchar)) |
||
573 | 578 04b4 90E0 ldi r25,hi8(gs(uart_putchar)) |
||
574 | 579 04b6 EDB7 in r30,__SP_L__ |
||
575 | 580 04b8 FEB7 in r31,__SP_H__ |
||
576 | 581 04ba 9283 std Z+2,r25 |
||
577 | 582 04bc 8183 std Z+1,r24 |
||
578 | 583 04be 80E0 ldi r24,lo8(__c.2300) |
||
579 | 584 04c0 90E0 ldi r25,hi8(__c.2300) |
||
580 | 585 04c2 9483 std Z+4,r25 |
||
581 | 586 04c4 8383 std Z+3,r24 |
||
582 | 587 04c6 E091 0000 lds r30,_printf_P |
||
583 | 588 04ca F091 0000 lds r31,(_printf_P)+1 |
||
584 | 589 04ce 0995 icall |
||
585 | 590 04d0 0F90 pop __tmp_reg__ |
||
586 | 591 04d2 0F90 pop __tmp_reg__ |
||
587 | 592 04d4 0F90 pop __tmp_reg__ |
||
588 | 593 04d6 0F90 pop __tmp_reg__ |
||
589 | 594 04d8 88EE ldi r24,lo8(1000) |
||
590 | 595 04da 93E0 ldi r25,hi8(1000) |
||
591 | 596 04dc 0E94 0000 call SetDelay |
||
592 | 597 04e0 8C01 movw r16,r24 |
||
593 | 598 04e2 0E94 0000 call SucheLuftruckOffset |
||
594 | 599 .L44: |
||
595 | 600 04e6 C801 movw r24,r16 |
||
596 | 601 04e8 0E94 0000 call CheckDelay |
||
597 | 602 04ec 8823 tst r24 |
||
598 | 603 04ee 01F0 breq .L44 |
||
599 | 604 04f0 00D0 rcall . |
||
600 | 605 04f2 00D0 rcall . |
||
601 | 606 04f4 80E0 ldi r24,lo8(gs(uart_putchar)) |
||
602 | 607 04f6 90E0 ldi r25,hi8(gs(uart_putchar)) |
||
603 | 608 04f8 ADB7 in r26,__SP_L__ |
||
604 | 609 04fa BEB7 in r27,__SP_H__ |
||
605 | 610 04fc 1296 adiw r26,1+1 |
||
606 | 611 04fe 9C93 st X,r25 |
||
607 | 612 0500 8E93 st -X,r24 |
||
608 | 613 0502 1197 sbiw r26,1 |
||
609 | 614 0504 80E0 ldi r24,lo8(__c.2305) |
||
610 | 615 0506 90E0 ldi r25,hi8(__c.2305) |
||
611 | 616 0508 1496 adiw r26,3+1 |
||
612 | 617 050a 9C93 st X,r25 |
||
613 | 618 050c 8E93 st -X,r24 |
||
614 | 619 050e 1397 sbiw r26,3 |
||
615 | 620 0510 E091 0000 lds r30,_printf_P |
||
616 | 621 0514 F091 0000 lds r31,(_printf_P)+1 |
||
617 | 622 0518 0995 icall |
||
618 | 623 051a 0F90 pop __tmp_reg__ |
||
619 | 624 051c 0F90 pop __tmp_reg__ |
||
620 | 625 051e 0F90 pop __tmp_reg__ |
||
621 | 626 0520 0F90 pop __tmp_reg__ |
||
622 | 627 0522 80E0 ldi r24,lo8(0) |
||
623 | 628 0524 0E94 0000 call SetNeutral |
||
624 | 629 0528 8091 0000 lds r24,PlatinenVersion |
||
625 | 630 052c 8A30 cpi r24,lo8(10) |
||
626 | 631 052e 01F0 breq .L45 |
||
627 | 632 0530 8431 cpi r24,lo8(20) |
||
628 | 633 0532 00F0 brlo .L46 |
||
629 | 634 .L45: |
||
630 | 635 0534 2898 cbi 37-32,0 |
||
631 | 636 0536 00C0 rjmp .L47 |
||
632 | 637 .L46: |
||
633 | 638 0538 289A sbi 37-32,0 |
||
634 | 639 .L47: |
||
635 | 640 053a 80ED ldi r24,lo8(2000) |
||
636 | 641 053c 97E0 ldi r25,hi8(2000) |
||
637 | 642 053e 9093 0000 sts (beeptime)+1,r25 |
||
638 | 643 0542 8093 0000 sts beeptime,r24 |
||
639 | 644 0546 85E5 ldi r24,lo8(85) |
||
640 | 645 0548 8093 0000 sts ExternControl,r24 |
||
641 | 646 054c 8EE0 ldi r24,lo8(14) |
||
642 | 647 054e 90E0 ldi r25,hi8(14) |
||
643 | 648 0550 0E94 0000 call GetParamByte |
||
644 | 649 0554 182F mov r17,r24 |
||
645 | 650 0556 8FE0 ldi r24,lo8(15) |
||
646 | 651 0558 90E0 ldi r25,hi8(15) |
||
647 | 652 055a 0E94 0000 call GetParamByte |
||
648 | 653 055e 312F mov r19,r17 |
||
649 | 654 0560 20E0 ldi r18,lo8(0) |
||
650 | 655 0562 280F add r18,r24 |
||
651 | 656 0564 311D adc r19,__zero_reg__ |
||
652 | 657 0566 3093 0000 sts (FlugMinuten)+1,r19 |
||
653 | 658 056a 2093 0000 sts FlugMinuten,r18 |
||
654 | 659 056e 8AE0 ldi r24,lo8(10) |
||
655 | 660 0570 90E0 ldi r25,hi8(10) |
||
656 | 661 0572 0E94 0000 call GetParamByte |
||
657 | 662 0576 182F mov r17,r24 |
||
658 | 663 0578 8BE0 ldi r24,lo8(11) |
||
659 | 664 057a 90E0 ldi r25,hi8(11) |
||
660 | 665 057c 0E94 0000 call GetParamByte |
||
661 | 666 0580 312F mov r19,r17 |
||
662 | 667 0582 20E0 ldi r18,lo8(0) |
||
663 | 668 0584 280F add r18,r24 |
||
664 | 669 0586 311D adc r19,__zero_reg__ |
||
665 | 670 0588 3093 0000 sts (FlugMinutenGesamt)+1,r19 |
||
666 | 671 058c 2093 0000 sts FlugMinutenGesamt,r18 |
||
667 | 672 0590 2F5F subi r18,lo8(-1) |
||
668 | 673 0592 3F4F sbci r19,hi8(-1) |
||
669 | 674 0594 01F0 breq .L48 |
||
670 | 675 0596 8091 0000 lds r24,FlugMinuten |
||
671 | 676 059a 9091 0000 lds r25,(FlugMinuten)+1 |
||
672 | 677 059e 8F5F subi r24,lo8(-1) |
||
673 | 678 05a0 9F4F sbci r25,hi8(-1) |
||
674 | 679 05a2 01F4 brne .L49 |
||
675 | 680 .L48: |
||
676 | 681 05a4 1092 0000 sts (FlugMinuten)+1,__zero_reg__ |
||
677 | 682 05a8 1092 0000 sts FlugMinuten,__zero_reg__ |
||
678 | 683 05ac 1092 0000 sts (FlugMinutenGesamt)+1,__zero_reg__ |
||
679 | 684 05b0 1092 0000 sts FlugMinutenGesamt,__zero_reg__ |
||
680 | 685 .L49: |
||
681 | 686 05b4 8DB7 in r24,__SP_L__ |
||
682 | 687 05b6 9EB7 in r25,__SP_H__ |
||
683 | 688 05b8 0897 sbiw r24,8 |
||
684 | 689 05ba 8DBF out __SP_L__,r24 |
||
685 | 690 05bc EDB7 in r30,__SP_L__ |
||
686 | 691 05be FEB7 in r31,__SP_H__ |
||
687 | 692 05c0 3196 adiw r30,1 |
||
688 | 693 05c2 00E0 ldi r16,lo8(gs(uart_putchar)) |
||
689 | 694 05c4 10E0 ldi r17,hi8(gs(uart_putchar)) |
||
690 | 695 05c6 ADB7 in r26,__SP_L__ |
||
691 | 696 05c8 BEB7 in r27,__SP_H__ |
||
692 | 697 05ca 1296 adiw r26,1+1 |
||
693 | 698 05cc 1C93 st X,r17 |
||
694 | 699 05ce 0E93 st -X,r16 |
||
695 | 700 05d0 1197 sbiw r26,1 |
||
696 | 701 05d2 80E0 ldi r24,lo8(__c.2307) |
||
697 | 702 05d4 90E0 ldi r25,hi8(__c.2307) |
||
698 | 703 05d6 9383 std Z+3,r25 |
||
699 | 704 05d8 8283 std Z+2,r24 |
||
700 | 705 05da 8091 0000 lds r24,FlugMinuten |
||
701 | 706 05de 9091 0000 lds r25,(FlugMinuten)+1 |
||
702 | 707 05e2 9583 std Z+5,r25 |
||
703 | 708 05e4 8483 std Z+4,r24 |
||
704 | 709 05e6 8091 0000 lds r24,FlugMinutenGesamt |
||
705 | 710 05ea 9091 0000 lds r25,(FlugMinutenGesamt)+1 |
||
706 | 711 05ee 9783 std Z+7,r25 |
||
707 | 712 05f0 8683 std Z+6,r24 |
||
708 | 713 05f2 E091 0000 lds r30,_printf_P |
||
709 | 714 05f6 F091 0000 lds r31,(_printf_P)+1 |
||
710 | 715 05fa 0995 icall |
||
711 | 716 05fc 0F90 pop __tmp_reg__ |
||
712 | 717 05fe 0F90 pop __tmp_reg__ |
||
713 | 718 0600 0F90 pop __tmp_reg__ |
||
714 | 719 0602 0F90 pop __tmp_reg__ |
||
715 | 720 0604 EDB7 in r30,__SP_L__ |
||
716 | 721 0606 FEB7 in r31,__SP_H__ |
||
717 | 722 0608 1283 std Z+2,r17 |
||
718 | 723 060a 0183 std Z+1,r16 |
||
719 | 724 060c 80E0 ldi r24,lo8(__c.2309) |
||
720 | 725 060e 90E0 ldi r25,hi8(__c.2309) |
||
721 | 726 0610 9483 std Z+4,r25 |
||
722 | 727 0612 8383 std Z+3,r24 |
||
723 | 728 0614 E091 0000 lds r30,_printf_P |
||
724 | 729 0618 F091 0000 lds r31,(_printf_P)+1 |
||
725 | 730 061c 0995 icall |
||
726 | 731 061e 8091 0000 lds r24,EE_Parameter+13 |
||
727 | 732 0622 0F90 pop __tmp_reg__ |
||
728 | 733 0624 0F90 pop __tmp_reg__ |
||
729 | 734 0626 0F90 pop __tmp_reg__ |
||
730 | 735 0628 0F90 pop __tmp_reg__ |
||
731 | 736 062a 82FF sbrs r24,2 |
||
732 | 737 062c 00C0 rjmp .L50 |
||
733 | 738 062e 00D0 rcall . |
||
734 | 739 0630 00D0 rcall . |
||
735 | 740 0632 ADB7 in r26,__SP_L__ |
||
736 | 741 0634 BEB7 in r27,__SP_H__ |
||
737 | 742 0636 1296 adiw r26,1+1 |
||
738 | 743 0638 1C93 st X,r17 |
||
739 | 744 063a 0E93 st -X,r16 |
||
740 | 745 063c 1197 sbiw r26,1 |
||
741 | 746 063e 80E0 ldi r24,lo8(__c.2311) |
||
742 | 747 0640 90E0 ldi r25,hi8(__c.2311) |
||
743 | 748 0642 1496 adiw r26,3+1 |
||
744 | 749 0644 9C93 st X,r25 |
||
745 | 750 0646 8E93 st -X,r24 |
||
746 | 751 0648 1397 sbiw r26,3 |
||
747 | 752 064a 00C0 rjmp .L99 |
||
748 | 753 .L50: |
||
749 | 754 064c 00D0 rcall . |
||
750 | 755 064e 00D0 rcall . |
||
751 | 756 0650 EDB7 in r30,__SP_L__ |
||
752 | 757 0652 FEB7 in r31,__SP_H__ |
||
753 | 758 0654 1283 std Z+2,r17 |
||
754 | 759 0656 0183 std Z+1,r16 |
||
755 | 760 0658 80E0 ldi r24,lo8(__c.2313) |
||
756 | 761 065a 90E0 ldi r25,hi8(__c.2313) |
||
757 | 762 065c 9483 std Z+4,r25 |
||
758 | 763 065e 8383 std Z+3,r24 |
||
759 | 764 .L99: |
||
760 | 765 0660 E091 0000 lds r30,_printf_P |
||
761 | 766 0664 F091 0000 lds r31,(_printf_P)+1 |
||
762 | 767 0668 0995 icall |
||
763 | 768 066a 0F90 pop __tmp_reg__ |
||
764 | 769 066c 0F90 pop __tmp_reg__ |
||
765 | 770 066e 0F90 pop __tmp_reg__ |
||
766 | 771 0670 0F90 pop __tmp_reg__ |
||
767 | 772 0672 0E94 0000 call LcdClear |
||
768 | 773 0676 88E8 ldi r24,lo8(5000) |
||
769 | 774 0678 93E1 ldi r25,hi8(5000) |
||
770 | 775 067a 9093 0000 sts (I2CTimeout)+1,r25 |
||
771 | 776 067e 8093 0000 sts I2CTimeout,r24 |
||
772 | 777 0682 81E0 ldi r24,lo8(1) |
||
773 | 778 0684 8093 0000 sts WinkelOut+7,r24 |
||
774 | 779 0688 0E94 0000 call LipoDetection |
||
775 | 780 068c 8091 0000 lds r24,EE_Parameter+39 |
||
776 | 781 0690 0E94 0000 call LIBFC_ReceiverInit |
||
777 | 782 0694 00D0 rcall . |
||
778 | 783 0696 00D0 rcall . |
||
779 | 784 0698 80E0 ldi r24,lo8(gs(uart_putchar)) |
||
780 | 785 069a 90E0 ldi r25,hi8(gs(uart_putchar)) |
||
781 | 786 069c ADB7 in r26,__SP_L__ |
||
782 | 787 069e BEB7 in r27,__SP_H__ |
||
783 | 788 06a0 1296 adiw r26,1+1 |
||
784 | 789 06a2 9C93 st X,r25 |
||
785 | 790 06a4 8E93 st -X,r24 |
||
786 | 791 06a6 1197 sbiw r26,1 |
||
787 | 792 06a8 80E0 ldi r24,lo8(__c.2315) |
||
788 | 793 06aa 90E0 ldi r25,hi8(__c.2315) |
||
789 | 794 06ac 1496 adiw r26,3+1 |
||
790 | 795 06ae 9C93 st X,r25 |
||
791 | 796 06b0 8E93 st -X,r24 |
||
792 | 797 06b2 1397 sbiw r26,3 |
||
793 | 798 06b4 E091 0000 lds r30,_printf_P |
||
794 | 799 06b8 F091 0000 lds r31,(_printf_P)+1 |
||
795 | 800 06bc 0995 icall |
||
796 | 801 06be 0F90 pop __tmp_reg__ |
||
797 | 802 06c0 0F90 pop __tmp_reg__ |
||
798 | 803 06c2 0F90 pop __tmp_reg__ |
||
799 | 804 06c4 0F90 pop __tmp_reg__ |
||
800 | 805 06c6 80ED ldi r24,lo8(2000) |
||
801 | 806 06c8 97E0 ldi r25,hi8(2000) |
||
802 | 807 06ca 0E94 0000 call SetDelay |
||
803 | 808 06ce 8C01 movw r16,r24 |
||
804 | 809 06d0 8AEF ldi r24,lo8(250) |
||
805 | 810 06d2 90E0 ldi r25,hi8(250) |
||
806 | 811 06d4 0E94 0000 call SetDelay |
||
807 | 812 06d8 7C01 movw r14,r24 |
||
808 | 813 06da 83E0 ldi r24,lo8(3) |
||
809 | 814 06dc 8093 0000 sts DebugOut,r24 |
||
810 | 815 06e0 C0E0 ldi r28,lo8(0) |
||
811 | 816 06e2 D0E0 ldi r29,hi8(0) |
||
812 | 817 06e4 78E9 ldi r23,lo8(15000) |
||
813 | 818 06e6 C72E mov r12,r23 |
||
814 | 819 06e8 7AE3 ldi r23,hi8(15000) |
||
815 | 820 06ea D72E mov r13,r23 |
||
816 | 821 06ec 412C mov r4,__zero_reg__ |
||
817 | 822 06ee 68EA ldi r22,hi8(-22528) |
||
818 | 823 06f0 562E mov r5,r22 |
||
819 | 824 06f2 212C mov r2,__zero_reg__ |
||
820 | 825 06f4 5CE0 ldi r21,hi8(3072) |
||
821 | 826 06f6 352E mov r3,r21 |
||
822 | 827 06f8 40E1 ldi r20,lo8(10000) |
||
823 | 828 06fa A42E mov r10,r20 |
||
824 | 829 06fc 47E2 ldi r20,hi8(10000) |
||
825 | 830 06fe B42E mov r11,r20 |
||
826 | 831 0700 30E8 ldi r19,lo8(128) |
||
827 | 832 0702 832E mov r8,r19 |
||
828 | 833 0704 912C mov r9,__zero_reg__ |
||
829 | 834 0706 25E0 ldi r18,lo8(5) |
||
830 | 835 0708 622E mov r6,r18 |
||
831 | 836 070a 712C mov r7,__zero_reg__ |
||
832 | 837 .L96: |
||
833 | 838 070c C701 movw r24,r14 |
||
834 | 839 070e 0E94 0000 call CheckDelay |
||
835 | 840 0712 8823 tst r24 |
||
836 | 841 0714 01F0 breq .L52 |
||
837 | 842 0716 84E6 ldi r24,lo8(100) |
||
838 | 843 0718 90E0 ldi r25,hi8(100) |
||
839 | 844 071a 0E94 0000 call SetDelay |
||
840 | 845 071e 7C01 movw r14,r24 |
||
841 | 846 0720 0E94 0000 call LIBFC_Polling |
||
842 | 847 .L52: |
||
843 | 848 0724 8091 0000 lds r24,UpdateMotor |
||
844 | 849 0728 8823 tst r24 |
||
845 | 850 072a 01F4 brne .+2 |
||
846 | 851 072c 00C0 rjmp .L53 |
||
847 | 852 072e 8091 0000 lds r24,AdReady |
||
848 | 853 0732 8823 tst r24 |
||
849 | 854 0734 01F4 brne .+2 |
||
850 | 855 0736 00C0 rjmp .L53 |
||
851 | 856 0738 1092 0000 sts UpdateMotor,__zero_reg__ |
||
852 | 857 073c 8091 0000 lds r24,WinkelOut+6 |
||
853 | 858 0740 8823 tst r24 |
||
854 | 859 0742 01F0 breq .L54 |
||
855 | 860 0744 0E94 0000 call CalMk3Mag |
||
856 | 861 0748 00C0 rjmp .L55 |
||
857 | 862 .L54: |
||
858 | 863 074a 0E94 0000 call MotorRegler |
||
859 | 864 .L55: |
||
860 | 865 074e 0E94 0000 call SendMotorData |
||
861 | 866 0752 8091 0000 lds r24,PlatinenVersion |
||
862 | 867 0756 8A30 cpi r24,lo8(10) |
||
863 | 868 0758 01F0 breq .L56 |
||
864 | 869 075a 8431 cpi r24,lo8(20) |
||
865 | 870 075c 00F0 brlo .L57 |
||
866 | 871 .L56: |
||
867 | 872 075e 2898 cbi 37-32,0 |
||
868 | 873 0760 00C0 rjmp .L58 |
||
869 | 874 .L57: |
||
870 | 875 0762 289A sbi 37-32,0 |
||
871 | 876 .L58: |
||
872 | 877 0764 8091 0000 lds r24,SenderOkay |
||
873 | 878 0768 8823 tst r24 |
||
874 | 879 076a 01F0 breq .L59 |
||
875 | 880 076c 8091 0000 lds r24,SenderOkay |
||
876 | 881 0770 8150 subi r24,lo8(-(-1)) |
||
877 | 882 0772 8093 0000 sts SenderOkay,r24 |
||
878 | 883 0776 8091 0000 lds r24,VersionInfo+6 |
||
879 | 884 077a 877F andi r24,lo8(-9) |
||
880 | 885 077c 00C0 rjmp .L100 |
||
881 | 886 .L59: |
||
882 | 887 077e 8091 6F00 lds r24,111 |
||
883 | 888 0782 8062 ori r24,lo8(32) |
||
884 | 889 0784 8093 6F00 sts 111,r24 |
||
885 | 890 0788 1092 0000 sts (PPM_in)+1,__zero_reg__ |
||
886 | 891 078c 1092 0000 sts PPM_in,__zero_reg__ |
||
887 | 892 0790 8091 0000 lds r24,VersionInfo+6 |
||
888 | 893 0794 8860 ori r24,lo8(8) |
||
889 | 894 .L100: |
||
890 | 895 0796 8093 0000 sts VersionInfo+6,r24 |
||
891 | 896 079a 8091 0000 lds r24,I2CTimeout |
||
892 | 897 079e 9091 0000 lds r25,(I2CTimeout)+1 |
||
893 | 898 07a2 0197 sbiw r24,1 |
||
894 | 899 07a4 9093 0000 sts (I2CTimeout)+1,r25 |
||
895 | 900 07a8 8093 0000 sts I2CTimeout,r24 |
||
896 | 901 07ac 8091 0000 lds r24,I2CTimeout |
||
897 | 902 07b0 9091 0000 lds r25,(I2CTimeout)+1 |
||
898 | 903 07b4 892B or r24,r25 |
||
899 | 904 07b6 01F0 breq .L61 |
||
900 | 905 07b8 8091 0000 lds r24,MissingMotor |
||
901 | 906 07bc 8823 tst r24 |
||
902 | 907 07be 01F0 breq .L62 |
||
903 | 908 .L61: |
||
904 | 909 07c0 8091 0000 lds r24,I2CTimeout |
||
905 | 910 07c4 9091 0000 lds r25,(I2CTimeout)+1 |
||
906 | 911 07c8 892B or r24,r25 |
||
907 | 912 07ca 01F4 brne .L63 |
||
908 | 913 07cc 0E94 0000 call I2C_Reset |
||
909 | 914 07d0 7092 0000 sts (I2CTimeout)+1,r7 |
||
910 | 915 07d4 6092 0000 sts I2CTimeout,r6 |
||
911 | 916 07d8 8091 0000 lds r24,DebugOut+58 |
||
912 | 917 07dc 9091 0000 lds r25,(DebugOut+58)+1 |
||
913 | 918 07e0 0196 adiw r24,1 |
||
914 | 919 07e2 9093 0000 sts (DebugOut+58)+1,r25 |
||
915 | 920 07e6 8093 0000 sts DebugOut+58,r24 |
||
916 | 921 07ea 8091 0000 lds r24,FCFlags |
||
917 | 922 07ee 8068 ori r24,lo8(-128) |
||
918 | 923 07f0 8093 0000 sts FCFlags,r24 |
||
919 | 924 07f4 8091 0000 lds r24,VersionInfo+6 |
||
920 | 925 07f8 8160 ori r24,lo8(1) |
||
921 | 926 07fa 8093 0000 sts VersionInfo+6,r24 |
||
922 | 927 07fe 8091 0000 lds r24,DebugOut+1 |
||
923 | 928 0802 8260 ori r24,lo8(2) |
||
924 | 929 0804 8093 0000 sts DebugOut+1,r24 |
||
925 | 930 .L63: |
||
926 | 931 0808 8091 0000 lds r24,BeepMuster |
||
927 | 932 080c 9091 0000 lds r25,(BeepMuster)+1 |
||
928 | 933 0810 8F5F subi r24,lo8(-1) |
||
929 | 934 0812 9F4F sbci r25,hi8(-1) |
||
930 | 935 0814 01F4 brne .L64 |
||
931 | 936 0816 8091 0000 lds r24,MotorenEin |
||
932 | 937 081a 8823 tst r24 |
||
933 | 938 081c 01F0 breq .L64 |
||
934 | 939 081e B092 0000 sts (beeptime)+1,r11 |
||
935 | 940 0822 A092 0000 sts beeptime,r10 |
||
936 | 941 0826 9092 0000 sts (BeepMuster)+1,r9 |
||
937 | 942 082a 8092 0000 sts BeepMuster,r8 |
||
938 | 943 082e 00C0 rjmp .L64 |
||
939 | 944 .L62: |
||
940 | 945 0830 8091 0000 lds r24,PlatinenVersion |
||
941 | 946 0834 8A30 cpi r24,lo8(10) |
||
942 | 947 0836 01F0 breq .L65 |
||
943 | 948 0838 8431 cpi r24,lo8(20) |
||
944 | 949 083a 00F0 brlo .L66 |
||
945 | 950 .L65: |
||
946 | 951 083c 2898 cbi 37-32,0 |
||
947 | 952 083e 00C0 rjmp .L67 |
||
948 | 953 .L66: |
||
949 | 954 0840 289A sbi 37-32,0 |
||
950 | 955 .L67: |
||
951 | 956 0842 8091 0000 lds r24,beeptime |
||
952 | 957 0846 9091 0000 lds r25,(beeptime)+1 |
||
953 | 958 084a 892B or r24,r25 |
||
954 | 959 084c 01F4 brne .L64 |
||
955 | 960 084e 8091 0000 lds r24,FCFlags |
||
956 | 961 0852 8F77 andi r24,lo8(127) |
||
957 | 962 0854 8093 0000 sts FCFlags,r24 |
||
958 | 963 .L64: |
||
959 | 964 0858 8091 0000 lds r24,UpdateMotor |
||
960 | 965 085c 8823 tst r24 |
||
961 | 966 085e 01F0 breq .+2 |
||
962 | 967 0860 00C0 rjmp .L53 |
||
963 | 968 0862 0E94 0000 call DatenUebertragung |
||
964 | 969 0866 0E94 0000 call BearbeiteRxDaten |
||
965 | 970 086a C801 movw r24,r16 |
||
966 | 971 086c 0E94 0000 call CheckDelay |
||
967 | 972 0870 8823 tst r24 |
||
968 | 973 0872 01F4 brne .+2 |
||
969 | 974 0874 00C0 rjmp .L68 |
||
970 | 975 0876 8091 0000 lds r24,MissingMotor |
||
971 | 976 087a 8823 tst r24 |
||
972 | 977 087c 01F0 breq .L69 |
||
973 | 978 087e 8091 0000 lds r24,VersionInfo+6 |
||
974 | 979 0882 8260 ori r24,lo8(2) |
||
975 | 980 0884 8093 0000 sts VersionInfo+6,r24 |
||
976 | 981 0888 8091 0000 lds r24,DebugOut+1 |
||
977 | 982 088c 8260 ori r24,lo8(2) |
||
978 | 983 088e 00C0 rjmp .L101 |
||
979 | 984 .L69: |
||
980 | 985 0890 8091 0000 lds r24,VersionInfo+6 |
||
981 | 986 0894 8D7F andi r24,lo8(-3) |
||
982 | 987 0896 8093 0000 sts VersionInfo+6,r24 |
||
983 | 988 089a 8091 0000 lds r24,I2CTimeout |
||
984 | 989 089e 9091 0000 lds r25,(I2CTimeout)+1 |
||
985 | 990 08a2 0797 sbiw r24,7 |
||
986 | 991 08a4 00F0 brlo .L70 |
||
987 | 992 08a6 8091 0000 lds r24,DebugOut+1 |
||
988 | 993 08aa 8D7F andi r24,lo8(-3) |
||
989 | 994 .L101: |
||
990 | 995 08ac 8093 0000 sts DebugOut+1,r24 |
||
991 | 996 .L70: |
||
992 | 997 08b0 8091 0000 lds r24,I2CTimeout |
||
993 | 998 08b4 9091 0000 lds r25,(I2CTimeout)+1 |
||
994 | 999 08b8 0797 sbiw r24,7 |
||
995 | 1000 08ba 00F0 brlo .L71 |
||
996 | 1001 08bc 8091 0000 lds r24,VersionInfo+6 |
||
997 | 1002 08c0 8E7F andi r24,lo8(-2) |
||
998 | 1003 08c2 8093 0000 sts VersionInfo+6,r24 |
||
999 | 1004 .L71: |
||
1000 | 1005 08c6 8091 0000 lds r24,PcZugriff |
||
1001 | 1006 08ca 8823 tst r24 |
||
1002 | 1007 08cc 01F0 breq .L72 |
||
1003 | 1008 08ce 8150 subi r24,lo8(-(-1)) |
||
1004 | 1009 08d0 8093 0000 sts PcZugriff,r24 |
||
1005 | 1010 08d4 00C0 rjmp .L73 |
||
1006 | 1011 .L72: |
||
1007 | 1012 08d6 1092 0000 sts ExternControl+10,__zero_reg__ |
||
1008 | 1013 08da 1092 0000 sts (ExternStickNick)+1,__zero_reg__ |
||
1009 | 1014 08de 1092 0000 sts ExternStickNick,__zero_reg__ |
||
1010 | 1015 08e2 1092 0000 sts (ExternStickRoll)+1,__zero_reg__ |
||
1011 | 1016 08e6 1092 0000 sts ExternStickRoll,__zero_reg__ |
||
1012 | 1017 08ea 1092 0000 sts (ExternStickGier)+1,__zero_reg__ |
||
1013 | 1018 08ee 1092 0000 sts ExternStickGier,__zero_reg__ |
||
1014 | 1019 08f2 8091 0000 lds r24,BeepMuster |
||
1015 | 1020 08f6 9091 0000 lds r25,(BeepMuster)+1 |
||
1016 | 1021 08fa 8F5F subi r24,lo8(-1) |
||
1017 | 1022 08fc 9F4F sbci r25,hi8(-1) |
||
1018 | 1023 08fe 01F4 brne .L73 |
||
1019 | 1024 0900 8091 0000 lds r24,SenderOkay |
||
1020 | 1025 0904 8823 tst r24 |
||
1021 | 1026 0906 01F4 brne .L73 |
||
1022 | 1027 0908 D092 0000 sts (beeptime)+1,r13 |
||
1023 | 1028 090c C092 0000 sts beeptime,r12 |
||
1024 | 1029 0910 3092 0000 sts (BeepMuster)+1,r3 |
||
1025 | 1030 0914 2092 0000 sts BeepMuster,r2 |
||
1026 | 1031 .L73: |
||
1027 | 1032 0918 8091 0000 lds r24,NaviDataOkay |
||
1028 | 1033 091c 893C cpi r24,lo8(-55) |
||
1029 | 1034 091e 00F0 brlo .L74 |
||
1030 | 1035 0920 8150 subi r24,lo8(-(-1)) |
||
1031 | 1036 0922 8093 0000 sts NaviDataOkay,r24 |
||
1032 | 1037 0926 8091 0000 lds r24,FCFlags |
||
1033 | 1038 092a 8F7B andi r24,lo8(-65) |
||
1034 | 1039 092c 8093 0000 sts FCFlags,r24 |
||
1035 | 1040 0930 8091 0000 lds r24,VersionInfo+6 |
||
1036 | 1041 0934 8B7F andi r24,lo8(-5) |
||
1037 | 1042 0936 8093 0000 sts VersionInfo+6,r24 |
||
1038 | 1043 093a 00C0 rjmp .L75 |
||
1039 | 1044 .L74: |
||
1040 | 1045 093c 8091 0000 lds r24,NC_Version+3 |
||
1041 | 1046 0940 8823 tst r24 |
||
1042 | 1047 0942 01F0 breq .L76 |
||
1043 | 1048 0944 8091 0000 lds r24,FCFlags |
||
1044 | 1049 0948 8064 ori r24,lo8(64) |
||
1045 | 1050 094a 8093 0000 sts FCFlags,r24 |
||
1046 | 1051 094e 8091 0000 lds r24,VersionInfo+6 |
||
1047 | 1052 0952 8460 ori r24,lo8(4) |
||
1048 | 1053 0954 8093 0000 sts VersionInfo+6,r24 |
||
1049 | 1054 0958 8091 0000 lds r24,BeepMuster |
||
1050 | 1055 095c 9091 0000 lds r25,(BeepMuster)+1 |
||
1051 | 1056 0960 8F5F subi r24,lo8(-1) |
||
1052 | 1057 0962 9F4F sbci r25,hi8(-1) |
||
1053 | 1058 0964 01F4 brne .L76 |
||
1054 | 1059 0966 8091 0000 lds r24,MotorenEin |
||
1055 | 1060 096a 8823 tst r24 |
||
1056 | 1061 096c 01F0 breq .L76 |
||
1057 | 1062 096e D092 0000 sts (beeptime)+1,r13 |
||
1058 | 1063 0972 C092 0000 sts beeptime,r12 |
||
1059 | 1064 0976 5092 0000 sts (BeepMuster)+1,r5 |
||
1060 | 1065 097a 4092 0000 sts BeepMuster,r4 |
||
1061 | 1066 .L76: |
||
1062 | 1067 097e 1092 0000 sts (GPS_Nick)+1,__zero_reg__ |
||
1063 | 1068 0982 1092 0000 sts GPS_Nick,__zero_reg__ |
||
1064 | 1069 0986 1092 0000 sts (GPS_Roll)+1,__zero_reg__ |
||
1065 | 1070 098a 1092 0000 sts GPS_Roll,__zero_reg__ |
||
1066 | 1071 098e 8FEF ldi r24,lo8(-1) |
||
1067 | 1072 0990 9FEF ldi r25,hi8(-1) |
||
1068 | 1073 0992 9093 0000 sts (FromNaviCtrl+7)+1,r25 |
||
1069 | 1074 0996 8093 0000 sts FromNaviCtrl+7,r24 |
||
1070 | 1075 099a 1092 0000 sts NaviDataOkay,__zero_reg__ |
||
1071 | 1076 .L75: |
||
1072 | 1077 099e 2091 0000 lds r18,UBat |
||
1073 | 1078 09a2 3091 0000 lds r19,(UBat)+1 |
||
1074 | 1079 09a6 8091 0000 lds r24,BattLowVoltageWarning |
||
1075 | 1080 09aa 90E0 ldi r25,lo8(0) |
||
1076 | 1081 09ac 2817 cp r18,r24 |
||
1077 | 1082 09ae 3907 cpc r19,r25 |
||
1078 | 1083 09b0 04F4 brge .L77 |
||
1079 | 1084 09b2 8091 0000 lds r24,FCFlags |
||
1080 | 1085 09b6 8062 ori r24,lo8(32) |
||
1081 | 1086 09b8 8093 0000 sts FCFlags,r24 |
||
1082 | 1087 09bc 8091 0000 lds r24,BeepMuster |
||
1083 | 1088 09c0 9091 0000 lds r25,(BeepMuster)+1 |
||
1084 | 1089 09c4 8F5F subi r24,lo8(-1) |
||
1085 | 1090 09c6 9F4F sbci r25,hi8(-1) |
||
1086 | 1091 09c8 01F4 brne .L78 |
||
1087 | 1092 09ca E0E7 ldi r30,lo8(6000) |
||
1088 | 1093 09cc F7E1 ldi r31,hi8(6000) |
||
1089 | 1094 09ce F093 0000 sts (beeptime)+1,r31 |
||
1090 | 1095 09d2 E093 0000 sts beeptime,r30 |
||
1091 | 1096 09d6 80E0 ldi r24,lo8(768) |
||
1092 | 1097 09d8 93E0 ldi r25,hi8(768) |
||
1093 | 1098 09da 9093 0000 sts (BeepMuster)+1,r25 |
||
1094 | 1099 09de 8093 0000 sts BeepMuster,r24 |
||
1095 | 1100 09e2 00C0 rjmp .L78 |
||
1096 | 1101 .L77: |
||
1097 | 1102 09e4 8091 0000 lds r24,beeptime |
||
1098 | 1103 09e8 9091 0000 lds r25,(beeptime)+1 |
||
1099 | 1104 09ec 892B or r24,r25 |
||
1100 | 1105 09ee 01F4 brne .L78 |
||
1101 | 1106 09f0 8091 0000 lds r24,FCFlags |
||
1102 | 1107 09f4 8F7D andi r24,lo8(-33) |
||
1103 | 1108 09f6 8093 0000 sts FCFlags,r24 |
||
1104 | 1109 .L78: |
||
1105 | 1110 09fa 0E94 0000 call SPI_StartTransmitPacket |
||
1106 | 1111 09fe 94E0 ldi r25,lo8(4) |
||
1107 | 1112 0a00 9093 0000 sts SendSPI,r25 |
||
1108 | 1113 0a04 8091 0000 lds r24,MotorenEin |
||
1109 | 1114 0a08 8823 tst r24 |
||
1110 | 1115 0a0a 01F4 brne .L79 |
||
1111 | 1116 0a0c CAEA ldi r28,lo8(1450) |
||
1112 | 1117 0a0e D5E0 ldi r29,hi8(1450) |
||
1113 | 1118 0a10 00C0 rjmp .L80 |
||
1114 | 1119 .L79: |
||
1115 | 1120 0a12 8091 0000 lds r24,second.2317 |
||
1116 | 1121 0a16 8F5F subi r24,lo8(-(1)) |
||
1117 | 1122 0a18 8093 0000 sts second.2317,r24 |
||
1118 | 1123 0a1c 8133 cpi r24,lo8(49) |
||
1119 | 1124 0a1e 01F4 brne .L80 |
||
1120 | 1125 0a20 1092 0000 sts second.2317,__zero_reg__ |
||
1121 | 1126 0a24 8091 0000 lds r24,FlugSekunden |
||
1122 | 1127 0a28 9091 0000 lds r25,(FlugSekunden)+1 |
||
1123 | 1128 0a2c 0196 adiw r24,1 |
||
1124 | 1129 0a2e 9093 0000 sts (FlugSekunden)+1,r25 |
||
1125 | 1130 0a32 8093 0000 sts FlugSekunden,r24 |
||
1126 | 1131 .L80: |
||
1127 | 1132 0a36 2196 adiw r28,1 |
||
1128 | 1133 0a38 ABE0 ldi r26,hi8(2930) |
||
1129 | 1134 0a3a C237 cpi r28,lo8(2930) |
||
1130 | 1135 0a3c DA07 cpc r29,r26 |
||
1131 | 1136 0a3e 01F0 breq .L81 |
||
1132 | 1137 0a40 0C5E subi r16,lo8(-(20)) |
||
1133 | 1138 0a42 1F4F sbci r17,hi8(-(20)) |
||
1134 | 1139 0a44 00C0 rjmp .L68 |
||
1135 | 1140 .L81: |
||
1136 | 1141 0a46 8091 0000 lds r24,FlugMinuten |
||
1137 | 1142 0a4a 9091 0000 lds r25,(FlugMinuten)+1 |
||
1138 | 1143 0a4e 0196 adiw r24,1 |
||
1139 | 1144 0a50 9093 0000 sts (FlugMinuten)+1,r25 |
||
1140 | 1145 0a54 8093 0000 sts FlugMinuten,r24 |
||
1141 | 1146 0a58 8091 0000 lds r24,FlugMinutenGesamt |
||
1142 | 1147 0a5c 9091 0000 lds r25,(FlugMinutenGesamt)+1 |
||
1143 | 1148 0a60 0196 adiw r24,1 |
||
1144 | 1149 0a62 9093 0000 sts (FlugMinutenGesamt)+1,r25 |
||
1145 | 1150 0a66 8093 0000 sts FlugMinutenGesamt,r24 |
||
1146 | 1151 0a6a 6091 0000 lds r22,FlugMinuten+1 |
||
1147 | 1152 0a6e 8EE0 ldi r24,lo8(14) |
||
1148 | 1153 0a70 90E0 ldi r25,hi8(14) |
||
1149 | 1154 0a72 0E94 0000 call SetParamByte |
||
1150 | 1155 0a76 8FE0 ldi r24,lo8(15) |
||
1151 | 1156 0a78 90E0 ldi r25,hi8(15) |
||
1152 | 1157 0a7a 6091 0000 lds r22,FlugMinuten |
||
1153 | 1158 0a7e 0E94 0000 call SetParamByte |
||
1154 | 1159 0a82 6091 0000 lds r22,FlugMinutenGesamt+1 |
||
1155 | 1160 0a86 8AE0 ldi r24,lo8(10) |
||
1156 | 1161 0a88 90E0 ldi r25,hi8(10) |
||
1157 | 1162 0a8a 0E94 0000 call SetParamByte |
||
1158 | 1163 0a8e 8BE0 ldi r24,lo8(11) |
||
1159 | 1164 0a90 90E0 ldi r25,hi8(11) |
||
1160 | 1165 0a92 6091 0000 lds r22,FlugMinutenGesamt |
||
1161 | 1166 0a96 0E94 0000 call SetParamByte |
||
1162 | 1167 0a9a 84E1 ldi r24,lo8(20) |
||
1163 | 1168 0a9c 90E0 ldi r25,hi8(20) |
||
1164 | 1169 0a9e 0E94 0000 call SetDelay |
||
1165 | 1170 0aa2 8C01 movw r16,r24 |
||
1166 | 1171 0aa4 C0E0 ldi r28,lo8(0) |
||
1167 | 1172 0aa6 D0E0 ldi r29,hi8(0) |
||
1168 | 1173 .L68: |
||
1169 | 1174 0aa8 0E94 0000 call LED_Update |
||
1170 | 1175 0aac 0E94 0000 call Capacity_Update |
||
1171 | 1176 .L53: |
||
1172 | 1177 0ab0 8091 0000 lds r24,SendSPI |
||
1173 | 1178 0ab4 8823 tst r24 |
||
1174 | 1179 0ab6 01F0 breq .+2 |
||
1175 | 1180 0ab8 00C0 rjmp .L96 |
||
1176 | 1181 0aba 0E94 0000 call SPI_TransmitByte |
||
1177 | 1182 0abe 00C0 rjmp .L96 |
||
1178 | 1184 .global PlatinenVersion |
||
1179 | 1185 .data |
||
1180 | 1188 PlatinenVersion: |
||
1181 | 1189 0000 0A .byte 10 |
||
1182 | 1190 .global SendVersionToNavi |
||
1183 | 1193 SendVersionToNavi: |
||
1184 | 1194 0001 01 .byte 1 |
||
1185 | 1195 .global BattLowVoltageWarning |
||
1186 | 1198 BattLowVoltageWarning: |
||
1187 | 1199 0002 5E .byte 94 |
||
1188 | 1200 .global FlugMinuten |
||
1189 | 1201 .global FlugMinuten |
||
1190 | 1202 .section .bss |
||
1191 | 1205 FlugMinuten: |
||
1192 | 1206 0000 0000 .skip 2,0 |
||
1193 | 1207 .global FlugMinutenGesamt |
||
1194 | 1208 .global FlugMinutenGesamt |
||
1195 | 1211 FlugMinutenGesamt: |
||
1196 | 1212 0002 0000 .skip 2,0 |
||
1197 | 1213 .global FlugSekunden |
||
1198 | 1214 .global FlugSekunden |
||
1199 | 1217 FlugSekunden: |
||
1200 | 1218 0004 0000 .skip 2,0 |
||
1201 | 1219 .global FoundMotors |
||
1202 | 1220 .global FoundMotors |
||
1203 | 1223 FoundMotors: |
||
1204 | 1224 0006 00 .skip 1,0 |
||
1205 | 1225 .lcomm second.2317,1 |
||
1206 | 1226 .section .progmem.data,"a",@progbits |
||
1207 | 1229 __c.2315: |
||
1208 | 1230 0000 0A0D 3D3D .string "\n\r===================================\n\r" |
||
1209 | 1230 3D3D 3D3D |
||
1210 | 1230 3D3D 3D3D |
||
1211 | 1230 3D3D 3D3D |
||
1212 | 1230 3D3D 3D3D |
||
1213 | 1233 __c.2313: |
||
1214 | 1234 0028 4E6F 726D .string "Normal (ACC-Mode)" |
||
1215 | 1234 616C 2028 |
||
1216 | 1234 4143 432D |
||
1217 | 1234 4D6F 6465 |
||
1218 | 1234 2900 |
||
1219 | 1237 __c.2311: |
||
1220 | 1238 003a 4865 6164 .string "HeadingHold" |
||
1221 | 1238 696E 6748 |
||
1222 | 1238 6F6C 6400 |
||
1223 | 1241 __c.2309: |
||
1224 | 1242 0046 0A0D 436F .string "\n\rControl: " |
||
1225 | 1242 6E74 726F |
||
1226 | 1242 6C3A 2000 |
||
1227 | 1245 __c.2307: |
||
1228 | 1246 0052 0A0D 466C .string "\n\rFlight-time %u min Total:%u min" |
||
1229 | 1246 6967 6874 |
||
1230 | 1246 2D74 696D |
||
1231 | 1246 6520 2575 |
||
1232 | 1246 206D 696E |
||
1233 | 1249 __c.2305: |
||
1234 | 1250 0075 4F4B 0A0D .string "OK\n\r" |
||
1235 | 1250 00 |
||
1236 | 1253 __c.2300: |
||
1237 | 1254 007a 0A0D 4361 .string "\n\rCalibrating pressure sensor.." |
||
1238 | 1254 6C69 6272 |
||
1239 | 1254 6174 696E |
||
1240 | 1254 6720 7072 |
||
1241 | 1254 6573 7375 |
||
1242 | 1257 __c.2298: |
||
1243 | 1258 009a 0A0D 3D3D .string "\n\r===================================" |
||
1244 | 1258 3D3D 3D3D |
||
1245 | 1258 3D3D 3D3D |
||
1246 | 1258 3D3D 3D3D |
||
1247 | 1258 3D3D 3D3D |
||
1248 | 1261 __c.2293: |
||
1249 | 1262 00c0 0A0D 0A0D .string "\n\r\n\r!! MISSING BL-CTRL: %d !!" |
||
1250 | 1262 2121 204D |
||
1251 | 1262 4953 5349 |
||
1252 | 1262 4E47 2042 |
||
1253 | 1262 4C2D 4354 |
||
1254 | 1265 __c.2288: |
||
1255 | 1266 00de 2564 00 .string "%d" |
||
1256 | 1269 __c.2277: |
||
1257 | 1270 00e1 0A0D 466F .string "\n\rFound BL-Ctrl: " |
||
1258 | 1270 756E 6420 |
||
1259 | 1270 424C 2D43 |
||
1260 | 1270 7472 6C3A |
||
1261 | 1270 2000 |
||
1262 | 1273 __c.2246: |
||
1263 | 1274 00f3 204C 6F77 .string " Low warning level: %d.%d" |
||
1264 | 1274 2077 6172 |
||
1265 | 1274 6E69 6E67 |
||
1266 | 1274 206C 6576 |
||
1267 | 1274 656C 3A20 |
||
1268 | 1277 __c.2244: |
||
1269 | 1278 010d 2025 6420 .string " %d Cells " |
||
1270 | 1278 4365 6C6C |
||
1271 | 1278 7320 00 |
||
1272 | 1281 __c.2236: |
||
1273 | 1282 0118 0A0D 4261 .string "\n\rBatt:" |
||
1274 | 1282 7474 3A00 |
||
1275 | 1283 .data |
||
1276 | 1286 stick.2222: |
||
1277 | 1287 0003 01 .byte 1 |
||
1278 | 1288 .comm _printf_P,2,1 |
||
1279 | 1289 .global __do_copy_data |
||
1280 | 1290 .global __do_clear_bss |
||
1755 | - | 1281 | DEFINED SYMBOLS |
1282 | *ABS*:00000000 main.c |
||
1789 | - | 1283 | C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:2 *ABS*:0000003f __SREG__ |
1284 | C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:3 *ABS*:0000003e __SP_H__ |
||
1285 | C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:4 *ABS*:0000003d __SP_L__ |
||
1286 | C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:5 *ABS*:00000034 __CCP__ |
||
1287 | C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:6 *ABS*:00000000 __tmp_reg__ |
||
1288 | C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:7 *ABS*:00000001 __zero_reg__ |
||
1289 | C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:11 .text:00000000 LipoDetection |
||
1290 | C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1281 .progmem.data:00000118 __c.2236 |
||
1755 | - | 1291 | *COM*:00000002 _printf_P |
1789 | - | 1292 | C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1198 .data:00000002 BattLowVoltageWarning |
1293 | C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1277 .progmem.data:0000010d __c.2244 |
||
1294 | C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1273 .progmem.data:000000f3 __c.2246 |
||
1295 | C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:173 .text:0000014a CalMk3Mag |
||
1296 | C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1286 .data:00000003 stick.2222 |
||
1297 | C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:228 .text:000001bc main |
||
1298 | C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1188 .data:00000000 PlatinenVersion |
||
1299 | C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1269 .progmem.data:000000e1 __c.2277 |
||
1300 | C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1265 .progmem.data:000000de __c.2288 |
||
1301 | C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1223 .bss:00000006 FoundMotors |
||
1302 | C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1261 .progmem.data:000000c0 __c.2293 |
||
1303 | C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1257 .progmem.data:0000009a __c.2298 |
||
1304 | C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1253 .progmem.data:0000007a __c.2300 |
||
1305 | C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1249 .progmem.data:00000075 __c.2305 |
||
1306 | C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1205 .bss:00000000 FlugMinuten |
||
1307 | C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1211 .bss:00000002 FlugMinutenGesamt |
||
1308 | C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1245 .progmem.data:00000052 __c.2307 |
||
1309 | C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1241 .progmem.data:00000046 __c.2309 |
||
1310 | C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1237 .progmem.data:0000003a __c.2311 |
||
1311 | C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1233 .progmem.data:00000028 __c.2313 |
||
1312 | C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1229 .progmem.data:00000000 __c.2315 |
||
1313 | .bss:00000007 second.2317 |
||
1314 | C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1217 .bss:00000004 FlugSekunden |
||
1315 | C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1193 .data:00000001 SendVersionToNavi |
||
1755 | - | 1316 | |
1317 | UNDEFINED SYMBOLS |
||
1789 | - | 1318 | uart_putchar |
1755 | - | 1319 | EE_Parameter |
1789 | - | 1320 | SetDelay |
1321 | CheckDelay |
||
1322 | UBat |
||
1323 | Piep |
||
1324 | __udivmodqi4 |
||
1755 | - | 1325 | PPM_in |
1326 | WinkelOut |
||
1327 | beeptime |
||
1328 | DebugOut |
||
1789 | - | 1329 | __prologue_saves__ |
1755 | - | 1330 | StickGier |
1331 | StickRoll |
||
1332 | StickNick |
||
1333 | GIER_GRAD_FAKTOR |
||
1334 | Timer_Init |
||
1335 | TIMER2_Init |
||
1336 | UART_Init |
||
1337 | rc_sum_init |
||
1338 | ADC_Init |
||
1339 | I2C_Init |
||
1340 | SPI_MasterInit |
||
1341 | Capacity_Init |
||
1342 | LIBFC_Init |
||
1343 | ParamSet_Init |
||
1344 | BLFlags |
||
1345 | motor_read |
||
1346 | SendMotorData |
||
1347 | Motor |
||
1348 | Mixer |
||
1349 | ServoActive |
||
1350 | RequiredMotors |
||
1351 | VersionInfo |
||
1352 | SucheLuftruckOffset |
||
1353 | SetNeutral |
||
1354 | ExternControl |
||
1355 | GetParamByte |
||
1356 | LcdClear |
||
1357 | I2CTimeout |
||
1358 | LIBFC_ReceiverInit |
||
1359 | LIBFC_Polling |
||
1360 | UpdateMotor |
||
1361 | AdReady |
||
1362 | MotorRegler |
||
1363 | SenderOkay |
||
1364 | MissingMotor |
||
1365 | I2C_Reset |
||
1366 | FCFlags |
||
1367 | BeepMuster |
||
1368 | MotorenEin |
||
1369 | DatenUebertragung |
||
1370 | BearbeiteRxDaten |
||
1371 | PcZugriff |
||
1372 | ExternStickNick |
||
1373 | ExternStickRoll |
||
1374 | ExternStickGier |
||
1375 | NaviDataOkay |
||
1376 | NC_Version |
||
1377 | GPS_Nick |
||
1378 | GPS_Roll |
||
1379 | FromNaviCtrl |
||
1380 | SPI_StartTransmitPacket |
||
1381 | SendSPI |
||
1382 | SetParamByte |
||
1383 | LED_Update |
||
1384 | Capacity_Update |
||
1385 | SPI_TransmitByte |
||
1789 | - | 1386 | __do_copy_data |
1387 | __do_clear_bss |