Blame | Last modification | View Log | RSS feed
1 .file "GPS.c"
2 .arch atmega644
3 __SREG__ = 0x3f
4 __SP_H__ = 0x3e
5 __SP_L__ = 0x3d
6 __tmp_reg__ = 0
7 __zero_reg__ = 1
8 .global __do_copy_data
9 .global __do_clear_bss
10 .text
11 .global gps_main
13 gps_main:
14 /* prologue: frame size=31 */
15 0000 2F92 push r2
16 0002 3F92 push r3
17 0004 4F92 push r4
18 0006 5F92 push r5
19 0008 6F92 push r6
20 000a 7F92 push r7
21 000c 8F92 push r8
22 000e 9F92 push r9
23 0010 AF92 push r10
24 0012 BF92 push r11
25 0014 CF92 push r12
26 0016 DF92 push r13
27 0018 EF92 push r14
28 001a FF92 push r15
29 001c 0F93 push r16
30 001e 1F93 push r17
31 0020 CF93 push r28
32 0022 DF93 push r29
33 0024 CDB7 in r28,__SP_L__
34 0026 DEB7 in r29,__SP_H__
35 0028 6F97 sbiw r28,31
36 002a 0FB6 in __tmp_reg__,__SREG__
37 002c F894 cli
38 002e DEBF out __SP_H__,r29
39 0030 0FBE out __SREG__,__tmp_reg__
40 0032 CDBF out __SP_L__,r28
41 /* prologue end (size=26) */
42 0034 2091 0000 lds r18,actualPos+45
43 0038 2D87 std Y+13,r18
44 003a 2330 cpi r18,lo8(3)
45 003c 01F0 breq .+2
46 003e 00C0 rjmp .L2
47 0040 E091 0000 lds r30,FilterPos
48 0044 FF27 clr r31
49 0046 EE0F lsl r30
50 0048 FF1F rol r31
51 004a EE0F lsl r30
52 004c FF1F rol r31
53 004e E050 subi r30,lo8(-(filter_north))
54 0050 F040 sbci r31,hi8(-(filter_north))
55 0052 8091 0000 lds r24,actualPos+24
56 0056 9091 0000 lds r25,(actualPos+24)+1
57 005a A091 0000 lds r26,(actualPos+24)+2
58 005e B091 0000 lds r27,(actualPos+24)+3
59 0062 8083 st Z,r24
60 0064 9183 std Z+1,r25
61 0066 A283 std Z+2,r26
62 0068 B383 std Z+3,r27
63 006a E091 0000 lds r30,FilterPos
64 006e FF27 clr r31
65 0070 EE0F lsl r30
66 0072 FF1F rol r31
67 0074 EE0F lsl r30
68 0076 FF1F rol r31
69 0078 E050 subi r30,lo8(-(filter_east))
70 007a F040 sbci r31,hi8(-(filter_east))
71 007c 8091 0000 lds r24,actualPos+28
72 0080 9091 0000 lds r25,(actualPos+28)+1
73 0084 A091 0000 lds r26,(actualPos+28)+2
74 0088 B091 0000 lds r27,(actualPos+28)+3
75 008c 8083 st Z,r24
76 008e 9183 std Z+1,r25
77 0090 A283 std Z+2,r26
78 0092 B383 std Z+3,r27
79 0094 8091 0000 lds r24,FilterPos
80 0098 8F5F subi r24,lo8(-(1))
81 009a 8093 0000 sts FilterPos,r24
82 009e 8091 0000 lds r24,FilterPos
83 00a2 8830 cpi r24,lo8(8)
84 00a4 01F4 brne .L4
85 00a6 1092 0000 sts FilterPos,__zero_reg__
86 .L4:
87 00aa 8091 0000 lds r24,filterfilled
88 00ae 9091 0000 lds r25,(filterfilled)+1
89 00b2 0897 sbiw r24,8
90 00b4 04F4 brge .L6
91 00b6 8091 0000 lds r24,filterfilled
92 00ba 9091 0000 lds r25,(filterfilled)+1
93 00be 0196 adiw r24,1
94 00c0 9093 0000 sts (filterfilled)+1,r25
95 00c4 8093 0000 sts filterfilled,r24
96 .L6:
97 00c8 1092 0000 sts NORTH_LONG_LONG,__zero_reg__
98 00cc 1092 0000 sts NORTH_LONG_LONG+1,__zero_reg__
99 00d0 1092 0000 sts NORTH_LONG_LONG+2,__zero_reg__
100 00d4 1092 0000 sts NORTH_LONG_LONG+3,__zero_reg__
101 00d8 1092 0000 sts NORTH_LONG_LONG+4,__zero_reg__
102 00dc 1092 0000 sts NORTH_LONG_LONG+5,__zero_reg__
103 00e0 1092 0000 sts NORTH_LONG_LONG+6,__zero_reg__
104 00e4 1092 0000 sts NORTH_LONG_LONG+7,__zero_reg__
105 00e8 1092 0000 sts EAST_LONG_LONG,__zero_reg__
106 00ec 1092 0000 sts EAST_LONG_LONG+1,__zero_reg__
107 00f0 1092 0000 sts EAST_LONG_LONG+2,__zero_reg__
108 00f4 1092 0000 sts EAST_LONG_LONG+3,__zero_reg__
109 00f8 1092 0000 sts EAST_LONG_LONG+4,__zero_reg__
110 00fc 1092 0000 sts EAST_LONG_LONG+5,__zero_reg__
111 0100 1092 0000 sts EAST_LONG_LONG+6,__zero_reg__
112 0104 1092 0000 sts EAST_LONG_LONG+7,__zero_reg__
113 0108 1C82 std Y+4,__zero_reg__
114 010a 1B82 std Y+3,__zero_reg__
115 010c 80E0 ldi r24,lo8(filter_north)
116 010e 90E0 ldi r25,hi8(filter_north)
117 0110 9A83 std Y+2,r25
118 0112 8983 std Y+1,r24
119 0114 A0E0 ldi r26,lo8(filter_east)
120 0116 B0E0 ldi r27,hi8(filter_east)
121 0118 BF8F std Y+31,r27
122 011a AE8F std Y+30,r26
123 011c 00C0 rjmp .L8
124 .L9:
125 011e 2090 0000 lds r2,NORTH_LONG_LONG
126 0122 3090 0000 lds r3,NORTH_LONG_LONG+1
127 0126 4090 0000 lds r4,NORTH_LONG_LONG+2
128 012a 5090 0000 lds r5,NORTH_LONG_LONG+3
129 012e 6090 0000 lds r6,NORTH_LONG_LONG+4
130 0132 7090 0000 lds r7,NORTH_LONG_LONG+5
131 0136 8090 0000 lds r8,NORTH_LONG_LONG+6
132 013a 9090 0000 lds r9,NORTH_LONG_LONG+7
133 013e E981 ldd r30,Y+1
134 0140 FA81 ldd r31,Y+2
135 0142 2081 ld r18,Z
136 0144 3181 ldd r19,Z+1
137 0146 4281 ldd r20,Z+2
138 0148 5381 ldd r21,Z+3
139 014a DA01 movw r26,r20
140 014c C901 movw r24,r18
141 014e BB0F lsl r27
142 0150 880B sbc r24,r24
143 0152 982F mov r25,r24
144 0154 DC01 movw r26,r24
145 0156 2E87 std Y+14,r18
146 0158 3F87 std Y+15,r19
147 015a 488B std Y+16,r20
148 015c 598B std Y+17,r21
149 015e 8A8B std Y+18,r24
150 0160 8B8B std Y+19,r24
151 0162 8C8B std Y+20,r24
152 0164 8D8B std Y+21,r24
153 0166 AE84 ldd r10,Y+14
154 0168 A20C add r10,r2
155 016a 81E0 ldi r24,lo8(1)
156 016c A214 cp r10,r2
157 016e 00F0 brlo .L10
158 0170 80E0 ldi r24,lo8(0)
159 .L10:
160 0172 BF84 ldd r11,Y+15
161 0174 B30C add r11,r3
162 0176 21E0 ldi r18,lo8(1)
163 0178 B314 cp r11,r3
164 017a 00F0 brlo .L11
165 017c 20E0 ldi r18,lo8(0)
166 .L11:
167 017e 8B0D add r24,r11
168 0180 91E0 ldi r25,lo8(1)
169 0182 8B15 cp r24,r11
170 0184 00F0 brlo .L12
171 0186 90E0 ldi r25,lo8(0)
172 .L12:
173 0188 292B or r18,r25
174 018a B82E mov r11,r24
175 018c C888 ldd r12,Y+16
176 018e C40C add r12,r4
177 0190 31E0 ldi r19,lo8(1)
178 0192 C414 cp r12,r4
179 0194 00F0 brlo .L13
180 0196 30E0 ldi r19,lo8(0)
181 .L13:
182 0198 822F mov r24,r18
183 019a 8C0D add r24,r12
184 019c 91E0 ldi r25,lo8(1)
185 019e 8C15 cp r24,r12
186 01a0 00F0 brlo .L14
187 01a2 90E0 ldi r25,lo8(0)
188 .L14:
189 01a4 392B or r19,r25
190 01a6 C82E mov r12,r24
191 01a8 D988 ldd r13,Y+17
192 01aa D50C add r13,r5
193 01ac 21E0 ldi r18,lo8(1)
194 01ae D514 cp r13,r5
195 01b0 00F0 brlo .L15
196 01b2 20E0 ldi r18,lo8(0)
197 .L15:
198 01b4 832F mov r24,r19
199 01b6 8D0D add r24,r13
200 01b8 91E0 ldi r25,lo8(1)
201 01ba 8D15 cp r24,r13
202 01bc 00F0 brlo .L16
203 01be 90E0 ldi r25,lo8(0)
204 .L16:
205 01c0 292B or r18,r25
206 01c2 D82E mov r13,r24
207 01c4 EA88 ldd r14,Y+18
208 01c6 E60C add r14,r6
209 01c8 31E0 ldi r19,lo8(1)
210 01ca E614 cp r14,r6
211 01cc 00F0 brlo .L17
212 01ce 30E0 ldi r19,lo8(0)
213 .L17:
214 01d0 822F mov r24,r18
215 01d2 8E0D add r24,r14
216 01d4 91E0 ldi r25,lo8(1)
217 01d6 8E15 cp r24,r14
218 01d8 00F0 brlo .L18
219 01da 90E0 ldi r25,lo8(0)
220 .L18:
221 01dc 392B or r19,r25
222 01de E82E mov r14,r24
223 01e0 FB88 ldd r15,Y+19
224 01e2 F70C add r15,r7
225 01e4 21E0 ldi r18,lo8(1)
226 01e6 F714 cp r15,r7
227 01e8 00F0 brlo .L19
228 01ea 20E0 ldi r18,lo8(0)
229 .L19:
230 01ec 832F mov r24,r19
231 01ee 8F0D add r24,r15
232 01f0 91E0 ldi r25,lo8(1)
233 01f2 8F15 cp r24,r15
234 01f4 00F0 brlo .L20
235 01f6 90E0 ldi r25,lo8(0)
236 .L20:
237 01f8 292B or r18,r25
238 01fa F82E mov r15,r24
239 01fc 0C89 ldd r16,Y+20
240 01fe 080D add r16,r8
241 0200 91E0 ldi r25,lo8(1)
242 0202 0815 cp r16,r8
243 0204 00F0 brlo .L21
244 0206 90E0 ldi r25,lo8(0)
245 .L21:
246 0208 822F mov r24,r18
247 020a 800F add r24,r16
248 020c E1E0 ldi r30,lo8(1)
249 020e 8017 cp r24,r16
250 0210 00F0 brlo .L22
251 0212 E0E0 ldi r30,lo8(0)
252 .L22:
253 0214 AE2F mov r26,r30
254 0216 A92B or r26,r25
255 0218 1D89 ldd r17,Y+21
256 021a 190D add r17,r9
257 021c A10F add r26,r17
258 021e A092 0000 sts NORTH_LONG_LONG,r10
259 0222 B092 0000 sts NORTH_LONG_LONG+1,r11
260 0226 C092 0000 sts NORTH_LONG_LONG+2,r12
261 022a D092 0000 sts NORTH_LONG_LONG+3,r13
262 022e E092 0000 sts NORTH_LONG_LONG+4,r14
263 0232 F092 0000 sts NORTH_LONG_LONG+5,r15
264 0236 8093 0000 sts NORTH_LONG_LONG+6,r24
265 023a A093 0000 sts NORTH_LONG_LONG+7,r26
266 023e 2090 0000 lds r2,EAST_LONG_LONG
267 0242 3090 0000 lds r3,EAST_LONG_LONG+1
268 0246 4090 0000 lds r4,EAST_LONG_LONG+2
269 024a 5090 0000 lds r5,EAST_LONG_LONG+3
270 024e 6090 0000 lds r6,EAST_LONG_LONG+4
271 0252 7090 0000 lds r7,EAST_LONG_LONG+5
272 0256 8090 0000 lds r8,EAST_LONG_LONG+6
273 025a 9090 0000 lds r9,EAST_LONG_LONG+7
274 025e AE8D ldd r26,Y+30
275 0260 BF8D ldd r27,Y+31
276 0262 2D91 ld r18,X+
277 0264 3D91 ld r19,X+
278 0266 4D91 ld r20,X+
279 0268 5C91 ld r21,X
280 026a DA01 movw r26,r20
281 026c C901 movw r24,r18
282 026e BB0F lsl r27
283 0270 880B sbc r24,r24
284 0272 982F mov r25,r24
285 0274 DC01 movw r26,r24
286 0276 2E8B std Y+22,r18
287 0278 3F8B std Y+23,r19
288 027a 488F std Y+24,r20
289 027c 598F std Y+25,r21
290 027e 8A8F std Y+26,r24
291 0280 8B8F std Y+27,r24
292 0282 8C8F std Y+28,r24
293 0284 8D8F std Y+29,r24
294 0286 AE88 ldd r10,Y+22
295 0288 A20C add r10,r2
296 028a 81E0 ldi r24,lo8(1)
297 028c A214 cp r10,r2
298 028e 00F0 brlo .L23
299 0290 80E0 ldi r24,lo8(0)
300 .L23:
301 0292 BF88 ldd r11,Y+23
302 0294 B30C add r11,r3
303 0296 21E0 ldi r18,lo8(1)
304 0298 B314 cp r11,r3
305 029a 00F0 brlo .L24
306 029c 20E0 ldi r18,lo8(0)
307 .L24:
308 029e 8B0D add r24,r11
309 02a0 91E0 ldi r25,lo8(1)
310 02a2 8B15 cp r24,r11
311 02a4 00F0 brlo .L25
312 02a6 90E0 ldi r25,lo8(0)
313 .L25:
314 02a8 292B or r18,r25
315 02aa B82E mov r11,r24
316 02ac C88C ldd r12,Y+24
317 02ae C40C add r12,r4
318 02b0 31E0 ldi r19,lo8(1)
319 02b2 C414 cp r12,r4
320 02b4 00F0 brlo .L26
321 02b6 30E0 ldi r19,lo8(0)
322 .L26:
323 02b8 822F mov r24,r18
324 02ba 8C0D add r24,r12
325 02bc 91E0 ldi r25,lo8(1)
326 02be 8C15 cp r24,r12
327 02c0 00F0 brlo .L27
328 02c2 90E0 ldi r25,lo8(0)
329 .L27:
330 02c4 392B or r19,r25
331 02c6 C82E mov r12,r24
332 02c8 D98C ldd r13,Y+25
333 02ca D50C add r13,r5
334 02cc 21E0 ldi r18,lo8(1)
335 02ce D514 cp r13,r5
336 02d0 00F0 brlo .L28
337 02d2 20E0 ldi r18,lo8(0)
338 .L28:
339 02d4 832F mov r24,r19
340 02d6 8D0D add r24,r13
341 02d8 91E0 ldi r25,lo8(1)
342 02da 8D15 cp r24,r13
343 02dc 00F0 brlo .L29
344 02de 90E0 ldi r25,lo8(0)
345 .L29:
346 02e0 292B or r18,r25
347 02e2 D82E mov r13,r24
348 02e4 EA8C ldd r14,Y+26
349 02e6 E60C add r14,r6
350 02e8 31E0 ldi r19,lo8(1)
351 02ea E614 cp r14,r6
352 02ec 00F0 brlo .L30
353 02ee 30E0 ldi r19,lo8(0)
354 .L30:
355 02f0 822F mov r24,r18
356 02f2 8E0D add r24,r14
357 02f4 91E0 ldi r25,lo8(1)
358 02f6 8E15 cp r24,r14
359 02f8 00F0 brlo .L31
360 02fa 90E0 ldi r25,lo8(0)
361 .L31:
362 02fc 392B or r19,r25
363 02fe E82E mov r14,r24
364 0300 FB8C ldd r15,Y+27
365 0302 F70C add r15,r7
366 0304 21E0 ldi r18,lo8(1)
367 0306 F714 cp r15,r7
368 0308 00F0 brlo .L32
369 030a 20E0 ldi r18,lo8(0)
370 .L32:
371 030c 832F mov r24,r19
372 030e 8F0D add r24,r15
373 0310 91E0 ldi r25,lo8(1)
374 0312 8F15 cp r24,r15
375 0314 00F0 brlo .L33
376 0316 90E0 ldi r25,lo8(0)
377 .L33:
378 0318 292B or r18,r25
379 031a F82E mov r15,r24
380 031c 0C8D ldd r16,Y+28
381 031e 080D add r16,r8
382 0320 91E0 ldi r25,lo8(1)
383 0322 0815 cp r16,r8
384 0324 00F0 brlo .L34
385 0326 90E0 ldi r25,lo8(0)
386 .L34:
387 0328 822F mov r24,r18
388 032a 800F add r24,r16
389 032c E1E0 ldi r30,lo8(1)
390 032e 8017 cp r24,r16
391 0330 00F0 brlo .L35
392 0332 E0E0 ldi r30,lo8(0)
393 .L35:
394 0334 AE2F mov r26,r30
395 0336 A92B or r26,r25
396 0338 1D8D ldd r17,Y+29
397 033a 190D add r17,r9
398 033c A10F add r26,r17
399 033e A092 0000 sts EAST_LONG_LONG,r10
400 0342 B092 0000 sts EAST_LONG_LONG+1,r11
401 0346 C092 0000 sts EAST_LONG_LONG+2,r12
402 034a D092 0000 sts EAST_LONG_LONG+3,r13
403 034e E092 0000 sts EAST_LONG_LONG+4,r14
404 0352 F092 0000 sts EAST_LONG_LONG+5,r15
405 0356 8093 0000 sts EAST_LONG_LONG+6,r24
406 035a A093 0000 sts EAST_LONG_LONG+7,r26
407 035e EB81 ldd r30,Y+3
408 0360 FC81 ldd r31,Y+4
409 0362 3196 adiw r30,1
410 0364 FC83 std Y+4,r31
411 0366 EB83 std Y+3,r30
412 0368 2981 ldd r18,Y+1
413 036a 3A81 ldd r19,Y+2
414 036c 2C5F subi r18,lo8(-(4))
415 036e 3F4F sbci r19,hi8(-(4))
416 0370 3A83 std Y+2,r19
417 0372 2983 std Y+1,r18
418 0374 8E8D ldd r24,Y+30
419 0376 9F8D ldd r25,Y+31
420 0378 0496 adiw r24,4
421 037a 9F8F std Y+31,r25
422 037c 8E8F std Y+30,r24
423 .L8:
424 037e 8091 0000 lds r24,filterfilled
425 0382 9091 0000 lds r25,(filterfilled)+1
426 0386 AB81 ldd r26,Y+3
427 0388 BC81 ldd r27,Y+4
428 038a A817 cp r26,r24
429 038c B907 cpc r27,r25
430 038e 04F4 brge .+2
431 0390 00C0 rjmp .L9
432 0392 2090 0000 lds r2,NORTH_LONG_LONG
433 0396 3090 0000 lds r3,NORTH_LONG_LONG+1
434 039a 4090 0000 lds r4,NORTH_LONG_LONG+2
435 039e 5090 0000 lds r5,NORTH_LONG_LONG+3
436 03a2 6090 0000 lds r6,NORTH_LONG_LONG+4
437 03a6 7090 0000 lds r7,NORTH_LONG_LONG+5
438 03aa 8090 0000 lds r8,NORTH_LONG_LONG+6
439 03ae 9090 0000 lds r9,NORTH_LONG_LONG+7
440 03b2 A091 0000 lds r26,filterfilled
441 03b6 B091 0000 lds r27,(filterfilled)+1
442 03ba FD01 movw r30,r26
443 03bc FF0F lsl r31
444 03be EE0B sbc r30,r30
445 03c0 FE2F mov r31,r30
446 03c2 9D01 movw r18,r26
447 03c4 AA2E mov r10,r26
448 03c6 B32E mov r11,r19
449 03c8 CE2E mov r12,r30
450 03ca DE2E mov r13,r30
451 03cc EE2E mov r14,r30
452 03ce FE2E mov r15,r30
453 03d0 0E2F mov r16,r30
454 03d2 1E2F mov r17,r30
455 03d4 222D mov r18,r2
456 03d6 332D mov r19,r3
457 03d8 442D mov r20,r4
458 03da 552D mov r21,r5
459 03dc 662D mov r22,r6
460 03de 772D mov r23,r7
461 03e0 882D mov r24,r8
462 03e2 992D mov r25,r9
463 03e4 0E94 0000 call __divdi3
464 03e8 2093 0000 sts NORTH_LONG_LONG,r18
465 03ec 3093 0000 sts NORTH_LONG_LONG+1,r19
466 03f0 4093 0000 sts NORTH_LONG_LONG+2,r20
467 03f4 5093 0000 sts NORTH_LONG_LONG+3,r21
468 03f8 6093 0000 sts NORTH_LONG_LONG+4,r22
469 03fc 7093 0000 sts NORTH_LONG_LONG+5,r23
470 0400 8093 0000 sts NORTH_LONG_LONG+6,r24
471 0404 9093 0000 sts NORTH_LONG_LONG+7,r25
472 0408 2090 0000 lds r2,EAST_LONG_LONG
473 040c 3090 0000 lds r3,EAST_LONG_LONG+1
474 0410 4090 0000 lds r4,EAST_LONG_LONG+2
475 0414 5090 0000 lds r5,EAST_LONG_LONG+3
476 0418 6090 0000 lds r6,EAST_LONG_LONG+4
477 041c 7090 0000 lds r7,EAST_LONG_LONG+5
478 0420 8090 0000 lds r8,EAST_LONG_LONG+6
479 0424 9090 0000 lds r9,EAST_LONG_LONG+7
480 0428 A091 0000 lds r26,filterfilled
481 042c B091 0000 lds r27,(filterfilled)+1
482 0430 FD01 movw r30,r26
483 0432 FF0F lsl r31
484 0434 EE0B sbc r30,r30
485 0436 FE2F mov r31,r30
486 0438 9D01 movw r18,r26
487 043a AA2E mov r10,r26
488 043c B32E mov r11,r19
489 043e CE2E mov r12,r30
490 0440 DE2E mov r13,r30
491 0442 EE2E mov r14,r30
492 0444 FE2E mov r15,r30
493 0446 0E2F mov r16,r30
494 0448 1E2F mov r17,r30
495 044a 222D mov r18,r2
496 044c 332D mov r19,r3
497 044e 442D mov r20,r4
498 0450 552D mov r21,r5
499 0452 662D mov r22,r6
500 0454 772D mov r23,r7
501 0456 882D mov r24,r8
502 0458 992D mov r25,r9
503 045a 0E94 0000 call __divdi3
504 045e 2093 0000 sts EAST_LONG_LONG,r18
505 0462 3093 0000 sts EAST_LONG_LONG+1,r19
506 0466 4093 0000 sts EAST_LONG_LONG+2,r20
507 046a 5093 0000 sts EAST_LONG_LONG+3,r21
508 046e 6093 0000 sts EAST_LONG_LONG+4,r22
509 0472 7093 0000 sts EAST_LONG_LONG+5,r23
510 0476 8093 0000 sts EAST_LONG_LONG+6,r24
511 047a 9093 0000 sts EAST_LONG_LONG+7,r25
512 047e 2091 0000 lds r18,NORTH_LONG_LONG
513 0482 3091 0000 lds r19,NORTH_LONG_LONG+1
514 0486 4091 0000 lds r20,NORTH_LONG_LONG+2
515 048a 5091 0000 lds r21,NORTH_LONG_LONG+3
516 048e 6091 0000 lds r22,NORTH_LONG_LONG+4
517 0492 7091 0000 lds r23,NORTH_LONG_LONG+5
518 0496 8091 0000 lds r24,NORTH_LONG_LONG+6
519 049a 9091 0000 lds r25,NORTH_LONG_LONG+7
520 049e 2093 0000 sts NORTH_MITTEL,r18
521 04a2 3093 0000 sts (NORTH_MITTEL)+1,r19
522 04a6 4093 0000 sts (NORTH_MITTEL)+2,r20
523 04aa 5093 0000 sts (NORTH_MITTEL)+3,r21
524 04ae 2091 0000 lds r18,EAST_LONG_LONG
525 04b2 3091 0000 lds r19,EAST_LONG_LONG+1
526 04b6 4091 0000 lds r20,EAST_LONG_LONG+2
527 04ba 5091 0000 lds r21,EAST_LONG_LONG+3
528 04be 6091 0000 lds r22,EAST_LONG_LONG+4
529 04c2 7091 0000 lds r23,EAST_LONG_LONG+5
530 04c6 8091 0000 lds r24,EAST_LONG_LONG+6
531 04ca 9091 0000 lds r25,EAST_LONG_LONG+7
532 04ce 2093 0000 sts EAST_MITTEL,r18
533 04d2 3093 0000 sts (EAST_MITTEL)+1,r19
534 04d6 4093 0000 sts (EAST_MITTEL)+2,r20
535 04da 5093 0000 sts (EAST_MITTEL)+3,r21
536 04de 81E0 ldi r24,lo8(1)
537 04e0 8093 0000 sts NeuerMittelwert,r24
538 04e4 2091 0000 lds r18,MotorenEin
539 04e8 2130 cpi r18,lo8(1)
540 04ea 01F0 breq .+2
541 04ec 00C0 rjmp .L38
542 04ee 00C0 rjmp .L37
543 .L2:
544 04f0 BD85 ldd r27,Y+13
545 04f2 B330 cpi r27,lo8(3)
546 04f4 00F0 brlo .+2
547 04f6 00C0 rjmp .L38
548 04f8 8091 0000 lds r24,Poti3
549 04fc 9091 0000 lds r25,(Poti3)+1
550 0500 8734 cpi r24,71
551 0502 9105 cpc r25,__zero_reg__
552 0504 04F4 brge .+2
553 0506 00C0 rjmp .L38
554 0508 1092 0000 sts (GPS_Nick)+1,__zero_reg__
555 050c 1092 0000 sts GPS_Nick,__zero_reg__
556 0510 1092 0000 sts (GPS_Roll)+1,__zero_reg__
557 0514 1092 0000 sts GPS_Roll,__zero_reg__
558 0518 4398 cbi 40-0x20,3
559 051a 82E3 ldi r24,lo8(50)
560 051c 90E0 ldi r25,hi8(50)
561 051e 9093 0000 sts (beeptime)+1,r25
562 0522 8093 0000 sts beeptime,r24
563 0526 00C0 rjmp .L38
564 .L37:
565 0528 8091 0000 lds r24,gethome
566 052c 8823 tst r24
567 052e 01F0 breq .+2
568 0530 00C0 rjmp .L41
569 0532 8091 0000 lds r24,modell_fliegt_gps
570 0536 9091 0000 lds r25,(modell_fliegt_gps)+1
571 053a 805D subi r24,lo8(2000)
572 053c 9740 sbci r25,hi8(2000)
573 053e 00F0 brlo .+2
574 0540 00C0 rjmp .L41
575 0542 8091 0000 lds r24,NORTH_MITTEL
576 0546 9091 0000 lds r25,(NORTH_MITTEL)+1
577 054a A091 0000 lds r26,(NORTH_MITTEL)+2
578 054e B091 0000 lds r27,(NORTH_MITTEL)+3
579 0552 8093 0000 sts GPS_Home_North,r24
580 0556 9093 0000 sts (GPS_Home_North)+1,r25
581 055a A093 0000 sts (GPS_Home_North)+2,r26
582 055e B093 0000 sts (GPS_Home_North)+3,r27
583 0562 8091 0000 lds r24,EAST_MITTEL
584 0566 9091 0000 lds r25,(EAST_MITTEL)+1
585 056a A091 0000 lds r26,(EAST_MITTEL)+2
586 056e B091 0000 lds r27,(EAST_MITTEL)+3
587 0572 8093 0000 sts GPS_Home_East,r24
588 0576 9093 0000 sts (GPS_Home_East)+1,r25
589 057a A093 0000 sts (GPS_Home_East)+2,r26
590 057e B093 0000 sts (GPS_Home_East)+3,r27
591 0582 8091 0000 lds r24,NORTH_MITTEL
592 0586 9091 0000 lds r25,(NORTH_MITTEL)+1
593 058a A091 0000 lds r26,(NORTH_MITTEL)+2
594 058e B091 0000 lds r27,(NORTH_MITTEL)+3
595 0592 8093 0000 sts Soll_Position_North,r24
596 0596 9093 0000 sts (Soll_Position_North)+1,r25
597 059a A093 0000 sts (Soll_Position_North)+2,r26
598 059e B093 0000 sts (Soll_Position_North)+3,r27
599 05a2 8091 0000 lds r24,EAST_MITTEL
600 05a6 9091 0000 lds r25,(EAST_MITTEL)+1
601 05aa A091 0000 lds r26,(EAST_MITTEL)+2
602 05ae B091 0000 lds r27,(EAST_MITTEL)+3
603 05b2 8093 0000 sts Soll_Position_East,r24
604 05b6 9093 0000 sts (Soll_Position_East)+1,r25
605 05ba A093 0000 sts (Soll_Position_East)+2,r26
606 05be B093 0000 sts (Soll_Position_East)+3,r27
607 05c2 82E3 ldi r24,lo8(50)
608 05c4 90E0 ldi r25,hi8(50)
609 05c6 9093 0000 sts (beeptime)+1,r25
610 05ca 8093 0000 sts beeptime,r24
611 05ce 2093 0000 sts gethome,r18
612 05d2 00C0 rjmp .L41
613 .L38:
614 05d4 8091 0000 lds r24,MotorenEin
615 05d8 8823 tst r24
616 05da 01F4 brne .L41
617 05dc 1092 0000 sts GPS_Home_North,__zero_reg__
618 05e0 1092 0000 sts (GPS_Home_North)+1,__zero_reg__
619 05e4 1092 0000 sts (GPS_Home_North)+2,__zero_reg__
620 05e8 1092 0000 sts (GPS_Home_North)+3,__zero_reg__
621 05ec 1092 0000 sts GPS_Home_East,__zero_reg__
622 05f0 1092 0000 sts (GPS_Home_East)+1,__zero_reg__
623 05f4 1092 0000 sts (GPS_Home_East)+2,__zero_reg__
624 05f8 1092 0000 sts (GPS_Home_East)+3,__zero_reg__
625 05fc 1092 0000 sts gethome,__zero_reg__
626 0600 1092 0000 sts (modell_fliegt_gps)+1,__zero_reg__
627 0604 1092 0000 sts modell_fliegt_gps,__zero_reg__
628 .L41:
629 0608 2091 0000 lds r18,Poti3
630 060c 3091 0000 lds r19,(Poti3)+1
631 0610 3F8F std Y+31,r19
632 0612 2E8F std Y+30,r18
633 0614 2634 cpi r18,70
634 0616 3105 cpc r19,__zero_reg__
635 0618 04F4 brge .L45
636 061a 8091 0000 lds r24,NORTH_MITTEL
637 061e 9091 0000 lds r25,(NORTH_MITTEL)+1
638 0622 A091 0000 lds r26,(NORTH_MITTEL)+2
639 0626 B091 0000 lds r27,(NORTH_MITTEL)+3
640 062a 8093 0000 sts Soll_Position_North,r24
641 062e 9093 0000 sts (Soll_Position_North)+1,r25
642 0632 A093 0000 sts (Soll_Position_North)+2,r26
643 0636 B093 0000 sts (Soll_Position_North)+3,r27
644 063a 8091 0000 lds r24,EAST_MITTEL
645 063e 9091 0000 lds r25,(EAST_MITTEL)+1
646 0642 A091 0000 lds r26,(EAST_MITTEL)+2
647 0646 B091 0000 lds r27,(EAST_MITTEL)+3
648 064a 8093 0000 sts Soll_Position_East,r24
649 064e 9093 0000 sts (Soll_Position_East)+1,r25
650 0652 A093 0000 sts (Soll_Position_East)+2,r26
651 0656 B093 0000 sts (Soll_Position_East)+3,r27
652 065a 1092 0000 sts (GPS_Nick)+1,__zero_reg__
653 065e 1092 0000 sts GPS_Nick,__zero_reg__
654 0662 1092 0000 sts (GPS_Roll)+1,__zero_reg__
655 0666 1092 0000 sts GPS_Roll,__zero_reg__
656 066a 4398 cbi 40-0x20,3
657 .L45:
658 066c 3D85 ldd r19,Y+13
659 066e 3330 cpi r19,lo8(3)
660 0670 01F0 breq .+2
661 0672 00C0 rjmp .L94
662 0674 8E8D ldd r24,Y+30
663 0676 9F8D ldd r25,Y+31
664 0678 8734 cpi r24,71
665 067a 9105 cpc r25,__zero_reg__
666 067c 04F4 brge .+2
667 067e 00C0 rjmp .L94
668 0680 8639 cpi r24,150
669 0682 9105 cpc r25,__zero_reg__
670 0684 04F0 brlt .+2
671 0686 00C0 rjmp .L50
672 0688 8091 0000 lds r24,StickNick
673 068c 9091 0000 lds r25,(StickNick)+1
674 0690 0C96 adiw r24,12
675 0692 4997 sbiw r24,25
676 0694 00F4 brsh .L52
677 0696 8091 0000 lds r24,StickRoll
678 069a 9091 0000 lds r25,(StickRoll)+1
679 069e 8D30 cpi r24,13
680 06a0 9105 cpc r25,__zero_reg__
681 06a2 04F4 brge .L52
682 06a4 845F subi r24,lo8(-12)
683 06a6 9F4F sbci r25,hi8(-12)
684 06a8 04F4 brge .L50
685 .L52:
686 06aa 1092 0000 sts (GPS_Nick)+1,__zero_reg__
687 06ae 1092 0000 sts GPS_Nick,__zero_reg__
688 06b2 1092 0000 sts (GPS_Roll)+1,__zero_reg__
689 06b6 1092 0000 sts GPS_Roll,__zero_reg__
690 06ba 8091 0000 lds r24,NORTH_MITTEL
691 06be 9091 0000 lds r25,(NORTH_MITTEL)+1
692 06c2 A091 0000 lds r26,(NORTH_MITTEL)+2
693 06c6 B091 0000 lds r27,(NORTH_MITTEL)+3
694 06ca 8093 0000 sts Soll_Position_North,r24
695 06ce 9093 0000 sts (Soll_Position_North)+1,r25
696 06d2 A093 0000 sts (Soll_Position_North)+2,r26
697 06d6 B093 0000 sts (Soll_Position_North)+3,r27
698 06da 8091 0000 lds r24,EAST_MITTEL
699 06de 9091 0000 lds r25,(EAST_MITTEL)+1
700 06e2 A091 0000 lds r26,(EAST_MITTEL)+2
701 06e6 B091 0000 lds r27,(EAST_MITTEL)+3
702 06ea 8093 0000 sts Soll_Position_East,r24
703 06ee 9093 0000 sts (Soll_Position_East)+1,r25
704 06f2 A093 0000 sts (Soll_Position_East)+2,r26
705 06f6 B093 0000 sts (Soll_Position_East)+3,r27
706 06fa 8091 0000 lds r24,blinkcount_LED2
707 06fe 883C cpi r24,lo8(-56)
708 0700 00F0 brlo .L55
709 0702 88B1 in r24,40-0x20
710 0704 98E0 ldi r25,lo8(8)
711 0706 8927 eor r24,r25
712 0708 88B9 out 40-0x20,r24
713 070a 1092 0000 sts blinkcount_LED2,__zero_reg__
714 .L55:
715 070e 8091 0000 lds r24,blinkcount_LED2
716 0712 8F5F subi r24,lo8(-(1))
717 0714 8093 0000 sts blinkcount_LED2,r24
718 .L50:
719 0718 8091 0000 lds r24,NeuerMittelwert
720 071c 8130 cpi r24,lo8(1)
721 071e 01F0 breq .+2
722 0720 00C0 rjmp .L94
723 0722 E090 0000 lds r14,Soll_Position_North
724 0726 F090 0000 lds r15,(Soll_Position_North)+1
725 072a 0091 0000 lds r16,(Soll_Position_North)+2
726 072e 1091 0000 lds r17,(Soll_Position_North)+3
727 0732 E114 cp r14,__zero_reg__
728 0734 F104 cpc r15,__zero_reg__
729 0736 0105 cpc r16,__zero_reg__
730 0738 1105 cpc r17,__zero_reg__
731 073a 01F4 brne .+2
732 073c 00C0 rjmp .L94
733 073e A090 0000 lds r10,Soll_Position_East
734 0742 B090 0000 lds r11,(Soll_Position_East)+1
735 0746 C090 0000 lds r12,(Soll_Position_East)+2
736 074a D090 0000 lds r13,(Soll_Position_East)+3
737 074e A114 cp r10,__zero_reg__
738 0750 B104 cpc r11,__zero_reg__
739 0752 C104 cpc r12,__zero_reg__
740 0754 D104 cpc r13,__zero_reg__
741 0756 01F4 brne .+2
742 0758 00C0 rjmp .L94
743 075a 8091 0000 lds r24,StickNick
744 075e 9091 0000 lds r25,(StickNick)+1
745 0762 8D30 cpi r24,13
746 0764 9105 cpc r25,__zero_reg__
747 0766 04F0 brlt .+2
748 0768 00C0 rjmp .L94
749 076a 845F subi r24,lo8(-12)
750 076c 9F4F sbci r25,hi8(-12)
751 076e 04F4 brge .+2
752 0770 00C0 rjmp .L94
753 0772 8091 0000 lds r24,StickRoll
754 0776 9091 0000 lds r25,(StickRoll)+1
755 077a 8D30 cpi r24,13
756 077c 9105 cpc r25,__zero_reg__
757 077e 04F0 brlt .+2
758 0780 00C0 rjmp .L94
759 0782 845F subi r24,lo8(-12)
760 0784 9F4F sbci r25,hi8(-12)
761 0786 04F4 brge .+2
762 0788 00C0 rjmp .L94
763 078a 2E8D ldd r18,Y+30
764 078c 3F8D ldd r19,Y+31
765 078e 2639 cpi r18,150
766 0790 3105 cpc r19,__zero_reg__
767 0792 04F0 brlt .+2
768 0794 00C0 rjmp .L64
769 0796 8091 0000 lds r24,NORTH_MITTEL
770 079a 9091 0000 lds r25,(NORTH_MITTEL)+1
771 079e A091 0000 lds r26,(NORTH_MITTEL)+2
772 07a2 B091 0000 lds r27,(NORTH_MITTEL)+3
773 07a6 E81A sub r14,r24
774 07a8 F90A sbc r15,r25
775 07aa 0A0B sbc r16,r26
776 07ac 1B0B sbc r17,r27
777 07ae E092 0000 sts GPS_Positionsabweichung_North,r14
778 07b2 F092 0000 sts (GPS_Positionsabweichung_North)+1,r15
779 07b6 0093 0000 sts (GPS_Positionsabweichung_North)+2,r16
780 07ba 1093 0000 sts (GPS_Positionsabweichung_North)+3,r17
781 07be 8091 0000 lds r24,EAST_MITTEL
782 07c2 9091 0000 lds r25,(EAST_MITTEL)+1
783 07c6 A091 0000 lds r26,(EAST_MITTEL)+2
784 07ca B091 0000 lds r27,(EAST_MITTEL)+3
785 07ce A81A sub r10,r24
786 07d0 B90A sbc r11,r25
787 07d2 CA0A sbc r12,r26
788 07d4 DB0A sbc r13,r27
789 07d6 A092 0000 sts GPS_Positionsabweichung_East,r10
790 07da B092 0000 sts (GPS_Positionsabweichung_East)+1,r11
791 07de C092 0000 sts (GPS_Positionsabweichung_East)+2,r12
792 07e2 D092 0000 sts (GPS_Positionsabweichung_East)+3,r13
793 07e6 00C0 rjmp .L96
794 .L67:
795 07e8 E090 0000 lds r14,GPS_Home_East
796 07ec F090 0000 lds r15,(GPS_Home_East)+1
797 07f0 0091 0000 lds r16,(GPS_Home_East)+2
798 07f4 1091 0000 lds r17,(GPS_Home_East)+3
799 07f8 E114 cp r14,__zero_reg__
800 07fa F104 cpc r15,__zero_reg__
801 07fc 0105 cpc r16,__zero_reg__
802 07fe 1105 cpc r17,__zero_reg__
803 0800 01F4 brne .+2
804 0802 00C0 rjmp .L66
805 0804 8091 0000 lds r24,NORTH_MITTEL
806 0808 9091 0000 lds r25,(NORTH_MITTEL)+1
807 080c A091 0000 lds r26,(NORTH_MITTEL)+2
808 0810 B091 0000 lds r27,(NORTH_MITTEL)+3
809 0814 281B sub r18,r24
810 0816 390B sbc r19,r25
811 0818 4A0B sbc r20,r26
812 081a 5B0B sbc r21,r27
813 081c 2093 0000 sts GPS_Positionsabweichung_North,r18
814 0820 3093 0000 sts (GPS_Positionsabweichung_North)+1,r19
815 0824 4093 0000 sts (GPS_Positionsabweichung_North)+2,r20
816 0828 5093 0000 sts (GPS_Positionsabweichung_North)+3,r21
817 082c 8091 0000 lds r24,EAST_MITTEL
818 0830 9091 0000 lds r25,(EAST_MITTEL)+1
819 0834 A091 0000 lds r26,(EAST_MITTEL)+2
820 0838 B091 0000 lds r27,(EAST_MITTEL)+3
821 083c E81A sub r14,r24
822 083e F90A sbc r15,r25
823 0840 0A0B sbc r16,r26
824 0842 1B0B sbc r17,r27
825 0844 E092 0000 sts GPS_Positionsabweichung_East,r14
826 0848 F092 0000 sts (GPS_Positionsabweichung_East)+1,r15
827 084c 0093 0000 sts (GPS_Positionsabweichung_East)+2,r16
828 0850 1093 0000 sts (GPS_Positionsabweichung_East)+3,r17
829 0854 8091 0000 lds r24,NORTH_MITTEL
830 0858 9091 0000 lds r25,(NORTH_MITTEL)+1
831 085c A091 0000 lds r26,(NORTH_MITTEL)+2
832 0860 B091 0000 lds r27,(NORTH_MITTEL)+3
833 0864 8093 0000 sts Soll_Position_North,r24
834 0868 9093 0000 sts (Soll_Position_North)+1,r25
835 086c A093 0000 sts (Soll_Position_North)+2,r26
836 0870 B093 0000 sts (Soll_Position_North)+3,r27
837 0874 8091 0000 lds r24,EAST_MITTEL
838 0878 9091 0000 lds r25,(EAST_MITTEL)+1
839 087c A091 0000 lds r26,(EAST_MITTEL)+2
840 0880 B091 0000 lds r27,(EAST_MITTEL)+3
841 0884 8093 0000 sts Soll_Position_East,r24
842 0888 9093 0000 sts (Soll_Position_East)+1,r25
843 088c A093 0000 sts (Soll_Position_East)+2,r26
844 0890 B093 0000 sts (Soll_Position_East)+3,r27
845 .L96:
846 0894 439A sbi 40-0x20,3
847 0896 00C0 rjmp .L66
848 .L95:
849 0898 8091 0000 lds r24,GPS_Home_East
850 089c 9091 0000 lds r25,(GPS_Home_East)+1
851 08a0 A091 0000 lds r26,(GPS_Home_East)+2
852 08a4 B091 0000 lds r27,(GPS_Home_East)+3
853 08a8 0097 sbiw r24,0
854 08aa A105 cpc r26,__zero_reg__
855 08ac B105 cpc r27,__zero_reg__
856 08ae 01F4 brne .L66
857 08b0 8091 0000 lds r24,NORTH_MITTEL
858 08b4 9091 0000 lds r25,(NORTH_MITTEL)+1
859 08b8 A091 0000 lds r26,(NORTH_MITTEL)+2
860 08bc B091 0000 lds r27,(NORTH_MITTEL)+3
861 08c0 E81A sub r14,r24
862 08c2 F90A sbc r15,r25
863 08c4 0A0B sbc r16,r26
864 08c6 1B0B sbc r17,r27
865 08c8 E092 0000 sts GPS_Positionsabweichung_North,r14
866 08cc F092 0000 sts (GPS_Positionsabweichung_North)+1,r15
867 08d0 0093 0000 sts (GPS_Positionsabweichung_North)+2,r16
868 08d4 1093 0000 sts (GPS_Positionsabweichung_North)+3,r17
869 08d8 8091 0000 lds r24,EAST_MITTEL
870 08dc 9091 0000 lds r25,(EAST_MITTEL)+1
871 08e0 A091 0000 lds r26,(EAST_MITTEL)+2
872 08e4 B091 0000 lds r27,(EAST_MITTEL)+3
873 08e8 A81A sub r10,r24
874 08ea B90A sbc r11,r25
875 08ec CA0A sbc r12,r26
876 08ee DB0A sbc r13,r27
877 08f0 A092 0000 sts GPS_Positionsabweichung_East,r10
878 08f4 B092 0000 sts (GPS_Positionsabweichung_East)+1,r11
879 08f8 C092 0000 sts (GPS_Positionsabweichung_East)+2,r12
880 08fc D092 0000 sts (GPS_Positionsabweichung_East)+3,r13
881 0900 439A sbi 40-0x20,3
882 0902 82E3 ldi r24,lo8(50)
883 0904 90E0 ldi r25,hi8(50)
884 0906 9093 0000 sts (beeptime)+1,r25
885 090a 8093 0000 sts beeptime,r24
886 .L66:
887 090e E090 0000 lds r14,actualPos+36
888 0912 F090 0000 lds r15,(actualPos+36)+1
889 0916 0091 0000 lds r16,(actualPos+36)+2
890 091a 1091 0000 lds r17,(actualPos+36)+3
891 091e E092 0000 sts GPS_Geschwindigkeit_North,r14
892 0922 F092 0000 sts (GPS_Geschwindigkeit_North)+1,r15
893 0926 0093 0000 sts (GPS_Geschwindigkeit_North)+2,r16
894 092a 1093 0000 sts (GPS_Geschwindigkeit_North)+3,r17
895 092e A090 0000 lds r10,actualPos+40
896 0932 B090 0000 lds r11,(actualPos+40)+1
897 0936 C090 0000 lds r12,(actualPos+40)+2
898 093a D090 0000 lds r13,(actualPos+40)+3
899 093e A092 0000 sts GPS_Geschwindigkeit_East,r10
900 0942 B092 0000 sts (GPS_Geschwindigkeit_East)+1,r11
901 0946 C092 0000 sts (GPS_Geschwindigkeit_East)+2,r12
902 094a D092 0000 sts (GPS_Geschwindigkeit_East)+3,r13
903 094e 6091 0000 lds r22,P_GPS_Verstaerkung
904 0952 7091 0000 lds r23,(P_GPS_Verstaerkung)+1
905 0956 6090 0000 lds r6,GPS_Positionsabweichung_North
906 095a 7090 0000 lds r7,(GPS_Positionsabweichung_North)+1
907 095e 8090 0000 lds r8,(GPS_Positionsabweichung_North)+2
908 0962 9090 0000 lds r9,(GPS_Positionsabweichung_North)+3
909 0966 8827 clr r24
910 0968 77FD sbrc r23,7
911 096a 8095 com r24
912 096c 982F mov r25,r24
913 096e A401 movw r20,r8
914 0970 9301 movw r18,r6
915 0972 0E94 0000 call __mulsi3
916 0976 0E94 0000 call __floatsisf
917 097a 2FE6 ldi r18,lo8(0x3a03126f)
918 097c 32E1 ldi r19,hi8(0x3a03126f)
919 097e 43E0 ldi r20,hlo8(0x3a03126f)
920 0980 5AE3 ldi r21,hhi8(0x3a03126f)
921 0982 0E94 0000 call __mulsf3
922 0986 0E94 0000 call __fixsfsi
923 098a 6987 std Y+9,r22
924 098c 7A87 std Y+10,r23
925 098e 8B87 std Y+11,r24
926 0990 9C87 std Y+12,r25
927 0992 6093 0000 sts P_Einfluss_North,r22
928 0996 7093 0000 sts (P_Einfluss_North)+1,r23
929 099a 8093 0000 sts (P_Einfluss_North)+2,r24
930 099e 9093 0000 sts (P_Einfluss_North)+3,r25
931 09a2 6091 0000 lds r22,D_GPS_Verstaerkung
932 09a6 7091 0000 lds r23,(D_GPS_Verstaerkung)+1
933 09aa 8827 clr r24
934 09ac 77FD sbrc r23,7
935 09ae 8095 com r24
936 09b0 982F mov r25,r24
937 09b2 A801 movw r20,r16
938 09b4 9701 movw r18,r14
939 09b6 0E94 0000 call __mulsi3
940 09ba 0E94 0000 call __floatsisf
941 09be 21E2 ldi r18,lo8(0x3b5a3c21)
942 09c0 3CE3 ldi r19,hi8(0x3b5a3c21)
943 09c2 4AE5 ldi r20,hlo8(0x3b5a3c21)
944 09c4 5BE3 ldi r21,hhi8(0x3b5a3c21)
945 09c6 0E94 0000 call __mulsf3
946 09ca 0E94 0000 call __fixsfsi
947 09ce 1B01 movw r2,r22
948 09d0 2C01 movw r4,r24
949 09d2 6093 0000 sts D_Einfluss_North,r22
950 09d6 7093 0000 sts (D_Einfluss_North)+1,r23
951 09da 8093 0000 sts (D_Einfluss_North)+2,r24
952 09de 9093 0000 sts (D_Einfluss_North)+3,r25
953 09e2 6091 0000 lds r22,P_GPS_Verstaerkung
954 09e6 7091 0000 lds r23,(P_GPS_Verstaerkung)+1
955 09ea E090 0000 lds r14,GPS_Positionsabweichung_East
956 09ee F090 0000 lds r15,(GPS_Positionsabweichung_East)+1
957 09f2 0091 0000 lds r16,(GPS_Positionsabweichung_East)+2
958 09f6 1091 0000 lds r17,(GPS_Positionsabweichung_East)+3
959 09fa 8827 clr r24
960 09fc 77FD sbrc r23,7
961 09fe 8095 com r24
962 0a00 982F mov r25,r24
963 0a02 A801 movw r20,r16
964 0a04 9701 movw r18,r14
965 0a06 0E94 0000 call __mulsi3
966 0a0a 0E94 0000 call __floatsisf
967 0a0e 2FE6 ldi r18,lo8(0x3a03126f)
968 0a10 32E1 ldi r19,hi8(0x3a03126f)
969 0a12 43E0 ldi r20,hlo8(0x3a03126f)
970 0a14 5AE3 ldi r21,hhi8(0x3a03126f)
971 0a16 0E94 0000 call __mulsf3
972 0a1a 0E94 0000 call __fixsfsi
973 0a1e 6D83 std Y+5,r22
974 0a20 7E83 std Y+6,r23
975 0a22 8F83 std Y+7,r24
976 0a24 9887 std Y+8,r25
977 0a26 6093 0000 sts P_Einfluss_East,r22
978 0a2a 7093 0000 sts (P_Einfluss_East)+1,r23
979 0a2e 8093 0000 sts (P_Einfluss_East)+2,r24
980 0a32 9093 0000 sts (P_Einfluss_East)+3,r25
981 0a36 6091 0000 lds r22,D_GPS_Verstaerkung
982 0a3a 7091 0000 lds r23,(D_GPS_Verstaerkung)+1
983 0a3e 8827 clr r24
984 0a40 77FD sbrc r23,7
985 0a42 8095 com r24
986 0a44 982F mov r25,r24
987 0a46 A601 movw r20,r12
988 0a48 9501 movw r18,r10
989 0a4a 0E94 0000 call __mulsi3
990 0a4e 0E94 0000 call __floatsisf
991 0a52 21E2 ldi r18,lo8(0x3b5a3c21)
992 0a54 3CE3 ldi r19,hi8(0x3b5a3c21)
993 0a56 4AE5 ldi r20,hlo8(0x3b5a3c21)
994 0a58 5BE3 ldi r21,hhi8(0x3b5a3c21)
995 0a5a 0E94 0000 call __mulsf3
996 0a5e 0E94 0000 call __fixsfsi
997 0a62 5B01 movw r10,r22
998 0a64 6C01 movw r12,r24
999 0a66 6093 0000 sts D_Einfluss_East,r22
1000 0a6a 7093 0000 sts (D_Einfluss_East)+1,r23
1001 0a6e 8093 0000 sts (D_Einfluss_East)+2,r24
1002 0a72 9093 0000 sts (D_Einfluss_East)+3,r25
1003 0a76 8E8D ldd r24,Y+30
1004 0a78 9F8D ldd r25,Y+31
1005 0a7a 8639 cpi r24,150
1006 0a7c 9105 cpc r25,__zero_reg__
1007 0a7e 04F4 brge .+2
1008 0a80 00C0 rjmp .L71
1009 0a82 8091 0000 lds r24,GPS_Home_North
1010 0a86 9091 0000 lds r25,(GPS_Home_North)+1
1011 0a8a A091 0000 lds r26,(GPS_Home_North)+2
1012 0a8e B091 0000 lds r27,(GPS_Home_North)+3
1013 0a92 0097 sbiw r24,0
1014 0a94 A105 cpc r26,__zero_reg__
1015 0a96 B105 cpc r27,__zero_reg__
1016 0a98 01F4 brne .+2
1017 0a9a 00C0 rjmp .L71
1018 0a9c 8091 0000 lds r24,GPS_Home_East
1019 0aa0 9091 0000 lds r25,(GPS_Home_East)+1
1020 0aa4 A091 0000 lds r26,(GPS_Home_East)+2
1021 0aa8 B091 0000 lds r27,(GPS_Home_East)+3
1022 0aac 0097 sbiw r24,0
1023 0aae A105 cpc r26,__zero_reg__
1024 0ab0 B105 cpc r27,__zero_reg__
1025 0ab2 01F4 brne .+2
1026 0ab4 00C0 rjmp .L71
1027 0ab6 C301 movw r24,r6
1028 0ab8 77FE sbrs r7,7
1029 0aba 00C0 rjmp .L76
1030 0abc 9095 com r25
1031 0abe 8195 neg r24
1032 0ac0 9F4F sbci r25,lo8(-1)
1033 .L76:
1034 0ac2 8B3F cpi r24,251
1035 0ac4 9105 cpc r25,__zero_reg__
1036 0ac6 04F4 brge .L75
1037 0ac8 C701 movw r24,r14
1038 0aca F7FE sbrs r15,7
1039 0acc 00C0 rjmp .L78
1040 0ace 9095 com r25
1041 0ad0 8195 neg r24
1042 0ad2 9F4F sbci r25,lo8(-1)
1043 .L78:
1044 0ad4 8B3F cpi r24,251
1045 0ad6 9105 cpc r25,__zero_reg__
1046 0ad8 04F4 brge .+2
1047 0ada 00C0 rjmp .L71
1048 .L75:
1049 0adc 8091 0000 lds r24,Limit_D_Anteil
1050 0ae0 282F mov r18,r24
1051 0ae2 3327 clr r19
1052 0ae4 4427 clr r20
1053 0ae6 5527 clr r21
1054 0ae8 2215 cp r18,r2
1055 0aea 3305 cpc r19,r3
1056 0aec 4405 cpc r20,r4
1057 0aee 5505 cpc r21,r5
1058 0af0 04F4 brge .L79
1059 0af2 2093 0000 sts D_Einfluss_North,r18
1060 0af6 3093 0000 sts (D_Einfluss_North)+1,r19
1061 0afa 4093 0000 sts (D_Einfluss_North)+2,r20
1062 0afe 5093 0000 sts (D_Einfluss_North)+3,r21
1063 .L79:
1064 0b02 2A15 cp r18,r10
1065 0b04 3B05 cpc r19,r11
1066 0b06 4C05 cpc r20,r12
1067 0b08 5D05 cpc r21,r13
1068 0b0a 04F4 brge .L81
1069 0b0c 2093 0000 sts D_Einfluss_East,r18
1070 0b10 3093 0000 sts (D_Einfluss_East)+1,r19
1071 0b14 4093 0000 sts (D_Einfluss_East)+2,r20
1072 0b18 5093 0000 sts (D_Einfluss_East)+3,r21
1073 .L81:
1074 0b1c 9927 clr r25
1075 0b1e 9095 com r25
1076 0b20 8195 neg r24
1077 0b22 9F4F sbci r25,lo8(-1)
1078 0b24 9C01 movw r18,r24
1079 0b26 4427 clr r20
1080 0b28 37FD sbrc r19,7
1081 0b2a 4095 com r20
1082 0b2c 542F mov r21,r20
1083 0b2e 8091 0000 lds r24,D_Einfluss_North
1084 0b32 9091 0000 lds r25,(D_Einfluss_North)+1
1085 0b36 A091 0000 lds r26,(D_Einfluss_North)+2
1086 0b3a B091 0000 lds r27,(D_Einfluss_North)+3
1087 0b3e 8217 cp r24,r18
1088 0b40 9307 cpc r25,r19
1089 0b42 A407 cpc r26,r20
1090 0b44 B507 cpc r27,r21
1091 0b46 04F4 brge .L83
1092 0b48 2093 0000 sts D_Einfluss_North,r18
1093 0b4c 3093 0000 sts (D_Einfluss_North)+1,r19
1094 0b50 4093 0000 sts (D_Einfluss_North)+2,r20
1095 0b54 5093 0000 sts (D_Einfluss_North)+3,r21
1096 .L83:
1097 0b58 8091 0000 lds r24,D_Einfluss_East
1098 0b5c 9091 0000 lds r25,(D_Einfluss_East)+1
1099 0b60 A091 0000 lds r26,(D_Einfluss_East)+2
1100 0b64 B091 0000 lds r27,(D_Einfluss_East)+3
1101 0b68 8217 cp r24,r18
1102 0b6a 9307 cpc r25,r19
1103 0b6c A407 cpc r26,r20
1104 0b6e B507 cpc r27,r21
1105 0b70 04F4 brge .L71
1106 0b72 2093 0000 sts D_Einfluss_East,r18
1107 0b76 3093 0000 sts (D_Einfluss_East)+1,r19
1108 0b7a 4093 0000 sts (D_Einfluss_East)+2,r20
1109 0b7e 5093 0000 sts (D_Einfluss_East)+3,r21
1110 .L71:
1111 0b82 E090 0000 lds r14,D_Einfluss_North
1112 0b86 F090 0000 lds r15,(D_Einfluss_North)+1
1113 0b8a A985 ldd r26,Y+9
1114 0b8c BA85 ldd r27,Y+10
1115 0b8e EA1A sub r14,r26
1116 0b90 FB0A sbc r15,r27
1117 0b92 F092 0000 sts (GPS_North)+1,r15
1118 0b96 E092 0000 sts GPS_North,r14
1119 0b9a 8091 0000 lds r24,D_Einfluss_East
1120 0b9e 9091 0000 lds r25,(D_Einfluss_East)+1
1121 0ba2 6D81 ldd r22,Y+5
1122 0ba4 7E81 ldd r23,Y+6
1123 0ba6 681B sub r22,r24
1124 0ba8 790B sbc r23,r25
1125 0baa 7093 0000 sts (GPS_East)+1,r23
1126 0bae 6093 0000 sts GPS_East,r22
1127 0bb2 C090 0000 lds r12,KompassValue
1128 0bb6 D090 0000 lds r13,(KompassValue)+1
1129 0bba 8827 clr r24
1130 0bbc 77FD sbrc r23,7
1131 0bbe 8095 com r24
1132 0bc0 982F mov r25,r24
1133 0bc2 0E94 0000 call __floatsisf
1134 0bc6 3B01 movw r6,r22
1135 0bc8 4C01 movw r8,r24
1136 0bca A090 0000 lds r10,KompassValue
1137 0bce B090 0000 lds r11,(KompassValue)+1
1138 0bd2 0027 clr r16
1139 0bd4 F7FC sbrc r15,7
1140 0bd6 0095 com r16
1141 0bd8 102F mov r17,r16
1142 0bda C801 movw r24,r16
1143 0bdc B701 movw r22,r14
1144 0bde 0E94 0000 call __floatsisf
1145 0be2 1B01 movw r2,r22
1146 0be4 2C01 movw r4,r24
1147 0be6 CC0C lsl r12
1148 0be8 DD1C rol r13
1149 0bea E0E0 ldi r30,lo8(c_sin)
1150 0bec F0E0 ldi r31,hi8(c_sin)
1151 0bee CE0E add r12,r30
1152 0bf0 DF1E adc r13,r31
1153 0bf2 D601 movw r26,r12
1154 0bf4 6D91 ld r22,X+
1155 0bf6 7C91 ld r23,X
1156 0bf8 7095 com r23
1157 0bfa 6195 neg r22
1158 0bfc 7F4F sbci r23,lo8(-1)
1159 0bfe 8827 clr r24
1160 0c00 77FD sbrc r23,7
1161 0c02 8095 com r24
1162 0c04 982F mov r25,r24
1163 0c06 0E94 0000 call __floatsisf
1164 0c0a 2FE6 ldi r18,lo8(0x3a83126f)
1165 0c0c 32E1 ldi r19,hi8(0x3a83126f)
1166 0c0e 43E8 ldi r20,hlo8(0x3a83126f)
1167 0c10 5AE3 ldi r21,hhi8(0x3a83126f)
1168 0c12 0E94 0000 call __mulsf3
1169 0c16 A401 movw r20,r8
1170 0c18 9301 movw r18,r6
1171 0c1a 0E94 0000 call __mulsf3
1172 0c1e 7B01 movw r14,r22
1173 0c20 8C01 movw r16,r24
1174 0c22 AA0C lsl r10
1175 0c24 BB1C rol r11
1176 0c26 E0E0 ldi r30,lo8(c_cos)
1177 0c28 F0E0 ldi r31,hi8(c_cos)
1178 0c2a AE0E add r10,r30
1179 0c2c BF1E adc r11,r31
1180 0c2e D501 movw r26,r10
1181 0c30 6D91 ld r22,X+
1182 0c32 7C91 ld r23,X
1183 0c34 8827 clr r24
1184 0c36 77FD sbrc r23,7
1185 0c38 8095 com r24
1186 0c3a 982F mov r25,r24
1187 0c3c 0E94 0000 call __floatsisf
1188 0c40 2FE6 ldi r18,lo8(0x3a83126f)
1189 0c42 32E1 ldi r19,hi8(0x3a83126f)
1190 0c44 43E8 ldi r20,hlo8(0x3a83126f)
1191 0c46 5AE3 ldi r21,hhi8(0x3a83126f)
1192 0c48 0E94 0000 call __mulsf3
1193 0c4c A201 movw r20,r4
1194 0c4e 9101 movw r18,r2
1195 0c50 0E94 0000 call __mulsf3
1196 0c54 9B01 movw r18,r22
1197 0c56 AC01 movw r20,r24
1198 0c58 C801 movw r24,r16
1199 0c5a B701 movw r22,r14
1200 0c5c 0E94 0000 call __addsf3
1201 0c60 0E94 0000 call __fixsfsi
1202 0c64 5B01 movw r10,r22
1203 0c66 7093 0000 sts (GPS_Nick)+1,r23
1204 0c6a 6093 0000 sts GPS_Nick,r22
1205 0c6e E091 0000 lds r30,KompassValue
1206 0c72 F091 0000 lds r31,(KompassValue)+1
1207 0c76 0091 0000 lds r16,KompassValue
1208 0c7a 1091 0000 lds r17,(KompassValue)+1
1209 0c7e EE0F lsl r30
1210 0c80 FF1F rol r31
1211 0c82 E050 subi r30,lo8(-(c_cos))
1212 0c84 F040 sbci r31,hi8(-(c_cos))
1213 0c86 6081 ld r22,Z
1214 0c88 7181 ldd r23,Z+1
1215 0c8a 8827 clr r24
1216 0c8c 77FD sbrc r23,7
1217 0c8e 8095 com r24
1218 0c90 982F mov r25,r24
1219 0c92 0E94 0000 call __floatsisf
1220 0c96 2FE6 ldi r18,lo8(0x3a83126f)
1221 0c98 32E1 ldi r19,hi8(0x3a83126f)
1222 0c9a 43E8 ldi r20,hlo8(0x3a83126f)
1223 0c9c 5AE3 ldi r21,hhi8(0x3a83126f)
1224 0c9e 0E94 0000 call __mulsf3
1225 0ca2 A401 movw r20,r8
1226 0ca4 9301 movw r18,r6
1227 0ca6 0E94 0000 call __mulsf3
1228 0caa 6B01 movw r12,r22
1229 0cac 7C01 movw r14,r24
1230 0cae 000F lsl r16
1231 0cb0 111F rol r17
1232 0cb2 0050 subi r16,lo8(-(c_sin))
1233 0cb4 1040 sbci r17,hi8(-(c_sin))
1234 0cb6 F801 movw r30,r16
1235 0cb8 6081 ld r22,Z
1236 0cba 7181 ldd r23,Z+1
1237 0cbc 8827 clr r24
1238 0cbe 77FD sbrc r23,7
1239 0cc0 8095 com r24
1240 0cc2 982F mov r25,r24
1241 0cc4 0E94 0000 call __floatsisf
1242 0cc8 2FE6 ldi r18,lo8(0x3a83126f)
1243 0cca 32E1 ldi r19,hi8(0x3a83126f)
1244 0ccc 43E8 ldi r20,hlo8(0x3a83126f)
1245 0cce 5AE3 ldi r21,hhi8(0x3a83126f)
1246 0cd0 0E94 0000 call __mulsf3
1247 0cd4 A201 movw r20,r4
1248 0cd6 9101 movw r18,r2
1249 0cd8 0E94 0000 call __mulsf3
1250 0cdc 9B01 movw r18,r22
1251 0cde AC01 movw r20,r24
1252 0ce0 C701 movw r24,r14
1253 0ce2 B601 movw r22,r12
1254 0ce4 0E94 0000 call __addsf3
1255 0ce8 0E94 0000 call __fixsfsi
1256 0cec 9B01 movw r18,r22
1257 0cee 7093 0000 sts (GPS_Roll)+1,r23
1258 0cf2 6093 0000 sts GPS_Roll,r22
1259 0cf6 F4E2 ldi r31,lo8(36)
1260 0cf8 AF16 cp r10,r31
1261 0cfa B104 cpc r11,__zero_reg__
1262 0cfc 04F0 brlt .L86
1263 0cfe 83E2 ldi r24,lo8(35)
1264 0d00 90E0 ldi r25,hi8(35)
1265 0d02 9093 0000 sts (GPS_Nick)+1,r25
1266 0d06 8093 0000 sts GPS_Nick,r24
1267 .L86:
1268 0d0a 2432 cpi r18,36
1269 0d0c 3105 cpc r19,__zero_reg__
1270 0d0e 04F0 brlt .L88
1271 0d10 83E2 ldi r24,lo8(35)
1272 0d12 90E0 ldi r25,hi8(35)
1273 0d14 9093 0000 sts (GPS_Roll)+1,r25
1274 0d18 8093 0000 sts GPS_Roll,r24
1275 .L88:
1276 0d1c 8091 0000 lds r24,GPS_Nick
1277 0d20 9091 0000 lds r25,(GPS_Nick)+1
1278 0d24 8D5D subi r24,lo8(-35)
1279 0d26 9F4F sbci r25,hi8(-35)
1280 0d28 04F4 brge .L90
1281 0d2a 8DED ldi r24,lo8(-35)
1282 0d2c 9FEF ldi r25,hi8(-35)
1283 0d2e 9093 0000 sts (GPS_Nick)+1,r25
1284 0d32 8093 0000 sts GPS_Nick,r24
1285 .L90:
1286 0d36 8091 0000 lds r24,GPS_Roll
1287 0d3a 9091 0000 lds r25,(GPS_Roll)+1
1288 0d3e 8D5D subi r24,lo8(-35)
1289 0d40 9F4F sbci r25,hi8(-35)
1290 0d42 04F4 brge .L92
1291 0d44 8DED ldi r24,lo8(-35)
1292 0d46 9FEF ldi r25,hi8(-35)
1293 0d48 9093 0000 sts (GPS_Roll)+1,r25
1294 0d4c 8093 0000 sts GPS_Roll,r24
1295 .L92:
1296 0d50 1092 0000 sts NeuerMittelwert,__zero_reg__
1297 0d54 00C0 rjmp .L94
1298 .L64:
1299 0d56 2091 0000 lds r18,GPS_Home_North
1300 0d5a 3091 0000 lds r19,(GPS_Home_North)+1
1301 0d5e 4091 0000 lds r20,(GPS_Home_North)+2
1302 0d62 5091 0000 lds r21,(GPS_Home_North)+3
1303 0d66 2115 cp r18,__zero_reg__
1304 0d68 3105 cpc r19,__zero_reg__
1305 0d6a 4105 cpc r20,__zero_reg__
1306 0d6c 5105 cpc r21,__zero_reg__
1307 0d6e 01F0 breq .+2
1308 0d70 00C0 rjmp .L67
1309 0d72 00C0 rjmp .L95
1310 .L94:
1311 /* epilogue: frame size=31 */
1312 0d74 6F96 adiw r28,31
1313 0d76 0FB6 in __tmp_reg__,__SREG__
1314 0d78 F894 cli
1315 0d7a DEBF out __SP_H__,r29
1316 0d7c 0FBE out __SREG__,__tmp_reg__
1317 0d7e CDBF out __SP_L__,r28
1318 0d80 DF91 pop r29
1319 0d82 CF91 pop r28
1320 0d84 1F91 pop r17
1321 0d86 0F91 pop r16
1322 0d88 FF90 pop r15
1323 0d8a EF90 pop r14
1324 0d8c DF90 pop r13
1325 0d8e CF90 pop r12
1326 0d90 BF90 pop r11
1327 0d92 AF90 pop r10
1328 0d94 9F90 pop r9
1329 0d96 8F90 pop r8
1330 0d98 7F90 pop r7
1331 0d9a 6F90 pop r6
1332 0d9c 5F90 pop r5
1333 0d9e 4F90 pop r4
1334 0da0 3F90 pop r3
1335 0da2 2F90 pop r2
1336 0da4 0895 ret
1337 /* epilogue end (size=25) */
1338 /* function gps_main size 1755 (1704) */
1340 .global c_sin
1341 .data
1344 c_sin:
1345 0000 0000 .word 0
1346 0002 1100 .word 17
1347 0004 2200 .word 34
1348 0006 3400 .word 52
1349 0008 4500 .word 69
1350 000a 5700 .word 87
1351 000c 6800 .word 104
1352 000e 7900 .word 121
1353 0010 8B00 .word 139
1354 0012 9C00 .word 156
1355 0014 AD00 .word 173
1356 0016 BE00 .word 190
1357 0018 CF00 .word 207
1358 001a E000 .word 224
1359 001c F100 .word 241
1360 001e 0201 .word 258
1361 0020 1301 .word 275
1362 0022 2401 .word 292
1363 0024 3501 .word 309
1364 0026 4501 .word 325
1365 0028 5601 .word 342
1366 002a 6601 .word 358
1367 002c 7601 .word 374
1368 002e 8601 .word 390
1369 0030 9601 .word 406
1370 0032 A601 .word 422
1371 0034 B601 .word 438
1372 0036 C501 .word 453
1373 0038 D501 .word 469
1374 003a E401 .word 484
1375 003c F401 .word 500
1376 003e 0302 .word 515
1377 0040 1102 .word 529
1378 0042 2002 .word 544
1379 0044 2F02 .word 559
1380 0046 3D02 .word 573
1381 0048 4B02 .word 587
1382 004a 5902 .word 601
1383 004c 6702 .word 615
1384 004e 7502 .word 629
1385 0050 8202 .word 642
1386 0052 9002 .word 656
1387 0054 9D02 .word 669
1388 0056 AA02 .word 682
1389 0058 B602 .word 694
1390 005a C302 .word 707
1391 005c CF02 .word 719
1392 005e DB02 .word 731
1393 0060 E702 .word 743
1394 0062 F202 .word 754
1395 0064 FE02 .word 766
1396 0066 0903 .word 777
1397 0068 1403 .word 788
1398 006a 1E03 .word 798
1399 006c 2903 .word 809
1400 006e 3303 .word 819
1401 0070 3D03 .word 829
1402 0072 4603 .word 838
1403 0074 5003 .word 848
1404 0076 5903 .word 857
1405 0078 6203 .word 866
1406 007a 6A03 .word 874
1407 007c 7203 .word 882
1408 007e 7B03 .word 891
1409 0080 8203 .word 898
1410 0082 8A03 .word 906
1411 0084 9103 .word 913
1412 0086 9803 .word 920
1413 0088 9F03 .word 927
1414 008a A503 .word 933
1415 008c AB03 .word 939
1416 008e B103 .word 945
1417 0090 B703 .word 951
1418 0092 BC03 .word 956
1419 0094 C103 .word 961
1420 0096 C503 .word 965
1421 0098 CA03 .word 970
1422 009a CE03 .word 974
1423 009c D203 .word 978
1424 009e D503 .word 981
1425 00a0 D803 .word 984
1426 00a2 DB03 .word 987
1427 00a4 DE03 .word 990
1428 00a6 E003 .word 992
1429 00a8 E203 .word 994
1430 00aa E403 .word 996
1431 00ac E503 .word 997
1432 00ae E603 .word 998
1433 00b0 E703 .word 999
1434 00b2 E703 .word 999
1435 00b4 E803 .word 1000
1436 00b6 E703 .word 999
1437 00b8 E703 .word 999
1438 00ba E603 .word 998
1439 00bc E503 .word 997
1440 00be E403 .word 996
1441 00c0 E203 .word 994
1442 00c2 E003 .word 992
1443 00c4 DE03 .word 990
1444 00c6 DB03 .word 987
1445 00c8 D803 .word 984
1446 00ca D503 .word 981
1447 00cc D203 .word 978
1448 00ce CE03 .word 974
1449 00d0 CA03 .word 970
1450 00d2 C503 .word 965
1451 00d4 C103 .word 961
1452 00d6 BC03 .word 956
1453 00d8 B703 .word 951
1454 00da B103 .word 945
1455 00dc AB03 .word 939
1456 00de A503 .word 933
1457 00e0 9F03 .word 927
1458 00e2 9803 .word 920
1459 00e4 9103 .word 913
1460 00e6 8A03 .word 906
1461 00e8 8203 .word 898
1462 00ea 7B03 .word 891
1463 00ec 7203 .word 882
1464 00ee 6A03 .word 874
1465 00f0 6203 .word 866
1466 00f2 5903 .word 857
1467 00f4 5003 .word 848
1468 00f6 4603 .word 838
1469 00f8 3D03 .word 829
1470 00fa 3303 .word 819
1471 00fc 2903 .word 809
1472 00fe 1E03 .word 798
1473 0100 1403 .word 788
1474 0102 0903 .word 777
1475 0104 FE02 .word 766
1476 0106 F202 .word 754
1477 0108 E702 .word 743
1478 010a DB02 .word 731
1479 010c CF02 .word 719
1480 010e C302 .word 707
1481 0110 B602 .word 694
1482 0112 AA02 .word 682
1483 0114 9D02 .word 669
1484 0116 9002 .word 656
1485 0118 8202 .word 642
1486 011a 7502 .word 629
1487 011c 6702 .word 615
1488 011e 5902 .word 601
1489 0120 4B02 .word 587
1490 0122 3D02 .word 573
1491 0124 2F02 .word 559
1492 0126 2002 .word 544
1493 0128 1102 .word 529
1494 012a 0302 .word 515
1495 012c F401 .word 500
1496 012e E401 .word 484
1497 0130 D501 .word 469
1498 0132 C501 .word 453
1499 0134 B601 .word 438
1500 0136 A601 .word 422
1501 0138 9601 .word 406
1502 013a 8601 .word 390
1503 013c 7601 .word 374
1504 013e 6601 .word 358
1505 0140 5601 .word 342
1506 0142 4501 .word 325
1507 0144 3501 .word 309
1508 0146 2401 .word 292
1509 0148 1301 .word 275
1510 014a 0201 .word 258
1511 014c F100 .word 241
1512 014e E000 .word 224
1513 0150 CF00 .word 207
1514 0152 BE00 .word 190
1515 0154 AD00 .word 173
1516 0156 9C00 .word 156
1517 0158 8B00 .word 139
1518 015a 7900 .word 121
1519 015c 6800 .word 104
1520 015e 5700 .word 87
1521 0160 4500 .word 69
1522 0162 3400 .word 52
1523 0164 2200 .word 34
1524 0166 1100 .word 17
1525 0168 0000 .word 0
1526 016a EFFF .word -17
1527 016c DEFF .word -34
1528 016e CCFF .word -52
1529 0170 BBFF .word -69
1530 0172 A9FF .word -87
1531 0174 98FF .word -104
1532 0176 87FF .word -121
1533 0178 75FF .word -139
1534 017a 64FF .word -156
1535 017c 53FF .word -173
1536 017e 42FF .word -190
1537 0180 31FF .word -207
1538 0182 20FF .word -224
1539 0184 0FFF .word -241
1540 0186 FEFE .word -258
1541 0188 EDFE .word -275
1542 018a DCFE .word -292
1543 018c CBFE .word -309
1544 018e BBFE .word -325
1545 0190 AAFE .word -342
1546 0192 9AFE .word -358
1547 0194 8AFE .word -374
1548 0196 7AFE .word -390
1549 0198 6AFE .word -406
1550 019a 5AFE .word -422
1551 019c 4AFE .word -438
1552 019e 3BFE .word -453
1553 01a0 2BFE .word -469
1554 01a2 1CFE .word -484
1555 01a4 0CFE .word -500
1556 01a6 FDFD .word -515
1557 01a8 EFFD .word -529
1558 01aa E0FD .word -544
1559 01ac D1FD .word -559
1560 01ae C3FD .word -573
1561 01b0 B5FD .word -587
1562 01b2 A7FD .word -601
1563 01b4 99FD .word -615
1564 01b6 8BFD .word -629
1565 01b8 7EFD .word -642
1566 01ba 70FD .word -656
1567 01bc 63FD .word -669
1568 01be 56FD .word -682
1569 01c0 4AFD .word -694
1570 01c2 3DFD .word -707
1571 01c4 31FD .word -719
1572 01c6 25FD .word -731
1573 01c8 19FD .word -743
1574 01ca 0EFD .word -754
1575 01cc 02FD .word -766
1576 01ce F7FC .word -777
1577 01d0 ECFC .word -788
1578 01d2 E2FC .word -798
1579 01d4 D7FC .word -809
1580 01d6 CDFC .word -819
1581 01d8 C3FC .word -829
1582 01da BAFC .word -838
1583 01dc B0FC .word -848
1584 01de A7FC .word -857
1585 01e0 9EFC .word -866
1586 01e2 96FC .word -874
1587 01e4 8EFC .word -882
1588 01e6 85FC .word -891
1589 01e8 7EFC .word -898
1590 01ea 76FC .word -906
1591 01ec 6FFC .word -913
1592 01ee 68FC .word -920
1593 01f0 61FC .word -927
1594 01f2 5BFC .word -933
1595 01f4 55FC .word -939
1596 01f6 4FFC .word -945
1597 01f8 49FC .word -951
1598 01fa 44FC .word -956
1599 01fc 3FFC .word -961
1600 01fe 3BFC .word -965
1601 0200 36FC .word -970
1602 0202 32FC .word -974
1603 0204 2EFC .word -978
1604 0206 2BFC .word -981
1605 0208 28FC .word -984
1606 020a 25FC .word -987
1607 020c 22FC .word -990
1608 020e 20FC .word -992
1609 0210 1EFC .word -994
1610 0212 1CFC .word -996
1611 0214 1BFC .word -997
1612 0216 1AFC .word -998
1613 0218 19FC .word -999
1614 021a 19FC .word -999
1615 021c 18FC .word -1000
1616 021e 19FC .word -999
1617 0220 19FC .word -999
1618 0222 1AFC .word -998
1619 0224 1BFC .word -997
1620 0226 1CFC .word -996
1621 0228 1EFC .word -994
1622 022a 20FC .word -992
1623 022c 22FC .word -990
1624 022e 25FC .word -987
1625 0230 28FC .word -984
1626 0232 2BFC .word -981
1627 0234 2EFC .word -978
1628 0236 32FC .word -974
1629 0238 36FC .word -970
1630 023a 3BFC .word -965
1631 023c 3FFC .word -961
1632 023e 44FC .word -956
1633 0240 49FC .word -951
1634 0242 4FFC .word -945
1635 0244 55FC .word -939
1636 0246 5BFC .word -933
1637 0248 61FC .word -927
1638 024a 68FC .word -920
1639 024c 6FFC .word -913
1640 024e 76FC .word -906
1641 0250 7EFC .word -898
1642 0252 85FC .word -891
1643 0254 8EFC .word -882
1644 0256 96FC .word -874
1645 0258 9EFC .word -866
1646 025a A7FC .word -857
1647 025c B0FC .word -848
1648 025e BAFC .word -838
1649 0260 C3FC .word -829
1650 0262 CDFC .word -819
1651 0264 D7FC .word -809
1652 0266 E2FC .word -798
1653 0268 ECFC .word -788
1654 026a F7FC .word -777
1655 026c 02FD .word -766
1656 026e 0EFD .word -754
1657 0270 19FD .word -743
1658 0272 25FD .word -731
1659 0274 31FD .word -719
1660 0276 3DFD .word -707
1661 0278 4AFD .word -694
1662 027a 56FD .word -682
1663 027c 63FD .word -669
1664 027e 70FD .word -656
1665 0280 7EFD .word -642
1666 0282 8BFD .word -629
1667 0284 99FD .word -615
1668 0286 A7FD .word -601
1669 0288 B5FD .word -587
1670 028a C3FD .word -573
1671 028c D1FD .word -559
1672 028e E0FD .word -544
1673 0290 EFFD .word -529
1674 0292 FDFD .word -515
1675 0294 0CFE .word -500
1676 0296 1CFE .word -484
1677 0298 2BFE .word -469
1678 029a 3BFE .word -453
1679 029c 4AFE .word -438
1680 029e 5AFE .word -422
1681 02a0 6AFE .word -406
1682 02a2 7AFE .word -390
1683 02a4 8AFE .word -374
1684 02a6 9AFE .word -358
1685 02a8 AAFE .word -342
1686 02aa BBFE .word -325
1687 02ac CBFE .word -309
1688 02ae DCFE .word -292
1689 02b0 EDFE .word -275
1690 02b2 FEFE .word -258
1691 02b4 0FFF .word -241
1692 02b6 20FF .word -224
1693 02b8 31FF .word -207
1694 02ba 42FF .word -190
1695 02bc 53FF .word -173
1696 02be 64FF .word -156
1697 02c0 75FF .word -139
1698 02c2 87FF .word -121
1699 02c4 98FF .word -104
1700 02c6 A9FF .word -87
1701 02c8 BBFF .word -69
1702 02ca CCFF .word -52
1703 02cc DEFF .word -34
1704 02ce EFFF .word -17
1705 .global c_cos
1708 c_cos:
1709 02d0 E803 .word 1000
1710 02d2 E703 .word 999
1711 02d4 E703 .word 999
1712 02d6 E603 .word 998
1713 02d8 E503 .word 997
1714 02da E403 .word 996
1715 02dc E203 .word 994
1716 02de E003 .word 992
1717 02e0 DE03 .word 990
1718 02e2 DB03 .word 987
1719 02e4 D803 .word 984
1720 02e6 D503 .word 981
1721 02e8 D203 .word 978
1722 02ea CE03 .word 974
1723 02ec CA03 .word 970
1724 02ee C503 .word 965
1725 02f0 C103 .word 961
1726 02f2 BC03 .word 956
1727 02f4 B703 .word 951
1728 02f6 B103 .word 945
1729 02f8 AB03 .word 939
1730 02fa A503 .word 933
1731 02fc 9F03 .word 927
1732 02fe 9803 .word 920
1733 0300 9103 .word 913
1734 0302 8A03 .word 906
1735 0304 8203 .word 898
1736 0306 7B03 .word 891
1737 0308 7203 .word 882
1738 030a 6A03 .word 874
1739 030c 6203 .word 866
1740 030e 5903 .word 857
1741 0310 5003 .word 848
1742 0312 4603 .word 838
1743 0314 3D03 .word 829
1744 0316 3303 .word 819
1745 0318 2903 .word 809
1746 031a 1E03 .word 798
1747 031c 1403 .word 788
1748 031e 0903 .word 777
1749 0320 FE02 .word 766
1750 0322 F202 .word 754
1751 0324 E702 .word 743
1752 0326 DB02 .word 731
1753 0328 CF02 .word 719
1754 032a C302 .word 707
1755 032c B602 .word 694
1756 032e AA02 .word 682
1757 0330 9D02 .word 669
1758 0332 9002 .word 656
1759 0334 8202 .word 642
1760 0336 7502 .word 629
1761 0338 6702 .word 615
1762 033a 5902 .word 601
1763 033c 4B02 .word 587
1764 033e 3D02 .word 573
1765 0340 2F02 .word 559
1766 0342 2002 .word 544
1767 0344 1102 .word 529
1768 0346 0302 .word 515
1769 0348 F401 .word 500
1770 034a E401 .word 484
1771 034c D501 .word 469
1772 034e C501 .word 453
1773 0350 B601 .word 438
1774 0352 A601 .word 422
1775 0354 9601 .word 406
1776 0356 8601 .word 390
1777 0358 7601 .word 374
1778 035a 6601 .word 358
1779 035c 5601 .word 342
1780 035e 4501 .word 325
1781 0360 3501 .word 309
1782 0362 2401 .word 292
1783 0364 1301 .word 275
1784 0366 0201 .word 258
1785 0368 F100 .word 241
1786 036a E000 .word 224
1787 036c CF00 .word 207
1788 036e BE00 .word 190
1789 0370 AD00 .word 173
1790 0372 9C00 .word 156
1791 0374 8B00 .word 139
1792 0376 7900 .word 121
1793 0378 6800 .word 104
1794 037a 5700 .word 87
1795 037c 4500 .word 69
1796 037e 3400 .word 52
1797 0380 2200 .word 34
1798 0382 1100 .word 17
1799 0384 0000 .word 0
1800 0386 EFFF .word -17
1801 0388 DEFF .word -34
1802 038a CCFF .word -52
1803 038c BBFF .word -69
1804 038e A9FF .word -87
1805 0390 98FF .word -104
1806 0392 87FF .word -121
1807 0394 75FF .word -139
1808 0396 64FF .word -156
1809 0398 53FF .word -173
1810 039a 42FF .word -190
1811 039c 31FF .word -207
1812 039e 20FF .word -224
1813 03a0 0FFF .word -241
1814 03a2 FEFE .word -258
1815 03a4 EDFE .word -275
1816 03a6 DCFE .word -292
1817 03a8 CBFE .word -309
1818 03aa BBFE .word -325
1819 03ac AAFE .word -342
1820 03ae 9AFE .word -358
1821 03b0 8AFE .word -374
1822 03b2 7AFE .word -390
1823 03b4 6AFE .word -406
1824 03b6 5AFE .word -422
1825 03b8 4AFE .word -438
1826 03ba 3BFE .word -453
1827 03bc 2BFE .word -469
1828 03be 1CFE .word -484
1829 03c0 0CFE .word -500
1830 03c2 FDFD .word -515
1831 03c4 EFFD .word -529
1832 03c6 E0FD .word -544
1833 03c8 D1FD .word -559
1834 03ca C3FD .word -573
1835 03cc B5FD .word -587
1836 03ce A7FD .word -601
1837 03d0 99FD .word -615
1838 03d2 8BFD .word -629
1839 03d4 7EFD .word -642
1840 03d6 70FD .word -656
1841 03d8 63FD .word -669
1842 03da 56FD .word -682
1843 03dc 4AFD .word -694
1844 03de 3DFD .word -707
1845 03e0 31FD .word -719
1846 03e2 25FD .word -731
1847 03e4 19FD .word -743
1848 03e6 0EFD .word -754
1849 03e8 02FD .word -766
1850 03ea F7FC .word -777
1851 03ec ECFC .word -788
1852 03ee E2FC .word -798
1853 03f0 D7FC .word -809
1854 03f2 CDFC .word -819
1855 03f4 C3FC .word -829
1856 03f6 BAFC .word -838
1857 03f8 B0FC .word -848
1858 03fa A7FC .word -857
1859 03fc 9EFC .word -866
1860 03fe 96FC .word -874
1861 0400 8EFC .word -882
1862 0402 85FC .word -891
1863 0404 7EFC .word -898
1864 0406 76FC .word -906
1865 0408 6FFC .word -913
1866 040a 68FC .word -920
1867 040c 61FC .word -927
1868 040e 5BFC .word -933
1869 0410 55FC .word -939
1870 0412 4FFC .word -945
1871 0414 49FC .word -951
1872 0416 44FC .word -956
1873 0418 3FFC .word -961
1874 041a 3BFC .word -965
1875 041c 36FC .word -970
1876 041e 32FC .word -974
1877 0420 2EFC .word -978
1878 0422 2BFC .word -981
1879 0424 28FC .word -984
1880 0426 25FC .word -987
1881 0428 22FC .word -990
1882 042a 20FC .word -992
1883 042c 1EFC .word -994
1884 042e 1CFC .word -996
1885 0430 1BFC .word -997
1886 0432 1AFC .word -998
1887 0434 19FC .word -999
1888 0436 19FC .word -999
1889 0438 18FC .word -1000
1890 043a 19FC .word -999
1891 043c 19FC .word -999
1892 043e 1AFC .word -998
1893 0440 1BFC .word -997
1894 0442 1CFC .word -996
1895 0444 1EFC .word -994
1896 0446 20FC .word -992
1897 0448 22FC .word -990
1898 044a 25FC .word -987
1899 044c 28FC .word -984
1900 044e 2BFC .word -981
1901 0450 2EFC .word -978
1902 0452 32FC .word -974
1903 0454 36FC .word -970
1904 0456 3BFC .word -965
1905 0458 3FFC .word -961
1906 045a 44FC .word -956
1907 045c 49FC .word -951
1908 045e 4FFC .word -945
1909 0460 55FC .word -939
1910 0462 5BFC .word -933
1911 0464 61FC .word -927
1912 0466 68FC .word -920
1913 0468 6FFC .word -913
1914 046a 76FC .word -906
1915 046c 7EFC .word -898
1916 046e 85FC .word -891
1917 0470 8EFC .word -882
1918 0472 96FC .word -874
1919 0474 9EFC .word -866
1920 0476 A7FC .word -857
1921 0478 B0FC .word -848
1922 047a BAFC .word -838
1923 047c C3FC .word -829
1924 047e CDFC .word -819
1925 0480 D7FC .word -809
1926 0482 E2FC .word -798
1927 0484 ECFC .word -788
1928 0486 F7FC .word -777
1929 0488 02FD .word -766
1930 048a 0EFD .word -754
1931 048c 19FD .word -743
1932 048e 25FD .word -731
1933 0490 31FD .word -719
1934 0492 3DFD .word -707
1935 0494 4AFD .word -694
1936 0496 56FD .word -682
1937 0498 63FD .word -669
1938 049a 70FD .word -656
1939 049c 7EFD .word -642
1940 049e 8BFD .word -629
1941 04a0 99FD .word -615
1942 04a2 A7FD .word -601
1943 04a4 B5FD .word -587
1944 04a6 C3FD .word -573
1945 04a8 D1FD .word -559
1946 04aa E0FD .word -544
1947 04ac EFFD .word -529
1948 04ae FDFD .word -515
1949 04b0 0CFE .word -500
1950 04b2 1CFE .word -484
1951 04b4 2BFE .word -469
1952 04b6 3BFE .word -453
1953 04b8 4AFE .word -438
1954 04ba 5AFE .word -422
1955 04bc 6AFE .word -406
1956 04be 7AFE .word -390
1957 04c0 8AFE .word -374
1958 04c2 9AFE .word -358
1959 04c4 AAFE .word -342
1960 04c6 BBFE .word -325
1961 04c8 CBFE .word -309
1962 04ca DCFE .word -292
1963 04cc EDFE .word -275
1964 04ce FEFE .word -258
1965 04d0 0FFF .word -241
1966 04d2 20FF .word -224
1967 04d4 31FF .word -207
1968 04d6 42FF .word -190
1969 04d8 53FF .word -173
1970 04da 64FF .word -156
1971 04dc 75FF .word -139
1972 04de 87FF .word -121
1973 04e0 98FF .word -104
1974 04e2 A9FF .word -87
1975 04e4 BBFF .word -69
1976 04e6 CCFF .word -52
1977 04e8 DEFF .word -34
1978 04ea EFFF .word -17
1979 04ec 0000 .word 0
1980 04ee 1100 .word 17
1981 04f0 2200 .word 34
1982 04f2 3400 .word 52
1983 04f4 4500 .word 69
1984 04f6 5700 .word 87
1985 04f8 6800 .word 104
1986 04fa 7900 .word 121
1987 04fc 8B00 .word 139
1988 04fe 9C00 .word 156
1989 0500 AD00 .word 173
1990 0502 BE00 .word 190
1991 0504 CF00 .word 207
1992 0506 E000 .word 224
1993 0508 F100 .word 241
1994 050a 0201 .word 258
1995 050c 1301 .word 275
1996 050e 2401 .word 292
1997 0510 3501 .word 309
1998 0512 4501 .word 325
1999 0514 5601 .word 342
2000 0516 6601 .word 358
2001 0518 7601 .word 374
2002 051a 8601 .word 390
2003 051c 9601 .word 406
2004 051e A601 .word 422
2005 0520 B601 .word 438
2006 0522 C501 .word 453
2007 0524 D501 .word 469
2008 0526 E401 .word 484
2009 0528 F401 .word 500
2010 052a 0302 .word 515
2011 052c 1102 .word 529
2012 052e 2002 .word 544
2013 0530 2F02 .word 559
2014 0532 3D02 .word 573
2015 0534 4B02 .word 587
2016 0536 5902 .word 601
2017 0538 6702 .word 615
2018 053a 7502 .word 629
2019 053c 8202 .word 642
2020 053e 9002 .word 656
2021 0540 9D02 .word 669
2022 0542 AA02 .word 682
2023 0544 B602 .word 694
2024 0546 C302 .word 707
2025 0548 CF02 .word 719
2026 054a DB02 .word 731
2027 054c E702 .word 743
2028 054e F202 .word 754
2029 0550 FE02 .word 766
2030 0552 0903 .word 777
2031 0554 1403 .word 788
2032 0556 1E03 .word 798
2033 0558 2903 .word 809
2034 055a 3303 .word 819
2035 055c 3D03 .word 829
2036 055e 4603 .word 838
2037 0560 5003 .word 848
2038 0562 5903 .word 857
2039 0564 6203 .word 866
2040 0566 6A03 .word 874
2041 0568 7203 .word 882
2042 056a 7B03 .word 891
2043 056c 8203 .word 898
2044 056e 8A03 .word 906
2045 0570 9103 .word 913
2046 0572 9803 .word 920
2047 0574 9F03 .word 927
2048 0576 A503 .word 933
2049 0578 AB03 .word 939
2050 057a B103 .word 945
2051 057c B703 .word 951
2052 057e BC03 .word 956
2053 0580 C103 .word 961
2054 0582 C503 .word 965
2055 0584 CA03 .word 970
2056 0586 CE03 .word 974
2057 0588 D203 .word 978
2058 058a D503 .word 981
2059 058c D803 .word 984
2060 058e DB03 .word 987
2061 0590 DE03 .word 990
2062 0592 E003 .word 992
2063 0594 E203 .word 994
2064 0596 E403 .word 996
2065 0598 E503 .word 997
2066 059a E603 .word 998
2067 059c E703 .word 999
2068 059e E703 .word 999
2069 .global Soll_Position_North
2070 .global Soll_Position_North
2071 .section .bss
2074 Soll_Position_North:
2075 0000 0000 0000 .skip 4,0
2076 .global Soll_Position_East
2077 .global Soll_Position_East
2080 Soll_Position_East:
2081 0004 0000 0000 .skip 4,0
2082 .global GPS_Positionsabweichung_North
2083 .global GPS_Positionsabweichung_North
2086 GPS_Positionsabweichung_North:
2087 0008 0000 0000 .skip 4,0
2088 .global GPS_Positionsabweichung_East
2089 .global GPS_Positionsabweichung_East
2092 GPS_Positionsabweichung_East:
2093 000c 0000 0000 .skip 4,0
2094 .global GPS_Geschwindigkeit_North
2095 .global GPS_Geschwindigkeit_North
2098 GPS_Geschwindigkeit_North:
2099 0010 0000 0000 .skip 4,0
2100 .global GPS_Geschwindigkeit_East
2101 .global GPS_Geschwindigkeit_East
2104 GPS_Geschwindigkeit_East:
2105 0014 0000 0000 .skip 4,0
2106 .global P_Einfluss_North
2107 .global P_Einfluss_North
2110 P_Einfluss_North:
2111 0018 0000 0000 .skip 4,0
2112 .global D_Einfluss_North
2113 .global D_Einfluss_North
2116 D_Einfluss_North:
2117 001c 0000 0000 .skip 4,0
2118 .global P_Einfluss_East
2119 .global P_Einfluss_East
2122 P_Einfluss_East:
2123 0020 0000 0000 .skip 4,0
2124 .global D_Einfluss_East
2125 .global D_Einfluss_East
2128 D_Einfluss_East:
2129 0024 0000 0000 .skip 4,0
2130 .global GPS_North
2131 .global GPS_North
2134 GPS_North:
2135 0028 0000 .skip 2,0
2136 .global GPS_East
2137 .global GPS_East
2140 GPS_East:
2141 002a 0000 .skip 2,0
2142 .global GPS_Nick
2143 .global GPS_Nick
2146 GPS_Nick:
2147 002c 0000 .skip 2,0
2148 .global GPS_Roll
2149 .global GPS_Roll
2152 GPS_Roll:
2153 002e 0000 .skip 2,0
2154 .global gethome
2155 .global gethome
2158 gethome:
2159 0030 00 .skip 1,0
2160 .global GPS_Home_North
2161 .global GPS_Home_North
2164 GPS_Home_North:
2165 0031 0000 0000 .skip 4,0
2166 .global GPS_Home_East
2167 .global GPS_Home_East
2170 GPS_Home_East:
2171 0035 0000 0000 .skip 4,0
2172 .global blinkcount_LED2
2173 .global blinkcount_LED2
2176 blinkcount_LED2:
2177 0039 00 .skip 1,0
2178 .global NeuerMittelwert
2179 .global NeuerMittelwert
2182 NeuerMittelwert:
2183 003a 00 .skip 1,0
2184 .global FilterPos
2185 .global FilterPos
2188 FilterPos:
2189 003b 00 .skip 1,0
2190 .global NORTH_MITTEL
2191 .global NORTH_MITTEL
2194 NORTH_MITTEL:
2195 003c 0000 0000 .skip 4,0
2196 .global EAST_MITTEL
2197 .global EAST_MITTEL
2200 EAST_MITTEL:
2201 0040 0000 0000 .skip 4,0
2202 .global NORTH_LONG_LONG
2203 .global NORTH_LONG_LONG
2206 NORTH_LONG_LONG:
2207 0044 0000 0000 .skip 8,0
2207 0000 0000
2208 .global EAST_LONG_LONG
2209 .global EAST_LONG_LONG
2212 EAST_LONG_LONG:
2213 004c 0000 0000 .skip 8,0
2213 0000 0000
2214 .global filterfilled
2215 .global filterfilled
2218 filterfilled:
2219 0054 0000 .skip 2,0
2220 .comm DiffNick,2,1
2221 .comm DiffRoll,2,1
2222 .comm SenderOkay,1,1
2223 .comm CosinusNickWinkel,1,1
2224 .comm CosinusRollWinkel,1,1
2225 .comm durchschnitt_northing,4,1
2226 .comm durchschnitt_easting,4,1
2227 .comm P_GPS_Verstaerkung,2,1
2228 .comm D_GPS_Verstaerkung,2,1
2229 .comm RemoteTasten,1,1
2230 .comm Timeout,1,1
2231 .comm IntegralNick,4,1
2232 .comm IntegralNick2,4,1
2233 .comm IntegralRoll,4,1
2234 .comm IntegralRoll2,4,1
2235 .comm Mess_IntegralNick,4,1
2236 .comm Mess_IntegralNick2,4,1
2237 .comm Mess_IntegralRoll,4,1
2238 .comm Mess_IntegralRoll2,4,1
2239 .comm Integral_Gier,4,1
2240 .comm Mess_Integral_Gier,4,1
2241 .comm h,1,1
2242 .comm m,1,1
2243 .comm s,1,1
2244 .comm Motor_Vorne,1,1
2245 .comm Motor_Hinten,1,1
2246 .comm Motor_Rechts,1,1
2247 .comm Motor_Links,1,1
2248 .comm Count,1,1
2249 .comm MotorWert,5,1
2250 .comm filter_north,32,1
2251 .comm filter_east,32,1
2252 /* File "GPS.c": code 1755 = 0x06db (1704), prologues 26, epilogues 25 */
DEFINED SYMBOLS
*ABS*:00000000 GPS.c
C:\DOKUME~1\none\LOKALE~1\Temp/cc7fUdHj.s:3 *ABS*:0000003f __SREG__
C:\DOKUME~1\none\LOKALE~1\Temp/cc7fUdHj.s:4 *ABS*:0000003e __SP_H__
C:\DOKUME~1\none\LOKALE~1\Temp/cc7fUdHj.s:5 *ABS*:0000003d __SP_L__
C:\DOKUME~1\none\LOKALE~1\Temp/cc7fUdHj.s:6 *ABS*:00000000 __tmp_reg__
C:\DOKUME~1\none\LOKALE~1\Temp/cc7fUdHj.s:7 *ABS*:00000001 __zero_reg__
C:\DOKUME~1\none\LOKALE~1\Temp/cc7fUdHj.s:13 .text:00000000 gps_main
C:\DOKUME~1\none\LOKALE~1\Temp/cc7fUdHj.s:2188 .bss:0000003b FilterPos
*COM*:00000020 filter_north
*COM*:00000020 filter_east
C:\DOKUME~1\none\LOKALE~1\Temp/cc7fUdHj.s:2218 .bss:00000054 filterfilled
C:\DOKUME~1\none\LOKALE~1\Temp/cc7fUdHj.s:2206 .bss:00000044 NORTH_LONG_LONG
C:\DOKUME~1\none\LOKALE~1\Temp/cc7fUdHj.s:2212 .bss:0000004c EAST_LONG_LONG
C:\DOKUME~1\none\LOKALE~1\Temp/cc7fUdHj.s:2194 .bss:0000003c NORTH_MITTEL
C:\DOKUME~1\none\LOKALE~1\Temp/cc7fUdHj.s:2200 .bss:00000040 EAST_MITTEL
C:\DOKUME~1\none\LOKALE~1\Temp/cc7fUdHj.s:2182 .bss:0000003a NeuerMittelwert
C:\DOKUME~1\none\LOKALE~1\Temp/cc7fUdHj.s:2146 .bss:0000002c GPS_Nick
C:\DOKUME~1\none\LOKALE~1\Temp/cc7fUdHj.s:2152 .bss:0000002e GPS_Roll
C:\DOKUME~1\none\LOKALE~1\Temp/cc7fUdHj.s:2158 .bss:00000030 gethome
C:\DOKUME~1\none\LOKALE~1\Temp/cc7fUdHj.s:2164 .bss:00000031 GPS_Home_North
C:\DOKUME~1\none\LOKALE~1\Temp/cc7fUdHj.s:2170 .bss:00000035 GPS_Home_East
C:\DOKUME~1\none\LOKALE~1\Temp/cc7fUdHj.s:2074 .bss:00000000 Soll_Position_North
C:\DOKUME~1\none\LOKALE~1\Temp/cc7fUdHj.s:2080 .bss:00000004 Soll_Position_East
C:\DOKUME~1\none\LOKALE~1\Temp/cc7fUdHj.s:2176 .bss:00000039 blinkcount_LED2
C:\DOKUME~1\none\LOKALE~1\Temp/cc7fUdHj.s:2086 .bss:00000008 GPS_Positionsabweichung_North
C:\DOKUME~1\none\LOKALE~1\Temp/cc7fUdHj.s:2092 .bss:0000000c GPS_Positionsabweichung_East
C:\DOKUME~1\none\LOKALE~1\Temp/cc7fUdHj.s:2098 .bss:00000010 GPS_Geschwindigkeit_North
C:\DOKUME~1\none\LOKALE~1\Temp/cc7fUdHj.s:2104 .bss:00000014 GPS_Geschwindigkeit_East
*COM*:00000002 P_GPS_Verstaerkung
C:\DOKUME~1\none\LOKALE~1\Temp/cc7fUdHj.s:2110 .bss:00000018 P_Einfluss_North
*COM*:00000002 D_GPS_Verstaerkung
C:\DOKUME~1\none\LOKALE~1\Temp/cc7fUdHj.s:2116 .bss:0000001c D_Einfluss_North
C:\DOKUME~1\none\LOKALE~1\Temp/cc7fUdHj.s:2122 .bss:00000020 P_Einfluss_East
C:\DOKUME~1\none\LOKALE~1\Temp/cc7fUdHj.s:2128 .bss:00000024 D_Einfluss_East
C:\DOKUME~1\none\LOKALE~1\Temp/cc7fUdHj.s:2134 .bss:00000028 GPS_North
C:\DOKUME~1\none\LOKALE~1\Temp/cc7fUdHj.s:2140 .bss:0000002a GPS_East
C:\DOKUME~1\none\LOKALE~1\Temp/cc7fUdHj.s:1344 .data:00000000 c_sin
C:\DOKUME~1\none\LOKALE~1\Temp/cc7fUdHj.s:1708 .data:000002d0 c_cos
*COM*:00000002 DiffNick
*COM*:00000002 DiffRoll
*COM*:00000001 SenderOkay
*COM*:00000001 CosinusNickWinkel
*COM*:00000001 CosinusRollWinkel
*COM*:00000004 durchschnitt_northing
*COM*:00000004 durchschnitt_easting
*COM*:00000001 RemoteTasten
*COM*:00000001 Timeout
*COM*:00000004 IntegralNick
*COM*:00000004 IntegralNick2
*COM*:00000004 IntegralRoll
*COM*:00000004 IntegralRoll2
*COM*:00000004 Mess_IntegralNick
*COM*:00000004 Mess_IntegralNick2
*COM*:00000004 Mess_IntegralRoll
*COM*:00000004 Mess_IntegralRoll2
*COM*:00000004 Integral_Gier
*COM*:00000004 Mess_Integral_Gier
*COM*:00000001 h
*COM*:00000001 m
*COM*:00000001 s
*COM*:00000001 Motor_Vorne
*COM*:00000001 Motor_Hinten
*COM*:00000001 Motor_Rechts
*COM*:00000001 Motor_Links
*COM*:00000001 Count
*COM*:00000005 MotorWert
UNDEFINED SYMBOLS
__do_copy_data
__do_clear_bss
actualPos
__divdi3
MotorenEin
Poti3
beeptime
modell_fliegt_gps
StickNick
StickRoll
__mulsi3
__floatsisf
__mulsf3
__fixsfsi
Limit_D_Anteil
KompassValue
__addsf3