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 |