Subversion Repositories FlightCtrl

Rev

Details | Last modification | View Log | RSS feed

Rev Author Line No. Line
1564 LPDunwell 1
   1               		.file	"analog.c"
2
   2               	__SREG__ = 0x3f
3
   3               	__SP_H__ = 0x3e
4
   4               	__SP_L__ = 0x3d
5
   5               	__CCP__  = 0x34
6
   6               	__tmp_reg__ = 0
7
   7               	__zero_reg__ = 1
8
   8               		.text
9
   9               	.global	ADC_Init
10
  11               	ADC_Init:
11
  12               	/* prologue: function */
12
  13               	/* frame size = 0 */
13
  14 0000 9FB7      		in r25,__SREG__
14
  15               	/* #APP */
15
  16               	 ;  93 "analog.c" 1
16
  17 0002 F894      		cli
17
  18               	 ;  0 "" 2
18
  19               	/* #NOAPP */
19
  20 0004 11B8      		out 33-32,__zero_reg__
20
  21 0006 12B8      		out 34-32,__zero_reg__
21
  22 0008 8FEF      		ldi r24,lo8(-1)
22
  23 000a 8093 7E00 		sts 126,r24
23
  24 000e ECE7      		ldi r30,lo8(124)
24
  25 0010 F0E0      		ldi r31,hi8(124)
25
  26 0012 8081      		ld r24,Z
26
  27 0014 8F71      		andi r24,lo8(31)
27
  28 0016 8083      		st Z,r24
28
  29 0018 8081      		ld r24,Z
29
  30 001a 807E      		andi r24,lo8(-32)
30
  31 001c 8083      		st Z,r24
31
  32 001e AAE7      		ldi r26,lo8(122)
32
  33 0020 B0E0      		ldi r27,hi8(122)
33
  34 0022 87E0      		ldi r24,lo8(7)
34
  35 0024 8C93      		st X,r24
35
  36 0026 EBE7      		ldi r30,lo8(123)
36
  37 0028 F0E0      		ldi r31,hi8(123)
37
  38 002a 8081      		ld r24,Z
38
  39 002c 887F      		andi r24,lo8(-8)
39
  40 002e 8083      		st Z,r24
40
  41 0030 8C91      		ld r24,X
41
  42 0032 886C      		ori r24,lo8(-56)
42
  43 0034 8C93      		st X,r24
43
  44 0036 9FBF      		out __SREG__,r25
44
  45               	/* epilogue start */
45
  46 0038 0895      		ret
46
  48               	.global	__vector_24
47
  50               	__vector_24:
48
  51 003a 1F92      		push __zero_reg__
49
  52 003c 0F92      		push r0
50
  53 003e 0FB6      		in r0,__SREG__
51
  54 0040 0F92      		push r0
52
  55 0042 1124      		clr __zero_reg__
53
  56 0044 7F92      		push r7
54
  57 0046 8F92      		push r8
55
  58 0048 9F92      		push r9
56
  59 004a AF92      		push r10
57
  60 004c BF92      		push r11
58
  61 004e CF92      		push r12
59
  62 0050 DF92      		push r13
60
  63 0052 EF92      		push r14
61
  64 0054 FF92      		push r15
62
  65 0056 0F93      		push r16
63
  66 0058 1F93      		push r17
64
  67 005a 2F93      		push r18
65
  68 005c 3F93      		push r19
66
  69 005e 4F93      		push r20
67
  70 0060 5F93      		push r21
68
  71 0062 6F93      		push r22
69
  72 0064 7F93      		push r23
70
  73 0066 8F93      		push r24
71
  74 0068 9F93      		push r25
72
  75 006a AF93      		push r26
73
  76 006c BF93      		push r27
74
  77 006e EF93      		push r30
75
  78 0070 FF93      		push r31
76
  79               	/* prologue: Signal */
77
  80               	/* frame size = 0 */
78
  81 0072 7090 0000 		lds r7,state.1866
79
  82 0076 872D      		mov r24,r7
80
  83 0078 7394      		inc r7
81
  84 007a 7092 0000 		sts state.1866,r7
82
  85 007e E82F      		mov r30,r24
83
  86 0080 F0E0      		ldi r31,lo8(0)
84
  87 0082 E231      		cpi r30,18
85
  88 0084 F105      		cpc r31,__zero_reg__
86
  89 0086 00F0      		brlo .L45
87
  90 0088 82E0      		ldi r24,lo8(2)
88
  91 008a 8093 0000 		sts ad_channel.1865,r24
89
  92 008e 1092 0000 		sts state.1866,__zero_reg__
90
  93 0092 8091 7C00 		lds r24,124
91
  94 0096 807E      		andi r24,lo8(-32)
92
  95 0098 8260      		ori r24,lo8(2)
93
  96 009a 8093 7C00 		sts 124,r24
94
  97               	.L41:
95
  98               	/* epilogue start */
96
  99 009e FF91      		pop r31
97
 100 00a0 EF91      		pop r30
98
 101 00a2 BF91      		pop r27
99
 102 00a4 AF91      		pop r26
100
 103 00a6 9F91      		pop r25
101
 104 00a8 8F91      		pop r24
102
 105 00aa 7F91      		pop r23
103
 106 00ac 6F91      		pop r22
104
 107 00ae 5F91      		pop r21
105
 108 00b0 4F91      		pop r20
106
 109 00b2 3F91      		pop r19
107
 110 00b4 2F91      		pop r18
108
 111 00b6 1F91      		pop r17
109
 112 00b8 0F91      		pop r16
110
 113 00ba FF90      		pop r15
111
 114 00bc EF90      		pop r14
112
 115 00be DF90      		pop r13
113
 116 00c0 CF90      		pop r12
114
 117 00c2 BF90      		pop r11
115
 118 00c4 AF90      		pop r10
116
 119 00c6 9F90      		pop r9
117
 120 00c8 8F90      		pop r8
118
 121 00ca 7F90      		pop r7
119
 122 00cc 0F90      		pop r0
120
 123 00ce 0FBE      		out __SREG__,r0
121
 124 00d0 0F90      		pop r0
122
 125 00d2 1F90      		pop __zero_reg__
123
 126 00d4 1895      		reti
124
 127               	.L45:
125
 128 00d6 E050      		subi r30,lo8(-(gs(.L23)))
126
 129 00d8 F040      		sbci r31,hi8(-(gs(.L23)))
127
 130 00da EE0F      		lsl r30
128
 131 00dc FF1F      		rol r31
129
 132 00de 0590      		lpm __tmp_reg__,Z+
130
 133 00e0 F491      		lpm r31,Z
131
 134 00e2 E02D      		mov r30,__tmp_reg__
132
 135 00e4 0994      		ijmp
133
 136               		.data
134
 137               		.section .progmem.gcc_sw_table, "a", @progbits
135
 138               		.p2align 1
136
 139               	.L23:
137
 140               		.data
138
 141               		.section .progmem.gcc_sw_table, "a", @progbits
139
 142               		.p2align 1
140
 143 0000 0000      		.word gs(.L5)
141
 144 0002 0000      		.word gs(.L6)
142
 145 0004 0000      		.word gs(.L7)
143
 146 0006 0000      		.word gs(.L8)
144
 147 0008 0000      		.word gs(.L9)
145
 148 000a 0000      		.word gs(.L15)
146
 149 000c 0000      		.word gs(.L11)
147
 150 000e 0000      		.word gs(.L12)
148
 151 0010 0000      		.word gs(.L13)
149
 152 0012 0000      		.word gs(.L14)
150
 153 0014 0000      		.word gs(.L15)
151
 154 0016 0000      		.word gs(.L16)
152
 155 0018 0000      		.word gs(.L17)
153
 156 001a 0000      		.word gs(.L18)
154
 157 001c 0000      		.word gs(.L19)
155
 158 001e 0000      		.word gs(.L20)
156
 159 0020 0000      		.word gs(.L21)
157
 160 0022 0000      		.word gs(.L22)
158
 161               		.text
159
 162               	.L15:
160
 163 00e6 8091 7800 		lds r24,120
161
 164 00ea 9091 7900 		lds r25,(120)+1
162
 165 00ee 2091 0000 		lds r18,gyronick.1869
163
 166 00f2 3091 0000 		lds r19,(gyronick.1869)+1
164
 167 00f6 280F      		add r18,r24
165
 168 00f8 391F      		adc r19,r25
166
 169 00fa 3093 0000 		sts (gyronick.1869)+1,r19
167
 170 00fe 2093 0000 		sts gyronick.1869,r18
168
 171 0102 81E0      		ldi r24,lo8(1)
169
 172 0104 8093 0000 		sts ad_channel.1865,r24
170
 173               	.L24:
171
 174 0108 8091 7C00 		lds r24,124
172
 175 010c 807E      		andi r24,lo8(-32)
173
 176 010e 9091 0000 		lds r25,ad_channel.1865
174
 177 0112 892B      		or r24,r25
175
 178 0114 8093 7C00 		sts 124,r24
176
 179 0118 7720      		tst r7
177
 180 011a 01F0      		breq .L41
178
 181 011c 8091 7A00 		lds r24,122
179
 182 0120 886C      		ori r24,lo8(-56)
180
 183 0122 8093 7A00 		sts 122,r24
181
 184 0126 00C0      		rjmp .L41
182
 185               	.L22:
183
 186 0128 1092 0000 		sts state.1866,__zero_reg__
184
 187 012c 81E0      		ldi r24,lo8(1)
185
 188 012e 8093 0000 		sts ADReady,r24
186
 189 0132 8091 0000 		lds r24,MeasurementCounter
187
 190 0136 9091 0000 		lds r25,(MeasurementCounter)+1
188
 191 013a 0196      		adiw r24,1
189
 192 013c 9093 0000 		sts (MeasurementCounter)+1,r25
190
 193 0140 8093 0000 		sts MeasurementCounter,r24
191
 194 0144 7724      		clr r7
192
 195               	.L14:
193
 196 0146 8091 7800 		lds r24,120
194
 197 014a 9091 7900 		lds r25,(120)+1
195
 198 014e 9093 0000 		sts (AdAirPressure)+1,r25
196
 199 0152 8093 0000 		sts AdAirPressure,r24
197
 200 0156 8091 0000 		lds r24,AdAirPressure
198
 201 015a 9091 0000 		lds r25,(AdAirPressure)+1
199
 202 015e 4C01      		movw r8,r24
200
 203 0160 AA24      		clr r10
201
 204 0162 97FC      		sbrc r9,7
202
 205 0164 A094      		com r10
203
 206 0166 BA2C      		mov r11,r10
204
 207 0168 8091 0000 		lds r24,tmpAirPressure.1874
205
 208 016c 9091 0000 		lds r25,(tmpAirPressure.1874)+1
206
 209 0170 A091 0000 		lds r26,(tmpAirPressure.1874)+2
207
 210 0174 B091 0000 		lds r27,(tmpAirPressure.1874)+3
208
 211 0178 880E      		add r8,r24
209
 212 017a 991E      		adc r9,r25
210
 213 017c AA1E      		adc r10,r26
211
 214 017e BB1E      		adc r11,r27
212
 215 0180 8092 0000 		sts tmpAirPressure.1874,r8
213
 216 0184 9092 0000 		sts (tmpAirPressure.1874)+1,r9
214
 217 0188 A092 0000 		sts (tmpAirPressure.1874)+2,r10
215
 218 018c B092 0000 		sts (tmpAirPressure.1874)+3,r11
216
 219 0190 8091 0000 		lds r24,AirPressCount.1875
217
 220 0194 8F5F      		subi r24,lo8(-(1))
218
 221 0196 8093 0000 		sts AirPressCount.1875,r24
219
 222 019a 8231      		cpi r24,lo8(18)
220
 223 019c 00F4      		brsh .+2
221
 224 019e 00C0      		rjmp .L38
222
 225 01a0 8091 0000 		lds r24,AirPressure
223
 226 01a4 9091 0000 		lds r25,(AirPressure)+1
224
 227 01a8 A091 0000 		lds r26,(AirPressure)+2
225
 228 01ac B091 0000 		lds r27,(AirPressure)+3
226
 229 01b0 7C01      		movw r14,r24
227
 230 01b2 8D01      		movw r16,r26
228
 231 01b4 EE0C      		lsl r14
229
 232 01b6 FF1C      		rol r15
230
 233 01b8 001F      		rol r16
231
 234 01ba 111F      		rol r17
232
 235 01bc EE0C      		lsl r14
233
 236 01be FF1C      		rol r15
234
 237 01c0 001F      		rol r16
235
 238 01c2 111F      		rol r17
236
 239 01c4 EE0C      		lsl r14
237
 240 01c6 FF1C      		rol r15
238
 241 01c8 001F      		rol r16
239
 242 01ca 111F      		rol r17
240
 243 01cc E81A      		sub r14,r24
241
 244 01ce F90A      		sbc r15,r25
242
 245 01d0 0A0B      		sbc r16,r26
243
 246 01d2 1B0B      		sbc r17,r27
244
 247 01d4 84E0      		ldi r24,lo8(4)
245
 248 01d6 90E0      		ldi r25,hi8(4)
246
 249 01d8 A0E0      		ldi r26,hlo8(4)
247
 250 01da B0E0      		ldi r27,hhi8(4)
248
 251 01dc E80E      		add r14,r24
249
 252 01de F91E      		adc r15,r25
250
 253 01e0 0A1F      		adc r16,r26
251
 254 01e2 1B1F      		adc r17,r27
252
 255 01e4 E80C      		add r14,r8
253
 256 01e6 F91C      		adc r15,r9
254
 257 01e8 0A1D      		adc r16,r10
255
 258 01ea 1B1D      		adc r17,r11
256
 259 01ec 6091 0000 		lds r22,ExpandBaro
257
 260 01f0 7727      		clr r23
258
 261 01f2 67FD      		sbrc r22,7
259
 262 01f4 7095      		com r23
260
 263 01f6 872F      		mov r24,r23
261
 264 01f8 972F      		mov r25,r23
262
 265 01fa 2AE3      		ldi r18,lo8(-9414)
263
 266 01fc 3BED      		ldi r19,hi8(-9414)
264
 267 01fe 4FEF      		ldi r20,hlo8(-9414)
265
 268 0200 5FEF      		ldi r21,hhi8(-9414)
266
 269 0202 0E94 0000 		call __mulsi3
267
 270 0206 E60E      		add r14,r22
268
 271 0208 F71E      		adc r15,r23
269
 272 020a 081F      		adc r16,r24
270
 273 020c 191F      		adc r17,r25
271
 274 020e C801      		movw r24,r16
272
 275 0210 B701      		movw r22,r14
273
 276 0212 28E0      		ldi r18,lo8(8)
274
 277 0214 30E0      		ldi r19,hi8(8)
275
 278 0216 40E0      		ldi r20,hlo8(8)
276
 279 0218 50E0      		ldi r21,hhi8(8)
277
 280 021a 0E94 0000 		call __divmodsi4
278
 281 021e C901      		movw r24,r18
279
 282 0220 DA01      		movw r26,r20
280
 283 0222 8093 0000 		sts AirPressure,r24
281
 284 0226 9093 0000 		sts (AirPressure)+1,r25
282
 285 022a A093 0000 		sts (AirPressure)+2,r26
283
 286 022e B093 0000 		sts (AirPressure)+3,r27
284
 287 0232 8091 0000 		lds r24,StartAirPressure
285
 288 0236 9091 0000 		lds r25,(StartAirPressure)+1
286
 289 023a A091 0000 		lds r26,(StartAirPressure)+2
287
 290 023e B091 0000 		lds r27,(StartAirPressure)+3
288
 291 0242 2091 0000 		lds r18,AirPressure
289
 292 0246 3091 0000 		lds r19,(AirPressure)+1
290
 293 024a 4091 0000 		lds r20,(AirPressure)+2
291
 294 024e 5091 0000 		lds r21,(AirPressure)+3
292
 295 0252 821B      		sub r24,r18
293
 296 0254 930B      		sbc r25,r19
294
 297 0256 A40B      		sbc r26,r20
295
 298 0258 B50B      		sbc r27,r21
296
 299 025a 8093 0000 		sts ReadingHeight,r24
297
 300 025e 9093 0000 		sts (ReadingHeight)+1,r25
298
 301 0262 A093 0000 		sts (ReadingHeight)+2,r26
299
 302 0266 B093 0000 		sts (ReadingHeight)+3,r27
300
 303 026a 6091 0000 		lds r22,SumHeight
301
 304 026e 7091 0000 		lds r23,(SumHeight)+1
302
 305 0272 8091 0000 		lds r24,(SumHeight)+2
303
 306 0276 9091 0000 		lds r25,(SumHeight)+3
304
 307 027a E090 0000 		lds r14,SumHeight
305
 308 027e F090 0000 		lds r15,(SumHeight)+1
306
 309 0282 0091 0000 		lds r16,(SumHeight)+2
307
 310 0286 1091 0000 		lds r17,(SumHeight)+3
308
 311 028a 20E1      		ldi r18,lo8(16)
309
 312 028c 30E0      		ldi r19,hi8(16)
310
 313 028e 40E0      		ldi r20,hlo8(16)
311
 314 0290 50E0      		ldi r21,hhi8(16)
312
 315 0292 0E94 0000 		call __divmodsi4
313
 316 0296 E21A      		sub r14,r18
314
 317 0298 F30A      		sbc r15,r19
315
 318 029a 040B      		sbc r16,r20
316
 319 029c 150B      		sbc r17,r21
317
 320 029e E092 0000 		sts SumHeight,r14
318
 321 02a2 F092 0000 		sts (SumHeight)+1,r15
319
 322 02a6 0093 0000 		sts (SumHeight)+2,r16
320
 323 02aa 1093 0000 		sts (SumHeight)+3,r17
321
 324 02ae 2091 0000 		lds r18,SumHeight
322
 325 02b2 3091 0000 		lds r19,(SumHeight)+1
323
 326 02b6 4091 0000 		lds r20,(SumHeight)+2
324
 327 02ba 5091 0000 		lds r21,(SumHeight)+3
325
 328 02be 8091 0000 		lds r24,ReadingHeight
326
 329 02c2 9091 0000 		lds r25,(ReadingHeight)+1
327
 330 02c6 A091 0000 		lds r26,(ReadingHeight)+2
328
 331 02ca B091 0000 		lds r27,(ReadingHeight)+3
329
 332 02ce 820F      		add r24,r18
330
 333 02d0 931F      		adc r25,r19
331
 334 02d2 A41F      		adc r26,r20
332
 335 02d4 B51F      		adc r27,r21
333
 336 02d6 8093 0000 		sts SumHeight,r24
334
 337 02da 9093 0000 		sts (SumHeight)+1,r25
335
 338 02de A093 0000 		sts (SumHeight)+2,r26
336
 339 02e2 B093 0000 		sts (SumHeight)+3,r27
337
 340 02e6 C090 0000 		lds r12,ReadingVario
338
 341 02ea D090 0000 		lds r13,(ReadingVario)+1
339
 342 02ee 6091 0000 		lds r22,SumHeight
340
 343 02f2 7091 0000 		lds r23,(SumHeight)+1
341
 344 02f6 8091 0000 		lds r24,(SumHeight)+2
342
 345 02fa 9091 0000 		lds r25,(SumHeight)+3
343
 346 02fe E090 0000 		lds r14,ReadingHeight
344
 347 0302 F090 0000 		lds r15,(ReadingHeight)+1
345
 348 0306 0091 0000 		lds r16,(ReadingHeight)+2
346
 349 030a 1091 0000 		lds r17,(ReadingHeight)+3
347
 350 030e 20E1      		ldi r18,lo8(16)
348
 351 0310 30E0      		ldi r19,hi8(16)
349
 352 0312 40E0      		ldi r20,hlo8(16)
350
 353 0314 50E0      		ldi r21,hhi8(16)
351
 354 0316 0E94 0000 		call __divmodsi4
352
 355 031a 5095      		com r21
353
 356 031c 4095      		com r20
354
 357 031e 3095      		com r19
355
 358 0320 2195      		neg r18
356
 359 0322 3F4F      		sbci r19,lo8(-1)
357
 360 0324 4F4F      		sbci r20,lo8(-1)
358
 361 0326 5F4F      		sbci r21,lo8(-1)
359
 362 0328 A901      		movw r20,r18
360
 363 032a 4E0D      		add r20,r14
361
 364 032c 5F1D      		adc r21,r15
362
 365 032e 440F      		lsl r20
363
 366 0330 551F      		rol r21
364
 367 0332 440F      		lsl r20
365
 368 0334 551F      		rol r21
366
 369 0336 440F      		lsl r20
367
 370 0338 551F      		rol r21
368
 371 033a C601      		movw r24,r12
369
 372 033c 880F      		lsl r24
370
 373 033e 991F      		rol r25
371
 374 0340 8C0D      		add r24,r12
372
 375 0342 9D1D      		adc r25,r13
373
 376 0344 9C01      		movw r18,r24
374
 377 0346 220F      		lsl r18
375
 378 0348 331F      		rol r19
376
 379 034a 220F      		lsl r18
377
 380 034c 331F      		rol r19
378
 381 034e 820F      		add r24,r18
379
 382 0350 931F      		adc r25,r19
380
 383 0352 480F      		add r20,r24
381
 384 0354 591F      		adc r21,r25
382
 385 0356 57FD      		sbrc r21,7
383
 386 0358 00C0      		rjmp .L46
384
 387               	.L39:
385
 388 035a 5595      		asr r21
386
 389 035c 4795      		ror r20
387
 390 035e 5595      		asr r21
388
 391 0360 4795      		ror r20
389
 392 0362 5595      		asr r21
390
 393 0364 4795      		ror r20
391
 394 0366 5595      		asr r21
392
 395 0368 4795      		ror r20
393
 396 036a 5093 0000 		sts (ReadingVario)+1,r21
394
 397 036e 4093 0000 		sts ReadingVario,r20
395
 398 0372 C501      		movw r24,r10
396
 399 0374 B401      		movw r22,r8
397
 400 0376 22E0      		ldi r18,lo8(2)
398
 401 0378 30E0      		ldi r19,hi8(2)
399
 402 037a 40E0      		ldi r20,hlo8(2)
400
 403 037c 50E0      		ldi r21,hhi8(2)
401
 404 037e 0E94 0000 		call __divmodsi4
402
 405 0382 2093 0000 		sts tmpAirPressure.1874,r18
403
 406 0386 3093 0000 		sts (tmpAirPressure.1874)+1,r19
404
 407 038a 4093 0000 		sts (tmpAirPressure.1874)+2,r20
405
 408 038e 5093 0000 		sts (tmpAirPressure.1874)+3,r21
406
 409 0392 89E0      		ldi r24,lo8(9)
407
 410 0394 8093 0000 		sts AirPressCount.1875,r24
408
 411               	.L38:
409
 412 0398 82E0      		ldi r24,lo8(2)
410
 413 039a 8093 0000 		sts ad_channel.1865,r24
411
 414 039e 00C0      		rjmp .L24
412
 415               	.L13:
413
 416 03a0 8091 7800 		lds r24,120
414
 417 03a4 9091 7900 		lds r25,(120)+1
415
 418 03a8 9093 0000 		sts (AdValueAccZ)+1,r25
416
 419 03ac 8093 0000 		sts AdValueAccZ,r24
417
 420 03b0 6091 7800 		lds r22,120
418
 421 03b4 7091 7900 		lds r23,(120)+1
419
 422 03b8 E090 0000 		lds r14,AdBiasAccTop
420
 423 03bc F090 0000 		lds r15,(AdBiasAccTop)+1
421
 424 03c0 0091 0000 		lds r16,(AdBiasAccTop)+2
422
 425 03c4 1091 0000 		lds r17,(AdBiasAccTop)+3
423
 426 03c8 8827      		clr r24
424
 427 03ca 77FD      		sbrc r23,7
425
 428 03cc 8095      		com r24
426
 429 03ce 982F      		mov r25,r24
427
 430 03d0 0E94 0000 		call __floatsisf
428
 431 03d4 A801      		movw r20,r16
429
 432 03d6 9701      		movw r18,r14
430
 433 03d8 0E94 0000 		call __subsf3
431
 434 03dc 0E94 0000 		call __fixsfsi
432
 435 03e0 7093 0000 		sts (AdValueAccTop)+1,r23
433
 436 03e4 6093 0000 		sts AdValueAccTop,r22
434
 437 03e8 8091 0000 		lds r24,AdValueAccTop
435
 438 03ec 9091 0000 		lds r25,(AdValueAccTop)+1
436
 439 03f0 0297      		sbiw r24,2
437
 440 03f2 04F4      		brge .+2
438
 441 03f4 00C0      		rjmp .L25
439
 442 03f6 6091 0000 		lds r22,AdBiasAccTop
440
 443 03fa 7091 0000 		lds r23,(AdBiasAccTop)+1
441
 444 03fe 8091 0000 		lds r24,(AdBiasAccTop)+2
442
 445 0402 9091 0000 		lds r25,(AdBiasAccTop)+3
443
 446 0406 20E0      		ldi r18,lo8(0x443b8000)
444
 447 0408 30E8      		ldi r19,hi8(0x443b8000)
445
 448 040a 4BE3      		ldi r20,hlo8(0x443b8000)
446
 449 040c 54E4      		ldi r21,hhi8(0x443b8000)
447
 450 040e 0E94 0000 		call __ltsf2
448
 451 0412 8823      		tst r24
449
 452 0414 04F4      		brge .L26
450
 453 0416 6091 0000 		lds r22,AdBiasAccTop
451
 454 041a 7091 0000 		lds r23,(AdBiasAccTop)+1
452
 455 041e 8091 0000 		lds r24,(AdBiasAccTop)+2
453
 456 0422 9091 0000 		lds r25,(AdBiasAccTop)+3
454
 457 0426 2AE0      		ldi r18,lo8(0x3ca3d70a)
455
 458 0428 37ED      		ldi r19,hi8(0x3ca3d70a)
456
 459 042a 43EA      		ldi r20,hlo8(0x3ca3d70a)
457
 460 042c 5CE3      		ldi r21,hhi8(0x3ca3d70a)
458
 461 042e 0E94 0000 		call __addsf3
459
 462 0432 6093 0000 		sts AdBiasAccTop,r22
460
 463 0436 7093 0000 		sts (AdBiasAccTop)+1,r23
461
 464 043a 8093 0000 		sts (AdBiasAccTop)+2,r24
462
 465 043e 9093 0000 		sts (AdBiasAccTop)+3,r25
463
 466 0442 8091 0000 		lds r24,ModelIsFlying
464
 467 0446 9091 0000 		lds r25,(ModelIsFlying)+1
465
 468 044a 845F      		subi r24,lo8(500)
466
 469 044c 9140      		sbci r25,hi8(500)
467
 470 044e 00F4      		brsh .L26
468
 471 0450 6091 0000 		lds r22,AdBiasAccTop
469
 472 0454 7091 0000 		lds r23,(AdBiasAccTop)+1
470
 473 0458 8091 0000 		lds r24,(AdBiasAccTop)+2
471
 474 045c 9091 0000 		lds r25,(AdBiasAccTop)+3
472
 475 0460 2DEC      		ldi r18,lo8(0x3dcccccd)
473
 476 0462 3CEC      		ldi r19,hi8(0x3dcccccd)
474
 477 0464 4CEC      		ldi r20,hlo8(0x3dcccccd)
475
 478 0466 5DE3      		ldi r21,hhi8(0x3dcccccd)
476
 479 0468 0E94 0000 		call __addsf3
477
 480 046c 6093 0000 		sts AdBiasAccTop,r22
478
 481 0470 7093 0000 		sts (AdBiasAccTop)+1,r23
479
 482 0474 8093 0000 		sts (AdBiasAccTop)+2,r24
480
 483 0478 9093 0000 		sts (AdBiasAccTop)+3,r25
481
 484               	.L26:
482
 485 047c 6091 0000 		lds r22,ReadingIntegralTop
483
 486 0480 7091 0000 		lds r23,(ReadingIntegralTop)+1
484
 487 0484 8091 0000 		lds r24,(ReadingIntegralTop)+2
485
 488 0488 9091 0000 		lds r25,(ReadingIntegralTop)+3
486
 489 048c E090 0000 		lds r14,ReadingIntegralTop
487
 490 0490 F090 0000 		lds r15,(ReadingIntegralTop)+1
488
 491 0494 0091 0000 		lds r16,(ReadingIntegralTop)+2
489
 492 0498 1091 0000 		lds r17,(ReadingIntegralTop)+3
490
 493 049c 20E0      		ldi r18,lo8(1024)
491
 494 049e 34E0      		ldi r19,hi8(1024)
492
 495 04a0 40E0      		ldi r20,hlo8(1024)
493
 496 04a2 50E0      		ldi r21,hhi8(1024)
494
 497 04a4 0E94 0000 		call __divmodsi4
495
 498 04a8 E21A      		sub r14,r18
496
 499 04aa F30A      		sbc r15,r19
497
 500 04ac 040B      		sbc r16,r20
498
 501 04ae 150B      		sbc r17,r21
499
 502 04b0 E092 0000 		sts ReadingIntegralTop,r14
500
 503 04b4 F092 0000 		sts (ReadingIntegralTop)+1,r15
501
 504 04b8 0093 0000 		sts (ReadingIntegralTop)+2,r16
502
 505 04bc 1093 0000 		sts (ReadingIntegralTop)+3,r17
503
 506 04c0 8091 0000 		lds r24,AdValueAccTop
504
 507 04c4 9091 0000 		lds r25,(AdValueAccTop)+1
505
 508 04c8 2091 0000 		lds r18,ReadingIntegralTop
506
 509 04cc 3091 0000 		lds r19,(ReadingIntegralTop)+1
507
 510 04d0 4091 0000 		lds r20,(ReadingIntegralTop)+2
508
 511 04d4 5091 0000 		lds r21,(ReadingIntegralTop)+3
509
 512 04d8 AA27      		clr r26
510
 513 04da 97FD      		sbrc r25,7
511
 514 04dc A095      		com r26
512
 515 04de BA2F      		mov r27,r26
513
 516 04e0 820F      		add r24,r18
514
 517 04e2 931F      		adc r25,r19
515
 518 04e4 A41F      		adc r26,r20
516
 519 04e6 B51F      		adc r27,r21
517
 520 04e8 8093 0000 		sts ReadingIntegralTop,r24
518
 521 04ec 9093 0000 		sts (ReadingIntegralTop)+1,r25
519
 522 04f0 A093 0000 		sts (ReadingIntegralTop)+2,r26
520
 523 04f4 B093 0000 		sts (ReadingIntegralTop)+3,r27
521
 524 04f8 83E0      		ldi r24,lo8(3)
522
 525 04fa 8093 0000 		sts ad_channel.1865,r24
523
 526 04fe 00C0      		rjmp .L24
524
 527               	.L11:
525
 528 0500 8091 7800 		lds r24,120
526
 529 0504 9091 7900 		lds r25,(120)+1
527
 530 0508 2091 0000 		lds r18,gyroroll.1868
528
 531 050c 3091 0000 		lds r19,(gyroroll.1868)+1
529
 532 0510 280F      		add r18,r24
530
 533 0512 391F      		adc r19,r25
531
 534 0514 3093 0000 		sts (gyroroll.1868)+1,r19
532
 535 0518 2093 0000 		sts gyroroll.1868,r18
533
 536 051c 84E0      		ldi r24,lo8(4)
534
 537 051e 8093 0000 		sts ad_channel.1865,r24
535
 538 0522 00C0      		rjmp .L24
536
 539               	.L12:
537
 540 0524 4091 0000 		lds r20,UBat
538
 541 0528 5091 0000 		lds r21,(UBat)+1
539
 542 052c 8091 7800 		lds r24,120
540
 543 0530 9091 7900 		lds r25,(120)+1
541
 544 0534 9A01      		movw r18,r20
542
 545 0536 220F      		lsl r18
543
 546 0538 331F      		rol r19
544
 547 053a 240F      		add r18,r20
545
 548 053c 351F      		adc r19,r21
546
 549 053e 63E0      		ldi r22,lo8(3)
547
 550 0540 70E0      		ldi r23,hi8(3)
548
 551 0542 0E94 0000 		call __udivmodhi4
549
 552 0546 260F      		add r18,r22
550
 553 0548 371F      		adc r19,r23
551
 554 054a 3695      		lsr r19
552
 555 054c 2795      		ror r18
553
 556 054e 3695      		lsr r19
554
 557 0550 2795      		ror r18
555
 558 0552 3093 0000 		sts (UBat)+1,r19
556
 559 0556 2093 0000 		sts UBat,r18
557
 560 055a 85E0      		ldi r24,lo8(5)
558
 561 055c 8093 0000 		sts ad_channel.1865,r24
559
 562 0560 00C0      		rjmp .L24
560
 563               	.L7:
561
 564 0562 8091 7800 		lds r24,120
562
 565 0566 9091 7900 		lds r25,(120)+1
563
 566 056a 9093 0000 		sts (gyroyaw.1867)+1,r25
564
 567 056e 8093 0000 		sts gyroyaw.1867,r24
565
 568 0572 86E0      		ldi r24,lo8(6)
566
 569 0574 8093 0000 		sts ad_channel.1865,r24
567
 570 0578 00C0      		rjmp .L24
568
 571               	.L8:
569
 572 057a 8091 7800 		lds r24,120
570
 573 057e 9091 7900 		lds r25,(120)+1
571
 574 0582 9093 0000 		sts (accroll.1870)+1,r25
572
 575 0586 8093 0000 		sts accroll.1870,r24
573
 576 058a 87E0      		ldi r24,lo8(7)
574
 577 058c 8093 0000 		sts ad_channel.1865,r24
575
 578 0590 00C0      		rjmp .L24
576
 579               	.L9:
577
 580 0592 8091 7800 		lds r24,120
578
 581 0596 9091 7900 		lds r25,(120)+1
579
 582 059a 9093 0000 		sts (accnick.1871)+1,r25
580
 583 059e 8093 0000 		sts accnick.1871,r24
581
 584 05a2 82E0      		ldi r24,lo8(2)
582
 585 05a4 8093 0000 		sts ad_channel.1865,r24
583
 586 05a8 00C0      		rjmp .L24
584
 587               	.L16:
585
 588 05aa 2091 7800 		lds r18,120
586
 589 05ae 3091 7900 		lds r19,(120)+1
587
 590 05b2 8091 0000 		lds r24,gyroroll.1868
588
 591 05b6 9091 0000 		lds r25,(gyroroll.1868)+1
589
 592 05ba 820F      		add r24,r18
590
 593 05bc 931F      		adc r25,r19
591
 594 05be 9093 0000 		sts (gyroroll.1868)+1,r25
592
 595 05c2 8093 0000 		sts gyroroll.1868,r24
593
 596 05c6 1092 0000 		sts ad_channel.1865,__zero_reg__
594
 597 05ca 00C0      		rjmp .L24
595
 598               	.L17:
596
 599 05cc 2091 7800 		lds r18,120
597
 600 05d0 3091 7900 		lds r19,(120)+1
598
 601 05d4 8091 0000 		lds r24,gyroyaw.1867
599
 602 05d8 9091 0000 		lds r25,(gyroyaw.1867)+1
600
 603 05dc 280F      		add r18,r24
601
 604 05de 391F      		adc r19,r25
602
 605 05e0 3093 0000 		sts (gyroyaw.1867)+1,r19
603
 606 05e4 2093 0000 		sts gyroyaw.1867,r18
604
 607 05e8 8091 0000 		lds r24,BoardRelease
605
 608 05ec 8A30      		cpi r24,lo8(10)
606
 609 05ee 01F4      		brne .+2
607
 610 05f0 00C0      		rjmp .L47
608
 611 05f2 8431      		cpi r24,lo8(20)
609
 612 05f4 01F4      		brne .+2
610
 613 05f6 00C0      		rjmp .L48
611
 614 05f8 3093 0000 		sts (AdValueGyroYaw)+1,r19
612
 615 05fc 2093 0000 		sts AdValueGyroYaw,r18
613
 616               	.L30:
614
 617 0600 86E0      		ldi r24,lo8(6)
615
 618 0602 8093 0000 		sts ad_channel.1865,r24
616
 619 0606 00C0      		rjmp .L24
617
 620               	.L18:
618
 621 0608 2091 7800 		lds r18,120
619
 622 060c 3091 7900 		lds r19,(120)+1
620
 623 0610 8091 0000 		lds r24,accroll.1870
621
 624 0614 9091 0000 		lds r25,(accroll.1870)+1
622
 625 0618 280F      		add r18,r24
623
 626 061a 391F      		adc r19,r25
624
 627 061c 3093 0000 		sts (accroll.1870)+1,r19
625
 628 0620 2093 0000 		sts accroll.1870,r18
626
 629 0624 8091 0000 		lds r24,AdBiasAccRoll
627
 630 0628 9091 0000 		lds r25,(AdBiasAccRoll)+1
628
 631 062c 821B      		sub r24,r18
629
 632 062e 930B      		sbc r25,r19
630
 633 0630 9093 0000 		sts (AdValueAccRoll)+1,r25
631
 634 0634 8093 0000 		sts AdValueAccRoll,r24
632
 635 0638 87E0      		ldi r24,lo8(7)
633
 636 063a 8093 0000 		sts ad_channel.1865,r24
634
 637 063e 00C0      		rjmp .L24
635
 638               	.L19:
636
 639 0640 8091 7800 		lds r24,120
637
 640 0644 9091 7900 		lds r25,(120)+1
638
 641 0648 2091 0000 		lds r18,accnick.1871
639
 642 064c 3091 0000 		lds r19,(accnick.1871)+1
640
 643 0650 820F      		add r24,r18
641
 644 0652 931F      		adc r25,r19
642
 645 0654 9093 0000 		sts (accnick.1871)+1,r25
643
 646 0658 8093 0000 		sts accnick.1871,r24
644
 647 065c 2091 0000 		lds r18,AdBiasAccNick
645
 648 0660 3091 0000 		lds r19,(AdBiasAccNick)+1
646
 649 0664 821B      		sub r24,r18
647
 650 0666 930B      		sbc r25,r19
648
 651 0668 9093 0000 		sts (AdValueAccNick)+1,r25
649
 652 066c 8093 0000 		sts AdValueAccNick,r24
650
 653 0670 82E0      		ldi r24,lo8(2)
651
 654 0672 8093 0000 		sts ad_channel.1865,r24
652
 655 0676 00C0      		rjmp .L24
653
 656               	.L20:
654
 657 0678 2091 7800 		lds r18,120
655
 658 067c 3091 7900 		lds r19,(120)+1
656
 659 0680 8091 0000 		lds r24,gyronick.1869
657
 660 0684 9091 0000 		lds r25,(gyronick.1869)+1
658
 661 0688 280F      		add r18,r24
659
 662 068a 391F      		adc r19,r25
660
 663 068c 8091 0000 		lds r24,BoardRelease
661
 664 0690 8A30      		cpi r24,lo8(10)
662
 665 0692 01F4      		brne .+2
663
 666 0694 00C0      		rjmp .L49
664
 667 0696 220F      		lsl r18
665
 668 0698 331F      		rol r19
666
 669 069a 220F      		lsl r18
667
 670 069c 331F      		rol r19
668
 671 069e 3093 0000 		sts (gyronick.1869)+1,r19
669
 672 06a2 2093 0000 		sts gyronick.1869,r18
670
 673               	.L33:
671
 674 06a6 6091 0000 		lds r22,gyronick.1869
672
 675 06aa 7091 0000 		lds r23,(gyronick.1869)+1
673
 676 06ae 9B01      		movw r18,r22
674
 677 06b0 3695      		lsr r19
675
 678 06b2 2795      		ror r18
676
 679 06b4 3695      		lsr r19
677
 680 06b6 2795      		ror r18
678
 681 06b8 3695      		lsr r19
679
 682 06ba 2795      		ror r18
680
 683 06bc 3093 0000 		sts (AdValueGyroNick)+1,r19
681
 684 06c0 2093 0000 		sts AdValueGyroNick,r18
682
 685 06c4 80E0      		ldi r24,lo8(0)
683
 686 06c6 90E0      		ldi r25,hi8(0)
684
 687 06c8 2091 0000 		lds r18,filtergyronick.1872
685
 688 06cc 3091 0000 		lds r19,(filtergyronick.1872)+1
686
 689 06d0 4091 0000 		lds r20,(filtergyronick.1872)+2
687
 690 06d4 5091 0000 		lds r21,(filtergyronick.1872)+3
688
 691 06d8 620F      		add r22,r18
689
 692 06da 731F      		adc r23,r19
690
 693 06dc 841F      		adc r24,r20
691
 694 06de 951F      		adc r25,r21
692
 695 06e0 22E0      		ldi r18,lo8(2)
693
 696 06e2 30E0      		ldi r19,hi8(2)
694
 697 06e4 40E0      		ldi r20,hlo8(2)
695
 698 06e6 50E0      		ldi r21,hhi8(2)
696
 699 06e8 0E94 0000 		call __divmodsi4
697
 700 06ec C901      		movw r24,r18
698
 701 06ee DA01      		movw r26,r20
699
 702 06f0 8093 0000 		sts filtergyronick.1872,r24
700
 703 06f4 9093 0000 		sts (filtergyronick.1872)+1,r25
701
 704 06f8 A093 0000 		sts (filtergyronick.1872)+2,r26
702
 705 06fc B093 0000 		sts (filtergyronick.1872)+3,r27
703
 706 0700 2091 0000 		lds r18,BiasHiResGyroNick
704
 707 0704 3091 0000 		lds r19,(BiasHiResGyroNick)+1
705
 708 0708 821B      		sub r24,r18
706
 709 070a 930B      		sbc r25,r19
707
 710 070c 9093 0000 		sts (HiResGyroNick)+1,r25
708
 711 0710 8093 0000 		sts HiResGyroNick,r24
709
 712 0714 8091 0000 		lds r24,FilterHiResGyroNick
710
 713 0718 9091 0000 		lds r25,(FilterHiResGyroNick)+1
711
 714 071c 2091 0000 		lds r18,HiResGyroNick
712
 715 0720 3091 0000 		lds r19,(HiResGyroNick)+1
713
 716 0724 280F      		add r18,r24
714
 717 0726 391F      		adc r19,r25
715
 718 0728 37FD      		sbrc r19,7
716
 719 072a 00C0      		rjmp .L50
717
 720               	.L34:
718
 721 072c 3595      		asr r19
719
 722 072e 2795      		ror r18
720
 723 0730 3093 0000 		sts (FilterHiResGyroNick)+1,r19
721
 724 0734 2093 0000 		sts FilterHiResGyroNick,r18
722
 725 0738 81E0      		ldi r24,lo8(1)
723
 726 073a 8093 0000 		sts ad_channel.1865,r24
724
 727 073e 00C0      		rjmp .L24
725
 728               	.L21:
726
 729 0740 2091 7800 		lds r18,120
727
 730 0744 3091 7900 		lds r19,(120)+1
728
 731 0748 8091 0000 		lds r24,gyroroll.1868
729
 732 074c 9091 0000 		lds r25,(gyroroll.1868)+1
730
 733 0750 280F      		add r18,r24
731
 734 0752 391F      		adc r19,r25
732
 735 0754 8091 0000 		lds r24,BoardRelease
733
 736 0758 8A30      		cpi r24,lo8(10)
734
 737 075a 01F4      		brne .+2
735
 738 075c 00C0      		rjmp .L51
736
 739 075e 220F      		lsl r18
737
 740 0760 331F      		rol r19
738
 741 0762 220F      		lsl r18
739
 742 0764 331F      		rol r19
740
 743 0766 3093 0000 		sts (gyroroll.1868)+1,r19
741
 744 076a 2093 0000 		sts gyroroll.1868,r18
742
 745               	.L36:
743
 746 076e 6091 0000 		lds r22,gyroroll.1868
744
 747 0772 7091 0000 		lds r23,(gyroroll.1868)+1
745
 748 0776 9B01      		movw r18,r22
746
 749 0778 3695      		lsr r19
747
 750 077a 2795      		ror r18
748
 751 077c 3695      		lsr r19
749
 752 077e 2795      		ror r18
750
 753 0780 3695      		lsr r19
751
 754 0782 2795      		ror r18
752
 755 0784 3093 0000 		sts (AdValueGyroRoll)+1,r19
753
 756 0788 2093 0000 		sts AdValueGyroRoll,r18
754
 757 078c 80E0      		ldi r24,lo8(0)
755
 758 078e 90E0      		ldi r25,hi8(0)
756
 759 0790 2091 0000 		lds r18,filtergyroroll.1873
757
 760 0794 3091 0000 		lds r19,(filtergyroroll.1873)+1
758
 761 0798 4091 0000 		lds r20,(filtergyroroll.1873)+2
759
 762 079c 5091 0000 		lds r21,(filtergyroroll.1873)+3
760
 763 07a0 620F      		add r22,r18
761
 764 07a2 731F      		adc r23,r19
762
 765 07a4 841F      		adc r24,r20
763
 766 07a6 951F      		adc r25,r21
764
 767 07a8 22E0      		ldi r18,lo8(2)
765
 768 07aa 30E0      		ldi r19,hi8(2)
766
 769 07ac 40E0      		ldi r20,hlo8(2)
767
 770 07ae 50E0      		ldi r21,hhi8(2)
768
 771 07b0 0E94 0000 		call __divmodsi4
769
 772 07b4 C901      		movw r24,r18
770
 773 07b6 DA01      		movw r26,r20
771
 774 07b8 8093 0000 		sts filtergyroroll.1873,r24
772
 775 07bc 9093 0000 		sts (filtergyroroll.1873)+1,r25
773
 776 07c0 A093 0000 		sts (filtergyroroll.1873)+2,r26
774
 777 07c4 B093 0000 		sts (filtergyroroll.1873)+3,r27
775
 778 07c8 2091 0000 		lds r18,BiasHiResGyroRoll
776
 779 07cc 3091 0000 		lds r19,(BiasHiResGyroRoll)+1
777
 780 07d0 821B      		sub r24,r18
778
 781 07d2 930B      		sbc r25,r19
779
 782 07d4 9093 0000 		sts (HiResGyroRoll)+1,r25
780
 783 07d8 8093 0000 		sts HiResGyroRoll,r24
781
 784 07dc 8091 0000 		lds r24,FilterHiResGyroRoll
782
 785 07e0 9091 0000 		lds r25,(FilterHiResGyroRoll)+1
783
 786 07e4 2091 0000 		lds r18,HiResGyroRoll
784
 787 07e8 3091 0000 		lds r19,(HiResGyroRoll)+1
785
 788 07ec 280F      		add r18,r24
786
 789 07ee 391F      		adc r19,r25
787
 790 07f0 37FD      		sbrc r19,7
788
 791 07f2 00C0      		rjmp .L52
789
 792               	.L37:
790
 793 07f4 3595      		asr r19
791
 794 07f6 2795      		ror r18
792
 795 07f8 3093 0000 		sts (FilterHiResGyroRoll)+1,r19
793
 796 07fc 2093 0000 		sts FilterHiResGyroRoll,r18
794
 797 0800 83E0      		ldi r24,lo8(3)
795
 798 0802 8093 0000 		sts ad_channel.1865,r24
796
 799 0806 00C0      		rjmp .L24
797
 800               	.L5:
798
 801 0808 8091 7800 		lds r24,120
799
 802 080c 9091 7900 		lds r25,(120)+1
800
 803 0810 9093 0000 		sts (gyronick.1869)+1,r25
801
 804 0814 8093 0000 		sts gyronick.1869,r24
802
 805 0818 81E0      		ldi r24,lo8(1)
803
 806 081a 8093 0000 		sts ad_channel.1865,r24
804
 807 081e 00C0      		rjmp .L24
805
 808               	.L6:
806
 809 0820 8091 7800 		lds r24,120
807
 810 0824 9091 7900 		lds r25,(120)+1
808
 811 0828 9093 0000 		sts (gyroroll.1868)+1,r25
809
 812 082c 8093 0000 		sts gyroroll.1868,r24
810
 813 0830 1092 0000 		sts ad_channel.1865,__zero_reg__
811
 814 0834 00C0      		rjmp .L24
812
 815               	.L51:
813
 816 0836 220F      		lsl r18
814
 817 0838 331F      		rol r19
815
 818 083a 3093 0000 		sts (gyroroll.1868)+1,r19
816
 819 083e 2093 0000 		sts gyroroll.1868,r18
817
 820 0842 00C0      		rjmp .L36
818
 821               	.L47:
819
 822 0844 2F5F      		subi r18,lo8(-(1))
820
 823 0846 3F4F      		sbci r19,hi8(-(1))
821
 824 0848 3695      		lsr r19
822
 825 084a 2795      		ror r18
823
 826 084c 3093 0000 		sts (AdValueGyroYaw)+1,r19
824
 827 0850 2093 0000 		sts AdValueGyroYaw,r18
825
 828 0854 00C0      		rjmp .L30
826
 829               	.L49:
827
 830 0856 220F      		lsl r18
828
 831 0858 331F      		rol r19
829
 832 085a 3093 0000 		sts (gyronick.1869)+1,r19
830
 833 085e 2093 0000 		sts gyronick.1869,r18
831
 834 0862 00C0      		rjmp .L33
832
 835               	.L25:
833
 836 0864 8091 0000 		lds r24,AdValueAccTop
834
 837 0868 9091 0000 		lds r25,(AdValueAccTop)+1
835
 838 086c 8F5F      		subi r24,lo8(-1)
836
 839 086e 9F4F      		sbci r25,hi8(-1)
837
 840 0870 04F0      		brlt .+2
838
 841 0872 00C0      		rjmp .L26
839
 842 0874 6091 0000 		lds r22,AdBiasAccTop
840
 843 0878 7091 0000 		lds r23,(AdBiasAccTop)+1
841
 844 087c 8091 0000 		lds r24,(AdBiasAccTop)+2
842
 845 0880 9091 0000 		lds r25,(AdBiasAccTop)+3
843
 846 0884 20E0      		ldi r18,lo8(0x44098000)
844
 847 0886 30E8      		ldi r19,hi8(0x44098000)
845
 848 0888 49E0      		ldi r20,hlo8(0x44098000)
846
 849 088a 54E4      		ldi r21,hhi8(0x44098000)
847
 850 088c 0E94 0000 		call __gtsf2
848
 851 0890 1816      		cp __zero_reg__,r24
849
 852 0892 04F0      		brlt .+2
850
 853 0894 00C0      		rjmp .L26
851
 854 0896 6091 0000 		lds r22,AdBiasAccTop
852
 855 089a 7091 0000 		lds r23,(AdBiasAccTop)+1
853
 856 089e 8091 0000 		lds r24,(AdBiasAccTop)+2
854
 857 08a2 9091 0000 		lds r25,(AdBiasAccTop)+3
855
 858 08a6 2AE0      		ldi r18,lo8(0x3ca3d70a)
856
 859 08a8 37ED      		ldi r19,hi8(0x3ca3d70a)
857
 860 08aa 43EA      		ldi r20,hlo8(0x3ca3d70a)
858
 861 08ac 5CE3      		ldi r21,hhi8(0x3ca3d70a)
859
 862 08ae 0E94 0000 		call __subsf3
860
 863 08b2 6093 0000 		sts AdBiasAccTop,r22
861
 864 08b6 7093 0000 		sts (AdBiasAccTop)+1,r23
862
 865 08ba 8093 0000 		sts (AdBiasAccTop)+2,r24
863
 866 08be 9093 0000 		sts (AdBiasAccTop)+3,r25
864
 867 08c2 8091 0000 		lds r24,ModelIsFlying
865
 868 08c6 9091 0000 		lds r25,(ModelIsFlying)+1
866
 869 08ca 845F      		subi r24,lo8(500)
867
 870 08cc 9140      		sbci r25,hi8(500)
868
 871 08ce 00F0      		brlo .+2
869
 872 08d0 00C0      		rjmp .L26
870
 873 08d2 6091 0000 		lds r22,AdBiasAccTop
871
 874 08d6 7091 0000 		lds r23,(AdBiasAccTop)+1
872
 875 08da 8091 0000 		lds r24,(AdBiasAccTop)+2
873
 876 08de 9091 0000 		lds r25,(AdBiasAccTop)+3
874
 877 08e2 2DEC      		ldi r18,lo8(0x3dcccccd)
875
 878 08e4 3CEC      		ldi r19,hi8(0x3dcccccd)
876
 879 08e6 4CEC      		ldi r20,hlo8(0x3dcccccd)
877
 880 08e8 5DE3      		ldi r21,hhi8(0x3dcccccd)
878
 881 08ea 0E94 0000 		call __subsf3
879
 882 08ee 6093 0000 		sts AdBiasAccTop,r22
880
 883 08f2 7093 0000 		sts (AdBiasAccTop)+1,r23
881
 884 08f6 8093 0000 		sts (AdBiasAccTop)+2,r24
882
 885 08fa 9093 0000 		sts (AdBiasAccTop)+3,r25
883
 886 08fe 00C0      		rjmp .L26
884
 887               	.L46:
885
 888 0900 415F      		subi r20,lo8(-(15))
886
 889 0902 5F4F      		sbci r21,hi8(-(15))
887
 890 0904 00C0      		rjmp .L39
888
 891               	.L48:
889
 892 0906 8FEF      		ldi r24,lo8(2047)
890
 893 0908 97E0      		ldi r25,hi8(2047)
891
 894 090a 821B      		sub r24,r18
892
 895 090c 930B      		sbc r25,r19
893
 896 090e 9093 0000 		sts (AdValueGyroYaw)+1,r25
894
 897 0912 8093 0000 		sts AdValueGyroYaw,r24
895
 898 0916 00C0      		rjmp .L30
896
 899               	.L50:
897
 900 0918 2F5F      		subi r18,lo8(-(1))
898
 901 091a 3F4F      		sbci r19,hi8(-(1))
899
 902 091c 00C0      		rjmp .L34
900
 903               	.L52:
901
 904 091e 2F5F      		subi r18,lo8(-(1))
902
 905 0920 3F4F      		sbci r19,hi8(-(1))
903
 906 0922 00C0      		rjmp .L37
904
 908               	.global	SearchDacGyroOffset
905
 910               	SearchDacGyroOffset:
906
 911 0924 AF92      		push r10
907
 912 0926 BF92      		push r11
908
 913 0928 DF92      		push r13
909
 914 092a EF92      		push r14
910
 915 092c FF92      		push r15
911
 916 092e 0F93      		push r16
912
 917 0930 1F93      		push r17
913
 918 0932 CF93      		push r28
914
 919 0934 DF93      		push r29
915
 920               	/* prologue: function */
916
 921               	/* frame size = 0 */
917
 922 0936 1092 0000 		sts GyroDefectNick,__zero_reg__
918
 923 093a 1092 0000 		sts GyroDefectRoll,__zero_reg__
919
 924 093e 1092 0000 		sts GyroDefectYaw,__zero_reg__
920
 925 0942 80ED      		ldi r24,lo8(2000)
921
 926 0944 97E0      		ldi r25,hi8(2000)
922
 927 0946 0E94 0000 		call SetDelay
923
 928 094a EC01      		movw r28,r24
924
 929 094c 8091 0000 		lds r24,BoardRelease
925
 930 0950 8D30      		cpi r24,lo8(13)
926
 931 0952 01F0      		breq .L83
927
 932               	.L76:
928
 933               	/* epilogue start */
929
 934 0954 DF91      		pop r29
930
 935 0956 CF91      		pop r28
931
 936 0958 1F91      		pop r17
932
 937 095a 0F91      		pop r16
933
 938 095c FF90      		pop r15
934
 939 095e EF90      		pop r14
935
 940 0960 DF90      		pop r13
936
 941 0962 BF90      		pop r11
937
 942 0964 AF90      		pop r10
938
 943 0966 0895      		ret
939
 944               	.L83:
940
 945 0968 0CE8      		ldi r16,lo8(-116)
941
 946 096a FF24      		clr r15
942
 947 096c F394      		inc r15
943
 948 096e F5EF      		ldi r31,lo8(-11)
944
 949 0970 EF2E      		mov r14,r31
945
 950 0972 EAE0      		ldi r30,lo8(10)
946
 951 0974 DE2E      		mov r13,r30
947
 952 0976 70E0      		ldi r23,lo8(__c.1826)
948
 953 0978 A72E      		mov r10,r23
949
 954 097a 70E0      		ldi r23,hi8(__c.1826)
950
 955 097c B72E      		mov r11,r23
951
 956               	.L82:
952
 957 097e 8091 0000 		lds r24,AdValueGyroNick
953
 958 0982 9091 0000 		lds r25,(AdValueGyroNick)+1
954
 959 0986 8C5F      		subi r24,lo8(1020)
955
 960 0988 9340      		sbci r25,hi8(1020)
956
 961 098a 04F0      		brlt .+2
957
 962 098c 00C0      		rjmp .L56
958
 963 098e 8091 0000 		lds r24,DacOffsetGyroNick
959
 964 0992 8150      		subi r24,lo8(-(-1))
960
 965 0994 8093 0000 		sts DacOffsetGyroNick,r24
961
 966 0998 10E0      		ldi r17,lo8(0)
962
 967               	.L57:
963
 968 099a 8091 0000 		lds r24,AdValueGyroRoll
964
 969 099e 9091 0000 		lds r25,(AdValueGyroRoll)+1
965
 970 09a2 8C5F      		subi r24,lo8(1020)
966
 971 09a4 9340      		sbci r25,hi8(1020)
967
 972 09a6 04F0      		brlt .+2
968
 973 09a8 00C0      		rjmp .L59
969
 974 09aa 8091 0000 		lds r24,DacOffsetGyroRoll
970
 975 09ae 8150      		subi r24,lo8(-(-1))
971
 976 09b0 8093 0000 		sts DacOffsetGyroRoll,r24
972
 977               	.L60:
973
 978 09b4 8091 0000 		lds r24,AdValueGyroYaw
974
 979 09b8 9091 0000 		lds r25,(AdValueGyroYaw)+1
975
 980 09bc 8C5F      		subi r24,lo8(1020)
976
 981 09be 9340      		sbci r25,hi8(1020)
977
 982 09c0 04F0      		brlt .+2
978
 983 09c2 00C0      		rjmp .L62
979
 984 09c4 8091 0000 		lds r24,DacOffsetGyroYaw
980
 985 09c8 8150      		subi r24,lo8(-(-1))
981
 986 09ca 8093 0000 		sts DacOffsetGyroYaw,r24
982
 987               	.L63:
983
 988 09ce 87E0      		ldi r24,lo8(7)
984
 989 09d0 0E94 0000 		call I2C_Start
985
 990 09d4 8091 0000 		lds r24,DacOffsetGyroNick
986
 991 09d8 8A30      		cpi r24,lo8(10)
987
 992 09da 00F0      		brlo .+2
988
 993 09dc 00C0      		rjmp .L65
989
 994 09de F092 0000 		sts GyroDefectNick,r15
990
 995 09e2 D092 0000 		sts DacOffsetGyroNick,r13
991
 996               	.L66:
992
 997 09e6 8091 0000 		lds r24,DacOffsetGyroRoll
993
 998 09ea 8A30      		cpi r24,lo8(10)
994
 999 09ec 00F0      		brlo .+2
995
 1000 09ee 00C0      		rjmp .L67
996
 1001 09f0 F092 0000 		sts GyroDefectRoll,r15
997
 1002 09f4 D092 0000 		sts DacOffsetGyroRoll,r13
998
 1003               	.L68:
999
 1004 09f8 8091 0000 		lds r24,DacOffsetGyroYaw
1000
 1005 09fc 8A30      		cpi r24,lo8(10)
1001
 1006 09fe 00F4      		brsh .L69
1002
 1007 0a00 F092 0000 		sts GyroDefectYaw,r15
1003
 1008 0a04 D092 0000 		sts DacOffsetGyroYaw,r13
1004
 1009               	.L78:
1005
 1010 0a08 8091 0000 		lds r24,twi_state
1006
 1011 0a0c 8823      		tst r24
1007
 1012 0a0e 01F0      		breq .L71
1008
 1013 0a10 CE01      		movw r24,r28
1009
 1014 0a12 0E94 0000 		call CheckDelay
1010
 1015 0a16 8823      		tst r24
1011
 1016 0a18 01F0      		breq .L78
1012
 1017 0a1a 00D0      		rcall .
1013
 1018 0a1c 0F92      		push __tmp_reg__
1014
 1019 0a1e EDB7      		in r30,__SP_L__
1015
 1020 0a20 FEB7      		in r31,__SP_H__
1016
 1021 0a22 1182      		std Z+1,__zero_reg__
1017
 1022 0a24 B382      		std Z+3,r11
1018
 1023 0a26 A282      		std Z+2,r10
1019
 1024 0a28 0E94 0000 		call _printf_P
1020
 1025 0a2c 0F90      		pop __tmp_reg__
1021
 1026 0a2e 0F90      		pop __tmp_reg__
1022
 1027 0a30 0F90      		pop __tmp_reg__
1023
 1028               	.L71:
1024
 1029 0a32 1092 0000 		sts ADReady,__zero_reg__
1025
 1030 0a36 8091 7A00 		lds r24,122
1026
 1031 0a3a 886C      		ori r24,lo8(-56)
1027
 1032 0a3c 8093 7A00 		sts 122,r24
1028
 1033               	.L73:
1029
 1034 0a40 8091 0000 		lds r24,ADReady
1030
 1035 0a44 8823      		tst r24
1031
 1036 0a46 01F0      		breq .L73
1032
 1037 0a48 0A30      		cpi r16,lo8(10)
1033
 1038 0a4a 00F4      		brsh .+2
1034
 1039 0a4c 00C0      		rjmp .L84
1035
 1040 0a4e 0150      		subi r16,lo8(-(-1))
1036
 1041 0a50 01F4      		brne .+2
1037
 1042 0a52 00C0      		rjmp .L85
1038
 1043               	.L75:
1039
 1044 0a54 1330      		cpi r17,lo8(3)
1040
 1045 0a56 01F0      		breq .+2
1041
 1046 0a58 00C0      		rjmp .L82
1042
 1047 0a5a 0B30      		cpi r16,lo8(11)
1043
 1048 0a5c 00F4      		brsh .+2
1044
 1049 0a5e 00C0      		rjmp .L82
1045
 1050 0a60 09E0      		ldi r16,lo8(9)
1046
 1051 0a62 00C0      		rjmp .L82
1047
 1052               	.L69:
1048
 1053 0a64 863F      		cpi r24,lo8(-10)
1049
 1054 0a66 00F0      		brlo .L78
1050
 1055 0a68 F092 0000 		sts GyroDefectYaw,r15
1051
 1056 0a6c E092 0000 		sts DacOffsetGyroYaw,r14
1052
 1057 0a70 00C0      		rjmp .L78
1053
 1058               	.L67:
1054
 1059 0a72 863F      		cpi r24,lo8(-10)
1055
 1060 0a74 00F4      		brsh .+2
1056
 1061 0a76 00C0      		rjmp .L68
1057
 1062 0a78 F092 0000 		sts GyroDefectRoll,r15
1058
 1063 0a7c E092 0000 		sts DacOffsetGyroRoll,r14
1059
 1064 0a80 00C0      		rjmp .L68
1060
 1065               	.L65:
1061
 1066 0a82 863F      		cpi r24,lo8(-10)
1062
 1067 0a84 00F4      		brsh .+2
1063
 1068 0a86 00C0      		rjmp .L66
1064
 1069 0a88 F092 0000 		sts GyroDefectNick,r15
1065
 1070 0a8c E092 0000 		sts DacOffsetGyroNick,r14
1066
 1071 0a90 00C0      		rjmp .L66
1067
 1072               	.L62:
1068
 1073 0a92 8091 0000 		lds r24,AdValueGyroYaw
1069
 1074 0a96 9091 0000 		lds r25,(AdValueGyroYaw)+1
1070
 1075 0a9a 8750      		subi r24,lo8(1031)
1071
 1076 0a9c 9440      		sbci r25,hi8(1031)
1072
 1077 0a9e 04F0      		brlt .L64
1073
 1078 0aa0 8091 0000 		lds r24,DacOffsetGyroYaw
1074
 1079 0aa4 8F5F      		subi r24,lo8(-(1))
1075
 1080 0aa6 8093 0000 		sts DacOffsetGyroYaw,r24
1076
 1081 0aaa 00C0      		rjmp .L63
1077
 1082               	.L59:
1078
 1083 0aac 8091 0000 		lds r24,AdValueGyroRoll
1079
 1084 0ab0 9091 0000 		lds r25,(AdValueGyroRoll)+1
1080
 1085 0ab4 8750      		subi r24,lo8(1031)
1081
 1086 0ab6 9440      		sbci r25,hi8(1031)
1082
 1087 0ab8 04F0      		brlt .L61
1083
 1088 0aba 8091 0000 		lds r24,DacOffsetGyroRoll
1084
 1089 0abe 8F5F      		subi r24,lo8(-(1))
1085
 1090 0ac0 8093 0000 		sts DacOffsetGyroRoll,r24
1086
 1091 0ac4 00C0      		rjmp .L60
1087
 1092               	.L56:
1088
 1093 0ac6 8091 0000 		lds r24,AdValueGyroNick
1089
 1094 0aca 9091 0000 		lds r25,(AdValueGyroNick)+1
1090
 1095 0ace 8750      		subi r24,lo8(1031)
1091
 1096 0ad0 9440      		sbci r25,hi8(1031)
1092
 1097 0ad2 04F4      		brge .L58
1093
 1098 0ad4 11E0      		ldi r17,lo8(1)
1094
 1099 0ad6 00C0      		rjmp .L57
1095
 1100               	.L84:
1096
 1101 0ad8 8AE0      		ldi r24,lo8(10)
1097
 1102 0ada 90E0      		ldi r25,hi8(10)
1098
 1103 0adc 0E94 0000 		call Delay_ms_Mess
1099
 1104 0ae0 0150      		subi r16,lo8(-(-1))
1100
 1105 0ae2 01F0      		breq .+2
1101
 1106 0ae4 00C0      		rjmp .L75
1102
 1107               	.L85:
1103
 1108 0ae6 86E4      		ldi r24,lo8(70)
1104
 1109 0ae8 90E0      		ldi r25,hi8(70)
1105
 1110 0aea 0E94 0000 		call Delay_ms_Mess
1106
 1111 0aee 00C0      		rjmp .L76
1107
 1112               	.L64:
1108
 1113 0af0 1F5F      		subi r17,lo8(-(1))
1109
 1114 0af2 00C0      		rjmp .L63
1110
 1115               	.L61:
1111
 1116 0af4 1F5F      		subi r17,lo8(-(1))
1112
 1117 0af6 00C0      		rjmp .L60
1113
 1118               	.L58:
1114
 1119 0af8 8091 0000 		lds r24,DacOffsetGyroNick
1115
 1120 0afc 8F5F      		subi r24,lo8(-(1))
1116
 1121 0afe 8093 0000 		sts DacOffsetGyroNick,r24
1117
 1122 0b02 10E0      		ldi r17,lo8(0)
1118
 1123 0b04 00C0      		rjmp .L57
1119
 1125               	.global	SearchAirPressureOffset
1120
 1127               	SearchAirPressureOffset:
1121
 1128 0b06 1F93      		push r17
1122
 1129 0b08 CF93      		push r28
1123
 1130 0b0a DF93      		push r29
1124
 1131               	/* prologue: function */
1125
 1132               	/* frame size = 0 */
1126
 1133 0b0c 83E0      		ldi r24,lo8(3)
1127
 1134 0b0e 90E0      		ldi r25,hi8(3)
1128
 1135 0b10 0E94 0000 		call GetParamByte
1129
 1136 0b14 182F      		mov r17,r24
1130
 1137 0b16 8531      		cpi r24,lo8(21)
1131
 1138 0b18 00F0      		brlo .L87
1132
 1139 0b1a 1A50      		subi r17,lo8(-(-10))
1133
 1140               	.L87:
1134
 1141 0b1c 17BD      		out 71-32,r17
1135
 1142 0b1e 1092 0000 		sts ExpandBaro,__zero_reg__
1136
 1143 0b22 84E6      		ldi r24,lo8(100)
1137
 1144 0b24 90E0      		ldi r25,hi8(100)
1138
 1145 0b26 0E94 0000 		call Delay_ms_Mess
1139
 1146 0b2a 8091 0000 		lds r24,AdAirPressure
1140
 1147 0b2e 9091 0000 		lds r25,(AdAirPressure)+1
1141
 1148 0b32 8052      		subi r24,lo8(800)
1142
 1149 0b34 9340      		sbci r25,hi8(800)
1143
 1150 0b36 04F0      		brlt .+2
1144
 1151 0b38 00C0      		rjmp .L88
1145
 1152 0b3a 10E0      		ldi r17,lo8(0)
1146
 1153 0b3c C0E0      		ldi r28,lo8(__c.1808)
1147
 1154 0b3e D0E0      		ldi r29,hi8(__c.1808)
1148
 1155 0b40 00C0      		rjmp .L92
1149
 1156               	.L94:
1150
 1157 0b42 1F5F      		subi r17,lo8(-(1))
1151
 1158 0b44 1A3F      		cpi r17,lo8(-6)
1152
 1159 0b46 00F4      		brsh .L90
1153
 1160               	.L92:
1154
 1161 0b48 17BD      		out 71-32,r17
1155
 1162 0b4a 82E3      		ldi r24,lo8(50)
1156
 1163 0b4c 90E0      		ldi r25,hi8(50)
1157
 1164 0b4e 0E94 0000 		call Delay_ms_Mess
1158
 1165 0b52 00D0      		rcall .
1159
 1166 0b54 0F92      		push __tmp_reg__
1160
 1167 0b56 EDB7      		in r30,__SP_L__
1161
 1168 0b58 FEB7      		in r31,__SP_H__
1162
 1169 0b5a 1182      		std Z+1,__zero_reg__
1163
 1170 0b5c D383      		std Z+3,r29
1164
 1171 0b5e C283      		std Z+2,r28
1165
 1172 0b60 0E94 0000 		call _printf_P
1166
 1173 0b64 8091 0000 		lds r24,AdAirPressure
1167
 1174 0b68 9091 0000 		lds r25,(AdAirPressure)+1
1168
 1175 0b6c 0F90      		pop __tmp_reg__
1169
 1176 0b6e 0F90      		pop __tmp_reg__
1170
 1177 0b70 0F90      		pop __tmp_reg__
1171
 1178 0b72 8052      		subi r24,lo8(800)
1172
 1179 0b74 9340      		sbci r25,hi8(800)
1173
 1180 0b76 04F4      		brge .L94
1174
 1181               	.L90:
1175
 1182 0b78 83E0      		ldi r24,lo8(3)
1176
 1183 0b7a 90E0      		ldi r25,hi8(3)
1177
 1184 0b7c 612F      		mov r22,r17
1178
 1185 0b7e 0E94 0000 		call SetParamByte
1179
 1186 0b82 1093 0000 		sts PressureSensorOffset,r17
1180
 1187 0b86 6091 0000 		lds r22,AdAirPressure
1181
 1188 0b8a 7091 0000 		lds r23,(AdAirPressure)+1
1182
 1189 0b8e 8827      		clr r24
1183
 1190 0b90 77FD      		sbrc r23,7
1184
 1191 0b92 8095      		com r24
1185
 1192 0b94 982F      		mov r25,r24
1186
 1193 0b96 22E1      		ldi r18,lo8(18)
1187
 1194 0b98 30E0      		ldi r19,hi8(18)
1188
 1195 0b9a 40E0      		ldi r20,hlo8(18)
1189
 1196 0b9c 50E0      		ldi r21,hhi8(18)
1190
 1197 0b9e 0E94 0000 		call __mulsi3
1191
 1198 0ba2 6093 0000 		sts AirPressure,r22
1192
 1199 0ba6 7093 0000 		sts (AirPressure)+1,r23
1193
 1200 0baa 8093 0000 		sts (AirPressure)+2,r24
1194
 1201 0bae 9093 0000 		sts (AirPressure)+3,r25
1195
 1202 0bb2 8CE2      		ldi r24,lo8(300)
1196
 1203 0bb4 91E0      		ldi r25,hi8(300)
1197
 1204 0bb6 0E94 0000 		call Delay_ms_Mess
1198
 1205               	/* epilogue start */
1199
 1206 0bba DF91      		pop r29
1200
 1207 0bbc CF91      		pop r28
1201
 1208 0bbe 1F91      		pop r17
1202
 1209 0bc0 0895      		ret
1203
 1210               	.L88:
1204
 1211 0bc2 1A3F      		cpi r17,lo8(-6)
1205
 1212 0bc4 00F4      		brsh .L90
1206
 1213 0bc6 C0E0      		ldi r28,lo8(__c.1808)
1207
 1214 0bc8 D0E0      		ldi r29,hi8(__c.1808)
1208
 1215 0bca 00C0      		rjmp .L92
1209
 1217               	.global	Test
1210
 1218               	.global	Test
1211
 1219               		.section .bss
1212
 1222               	Test:
1213
 1223 0000 0000      		.skip 2,0
1214
 1224               	.global	UBat
1215
 1225               		.data
1216
 1228               	UBat:
1217
 1229 0000 6400      		.word	100
1218
 1230               	.global	AdValueGyroNick
1219
 1231               	.global	AdValueGyroNick
1220
 1232               		.section .bss
1221
 1235               	AdValueGyroNick:
1222
 1236 0002 0000      		.skip 2,0
1223
 1237               	.global	AdValueGyroRoll
1224
 1238               	.global	AdValueGyroRoll
1225
 1241               	AdValueGyroRoll:
1226
 1242 0004 0000      		.skip 2,0
1227
 1243               	.global	AdValueGyroYaw
1228
 1244               	.global	AdValueGyroYaw
1229
 1247               	AdValueGyroYaw:
1230
 1248 0006 0000      		.skip 2,0
1231
 1249               	.global	FilterHiResGyroNick
1232
 1250               	.global	FilterHiResGyroNick
1233
 1253               	FilterHiResGyroNick:
1234
 1254 0008 0000      		.skip 2,0
1235
 1255               	.global	FilterHiResGyroRoll
1236
 1256               	.global	FilterHiResGyroRoll
1237
 1259               	FilterHiResGyroRoll:
1238
 1260 000a 0000      		.skip 2,0
1239
 1261               	.global	HiResGyroNick
1240
 1262               		.data
1241
 1265               	HiResGyroNick:
1242
 1266 0002 C409      		.word	2500
1243
 1267               	.global	HiResGyroRoll
1244
 1270               	HiResGyroRoll:
1245
 1271 0004 C409      		.word	2500
1246
 1272               	.global	AdValueAccRoll
1247
 1273               	.global	AdValueAccRoll
1248
 1274               		.section .bss
1249
 1277               	AdValueAccRoll:
1250
 1278 000c 0000      		.skip 2,0
1251
 1279               	.global	AdValueAccNick
1252
 1280               	.global	AdValueAccNick
1253
 1283               	AdValueAccNick:
1254
 1284 000e 0000      		.skip 2,0
1255
 1285               	.global	AdValueAccTop
1256
 1286               	.global	AdValueAccTop
1257
 1289               	AdValueAccTop:
1258
 1290 0010 0000      		.skip 2,0
1259
 1291               	.global	AdValueAccZ
1260
 1292               	.global	AdValueAccZ
1261
 1295               	AdValueAccZ:
1262
 1296 0012 0000      		.skip 2,0
1263
 1297               	.global	AirPressure
1264
 1298               		.data
1265
 1301               	AirPressure:
1266
 1302 0006 00        		.byte	0
1267
 1303 0007 7D        		.byte	125
1268
 1304 0008 00        		.byte	0
1269
 1305 0009 00        		.byte	0
1270
 1306               	.global	AdAirPressure
1271
 1309               	AdAirPressure:
1272
 1310 000a FF03      		.word	1023
1273
 1311               	.global	ReadingHeight
1274
 1312               	.global	ReadingHeight
1275
 1313               		.section .bss
1276
 1316               	ReadingHeight:
1277
 1317 0014 0000 0000 		.skip 4,0
1278
 1318               	.global	ReadingVario
1279
 1319               	.global	ReadingVario
1280
 1322               	ReadingVario:
1281
 1323 0018 0000      		.skip 2,0
1282
 1324               	.global	SumHeight
1283
 1325               	.global	SumHeight
1284
 1328               	SumHeight:
1285
 1329 001a 0000 0000 		.skip 4,0
1286
 1330               	.global	MeasurementCounter
1287
 1331               	.global	MeasurementCounter
1288
 1334               	MeasurementCounter:
1289
 1335 001e 0000      		.skip 2,0
1290
 1336               	.global	ADReady
1291
 1337               		.data
1292
 1340               	ADReady:
1293
 1341 000c 01        		.byte	1
1294
 1342               	.global	DacOffsetGyroNick
1295
 1345               	DacOffsetGyroNick:
1296
 1346 000d 73        		.byte	115
1297
 1347               	.global	DacOffsetGyroRoll
1298
 1350               	DacOffsetGyroRoll:
1299
 1351 000e 73        		.byte	115
1300
 1352               	.global	DacOffsetGyroYaw
1301
 1355               	DacOffsetGyroYaw:
1302
 1356 000f 73        		.byte	115
1303
 1357               	.global	GyroDefectNick
1304
 1358               	.global	GyroDefectNick
1305
 1359               		.section .bss
1306
 1362               	GyroDefectNick:
1307
 1363 0020 00        		.skip 1,0
1308
 1364               	.global	GyroDefectRoll
1309
 1365               	.global	GyroDefectRoll
1310
 1368               	GyroDefectRoll:
1311
 1369 0021 00        		.skip 1,0
1312
 1370               	.global	GyroDefectYaw
1313
 1371               	.global	GyroDefectYaw
1314
 1374               	GyroDefectYaw:
1315
 1375 0022 00        		.skip 1,0
1316
 1376               	.global	ExpandBaro
1317
 1377               	.global	ExpandBaro
1318
 1380               	ExpandBaro:
1319
 1381 0023 00        		.skip 1,0
1320
 1382               		.lcomm AirPressCount.1875,1
1321
 1383               		.lcomm tmpAirPressure.1874,4
1322
 1384               		.lcomm filtergyroroll.1873,4
1323
 1385               		.lcomm filtergyronick.1872,4
1324
 1386               		.lcomm accnick.1871,2
1325
 1387               		.lcomm accroll.1870,2
1326
 1388               		.lcomm gyronick.1869,2
1327
 1389               		.lcomm gyroroll.1868,2
1328
 1390               		.lcomm gyroyaw.1867,2
1329
 1391               		.lcomm state.1866,1
1330
 1392               		.data
1331
 1395               	ad_channel.1865:
1332
 1396 0010 02        		.byte	2
1333
 1397               		.section	.progmem.data,"a",@progbits
1334
 1400               	__c.1826:
1335
 1401 0000 0D0A 2044 		.string	"\r\n DAC or I2C Error1 check I2C, 3Vref, DAC, and BL-Ctrl"
1336
 1401      4143 206F
1337
 1401      7220 4932
1338
 1401      4320 4572
1339
 1401      726F 7231
1340
 1404               	__c.1808:
1341
 1405 0038 2E00      		.string	"."
1342
 1406               		.comm StartAirPressure,4,1
1343
 1407               		.comm PressureSensorOffset,1,1
1344
 1408               	.global __do_copy_data
1345
 1409               	.global __do_clear_bss
1346
DEFINED SYMBOLS
1347
                            *ABS*:00000000 analog.c
1348
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:2      *ABS*:0000003f __SREG__
1349
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:3      *ABS*:0000003e __SP_H__
1350
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:4      *ABS*:0000003d __SP_L__
1351
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:5      *ABS*:00000034 __CCP__
1352
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:6      *ABS*:00000000 __tmp_reg__
1353
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:7      *ABS*:00000001 __zero_reg__
1354
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:11     .text:00000000 ADC_Init
1355
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:50     .text:0000003a __vector_24
1356
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:1390   .bss:0000003b state.1866
1357
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:1395   .data:00000010 ad_channel.1865
1358
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:1387   .bss:00000035 gyronick.1869
1359
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:1340   .data:0000000c ADReady
1360
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:1334   .bss:0000001e MeasurementCounter
1361
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:1309   .data:0000000a AdAirPressure
1362
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:1382   .bss:00000025 tmpAirPressure.1874
1363
                             .bss:00000024 AirPressCount.1875
1364
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:1301   .data:00000006 AirPressure
1365
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:1380   .bss:00000023 ExpandBaro
1366
                            *COM*:00000004 StartAirPressure
1367
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:1316   .bss:00000014 ReadingHeight
1368
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:1328   .bss:0000001a SumHeight
1369
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:1322   .bss:00000018 ReadingVario
1370
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:1295   .bss:00000012 AdValueAccZ
1371
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:1289   .bss:00000010 AdValueAccTop
1372
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:1388   .bss:00000037 gyroroll.1868
1373
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:1228   .data:00000000 UBat
1374
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:1389   .bss:00000039 gyroyaw.1867
1375
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:1386   .bss:00000033 accroll.1870
1376
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:1385   .bss:00000031 accnick.1871
1377
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:1247   .bss:00000006 AdValueGyroYaw
1378
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:1277   .bss:0000000c AdValueAccRoll
1379
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:1283   .bss:0000000e AdValueAccNick
1380
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:1235   .bss:00000002 AdValueGyroNick
1381
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:1384   .bss:0000002d filtergyronick.1872
1382
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:1265   .data:00000002 HiResGyroNick
1383
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:1253   .bss:00000008 FilterHiResGyroNick
1384
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:1241   .bss:00000004 AdValueGyroRoll
1385
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:1383   .bss:00000029 filtergyroroll.1873
1386
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:1270   .data:00000004 HiResGyroRoll
1387
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:1259   .bss:0000000a FilterHiResGyroRoll
1388
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:910    .text:00000924 SearchDacGyroOffset
1389
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:1362   .bss:00000020 GyroDefectNick
1390
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:1368   .bss:00000021 GyroDefectRoll
1391
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:1374   .bss:00000022 GyroDefectYaw
1392
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:1400   .progmem.data:00000000 __c.1826
1393
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:1345   .data:0000000d DacOffsetGyroNick
1394
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:1350   .data:0000000e DacOffsetGyroRoll
1395
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:1355   .data:0000000f DacOffsetGyroYaw
1396
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:1127   .text:00000b06 SearchAirPressureOffset
1397
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:1404   .progmem.data:00000038 __c.1808
1398
                            *COM*:00000001 PressureSensorOffset
1399
C:\DOKUME~1\LUKEPA~1\LOKALE~1\Temp/ccEia1ik.s:1222   .bss:00000000 Test
1400
 
1401
UNDEFINED SYMBOLS
1402
__mulsi3
1403
__divmodsi4
1404
AdBiasAccTop
1405
__floatsisf
1406
__subsf3
1407
__fixsfsi
1408
__ltsf2
1409
__addsf3
1410
ModelIsFlying
1411
ReadingIntegralTop
1412
__udivmodhi4
1413
BoardRelease
1414
AdBiasAccRoll
1415
AdBiasAccNick
1416
BiasHiResGyroNick
1417
BiasHiResGyroRoll
1418
__gtsf2
1419
SetDelay
1420
I2C_Start
1421
twi_state
1422
CheckDelay
1423
_printf_P
1424
Delay_ms_Mess
1425
GetParamByte
1426
SetParamByte
1427
__do_copy_data
1428
__do_clear_bss