Go to most recent revision | Details | Last modification | View Log | RSS feed
Rev | Author | Line No. | Line |
---|---|---|---|
1564 | LPDunwell | 1 | 1 .file "main.c" |
2 | 2 __SREG__ = 0x3f |
||
3 | 3 __SP_H__ = 0x3e |
||
4 | 4 __SP_L__ = 0x3d |
||
5 | 5 __CCP__ = 0x34 |
||
6 | 6 __tmp_reg__ = 0 |
||
7 | 7 __zero_reg__ = 1 |
||
8 | 8 .text |
||
9 | 9 .global GetCPUType |
||
10 | 11 GetCPUType: |
||
11 | 12 /* prologue: function */ |
||
12 | 13 /* frame size = 0 */ |
||
13 | 14 0000 8091 C800 lds r24,200 |
||
14 | 15 0004 8032 cpi r24,lo8(32) |
||
15 | 16 0006 01F0 breq .L2 |
||
16 | 17 0008 90E0 ldi r25,lo8(0) |
||
17 | 18 .L3: |
||
18 | 19 000a 892F mov r24,r25 |
||
19 | 20 /* epilogue start */ |
||
20 | 21 000c 0895 ret |
||
21 | 22 .L2: |
||
22 | 23 000e 8091 CA00 lds r24,202 |
||
23 | 24 0012 90E0 ldi r25,lo8(0) |
||
24 | 25 0014 8630 cpi r24,lo8(6) |
||
25 | 26 0016 01F4 brne .L3 |
||
26 | 27 0018 91E0 ldi r25,lo8(1) |
||
27 | 28 001a 892F mov r24,r25 |
||
28 | 29 001c 0895 ret |
||
29 | 31 .global GetBoardRelease |
||
30 | 33 GetBoardRelease: |
||
31 | 34 /* prologue: function */ |
||
32 | 35 /* frame size = 0 */ |
||
33 | 36 001e 85B1 in r24,37-32 |
||
34 | 37 0020 8C7F andi r24,lo8(-4) |
||
35 | 38 0022 85B9 out 37-32,r24 |
||
36 | 39 0024 2098 cbi 36-32,0 |
||
37 | 40 0026 88EE ldi r24,lo8(1000) |
||
38 | 41 0028 93E0 ldi r25,hi8(1000) |
||
39 | 42 /* #APP */ |
||
40 | 43 ; 105 "c:/winavr-20090313/lib/gcc/../../avr/include/util/delay_basic.h" 1 |
||
41 | 44 002a 0197 1: sbiw r24,1 |
||
42 | 45 002c 01F4 brne 1b |
||
43 | 46 ; 0 "" 2 |
||
44 | 47 /* #NOAPP */ |
||
45 | 48 002e 83B1 in r24,35-32 |
||
46 | 49 0030 90E0 ldi r25,lo8(0) |
||
47 | 50 0032 8370 andi r24,lo8(3) |
||
48 | 51 0034 9070 andi r25,hi8(3) |
||
49 | 52 0036 8230 cpi r24,2 |
||
50 | 53 0038 9105 cpc r25,__zero_reg__ |
||
51 | 54 003a 01F0 breq .L10 |
||
52 | 55 003c 8330 cpi r24,3 |
||
53 | 56 003e 9105 cpc r25,__zero_reg__ |
||
54 | 57 0040 01F0 breq .L11 |
||
55 | 58 0042 0197 sbiw r24,1 |
||
56 | 59 0044 01F0 breq .L9 |
||
57 | 60 0046 84B1 in r24,36-32 |
||
58 | 61 0048 8360 ori r24,lo8(3) |
||
59 | 62 004a 84B9 out 36-32,r24 |
||
60 | 63 004c 8AE0 ldi r24,lo8(10) |
||
61 | 64 .L16: |
||
62 | 65 004e 289A sbi 37-32,0 |
||
63 | 66 0050 8C30 cpi r24,lo8(12) |
||
64 | 67 0052 00F0 brlo .L18 |
||
65 | 68 .L13: |
||
66 | 69 0054 299A sbi 37-32,1 |
||
67 | 70 0056 0895 ret |
||
68 | 71 .L9: |
||
69 | 72 0058 84B1 in r24,36-32 |
||
70 | 73 005a 8360 ori r24,lo8(3) |
||
71 | 74 005c 84B9 out 36-32,r24 |
||
72 | 75 005e 8BE0 ldi r24,lo8(11) |
||
73 | 76 0060 2898 cbi 37-32,0 |
||
74 | 77 .L19: |
||
75 | 78 0062 8C30 cpi r24,lo8(12) |
||
76 | 79 0064 00F4 brsh .L13 |
||
77 | 80 .L18: |
||
78 | 81 0066 2998 cbi 37-32,1 |
||
79 | 82 0068 0895 ret |
||
80 | 83 .L11: |
||
81 | 84 006a 84B1 in r24,36-32 |
||
82 | 85 006c 8360 ori r24,lo8(3) |
||
83 | 86 006e 84B9 out 36-32,r24 |
||
84 | 87 0070 8DE0 ldi r24,lo8(13) |
||
85 | 88 0072 2898 cbi 37-32,0 |
||
86 | 89 0074 00C0 rjmp .L19 |
||
87 | 90 .L10: |
||
88 | 91 0076 84B1 in r24,36-32 |
||
89 | 92 0078 8360 ori r24,lo8(3) |
||
90 | 93 007a 84B9 out 36-32,r24 |
||
91 | 94 007c 84E1 ldi r24,lo8(20) |
||
92 | 95 007e 00C0 rjmp .L16 |
||
93 | 97 .global LipoDetection |
||
94 | 99 LipoDetection: |
||
95 | 100 0080 1F93 push r17 |
||
96 | 101 0082 CF93 push r28 |
||
97 | 102 0084 DF93 push r29 |
||
98 | 103 /* prologue: function */ |
||
99 | 104 /* frame size = 0 */ |
||
100 | 105 0086 182F mov r17,r24 |
||
101 | 106 0088 8823 tst r24 |
||
102 | 107 008a 01F0 breq .+2 |
||
103 | 108 008c 00C0 rjmp .L32 |
||
104 | 109 .L21: |
||
105 | 110 008e 8091 0000 lds r24,ParamSet+30 |
||
106 | 111 0092 8233 cpi r24,lo8(50) |
||
107 | 112 0094 00F0 brlo .L33 |
||
108 | 113 0096 8093 0000 sts LowVoltageWarning,r24 |
||
109 | 114 009a 1123 tst r17 |
||
110 | 115 009c 01F4 brne .L27 |
||
111 | 116 .L28: |
||
112 | 117 /* epilogue start */ |
||
113 | 118 009e DF91 pop r29 |
||
114 | 119 00a0 CF91 pop r28 |
||
115 | 120 00a2 1F91 pop r17 |
||
116 | 121 00a4 0895 ret |
||
117 | 122 .L33: |
||
118 | 123 00a6 84EF ldi r24,lo8(500) |
||
119 | 124 00a8 91E0 ldi r25,hi8(500) |
||
120 | 125 00aa 0E94 0000 call SetDelay |
||
121 | 126 00ae EC01 movw r28,r24 |
||
122 | 127 00b0 1123 tst r17 |
||
123 | 128 00b2 01F0 breq .+2 |
||
124 | 129 00b4 00C0 rjmp .L29 |
||
125 | 130 .L23: |
||
126 | 131 00b6 8091 0000 lds r24,UBat |
||
127 | 132 00ba 9091 0000 lds r25,(UBat)+1 |
||
128 | 133 00be 8238 cpi r24,130 |
||
129 | 134 00c0 9105 cpc r25,__zero_reg__ |
||
130 | 135 00c2 04F0 brlt .+2 |
||
131 | 136 00c4 00C0 rjmp .L25 |
||
132 | 137 00c6 8091 0000 lds r24,ParamSet+30 |
||
133 | 138 00ca 23E0 ldi r18,lo8(3) |
||
134 | 139 00cc 829F mul r24,r18 |
||
135 | 140 00ce C001 movw r24,r0 |
||
136 | 141 00d0 1124 clr r1 |
||
137 | 142 00d2 8093 0000 sts LowVoltageWarning,r24 |
||
138 | 143 00d6 1123 tst r17 |
||
139 | 144 00d8 01F0 breq .L28 |
||
140 | 145 00da 83E0 ldi r24,lo8(3) |
||
141 | 146 00dc 68EC ldi r22,lo8(200) |
||
142 | 147 00de 70E0 ldi r23,hi8(200) |
||
143 | 148 00e0 0E94 0000 call Beep |
||
144 | 149 00e4 00D0 rcall . |
||
145 | 150 00e6 0F92 push __tmp_reg__ |
||
146 | 151 00e8 EDB7 in r30,__SP_L__ |
||
147 | 152 00ea FEB7 in r31,__SP_H__ |
||
148 | 153 00ec 1182 std Z+1,__zero_reg__ |
||
149 | 154 00ee 80E0 ldi r24,lo8(__c.1914) |
||
150 | 155 00f0 90E0 ldi r25,hi8(__c.1914) |
||
151 | 156 00f2 9383 std Z+3,r25 |
||
152 | 157 00f4 8283 std Z+2,r24 |
||
153 | 158 00f6 0E94 0000 call _printf_P |
||
154 | 159 00fa 0F90 pop __tmp_reg__ |
||
155 | 160 00fc 0F90 pop __tmp_reg__ |
||
156 | 161 00fe 0F90 pop __tmp_reg__ |
||
157 | 162 .L27: |
||
158 | 163 0100 2091 0000 lds r18,LowVoltageWarning |
||
159 | 164 0104 EDB7 in r30,__SP_L__ |
||
160 | 165 0106 FEB7 in r31,__SP_H__ |
||
161 | 166 0108 3797 sbiw r30,7 |
||
162 | 167 010a 0FB6 in __tmp_reg__,__SREG__ |
||
163 | 168 010c F894 cli |
||
164 | 169 010e FEBF out __SP_H__,r31 |
||
165 | 170 0110 0FBE out __SREG__,__tmp_reg__ |
||
166 | 171 0112 EDBF out __SP_L__,r30 |
||
167 | 172 0114 3196 adiw r30,1 |
||
168 | 173 0116 ADB7 in r26,__SP_L__ |
||
169 | 174 0118 BEB7 in r27,__SP_H__ |
||
170 | 175 011a 1196 adiw r26,1 |
||
171 | 176 011c 1C92 st X,__zero_reg__ |
||
172 | 177 011e 80E0 ldi r24,lo8(__c.1918) |
||
173 | 178 0120 90E0 ldi r25,hi8(__c.1918) |
||
174 | 179 0122 9283 std Z+2,r25 |
||
175 | 180 0124 8183 std Z+1,r24 |
||
176 | 181 0126 822F mov r24,r18 |
||
177 | 182 0128 6AE0 ldi r22,lo8(10) |
||
178 | 183 012a 0E94 0000 call __udivmodqi4 |
||
179 | 184 012e 8383 std Z+3,r24 |
||
180 | 185 0130 1482 std Z+4,__zero_reg__ |
||
181 | 186 0132 822F mov r24,r18 |
||
182 | 187 0134 0E94 0000 call __udivmodqi4 |
||
183 | 188 0138 9583 std Z+5,r25 |
||
184 | 189 013a 1682 std Z+6,__zero_reg__ |
||
185 | 190 013c 0E94 0000 call _printf_P |
||
186 | 191 0140 EDB7 in r30,__SP_L__ |
||
187 | 192 0142 FEB7 in r31,__SP_H__ |
||
188 | 193 0144 3796 adiw r30,7 |
||
189 | 194 0146 0FB6 in __tmp_reg__,__SREG__ |
||
190 | 195 0148 F894 cli |
||
191 | 196 014a FEBF out __SP_H__,r31 |
||
192 | 197 014c 0FBE out __SREG__,__tmp_reg__ |
||
193 | 198 014e EDBF out __SP_L__,r30 |
||
194 | 199 0150 DF91 pop r29 |
||
195 | 200 0152 CF91 pop r28 |
||
196 | 201 0154 1F91 pop r17 |
||
197 | 202 0156 0895 ret |
||
198 | 203 .L29: |
||
199 | 204 0158 CE01 movw r24,r28 |
||
200 | 205 015a 0E94 0000 call CheckDelay |
||
201 | 206 015e 8823 tst r24 |
||
202 | 207 0160 01F0 breq .+2 |
||
203 | 208 0162 00C0 rjmp .L23 |
||
204 | 209 0164 CE01 movw r24,r28 |
||
205 | 210 0166 0E94 0000 call CheckDelay |
||
206 | 211 016a 8823 tst r24 |
||
207 | 212 016c 01F0 breq .L29 |
||
208 | 213 016e 00C0 rjmp .L23 |
||
209 | 214 .L32: |
||
210 | 215 0170 00D0 rcall . |
||
211 | 216 0172 0F92 push __tmp_reg__ |
||
212 | 217 0174 ADB7 in r26,__SP_L__ |
||
213 | 218 0176 BEB7 in r27,__SP_H__ |
||
214 | 219 0178 1196 adiw r26,1 |
||
215 | 220 017a 1C92 st X,__zero_reg__ |
||
216 | 221 017c 1197 sbiw r26,1 |
||
217 | 222 017e 80E0 ldi r24,lo8(__c.1909) |
||
218 | 223 0180 90E0 ldi r25,hi8(__c.1909) |
||
219 | 224 0182 1396 adiw r26,2+1 |
||
220 | 225 0184 9C93 st X,r25 |
||
221 | 226 0186 8E93 st -X,r24 |
||
222 | 227 0188 1297 sbiw r26,2 |
||
223 | 228 018a 0E94 0000 call _printf_P |
||
224 | 229 018e 0F90 pop __tmp_reg__ |
||
225 | 230 0190 0F90 pop __tmp_reg__ |
||
226 | 231 0192 0F90 pop __tmp_reg__ |
||
227 | 232 0194 00C0 rjmp .L21 |
||
228 | 233 .L25: |
||
229 | 234 0196 8091 0000 lds r24,ParamSet+30 |
||
230 | 235 019a 90E0 ldi r25,lo8(0) |
||
231 | 236 019c 880F lsl r24 |
||
232 | 237 019e 991F rol r25 |
||
233 | 238 01a0 880F lsl r24 |
||
234 | 239 01a2 991F rol r25 |
||
235 | 240 01a4 8093 0000 sts LowVoltageWarning,r24 |
||
236 | 241 01a8 1123 tst r17 |
||
237 | 242 01aa 01F4 brne .+2 |
||
238 | 243 01ac 00C0 rjmp .L28 |
||
239 | 244 01ae 84E0 ldi r24,lo8(4) |
||
240 | 245 01b0 68EC ldi r22,lo8(200) |
||
241 | 246 01b2 70E0 ldi r23,hi8(200) |
||
242 | 247 01b4 0E94 0000 call Beep |
||
243 | 248 01b8 00D0 rcall . |
||
244 | 249 01ba 0F92 push __tmp_reg__ |
||
245 | 250 01bc ADB7 in r26,__SP_L__ |
||
246 | 251 01be BEB7 in r27,__SP_H__ |
||
247 | 252 01c0 1196 adiw r26,1 |
||
248 | 253 01c2 1C92 st X,__zero_reg__ |
||
249 | 254 01c4 1197 sbiw r26,1 |
||
250 | 255 01c6 80E0 ldi r24,lo8(__c.1916) |
||
251 | 256 01c8 90E0 ldi r25,hi8(__c.1916) |
||
252 | 257 01ca 1396 adiw r26,2+1 |
||
253 | 258 01cc 9C93 st X,r25 |
||
254 | 259 01ce 8E93 st -X,r24 |
||
255 | 260 01d0 1297 sbiw r26,2 |
||
256 | 261 01d2 0E94 0000 call _printf_P |
||
257 | 262 01d6 0F90 pop __tmp_reg__ |
||
258 | 263 01d8 0F90 pop __tmp_reg__ |
||
259 | 264 01da 0F90 pop __tmp_reg__ |
||
260 | 265 01dc 00C0 rjmp .L27 |
||
261 | 267 .global main |
||
262 | 269 main: |
||
263 | 270 01de 2F92 push r2 |
||
264 | 271 01e0 3F92 push r3 |
||
265 | 272 01e2 4F92 push r4 |
||
266 | 273 01e4 5F92 push r5 |
||
267 | 274 01e6 6F92 push r6 |
||
268 | 275 01e8 7F92 push r7 |
||
269 | 276 01ea 8F92 push r8 |
||
270 | 277 01ec 9F92 push r9 |
||
271 | 278 01ee AF92 push r10 |
||
272 | 279 01f0 BF92 push r11 |
||
273 | 280 01f2 CF92 push r12 |
||
274 | 281 01f4 DF92 push r13 |
||
275 | 282 01f6 EF92 push r14 |
||
276 | 283 01f8 FF92 push r15 |
||
277 | 284 01fa 0F93 push r16 |
||
278 | 285 01fc 1F93 push r17 |
||
279 | 286 01fe CF93 push r28 |
||
280 | 287 0200 DF93 push r29 |
||
281 | 288 /* prologue: function */ |
||
282 | 289 /* frame size = 0 */ |
||
283 | 290 /* #APP */ |
||
284 | 291 ; 172 "main.c" 1 |
||
285 | 292 0202 F894 cli |
||
286 | 293 ; 0 "" 2 |
||
287 | 294 /* #NOAPP */ |
||
288 | 295 0204 8091 C800 lds r24,200 |
||
289 | 296 0208 8032 cpi r24,lo8(32) |
||
290 | 297 020a 01F4 brne .+2 |
||
291 | 298 020c 00C0 rjmp .L35 |
||
292 | 299 020e 90E0 ldi r25,lo8(0) |
||
293 | 300 .L36: |
||
294 | 301 0210 9093 0000 sts CPUType,r25 |
||
295 | 302 0214 0E94 0000 call GetBoardRelease |
||
296 | 303 0218 282F mov r18,r24 |
||
297 | 304 021a 8093 0000 sts BoardRelease,r24 |
||
298 | 305 021e 84B7 in r24,84-32 |
||
299 | 306 0220 877F andi r24,lo8(-9) |
||
300 | 307 0222 84BF out 84-32,r24 |
||
301 | 308 0224 8091 6000 lds r24,96 |
||
302 | 309 0228 8861 ori r24,lo8(24) |
||
303 | 310 022a 8093 6000 sts 96,r24 |
||
304 | 311 022e 1092 6000 sts 96,__zero_reg__ |
||
305 | 312 0232 80ED ldi r24,lo8(2000) |
||
306 | 313 0234 97E0 ldi r25,hi8(2000) |
||
307 | 314 0236 9093 0000 sts (BeepTime)+1,r25 |
||
308 | 315 023a 8093 0000 sts BeepTime,r24 |
||
309 | 316 023e 1092 0000 sts (PPM_in+4)+1,__zero_reg__ |
||
310 | 317 0242 1092 0000 sts PPM_in+4,__zero_reg__ |
||
311 | 318 0246 1092 0000 sts (StickYaw)+1,__zero_reg__ |
||
312 | 319 024a 1092 0000 sts StickYaw,__zero_reg__ |
||
313 | 320 024e 1092 0000 sts (StickRoll)+1,__zero_reg__ |
||
314 | 321 0252 1092 0000 sts StickRoll,__zero_reg__ |
||
315 | 322 0256 1092 0000 sts (StickNick)+1,__zero_reg__ |
||
316 | 323 025a 1092 0000 sts StickNick,__zero_reg__ |
||
317 | 324 025e 2A30 cpi r18,lo8(10) |
||
318 | 325 0260 01F4 brne .+2 |
||
319 | 326 0262 00C0 rjmp .L38 |
||
320 | 327 0264 2431 cpi r18,lo8(20) |
||
321 | 328 0266 01F4 brne .+2 |
||
322 | 329 0268 00C0 rjmp .L38 |
||
323 | 330 026a 289A sbi 37-32,0 |
||
324 | 331 .L40: |
||
325 | 332 026c 0E94 0000 call LED_Init |
||
326 | 333 0270 0E94 0000 call TIMER0_Init |
||
327 | 334 0274 0E94 0000 call TIMER2_Init |
||
328 | 335 0278 0E94 0000 call USART0_Init |
||
329 | 336 027c 8091 0000 lds r24,CPUType |
||
330 | 337 0280 8130 cpi r24,lo8(1) |
||
331 | 338 0282 01F4 brne .+2 |
||
332 | 339 0284 00C0 rjmp .L104 |
||
333 | 340 .L41: |
||
334 | 341 0286 0E94 0000 call RC_Init |
||
335 | 342 028a 0E94 0000 call ADC_Init |
||
336 | 343 028e 0E94 0000 call I2C_Init |
||
337 | 344 0292 0E94 0000 call SPI_MasterInit |
||
338 | 345 /* #APP */ |
||
339 | 346 ; 212 "main.c" 1 |
||
340 | 347 0296 7894 sei |
||
341 | 348 ; 0 "" 2 |
||
342 | 349 /* #NOAPP */ |
||
343 | 350 0298 00D0 rcall . |
||
344 | 351 029a 0F92 push __tmp_reg__ |
||
345 | 352 029c ADB7 in r26,__SP_L__ |
||
346 | 353 029e BEB7 in r27,__SP_H__ |
||
347 | 354 02a0 1196 adiw r26,1 |
||
348 | 355 02a2 1C92 st X,__zero_reg__ |
||
349 | 356 02a4 1197 sbiw r26,1 |
||
350 | 357 02a6 80E0 ldi r24,lo8(__c.1940) |
||
351 | 358 02a8 90E0 ldi r25,hi8(__c.1940) |
||
352 | 359 02aa 1396 adiw r26,2+1 |
||
353 | 360 02ac 9C93 st X,r25 |
||
354 | 361 02ae 8E93 st -X,r24 |
||
355 | 362 02b0 1297 sbiw r26,2 |
||
356 | 363 02b2 0E94 0000 call _printf_P |
||
357 | 364 02b6 EDB7 in r30,__SP_L__ |
||
358 | 365 02b8 FEB7 in r31,__SP_H__ |
||
359 | 366 02ba 1182 std Z+1,__zero_reg__ |
||
360 | 367 02bc 80E0 ldi r24,lo8(__c.1942) |
||
361 | 368 02be 90E0 ldi r25,hi8(__c.1942) |
||
362 | 369 02c0 9383 std Z+3,r25 |
||
363 | 370 02c2 8283 std Z+2,r24 |
||
364 | 371 02c4 0E94 0000 call _printf_P |
||
365 | 372 02c8 2091 0000 lds r18,BoardRelease |
||
366 | 373 02cc 00D0 rcall . |
||
367 | 374 02ce 00D0 rcall . |
||
368 | 375 02d0 EDB7 in r30,__SP_L__ |
||
369 | 376 02d2 FEB7 in r31,__SP_H__ |
||
370 | 377 02d4 3196 adiw r30,1 |
||
371 | 378 02d6 ADB7 in r26,__SP_L__ |
||
372 | 379 02d8 BEB7 in r27,__SP_H__ |
||
373 | 380 02da 1196 adiw r26,1 |
||
374 | 381 02dc 1C92 st X,__zero_reg__ |
||
375 | 382 02de 80E0 ldi r24,lo8(__c.1944) |
||
376 | 383 02e0 90E0 ldi r25,hi8(__c.1944) |
||
377 | 384 02e2 9283 std Z+2,r25 |
||
378 | 385 02e4 8183 std Z+1,r24 |
||
379 | 386 02e6 822F mov r24,r18 |
||
380 | 387 02e8 6AE0 ldi r22,lo8(10) |
||
381 | 388 02ea 0E94 0000 call __udivmodqi4 |
||
382 | 389 02ee 8383 std Z+3,r24 |
||
383 | 390 02f0 1482 std Z+4,__zero_reg__ |
||
384 | 391 02f2 822F mov r24,r18 |
||
385 | 392 02f4 0E94 0000 call __udivmodqi4 |
||
386 | 393 02f8 9583 std Z+5,r25 |
||
387 | 394 02fa 1682 std Z+6,__zero_reg__ |
||
388 | 395 02fc 0E94 0000 call _printf_P |
||
389 | 396 0300 0F90 pop __tmp_reg__ |
||
390 | 397 0302 0F90 pop __tmp_reg__ |
||
391 | 398 0304 0F90 pop __tmp_reg__ |
||
392 | 399 0306 0F90 pop __tmp_reg__ |
||
393 | 400 0308 EDB7 in r30,__SP_L__ |
||
394 | 401 030a FEB7 in r31,__SP_H__ |
||
395 | 402 030c 1182 std Z+1,__zero_reg__ |
||
396 | 403 030e 80E0 ldi r24,lo8(__c.1946) |
||
397 | 404 0310 90E0 ldi r25,hi8(__c.1946) |
||
398 | 405 0312 9383 std Z+3,r25 |
||
399 | 406 0314 8283 std Z+2,r24 |
||
400 | 407 0316 0E94 0000 call _printf_P |
||
401 | 408 031a ADB7 in r26,__SP_L__ |
||
402 | 409 031c BEB7 in r27,__SP_H__ |
||
403 | 410 031e 1196 adiw r26,1 |
||
404 | 411 0320 1C92 st X,__zero_reg__ |
||
405 | 412 0322 1197 sbiw r26,1 |
||
406 | 413 0324 80E0 ldi r24,lo8(__c.1948) |
||
407 | 414 0326 90E0 ldi r25,hi8(__c.1948) |
||
408 | 415 0328 1396 adiw r26,2+1 |
||
409 | 416 032a 9C93 st X,r25 |
||
410 | 417 032c 8E93 st -X,r24 |
||
411 | 418 032e 1297 sbiw r26,2 |
||
412 | 419 0330 0E94 0000 call _printf_P |
||
413 | 420 0334 EDB7 in r30,__SP_L__ |
||
414 | 421 0336 FEB7 in r31,__SP_H__ |
||
415 | 422 0338 1182 std Z+1,__zero_reg__ |
||
416 | 423 033a 80E0 ldi r24,lo8(__c.1950) |
||
417 | 424 033c 90E0 ldi r25,hi8(__c.1950) |
||
418 | 425 033e 9383 std Z+3,r25 |
||
419 | 426 0340 8283 std Z+2,r24 |
||
420 | 427 0342 0E94 0000 call _printf_P |
||
421 | 428 0346 0F90 pop __tmp_reg__ |
||
422 | 429 0348 0F90 pop __tmp_reg__ |
||
423 | 430 034a 0F90 pop __tmp_reg__ |
||
424 | 431 034c 8091 0000 lds r24,CPUType |
||
425 | 432 0350 8130 cpi r24,lo8(1) |
||
426 | 433 0352 01F4 brne .+2 |
||
427 | 434 0354 00C0 rjmp .L105 |
||
428 | 435 0356 00D0 rcall . |
||
429 | 436 0358 0F92 push __tmp_reg__ |
||
430 | 437 035a EDB7 in r30,__SP_L__ |
||
431 | 438 035c FEB7 in r31,__SP_H__ |
||
432 | 439 035e 1182 std Z+1,__zero_reg__ |
||
433 | 440 0360 80E0 ldi r24,lo8(__c.1954) |
||
434 | 441 0362 90E0 ldi r25,hi8(__c.1954) |
||
435 | 442 0364 9383 std Z+3,r25 |
||
436 | 443 0366 8283 std Z+2,r24 |
||
437 | 444 0368 0E94 0000 call _printf_P |
||
438 | 445 036c 0F90 pop __tmp_reg__ |
||
439 | 446 036e 0F90 pop __tmp_reg__ |
||
440 | 447 0370 0F90 pop __tmp_reg__ |
||
441 | 448 .L43: |
||
442 | 449 0372 8DB7 in r24,__SP_L__ |
||
443 | 450 0374 9EB7 in r25,__SP_H__ |
||
444 | 451 0376 0997 sbiw r24,9 |
||
445 | 452 0378 0FB6 in __tmp_reg__,__SREG__ |
||
446 | 453 037a F894 cli |
||
447 | 454 037c 9EBF out __SP_H__,r25 |
||
448 | 455 037e 0FBE out __SREG__,__tmp_reg__ |
||
449 | 456 0380 8DBF out __SP_L__,r24 |
||
450 | 457 0382 EDB7 in r30,__SP_L__ |
||
451 | 458 0384 FEB7 in r31,__SP_H__ |
||
452 | 459 0386 3196 adiw r30,1 |
||
453 | 460 0388 ADB7 in r26,__SP_L__ |
||
454 | 461 038a BEB7 in r27,__SP_H__ |
||
455 | 462 038c 1196 adiw r26,1 |
||
456 | 463 038e 1C92 st X,__zero_reg__ |
||
457 | 464 0390 80E0 ldi r24,lo8(__c.1956) |
||
458 | 465 0392 90E0 ldi r25,hi8(__c.1956) |
||
459 | 466 0394 9283 std Z+2,r25 |
||
460 | 467 0396 8183 std Z+1,r24 |
||
461 | 468 0398 1482 std Z+4,__zero_reg__ |
||
462 | 469 039a 1382 std Z+3,__zero_reg__ |
||
463 | 470 039c 8CE4 ldi r24,lo8(76) |
||
464 | 471 039e 90E0 ldi r25,hi8(76) |
||
465 | 472 03a0 9683 std Z+6,r25 |
||
466 | 473 03a2 8583 std Z+5,r24 |
||
467 | 474 03a4 87E6 ldi r24,lo8(103) |
||
468 | 475 03a6 90E0 ldi r25,hi8(103) |
||
469 | 476 03a8 9087 std Z+8,r25 |
||
470 | 477 03aa 8783 std Z+7,r24 |
||
471 | 478 03ac 0E94 0000 call _printf_P |
||
472 | 479 03b0 EDB7 in r30,__SP_L__ |
||
473 | 480 03b2 FEB7 in r31,__SP_H__ |
||
474 | 481 03b4 3696 adiw r30,6 |
||
475 | 482 03b6 0FB6 in __tmp_reg__,__SREG__ |
||
476 | 483 03b8 F894 cli |
||
477 | 484 03ba FEBF out __SP_H__,r31 |
||
478 | 485 03bc 0FBE out __SREG__,__tmp_reg__ |
||
479 | 486 03be EDBF out __SP_L__,r30 |
||
480 | 487 03c0 1182 std Z+1,__zero_reg__ |
||
481 | 488 03c2 80E0 ldi r24,lo8(__c.1958) |
||
482 | 489 03c4 90E0 ldi r25,hi8(__c.1958) |
||
483 | 490 03c6 9383 std Z+3,r25 |
||
484 | 491 03c8 8283 std Z+2,r24 |
||
485 | 492 03ca 0E94 0000 call _printf_P |
||
486 | 493 03ce 0F90 pop __tmp_reg__ |
||
487 | 494 03d0 0F90 pop __tmp_reg__ |
||
488 | 495 03d2 0F90 pop __tmp_reg__ |
||
489 | 496 03d4 8091 0000 lds r24,BoardRelease |
||
490 | 497 03d8 8C30 cpi r24,lo8(12) |
||
491 | 498 03da 00F0 brlo .+2 |
||
492 | 499 03dc 00C0 rjmp .L44 |
||
493 | 500 03de 299A sbi 37-32,1 |
||
494 | 501 .L45: |
||
495 | 502 03e0 0E94 0000 call ParamSet_Init |
||
496 | 503 03e4 00D0 rcall . |
||
497 | 504 03e6 0F92 push __tmp_reg__ |
||
498 | 505 03e8 ADB7 in r26,__SP_L__ |
||
499 | 506 03ea BEB7 in r27,__SP_H__ |
||
500 | 507 03ec 1196 adiw r26,1 |
||
501 | 508 03ee 1C92 st X,__zero_reg__ |
||
502 | 509 03f0 1197 sbiw r26,1 |
||
503 | 510 03f2 80E0 ldi r24,lo8(__c.1960) |
||
504 | 511 03f4 90E0 ldi r25,hi8(__c.1960) |
||
505 | 512 03f6 1396 adiw r26,2+1 |
||
506 | 513 03f8 9C93 st X,r25 |
||
507 | 514 03fa 8E93 st -X,r24 |
||
508 | 515 03fc 1297 sbiw r26,2 |
||
509 | 516 03fe 0E94 0000 call _printf_P |
||
510 | 517 0402 1092 0000 sts motor_read,__zero_reg__ |
||
511 | 518 0406 1092 0000 sts UpdateMotor,__zero_reg__ |
||
512 | 519 040a 0F90 pop __tmp_reg__ |
||
513 | 520 040c 0F90 pop __tmp_reg__ |
||
514 | 521 040e 0F90 pop __tmp_reg__ |
||
515 | 522 0410 0E94 0000 call SendMotorData |
||
516 | 523 .L46: |
||
517 | 524 0414 8091 0000 lds r24,UpdateMotor |
||
518 | 525 0418 8823 tst r24 |
||
519 | 526 041a 01F0 breq .L46 |
||
520 | 527 041c 1092 0000 sts motor_read,__zero_reg__ |
||
521 | 528 0420 80ED ldi r24,lo8(2000) |
||
522 | 529 0422 97E0 ldi r25,hi8(2000) |
||
523 | 530 0424 0E94 0000 call SetDelay |
||
524 | 531 0428 8C01 movw r16,r24 |
||
525 | 532 042a 20E0 ldi r18,lo8(Motor+1) |
||
526 | 533 042c C22E mov r12,r18 |
||
527 | 534 042e 20E0 ldi r18,hi8(Motor+1) |
||
528 | 535 0430 D22E mov r13,r18 |
||
529 | 536 0432 90E0 ldi r25,lo8(Mixer+13) |
||
530 | 537 0434 892E mov r8,r25 |
||
531 | 538 0436 90E0 ldi r25,hi8(Mixer+13) |
||
532 | 539 0438 992E mov r9,r25 |
||
533 | 540 043a E601 movw r28,r12 |
||
534 | 541 043c 5401 movw r10,r8 |
||
535 | 542 043e 81E0 ldi r24,lo8(1) |
||
536 | 543 0440 E82E mov r14,r24 |
||
537 | 544 0442 F12C mov r15,__zero_reg__ |
||
538 | 545 0444 B0E0 ldi r27,lo8(__c.1974) |
||
539 | 546 0446 6B2E mov r6,r27 |
||
540 | 547 0448 B0E0 ldi r27,hi8(__c.1974) |
||
541 | 548 044a 7B2E mov r7,r27 |
||
542 | 549 .L54: |
||
543 | 550 044c 1092 0000 sts UpdateMotor,__zero_reg__ |
||
544 | 551 0450 0E94 0000 call SendMotorData |
||
545 | 552 .L47: |
||
546 | 553 0454 8091 0000 lds r24,UpdateMotor |
||
547 | 554 0458 8823 tst r24 |
||
548 | 555 045a 01F0 breq .L47 |
||
549 | 556 045c F501 movw r30,r10 |
||
550 | 557 045e 8081 ld r24,Z |
||
551 | 558 0460 1816 cp __zero_reg__,r24 |
||
552 | 559 0462 04F4 brge .L49 |
||
553 | 560 0464 C801 movw r24,r16 |
||
554 | 561 0466 0E94 0000 call CheckDelay |
||
555 | 562 046a 8823 tst r24 |
||
556 | 563 046c 01F4 brne .L49 |
||
557 | 564 .L106: |
||
558 | 565 046e 8881 ld r24,Y |
||
559 | 566 0470 8823 tst r24 |
||
560 | 567 0472 01F0 breq .+2 |
||
561 | 568 0474 00C0 rjmp .L52 |
||
562 | 569 0476 1092 0000 sts UpdateMotor,__zero_reg__ |
||
563 | 570 047a 0E94 0000 call SendMotorData |
||
564 | 571 .L50: |
||
565 | 572 047e 8091 0000 lds r24,UpdateMotor |
||
566 | 573 0482 8823 tst r24 |
||
567 | 574 0484 01F0 breq .L50 |
||
568 | 575 0486 C801 movw r24,r16 |
||
569 | 576 0488 0E94 0000 call CheckDelay |
||
570 | 577 048c 8823 tst r24 |
||
571 | 578 048e 01F0 breq .L106 |
||
572 | 579 .L49: |
||
573 | 580 0490 8881 ld r24,Y |
||
574 | 581 0492 8823 tst r24 |
||
575 | 582 0494 01F0 breq .+2 |
||
576 | 583 0496 00C0 rjmp .L52 |
||
577 | 584 .L53: |
||
578 | 585 0498 2596 adiw r28,5 |
||
579 | 586 049a 0894 sec |
||
580 | 587 049c E11C adc r14,__zero_reg__ |
||
581 | 588 049e F11C adc r15,__zero_reg__ |
||
582 | 589 04a0 E4E0 ldi r30,lo8(4) |
||
583 | 590 04a2 F0E0 ldi r31,hi8(4) |
||
584 | 591 04a4 AE0E add r10,r30 |
||
585 | 592 04a6 BF1E adc r11,r31 |
||
586 | 593 04a8 F0E0 ldi r31,hi8(Motor+61) |
||
587 | 594 04aa C030 cpi r28,lo8(Motor+61) |
||
588 | 595 04ac DF07 cpc r29,r31 |
||
589 | 596 04ae 01F4 brne .L54 |
||
590 | 597 04b0 01E0 ldi r16,lo8(1) |
||
591 | 598 04b2 10E0 ldi r17,hi8(1) |
||
592 | 599 04b4 A0E0 ldi r26,lo8(__c.1979) |
||
593 | 600 04b6 EA2E mov r14,r26 |
||
594 | 601 04b8 A0E0 ldi r26,hi8(__c.1979) |
||
595 | 602 04ba FA2E mov r15,r26 |
||
596 | 603 .L56: |
||
597 | 604 04bc D601 movw r26,r12 |
||
598 | 605 04be 8C91 ld r24,X |
||
599 | 606 04c0 8823 tst r24 |
||
600 | 607 04c2 01F4 brne .L55 |
||
601 | 608 04c4 F401 movw r30,r8 |
||
602 | 609 04c6 8081 ld r24,Z |
||
603 | 610 04c8 1816 cp __zero_reg__,r24 |
||
604 | 611 04ca 04F4 brge .L55 |
||
605 | 612 04cc 00D0 rcall . |
||
606 | 613 04ce 00D0 rcall . |
||
607 | 614 04d0 0F92 push __tmp_reg__ |
||
608 | 615 04d2 EDB7 in r30,__SP_L__ |
||
609 | 616 04d4 FEB7 in r31,__SP_H__ |
||
610 | 617 04d6 3196 adiw r30,1 |
||
611 | 618 04d8 ADB7 in r26,__SP_L__ |
||
612 | 619 04da BEB7 in r27,__SP_H__ |
||
613 | 620 04dc 1196 adiw r26,1 |
||
614 | 621 04de 1C92 st X,__zero_reg__ |
||
615 | 622 04e0 F282 std Z+2,r15 |
||
616 | 623 04e2 E182 std Z+1,r14 |
||
617 | 624 04e4 1483 std Z+4,r17 |
||
618 | 625 04e6 0383 std Z+3,r16 |
||
619 | 626 04e8 0E94 0000 call _printf_P |
||
620 | 627 04ec 0F90 pop __tmp_reg__ |
||
621 | 628 04ee 0F90 pop __tmp_reg__ |
||
622 | 629 04f0 0F90 pop __tmp_reg__ |
||
623 | 630 04f2 0F90 pop __tmp_reg__ |
||
624 | 631 04f4 0F90 pop __tmp_reg__ |
||
625 | 632 04f6 0E94 0000 call Servo_On |
||
626 | 633 .L55: |
||
627 | 634 04fa F601 movw r30,r12 |
||
628 | 635 04fc 1182 std Z+1,__zero_reg__ |
||
629 | 636 04fe 85E0 ldi r24,lo8(5) |
||
630 | 637 0500 90E0 ldi r25,hi8(5) |
||
631 | 638 0502 C80E add r12,r24 |
||
632 | 639 0504 D91E adc r13,r25 |
||
633 | 640 0506 A4E0 ldi r26,lo8(4) |
||
634 | 641 0508 B0E0 ldi r27,hi8(4) |
||
635 | 642 050a 8A0E add r8,r26 |
||
636 | 643 050c 9B1E adc r9,r27 |
||
637 | 644 050e 0F5F subi r16,lo8(-(1)) |
||
638 | 645 0510 1F4F sbci r17,hi8(-(1)) |
||
639 | 646 0512 CC15 cp r28,r12 |
||
640 | 647 0514 DD05 cpc r29,r13 |
||
641 | 648 0516 01F4 brne .L56 |
||
642 | 649 0518 00D0 rcall . |
||
643 | 650 051a 0F92 push __tmp_reg__ |
||
644 | 651 051c EDB7 in r30,__SP_L__ |
||
645 | 652 051e FEB7 in r31,__SP_H__ |
||
646 | 653 0520 1182 std Z+1,__zero_reg__ |
||
647 | 654 0522 80E0 ldi r24,lo8(__c.1984) |
||
648 | 655 0524 90E0 ldi r25,hi8(__c.1984) |
||
649 | 656 0526 9383 std Z+3,r25 |
||
650 | 657 0528 8283 std Z+2,r24 |
||
651 | 658 052a 0E94 0000 call _printf_P |
||
652 | 659 052e 0F90 pop __tmp_reg__ |
||
653 | 660 0530 0F90 pop __tmp_reg__ |
||
654 | 661 0532 0F90 pop __tmp_reg__ |
||
655 | 662 0534 0E94 0000 call SendMotorData |
||
656 | 663 0538 84EF ldi r24,lo8(500) |
||
657 | 664 053a 91E0 ldi r25,hi8(500) |
||
658 | 665 053c 0E94 0000 call SetDelay |
||
659 | 666 0540 EC01 movw r28,r24 |
||
660 | 667 .L57: |
||
661 | 668 0542 CE01 movw r24,r28 |
||
662 | 669 0544 0E94 0000 call CheckDelay |
||
663 | 670 0548 8823 tst r24 |
||
664 | 671 054a 01F0 breq .L57 |
||
665 | 672 054c 8091 0000 lds r24,ParamSet+8 |
||
666 | 673 0550 80FD sbrc r24,0 |
||
667 | 674 0552 00C0 rjmp .L107 |
||
668 | 675 .L58: |
||
669 | 676 0554 00D0 rcall . |
||
670 | 677 0556 0F92 push __tmp_reg__ |
||
671 | 678 0558 ADB7 in r26,__SP_L__ |
||
672 | 679 055a BEB7 in r27,__SP_H__ |
||
673 | 680 055c 1196 adiw r26,1 |
||
674 | 681 055e 1C92 st X,__zero_reg__ |
||
675 | 682 0560 1197 sbiw r26,1 |
||
676 | 683 0562 80E0 ldi r24,lo8(__c.1996) |
||
677 | 684 0564 90E0 ldi r25,hi8(__c.1996) |
||
678 | 685 0566 1396 adiw r26,2+1 |
||
679 | 686 0568 9C93 st X,r25 |
||
680 | 687 056a 8E93 st -X,r24 |
||
681 | 688 056c 1297 sbiw r26,2 |
||
682 | 689 056e 0E94 0000 call _printf_P |
||
683 | 690 0572 EDB7 in r30,__SP_L__ |
||
684 | 691 0574 FEB7 in r31,__SP_H__ |
||
685 | 692 0576 1182 std Z+1,__zero_reg__ |
||
686 | 693 0578 80E0 ldi r24,lo8(__c.1998) |
||
687 | 694 057a 90E0 ldi r25,hi8(__c.1998) |
||
688 | 695 057c 9383 std Z+3,r25 |
||
689 | 696 057e 8283 std Z+2,r24 |
||
690 | 697 0580 0E94 0000 call _printf_P |
||
691 | 698 0584 0F90 pop __tmp_reg__ |
||
692 | 699 0586 0F90 pop __tmp_reg__ |
||
693 | 700 0588 0F90 pop __tmp_reg__ |
||
694 | 701 058a 80E0 ldi r24,lo8(0) |
||
695 | 702 058c 0E94 0000 call SetNeutral |
||
696 | 703 0590 8091 0000 lds r24,BoardRelease |
||
697 | 704 0594 8A30 cpi r24,lo8(10) |
||
698 | 705 0596 01F4 brne .+2 |
||
699 | 706 0598 00C0 rjmp .L60 |
||
700 | 707 059a 8431 cpi r24,lo8(20) |
||
701 | 708 059c 01F4 brne .+2 |
||
702 | 709 059e 00C0 rjmp .L60 |
||
703 | 710 05a0 289A sbi 37-32,0 |
||
704 | 711 .L62: |
||
705 | 712 05a2 80ED ldi r24,lo8(2000) |
||
706 | 713 05a4 97E0 ldi r25,hi8(2000) |
||
707 | 714 05a6 9093 0000 sts (BeepTime)+1,r25 |
||
708 | 715 05aa 8093 0000 sts BeepTime,r24 |
||
709 | 716 05ae 85E5 ldi r24,lo8(85) |
||
710 | 717 05b0 8093 0000 sts ExternControl,r24 |
||
711 | 718 05b4 8EE0 ldi r24,lo8(14) |
||
712 | 719 05b6 90E0 ldi r25,hi8(14) |
||
713 | 720 05b8 0E94 0000 call GetParamWord |
||
714 | 721 05bc 9093 0000 sts (FlightMinutes)+1,r25 |
||
715 | 722 05c0 8093 0000 sts FlightMinutes,r24 |
||
716 | 723 05c4 8AE0 ldi r24,lo8(10) |
||
717 | 724 05c6 90E0 ldi r25,hi8(10) |
||
718 | 725 05c8 0E94 0000 call GetParamWord |
||
719 | 726 05cc 9093 0000 sts (FlightMinutesTotal)+1,r25 |
||
720 | 727 05d0 8093 0000 sts FlightMinutesTotal,r24 |
||
721 | 728 05d4 8F5F subi r24,lo8(-1) |
||
722 | 729 05d6 9F4F sbci r25,hi8(-1) |
||
723 | 730 05d8 01F4 brne .+2 |
||
724 | 731 05da 00C0 rjmp .L63 |
||
725 | 732 05dc 8091 0000 lds r24,FlightMinutes |
||
726 | 733 05e0 9091 0000 lds r25,(FlightMinutes)+1 |
||
727 | 734 05e4 8F5F subi r24,lo8(-1) |
||
728 | 735 05e6 9F4F sbci r25,hi8(-1) |
||
729 | 736 05e8 01F4 brne .+2 |
||
730 | 737 05ea 00C0 rjmp .L63 |
||
731 | 738 .L64: |
||
732 | 739 05ec 8DB7 in r24,__SP_L__ |
||
733 | 740 05ee 9EB7 in r25,__SP_H__ |
||
734 | 741 05f0 0797 sbiw r24,7 |
||
735 | 742 05f2 0FB6 in __tmp_reg__,__SREG__ |
||
736 | 743 05f4 F894 cli |
||
737 | 744 05f6 9EBF out __SP_H__,r25 |
||
738 | 745 05f8 0FBE out __SREG__,__tmp_reg__ |
||
739 | 746 05fa 8DBF out __SP_L__,r24 |
||
740 | 747 05fc EDB7 in r30,__SP_L__ |
||
741 | 748 05fe FEB7 in r31,__SP_H__ |
||
742 | 749 0600 3196 adiw r30,1 |
||
743 | 750 0602 ADB7 in r26,__SP_L__ |
||
744 | 751 0604 BEB7 in r27,__SP_H__ |
||
745 | 752 0606 1196 adiw r26,1 |
||
746 | 753 0608 1C92 st X,__zero_reg__ |
||
747 | 754 060a 80E0 ldi r24,lo8(__c.2000) |
||
748 | 755 060c 90E0 ldi r25,hi8(__c.2000) |
||
749 | 756 060e 9283 std Z+2,r25 |
||
750 | 757 0610 8183 std Z+1,r24 |
||
751 | 758 0612 8091 0000 lds r24,FlightMinutes |
||
752 | 759 0616 9091 0000 lds r25,(FlightMinutes)+1 |
||
753 | 760 061a 9483 std Z+4,r25 |
||
754 | 761 061c 8383 std Z+3,r24 |
||
755 | 762 061e 8091 0000 lds r24,FlightMinutesTotal |
||
756 | 763 0622 9091 0000 lds r25,(FlightMinutesTotal)+1 |
||
757 | 764 0626 9683 std Z+6,r25 |
||
758 | 765 0628 8583 std Z+5,r24 |
||
759 | 766 062a 0E94 0000 call _printf_P |
||
760 | 767 062e 0F90 pop __tmp_reg__ |
||
761 | 768 0630 0F90 pop __tmp_reg__ |
||
762 | 769 0632 0F90 pop __tmp_reg__ |
||
763 | 770 0634 0F90 pop __tmp_reg__ |
||
764 | 771 0636 EDB7 in r30,__SP_L__ |
||
765 | 772 0638 FEB7 in r31,__SP_H__ |
||
766 | 773 063a 1182 std Z+1,__zero_reg__ |
||
767 | 774 063c 80E0 ldi r24,lo8(__c.2002) |
||
768 | 775 063e 90E0 ldi r25,hi8(__c.2002) |
||
769 | 776 0640 9383 std Z+3,r25 |
||
770 | 777 0642 8283 std Z+2,r24 |
||
771 | 778 0644 0E94 0000 call _printf_P |
||
772 | 779 0648 8091 0000 lds r24,ParamSet+8 |
||
773 | 780 064c 0F90 pop __tmp_reg__ |
||
774 | 781 064e 0F90 pop __tmp_reg__ |
||
775 | 782 0650 0F90 pop __tmp_reg__ |
||
776 | 783 0652 82FF sbrs r24,2 |
||
777 | 784 0654 00C0 rjmp .L65 |
||
778 | 785 0656 00D0 rcall . |
||
779 | 786 0658 0F92 push __tmp_reg__ |
||
780 | 787 065a ADB7 in r26,__SP_L__ |
||
781 | 788 065c BEB7 in r27,__SP_H__ |
||
782 | 789 065e 1196 adiw r26,1 |
||
783 | 790 0660 1C92 st X,__zero_reg__ |
||
784 | 791 0662 1197 sbiw r26,1 |
||
785 | 792 0664 80E0 ldi r24,lo8(__c.2004) |
||
786 | 793 0666 90E0 ldi r25,hi8(__c.2004) |
||
787 | 794 0668 1396 adiw r26,2+1 |
||
788 | 795 066a 9C93 st X,r25 |
||
789 | 796 066c 8E93 st -X,r24 |
||
790 | 797 066e 1297 sbiw r26,2 |
||
791 | 798 0670 0E94 0000 call _printf_P |
||
792 | 799 0674 0F90 pop __tmp_reg__ |
||
793 | 800 0676 0F90 pop __tmp_reg__ |
||
794 | 801 0678 0F90 pop __tmp_reg__ |
||
795 | 802 .L66: |
||
796 | 803 067a 0E94 0000 call LCD_Clear |
||
797 | 804 067e 88E8 ldi r24,lo8(5000) |
||
798 | 805 0680 93E1 ldi r25,hi8(5000) |
||
799 | 806 0682 9093 0000 sts (I2CTimeout)+1,r25 |
||
800 | 807 0686 8093 0000 sts I2CTimeout,r24 |
||
801 | 808 068a 81E0 ldi r24,lo8(1) |
||
802 | 809 068c 0E94 0000 call LipoDetection |
||
803 | 810 0690 00D0 rcall . |
||
804 | 811 0692 0F92 push __tmp_reg__ |
||
805 | 812 0694 ADB7 in r26,__SP_L__ |
||
806 | 813 0696 BEB7 in r27,__SP_H__ |
||
807 | 814 0698 1196 adiw r26,1 |
||
808 | 815 069a 1C92 st X,__zero_reg__ |
||
809 | 816 069c 1197 sbiw r26,1 |
||
810 | 817 069e 80E0 ldi r24,lo8(__c.2008) |
||
811 | 818 06a0 90E0 ldi r25,hi8(__c.2008) |
||
812 | 819 06a2 1396 adiw r26,2+1 |
||
813 | 820 06a4 9C93 st X,r25 |
||
814 | 821 06a6 8E93 st -X,r24 |
||
815 | 822 06a8 1297 sbiw r26,2 |
||
816 | 823 06aa 0E94 0000 call _printf_P |
||
817 | 824 06ae 0F90 pop __tmp_reg__ |
||
818 | 825 06b0 0F90 pop __tmp_reg__ |
||
819 | 826 06b2 0F90 pop __tmp_reg__ |
||
820 | 827 06b4 80ED ldi r24,lo8(2000) |
||
821 | 828 06b6 97E0 ldi r25,hi8(2000) |
||
822 | 829 06b8 0E94 0000 call SetDelay |
||
823 | 830 06bc EC01 movw r28,r24 |
||
824 | 831 06be 00E0 ldi r16,lo8(0) |
||
825 | 832 06c0 10E0 ldi r17,hi8(0) |
||
826 | 833 06c2 F4E0 ldi r31,lo8(4) |
||
827 | 834 06c4 FF2E mov r15,r31 |
||
828 | 835 06c6 C12C mov r12,__zero_reg__ |
||
829 | 836 06c8 E3E0 ldi r30,hi8(768) |
||
830 | 837 06ca DE2E mov r13,r30 |
||
831 | 838 06cc 70E7 ldi r23,lo8(6000) |
||
832 | 839 06ce 872E mov r8,r23 |
||
833 | 840 06d0 77E1 ldi r23,hi8(6000) |
||
834 | 841 06d2 972E mov r9,r23 |
||
835 | 842 06d4 68E9 ldi r22,lo8(15000) |
||
836 | 843 06d6 262E mov r2,r22 |
||
837 | 844 06d8 6AE3 ldi r22,hi8(15000) |
||
838 | 845 06da 362E mov r3,r22 |
||
839 | 846 06dc 50E1 ldi r21,lo8(10000) |
||
840 | 847 06de 652E mov r6,r21 |
||
841 | 848 06e0 57E2 ldi r21,hi8(10000) |
||
842 | 849 06e2 752E mov r7,r21 |
||
843 | 850 06e4 40E8 ldi r20,lo8(128) |
||
844 | 851 06e6 442E mov r4,r20 |
||
845 | 852 06e8 512C mov r5,__zero_reg__ |
||
846 | 853 06ea 35E0 ldi r19,lo8(5) |
||
847 | 854 06ec A32E mov r10,r19 |
||
848 | 855 06ee B12C mov r11,__zero_reg__ |
||
849 | 856 .L103: |
||
850 | 857 06f0 8091 0000 lds r24,UpdateMotor |
||
851 | 858 06f4 8823 tst r24 |
||
852 | 859 06f6 01F0 breq .L67 |
||
853 | 860 06f8 8091 0000 lds r24,ADReady |
||
854 | 861 06fc 8823 tst r24 |
||
855 | 862 06fe 01F4 brne .L108 |
||
856 | 863 .L67: |
||
857 | 864 0700 8091 0000 lds r24,SendSPI |
||
858 | 865 0704 8823 tst r24 |
||
859 | 866 0706 01F4 brne .L103 |
||
860 | 867 0708 0E94 0000 call SPI_TransmitByte |
||
861 | 868 070c 8091 0000 lds r24,UpdateMotor |
||
862 | 869 0710 8823 tst r24 |
||
863 | 870 0712 01F0 breq .L67 |
||
864 | 871 0714 8091 0000 lds r24,ADReady |
||
865 | 872 0718 8823 tst r24 |
||
866 | 873 071a 01F0 breq .L67 |
||
867 | 874 .L108: |
||
868 | 875 071c 1092 0000 sts UpdateMotor,__zero_reg__ |
||
869 | 876 0720 0E94 0000 call MotorControl |
||
870 | 877 0724 0E94 0000 call SendMotorData |
||
871 | 878 0728 2091 0000 lds r18,BoardRelease |
||
872 | 879 072c 2A30 cpi r18,lo8(10) |
||
873 | 880 072e 01F4 brne .+2 |
||
874 | 881 0730 00C0 rjmp .L68 |
||
875 | 882 0732 2431 cpi r18,lo8(20) |
||
876 | 883 0734 01F4 brne .+2 |
||
877 | 884 0736 00C0 rjmp .L68 |
||
878 | 885 0738 289A sbi 37-32,0 |
||
879 | 886 073a 8091 0000 lds r24,RC_Quality |
||
880 | 887 073e 8823 tst r24 |
||
881 | 888 0740 01F4 brne .+2 |
||
882 | 889 0742 00C0 rjmp .L71 |
||
883 | 890 .L110: |
||
884 | 891 0744 8091 0000 lds r24,RC_Quality |
||
885 | 892 0748 8150 subi r24,lo8(-(-1)) |
||
886 | 893 074a 8093 0000 sts RC_Quality,r24 |
||
887 | 894 .L72: |
||
888 | 895 074e 8091 0000 lds r24,NCDataOkay |
||
889 | 896 0752 8823 tst r24 |
||
890 | 897 0754 01F0 breq .L73 |
||
891 | 898 0756 8150 subi r24,lo8(-(-1)) |
||
892 | 899 0758 8093 0000 sts NCDataOkay,r24 |
||
893 | 900 075c 8823 tst r24 |
||
894 | 901 075e 01F4 brne .L73 |
||
895 | 902 0760 1092 0000 sts (GPSStickNick)+1,__zero_reg__ |
||
896 | 903 0764 1092 0000 sts GPSStickNick,__zero_reg__ |
||
897 | 904 0768 1092 0000 sts (GPSStickRoll)+1,__zero_reg__ |
||
898 | 905 076c 1092 0000 sts GPSStickRoll,__zero_reg__ |
||
899 | 906 0770 1092 0000 sts NCSerialDataOkay,__zero_reg__ |
||
900 | 907 0774 1092 0000 sts NCGpsZ,__zero_reg__ |
||
901 | 908 .L73: |
||
902 | 909 0778 8091 0000 lds r24,I2CTimeout |
||
903 | 910 077c 9091 0000 lds r25,(I2CTimeout)+1 |
||
904 | 911 0780 0197 sbiw r24,1 |
||
905 | 912 0782 9093 0000 sts (I2CTimeout)+1,r25 |
||
906 | 913 0786 8093 0000 sts I2CTimeout,r24 |
||
907 | 914 078a 8091 0000 lds r24,I2CTimeout |
||
908 | 915 078e 9091 0000 lds r25,(I2CTimeout)+1 |
||
909 | 916 0792 892B or r24,r25 |
||
910 | 917 0794 01F4 brne .+2 |
||
911 | 918 0796 00C0 rjmp .L74 |
||
912 | 919 0798 8091 0000 lds r24,MissingMotor |
||
913 | 920 079c 8823 tst r24 |
||
914 | 921 079e 01F0 breq .+2 |
||
915 | 922 07a0 00C0 rjmp .L74 |
||
916 | 923 07a2 2A30 cpi r18,lo8(10) |
||
917 | 924 07a4 01F4 brne .+2 |
||
918 | 925 07a6 00C0 rjmp .L81 |
||
919 | 926 07a8 2431 cpi r18,lo8(20) |
||
920 | 927 07aa 01F4 brne .+2 |
||
921 | 928 07ac 00C0 rjmp .L81 |
||
922 | 929 07ae 289A sbi 37-32,0 |
||
923 | 930 .L80: |
||
924 | 931 07b0 8091 0000 lds r24,UpdateMotor |
||
925 | 932 07b4 8823 tst r24 |
||
926 | 933 07b6 01F0 breq .L83 |
||
927 | 934 07b8 8091 0000 lds r24,MKFlags |
||
928 | 935 07bc 80FD sbrc r24,0 |
||
929 | 936 07be 00C0 rjmp .L84 |
||
930 | 937 .L83: |
||
931 | 938 07c0 0E94 0000 call USART0_TransmitTxData |
||
932 | 939 .L84: |
||
933 | 940 07c4 0E94 0000 call USART0_ProcessRxData |
||
934 | 941 07c8 CE01 movw r24,r28 |
||
935 | 942 07ca 0E94 0000 call CheckDelay |
||
936 | 943 07ce 8823 tst r24 |
||
937 | 944 07d0 01F0 breq .L85 |
||
938 | 945 07d2 6496 adiw r28,20 |
||
939 | 946 07d4 8091 0000 lds r24,PcAccess |
||
940 | 947 07d8 8823 tst r24 |
||
941 | 948 07da 01F4 brne .+2 |
||
942 | 949 07dc 00C0 rjmp .L86 |
||
943 | 950 07de 8150 subi r24,lo8(-(-1)) |
||
944 | 951 07e0 8093 0000 sts PcAccess,r24 |
||
945 | 952 .L87: |
||
946 | 953 07e4 2091 0000 lds r18,UBat |
||
947 | 954 07e8 3091 0000 lds r19,(UBat)+1 |
||
948 | 955 07ec 8091 0000 lds r24,LowVoltageWarning |
||
949 | 956 07f0 90E0 ldi r25,lo8(0) |
||
950 | 957 07f2 2817 cp r18,r24 |
||
951 | 958 07f4 3907 cpc r19,r25 |
||
952 | 959 07f6 04F0 brlt .+2 |
||
953 | 960 07f8 00C0 rjmp .L88 |
||
954 | 961 07fa 8091 0000 lds r24,MKFlags |
||
955 | 962 07fe 8062 ori r24,lo8(32) |
||
956 | 963 0800 8093 0000 sts MKFlags,r24 |
||
957 | 964 0804 D092 0000 sts (BeepModulation)+1,r13 |
||
958 | 965 0808 C092 0000 sts BeepModulation,r12 |
||
959 | 966 080c 8091 0000 lds r24,BeepTime |
||
960 | 967 0810 9091 0000 lds r25,(BeepTime)+1 |
||
961 | 968 0814 892B or r24,r25 |
||
962 | 969 0816 01F4 brne .L89 |
||
963 | 970 0818 9092 0000 sts (BeepTime)+1,r9 |
||
964 | 971 081c 8092 0000 sts BeepTime,r8 |
||
965 | 972 .L89: |
||
966 | 973 0820 0E94 0000 call SPI_StartTransmitPacket |
||
967 | 974 0824 F092 0000 sts SendSPI,r15 |
||
968 | 975 0828 8091 0000 lds r24,MKFlags |
||
969 | 976 082c 80FD sbrc r24,0 |
||
970 | 977 082e 00C0 rjmp .L90 |
||
971 | 978 0830 0BEA ldi r16,lo8(1451) |
||
972 | 979 0832 15E0 ldi r17,hi8(1451) |
||
973 | 980 .L85: |
||
974 | 981 0834 0E94 0000 call LED_Update |
||
975 | 982 0838 00C0 rjmp .L67 |
||
976 | 983 .L74: |
||
977 | 984 083a 2A30 cpi r18,lo8(10) |
||
978 | 985 083c 01F0 breq .L76 |
||
979 | 986 083e 2431 cpi r18,lo8(20) |
||
980 | 987 0840 01F0 breq .L76 |
||
981 | 988 0842 2898 cbi 37-32,0 |
||
982 | 989 0844 8091 0000 lds r24,I2CTimeout |
||
983 | 990 0848 9091 0000 lds r25,(I2CTimeout)+1 |
||
984 | 991 084c 892B or r24,r25 |
||
985 | 992 084e 01F0 breq .L109 |
||
986 | 993 .L79: |
||
987 | 994 0850 8091 0000 lds r24,BeepModulation |
||
988 | 995 0854 9091 0000 lds r25,(BeepModulation)+1 |
||
989 | 996 0858 8F5F subi r24,lo8(-1) |
||
990 | 997 085a 9F4F sbci r25,hi8(-1) |
||
991 | 998 085c 01F0 breq .+2 |
||
992 | 999 085e 00C0 rjmp .L80 |
||
993 | 1000 0860 8091 0000 lds r24,MKFlags |
||
994 | 1001 0864 80FF sbrs r24,0 |
||
995 | 1002 0866 00C0 rjmp .L80 |
||
996 | 1003 0868 7092 0000 sts (BeepTime)+1,r7 |
||
997 | 1004 086c 6092 0000 sts BeepTime,r6 |
||
998 | 1005 0870 5092 0000 sts (BeepModulation)+1,r5 |
||
999 | 1006 0874 4092 0000 sts BeepModulation,r4 |
||
1000 | 1007 0878 00C0 rjmp .L80 |
||
1001 | 1008 .L68: |
||
1002 | 1009 087a 2898 cbi 37-32,0 |
||
1003 | 1010 087c 8091 0000 lds r24,RC_Quality |
||
1004 | 1011 0880 8823 tst r24 |
||
1005 | 1012 0882 01F0 breq .+2 |
||
1006 | 1013 0884 00C0 rjmp .L110 |
||
1007 | 1014 .L71: |
||
1008 | 1015 0886 8091 6F00 lds r24,111 |
||
1009 | 1016 088a 8062 ori r24,lo8(32) |
||
1010 | 1017 088c 8093 6F00 sts 111,r24 |
||
1011 | 1018 0890 00C0 rjmp .L72 |
||
1012 | 1019 .L76: |
||
1013 | 1020 0892 289A sbi 37-32,0 |
||
1014 | 1021 0894 8091 0000 lds r24,I2CTimeout |
||
1015 | 1022 0898 9091 0000 lds r25,(I2CTimeout)+1 |
||
1016 | 1023 089c 892B or r24,r25 |
||
1017 | 1024 089e 01F4 brne .L79 |
||
1018 | 1025 .L109: |
||
1019 | 1026 08a0 0E94 0000 call I2C_Reset |
||
1020 | 1027 08a4 B092 0000 sts (I2CTimeout)+1,r11 |
||
1021 | 1028 08a8 A092 0000 sts I2CTimeout,r10 |
||
1022 | 1029 08ac 8091 0000 lds r24,DebugOut+58 |
||
1023 | 1030 08b0 9091 0000 lds r25,(DebugOut+58)+1 |
||
1024 | 1031 08b4 0196 adiw r24,1 |
||
1025 | 1032 08b6 9093 0000 sts (DebugOut+58)+1,r25 |
||
1026 | 1033 08ba 8093 0000 sts DebugOut+58,r24 |
||
1027 | 1034 08be 00C0 rjmp .L79 |
||
1028 | 1035 .L90: |
||
1029 | 1036 08c0 0F5F subi r16,lo8(-(1)) |
||
1030 | 1037 08c2 1F4F sbci r17,hi8(-(1)) |
||
1031 | 1038 08c4 9BE0 ldi r25,hi8(2930) |
||
1032 | 1039 08c6 0237 cpi r16,lo8(2930) |
||
1033 | 1040 08c8 1907 cpc r17,r25 |
||
1034 | 1041 08ca 01F0 breq .+2 |
||
1035 | 1042 08cc 00C0 rjmp .L85 |
||
1036 | 1043 08ce 6091 0000 lds r22,FlightMinutesTotal |
||
1037 | 1044 08d2 7091 0000 lds r23,(FlightMinutesTotal)+1 |
||
1038 | 1045 08d6 6F5F subi r22,lo8(-(1)) |
||
1039 | 1046 08d8 7F4F sbci r23,hi8(-(1)) |
||
1040 | 1047 08da 7093 0000 sts (FlightMinutesTotal)+1,r23 |
||
1041 | 1048 08de 6093 0000 sts FlightMinutesTotal,r22 |
||
1042 | 1049 08e2 8091 0000 lds r24,FlightMinutes |
||
1043 | 1050 08e6 9091 0000 lds r25,(FlightMinutes)+1 |
||
1044 | 1051 08ea 0196 adiw r24,1 |
||
1045 | 1052 08ec 9093 0000 sts (FlightMinutes)+1,r25 |
||
1046 | 1053 08f0 8093 0000 sts FlightMinutes,r24 |
||
1047 | 1054 08f4 8AE0 ldi r24,lo8(10) |
||
1048 | 1055 08f6 90E0 ldi r25,hi8(10) |
||
1049 | 1056 08f8 0E94 0000 call SetParamWord |
||
1050 | 1057 08fc 6091 0000 lds r22,FlightMinutes |
||
1051 | 1058 0900 7091 0000 lds r23,(FlightMinutes)+1 |
||
1052 | 1059 0904 8EE0 ldi r24,lo8(14) |
||
1053 | 1060 0906 90E0 ldi r25,hi8(14) |
||
1054 | 1061 0908 0E94 0000 call SetParamWord |
||
1055 | 1062 090c 84E1 ldi r24,lo8(20) |
||
1056 | 1063 090e 90E0 ldi r25,hi8(20) |
||
1057 | 1064 0910 0E94 0000 call SetDelay |
||
1058 | 1065 0914 EC01 movw r28,r24 |
||
1059 | 1066 0916 00E0 ldi r16,lo8(0) |
||
1060 | 1067 0918 10E0 ldi r17,hi8(0) |
||
1061 | 1068 091a 00C0 rjmp .L85 |
||
1062 | 1069 .L86: |
||
1063 | 1070 091c 1092 0000 sts ExternControl+10,__zero_reg__ |
||
1064 | 1071 0920 1092 0000 sts (ExternStickNick)+1,__zero_reg__ |
||
1065 | 1072 0924 1092 0000 sts ExternStickNick,__zero_reg__ |
||
1066 | 1073 0928 1092 0000 sts (ExternStickRoll)+1,__zero_reg__ |
||
1067 | 1074 092c 1092 0000 sts ExternStickRoll,__zero_reg__ |
||
1068 | 1075 0930 1092 0000 sts (ExternStickYaw)+1,__zero_reg__ |
||
1069 | 1076 0934 1092 0000 sts ExternStickYaw,__zero_reg__ |
||
1070 | 1077 0938 8091 0000 lds r24,BeepModulation |
||
1071 | 1078 093c 9091 0000 lds r25,(BeepModulation)+1 |
||
1072 | 1079 0940 8F5F subi r24,lo8(-1) |
||
1073 | 1080 0942 9F4F sbci r25,hi8(-1) |
||
1074 | 1081 0944 01F0 breq .+2 |
||
1075 | 1082 0946 00C0 rjmp .L87 |
||
1076 | 1083 0948 8091 0000 lds r24,RC_Quality |
||
1077 | 1084 094c 8823 tst r24 |
||
1078 | 1085 094e 01F0 breq .+2 |
||
1079 | 1086 0950 00C0 rjmp .L87 |
||
1080 | 1087 0952 3092 0000 sts (BeepTime)+1,r3 |
||
1081 | 1088 0956 2092 0000 sts BeepTime,r2 |
||
1082 | 1089 095a 80E0 ldi r24,lo8(3072) |
||
1083 | 1090 095c 9CE0 ldi r25,hi8(3072) |
||
1084 | 1091 095e 9093 0000 sts (BeepModulation)+1,r25 |
||
1085 | 1092 0962 8093 0000 sts BeepModulation,r24 |
||
1086 | 1093 0966 00C0 rjmp .L87 |
||
1087 | 1094 .L88: |
||
1088 | 1095 0968 8091 0000 lds r24,MKFlags |
||
1089 | 1096 096c 8F7D andi r24,lo8(-33) |
||
1090 | 1097 096e 8093 0000 sts MKFlags,r24 |
||
1091 | 1098 0972 00C0 rjmp .L89 |
||
1092 | 1099 .L81: |
||
1093 | 1100 0974 2898 cbi 37-32,0 |
||
1094 | 1101 0976 00C0 rjmp .L80 |
||
1095 | 1102 .L52: |
||
1096 | 1103 0978 00D0 rcall . |
||
1097 | 1104 097a 00D0 rcall . |
||
1098 | 1105 097c 0F92 push __tmp_reg__ |
||
1099 | 1106 097e EDB7 in r30,__SP_L__ |
||
1100 | 1107 0980 FEB7 in r31,__SP_H__ |
||
1101 | 1108 0982 3196 adiw r30,1 |
||
1102 | 1109 0984 ADB7 in r26,__SP_L__ |
||
1103 | 1110 0986 BEB7 in r27,__SP_H__ |
||
1104 | 1111 0988 1196 adiw r26,1 |
||
1105 | 1112 098a 1C92 st X,__zero_reg__ |
||
1106 | 1113 098c 7282 std Z+2,r7 |
||
1107 | 1114 098e 6182 std Z+1,r6 |
||
1108 | 1115 0990 F482 std Z+4,r15 |
||
1109 | 1116 0992 E382 std Z+3,r14 |
||
1110 | 1117 0994 0E94 0000 call _printf_P |
||
1111 | 1118 0998 0F90 pop __tmp_reg__ |
||
1112 | 1119 099a 0F90 pop __tmp_reg__ |
||
1113 | 1120 099c 0F90 pop __tmp_reg__ |
||
1114 | 1121 099e 0F90 pop __tmp_reg__ |
||
1115 | 1122 09a0 0F90 pop __tmp_reg__ |
||
1116 | 1123 09a2 00C0 rjmp .L53 |
||
1117 | 1124 .L44: |
||
1118 | 1125 09a4 2998 cbi 37-32,1 |
||
1119 | 1126 09a6 00C0 rjmp .L45 |
||
1120 | 1127 .L63: |
||
1121 | 1128 09a8 1092 0000 sts (FlightMinutes)+1,__zero_reg__ |
||
1122 | 1129 09ac 1092 0000 sts FlightMinutes,__zero_reg__ |
||
1123 | 1130 09b0 1092 0000 sts (FlightMinutesTotal)+1,__zero_reg__ |
||
1124 | 1131 09b4 1092 0000 sts FlightMinutesTotal,__zero_reg__ |
||
1125 | 1132 09b8 00C0 rjmp .L64 |
||
1126 | 1133 .L60: |
||
1127 | 1134 09ba 2898 cbi 37-32,0 |
||
1128 | 1135 09bc 00C0 rjmp .L62 |
||
1129 | 1136 .L38: |
||
1130 | 1137 09be 2898 cbi 37-32,0 |
||
1131 | 1138 09c0 00C0 rjmp .L40 |
||
1132 | 1139 .L35: |
||
1133 | 1140 09c2 8091 CA00 lds r24,202 |
||
1134 | 1141 09c6 90E0 ldi r25,lo8(0) |
||
1135 | 1142 09c8 8630 cpi r24,lo8(6) |
||
1136 | 1143 09ca 01F0 breq .+2 |
||
1137 | 1144 09cc 00C0 rjmp .L36 |
||
1138 | 1145 09ce 91E0 ldi r25,lo8(1) |
||
1139 | 1146 09d0 00C0 rjmp .L36 |
||
1140 | 1147 .L65: |
||
1141 | 1148 09d2 00D0 rcall . |
||
1142 | 1149 09d4 0F92 push __tmp_reg__ |
||
1143 | 1150 09d6 EDB7 in r30,__SP_L__ |
||
1144 | 1151 09d8 FEB7 in r31,__SP_H__ |
||
1145 | 1152 09da 1182 std Z+1,__zero_reg__ |
||
1146 | 1153 09dc 80E0 ldi r24,lo8(__c.2006) |
||
1147 | 1154 09de 90E0 ldi r25,hi8(__c.2006) |
||
1148 | 1155 09e0 9383 std Z+3,r25 |
||
1149 | 1156 09e2 8283 std Z+2,r24 |
||
1150 | 1157 09e4 0E94 0000 call _printf_P |
||
1151 | 1158 09e8 0F90 pop __tmp_reg__ |
||
1152 | 1159 09ea 0F90 pop __tmp_reg__ |
||
1153 | 1160 09ec 0F90 pop __tmp_reg__ |
||
1154 | 1161 09ee 00C0 rjmp .L66 |
||
1155 | 1162 .L105: |
||
1156 | 1163 09f0 00D0 rcall . |
||
1157 | 1164 09f2 0F92 push __tmp_reg__ |
||
1158 | 1165 09f4 ADB7 in r26,__SP_L__ |
||
1159 | 1166 09f6 BEB7 in r27,__SP_H__ |
||
1160 | 1167 09f8 1196 adiw r26,1 |
||
1161 | 1168 09fa 1C92 st X,__zero_reg__ |
||
1162 | 1169 09fc 1197 sbiw r26,1 |
||
1163 | 1170 09fe 80E0 ldi r24,lo8(__c.1952) |
||
1164 | 1171 0a00 90E0 ldi r25,hi8(__c.1952) |
||
1165 | 1172 0a02 1396 adiw r26,2+1 |
||
1166 | 1173 0a04 9C93 st X,r25 |
||
1167 | 1174 0a06 8E93 st -X,r24 |
||
1168 | 1175 0a08 1297 sbiw r26,2 |
||
1169 | 1176 0a0a 0E94 0000 call _printf_P |
||
1170 | 1177 0a0e 0F90 pop __tmp_reg__ |
||
1171 | 1178 0a10 0F90 pop __tmp_reg__ |
||
1172 | 1179 0a12 0F90 pop __tmp_reg__ |
||
1173 | 1180 0a14 00C0 rjmp .L43 |
||
1174 | 1181 .L104: |
||
1175 | 1182 0a16 0E94 0000 call USART1_Init |
||
1176 | 1183 0a1a 00C0 rjmp .L41 |
||
1177 | 1184 .L107: |
||
1178 | 1185 0a1c 00D0 rcall . |
||
1179 | 1186 0a1e 0F92 push __tmp_reg__ |
||
1180 | 1187 0a20 ADB7 in r26,__SP_L__ |
||
1181 | 1188 0a22 BEB7 in r27,__SP_H__ |
||
1182 | 1189 0a24 1196 adiw r26,1 |
||
1183 | 1190 0a26 1C92 st X,__zero_reg__ |
||
1184 | 1191 0a28 1197 sbiw r26,1 |
||
1185 | 1192 0a2a 80E0 ldi r24,lo8(__c.1989) |
||
1186 | 1193 0a2c 90E0 ldi r25,hi8(__c.1989) |
||
1187 | 1194 0a2e 1396 adiw r26,2+1 |
||
1188 | 1195 0a30 9C93 st X,r25 |
||
1189 | 1196 0a32 8E93 st -X,r24 |
||
1190 | 1197 0a34 1297 sbiw r26,2 |
||
1191 | 1198 0a36 0E94 0000 call _printf_P |
||
1192 | 1199 0a3a 0F90 pop __tmp_reg__ |
||
1193 | 1200 0a3c 0F90 pop __tmp_reg__ |
||
1194 | 1201 0a3e 0F90 pop __tmp_reg__ |
||
1195 | 1202 0a40 88EE ldi r24,lo8(1000) |
||
1196 | 1203 0a42 93E0 ldi r25,hi8(1000) |
||
1197 | 1204 0a44 0E94 0000 call SetDelay |
||
1198 | 1205 0a48 EC01 movw r28,r24 |
||
1199 | 1206 0a4a 0E94 0000 call SearchAirPressureOffset |
||
1200 | 1207 .L59: |
||
1201 | 1208 0a4e CE01 movw r24,r28 |
||
1202 | 1209 0a50 0E94 0000 call CheckDelay |
||
1203 | 1210 0a54 8823 tst r24 |
||
1204 | 1211 0a56 01F0 breq .L59 |
||
1205 | 1212 0a58 00D0 rcall . |
||
1206 | 1213 0a5a 0F92 push __tmp_reg__ |
||
1207 | 1214 0a5c EDB7 in r30,__SP_L__ |
||
1208 | 1215 0a5e FEB7 in r31,__SP_H__ |
||
1209 | 1216 0a60 1182 std Z+1,__zero_reg__ |
||
1210 | 1217 0a62 80E0 ldi r24,lo8(__c.1994) |
||
1211 | 1218 0a64 90E0 ldi r25,hi8(__c.1994) |
||
1212 | 1219 0a66 9383 std Z+3,r25 |
||
1213 | 1220 0a68 8283 std Z+2,r24 |
||
1214 | 1221 0a6a 0E94 0000 call _printf_P |
||
1215 | 1222 0a6e 0F90 pop __tmp_reg__ |
||
1216 | 1223 0a70 0F90 pop __tmp_reg__ |
||
1217 | 1224 0a72 0F90 pop __tmp_reg__ |
||
1218 | 1225 0a74 00C0 rjmp .L58 |
||
1219 | 1227 .global BoardRelease |
||
1220 | 1228 .data |
||
1221 | 1231 BoardRelease: |
||
1222 | 1232 0000 0A .byte 10 |
||
1223 | 1233 .global CPUType |
||
1224 | 1236 CPUType: |
||
1225 | 1237 0001 01 .byte 1 |
||
1226 | 1238 .global LowVoltageWarning |
||
1227 | 1241 LowVoltageWarning: |
||
1228 | 1242 0002 5E .byte 94 |
||
1229 | 1243 .global FlightMinutes |
||
1230 | 1244 .global FlightMinutes |
||
1231 | 1245 .section .bss |
||
1232 | 1248 FlightMinutes: |
||
1233 | 1249 0000 0000 .skip 2,0 |
||
1234 | 1250 .global FlightMinutesTotal |
||
1235 | 1251 .global FlightMinutesTotal |
||
1236 | 1254 FlightMinutesTotal: |
||
1237 | 1255 0002 0000 .skip 2,0 |
||
1238 | 1256 .section .progmem.data,"a",@progbits |
||
1239 | 1259 __c.2008: |
||
1240 | 1260 0000 0A0D 3D3D .string "\n\r===================================\n\r" |
||
1241 | 1260 3D3D 3D3D |
||
1242 | 1260 3D3D 3D3D |
||
1243 | 1260 3D3D 3D3D |
||
1244 | 1260 3D3D 3D3D |
||
1245 | 1263 __c.2006: |
||
1246 | 1264 0028 4E65 7574 .string "Neutral (ACC-Mode)" |
||
1247 | 1264 7261 6C20 |
||
1248 | 1264 2841 4343 |
||
1249 | 1264 2D4D 6F64 |
||
1250 | 1264 6529 00 |
||
1251 | 1267 __c.2004: |
||
1252 | 1268 003b 4865 6164 .string "HeadingHold" |
||
1253 | 1268 696E 6748 |
||
1254 | 1268 6F6C 6400 |
||
1255 | 1271 __c.2002: |
||
1256 | 1272 0047 0A0D 436F .string "\n\rControl: " |
||
1257 | 1272 6E74 726F |
||
1258 | 1272 6C3A 2000 |
||
1259 | 1275 __c.2000: |
||
1260 | 1276 0053 0A0D 466C .string "\n\rFlight-time %u min Total:%u min" |
||
1261 | 1276 6967 6874 |
||
1262 | 1276 2D74 696D |
||
1263 | 1276 6520 2575 |
||
1264 | 1276 206D 696E |
||
1265 | 1279 __c.1998: |
||
1266 | 1280 0076 0D0A 5375 .string "\r\nSupport for JENNIC RC at 2nd UART" |
||
1267 | 1280 7070 6F72 |
||
1268 | 1280 7420 666F |
||
1269 | 1280 7220 4A45 |
||
1270 | 1280 4E4E 4943 |
||
1271 | 1283 __c.1996: |
||
1272 | 1284 009a 0A0D 5375 .string "\n\rSupport for NaviCtrl" |
||
1273 | 1284 7070 6F72 |
||
1274 | 1284 7420 666F |
||
1275 | 1284 7220 4E61 |
||
1276 | 1284 7669 4374 |
||
1277 | 1287 __c.1994: |
||
1278 | 1288 00b1 4F4B 0A0D .string "OK\n\r" |
||
1279 | 1288 00 |
||
1280 | 1291 __c.1989: |
||
1281 | 1292 00b6 0A0D 4361 .string "\n\rCalibrating air pressure sensor.." |
||
1282 | 1292 6C69 6272 |
||
1283 | 1292 6174 696E |
||
1284 | 1292 6720 6169 |
||
1285 | 1292 7220 7072 |
||
1286 | 1295 __c.1984: |
||
1287 | 1296 00da 0A0D 3D3D .string "\n\r===================================" |
||
1288 | 1296 3D3D 3D3D |
||
1289 | 1296 3D3D 3D3D |
||
1290 | 1296 3D3D 3D3D |
||
1291 | 1296 3D3D 3D3D |
||
1292 | 1299 __c.1979: |
||
1293 | 1300 0100 0A0D 0A0D .string "\n\r\n\r!! MISSING BL-CTRL: %d !!" |
||
1294 | 1300 2121 204D |
||
1295 | 1300 4953 5349 |
||
1296 | 1300 4E47 2042 |
||
1297 | 1300 4C2D 4354 |
||
1298 | 1303 __c.1974: |
||
1299 | 1304 011e 2564 2000 .string "%d " |
||
1300 | 1307 __c.1960: |
||
1301 | 1308 0122 0A0D 466F .string "\n\rFound BL-Ctrl: " |
||
1302 | 1308 756E 6420 |
||
1303 | 1308 424C 2D43 |
||
1304 | 1308 7472 6C3A |
||
1305 | 1308 2000 |
||
1306 | 1311 __c.1958: |
||
1307 | 1312 0134 0A0D 3D3D .string "\n\r===================================" |
||
1308 | 1312 3D3D 3D3D |
||
1309 | 1312 3D3D 3D3D |
||
1310 | 1312 3D3D 3D3D |
||
1311 | 1312 3D3D 3D3D |
||
1312 | 1315 __c.1956: |
||
1313 | 1316 015a 0A0D 536F .string "\n\rSoftware: V%d.%d%c" |
||
1314 | 1316 6674 7761 |
||
1315 | 1316 7265 3A20 |
||
1316 | 1316 5625 642E |
||
1317 | 1316 2564 2563 |
||
1318 | 1319 __c.1954: |
||
1319 | 1320 016f 0D0A 2020 .string "\r\n CPU: Atmega644" |
||
1320 | 1320 2020 2043 |
||
1321 | 1320 5055 3A20 |
||
1322 | 1320 4174 6D65 |
||
1323 | 1320 6761 3634 |
||
1324 | 1323 __c.1952: |
||
1325 | 1324 0185 0D0A 2020 .string "\r\n CPU: Atmega644p" |
||
1326 | 1324 2020 2043 |
||
1327 | 1324 5055 3A20 |
||
1328 | 1324 4174 6D65 |
||
1329 | 1324 6761 3634 |
||
1330 | 1327 __c.1950: |
||
1331 | 1328 019c 0A0D 3D3D .string "\n\r===================================" |
||
1332 | 1328 3D3D 3D3D |
||
1333 | 1328 3D3D 3D3D |
||
1334 | 1328 3D3D 3D3D |
||
1335 | 1328 3D3D 3D3D |
||
1336 | 1331 __c.1948: |
||
1337 | 1332 01c2 0A0D 7777 .string "\n\rwww.MikroKopter.de (c) HiSystems GmbH" |
||
1338 | 1332 772E 4D69 |
||
1339 | 1332 6B72 6F4B |
||
1340 | 1332 6F70 7465 |
||
1341 | 1332 722E 6465 |
||
1342 | 1335 __c.1946: |
||
1343 | 1336 01ea 0A0D 7468 .ascii "\n\rthe use of th" |
||
1344 | 1336 6520 7573 |
||
1345 | 1336 6520 6F66 |
||
1346 | 1336 2074 68 |
||
1347 | 1337 01f9 6973 2073 .string "is software is only permitted \n\ron original MikroKopter-Hardware" |
||
1348 | 1337 6F66 7477 |
||
1349 | 1337 6172 6520 |
||
1350 | 1337 6973 206F |
||
1351 | 1337 6E6C 7920 |
||
1352 | 1340 __c.1944: |
||
1353 | 1341 023a 0A0D 4861 .string "\n\rHardware: %d.%d" |
||
1354 | 1341 7264 7761 |
||
1355 | 1341 7265 3A20 |
||
1356 | 1341 2564 2E25 |
||
1357 | 1341 6400 |
||
1358 | 1344 __c.1942: |
||
1359 | 1345 024c 0A0D 466C .string "\n\rFlightControl" |
||
1360 | 1345 6967 6874 |
||
1361 | 1345 436F 6E74 |
||
1362 | 1345 726F 6C00 |
||
1363 | 1348 __c.1940: |
||
1364 | 1349 025c 0A0D 3D3D .string "\n\r===================================" |
||
1365 | 1349 3D3D 3D3D |
||
1366 | 1349 3D3D 3D3D |
||
1367 | 1349 3D3D 3D3D |
||
1368 | 1349 3D3D 3D3D |
||
1369 | 1352 __c.1918: |
||
1370 | 1353 0282 4C6F 7720 .string "Low Warning level: %d.%dV" |
||
1371 | 1353 5761 726E |
||
1372 | 1353 696E 6720 |
||
1373 | 1353 6C65 7665 |
||
1374 | 1353 6C3A 2025 |
||
1375 | 1356 __c.1916: |
||
1376 | 1357 029c 2034 2043 .string " 4 Cells " |
||
1377 | 1357 656C 6C73 |
||
1378 | 1357 2020 00 |
||
1379 | 1360 __c.1914: |
||
1380 | 1361 02a7 2033 2043 .string " 3 Cells " |
||
1381 | 1361 656C 6C73 |
||
1382 | 1361 2020 00 |
||
1383 | 1364 __c.1909: |
||
1384 | 1365 02b2 0A0D 4261 .string "\n\rBatt:" |
||
1385 | 1365 7474 3A00 |
||
1386 | 1366 .global __do_copy_data |
||
1387 | 1367 .global __do_clear_bss |
||
1388 | DEFINED SYMBOLS |
||
1389 | *ABS*:00000000 main.c |
||
1390 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:2 *ABS*:0000003f __SREG__ |
||
1391 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:3 *ABS*:0000003e __SP_H__ |
||
1392 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:4 *ABS*:0000003d __SP_L__ |
||
1393 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:5 *ABS*:00000034 __CCP__ |
||
1394 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:6 *ABS*:00000000 __tmp_reg__ |
||
1395 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:7 *ABS*:00000001 __zero_reg__ |
||
1396 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:11 .text:00000000 GetCPUType |
||
1397 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:33 .text:0000001e GetBoardRelease |
||
1398 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:99 .text:00000080 LipoDetection |
||
1399 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:1241 .data:00000002 LowVoltageWarning |
||
1400 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:1360 .progmem.data:000002a7 __c.1914 |
||
1401 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:1352 .progmem.data:00000282 __c.1918 |
||
1402 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:1364 .progmem.data:000002b2 __c.1909 |
||
1403 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:1356 .progmem.data:0000029c __c.1916 |
||
1404 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:269 .text:000001de main |
||
1405 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:1236 .data:00000001 CPUType |
||
1406 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:1231 .data:00000000 BoardRelease |
||
1407 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:1348 .progmem.data:0000025c __c.1940 |
||
1408 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:1344 .progmem.data:0000024c __c.1942 |
||
1409 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:1340 .progmem.data:0000023a __c.1944 |
||
1410 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:1335 .progmem.data:000001ea __c.1946 |
||
1411 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:1331 .progmem.data:000001c2 __c.1948 |
||
1412 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:1327 .progmem.data:0000019c __c.1950 |
||
1413 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:1319 .progmem.data:0000016f __c.1954 |
||
1414 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:1315 .progmem.data:0000015a __c.1956 |
||
1415 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:1311 .progmem.data:00000134 __c.1958 |
||
1416 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:1307 .progmem.data:00000122 __c.1960 |
||
1417 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:1303 .progmem.data:0000011e __c.1974 |
||
1418 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:1299 .progmem.data:00000100 __c.1979 |
||
1419 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:1295 .progmem.data:000000da __c.1984 |
||
1420 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:1283 .progmem.data:0000009a __c.1996 |
||
1421 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:1279 .progmem.data:00000076 __c.1998 |
||
1422 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:1248 .bss:00000000 FlightMinutes |
||
1423 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:1254 .bss:00000002 FlightMinutesTotal |
||
1424 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:1275 .progmem.data:00000053 __c.2000 |
||
1425 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:1271 .progmem.data:00000047 __c.2002 |
||
1426 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:1267 .progmem.data:0000003b __c.2004 |
||
1427 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:1259 .progmem.data:00000000 __c.2008 |
||
1428 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:1263 .progmem.data:00000028 __c.2006 |
||
1429 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:1323 .progmem.data:00000185 __c.1952 |
||
1430 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:1291 .progmem.data:000000b6 __c.1989 |
||
1431 | C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccMHWd4q.s:1287 .progmem.data:000000b1 __c.1994 |
||
1432 | |||
1433 | UNDEFINED SYMBOLS |
||
1434 | ParamSet |
||
1435 | SetDelay |
||
1436 | UBat |
||
1437 | Beep |
||
1438 | _printf_P |
||
1439 | __udivmodqi4 |
||
1440 | CheckDelay |
||
1441 | BeepTime |
||
1442 | PPM_in |
||
1443 | StickYaw |
||
1444 | StickRoll |
||
1445 | StickNick |
||
1446 | LED_Init |
||
1447 | TIMER0_Init |
||
1448 | TIMER2_Init |
||
1449 | USART0_Init |
||
1450 | RC_Init |
||
1451 | ADC_Init |
||
1452 | I2C_Init |
||
1453 | SPI_MasterInit |
||
1454 | ParamSet_Init |
||
1455 | motor_read |
||
1456 | UpdateMotor |
||
1457 | SendMotorData |
||
1458 | Motor |
||
1459 | Mixer |
||
1460 | Servo_On |
||
1461 | SetNeutral |
||
1462 | ExternControl |
||
1463 | GetParamWord |
||
1464 | LCD_Clear |
||
1465 | I2CTimeout |
||
1466 | ADReady |
||
1467 | SendSPI |
||
1468 | SPI_TransmitByte |
||
1469 | MotorControl |
||
1470 | RC_Quality |
||
1471 | NCDataOkay |
||
1472 | GPSStickNick |
||
1473 | GPSStickRoll |
||
1474 | NCSerialDataOkay |
||
1475 | NCGpsZ |
||
1476 | MissingMotor |
||
1477 | MKFlags |
||
1478 | USART0_TransmitTxData |
||
1479 | USART0_ProcessRxData |
||
1480 | PcAccess |
||
1481 | BeepModulation |
||
1482 | SPI_StartTransmitPacket |
||
1483 | LED_Update |
||
1484 | I2C_Reset |
||
1485 | DebugOut |
||
1486 | SetParamWord |
||
1487 | ExternStickNick |
||
1488 | ExternStickRoll |
||
1489 | ExternStickYaw |
||
1490 | USART1_Init |
||
1491 | SearchAirPressureOffset |
||
1492 | __do_copy_data |
||
1493 | __do_clear_bss |