Subversion Repositories FlightCtrl

Rev

Go to most recent revision | Details | 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
1039
C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccRl0yRh.s:2      *ABS*:0000003f __SREG__
1040
C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccRl0yRh.s:3      *ABS*:0000003e __SP_H__
1041
C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccRl0yRh.s:4      *ABS*:0000003d __SP_L__
1042
C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccRl0yRh.s:5      *ABS*:00000000 __tmp_reg__
1043
C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccRl0yRh.s:6      *ABS*:00000001 __zero_reg__
1044
C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccRl0yRh.s:12     .text:00000000 SetActiveParamSetNumber
1045
C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccRl0yRh.s:1040   .eeprom:00000000 EEPromArray
1046
C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccRl0yRh.s:37     .text:00000018 GetActiveParamSetNumber
1047
C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccRl0yRh.s:66     .text:0000003c CalMk3Mag
1048
C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccRl0yRh.s:1034   .data:00000002 stick.2399
1049
C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccRl0yRh.s:122    .text:000000ac WriteParameterSet
1050
C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccRl0yRh.s:149    .text:000000d8 .117_start
1051
C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccRl0yRh.s:155    .text:000000e4 .117_finished
1052
C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccRl0yRh.s:190    .text:00000114 ReadParameterSet
1053
C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccRl0yRh.s:218    .text:00000140 .163_start
1054
C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccRl0yRh.s:224    .text:0000014c .163_finished
1055
C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccRl0yRh.s:234    .text:00000152 main
1056
C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccRl0yRh.s:975    .data:00000000 PlatinenVersion
1057
C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccRl0yRh.s:1029   .progmem.data:000000e4 __c.2416
1058
C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccRl0yRh.s:1025   .progmem.data:000000c3 __c.2419
1059
C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccRl0yRh.s:1021   .progmem.data:000000b4 __c.2421
1060
C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccRl0yRh.s:1009   .progmem.data:00000048 __c.2433
1061
C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccRl0yRh.s:997    .progmem.data:00000018 __c.2442
1062
C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccRl0yRh.s:993    .progmem.data:0000000c __c.2444
1063
C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccRl0yRh.s:985    .progmem.data:00000000 __c.2448
1064
C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccRl0yRh.s:989    .progmem.data:00000004 __c.2446
1065
C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccRl0yRh.s:1005   .progmem.data:0000002b __c.2435
1066
C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccRl0yRh.s:1001   .progmem.data:00000026 __c.2440
1067
C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccRl0yRh.s:1017   .progmem.data:0000007c __c.2425
1068
C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccRl0yRh.s:1013   .progmem.data:00000063 __c.2431
1069
C:\DOKUME~1\DPeters\LOKALE~1\Temp/ccRl0yRh.s:980    .data:00000001 SendVersionToNavi
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