Rev 1189 | Details | Compare with Previous | Last modification | View Log | RSS feed
Rev | Author | Line No. | Line |
---|---|---|---|
1189 | kmpec | 1 | 1 .file "main.c" |
2 | 2 __SREG__ = 0x3f |
||
3 | 3 __SP_H__ = 0x3e |
||
4 | 4 __SP_L__ = 0x3d |
||
5 | 5 __tmp_reg__ = 0 |
||
6 | 6 __zero_reg__ = 1 |
||
7 | 7 .global __do_copy_data |
||
8 | 8 .global __do_clear_bss |
||
9 | 9 .text |
||
10 | 10 .global SetActiveParamSetNumber |
||
11 | 12 SetActiveParamSetNumber: |
||
12 | 13 /* prologue: frame size=0 */ |
||
13 | 14 /* prologue end (size=0) */ |
||
14 | 15 0000 8630 cpi r24,lo8(6) |
||
15 | 16 0002 00F0 brlo .L2 |
||
16 | 17 0004 85E0 ldi r24,lo8(5) |
||
17 | 18 .L4: |
||
18 | 19 0006 A0E0 ldi r26,lo8(EEPromArray+2) |
||
19 | 20 0008 B0E0 ldi r27,hi8(EEPromArray+2) |
||
20 | 21 /* #APP */ |
||
21 | 22 000a 082E mov __tmp_reg__,r24 |
||
22 | 23 000c 0E94 0000 call __eeprom_write_byte_1F2021 |
||
23 | 24 /* #NOAPP */ |
||
24 | 25 0010 0895 ret |
||
25 | 26 .L2: |
||
26 | 27 0012 8823 tst r24 |
||
27 | 28 0014 01F4 brne .L4 |
||
28 | 29 0016 0895 ret |
||
29 | 30 /* epilogue: frame size=0 */ |
||
30 | 31 /* epilogue: noreturn */ |
||
31 | 32 /* epilogue end (size=0) */ |
||
32 | 33 /* function SetActiveParamSetNumber size 13 (13) */ |
||
33 | 35 .global GetActiveParamSetNumber |
||
34 | 37 GetActiveParamSetNumber: |
||
35 | 38 /* prologue: frame size=0 */ |
||
36 | 39 /* prologue end (size=0) */ |
||
37 | 40 0018 A0E0 ldi r26,lo8(EEPromArray+2) |
||
38 | 41 001a B0E0 ldi r27,hi8(EEPromArray+2) |
||
39 | 42 /* #APP */ |
||
40 | 43 001c 0E94 0000 call __eeprom_read_byte_1F2021 |
||
41 | 44 0020 902D mov r25,__tmp_reg__ |
||
42 | 45 /* #NOAPP */ |
||
43 | 46 0022 892F mov r24,r25 |
||
44 | 47 0024 8150 subi r24,lo8(-(-1)) |
||
45 | 48 0026 8530 cpi r24,lo8(5) |
||
46 | 49 0028 00F4 brsh .L10 |
||
47 | 50 002a 892F mov r24,r25 |
||
48 | 51 002c 90E0 ldi r25,lo8(0) |
||
49 | 52 002e 0895 ret |
||
50 | 53 .L10: |
||
51 | 54 0030 83E0 ldi r24,lo8(3) |
||
52 | 55 0032 0E94 0000 call SetActiveParamSetNumber |
||
53 | 56 0036 83E0 ldi r24,lo8(3) |
||
54 | 57 0038 90E0 ldi r25,hi8(3) |
||
55 | 58 003a 0895 ret |
||
56 | 59 /* epilogue: frame size=0 */ |
||
57 | 60 /* epilogue: noreturn */ |
||
58 | 61 /* epilogue end (size=0) */ |
||
59 | 62 /* function GetActiveParamSetNumber size 19 (19) */ |
||
60 | 64 .global CalMk3Mag |
||
61 | 66 CalMk3Mag: |
||
62 | 67 /* prologue: frame size=0 */ |
||
63 | 68 /* prologue end (size=0) */ |
||
64 | 69 003c 8091 0000 lds r24,EE_Parameter |
||
65 | 70 0040 E82F mov r30,r24 |
||
66 | 71 0042 F0E0 ldi r31,lo8(0) |
||
67 | 72 0044 EE0F lsl r30 |
||
68 | 73 0046 FF1F rol r31 |
||
69 | 74 0048 E050 subi r30,lo8(-(PPM_in)) |
||
70 | 75 004a F040 sbci r31,hi8(-(PPM_in)) |
||
71 | 76 004c 8081 ld r24,Z |
||
72 | 77 004e 9181 ldd r25,Z+1 |
||
73 | 78 0050 8D5E subi r24,lo8(-19) |
||
74 | 79 0052 9F4F sbci r25,hi8(-19) |
||
75 | 80 0054 04F0 brlt .L15 |
||
76 | 81 0056 1092 0000 sts stick.2399,__zero_reg__ |
||
77 | 82 .L15: |
||
78 | 83 005a 8081 ld r24,Z |
||
79 | 84 005c 9181 ldd r25,Z+1 |
||
80 | 85 005e 8A5B subi r24,lo8(-70) |
||
81 | 86 0060 9F4F sbci r25,hi8(-70) |
||
82 | 87 0062 04F4 brge .L24 |
||
83 | 88 0064 8091 0000 lds r24,stick.2399 |
||
84 | 89 0068 8823 tst r24 |
||
85 | 90 006a 01F4 brne .L24 |
||
86 | 91 006c 81E0 ldi r24,lo8(1) |
||
87 | 92 006e 8093 0000 sts stick.2399,r24 |
||
88 | 93 0072 2091 0000 lds r18,WinkelOut+6 |
||
89 | 94 0076 2F5F subi r18,lo8(-(1)) |
||
90 | 95 0078 2093 0000 sts WinkelOut+6,r18 |
||
91 | 96 007c 2530 cpi r18,lo8(5) |
||
92 | 97 007e 00F0 brlo .L20 |
||
93 | 98 0080 88EE ldi r24,lo8(1000) |
||
94 | 99 0082 93E0 ldi r25,hi8(1000) |
||
95 | 100 0084 9093 0000 sts (beeptime)+1,r25 |
||
96 | 101 0088 8093 0000 sts beeptime,r24 |
||
97 | 102 008c 00C0 rjmp .L17 |
||
98 | 103 .L24: |
||
99 | 104 008e 2091 0000 lds r18,WinkelOut+6 |
||
100 | 105 0092 00C0 rjmp .L17 |
||
101 | 106 .L20: |
||
102 | 107 0094 822F mov r24,r18 |
||
103 | 108 0096 0E94 0000 call Piep |
||
104 | 109 009a 2091 0000 lds r18,WinkelOut+6 |
||
105 | 110 .L17: |
||
106 | 111 009e 822F mov r24,r18 |
||
107 | 112 00a0 90E0 ldi r25,lo8(0) |
||
108 | 113 00a2 9093 0000 sts (DebugOut+40)+1,r25 |
||
109 | 114 00a6 8093 0000 sts DebugOut+40,r24 |
||
110 | 115 /* epilogue: frame size=0 */ |
||
111 | 116 00aa 0895 ret |
||
112 | 117 /* epilogue end (size=1) */ |
||
113 | 118 /* function CalMk3Mag size 58 (57) */ |
||
114 | 120 .global WriteParameterSet |
||
115 | 122 WriteParameterSet: |
||
116 | 123 /* prologue: frame size=0 */ |
||
117 | 124 /* prologue end (size=0) */ |
||
118 | 125 00ac 582F mov r21,r24 |
||
119 | 126 00ae 9B01 movw r18,r22 |
||
120 | 127 00b0 8630 cpi r24,lo8(6) |
||
121 | 128 00b2 00F4 brsh .L32 |
||
122 | 129 00b4 8823 tst r24 |
||
123 | 130 00b6 01F0 breq .L31 |
||
124 | 131 00b8 A82F mov r26,r24 |
||
125 | 132 00ba B0E0 ldi r27,lo8(0) |
||
126 | 133 00bc 1197 sbiw r26,1 |
||
127 | 134 .L28: |
||
128 | 135 00be 842F mov r24,r20 |
||
129 | 136 00c0 90E0 ldi r25,lo8(0) |
||
130 | 137 00c2 BD01 movw r22,r26 |
||
131 | 138 00c4 689F mul r22,r24 |
||
132 | 139 00c6 D001 movw r26,r0 |
||
133 | 140 00c8 699F mul r22,r25 |
||
134 | 141 00ca B00D add r27,r0 |
||
135 | 142 00cc 789F mul r23,r24 |
||
136 | 143 00ce B00D add r27,r0 |
||
137 | 144 00d0 1124 clr r1 |
||
138 | 145 00d2 A050 subi r26,lo8(-(EEPromArray+100)) |
||
139 | 146 00d4 B040 sbci r27,hi8(-(EEPromArray+100)) |
||
140 | 147 00d6 F901 movw r30,r18 |
||
141 | 148 /* #APP */ |
||
142 | 149 .117_start: |
||
143 | 150 00d8 0197 sbiw r24,1 |
||
144 | 151 00da 04F0 brlt .117_finished |
||
145 | 152 00dc 0190 ld __tmp_reg__,z+ |
||
146 | 153 00de 0E94 0000 call __eeprom_write_byte_1F2021 |
||
147 | 154 00e2 00C0 rjmp .117_start |
||
148 | 155 .117_finished: |
||
149 | 156 /* #NOAPP */ |
||
150 | 157 00e4 60E0 ldi r22,lo8(EEPromArray+98) |
||
151 | 158 00e6 70E0 ldi r23,hi8(EEPromArray+98) |
||
152 | 159 00e8 DB01 movw r26,r22 |
||
153 | 160 /* #APP */ |
||
154 | 161 00ea 042E mov __tmp_reg__,r20 |
||
155 | 162 00ec 0E94 0000 call __eeprom_write_byte_1F2021 |
||
156 | 163 /* #NOAPP */ |
||
157 | 164 00f0 88E0 ldi r24,lo8(8) |
||
158 | 165 00f2 6251 subi r22,lo8(-(-18)) |
||
159 | 166 00f4 7040 sbci r23,hi8(-(-18)) |
||
160 | 167 00f6 DB01 movw r26,r22 |
||
161 | 168 00f8 F901 movw r30,r18 |
||
162 | 169 /* #APP */ |
||
163 | 170 00fa 182E mov __zero_reg__,r24 |
||
164 | 171 00fc 0E94 0000 call __eeprom_write_block_1F2021 |
||
165 | 172 /* #NOAPP */ |
||
166 | 173 0100 852F mov r24,r21 |
||
167 | 174 0102 0E94 0000 call SetActiveParamSetNumber |
||
168 | 175 0106 0E94 0000 call LED_Init |
||
169 | 176 .L31: |
||
170 | 177 010a 0895 ret |
||
171 | 178 .L32: |
||
172 | 179 010c 55E0 ldi r21,lo8(5) |
||
173 | 180 010e A4E0 ldi r26,lo8(4) |
||
174 | 181 0110 B0E0 ldi r27,hi8(4) |
||
175 | 182 0112 00C0 rjmp .L28 |
||
176 | 183 /* epilogue: frame size=0 */ |
||
177 | 184 /* epilogue: noreturn */ |
||
178 | 185 /* epilogue end (size=0) */ |
||
179 | 186 /* function WriteParameterSet size 62 (62) */ |
||
180 | 188 .global ReadParameterSet |
||
181 | 190 ReadParameterSet: |
||
182 | 191 /* prologue: frame size=0 */ |
||
183 | 192 /* prologue end (size=0) */ |
||
184 | 193 0114 A82F mov r26,r24 |
||
185 | 194 0116 FB01 movw r30,r22 |
||
186 | 195 0118 8150 subi r24,lo8(-(-1)) |
||
187 | 196 011a 8530 cpi r24,lo8(5) |
||
188 | 197 011c 00F0 brlo .L34 |
||
189 | 198 011e A2E0 ldi r26,lo8(2) |
||
190 | 199 0120 B0E0 ldi r27,hi8(2) |
||
191 | 200 0122 00C0 rjmp .L36 |
||
192 | 201 .L34: |
||
193 | 202 0124 B0E0 ldi r27,lo8(0) |
||
194 | 203 0126 1197 sbiw r26,1 |
||
195 | 204 .L36: |
||
196 | 205 0128 842F mov r24,r20 |
||
197 | 206 012a 90E0 ldi r25,lo8(0) |
||
198 | 207 012c 9D01 movw r18,r26 |
||
199 | 208 012e 289F mul r18,r24 |
||
200 | 209 0130 D001 movw r26,r0 |
||
201 | 210 0132 299F mul r18,r25 |
||
202 | 211 0134 B00D add r27,r0 |
||
203 | 212 0136 389F mul r19,r24 |
||
204 | 213 0138 B00D add r27,r0 |
||
205 | 214 013a 1124 clr r1 |
||
206 | 215 013c A050 subi r26,lo8(-(EEPromArray+100)) |
||
207 | 216 013e B040 sbci r27,hi8(-(EEPromArray+100)) |
||
208 | 217 /* #APP */ |
||
209 | 218 .163_start: |
||
210 | 219 0140 0197 sbiw r24,1 |
||
211 | 220 0142 04F0 brlt .163_finished |
||
212 | 221 0144 0E94 0000 call __eeprom_read_byte_1F2021 |
||
213 | 222 0148 0192 st z+,__tmp_reg__ |
||
214 | 223 014a 00C0 rjmp .163_start |
||
215 | 224 .163_finished: |
||
216 | 225 /* #NOAPP */ |
||
217 | 226 014c 0E94 0000 call LED_Init |
||
218 | 227 /* epilogue: frame size=0 */ |
||
219 | 228 0150 0895 ret |
||
220 | 229 /* epilogue end (size=1) */ |
||
221 | 230 /* function ReadParameterSet size 39 (38) */ |
||
222 | 232 .global main |
||
223 | 234 main: |
||
224 | 235 /* prologue: frame size=2 */ |
||
225 | 236 0152 2F92 push r2 |
||
226 | 237 0154 3F92 push r3 |
||
227 | 238 0156 4F92 push r4 |
||
228 | 239 0158 5F92 push r5 |
||
229 | 240 015a 6F92 push r6 |
||
230 | 241 015c 7F92 push r7 |
||
231 | 242 015e 8F92 push r8 |
||
232 | 243 0160 9F92 push r9 |
||
233 | 244 0162 AF92 push r10 |
||
234 | 245 0164 BF92 push r11 |
||
235 | 246 0166 CF92 push r12 |
||
236 | 247 0168 DF92 push r13 |
||
237 | 248 016a EF92 push r14 |
||
238 | 249 016c FF92 push r15 |
||
239 | 250 016e 0F93 push r16 |
||
240 | 251 0170 1F93 push r17 |
||
241 | 252 0172 CF93 push r28 |
||
242 | 253 0174 DF93 push r29 |
||
243 | 254 0176 CDB7 in r28,__SP_L__ |
||
244 | 255 0178 DEB7 in r29,__SP_H__ |
||
245 | 256 017a 2297 sbiw r28,2 |
||
246 | 257 017c 0FB6 in __tmp_reg__,__SREG__ |
||
247 | 258 017e F894 cli |
||
248 | 259 0180 DEBF out __SP_H__,r29 |
||
249 | 260 0182 0FBE out __SREG__,__tmp_reg__ |
||
250 | 261 0184 CDBF out __SP_L__,r28 |
||
251 | 262 /* prologue end (size=26) */ |
||
252 | 263 0186 14B8 out 36-0x20,__zero_reg__ |
||
253 | 264 0188 15B8 out 37-0x20,__zero_reg__ |
||
254 | 265 018a 189B sbis 35-0x20,0 |
||
255 | 266 018c 00C0 rjmp .L39 |
||
256 | 267 018e 199B sbis 35-0x20,1 |
||
257 | 268 0190 00C0 rjmp .L41 |
||
258 | 269 0192 8DE0 ldi r24,lo8(13) |
||
259 | 270 0194 8093 0000 sts PlatinenVersion,r24 |
||
260 | 271 .L43: |
||
261 | 272 0198 81E8 ldi r24,lo8(-127) |
||
262 | 273 019a 87B9 out 39-0x20,r24 |
||
263 | 274 019c 3E9A sbi 39-0x20,6 |
||
264 | 275 019e 8FEF ldi r24,lo8(-1) |
||
265 | 276 01a0 88B9 out 40-0x20,r24 |
||
266 | 277 01a2 8BE1 ldi r24,lo8(27) |
||
267 | 278 01a4 84B9 out 36-0x20,r24 |
||
268 | 279 01a6 81E0 ldi r24,lo8(1) |
||
269 | 280 01a8 85B9 out 37-0x20,r24 |
||
270 | 281 01aa 8EE3 ldi r24,lo8(62) |
||
271 | 282 01ac 8AB9 out 42-0x20,r24 |
||
272 | 283 01ae 579A sbi 42-0x20,7 |
||
273 | 284 01b0 87E4 ldi r24,lo8(71) |
||
274 | 285 01b2 8BB9 out 43-0x20,r24 |
||
275 | 286 01b4 469A sbi 40-0x20,6 |
||
276 | 287 01b6 84B7 in r24,84-0x20 |
||
277 | 288 01b8 877F andi r24,lo8(-9) |
||
278 | 289 01ba 84BF out 84-0x20,r24 |
||
279 | 290 01bc 8091 6000 lds r24,96 |
||
280 | 291 01c0 8861 ori r24,lo8(24) |
||
281 | 292 01c2 8093 6000 sts 96,r24 |
||
282 | 293 01c6 1092 6000 sts 96,__zero_reg__ |
||
283 | 294 01ca 80ED ldi r24,lo8(2000) |
||
284 | 295 01cc 97E0 ldi r25,hi8(2000) |
||
285 | 296 01ce 9093 0000 sts (beeptime)+1,r25 |
||
286 | 297 01d2 8093 0000 sts beeptime,r24 |
||
287 | 298 01d6 1092 0000 sts (StickGier)+1,__zero_reg__ |
||
288 | 299 01da 1092 0000 sts StickGier,__zero_reg__ |
||
289 | 300 01de 1092 0000 sts (PPM_in+4)+1,__zero_reg__ |
||
290 | 301 01e2 1092 0000 sts PPM_in+4,__zero_reg__ |
||
291 | 302 01e6 1092 0000 sts (StickRoll)+1,__zero_reg__ |
||
292 | 303 01ea 1092 0000 sts StickRoll,__zero_reg__ |
||
293 | 304 01ee 1092 0000 sts (StickNick)+1,__zero_reg__ |
||
294 | 305 01f2 1092 0000 sts StickNick,__zero_reg__ |
||
295 | 306 01f6 2091 0000 lds r18,PlatinenVersion |
||
296 | 307 01fa 2431 cpi r18,lo8(20) |
||
297 | 308 01fc 00F4 brsh .+2 |
||
298 | 309 01fe 00C0 rjmp .L46 |
||
299 | 310 0200 88E8 ldi r24,lo8(1160) |
||
300 | 311 0202 94E0 ldi r25,hi8(1160) |
||
301 | 312 0204 A0E0 ldi r26,hlo8(1160) |
||
302 | 313 0206 B0E0 ldi r27,hhi8(1160) |
||
303 | 314 0208 8093 0000 sts GIER_GRAD_FAKTOR,r24 |
||
304 | 315 020c 9093 0000 sts (GIER_GRAD_FAKTOR)+1,r25 |
||
305 | 316 0210 A093 0000 sts (GIER_GRAD_FAKTOR)+2,r26 |
||
306 | 317 0214 B093 0000 sts (GIER_GRAD_FAKTOR)+3,r27 |
||
307 | 318 .L48: |
||
308 | 319 0218 2A30 cpi r18,lo8(10) |
||
309 | 320 021a 01F4 brne .+2 |
||
310 | 321 021c 00C0 rjmp .L49 |
||
311 | 322 021e 2431 cpi r18,lo8(20) |
||
312 | 323 0220 01F4 brne .+2 |
||
313 | 324 0222 00C0 rjmp .L49 |
||
314 | 325 0224 289A sbi 37-0x20,0 |
||
315 | 326 .L52: |
||
316 | 327 0226 0E94 0000 call Timer_Init |
||
317 | 328 022a 0E94 0000 call TIMER2_Init |
||
318 | 329 022e 0E94 0000 call UART_Init |
||
319 | 330 0232 0E94 0000 call rc_sum_init |
||
320 | 331 0236 0E94 0000 call ADC_Init |
||
321 | 332 023a 0E94 0000 call i2c_init |
||
322 | 333 023e 0E94 0000 call SPI_MasterInit |
||
323 | 334 /* #APP */ |
||
324 | 335 0242 7894 sei |
||
325 | 336 /* #NOAPP */ |
||
326 | 337 0244 2091 0000 lds r18,PlatinenVersion |
||
327 | 338 0248 822F mov r24,r18 |
||
328 | 339 024a 6AE0 ldi r22,lo8(10) |
||
329 | 340 024c 0E94 0000 call __udivmodqi4 |
||
330 | 341 0250 492F mov r20,r25 |
||
331 | 342 0252 50E0 ldi r21,lo8(0) |
||
332 | 343 0254 822F mov r24,r18 |
||
333 | 344 0256 0E94 0000 call __udivmodqi4 |
||
334 | 345 025a 90E0 ldi r25,lo8(0) |
||
335 | 346 025c 20E7 ldi r18,lo8(112) |
||
336 | 347 025e 30E0 ldi r19,hi8(112) |
||
337 | 348 0260 3F93 push r19 |
||
338 | 349 0262 2F93 push r18 |
||
339 | 350 0264 28E4 ldi r18,lo8(72) |
||
340 | 351 0266 30E0 ldi r19,hi8(72) |
||
341 | 352 0268 3F93 push r19 |
||
342 | 353 026a 2F93 push r18 |
||
343 | 354 026c 1F92 push __zero_reg__ |
||
344 | 355 026e 1F92 push __zero_reg__ |
||
345 | 356 0270 5F93 push r21 |
||
346 | 357 0272 4F93 push r20 |
||
347 | 358 0274 9F93 push r25 |
||
348 | 359 0276 8F93 push r24 |
||
349 | 360 0278 80E0 ldi r24,lo8(__c.2416) |
||
350 | 361 027a 90E0 ldi r25,hi8(__c.2416) |
||
351 | 362 027c 9F93 push r25 |
||
352 | 363 027e 8F93 push r24 |
||
353 | 364 0280 1F92 push __zero_reg__ |
||
354 | 365 0282 0E94 0000 call _printf_P |
||
355 | 366 0286 8091 C800 lds r24,200 |
||
356 | 367 028a 2DB7 in r18,__SP_L__ |
||
357 | 368 028c 3EB7 in r19,__SP_H__ |
||
358 | 369 028e 235F subi r18,lo8(-(13)) |
||
359 | 370 0290 3F4F sbci r19,hi8(-(13)) |
||
360 | 371 0292 0FB6 in __tmp_reg__,__SREG__ |
||
361 | 372 0294 F894 cli |
||
362 | 373 0296 3EBF out __SP_H__,r19 |
||
363 | 374 0298 0FBE out __SREG__,__tmp_reg__ |
||
364 | 375 029a 2DBF out __SP_L__,r18 |
||
365 | 376 029c 8032 cpi r24,lo8(32) |
||
366 | 377 029e 01F4 brne .+2 |
||
367 | 378 02a0 00C0 rjmp .L136 |
||
368 | 379 .L53: |
||
369 | 380 02a2 80E0 ldi r24,lo8(__c.2419) |
||
370 | 381 02a4 90E0 ldi r25,hi8(__c.2419) |
||
371 | 382 02a6 9F93 push r25 |
||
372 | 383 02a8 8F93 push r24 |
||
373 | 384 02aa 1F92 push __zero_reg__ |
||
374 | 385 02ac 0E94 0000 call _printf_P |
||
375 | 386 02b0 0F90 pop __tmp_reg__ |
||
376 | 387 02b2 0F90 pop __tmp_reg__ |
||
377 | 388 02b4 0F90 pop __tmp_reg__ |
||
378 | 389 02b6 8091 0000 lds r24,PlatinenVersion |
||
379 | 390 02ba 8C30 cpi r24,lo8(12) |
||
380 | 391 02bc 00F0 brlo .+2 |
||
381 | 392 02be 00C0 rjmp .L56 |
||
382 | 393 02c0 299A sbi 37-0x20,1 |
||
383 | 394 .L58: |
||
384 | 395 02c2 49E0 ldi r20,lo8(9) |
||
385 | 396 02c4 60E0 ldi r22,lo8(EE_Parameter) |
||
386 | 397 02c6 70E0 ldi r23,hi8(EE_Parameter) |
||
387 | 398 02c8 83E0 ldi r24,lo8(3) |
||
388 | 399 02ca 0E94 0000 call ReadParameterSet |
||
389 | 400 02ce 70E0 ldi r23,lo8(EEPromArray+1) |
||
390 | 401 02d0 C72E mov r12,r23 |
||
391 | 402 02d2 70E0 ldi r23,hi8(EEPromArray+1) |
||
392 | 403 02d4 D72E mov r13,r23 |
||
393 | 404 02d6 D601 movw r26,r12 |
||
394 | 405 /* #APP */ |
||
395 | 406 02d8 0E94 0000 call __eeprom_read_byte_1F2021 |
||
396 | 407 02dc 802D mov r24,__tmp_reg__ |
||
397 | 408 /* #NOAPP */ |
||
398 | 409 02de 8A34 cpi r24,lo8(74) |
||
399 | 410 02e0 01F4 brne .+2 |
||
400 | 411 02e2 00C0 rjmp .L59 |
||
401 | 412 02e4 0E94 0000 call DefaultKonstanten1 |
||
402 | 413 02e8 80E0 ldi r24,lo8(__c.2421) |
||
403 | 414 02ea 90E0 ldi r25,hi8(__c.2421) |
||
404 | 415 02ec 9F93 push r25 |
||
405 | 416 02ee 8F93 push r24 |
||
406 | 417 02f0 1F92 push __zero_reg__ |
||
407 | 418 02f2 0E94 0000 call _printf_P |
||
408 | 419 02f6 1A82 std Y+2,__zero_reg__ |
||
409 | 420 02f8 1982 std Y+1,__zero_reg__ |
||
410 | 421 02fa 0F90 pop __tmp_reg__ |
||
411 | 422 02fc 0F90 pop __tmp_reg__ |
||
412 | 423 02fe 0F90 pop __tmp_reg__ |
||
413 | 424 0300 60E0 ldi r22,lo8(EEPromArray+80) |
||
414 | 425 0302 A62E mov r10,r22 |
||
415 | 426 0304 60E0 ldi r22,hi8(EEPromArray+80) |
||
416 | 427 0306 B62E mov r11,r22 |
||
417 | 428 0308 50E0 ldi r21,lo8(EEPromArray+81) |
||
418 | 429 030a 852E mov r8,r21 |
||
419 | 430 030c 50E0 ldi r21,hi8(EEPromArray+81) |
||
420 | 431 030e 952E mov r9,r21 |
||
421 | 432 0310 40E0 ldi r20,lo8(EEPromArray+82) |
||
422 | 433 0312 642E mov r6,r20 |
||
423 | 434 0314 40E0 ldi r20,hi8(EEPromArray+82) |
||
424 | 435 0316 742E mov r7,r20 |
||
425 | 436 0318 30E0 ldi r19,lo8(EEPromArray+83) |
||
426 | 437 031a 432E mov r4,r19 |
||
427 | 438 031c 30E0 ldi r19,hi8(EEPromArray+83) |
||
428 | 439 031e 532E mov r5,r19 |
||
429 | 440 0320 20E0 ldi r18,lo8(EEPromArray+84) |
||
430 | 441 0322 222E mov r2,r18 |
||
431 | 442 0324 20E0 ldi r18,hi8(EEPromArray+84) |
||
432 | 443 0326 322E mov r3,r18 |
||
433 | 444 0328 90E0 ldi r25,lo8(EEPromArray+87) |
||
434 | 445 032a E92E mov r14,r25 |
||
435 | 446 032c 90E0 ldi r25,hi8(EEPromArray+87) |
||
436 | 447 032e F92E mov r15,r25 |
||
437 | 448 .L61: |
||
438 | 449 0330 0981 ldd r16,Y+1 |
||
439 | 450 0332 102F mov r17,r16 |
||
440 | 451 0334 1F5F subi r17,lo8(-(1)) |
||
441 | 452 0336 1230 cpi r17,lo8(2) |
||
442 | 453 0338 01F4 brne .+2 |
||
443 | 454 033a 00C0 rjmp .L134 |
||
444 | 455 033c 1330 cpi r17,lo8(3) |
||
445 | 456 033e 01F4 brne .+2 |
||
446 | 457 0340 00C0 rjmp .L137 |
||
447 | 458 0342 1430 cpi r17,lo8(4) |
||
448 | 459 0344 00F0 brlo .+2 |
||
449 | 460 0346 00C0 rjmp .L134 |
||
450 | 461 .L65: |
||
451 | 462 0348 8091 0000 lds r24,PlatinenVersion |
||
452 | 463 034c 8431 cpi r24,lo8(20) |
||
453 | 464 034e 00F0 brlo .L69 |
||
454 | 465 0350 85E0 ldi r24,lo8(5) |
||
455 | 466 0352 8093 0000 sts EE_Parameter+24,r24 |
||
456 | 467 0356 1092 0000 sts EE_Parameter+48,__zero_reg__ |
||
457 | 468 035a 8BE1 ldi r24,lo8(27) |
||
458 | 469 035c 8093 0000 sts EE_Parameter+20,r24 |
||
459 | 470 0360 8EE4 ldi r24,lo8(78) |
||
460 | 471 0362 8093 0000 sts EE_Parameter+45,r24 |
||
461 | 472 0366 8093 0000 sts EE_Parameter+46,r24 |
||
462 | 473 .L69: |
||
463 | 474 036a D501 movw r26,r10 |
||
464 | 475 /* #APP */ |
||
465 | 476 036c 0E94 0000 call __eeprom_read_byte_1F2021 |
||
466 | 477 0370 802D mov r24,__tmp_reg__ |
||
467 | 478 /* #NOAPP */ |
||
468 | 479 0372 8C30 cpi r24,lo8(12) |
||
469 | 480 0374 00F0 brlo .+2 |
||
470 | 481 0376 00C0 rjmp .L71 |
||
471 | 482 0378 D401 movw r26,r8 |
||
472 | 483 /* #APP */ |
||
473 | 484 037a 0E94 0000 call __eeprom_read_byte_1F2021 |
||
474 | 485 037e 802D mov r24,__tmp_reg__ |
||
475 | 486 /* #NOAPP */ |
||
476 | 487 0380 8C30 cpi r24,lo8(12) |
||
477 | 488 0382 00F0 brlo .+2 |
||
478 | 489 0384 00C0 rjmp .L71 |
||
479 | 490 0386 D301 movw r26,r6 |
||
480 | 491 /* #APP */ |
||
481 | 492 0388 0E94 0000 call __eeprom_read_byte_1F2021 |
||
482 | 493 038c 802D mov r24,__tmp_reg__ |
||
483 | 494 /* #NOAPP */ |
||
484 | 495 038e 8C30 cpi r24,lo8(12) |
||
485 | 496 0390 00F0 brlo .+2 |
||
486 | 497 0392 00C0 rjmp .L71 |
||
487 | 498 0394 D201 movw r26,r4 |
||
488 | 499 /* #APP */ |
||
489 | 500 0396 0E94 0000 call __eeprom_read_byte_1F2021 |
||
490 | 501 039a 802D mov r24,__tmp_reg__ |
||
491 | 502 /* #NOAPP */ |
||
492 | 503 039c 8C30 cpi r24,lo8(12) |
||
493 | 504 039e 00F0 brlo .+2 |
||
494 | 505 03a0 00C0 rjmp .L71 |
||
495 | 506 03a2 A0E0 ldi r26,lo8(EEPromArray+80) |
||
496 | 507 03a4 B0E0 ldi r27,hi8(EEPromArray+80) |
||
497 | 508 /* #APP */ |
||
498 | 509 03a6 0E94 0000 call __eeprom_read_byte_1F2021 |
||
499 | 510 03aa 802D mov r24,__tmp_reg__ |
||
500 | 511 /* #NOAPP */ |
||
501 | 512 03ac 8093 0000 sts EE_Parameter,r24 |
||
502 | 513 03b0 A0E0 ldi r26,lo8(EEPromArray+81) |
||
503 | 514 03b2 B0E0 ldi r27,hi8(EEPromArray+81) |
||
504 | 515 /* #APP */ |
||
505 | 516 03b4 0E94 0000 call __eeprom_read_byte_1F2021 |
||
506 | 517 03b8 802D mov r24,__tmp_reg__ |
||
507 | 518 /* #NOAPP */ |
||
508 | 519 03ba 8093 0000 sts EE_Parameter+1,r24 |
||
509 | 520 03be A0E0 ldi r26,lo8(EEPromArray+82) |
||
510 | 521 03c0 B0E0 ldi r27,hi8(EEPromArray+82) |
||
511 | 522 /* #APP */ |
||
512 | 523 03c2 0E94 0000 call __eeprom_read_byte_1F2021 |
||
513 | 524 03c6 802D mov r24,__tmp_reg__ |
||
514 | 525 /* #NOAPP */ |
||
515 | 526 03c8 8093 0000 sts EE_Parameter+2,r24 |
||
516 | 527 03cc A0E0 ldi r26,lo8(EEPromArray+83) |
||
517 | 528 03ce B0E0 ldi r27,hi8(EEPromArray+83) |
||
518 | 529 /* #APP */ |
||
519 | 530 03d0 0E94 0000 call __eeprom_read_byte_1F2021 |
||
520 | 531 03d4 802D mov r24,__tmp_reg__ |
||
521 | 532 /* #NOAPP */ |
||
522 | 533 03d6 8093 0000 sts EE_Parameter+3,r24 |
||
523 | 534 03da D101 movw r26,r2 |
||
524 | 535 /* #APP */ |
||
525 | 536 03dc 0E94 0000 call __eeprom_read_byte_1F2021 |
||
526 | 537 03e0 802D mov r24,__tmp_reg__ |
||
527 | 538 /* #NOAPP */ |
||
528 | 539 03e2 8093 0000 sts EE_Parameter+4,r24 |
||
529 | 540 03e6 A0E0 ldi r26,lo8(EEPromArray+85) |
||
530 | 541 03e8 B0E0 ldi r27,hi8(EEPromArray+85) |
||
531 | 542 /* #APP */ |
||
532 | 543 03ea 0E94 0000 call __eeprom_read_byte_1F2021 |
||
533 | 544 03ee 802D mov r24,__tmp_reg__ |
||
534 | 545 /* #NOAPP */ |
||
535 | 546 03f0 8093 0000 sts EE_Parameter+5,r24 |
||
536 | 547 03f4 A0E0 ldi r26,lo8(EEPromArray+86) |
||
537 | 548 03f6 B0E0 ldi r27,hi8(EEPromArray+86) |
||
538 | 549 /* #APP */ |
||
539 | 550 03f8 0E94 0000 call __eeprom_read_byte_1F2021 |
||
540 | 551 03fc 802D mov r24,__tmp_reg__ |
||
541 | 552 /* #NOAPP */ |
||
542 | 553 03fe 8093 0000 sts EE_Parameter+6,r24 |
||
543 | 554 0402 D701 movw r26,r14 |
||
544 | 555 /* #APP */ |
||
545 | 556 0404 0E94 0000 call __eeprom_read_byte_1F2021 |
||
546 | 557 0408 802D mov r24,__tmp_reg__ |
||
547 | 558 /* #NOAPP */ |
||
548 | 559 040a 8093 0000 sts EE_Parameter+7,r24 |
||
549 | 560 040e 1130 cpi r17,lo8(1) |
||
550 | 561 0410 01F4 brne .+2 |
||
551 | 562 0412 00C0 rjmp .L138 |
||
552 | 563 .L76: |
||
553 | 564 0414 4CE5 ldi r20,lo8(92) |
||
554 | 565 0416 60E0 ldi r22,lo8(EE_Parameter) |
||
555 | 566 0418 70E0 ldi r23,hi8(EE_Parameter) |
||
556 | 567 041a 812F mov r24,r17 |
||
557 | 568 041c 0E94 0000 call WriteParameterSet |
||
558 | 569 0420 0E5F subi r16,lo8(-(2)) |
||
559 | 570 0422 0630 cpi r16,lo8(6) |
||
560 | 571 0424 00F4 brsh .L139 |
||
561 | 572 .L62: |
||
562 | 573 0426 8981 ldd r24,Y+1 |
||
563 | 574 0428 9A81 ldd r25,Y+2 |
||
564 | 575 042a 0196 adiw r24,1 |
||
565 | 576 042c 9A83 std Y+2,r25 |
||
566 | 577 042e 8983 std Y+1,r24 |
||
567 | 578 0430 00C0 rjmp .L61 |
||
568 | 579 .L71: |
||
569 | 580 0432 0E94 0000 call DefaultStickMapping |
||
570 | 581 0436 00C0 rjmp .L76 |
||
571 | 582 .L139: |
||
572 | 583 0438 83E0 ldi r24,lo8(3) |
||
573 | 584 043a 0E94 0000 call SetActiveParamSetNumber |
||
574 | 585 043e 8AE4 ldi r24,lo8(74) |
||
575 | 586 0440 D601 movw r26,r12 |
||
576 | 587 /* #APP */ |
||
577 | 588 0442 082E mov __tmp_reg__,r24 |
||
578 | 589 0444 0E94 0000 call __eeprom_write_byte_1F2021 |
||
579 | 590 /* #NOAPP */ |
||
580 | 591 .L59: |
||
581 | 592 0448 A0E0 ldi r26,lo8(EEPromArray+4) |
||
582 | 593 044a B0E0 ldi r27,hi8(EEPromArray+4) |
||
583 | 594 /* #APP */ |
||
584 | 595 044c 0E94 0000 call __eeprom_read_byte_1F2021 |
||
585 | 596 0450 802D mov r24,__tmp_reg__ |
||
586 | 597 /* #NOAPP */ |
||
587 | 598 0452 8530 cpi r24,lo8(5) |
||
588 | 599 0454 00F0 brlo .+2 |
||
589 | 600 0456 00C0 rjmp .L140 |
||
590 | 601 .L79: |
||
591 | 602 0458 0E94 0000 call GetActiveParamSetNumber |
||
592 | 603 045c 4CE5 ldi r20,lo8(92) |
||
593 | 604 045e 60E0 ldi r22,lo8(EE_Parameter) |
||
594 | 605 0460 70E0 ldi r23,hi8(EE_Parameter) |
||
595 | 606 0462 0E94 0000 call ReadParameterSet |
||
596 | 607 0466 0E94 0000 call GetActiveParamSetNumber |
||
597 | 608 046a 90E0 ldi r25,lo8(0) |
||
598 | 609 046c 9F93 push r25 |
||
599 | 610 046e 8F93 push r24 |
||
600 | 611 0470 80E0 ldi r24,lo8(__c.2433) |
||
601 | 612 0472 90E0 ldi r25,hi8(__c.2433) |
||
602 | 613 0474 9F93 push r25 |
||
603 | 614 0476 8F93 push r24 |
||
604 | 615 0478 1F92 push __zero_reg__ |
||
605 | 616 047a 0E94 0000 call _printf_P |
||
606 | 617 047e 8091 0000 lds r24,EE_Parameter+8 |
||
607 | 618 0482 0F90 pop __tmp_reg__ |
||
608 | 619 0484 0F90 pop __tmp_reg__ |
||
609 | 620 0486 0F90 pop __tmp_reg__ |
||
610 | 621 0488 0F90 pop __tmp_reg__ |
||
611 | 622 048a 0F90 pop __tmp_reg__ |
||
612 | 623 048c 80FD sbrc r24,0 |
||
613 | 624 048e 00C0 rjmp .L81 |
||
614 | 625 0490 08EE ldi r16,lo8(1000) |
||
615 | 626 0492 13E0 ldi r17,hi8(1000) |
||
616 | 627 .L83: |
||
617 | 628 0494 0E94 0000 call SetNeutral |
||
618 | 629 0498 8091 0000 lds r24,PlatinenVersion |
||
619 | 630 049c 8A30 cpi r24,lo8(10) |
||
620 | 631 049e 01F4 brne .+2 |
||
621 | 632 04a0 00C0 rjmp .L86 |
||
622 | 633 04a2 8431 cpi r24,lo8(20) |
||
623 | 634 04a4 01F4 brne .+2 |
||
624 | 635 04a6 00C0 rjmp .L86 |
||
625 | 636 04a8 289A sbi 37-0x20,0 |
||
626 | 637 .L89: |
||
627 | 638 04aa 80ED ldi r24,lo8(2000) |
||
628 | 639 04ac 97E0 ldi r25,hi8(2000) |
||
629 | 640 04ae 9093 0000 sts (beeptime)+1,r25 |
||
630 | 641 04b2 8093 0000 sts beeptime,r24 |
||
631 | 642 04b6 85E5 ldi r24,lo8(85) |
||
632 | 643 04b8 8093 0000 sts ExternControl,r24 |
||
633 | 644 04bc 80E0 ldi r24,lo8(__c.2442) |
||
634 | 645 04be 90E0 ldi r25,hi8(__c.2442) |
||
635 | 646 04c0 9F93 push r25 |
||
636 | 647 04c2 8F93 push r24 |
||
637 | 648 04c4 1F92 push __zero_reg__ |
||
638 | 649 04c6 0E94 0000 call _printf_P |
||
639 | 650 04ca 8091 0000 lds r24,EE_Parameter+8 |
||
640 | 651 04ce 0F90 pop __tmp_reg__ |
||
641 | 652 04d0 0F90 pop __tmp_reg__ |
||
642 | 653 04d2 0F90 pop __tmp_reg__ |
||
643 | 654 04d4 82FF sbrs r24,2 |
||
644 | 655 04d6 00C0 rjmp .L90 |
||
645 | 656 04d8 80E0 ldi r24,lo8(__c.2444) |
||
646 | 657 04da 90E0 ldi r25,hi8(__c.2444) |
||
647 | 658 04dc 9F93 push r25 |
||
648 | 659 04de 8F93 push r24 |
||
649 | 660 04e0 1F92 push __zero_reg__ |
||
650 | 661 04e2 0E94 0000 call _printf_P |
||
651 | 662 04e6 0F90 pop __tmp_reg__ |
||
652 | 663 04e8 0F90 pop __tmp_reg__ |
||
653 | 664 04ea 0F90 pop __tmp_reg__ |
||
654 | 665 .L92: |
||
655 | 666 04ec 80E0 ldi r24,lo8(__c.2448) |
||
656 | 667 04ee 90E0 ldi r25,hi8(__c.2448) |
||
657 | 668 04f0 9F93 push r25 |
||
658 | 669 04f2 8F93 push r24 |
||
659 | 670 04f4 1F92 push __zero_reg__ |
||
660 | 671 04f6 0E94 0000 call _printf_P |
||
661 | 672 04fa 0E94 0000 call LcdClear |
||
662 | 673 04fe 88E8 ldi r24,lo8(5000) |
||
663 | 674 0500 93E1 ldi r25,hi8(5000) |
||
664 | 675 0502 9093 0000 sts (I2CTimeout)+1,r25 |
||
665 | 676 0506 8093 0000 sts I2CTimeout,r24 |
||
666 | 677 050a 81E0 ldi r24,lo8(1) |
||
667 | 678 050c 8093 0000 sts WinkelOut+7,r24 |
||
668 | 679 0510 0F90 pop __tmp_reg__ |
||
669 | 680 0512 0F90 pop __tmp_reg__ |
||
670 | 681 0514 0F90 pop __tmp_reg__ |
||
671 | 682 .L135: |
||
672 | 683 0516 8091 0000 lds r24,UpdateMotor |
||
673 | 684 051a 8823 tst r24 |
||
674 | 685 051c 01F4 brne .+2 |
||
675 | 686 051e 00C0 rjmp .L94 |
||
676 | 687 .L143: |
||
677 | 688 0520 8091 0000 lds r24,AdReady |
||
678 | 689 0524 8823 tst r24 |
||
679 | 690 0526 01F4 brne .+2 |
||
680 | 691 0528 00C0 rjmp .L94 |
||
681 | 692 052a 1092 0000 sts UpdateMotor,__zero_reg__ |
||
682 | 693 052e 8091 0000 lds r24,WinkelOut+6 |
||
683 | 694 0532 8823 tst r24 |
||
684 | 695 0534 01F4 brne .+2 |
||
685 | 696 0536 00C0 rjmp .L97 |
||
686 | 697 0538 0E94 0000 call CalMk3Mag |
||
687 | 698 053c 0E94 0000 call SendMotorData |
||
688 | 699 0540 2091 0000 lds r18,PlatinenVersion |
||
689 | 700 0544 2A30 cpi r18,lo8(10) |
||
690 | 701 0546 01F4 brne .+2 |
||
691 | 702 0548 00C0 rjmp .L100 |
||
692 | 703 .L144: |
||
693 | 704 054a 2431 cpi r18,lo8(20) |
||
694 | 705 054c 01F4 brne .+2 |
||
695 | 706 054e 00C0 rjmp .L100 |
||
696 | 707 0550 289A sbi 37-0x20,0 |
||
697 | 708 0552 8091 0000 lds r24,PcZugriff |
||
698 | 709 0556 8823 tst r24 |
||
699 | 710 0558 01F4 brne .+2 |
||
700 | 711 055a 00C0 rjmp .L104 |
||
701 | 712 .L145: |
||
702 | 713 055c 8150 subi r24,lo8(-(-1)) |
||
703 | 714 055e 8093 0000 sts PcZugriff,r24 |
||
704 | 715 .L106: |
||
705 | 716 0562 8091 0000 lds r24,SenderOkay |
||
706 | 717 0566 8823 tst r24 |
||
707 | 718 0568 01F0 breq .L107 |
||
708 | 719 056a 8091 0000 lds r24,SenderOkay |
||
709 | 720 056e 8150 subi r24,lo8(-(-1)) |
||
710 | 721 0570 8093 0000 sts SenderOkay,r24 |
||
711 | 722 .L107: |
||
712 | 723 0574 8091 0000 lds r24,I2CTimeout |
||
713 | 724 0578 9091 0000 lds r25,(I2CTimeout)+1 |
||
714 | 725 057c 892B or r24,r25 |
||
715 | 726 057e 01F4 brne .+2 |
||
716 | 727 0580 00C0 rjmp .L141 |
||
717 | 728 0582 8091 0000 lds r24,I2CTimeout |
||
718 | 729 0586 9091 0000 lds r25,(I2CTimeout)+1 |
||
719 | 730 058a 0197 sbiw r24,1 |
||
720 | 731 058c 9093 0000 sts (I2CTimeout)+1,r25 |
||
721 | 732 0590 8093 0000 sts I2CTimeout,r24 |
||
722 | 733 0594 2A30 cpi r18,lo8(10) |
||
723 | 734 0596 01F4 brne .+2 |
||
724 | 735 0598 00C0 rjmp .L114 |
||
725 | 736 059a 2431 cpi r18,lo8(20) |
||
726 | 737 059c 01F4 brne .+2 |
||
727 | 738 059e 00C0 rjmp .L114 |
||
728 | 739 05a0 289A sbi 37-0x20,0 |
||
729 | 740 .L111: |
||
730 | 741 05a2 8091 0000 lds r24,UpdateMotor |
||
731 | 742 05a6 8823 tst r24 |
||
732 | 743 05a8 01F0 breq .L117 |
||
733 | 744 05aa 8091 0000 lds r24,MotorenEin |
||
734 | 745 05ae 8823 tst r24 |
||
735 | 746 05b0 01F0 breq .+2 |
||
736 | 747 05b2 00C0 rjmp .L119 |
||
737 | 748 .L117: |
||
738 | 749 05b4 0E94 0000 call DatenUebertragung |
||
739 | 750 05b8 0E94 0000 call BearbeiteRxDaten |
||
740 | 751 .L120: |
||
741 | 752 05bc C801 movw r24,r16 |
||
742 | 753 05be 0E94 0000 call CheckDelay |
||
743 | 754 05c2 8823 tst r24 |
||
744 | 755 05c4 01F0 breq .L121 |
||
745 | 756 05c6 2091 0000 lds r18,UBat |
||
746 | 757 05ca 3091 0000 lds r19,(UBat)+1 |
||
747 | 758 05ce 8091 0000 lds r24,EE_Parameter+25 |
||
748 | 759 05d2 90E0 ldi r25,lo8(0) |
||
749 | 760 05d4 2817 cp r18,r24 |
||
750 | 761 05d6 3907 cpc r19,r25 |
||
751 | 762 05d8 04F4 brge .L123 |
||
752 | 763 05da 8091 0000 lds r24,BeepMuster |
||
753 | 764 05de 9091 0000 lds r25,(BeepMuster)+1 |
||
754 | 765 05e2 8F5F subi r24,lo8(-1) |
||
755 | 766 05e4 9F4F sbci r25,hi8(-1) |
||
756 | 767 05e6 01F4 brne .+2 |
||
757 | 768 05e8 00C0 rjmp .L142 |
||
758 | 769 .L123: |
||
759 | 770 05ea 0E94 0000 call SPI_StartTransmitPacket |
||
760 | 771 05ee 84E0 ldi r24,lo8(4) |
||
761 | 772 05f0 8093 0000 sts SendSPI,r24 |
||
762 | 773 05f4 84E1 ldi r24,lo8(20) |
||
763 | 774 05f6 90E0 ldi r25,hi8(20) |
||
764 | 775 05f8 0E94 0000 call SetDelay |
||
765 | 776 05fc 8C01 movw r16,r24 |
||
766 | 777 .L121: |
||
767 | 778 05fe 0E94 0000 call LED_Update |
||
768 | 779 .L94: |
||
769 | 780 0602 8091 0000 lds r24,SendSPI |
||
770 | 781 0606 8823 tst r24 |
||
771 | 782 0608 01F0 breq .+2 |
||
772 | 783 060a 00C0 rjmp .L135 |
||
773 | 784 060c 0E94 0000 call SPI_TransmitByte |
||
774 | 785 0610 8091 0000 lds r24,UpdateMotor |
||
775 | 786 0614 8823 tst r24 |
||
776 | 787 0616 01F0 breq .L94 |
||
777 | 788 0618 00C0 rjmp .L143 |
||
778 | 789 .L97: |
||
779 | 790 061a 0E94 0000 call MotorRegler |
||
780 | 791 061e 0E94 0000 call SendMotorData |
||
781 | 792 0622 2091 0000 lds r18,PlatinenVersion |
||
782 | 793 0626 2A30 cpi r18,lo8(10) |
||
783 | 794 0628 01F0 breq .+2 |
||
784 | 795 062a 00C0 rjmp .L144 |
||
785 | 796 .L100: |
||
786 | 797 062c 2898 cbi 37-0x20,0 |
||
787 | 798 062e 8091 0000 lds r24,PcZugriff |
||
788 | 799 0632 8823 tst r24 |
||
789 | 800 0634 01F0 breq .+2 |
||
790 | 801 0636 00C0 rjmp .L145 |
||
791 | 802 .L104: |
||
792 | 803 0638 1092 0000 sts ExternControl+10,__zero_reg__ |
||
793 | 804 063c 1092 0000 sts (ExternStickNick)+1,__zero_reg__ |
||
794 | 805 0640 1092 0000 sts ExternStickNick,__zero_reg__ |
||
795 | 806 0644 1092 0000 sts (ExternStickRoll)+1,__zero_reg__ |
||
796 | 807 0648 1092 0000 sts ExternStickRoll,__zero_reg__ |
||
797 | 808 064c 1092 0000 sts (ExternStickGier)+1,__zero_reg__ |
||
798 | 809 0650 1092 0000 sts ExternStickGier,__zero_reg__ |
||
799 | 810 0654 00C0 rjmp .L106 |
||
800 | 811 .L114: |
||
801 | 812 0656 2898 cbi 37-0x20,0 |
||
802 | 813 0658 00C0 rjmp .L111 |
||
803 | 814 .L141: |
||
804 | 815 065a 85E0 ldi r24,lo8(5) |
||
805 | 816 065c 90E0 ldi r25,hi8(5) |
||
806 | 817 065e 9093 0000 sts (I2CTimeout)+1,r25 |
||
807 | 818 0662 8093 0000 sts I2CTimeout,r24 |
||
808 | 819 0666 0E94 0000 call i2c_reset |
||
809 | 820 066a 8091 0000 lds r24,BeepMuster |
||
810 | 821 066e 9091 0000 lds r25,(BeepMuster)+1 |
||
811 | 822 0672 8F5F subi r24,lo8(-1) |
||
812 | 823 0674 9F4F sbci r25,hi8(-1) |
||
813 | 824 0676 01F0 breq .+2 |
||
814 | 825 0678 00C0 rjmp .L111 |
||
815 | 826 067a 8091 0000 lds r24,MotorenEin |
||
816 | 827 067e 8823 tst r24 |
||
817 | 828 0680 01F4 brne .+2 |
||
818 | 829 0682 00C0 rjmp .L111 |
||
819 | 830 0684 80E1 ldi r24,lo8(10000) |
||
820 | 831 0686 97E2 ldi r25,hi8(10000) |
||
821 | 832 0688 9093 0000 sts (beeptime)+1,r25 |
||
822 | 833 068c 8093 0000 sts beeptime,r24 |
||
823 | 834 0690 80E8 ldi r24,lo8(128) |
||
824 | 835 0692 90E0 ldi r25,hi8(128) |
||
825 | 836 0694 9093 0000 sts (BeepMuster)+1,r25 |
||
826 | 837 0698 8093 0000 sts BeepMuster,r24 |
||
827 | 838 069c 00C0 rjmp .L111 |
||
828 | 839 .L119: |
||
829 | 840 069e 0E94 0000 call BearbeiteRxDaten |
||
830 | 841 06a2 00C0 rjmp .L120 |
||
831 | 842 .L142: |
||
832 | 843 06a4 80E7 ldi r24,lo8(6000) |
||
833 | 844 06a6 97E1 ldi r25,hi8(6000) |
||
834 | 845 06a8 9093 0000 sts (beeptime)+1,r25 |
||
835 | 846 06ac 8093 0000 sts beeptime,r24 |
||
836 | 847 06b0 80E0 ldi r24,lo8(768) |
||
837 | 848 06b2 93E0 ldi r25,hi8(768) |
||
838 | 849 06b4 9093 0000 sts (BeepMuster)+1,r25 |
||
839 | 850 06b8 8093 0000 sts BeepMuster,r24 |
||
840 | 851 06bc 00C0 rjmp .L123 |
||
841 | 852 .L134: |
||
842 | 853 06be 0E94 0000 call DefaultKonstanten2 |
||
843 | 854 06c2 00C0 rjmp .L65 |
||
844 | 855 .L90: |
||
845 | 856 06c4 80E0 ldi r24,lo8(__c.2446) |
||
846 | 857 06c6 90E0 ldi r25,hi8(__c.2446) |
||
847 | 858 06c8 9F93 push r25 |
||
848 | 859 06ca 8F93 push r24 |
||
849 | 860 06cc 1F92 push __zero_reg__ |
||
850 | 861 06ce 0E94 0000 call _printf_P |
||
851 | 862 06d2 0F90 pop __tmp_reg__ |
||
852 | 863 06d4 0F90 pop __tmp_reg__ |
||
853 | 864 06d6 0F90 pop __tmp_reg__ |
||
854 | 865 06d8 00C0 rjmp .L92 |
||
855 | 866 .L86: |
||
856 | 867 06da 2898 cbi 37-0x20,0 |
||
857 | 868 06dc 00C0 rjmp .L89 |
||
858 | 869 .L56: |
||
859 | 870 06de 2998 cbi 37-0x20,1 |
||
860 | 871 06e0 00C0 rjmp .L58 |
||
861 | 872 .L136: |
||
862 | 873 06e2 8091 CA00 lds r24,202 |
||
863 | 874 06e6 8630 cpi r24,lo8(6) |
||
864 | 875 06e8 01F0 breq .+2 |
||
865 | 876 06ea 00C0 rjmp .L53 |
||
866 | 877 06ec 0E94 0000 call Uart1Init |
||
867 | 878 06f0 00C0 rjmp .L53 |
||
868 | 879 .L81: |
||
869 | 880 06f2 80E0 ldi r24,lo8(__c.2435) |
||
870 | 881 06f4 90E0 ldi r25,hi8(__c.2435) |
||
871 | 882 06f6 9F93 push r25 |
||
872 | 883 06f8 8F93 push r24 |
||
873 | 884 06fa 1F92 push __zero_reg__ |
||
874 | 885 06fc 0E94 0000 call _printf_P |
||
875 | 886 0700 88EE ldi r24,lo8(1000) |
||
876 | 887 0702 93E0 ldi r25,hi8(1000) |
||
877 | 888 0704 0E94 0000 call SetDelay |
||
878 | 889 0708 8C01 movw r16,r24 |
||
879 | 890 070a 0E94 0000 call SucheLuftruckOffset |
||
880 | 891 070e 0F90 pop __tmp_reg__ |
||
881 | 892 0710 0F90 pop __tmp_reg__ |
||
882 | 893 0712 0F90 pop __tmp_reg__ |
||
883 | 894 .L84: |
||
884 | 895 0714 C801 movw r24,r16 |
||
885 | 896 0716 0E94 0000 call CheckDelay |
||
886 | 897 071a 8823 tst r24 |
||
887 | 898 071c 01F0 breq .L84 |
||
888 | 899 071e 80E0 ldi r24,lo8(__c.2440) |
||
889 | 900 0720 90E0 ldi r25,hi8(__c.2440) |
||
890 | 901 0722 9F93 push r25 |
||
891 | 902 0724 8F93 push r24 |
||
892 | 903 0726 1F92 push __zero_reg__ |
||
893 | 904 0728 0E94 0000 call _printf_P |
||
894 | 905 072c 0F90 pop __tmp_reg__ |
||
895 | 906 072e 0F90 pop __tmp_reg__ |
||
896 | 907 0730 0F90 pop __tmp_reg__ |
||
897 | 908 0732 00C0 rjmp .L83 |
||
898 | 909 .L49: |
||
899 | 910 0734 2898 cbi 37-0x20,0 |
||
900 | 911 0736 00C0 rjmp .L52 |
||
901 | 912 .L137: |
||
902 | 913 0738 0E94 0000 call DefaultKonstanten3 |
||
903 | 914 073c 00C0 rjmp .L65 |
||
904 | 915 .L138: |
||
905 | 916 073e E0E0 ldi r30,lo8(__c.2425) |
||
906 | 917 0740 F0E0 ldi r31,hi8(__c.2425) |
||
907 | 918 0742 FF93 push r31 |
||
908 | 919 0744 EF93 push r30 |
||
909 | 920 0746 1F92 push __zero_reg__ |
||
910 | 921 0748 0E94 0000 call _printf_P |
||
911 | 922 074c 4CE5 ldi r20,lo8(92) |
||
912 | 923 074e 60E0 ldi r22,lo8(EE_Parameter) |
||
913 | 924 0750 70E0 ldi r23,hi8(EE_Parameter) |
||
914 | 925 0752 81E0 ldi r24,lo8(1) |
||
915 | 926 0754 0E94 0000 call WriteParameterSet |
||
916 | 927 0758 0F90 pop __tmp_reg__ |
||
917 | 928 075a 0F90 pop __tmp_reg__ |
||
918 | 929 075c 0F90 pop __tmp_reg__ |
||
919 | 930 075e 00C0 rjmp .L62 |
||
920 | 931 .L140: |
||
921 | 932 0760 80E0 ldi r24,lo8(__c.2431) |
||
922 | 933 0762 90E0 ldi r25,hi8(__c.2431) |
||
923 | 934 0764 9F93 push r25 |
||
924 | 935 0766 8F93 push r24 |
||
925 | 936 0768 1F92 push __zero_reg__ |
||
926 | 937 076a 0E94 0000 call _printf_P |
||
927 | 938 076e 0F90 pop __tmp_reg__ |
||
928 | 939 0770 0F90 pop __tmp_reg__ |
||
929 | 940 0772 0F90 pop __tmp_reg__ |
||
930 | 941 0774 00C0 rjmp .L79 |
||
931 | 942 .L41: |
||
932 | 943 0776 8BE0 ldi r24,lo8(11) |
||
933 | 944 0778 8093 0000 sts PlatinenVersion,r24 |
||
934 | 945 077c 00C0 rjmp .L43 |
||
935 | 946 .L39: |
||
936 | 947 077e 199B sbis 35-0x20,1 |
||
937 | 948 0780 00C0 rjmp .L44 |
||
938 | 949 0782 84E1 ldi r24,lo8(20) |
||
939 | 950 0784 8093 0000 sts PlatinenVersion,r24 |
||
940 | 951 0788 00C0 rjmp .L43 |
||
941 | 952 .L46: |
||
942 | 953 078a 8BE0 ldi r24,lo8(1291) |
||
943 | 954 078c 95E0 ldi r25,hi8(1291) |
||
944 | 955 078e A0E0 ldi r26,hlo8(1291) |
||
945 | 956 0790 B0E0 ldi r27,hhi8(1291) |
||
946 | 957 0792 8093 0000 sts GIER_GRAD_FAKTOR,r24 |
||
947 | 958 0796 9093 0000 sts (GIER_GRAD_FAKTOR)+1,r25 |
||
948 | 959 079a A093 0000 sts (GIER_GRAD_FAKTOR)+2,r26 |
||
949 | 960 079e B093 0000 sts (GIER_GRAD_FAKTOR)+3,r27 |
||
950 | 961 07a2 00C0 rjmp .L48 |
||
951 | 962 .L44: |
||
952 | 963 07a4 8AE0 ldi r24,lo8(10) |
||
953 | 964 07a6 8093 0000 sts PlatinenVersion,r24 |
||
954 | 965 07aa 00C0 rjmp .L43 |
||
955 | 966 /* epilogue: frame size=2 */ |
||
956 | 967 /* epilogue: noreturn */ |
||
957 | 968 /* epilogue end (size=0) */ |
||
958 | 969 /* function main size 831 (805) */ |
||
959 | 971 .global PlatinenVersion |
||
960 | 972 .data |
||
961 | 975 PlatinenVersion: |
||
962 | 976 0000 0A .byte 10 |
||
963 | 977 .global SendVersionToNavi |
||
964 | 980 SendVersionToNavi: |
||
965 | 981 0001 01 .byte 1 |
||
966 | 982 .section .progmem.data,"a",@progbits |
||
967 | 985 __c.2448: |
||
968 | 986 0000 0A0A 0D00 .string "\n\n\r" |
||
969 | 989 __c.2446: |
||
970 | 990 0004 4E65 7574 .string "Neutral" |
||
971 | 990 7261 6C00 |
||
972 | 993 __c.2444: |
||
973 | 994 000c 4865 6164 .string "HeadingHold" |
||
974 | 994 696E 6748 |
||
975 | 994 6F6C 6400 |
||
976 | 997 __c.2442: |
||
977 | 998 0018 0A0D 5374 .string "\n\rSteuerung: " |
||
978 | 998 6575 6572 |
||
979 | 998 756E 673A |
||
980 | 998 2000 |
||
981 | 1001 __c.2440: |
||
982 | 1002 0026 4F4B 0A0D .string "OK\n\r" |
||
983 | 1002 00 |
||
984 | 1005 __c.2435: |
||
985 | 1006 002b 0A0D 4162 .string "\n\rAbgleich Luftdrucksensor.." |
||
986 | 1006 676C 6569 |
||
987 | 1006 6368 204C |
||
988 | 1006 7566 7464 |
||
989 | 1006 7275 636B |
||
990 | 1009 __c.2433: |
||
991 | 1010 0048 0A0D 4265 .string "\n\rBenutze Parametersatz %d" |
||
992 | 1010 6E75 747A |
||
993 | 1010 6520 5061 |
||
994 | 1010 7261 6D65 |
||
995 | 1010 7465 7273 |
||
996 | 1013 __c.2431: |
||
997 | 1014 0063 0A0D 4143 .string "\n\rACC nicht abgeglichen!" |
||
998 | 1014 4320 6E69 |
||
999 | 1014 6368 7420 |
||
1000 | 1014 6162 6765 |
||
1001 | 1014 676C 6963 |
||
1002 | 1017 __c.2425: |
||
1003 | 1018 007c 3A20 4765 .string ": Generating Default-Parameter using old Stick Settings" |
||
1004 | 1018 6E65 7261 |
||
1005 | 1018 7469 6E67 |
||
1006 | 1018 2044 6566 |
||
1007 | 1018 6175 6C74 |
||
1008 | 1021 __c.2421: |
||
1009 | 1022 00b4 0A0D 496E .string "\n\rInit. EEPROM" |
||
1010 | 1022 6974 2E20 |
||
1011 | 1022 4545 5052 |
||
1012 | 1022 4F4D 00 |
||
1013 | 1025 __c.2419: |
||
1014 | 1026 00c3 0A0D 3D3D .string "\n\r==============================" |
||
1015 | 1026 3D3D 3D3D |
||
1016 | 1026 3D3D 3D3D |
||
1017 | 1026 3D3D 3D3D |
||
1018 | 1026 3D3D 3D3D |
||
1019 | 1029 __c.2416: |
||
1020 | 1030 00e4 0A0D 466C .string "\n\rFlightControl\n\rHardware:%d.%d\n\rSoftware:V%d.%d%c " |
||
1021 | 1030 6967 6874 |
||
1022 | 1030 436F 6E74 |
||
1023 | 1030 726F 6C0A |
||
1024 | 1030 0D48 6172 |
||
1025 | 1031 .data |
||
1026 | 1034 stick.2399: |
||
1027 | 1035 0002 01 .byte 1 |
||
1028 | 1036 .global EEPromArray |
||
1029 | 1037 .section .eeprom,"aw",@progbits |
||
1030 | 1040 EEPromArray: |
||
1031 | 1041 0000 0000 0000 .skip 2048,0 |
||
1032 | 1041 0000 0000 |
||
1033 | 1041 0000 0000 |
||
1034 | 1041 0000 0000 |
||
1035 | 1041 0000 0000 |
||
1036 | 1042 /* File "main.c": code 1022 = 0x03fe ( 994), prologues 26, epilogues 2 */ |
||
1037 | DEFINED SYMBOLS |
||
1038 | *ABS*:00000000 main.c |
||
1193 | kmpec | 1039 | C:\DOKUME~1\David\LOKALE~1\Temp/ccW5YAp7.s:2 *ABS*:0000003f __SREG__ |
1040 | C:\DOKUME~1\David\LOKALE~1\Temp/ccW5YAp7.s:3 *ABS*:0000003e __SP_H__ |
||
1041 | C:\DOKUME~1\David\LOKALE~1\Temp/ccW5YAp7.s:4 *ABS*:0000003d __SP_L__ |
||
1042 | C:\DOKUME~1\David\LOKALE~1\Temp/ccW5YAp7.s:5 *ABS*:00000000 __tmp_reg__ |
||
1043 | C:\DOKUME~1\David\LOKALE~1\Temp/ccW5YAp7.s:6 *ABS*:00000001 __zero_reg__ |
||
1044 | C:\DOKUME~1\David\LOKALE~1\Temp/ccW5YAp7.s:12 .text:00000000 SetActiveParamSetNumber |
||
1045 | C:\DOKUME~1\David\LOKALE~1\Temp/ccW5YAp7.s:1040 .eeprom:00000000 EEPromArray |
||
1046 | C:\DOKUME~1\David\LOKALE~1\Temp/ccW5YAp7.s:37 .text:00000018 GetActiveParamSetNumber |
||
1047 | C:\DOKUME~1\David\LOKALE~1\Temp/ccW5YAp7.s:66 .text:0000003c CalMk3Mag |
||
1048 | C:\DOKUME~1\David\LOKALE~1\Temp/ccW5YAp7.s:1034 .data:00000002 stick.2399 |
||
1049 | C:\DOKUME~1\David\LOKALE~1\Temp/ccW5YAp7.s:122 .text:000000ac WriteParameterSet |
||
1050 | C:\DOKUME~1\David\LOKALE~1\Temp/ccW5YAp7.s:149 .text:000000d8 .117_start |
||
1051 | C:\DOKUME~1\David\LOKALE~1\Temp/ccW5YAp7.s:155 .text:000000e4 .117_finished |
||
1052 | C:\DOKUME~1\David\LOKALE~1\Temp/ccW5YAp7.s:190 .text:00000114 ReadParameterSet |
||
1053 | C:\DOKUME~1\David\LOKALE~1\Temp/ccW5YAp7.s:218 .text:00000140 .163_start |
||
1054 | C:\DOKUME~1\David\LOKALE~1\Temp/ccW5YAp7.s:224 .text:0000014c .163_finished |
||
1055 | C:\DOKUME~1\David\LOKALE~1\Temp/ccW5YAp7.s:234 .text:00000152 main |
||
1056 | C:\DOKUME~1\David\LOKALE~1\Temp/ccW5YAp7.s:975 .data:00000000 PlatinenVersion |
||
1057 | C:\DOKUME~1\David\LOKALE~1\Temp/ccW5YAp7.s:1029 .progmem.data:000000e4 __c.2416 |
||
1058 | C:\DOKUME~1\David\LOKALE~1\Temp/ccW5YAp7.s:1025 .progmem.data:000000c3 __c.2419 |
||
1059 | C:\DOKUME~1\David\LOKALE~1\Temp/ccW5YAp7.s:1021 .progmem.data:000000b4 __c.2421 |
||
1060 | C:\DOKUME~1\David\LOKALE~1\Temp/ccW5YAp7.s:1009 .progmem.data:00000048 __c.2433 |
||
1061 | C:\DOKUME~1\David\LOKALE~1\Temp/ccW5YAp7.s:997 .progmem.data:00000018 __c.2442 |
||
1062 | C:\DOKUME~1\David\LOKALE~1\Temp/ccW5YAp7.s:993 .progmem.data:0000000c __c.2444 |
||
1063 | C:\DOKUME~1\David\LOKALE~1\Temp/ccW5YAp7.s:985 .progmem.data:00000000 __c.2448 |
||
1064 | C:\DOKUME~1\David\LOKALE~1\Temp/ccW5YAp7.s:989 .progmem.data:00000004 __c.2446 |
||
1065 | C:\DOKUME~1\David\LOKALE~1\Temp/ccW5YAp7.s:1005 .progmem.data:0000002b __c.2435 |
||
1066 | C:\DOKUME~1\David\LOKALE~1\Temp/ccW5YAp7.s:1001 .progmem.data:00000026 __c.2440 |
||
1067 | C:\DOKUME~1\David\LOKALE~1\Temp/ccW5YAp7.s:1017 .progmem.data:0000007c __c.2425 |
||
1068 | C:\DOKUME~1\David\LOKALE~1\Temp/ccW5YAp7.s:1013 .progmem.data:00000063 __c.2431 |
||
1069 | C:\DOKUME~1\David\LOKALE~1\Temp/ccW5YAp7.s:980 .data:00000001 SendVersionToNavi |
||
1189 | kmpec | 1070 | |
1071 | UNDEFINED SYMBOLS |
||
1072 | __do_copy_data |
||
1073 | __do_clear_bss |
||
1074 | __eeprom_write_byte_1F2021 |
||
1075 | __eeprom_read_byte_1F2021 |
||
1076 | EE_Parameter |
||
1077 | PPM_in |
||
1078 | WinkelOut |
||
1079 | beeptime |
||
1080 | Piep |
||
1081 | DebugOut |
||
1082 | __eeprom_write_block_1F2021 |
||
1083 | LED_Init |
||
1084 | StickGier |
||
1085 | StickRoll |
||
1086 | StickNick |
||
1087 | GIER_GRAD_FAKTOR |
||
1088 | Timer_Init |
||
1089 | TIMER2_Init |
||
1090 | UART_Init |
||
1091 | rc_sum_init |
||
1092 | ADC_Init |
||
1093 | i2c_init |
||
1094 | SPI_MasterInit |
||
1095 | __udivmodqi4 |
||
1096 | _printf_P |
||
1097 | DefaultKonstanten1 |
||
1098 | DefaultStickMapping |
||
1099 | SetNeutral |
||
1100 | ExternControl |
||
1101 | LcdClear |
||
1102 | I2CTimeout |
||
1103 | UpdateMotor |
||
1104 | AdReady |
||
1105 | SendMotorData |
||
1106 | PcZugriff |
||
1107 | SenderOkay |
||
1108 | MotorenEin |
||
1109 | DatenUebertragung |
||
1110 | BearbeiteRxDaten |
||
1111 | CheckDelay |
||
1112 | UBat |
||
1113 | BeepMuster |
||
1114 | SPI_StartTransmitPacket |
||
1115 | SendSPI |
||
1116 | SetDelay |
||
1117 | LED_Update |
||
1118 | SPI_TransmitByte |
||
1119 | MotorRegler |
||
1120 | ExternStickNick |
||
1121 | ExternStickRoll |
||
1122 | ExternStickGier |
||
1123 | i2c_reset |
||
1124 | DefaultKonstanten2 |
||
1125 | Uart1Init |
||
1126 | SucheLuftruckOffset |
||
1127 | DefaultKonstanten3 |