/branches/V0.80g-Arthur-P1/GPS.lst |
---|
1,95 → 1,101 |
1 .file "GPS.c" |
2 __SREG__ = 0x3f |
3 __SP_H__ = 0x3e |
4 __SP_L__ = 0x3d |
5 __CCP__ = 0x34 |
2 .arch atmega644p |
3 __SREG__ = 0x3f |
4 __SP_H__ = 0x3e |
5 __SP_L__ = 0x3d |
6 __tmp_reg__ = 0 |
7 __zero_reg__ = 1 |
8 .text |
9 .global GPS_Neutral |
11 GPS_Neutral: |
12 /* prologue: function */ |
13 /* frame size = 0 */ |
14 0000 8091 0000 lds r24,GpsAktuell_X |
15 0004 9091 0000 lds r25,(GpsAktuell_X)+1 |
16 0008 A091 0000 lds r26,(GpsAktuell_X)+2 |
17 000c B091 0000 lds r27,(GpsAktuell_X)+3 |
18 0010 8093 0000 sts GpsZiel_X,r24 |
19 0014 9093 0000 sts (GpsZiel_X)+1,r25 |
20 0018 A093 0000 sts (GpsZiel_X)+2,r26 |
21 001c B093 0000 sts (GpsZiel_X)+3,r27 |
22 0020 8091 0000 lds r24,GpsAktuell_Y |
23 0024 9091 0000 lds r25,(GpsAktuell_Y)+1 |
24 0028 A091 0000 lds r26,(GpsAktuell_Y)+2 |
25 002c B091 0000 lds r27,(GpsAktuell_Y)+3 |
26 0030 8093 0000 sts GpsZiel_Y,r24 |
27 0034 9093 0000 sts (GpsZiel_Y)+1,r25 |
28 0038 A093 0000 sts (GpsZiel_Y)+2,r26 |
29 003c B093 0000 sts (GpsZiel_Y)+3,r27 |
30 /* epilogue start */ |
31 0040 0895 ret |
33 .global GPS_BerechneZielrichtung |
35 GPS_BerechneZielrichtung: |
36 /* prologue: function */ |
37 /* frame size = 0 */ |
38 0042 1092 0000 sts (GPS_Nick)+1,__zero_reg__ |
39 0046 1092 0000 sts GPS_Nick,__zero_reg__ |
40 004a 1092 0000 sts (GPS_Roll)+1,__zero_reg__ |
41 004e 1092 0000 sts GPS_Roll,__zero_reg__ |
42 /* epilogue start */ |
43 0052 0895 ret |
45 .global GPS_Nick |
46 .global GPS_Nick |
47 .section .bss |
50 GPS_Nick: |
51 0000 0000 .skip 2,0 |
52 .global GPS_Roll |
53 .global GPS_Roll |
56 GPS_Roll: |
57 0002 0000 .skip 2,0 |
58 .global GPS_Nick2 |
59 .global GPS_Nick2 |
62 GPS_Nick2: |
63 0004 0000 .skip 2,0 |
64 .global GPS_Roll2 |
65 .global GPS_Roll2 |
68 GPS_Roll2: |
69 0006 0000 .skip 2,0 |
70 .global GpsAktuell_X |
71 .global GpsAktuell_X |
74 GpsAktuell_X: |
75 0008 0000 0000 .skip 4,0 |
76 .global GpsAktuell_Y |
77 .global GpsAktuell_Y |
80 GpsAktuell_Y: |
81 000c 0000 0000 .skip 4,0 |
82 .global GpsZiel_X |
83 .global GpsZiel_X |
86 GpsZiel_X: |
87 0010 0000 0000 .skip 4,0 |
88 .global GpsZiel_Y |
89 .global GpsZiel_Y |
92 GpsZiel_Y: |
93 0014 0000 0000 .skip 4,0 |
94 .global __do_clear_bss |
8 .global __do_copy_data |
9 .global __do_clear_bss |
10 .global GpsZiel_Y |
11 .global GpsZiel_Y |
12 .section .bss |
15 GpsZiel_Y: |
16 0000 0000 0000 .skip 4,0 |
17 .global GpsZiel_X |
18 .global GpsZiel_X |
21 GpsZiel_X: |
22 0004 0000 0000 .skip 4,0 |
23 .global GpsAktuell_Y |
24 .global GpsAktuell_Y |
27 GpsAktuell_Y: |
28 0008 0000 0000 .skip 4,0 |
29 .global GpsAktuell_X |
30 .global GpsAktuell_X |
33 GpsAktuell_X: |
34 000c 0000 0000 .skip 4,0 |
35 .global GPS_Roll2 |
36 .global GPS_Roll2 |
39 GPS_Roll2: |
40 0010 0000 .skip 2,0 |
41 .global GPS_Nick2 |
42 .global GPS_Nick2 |
45 GPS_Nick2: |
46 0012 0000 .skip 2,0 |
47 .global GPS_Roll |
48 .global GPS_Roll |
51 GPS_Roll: |
52 0014 0000 .skip 2,0 |
53 .global GPS_Nick |
54 .global GPS_Nick |
57 GPS_Nick: |
58 0016 0000 .skip 2,0 |
59 .text |
60 .global GPS_Neutral |
62 GPS_Neutral: |
63 /* prologue: frame size=0 */ |
64 /* prologue end (size=0) */ |
65 0000 8091 0000 lds r24,GpsAktuell_X |
66 0004 9091 0000 lds r25,(GpsAktuell_X)+1 |
67 0008 A091 0000 lds r26,(GpsAktuell_X)+2 |
68 000c B091 0000 lds r27,(GpsAktuell_X)+3 |
69 0010 8093 0000 sts GpsZiel_X,r24 |
70 0014 9093 0000 sts (GpsZiel_X)+1,r25 |
71 0018 A093 0000 sts (GpsZiel_X)+2,r26 |
72 001c B093 0000 sts (GpsZiel_X)+3,r27 |
73 0020 8091 0000 lds r24,GpsAktuell_Y |
74 0024 9091 0000 lds r25,(GpsAktuell_Y)+1 |
75 0028 A091 0000 lds r26,(GpsAktuell_Y)+2 |
76 002c B091 0000 lds r27,(GpsAktuell_Y)+3 |
77 0030 8093 0000 sts GpsZiel_Y,r24 |
78 0034 9093 0000 sts (GpsZiel_Y)+1,r25 |
79 0038 A093 0000 sts (GpsZiel_Y)+2,r26 |
80 003c B093 0000 sts (GpsZiel_Y)+3,r27 |
81 /* epilogue: frame size=0 */ |
82 0040 0895 ret |
83 /* epilogue end (size=1) */ |
84 /* function GPS_Neutral size 33 (32) */ |
86 .global GPS_BerechneZielrichtung |
88 GPS_BerechneZielrichtung: |
89 /* prologue: frame size=0 */ |
90 /* prologue end (size=0) */ |
91 0042 1092 0000 sts (GPS_Nick)+1,__zero_reg__ |
92 0046 1092 0000 sts GPS_Nick,__zero_reg__ |
93 004a 1092 0000 sts (GPS_Roll)+1,__zero_reg__ |
94 004e 1092 0000 sts GPS_Roll,__zero_reg__ |
95 /* epilogue: frame size=0 */ |
96 0052 0895 ret |
97 /* epilogue end (size=1) */ |
98 /* function GPS_BerechneZielrichtung size 9 (8) */ |
100 /* File "GPS.c": code 42 = 0x002a ( 40), prologues 0, epilogues 2 */ |
DEFINED SYMBOLS |
*ABS*:00000000 GPS.c |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc1T8cW1.s:2 *ABS*:0000003f __SREG__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc1T8cW1.s:3 *ABS*:0000003e __SP_H__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc1T8cW1.s:4 *ABS*:0000003d __SP_L__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc1T8cW1.s:5 *ABS*:00000034 __CCP__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc1T8cW1.s:6 *ABS*:00000000 __tmp_reg__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc1T8cW1.s:7 *ABS*:00000001 __zero_reg__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc1T8cW1.s:11 .text:00000000 GPS_Neutral |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc1T8cW1.s:74 .bss:00000008 GpsAktuell_X |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc1T8cW1.s:86 .bss:00000010 GpsZiel_X |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc1T8cW1.s:80 .bss:0000000c GpsAktuell_Y |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc1T8cW1.s:92 .bss:00000014 GpsZiel_Y |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc1T8cW1.s:35 .text:00000042 GPS_BerechneZielrichtung |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc1T8cW1.s:50 .bss:00000000 GPS_Nick |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc1T8cW1.s:56 .bss:00000002 GPS_Roll |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc1T8cW1.s:62 .bss:00000004 GPS_Nick2 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc1T8cW1.s:68 .bss:00000006 GPS_Roll2 |
C:\Users\Arthur-P\AppData\Local\Temp/ccs3baaa.s:3 *ABS*:0000003f __SREG__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccs3baaa.s:4 *ABS*:0000003e __SP_H__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccs3baaa.s:5 *ABS*:0000003d __SP_L__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccs3baaa.s:6 *ABS*:00000000 __tmp_reg__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccs3baaa.s:7 *ABS*:00000001 __zero_reg__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccs3baaa.s:15 .bss:00000000 GpsZiel_Y |
C:\Users\Arthur-P\AppData\Local\Temp/ccs3baaa.s:21 .bss:00000004 GpsZiel_X |
C:\Users\Arthur-P\AppData\Local\Temp/ccs3baaa.s:27 .bss:00000008 GpsAktuell_Y |
C:\Users\Arthur-P\AppData\Local\Temp/ccs3baaa.s:33 .bss:0000000c GpsAktuell_X |
C:\Users\Arthur-P\AppData\Local\Temp/ccs3baaa.s:39 .bss:00000010 GPS_Roll2 |
C:\Users\Arthur-P\AppData\Local\Temp/ccs3baaa.s:45 .bss:00000012 GPS_Nick2 |
C:\Users\Arthur-P\AppData\Local\Temp/ccs3baaa.s:51 .bss:00000014 GPS_Roll |
C:\Users\Arthur-P\AppData\Local\Temp/ccs3baaa.s:57 .bss:00000016 GPS_Nick |
C:\Users\Arthur-P\AppData\Local\Temp/ccs3baaa.s:62 .text:00000000 GPS_Neutral |
C:\Users\Arthur-P\AppData\Local\Temp/ccs3baaa.s:88 .text:00000042 GPS_BerechneZielrichtung |
UNDEFINED SYMBOLS |
__do_copy_data |
__do_clear_bss |
/branches/V0.80g-Arthur-P1/Spektrum.lst |
---|
1,633 → 1,644 |
1 .file "Spektrum.c" |
2 __SREG__ = 0x3f |
3 __SP_H__ = 0x3e |
4 __SP_L__ = 0x3d |
5 __CCP__ = 0x34 |
2 .arch atmega644p |
3 __SREG__ = 0x3f |
4 __SP_H__ = 0x3e |
5 __SP_L__ = 0x3d |
6 __tmp_reg__ = 0 |
7 __zero_reg__ = 1 |
8 .text |
9 .global SpektrumUartInit |
11 SpektrumUartInit: |
12 /* prologue: function */ |
13 /* frame size = 0 */ |
14 0000 9FB7 in r25,__SREG__ |
15 /* #APP */ |
16 ; 84 "Spektrum.c" 1 |
17 0002 F894 cli |
18 ; 0 "" 2 |
19 /* #NOAPP */ |
20 0004 8091 C900 lds r24,201 |
21 0008 8F77 andi r24,lo8(127) |
22 000a 8093 C900 sts 201,r24 |
23 000e 8091 C900 lds r24,201 |
24 0012 8F7B andi r24,lo8(-65) |
25 0014 8093 C900 sts 201,r24 |
26 0018 8091 C900 lds r24,201 |
27 001c 8F7D andi r24,lo8(-33) |
28 001e 8093 C900 sts 201,r24 |
29 0022 5A9A sbi 43-32,2 |
30 0024 5298 cbi 42-32,2 |
31 0026 5B9A sbi 43-32,3 |
32 0028 539A sbi 42-32,3 |
33 002a 1092 CD00 sts 205,__zero_reg__ |
34 002e 84E1 ldi r24,lo8(20) |
35 0030 8093 CC00 sts 204,r24 |
36 0034 8091 C800 lds r24,200 |
37 0038 8260 ori r24,lo8(2) |
38 003a 8093 C800 sts 200,r24 |
39 003e 80E1 ldi r24,lo8(16) |
40 0040 8093 C900 sts 201,r24 |
41 0044 8091 CA00 lds r24,202 |
42 0048 8F77 andi r24,lo8(127) |
43 004a 8093 CA00 sts 202,r24 |
44 004e 8091 CA00 lds r24,202 |
45 0052 8F7B andi r24,lo8(-65) |
46 0054 8093 CA00 sts 202,r24 |
47 0058 8091 CA00 lds r24,202 |
48 005c 8F7D andi r24,lo8(-33) |
49 005e 8093 CA00 sts 202,r24 |
50 0062 8091 CA00 lds r24,202 |
51 0066 8F7E andi r24,lo8(-17) |
52 0068 8093 CA00 sts 202,r24 |
53 006c 8091 CA00 lds r24,202 |
54 0070 877F andi r24,lo8(-9) |
55 0072 8093 CA00 sts 202,r24 |
56 0076 8091 C900 lds r24,201 |
57 007a 8B7F andi r24,lo8(-5) |
58 007c 8093 C900 sts 201,r24 |
59 0080 8091 CA00 lds r24,202 |
60 0084 8460 ori r24,lo8(4) |
61 0086 8093 CA00 sts 202,r24 |
62 008a 8091 CA00 lds r24,202 |
63 008e 8260 ori r24,lo8(2) |
64 0090 8093 CA00 sts 202,r24 |
65 0094 00C0 rjmp .L2 |
66 .L3: |
67 0096 8091 CE00 lds r24,206 |
68 .L2: |
69 009a 8091 C800 lds r24,200 |
70 009e 87FD sbrc r24,7 |
71 00a0 00C0 rjmp .L3 |
72 00a2 8091 C900 lds r24,201 |
73 00a6 8068 ori r24,lo8(-128) |
74 00a8 8093 C900 sts 201,r24 |
75 00ac 9FBF out __SREG__,r25 |
76 /* epilogue start */ |
77 00ae 0895 ret |
79 .global SpektrumParser |
81 SpektrumParser: |
82 00b0 0F93 push r16 |
83 00b2 1F93 push r17 |
84 00b4 CF93 push r28 |
85 00b6 DF93 push r29 |
86 /* prologue: function */ |
87 /* frame size = 0 */ |
88 00b8 982F mov r25,r24 |
89 00ba 8091 0000 lds r24,ReSync.2382 |
90 00be 8130 cpi r24,lo8(1) |
91 00c0 01F4 brne .L6 |
92 00c2 1092 0000 sts ReSync.2382,__zero_reg__ |
93 00c6 84E4 ldi r24,lo8(68) |
94 00c8 8093 0000 sts SpektrumTimer,r24 |
95 00cc 1092 0000 sts FrameCnt.2380,__zero_reg__ |
96 00d0 1092 0000 sts Sync.2379,__zero_reg__ |
97 00d4 1092 0000 sts ByteHigh.2381,__zero_reg__ |
98 00d8 00C0 rjmp .L27 |
99 .L6: |
100 00da 20E0 ldi r18,lo8(0) |
101 00dc 30E0 ldi r19,hi8(0) |
102 00de 8091 0000 lds r24,SpektrumTimer |
103 00e2 8823 tst r24 |
104 00e4 01F4 brne .L8 |
105 00e6 21E0 ldi r18,lo8(1) |
106 00e8 30E0 ldi r19,hi8(1) |
107 .L8: |
108 00ea 8091 0000 lds r24,Sync.2379 |
109 00ee 8823 tst r24 |
110 00f0 01F4 brne .L9 |
111 00f2 232B or r18,r19 |
112 00f4 01F0 breq .L10 |
113 00f6 81E0 ldi r24,lo8(1) |
114 00f8 00C0 rjmp .L31 |
115 .L10: |
116 00fa 84E4 ldi r24,lo8(68) |
117 00fc 8093 0000 sts SpektrumTimer,r24 |
118 0100 1092 0000 sts FrameCnt.2380,__zero_reg__ |
119 0104 1092 0000 sts Sync.2379,__zero_reg__ |
120 0108 1092 0000 sts ByteHigh.2381,__zero_reg__ |
121 010c 00C0 rjmp .L11 |
122 .L9: |
123 010e 8130 cpi r24,lo8(1) |
124 0110 01F4 brne .L12 |
125 0112 232B or r18,r19 |
126 0114 01F0 breq .+2 |
127 0116 00C0 rjmp .L15 |
128 0118 82E0 ldi r24,lo8(2) |
129 .L31: |
130 011a 8093 0000 sts Sync.2379,r24 |
131 011e 8091 0000 lds r24,FrameCnt.2380 |
132 0122 8F5F subi r24,lo8(-(1)) |
133 0124 8093 0000 sts FrameCnt.2380,r24 |
134 0128 83E0 ldi r24,lo8(3) |
135 012a 00C0 rjmp .L30 |
136 .L12: |
137 012c 8230 cpi r24,lo8(2) |
138 012e 01F4 brne .L13 |
139 0130 232B or r18,r19 |
140 0132 01F0 breq .+2 |
141 0134 00C0 rjmp .L15 |
142 0136 83E0 ldi r24,lo8(3) |
143 0138 8093 0000 sts SpektrumTimer,r24 |
144 013c 9093 0000 sts ByteHigh.2381,r25 |
145 0140 2091 0000 lds r18,FrameCnt.2380 |
146 0144 2230 cpi r18,lo8(2) |
147 0146 01F4 brne .L14 |
148 0148 1092 0000 sts Frame2.2383,__zero_reg__ |
149 014c 97FF sbrs r25,7 |
150 014e 00C0 rjmp .L14 |
151 0150 81E0 ldi r24,lo8(1) |
152 0152 8093 0000 sts Frame2.2383,r24 |
153 .L14: |
154 0156 83E0 ldi r24,lo8(3) |
155 0158 8093 0000 sts Sync.2379,r24 |
156 015c 2F5F subi r18,lo8(-(1)) |
157 015e 2093 0000 sts FrameCnt.2380,r18 |
158 0162 00C0 rjmp .L11 |
159 .L13: |
160 0164 8330 cpi r24,lo8(3) |
161 0166 01F0 breq .+2 |
162 0168 00C0 rjmp .L15 |
163 016a 232B or r18,r19 |
164 016c 01F0 breq .+2 |
165 016e 00C0 rjmp .L15 |
166 0170 8093 0000 sts SpektrumTimer,r24 |
167 0174 82E0 ldi r24,lo8(2) |
168 0176 8093 0000 sts Sync.2379,r24 |
169 017a 8091 0000 lds r24,FrameCnt.2380 |
170 017e 8F5F subi r24,lo8(-(1)) |
171 0180 8093 0000 sts FrameCnt.2380,r24 |
172 0184 4091 0000 lds r20,ByteHigh.2381 |
173 0188 292F mov r18,r25 |
174 018a 30E0 ldi r19,lo8(0) |
175 018c 942F mov r25,r20 |
176 018e 80E0 ldi r24,lo8(0) |
177 0190 282B or r18,r24 |
178 0192 392B or r19,r25 |
179 0194 8091 0000 lds r24,EE_Parameter+39 |
180 0198 8130 cpi r24,lo8(1) |
181 019a 01F4 brne .L16 |
182 019c 3370 andi r19,hi8(1023) |
183 019e C901 movw r24,r18 |
184 01a0 8050 subi r24,lo8(-(-512)) |
185 01a2 9240 sbci r25,hi8(-(-512)) |
186 01a4 63E0 ldi r22,lo8(3) |
187 01a6 70E0 ldi r23,hi8(3) |
188 01a8 00C0 rjmp .L28 |
189 .L16: |
190 01aa 8230 cpi r24,lo8(2) |
191 01ac 01F4 brne .L18 |
192 01ae 3770 andi r19,hi8(2047) |
193 01b0 C901 movw r24,r18 |
194 01b2 8050 subi r24,lo8(-(-1024)) |
195 01b4 9440 sbci r25,hi8(-(-1024)) |
196 01b6 66E0 ldi r22,lo8(6) |
197 01b8 70E0 ldi r23,hi8(6) |
198 01ba 0E94 0000 call __divmodhi4 |
199 01be EB01 movw r28,r22 |
200 01c0 4695 lsr r20 |
201 01c2 4695 lsr r20 |
202 01c4 4695 lsr r20 |
203 01c6 00C0 rjmp .L29 |
204 .L18: |
205 01c8 3370 andi r19,hi8(1023) |
206 01ca C901 movw r24,r18 |
207 01cc 8856 subi r24,lo8(-(-360)) |
208 01ce 9140 sbci r25,hi8(-(-360)) |
209 01d0 62E0 ldi r22,lo8(2) |
210 01d2 70E0 ldi r23,hi8(2) |
211 .L28: |
212 01d4 0E94 0000 call __divmodhi4 |
213 01d8 EB01 movw r28,r22 |
214 01da 4695 lsr r20 |
215 01dc 4695 lsr r20 |
216 .L29: |
217 01de 842F mov r24,r20 |
218 01e0 90E0 ldi r25,lo8(0) |
219 01e2 8F70 andi r24,lo8(15) |
220 01e4 9070 andi r25,hi8(15) |
221 01e6 8C01 movw r16,r24 |
222 01e8 0F5F subi r16,lo8(-(1)) |
223 01ea 1F4F sbci r17,hi8(-(1)) |
224 01ec 0D30 cpi r16,13 |
225 01ee 1105 cpc r17,__zero_reg__ |
226 01f0 00F0 brlo .+2 |
227 01f2 00C0 rjmp .L11 |
228 01f4 F801 movw r30,r16 |
229 01f6 EE0F lsl r30 |
230 01f8 FF1F rol r31 |
231 01fa E050 subi r30,lo8(-(PPM_in)) |
232 01fc F040 sbci r31,hi8(-(PPM_in)) |
233 01fe 8081 ld r24,Z |
234 0200 9181 ldd r25,Z+1 |
235 0202 9E01 movw r18,r28 |
236 0204 281B sub r18,r24 |
237 0206 390B sbc r19,r25 |
238 0208 C901 movw r24,r18 |
239 020a 37FF sbrs r19,7 |
240 020c 00C0 rjmp .L20 |
241 020e 9095 com r25 |
242 0210 8195 neg r24 |
243 0212 9F4F sbci r25,lo8(-1) |
244 .L20: |
245 0214 0697 sbiw r24,6 |
246 0216 04F4 brge .L19 |
247 0218 8091 0000 lds r24,SenderOkay |
248 021c 883C cpi r24,lo8(-56) |
249 021e 00F4 brsh .L21 |
250 0220 8091 0000 lds r24,SenderOkay |
251 0224 865F subi r24,lo8(-(10)) |
252 0226 8093 0000 sts SenderOkay,r24 |
253 022a 00C0 rjmp .L19 |
254 .L21: |
255 022c 88EC ldi r24,lo8(-56) |
256 022e 8093 0000 sts SenderOkay,r24 |
257 0232 8091 6F00 lds r24,111 |
258 0236 8F7D andi r24,lo8(-33) |
259 0238 8093 6F00 sts 111,r24 |
260 .L19: |
261 023c F801 movw r30,r16 |
262 023e EE0F lsl r30 |
263 0240 FF1F rol r31 |
264 0242 E050 subi r30,lo8(-(PPM_in)) |
265 0244 F040 sbci r31,hi8(-(PPM_in)) |
266 0246 2081 ld r18,Z |
267 0248 3181 ldd r19,Z+1 |
268 024a C901 movw r24,r18 |
269 024c 880F lsl r24 |
270 024e 991F rol r25 |
271 0250 820F add r24,r18 |
272 0252 931F adc r25,r19 |
273 0254 8C0F add r24,r28 |
274 0256 9D1F adc r25,r29 |
275 0258 64E0 ldi r22,lo8(4) |
276 025a 70E0 ldi r23,hi8(4) |
277 025c 0E94 0000 call __divmodhi4 |
278 0260 9B01 movw r18,r22 |
279 0262 CE01 movw r24,r28 |
280 0264 0196 adiw r24,1 |
281 0266 8617 cp r24,r22 |
282 0268 9707 cpc r25,r23 |
283 026a 04F4 brge .L22 |
284 026c 2150 subi r18,lo8(-(-1)) |
285 026e 3040 sbci r19,hi8(-(-1)) |
286 0270 00C0 rjmp .L23 |
287 .L22: |
288 0272 2197 sbiw r28,1 |
289 0274 6C17 cp r22,r28 |
290 0276 7D07 cpc r23,r29 |
291 0278 04F4 brge .L23 |
292 027a 2F5F subi r18,lo8(-(1)) |
293 027c 3F4F sbci r19,hi8(-(1)) |
294 .L23: |
295 027e 8091 0000 lds r24,SenderOkay |
296 0282 E801 movw r28,r16 |
297 0284 CC0F lsl r28 |
298 0286 DD1F rol r29 |
299 0288 843B cpi r24,lo8(-76) |
300 028a 00F0 brlo .L24 |
301 028c FE01 movw r30,r28 |
302 028e E050 subi r30,lo8(-(PPM_in)) |
303 0290 F040 sbci r31,hi8(-(PPM_in)) |
304 0292 8081 ld r24,Z |
305 0294 9181 ldd r25,Z+1 |
306 0296 A901 movw r20,r18 |
307 0298 481B sub r20,r24 |
308 029a 590B sbc r21,r25 |
309 029c CA01 movw r24,r20 |
310 029e 63E0 ldi r22,lo8(3) |
311 02a0 70E0 ldi r23,hi8(3) |
312 02a2 0E94 0000 call __divmodhi4 |
313 02a6 CB01 movw r24,r22 |
314 02a8 880F lsl r24 |
315 02aa 991F rol r25 |
316 02ac 860F add r24,r22 |
317 02ae 971F adc r25,r23 |
318 02b0 C050 subi r28,lo8(-(PPM_diff)) |
319 02b2 D040 sbci r29,hi8(-(PPM_diff)) |
320 02b4 9983 std Y+1,r25 |
321 02b6 8883 st Y,r24 |
322 02b8 00C0 rjmp .L25 |
323 .L24: |
324 02ba C050 subi r28,lo8(-(PPM_diff)) |
325 02bc D040 sbci r29,hi8(-(PPM_diff)) |
326 02be 1982 std Y+1,__zero_reg__ |
327 02c0 1882 st Y,__zero_reg__ |
328 .L25: |
329 02c2 000F lsl r16 |
330 02c4 111F rol r17 |
331 02c6 0050 subi r16,lo8(-(PPM_in)) |
332 02c8 1040 sbci r17,hi8(-(PPM_in)) |
333 02ca F801 movw r30,r16 |
334 02cc 3183 std Z+1,r19 |
335 02ce 2083 st Z,r18 |
336 02d0 00C0 rjmp .L11 |
337 .L15: |
338 02d2 81E0 ldi r24,lo8(1) |
339 02d4 8093 0000 sts ReSync.2382,r24 |
340 02d8 1092 0000 sts FrameCnt.2380,__zero_reg__ |
341 02dc 1092 0000 sts Frame2.2383,__zero_reg__ |
342 02e0 84E4 ldi r24,lo8(68) |
343 .L30: |
344 02e2 8093 0000 sts SpektrumTimer,r24 |
345 .L11: |
346 02e6 8091 0000 lds r24,FrameCnt.2380 |
347 02ea 8031 cpi r24,lo8(16) |
348 02ec 00F0 brlo .L27 |
349 02ee 8091 0000 lds r24,Frame2.2383 |
350 02f2 8823 tst r24 |
351 02f4 01F4 brne .L26 |
352 02f6 8091 0000 lds r24,ReSync.2382 |
353 02fa 8823 tst r24 |
354 02fc 01F4 brne .L26 |
355 02fe 1092 0000 sts NewPpmData,__zero_reg__ |
356 .L26: |
357 0302 1092 0000 sts FrameCnt.2380,__zero_reg__ |
358 0306 1092 0000 sts Frame2.2383,__zero_reg__ |
359 030a 1092 0000 sts Sync.2379,__zero_reg__ |
360 030e 84E4 ldi r24,lo8(68) |
361 0310 8093 0000 sts SpektrumTimer,r24 |
362 .L27: |
363 /* epilogue start */ |
364 0314 DF91 pop r29 |
365 0316 CF91 pop r28 |
366 0318 1F91 pop r17 |
367 031a 0F91 pop r16 |
368 031c 0895 ret |
370 .global SpektrumBinding |
372 SpektrumBinding: |
373 031e CF93 push r28 |
374 0320 DF93 push r29 |
375 /* prologue: function */ |
376 /* frame size = 0 */ |
377 0322 80E1 ldi r24,lo8(10000) |
378 0324 97E2 ldi r25,hi8(10000) |
379 0326 0E94 0000 call SetDelay |
380 032a EC01 movw r28,r24 |
381 032c 8091 C900 lds r24,201 |
382 0330 8F77 andi r24,lo8(127) |
383 0332 8093 C900 sts 201,r24 |
384 0336 8091 C900 lds r24,201 |
385 033a 8F7E andi r24,lo8(-17) |
386 033c 8093 C900 sts 201,r24 |
387 0340 5A98 cbi 43-32,2 |
388 0342 00D0 rcall . |
389 0344 00D0 rcall . |
390 0346 80E0 ldi r24,lo8(gs(uart_putchar)) |
391 0348 90E0 ldi r25,hi8(gs(uart_putchar)) |
392 034a EDB7 in r30,__SP_L__ |
393 034c FEB7 in r31,__SP_H__ |
394 034e 9283 std Z+2,r25 |
395 0350 8183 std Z+1,r24 |
396 0352 80E0 ldi r24,lo8(__c.2218) |
397 0354 90E0 ldi r25,hi8(__c.2218) |
398 0356 9483 std Z+4,r25 |
399 0358 8383 std Z+3,r24 |
400 035a E091 0000 lds r30,_printf_P |
401 035e F091 0000 lds r31,(_printf_P)+1 |
402 0362 0995 icall |
403 0364 0F90 pop __tmp_reg__ |
404 0366 0F90 pop __tmp_reg__ |
405 0368 0F90 pop __tmp_reg__ |
406 036a 0F90 pop __tmp_reg__ |
407 036c 00C0 rjmp .L33 |
408 .L35: |
409 036e 4A9B sbis 41-32,2 |
410 0370 00C0 rjmp .L33 |
411 0372 8AE5 ldi r24,lo8(90) |
412 0374 90E0 ldi r25,hi8(90) |
413 0376 0E94 0000 call SetDelay |
414 037a EC01 movw r28,r24 |
415 037c 00D0 rcall . |
416 037e 00D0 rcall . |
417 0380 80E0 ldi r24,lo8(gs(uart_putchar)) |
418 0382 90E0 ldi r25,hi8(gs(uart_putchar)) |
419 0384 EDB7 in r30,__SP_L__ |
420 0386 FEB7 in r31,__SP_H__ |
421 0388 9283 std Z+2,r25 |
422 038a 8183 std Z+1,r24 |
423 038c 80E0 ldi r24,lo8(__c.2223) |
424 038e 90E0 ldi r25,hi8(__c.2223) |
425 0390 9483 std Z+4,r25 |
426 0392 8383 std Z+3,r24 |
427 0394 E091 0000 lds r30,_printf_P |
428 0398 F091 0000 lds r31,(_printf_P)+1 |
429 039c 0995 icall |
430 039e 529A sbi 42-32,2 |
431 03a0 0F90 pop __tmp_reg__ |
432 03a2 0F90 pop __tmp_reg__ |
433 03a4 0F90 pop __tmp_reg__ |
434 03a6 0F90 pop __tmp_reg__ |
435 03a8 00C0 rjmp .L34 |
436 .L33: |
437 03aa CE01 movw r24,r28 |
438 03ac 0E94 0000 call CheckDelay |
439 03b0 8823 tst r24 |
440 03b2 01F0 breq .L35 |
441 03b4 00C0 rjmp .L68 |
442 .L34: |
443 03b6 CE01 movw r24,r28 |
444 03b8 0E94 0000 call CheckDelay |
445 03bc 8823 tst r24 |
446 03be 01F0 breq .L34 |
447 03c0 80E0 ldi r24,lo8(0) |
448 03c2 90E0 ldi r25,hi8(0) |
449 .L37: |
450 03c4 5A9A sbi 43-32,2 |
451 03c6 0196 adiw r24,1 |
452 03c8 8436 cpi r24,100 |
453 03ca 9105 cpc r25,__zero_reg__ |
454 03cc 01F4 brne .L37 |
455 03ce 80E0 ldi r24,lo8(0) |
456 03d0 90E0 ldi r25,hi8(0) |
457 .L38: |
458 03d2 5A98 cbi 43-32,2 |
459 03d4 0196 adiw r24,1 |
460 03d6 F1E0 ldi r31,hi8(400) |
461 03d8 8039 cpi r24,lo8(400) |
462 03da 9F07 cpc r25,r31 |
463 03dc 01F4 brne .L38 |
464 03de 80E0 ldi r24,lo8(0) |
465 03e0 90E0 ldi r25,hi8(0) |
466 .L39: |
467 03e2 5A9A sbi 43-32,2 |
468 03e4 0196 adiw r24,1 |
469 03e6 8A30 cpi r24,10 |
470 03e8 9105 cpc r25,__zero_reg__ |
471 03ea 01F4 brne .L39 |
472 03ec 80E0 ldi r24,lo8(0) |
473 03ee 90E0 ldi r25,hi8(0) |
474 .L40: |
475 03f0 5A98 cbi 43-32,2 |
476 03f2 0196 adiw r24,1 |
477 03f4 8A30 cpi r24,10 |
478 03f6 9105 cpc r25,__zero_reg__ |
479 03f8 01F4 brne .L40 |
480 03fa 80E0 ldi r24,lo8(0) |
481 03fc 90E0 ldi r25,hi8(0) |
482 .L41: |
483 03fe 5A9A sbi 43-32,2 |
484 0400 0196 adiw r24,1 |
485 0402 21E0 ldi r18,hi8(400) |
486 0404 8039 cpi r24,lo8(400) |
487 0406 9207 cpc r25,r18 |
488 0408 01F4 brne .L41 |
489 040a 80E0 ldi r24,lo8(0) |
490 040c 90E0 ldi r25,hi8(0) |
491 .L42: |
492 040e 5A98 cbi 43-32,2 |
493 0410 0196 adiw r24,1 |
494 0412 E1E0 ldi r30,hi8(400) |
495 0414 8039 cpi r24,lo8(400) |
496 0416 9E07 cpc r25,r30 |
497 0418 01F4 brne .L42 |
498 041a 80E0 ldi r24,lo8(0) |
499 041c 90E0 ldi r25,hi8(0) |
500 .L43: |
501 041e 5A9A sbi 43-32,2 |
502 0420 0196 adiw r24,1 |
503 0422 8A30 cpi r24,10 |
504 0424 9105 cpc r25,__zero_reg__ |
505 0426 01F4 brne .L43 |
506 0428 80E0 ldi r24,lo8(0) |
507 042a 90E0 ldi r25,hi8(0) |
508 .L44: |
509 042c 5A98 cbi 43-32,2 |
510 042e 0196 adiw r24,1 |
511 0430 8A30 cpi r24,10 |
512 0432 9105 cpc r25,__zero_reg__ |
513 0434 01F4 brne .L44 |
514 0436 80E0 ldi r24,lo8(0) |
515 0438 90E0 ldi r25,hi8(0) |
516 .L45: |
517 043a 5A9A sbi 43-32,2 |
518 043c 0196 adiw r24,1 |
519 043e F1E0 ldi r31,hi8(400) |
520 0440 8039 cpi r24,lo8(400) |
521 0442 9F07 cpc r25,r31 |
522 0444 01F4 brne .L45 |
523 0446 80E0 ldi r24,lo8(0) |
524 0448 90E0 ldi r25,hi8(0) |
525 .L46: |
526 044a 5A98 cbi 43-32,2 |
527 044c 0196 adiw r24,1 |
528 044e 21E0 ldi r18,hi8(400) |
529 0450 8039 cpi r24,lo8(400) |
530 0452 9207 cpc r25,r18 |
531 0454 01F4 brne .L46 |
532 0456 80E0 ldi r24,lo8(0) |
533 0458 90E0 ldi r25,hi8(0) |
534 .L47: |
535 045a 5A9A sbi 43-32,2 |
536 045c 0196 adiw r24,1 |
537 045e 8A30 cpi r24,10 |
538 0460 9105 cpc r25,__zero_reg__ |
539 0462 01F4 brne .L47 |
540 0464 80E0 ldi r24,lo8(0) |
541 0466 90E0 ldi r25,hi8(0) |
542 .L48: |
543 0468 5A98 cbi 43-32,2 |
544 046a 0196 adiw r24,1 |
545 046c 8A30 cpi r24,10 |
546 046e 9105 cpc r25,__zero_reg__ |
547 0470 01F4 brne .L48 |
548 0472 80E0 ldi r24,lo8(0) |
549 0474 90E0 ldi r25,hi8(0) |
550 .L49: |
551 0476 5A9A sbi 43-32,2 |
552 0478 0196 adiw r24,1 |
553 047a E1E0 ldi r30,hi8(400) |
554 047c 8039 cpi r24,lo8(400) |
555 047e 9E07 cpc r25,r30 |
556 0480 01F4 brne .L49 |
557 .L50: |
558 0482 5298 cbi 42-32,2 |
559 0484 5A98 cbi 43-32,2 |
560 0486 0E94 0000 call SpektrumUartInit |
561 /* epilogue start */ |
562 048a DF91 pop r29 |
563 048c CF91 pop r28 |
564 048e 0895 ret |
565 .L68: |
566 0490 00D0 rcall . |
567 0492 00D0 rcall . |
568 0494 80E0 ldi r24,lo8(gs(uart_putchar)) |
569 0496 90E0 ldi r25,hi8(gs(uart_putchar)) |
570 0498 EDB7 in r30,__SP_L__ |
571 049a FEB7 in r31,__SP_H__ |
572 049c 9283 std Z+2,r25 |
573 049e 8183 std Z+1,r24 |
574 04a0 80E0 ldi r24,lo8(__c.2267) |
575 04a2 90E0 ldi r25,hi8(__c.2267) |
576 04a4 9483 std Z+4,r25 |
577 04a6 8383 std Z+3,r24 |
578 04a8 E091 0000 lds r30,_printf_P |
579 04ac F091 0000 lds r31,(_printf_P)+1 |
580 04b0 0995 icall |
581 04b2 0F90 pop __tmp_reg__ |
582 04b4 0F90 pop __tmp_reg__ |
583 04b6 0F90 pop __tmp_reg__ |
584 04b8 0F90 pop __tmp_reg__ |
585 04ba 00C0 rjmp .L50 |
587 .global SpektrumTimer |
588 .global SpektrumTimer |
589 .section .bss |
592 SpektrumTimer: |
593 0000 00 .skip 1,0 |
594 .lcomm Frame2.2383,1 |
595 .data |
598 ReSync.2382: |
599 0000 01 .byte 1 |
600 .lcomm ByteHigh.2381,1 |
601 .lcomm FrameCnt.2380,1 |
602 .lcomm Sync.2379,1 |
603 .section .progmem.data,"a",@progbits |
606 __c.2267: |
607 0000 5469 6D65 .string "Timeout.\n\r" |
607 6F75 742E |
607 0A0D 00 |
610 __c.2223: |
611 000b 6F6B 2E0A .string "ok.\n\r" |
611 0D00 |
614 __c.2218: |
615 0011 0A0D 506C .string "\n\rPlease connect Spektrum receiver for binding NOW..." |
615 6561 7365 |
615 2063 6F6E |
615 6E65 6374 |
615 2053 7065 |
616 .global __do_copy_data |
617 .global __do_clear_bss |
8 .global __do_copy_data |
9 .global __do_clear_bss |
10 .global SpektrumTimer |
11 .global SpektrumTimer |
12 .section .bss |
15 SpektrumTimer: |
16 0000 00 .skip 1,0 |
17 .text |
18 .global SpektrumUartInit |
20 SpektrumUartInit: |
21 /* prologue: frame size=0 */ |
22 /* prologue end (size=0) */ |
23 0000 4FB7 in r20,95-0x20 |
24 0002 24E1 ldi r18,lo8(20) |
25 0004 30E0 ldi r19,hi8(20) |
26 /* #APP */ |
27 0006 F894 cli |
28 /* #NOAPP */ |
29 0008 8091 C900 lds r24,201 |
30 000c 8F77 andi r24,lo8(127) |
31 000e 8093 C900 sts 201,r24 |
32 0012 8091 C900 lds r24,201 |
33 0016 8F7B andi r24,lo8(-65) |
34 0018 8093 C900 sts 201,r24 |
35 001c 8091 C900 lds r24,201 |
36 0020 8F7D andi r24,lo8(-33) |
37 0022 8093 C900 sts 201,r24 |
38 0026 5A9A sbi 43-0x20,2 |
39 0028 5298 cbi 42-0x20,2 |
40 002a 5B9A sbi 43-0x20,3 |
41 002c 539A sbi 42-0x20,3 |
42 002e 832F mov r24,r19 |
43 0030 9927 clr r25 |
44 0032 8093 CD00 sts 205,r24 |
45 0036 2093 CC00 sts 204,r18 |
46 003a 8091 C800 lds r24,200 |
47 003e 8260 ori r24,lo8(2) |
48 0040 8093 C800 sts 200,r24 |
49 0044 80E1 ldi r24,lo8(16) |
50 0046 8093 C900 sts 201,r24 |
51 004a 8091 CA00 lds r24,202 |
52 004e 8F77 andi r24,lo8(127) |
53 0050 8093 CA00 sts 202,r24 |
54 0054 8091 CA00 lds r24,202 |
55 0058 8F7B andi r24,lo8(-65) |
56 005a 8093 CA00 sts 202,r24 |
57 005e 8091 CA00 lds r24,202 |
58 0062 8F7D andi r24,lo8(-33) |
59 0064 8093 CA00 sts 202,r24 |
60 0068 8091 CA00 lds r24,202 |
61 006c 8F7E andi r24,lo8(-17) |
62 006e 8093 CA00 sts 202,r24 |
63 0072 8091 CA00 lds r24,202 |
64 0076 877F andi r24,lo8(-9) |
65 0078 8093 CA00 sts 202,r24 |
66 007c 8091 C900 lds r24,201 |
67 0080 8B7F andi r24,lo8(-5) |
68 0082 8093 C900 sts 201,r24 |
69 0086 8091 CA00 lds r24,202 |
70 008a 8460 ori r24,lo8(4) |
71 008c 8093 CA00 sts 202,r24 |
72 0090 8091 CA00 lds r24,202 |
73 0094 8260 ori r24,lo8(2) |
74 0096 8093 CA00 sts 202,r24 |
75 .L7: |
76 009a 8091 C800 lds r24,200 |
77 009e 87FF sbrs r24,7 |
78 00a0 03C0 rjmp .L6 |
79 00a2 8091 CE00 lds r24,206 |
80 00a6 F9CF rjmp .L7 |
81 .L6: |
82 00a8 8091 C900 lds r24,201 |
83 00ac 8068 ori r24,lo8(-128) |
84 00ae 8093 C900 sts 201,r24 |
85 00b2 4FBF out 95-0x20,r20 |
86 /* epilogue: frame size=0 */ |
87 00b4 0895 ret |
88 /* epilogue end (size=1) */ |
89 /* function SpektrumUartInit size 92 (91) */ |
91 .section .progmem.data,"a",@progbits |
94 __c.5: |
95 0000 0A0D 506C .string "\n\rPlease connect Spektrum receiver for binding NOW..." |
95 6561 7365 |
95 2063 6F6E |
95 6E65 6374 |
95 2053 7065 |
98 __c.6: |
99 0036 6F6B 2E0A .string "ok.\n\r" |
99 0D00 |
102 __c.7: |
103 003c 5469 6D65 .string "Timeout.\n\r" |
103 6F75 742E |
103 0A0D 00 |
104 .text |
105 .global SpektrumBinding |
107 SpektrumBinding: |
108 /* prologue: frame size=0 */ |
109 00b6 FF92 push r15 |
110 00b8 0F93 push r16 |
111 00ba 1F93 push r17 |
112 00bc CF93 push r28 |
113 00be DF93 push r29 |
114 /* prologue end (size=5) */ |
115 00c0 80E1 ldi r24,lo8(10000) |
116 00c2 97E2 ldi r25,hi8(10000) |
117 00c4 0E94 0000 call SetDelay |
118 00c8 EC01 movw r28,r24 |
119 00ca FF24 clr r15 |
120 00cc 8091 C900 lds r24,201 |
121 00d0 8F77 andi r24,lo8(127) |
122 00d2 8093 C900 sts 201,r24 |
123 00d6 8091 C900 lds r24,201 |
124 00da 8F7E andi r24,lo8(-17) |
125 00dc 8093 C900 sts 201,r24 |
126 00e0 5A98 cbi 43-0x20,2 |
127 00e2 80E0 ldi r24,lo8(__c.5) |
128 00e4 90E0 ldi r25,hi8(__c.5) |
129 00e6 9F93 push r25 |
130 00e8 8F93 push r24 |
131 00ea 00E0 ldi r16,lo8(pm(uart_putchar)) |
132 00ec 10E0 ldi r17,hi8(pm(uart_putchar)) |
133 00ee 1F93 push r17 |
134 00f0 0F93 push r16 |
135 00f2 E091 0000 lds r30,_printf_P |
136 00f6 F091 0000 lds r31,(_printf_P)+1 |
137 00fa 0995 icall |
138 00fc 0F90 pop __tmp_reg__ |
139 00fe 0F90 pop __tmp_reg__ |
140 0100 0F90 pop __tmp_reg__ |
141 0102 0F90 pop __tmp_reg__ |
142 0104 02C0 rjmp .L9 |
143 .L12: |
144 0106 4A99 sbic 41-0x20,2 |
145 0108 6CC0 rjmp .L96 |
146 .L9: |
147 010a CE01 movw r24,r28 |
148 010c 0E94 0000 call CheckDelay |
149 0110 8823 tst r24 |
150 0112 C9F3 breq .L12 |
151 .L10: |
152 0114 E091 0000 lds r30,_printf_P |
153 0118 F091 0000 lds r31,(_printf_P)+1 |
154 011c FF20 tst r15 |
155 011e 09F4 brne .+2 |
156 0120 68C0 rjmp .L13 |
157 0122 80E0 ldi r24,lo8(__c.6) |
158 0124 90E0 ldi r25,hi8(__c.6) |
159 0126 9F93 push r25 |
160 0128 8F93 push r24 |
161 012a 1F93 push r17 |
162 012c 0F93 push r16 |
163 012e 0995 icall |
164 0130 529A sbi 42-0x20,2 |
165 0132 0F90 pop __tmp_reg__ |
166 0134 0F90 pop __tmp_reg__ |
167 0136 0F90 pop __tmp_reg__ |
168 0138 0F90 pop __tmp_reg__ |
169 .L14: |
170 013a CE01 movw r24,r28 |
171 013c 0E94 0000 call CheckDelay |
172 0140 8823 tst r24 |
173 0142 D9F3 breq .L14 |
174 0144 83E6 ldi r24,lo8(99) |
175 0146 90E0 ldi r25,hi8(99) |
176 .L20: |
177 0148 5A9A sbi 43-0x20,2 |
178 014a 0197 sbiw r24,1 |
179 014c 97FF sbrs r25,7 |
180 014e FCCF rjmp .L20 |
181 0150 8FE8 ldi r24,lo8(399) |
182 0152 91E0 ldi r25,hi8(399) |
183 .L24: |
184 0154 5A98 cbi 43-0x20,2 |
185 0156 0197 sbiw r24,1 |
186 0158 97FF sbrs r25,7 |
187 015a FCCF rjmp .L24 |
188 015c 89E0 ldi r24,lo8(9) |
189 015e 90E0 ldi r25,hi8(9) |
190 .L28: |
191 0160 5A9A sbi 43-0x20,2 |
192 0162 0197 sbiw r24,1 |
193 0164 97FF sbrs r25,7 |
194 0166 FCCF rjmp .L28 |
195 0168 89E0 ldi r24,lo8(9) |
196 016a 90E0 ldi r25,hi8(9) |
197 .L32: |
198 016c 5A98 cbi 43-0x20,2 |
199 016e 0197 sbiw r24,1 |
200 0170 97FF sbrs r25,7 |
201 0172 FCCF rjmp .L32 |
202 0174 8FE8 ldi r24,lo8(399) |
203 0176 91E0 ldi r25,hi8(399) |
204 .L36: |
205 0178 5A9A sbi 43-0x20,2 |
206 017a 0197 sbiw r24,1 |
207 017c 97FF sbrs r25,7 |
208 017e FCCF rjmp .L36 |
209 0180 8FE8 ldi r24,lo8(399) |
210 0182 91E0 ldi r25,hi8(399) |
211 .L40: |
212 0184 5A98 cbi 43-0x20,2 |
213 0186 0197 sbiw r24,1 |
214 0188 97FF sbrs r25,7 |
215 018a FCCF rjmp .L40 |
216 018c 89E0 ldi r24,lo8(9) |
217 018e 90E0 ldi r25,hi8(9) |
218 .L44: |
219 0190 5A9A sbi 43-0x20,2 |
220 0192 0197 sbiw r24,1 |
221 0194 97FF sbrs r25,7 |
222 0196 FCCF rjmp .L44 |
223 0198 89E0 ldi r24,lo8(9) |
224 019a 90E0 ldi r25,hi8(9) |
225 .L48: |
226 019c 5A98 cbi 43-0x20,2 |
227 019e 0197 sbiw r24,1 |
228 01a0 97FF sbrs r25,7 |
229 01a2 FCCF rjmp .L48 |
230 01a4 8FE8 ldi r24,lo8(399) |
231 01a6 91E0 ldi r25,hi8(399) |
232 .L52: |
233 01a8 5A9A sbi 43-0x20,2 |
234 01aa 0197 sbiw r24,1 |
235 01ac 97FF sbrs r25,7 |
236 01ae FCCF rjmp .L52 |
237 01b0 8FE8 ldi r24,lo8(399) |
238 01b2 91E0 ldi r25,hi8(399) |
239 .L56: |
240 01b4 5A98 cbi 43-0x20,2 |
241 01b6 0197 sbiw r24,1 |
242 01b8 97FF sbrs r25,7 |
243 01ba FCCF rjmp .L56 |
244 01bc 89E0 ldi r24,lo8(9) |
245 01be 90E0 ldi r25,hi8(9) |
246 .L60: |
247 01c0 5A9A sbi 43-0x20,2 |
248 01c2 0197 sbiw r24,1 |
249 01c4 97FF sbrs r25,7 |
250 01c6 FCCF rjmp .L60 |
251 01c8 89E0 ldi r24,lo8(9) |
252 01ca 90E0 ldi r25,hi8(9) |
253 .L64: |
254 01cc 5A98 cbi 43-0x20,2 |
255 01ce 0197 sbiw r24,1 |
256 01d0 97FF sbrs r25,7 |
257 01d2 FCCF rjmp .L64 |
258 01d4 8FE8 ldi r24,lo8(399) |
259 01d6 91E0 ldi r25,hi8(399) |
260 .L68: |
261 01d8 5A9A sbi 43-0x20,2 |
262 01da 0197 sbiw r24,1 |
263 01dc 97FF sbrs r25,7 |
264 01de FCCF rjmp .L68 |
265 01e0 13C0 rjmp .L69 |
266 .L96: |
267 01e2 8AE5 ldi r24,lo8(90) |
268 01e4 90E0 ldi r25,hi8(90) |
269 01e6 0E94 0000 call SetDelay |
270 01ea EC01 movw r28,r24 |
271 01ec 91E0 ldi r25,lo8(1) |
272 01ee F92E mov r15,r25 |
273 01f0 91CF rjmp .L10 |
274 .L13: |
275 01f2 80E0 ldi r24,lo8(__c.7) |
276 01f4 90E0 ldi r25,hi8(__c.7) |
277 01f6 9F93 push r25 |
278 01f8 8F93 push r24 |
279 01fa 1F93 push r17 |
280 01fc 0F93 push r16 |
281 01fe 0995 icall |
282 0200 0F90 pop __tmp_reg__ |
283 0202 0F90 pop __tmp_reg__ |
284 0204 0F90 pop __tmp_reg__ |
285 0206 0F90 pop __tmp_reg__ |
286 .L69: |
287 0208 5298 cbi 42-0x20,2 |
288 020a 5A98 cbi 43-0x20,2 |
289 020c 0E94 0000 call SpektrumUartInit |
290 /* epilogue: frame size=0 */ |
291 0210 E5E0 ldi r30,5 |
292 0212 CDB7 in r28,__SP_L__ |
293 0214 DEB7 in r29,__SP_H__ |
294 0216 0C94 0000 jmp __epilogue_restores__+26 |
295 /* epilogue end (size=5) */ |
296 /* function SpektrumBinding size 178 (168) */ |
298 .lcomm Sync.0,1 |
299 .lcomm FrameCnt.1,1 |
300 .lcomm ByteHigh.2,1 |
301 .data |
304 ReSync.3: |
305 0000 01 .byte 1 |
306 .lcomm Frame2.4,1 |
307 .text |
308 .global SpektrumParser |
310 SpektrumParser: |
311 /* prologue: frame size=0 */ |
312 021a EF92 push r14 |
313 021c FF92 push r15 |
314 021e 0F93 push r16 |
315 0220 1F93 push r17 |
316 0222 CF93 push r28 |
317 0224 DF93 push r29 |
318 /* prologue end (size=6) */ |
319 0226 482F mov r20,r24 |
320 0228 00E0 ldi r16,lo8(0) |
321 022a 10E0 ldi r17,hi8(0) |
322 022c 8091 0000 lds r24,ReSync.3 |
323 0230 8130 cpi r24,lo8(1) |
324 0232 61F4 brne .L98 |
325 0234 1092 0000 sts ReSync.3,__zero_reg__ |
326 0238 84E4 ldi r24,lo8(68) |
327 023a 8093 0000 sts SpektrumTimer,r24 |
328 023e 1092 0000 sts FrameCnt.1,__zero_reg__ |
329 0242 1092 0000 sts Sync.0,__zero_reg__ |
330 0246 1092 0000 sts ByteHigh.2,__zero_reg__ |
331 024a 2BC1 rjmp .L97 |
332 .L98: |
333 024c 8091 0000 lds r24,SpektrumTimer |
334 0250 8823 tst r24 |
335 0252 19F4 brne .L100 |
336 0254 21E0 ldi r18,lo8(1) |
337 0256 30E0 ldi r19,hi8(1) |
338 0258 01C0 rjmp .L101 |
339 .L100: |
340 025a 9801 movw r18,r16 |
341 .L101: |
342 025c 9091 0000 lds r25,Sync.0 |
343 0260 9923 tst r25 |
344 0262 71F4 brne .L102 |
345 0264 232B or r18,r19 |
346 0266 11F0 breq .L103 |
347 0268 81E0 ldi r24,lo8(1) |
348 026a 10C0 rjmp .L138 |
349 .L103: |
350 026c 84E4 ldi r24,lo8(68) |
351 026e 8093 0000 sts SpektrumTimer,r24 |
352 0272 9093 0000 sts FrameCnt.1,r25 |
353 0276 9093 0000 sts Sync.0,r25 |
354 027a 9093 0000 sts ByteHigh.2,r25 |
355 027e FAC0 rjmp .L105 |
356 .L102: |
357 0280 9130 cpi r25,lo8(1) |
358 0282 69F4 brne .L106 |
359 0284 232B or r18,r19 |
360 0286 09F0 breq .+2 |
361 0288 EBC0 rjmp .L112 |
362 028a 82E0 ldi r24,lo8(2) |
363 .L138: |
364 028c 8093 0000 sts Sync.0,r24 |
365 0290 8091 0000 lds r24,FrameCnt.1 |
366 0294 8F5F subi r24,lo8(-(1)) |
367 0296 8093 0000 sts FrameCnt.1,r24 |
368 029a 83E0 ldi r24,lo8(3) |
369 029c E9C0 rjmp .L136 |
370 .L106: |
371 029e 9230 cpi r25,lo8(2) |
372 02a0 D1F4 brne .L108 |
373 02a2 232B or r18,r19 |
374 02a4 09F0 breq .+2 |
375 02a6 DCC0 rjmp .L112 |
376 02a8 83E0 ldi r24,lo8(3) |
377 02aa 8093 0000 sts SpektrumTimer,r24 |
378 02ae 4093 0000 sts ByteHigh.2,r20 |
379 02b2 9091 0000 lds r25,FrameCnt.1 |
380 02b6 9230 cpi r25,lo8(2) |
381 02b8 39F4 brne .L109 |
382 02ba 1092 0000 sts Frame2.4,__zero_reg__ |
383 02be 47FF sbrs r20,7 |
384 02c0 03C0 rjmp .L109 |
385 02c2 81E0 ldi r24,lo8(1) |
386 02c4 8093 0000 sts Frame2.4,r24 |
387 .L109: |
388 02c8 83E0 ldi r24,lo8(3) |
389 02ca 8093 0000 sts Sync.0,r24 |
390 02ce 9F5F subi r25,lo8(-(1)) |
391 02d0 9093 0000 sts FrameCnt.1,r25 |
392 02d4 CFC0 rjmp .L105 |
393 .L108: |
394 02d6 9330 cpi r25,lo8(3) |
395 02d8 09F0 breq .+2 |
396 02da C2C0 rjmp .L112 |
397 02dc 232B or r18,r19 |
398 02de 09F0 breq .+2 |
399 02e0 BFC0 rjmp .L112 |
400 02e2 9093 0000 sts SpektrumTimer,r25 |
401 02e6 82E0 ldi r24,lo8(2) |
402 02e8 8093 0000 sts Sync.0,r24 |
403 02ec 8091 0000 lds r24,FrameCnt.1 |
404 02f0 8F5F subi r24,lo8(-(1)) |
405 02f2 8093 0000 sts FrameCnt.1,r24 |
406 02f6 2091 0000 lds r18,ByteHigh.2 |
407 02fa 822F mov r24,r18 |
408 02fc 9927 clr r25 |
409 02fe 782F mov r23,r24 |
410 0300 6627 clr r22 |
411 0302 842F mov r24,r20 |
412 0304 9927 clr r25 |
413 0306 682B or r22,r24 |
414 0308 792B or r23,r25 |
415 030a 8091 0000 lds r24,EE_Parameter+39 |
416 030e 8130 cpi r24,lo8(1) |
417 0310 49F4 brne .L113 |
418 0312 7370 andi r23,hi8(1023) |
419 0314 CB01 movw r24,r22 |
420 0316 8050 subi r24,lo8(-(-512)) |
421 0318 9240 sbci r25,hi8(-(-512)) |
422 031a 63E0 ldi r22,lo8(3) |
423 031c 70E0 ldi r23,hi8(3) |
424 031e 0E94 0000 call __divmodhi4 |
425 0322 17C0 rjmp .L137 |
426 .L113: |
427 0324 8230 cpi r24,lo8(2) |
428 0326 61F4 brne .L115 |
429 0328 7770 andi r23,hi8(2047) |
430 032a CB01 movw r24,r22 |
431 032c 8050 subi r24,lo8(-(-1024)) |
432 032e 9440 sbci r25,hi8(-(-1024)) |
433 0330 66E0 ldi r22,lo8(6) |
434 0332 70E0 ldi r23,hi8(6) |
435 0334 0E94 0000 call __divmodhi4 |
436 0338 2695 lsr r18 |
437 033a 2695 lsr r18 |
438 033c 2695 lsr r18 |
439 033e 0BC0 rjmp .L135 |
440 .L115: |
441 0340 7370 andi r23,hi8(1023) |
442 0342 6856 subi r22,lo8(-(-360)) |
443 0344 7140 sbci r23,hi8(-(-360)) |
444 0346 CB01 movw r24,r22 |
445 0348 77FD sbrc r23,7 |
446 034a 0196 adiw r24,1 |
447 .L117: |
448 034c BC01 movw r22,r24 |
449 034e 7595 asr r23 |
450 0350 6795 ror r22 |
451 .L137: |
452 0352 2695 lsr r18 |
453 0354 2695 lsr r18 |
454 .L135: |
455 0356 022F mov r16,r18 |
456 0358 1127 clr r17 |
457 035a 0F70 andi r16,lo8(15) |
458 035c 1070 andi r17,hi8(15) |
459 035e 0F5F subi r16,lo8(-(1)) |
460 0360 1F4F sbci r17,hi8(-(1)) |
461 0362 0D30 cpi r16,13 |
462 0364 1105 cpc r17,__zero_reg__ |
463 0366 08F0 brlo .+2 |
464 0368 74C0 rjmp .L118 |
465 036a 7801 movw r14,r16 |
466 036c E00E add r14,r16 |
467 036e F11E adc r15,r17 |
468 0370 F701 movw r30,r14 |
469 0372 E050 subi r30,lo8(-(PPM_in)) |
470 0374 F040 sbci r31,hi8(-(PPM_in)) |
471 0376 8081 ld r24,Z |
472 0378 9181 ldd r25,Z+1 |
473 037a 9B01 movw r18,r22 |
474 037c 281B sub r18,r24 |
475 037e 390B sbc r19,r25 |
476 0380 C901 movw r24,r18 |
477 0382 37FF sbrs r19,7 |
478 0384 03C0 rjmp .L120 |
479 0386 9095 com r25 |
480 0388 8195 neg r24 |
481 038a 9F4F sbci r25,lo8(-1) |
482 .L120: |
483 038c 0697 sbiw r24,6 |
484 038e 94F4 brge .L119 |
485 0390 8091 0000 lds r24,SenderOkay |
486 0394 883C cpi r24,lo8(-56) |
487 0396 30F4 brsh .L121 |
488 0398 8091 0000 lds r24,SenderOkay |
489 039c 865F subi r24,lo8(-(10)) |
490 039e 8093 0000 sts SenderOkay,r24 |
491 03a2 08C0 rjmp .L119 |
492 .L121: |
493 03a4 88EC ldi r24,lo8(-56) |
494 03a6 8093 0000 sts SenderOkay,r24 |
495 03aa 8091 6F00 lds r24,111 |
496 03ae 8F7D andi r24,lo8(-33) |
497 03b0 8093 6F00 sts 111,r24 |
498 .L119: |
499 03b4 F701 movw r30,r14 |
500 03b6 E050 subi r30,lo8(-(PPM_in)) |
501 03b8 F040 sbci r31,hi8(-(PPM_in)) |
502 03ba 8081 ld r24,Z |
503 03bc 9181 ldd r25,Z+1 |
504 03be 9C01 movw r18,r24 |
505 03c0 220F lsl r18 |
506 03c2 331F rol r19 |
507 03c4 280F add r18,r24 |
508 03c6 391F adc r19,r25 |
509 03c8 260F add r18,r22 |
510 03ca 371F adc r19,r23 |
511 03cc 37FF sbrs r19,7 |
512 03ce 02C0 rjmp .L123 |
513 03d0 2D5F subi r18,lo8(-(3)) |
514 03d2 3F4F sbci r19,hi8(-(3)) |
515 .L123: |
516 03d4 E901 movw r28,r18 |
517 03d6 D595 asr r29 |
518 03d8 C795 ror r28 |
519 03da D595 asr r29 |
520 03dc C795 ror r28 |
521 03de CB01 movw r24,r22 |
522 03e0 0196 adiw r24,1 |
523 03e2 8C17 cp r24,r28 |
524 03e4 9D07 cpc r25,r29 |
525 03e6 14F4 brge .L124 |
526 03e8 2197 sbiw r28,1 |
527 03ea 06C0 rjmp .L125 |
528 .L124: |
529 03ec 6150 subi r22,lo8(-(-1)) |
530 03ee 7040 sbci r23,hi8(-(-1)) |
531 03f0 C617 cp r28,r22 |
532 03f2 D707 cpc r29,r23 |
533 03f4 0CF4 brge .L125 |
534 03f6 2196 adiw r28,1 |
535 .L125: |
536 03f8 8091 0000 lds r24,SenderOkay |
537 03fc 843B cpi r24,lo8(-76) |
538 03fe D0F0 brlo .L127 |
539 0400 F701 movw r30,r14 |
540 0402 E050 subi r30,lo8(-(PPM_in)) |
541 0404 F040 sbci r31,hi8(-(PPM_in)) |
542 0406 8081 ld r24,Z |
543 0408 9181 ldd r25,Z+1 |
544 040a FE01 movw r30,r28 |
545 040c E81B sub r30,r24 |
546 040e F90B sbc r31,r25 |
547 0410 CF01 movw r24,r30 |
548 0412 63E0 ldi r22,lo8(3) |
549 0414 70E0 ldi r23,hi8(3) |
550 0416 0E94 0000 call __divmodhi4 |
551 041a CB01 movw r24,r22 |
552 041c 880F lsl r24 |
553 041e 991F rol r25 |
554 0420 860F add r24,r22 |
555 0422 971F adc r25,r23 |
556 0424 20E0 ldi r18,lo8(PPM_diff) |
557 0426 30E0 ldi r19,hi8(PPM_diff) |
558 0428 E20E add r14,r18 |
559 042a F31E adc r15,r19 |
560 042c F701 movw r30,r14 |
561 042e 9183 std Z+1,r25 |
562 0430 8083 st Z,r24 |
563 0432 07C0 rjmp .L128 |
564 .L127: |
565 0434 20E0 ldi r18,lo8(PPM_diff) |
566 0436 30E0 ldi r19,hi8(PPM_diff) |
567 0438 E20E add r14,r18 |
568 043a F31E adc r15,r19 |
569 043c F701 movw r30,r14 |
570 043e 1182 std Z+1,__zero_reg__ |
571 0440 1082 st Z,__zero_reg__ |
572 .L128: |
573 0442 000F add r16,r16 |
574 0444 111F adc r17,r17 |
575 0446 0050 subi r16,lo8(-(PPM_in)) |
576 0448 1040 sbci r17,hi8(-(PPM_in)) |
577 044a F801 movw r30,r16 |
578 044c D183 std Z+1,r29 |
579 044e C083 st Z,r28 |
580 0450 11C0 rjmp .L105 |
581 .L118: |
582 0452 0231 cpi r16,18 |
583 0454 1105 cpc r17,__zero_reg__ |
584 0456 70F0 brlo .L105 |
585 0458 81E0 ldi r24,lo8(1) |
586 045a 8093 0000 sts ReSync.3,r24 |
587 045e 0AC0 rjmp .L105 |
588 .L112: |
589 0460 81E0 ldi r24,lo8(1) |
590 0462 8093 0000 sts ReSync.3,r24 |
591 0466 1092 0000 sts FrameCnt.1,__zero_reg__ |
592 046a 1092 0000 sts Frame2.4,__zero_reg__ |
593 046e 84E4 ldi r24,lo8(68) |
594 .L136: |
595 0470 8093 0000 sts SpektrumTimer,r24 |
596 .L105: |
597 0474 8091 0000 lds r24,FrameCnt.1 |
598 0478 8031 cpi r24,lo8(16) |
599 047a 98F0 brlo .L97 |
600 047c 8091 0000 lds r24,Frame2.4 |
601 0480 8823 tst r24 |
602 0482 31F4 brne .L133 |
603 0484 8091 0000 lds r24,ReSync.3 |
604 0488 8823 tst r24 |
605 048a 11F4 brne .L133 |
606 048c 8093 0000 sts NewPpmData,r24 |
607 .L133: |
608 0490 1092 0000 sts FrameCnt.1,__zero_reg__ |
609 0494 1092 0000 sts Frame2.4,__zero_reg__ |
610 0498 1092 0000 sts Sync.0,__zero_reg__ |
611 049c 84E4 ldi r24,lo8(68) |
612 049e 8093 0000 sts SpektrumTimer,r24 |
613 .L97: |
614 /* epilogue: frame size=0 */ |
615 04a2 E6E0 ldi r30,6 |
616 04a4 CDB7 in r28,__SP_L__ |
617 04a6 DEB7 in r29,__SP_H__ |
618 04a8 0C94 0000 jmp __epilogue_restores__+24 |
619 /* epilogue end (size=5) */ |
620 /* function SpektrumParser size 334 (323) */ |
622 /* File "Spektrum.c": code 604 = 0x025c ( 582), prologues 11, epilogues 11 */ |
DEFINED SYMBOLS |
*ABS*:00000000 Spektrum.c |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccUjdFTS.s:2 *ABS*:0000003f __SREG__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccUjdFTS.s:3 *ABS*:0000003e __SP_H__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccUjdFTS.s:4 *ABS*:0000003d __SP_L__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccUjdFTS.s:5 *ABS*:00000034 __CCP__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccUjdFTS.s:6 *ABS*:00000000 __tmp_reg__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccUjdFTS.s:7 *ABS*:00000001 __zero_reg__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccUjdFTS.s:11 .text:00000000 SpektrumUartInit |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccUjdFTS.s:81 .text:000000b0 SpektrumParser |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccUjdFTS.s:598 .data:00000000 ReSync.2382 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccUjdFTS.s:592 .bss:00000000 SpektrumTimer |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccUjdFTS.s:600 .bss:00000003 FrameCnt.2380 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccUjdFTS.s:601 .bss:00000004 Sync.2379 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccUjdFTS.s:594 .bss:00000002 ByteHigh.2381 |
.bss:00000001 Frame2.2383 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccUjdFTS.s:372 .text:0000031e SpektrumBinding |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccUjdFTS.s:614 .progmem.data:00000011 __c.2218 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccUjdFTS.s:610 .progmem.data:0000000b __c.2223 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccUjdFTS.s:606 .progmem.data:00000000 __c.2267 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIfbaaa.s:3 *ABS*:0000003f __SREG__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccIfbaaa.s:4 *ABS*:0000003e __SP_H__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccIfbaaa.s:5 *ABS*:0000003d __SP_L__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccIfbaaa.s:6 *ABS*:00000000 __tmp_reg__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccIfbaaa.s:7 *ABS*:00000001 __zero_reg__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccIfbaaa.s:15 .bss:00000000 SpektrumTimer |
C:\Users\Arthur-P\AppData\Local\Temp/ccIfbaaa.s:20 .text:00000000 SpektrumUartInit |
C:\Users\Arthur-P\AppData\Local\Temp/ccIfbaaa.s:94 .progmem.data:00000000 __c.5 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIfbaaa.s:98 .progmem.data:00000036 __c.6 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIfbaaa.s:102 .progmem.data:0000003c __c.7 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIfbaaa.s:107 .text:000000b6 SpektrumBinding |
.bss:00000001 Sync.0 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIfbaaa.s:298 .bss:00000002 FrameCnt.1 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIfbaaa.s:299 .bss:00000003 ByteHigh.2 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIfbaaa.s:304 .data:00000000 ReSync.3 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIfbaaa.s:300 .bss:00000004 Frame2.4 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIfbaaa.s:310 .text:0000021a SpektrumParser |
UNDEFINED SYMBOLS |
__do_copy_data |
__do_clear_bss |
SetDelay |
uart_putchar |
_printf_P |
CheckDelay |
__epilogue_restores__ |
EE_Parameter |
__divmodhi4 |
PPM_in |
634,9 → 645,3 |
SenderOkay |
PPM_diff |
NewPpmData |
SetDelay |
uart_putchar |
_printf_P |
CheckDelay |
__do_copy_data |
__do_clear_bss |
/branches/V0.80g-Arthur-P1/analog.lst |
---|
1,1237 → 1,1276 |
1 .file "analog.c" |
2 __SREG__ = 0x3f |
3 __SP_H__ = 0x3e |
4 __SP_L__ = 0x3d |
5 __CCP__ = 0x34 |
2 .arch atmega644p |
3 __SREG__ = 0x3f |
4 __SP_H__ = 0x3e |
5 __SP_L__ = 0x3d |
6 __tmp_reg__ = 0 |
7 __zero_reg__ = 1 |
8 .text |
9 .global ADC_Init |
11 ADC_Init: |
12 /* prologue: function */ |
13 /* frame size = 0 */ |
14 0000 1092 7C00 sts 124,__zero_reg__ |
15 0004 8FEC ldi r24,lo8(-49) |
16 0006 8093 7A00 sts 122,r24 |
17 /* epilogue start */ |
18 000a 0895 ret |
20 .global __vector_24 |
22 __vector_24: |
23 000c 1F92 push __zero_reg__ |
24 000e 0F92 push r0 |
25 0010 0FB6 in r0,__SREG__ |
26 0012 0F92 push r0 |
27 0014 1124 clr __zero_reg__ |
28 0016 6F92 push r6 |
29 0018 7F92 push r7 |
30 001a 8F92 push r8 |
31 001c 9F92 push r9 |
32 001e AF92 push r10 |
33 0020 BF92 push r11 |
34 0022 CF92 push r12 |
35 0024 DF92 push r13 |
36 0026 EF92 push r14 |
37 0028 FF92 push r15 |
38 002a 0F93 push r16 |
39 002c 1F93 push r17 |
40 002e 2F93 push r18 |
41 0030 3F93 push r19 |
42 0032 4F93 push r20 |
43 0034 5F93 push r21 |
44 0036 6F93 push r22 |
45 0038 7F93 push r23 |
46 003a 8F93 push r24 |
47 003c 9F93 push r25 |
48 003e AF93 push r26 |
49 0040 BF93 push r27 |
50 0042 EF93 push r30 |
51 0044 FF93 push r31 |
52 /* prologue: Signal */ |
53 /* frame size = 0 */ |
54 0046 8091 0000 lds r24,state.2325 |
55 004a 8F5F subi r24,lo8(-(1)) |
56 004c 8093 0000 sts state.2325,r24 |
57 0050 8150 subi r24,lo8(-(-1)) |
58 0052 E82F mov r30,r24 |
59 0054 F0E0 ldi r31,lo8(0) |
60 0056 E231 cpi r30,18 |
61 0058 F105 cpc r31,__zero_reg__ |
62 005a 00F0 brlo .+2 |
63 005c 00C0 rjmp .L4 |
64 005e E050 subi r30,lo8(-(gs(.L23))) |
65 0060 F040 sbci r31,hi8(-(gs(.L23))) |
66 0062 0C94 0000 jmp __tablejump2__ |
67 .data |
68 .section .progmem.gcc_sw_table, "a", @progbits |
69 .p2align 1 |
70 .L23: |
71 .data |
72 .section .progmem.gcc_sw_table, "a", @progbits |
73 .p2align 1 |
74 0000 0000 .word gs(.L5) |
75 0002 0000 .word gs(.L6) |
76 0004 0000 .word gs(.L7) |
77 0006 0000 .word gs(.L8) |
78 0008 0000 .word gs(.L9) |
79 000a 0000 .word gs(.L15) |
80 000c 0000 .word gs(.L11) |
81 000e 0000 .word gs(.L12) |
82 0010 0000 .word gs(.L13) |
83 0012 0000 .word gs(.L14) |
84 0014 0000 .word gs(.L15) |
85 0016 0000 .word gs(.L16) |
86 0018 0000 .word gs(.L17) |
87 001a 0000 .word gs(.L18) |
88 001c 0000 .word gs(.L19) |
89 001e 0000 .word gs(.L20) |
90 0020 0000 .word gs(.L21) |
91 0022 0000 .word gs(.L22) |
92 .text |
93 .L5: |
94 0066 8091 7800 lds r24,120 |
95 006a 9091 7900 lds r25,(120)+1 |
96 006e 9093 0000 sts (nick1.2329)+1,r25 |
97 0072 8093 0000 sts nick1.2329,r24 |
98 0076 00C0 rjmp .L45 |
99 .L6: |
100 0078 8091 7800 lds r24,120 |
101 007c 9091 7900 lds r25,(120)+1 |
102 0080 00C0 rjmp .L44 |
103 .L7: |
104 0082 8091 7800 lds r24,120 |
105 0086 9091 7900 lds r25,(120)+1 |
106 008a 9093 0000 sts (gier1.2327)+1,r25 |
107 008e 8093 0000 sts gier1.2327,r24 |
108 0092 00C0 rjmp .L46 |
109 .L8: |
110 0094 2091 7800 lds r18,120 |
111 0098 3091 7900 lds r19,(120)+1 |
112 009c 8091 0000 lds r24,NeutralAccY |
113 00a0 9091 0000 lds r25,(NeutralAccY)+1 |
114 00a4 821B sub r24,r18 |
115 00a6 930B sbc r25,r19 |
116 00a8 9093 0000 sts (Aktuell_ay)+1,r25 |
117 00ac 8093 0000 sts Aktuell_ay,r24 |
118 00b0 8091 0000 lds r24,Aktuell_ay |
119 00b4 9091 0000 lds r25,(Aktuell_ay)+1 |
120 00b8 9093 0000 sts (accy.2332)+1,r25 |
121 00bc 8093 0000 sts accy.2332,r24 |
122 00c0 00C0 rjmp .L47 |
123 .L9: |
124 00c2 8091 7800 lds r24,120 |
125 00c6 9091 7900 lds r25,(120)+1 |
126 00ca 2091 0000 lds r18,NeutralAccX |
127 00ce 3091 0000 lds r19,(NeutralAccX)+1 |
128 00d2 821B sub r24,r18 |
129 00d4 930B sbc r25,r19 |
130 00d6 9093 0000 sts (Aktuell_ax)+1,r25 |
131 00da 8093 0000 sts Aktuell_ax,r24 |
132 00de 8091 0000 lds r24,Aktuell_ax |
133 00e2 9091 0000 lds r25,(Aktuell_ax)+1 |
134 00e6 9093 0000 sts (accx.2333)+1,r25 |
135 00ea 8093 0000 sts accx.2333,r24 |
136 00ee 00C0 rjmp .L48 |
137 .L11: |
138 00f0 8091 7800 lds r24,120 |
139 00f4 9091 7900 lds r25,(120)+1 |
140 00f8 2091 0000 lds r18,roll1.2328 |
141 00fc 3091 0000 lds r19,(roll1.2328)+1 |
142 0100 280F add r18,r24 |
143 0102 391F adc r19,r25 |
144 0104 3093 0000 sts (roll1.2328)+1,r19 |
145 0108 2093 0000 sts roll1.2328,r18 |
146 010c 84E0 ldi r24,lo8(4) |
147 010e 00C0 rjmp .L43 |
148 .L12: |
149 0110 4091 0000 lds r20,UBat |
150 0114 5091 0000 lds r21,(UBat)+1 |
151 0118 8091 7800 lds r24,120 |
152 011c 9091 7900 lds r25,(120)+1 |
153 0120 9A01 movw r18,r20 |
154 0122 220F lsl r18 |
155 0124 331F rol r19 |
156 0126 240F add r18,r20 |
157 0128 351F adc r19,r21 |
158 012a 63E0 ldi r22,lo8(3) |
159 012c 70E0 ldi r23,hi8(3) |
160 012e 0E94 0000 call __udivmodhi4 |
161 0132 260F add r18,r22 |
162 0134 371F adc r19,r23 |
163 0136 3695 lsr r19 |
164 0138 2795 ror r18 |
165 013a 3695 lsr r19 |
166 013c 2795 ror r18 |
167 013e 3093 0000 sts (UBat)+1,r19 |
168 0142 2093 0000 sts UBat,r18 |
169 0146 85E0 ldi r24,lo8(5) |
170 0148 00C0 rjmp .L43 |
171 .L13: |
172 014a 8091 7800 lds r24,120 |
173 014e 9091 7900 lds r25,(120)+1 |
174 0152 4091 0000 lds r20,NeutralAccZ |
175 0156 5091 0000 lds r21,(NeutralAccZ)+1 |
176 015a 841B sub r24,r20 |
177 015c 950B sbc r25,r21 |
178 015e 9093 0000 sts (AdWertAccHoch)+1,r25 |
179 0162 8093 0000 sts AdWertAccHoch,r24 |
180 0166 8091 0000 lds r24,AdWertAccHoch |
181 016a 9091 0000 lds r25,(AdWertAccHoch)+1 |
182 016e 0297 sbiw r24,2 |
183 0170 04F0 brlt .L25 |
184 0172 22E0 ldi r18,hi8(750) |
185 0174 4E3E cpi r20,lo8(750) |
186 0176 5207 cpc r21,r18 |
187 0178 04F4 brge .L26 |
188 017a 2091 0000 lds r18,subcount.2326 |
189 017e 2B5F subi r18,lo8(-(5)) |
190 0180 2093 0000 sts subcount.2326,r18 |
191 0184 2550 subi r18,lo8(-(-5)) |
192 0186 8091 0000 lds r24,modell_fliegt |
193 018a 9091 0000 lds r25,(modell_fliegt)+1 |
194 018e 845F subi r24,lo8(500) |
195 0190 9140 sbci r25,hi8(500) |
196 0192 00F4 brsh .L26 |
197 0194 215F subi r18,lo8(-(15)) |
198 0196 2093 0000 sts subcount.2326,r18 |
199 .L26: |
200 019a 8091 0000 lds r24,subcount.2326 |
201 019e 8536 cpi r24,lo8(101) |
202 01a0 04F0 brlt .L27 |
203 01a2 4F5F subi r20,lo8(-(1)) |
204 01a4 5F4F sbci r21,hi8(-(1)) |
205 01a6 5093 0000 sts (NeutralAccZ)+1,r21 |
206 01aa 4093 0000 sts NeutralAccZ,r20 |
207 01ae 8456 subi r24,lo8(-(-100)) |
208 01b0 00C0 rjmp .L39 |
209 .L25: |
210 01b2 8091 0000 lds r24,AdWertAccHoch |
211 01b6 9091 0000 lds r25,(AdWertAccHoch)+1 |
212 01ba 8F5F subi r24,lo8(-1) |
213 01bc 9F4F sbci r25,hi8(-1) |
214 01be 04F4 brge .L27 |
215 01c0 B2E0 ldi r27,hi8(551) |
216 01c2 4732 cpi r20,lo8(551) |
217 01c4 5B07 cpc r21,r27 |
218 01c6 04F0 brlt .L27 |
219 01c8 2091 0000 lds r18,subcount.2326 |
220 01cc 2550 subi r18,lo8(-(-5)) |
221 01ce 2093 0000 sts subcount.2326,r18 |
222 01d2 2B5F subi r18,lo8(-(5)) |
223 01d4 8091 0000 lds r24,modell_fliegt |
224 01d8 9091 0000 lds r25,(modell_fliegt)+1 |
225 01dc 845F subi r24,lo8(500) |
226 01de 9140 sbci r25,hi8(500) |
227 01e0 00F4 brsh .L28 |
228 01e2 2F50 subi r18,lo8(-(-15)) |
229 01e4 2093 0000 sts subcount.2326,r18 |
230 .L28: |
231 01e8 8091 0000 lds r24,subcount.2326 |
232 01ec 8C39 cpi r24,lo8(-100) |
233 01ee 04F4 brge .L27 |
234 01f0 4150 subi r20,lo8(-(-1)) |
235 01f2 5040 sbci r21,hi8(-(-1)) |
236 01f4 5093 0000 sts (NeutralAccZ)+1,r21 |
237 01f8 4093 0000 sts NeutralAccZ,r20 |
238 01fc 8C59 subi r24,lo8(-(100)) |
239 .L39: |
240 01fe 8093 0000 sts subcount.2326,r24 |
241 .L27: |
242 0202 81E0 ldi r24,lo8(1) |
243 0204 8093 0000 sts messanzahl_AccHoch,r24 |
244 0208 8091 7800 lds r24,120 |
245 020c 9091 7900 lds r25,(120)+1 |
246 0210 9093 0000 sts (Aktuell_az)+1,r25 |
247 0214 8093 0000 sts Aktuell_az,r24 |
248 0218 2091 0000 lds r18,Mess_Integral_Hoch |
249 021c 3091 0000 lds r19,(Mess_Integral_Hoch)+1 |
250 0220 4091 0000 lds r20,(Mess_Integral_Hoch)+2 |
251 0224 5091 0000 lds r21,(Mess_Integral_Hoch)+3 |
252 0228 8091 0000 lds r24,AdWertAccHoch |
253 022c 9091 0000 lds r25,(AdWertAccHoch)+1 |
254 0230 AA27 clr r26 |
255 0232 97FD sbrc r25,7 |
256 0234 A095 com r26 |
257 0236 BA2F mov r27,r26 |
258 0238 820F add r24,r18 |
259 023a 931F adc r25,r19 |
260 023c A41F adc r26,r20 |
261 023e B51F adc r27,r21 |
262 0240 8093 0000 sts Mess_Integral_Hoch,r24 |
263 0244 9093 0000 sts (Mess_Integral_Hoch)+1,r25 |
264 0248 A093 0000 sts (Mess_Integral_Hoch)+2,r26 |
265 024c B093 0000 sts (Mess_Integral_Hoch)+3,r27 |
266 0250 E090 0000 lds r14,Mess_Integral_Hoch |
267 0254 F090 0000 lds r15,(Mess_Integral_Hoch)+1 |
268 0258 0091 0000 lds r16,(Mess_Integral_Hoch)+2 |
269 025c 1091 0000 lds r17,(Mess_Integral_Hoch)+3 |
270 0260 6091 0000 lds r22,Mess_Integral_Hoch |
271 0264 7091 0000 lds r23,(Mess_Integral_Hoch)+1 |
272 0268 8091 0000 lds r24,(Mess_Integral_Hoch)+2 |
273 026c 9091 0000 lds r25,(Mess_Integral_Hoch)+3 |
274 0270 20E0 ldi r18,lo8(1024) |
275 0272 34E0 ldi r19,hi8(1024) |
276 0274 40E0 ldi r20,hlo8(1024) |
277 0276 50E0 ldi r21,hhi8(1024) |
278 0278 0E94 0000 call __divmodsi4 |
279 027c E21A sub r14,r18 |
280 027e F30A sbc r15,r19 |
281 0280 040B sbc r16,r20 |
282 0282 150B sbc r17,r21 |
283 0284 E092 0000 sts Mess_Integral_Hoch,r14 |
284 0288 F092 0000 sts (Mess_Integral_Hoch)+1,r15 |
285 028c 0093 0000 sts (Mess_Integral_Hoch)+2,r16 |
286 0290 1093 0000 sts (Mess_Integral_Hoch)+3,r17 |
287 0294 00C0 rjmp .L49 |
288 .L15: |
289 0296 8091 7800 lds r24,120 |
290 029a 9091 7900 lds r25,(120)+1 |
291 029e 2091 0000 lds r18,nick1.2329 |
292 02a2 3091 0000 lds r19,(nick1.2329)+1 |
293 02a6 280F add r18,r24 |
294 02a8 391F adc r19,r25 |
295 02aa 3093 0000 sts (nick1.2329)+1,r19 |
296 02ae 2093 0000 sts nick1.2329,r18 |
297 02b2 00C0 rjmp .L45 |
298 .L16: |
299 02b4 2091 7800 lds r18,120 |
300 02b8 3091 7900 lds r19,(120)+1 |
301 02bc 8091 0000 lds r24,roll1.2328 |
302 02c0 9091 0000 lds r25,(roll1.2328)+1 |
303 02c4 820F add r24,r18 |
304 02c6 931F adc r25,r19 |
305 .L44: |
306 02c8 9093 0000 sts (roll1.2328)+1,r25 |
307 02cc 8093 0000 sts roll1.2328,r24 |
308 02d0 1092 0000 sts kanal.2324,__zero_reg__ |
309 02d4 00C0 rjmp .L24 |
310 .L17: |
311 02d6 8091 0000 lds r24,PlatinenVersion |
312 02da 8A30 cpi r24,lo8(10) |
313 02dc 01F4 brne .L29 |
314 02de 8091 7800 lds r24,120 |
315 02e2 9091 7900 lds r25,(120)+1 |
316 02e6 0196 adiw r24,1 |
317 02e8 2091 0000 lds r18,gier1.2327 |
318 02ec 3091 0000 lds r19,(gier1.2327)+1 |
319 02f0 820F add r24,r18 |
320 02f2 931F adc r25,r19 |
321 02f4 9695 lsr r25 |
322 02f6 8795 ror r24 |
323 02f8 00C0 rjmp .L40 |
324 .L29: |
325 02fa 4091 0000 lds r20,gier1.2327 |
326 02fe 5091 0000 lds r21,(gier1.2327)+1 |
327 0302 8431 cpi r24,lo8(20) |
328 0304 00F0 brlo .L31 |
329 0306 2091 7800 lds r18,120 |
330 030a 3091 7900 lds r19,(120)+1 |
331 030e 8FEF ldi r24,lo8(2047) |
332 0310 97E0 ldi r25,hi8(2047) |
333 0312 821B sub r24,r18 |
334 0314 930B sbc r25,r19 |
335 0316 841B sub r24,r20 |
336 0318 950B sbc r25,r21 |
337 031a 00C0 rjmp .L40 |
338 .L31: |
339 031c 8091 7800 lds r24,120 |
340 0320 9091 7900 lds r25,(120)+1 |
341 0324 840F add r24,r20 |
342 0326 951F adc r25,r21 |
343 .L40: |
344 0328 9093 0000 sts (AdWertGier)+1,r25 |
345 032c 8093 0000 sts AdWertGier,r24 |
346 .L46: |
347 0330 86E0 ldi r24,lo8(6) |
348 0332 00C0 rjmp .L43 |
349 .L18: |
350 0334 2091 7800 lds r18,120 |
351 0338 3091 7900 lds r19,(120)+1 |
352 033c 8091 0000 lds r24,NeutralAccY |
353 0340 9091 0000 lds r25,(NeutralAccY)+1 |
354 0344 821B sub r24,r18 |
355 0346 930B sbc r25,r19 |
356 0348 9093 0000 sts (Aktuell_ay)+1,r25 |
357 034c 8093 0000 sts Aktuell_ay,r24 |
358 0350 8091 0000 lds r24,Aktuell_ay |
359 0354 9091 0000 lds r25,(Aktuell_ay)+1 |
360 0358 2091 0000 lds r18,accy.2332 |
361 035c 3091 0000 lds r19,(accy.2332)+1 |
362 0360 820F add r24,r18 |
363 0362 931F adc r25,r19 |
364 0364 9093 0000 sts (AdWertAccRoll)+1,r25 |
365 0368 8093 0000 sts AdWertAccRoll,r24 |
366 .L47: |
367 036c 87E0 ldi r24,lo8(7) |
368 036e 00C0 rjmp .L43 |
369 .L19: |
370 0370 8091 7800 lds r24,120 |
371 0374 9091 7900 lds r25,(120)+1 |
372 0378 2091 0000 lds r18,NeutralAccX |
373 037c 3091 0000 lds r19,(NeutralAccX)+1 |
374 0380 821B sub r24,r18 |
375 0382 930B sbc r25,r19 |
376 0384 9093 0000 sts (Aktuell_ax)+1,r25 |
377 0388 8093 0000 sts Aktuell_ax,r24 |
378 038c 8091 0000 lds r24,Aktuell_ax |
379 0390 9091 0000 lds r25,(Aktuell_ax)+1 |
380 0394 2091 0000 lds r18,accx.2333 |
381 0398 3091 0000 lds r19,(accx.2333)+1 |
382 039c 820F add r24,r18 |
383 039e 931F adc r25,r19 |
384 03a0 9093 0000 sts (AdWertAccNick)+1,r25 |
385 03a4 8093 0000 sts AdWertAccNick,r24 |
386 03a8 00C0 rjmp .L48 |
387 .L20: |
388 03aa 2091 7800 lds r18,120 |
389 03ae 3091 7900 lds r19,(120)+1 |
390 03b2 8091 0000 lds r24,nick1.2329 |
391 03b6 9091 0000 lds r25,(nick1.2329)+1 |
392 03ba 280F add r18,r24 |
393 03bc 391F adc r19,r25 |
394 03be 8091 0000 lds r24,PlatinenVersion |
395 03c2 8A30 cpi r24,lo8(10) |
396 03c4 01F4 brne .L32 |
397 03c6 220F lsl r18 |
398 03c8 331F rol r19 |
399 03ca 00C0 rjmp .L41 |
400 .L32: |
401 03cc 220F lsl r18 |
402 03ce 331F rol r19 |
403 03d0 220F lsl r18 |
404 03d2 331F rol r19 |
405 .L41: |
406 03d4 3093 0000 sts (nick1.2329)+1,r19 |
407 03d8 2093 0000 sts nick1.2329,r18 |
408 03dc 2091 0000 lds r18,nick1.2329 |
409 03e0 3091 0000 lds r19,(nick1.2329)+1 |
410 03e4 C901 movw r24,r18 |
411 03e6 68E0 ldi r22,lo8(8) |
412 03e8 70E0 ldi r23,hi8(8) |
413 03ea 0E94 0000 call __divmodhi4 |
414 03ee 7093 0000 sts (AdWertNick)+1,r23 |
415 03f2 6093 0000 sts AdWertNick,r22 |
416 03f6 8091 0000 lds r24,nick_filter.2330 |
417 03fa 9091 0000 lds r25,(nick_filter.2330)+1 |
418 03fe 820F add r24,r18 |
419 0400 931F adc r25,r19 |
420 0402 62E0 ldi r22,lo8(2) |
421 0404 70E0 ldi r23,hi8(2) |
422 0406 0E94 0000 call __divmodhi4 |
423 040a CB01 movw r24,r22 |
424 040c 7093 0000 sts (nick_filter.2330)+1,r23 |
425 0410 6093 0000 sts nick_filter.2330,r22 |
426 0414 2091 0000 lds r18,AdNeutralNick |
427 0418 3091 0000 lds r19,(AdNeutralNick)+1 |
428 041c 821B sub r24,r18 |
429 041e 930B sbc r25,r19 |
430 0420 9093 0000 sts (HiResNick)+1,r25 |
431 0424 8093 0000 sts HiResNick,r24 |
432 0428 2091 0000 lds r18,AdWertNickFilter |
433 042c 3091 0000 lds r19,(AdWertNickFilter)+1 |
434 0430 8091 0000 lds r24,HiResNick |
435 0434 9091 0000 lds r25,(HiResNick)+1 |
436 0438 820F add r24,r18 |
437 043a 931F adc r25,r19 |
438 043c 62E0 ldi r22,lo8(2) |
439 043e 70E0 ldi r23,hi8(2) |
440 0440 0E94 0000 call __divmodhi4 |
441 0444 7093 0000 sts (AdWertNickFilter)+1,r23 |
442 0448 6093 0000 sts AdWertNickFilter,r22 |
443 .L45: |
444 044c 81E0 ldi r24,lo8(1) |
445 044e 00C0 rjmp .L43 |
446 .L21: |
447 0450 2091 7800 lds r18,120 |
448 0454 3091 7900 lds r19,(120)+1 |
449 0458 8091 0000 lds r24,roll1.2328 |
450 045c 9091 0000 lds r25,(roll1.2328)+1 |
451 0460 280F add r18,r24 |
452 0462 391F adc r19,r25 |
453 0464 8091 0000 lds r24,PlatinenVersion |
454 0468 8A30 cpi r24,lo8(10) |
455 046a 01F4 brne .L34 |
456 046c 220F lsl r18 |
457 046e 331F rol r19 |
458 0470 00C0 rjmp .L42 |
459 .L34: |
460 0472 220F lsl r18 |
461 0474 331F rol r19 |
462 0476 220F lsl r18 |
463 0478 331F rol r19 |
464 .L42: |
465 047a 3093 0000 sts (roll1.2328)+1,r19 |
466 047e 2093 0000 sts roll1.2328,r18 |
467 0482 2091 0000 lds r18,roll1.2328 |
468 0486 3091 0000 lds r19,(roll1.2328)+1 |
469 048a C901 movw r24,r18 |
470 048c 68E0 ldi r22,lo8(8) |
471 048e 70E0 ldi r23,hi8(8) |
472 0490 0E94 0000 call __divmodhi4 |
473 0494 7093 0000 sts (AdWertRoll)+1,r23 |
474 0498 6093 0000 sts AdWertRoll,r22 |
475 049c 8091 0000 lds r24,roll_filter.2331 |
476 04a0 9091 0000 lds r25,(roll_filter.2331)+1 |
477 04a4 820F add r24,r18 |
478 04a6 931F adc r25,r19 |
479 04a8 62E0 ldi r22,lo8(2) |
480 04aa 70E0 ldi r23,hi8(2) |
481 04ac 0E94 0000 call __divmodhi4 |
482 04b0 CB01 movw r24,r22 |
483 04b2 7093 0000 sts (roll_filter.2331)+1,r23 |
484 04b6 6093 0000 sts roll_filter.2331,r22 |
485 04ba 2091 0000 lds r18,AdNeutralRoll |
486 04be 3091 0000 lds r19,(AdNeutralRoll)+1 |
487 04c2 821B sub r24,r18 |
488 04c4 930B sbc r25,r19 |
489 04c6 9093 0000 sts (HiResRoll)+1,r25 |
490 04ca 8093 0000 sts HiResRoll,r24 |
491 04ce 2091 0000 lds r18,AdWertRollFilter |
492 04d2 3091 0000 lds r19,(AdWertRollFilter)+1 |
493 04d6 8091 0000 lds r24,HiResRoll |
494 04da 9091 0000 lds r25,(HiResRoll)+1 |
495 04de 820F add r24,r18 |
496 04e0 931F adc r25,r19 |
497 04e2 62E0 ldi r22,lo8(2) |
498 04e4 70E0 ldi r23,hi8(2) |
499 04e6 0E94 0000 call __divmodhi4 |
500 04ea 7093 0000 sts (AdWertRollFilter)+1,r23 |
501 04ee 6093 0000 sts AdWertRollFilter,r22 |
502 .L49: |
503 04f2 83E0 ldi r24,lo8(3) |
504 04f4 00C0 rjmp .L43 |
505 .L22: |
506 04f6 1092 0000 sts state.2325,__zero_reg__ |
507 04fa 81E0 ldi r24,lo8(1) |
508 04fc 8093 0000 sts AdReady,r24 |
509 0500 8091 0000 lds r24,ZaehlMessungen |
510 0504 9091 0000 lds r25,(ZaehlMessungen)+1 |
511 0508 0196 adiw r24,1 |
512 050a 9093 0000 sts (ZaehlMessungen)+1,r25 |
513 050e 8093 0000 sts ZaehlMessungen,r24 |
514 .L14: |
515 0512 8091 7800 lds r24,120 |
516 0516 9091 7900 lds r25,(120)+1 |
517 051a 9093 0000 sts (MessLuftdruck)+1,r25 |
518 051e 8093 0000 sts MessLuftdruck,r24 |
519 0522 8091 0000 lds r24,MessLuftdruck |
520 0526 9091 0000 lds r25,(MessLuftdruck)+1 |
521 052a 3C01 movw r6,r24 |
522 052c 8824 clr r8 |
523 052e 9924 clr r9 |
524 0530 8091 0000 lds r24,tmpLuftdruck.2334 |
525 0534 9091 0000 lds r25,(tmpLuftdruck.2334)+1 |
526 0538 A091 0000 lds r26,(tmpLuftdruck.2334)+2 |
527 053c B091 0000 lds r27,(tmpLuftdruck.2334)+3 |
528 0540 680E add r6,r24 |
529 0542 791E adc r7,r25 |
530 0544 8A1E adc r8,r26 |
531 0546 9B1E adc r9,r27 |
532 0548 6092 0000 sts tmpLuftdruck.2334,r6 |
533 054c 7092 0000 sts (tmpLuftdruck.2334)+1,r7 |
534 0550 8092 0000 sts (tmpLuftdruck.2334)+2,r8 |
535 0554 9092 0000 sts (tmpLuftdruck.2334)+3,r9 |
536 0558 8091 0000 lds r24,messanzahl_Druck.2335 |
537 055c 8F5F subi r24,lo8(-(1)) |
538 055e 8093 0000 sts messanzahl_Druck.2335,r24 |
539 0562 8231 cpi r24,lo8(18) |
540 0564 00F4 brsh .+2 |
541 0566 00C0 rjmp .L48 |
542 0568 8091 0000 lds r24,Luftdruck |
543 056c 9091 0000 lds r25,(Luftdruck)+1 |
544 0570 A091 0000 lds r26,(Luftdruck)+2 |
545 0574 B091 0000 lds r27,(Luftdruck)+3 |
546 0578 7C01 movw r14,r24 |
547 057a 8D01 movw r16,r26 |
548 057c 43E0 ldi r20,3 |
549 057e EE0C 1: lsl r14 |
550 0580 FF1C rol r15 |
551 0582 001F rol r16 |
552 0584 111F rol r17 |
553 0586 4A95 dec r20 |
554 0588 01F4 brne 1b |
555 058a E81A sub r14,r24 |
556 058c F90A sbc r15,r25 |
557 058e 0A0B sbc r16,r26 |
558 0590 1B0B sbc r17,r27 |
559 0592 84E0 ldi r24,lo8(4) |
560 0594 90E0 ldi r25,hi8(4) |
561 0596 A0E0 ldi r26,hlo8(4) |
562 0598 B0E0 ldi r27,hhi8(4) |
563 059a E80E add r14,r24 |
564 059c F91E adc r15,r25 |
565 059e 0A1F adc r16,r26 |
566 05a0 1B1F adc r17,r27 |
567 05a2 E60C add r14,r6 |
568 05a4 F71C adc r15,r7 |
569 05a6 081D adc r16,r8 |
570 05a8 191D adc r17,r9 |
571 05aa 6091 0000 lds r22,ExpandBaro |
572 05ae 7727 clr r23 |
573 05b0 67FD sbrc r22,7 |
574 05b2 7095 com r23 |
575 05b4 872F mov r24,r23 |
576 05b6 972F mov r25,r23 |
577 05b8 2AE3 ldi r18,lo8(-9414) |
578 05ba 3BED ldi r19,hi8(-9414) |
579 05bc 4FEF ldi r20,hlo8(-9414) |
580 05be 5FEF ldi r21,hhi8(-9414) |
581 05c0 0E94 0000 call __mulsi3 |
582 05c4 E60E add r14,r22 |
583 05c6 F71E adc r15,r23 |
584 05c8 081F adc r16,r24 |
585 05ca 191F adc r17,r25 |
586 05cc C801 movw r24,r16 |
587 05ce B701 movw r22,r14 |
588 05d0 28E0 ldi r18,lo8(8) |
589 05d2 30E0 ldi r19,hi8(8) |
590 05d4 40E0 ldi r20,hlo8(8) |
591 05d6 50E0 ldi r21,hhi8(8) |
592 05d8 0E94 0000 call __divmodsi4 |
593 05dc C901 movw r24,r18 |
594 05de DA01 movw r26,r20 |
595 05e0 8093 0000 sts Luftdruck,r24 |
596 05e4 9093 0000 sts (Luftdruck)+1,r25 |
597 05e8 A093 0000 sts (Luftdruck)+2,r26 |
598 05ec B093 0000 sts (Luftdruck)+3,r27 |
599 05f0 E090 0000 lds r14,StartLuftdruck |
600 05f4 F090 0000 lds r15,(StartLuftdruck)+1 |
601 05f8 8091 0000 lds r24,Luftdruck |
602 05fc 9091 0000 lds r25,(Luftdruck)+1 |
603 0600 A091 0000 lds r26,(Luftdruck)+2 |
604 0604 B091 0000 lds r27,(Luftdruck)+3 |
605 0608 0027 clr r16 |
606 060a F7FC sbrc r15,7 |
607 060c 0095 com r16 |
608 060e 102F mov r17,r16 |
609 0610 E81A sub r14,r24 |
610 0612 F90A sbc r15,r25 |
611 0614 0A0B sbc r16,r26 |
612 0616 1B0B sbc r17,r27 |
613 0618 E092 0000 sts HoehenWert,r14 |
614 061c F092 0000 sts (HoehenWert)+1,r15 |
615 0620 0093 0000 sts (HoehenWert)+2,r16 |
616 0624 1093 0000 sts (HoehenWert)+3,r17 |
617 0628 A090 0000 lds r10,SummenHoehe |
618 062c B090 0000 lds r11,(SummenHoehe)+1 |
619 0630 C090 0000 lds r12,(SummenHoehe)+2 |
620 0634 D090 0000 lds r13,(SummenHoehe)+3 |
621 0638 6091 0000 lds r22,SummenHoehe |
622 063c 7091 0000 lds r23,(SummenHoehe)+1 |
623 0640 8091 0000 lds r24,(SummenHoehe)+2 |
624 0644 9091 0000 lds r25,(SummenHoehe)+3 |
625 0648 20E1 ldi r18,lo8(16) |
626 064a 30E0 ldi r19,hi8(16) |
627 064c 40E0 ldi r20,hlo8(16) |
628 064e 50E0 ldi r21,hhi8(16) |
629 0650 0E94 0000 call __divmodsi4 |
630 0654 A21A sub r10,r18 |
631 0656 B30A sbc r11,r19 |
632 0658 C40A sbc r12,r20 |
633 065a D50A sbc r13,r21 |
634 065c A092 0000 sts SummenHoehe,r10 |
635 0660 B092 0000 sts (SummenHoehe)+1,r11 |
636 0664 C092 0000 sts (SummenHoehe)+2,r12 |
637 0668 D092 0000 sts (SummenHoehe)+3,r13 |
638 066c 8091 0000 lds r24,SummenHoehe |
639 0670 9091 0000 lds r25,(SummenHoehe)+1 |
640 0674 A091 0000 lds r26,(SummenHoehe)+2 |
641 0678 B091 0000 lds r27,(SummenHoehe)+3 |
642 067c 8E0D add r24,r14 |
643 067e 9F1D adc r25,r15 |
644 0680 A01F adc r26,r16 |
645 0682 B11F adc r27,r17 |
646 0684 8093 0000 sts SummenHoehe,r24 |
647 0688 9093 0000 sts (SummenHoehe)+1,r25 |
648 068c A093 0000 sts (SummenHoehe)+2,r26 |
649 0690 B093 0000 sts (SummenHoehe)+3,r27 |
650 0694 C090 0000 lds r12,VarioMeter |
651 0698 D090 0000 lds r13,(VarioMeter)+1 |
652 069c 6091 0000 lds r22,SummenHoehe |
653 06a0 7091 0000 lds r23,(SummenHoehe)+1 |
654 06a4 8091 0000 lds r24,(SummenHoehe)+2 |
655 06a8 9091 0000 lds r25,(SummenHoehe)+3 |
656 06ac 20E1 ldi r18,lo8(16) |
657 06ae 30E0 ldi r19,hi8(16) |
658 06b0 40E0 ldi r20,hlo8(16) |
659 06b2 50E0 ldi r21,hhi8(16) |
660 06b4 0E94 0000 call __divmodsi4 |
661 06b8 5095 com r21 |
662 06ba 4095 com r20 |
663 06bc 3095 com r19 |
664 06be 2195 neg r18 |
665 06c0 3F4F sbci r19,lo8(-1) |
666 06c2 4F4F sbci r20,lo8(-1) |
667 06c4 5F4F sbci r21,lo8(-1) |
668 06c6 E20E add r14,r18 |
669 06c8 F31E adc r15,r19 |
670 06ca 33E0 ldi r19,3 |
671 06cc EE0C 1: lsl r14 |
672 06ce FF1C rol r15 |
673 06d0 3A95 dec r19 |
674 06d2 01F4 brne 1b |
675 06d4 C601 movw r24,r12 |
676 06d6 25E0 ldi r18,5 |
677 06d8 880F 1: lsl r24 |
678 06da 991F rol r25 |
679 06dc 2A95 dec r18 |
680 06de 01F4 brne 1b |
681 06e0 8C19 sub r24,r12 |
682 06e2 9D09 sbc r25,r13 |
683 06e4 8E0D add r24,r14 |
684 06e6 9F1D adc r25,r15 |
685 06e8 60E2 ldi r22,lo8(32) |
686 06ea 70E0 ldi r23,hi8(32) |
687 06ec 0E94 0000 call __divmodhi4 |
688 06f0 7093 0000 sts (VarioMeter)+1,r23 |
689 06f4 6093 0000 sts VarioMeter,r22 |
690 06f8 C401 movw r24,r8 |
691 06fa B301 movw r22,r6 |
692 06fc 22E0 ldi r18,lo8(2) |
693 06fe 30E0 ldi r19,hi8(2) |
694 0700 40E0 ldi r20,hlo8(2) |
695 0702 50E0 ldi r21,hhi8(2) |
696 0704 0E94 0000 call __divmodsi4 |
697 0708 2093 0000 sts tmpLuftdruck.2334,r18 |
698 070c 3093 0000 sts (tmpLuftdruck.2334)+1,r19 |
699 0710 4093 0000 sts (tmpLuftdruck.2334)+2,r20 |
700 0714 5093 0000 sts (tmpLuftdruck.2334)+3,r21 |
701 0718 89E0 ldi r24,lo8(9) |
702 071a 8093 0000 sts messanzahl_Druck.2335,r24 |
703 071e 00C0 rjmp .L48 |
704 .L4: |
705 0720 1092 0000 sts state.2325,__zero_reg__ |
706 .L48: |
707 0724 82E0 ldi r24,lo8(2) |
708 .L43: |
709 0726 8093 0000 sts kanal.2324,r24 |
710 .L24: |
711 072a 8091 0000 lds r24,kanal.2324 |
712 072e 8093 7C00 sts 124,r24 |
713 0732 8091 0000 lds r24,state.2325 |
714 0736 8823 tst r24 |
715 0738 01F0 breq .L38 |
716 073a 8FEC ldi r24,lo8(-49) |
717 073c 8093 7A00 sts 122,r24 |
718 .L38: |
719 /* epilogue start */ |
720 0740 FF91 pop r31 |
721 0742 EF91 pop r30 |
722 0744 BF91 pop r27 |
723 0746 AF91 pop r26 |
724 0748 9F91 pop r25 |
725 074a 8F91 pop r24 |
726 074c 7F91 pop r23 |
727 074e 6F91 pop r22 |
728 0750 5F91 pop r21 |
729 0752 4F91 pop r20 |
730 0754 3F91 pop r19 |
731 0756 2F91 pop r18 |
732 0758 1F91 pop r17 |
733 075a 0F91 pop r16 |
734 075c FF90 pop r15 |
735 075e EF90 pop r14 |
736 0760 DF90 pop r13 |
737 0762 CF90 pop r12 |
738 0764 BF90 pop r11 |
739 0766 AF90 pop r10 |
740 0768 9F90 pop r9 |
741 076a 8F90 pop r8 |
742 076c 7F90 pop r7 |
743 076e 6F90 pop r6 |
744 0770 0F90 pop r0 |
745 0772 0FBE out __SREG__,r0 |
746 0774 0F90 pop r0 |
747 0776 1F90 pop __zero_reg__ |
748 0778 1895 reti |
750 .global SucheGyroOffset |
752 SucheGyroOffset: |
753 077a A0E0 ldi r26,lo8(0) |
754 077c B0E0 ldi r27,hi8(0) |
755 077e E0E0 ldi r30,lo8(gs(1f)) |
756 0780 F0E0 ldi r31,hi8(gs(1f)) |
757 0782 0C94 0000 jmp __prologue_saves__+((18 - 13) * 2) |
758 1: |
759 /* prologue: function */ |
760 /* frame size = 0 */ |
761 0786 80ED ldi r24,lo8(2000) |
762 0788 97E0 ldi r25,hi8(2000) |
763 078a 0E94 0000 call SetDelay |
764 078e EC01 movw r28,r24 |
765 0790 0CE8 ldi r16,lo8(-116) |
766 0792 52E1 ldi r21,lo8(18) |
767 0794 752E mov r7,r21 |
768 0796 45EA ldi r20,lo8(-91) |
769 0798 842E mov r8,r20 |
770 079a 3AE0 ldi r19,lo8(10) |
771 079c E32E mov r14,r19 |
772 079e 25EF ldi r18,lo8(-11) |
773 07a0 F22E mov r15,r18 |
774 07a2 90E0 ldi r25,lo8(gs(uart_putchar)) |
775 07a4 A92E mov r10,r25 |
776 07a6 90E0 ldi r25,hi8(gs(uart_putchar)) |
777 07a8 B92E mov r11,r25 |
778 07aa 80E0 ldi r24,lo8(__c.2279) |
779 07ac C82E mov r12,r24 |
780 07ae 80E0 ldi r24,hi8(__c.2279) |
781 07b0 D82E mov r13,r24 |
782 07b2 1FEC ldi r17,lo8(-49) |
783 07b4 912E mov r9,r17 |
784 07b6 00C0 rjmp .L78 |
785 .L71: |
786 07b8 1330 cpi r17,lo8(3) |
787 07ba 01F4 brne .L78 |
788 07bc 0B30 cpi r16,lo8(11) |
789 07be 00F0 brlo .L78 |
790 07c0 09E0 ldi r16,lo8(9) |
791 .L78: |
792 07c2 8091 0000 lds r24,AdWertNick |
793 07c6 9091 0000 lds r25,(AdWertNick)+1 |
794 07ca 8C5F subi r24,lo8(1020) |
795 07cc 9340 sbci r25,hi8(1020) |
796 07ce 04F4 brge .L52 |
797 07d0 8091 0000 lds r24,AnalogOffsetNick |
798 07d4 8150 subi r24,lo8(-(-1)) |
799 07d6 00C0 rjmp .L79 |
800 .L52: |
801 07d8 8091 0000 lds r24,AdWertNick |
802 07dc 9091 0000 lds r25,(AdWertNick)+1 |
803 07e0 8750 subi r24,lo8(1031) |
804 07e2 9440 sbci r25,hi8(1031) |
805 07e4 04F4 brge .L54 |
806 07e6 11E0 ldi r17,lo8(1) |
807 07e8 00C0 rjmp .L53 |
808 .L54: |
809 07ea 8091 0000 lds r24,AnalogOffsetNick |
810 07ee 8F5F subi r24,lo8(-(1)) |
811 .L79: |
812 07f0 8093 0000 sts AnalogOffsetNick,r24 |
813 07f4 10E0 ldi r17,lo8(0) |
814 .L53: |
815 07f6 8091 0000 lds r24,AdWertRoll |
816 07fa 9091 0000 lds r25,(AdWertRoll)+1 |
817 07fe 8C5F subi r24,lo8(1020) |
818 0800 9340 sbci r25,hi8(1020) |
819 0802 04F4 brge .L55 |
820 0804 8091 0000 lds r24,AnalogOffsetRoll |
821 0808 8150 subi r24,lo8(-(-1)) |
822 080a 00C0 rjmp .L80 |
823 .L55: |
824 080c 8091 0000 lds r24,AdWertRoll |
825 0810 9091 0000 lds r25,(AdWertRoll)+1 |
826 0814 8750 subi r24,lo8(1031) |
827 0816 9440 sbci r25,hi8(1031) |
828 0818 04F0 brlt .L57 |
829 081a 8091 0000 lds r24,AnalogOffsetRoll |
830 081e 8F5F subi r24,lo8(-(1)) |
831 .L80: |
832 0820 8093 0000 sts AnalogOffsetRoll,r24 |
833 0824 00C0 rjmp .L56 |
834 .L57: |
835 0826 1F5F subi r17,lo8(-(1)) |
836 .L56: |
837 0828 8091 0000 lds r24,AdWertGier |
838 082c 9091 0000 lds r25,(AdWertGier)+1 |
839 0830 8C5F subi r24,lo8(1020) |
840 0832 9340 sbci r25,hi8(1020) |
841 0834 04F4 brge .L58 |
842 0836 8091 0000 lds r24,AnalogOffsetGier |
843 083a 8150 subi r24,lo8(-(-1)) |
844 083c 00C0 rjmp .L81 |
845 .L58: |
846 083e 8091 0000 lds r24,AdWertGier |
847 0842 9091 0000 lds r25,(AdWertGier)+1 |
848 0846 8750 subi r24,lo8(1031) |
849 0848 9440 sbci r25,hi8(1031) |
850 084a 04F0 brlt .L60 |
851 084c 8091 0000 lds r24,AnalogOffsetGier |
852 0850 8F5F subi r24,lo8(-(1)) |
853 .L81: |
854 0852 8093 0000 sts AnalogOffsetGier,r24 |
855 0856 00C0 rjmp .L59 |
856 .L60: |
857 0858 1F5F subi r17,lo8(-(1)) |
858 .L59: |
859 085a 7092 0000 sts twi_state,r7 |
860 085e 8091 0000 lds r24,BLFlags |
861 0862 8E7F andi r24,lo8(-2) |
862 0864 8093 0000 sts BLFlags,r24 |
863 0868 8092 BC00 sts 188,r8 |
864 086c 8091 0000 lds r24,AnalogOffsetNick |
865 0870 8A30 cpi r24,lo8(10) |
866 0872 00F4 brsh .L61 |
867 0874 8091 0000 lds r24,VersionInfo+5 |
868 0878 8160 ori r24,lo8(1) |
869 087a 8093 0000 sts VersionInfo+5,r24 |
870 087e E092 0000 sts AnalogOffsetNick,r14 |
871 .L61: |
872 0882 8091 0000 lds r24,AnalogOffsetNick |
873 0886 863F cpi r24,lo8(-10) |
874 0888 00F0 brlo .L62 |
875 088a 8091 0000 lds r24,VersionInfo+5 |
876 088e 8160 ori r24,lo8(1) |
877 0890 8093 0000 sts VersionInfo+5,r24 |
878 0894 F092 0000 sts AnalogOffsetNick,r15 |
879 .L62: |
880 0898 8091 0000 lds r24,AnalogOffsetRoll |
881 089c 8A30 cpi r24,lo8(10) |
882 089e 00F4 brsh .L63 |
883 08a0 8091 0000 lds r24,VersionInfo+5 |
884 08a4 8260 ori r24,lo8(2) |
885 08a6 8093 0000 sts VersionInfo+5,r24 |
886 08aa E092 0000 sts AnalogOffsetRoll,r14 |
887 .L63: |
888 08ae 8091 0000 lds r24,AnalogOffsetRoll |
889 08b2 863F cpi r24,lo8(-10) |
890 08b4 00F0 brlo .L64 |
891 08b6 8091 0000 lds r24,VersionInfo+5 |
892 08ba 8260 ori r24,lo8(2) |
893 08bc 8093 0000 sts VersionInfo+5,r24 |
894 08c0 F092 0000 sts AnalogOffsetRoll,r15 |
895 .L64: |
896 08c4 8091 0000 lds r24,AnalogOffsetGier |
897 08c8 8A30 cpi r24,lo8(10) |
898 08ca 00F4 brsh .L65 |
899 08cc 8091 0000 lds r24,VersionInfo+5 |
900 08d0 8460 ori r24,lo8(4) |
901 08d2 8093 0000 sts VersionInfo+5,r24 |
902 08d6 E092 0000 sts AnalogOffsetGier,r14 |
903 .L65: |
904 08da 8091 0000 lds r24,AnalogOffsetGier |
905 08de 863F cpi r24,lo8(-10) |
906 08e0 00F0 brlo .L74 |
907 08e2 8091 0000 lds r24,VersionInfo+5 |
908 08e6 8460 ori r24,lo8(4) |
909 08e8 8093 0000 sts VersionInfo+5,r24 |
910 08ec F092 0000 sts AnalogOffsetGier,r15 |
911 08f0 00C0 rjmp .L74 |
912 .L68: |
913 08f2 CE01 movw r24,r28 |
914 08f4 0E94 0000 call CheckDelay |
915 08f8 8823 tst r24 |
916 08fa 01F0 breq .L74 |
917 08fc 00D0 rcall . |
918 08fe 00D0 rcall . |
919 0900 EDB7 in r30,__SP_L__ |
920 0902 FEB7 in r31,__SP_H__ |
921 0904 B282 std Z+2,r11 |
922 0906 A182 std Z+1,r10 |
923 0908 D482 std Z+4,r13 |
924 090a C382 std Z+3,r12 |
925 090c E091 0000 lds r30,_printf_P |
926 0910 F091 0000 lds r31,(_printf_P)+1 |
927 0914 0995 icall |
928 0916 0F90 pop __tmp_reg__ |
929 0918 0F90 pop __tmp_reg__ |
930 091a 0F90 pop __tmp_reg__ |
931 091c 0F90 pop __tmp_reg__ |
932 091e 00C0 rjmp .L67 |
933 .L74: |
934 0920 8091 0000 lds r24,twi_state |
935 0924 8823 tst r24 |
936 0926 01F4 brne .L68 |
937 .L67: |
938 0928 1092 0000 sts AdReady,__zero_reg__ |
939 092c 9092 7A00 sts 122,r9 |
940 .L69: |
941 0930 8091 0000 lds r24,AdReady |
942 0934 8823 tst r24 |
943 0936 01F0 breq .L69 |
944 0938 0A30 cpi r16,lo8(10) |
945 093a 00F4 brsh .L70 |
946 093c 8AE0 ldi r24,lo8(10) |
947 093e 90E0 ldi r25,hi8(10) |
948 0940 0E94 0000 call Delay_ms_Mess |
949 .L70: |
950 0944 0150 subi r16,lo8(-(-1)) |
951 0946 01F0 breq .+2 |
952 0948 00C0 rjmp .L71 |
953 094a 86E4 ldi r24,lo8(70) |
954 094c 90E0 ldi r25,hi8(70) |
955 094e 0E94 0000 call Delay_ms_Mess |
956 /* epilogue start */ |
957 0952 CDB7 in r28,__SP_L__ |
958 0954 DEB7 in r29,__SP_H__ |
959 0956 EDE0 ldi r30, lo8(13) |
960 0958 0C94 0000 jmp __epilogue_restores__ + ((18 - 13) * 2) |
962 .global SucheLuftruckOffset |
964 SucheLuftruckOffset: |
965 095c EF92 push r14 |
966 095e FF92 push r15 |
967 0960 0F93 push r16 |
968 0962 1F93 push r17 |
969 0964 CF93 push r28 |
970 0966 DF93 push r29 |
971 /* prologue: function */ |
972 /* frame size = 0 */ |
973 0968 1092 0000 sts ExpandBaro,__zero_reg__ |
974 096c 83E0 ldi r24,lo8(3) |
975 096e 90E0 ldi r25,hi8(3) |
976 0970 0E94 0000 call GetParamByte |
977 0974 C82F mov r28,r24 |
978 0976 D0E0 ldi r29,lo8(0) |
979 0978 C531 cpi r28,21 |
980 097a D105 cpc r29,__zero_reg__ |
981 097c 00F0 brlo .L83 |
982 097e 2A97 sbiw r28,10 |
983 .L83: |
984 0980 C7BD out 71-32,r28 |
985 0982 84E6 ldi r24,lo8(100) |
986 0984 90E0 ldi r25,hi8(100) |
987 0986 0E94 0000 call Delay_ms_Mess |
988 098a 8091 0000 lds r24,MessLuftdruck |
989 098e 9091 0000 lds r25,(MessLuftdruck)+1 |
990 0992 8052 subi r24,lo8(800) |
991 0994 9340 sbci r25,hi8(800) |
992 0996 00F4 brsh .L84 |
993 0998 C0E0 ldi r28,lo8(0) |
994 099a D0E0 ldi r29,hi8(0) |
995 099c 00C0 rjmp .L84 |
996 .L86: |
997 099e C7BD out 71-32,r28 |
998 09a0 82E3 ldi r24,lo8(50) |
999 09a2 90E0 ldi r25,hi8(50) |
1000 09a4 0E94 0000 call Delay_ms_Mess |
1001 09a8 00D0 rcall . |
1002 09aa 00D0 rcall . |
1003 09ac EDB7 in r30,__SP_L__ |
1004 09ae FEB7 in r31,__SP_H__ |
1005 09b0 F282 std Z+2,r15 |
1006 09b2 E182 std Z+1,r14 |
1007 09b4 1483 std Z+4,r17 |
1008 09b6 0383 std Z+3,r16 |
1009 09b8 E091 0000 lds r30,_printf_P |
1010 09bc F091 0000 lds r31,(_printf_P)+1 |
1011 09c0 0995 icall |
1012 09c2 8091 0000 lds r24,MessLuftdruck |
1013 09c6 9091 0000 lds r25,(MessLuftdruck)+1 |
1014 09ca 0F90 pop __tmp_reg__ |
1015 09cc 0F90 pop __tmp_reg__ |
1016 09ce 0F90 pop __tmp_reg__ |
1017 09d0 0F90 pop __tmp_reg__ |
1018 09d2 8052 subi r24,lo8(800) |
1019 09d4 9340 sbci r25,hi8(800) |
1020 09d6 00F0 brlo .L85 |
1021 09d8 2196 adiw r28,1 |
1022 09da 00C0 rjmp .L89 |
1023 .L84: |
1024 09dc 60E0 ldi r22,lo8(gs(uart_putchar)) |
1025 09de E62E mov r14,r22 |
1026 09e0 60E0 ldi r22,hi8(gs(uart_putchar)) |
1027 09e2 F62E mov r15,r22 |
1028 09e4 00E0 ldi r16,lo8(__c.2252) |
1029 09e6 10E0 ldi r17,hi8(__c.2252) |
1030 .L89: |
1031 09e8 CA3F cpi r28,250 |
1032 09ea D105 cpc r29,__zero_reg__ |
1033 09ec 00F0 brlo .L86 |
1034 .L85: |
1035 09ee 1C2F mov r17,r28 |
1036 09f0 C093 0000 sts DruckOffsetSetting,r28 |
1037 09f4 83E0 ldi r24,lo8(3) |
1038 09f6 90E0 ldi r25,hi8(3) |
1039 09f8 6C2F mov r22,r28 |
1040 09fa 0E94 0000 call SetParamByte |
1041 09fe 8091 0000 lds r24,EE_Parameter+13 |
1042 0a02 80FF sbrs r24,0 |
1043 0a04 00C0 rjmp .L87 |
1044 0a06 8091 0000 lds r24,DruckOffsetSetting |
1045 0a0a 8A50 subi r24,lo8(-(-10)) |
1046 0a0c 8B3E cpi r24,lo8(-21) |
1047 0a0e 00F0 brlo .L87 |
1048 0a10 8091 0000 lds r24,VersionInfo+5 |
1049 0a14 8064 ori r24,lo8(64) |
1050 0a16 8093 0000 sts VersionInfo+5,r24 |
1051 .L87: |
1052 0a1a 17BD out 71-32,r17 |
1053 0a1c 8CE2 ldi r24,lo8(300) |
1054 0a1e 91E0 ldi r25,hi8(300) |
1055 0a20 0E94 0000 call Delay_ms_Mess |
1056 /* epilogue start */ |
1057 0a24 CDB7 in r28,__SP_L__ |
1058 0a26 DEB7 in r29,__SP_H__ |
1059 0a28 E6E0 ldi r30, lo8(6) |
1060 0a2a 0C94 0000 jmp __epilogue_restores__ + ((18 - 6) * 2) |
1062 .global UBat |
1063 .data |
1066 UBat: |
1067 0000 6400 .word 100 |
1068 .global AdWertNickFilter |
1069 .global AdWertNickFilter |
1070 .section .bss |
1073 AdWertNickFilter: |
1074 0000 0000 .skip 2,0 |
1075 .global AdWertRollFilter |
1076 .global AdWertRollFilter |
1079 AdWertRollFilter: |
1080 0002 0000 .skip 2,0 |
1081 .global AdWertGierFilter |
1082 .global AdWertGierFilter |
1085 AdWertGierFilter: |
1086 0004 0000 .skip 2,0 |
1087 .global HiResNick |
1088 .data |
1091 HiResNick: |
1092 0002 C409 .word 2500 |
1093 .global HiResRoll |
1096 HiResRoll: |
1097 0004 C409 .word 2500 |
1098 .global AdWertNick |
1099 .global AdWertNick |
1100 .section .bss |
1103 AdWertNick: |
1104 0006 0000 .skip 2,0 |
1105 .global AdWertRoll |
1106 .global AdWertRoll |
1109 AdWertRoll: |
1110 0008 0000 .skip 2,0 |
1111 .global AdWertGier |
1112 .global AdWertGier |
1115 AdWertGier: |
1116 000a 0000 .skip 2,0 |
1117 .global AdWertAccRoll |
1118 .global AdWertAccRoll |
1121 AdWertAccRoll: |
1122 000c 0000 .skip 2,0 |
1123 .global AdWertAccNick |
1124 .global AdWertAccNick |
1127 AdWertAccNick: |
1128 000e 0000 .skip 2,0 |
1129 .global AdWertAccHoch |
1130 .global AdWertAccHoch |
1133 AdWertAccHoch: |
1134 0010 0000 .skip 2,0 |
1135 .global messanzahl_AccHoch |
1136 .global messanzahl_AccHoch |
1139 messanzahl_AccHoch: |
1140 0012 00 .skip 1,0 |
1141 .global Luftdruck |
1142 .data |
1145 Luftdruck: |
1146 0006 00 .byte 0 |
1147 0007 7D .byte 125 |
1148 0008 00 .byte 0 |
1149 0009 00 .byte 0 |
1150 .global SummenHoehe |
1151 .global SummenHoehe |
1152 .section .bss |
1155 SummenHoehe: |
1156 0013 0000 0000 .skip 4,0 |
1157 .global MessLuftdruck |
1158 .data |
1161 MessLuftdruck: |
1162 000a FF03 .word 1023 |
1163 .global ExpandBaro |
1164 .global ExpandBaro |
1165 .section .bss |
1168 ExpandBaro: |
1169 0017 00 .skip 1,0 |
1170 .global VarioMeter |
1171 .global VarioMeter |
1174 VarioMeter: |
1175 0018 0000 .skip 2,0 |
1176 .global ZaehlMessungen |
1177 .global ZaehlMessungen |
1180 ZaehlMessungen: |
1181 001a 0000 .skip 2,0 |
1182 .global AnalogOffsetNick |
1183 .data |
1186 AnalogOffsetNick: |
1187 000c 73 .byte 115 |
1188 .global AnalogOffsetRoll |
1191 AnalogOffsetRoll: |
1192 000d 73 .byte 115 |
1193 .global AnalogOffsetGier |
1196 AnalogOffsetGier: |
1197 000e 73 .byte 115 |
1198 .global AdReady |
1201 AdReady: |
1202 000f 01 .byte 1 |
1203 .lcomm messanzahl_Druck.2335,1 |
1204 .lcomm tmpLuftdruck.2334,4 |
1205 .lcomm accx.2333,2 |
1206 .lcomm accy.2332,2 |
1207 .lcomm roll_filter.2331,2 |
1208 .lcomm nick_filter.2330,2 |
1209 .lcomm nick1.2329,2 |
1210 .lcomm roll1.2328,2 |
1211 .lcomm gier1.2327,2 |
1212 .lcomm subcount.2326,1 |
1213 .lcomm state.2325,1 |
1214 .lcomm kanal.2324,1 |
1215 .section .progmem.data,"a",@progbits |
1218 __c.2279: |
1219 0000 0A0D 2044 .string "\n\r DAC or I2C ERROR! Check I2C, 3Vref, DAC and BL-Ctrl" |
1219 4143 206F |
1219 7220 4932 |
1219 4320 4552 |
1219 524F 5221 |
1222 __c.2252: |
1223 0037 2E00 .string "." |
1224 .comm Aktuell_Nick,2,1 |
1225 .comm Aktuell_Roll,2,1 |
1226 .comm Aktuell_Gier,2,1 |
1227 .comm Aktuell_ax,2,1 |
1228 .comm Aktuell_ay,2,1 |
1229 .comm Aktuell_az,2,1 |
1230 .comm DruckOffsetSetting,1,1 |
1231 .comm StartLuftdruck,2,1 |
1232 .comm NeutralAccZ_float,4,1 |
1233 .global __do_copy_data |
1234 .global __do_clear_bss |
8 .global __do_copy_data |
9 .global __do_clear_bss |
10 .global AdReady |
11 .data |
14 AdReady: |
15 0000 01 .byte 1 |
16 .global AnalogOffsetGier |
19 AnalogOffsetGier: |
20 0001 73 .byte 115 |
21 .global AnalogOffsetRoll |
24 AnalogOffsetRoll: |
25 0002 73 .byte 115 |
26 .global AnalogOffsetNick |
29 AnalogOffsetNick: |
30 0003 73 .byte 115 |
31 .global ZaehlMessungen |
32 .global ZaehlMessungen |
33 .section .bss |
36 ZaehlMessungen: |
37 0000 0000 .skip 2,0 |
38 .global VarioMeter |
39 .global VarioMeter |
42 VarioMeter: |
43 0002 0000 .skip 2,0 |
44 .global ExpandBaro |
45 .global ExpandBaro |
48 ExpandBaro: |
49 0004 00 .skip 1,0 |
50 .global MessLuftdruck |
51 .data |
54 MessLuftdruck: |
55 0004 FF03 .word 1023 |
56 .global SummenHoehe |
57 .global SummenHoehe |
58 .section .bss |
61 SummenHoehe: |
62 0005 0000 0000 .skip 4,0 |
63 .global Luftdruck |
64 .data |
67 Luftdruck: |
68 0006 007D 0000 .long 32000 |
69 .global messanzahl_AccHoch |
70 .global messanzahl_AccHoch |
71 .section .bss |
74 messanzahl_AccHoch: |
75 0009 00 .skip 1,0 |
76 .global AdWertAccHoch |
77 .global AdWertAccHoch |
80 AdWertAccHoch: |
81 000a 0000 .skip 2,0 |
82 .global AdWertAccNick |
83 .global AdWertAccNick |
86 AdWertAccNick: |
87 000c 0000 .skip 2,0 |
88 .global AdWertAccRoll |
89 .global AdWertAccRoll |
92 AdWertAccRoll: |
93 000e 0000 .skip 2,0 |
94 .global AdWertGier |
95 .global AdWertGier |
98 AdWertGier: |
99 0010 0000 .skip 2,0 |
100 .global AdWertRoll |
101 .global AdWertRoll |
104 AdWertRoll: |
105 0012 0000 .skip 2,0 |
106 .global AdWertNick |
107 .global AdWertNick |
110 AdWertNick: |
111 0014 0000 .skip 2,0 |
112 .global HiResRoll |
113 .data |
116 HiResRoll: |
117 000a C409 .word 2500 |
118 .global HiResNick |
121 HiResNick: |
122 000c C409 .word 2500 |
123 .global AdWertGierFilter |
124 .global AdWertGierFilter |
125 .section .bss |
128 AdWertGierFilter: |
129 0016 0000 .skip 2,0 |
130 .global AdWertRollFilter |
131 .global AdWertRollFilter |
134 AdWertRollFilter: |
135 0018 0000 .skip 2,0 |
136 .global AdWertNickFilter |
137 .global AdWertNickFilter |
140 AdWertNickFilter: |
141 001a 0000 .skip 2,0 |
142 .global UBat |
143 .data |
146 UBat: |
147 000e 6400 .word 100 |
148 .text |
149 .global ADC_Init |
151 ADC_Init: |
152 /* prologue: frame size=0 */ |
153 /* prologue end (size=0) */ |
154 0000 1092 7C00 sts 124,__zero_reg__ |
155 0004 8FEC ldi r24,lo8(-49) |
156 0006 8093 7A00 sts 122,r24 |
157 /* epilogue: frame size=0 */ |
158 000a 0895 ret |
159 /* epilogue end (size=1) */ |
160 /* function ADC_Init size 6 (5) */ |
162 .section .progmem.data,"a",@progbits |
165 __c.13: |
166 0000 2E00 .string "." |
167 .text |
168 .global SucheLuftruckOffset |
170 SucheLuftruckOffset: |
171 /* prologue: frame size=0 */ |
172 000c CF93 push r28 |
173 000e DF93 push r29 |
174 /* prologue end (size=2) */ |
175 0010 1092 0000 sts ExpandBaro,__zero_reg__ |
176 0014 83E0 ldi r24,lo8(3) |
177 0016 90E0 ldi r25,hi8(3) |
178 0018 0E94 0000 call GetParamByte |
179 001c C82F mov r28,r24 |
180 001e DD27 clr r29 |
181 0020 C531 cpi r28,21 |
182 0022 D105 cpc r29,__zero_reg__ |
183 0024 08F0 brlo .L3 |
184 0026 2A97 sbiw r28,10 |
185 .L3: |
186 0028 C7BD out 71-0x20,r28 |
187 002a 84E6 ldi r24,lo8(100) |
188 002c 90E0 ldi r25,hi8(100) |
189 002e 0E94 0000 call Delay_ms_Mess |
190 0032 8091 0000 lds r24,MessLuftdruck |
191 0036 9091 0000 lds r25,(MessLuftdruck)+1 |
192 003a 8052 subi r24,lo8(800) |
193 003c 9340 sbci r25,hi8(800) |
194 003e 10F4 brsh .L4 |
195 0040 C0E0 ldi r28,lo8(0) |
196 0042 D0E0 ldi r29,hi8(0) |
197 .L4: |
198 0044 CA3F cpi r28,250 |
199 0046 D105 cpc r29,__zero_reg__ |
200 0048 F8F4 brsh .L6 |
201 004a C7BD out 71-0x20,r28 |
202 004c 82E3 ldi r24,lo8(50) |
203 004e 90E0 ldi r25,hi8(50) |
204 0050 0E94 0000 call Delay_ms_Mess |
205 0054 80E0 ldi r24,lo8(__c.13) |
206 0056 90E0 ldi r25,hi8(__c.13) |
207 0058 9F93 push r25 |
208 005a 8F93 push r24 |
209 005c 80E0 ldi r24,lo8(pm(uart_putchar)) |
210 005e 90E0 ldi r25,hi8(pm(uart_putchar)) |
211 0060 9F93 push r25 |
212 0062 8F93 push r24 |
213 0064 E091 0000 lds r30,_printf_P |
214 0068 F091 0000 lds r31,(_printf_P)+1 |
215 006c 0995 icall |
216 006e 8091 0000 lds r24,MessLuftdruck |
217 0072 9091 0000 lds r25,(MessLuftdruck)+1 |
218 0076 0F90 pop __tmp_reg__ |
219 0078 0F90 pop __tmp_reg__ |
220 007a 0F90 pop __tmp_reg__ |
221 007c 0F90 pop __tmp_reg__ |
222 007e 8052 subi r24,lo8(800) |
223 0080 9340 sbci r25,hi8(800) |
224 0082 10F0 brlo .L6 |
225 0084 2196 adiw r28,1 |
226 0086 DECF rjmp .L4 |
227 .L6: |
228 0088 C093 0000 sts DruckOffsetSetting,r28 |
229 008c 6C2F mov r22,r28 |
230 008e 83E0 ldi r24,lo8(3) |
231 0090 90E0 ldi r25,hi8(3) |
232 0092 0E94 0000 call SetParamByte |
233 0096 8091 0000 lds r24,EE_Parameter+13 |
234 009a 80FF sbrs r24,0 |
235 009c 0AC0 rjmp .L10 |
236 009e 8091 0000 lds r24,DruckOffsetSetting |
237 00a2 8A50 subi r24,lo8(-(-10)) |
238 00a4 8B3E cpi r24,lo8(-21) |
239 00a6 28F0 brlo .L10 |
240 00a8 8091 0000 lds r24,VersionInfo+5 |
241 00ac 8064 ori r24,lo8(64) |
242 00ae 8093 0000 sts VersionInfo+5,r24 |
243 .L10: |
244 00b2 C7BD out 71-0x20,r28 |
245 00b4 8CE2 ldi r24,lo8(300) |
246 00b6 91E0 ldi r25,hi8(300) |
247 00b8 0E94 0000 call Delay_ms_Mess |
248 /* epilogue: frame size=0 */ |
249 00bc DF91 pop r29 |
250 00be CF91 pop r28 |
251 00c0 0895 ret |
252 /* epilogue end (size=3) */ |
253 /* function SucheLuftruckOffset size 93 (88) */ |
255 .section .progmem.data |
258 __c.12: |
259 0002 0A0D 2044 .string "\n\r DAC or I2C ERROR! Check I2C, 3Vref, DAC and BL-Ctrl" |
259 4143 206F |
259 7220 4932 |
259 4320 4552 |
259 524F 5221 |
260 .text |
261 .global SucheGyroOffset |
263 SucheGyroOffset: |
264 /* prologue: frame size=0 */ |
265 00c2 EF92 push r14 |
266 00c4 FF92 push r15 |
267 00c6 1F93 push r17 |
268 00c8 CF93 push r28 |
269 /* prologue end (size=4) */ |
270 00ca 10E0 ldi r17,lo8(0) |
271 00cc 80ED ldi r24,lo8(2000) |
272 00ce 97E0 ldi r25,hi8(2000) |
273 00d0 0E94 0000 call SetDelay |
274 00d4 7C01 movw r14,r24 |
275 00d6 CCE8 ldi r28,lo8(-116) |
276 .L43: |
277 00d8 1330 cpi r17,lo8(3) |
278 00da 19F4 brne .L16 |
279 00dc CB30 cpi r28,lo8(11) |
280 00de 08F0 brlo .L16 |
281 00e0 C9E0 ldi r28,lo8(9) |
282 .L16: |
283 00e2 10E0 ldi r17,lo8(0) |
284 00e4 8091 0000 lds r24,AdWertNick |
285 00e8 9091 0000 lds r25,(AdWertNick)+1 |
286 00ec 8C5F subi r24,lo8(1020) |
287 00ee 9340 sbci r25,hi8(1020) |
288 00f0 24F4 brge .L17 |
289 00f2 8091 0000 lds r24,AnalogOffsetNick |
290 00f6 8150 subi r24,lo8(-(-1)) |
291 00f8 0AC0 rjmp .L48 |
292 .L17: |
293 00fa 8091 0000 lds r24,AdWertNick |
294 00fe 9091 0000 lds r25,(AdWertNick)+1 |
295 0102 8750 subi r24,lo8(1031) |
296 0104 9440 sbci r25,hi8(1031) |
297 0106 34F0 brlt .L19 |
298 0108 8091 0000 lds r24,AnalogOffsetNick |
299 010c 8F5F subi r24,lo8(-(1)) |
300 .L48: |
301 010e 8093 0000 sts AnalogOffsetNick,r24 |
302 0112 01C0 rjmp .L18 |
303 .L19: |
304 0114 11E0 ldi r17,lo8(1) |
305 .L18: |
306 0116 8091 0000 lds r24,AdWertRoll |
307 011a 9091 0000 lds r25,(AdWertRoll)+1 |
308 011e 8C5F subi r24,lo8(1020) |
309 0120 9340 sbci r25,hi8(1020) |
310 0122 24F4 brge .L21 |
311 0124 8091 0000 lds r24,AnalogOffsetRoll |
312 0128 8150 subi r24,lo8(-(-1)) |
313 012a 0AC0 rjmp .L49 |
314 .L21: |
315 012c 8091 0000 lds r24,AdWertRoll |
316 0130 9091 0000 lds r25,(AdWertRoll)+1 |
317 0134 8750 subi r24,lo8(1031) |
318 0136 9440 sbci r25,hi8(1031) |
319 0138 34F0 brlt .L23 |
320 013a 8091 0000 lds r24,AnalogOffsetRoll |
321 013e 8F5F subi r24,lo8(-(1)) |
322 .L49: |
323 0140 8093 0000 sts AnalogOffsetRoll,r24 |
324 0144 01C0 rjmp .L22 |
325 .L23: |
326 0146 1F5F subi r17,lo8(-(1)) |
327 .L22: |
328 0148 8091 0000 lds r24,AdWertGier |
329 014c 9091 0000 lds r25,(AdWertGier)+1 |
330 0150 8C5F subi r24,lo8(1020) |
331 0152 9340 sbci r25,hi8(1020) |
332 0154 24F4 brge .L25 |
333 0156 8091 0000 lds r24,AnalogOffsetGier |
334 015a 8150 subi r24,lo8(-(-1)) |
335 015c 0AC0 rjmp .L50 |
336 .L25: |
337 015e 8091 0000 lds r24,AdWertGier |
338 0162 9091 0000 lds r25,(AdWertGier)+1 |
339 0166 8750 subi r24,lo8(1031) |
340 0168 9440 sbci r25,hi8(1031) |
341 016a C4F0 brlt .L27 |
342 016c 8091 0000 lds r24,AnalogOffsetGier |
343 0170 8F5F subi r24,lo8(-(1)) |
344 .L50: |
345 0172 8093 0000 sts AnalogOffsetGier,r24 |
346 0176 13C0 rjmp .L26 |
347 .L47: |
348 0178 80E0 ldi r24,lo8(__c.12) |
349 017a 90E0 ldi r25,hi8(__c.12) |
350 017c 9F93 push r25 |
351 017e 8F93 push r24 |
352 0180 80E0 ldi r24,lo8(pm(uart_putchar)) |
353 0182 90E0 ldi r25,hi8(pm(uart_putchar)) |
354 0184 9F93 push r25 |
355 0186 8F93 push r24 |
356 0188 E091 0000 lds r30,_printf_P |
357 018c F091 0000 lds r31,(_printf_P)+1 |
358 0190 0995 icall |
359 0192 0F90 pop __tmp_reg__ |
360 0194 0F90 pop __tmp_reg__ |
361 0196 0F90 pop __tmp_reg__ |
362 0198 0F90 pop __tmp_reg__ |
363 019a 5FC0 rjmp .L36 |
364 .L27: |
365 019c 1F5F subi r17,lo8(-(1)) |
366 .L26: |
367 019e 82E1 ldi r24,lo8(18) |
368 01a0 8093 0000 sts twi_state,r24 |
369 01a4 8091 0000 lds r24,BLFlags |
370 01a8 8E7F andi r24,lo8(-2) |
371 01aa 8093 0000 sts BLFlags,r24 |
372 01ae 85EA ldi r24,lo8(-91) |
373 01b0 8093 BC00 sts 188,r24 |
374 01b4 8091 0000 lds r24,AnalogOffsetNick |
375 01b8 8A30 cpi r24,lo8(10) |
376 01ba 40F4 brsh .L29 |
377 01bc 8091 0000 lds r24,VersionInfo+5 |
378 01c0 8160 ori r24,lo8(1) |
379 01c2 8093 0000 sts VersionInfo+5,r24 |
380 01c6 8AE0 ldi r24,lo8(10) |
381 01c8 8093 0000 sts AnalogOffsetNick,r24 |
382 .L29: |
383 01cc 8091 0000 lds r24,AnalogOffsetNick |
384 01d0 863F cpi r24,lo8(-10) |
385 01d2 40F0 brlo .L30 |
386 01d4 8091 0000 lds r24,VersionInfo+5 |
387 01d8 8160 ori r24,lo8(1) |
388 01da 8093 0000 sts VersionInfo+5,r24 |
389 01de 85EF ldi r24,lo8(-11) |
390 01e0 8093 0000 sts AnalogOffsetNick,r24 |
391 .L30: |
392 01e4 8091 0000 lds r24,AnalogOffsetRoll |
393 01e8 8A30 cpi r24,lo8(10) |
394 01ea 40F4 brsh .L31 |
395 01ec 8091 0000 lds r24,VersionInfo+5 |
396 01f0 8260 ori r24,lo8(2) |
397 01f2 8093 0000 sts VersionInfo+5,r24 |
398 01f6 8AE0 ldi r24,lo8(10) |
399 01f8 8093 0000 sts AnalogOffsetRoll,r24 |
400 .L31: |
401 01fc 8091 0000 lds r24,AnalogOffsetRoll |
402 0200 863F cpi r24,lo8(-10) |
403 0202 40F0 brlo .L32 |
404 0204 8091 0000 lds r24,VersionInfo+5 |
405 0208 8260 ori r24,lo8(2) |
406 020a 8093 0000 sts VersionInfo+5,r24 |
407 020e 85EF ldi r24,lo8(-11) |
408 0210 8093 0000 sts AnalogOffsetRoll,r24 |
409 .L32: |
410 0214 8091 0000 lds r24,AnalogOffsetGier |
411 0218 8A30 cpi r24,lo8(10) |
412 021a 40F4 brsh .L33 |
413 021c 8091 0000 lds r24,VersionInfo+5 |
414 0220 8460 ori r24,lo8(4) |
415 0222 8093 0000 sts VersionInfo+5,r24 |
416 0226 8AE0 ldi r24,lo8(10) |
417 0228 8093 0000 sts AnalogOffsetGier,r24 |
418 .L33: |
419 022c 8091 0000 lds r24,AnalogOffsetGier |
420 0230 863F cpi r24,lo8(-10) |
421 0232 40F0 brlo .L34 |
422 0234 8091 0000 lds r24,VersionInfo+5 |
423 0238 8460 ori r24,lo8(4) |
424 023a 8093 0000 sts VersionInfo+5,r24 |
425 023e 85EF ldi r24,lo8(-11) |
426 0240 8093 0000 sts AnalogOffsetGier,r24 |
427 .L34: |
428 0244 8091 0000 lds r24,twi_state |
429 0248 8823 tst r24 |
430 024a 39F0 breq .L36 |
431 024c C701 movw r24,r14 |
432 024e 0E94 0000 call CheckDelay |
433 0252 8823 tst r24 |
434 0254 09F0 breq .+2 |
435 0256 90CF rjmp .L47 |
436 0258 F5CF rjmp .L34 |
437 .L36: |
438 025a 1092 0000 sts AdReady,__zero_reg__ |
439 025e 8FEC ldi r24,lo8(-49) |
440 0260 8093 7A00 sts 122,r24 |
441 .L39: |
442 0264 8091 0000 lds r24,AdReady |
443 0268 8823 tst r24 |
444 026a E1F3 breq .L39 |
445 026c CA30 cpi r28,lo8(10) |
446 026e 20F4 brsh .L15 |
447 0270 8AE0 ldi r24,lo8(10) |
448 0272 90E0 ldi r25,hi8(10) |
449 0274 0E94 0000 call Delay_ms_Mess |
450 .L15: |
451 0278 C150 subi r28,lo8(-(-1)) |
452 027a 09F0 breq .+2 |
453 027c 2DCF rjmp .L43 |
454 027e 86E4 ldi r24,lo8(70) |
455 0280 90E0 ldi r25,hi8(70) |
456 0282 0E94 0000 call Delay_ms_Mess |
457 /* epilogue: frame size=0 */ |
458 0286 CF91 pop r28 |
459 0288 1F91 pop r17 |
460 028a FF90 pop r15 |
461 028c EF90 pop r14 |
462 028e 0895 ret |
463 /* epilogue end (size=5) */ |
464 /* function SucheGyroOffset size 238 (229) */ |
466 .lcomm kanal.0,1 |
467 .lcomm state.1,1 |
468 .lcomm subcount.2,1 |
469 .lcomm gier1.3,2 |
470 .lcomm roll1.4,2 |
471 .lcomm nick1.5,2 |
472 .lcomm nick_filter.6,2 |
473 .lcomm roll_filter.7,2 |
474 .lcomm accy.8,2 |
475 .lcomm accx.9,2 |
476 .lcomm tmpLuftdruck.10,4 |
477 .lcomm messanzahl_Druck.11,1 |
478 .global __vector_24 |
480 __vector_24: |
481 /* prologue: frame size=0 */ |
482 0290 1F92 push __zero_reg__ |
483 0292 0F92 push __tmp_reg__ |
484 0294 0FB6 in __tmp_reg__,__SREG__ |
485 0296 0F92 push __tmp_reg__ |
486 0298 1124 clr __zero_reg__ |
487 029a AF92 push r10 |
488 029c BF92 push r11 |
489 029e CF92 push r12 |
490 02a0 DF92 push r13 |
491 02a2 EF92 push r14 |
492 02a4 FF92 push r15 |
493 02a6 0F93 push r16 |
494 02a8 1F93 push r17 |
495 02aa 2F93 push r18 |
496 02ac 3F93 push r19 |
497 02ae 4F93 push r20 |
498 02b0 5F93 push r21 |
499 02b2 6F93 push r22 |
500 02b4 7F93 push r23 |
501 02b6 8F93 push r24 |
502 02b8 9F93 push r25 |
503 02ba AF93 push r26 |
504 02bc BF93 push r27 |
505 02be EF93 push r30 |
506 02c0 FF93 push r31 |
507 /* prologue end (size=25) */ |
508 02c2 8091 0000 lds r24,state.1 |
509 02c6 282F mov r18,r24 |
510 02c8 3327 clr r19 |
511 02ca 4427 clr r20 |
512 02cc 5527 clr r21 |
513 02ce 8F5F subi r24,lo8(-(1)) |
514 02d0 8093 0000 sts state.1,r24 |
515 02d4 F901 movw r30,r18 |
516 02d6 2231 cpi r18,18 |
517 02d8 3105 cpc r19,__zero_reg__ |
518 02da 08F0 brlo .+2 |
519 02dc 8CC3 rjmp .L101 |
520 02de E050 subi r30,lo8(-(pm(.L102))) |
521 02e0 F040 sbci r31,hi8(-(pm(.L102))) |
522 02e2 0C94 0000 jmp __tablejump2__ |
523 .data |
524 .section .progmem.gcc_sw_table, "a", @progbits |
525 .p2align 1 |
526 .L102: |
527 0000 0000 .word pm(.L53) |
528 0002 0000 .word pm(.L54) |
529 0004 0000 .word pm(.L55) |
530 0006 0000 .word pm(.L56) |
531 0008 0000 .word pm(.L57) |
532 000a 0000 .word pm(.L58) |
533 000c 0000 .word pm(.L59) |
534 000e 0000 .word pm(.L60) |
535 0010 0000 .word pm(.L61) |
536 0012 0000 .word pm(.L94) |
537 0014 0000 .word pm(.L58) |
538 0016 0000 .word pm(.L73) |
539 0018 0000 .word pm(.L74) |
540 001a 0000 .word pm(.L79) |
541 001c 0000 .word pm(.L80) |
542 001e 0000 .word pm(.L81) |
543 0020 0000 .word pm(.L87) |
544 0022 0000 .word pm(.L93) |
545 .text |
546 .L53: |
547 02e6 8091 7800 lds r24,120 |
548 02ea 9091 7900 lds r25,(120)+1 |
549 02ee 46C0 rjmp .L111 |
550 .L54: |
551 02f0 8091 7800 lds r24,120 |
552 02f4 9091 7900 lds r25,(120)+1 |
553 02f8 2CC1 rjmp .L110 |
554 .L55: |
555 02fa 8091 7800 lds r24,120 |
556 02fe 9091 7900 lds r25,(120)+1 |
557 0302 9093 0000 sts (gier1.3)+1,r25 |
558 0306 8093 0000 sts gier1.3,r24 |
559 030a 57C1 rjmp .L112 |
560 .L56: |
561 030c 8091 0000 lds r24,NeutralAccY |
562 0310 9091 0000 lds r25,(NeutralAccY)+1 |
563 0314 2091 7800 lds r18,120 |
564 0318 3091 7900 lds r19,(120)+1 |
565 031c 821B sub r24,r18 |
566 031e 930B sbc r25,r19 |
567 0320 9093 0000 sts (Aktuell_ay)+1,r25 |
568 0324 8093 0000 sts Aktuell_ay,r24 |
569 0328 8091 0000 lds r24,Aktuell_ay |
570 032c 9091 0000 lds r25,(Aktuell_ay)+1 |
571 0330 9093 0000 sts (accy.8)+1,r25 |
572 0334 8093 0000 sts accy.8,r24 |
573 0338 5EC1 rjmp .L113 |
574 .L57: |
575 033a 8091 7800 lds r24,120 |
576 033e 9091 7900 lds r25,(120)+1 |
577 0342 2091 0000 lds r18,NeutralAccX |
578 0346 3091 0000 lds r19,(NeutralAccX)+1 |
579 034a 821B sub r24,r18 |
580 034c 930B sbc r25,r19 |
581 034e 9093 0000 sts (Aktuell_ax)+1,r25 |
582 0352 8093 0000 sts Aktuell_ax,r24 |
583 0356 8091 0000 lds r24,Aktuell_ax |
584 035a 9091 0000 lds r25,(Aktuell_ax)+1 |
585 035e 9093 0000 sts (accx.9)+1,r25 |
586 0362 8093 0000 sts accx.9,r24 |
587 0366 49C3 rjmp .L108 |
588 .L58: |
589 0368 8091 0000 lds r24,nick1.5 |
590 036c 9091 0000 lds r25,(nick1.5)+1 |
591 0370 2091 7800 lds r18,120 |
592 0374 3091 7900 lds r19,(120)+1 |
593 0378 820F add r24,r18 |
594 037a 931F adc r25,r19 |
595 .L111: |
596 037c 9093 0000 sts (nick1.5)+1,r25 |
597 0380 8093 0000 sts nick1.5,r24 |
598 .L115: |
599 0384 81E0 ldi r24,lo8(1) |
600 0386 3AC3 rjmp .L109 |
601 .L59: |
602 0388 8091 0000 lds r24,roll1.4 |
603 038c 9091 0000 lds r25,(roll1.4)+1 |
604 0390 2091 7800 lds r18,120 |
605 0394 3091 7900 lds r19,(120)+1 |
606 0398 820F add r24,r18 |
607 039a 931F adc r25,r19 |
608 039c 9093 0000 sts (roll1.4)+1,r25 |
609 03a0 8093 0000 sts roll1.4,r24 |
610 03a4 84E0 ldi r24,lo8(4) |
611 03a6 2AC3 rjmp .L109 |
612 .L60: |
613 03a8 8091 0000 lds r24,UBat |
614 03ac 9091 0000 lds r25,(UBat)+1 |
615 03b0 9C01 movw r18,r24 |
616 03b2 220F lsl r18 |
617 03b4 331F rol r19 |
618 03b6 280F add r18,r24 |
619 03b8 391F adc r19,r25 |
620 03ba 8091 7800 lds r24,120 |
621 03be 9091 7900 lds r25,(120)+1 |
622 03c2 63E0 ldi r22,lo8(3) |
623 03c4 70E0 ldi r23,hi8(3) |
624 03c6 0E94 0000 call __udivmodhi4 |
625 03ca 260F add r18,r22 |
626 03cc 371F adc r19,r23 |
627 03ce 3695 lsr r19 |
628 03d0 2795 ror r18 |
629 03d2 3695 lsr r19 |
630 03d4 2795 ror r18 |
631 03d6 3093 0000 sts (UBat)+1,r19 |
632 03da 2093 0000 sts UBat,r18 |
633 03de 85E0 ldi r24,lo8(5) |
634 03e0 0DC3 rjmp .L109 |
635 .L61: |
636 03e2 8091 7800 lds r24,120 |
637 03e6 9091 7900 lds r25,(120)+1 |
638 03ea 4091 0000 lds r20,NeutralAccZ |
639 03ee 5091 0000 lds r21,(NeutralAccZ)+1 |
640 03f2 841B sub r24,r20 |
641 03f4 950B sbc r25,r21 |
642 03f6 9093 0000 sts (AdWertAccHoch)+1,r25 |
643 03fa 8093 0000 sts AdWertAccHoch,r24 |
644 03fe 8091 0000 lds r24,AdWertAccHoch |
645 0402 9091 0000 lds r25,(AdWertAccHoch)+1 |
646 0406 0297 sbiw r24,2 |
647 0408 04F1 brlt .L62 |
648 040a 22E0 ldi r18,hi8(750) |
649 040c 4E3E cpi r20,lo8(750) |
650 040e 5207 cpc r21,r18 |
651 0410 84F4 brge .L63 |
652 0412 2091 0000 lds r18,subcount.2 |
653 0416 2B5F subi r18,lo8(-(5)) |
654 0418 2093 0000 sts subcount.2,r18 |
655 041c 2550 subi r18,lo8(-(-5)) |
656 041e 8091 0000 lds r24,modell_fliegt |
657 0422 9091 0000 lds r25,(modell_fliegt)+1 |
658 0426 845F subi r24,lo8(500) |
659 0428 9140 sbci r25,hi8(500) |
660 042a 18F4 brsh .L63 |
661 042c 215F subi r18,lo8(-(15)) |
662 042e 2093 0000 sts subcount.2,r18 |
663 .L63: |
664 0432 8091 0000 lds r24,subcount.2 |
665 0436 8536 cpi r24,lo8(101) |
666 0438 84F1 brlt .L66 |
667 043a 4F5F subi r20,lo8(-(1)) |
668 043c 5F4F sbci r21,hi8(-(1)) |
669 043e 5093 0000 sts (NeutralAccZ)+1,r21 |
670 0442 4093 0000 sts NeutralAccZ,r20 |
671 0446 8456 subi r24,lo8(-(-100)) |
672 0448 26C0 rjmp .L104 |
673 .L62: |
674 044a 8091 0000 lds r24,AdWertAccHoch |
675 044e 9091 0000 lds r25,(AdWertAccHoch)+1 |
676 0452 8F5F subi r24,lo8(-1) |
677 0454 9F4F sbci r25,hi8(-1) |
678 0456 0CF5 brge .L66 |
679 0458 32E0 ldi r19,hi8(551) |
680 045a 4732 cpi r20,lo8(551) |
681 045c 5307 cpc r21,r19 |
682 045e ECF0 brlt .L66 |
683 0460 2091 0000 lds r18,subcount.2 |
684 0464 2550 subi r18,lo8(-(-5)) |
685 0466 2093 0000 sts subcount.2,r18 |
686 046a 2B5F subi r18,lo8(-(5)) |
687 046c 8091 0000 lds r24,modell_fliegt |
688 0470 9091 0000 lds r25,(modell_fliegt)+1 |
689 0474 845F subi r24,lo8(500) |
690 0476 9140 sbci r25,hi8(500) |
691 0478 18F4 brsh .L69 |
692 047a 2F50 subi r18,lo8(-(-15)) |
693 047c 2093 0000 sts subcount.2,r18 |
694 .L69: |
695 0480 8091 0000 lds r24,subcount.2 |
696 0484 8C39 cpi r24,lo8(-100) |
697 0486 4CF4 brge .L66 |
698 0488 4150 subi r20,lo8(-(-1)) |
699 048a 5040 sbci r21,hi8(-(-1)) |
700 048c 5093 0000 sts (NeutralAccZ)+1,r21 |
701 0490 4093 0000 sts NeutralAccZ,r20 |
702 0494 8C59 subi r24,lo8(-(100)) |
703 .L104: |
704 0496 8093 0000 sts subcount.2,r24 |
705 .L66: |
706 049a 81E0 ldi r24,lo8(1) |
707 049c 8093 0000 sts messanzahl_AccHoch,r24 |
708 04a0 8091 7800 lds r24,120 |
709 04a4 9091 7900 lds r25,(120)+1 |
710 04a8 9093 0000 sts (Aktuell_az)+1,r25 |
711 04ac 8093 0000 sts Aktuell_az,r24 |
712 04b0 8091 0000 lds r24,AdWertAccHoch |
713 04b4 9091 0000 lds r25,(AdWertAccHoch)+1 |
714 04b8 9C01 movw r18,r24 |
715 04ba 4427 clr r20 |
716 04bc 37FD sbrc r19,7 |
717 04be 4095 com r20 |
718 04c0 542F mov r21,r20 |
719 04c2 8091 0000 lds r24,Mess_Integral_Hoch |
720 04c6 9091 0000 lds r25,(Mess_Integral_Hoch)+1 |
721 04ca A091 0000 lds r26,(Mess_Integral_Hoch)+2 |
722 04ce B091 0000 lds r27,(Mess_Integral_Hoch)+3 |
723 04d2 820F add r24,r18 |
724 04d4 931F adc r25,r19 |
725 04d6 A41F adc r26,r20 |
726 04d8 B51F adc r27,r21 |
727 04da 8093 0000 sts Mess_Integral_Hoch,r24 |
728 04de 9093 0000 sts (Mess_Integral_Hoch)+1,r25 |
729 04e2 A093 0000 sts (Mess_Integral_Hoch)+2,r26 |
730 04e6 B093 0000 sts (Mess_Integral_Hoch)+3,r27 |
731 04ea 2091 0000 lds r18,Mess_Integral_Hoch |
732 04ee 3091 0000 lds r19,(Mess_Integral_Hoch)+1 |
733 04f2 4091 0000 lds r20,(Mess_Integral_Hoch)+2 |
734 04f6 5091 0000 lds r21,(Mess_Integral_Hoch)+3 |
735 04fa 57FF sbrs r21,7 |
736 04fc 04C0 rjmp .L71 |
737 04fe 2150 subi r18,lo8(-(1023)) |
738 0500 3C4F sbci r19,hi8(-(1023)) |
739 0502 4F4F sbci r20,hlo8(-(1023)) |
740 0504 5F4F sbci r21,hhi8(-(1023)) |
741 .L71: |
742 0506 0AE0 ldi r16,10 |
743 0508 5595 1: asr r21 |
744 050a 4795 ror r20 |
745 050c 3795 ror r19 |
746 050e 2795 ror r18 |
747 0510 0A95 dec r16 |
748 0512 D1F7 brne 1b |
749 0514 8091 0000 lds r24,Mess_Integral_Hoch |
750 0518 9091 0000 lds r25,(Mess_Integral_Hoch)+1 |
751 051c A091 0000 lds r26,(Mess_Integral_Hoch)+2 |
752 0520 B091 0000 lds r27,(Mess_Integral_Hoch)+3 |
753 0524 821B sub r24,r18 |
754 0526 930B sbc r25,r19 |
755 0528 A40B sbc r26,r20 |
756 052a B50B sbc r27,r21 |
757 052c 8093 0000 sts Mess_Integral_Hoch,r24 |
758 0530 9093 0000 sts (Mess_Integral_Hoch)+1,r25 |
759 0534 A093 0000 sts (Mess_Integral_Hoch)+2,r26 |
760 0538 B093 0000 sts (Mess_Integral_Hoch)+3,r27 |
761 053c 2EC1 rjmp .L114 |
762 .L73: |
763 053e 8091 0000 lds r24,roll1.4 |
764 0542 9091 0000 lds r25,(roll1.4)+1 |
765 0546 2091 7800 lds r18,120 |
766 054a 3091 7900 lds r19,(120)+1 |
767 054e 820F add r24,r18 |
768 0550 931F adc r25,r19 |
769 .L110: |
770 0552 9093 0000 sts (roll1.4)+1,r25 |
771 0556 8093 0000 sts roll1.4,r24 |
772 055a 1092 0000 sts kanal.0,__zero_reg__ |
773 055e 50C2 rjmp .L52 |
774 .L74: |
775 0560 8091 0000 lds r24,PlatinenVersion |
776 0564 8A30 cpi r24,lo8(10) |
777 0566 71F4 brne .L75 |
778 0568 8091 7800 lds r24,120 |
779 056c 9091 7900 lds r25,(120)+1 |
780 0570 2091 0000 lds r18,gier1.3 |
781 0574 3091 0000 lds r19,(gier1.3)+1 |
782 0578 820F add r24,r18 |
783 057a 931F adc r25,r19 |
784 057c 0196 adiw r24,1 |
785 057e 9695 lsr r25 |
786 0580 8795 ror r24 |
787 0582 17C0 rjmp .L105 |
788 .L75: |
789 0584 4091 0000 lds r20,gier1.3 |
790 0588 5091 0000 lds r21,(gier1.3)+1 |
791 058c 8431 cpi r24,lo8(20) |
792 058e 58F0 brlo .L77 |
793 0590 2091 7800 lds r18,120 |
794 0594 3091 7900 lds r19,(120)+1 |
795 0598 240F add r18,r20 |
796 059a 351F adc r19,r21 |
797 059c 8FEF ldi r24,lo8(2047) |
798 059e 97E0 ldi r25,hi8(2047) |
799 05a0 821B sub r24,r18 |
800 05a2 930B sbc r25,r19 |
801 05a4 06C0 rjmp .L105 |
802 .L77: |
803 05a6 8091 7800 lds r24,120 |
804 05aa 9091 7900 lds r25,(120)+1 |
805 05ae 840F add r24,r20 |
806 05b0 951F adc r25,r21 |
807 .L105: |
808 05b2 9093 0000 sts (AdWertGier)+1,r25 |
809 05b6 8093 0000 sts AdWertGier,r24 |
810 .L112: |
811 05ba 86E0 ldi r24,lo8(6) |
812 05bc 1FC2 rjmp .L109 |
813 .L79: |
814 05be 8091 0000 lds r24,NeutralAccY |
815 05c2 9091 0000 lds r25,(NeutralAccY)+1 |
816 05c6 2091 7800 lds r18,120 |
817 05ca 3091 7900 lds r19,(120)+1 |
818 05ce 821B sub r24,r18 |
819 05d0 930B sbc r25,r19 |
820 05d2 9093 0000 sts (Aktuell_ay)+1,r25 |
821 05d6 8093 0000 sts Aktuell_ay,r24 |
822 05da 8091 0000 lds r24,Aktuell_ay |
823 05de 9091 0000 lds r25,(Aktuell_ay)+1 |
824 05e2 2091 0000 lds r18,accy.8 |
825 05e6 3091 0000 lds r19,(accy.8)+1 |
826 05ea 820F add r24,r18 |
827 05ec 931F adc r25,r19 |
828 05ee 9093 0000 sts (AdWertAccRoll)+1,r25 |
829 05f2 8093 0000 sts AdWertAccRoll,r24 |
830 .L113: |
831 05f6 87E0 ldi r24,lo8(7) |
832 05f8 01C2 rjmp .L109 |
833 .L80: |
834 05fa 8091 7800 lds r24,120 |
835 05fe 9091 7900 lds r25,(120)+1 |
836 0602 2091 0000 lds r18,NeutralAccX |
837 0606 3091 0000 lds r19,(NeutralAccX)+1 |
838 060a 821B sub r24,r18 |
839 060c 930B sbc r25,r19 |
840 060e 9093 0000 sts (Aktuell_ax)+1,r25 |
841 0612 8093 0000 sts Aktuell_ax,r24 |
842 0616 8091 0000 lds r24,Aktuell_ax |
843 061a 9091 0000 lds r25,(Aktuell_ax)+1 |
844 061e 2091 0000 lds r18,accx.9 |
845 0622 3091 0000 lds r19,(accx.9)+1 |
846 0626 820F add r24,r18 |
847 0628 931F adc r25,r19 |
848 062a 9093 0000 sts (AdWertAccNick)+1,r25 |
849 062e 8093 0000 sts AdWertAccNick,r24 |
850 0632 E3C1 rjmp .L108 |
851 .L81: |
852 0634 2091 0000 lds r18,nick1.5 |
853 0638 3091 0000 lds r19,(nick1.5)+1 |
854 063c 8091 7800 lds r24,120 |
855 0640 9091 7900 lds r25,(120)+1 |
856 0644 280F add r18,r24 |
857 0646 391F adc r19,r25 |
858 0648 3093 0000 sts (nick1.5)+1,r19 |
859 064c 2093 0000 sts nick1.5,r18 |
860 0650 8091 0000 lds r24,PlatinenVersion |
861 0654 8A30 cpi r24,lo8(10) |
862 0656 19F4 brne .L82 |
863 0658 220F add r18,r18 |
864 065a 331F adc r19,r19 |
865 065c 04C0 rjmp .L106 |
866 .L82: |
867 065e 220F lsl r18 |
868 0660 331F rol r19 |
869 0662 220F lsl r18 |
870 0664 331F rol r19 |
871 .L106: |
872 0666 3093 0000 sts (nick1.5)+1,r19 |
873 066a 2093 0000 sts nick1.5,r18 |
874 066e 2091 0000 lds r18,nick1.5 |
875 0672 3091 0000 lds r19,(nick1.5)+1 |
876 0676 C901 movw r24,r18 |
877 0678 37FD sbrc r19,7 |
878 067a 0796 adiw r24,7 |
879 .L84: |
880 067c A3E0 ldi r26,3 |
881 067e 9595 1: asr r25 |
882 0680 8795 ror r24 |
883 0682 AA95 dec r26 |
884 0684 E1F7 brne 1b |
885 0686 9093 0000 sts (AdWertNick)+1,r25 |
886 068a 8093 0000 sts AdWertNick,r24 |
887 068e 8091 0000 lds r24,nick_filter.6 |
888 0692 9091 0000 lds r25,(nick_filter.6)+1 |
889 0696 820F add r24,r18 |
890 0698 931F adc r25,r19 |
891 069a 97FD sbrc r25,7 |
892 069c 0196 adiw r24,1 |
893 .L85: |
894 069e 9595 asr r25 |
895 06a0 8795 ror r24 |
896 06a2 9093 0000 sts (nick_filter.6)+1,r25 |
897 06a6 8093 0000 sts nick_filter.6,r24 |
898 06aa 2091 0000 lds r18,AdNeutralNick |
899 06ae 3091 0000 lds r19,(AdNeutralNick)+1 |
900 06b2 821B sub r24,r18 |
901 06b4 930B sbc r25,r19 |
902 06b6 9093 0000 sts (HiResNick)+1,r25 |
903 06ba 8093 0000 sts HiResNick,r24 |
904 06be 2091 0000 lds r18,AdWertNickFilter |
905 06c2 3091 0000 lds r19,(AdWertNickFilter)+1 |
906 06c6 8091 0000 lds r24,HiResNick |
907 06ca 9091 0000 lds r25,(HiResNick)+1 |
908 06ce 280F add r18,r24 |
909 06d0 391F adc r19,r25 |
910 06d2 37FF sbrs r19,7 |
911 06d4 02C0 rjmp .L86 |
912 06d6 2F5F subi r18,lo8(-(1)) |
913 06d8 3F4F sbci r19,hi8(-(1)) |
914 .L86: |
915 06da 3595 asr r19 |
916 06dc 2795 ror r18 |
917 06de 3093 0000 sts (AdWertNickFilter)+1,r19 |
918 06e2 2093 0000 sts AdWertNickFilter,r18 |
919 06e6 4ECE rjmp .L115 |
920 .L87: |
921 06e8 2091 0000 lds r18,roll1.4 |
922 06ec 3091 0000 lds r19,(roll1.4)+1 |
923 06f0 8091 7800 lds r24,120 |
924 06f4 9091 7900 lds r25,(120)+1 |
925 06f8 280F add r18,r24 |
926 06fa 391F adc r19,r25 |
927 06fc 3093 0000 sts (roll1.4)+1,r19 |
928 0700 2093 0000 sts roll1.4,r18 |
929 0704 8091 0000 lds r24,PlatinenVersion |
930 0708 8A30 cpi r24,lo8(10) |
931 070a 19F4 brne .L88 |
932 070c 220F add r18,r18 |
933 070e 331F adc r19,r19 |
934 0710 04C0 rjmp .L107 |
935 .L88: |
936 0712 220F lsl r18 |
937 0714 331F rol r19 |
938 0716 220F lsl r18 |
939 0718 331F rol r19 |
940 .L107: |
941 071a 3093 0000 sts (roll1.4)+1,r19 |
942 071e 2093 0000 sts roll1.4,r18 |
943 0722 2091 0000 lds r18,roll1.4 |
944 0726 3091 0000 lds r19,(roll1.4)+1 |
945 072a C901 movw r24,r18 |
946 072c 37FD sbrc r19,7 |
947 072e 0796 adiw r24,7 |
948 .L90: |
949 0730 63E0 ldi r22,3 |
950 0732 9595 1: asr r25 |
951 0734 8795 ror r24 |
952 0736 6A95 dec r22 |
953 0738 E1F7 brne 1b |
954 073a 9093 0000 sts (AdWertRoll)+1,r25 |
955 073e 8093 0000 sts AdWertRoll,r24 |
956 0742 8091 0000 lds r24,roll_filter.7 |
957 0746 9091 0000 lds r25,(roll_filter.7)+1 |
958 074a 820F add r24,r18 |
959 074c 931F adc r25,r19 |
960 074e 97FD sbrc r25,7 |
961 0750 0196 adiw r24,1 |
962 .L91: |
963 0752 9595 asr r25 |
964 0754 8795 ror r24 |
965 0756 9093 0000 sts (roll_filter.7)+1,r25 |
966 075a 8093 0000 sts roll_filter.7,r24 |
967 075e 2091 0000 lds r18,AdNeutralRoll |
968 0762 3091 0000 lds r19,(AdNeutralRoll)+1 |
969 0766 821B sub r24,r18 |
970 0768 930B sbc r25,r19 |
971 076a 9093 0000 sts (HiResRoll)+1,r25 |
972 076e 8093 0000 sts HiResRoll,r24 |
973 0772 2091 0000 lds r18,AdWertRollFilter |
974 0776 3091 0000 lds r19,(AdWertRollFilter)+1 |
975 077a 8091 0000 lds r24,HiResRoll |
976 077e 9091 0000 lds r25,(HiResRoll)+1 |
977 0782 280F add r18,r24 |
978 0784 391F adc r19,r25 |
979 0786 37FF sbrs r19,7 |
980 0788 02C0 rjmp .L92 |
981 078a 2F5F subi r18,lo8(-(1)) |
982 078c 3F4F sbci r19,hi8(-(1)) |
983 .L92: |
984 078e 3595 asr r19 |
985 0790 2795 ror r18 |
986 0792 3093 0000 sts (AdWertRollFilter)+1,r19 |
987 0796 2093 0000 sts AdWertRollFilter,r18 |
988 .L114: |
989 079a 83E0 ldi r24,lo8(3) |
990 079c 2FC1 rjmp .L109 |
991 .L93: |
992 079e 1092 0000 sts state.1,__zero_reg__ |
993 07a2 81E0 ldi r24,lo8(1) |
994 07a4 8093 0000 sts AdReady,r24 |
995 07a8 8091 0000 lds r24,ZaehlMessungen |
996 07ac 9091 0000 lds r25,(ZaehlMessungen)+1 |
997 07b0 0196 adiw r24,1 |
998 07b2 9093 0000 sts (ZaehlMessungen)+1,r25 |
999 07b6 8093 0000 sts ZaehlMessungen,r24 |
1000 .L94: |
1001 07ba 8091 7800 lds r24,120 |
1002 07be 9091 7900 lds r25,(120)+1 |
1003 07c2 9093 0000 sts (MessLuftdruck)+1,r25 |
1004 07c6 8093 0000 sts MessLuftdruck,r24 |
1005 07ca 8091 0000 lds r24,MessLuftdruck |
1006 07ce 9091 0000 lds r25,(MessLuftdruck)+1 |
1007 07d2 AA27 clr r26 |
1008 07d4 BB27 clr r27 |
1009 07d6 A090 0000 lds r10,tmpLuftdruck.10 |
1010 07da B090 0000 lds r11,(tmpLuftdruck.10)+1 |
1011 07de C090 0000 lds r12,(tmpLuftdruck.10)+2 |
1012 07e2 D090 0000 lds r13,(tmpLuftdruck.10)+3 |
1013 07e6 A80E add r10,r24 |
1014 07e8 B91E adc r11,r25 |
1015 07ea CA1E adc r12,r26 |
1016 07ec DB1E adc r13,r27 |
1017 07ee A092 0000 sts tmpLuftdruck.10,r10 |
1018 07f2 B092 0000 sts (tmpLuftdruck.10)+1,r11 |
1019 07f6 C092 0000 sts (tmpLuftdruck.10)+2,r12 |
1020 07fa D092 0000 sts (tmpLuftdruck.10)+3,r13 |
1021 07fe 8091 0000 lds r24,messanzahl_Druck.11 |
1022 0802 8F5F subi r24,lo8(-(1)) |
1023 0804 8093 0000 sts messanzahl_Druck.11,r24 |
1024 0808 8231 cpi r24,lo8(18) |
1025 080a 08F4 brsh .+2 |
1026 080c F6C0 rjmp .L108 |
1027 080e 8091 0000 lds r24,Luftdruck |
1028 0812 9091 0000 lds r25,(Luftdruck)+1 |
1029 0816 A091 0000 lds r26,(Luftdruck)+2 |
1030 081a B091 0000 lds r27,(Luftdruck)+3 |
1031 081e 7C01 movw r14,r24 |
1032 0820 8D01 movw r16,r26 |
1033 0822 23E0 ldi r18,3 |
1034 0824 EE0C 1: lsl r14 |
1035 0826 FF1C rol r15 |
1036 0828 001F rol r16 |
1037 082a 111F rol r17 |
1038 082c 2A95 dec r18 |
1039 082e D1F7 brne 1b |
1040 0830 E81A sub r14,r24 |
1041 0832 F90A sbc r15,r25 |
1042 0834 0A0B sbc r16,r26 |
1043 0836 1B0B sbc r17,r27 |
1044 0838 EA0C add r14,r10 |
1045 083a FB1C adc r15,r11 |
1046 083c 0C1D adc r16,r12 |
1047 083e 1D1D adc r17,r13 |
1048 0840 8091 0000 lds r24,ExpandBaro |
1049 0844 9927 clr r25 |
1050 0846 87FD sbrc r24,7 |
1051 0848 9095 com r25 |
1052 084a A92F mov r26,r25 |
1053 084c B92F mov r27,r25 |
1054 084e BC01 movw r22,r24 |
1055 0850 CD01 movw r24,r26 |
1056 0852 26EC ldi r18,lo8(9414) |
1057 0854 34E2 ldi r19,hi8(9414) |
1058 0856 40E0 ldi r20,hlo8(9414) |
1059 0858 50E0 ldi r21,hhi8(9414) |
1060 085a 0E94 0000 call __mulsi3 |
1061 085e DC01 movw r26,r24 |
1062 0860 CB01 movw r24,r22 |
1063 0862 E81A sub r14,r24 |
1064 0864 F90A sbc r15,r25 |
1065 0866 0A0B sbc r16,r26 |
1066 0868 1B0B sbc r17,r27 |
1067 086a D801 movw r26,r16 |
1068 086c C701 movw r24,r14 |
1069 086e 0496 adiw r24,4 |
1070 0870 A11D adc r26,__zero_reg__ |
1071 0872 B11D adc r27,__zero_reg__ |
1072 0874 B7FF sbrs r27,7 |
1073 0876 05C0 rjmp .L96 |
1074 0878 D801 movw r26,r16 |
1075 087a C701 movw r24,r14 |
1076 087c 0B96 adiw r24,11 |
1077 087e A11D adc r26,__zero_reg__ |
1078 0880 B11D adc r27,__zero_reg__ |
1079 .L96: |
1080 0882 13E0 ldi r17,3 |
1081 0884 B595 1: asr r27 |
1082 0886 A795 ror r26 |
1083 0888 9795 ror r25 |
1084 088a 8795 ror r24 |
1085 088c 1A95 dec r17 |
1086 088e D1F7 brne 1b |
1087 0890 8093 0000 sts Luftdruck,r24 |
1088 0894 9093 0000 sts (Luftdruck)+1,r25 |
1089 0898 A093 0000 sts (Luftdruck)+2,r26 |
1090 089c B093 0000 sts (Luftdruck)+3,r27 |
1091 08a0 8091 0000 lds r24,StartLuftdruck |
1092 08a4 9091 0000 lds r25,(StartLuftdruck)+1 |
1093 08a8 7C01 movw r14,r24 |
1094 08aa 0027 clr r16 |
1095 08ac F7FC sbrc r15,7 |
1096 08ae 0095 com r16 |
1097 08b0 102F mov r17,r16 |
1098 08b2 8091 0000 lds r24,Luftdruck |
1099 08b6 9091 0000 lds r25,(Luftdruck)+1 |
1100 08ba A091 0000 lds r26,(Luftdruck)+2 |
1101 08be B091 0000 lds r27,(Luftdruck)+3 |
1102 08c2 E81A sub r14,r24 |
1103 08c4 F90A sbc r15,r25 |
1104 08c6 0A0B sbc r16,r26 |
1105 08c8 1B0B sbc r17,r27 |
1106 08ca E092 0000 sts HoehenWert,r14 |
1107 08ce F092 0000 sts (HoehenWert)+1,r15 |
1108 08d2 0093 0000 sts (HoehenWert)+2,r16 |
1109 08d6 1093 0000 sts (HoehenWert)+3,r17 |
1110 08da 2091 0000 lds r18,SummenHoehe |
1111 08de 3091 0000 lds r19,(SummenHoehe)+1 |
1112 08e2 4091 0000 lds r20,(SummenHoehe)+2 |
1113 08e6 5091 0000 lds r21,(SummenHoehe)+3 |
1114 08ea 57FF sbrs r21,7 |
1115 08ec 04C0 rjmp .L97 |
1116 08ee 215F subi r18,lo8(-(15)) |
1117 08f0 3F4F sbci r19,hi8(-(15)) |
1118 08f2 4F4F sbci r20,hlo8(-(15)) |
1119 08f4 5F4F sbci r21,hhi8(-(15)) |
1120 .L97: |
1121 08f6 F4E0 ldi r31,4 |
1122 08f8 5595 1: asr r21 |
1123 08fa 4795 ror r20 |
1124 08fc 3795 ror r19 |
1125 08fe 2795 ror r18 |
1126 0900 FA95 dec r31 |
1127 0902 D1F7 brne 1b |
1128 0904 8091 0000 lds r24,SummenHoehe |
1129 0908 9091 0000 lds r25,(SummenHoehe)+1 |
1130 090c A091 0000 lds r26,(SummenHoehe)+2 |
1131 0910 B091 0000 lds r27,(SummenHoehe)+3 |
1132 0914 821B sub r24,r18 |
1133 0916 930B sbc r25,r19 |
1134 0918 A40B sbc r26,r20 |
1135 091a B50B sbc r27,r21 |
1136 091c 8093 0000 sts SummenHoehe,r24 |
1137 0920 9093 0000 sts (SummenHoehe)+1,r25 |
1138 0924 A093 0000 sts (SummenHoehe)+2,r26 |
1139 0928 B093 0000 sts (SummenHoehe)+3,r27 |
1140 092c 8091 0000 lds r24,SummenHoehe |
1141 0930 9091 0000 lds r25,(SummenHoehe)+1 |
1142 0934 A091 0000 lds r26,(SummenHoehe)+2 |
1143 0938 B091 0000 lds r27,(SummenHoehe)+3 |
1144 093c 8E0D add r24,r14 |
1145 093e 9F1D adc r25,r15 |
1146 0940 A01F adc r26,r16 |
1147 0942 B11F adc r27,r17 |
1148 0944 8093 0000 sts SummenHoehe,r24 |
1149 0948 9093 0000 sts (SummenHoehe)+1,r25 |
1150 094c A093 0000 sts (SummenHoehe)+2,r26 |
1151 0950 B093 0000 sts (SummenHoehe)+3,r27 |
1152 0954 8091 0000 lds r24,VarioMeter |
1153 0958 9091 0000 lds r25,(VarioMeter)+1 |
1154 095c AC01 movw r20,r24 |
1155 095e E5E0 ldi r30,5 |
1156 0960 440F 1: lsl r20 |
1157 0962 551F rol r21 |
1158 0964 EA95 dec r30 |
1159 0966 E1F7 brne 1b |
1160 0968 481B sub r20,r24 |
1161 096a 590B sbc r21,r25 |
1162 096c 8091 0000 lds r24,SummenHoehe |
1163 0970 9091 0000 lds r25,(SummenHoehe)+1 |
1164 0974 A091 0000 lds r26,(SummenHoehe)+2 |
1165 0978 B091 0000 lds r27,(SummenHoehe)+3 |
1166 097c B7FF sbrs r27,7 |
1167 097e 03C0 rjmp .L98 |
1168 0980 0F96 adiw r24,15 |
1169 0982 A11D adc r26,__zero_reg__ |
1170 0984 B11D adc r27,__zero_reg__ |
1171 .L98: |
1172 0986 74E0 ldi r23,4 |
1173 0988 B595 1: asr r27 |
1174 098a A795 ror r26 |
1175 098c 9795 ror r25 |
1176 098e 8795 ror r24 |
1177 0990 7A95 dec r23 |
1178 0992 D1F7 brne 1b |
1179 0994 2091 0000 lds r18,HoehenWert |
1180 0998 3091 0000 lds r19,(HoehenWert)+1 |
1181 099c 281B sub r18,r24 |
1182 099e 390B sbc r19,r25 |
1183 09a0 63E0 ldi r22,3 |
1184 09a2 220F 1: lsl r18 |
1185 09a4 331F rol r19 |
1186 09a6 6A95 dec r22 |
1187 09a8 E1F7 brne 1b |
1188 09aa 240F add r18,r20 |
1189 09ac 351F adc r19,r21 |
1190 09ae 37FF sbrs r19,7 |
1191 09b0 02C0 rjmp .L99 |
1192 09b2 215E subi r18,lo8(-(31)) |
1193 09b4 3F4F sbci r19,hi8(-(31)) |
1194 .L99: |
1195 09b6 45E0 ldi r20,5 |
1196 09b8 3595 1: asr r19 |
1197 09ba 2795 ror r18 |
1198 09bc 4A95 dec r20 |
1199 09be E1F7 brne 1b |
1200 09c0 3093 0000 sts (VarioMeter)+1,r19 |
1201 09c4 2093 0000 sts VarioMeter,r18 |
1202 09c8 D601 movw r26,r12 |
1203 09ca C501 movw r24,r10 |
1204 09cc D7FE sbrs r13,7 |
1205 09ce 03C0 rjmp .L100 |
1206 09d0 0196 adiw r24,1 |
1207 09d2 A11D adc r26,__zero_reg__ |
1208 09d4 B11D adc r27,__zero_reg__ |
1209 .L100: |
1210 09d6 B595 asr r27 |
1211 09d8 A795 ror r26 |
1212 09da 9795 ror r25 |
1213 09dc 8795 ror r24 |
1214 09de 8093 0000 sts tmpLuftdruck.10,r24 |
1215 09e2 9093 0000 sts (tmpLuftdruck.10)+1,r25 |
1216 09e6 A093 0000 sts (tmpLuftdruck.10)+2,r26 |
1217 09ea B093 0000 sts (tmpLuftdruck.10)+3,r27 |
1218 09ee 89E0 ldi r24,lo8(9) |
1219 09f0 8093 0000 sts messanzahl_Druck.11,r24 |
1220 09f4 02C0 rjmp .L108 |
1221 .L101: |
1222 09f6 1092 0000 sts state.1,__zero_reg__ |
1223 .L108: |
1224 09fa 82E0 ldi r24,lo8(2) |
1225 .L109: |
1226 09fc 8093 0000 sts kanal.0,r24 |
1227 .L52: |
1228 0a00 8091 0000 lds r24,kanal.0 |
1229 0a04 8093 7C00 sts 124,r24 |
1230 0a08 8091 0000 lds r24,state.1 |
1231 0a0c 8823 tst r24 |
1232 0a0e 19F0 breq .L51 |
1233 0a10 8FEC ldi r24,lo8(-49) |
1234 0a12 8093 7A00 sts 122,r24 |
1235 .L51: |
1236 /* epilogue: frame size=0 */ |
1237 0a16 FF91 pop r31 |
1238 0a18 EF91 pop r30 |
1239 0a1a BF91 pop r27 |
1240 0a1c AF91 pop r26 |
1241 0a1e 9F91 pop r25 |
1242 0a20 8F91 pop r24 |
1243 0a22 7F91 pop r23 |
1244 0a24 6F91 pop r22 |
1245 0a26 5F91 pop r21 |
1246 0a28 4F91 pop r20 |
1247 0a2a 3F91 pop r19 |
1248 0a2c 2F91 pop r18 |
1249 0a2e 1F91 pop r17 |
1250 0a30 0F91 pop r16 |
1251 0a32 FF90 pop r15 |
1252 0a34 EF90 pop r14 |
1253 0a36 DF90 pop r13 |
1254 0a38 CF90 pop r12 |
1255 0a3a BF90 pop r11 |
1256 0a3c AF90 pop r10 |
1257 0a3e 0F90 pop __tmp_reg__ |
1258 0a40 0FBE out __SREG__,__tmp_reg__ |
1259 0a42 0F90 pop __tmp_reg__ |
1260 0a44 1F90 pop __zero_reg__ |
1261 0a46 1895 reti |
1262 /* epilogue end (size=25) */ |
1263 /* function __vector_24 size 1014 (964) */ |
1265 .comm Aktuell_Nick,2,1 |
1266 .comm Aktuell_Roll,2,1 |
1267 .comm Aktuell_Gier,2,1 |
1268 .comm Aktuell_ax,2,1 |
1269 .comm Aktuell_ay,2,1 |
1270 .comm Aktuell_az,2,1 |
1271 .comm DruckOffsetSetting,1,1 |
1272 .comm StartLuftdruck,2,1 |
1273 .comm NeutralAccZ_float,4,1 |
1274 /* File "analog.c": code 1351 = 0x0547 (1286), prologues 31, epilogues 34 */ |
DEFINED SYMBOLS |
*ABS*:00000000 analog.c |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:2 *ABS*:0000003f __SREG__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:3 *ABS*:0000003e __SP_H__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:4 *ABS*:0000003d __SP_L__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:5 *ABS*:00000034 __CCP__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:6 *ABS*:00000000 __tmp_reg__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:7 *ABS*:00000001 __zero_reg__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:11 .text:00000000 ADC_Init |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:22 .text:0000000c __vector_24 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:1212 .bss:00000030 state.2325 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:1208 .bss:00000029 nick1.2329 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:1210 .bss:0000002d gier1.2327 |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:3 *ABS*:0000003f __SREG__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:4 *ABS*:0000003e __SP_H__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:5 *ABS*:0000003d __SP_L__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:6 *ABS*:00000000 __tmp_reg__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:7 *ABS*:00000001 __zero_reg__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:14 .data:00000000 AdReady |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:19 .data:00000001 AnalogOffsetGier |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:24 .data:00000002 AnalogOffsetRoll |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:29 .data:00000003 AnalogOffsetNick |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:36 .bss:00000000 ZaehlMessungen |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:42 .bss:00000002 VarioMeter |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:48 .bss:00000004 ExpandBaro |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:54 .data:00000004 MessLuftdruck |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:61 .bss:00000005 SummenHoehe |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:67 .data:00000006 Luftdruck |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:74 .bss:00000009 messanzahl_AccHoch |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:80 .bss:0000000a AdWertAccHoch |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:86 .bss:0000000c AdWertAccNick |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:92 .bss:0000000e AdWertAccRoll |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:98 .bss:00000010 AdWertGier |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:104 .bss:00000012 AdWertRoll |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:110 .bss:00000014 AdWertNick |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:116 .data:0000000a HiResRoll |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:121 .data:0000000c HiResNick |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:128 .bss:00000016 AdWertGierFilter |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:134 .bss:00000018 AdWertRollFilter |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:140 .bss:0000001a AdWertNickFilter |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:146 .data:0000000e UBat |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:151 .text:00000000 ADC_Init |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:165 .progmem.data:00000000 __c.13 |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:170 .text:0000000c SucheLuftruckOffset |
*COM*:00000001 DruckOffsetSetting |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:258 .progmem.data:00000002 __c.12 |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:263 .text:000000c2 SucheGyroOffset |
.bss:0000001c kanal.0 |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:466 .bss:0000001d state.1 |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:467 .bss:0000001e subcount.2 |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:468 .bss:0000001f gier1.3 |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:469 .bss:00000021 roll1.4 |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:470 .bss:00000023 nick1.5 |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:471 .bss:00000025 nick_filter.6 |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:472 .bss:00000027 roll_filter.7 |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:473 .bss:00000029 accy.8 |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:474 .bss:0000002b accx.9 |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:475 .bss:0000002d tmpLuftdruck.10 |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:476 .bss:00000031 messanzahl_Druck.11 |
C:\Users\Arthur-P\AppData\Local\Temp/ccEZbaaa.s:480 .text:00000290 __vector_24 |
*COM*:00000002 Aktuell_ay |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:1205 .bss:00000023 accy.2332 |
*COM*:00000002 Aktuell_ax |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:1204 .bss:00000021 accx.2333 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:1209 .bss:0000002b roll1.2328 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:1066 .data:00000000 UBat |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:1133 .bss:00000010 AdWertAccHoch |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:1211 .bss:0000002f subcount.2326 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:1139 .bss:00000012 messanzahl_AccHoch |
*COM*:00000002 Aktuell_az |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:1213 .bss:00000031 kanal.2324 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:1115 .bss:0000000a AdWertGier |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:1121 .bss:0000000c AdWertAccRoll |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:1127 .bss:0000000e AdWertAccNick |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:1103 .bss:00000006 AdWertNick |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:1207 .bss:00000027 nick_filter.2330 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:1091 .data:00000002 HiResNick |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:1073 .bss:00000000 AdWertNickFilter |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:1109 .bss:00000008 AdWertRoll |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:1206 .bss:00000025 roll_filter.2331 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:1096 .data:00000004 HiResRoll |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:1079 .bss:00000002 AdWertRollFilter |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:1201 .data:0000000f AdReady |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:1180 .bss:0000001a ZaehlMessungen |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:1161 .data:0000000a MessLuftdruck |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:1203 .bss:0000001d tmpLuftdruck.2334 |
.bss:0000001c messanzahl_Druck.2335 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:1145 .data:00000006 Luftdruck |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:1168 .bss:00000017 ExpandBaro |
*COM*:00000002 StartLuftdruck |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:1155 .bss:00000013 SummenHoehe |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:1174 .bss:00000018 VarioMeter |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:752 .text:0000077a SucheGyroOffset |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:1218 .progmem.data:00000000 __c.2279 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:1186 .data:0000000c AnalogOffsetNick |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:1191 .data:0000000d AnalogOffsetRoll |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:1196 .data:0000000e AnalogOffsetGier |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:964 .text:0000095c SucheLuftruckOffset |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:1222 .progmem.data:00000037 __c.2252 |
*COM*:00000001 DruckOffsetSetting |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccewM8xd.s:1085 .bss:00000004 AdWertGierFilter |
*COM*:00000002 Aktuell_Nick |
*COM*:00000002 Aktuell_Roll |
*COM*:00000002 Aktuell_Gier |
1238,6 → 1277,19 |
*COM*:00000004 NeutralAccZ_float |
UNDEFINED SYMBOLS |
__do_copy_data |
__do_clear_bss |
GetParamByte |
Delay_ms_Mess |
uart_putchar |
_printf_P |
SetParamByte |
EE_Parameter |
VersionInfo |
SetDelay |
twi_state |
BLFlags |
CheckDelay |
__tablejump2__ |
NeutralAccY |
NeutralAccX |
1245,25 → 1297,8 |
NeutralAccZ |
modell_fliegt |
Mess_Integral_Hoch |
__divmodsi4 |
PlatinenVersion |
__divmodhi4 |
AdNeutralNick |
AdNeutralRoll |
__mulsi3 |
HoehenWert |
__prologue_saves__ |
SetDelay |
uart_putchar |
twi_state |
BLFlags |
VersionInfo |
CheckDelay |
_printf_P |
Delay_ms_Mess |
__epilogue_restores__ |
GetParamByte |
SetParamByte |
EE_Parameter |
__do_copy_data |
__do_clear_bss |
/branches/V0.80g-Arthur-P1/capacity.lst |
---|
1,223 → 1,229 |
1 .file "capacity.c" |
2 __SREG__ = 0x3f |
3 __SP_H__ = 0x3e |
4 __SP_L__ = 0x3d |
5 __CCP__ = 0x34 |
2 .arch atmega644p |
3 __SREG__ = 0x3f |
4 __SP_H__ = 0x3e |
5 __SP_L__ = 0x3d |
6 __tmp_reg__ = 0 |
7 __zero_reg__ = 1 |
8 .text |
9 .global Capacity_Update |
11 Capacity_Update: |
12 /* prologue: function */ |
13 /* frame size = 0 */ |
14 0000 8091 0000 lds r24,update_timer |
15 0004 9091 0000 lds r25,(update_timer)+1 |
16 0008 0E94 0000 call CheckDelay |
17 000c 8823 tst r24 |
18 000e 01F4 brne .+2 |
19 0010 00C0 rjmp .L13 |
20 0012 8091 0000 lds r24,update_timer |
21 0016 9091 0000 lds r25,(update_timer)+1 |
22 001a 0A96 adiw r24,10 |
23 001c 9093 0000 sts (update_timer)+1,r25 |
24 0020 8093 0000 sts update_timer,r24 |
25 0024 E0E0 ldi r30,lo8(Motor+1) |
26 0026 F0E0 ldi r31,hi8(Motor+1) |
27 0028 60E0 ldi r22,lo8(0) |
28 002a 70E0 ldi r23,hi8(0) |
29 002c 40E0 ldi r20,lo8(0) |
30 002e 50E0 ldi r21,hi8(0) |
31 0030 90E0 ldi r25,lo8(0) |
32 0032 AFEF ldi r26,lo8(-1) |
33 .L6: |
34 0034 8281 ldd r24,Z+2 |
35 0036 87FF sbrs r24,7 |
36 0038 00C0 rjmp .L3 |
37 003a 9F5F subi r25,lo8(-(1)) |
38 003c 8481 ldd r24,Z+4 |
39 003e 680F add r22,r24 |
40 0040 711D adc r23,__zero_reg__ |
41 0042 8081 ld r24,Z |
42 0044 480F add r20,r24 |
43 0046 511D adc r21,__zero_reg__ |
44 0048 8581 ldd r24,Z+5 |
45 004a 8A17 cp r24,r26 |
46 004c 00F0 brlo .L4 |
47 .L3: |
48 004e 8A2F mov r24,r26 |
49 .L4: |
50 0050 3896 adiw r30,8 |
51 0052 20E0 ldi r18,hi8(Motor+97) |
52 0054 E030 cpi r30,lo8(Motor+97) |
53 0056 F207 cpc r31,r18 |
54 0058 01F0 breq .L5 |
55 005a A82F mov r26,r24 |
56 005c 00C0 rjmp .L6 |
57 .L5: |
58 005e 8093 0000 sts Capacity+6,r24 |
59 0062 452B or r20,r21 |
60 0064 01F4 brne .L7 |
61 0066 8091 0000 lds r24,SumCurrentOffset.2245 |
62 006a 9091 0000 lds r25,(SumCurrentOffset.2245)+1 |
63 006e A091 0000 lds r26,(SumCurrentOffset.2245)+2 |
64 0072 B091 0000 lds r27,(SumCurrentOffset.2245)+3 |
65 0076 292F mov r18,r25 |
66 0078 3A2F mov r19,r26 |
67 007a 4B2F mov r20,r27 |
68 007c 5527 clr r21 |
69 007e 3093 0000 sts (CurrentOffset.2244)+1,r19 |
70 0082 2093 0000 sts CurrentOffset.2244,r18 |
71 0086 40E0 ldi r20,lo8(0) |
72 0088 50E0 ldi r21,hi8(0) |
73 008a 821B sub r24,r18 |
74 008c 930B sbc r25,r19 |
75 008e A40B sbc r26,r20 |
76 0090 B50B sbc r27,r21 |
77 0092 9B01 movw r18,r22 |
78 0094 40E0 ldi r20,lo8(0) |
79 0096 50E0 ldi r21,hi8(0) |
80 0098 820F add r24,r18 |
81 009a 931F adc r25,r19 |
82 009c A41F adc r26,r20 |
83 009e B51F adc r27,r21 |
84 00a0 8093 0000 sts SumCurrentOffset.2245,r24 |
85 00a4 9093 0000 sts (SumCurrentOffset.2245)+1,r25 |
86 00a8 A093 0000 sts (SumCurrentOffset.2245)+2,r26 |
87 00ac B093 0000 sts (SumCurrentOffset.2245)+3,r27 |
88 00b0 E5E0 ldi r30,lo8(5) |
89 00b2 F0E0 ldi r31,hi8(5) |
90 00b4 00C0 rjmp .L8 |
91 .L7: |
92 00b6 4091 0000 lds r20,CurrentOffset.2244 |
93 00ba 5091 0000 lds r21,(CurrentOffset.2244)+1 |
94 00be 4617 cp r20,r22 |
95 00c0 5707 cpc r21,r23 |
96 00c2 00F0 brlo .L9 |
97 00c4 20E0 ldi r18,lo8(0) |
98 00c6 30E0 ldi r19,hi8(0) |
99 00c8 00C0 rjmp .L10 |
100 .L9: |
101 00ca 9B01 movw r18,r22 |
102 00cc 241B sub r18,r20 |
103 00ce 350B sbc r19,r21 |
104 .L10: |
105 00d0 E92F mov r30,r25 |
106 00d2 F0E0 ldi r31,lo8(0) |
107 00d4 EE0F lsl r30 |
108 00d6 FF1F rol r31 |
109 00d8 3596 adiw r30,5 |
110 00da E20F add r30,r18 |
111 00dc F31F adc r31,r19 |
112 .L8: |
113 00de F093 0000 sts (Capacity)+1,r31 |
114 00e2 E093 0000 sts Capacity,r30 |
115 00e6 EF3F cpi r30,255 |
116 00e8 F105 cpc r31,__zero_reg__ |
117 00ea 00F4 brsh .L11 |
118 00ec 8091 0000 lds r24,UBat |
119 00f0 9091 0000 lds r25,(UBat)+1 |
120 00f4 AC01 movw r20,r24 |
121 00f6 E49F mul r30,r20 |
122 00f8 C001 movw r24,r0 |
123 00fa E59F mul r30,r21 |
124 00fc 900D add r25,r0 |
125 00fe F49F mul r31,r20 |
126 0100 900D add r25,r0 |
127 0102 1124 clr r1 |
128 0104 64E6 ldi r22,lo8(100) |
129 0106 70E0 ldi r23,hi8(100) |
130 0108 00C0 rjmp .L14 |
131 .L11: |
132 010a 8091 0000 lds r24,UBat |
133 010e 9091 0000 lds r25,(UBat)+1 |
134 0112 9F01 movw r18,r30 |
135 0114 3695 lsr r19 |
136 0116 2795 ror r18 |
137 0118 3695 lsr r19 |
138 011a 2795 ror r18 |
139 011c AC01 movw r20,r24 |
140 011e 249F mul r18,r20 |
141 0120 C001 movw r24,r0 |
142 0122 259F mul r18,r21 |
143 0124 900D add r25,r0 |
144 0126 349F mul r19,r20 |
145 0128 900D add r25,r0 |
146 012a 1124 clr r1 |
147 012c 69E1 ldi r22,lo8(25) |
148 012e 70E0 ldi r23,hi8(25) |
149 .L14: |
150 0130 0E94 0000 call __udivmodhi4 |
151 0134 7093 0000 sts (Capacity+2)+1,r23 |
152 0138 6093 0000 sts Capacity+2,r22 |
153 013c 2091 0000 lds r18,SubCounter.2243 |
154 0140 3091 0000 lds r19,(SubCounter.2243)+1 |
155 0144 2E0F add r18,r30 |
156 0146 3F1F adc r19,r31 |
157 0148 3093 0000 sts (SubCounter.2243)+1,r19 |
158 014c 2093 0000 sts SubCounter.2243,r18 |
159 0150 5EE0 ldi r21,hi8(3601) |
160 0152 2131 cpi r18,lo8(3601) |
161 0154 3507 cpc r19,r21 |
162 0156 00F0 brlo .L13 |
163 0158 8091 0000 lds r24,Capacity+4 |
164 015c 9091 0000 lds r25,(Capacity+4)+1 |
165 0160 0196 adiw r24,1 |
166 0162 9093 0000 sts (Capacity+4)+1,r25 |
167 0166 8093 0000 sts Capacity+4,r24 |
168 016a 2051 subi r18,lo8(-(-3600)) |
169 016c 3E40 sbci r19,hi8(-(-3600)) |
170 016e 3093 0000 sts (SubCounter.2243)+1,r19 |
171 0172 2093 0000 sts SubCounter.2243,r18 |
172 .L13: |
173 0176 0895 ret |
175 .global Capacity_Init |
177 Capacity_Init: |
178 /* prologue: function */ |
179 /* frame size = 0 */ |
180 0178 1092 0000 sts (Capacity)+1,__zero_reg__ |
181 017c 1092 0000 sts Capacity,__zero_reg__ |
182 0180 1092 0000 sts (Capacity+4)+1,__zero_reg__ |
183 0184 1092 0000 sts Capacity+4,__zero_reg__ |
184 0188 1092 0000 sts (Capacity+2)+1,__zero_reg__ |
185 018c 1092 0000 sts Capacity+2,__zero_reg__ |
186 0190 1092 0000 sts Capacity+6,__zero_reg__ |
187 0194 8AE0 ldi r24,lo8(10) |
188 0196 90E0 ldi r25,hi8(10) |
189 0198 0E94 0000 call SetDelay |
190 019c 9093 0000 sts (update_timer)+1,r25 |
191 01a0 8093 0000 sts update_timer,r24 |
192 /* epilogue start */ |
193 01a4 0895 ret |
195 .global update_timer |
196 .global update_timer |
197 .section .bss |
200 update_timer: |
201 0000 0000 .skip 2,0 |
202 .lcomm SumCurrentOffset.2245,4 |
203 .lcomm CurrentOffset.2244,2 |
204 .lcomm SubCounter.2243,2 |
205 .comm Capacity,7,1 |
206 .global __do_clear_bss |
8 .global __do_copy_data |
9 .global __do_clear_bss |
10 .global update_timer |
11 .global update_timer |
12 .section .bss |
15 update_timer: |
16 0000 0000 .skip 2,0 |
17 .text |
18 .global Capacity_Init |
20 Capacity_Init: |
21 /* prologue: frame size=0 */ |
22 /* prologue end (size=0) */ |
23 0000 1092 0000 sts (Capacity)+1,__zero_reg__ |
24 0004 1092 0000 sts Capacity,__zero_reg__ |
25 0008 1092 0000 sts (Capacity+4)+1,__zero_reg__ |
26 000c 1092 0000 sts Capacity+4,__zero_reg__ |
27 0010 1092 0000 sts (Capacity+2)+1,__zero_reg__ |
28 0014 1092 0000 sts Capacity+2,__zero_reg__ |
29 0018 1092 0000 sts Capacity+6,__zero_reg__ |
30 001c 8AE0 ldi r24,lo8(10) |
31 001e 90E0 ldi r25,hi8(10) |
32 0020 0E94 0000 call SetDelay |
33 0024 9093 0000 sts (update_timer)+1,r25 |
34 0028 8093 0000 sts update_timer,r24 |
35 /* epilogue: frame size=0 */ |
36 002c 0895 ret |
37 /* epilogue end (size=1) */ |
38 /* function Capacity_Init size 23 (22) */ |
40 .lcomm SubCounter.0,2 |
41 .lcomm CurrentOffset.1,2 |
42 .lcomm SumCurrentOffset.2,4 |
43 .global Capacity_Update |
45 Capacity_Update: |
46 /* prologue: frame size=0 */ |
47 002e CF93 push r28 |
48 0030 DF93 push r29 |
49 /* prologue end (size=2) */ |
50 0032 8091 0000 lds r24,update_timer |
51 0036 9091 0000 lds r25,(update_timer)+1 |
52 003a 0E94 0000 call CheckDelay |
53 003e 8823 tst r24 |
54 0040 09F4 brne .+2 |
55 0042 AFC0 rjmp .L2 |
56 0044 8091 0000 lds r24,update_timer |
57 0048 9091 0000 lds r25,(update_timer)+1 |
58 004c 0A96 adiw r24,10 |
59 004e 9093 0000 sts (update_timer)+1,r25 |
60 0052 8093 0000 sts update_timer,r24 |
61 0056 E0E0 ldi r30,lo8(0) |
62 0058 F0E0 ldi r31,hi8(0) |
63 005a 9F01 movw r18,r30 |
64 005c 90E0 ldi r25,lo8(0) |
65 005e 5FEF ldi r21,lo8(-1) |
66 0060 A0E0 ldi r26,lo8(Motor) |
67 0062 B0E0 ldi r27,hi8(Motor) |
68 0064 4BE0 ldi r20,lo8(11) |
69 .L9: |
70 0066 ED01 movw r28,r26 |
71 0068 8B81 ldd r24,Y+3 |
72 006a 87FF sbrs r24,7 |
73 006c 0BC0 rjmp .L6 |
74 006e 9F5F subi r25,lo8(-(1)) |
75 0070 8D81 ldd r24,Y+5 |
76 0072 E80F add r30,r24 |
77 0074 F11D adc r31,__zero_reg__ |
78 0076 8981 ldd r24,Y+1 |
79 0078 280F add r18,r24 |
80 007a 311D adc r19,__zero_reg__ |
81 007c 8E81 ldd r24,Y+6 |
82 007e 8517 cp r24,r21 |
83 0080 08F4 brsh .L6 |
84 0082 582F mov r21,r24 |
85 .L6: |
86 0084 4150 subi r20,lo8(-(-1)) |
87 0086 1896 adiw r26,8 |
88 0088 47FF sbrs r20,7 |
89 008a EDCF rjmp .L9 |
90 008c 5093 0000 sts Capacity+6,r21 |
91 0090 232B or r18,r19 |
92 0092 41F5 brne .L10 |
93 0094 2091 0000 lds r18,SumCurrentOffset.2 |
94 0098 3091 0000 lds r19,(SumCurrentOffset.2)+1 |
95 009c 4091 0000 lds r20,(SumCurrentOffset.2)+2 |
96 00a0 5091 0000 lds r21,(SumCurrentOffset.2)+3 |
97 00a4 BB27 clr r27 |
98 00a6 A52F mov r26,r21 |
99 00a8 942F mov r25,r20 |
100 00aa 832F mov r24,r19 |
101 00ac 9093 0000 sts (CurrentOffset.1)+1,r25 |
102 00b0 8093 0000 sts CurrentOffset.1,r24 |
103 00b4 AA27 clr r26 |
104 00b6 BB27 clr r27 |
105 00b8 281B sub r18,r24 |
106 00ba 390B sbc r19,r25 |
107 00bc 4A0B sbc r20,r26 |
108 00be 5B0B sbc r21,r27 |
109 00c0 CF01 movw r24,r30 |
110 00c2 AA27 clr r26 |
111 00c4 BB27 clr r27 |
112 00c6 280F add r18,r24 |
113 00c8 391F adc r19,r25 |
114 00ca 4A1F adc r20,r26 |
115 00cc 5B1F adc r21,r27 |
116 00ce 2093 0000 sts SumCurrentOffset.2,r18 |
117 00d2 3093 0000 sts (SumCurrentOffset.2)+1,r19 |
118 00d6 4093 0000 sts (SumCurrentOffset.2)+2,r20 |
119 00da 5093 0000 sts (SumCurrentOffset.2)+3,r21 |
120 00de E5E0 ldi r30,lo8(5) |
121 00e0 F0E0 ldi r31,hi8(5) |
122 00e2 13C0 rjmp .L11 |
123 .L10: |
124 00e4 2091 0000 lds r18,CurrentOffset.1 |
125 00e8 3091 0000 lds r19,(CurrentOffset.1)+1 |
126 00ec 2E17 cp r18,r30 |
127 00ee 3F07 cpc r19,r31 |
128 00f0 18F4 brsh .L12 |
129 00f2 E21B sub r30,r18 |
130 00f4 F30B sbc r31,r19 |
131 00f6 02C0 rjmp .L13 |
132 .L12: |
133 00f8 E0E0 ldi r30,lo8(0) |
134 00fa F0E0 ldi r31,hi8(0) |
135 .L13: |
136 00fc 892F mov r24,r25 |
137 00fe 9927 clr r25 |
138 0100 880F add r24,r24 |
139 0102 991F adc r25,r25 |
140 0104 E80F add r30,r24 |
141 0106 F91F adc r31,r25 |
142 0108 3596 adiw r30,5 |
143 .L11: |
144 010a F093 0000 sts (Capacity)+1,r31 |
145 010e E093 0000 sts Capacity,r30 |
146 0112 EF3F cpi r30,255 |
147 0114 F105 cpc r31,__zero_reg__ |
148 0116 78F4 brsh .L14 |
149 0118 8091 0000 lds r24,UBat |
150 011c 9091 0000 lds r25,(UBat)+1 |
151 0120 8E9F mul r24,r30 |
152 0122 9001 movw r18,r0 |
153 0124 8F9F mul r24,r31 |
154 0126 300D add r19,r0 |
155 0128 9E9F mul r25,r30 |
156 012a 300D add r19,r0 |
157 012c 1124 clr r1 |
158 012e C901 movw r24,r18 |
159 0130 64E6 ldi r22,lo8(100) |
160 0132 70E0 ldi r23,hi8(100) |
161 0134 13C0 rjmp .L19 |
162 .L14: |
163 0136 CF01 movw r24,r30 |
164 0138 9695 lsr r25 |
165 013a 8795 ror r24 |
166 013c 9695 lsr r25 |
167 013e 8795 ror r24 |
168 0140 2091 0000 lds r18,UBat |
169 0144 3091 0000 lds r19,(UBat)+1 |
170 0148 289F mul r18,r24 |
171 014a A001 movw r20,r0 |
172 014c 299F mul r18,r25 |
173 014e 500D add r21,r0 |
174 0150 389F mul r19,r24 |
175 0152 500D add r21,r0 |
176 0154 1124 clr r1 |
177 0156 CA01 movw r24,r20 |
178 0158 69E1 ldi r22,lo8(25) |
179 015a 70E0 ldi r23,hi8(25) |
180 .L19: |
181 015c 0E94 0000 call __udivmodhi4 |
182 0160 7093 0000 sts (Capacity+2)+1,r23 |
183 0164 6093 0000 sts Capacity+2,r22 |
184 0168 2091 0000 lds r18,SubCounter.0 |
185 016c 3091 0000 lds r19,(SubCounter.0)+1 |
186 0170 2E0F add r18,r30 |
187 0172 3F1F adc r19,r31 |
188 0174 3093 0000 sts (SubCounter.0)+1,r19 |
189 0178 2093 0000 sts SubCounter.0,r18 |
190 017c 5EE0 ldi r21,hi8(3601) |
191 017e 2131 cpi r18,lo8(3601) |
192 0180 3507 cpc r19,r21 |
193 0182 78F0 brlo .L2 |
194 0184 8091 0000 lds r24,Capacity+4 |
195 0188 9091 0000 lds r25,(Capacity+4)+1 |
196 018c 0196 adiw r24,1 |
197 018e 9093 0000 sts (Capacity+4)+1,r25 |
198 0192 8093 0000 sts Capacity+4,r24 |
199 0196 2051 subi r18,lo8(-(-3600)) |
200 0198 3E40 sbci r19,hi8(-(-3600)) |
201 019a 3093 0000 sts (SubCounter.0)+1,r19 |
202 019e 2093 0000 sts SubCounter.0,r18 |
203 .L2: |
204 /* epilogue: frame size=0 */ |
205 01a2 DF91 pop r29 |
206 01a4 CF91 pop r28 |
207 01a6 0895 ret |
208 /* epilogue end (size=3) */ |
209 /* function Capacity_Update size 189 (184) */ |
211 .comm Capacity,7,1 |
212 /* File "capacity.c": code 212 = 0x00d4 ( 206), prologues 2, epilogues 4 */ |
DEFINED SYMBOLS |
*ABS*:00000000 capacity.c |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc3DnvEP.s:2 *ABS*:0000003f __SREG__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc3DnvEP.s:3 *ABS*:0000003e __SP_H__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc3DnvEP.s:4 *ABS*:0000003d __SP_L__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc3DnvEP.s:5 *ABS*:00000034 __CCP__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc3DnvEP.s:6 *ABS*:00000000 __tmp_reg__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc3DnvEP.s:7 *ABS*:00000001 __zero_reg__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc3DnvEP.s:11 .text:00000000 Capacity_Update |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc3DnvEP.s:200 .bss:00000000 update_timer |
C:\Users\Arthur-P\AppData\Local\Temp/cckHbaaa.s:3 *ABS*:0000003f __SREG__ |
C:\Users\Arthur-P\AppData\Local\Temp/cckHbaaa.s:4 *ABS*:0000003e __SP_H__ |
C:\Users\Arthur-P\AppData\Local\Temp/cckHbaaa.s:5 *ABS*:0000003d __SP_L__ |
C:\Users\Arthur-P\AppData\Local\Temp/cckHbaaa.s:6 *ABS*:00000000 __tmp_reg__ |
C:\Users\Arthur-P\AppData\Local\Temp/cckHbaaa.s:7 *ABS*:00000001 __zero_reg__ |
C:\Users\Arthur-P\AppData\Local\Temp/cckHbaaa.s:15 .bss:00000000 update_timer |
C:\Users\Arthur-P\AppData\Local\Temp/cckHbaaa.s:20 .text:00000000 Capacity_Init |
*COM*:00000007 Capacity |
.bss:00000002 SumCurrentOffset.2245 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc3DnvEP.s:202 .bss:00000006 CurrentOffset.2244 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc3DnvEP.s:203 .bss:00000008 SubCounter.2243 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc3DnvEP.s:177 .text:00000178 Capacity_Init |
.bss:00000002 SubCounter.0 |
C:\Users\Arthur-P\AppData\Local\Temp/cckHbaaa.s:40 .bss:00000004 CurrentOffset.1 |
C:\Users\Arthur-P\AppData\Local\Temp/cckHbaaa.s:41 .bss:00000006 SumCurrentOffset.2 |
C:\Users\Arthur-P\AppData\Local\Temp/cckHbaaa.s:45 .text:0000002e Capacity_Update |
UNDEFINED SYMBOLS |
__do_copy_data |
__do_clear_bss |
SetDelay |
CheckDelay |
Motor |
UBat |
__udivmodhi4 |
SetDelay |
__do_clear_bss |
/branches/V0.80g-Arthur-P1/debug.lst |
---|
1,17 → 1,21 |
1 .file "debug.c" |
2 __SREG__ = 0x3f |
3 __SP_H__ = 0x3e |
4 __SP_L__ = 0x3d |
5 __CCP__ = 0x34 |
2 .arch atmega644p |
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 /* File "debug.c": code 0 = 0x0000 ( 0), prologues 0, epilogues 0 */ |
DEFINED SYMBOLS |
*ABS*:00000000 debug.c |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cchXWPa5.s:2 *ABS*:0000003f __SREG__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cchXWPa5.s:3 *ABS*:0000003e __SP_H__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cchXWPa5.s:4 *ABS*:0000003d __SP_L__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cchXWPa5.s:5 *ABS*:00000034 __CCP__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cchXWPa5.s:6 *ABS*:00000000 __tmp_reg__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cchXWPa5.s:7 *ABS*:00000001 __zero_reg__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccSSbaaa.s:3 *ABS*:0000003f __SREG__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccSSbaaa.s:4 *ABS*:0000003e __SP_H__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccSSbaaa.s:5 *ABS*:0000003d __SP_L__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccSSbaaa.s:6 *ABS*:00000000 __tmp_reg__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccSSbaaa.s:7 *ABS*:00000001 __zero_reg__ |
NO UNDEFINED SYMBOLS |
UNDEFINED SYMBOLS |
__do_copy_data |
__do_clear_bss |
/branches/V0.80g-Arthur-P1/eeprom.lst |
---|
1,1633 → 1,1309 |
1 .file "eeprom.c" |
2 __SREG__ = 0x3f |
3 __SP_H__ = 0x3e |
4 __SP_L__ = 0x3d |
5 __CCP__ = 0x34 |
2 .arch atmega644p |
3 __SREG__ = 0x3f |
4 __SP_H__ = 0x3e |
5 __SP_L__ = 0x3d |
6 __tmp_reg__ = 0 |
7 __zero_reg__ = 1 |
8 .text |
10 eeprom_read_byte: |
11 /* prologue: function */ |
12 /* frame size = 0 */ |
13 0000 9C01 movw r18,r24 |
14 .L2: |
15 0002 F999 sbic 63-32,1 |
16 0004 00C0 rjmp .L2 |
17 0006 32BD out (65)+1-32,r19 |
18 0008 21BD out 65-32,r18 |
19 /* #APP */ |
20 ; 208 "c:/winavr-20090313/lib/gcc/../../avr/include/avr/eeprom.h" 1 |
21 /* START EEPROM READ CRITICAL SECTION */ |
22 000a F89A sbi 31, 0 |
23 000c 80B5 in r24, 32 |
24 /* END EEPROM READ CRITICAL SECTION */ |
25 |
26 ; 0 "" 2 |
27 /* epilogue start */ |
28 /* #NOAPP */ |
29 000e 0895 ret |
32 eeprom_write_byte: |
33 /* prologue: function */ |
34 /* frame size = 0 */ |
35 0010 9C01 movw r18,r24 |
36 .L6: |
37 0012 F999 sbic 63-32,1 |
38 0014 00C0 rjmp .L6 |
39 0016 1FBA out 63-32,__zero_reg__ |
40 0018 32BD out (65)+1-32,r19 |
41 001a 21BD out 65-32,r18 |
42 001c 60BD out 64-32,r22 |
43 /* #APP */ |
44 ; 315 "c:/winavr-20090313/lib/gcc/../../avr/include/avr/eeprom.h" 1 |
45 /* START EEPROM WRITE CRITICAL SECTION */ |
46 001e 0FB6 in r0, 63 |
47 0020 F894 cli |
48 0022 FA9A sbi 31, 2 |
49 0024 F99A sbi 31, 1 |
50 0026 0FBE out 63, r0 |
51 /* END EEPROM WRITE CRITICAL SECTION */ |
52 ; 0 "" 2 |
53 /* epilogue start */ |
54 /* #NOAPP */ |
55 0028 0895 ret |
57 .global RAM_Checksum |
59 RAM_Checksum: |
60 /* prologue: function */ |
61 /* frame size = 0 */ |
62 002a DC01 movw r26,r24 |
63 002c 4AEA ldi r20,lo8(-86) |
64 002e 20E0 ldi r18,lo8(0) |
65 0030 30E0 ldi r19,hi8(0) |
66 0032 00C0 rjmp .L10 |
67 .L11: |
68 0034 FD01 movw r30,r26 |
69 0036 E20F add r30,r18 |
70 0038 F31F adc r31,r19 |
71 003a 8081 ld r24,Z |
72 003c 480F add r20,r24 |
73 003e 2F5F subi r18,lo8(-(1)) |
74 0040 3F4F sbci r19,hi8(-(1)) |
75 .L10: |
76 0042 2617 cp r18,r22 |
77 0044 3707 cpc r19,r23 |
78 0046 00F0 brlo .L11 |
79 0048 842F mov r24,r20 |
80 /* epilogue start */ |
81 004a 0895 ret |
83 .global EEProm_Checksum |
85 EEProm_Checksum: |
86 /* prologue: function */ |
87 /* frame size = 0 */ |
88 004c FC01 movw r30,r24 |
89 004e 4AEA ldi r20,lo8(-86) |
90 0050 20E0 ldi r18,lo8(0) |
91 0052 30E0 ldi r19,hi8(0) |
92 0054 00C0 rjmp .L14 |
93 .L17: |
94 0056 F999 sbic 63-32,1 |
95 0058 00C0 rjmp .L17 |
96 005a C901 movw r24,r18 |
97 005c 8E0F add r24,r30 |
98 005e 9F1F adc r25,r31 |
99 0060 92BD out (65)+1-32,r25 |
100 0062 81BD out 65-32,r24 |
101 /* #APP */ |
102 ; 208 "c:/winavr-20090313/lib/gcc/../../avr/include/avr/eeprom.h" 1 |
103 /* START EEPROM READ CRITICAL SECTION */ |
104 0064 F89A sbi 31, 0 |
105 0066 80B5 in r24, 32 |
106 /* END EEPROM READ CRITICAL SECTION */ |
107 |
108 ; 0 "" 2 |
109 /* #NOAPP */ |
110 0068 480F add r20,r24 |
111 006a 2F5F subi r18,lo8(-(1)) |
112 006c 3F4F sbci r19,hi8(-(1)) |
113 .L14: |
114 006e 2617 cp r18,r22 |
115 0070 3707 cpc r19,r23 |
116 0072 00F0 brlo .L17 |
117 0074 842F mov r24,r20 |
118 /* epilogue start */ |
119 0076 0895 ret |
121 .global ParamSet_DefaultStickMapping |
123 ParamSet_DefaultStickMapping: |
124 /* prologue: function */ |
125 /* frame size = 0 */ |
126 0078 81E0 ldi r24,lo8(1) |
127 007a 8093 0000 sts EE_Parameter+3,r24 |
128 007e 82E0 ldi r24,lo8(2) |
129 0080 8093 0000 sts EE_Parameter+2,r24 |
130 0084 83E0 ldi r24,lo8(3) |
131 0086 8093 0000 sts EE_Parameter+1,r24 |
132 008a 84E0 ldi r24,lo8(4) |
133 008c 8093 0000 sts EE_Parameter+4,r24 |
134 0090 85E0 ldi r24,lo8(5) |
135 0092 8093 0000 sts EE_Parameter+5,r24 |
136 0096 86E0 ldi r24,lo8(6) |
137 0098 8093 0000 sts EE_Parameter+6,r24 |
138 009c 87E0 ldi r24,lo8(7) |
139 009e 8093 0000 sts EE_Parameter+7,r24 |
140 00a2 88E0 ldi r24,lo8(8) |
141 00a4 8093 0000 sts EE_Parameter+8,r24 |
142 00a8 89E0 ldi r24,lo8(9) |
143 00aa 8093 0000 sts EE_Parameter+9,r24 |
144 00ae 8AE0 ldi r24,lo8(10) |
145 00b0 8093 0000 sts EE_Parameter+10,r24 |
146 00b4 8BE0 ldi r24,lo8(11) |
147 00b6 8093 0000 sts EE_Parameter+11,r24 |
148 00ba 8CE0 ldi r24,lo8(12) |
149 00bc 8093 0000 sts EE_Parameter+12,r24 |
150 /* epilogue start */ |
151 00c0 0895 ret |
153 .global GetParamByte |
155 GetParamByte: |
156 /* prologue: function */ |
157 /* frame size = 0 */ |
158 .L22: |
159 00c2 F999 sbic 63-32,1 |
160 00c4 00C0 rjmp .L22 |
161 00c6 92BD out (65)+1-32,r25 |
162 00c8 81BD out 65-32,r24 |
163 /* #APP */ |
164 ; 208 "c:/winavr-20090313/lib/gcc/../../avr/include/avr/eeprom.h" 1 |
165 /* START EEPROM READ CRITICAL SECTION */ |
166 00ca F89A sbi 31, 0 |
167 00cc 80B5 in r24, 32 |
168 /* END EEPROM READ CRITICAL SECTION */ |
169 |
170 ; 0 "" 2 |
171 /* epilogue start */ |
172 /* #NOAPP */ |
173 00ce 0895 ret |
175 .global SetParamByte |
177 SetParamByte: |
178 /* prologue: function */ |
179 /* frame size = 0 */ |
180 .L26: |
181 00d0 F999 sbic 63-32,1 |
182 00d2 00C0 rjmp .L26 |
183 00d4 1FBA out 63-32,__zero_reg__ |
184 00d6 92BD out (65)+1-32,r25 |
185 00d8 81BD out 65-32,r24 |
186 00da 60BD out 64-32,r22 |
187 /* #APP */ |
188 ; 315 "c:/winavr-20090313/lib/gcc/../../avr/include/avr/eeprom.h" 1 |
189 /* START EEPROM WRITE CRITICAL SECTION */ |
190 00dc 0FB6 in r0, 63 |
191 00de F894 cli |
192 00e0 FA9A sbi 31, 2 |
193 00e2 F99A sbi 31, 1 |
194 00e4 0FBE out 63, r0 |
195 /* END EEPROM WRITE CRITICAL SECTION */ |
196 ; 0 "" 2 |
197 /* epilogue start */ |
198 /* #NOAPP */ |
199 00e6 0895 ret |
201 .global GetActiveParamSet |
203 GetActiveParamSet: |
204 /* prologue: function */ |
205 /* frame size = 0 */ |
206 .L30: |
207 00e8 F999 sbic 63-32,1 |
208 00ea 00C0 rjmp .L30 |
209 00ec 82E0 ldi r24,lo8(2) |
210 00ee 90E0 ldi r25,hi8(2) |
211 00f0 92BD out (65)+1-32,r25 |
212 00f2 81BD out 65-32,r24 |
213 /* #APP */ |
214 ; 208 "c:/winavr-20090313/lib/gcc/../../avr/include/avr/eeprom.h" 1 |
215 /* START EEPROM READ CRITICAL SECTION */ |
216 00f4 F89A sbi 31, 0 |
217 00f6 80B5 in r24, 32 |
218 /* END EEPROM READ CRITICAL SECTION */ |
219 |
220 ; 0 "" 2 |
221 /* #NOAPP */ |
222 00f8 8630 cpi r24,lo8(6) |
223 00fa 00F0 brlo .L31 |
224 .L34: |
225 00fc F999 sbic 63-32,1 |
226 00fe 00C0 rjmp .L34 |
227 0100 1FBA out 63-32,__zero_reg__ |
228 0102 82E0 ldi r24,lo8(2) |
229 0104 90E0 ldi r25,hi8(2) |
230 0106 92BD out (65)+1-32,r25 |
231 0108 81BD out 65-32,r24 |
232 010a 83E0 ldi r24,lo8(3) |
233 010c 80BD out 64-32,r24 |
234 /* #APP */ |
235 ; 315 "c:/winavr-20090313/lib/gcc/../../avr/include/avr/eeprom.h" 1 |
236 /* START EEPROM WRITE CRITICAL SECTION */ |
237 010e 0FB6 in r0, 63 |
238 0110 F894 cli |
239 0112 FA9A sbi 31, 2 |
240 0114 F99A sbi 31, 1 |
241 0116 0FBE out 63, r0 |
242 /* END EEPROM WRITE CRITICAL SECTION */ |
243 ; 0 "" 2 |
244 /* #NOAPP */ |
245 .L31: |
246 0118 0895 ret |
248 .global SetActiveParamSet |
250 SetActiveParamSet: |
251 /* prologue: function */ |
252 /* frame size = 0 */ |
253 011a 282F mov r18,r24 |
254 011c 8630 cpi r24,lo8(6) |
255 011e 00F0 brlo .L38 |
256 0120 25E0 ldi r18,lo8(5) |
257 0122 00C0 rjmp .L41 |
258 .L38: |
259 0124 8823 tst r24 |
260 0126 01F4 brne .L41 |
261 0128 21E0 ldi r18,lo8(1) |
262 .L41: |
263 012a F999 sbic 63-32,1 |
264 012c 00C0 rjmp .L41 |
265 012e 1FBA out 63-32,__zero_reg__ |
266 0130 82E0 ldi r24,lo8(2) |
267 0132 90E0 ldi r25,hi8(2) |
268 0134 92BD out (65)+1-32,r25 |
269 0136 81BD out 65-32,r24 |
270 0138 20BD out 64-32,r18 |
271 /* #APP */ |
272 ; 315 "c:/winavr-20090313/lib/gcc/../../avr/include/avr/eeprom.h" 1 |
273 /* START EEPROM WRITE CRITICAL SECTION */ |
274 013a 0FB6 in r0, 63 |
275 013c F894 cli |
276 013e FA9A sbi 31, 2 |
277 0140 F99A sbi 31, 1 |
278 0142 0FBE out 63, r0 |
279 /* END EEPROM WRITE CRITICAL SECTION */ |
280 ; 0 "" 2 |
281 /* epilogue start */ |
282 /* #NOAPP */ |
283 0144 0895 ret |
285 .global MixerTable_ReadFromEEProm |
287 MixerTable_ReadFromEEProm: |
288 /* prologue: function */ |
289 /* frame size = 0 */ |
290 0146 4AEA ldi r20,lo8(-86) |
291 0148 28EE ldi r18,lo8(1000) |
292 014a 33E0 ldi r19,hi8(1000) |
293 .L56: |
294 014c F999 sbic 63-32,1 |
295 014e 00C0 rjmp .L56 |
296 0150 32BD out (65)+1-32,r19 |
297 0152 21BD out 65-32,r18 |
298 /* #APP */ |
299 ; 208 "c:/winavr-20090313/lib/gcc/../../avr/include/avr/eeprom.h" 1 |
300 /* START EEPROM READ CRITICAL SECTION */ |
301 0154 F89A sbi 31, 0 |
302 0156 80B5 in r24, 32 |
303 /* END EEPROM READ CRITICAL SECTION */ |
304 |
305 ; 0 "" 2 |
306 /* #NOAPP */ |
307 0158 480F add r20,r24 |
308 015a 2F5F subi r18,lo8(-(1)) |
309 015c 3F4F sbci r19,hi8(-(1)) |
310 015e 84E0 ldi r24,hi8(1077) |
311 0160 2533 cpi r18,lo8(1077) |
312 0162 3807 cpc r19,r24 |
313 0164 01F4 brne .L56 |
314 .L52: |
315 0166 F999 sbic 63-32,1 |
316 0168 00C0 rjmp .L52 |
317 016a 85E3 ldi r24,lo8(1077) |
318 016c 94E0 ldi r25,hi8(1077) |
319 016e 92BD out (65)+1-32,r25 |
320 0170 81BD out 65-32,r24 |
321 /* #APP */ |
322 ; 208 "c:/winavr-20090313/lib/gcc/../../avr/include/avr/eeprom.h" 1 |
323 /* START EEPROM READ CRITICAL SECTION */ |
324 0172 F89A sbi 31, 0 |
325 0174 80B5 in r24, 32 |
326 /* END EEPROM READ CRITICAL SECTION */ |
327 |
328 ; 0 "" 2 |
329 /* #NOAPP */ |
330 0176 4817 cp r20,r24 |
331 0178 01F4 brne .L46 |
332 .L51: |
333 017a F999 sbic 63-32,1 |
334 017c 00C0 rjmp .L51 |
335 017e 88EE ldi r24,lo8(1000) |
336 0180 93E0 ldi r25,hi8(1000) |
337 0182 92BD out (65)+1-32,r25 |
338 0184 81BD out 65-32,r24 |
339 /* #APP */ |
340 ; 208 "c:/winavr-20090313/lib/gcc/../../avr/include/avr/eeprom.h" 1 |
341 /* START EEPROM READ CRITICAL SECTION */ |
342 0186 F89A sbi 31, 0 |
343 0188 80B5 in r24, 32 |
344 /* END EEPROM READ CRITICAL SECTION */ |
345 |
346 ; 0 "" 2 |
347 /* #NOAPP */ |
348 018a 8130 cpi r24,lo8(1) |
349 018c 01F4 brne .L46 |
350 018e 80E0 ldi r24,lo8(Mixer) |
351 0190 90E0 ldi r25,hi8(Mixer) |
352 0192 68EE ldi r22,lo8(1000) |
353 0194 73E0 ldi r23,hi8(1000) |
354 0196 4EE4 ldi r20,lo8(78) |
355 0198 50E0 ldi r21,hi8(78) |
356 019a 20E0 ldi r18,lo8(gs(eeprom_read_byte)) |
357 019c 30E0 ldi r19,hi8(gs(eeprom_read_byte)) |
358 019e 0E94 0000 call __eerd_block |
359 01a2 81E0 ldi r24,lo8(1) |
360 01a4 0895 ret |
361 .L46: |
362 01a6 80E0 ldi r24,lo8(0) |
363 01a8 0895 ret |
365 .data |
366 .LC0: |
367 0000 5175 6164 .string "Quadro" |
367 726F 00 |
368 0007 00 .string "" |
369 .text |
370 .global MixerTable_Default |
372 MixerTable_Default: |
373 /* prologue: function */ |
374 /* frame size = 0 */ |
375 01aa 81E0 ldi r24,lo8(1) |
376 01ac 8093 0000 sts Mixer,r24 |
377 01b0 E0E0 ldi r30,lo8(Mixer+13) |
378 01b2 F0E0 ldi r31,hi8(Mixer+13) |
379 .L58: |
380 01b4 1082 st Z,__zero_reg__ |
381 01b6 1182 std Z+1,__zero_reg__ |
382 01b8 1282 std Z+2,__zero_reg__ |
383 01ba 1382 std Z+3,__zero_reg__ |
384 01bc 3496 adiw r30,4 |
385 01be 80E0 ldi r24,hi8(Mixer+77) |
386 01c0 E030 cpi r30,lo8(Mixer+77) |
387 01c2 F807 cpc r31,r24 |
388 01c4 01F4 brne .L58 |
389 01c6 80E4 ldi r24,lo8(64) |
390 01c8 8093 0000 sts Mixer+13,r24 |
391 01cc FF97 sbiw r30,63 |
392 01ce 8083 st Z,r24 |
393 01d0 1092 0000 sts Mixer+15,__zero_reg__ |
394 01d4 8093 0000 sts Mixer+16,r24 |
395 01d8 8093 0000 sts Mixer+17,r24 |
396 01dc 90EC ldi r25,lo8(-64) |
397 01de 9093 0000 sts Mixer+18,r25 |
398 01e2 1092 0000 sts Mixer+19,__zero_reg__ |
399 01e6 8093 0000 sts Mixer+20,r24 |
400 01ea 8093 0000 sts Mixer+21,r24 |
401 01ee 1092 0000 sts Mixer+22,__zero_reg__ |
402 01f2 9093 0000 sts Mixer+23,r25 |
403 01f6 9093 0000 sts Mixer+24,r25 |
404 01fa 8093 0000 sts Mixer+25,r24 |
405 01fe 1092 0000 sts Mixer+26,__zero_reg__ |
406 0202 8093 0000 sts Mixer+27,r24 |
407 0206 9093 0000 sts Mixer+28,r25 |
408 020a 3D97 sbiw r30,13 |
409 020c A0E0 ldi r26,lo8(.LC0) |
410 020e B0E0 ldi r27,hi8(.LC0) |
411 0210 87E0 ldi r24,lo8(7) |
412 .L59: |
413 0212 0D90 ld r0,X+ |
414 0214 0192 st Z+,r0 |
415 0216 8150 subi r24,lo8(-(-1)) |
416 0218 01F4 brne .L59 |
417 021a E0E0 ldi r30,lo8(Mixer) |
418 021c F0E0 ldi r31,hi8(Mixer) |
419 021e 9AEA ldi r25,lo8(-86) |
420 .L60: |
421 0220 8191 ld r24,Z+ |
422 0222 980F add r25,r24 |
423 0224 80E0 ldi r24,hi8(Mixer+77) |
424 0226 E030 cpi r30,lo8(Mixer+77) |
425 0228 F807 cpc r31,r24 |
426 022a 01F4 brne .L60 |
427 022c 9093 0000 sts Mixer+77,r25 |
428 /* epilogue start */ |
429 0230 0895 ret |
431 .data |
432 .LC1: |
433 0008 4265 6769 .string "Beginner" |
433 6E6E 6572 |
433 00 |
434 0011 00 .string "" |
435 .text |
436 .global ParamSet_DefaultSet3 |
438 ParamSet_DefaultSet3: |
439 /* prologue: function */ |
440 /* frame size = 0 */ |
441 0232 84E5 ldi r24,lo8(84) |
442 0234 8093 0000 sts EE_Parameter,r24 |
443 0238 8091 0000 lds r24,PlatinenVersion |
444 023c 8431 cpi r24,lo8(20) |
445 023e 00F0 brlo .L66 |
446 0240 8AE0 ldi r24,lo8(10) |
447 0242 8093 0000 sts EE_Parameter+32,r24 |
448 0246 1092 0000 sts EE_Parameter+66,__zero_reg__ |
449 024a 8BE1 ldi r24,lo8(27) |
450 024c 8093 0000 sts EE_Parameter+28,r24 |
451 0250 8EE4 ldi r24,lo8(78) |
452 0252 00C0 rjmp .L73 |
453 .L66: |
454 0254 83E0 ldi r24,lo8(3) |
455 0256 8093 0000 sts EE_Parameter+32,r24 |
456 025a 80E2 ldi r24,lo8(32) |
457 025c 8093 0000 sts EE_Parameter+66,r24 |
458 0260 8EE1 ldi r24,lo8(30) |
459 0262 8093 0000 sts EE_Parameter+28,r24 |
460 0266 85E5 ldi r24,lo8(85) |
461 .L73: |
462 0268 8093 0000 sts EE_Parameter+63,r24 |
463 026c 8093 0000 sts EE_Parameter+64,r24 |
464 0270 8AE6 ldi r24,lo8(106) |
465 0272 8093 0000 sts EE_Parameter+13,r24 |
466 0276 83E0 ldi r24,lo8(3) |
467 0278 8093 0000 sts EE_Parameter+99,r24 |
468 027c 6EE1 ldi r22,lo8(30) |
469 027e 6093 0000 sts EE_Parameter+14,r22 |
470 0282 8FEF ldi r24,lo8(-1) |
471 0284 8093 0000 sts EE_Parameter+16,r24 |
472 0288 9FE0 ldi r25,lo8(15) |
473 028a 9093 0000 sts EE_Parameter+17,r25 |
474 028e 6093 0000 sts EE_Parameter+15,r22 |
475 0292 1092 0000 sts EE_Parameter+19,__zero_reg__ |
476 0296 78E0 ldi r23,lo8(8) |
477 0298 7093 0000 sts EE_Parameter+20,r23 |
478 029c 80E4 ldi r24,lo8(64) |
479 029e 8093 0000 sts EE_Parameter+21,r24 |
480 02a2 1092 0000 sts EE_Parameter+22,__zero_reg__ |
481 02a6 9093 0000 sts EE_Parameter+18,r25 |
482 02aa 7093 0000 sts EE_Parameter+23,r23 |
483 02ae 90E1 ldi r25,lo8(16) |
484 02b0 9093 0000 sts EE_Parameter+24,r25 |
485 02b4 56E0 ldi r21,lo8(6) |
486 02b6 5093 0000 sts EE_Parameter+25,r21 |
487 02ba 7093 0000 sts EE_Parameter+26,r23 |
488 02be 86EE ldi r24,lo8(-26) |
489 02c0 8093 0000 sts EE_Parameter+27,r24 |
490 02c4 80E8 ldi r24,lo8(-128) |
491 02c6 8093 0000 sts EE_Parameter+29,r24 |
492 02ca 34E6 ldi r19,lo8(100) |
493 02cc 3093 0000 sts EE_Parameter+30,r19 |
494 02d0 88E7 ldi r24,lo8(120) |
495 02d2 8093 0000 sts EE_Parameter+31,r24 |
496 02d6 3093 0000 sts EE_Parameter+33,r19 |
497 02da 8093 0000 sts EE_Parameter+34,r24 |
498 02de 5093 0000 sts EE_Parameter+35,r21 |
499 02e2 81E2 ldi r24,lo8(33) |
500 02e4 8093 0000 sts EE_Parameter+36,r24 |
501 02e8 8DE2 ldi r24,lo8(45) |
502 02ea 8093 0000 sts EE_Parameter+37,r24 |
503 02ee 2AE5 ldi r18,lo8(90) |
504 02f0 2093 0000 sts EE_Parameter+38,r18 |
505 02f4 9093 0000 sts EE_Parameter+40,r25 |
506 02f8 1092 0000 sts EE_Parameter+41,__zero_reg__ |
507 02fc 1092 0000 sts EE_Parameter+42,__zero_reg__ |
508 0300 1092 0000 sts EE_Parameter+43,__zero_reg__ |
509 0304 1092 0000 sts EE_Parameter+44,__zero_reg__ |
510 0308 1092 0000 sts EE_Parameter+68,__zero_reg__ |
511 030c 1092 0000 sts EE_Parameter+69,__zero_reg__ |
512 0310 1092 0000 sts EE_Parameter+70,__zero_reg__ |
513 0314 1092 0000 sts EE_Parameter+71,__zero_reg__ |
514 0318 3093 0000 sts EE_Parameter+45,r19 |
515 031c 48E2 ldi r20,lo8(40) |
516 031e 4093 0000 sts EE_Parameter+46,r20 |
517 0322 E1E0 ldi r30,lo8(1) |
518 0324 E093 0000 sts EE_Parameter+98,r30 |
519 0328 1092 0000 sts EE_Parameter+47,__zero_reg__ |
520 032c 97EF ldi r25,lo8(-9) |
521 032e 9093 0000 sts EE_Parameter+48,r25 |
522 0332 5093 0000 sts EE_Parameter+53,r21 |
523 0336 8DE7 ldi r24,lo8(125) |
524 0338 8093 0000 sts EE_Parameter+54,r24 |
525 033c 8093 0000 sts EE_Parameter+55,r24 |
526 0340 8093 0000 sts EE_Parameter+56,r24 |
527 0344 3093 0000 sts EE_Parameter+49,r19 |
528 0348 4093 0000 sts EE_Parameter+50,r20 |
529 034c 1092 0000 sts EE_Parameter+51,__zero_reg__ |
530 0350 9093 0000 sts EE_Parameter+52,r25 |
531 0354 82E3 ldi r24,lo8(50) |
532 0356 8093 0000 sts EE_Parameter+57,r24 |
533 035a 2093 0000 sts EE_Parameter+58,r18 |
534 035e 8093 0000 sts EE_Parameter+59,r24 |
535 0362 1092 0000 sts EE_Parameter+97,__zero_reg__ |
536 0366 2093 0000 sts EE_Parameter+60,r18 |
537 036a 80E5 ldi r24,lo8(80) |
538 036c 8093 0000 sts EE_Parameter+61,r24 |
539 0370 96E4 ldi r25,lo8(70) |
540 0372 9093 0000 sts EE_Parameter+62,r25 |
541 0376 80E2 ldi r24,lo8(32) |
542 0378 8093 0000 sts EE_Parameter+65,r24 |
543 037c 9093 0000 sts EE_Parameter+67,r25 |
544 0380 8FE5 ldi r24,lo8(95) |
545 0382 8093 0000 sts EE_Parameter+72,r24 |
546 0386 83EF ldi r24,lo8(-13) |
547 0388 8093 0000 sts EE_Parameter+74,r24 |
548 038c 8AEA ldi r24,lo8(-86) |
549 038e 8093 0000 sts EE_Parameter+76,r24 |
550 0392 8093 0000 sts EE_Parameter+77,r24 |
551 0396 6093 0000 sts EE_Parameter+73,r22 |
552 039a 6093 0000 sts EE_Parameter+75,r22 |
553 039e 8EEF ldi r24,lo8(-2) |
554 03a0 8093 0000 sts EE_Parameter+78,r24 |
555 03a4 3093 0000 sts EE_Parameter+79,r19 |
556 03a8 2093 0000 sts EE_Parameter+80,r18 |
557 03ac 2093 0000 sts EE_Parameter+81,r18 |
558 03b0 2093 0000 sts EE_Parameter+82,r18 |
559 03b4 8BE4 ldi r24,lo8(75) |
560 03b6 8093 0000 sts EE_Parameter+83,r24 |
561 03ba 8093 0000 sts EE_Parameter+84,r24 |
562 03be 8093 0000 sts EE_Parameter+85,r24 |
563 03c2 1092 0000 sts EE_Parameter+86,__zero_reg__ |
564 03c6 5093 0000 sts EE_Parameter+87,r21 |
565 03ca 7093 0000 sts EE_Parameter+88,r23 |
566 03ce 2093 0000 sts EE_Parameter+89,r18 |
567 03d2 6093 0000 sts EE_Parameter+90,r22 |
568 03d6 3093 0000 sts EE_Parameter+91,r19 |
569 03da 3093 0000 sts EE_Parameter+92,r19 |
570 03de 82E0 ldi r24,lo8(2) |
571 03e0 8093 0000 sts EE_Parameter+93,r24 |
572 03e4 E093 0000 sts EE_Parameter+39,r30 |
573 03e8 1092 0000 sts EE_Parameter+95,__zero_reg__ |
574 03ec 1092 0000 sts EE_Parameter+96,__zero_reg__ |
575 03f0 A0E0 ldi r26,lo8(EE_Parameter+100) |
576 03f2 B0E0 ldi r27,hi8(EE_Parameter+100) |
577 03f4 E0E0 ldi r30,lo8(.LC1) |
578 03f6 F0E0 ldi r31,hi8(.LC1) |
579 03f8 8CE0 ldi r24,lo8(12) |
580 .L68: |
581 03fa 0190 ld r0,Z+ |
582 03fc 0D92 st X+,r0 |
583 03fe 8150 subi r24,lo8(-(-1)) |
584 0400 01F4 brne .L68 |
585 0402 E0E0 ldi r30,lo8(EE_Parameter) |
586 0404 F0E0 ldi r31,hi8(EE_Parameter) |
587 0406 9AEA ldi r25,lo8(-86) |
588 .L69: |
589 0408 8191 ld r24,Z+ |
590 040a 980F add r25,r24 |
591 040c 80E0 ldi r24,hi8(EE_Parameter+112) |
592 040e E030 cpi r30,lo8(EE_Parameter+112) |
593 0410 F807 cpc r31,r24 |
594 0412 01F4 brne .L69 |
595 0414 9083 st Z,r25 |
596 /* epilogue start */ |
597 0416 0895 ret |
599 .data |
600 .LC2: |
601 0012 4E6F 726D .string "Normal" |
601 616C 00 |
602 0019 00 .string "" |
603 .text |
604 .global ParamSet_DefaultSet2 |
606 ParamSet_DefaultSet2: |
607 /* prologue: function */ |
608 /* frame size = 0 */ |
609 0418 84E5 ldi r24,lo8(84) |
610 041a 8093 0000 sts EE_Parameter,r24 |
611 041e 8091 0000 lds r24,PlatinenVersion |
612 0422 8431 cpi r24,lo8(20) |
613 0424 00F0 brlo .L75 |
614 0426 8AE0 ldi r24,lo8(10) |
615 0428 8093 0000 sts EE_Parameter+32,r24 |
616 042c 1092 0000 sts EE_Parameter+66,__zero_reg__ |
617 0430 8BE1 ldi r24,lo8(27) |
618 0432 8093 0000 sts EE_Parameter+28,r24 |
619 0436 8EE4 ldi r24,lo8(78) |
620 0438 00C0 rjmp .L82 |
621 .L75: |
622 043a 83E0 ldi r24,lo8(3) |
623 043c 8093 0000 sts EE_Parameter+32,r24 |
624 0440 80E2 ldi r24,lo8(32) |
625 0442 8093 0000 sts EE_Parameter+66,r24 |
626 0446 8EE1 ldi r24,lo8(30) |
627 0448 8093 0000 sts EE_Parameter+28,r24 |
628 044c 85E5 ldi r24,lo8(85) |
629 .L82: |
630 044e 8093 0000 sts EE_Parameter+63,r24 |
631 0452 8093 0000 sts EE_Parameter+64,r24 |
632 0456 8AE6 ldi r24,lo8(106) |
633 0458 8093 0000 sts EE_Parameter+13,r24 |
634 045c 83E0 ldi r24,lo8(3) |
635 045e 8093 0000 sts EE_Parameter+99,r24 |
636 0462 7EE1 ldi r23,lo8(30) |
637 0464 7093 0000 sts EE_Parameter+14,r23 |
638 0468 8FEF ldi r24,lo8(-1) |
639 046a 8093 0000 sts EE_Parameter+16,r24 |
640 046e 9FE0 ldi r25,lo8(15) |
641 0470 9093 0000 sts EE_Parameter+17,r25 |
642 0474 7093 0000 sts EE_Parameter+15,r23 |
643 0478 1092 0000 sts EE_Parameter+19,__zero_reg__ |
644 047c 68E0 ldi r22,lo8(8) |
645 047e 6093 0000 sts EE_Parameter+20,r22 |
646 0482 80E4 ldi r24,lo8(64) |
647 0484 8093 0000 sts EE_Parameter+21,r24 |
648 0488 1092 0000 sts EE_Parameter+22,__zero_reg__ |
649 048c 9093 0000 sts EE_Parameter+18,r25 |
650 0490 8AE0 ldi r24,lo8(10) |
651 0492 8093 0000 sts EE_Parameter+23,r24 |
652 0496 80E1 ldi r24,lo8(16) |
653 0498 8093 0000 sts EE_Parameter+24,r24 |
654 049c 56E0 ldi r21,lo8(6) |
655 049e 5093 0000 sts EE_Parameter+25,r21 |
656 04a2 6093 0000 sts EE_Parameter+26,r22 |
657 04a6 86EE ldi r24,lo8(-26) |
658 04a8 8093 0000 sts EE_Parameter+27,r24 |
659 04ac 80E8 ldi r24,lo8(-128) |
660 04ae 8093 0000 sts EE_Parameter+29,r24 |
661 04b2 2AE5 ldi r18,lo8(90) |
662 04b4 2093 0000 sts EE_Parameter+30,r18 |
663 04b8 88E7 ldi r24,lo8(120) |
664 04ba 8093 0000 sts EE_Parameter+31,r24 |
665 04be 2093 0000 sts EE_Parameter+33,r18 |
666 04c2 8093 0000 sts EE_Parameter+34,r24 |
667 04c6 5093 0000 sts EE_Parameter+35,r21 |
668 04ca 81E2 ldi r24,lo8(33) |
669 04cc 8093 0000 sts EE_Parameter+36,r24 |
670 04d0 8DE2 ldi r24,lo8(45) |
671 04d2 8093 0000 sts EE_Parameter+37,r24 |
672 04d6 2093 0000 sts EE_Parameter+38,r18 |
673 04da E0E2 ldi r30,lo8(32) |
674 04dc E093 0000 sts EE_Parameter+40,r30 |
675 04e0 1092 0000 sts EE_Parameter+41,__zero_reg__ |
676 04e4 1092 0000 sts EE_Parameter+42,__zero_reg__ |
677 04e8 1092 0000 sts EE_Parameter+43,__zero_reg__ |
678 04ec 1092 0000 sts EE_Parameter+44,__zero_reg__ |
679 04f0 1092 0000 sts EE_Parameter+68,__zero_reg__ |
680 04f4 1092 0000 sts EE_Parameter+69,__zero_reg__ |
681 04f8 1092 0000 sts EE_Parameter+70,__zero_reg__ |
682 04fc 1092 0000 sts EE_Parameter+71,__zero_reg__ |
683 0500 44E6 ldi r20,lo8(100) |
684 0502 4093 0000 sts EE_Parameter+45,r20 |
685 0506 38E2 ldi r19,lo8(40) |
686 0508 3093 0000 sts EE_Parameter+46,r19 |
687 050c F1E0 ldi r31,lo8(1) |
688 050e F093 0000 sts EE_Parameter+98,r31 |
689 0512 1092 0000 sts EE_Parameter+47,__zero_reg__ |
690 0516 97EF ldi r25,lo8(-9) |
691 0518 9093 0000 sts EE_Parameter+48,r25 |
692 051c 5093 0000 sts EE_Parameter+53,r21 |
693 0520 8DE7 ldi r24,lo8(125) |
694 0522 8093 0000 sts EE_Parameter+54,r24 |
695 0526 8093 0000 sts EE_Parameter+55,r24 |
696 052a 8093 0000 sts EE_Parameter+56,r24 |
697 052e 4093 0000 sts EE_Parameter+49,r20 |
698 0532 3093 0000 sts EE_Parameter+50,r19 |
699 0536 1092 0000 sts EE_Parameter+51,__zero_reg__ |
700 053a 9093 0000 sts EE_Parameter+52,r25 |
701 053e 82E3 ldi r24,lo8(50) |
702 0540 8093 0000 sts EE_Parameter+57,r24 |
703 0544 2093 0000 sts EE_Parameter+58,r18 |
704 0548 8093 0000 sts EE_Parameter+59,r24 |
705 054c 1092 0000 sts EE_Parameter+97,__zero_reg__ |
706 0550 2093 0000 sts EE_Parameter+60,r18 |
707 0554 80E5 ldi r24,lo8(80) |
708 0556 8093 0000 sts EE_Parameter+61,r24 |
709 055a 8CE3 ldi r24,lo8(60) |
710 055c 8093 0000 sts EE_Parameter+62,r24 |
711 0560 E093 0000 sts EE_Parameter+65,r30 |
712 0564 9BE4 ldi r25,lo8(75) |
713 0566 9093 0000 sts EE_Parameter+67,r25 |
714 056a 8FE5 ldi r24,lo8(95) |
715 056c 8093 0000 sts EE_Parameter+72,r24 |
716 0570 83EF ldi r24,lo8(-13) |
717 0572 8093 0000 sts EE_Parameter+74,r24 |
718 0576 8AEA ldi r24,lo8(-86) |
719 0578 8093 0000 sts EE_Parameter+76,r24 |
720 057c 8093 0000 sts EE_Parameter+77,r24 |
721 0580 84E1 ldi r24,lo8(20) |
722 0582 8093 0000 sts EE_Parameter+73,r24 |
723 0586 8093 0000 sts EE_Parameter+75,r24 |
724 058a 8EEF ldi r24,lo8(-2) |
725 058c 8093 0000 sts EE_Parameter+78,r24 |
726 0590 4093 0000 sts EE_Parameter+79,r20 |
727 0594 2093 0000 sts EE_Parameter+80,r18 |
728 0598 2093 0000 sts EE_Parameter+81,r18 |
729 059c 2093 0000 sts EE_Parameter+82,r18 |
730 05a0 9093 0000 sts EE_Parameter+83,r25 |
731 05a4 9093 0000 sts EE_Parameter+84,r25 |
732 05a8 9093 0000 sts EE_Parameter+85,r25 |
733 05ac 1092 0000 sts EE_Parameter+86,__zero_reg__ |
734 05b0 5093 0000 sts EE_Parameter+87,r21 |
735 05b4 6093 0000 sts EE_Parameter+88,r22 |
736 05b8 2093 0000 sts EE_Parameter+89,r18 |
737 05bc 7093 0000 sts EE_Parameter+90,r23 |
738 05c0 4093 0000 sts EE_Parameter+91,r20 |
739 05c4 4093 0000 sts EE_Parameter+92,r20 |
740 05c8 82E0 ldi r24,lo8(2) |
741 05ca 8093 0000 sts EE_Parameter+93,r24 |
742 05ce F093 0000 sts EE_Parameter+39,r31 |
743 05d2 1092 0000 sts EE_Parameter+95,__zero_reg__ |
744 05d6 1092 0000 sts EE_Parameter+96,__zero_reg__ |
745 05da A0E0 ldi r26,lo8(EE_Parameter+100) |
746 05dc B0E0 ldi r27,hi8(EE_Parameter+100) |
747 05de E0E0 ldi r30,lo8(.LC2) |
748 05e0 F0E0 ldi r31,hi8(.LC2) |
749 05e2 8CE0 ldi r24,lo8(12) |
750 .L77: |
751 05e4 0190 ld r0,Z+ |
752 05e6 0D92 st X+,r0 |
753 05e8 8150 subi r24,lo8(-(-1)) |
754 05ea 01F4 brne .L77 |
755 05ec E0E0 ldi r30,lo8(EE_Parameter) |
756 05ee F0E0 ldi r31,hi8(EE_Parameter) |
757 05f0 9AEA ldi r25,lo8(-86) |
758 .L78: |
759 05f2 8191 ld r24,Z+ |
760 05f4 980F add r25,r24 |
761 05f6 80E0 ldi r24,hi8(EE_Parameter+112) |
762 05f8 E030 cpi r30,lo8(EE_Parameter+112) |
763 05fa F807 cpc r31,r24 |
764 05fc 01F4 brne .L78 |
765 05fe 9083 st Z,r25 |
766 /* epilogue start */ |
767 0600 0895 ret |
769 .data |
770 .LC3: |
771 001a 5370 6F72 .string "Sport" |
771 7400 |
772 0020 00 .string "" |
773 .text |
774 .global ParamSet_DefaultSet1 |
776 ParamSet_DefaultSet1: |
777 /* prologue: function */ |
778 /* frame size = 0 */ |
779 0602 84E5 ldi r24,lo8(84) |
780 0604 8093 0000 sts EE_Parameter,r24 |
781 0608 8091 0000 lds r24,PlatinenVersion |
782 060c 8431 cpi r24,lo8(20) |
783 060e 00F0 brlo .L84 |
784 0610 8AE0 ldi r24,lo8(10) |
785 0612 8093 0000 sts EE_Parameter+32,r24 |
786 0616 1092 0000 sts EE_Parameter+66,__zero_reg__ |
787 061a 8BE1 ldi r24,lo8(27) |
788 061c 8093 0000 sts EE_Parameter+28,r24 |
789 0620 8EE4 ldi r24,lo8(78) |
790 0622 00C0 rjmp .L91 |
791 .L84: |
792 0624 83E0 ldi r24,lo8(3) |
793 0626 8093 0000 sts EE_Parameter+32,r24 |
794 062a 80E2 ldi r24,lo8(32) |
795 062c 8093 0000 sts EE_Parameter+66,r24 |
796 0630 8EE1 ldi r24,lo8(30) |
797 0632 8093 0000 sts EE_Parameter+28,r24 |
798 0636 85E5 ldi r24,lo8(85) |
799 .L91: |
800 0638 8093 0000 sts EE_Parameter+63,r24 |
801 063c 8093 0000 sts EE_Parameter+64,r24 |
802 0640 8AE6 ldi r24,lo8(106) |
803 0642 8093 0000 sts EE_Parameter+13,r24 |
804 0646 83E0 ldi r24,lo8(3) |
805 0648 8093 0000 sts EE_Parameter+99,r24 |
806 064c AEE1 ldi r26,lo8(30) |
807 064e A093 0000 sts EE_Parameter+14,r26 |
808 0652 8FEF ldi r24,lo8(-1) |
809 0654 8093 0000 sts EE_Parameter+16,r24 |
810 0658 EFE0 ldi r30,lo8(15) |
811 065a E093 0000 sts EE_Parameter+17,r30 |
812 065e A093 0000 sts EE_Parameter+15,r26 |
813 0662 1092 0000 sts EE_Parameter+19,__zero_reg__ |
814 0666 F8E0 ldi r31,lo8(8) |
815 0668 F093 0000 sts EE_Parameter+20,r31 |
816 066c 80E4 ldi r24,lo8(64) |
817 066e 8093 0000 sts EE_Parameter+21,r24 |
818 0672 1092 0000 sts EE_Parameter+22,__zero_reg__ |
819 0676 84E1 ldi r24,lo8(20) |
820 0678 8093 0000 sts EE_Parameter+18,r24 |
821 067c 8EE0 ldi r24,lo8(14) |
822 067e 8093 0000 sts EE_Parameter+23,r24 |
823 0682 B0E1 ldi r27,lo8(16) |
824 0684 B093 0000 sts EE_Parameter+24,r27 |
825 0688 8CE0 ldi r24,lo8(12) |
826 068a 8093 0000 sts EE_Parameter+25,r24 |
827 068e F093 0000 sts EE_Parameter+26,r31 |
828 0692 86EE ldi r24,lo8(-26) |
829 0694 8093 0000 sts EE_Parameter+27,r24 |
830 0698 80E8 ldi r24,lo8(-128) |
831 069a 8093 0000 sts EE_Parameter+29,r24 |
832 069e 50E5 ldi r21,lo8(80) |
833 06a0 5093 0000 sts EE_Parameter+30,r21 |
834 06a4 86E9 ldi r24,lo8(-106) |
835 06a6 8093 0000 sts EE_Parameter+31,r24 |
836 06aa 5093 0000 sts EE_Parameter+33,r21 |
837 06ae 8093 0000 sts EE_Parameter+34,r24 |
838 06b2 76E0 ldi r23,lo8(6) |
839 06b4 7093 0000 sts EE_Parameter+35,r23 |
840 06b8 81E2 ldi r24,lo8(33) |
841 06ba 8093 0000 sts EE_Parameter+36,r24 |
842 06be 8DE2 ldi r24,lo8(45) |
843 06c0 8093 0000 sts EE_Parameter+37,r24 |
844 06c4 9AE5 ldi r25,lo8(90) |
845 06c6 9093 0000 sts EE_Parameter+38,r25 |
846 06ca 80E2 ldi r24,lo8(32) |
847 06cc 8093 0000 sts EE_Parameter+40,r24 |
848 06d0 1092 0000 sts EE_Parameter+41,__zero_reg__ |
849 06d4 1092 0000 sts EE_Parameter+42,__zero_reg__ |
850 06d8 1092 0000 sts EE_Parameter+43,__zero_reg__ |
851 06dc 1092 0000 sts EE_Parameter+44,__zero_reg__ |
852 06e0 1092 0000 sts EE_Parameter+68,__zero_reg__ |
853 06e4 1092 0000 sts EE_Parameter+69,__zero_reg__ |
854 06e8 1092 0000 sts EE_Parameter+70,__zero_reg__ |
855 06ec 1092 0000 sts EE_Parameter+71,__zero_reg__ |
856 06f0 34E6 ldi r19,lo8(100) |
857 06f2 3093 0000 sts EE_Parameter+45,r19 |
858 06f6 48E2 ldi r20,lo8(40) |
859 06f8 4093 0000 sts EE_Parameter+46,r20 |
860 06fc 61E0 ldi r22,lo8(1) |
861 06fe 6093 0000 sts EE_Parameter+98,r22 |
862 0702 1092 0000 sts EE_Parameter+47,__zero_reg__ |
863 0706 27EF ldi r18,lo8(-9) |
864 0708 2093 0000 sts EE_Parameter+48,r18 |
865 070c 7093 0000 sts EE_Parameter+53,r23 |
866 0710 8DE7 ldi r24,lo8(125) |
867 0712 8093 0000 sts EE_Parameter+54,r24 |
868 0716 8093 0000 sts EE_Parameter+55,r24 |
869 071a 8093 0000 sts EE_Parameter+56,r24 |
870 071e 3093 0000 sts EE_Parameter+49,r19 |
871 0722 4093 0000 sts EE_Parameter+50,r20 |
872 0726 1092 0000 sts EE_Parameter+51,__zero_reg__ |
873 072a 2093 0000 sts EE_Parameter+52,r18 |
874 072e 82E3 ldi r24,lo8(50) |
875 0730 8093 0000 sts EE_Parameter+57,r24 |
876 0734 9093 0000 sts EE_Parameter+58,r25 |
877 0738 8093 0000 sts EE_Parameter+59,r24 |
878 073c 1092 0000 sts EE_Parameter+97,__zero_reg__ |
879 0740 9093 0000 sts EE_Parameter+60,r25 |
880 0744 5093 0000 sts EE_Parameter+61,r21 |
881 0748 6093 0000 sts EE_Parameter+62,r22 |
882 074c B093 0000 sts EE_Parameter+65,r27 |
883 0750 3093 0000 sts EE_Parameter+67,r19 |
884 0754 8FE5 ldi r24,lo8(95) |
885 0756 8093 0000 sts EE_Parameter+72,r24 |
886 075a 83EF ldi r24,lo8(-13) |
887 075c 8093 0000 sts EE_Parameter+74,r24 |
888 0760 8AEA ldi r24,lo8(-86) |
889 0762 8093 0000 sts EE_Parameter+76,r24 |
890 0766 8093 0000 sts EE_Parameter+77,r24 |
891 076a E093 0000 sts EE_Parameter+73,r30 |
892 076e E093 0000 sts EE_Parameter+75,r30 |
893 0772 8EEF ldi r24,lo8(-2) |
894 0774 8093 0000 sts EE_Parameter+78,r24 |
895 0778 3093 0000 sts EE_Parameter+79,r19 |
896 077c 9093 0000 sts EE_Parameter+80,r25 |
897 0780 9093 0000 sts EE_Parameter+81,r25 |
898 0784 9093 0000 sts EE_Parameter+82,r25 |
899 0788 8BE4 ldi r24,lo8(75) |
900 078a 8093 0000 sts EE_Parameter+83,r24 |
901 078e 8093 0000 sts EE_Parameter+84,r24 |
902 0792 8093 0000 sts EE_Parameter+85,r24 |
903 0796 1092 0000 sts EE_Parameter+86,__zero_reg__ |
904 079a 7093 0000 sts EE_Parameter+87,r23 |
905 079e F093 0000 sts EE_Parameter+88,r31 |
906 07a2 9093 0000 sts EE_Parameter+89,r25 |
907 07a6 A093 0000 sts EE_Parameter+90,r26 |
908 07aa 3093 0000 sts EE_Parameter+91,r19 |
909 07ae 3093 0000 sts EE_Parameter+92,r19 |
910 07b2 82E0 ldi r24,lo8(2) |
911 07b4 8093 0000 sts EE_Parameter+93,r24 |
912 07b8 6093 0000 sts EE_Parameter+39,r22 |
913 07bc 1092 0000 sts EE_Parameter+95,__zero_reg__ |
914 07c0 1092 0000 sts EE_Parameter+96,__zero_reg__ |
915 07c4 A0E0 ldi r26,lo8(EE_Parameter+100) |
916 07c6 B0E0 ldi r27,hi8(EE_Parameter+100) |
917 07c8 E0E0 ldi r30,lo8(.LC3) |
918 07ca F0E0 ldi r31,hi8(.LC3) |
919 07cc 8CE0 ldi r24,lo8(12) |
920 .L86: |
921 07ce 0190 ld r0,Z+ |
922 07d0 0D92 st X+,r0 |
923 07d2 8150 subi r24,lo8(-(-1)) |
924 07d4 01F4 brne .L86 |
925 07d6 E0E0 ldi r30,lo8(EE_Parameter) |
926 07d8 F0E0 ldi r31,hi8(EE_Parameter) |
927 07da 9AEA ldi r25,lo8(-86) |
928 .L87: |
929 07dc 8191 ld r24,Z+ |
930 07de 980F add r25,r24 |
931 07e0 80E0 ldi r24,hi8(EE_Parameter+112) |
932 07e2 E030 cpi r30,lo8(EE_Parameter+112) |
933 07e4 F807 cpc r31,r24 |
934 07e6 01F4 brne .L87 |
935 07e8 9083 st Z,r25 |
936 /* epilogue start */ |
937 07ea 0895 ret |
939 .global MixerTable_WriteToEEProm |
941 MixerTable_WriteToEEProm: |
942 /* prologue: function */ |
943 /* frame size = 0 */ |
944 07ec 8091 0000 lds r24,Mixer |
945 07f0 8130 cpi r24,lo8(1) |
946 07f2 01F0 breq .L93 |
947 07f4 80E0 ldi r24,lo8(0) |
948 07f6 0895 ret |
949 .L93: |
950 07f8 E0E0 ldi r30,lo8(Mixer) |
951 07fa F0E0 ldi r31,hi8(Mixer) |
952 07fc 9AEA ldi r25,lo8(-86) |
953 .L95: |
954 07fe 8191 ld r24,Z+ |
955 0800 980F add r25,r24 |
956 0802 80E0 ldi r24,hi8(Mixer+77) |
957 0804 E030 cpi r30,lo8(Mixer+77) |
958 0806 F807 cpc r31,r24 |
959 0808 01F4 brne .L95 |
960 080a 9083 st Z,r25 |
961 080c 88EE ldi r24,lo8(1000) |
962 080e 93E0 ldi r25,hi8(1000) |
963 0810 60E0 ldi r22,lo8(Mixer) |
964 0812 70E0 ldi r23,hi8(Mixer) |
965 0814 4EE4 ldi r20,lo8(78) |
966 0816 50E0 ldi r21,hi8(78) |
967 0818 20E0 ldi r18,lo8(gs(eeprom_write_byte)) |
968 081a 30E0 ldi r19,hi8(gs(eeprom_write_byte)) |
969 081c 0E94 0000 call __eewr_block |
970 0820 81E0 ldi r24,lo8(1) |
971 0822 0895 ret |
973 .global ParamSet_WriteToEEProm |
975 ParamSet_WriteToEEProm: |
976 0824 1F93 push r17 |
977 /* prologue: function */ |
978 /* frame size = 0 */ |
979 0826 182F mov r17,r24 |
980 0828 8091 0000 lds r24,EE_Parameter |
981 082c 8435 cpi r24,lo8(84) |
982 082e 01F0 breq .+2 |
983 0830 00C0 rjmp .L99 |
984 0832 1630 cpi r17,lo8(6) |
985 0834 00F0 brlo .L100 |
986 0836 15E0 ldi r17,lo8(5) |
987 0838 00C0 rjmp .L101 |
988 .L100: |
989 083a 1123 tst r17 |
990 083c 01F4 brne .+2 |
991 083e 00C0 rjmp .L99 |
992 .L101: |
993 0840 E0E0 ldi r30,lo8(EE_Parameter) |
994 0842 F0E0 ldi r31,hi8(EE_Parameter) |
995 0844 9AEA ldi r25,lo8(-86) |
996 .L102: |
997 0846 8191 ld r24,Z+ |
998 0848 980F add r25,r24 |
999 084a 40E0 ldi r20,hi8(EE_Parameter+112) |
1000 084c E030 cpi r30,lo8(EE_Parameter+112) |
1001 084e F407 cpc r31,r20 |
1002 0850 01F4 brne .L102 |
1003 0852 9083 st Z,r25 |
1004 0854 812F mov r24,r17 |
1005 0856 90E0 ldi r25,lo8(0) |
1006 0858 0197 sbiw r24,1 |
1007 085a 21E7 ldi r18,lo8(113) |
1008 085c 30E0 ldi r19,hi8(113) |
1009 085e AC01 movw r20,r24 |
1010 0860 429F mul r20,r18 |
1011 0862 C001 movw r24,r0 |
1012 0864 439F mul r20,r19 |
1013 0866 900D add r25,r0 |
1014 0868 529F mul r21,r18 |
1015 086a 900D add r25,r0 |
1016 086c 1124 clr r1 |
1017 086e 8C59 subi r24,lo8(-(100)) |
1018 0870 9F4F sbci r25,hi8(-(100)) |
1019 0872 60E0 ldi r22,lo8(EE_Parameter) |
1020 0874 70E0 ldi r23,hi8(EE_Parameter) |
1021 0876 41E7 ldi r20,lo8(113) |
1022 0878 50E0 ldi r21,hi8(113) |
1023 087a 20E0 ldi r18,lo8(gs(eeprom_write_byte)) |
1024 087c 30E0 ldi r19,hi8(gs(eeprom_write_byte)) |
1025 087e 0E94 0000 call __eewr_block |
1026 0882 80E5 ldi r24,lo8(80) |
1027 0884 90E0 ldi r25,hi8(80) |
1028 0886 60E0 ldi r22,lo8(EE_Parameter+1) |
1029 0888 70E0 ldi r23,hi8(EE_Parameter+1) |
1030 088a 4CE0 ldi r20,lo8(12) |
1031 088c 50E0 ldi r21,hi8(12) |
1032 088e 20E0 ldi r18,lo8(gs(eeprom_write_byte)) |
1033 0890 30E0 ldi r19,hi8(gs(eeprom_write_byte)) |
1034 0892 0E94 0000 call __eewr_block |
1035 0896 E0E0 ldi r30,lo8(EE_Parameter+1) |
1036 0898 F0E0 ldi r31,hi8(EE_Parameter+1) |
1037 089a 2AEA ldi r18,lo8(-86) |
1038 .L103: |
1039 089c 8191 ld r24,Z+ |
1040 089e 280F add r18,r24 |
1041 08a0 50E0 ldi r21,hi8(EE_Parameter+13) |
1042 08a2 E030 cpi r30,lo8(EE_Parameter+13) |
1043 08a4 F507 cpc r31,r21 |
1044 08a6 01F4 brne .L103 |
1045 .L108: |
1046 08a8 F999 sbic 63-32,1 |
1047 08aa 00C0 rjmp .L108 |
1048 08ac 1FBA out 63-32,__zero_reg__ |
1049 08ae 8CE5 ldi r24,lo8(92) |
1050 08b0 90E0 ldi r25,hi8(92) |
1051 08b2 92BD out (65)+1-32,r25 |
1052 08b4 81BD out 65-32,r24 |
1053 08b6 20BD out 64-32,r18 |
1054 /* #APP */ |
1055 ; 315 "c:/winavr-20090313/lib/gcc/../../avr/include/avr/eeprom.h" 1 |
1056 /* START EEPROM WRITE CRITICAL SECTION */ |
1057 08b8 0FB6 in r0, 63 |
1058 08ba F894 cli |
1059 08bc FA9A sbi 31, 2 |
1060 08be F99A sbi 31, 1 |
1061 08c0 0FBE out 63, r0 |
1062 /* END EEPROM WRITE CRITICAL SECTION */ |
1063 ; 0 "" 2 |
1064 /* #NOAPP */ |
1065 .L105: |
1066 08c2 F999 sbic 63-32,1 |
1067 08c4 00C0 rjmp .L105 |
1068 08c6 1FBA out 63-32,__zero_reg__ |
1069 08c8 82E0 ldi r24,lo8(2) |
1070 08ca 90E0 ldi r25,hi8(2) |
1071 08cc 92BD out (65)+1-32,r25 |
1072 08ce 81BD out 65-32,r24 |
1073 08d0 10BD out 64-32,r17 |
1074 /* #APP */ |
1075 ; 315 "c:/winavr-20090313/lib/gcc/../../avr/include/avr/eeprom.h" 1 |
1076 /* START EEPROM WRITE CRITICAL SECTION */ |
1077 08d2 0FB6 in r0, 63 |
1078 08d4 F894 cli |
1079 08d6 FA9A sbi 31, 2 |
1080 08d8 F99A sbi 31, 1 |
1081 08da 0FBE out 63, r0 |
1082 /* END EEPROM WRITE CRITICAL SECTION */ |
1083 ; 0 "" 2 |
1084 /* #NOAPP */ |
1085 08dc 0E94 0000 call LED_Init |
1086 08e0 81E0 ldi r24,lo8(1) |
1087 08e2 00C0 rjmp .L106 |
1088 .L99: |
1089 08e4 80E0 ldi r24,lo8(0) |
1090 .L106: |
1091 /* epilogue start */ |
1092 08e6 1F91 pop r17 |
1093 08e8 0895 ret |
1095 .global ParamSet_ReadFromEEProm |
1097 ParamSet_ReadFromEEProm: |
1098 /* prologue: function */ |
1099 /* frame size = 0 */ |
1100 08ea 982F mov r25,r24 |
1101 08ec 8150 subi r24,lo8(-(-1)) |
1102 08ee 8530 cpi r24,lo8(5) |
1103 08f0 00F0 brlo .L114 |
1104 08f2 93E0 ldi r25,lo8(3) |
1105 .L114: |
1106 08f4 892F mov r24,r25 |
1107 08f6 90E0 ldi r25,lo8(0) |
1108 08f8 0197 sbiw r24,1 |
1109 08fa 21E7 ldi r18,lo8(113) |
1110 08fc 30E0 ldi r19,hi8(113) |
1111 08fe AC01 movw r20,r24 |
1112 0900 429F mul r20,r18 |
1113 0902 C001 movw r24,r0 |
1114 0904 439F mul r20,r19 |
1115 0906 900D add r25,r0 |
1116 0908 529F mul r21,r18 |
1117 090a 900D add r25,r0 |
1118 090c 1124 clr r1 |
1119 090e BC01 movw r22,r24 |
1120 0910 6C59 subi r22,lo8(-(100)) |
1121 0912 7F4F sbci r23,hi8(-(100)) |
1122 0914 9B01 movw r18,r22 |
1123 0916 4AEA ldi r20,lo8(-86) |
1124 0918 FC01 movw r30,r24 |
1125 091a EC52 subi r30,lo8(-(212)) |
1126 091c FF4F sbci r31,hi8(-(212)) |
1127 .L127: |
1128 091e F999 sbic 63-32,1 |
1129 0920 00C0 rjmp .L127 |
1130 0922 32BD out (65)+1-32,r19 |
1131 0924 21BD out 65-32,r18 |
1132 /* #APP */ |
1133 ; 208 "c:/winavr-20090313/lib/gcc/../../avr/include/avr/eeprom.h" 1 |
1134 /* START EEPROM READ CRITICAL SECTION */ |
1135 0926 F89A sbi 31, 0 |
1136 0928 80B5 in r24, 32 |
1137 /* END EEPROM READ CRITICAL SECTION */ |
1138 |
1139 ; 0 "" 2 |
1140 /* #NOAPP */ |
1141 092a 480F add r20,r24 |
1142 092c 2F5F subi r18,lo8(-(1)) |
1143 092e 3F4F sbci r19,hi8(-(1)) |
1144 0930 2E17 cp r18,r30 |
1145 0932 3F07 cpc r19,r31 |
1146 0934 01F4 brne .L127 |
1147 .L123: |
1148 0936 F999 sbic 63-32,1 |
1149 0938 00C0 rjmp .L123 |
1150 093a 6059 subi r22,lo8(-(112)) |
1151 093c 7F4F sbci r23,hi8(-(112)) |
1152 093e 72BD out (65)+1-32,r23 |
1153 0940 61BD out 65-32,r22 |
1154 0942 6057 subi r22,lo8(-(-112)) |
1155 0944 7040 sbci r23,hi8(-(-112)) |
1156 /* #APP */ |
1157 ; 208 "c:/winavr-20090313/lib/gcc/../../avr/include/avr/eeprom.h" 1 |
1158 /* START EEPROM READ CRITICAL SECTION */ |
1159 0946 F89A sbi 31, 0 |
1160 0948 80B5 in r24, 32 |
1161 /* END EEPROM READ CRITICAL SECTION */ |
1162 |
1163 ; 0 "" 2 |
1164 /* #NOAPP */ |
1165 094a 4817 cp r20,r24 |
1166 094c 01F4 brne .L117 |
1167 .L122: |
1168 094e F999 sbic 63-32,1 |
1169 0950 00C0 rjmp .L122 |
1170 0952 72BD out (65)+1-32,r23 |
1171 0954 61BD out 65-32,r22 |
1172 /* #APP */ |
1173 ; 208 "c:/winavr-20090313/lib/gcc/../../avr/include/avr/eeprom.h" 1 |
1174 /* START EEPROM READ CRITICAL SECTION */ |
1175 0956 F89A sbi 31, 0 |
1176 0958 80B5 in r24, 32 |
1177 /* END EEPROM READ CRITICAL SECTION */ |
1178 |
1179 ; 0 "" 2 |
1180 /* #NOAPP */ |
1181 095a 8435 cpi r24,lo8(84) |
1182 095c 01F4 brne .L117 |
1183 095e 80E0 ldi r24,lo8(EE_Parameter) |
1184 0960 90E0 ldi r25,hi8(EE_Parameter) |
1185 0962 41E7 ldi r20,lo8(113) |
1186 0964 50E0 ldi r21,hi8(113) |
1187 0966 20E0 ldi r18,lo8(gs(eeprom_read_byte)) |
1188 0968 30E0 ldi r19,hi8(gs(eeprom_read_byte)) |
1189 096a 0E94 0000 call __eerd_block |
1190 096e 0E94 0000 call LED_Init |
1191 0972 81E0 ldi r24,lo8(1) |
1192 0974 0895 ret |
1193 .L117: |
1194 0976 80E0 ldi r24,lo8(0) |
1195 0978 0895 ret |
1197 .global ParamSet_Init |
1199 ParamSet_Init: |
1200 097a A0E0 ldi r26,lo8(0) |
1201 097c B0E0 ldi r27,hi8(0) |
1202 097e E0E0 ldi r30,lo8(gs(1f)) |
1203 0980 F0E0 ldi r31,hi8(gs(1f)) |
1204 0982 0C94 0000 jmp __prologue_saves__+((18 - 18) * 2) |
1205 1: |
1206 /* prologue: function */ |
1207 /* frame size = 0 */ |
1208 .L129: |
1209 0986 F999 sbic 63-32,1 |
1210 0988 00C0 rjmp .L129 |
1211 098a 81E0 ldi r24,lo8(1) |
1212 098c 90E0 ldi r25,hi8(1) |
1213 098e 92BD out (65)+1-32,r25 |
1214 0990 81BD out 65-32,r24 |
1215 /* #APP */ |
1216 ; 208 "c:/winavr-20090313/lib/gcc/../../avr/include/avr/eeprom.h" 1 |
1217 /* START EEPROM READ CRITICAL SECTION */ |
1218 0992 F89A sbi 31, 0 |
1219 0994 80B5 in r24, 32 |
1220 /* END EEPROM READ CRITICAL SECTION */ |
1221 |
1222 ; 0 "" 2 |
1223 /* #NOAPP */ |
1224 0996 8435 cpi r24,lo8(84) |
1225 0998 01F4 brne .L154 |
1226 099a CC24 clr r12 |
1227 099c 00C0 rjmp .L131 |
1228 .L154: |
1229 099e F999 sbic 63-32,1 |
1230 09a0 00C0 rjmp .L154 |
1231 09a2 1FBA out 63-32,__zero_reg__ |
1232 09a4 81E0 ldi r24,lo8(1) |
1233 09a6 90E0 ldi r25,hi8(1) |
1234 09a8 92BD out (65)+1-32,r25 |
1235 09aa 81BD out 65-32,r24 |
1236 09ac 84E5 ldi r24,lo8(84) |
1237 09ae 80BD out 64-32,r24 |
1238 /* #APP */ |
1239 ; 315 "c:/winavr-20090313/lib/gcc/../../avr/include/avr/eeprom.h" 1 |
1240 /* START EEPROM WRITE CRITICAL SECTION */ |
1241 09b0 0FB6 in r0, 63 |
1242 09b2 F894 cli |
1243 09b4 FA9A sbi 31, 2 |
1244 09b6 F99A sbi 31, 1 |
1245 09b8 0FBE out 63, r0 |
1246 /* END EEPROM WRITE CRITICAL SECTION */ |
1247 ; 0 "" 2 |
1248 /* #NOAPP */ |
1249 09ba CC24 clr r12 |
1250 09bc C394 inc r12 |
1251 .L131: |
1252 09be EAEA ldi r30,lo8(-86) |
1253 09c0 DE2E mov r13,r30 |
1254 09c2 20E5 ldi r18,lo8(80) |
1255 09c4 30E0 ldi r19,hi8(80) |
1256 .L162: |
1257 09c6 F999 sbic 63-32,1 |
1258 09c8 00C0 rjmp .L162 |
1259 09ca 32BD out (65)+1-32,r19 |
1260 09cc 21BD out 65-32,r18 |
1261 /* #APP */ |
1262 ; 208 "c:/winavr-20090313/lib/gcc/../../avr/include/avr/eeprom.h" 1 |
1263 /* START EEPROM READ CRITICAL SECTION */ |
1264 09ce F89A sbi 31, 0 |
1265 09d0 80B5 in r24, 32 |
1266 /* END EEPROM READ CRITICAL SECTION */ |
1267 |
1268 ; 0 "" 2 |
1269 /* #NOAPP */ |
1270 09d2 D80E add r13,r24 |
1271 09d4 2F5F subi r18,lo8(-(1)) |
1272 09d6 3F4F sbci r19,hi8(-(1)) |
1273 09d8 2C35 cpi r18,92 |
1274 09da 3105 cpc r19,__zero_reg__ |
1275 09dc 01F4 brne .L162 |
1276 .L153: |
1277 09de F999 sbic 63-32,1 |
1278 09e0 00C0 rjmp .L153 |
1279 09e2 8CE5 ldi r24,lo8(92) |
1280 09e4 90E0 ldi r25,hi8(92) |
1281 09e6 92BD out (65)+1-32,r25 |
1282 09e8 81BD out 65-32,r24 |
1283 /* #APP */ |
1284 ; 208 "c:/winavr-20090313/lib/gcc/../../avr/include/avr/eeprom.h" 1 |
1285 /* START EEPROM READ CRITICAL SECTION */ |
1286 09ea F89A sbi 31, 0 |
1287 09ec 90B4 in r9, 32 |
1288 /* END EEPROM READ CRITICAL SECTION */ |
1289 |
1290 ; 0 "" 2 |
1291 /* #NOAPP */ |
1292 09ee EE24 clr r14 |
1293 09f0 01E0 ldi r16,lo8(1) |
1294 09f2 10E0 ldi r17,hi8(1) |
1295 09f4 70E0 ldi r23,lo8(gs(uart_putchar)) |
1296 09f6 A72E mov r10,r23 |
1297 09f8 70E0 ldi r23,hi8(gs(uart_putchar)) |
1298 09fa B72E mov r11,r23 |
1299 09fc C0E0 ldi r28,lo8(__c.2353) |
1300 09fe D0E0 ldi r29,hi8(__c.2353) |
1301 0a00 66E0 ldi r22,lo8(6) |
1302 0a02 262E mov r2,r22 |
1303 0a04 57E0 ldi r21,lo8(7) |
1304 0a06 352E mov r3,r21 |
1305 0a08 48E0 ldi r20,lo8(8) |
1306 0a0a 442E mov r4,r20 |
1307 0a0c 39E0 ldi r19,lo8(9) |
1308 0a0e 532E mov r5,r19 |
1309 0a10 2AE0 ldi r18,lo8(10) |
1310 0a12 622E mov r6,r18 |
1311 0a14 9BE0 ldi r25,lo8(11) |
1312 0a16 792E mov r7,r25 |
1313 0a18 8CE0 ldi r24,lo8(12) |
1314 0a1a 882E mov r8,r24 |
1315 .L143: |
1316 0a1c F02E mov r15,r16 |
1317 0a1e CC20 tst r12 |
1318 0a20 01F4 brne .L134 |
1319 0a22 802F mov r24,r16 |
1320 0a24 0E94 0000 call ParamSet_ReadFromEEProm |
1321 0a28 8823 tst r24 |
1322 0a2a 01F0 breq .+2 |
1323 0a2c 00C0 rjmp .L135 |
1324 .L134: |
1325 0a2e 00D0 rcall . |
1326 0a30 00D0 rcall . |
1327 0a32 00D0 rcall . |
1328 0a34 EDB7 in r30,__SP_L__ |
1329 0a36 FEB7 in r31,__SP_H__ |
1330 0a38 3196 adiw r30,1 |
1331 0a3a ADB7 in r26,__SP_L__ |
1332 0a3c BEB7 in r27,__SP_H__ |
1333 0a3e 1296 adiw r26,1+1 |
1334 0a40 BC92 st X,r11 |
1335 0a42 AE92 st -X,r10 |
1336 0a44 1197 sbiw r26,1 |
1337 0a46 D383 std Z+3,r29 |
1338 0a48 C283 std Z+2,r28 |
1339 0a4a 1583 std Z+5,r17 |
1340 0a4c 0483 std Z+4,r16 |
1341 0a4e E091 0000 lds r30,_printf_P |
1342 0a52 F091 0000 lds r31,(_printf_P)+1 |
1343 0a56 0995 icall |
1344 0a58 EDB7 in r30,__SP_L__ |
1345 0a5a FEB7 in r31,__SP_H__ |
1346 0a5c 3696 adiw r30,6 |
1347 0a5e EDBF out __SP_L__,r30 |
1348 0a60 F2E0 ldi r31,lo8(2) |
1349 0a62 FF16 cp r15,r31 |
1350 0a64 01F0 breq .L138 |
1351 0a66 83E0 ldi r24,lo8(3) |
1352 0a68 F816 cp r15,r24 |
1353 0a6a 01F0 breq .L163 |
1354 0a6c 91E0 ldi r25,lo8(1) |
1355 0a6e F916 cp r15,r25 |
1356 0a70 01F4 brne .L163 |
1357 0a72 0E94 0000 call ParamSet_DefaultSet1 |
1358 0a76 00C0 rjmp .L140 |
1359 .L138: |
1360 0a78 0E94 0000 call ParamSet_DefaultSet2 |
1361 0a7c 00C0 rjmp .L140 |
1362 .L163: |
1363 0a7e 0E94 0000 call ParamSet_DefaultSet3 |
1364 .L140: |
1365 0a82 D914 cp r13,r9 |
1366 0a84 01F4 brne .L141 |
1367 0a86 80E0 ldi r24,lo8(EE_Parameter+1) |
1368 0a88 90E0 ldi r25,hi8(EE_Parameter+1) |
1369 0a8a 60E5 ldi r22,lo8(80) |
1370 0a8c 70E0 ldi r23,hi8(80) |
1371 0a8e 4CE0 ldi r20,lo8(12) |
1372 0a90 50E0 ldi r21,hi8(12) |
1373 0a92 20E0 ldi r18,lo8(gs(eeprom_read_byte)) |
1374 0a94 30E0 ldi r19,hi8(gs(eeprom_read_byte)) |
1375 0a96 0E94 0000 call __eerd_block |
1376 0a9a 00C0 rjmp .L142 |
1377 .L141: |
1378 0a9c A1E0 ldi r26,lo8(1) |
1379 0a9e A093 0000 sts EE_Parameter+3,r26 |
1380 0aa2 B2E0 ldi r27,lo8(2) |
1381 0aa4 B093 0000 sts EE_Parameter+2,r27 |
1382 0aa8 E3E0 ldi r30,lo8(3) |
1383 0aaa E093 0000 sts EE_Parameter+1,r30 |
1384 0aae F4E0 ldi r31,lo8(4) |
1385 0ab0 F093 0000 sts EE_Parameter+4,r31 |
1386 0ab4 85E0 ldi r24,lo8(5) |
1387 0ab6 8093 0000 sts EE_Parameter+5,r24 |
1388 0aba 2092 0000 sts EE_Parameter+6,r2 |
1389 0abe 3092 0000 sts EE_Parameter+7,r3 |
1390 0ac2 4092 0000 sts EE_Parameter+8,r4 |
1391 0ac6 5092 0000 sts EE_Parameter+9,r5 |
1392 0aca 6092 0000 sts EE_Parameter+10,r6 |
1393 0ace 7092 0000 sts EE_Parameter+11,r7 |
1394 0ad2 8092 0000 sts EE_Parameter+12,r8 |
1395 .L142: |
1396 0ad6 8F2D mov r24,r15 |
1397 0ad8 0E94 0000 call ParamSet_WriteToEEProm |
1398 0adc EE24 clr r14 |
1399 0ade E394 inc r14 |
1400 .L135: |
1401 0ae0 0F5F subi r16,lo8(-(1)) |
1402 0ae2 1F4F sbci r17,hi8(-(1)) |
1403 0ae4 0630 cpi r16,6 |
1404 0ae6 1105 cpc r17,__zero_reg__ |
1405 0ae8 01F0 breq .+2 |
1406 0aea 00C0 rjmp .L143 |
1407 0aec EE20 tst r14 |
1408 0aee 01F0 breq .L144 |
1409 .L152: |
1410 0af0 F999 sbic 63-32,1 |
1411 0af2 00C0 rjmp .L152 |
1412 0af4 1FBA out 63-32,__zero_reg__ |
1413 0af6 82E0 ldi r24,lo8(2) |
1414 0af8 90E0 ldi r25,hi8(2) |
1415 0afa 92BD out (65)+1-32,r25 |
1416 0afc 81BD out 65-32,r24 |
1417 0afe 83E0 ldi r24,lo8(3) |
1418 0b00 80BD out 64-32,r24 |
1419 /* #APP */ |
1420 ; 315 "c:/winavr-20090313/lib/gcc/../../avr/include/avr/eeprom.h" 1 |
1421 /* START EEPROM WRITE CRITICAL SECTION */ |
1422 0b02 0FB6 in r0, 63 |
1423 0b04 F894 cli |
1424 0b06 FA9A sbi 31, 2 |
1425 0b08 F99A sbi 31, 1 |
1426 0b0a 0FBE out 63, r0 |
1427 /* END EEPROM WRITE CRITICAL SECTION */ |
1428 ; 0 "" 2 |
1429 /* #NOAPP */ |
1430 .L144: |
1431 0b0c 0E94 0000 call GetActiveParamSet |
1432 0b10 182F mov r17,r24 |
1433 0b12 0E94 0000 call ParamSet_ReadFromEEProm |
1434 0b16 00D0 rcall . |
1435 0b18 00D0 rcall . |
1436 0b1a 00D0 rcall . |
1437 0b1c EDB7 in r30,__SP_L__ |
1438 0b1e FEB7 in r31,__SP_H__ |
1439 0b20 3196 adiw r30,1 |
1440 0b22 80E0 ldi r24,lo8(gs(uart_putchar)) |
1441 0b24 90E0 ldi r25,hi8(gs(uart_putchar)) |
1442 0b26 ADB7 in r26,__SP_L__ |
1443 0b28 BEB7 in r27,__SP_H__ |
1444 0b2a 1296 adiw r26,1+1 |
1445 0b2c 9C93 st X,r25 |
1446 0b2e 8E93 st -X,r24 |
1447 0b30 1197 sbiw r26,1 |
1448 0b32 80E0 ldi r24,lo8(__c.2363) |
1449 0b34 90E0 ldi r25,hi8(__c.2363) |
1450 0b36 9383 std Z+3,r25 |
1451 0b38 8283 std Z+2,r24 |
1452 0b3a 1483 std Z+4,r17 |
1453 0b3c 1582 std Z+5,__zero_reg__ |
1454 0b3e E091 0000 lds r30,_printf_P |
1455 0b42 F091 0000 lds r31,(_printf_P)+1 |
1456 0b46 0995 icall |
1457 0b48 EDB7 in r30,__SP_L__ |
1458 0b4a FEB7 in r31,__SP_H__ |
1459 0b4c 3696 adiw r30,6 |
1460 0b4e EDBF out __SP_L__,r30 |
1461 0b50 CC20 tst r12 |
1462 0b52 01F4 brne .L146 |
1463 0b54 0E94 0000 call MixerTable_ReadFromEEProm |
1464 0b58 8823 tst r24 |
1465 0b5a 01F4 brne .L147 |
1466 .L146: |
1467 0b5c 00D0 rcall . |
1468 0b5e 00D0 rcall . |
1469 0b60 80E0 ldi r24,lo8(gs(uart_putchar)) |
1470 0b62 90E0 ldi r25,hi8(gs(uart_putchar)) |
1471 0b64 ADB7 in r26,__SP_L__ |
1472 0b66 BEB7 in r27,__SP_H__ |
1473 0b68 1296 adiw r26,1+1 |
1474 0b6a 9C93 st X,r25 |
1475 0b6c 8E93 st -X,r24 |
1476 0b6e 1197 sbiw r26,1 |
1477 0b70 80E0 ldi r24,lo8(__c.2365) |
1478 0b72 90E0 ldi r25,hi8(__c.2365) |
1479 0b74 1496 adiw r26,3+1 |
1480 0b76 9C93 st X,r25 |
1481 0b78 8E93 st -X,r24 |
1482 0b7a 1397 sbiw r26,3 |
1483 0b7c E091 0000 lds r30,_printf_P |
1484 0b80 F091 0000 lds r31,(_printf_P)+1 |
1485 0b84 0995 icall |
1486 0b86 0F90 pop __tmp_reg__ |
1487 0b88 0F90 pop __tmp_reg__ |
1488 0b8a 0F90 pop __tmp_reg__ |
1489 0b8c 0F90 pop __tmp_reg__ |
1490 0b8e 0E94 0000 call MixerTable_Default |
1491 0b92 0E94 0000 call MixerTable_WriteToEEProm |
1492 .L147: |
1493 0b96 1092 0000 sts RequiredMotors,__zero_reg__ |
1494 0b9a E0E0 ldi r30,lo8(Mixer+13) |
1495 0b9c F0E0 ldi r31,hi8(Mixer+13) |
1496 .L149: |
1497 0b9e 8081 ld r24,Z |
1498 0ba0 1816 cp __zero_reg__,r24 |
1499 0ba2 04F4 brge .L148 |
1500 0ba4 8091 0000 lds r24,RequiredMotors |
1501 0ba8 8F5F subi r24,lo8(-(1)) |
1502 0baa 8093 0000 sts RequiredMotors,r24 |
1503 .L148: |
1504 0bae 3496 adiw r30,4 |
1505 0bb0 B0E0 ldi r27,hi8(Mixer+77) |
1506 0bb2 E030 cpi r30,lo8(Mixer+77) |
1507 0bb4 FB07 cpc r31,r27 |
1508 0bb6 01F4 brne .L149 |
1509 0bb8 EDB7 in r30,__SP_L__ |
1510 0bba FEB7 in r31,__SP_H__ |
1511 0bbc 3897 sbiw r30,8 |
1512 0bbe EDBF out __SP_L__,r30 |
1513 0bc0 3196 adiw r30,1 |
1514 0bc2 00E0 ldi r16,lo8(gs(uart_putchar)) |
1515 0bc4 10E0 ldi r17,hi8(gs(uart_putchar)) |
1516 0bc6 ADB7 in r26,__SP_L__ |
1517 0bc8 BEB7 in r27,__SP_H__ |
1518 0bca 1296 adiw r26,1+1 |
1519 0bcc 1C93 st X,r17 |
1520 0bce 0E93 st -X,r16 |
1521 0bd0 1197 sbiw r26,1 |
1522 0bd2 80E0 ldi r24,lo8(__c.2370) |
1523 0bd4 90E0 ldi r25,hi8(__c.2370) |
1524 0bd6 9383 std Z+3,r25 |
1525 0bd8 8283 std Z+2,r24 |
1526 0bda 80E0 ldi r24,lo8(Mixer+1) |
1527 0bdc 90E0 ldi r25,hi8(Mixer+1) |
1528 0bde 9583 std Z+5,r25 |
1529 0be0 8483 std Z+4,r24 |
1530 0be2 8091 0000 lds r24,RequiredMotors |
1531 0be6 8683 std Z+6,r24 |
1532 0be8 1782 std Z+7,__zero_reg__ |
1533 0bea E091 0000 lds r30,_printf_P |
1534 0bee F091 0000 lds r31,(_printf_P)+1 |
1535 0bf2 0995 icall |
1536 0bf4 0F90 pop __tmp_reg__ |
1537 0bf6 0F90 pop __tmp_reg__ |
1538 0bf8 0F90 pop __tmp_reg__ |
1539 0bfa 0F90 pop __tmp_reg__ |
1540 0bfc EDB7 in r30,__SP_L__ |
1541 0bfe FEB7 in r31,__SP_H__ |
1542 0c00 1283 std Z+2,r17 |
1543 0c02 0183 std Z+1,r16 |
1544 0c04 80E0 ldi r24,lo8(__c.2372) |
1545 0c06 90E0 ldi r25,hi8(__c.2372) |
1546 0c08 9483 std Z+4,r25 |
1547 0c0a 8383 std Z+3,r24 |
1548 0c0c E091 0000 lds r30,_printf_P |
1549 0c10 F091 0000 lds r31,(_printf_P)+1 |
1550 0c14 0995 icall |
1551 0c16 0F90 pop __tmp_reg__ |
1552 0c18 0F90 pop __tmp_reg__ |
1553 0c1a 0F90 pop __tmp_reg__ |
1554 0c1c 0F90 pop __tmp_reg__ |
1555 /* epilogue start */ |
1556 0c1e CDB7 in r28,__SP_L__ |
1557 0c20 DEB7 in r29,__SP_H__ |
1558 0c22 E2E1 ldi r30, lo8(18) |
1559 0c24 0C94 0000 jmp __epilogue_restores__ + ((18 - 18) * 2) |
1561 .global SetParamWord |
1563 SetParamWord: |
1564 /* prologue: function */ |
1565 /* frame size = 0 */ |
1566 0c28 40E0 ldi r20,lo8(gs(eeprom_write_byte)) |
1567 0c2a 50E0 ldi r21,hi8(gs(eeprom_write_byte)) |
1568 0c2c 0E94 0000 call __eewr_word |
1569 /* epilogue start */ |
1570 0c30 0895 ret |
1572 .global GetParamWord |
1574 GetParamWord: |
1575 /* prologue: function */ |
1576 /* frame size = 0 */ |
1577 0c32 60E0 ldi r22,lo8(gs(eeprom_read_byte)) |
1578 0c34 70E0 ldi r23,hi8(gs(eeprom_read_byte)) |
1579 0c36 0E94 0000 call __eerd_word |
1580 /* epilogue start */ |
1581 0c3a 0895 ret |
1583 .section .progmem.data,"a",@progbits |
1586 __c.2372: |
1587 0000 0A0D 3D3D .string "\n\r==============================" |
1587 3D3D 3D3D |
1587 3D3D 3D3D |
1587 3D3D 3D3D |
1587 3D3D 3D3D |
1590 __c.2370: |
1591 0021 0A0D 4D69 .string "\n\rMixer-Config: '%s' (%u Motors)" |
1591 7865 722D |
1591 436F 6E66 |
1591 6967 3A20 |
1591 2725 7327 |
1594 __c.2365: |
1595 0042 0A0D 4765 .string "\n\rGenerating default Mixer Table" |
1595 6E65 7261 |
1595 7469 6E67 |
1595 2064 6566 |
1595 6175 6C74 |
1598 __c.2363: |
1599 0063 0A0D 5573 .string "\n\rUsing Parameter Set %d" |
1599 696E 6720 |
1599 5061 7261 |
1599 6D65 7465 |
1599 7220 5365 |
1602 __c.2353: |
1603 007c 0A0D 4765 .string "\n\rGenerating default Parameter Set %d" |
1603 6E65 7261 |
1603 7469 6E67 |
1603 2064 6566 |
1603 6175 6C74 |
1604 .comm Mixer,78,1 |
1605 .comm RequiredMotors,1,1 |
1606 .comm EE_Parameter,113,1 |
1607 .global __do_copy_data |
1608 .global __do_clear_bss |
8 .global __do_copy_data |
9 .global __do_clear_bss |
10 .text |
11 .global RAM_Checksum |
13 RAM_Checksum: |
14 /* prologue: frame size=0 */ |
15 /* prologue end (size=0) */ |
16 0000 4AEA ldi r20,lo8(-86) |
17 0002 20E0 ldi r18,lo8(0) |
18 0004 30E0 ldi r19,hi8(0) |
19 0006 2617 cp r18,r22 |
20 0008 3707 cpc r19,r23 |
21 000a 40F4 brsh .L7 |
22 000c FC01 movw r30,r24 |
23 .L5: |
24 000e 8191 ld r24,Z+ |
25 0010 480F add r20,r24 |
26 0012 2F5F subi r18,lo8(-(1)) |
27 0014 3F4F sbci r19,hi8(-(1)) |
28 0016 2617 cp r18,r22 |
29 0018 3707 cpc r19,r23 |
30 001a C8F3 brlo .L5 |
31 .L7: |
32 001c 842F mov r24,r20 |
33 001e 9927 clr r25 |
34 /* epilogue: frame size=0 */ |
35 0020 0895 ret |
36 /* epilogue end (size=1) */ |
37 /* function RAM_Checksum size 17 (16) */ |
39 .global EEProm_Checksum |
41 EEProm_Checksum: |
42 /* prologue: frame size=0 */ |
43 /* prologue end (size=0) */ |
44 0022 AC01 movw r20,r24 |
45 0024 9AEA ldi r25,lo8(-86) |
46 0026 20E0 ldi r18,lo8(0) |
47 0028 30E0 ldi r19,hi8(0) |
48 .L16: |
49 002a 2617 cp r18,r22 |
50 002c 3707 cpc r19,r23 |
51 002e 50F4 brsh .L15 |
52 0030 DA01 movw r26,r20 |
53 0032 A20F add r26,r18 |
54 0034 B31F adc r27,r19 |
55 /* #APP */ |
56 0036 0E94 0000 call __eeprom_read_byte_1F2021 |
57 003a 802D mov r24,__tmp_reg__ |
58 /* #NOAPP */ |
59 003c 980F add r25,r24 |
60 003e 2F5F subi r18,lo8(-(1)) |
61 0040 3F4F sbci r19,hi8(-(1)) |
62 0042 F3CF rjmp .L16 |
63 .L15: |
64 0044 892F mov r24,r25 |
65 0046 9927 clr r25 |
66 /* epilogue: frame size=0 */ |
67 0048 0895 ret |
68 /* epilogue end (size=1) */ |
69 /* function EEProm_Checksum size 21 (20) */ |
71 .global ParamSet_DefaultStickMapping |
73 ParamSet_DefaultStickMapping: |
74 /* prologue: frame size=0 */ |
75 /* prologue end (size=0) */ |
76 004a 81E0 ldi r24,lo8(1) |
77 004c 8093 0000 sts EE_Parameter+3,r24 |
78 0050 82E0 ldi r24,lo8(2) |
79 0052 8093 0000 sts EE_Parameter+2,r24 |
80 0056 83E0 ldi r24,lo8(3) |
81 0058 8093 0000 sts EE_Parameter+1,r24 |
82 005c 84E0 ldi r24,lo8(4) |
83 005e 8093 0000 sts EE_Parameter+4,r24 |
84 0062 85E0 ldi r24,lo8(5) |
85 0064 8093 0000 sts EE_Parameter+5,r24 |
86 0068 86E0 ldi r24,lo8(6) |
87 006a 8093 0000 sts EE_Parameter+6,r24 |
88 006e 87E0 ldi r24,lo8(7) |
89 0070 8093 0000 sts EE_Parameter+7,r24 |
90 0074 88E0 ldi r24,lo8(8) |
91 0076 8093 0000 sts EE_Parameter+8,r24 |
92 007a 89E0 ldi r24,lo8(9) |
93 007c 8093 0000 sts EE_Parameter+9,r24 |
94 0080 8AE0 ldi r24,lo8(10) |
95 0082 8093 0000 sts EE_Parameter+10,r24 |
96 0086 8BE0 ldi r24,lo8(11) |
97 0088 8093 0000 sts EE_Parameter+11,r24 |
98 008c 8CE0 ldi r24,lo8(12) |
99 008e 8093 0000 sts EE_Parameter+12,r24 |
100 /* epilogue: frame size=0 */ |
101 0092 0895 ret |
102 /* epilogue end (size=1) */ |
103 /* function ParamSet_DefaultStickMapping size 37 (36) */ |
105 .data |
106 .LC0: |
107 0000 5370 6F72 .string "Sport" |
107 7400 |
108 0006 00 .string "" |
109 .text |
110 .global ParamSet_DefaultSet1 |
112 ParamSet_DefaultSet1: |
113 /* prologue: frame size=0 */ |
114 0094 1F93 push r17 |
115 0096 CF93 push r28 |
116 0098 DF93 push r29 |
117 /* prologue end (size=3) */ |
118 009a 84E5 ldi r24,lo8(84) |
119 009c 8093 0000 sts EE_Parameter,r24 |
120 00a0 8091 0000 lds r24,PlatinenVersion |
121 00a4 8431 cpi r24,lo8(20) |
122 00a6 50F0 brlo .L19 |
123 00a8 8AE0 ldi r24,lo8(10) |
124 00aa 8093 0000 sts EE_Parameter+32,r24 |
125 00ae 1092 0000 sts EE_Parameter+66,__zero_reg__ |
126 00b2 8BE1 ldi r24,lo8(27) |
127 00b4 8093 0000 sts EE_Parameter+28,r24 |
128 00b8 8EE4 ldi r24,lo8(78) |
129 00ba 0AC0 rjmp .L21 |
130 .L19: |
131 00bc 83E0 ldi r24,lo8(3) |
132 00be 8093 0000 sts EE_Parameter+32,r24 |
133 00c2 80E2 ldi r24,lo8(32) |
134 00c4 8093 0000 sts EE_Parameter+66,r24 |
135 00c8 8EE1 ldi r24,lo8(30) |
136 00ca 8093 0000 sts EE_Parameter+28,r24 |
137 00ce 85E5 ldi r24,lo8(85) |
138 .L21: |
139 00d0 8093 0000 sts EE_Parameter+63,r24 |
140 00d4 8093 0000 sts EE_Parameter+64,r24 |
141 00d8 8AE6 ldi r24,lo8(106) |
142 00da 8093 0000 sts EE_Parameter+13,r24 |
143 00de 83E0 ldi r24,lo8(3) |
144 00e0 8093 0000 sts EE_Parameter+99,r24 |
145 00e4 AEE1 ldi r26,lo8(30) |
146 00e6 A093 0000 sts EE_Parameter+14,r26 |
147 00ea 8FEF ldi r24,lo8(-1) |
148 00ec 8093 0000 sts EE_Parameter+16,r24 |
149 00f0 EFE0 ldi r30,lo8(15) |
150 00f2 E093 0000 sts EE_Parameter+17,r30 |
151 00f6 A093 0000 sts EE_Parameter+15,r26 |
152 00fa 1092 0000 sts EE_Parameter+19,__zero_reg__ |
153 00fe F8E0 ldi r31,lo8(8) |
154 0100 F093 0000 sts EE_Parameter+20,r31 |
155 0104 80E4 ldi r24,lo8(64) |
156 0106 8093 0000 sts EE_Parameter+21,r24 |
157 010a 1092 0000 sts EE_Parameter+22,__zero_reg__ |
158 010e 84E1 ldi r24,lo8(20) |
159 0110 8093 0000 sts EE_Parameter+18,r24 |
160 0114 8EE0 ldi r24,lo8(14) |
161 0116 8093 0000 sts EE_Parameter+23,r24 |
162 011a B0E1 ldi r27,lo8(16) |
163 011c B093 0000 sts EE_Parameter+24,r27 |
164 0120 1CE0 ldi r17,lo8(12) |
165 0122 1093 0000 sts EE_Parameter+25,r17 |
166 0126 F093 0000 sts EE_Parameter+26,r31 |
167 012a 86EE ldi r24,lo8(-26) |
168 012c 8093 0000 sts EE_Parameter+27,r24 |
169 0130 80E8 ldi r24,lo8(-128) |
170 0132 8093 0000 sts EE_Parameter+29,r24 |
171 0136 50E5 ldi r21,lo8(80) |
172 0138 5093 0000 sts EE_Parameter+30,r21 |
173 013c 86E9 ldi r24,lo8(-106) |
174 013e 8093 0000 sts EE_Parameter+31,r24 |
175 0142 5093 0000 sts EE_Parameter+33,r21 |
176 0146 8093 0000 sts EE_Parameter+34,r24 |
177 014a 76E0 ldi r23,lo8(6) |
178 014c 7093 0000 sts EE_Parameter+35,r23 |
179 0150 81E2 ldi r24,lo8(33) |
180 0152 8093 0000 sts EE_Parameter+36,r24 |
181 0156 8DE2 ldi r24,lo8(45) |
182 0158 8093 0000 sts EE_Parameter+37,r24 |
183 015c 9AE5 ldi r25,lo8(90) |
184 015e 9093 0000 sts EE_Parameter+38,r25 |
185 0162 80E2 ldi r24,lo8(32) |
186 0164 8093 0000 sts EE_Parameter+40,r24 |
187 0168 1092 0000 sts EE_Parameter+41,__zero_reg__ |
188 016c 1092 0000 sts EE_Parameter+42,__zero_reg__ |
189 0170 1092 0000 sts EE_Parameter+43,__zero_reg__ |
190 0174 1092 0000 sts EE_Parameter+44,__zero_reg__ |
191 0178 1092 0000 sts EE_Parameter+68,__zero_reg__ |
192 017c 1092 0000 sts EE_Parameter+69,__zero_reg__ |
193 0180 1092 0000 sts EE_Parameter+70,__zero_reg__ |
194 0184 1092 0000 sts EE_Parameter+71,__zero_reg__ |
195 0188 34E6 ldi r19,lo8(100) |
196 018a 3093 0000 sts EE_Parameter+45,r19 |
197 018e 48E2 ldi r20,lo8(40) |
198 0190 4093 0000 sts EE_Parameter+46,r20 |
199 0194 61E0 ldi r22,lo8(1) |
200 0196 6093 0000 sts EE_Parameter+98,r22 |
201 019a 1092 0000 sts EE_Parameter+47,__zero_reg__ |
202 019e 27EF ldi r18,lo8(-9) |
203 01a0 2093 0000 sts EE_Parameter+48,r18 |
204 01a4 7093 0000 sts EE_Parameter+53,r23 |
205 01a8 8DE7 ldi r24,lo8(125) |
206 01aa 8093 0000 sts EE_Parameter+54,r24 |
207 01ae 8093 0000 sts EE_Parameter+55,r24 |
208 01b2 8093 0000 sts EE_Parameter+56,r24 |
209 01b6 3093 0000 sts EE_Parameter+49,r19 |
210 01ba 4093 0000 sts EE_Parameter+50,r20 |
211 01be 1092 0000 sts EE_Parameter+51,__zero_reg__ |
212 01c2 2093 0000 sts EE_Parameter+52,r18 |
213 01c6 82E3 ldi r24,lo8(50) |
214 01c8 8093 0000 sts EE_Parameter+57,r24 |
215 01cc 9093 0000 sts EE_Parameter+58,r25 |
216 01d0 8093 0000 sts EE_Parameter+59,r24 |
217 01d4 1092 0000 sts EE_Parameter+97,__zero_reg__ |
218 01d8 9093 0000 sts EE_Parameter+60,r25 |
219 01dc 5093 0000 sts EE_Parameter+61,r21 |
220 01e0 6093 0000 sts EE_Parameter+62,r22 |
221 01e4 B093 0000 sts EE_Parameter+65,r27 |
222 01e8 3093 0000 sts EE_Parameter+67,r19 |
223 01ec 8FE5 ldi r24,lo8(95) |
224 01ee 8093 0000 sts EE_Parameter+72,r24 |
225 01f2 83EF ldi r24,lo8(-13) |
226 01f4 8093 0000 sts EE_Parameter+74,r24 |
227 01f8 8AEA ldi r24,lo8(-86) |
228 01fa 8093 0000 sts EE_Parameter+76,r24 |
229 01fe 8093 0000 sts EE_Parameter+77,r24 |
230 0202 E093 0000 sts EE_Parameter+73,r30 |
231 0206 E093 0000 sts EE_Parameter+75,r30 |
232 020a 8EEF ldi r24,lo8(-2) |
233 020c 8093 0000 sts EE_Parameter+78,r24 |
234 0210 3093 0000 sts EE_Parameter+79,r19 |
235 0214 9093 0000 sts EE_Parameter+80,r25 |
236 0218 9093 0000 sts EE_Parameter+81,r25 |
237 021c 9093 0000 sts EE_Parameter+82,r25 |
238 0220 8BE4 ldi r24,lo8(75) |
239 0222 8093 0000 sts EE_Parameter+83,r24 |
240 0226 8093 0000 sts EE_Parameter+84,r24 |
241 022a 8093 0000 sts EE_Parameter+85,r24 |
242 022e 1092 0000 sts EE_Parameter+86,__zero_reg__ |
243 0232 7093 0000 sts EE_Parameter+87,r23 |
244 0236 F093 0000 sts EE_Parameter+88,r31 |
245 023a 9093 0000 sts EE_Parameter+89,r25 |
246 023e A093 0000 sts EE_Parameter+90,r26 |
247 0242 3093 0000 sts EE_Parameter+91,r19 |
248 0246 3093 0000 sts EE_Parameter+92,r19 |
249 024a 82E0 ldi r24,lo8(2) |
250 024c 8093 0000 sts EE_Parameter+93,r24 |
251 0250 6093 0000 sts EE_Parameter+39,r22 |
252 0254 1092 0000 sts EE_Parameter+95,__zero_reg__ |
253 0258 1092 0000 sts EE_Parameter+96,__zero_reg__ |
254 025c A0E0 ldi r26,lo8(EE_Parameter+100) |
255 025e B0E0 ldi r27,hi8(EE_Parameter+100) |
256 0260 E0E0 ldi r30,lo8(.LC0) |
257 0262 F0E0 ldi r31,hi8(.LC0) |
258 0264 ED01 movw r28,r26 |
259 0266 0190 ld __tmp_reg__,Z+ |
260 0268 0992 st Y+,__tmp_reg__ |
261 026a 1A95 dec r17 |
262 026c E1F7 brne .-8 |
263 026e 60E7 ldi r22,lo8(112) |
264 0270 70E0 ldi r23,hi8(112) |
265 0272 CD01 movw r24,r26 |
266 0274 8456 subi r24,lo8(-(-100)) |
267 0276 9040 sbci r25,hi8(-(-100)) |
268 0278 0E94 0000 call RAM_Checksum |
269 027c 8093 0000 sts EE_Parameter+112,r24 |
270 /* epilogue: frame size=0 */ |
271 0280 DF91 pop r29 |
272 0282 CF91 pop r28 |
273 0284 1F91 pop r17 |
274 0286 0895 ret |
275 /* epilogue end (size=4) */ |
276 /* function ParamSet_DefaultSet1 size 250 (243) */ |
278 .data |
279 .LC1: |
280 0007 4E6F 726D .string "Normal" |
280 616C 00 |
281 000e 00 .string "" |
282 .text |
283 .global ParamSet_DefaultSet2 |
285 ParamSet_DefaultSet2: |
286 /* prologue: frame size=0 */ |
287 0288 CF93 push r28 |
288 028a DF93 push r29 |
289 /* prologue end (size=2) */ |
290 028c 84E5 ldi r24,lo8(84) |
291 028e 8093 0000 sts EE_Parameter,r24 |
292 0292 8091 0000 lds r24,PlatinenVersion |
293 0296 8431 cpi r24,lo8(20) |
294 0298 50F0 brlo .L23 |
295 029a 8AE0 ldi r24,lo8(10) |
296 029c 8093 0000 sts EE_Parameter+32,r24 |
297 02a0 1092 0000 sts EE_Parameter+66,__zero_reg__ |
298 02a4 8BE1 ldi r24,lo8(27) |
299 02a6 8093 0000 sts EE_Parameter+28,r24 |
300 02aa 8EE4 ldi r24,lo8(78) |
301 02ac 0AC0 rjmp .L25 |
302 .L23: |
303 02ae 83E0 ldi r24,lo8(3) |
304 02b0 8093 0000 sts EE_Parameter+32,r24 |
305 02b4 80E2 ldi r24,lo8(32) |
306 02b6 8093 0000 sts EE_Parameter+66,r24 |
307 02ba 8EE1 ldi r24,lo8(30) |
308 02bc 8093 0000 sts EE_Parameter+28,r24 |
309 02c0 85E5 ldi r24,lo8(85) |
310 .L25: |
311 02c2 8093 0000 sts EE_Parameter+63,r24 |
312 02c6 8093 0000 sts EE_Parameter+64,r24 |
313 02ca 8AE6 ldi r24,lo8(106) |
314 02cc 8093 0000 sts EE_Parameter+13,r24 |
315 02d0 83E0 ldi r24,lo8(3) |
316 02d2 8093 0000 sts EE_Parameter+99,r24 |
317 02d6 7EE1 ldi r23,lo8(30) |
318 02d8 7093 0000 sts EE_Parameter+14,r23 |
319 02dc 8FEF ldi r24,lo8(-1) |
320 02de 8093 0000 sts EE_Parameter+16,r24 |
321 02e2 9FE0 ldi r25,lo8(15) |
322 02e4 9093 0000 sts EE_Parameter+17,r25 |
323 02e8 7093 0000 sts EE_Parameter+15,r23 |
324 02ec 1092 0000 sts EE_Parameter+19,__zero_reg__ |
325 02f0 68E0 ldi r22,lo8(8) |
326 02f2 6093 0000 sts EE_Parameter+20,r22 |
327 02f6 80E4 ldi r24,lo8(64) |
328 02f8 8093 0000 sts EE_Parameter+21,r24 |
329 02fc 1092 0000 sts EE_Parameter+22,__zero_reg__ |
330 0300 9093 0000 sts EE_Parameter+18,r25 |
331 0304 8AE0 ldi r24,lo8(10) |
332 0306 8093 0000 sts EE_Parameter+23,r24 |
333 030a 80E1 ldi r24,lo8(16) |
334 030c 8093 0000 sts EE_Parameter+24,r24 |
335 0310 56E0 ldi r21,lo8(6) |
336 0312 5093 0000 sts EE_Parameter+25,r21 |
337 0316 6093 0000 sts EE_Parameter+26,r22 |
338 031a 86EE ldi r24,lo8(-26) |
339 031c 8093 0000 sts EE_Parameter+27,r24 |
340 0320 80E8 ldi r24,lo8(-128) |
341 0322 8093 0000 sts EE_Parameter+29,r24 |
342 0326 2AE5 ldi r18,lo8(90) |
343 0328 2093 0000 sts EE_Parameter+30,r18 |
344 032c 88E7 ldi r24,lo8(120) |
345 032e 8093 0000 sts EE_Parameter+31,r24 |
346 0332 2093 0000 sts EE_Parameter+33,r18 |
347 0336 8093 0000 sts EE_Parameter+34,r24 |
348 033a 5093 0000 sts EE_Parameter+35,r21 |
349 033e 81E2 ldi r24,lo8(33) |
350 0340 8093 0000 sts EE_Parameter+36,r24 |
351 0344 8DE2 ldi r24,lo8(45) |
352 0346 8093 0000 sts EE_Parameter+37,r24 |
353 034a 2093 0000 sts EE_Parameter+38,r18 |
354 034e E0E2 ldi r30,lo8(32) |
355 0350 E093 0000 sts EE_Parameter+40,r30 |
356 0354 1092 0000 sts EE_Parameter+41,__zero_reg__ |
357 0358 1092 0000 sts EE_Parameter+42,__zero_reg__ |
358 035c 1092 0000 sts EE_Parameter+43,__zero_reg__ |
359 0360 1092 0000 sts EE_Parameter+44,__zero_reg__ |
360 0364 1092 0000 sts EE_Parameter+68,__zero_reg__ |
361 0368 1092 0000 sts EE_Parameter+69,__zero_reg__ |
362 036c 1092 0000 sts EE_Parameter+70,__zero_reg__ |
363 0370 1092 0000 sts EE_Parameter+71,__zero_reg__ |
364 0374 44E6 ldi r20,lo8(100) |
365 0376 4093 0000 sts EE_Parameter+45,r20 |
366 037a 38E2 ldi r19,lo8(40) |
367 037c 3093 0000 sts EE_Parameter+46,r19 |
368 0380 F1E0 ldi r31,lo8(1) |
369 0382 F093 0000 sts EE_Parameter+98,r31 |
370 0386 1092 0000 sts EE_Parameter+47,__zero_reg__ |
371 038a 97EF ldi r25,lo8(-9) |
372 038c 9093 0000 sts EE_Parameter+48,r25 |
373 0390 5093 0000 sts EE_Parameter+53,r21 |
374 0394 8DE7 ldi r24,lo8(125) |
375 0396 8093 0000 sts EE_Parameter+54,r24 |
376 039a 8093 0000 sts EE_Parameter+55,r24 |
377 039e 8093 0000 sts EE_Parameter+56,r24 |
378 03a2 4093 0000 sts EE_Parameter+49,r20 |
379 03a6 3093 0000 sts EE_Parameter+50,r19 |
380 03aa 1092 0000 sts EE_Parameter+51,__zero_reg__ |
381 03ae 9093 0000 sts EE_Parameter+52,r25 |
382 03b2 82E3 ldi r24,lo8(50) |
383 03b4 8093 0000 sts EE_Parameter+57,r24 |
384 03b8 2093 0000 sts EE_Parameter+58,r18 |
385 03bc 8093 0000 sts EE_Parameter+59,r24 |
386 03c0 1092 0000 sts EE_Parameter+97,__zero_reg__ |
387 03c4 2093 0000 sts EE_Parameter+60,r18 |
388 03c8 80E5 ldi r24,lo8(80) |
389 03ca 8093 0000 sts EE_Parameter+61,r24 |
390 03ce 8CE3 ldi r24,lo8(60) |
391 03d0 8093 0000 sts EE_Parameter+62,r24 |
392 03d4 E093 0000 sts EE_Parameter+65,r30 |
393 03d8 9BE4 ldi r25,lo8(75) |
394 03da 9093 0000 sts EE_Parameter+67,r25 |
395 03de 8FE5 ldi r24,lo8(95) |
396 03e0 8093 0000 sts EE_Parameter+72,r24 |
397 03e4 83EF ldi r24,lo8(-13) |
398 03e6 8093 0000 sts EE_Parameter+74,r24 |
399 03ea 8AEA ldi r24,lo8(-86) |
400 03ec 8093 0000 sts EE_Parameter+76,r24 |
401 03f0 8093 0000 sts EE_Parameter+77,r24 |
402 03f4 84E1 ldi r24,lo8(20) |
403 03f6 8093 0000 sts EE_Parameter+73,r24 |
404 03fa 8093 0000 sts EE_Parameter+75,r24 |
405 03fe 8EEF ldi r24,lo8(-2) |
406 0400 8093 0000 sts EE_Parameter+78,r24 |
407 0404 4093 0000 sts EE_Parameter+79,r20 |
408 0408 2093 0000 sts EE_Parameter+80,r18 |
409 040c 2093 0000 sts EE_Parameter+81,r18 |
410 0410 2093 0000 sts EE_Parameter+82,r18 |
411 0414 9093 0000 sts EE_Parameter+83,r25 |
412 0418 9093 0000 sts EE_Parameter+84,r25 |
413 041c 9093 0000 sts EE_Parameter+85,r25 |
414 0420 1092 0000 sts EE_Parameter+86,__zero_reg__ |
415 0424 5093 0000 sts EE_Parameter+87,r21 |
416 0428 6093 0000 sts EE_Parameter+88,r22 |
417 042c 2093 0000 sts EE_Parameter+89,r18 |
418 0430 7093 0000 sts EE_Parameter+90,r23 |
419 0434 4093 0000 sts EE_Parameter+91,r20 |
420 0438 4093 0000 sts EE_Parameter+92,r20 |
421 043c 82E0 ldi r24,lo8(2) |
422 043e 8093 0000 sts EE_Parameter+93,r24 |
423 0442 F093 0000 sts EE_Parameter+39,r31 |
424 0446 1092 0000 sts EE_Parameter+95,__zero_reg__ |
425 044a 1092 0000 sts EE_Parameter+96,__zero_reg__ |
426 044e A0E0 ldi r26,lo8(EE_Parameter+100) |
427 0450 B0E0 ldi r27,hi8(EE_Parameter+100) |
428 0452 8CE0 ldi r24,lo8(12) |
429 0454 E0E0 ldi r30,lo8(.LC1) |
430 0456 F0E0 ldi r31,hi8(.LC1) |
431 0458 ED01 movw r28,r26 |
432 045a 0190 ld __tmp_reg__,Z+ |
433 045c 0992 st Y+,__tmp_reg__ |
434 045e 8A95 dec r24 |
435 0460 E1F7 brne .-8 |
436 0462 60E7 ldi r22,lo8(112) |
437 0464 70E0 ldi r23,hi8(112) |
438 0466 CD01 movw r24,r26 |
439 0468 8456 subi r24,lo8(-(-100)) |
440 046a 9040 sbci r25,hi8(-(-100)) |
441 046c 0E94 0000 call RAM_Checksum |
442 0470 8093 0000 sts EE_Parameter+112,r24 |
443 /* epilogue: frame size=0 */ |
444 0474 DF91 pop r29 |
445 0476 CF91 pop r28 |
446 0478 0895 ret |
447 /* epilogue end (size=3) */ |
448 /* function ParamSet_DefaultSet2 size 249 (244) */ |
450 .data |
451 .LC2: |
452 000f 4265 6769 .string "Beginner" |
452 6E6E 6572 |
452 00 |
453 0018 00 .string "" |
454 .text |
455 .global ParamSet_DefaultSet3 |
457 ParamSet_DefaultSet3: |
458 /* prologue: frame size=0 */ |
459 047a CF93 push r28 |
460 047c DF93 push r29 |
461 /* prologue end (size=2) */ |
462 047e 84E5 ldi r24,lo8(84) |
463 0480 8093 0000 sts EE_Parameter,r24 |
464 0484 8091 0000 lds r24,PlatinenVersion |
465 0488 8431 cpi r24,lo8(20) |
466 048a 50F0 brlo .L27 |
467 048c 8AE0 ldi r24,lo8(10) |
468 048e 8093 0000 sts EE_Parameter+32,r24 |
469 0492 1092 0000 sts EE_Parameter+66,__zero_reg__ |
470 0496 8BE1 ldi r24,lo8(27) |
471 0498 8093 0000 sts EE_Parameter+28,r24 |
472 049c 8EE4 ldi r24,lo8(78) |
473 049e 0AC0 rjmp .L29 |
474 .L27: |
475 04a0 83E0 ldi r24,lo8(3) |
476 04a2 8093 0000 sts EE_Parameter+32,r24 |
477 04a6 80E2 ldi r24,lo8(32) |
478 04a8 8093 0000 sts EE_Parameter+66,r24 |
479 04ac 8EE1 ldi r24,lo8(30) |
480 04ae 8093 0000 sts EE_Parameter+28,r24 |
481 04b2 85E5 ldi r24,lo8(85) |
482 .L29: |
483 04b4 8093 0000 sts EE_Parameter+63,r24 |
484 04b8 8093 0000 sts EE_Parameter+64,r24 |
485 04bc 8AE6 ldi r24,lo8(106) |
486 04be 8093 0000 sts EE_Parameter+13,r24 |
487 04c2 83E0 ldi r24,lo8(3) |
488 04c4 8093 0000 sts EE_Parameter+99,r24 |
489 04c8 6EE1 ldi r22,lo8(30) |
490 04ca 6093 0000 sts EE_Parameter+14,r22 |
491 04ce 8FEF ldi r24,lo8(-1) |
492 04d0 8093 0000 sts EE_Parameter+16,r24 |
493 04d4 9FE0 ldi r25,lo8(15) |
494 04d6 9093 0000 sts EE_Parameter+17,r25 |
495 04da 6093 0000 sts EE_Parameter+15,r22 |
496 04de 1092 0000 sts EE_Parameter+19,__zero_reg__ |
497 04e2 78E0 ldi r23,lo8(8) |
498 04e4 7093 0000 sts EE_Parameter+20,r23 |
499 04e8 80E4 ldi r24,lo8(64) |
500 04ea 8093 0000 sts EE_Parameter+21,r24 |
501 04ee 1092 0000 sts EE_Parameter+22,__zero_reg__ |
502 04f2 9093 0000 sts EE_Parameter+18,r25 |
503 04f6 7093 0000 sts EE_Parameter+23,r23 |
504 04fa 90E1 ldi r25,lo8(16) |
505 04fc 9093 0000 sts EE_Parameter+24,r25 |
506 0500 56E0 ldi r21,lo8(6) |
507 0502 5093 0000 sts EE_Parameter+25,r21 |
508 0506 7093 0000 sts EE_Parameter+26,r23 |
509 050a 86EE ldi r24,lo8(-26) |
510 050c 8093 0000 sts EE_Parameter+27,r24 |
511 0510 80E8 ldi r24,lo8(-128) |
512 0512 8093 0000 sts EE_Parameter+29,r24 |
513 0516 34E6 ldi r19,lo8(100) |
514 0518 3093 0000 sts EE_Parameter+30,r19 |
515 051c 88E7 ldi r24,lo8(120) |
516 051e 8093 0000 sts EE_Parameter+31,r24 |
517 0522 3093 0000 sts EE_Parameter+33,r19 |
518 0526 8093 0000 sts EE_Parameter+34,r24 |
519 052a 5093 0000 sts EE_Parameter+35,r21 |
520 052e 81E2 ldi r24,lo8(33) |
521 0530 8093 0000 sts EE_Parameter+36,r24 |
522 0534 8DE2 ldi r24,lo8(45) |
523 0536 8093 0000 sts EE_Parameter+37,r24 |
524 053a 2AE5 ldi r18,lo8(90) |
525 053c 2093 0000 sts EE_Parameter+38,r18 |
526 0540 9093 0000 sts EE_Parameter+40,r25 |
527 0544 1092 0000 sts EE_Parameter+41,__zero_reg__ |
528 0548 1092 0000 sts EE_Parameter+42,__zero_reg__ |
529 054c 1092 0000 sts EE_Parameter+43,__zero_reg__ |
530 0550 1092 0000 sts EE_Parameter+44,__zero_reg__ |
531 0554 1092 0000 sts EE_Parameter+68,__zero_reg__ |
532 0558 1092 0000 sts EE_Parameter+69,__zero_reg__ |
533 055c 1092 0000 sts EE_Parameter+70,__zero_reg__ |
534 0560 1092 0000 sts EE_Parameter+71,__zero_reg__ |
535 0564 3093 0000 sts EE_Parameter+45,r19 |
536 0568 48E2 ldi r20,lo8(40) |
537 056a 4093 0000 sts EE_Parameter+46,r20 |
538 056e E1E0 ldi r30,lo8(1) |
539 0570 E093 0000 sts EE_Parameter+98,r30 |
540 0574 1092 0000 sts EE_Parameter+47,__zero_reg__ |
541 0578 97EF ldi r25,lo8(-9) |
542 057a 9093 0000 sts EE_Parameter+48,r25 |
543 057e 5093 0000 sts EE_Parameter+53,r21 |
544 0582 8DE7 ldi r24,lo8(125) |
545 0584 8093 0000 sts EE_Parameter+54,r24 |
546 0588 8093 0000 sts EE_Parameter+55,r24 |
547 058c 8093 0000 sts EE_Parameter+56,r24 |
548 0590 3093 0000 sts EE_Parameter+49,r19 |
549 0594 4093 0000 sts EE_Parameter+50,r20 |
550 0598 1092 0000 sts EE_Parameter+51,__zero_reg__ |
551 059c 9093 0000 sts EE_Parameter+52,r25 |
552 05a0 82E3 ldi r24,lo8(50) |
553 05a2 8093 0000 sts EE_Parameter+57,r24 |
554 05a6 2093 0000 sts EE_Parameter+58,r18 |
555 05aa 8093 0000 sts EE_Parameter+59,r24 |
556 05ae 1092 0000 sts EE_Parameter+97,__zero_reg__ |
557 05b2 2093 0000 sts EE_Parameter+60,r18 |
558 05b6 80E5 ldi r24,lo8(80) |
559 05b8 8093 0000 sts EE_Parameter+61,r24 |
560 05bc 96E4 ldi r25,lo8(70) |
561 05be 9093 0000 sts EE_Parameter+62,r25 |
562 05c2 80E2 ldi r24,lo8(32) |
563 05c4 8093 0000 sts EE_Parameter+65,r24 |
564 05c8 9093 0000 sts EE_Parameter+67,r25 |
565 05cc 8FE5 ldi r24,lo8(95) |
566 05ce 8093 0000 sts EE_Parameter+72,r24 |
567 05d2 83EF ldi r24,lo8(-13) |
568 05d4 8093 0000 sts EE_Parameter+74,r24 |
569 05d8 8AEA ldi r24,lo8(-86) |
570 05da 8093 0000 sts EE_Parameter+76,r24 |
571 05de 8093 0000 sts EE_Parameter+77,r24 |
572 05e2 6093 0000 sts EE_Parameter+73,r22 |
573 05e6 6093 0000 sts EE_Parameter+75,r22 |
574 05ea 8EEF ldi r24,lo8(-2) |
575 05ec 8093 0000 sts EE_Parameter+78,r24 |
576 05f0 3093 0000 sts EE_Parameter+79,r19 |
577 05f4 2093 0000 sts EE_Parameter+80,r18 |
578 05f8 2093 0000 sts EE_Parameter+81,r18 |
579 05fc 2093 0000 sts EE_Parameter+82,r18 |
580 0600 8BE4 ldi r24,lo8(75) |
581 0602 8093 0000 sts EE_Parameter+83,r24 |
582 0606 8093 0000 sts EE_Parameter+84,r24 |
583 060a 8093 0000 sts EE_Parameter+85,r24 |
584 060e 1092 0000 sts EE_Parameter+86,__zero_reg__ |
585 0612 5093 0000 sts EE_Parameter+87,r21 |
586 0616 7093 0000 sts EE_Parameter+88,r23 |
587 061a 2093 0000 sts EE_Parameter+89,r18 |
588 061e 6093 0000 sts EE_Parameter+90,r22 |
589 0622 3093 0000 sts EE_Parameter+91,r19 |
590 0626 3093 0000 sts EE_Parameter+92,r19 |
591 062a 82E0 ldi r24,lo8(2) |
592 062c 8093 0000 sts EE_Parameter+93,r24 |
593 0630 E093 0000 sts EE_Parameter+39,r30 |
594 0634 1092 0000 sts EE_Parameter+95,__zero_reg__ |
595 0638 1092 0000 sts EE_Parameter+96,__zero_reg__ |
596 063c A0E0 ldi r26,lo8(EE_Parameter+100) |
597 063e B0E0 ldi r27,hi8(EE_Parameter+100) |
598 0640 8CE0 ldi r24,lo8(12) |
599 0642 E0E0 ldi r30,lo8(.LC2) |
600 0644 F0E0 ldi r31,hi8(.LC2) |
601 0646 ED01 movw r28,r26 |
602 0648 0190 ld __tmp_reg__,Z+ |
603 064a 0992 st Y+,__tmp_reg__ |
604 064c 8A95 dec r24 |
605 064e E1F7 brne .-8 |
606 0650 60E7 ldi r22,lo8(112) |
607 0652 70E0 ldi r23,hi8(112) |
608 0654 CD01 movw r24,r26 |
609 0656 8456 subi r24,lo8(-(-100)) |
610 0658 9040 sbci r25,hi8(-(-100)) |
611 065a 0E94 0000 call RAM_Checksum |
612 065e 8093 0000 sts EE_Parameter+112,r24 |
613 /* epilogue: frame size=0 */ |
614 0662 DF91 pop r29 |
615 0664 CF91 pop r28 |
616 0666 0895 ret |
617 /* epilogue end (size=3) */ |
618 /* function ParamSet_DefaultSet3 size 247 (242) */ |
620 .global GetParamByte |
622 GetParamByte: |
623 /* prologue: frame size=0 */ |
624 /* prologue end (size=0) */ |
625 0668 DC01 movw r26,r24 |
626 /* #APP */ |
627 066a 0E94 0000 call __eeprom_read_byte_1F2021 |
628 066e 802D mov r24,__tmp_reg__ |
629 /* #NOAPP */ |
630 0670 9927 clr r25 |
631 /* epilogue: frame size=0 */ |
632 0672 0895 ret |
633 /* epilogue end (size=1) */ |
634 /* function GetParamByte size 7 (6) */ |
636 .global SetParamByte |
638 SetParamByte: |
639 /* prologue: frame size=0 */ |
640 /* prologue end (size=0) */ |
641 0674 DC01 movw r26,r24 |
642 /* #APP */ |
643 0676 062E mov __tmp_reg__,r22 |
644 0678 0E94 0000 call __eeprom_write_byte_1F2021 |
645 /* #NOAPP */ |
646 /* epilogue: frame size=0 */ |
647 067c 0895 ret |
648 /* epilogue end (size=1) */ |
649 /* function SetParamByte size 6 (5) */ |
651 .global GetParamWord |
653 GetParamWord: |
654 /* prologue: frame size=0 */ |
655 /* prologue end (size=0) */ |
656 067e DC01 movw r26,r24 |
657 /* #APP */ |
658 0680 0E94 0000 call __eeprom_read_word_1F2021 |
659 |
660 /* #NOAPP */ |
661 0684 CF01 movw r24,r30 |
662 /* epilogue: frame size=0 */ |
663 0686 0895 ret |
664 /* epilogue end (size=1) */ |
665 /* function GetParamWord size 7 (6) */ |
667 .global SetParamWord |
669 SetParamWord: |
670 /* prologue: frame size=0 */ |
671 /* prologue end (size=0) */ |
672 0688 DC01 movw r26,r24 |
673 /* #APP */ |
674 068a 0B01 movw __tmp_reg__,r22 |
675 068c 0E94 0000 call __eeprom_write_word_1F2021 |
676 |
677 /* #NOAPP */ |
678 /* epilogue: frame size=0 */ |
679 0690 0895 ret |
680 /* epilogue end (size=1) */ |
681 /* function SetParamWord size 8 (7) */ |
683 .global ParamSet_ReadFromEEProm |
685 ParamSet_ReadFromEEProm: |
686 /* prologue: frame size=0 */ |
687 0692 FF92 push r15 |
688 0694 0F93 push r16 |
689 0696 1F93 push r17 |
690 0698 CF93 push r28 |
691 069a DF93 push r29 |
692 /* prologue end (size=5) */ |
693 069c 982F mov r25,r24 |
694 069e 8150 subi r24,lo8(-(-1)) |
695 06a0 8530 cpi r24,lo8(5) |
696 06a2 08F0 brlo .L39 |
697 06a4 93E0 ldi r25,lo8(3) |
698 .L39: |
699 06a6 81E7 ldi r24,lo8(113) |
700 06a8 F82E mov r15,r24 |
701 06aa 9F9D mul r25,r15 |
702 06ac 8001 movw r16,r0 |
703 06ae 1124 clr r1 |
704 06b0 E801 movw r28,r16 |
705 06b2 2D97 sbiw r28,13 |
706 06b4 60E7 ldi r22,lo8(112) |
707 06b6 70E0 ldi r23,hi8(112) |
708 06b8 CE01 movw r24,r28 |
709 06ba 0E94 0000 call EEProm_Checksum |
710 06be 982F mov r25,r24 |
711 06c0 D801 movw r26,r16 |
712 06c2 AD59 subi r26,lo8(-(99)) |
713 06c4 BF4F sbci r27,hi8(-(99)) |
714 /* #APP */ |
715 06c6 0E94 0000 call __eeprom_read_byte_1F2021 |
716 06ca 802D mov r24,__tmp_reg__ |
717 /* #NOAPP */ |
718 06cc 8917 cp r24,r25 |
719 06ce 31F4 brne .L51 |
720 06d0 DE01 movw r26,r28 |
721 /* #APP */ |
722 06d2 0E94 0000 call __eeprom_read_byte_1F2021 |
723 06d6 802D mov r24,__tmp_reg__ |
724 /* #NOAPP */ |
725 06d8 8435 cpi r24,lo8(84) |
726 06da 19F0 breq .L42 |
727 .L51: |
728 06dc 80E0 ldi r24,lo8(0) |
729 06de 90E0 ldi r25,hi8(0) |
730 06e0 0AC0 rjmp .L38 |
731 .L42: |
732 06e2 E0E0 ldi r30,lo8(EE_Parameter) |
733 06e4 F0E0 ldi r31,hi8(EE_Parameter) |
734 06e6 DE01 movw r26,r28 |
735 /* #APP */ |
736 06e8 1F2C mov __zero_reg__,r15 |
737 06ea 0E94 0000 call __eeprom_read_block_1F2021 |
738 /* #NOAPP */ |
739 06ee 0E94 0000 call LED_Init |
740 06f2 81E0 ldi r24,lo8(1) |
741 06f4 90E0 ldi r25,hi8(1) |
742 .L38: |
743 /* epilogue: frame size=0 */ |
744 06f6 E5E0 ldi r30,5 |
745 06f8 CDB7 in r28,__SP_L__ |
746 06fa DEB7 in r29,__SP_H__ |
747 06fc 0C94 0000 jmp __epilogue_restores__+26 |
748 /* epilogue end (size=5) */ |
749 /* function ParamSet_ReadFromEEProm size 58 (48) */ |
751 .global SetActiveParamSet |
753 SetActiveParamSet: |
754 /* prologue: frame size=0 */ |
755 /* prologue end (size=0) */ |
756 0700 8630 cpi r24,lo8(6) |
757 0702 10F0 brlo .L53 |
758 0704 85E0 ldi r24,lo8(5) |
759 0706 03C0 rjmp .L54 |
760 .L53: |
761 0708 8823 tst r24 |
762 070a 09F4 brne .L54 |
763 070c 81E0 ldi r24,lo8(1) |
764 .L54: |
765 070e A2E0 ldi r26,lo8(2) |
766 0710 B0E0 ldi r27,hi8(2) |
767 /* #APP */ |
768 0712 082E mov __tmp_reg__,r24 |
769 0714 0E94 0000 call __eeprom_write_byte_1F2021 |
770 /* #NOAPP */ |
771 /* epilogue: frame size=0 */ |
772 0718 0895 ret |
773 /* epilogue end (size=1) */ |
774 /* function SetActiveParamSet size 14 (13) */ |
776 .global ParamSet_WriteToEEProm |
778 ParamSet_WriteToEEProm: |
779 /* prologue: frame size=0 */ |
780 071a 1F93 push r17 |
781 071c CF93 push r28 |
782 071e DF93 push r29 |
783 /* prologue end (size=3) */ |
784 0720 182F mov r17,r24 |
785 0722 C0E0 ldi r28,lo8(EE_Parameter) |
786 0724 D0E0 ldi r29,hi8(EE_Parameter) |
787 0726 8091 0000 lds r24,EE_Parameter |
788 072a 8435 cpi r24,lo8(84) |
789 072c 91F5 brne .L57 |
790 072e 1630 cpi r17,lo8(6) |
791 0730 10F0 brlo .L58 |
792 0732 15E0 ldi r17,lo8(5) |
793 0734 02C0 rjmp .L59 |
794 .L58: |
795 0736 1123 tst r17 |
796 0738 61F1 breq .L57 |
797 .L59: |
798 073a 60E7 ldi r22,lo8(112) |
799 073c 70E0 ldi r23,hi8(112) |
800 073e 80E0 ldi r24,lo8(EE_Parameter) |
801 0740 90E0 ldi r25,hi8(EE_Parameter) |
802 0742 0E94 0000 call RAM_Checksum |
803 0746 8093 0000 sts EE_Parameter+112,r24 |
804 074a 81E7 ldi r24,lo8(113) |
805 074c 189F mul r17,r24 |
806 074e D001 movw r26,r0 |
807 0750 1124 clr r1 |
808 0752 1D97 sbiw r26,13 |
809 0754 FE01 movw r30,r28 |
810 /* #APP */ |
811 0756 182E mov __zero_reg__,r24 |
812 0758 0E94 0000 call __eeprom_write_block_1F2021 |
813 /* #NOAPP */ |
814 075c E0E0 ldi r30,lo8(EE_Parameter+1) |
815 075e F0E0 ldi r31,hi8(EE_Parameter+1) |
816 0760 A0E5 ldi r26,lo8(80) |
817 0762 B0E0 ldi r27,hi8(80) |
818 0764 2CE0 ldi r18,lo8(12) |
819 0766 30E0 ldi r19,hi8(12) |
820 /* #APP */ |
821 0768 122E mov __zero_reg__,r18 |
822 076a 0E94 0000 call __eeprom_write_block_1F2021 |
823 /* #NOAPP */ |
824 076e B901 movw r22,r18 |
825 0770 80E0 ldi r24,lo8(EE_Parameter+1) |
826 0772 90E0 ldi r25,hi8(EE_Parameter+1) |
827 0774 0E94 0000 call RAM_Checksum |
828 0778 ACE5 ldi r26,lo8(92) |
829 077a B0E0 ldi r27,hi8(92) |
830 /* #APP */ |
831 077c 082E mov __tmp_reg__,r24 |
832 077e 0E94 0000 call __eeprom_write_byte_1F2021 |
833 /* #NOAPP */ |
834 0782 812F mov r24,r17 |
835 0784 0E94 0000 call SetActiveParamSet |
836 0788 0E94 0000 call LED_Init |
837 078c 81E0 ldi r24,lo8(1) |
838 078e 90E0 ldi r25,hi8(1) |
839 0790 02C0 rjmp .L56 |
840 .L57: |
841 0792 80E0 ldi r24,lo8(0) |
842 0794 90E0 ldi r25,hi8(0) |
843 .L56: |
844 /* epilogue: frame size=0 */ |
845 0796 DF91 pop r29 |
846 0798 CF91 pop r28 |
847 079a 1F91 pop r17 |
848 079c 0895 ret |
849 /* epilogue end (size=4) */ |
850 /* function ParamSet_WriteToEEProm size 69 (62) */ |
852 .global MixerTable_ReadFromEEProm |
854 MixerTable_ReadFromEEProm: |
855 /* prologue: frame size=0 */ |
856 /* prologue end (size=0) */ |
857 079e 6DE4 ldi r22,lo8(77) |
858 07a0 70E0 ldi r23,hi8(77) |
859 07a2 88EE ldi r24,lo8(1000) |
860 07a4 93E0 ldi r25,hi8(1000) |
861 07a6 0E94 0000 call EEProm_Checksum |
862 07aa A5E3 ldi r26,lo8(1077) |
863 07ac B4E0 ldi r27,hi8(1077) |
864 /* #APP */ |
865 07ae 0E94 0000 call __eeprom_read_byte_1F2021 |
866 07b2 902D mov r25,__tmp_reg__ |
867 /* #NOAPP */ |
868 07b4 9817 cp r25,r24 |
869 07b6 39F4 brne .L87 |
870 07b8 A8EE ldi r26,lo8(1000) |
871 07ba B3E0 ldi r27,hi8(1000) |
872 /* #APP */ |
873 07bc 0E94 0000 call __eeprom_read_byte_1F2021 |
874 07c0 802D mov r24,__tmp_reg__ |
875 /* #NOAPP */ |
876 07c2 8130 cpi r24,lo8(1) |
877 07c4 19F0 breq .L78 |
878 .L87: |
879 07c6 80E0 ldi r24,lo8(0) |
880 07c8 90E0 ldi r25,hi8(0) |
881 07ca 0895 ret |
882 .L78: |
883 07cc E0E0 ldi r30,lo8(Mixer) |
884 07ce F0E0 ldi r31,hi8(Mixer) |
885 07d0 A8EE ldi r26,lo8(1000) |
886 07d2 B3E0 ldi r27,hi8(1000) |
887 07d4 8EE4 ldi r24,lo8(78) |
888 /* #APP */ |
889 07d6 182E mov __zero_reg__,r24 |
890 07d8 0E94 0000 call __eeprom_read_block_1F2021 |
891 /* #NOAPP */ |
892 07dc 81E0 ldi r24,lo8(1) |
893 07de 90E0 ldi r25,hi8(1) |
894 07e0 0895 ret |
895 /* epilogue: frame size=0 */ |
896 /* epilogue: noreturn */ |
897 /* epilogue end (size=0) */ |
898 /* function MixerTable_ReadFromEEProm size 37 (37) */ |
900 .global MixerTable_WriteToEEProm |
902 MixerTable_WriteToEEProm: |
903 /* prologue: frame size=0 */ |
904 07e2 CF93 push r28 |
905 07e4 DF93 push r29 |
906 /* prologue end (size=2) */ |
907 07e6 C0E0 ldi r28,lo8(Mixer) |
908 07e8 D0E0 ldi r29,hi8(Mixer) |
909 07ea 8091 0000 lds r24,Mixer |
910 07ee 8130 cpi r24,lo8(1) |
911 07f0 89F4 brne .L89 |
912 07f2 6DE4 ldi r22,lo8(77) |
913 07f4 70E0 ldi r23,hi8(77) |
914 07f6 CE01 movw r24,r28 |
915 07f8 0E94 0000 call RAM_Checksum |
916 07fc 8093 0000 sts Mixer+77,r24 |
917 0800 A8EE ldi r26,lo8(1000) |
918 0802 B3E0 ldi r27,hi8(1000) |
919 0804 8EE4 ldi r24,lo8(78) |
920 0806 FE01 movw r30,r28 |
921 /* #APP */ |
922 0808 182E mov __zero_reg__,r24 |
923 080a 0E94 0000 call __eeprom_write_block_1F2021 |
924 /* #NOAPP */ |
925 080e 81E0 ldi r24,lo8(1) |
926 0810 90E0 ldi r25,hi8(1) |
927 0812 02C0 rjmp .L88 |
928 .L89: |
929 0814 80E0 ldi r24,lo8(0) |
930 0816 90E0 ldi r25,hi8(0) |
931 .L88: |
932 /* epilogue: frame size=0 */ |
933 0818 DF91 pop r29 |
934 081a CF91 pop r28 |
935 081c 0895 ret |
936 /* epilogue end (size=3) */ |
937 /* function MixerTable_WriteToEEProm size 31 (26) */ |
939 .data |
940 .LC3: |
941 0019 5175 6164 .string "Quadro" |
941 726F 00 |
942 0020 00 .string "" |
943 .text |
944 .global MixerTable_Default |
946 MixerTable_Default: |
947 /* prologue: frame size=0 */ |
948 081e CF93 push r28 |
949 0820 DF93 push r29 |
950 /* prologue end (size=2) */ |
951 0822 81E0 ldi r24,lo8(1) |
952 0824 8093 0000 sts Mixer,r24 |
953 0828 E0E0 ldi r30,lo8(Mixer) |
954 082a F0E0 ldi r31,hi8(Mixer) |
955 082c 8FE0 ldi r24,lo8(15) |
956 .L102: |
957 082e 1586 std Z+13,__zero_reg__ |
958 0830 1686 std Z+14,__zero_reg__ |
959 0832 1786 std Z+15,__zero_reg__ |
960 0834 108A std Z+16,__zero_reg__ |
961 0836 8150 subi r24,lo8(-(-1)) |
962 0838 3496 adiw r30,4 |
963 083a 87FF sbrs r24,7 |
964 083c F8CF rjmp .L102 |
965 083e 80E4 ldi r24,lo8(64) |
966 0840 8093 0000 sts Mixer+13,r24 |
967 0844 8093 0000 sts Mixer+14,r24 |
968 0848 1092 0000 sts Mixer+15,__zero_reg__ |
969 084c 8093 0000 sts Mixer+16,r24 |
970 0850 8093 0000 sts Mixer+17,r24 |
971 0854 90EC ldi r25,lo8(-64) |
972 0856 9093 0000 sts Mixer+18,r25 |
973 085a 1092 0000 sts Mixer+19,__zero_reg__ |
974 085e 8093 0000 sts Mixer+20,r24 |
975 0862 8093 0000 sts Mixer+21,r24 |
976 0866 1092 0000 sts Mixer+22,__zero_reg__ |
977 086a 9093 0000 sts Mixer+23,r25 |
978 086e 9093 0000 sts Mixer+24,r25 |
979 0872 8093 0000 sts Mixer+25,r24 |
980 0876 1092 0000 sts Mixer+26,__zero_reg__ |
981 087a 8093 0000 sts Mixer+27,r24 |
982 087e 9093 0000 sts Mixer+28,r25 |
983 0882 A0E0 ldi r26,lo8(Mixer+1) |
984 0884 B0E0 ldi r27,hi8(Mixer+1) |
985 0886 87E0 ldi r24,lo8(7) |
986 0888 E0E0 ldi r30,lo8(.LC3) |
987 088a F0E0 ldi r31,hi8(.LC3) |
988 088c ED01 movw r28,r26 |
989 088e 0190 ld __tmp_reg__,Z+ |
990 0890 0992 st Y+,__tmp_reg__ |
991 0892 8A95 dec r24 |
992 0894 E1F7 brne .-8 |
993 0896 6DE4 ldi r22,lo8(77) |
994 0898 70E0 ldi r23,hi8(77) |
995 089a CD01 movw r24,r26 |
996 089c 0197 sbiw r24,1 |
997 089e 0E94 0000 call RAM_Checksum |
998 08a2 8093 0000 sts Mixer+77,r24 |
999 /* epilogue: frame size=0 */ |
1000 08a6 DF91 pop r29 |
1001 08a8 CF91 pop r28 |
1002 08aa 0895 ret |
1003 /* epilogue end (size=3) */ |
1004 /* function MixerTable_Default size 71 (66) */ |
1006 .global GetActiveParamSet |
1008 GetActiveParamSet: |
1009 /* prologue: frame size=0 */ |
1010 /* prologue end (size=0) */ |
1011 08ac A2E0 ldi r26,lo8(2) |
1012 08ae B0E0 ldi r27,hi8(2) |
1013 /* #APP */ |
1014 08b0 0E94 0000 call __eeprom_read_byte_1F2021 |
1015 08b4 802D mov r24,__tmp_reg__ |
1016 /* #NOAPP */ |
1017 08b6 8630 cpi r24,lo8(6) |
1018 08b8 30F0 brlo .L107 |
1019 08ba 83E0 ldi r24,lo8(3) |
1020 08bc A2E0 ldi r26,lo8(2) |
1021 08be B0E0 ldi r27,hi8(2) |
1022 /* #APP */ |
1023 08c0 082E mov __tmp_reg__,r24 |
1024 08c2 0E94 0000 call __eeprom_write_byte_1F2021 |
1025 /* #NOAPP */ |
1026 .L107: |
1027 08c6 9927 clr r25 |
1028 /* epilogue: frame size=0 */ |
1029 08c8 0895 ret |
1030 /* epilogue end (size=1) */ |
1031 /* function GetActiveParamSet size 17 (16) */ |
1033 .section .progmem.data,"a",@progbits |
1036 __c.0: |
1037 0000 0A0D 4765 .string "\n\rGenerating default Parameter Set %d" |
1037 6E65 7261 |
1037 7469 6E67 |
1037 2064 6566 |
1037 6175 6C74 |
1040 __c.1: |
1041 0026 0A0D 5573 .string "\n\rUsing Parameter Set %d" |
1041 696E 6720 |
1041 5061 7261 |
1041 6D65 7465 |
1041 7220 5365 |
1044 __c.2: |
1045 003f 0A0D 4765 .string "\n\rGenerating default Mixer Table" |
1045 6E65 7261 |
1045 7469 6E67 |
1045 2064 6566 |
1045 6175 6C74 |
1048 __c.3: |
1049 0060 0A0D 4D69 .string "\n\rMixer-Config: '%s' (%u Motors)" |
1049 7865 722D |
1049 436F 6E66 |
1049 6967 3A20 |
1049 2725 7327 |
1052 __c.4: |
1053 0081 0A0D 3D3D .string "\n\r==============================" |
1053 3D3D 3D3D |
1053 3D3D 3D3D |
1053 3D3D 3D3D |
1053 3D3D 3D3D |
1054 .text |
1055 .global ParamSet_Init |
1057 ParamSet_Init: |
1058 /* prologue: frame size=0 */ |
1059 08ca DF92 push r13 |
1060 08cc EF92 push r14 |
1061 08ce FF92 push r15 |
1062 08d0 0F93 push r16 |
1063 08d2 1F93 push r17 |
1064 08d4 CF93 push r28 |
1065 /* prologue end (size=6) */ |
1066 08d6 FF24 clr r15 |
1067 08d8 DF2C mov r13,r15 |
1068 08da EF2C mov r14,r15 |
1069 08dc 81E0 ldi r24,lo8(1) |
1070 08de 90E0 ldi r25,hi8(1) |
1071 08e0 0E94 0000 call GetParamByte |
1072 08e4 8435 cpi r24,lo8(84) |
1073 08e6 39F0 breq .L110 |
1074 08e8 31E0 ldi r19,lo8(1) |
1075 08ea E32E mov r14,r19 |
1076 08ec 64E5 ldi r22,lo8(84) |
1077 08ee 81E0 ldi r24,lo8(1) |
1078 08f0 90E0 ldi r25,hi8(1) |
1079 08f2 0E94 0000 call SetParamByte |
1080 .L110: |
1081 08f6 6CE0 ldi r22,lo8(12) |
1082 08f8 70E0 ldi r23,hi8(12) |
1083 08fa 80E5 ldi r24,lo8(80) |
1084 08fc 90E0 ldi r25,hi8(80) |
1085 08fe 0E94 0000 call EEProm_Checksum |
1086 0902 C82F mov r28,r24 |
1087 0904 ACE5 ldi r26,lo8(92) |
1088 0906 B0E0 ldi r27,hi8(92) |
1089 /* #APP */ |
1090 0908 0E94 0000 call __eeprom_read_byte_1F2021 |
1091 090c 802D mov r24,__tmp_reg__ |
1092 /* #NOAPP */ |
1093 090e 8C17 cp r24,r28 |
1094 0910 11F4 brne .L111 |
1095 0912 21E0 ldi r18,lo8(1) |
1096 0914 D22E mov r13,r18 |
1097 .L111: |
1098 0916 C1E0 ldi r28,lo8(1) |
1099 0918 01E0 ldi r16,lo8(1) |
1100 091a 10E0 ldi r17,hi8(1) |
1101 .L133: |
1102 091c EE20 tst r14 |
1103 091e 29F4 brne .L117 |
1104 0920 8C2F mov r24,r28 |
1105 0922 0E94 0000 call ParamSet_ReadFromEEProm |
1106 0926 8823 tst r24 |
1107 0928 B1F5 brne .L115 |
1108 .L117: |
1109 092a 91E0 ldi r25,lo8(1) |
1110 092c F92E mov r15,r25 |
1111 092e 1F93 push r17 |
1112 0930 0F93 push r16 |
1113 0932 80E0 ldi r24,lo8(__c.0) |
1114 0934 90E0 ldi r25,hi8(__c.0) |
1115 0936 9F93 push r25 |
1116 0938 8F93 push r24 |
1117 093a 80E0 ldi r24,lo8(pm(uart_putchar)) |
1118 093c 90E0 ldi r25,hi8(pm(uart_putchar)) |
1119 093e 9F93 push r25 |
1120 0940 8F93 push r24 |
1121 0942 E091 0000 lds r30,_printf_P |
1122 0946 F091 0000 lds r31,(_printf_P)+1 |
1123 094a 0995 icall |
1124 094c 8DB7 in r24,__SP_L__ |
1125 094e 9EB7 in r25,__SP_H__ |
1126 0950 0696 adiw r24,6 |
1127 0952 8DBF out __SP_L__,r24 |
1128 0954 0230 cpi r16,2 |
1129 0956 1105 cpc r17,__zero_reg__ |
1130 0958 49F0 breq .L120 |
1131 095a 0330 cpi r16,3 |
1132 095c 1105 cpc r17,__zero_reg__ |
1133 095e 4CF4 brge .L122 |
1134 0960 0130 cpi r16,1 |
1135 0962 1105 cpc r17,__zero_reg__ |
1136 0964 31F4 brne .L122 |
1137 0966 0E94 0000 call ParamSet_DefaultSet1 |
1138 096a 05C0 rjmp .L118 |
1139 .L120: |
1140 096c 0E94 0000 call ParamSet_DefaultSet2 |
1141 0970 02C0 rjmp .L118 |
1142 .L122: |
1143 0972 0E94 0000 call ParamSet_DefaultSet3 |
1144 .L118: |
1145 0976 DD20 tst r13 |
1146 0978 49F0 breq .L124 |
1147 097a E0E0 ldi r30,lo8(EE_Parameter+1) |
1148 097c F0E0 ldi r31,hi8(EE_Parameter+1) |
1149 097e A0E5 ldi r26,lo8(80) |
1150 0980 B0E0 ldi r27,hi8(80) |
1151 0982 8CE0 ldi r24,lo8(12) |
1152 /* #APP */ |
1153 0984 182E mov __zero_reg__,r24 |
1154 0986 0E94 0000 call __eeprom_read_block_1F2021 |
1155 /* #NOAPP */ |
1156 098a 02C0 rjmp .L132 |
1157 .L124: |
1158 098c 0E94 0000 call ParamSet_DefaultStickMapping |
1159 .L132: |
1160 0990 8C2F mov r24,r28 |
1161 0992 0E94 0000 call ParamSet_WriteToEEProm |
1162 .L115: |
1163 0996 CF5F subi r28,lo8(-(1)) |
1164 0998 0F5F subi r16,lo8(-(1)) |
1165 099a 1F4F sbci r17,hi8(-(1)) |
1166 099c C630 cpi r28,lo8(6) |
1167 099e 08F4 brsh .+2 |
1168 09a0 BDCF rjmp .L133 |
1169 09a2 FF20 tst r15 |
1170 09a4 19F0 breq .L134 |
1171 09a6 83E0 ldi r24,lo8(3) |
1172 09a8 0E94 0000 call SetActiveParamSet |
1173 .L134: |
1174 09ac 0E94 0000 call GetActiveParamSet |
1175 09b0 C82F mov r28,r24 |
1176 09b2 0E94 0000 call ParamSet_ReadFromEEProm |
1177 09b6 8C2F mov r24,r28 |
1178 09b8 9927 clr r25 |
1179 09ba 9F93 push r25 |
1180 09bc 8F93 push r24 |
1181 09be 80E0 ldi r24,lo8(__c.1) |
1182 09c0 90E0 ldi r25,hi8(__c.1) |
1183 09c2 9F93 push r25 |
1184 09c4 8F93 push r24 |
1185 09c6 00E0 ldi r16,lo8(pm(uart_putchar)) |
1186 09c8 10E0 ldi r17,hi8(pm(uart_putchar)) |
1187 09ca 1F93 push r17 |
1188 09cc 0F93 push r16 |
1189 09ce E091 0000 lds r30,_printf_P |
1190 09d2 F091 0000 lds r31,(_printf_P)+1 |
1191 09d6 0995 icall |
1192 09d8 8DB7 in r24,__SP_L__ |
1193 09da 9EB7 in r25,__SP_H__ |
1194 09dc 0696 adiw r24,6 |
1195 09de 8DBF out __SP_L__,r24 |
1196 09e0 EE20 tst r14 |
1197 09e2 21F4 brne .L136 |
1198 09e4 0E94 0000 call MixerTable_ReadFromEEProm |
1199 09e8 8823 tst r24 |
1200 09ea 99F4 brne .L135 |
1201 .L136: |
1202 09ec 80E0 ldi r24,lo8(__c.2) |
1203 09ee 90E0 ldi r25,hi8(__c.2) |
1204 09f0 9F93 push r25 |
1205 09f2 8F93 push r24 |
1206 09f4 1F93 push r17 |
1207 09f6 0F93 push r16 |
1208 09f8 E091 0000 lds r30,_printf_P |
1209 09fc F091 0000 lds r31,(_printf_P)+1 |
1210 0a00 0995 icall |
1211 0a02 0E94 0000 call MixerTable_Default |
1212 0a06 0E94 0000 call MixerTable_WriteToEEProm |
1213 0a0a 0F90 pop __tmp_reg__ |
1214 0a0c 0F90 pop __tmp_reg__ |
1215 0a0e 0F90 pop __tmp_reg__ |
1216 0a10 0F90 pop __tmp_reg__ |
1217 .L135: |
1218 0a12 1092 0000 sts RequiredMotors,__zero_reg__ |
1219 0a16 90E0 ldi r25,lo8(0) |
1220 0a18 E0E0 ldi r30,lo8(Mixer+13) |
1221 0a1a F0E0 ldi r31,hi8(Mixer+13) |
1222 0a1c CFE0 ldi r28,lo8(15) |
1223 .L141: |
1224 0a1e 8081 ld r24,Z |
1225 0a20 3496 adiw r30,4 |
1226 0a22 1816 cp __zero_reg__,r24 |
1227 0a24 0CF4 brge .L139 |
1228 0a26 9F5F subi r25,lo8(-(1)) |
1229 .L139: |
1230 0a28 C150 subi r28,lo8(-(-1)) |
1231 0a2a C7FF sbrs r28,7 |
1232 0a2c F8CF rjmp .L141 |
1233 0a2e 9093 0000 sts RequiredMotors,r25 |
1234 0a32 892F mov r24,r25 |
1235 0a34 9927 clr r25 |
1236 0a36 9F93 push r25 |
1237 0a38 8F93 push r24 |
1238 0a3a 80E0 ldi r24,lo8(Mixer+1) |
1239 0a3c 90E0 ldi r25,hi8(Mixer+1) |
1240 0a3e 9F93 push r25 |
1241 0a40 8F93 push r24 |
1242 0a42 80E0 ldi r24,lo8(__c.3) |
1243 0a44 90E0 ldi r25,hi8(__c.3) |
1244 0a46 9F93 push r25 |
1245 0a48 8F93 push r24 |
1246 0a4a 1F93 push r17 |
1247 0a4c 0F93 push r16 |
1248 0a4e E091 0000 lds r30,_printf_P |
1249 0a52 F091 0000 lds r31,(_printf_P)+1 |
1250 0a56 0995 icall |
1251 0a58 8DB7 in r24,__SP_L__ |
1252 0a5a 9EB7 in r25,__SP_H__ |
1253 0a5c 0896 adiw r24,8 |
1254 0a5e 8DBF out __SP_L__,r24 |
1255 0a60 80E0 ldi r24,lo8(__c.4) |
1256 0a62 90E0 ldi r25,hi8(__c.4) |
1257 0a64 9F93 push r25 |
1258 0a66 8F93 push r24 |
1259 0a68 1F93 push r17 |
1260 0a6a 0F93 push r16 |
1261 0a6c E091 0000 lds r30,_printf_P |
1262 0a70 F091 0000 lds r31,(_printf_P)+1 |
1263 0a74 0995 icall |
1264 0a76 0F90 pop __tmp_reg__ |
1265 0a78 0F90 pop __tmp_reg__ |
1266 0a7a 0F90 pop __tmp_reg__ |
1267 0a7c 0F90 pop __tmp_reg__ |
1268 /* epilogue: frame size=0 */ |
1269 0a7e CF91 pop r28 |
1270 0a80 1F91 pop r17 |
1271 0a82 0F91 pop r16 |
1272 0a84 FF90 pop r15 |
1273 0a86 EF90 pop r14 |
1274 0a88 DF90 pop r13 |
1275 0a8a 0895 ret |
1276 /* epilogue end (size=7) */ |
1277 /* function ParamSet_Init size 227 (214) */ |
1279 .comm Mixer,78,1 |
1280 .comm RequiredMotors,1,1 |
1281 .comm EE_Parameter,113,1 |
1282 /* File "eeprom.c": code 1373 = 0x055d (1307), prologues 25, epilogues 41 */ |
DEFINED SYMBOLS |
*ABS*:00000000 eeprom.c |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccmcRtsh.s:2 *ABS*:0000003f __SREG__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccmcRtsh.s:3 *ABS*:0000003e __SP_H__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccmcRtsh.s:4 *ABS*:0000003d __SP_L__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccmcRtsh.s:5 *ABS*:00000034 __CCP__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccmcRtsh.s:6 *ABS*:00000000 __tmp_reg__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccmcRtsh.s:7 *ABS*:00000001 __zero_reg__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccmcRtsh.s:10 .text:00000000 eeprom_read_byte |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccmcRtsh.s:32 .text:00000010 eeprom_write_byte |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccmcRtsh.s:59 .text:0000002a RAM_Checksum |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccmcRtsh.s:85 .text:0000004c EEProm_Checksum |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccmcRtsh.s:123 .text:00000078 ParamSet_DefaultStickMapping |
C:\Users\Arthur-P\AppData\Local\Temp/ccuObaaa.s:3 *ABS*:0000003f __SREG__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccuObaaa.s:4 *ABS*:0000003e __SP_H__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccuObaaa.s:5 *ABS*:0000003d __SP_L__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccuObaaa.s:6 *ABS*:00000000 __tmp_reg__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccuObaaa.s:7 *ABS*:00000001 __zero_reg__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccuObaaa.s:13 .text:00000000 RAM_Checksum |
C:\Users\Arthur-P\AppData\Local\Temp/ccuObaaa.s:41 .text:00000022 EEProm_Checksum |
C:\Users\Arthur-P\AppData\Local\Temp/ccuObaaa.s:73 .text:0000004a ParamSet_DefaultStickMapping |
*COM*:00000071 EE_Parameter |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccmcRtsh.s:155 .text:000000c2 GetParamByte |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccmcRtsh.s:177 .text:000000d0 SetParamByte |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccmcRtsh.s:203 .text:000000e8 GetActiveParamSet |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccmcRtsh.s:250 .text:0000011a SetActiveParamSet |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccmcRtsh.s:287 .text:00000146 MixerTable_ReadFromEEProm |
C:\Users\Arthur-P\AppData\Local\Temp/ccuObaaa.s:112 .text:00000094 ParamSet_DefaultSet1 |
C:\Users\Arthur-P\AppData\Local\Temp/ccuObaaa.s:285 .text:00000288 ParamSet_DefaultSet2 |
C:\Users\Arthur-P\AppData\Local\Temp/ccuObaaa.s:457 .text:0000047a ParamSet_DefaultSet3 |
C:\Users\Arthur-P\AppData\Local\Temp/ccuObaaa.s:622 .text:00000668 GetParamByte |
C:\Users\Arthur-P\AppData\Local\Temp/ccuObaaa.s:638 .text:00000674 SetParamByte |
C:\Users\Arthur-P\AppData\Local\Temp/ccuObaaa.s:653 .text:0000067e GetParamWord |
C:\Users\Arthur-P\AppData\Local\Temp/ccuObaaa.s:669 .text:00000688 SetParamWord |
C:\Users\Arthur-P\AppData\Local\Temp/ccuObaaa.s:685 .text:00000692 ParamSet_ReadFromEEProm |
C:\Users\Arthur-P\AppData\Local\Temp/ccuObaaa.s:753 .text:00000700 SetActiveParamSet |
C:\Users\Arthur-P\AppData\Local\Temp/ccuObaaa.s:778 .text:0000071a ParamSet_WriteToEEProm |
C:\Users\Arthur-P\AppData\Local\Temp/ccuObaaa.s:854 .text:0000079e MixerTable_ReadFromEEProm |
*COM*:0000004e Mixer |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccmcRtsh.s:372 .text:000001aa MixerTable_Default |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccmcRtsh.s:438 .text:00000232 ParamSet_DefaultSet3 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccmcRtsh.s:606 .text:00000418 ParamSet_DefaultSet2 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccmcRtsh.s:776 .text:00000602 ParamSet_DefaultSet1 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccmcRtsh.s:941 .text:000007ec MixerTable_WriteToEEProm |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccmcRtsh.s:975 .text:00000824 ParamSet_WriteToEEProm |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccmcRtsh.s:1097 .text:000008ea ParamSet_ReadFromEEProm |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccmcRtsh.s:1199 .text:0000097a ParamSet_Init |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccmcRtsh.s:1602 .progmem.data:0000007c __c.2353 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccmcRtsh.s:1598 .progmem.data:00000063 __c.2363 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccmcRtsh.s:1594 .progmem.data:00000042 __c.2365 |
C:\Users\Arthur-P\AppData\Local\Temp/ccuObaaa.s:902 .text:000007e2 MixerTable_WriteToEEProm |
C:\Users\Arthur-P\AppData\Local\Temp/ccuObaaa.s:946 .text:0000081e MixerTable_Default |
C:\Users\Arthur-P\AppData\Local\Temp/ccuObaaa.s:1008 .text:000008ac GetActiveParamSet |
C:\Users\Arthur-P\AppData\Local\Temp/ccuObaaa.s:1036 .progmem.data:00000000 __c.0 |
C:\Users\Arthur-P\AppData\Local\Temp/ccuObaaa.s:1040 .progmem.data:00000026 __c.1 |
C:\Users\Arthur-P\AppData\Local\Temp/ccuObaaa.s:1044 .progmem.data:0000003f __c.2 |
C:\Users\Arthur-P\AppData\Local\Temp/ccuObaaa.s:1048 .progmem.data:00000060 __c.3 |
C:\Users\Arthur-P\AppData\Local\Temp/ccuObaaa.s:1052 .progmem.data:00000081 __c.4 |
C:\Users\Arthur-P\AppData\Local\Temp/ccuObaaa.s:1057 .text:000008ca ParamSet_Init |
*COM*:00000001 RequiredMotors |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccmcRtsh.s:1590 .progmem.data:00000021 __c.2370 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccmcRtsh.s:1586 .progmem.data:00000000 __c.2372 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccmcRtsh.s:1563 .text:00000c28 SetParamWord |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccmcRtsh.s:1574 .text:00000c32 GetParamWord |
UNDEFINED SYMBOLS |
__eerd_block |
__do_copy_data |
__do_clear_bss |
__eeprom_read_byte_1F2021 |
PlatinenVersion |
__eewr_block |
__eeprom_write_byte_1F2021 |
__eeprom_read_word_1F2021 |
__eeprom_write_word_1F2021 |
__eeprom_read_block_1F2021 |
LED_Init |
__prologue_saves__ |
__epilogue_restores__ |
__eeprom_write_block_1F2021 |
uart_putchar |
_printf_P |
__epilogue_restores__ |
__eewr_word |
__eerd_word |
__do_copy_data |
__do_clear_bss |
/branches/V0.80g-Arthur-P1/fc.lst |
---|
1,9276 → 1,10116 |
1 .file "fc.c" |
2 __SREG__ = 0x3f |
3 __SP_H__ = 0x3e |
4 __SP_L__ = 0x3d |
5 __CCP__ = 0x34 |
2 .arch atmega644p |
3 __SREG__ = 0x3f |
4 __SP_H__ = 0x3e |
5 __SP_L__ = 0x3d |
6 __tmp_reg__ = 0 |
7 __zero_reg__ = 1 |
8 .text |
9 .global CopyDebugValues |
11 CopyDebugValues: |
12 0000 EF92 push r14 |
13 0002 FF92 push r15 |
14 0004 0F93 push r16 |
15 0006 1F93 push r17 |
16 /* prologue: function */ |
17 /* frame size = 0 */ |
18 0008 E090 0000 lds r14,EE_Parameter+28 |
19 000c FF24 clr r15 |
20 000e EE0C lsl r14 |
21 0010 FF1C rol r15 |
22 0012 EE0C lsl r14 |
23 0014 FF1C rol r15 |
24 0016 0027 clr r16 |
25 0018 F7FC sbrc r15,7 |
26 001a 0095 com r16 |
27 001c 102F mov r17,r16 |
28 001e 6091 0000 lds r22,IntegralNick |
29 0022 7091 0000 lds r23,(IntegralNick)+1 |
30 0026 8091 0000 lds r24,(IntegralNick)+2 |
31 002a 9091 0000 lds r25,(IntegralNick)+3 |
32 002e A801 movw r20,r16 |
33 0030 9701 movw r18,r14 |
34 0032 0E94 0000 call __divmodsi4 |
35 0036 3093 0000 sts (DebugOut+2)+1,r19 |
36 003a 2093 0000 sts DebugOut+2,r18 |
37 003e 6091 0000 lds r22,IntegralRoll |
38 0042 7091 0000 lds r23,(IntegralRoll)+1 |
39 0046 8091 0000 lds r24,(IntegralRoll)+2 |
40 004a 9091 0000 lds r25,(IntegralRoll)+3 |
41 004e A801 movw r20,r16 |
42 0050 9701 movw r18,r14 |
43 0052 0E94 0000 call __divmodsi4 |
44 0056 3093 0000 sts (DebugOut+4)+1,r19 |
45 005a 2093 0000 sts DebugOut+4,r18 |
46 005e 8091 0000 lds r24,Mittelwert_AccNick |
47 0062 9091 0000 lds r25,(Mittelwert_AccNick)+1 |
48 0066 64E0 ldi r22,lo8(4) |
49 0068 70E0 ldi r23,hi8(4) |
50 006a 0E94 0000 call __divmodhi4 |
51 006e 7093 0000 sts (DebugOut+6)+1,r23 |
52 0072 6093 0000 sts DebugOut+6,r22 |
53 0076 8091 0000 lds r24,Mittelwert_AccRoll |
54 007a 9091 0000 lds r25,(Mittelwert_AccRoll)+1 |
55 007e 64E0 ldi r22,lo8(4) |
56 0080 70E0 ldi r23,hi8(4) |
57 0082 0E94 0000 call __divmodhi4 |
58 0086 7093 0000 sts (DebugOut+8)+1,r23 |
59 008a 6093 0000 sts DebugOut+8,r22 |
60 008e 2091 0000 lds r18,AdWertGier |
61 0092 3091 0000 lds r19,(AdWertGier)+1 |
62 0096 8091 0000 lds r24,AdNeutralGier |
63 009a 9091 0000 lds r25,(AdNeutralGier)+1 |
64 009e 821B sub r24,r18 |
65 00a0 930B sbc r25,r19 |
66 00a2 9093 0000 sts (DebugOut+10)+1,r25 |
67 00a6 8093 0000 sts DebugOut+10,r24 |
68 00aa 6091 0000 lds r22,HoehenWert |
69 00ae 7091 0000 lds r23,(HoehenWert)+1 |
70 00b2 8091 0000 lds r24,(HoehenWert)+2 |
71 00b6 9091 0000 lds r25,(HoehenWert)+3 |
72 00ba 25E0 ldi r18,lo8(5) |
73 00bc 30E0 ldi r19,hi8(5) |
74 00be 40E0 ldi r20,hlo8(5) |
75 00c0 50E0 ldi r21,hhi8(5) |
76 00c2 0E94 0000 call __divmodsi4 |
77 00c6 3093 0000 sts (DebugOut+12)+1,r19 |
78 00ca 2093 0000 sts DebugOut+12,r18 |
79 00ce 8091 0000 lds r24,AdWertAccHoch |
80 00d2 9091 0000 lds r25,(AdWertAccHoch)+1 |
81 00d6 9093 0000 sts (DebugOut+14)+1,r25 |
82 00da 8093 0000 sts DebugOut+14,r24 |
83 00de 8091 0000 lds r24,KompassValue |
84 00e2 9091 0000 lds r25,(KompassValue)+1 |
85 00e6 9093 0000 sts (DebugOut+18)+1,r25 |
86 00ea 8093 0000 sts DebugOut+18,r24 |
87 00ee 8091 0000 lds r24,UBat |
88 00f2 9091 0000 lds r25,(UBat)+1 |
89 00f6 9093 0000 sts (DebugOut+20)+1,r25 |
90 00fa 8093 0000 sts DebugOut+20,r24 |
91 00fe 8091 0000 lds r24,SenderOkay |
92 0102 00E0 ldi r16,lo8(DebugOut+22) |
93 0104 10E0 ldi r17,hi8(DebugOut+22) |
94 0106 8093 0000 sts DebugOut+22,r24 |
95 010a 1092 0000 sts DebugOut+23,__zero_reg__ |
96 010e 6091 0000 lds r22,ErsatzKompass |
97 0112 7091 0000 lds r23,(ErsatzKompass)+1 |
98 0116 8091 0000 lds r24,(ErsatzKompass)+2 |
99 011a 9091 0000 lds r25,(ErsatzKompass)+3 |
100 011e 2091 0000 lds r18,GIER_GRAD_FAKTOR |
101 0122 3091 0000 lds r19,(GIER_GRAD_FAKTOR)+1 |
102 0126 4091 0000 lds r20,(GIER_GRAD_FAKTOR)+2 |
103 012a 5091 0000 lds r21,(GIER_GRAD_FAKTOR)+3 |
104 012e 0E94 0000 call __divmodsi4 |
105 0132 3093 0000 sts (DebugOut+24)+1,r19 |
106 0136 2093 0000 sts DebugOut+24,r18 |
107 013a 8091 0000 lds r24,Motor+1 |
108 013e 8093 0000 sts DebugOut+26,r24 |
109 0142 F801 movw r30,r16 |
110 0144 1582 std Z+5,__zero_reg__ |
111 0146 8091 0000 lds r24,Motor+9 |
112 014a 8093 0000 sts DebugOut+28,r24 |
113 014e 1782 std Z+7,__zero_reg__ |
114 0150 8091 0000 lds r24,Motor+17 |
115 0154 8093 0000 sts DebugOut+30,r24 |
116 0158 1186 std Z+9,__zero_reg__ |
117 015a 8091 0000 lds r24,Motor+25 |
118 015e 8093 0000 sts DebugOut+32,r24 |
119 0162 1386 std Z+11,__zero_reg__ |
120 0164 8091 0000 lds r24,ServoNickValue |
121 0168 9091 0000 lds r25,(ServoNickValue)+1 |
122 016c 9093 0000 sts (DebugOut+42)+1,r25 |
123 0170 8093 0000 sts DebugOut+42,r24 |
124 0174 8091 0000 lds r24,Capacity |
125 0178 9091 0000 lds r25,(Capacity)+1 |
126 017c 9093 0000 sts (DebugOut+46)+1,r25 |
127 0180 8093 0000 sts DebugOut+46,r24 |
128 0184 8091 0000 lds r24,Capacity+4 |
129 0188 9091 0000 lds r25,(Capacity+4)+1 |
130 018c 9093 0000 sts (DebugOut+48)+1,r25 |
131 0190 8093 0000 sts DebugOut+48,r24 |
132 0194 8091 0000 lds r24,Capacity+6 |
133 0198 8093 0000 sts DebugOut+60,r24 |
134 019c 17A2 std Z+39,__zero_reg__ |
135 019e 8091 0000 lds r24,GPS_Nick |
136 01a2 9091 0000 lds r25,(GPS_Nick)+1 |
137 01a6 9093 0000 sts (DebugOut+62)+1,r25 |
138 01aa 8093 0000 sts DebugOut+62,r24 |
139 01ae 8091 0000 lds r24,GPS_Roll |
140 01b2 9091 0000 lds r25,(GPS_Roll)+1 |
141 01b6 9093 0000 sts (DebugOut+64)+1,r25 |
142 01ba 8093 0000 sts DebugOut+64,r24 |
143 01be 8091 0000 lds r24,VersionInfo+5 |
144 01c2 8823 tst r24 |
145 01c4 01F4 brne .L2 |
146 01c6 8091 0000 lds r24,VersionInfo+6 |
147 01ca 8823 tst r24 |
148 01cc 01F0 breq .L3 |
149 .L2: |
150 01ce 8091 0000 lds r24,DebugOut+1 |
151 01d2 8160 ori r24,lo8(1) |
152 01d4 00C0 rjmp .L6 |
153 .L3: |
154 01d6 8091 0000 lds r24,DebugOut+1 |
155 01da 8E7F andi r24,lo8(-2) |
156 .L6: |
157 01dc 8093 0000 sts DebugOut+1,r24 |
158 /* epilogue start */ |
159 01e0 1F91 pop r17 |
160 01e2 0F91 pop r16 |
161 01e4 FF90 pop r15 |
162 01e6 EF90 pop r14 |
163 01e8 0895 ret |
165 .global Mittelwert |
167 Mittelwert: |
168 01ea ABE1 ldi r26,lo8(27) |
169 01ec B0E0 ldi r27,hi8(27) |
170 01ee E0E0 ldi r30,lo8(gs(1f)) |
171 01f0 F0E0 ldi r31,hi8(gs(1f)) |
172 01f2 0C94 0000 jmp __prologue_saves__+((18 - 18) * 2) |
173 1: |
174 /* prologue: function */ |
175 /* frame size = 27 */ |
176 01f6 8091 0000 lds r24,AdWertGier |
177 01fa 9091 0000 lds r25,(AdWertGier)+1 |
178 01fe 2091 0000 lds r18,AdNeutralGier |
179 0202 3091 0000 lds r19,(AdNeutralGier)+1 |
180 0206 281B sub r18,r24 |
181 0208 390B sbc r19,r25 |
182 020a 3B8F std Y+27,r19 |
183 020c 2A8F std Y+26,r18 |
184 020e 3093 0000 sts (MesswertGier)+1,r19 |
185 0212 2093 0000 sts MesswertGier,r18 |
186 0216 8091 0000 lds r24,AdWertNickFilter |
187 021a 9091 0000 lds r25,(AdWertNickFilter)+1 |
188 021e 68E0 ldi r22,lo8(8) |
189 0220 70E0 ldi r23,hi8(8) |
190 0222 0E94 0000 call __divmodhi4 |
191 0226 6E8B std Y+22,r22 |
192 0228 7F8B std Y+23,r23 |
193 022a 8091 0000 lds r24,AdWertRollFilter |
194 022e 9091 0000 lds r25,(AdWertRollFilter)+1 |
195 0232 68E0 ldi r22,lo8(8) |
196 0234 70E0 ldi r23,hi8(8) |
197 0236 0E94 0000 call __divmodhi4 |
198 023a 688F std Y+24,r22 |
199 023c 798F std Y+25,r23 |
200 023e 4E89 ldd r20,Y+22 |
201 0240 5F89 ldd r21,Y+23 |
202 0242 5093 0000 sts (RohMesswertNick)+1,r21 |
203 0246 4093 0000 sts RohMesswertNick,r20 |
204 024a 688D ldd r22,Y+24 |
205 024c 798D ldd r23,Y+25 |
206 024e 7093 0000 sts (RohMesswertRoll)+1,r23 |
207 0252 6093 0000 sts RohMesswertRoll,r22 |
208 0256 2091 0000 lds r18,AdWertAccNick |
209 025a 3091 0000 lds r19,(AdWertAccNick)+1 |
210 025e C901 movw r24,r18 |
211 0260 880F lsl r24 |
212 0262 991F rol r25 |
213 0264 820F add r24,r18 |
214 0266 931F adc r25,r19 |
215 0268 880F lsl r24 |
216 026a 991F rol r25 |
217 026c 4091 0000 lds r20,Mittelwert_AccNick |
218 0270 5091 0000 lds r21,(Mittelwert_AccNick)+1 |
219 0274 9A01 movw r18,r20 |
220 0276 220F lsl r18 |
221 0278 331F rol r19 |
222 027a 240F add r18,r20 |
223 027c 351F adc r19,r21 |
224 027e 820F add r24,r18 |
225 0280 931F adc r25,r19 |
226 0282 64E0 ldi r22,lo8(4) |
227 0284 70E0 ldi r23,hi8(4) |
228 0286 0E94 0000 call __divmodhi4 |
229 028a 7093 0000 sts (Mittelwert_AccNick)+1,r23 |
230 028e 6093 0000 sts Mittelwert_AccNick,r22 |
231 0292 2091 0000 lds r18,AdWertAccRoll |
232 0296 3091 0000 lds r19,(AdWertAccRoll)+1 |
233 029a C901 movw r24,r18 |
234 029c 880F lsl r24 |
235 029e 991F rol r25 |
236 02a0 820F add r24,r18 |
237 02a2 931F adc r25,r19 |
238 02a4 880F lsl r24 |
239 02a6 991F rol r25 |
240 02a8 4091 0000 lds r20,Mittelwert_AccRoll |
241 02ac 5091 0000 lds r21,(Mittelwert_AccRoll)+1 |
242 02b0 9A01 movw r18,r20 |
243 02b2 220F lsl r18 |
244 02b4 331F rol r19 |
245 02b6 240F add r18,r20 |
246 02b8 351F adc r19,r21 |
247 02ba 820F add r24,r18 |
248 02bc 931F adc r25,r19 |
249 02be 64E0 ldi r22,lo8(4) |
250 02c0 70E0 ldi r23,hi8(4) |
251 02c2 0E94 0000 call __divmodhi4 |
252 02c6 7093 0000 sts (Mittelwert_AccRoll)+1,r23 |
253 02ca 6093 0000 sts Mittelwert_AccRoll,r22 |
254 02ce 2091 0000 lds r18,AdWertAccNick |
255 02d2 3091 0000 lds r19,(AdWertAccNick)+1 |
256 02d6 C901 movw r24,r18 |
257 02d8 880F lsl r24 |
258 02da 991F rol r25 |
259 02dc 820F add r24,r18 |
260 02de 931F adc r25,r19 |
261 02e0 880F lsl r24 |
262 02e2 991F rol r25 |
263 02e4 AA27 clr r26 |
264 02e6 97FD sbrc r25,7 |
265 02e8 A095 com r26 |
266 02ea BA2F mov r27,r26 |
267 02ec 2091 0000 lds r18,IntegralAccNick |
268 02f0 3091 0000 lds r19,(IntegralAccNick)+1 |
269 02f4 4091 0000 lds r20,(IntegralAccNick)+2 |
270 02f8 5091 0000 lds r21,(IntegralAccNick)+3 |
271 02fc 280F add r18,r24 |
272 02fe 391F adc r19,r25 |
273 0300 4A1F adc r20,r26 |
274 0302 5B1F adc r21,r27 |
275 0304 2093 0000 sts IntegralAccNick,r18 |
276 0308 3093 0000 sts (IntegralAccNick)+1,r19 |
277 030c 4093 0000 sts (IntegralAccNick)+2,r20 |
278 0310 5093 0000 sts (IntegralAccNick)+3,r21 |
279 0314 2091 0000 lds r18,AdWertAccRoll |
280 0318 3091 0000 lds r19,(AdWertAccRoll)+1 |
281 031c C901 movw r24,r18 |
282 031e 880F lsl r24 |
283 0320 991F rol r25 |
284 0322 820F add r24,r18 |
285 0324 931F adc r25,r19 |
286 0326 880F lsl r24 |
287 0328 991F rol r25 |
288 032a AA27 clr r26 |
289 032c 97FD sbrc r25,7 |
290 032e A095 com r26 |
291 0330 BA2F mov r27,r26 |
292 0332 2091 0000 lds r18,IntegralAccRoll |
293 0336 3091 0000 lds r19,(IntegralAccRoll)+1 |
294 033a 4091 0000 lds r20,(IntegralAccRoll)+2 |
295 033e 5091 0000 lds r21,(IntegralAccRoll)+3 |
296 0342 280F add r18,r24 |
297 0344 391F adc r19,r25 |
298 0346 4A1F adc r20,r26 |
299 0348 5B1F adc r21,r27 |
300 034a 2093 0000 sts IntegralAccRoll,r18 |
301 034e 3093 0000 sts (IntegralAccRoll)+1,r19 |
302 0352 4093 0000 sts (IntegralAccRoll)+2,r20 |
303 0356 5093 0000 sts (IntegralAccRoll)+3,r21 |
304 035a 2091 0000 lds r18,AdWertAccNick |
305 035e 3091 0000 lds r19,(AdWertAccNick)+1 |
306 0362 8091 0000 lds r24,NaviAccNick |
307 0366 9091 0000 lds r25,(NaviAccNick)+1 |
308 036a 820F add r24,r18 |
309 036c 931F adc r25,r19 |
310 036e 9093 0000 sts (NaviAccNick)+1,r25 |
311 0372 8093 0000 sts NaviAccNick,r24 |
312 0376 2091 0000 lds r18,AdWertAccRoll |
313 037a 3091 0000 lds r19,(AdWertAccRoll)+1 |
314 037e 8091 0000 lds r24,NaviAccRoll |
315 0382 9091 0000 lds r25,(NaviAccRoll)+1 |
316 0386 820F add r24,r18 |
317 0388 931F adc r25,r19 |
318 038a 9093 0000 sts (NaviAccRoll)+1,r25 |
319 038e 8093 0000 sts NaviAccRoll,r24 |
320 0392 8091 0000 lds r24,NaviCntAcc |
321 0396 9091 0000 lds r25,(NaviCntAcc)+1 |
322 039a 0196 adiw r24,1 |
323 039c 9093 0000 sts (NaviCntAcc)+1,r25 |
324 03a0 8093 0000 sts NaviCntAcc,r24 |
325 03a4 2091 0000 lds r18,Aktuell_az |
326 03a8 3091 0000 lds r19,(Aktuell_az)+1 |
327 03ac 8091 0000 lds r24,NeutralAccZ |
328 03b0 9091 0000 lds r25,(NeutralAccZ)+1 |
329 03b4 281B sub r18,r24 |
330 03b6 390B sbc r19,r25 |
331 03b8 4427 clr r20 |
332 03ba 37FD sbrc r19,7 |
333 03bc 4095 com r20 |
334 03be 542F mov r21,r20 |
335 03c0 8091 0000 lds r24,IntegralAccZ |
336 03c4 9091 0000 lds r25,(IntegralAccZ)+1 |
337 03c8 A091 0000 lds r26,(IntegralAccZ)+2 |
338 03cc B091 0000 lds r27,(IntegralAccZ)+3 |
339 03d0 820F add r24,r18 |
340 03d2 931F adc r25,r19 |
341 03d4 A41F adc r26,r20 |
342 03d6 B51F adc r27,r21 |
343 03d8 8093 0000 sts IntegralAccZ,r24 |
344 03dc 9093 0000 sts (IntegralAccZ)+1,r25 |
345 03e0 A093 0000 sts (IntegralAccZ)+2,r26 |
346 03e4 B093 0000 sts (IntegralAccZ)+3,r27 |
347 03e8 8FEC ldi r24,lo8(-49) |
348 03ea 8093 7A00 sts 122,r24 |
349 03ee 1092 0000 sts AdReady,__zero_reg__ |
350 03f2 8091 0000 lds r24,Mess_IntegralRoll |
351 03f6 9091 0000 lds r25,(Mess_IntegralRoll)+1 |
352 03fa A091 0000 lds r26,(Mess_IntegralRoll)+2 |
353 03fe B091 0000 lds r27,(Mess_IntegralRoll)+3 |
354 0402 8A8B std Y+18,r24 |
355 0404 9B8B std Y+19,r25 |
356 0406 AC8B std Y+20,r26 |
357 0408 BD8B std Y+21,r27 |
358 040a 2091 0000 lds r18,Mess_IntegralNick |
359 040e 3091 0000 lds r19,(Mess_IntegralNick)+1 |
360 0412 4091 0000 lds r20,(Mess_IntegralNick)+2 |
361 0416 5091 0000 lds r21,(Mess_IntegralNick)+3 |
362 041a 2E87 std Y+14,r18 |
363 041c 3F87 std Y+15,r19 |
364 041e 488B std Y+16,r20 |
365 0420 598B std Y+17,r21 |
366 0422 4A8D ldd r20,Y+26 |
367 0424 5B8D ldd r21,Y+27 |
368 0426 6627 clr r22 |
369 0428 57FD sbrc r21,7 |
370 042a 6095 com r22 |
371 042c 762F mov r23,r22 |
372 042e 4A87 std Y+10,r20 |
373 0430 5B87 std Y+11,r21 |
374 0432 6C87 std Y+12,r22 |
375 0434 7D87 std Y+13,r23 |
376 0436 2090 0000 lds r2,Mess_Integral_Gier |
377 043a 3090 0000 lds r3,(Mess_Integral_Gier)+1 |
378 043e 4090 0000 lds r4,(Mess_Integral_Gier)+2 |
379 0442 5090 0000 lds r5,(Mess_Integral_Gier)+3 |
380 0446 240E add r2,r20 |
381 0448 351E adc r3,r21 |
382 044a 461E adc r4,r22 |
383 044c 571E adc r5,r23 |
384 044e 2092 0000 sts Mess_Integral_Gier,r2 |
385 0452 3092 0000 sts (Mess_Integral_Gier)+1,r3 |
386 0456 4092 0000 sts (Mess_Integral_Gier)+2,r4 |
387 045a 5092 0000 sts (Mess_Integral_Gier)+3,r5 |
388 045e 6090 0000 lds r6,ErsatzKompass |
389 0462 7090 0000 lds r7,(ErsatzKompass)+1 |
390 0466 8090 0000 lds r8,(ErsatzKompass)+2 |
391 046a 9090 0000 lds r9,(ErsatzKompass)+3 |
392 046e 640E add r6,r20 |
393 0470 751E adc r7,r21 |
394 0472 861E adc r8,r22 |
395 0474 971E adc r9,r23 |
396 0476 6092 0000 sts ErsatzKompass,r6 |
397 047a 7092 0000 sts (ErsatzKompass)+1,r7 |
398 047e 8092 0000 sts (ErsatzKompass)+2,r8 |
399 0482 9092 0000 sts (ErsatzKompass)+3,r9 |
400 0486 5091 0000 lds r21,Looping_Nick |
401 048a 5987 std Y+9,r21 |
402 048c 5523 tst r21 |
403 048e 01F0 breq .+2 |
404 0490 00C0 rjmp .L8 |
405 0492 8091 0000 lds r24,Looping_Roll |
406 0496 8823 tst r24 |
407 0498 01F0 breq .+2 |
408 049a 00C0 rjmp .L8 |
409 049c 8091 0000 lds r24,EE_Parameter+13 |
410 04a0 86FF sbrs r24,6 |
411 04a2 00C0 rjmp .L8 |
412 04a4 2A89 ldd r18,Y+18 |
413 04a6 3B89 ldd r19,Y+19 |
414 04a8 4C89 ldd r20,Y+20 |
415 04aa 5D89 ldd r21,Y+21 |
416 04ac 283B cpi r18,lo8(-93000) |
417 04ae 64E9 ldi r22,hi8(-93000) |
418 04b0 3607 cpc r19,r22 |
419 04b2 6EEF ldi r22,hlo8(-93000) |
420 04b4 4607 cpc r20,r22 |
421 04b6 6FEF ldi r22,hhi8(-93000) |
422 04b8 5607 cpc r21,r22 |
423 04ba 04F4 brge .L9 |
424 04bc 28EB ldi r18,lo8(-93000) |
425 04be 34E9 ldi r19,hi8(-93000) |
426 04c0 4EEF ldi r20,hlo8(-93000) |
427 04c2 5FEF ldi r21,hhi8(-93000) |
428 .L9: |
429 04c4 2983 std Y+1,r18 |
430 04c6 3A83 std Y+2,r19 |
431 04c8 4B83 std Y+3,r20 |
432 04ca 5C83 std Y+4,r21 |
433 04cc 2954 subi r18,lo8(93001) |
434 04ce 3B46 sbci r19,hi8(93001) |
435 04d0 4140 sbci r20,hlo8(93001) |
436 04d2 5040 sbci r21,hhi8(93001) |
437 04d4 04F0 brlt .L10 |
438 04d6 88E4 ldi r24,lo8(93000) |
439 04d8 9BE6 ldi r25,hi8(93000) |
440 04da A1E0 ldi r26,hlo8(93000) |
441 04dc B0E0 ldi r27,hhi8(93000) |
442 04de 8983 std Y+1,r24 |
443 04e0 9A83 std Y+2,r25 |
444 04e2 AB83 std Y+3,r26 |
445 04e4 BC83 std Y+4,r27 |
446 .L10: |
447 04e6 2E85 ldd r18,Y+14 |
448 04e8 3F85 ldd r19,Y+15 |
449 04ea 4889 ldd r20,Y+16 |
450 04ec 5989 ldd r21,Y+17 |
451 04ee 283B cpi r18,lo8(-93000) |
452 04f0 94E9 ldi r25,hi8(-93000) |
453 04f2 3907 cpc r19,r25 |
454 04f4 9EEF ldi r25,hlo8(-93000) |
455 04f6 4907 cpc r20,r25 |
456 04f8 9FEF ldi r25,hhi8(-93000) |
457 04fa 5907 cpc r21,r25 |
458 04fc 04F4 brge .L11 |
459 04fe 28EB ldi r18,lo8(-93000) |
460 0500 34E9 ldi r19,hi8(-93000) |
461 0502 4EEF ldi r20,hlo8(-93000) |
462 0504 5FEF ldi r21,hhi8(-93000) |
463 .L11: |
464 0506 2D83 std Y+5,r18 |
465 0508 3E83 std Y+6,r19 |
466 050a 4F83 std Y+7,r20 |
467 050c 5887 std Y+8,r21 |
468 050e 2954 subi r18,lo8(93001) |
469 0510 3B46 sbci r19,hi8(93001) |
470 0512 4140 sbci r20,hlo8(93001) |
471 0514 5040 sbci r21,hhi8(93001) |
472 0516 04F0 brlt .L12 |
473 0518 28E4 ldi r18,lo8(93000) |
474 051a 3BE6 ldi r19,hi8(93000) |
475 051c 41E0 ldi r20,hlo8(93000) |
476 051e 50E0 ldi r21,hhi8(93000) |
477 0520 2D83 std Y+5,r18 |
478 0522 3E83 std Y+6,r19 |
479 0524 4F83 std Y+7,r20 |
480 0526 5887 std Y+8,r21 |
481 .L12: |
482 0528 A090 0000 lds r10,Parameter_AchsKopplung2 |
483 052c BB24 clr r11 |
484 052e CC24 clr r12 |
485 0530 DD24 clr r13 |
486 0532 688D ldd r22,Y+24 |
487 0534 798D ldd r23,Y+25 |
488 0536 9B01 movw r18,r22 |
489 0538 4427 clr r20 |
490 053a 37FD sbrc r19,7 |
491 053c 4095 com r20 |
492 053e 542F mov r21,r20 |
493 0540 6D81 ldd r22,Y+5 |
494 0542 7E81 ldd r23,Y+6 |
495 0544 8F81 ldd r24,Y+7 |
496 0546 9885 ldd r25,Y+8 |
497 0548 0E94 0000 call __mulsi3 |
498 054c 20E0 ldi r18,lo8(2048) |
499 054e 38E0 ldi r19,hi8(2048) |
500 0550 40E0 ldi r20,hlo8(2048) |
501 0552 50E0 ldi r21,hhi8(2048) |
502 0554 0E94 0000 call __divmodsi4 |
503 0558 CA01 movw r24,r20 |
504 055a B901 movw r22,r18 |
505 055c A601 movw r20,r12 |
506 055e 9501 movw r18,r10 |
507 0560 0E94 0000 call __mulsi3 |
508 0564 20E0 ldi r18,lo8(4096) |
509 0566 30E1 ldi r19,hi8(4096) |
510 0568 40E0 ldi r20,hlo8(4096) |
511 056a 50E0 ldi r21,hhi8(4096) |
512 056c 0E94 0000 call __divmodsi4 |
513 0570 7901 movw r14,r18 |
514 0572 8A01 movw r16,r20 |
515 0574 E092 0000 sts tmpl3.2602,r14 |
516 0578 F092 0000 sts (tmpl3.2602)+1,r15 |
517 057c 0093 0000 sts (tmpl3.2602)+2,r16 |
518 0580 1093 0000 sts (tmpl3.2602)+3,r17 |
519 0584 8E89 ldd r24,Y+22 |
520 0586 9F89 ldd r25,Y+23 |
521 0588 9C01 movw r18,r24 |
522 058a 4427 clr r20 |
523 058c 37FD sbrc r19,7 |
524 058e 4095 com r20 |
525 0590 542F mov r21,r20 |
526 0592 6981 ldd r22,Y+1 |
527 0594 7A81 ldd r23,Y+2 |
528 0596 8B81 ldd r24,Y+3 |
529 0598 9C81 ldd r25,Y+4 |
530 059a 0E94 0000 call __mulsi3 |
531 059e 20E0 ldi r18,lo8(2048) |
532 05a0 38E0 ldi r19,hi8(2048) |
533 05a2 40E0 ldi r20,hlo8(2048) |
534 05a4 50E0 ldi r21,hhi8(2048) |
535 05a6 0E94 0000 call __divmodsi4 |
536 05aa CA01 movw r24,r20 |
537 05ac B901 movw r22,r18 |
538 05ae A601 movw r20,r12 |
539 05b0 9501 movw r18,r10 |
540 05b2 0E94 0000 call __mulsi3 |
541 05b6 20E0 ldi r18,lo8(4096) |
542 05b8 30E1 ldi r19,hi8(4096) |
543 05ba 40E0 ldi r20,hlo8(4096) |
544 05bc 50E0 ldi r21,hhi8(4096) |
545 05be 0E94 0000 call __divmodsi4 |
546 05c2 C901 movw r24,r18 |
547 05c4 DA01 movw r26,r20 |
548 05c6 F092 0000 sts (KopplungsteilNickRoll)+1,r15 |
549 05ca E092 0000 sts KopplungsteilNickRoll,r14 |
550 05ce 3093 0000 sts (KopplungsteilRollNick)+1,r19 |
551 05d2 2093 0000 sts KopplungsteilRollNick,r18 |
552 05d6 9C01 movw r18,r24 |
553 05d8 AD01 movw r20,r26 |
554 05da 2E19 sub r18,r14 |
555 05dc 3F09 sbc r19,r15 |
556 05de 400B sbc r20,r16 |
557 05e0 510B sbc r21,r17 |
558 05e2 7901 movw r14,r18 |
559 05e4 8A01 movw r16,r20 |
560 05e6 2093 0000 sts tmpl4.2603,r18 |
561 05ea 3093 0000 sts (tmpl4.2603)+1,r19 |
562 05ee 4093 0000 sts (tmpl4.2603)+2,r20 |
563 05f2 5093 0000 sts (tmpl4.2603)+3,r21 |
564 05f6 620E add r6,r18 |
565 05f8 731E adc r7,r19 |
566 05fa 841E adc r8,r20 |
567 05fc 951E adc r9,r21 |
568 05fe 6092 0000 sts ErsatzKompass,r6 |
569 0602 7092 0000 sts (ErsatzKompass)+1,r7 |
570 0606 8092 0000 sts (ErsatzKompass)+2,r8 |
571 060a 9092 0000 sts (ErsatzKompass)+3,r9 |
572 060e 8091 0000 lds r24,Parameter_CouplingYawCorrection |
573 0612 8823 tst r24 |
574 0614 01F4 brne .L13 |
575 0616 CA01 movw r24,r20 |
576 0618 B901 movw r22,r18 |
577 061a 22E0 ldi r18,lo8(2) |
578 061c 30E0 ldi r19,hi8(2) |
579 061e 40E0 ldi r20,hlo8(2) |
580 0620 50E0 ldi r21,hhi8(2) |
581 0622 0E94 0000 call __divmodsi4 |
582 0626 221A sub r2,r18 |
583 0628 330A sbc r3,r19 |
584 062a 440A sbc r4,r20 |
585 062c 550A sbc r5,r21 |
586 062e 2092 0000 sts Mess_Integral_Gier,r2 |
587 0632 3092 0000 sts (Mess_Integral_Gier)+1,r3 |
588 0636 4092 0000 sts (Mess_Integral_Gier)+2,r4 |
589 063a 5092 0000 sts (Mess_Integral_Gier)+3,r5 |
590 .L13: |
591 063e AA84 ldd r10,Y+10 |
592 0640 BB84 ldd r11,Y+11 |
593 0642 CC84 ldd r12,Y+12 |
594 0644 DD84 ldd r13,Y+13 |
595 0646 AE0C add r10,r14 |
596 0648 BF1C adc r11,r15 |
597 064a C01E adc r12,r16 |
598 064c D11E adc r13,r17 |
599 064e E090 0000 lds r14,Parameter_AchsKopplung1 |
600 0652 FF24 clr r15 |
601 0654 00E0 ldi r16,lo8(0) |
602 0656 10E0 ldi r17,hi8(0) |
603 0658 C601 movw r24,r12 |
604 065a B501 movw r22,r10 |
605 065c 2D81 ldd r18,Y+5 |
606 065e 3E81 ldd r19,Y+6 |
607 0660 4F81 ldd r20,Y+7 |
608 0662 5885 ldd r21,Y+8 |
609 0664 0E94 0000 call __mulsi3 |
610 0668 20E0 ldi r18,lo8(2048) |
611 066a 38E0 ldi r19,hi8(2048) |
612 066c 40E0 ldi r20,hlo8(2048) |
613 066e 50E0 ldi r21,hhi8(2048) |
614 0670 0E94 0000 call __divmodsi4 |
615 0674 CA01 movw r24,r20 |
616 0676 B901 movw r22,r18 |
617 0678 A801 movw r20,r16 |
618 067a 9701 movw r18,r14 |
619 067c 0E94 0000 call __mulsi3 |
620 0680 20E0 ldi r18,lo8(4096) |
621 0682 30E1 ldi r19,hi8(4096) |
622 0684 40E0 ldi r20,hlo8(4096) |
623 0686 50E0 ldi r21,hhi8(4096) |
624 0688 0E94 0000 call __divmodsi4 |
625 068c 922E mov r9,r18 |
626 068e 832E mov r8,r19 |
627 0690 742E mov r7,r20 |
628 0692 652E mov r6,r21 |
629 0694 2093 0000 sts tmpl.2600,r18 |
630 0698 3093 0000 sts tmpl.2600+1,r19 |
631 069c 4093 0000 sts tmpl.2600+2,r20 |
632 06a0 5093 0000 sts tmpl.2600+3,r21 |
633 06a4 C601 movw r24,r12 |
634 06a6 B501 movw r22,r10 |
635 06a8 2981 ldd r18,Y+1 |
636 06aa 3A81 ldd r19,Y+2 |
637 06ac 4B81 ldd r20,Y+3 |
638 06ae 5C81 ldd r21,Y+4 |
639 06b0 0E94 0000 call __mulsi3 |
640 06b4 20E0 ldi r18,lo8(2048) |
641 06b6 38E0 ldi r19,hi8(2048) |
642 06b8 40E0 ldi r20,hlo8(2048) |
643 06ba 50E0 ldi r21,hhi8(2048) |
644 06bc 0E94 0000 call __divmodsi4 |
645 06c0 CA01 movw r24,r20 |
646 06c2 B901 movw r22,r18 |
647 06c4 A801 movw r20,r16 |
648 06c6 9701 movw r18,r14 |
649 06c8 0E94 0000 call __mulsi3 |
650 06cc 20E0 ldi r18,lo8(4096) |
651 06ce 30E1 ldi r19,hi8(4096) |
652 06d0 40E0 ldi r20,hlo8(4096) |
653 06d2 50E0 ldi r21,hhi8(4096) |
654 06d4 0E94 0000 call __divmodsi4 |
655 06d8 B901 movw r22,r18 |
656 06da FA01 movw r30,r20 |
657 06dc 2093 0000 sts tmpl2.2601,r18 |
658 06e0 7093 0000 sts tmpl2.2601+1,r23 |
659 06e4 4093 0000 sts tmpl2.2601+2,r20 |
660 06e8 F093 0000 sts tmpl2.2601+3,r31 |
661 06ec 8A8D ldd r24,Y+26 |
662 06ee 9B8D ldd r25,Y+27 |
663 06f0 97FF sbrs r25,7 |
664 06f2 00C0 rjmp .L15 |
665 06f4 9095 com r25 |
666 06f6 8195 neg r24 |
667 06f8 9F4F sbci r25,lo8(-1) |
668 .L15: |
669 06fa 8134 cpi r24,65 |
670 06fc 9105 cpc r25,__zero_reg__ |
671 06fe 04F4 brge .+2 |
672 0700 00C0 rjmp .L14 |
673 0702 292D mov r18,r9 |
674 0704 382D mov r19,r8 |
675 0706 472D mov r20,r7 |
676 0708 562D mov r21,r6 |
677 070a C901 movw r24,r18 |
678 070c DA01 movw r26,r20 |
679 070e B7FF sbrs r27,7 |
680 0710 00C0 rjmp .L17 |
681 0712 B095 com r27 |
682 0714 A095 com r26 |
683 0716 9095 com r25 |
684 0718 8195 neg r24 |
685 071a 9F4F sbci r25,lo8(-1) |
686 071c AF4F sbci r26,lo8(-1) |
687 071e BF4F sbci r27,lo8(-1) |
688 .L17: |
689 0720 8138 cpi r24,lo8(129) |
690 0722 9105 cpc r25,__zero_reg__ |
691 0724 A105 cpc r26,__zero_reg__ |
692 0726 B105 cpc r27,__zero_reg__ |
693 0728 04F4 brge .L16 |
694 072a CB01 movw r24,r22 |
695 072c DF01 movw r26,r30 |
696 072e B7FF sbrs r27,7 |
697 0730 00C0 rjmp .L18 |
698 0732 B095 com r27 |
699 0734 A095 com r26 |
700 0736 9095 com r25 |
701 0738 8195 neg r24 |
702 073a 9F4F sbci r25,lo8(-1) |
703 073c AF4F sbci r26,lo8(-1) |
704 073e BF4F sbci r27,lo8(-1) |
705 .L18: |
706 0740 8138 cpi r24,lo8(129) |
707 0742 9105 cpc r25,__zero_reg__ |
708 0744 A105 cpc r26,__zero_reg__ |
709 0746 B105 cpc r27,__zero_reg__ |
710 0748 04F0 brlt .L14 |
711 .L16: |
712 074a 81E0 ldi r24,lo8(1) |
713 074c 8093 0000 sts TrichterFlug,r24 |
714 0750 00C0 rjmp .L14 |
715 .L8: |
716 0752 1092 0000 sts (KopplungsteilRollNick)+1,__zero_reg__ |
717 0756 1092 0000 sts KopplungsteilRollNick,__zero_reg__ |
718 075a 1092 0000 sts (KopplungsteilNickRoll)+1,__zero_reg__ |
719 075e 1092 0000 sts KopplungsteilNickRoll,__zero_reg__ |
720 0762 1092 0000 sts tmpl2.2601,__zero_reg__ |
721 0766 1092 0000 sts (tmpl2.2601)+1,__zero_reg__ |
722 076a 1092 0000 sts (tmpl2.2601)+2,__zero_reg__ |
723 076e 1092 0000 sts (tmpl2.2601)+3,__zero_reg__ |
724 0772 1092 0000 sts tmpl.2600,__zero_reg__ |
725 0776 1092 0000 sts (tmpl.2600)+1,__zero_reg__ |
726 077a 1092 0000 sts (tmpl.2600)+2,__zero_reg__ |
727 077e 1092 0000 sts (tmpl.2600)+3,__zero_reg__ |
728 .L14: |
729 0782 E090 0000 lds r14,tmpl.2600 |
730 0786 F090 0000 lds r15,(tmpl.2600)+1 |
731 078a 0091 0000 lds r16,(tmpl.2600)+2 |
732 078e 1091 0000 lds r17,(tmpl.2600)+3 |
733 0792 A090 0000 lds r10,tmpl2.2601 |
734 0796 B090 0000 lds r11,(tmpl2.2601)+1 |
735 079a C090 0000 lds r12,(tmpl2.2601)+2 |
736 079e D090 0000 lds r13,(tmpl2.2601)+3 |
737 07a2 C601 movw r24,r12 |
738 07a4 B501 movw r22,r10 |
739 07a6 2CE9 ldi r18,lo8(-100) |
740 07a8 3FEF ldi r19,hi8(-100) |
741 07aa 4FEF ldi r20,hlo8(-100) |
742 07ac 5FEF ldi r21,hhi8(-100) |
743 07ae 0E94 0000 call __divmodsi4 |
744 07b2 2901 movw r4,r18 |
745 07b4 4E0C add r4,r14 |
746 07b6 5F1C adc r5,r15 |
747 07b8 5092 0000 sts (TrimRoll)+1,r5 |
748 07bc 4092 0000 sts TrimRoll,r4 |
749 07c0 C801 movw r24,r16 |
750 07c2 B701 movw r22,r14 |
751 07c4 24E6 ldi r18,lo8(100) |
752 07c6 30E0 ldi r19,hi8(100) |
753 07c8 40E0 ldi r20,hlo8(100) |
754 07ca 50E0 ldi r21,hhi8(100) |
755 07cc 0E94 0000 call __divmodsi4 |
756 07d0 1901 movw r2,r18 |
757 07d2 2A18 sub r2,r10 |
758 07d4 3B08 sbc r3,r11 |
759 07d6 3092 0000 sts (TrimNick)+1,r3 |
760 07da 2092 0000 sts TrimNick,r2 |
761 07de E090 0000 lds r14,ErsatzKompass |
762 07e2 F090 0000 lds r15,(ErsatzKompass)+1 |
763 07e6 0091 0000 lds r16,(ErsatzKompass)+2 |
764 07ea 1091 0000 lds r17,(ErsatzKompass)+3 |
765 07ee A090 0000 lds r10,GIER_GRAD_FAKTOR |
766 07f2 B090 0000 lds r11,(GIER_GRAD_FAKTOR)+1 |
767 07f6 C090 0000 lds r12,(GIER_GRAD_FAKTOR)+2 |
768 07fa D090 0000 lds r13,(GIER_GRAD_FAKTOR)+3 |
769 07fe C601 movw r24,r12 |
770 0800 B501 movw r22,r10 |
771 0802 28E6 ldi r18,lo8(360) |
772 0804 31E0 ldi r19,hi8(360) |
773 0806 40E0 ldi r20,hlo8(360) |
774 0808 50E0 ldi r21,hhi8(360) |
775 080a 0E94 0000 call __mulsi3 |
776 080e 3B01 movw r6,r22 |
777 0810 4C01 movw r8,r24 |
778 0812 E616 cp r14,r22 |
779 0814 F706 cpc r15,r23 |
780 0816 0807 cpc r16,r24 |
781 0818 1907 cpc r17,r25 |
782 081a 04F0 brlt .L19 |
783 081c C601 movw r24,r12 |
784 081e B501 movw r22,r10 |
785 0820 28E9 ldi r18,lo8(-360) |
786 0822 3EEF ldi r19,hi8(-360) |
787 0824 4FEF ldi r20,hlo8(-360) |
788 0826 5FEF ldi r21,hhi8(-360) |
789 0828 0E94 0000 call __mulsi3 |
790 082c E60E add r14,r22 |
791 082e F71E adc r15,r23 |
792 0830 081F adc r16,r24 |
793 0832 191F adc r17,r25 |
794 0834 E092 0000 sts ErsatzKompass,r14 |
795 0838 F092 0000 sts (ErsatzKompass)+1,r15 |
796 083c 0093 0000 sts (ErsatzKompass)+2,r16 |
797 0840 1093 0000 sts (ErsatzKompass)+3,r17 |
798 .L19: |
799 0844 8091 0000 lds r24,ErsatzKompass |
800 0848 9091 0000 lds r25,(ErsatzKompass)+1 |
801 084c A091 0000 lds r26,(ErsatzKompass)+2 |
802 0850 B091 0000 lds r27,(ErsatzKompass)+3 |
803 0854 B7FF sbrs r27,7 |
804 0856 00C0 rjmp .L20 |
805 0858 860D add r24,r6 |
806 085a 971D adc r25,r7 |
807 085c A81D adc r26,r8 |
808 085e B91D adc r27,r9 |
809 0860 8093 0000 sts ErsatzKompass,r24 |
810 0864 9093 0000 sts (ErsatzKompass)+1,r25 |
811 0868 A093 0000 sts (ErsatzKompass)+2,r26 |
812 086c B093 0000 sts (ErsatzKompass)+3,r27 |
813 .L20: |
814 0870 288D ldd r18,Y+24 |
815 0872 398D ldd r19,Y+25 |
816 0874 240D add r18,r4 |
817 0876 351D adc r19,r5 |
818 0878 7901 movw r14,r18 |
819 087a 0027 clr r16 |
820 087c F7FC sbrc r15,7 |
821 087e 0095 com r16 |
822 0880 102F mov r17,r16 |
823 0882 8091 0000 lds r24,Mess_IntegralRoll2 |
824 0886 9091 0000 lds r25,(Mess_IntegralRoll2)+1 |
825 088a A091 0000 lds r26,(Mess_IntegralRoll2)+2 |
826 088e B091 0000 lds r27,(Mess_IntegralRoll2)+3 |
827 0892 8E0D add r24,r14 |
828 0894 9F1D adc r25,r15 |
829 0896 A01F adc r26,r16 |
830 0898 B11F adc r27,r17 |
831 089a 8093 0000 sts Mess_IntegralRoll2,r24 |
832 089e 9093 0000 sts (Mess_IntegralRoll2)+1,r25 |
833 08a2 A093 0000 sts (Mess_IntegralRoll2)+2,r26 |
834 08a6 B093 0000 sts (Mess_IntegralRoll2)+3,r27 |
835 08aa 8091 0000 lds r24,LageKorrekturRoll |
836 08ae 9091 0000 lds r25,(LageKorrekturRoll)+1 |
837 08b2 281B sub r18,r24 |
838 08b4 390B sbc r19,r25 |
839 08b6 4427 clr r20 |
840 08b8 37FD sbrc r19,7 |
841 08ba 4095 com r20 |
842 08bc 542F mov r21,r20 |
843 08be 6A89 ldd r22,Y+18 |
844 08c0 7B89 ldd r23,Y+19 |
845 08c2 8C89 ldd r24,Y+20 |
846 08c4 9D89 ldd r25,Y+21 |
847 08c6 260F add r18,r22 |
848 08c8 371F adc r19,r23 |
849 08ca 481F adc r20,r24 |
850 08cc 591F adc r21,r25 |
851 08ce 2093 0000 sts Mess_IntegralRoll,r18 |
852 08d2 3093 0000 sts (Mess_IntegralRoll)+1,r19 |
853 08d6 4093 0000 sts (Mess_IntegralRoll)+2,r20 |
854 08da 5093 0000 sts (Mess_IntegralRoll)+3,r21 |
855 08de E090 0000 lds r14,Umschlag180Roll |
856 08e2 F090 0000 lds r15,(Umschlag180Roll)+1 |
857 08e6 0091 0000 lds r16,(Umschlag180Roll)+2 |
858 08ea 1091 0000 lds r17,(Umschlag180Roll)+3 |
859 08ee E216 cp r14,r18 |
860 08f0 F306 cpc r15,r19 |
861 08f2 0407 cpc r16,r20 |
862 08f4 1507 cpc r17,r21 |
863 08f6 04F4 brge .L21 |
864 08f8 88EA ldi r24,lo8(25000) |
865 08fa 91E6 ldi r25,hi8(25000) |
866 08fc A0E0 ldi r26,hlo8(25000) |
867 08fe B0E0 ldi r27,hhi8(25000) |
868 0900 8E19 sub r24,r14 |
869 0902 9F09 sbc r25,r15 |
870 0904 A00B sbc r26,r16 |
871 0906 B10B sbc r27,r17 |
872 0908 8093 0000 sts Mess_IntegralRoll,r24 |
873 090c 9093 0000 sts (Mess_IntegralRoll)+1,r25 |
874 0910 A093 0000 sts (Mess_IntegralRoll)+2,r26 |
875 0914 B093 0000 sts (Mess_IntegralRoll)+3,r27 |
876 0918 8093 0000 sts Mess_IntegralRoll2,r24 |
877 091c 9093 0000 sts (Mess_IntegralRoll2)+1,r25 |
878 0920 A093 0000 sts (Mess_IntegralRoll2)+2,r26 |
879 0924 B093 0000 sts (Mess_IntegralRoll2)+3,r27 |
880 .L21: |
881 0928 2227 clr r18 |
882 092a 3327 clr r19 |
883 092c A901 movw r20,r18 |
884 092e 2E19 sub r18,r14 |
885 0930 3F09 sbc r19,r15 |
886 0932 400B sbc r20,r16 |
887 0934 510B sbc r21,r17 |
888 0936 8091 0000 lds r24,Mess_IntegralRoll |
889 093a 9091 0000 lds r25,(Mess_IntegralRoll)+1 |
890 093e A091 0000 lds r26,(Mess_IntegralRoll)+2 |
891 0942 B091 0000 lds r27,(Mess_IntegralRoll)+3 |
892 0946 8217 cp r24,r18 |
893 0948 9307 cpc r25,r19 |
894 094a A407 cpc r26,r20 |
895 094c B507 cpc r27,r21 |
896 094e 04F4 brge .L22 |
897 0950 D801 movw r26,r16 |
898 0952 C701 movw r24,r14 |
899 0954 885A subi r24,lo8(-(-25000)) |
900 0956 9146 sbci r25,hi8(-(-25000)) |
901 0958 A040 sbci r26,hlo8(-(-25000)) |
902 095a B040 sbci r27,hhi8(-(-25000)) |
903 095c 8093 0000 sts Mess_IntegralRoll,r24 |
904 0960 9093 0000 sts (Mess_IntegralRoll)+1,r25 |
905 0964 A093 0000 sts (Mess_IntegralRoll)+2,r26 |
906 0968 B093 0000 sts (Mess_IntegralRoll)+3,r27 |
907 096c 8093 0000 sts Mess_IntegralRoll2,r24 |
908 0970 9093 0000 sts (Mess_IntegralRoll2)+1,r25 |
909 0974 A093 0000 sts (Mess_IntegralRoll2)+2,r26 |
910 0978 B093 0000 sts (Mess_IntegralRoll2)+3,r27 |
911 .L22: |
912 097c 2E89 ldd r18,Y+22 |
913 097e 3F89 ldd r19,Y+23 |
914 0980 220D add r18,r2 |
915 0982 331D adc r19,r3 |
916 0984 7901 movw r14,r18 |
917 0986 0027 clr r16 |
918 0988 F7FC sbrc r15,7 |
919 098a 0095 com r16 |
920 098c 102F mov r17,r16 |
921 098e 8091 0000 lds r24,Mess_IntegralNick2 |
922 0992 9091 0000 lds r25,(Mess_IntegralNick2)+1 |
923 0996 A091 0000 lds r26,(Mess_IntegralNick2)+2 |
924 099a B091 0000 lds r27,(Mess_IntegralNick2)+3 |
925 099e 8E0D add r24,r14 |
926 09a0 9F1D adc r25,r15 |
927 09a2 A01F adc r26,r16 |
928 09a4 B11F adc r27,r17 |
929 09a6 8093 0000 sts Mess_IntegralNick2,r24 |
930 09aa 9093 0000 sts (Mess_IntegralNick2)+1,r25 |
931 09ae A093 0000 sts (Mess_IntegralNick2)+2,r26 |
932 09b2 B093 0000 sts (Mess_IntegralNick2)+3,r27 |
933 09b6 8091 0000 lds r24,LageKorrekturNick |
934 09ba 9091 0000 lds r25,(LageKorrekturNick)+1 |
935 09be 281B sub r18,r24 |
936 09c0 390B sbc r19,r25 |
937 09c2 4427 clr r20 |
938 09c4 37FD sbrc r19,7 |
939 09c6 4095 com r20 |
940 09c8 542F mov r21,r20 |
941 09ca 8E85 ldd r24,Y+14 |
942 09cc 9F85 ldd r25,Y+15 |
943 09ce A889 ldd r26,Y+16 |
944 09d0 B989 ldd r27,Y+17 |
945 09d2 280F add r18,r24 |
946 09d4 391F adc r19,r25 |
947 09d6 4A1F adc r20,r26 |
948 09d8 5B1F adc r21,r27 |
949 09da 2093 0000 sts Mess_IntegralNick,r18 |
950 09de 3093 0000 sts (Mess_IntegralNick)+1,r19 |
951 09e2 4093 0000 sts (Mess_IntegralNick)+2,r20 |
952 09e6 5093 0000 sts (Mess_IntegralNick)+3,r21 |
953 09ea E090 0000 lds r14,Umschlag180Nick |
954 09ee F090 0000 lds r15,(Umschlag180Nick)+1 |
955 09f2 0091 0000 lds r16,(Umschlag180Nick)+2 |
956 09f6 1091 0000 lds r17,(Umschlag180Nick)+3 |
957 09fa E216 cp r14,r18 |
958 09fc F306 cpc r15,r19 |
959 09fe 0407 cpc r16,r20 |
960 0a00 1507 cpc r17,r21 |
961 0a02 04F4 brge .L23 |
962 0a04 88EA ldi r24,lo8(25000) |
963 0a06 91E6 ldi r25,hi8(25000) |
964 0a08 A0E0 ldi r26,hlo8(25000) |
965 0a0a B0E0 ldi r27,hhi8(25000) |
966 0a0c 8E19 sub r24,r14 |
967 0a0e 9F09 sbc r25,r15 |
968 0a10 A00B sbc r26,r16 |
969 0a12 B10B sbc r27,r17 |
970 0a14 8093 0000 sts Mess_IntegralNick,r24 |
971 0a18 9093 0000 sts (Mess_IntegralNick)+1,r25 |
972 0a1c A093 0000 sts (Mess_IntegralNick)+2,r26 |
973 0a20 B093 0000 sts (Mess_IntegralNick)+3,r27 |
974 0a24 8093 0000 sts Mess_IntegralNick2,r24 |
975 0a28 9093 0000 sts (Mess_IntegralNick2)+1,r25 |
976 0a2c A093 0000 sts (Mess_IntegralNick2)+2,r26 |
977 0a30 B093 0000 sts (Mess_IntegralNick2)+3,r27 |
978 .L23: |
979 0a34 2227 clr r18 |
980 0a36 3327 clr r19 |
981 0a38 A901 movw r20,r18 |
982 0a3a 2E19 sub r18,r14 |
983 0a3c 3F09 sbc r19,r15 |
984 0a3e 400B sbc r20,r16 |
985 0a40 510B sbc r21,r17 |
986 0a42 8091 0000 lds r24,Mess_IntegralNick |
987 0a46 9091 0000 lds r25,(Mess_IntegralNick)+1 |
988 0a4a A091 0000 lds r26,(Mess_IntegralNick)+2 |
989 0a4e B091 0000 lds r27,(Mess_IntegralNick)+3 |
990 0a52 8217 cp r24,r18 |
991 0a54 9307 cpc r25,r19 |
992 0a56 A407 cpc r26,r20 |
993 0a58 B507 cpc r27,r21 |
994 0a5a 04F4 brge .L24 |
995 0a5c D801 movw r26,r16 |
996 0a5e C701 movw r24,r14 |
997 0a60 885A subi r24,lo8(-(-25000)) |
998 0a62 9146 sbci r25,hi8(-(-25000)) |
999 0a64 A040 sbci r26,hlo8(-(-25000)) |
1000 0a66 B040 sbci r27,hhi8(-(-25000)) |
1001 0a68 8093 0000 sts Mess_IntegralNick,r24 |
1002 0a6c 9093 0000 sts (Mess_IntegralNick)+1,r25 |
1003 0a70 A093 0000 sts (Mess_IntegralNick)+2,r26 |
1004 0a74 B093 0000 sts (Mess_IntegralNick)+3,r27 |
1005 0a78 8093 0000 sts Mess_IntegralNick2,r24 |
1006 0a7c 9093 0000 sts (Mess_IntegralNick2)+1,r25 |
1007 0a80 A093 0000 sts (Mess_IntegralNick2)+2,r26 |
1008 0a84 B093 0000 sts (Mess_IntegralNick2)+3,r27 |
1009 .L24: |
1010 0a88 8091 0000 lds r24,Mess_Integral_Gier |
1011 0a8c 9091 0000 lds r25,(Mess_Integral_Gier)+1 |
1012 0a90 A091 0000 lds r26,(Mess_Integral_Gier)+2 |
1013 0a94 B091 0000 lds r27,(Mess_Integral_Gier)+3 |
1014 0a98 8093 0000 sts Integral_Gier,r24 |
1015 0a9c 9093 0000 sts (Integral_Gier)+1,r25 |
1016 0aa0 A093 0000 sts (Integral_Gier)+2,r26 |
1017 0aa4 B093 0000 sts (Integral_Gier)+3,r27 |
1018 0aa8 8091 0000 lds r24,Mess_IntegralNick |
1019 0aac 9091 0000 lds r25,(Mess_IntegralNick)+1 |
1020 0ab0 A091 0000 lds r26,(Mess_IntegralNick)+2 |
1021 0ab4 B091 0000 lds r27,(Mess_IntegralNick)+3 |
1022 0ab8 8093 0000 sts IntegralNick,r24 |
1023 0abc 9093 0000 sts (IntegralNick)+1,r25 |
1024 0ac0 A093 0000 sts (IntegralNick)+2,r26 |
1025 0ac4 B093 0000 sts (IntegralNick)+3,r27 |
1026 0ac8 8091 0000 lds r24,Mess_IntegralRoll |
1027 0acc 9091 0000 lds r25,(Mess_IntegralRoll)+1 |
1028 0ad0 A091 0000 lds r26,(Mess_IntegralRoll)+2 |
1029 0ad4 B091 0000 lds r27,(Mess_IntegralRoll)+3 |
1030 0ad8 8093 0000 sts IntegralRoll,r24 |
1031 0adc 9093 0000 sts (IntegralRoll)+1,r25 |
1032 0ae0 A093 0000 sts (IntegralRoll)+2,r26 |
1033 0ae4 B093 0000 sts (IntegralRoll)+3,r27 |
1034 0ae8 8091 0000 lds r24,Mess_IntegralNick2 |
1035 0aec 9091 0000 lds r25,(Mess_IntegralNick2)+1 |
1036 0af0 A091 0000 lds r26,(Mess_IntegralNick2)+2 |
1037 0af4 B091 0000 lds r27,(Mess_IntegralNick2)+3 |
1038 0af8 8093 0000 sts IntegralNick2,r24 |
1039 0afc 9093 0000 sts (IntegralNick2)+1,r25 |
1040 0b00 A093 0000 sts (IntegralNick2)+2,r26 |
1041 0b04 B093 0000 sts (IntegralNick2)+3,r27 |
1042 0b08 8091 0000 lds r24,Mess_IntegralRoll2 |
1043 0b0c 9091 0000 lds r25,(Mess_IntegralRoll2)+1 |
1044 0b10 A091 0000 lds r26,(Mess_IntegralRoll2)+2 |
1045 0b14 B091 0000 lds r27,(Mess_IntegralRoll2)+3 |
1046 0b18 8093 0000 sts IntegralRoll2,r24 |
1047 0b1c 9093 0000 sts (IntegralRoll2)+1,r25 |
1048 0b20 A093 0000 sts (IntegralRoll2)+2,r26 |
1049 0b24 B093 0000 sts (IntegralRoll2)+3,r27 |
1050 0b28 8091 0000 lds r24,HiResNick |
1051 0b2c 9091 0000 lds r25,(HiResNick)+1 |
1052 0b30 68E0 ldi r22,lo8(8) |
1053 0b32 70E0 ldi r23,hi8(8) |
1054 0b34 0E94 0000 call __divmodhi4 |
1055 0b38 7093 0000 sts (MesswertNick)+1,r23 |
1056 0b3c 6093 0000 sts MesswertNick,r22 |
1057 0b40 8091 0000 lds r24,HiResRoll |
1058 0b44 9091 0000 lds r25,(HiResRoll)+1 |
1059 0b48 68E0 ldi r22,lo8(8) |
1060 0b4a 70E0 ldi r23,hi8(8) |
1061 0b4c 0E94 0000 call __divmodhi4 |
1062 0b50 7093 0000 sts (MesswertRoll)+1,r23 |
1063 0b54 6093 0000 sts MesswertRoll,r22 |
1064 0b58 8091 0000 lds r24,AdWertNick |
1065 0b5c 9091 0000 lds r25,(AdWertNick)+1 |
1066 0b60 0F97 sbiw r24,15 |
1067 0b62 04F4 brge .L25 |
1068 0b64 88E1 ldi r24,lo8(-1000) |
1069 0b66 9CEF ldi r25,hi8(-1000) |
1070 0b68 9093 0000 sts (MesswertNick)+1,r25 |
1071 0b6c 8093 0000 sts MesswertNick,r24 |
1072 .L25: |
1073 0b70 8091 0000 lds r24,AdWertNick |
1074 0b74 9091 0000 lds r25,(AdWertNick)+1 |
1075 0b78 0797 sbiw r24,7 |
1076 0b7a 04F4 brge .L26 |
1077 0b7c 80E3 ldi r24,lo8(-2000) |
1078 0b7e 98EF ldi r25,hi8(-2000) |
1079 0b80 9093 0000 sts (MesswertNick)+1,r25 |
1080 0b84 8093 0000 sts MesswertNick,r24 |
1081 .L26: |
1082 0b88 2091 0000 lds r18,PlatinenVersion |
1083 0b8c 2A30 cpi r18,lo8(10) |
1084 0b8e 01F4 brne .L27 |
1085 0b90 8091 0000 lds r24,AdWertNick |
1086 0b94 9091 0000 lds r25,(AdWertNick)+1 |
1087 0b98 835F subi r24,lo8(1011) |
1088 0b9a 9340 sbci r25,hi8(1011) |
1089 0b9c 04F0 brlt .L28 |
1090 0b9e 88EE ldi r24,lo8(1000) |
1091 0ba0 93E0 ldi r25,hi8(1000) |
1092 0ba2 9093 0000 sts (MesswertNick)+1,r25 |
1093 0ba6 8093 0000 sts MesswertNick,r24 |
1094 .L28: |
1095 0baa 8091 0000 lds r24,AdWertNick |
1096 0bae 9091 0000 lds r25,(AdWertNick)+1 |
1097 0bb2 8A5F subi r24,lo8(1018) |
1098 0bb4 9340 sbci r25,hi8(1018) |
1099 0bb6 04F0 brlt .L29 |
1100 0bb8 00C0 rjmp .L62 |
1101 .L27: |
1102 0bba 8091 0000 lds r24,AdWertNick |
1103 0bbe 9091 0000 lds r25,(AdWertNick)+1 |
1104 0bc2 815D subi r24,lo8(2001) |
1105 0bc4 9740 sbci r25,hi8(2001) |
1106 0bc6 04F0 brlt .L30 |
1107 0bc8 88EE ldi r24,lo8(1000) |
1108 0bca 93E0 ldi r25,hi8(1000) |
1109 0bcc 9093 0000 sts (MesswertNick)+1,r25 |
1110 0bd0 8093 0000 sts MesswertNick,r24 |
1111 .L30: |
1112 0bd4 8091 0000 lds r24,AdWertNick |
1113 0bd8 9091 0000 lds r25,(AdWertNick)+1 |
1114 0bdc 805E subi r24,lo8(2016) |
1115 0bde 9740 sbci r25,hi8(2016) |
1116 0be0 04F0 brlt .L29 |
1117 .L62: |
1118 0be2 80ED ldi r24,lo8(2000) |
1119 0be4 97E0 ldi r25,hi8(2000) |
1120 0be6 9093 0000 sts (MesswertNick)+1,r25 |
1121 0bea 8093 0000 sts MesswertNick,r24 |
1122 .L29: |
1123 0bee 8091 0000 lds r24,AdWertRoll |
1124 0bf2 9091 0000 lds r25,(AdWertRoll)+1 |
1125 0bf6 0F97 sbiw r24,15 |
1126 0bf8 04F4 brge .L31 |
1127 0bfa 88E1 ldi r24,lo8(-1000) |
1128 0bfc 9CEF ldi r25,hi8(-1000) |
1129 0bfe 9093 0000 sts (MesswertRoll)+1,r25 |
1130 0c02 8093 0000 sts MesswertRoll,r24 |
1131 .L31: |
1132 0c06 8091 0000 lds r24,AdWertRoll |
1133 0c0a 9091 0000 lds r25,(AdWertRoll)+1 |
1134 0c0e 0797 sbiw r24,7 |
1135 0c10 04F4 brge .L32 |
1136 0c12 80E3 ldi r24,lo8(-2000) |
1137 0c14 98EF ldi r25,hi8(-2000) |
1138 0c16 9093 0000 sts (MesswertRoll)+1,r25 |
1139 0c1a 8093 0000 sts MesswertRoll,r24 |
1140 .L32: |
1141 0c1e 2A30 cpi r18,lo8(10) |
1142 0c20 01F4 brne .L33 |
1143 0c22 8091 0000 lds r24,AdWertRoll |
1144 0c26 9091 0000 lds r25,(AdWertRoll)+1 |
1145 0c2a 835F subi r24,lo8(1011) |
1146 0c2c 9340 sbci r25,hi8(1011) |
1147 0c2e 04F0 brlt .L34 |
1148 0c30 88EE ldi r24,lo8(1000) |
1149 0c32 93E0 ldi r25,hi8(1000) |
1150 0c34 9093 0000 sts (MesswertRoll)+1,r25 |
1151 0c38 8093 0000 sts MesswertRoll,r24 |
1152 .L34: |
1153 0c3c 8091 0000 lds r24,AdWertRoll |
1154 0c40 9091 0000 lds r25,(AdWertRoll)+1 |
1155 0c44 8A5F subi r24,lo8(1018) |
1156 0c46 9340 sbci r25,hi8(1018) |
1157 0c48 04F0 brlt .L35 |
1158 0c4a 00C0 rjmp .L63 |
1159 .L33: |
1160 0c4c 8091 0000 lds r24,AdWertRoll |
1161 0c50 9091 0000 lds r25,(AdWertRoll)+1 |
1162 0c54 815D subi r24,lo8(2001) |
1163 0c56 9740 sbci r25,hi8(2001) |
1164 0c58 04F0 brlt .L36 |
1165 0c5a 88EE ldi r24,lo8(1000) |
1166 0c5c 93E0 ldi r25,hi8(1000) |
1167 0c5e 9093 0000 sts (MesswertRoll)+1,r25 |
1168 0c62 8093 0000 sts MesswertRoll,r24 |
1169 .L36: |
1170 0c66 8091 0000 lds r24,AdWertRoll |
1171 0c6a 9091 0000 lds r25,(AdWertRoll)+1 |
1172 0c6e 805E subi r24,lo8(2016) |
1173 0c70 9740 sbci r25,hi8(2016) |
1174 0c72 04F0 brlt .L35 |
1175 .L63: |
1176 0c74 80ED ldi r24,lo8(2000) |
1177 0c76 97E0 ldi r25,hi8(2000) |
1178 0c78 9093 0000 sts (MesswertRoll)+1,r25 |
1179 0c7c 8093 0000 sts MesswertRoll,r24 |
1180 .L35: |
1181 0c80 4091 0000 lds r20,Parameter_Gyro_D |
1182 0c84 4423 tst r20 |
1183 0c86 01F4 brne .+2 |
1184 0c88 00C0 rjmp .L37 |
1185 0c8a E091 0000 lds r30,HiResNick |
1186 0c8e F091 0000 lds r31,(HiResNick)+1 |
1187 0c92 2091 0000 lds r18,oldNick.2604 |
1188 0c96 3091 0000 lds r19,(oldNick.2604)+1 |
1189 0c9a E21B sub r30,r18 |
1190 0c9c F30B sbc r31,r19 |
1191 0c9e F093 0000 sts (d2Nick.2607)+1,r31 |
1192 0ca2 E093 0000 sts d2Nick.2607,r30 |
1193 0ca6 8091 0000 lds r24,HiResNick |
1194 0caa 9091 0000 lds r25,(HiResNick)+1 |
1195 0cae 820F add r24,r18 |
1196 0cb0 931F adc r25,r19 |
1197 0cb2 62E0 ldi r22,lo8(2) |
1198 0cb4 70E0 ldi r23,hi8(2) |
1199 0cb6 0E94 0000 call __divmodhi4 |
1200 0cba 7093 0000 sts (oldNick.2604)+1,r23 |
1201 0cbe 6093 0000 sts oldNick.2604,r22 |
1202 0cc2 E138 cpi r30,129 |
1203 0cc4 F105 cpc r31,__zero_reg__ |
1204 0cc6 04F0 brlt .L38 |
1205 0cc8 80E8 ldi r24,lo8(128) |
1206 0cca 90E0 ldi r25,hi8(128) |
1207 0ccc 00C0 rjmp .L64 |
1208 .L38: |
1209 0cce E058 subi r30,lo8(-128) |
1210 0cd0 FF4F sbci r31,hi8(-128) |
1211 0cd2 04F4 brge .L39 |
1212 0cd4 80E8 ldi r24,lo8(-128) |
1213 0cd6 9FEF ldi r25,hi8(-128) |
1214 .L64: |
1215 0cd8 9093 0000 sts (d2Nick.2607)+1,r25 |
1216 0cdc 8093 0000 sts d2Nick.2607,r24 |
1217 .L39: |
1218 0ce0 042F mov r16,r20 |
1219 0ce2 10E0 ldi r17,lo8(0) |
1220 0ce4 8091 0000 lds r24,d2Nick.2607 |
1221 0ce8 9091 0000 lds r25,(d2Nick.2607)+1 |
1222 0cec 089F mul r16,r24 |
1223 0cee 7001 movw r14,r0 |
1224 0cf0 099F mul r16,r25 |
1225 0cf2 F00C add r15,r0 |
1226 0cf4 189F mul r17,r24 |
1227 0cf6 F00C add r15,r0 |
1228 0cf8 1124 clr r1 |
1229 0cfa C701 movw r24,r14 |
1230 0cfc 60E1 ldi r22,lo8(16) |
1231 0cfe 70E0 ldi r23,hi8(16) |
1232 0d00 0E94 0000 call __divmodhi4 |
1233 0d04 8091 0000 lds r24,MesswertNick |
1234 0d08 9091 0000 lds r25,(MesswertNick)+1 |
1235 0d0c 860F add r24,r22 |
1236 0d0e 971F adc r25,r23 |
1237 0d10 9093 0000 sts (MesswertNick)+1,r25 |
1238 0d14 8093 0000 sts MesswertNick,r24 |
1239 0d18 E091 0000 lds r30,HiResRoll |
1240 0d1c F091 0000 lds r31,(HiResRoll)+1 |
1241 0d20 2091 0000 lds r18,oldRoll.2605 |
1242 0d24 3091 0000 lds r19,(oldRoll.2605)+1 |
1243 0d28 E21B sub r30,r18 |
1244 0d2a F30B sbc r31,r19 |
1245 0d2c F093 0000 sts (d2Roll.2606)+1,r31 |
1246 0d30 E093 0000 sts d2Roll.2606,r30 |
1247 0d34 8091 0000 lds r24,HiResRoll |
1248 0d38 9091 0000 lds r25,(HiResRoll)+1 |
1249 0d3c 820F add r24,r18 |
1250 0d3e 931F adc r25,r19 |
1251 0d40 62E0 ldi r22,lo8(2) |
1252 0d42 70E0 ldi r23,hi8(2) |
1253 0d44 0E94 0000 call __divmodhi4 |
1254 0d48 7093 0000 sts (oldRoll.2605)+1,r23 |
1255 0d4c 6093 0000 sts oldRoll.2605,r22 |
1256 0d50 E138 cpi r30,129 |
1257 0d52 F105 cpc r31,__zero_reg__ |
1258 0d54 04F0 brlt .L40 |
1259 0d56 80E8 ldi r24,lo8(128) |
1260 0d58 90E0 ldi r25,hi8(128) |
1261 0d5a 00C0 rjmp .L65 |
1262 .L40: |
1263 0d5c E058 subi r30,lo8(-128) |
1264 0d5e FF4F sbci r31,hi8(-128) |
1265 0d60 04F4 brge .L41 |
1266 0d62 80E8 ldi r24,lo8(-128) |
1267 0d64 9FEF ldi r25,hi8(-128) |
1268 .L65: |
1269 0d66 9093 0000 sts (d2Roll.2606)+1,r25 |
1270 0d6a 8093 0000 sts d2Roll.2606,r24 |
1271 .L41: |
1272 0d6e 8091 0000 lds r24,d2Roll.2606 |
1273 0d72 9091 0000 lds r25,(d2Roll.2606)+1 |
1274 0d76 089F mul r16,r24 |
1275 0d78 9001 movw r18,r0 |
1276 0d7a 099F mul r16,r25 |
1277 0d7c 300D add r19,r0 |
1278 0d7e 189F mul r17,r24 |
1279 0d80 300D add r19,r0 |
1280 0d82 1124 clr r1 |
1281 0d84 C901 movw r24,r18 |
1282 0d86 60E1 ldi r22,lo8(16) |
1283 0d88 70E0 ldi r23,hi8(16) |
1284 0d8a 0E94 0000 call __divmodhi4 |
1285 0d8e 8091 0000 lds r24,MesswertRoll |
1286 0d92 9091 0000 lds r25,(MesswertRoll)+1 |
1287 0d96 860F add r24,r22 |
1288 0d98 971F adc r25,r23 |
1289 0d9a 9093 0000 sts (MesswertRoll)+1,r25 |
1290 0d9e 8093 0000 sts MesswertRoll,r24 |
1291 0da2 8091 0000 lds r24,HiResNick |
1292 0da6 9091 0000 lds r25,(HiResNick)+1 |
1293 0daa E80E add r14,r24 |
1294 0dac F91E adc r15,r25 |
1295 0dae F092 0000 sts (HiResNick)+1,r15 |
1296 0db2 E092 0000 sts HiResNick,r14 |
1297 0db6 8091 0000 lds r24,HiResRoll |
1298 0dba 9091 0000 lds r25,(HiResRoll)+1 |
1299 0dbe 280F add r18,r24 |
1300 0dc0 391F adc r19,r25 |
1301 0dc2 3093 0000 sts (HiResRoll)+1,r19 |
1302 0dc6 2093 0000 sts HiResRoll,r18 |
1303 .L37: |
1304 0dca 2091 0000 lds r18,KopplungsteilNickRoll |
1305 0dce 3091 0000 lds r19,KopplungsteilNickRoll+1 |
1306 0dd2 888D ldd r24,Y+24 |
1307 0dd4 998D ldd r25,Y+25 |
1308 0dd6 1816 cp __zero_reg__,r24 |
1309 0dd8 1906 cpc __zero_reg__,r25 |
1310 0dda 04F4 brge .L42 |
1311 0ddc C901 movw r24,r18 |
1312 0dde 9C01 movw r18,r24 |
1313 0de0 97FF sbrs r25,7 |
1314 0de2 00C0 rjmp .L43 |
1315 0de4 3095 com r19 |
1316 0de6 2195 neg r18 |
1317 0de8 3F4F sbci r19,lo8(-1) |
1318 .L43: |
1319 0dea B901 movw r22,r18 |
1320 0dec 8827 clr r24 |
1321 0dee 77FD sbrc r23,7 |
1322 0df0 8095 com r24 |
1323 0df2 982F mov r25,r24 |
1324 0df4 2091 0000 lds r18,Parameter_CouplingYawCorrection |
1325 0df8 30E0 ldi r19,lo8(0) |
1326 0dfa 40E0 ldi r20,lo8(0) |
1327 0dfc 50E0 ldi r21,hi8(0) |
1328 0dfe 0E94 0000 call __mulsi3 |
1329 0e02 20E4 ldi r18,lo8(64) |
1330 0e04 30E0 ldi r19,hi8(64) |
1331 0e06 40E0 ldi r20,hlo8(64) |
1332 0e08 50E0 ldi r21,hhi8(64) |
1333 0e0a 0E94 0000 call __divmodsi4 |
1334 0e0e 00C0 rjmp .L66 |
1335 .L42: |
1336 0e10 C901 movw r24,r18 |
1337 0e12 9C01 movw r18,r24 |
1338 0e14 97FF sbrs r25,7 |
1339 0e16 00C0 rjmp .L45 |
1340 0e18 3095 com r19 |
1341 0e1a 2195 neg r18 |
1342 0e1c 3F4F sbci r19,lo8(-1) |
1343 .L45: |
1344 0e1e B901 movw r22,r18 |
1345 0e20 8827 clr r24 |
1346 0e22 77FD sbrc r23,7 |
1347 0e24 8095 com r24 |
1348 0e26 982F mov r25,r24 |
1349 0e28 2091 0000 lds r18,Parameter_CouplingYawCorrection |
1350 0e2c 30E0 ldi r19,lo8(0) |
1351 0e2e 40E0 ldi r20,lo8(0) |
1352 0e30 50E0 ldi r21,hi8(0) |
1353 0e32 0E94 0000 call __mulsi3 |
1354 0e36 20E4 ldi r18,lo8(64) |
1355 0e38 30E0 ldi r19,hi8(64) |
1356 0e3a 40E0 ldi r20,hlo8(64) |
1357 0e3c 50E0 ldi r21,hhi8(64) |
1358 0e3e 0E94 0000 call __divmodsi4 |
1359 0e42 5095 com r21 |
1360 0e44 4095 com r20 |
1361 0e46 3095 com r19 |
1362 0e48 2195 neg r18 |
1363 0e4a 3F4F sbci r19,lo8(-1) |
1364 0e4c 4F4F sbci r20,lo8(-1) |
1365 0e4e 5F4F sbci r21,lo8(-1) |
1366 .L66: |
1367 0e50 420E add r4,r18 |
1368 0e52 531E adc r5,r19 |
1369 0e54 5092 0000 sts (TrimRoll)+1,r5 |
1370 0e58 4092 0000 sts TrimRoll,r4 |
1371 0e5c 2091 0000 lds r18,KopplungsteilRollNick |
1372 0e60 3091 0000 lds r19,KopplungsteilRollNick+1 |
1373 0e64 AE89 ldd r26,Y+22 |
1374 0e66 BF89 ldd r27,Y+23 |
1375 0e68 1A16 cp __zero_reg__,r26 |
1376 0e6a 1B06 cpc __zero_reg__,r27 |
1377 0e6c 04F4 brge .L46 |
1378 0e6e C901 movw r24,r18 |
1379 0e70 9C01 movw r18,r24 |
1380 0e72 97FF sbrs r25,7 |
1381 0e74 00C0 rjmp .L47 |
1382 0e76 3095 com r19 |
1383 0e78 2195 neg r18 |
1384 0e7a 3F4F sbci r19,lo8(-1) |
1385 .L47: |
1386 0e7c B901 movw r22,r18 |
1387 0e7e 8827 clr r24 |
1388 0e80 77FD sbrc r23,7 |
1389 0e82 8095 com r24 |
1390 0e84 982F mov r25,r24 |
1391 0e86 2091 0000 lds r18,Parameter_CouplingYawCorrection |
1392 0e8a 30E0 ldi r19,lo8(0) |
1393 0e8c 40E0 ldi r20,lo8(0) |
1394 0e8e 50E0 ldi r21,hi8(0) |
1395 0e90 0E94 0000 call __mulsi3 |
1396 0e94 20E4 ldi r18,lo8(64) |
1397 0e96 30E0 ldi r19,hi8(64) |
1398 0e98 40E0 ldi r20,hlo8(64) |
1399 0e9a 50E0 ldi r21,hhi8(64) |
1400 0e9c 0E94 0000 call __divmodsi4 |
1401 0ea0 00C0 rjmp .L67 |
1402 .L46: |
1403 0ea2 C901 movw r24,r18 |
1404 0ea4 9C01 movw r18,r24 |
1405 0ea6 97FF sbrs r25,7 |
1406 0ea8 00C0 rjmp .L49 |
1407 0eaa 3095 com r19 |
1408 0eac 2195 neg r18 |
1409 0eae 3F4F sbci r19,lo8(-1) |
1410 .L49: |
1411 0eb0 B901 movw r22,r18 |
1412 0eb2 8827 clr r24 |
1413 0eb4 77FD sbrc r23,7 |
1414 0eb6 8095 com r24 |
1415 0eb8 982F mov r25,r24 |
1416 0eba 2091 0000 lds r18,Parameter_CouplingYawCorrection |
1417 0ebe 30E0 ldi r19,lo8(0) |
1418 0ec0 40E0 ldi r20,lo8(0) |
1419 0ec2 50E0 ldi r21,hi8(0) |
1420 0ec4 0E94 0000 call __mulsi3 |
1421 0ec8 20E4 ldi r18,lo8(64) |
1422 0eca 30E0 ldi r19,hi8(64) |
1423 0ecc 40E0 ldi r20,hlo8(64) |
1424 0ece 50E0 ldi r21,hhi8(64) |
1425 0ed0 0E94 0000 call __divmodsi4 |
1426 0ed4 5095 com r21 |
1427 0ed6 4095 com r20 |
1428 0ed8 3095 com r19 |
1429 0eda 2195 neg r18 |
1430 0edc 3F4F sbci r19,lo8(-1) |
1431 0ede 4F4F sbci r20,lo8(-1) |
1432 0ee0 5F4F sbci r21,lo8(-1) |
1433 .L67: |
1434 0ee2 220E add r2,r18 |
1435 0ee4 331E adc r3,r19 |
1436 0ee6 3092 0000 sts (TrimNick)+1,r3 |
1437 0eea 2092 0000 sts TrimNick,r2 |
1438 0eee 8091 0000 lds r24,EE_Parameter+13 |
1439 0ef2 87FF sbrs r24,7 |
1440 0ef4 00C0 rjmp .L50 |
1441 0ef6 B985 ldd r27,Y+9 |
1442 0ef8 BB23 tst r27 |
1443 0efa 01F0 breq .L51 |
1444 .L50: |
1445 0efc 20E0 ldi r18,lo8(EE_Parameter+5) |
1446 0efe 30E0 ldi r19,hi8(EE_Parameter+5) |
1447 0f00 00E0 ldi r16,lo8(Poti) |
1448 0f02 10E0 ldi r17,hi8(Poti) |
1449 0f04 00C0 rjmp .L52 |
1450 .L51: |
1451 0f06 8091 0000 lds r24,Looping_Roll |
1452 0f0a 8823 tst r24 |
1453 0f0c 01F4 brne .L50 |
1454 0f0e EE89 ldd r30,Y+22 |
1455 0f10 FF89 ldd r31,Y+23 |
1456 0f12 21E0 ldi r18,hi8(257) |
1457 0f14 E130 cpi r30,lo8(257) |
1458 0f16 F207 cpc r31,r18 |
1459 0f18 04F0 brlt .L53 |
1460 0f1a 8091 0000 lds r24,MesswertNick |
1461 0f1e 9091 0000 lds r25,(MesswertNick)+1 |
1462 0f22 8050 subi r24,lo8(-(-256)) |
1463 0f24 9140 sbci r25,hi8(-(-256)) |
1464 0f26 8E0F add r24,r30 |
1465 0f28 9F1F adc r25,r31 |
1466 0f2a 00C0 rjmp .L69 |
1467 .L53: |
1468 0f2c 4E89 ldd r20,Y+22 |
1469 0f2e 5F89 ldd r21,Y+23 |
1470 0f30 6FEF ldi r22,hi8(-256) |
1471 0f32 4030 cpi r20,lo8(-256) |
1472 0f34 5607 cpc r21,r22 |
1473 0f36 04F4 brge .L54 |
1474 0f38 8091 0000 lds r24,MesswertNick |
1475 0f3c 9091 0000 lds r25,(MesswertNick)+1 |
1476 0f40 8050 subi r24,lo8(-(256)) |
1477 0f42 9F4F sbci r25,hi8(-(256)) |
1478 0f44 840F add r24,r20 |
1479 0f46 951F adc r25,r21 |
1480 .L69: |
1481 0f48 9093 0000 sts (MesswertNick)+1,r25 |
1482 0f4c 8093 0000 sts MesswertNick,r24 |
1483 .L54: |
1484 0f50 888D ldd r24,Y+24 |
1485 0f52 998D ldd r25,Y+25 |
1486 0f54 8150 subi r24,lo8(257) |
1487 0f56 9140 sbci r25,hi8(257) |
1488 0f58 04F0 brlt .L55 |
1489 0f5a 8091 0000 lds r24,MesswertRoll |
1490 0f5e 9091 0000 lds r25,(MesswertRoll)+1 |
1491 0f62 8050 subi r24,lo8(-(-256)) |
1492 0f64 9140 sbci r25,hi8(-(-256)) |
1493 0f66 E88D ldd r30,Y+24 |
1494 0f68 F98D ldd r31,Y+25 |
1495 0f6a 8E0F add r24,r30 |
1496 0f6c 9F1F adc r25,r31 |
1497 0f6e 00C0 rjmp .L68 |
1498 .L55: |
1499 0f70 288D ldd r18,Y+24 |
1500 0f72 398D ldd r19,Y+25 |
1501 0f74 4FEF ldi r20,hi8(-256) |
1502 0f76 2030 cpi r18,lo8(-256) |
1503 0f78 3407 cpc r19,r20 |
1504 0f7a 04F0 brlt .+2 |
1505 0f7c 00C0 rjmp .L50 |
1506 0f7e 8091 0000 lds r24,MesswertRoll |
1507 0f82 9091 0000 lds r25,(MesswertRoll)+1 |
1508 0f86 8050 subi r24,lo8(-(256)) |
1509 0f88 9F4F sbci r25,hi8(-(256)) |
1510 0f8a 820F add r24,r18 |
1511 0f8c 931F adc r25,r19 |
1512 .L68: |
1513 0f8e 9093 0000 sts (MesswertRoll)+1,r25 |
1514 0f92 8093 0000 sts MesswertRoll,r24 |
1515 0f96 00C0 rjmp .L50 |
1516 .L52: |
1517 0f98 D901 movw r26,r18 |
1518 0f9a EC91 ld r30,X |
1519 0f9c F0E0 ldi r31,lo8(0) |
1520 0f9e EE0F lsl r30 |
1521 0fa0 FF1F rol r31 |
1522 0fa2 E050 subi r30,lo8(-(PPM_in)) |
1523 0fa4 F040 sbci r31,hi8(-(PPM_in)) |
1524 0fa6 8081 ld r24,Z |
1525 0fa8 9181 ldd r25,Z+1 |
1526 0faa 8259 subi r24,lo8(-(110)) |
1527 0fac 9F4F sbci r25,hi8(-(110)) |
1528 0fae 97FF sbrs r25,7 |
1529 0fb0 00C0 rjmp .L56 |
1530 0fb2 80E0 ldi r24,lo8(0) |
1531 0fb4 90E0 ldi r25,hi8(0) |
1532 .L56: |
1533 0fb6 FC01 movw r30,r24 |
1534 0fb8 8F3F cpi r24,255 |
1535 0fba 9105 cpc r25,__zero_reg__ |
1536 0fbc 01F0 breq .L57 |
1537 0fbe 04F0 brlt .L57 |
1538 0fc0 EFEF ldi r30,lo8(255) |
1539 0fc2 F0E0 ldi r31,hi8(255) |
1540 .L57: |
1541 0fc4 D801 movw r26,r16 |
1542 0fc6 4C91 ld r20,X |
1543 0fc8 842F mov r24,r20 |
1544 0fca 90E0 ldi r25,lo8(0) |
1545 0fcc E817 cp r30,r24 |
1546 0fce F907 cpc r31,r25 |
1547 0fd0 01F0 breq .L58 |
1548 0fd2 BF01 movw r22,r30 |
1549 0fd4 681B sub r22,r24 |
1550 0fd6 790B sbc r23,r25 |
1551 0fd8 CB01 movw r24,r22 |
1552 0fda 68E0 ldi r22,lo8(8) |
1553 0fdc 70E0 ldi r23,hi8(8) |
1554 0fde 0E94 0000 call __divmodhi4 |
1555 0fe2 640F add r22,r20 |
1556 0fe4 D801 movw r26,r16 |
1557 0fe6 6C93 st X,r22 |
1558 0fe8 862F mov r24,r22 |
1559 0fea 90E0 ldi r25,lo8(0) |
1560 0fec E817 cp r30,r24 |
1561 0fee F907 cpc r31,r25 |
1562 0ff0 04F4 brge .L59 |
1563 0ff2 6150 subi r22,lo8(-(-1)) |
1564 0ff4 6C93 st X,r22 |
1565 0ff6 00C0 rjmp .L58 |
1566 .L59: |
1567 0ff8 6F5F subi r22,lo8(-(1)) |
1568 0ffa F801 movw r30,r16 |
1569 0ffc 6083 st Z,r22 |
1570 .L58: |
1571 0ffe 2F5F subi r18,lo8(-(1)) |
1572 1000 3F4F sbci r19,hi8(-(1)) |
1573 1002 0F5F subi r16,lo8(-(1)) |
1574 1004 1F4F sbci r17,hi8(-(1)) |
1575 1006 F0E0 ldi r31,hi8(EE_Parameter+13) |
1576 1008 2030 cpi r18,lo8(EE_Parameter+13) |
1577 100a 3F07 cpc r19,r31 |
1578 100c 01F4 brne .L52 |
1579 /* epilogue start */ |
1580 100e 6B96 adiw r28,27 |
1581 1010 E2E1 ldi r30, lo8(18) |
1582 1012 0C94 0000 jmp __epilogue_restores__ + ((18 - 18) * 2) |
1584 .global SendMotorData |
1586 SendMotorData: |
1587 /* prologue: function */ |
1588 /* frame size = 0 */ |
1589 1016 8091 0000 lds r24,MotorenEin |
1590 101a 8823 tst r24 |
1591 101c 01F4 brne .L71 |
1592 101e 8091 0000 lds r24,FCFlags |
1593 1022 8C7F andi r24,lo8(-4) |
1594 1024 8093 0000 sts FCFlags,r24 |
1595 1028 A0E0 ldi r26,lo8(MotorTest) |
1596 102a B0E0 ldi r27,hi8(MotorTest) |
1597 102c E0E0 ldi r30,lo8(Motor+1) |
1598 102e F0E0 ldi r31,hi8(Motor+1) |
1599 .L73: |
1600 1030 8091 0000 lds r24,PC_MotortestActive |
1601 1034 8823 tst r24 |
1602 1036 01F4 brne .L72 |
1603 1038 1C92 st X,__zero_reg__ |
1604 .L72: |
1605 103a 8D91 ld r24,X+ |
1606 103c 8083 st Z,r24 |
1607 103e 1182 std Z+1,__zero_reg__ |
1608 1040 3896 adiw r30,8 |
1609 1042 80E0 ldi r24,hi8(MotorTest+12) |
1610 1044 A030 cpi r26,lo8(MotorTest+12) |
1611 1046 B807 cpc r27,r24 |
1612 1048 01F4 brne .L73 |
1613 104a 8091 0000 lds r24,PC_MotortestActive |
1614 104e 8823 tst r24 |
1615 1050 01F0 breq .L74 |
1616 1052 8091 0000 lds r24,PC_MotortestActive |
1617 1056 8150 subi r24,lo8(-(-1)) |
1618 1058 8093 0000 sts PC_MotortestActive,r24 |
1619 105c 00C0 rjmp .L74 |
1620 .L71: |
1621 105e 8091 0000 lds r24,FCFlags |
1622 1062 8160 ori r24,lo8(1) |
1623 1064 8093 0000 sts FCFlags,r24 |
1624 .L74: |
1625 1068 1092 0000 sts motor_write,__zero_reg__ |
1626 106c 1092 0000 sts twi_state,__zero_reg__ |
1627 1070 8091 0000 lds r24,BLFlags |
1628 1074 8E7F andi r24,lo8(-2) |
1629 1076 8093 0000 sts BLFlags,r24 |
1630 107a 85EA ldi r24,lo8(-91) |
1631 107c 8093 BC00 sts 188,r24 |
1632 /* epilogue start */ |
1633 1080 0895 ret |
1635 .global ParameterZuordnung |
1637 ParameterZuordnung: |
1638 /* prologue: function */ |
1639 /* frame size = 0 */ |
1640 1082 8091 0000 lds r24,EE_Parameter+15 |
1641 1086 883F cpi r24,lo8(-8) |
1642 1088 00F0 brlo .L161 |
1643 .L78: |
1644 108a EFEF ldi r30,lo8(255) |
1645 108c F0E0 ldi r31,hi8(255) |
1646 108e E81B sub r30,r24 |
1647 1090 F109 sbc r31,__zero_reg__ |
1648 1092 E050 subi r30,lo8(-(Poti)) |
1649 1094 F040 sbci r31,hi8(-(Poti)) |
1650 1096 8081 ld r24,Z |
1651 .L161: |
1652 1098 8093 0000 sts Parameter_Luftdruck_D,r24 |
1653 109c 8091 0000 lds r24,Parameter_Luftdruck_D |
1654 10a0 8823 tst r24 |
1655 10a2 01F4 brne .L80 |
1656 10a4 1092 0000 sts Parameter_Luftdruck_D,__zero_reg__ |
1657 10a8 00C0 rjmp .L81 |
1658 .L80: |
1659 10aa 8436 cpi r24,lo8(100) |
1660 10ac 00F0 brlo .L81 |
1661 10ae 84E6 ldi r24,lo8(100) |
1662 10b0 8093 0000 sts Parameter_Luftdruck_D,r24 |
1663 .L81: |
1664 10b4 8091 0000 lds r24,EE_Parameter+17 |
1665 10b8 883F cpi r24,lo8(-8) |
1666 10ba 00F0 brlo .L162 |
1667 .L82: |
1668 10bc EFEF ldi r30,lo8(255) |
1669 10be F0E0 ldi r31,hi8(255) |
1670 10c0 E81B sub r30,r24 |
1671 10c2 F109 sbc r31,__zero_reg__ |
1672 10c4 E050 subi r30,lo8(-(Poti)) |
1673 10c6 F040 sbci r31,hi8(-(Poti)) |
1674 10c8 8081 ld r24,Z |
1675 .L162: |
1676 10ca 8093 0000 sts Parameter_Hoehe_P,r24 |
1677 10ce 8091 0000 lds r24,Parameter_Hoehe_P |
1678 10d2 8823 tst r24 |
1679 10d4 01F4 brne .L84 |
1680 10d6 1092 0000 sts Parameter_Hoehe_P,__zero_reg__ |
1681 10da 00C0 rjmp .L85 |
1682 .L84: |
1683 10dc 8436 cpi r24,lo8(100) |
1684 10de 00F0 brlo .L85 |
1685 10e0 84E6 ldi r24,lo8(100) |
1686 10e2 8093 0000 sts Parameter_Hoehe_P,r24 |
1687 .L85: |
1688 10e6 8091 0000 lds r24,EE_Parameter+30 |
1689 10ea 883F cpi r24,lo8(-8) |
1690 10ec 00F0 brlo .L163 |
1691 .L86: |
1692 10ee EFEF ldi r30,lo8(255) |
1693 10f0 F0E0 ldi r31,hi8(255) |
1694 10f2 E81B sub r30,r24 |
1695 10f4 F109 sbc r31,__zero_reg__ |
1696 10f6 E050 subi r30,lo8(-(Poti)) |
1697 10f8 F040 sbci r31,hi8(-(Poti)) |
1698 10fa 8081 ld r24,Z |
1699 .L163: |
1700 10fc 8093 0000 sts Parameter_Gyro_P,r24 |
1701 1100 8091 0000 lds r24,Parameter_Gyro_P |
1702 1104 8B30 cpi r24,lo8(11) |
1703 1106 00F4 brsh .L88 |
1704 1108 8AE0 ldi r24,lo8(10) |
1705 110a 00C0 rjmp .L164 |
1706 .L88: |
1707 110c 8F3F cpi r24,lo8(-1) |
1708 110e 01F4 brne .L89 |
1709 .L164: |
1710 1110 8093 0000 sts Parameter_Gyro_P,r24 |
1711 .L89: |
1712 1114 8091 0000 lds r24,EE_Parameter+73 |
1713 1118 883F cpi r24,lo8(-8) |
1714 111a 00F0 brlo .L165 |
1715 .L90: |
1716 111c EFEF ldi r30,lo8(255) |
1717 111e F0E0 ldi r31,hi8(255) |
1718 1120 E81B sub r30,r24 |
1719 1122 F109 sbc r31,__zero_reg__ |
1720 1124 E050 subi r30,lo8(-(Poti)) |
1721 1126 F040 sbci r31,hi8(-(Poti)) |
1722 1128 8081 ld r24,Z |
1723 .L165: |
1724 112a 8093 0000 sts Parameter_J16Timing,r24 |
1725 112e 8091 0000 lds r24,Parameter_J16Timing |
1726 1132 8230 cpi r24,lo8(2) |
1727 1134 00F4 brsh .L92 |
1728 1136 81E0 ldi r24,lo8(1) |
1729 1138 00C0 rjmp .L166 |
1730 .L92: |
1731 113a 8F3F cpi r24,lo8(-1) |
1732 113c 01F4 brne .L93 |
1733 .L166: |
1734 113e 8093 0000 sts Parameter_J16Timing,r24 |
1735 .L93: |
1736 1142 8091 0000 lds r24,EE_Parameter+75 |
1737 1146 883F cpi r24,lo8(-8) |
1738 1148 00F0 brlo .L167 |
1739 .L94: |
1740 114a EFEF ldi r30,lo8(255) |
1741 114c F0E0 ldi r31,hi8(255) |
1742 114e E81B sub r30,r24 |
1743 1150 F109 sbc r31,__zero_reg__ |
1744 1152 E050 subi r30,lo8(-(Poti)) |
1745 1154 F040 sbci r31,hi8(-(Poti)) |
1746 1156 8081 ld r24,Z |
1747 .L167: |
1748 1158 8093 0000 sts Parameter_J17Timing,r24 |
1749 115c 8091 0000 lds r24,Parameter_J17Timing |
1750 1160 8230 cpi r24,lo8(2) |
1751 1162 00F4 brsh .L96 |
1752 1164 81E0 ldi r24,lo8(1) |
1753 1166 00C0 rjmp .L168 |
1754 .L96: |
1755 1168 8F3F cpi r24,lo8(-1) |
1756 116a 01F4 brne .L97 |
1757 .L168: |
1758 116c 8093 0000 sts Parameter_J17Timing,r24 |
1759 .L97: |
1760 1170 8091 0000 lds r24,EE_Parameter+54 |
1761 1174 883F cpi r24,lo8(-8) |
1762 1176 00F0 brlo .L169 |
1763 .L98: |
1764 1178 EFEF ldi r30,lo8(255) |
1765 117a F0E0 ldi r31,hi8(255) |
1766 117c E81B sub r30,r24 |
1767 117e F109 sbc r31,__zero_reg__ |
1768 1180 E050 subi r30,lo8(-(Poti)) |
1769 1182 F040 sbci r31,hi8(-(Poti)) |
1770 1184 8081 ld r24,Z |
1771 .L169: |
1772 1186 8093 0000 sts Parameter_Servo3,r24 |
1773 118a 8091 0000 lds r24,EE_Parameter+55 |
1774 118e 883F cpi r24,lo8(-8) |
1775 1190 00F0 brlo .L170 |
1776 .L100: |
1777 1192 EFEF ldi r30,lo8(255) |
1778 1194 F0E0 ldi r31,hi8(255) |
1779 1196 E81B sub r30,r24 |
1780 1198 F109 sbc r31,__zero_reg__ |
1781 119a E050 subi r30,lo8(-(Poti)) |
1782 119c F040 sbci r31,hi8(-(Poti)) |
1783 119e 8081 ld r24,Z |
1784 .L170: |
1785 11a0 8093 0000 sts Parameter_Servo4,r24 |
1786 11a4 8091 0000 lds r24,EE_Parameter+56 |
1787 11a8 883F cpi r24,lo8(-8) |
1788 11aa 00F0 brlo .L171 |
1789 .L102: |
1790 11ac EFEF ldi r30,lo8(255) |
1791 11ae F0E0 ldi r31,hi8(255) |
1792 11b0 E81B sub r30,r24 |
1793 11b2 F109 sbc r31,__zero_reg__ |
1794 11b4 E050 subi r30,lo8(-(Poti)) |
1795 11b6 F040 sbci r31,hi8(-(Poti)) |
1796 11b8 8081 ld r24,Z |
1797 .L171: |
1798 11ba 8093 0000 sts Parameter_Servo5,r24 |
1799 11be 8091 0000 lds r24,EE_Parameter+16 |
1800 11c2 883F cpi r24,lo8(-8) |
1801 11c4 00F0 brlo .L172 |
1802 .L104: |
1803 11c6 EFEF ldi r30,lo8(255) |
1804 11c8 F0E0 ldi r31,hi8(255) |
1805 11ca E81B sub r30,r24 |
1806 11cc F109 sbc r31,__zero_reg__ |
1807 11ce E050 subi r30,lo8(-(Poti)) |
1808 11d0 F040 sbci r31,hi8(-(Poti)) |
1809 11d2 8081 ld r24,Z |
1810 .L172: |
1811 11d4 8093 0000 sts Parameter_MaxHoehe,r24 |
1812 11d8 8091 0000 lds r24,EE_Parameter+19 |
1813 11dc 883F cpi r24,lo8(-8) |
1814 11de 00F0 brlo .L173 |
1815 .L106: |
1816 11e0 EFEF ldi r30,lo8(255) |
1817 11e2 F0E0 ldi r31,hi8(255) |
1818 11e4 E81B sub r30,r24 |
1819 11e6 F109 sbc r31,__zero_reg__ |
1820 11e8 E050 subi r30,lo8(-(Poti)) |
1821 11ea F040 sbci r31,hi8(-(Poti)) |
1822 11ec 8081 ld r24,Z |
1823 .L173: |
1824 11ee 8093 0000 sts Parameter_Hoehe_ACC_Wirkung,r24 |
1825 11f2 8091 0000 lds r24,EE_Parameter+21 |
1826 11f6 883F cpi r24,lo8(-8) |
1827 11f8 00F0 brlo .L174 |
1828 .L108: |
1829 11fa EFEF ldi r30,lo8(255) |
1830 11fc F0E0 ldi r31,hi8(255) |
1831 11fe E81B sub r30,r24 |
1832 1200 F109 sbc r31,__zero_reg__ |
1833 1202 E050 subi r30,lo8(-(Poti)) |
1834 1204 F040 sbci r31,hi8(-(Poti)) |
1835 1206 8081 ld r24,Z |
1836 .L174: |
1837 1208 8093 0000 sts Parameter_Hoehe_GPS_Z,r24 |
1838 120c 8091 0000 lds r24,EE_Parameter+29 |
1839 1210 883F cpi r24,lo8(-8) |
1840 1212 00F0 brlo .L175 |
1841 .L110: |
1842 1214 EFEF ldi r30,lo8(255) |
1843 1216 F0E0 ldi r31,hi8(255) |
1844 1218 E81B sub r30,r24 |
1845 121a F109 sbc r31,__zero_reg__ |
1846 121c E050 subi r30,lo8(-(Poti)) |
1847 121e F040 sbci r31,hi8(-(Poti)) |
1848 1220 8081 ld r24,Z |
1849 .L175: |
1850 1222 8093 0000 sts Parameter_KompassWirkung,r24 |
1851 1226 8091 0000 lds r24,EE_Parameter+31 |
1852 122a 883F cpi r24,lo8(-8) |
1853 122c 00F0 brlo .L176 |
1854 .L112: |
1855 122e EFEF ldi r30,lo8(255) |
1856 1230 F0E0 ldi r31,hi8(255) |
1857 1232 E81B sub r30,r24 |
1858 1234 F109 sbc r31,__zero_reg__ |
1859 1236 E050 subi r30,lo8(-(Poti)) |
1860 1238 F040 sbci r31,hi8(-(Poti)) |
1861 123a 8081 ld r24,Z |
1862 .L176: |
1863 123c 8093 0000 sts Parameter_Gyro_I,r24 |
1864 1240 8091 0000 lds r24,EE_Parameter+32 |
1865 1244 883F cpi r24,lo8(-8) |
1866 1246 00F0 brlo .L177 |
1867 .L114: |
1868 1248 EFEF ldi r30,lo8(255) |
1869 124a F0E0 ldi r31,hi8(255) |
1870 124c E81B sub r30,r24 |
1871 124e F109 sbc r31,__zero_reg__ |
1872 1250 E050 subi r30,lo8(-(Poti)) |
1873 1252 F040 sbci r31,hi8(-(Poti)) |
1874 1254 8081 ld r24,Z |
1875 .L177: |
1876 1256 8093 0000 sts Parameter_Gyro_D,r24 |
1877 125a 8091 0000 lds r24,EE_Parameter+33 |
1878 125e 883F cpi r24,lo8(-8) |
1879 1260 00F0 brlo .L178 |
1880 .L116: |
1881 1262 EFEF ldi r30,lo8(255) |
1882 1264 F0E0 ldi r31,hi8(255) |
1883 1266 E81B sub r30,r24 |
1884 1268 F109 sbc r31,__zero_reg__ |
1885 126a E050 subi r30,lo8(-(Poti)) |
1886 126c F040 sbci r31,hi8(-(Poti)) |
1887 126e 8081 ld r24,Z |
1888 .L178: |
1889 1270 8093 0000 sts Parameter_Gyro_Gier_P,r24 |
1890 1274 8091 0000 lds r24,EE_Parameter+34 |
1891 1278 883F cpi r24,lo8(-8) |
1892 127a 00F0 brlo .L179 |
1893 .L118: |
1894 127c EFEF ldi r30,lo8(255) |
1895 127e F0E0 ldi r31,hi8(255) |
1896 1280 E81B sub r30,r24 |
1897 1282 F109 sbc r31,__zero_reg__ |
1898 1284 E050 subi r30,lo8(-(Poti)) |
1899 1286 F040 sbci r31,hi8(-(Poti)) |
1900 1288 8081 ld r24,Z |
1901 .L179: |
1902 128a 8093 0000 sts Parameter_Gyro_Gier_I,r24 |
1903 128e 8091 0000 lds r24,EE_Parameter+40 |
1904 1292 883F cpi r24,lo8(-8) |
1905 1294 00F0 brlo .L180 |
1906 .L120: |
1907 1296 EFEF ldi r30,lo8(255) |
1908 1298 F0E0 ldi r31,hi8(255) |
1909 129a E81B sub r30,r24 |
1910 129c F109 sbc r31,__zero_reg__ |
1911 129e E050 subi r30,lo8(-(Poti)) |
1912 12a0 F040 sbci r31,hi8(-(Poti)) |
1913 12a2 8081 ld r24,Z |
1914 .L180: |
1915 12a4 8093 0000 sts Parameter_I_Faktor,r24 |
1916 12a8 8091 0000 lds r24,EE_Parameter+41 |
1917 12ac 883F cpi r24,lo8(-8) |
1918 12ae 00F0 brlo .L181 |
1919 .L122: |
1920 12b0 EFEF ldi r30,lo8(255) |
1921 12b2 F0E0 ldi r31,hi8(255) |
1922 12b4 E81B sub r30,r24 |
1923 12b6 F109 sbc r31,__zero_reg__ |
1924 12b8 E050 subi r30,lo8(-(Poti)) |
1925 12ba F040 sbci r31,hi8(-(Poti)) |
1926 12bc 8081 ld r24,Z |
1927 .L181: |
1928 12be 8093 0000 sts Parameter_UserParam1,r24 |
1929 12c2 8091 0000 lds r24,EE_Parameter+42 |
1930 12c6 883F cpi r24,lo8(-8) |
1931 12c8 00F0 brlo .L182 |
1932 .L124: |
1933 12ca EFEF ldi r30,lo8(255) |
1934 12cc F0E0 ldi r31,hi8(255) |
1935 12ce E81B sub r30,r24 |
1936 12d0 F109 sbc r31,__zero_reg__ |
1937 12d2 E050 subi r30,lo8(-(Poti)) |
1938 12d4 F040 sbci r31,hi8(-(Poti)) |
1939 12d6 8081 ld r24,Z |
1940 .L182: |
1941 12d8 8093 0000 sts Parameter_UserParam2,r24 |
1942 12dc 8091 0000 lds r24,EE_Parameter+43 |
1943 12e0 883F cpi r24,lo8(-8) |
1944 12e2 00F0 brlo .L183 |
1945 .L126: |
1946 12e4 EFEF ldi r30,lo8(255) |
1947 12e6 F0E0 ldi r31,hi8(255) |
1948 12e8 E81B sub r30,r24 |
1949 12ea F109 sbc r31,__zero_reg__ |
1950 12ec E050 subi r30,lo8(-(Poti)) |
1951 12ee F040 sbci r31,hi8(-(Poti)) |
1952 12f0 8081 ld r24,Z |
1953 .L183: |
1954 12f2 8093 0000 sts Parameter_UserParam3,r24 |
1955 12f6 8091 0000 lds r24,EE_Parameter+44 |
1956 12fa 883F cpi r24,lo8(-8) |
1957 12fc 00F0 brlo .L184 |
1958 .L128: |
1959 12fe EFEF ldi r30,lo8(255) |
1960 1300 F0E0 ldi r31,hi8(255) |
1961 1302 E81B sub r30,r24 |
1962 1304 F109 sbc r31,__zero_reg__ |
1963 1306 E050 subi r30,lo8(-(Poti)) |
1964 1308 F040 sbci r31,hi8(-(Poti)) |
1965 130a 8081 ld r24,Z |
1966 .L184: |
1967 130c 8093 0000 sts Parameter_UserParam4,r24 |
1968 1310 8091 0000 lds r24,EE_Parameter+68 |
1969 1314 883F cpi r24,lo8(-8) |
1970 1316 00F0 brlo .L185 |
1971 .L130: |
1972 1318 EFEF ldi r30,lo8(255) |
1973 131a F0E0 ldi r31,hi8(255) |
1974 131c E81B sub r30,r24 |
1975 131e F109 sbc r31,__zero_reg__ |
1976 1320 E050 subi r30,lo8(-(Poti)) |
1977 1322 F040 sbci r31,hi8(-(Poti)) |
1978 1324 8081 ld r24,Z |
1979 .L185: |
1980 1326 8093 0000 sts Parameter_UserParam5,r24 |
1981 132a 8091 0000 lds r24,EE_Parameter+69 |
1982 132e 883F cpi r24,lo8(-8) |
1983 1330 00F0 brlo .L186 |
1984 .L132: |
1985 1332 EFEF ldi r30,lo8(255) |
1986 1334 F0E0 ldi r31,hi8(255) |
1987 1336 E81B sub r30,r24 |
1988 1338 F109 sbc r31,__zero_reg__ |
1989 133a E050 subi r30,lo8(-(Poti)) |
1990 133c F040 sbci r31,hi8(-(Poti)) |
1991 133e 8081 ld r24,Z |
1992 .L186: |
1993 1340 8093 0000 sts Parameter_UserParam6,r24 |
1994 1344 8091 0000 lds r24,EE_Parameter+70 |
1995 1348 883F cpi r24,lo8(-8) |
1996 134a 00F0 brlo .L187 |
1997 .L134: |
1998 134c EFEF ldi r30,lo8(255) |
1999 134e F0E0 ldi r31,hi8(255) |
2000 1350 E81B sub r30,r24 |
2001 1352 F109 sbc r31,__zero_reg__ |
2002 1354 E050 subi r30,lo8(-(Poti)) |
2003 1356 F040 sbci r31,hi8(-(Poti)) |
2004 1358 8081 ld r24,Z |
2005 .L187: |
2006 135a 8093 0000 sts Parameter_UserParam7,r24 |
2007 135e 8091 0000 lds r24,EE_Parameter+71 |
2008 1362 883F cpi r24,lo8(-8) |
2009 1364 00F0 brlo .L188 |
2010 .L136: |
2011 1366 EFEF ldi r30,lo8(255) |
2012 1368 F0E0 ldi r31,hi8(255) |
2013 136a E81B sub r30,r24 |
2014 136c F109 sbc r31,__zero_reg__ |
2015 136e E050 subi r30,lo8(-(Poti)) |
2016 1370 F040 sbci r31,hi8(-(Poti)) |
2017 1372 8081 ld r24,Z |
2018 .L188: |
2019 1374 8093 0000 sts Parameter_UserParam8,r24 |
2020 1378 8091 0000 lds r24,EE_Parameter+45 |
2021 137c 883F cpi r24,lo8(-8) |
2022 137e 00F0 brlo .L189 |
2023 .L138: |
2024 1380 EFEF ldi r30,lo8(255) |
2025 1382 F0E0 ldi r31,hi8(255) |
2026 1384 E81B sub r30,r24 |
2027 1386 F109 sbc r31,__zero_reg__ |
2028 1388 E050 subi r30,lo8(-(Poti)) |
2029 138a F040 sbci r31,hi8(-(Poti)) |
2030 138c 8081 ld r24,Z |
2031 .L189: |
2032 138e 8093 0000 sts Parameter_ServoNickControl,r24 |
2033 1392 8091 0000 lds r24,EE_Parameter+49 |
2034 1396 883F cpi r24,lo8(-8) |
2035 1398 00F0 brlo .L190 |
2036 .L140: |
2037 139a EFEF ldi r30,lo8(255) |
2038 139c F0E0 ldi r31,hi8(255) |
2039 139e E81B sub r30,r24 |
2040 13a0 F109 sbc r31,__zero_reg__ |
2041 13a2 E050 subi r30,lo8(-(Poti)) |
2042 13a4 F040 sbci r31,hi8(-(Poti)) |
2043 13a6 8081 ld r24,Z |
2044 .L190: |
2045 13a8 8093 0000 sts Parameter_ServoRollControl,r24 |
2046 13ac 8091 0000 lds r24,EE_Parameter+57 |
2047 13b0 883F cpi r24,lo8(-8) |
2048 13b2 00F0 brlo .L191 |
2049 .L142: |
2050 13b4 EFEF ldi r30,lo8(255) |
2051 13b6 F0E0 ldi r31,hi8(255) |
2052 13b8 E81B sub r30,r24 |
2053 13ba F109 sbc r31,__zero_reg__ |
2054 13bc E050 subi r30,lo8(-(Poti)) |
2055 13be F040 sbci r31,hi8(-(Poti)) |
2056 13c0 8081 ld r24,Z |
2057 .L191: |
2058 13c2 8093 0000 sts Parameter_LoopGasLimit,r24 |
2059 13c6 8091 0000 lds r24,EE_Parameter+60 |
2060 13ca 883F cpi r24,lo8(-8) |
2061 13cc 00F0 brlo .L192 |
2062 .L144: |
2063 13ce EFEF ldi r30,lo8(255) |
2064 13d0 F0E0 ldi r31,hi8(255) |
2065 13d2 E81B sub r30,r24 |
2066 13d4 F109 sbc r31,__zero_reg__ |
2067 13d6 E050 subi r30,lo8(-(Poti)) |
2068 13d8 F040 sbci r31,hi8(-(Poti)) |
2069 13da 8081 ld r24,Z |
2070 .L192: |
2071 13dc 8093 0000 sts Parameter_AchsKopplung1,r24 |
2072 13e0 8091 0000 lds r24,EE_Parameter+61 |
2073 13e4 883F cpi r24,lo8(-8) |
2074 13e6 00F0 brlo .L193 |
2075 .L146: |
2076 13e8 EFEF ldi r30,lo8(255) |
2077 13ea F0E0 ldi r31,hi8(255) |
2078 13ec E81B sub r30,r24 |
2079 13ee F109 sbc r31,__zero_reg__ |
2080 13f0 E050 subi r30,lo8(-(Poti)) |
2081 13f2 F040 sbci r31,hi8(-(Poti)) |
2082 13f4 8081 ld r24,Z |
2083 .L193: |
2084 13f6 8093 0000 sts Parameter_AchsKopplung2,r24 |
2085 13fa 8091 0000 lds r24,EE_Parameter+62 |
2086 13fe 883F cpi r24,lo8(-8) |
2087 1400 00F0 brlo .L194 |
2088 .L148: |
2089 1402 EFEF ldi r30,lo8(255) |
2090 1404 F0E0 ldi r31,hi8(255) |
2091 1406 E81B sub r30,r24 |
2092 1408 F109 sbc r31,__zero_reg__ |
2093 140a E050 subi r30,lo8(-(Poti)) |
2094 140c F040 sbci r31,hi8(-(Poti)) |
2095 140e 8081 ld r24,Z |
2096 .L194: |
2097 1410 8093 0000 sts Parameter_CouplingYawCorrection,r24 |
2098 1414 8091 0000 lds r24,EE_Parameter+67 |
2099 1418 883F cpi r24,lo8(-8) |
2100 141a 00F0 brlo .L195 |
2101 .L150: |
2102 141c EFEF ldi r30,lo8(255) |
2103 141e F0E0 ldi r31,hi8(255) |
2104 1420 E81B sub r30,r24 |
2105 1422 F109 sbc r31,__zero_reg__ |
2106 1424 E050 subi r30,lo8(-(Poti)) |
2107 1426 F040 sbci r31,hi8(-(Poti)) |
2108 1428 8081 ld r24,Z |
2109 .L195: |
2110 142a 8093 0000 sts Parameter_DynamicStability,r24 |
2111 142e 8091 0000 lds r24,EE_Parameter+94 |
2112 1432 883F cpi r24,lo8(-8) |
2113 1434 00F0 brlo .L196 |
2114 .L152: |
2115 1436 EFEF ldi r30,lo8(255) |
2116 1438 F0E0 ldi r31,hi8(255) |
2117 143a E81B sub r30,r24 |
2118 143c F109 sbc r31,__zero_reg__ |
2119 143e E050 subi r30,lo8(-(Poti)) |
2120 1440 F040 sbci r31,hi8(-(Poti)) |
2121 1442 8081 ld r24,Z |
2122 .L196: |
2123 1444 8093 0000 sts Parameter_ExternalControl,r24 |
2124 1448 6091 0000 lds r22,Parameter_I_Faktor |
2125 144c 70E0 ldi r23,lo8(0) |
2126 144e 6F5F subi r22,lo8(-(1)) |
2127 1450 7F4F sbci r23,hi8(-(1)) |
2128 1452 8CE3 ldi r24,lo8(10300) |
2129 1454 98E2 ldi r25,hi8(10300) |
2130 1456 0E94 0000 call __divmodhi4 |
2131 145a 7093 0000 sts (Ki)+1,r23 |
2132 145e 6093 0000 sts Ki,r22 |
2133 1462 8091 0000 lds r24,EE_Parameter+27 |
2134 1466 8093 0000 sts MAX_GAS,r24 |
2135 146a 8091 0000 lds r24,EE_Parameter+26 |
2136 146e 8093 0000 sts MIN_GAS,r24 |
2137 1472 9091 0000 lds r25,EE_Parameter+96 |
2138 1476 9333 cpi r25,lo8(51) |
2139 1478 00F0 brlo .L154 |
2140 147a 81E0 ldi r24,lo8(1) |
2141 147c 8093 0000 sts CareFree,r24 |
2142 1480 983F cpi r25,lo8(-8) |
2143 1482 00F0 brlo .L155 |
2144 1484 EFEF ldi r30,lo8(255) |
2145 1486 F0E0 ldi r31,hi8(255) |
2146 1488 E91B sub r30,r25 |
2147 148a F109 sbc r31,__zero_reg__ |
2148 148c E050 subi r30,lo8(-(Poti)) |
2149 148e F040 sbci r31,hi8(-(Poti)) |
2150 1490 8081 ld r24,Z |
2151 1492 8233 cpi r24,lo8(50) |
2152 1494 00F4 brsh .L155 |
2153 1496 1092 0000 sts CareFree,__zero_reg__ |
2154 .L155: |
2155 149a 8091 0000 lds r24,FromNaviCtrl+7 |
2156 149e 9091 0000 lds r25,(FromNaviCtrl+7)+1 |
2157 14a2 97FF sbrs r25,7 |
2158 14a4 00C0 rjmp .L156 |
2159 14a6 8091 0000 lds r24,CareFree |
2160 14aa 8823 tst r24 |
2161 14ac 01F0 breq .L156 |
2162 14ae 8091 0000 lds r24,VersionInfo+5 |
2163 14b2 8068 ori r24,lo8(-128) |
2164 14b4 00C0 rjmp .L197 |
2165 .L156: |
2166 14b6 8091 0000 lds r24,VersionInfo+5 |
2167 14ba 8F77 andi r24,lo8(127) |
2168 .L197: |
2169 14bc 8093 0000 sts VersionInfo+5,r24 |
2170 14c0 00C0 rjmp .L157 |
2171 .L154: |
2172 14c2 1092 0000 sts CareFree,__zero_reg__ |
2173 .L157: |
2174 14c6 8091 0000 lds r24,FromNaviCtrl+7 |
2175 14ca 9091 0000 lds r25,(FromNaviCtrl+7)+1 |
2176 14ce 97FF sbrs r25,7 |
2177 14d0 00C0 rjmp .L158 |
2178 14d2 8091 0000 lds r24,MotorenEin |
2179 14d6 8823 tst r24 |
2180 14d8 01F0 breq .L158 |
2181 14da 8091 0000 lds r24,CareFree |
2182 14de 8823 tst r24 |
2183 14e0 01F0 breq .L158 |
2184 14e2 8091 0000 lds r24,BeepMuster |
2185 14e6 9091 0000 lds r25,(BeepMuster)+1 |
2186 14ea 8F5F subi r24,lo8(-1) |
2187 14ec 9F4F sbci r25,hi8(-1) |
2188 14ee 01F4 brne .L158 |
2189 14f0 88E9 ldi r24,lo8(15000) |
2190 14f2 9AE3 ldi r25,hi8(15000) |
2191 14f4 9093 0000 sts (beeptime)+1,r25 |
2192 14f8 8093 0000 sts beeptime,r24 |
2193 14fc 80E0 ldi r24,lo8(-23552) |
2194 14fe 94EA ldi r25,hi8(-23552) |
2195 1500 9093 0000 sts (BeepMuster)+1,r25 |
2196 1504 8093 0000 sts BeepMuster,r24 |
2197 1508 1092 0000 sts CareFree,__zero_reg__ |
2198 .L158: |
2199 150c 8091 0000 lds r24,CareFree |
2200 1510 8823 tst r24 |
2201 1512 01F0 breq .L160 |
2202 1514 8091 0000 lds r24,Parameter_AchsKopplung1 |
2203 1518 823D cpi r24,lo8(-46) |
2204 151a 00F4 brsh .L160 |
2205 151c 825E subi r24,lo8(-(30)) |
2206 151e 8093 0000 sts Parameter_AchsKopplung1,r24 |
2207 .L160: |
2208 1522 0895 ret |
2210 .global CalibrierMittelwert |
2212 CalibrierMittelwert: |
2213 1524 CF93 push r28 |
2214 1526 DF93 push r29 |
2215 /* prologue: function */ |
2216 /* frame size = 0 */ |
2217 1528 8091 0000 lds r24,PlatinenVersion |
2218 152c 8D30 cpi r24,lo8(13) |
2219 152e 01F4 brne .L199 |
2220 1530 0E94 0000 call SucheGyroOffset |
2221 .L199: |
2222 1534 1092 7A00 sts 122,__zero_reg__ |
2223 1538 8091 0000 lds r24,AdWertNick |
2224 153c 9091 0000 lds r25,(AdWertNick)+1 |
2225 1540 9093 0000 sts (MesswertNick)+1,r25 |
2226 1544 8093 0000 sts MesswertNick,r24 |
2227 1548 8091 0000 lds r24,AdWertRoll |
2228 154c 9091 0000 lds r25,(AdWertRoll)+1 |
2229 1550 9093 0000 sts (MesswertRoll)+1,r25 |
2230 1554 8093 0000 sts MesswertRoll,r24 |
2231 1558 8091 0000 lds r24,AdWertGier |
2232 155c 9091 0000 lds r25,(AdWertGier)+1 |
2233 1560 9093 0000 sts (MesswertGier)+1,r25 |
2234 1564 8093 0000 sts MesswertGier,r24 |
2235 1568 2091 0000 lds r18,AdWertAccNick |
2236 156c 3091 0000 lds r19,(AdWertAccNick)+1 |
2237 1570 C901 movw r24,r18 |
2238 1572 880F lsl r24 |
2239 1574 991F rol r25 |
2240 1576 820F add r24,r18 |
2241 1578 931F adc r25,r19 |
2242 157a 880F lsl r24 |
2243 157c 991F rol r25 |
2244 157e 9093 0000 sts (Mittelwert_AccNick)+1,r25 |
2245 1582 8093 0000 sts Mittelwert_AccNick,r24 |
2246 1586 2091 0000 lds r18,AdWertAccRoll |
2247 158a 3091 0000 lds r19,(AdWertAccRoll)+1 |
2248 158e C901 movw r24,r18 |
2249 1590 880F lsl r24 |
2250 1592 991F rol r25 |
2251 1594 820F add r24,r18 |
2252 1596 931F adc r25,r19 |
2253 1598 880F lsl r24 |
2254 159a 991F rol r25 |
2255 159c 9093 0000 sts (Mittelwert_AccRoll)+1,r25 |
2256 15a0 8093 0000 sts Mittelwert_AccRoll,r24 |
2257 15a4 8FEC ldi r24,lo8(-49) |
2258 15a6 8093 7A00 sts 122,r24 |
2259 15aa C0E0 ldi r28,lo8(EE_Parameter+5) |
2260 15ac D0E0 ldi r29,hi8(EE_Parameter+5) |
2261 15ae A0E0 ldi r26,lo8(Poti) |
2262 15b0 B0E0 ldi r27,hi8(Poti) |
2263 .L204: |
2264 15b2 E881 ld r30,Y |
2265 15b4 F0E0 ldi r31,lo8(0) |
2266 15b6 EE0F lsl r30 |
2267 15b8 FF1F rol r31 |
2268 15ba E050 subi r30,lo8(-(PPM_in)) |
2269 15bc F040 sbci r31,hi8(-(PPM_in)) |
2270 15be 0190 ld __tmp_reg__,Z+ |
2271 15c0 F081 ld r31,Z |
2272 15c2 E02D mov r30,__tmp_reg__ |
2273 15c4 E259 subi r30,lo8(-(110)) |
2274 15c6 FF4F sbci r31,hi8(-(110)) |
2275 15c8 1E16 cp __zero_reg__,r30 |
2276 15ca 1F06 cpc __zero_reg__,r31 |
2277 15cc 04F0 brlt .L200 |
2278 15ce E0E0 ldi r30,lo8(0) |
2279 15d0 F0E0 ldi r31,hi8(0) |
2280 15d2 00C0 rjmp .L201 |
2281 .L200: |
2282 15d4 EF3F cpi r30,255 |
2283 15d6 F105 cpc r31,__zero_reg__ |
2284 15d8 04F0 brlt .L201 |
2285 15da EFEF ldi r30,lo8(255) |
2286 15dc F0E0 ldi r31,hi8(255) |
2287 .L201: |
2288 15de 8C91 ld r24,X |
2289 15e0 282F mov r18,r24 |
2290 15e2 30E0 ldi r19,lo8(0) |
2291 15e4 E217 cp r30,r18 |
2292 15e6 F307 cpc r31,r19 |
2293 15e8 04F4 brge .L202 |
2294 15ea 8150 subi r24,lo8(-(-1)) |
2295 15ec 00C0 rjmp .L207 |
2296 .L202: |
2297 15ee 2E17 cp r18,r30 |
2298 15f0 3F07 cpc r19,r31 |
2299 15f2 04F4 brge .L203 |
2300 15f4 8F5F subi r24,lo8(-(1)) |
2301 .L207: |
2302 15f6 8C93 st X,r24 |
2303 .L203: |
2304 15f8 2196 adiw r28,1 |
2305 15fa 1196 adiw r26,1 |
2306 15fc 80E0 ldi r24,hi8(EE_Parameter+13) |
2307 15fe C030 cpi r28,lo8(EE_Parameter+13) |
2308 1600 D807 cpc r29,r24 |
2309 1602 01F4 brne .L204 |
2310 1604 6AA9 ldd r22,Y+50 |
2311 1606 70E0 ldi r23,lo8(0) |
2312 1608 80E0 ldi r24,lo8(0) |
2313 160a 90E0 ldi r25,hi8(0) |
2314 160c 24EC ldi r18,lo8(2500) |
2315 160e 39E0 ldi r19,hi8(2500) |
2316 1610 40E0 ldi r20,hlo8(2500) |
2317 1612 50E0 ldi r21,hhi8(2500) |
2318 1614 0E94 0000 call __mulsi3 |
2319 1618 6093 0000 sts Umschlag180Nick,r22 |
2320 161c 7093 0000 sts (Umschlag180Nick)+1,r23 |
2321 1620 8093 0000 sts (Umschlag180Nick)+2,r24 |
2322 1624 9093 0000 sts (Umschlag180Nick)+3,r25 |
2323 1628 6BA9 ldd r22,Y+51 |
2324 162a 70E0 ldi r23,lo8(0) |
2325 162c 80E0 ldi r24,lo8(0) |
2326 162e 90E0 ldi r25,hi8(0) |
2327 1630 0E94 0000 call __mulsi3 |
2328 1634 6093 0000 sts Umschlag180Roll,r22 |
2329 1638 7093 0000 sts (Umschlag180Roll)+1,r23 |
2330 163c 8093 0000 sts (Umschlag180Roll)+2,r24 |
2331 1640 9093 0000 sts (Umschlag180Roll)+3,r25 |
2332 /* epilogue start */ |
2333 1644 DF91 pop r29 |
2334 1646 CF91 pop r28 |
2335 1648 0895 ret |
2337 .global SetNeutral |
2339 SetNeutral: |
2340 164a A0E0 ldi r26,lo8(0) |
2341 164c B0E0 ldi r27,hi8(0) |
2342 164e E0E0 ldi r30,lo8(gs(1f)) |
2343 1650 F0E0 ldi r31,hi8(gs(1f)) |
2344 1652 0C94 0000 jmp __prologue_saves__+((18 - 14) * 2) |
2345 1: |
2346 /* prologue: function */ |
2347 /* frame size = 0 */ |
2348 1656 682E mov r6,r24 |
2349 1658 1092 0000 sts VersionInfo+5,__zero_reg__ |
2350 165c 469A sbi 40-32,6 |
2351 165e 1092 0000 sts (NeutralAccX)+1,__zero_reg__ |
2352 1662 1092 0000 sts NeutralAccX,__zero_reg__ |
2353 1666 1092 0000 sts (NeutralAccY)+1,__zero_reg__ |
2354 166a 1092 0000 sts NeutralAccY,__zero_reg__ |
2355 166e 1092 0000 sts (NeutralAccZ)+1,__zero_reg__ |
2356 1672 1092 0000 sts NeutralAccZ,__zero_reg__ |
2357 1676 1092 0000 sts (AdNeutralNick)+1,__zero_reg__ |
2358 167a 1092 0000 sts AdNeutralNick,__zero_reg__ |
2359 167e 1092 0000 sts (AdNeutralRoll)+1,__zero_reg__ |
2360 1682 1092 0000 sts AdNeutralRoll,__zero_reg__ |
2361 1686 1092 0000 sts (AdNeutralGier)+1,__zero_reg__ |
2362 168a 1092 0000 sts AdNeutralGier,__zero_reg__ |
2363 168e 1092 0000 sts Parameter_AchsKopplung1,__zero_reg__ |
2364 1692 1092 0000 sts Parameter_AchsKopplung2,__zero_reg__ |
2365 1696 1092 0000 sts ExpandBaro,__zero_reg__ |
2366 169a 0E94 0000 call CalibrierMittelwert |
2367 169e 84E6 ldi r24,lo8(100) |
2368 16a0 90E0 ldi r25,hi8(100) |
2369 16a2 0E94 0000 call Delay_ms_Mess |
2370 16a6 0E94 0000 call CalibrierMittelwert |
2371 16aa 8091 0000 lds r24,EE_Parameter+13 |
2372 16ae 80FF sbrs r24,0 |
2373 16b0 00C0 rjmp .L209 |
2374 16b2 8091 0000 lds r24,MessLuftdruck |
2375 16b6 9091 0000 lds r25,(MessLuftdruck)+1 |
2376 16ba 875B subi r24,lo8(951) |
2377 16bc 9340 sbci r25,hi8(951) |
2378 16be 00F4 brsh .L210 |
2379 16c0 8091 0000 lds r24,MessLuftdruck |
2380 16c4 9091 0000 lds r25,(MessLuftdruck)+1 |
2381 16c8 8E5E subi r24,lo8(750) |
2382 16ca 9240 sbci r25,hi8(750) |
2383 16cc 00F4 brsh .L209 |
2384 .L210: |
2385 16ce 0E94 0000 call SucheLuftruckOffset |
2386 .L209: |
2387 16d2 AA24 clr r10 |
2388 16d4 C0E0 ldi r28,lo8(0) |
2389 16d6 D0E0 ldi r29,hi8(0) |
2390 16d8 00E0 ldi r16,lo8(0) |
2391 16da 10E0 ldi r17,hi8(0) |
2392 16dc EE24 clr r14 |
2393 16de FF24 clr r15 |
2394 .L211: |
2395 16e0 8AE0 ldi r24,lo8(10) |
2396 16e2 90E0 ldi r25,hi8(10) |
2397 16e4 0E94 0000 call Delay_ms_Mess |
2398 16e8 8091 0000 lds r24,AdWertGier |
2399 16ec 9091 0000 lds r25,(AdWertGier)+1 |
2400 16f0 C80F add r28,r24 |
2401 16f2 D91F adc r29,r25 |
2402 16f4 8091 0000 lds r24,AdWertNick |
2403 16f8 9091 0000 lds r25,(AdWertNick)+1 |
2404 16fc 080F add r16,r24 |
2405 16fe 191F adc r17,r25 |
2406 1700 8091 0000 lds r24,AdWertRoll |
2407 1704 9091 0000 lds r25,(AdWertRoll)+1 |
2408 1708 E80E add r14,r24 |
2409 170a F91E adc r15,r25 |
2410 170c A394 inc r10 |
2411 170e 80E2 ldi r24,lo8(32) |
2412 1710 A816 cp r10,r24 |
2413 1712 01F4 brne .L211 |
2414 1714 9801 movw r18,r16 |
2415 1716 205F subi r18,lo8(-(16)) |
2416 1718 3F4F sbci r19,hi8(-(16)) |
2417 171a 3695 lsr r19 |
2418 171c 2795 ror r18 |
2419 171e 3695 lsr r19 |
2420 1720 2795 ror r18 |
2421 1722 3093 0000 sts (AdNeutralNick)+1,r19 |
2422 1726 2093 0000 sts AdNeutralNick,r18 |
2423 172a C701 movw r24,r14 |
2424 172c 4096 adiw r24,16 |
2425 172e 9695 lsr r25 |
2426 1730 8795 ror r24 |
2427 1732 9695 lsr r25 |
2428 1734 8795 ror r24 |
2429 1736 9093 0000 sts (AdNeutralRoll)+1,r25 |
2430 173a 8093 0000 sts AdNeutralRoll,r24 |
2431 173e 6096 adiw r28,16 |
2432 1740 15E0 ldi r17,5 |
2433 1742 D695 1: lsr r29 |
2434 1744 C795 ror r28 |
2435 1746 1A95 dec r17 |
2436 1748 01F4 brne 1b |
2437 174a D093 0000 sts (AdNeutralGier)+1,r29 |
2438 174e C093 0000 sts AdNeutralGier,r28 |
2439 1752 9093 0000 sts (StartNeutralRoll)+1,r25 |
2440 1756 8093 0000 sts StartNeutralRoll,r24 |
2441 175a 3093 0000 sts (StartNeutralNick)+1,r19 |
2442 175e 2093 0000 sts StartNeutralNick,r18 |
2443 1762 6620 tst r6 |
2444 1764 01F4 brne .+2 |
2445 1766 00C0 rjmp .L212 |
2446 1768 8091 0000 lds r24,Mittelwert_AccNick |
2447 176c 9091 0000 lds r25,(Mittelwert_AccNick)+1 |
2448 1770 97FF sbrs r25,7 |
2449 1772 00C0 rjmp .L213 |
2450 1774 9095 com r25 |
2451 1776 8195 neg r24 |
2452 1778 9F4F sbci r25,lo8(-1) |
2453 .L213: |
2454 177a 6CE0 ldi r22,lo8(12) |
2455 177c 70E0 ldi r23,hi8(12) |
2456 177e 0E94 0000 call __divmodhi4 |
2457 1782 9B01 movw r18,r22 |
2458 1784 6093 0000 sts NeutralAccX,r22 |
2459 1788 3093 0000 sts NeutralAccX+1,r19 |
2460 178c 8091 0000 lds r24,Mittelwert_AccRoll |
2461 1790 9091 0000 lds r25,(Mittelwert_AccRoll)+1 |
2462 1794 97FF sbrs r25,7 |
2463 1796 00C0 rjmp .L214 |
2464 1798 9095 com r25 |
2465 179a 8195 neg r24 |
2466 179c 9F4F sbci r25,lo8(-1) |
2467 .L214: |
2468 179e 6CE0 ldi r22,lo8(12) |
2469 17a0 70E0 ldi r23,hi8(12) |
2470 17a2 0E94 0000 call __divmodhi4 |
2471 17a6 7093 0000 sts (NeutralAccY)+1,r23 |
2472 17aa 6093 0000 sts NeutralAccY,r22 |
2473 17ae 8091 0000 lds r24,Aktuell_az |
2474 17b2 9091 0000 lds r25,(Aktuell_az)+1 |
2475 17b6 9093 0000 sts (NeutralAccZ)+1,r25 |
2476 17ba 8093 0000 sts NeutralAccZ,r24 |
2477 17be 84E0 ldi r24,lo8(4) |
2478 17c0 90E0 ldi r25,hi8(4) |
2479 17c2 B901 movw r22,r18 |
2480 17c4 0E94 0000 call SetParamWord |
2481 17c8 6091 0000 lds r22,NeutralAccY |
2482 17cc 7091 0000 lds r23,(NeutralAccY)+1 |
2483 17d0 86E0 ldi r24,lo8(6) |
2484 17d2 90E0 ldi r25,hi8(6) |
2485 17d4 0E94 0000 call SetParamWord |
2486 17d8 6091 0000 lds r22,NeutralAccZ |
2487 17dc 7091 0000 lds r23,(NeutralAccZ)+1 |
2488 17e0 88E0 ldi r24,lo8(8) |
2489 17e2 90E0 ldi r25,hi8(8) |
2490 17e4 0E94 0000 call SetParamWord |
2491 17e8 00C0 rjmp .L215 |
2492 .L212: |
2493 17ea 84E0 ldi r24,lo8(4) |
2494 17ec 90E0 ldi r25,hi8(4) |
2495 17ee 0E94 0000 call GetParamWord |
2496 17f2 9093 0000 sts (NeutralAccX)+1,r25 |
2497 17f6 8093 0000 sts NeutralAccX,r24 |
2498 17fa 86E0 ldi r24,lo8(6) |
2499 17fc 90E0 ldi r25,hi8(6) |
2500 17fe 0E94 0000 call GetParamWord |
2501 1802 9093 0000 sts (NeutralAccY)+1,r25 |
2502 1806 8093 0000 sts NeutralAccY,r24 |
2503 180a 88E0 ldi r24,lo8(8) |
2504 180c 90E0 ldi r25,hi8(8) |
2505 180e 0E94 0000 call GetParamWord |
2506 1812 9C01 movw r18,r24 |
2507 1814 9093 0000 sts (NeutralAccZ)+1,r25 |
2508 1818 8093 0000 sts NeutralAccZ,r24 |
2509 181c 8091 0000 lds r24,NeutralAccX |
2510 1820 9091 0000 lds r25,(NeutralAccX)+1 |
2511 1824 8150 subi r24,lo8(2049) |
2512 1826 9840 sbci r25,hi8(2049) |
2513 1828 00F4 brsh .L216 |
2514 182a 8091 0000 lds r24,NeutralAccY |
2515 182e 9091 0000 lds r25,(NeutralAccY)+1 |
2516 1832 8150 subi r24,lo8(2049) |
2517 1834 9840 sbci r25,hi8(2049) |
2518 1836 00F4 brsh .L216 |
2519 1838 2150 subi r18,lo8(1025) |
2520 183a 3440 sbci r19,hi8(1025) |
2521 183c 00F4 brsh .+2 |
2522 183e 00C0 rjmp .L215 |
2523 .L216: |
2524 1840 00D0 rcall . |
2525 1842 00D0 rcall . |
2526 1844 80E0 ldi r24,lo8(gs(uart_putchar)) |
2527 1846 90E0 ldi r25,hi8(gs(uart_putchar)) |
2528 1848 EDB7 in r30,__SP_L__ |
2529 184a FEB7 in r31,__SP_H__ |
2530 184c 9283 std Z+2,r25 |
2531 184e 8183 std Z+1,r24 |
2532 1850 80E0 ldi r24,lo8(__c.2485) |
2533 1852 90E0 ldi r25,hi8(__c.2485) |
2534 1854 9483 std Z+4,r25 |
2535 1856 8383 std Z+3,r24 |
2536 1858 E091 0000 lds r30,_printf_P |
2537 185c F091 0000 lds r31,(_printf_P)+1 |
2538 1860 0995 icall |
2539 1862 8091 0000 lds r24,Mittelwert_AccNick |
2540 1866 9091 0000 lds r25,(Mittelwert_AccNick)+1 |
2541 186a 97FF sbrs r25,7 |
2542 186c 00C0 rjmp .L217 |
2543 186e 9095 com r25 |
2544 1870 8195 neg r24 |
2545 1872 9F4F sbci r25,lo8(-1) |
2546 .L217: |
2547 1874 6CE0 ldi r22,lo8(12) |
2548 1876 70E0 ldi r23,hi8(12) |
2549 1878 0E94 0000 call __divmodhi4 |
2550 187c 7093 0000 sts (NeutralAccX)+1,r23 |
2551 1880 6093 0000 sts NeutralAccX,r22 |
2552 1884 8091 0000 lds r24,Mittelwert_AccRoll |
2553 1888 9091 0000 lds r25,(Mittelwert_AccRoll)+1 |
2554 188c 97FF sbrs r25,7 |
2555 188e 00C0 rjmp .L218 |
2556 1890 9095 com r25 |
2557 1892 8195 neg r24 |
2558 1894 9F4F sbci r25,lo8(-1) |
2559 .L218: |
2560 1896 6CE0 ldi r22,lo8(12) |
2561 1898 70E0 ldi r23,hi8(12) |
2562 189a 0E94 0000 call __divmodhi4 |
2563 189e 7093 0000 sts (NeutralAccY)+1,r23 |
2564 18a2 6093 0000 sts NeutralAccY,r22 |
2565 18a6 8091 0000 lds r24,Aktuell_az |
2566 18aa 9091 0000 lds r25,(Aktuell_az)+1 |
2567 18ae 9093 0000 sts (NeutralAccZ)+1,r25 |
2568 18b2 8093 0000 sts NeutralAccZ,r24 |
2569 18b6 0F90 pop __tmp_reg__ |
2570 18b8 0F90 pop __tmp_reg__ |
2571 18ba 0F90 pop __tmp_reg__ |
2572 18bc 0F90 pop __tmp_reg__ |
2573 .L215: |
2574 18be 1092 0000 sts (MesswertNick)+1,__zero_reg__ |
2575 18c2 1092 0000 sts MesswertNick,__zero_reg__ |
2576 18c6 1092 0000 sts (MesswertRoll)+1,__zero_reg__ |
2577 18ca 1092 0000 sts MesswertRoll,__zero_reg__ |
2578 18ce 1092 0000 sts (MesswertGier)+1,__zero_reg__ |
2579 18d2 1092 0000 sts MesswertGier,__zero_reg__ |
2580 18d6 84E6 ldi r24,lo8(100) |
2581 18d8 90E0 ldi r25,hi8(100) |
2582 18da 0E94 0000 call Delay_ms_Mess |
2583 18de 2091 0000 lds r18,AdWertAccNick |
2584 18e2 3091 0000 lds r19,(AdWertAccNick)+1 |
2585 18e6 B901 movw r22,r18 |
2586 18e8 660F lsl r22 |
2587 18ea 771F rol r23 |
2588 18ec 620F add r22,r18 |
2589 18ee 731F adc r23,r19 |
2590 18f0 660F lsl r22 |
2591 18f2 771F rol r23 |
2592 18f4 7093 0000 sts (Mittelwert_AccNick)+1,r23 |
2593 18f8 6093 0000 sts Mittelwert_AccNick,r22 |
2594 18fc 2091 0000 lds r18,AdWertAccRoll |
2595 1900 3091 0000 lds r19,(AdWertAccRoll)+1 |
2596 1904 7901 movw r14,r18 |
2597 1906 EE0C lsl r14 |
2598 1908 FF1C rol r15 |
2599 190a E20E add r14,r18 |
2600 190c F31E adc r15,r19 |
2601 190e EE0C lsl r14 |
2602 1910 FF1C rol r15 |
2603 1912 F092 0000 sts (Mittelwert_AccRoll)+1,r15 |
2604 1916 E092 0000 sts Mittelwert_AccRoll,r14 |
2605 191a A090 0000 lds r10,EE_Parameter+28 |
2606 191e BB24 clr r11 |
2607 1920 CC24 clr r12 |
2608 1922 DD24 clr r13 |
2609 1924 8827 clr r24 |
2610 1926 77FD sbrc r23,7 |
2611 1928 8095 com r24 |
2612 192a 982F mov r25,r24 |
2613 192c A601 movw r20,r12 |
2614 192e 9501 movw r18,r10 |
2615 1930 0E94 0000 call __mulsi3 |
2616 1934 3B01 movw r6,r22 |
2617 1936 4C01 movw r8,r24 |
2618 1938 6093 0000 sts IntegralNick,r22 |
2619 193c 7093 0000 sts (IntegralNick)+1,r23 |
2620 1940 8093 0000 sts (IntegralNick)+2,r24 |
2621 1944 9093 0000 sts (IntegralNick)+3,r25 |
2622 1948 0027 clr r16 |
2623 194a F7FC sbrc r15,7 |
2624 194c 0095 com r16 |
2625 194e 102F mov r17,r16 |
2626 1950 C801 movw r24,r16 |
2627 1952 B701 movw r22,r14 |
2628 1954 0E94 0000 call __mulsi3 |
2629 1958 6093 0000 sts IntegralRoll,r22 |
2630 195c 7093 0000 sts (IntegralRoll)+1,r23 |
2631 1960 8093 0000 sts (IntegralRoll)+2,r24 |
2632 1964 9093 0000 sts (IntegralRoll)+3,r25 |
2633 1968 6092 0000 sts Mess_IntegralNick2,r6 |
2634 196c 7092 0000 sts (Mess_IntegralNick2)+1,r7 |
2635 1970 8092 0000 sts (Mess_IntegralNick2)+2,r8 |
2636 1974 9092 0000 sts (Mess_IntegralNick2)+3,r9 |
2637 1978 6093 0000 sts Mess_IntegralRoll2,r22 |
2638 197c 7093 0000 sts (Mess_IntegralRoll2)+1,r23 |
2639 1980 8093 0000 sts (Mess_IntegralRoll2)+2,r24 |
2640 1984 9093 0000 sts (Mess_IntegralRoll2)+3,r25 |
2641 1988 1092 0000 sts Mess_Integral_Gier,__zero_reg__ |
2642 198c 1092 0000 sts (Mess_Integral_Gier)+1,__zero_reg__ |
2643 1990 1092 0000 sts (Mess_Integral_Gier)+2,__zero_reg__ |
2644 1994 1092 0000 sts (Mess_Integral_Gier)+3,__zero_reg__ |
2645 1998 8091 0000 lds r24,Luftdruck |
2646 199c 9091 0000 lds r25,(Luftdruck)+1 |
2647 19a0 A091 0000 lds r26,(Luftdruck)+2 |
2648 19a4 B091 0000 lds r27,(Luftdruck)+3 |
2649 19a8 9093 0000 sts (StartLuftdruck)+1,r25 |
2650 19ac 8093 0000 sts StartLuftdruck,r24 |
2651 19b0 1092 0000 sts (VarioMeter)+1,__zero_reg__ |
2652 19b4 1092 0000 sts VarioMeter,__zero_reg__ |
2653 19b8 1092 0000 sts Mess_Integral_Hoch,__zero_reg__ |
2654 19bc 1092 0000 sts (Mess_Integral_Hoch)+1,__zero_reg__ |
2655 19c0 1092 0000 sts (Mess_Integral_Hoch)+2,__zero_reg__ |
2656 19c4 1092 0000 sts (Mess_Integral_Hoch)+3,__zero_reg__ |
2657 19c8 8091 0000 lds r24,KompassValue |
2658 19cc 9091 0000 lds r25,(KompassValue)+1 |
2659 19d0 9093 0000 sts (KompassStartwert)+1,r25 |
2660 19d4 8093 0000 sts KompassStartwert,r24 |
2661 19d8 0E94 0000 call GPS_Neutral |
2662 19dc 82E3 ldi r24,lo8(50) |
2663 19de 90E0 ldi r25,hi8(50) |
2664 19e0 9093 0000 sts (beeptime)+1,r25 |
2665 19e4 8093 0000 sts beeptime,r24 |
2666 19e8 6091 0000 lds r22,EE_Parameter+63 |
2667 19ec 70E0 ldi r23,lo8(0) |
2668 19ee 80E0 ldi r24,lo8(0) |
2669 19f0 90E0 ldi r25,hi8(0) |
2670 19f2 24EC ldi r18,lo8(2500) |
2671 19f4 39E0 ldi r19,hi8(2500) |
2672 19f6 40E0 ldi r20,hlo8(2500) |
2673 19f8 50E0 ldi r21,hhi8(2500) |
2674 19fa 0E94 0000 call __mulsi3 |
2675 19fe 6856 subi r22,lo8(-(15000)) |
2676 1a00 754C sbci r23,hi8(-(15000)) |
2677 1a02 8F4F sbci r24,hlo8(-(15000)) |
2678 1a04 9F4F sbci r25,hhi8(-(15000)) |
2679 1a06 6093 0000 sts Umschlag180Nick,r22 |
2680 1a0a 7093 0000 sts (Umschlag180Nick)+1,r23 |
2681 1a0e 8093 0000 sts (Umschlag180Nick)+2,r24 |
2682 1a12 9093 0000 sts (Umschlag180Nick)+3,r25 |
2683 1a16 6091 0000 lds r22,EE_Parameter+64 |
2684 1a1a 70E0 ldi r23,lo8(0) |
2685 1a1c 80E0 ldi r24,lo8(0) |
2686 1a1e 90E0 ldi r25,hi8(0) |
2687 1a20 0E94 0000 call __mulsi3 |
2688 1a24 6856 subi r22,lo8(-(15000)) |
2689 1a26 754C sbci r23,hi8(-(15000)) |
2690 1a28 8F4F sbci r24,hlo8(-(15000)) |
2691 1a2a 9F4F sbci r25,hhi8(-(15000)) |
2692 1a2c 6093 0000 sts Umschlag180Roll,r22 |
2693 1a30 7093 0000 sts (Umschlag180Roll)+1,r23 |
2694 1a34 8093 0000 sts (Umschlag180Roll)+2,r24 |
2695 1a38 9093 0000 sts (Umschlag180Roll)+3,r25 |
2696 1a3c 1092 0000 sts (ExternHoehenValue)+1,__zero_reg__ |
2697 1a40 1092 0000 sts ExternHoehenValue,__zero_reg__ |
2698 1a44 6091 0000 lds r22,KompassValue |
2699 1a48 7091 0000 lds r23,(KompassValue)+1 |
2700 1a4c 8827 clr r24 |
2701 1a4e 77FD sbrc r23,7 |
2702 1a50 8095 com r24 |
2703 1a52 982F mov r25,r24 |
2704 1a54 2091 0000 lds r18,GIER_GRAD_FAKTOR |
2705 1a58 3091 0000 lds r19,(GIER_GRAD_FAKTOR)+1 |
2706 1a5c 4091 0000 lds r20,(GIER_GRAD_FAKTOR)+2 |
2707 1a60 5091 0000 lds r21,(GIER_GRAD_FAKTOR)+3 |
2708 1a64 0E94 0000 call __mulsi3 |
2709 1a68 6093 0000 sts ErsatzKompass,r22 |
2710 1a6c 7093 0000 sts (ErsatzKompass)+1,r23 |
2711 1a70 8093 0000 sts (ErsatzKompass)+2,r24 |
2712 1a74 9093 0000 sts (ErsatzKompass)+3,r25 |
2713 1a78 1092 0000 sts (GierGyroFehler)+1,__zero_reg__ |
2714 1a7c 1092 0000 sts GierGyroFehler,__zero_reg__ |
2715 1a80 81E0 ldi r24,lo8(1) |
2716 1a82 8093 0000 sts SendVersionToNavi,r24 |
2717 1a86 0E94 0000 call LED_Init |
2718 1a8a 8091 0000 lds r24,FCFlags |
2719 1a8e 8460 ori r24,lo8(4) |
2720 1a90 8093 0000 sts FCFlags,r24 |
2721 1a94 8FEF ldi r24,lo8(-1) |
2722 1a96 8093 0000 sts FromNaviCtrl_Value,r24 |
2723 1a9a 1092 0000 sts FromNaviCtrl_Value+1,__zero_reg__ |
2724 1a9e 80E2 ldi r24,lo8(32) |
2725 1aa0 8093 0000 sts FromNaviCtrl_Value+2,r24 |
2726 1aa4 A0E0 ldi r26,lo8(EE_Parameter+5) |
2727 1aa6 B0E0 ldi r27,hi8(EE_Parameter+5) |
2728 1aa8 C0E0 ldi r28,lo8(Poti) |
2729 1aaa D0E0 ldi r29,hi8(Poti) |
2730 .L219: |
2731 1aac ED91 ld r30,X+ |
2732 1aae F0E0 ldi r31,lo8(0) |
2733 1ab0 EE0F lsl r30 |
2734 1ab2 FF1F rol r31 |
2735 1ab4 E050 subi r30,lo8(-(PPM_in)) |
2736 1ab6 F040 sbci r31,hi8(-(PPM_in)) |
2737 1ab8 8081 ld r24,Z |
2738 1aba 9181 ldd r25,Z+1 |
2739 1abc 8259 subi r24,lo8(-(110)) |
2740 1abe 8993 st Y+,r24 |
2741 1ac0 F0E0 ldi r31,hi8(EE_Parameter+13) |
2742 1ac2 A030 cpi r26,lo8(EE_Parameter+13) |
2743 1ac4 BF07 cpc r27,r31 |
2744 1ac6 01F4 brne .L219 |
2745 1ac8 84E6 ldi r24,lo8(100) |
2746 1aca 8093 0000 sts SenderOkay,r24 |
2747 1ace 8091 0000 lds r24,ServoActive |
2748 1ad2 8823 tst r24 |
2749 1ad4 01F0 breq .L220 |
2750 1ad6 469A sbi 40-32,6 |
2751 1ad8 579A sbi 42-32,7 |
2752 .L220: |
2753 1ada 8091 0000 lds r24,AdNeutralNick |
2754 1ade 9091 0000 lds r25,(AdNeutralNick)+1 |
2755 1ae2 8056 subi r24,lo8(-(-2400)) |
2756 1ae4 9940 sbci r25,hi8(-(-2400)) |
2757 1ae6 815C subi r24,lo8(11201) |
2758 1ae8 9B42 sbci r25,hi8(11201) |
2759 1aea 00F0 brlo .L221 |
2760 1aec 8091 0000 lds r24,VersionInfo+5 |
2761 1af0 8160 ori r24,lo8(1) |
2762 1af2 8093 0000 sts VersionInfo+5,r24 |
2763 .L221: |
2764 1af6 8091 0000 lds r24,AdNeutralRoll |
2765 1afa 9091 0000 lds r25,(AdNeutralRoll)+1 |
2766 1afe 8056 subi r24,lo8(-(-2400)) |
2767 1b00 9940 sbci r25,hi8(-(-2400)) |
2768 1b02 815C subi r24,lo8(11201) |
2769 1b04 9B42 sbci r25,hi8(11201) |
2770 1b06 00F0 brlo .L222 |
2771 1b08 8091 0000 lds r24,VersionInfo+5 |
2772 1b0c 8260 ori r24,lo8(2) |
2773 1b0e 8093 0000 sts VersionInfo+5,r24 |
2774 .L222: |
2775 1b12 8091 0000 lds r24,AdNeutralGier |
2776 1b16 9091 0000 lds r25,(AdNeutralGier)+1 |
2777 1b1a 8C52 subi r24,lo8(-(-300)) |
2778 1b1c 9140 sbci r25,hi8(-(-300)) |
2779 1b1e 8957 subi r24,lo8(1401) |
2780 1b20 9540 sbci r25,hi8(1401) |
2781 1b22 00F0 brlo .L223 |
2782 1b24 8091 0000 lds r24,VersionInfo+5 |
2783 1b28 8460 ori r24,lo8(4) |
2784 1b2a 8093 0000 sts VersionInfo+5,r24 |
2785 .L223: |
2786 1b2e 8091 0000 lds r24,NeutralAccX |
2787 1b32 9091 0000 lds r25,(NeutralAccX)+1 |
2788 1b36 8C52 subi r24,lo8(-(-300)) |
2789 1b38 9140 sbci r25,hi8(-(-300)) |
2790 1b3a 835C subi r24,lo8(451) |
2791 1b3c 9140 sbci r25,hi8(451) |
2792 1b3e 00F0 brlo .L224 |
2793 1b40 8091 0000 lds r24,VersionInfo+5 |
2794 1b44 8860 ori r24,lo8(8) |
2795 1b46 8093 0000 sts VersionInfo+5,r24 |
2796 .L224: |
2797 1b4a 8091 0000 lds r24,NeutralAccY |
2798 1b4e 9091 0000 lds r25,(NeutralAccY)+1 |
2799 1b52 8C52 subi r24,lo8(-(-300)) |
2800 1b54 9140 sbci r25,hi8(-(-300)) |
2801 1b56 835C subi r24,lo8(451) |
2802 1b58 9140 sbci r25,hi8(451) |
2803 1b5a 00F0 brlo .L225 |
2804 1b5c 8091 0000 lds r24,VersionInfo+5 |
2805 1b60 8061 ori r24,lo8(16) |
2806 1b62 8093 0000 sts VersionInfo+5,r24 |
2807 .L225: |
2808 1b66 8091 0000 lds r24,NeutralAccZ |
2809 1b6a 9091 0000 lds r25,(NeutralAccZ)+1 |
2810 1b6e 8050 subi r24,lo8(-(-512)) |
2811 1b70 9240 sbci r25,hi8(-(-512)) |
2812 1b72 8355 subi r24,lo8(339) |
2813 1b74 9140 sbci r25,hi8(339) |
2814 1b76 00F0 brlo .L227 |
2815 1b78 8091 0000 lds r24,VersionInfo+5 |
2816 1b7c 8062 ori r24,lo8(32) |
2817 1b7e 8093 0000 sts VersionInfo+5,r24 |
2818 .L227: |
2819 /* epilogue start */ |
2820 1b82 CDB7 in r28,__SP_L__ |
2821 1b84 DEB7 in r29,__SP_H__ |
2822 1b86 EEE0 ldi r30, lo8(14) |
2823 1b88 0C94 0000 jmp __epilogue_restores__ + ((18 - 14) * 2) |
2825 .global Piep |
2827 Piep: |
2828 1b8c EF92 push r14 |
2829 1b8e FF92 push r15 |
2830 1b90 1F93 push r17 |
2831 1b92 CF93 push r28 |
2832 1b94 DF93 push r29 |
2833 /* prologue: function */ |
2834 /* frame size = 0 */ |
2835 1b96 182F mov r17,r24 |
2836 1b98 EB01 movw r28,r22 |
2837 1b9a 8091 0000 lds r24,MotorenEin |
2838 1b9e 8823 tst r24 |
2839 1ba0 01F4 brne .L235 |
2840 1ba2 7B01 movw r14,r22 |
2841 1ba4 EE0C lsl r14 |
2842 1ba6 FF1C rol r15 |
2843 1ba8 00C0 rjmp .L232 |
2844 .L234: |
2845 1baa D093 0000 sts (beeptime)+1,r29 |
2846 1bae C093 0000 sts beeptime,r28 |
2847 .L233: |
2848 1bb2 8091 0000 lds r24,beeptime |
2849 1bb6 9091 0000 lds r25,(beeptime)+1 |
2850 1bba 892B or r24,r25 |
2851 1bbc 01F4 brne .L233 |
2852 1bbe C701 movw r24,r14 |
2853 1bc0 0E94 0000 call Delay_ms |
2854 1bc4 1150 subi r17,lo8(-(-1)) |
2855 .L232: |
2856 1bc6 1123 tst r17 |
2857 1bc8 01F4 brne .L234 |
2858 .L235: |
2859 /* epilogue start */ |
2860 1bca DF91 pop r29 |
2861 1bcc CF91 pop r28 |
2862 1bce 1F91 pop r17 |
2863 1bd0 FF90 pop r15 |
2864 1bd2 EF90 pop r14 |
2865 1bd4 0895 ret |
2867 .global MotorRegler |
2869 MotorRegler: |
2870 1bd6 A5E4 ldi r26,lo8(69) |
2871 1bd8 B0E0 ldi r27,hi8(69) |
2872 1bda E0E0 ldi r30,lo8(gs(1f)) |
2873 1bdc F0E0 ldi r31,hi8(gs(1f)) |
2874 1bde 0C94 0000 jmp __prologue_saves__+((18 - 18) * 2) |
2875 1: |
2876 /* prologue: function */ |
2877 /* frame size = 69 */ |
2878 1be2 0E94 0000 call Mittelwert |
2879 1be6 8091 0000 lds r24,PlatinenVersion |
2880 1bea 8C30 cpi r24,lo8(12) |
2881 1bec 00F4 brsh .L238 |
2882 1bee 299A sbi 37-32,1 |
2883 1bf0 00C0 rjmp .L239 |
2884 .L238: |
2885 1bf2 2998 cbi 37-32,1 |
2886 .L239: |
2887 1bf4 2091 0000 lds r18,StickGas |
2888 1bf8 3091 0000 lds r19,(StickGas)+1 |
2889 1bfc 3FA3 std Y+39,r19 |
2890 1bfe 2EA3 std Y+38,r18 |
2891 1c00 8091 0000 lds r24,MIN_GAS |
2892 1c04 282F mov r18,r24 |
2893 1c06 30E0 ldi r19,lo8(0) |
2894 1c08 C901 movw r24,r18 |
2895 1c0a 0996 adiw r24,9 |
2896 1c0c 4EA1 ldd r20,Y+38 |
2897 1c0e 5FA1 ldd r21,Y+39 |
2898 1c10 8417 cp r24,r20 |
2899 1c12 9507 cpc r25,r21 |
2900 1c14 04F0 brlt .L240 |
2901 1c16 B901 movw r22,r18 |
2902 1c18 665F subi r22,lo8(-(10)) |
2903 1c1a 7F4F sbci r23,hi8(-(10)) |
2904 1c1c 7FA3 std Y+39,r23 |
2905 1c1e 6EA3 std Y+38,r22 |
2906 .L240: |
2907 1c20 8091 0000 lds r24,SenderOkay |
2908 1c24 8436 cpi r24,lo8(100) |
2909 1c26 00F0 brlo .+2 |
2910 1c28 00C0 rjmp .L241 |
2911 1c2a 8091 0000 lds r24,RcLostTimer.3047 |
2912 1c2e 9091 0000 lds r25,(RcLostTimer.3047)+1 |
2913 1c32 0097 sbiw r24,0 |
2914 1c34 01F0 breq .L242 |
2915 1c36 0197 sbiw r24,1 |
2916 1c38 9093 0000 sts (RcLostTimer.3047)+1,r25 |
2917 1c3c 8093 0000 sts RcLostTimer.3047,r24 |
2918 1c40 00C0 rjmp .L243 |
2919 .L242: |
2920 1c42 1092 0000 sts MotorenEin,__zero_reg__ |
2921 1c46 8091 0000 lds r24,FCFlags |
2922 1c4a 8F7E andi r24,lo8(-17) |
2923 1c4c 8093 0000 sts FCFlags,r24 |
2924 .L243: |
2925 1c50 8091 0000 lds r24,PlatinenVersion |
2926 1c54 8A30 cpi r24,lo8(10) |
2927 1c56 01F0 breq .L244 |
2928 1c58 8431 cpi r24,lo8(20) |
2929 1c5a 00F0 brlo .L245 |
2930 .L244: |
2931 1c5c 289A sbi 37-32,0 |
2932 1c5e 00C0 rjmp .L246 |
2933 .L245: |
2934 1c60 2898 cbi 37-32,0 |
2935 .L246: |
2936 1c62 8091 0000 lds r24,modell_fliegt |
2937 1c66 9091 0000 lds r25,(modell_fliegt)+1 |
2938 1c6a 895E subi r24,lo8(1001) |
2939 1c6c 9340 sbci r25,hi8(1001) |
2940 1c6e 00F0 brlo .L247 |
2941 1c70 8091 0000 lds r24,EE_Parameter+37 |
2942 1c74 A82F mov r26,r24 |
2943 1c76 B0E0 ldi r27,lo8(0) |
2944 1c78 BFA3 std Y+39,r27 |
2945 1c7a AEA3 std Y+38,r26 |
2946 1c7c 8091 0000 lds r24,FCFlags |
2947 1c80 8061 ori r24,lo8(16) |
2948 1c82 8093 0000 sts FCFlags,r24 |
2949 1c86 A091 0000 lds r26,EE_Parameter+1 |
2950 1c8a B0E0 ldi r27,lo8(0) |
2951 1c8c AA0F lsl r26 |
2952 1c8e BB1F rol r27 |
2953 1c90 FD01 movw r30,r26 |
2954 1c92 E050 subi r30,lo8(-(PPM_diff)) |
2955 1c94 F040 sbci r31,hi8(-(PPM_diff)) |
2956 1c96 1182 std Z+1,__zero_reg__ |
2957 1c98 1082 st Z,__zero_reg__ |
2958 1c9a E091 0000 lds r30,EE_Parameter+2 |
2959 1c9e 2E2F mov r18,r30 |
2960 1ca0 30E0 ldi r19,lo8(0) |
2961 1ca2 220F lsl r18 |
2962 1ca4 331F rol r19 |
2963 1ca6 C901 movw r24,r18 |
2964 1ca8 8050 subi r24,lo8(-(PPM_diff)) |
2965 1caa 9040 sbci r25,hi8(-(PPM_diff)) |
2966 1cac FC01 movw r30,r24 |
2967 1cae 1182 std Z+1,__zero_reg__ |
2968 1cb0 1082 st Z,__zero_reg__ |
2969 1cb2 A050 subi r26,lo8(-(PPM_in)) |
2970 1cb4 B040 sbci r27,hi8(-(PPM_in)) |
2971 1cb6 1196 adiw r26,1 |
2972 1cb8 1C92 st X,__zero_reg__ |
2973 1cba 1E92 st -X,__zero_reg__ |
2974 1cbc 2050 subi r18,lo8(-(PPM_in)) |
2975 1cbe 3040 sbci r19,hi8(-(PPM_in)) |
2976 1cc0 D901 movw r26,r18 |
2977 1cc2 1196 adiw r26,1 |
2978 1cc4 1C92 st X,__zero_reg__ |
2979 1cc6 1E92 st -X,__zero_reg__ |
2980 1cc8 E091 0000 lds r30,EE_Parameter+4 |
2981 1ccc F0E0 ldi r31,lo8(0) |
2982 1cce EE0F lsl r30 |
2983 1cd0 FF1F rol r31 |
2984 1cd2 E050 subi r30,lo8(-(PPM_in)) |
2985 1cd4 F040 sbci r31,hi8(-(PPM_in)) |
2986 1cd6 1182 std Z+1,__zero_reg__ |
2987 1cd8 1082 st Z,__zero_reg__ |
2988 1cda 00C0 rjmp .L248 |
2989 .L247: |
2990 1cdc 1092 0000 sts MotorenEin,__zero_reg__ |
2991 1ce0 00C0 rjmp .L248 |
2992 .L241: |
2993 1ce2 8091 0000 lds r24,SenderOkay |
2994 1ce6 8D38 cpi r24,lo8(-115) |
2995 1ce8 00F4 brsh .+2 |
2996 1cea 00C0 rjmp .L248 |
2997 1cec 8091 0000 lds r24,FCFlags |
2998 1cf0 8F7E andi r24,lo8(-17) |
2999 1cf2 8093 0000 sts FCFlags,r24 |
3000 1cf6 8091 0000 lds r24,EE_Parameter+38 |
3001 1cfa 22E3 ldi r18,lo8(50) |
3002 1cfc 829F mul r24,r18 |
3003 1cfe C001 movw r24,r0 |
3004 1d00 1124 clr r1 |
3005 1d02 9093 0000 sts (RcLostTimer.3047)+1,r25 |
3006 1d06 8093 0000 sts RcLostTimer.3047,r24 |
3007 1d0a EEA1 ldd r30,Y+38 |
3008 1d0c FFA1 ldd r31,Y+39 |
3009 1d0e B997 sbiw r30,41 |
3010 1d10 04F0 brlt .L249 |
3011 1d12 8091 0000 lds r24,MotorenEin |
3012 1d16 8823 tst r24 |
3013 1d18 01F0 breq .L249 |
3014 1d1a 8091 0000 lds r24,modell_fliegt |
3015 1d1e 9091 0000 lds r25,(modell_fliegt)+1 |
3016 1d22 FFEF ldi r31,hi8(-1) |
3017 1d24 8F3F cpi r24,lo8(-1) |
3018 1d26 9F07 cpc r25,r31 |
3019 1d28 01F0 breq .L249 |
3020 1d2a 0196 adiw r24,1 |
3021 1d2c 9093 0000 sts (modell_fliegt)+1,r25 |
3022 1d30 8093 0000 sts modell_fliegt,r24 |
3023 .L249: |
3024 1d34 8091 0000 lds r24,modell_fliegt |
3025 1d38 9091 0000 lds r25,(modell_fliegt)+1 |
3026 1d3c 8F3F cpi r24,255 |
3027 1d3e 9105 cpc r25,__zero_reg__ |
3028 1d40 01F0 breq .+2 |
3029 1d42 00F4 brsh .L250 |
3030 1d44 1092 0000 sts SummeNick,__zero_reg__ |
3031 1d48 1092 0000 sts (SummeNick)+1,__zero_reg__ |
3032 1d4c 1092 0000 sts (SummeNick)+2,__zero_reg__ |
3033 1d50 1092 0000 sts (SummeNick)+3,__zero_reg__ |
3034 1d54 1092 0000 sts SummeRoll,__zero_reg__ |
3035 1d58 1092 0000 sts (SummeRoll)+1,__zero_reg__ |
3036 1d5c 1092 0000 sts (SummeRoll)+2,__zero_reg__ |
3037 1d60 1092 0000 sts (SummeRoll)+3,__zero_reg__ |
3038 1d64 1092 0000 sts sollGier.3042,__zero_reg__ |
3039 1d68 1092 0000 sts (sollGier.3042)+1,__zero_reg__ |
3040 1d6c 1092 0000 sts (sollGier.3042)+2,__zero_reg__ |
3041 1d70 1092 0000 sts (sollGier.3042)+3,__zero_reg__ |
3042 1d74 1092 0000 sts Mess_Integral_Gier,__zero_reg__ |
3043 1d78 1092 0000 sts (Mess_Integral_Gier)+1,__zero_reg__ |
3044 1d7c 1092 0000 sts (Mess_Integral_Gier)+2,__zero_reg__ |
3045 1d80 1092 0000 sts (Mess_Integral_Gier)+3,__zero_reg__ |
3046 1d84 8A3F cpi r24,250 |
3047 1d86 9105 cpc r25,__zero_reg__ |
3048 1d88 01F4 brne .L251 |
3049 1d8a 81E0 ldi r24,lo8(1) |
3050 1d8c 8093 0000 sts NeueKompassRichtungMerken.3052,r24 |
3051 1d90 00C0 rjmp .L251 |
3052 .L250: |
3053 1d92 8091 0000 lds r24,FCFlags |
3054 1d96 8260 ori r24,lo8(2) |
3055 1d98 8093 0000 sts FCFlags,r24 |
3056 .L251: |
3057 1d9c E091 0000 lds r30,EE_Parameter+3 |
3058 1da0 F0E0 ldi r31,lo8(0) |
3059 1da2 EE0F lsl r30 |
3060 1da4 FF1F rol r31 |
3061 1da6 E050 subi r30,lo8(-(PPM_in)) |
3062 1da8 F040 sbci r31,hi8(-(PPM_in)) |
3063 1daa 8081 ld r24,Z |
3064 1dac 9181 ldd r25,Z+1 |
3065 1dae 8135 cpi r24,81 |
3066 1db0 9105 cpc r25,__zero_reg__ |
3067 1db2 04F4 brge .+2 |
3068 1db4 00C0 rjmp .L252 |
3069 1db6 8091 0000 lds r24,MotorenEin |
3070 1dba 8823 tst r24 |
3071 1dbc 01F0 breq .+2 |
3072 1dbe 00C0 rjmp .L252 |
3073 1dc0 8091 0000 lds r24,EE_Parameter+4 |
3074 1dc4 E82F mov r30,r24 |
3075 1dc6 F0E0 ldi r31,lo8(0) |
3076 1dc8 EE0F lsl r30 |
3077 1dca FF1F rol r31 |
3078 1dcc E050 subi r30,lo8(-(PPM_in)) |
3079 1dce F040 sbci r31,hi8(-(PPM_in)) |
3080 1dd0 8081 ld r24,Z |
3081 1dd2 9181 ldd r25,Z+1 |
3082 1dd4 8C34 cpi r24,76 |
3083 1dd6 9105 cpc r25,__zero_reg__ |
3084 1dd8 04F4 brge .+2 |
3085 1dda 00C0 rjmp .L253 |
3086 1ddc 8091 0000 lds r24,delay_neutral.3048 |
3087 1de0 8F5F subi r24,lo8(-(1)) |
3088 1de2 8093 0000 sts delay_neutral.3048,r24 |
3089 1de6 893C cpi r24,lo8(-55) |
3090 1de8 00F4 brsh .+2 |
3091 1dea 00C0 rjmp .L252 |
3092 1dec 8091 0000 lds r24,PlatinenVersion |
3093 1df0 8C30 cpi r24,lo8(12) |
3094 1df2 00F4 brsh .L254 |
3095 1df4 2998 cbi 37-32,1 |
3096 1df6 00C0 rjmp .L255 |
3097 .L254: |
3098 1df8 299A sbi 37-32,1 |
3099 .L255: |
3100 1dfa 1092 0000 sts MotorenEin,__zero_reg__ |
3101 1dfe 1092 0000 sts delay_neutral.3048,__zero_reg__ |
3102 1e02 1092 0000 sts (modell_fliegt)+1,__zero_reg__ |
3103 1e06 1092 0000 sts modell_fliegt,__zero_reg__ |
3104 1e0a 8091 0000 lds r24,EE_Parameter+1 |
3105 1e0e 282F mov r18,r24 |
3106 1e10 30E0 ldi r19,lo8(0) |
3107 1e12 F901 movw r30,r18 |
3108 1e14 EE0F lsl r30 |
3109 1e16 FF1F rol r31 |
3110 1e18 E050 subi r30,lo8(-(PPM_in)) |
3111 1e1a F040 sbci r31,hi8(-(PPM_in)) |
3112 1e1c 8081 ld r24,Z |
3113 1e1e 9181 ldd r25,Z+1 |
3114 1e20 8734 cpi r24,71 |
3115 1e22 9105 cpc r25,__zero_reg__ |
3116 1e24 04F4 brge .L256 |
3117 1e26 E091 0000 lds r30,EE_Parameter+2 |
3118 1e2a F0E0 ldi r31,lo8(0) |
3119 1e2c EE0F lsl r30 |
3120 1e2e FF1F rol r31 |
3121 1e30 E050 subi r30,lo8(-(PPM_in)) |
3122 1e32 F040 sbci r31,hi8(-(PPM_in)) |
3123 1e34 0190 ld __tmp_reg__,Z+ |
3124 1e36 F081 ld r31,Z |
3125 1e38 E02D mov r30,__tmp_reg__ |
3126 1e3a F7FF sbrs r31,7 |
3127 1e3c 00C0 rjmp .L258 |
3128 1e3e F095 com r31 |
3129 1e40 E195 neg r30 |
3130 1e42 FF4F sbci r31,lo8(-1) |
3131 .L258: |
3132 1e44 E734 cpi r30,71 |
3133 1e46 F105 cpc r31,__zero_reg__ |
3134 1e48 04F4 brge .+2 |
3135 1e4a 00C0 rjmp .L257 |
3136 .L256: |
3137 1e4c 8091 0000 lds r24,EE_Parameter+2 |
3138 1e50 A82F mov r26,r24 |
3139 1e52 B0E0 ldi r27,lo8(0) |
3140 1e54 FD01 movw r30,r26 |
3141 1e56 EE0F lsl r30 |
3142 1e58 FF1F rol r31 |
3143 1e5a E050 subi r30,lo8(-(PPM_in)) |
3144 1e5c F040 sbci r31,hi8(-(PPM_in)) |
3145 1e5e 8081 ld r24,Z |
3146 1e60 9181 ldd r25,Z+1 |
3147 1e62 8734 cpi r24,71 |
3148 1e64 9105 cpc r25,__zero_reg__ |
3149 1e66 04F0 brlt .L259 |
3150 1e68 F901 movw r30,r18 |
3151 1e6a EE0F lsl r30 |
3152 1e6c FF1F rol r31 |
3153 1e6e E050 subi r30,lo8(-(PPM_in)) |
3154 1e70 F040 sbci r31,hi8(-(PPM_in)) |
3155 1e72 0190 ld __tmp_reg__,Z+ |
3156 1e74 F081 ld r31,Z |
3157 1e76 E02D mov r30,__tmp_reg__ |
3158 .L259: |
3159 1e78 FD01 movw r30,r26 |
3160 1e7a EE0F lsl r30 |
3161 1e7c FF1F rol r31 |
3162 1e7e E050 subi r30,lo8(-(PPM_in)) |
3163 1e80 F040 sbci r31,hi8(-(PPM_in)) |
3164 1e82 8081 ld r24,Z |
3165 1e84 9181 ldd r25,Z+1 |
3166 1e86 8734 cpi r24,71 |
3167 1e88 9105 cpc r25,__zero_reg__ |
3168 1e8a 04F0 brlt .L260 |
3169 1e8c F901 movw r30,r18 |
3170 1e8e EE0F lsl r30 |
3171 1e90 FF1F rol r31 |
3172 1e92 E050 subi r30,lo8(-(PPM_in)) |
3173 1e94 F040 sbci r31,hi8(-(PPM_in)) |
3174 1e96 8081 ld r24,Z |
3175 1e98 9181 ldd r25,Z+1 |
3176 1e9a 8734 cpi r24,71 |
3177 1e9c 9105 cpc r25,__zero_reg__ |
3178 1e9e 04F0 brlt .L260 |
3179 1ea0 42E0 ldi r20,lo8(2) |
3180 1ea2 00C0 rjmp .L261 |
3181 .L260: |
3182 1ea4 41E0 ldi r20,lo8(1) |
3183 .L261: |
3184 1ea6 FD01 movw r30,r26 |
3185 1ea8 EE0F lsl r30 |
3186 1eaa FF1F rol r31 |
3187 1eac E050 subi r30,lo8(-(PPM_in)) |
3188 1eae F040 sbci r31,hi8(-(PPM_in)) |
3189 1eb0 8081 ld r24,Z |
3190 1eb2 9181 ldd r25,Z+1 |
3191 1eb4 8634 cpi r24,70 |
3192 1eb6 9105 cpc r25,__zero_reg__ |
3193 1eb8 04F4 brge .L262 |
3194 1eba F901 movw r30,r18 |
3195 1ebc EE0F lsl r30 |
3196 1ebe FF1F rol r31 |
3197 1ec0 E050 subi r30,lo8(-(PPM_in)) |
3198 1ec2 F040 sbci r31,hi8(-(PPM_in)) |
3199 1ec4 8081 ld r24,Z |
3200 1ec6 9181 ldd r25,Z+1 |
3201 1ec8 8734 cpi r24,71 |
3202 1eca 9105 cpc r25,__zero_reg__ |
3203 1ecc 04F0 brlt .L262 |
3204 1ece 43E0 ldi r20,lo8(3) |
3205 .L262: |
3206 1ed0 FD01 movw r30,r26 |
3207 1ed2 EE0F lsl r30 |
3208 1ed4 FF1F rol r31 |
3209 1ed6 E050 subi r30,lo8(-(PPM_in)) |
3210 1ed8 F040 sbci r31,hi8(-(PPM_in)) |
3211 1eda 8081 ld r24,Z |
3212 1edc 9181 ldd r25,Z+1 |
3213 1ede 8A5B subi r24,lo8(-70) |
3214 1ee0 9F4F sbci r25,hi8(-70) |
3215 1ee2 04F4 brge .L263 |
3216 1ee4 F901 movw r30,r18 |
3217 1ee6 EE0F lsl r30 |
3218 1ee8 FF1F rol r31 |
3219 1eea E050 subi r30,lo8(-(PPM_in)) |
3220 1eec F040 sbci r31,hi8(-(PPM_in)) |
3221 1eee 8081 ld r24,Z |
3222 1ef0 9181 ldd r25,Z+1 |
3223 1ef2 8734 cpi r24,71 |
3224 1ef4 9105 cpc r25,__zero_reg__ |
3225 1ef6 04F0 brlt .L263 |
3226 1ef8 44E0 ldi r20,lo8(4) |
3227 .L263: |
3228 1efa AA0F lsl r26 |
3229 1efc BB1F rol r27 |
3230 1efe A050 subi r26,lo8(-(PPM_in)) |
3231 1f00 B040 sbci r27,hi8(-(PPM_in)) |
3232 1f02 8D91 ld r24,X+ |
3233 1f04 9C91 ld r25,X |
3234 1f06 8A5B subi r24,lo8(-70) |
3235 1f08 9F4F sbci r25,hi8(-70) |
3236 1f0a 04F4 brge .L264 |
3237 1f0c 220F lsl r18 |
3238 1f0e 331F rol r19 |
3239 1f10 2050 subi r18,lo8(-(PPM_in)) |
3240 1f12 3040 sbci r19,hi8(-(PPM_in)) |
3241 1f14 D901 movw r26,r18 |
3242 1f16 8D91 ld r24,X+ |
3243 1f18 9C91 ld r25,X |
3244 1f1a 8634 cpi r24,70 |
3245 1f1c 9105 cpc r25,__zero_reg__ |
3246 1f1e 04F4 brge .L264 |
3247 1f20 45E0 ldi r20,lo8(5) |
3248 .L264: |
3249 1f22 842F mov r24,r20 |
3250 1f24 0E94 0000 call SetActiveParamSet |
3251 .L257: |
3252 1f28 E091 0000 lds r30,EE_Parameter+2 |
3253 1f2c F0E0 ldi r31,lo8(0) |
3254 1f2e EE0F lsl r30 |
3255 1f30 FF1F rol r31 |
3256 1f32 E050 subi r30,lo8(-(PPM_in)) |
3257 1f34 F040 sbci r31,hi8(-(PPM_in)) |
3258 1f36 0190 ld __tmp_reg__,Z+ |
3259 1f38 F081 ld r31,Z |
3260 1f3a E02D mov r30,__tmp_reg__ |
3261 1f3c F7FF sbrs r31,7 |
3262 1f3e 00C0 rjmp .L266 |
3263 1f40 F095 com r31 |
3264 1f42 E195 neg r30 |
3265 1f44 FF4F sbci r31,lo8(-1) |
3266 .L266: |
3267 1f46 7E97 sbiw r30,30 |
3268 1f48 04F4 brge .L265 |
3269 1f4a E091 0000 lds r30,EE_Parameter+1 |
3270 1f4e F0E0 ldi r31,lo8(0) |
3271 1f50 EE0F lsl r30 |
3272 1f52 FF1F rol r31 |
3273 1f54 E050 subi r30,lo8(-(PPM_in)) |
3274 1f56 F040 sbci r31,hi8(-(PPM_in)) |
3275 1f58 8081 ld r24,Z |
3276 1f5a 9181 ldd r25,Z+1 |
3277 1f5c 8A5B subi r24,lo8(-70) |
3278 1f5e 9F4F sbci r25,hi8(-70) |
3279 1f60 04F4 brge .L265 |
3280 1f62 81E0 ldi r24,lo8(1) |
3281 1f64 8093 0000 sts WinkelOut+6,r24 |
3282 1f68 88EE ldi r24,lo8(1000) |
3283 1f6a 93E0 ldi r25,hi8(1000) |
3284 1f6c 9093 0000 sts (beeptime)+1,r25 |
3285 1f70 8093 0000 sts beeptime,r24 |
3286 1f74 00C0 rjmp .L252 |
3287 .L265: |
3288 1f76 0E94 0000 call GetActiveParamSet |
3289 1f7a 0E94 0000 call ParamSet_ReadFromEEProm |
3290 1f7e 80E0 ldi r24,lo8(0) |
3291 1f80 0E94 0000 call LipoDetection |
3292 1f84 8091 0000 lds r24,EE_Parameter+39 |
3293 1f88 0E94 0000 call LIBFC_ReceiverInit |
3294 1f8c 8091 0000 lds r24,EE_Parameter+13 |
3295 1f90 80FF sbrs r24,0 |
3296 1f92 00C0 rjmp .L267 |
3297 1f94 8091 0000 lds r24,MessLuftdruck |
3298 1f98 9091 0000 lds r25,(MessLuftdruck)+1 |
3299 1f9c 875B subi r24,lo8(951) |
3300 1f9e 9340 sbci r25,hi8(951) |
3301 1fa0 00F4 brsh .L268 |
3302 1fa2 8091 0000 lds r24,MessLuftdruck |
3303 1fa6 9091 0000 lds r25,(MessLuftdruck)+1 |
3304 1faa 8E5E subi r24,lo8(750) |
3305 1fac 9240 sbci r25,hi8(750) |
3306 1fae 00F4 brsh .L267 |
3307 .L268: |
3308 1fb0 0E94 0000 call SucheLuftruckOffset |
3309 .L267: |
3310 1fb4 1092 0000 sts ServoActive,__zero_reg__ |
3311 1fb8 80E0 ldi r24,lo8(0) |
3312 1fba 0E94 0000 call SetNeutral |
3313 1fbe 81E0 ldi r24,lo8(1) |
3314 1fc0 8093 0000 sts calibration_done.3051,r24 |
3315 1fc4 8093 0000 sts ServoActive,r24 |
3316 1fc8 579A sbi 42-32,7 |
3317 1fca 00C0 rjmp .L529 |
3318 .L253: |
3319 1fcc 8081 ld r24,Z |
3320 1fce 9181 ldd r25,Z+1 |
3321 1fd0 855B subi r24,lo8(-75) |
3322 1fd2 9F4F sbci r25,hi8(-75) |
3323 1fd4 04F4 brge .L269 |
3324 1fd6 8091 0000 lds r24,delay_neutral.3048 |
3325 1fda 8F5F subi r24,lo8(-(1)) |
3326 1fdc 8093 0000 sts delay_neutral.3048,r24 |
3327 1fe0 893C cpi r24,lo8(-55) |
3328 1fe2 00F0 brlo .L252 |
3329 1fe4 8091 0000 lds r24,PlatinenVersion |
3330 1fe8 8C30 cpi r24,lo8(12) |
3331 1fea 00F4 brsh .L270 |
3332 1fec 2998 cbi 37-32,1 |
3333 1fee 00C0 rjmp .L271 |
3334 .L270: |
3335 1ff0 299A sbi 37-32,1 |
3336 .L271: |
3337 1ff2 1092 0000 sts MotorenEin,__zero_reg__ |
3338 1ff6 1092 0000 sts delay_neutral.3048,__zero_reg__ |
3339 1ffa 1092 0000 sts (modell_fliegt)+1,__zero_reg__ |
3340 1ffe 1092 0000 sts modell_fliegt,__zero_reg__ |
3341 2002 81E0 ldi r24,lo8(1) |
3342 2004 0E94 0000 call SetNeutral |
3343 2008 81E0 ldi r24,lo8(1) |
3344 200a 8093 0000 sts calibration_done.3051,r24 |
3345 .L529: |
3346 200e 0E94 0000 call GetActiveParamSet |
3347 2012 68E7 ldi r22,lo8(120) |
3348 2014 70E0 ldi r23,hi8(120) |
3349 2016 0E94 0000 call Piep |
3350 201a 00C0 rjmp .L252 |
3351 .L269: |
3352 201c 1092 0000 sts delay_neutral.3048,__zero_reg__ |
3353 .L252: |
3354 2020 E091 0000 lds r30,EE_Parameter+3 |
3355 2024 F0E0 ldi r31,lo8(0) |
3356 2026 EE0F lsl r30 |
3357 2028 FF1F rol r31 |
3358 202a E050 subi r30,lo8(-(PPM_in)) |
3359 202c F040 sbci r31,hi8(-(PPM_in)) |
3360 202e 8081 ld r24,Z |
3361 2030 9181 ldd r25,Z+1 |
3362 2032 8B5A subi r24,lo8(-85) |
3363 2034 9F4F sbci r25,hi8(-85) |
3364 2036 04F0 brlt .+2 |
3365 2038 00C0 rjmp .L248 |
3366 203a 8091 0000 lds r24,MotorenEin |
3367 203e 8823 tst r24 |
3368 2040 01F0 breq .+2 |
3369 2042 00C0 rjmp .L272 |
3370 2044 E091 0000 lds r30,EE_Parameter+4 |
3371 2048 F0E0 ldi r31,lo8(0) |
3372 204a EE0F lsl r30 |
3373 204c FF1F rol r31 |
3374 204e E050 subi r30,lo8(-(PPM_in)) |
3375 2050 F040 sbci r31,hi8(-(PPM_in)) |
3376 2052 8081 ld r24,Z |
3377 2054 9181 ldd r25,Z+1 |
3378 2056 855B subi r24,lo8(-75) |
3379 2058 9F4F sbci r25,hi8(-75) |
3380 205a 04F0 brlt .+2 |
3381 205c 00C0 rjmp .L273 |
3382 205e 8091 0000 lds r24,delay_einschalten.3049 |
3383 2062 8F5F subi r24,lo8(-(1)) |
3384 2064 8093 0000 sts delay_einschalten.3049,r24 |
3385 2068 893C cpi r24,lo8(-55) |
3386 206a 00F4 brsh .+2 |
3387 206c 00C0 rjmp .L248 |
3388 206e 1092 0000 sts delay_einschalten.3049,__zero_reg__ |
3389 2072 8091 0000 lds r24,VersionInfo+5 |
3390 2076 8823 tst r24 |
3391 2078 01F0 breq .+2 |
3392 207a 00C0 rjmp .L274 |
3393 207c 8091 0000 lds r24,calibration_done.3051 |
3394 2080 8823 tst r24 |
3395 2082 01F4 brne .+2 |
3396 2084 00C0 rjmp .L274 |
3397 2086 81E0 ldi r24,lo8(1) |
3398 2088 90E0 ldi r25,hi8(1) |
3399 208a 9093 0000 sts (modell_fliegt)+1,r25 |
3400 208e 8093 0000 sts modell_fliegt,r24 |
3401 2092 81E0 ldi r24,lo8(1) |
3402 2094 8093 0000 sts MotorenEin,r24 |
3403 2098 1092 0000 sts sollGier.3042,__zero_reg__ |
3404 209c 1092 0000 sts (sollGier.3042)+1,__zero_reg__ |
3405 20a0 1092 0000 sts (sollGier.3042)+2,__zero_reg__ |
3406 20a4 1092 0000 sts (sollGier.3042)+3,__zero_reg__ |
3407 20a8 1092 0000 sts Mess_Integral_Gier,__zero_reg__ |
3408 20ac 1092 0000 sts (Mess_Integral_Gier)+1,__zero_reg__ |
3409 20b0 1092 0000 sts (Mess_Integral_Gier)+2,__zero_reg__ |
3410 20b4 1092 0000 sts (Mess_Integral_Gier)+3,__zero_reg__ |
3411 20b8 1092 0000 sts Mess_Integral_Gier2,__zero_reg__ |
3412 20bc 1092 0000 sts (Mess_Integral_Gier2)+1,__zero_reg__ |
3413 20c0 1092 0000 sts (Mess_Integral_Gier2)+2,__zero_reg__ |
3414 20c4 1092 0000 sts (Mess_Integral_Gier2)+3,__zero_reg__ |
3415 20c8 6091 0000 lds r22,Mittelwert_AccNick |
3416 20cc 7091 0000 lds r23,(Mittelwert_AccNick)+1 |
3417 20d0 8827 clr r24 |
3418 20d2 77FD sbrc r23,7 |
3419 20d4 8095 com r24 |
3420 20d6 982F mov r25,r24 |
3421 20d8 E090 0000 lds r14,EE_Parameter+28 |
3422 20dc FF24 clr r15 |
3423 20de 00E0 ldi r16,lo8(0) |
3424 20e0 10E0 ldi r17,hi8(0) |
3425 20e2 A801 movw r20,r16 |
3426 20e4 9701 movw r18,r14 |
3427 20e6 0E94 0000 call __mulsi3 |
3428 20ea 6093 0000 sts Mess_IntegralNick,r22 |
3429 20ee 7093 0000 sts (Mess_IntegralNick)+1,r23 |
3430 20f2 8093 0000 sts (Mess_IntegralNick)+2,r24 |
3431 20f6 9093 0000 sts (Mess_IntegralNick)+3,r25 |
3432 20fa 6091 0000 lds r22,Mittelwert_AccRoll |
3433 20fe 7091 0000 lds r23,(Mittelwert_AccRoll)+1 |
3434 2102 8827 clr r24 |
3435 2104 77FD sbrc r23,7 |
3436 2106 8095 com r24 |
3437 2108 982F mov r25,r24 |
3438 210a 0E94 0000 call __mulsi3 |
3439 210e 6093 0000 sts Mess_IntegralRoll,r22 |
3440 2112 7093 0000 sts (Mess_IntegralRoll)+1,r23 |
3441 2116 8093 0000 sts (Mess_IntegralRoll)+2,r24 |
3442 211a 9093 0000 sts (Mess_IntegralRoll)+3,r25 |
3443 211e 8091 0000 lds r24,IntegralNick |
3444 2122 9091 0000 lds r25,(IntegralNick)+1 |
3445 2126 A091 0000 lds r26,(IntegralNick)+2 |
3446 212a B091 0000 lds r27,(IntegralNick)+3 |
3447 212e 8093 0000 sts Mess_IntegralNick2,r24 |
3448 2132 9093 0000 sts (Mess_IntegralNick2)+1,r25 |
3449 2136 A093 0000 sts (Mess_IntegralNick2)+2,r26 |
3450 213a B093 0000 sts (Mess_IntegralNick2)+3,r27 |
3451 213e 8091 0000 lds r24,IntegralRoll |
3452 2142 9091 0000 lds r25,(IntegralRoll)+1 |
3453 2146 A091 0000 lds r26,(IntegralRoll)+2 |
3454 214a B091 0000 lds r27,(IntegralRoll)+3 |
3455 214e 8093 0000 sts Mess_IntegralRoll2,r24 |
3456 2152 9093 0000 sts (Mess_IntegralRoll2)+1,r25 |
3457 2156 A093 0000 sts (Mess_IntegralRoll2)+2,r26 |
3458 215a B093 0000 sts (Mess_IntegralRoll2)+3,r27 |
3459 215e 1092 0000 sts SummeNick,__zero_reg__ |
3460 2162 1092 0000 sts (SummeNick)+1,__zero_reg__ |
3461 2166 1092 0000 sts (SummeNick)+2,__zero_reg__ |
3462 216a 1092 0000 sts (SummeNick)+3,__zero_reg__ |
3463 216e 1092 0000 sts SummeRoll,__zero_reg__ |
3464 2172 1092 0000 sts (SummeRoll)+1,__zero_reg__ |
3465 2176 1092 0000 sts (SummeRoll)+2,__zero_reg__ |
3466 217a 1092 0000 sts (SummeRoll)+3,__zero_reg__ |
3467 217e 8091 0000 lds r24,FCFlags |
3468 2182 8860 ori r24,lo8(8) |
3469 2184 8093 0000 sts FCFlags,r24 |
3470 2188 8091 0000 lds r24,EE_Parameter+95 |
3471 218c 2FE0 ldi r18,lo8(15) |
3472 218e 829F mul r24,r18 |
3473 2190 C001 movw r24,r0 |
3474 2192 1124 clr r1 |
3475 2194 2091 0000 lds r18,KompassValue |
3476 2198 3091 0000 lds r19,(KompassValue)+1 |
3477 219c 820F add r24,r18 |
3478 219e 931F adc r25,r19 |
3479 21a0 68E6 ldi r22,lo8(360) |
3480 21a2 71E0 ldi r23,hi8(360) |
3481 21a4 0E94 0000 call __divmodhi4 |
3482 21a8 62E0 ldi r22,lo8(2) |
3483 21aa 70E0 ldi r23,hi8(2) |
3484 21ac 0E94 0000 call __divmodhi4 |
3485 21b0 6093 0000 sts ControlHeading,r22 |
3486 21b4 00C0 rjmp .L248 |
3487 .L274: |
3488 21b6 8CED ldi r24,lo8(1500) |
3489 21b8 95E0 ldi r25,hi8(1500) |
3490 21ba 9093 0000 sts (beeptime)+1,r25 |
3491 21be 8093 0000 sts beeptime,r24 |
3492 21c2 00C0 rjmp .L248 |
3493 .L273: |
3494 21c4 1092 0000 sts delay_einschalten.3049,__zero_reg__ |
3495 21c8 00C0 rjmp .L248 |
3496 .L272: |
3497 21ca E091 0000 lds r30,EE_Parameter+4 |
3498 21ce F0E0 ldi r31,lo8(0) |
3499 21d0 EE0F lsl r30 |
3500 21d2 FF1F rol r31 |
3501 21d4 E050 subi r30,lo8(-(PPM_in)) |
3502 21d6 F040 sbci r31,hi8(-(PPM_in)) |
3503 21d8 8081 ld r24,Z |
3504 21da 9181 ldd r25,Z+1 |
3505 21dc 8C34 cpi r24,76 |
3506 21de 9105 cpc r25,__zero_reg__ |
3507 21e0 04F0 brlt .L275 |
3508 21e2 8091 0000 lds r24,delay_ausschalten.3050 |
3509 21e6 8F5F subi r24,lo8(-(1)) |
3510 21e8 8093 0000 sts delay_ausschalten.3050,r24 |
3511 21ec 893C cpi r24,lo8(-55) |
3512 21ee 00F0 brlo .L248 |
3513 21f0 1092 0000 sts MotorenEin,__zero_reg__ |
3514 21f4 1092 0000 sts delay_ausschalten.3050,__zero_reg__ |
3515 21f8 1092 0000 sts (modell_fliegt)+1,__zero_reg__ |
3516 21fc 1092 0000 sts modell_fliegt,__zero_reg__ |
3517 2200 00C0 rjmp .L248 |
3518 .L275: |
3519 2202 1092 0000 sts delay_ausschalten.3050,__zero_reg__ |
3520 .L248: |
3521 2206 8091 0000 lds r24,NewPpmData |
3522 220a 8150 subi r24,lo8(-(-1)) |
3523 220c 8093 0000 sts NewPpmData,r24 |
3524 2210 8F5F subi r24,lo8(-(1)) |
3525 2212 01F0 breq .L276 |
3526 2214 8091 0000 lds r24,FCFlags |
3527 2218 84FF sbrs r24,4 |
3528 221a 00C0 rjmp .L277 |
3529 .L276: |
3530 221c 0E94 0000 call ParameterZuordnung |
3531 2220 2091 0000 lds r18,EE_Parameter+1 |
3532 2224 022F mov r16,r18 |
3533 2226 10E0 ldi r17,lo8(0) |
3534 2228 000F lsl r16 |
3535 222a 111F rol r17 |
3536 222c F801 movw r30,r16 |
3537 222e E050 subi r30,lo8(-(PPM_in)) |
3538 2230 F040 sbci r31,hi8(-(PPM_in)) |
3539 2232 8081 ld r24,Z |
3540 2234 9181 ldd r25,Z+1 |
3541 2236 E090 0000 lds r14,EE_Parameter+23 |
3542 223a FF24 clr r15 |
3543 223c BC01 movw r22,r24 |
3544 223e 6E9D mul r22,r14 |
3545 2240 C001 movw r24,r0 |
3546 2242 6F9D mul r22,r15 |
3547 2244 900D add r25,r0 |
3548 2246 7E9D mul r23,r14 |
3549 2248 900D add r25,r0 |
3550 224a 1124 clr r1 |
3551 224c 4091 0000 lds r20,stick_nick.3059 |
3552 2250 5091 0000 lds r21,(stick_nick.3059)+1 |
3553 2254 9A01 movw r18,r20 |
3554 2256 220F lsl r18 |
3555 2258 331F rol r19 |
3556 225a 240F add r18,r20 |
3557 225c 351F adc r19,r21 |
3558 225e 820F add r24,r18 |
3559 2260 931F adc r25,r19 |
3560 2262 64E0 ldi r22,lo8(4) |
3561 2264 70E0 ldi r23,hi8(4) |
3562 2266 0E94 0000 call __divmodhi4 |
3563 226a CB01 movw r24,r22 |
3564 226c 7093 0000 sts (stick_nick.3059)+1,r23 |
3565 2270 6093 0000 sts stick_nick.3059,r22 |
3566 2274 0050 subi r16,lo8(-(PPM_diff)) |
3567 2276 1040 sbci r17,hi8(-(PPM_diff)) |
3568 2278 D801 movw r26,r16 |
3569 227a 2D91 ld r18,X+ |
3570 227c 3C91 ld r19,X |
3571 227e 0091 0000 lds r16,EE_Parameter+24 |
3572 2282 10E0 ldi r17,lo8(0) |
3573 2284 F901 movw r30,r18 |
3574 2286 E09F mul r30,r16 |
3575 2288 9001 movw r18,r0 |
3576 228a E19F mul r30,r17 |
3577 228c 300D add r19,r0 |
3578 228e F09F mul r31,r16 |
3579 2290 300D add r19,r0 |
3580 2292 1124 clr r1 |
3581 2294 820F add r24,r18 |
3582 2296 931F adc r25,r19 |
3583 2298 9093 0000 sts (stick_nick.3059)+1,r25 |
3584 229c 8093 0000 sts stick_nick.3059,r24 |
3585 22a0 8091 0000 lds r24,EE_Parameter+2 |
3586 22a4 C82E mov r12,r24 |
3587 22a6 DD24 clr r13 |
3588 22a8 CC0C lsl r12 |
3589 22aa DD1C rol r13 |
3590 22ac F601 movw r30,r12 |
3591 22ae E050 subi r30,lo8(-(PPM_in)) |
3592 22b0 F040 sbci r31,hi8(-(PPM_in)) |
3593 22b2 8081 ld r24,Z |
3594 22b4 9181 ldd r25,Z+1 |
3595 22b6 9C01 movw r18,r24 |
3596 22b8 2E9D mul r18,r14 |
3597 22ba C001 movw r24,r0 |
3598 22bc 2F9D mul r18,r15 |
3599 22be 900D add r25,r0 |
3600 22c0 3E9D mul r19,r14 |
3601 22c2 900D add r25,r0 |
3602 22c4 1124 clr r1 |
3603 22c6 4091 0000 lds r20,stick_roll.3060 |
3604 22ca 5091 0000 lds r21,(stick_roll.3060)+1 |
3605 22ce 9A01 movw r18,r20 |
3606 22d0 220F lsl r18 |
3607 22d2 331F rol r19 |
3608 22d4 240F add r18,r20 |
3609 22d6 351F adc r19,r21 |
3610 22d8 820F add r24,r18 |
3611 22da 931F adc r25,r19 |
3612 22dc 64E0 ldi r22,lo8(4) |
3613 22de 70E0 ldi r23,hi8(4) |
3614 22e0 0E94 0000 call __divmodhi4 |
3615 22e4 7093 0000 sts (stick_roll.3060)+1,r23 |
3616 22e8 6093 0000 sts stick_roll.3060,r22 |
3617 22ec 40E0 ldi r20,lo8(PPM_diff) |
3618 22ee 50E0 ldi r21,hi8(PPM_diff) |
3619 22f0 C40E add r12,r20 |
3620 22f2 D51E adc r13,r21 |
3621 22f4 D601 movw r26,r12 |
3622 22f6 8D91 ld r24,X+ |
3623 22f8 9C91 ld r25,X |
3624 22fa 809F mul r24,r16 |
3625 22fc F001 movw r30,r0 |
3626 22fe 819F mul r24,r17 |
3627 2300 F00D add r31,r0 |
3628 2302 909F mul r25,r16 |
3629 2304 F00D add r31,r0 |
3630 2306 1124 clr r1 |
3631 2308 E60F add r30,r22 |
3632 230a F71F adc r31,r23 |
3633 230c F093 0000 sts (stick_roll.3060)+1,r31 |
3634 2310 E093 0000 sts stick_roll.3060,r30 |
3635 2314 9E01 movw r18,r28 |
3636 2316 2F5F subi r18,lo8(-(1)) |
3637 2318 3F4F sbci r19,hi8(-(1)) |
3638 231a 40E0 ldi r20,lo8(C.354.3251) |
3639 231c 50E0 ldi r21,hi8(C.354.3251) |
3640 231e 8FE1 ldi r24,lo8(31) |
3641 .L278: |
3642 2320 DA01 movw r26,r20 |
3643 2322 0D90 ld r0,X+ |
3644 2324 AD01 movw r20,r26 |
3645 2326 D901 movw r26,r18 |
3646 2328 0D92 st X+,r0 |
3647 232a 9D01 movw r18,r26 |
3648 232c 8150 subi r24,lo8(-(-1)) |
3649 232e 01F4 brne .L278 |
3650 2330 8091 0000 lds r24,CareFree |
3651 2334 C090 0000 lds r12,stick_nick.3059 |
3652 2338 D090 0000 lds r13,(stick_nick.3059)+1 |
3653 233c 8823 tst r24 |
3654 233e 01F0 breq .L279 |
3655 2340 C601 movw r24,r12 |
3656 2342 64E0 ldi r22,lo8(4) |
3657 2344 70E0 ldi r23,hi8(4) |
3658 2346 0E94 0000 call __divmodhi4 |
3659 234a 6B01 movw r12,r22 |
3660 234c CF01 movw r24,r30 |
3661 234e 64E0 ldi r22,lo8(4) |
3662 2350 70E0 ldi r23,hi8(4) |
3663 2352 0E94 0000 call __divmodhi4 |
3664 2356 8B01 movw r16,r22 |
3665 2358 E090 0000 lds r14,FromNC_Rotate_S |
3666 235c FF24 clr r15 |
3667 235e E7FC sbrc r14,7 |
3668 2360 F094 com r15 |
3669 2362 6E9D mul r22,r14 |
3670 2364 C001 movw r24,r0 |
3671 2366 6F9D mul r22,r15 |
3672 2368 900D add r25,r0 |
3673 236a 7E9D mul r23,r14 |
3674 236c 900D add r25,r0 |
3675 236e 1124 clr r1 |
3676 2370 E091 0000 lds r30,FromNC_Rotate_C |
3677 2374 FF27 clr r31 |
3678 2376 E7FD sbrc r30,7 |
3679 2378 F095 com r31 |
3680 237a EC9D mul r30,r12 |
3681 237c 9001 movw r18,r0 |
3682 237e ED9D mul r30,r13 |
3683 2380 300D add r19,r0 |
3684 2382 FC9D mul r31,r12 |
3685 2384 300D add r19,r0 |
3686 2386 1124 clr r1 |
3687 2388 820F add r24,r18 |
3688 238a 931F adc r25,r19 |
3689 238c 68E0 ldi r22,lo8(8) |
3690 238e 70E0 ldi r23,hi8(8) |
3691 2390 0E94 0000 call __divmodhi4 |
3692 2394 7093 0000 sts (StickNick)+1,r23 |
3693 2398 6093 0000 sts StickNick,r22 |
3694 239c 0E9F mul r16,r30 |
3695 239e C001 movw r24,r0 |
3696 23a0 0F9F mul r16,r31 |
3697 23a2 900D add r25,r0 |
3698 23a4 1E9F mul r17,r30 |
3699 23a6 900D add r25,r0 |
3700 23a8 1124 clr r1 |
3701 23aa EC9C mul r14,r12 |
3702 23ac 9001 movw r18,r0 |
3703 23ae ED9C mul r14,r13 |
3704 23b0 300D add r19,r0 |
3705 23b2 FC9C mul r15,r12 |
3706 23b4 300D add r19,r0 |
3707 23b6 1124 clr r1 |
3708 23b8 00C0 rjmp .L530 |
3709 .L279: |
3710 23ba E091 0000 lds r30,EE_Parameter+95 |
3711 23be F0E0 ldi r31,lo8(0) |
3712 23c0 DE01 movw r26,r28 |
3713 23c2 AE0F add r26,r30 |
3714 23c4 BF1F adc r27,r31 |
3715 23c6 1796 adiw r26,7 |
3716 23c8 0C91 ld r16,X |
3717 23ca 1797 sbiw r26,7 |
3718 23cc 0093 0000 sts FromNC_Rotate_C,r16 |
3719 23d0 FD01 movw r30,r26 |
3720 23d2 E181 ldd r30,Z+1 |
3721 23d4 E093 0000 sts FromNC_Rotate_S,r30 |
3722 23d8 FF27 clr r31 |
3723 23da E7FD sbrc r30,7 |
3724 23dc F095 com r31 |
3725 23de E090 0000 lds r14,stick_roll.3060 |
3726 23e2 F090 0000 lds r15,(stick_roll.3060)+1 |
3727 23e6 EE9D mul r30,r14 |
3728 23e8 C001 movw r24,r0 |
3729 23ea EF9D mul r30,r15 |
3730 23ec 900D add r25,r0 |
3731 23ee FE9D mul r31,r14 |
3732 23f0 900D add r25,r0 |
3733 23f2 1124 clr r1 |
3734 23f4 1127 clr r17 |
3735 23f6 07FD sbrc r16,7 |
3736 23f8 1095 com r17 |
3737 23fa 0C9D mul r16,r12 |
3738 23fc 9001 movw r18,r0 |
3739 23fe 0D9D mul r16,r13 |
3740 2400 300D add r19,r0 |
3741 2402 1C9D mul r17,r12 |
3742 2404 300D add r19,r0 |
3743 2406 1124 clr r1 |
3744 2408 820F add r24,r18 |
3745 240a 931F adc r25,r19 |
3746 240c 68E0 ldi r22,lo8(8) |
3747 240e 70E0 ldi r23,hi8(8) |
3748 2410 0E94 0000 call __divmodhi4 |
3749 2414 7093 0000 sts (StickNick)+1,r23 |
3750 2418 6093 0000 sts StickNick,r22 |
3751 241c 0E9D mul r16,r14 |
3752 241e C001 movw r24,r0 |
3753 2420 0F9D mul r16,r15 |
3754 2422 900D add r25,r0 |
3755 2424 1E9D mul r17,r14 |
3756 2426 900D add r25,r0 |
3757 2428 1124 clr r1 |
3758 242a EC9D mul r30,r12 |
3759 242c 9001 movw r18,r0 |
3760 242e ED9D mul r30,r13 |
3761 2430 300D add r19,r0 |
3762 2432 FC9D mul r31,r12 |
3763 2434 300D add r19,r0 |
3764 2436 1124 clr r1 |
3765 .L530: |
3766 2438 821B sub r24,r18 |
3767 243a 930B sbc r25,r19 |
3768 243c 68E0 ldi r22,lo8(8) |
3769 243e 70E0 ldi r23,hi8(8) |
3770 2440 0E94 0000 call __divmodhi4 |
3771 2444 7093 0000 sts (StickRoll)+1,r23 |
3772 2448 6093 0000 sts StickRoll,r22 |
3773 244c E091 0000 lds r30,EE_Parameter+4 |
3774 2450 F0E0 ldi r31,lo8(0) |
3775 2452 EE0F lsl r30 |
3776 2454 FF1F rol r31 |
3777 2456 E050 subi r30,lo8(-(PPM_in)) |
3778 2458 F040 sbci r31,hi8(-(PPM_in)) |
3779 245a 8081 ld r24,Z |
3780 245c 9181 ldd r25,Z+1 |
3781 245e 2227 clr r18 |
3782 2460 3327 clr r19 |
3783 2462 281B sub r18,r24 |
3784 2464 390B sbc r19,r25 |
3785 2466 2330 cpi r18,3 |
3786 2468 3105 cpc r19,__zero_reg__ |
3787 246a 04F0 brlt .L281 |
3788 246c 2250 subi r18,lo8(-(-2)) |
3789 246e 3040 sbci r19,hi8(-(-2)) |
3790 2470 00C0 rjmp .L531 |
3791 .L281: |
3792 2472 BFEF ldi r27,hi8(-2) |
3793 2474 2E3F cpi r18,lo8(-2) |
3794 2476 3B07 cpc r19,r27 |
3795 2478 04F4 brge .L283 |
3796 247a 2E5F subi r18,lo8(-(2)) |
3797 247c 3F4F sbci r19,hi8(-(2)) |
3798 .L531: |
3799 247e 3093 0000 sts (StickGier)+1,r19 |
3800 2482 2093 0000 sts StickGier,r18 |
3801 2486 00C0 rjmp .L282 |
3802 .L283: |
3803 2488 1092 0000 sts (StickGier)+1,__zero_reg__ |
3804 248c 1092 0000 sts StickGier,__zero_reg__ |
3805 .L282: |
3806 2490 8091 0000 lds r24,GPS_Nick2 |
3807 2494 9091 0000 lds r25,(GPS_Nick2)+1 |
3808 2498 9095 com r25 |
3809 249a 8195 neg r24 |
3810 249c 9F4F sbci r25,lo8(-1) |
3811 249e 2091 0000 lds r18,GPS_Nick |
3812 24a2 3091 0000 lds r19,(GPS_Nick)+1 |
3813 24a6 821B sub r24,r18 |
3814 24a8 930B sbc r25,r19 |
3815 24aa E090 0000 lds r14,StickNick |
3816 24ae F090 0000 lds r15,(StickNick)+1 |
3817 24b2 E80E add r14,r24 |
3818 24b4 F91E adc r15,r25 |
3819 24b6 F092 0000 sts (StickNick)+1,r15 |
3820 24ba E092 0000 sts StickNick,r14 |
3821 24be 8091 0000 lds r24,GPS_Roll2 |
3822 24c2 9091 0000 lds r25,(GPS_Roll2)+1 |
3823 24c6 9095 com r25 |
3824 24c8 8195 neg r24 |
3825 24ca 9F4F sbci r25,lo8(-1) |
3826 24cc 2091 0000 lds r18,GPS_Roll |
3827 24d0 3091 0000 lds r19,(GPS_Roll)+1 |
3828 24d4 821B sub r24,r18 |
3829 24d6 930B sbc r25,r19 |
3830 24d8 0091 0000 lds r16,StickRoll |
3831 24dc 1091 0000 lds r17,(StickRoll)+1 |
3832 24e0 080F add r16,r24 |
3833 24e2 191F adc r17,r25 |
3834 24e4 1093 0000 sts (StickRoll)+1,r17 |
3835 24e8 0093 0000 sts StickRoll,r16 |
3836 24ec E091 0000 lds r30,EE_Parameter+3 |
3837 24f0 F0E0 ldi r31,lo8(0) |
3838 24f2 EE0F lsl r30 |
3839 24f4 FF1F rol r31 |
3840 24f6 E050 subi r30,lo8(-(PPM_in)) |
3841 24f8 F040 sbci r31,hi8(-(PPM_in)) |
3842 24fa C080 ld r12,Z |
3843 24fc D180 ldd r13,Z+1 |
3844 24fe E8E7 ldi r30,lo8(120) |
3845 2500 F0E0 ldi r31,hi8(120) |
3846 2502 CE0E add r12,r30 |
3847 2504 DF1E adc r13,r31 |
3848 2506 D092 0000 sts (StickGas)+1,r13 |
3849 250a C092 0000 sts StickGas,r12 |
3850 250e 6091 0000 lds r22,Parameter_Gyro_P |
3851 2512 70E0 ldi r23,lo8(0) |
3852 2514 8827 clr r24 |
3853 2516 77FD sbrc r23,7 |
3854 2518 8095 com r24 |
3855 251a 982F mov r25,r24 |
3856 251c 0E94 0000 call __floatsisf |
3857 2520 20E0 ldi r18,lo8(0x41200000) |
3858 2522 30E0 ldi r19,hi8(0x41200000) |
3859 2524 40E2 ldi r20,hlo8(0x41200000) |
3860 2526 51E4 ldi r21,hhi8(0x41200000) |
3861 2528 0E94 0000 call __addsf3 |
3862 252c 0E94 0000 call __fixunssfsi |
3863 2530 6093 0000 sts GyroFaktor,r22 |
3864 2534 8091 0000 lds r24,Parameter_Gyro_I |
3865 2538 8093 0000 sts IntegralFaktor,r24 |
3866 253c 6091 0000 lds r22,Parameter_Gyro_Gier_P |
3867 2540 70E0 ldi r23,lo8(0) |
3868 2542 8827 clr r24 |
3869 2544 77FD sbrc r23,7 |
3870 2546 8095 com r24 |
3871 2548 982F mov r25,r24 |
3872 254a 0E94 0000 call __floatsisf |
3873 254e 20E0 ldi r18,lo8(0x41200000) |
3874 2550 30E0 ldi r19,hi8(0x41200000) |
3875 2552 40E2 ldi r20,hlo8(0x41200000) |
3876 2554 51E4 ldi r21,hhi8(0x41200000) |
3877 2556 0E94 0000 call __addsf3 |
3878 255a 0E94 0000 call __fixunssfsi |
3879 255e 6093 0000 sts GyroFaktorGier,r22 |
3880 2562 8091 0000 lds r24,Parameter_Gyro_Gier_I |
3881 2566 8093 0000 sts IntegralFaktorGier,r24 |
3882 256a 8091 0000 lds r24,ExternControl+10 |
3883 256e 80FF sbrs r24,0 |
3884 2570 00C0 rjmp .L284 |
3885 2572 8091 0000 lds r24,Parameter_ExternalControl |
3886 2576 8138 cpi r24,lo8(-127) |
3887 2578 00F4 brsh .+2 |
3888 257a 00C0 rjmp .L284 |
3889 257c 2091 0000 lds r18,EE_Parameter+23 |
3890 2580 30E0 ldi r19,lo8(0) |
3891 2582 8091 0000 lds r24,ExternControl+3 |
3892 2586 9927 clr r25 |
3893 2588 87FD sbrc r24,7 |
3894 258a 9095 com r25 |
3895 258c AC01 movw r20,r24 |
3896 258e 249F mul r18,r20 |
3897 2590 C001 movw r24,r0 |
3898 2592 259F mul r18,r21 |
3899 2594 900D add r25,r0 |
3900 2596 349F mul r19,r20 |
3901 2598 900D add r25,r0 |
3902 259a 1124 clr r1 |
3903 259c E80E add r14,r24 |
3904 259e F91E adc r15,r25 |
3905 25a0 F092 0000 sts (StickNick)+1,r15 |
3906 25a4 E092 0000 sts StickNick,r14 |
3907 25a8 8091 0000 lds r24,ExternControl+4 |
3908 25ac 9927 clr r25 |
3909 25ae 87FD sbrc r24,7 |
3910 25b0 9095 com r25 |
3911 25b2 BC01 movw r22,r24 |
3912 25b4 269F mul r18,r22 |
3913 25b6 C001 movw r24,r0 |
3914 25b8 279F mul r18,r23 |
3915 25ba 900D add r25,r0 |
3916 25bc 369F mul r19,r22 |
3917 25be 900D add r25,r0 |
3918 25c0 1124 clr r1 |
3919 25c2 080F add r16,r24 |
3920 25c4 191F adc r17,r25 |
3921 25c6 1093 0000 sts (StickRoll)+1,r17 |
3922 25ca 0093 0000 sts StickRoll,r16 |
3923 25ce 2091 0000 lds r18,ExternControl+5 |
3924 25d2 3327 clr r19 |
3925 25d4 27FD sbrc r18,7 |
3926 25d6 3095 com r19 |
3927 25d8 8091 0000 lds r24,StickGier |
3928 25dc 9091 0000 lds r25,(StickGier)+1 |
3929 25e0 820F add r24,r18 |
3930 25e2 931F adc r25,r19 |
3931 25e4 9093 0000 sts (StickGier)+1,r25 |
3932 25e8 8093 0000 sts StickGier,r24 |
3933 25ec 2091 0000 lds r18,EE_Parameter+18 |
3934 25f0 30E0 ldi r19,lo8(0) |
3935 25f2 8091 0000 lds r24,ExternControl+7 |
3936 25f6 9927 clr r25 |
3937 25f8 87FD sbrc r24,7 |
3938 25fa 9095 com r25 |
3939 25fc DC01 movw r26,r24 |
3940 25fe 2A9F mul r18,r26 |
3941 2600 C001 movw r24,r0 |
3942 2602 2B9F mul r18,r27 |
3943 2604 900D add r25,r0 |
3944 2606 3A9F mul r19,r26 |
3945 2608 900D add r25,r0 |
3946 260a 1124 clr r1 |
3947 260c 9093 0000 sts (ExternHoehenValue)+1,r25 |
3948 2610 8093 0000 sts ExternHoehenValue,r24 |
3949 2614 8091 0000 lds r24,ExternControl+6 |
3950 2618 90E0 ldi r25,lo8(0) |
3951 261a 8C15 cp r24,r12 |
3952 261c 9D05 cpc r25,r13 |
3953 261e 04F4 brge .L284 |
3954 2620 9093 0000 sts (StickGas)+1,r25 |
3955 2624 8093 0000 sts StickGas,r24 |
3956 .L284: |
3957 2628 8091 0000 lds r24,StickGas |
3958 262c 9091 0000 lds r25,(StickGas)+1 |
3959 2630 97FF sbrs r25,7 |
3960 2632 00C0 rjmp .L285 |
3961 2634 1092 0000 sts (StickGas)+1,__zero_reg__ |
3962 2638 1092 0000 sts StickGas,__zero_reg__ |
3963 .L285: |
3964 263c 8091 0000 lds r24,EE_Parameter+13 |
3965 2640 82FF sbrs r24,2 |
3966 2642 00C0 rjmp .L286 |
3967 2644 1092 0000 sts IntegralFaktor,__zero_reg__ |
3968 .L286: |
3969 2648 4091 0000 lds r20,StickNick |
3970 264c 1091 0000 lds r17,StickNick+1 |
3971 2650 E091 0000 lds r30,MaxStickNick |
3972 2654 F091 0000 lds r31,(MaxStickNick)+1 |
3973 2658 842F mov r24,r20 |
3974 265a 912F mov r25,r17 |
3975 265c 64E0 ldi r22,lo8(4) |
3976 265e 70E0 ldi r23,hi8(4) |
3977 2660 0E94 0000 call __divmodhi4 |
3978 2664 CB01 movw r24,r22 |
3979 2666 77FF sbrs r23,7 |
3980 2668 00C0 rjmp .L288 |
3981 266a 9095 com r25 |
3982 266c 8195 neg r24 |
3983 266e 9F4F sbci r25,lo8(-1) |
3984 .L288: |
3985 2670 E817 cp r30,r24 |
3986 2672 F907 cpc r31,r25 |
3987 2674 04F4 brge .L287 |
3988 2676 842F mov r24,r20 |
3989 2678 912F mov r25,r17 |
3990 267a 9C01 movw r18,r24 |
3991 267c 37FF sbrs r19,7 |
3992 267e 00C0 rjmp .L289 |
3993 2680 3095 com r19 |
3994 2682 2195 neg r18 |
3995 2684 3F4F sbci r19,lo8(-1) |
3996 .L289: |
3997 2686 C901 movw r24,r18 |
3998 2688 9595 asr r25 |
3999 268a 8795 ror r24 |
4000 268c 9595 asr r25 |
4001 268e 8795 ror r24 |
4002 2690 9093 0000 sts (MaxStickNick)+1,r25 |
4003 2694 8093 0000 sts MaxStickNick,r24 |
4004 2698 8536 cpi r24,101 |
4005 269a 9105 cpc r25,__zero_reg__ |
4006 269c 04F0 brlt .L290 |
4007 269e 84E6 ldi r24,lo8(100) |
4008 26a0 90E0 ldi r25,hi8(100) |
4009 26a2 9093 0000 sts (MaxStickNick)+1,r25 |
4010 26a6 8093 0000 sts MaxStickNick,r24 |
4011 26aa 00C0 rjmp .L290 |
4012 .L287: |
4013 26ac 3197 sbiw r30,1 |
4014 26ae F093 0000 sts (MaxStickNick)+1,r31 |
4015 26b2 E093 0000 sts MaxStickNick,r30 |
4016 .L290: |
4017 26b6 4091 0000 lds r20,StickRoll |
4018 26ba 1091 0000 lds r17,StickRoll+1 |
4019 26be E091 0000 lds r30,MaxStickRoll |
4020 26c2 F091 0000 lds r31,(MaxStickRoll)+1 |
4021 26c6 842F mov r24,r20 |
4022 26c8 912F mov r25,r17 |
4023 26ca 64E0 ldi r22,lo8(4) |
4024 26cc 70E0 ldi r23,hi8(4) |
4025 26ce 0E94 0000 call __divmodhi4 |
4026 26d2 CB01 movw r24,r22 |
4027 26d4 77FF sbrs r23,7 |
4028 26d6 00C0 rjmp .L292 |
4029 26d8 9095 com r25 |
4030 26da 8195 neg r24 |
4031 26dc 9F4F sbci r25,lo8(-1) |
4032 .L292: |
4033 26de E817 cp r30,r24 |
4034 26e0 F907 cpc r31,r25 |
4035 26e2 04F4 brge .L291 |
4036 26e4 842F mov r24,r20 |
4037 26e6 912F mov r25,r17 |
4038 26e8 9C01 movw r18,r24 |
4039 26ea 37FF sbrs r19,7 |
4040 26ec 00C0 rjmp .L293 |
4041 26ee 3095 com r19 |
4042 26f0 2195 neg r18 |
4043 26f2 3F4F sbci r19,lo8(-1) |
4044 .L293: |
4045 26f4 C901 movw r24,r18 |
4046 26f6 9595 asr r25 |
4047 26f8 8795 ror r24 |
4048 26fa 9595 asr r25 |
4049 26fc 8795 ror r24 |
4050 26fe 9093 0000 sts (MaxStickRoll)+1,r25 |
4051 2702 8093 0000 sts MaxStickRoll,r24 |
4052 2706 8536 cpi r24,101 |
4053 2708 9105 cpc r25,__zero_reg__ |
4054 270a 04F0 brlt .L294 |
4055 270c 84E6 ldi r24,lo8(100) |
4056 270e 90E0 ldi r25,hi8(100) |
4057 2710 9093 0000 sts (MaxStickRoll)+1,r25 |
4058 2714 8093 0000 sts MaxStickRoll,r24 |
4059 2718 00C0 rjmp .L294 |
4060 .L291: |
4061 271a 3197 sbiw r30,1 |
4062 271c F093 0000 sts (MaxStickRoll)+1,r31 |
4063 2720 E093 0000 sts MaxStickRoll,r30 |
4064 .L294: |
4065 2724 8091 0000 lds r24,FCFlags |
4066 2728 84FF sbrs r24,4 |
4067 272a 00C0 rjmp .L295 |
4068 272c 1092 0000 sts (MaxStickNick)+1,__zero_reg__ |
4069 2730 1092 0000 sts MaxStickNick,__zero_reg__ |
4070 2734 1092 0000 sts (MaxStickRoll)+1,__zero_reg__ |
4071 2738 1092 0000 sts MaxStickRoll,__zero_reg__ |
4072 .L295: |
4073 273c 8091 0000 lds r24,EE_Parameter+2 |
4074 2740 A82F mov r26,r24 |
4075 2742 B0E0 ldi r27,lo8(0) |
4076 2744 FD01 movw r30,r26 |
4077 2746 EE0F lsl r30 |
4078 2748 FF1F rol r31 |
4079 274a E050 subi r30,lo8(-(PPM_in)) |
4080 274c F040 sbci r31,hi8(-(PPM_in)) |
4081 274e 2081 ld r18,Z |
4082 2750 3181 ldd r19,Z+1 |
4083 2752 8091 0000 lds r24,EE_Parameter+58 |
4084 2756 482F mov r20,r24 |
4085 2758 50E0 ldi r21,lo8(0) |
4086 275a 4217 cp r20,r18 |
4087 275c 5307 cpc r21,r19 |
4088 275e 04F4 brge .L296 |
4089 2760 8091 0000 lds r24,EE_Parameter+97 |
4090 2764 82FF sbrs r24,2 |
4091 2766 00C0 rjmp .L296 |
4092 2768 81E0 ldi r24,lo8(1) |
4093 276a 8093 0000 sts Looping_Links,r24 |
4094 276e 00C0 rjmp .L297 |
4095 .L296: |
4096 2770 AA0F lsl r26 |
4097 2772 BB1F rol r27 |
4098 2774 A050 subi r26,lo8(-(PPM_in)) |
4099 2776 B040 sbci r27,hi8(-(PPM_in)) |
4100 2778 2D91 ld r18,X+ |
4101 277a 3C91 ld r19,X |
4102 277c 8091 0000 lds r24,EE_Parameter+59 |
4103 2780 481B sub r20,r24 |
4104 2782 5109 sbc r21,__zero_reg__ |
4105 2784 2417 cp r18,r20 |
4106 2786 3507 cpc r19,r21 |
4107 2788 04F4 brge .L297 |
4108 278a 1092 0000 sts Looping_Links,__zero_reg__ |
4109 .L297: |
4110 278e 8091 0000 lds r24,EE_Parameter+2 |
4111 2792 A82F mov r26,r24 |
4112 2794 B0E0 ldi r27,lo8(0) |
4113 2796 FD01 movw r30,r26 |
4114 2798 EE0F lsl r30 |
4115 279a FF1F rol r31 |
4116 279c E050 subi r30,lo8(-(PPM_in)) |
4117 279e F040 sbci r31,hi8(-(PPM_in)) |
4118 27a0 2081 ld r18,Z |
4119 27a2 3181 ldd r19,Z+1 |
4120 27a4 8091 0000 lds r24,EE_Parameter+58 |
4121 27a8 482F mov r20,r24 |
4122 27aa 50E0 ldi r21,lo8(0) |
4123 27ac 8827 clr r24 |
4124 27ae 9927 clr r25 |
4125 27b0 841B sub r24,r20 |
4126 27b2 950B sbc r25,r21 |
4127 27b4 2817 cp r18,r24 |
4128 27b6 3907 cpc r19,r25 |
4129 27b8 04F4 brge .L298 |
4130 27ba 8091 0000 lds r24,EE_Parameter+97 |
4131 27be 83FF sbrs r24,3 |
4132 27c0 00C0 rjmp .L298 |
4133 27c2 81E0 ldi r24,lo8(1) |
4134 27c4 8093 0000 sts Looping_Rechts,r24 |
4135 27c8 00C0 rjmp .L299 |
4136 .L298: |
4137 27ca 8091 0000 lds r24,Looping_Rechts |
4138 27ce 8823 tst r24 |
4139 27d0 01F0 breq .L299 |
4140 27d2 AA0F lsl r26 |
4141 27d4 BB1F rol r27 |
4142 27d6 A050 subi r26,lo8(-(PPM_in)) |
4143 27d8 B040 sbci r27,hi8(-(PPM_in)) |
4144 27da 2D91 ld r18,X+ |
4145 27dc 3C91 ld r19,X |
4146 27de 8091 0000 lds r24,EE_Parameter+59 |
4147 27e2 90E0 ldi r25,lo8(0) |
4148 27e4 841B sub r24,r20 |
4149 27e6 950B sbc r25,r21 |
4150 27e8 8217 cp r24,r18 |
4151 27ea 9307 cpc r25,r19 |
4152 27ec 04F4 brge .L299 |
4153 27ee 1092 0000 sts Looping_Rechts,__zero_reg__ |
4154 .L299: |
4155 27f2 8091 0000 lds r24,EE_Parameter+1 |
4156 27f6 A82F mov r26,r24 |
4157 27f8 B0E0 ldi r27,lo8(0) |
4158 27fa FD01 movw r30,r26 |
4159 27fc EE0F lsl r30 |
4160 27fe FF1F rol r31 |
4161 2800 E050 subi r30,lo8(-(PPM_in)) |
4162 2802 F040 sbci r31,hi8(-(PPM_in)) |
4163 2804 2081 ld r18,Z |
4164 2806 3181 ldd r19,Z+1 |
4165 2808 8091 0000 lds r24,EE_Parameter+58 |
4166 280c 482F mov r20,r24 |
4167 280e 50E0 ldi r21,lo8(0) |
4168 2810 4217 cp r20,r18 |
4169 2812 5307 cpc r21,r19 |
4170 2814 04F4 brge .L300 |
4171 2816 8091 0000 lds r24,EE_Parameter+97 |
4172 281a 80FF sbrs r24,0 |
4173 281c 00C0 rjmp .L300 |
4174 281e 81E0 ldi r24,lo8(1) |
4175 2820 8093 0000 sts Looping_Oben,r24 |
4176 2824 00C0 rjmp .L301 |
4177 .L300: |
4178 2826 8091 0000 lds r24,Looping_Oben |
4179 282a 8823 tst r24 |
4180 282c 01F0 breq .L301 |
4181 282e AA0F lsl r26 |
4182 2830 BB1F rol r27 |
4183 2832 A050 subi r26,lo8(-(PPM_in)) |
4184 2834 B040 sbci r27,hi8(-(PPM_in)) |
4185 2836 2D91 ld r18,X+ |
4186 2838 3C91 ld r19,X |
4187 283a 8091 0000 lds r24,EE_Parameter+59 |
4188 283e 481B sub r20,r24 |
4189 2840 5109 sbc r21,__zero_reg__ |
4190 2842 2417 cp r18,r20 |
4191 2844 3507 cpc r19,r21 |
4192 2846 04F4 brge .L301 |
4193 2848 1092 0000 sts Looping_Oben,__zero_reg__ |
4194 .L301: |
4195 284c 8091 0000 lds r24,EE_Parameter+1 |
4196 2850 A82F mov r26,r24 |
4197 2852 B0E0 ldi r27,lo8(0) |
4198 2854 FD01 movw r30,r26 |
4199 2856 EE0F lsl r30 |
4200 2858 FF1F rol r31 |
4201 285a E050 subi r30,lo8(-(PPM_in)) |
4202 285c F040 sbci r31,hi8(-(PPM_in)) |
4203 285e 2081 ld r18,Z |
4204 2860 3181 ldd r19,Z+1 |
4205 2862 8091 0000 lds r24,EE_Parameter+58 |
4206 2866 482F mov r20,r24 |
4207 2868 50E0 ldi r21,lo8(0) |
4208 286a 8827 clr r24 |
4209 286c 9927 clr r25 |
4210 286e 841B sub r24,r20 |
4211 2870 950B sbc r25,r21 |
4212 2872 2817 cp r18,r24 |
4213 2874 3907 cpc r19,r25 |
4214 2876 04F4 brge .L302 |
4215 2878 8091 0000 lds r24,EE_Parameter+97 |
4216 287c 81FF sbrs r24,1 |
4217 287e 00C0 rjmp .L302 |
4218 2880 81E0 ldi r24,lo8(1) |
4219 2882 8093 0000 sts Looping_Unten,r24 |
4220 2886 00C0 rjmp .L303 |
4221 .L302: |
4222 2888 8091 0000 lds r24,Looping_Unten |
4223 288c 8823 tst r24 |
4224 288e 01F0 breq .L303 |
4225 2890 AA0F lsl r26 |
4226 2892 BB1F rol r27 |
4227 2894 A050 subi r26,lo8(-(PPM_in)) |
4228 2896 B040 sbci r27,hi8(-(PPM_in)) |
4229 2898 2D91 ld r18,X+ |
4230 289a 3C91 ld r19,X |
4231 289c 8091 0000 lds r24,EE_Parameter+59 |
4232 28a0 90E0 ldi r25,lo8(0) |
4233 28a2 841B sub r24,r20 |
4234 28a4 950B sbc r25,r21 |
4235 28a6 8217 cp r24,r18 |
4236 28a8 9307 cpc r25,r19 |
4237 28aa 04F4 brge .L303 |
4238 28ac 1092 0000 sts Looping_Unten,__zero_reg__ |
4239 .L303: |
4240 28b0 8091 0000 lds r24,Looping_Links |
4241 28b4 8823 tst r24 |
4242 28b6 01F4 brne .L304 |
4243 28b8 8091 0000 lds r24,Looping_Rechts |
4244 28bc 8823 tst r24 |
4245 28be 01F0 breq .L305 |
4246 .L304: |
4247 28c0 81E0 ldi r24,lo8(1) |
4248 28c2 8093 0000 sts Looping_Roll,r24 |
4249 28c6 00C0 rjmp .L306 |
4250 .L305: |
4251 28c8 1092 0000 sts Looping_Roll,__zero_reg__ |
4252 .L306: |
4253 28cc 8091 0000 lds r24,Looping_Oben |
4254 28d0 8823 tst r24 |
4255 28d2 01F4 brne .L307 |
4256 28d4 8091 0000 lds r24,Looping_Unten |
4257 28d8 8823 tst r24 |
4258 28da 01F0 breq .L308 |
4259 .L307: |
4260 28dc 81E0 ldi r24,lo8(1) |
4261 28de 8093 0000 sts Looping_Nick,r24 |
4262 28e2 1092 0000 sts Looping_Roll,__zero_reg__ |
4263 28e6 1092 0000 sts Looping_Links,__zero_reg__ |
4264 28ea 1092 0000 sts Looping_Rechts,__zero_reg__ |
4265 28ee 00C0 rjmp .L277 |
4266 .L308: |
4267 28f0 1092 0000 sts Looping_Nick,__zero_reg__ |
4268 .L277: |
4269 28f4 8091 0000 lds r24,Looping_Roll |
4270 28f8 8823 tst r24 |
4271 28fa 01F4 brne .L309 |
4272 28fc 8091 0000 lds r24,Looping_Nick |
4273 2900 8823 tst r24 |
4274 2902 01F0 breq .L310 |
4275 .L309: |
4276 2904 8091 0000 lds r24,EE_Parameter+57 |
4277 2908 90E0 ldi r25,lo8(0) |
4278 290a EEA1 ldd r30,Y+38 |
4279 290c FFA1 ldd r31,Y+39 |
4280 290e 8E17 cp r24,r30 |
4281 2910 9F07 cpc r25,r31 |
4282 2912 04F4 brge .L311 |
4283 2914 9FA3 std Y+39,r25 |
4284 2916 8EA3 std Y+38,r24 |
4285 .L311: |
4286 2918 81E0 ldi r24,lo8(1) |
4287 291a 8093 0000 sts TrichterFlug,r24 |
4288 .L310: |
4289 291e 8091 0000 lds r24,FCFlags |
4290 2922 84FF sbrs r24,4 |
4291 2924 00C0 rjmp .L312 |
4292 2926 1092 0000 sts (StickGier)+1,__zero_reg__ |
4293 292a 1092 0000 sts StickGier,__zero_reg__ |
4294 292e 1092 0000 sts (StickNick)+1,__zero_reg__ |
4295 2932 1092 0000 sts StickNick,__zero_reg__ |
4296 2936 1092 0000 sts (StickRoll)+1,__zero_reg__ |
4297 293a 1092 0000 sts StickRoll,__zero_reg__ |
4298 293e 9AE5 ldi r25,lo8(90) |
4299 2940 9093 0000 sts GyroFaktor,r25 |
4300 2944 88E7 ldi r24,lo8(120) |
4301 2946 8093 0000 sts IntegralFaktor,r24 |
4302 294a 9093 0000 sts GyroFaktorGier,r25 |
4303 294e 8093 0000 sts IntegralFaktorGier,r24 |
4304 2952 1092 0000 sts Looping_Roll,__zero_reg__ |
4305 2956 1092 0000 sts Looping_Nick,__zero_reg__ |
4306 .L312: |
4307 295a 8091 0000 lds r24,MittelIntegralNick |
4308 295e 9091 0000 lds r25,(MittelIntegralNick)+1 |
4309 2962 A091 0000 lds r26,(MittelIntegralNick)+2 |
4310 2966 B091 0000 lds r27,(MittelIntegralNick)+3 |
4311 296a 2091 0000 lds r18,IntegralNick |
4312 296e 3091 0000 lds r19,(IntegralNick)+1 |
4313 2972 4091 0000 lds r20,(IntegralNick)+2 |
4314 2976 5091 0000 lds r21,(IntegralNick)+3 |
4315 297a 820F add r24,r18 |
4316 297c 931F adc r25,r19 |
4317 297e A41F adc r26,r20 |
4318 2980 B51F adc r27,r21 |
4319 2982 8093 0000 sts MittelIntegralNick,r24 |
4320 2986 9093 0000 sts (MittelIntegralNick)+1,r25 |
4321 298a A093 0000 sts (MittelIntegralNick)+2,r26 |
4322 298e B093 0000 sts (MittelIntegralNick)+3,r27 |
4323 2992 8091 0000 lds r24,MittelIntegralRoll |
4324 2996 9091 0000 lds r25,(MittelIntegralRoll)+1 |
4325 299a A091 0000 lds r26,(MittelIntegralRoll)+2 |
4326 299e B091 0000 lds r27,(MittelIntegralRoll)+3 |
4327 29a2 2091 0000 lds r18,IntegralRoll |
4328 29a6 3091 0000 lds r19,(IntegralRoll)+1 |
4329 29aa 4091 0000 lds r20,(IntegralRoll)+2 |
4330 29ae 5091 0000 lds r21,(IntegralRoll)+3 |
4331 29b2 820F add r24,r18 |
4332 29b4 931F adc r25,r19 |
4333 29b6 A41F adc r26,r20 |
4334 29b8 B51F adc r27,r21 |
4335 29ba 8093 0000 sts MittelIntegralRoll,r24 |
4336 29be 9093 0000 sts (MittelIntegralRoll)+1,r25 |
4337 29c2 A093 0000 sts (MittelIntegralRoll)+2,r26 |
4338 29c6 B093 0000 sts (MittelIntegralRoll)+3,r27 |
4339 29ca 8091 0000 lds r24,MittelIntegralNick2 |
4340 29ce 9091 0000 lds r25,(MittelIntegralNick2)+1 |
4341 29d2 A091 0000 lds r26,(MittelIntegralNick2)+2 |
4342 29d6 B091 0000 lds r27,(MittelIntegralNick2)+3 |
4343 29da 2091 0000 lds r18,IntegralNick2 |
4344 29de 3091 0000 lds r19,(IntegralNick2)+1 |
4345 29e2 4091 0000 lds r20,(IntegralNick2)+2 |
4346 29e6 5091 0000 lds r21,(IntegralNick2)+3 |
4347 29ea 820F add r24,r18 |
4348 29ec 931F adc r25,r19 |
4349 29ee A41F adc r26,r20 |
4350 29f0 B51F adc r27,r21 |
4351 29f2 8093 0000 sts MittelIntegralNick2,r24 |
4352 29f6 9093 0000 sts (MittelIntegralNick2)+1,r25 |
4353 29fa A093 0000 sts (MittelIntegralNick2)+2,r26 |
4354 29fe B093 0000 sts (MittelIntegralNick2)+3,r27 |
4355 2a02 8091 0000 lds r24,MittelIntegralRoll2 |
4356 2a06 9091 0000 lds r25,(MittelIntegralRoll2)+1 |
4357 2a0a A091 0000 lds r26,(MittelIntegralRoll2)+2 |
4358 2a0e B091 0000 lds r27,(MittelIntegralRoll2)+3 |
4359 2a12 2091 0000 lds r18,IntegralRoll2 |
4360 2a16 3091 0000 lds r19,(IntegralRoll2)+1 |
4361 2a1a 4091 0000 lds r20,(IntegralRoll2)+2 |
4362 2a1e 5091 0000 lds r21,(IntegralRoll2)+3 |
4363 2a22 820F add r24,r18 |
4364 2a24 931F adc r25,r19 |
4365 2a26 A41F adc r26,r20 |
4366 2a28 B51F adc r27,r21 |
4367 2a2a 8093 0000 sts MittelIntegralRoll2,r24 |
4368 2a2e 9093 0000 sts (MittelIntegralRoll2)+1,r25 |
4369 2a32 A093 0000 sts (MittelIntegralRoll2)+2,r26 |
4370 2a36 B093 0000 sts (MittelIntegralRoll2)+3,r27 |
4371 2a3a 8091 0000 lds r24,Looping_Nick |
4372 2a3e 8823 tst r24 |
4373 2a40 01F4 brne .L313 |
4374 2a42 8091 0000 lds r24,Looping_Roll |
4375 2a46 8823 tst r24 |
4376 2a48 01F4 brne .+2 |
4377 2a4a 00C0 rjmp .L314 |
4378 .L313: |
4379 2a4c 1092 0000 sts IntegralAccNick,__zero_reg__ |
4380 2a50 1092 0000 sts (IntegralAccNick)+1,__zero_reg__ |
4381 2a54 1092 0000 sts (IntegralAccNick)+2,__zero_reg__ |
4382 2a58 1092 0000 sts (IntegralAccNick)+3,__zero_reg__ |
4383 2a5c 1092 0000 sts IntegralAccRoll,__zero_reg__ |
4384 2a60 1092 0000 sts (IntegralAccRoll)+1,__zero_reg__ |
4385 2a64 1092 0000 sts (IntegralAccRoll)+2,__zero_reg__ |
4386 2a68 1092 0000 sts (IntegralAccRoll)+3,__zero_reg__ |
4387 2a6c 1092 0000 sts MittelIntegralNick,__zero_reg__ |
4388 2a70 1092 0000 sts (MittelIntegralNick)+1,__zero_reg__ |
4389 2a74 1092 0000 sts (MittelIntegralNick)+2,__zero_reg__ |
4390 2a78 1092 0000 sts (MittelIntegralNick)+3,__zero_reg__ |
4391 2a7c 1092 0000 sts MittelIntegralRoll,__zero_reg__ |
4392 2a80 1092 0000 sts (MittelIntegralRoll)+1,__zero_reg__ |
4393 2a84 1092 0000 sts (MittelIntegralRoll)+2,__zero_reg__ |
4394 2a88 1092 0000 sts (MittelIntegralRoll)+3,__zero_reg__ |
4395 2a8c 1092 0000 sts MittelIntegralNick2,__zero_reg__ |
4396 2a90 1092 0000 sts (MittelIntegralNick2)+1,__zero_reg__ |
4397 2a94 1092 0000 sts (MittelIntegralNick2)+2,__zero_reg__ |
4398 2a98 1092 0000 sts (MittelIntegralNick2)+3,__zero_reg__ |
4399 2a9c 1092 0000 sts MittelIntegralRoll2,__zero_reg__ |
4400 2aa0 1092 0000 sts (MittelIntegralRoll2)+1,__zero_reg__ |
4401 2aa4 1092 0000 sts (MittelIntegralRoll2)+2,__zero_reg__ |
4402 2aa8 1092 0000 sts (MittelIntegralRoll2)+3,__zero_reg__ |
4403 2aac 8091 0000 lds r24,Mess_IntegralNick |
4404 2ab0 9091 0000 lds r25,(Mess_IntegralNick)+1 |
4405 2ab4 A091 0000 lds r26,(Mess_IntegralNick)+2 |
4406 2ab8 B091 0000 lds r27,(Mess_IntegralNick)+3 |
4407 2abc 8093 0000 sts Mess_IntegralNick2,r24 |
4408 2ac0 9093 0000 sts (Mess_IntegralNick2)+1,r25 |
4409 2ac4 A093 0000 sts (Mess_IntegralNick2)+2,r26 |
4410 2ac8 B093 0000 sts (Mess_IntegralNick2)+3,r27 |
4411 2acc 8091 0000 lds r24,Mess_IntegralRoll |
4412 2ad0 9091 0000 lds r25,(Mess_IntegralRoll)+1 |
4413 2ad4 A091 0000 lds r26,(Mess_IntegralRoll)+2 |
4414 2ad8 B091 0000 lds r27,(Mess_IntegralRoll)+3 |
4415 2adc 8093 0000 sts Mess_IntegralRoll2,r24 |
4416 2ae0 9093 0000 sts (Mess_IntegralRoll2)+1,r25 |
4417 2ae4 A093 0000 sts (Mess_IntegralRoll2)+2,r26 |
4418 2ae8 B093 0000 sts (Mess_IntegralRoll2)+3,r27 |
4419 2aec 1092 0000 sts (ZaehlMessungen)+1,__zero_reg__ |
4420 2af0 1092 0000 sts ZaehlMessungen,__zero_reg__ |
4421 2af4 1092 0000 sts (LageKorrekturNick)+1,__zero_reg__ |
4422 2af8 1092 0000 sts LageKorrekturNick,__zero_reg__ |
4423 2afc 1092 0000 sts (LageKorrekturRoll)+1,__zero_reg__ |
4424 2b00 1092 0000 sts LageKorrekturRoll,__zero_reg__ |
4425 .L314: |
4426 2b04 8091 0000 lds r24,Looping_Nick |
4427 2b08 8823 tst r24 |
4428 2b0a 01F0 breq .+2 |
4429 2b0c 00C0 rjmp .L315 |
4430 2b0e 8091 0000 lds r24,Looping_Roll |
4431 2b12 8823 tst r24 |
4432 2b14 01F0 breq .+2 |
4433 2b16 00C0 rjmp .L315 |
4434 2b18 8091 0000 lds r24,Aktuell_az |
4435 2b1c 9091 0000 lds r25,(Aktuell_az)+1 |
4436 2b20 8150 subi r24,lo8(513) |
4437 2b22 9240 sbci r25,hi8(513) |
4438 2b24 04F4 brge .L316 |
4439 2b26 8091 0000 lds r24,MotorenEin |
4440 2b2a 8823 tst r24 |
4441 2b2c 01F4 brne .+2 |
4442 2b2e 00C0 rjmp .L315 |
4443 .L316: |
4444 2b30 2091 0000 lds r18,FromNaviCtrl_Value |
4445 2b34 4090 0000 lds r4,Mittelwert_AccNick |
4446 2b38 5090 0000 lds r5,(Mittelwert_AccNick)+1 |
4447 2b3c 2090 0000 lds r2,Mittelwert_AccRoll |
4448 2b40 3090 0000 lds r3,(Mittelwert_AccRoll)+1 |
4449 2b44 6091 0000 lds r22,IntegralNick |
4450 2b48 7091 0000 lds r23,(IntegralNick)+1 |
4451 2b4c 8091 0000 lds r24,(IntegralNick)+2 |
4452 2b50 9091 0000 lds r25,(IntegralNick)+3 |
4453 2b54 6090 0000 lds r6,IntegralRoll |
4454 2b58 7090 0000 lds r7,(IntegralRoll)+1 |
4455 2b5c 8090 0000 lds r8,(IntegralRoll)+2 |
4456 2b60 9090 0000 lds r9,(IntegralRoll)+3 |
4457 2b64 4091 0000 lds r20,MaxStickNick |
4458 2b68 5091 0000 lds r21,(MaxStickNick)+1 |
4459 2b6c 5DAB std Y+53,r21 |
4460 2b6e 4CAB std Y+52,r20 |
4461 2b70 2F3F cpi r18,lo8(-1) |
4462 2b72 01F4 brne .+2 |
4463 2b74 00C0 rjmp .L317 |
4464 2b76 E090 0000 lds r14,EE_Parameter+28 |
4465 2b7a FF24 clr r15 |
4466 2b7c 00E0 ldi r16,lo8(0) |
4467 2b7e 10E0 ldi r17,hi8(0) |
4468 2b80 A22E mov r10,r18 |
4469 2b82 BB24 clr r11 |
4470 2b84 A7FC sbrc r10,7 |
4471 2b86 B094 com r11 |
4472 2b88 CB2C mov r12,r11 |
4473 2b8a DB2C mov r13,r11 |
4474 2b8c A801 movw r20,r16 |
4475 2b8e 9701 movw r18,r14 |
4476 2b90 0E94 0000 call __divmodsi4 |
4477 2b94 C201 movw r24,r4 |
4478 2b96 AA27 clr r26 |
4479 2b98 97FD sbrc r25,7 |
4480 2b9a A095 com r26 |
4481 2b9c BA2F mov r27,r26 |
4482 2b9e 281B sub r18,r24 |
4483 2ba0 390B sbc r19,r25 |
4484 2ba2 4A0B sbc r20,r26 |
4485 2ba4 5B0B sbc r21,r27 |
4486 2ba6 CA01 movw r24,r20 |
4487 2ba8 B901 movw r22,r18 |
4488 2baa A601 movw r20,r12 |
4489 2bac 9501 movw r18,r10 |
4490 2bae 0E94 0000 call __mulsi3 |
4491 2bb2 20E0 ldi r18,lo8(512) |
4492 2bb4 32E0 ldi r19,hi8(512) |
4493 2bb6 40E0 ldi r20,hlo8(512) |
4494 2bb8 50E0 ldi r21,hhi8(512) |
4495 2bba 0E94 0000 call __divmodsi4 |
4496 2bbe 28AB std Y+48,r18 |
4497 2bc0 39AB std Y+49,r19 |
4498 2bc2 4AAB std Y+50,r20 |
4499 2bc4 5BAB std Y+51,r21 |
4500 2bc6 2CA7 std Y+44,r18 |
4501 2bc8 3DA7 std Y+45,r19 |
4502 2bca 4EA7 std Y+46,r20 |
4503 2bcc 5FA7 std Y+47,r21 |
4504 2bce C401 movw r24,r8 |
4505 2bd0 B301 movw r22,r6 |
4506 2bd2 A801 movw r20,r16 |
4507 2bd4 9701 movw r18,r14 |
4508 2bd6 0E94 0000 call __divmodsi4 |
4509 2bda C101 movw r24,r2 |
4510 2bdc AA27 clr r26 |
4511 2bde 97FD sbrc r25,7 |
4512 2be0 A095 com r26 |
4513 2be2 BA2F mov r27,r26 |
4514 2be4 281B sub r18,r24 |
4515 2be6 390B sbc r19,r25 |
4516 2be8 4A0B sbc r20,r26 |
4517 2bea 5B0B sbc r21,r27 |
4518 2bec CA01 movw r24,r20 |
4519 2bee B901 movw r22,r18 |
4520 2bf0 A601 movw r20,r12 |
4521 2bf2 9501 movw r18,r10 |
4522 2bf4 0E94 0000 call __mulsi3 |
4523 2bf8 20E0 ldi r18,lo8(512) |
4524 2bfa 32E0 ldi r19,hi8(512) |
4525 2bfc 40E0 ldi r20,hlo8(512) |
4526 2bfe 50E0 ldi r21,hhi8(512) |
4527 2c00 0E94 0000 call __divmodsi4 |
4528 2c04 122F mov r17,r18 |
4529 2c06 032F mov r16,r19 |
4530 2c08 F42E mov r15,r20 |
4531 2c0a E52E mov r14,r21 |
4532 2c0c 222E mov r2,r18 |
4533 2c0e 332E mov r3,r19 |
4534 2c10 442E mov r4,r20 |
4535 2c12 552E mov r5,r21 |
4536 2c14 6CA9 ldd r22,Y+52 |
4537 2c16 7DA9 ldd r23,Y+53 |
4538 2c18 6134 cpi r22,65 |
4539 2c1a 7105 cpc r23,__zero_reg__ |
4540 2c1c 04F4 brge .L318 |
4541 2c1e 8091 0000 lds r24,MaxStickRoll |
4542 2c22 9091 0000 lds r25,(MaxStickRoll)+1 |
4543 2c26 8134 cpi r24,65 |
4544 2c28 9105 cpc r25,__zero_reg__ |
4545 2c2a 04F0 brlt .L319 |
4546 .L318: |
4547 2c2c 68A9 ldd r22,Y+48 |
4548 2c2e 79A9 ldd r23,Y+49 |
4549 2c30 8AA9 ldd r24,Y+50 |
4550 2c32 9BA9 ldd r25,Y+51 |
4551 2c34 22E0 ldi r18,lo8(2) |
4552 2c36 30E0 ldi r19,hi8(2) |
4553 2c38 40E0 ldi r20,hlo8(2) |
4554 2c3a 50E0 ldi r21,hhi8(2) |
4555 2c3c 0E94 0000 call __divmodsi4 |
4556 2c40 2CA7 std Y+44,r18 |
4557 2c42 3DA7 std Y+45,r19 |
4558 2c44 4EA7 std Y+46,r20 |
4559 2c46 5FA7 std Y+47,r21 |
4560 2c48 612F mov r22,r17 |
4561 2c4a 702F mov r23,r16 |
4562 2c4c 8F2D mov r24,r15 |
4563 2c4e 9E2D mov r25,r14 |
4564 2c50 22E0 ldi r18,lo8(2) |
4565 2c52 30E0 ldi r19,hi8(2) |
4566 2c54 40E0 ldi r20,hlo8(2) |
4567 2c56 50E0 ldi r21,hhi8(2) |
4568 2c58 0E94 0000 call __divmodsi4 |
4569 2c5c 1901 movw r2,r18 |
4570 2c5e 2A01 movw r4,r20 |
4571 .L319: |
4572 2c60 E091 0000 lds r30,EE_Parameter+4 |
4573 2c64 F0E0 ldi r31,lo8(0) |
4574 2c66 EE0F lsl r30 |
4575 2c68 FF1F rol r31 |
4576 2c6a E050 subi r30,lo8(-(PPM_in)) |
4577 2c6c F040 sbci r31,hi8(-(PPM_in)) |
4578 2c6e 0190 ld __tmp_reg__,Z+ |
4579 2c70 F081 ld r31,Z |
4580 2c72 E02D mov r30,__tmp_reg__ |
4581 2c74 F7FF sbrs r31,7 |
4582 2c76 00C0 rjmp .L321 |
4583 2c78 F095 com r31 |
4584 2c7a E195 neg r30 |
4585 2c7c FF4F sbci r31,lo8(-1) |
4586 .L321: |
4587 2c7e 7A97 sbiw r30,26 |
4588 2c80 04F0 brlt .L320 |
4589 2c82 6CA5 ldd r22,Y+44 |
4590 2c84 7DA5 ldd r23,Y+45 |
4591 2c86 8EA5 ldd r24,Y+46 |
4592 2c88 9FA5 ldd r25,Y+47 |
4593 2c8a 23E0 ldi r18,lo8(3) |
4594 2c8c 30E0 ldi r19,hi8(3) |
4595 2c8e 40E0 ldi r20,hlo8(3) |
4596 2c90 50E0 ldi r21,hhi8(3) |
4597 2c92 0E94 0000 call __divmodsi4 |
4598 2c96 2CA7 std Y+44,r18 |
4599 2c98 3DA7 std Y+45,r19 |
4600 2c9a 4EA7 std Y+46,r20 |
4601 2c9c 5FA7 std Y+47,r21 |
4602 2c9e B101 movw r22,r2 |
4603 2ca0 C201 movw r24,r4 |
4604 2ca2 23E0 ldi r18,lo8(3) |
4605 2ca4 30E0 ldi r19,hi8(3) |
4606 2ca6 40E0 ldi r20,hlo8(3) |
4607 2ca8 50E0 ldi r21,hhi8(3) |
4608 2caa 0E94 0000 call __divmodsi4 |
4609 2cae 1901 movw r2,r18 |
4610 2cb0 2A01 movw r4,r20 |
4611 .L320: |
4612 2cb2 6091 0000 lds r22,FromNaviCtrl_Value+2 |
4613 2cb6 662E mov r6,r22 |
4614 2cb8 7724 clr r7 |
4615 2cba 67FC sbrc r6,7 |
4616 2cbc 7094 com r7 |
4617 2cbe 872C mov r8,r7 |
4618 2cc0 972C mov r9,r7 |
4619 2cc2 2CA5 ldd r18,Y+44 |
4620 2cc4 3DA5 ldd r19,Y+45 |
4621 2cc6 4EA5 ldd r20,Y+46 |
4622 2cc8 5FA5 ldd r21,Y+47 |
4623 2cca C901 movw r24,r18 |
4624 2ccc DA01 movw r26,r20 |
4625 2cce 9C01 movw r18,r24 |
4626 2cd0 AD01 movw r20,r26 |
4627 2cd2 6216 cp r6,r18 |
4628 2cd4 7306 cpc r7,r19 |
4629 2cd6 8406 cpc r8,r20 |
4630 2cd8 9506 cpc r9,r21 |
4631 2cda 04F4 brge .L322 |
4632 2cdc A401 movw r20,r8 |
4633 2cde 9301 movw r18,r6 |
4634 .L322: |
4635 2ce0 862F mov r24,r22 |
4636 2ce2 9927 clr r25 |
4637 2ce4 87FD sbrc r24,7 |
4638 2ce6 9095 com r25 |
4639 2ce8 9095 com r25 |
4640 2cea 8195 neg r24 |
4641 2cec 9F4F sbci r25,lo8(-1) |
4642 2cee 7C01 movw r14,r24 |
4643 2cf0 0027 clr r16 |
4644 2cf2 F7FC sbrc r15,7 |
4645 2cf4 0095 com r16 |
4646 2cf6 102F mov r17,r16 |
4647 2cf8 5901 movw r10,r18 |
4648 2cfa 6A01 movw r12,r20 |
4649 2cfc 2E15 cp r18,r14 |
4650 2cfe 3F05 cpc r19,r15 |
4651 2d00 4007 cpc r20,r16 |
4652 2d02 5107 cpc r21,r17 |
4653 2d04 04F4 brge .L323 |
4654 2d06 5701 movw r10,r14 |
4655 2d08 6801 movw r12,r16 |
4656 .L323: |
4657 2d0a C101 movw r24,r2 |
4658 2d0c D201 movw r26,r4 |
4659 2d0e 6816 cp r6,r24 |
4660 2d10 7906 cpc r7,r25 |
4661 2d12 8A06 cpc r8,r26 |
4662 2d14 9B06 cpc r9,r27 |
4663 2d16 04F4 brge .L324 |
4664 2d18 D401 movw r26,r8 |
4665 2d1a C301 movw r24,r6 |
4666 .L324: |
4667 2d1c 8E15 cp r24,r14 |
4668 2d1e 9F05 cpc r25,r15 |
4669 2d20 A007 cpc r26,r16 |
4670 2d22 B107 cpc r27,r17 |
4671 2d24 04F4 brge .+2 |
4672 2d26 00C0 rjmp .L325 |
4673 2d28 7C01 movw r14,r24 |
4674 2d2a 8D01 movw r16,r26 |
4675 2d2c 00C0 rjmp .L325 |
4676 .L317: |
4677 2d2e E090 0000 lds r14,EE_Parameter+28 |
4678 2d32 FF24 clr r15 |
4679 2d34 00E0 ldi r16,lo8(0) |
4680 2d36 10E0 ldi r17,hi8(0) |
4681 2d38 A801 movw r20,r16 |
4682 2d3a 9701 movw r18,r14 |
4683 2d3c 0E94 0000 call __divmodsi4 |
4684 2d40 5901 movw r10,r18 |
4685 2d42 6A01 movw r12,r20 |
4686 2d44 C201 movw r24,r4 |
4687 2d46 AA27 clr r26 |
4688 2d48 97FD sbrc r25,7 |
4689 2d4a A095 com r26 |
4690 2d4c BA2F mov r27,r26 |
4691 2d4e A81A sub r10,r24 |
4692 2d50 B90A sbc r11,r25 |
4693 2d52 CA0A sbc r12,r26 |
4694 2d54 DB0A sbc r13,r27 |
4695 2d56 C401 movw r24,r8 |
4696 2d58 B301 movw r22,r6 |
4697 2d5a A801 movw r20,r16 |
4698 2d5c 9701 movw r18,r14 |
4699 2d5e 0E94 0000 call __divmodsi4 |
4700 2d62 7901 movw r14,r18 |
4701 2d64 8A01 movw r16,r20 |
4702 2d66 C101 movw r24,r2 |
4703 2d68 AA27 clr r26 |
4704 2d6a 97FD sbrc r25,7 |
4705 2d6c A095 com r26 |
4706 2d6e BA2F mov r27,r26 |
4707 2d70 E81A sub r14,r24 |
4708 2d72 F90A sbc r15,r25 |
4709 2d74 0A0B sbc r16,r26 |
4710 2d76 1B0B sbc r17,r27 |
4711 2d78 C601 movw r24,r12 |
4712 2d7a B501 movw r22,r10 |
4713 2d7c 20E1 ldi r18,lo8(16) |
4714 2d7e 30E0 ldi r19,hi8(16) |
4715 2d80 40E0 ldi r20,hlo8(16) |
4716 2d82 50E0 ldi r21,hhi8(16) |
4717 2d84 0E94 0000 call __divmodsi4 |
4718 2d88 922E mov r9,r18 |
4719 2d8a 832E mov r8,r19 |
4720 2d8c 742E mov r7,r20 |
4721 2d8e 652E mov r6,r21 |
4722 2d90 822F mov r24,r18 |
4723 2d92 932F mov r25,r19 |
4724 2d94 A42F mov r26,r20 |
4725 2d96 B52F mov r27,r21 |
4726 2d98 5C01 movw r10,r24 |
4727 2d9a 6D01 movw r12,r26 |
4728 2d9c C801 movw r24,r16 |
4729 2d9e B701 movw r22,r14 |
4730 2da0 20E1 ldi r18,lo8(16) |
4731 2da2 30E0 ldi r19,hi8(16) |
4732 2da4 40E0 ldi r20,hlo8(16) |
4733 2da6 50E0 ldi r21,hhi8(16) |
4734 2da8 0E94 0000 call __divmodsi4 |
4735 2dac 522E mov r5,r18 |
4736 2dae 432E mov r4,r19 |
4737 2db0 1A01 movw r2,r20 |
4738 2db2 822F mov r24,r18 |
4739 2db4 932F mov r25,r19 |
4740 2db6 DA01 movw r26,r20 |
4741 2db8 7C01 movw r14,r24 |
4742 2dba 8D01 movw r16,r26 |
4743 2dbc 8CA9 ldd r24,Y+52 |
4744 2dbe 9DA9 ldd r25,Y+53 |
4745 2dc0 8134 cpi r24,65 |
4746 2dc2 9105 cpc r25,__zero_reg__ |
4747 2dc4 04F4 brge .L326 |
4748 2dc6 8091 0000 lds r24,MaxStickRoll |
4749 2dca 9091 0000 lds r25,(MaxStickRoll)+1 |
4750 2dce 8134 cpi r24,65 |
4751 2dd0 9105 cpc r25,__zero_reg__ |
4752 2dd2 04F0 brlt .L327 |
4753 .L326: |
4754 2dd4 692D mov r22,r9 |
4755 2dd6 782D mov r23,r8 |
4756 2dd8 872D mov r24,r7 |
4757 2dda 962D mov r25,r6 |
4758 2ddc 23E0 ldi r18,lo8(3) |
4759 2dde 30E0 ldi r19,hi8(3) |
4760 2de0 40E0 ldi r20,hlo8(3) |
4761 2de2 50E0 ldi r21,hhi8(3) |
4762 2de4 0E94 0000 call __divmodsi4 |
4763 2de8 C901 movw r24,r18 |
4764 2dea DA01 movw r26,r20 |
4765 2dec 5C01 movw r10,r24 |
4766 2dee 6D01 movw r12,r26 |
4767 2df0 652D mov r22,r5 |
4768 2df2 742D mov r23,r4 |
4769 2df4 C101 movw r24,r2 |
4770 2df6 23E0 ldi r18,lo8(3) |
4771 2df8 30E0 ldi r19,hi8(3) |
4772 2dfa 40E0 ldi r20,hlo8(3) |
4773 2dfc 50E0 ldi r21,hhi8(3) |
4774 2dfe 0E94 0000 call __divmodsi4 |
4775 2e02 C901 movw r24,r18 |
4776 2e04 DA01 movw r26,r20 |
4777 2e06 7C01 movw r14,r24 |
4778 2e08 8D01 movw r16,r26 |
4779 .L327: |
4780 2e0a E091 0000 lds r30,EE_Parameter+4 |
4781 2e0e F0E0 ldi r31,lo8(0) |
4782 2e10 EE0F lsl r30 |
4783 2e12 FF1F rol r31 |
4784 2e14 E050 subi r30,lo8(-(PPM_in)) |
4785 2e16 F040 sbci r31,hi8(-(PPM_in)) |
4786 2e18 0190 ld __tmp_reg__,Z+ |
4787 2e1a F081 ld r31,Z |
4788 2e1c E02D mov r30,__tmp_reg__ |
4789 2e1e F7FF sbrs r31,7 |
4790 2e20 00C0 rjmp .L329 |
4791 2e22 F095 com r31 |
4792 2e24 E195 neg r30 |
4793 2e26 FF4F sbci r31,lo8(-1) |
4794 .L329: |
4795 2e28 7A97 sbiw r30,26 |
4796 2e2a 04F0 brlt .L328 |
4797 2e2c C601 movw r24,r12 |
4798 2e2e B501 movw r22,r10 |
4799 2e30 23E0 ldi r18,lo8(3) |
4800 2e32 30E0 ldi r19,hi8(3) |
4801 2e34 40E0 ldi r20,hlo8(3) |
4802 2e36 50E0 ldi r21,hhi8(3) |
4803 2e38 0E94 0000 call __divmodsi4 |
4804 2e3c C901 movw r24,r18 |
4805 2e3e DA01 movw r26,r20 |
4806 2e40 5C01 movw r10,r24 |
4807 2e42 6D01 movw r12,r26 |
4808 2e44 C801 movw r24,r16 |
4809 2e46 B701 movw r22,r14 |
4810 2e48 23E0 ldi r18,lo8(3) |
4811 2e4a 30E0 ldi r19,hi8(3) |
4812 2e4c 40E0 ldi r20,hlo8(3) |
4813 2e4e 50E0 ldi r21,hhi8(3) |
4814 2e50 0E94 0000 call __divmodsi4 |
4815 2e54 C901 movw r24,r18 |
4816 2e56 DA01 movw r26,r20 |
4817 2e58 7C01 movw r14,r24 |
4818 2e5a 8D01 movw r16,r26 |
4819 .L328: |
4820 2e5c 91E2 ldi r25,lo8(33) |
4821 2e5e A916 cp r10,r25 |
4822 2e60 B104 cpc r11,__zero_reg__ |
4823 2e62 C104 cpc r12,__zero_reg__ |
4824 2e64 D104 cpc r13,__zero_reg__ |
4825 2e66 04F0 brlt .L330 |
4826 2e68 90E2 ldi r25,lo8(32) |
4827 2e6a A92E mov r10,r25 |
4828 2e6c B12C mov r11,__zero_reg__ |
4829 2e6e C12C mov r12,__zero_reg__ |
4830 2e70 D12C mov r13,__zero_reg__ |
4831 2e72 00C0 rjmp .L331 |
4832 .L330: |
4833 2e74 A0EE ldi r26,lo8(-32) |
4834 2e76 AA16 cp r10,r26 |
4835 2e78 AFEF ldi r26,hi8(-32) |
4836 2e7a BA06 cpc r11,r26 |
4837 2e7c AFEF ldi r26,hlo8(-32) |
4838 2e7e CA06 cpc r12,r26 |
4839 2e80 AFEF ldi r26,hhi8(-32) |
4840 2e82 DA06 cpc r13,r26 |
4841 2e84 04F4 brge .L331 |
4842 2e86 80EE ldi r24,lo8(-32) |
4843 2e88 A82E mov r10,r24 |
4844 2e8a 8FEF ldi r24,hi8(-32) |
4845 2e8c B82E mov r11,r24 |
4846 2e8e 8FEF ldi r24,hlo8(-32) |
4847 2e90 C82E mov r12,r24 |
4848 2e92 8FEF ldi r24,hhi8(-32) |
4849 2e94 D82E mov r13,r24 |
4850 .L331: |
4851 2e96 B1E2 ldi r27,lo8(33) |
4852 2e98 EB16 cp r14,r27 |
4853 2e9a F104 cpc r15,__zero_reg__ |
4854 2e9c 0105 cpc r16,__zero_reg__ |
4855 2e9e 1105 cpc r17,__zero_reg__ |
4856 2ea0 04F0 brlt .L332 |
4857 2ea2 10E2 ldi r17,lo8(32) |
4858 2ea4 E12E mov r14,r17 |
4859 2ea6 F12C mov r15,__zero_reg__ |
4860 2ea8 012D mov r16,__zero_reg__ |
4861 2eaa 112D mov r17,__zero_reg__ |
4862 2eac 00C0 rjmp .L325 |
4863 .L332: |
4864 2eae E0EE ldi r30,lo8(-32) |
4865 2eb0 EE16 cp r14,r30 |
4866 2eb2 EFEF ldi r30,hi8(-32) |
4867 2eb4 FE06 cpc r15,r30 |
4868 2eb6 EFEF ldi r30,hlo8(-32) |
4869 2eb8 0E07 cpc r16,r30 |
4870 2eba EFEF ldi r30,hhi8(-32) |
4871 2ebc 1E07 cpc r17,r30 |
4872 2ebe 04F4 brge .L325 |
4873 2ec0 B0EE ldi r27,lo8(-32) |
4874 2ec2 EB2E mov r14,r27 |
4875 2ec4 BFEF ldi r27,hi8(-32) |
4876 2ec6 FB2E mov r15,r27 |
4877 2ec8 BFEF ldi r27,hlo8(-32) |
4878 2eca 0B2F mov r16,r27 |
4879 2ecc BFEF ldi r27,hhi8(-32) |
4880 2ece 1B2F mov r17,r27 |
4881 .L325: |
4882 2ed0 8091 0000 lds r24,Mess_IntegralNick |
4883 2ed4 9091 0000 lds r25,(Mess_IntegralNick)+1 |
4884 2ed8 A091 0000 lds r26,(Mess_IntegralNick)+2 |
4885 2edc B091 0000 lds r27,(Mess_IntegralNick)+3 |
4886 2ee0 8A19 sub r24,r10 |
4887 2ee2 9B09 sbc r25,r11 |
4888 2ee4 AC09 sbc r26,r12 |
4889 2ee6 BD09 sbc r27,r13 |
4890 2ee8 8093 0000 sts Mess_IntegralNick,r24 |
4891 2eec 9093 0000 sts (Mess_IntegralNick)+1,r25 |
4892 2ef0 A093 0000 sts (Mess_IntegralNick)+2,r26 |
4893 2ef4 B093 0000 sts (Mess_IntegralNick)+3,r27 |
4894 2ef8 8091 0000 lds r24,Mess_IntegralRoll |
4895 2efc 9091 0000 lds r25,(Mess_IntegralRoll)+1 |
4896 2f00 A091 0000 lds r26,(Mess_IntegralRoll)+2 |
4897 2f04 B091 0000 lds r27,(Mess_IntegralRoll)+3 |
4898 2f08 8E19 sub r24,r14 |
4899 2f0a 9F09 sbc r25,r15 |
4900 2f0c A00B sbc r26,r16 |
4901 2f0e B10B sbc r27,r17 |
4902 2f10 8093 0000 sts Mess_IntegralRoll,r24 |
4903 2f14 9093 0000 sts (Mess_IntegralRoll)+1,r25 |
4904 2f18 A093 0000 sts (Mess_IntegralRoll)+2,r26 |
4905 2f1c B093 0000 sts (Mess_IntegralRoll)+3,r27 |
4906 .L315: |
4907 2f20 8091 0000 lds r24,ZaehlMessungen |
4908 2f24 9091 0000 lds r25,(ZaehlMessungen)+1 |
4909 2f28 8F3F cpi r24,255 |
4910 2f2a 9105 cpc r25,__zero_reg__ |
4911 2f2c 01F0 breq .+2 |
4912 2f2e 00F4 brsh .+2 |
4913 2f30 00C0 rjmp .L333 |
4914 2f32 8091 0000 lds r24,Looping_Nick |
4915 2f36 8823 tst r24 |
4916 2f38 01F0 breq .+2 |
4917 2f3a 00C0 rjmp .L334 |
4918 2f3c 8091 0000 lds r24,Looping_Roll |
4919 2f40 8823 tst r24 |
4920 2f42 01F0 breq .+2 |
4921 2f44 00C0 rjmp .L334 |
4922 2f46 8091 0000 lds r24,TrichterFlug |
4923 2f4a 8823 tst r24 |
4924 2f4c 01F0 breq .+2 |
4925 2f4e 00C0 rjmp .L334 |
4926 2f50 8091 0000 lds r24,EE_Parameter+66 |
4927 2f54 8823 tst r24 |
4928 2f56 01F4 brne .+2 |
4929 2f58 00C0 rjmp .L334 |
4930 2f5a 6091 0000 lds r22,MittelIntegralNick |
4931 2f5e 7091 0000 lds r23,(MittelIntegralNick)+1 |
4932 2f62 8091 0000 lds r24,(MittelIntegralNick)+2 |
4933 2f66 9091 0000 lds r25,(MittelIntegralNick)+3 |
4934 2f6a 20E0 ldi r18,lo8(256) |
4935 2f6c 31E0 ldi r19,hi8(256) |
4936 2f6e 40E0 ldi r20,hlo8(256) |
4937 2f70 50E0 ldi r21,hhi8(256) |
4938 2f72 0E94 0000 call __divmodsi4 |
4939 2f76 5901 movw r10,r18 |
4940 2f78 6A01 movw r12,r20 |
4941 2f7a 2093 0000 sts MittelIntegralNick,r18 |
4942 2f7e 3093 0000 sts (MittelIntegralNick)+1,r19 |
4943 2f82 4093 0000 sts (MittelIntegralNick)+2,r20 |
4944 2f86 5093 0000 sts (MittelIntegralNick)+3,r21 |
4945 2f8a 6091 0000 lds r22,MittelIntegralRoll |
4946 2f8e 7091 0000 lds r23,(MittelIntegralRoll)+1 |
4947 2f92 8091 0000 lds r24,(MittelIntegralRoll)+2 |
4948 2f96 9091 0000 lds r25,(MittelIntegralRoll)+3 |
4949 2f9a 20E0 ldi r18,lo8(256) |
4950 2f9c 31E0 ldi r19,hi8(256) |
4951 2f9e 40E0 ldi r20,hlo8(256) |
4952 2fa0 50E0 ldi r21,hhi8(256) |
4953 2fa2 0E94 0000 call __divmodsi4 |
4954 2fa6 3901 movw r6,r18 |
4955 2fa8 4A01 movw r8,r20 |
4956 2faa 2093 0000 sts MittelIntegralRoll,r18 |
4957 2fae 3093 0000 sts (MittelIntegralRoll)+1,r19 |
4958 2fb2 4093 0000 sts (MittelIntegralRoll)+2,r20 |
4959 2fb6 5093 0000 sts (MittelIntegralRoll)+3,r21 |
4960 2fba E090 0000 lds r14,EE_Parameter+28 |
4961 2fbe FF24 clr r15 |
4962 2fc0 00E0 ldi r16,lo8(0) |
4963 2fc2 10E0 ldi r17,hi8(0) |
4964 2fc4 2091 0000 lds r18,IntegralAccNick |
4965 2fc8 3091 0000 lds r19,(IntegralAccNick)+1 |
4966 2fcc 4091 0000 lds r20,(IntegralAccNick)+2 |
4967 2fd0 5091 0000 lds r21,(IntegralAccNick)+3 |
4968 2fd4 C801 movw r24,r16 |
4969 2fd6 B701 movw r22,r14 |
4970 2fd8 0E94 0000 call __mulsi3 |
4971 2fdc 20E0 ldi r18,lo8(256) |
4972 2fde 31E0 ldi r19,hi8(256) |
4973 2fe0 40E0 ldi r20,hlo8(256) |
4974 2fe2 50E0 ldi r21,hhi8(256) |
4975 2fe4 0E94 0000 call __divmodsi4 |
4976 2fe8 28A7 std Y+40,r18 |
4977 2fea 39A7 std Y+41,r19 |
4978 2fec 4AA7 std Y+42,r20 |
4979 2fee 5BA7 std Y+43,r21 |
4980 2ff0 2093 0000 sts IntegralAccNick,r18 |
4981 2ff4 3093 0000 sts (IntegralAccNick)+1,r19 |
4982 2ff8 4093 0000 sts (IntegralAccNick)+2,r20 |
4983 2ffc 5093 0000 sts (IntegralAccNick)+3,r21 |
4984 3000 2091 0000 lds r18,IntegralAccRoll |
4985 3004 3091 0000 lds r19,(IntegralAccRoll)+1 |
4986 3008 4091 0000 lds r20,(IntegralAccRoll)+2 |
4987 300c 5091 0000 lds r21,(IntegralAccRoll)+3 |
4988 3010 C801 movw r24,r16 |
4989 3012 B701 movw r22,r14 |
4990 3014 0E94 0000 call __mulsi3 |
4991 3018 20E0 ldi r18,lo8(256) |
4992 301a 31E0 ldi r19,hi8(256) |
4993 301c 40E0 ldi r20,hlo8(256) |
4994 301e 50E0 ldi r21,hhi8(256) |
4995 3020 0E94 0000 call __divmodsi4 |
4996 3024 1901 movw r2,r18 |
4997 3026 2A01 movw r4,r20 |
4998 3028 2093 0000 sts IntegralAccRoll,r18 |
4999 302c 3093 0000 sts (IntegralAccRoll)+1,r19 |
5000 3030 4093 0000 sts (IntegralAccRoll)+2,r20 |
5001 3034 5093 0000 sts (IntegralAccRoll)+3,r21 |
5002 3038 6091 0000 lds r22,IntegralAccZ |
5003 303c 7091 0000 lds r23,(IntegralAccZ)+1 |
5004 3040 8091 0000 lds r24,(IntegralAccZ)+2 |
5005 3044 9091 0000 lds r25,(IntegralAccZ)+3 |
5006 3048 20E0 ldi r18,lo8(256) |
5007 304a 31E0 ldi r19,hi8(256) |
5008 304c 40E0 ldi r20,hlo8(256) |
5009 304e 50E0 ldi r21,hhi8(256) |
5010 3050 0E94 0000 call __divmodsi4 |
5011 3054 2093 0000 sts IntegralAccZ,r18 |
5012 3058 3093 0000 sts (IntegralAccZ)+1,r19 |
5013 305c 4093 0000 sts (IntegralAccZ)+2,r20 |
5014 3060 5093 0000 sts (IntegralAccZ)+3,r21 |
5015 3064 28A5 ldd r18,Y+40 |
5016 3066 39A5 ldd r19,Y+41 |
5017 3068 4AA5 ldd r20,Y+42 |
5018 306a 5BA5 ldd r21,Y+43 |
5019 306c A21A sub r10,r18 |
5020 306e B30A sbc r11,r19 |
5021 3070 C40A sbc r12,r20 |
5022 3072 D50A sbc r13,r21 |
5023 3074 A092 0000 sts IntegralFehlerNick.3045,r10 |
5024 3078 B092 0000 sts (IntegralFehlerNick.3045)+1,r11 |
5025 307c C092 0000 sts (IntegralFehlerNick.3045)+2,r12 |
5026 3080 D092 0000 sts (IntegralFehlerNick.3045)+3,r13 |
5027 3084 E090 0000 lds r14,EE_Parameter+65 |
5028 3088 FF24 clr r15 |
5029 308a 00E0 ldi r16,lo8(0) |
5030 308c 10E0 ldi r17,hi8(0) |
5031 308e C601 movw r24,r12 |
5032 3090 B501 movw r22,r10 |
5033 3092 A801 movw r20,r16 |
5034 3094 9701 movw r18,r14 |
5035 3096 0E94 0000 call __divmodsi4 |
5036 309a 5901 movw r10,r18 |
5037 309c 6A01 movw r12,r20 |
5038 309e 2093 0000 sts ausgleichNick.3053,r18 |
5039 30a2 3093 0000 sts (ausgleichNick.3053)+1,r19 |
5040 30a6 4093 0000 sts (ausgleichNick.3053)+2,r20 |
5041 30aa 5093 0000 sts (ausgleichNick.3053)+3,r21 |
5042 30ae 6218 sub r6,r2 |
5043 30b0 7308 sbc r7,r3 |
5044 30b2 8408 sbc r8,r4 |
5045 30b4 9508 sbc r9,r5 |
5046 30b6 6092 0000 sts IntegralFehlerRoll.3046,r6 |
5047 30ba 7092 0000 sts (IntegralFehlerRoll.3046)+1,r7 |
5048 30be 8092 0000 sts (IntegralFehlerRoll.3046)+2,r8 |
5049 30c2 9092 0000 sts (IntegralFehlerRoll.3046)+3,r9 |
5050 30c6 C401 movw r24,r8 |
5051 30c8 B301 movw r22,r6 |
5052 30ca A801 movw r20,r16 |
5053 30cc 9701 movw r18,r14 |
5054 30ce 0E94 0000 call __divmodsi4 |
5055 30d2 7901 movw r14,r18 |
5056 30d4 8A01 movw r16,r20 |
5057 30d6 2093 0000 sts ausgleichRoll.3054,r18 |
5058 30da 3093 0000 sts (ausgleichRoll.3054)+1,r19 |
5059 30de 4093 0000 sts (ausgleichRoll.3054)+2,r20 |
5060 30e2 5093 0000 sts (ausgleichRoll.3054)+3,r21 |
5061 30e6 C601 movw r24,r12 |
5062 30e8 B501 movw r22,r10 |
5063 30ea 20E0 ldi r18,lo8(256) |
5064 30ec 31E0 ldi r19,hi8(256) |
5065 30ee 40E0 ldi r20,hlo8(256) |
5066 30f0 50E0 ldi r21,hhi8(256) |
5067 30f2 0E94 0000 call __divmodsi4 |
5068 30f6 3093 0000 sts (LageKorrekturNick)+1,r19 |
5069 30fa 2093 0000 sts LageKorrekturNick,r18 |
5070 30fe C801 movw r24,r16 |
5071 3100 B701 movw r22,r14 |
5072 3102 20E0 ldi r18,lo8(256) |
5073 3104 31E0 ldi r19,hi8(256) |
5074 3106 40E0 ldi r20,hlo8(256) |
5075 3108 50E0 ldi r21,hhi8(256) |
5076 310a 0E94 0000 call __divmodsi4 |
5077 310e 3093 0000 sts (LageKorrekturRoll)+1,r19 |
5078 3112 2093 0000 sts LageKorrekturRoll,r18 |
5079 3116 8091 0000 lds r24,MaxStickNick |
5080 311a 9091 0000 lds r25,(MaxStickNick)+1 |
5081 311e 8134 cpi r24,65 |
5082 3120 9105 cpc r25,__zero_reg__ |
5083 3122 04F4 brge .L335 |
5084 3124 8091 0000 lds r24,MaxStickRoll |
5085 3128 9091 0000 lds r25,(MaxStickRoll)+1 |
5086 312c 8134 cpi r24,65 |
5087 312e 9105 cpc r25,__zero_reg__ |
5088 3130 04F4 brge .L335 |
5089 3132 E091 0000 lds r30,EE_Parameter+4 |
5090 3136 F0E0 ldi r31,lo8(0) |
5091 3138 EE0F lsl r30 |
5092 313a FF1F rol r31 |
5093 313c E050 subi r30,lo8(-(PPM_in)) |
5094 313e F040 sbci r31,hi8(-(PPM_in)) |
5095 3140 0190 ld __tmp_reg__,Z+ |
5096 3142 F081 ld r31,Z |
5097 3144 E02D mov r30,__tmp_reg__ |
5098 3146 F7FF sbrs r31,7 |
5099 3148 00C0 rjmp .L337 |
5100 314a F095 com r31 |
5101 314c E195 neg r30 |
5102 314e FF4F sbci r31,lo8(-1) |
5103 .L337: |
5104 3150 7A97 sbiw r30,26 |
5105 3152 04F0 brlt .L336 |
5106 .L335: |
5107 3154 8091 0000 lds r24,FromNaviCtrl_Value |
5108 3158 8F3F cpi r24,lo8(-1) |
5109 315a 01F4 brne .L336 |
5110 315c 8091 0000 lds r24,LageKorrekturNick |
5111 3160 9091 0000 lds r25,(LageKorrekturNick)+1 |
5112 3164 62E0 ldi r22,lo8(2) |
5113 3166 70E0 ldi r23,hi8(2) |
5114 3168 0E94 0000 call __divmodhi4 |
5115 316c 7093 0000 sts (LageKorrekturNick)+1,r23 |
5116 3170 6093 0000 sts LageKorrekturNick,r22 |
5117 3174 8091 0000 lds r24,LageKorrekturRoll |
5118 3178 9091 0000 lds r25,(LageKorrekturRoll)+1 |
5119 317c 62E0 ldi r22,lo8(2) |
5120 317e 70E0 ldi r23,hi8(2) |
5121 3180 0E94 0000 call __divmodhi4 |
5122 3184 7093 0000 sts (LageKorrekturRoll)+1,r23 |
5123 3188 6093 0000 sts LageKorrekturRoll,r22 |
5124 .L336: |
5125 318c E090 0000 lds r14,IntegralNick2 |
5126 3190 F090 0000 lds r15,(IntegralNick2)+1 |
5127 3194 0091 0000 lds r16,(IntegralNick2)+2 |
5128 3198 1091 0000 lds r17,(IntegralNick2)+3 |
5129 319c 8091 0000 lds r24,IntegralNick |
5130 31a0 9091 0000 lds r25,(IntegralNick)+1 |
5131 31a4 A091 0000 lds r26,(IntegralNick)+2 |
5132 31a8 B091 0000 lds r27,(IntegralNick)+3 |
5133 31ac E81A sub r14,r24 |
5134 31ae F90A sbc r15,r25 |
5135 31b0 0A0B sbc r16,r26 |
5136 31b2 1B0B sbc r17,r27 |
5137 31b4 E092 0000 sts tmp_long.3043,r14 |
5138 31b8 F092 0000 sts (tmp_long.3043)+1,r15 |
5139 31bc 0093 0000 sts (tmp_long.3043)+2,r16 |
5140 31c0 1093 0000 sts (tmp_long.3043)+3,r17 |
5141 31c4 2091 0000 lds r18,IntegralRoll2 |
5142 31c8 3091 0000 lds r19,(IntegralRoll2)+1 |
5143 31cc 4091 0000 lds r20,(IntegralRoll2)+2 |
5144 31d0 5091 0000 lds r21,(IntegralRoll2)+3 |
5145 31d4 8091 0000 lds r24,IntegralRoll |
5146 31d8 9091 0000 lds r25,(IntegralRoll)+1 |
5147 31dc A091 0000 lds r26,(IntegralRoll)+2 |
5148 31e0 B091 0000 lds r27,(IntegralRoll)+3 |
5149 31e4 281B sub r18,r24 |
5150 31e6 390B sbc r19,r25 |
5151 31e8 4A0B sbc r20,r26 |
5152 31ea 5B0B sbc r21,r27 |
5153 31ec 2093 0000 sts tmp_long2.3044,r18 |
5154 31f0 3093 0000 sts (tmp_long2.3044)+1,r19 |
5155 31f4 4093 0000 sts (tmp_long2.3044)+2,r20 |
5156 31f8 5093 0000 sts (tmp_long2.3044)+3,r21 |
5157 31fc E092 0000 sts IntegralFehlerNick.3045,r14 |
5158 3200 F092 0000 sts (IntegralFehlerNick.3045)+1,r15 |
5159 3204 0093 0000 sts (IntegralFehlerNick.3045)+2,r16 |
5160 3208 1093 0000 sts (IntegralFehlerNick.3045)+3,r17 |
5161 320c 2093 0000 sts IntegralFehlerRoll.3046,r18 |
5162 3210 3093 0000 sts (IntegralFehlerRoll.3046)+1,r19 |
5163 3214 4093 0000 sts (IntegralFehlerRoll.3046)+2,r20 |
5164 3218 5093 0000 sts (IntegralFehlerRoll.3046)+3,r21 |
5165 321c 8091 0000 lds r24,Mess_IntegralNick2 |
5166 3220 9091 0000 lds r25,(Mess_IntegralNick2)+1 |
5167 3224 A091 0000 lds r26,(Mess_IntegralNick2)+2 |
5168 3228 B091 0000 lds r27,(Mess_IntegralNick2)+3 |
5169 322c 8E19 sub r24,r14 |
5170 322e 9F09 sbc r25,r15 |
5171 3230 A00B sbc r26,r16 |
5172 3232 B10B sbc r27,r17 |
5173 3234 8093 0000 sts Mess_IntegralNick2,r24 |
5174 3238 9093 0000 sts (Mess_IntegralNick2)+1,r25 |
5175 323c A093 0000 sts (Mess_IntegralNick2)+2,r26 |
5176 3240 B093 0000 sts (Mess_IntegralNick2)+3,r27 |
5177 3244 8091 0000 lds r24,Mess_IntegralRoll2 |
5178 3248 9091 0000 lds r25,(Mess_IntegralRoll2)+1 |
5179 324c A091 0000 lds r26,(Mess_IntegralRoll2)+2 |
5180 3250 B091 0000 lds r27,(Mess_IntegralRoll2)+3 |
5181 3254 821B sub r24,r18 |
5182 3256 930B sbc r25,r19 |
5183 3258 A40B sbc r26,r20 |
5184 325a B50B sbc r27,r21 |
5185 325c 8093 0000 sts Mess_IntegralRoll2,r24 |
5186 3260 9093 0000 sts (Mess_IntegralRoll2)+1,r25 |
5187 3264 A093 0000 sts (Mess_IntegralRoll2)+2,r26 |
5188 3268 B093 0000 sts (Mess_IntegralRoll2)+3,r27 |
5189 326c 8091 0000 lds r24,EE_Parameter+66 |
5190 3270 8823 tst r24 |
5191 3272 01F0 breq .L338 |
5192 3274 8091 0000 lds r24,GierGyroFehler |
5193 3278 9091 0000 lds r25,(GierGyroFehler)+1 |
5194 327c 8138 cpi r24,129 |
5195 327e 9105 cpc r25,__zero_reg__ |
5196 3280 04F0 brlt .L339 |
5197 3282 8091 0000 lds r24,AdNeutralGier |
5198 3286 9091 0000 lds r25,(AdNeutralGier)+1 |
5199 328a 0196 adiw r24,1 |
5200 328c 9093 0000 sts (AdNeutralGier)+1,r25 |
5201 3290 8093 0000 sts AdNeutralGier,r24 |
5202 .L339: |
5203 3294 8091 0000 lds r24,GierGyroFehler |
5204 3298 9091 0000 lds r25,(GierGyroFehler)+1 |
5205 329c 8058 subi r24,lo8(-128) |
5206 329e 9F4F sbci r25,hi8(-128) |
5207 32a0 04F4 brge .L338 |
5208 32a2 8091 0000 lds r24,AdNeutralGier |
5209 32a6 9091 0000 lds r25,(AdNeutralGier)+1 |
5210 32aa 0197 sbiw r24,1 |
5211 32ac 9093 0000 sts (AdNeutralGier)+1,r25 |
5212 32b0 8093 0000 sts AdNeutralGier,r24 |
5213 .L338: |
5214 32b4 1092 0000 sts (GierGyroFehler)+1,__zero_reg__ |
5215 32b8 1092 0000 sts GierGyroFehler,__zero_reg__ |
5216 32bc 81E0 ldi r24,lo8(1) |
5217 32be 90E0 ldi r25,hi8(1) |
5218 32c0 9093 0000 sts (cnt.3066)+1,r25 |
5219 32c4 8093 0000 sts cnt.3066,r24 |
5220 32c8 8091 0000 lds r24,IntegralFehlerNick.3045 |
5221 32cc 9091 0000 lds r25,(IntegralFehlerNick.3045)+1 |
5222 32d0 A091 0000 lds r26,(IntegralFehlerNick.3045)+2 |
5223 32d4 B091 0000 lds r27,(IntegralFehlerNick.3045)+3 |
5224 32d8 B7FF sbrs r27,7 |
5225 32da 00C0 rjmp .L341 |
5226 32dc B095 com r27 |
5227 32de A095 com r26 |
5228 32e0 9095 com r25 |
5229 32e2 8195 neg r24 |
5230 32e4 9F4F sbci r25,lo8(-1) |
5231 32e6 AF4F sbci r26,lo8(-1) |
5232 32e8 BF4F sbci r27,lo8(-1) |
5233 .L341: |
5234 32ea 8150 subi r24,lo8(513) |
5235 32ec 9240 sbci r25,hi8(513) |
5236 32ee A040 sbci r26,hlo8(513) |
5237 32f0 B040 sbci r27,hhi8(513) |
5238 32f2 04F0 brlt .L340 |
5239 32f4 84E0 ldi r24,lo8(4) |
5240 32f6 90E0 ldi r25,hi8(4) |
5241 32f8 9093 0000 sts (cnt.3066)+1,r25 |
5242 32fc 8093 0000 sts cnt.3066,r24 |
5243 .L340: |
5244 3300 8091 0000 lds r24,MittelIntegralNick_Alt.3071 |
5245 3304 9091 0000 lds r25,(MittelIntegralNick_Alt.3071)+1 |
5246 3308 A091 0000 lds r26,(MittelIntegralNick_Alt.3071)+2 |
5247 330c B091 0000 lds r27,(MittelIntegralNick_Alt.3071)+3 |
5248 3310 2091 0000 lds r18,MittelIntegralNick |
5249 3314 3091 0000 lds r19,(MittelIntegralNick)+1 |
5250 3318 4091 0000 lds r20,(MittelIntegralNick)+2 |
5251 331c 5091 0000 lds r21,(MittelIntegralNick)+3 |
5252 3320 821B sub r24,r18 |
5253 3322 930B sbc r25,r19 |
5254 3324 A40B sbc r26,r20 |
5255 3326 B50B sbc r27,r21 |
5256 3328 815E subi r24,lo8(-(19999)) |
5257 332a 914B sbci r25,hi8(-(19999)) |
5258 332c AF4F sbci r26,hlo8(-(19999)) |
5259 332e BF4F sbci r27,hhi8(-(19999)) |
5260 3330 8F53 subi r24,lo8(39999) |
5261 3332 9C49 sbci r25,hi8(39999) |
5262 3334 A040 sbci r26,hlo8(39999) |
5263 3336 B040 sbci r27,hhi8(39999) |
5264 3338 00F0 brlo .L342 |
5265 333a 8091 0000 lds r24,FromNaviCtrl_Value+1 |
5266 333e 8931 cpi r24,lo8(25) |
5267 3340 04F4 brge .+2 |
5268 3342 00C0 rjmp .L343 |
5269 .L342: |
5270 3344 E090 0000 lds r14,IntegralFehlerNick.3045 |
5271 3348 F090 0000 lds r15,(IntegralFehlerNick.3045)+1 |
5272 334c 0091 0000 lds r16,(IntegralFehlerNick.3045)+2 |
5273 3350 1091 0000 lds r17,(IntegralFehlerNick.3045)+3 |
5274 3354 61E0 ldi r22,lo8(4097) |
5275 3356 E616 cp r14,r22 |
5276 3358 60E1 ldi r22,hi8(4097) |
5277 335a F606 cpc r15,r22 |
5278 335c 60E0 ldi r22,hlo8(4097) |
5279 335e 0607 cpc r16,r22 |
5280 3360 60E0 ldi r22,hhi8(4097) |
5281 3362 1607 cpc r17,r22 |
5282 3364 04F4 brge .+2 |
5283 3366 00C0 rjmp .L344 |
5284 3368 8091 0000 lds r24,last_n_p.3067 |
5285 336c 8823 tst r24 |
5286 336e 01F4 brne .+2 |
5287 3370 00C0 rjmp .L345 |
5288 3372 A801 movw r20,r16 |
5289 3374 9701 movw r18,r14 |
5290 3376 F9E0 ldi r31,9 |
5291 3378 5595 1: asr r21 |
5292 337a 4795 ror r20 |
5293 337c 3795 ror r19 |
5294 337e 2795 ror r18 |
5295 3380 FA95 dec r31 |
5296 3382 01F4 brne 1b |
5297 3384 8091 0000 lds r24,cnt.3066 |
5298 3388 9091 0000 lds r25,(cnt.3066)+1 |
5299 338c 820F add r24,r18 |
5300 338e 931F adc r25,r19 |
5301 3390 9093 0000 sts (cnt.3066)+1,r25 |
5302 3394 8093 0000 sts cnt.3066,r24 |
5303 3398 C801 movw r24,r16 |
5304 339a B701 movw r22,r14 |
5305 339c 28E0 ldi r18,lo8(8) |
5306 339e 30E0 ldi r19,hi8(8) |
5307 33a0 40E0 ldi r20,hlo8(8) |
5308 33a2 50E0 ldi r21,hhi8(8) |
5309 33a4 0E94 0000 call __divmodsi4 |
5310 33a8 C901 movw r24,r18 |
5311 33aa DA01 movw r26,r20 |
5312 33ac 8093 0000 sts ausgleichNick.3053,r24 |
5313 33b0 9093 0000 sts (ausgleichNick.3053)+1,r25 |
5314 33b4 A093 0000 sts (ausgleichNick.3053)+2,r26 |
5315 33b8 B093 0000 sts (ausgleichNick.3053)+3,r27 |
5316 33bc 8958 subi r24,lo8(5001) |
5317 33be 9341 sbci r25,hi8(5001) |
5318 33c0 A040 sbci r26,hlo8(5001) |
5319 33c2 B040 sbci r27,hhi8(5001) |
5320 33c4 04F0 brlt .L346 |
5321 33c6 88E8 ldi r24,lo8(5000) |
5322 33c8 93E1 ldi r25,hi8(5000) |
5323 33ca A0E0 ldi r26,hlo8(5000) |
5324 33cc B0E0 ldi r27,hhi8(5000) |
5325 33ce 8093 0000 sts ausgleichNick.3053,r24 |
5326 33d2 9093 0000 sts (ausgleichNick.3053)+1,r25 |
5327 33d6 A093 0000 sts (ausgleichNick.3053)+2,r26 |
5328 33da B093 0000 sts (ausgleichNick.3053)+3,r27 |
5329 .L346: |
5330 33de 6091 0000 lds r22,ausgleichNick.3053 |
5331 33e2 7091 0000 lds r23,(ausgleichNick.3053)+1 |
5332 33e6 8091 0000 lds r24,(ausgleichNick.3053)+2 |
5333 33ea 9091 0000 lds r25,(ausgleichNick.3053)+3 |
5334 33ee 20E0 ldi r18,lo8(256) |
5335 33f0 31E0 ldi r19,hi8(256) |
5336 33f2 40E0 ldi r20,hlo8(256) |
5337 33f4 50E0 ldi r21,hhi8(256) |
5338 33f6 0E94 0000 call __divmodsi4 |
5339 33fa 8091 0000 lds r24,LageKorrekturNick |
5340 33fe 9091 0000 lds r25,(LageKorrekturNick)+1 |
5341 3402 820F add r24,r18 |
5342 3404 931F adc r25,r19 |
5343 3406 9093 0000 sts (LageKorrekturNick)+1,r25 |
5344 340a 8093 0000 sts LageKorrekturNick,r24 |
5345 340e 00C0 rjmp .L347 |
5346 .L345: |
5347 3410 81E0 ldi r24,lo8(1) |
5348 3412 8093 0000 sts last_n_p.3067,r24 |
5349 3416 00C0 rjmp .L347 |
5350 .L344: |
5351 3418 1092 0000 sts last_n_p.3067,__zero_reg__ |
5352 .L347: |
5353 341c 4091 0000 lds r20,IntegralFehlerNick.3045 |
5354 3420 5091 0000 lds r21,(IntegralFehlerNick.3045)+1 |
5355 3424 6091 0000 lds r22,(IntegralFehlerNick.3045)+2 |
5356 3428 7091 0000 lds r23,(IntegralFehlerNick.3045)+3 |
5357 342c 4030 cpi r20,lo8(-4096) |
5358 342e 80EF ldi r24,hi8(-4096) |
5359 3430 5807 cpc r21,r24 |
5360 3432 8FEF ldi r24,hlo8(-4096) |
5361 3434 6807 cpc r22,r24 |
5362 3436 8FEF ldi r24,hhi8(-4096) |
5363 3438 7807 cpc r23,r24 |
5364 343a 04F0 brlt .+2 |
5365 343c 00C0 rjmp .L348 |
5366 343e 8091 0000 lds r24,last_n_n.3068 |
5367 3442 8823 tst r24 |
5368 3444 01F4 brne .+2 |
5369 3446 00C0 rjmp .L349 |
5370 3448 8827 clr r24 |
5371 344a 9927 clr r25 |
5372 344c DC01 movw r26,r24 |
5373 344e 841B sub r24,r20 |
5374 3450 950B sbc r25,r21 |
5375 3452 A60B sbc r26,r22 |
5376 3454 B70B sbc r27,r23 |
5377 3456 E9E0 ldi r30,9 |
5378 3458 B595 1: asr r27 |
5379 345a A795 ror r26 |
5380 345c 9795 ror r25 |
5381 345e 8795 ror r24 |
5382 3460 EA95 dec r30 |
5383 3462 01F4 brne 1b |
5384 3464 2091 0000 lds r18,cnt.3066 |
5385 3468 3091 0000 lds r19,(cnt.3066)+1 |
5386 346c 280F add r18,r24 |
5387 346e 391F adc r19,r25 |
5388 3470 3093 0000 sts (cnt.3066)+1,r19 |
5389 3474 2093 0000 sts cnt.3066,r18 |
5390 3478 CB01 movw r24,r22 |
5391 347a BA01 movw r22,r20 |
5392 347c 28E0 ldi r18,lo8(8) |
5393 347e 30E0 ldi r19,hi8(8) |
5394 3480 40E0 ldi r20,hlo8(8) |
5395 3482 50E0 ldi r21,hhi8(8) |
5396 3484 0E94 0000 call __divmodsi4 |
5397 3488 C901 movw r24,r18 |
5398 348a DA01 movw r26,r20 |
5399 348c 8093 0000 sts ausgleichNick.3053,r24 |
5400 3490 9093 0000 sts (ausgleichNick.3053)+1,r25 |
5401 3494 A093 0000 sts (ausgleichNick.3053)+2,r26 |
5402 3498 B093 0000 sts (ausgleichNick.3053)+3,r27 |
5403 349c 8857 subi r24,lo8(-5000) |
5404 349e 9C4E sbci r25,hi8(-5000) |
5405 34a0 AF4F sbci r26,hlo8(-5000) |
5406 34a2 BF4F sbci r27,hhi8(-5000) |
5407 34a4 04F4 brge .L350 |
5408 34a6 88E7 ldi r24,lo8(-5000) |
5409 34a8 9CEE ldi r25,hi8(-5000) |
5410 34aa AFEF ldi r26,hlo8(-5000) |
5411 34ac BFEF ldi r27,hhi8(-5000) |
5412 34ae 8093 0000 sts ausgleichNick.3053,r24 |
5413 34b2 9093 0000 sts (ausgleichNick.3053)+1,r25 |
5414 34b6 A093 0000 sts (ausgleichNick.3053)+2,r26 |
5415 34ba B093 0000 sts (ausgleichNick.3053)+3,r27 |
5416 .L350: |
5417 34be 6091 0000 lds r22,ausgleichNick.3053 |
5418 34c2 7091 0000 lds r23,(ausgleichNick.3053)+1 |
5419 34c6 8091 0000 lds r24,(ausgleichNick.3053)+2 |
5420 34ca 9091 0000 lds r25,(ausgleichNick.3053)+3 |
5421 34ce 20E0 ldi r18,lo8(256) |
5422 34d0 31E0 ldi r19,hi8(256) |
5423 34d2 40E0 ldi r20,hlo8(256) |
5424 34d4 50E0 ldi r21,hhi8(256) |
5425 34d6 0E94 0000 call __divmodsi4 |
5426 34da 8091 0000 lds r24,LageKorrekturNick |
5427 34de 9091 0000 lds r25,(LageKorrekturNick)+1 |
5428 34e2 820F add r24,r18 |
5429 34e4 931F adc r25,r19 |
5430 34e6 9093 0000 sts (LageKorrekturNick)+1,r25 |
5431 34ea 8093 0000 sts LageKorrekturNick,r24 |
5432 34ee 00C0 rjmp .L351 |
5433 .L349: |
5434 34f0 81E0 ldi r24,lo8(1) |
5435 34f2 8093 0000 sts last_n_n.3068,r24 |
5436 34f6 00C0 rjmp .L351 |
5437 .L348: |
5438 34f8 1092 0000 sts last_n_n.3068,__zero_reg__ |
5439 34fc 00C0 rjmp .L351 |
5440 .L343: |
5441 34fe 1092 0000 sts (cnt.3066)+1,__zero_reg__ |
5442 3502 1092 0000 sts cnt.3066,__zero_reg__ |
5443 3506 88EE ldi r24,lo8(1000) |
5444 3508 93E0 ldi r25,hi8(1000) |
5445 350a 9093 0000 sts (KompassSignalSchlecht)+1,r25 |
5446 350e 8093 0000 sts KompassSignalSchlecht,r24 |
5447 .L351: |
5448 3512 8091 0000 lds r24,EE_Parameter+66 |
5449 3516 282F mov r18,r24 |
5450 3518 30E0 ldi r19,lo8(0) |
5451 351a 8091 0000 lds r24,cnt.3066 |
5452 351e 9091 0000 lds r25,(cnt.3066)+1 |
5453 3522 2817 cp r18,r24 |
5454 3524 3907 cpc r19,r25 |
5455 3526 04F4 brge .L352 |
5456 3528 3093 0000 sts (cnt.3066)+1,r19 |
5457 352c 2093 0000 sts cnt.3066,r18 |
5458 .L352: |
5459 3530 8091 0000 lds r24,FromNaviCtrl_Value+1 |
5460 3534 8823 tst r24 |
5461 3536 01F0 breq .L353 |
5462 3538 282F mov r18,r24 |
5463 353a 3327 clr r19 |
5464 353c 27FD sbrc r18,7 |
5465 353e 3095 com r19 |
5466 3540 8091 0000 lds r24,cnt.3066 |
5467 3544 9091 0000 lds r25,(cnt.3066)+1 |
5468 3548 2817 cp r18,r24 |
5469 354a 3907 cpc r19,r25 |
5470 354c 04F4 brge .L353 |
5471 354e 3093 0000 sts (cnt.3066)+1,r19 |
5472 3552 2093 0000 sts cnt.3066,r18 |
5473 .L353: |
5474 3556 8091 0000 lds r24,IntegralFehlerNick.3045 |
5475 355a 9091 0000 lds r25,(IntegralFehlerNick.3045)+1 |
5476 355e A091 0000 lds r26,(IntegralFehlerNick.3045)+2 |
5477 3562 B091 0000 lds r27,(IntegralFehlerNick.3045)+3 |
5478 3566 8138 cpi r24,lo8(129) |
5479 3568 9105 cpc r25,__zero_reg__ |
5480 356a A105 cpc r26,__zero_reg__ |
5481 356c B105 cpc r27,__zero_reg__ |
5482 356e 04F0 brlt .L354 |
5483 3570 8091 0000 lds r24,AdNeutralNick |
5484 3574 9091 0000 lds r25,(AdNeutralNick)+1 |
5485 3578 2091 0000 lds r18,cnt.3066 |
5486 357c 3091 0000 lds r19,(cnt.3066)+1 |
5487 3580 820F add r24,r18 |
5488 3582 931F adc r25,r19 |
5489 3584 9093 0000 sts (AdNeutralNick)+1,r25 |
5490 3588 8093 0000 sts AdNeutralNick,r24 |
5491 .L354: |
5492 358c 8091 0000 lds r24,IntegralFehlerNick.3045 |
5493 3590 9091 0000 lds r25,(IntegralFehlerNick.3045)+1 |
5494 3594 A091 0000 lds r26,(IntegralFehlerNick.3045)+2 |
5495 3598 B091 0000 lds r27,(IntegralFehlerNick.3045)+3 |
5496 359c 8058 subi r24,lo8(-128) |
5497 359e 9F4F sbci r25,hi8(-128) |
5498 35a0 AF4F sbci r26,hlo8(-128) |
5499 35a2 BF4F sbci r27,hhi8(-128) |
5500 35a4 04F4 brge .L355 |
5501 35a6 8091 0000 lds r24,AdNeutralNick |
5502 35aa 9091 0000 lds r25,(AdNeutralNick)+1 |
5503 35ae 2091 0000 lds r18,cnt.3066 |
5504 35b2 3091 0000 lds r19,(cnt.3066)+1 |
5505 35b6 821B sub r24,r18 |
5506 35b8 930B sbc r25,r19 |
5507 35ba 9093 0000 sts (AdNeutralNick)+1,r25 |
5508 35be 8093 0000 sts AdNeutralNick,r24 |
5509 .L355: |
5510 35c2 81E0 ldi r24,lo8(1) |
5511 35c4 90E0 ldi r25,hi8(1) |
5512 35c6 9093 0000 sts (cnt.3066)+1,r25 |
5513 35ca 8093 0000 sts cnt.3066,r24 |
5514 35ce 8091 0000 lds r24,IntegralFehlerRoll.3046 |
5515 35d2 9091 0000 lds r25,(IntegralFehlerRoll.3046)+1 |
5516 35d6 A091 0000 lds r26,(IntegralFehlerRoll.3046)+2 |
5517 35da B091 0000 lds r27,(IntegralFehlerRoll.3046)+3 |
5518 35de B7FF sbrs r27,7 |
5519 35e0 00C0 rjmp .L357 |
5520 35e2 B095 com r27 |
5521 35e4 A095 com r26 |
5522 35e6 9095 com r25 |
5523 35e8 8195 neg r24 |
5524 35ea 9F4F sbci r25,lo8(-1) |
5525 35ec AF4F sbci r26,lo8(-1) |
5526 35ee BF4F sbci r27,lo8(-1) |
5527 .L357: |
5528 35f0 8150 subi r24,lo8(513) |
5529 35f2 9240 sbci r25,hi8(513) |
5530 35f4 A040 sbci r26,hlo8(513) |
5531 35f6 B040 sbci r27,hhi8(513) |
5532 35f8 04F0 brlt .L356 |
5533 35fa 84E0 ldi r24,lo8(4) |
5534 35fc 90E0 ldi r25,hi8(4) |
5535 35fe 9093 0000 sts (cnt.3066)+1,r25 |
5536 3602 8093 0000 sts cnt.3066,r24 |
5537 .L356: |
5538 3606 8091 0000 lds r24,MittelIntegralRoll_Alt.3072 |
5539 360a 9091 0000 lds r25,(MittelIntegralRoll_Alt.3072)+1 |
5540 360e A091 0000 lds r26,(MittelIntegralRoll_Alt.3072)+2 |
5541 3612 B091 0000 lds r27,(MittelIntegralRoll_Alt.3072)+3 |
5542 3616 2091 0000 lds r18,MittelIntegralRoll |
5543 361a 3091 0000 lds r19,(MittelIntegralRoll)+1 |
5544 361e 4091 0000 lds r20,(MittelIntegralRoll)+2 |
5545 3622 5091 0000 lds r21,(MittelIntegralRoll)+3 |
5546 3626 821B sub r24,r18 |
5547 3628 930B sbc r25,r19 |
5548 362a A40B sbc r26,r20 |
5549 362c B50B sbc r27,r21 |
5550 362e 815E subi r24,lo8(-(19999)) |
5551 3630 914B sbci r25,hi8(-(19999)) |
5552 3632 AF4F sbci r26,hlo8(-(19999)) |
5553 3634 BF4F sbci r27,hhi8(-(19999)) |
5554 3636 8F53 subi r24,lo8(39999) |
5555 3638 9C49 sbci r25,hi8(39999) |
5556 363a A040 sbci r26,hlo8(39999) |
5557 363c B040 sbci r27,hhi8(39999) |
5558 363e 00F0 brlo .L358 |
5559 3640 8091 0000 lds r24,FromNaviCtrl_Value+1 |
5560 3644 8931 cpi r24,lo8(25) |
5561 3646 04F4 brge .+2 |
5562 3648 00C0 rjmp .L359 |
5563 .L358: |
5564 364a E090 0000 lds r14,IntegralFehlerRoll.3046 |
5565 364e F090 0000 lds r15,(IntegralFehlerRoll.3046)+1 |
5566 3652 0091 0000 lds r16,(IntegralFehlerRoll.3046)+2 |
5567 3656 1091 0000 lds r17,(IntegralFehlerRoll.3046)+3 |
5568 365a 41E0 ldi r20,lo8(4097) |
5569 365c E416 cp r14,r20 |
5570 365e 40E1 ldi r20,hi8(4097) |
5571 3660 F406 cpc r15,r20 |
5572 3662 40E0 ldi r20,hlo8(4097) |
5573 3664 0407 cpc r16,r20 |
5574 3666 40E0 ldi r20,hhi8(4097) |
5575 3668 1407 cpc r17,r20 |
5576 366a 04F4 brge .+2 |
5577 366c 00C0 rjmp .L360 |
5578 366e 8091 0000 lds r24,last_r_p.3069 |
5579 3672 8823 tst r24 |
5580 3674 01F4 brne .+2 |
5581 3676 00C0 rjmp .L361 |
5582 3678 A801 movw r20,r16 |
5583 367a 9701 movw r18,r14 |
5584 367c 69E0 ldi r22,9 |
5585 367e 5595 1: asr r21 |
5586 3680 4795 ror r20 |
5587 3682 3795 ror r19 |
5588 3684 2795 ror r18 |
5589 3686 6A95 dec r22 |
5590 3688 01F4 brne 1b |
5591 368a 8091 0000 lds r24,cnt.3066 |
5592 368e 9091 0000 lds r25,(cnt.3066)+1 |
5593 3692 820F add r24,r18 |
5594 3694 931F adc r25,r19 |
5595 3696 9093 0000 sts (cnt.3066)+1,r25 |
5596 369a 8093 0000 sts cnt.3066,r24 |
5597 369e C801 movw r24,r16 |
5598 36a0 B701 movw r22,r14 |
5599 36a2 28E0 ldi r18,lo8(8) |
5600 36a4 30E0 ldi r19,hi8(8) |
5601 36a6 40E0 ldi r20,hlo8(8) |
5602 36a8 50E0 ldi r21,hhi8(8) |
5603 36aa 0E94 0000 call __divmodsi4 |
5604 36ae C901 movw r24,r18 |
5605 36b0 DA01 movw r26,r20 |
5606 36b2 8093 0000 sts ausgleichRoll.3054,r24 |
5607 36b6 9093 0000 sts (ausgleichRoll.3054)+1,r25 |
5608 36ba A093 0000 sts (ausgleichRoll.3054)+2,r26 |
5609 36be B093 0000 sts (ausgleichRoll.3054)+3,r27 |
5610 36c2 8958 subi r24,lo8(5001) |
5611 36c4 9341 sbci r25,hi8(5001) |
5612 36c6 A040 sbci r26,hlo8(5001) |
5613 36c8 B040 sbci r27,hhi8(5001) |
5614 36ca 04F0 brlt .L362 |
5615 36cc 88E8 ldi r24,lo8(5000) |
5616 36ce 93E1 ldi r25,hi8(5000) |
5617 36d0 A0E0 ldi r26,hlo8(5000) |
5618 36d2 B0E0 ldi r27,hhi8(5000) |
5619 36d4 8093 0000 sts ausgleichRoll.3054,r24 |
5620 36d8 9093 0000 sts (ausgleichRoll.3054)+1,r25 |
5621 36dc A093 0000 sts (ausgleichRoll.3054)+2,r26 |
5622 36e0 B093 0000 sts (ausgleichRoll.3054)+3,r27 |
5623 .L362: |
5624 36e4 6091 0000 lds r22,ausgleichRoll.3054 |
5625 36e8 7091 0000 lds r23,(ausgleichRoll.3054)+1 |
5626 36ec 8091 0000 lds r24,(ausgleichRoll.3054)+2 |
5627 36f0 9091 0000 lds r25,(ausgleichRoll.3054)+3 |
5628 36f4 20E0 ldi r18,lo8(256) |
5629 36f6 31E0 ldi r19,hi8(256) |
5630 36f8 40E0 ldi r20,hlo8(256) |
5631 36fa 50E0 ldi r21,hhi8(256) |
5632 36fc 0E94 0000 call __divmodsi4 |
5633 3700 8091 0000 lds r24,LageKorrekturRoll |
5634 3704 9091 0000 lds r25,(LageKorrekturRoll)+1 |
5635 3708 820F add r24,r18 |
5636 370a 931F adc r25,r19 |
5637 370c 9093 0000 sts (LageKorrekturRoll)+1,r25 |
5638 3710 8093 0000 sts LageKorrekturRoll,r24 |
5639 3714 00C0 rjmp .L363 |
5640 .L361: |
5641 3716 81E0 ldi r24,lo8(1) |
5642 3718 8093 0000 sts last_r_p.3069,r24 |
5643 371c 00C0 rjmp .L363 |
5644 .L360: |
5645 371e 1092 0000 sts last_r_p.3069,__zero_reg__ |
5646 .L363: |
5647 3722 4091 0000 lds r20,IntegralFehlerRoll.3046 |
5648 3726 5091 0000 lds r21,(IntegralFehlerRoll.3046)+1 |
5649 372a 6091 0000 lds r22,(IntegralFehlerRoll.3046)+2 |
5650 372e 7091 0000 lds r23,(IntegralFehlerRoll.3046)+3 |
5651 3732 4030 cpi r20,lo8(-4096) |
5652 3734 80EF ldi r24,hi8(-4096) |
5653 3736 5807 cpc r21,r24 |
5654 3738 8FEF ldi r24,hlo8(-4096) |
5655 373a 6807 cpc r22,r24 |
5656 373c 8FEF ldi r24,hhi8(-4096) |
5657 373e 7807 cpc r23,r24 |
5658 3740 04F0 brlt .+2 |
5659 3742 00C0 rjmp .L364 |
5660 3744 8091 0000 lds r24,last_r_n.3070 |
5661 3748 8823 tst r24 |
5662 374a 01F4 brne .+2 |
5663 374c 00C0 rjmp .L365 |
5664 374e 8827 clr r24 |
5665 3750 9927 clr r25 |
5666 3752 DC01 movw r26,r24 |
5667 3754 841B sub r24,r20 |
5668 3756 950B sbc r25,r21 |
5669 3758 A60B sbc r26,r22 |
5670 375a B70B sbc r27,r23 |
5671 375c 29E0 ldi r18,9 |
5672 375e B595 1: asr r27 |
5673 3760 A795 ror r26 |
5674 3762 9795 ror r25 |
5675 3764 8795 ror r24 |
5676 3766 2A95 dec r18 |
5677 3768 01F4 brne 1b |
5678 376a 2091 0000 lds r18,cnt.3066 |
5679 376e 3091 0000 lds r19,(cnt.3066)+1 |
5680 3772 280F add r18,r24 |
5681 3774 391F adc r19,r25 |
5682 3776 3093 0000 sts (cnt.3066)+1,r19 |
5683 377a 2093 0000 sts cnt.3066,r18 |
5684 377e CB01 movw r24,r22 |
5685 3780 BA01 movw r22,r20 |
5686 3782 28E0 ldi r18,lo8(8) |
5687 3784 30E0 ldi r19,hi8(8) |
5688 3786 40E0 ldi r20,hlo8(8) |
5689 3788 50E0 ldi r21,hhi8(8) |
5690 378a 0E94 0000 call __divmodsi4 |
5691 378e C901 movw r24,r18 |
5692 3790 DA01 movw r26,r20 |
5693 3792 8093 0000 sts ausgleichRoll.3054,r24 |
5694 3796 9093 0000 sts (ausgleichRoll.3054)+1,r25 |
5695 379a A093 0000 sts (ausgleichRoll.3054)+2,r26 |
5696 379e B093 0000 sts (ausgleichRoll.3054)+3,r27 |
5697 37a2 8857 subi r24,lo8(-5000) |
5698 37a4 9C4E sbci r25,hi8(-5000) |
5699 37a6 AF4F sbci r26,hlo8(-5000) |
5700 37a8 BF4F sbci r27,hhi8(-5000) |
5701 37aa 04F4 brge .L366 |
5702 37ac 88E7 ldi r24,lo8(-5000) |
5703 37ae 9CEE ldi r25,hi8(-5000) |
5704 37b0 AFEF ldi r26,hlo8(-5000) |
5705 37b2 BFEF ldi r27,hhi8(-5000) |
5706 37b4 8093 0000 sts ausgleichRoll.3054,r24 |
5707 37b8 9093 0000 sts (ausgleichRoll.3054)+1,r25 |
5708 37bc A093 0000 sts (ausgleichRoll.3054)+2,r26 |
5709 37c0 B093 0000 sts (ausgleichRoll.3054)+3,r27 |
5710 .L366: |
5711 37c4 6091 0000 lds r22,ausgleichRoll.3054 |
5712 37c8 7091 0000 lds r23,(ausgleichRoll.3054)+1 |
5713 37cc 8091 0000 lds r24,(ausgleichRoll.3054)+2 |
5714 37d0 9091 0000 lds r25,(ausgleichRoll.3054)+3 |
5715 37d4 20E0 ldi r18,lo8(256) |
5716 37d6 31E0 ldi r19,hi8(256) |
5717 37d8 40E0 ldi r20,hlo8(256) |
5718 37da 50E0 ldi r21,hhi8(256) |
5719 37dc 0E94 0000 call __divmodsi4 |
5720 37e0 8091 0000 lds r24,LageKorrekturRoll |
5721 37e4 9091 0000 lds r25,(LageKorrekturRoll)+1 |
5722 37e8 820F add r24,r18 |
5723 37ea 931F adc r25,r19 |
5724 37ec 9093 0000 sts (LageKorrekturRoll)+1,r25 |
5725 37f0 8093 0000 sts LageKorrekturRoll,r24 |
5726 37f4 00C0 rjmp .L367 |
5727 .L365: |
5728 37f6 81E0 ldi r24,lo8(1) |
5729 37f8 8093 0000 sts last_r_n.3070,r24 |
5730 37fc 00C0 rjmp .L367 |
5731 .L364: |
5732 37fe 1092 0000 sts last_r_n.3070,__zero_reg__ |
5733 3802 00C0 rjmp .L367 |
5734 .L359: |
5735 3804 1092 0000 sts (cnt.3066)+1,__zero_reg__ |
5736 3808 1092 0000 sts cnt.3066,__zero_reg__ |
5737 380c 88EE ldi r24,lo8(1000) |
5738 380e 93E0 ldi r25,hi8(1000) |
5739 3810 9093 0000 sts (KompassSignalSchlecht)+1,r25 |
5740 3814 8093 0000 sts KompassSignalSchlecht,r24 |
5741 .L367: |
5742 3818 8091 0000 lds r24,EE_Parameter+66 |
5743 381c 282F mov r18,r24 |
5744 381e 30E0 ldi r19,lo8(0) |
5745 3820 8091 0000 lds r24,cnt.3066 |
5746 3824 9091 0000 lds r25,(cnt.3066)+1 |
5747 3828 2817 cp r18,r24 |
5748 382a 3907 cpc r19,r25 |
5749 382c 04F4 brge .L368 |
5750 382e 3093 0000 sts (cnt.3066)+1,r19 |
5751 3832 2093 0000 sts cnt.3066,r18 |
5752 .L368: |
5753 3836 8091 0000 lds r24,FromNaviCtrl_Value+1 |
5754 383a 8823 tst r24 |
5755 383c 01F0 breq .L369 |
5756 383e 282F mov r18,r24 |
5757 3840 3327 clr r19 |
5758 3842 27FD sbrc r18,7 |
5759 3844 3095 com r19 |
5760 3846 8091 0000 lds r24,cnt.3066 |
5761 384a 9091 0000 lds r25,(cnt.3066)+1 |
5762 384e 2817 cp r18,r24 |
5763 3850 3907 cpc r19,r25 |
5764 3852 04F4 brge .L369 |
5765 3854 3093 0000 sts (cnt.3066)+1,r19 |
5766 3858 2093 0000 sts cnt.3066,r18 |
5767 .L369: |
5768 385c 8091 0000 lds r24,IntegralFehlerRoll.3046 |
5769 3860 9091 0000 lds r25,(IntegralFehlerRoll.3046)+1 |
5770 3864 A091 0000 lds r26,(IntegralFehlerRoll.3046)+2 |
5771 3868 B091 0000 lds r27,(IntegralFehlerRoll.3046)+3 |
5772 386c 8138 cpi r24,lo8(129) |
5773 386e 9105 cpc r25,__zero_reg__ |
5774 3870 A105 cpc r26,__zero_reg__ |
5775 3872 B105 cpc r27,__zero_reg__ |
5776 3874 04F0 brlt .L370 |
5777 3876 8091 0000 lds r24,AdNeutralRoll |
5778 387a 9091 0000 lds r25,(AdNeutralRoll)+1 |
5779 387e 2091 0000 lds r18,cnt.3066 |
5780 3882 3091 0000 lds r19,(cnt.3066)+1 |
5781 3886 820F add r24,r18 |
5782 3888 931F adc r25,r19 |
5783 388a 9093 0000 sts (AdNeutralRoll)+1,r25 |
5784 388e 8093 0000 sts AdNeutralRoll,r24 |
5785 .L370: |
5786 3892 8091 0000 lds r24,IntegralFehlerRoll.3046 |
5787 3896 9091 0000 lds r25,(IntegralFehlerRoll.3046)+1 |
5788 389a A091 0000 lds r26,(IntegralFehlerRoll.3046)+2 |
5789 389e B091 0000 lds r27,(IntegralFehlerRoll.3046)+3 |
5790 38a2 8058 subi r24,lo8(-128) |
5791 38a4 9F4F sbci r25,hi8(-128) |
5792 38a6 AF4F sbci r26,hlo8(-128) |
5793 38a8 BF4F sbci r27,hhi8(-128) |
5794 38aa 04F4 brge .L371 |
5795 38ac 8091 0000 lds r24,AdNeutralRoll |
5796 38b0 9091 0000 lds r25,(AdNeutralRoll)+1 |
5797 38b4 2091 0000 lds r18,cnt.3066 |
5798 38b8 3091 0000 lds r19,(cnt.3066)+1 |
5799 38bc 821B sub r24,r18 |
5800 38be 930B sbc r25,r19 |
5801 38c0 9093 0000 sts (AdNeutralRoll)+1,r25 |
5802 38c4 8093 0000 sts AdNeutralRoll,r24 |
5803 38c8 00C0 rjmp .L371 |
5804 .L334: |
5805 38ca 1092 0000 sts (LageKorrekturRoll)+1,__zero_reg__ |
5806 38ce 1092 0000 sts LageKorrekturRoll,__zero_reg__ |
5807 38d2 1092 0000 sts (LageKorrekturNick)+1,__zero_reg__ |
5808 38d6 1092 0000 sts LageKorrekturNick,__zero_reg__ |
5809 38da 1092 0000 sts TrichterFlug,__zero_reg__ |
5810 .L371: |
5811 38de 8091 0000 lds r24,IntegralFaktor |
5812 38e2 8823 tst r24 |
5813 38e4 01F4 brne .L372 |
5814 38e6 1092 0000 sts (LageKorrekturRoll)+1,__zero_reg__ |
5815 38ea 1092 0000 sts LageKorrekturRoll,__zero_reg__ |
5816 38ee 1092 0000 sts (LageKorrekturNick)+1,__zero_reg__ |
5817 38f2 1092 0000 sts LageKorrekturNick,__zero_reg__ |
5818 .L372: |
5819 38f6 8091 0000 lds r24,MittelIntegralNick |
5820 38fa 9091 0000 lds r25,(MittelIntegralNick)+1 |
5821 38fe A091 0000 lds r26,(MittelIntegralNick)+2 |
5822 3902 B091 0000 lds r27,(MittelIntegralNick)+3 |
5823 3906 8093 0000 sts MittelIntegralNick_Alt.3071,r24 |
5824 390a 9093 0000 sts (MittelIntegralNick_Alt.3071)+1,r25 |
5825 390e A093 0000 sts (MittelIntegralNick_Alt.3071)+2,r26 |
5826 3912 B093 0000 sts (MittelIntegralNick_Alt.3071)+3,r27 |
5827 3916 8091 0000 lds r24,MittelIntegralRoll |
5828 391a 9091 0000 lds r25,(MittelIntegralRoll)+1 |
5829 391e A091 0000 lds r26,(MittelIntegralRoll)+2 |
5830 3922 B091 0000 lds r27,(MittelIntegralRoll)+3 |
5831 3926 8093 0000 sts MittelIntegralRoll_Alt.3072,r24 |
5832 392a 9093 0000 sts (MittelIntegralRoll_Alt.3072)+1,r25 |
5833 392e A093 0000 sts (MittelIntegralRoll_Alt.3072)+2,r26 |
5834 3932 B093 0000 sts (MittelIntegralRoll_Alt.3072)+3,r27 |
5835 3936 1092 0000 sts IntegralAccNick,__zero_reg__ |
5836 393a 1092 0000 sts (IntegralAccNick)+1,__zero_reg__ |
5837 393e 1092 0000 sts (IntegralAccNick)+2,__zero_reg__ |
5838 3942 1092 0000 sts (IntegralAccNick)+3,__zero_reg__ |
5839 3946 1092 0000 sts IntegralAccRoll,__zero_reg__ |
5840 394a 1092 0000 sts (IntegralAccRoll)+1,__zero_reg__ |
5841 394e 1092 0000 sts (IntegralAccRoll)+2,__zero_reg__ |
5842 3952 1092 0000 sts (IntegralAccRoll)+3,__zero_reg__ |
5843 3956 1092 0000 sts IntegralAccZ,__zero_reg__ |
5844 395a 1092 0000 sts (IntegralAccZ)+1,__zero_reg__ |
5845 395e 1092 0000 sts (IntegralAccZ)+2,__zero_reg__ |
5846 3962 1092 0000 sts (IntegralAccZ)+3,__zero_reg__ |
5847 3966 1092 0000 sts MittelIntegralNick,__zero_reg__ |
5848 396a 1092 0000 sts (MittelIntegralNick)+1,__zero_reg__ |
5849 396e 1092 0000 sts (MittelIntegralNick)+2,__zero_reg__ |
5850 3972 1092 0000 sts (MittelIntegralNick)+3,__zero_reg__ |
5851 3976 1092 0000 sts MittelIntegralRoll,__zero_reg__ |
5852 397a 1092 0000 sts (MittelIntegralRoll)+1,__zero_reg__ |
5853 397e 1092 0000 sts (MittelIntegralRoll)+2,__zero_reg__ |
5854 3982 1092 0000 sts (MittelIntegralRoll)+3,__zero_reg__ |
5855 3986 1092 0000 sts MittelIntegralNick2,__zero_reg__ |
5856 398a 1092 0000 sts (MittelIntegralNick2)+1,__zero_reg__ |
5857 398e 1092 0000 sts (MittelIntegralNick2)+2,__zero_reg__ |
5858 3992 1092 0000 sts (MittelIntegralNick2)+3,__zero_reg__ |
5859 3996 1092 0000 sts MittelIntegralRoll2,__zero_reg__ |
5860 399a 1092 0000 sts (MittelIntegralRoll2)+1,__zero_reg__ |
5861 399e 1092 0000 sts (MittelIntegralRoll2)+2,__zero_reg__ |
5862 39a2 1092 0000 sts (MittelIntegralRoll2)+3,__zero_reg__ |
5863 39a6 1092 0000 sts (ZaehlMessungen)+1,__zero_reg__ |
5864 39aa 1092 0000 sts ZaehlMessungen,__zero_reg__ |
5865 .L333: |
5866 39ae 8091 0000 lds r24,StickGier |
5867 39b2 9091 0000 lds r25,(StickGier)+1 |
5868 39b6 97FF sbrs r25,7 |
5869 39b8 00C0 rjmp .L374 |
5870 39ba 9095 com r25 |
5871 39bc 8195 neg r24 |
5872 39be 9F4F sbci r25,lo8(-1) |
5873 .L374: |
5874 39c0 4097 sbiw r24,16 |
5875 39c2 04F0 brlt .L373 |
5876 39c4 88EE ldi r24,lo8(1000) |
5877 39c6 93E0 ldi r25,hi8(1000) |
5878 39c8 9093 0000 sts (KompassSignalSchlecht)+1,r25 |
5879 39cc 8093 0000 sts KompassSignalSchlecht,r24 |
5880 39d0 8091 0000 lds r24,EE_Parameter+13 |
5881 39d4 84FD sbrc r24,4 |
5882 39d6 00C0 rjmp .L373 |
5883 39d8 81E0 ldi r24,lo8(1) |
5884 39da 8093 0000 sts NeueKompassRichtungMerken.3052,r24 |
5885 .L373: |
5886 39de D090 0000 lds r13,EE_Parameter+25 |
5887 39e2 E090 0000 lds r14,StickGier |
5888 39e6 F090 0000 lds r15,(StickGier)+1 |
5889 39ea B701 movw r22,r14 |
5890 39ec 8827 clr r24 |
5891 39ee 77FD sbrc r23,7 |
5892 39f0 8095 com r24 |
5893 39f2 982F mov r25,r24 |
5894 39f4 2D2D mov r18,r13 |
5895 39f6 30E0 ldi r19,lo8(0) |
5896 39f8 40E0 ldi r20,lo8(0) |
5897 39fa 50E0 ldi r21,hi8(0) |
5898 39fc 0E94 0000 call __mulsi3 |
5899 3a00 F701 movw r30,r14 |
5900 3a02 F7FE sbrs r15,7 |
5901 3a04 00C0 rjmp .L375 |
5902 3a06 EE27 clr r30 |
5903 3a08 FF27 clr r31 |
5904 3a0a EE19 sub r30,r14 |
5905 3a0c FF09 sbc r31,r15 |
5906 .L375: |
5907 3a0e 9F01 movw r18,r30 |
5908 3a10 4427 clr r20 |
5909 3a12 37FD sbrc r19,7 |
5910 3a14 4095 com r20 |
5911 3a16 542F mov r21,r20 |
5912 3a18 0E94 0000 call __mulsi3 |
5913 3a1c 20E0 ldi r18,lo8(512) |
5914 3a1e 32E0 ldi r19,hi8(512) |
5915 3a20 40E0 ldi r20,hlo8(512) |
5916 3a22 50E0 ldi r21,hhi8(512) |
5917 3a24 0E94 0000 call __divmodsi4 |
5918 3a28 8901 movw r16,r18 |
5919 3a2a 9A01 movw r18,r20 |
5920 3a2c 8D2D mov r24,r13 |
5921 3a2e 90E0 ldi r25,lo8(0) |
5922 3a30 AC01 movw r20,r24 |
5923 3a32 4E9D mul r20,r14 |
5924 3a34 C001 movw r24,r0 |
5925 3a36 4F9D mul r20,r15 |
5926 3a38 900D add r25,r0 |
5927 3a3a 5E9D mul r21,r14 |
5928 3a3c 900D add r25,r0 |
5929 3a3e 1124 clr r1 |
5930 3a40 64E0 ldi r22,lo8(4) |
5931 3a42 70E0 ldi r23,hi8(4) |
5932 3a44 0E94 0000 call __divmodhi4 |
5933 3a48 600F add r22,r16 |
5934 3a4a 711F adc r23,r17 |
5935 3a4c 8827 clr r24 |
5936 3a4e 77FD sbrc r23,7 |
5937 3a50 8095 com r24 |
5938 3a52 982F mov r25,r24 |
5939 3a54 6093 0000 sts sollGier.3042,r22 |
5940 3a58 7093 0000 sts (sollGier.3042)+1,r23 |
5941 3a5c 8093 0000 sts (sollGier.3042)+2,r24 |
5942 3a60 9093 0000 sts (sollGier.3042)+3,r25 |
5943 3a64 2091 0000 lds r18,Mess_Integral_Gier |
5944 3a68 3091 0000 lds r19,(Mess_Integral_Gier)+1 |
5945 3a6c 4091 0000 lds r20,(Mess_Integral_Gier)+2 |
5946 3a70 5091 0000 lds r21,(Mess_Integral_Gier)+3 |
5947 3a74 261B sub r18,r22 |
5948 3a76 370B sbc r19,r23 |
5949 3a78 480B sbc r20,r24 |
5950 3a7a 590B sbc r21,r25 |
5951 3a7c 2093 0000 sts Mess_Integral_Gier,r18 |
5952 3a80 3093 0000 sts (Mess_Integral_Gier)+1,r19 |
5953 3a84 4093 0000 sts (Mess_Integral_Gier)+2,r20 |
5954 3a88 5093 0000 sts (Mess_Integral_Gier)+3,r21 |
5955 3a8c 2155 subi r18,lo8(50001) |
5956 3a8e 334C sbci r19,hi8(50001) |
5957 3a90 4040 sbci r20,hlo8(50001) |
5958 3a92 5040 sbci r21,hhi8(50001) |
5959 3a94 04F0 brlt .L376 |
5960 3a96 80E5 ldi r24,lo8(50000) |
5961 3a98 93EC ldi r25,hi8(50000) |
5962 3a9a A0E0 ldi r26,hlo8(50000) |
5963 3a9c B0E0 ldi r27,hhi8(50000) |
5964 3a9e 8093 0000 sts Mess_Integral_Gier,r24 |
5965 3aa2 9093 0000 sts (Mess_Integral_Gier)+1,r25 |
5966 3aa6 A093 0000 sts (Mess_Integral_Gier)+2,r26 |
5967 3aaa B093 0000 sts (Mess_Integral_Gier)+3,r27 |
5968 .L376: |
5969 3aae 8091 0000 lds r24,Mess_Integral_Gier |
5970 3ab2 9091 0000 lds r25,(Mess_Integral_Gier)+1 |
5971 3ab6 A091 0000 lds r26,(Mess_Integral_Gier)+2 |
5972 3aba B091 0000 lds r27,(Mess_Integral_Gier)+3 |
5973 3abe 805B subi r24,lo8(-50000) |
5974 3ac0 9C43 sbci r25,hi8(-50000) |
5975 3ac2 AF4F sbci r26,hlo8(-50000) |
5976 3ac4 BF4F sbci r27,hhi8(-50000) |
5977 3ac6 04F4 brge .L377 |
5978 3ac8 80EB ldi r24,lo8(-50000) |
5979 3aca 9CE3 ldi r25,hi8(-50000) |
5980 3acc AFEF ldi r26,hlo8(-50000) |
5981 3ace BFEF ldi r27,hhi8(-50000) |
5982 3ad0 8093 0000 sts Mess_Integral_Gier,r24 |
5983 3ad4 9093 0000 sts (Mess_Integral_Gier)+1,r25 |
5984 3ad8 A093 0000 sts (Mess_Integral_Gier)+2,r26 |
5985 3adc B093 0000 sts (Mess_Integral_Gier)+3,r27 |
5986 .L377: |
5987 3ae0 C090 0000 lds r12,KompassValue |
5988 3ae4 D090 0000 lds r13,(KompassValue)+1 |
5989 3ae8 C114 cp r12,__zero_reg__ |
5990 3aea D104 cpc r13,__zero_reg__ |
5991 3aec 01F4 brne .+2 |
5992 3aee 00C0 rjmp .L378 |
5993 3af0 8091 0000 lds r24,EE_Parameter+13 |
5994 3af4 83FF sbrs r24,3 |
5995 3af6 00C0 rjmp .L378 |
5996 3af8 6091 0000 lds r22,IntegralNick |
5997 3afc 7091 0000 lds r23,(IntegralNick)+1 |
5998 3b00 8091 0000 lds r24,(IntegralNick)+2 |
5999 3b04 9091 0000 lds r25,(IntegralNick)+3 |
6000 3b08 20E0 ldi r18,lo8(512) |
6001 3b0a 32E0 ldi r19,hi8(512) |
6002 3b0c 40E0 ldi r20,hlo8(512) |
6003 3b0e 50E0 ldi r21,hhi8(512) |
6004 3b10 0E94 0000 call __divmodsi4 |
6005 3b14 8901 movw r16,r18 |
6006 3b16 37FF sbrs r19,7 |
6007 3b18 00C0 rjmp .L379 |
6008 3b1a 1095 com r17 |
6009 3b1c 0195 neg r16 |
6010 3b1e 1F4F sbci r17,lo8(-1) |
6011 .L379: |
6012 3b20 6091 0000 lds r22,IntegralRoll |
6013 3b24 7091 0000 lds r23,(IntegralRoll)+1 |
6014 3b28 8091 0000 lds r24,(IntegralRoll)+2 |
6015 3b2c 9091 0000 lds r25,(IntegralRoll)+3 |
6016 3b30 20E0 ldi r18,lo8(512) |
6017 3b32 32E0 ldi r19,hi8(512) |
6018 3b34 40E0 ldi r20,hlo8(512) |
6019 3b36 50E0 ldi r21,hhi8(512) |
6020 3b38 0E94 0000 call __divmodsi4 |
6021 3b3c 3901 movw r6,r18 |
6022 3b3e 37FF sbrs r19,7 |
6023 3b40 00C0 rjmp .L380 |
6024 3b42 7094 com r7 |
6025 3b44 6194 neg r6 |
6026 3b46 7108 sbc r7,__zero_reg__ |
6027 3b48 7394 inc r7 |
6028 .L380: |
6029 3b4a 6016 cp r6,r16 |
6030 3b4c 7106 cpc r7,r17 |
6031 3b4e 04F4 brge .L381 |
6032 3b50 3801 movw r6,r16 |
6033 .L381: |
6034 3b52 8CE1 ldi r24,lo8(540) |
6035 3b54 92E0 ldi r25,hi8(540) |
6036 3b56 C80E add r12,r24 |
6037 3b58 D91E adc r13,r25 |
6038 3b5a 7601 movw r14,r12 |
6039 3b5c 0027 clr r16 |
6040 3b5e F7FC sbrc r15,7 |
6041 3b60 0095 com r16 |
6042 3b62 102F mov r17,r16 |
6043 3b64 6091 0000 lds r22,ErsatzKompass |
6044 3b68 7091 0000 lds r23,(ErsatzKompass)+1 |
6045 3b6c 8091 0000 lds r24,(ErsatzKompass)+2 |
6046 3b70 9091 0000 lds r25,(ErsatzKompass)+3 |
6047 3b74 A090 0000 lds r10,GIER_GRAD_FAKTOR |
6048 3b78 B090 0000 lds r11,(GIER_GRAD_FAKTOR)+1 |
6049 3b7c C090 0000 lds r12,(GIER_GRAD_FAKTOR)+2 |
6050 3b80 D090 0000 lds r13,(GIER_GRAD_FAKTOR)+3 |
6051 3b84 A601 movw r20,r12 |
6052 3b86 9501 movw r18,r10 |
6053 3b88 0E94 0000 call __divmodsi4 |
6054 3b8c E21A sub r14,r18 |
6055 3b8e F30A sbc r15,r19 |
6056 3b90 040B sbc r16,r20 |
6057 3b92 150B sbc r17,r21 |
6058 3b94 C801 movw r24,r16 |
6059 3b96 B701 movw r22,r14 |
6060 3b98 28E6 ldi r18,lo8(360) |
6061 3b9a 31E0 ldi r19,hi8(360) |
6062 3b9c 40E0 ldi r20,hlo8(360) |
6063 3b9e 50E0 ldi r21,hhi8(360) |
6064 3ba0 0E94 0000 call __divmodsi4 |
6065 3ba4 8B01 movw r16,r22 |
6066 3ba6 045B subi r16,lo8(-(-180)) |
6067 3ba8 1040 sbci r17,hi8(-(-180)) |
6068 3baa 8091 0000 lds r24,KompassSignalSchlecht |
6069 3bae 9091 0000 lds r25,(KompassSignalSchlecht)+1 |
6070 3bb2 892B or r24,r25 |
6071 3bb4 01F4 brne .L382 |
6072 3bb6 99E1 ldi r25,lo8(25) |
6073 3bb8 6916 cp r6,r25 |
6074 3bba 7104 cpc r7,__zero_reg__ |
6075 3bbc 04F4 brge .L382 |
6076 3bbe 8091 0000 lds r24,GierGyroFehler |
6077 3bc2 9091 0000 lds r25,(GierGyroFehler)+1 |
6078 3bc6 800F add r24,r16 |
6079 3bc8 911F adc r25,r17 |
6080 3bca 9093 0000 sts (GierGyroFehler)+1,r25 |
6081 3bce 8093 0000 sts GierGyroFehler,r24 |
6082 3bd2 8091 0000 lds r24,NeueKompassRichtungMerken.3052 |
6083 3bd6 8823 tst r24 |
6084 3bd8 01F0 breq .L382 |
6085 3bda 6091 0000 lds r22,KompassValue |
6086 3bde 7091 0000 lds r23,(KompassValue)+1 |
6087 3be2 8827 clr r24 |
6088 3be4 77FD sbrc r23,7 |
6089 3be6 8095 com r24 |
6090 3be8 982F mov r25,r24 |
6091 3bea A601 movw r20,r12 |
6092 3bec 9501 movw r18,r10 |
6093 3bee 0E94 0000 call __mulsi3 |
6094 3bf2 6093 0000 sts ErsatzKompass,r22 |
6095 3bf6 7093 0000 sts (ErsatzKompass)+1,r23 |
6096 3bfa 8093 0000 sts (ErsatzKompass)+2,r24 |
6097 3bfe 9093 0000 sts (ErsatzKompass)+3,r25 |
6098 3c02 0E94 0000 call __divmodsi4 |
6099 3c06 3093 0000 sts (KompassStartwert)+1,r19 |
6100 3c0a 2093 0000 sts KompassStartwert,r18 |
6101 3c0e 1092 0000 sts NeueKompassRichtungMerken.3052,__zero_reg__ |
6102 .L382: |
6103 3c12 B301 movw r22,r6 |
6104 3c14 83E0 ldi r24,3 |
6105 3c16 7595 1: asr r23 |
6106 3c18 6795 ror r22 |
6107 3c1a 8A95 dec r24 |
6108 3c1c 01F4 brne 1b |
6109 3c1e 6E5F subi r22,lo8(-(2)) |
6110 3c20 7F4F sbci r23,hi8(-(2)) |
6111 3c22 C801 movw r24,r16 |
6112 3c24 04E0 ldi r16,4 |
6113 3c26 880F 1: lsl r24 |
6114 3c28 991F rol r25 |
6115 3c2a 0A95 dec r16 |
6116 3c2c 01F4 brne 1b |
6117 3c2e 0E94 0000 call __divmodhi4 |
6118 3c32 4B01 movw r8,r22 |
6119 3c34 AA24 clr r10 |
6120 3c36 97FC sbrc r9,7 |
6121 3c38 A094 com r10 |
6122 3c3a BA2C mov r11,r10 |
6123 3c3c 8091 0000 lds r24,ErsatzKompass |
6124 3c40 9091 0000 lds r25,(ErsatzKompass)+1 |
6125 3c44 A091 0000 lds r26,(ErsatzKompass)+2 |
6126 3c48 B091 0000 lds r27,(ErsatzKompass)+3 |
6127 3c4c 880E add r8,r24 |
6128 3c4e 991E adc r9,r25 |
6129 3c50 AA1E adc r10,r26 |
6130 3c52 BB1E adc r11,r27 |
6131 3c54 8092 0000 sts ErsatzKompass,r8 |
6132 3c58 9092 0000 sts (ErsatzKompass)+1,r9 |
6133 3c5c A092 0000 sts (ErsatzKompass)+2,r10 |
6134 3c60 B092 0000 sts (ErsatzKompass)+3,r11 |
6135 3c64 8091 0000 lds r24,Parameter_KompassWirkung |
6136 3c68 482E mov r4,r24 |
6137 3c6a 5524 clr r5 |
6138 3c6c 649C mul r6,r4 |
6139 3c6e C001 movw r24,r0 |
6140 3c70 659C mul r6,r5 |
6141 3c72 900D add r25,r0 |
6142 3c74 749C mul r7,r4 |
6143 3c76 900D add r25,r0 |
6144 3c78 1124 clr r1 |
6145 3c7a 60E2 ldi r22,lo8(32) |
6146 3c7c 70E0 ldi r23,hi8(32) |
6147 3c7e 0E94 0000 call __divmodhi4 |
6148 3c82 3201 movw r6,r4 |
6149 3c84 661A sub r6,r22 |
6150 3c86 770A sbc r7,r23 |
6151 3c88 77FC sbrc r7,7 |
6152 3c8a 00C0 rjmp .L383 |
6153 3c8c 8091 0000 lds r24,KompassSignalSchlecht |
6154 3c90 9091 0000 lds r25,(KompassSignalSchlecht)+1 |
6155 3c94 892B or r24,r25 |
6156 3c96 01F0 breq .+2 |
6157 3c98 00C0 rjmp .L384 |
6158 3c9a 8091 0000 lds r24,MaxStickRoll |
6159 3c9e 9091 0000 lds r25,(MaxStickRoll)+1 |
6160 3ca2 2091 0000 lds r18,MaxStickNick |
6161 3ca6 3091 0000 lds r19,(MaxStickNick)+1 |
6162 3caa 820F add r24,r18 |
6163 3cac 931F adc r25,r19 |
6164 3cae 68E0 ldi r22,lo8(8) |
6165 3cb0 70E0 ldi r23,hi8(8) |
6166 3cb2 0E94 0000 call __divmodhi4 |
6167 3cb6 6B01 movw r12,r22 |
6168 3cb8 A0E4 ldi r26,lo8(64) |
6169 3cba B0E0 ldi r27,hi8(64) |
6170 3cbc CA0E add r12,r26 |
6171 3cbe DB1E adc r13,r27 |
6172 3cc0 8091 0000 lds r24,KompassStartwert |
6173 3cc4 9091 0000 lds r25,(KompassStartwert)+1 |
6174 3cc8 AA27 clr r26 |
6175 3cca 97FD sbrc r25,7 |
6176 3ccc A095 com r26 |
6177 3cce BA2F mov r27,r26 |
6178 3cd0 1CE1 ldi r17,lo8(540) |
6179 3cd2 E12E mov r14,r17 |
6180 3cd4 12E0 ldi r17,hi8(540) |
6181 3cd6 F12E mov r15,r17 |
6182 3cd8 012D mov r16,__zero_reg__ |
6183 3cda 112D mov r17,__zero_reg__ |
6184 3cdc E81A sub r14,r24 |
6185 3cde F90A sbc r15,r25 |
6186 3ce0 0A0B sbc r16,r26 |
6187 3ce2 1B0B sbc r17,r27 |
6188 3ce4 2091 0000 lds r18,GIER_GRAD_FAKTOR |
6189 3ce8 3091 0000 lds r19,(GIER_GRAD_FAKTOR)+1 |
6190 3cec 4091 0000 lds r20,(GIER_GRAD_FAKTOR)+2 |
6191 3cf0 5091 0000 lds r21,(GIER_GRAD_FAKTOR)+3 |
6192 3cf4 C501 movw r24,r10 |
6193 3cf6 B401 movw r22,r8 |
6194 3cf8 0E94 0000 call __divmodsi4 |
6195 3cfc E20E add r14,r18 |
6196 3cfe F31E adc r15,r19 |
6197 3d00 041F adc r16,r20 |
6198 3d02 151F adc r17,r21 |
6199 3d04 C801 movw r24,r16 |
6200 3d06 B701 movw r22,r14 |
6201 3d08 28E6 ldi r18,lo8(360) |
6202 3d0a 31E0 ldi r19,hi8(360) |
6203 3d0c 40E0 ldi r20,hlo8(360) |
6204 3d0e 50E0 ldi r21,hhi8(360) |
6205 3d10 0E94 0000 call __divmodsi4 |
6206 3d14 645B subi r22,lo8(-(-180)) |
6207 3d16 7040 sbci r23,hi8(-(-180)) |
6208 3d18 669D mul r22,r6 |
6209 3d1a C001 movw r24,r0 |
6210 3d1c 679D mul r22,r7 |
6211 3d1e 900D add r25,r0 |
6212 3d20 769D mul r23,r6 |
6213 3d22 900D add r25,r0 |
6214 3d24 1124 clr r1 |
6215 3d26 B601 movw r22,r12 |
6216 3d28 0E94 0000 call __divmodhi4 |
6217 3d2c C201 movw r24,r4 |
6218 3d2e 880F lsl r24 |
6219 3d30 991F rol r25 |
6220 3d32 840D add r24,r4 |
6221 3d34 951D adc r25,r5 |
6222 3d36 8617 cp r24,r22 |
6223 3d38 9707 cpc r25,r23 |
6224 3d3a 04F4 brge .L385 |
6225 3d3c BC01 movw r22,r24 |
6226 3d3e 00C0 rjmp .L386 |
6227 .L385: |
6228 3d40 4427 clr r20 |
6229 3d42 5527 clr r21 |
6230 3d44 481B sub r20,r24 |
6231 3d46 590B sbc r21,r25 |
6232 3d48 6417 cp r22,r20 |
6233 3d4a 7507 cpc r23,r21 |
6234 3d4c 04F4 brge .L386 |
6235 3d4e BA01 movw r22,r20 |
6236 .L386: |
6237 3d50 9B01 movw r18,r22 |
6238 3d52 4427 clr r20 |
6239 3d54 37FD sbrc r19,7 |
6240 3d56 4095 com r20 |
6241 3d58 542F mov r21,r20 |
6242 3d5a 8091 0000 lds r24,Mess_Integral_Gier |
6243 3d5e 9091 0000 lds r25,(Mess_Integral_Gier)+1 |
6244 3d62 A091 0000 lds r26,(Mess_Integral_Gier)+2 |
6245 3d66 B091 0000 lds r27,(Mess_Integral_Gier)+3 |
6246 3d6a 820F add r24,r18 |
6247 3d6c 931F adc r25,r19 |
6248 3d6e A41F adc r26,r20 |
6249 3d70 B51F adc r27,r21 |
6250 3d72 8093 0000 sts Mess_Integral_Gier,r24 |
6251 3d76 9093 0000 sts (Mess_Integral_Gier)+1,r25 |
6252 3d7a A093 0000 sts (Mess_Integral_Gier)+2,r26 |
6253 3d7e B093 0000 sts (Mess_Integral_Gier)+3,r27 |
6254 .L384: |
6255 3d82 8091 0000 lds r24,KompassSignalSchlecht |
6256 3d86 9091 0000 lds r25,(KompassSignalSchlecht)+1 |
6257 3d8a 0097 sbiw r24,0 |
6258 3d8c 01F0 breq .L378 |
6259 3d8e 0197 sbiw r24,1 |
6260 3d90 00C0 rjmp .L532 |
6261 .L383: |
6262 3d92 84EF ldi r24,lo8(500) |
6263 3d94 91E0 ldi r25,hi8(500) |
6264 .L532: |
6265 3d96 9093 0000 sts (KompassSignalSchlecht)+1,r25 |
6266 3d9a 8093 0000 sts KompassSignalSchlecht,r24 |
6267 .L378: |
6268 3d9e 8091 0000 lds r24,TrichterFlug |
6269 3da2 8823 tst r24 |
6270 3da4 01F0 breq .L388 |
6271 3da6 1092 0000 sts SummeRoll,__zero_reg__ |
6272 3daa 1092 0000 sts (SummeRoll)+1,__zero_reg__ |
6273 3dae 1092 0000 sts (SummeRoll)+2,__zero_reg__ |
6274 3db2 1092 0000 sts (SummeRoll)+3,__zero_reg__ |
6275 3db6 1092 0000 sts SummeNick,__zero_reg__ |
6276 3dba 1092 0000 sts (SummeNick)+1,__zero_reg__ |
6277 3dbe 1092 0000 sts (SummeNick)+2,__zero_reg__ |
6278 3dc2 1092 0000 sts (SummeNick)+3,__zero_reg__ |
6279 .L388: |
6280 3dc6 8091 0000 lds r24,Looping_Nick |
6281 3dca 8823 tst r24 |
6282 3dcc 01F0 breq .L389 |
6283 3dce 1DA2 std Y+37,__zero_reg__ |
6284 3dd0 1CA2 std Y+36,__zero_reg__ |
6285 3dd2 00C0 rjmp .L390 |
6286 .L389: |
6287 3dd4 6091 0000 lds r22,IntegralFaktor |
6288 3dd8 70E0 ldi r23,lo8(0) |
6289 3dda 80E0 ldi r24,lo8(0) |
6290 3ddc 90E0 ldi r25,hi8(0) |
6291 3dde 2091 0000 lds r18,IntegralNick |
6292 3de2 3091 0000 lds r19,(IntegralNick)+1 |
6293 3de6 4091 0000 lds r20,(IntegralNick)+2 |
6294 3dea 5091 0000 lds r21,(IntegralNick)+3 |
6295 3dee 0E94 0000 call __mulsi3 |
6296 3df2 28EF ldi r18,lo8(11000) |
6297 3df4 3AE2 ldi r19,hi8(11000) |
6298 3df6 40E0 ldi r20,hlo8(11000) |
6299 3df8 50E0 ldi r21,hhi8(11000) |
6300 3dfa 0E94 0000 call __divmodsi4 |
6301 3dfe 3DA3 std Y+37,r19 |
6302 3e00 2CA3 std Y+36,r18 |
6303 .L390: |
6304 3e02 8091 0000 lds r24,Looping_Roll |
6305 3e06 8823 tst r24 |
6306 3e08 01F0 breq .L391 |
6307 3e0a 1BA2 std Y+35,__zero_reg__ |
6308 3e0c 1AA2 std Y+34,__zero_reg__ |
6309 3e0e 00C0 rjmp .L392 |
6310 .L391: |
6311 3e10 6091 0000 lds r22,IntegralFaktor |
6312 3e14 70E0 ldi r23,lo8(0) |
6313 3e16 80E0 ldi r24,lo8(0) |
6314 3e18 90E0 ldi r25,hi8(0) |
6315 3e1a 2091 0000 lds r18,IntegralRoll |
6316 3e1e 3091 0000 lds r19,(IntegralRoll)+1 |
6317 3e22 4091 0000 lds r20,(IntegralRoll)+2 |
6318 3e26 5091 0000 lds r21,(IntegralRoll)+3 |
6319 3e2a 0E94 0000 call __mulsi3 |
6320 3e2e 28EF ldi r18,lo8(11000) |
6321 3e30 3AE2 ldi r19,hi8(11000) |
6322 3e32 40E0 ldi r20,hlo8(11000) |
6323 3e34 50E0 ldi r21,hhi8(11000) |
6324 3e36 0E94 0000 call __divmodsi4 |
6325 3e3a 3BA3 std Y+35,r19 |
6326 3e3c 2AA3 std Y+34,r18 |
6327 .L392: |
6328 3e3e 8091 0000 lds r24,TrimNick |
6329 3e42 9091 0000 lds r25,(TrimNick)+1 |
6330 3e46 893C cpi r24,201 |
6331 3e48 9105 cpc r25,__zero_reg__ |
6332 3e4a 04F0 brlt .L393 |
6333 3e4c 88EC ldi r24,lo8(200) |
6334 3e4e 90E0 ldi r25,hi8(200) |
6335 3e50 00C0 rjmp .L533 |
6336 .L393: |
6337 3e52 8853 subi r24,lo8(-200) |
6338 3e54 9F4F sbci r25,hi8(-200) |
6339 3e56 04F4 brge .L394 |
6340 3e58 88E3 ldi r24,lo8(-200) |
6341 3e5a 9FEF ldi r25,hi8(-200) |
6342 .L533: |
6343 3e5c 9093 0000 sts (TrimNick)+1,r25 |
6344 3e60 8093 0000 sts TrimNick,r24 |
6345 .L394: |
6346 3e64 8091 0000 lds r24,TrimRoll |
6347 3e68 9091 0000 lds r25,(TrimRoll)+1 |
6348 3e6c 893C cpi r24,201 |
6349 3e6e 9105 cpc r25,__zero_reg__ |
6350 3e70 04F0 brlt .L395 |
6351 3e72 88EC ldi r24,lo8(200) |
6352 3e74 90E0 ldi r25,hi8(200) |
6353 3e76 00C0 rjmp .L534 |
6354 .L395: |
6355 3e78 8853 subi r24,lo8(-200) |
6356 3e7a 9F4F sbci r25,hi8(-200) |
6357 3e7c 04F4 brge .L396 |
6358 3e7e 88E3 ldi r24,lo8(-200) |
6359 3e80 9FEF ldi r25,hi8(-200) |
6360 .L534: |
6361 3e82 9093 0000 sts (TrimRoll)+1,r25 |
6362 3e86 8093 0000 sts TrimRoll,r24 |
6363 .L396: |
6364 3e8a E090 0000 lds r14,TrimNick |
6365 3e8e F090 0000 lds r15,(TrimNick)+1 |
6366 3e92 0027 clr r16 |
6367 3e94 F7FC sbrc r15,7 |
6368 3e96 0095 com r16 |
6369 3e98 102F mov r17,r16 |
6370 3e9a A7E0 ldi r26,7 |
6371 3e9c EE0C 1: lsl r14 |
6372 3e9e FF1C rol r15 |
6373 3ea0 001F rol r16 |
6374 3ea2 111F rol r17 |
6375 3ea4 AA95 dec r26 |
6376 3ea6 01F4 brne 1b |
6377 3ea8 A090 0000 lds r10,GyroFaktor |
6378 3eac BB24 clr r11 |
6379 3eae CC24 clr r12 |
6380 3eb0 DD24 clr r13 |
6381 3eb2 2091 0000 lds r18,MesswertNick |
6382 3eb6 3091 0000 lds r19,(MesswertNick)+1 |
6383 3eba 4427 clr r20 |
6384 3ebc 37FD sbrc r19,7 |
6385 3ebe 4095 com r20 |
6386 3ec0 542F mov r21,r20 |
6387 3ec2 C601 movw r24,r12 |
6388 3ec4 B501 movw r22,r10 |
6389 3ec6 0E94 0000 call __mulsi3 |
6390 3eca E60E add r14,r22 |
6391 3ecc F71E adc r15,r23 |
6392 3ece 081F adc r16,r24 |
6393 3ed0 191F adc r17,r25 |
6394 3ed2 C801 movw r24,r16 |
6395 3ed4 B701 movw r22,r14 |
6396 3ed6 20E4 ldi r18,lo8(64) |
6397 3ed8 30E0 ldi r19,hi8(64) |
6398 3eda 40E0 ldi r20,hlo8(64) |
6399 3edc 50E0 ldi r21,hhi8(64) |
6400 3ede 0E94 0000 call __divmodsi4 |
6401 3ee2 8CA0 ldd r8,Y+36 |
6402 3ee4 9DA0 ldd r9,Y+37 |
6403 3ee6 820E add r8,r18 |
6404 3ee8 931E adc r9,r19 |
6405 3eea 9092 0000 sts (MesswertNick)+1,r9 |
6406 3eee 8092 0000 sts MesswertNick,r8 |
6407 3ef2 E090 0000 lds r14,TrimRoll |
6408 3ef6 F090 0000 lds r15,(TrimRoll)+1 |
6409 3efa 0027 clr r16 |
6410 3efc F7FC sbrc r15,7 |
6411 3efe 0095 com r16 |
6412 3f00 102F mov r17,r16 |
6413 3f02 F7E0 ldi r31,7 |
6414 3f04 EE0C 1: lsl r14 |
6415 3f06 FF1C rol r15 |
6416 3f08 001F rol r16 |
6417 3f0a 111F rol r17 |
6418 3f0c FA95 dec r31 |
6419 3f0e 01F4 brne 1b |
6420 3f10 2091 0000 lds r18,MesswertRoll |
6421 3f14 3091 0000 lds r19,(MesswertRoll)+1 |
6422 3f18 4427 clr r20 |
6423 3f1a 37FD sbrc r19,7 |
6424 3f1c 4095 com r20 |
6425 3f1e 542F mov r21,r20 |
6426 3f20 C601 movw r24,r12 |
6427 3f22 B501 movw r22,r10 |
6428 3f24 0E94 0000 call __mulsi3 |
6429 3f28 E60E add r14,r22 |
6430 3f2a F71E adc r15,r23 |
6431 3f2c 081F adc r16,r24 |
6432 3f2e 191F adc r17,r25 |
6433 3f30 C801 movw r24,r16 |
6434 3f32 B701 movw r22,r14 |
6435 3f34 20E4 ldi r18,lo8(64) |
6436 3f36 30E0 ldi r19,hi8(64) |
6437 3f38 40E0 ldi r20,hlo8(64) |
6438 3f3a 50E0 ldi r21,hhi8(64) |
6439 3f3c 0E94 0000 call __divmodsi4 |
6440 3f40 8AA1 ldd r24,Y+34 |
6441 3f42 9BA1 ldd r25,Y+35 |
6442 3f44 820F add r24,r18 |
6443 3f46 931F adc r25,r19 |
6444 3f48 9093 0000 sts (MesswertRoll)+1,r25 |
6445 3f4c 8093 0000 sts MesswertRoll,r24 |
6446 3f50 6091 0000 lds r22,MesswertGier |
6447 3f54 7091 0000 lds r23,(MesswertGier)+1 |
6448 3f58 660F lsl r22 |
6449 3f5a 771F rol r23 |
6450 3f5c 8827 clr r24 |
6451 3f5e 77FD sbrc r23,7 |
6452 3f60 8095 com r24 |
6453 3f62 982F mov r25,r24 |
6454 3f64 2091 0000 lds r18,GyroFaktorGier |
6455 3f68 30E0 ldi r19,lo8(0) |
6456 3f6a 40E0 ldi r20,lo8(0) |
6457 3f6c 50E0 ldi r21,hi8(0) |
6458 3f6e 0E94 0000 call __mulsi3 |
6459 3f72 20E4 ldi r18,lo8(64) |
6460 3f74 30E0 ldi r19,hi8(64) |
6461 3f76 40E0 ldi r20,hlo8(64) |
6462 3f78 50E0 ldi r21,hhi8(64) |
6463 3f7a 0E94 0000 call __divmodsi4 |
6464 3f7e 7901 movw r14,r18 |
6465 3f80 8A01 movw r16,r20 |
6466 3f82 6091 0000 lds r22,IntegralFaktorGier |
6467 3f86 70E0 ldi r23,lo8(0) |
6468 3f88 80E0 ldi r24,lo8(0) |
6469 3f8a 90E0 ldi r25,hi8(0) |
6470 3f8c 2091 0000 lds r18,Integral_Gier |
6471 3f90 3091 0000 lds r19,(Integral_Gier)+1 |
6472 3f94 4091 0000 lds r20,(Integral_Gier)+2 |
6473 3f98 5091 0000 lds r21,(Integral_Gier)+3 |
6474 3f9c 0E94 0000 call __mulsi3 |
6475 3fa0 20EF ldi r18,lo8(22000) |
6476 3fa2 35E5 ldi r19,hi8(22000) |
6477 3fa4 40E0 ldi r20,hlo8(22000) |
6478 3fa6 50E0 ldi r21,hhi8(22000) |
6479 3fa8 0E94 0000 call __divmodsi4 |
6480 3fac E20E add r14,r18 |
6481 3fae F31E adc r15,r19 |
6482 3fb0 F092 0000 sts (MesswertGier)+1,r15 |
6483 3fb4 E092 0000 sts MesswertGier,r14 |
6484 3fb8 F1E0 ldi r31,lo8(4097) |
6485 3fba 8F16 cp r8,r31 |
6486 3fbc F0E1 ldi r31,hi8(4097) |
6487 3fbe 9F06 cpc r9,r31 |
6488 3fc0 04F0 brlt .L397 |
6489 3fc2 80E0 ldi r24,lo8(4096) |
6490 3fc4 90E1 ldi r25,hi8(4096) |
6491 3fc6 9093 0000 sts (MesswertNick)+1,r25 |
6492 3fca 8093 0000 sts MesswertNick,r24 |
6493 .L397: |
6494 3fce 8091 0000 lds r24,MesswertNick |
6495 3fd2 9091 0000 lds r25,(MesswertNick)+1 |
6496 3fd6 8050 subi r24,lo8(-4096) |
6497 3fd8 904F sbci r25,hi8(-4096) |
6498 3fda 04F4 brge .L398 |
6499 3fdc 80E0 ldi r24,lo8(-4096) |
6500 3fde 90EF ldi r25,hi8(-4096) |
6501 3fe0 9093 0000 sts (MesswertNick)+1,r25 |
6502 3fe4 8093 0000 sts MesswertNick,r24 |
6503 .L398: |
6504 3fe8 8091 0000 lds r24,MesswertRoll |
6505 3fec 9091 0000 lds r25,(MesswertRoll)+1 |
6506 3ff0 8150 subi r24,lo8(4097) |
6507 3ff2 9041 sbci r25,hi8(4097) |
6508 3ff4 04F0 brlt .L399 |
6509 3ff6 80E0 ldi r24,lo8(4096) |
6510 3ff8 90E1 ldi r25,hi8(4096) |
6511 3ffa 9093 0000 sts (MesswertRoll)+1,r25 |
6512 3ffe 8093 0000 sts MesswertRoll,r24 |
6513 .L399: |
6514 4002 8091 0000 lds r24,MesswertRoll |
6515 4006 9091 0000 lds r25,(MesswertRoll)+1 |
6516 400a 8050 subi r24,lo8(-4096) |
6517 400c 904F sbci r25,hi8(-4096) |
6518 400e 04F4 brge .L400 |
6519 4010 80E0 ldi r24,lo8(-4096) |
6520 4012 90EF ldi r25,hi8(-4096) |
6521 4014 9093 0000 sts (MesswertRoll)+1,r25 |
6522 4018 8093 0000 sts MesswertRoll,r24 |
6523 .L400: |
6524 401c 8091 0000 lds r24,MesswertGier |
6525 4020 9091 0000 lds r25,(MesswertGier)+1 |
6526 4024 8150 subi r24,lo8(4097) |
6527 4026 9041 sbci r25,hi8(4097) |
6528 4028 04F0 brlt .L401 |
6529 402a 80E0 ldi r24,lo8(4096) |
6530 402c 90E1 ldi r25,hi8(4096) |
6531 402e 9093 0000 sts (MesswertGier)+1,r25 |
6532 4032 8093 0000 sts MesswertGier,r24 |
6533 .L401: |
6534 4036 8091 0000 lds r24,MesswertGier |
6535 403a 9091 0000 lds r25,(MesswertGier)+1 |
6536 403e 8050 subi r24,lo8(-4096) |
6537 4040 904F sbci r25,hi8(-4096) |
6538 4042 04F4 brge .L402 |
6539 4044 80E0 ldi r24,lo8(-4096) |
6540 4046 90EF ldi r25,hi8(-4096) |
6541 4048 9093 0000 sts (MesswertGier)+1,r25 |
6542 404c 8093 0000 sts MesswertGier,r24 |
6543 .L402: |
6544 4050 2091 0000 lds r18,UBat |
6545 4054 3091 0000 lds r19,(UBat)+1 |
6546 4058 8091 0000 lds r24,BattLowVoltageWarning |
6547 405c 482F mov r20,r24 |
6548 405e 50E0 ldi r21,lo8(0) |
6549 4060 4217 cp r20,r18 |
6550 4062 5307 cpc r21,r19 |
6551 4064 04F4 brge .L403 |
6552 4066 6091 0000 lds r22,UBat |
6553 406a 7091 0000 lds r23,(UBat)+1 |
6554 406e AEA1 ldd r26,Y+38 |
6555 4070 BFA1 ldd r27,Y+39 |
6556 4072 A49F mul r26,r20 |
6557 4074 C001 movw r24,r0 |
6558 4076 A59F mul r26,r21 |
6559 4078 900D add r25,r0 |
6560 407a B49F mul r27,r20 |
6561 407c 900D add r25,r0 |
6562 407e 1124 clr r1 |
6563 4080 0E94 0000 call __udivmodhi4 |
6564 4084 7FA3 std Y+39,r23 |
6565 4086 6EA3 std Y+38,r22 |
6566 .L403: |
6567 4088 4EA0 ldd r4,Y+38 |
6568 408a 5FA0 ldd r5,Y+39 |
6569 408c 440C lsl r4 |
6570 408e 551C rol r5 |
6571 4090 440C lsl r4 |
6572 4092 551C rol r5 |
6573 4094 8091 0000 lds r24,EE_Parameter+13 |
6574 4098 80FF sbrs r24,0 |
6575 409a 00C0 rjmp .L404 |
6576 409c 8091 0000 lds r24,Looping_Roll |
6577 40a0 8823 tst r24 |
6578 40a2 01F0 breq .+2 |
6579 40a4 00C0 rjmp .L404 |
6580 40a6 8091 0000 lds r24,Looping_Nick |
6581 40aa 8823 tst r24 |
6582 40ac 01F0 breq .+2 |
6583 40ae 00C0 rjmp .L404 |
6584 40b0 8091 0000 lds r24,HoverGas |
6585 40b4 9091 0000 lds r25,(HoverGas)+1 |
6586 40b8 9093 0000 sts (DebugOut+44)+1,r25 |
6587 40bc 8093 0000 sts DebugOut+44,r24 |
6588 40c0 2091 0000 lds r18,BaroExpandActive |
6589 40c4 3091 0000 lds r19,(BaroExpandActive)+1 |
6590 40c8 2115 cp r18,__zero_reg__ |
6591 40ca 3105 cpc r19,__zero_reg__ |
6592 40cc 01F0 breq .+2 |
6593 40ce 00C0 rjmp .L405 |
6594 40d0 8091 0000 lds r24,MessLuftdruck |
6595 40d4 9091 0000 lds r25,(MessLuftdruck)+1 |
6596 40d8 8959 subi r24,lo8(921) |
6597 40da 9340 sbci r25,hi8(921) |
6598 40dc 00F0 brlo .L406 |
6599 40de 87B5 in r24,71-32 |
6600 40e0 853F cpi r24,lo8(-11) |
6601 40e2 00F4 brsh .L407 |
6602 40e4 8091 0000 lds r24,ExpandBaro |
6603 40e8 8150 subi r24,lo8(-(-1)) |
6604 40ea 00C0 rjmp .L535 |
6605 .L407: |
6606 40ec 81E0 ldi r24,lo8(1) |
6607 40ee 8093 0000 sts BaroAtLowerLimit.3089,r24 |
6608 40f2 00C0 rjmp .L408 |
6609 .L406: |
6610 40f4 8091 0000 lds r24,MessLuftdruck |
6611 40f8 9091 0000 lds r25,(MessLuftdruck)+1 |
6612 40fc 8436 cpi r24,100 |
6613 40fe 9105 cpc r25,__zero_reg__ |
6614 4100 00F4 brsh .L409 |
6615 4102 87B5 in r24,71-32 |
6616 4104 8B30 cpi r24,lo8(11) |
6617 4106 00F0 brlo .L410 |
6618 4108 8091 0000 lds r24,ExpandBaro |
6619 410c 8F5F subi r24,lo8(-(1)) |
6620 .L535: |
6621 410e 8093 0000 sts ExpandBaro,r24 |
6622 4112 26EF ldi r18,lo8(-10) |
6623 4114 8202 muls r24,r18 |
6624 4116 C001 movw r24,r0 |
6625 4118 1124 clr r1 |
6626 411a 2091 0000 lds r18,DruckOffsetSetting |
6627 411e 280F add r18,r24 |
6628 4120 27BD out 71-32,r18 |
6629 4122 8CE2 ldi r24,lo8(300) |
6630 4124 91E0 ldi r25,hi8(300) |
6631 4126 9093 0000 sts (beeptime)+1,r25 |
6632 412a 8093 0000 sts beeptime,r24 |
6633 412e 8EE5 ldi r24,lo8(350) |
6634 4130 91E0 ldi r25,hi8(350) |
6635 4132 9093 0000 sts (BaroExpandActive)+1,r25 |
6636 4136 8093 0000 sts BaroExpandActive,r24 |
6637 413a 00C0 rjmp .L408 |
6638 .L410: |
6639 413c 81E0 ldi r24,lo8(1) |
6640 413e 8093 0000 sts BaroAtUpperLimit.3088,r24 |
6641 4142 00C0 rjmp .L408 |
6642 .L409: |
6643 4144 1092 0000 sts BaroAtUpperLimit.3088,__zero_reg__ |
6644 4148 1092 0000 sts BaroAtLowerLimit.3089,__zero_reg__ |
6645 414c 00C0 rjmp .L408 |
6646 .L405: |
6647 414e 8091 0000 lds r24,HoehenWert |
6648 4152 9091 0000 lds r25,(HoehenWert)+1 |
6649 4156 A091 0000 lds r26,(HoehenWert)+2 |
6650 415a B091 0000 lds r27,(HoehenWert)+3 |
6651 415e 44E0 ldi r20,4 |
6652 4160 880F 1: lsl r24 |
6653 4162 991F rol r25 |
6654 4164 AA1F rol r26 |
6655 4166 BB1F rol r27 |
6656 4168 4A95 dec r20 |
6657 416a 01F4 brne 1b |
6658 416c 8093 0000 sts SummenHoehe,r24 |
6659 4170 9093 0000 sts (SummenHoehe)+1,r25 |
6660 4174 A093 0000 sts (SummenHoehe)+2,r26 |
6661 4178 B093 0000 sts (SummenHoehe)+3,r27 |
6662 417c 1092 0000 sts (VarioMeter)+1,__zero_reg__ |
6663 4180 1092 0000 sts VarioMeter,__zero_reg__ |
6664 4184 2150 subi r18,lo8(-(-1)) |
6665 4186 3040 sbci r19,hi8(-(-1)) |
6666 4188 3093 0000 sts (BaroExpandActive)+1,r19 |
6667 418c 2093 0000 sts BaroExpandActive,r18 |
6668 .L408: |
6669 4190 8091 0000 lds r24,EE_Parameter+13 |
6670 4194 9091 0000 lds r25,Parameter_MaxHoehe |
6671 4198 81FF sbrs r24,1 |
6672 419a 00C0 rjmp .L411 |
6673 419c 9233 cpi r25,lo8(50) |
6674 419e 00F4 brsh .L412 |
6675 41a0 8091 0000 lds r24,delay.3087 |
6676 41a4 8150 subi r24,lo8(-(-1)) |
6677 41a6 8093 0000 sts delay.3087,r24 |
6678 41aa 8F5F subi r24,lo8(-(1)) |
6679 41ac 01F4 brne .L413 |
6680 41ae 1092 0000 sts HoehenReglerAktiv,__zero_reg__ |
6681 41b2 8091 0000 lds r24,HoehenWert |
6682 41b6 9091 0000 lds r25,(HoehenWert)+1 |
6683 41ba A091 0000 lds r26,(HoehenWert)+2 |
6684 41be B091 0000 lds r27,(HoehenWert)+3 |
6685 41c2 8093 0000 sts SollHoehe,r24 |
6686 41c6 9093 0000 sts (SollHoehe)+1,r25 |
6687 41ca A093 0000 sts (SollHoehe)+2,r26 |
6688 41ce B093 0000 sts (SollHoehe)+3,r27 |
6689 41d2 81E0 ldi r24,lo8(1) |
6690 41d4 00C0 rjmp .L536 |
6691 .L412: |
6692 41d6 81E0 ldi r24,lo8(1) |
6693 41d8 8093 0000 sts HoehenReglerAktiv,r24 |
6694 41dc 88EC ldi r24,lo8(-56) |
6695 .L536: |
6696 41de 8093 0000 sts delay.3087,r24 |
6697 41e2 00C0 rjmp .L413 |
6698 .L411: |
6699 41e4 2091 0000 lds r18,ExternHoehenValue |
6700 41e8 3091 0000 lds r19,(ExternHoehenValue)+1 |
6701 41ec 290F add r18,r25 |
6702 41ee 311D adc r19,__zero_reg__ |
6703 41f0 8091 0000 lds r24,EE_Parameter+18 |
6704 41f4 90E0 ldi r25,lo8(0) |
6705 41f6 FC01 movw r30,r24 |
6706 41f8 2E9F mul r18,r30 |
6707 41fa C001 movw r24,r0 |
6708 41fc 2F9F mul r18,r31 |
6709 41fe 900D add r25,r0 |
6710 4200 3E9F mul r19,r30 |
6711 4202 900D add r25,r0 |
6712 4204 1124 clr r1 |
6713 4206 AA27 clr r26 |
6714 4208 97FD sbrc r25,7 |
6715 420a A095 com r26 |
6716 420c BA2F mov r27,r26 |
6717 420e 8093 0000 sts SollHoehe,r24 |
6718 4212 9093 0000 sts (SollHoehe)+1,r25 |
6719 4216 A093 0000 sts (SollHoehe)+2,r26 |
6720 421a B093 0000 sts (SollHoehe)+3,r27 |
6721 421e 81E0 ldi r24,lo8(1) |
6722 4220 8093 0000 sts HoehenReglerAktiv,r24 |
6723 .L413: |
6724 4224 E090 0000 lds r14,GIER_GRAD_FAKTOR |
6725 4228 F090 0000 lds r15,(GIER_GRAD_FAKTOR)+1 |
6726 422c 0091 0000 lds r16,(GIER_GRAD_FAKTOR)+2 |
6727 4230 1091 0000 lds r17,(GIER_GRAD_FAKTOR)+3 |
6728 4234 6091 0000 lds r22,IntegralNick |
6729 4238 7091 0000 lds r23,(IntegralNick)+1 |
6730 423c 8091 0000 lds r24,(IntegralNick)+2 |
6731 4240 9091 0000 lds r25,(IntegralNick)+3 |
6732 4244 A801 movw r20,r16 |
6733 4246 9701 movw r18,r14 |
6734 4248 0E94 0000 call __divmodsi4 |
6735 424c 5901 movw r10,r18 |
6736 424e 6A01 movw r12,r20 |
6737 4250 6091 0000 lds r22,IntegralRoll |
6738 4254 7091 0000 lds r23,(IntegralRoll)+1 |
6739 4258 8091 0000 lds r24,(IntegralRoll)+2 |
6740 425c 9091 0000 lds r25,(IntegralRoll)+3 |
6741 4260 A801 movw r20,r16 |
6742 4262 9701 movw r18,r14 |
6743 4264 0E94 0000 call __divmodsi4 |
6744 4268 C501 movw r24,r10 |
6745 426a B901 movw r22,r18 |
6746 426c 0E94 0000 call ihypot |
6747 4270 8C33 cpi r24,60 |
6748 4272 9105 cpc r25,__zero_reg__ |
6749 4274 04F0 brlt .L414 |
6750 4276 8CE3 ldi r24,lo8(60) |
6751 4278 90E0 ldi r25,hi8(60) |
6752 .L414: |
6753 427a 0E94 0000 call c_cos_8192 |
6754 427e 99A3 std Y+33,r25 |
6755 4280 88A3 std Y+32,r24 |
6756 4282 80E2 ldi r24,lo8(32) |
6757 4284 8093 0000 sts VarioCharacter,r24 |
6758 4288 8091 0000 lds r24,HoehenReglerAktiv |
6759 428c 8823 tst r24 |
6760 428e 01F4 brne .+2 |
6761 4290 00C0 rjmp .L415 |
6762 4292 8091 0000 lds r24,FCFlags |
6763 4296 84FD sbrc r24,4 |
6764 4298 00C0 rjmp .L415 |
6765 429a 8091 0000 lds r24,EE_Parameter+99 |
6766 429e 80FD sbrc r24,0 |
6767 42a0 00C0 rjmp .L416 |
6768 42a2 8091 0000 lds r24,EE_Parameter+13 |
6769 42a6 81FD sbrc r24,1 |
6770 42a8 00C0 rjmp .L417 |
6771 .L416: |
6772 42aa 1092 0000 sts (HeightTrimming.3081)+1,__zero_reg__ |
6773 42ae 1092 0000 sts HeightTrimming.3081,__zero_reg__ |
6774 42b2 1201 movw r2,r4 |
6775 42b4 00C0 rjmp .L418 |
6776 .L417: |
6777 42b6 8091 0000 lds r24,FCFlags |
6778 42ba 81FF sbrs r24,1 |
6779 42bc 00C0 rjmp .L419 |
6780 42be 4091 0000 lds r20,StickGas |
6781 42c2 5091 0000 lds r21,(StickGas)+1 |
6782 42c6 2091 0000 lds r18,StickGasHover.3083 |
6783 42ca 3091 0000 lds r19,(StickGasHover.3083)+1 |
6784 42ce C901 movw r24,r18 |
6785 42d0 0F96 adiw r24,15 |
6786 42d2 8417 cp r24,r20 |
6787 42d4 9507 cpc r25,r21 |
6788 42d6 04F4 brge .L420 |
6789 42d8 8091 0000 lds r24,BaroAtUpperLimit.3088 |
6790 42dc 8823 tst r24 |
6791 42de 01F4 brne .L420 |
6792 42e0 8091 0000 lds r24,HeightTrimmingFlag.3091 |
6793 42e4 81FF sbrs r24,1 |
6794 42e6 00C0 rjmp .L421 |
6795 42e8 8D7F andi r24,lo8(-3) |
6796 42ea 8093 0000 sts HeightTrimmingFlag.3091,r24 |
6797 42ee 8091 0000 lds r24,HoehenWert |
6798 42f2 9091 0000 lds r25,(HoehenWert)+1 |
6799 42f6 A091 0000 lds r26,(HoehenWert)+2 |
6800 42fa B091 0000 lds r27,(HoehenWert)+3 |
6801 42fe 8093 0000 sts SollHoehe,r24 |
6802 4302 9093 0000 sts (SollHoehe)+1,r25 |
6803 4306 A093 0000 sts (SollHoehe)+2,r26 |
6804 430a B093 0000 sts (SollHoehe)+3,r27 |
6805 .L421: |
6806 430e 8091 0000 lds r24,HeightTrimmingFlag.3091 |
6807 4312 8160 ori r24,lo8(1) |
6808 4314 8093 0000 sts HeightTrimmingFlag.3091,r24 |
6809 4318 2091 0000 lds r18,StickGas |
6810 431c 3091 0000 lds r19,(StickGas)+1 |
6811 4320 2F50 subi r18,lo8(-(-15)) |
6812 4322 3040 sbci r19,hi8(-(-15)) |
6813 4324 8091 0000 lds r24,StickGasHover.3083 |
6814 4328 9091 0000 lds r25,(StickGasHover.3083)+1 |
6815 432c 281B sub r18,r24 |
6816 432e 390B sbc r19,r25 |
6817 4330 37FF sbrs r19,7 |
6818 4332 00C0 rjmp .L422 |
6819 4334 3095 com r19 |
6820 4336 2195 neg r18 |
6821 4338 3F4F sbci r19,lo8(-1) |
6822 .L422: |
6823 433a 8091 0000 lds r24,HeightTrimming.3081 |
6824 433e 9091 0000 lds r25,(HeightTrimming.3081)+1 |
6825 4342 820F add r24,r18 |
6826 4344 931F adc r25,r19 |
6827 4346 9093 0000 sts (HeightTrimming.3081)+1,r25 |
6828 434a 8093 0000 sts HeightTrimming.3081,r24 |
6829 434e 8BE2 ldi r24,lo8(43) |
6830 4350 00C0 rjmp .L537 |
6831 .L420: |
6832 4352 2F50 subi r18,lo8(-(-15)) |
6833 4354 3040 sbci r19,hi8(-(-15)) |
6834 4356 4217 cp r20,r18 |
6835 4358 5307 cpc r21,r19 |
6836 435a 04F4 brge .L424 |
6837 435c 8091 0000 lds r24,BaroAtLowerLimit.3089 |
6838 4360 8823 tst r24 |
6839 4362 01F4 brne .L424 |
6840 4364 8091 0000 lds r24,HeightTrimmingFlag.3091 |
6841 4368 80FF sbrs r24,0 |
6842 436a 00C0 rjmp .L425 |
6843 436c 8E7F andi r24,lo8(-2) |
6844 436e 8093 0000 sts HeightTrimmingFlag.3091,r24 |
6845 4372 8091 0000 lds r24,HoehenWert |
6846 4376 9091 0000 lds r25,(HoehenWert)+1 |
6847 437a A091 0000 lds r26,(HoehenWert)+2 |
6848 437e B091 0000 lds r27,(HoehenWert)+3 |
6849 4382 8093 0000 sts SollHoehe,r24 |
6850 4386 9093 0000 sts (SollHoehe)+1,r25 |
6851 438a A093 0000 sts (SollHoehe)+2,r26 |
6852 438e B093 0000 sts (SollHoehe)+3,r27 |
6853 .L425: |
6854 4392 8091 0000 lds r24,HeightTrimmingFlag.3091 |
6855 4396 8260 ori r24,lo8(2) |
6856 4398 8093 0000 sts HeightTrimmingFlag.3091,r24 |
6857 439c 2091 0000 lds r18,StickGas |
6858 43a0 3091 0000 lds r19,(StickGas)+1 |
6859 43a4 215F subi r18,lo8(-(15)) |
6860 43a6 3F4F sbci r19,hi8(-(15)) |
6861 43a8 8091 0000 lds r24,StickGasHover.3083 |
6862 43ac 9091 0000 lds r25,(StickGasHover.3083)+1 |
6863 43b0 281B sub r18,r24 |
6864 43b2 390B sbc r19,r25 |
6865 43b4 37FF sbrs r19,7 |
6866 43b6 00C0 rjmp .L426 |
6867 43b8 3095 com r19 |
6868 43ba 2195 neg r18 |
6869 43bc 3F4F sbci r19,lo8(-1) |
6870 .L426: |
6871 43be 8091 0000 lds r24,HeightTrimming.3081 |
6872 43c2 9091 0000 lds r25,(HeightTrimming.3081)+1 |
6873 43c6 821B sub r24,r18 |
6874 43c8 930B sbc r25,r19 |
6875 43ca 9093 0000 sts (HeightTrimming.3081)+1,r25 |
6876 43ce 8093 0000 sts HeightTrimming.3081,r24 |
6877 43d2 8DE2 ldi r24,lo8(45) |
6878 43d4 00C0 rjmp .L537 |
6879 .L424: |
6880 43d6 2091 0000 lds r18,HeightTrimmingFlag.3091 |
6881 43da 822F mov r24,r18 |
6882 43dc 90E0 ldi r25,lo8(0) |
6883 43de 8370 andi r24,lo8(3) |
6884 43e0 9070 andi r25,hi8(3) |
6885 43e2 892B or r24,r25 |
6886 43e4 01F0 breq .L427 |
6887 43e6 2C7F andi r18,lo8(-4) |
6888 43e8 2093 0000 sts HeightTrimmingFlag.3091,r18 |
6889 43ec 1092 0000 sts (HeightTrimming.3081)+1,__zero_reg__ |
6890 43f0 1092 0000 sts HeightTrimming.3081,__zero_reg__ |
6891 43f4 8091 0000 lds r24,HoehenWert |
6892 43f8 9091 0000 lds r25,(HoehenWert)+1 |
6893 43fc A091 0000 lds r26,(HoehenWert)+2 |
6894 4400 B091 0000 lds r27,(HoehenWert)+3 |
6895 4404 8093 0000 sts SollHoehe,r24 |
6896 4408 9093 0000 sts (SollHoehe)+1,r25 |
6897 440c A093 0000 sts (SollHoehe)+2,r26 |
6898 4410 B093 0000 sts (SollHoehe)+3,r27 |
6899 4414 8091 0000 lds r24,EE_Parameter+99 |
6900 4418 81FF sbrs r24,1 |
6901 441a 00C0 rjmp .L428 |
6902 441c 84EF ldi r24,lo8(500) |
6903 441e 91E0 ldi r25,hi8(500) |
6904 4420 9093 0000 sts (beeptime)+1,r25 |
6905 4424 8093 0000 sts beeptime,r24 |
6906 .L428: |
6907 4428 8091 0000 lds r24,StartTrigger |
6908 442c 8823 tst r24 |
6909 442e 01F4 brne .L427 |
6910 4430 8091 0000 lds r24,HoehenWert |
6911 4434 9091 0000 lds r25,(HoehenWert)+1 |
6912 4438 A091 0000 lds r26,(HoehenWert)+2 |
6913 443c B091 0000 lds r27,(HoehenWert)+3 |
6914 4440 C397 sbiw r24,51 |
6915 4442 A105 cpc r26,__zero_reg__ |
6916 4444 B105 cpc r27,__zero_reg__ |
6917 4446 04F0 brlt .L427 |
6918 4448 81E0 ldi r24,lo8(1) |
6919 444a 8093 0000 sts StartTrigger,r24 |
6920 .L427: |
6921 444e 8DE3 ldi r24,lo8(61) |
6922 .L537: |
6923 4450 8093 0000 sts VarioCharacter,r24 |
6924 4454 2091 0000 lds r18,HeightTrimming.3081 |
6925 4458 3091 0000 lds r19,(HeightTrimming.3081)+1 |
6926 445c C901 movw r24,r18 |
6927 445e 37FF sbrs r19,7 |
6928 4460 00C0 rjmp .L430 |
6929 4462 8827 clr r24 |
6930 4464 9927 clr r25 |
6931 4466 821B sub r24,r18 |
6932 4468 930B sbc r25,r19 |
6933 .L430: |
6934 446a 8150 subi r24,lo8(513) |
6935 446c 9240 sbci r25,hi8(513) |
6936 446e 04F4 brge .+2 |
6937 4470 00C0 rjmp .L429 |
6938 4472 8091 0000 lds r24,EE_Parameter+18 |
6939 4476 90E0 ldi r25,lo8(0) |
6940 4478 AC01 movw r20,r24 |
6941 447a 429F mul r20,r18 |
6942 447c C001 movw r24,r0 |
6943 447e 439F mul r20,r19 |
6944 4480 900D add r25,r0 |
6945 4482 529F mul r21,r18 |
6946 4484 900D add r25,r0 |
6947 4486 1124 clr r1 |
6948 4488 60E0 ldi r22,lo8(1280) |
6949 448a 75E0 ldi r23,hi8(1280) |
6950 448c 0E94 0000 call __divmodhi4 |
6951 4490 8827 clr r24 |
6952 4492 77FD sbrc r23,7 |
6953 4494 8095 com r24 |
6954 4496 982F mov r25,r24 |
6955 4498 E090 0000 lds r14,SollHoehe |
6956 449c F090 0000 lds r15,(SollHoehe)+1 |
6957 44a0 0091 0000 lds r16,(SollHoehe)+2 |
6958 44a4 1091 0000 lds r17,(SollHoehe)+3 |
6959 44a8 E60E add r14,r22 |
6960 44aa F71E adc r15,r23 |
6961 44ac 081F adc r16,r24 |
6962 44ae 191F adc r17,r25 |
6963 44b0 E092 0000 sts SollHoehe,r14 |
6964 44b4 F092 0000 sts (SollHoehe)+1,r15 |
6965 44b8 0093 0000 sts (SollHoehe)+2,r16 |
6966 44bc 1093 0000 sts (SollHoehe)+3,r17 |
6967 44c0 1092 0000 sts (HeightTrimming.3081)+1,__zero_reg__ |
6968 44c4 1092 0000 sts HeightTrimming.3081,__zero_reg__ |
6969 44c8 2091 0000 lds r18,HoehenWert |
6970 44cc 3091 0000 lds r19,(HoehenWert)+1 |
6971 44d0 4091 0000 lds r20,(HoehenWert)+2 |
6972 44d4 5091 0000 lds r21,(HoehenWert)+3 |
6973 44d8 DA01 movw r26,r20 |
6974 44da C901 movw r24,r18 |
6975 44dc 8F5F subi r24,lo8(-(-1023)) |
6976 44de 9340 sbci r25,hi8(-(-1023)) |
6977 44e0 A040 sbci r26,hlo8(-(-1023)) |
6978 44e2 B040 sbci r27,hhi8(-(-1023)) |
6979 44e4 E816 cp r14,r24 |
6980 44e6 F906 cpc r15,r25 |
6981 44e8 0A07 cpc r16,r26 |
6982 44ea 1B07 cpc r17,r27 |
6983 44ec 04F4 brge .L431 |
6984 44ee 2050 subi r18,lo8(-(-1024)) |
6985 44f0 3440 sbci r19,hi8(-(-1024)) |
6986 44f2 4040 sbci r20,hlo8(-(-1024)) |
6987 44f4 5040 sbci r21,hhi8(-(-1024)) |
6988 44f6 00C0 rjmp .L538 |
6989 .L431: |
6990 44f8 DA01 movw r26,r20 |
6991 44fa C901 movw r24,r18 |
6992 44fc 8150 subi r24,lo8(-(1023)) |
6993 44fe 9C4F sbci r25,hi8(-(1023)) |
6994 4500 AF4F sbci r26,hlo8(-(1023)) |
6995 4502 BF4F sbci r27,hhi8(-(1023)) |
6996 4504 8E15 cp r24,r14 |
6997 4506 9F05 cpc r25,r15 |
6998 4508 A007 cpc r26,r16 |
6999 450a B107 cpc r27,r17 |
7000 450c 04F4 brge .L432 |
7001 450e 2050 subi r18,lo8(-(1024)) |
7002 4510 3C4F sbci r19,hi8(-(1024)) |
7003 4512 4F4F sbci r20,hlo8(-(1024)) |
7004 4514 5F4F sbci r21,hhi8(-(1024)) |
7005 .L538: |
7006 4516 2093 0000 sts SollHoehe,r18 |
7007 451a 3093 0000 sts (SollHoehe)+1,r19 |
7008 451e 4093 0000 sts (SollHoehe)+2,r20 |
7009 4522 5093 0000 sts (SollHoehe)+3,r21 |
7010 .L432: |
7011 4526 8091 0000 lds r24,EE_Parameter+99 |
7012 452a 81FF sbrs r24,1 |
7013 452c 00C0 rjmp .L433 |
7014 452e 84E6 ldi r24,lo8(100) |
7015 4530 90E0 ldi r25,hi8(100) |
7016 4532 9093 0000 sts (beeptime)+1,r25 |
7017 4536 8093 0000 sts beeptime,r24 |
7018 .L433: |
7019 453a 8091 0000 lds r24,EE_Parameter+22 |
7020 453e 8823 tst r24 |
7021 4540 01F4 brne .L429 |
7022 4542 8091 0000 lds r24,HoverGas |
7023 4546 9091 0000 lds r25,(HoverGas)+1 |
7024 454a 64E0 ldi r22,lo8(4) |
7025 454c 70E0 ldi r23,hi8(4) |
7026 454e 0E94 0000 call __divmodhi4 |
7027 4552 CB01 movw r24,r22 |
7028 4554 7093 0000 sts (StickGasHover.3083)+1,r23 |
7029 4558 6093 0000 sts StickGasHover.3083,r22 |
7030 455c 2091 0000 lds r18,UBat |
7031 4560 3091 0000 lds r19,(UBat)+1 |
7032 4564 6091 0000 lds r22,BattLowVoltageWarning |
7033 4568 DC01 movw r26,r24 |
7034 456a A29F mul r26,r18 |
7035 456c C001 movw r24,r0 |
7036 456e A39F mul r26,r19 |
7037 4570 900D add r25,r0 |
7038 4572 B29F mul r27,r18 |
7039 4574 900D add r25,r0 |
7040 4576 1124 clr r1 |
7041 4578 70E0 ldi r23,lo8(0) |
7042 457a 0E94 0000 call __divmodhi4 |
7043 457e 7093 0000 sts (StickGasHover.3083)+1,r23 |
7044 4582 6093 0000 sts StickGasHover.3083,r22 |
7045 4586 6634 cpi r22,70 |
7046 4588 7105 cpc r23,__zero_reg__ |
7047 458a 04F4 brge .L434 |
7048 458c 86E4 ldi r24,lo8(70) |
7049 458e 90E0 ldi r25,hi8(70) |
7050 4590 00C0 rjmp .L539 |
7051 .L434: |
7052 4592 6739 cpi r22,151 |
7053 4594 7105 cpc r23,__zero_reg__ |
7054 4596 04F0 brlt .L429 |
7055 4598 86E9 ldi r24,lo8(150) |
7056 459a 90E0 ldi r25,hi8(150) |
7057 .L539: |
7058 459c 9093 0000 sts (StickGasHover.3083)+1,r25 |
7059 45a0 8093 0000 sts StickGasHover.3083,r24 |
7060 .L429: |
7061 45a4 8091 0000 lds r24,BaroExpandActive |
7062 45a8 9091 0000 lds r25,(BaroExpandActive)+1 |
7063 45ac 892B or r24,r25 |
7064 45ae 01F0 breq .L435 |
7065 45b0 8091 0000 lds r24,HoehenWert |
7066 45b4 9091 0000 lds r25,(HoehenWert)+1 |
7067 45b8 A091 0000 lds r26,(HoehenWert)+2 |
7068 45bc B091 0000 lds r27,(HoehenWert)+3 |
7069 45c0 8093 0000 sts SollHoehe,r24 |
7070 45c4 9093 0000 sts (SollHoehe)+1,r25 |
7071 45c8 A093 0000 sts (SollHoehe)+2,r26 |
7072 45cc B093 0000 sts (SollHoehe)+3,r27 |
7073 45d0 00C0 rjmp .L435 |
7074 .L419: |
7075 45d2 8091 0000 lds r24,HoehenWert |
7076 45d6 9091 0000 lds r25,(HoehenWert)+1 |
7077 45da A091 0000 lds r26,(HoehenWert)+2 |
7078 45de B091 0000 lds r27,(HoehenWert)+3 |
7079 45e2 8059 subi r24,lo8(-(-400)) |
7080 45e4 9140 sbci r25,hi8(-(-400)) |
7081 45e6 A040 sbci r26,hlo8(-(-400)) |
7082 45e8 B040 sbci r27,hhi8(-(-400)) |
7083 45ea 8093 0000 sts SollHoehe,r24 |
7084 45ee 9093 0000 sts (SollHoehe)+1,r25 |
7085 45f2 A093 0000 sts (SollHoehe)+2,r26 |
7086 45f6 B093 0000 sts (SollHoehe)+3,r27 |
7087 45fa 8091 0000 lds r24,EE_Parameter+22 |
7088 45fe 8823 tst r24 |
7089 4600 01F0 breq .L436 |
7090 4602 8093 0000 sts StickGasHover.3083,r24 |
7091 4606 1092 0000 sts StickGasHover.3083+1,__zero_reg__ |
7092 460a 00C0 rjmp .L437 |
7093 .L436: |
7094 460c 88E7 ldi r24,lo8(120) |
7095 460e 90E0 ldi r25,hi8(120) |
7096 4610 9093 0000 sts (StickGasHover.3083)+1,r25 |
7097 4614 8093 0000 sts StickGasHover.3083,r24 |
7098 .L437: |
7099 4618 5092 0000 sts (HoverGas)+1,r5 |
7100 461c 4092 0000 sts HoverGas,r4 |
7101 .L435: |
7102 4620 2090 0000 lds r2,HoverGas |
7103 4624 3090 0000 lds r3,(HoverGas)+1 |
7104 .L418: |
7105 4628 E090 0000 lds r14,HoehenWert |
7106 462c F090 0000 lds r15,(HoehenWert)+1 |
7107 4630 0091 0000 lds r16,(HoehenWert)+2 |
7108 4634 1091 0000 lds r17,(HoehenWert)+3 |
7109 4638 2091 0000 lds r18,SollHoehe |
7110 463c 3091 0000 lds r19,(SollHoehe)+1 |
7111 4640 4091 0000 lds r20,(SollHoehe)+2 |
7112 4644 5091 0000 lds r21,(SollHoehe)+3 |
7113 4648 2E15 cp r18,r14 |
7114 464a 3F05 cpc r19,r15 |
7115 464c 4007 cpc r20,r16 |
7116 464e 5107 cpc r21,r17 |
7117 4650 04F0 brlt .L438 |
7118 4652 8091 0000 lds r24,EE_Parameter+99 |
7119 4656 80FD sbrc r24,0 |
7120 4658 00C0 rjmp .L439 |
7121 .L438: |
7122 465a 8091 0000 lds r24,BaroExpandActive |
7123 465e 9091 0000 lds r25,(BaroExpandActive)+1 |
7124 4662 892B or r24,r25 |
7125 4664 01F0 breq .L440 |
7126 4666 2090 0000 lds r2,HoverGas |
7127 466a 3090 0000 lds r3,(HoverGas)+1 |
7128 466e AA24 clr r10 |
7129 4670 BB24 clr r11 |
7130 4672 CC24 clr r12 |
7131 4674 DD24 clr r13 |
7132 4676 00C0 rjmp .L441 |
7133 .L440: |
7134 4678 D801 movw r26,r16 |
7135 467a C701 movw r24,r14 |
7136 467c 821B sub r24,r18 |
7137 467e 930B sbc r25,r19 |
7138 4680 A40B sbc r26,r20 |
7139 4682 B50B sbc r27,r21 |
7140 4684 8093 0000 sts tmp_long.3043,r24 |
7141 4688 9093 0000 sts (tmp_long.3043)+1,r25 |
7142 468c A093 0000 sts (tmp_long.3043)+2,r26 |
7143 4690 B093 0000 sts (tmp_long.3043)+3,r27 |
7144 4694 8230 cpi r24,lo8(-32766) |
7145 4696 E0E8 ldi r30,hi8(-32766) |
7146 4698 9E07 cpc r25,r30 |
7147 469a EFEF ldi r30,hlo8(-32766) |
7148 469c AE07 cpc r26,r30 |
7149 469e EFEF ldi r30,hhi8(-32766) |
7150 46a0 BE07 cpc r27,r30 |
7151 46a2 04F4 brge .L442 |
7152 46a4 81E0 ldi r24,lo8(-32767) |
7153 46a6 90E8 ldi r25,hi8(-32767) |
7154 46a8 AFEF ldi r26,hlo8(-32767) |
7155 46aa BFEF ldi r27,hhi8(-32767) |
7156 46ac 00C0 rjmp .L540 |
7157 .L442: |
7158 46ae 8F5F subi r24,lo8(32767) |
7159 46b0 9F47 sbci r25,hi8(32767) |
7160 46b2 A040 sbci r26,hlo8(32767) |
7161 46b4 B040 sbci r27,hhi8(32767) |
7162 46b6 04F0 brlt .L443 |
7163 46b8 8FEF ldi r24,lo8(32767) |
7164 46ba 9FE7 ldi r25,hi8(32767) |
7165 46bc A0E0 ldi r26,hlo8(32767) |
7166 46be B0E0 ldi r27,hhi8(32767) |
7167 .L540: |
7168 46c0 8093 0000 sts tmp_long.3043,r24 |
7169 46c4 9093 0000 sts (tmp_long.3043)+1,r25 |
7170 46c8 A093 0000 sts (tmp_long.3043)+2,r26 |
7171 46cc B093 0000 sts (tmp_long.3043)+3,r27 |
7172 .L443: |
7173 46d0 E090 0000 lds r14,tmp_long.3043 |
7174 46d4 F090 0000 lds r15,(tmp_long.3043)+1 |
7175 46d8 0091 0000 lds r16,(tmp_long.3043)+2 |
7176 46dc 1091 0000 lds r17,(tmp_long.3043)+3 |
7177 46e0 6091 0000 lds r22,Parameter_Hoehe_P |
7178 46e4 70E0 ldi r23,lo8(0) |
7179 46e6 80E0 ldi r24,lo8(0) |
7180 46e8 90E0 ldi r25,hi8(0) |
7181 46ea A801 movw r20,r16 |
7182 46ec 9701 movw r18,r14 |
7183 46ee 0E94 0000 call __mulsi3 |
7184 46f2 20E2 ldi r18,lo8(32) |
7185 46f4 30E0 ldi r19,hi8(32) |
7186 46f6 40E0 ldi r20,hlo8(32) |
7187 46f8 50E0 ldi r21,hhi8(32) |
7188 46fa 0E94 0000 call __divmodsi4 |
7189 46fe C901 movw r24,r18 |
7190 4700 DA01 movw r26,r20 |
7191 4702 8093 0000 sts tmp_long.3043,r24 |
7192 4706 9093 0000 sts (tmp_long.3043)+1,r25 |
7193 470a A093 0000 sts (tmp_long.3043)+2,r26 |
7194 470e B093 0000 sts (tmp_long.3043)+3,r27 |
7195 4712 8530 cpi r24,lo8(-507) |
7196 4714 2EEF ldi r18,hi8(-507) |
7197 4716 9207 cpc r25,r18 |
7198 4718 2FEF ldi r18,hlo8(-507) |
7199 471a A207 cpc r26,r18 |
7200 471c 2FEF ldi r18,hhi8(-507) |
7201 471e B207 cpc r27,r18 |
7202 4720 04F4 brge .L444 |
7203 4722 84E0 ldi r24,lo8(-508) |
7204 4724 9EEF ldi r25,hi8(-508) |
7205 4726 AFEF ldi r26,hlo8(-508) |
7206 4728 BFEF ldi r27,hhi8(-508) |
7207 472a 00C0 rjmp .L541 |
7208 .L444: |
7209 472c 8050 subi r24,lo8(1024) |
7210 472e 9440 sbci r25,hi8(1024) |
7211 4730 A040 sbci r26,hlo8(1024) |
7212 4732 B040 sbci r27,hhi8(1024) |
7213 4734 04F0 brlt .L445 |
7214 4736 80E0 ldi r24,lo8(1024) |
7215 4738 94E0 ldi r25,hi8(1024) |
7216 473a A0E0 ldi r26,hlo8(1024) |
7217 473c B0E0 ldi r27,hhi8(1024) |
7218 .L541: |
7219 473e 8093 0000 sts tmp_long.3043,r24 |
7220 4742 9093 0000 sts (tmp_long.3043)+1,r25 |
7221 4746 A093 0000 sts (tmp_long.3043)+2,r26 |
7222 474a B093 0000 sts (tmp_long.3043)+3,r27 |
7223 .L445: |
7224 474e 6090 0000 lds r6,tmp_long.3043 |
7225 4752 7090 0000 lds r7,(tmp_long.3043)+1 |
7226 4756 8090 0000 lds r8,(tmp_long.3043)+2 |
7227 475a 9090 0000 lds r9,(tmp_long.3043)+3 |
7228 475e 8091 0000 lds r24,VarioMeter |
7229 4762 9091 0000 lds r25,(VarioMeter)+1 |
7230 4766 68E0 ldi r22,lo8(8) |
7231 4768 70E0 ldi r23,hi8(8) |
7232 476a 0E94 0000 call __divmodhi4 |
7233 476e 9B01 movw r18,r22 |
7234 4770 4FEF ldi r20,hi8(-126) |
7235 4772 6238 cpi r22,lo8(-126) |
7236 4774 7407 cpc r23,r20 |
7237 4776 04F4 brge .L446 |
7238 4778 21E8 ldi r18,lo8(-127) |
7239 477a 3FEF ldi r19,hi8(-127) |
7240 477c 00C0 rjmp .L447 |
7241 .L446: |
7242 477e 6038 cpi r22,128 |
7243 4780 7105 cpc r23,__zero_reg__ |
7244 4782 04F0 brlt .L447 |
7245 4784 20E8 ldi r18,lo8(128) |
7246 4786 30E0 ldi r19,hi8(128) |
7247 .L447: |
7248 4788 B901 movw r22,r18 |
7249 478a 8827 clr r24 |
7250 478c 77FD sbrc r23,7 |
7251 478e 8095 com r24 |
7252 4790 982F mov r25,r24 |
7253 4792 2091 0000 lds r18,Parameter_Luftdruck_D |
7254 4796 30E0 ldi r19,lo8(0) |
7255 4798 40E0 ldi r20,lo8(0) |
7256 479a 50E0 ldi r21,hi8(0) |
7257 479c 0E94 0000 call __mulsi3 |
7258 47a0 24E0 ldi r18,lo8(4) |
7259 47a2 30E0 ldi r19,hi8(4) |
7260 47a4 40E0 ldi r20,hlo8(4) |
7261 47a6 50E0 ldi r21,hhi8(4) |
7262 47a8 0E94 0000 call __divmodsi4 |
7263 47ac 5FEF ldi r21,hi8(-255) |
7264 47ae 2130 cpi r18,lo8(-255) |
7265 47b0 3507 cpc r19,r21 |
7266 47b2 04F4 brge .L448 |
7267 47b4 20E0 ldi r18,lo8(-256) |
7268 47b6 3FEF ldi r19,hi8(-256) |
7269 47b8 00C0 rjmp .L449 |
7270 .L448: |
7271 47ba 2F3F cpi r18,255 |
7272 47bc 3105 cpc r19,__zero_reg__ |
7273 47be 01F0 breq .L449 |
7274 47c0 04F0 brlt .L449 |
7275 47c2 20E0 ldi r18,lo8(256) |
7276 47c4 31E0 ldi r19,hi8(256) |
7277 .L449: |
7278 47c6 8091 0000 lds r24,HeightTrimmingFlag.3091 |
7279 47ca 8823 tst r24 |
7280 47cc 01F0 breq .L450 |
7281 47ce C901 movw r24,r18 |
7282 47d0 64E0 ldi r22,lo8(4) |
7283 47d2 70E0 ldi r23,hi8(4) |
7284 47d4 00C0 rjmp .L542 |
7285 .L450: |
7286 47d6 8091 0000 lds r24,EE_Parameter+99 |
7287 47da 80FF sbrs r24,0 |
7288 47dc 00C0 rjmp .L451 |
7289 47de C901 movw r24,r18 |
7290 47e0 68E0 ldi r22,lo8(8) |
7291 47e2 70E0 ldi r23,hi8(8) |
7292 .L542: |
7293 47e4 0E94 0000 call __divmodhi4 |
7294 47e8 9B01 movw r18,r22 |
7295 .L451: |
7296 47ea 5701 movw r10,r14 |
7297 47ec 6301 movw r12,r6 |
7298 47ee C20E add r12,r18 |
7299 47f0 D31E adc r13,r19 |
7300 .L441: |
7301 47f2 E090 0000 lds r14,Parameter_Hoehe_ACC_Wirkung |
7302 47f6 EE20 tst r14 |
7303 47f8 01F4 brne .+2 |
7304 47fa 00C0 rjmp .L452 |
7305 47fc 6091 0000 lds r22,Mess_Integral_Hoch |
7306 4800 7091 0000 lds r23,(Mess_Integral_Hoch)+1 |
7307 4804 8091 0000 lds r24,(Mess_Integral_Hoch)+2 |
7308 4808 9091 0000 lds r25,(Mess_Integral_Hoch)+3 |
7309 480c FF24 clr r15 |
7310 480e 00E0 ldi r16,lo8(0) |
7311 4810 10E0 ldi r17,hi8(0) |
7312 4812 20E8 ldi r18,lo8(128) |
7313 4814 30E0 ldi r19,hi8(128) |
7314 4816 40E0 ldi r20,hlo8(128) |
7315 4818 50E0 ldi r21,hhi8(128) |
7316 481a 0E94 0000 call __divmodsi4 |
7317 481e C801 movw r24,r16 |
7318 4820 B701 movw r22,r14 |
7319 4822 0E94 0000 call __mulsi3 |
7320 4826 20E2 ldi r18,lo8(32) |
7321 4828 30E0 ldi r19,hi8(32) |
7322 482a 40E0 ldi r20,hlo8(32) |
7323 482c 50E0 ldi r21,hhi8(32) |
7324 482e 0E94 0000 call __divmodsi4 |
7325 4832 C901 movw r24,r18 |
7326 4834 DA01 movw r26,r20 |
7327 4836 8093 0000 sts tmp_long.3043,r24 |
7328 483a 9093 0000 sts (tmp_long.3043)+1,r25 |
7329 483e A093 0000 sts (tmp_long.3043)+2,r26 |
7330 4842 B093 0000 sts (tmp_long.3043)+3,r27 |
7331 4846 8138 cpi r24,lo8(-127) |
7332 4848 6FEF ldi r22,hi8(-127) |
7333 484a 9607 cpc r25,r22 |
7334 484c 6FEF ldi r22,hlo8(-127) |
7335 484e A607 cpc r26,r22 |
7336 4850 6FEF ldi r22,hhi8(-127) |
7337 4852 B607 cpc r27,r22 |
7338 4854 04F4 brge .L453 |
7339 4856 80E8 ldi r24,lo8(-128) |
7340 4858 9FEF ldi r25,hi8(-128) |
7341 485a AFEF ldi r26,hlo8(-128) |
7342 485c BFEF ldi r27,hhi8(-128) |
7343 485e 00C0 rjmp .L543 |
7344 .L453: |
7345 4860 8F3F cpi r24,lo8(255) |
7346 4862 9105 cpc r25,__zero_reg__ |
7347 4864 A105 cpc r26,__zero_reg__ |
7348 4866 B105 cpc r27,__zero_reg__ |
7349 4868 01F0 breq .L454 |
7350 486a 04F0 brlt .L454 |
7351 486c 80E0 ldi r24,lo8(256) |
7352 486e 91E0 ldi r25,hi8(256) |
7353 4870 A0E0 ldi r26,hlo8(256) |
7354 4872 B0E0 ldi r27,hhi8(256) |
7355 .L543: |
7356 4874 8093 0000 sts tmp_long.3043,r24 |
7357 4878 9093 0000 sts (tmp_long.3043)+1,r25 |
7358 487c A093 0000 sts (tmp_long.3043)+2,r26 |
7359 4880 B093 0000 sts (tmp_long.3043)+3,r27 |
7360 .L454: |
7361 4884 8091 0000 lds r24,tmp_long.3043 |
7362 4888 9091 0000 lds r25,(tmp_long.3043)+1 |
7363 488c C80E add r12,r24 |
7364 488e D91E adc r13,r25 |
7365 .L452: |
7366 4890 2091 0000 lds r18,FromNaviCtrl_Value+4 |
7367 4894 3327 clr r19 |
7368 4896 27FD sbrc r18,7 |
7369 4898 3095 com r19 |
7370 489a 8091 0000 lds r24,Parameter_Hoehe_GPS_Z |
7371 489e 90E0 ldi r25,lo8(0) |
7372 48a0 DC01 movw r26,r24 |
7373 48a2 2A9F mul r18,r26 |
7374 48a4 C001 movw r24,r0 |
7375 48a6 2B9F mul r18,r27 |
7376 48a8 900D add r25,r0 |
7377 48aa 3A9F mul r19,r26 |
7378 48ac 900D add r25,r0 |
7379 48ae 1124 clr r1 |
7380 48b0 60E8 ldi r22,lo8(128) |
7381 48b2 70E0 ldi r23,hi8(128) |
7382 48b4 0E94 0000 call __divmodhi4 |
7383 48b8 CB01 movw r24,r22 |
7384 48ba BFEF ldi r27,hi8(-127) |
7385 48bc 6138 cpi r22,lo8(-127) |
7386 48be 7B07 cpc r23,r27 |
7387 48c0 04F4 brge .L455 |
7388 48c2 80E8 ldi r24,lo8(-128) |
7389 48c4 9FEF ldi r25,hi8(-128) |
7390 .L455: |
7391 48c6 0091 0000 lds r16,HoverGas |
7392 48ca 1091 0000 lds r17,(HoverGas)+1 |
7393 48ce C80E add r12,r24 |
7394 48d0 D91E adc r13,r25 |
7395 48d2 B601 movw r22,r12 |
7396 48d4 8827 clr r24 |
7397 48d6 77FD sbrc r23,7 |
7398 48d8 8095 com r24 |
7399 48da 982F mov r25,r24 |
7400 48dc 9801 movw r18,r16 |
7401 48de 4427 clr r20 |
7402 48e0 37FD sbrc r19,7 |
7403 48e2 4095 com r20 |
7404 48e4 542F mov r21,r20 |
7405 48e6 0E94 0000 call __mulsi3 |
7406 48ea 20E0 ldi r18,lo8(512) |
7407 48ec 32E0 ldi r19,hi8(512) |
7408 48ee 40E0 ldi r20,hlo8(512) |
7409 48f0 50E0 ldi r21,hhi8(512) |
7410 48f2 0E94 0000 call __divmodsi4 |
7411 48f6 F101 movw r30,r2 |
7412 48f8 E21B sub r30,r18 |
7413 48fa F30B sbc r31,r19 |
7414 48fc 8091 0000 lds r24,HeightTrimming.3081 |
7415 4900 9091 0000 lds r25,(HeightTrimming.3081)+1 |
7416 4904 892B or r24,r25 |
7417 4906 01F0 breq .+2 |
7418 4908 00C0 rjmp .L456 |
7419 490a 1016 cp __zero_reg__,r16 |
7420 490c 1106 cpc __zero_reg__,r17 |
7421 490e 04F0 brlt .+2 |
7422 4910 00C0 rjmp .L456 |
7423 4912 C501 movw r24,r10 |
7424 4914 B7FE sbrs r11,7 |
7425 4916 00C0 rjmp .L457 |
7426 4918 8827 clr r24 |
7427 491a 9927 clr r25 |
7428 491c 8A19 sub r24,r10 |
7429 491e 9B09 sbc r25,r11 |
7430 .L457: |
7431 4920 8D33 cpi r24,61 |
7432 4922 9105 cpc r25,__zero_reg__ |
7433 4924 00F4 brsh .L458 |
7434 4926 2091 0000 lds r18,HoverGasMin.3084 |
7435 492a 3091 0000 lds r19,(HoverGasMin.3084)+1 |
7436 492e 2E17 cp r18,r30 |
7437 4930 3F07 cpc r19,r31 |
7438 4932 04F0 brlt .+2 |
7439 4934 00C0 rjmp .L459 |
7440 4936 00C0 rjmp .L463 |
7441 .L458: |
7442 4938 AC01 movw r20,r24 |
7443 493a 4C53 subi r20,lo8(-(-60)) |
7444 493c 5040 sbci r21,hi8(-(-60)) |
7445 493e 85E0 ldi r24,5 |
7446 4940 5695 1: lsr r21 |
7447 4942 4795 ror r20 |
7448 4944 8A95 dec r24 |
7449 4946 01F4 brne 1b |
7450 4948 4031 cpi r20,16 |
7451 494a 5105 cpc r21,__zero_reg__ |
7452 494c 00F0 brlo .L461 |
7453 494e 4FE0 ldi r20,lo8(15) |
7454 4950 50E0 ldi r21,hi8(15) |
7455 .L461: |
7456 4952 2091 0000 lds r18,HoverGasMin.3084 |
7457 4956 3091 0000 lds r19,(HoverGasMin.3084)+1 |
7458 495a 1A14 cp __zero_reg__,r10 |
7459 495c 1B04 cpc __zero_reg__,r11 |
7460 495e 04F4 brge .L462 |
7461 4960 80E1 ldi r24,lo8(16) |
7462 4962 90E0 ldi r25,hi8(16) |
7463 4964 841B sub r24,r20 |
7464 4966 950B sbc r25,r21 |
7465 4968 829F mul r24,r18 |
7466 496a B001 movw r22,r0 |
7467 496c 839F mul r24,r19 |
7468 496e 700D add r23,r0 |
7469 4970 929F mul r25,r18 |
7470 4972 700D add r23,r0 |
7471 4974 1124 clr r1 |
7472 4976 04E0 ldi r16,4 |
7473 4978 7695 1: lsr r23 |
7474 497a 6795 ror r22 |
7475 497c 0A95 dec r16 |
7476 497e 01F4 brne 1b |
7477 4980 6E17 cp r22,r30 |
7478 4982 7F07 cpc r23,r31 |
7479 4984 00F4 brsh .L545 |
7480 .L463: |
7481 4986 8091 0000 lds r24,HoverGasMax.3085 |
7482 498a 9091 0000 lds r25,(HoverGasMax.3085)+1 |
7483 498e 9F01 movw r18,r30 |
7484 4990 8E17 cp r24,r30 |
7485 4992 9F07 cpc r25,r31 |
7486 4994 04F4 brge .L459 |
7487 4996 9C01 movw r18,r24 |
7488 4998 00C0 rjmp .L459 |
7489 .L462: |
7490 499a 8091 0000 lds r24,HoverGasMax.3085 |
7491 499e 9091 0000 lds r25,(HoverGasMax.3085)+1 |
7492 49a2 2E17 cp r18,r30 |
7493 49a4 3F07 cpc r19,r31 |
7494 49a6 04F4 brge .L459 |
7495 49a8 405F subi r20,lo8(-(16)) |
7496 49aa 5F4F sbci r21,hi8(-(16)) |
7497 49ac 489F mul r20,r24 |
7498 49ae B001 movw r22,r0 |
7499 49b0 499F mul r20,r25 |
7500 49b2 700D add r23,r0 |
7501 49b4 589F mul r21,r24 |
7502 49b6 700D add r23,r0 |
7503 49b8 1124 clr r1 |
7504 49ba 14E0 ldi r17,4 |
7505 49bc 7695 1: lsr r23 |
7506 49be 6795 ror r22 |
7507 49c0 1A95 dec r17 |
7508 49c2 01F4 brne 1b |
7509 49c4 E617 cp r30,r22 |
7510 49c6 F707 cpc r31,r23 |
7511 49c8 00F0 brlo .L456 |
7512 .L545: |
7513 49ca 9B01 movw r18,r22 |
7514 49cc 00C0 rjmp .L459 |
7515 .L456: |
7516 49ce 9F01 movw r18,r30 |
7517 .L459: |
7518 49d0 B901 movw r22,r18 |
7519 49d2 8827 clr r24 |
7520 49d4 77FD sbrc r23,7 |
7521 49d6 8095 com r24 |
7522 49d8 982F mov r25,r24 |
7523 49da BDE0 ldi r27,13 |
7524 49dc 660F 1: lsl r22 |
7525 49de 771F rol r23 |
7526 49e0 881F rol r24 |
7527 49e2 991F rol r25 |
7528 49e4 BA95 dec r27 |
7529 49e6 01F4 brne 1b |
7530 49e8 E8A1 ldd r30,Y+32 |
7531 49ea F9A1 ldd r31,Y+33 |
7532 49ec 9F01 movw r18,r30 |
7533 49ee 4427 clr r20 |
7534 49f0 37FD sbrc r19,7 |
7535 49f2 4095 com r20 |
7536 49f4 542F mov r21,r20 |
7537 49f6 0E94 0000 call __divmodsi4 |
7538 49fa 7901 movw r14,r18 |
7539 49fc 8A01 movw r16,r20 |
7540 49fe E092 0000 sts tmp_long2.3044,r14 |
7541 4a02 F092 0000 sts (tmp_long2.3044)+1,r15 |
7542 4a06 0093 0000 sts (tmp_long2.3044)+2,r16 |
7543 4a0a 1093 0000 sts (tmp_long2.3044)+3,r17 |
7544 4a0e 2091 0000 lds r18,FilterHCGas.3082 |
7545 4a12 3091 0000 lds r19,(FilterHCGas.3082)+1 |
7546 4a16 C901 movw r24,r18 |
7547 4a18 880F lsl r24 |
7548 4a1a 991F rol r25 |
7549 4a1c 820F add r24,r18 |
7550 4a1e 931F adc r25,r19 |
7551 4a20 8E0D add r24,r14 |
7552 4a22 9F1D adc r25,r15 |
7553 4a24 64E0 ldi r22,lo8(4) |
7554 4a26 70E0 ldi r23,hi8(4) |
7555 4a28 0E94 0000 call __divmodhi4 |
7556 4a2c 7093 0000 sts (FilterHCGas.3082)+1,r23 |
7557 4a30 6093 0000 sts FilterHCGas.3082,r22 |
7558 4a34 8091 0000 lds r24,EE_Parameter+14 |
7559 4a38 90E0 ldi r25,lo8(0) |
7560 4a3a 880F lsl r24 |
7561 4a3c 991F rol r25 |
7562 4a3e 880F lsl r24 |
7563 4a40 991F rol r25 |
7564 4a42 8617 cp r24,r22 |
7565 4a44 9707 cpc r25,r23 |
7566 4a46 04F4 brge .L546 |
7567 .L465: |
7568 4a48 8091 0000 lds r24,MAX_GAS |
7569 4a4c 90E0 ldi r25,lo8(0) |
7570 4a4e 4497 sbiw r24,20 |
7571 4a50 880F lsl r24 |
7572 4a52 991F rol r25 |
7573 4a54 880F lsl r24 |
7574 4a56 991F rol r25 |
7575 4a58 6817 cp r22,r24 |
7576 4a5a 7907 cpc r23,r25 |
7577 4a5c 04F0 brlt .L466 |
7578 .L546: |
7579 4a5e 9093 0000 sts (FilterHCGas.3082)+1,r25 |
7580 4a62 8093 0000 sts FilterHCGas.3082,r24 |
7581 .L466: |
7582 4a66 8091 0000 lds r24,EE_Parameter+99 |
7583 4a6a 2091 0000 lds r18,FilterHCGas.3082 |
7584 4a6e 3091 0000 lds r19,(FilterHCGas.3082)+1 |
7585 4a72 80FF sbrs r24,0 |
7586 4a74 00C0 rjmp .L467 |
7587 4a76 2415 cp r18,r4 |
7588 4a78 3505 cpc r19,r5 |
7589 4a7a 04F0 brlt .L468 |
7590 4a7c 5092 0000 sts (FilterHCGas.3082)+1,r5 |
7591 4a80 4092 0000 sts FilterHCGas.3082,r4 |
7592 .L468: |
7593 4a84 4090 0000 lds r4,FilterHCGas.3082 |
7594 4a88 5090 0000 lds r5,(FilterHCGas.3082)+1 |
7595 4a8c 00C0 rjmp .L439 |
7596 .L467: |
7597 4a8e 8091 0000 lds r24,HoverGas |
7598 4a92 9091 0000 lds r25,(HoverGas)+1 |
7599 4a96 A201 movw r20,r4 |
7600 4a98 481B sub r20,r24 |
7601 4a9a 590B sbc r21,r25 |
7602 4a9c CA01 movw r24,r20 |
7603 4a9e 64E0 ldi r22,lo8(4) |
7604 4aa0 70E0 ldi r23,hi8(4) |
7605 4aa2 0E94 0000 call __divmodhi4 |
7606 4aa6 2B01 movw r4,r22 |
7607 4aa8 420E add r4,r18 |
7608 4aaa 531E adc r5,r19 |
7609 4aac 00C0 rjmp .L439 |
7610 .L415: |
7611 4aae 8091 0000 lds r24,EE_Parameter+22 |
7612 4ab2 8823 tst r24 |
7613 4ab4 01F4 brne .L469 |
7614 4ab6 8091 0000 lds r24,HoverGas |
7615 4aba 9091 0000 lds r25,(HoverGas)+1 |
7616 4abe 64E0 ldi r22,lo8(4) |
7617 4ac0 70E0 ldi r23,hi8(4) |
7618 4ac2 0E94 0000 call __divmodhi4 |
7619 4ac6 CB01 movw r24,r22 |
7620 4ac8 7093 0000 sts (StickGasHover.3083)+1,r23 |
7621 4acc 6093 0000 sts StickGasHover.3083,r22 |
7622 4ad0 2091 0000 lds r18,UBat |
7623 4ad4 3091 0000 lds r19,(UBat)+1 |
7624 4ad8 6091 0000 lds r22,BattLowVoltageWarning |
7625 4adc DC01 movw r26,r24 |
7626 4ade A29F mul r26,r18 |
7627 4ae0 C001 movw r24,r0 |
7628 4ae2 A39F mul r26,r19 |
7629 4ae4 900D add r25,r0 |
7630 4ae6 B29F mul r27,r18 |
7631 4ae8 900D add r25,r0 |
7632 4aea 1124 clr r1 |
7633 4aec 70E0 ldi r23,lo8(0) |
7634 4aee 0E94 0000 call __divmodhi4 |
7635 4af2 7093 0000 sts (StickGasHover.3083)+1,r23 |
7636 4af6 6093 0000 sts StickGasHover.3083,r22 |
7637 4afa 00C0 rjmp .L470 |
7638 .L469: |
7639 4afc 8093 0000 sts StickGasHover.3083,r24 |
7640 4b00 1092 0000 sts StickGasHover.3083+1,__zero_reg__ |
7641 .L470: |
7642 4b04 8091 0000 lds r24,StickGasHover.3083 |
7643 4b08 9091 0000 lds r25,(StickGasHover.3083)+1 |
7644 4b0c 8734 cpi r24,71 |
7645 4b0e 9105 cpc r25,__zero_reg__ |
7646 4b10 04F4 brge .L471 |
7647 4b12 86E4 ldi r24,lo8(70) |
7648 4b14 90E0 ldi r25,hi8(70) |
7649 4b16 00C0 rjmp .L547 |
7650 .L471: |
7651 4b18 8639 cpi r24,150 |
7652 4b1a 9105 cpc r25,__zero_reg__ |
7653 4b1c 04F0 brlt .L472 |
7654 4b1e 86E9 ldi r24,lo8(150) |
7655 4b20 90E0 ldi r25,hi8(150) |
7656 .L547: |
7657 4b22 9093 0000 sts (StickGasHover.3083)+1,r25 |
7658 4b26 8093 0000 sts StickGasHover.3083,r24 |
7659 .L472: |
7660 4b2a 5092 0000 sts (FilterHCGas.3082)+1,r5 |
7661 4b2e 4092 0000 sts FilterHCGas.3082,r4 |
7662 .L439: |
7663 4b32 8091 0000 lds r24,FCFlags |
7664 4b36 81FF sbrs r24,1 |
7665 4b38 00C0 rjmp .L473 |
7666 4b3a 8091 0000 lds r24,HoverGasFilter.3086 |
7667 4b3e 9091 0000 lds r25,(HoverGasFilter.3086)+1 |
7668 4b42 A091 0000 lds r26,(HoverGasFilter.3086)+2 |
7669 4b46 B091 0000 lds r27,(HoverGasFilter.3086)+3 |
7670 4b4a 0097 sbiw r24,0 |
7671 4b4c A105 cpc r26,__zero_reg__ |
7672 4b4e B105 cpc r27,__zero_reg__ |
7673 4b50 01F0 breq .L474 |
7674 4b52 8091 0000 lds r24,StartTrigger |
7675 4b56 8130 cpi r24,lo8(1) |
7676 4b58 01F4 brne .L475 |
7677 .L474: |
7678 4b5a C201 movw r24,r4 |
7679 4b5c AA27 clr r26 |
7680 4b5e 97FD sbrc r25,7 |
7681 4b60 A095 com r26 |
7682 4b62 BA2F mov r27,r26 |
7683 4b64 7EE0 ldi r23,14 |
7684 4b66 880F 1: lsl r24 |
7685 4b68 991F rol r25 |
7686 4b6a AA1F rol r26 |
7687 4b6c BB1F rol r27 |
7688 4b6e 7A95 dec r23 |
7689 4b70 01F4 brne 1b |
7690 4b72 8093 0000 sts HoverGasFilter.3086,r24 |
7691 4b76 9093 0000 sts (HoverGasFilter.3086)+1,r25 |
7692 4b7a A093 0000 sts (HoverGasFilter.3086)+2,r26 |
7693 4b7e B093 0000 sts (HoverGasFilter.3086)+3,r27 |
7694 .L475: |
7695 4b82 8091 0000 lds r24,StartTrigger |
7696 4b86 8130 cpi r24,lo8(1) |
7697 4b88 01F4 brne .L476 |
7698 4b8a 82E0 ldi r24,lo8(2) |
7699 4b8c 8093 0000 sts StartTrigger,r24 |
7700 .L476: |
7701 4b90 B201 movw r22,r4 |
7702 4b92 8827 clr r24 |
7703 4b94 77FD sbrc r23,7 |
7704 4b96 8095 com r24 |
7705 4b98 982F mov r25,r24 |
7706 4b9a E8A1 ldd r30,Y+32 |
7707 4b9c F9A1 ldd r31,Y+33 |
7708 4b9e 9F01 movw r18,r30 |
7709 4ba0 4427 clr r20 |
7710 4ba2 37FD sbrc r19,7 |
7711 4ba4 4095 com r20 |
7712 4ba6 542F mov r21,r20 |
7713 4ba8 0E94 0000 call __mulsi3 |
7714 4bac 20E0 ldi r18,lo8(8192) |
7715 4bae 30E2 ldi r19,hi8(8192) |
7716 4bb0 40E0 ldi r20,hlo8(8192) |
7717 4bb2 50E0 ldi r21,hhi8(8192) |
7718 4bb4 0E94 0000 call __divmodsi4 |
7719 4bb8 7901 movw r14,r18 |
7720 4bba 8A01 movw r16,r20 |
7721 4bbc 2093 0000 sts tmp_long2.3044,r18 |
7722 4bc0 3093 0000 sts (tmp_long2.3044)+1,r19 |
7723 4bc4 4093 0000 sts (tmp_long2.3044)+2,r20 |
7724 4bc8 5093 0000 sts (tmp_long2.3044)+3,r21 |
7725 4bcc 8091 0000 lds r24,modell_fliegt |
7726 4bd0 9091 0000 lds r25,(modell_fliegt)+1 |
7727 4bd4 805A subi r24,lo8(4000) |
7728 4bd6 9F40 sbci r25,hi8(4000) |
7729 4bd8 00F4 brsh .L477 |
7730 4bda 8091 0000 lds r24,HoverGasFilter.3086 |
7731 4bde 9091 0000 lds r25,(HoverGasFilter.3086)+1 |
7732 4be2 A091 0000 lds r26,(HoverGasFilter.3086)+2 |
7733 4be6 B091 0000 lds r27,(HoverGasFilter.3086)+3 |
7734 4bea 9C01 movw r18,r24 |
7735 4bec AD01 movw r20,r26 |
7736 4bee 6AE0 ldi r22,10 |
7737 4bf0 5695 1: lsr r21 |
7738 4bf2 4795 ror r20 |
7739 4bf4 3795 ror r19 |
7740 4bf6 2795 ror r18 |
7741 4bf8 6A95 dec r22 |
7742 4bfa 01F4 brne 1b |
7743 4bfc 821B sub r24,r18 |
7744 4bfe 930B sbc r25,r19 |
7745 4c00 A40B sbc r26,r20 |
7746 4c02 B50B sbc r27,r21 |
7747 4c04 F4E0 ldi r31,4 |
7748 4c06 EE0C 1: lsl r14 |
7749 4c08 FF1C rol r15 |
7750 4c0a 001F rol r16 |
7751 4c0c 111F rol r17 |
7752 4c0e FA95 dec r31 |
7753 4c10 01F4 brne 1b |
7754 4c12 8E0D add r24,r14 |
7755 4c14 9F1D adc r25,r15 |
7756 4c16 A01F adc r26,r16 |
7757 4c18 B11F adc r27,r17 |
7758 4c1a 8093 0000 sts HoverGasFilter.3086,r24 |
7759 4c1e 9093 0000 sts (HoverGasFilter.3086)+1,r25 |
7760 4c22 A093 0000 sts (HoverGasFilter.3086)+2,r26 |
7761 4c26 B093 0000 sts (HoverGasFilter.3086)+3,r27 |
7762 .L477: |
7763 4c2a 8091 0000 lds r24,modell_fliegt |
7764 4c2e 9091 0000 lds r25,(modell_fliegt)+1 |
7765 4c32 8054 subi r24,lo8(8000) |
7766 4c34 9F41 sbci r25,hi8(8000) |
7767 4c36 00F4 brsh .L478 |
7768 4c38 8091 0000 lds r24,HoverGasFilter.3086 |
7769 4c3c 9091 0000 lds r25,(HoverGasFilter.3086)+1 |
7770 4c40 A091 0000 lds r26,(HoverGasFilter.3086)+2 |
7771 4c44 B091 0000 lds r27,(HoverGasFilter.3086)+3 |
7772 4c48 9C01 movw r18,r24 |
7773 4c4a AD01 movw r20,r26 |
7774 4c4c ECE0 ldi r30,12 |
7775 4c4e 5695 1: lsr r21 |
7776 4c50 4795 ror r20 |
7777 4c52 3795 ror r19 |
7778 4c54 2795 ror r18 |
7779 4c56 EA95 dec r30 |
7780 4c58 01F4 brne 1b |
7781 4c5a 821B sub r24,r18 |
7782 4c5c 930B sbc r25,r19 |
7783 4c5e A40B sbc r26,r20 |
7784 4c60 B50B sbc r27,r21 |
7785 4c62 2091 0000 lds r18,tmp_long2.3044 |
7786 4c66 3091 0000 lds r19,(tmp_long2.3044)+1 |
7787 4c6a 4091 0000 lds r20,(tmp_long2.3044)+2 |
7788 4c6e 5091 0000 lds r21,(tmp_long2.3044)+3 |
7789 4c72 72E0 ldi r23,2 |
7790 4c74 220F 1: lsl r18 |
7791 4c76 331F rol r19 |
7792 4c78 441F rol r20 |
7793 4c7a 551F rol r21 |
7794 4c7c 7A95 dec r23 |
7795 4c7e 01F4 brne 1b |
7796 4c80 280F add r18,r24 |
7797 4c82 391F adc r19,r25 |
7798 4c84 4A1F adc r20,r26 |
7799 4c86 5B1F adc r21,r27 |
7800 4c88 2093 0000 sts HoverGasFilter.3086,r18 |
7801 4c8c 3093 0000 sts (HoverGasFilter.3086)+1,r19 |
7802 4c90 4093 0000 sts (HoverGasFilter.3086)+2,r20 |
7803 4c94 5093 0000 sts (HoverGasFilter.3086)+3,r21 |
7804 4c98 00C0 rjmp .L479 |
7805 .L478: |
7806 4c9a 8091 0000 lds r24,VarioMeter |
7807 4c9e 9091 0000 lds r25,(VarioMeter)+1 |
7808 4ca2 97FF sbrs r25,7 |
7809 4ca4 00C0 rjmp .L480 |
7810 4ca6 9095 com r25 |
7811 4ca8 8195 neg r24 |
7812 4caa 9F4F sbci r25,lo8(-1) |
7813 .L480: |
7814 4cac 8436 cpi r24,100 |
7815 4cae 9105 cpc r25,__zero_reg__ |
7816 4cb0 04F4 brge .L479 |
7817 4cb2 8091 0000 lds r24,HoverGasFilter.3086 |
7818 4cb6 9091 0000 lds r25,(HoverGasFilter.3086)+1 |
7819 4cba A091 0000 lds r26,(HoverGasFilter.3086)+2 |
7820 4cbe B091 0000 lds r27,(HoverGasFilter.3086)+3 |
7821 4cc2 9C01 movw r18,r24 |
7822 4cc4 AD01 movw r20,r26 |
7823 4cc6 6EE0 ldi r22,14 |
7824 4cc8 5695 1: lsr r21 |
7825 4cca 4795 ror r20 |
7826 4ccc 3795 ror r19 |
7827 4cce 2795 ror r18 |
7828 4cd0 6A95 dec r22 |
7829 4cd2 01F4 brne 1b |
7830 4cd4 821B sub r24,r18 |
7831 4cd6 930B sbc r25,r19 |
7832 4cd8 A40B sbc r26,r20 |
7833 4cda B50B sbc r27,r21 |
7834 4cdc 2091 0000 lds r18,tmp_long2.3044 |
7835 4ce0 3091 0000 lds r19,(tmp_long2.3044)+1 |
7836 4ce4 4091 0000 lds r20,(tmp_long2.3044)+2 |
7837 4ce8 5091 0000 lds r21,(tmp_long2.3044)+3 |
7838 4cec 820F add r24,r18 |
7839 4cee 931F adc r25,r19 |
7840 4cf0 A41F adc r26,r20 |
7841 4cf2 B51F adc r27,r21 |
7842 4cf4 8093 0000 sts HoverGasFilter.3086,r24 |
7843 4cf8 9093 0000 sts (HoverGasFilter.3086)+1,r25 |
7844 4cfc A093 0000 sts (HoverGasFilter.3086)+2,r26 |
7845 4d00 B093 0000 sts (HoverGasFilter.3086)+3,r27 |
7846 .L479: |
7847 4d04 8091 0000 lds r24,HoverGasFilter.3086 |
7848 4d08 9091 0000 lds r25,(HoverGasFilter.3086)+1 |
7849 4d0c A091 0000 lds r26,(HoverGasFilter.3086)+2 |
7850 4d10 B091 0000 lds r27,(HoverGasFilter.3086)+3 |
7851 4d14 2EE0 ldi r18,14 |
7852 4d16 B695 1: lsr r27 |
7853 4d18 A795 ror r26 |
7854 4d1a 9795 ror r25 |
7855 4d1c 8795 ror r24 |
7856 4d1e 2A95 dec r18 |
7857 4d20 01F4 brne 1b |
7858 4d22 FC01 movw r30,r24 |
7859 4d24 9093 0000 sts (HoverGas)+1,r25 |
7860 4d28 8093 0000 sts HoverGas,r24 |
7861 4d2c 6091 0000 lds r22,EE_Parameter+20 |
7862 4d30 6623 tst r22 |
7863 4d32 01F0 breq .L481 |
7864 4d34 70E0 ldi r23,lo8(0) |
7865 4d36 0E94 0000 call __divmodhi4 |
7866 4d3a CB01 movw r24,r22 |
7867 4d3c 9F01 movw r18,r30 |
7868 4d3e 261B sub r18,r22 |
7869 4d40 370B sbc r19,r23 |
7870 4d42 3093 0000 sts (HoverGasMin.3084)+1,r19 |
7871 4d46 2093 0000 sts HoverGasMin.3084,r18 |
7872 4d4a 8E0F add r24,r30 |
7873 4d4c 9F1F adc r25,r31 |
7874 4d4e 00C0 rjmp .L548 |
7875 .L481: |
7876 4d50 1092 0000 sts (HoverGasMin.3084)+1,__zero_reg__ |
7877 4d54 1092 0000 sts HoverGasMin.3084,__zero_reg__ |
7878 4d58 8FEF ldi r24,lo8(1023) |
7879 4d5a 93E0 ldi r25,hi8(1023) |
7880 .L548: |
7881 4d5c 9093 0000 sts (HoverGasMax.3085)+1,r25 |
7882 4d60 8093 0000 sts HoverGasMax.3085,r24 |
7883 4d64 00C0 rjmp .L404 |
7884 .L473: |
7885 4d66 1092 0000 sts StartTrigger,__zero_reg__ |
7886 4d6a 1092 0000 sts HoverGasFilter.3086,__zero_reg__ |
7887 4d6e 1092 0000 sts (HoverGasFilter.3086)+1,__zero_reg__ |
7888 4d72 1092 0000 sts (HoverGasFilter.3086)+2,__zero_reg__ |
7889 4d76 1092 0000 sts (HoverGasFilter.3086)+3,__zero_reg__ |
7890 4d7a 1092 0000 sts (HoverGas)+1,__zero_reg__ |
7891 4d7e 1092 0000 sts HoverGas,__zero_reg__ |
7892 .L404: |
7893 4d82 8091 0000 lds r24,MIN_GAS |
7894 4d86 282F mov r18,r24 |
7895 4d88 30E0 ldi r19,lo8(0) |
7896 4d8a 265F subi r18,lo8(-(10)) |
7897 4d8c 3F4F sbci r19,hi8(-(10)) |
7898 4d8e 220F lsl r18 |
7899 4d90 331F rol r19 |
7900 4d92 220F lsl r18 |
7901 4d94 331F rol r19 |
7902 4d96 B201 movw r22,r4 |
7903 4d98 4216 cp r4,r18 |
7904 4d9a 5306 cpc r5,r19 |
7905 4d9c 04F4 brge .L482 |
7906 4d9e B901 movw r22,r18 |
7907 .L482: |
7908 4da0 8091 0000 lds r24,MAX_GAS |
7909 4da4 282F mov r18,r24 |
7910 4da6 30E0 ldi r19,lo8(0) |
7911 4da8 2451 subi r18,lo8(-(-20)) |
7912 4daa 3040 sbci r19,hi8(-(-20)) |
7913 4dac 220F lsl r18 |
7914 4dae 331F rol r19 |
7915 4db0 220F lsl r18 |
7916 4db2 331F rol r19 |
7917 4db4 7B01 movw r14,r22 |
7918 4db6 2617 cp r18,r22 |
7919 4db8 3707 cpc r19,r23 |
7920 4dba 04F4 brge .L483 |
7921 4dbc 7901 movw r14,r18 |
7922 .L483: |
7923 4dbe 8091 0000 lds r24,MissingMotor |
7924 4dc2 8823 tst r24 |
7925 4dc4 01F4 brne .L484 |
7926 4dc6 8091 0000 lds r24,Capacity+6 |
7927 4dca 8F3F cpi r24,lo8(-1) |
7928 4dcc 01F0 breq .L485 |
7929 .L484: |
7930 4dce 8091 0000 lds r24,modell_fliegt |
7931 4dd2 9091 0000 lds r25,(modell_fliegt)+1 |
7932 4dd6 0297 sbiw r24,2 |
7933 4dd8 C097 sbiw r24,48 |
7934 4dda 00F4 brsh .L485 |
7935 4ddc 1E14 cp __zero_reg__,r14 |
7936 4dde 1F04 cpc __zero_reg__,r15 |
7937 4de0 04F4 brge .L485 |
7938 4de2 81E0 ldi r24,lo8(1) |
7939 4de4 90E0 ldi r25,hi8(1) |
7940 4de6 9093 0000 sts (modell_fliegt)+1,r25 |
7941 4dea 8093 0000 sts modell_fliegt,r24 |
7942 4dee 8091 0000 lds r24,MIN_GAS |
7943 4df2 E82E mov r14,r24 |
7944 4df4 FF24 clr r15 |
7945 4df6 4AE0 ldi r20,lo8(10) |
7946 4df8 50E0 ldi r21,hi8(10) |
7947 4dfa E40E add r14,r20 |
7948 4dfc F51E adc r15,r21 |
7949 4dfe EE0C lsl r14 |
7950 4e00 FF1C rol r15 |
7951 4e02 EE0C lsl r14 |
7952 4e04 FF1C rol r15 |
7953 .L485: |
7954 4e06 F092 0000 sts (DebugOut+16)+1,r15 |
7955 4e0a E092 0000 sts DebugOut+16,r14 |
7956 4e0e 6091 0000 lds r22,sollGier.3042 |
7957 4e12 7091 0000 lds r23,(sollGier.3042)+1 |
7958 4e16 8091 0000 lds r24,(sollGier.3042)+2 |
7959 4e1a 9091 0000 lds r25,(sollGier.3042)+3 |
7960 4e1e 2CEF ldi r18,lo8(-4) |
7961 4e20 3FEF ldi r19,hi8(-4) |
7962 4e22 4FEF ldi r20,hlo8(-4) |
7963 4e24 5FEF ldi r21,hhi8(-4) |
7964 4e26 0E94 0000 call __mulsi3 |
7965 4e2a 8091 0000 lds r24,MesswertGier |
7966 4e2e 9091 0000 lds r25,(MesswertGier)+1 |
7967 4e32 860F add r24,r22 |
7968 4e34 971F adc r25,r23 |
7969 4e36 51EA ldi r21,lo8(161) |
7970 4e38 E516 cp r14,r21 |
7971 4e3a F104 cpc r15,__zero_reg__ |
7972 4e3c 04F0 brlt .L486 |
7973 4e3e 9701 movw r18,r14 |
7974 4e40 3595 asr r19 |
7975 4e42 2795 ror r18 |
7976 4e44 8217 cp r24,r18 |
7977 4e46 9307 cpc r25,r19 |
7978 4e48 04F4 brge .L487 |
7979 4e4a 9C01 movw r18,r24 |
7980 .L487: |
7981 4e4c C701 movw r24,r14 |
7982 4e4e 62E0 ldi r22,lo8(2) |
7983 4e50 70E0 ldi r23,hi8(2) |
7984 4e52 0E94 0000 call __divmodhi4 |
7985 4e56 7095 com r23 |
7986 4e58 6195 neg r22 |
7987 4e5a 7F4F sbci r23,lo8(-1) |
7988 4e5c 2617 cp r18,r22 |
7989 4e5e 3707 cpc r19,r23 |
7990 4e60 04F4 brge .L489 |
7991 4e62 9B01 movw r18,r22 |
7992 4e64 00C0 rjmp .L489 |
7993 .L486: |
7994 4e66 6FEF ldi r22,hi8(-80) |
7995 4e68 803B cpi r24,lo8(-80) |
7996 4e6a 9607 cpc r25,r22 |
7997 4e6c 04F4 brge .L490 |
7998 4e6e 80EB ldi r24,lo8(-80) |
7999 4e70 9FEF ldi r25,hi8(-80) |
8000 .L490: |
8001 4e72 9C01 movw r18,r24 |
8002 4e74 8135 cpi r24,81 |
8003 4e76 9105 cpc r25,__zero_reg__ |
8004 4e78 04F0 brlt .L489 |
8005 4e7a 20E5 ldi r18,lo8(80) |
8006 4e7c 30E0 ldi r19,hi8(80) |
8007 .L489: |
8008 4e7e 8091 0000 lds r24,MAX_GAS |
8009 4e82 90E0 ldi r25,lo8(0) |
8010 4e84 880F lsl r24 |
8011 4e86 991F rol r25 |
8012 4e88 880F lsl r24 |
8013 4e8a 991F rol r25 |
8014 4e8c AC01 movw r20,r24 |
8015 4e8e 4E19 sub r20,r14 |
8016 4e90 5F09 sbc r21,r15 |
8017 4e92 4217 cp r20,r18 |
8018 4e94 5307 cpc r21,r19 |
8019 4e96 04F4 brge .L492 |
8020 4e98 9A01 movw r18,r20 |
8021 .L492: |
8022 4e9a D701 movw r26,r14 |
8023 4e9c A81B sub r26,r24 |
8024 4e9e B90B sbc r27,r25 |
8025 4ea0 4901 movw r8,r18 |
8026 4ea2 2A17 cp r18,r26 |
8027 4ea4 3B07 cpc r19,r27 |
8028 4ea6 04F4 brge .L493 |
8029 4ea8 4D01 movw r8,r26 |
8030 .L493: |
8031 4eaa 6091 0000 lds r22,MesswertNick |
8032 4eae 7091 0000 lds r23,(MesswertNick)+1 |
8033 4eb2 E091 0000 lds r30,StickNick |
8034 4eb6 F091 0000 lds r31,(StickNick)+1 |
8035 4eba 6E1B sub r22,r30 |
8036 4ebc 7F0B sbc r23,r31 |
8037 4ebe 7093 0000 sts (DiffNick)+1,r23 |
8038 4ec2 6093 0000 sts DiffNick,r22 |
8039 4ec6 8091 0000 lds r24,IntegralFaktor |
8040 4eca 2091 0000 lds r18,SummeNick |
8041 4ece 3091 0000 lds r19,(SummeNick)+1 |
8042 4ed2 4091 0000 lds r20,(SummeNick)+2 |
8043 4ed6 5091 0000 lds r21,(SummeNick)+3 |
8044 4eda 8823 tst r24 |
8045 4edc 01F0 breq .L494 |
8046 4ede 6CA1 ldd r22,Y+36 |
8047 4ee0 7DA1 ldd r23,Y+37 |
8048 4ee2 6E1B sub r22,r30 |
8049 4ee4 7F0B sbc r23,r31 |
8050 .L494: |
8051 4ee6 CB01 movw r24,r22 |
8052 4ee8 AA27 clr r26 |
8053 4eea 97FD sbrc r25,7 |
8054 4eec A095 com r26 |
8055 4eee BA2F mov r27,r26 |
8056 4ef0 280F add r18,r24 |
8057 4ef2 391F adc r19,r25 |
8058 4ef4 4A1F adc r20,r26 |
8059 4ef6 5B1F adc r21,r27 |
8060 4ef8 2093 0000 sts SummeNick,r18 |
8061 4efc 3093 0000 sts (SummeNick)+1,r19 |
8062 4f00 4093 0000 sts (SummeNick)+2,r20 |
8063 4f04 5093 0000 sts (SummeNick)+3,r21 |
8064 4f08 8091 0000 lds r24,SummeNick |
8065 4f0c 9091 0000 lds r25,(SummeNick)+1 |
8066 4f10 A091 0000 lds r26,(SummeNick)+2 |
8067 4f14 B091 0000 lds r27,(SummeNick)+3 |
8068 4f18 8150 subi r24,lo8(64001) |
8069 4f1a 9A4F sbci r25,hi8(64001) |
8070 4f1c A040 sbci r26,hlo8(64001) |
8071 4f1e B040 sbci r27,hhi8(64001) |
8072 4f20 04F0 brlt .L496 |
8073 4f22 80E0 ldi r24,lo8(64000) |
8074 4f24 9AEF ldi r25,hi8(64000) |
8075 4f26 A0E0 ldi r26,hlo8(64000) |
8076 4f28 B0E0 ldi r27,hhi8(64000) |
8077 4f2a 8093 0000 sts SummeNick,r24 |
8078 4f2e 9093 0000 sts (SummeNick)+1,r25 |
8079 4f32 A093 0000 sts (SummeNick)+2,r26 |
8080 4f36 B093 0000 sts (SummeNick)+3,r27 |
8081 .L496: |
8082 4f3a 8091 0000 lds r24,SummeNick |
8083 4f3e 9091 0000 lds r25,(SummeNick)+1 |
8084 4f42 A091 0000 lds r26,(SummeNick)+2 |
8085 4f46 B091 0000 lds r27,(SummeNick)+3 |
8086 4f4a 8050 subi r24,lo8(-64000) |
8087 4f4c 9640 sbci r25,hi8(-64000) |
8088 4f4e AF4F sbci r26,hlo8(-64000) |
8089 4f50 BF4F sbci r27,hhi8(-64000) |
8090 4f52 04F4 brge .L497 |
8091 4f54 80E0 ldi r24,lo8(-64000) |
8092 4f56 96E0 ldi r25,hi8(-64000) |
8093 4f58 AFEF ldi r26,hlo8(-64000) |
8094 4f5a BFEF ldi r27,hhi8(-64000) |
8095 4f5c 8093 0000 sts SummeNick,r24 |
8096 4f60 9093 0000 sts (SummeNick)+1,r25 |
8097 4f64 A093 0000 sts (SummeNick)+2,r26 |
8098 4f68 B093 0000 sts (SummeNick)+3,r27 |
8099 .L497: |
8100 4f6c 8091 0000 lds r24,EE_Parameter+35 |
8101 4f70 90E0 ldi r25,lo8(0) |
8102 4f72 2091 0000 lds r18,DiffNick |
8103 4f76 3091 0000 lds r19,(DiffNick)+1 |
8104 4f7a AC01 movw r20,r24 |
8105 4f7c 429F mul r20,r18 |
8106 4f7e C001 movw r24,r0 |
8107 4f80 439F mul r20,r19 |
8108 4f82 900D add r25,r0 |
8109 4f84 529F mul r21,r18 |
8110 4f86 900D add r25,r0 |
8111 4f88 1124 clr r1 |
8112 4f8a 68E0 ldi r22,lo8(8) |
8113 4f8c 70E0 ldi r23,hi8(8) |
8114 4f8e 0E94 0000 call __divmodhi4 |
8115 4f92 8B01 movw r16,r22 |
8116 4f94 2091 0000 lds r18,Ki |
8117 4f98 3091 0000 lds r19,(Ki)+1 |
8118 4f9c 4427 clr r20 |
8119 4f9e 37FD sbrc r19,7 |
8120 4fa0 4095 com r20 |
8121 4fa2 542F mov r21,r20 |
8122 4fa4 6091 0000 lds r22,SummeNick |
8123 4fa8 7091 0000 lds r23,(SummeNick)+1 |
8124 4fac 8091 0000 lds r24,(SummeNick)+2 |
8125 4fb0 9091 0000 lds r25,(SummeNick)+3 |
8126 4fb4 0E94 0000 call __divmodsi4 |
8127 4fb8 020F add r16,r18 |
8128 4fba 131F adc r17,r19 |
8129 4fbc C401 movw r24,r8 |
8130 4fbe 97FE sbrs r9,7 |
8131 4fc0 00C0 rjmp .L498 |
8132 4fc2 8827 clr r24 |
8133 4fc4 9927 clr r25 |
8134 4fc6 8819 sub r24,r8 |
8135 4fc8 9909 sbc r25,r9 |
8136 .L498: |
8137 4fca 9595 asr r25 |
8138 4fcc 8795 ror r24 |
8139 4fce 8E0D add r24,r14 |
8140 4fd0 9F1D adc r25,r15 |
8141 4fd2 5C01 movw r10,r24 |
8142 4fd4 CC24 clr r12 |
8143 4fd6 B7FC sbrc r11,7 |
8144 4fd8 C094 com r12 |
8145 4fda DC2C mov r13,r12 |
8146 4fdc 2091 0000 lds r18,Parameter_DynamicStability |
8147 4fe0 30E0 ldi r19,lo8(0) |
8148 4fe2 40E0 ldi r20,lo8(0) |
8149 4fe4 50E0 ldi r21,hi8(0) |
8150 4fe6 C601 movw r24,r12 |
8151 4fe8 B501 movw r22,r10 |
8152 4fea 0E94 0000 call __mulsi3 |
8153 4fee 20E4 ldi r18,lo8(64) |
8154 4ff0 30E0 ldi r19,hi8(64) |
8155 4ff2 40E0 ldi r20,hlo8(64) |
8156 4ff4 50E0 ldi r21,hhi8(64) |
8157 4ff6 0E94 0000 call __divmodsi4 |
8158 4ffa C901 movw r24,r18 |
8159 4ffc 0217 cp r16,r18 |
8160 4ffe 1307 cpc r17,r19 |
8161 5000 04F4 brge .L499 |
8162 5002 9801 movw r18,r16 |
8163 .L499: |
8164 5004 2224 clr r2 |
8165 5006 3324 clr r3 |
8166 5008 281A sub r2,r24 |
8167 500a 390A sbc r3,r25 |
8168 500c 2216 cp r2,r18 |
8169 500e 3306 cpc r3,r19 |
8170 5010 04F4 brge .L500 |
8171 5012 1901 movw r2,r18 |
8172 .L500: |
8173 5014 6091 0000 lds r22,MesswertRoll |
8174 5018 7091 0000 lds r23,(MesswertRoll)+1 |
8175 501c E091 0000 lds r30,StickRoll |
8176 5020 F091 0000 lds r31,(StickRoll)+1 |
8177 5024 6E1B sub r22,r30 |
8178 5026 7F0B sbc r23,r31 |
8179 5028 7093 0000 sts (DiffRoll)+1,r23 |
8180 502c 6093 0000 sts DiffRoll,r22 |
8181 5030 8091 0000 lds r24,IntegralFaktor |
8182 5034 2091 0000 lds r18,SummeRoll |
8183 5038 3091 0000 lds r19,(SummeRoll)+1 |
8184 503c 4091 0000 lds r20,(SummeRoll)+2 |
8185 5040 5091 0000 lds r21,(SummeRoll)+3 |
8186 5044 8823 tst r24 |
8187 5046 01F0 breq .L501 |
8188 5048 6AA1 ldd r22,Y+34 |
8189 504a 7BA1 ldd r23,Y+35 |
8190 504c 6E1B sub r22,r30 |
8191 504e 7F0B sbc r23,r31 |
8192 .L501: |
8193 5050 CB01 movw r24,r22 |
8194 5052 AA27 clr r26 |
8195 5054 97FD sbrc r25,7 |
8196 5056 A095 com r26 |
8197 5058 BA2F mov r27,r26 |
8198 505a 280F add r18,r24 |
8199 505c 391F adc r19,r25 |
8200 505e 4A1F adc r20,r26 |
8201 5060 5B1F adc r21,r27 |
8202 5062 2093 0000 sts SummeRoll,r18 |
8203 5066 3093 0000 sts (SummeRoll)+1,r19 |
8204 506a 4093 0000 sts (SummeRoll)+2,r20 |
8205 506e 5093 0000 sts (SummeRoll)+3,r21 |
8206 5072 8091 0000 lds r24,SummeRoll |
8207 5076 9091 0000 lds r25,(SummeRoll)+1 |
8208 507a A091 0000 lds r26,(SummeRoll)+2 |
8209 507e B091 0000 lds r27,(SummeRoll)+3 |
8210 5082 8150 subi r24,lo8(64001) |
8211 5084 9A4F sbci r25,hi8(64001) |
8212 5086 A040 sbci r26,hlo8(64001) |
8213 5088 B040 sbci r27,hhi8(64001) |
8214 508a 04F0 brlt .L503 |
8215 508c 80E0 ldi r24,lo8(64000) |
8216 508e 9AEF ldi r25,hi8(64000) |
8217 5090 A0E0 ldi r26,hlo8(64000) |
8218 5092 B0E0 ldi r27,hhi8(64000) |
8219 5094 8093 0000 sts SummeRoll,r24 |
8220 5098 9093 0000 sts (SummeRoll)+1,r25 |
8221 509c A093 0000 sts (SummeRoll)+2,r26 |
8222 50a0 B093 0000 sts (SummeRoll)+3,r27 |
8223 .L503: |
8224 50a4 8091 0000 lds r24,SummeRoll |
8225 50a8 9091 0000 lds r25,(SummeRoll)+1 |
8226 50ac A091 0000 lds r26,(SummeRoll)+2 |
8227 50b0 B091 0000 lds r27,(SummeRoll)+3 |
8228 50b4 8050 subi r24,lo8(-64000) |
8229 50b6 9640 sbci r25,hi8(-64000) |
8230 50b8 AF4F sbci r26,hlo8(-64000) |
8231 50ba BF4F sbci r27,hhi8(-64000) |
8232 50bc 04F4 brge .L504 |
8233 50be 80E0 ldi r24,lo8(-64000) |
8234 50c0 96E0 ldi r25,hi8(-64000) |
8235 50c2 AFEF ldi r26,hlo8(-64000) |
8236 50c4 BFEF ldi r27,hhi8(-64000) |
8237 50c6 8093 0000 sts SummeRoll,r24 |
8238 50ca 9093 0000 sts (SummeRoll)+1,r25 |
8239 50ce A093 0000 sts (SummeRoll)+2,r26 |
8240 50d2 B093 0000 sts (SummeRoll)+3,r27 |
8241 .L504: |
8242 50d6 8091 0000 lds r24,EE_Parameter+35 |
8243 50da 90E0 ldi r25,lo8(0) |
8244 50dc 2091 0000 lds r18,DiffRoll |
8245 50e0 3091 0000 lds r19,(DiffRoll)+1 |
8246 50e4 AC01 movw r20,r24 |
8247 50e6 429F mul r20,r18 |
8248 50e8 C001 movw r24,r0 |
8249 50ea 439F mul r20,r19 |
8250 50ec 900D add r25,r0 |
8251 50ee 529F mul r21,r18 |
8252 50f0 900D add r25,r0 |
8253 50f2 1124 clr r1 |
8254 50f4 68E0 ldi r22,lo8(8) |
8255 50f6 70E0 ldi r23,hi8(8) |
8256 50f8 0E94 0000 call __divmodhi4 |
8257 50fc 8B01 movw r16,r22 |
8258 50fe 2091 0000 lds r18,Ki |
8259 5102 3091 0000 lds r19,(Ki)+1 |
8260 5106 4427 clr r20 |
8261 5108 37FD sbrc r19,7 |
8262 510a 4095 com r20 |
8263 510c 542F mov r21,r20 |
8264 510e 6091 0000 lds r22,SummeRoll |
8265 5112 7091 0000 lds r23,(SummeRoll)+1 |
8266 5116 8091 0000 lds r24,(SummeRoll)+2 |
8267 511a 9091 0000 lds r25,(SummeRoll)+3 |
8268 511e 0E94 0000 call __divmodsi4 |
8269 5122 020F add r16,r18 |
8270 5124 131F adc r17,r19 |
8271 5126 2091 0000 lds r18,Parameter_DynamicStability |
8272 512a 30E0 ldi r19,lo8(0) |
8273 512c 40E0 ldi r20,lo8(0) |
8274 512e 50E0 ldi r21,hi8(0) |
8275 5130 C601 movw r24,r12 |
8276 5132 B501 movw r22,r10 |
8277 5134 0E94 0000 call __mulsi3 |
8278 5138 20E4 ldi r18,lo8(64) |
8279 513a 30E0 ldi r19,hi8(64) |
8280 513c 40E0 ldi r20,hlo8(64) |
8281 513e 50E0 ldi r21,hhi8(64) |
8282 5140 0E94 0000 call __divmodsi4 |
8283 5144 A901 movw r20,r18 |
8284 5146 622F mov r22,r18 |
8285 5148 232F mov r18,r19 |
8286 514a 0417 cp r16,r20 |
8287 514c 1507 cpc r17,r21 |
8288 514e 04F4 brge .L505 |
8289 5150 C801 movw r24,r16 |
8290 5152 602F mov r22,r16 |
8291 5154 292F mov r18,r25 |
8292 .L505: |
8293 5156 EE27 clr r30 |
8294 5158 FF27 clr r31 |
8295 515a E41B sub r30,r20 |
8296 515c F50B sbc r31,r21 |
8297 515e 862F mov r24,r22 |
8298 5160 922F mov r25,r18 |
8299 5162 3C01 movw r6,r24 |
8300 5164 6E16 cp r6,r30 |
8301 5166 7F06 cpc r7,r31 |
8302 5168 04F4 brge .L506 |
8303 516a 3F01 movw r6,r30 |
8304 .L506: |
8305 516c F0E0 ldi r31,lo8(Mixer+13) |
8306 516e CF2E mov r12,r31 |
8307 5170 F0E0 ldi r31,hi8(Mixer+13) |
8308 5172 DF2E mov r13,r31 |
8309 5174 E0E0 ldi r30,lo8(Motor+1) |
8310 5176 AE2E mov r10,r30 |
8311 5178 E0E0 ldi r30,hi8(Motor+1) |
8312 517a BE2E mov r11,r30 |
8313 517c 70E0 ldi r23,lo8(tmp_motorwert) |
8314 517e 472E mov r4,r23 |
8315 5180 70E0 ldi r23,hi8(tmp_motorwert) |
8316 5182 572E mov r5,r23 |
8317 5184 B401 movw r22,r8 |
8318 5186 8827 clr r24 |
8319 5188 77FD sbrc r23,7 |
8320 518a 8095 com r24 |
8321 518c 982F mov r25,r24 |
8322 518e 6EAB std Y+54,r22 |
8323 5190 7FAB std Y+55,r23 |
8324 5192 88AF std Y+56,r24 |
8325 5194 99AF std Y+57,r25 |
8326 5196 C301 movw r24,r6 |
8327 5198 AA27 clr r26 |
8328 519a 97FD sbrc r25,7 |
8329 519c A095 com r26 |
8330 519e BA2F mov r27,r26 |
8331 51a0 8AAF std Y+58,r24 |
8332 51a2 9BAF std Y+59,r25 |
8333 51a4 ACAF std Y+60,r26 |
8334 51a6 BDAF std Y+61,r27 |
8335 51a8 9101 movw r18,r2 |
8336 51aa 4427 clr r20 |
8337 51ac 37FD sbrc r19,7 |
8338 51ae 4095 com r20 |
8339 51b0 542F mov r21,r20 |
8340 51b2 2296 adiw r28,62-60 |
8341 51b4 2CAF std Y+60,r18 |
8342 51b6 3DAF std Y+61,r19 |
8343 51b8 4EAF std Y+62,r20 |
8344 51ba 5FAF std Y+63,r21 |
8345 51bc 2297 sbiw r28,62-60 |
8346 51be A701 movw r20,r14 |
8347 51c0 6627 clr r22 |
8348 51c2 57FD sbrc r21,7 |
8349 51c4 6095 com r22 |
8350 51c6 762F mov r23,r22 |
8351 51c8 2696 adiw r28,66-60 |
8352 51ca 4CAF std Y+60,r20 |
8353 51cc 5DAF std Y+61,r21 |
8354 51ce 6EAF std Y+62,r22 |
8355 51d0 7FAF std Y+63,r23 |
8356 51d2 2697 sbiw r28,66-60 |
8357 .L525: |
8358 51d4 D601 movw r26,r12 |
8359 51d6 2C91 ld r18,X |
8360 51d8 1216 cp __zero_reg__,r18 |
8361 51da 04F0 brlt .+2 |
8362 51dc 00C0 rjmp .L507 |
8363 51de 2034 cpi r18,lo8(64) |
8364 51e0 01F4 brne .L508 |
8365 51e2 8701 movw r16,r14 |
8366 51e4 00C0 rjmp .L509 |
8367 .L508: |
8368 51e6 3327 clr r19 |
8369 51e8 27FD sbrc r18,7 |
8370 51ea 3095 com r19 |
8371 51ec 432F mov r20,r19 |
8372 51ee 532F mov r21,r19 |
8373 51f0 2696 adiw r28,66-60 |
8374 51f2 6CAD ldd r22,Y+60 |
8375 51f4 7DAD ldd r23,Y+61 |
8376 51f6 8EAD ldd r24,Y+62 |
8377 51f8 9FAD ldd r25,Y+63 |
8378 51fa 2697 sbiw r28,66-60 |
8379 51fc 0E94 0000 call __mulsi3 |
8380 5200 20E4 ldi r18,lo8(64) |
8381 5202 30E0 ldi r19,hi8(64) |
8382 5204 40E0 ldi r20,hlo8(64) |
8383 5206 50E0 ldi r21,hhi8(64) |
8384 5208 0E94 0000 call __divmodsi4 |
8385 520c 8901 movw r16,r18 |
8386 .L509: |
8387 520e F601 movw r30,r12 |
8388 5210 2181 ldd r18,Z+1 |
8389 5212 2034 cpi r18,lo8(64) |
8390 5214 01F4 brne .L510 |
8391 5216 020D add r16,r2 |
8392 5218 131D adc r17,r3 |
8393 521a 00C0 rjmp .L511 |
8394 .L510: |
8395 521c 203C cpi r18,lo8(-64) |
8396 521e 01F4 brne .L512 |
8397 5220 0219 sub r16,r2 |
8398 5222 1309 sbc r17,r3 |
8399 5224 00C0 rjmp .L511 |
8400 .L512: |
8401 5226 3327 clr r19 |
8402 5228 27FD sbrc r18,7 |
8403 522a 3095 com r19 |
8404 522c 432F mov r20,r19 |
8405 522e 532F mov r21,r19 |
8406 5230 2296 adiw r28,62-60 |
8407 5232 6CAD ldd r22,Y+60 |
8408 5234 7DAD ldd r23,Y+61 |
8409 5236 8EAD ldd r24,Y+62 |
8410 5238 9FAD ldd r25,Y+63 |
8411 523a 2297 sbiw r28,62-60 |
8412 523c 0E94 0000 call __mulsi3 |
8413 5240 20E4 ldi r18,lo8(64) |
8414 5242 30E0 ldi r19,hi8(64) |
8415 5244 40E0 ldi r20,hlo8(64) |
8416 5246 50E0 ldi r21,hhi8(64) |
8417 5248 0E94 0000 call __divmodsi4 |
8418 524c 020F add r16,r18 |
8419 524e 131F adc r17,r19 |
8420 .L511: |
8421 5250 D601 movw r26,r12 |
8422 5252 1296 adiw r26,2 |
8423 5254 2C91 ld r18,X |
8424 5256 2034 cpi r18,lo8(64) |
8425 5258 01F4 brne .L513 |
8426 525a 060D add r16,r6 |
8427 525c 171D adc r17,r7 |
8428 525e 00C0 rjmp .L514 |
8429 .L513: |
8430 5260 203C cpi r18,lo8(-64) |
8431 5262 01F4 brne .L515 |
8432 5264 0619 sub r16,r6 |
8433 5266 1709 sbc r17,r7 |
8434 5268 00C0 rjmp .L514 |
8435 .L515: |
8436 526a 3327 clr r19 |
8437 526c 27FD sbrc r18,7 |
8438 526e 3095 com r19 |
8439 5270 432F mov r20,r19 |
8440 5272 532F mov r21,r19 |
8441 5274 6AAD ldd r22,Y+58 |
8442 5276 7BAD ldd r23,Y+59 |
8443 5278 8CAD ldd r24,Y+60 |
8444 527a 9DAD ldd r25,Y+61 |
8445 527c 0E94 0000 call __mulsi3 |
8446 5280 20E4 ldi r18,lo8(64) |
8447 5282 30E0 ldi r19,hi8(64) |
8448 5284 40E0 ldi r20,hlo8(64) |
8449 5286 50E0 ldi r21,hhi8(64) |
8450 5288 0E94 0000 call __divmodsi4 |
8451 528c 020F add r16,r18 |
8452 528e 131F adc r17,r19 |
8453 .L514: |
8454 5290 F601 movw r30,r12 |
8455 5292 2381 ldd r18,Z+3 |
8456 5294 2034 cpi r18,lo8(64) |
8457 5296 01F4 brne .L516 |
8458 5298 9801 movw r18,r16 |
8459 529a 280D add r18,r8 |
8460 529c 391D adc r19,r9 |
8461 529e 00C0 rjmp .L517 |
8462 .L516: |
8463 52a0 203C cpi r18,lo8(-64) |
8464 52a2 01F4 brne .L518 |
8465 52a4 9801 movw r18,r16 |
8466 52a6 2819 sub r18,r8 |
8467 52a8 3909 sbc r19,r9 |
8468 52aa 00C0 rjmp .L517 |
8469 .L518: |
8470 52ac 3327 clr r19 |
8471 52ae 27FD sbrc r18,7 |
8472 52b0 3095 com r19 |
8473 52b2 432F mov r20,r19 |
8474 52b4 532F mov r21,r19 |
8475 52b6 6EA9 ldd r22,Y+54 |
8476 52b8 7FA9 ldd r23,Y+55 |
8477 52ba 88AD ldd r24,Y+56 |
8478 52bc 99AD ldd r25,Y+57 |
8479 52be 0E94 0000 call __mulsi3 |
8480 52c2 20E4 ldi r18,lo8(64) |
8481 52c4 30E0 ldi r19,hi8(64) |
8482 52c6 40E0 ldi r20,hlo8(64) |
8483 52c8 50E0 ldi r21,hhi8(64) |
8484 52ca 0E94 0000 call __divmodsi4 |
8485 52ce 200F add r18,r16 |
8486 52d0 311F adc r19,r17 |
8487 .L517: |
8488 52d2 D201 movw r26,r4 |
8489 52d4 8D91 ld r24,X+ |
8490 52d6 9C91 ld r25,X |
8491 52d8 8217 cp r24,r18 |
8492 52da 9307 cpc r25,r19 |
8493 52dc 04F4 brge .L519 |
8494 52de 820F add r24,r18 |
8495 52e0 931F adc r25,r19 |
8496 52e2 62E0 ldi r22,lo8(2) |
8497 52e4 70E0 ldi r23,hi8(2) |
8498 52e6 0E94 0000 call __divmodhi4 |
8499 52ea 9B01 movw r18,r22 |
8500 52ec 00C0 rjmp .L520 |
8501 .L519: |
8502 52ee 6091 0000 lds r22,Parameter_UserParam7 |
8503 52f2 6230 cpi r22,lo8(2) |
8504 52f4 00F4 brsh .L521 |
8505 52f6 220F lsl r18 |
8506 52f8 331F rol r19 |
8507 52fa 281B sub r18,r24 |
8508 52fc 390B sbc r19,r25 |
8509 52fe 00C0 rjmp .L520 |
8510 .L521: |
8511 5300 821B sub r24,r18 |
8512 5302 930B sbc r25,r19 |
8513 5304 70E0 ldi r23,lo8(0) |
8514 5306 0E94 0000 call __divmodhi4 |
8515 530a 260F add r18,r22 |
8516 530c 371F adc r19,r23 |
8517 .L520: |
8518 530e 8091 0000 lds r24,MIN_GAS |
8519 5312 E82F mov r30,r24 |
8520 5314 F0E0 ldi r31,lo8(0) |
8521 5316 EE0F lsl r30 |
8522 5318 FF1F rol r31 |
8523 531a EE0F lsl r30 |
8524 531c FF1F rol r31 |
8525 531e E217 cp r30,r18 |
8526 5320 F307 cpc r31,r19 |
8527 5322 04F4 brge .L522 |
8528 5324 8091 0000 lds r24,MAX_GAS |
8529 5328 682F mov r22,r24 |
8530 532a 70E0 ldi r23,lo8(0) |
8531 532c 660F lsl r22 |
8532 532e 771F rol r23 |
8533 5330 660F lsl r22 |
8534 5332 771F rol r23 |
8535 5334 F901 movw r30,r18 |
8536 5336 6217 cp r22,r18 |
8537 5338 7307 cpc r23,r19 |
8538 533a 04F4 brge .L522 |
8539 533c FB01 movw r30,r22 |
8540 .L522: |
8541 533e CF01 movw r24,r30 |
8542 5340 64E0 ldi r22,lo8(4) |
8543 5342 70E0 ldi r23,hi8(4) |
8544 5344 0E94 0000 call __divmodhi4 |
8545 5348 D501 movw r26,r10 |
8546 534a 6C93 st X,r22 |
8547 534c CF01 movw r24,r30 |
8548 534e 64E0 ldi r22,lo8(4) |
8549 5350 70E0 ldi r23,hi8(4) |
8550 5352 0E94 0000 call __divmodhi4 |
8551 5356 880F lsl r24 |
8552 5358 D501 movw r26,r10 |
8553 535a 1196 adiw r26,1 |
8554 535c 8C93 st X,r24 |
8555 535e D201 movw r26,r4 |
8556 5360 ED93 st X+,r30 |
8557 5362 FC93 st X,r31 |
8558 5364 00C0 rjmp .L524 |
8559 .L507: |
8560 5366 F501 movw r30,r10 |
8561 5368 1082 st Z,__zero_reg__ |
8562 536a 1182 std Z+1,__zero_reg__ |
8563 .L524: |
8564 536c 24E0 ldi r18,lo8(4) |
8565 536e 30E0 ldi r19,hi8(4) |
8566 5370 C20E add r12,r18 |
8567 5372 D31E adc r13,r19 |
8568 5374 48E0 ldi r20,lo8(8) |
8569 5376 50E0 ldi r21,hi8(8) |
8570 5378 A40E add r10,r20 |
8571 537a B51E adc r11,r21 |
8572 537c 62E0 ldi r22,lo8(2) |
8573 537e 70E0 ldi r23,hi8(2) |
8574 5380 460E add r4,r22 |
8575 5382 571E adc r5,r23 |
8576 5384 70E0 ldi r23,lo8(Mixer+61) |
8577 5386 C716 cp r12,r23 |
8578 5388 70E0 ldi r23,hi8(Mixer+61) |
8579 538a D706 cpc r13,r23 |
8580 538c 01F0 breq .+2 |
8581 538e 00C0 rjmp .L525 |
8582 /* epilogue start */ |
8583 5390 CB5B subi r28,lo8(-(69)) |
8584 5392 DF4F sbci r29,hi8(-(69)) |
8585 5394 E2E1 ldi r30, lo8(18) |
8586 5396 0C94 0000 jmp __epilogue_restores__ + ((18 - 18) * 2) |
8588 .global BaroExpandActive |
8589 .global BaroExpandActive |
8590 .section .bss |
8593 BaroExpandActive: |
8594 0000 0000 .skip 2,0 |
8595 .global AdNeutralNick |
8596 .global AdNeutralNick |
8599 AdNeutralNick: |
8600 0002 0000 .skip 2,0 |
8601 .global AdNeutralRoll |
8602 .global AdNeutralRoll |
8605 AdNeutralRoll: |
8606 0004 0000 .skip 2,0 |
8607 .global AdNeutralGier |
8608 .global AdNeutralGier |
8611 AdNeutralGier: |
8612 0006 0000 .skip 2,0 |
8613 .global StartNeutralRoll |
8614 .global StartNeutralRoll |
8617 StartNeutralRoll: |
8618 0008 0000 .skip 2,0 |
8619 .global StartNeutralNick |
8620 .global StartNeutralNick |
8623 StartNeutralNick: |
8624 000a 0000 .skip 2,0 |
8625 .global NeutralAccX |
8626 .global NeutralAccX |
8629 NeutralAccX: |
8630 000c 0000 .skip 2,0 |
8631 .global NeutralAccY |
8632 .global NeutralAccY |
8635 NeutralAccY: |
8636 000e 0000 .skip 2,0 |
8637 .global NaviCntAcc |
8638 .global NaviCntAcc |
8641 NaviCntAcc: |
8642 0010 0000 .skip 2,0 |
8643 .global NeutralAccZ |
8644 .global NeutralAccZ |
8647 NeutralAccZ: |
8648 0012 0000 .skip 2,0 |
8649 .global ControlHeading |
8650 .global ControlHeading |
8653 ControlHeading: |
8654 0014 00 .skip 1,0 |
8655 .global IntegralNick |
8656 .global IntegralNick |
8659 IntegralNick: |
8660 0015 0000 0000 .skip 4,0 |
8661 .global IntegralNick2 |
8662 .global IntegralNick2 |
8665 IntegralNick2: |
8666 0019 0000 0000 .skip 4,0 |
8667 .global IntegralRoll |
8668 .global IntegralRoll |
8671 IntegralRoll: |
8672 001d 0000 0000 .skip 4,0 |
8673 .global IntegralRoll2 |
8674 .global IntegralRoll2 |
8677 IntegralRoll2: |
8678 0021 0000 0000 .skip 4,0 |
8679 .global IntegralAccNick |
8680 .global IntegralAccNick |
8683 IntegralAccNick: |
8684 0025 0000 0000 .skip 4,0 |
8685 .global IntegralAccRoll |
8686 .global IntegralAccRoll |
8689 IntegralAccRoll: |
8690 0029 0000 0000 .skip 4,0 |
8691 .global IntegralAccZ |
8692 .global IntegralAccZ |
8695 IntegralAccZ: |
8696 002d 0000 0000 .skip 4,0 |
8697 .global Integral_Gier |
8698 .global Integral_Gier |
8701 Integral_Gier: |
8702 0031 0000 0000 .skip 4,0 |
8703 .global Mess_IntegralNick |
8704 .global Mess_IntegralNick |
8707 Mess_IntegralNick: |
8708 0035 0000 0000 .skip 4,0 |
8709 .global Mess_IntegralNick2 |
8710 .global Mess_IntegralNick2 |
8713 Mess_IntegralNick2: |
8714 0039 0000 0000 .skip 4,0 |
8715 .global Mess_IntegralRoll |
8716 .global Mess_IntegralRoll |
8719 Mess_IntegralRoll: |
8720 003d 0000 0000 .skip 4,0 |
8721 .global Mess_IntegralRoll2 |
8722 .global Mess_IntegralRoll2 |
8725 Mess_IntegralRoll2: |
8726 0041 0000 0000 .skip 4,0 |
8727 .global Mess_Integral_Gier |
8728 .global Mess_Integral_Gier |
8731 Mess_Integral_Gier: |
8732 0045 0000 0000 .skip 4,0 |
8733 .global Mess_Integral_Gier2 |
8734 .global Mess_Integral_Gier2 |
8737 Mess_Integral_Gier2: |
8738 0049 0000 0000 .skip 4,0 |
8739 .global SummeNick |
8740 .global SummeNick |
8743 SummeNick: |
8744 004d 0000 0000 .skip 4,0 |
8745 .global SummeRoll |
8746 .global SummeRoll |
8749 SummeRoll: |
8750 0051 0000 0000 .skip 4,0 |
8751 .global Mess_Integral_Hoch |
8752 .global Mess_Integral_Hoch |
8755 Mess_Integral_Hoch: |
8756 0055 0000 0000 .skip 4,0 |
8757 .global KompassValue |
8758 .global KompassValue |
8761 KompassValue: |
8762 0059 0000 .skip 2,0 |
8763 .global KompassStartwert |
8764 .global KompassStartwert |
8767 KompassStartwert: |
8768 005b 0000 .skip 2,0 |
8769 .global KompassRichtung |
8770 .global KompassRichtung |
8773 KompassRichtung: |
8774 005d 0000 .skip 2,0 |
8775 .global KompassSignalSchlecht |
8776 .data |
8779 KompassSignalSchlecht: |
8780 0000 F401 .word 500 |
8781 .global HoehenReglerAktiv |
8782 .global HoehenReglerAktiv |
8783 .section .bss |
8786 HoehenReglerAktiv: |
8787 005f 00 .skip 1,0 |
8788 .global TrichterFlug |
8789 .global TrichterFlug |
8792 TrichterFlug: |
8793 0060 00 .skip 1,0 |
8794 .global Umschlag180Nick |
8795 .data |
8798 Umschlag180Nick: |
8799 0002 90 .byte -112 |
8800 0003 D0 .byte -48 |
8801 0004 03 .byte 3 |
8802 0005 00 .byte 0 |
8803 .global Umschlag180Roll |
8806 Umschlag180Roll: |
8807 0006 90 .byte -112 |
8808 0007 D0 .byte -48 |
8809 0008 03 .byte 3 |
8810 0009 00 .byte 0 |
8811 .global GierGyroFehler |
8812 .global GierGyroFehler |
8813 .section .bss |
8816 GierGyroFehler: |
8817 0061 0000 .skip 2,0 |
8818 .global Poti |
8819 .global Poti |
8822 Poti: |
8823 0063 0000 0000 .skip 9,0 |
8823 0000 0000 |
8823 00 |
8824 .global SenderOkay |
8825 .global SenderOkay |
8828 SenderOkay: |
8829 006c 00 .skip 1,0 |
8830 .global StickNick |
8831 .global StickNick |
8834 StickNick: |
8835 006d 0000 .skip 2,0 |
8836 .global StickRoll |
8837 .global StickRoll |
8840 StickRoll: |
8841 006f 0000 .skip 2,0 |
8842 .global StickGier |
8843 .global StickGier |
8846 StickGier: |
8847 0071 0000 .skip 2,0 |
8848 .global StickGas |
8849 .global StickGas |
8852 StickGas: |
8853 0073 0000 .skip 2,0 |
8854 .global MotorenEin |
8855 .global MotorenEin |
8858 MotorenEin: |
8859 0075 00 .skip 1,0 |
8860 .global StartTrigger |
8861 .global StartTrigger |
8864 StartTrigger: |
8865 0076 00 .skip 1,0 |
8866 .global HoehenWert |
8867 .global HoehenWert |
8870 HoehenWert: |
8871 0077 0000 0000 .skip 4,0 |
8872 .global SollHoehe |
8873 .global SollHoehe |
8876 SollHoehe: |
8877 007b 0000 0000 .skip 4,0 |
8878 .global LageKorrekturRoll |
8879 .global LageKorrekturRoll |
8882 LageKorrekturRoll: |
8883 007f 0000 .skip 2,0 |
8884 .global LageKorrekturNick |
8885 .global LageKorrekturNick |
8888 LageKorrekturNick: |
8889 0081 0000 .skip 2,0 |
8890 .global HoverGas |
8891 .global HoverGas |
8894 HoverGas: |
8895 0083 0000 .skip 2,0 |
8896 .global Ki |
8897 .data |
8900 Ki: |
8901 000a 3801 .word 312 |
8902 .global Looping_Nick |
8903 .global Looping_Nick |
8904 .section .bss |
8907 Looping_Nick: |
8908 0085 00 .skip 1,0 |
8909 .global Looping_Roll |
8910 .global Looping_Roll |
8913 Looping_Roll: |
8914 0086 00 .skip 1,0 |
8915 .global Looping_Links |
8916 .global Looping_Links |
8919 Looping_Links: |
8920 0087 00 .skip 1,0 |
8921 .global Looping_Rechts |
8922 .global Looping_Rechts |
8925 Looping_Rechts: |
8926 0088 00 .skip 1,0 |
8927 .global Looping_Unten |
8928 .global Looping_Unten |
8931 Looping_Unten: |
8932 0089 00 .skip 1,0 |
8933 .global Looping_Oben |
8934 .global Looping_Oben |
8937 Looping_Oben: |
8938 008a 00 .skip 1,0 |
8939 .global Parameter_Luftdruck_D |
8940 .data |
8943 Parameter_Luftdruck_D: |
8944 000c 30 .byte 48 |
8945 .global Parameter_MaxHoehe |
8948 Parameter_MaxHoehe: |
8949 000d FB .byte -5 |
8950 .global Parameter_Hoehe_P |
8953 Parameter_Hoehe_P: |
8954 000e 10 .byte 16 |
8955 .global Parameter_Hoehe_ACC_Wirkung |
8958 Parameter_Hoehe_ACC_Wirkung: |
8959 000f 3A .byte 58 |
8960 .global Parameter_KompassWirkung |
8963 Parameter_KompassWirkung: |
8964 0010 40 .byte 64 |
8965 .global Parameter_Hoehe_GPS_Z |
8968 Parameter_Hoehe_GPS_Z: |
8969 0011 40 .byte 64 |
8970 .global Parameter_Gyro_D |
8973 Parameter_Gyro_D: |
8974 0012 08 .byte 8 |
8975 .global Parameter_Gyro_P |
8978 Parameter_Gyro_P: |
8979 0013 96 .byte -106 |
8980 .global Parameter_Gyro_I |
8983 Parameter_Gyro_I: |
8984 0014 96 .byte -106 |
8985 .global Parameter_Gyro_Gier_P |
8988 Parameter_Gyro_Gier_P: |
8989 0015 96 .byte -106 |
8990 .global Parameter_Gyro_Gier_I |
8993 Parameter_Gyro_Gier_I: |
8994 0016 96 .byte -106 |
8995 .global Parameter_Gier_P |
8998 Parameter_Gier_P: |
8999 0017 02 .byte 2 |
9000 .global Parameter_I_Faktor |
9003 Parameter_I_Faktor: |
9004 0018 0A .byte 10 |
9005 .global Parameter_UserParam1 |
9006 .global Parameter_UserParam1 |
9007 .section .bss |
9010 Parameter_UserParam1: |
9011 008b 00 .skip 1,0 |
9012 .global Parameter_UserParam2 |
9013 .global Parameter_UserParam2 |
9016 Parameter_UserParam2: |
9017 008c 00 .skip 1,0 |
9018 .global Parameter_UserParam3 |
9019 .global Parameter_UserParam3 |
9022 Parameter_UserParam3: |
9023 008d 00 .skip 1,0 |
9024 .global Parameter_UserParam4 |
9025 .global Parameter_UserParam4 |
9028 Parameter_UserParam4: |
9029 008e 00 .skip 1,0 |
9030 .global Parameter_UserParam5 |
9031 .global Parameter_UserParam5 |
9034 Parameter_UserParam5: |
9035 008f 00 .skip 1,0 |
9036 .global Parameter_UserParam6 |
9037 .global Parameter_UserParam6 |
9040 Parameter_UserParam6: |
9041 0090 00 .skip 1,0 |
9042 .global Parameter_UserParam7 |
9043 .global Parameter_UserParam7 |
9046 Parameter_UserParam7: |
9047 0091 00 .skip 1,0 |
9048 .global Parameter_UserParam8 |
9049 .global Parameter_UserParam8 |
9052 Parameter_UserParam8: |
9053 0092 00 .skip 1,0 |
9054 .global Parameter_ServoNickControl |
9055 .data |
9058 Parameter_ServoNickControl: |
9059 0019 64 .byte 100 |
9060 .global Parameter_ServoRollControl |
9063 Parameter_ServoRollControl: |
9064 001a 64 .byte 100 |
9065 .global Parameter_LoopGasLimit |
9068 Parameter_LoopGasLimit: |
9069 001b 46 .byte 70 |
9070 .global Parameter_AchsKopplung1 |
9073 Parameter_AchsKopplung1: |
9074 001c 5A .byte 90 |
9075 .global Parameter_AchsKopplung2 |
9078 Parameter_AchsKopplung2: |
9079 001d 41 .byte 65 |
9080 .global Parameter_CouplingYawCorrection |
9083 Parameter_CouplingYawCorrection: |
9084 001e 40 .byte 64 |
9085 .global Parameter_DynamicStability |
9088 Parameter_DynamicStability: |
9089 001f 64 .byte 100 |
9090 .global CareFree |
9091 .global CareFree |
9092 .section .bss |
9095 CareFree: |
9096 0093 00 .skip 1,0 |
9097 .global ExternStickNick |
9098 .global ExternStickNick |
9101 ExternStickNick: |
9102 0094 0000 .skip 2,0 |
9103 .global ExternStickRoll |
9104 .global ExternStickRoll |
9107 ExternStickRoll: |
9108 0096 0000 .skip 2,0 |
9109 .global ExternStickGier |
9110 .global ExternStickGier |
9113 ExternStickGier: |
9114 0098 0000 .skip 2,0 |
9115 .global ExternHoehenValue |
9116 .data |
9119 ExternHoehenValue: |
9120 0020 ECFF .word -20 |
9121 .global MaxStickNick |
9122 .global MaxStickNick |
9123 .section .bss |
9126 MaxStickNick: |
9127 009a 0000 .skip 2,0 |
9128 .global MaxStickRoll |
9129 .global MaxStickRoll |
9132 MaxStickRoll: |
9133 009c 0000 .skip 2,0 |
9134 .global modell_fliegt |
9135 .global modell_fliegt |
9138 modell_fliegt: |
9139 009e 0000 .skip 2,0 |
9140 .global FCFlags |
9141 .global FCFlags |
9144 FCFlags: |
9145 00a0 00 .skip 1,0 |
9146 .global GIER_GRAD_FAKTOR |
9147 .data |
9150 GIER_GRAD_FAKTOR: |
9151 0022 0B .byte 11 |
9152 0023 05 .byte 5 |
9153 0024 00 .byte 0 |
9154 0025 00 .byte 0 |
9155 .global VarioCharacter |
9158 VarioCharacter: |
9159 0026 20 .byte 32 |
9160 .lcomm HeightTrimmingFlag.3091,1 |
9161 .lcomm BaroAtLowerLimit.3089,1 |
9162 .lcomm BaroAtUpperLimit.3088,1 |
9165 delay.3087: |
9166 0027 64 .byte 100 |
9167 .lcomm HoverGasFilter.3086,4 |
9170 HoverGasMax.3085: |
9171 0028 FF03 .word 1023 |
9172 .lcomm HoverGasMin.3084,2 |
9175 StickGasHover.3083: |
9176 002a 7800 .word 120 |
9177 .lcomm FilterHCGas.3082,2 |
9178 .lcomm HeightTrimming.3081,2 |
9179 .lcomm MittelIntegralRoll_Alt.3072,4 |
9180 .lcomm MittelIntegralNick_Alt.3071,4 |
9181 .lcomm last_r_n.3070,1 |
9182 .lcomm last_r_p.3069,1 |
9183 .lcomm last_n_n.3068,1 |
9184 .lcomm last_n_p.3067,1 |
9185 .lcomm cnt.3066,2 |
9186 .lcomm stick_roll.3060,2 |
9187 .lcomm stick_nick.3059,2 |
9188 .lcomm ausgleichRoll.3054,4 |
9189 .lcomm ausgleichNick.3053,4 |
9190 .lcomm NeueKompassRichtungMerken.3052,1 |
9191 .lcomm calibration_done.3051,1 |
9192 .lcomm delay_ausschalten.3050,1 |
9193 .lcomm delay_einschalten.3049,1 |
9194 .lcomm delay_neutral.3048,1 |
9195 .lcomm RcLostTimer.3047,2 |
9196 .lcomm IntegralFehlerRoll.3046,4 |
9197 .lcomm IntegralFehlerNick.3045,4 |
9198 .lcomm tmp_long2.3044,4 |
9199 .lcomm tmp_long.3043,4 |
9200 .lcomm sollGier.3042,4 |
9203 C.354.3251: |
9204 002c 00 .byte 0 |
9205 002d 02 .byte 2 |
9206 002e 04 .byte 4 |
9207 002f 06 .byte 6 |
9208 0030 07 .byte 7 |
9209 0031 08 .byte 8 |
9210 0032 08 .byte 8 |
9211 0033 08 .byte 8 |
9212 0034 07 .byte 7 |
9213 0035 06 .byte 6 |
9214 0036 04 .byte 4 |
9215 0037 02 .byte 2 |
9216 0038 00 .byte 0 |
9217 0039 FE .byte -2 |
9218 003a FC .byte -4 |
9219 003b FA .byte -6 |
9220 003c F9 .byte -7 |
9221 003d F8 .byte -8 |
9222 003e F8 .byte -8 |
9223 003f F8 .byte -8 |
9224 0040 F9 .byte -7 |
9225 0041 FA .byte -6 |
9226 0042 FC .byte -4 |
9227 0043 FE .byte -2 |
9228 0044 00 .byte 0 |
9229 0045 02 .byte 2 |
9230 0046 04 .byte 4 |
9231 0047 06 .byte 6 |
9232 0048 07 .byte 7 |
9233 0049 08 .byte 8 |
9234 004a 08 .byte 8 |
9235 .lcomm d2Nick.2607,2 |
9236 .lcomm d2Roll.2606,2 |
9237 .lcomm oldRoll.2605,2 |
9238 .lcomm oldNick.2604,2 |
9239 .lcomm tmpl4.2603,4 |
9240 .lcomm tmpl3.2602,4 |
9241 .lcomm tmpl2.2601,4 |
9242 .lcomm tmpl.2600,4 |
9243 .section .progmem.data,"a",@progbits |
9246 __c.2485: |
9247 0000 0A0D 4143 .string "\n\rACC not calibrated!\r\n" |
9247 4320 6E6F |
9247 7420 6361 |
9247 6C69 6272 |
9247 6174 6564 |
9248 .comm TrimNick,2,1 |
9249 .comm TrimRoll,2,1 |
9250 .comm ErsatzKompass,4,1 |
9251 .comm ErsatzKompassInGrad,2,1 |
9252 .comm MesswertNick,2,1 |
9253 .comm MesswertRoll,2,1 |
9254 .comm MesswertGier,2,1 |
9255 .comm Mittelwert_AccNick,2,1 |
9256 .comm Mittelwert_AccRoll,2,1 |
9257 .comm NaviAccNick,2,1 |
9258 .comm NaviAccRoll,2,1 |
9259 .comm h,1,1 |
9260 .comm m,1,1 |
9261 .comm s,1,1 |
9262 .comm DiffNick,2,1 |
9263 .comm DiffRoll,2,1 |
9264 .comm Parameter_Servo3,1,1 |
9265 .comm Parameter_Servo4,1,1 |
9266 .comm Parameter_Servo5,1,1 |
9267 .comm Parameter_J16Bitmask,1,1 |
9268 .comm Parameter_J16Timing,1,1 |
9269 .comm Parameter_J17Bitmask,1,1 |
9270 .comm Parameter_J17Timing,1,1 |
9271 .comm MesswertGierBias,2,1 |
9272 .comm RohMesswertNick,2,1 |
9273 .comm RohMesswertRoll,2,1 |
9274 .comm MittelIntegralNick,4,1 |
9275 .comm MittelIntegralRoll,4,1 |
9276 .comm MittelIntegralNick2,4,1 |
9277 .comm MittelIntegralRoll2,4,1 |
9278 .comm MAX_GAS,1,1 |
9279 .comm MIN_GAS,1,1 |
9280 .comm GyroFaktor,1,1 |
9281 .comm GyroFaktorGier,1,1 |
9282 .comm IntegralFaktor,1,1 |
9283 .comm IntegralFaktorGier,1,1 |
9284 .comm Parameter_NaviGpsModeControl,1,1 |
9285 .comm Parameter_NaviGpsGain,1,1 |
9286 .comm Parameter_NaviGpsP,1,1 |
9287 .comm Parameter_NaviGpsI,1,1 |
9288 .comm Parameter_NaviGpsD,1,1 |
9289 .comm Parameter_NaviGpsACC,1,1 |
9290 .comm Parameter_NaviOperatingRadius,1,1 |
9291 .comm Parameter_NaviWindCorrection,1,1 |
9292 .comm Parameter_NaviSpeedCompensation,1,1 |
9293 .comm Parameter_ExternalControl,1,1 |
9294 .comm KopplungsteilNickRoll,2,1 |
9295 .comm KopplungsteilRollNick,2,1 |
9296 .comm tmp_motorwert,24,1 |
9297 .global __do_copy_data |
9298 .global __do_clear_bss |
8 .global __do_copy_data |
9 .global __do_clear_bss |
10 .global VarioCharacter |
11 .data |
14 VarioCharacter: |
15 0000 20 .byte 32 |
16 .global GIER_GRAD_FAKTOR |
19 GIER_GRAD_FAKTOR: |
20 0001 0B05 0000 .long 1291 |
21 .global FCFlags |
22 .global FCFlags |
23 .section .bss |
26 FCFlags: |
27 0000 00 .skip 1,0 |
28 .global modell_fliegt |
29 .global modell_fliegt |
32 modell_fliegt: |
33 0001 0000 .skip 2,0 |
34 .global MaxStickRoll |
35 .global MaxStickRoll |
38 MaxStickRoll: |
39 0003 0000 .skip 2,0 |
40 .global MaxStickNick |
41 .global MaxStickNick |
44 MaxStickNick: |
45 0005 0000 .skip 2,0 |
46 .global ExternHoehenValue |
47 .data |
50 ExternHoehenValue: |
51 0005 ECFF .word -20 |
52 .global ExternStickGier |
53 .global ExternStickGier |
54 .section .bss |
57 ExternStickGier: |
58 0007 0000 .skip 2,0 |
59 .global ExternStickRoll |
60 .global ExternStickRoll |
63 ExternStickRoll: |
64 0009 0000 .skip 2,0 |
65 .global ExternStickNick |
66 .global ExternStickNick |
69 ExternStickNick: |
70 000b 0000 .skip 2,0 |
71 .global CareFree |
72 .global CareFree |
75 CareFree: |
76 000d 00 .skip 1,0 |
77 .global Parameter_DynamicStability |
78 .data |
81 Parameter_DynamicStability: |
82 0007 64 .byte 100 |
83 .global Parameter_CouplingYawCorrection |
86 Parameter_CouplingYawCorrection: |
87 0008 40 .byte 64 |
88 .global Parameter_AchsKopplung2 |
91 Parameter_AchsKopplung2: |
92 0009 41 .byte 65 |
93 .global Parameter_AchsKopplung1 |
96 Parameter_AchsKopplung1: |
97 000a 5A .byte 90 |
98 .global Parameter_LoopGasLimit |
101 Parameter_LoopGasLimit: |
102 000b 46 .byte 70 |
103 .global Parameter_ServoRollControl |
106 Parameter_ServoRollControl: |
107 000c 64 .byte 100 |
108 .global Parameter_ServoNickControl |
111 Parameter_ServoNickControl: |
112 000d 64 .byte 100 |
113 .global Parameter_UserParam8 |
114 .global Parameter_UserParam8 |
115 .section .bss |
118 Parameter_UserParam8: |
119 000e 00 .skip 1,0 |
120 .global Parameter_UserParam7 |
121 .global Parameter_UserParam7 |
124 Parameter_UserParam7: |
125 000f 00 .skip 1,0 |
126 .global Parameter_UserParam6 |
127 .global Parameter_UserParam6 |
130 Parameter_UserParam6: |
131 0010 00 .skip 1,0 |
132 .global Parameter_UserParam5 |
133 .global Parameter_UserParam5 |
136 Parameter_UserParam5: |
137 0011 00 .skip 1,0 |
138 .global Parameter_UserParam4 |
139 .global Parameter_UserParam4 |
142 Parameter_UserParam4: |
143 0012 00 .skip 1,0 |
144 .global Parameter_UserParam3 |
145 .global Parameter_UserParam3 |
148 Parameter_UserParam3: |
149 0013 00 .skip 1,0 |
150 .global Parameter_UserParam2 |
151 .global Parameter_UserParam2 |
154 Parameter_UserParam2: |
155 0014 00 .skip 1,0 |
156 .global Parameter_UserParam1 |
157 .global Parameter_UserParam1 |
160 Parameter_UserParam1: |
161 0015 00 .skip 1,0 |
162 .global Parameter_I_Faktor |
163 .data |
166 Parameter_I_Faktor: |
167 000e 0A .byte 10 |
168 .global Parameter_Gier_P |
171 Parameter_Gier_P: |
172 000f 02 .byte 2 |
173 .global Parameter_Gyro_Gier_I |
176 Parameter_Gyro_Gier_I: |
177 0010 96 .byte -106 |
178 .global Parameter_Gyro_Gier_P |
181 Parameter_Gyro_Gier_P: |
182 0011 96 .byte -106 |
183 .global Parameter_Gyro_I |
186 Parameter_Gyro_I: |
187 0012 96 .byte -106 |
188 .global Parameter_Gyro_P |
191 Parameter_Gyro_P: |
192 0013 96 .byte -106 |
193 .global Parameter_Gyro_D |
196 Parameter_Gyro_D: |
197 0014 08 .byte 8 |
198 .global Parameter_Hoehe_GPS_Z |
201 Parameter_Hoehe_GPS_Z: |
202 0015 40 .byte 64 |
203 .global Parameter_KompassWirkung |
206 Parameter_KompassWirkung: |
207 0016 40 .byte 64 |
208 .global Parameter_Hoehe_ACC_Wirkung |
211 Parameter_Hoehe_ACC_Wirkung: |
212 0017 3A .byte 58 |
213 .global Parameter_Hoehe_P |
216 Parameter_Hoehe_P: |
217 0018 10 .byte 16 |
218 .global Parameter_MaxHoehe |
221 Parameter_MaxHoehe: |
222 0019 FB .byte -5 |
223 .global Parameter_Luftdruck_D |
226 Parameter_Luftdruck_D: |
227 001a 30 .byte 48 |
228 .global Looping_Oben |
229 .global Looping_Oben |
230 .section .bss |
233 Looping_Oben: |
234 0016 00 .skip 1,0 |
235 .global Looping_Unten |
236 .global Looping_Unten |
239 Looping_Unten: |
240 0017 00 .skip 1,0 |
241 .global Looping_Rechts |
242 .global Looping_Rechts |
245 Looping_Rechts: |
246 0018 00 .skip 1,0 |
247 .global Looping_Links |
248 .global Looping_Links |
251 Looping_Links: |
252 0019 00 .skip 1,0 |
253 .global Looping_Roll |
254 .global Looping_Roll |
257 Looping_Roll: |
258 001a 00 .skip 1,0 |
259 .global Looping_Nick |
260 .global Looping_Nick |
263 Looping_Nick: |
264 001b 00 .skip 1,0 |
265 .global Ki |
266 .data |
269 Ki: |
270 001b 3801 .word 312 |
271 .global HoverGas |
272 .global HoverGas |
273 .section .bss |
276 HoverGas: |
277 001c 0000 .skip 2,0 |
278 .global LageKorrekturNick |
279 .global LageKorrekturNick |
282 LageKorrekturNick: |
283 001e 0000 .skip 2,0 |
284 .global LageKorrekturRoll |
285 .global LageKorrekturRoll |
288 LageKorrekturRoll: |
289 0020 0000 .skip 2,0 |
290 .global SollHoehe |
291 .global SollHoehe |
294 SollHoehe: |
295 0022 0000 0000 .skip 4,0 |
296 .global HoehenWert |
297 .global HoehenWert |
300 HoehenWert: |
301 0026 0000 0000 .skip 4,0 |
302 .global StartTrigger |
303 .global StartTrigger |
306 StartTrigger: |
307 002a 00 .skip 1,0 |
308 .global MotorenEin |
309 .global MotorenEin |
312 MotorenEin: |
313 002b 00 .skip 1,0 |
314 .global StickGas |
315 .global StickGas |
318 StickGas: |
319 002c 0000 .skip 2,0 |
320 .global StickGier |
321 .global StickGier |
324 StickGier: |
325 002e 0000 .skip 2,0 |
326 .global StickRoll |
327 .global StickRoll |
330 StickRoll: |
331 0030 0000 .skip 2,0 |
332 .global StickNick |
333 .global StickNick |
336 StickNick: |
337 0032 0000 .skip 2,0 |
338 .global SenderOkay |
339 .global SenderOkay |
342 SenderOkay: |
343 0034 00 .skip 1,0 |
344 .global Poti |
345 .global Poti |
348 Poti: |
349 0035 0000 0000 .skip 9,0 |
349 0000 0000 |
349 00 |
350 .global GierGyroFehler |
351 .global GierGyroFehler |
354 GierGyroFehler: |
355 003e 0000 .skip 2,0 |
356 .global Umschlag180Roll |
357 .data |
360 Umschlag180Roll: |
361 001d 90D0 0300 .long 250000 |
362 .global Umschlag180Nick |
365 Umschlag180Nick: |
366 0021 90D0 0300 .long 250000 |
367 .global TrichterFlug |
368 .global TrichterFlug |
369 .section .bss |
372 TrichterFlug: |
373 0040 00 .skip 1,0 |
374 .global HoehenReglerAktiv |
375 .global HoehenReglerAktiv |
378 HoehenReglerAktiv: |
379 0041 00 .skip 1,0 |
380 .global KompassSignalSchlecht |
381 .data |
384 KompassSignalSchlecht: |
385 0025 F401 .word 500 |
386 .global KompassRichtung |
387 .global KompassRichtung |
388 .section .bss |
391 KompassRichtung: |
392 0042 0000 .skip 2,0 |
393 .global KompassStartwert |
394 .global KompassStartwert |
397 KompassStartwert: |
398 0044 0000 .skip 2,0 |
399 .global KompassValue |
400 .global KompassValue |
403 KompassValue: |
404 0046 0000 .skip 2,0 |
405 .global Mess_Integral_Hoch |
406 .global Mess_Integral_Hoch |
409 Mess_Integral_Hoch: |
410 0048 0000 0000 .skip 4,0 |
411 .global SummeRoll |
412 .global SummeRoll |
415 SummeRoll: |
416 004c 0000 0000 .skip 4,0 |
417 .global SummeNick |
418 .global SummeNick |
421 SummeNick: |
422 0050 0000 0000 .skip 4,0 |
423 .global Mess_Integral_Gier2 |
424 .global Mess_Integral_Gier2 |
427 Mess_Integral_Gier2: |
428 0054 0000 0000 .skip 4,0 |
429 .global Mess_Integral_Gier |
430 .global Mess_Integral_Gier |
433 Mess_Integral_Gier: |
434 0058 0000 0000 .skip 4,0 |
435 .global Mess_IntegralRoll2 |
436 .global Mess_IntegralRoll2 |
439 Mess_IntegralRoll2: |
440 005c 0000 0000 .skip 4,0 |
441 .global Mess_IntegralRoll |
442 .global Mess_IntegralRoll |
445 Mess_IntegralRoll: |
446 0060 0000 0000 .skip 4,0 |
447 .global Mess_IntegralNick2 |
448 .global Mess_IntegralNick2 |
451 Mess_IntegralNick2: |
452 0064 0000 0000 .skip 4,0 |
453 .global Mess_IntegralNick |
454 .global Mess_IntegralNick |
457 Mess_IntegralNick: |
458 0068 0000 0000 .skip 4,0 |
459 .global Integral_Gier |
460 .global Integral_Gier |
463 Integral_Gier: |
464 006c 0000 0000 .skip 4,0 |
465 .global IntegralAccZ |
466 .global IntegralAccZ |
469 IntegralAccZ: |
470 0070 0000 0000 .skip 4,0 |
471 .global IntegralAccRoll |
472 .global IntegralAccRoll |
475 IntegralAccRoll: |
476 0074 0000 0000 .skip 4,0 |
477 .global IntegralAccNick |
478 .global IntegralAccNick |
481 IntegralAccNick: |
482 0078 0000 0000 .skip 4,0 |
483 .global IntegralRoll2 |
484 .global IntegralRoll2 |
487 IntegralRoll2: |
488 007c 0000 0000 .skip 4,0 |
489 .global IntegralRoll |
490 .global IntegralRoll |
493 IntegralRoll: |
494 0080 0000 0000 .skip 4,0 |
495 .global IntegralNick2 |
496 .global IntegralNick2 |
499 IntegralNick2: |
500 0084 0000 0000 .skip 4,0 |
501 .global IntegralNick |
502 .global IntegralNick |
505 IntegralNick: |
506 0088 0000 0000 .skip 4,0 |
507 .global ControlHeading |
508 .global ControlHeading |
511 ControlHeading: |
512 008c 00 .skip 1,0 |
513 .global NeutralAccZ |
514 .global NeutralAccZ |
517 NeutralAccZ: |
518 008d 0000 .skip 2,0 |
519 .global NaviCntAcc |
520 .global NaviCntAcc |
523 NaviCntAcc: |
524 008f 0000 .skip 2,0 |
525 .global NeutralAccY |
526 .global NeutralAccY |
529 NeutralAccY: |
530 0091 0000 .skip 2,0 |
531 .global NeutralAccX |
532 .global NeutralAccX |
535 NeutralAccX: |
536 0093 0000 .skip 2,0 |
537 .global StartNeutralNick |
538 .global StartNeutralNick |
541 StartNeutralNick: |
542 0095 0000 .skip 2,0 |
543 .global StartNeutralRoll |
544 .global StartNeutralRoll |
547 StartNeutralRoll: |
548 0097 0000 .skip 2,0 |
549 .global AdNeutralGier |
550 .global AdNeutralGier |
553 AdNeutralGier: |
554 0099 0000 .skip 2,0 |
555 .global AdNeutralRoll |
556 .global AdNeutralRoll |
559 AdNeutralRoll: |
560 009b 0000 .skip 2,0 |
561 .global AdNeutralNick |
562 .global AdNeutralNick |
565 AdNeutralNick: |
566 009d 0000 .skip 2,0 |
567 .global BaroExpandActive |
568 .global BaroExpandActive |
571 BaroExpandActive: |
572 009f 0000 .skip 2,0 |
573 .text |
574 .global CopyDebugValues |
576 CopyDebugValues: |
577 /* prologue: frame size=0 */ |
578 0000 EF92 push r14 |
579 0002 FF92 push r15 |
580 0004 0F93 push r16 |
581 0006 1F93 push r17 |
582 /* prologue end (size=4) */ |
583 0008 8091 0000 lds r24,EE_Parameter+28 |
584 000c 9927 clr r25 |
585 000e 880F lsl r24 |
586 0010 991F rol r25 |
587 0012 880F lsl r24 |
588 0014 991F rol r25 |
589 0016 7C01 movw r14,r24 |
590 0018 0027 clr r16 |
591 001a F7FC sbrc r15,7 |
592 001c 0095 com r16 |
593 001e 102F mov r17,r16 |
594 0020 8091 0000 lds r24,IntegralNick |
595 0024 9091 0000 lds r25,(IntegralNick)+1 |
596 0028 A091 0000 lds r26,(IntegralNick)+2 |
597 002c B091 0000 lds r27,(IntegralNick)+3 |
598 0030 BC01 movw r22,r24 |
599 0032 CD01 movw r24,r26 |
600 0034 A801 movw r20,r16 |
601 0036 9701 movw r18,r14 |
602 0038 0E94 0000 call __divmodsi4 |
603 003c 3093 0000 sts (DebugOut+2)+1,r19 |
604 0040 2093 0000 sts DebugOut+2,r18 |
605 0044 8091 0000 lds r24,IntegralRoll |
606 0048 9091 0000 lds r25,(IntegralRoll)+1 |
607 004c A091 0000 lds r26,(IntegralRoll)+2 |
608 0050 B091 0000 lds r27,(IntegralRoll)+3 |
609 0054 BC01 movw r22,r24 |
610 0056 CD01 movw r24,r26 |
611 0058 A801 movw r20,r16 |
612 005a 9701 movw r18,r14 |
613 005c 0E94 0000 call __divmodsi4 |
614 0060 3093 0000 sts (DebugOut+4)+1,r19 |
615 0064 2093 0000 sts DebugOut+4,r18 |
616 0068 8091 0000 lds r24,Mittelwert_AccNick |
617 006c 9091 0000 lds r25,(Mittelwert_AccNick)+1 |
618 0070 97FD sbrc r25,7 |
619 0072 0396 adiw r24,3 |
620 .L2: |
621 0074 9595 asr r25 |
622 0076 8795 ror r24 |
623 0078 9595 asr r25 |
624 007a 8795 ror r24 |
625 007c 9093 0000 sts (DebugOut+6)+1,r25 |
626 0080 8093 0000 sts DebugOut+6,r24 |
627 0084 8091 0000 lds r24,Mittelwert_AccRoll |
628 0088 9091 0000 lds r25,(Mittelwert_AccRoll)+1 |
629 008c 97FD sbrc r25,7 |
630 008e 0396 adiw r24,3 |
631 .L3: |
632 0090 9595 asr r25 |
633 0092 8795 ror r24 |
634 0094 9595 asr r25 |
635 0096 8795 ror r24 |
636 0098 9093 0000 sts (DebugOut+8)+1,r25 |
637 009c 8093 0000 sts DebugOut+8,r24 |
638 00a0 8091 0000 lds r24,AdNeutralGier |
639 00a4 9091 0000 lds r25,(AdNeutralGier)+1 |
640 00a8 2091 0000 lds r18,AdWertGier |
641 00ac 3091 0000 lds r19,(AdWertGier)+1 |
642 00b0 821B sub r24,r18 |
643 00b2 930B sbc r25,r19 |
644 00b4 9093 0000 sts (DebugOut+10)+1,r25 |
645 00b8 8093 0000 sts DebugOut+10,r24 |
646 00bc 8091 0000 lds r24,HoehenWert |
647 00c0 9091 0000 lds r25,(HoehenWert)+1 |
648 00c4 A091 0000 lds r26,(HoehenWert)+2 |
649 00c8 B091 0000 lds r27,(HoehenWert)+3 |
650 00cc BC01 movw r22,r24 |
651 00ce CD01 movw r24,r26 |
652 00d0 25E0 ldi r18,lo8(5) |
653 00d2 30E0 ldi r19,hi8(5) |
654 00d4 40E0 ldi r20,hlo8(5) |
655 00d6 50E0 ldi r21,hhi8(5) |
656 00d8 0E94 0000 call __divmodsi4 |
657 00dc 3093 0000 sts (DebugOut+12)+1,r19 |
658 00e0 2093 0000 sts DebugOut+12,r18 |
659 00e4 8091 0000 lds r24,AdWertAccHoch |
660 00e8 9091 0000 lds r25,(AdWertAccHoch)+1 |
661 00ec 9093 0000 sts (DebugOut+14)+1,r25 |
662 00f0 8093 0000 sts DebugOut+14,r24 |
663 00f4 8091 0000 lds r24,KompassValue |
664 00f8 9091 0000 lds r25,(KompassValue)+1 |
665 00fc 9093 0000 sts (DebugOut+18)+1,r25 |
666 0100 8093 0000 sts DebugOut+18,r24 |
667 0104 8091 0000 lds r24,UBat |
668 0108 9091 0000 lds r25,(UBat)+1 |
669 010c 9093 0000 sts (DebugOut+20)+1,r25 |
670 0110 8093 0000 sts DebugOut+20,r24 |
671 0114 8091 0000 lds r24,SenderOkay |
672 0118 9927 clr r25 |
673 011a 9093 0000 sts (DebugOut+22)+1,r25 |
674 011e 8093 0000 sts DebugOut+22,r24 |
675 0122 8091 0000 lds r24,ErsatzKompass |
676 0126 9091 0000 lds r25,(ErsatzKompass)+1 |
677 012a A091 0000 lds r26,(ErsatzKompass)+2 |
678 012e B091 0000 lds r27,(ErsatzKompass)+3 |
679 0132 2091 0000 lds r18,GIER_GRAD_FAKTOR |
680 0136 3091 0000 lds r19,(GIER_GRAD_FAKTOR)+1 |
681 013a 4091 0000 lds r20,(GIER_GRAD_FAKTOR)+2 |
682 013e 5091 0000 lds r21,(GIER_GRAD_FAKTOR)+3 |
683 0142 BC01 movw r22,r24 |
684 0144 CD01 movw r24,r26 |
685 0146 0E94 0000 call __divmodsi4 |
686 014a 3093 0000 sts (DebugOut+24)+1,r19 |
687 014e 2093 0000 sts DebugOut+24,r18 |
688 0152 8091 0000 lds r24,Motor+1 |
689 0156 9927 clr r25 |
690 0158 9093 0000 sts (DebugOut+26)+1,r25 |
691 015c 8093 0000 sts DebugOut+26,r24 |
692 0160 8091 0000 lds r24,Motor+9 |
693 0164 9927 clr r25 |
694 0166 9093 0000 sts (DebugOut+28)+1,r25 |
695 016a 8093 0000 sts DebugOut+28,r24 |
696 016e 8091 0000 lds r24,Motor+17 |
697 0172 9927 clr r25 |
698 0174 9093 0000 sts (DebugOut+30)+1,r25 |
699 0178 8093 0000 sts DebugOut+30,r24 |
700 017c 8091 0000 lds r24,Motor+25 |
701 0180 9927 clr r25 |
702 0182 9093 0000 sts (DebugOut+32)+1,r25 |
703 0186 8093 0000 sts DebugOut+32,r24 |
704 018a 8091 0000 lds r24,ServoNickValue |
705 018e 9091 0000 lds r25,(ServoNickValue)+1 |
706 0192 9093 0000 sts (DebugOut+42)+1,r25 |
707 0196 8093 0000 sts DebugOut+42,r24 |
708 019a 8091 0000 lds r24,Capacity |
709 019e 9091 0000 lds r25,(Capacity)+1 |
710 01a2 9093 0000 sts (DebugOut+46)+1,r25 |
711 01a6 8093 0000 sts DebugOut+46,r24 |
712 01aa 8091 0000 lds r24,Capacity+4 |
713 01ae 9091 0000 lds r25,(Capacity+4)+1 |
714 01b2 9093 0000 sts (DebugOut+48)+1,r25 |
715 01b6 8093 0000 sts DebugOut+48,r24 |
716 01ba 8091 0000 lds r24,Capacity+6 |
717 01be 9927 clr r25 |
718 01c0 9093 0000 sts (DebugOut+60)+1,r25 |
719 01c4 8093 0000 sts DebugOut+60,r24 |
720 01c8 8091 0000 lds r24,GPS_Nick |
721 01cc 9091 0000 lds r25,(GPS_Nick)+1 |
722 01d0 9093 0000 sts (DebugOut+62)+1,r25 |
723 01d4 8093 0000 sts DebugOut+62,r24 |
724 01d8 8091 0000 lds r24,GPS_Roll |
725 01dc 9091 0000 lds r25,(GPS_Roll)+1 |
726 01e0 9093 0000 sts (DebugOut+64)+1,r25 |
727 01e4 8093 0000 sts DebugOut+64,r24 |
728 01e8 8091 0000 lds r24,VersionInfo+5 |
729 01ec 8823 tst r24 |
730 01ee 21F4 brne .L5 |
731 01f0 8091 0000 lds r24,VersionInfo+6 |
732 01f4 8823 tst r24 |
733 01f6 21F0 breq .L4 |
734 .L5: |
735 01f8 8091 0000 lds r24,DebugOut+1 |
736 01fc 8160 ori r24,lo8(1) |
737 01fe 03C0 rjmp .L7 |
738 .L4: |
739 0200 8091 0000 lds r24,DebugOut+1 |
740 0204 8E7F andi r24,lo8(-2) |
741 .L7: |
742 0206 8093 0000 sts DebugOut+1,r24 |
743 /* epilogue: frame size=0 */ |
744 020a 1F91 pop r17 |
745 020c 0F91 pop r16 |
746 020e FF90 pop r15 |
747 0210 EF90 pop r14 |
748 0212 0895 ret |
749 /* epilogue end (size=5) */ |
750 /* function CopyDebugValues size 268 (259) */ |
752 .global Piep |
754 Piep: |
755 /* prologue: frame size=0 */ |
756 0214 1F93 push r17 |
757 0216 CF93 push r28 |
758 0218 DF93 push r29 |
759 /* prologue end (size=3) */ |
760 021a 182F mov r17,r24 |
761 021c EB01 movw r28,r22 |
762 021e 8091 0000 lds r24,MotorenEin |
763 0222 8823 tst r24 |
764 0224 A1F4 brne .L8 |
765 0226 1150 subi r17,lo8(-(-1)) |
766 0228 1F3F cpi r17,lo8(-1) |
767 022a 89F0 breq .L8 |
768 .L15: |
769 022c D093 0000 sts (beeptime)+1,r29 |
770 0230 C093 0000 sts beeptime,r28 |
771 .L12: |
772 0234 8091 0000 lds r24,beeptime |
773 0238 9091 0000 lds r25,(beeptime)+1 |
774 023c 892B or r24,r25 |
775 023e D1F7 brne .L12 |
776 0240 CE01 movw r24,r28 |
777 0242 8C0F add r24,r28 |
778 0244 9D1F adc r25,r29 |
779 0246 0E94 0000 call Delay_ms |
780 024a 1150 subi r17,1 |
781 024c 78F7 brcc .L15 |
782 .L8: |
783 /* epilogue: frame size=0 */ |
784 024e DF91 pop r29 |
785 0250 CF91 pop r28 |
786 0252 1F91 pop r17 |
787 0254 0895 ret |
788 /* epilogue end (size=4) */ |
789 /* function Piep size 34 (27) */ |
791 .global CalibrierMittelwert |
793 CalibrierMittelwert: |
794 /* prologue: frame size=0 */ |
795 0256 CF93 push r28 |
796 0258 DF93 push r29 |
797 /* prologue end (size=2) */ |
798 025a 8091 0000 lds r24,PlatinenVersion |
799 025e 8D30 cpi r24,lo8(13) |
800 0260 11F4 brne .L18 |
801 0262 0E94 0000 call SucheGyroOffset |
802 .L18: |
803 0266 1092 7A00 sts 122,__zero_reg__ |
804 026a 8091 0000 lds r24,AdWertNick |
805 026e 9091 0000 lds r25,(AdWertNick)+1 |
806 0272 9093 0000 sts (MesswertNick)+1,r25 |
807 0276 8093 0000 sts MesswertNick,r24 |
808 027a 8091 0000 lds r24,AdWertRoll |
809 027e 9091 0000 lds r25,(AdWertRoll)+1 |
810 0282 9093 0000 sts (MesswertRoll)+1,r25 |
811 0286 8093 0000 sts MesswertRoll,r24 |
812 028a 8091 0000 lds r24,AdWertGier |
813 028e 9091 0000 lds r25,(AdWertGier)+1 |
814 0292 9093 0000 sts (MesswertGier)+1,r25 |
815 0296 8093 0000 sts MesswertGier,r24 |
816 029a 2091 0000 lds r18,AdWertAccNick |
817 029e 3091 0000 lds r19,(AdWertAccNick)+1 |
818 02a2 C901 movw r24,r18 |
819 02a4 880F lsl r24 |
820 02a6 991F rol r25 |
821 02a8 880F lsl r24 |
822 02aa 991F rol r25 |
823 02ac 820F add r24,r18 |
824 02ae 931F adc r25,r19 |
825 02b0 820F add r24,r18 |
826 02b2 931F adc r25,r19 |
827 02b4 9093 0000 sts (Mittelwert_AccNick)+1,r25 |
828 02b8 8093 0000 sts Mittelwert_AccNick,r24 |
829 02bc 2091 0000 lds r18,AdWertAccRoll |
830 02c0 3091 0000 lds r19,(AdWertAccRoll)+1 |
831 02c4 C901 movw r24,r18 |
832 02c6 880F lsl r24 |
833 02c8 991F rol r25 |
834 02ca 880F lsl r24 |
835 02cc 991F rol r25 |
836 02ce 820F add r24,r18 |
837 02d0 931F adc r25,r19 |
838 02d2 820F add r24,r18 |
839 02d4 931F adc r25,r19 |
840 02d6 9093 0000 sts (Mittelwert_AccRoll)+1,r25 |
841 02da 8093 0000 sts Mittelwert_AccRoll,r24 |
842 02de 8FEC ldi r24,lo8(-49) |
843 02e0 8093 7A00 sts 122,r24 |
844 02e4 A0E0 ldi r26,lo8(Poti) |
845 02e6 B0E0 ldi r27,hi8(Poti) |
846 02e8 C0E0 ldi r28,lo8(EE_Parameter+5) |
847 02ea D0E0 ldi r29,hi8(EE_Parameter+5) |
848 02ec 97E0 ldi r25,lo8(7) |
849 .L28: |
850 02ee 8991 ld r24,Y+ |
851 02f0 E82F mov r30,r24 |
852 02f2 FF27 clr r31 |
853 02f4 EE0F add r30,r30 |
854 02f6 FF1F adc r31,r31 |
855 02f8 E050 subi r30,lo8(-(PPM_in)) |
856 02fa F040 sbci r31,hi8(-(PPM_in)) |
857 02fc 0190 ld __tmp_reg__,Z+ |
858 02fe F081 ld r31,Z |
859 0300 E02D mov r30,__tmp_reg__ |
860 0302 E259 subi r30,lo8(-(110)) |
861 0304 FF4F sbci r31,hi8(-(110)) |
862 0306 1E16 cp __zero_reg__,r30 |
863 0308 1F06 cpc __zero_reg__,r31 |
864 030a 1CF0 brlt .L22 |
865 030c E0E0 ldi r30,lo8(0) |
866 030e F0E0 ldi r31,hi8(0) |
867 0310 05C0 rjmp .L23 |
868 .L22: |
869 0312 EF3F cpi r30,255 |
870 0314 F105 cpc r31,__zero_reg__ |
871 0316 14F0 brlt .L23 |
872 0318 EFEF ldi r30,lo8(255) |
873 031a F0E0 ldi r31,hi8(255) |
874 .L23: |
875 031c 8C91 ld r24,X |
876 031e 282F mov r18,r24 |
877 0320 3327 clr r19 |
878 0322 E217 cp r30,r18 |
879 0324 F307 cpc r31,r19 |
880 0326 14F4 brge .L25 |
881 0328 8150 subi r24,lo8(-(-1)) |
882 032a 04C0 rjmp .L31 |
883 .L25: |
884 032c 2E17 cp r18,r30 |
885 032e 3F07 cpc r19,r31 |
886 0330 14F4 brge .L21 |
887 0332 8F5F subi r24,lo8(-(1)) |
888 .L31: |
889 0334 8C93 st X,r24 |
890 .L21: |
891 0336 9150 subi r25,lo8(-(-1)) |
892 0338 1196 adiw r26,1 |
893 033a 97FF sbrs r25,7 |
894 033c D8CF rjmp .L28 |
895 033e 8091 0000 lds r24,EE_Parameter+63 |
896 0342 9927 clr r25 |
897 0344 AA27 clr r26 |
898 0346 BB27 clr r27 |
899 0348 BC01 movw r22,r24 |
900 034a CD01 movw r24,r26 |
901 034c 24EC ldi r18,lo8(2500) |
902 034e 39E0 ldi r19,hi8(2500) |
903 0350 40E0 ldi r20,hlo8(2500) |
904 0352 50E0 ldi r21,hhi8(2500) |
905 0354 0E94 0000 call __mulsi3 |
906 0358 DC01 movw r26,r24 |
907 035a CB01 movw r24,r22 |
908 035c 8093 0000 sts Umschlag180Nick,r24 |
909 0360 9093 0000 sts (Umschlag180Nick)+1,r25 |
910 0364 A093 0000 sts (Umschlag180Nick)+2,r26 |
911 0368 B093 0000 sts (Umschlag180Nick)+3,r27 |
912 036c 8091 0000 lds r24,EE_Parameter+64 |
913 0370 9927 clr r25 |
914 0372 AA27 clr r26 |
915 0374 BB27 clr r27 |
916 0376 BC01 movw r22,r24 |
917 0378 CD01 movw r24,r26 |
918 037a 0E94 0000 call __mulsi3 |
919 037e DC01 movw r26,r24 |
920 0380 CB01 movw r24,r22 |
921 0382 8093 0000 sts Umschlag180Roll,r24 |
922 0386 9093 0000 sts (Umschlag180Roll)+1,r25 |
923 038a A093 0000 sts (Umschlag180Roll)+2,r26 |
924 038e B093 0000 sts (Umschlag180Roll)+3,r27 |
925 /* epilogue: frame size=0 */ |
926 0392 DF91 pop r29 |
927 0394 CF91 pop r28 |
928 0396 0895 ret |
929 /* epilogue end (size=3) */ |
930 /* function CalibrierMittelwert size 161 (156) */ |
932 .section .progmem.data,"a",@progbits |
935 __c.40: |
936 0000 0A0D 4143 .string "\n\rACC not calibrated!\r\n" |
936 4320 6E6F |
936 7420 6361 |
936 6C69 6272 |
936 6174 6564 |
937 .text |
938 .global SetNeutral |
940 SetNeutral: |
941 /* prologue: frame size=0 */ |
942 0398 A0E0 ldi r26,lo8(0) |
943 039a B0E0 ldi r27,hi8(0) |
944 039c E0E0 ldi r30,pm_lo8(1f) |
945 039e F0E0 ldi r31,pm_hi8(1f) |
946 03a0 0C94 0000 jmp __prologue_saves__+12 |
947 1: |
948 /* prologue end (size=6) */ |
949 03a4 882E mov r8,r24 |
950 03a6 C0E0 ldi r28,lo8(0) |
951 03a8 D0E0 ldi r29,hi8(0) |
952 03aa 7E01 movw r14,r28 |
953 03ac 6E01 movw r12,r28 |
954 03ae 1092 0000 sts VersionInfo+5,__zero_reg__ |
955 03b2 469A sbi 40-0x20,6 |
956 03b4 D093 0000 sts (NeutralAccX)+1,r29 |
957 03b8 C093 0000 sts NeutralAccX,r28 |
958 03bc D093 0000 sts (NeutralAccY)+1,r29 |
959 03c0 C093 0000 sts NeutralAccY,r28 |
960 03c4 D093 0000 sts (NeutralAccZ)+1,r29 |
961 03c8 C093 0000 sts NeutralAccZ,r28 |
962 03cc D093 0000 sts (AdNeutralNick)+1,r29 |
963 03d0 C093 0000 sts AdNeutralNick,r28 |
964 03d4 D093 0000 sts (AdNeutralRoll)+1,r29 |
965 03d8 C093 0000 sts AdNeutralRoll,r28 |
966 03dc D093 0000 sts (AdNeutralGier)+1,r29 |
967 03e0 C093 0000 sts AdNeutralGier,r28 |
968 03e4 1092 0000 sts Parameter_AchsKopplung1,__zero_reg__ |
969 03e8 1092 0000 sts Parameter_AchsKopplung2,__zero_reg__ |
970 03ec 1092 0000 sts ExpandBaro,__zero_reg__ |
971 03f0 0E94 0000 call CalibrierMittelwert |
972 03f4 84E6 ldi r24,lo8(100) |
973 03f6 90E0 ldi r25,hi8(100) |
974 03f8 0E94 0000 call Delay_ms_Mess |
975 03fc 0E94 0000 call CalibrierMittelwert |
976 0400 8091 0000 lds r24,EE_Parameter+13 |
977 0404 80FF sbrs r24,0 |
978 0406 10C0 rjmp .L33 |
979 0408 8091 0000 lds r24,MessLuftdruck |
980 040c 9091 0000 lds r25,(MessLuftdruck)+1 |
981 0410 875B subi r24,lo8(951) |
982 0412 9340 sbci r25,hi8(951) |
983 0414 38F4 brsh .L35 |
984 0416 8091 0000 lds r24,MessLuftdruck |
985 041a 9091 0000 lds r25,(MessLuftdruck)+1 |
986 041e 8E5E subi r24,lo8(750) |
987 0420 9240 sbci r25,hi8(750) |
988 0422 10F4 brsh .L33 |
989 .L35: |
990 0424 0E94 0000 call SucheLuftruckOffset |
991 .L33: |
992 0428 0FE1 ldi r16,lo8(31) |
993 .L39: |
994 042a 8AE0 ldi r24,lo8(10) |
995 042c 90E0 ldi r25,hi8(10) |
996 042e 0E94 0000 call Delay_ms_Mess |
997 0432 8091 0000 lds r24,AdWertGier |
998 0436 9091 0000 lds r25,(AdWertGier)+1 |
999 043a C80F add r28,r24 |
1000 043c D91F adc r29,r25 |
1001 043e 8091 0000 lds r24,AdWertNick |
1002 0442 9091 0000 lds r25,(AdWertNick)+1 |
1003 0446 E80E add r14,r24 |
1004 0448 F91E adc r15,r25 |
1005 044a 8091 0000 lds r24,AdWertRoll |
1006 044e 9091 0000 lds r25,(AdWertRoll)+1 |
1007 0452 C80E add r12,r24 |
1008 0454 D91E adc r13,r25 |
1009 0456 0150 subi r16,lo8(-(-1)) |
1010 0458 07FF sbrs r16,7 |
1011 045a E7CF rjmp .L39 |
1012 045c 9701 movw r18,r14 |
1013 045e 205F subi r18,lo8(-(16)) |
1014 0460 3F4F sbci r19,hi8(-(16)) |
1015 0462 3695 lsr r19 |
1016 0464 2795 ror r18 |
1017 0466 3695 lsr r19 |
1018 0468 2795 ror r18 |
1019 046a 3093 0000 sts (AdNeutralNick)+1,r19 |
1020 046e 2093 0000 sts AdNeutralNick,r18 |
1021 0472 C601 movw r24,r12 |
1022 0474 4096 adiw r24,16 |
1023 0476 9695 lsr r25 |
1024 0478 8795 ror r24 |
1025 047a 9695 lsr r25 |
1026 047c 8795 ror r24 |
1027 047e 9093 0000 sts (AdNeutralRoll)+1,r25 |
1028 0482 8093 0000 sts AdNeutralRoll,r24 |
1029 0486 6096 adiw r28,16 |
1030 0488 F5E0 ldi r31,5 |
1031 048a D695 1: lsr r29 |
1032 048c C795 ror r28 |
1033 048e FA95 dec r31 |
1034 0490 E1F7 brne 1b |
1035 0492 D093 0000 sts (AdNeutralGier)+1,r29 |
1036 0496 C093 0000 sts AdNeutralGier,r28 |
1037 049a 9093 0000 sts (StartNeutralRoll)+1,r25 |
1038 049e 8093 0000 sts StartNeutralRoll,r24 |
1039 04a2 3093 0000 sts (StartNeutralNick)+1,r19 |
1040 04a6 2093 0000 sts StartNeutralNick,r18 |
1041 04aa 8820 tst r8 |
1042 04ac 09F4 brne .+2 |
1043 04ae 41C0 rjmp .L40 |
1044 04b0 8091 0000 lds r24,Mittelwert_AccNick |
1045 04b4 9091 0000 lds r25,(Mittelwert_AccNick)+1 |
1046 04b8 97FF sbrs r25,7 |
1047 04ba 03C0 rjmp .L41 |
1048 04bc 9095 com r25 |
1049 04be 8195 neg r24 |
1050 04c0 9F4F sbci r25,lo8(-1) |
1051 .L41: |
1052 04c2 6CE0 ldi r22,lo8(12) |
1053 04c4 70E0 ldi r23,hi8(12) |
1054 04c6 0E94 0000 call __divmodhi4 |
1055 04ca 9B01 movw r18,r22 |
1056 04cc 7093 0000 sts (NeutralAccX)+1,r23 |
1057 04d0 6093 0000 sts NeutralAccX,r22 |
1058 04d4 8091 0000 lds r24,Mittelwert_AccRoll |
1059 04d8 9091 0000 lds r25,(Mittelwert_AccRoll)+1 |
1060 04dc 97FF sbrs r25,7 |
1061 04de 03C0 rjmp .L42 |
1062 04e0 9095 com r25 |
1063 04e2 8195 neg r24 |
1064 04e4 9F4F sbci r25,lo8(-1) |
1065 .L42: |
1066 04e6 6CE0 ldi r22,lo8(12) |
1067 04e8 70E0 ldi r23,hi8(12) |
1068 04ea 0E94 0000 call __divmodhi4 |
1069 04ee 7093 0000 sts (NeutralAccY)+1,r23 |
1070 04f2 6093 0000 sts NeutralAccY,r22 |
1071 04f6 8091 0000 lds r24,Aktuell_az |
1072 04fa 9091 0000 lds r25,(Aktuell_az)+1 |
1073 04fe 9093 0000 sts (NeutralAccZ)+1,r25 |
1074 0502 8093 0000 sts NeutralAccZ,r24 |
1075 0506 B901 movw r22,r18 |
1076 0508 84E0 ldi r24,lo8(4) |
1077 050a 90E0 ldi r25,hi8(4) |
1078 050c 0E94 0000 call SetParamWord |
1079 0510 6091 0000 lds r22,NeutralAccY |
1080 0514 7091 0000 lds r23,(NeutralAccY)+1 |
1081 0518 86E0 ldi r24,lo8(6) |
1082 051a 90E0 ldi r25,hi8(6) |
1083 051c 0E94 0000 call SetParamWord |
1084 0520 6091 0000 lds r22,NeutralAccZ |
1085 0524 7091 0000 lds r23,(NeutralAccZ)+1 |
1086 0528 88E0 ldi r24,lo8(8) |
1087 052a 90E0 ldi r25,hi8(8) |
1088 052c 0E94 0000 call SetParamWord |
1089 0530 65C0 rjmp .L43 |
1090 .L40: |
1091 0532 84E0 ldi r24,lo8(4) |
1092 0534 90E0 ldi r25,hi8(4) |
1093 0536 0E94 0000 call GetParamWord |
1094 053a 9093 0000 sts (NeutralAccX)+1,r25 |
1095 053e 8093 0000 sts NeutralAccX,r24 |
1096 0542 86E0 ldi r24,lo8(6) |
1097 0544 90E0 ldi r25,hi8(6) |
1098 0546 0E94 0000 call GetParamWord |
1099 054a 9093 0000 sts (NeutralAccY)+1,r25 |
1100 054e 8093 0000 sts NeutralAccY,r24 |
1101 0552 88E0 ldi r24,lo8(8) |
1102 0554 90E0 ldi r25,hi8(8) |
1103 0556 0E94 0000 call GetParamWord |
1104 055a 9C01 movw r18,r24 |
1105 055c 9093 0000 sts (NeutralAccZ)+1,r25 |
1106 0560 8093 0000 sts NeutralAccZ,r24 |
1107 0564 8091 0000 lds r24,NeutralAccX |
1108 0568 9091 0000 lds r25,(NeutralAccX)+1 |
1109 056c 8150 subi r24,lo8(2049) |
1110 056e 9840 sbci r25,hi8(2049) |
1111 0570 50F4 brsh .L45 |
1112 0572 8091 0000 lds r24,NeutralAccY |
1113 0576 9091 0000 lds r25,(NeutralAccY)+1 |
1114 057a 8150 subi r24,lo8(2049) |
1115 057c 9840 sbci r25,hi8(2049) |
1116 057e 18F4 brsh .L45 |
1117 0580 2150 subi r18,lo8(1025) |
1118 0582 3440 sbci r19,hi8(1025) |
1119 0584 D8F1 brlo .L43 |
1120 .L45: |
1121 0586 80E0 ldi r24,lo8(__c.40) |
1122 0588 90E0 ldi r25,hi8(__c.40) |
1123 058a 9F93 push r25 |
1124 058c 8F93 push r24 |
1125 058e 80E0 ldi r24,lo8(pm(uart_putchar)) |
1126 0590 90E0 ldi r25,hi8(pm(uart_putchar)) |
1127 0592 9F93 push r25 |
1128 0594 8F93 push r24 |
1129 0596 E091 0000 lds r30,_printf_P |
1130 059a F091 0000 lds r31,(_printf_P)+1 |
1131 059e 0995 icall |
1132 05a0 8091 0000 lds r24,Mittelwert_AccNick |
1133 05a4 9091 0000 lds r25,(Mittelwert_AccNick)+1 |
1134 05a8 97FF sbrs r25,7 |
1135 05aa 03C0 rjmp .L46 |
1136 05ac 9095 com r25 |
1137 05ae 8195 neg r24 |
1138 05b0 9F4F sbci r25,lo8(-1) |
1139 .L46: |
1140 05b2 6CE0 ldi r22,lo8(12) |
1141 05b4 70E0 ldi r23,hi8(12) |
1142 05b6 0E94 0000 call __divmodhi4 |
1143 05ba 7093 0000 sts (NeutralAccX)+1,r23 |
1144 05be 6093 0000 sts NeutralAccX,r22 |
1145 05c2 8091 0000 lds r24,Mittelwert_AccRoll |
1146 05c6 9091 0000 lds r25,(Mittelwert_AccRoll)+1 |
1147 05ca 97FF sbrs r25,7 |
1148 05cc 03C0 rjmp .L47 |
1149 05ce 9095 com r25 |
1150 05d0 8195 neg r24 |
1151 05d2 9F4F sbci r25,lo8(-1) |
1152 .L47: |
1153 05d4 6CE0 ldi r22,lo8(12) |
1154 05d6 70E0 ldi r23,hi8(12) |
1155 05d8 0E94 0000 call __divmodhi4 |
1156 05dc 7093 0000 sts (NeutralAccY)+1,r23 |
1157 05e0 6093 0000 sts NeutralAccY,r22 |
1158 05e4 8091 0000 lds r24,Aktuell_az |
1159 05e8 9091 0000 lds r25,(Aktuell_az)+1 |
1160 05ec 9093 0000 sts (NeutralAccZ)+1,r25 |
1161 05f0 8093 0000 sts NeutralAccZ,r24 |
1162 05f4 0F90 pop __tmp_reg__ |
1163 05f6 0F90 pop __tmp_reg__ |
1164 05f8 0F90 pop __tmp_reg__ |
1165 05fa 0F90 pop __tmp_reg__ |
1166 .L43: |
1167 05fc 1092 0000 sts (MesswertNick)+1,__zero_reg__ |
1168 0600 1092 0000 sts MesswertNick,__zero_reg__ |
1169 0604 1092 0000 sts (MesswertRoll)+1,__zero_reg__ |
1170 0608 1092 0000 sts MesswertRoll,__zero_reg__ |
1171 060c 1092 0000 sts (MesswertGier)+1,__zero_reg__ |
1172 0610 1092 0000 sts MesswertGier,__zero_reg__ |
1173 0614 84E6 ldi r24,lo8(100) |
1174 0616 90E0 ldi r25,hi8(100) |
1175 0618 0E94 0000 call Delay_ms_Mess |
1176 061c 8091 0000 lds r24,AdWertAccNick |
1177 0620 9091 0000 lds r25,(AdWertAccNick)+1 |
1178 0624 9C01 movw r18,r24 |
1179 0626 220F lsl r18 |
1180 0628 331F rol r19 |
1181 062a 220F lsl r18 |
1182 062c 331F rol r19 |
1183 062e 280F add r18,r24 |
1184 0630 391F adc r19,r25 |
1185 0632 280F add r18,r24 |
1186 0634 391F adc r19,r25 |
1187 0636 3093 0000 sts (Mittelwert_AccNick)+1,r19 |
1188 063a 2093 0000 sts Mittelwert_AccNick,r18 |
1189 063e 8091 0000 lds r24,AdWertAccRoll |
1190 0642 9091 0000 lds r25,(AdWertAccRoll)+1 |
1191 0646 8C01 movw r16,r24 |
1192 0648 000F lsl r16 |
1193 064a 111F rol r17 |
1194 064c 000F lsl r16 |
1195 064e 111F rol r17 |
1196 0650 080F add r16,r24 |
1197 0652 191F adc r17,r25 |
1198 0654 080F add r16,r24 |
1199 0656 191F adc r17,r25 |
1200 0658 1093 0000 sts (Mittelwert_AccRoll)+1,r17 |
1201 065c 0093 0000 sts Mittelwert_AccRoll,r16 |
1202 0660 8091 0000 lds r24,EE_Parameter+28 |
1203 0664 C82E mov r12,r24 |
1204 0666 DD24 clr r13 |
1205 0668 EE24 clr r14 |
1206 066a FF24 clr r15 |
1207 066c 4427 clr r20 |
1208 066e 37FD sbrc r19,7 |
1209 0670 4095 com r20 |
1210 0672 542F mov r21,r20 |
1211 0674 C701 movw r24,r14 |
1212 0676 B601 movw r22,r12 |
1213 0678 0E94 0000 call __mulsi3 |
1214 067c 4B01 movw r8,r22 |
1215 067e 5C01 movw r10,r24 |
1216 0680 6093 0000 sts IntegralNick,r22 |
1217 0684 7093 0000 sts (IntegralNick)+1,r23 |
1218 0688 8093 0000 sts (IntegralNick)+2,r24 |
1219 068c 9093 0000 sts (IntegralNick)+3,r25 |
1220 0690 9801 movw r18,r16 |
1221 0692 4427 clr r20 |
1222 0694 37FD sbrc r19,7 |
1223 0696 4095 com r20 |
1224 0698 542F mov r21,r20 |
1225 069a C701 movw r24,r14 |
1226 069c B601 movw r22,r12 |
1227 069e 0E94 0000 call __mulsi3 |
1228 06a2 DC01 movw r26,r24 |
1229 06a4 CB01 movw r24,r22 |
1230 06a6 8093 0000 sts IntegralRoll,r24 |
1231 06aa 9093 0000 sts (IntegralRoll)+1,r25 |
1232 06ae A093 0000 sts (IntegralRoll)+2,r26 |
1233 06b2 B093 0000 sts (IntegralRoll)+3,r27 |
1234 06b6 8092 0000 sts Mess_IntegralNick2,r8 |
1235 06ba 9092 0000 sts (Mess_IntegralNick2)+1,r9 |
1236 06be A092 0000 sts (Mess_IntegralNick2)+2,r10 |
1237 06c2 B092 0000 sts (Mess_IntegralNick2)+3,r11 |
1238 06c6 8093 0000 sts Mess_IntegralRoll2,r24 |
1239 06ca 9093 0000 sts (Mess_IntegralRoll2)+1,r25 |
1240 06ce A093 0000 sts (Mess_IntegralRoll2)+2,r26 |
1241 06d2 B093 0000 sts (Mess_IntegralRoll2)+3,r27 |
1242 06d6 1092 0000 sts Mess_Integral_Gier,__zero_reg__ |
1243 06da 1092 0000 sts (Mess_Integral_Gier)+1,__zero_reg__ |
1244 06de 1092 0000 sts (Mess_Integral_Gier)+2,__zero_reg__ |
1245 06e2 1092 0000 sts (Mess_Integral_Gier)+3,__zero_reg__ |
1246 06e6 8091 0000 lds r24,Luftdruck |
1247 06ea 9091 0000 lds r25,(Luftdruck)+1 |
1248 06ee A091 0000 lds r26,(Luftdruck)+2 |
1249 06f2 B091 0000 lds r27,(Luftdruck)+3 |
1250 06f6 9093 0000 sts (StartLuftdruck)+1,r25 |
1251 06fa 8093 0000 sts StartLuftdruck,r24 |
1252 06fe 1092 0000 sts (VarioMeter)+1,__zero_reg__ |
1253 0702 1092 0000 sts VarioMeter,__zero_reg__ |
1254 0706 1092 0000 sts Mess_Integral_Hoch,__zero_reg__ |
1255 070a 1092 0000 sts (Mess_Integral_Hoch)+1,__zero_reg__ |
1256 070e 1092 0000 sts (Mess_Integral_Hoch)+2,__zero_reg__ |
1257 0712 1092 0000 sts (Mess_Integral_Hoch)+3,__zero_reg__ |
1258 0716 8091 0000 lds r24,KompassValue |
1259 071a 9091 0000 lds r25,(KompassValue)+1 |
1260 071e 9093 0000 sts (KompassStartwert)+1,r25 |
1261 0722 8093 0000 sts KompassStartwert,r24 |
1262 0726 0E94 0000 call GPS_Neutral |
1263 072a 82E3 ldi r24,lo8(50) |
1264 072c 90E0 ldi r25,hi8(50) |
1265 072e 9093 0000 sts (beeptime)+1,r25 |
1266 0732 8093 0000 sts beeptime,r24 |
1267 0736 8091 0000 lds r24,EE_Parameter+63 |
1268 073a 9927 clr r25 |
1269 073c AA27 clr r26 |
1270 073e BB27 clr r27 |
1271 0740 BC01 movw r22,r24 |
1272 0742 CD01 movw r24,r26 |
1273 0744 24EC ldi r18,lo8(2500) |
1274 0746 39E0 ldi r19,hi8(2500) |
1275 0748 40E0 ldi r20,hlo8(2500) |
1276 074a 50E0 ldi r21,hhi8(2500) |
1277 074c 0E94 0000 call __mulsi3 |
1278 0750 DC01 movw r26,r24 |
1279 0752 CB01 movw r24,r22 |
1280 0754 8856 subi r24,lo8(-(15000)) |
1281 0756 954C sbci r25,hi8(-(15000)) |
1282 0758 AF4F sbci r26,hlo8(-(15000)) |
1283 075a BF4F sbci r27,hhi8(-(15000)) |
1284 075c 8093 0000 sts Umschlag180Nick,r24 |
1285 0760 9093 0000 sts (Umschlag180Nick)+1,r25 |
1286 0764 A093 0000 sts (Umschlag180Nick)+2,r26 |
1287 0768 B093 0000 sts (Umschlag180Nick)+3,r27 |
1288 076c 8091 0000 lds r24,EE_Parameter+64 |
1289 0770 9927 clr r25 |
1290 0772 AA27 clr r26 |
1291 0774 BB27 clr r27 |
1292 0776 BC01 movw r22,r24 |
1293 0778 CD01 movw r24,r26 |
1294 077a 0E94 0000 call __mulsi3 |
1295 077e DC01 movw r26,r24 |
1296 0780 CB01 movw r24,r22 |
1297 0782 8856 subi r24,lo8(-(15000)) |
1298 0784 954C sbci r25,hi8(-(15000)) |
1299 0786 AF4F sbci r26,hlo8(-(15000)) |
1300 0788 BF4F sbci r27,hhi8(-(15000)) |
1301 078a 8093 0000 sts Umschlag180Roll,r24 |
1302 078e 9093 0000 sts (Umschlag180Roll)+1,r25 |
1303 0792 A093 0000 sts (Umschlag180Roll)+2,r26 |
1304 0796 B093 0000 sts (Umschlag180Roll)+3,r27 |
1305 079a 1092 0000 sts (ExternHoehenValue)+1,__zero_reg__ |
1306 079e 1092 0000 sts ExternHoehenValue,__zero_reg__ |
1307 07a2 8091 0000 lds r24,KompassValue |
1308 07a6 9091 0000 lds r25,(KompassValue)+1 |
1309 07aa AA27 clr r26 |
1310 07ac 97FD sbrc r25,7 |
1311 07ae A095 com r26 |
1312 07b0 BA2F mov r27,r26 |
1313 07b2 2091 0000 lds r18,GIER_GRAD_FAKTOR |
1314 07b6 3091 0000 lds r19,(GIER_GRAD_FAKTOR)+1 |
1315 07ba 4091 0000 lds r20,(GIER_GRAD_FAKTOR)+2 |
1316 07be 5091 0000 lds r21,(GIER_GRAD_FAKTOR)+3 |
1317 07c2 BC01 movw r22,r24 |
1318 07c4 CD01 movw r24,r26 |
1319 07c6 0E94 0000 call __mulsi3 |
1320 07ca DC01 movw r26,r24 |
1321 07cc CB01 movw r24,r22 |
1322 07ce 8093 0000 sts ErsatzKompass,r24 |
1323 07d2 9093 0000 sts (ErsatzKompass)+1,r25 |
1324 07d6 A093 0000 sts (ErsatzKompass)+2,r26 |
1325 07da B093 0000 sts (ErsatzKompass)+3,r27 |
1326 07de 1092 0000 sts (GierGyroFehler)+1,__zero_reg__ |
1327 07e2 1092 0000 sts GierGyroFehler,__zero_reg__ |
1328 07e6 81E0 ldi r24,lo8(1) |
1329 07e8 8093 0000 sts SendVersionToNavi,r24 |
1330 07ec 0E94 0000 call LED_Init |
1331 07f0 8091 0000 lds r24,FCFlags |
1332 07f4 8460 ori r24,lo8(4) |
1333 07f6 8093 0000 sts FCFlags,r24 |
1334 07fa 8FEF ldi r24,lo8(-1) |
1335 07fc 8093 0000 sts FromNaviCtrl_Value,r24 |
1336 0800 1092 0000 sts FromNaviCtrl_Value+1,__zero_reg__ |
1337 0804 80E2 ldi r24,lo8(32) |
1338 0806 8093 0000 sts FromNaviCtrl_Value+2,r24 |
1339 080a C0E0 ldi r28,lo8(Poti) |
1340 080c D0E0 ldi r29,hi8(Poti) |
1341 080e A0E0 ldi r26,lo8(EE_Parameter+5) |
1342 0810 B0E0 ldi r27,hi8(EE_Parameter+5) |
1343 0812 07E0 ldi r16,lo8(7) |
1344 .L51: |
1345 0814 8D91 ld r24,X+ |
1346 0816 E82F mov r30,r24 |
1347 0818 FF27 clr r31 |
1348 081a EE0F add r30,r30 |
1349 081c FF1F adc r31,r31 |
1350 081e E050 subi r30,lo8(-(PPM_in)) |
1351 0820 F040 sbci r31,hi8(-(PPM_in)) |
1352 0822 8081 ld r24,Z |
1353 0824 9181 ldd r25,Z+1 |
1354 0826 8259 subi r24,lo8(-(110)) |
1355 0828 8993 st Y+,r24 |
1356 082a 0150 subi r16,lo8(-(-1)) |
1357 082c 07FF sbrs r16,7 |
1358 082e F2CF rjmp .L51 |
1359 0830 84E6 ldi r24,lo8(100) |
1360 0832 8093 0000 sts SenderOkay,r24 |
1361 0836 8091 0000 lds r24,ServoActive |
1362 083a 8823 tst r24 |
1363 083c 11F0 breq .L52 |
1364 083e 469A sbi 40-0x20,6 |
1365 0840 579A sbi 42-0x20,7 |
1366 .L52: |
1367 0842 8091 0000 lds r24,AdNeutralNick |
1368 0846 9091 0000 lds r25,(AdNeutralNick)+1 |
1369 084a 8056 subi r24,lo8(-(-2400)) |
1370 084c 9940 sbci r25,hi8(-(-2400)) |
1371 084e 815C subi r24,lo8(11201) |
1372 0850 9B42 sbci r25,hi8(11201) |
1373 0852 28F0 brlo .L53 |
1374 0854 8091 0000 lds r24,VersionInfo+5 |
1375 0858 8160 ori r24,lo8(1) |
1376 085a 8093 0000 sts VersionInfo+5,r24 |
1377 .L53: |
1378 085e 8091 0000 lds r24,AdNeutralRoll |
1379 0862 9091 0000 lds r25,(AdNeutralRoll)+1 |
1380 0866 8056 subi r24,lo8(-(-2400)) |
1381 0868 9940 sbci r25,hi8(-(-2400)) |
1382 086a 815C subi r24,lo8(11201) |
1383 086c 9B42 sbci r25,hi8(11201) |
1384 086e 28F0 brlo .L54 |
1385 0870 8091 0000 lds r24,VersionInfo+5 |
1386 0874 8260 ori r24,lo8(2) |
1387 0876 8093 0000 sts VersionInfo+5,r24 |
1388 .L54: |
1389 087a 8091 0000 lds r24,AdNeutralGier |
1390 087e 9091 0000 lds r25,(AdNeutralGier)+1 |
1391 0882 8C52 subi r24,lo8(-(-300)) |
1392 0884 9140 sbci r25,hi8(-(-300)) |
1393 0886 8957 subi r24,lo8(1401) |
1394 0888 9540 sbci r25,hi8(1401) |
1395 088a 28F0 brlo .L55 |
1396 088c 8091 0000 lds r24,VersionInfo+5 |
1397 0890 8460 ori r24,lo8(4) |
1398 0892 8093 0000 sts VersionInfo+5,r24 |
1399 .L55: |
1400 0896 8091 0000 lds r24,NeutralAccX |
1401 089a 9091 0000 lds r25,(NeutralAccX)+1 |
1402 089e 8C52 subi r24,lo8(-(-300)) |
1403 08a0 9140 sbci r25,hi8(-(-300)) |
1404 08a2 835C subi r24,lo8(451) |
1405 08a4 9140 sbci r25,hi8(451) |
1406 08a6 28F0 brlo .L56 |
1407 08a8 8091 0000 lds r24,VersionInfo+5 |
1408 08ac 8860 ori r24,lo8(8) |
1409 08ae 8093 0000 sts VersionInfo+5,r24 |
1410 .L56: |
1411 08b2 8091 0000 lds r24,NeutralAccY |
1412 08b6 9091 0000 lds r25,(NeutralAccY)+1 |
1413 08ba 8C52 subi r24,lo8(-(-300)) |
1414 08bc 9140 sbci r25,hi8(-(-300)) |
1415 08be 835C subi r24,lo8(451) |
1416 08c0 9140 sbci r25,hi8(451) |
1417 08c2 28F0 brlo .L57 |
1418 08c4 8091 0000 lds r24,VersionInfo+5 |
1419 08c8 8061 ori r24,lo8(16) |
1420 08ca 8093 0000 sts VersionInfo+5,r24 |
1421 .L57: |
1422 08ce 8091 0000 lds r24,NeutralAccZ |
1423 08d2 9091 0000 lds r25,(NeutralAccZ)+1 |
1424 08d6 8050 subi r24,lo8(-(-512)) |
1425 08d8 9240 sbci r25,hi8(-(-512)) |
1426 08da 8355 subi r24,lo8(339) |
1427 08dc 9140 sbci r25,hi8(339) |
1428 08de 28F0 brlo .L32 |
1429 08e0 8091 0000 lds r24,VersionInfo+5 |
1430 08e4 8062 ori r24,lo8(32) |
1431 08e6 8093 0000 sts VersionInfo+5,r24 |
1432 .L32: |
1433 /* epilogue: frame size=0 */ |
1434 08ea ECE0 ldi r30,12 |
1435 08ec CDB7 in r28,__SP_L__ |
1436 08ee DEB7 in r29,__SP_H__ |
1437 08f0 0C94 0000 jmp __epilogue_restores__+12 |
1438 /* epilogue end (size=5) */ |
1439 /* function SetNeutral size 697 (686) */ |
1441 .lcomm tmpl.32,4 |
1442 .lcomm tmpl2.33,4 |
1443 .lcomm tmpl3.34,4 |
1444 .lcomm tmpl4.35,4 |
1445 .lcomm oldNick.36,2 |
1446 .lcomm oldRoll.37,2 |
1447 .lcomm d2Roll.38,2 |
1448 .lcomm d2Nick.39,2 |
1449 .global Mittelwert |
1451 Mittelwert: |
1452 /* prologue: frame size=19 */ |
1453 08f4 A3E1 ldi r26,lo8(19) |
1454 08f6 B0E0 ldi r27,hi8(19) |
1455 08f8 E0E0 ldi r30,pm_lo8(1f) |
1456 08fa F0E0 ldi r31,pm_hi8(1f) |
1457 08fc 0C94 0000 jmp __prologue_saves__+0 |
1458 1: |
1459 /* prologue end (size=6) */ |
1460 0900 8091 0000 lds r24,AdNeutralGier |
1461 0904 9091 0000 lds r25,(AdNeutralGier)+1 |
1462 0908 2091 0000 lds r18,AdWertGier |
1463 090c 3091 0000 lds r19,(AdWertGier)+1 |
1464 0910 821B sub r24,r18 |
1465 0912 930B sbc r25,r19 |
1466 0914 9093 0000 sts (MesswertGier)+1,r25 |
1467 0918 8093 0000 sts MesswertGier,r24 |
1468 091c 8091 0000 lds r24,AdWertNickFilter |
1469 0920 9091 0000 lds r25,(AdWertNickFilter)+1 |
1470 0924 97FD sbrc r25,7 |
1471 0926 0796 adiw r24,7 |
1472 .L64: |
1473 0928 9C01 movw r18,r24 |
1474 092a 53E0 ldi r21,3 |
1475 092c 3595 1: asr r19 |
1476 092e 2795 ror r18 |
1477 0930 5A95 dec r21 |
1478 0932 E1F7 brne 1b |
1479 0934 3093 0000 sts (MesswertNick)+1,r19 |
1480 0938 2093 0000 sts MesswertNick,r18 |
1481 093c 8091 0000 lds r24,AdWertRollFilter |
1482 0940 9091 0000 lds r25,(AdWertRollFilter)+1 |
1483 0944 97FD sbrc r25,7 |
1484 0946 0796 adiw r24,7 |
1485 .L65: |
1486 0948 43E0 ldi r20,3 |
1487 094a 9595 1: asr r25 |
1488 094c 8795 ror r24 |
1489 094e 4A95 dec r20 |
1490 0950 E1F7 brne 1b |
1491 0952 9093 0000 sts (MesswertRoll)+1,r25 |
1492 0956 8093 0000 sts MesswertRoll,r24 |
1493 095a 3093 0000 sts (RohMesswertNick)+1,r19 |
1494 095e 2093 0000 sts RohMesswertNick,r18 |
1495 0962 9093 0000 sts (RohMesswertRoll)+1,r25 |
1496 0966 8093 0000 sts RohMesswertRoll,r24 |
1497 096a 8091 0000 lds r24,Mittelwert_AccNick |
1498 096e 9091 0000 lds r25,(Mittelwert_AccNick)+1 |
1499 0972 AC01 movw r20,r24 |
1500 0974 440F lsl r20 |
1501 0976 551F rol r21 |
1502 0978 480F add r20,r24 |
1503 097a 591F adc r21,r25 |
1504 097c 2091 0000 lds r18,AdWertAccNick |
1505 0980 3091 0000 lds r19,(AdWertAccNick)+1 |
1506 0984 C901 movw r24,r18 |
1507 0986 880F lsl r24 |
1508 0988 991F rol r25 |
1509 098a 880F lsl r24 |
1510 098c 991F rol r25 |
1511 098e 820F add r24,r18 |
1512 0990 931F adc r25,r19 |
1513 0992 820F add r24,r18 |
1514 0994 931F adc r25,r19 |
1515 0996 480F add r20,r24 |
1516 0998 591F adc r21,r25 |
1517 099a 57FF sbrs r21,7 |
1518 099c 02C0 rjmp .L66 |
1519 099e 4D5F subi r20,lo8(-(3)) |
1520 09a0 5F4F sbci r21,hi8(-(3)) |
1521 .L66: |
1522 09a2 5595 asr r21 |
1523 09a4 4795 ror r20 |
1524 09a6 5595 asr r21 |
1525 09a8 4795 ror r20 |
1526 09aa 5093 0000 sts (Mittelwert_AccNick)+1,r21 |
1527 09ae 4093 0000 sts Mittelwert_AccNick,r20 |
1528 09b2 8091 0000 lds r24,Mittelwert_AccRoll |
1529 09b6 9091 0000 lds r25,(Mittelwert_AccRoll)+1 |
1530 09ba AC01 movw r20,r24 |
1531 09bc 440F lsl r20 |
1532 09be 551F rol r21 |
1533 09c0 480F add r20,r24 |
1534 09c2 591F adc r21,r25 |
1535 09c4 2091 0000 lds r18,AdWertAccRoll |
1536 09c8 3091 0000 lds r19,(AdWertAccRoll)+1 |
1537 09cc C901 movw r24,r18 |
1538 09ce 880F lsl r24 |
1539 09d0 991F rol r25 |
1540 09d2 880F lsl r24 |
1541 09d4 991F rol r25 |
1542 09d6 820F add r24,r18 |
1543 09d8 931F adc r25,r19 |
1544 09da 820F add r24,r18 |
1545 09dc 931F adc r25,r19 |
1546 09de 480F add r20,r24 |
1547 09e0 591F adc r21,r25 |
1548 09e2 57FF sbrs r21,7 |
1549 09e4 02C0 rjmp .L67 |
1550 09e6 4D5F subi r20,lo8(-(3)) |
1551 09e8 5F4F sbci r21,hi8(-(3)) |
1552 .L67: |
1553 09ea 5595 asr r21 |
1554 09ec 4795 ror r20 |
1555 09ee 5595 asr r21 |
1556 09f0 4795 ror r20 |
1557 09f2 5093 0000 sts (Mittelwert_AccRoll)+1,r21 |
1558 09f6 4093 0000 sts Mittelwert_AccRoll,r20 |
1559 09fa 2091 0000 lds r18,AdWertAccNick |
1560 09fe 3091 0000 lds r19,(AdWertAccNick)+1 |
1561 0a02 C901 movw r24,r18 |
1562 0a04 880F lsl r24 |
1563 0a06 991F rol r25 |
1564 0a08 880F lsl r24 |
1565 0a0a 991F rol r25 |
1566 0a0c 820F add r24,r18 |
1567 0a0e 931F adc r25,r19 |
1568 0a10 820F add r24,r18 |
1569 0a12 931F adc r25,r19 |
1570 0a14 9C01 movw r18,r24 |
1571 0a16 4427 clr r20 |
1572 0a18 37FD sbrc r19,7 |
1573 0a1a 4095 com r20 |
1574 0a1c 542F mov r21,r20 |
1575 0a1e 8091 0000 lds r24,IntegralAccNick |
1576 0a22 9091 0000 lds r25,(IntegralAccNick)+1 |
1577 0a26 A091 0000 lds r26,(IntegralAccNick)+2 |
1578 0a2a B091 0000 lds r27,(IntegralAccNick)+3 |
1579 0a2e 820F add r24,r18 |
1580 0a30 931F adc r25,r19 |
1581 0a32 A41F adc r26,r20 |
1582 0a34 B51F adc r27,r21 |
1583 0a36 8093 0000 sts IntegralAccNick,r24 |
1584 0a3a 9093 0000 sts (IntegralAccNick)+1,r25 |
1585 0a3e A093 0000 sts (IntegralAccNick)+2,r26 |
1586 0a42 B093 0000 sts (IntegralAccNick)+3,r27 |
1587 0a46 2091 0000 lds r18,AdWertAccRoll |
1588 0a4a 3091 0000 lds r19,(AdWertAccRoll)+1 |
1589 0a4e C901 movw r24,r18 |
1590 0a50 880F lsl r24 |
1591 0a52 991F rol r25 |
1592 0a54 880F lsl r24 |
1593 0a56 991F rol r25 |
1594 0a58 820F add r24,r18 |
1595 0a5a 931F adc r25,r19 |
1596 0a5c 820F add r24,r18 |
1597 0a5e 931F adc r25,r19 |
1598 0a60 9C01 movw r18,r24 |
1599 0a62 4427 clr r20 |
1600 0a64 37FD sbrc r19,7 |
1601 0a66 4095 com r20 |
1602 0a68 542F mov r21,r20 |
1603 0a6a 8091 0000 lds r24,IntegralAccRoll |
1604 0a6e 9091 0000 lds r25,(IntegralAccRoll)+1 |
1605 0a72 A091 0000 lds r26,(IntegralAccRoll)+2 |
1606 0a76 B091 0000 lds r27,(IntegralAccRoll)+3 |
1607 0a7a 820F add r24,r18 |
1608 0a7c 931F adc r25,r19 |
1609 0a7e A41F adc r26,r20 |
1610 0a80 B51F adc r27,r21 |
1611 0a82 8093 0000 sts IntegralAccRoll,r24 |
1612 0a86 9093 0000 sts (IntegralAccRoll)+1,r25 |
1613 0a8a A093 0000 sts (IntegralAccRoll)+2,r26 |
1614 0a8e B093 0000 sts (IntegralAccRoll)+3,r27 |
1615 0a92 8091 0000 lds r24,NaviAccNick |
1616 0a96 9091 0000 lds r25,(NaviAccNick)+1 |
1617 0a9a 2091 0000 lds r18,AdWertAccNick |
1618 0a9e 3091 0000 lds r19,(AdWertAccNick)+1 |
1619 0aa2 820F add r24,r18 |
1620 0aa4 931F adc r25,r19 |
1621 0aa6 9093 0000 sts (NaviAccNick)+1,r25 |
1622 0aaa 8093 0000 sts NaviAccNick,r24 |
1623 0aae 8091 0000 lds r24,NaviAccRoll |
1624 0ab2 9091 0000 lds r25,(NaviAccRoll)+1 |
1625 0ab6 2091 0000 lds r18,AdWertAccRoll |
1626 0aba 3091 0000 lds r19,(AdWertAccRoll)+1 |
1627 0abe 820F add r24,r18 |
1628 0ac0 931F adc r25,r19 |
1629 0ac2 9093 0000 sts (NaviAccRoll)+1,r25 |
1630 0ac6 8093 0000 sts NaviAccRoll,r24 |
1631 0aca 8091 0000 lds r24,NaviCntAcc |
1632 0ace 9091 0000 lds r25,(NaviCntAcc)+1 |
1633 0ad2 0196 adiw r24,1 |
1634 0ad4 9093 0000 sts (NaviCntAcc)+1,r25 |
1635 0ad8 8093 0000 sts NaviCntAcc,r24 |
1636 0adc 8091 0000 lds r24,Aktuell_az |
1637 0ae0 9091 0000 lds r25,(Aktuell_az)+1 |
1638 0ae4 2091 0000 lds r18,NeutralAccZ |
1639 0ae8 3091 0000 lds r19,(NeutralAccZ)+1 |
1640 0aec 821B sub r24,r18 |
1641 0aee 930B sbc r25,r19 |
1642 0af0 9C01 movw r18,r24 |
1643 0af2 4427 clr r20 |
1644 0af4 37FD sbrc r19,7 |
1645 0af6 4095 com r20 |
1646 0af8 542F mov r21,r20 |
1647 0afa 8091 0000 lds r24,IntegralAccZ |
1648 0afe 9091 0000 lds r25,(IntegralAccZ)+1 |
1649 0b02 A091 0000 lds r26,(IntegralAccZ)+2 |
1650 0b06 B091 0000 lds r27,(IntegralAccZ)+3 |
1651 0b0a 820F add r24,r18 |
1652 0b0c 931F adc r25,r19 |
1653 0b0e A41F adc r26,r20 |
1654 0b10 B51F adc r27,r21 |
1655 0b12 8093 0000 sts IntegralAccZ,r24 |
1656 0b16 9093 0000 sts (IntegralAccZ)+1,r25 |
1657 0b1a A093 0000 sts (IntegralAccZ)+2,r26 |
1658 0b1e B093 0000 sts (IntegralAccZ)+3,r27 |
1659 0b22 8FEC ldi r24,lo8(-49) |
1660 0b24 8093 7A00 sts 122,r24 |
1661 0b28 1092 0000 sts AdReady,__zero_reg__ |
1662 0b2c 2091 0000 lds r18,Mess_IntegralRoll |
1663 0b30 3091 0000 lds r19,(Mess_IntegralRoll)+1 |
1664 0b34 4091 0000 lds r20,(Mess_IntegralRoll)+2 |
1665 0b38 5091 0000 lds r21,(Mess_IntegralRoll)+3 |
1666 0b3c 2987 std Y+9,r18 |
1667 0b3e 3A87 std Y+10,r19 |
1668 0b40 4B87 std Y+11,r20 |
1669 0b42 5C87 std Y+12,r21 |
1670 0b44 2954 subi r18,lo8(93001) |
1671 0b46 3B46 sbci r19,hi8(93001) |
1672 0b48 4140 sbci r20,hlo8(93001) |
1673 0b4a 5040 sbci r21,hhi8(93001) |
1674 0b4c 2CF0 brlt .L68 |
1675 0b4e 28E4 ldi r18,lo8(93000) |
1676 0b50 3BE6 ldi r19,hi8(93000) |
1677 0b52 41E0 ldi r20,hlo8(93000) |
1678 0b54 50E0 ldi r21,hhi8(93000) |
1679 0b56 0DC0 rjmp .L161 |
1680 .L68: |
1681 0b58 8985 ldd r24,Y+9 |
1682 0b5a 9A85 ldd r25,Y+10 |
1683 0b5c AB85 ldd r26,Y+11 |
1684 0b5e BC85 ldd r27,Y+12 |
1685 0b60 885B subi r24,lo8(-93000) |
1686 0b62 9449 sbci r25,hi8(-93000) |
1687 0b64 AE4F sbci r26,hlo8(-93000) |
1688 0b66 BF4F sbci r27,hhi8(-93000) |
1689 0b68 4CF4 brge .L70 |
1690 0b6a 28EB ldi r18,lo8(-93000) |
1691 0b6c 34E9 ldi r19,hi8(-93000) |
1692 0b6e 4EEF ldi r20,hlo8(-93000) |
1693 0b70 5FEF ldi r21,hhi8(-93000) |
1694 .L161: |
1695 0b72 2D83 std Y+5,r18 |
1696 0b74 3E83 std Y+6,r19 |
1697 0b76 4F83 std Y+7,r20 |
1698 0b78 5887 std Y+8,r21 |
1699 0b7a 08C0 rjmp .L69 |
1700 .L70: |
1701 0b7c 8985 ldd r24,Y+9 |
1702 0b7e 9A85 ldd r25,Y+10 |
1703 0b80 AB85 ldd r26,Y+11 |
1704 0b82 BC85 ldd r27,Y+12 |
1705 0b84 8D83 std Y+5,r24 |
1706 0b86 9E83 std Y+6,r25 |
1707 0b88 AF83 std Y+7,r26 |
1708 0b8a B887 std Y+8,r27 |
1709 .L69: |
1710 0b8c 2091 0000 lds r18,Mess_IntegralNick |
1711 0b90 3091 0000 lds r19,(Mess_IntegralNick)+1 |
1712 0b94 4091 0000 lds r20,(Mess_IntegralNick)+2 |
1713 0b98 5091 0000 lds r21,(Mess_IntegralNick)+3 |
1714 0b9c 2D87 std Y+13,r18 |
1715 0b9e 3E87 std Y+14,r19 |
1716 0ba0 4F87 std Y+15,r20 |
1717 0ba2 588B std Y+16,r21 |
1718 0ba4 2954 subi r18,lo8(93001) |
1719 0ba6 3B46 sbci r19,hi8(93001) |
1720 0ba8 4140 sbci r20,hlo8(93001) |
1721 0baa 5040 sbci r21,hhi8(93001) |
1722 0bac 2CF0 brlt .L72 |
1723 0bae 28E4 ldi r18,lo8(93000) |
1724 0bb0 3BE6 ldi r19,hi8(93000) |
1725 0bb2 41E0 ldi r20,hlo8(93000) |
1726 0bb4 50E0 ldi r21,hhi8(93000) |
1727 0bb6 0DC0 rjmp .L162 |
1728 .L72: |
1729 0bb8 8D85 ldd r24,Y+13 |
1730 0bba 9E85 ldd r25,Y+14 |
1731 0bbc AF85 ldd r26,Y+15 |
1732 0bbe B889 ldd r27,Y+16 |
1733 0bc0 885B subi r24,lo8(-93000) |
1734 0bc2 9449 sbci r25,hi8(-93000) |
1735 0bc4 AE4F sbci r26,hlo8(-93000) |
1736 0bc6 BF4F sbci r27,hhi8(-93000) |
1737 0bc8 4CF4 brge .L74 |
1738 0bca 28EB ldi r18,lo8(-93000) |
1739 0bcc 34E9 ldi r19,hi8(-93000) |
1740 0bce 4EEF ldi r20,hlo8(-93000) |
1741 0bd0 5FEF ldi r21,hhi8(-93000) |
1742 .L162: |
1743 0bd2 2983 std Y+1,r18 |
1744 0bd4 3A83 std Y+2,r19 |
1745 0bd6 4B83 std Y+3,r20 |
1746 0bd8 5C83 std Y+4,r21 |
1747 0bda 08C0 rjmp .L73 |
1748 .L74: |
1749 0bdc 8D85 ldd r24,Y+13 |
1750 0bde 9E85 ldd r25,Y+14 |
1751 0be0 AF85 ldd r26,Y+15 |
1752 0be2 B889 ldd r27,Y+16 |
1753 0be4 8983 std Y+1,r24 |
1754 0be6 9A83 std Y+2,r25 |
1755 0be8 AB83 std Y+3,r26 |
1756 0bea BC83 std Y+4,r27 |
1757 .L73: |
1758 0bec A091 0000 lds r26,MesswertGier |
1759 0bf0 B091 0000 lds r27,(MesswertGier)+1 |
1760 0bf4 BB8B std Y+19,r27 |
1761 0bf6 AA8B std Y+18,r26 |
1762 0bf8 FD01 movw r30,r26 |
1763 0bfa CF01 movw r24,r30 |
1764 0bfc AA27 clr r26 |
1765 0bfe 97FD sbrc r25,7 |
1766 0c00 A095 com r26 |
1767 0c02 BA2F mov r27,r26 |
1768 0c04 A090 0000 lds r10,Mess_Integral_Gier |
1769 0c08 B090 0000 lds r11,(Mess_Integral_Gier)+1 |
1770 0c0c C090 0000 lds r12,(Mess_Integral_Gier)+2 |
1771 0c10 D090 0000 lds r13,(Mess_Integral_Gier)+3 |
1772 0c14 A80E add r10,r24 |
1773 0c16 B91E adc r11,r25 |
1774 0c18 CA1E adc r12,r26 |
1775 0c1a DB1E adc r13,r27 |
1776 0c1c A092 0000 sts Mess_Integral_Gier,r10 |
1777 0c20 B092 0000 sts (Mess_Integral_Gier)+1,r11 |
1778 0c24 C092 0000 sts (Mess_Integral_Gier)+2,r12 |
1779 0c28 D092 0000 sts (Mess_Integral_Gier)+3,r13 |
1780 0c2c E090 0000 lds r14,ErsatzKompass |
1781 0c30 F090 0000 lds r15,(ErsatzKompass)+1 |
1782 0c34 0091 0000 lds r16,(ErsatzKompass)+2 |
1783 0c38 1091 0000 lds r17,(ErsatzKompass)+3 |
1784 0c3c E80E add r14,r24 |
1785 0c3e F91E adc r15,r25 |
1786 0c40 0A1F adc r16,r26 |
1787 0c42 1B1F adc r17,r27 |
1788 0c44 E092 0000 sts ErsatzKompass,r14 |
1789 0c48 F092 0000 sts (ErsatzKompass)+1,r15 |
1790 0c4c 0093 0000 sts (ErsatzKompass)+2,r16 |
1791 0c50 1093 0000 sts (ErsatzKompass)+3,r17 |
1792 0c54 F091 0000 lds r31,Looping_Nick |
1793 0c58 F98B std Y+17,r31 |
1794 0c5a FF23 tst r31 |
1795 0c5c 09F0 breq .+2 |
1796 0c5e 98C1 rjmp .L76 |
1797 0c60 8091 0000 lds r24,Looping_Roll |
1798 0c64 8823 tst r24 |
1799 0c66 09F0 breq .+2 |
1800 0c68 93C1 rjmp .L76 |
1801 0c6a 8091 0000 lds r24,EE_Parameter+13 |
1802 0c6e 86FF sbrs r24,6 |
1803 0c70 8FC1 rjmp .L76 |
1804 0c72 8091 0000 lds r24,MesswertRoll |
1805 0c76 9091 0000 lds r25,(MesswertRoll)+1 |
1806 0c7a AA27 clr r26 |
1807 0c7c 97FD sbrc r25,7 |
1808 0c7e A095 com r26 |
1809 0c80 BA2F mov r27,r26 |
1810 0c82 BC01 movw r22,r24 |
1811 0c84 CD01 movw r24,r26 |
1812 0c86 2981 ldd r18,Y+1 |
1813 0c88 3A81 ldd r19,Y+2 |
1814 0c8a 4B81 ldd r20,Y+3 |
1815 0c8c 5C81 ldd r21,Y+4 |
1816 0c8e 0E94 0000 call __mulsi3 |
1817 0c92 9B01 movw r18,r22 |
1818 0c94 AC01 movw r20,r24 |
1819 0c96 97FF sbrs r25,7 |
1820 0c98 04C0 rjmp .L77 |
1821 0c9a 2150 subi r18,lo8(-(2047)) |
1822 0c9c 384F sbci r19,hi8(-(2047)) |
1823 0c9e 4F4F sbci r20,hlo8(-(2047)) |
1824 0ca0 5F4F sbci r21,hhi8(-(2047)) |
1825 .L77: |
1826 0ca2 6BE0 ldi r22,11 |
1827 0ca4 5595 1: asr r21 |
1828 0ca6 4795 ror r20 |
1829 0ca8 3795 ror r19 |
1830 0caa 2795 ror r18 |
1831 0cac 6A95 dec r22 |
1832 0cae D1F7 brne 1b |
1833 0cb0 8091 0000 lds r24,Parameter_AchsKopplung2 |
1834 0cb4 682E mov r6,r24 |
1835 0cb6 7724 clr r7 |
1836 0cb8 8824 clr r8 |
1837 0cba 9924 clr r9 |
1838 0cbc CA01 movw r24,r20 |
1839 0cbe B901 movw r22,r18 |
1840 0cc0 A401 movw r20,r8 |
1841 0cc2 9301 movw r18,r6 |
1842 0cc4 0E94 0000 call __mulsi3 |
1843 0cc8 DC01 movw r26,r24 |
1844 0cca CB01 movw r24,r22 |
1845 0ccc 8093 0000 sts tmpl3.34,r24 |
1846 0cd0 9093 0000 sts (tmpl3.34)+1,r25 |
1847 0cd4 A093 0000 sts (tmpl3.34)+2,r26 |
1848 0cd8 B093 0000 sts (tmpl3.34)+3,r27 |
1849 0cdc B7FF sbrs r27,7 |
1850 0cde 04C0 rjmp .L78 |
1851 0ce0 8150 subi r24,lo8(-(4095)) |
1852 0ce2 904F sbci r25,hi8(-(4095)) |
1853 0ce4 AF4F sbci r26,hlo8(-(4095)) |
1854 0ce6 BF4F sbci r27,hhi8(-(4095)) |
1855 .L78: |
1856 0ce8 1C01 movw r2,r24 |
1857 0cea 2D01 movw r4,r26 |
1858 0cec 3CE0 ldi r19,12 |
1859 0cee 5594 1: asr r5 |
1860 0cf0 4794 ror r4 |
1861 0cf2 3794 ror r3 |
1862 0cf4 2794 ror r2 |
1863 0cf6 3A95 dec r19 |
1864 0cf8 D1F7 brne 1b |
1865 0cfa 2092 0000 sts tmpl3.34,r2 |
1866 0cfe 3092 0000 sts (tmpl3.34)+1,r3 |
1867 0d02 4092 0000 sts (tmpl3.34)+2,r4 |
1868 0d06 5092 0000 sts (tmpl3.34)+3,r5 |
1869 0d0a 8091 0000 lds r24,MesswertNick |
1870 0d0e 9091 0000 lds r25,(MesswertNick)+1 |
1871 0d12 AA27 clr r26 |
1872 0d14 97FD sbrc r25,7 |
1873 0d16 A095 com r26 |
1874 0d18 BA2F mov r27,r26 |
1875 0d1a BC01 movw r22,r24 |
1876 0d1c CD01 movw r24,r26 |
1877 0d1e 2D81 ldd r18,Y+5 |
1878 0d20 3E81 ldd r19,Y+6 |
1879 0d22 4F81 ldd r20,Y+7 |
1880 0d24 5885 ldd r21,Y+8 |
1881 0d26 0E94 0000 call __mulsi3 |
1882 0d2a 97FF sbrs r25,7 |
1883 0d2c 04C0 rjmp .L79 |
1884 0d2e 6150 subi r22,lo8(-(2047)) |
1885 0d30 784F sbci r23,hi8(-(2047)) |
1886 0d32 8F4F sbci r24,hlo8(-(2047)) |
1887 0d34 9F4F sbci r25,hhi8(-(2047)) |
1888 .L79: |
1889 0d36 2BE0 ldi r18,11 |
1890 0d38 9595 1: asr r25 |
1891 0d3a 8795 ror r24 |
1892 0d3c 7795 ror r23 |
1893 0d3e 6795 ror r22 |
1894 0d40 2A95 dec r18 |
1895 0d42 D1F7 brne 1b |
1896 0d44 A401 movw r20,r8 |
1897 0d46 9301 movw r18,r6 |
1898 0d48 0E94 0000 call __mulsi3 |
1899 0d4c DC01 movw r26,r24 |
1900 0d4e CB01 movw r24,r22 |
1901 0d50 8093 0000 sts tmpl4.35,r24 |
1902 0d54 9093 0000 sts (tmpl4.35)+1,r25 |
1903 0d58 A093 0000 sts (tmpl4.35)+2,r26 |
1904 0d5c B093 0000 sts (tmpl4.35)+3,r27 |
1905 0d60 B7FF sbrs r27,7 |
1906 0d62 04C0 rjmp .L80 |
1907 0d64 8150 subi r24,lo8(-(4095)) |
1908 0d66 904F sbci r25,hi8(-(4095)) |
1909 0d68 AF4F sbci r26,hlo8(-(4095)) |
1910 0d6a BF4F sbci r27,hhi8(-(4095)) |
1911 .L80: |
1912 0d6c 9C01 movw r18,r24 |
1913 0d6e AD01 movw r20,r26 |
1914 0d70 8CE0 ldi r24,12 |
1915 0d72 5595 1: asr r21 |
1916 0d74 4795 ror r20 |
1917 0d76 3795 ror r19 |
1918 0d78 2795 ror r18 |
1919 0d7a 8A95 dec r24 |
1920 0d7c D1F7 brne 1b |
1921 0d7e 2093 0000 sts tmpl4.35,r18 |
1922 0d82 3093 0000 sts (tmpl4.35)+1,r19 |
1923 0d86 4093 0000 sts (tmpl4.35)+2,r20 |
1924 0d8a 5093 0000 sts (tmpl4.35)+3,r21 |
1925 0d8e 8091 0000 lds r24,tmpl3.34 |
1926 0d92 9091 0000 lds r25,(tmpl3.34)+1 |
1927 0d96 9093 0000 sts (KopplungsteilNickRoll)+1,r25 |
1928 0d9a 8093 0000 sts KopplungsteilNickRoll,r24 |
1929 0d9e 8091 0000 lds r24,tmpl4.35 |
1930 0da2 9091 0000 lds r25,(tmpl4.35)+1 |
1931 0da6 9093 0000 sts (KopplungsteilRollNick)+1,r25 |
1932 0daa 8093 0000 sts KopplungsteilRollNick,r24 |
1933 0dae 2219 sub r18,r2 |
1934 0db0 3309 sbc r19,r3 |
1935 0db2 4409 sbc r20,r4 |
1936 0db4 5509 sbc r21,r5 |
1937 0db6 2093 0000 sts tmpl4.35,r18 |
1938 0dba 3093 0000 sts (tmpl4.35)+1,r19 |
1939 0dbe 4093 0000 sts (tmpl4.35)+2,r20 |
1940 0dc2 5093 0000 sts (tmpl4.35)+3,r21 |
1941 0dc6 E20E add r14,r18 |
1942 0dc8 F31E adc r15,r19 |
1943 0dca 041F adc r16,r20 |
1944 0dcc 151F adc r17,r21 |
1945 0dce E092 0000 sts ErsatzKompass,r14 |
1946 0dd2 F092 0000 sts (ErsatzKompass)+1,r15 |
1947 0dd6 0093 0000 sts (ErsatzKompass)+2,r16 |
1948 0dda 1093 0000 sts (ErsatzKompass)+3,r17 |
1949 0dde 8091 0000 lds r24,Parameter_CouplingYawCorrection |
1950 0de2 8823 tst r24 |
1951 0de4 B1F4 brne .L81 |
1952 0de6 57FF sbrs r21,7 |
1953 0de8 04C0 rjmp .L82 |
1954 0dea 2F5F subi r18,lo8(-(1)) |
1955 0dec 3F4F sbci r19,hi8(-(1)) |
1956 0dee 4F4F sbci r20,hlo8(-(1)) |
1957 0df0 5F4F sbci r21,hhi8(-(1)) |
1958 .L82: |
1959 0df2 5595 asr r21 |
1960 0df4 4795 ror r20 |
1961 0df6 3795 ror r19 |
1962 0df8 2795 ror r18 |
1963 0dfa A21A sub r10,r18 |
1964 0dfc B30A sbc r11,r19 |
1965 0dfe C40A sbc r12,r20 |
1966 0e00 D50A sbc r13,r21 |
1967 0e02 A092 0000 sts Mess_Integral_Gier,r10 |
1968 0e06 B092 0000 sts (Mess_Integral_Gier)+1,r11 |
1969 0e0a C092 0000 sts (Mess_Integral_Gier)+2,r12 |
1970 0e0e D092 0000 sts (Mess_Integral_Gier)+3,r13 |
1971 .L81: |
1972 0e12 2A89 ldd r18,Y+18 |
1973 0e14 3B89 ldd r19,Y+19 |
1974 0e16 7901 movw r14,r18 |
1975 0e18 0027 clr r16 |
1976 0e1a F7FC sbrc r15,7 |
1977 0e1c 0095 com r16 |
1978 0e1e 102F mov r17,r16 |
1979 0e20 8091 0000 lds r24,tmpl4.35 |
1980 0e24 9091 0000 lds r25,(tmpl4.35)+1 |
1981 0e28 A091 0000 lds r26,(tmpl4.35)+2 |
1982 0e2c B091 0000 lds r27,(tmpl4.35)+3 |
1983 0e30 E80E add r14,r24 |
1984 0e32 F91E adc r15,r25 |
1985 0e34 0A1F adc r16,r26 |
1986 0e36 1B1F adc r17,r27 |
1987 0e38 C801 movw r24,r16 |
1988 0e3a B701 movw r22,r14 |
1989 0e3c 2981 ldd r18,Y+1 |
1990 0e3e 3A81 ldd r19,Y+2 |
1991 0e40 4B81 ldd r20,Y+3 |
1992 0e42 5C81 ldd r21,Y+4 |
1993 0e44 0E94 0000 call __mulsi3 |
1994 0e48 9B01 movw r18,r22 |
1995 0e4a AC01 movw r20,r24 |
1996 0e4c 97FF sbrs r25,7 |
1997 0e4e 04C0 rjmp .L83 |
1998 0e50 2150 subi r18,lo8(-(2047)) |
1999 0e52 384F sbci r19,hi8(-(2047)) |
2000 0e54 4F4F sbci r20,hlo8(-(2047)) |
2001 0e56 5F4F sbci r21,hhi8(-(2047)) |
2002 .L83: |
2003 0e58 BBE0 ldi r27,11 |
2004 0e5a 5595 1: asr r21 |
2005 0e5c 4795 ror r20 |
2006 0e5e 3795 ror r19 |
2007 0e60 2795 ror r18 |
2008 0e62 BA95 dec r27 |
2009 0e64 D1F7 brne 1b |
2010 0e66 8091 0000 lds r24,Parameter_AchsKopplung1 |
2011 0e6a A82E mov r10,r24 |
2012 0e6c BB24 clr r11 |
2013 0e6e CC24 clr r12 |
2014 0e70 DD24 clr r13 |
2015 0e72 CA01 movw r24,r20 |
2016 0e74 B901 movw r22,r18 |
2017 0e76 A601 movw r20,r12 |
2018 0e78 9501 movw r18,r10 |
2019 0e7a 0E94 0000 call __mulsi3 |
2020 0e7e DC01 movw r26,r24 |
2021 0e80 CB01 movw r24,r22 |
2022 0e82 8093 0000 sts tmpl.32,r24 |
2023 0e86 9093 0000 sts (tmpl.32)+1,r25 |
2024 0e8a A093 0000 sts (tmpl.32)+2,r26 |
2025 0e8e B093 0000 sts (tmpl.32)+3,r27 |
2026 0e92 B7FF sbrs r27,7 |
2027 0e94 04C0 rjmp .L84 |
2028 0e96 8150 subi r24,lo8(-(4095)) |
2029 0e98 904F sbci r25,hi8(-(4095)) |
2030 0e9a AF4F sbci r26,hlo8(-(4095)) |
2031 0e9c BF4F sbci r27,hhi8(-(4095)) |
2032 .L84: |
2033 0e9e 3C01 movw r6,r24 |
2034 0ea0 4D01 movw r8,r26 |
2035 0ea2 ACE0 ldi r26,12 |
2036 0ea4 9594 1: asr r9 |
2037 0ea6 8794 ror r8 |
2038 0ea8 7794 ror r7 |
2039 0eaa 6794 ror r6 |
2040 0eac AA95 dec r26 |
2041 0eae D1F7 brne 1b |
2042 0eb0 6092 0000 sts tmpl.32,r6 |
2043 0eb4 7092 0000 sts (tmpl.32)+1,r7 |
2044 0eb8 8092 0000 sts (tmpl.32)+2,r8 |
2045 0ebc 9092 0000 sts (tmpl.32)+3,r9 |
2046 0ec0 C801 movw r24,r16 |
2047 0ec2 B701 movw r22,r14 |
2048 0ec4 2D81 ldd r18,Y+5 |
2049 0ec6 3E81 ldd r19,Y+6 |
2050 0ec8 4F81 ldd r20,Y+7 |
2051 0eca 5885 ldd r21,Y+8 |
2052 0ecc 0E94 0000 call __mulsi3 |
2053 0ed0 97FF sbrs r25,7 |
2054 0ed2 04C0 rjmp .L85 |
2055 0ed4 6150 subi r22,lo8(-(2047)) |
2056 0ed6 784F sbci r23,hi8(-(2047)) |
2057 0ed8 8F4F sbci r24,hlo8(-(2047)) |
2058 0eda 9F4F sbci r25,hhi8(-(2047)) |
2059 .L85: |
2060 0edc FBE0 ldi r31,11 |
2061 0ede 9595 1: asr r25 |
2062 0ee0 8795 ror r24 |
2063 0ee2 7795 ror r23 |
2064 0ee4 6795 ror r22 |
2065 0ee6 FA95 dec r31 |
2066 0ee8 D1F7 brne 1b |
2067 0eea A601 movw r20,r12 |
2068 0eec 9501 movw r18,r10 |
2069 0eee 0E94 0000 call __mulsi3 |
2070 0ef2 DC01 movw r26,r24 |
2071 0ef4 CB01 movw r24,r22 |
2072 0ef6 8093 0000 sts tmpl2.33,r24 |
2073 0efa 9093 0000 sts (tmpl2.33)+1,r25 |
2074 0efe A093 0000 sts (tmpl2.33)+2,r26 |
2075 0f02 B093 0000 sts (tmpl2.33)+3,r27 |
2076 0f06 B7FF sbrs r27,7 |
2077 0f08 04C0 rjmp .L86 |
2078 0f0a 8150 subi r24,lo8(-(4095)) |
2079 0f0c 904F sbci r25,hi8(-(4095)) |
2080 0f0e AF4F sbci r26,hlo8(-(4095)) |
2081 0f10 BF4F sbci r27,hhi8(-(4095)) |
2082 .L86: |
2083 0f12 AC01 movw r20,r24 |
2084 0f14 BD01 movw r22,r26 |
2085 0f16 ECE0 ldi r30,12 |
2086 0f18 7595 1: asr r23 |
2087 0f1a 6795 ror r22 |
2088 0f1c 5795 ror r21 |
2089 0f1e 4795 ror r20 |
2090 0f20 EA95 dec r30 |
2091 0f22 D1F7 brne 1b |
2092 0f24 4093 0000 sts tmpl2.33,r20 |
2093 0f28 5093 0000 sts (tmpl2.33)+1,r21 |
2094 0f2c 6093 0000 sts (tmpl2.33)+2,r22 |
2095 0f30 7093 0000 sts (tmpl2.33)+3,r23 |
2096 0f34 2A89 ldd r18,Y+18 |
2097 0f36 3B89 ldd r19,Y+19 |
2098 0f38 37FF sbrs r19,7 |
2099 0f3a 03C0 rjmp .L88 |
2100 0f3c 3095 com r19 |
2101 0f3e 2195 neg r18 |
2102 0f40 3F4F sbci r19,lo8(-1) |
2103 .L88: |
2104 0f42 2134 cpi r18,65 |
2105 0f44 3105 cpc r19,__zero_reg__ |
2106 0f46 E4F1 brlt .L93 |
2107 0f48 D401 movw r26,r8 |
2108 0f4a C301 movw r24,r6 |
2109 0f4c 97FE sbrs r9,7 |
2110 0f4e 07C0 rjmp .L91 |
2111 0f50 B095 com r27 |
2112 0f52 A095 com r26 |
2113 0f54 9095 com r25 |
2114 0f56 8195 neg r24 |
2115 0f58 9F4F sbci r25,lo8(-1) |
2116 0f5a AF4F sbci r26,lo8(-1) |
2117 0f5c BF4F sbci r27,lo8(-1) |
2118 .L91: |
2119 0f5e 8138 cpi r24,lo8(129) |
2120 0f60 9105 cpc r25,__zero_reg__ |
2121 0f62 A105 cpc r26,__zero_reg__ |
2122 0f64 B105 cpc r27,__zero_reg__ |
2123 0f66 84F4 brge .L90 |
2124 0f68 DB01 movw r26,r22 |
2125 0f6a CA01 movw r24,r20 |
2126 0f6c 77FF sbrs r23,7 |
2127 0f6e 07C0 rjmp .L92 |
2128 0f70 B095 com r27 |
2129 0f72 A095 com r26 |
2130 0f74 9095 com r25 |
2131 0f76 8195 neg r24 |
2132 0f78 9F4F sbci r25,lo8(-1) |
2133 0f7a AF4F sbci r26,lo8(-1) |
2134 0f7c BF4F sbci r27,lo8(-1) |
2135 .L92: |
2136 0f7e 8138 cpi r24,lo8(129) |
2137 0f80 9105 cpc r25,__zero_reg__ |
2138 0f82 A105 cpc r26,__zero_reg__ |
2139 0f84 B105 cpc r27,__zero_reg__ |
2140 0f86 E4F0 brlt .L93 |
2141 .L90: |
2142 0f88 81E0 ldi r24,lo8(1) |
2143 0f8a 8093 0000 sts TrichterFlug,r24 |
2144 0f8e 18C0 rjmp .L93 |
2145 .L76: |
2146 0f90 1092 0000 sts (KopplungsteilRollNick)+1,__zero_reg__ |
2147 0f94 1092 0000 sts KopplungsteilRollNick,__zero_reg__ |
2148 0f98 1092 0000 sts (KopplungsteilNickRoll)+1,__zero_reg__ |
2149 0f9c 1092 0000 sts KopplungsteilNickRoll,__zero_reg__ |
2150 0fa0 1092 0000 sts tmpl2.33,__zero_reg__ |
2151 0fa4 1092 0000 sts (tmpl2.33)+1,__zero_reg__ |
2152 0fa8 1092 0000 sts (tmpl2.33)+2,__zero_reg__ |
2153 0fac 1092 0000 sts (tmpl2.33)+3,__zero_reg__ |
2154 0fb0 1092 0000 sts tmpl.32,__zero_reg__ |
2155 0fb4 1092 0000 sts (tmpl.32)+1,__zero_reg__ |
2156 0fb8 1092 0000 sts (tmpl.32)+2,__zero_reg__ |
2157 0fbc 1092 0000 sts (tmpl.32)+3,__zero_reg__ |
2158 .L93: |
2159 0fc0 8091 0000 lds r24,tmpl2.33 |
2160 0fc4 9091 0000 lds r25,(tmpl2.33)+1 |
2161 0fc8 A091 0000 lds r26,(tmpl2.33)+2 |
2162 0fcc B091 0000 lds r27,(tmpl2.33)+3 |
2163 0fd0 BC01 movw r22,r24 |
2164 0fd2 CD01 movw r24,r26 |
2165 0fd4 24E6 ldi r18,lo8(100) |
2166 0fd6 30E0 ldi r19,hi8(100) |
2167 0fd8 40E0 ldi r20,hlo8(100) |
2168 0fda 50E0 ldi r21,hhi8(100) |
2169 0fdc 0E94 0000 call __divmodsi4 |
2170 0fe0 E090 0000 lds r14,tmpl.32 |
2171 0fe4 F090 0000 lds r15,(tmpl.32)+1 |
2172 0fe8 E21A sub r14,r18 |
2173 0fea F30A sbc r15,r19 |
2174 0fec F092 0000 sts (TrimRoll)+1,r15 |
2175 0ff0 E092 0000 sts TrimRoll,r14 |
2176 0ff4 8091 0000 lds r24,tmpl.32 |
2177 0ff8 9091 0000 lds r25,(tmpl.32)+1 |
2178 0ffc A091 0000 lds r26,(tmpl.32)+2 |
2179 1000 B091 0000 lds r27,(tmpl.32)+3 |
2180 1004 BC01 movw r22,r24 |
2181 1006 CD01 movw r24,r26 |
2182 1008 24E6 ldi r18,lo8(100) |
2183 100a 30E0 ldi r19,hi8(100) |
2184 100c 40E0 ldi r20,hlo8(100) |
2185 100e 50E0 ldi r21,hhi8(100) |
2186 1010 0E94 0000 call __divmodsi4 |
2187 1014 DA01 movw r26,r20 |
2188 1016 C901 movw r24,r18 |
2189 1018 2091 0000 lds r18,tmpl2.33 |
2190 101c 3091 0000 lds r19,(tmpl2.33)+1 |
2191 1020 8C01 movw r16,r24 |
2192 1022 021B sub r16,r18 |
2193 1024 130B sbc r17,r19 |
2194 1026 1093 0000 sts (TrimNick)+1,r17 |
2195 102a 0093 0000 sts TrimNick,r16 |
2196 102e 8091 0000 lds r24,GIER_GRAD_FAKTOR |
2197 1032 9091 0000 lds r25,(GIER_GRAD_FAKTOR)+1 |
2198 1036 A091 0000 lds r26,(GIER_GRAD_FAKTOR)+2 |
2199 103a B091 0000 lds r27,(GIER_GRAD_FAKTOR)+3 |
2200 103e BC01 movw r22,r24 |
2201 1040 CD01 movw r24,r26 |
2202 1042 28E6 ldi r18,lo8(360) |
2203 1044 31E0 ldi r19,hi8(360) |
2204 1046 40E0 ldi r20,hlo8(360) |
2205 1048 50E0 ldi r21,hhi8(360) |
2206 104a 0E94 0000 call __mulsi3 |
2207 104e 2091 0000 lds r18,ErsatzKompass |
2208 1052 3091 0000 lds r19,(ErsatzKompass)+1 |
2209 1056 4091 0000 lds r20,(ErsatzKompass)+2 |
2210 105a 5091 0000 lds r21,(ErsatzKompass)+3 |
2211 105e 2617 cp r18,r22 |
2212 1060 3707 cpc r19,r23 |
2213 1062 4807 cpc r20,r24 |
2214 1064 5907 cpc r21,r25 |
2215 1066 64F0 brlt .L94 |
2216 1068 261B sub r18,r22 |
2217 106a 370B sbc r19,r23 |
2218 106c 480B sbc r20,r24 |
2219 106e 590B sbc r21,r25 |
2220 1070 2093 0000 sts ErsatzKompass,r18 |
2221 1074 3093 0000 sts (ErsatzKompass)+1,r19 |
2222 1078 4093 0000 sts (ErsatzKompass)+2,r20 |
2223 107c 5093 0000 sts (ErsatzKompass)+3,r21 |
2224 .L94: |
2225 1080 2091 0000 lds r18,ErsatzKompass |
2226 1084 3091 0000 lds r19,(ErsatzKompass)+1 |
2227 1088 4091 0000 lds r20,(ErsatzKompass)+2 |
2228 108c 5091 0000 lds r21,(ErsatzKompass)+3 |
2229 1090 57FF sbrs r21,7 |
2230 1092 0CC0 rjmp .L95 |
2231 1094 260F add r18,r22 |
2232 1096 371F adc r19,r23 |
2233 1098 481F adc r20,r24 |
2234 109a 591F adc r21,r25 |
2235 109c 2093 0000 sts ErsatzKompass,r18 |
2236 10a0 3093 0000 sts (ErsatzKompass)+1,r19 |
2237 10a4 4093 0000 sts (ErsatzKompass)+2,r20 |
2238 10a8 5093 0000 sts (ErsatzKompass)+3,r21 |
2239 .L95: |
2240 10ac 6091 0000 lds r22,MesswertRoll |
2241 10b0 7091 0000 lds r23,(MesswertRoll)+1 |
2242 10b4 6E0D add r22,r14 |
2243 10b6 7F1D adc r23,r15 |
2244 10b8 9B01 movw r18,r22 |
2245 10ba 4427 clr r20 |
2246 10bc 37FD sbrc r19,7 |
2247 10be 4095 com r20 |
2248 10c0 542F mov r21,r20 |
2249 10c2 8091 0000 lds r24,Mess_IntegralRoll2 |
2250 10c6 9091 0000 lds r25,(Mess_IntegralRoll2)+1 |
2251 10ca A091 0000 lds r26,(Mess_IntegralRoll2)+2 |
2252 10ce B091 0000 lds r27,(Mess_IntegralRoll2)+3 |
2253 10d2 820F add r24,r18 |
2254 10d4 931F adc r25,r19 |
2255 10d6 A41F adc r26,r20 |
2256 10d8 B51F adc r27,r21 |
2257 10da 8093 0000 sts Mess_IntegralRoll2,r24 |
2258 10de 9093 0000 sts (Mess_IntegralRoll2)+1,r25 |
2259 10e2 A093 0000 sts (Mess_IntegralRoll2)+2,r26 |
2260 10e6 B093 0000 sts (Mess_IntegralRoll2)+3,r27 |
2261 10ea 8091 0000 lds r24,LageKorrekturRoll |
2262 10ee 9091 0000 lds r25,(LageKorrekturRoll)+1 |
2263 10f2 681B sub r22,r24 |
2264 10f4 790B sbc r23,r25 |
2265 10f6 CB01 movw r24,r22 |
2266 10f8 AA27 clr r26 |
2267 10fa 97FD sbrc r25,7 |
2268 10fc A095 com r26 |
2269 10fe BA2F mov r27,r26 |
2270 1100 2985 ldd r18,Y+9 |
2271 1102 3A85 ldd r19,Y+10 |
2272 1104 4B85 ldd r20,Y+11 |
2273 1106 5C85 ldd r21,Y+12 |
2274 1108 820F add r24,r18 |
2275 110a 931F adc r25,r19 |
2276 110c A41F adc r26,r20 |
2277 110e B51F adc r27,r21 |
2278 1110 8093 0000 sts Mess_IntegralRoll,r24 |
2279 1114 9093 0000 sts (Mess_IntegralRoll)+1,r25 |
2280 1118 A093 0000 sts (Mess_IntegralRoll)+2,r26 |
2281 111c B093 0000 sts (Mess_IntegralRoll)+3,r27 |
2282 1120 C090 0000 lds r12,Umschlag180Roll |
2283 1124 D090 0000 lds r13,(Umschlag180Roll)+1 |
2284 1128 E090 0000 lds r14,(Umschlag180Roll)+2 |
2285 112c F090 0000 lds r15,(Umschlag180Roll)+3 |
2286 1130 C816 cp r12,r24 |
2287 1132 D906 cpc r13,r25 |
2288 1134 EA06 cpc r14,r26 |
2289 1136 FB06 cpc r15,r27 |
2290 1138 C4F4 brge .L96 |
2291 113a 88EA ldi r24,lo8(25000) |
2292 113c 91E6 ldi r25,hi8(25000) |
2293 113e A0E0 ldi r26,hlo8(25000) |
2294 1140 B0E0 ldi r27,hhi8(25000) |
2295 1142 8C19 sub r24,r12 |
2296 1144 9D09 sbc r25,r13 |
2297 1146 AE09 sbc r26,r14 |
2298 1148 BF09 sbc r27,r15 |
2299 114a 8093 0000 sts Mess_IntegralRoll,r24 |
2300 114e 9093 0000 sts (Mess_IntegralRoll)+1,r25 |
2301 1152 A093 0000 sts (Mess_IntegralRoll)+2,r26 |
2302 1156 B093 0000 sts (Mess_IntegralRoll)+3,r27 |
2303 115a 8093 0000 sts Mess_IntegralRoll2,r24 |
2304 115e 9093 0000 sts (Mess_IntegralRoll2)+1,r25 |
2305 1162 A093 0000 sts (Mess_IntegralRoll2)+2,r26 |
2306 1166 B093 0000 sts (Mess_IntegralRoll2)+3,r27 |
2307 .L96: |
2308 116a 2227 clr r18 |
2309 116c 3327 clr r19 |
2310 116e A901 movw r20,r18 |
2311 1170 2C19 sub r18,r12 |
2312 1172 3D09 sbc r19,r13 |
2313 1174 4E09 sbc r20,r14 |
2314 1176 5F09 sbc r21,r15 |
2315 1178 8091 0000 lds r24,Mess_IntegralRoll |
2316 117c 9091 0000 lds r25,(Mess_IntegralRoll)+1 |
2317 1180 A091 0000 lds r26,(Mess_IntegralRoll)+2 |
2318 1184 B091 0000 lds r27,(Mess_IntegralRoll)+3 |
2319 1188 8217 cp r24,r18 |
2320 118a 9307 cpc r25,r19 |
2321 118c A407 cpc r26,r20 |
2322 118e B507 cpc r27,r21 |
2323 1190 B4F4 brge .L97 |
2324 1192 D701 movw r26,r14 |
2325 1194 C601 movw r24,r12 |
2326 1196 885A subi r24,lo8(-(-25000)) |
2327 1198 9146 sbci r25,hi8(-(-25000)) |
2328 119a A040 sbci r26,hlo8(-(-25000)) |
2329 119c B040 sbci r27,hhi8(-(-25000)) |
2330 119e 8093 0000 sts Mess_IntegralRoll,r24 |
2331 11a2 9093 0000 sts (Mess_IntegralRoll)+1,r25 |
2332 11a6 A093 0000 sts (Mess_IntegralRoll)+2,r26 |
2333 11aa B093 0000 sts (Mess_IntegralRoll)+3,r27 |
2334 11ae 8093 0000 sts Mess_IntegralRoll2,r24 |
2335 11b2 9093 0000 sts (Mess_IntegralRoll2)+1,r25 |
2336 11b6 A093 0000 sts (Mess_IntegralRoll2)+2,r26 |
2337 11ba B093 0000 sts (Mess_IntegralRoll2)+3,r27 |
2338 .L97: |
2339 11be 6091 0000 lds r22,MesswertNick |
2340 11c2 7091 0000 lds r23,(MesswertNick)+1 |
2341 11c6 600F add r22,r16 |
2342 11c8 711F adc r23,r17 |
2343 11ca 9B01 movw r18,r22 |
2344 11cc 4427 clr r20 |
2345 11ce 37FD sbrc r19,7 |
2346 11d0 4095 com r20 |
2347 11d2 542F mov r21,r20 |
2348 11d4 8091 0000 lds r24,Mess_IntegralNick2 |
2349 11d8 9091 0000 lds r25,(Mess_IntegralNick2)+1 |
2350 11dc A091 0000 lds r26,(Mess_IntegralNick2)+2 |
2351 11e0 B091 0000 lds r27,(Mess_IntegralNick2)+3 |
2352 11e4 820F add r24,r18 |
2353 11e6 931F adc r25,r19 |
2354 11e8 A41F adc r26,r20 |
2355 11ea B51F adc r27,r21 |
2356 11ec 8093 0000 sts Mess_IntegralNick2,r24 |
2357 11f0 9093 0000 sts (Mess_IntegralNick2)+1,r25 |
2358 11f4 A093 0000 sts (Mess_IntegralNick2)+2,r26 |
2359 11f8 B093 0000 sts (Mess_IntegralNick2)+3,r27 |
2360 11fc 8091 0000 lds r24,LageKorrekturNick |
2361 1200 9091 0000 lds r25,(LageKorrekturNick)+1 |
2362 1204 681B sub r22,r24 |
2363 1206 790B sbc r23,r25 |
2364 1208 CB01 movw r24,r22 |
2365 120a AA27 clr r26 |
2366 120c 97FD sbrc r25,7 |
2367 120e A095 com r26 |
2368 1210 BA2F mov r27,r26 |
2369 1212 2D85 ldd r18,Y+13 |
2370 1214 3E85 ldd r19,Y+14 |
2371 1216 4F85 ldd r20,Y+15 |
2372 1218 5889 ldd r21,Y+16 |
2373 121a 820F add r24,r18 |
2374 121c 931F adc r25,r19 |
2375 121e A41F adc r26,r20 |
2376 1220 B51F adc r27,r21 |
2377 1222 8093 0000 sts Mess_IntegralNick,r24 |
2378 1226 9093 0000 sts (Mess_IntegralNick)+1,r25 |
2379 122a A093 0000 sts (Mess_IntegralNick)+2,r26 |
2380 122e B093 0000 sts (Mess_IntegralNick)+3,r27 |
2381 1232 E090 0000 lds r14,Umschlag180Nick |
2382 1236 F090 0000 lds r15,(Umschlag180Nick)+1 |
2383 123a 0091 0000 lds r16,(Umschlag180Nick)+2 |
2384 123e 1091 0000 lds r17,(Umschlag180Nick)+3 |
2385 1242 E816 cp r14,r24 |
2386 1244 F906 cpc r15,r25 |
2387 1246 0A07 cpc r16,r26 |
2388 1248 1B07 cpc r17,r27 |
2389 124a C4F4 brge .L98 |
2390 124c 88EA ldi r24,lo8(25000) |
2391 124e 91E6 ldi r25,hi8(25000) |
2392 1250 A0E0 ldi r26,hlo8(25000) |
2393 1252 B0E0 ldi r27,hhi8(25000) |
2394 1254 8E19 sub r24,r14 |
2395 1256 9F09 sbc r25,r15 |
2396 1258 A00B sbc r26,r16 |
2397 125a B10B sbc r27,r17 |
2398 125c 8093 0000 sts Mess_IntegralNick,r24 |
2399 1260 9093 0000 sts (Mess_IntegralNick)+1,r25 |
2400 1264 A093 0000 sts (Mess_IntegralNick)+2,r26 |
2401 1268 B093 0000 sts (Mess_IntegralNick)+3,r27 |
2402 126c 8093 0000 sts Mess_IntegralNick2,r24 |
2403 1270 9093 0000 sts (Mess_IntegralNick2)+1,r25 |
2404 1274 A093 0000 sts (Mess_IntegralNick2)+2,r26 |
2405 1278 B093 0000 sts (Mess_IntegralNick2)+3,r27 |
2406 .L98: |
2407 127c 2227 clr r18 |
2408 127e 3327 clr r19 |
2409 1280 A901 movw r20,r18 |
2410 1282 2E19 sub r18,r14 |
2411 1284 3F09 sbc r19,r15 |
2412 1286 400B sbc r20,r16 |
2413 1288 510B sbc r21,r17 |
2414 128a 8091 0000 lds r24,Mess_IntegralNick |
2415 128e 9091 0000 lds r25,(Mess_IntegralNick)+1 |
2416 1292 A091 0000 lds r26,(Mess_IntegralNick)+2 |
2417 1296 B091 0000 lds r27,(Mess_IntegralNick)+3 |
2418 129a 8217 cp r24,r18 |
2419 129c 9307 cpc r25,r19 |
2420 129e A407 cpc r26,r20 |
2421 12a0 B507 cpc r27,r21 |
2422 12a2 B4F4 brge .L99 |
2423 12a4 D801 movw r26,r16 |
2424 12a6 C701 movw r24,r14 |
2425 12a8 885A subi r24,lo8(-(-25000)) |
2426 12aa 9146 sbci r25,hi8(-(-25000)) |
2427 12ac A040 sbci r26,hlo8(-(-25000)) |
2428 12ae B040 sbci r27,hhi8(-(-25000)) |
2429 12b0 8093 0000 sts Mess_IntegralNick,r24 |
2430 12b4 9093 0000 sts (Mess_IntegralNick)+1,r25 |
2431 12b8 A093 0000 sts (Mess_IntegralNick)+2,r26 |
2432 12bc B093 0000 sts (Mess_IntegralNick)+3,r27 |
2433 12c0 8093 0000 sts Mess_IntegralNick2,r24 |
2434 12c4 9093 0000 sts (Mess_IntegralNick2)+1,r25 |
2435 12c8 A093 0000 sts (Mess_IntegralNick2)+2,r26 |
2436 12cc B093 0000 sts (Mess_IntegralNick2)+3,r27 |
2437 .L99: |
2438 12d0 8091 0000 lds r24,Mess_Integral_Gier |
2439 12d4 9091 0000 lds r25,(Mess_Integral_Gier)+1 |
2440 12d8 A091 0000 lds r26,(Mess_Integral_Gier)+2 |
2441 12dc B091 0000 lds r27,(Mess_Integral_Gier)+3 |
2442 12e0 8093 0000 sts Integral_Gier,r24 |
2443 12e4 9093 0000 sts (Integral_Gier)+1,r25 |
2444 12e8 A093 0000 sts (Integral_Gier)+2,r26 |
2445 12ec B093 0000 sts (Integral_Gier)+3,r27 |
2446 12f0 8091 0000 lds r24,Mess_IntegralNick |
2447 12f4 9091 0000 lds r25,(Mess_IntegralNick)+1 |
2448 12f8 A091 0000 lds r26,(Mess_IntegralNick)+2 |
2449 12fc B091 0000 lds r27,(Mess_IntegralNick)+3 |
2450 1300 8093 0000 sts IntegralNick,r24 |
2451 1304 9093 0000 sts (IntegralNick)+1,r25 |
2452 1308 A093 0000 sts (IntegralNick)+2,r26 |
2453 130c B093 0000 sts (IntegralNick)+3,r27 |
2454 1310 8091 0000 lds r24,Mess_IntegralRoll |
2455 1314 9091 0000 lds r25,(Mess_IntegralRoll)+1 |
2456 1318 A091 0000 lds r26,(Mess_IntegralRoll)+2 |
2457 131c B091 0000 lds r27,(Mess_IntegralRoll)+3 |
2458 1320 8093 0000 sts IntegralRoll,r24 |
2459 1324 9093 0000 sts (IntegralRoll)+1,r25 |
2460 1328 A093 0000 sts (IntegralRoll)+2,r26 |
2461 132c B093 0000 sts (IntegralRoll)+3,r27 |
2462 1330 8091 0000 lds r24,Mess_IntegralNick2 |
2463 1334 9091 0000 lds r25,(Mess_IntegralNick2)+1 |
2464 1338 A091 0000 lds r26,(Mess_IntegralNick2)+2 |
2465 133c B091 0000 lds r27,(Mess_IntegralNick2)+3 |
2466 1340 8093 0000 sts IntegralNick2,r24 |
2467 1344 9093 0000 sts (IntegralNick2)+1,r25 |
2468 1348 A093 0000 sts (IntegralNick2)+2,r26 |
2469 134c B093 0000 sts (IntegralNick2)+3,r27 |
2470 1350 8091 0000 lds r24,Mess_IntegralRoll2 |
2471 1354 9091 0000 lds r25,(Mess_IntegralRoll2)+1 |
2472 1358 A091 0000 lds r26,(Mess_IntegralRoll2)+2 |
2473 135c B091 0000 lds r27,(Mess_IntegralRoll2)+3 |
2474 1360 8093 0000 sts IntegralRoll2,r24 |
2475 1364 9093 0000 sts (IntegralRoll2)+1,r25 |
2476 1368 A093 0000 sts (IntegralRoll2)+2,r26 |
2477 136c B093 0000 sts (IntegralRoll2)+3,r27 |
2478 1370 8091 0000 lds r24,HiResNick |
2479 1374 9091 0000 lds r25,(HiResNick)+1 |
2480 1378 97FD sbrc r25,7 |
2481 137a 0796 adiw r24,7 |
2482 .L100: |
2483 137c 33E0 ldi r19,3 |
2484 137e 9595 1: asr r25 |
2485 1380 8795 ror r24 |
2486 1382 3A95 dec r19 |
2487 1384 E1F7 brne 1b |
2488 1386 9093 0000 sts (MesswertNick)+1,r25 |
2489 138a 8093 0000 sts MesswertNick,r24 |
2490 138e 8091 0000 lds r24,HiResRoll |
2491 1392 9091 0000 lds r25,(HiResRoll)+1 |
2492 1396 97FD sbrc r25,7 |
2493 1398 0796 adiw r24,7 |
2494 .L101: |
2495 139a 23E0 ldi r18,3 |
2496 139c 9595 1: asr r25 |
2497 139e 8795 ror r24 |
2498 13a0 2A95 dec r18 |
2499 13a2 E1F7 brne 1b |
2500 13a4 9093 0000 sts (MesswertRoll)+1,r25 |
2501 13a8 8093 0000 sts MesswertRoll,r24 |
2502 13ac 8091 0000 lds r24,AdWertNick |
2503 13b0 9091 0000 lds r25,(AdWertNick)+1 |
2504 13b4 0F97 sbiw r24,15 |
2505 13b6 34F4 brge .L102 |
2506 13b8 88E1 ldi r24,lo8(-1000) |
2507 13ba 9CEF ldi r25,hi8(-1000) |
2508 13bc 9093 0000 sts (MesswertNick)+1,r25 |
2509 13c0 8093 0000 sts MesswertNick,r24 |
2510 .L102: |
2511 13c4 8091 0000 lds r24,AdWertNick |
2512 13c8 9091 0000 lds r25,(AdWertNick)+1 |
2513 13cc 0797 sbiw r24,7 |
2514 13ce 34F4 brge .L103 |
2515 13d0 80E3 ldi r24,lo8(-2000) |
2516 13d2 98EF ldi r25,hi8(-2000) |
2517 13d4 9093 0000 sts (MesswertNick)+1,r25 |
2518 13d8 8093 0000 sts MesswertNick,r24 |
2519 .L103: |
2520 13dc 2091 0000 lds r18,PlatinenVersion |
2521 13e0 2A30 cpi r18,lo8(10) |
2522 13e2 A9F4 brne .L104 |
2523 13e4 8091 0000 lds r24,AdWertNick |
2524 13e8 9091 0000 lds r25,(AdWertNick)+1 |
2525 13ec 835F subi r24,lo8(1011) |
2526 13ee 9340 sbci r25,hi8(1011) |
2527 13f0 34F0 brlt .L105 |
2528 13f2 88EE ldi r24,lo8(1000) |
2529 13f4 93E0 ldi r25,hi8(1000) |
2530 13f6 9093 0000 sts (MesswertNick)+1,r25 |
2531 13fa 8093 0000 sts MesswertNick,r24 |
2532 .L105: |
2533 13fe 8091 0000 lds r24,AdWertNick |
2534 1402 9091 0000 lds r25,(AdWertNick)+1 |
2535 1406 8A5F subi r24,lo8(1018) |
2536 1408 9340 sbci r25,hi8(1018) |
2537 140a DCF0 brlt .L107 |
2538 140c 14C0 rjmp .L163 |
2539 .L104: |
2540 140e 8091 0000 lds r24,AdWertNick |
2541 1412 9091 0000 lds r25,(AdWertNick)+1 |
2542 1416 815D subi r24,lo8(2001) |
2543 1418 9740 sbci r25,hi8(2001) |
2544 141a 34F0 brlt .L108 |
2545 141c 88EE ldi r24,lo8(1000) |
2546 141e 93E0 ldi r25,hi8(1000) |
2547 1420 9093 0000 sts (MesswertNick)+1,r25 |
2548 1424 8093 0000 sts MesswertNick,r24 |
2549 .L108: |
2550 1428 8091 0000 lds r24,AdWertNick |
2551 142c 9091 0000 lds r25,(AdWertNick)+1 |
2552 1430 805E subi r24,lo8(2016) |
2553 1432 9740 sbci r25,hi8(2016) |
2554 1434 34F0 brlt .L107 |
2555 .L163: |
2556 1436 80ED ldi r24,lo8(2000) |
2557 1438 97E0 ldi r25,hi8(2000) |
2558 143a 9093 0000 sts (MesswertNick)+1,r25 |
2559 143e 8093 0000 sts MesswertNick,r24 |
2560 .L107: |
2561 1442 8091 0000 lds r24,AdWertRoll |
2562 1446 9091 0000 lds r25,(AdWertRoll)+1 |
2563 144a 0F97 sbiw r24,15 |
2564 144c 34F4 brge .L110 |
2565 144e 88E1 ldi r24,lo8(-1000) |
2566 1450 9CEF ldi r25,hi8(-1000) |
2567 1452 9093 0000 sts (MesswertRoll)+1,r25 |
2568 1456 8093 0000 sts MesswertRoll,r24 |
2569 .L110: |
2570 145a 8091 0000 lds r24,AdWertRoll |
2571 145e 9091 0000 lds r25,(AdWertRoll)+1 |
2572 1462 0797 sbiw r24,7 |
2573 1464 34F4 brge .L111 |
2574 1466 80E3 ldi r24,lo8(-2000) |
2575 1468 98EF ldi r25,hi8(-2000) |
2576 146a 9093 0000 sts (MesswertRoll)+1,r25 |
2577 146e 8093 0000 sts MesswertRoll,r24 |
2578 .L111: |
2579 1472 2A30 cpi r18,lo8(10) |
2580 1474 A9F4 brne .L112 |
2581 1476 8091 0000 lds r24,AdWertRoll |
2582 147a 9091 0000 lds r25,(AdWertRoll)+1 |
2583 147e 835F subi r24,lo8(1011) |
2584 1480 9340 sbci r25,hi8(1011) |
2585 1482 34F0 brlt .L113 |
2586 1484 88EE ldi r24,lo8(1000) |
2587 1486 93E0 ldi r25,hi8(1000) |
2588 1488 9093 0000 sts (MesswertRoll)+1,r25 |
2589 148c 8093 0000 sts MesswertRoll,r24 |
2590 .L113: |
2591 1490 8091 0000 lds r24,AdWertRoll |
2592 1494 9091 0000 lds r25,(AdWertRoll)+1 |
2593 1498 8A5F subi r24,lo8(1018) |
2594 149a 9340 sbci r25,hi8(1018) |
2595 149c DCF0 brlt .L115 |
2596 149e 14C0 rjmp .L164 |
2597 .L112: |
2598 14a0 8091 0000 lds r24,AdWertRoll |
2599 14a4 9091 0000 lds r25,(AdWertRoll)+1 |
2600 14a8 815D subi r24,lo8(2001) |
2601 14aa 9740 sbci r25,hi8(2001) |
2602 14ac 34F0 brlt .L116 |
2603 14ae 88EE ldi r24,lo8(1000) |
2604 14b0 93E0 ldi r25,hi8(1000) |
2605 14b2 9093 0000 sts (MesswertRoll)+1,r25 |
2606 14b6 8093 0000 sts MesswertRoll,r24 |
2607 .L116: |
2608 14ba 8091 0000 lds r24,AdWertRoll |
2609 14be 9091 0000 lds r25,(AdWertRoll)+1 |
2610 14c2 805E subi r24,lo8(2016) |
2611 14c4 9740 sbci r25,hi8(2016) |
2612 14c6 34F0 brlt .L115 |
2613 .L164: |
2614 14c8 80ED ldi r24,lo8(2000) |
2615 14ca 97E0 ldi r25,hi8(2000) |
2616 14cc 9093 0000 sts (MesswertRoll)+1,r25 |
2617 14d0 8093 0000 sts MesswertRoll,r24 |
2618 .L115: |
2619 14d4 E091 0000 lds r30,Parameter_Gyro_D |
2620 14d8 EE23 tst r30 |
2621 14da 09F4 brne .+2 |
2622 14dc B7C0 rjmp .L118 |
2623 14de 4091 0000 lds r20,HiResNick |
2624 14e2 5091 0000 lds r21,(HiResNick)+1 |
2625 14e6 8091 0000 lds r24,oldNick.36 |
2626 14ea 9091 0000 lds r25,(oldNick.36)+1 |
2627 14ee 481B sub r20,r24 |
2628 14f0 590B sbc r21,r25 |
2629 14f2 5093 0000 sts (d2Nick.39)+1,r21 |
2630 14f6 4093 0000 sts d2Nick.39,r20 |
2631 14fa 2091 0000 lds r18,HiResNick |
2632 14fe 3091 0000 lds r19,(HiResNick)+1 |
2633 1502 280F add r18,r24 |
2634 1504 391F adc r19,r25 |
2635 1506 37FF sbrs r19,7 |
2636 1508 02C0 rjmp .L119 |
2637 150a 2F5F subi r18,lo8(-(1)) |
2638 150c 3F4F sbci r19,hi8(-(1)) |
2639 .L119: |
2640 150e 3595 asr r19 |
2641 1510 2795 ror r18 |
2642 1512 3093 0000 sts (oldNick.36)+1,r19 |
2643 1516 2093 0000 sts oldNick.36,r18 |
2644 151a 4138 cpi r20,129 |
2645 151c 5105 cpc r21,__zero_reg__ |
2646 151e 1CF0 brlt .L120 |
2647 1520 80E8 ldi r24,lo8(128) |
2648 1522 90E0 ldi r25,hi8(128) |
2649 1524 05C0 rjmp .L165 |
2650 .L120: |
2651 1526 4058 subi r20,lo8(-128) |
2652 1528 5F4F sbci r21,hi8(-128) |
2653 152a 34F4 brge .L121 |
2654 152c 80E8 ldi r24,lo8(-128) |
2655 152e 9FEF ldi r25,hi8(-128) |
2656 .L165: |
2657 1530 9093 0000 sts (d2Nick.39)+1,r25 |
2658 1534 8093 0000 sts d2Nick.39,r24 |
2659 .L121: |
2660 1538 8E2F mov r24,r30 |
2661 153a 9927 clr r25 |
2662 153c A091 0000 lds r26,d2Nick.39 |
2663 1540 B091 0000 lds r27,(d2Nick.39)+1 |
2664 1544 A89F mul r26,r24 |
2665 1546 A001 movw r20,r0 |
2666 1548 A99F mul r26,r25 |
2667 154a 500D add r21,r0 |
2668 154c B89F mul r27,r24 |
2669 154e 500D add r21,r0 |
2670 1550 1124 clr r1 |
2671 1552 57FF sbrs r21,7 |
2672 1554 02C0 rjmp .L123 |
2673 1556 415F subi r20,lo8(-(15)) |
2674 1558 5F4F sbci r21,hi8(-(15)) |
2675 .L123: |
2676 155a 14E0 ldi r17,4 |
2677 155c 5595 1: asr r21 |
2678 155e 4795 ror r20 |
2679 1560 1A95 dec r17 |
2680 1562 E1F7 brne 1b |
2681 1564 8091 0000 lds r24,MesswertNick |
2682 1568 9091 0000 lds r25,(MesswertNick)+1 |
2683 156c 840F add r24,r20 |
2684 156e 951F adc r25,r21 |
2685 1570 9093 0000 sts (MesswertNick)+1,r25 |
2686 1574 8093 0000 sts MesswertNick,r24 |
2687 1578 6091 0000 lds r22,HiResRoll |
2688 157c 7091 0000 lds r23,(HiResRoll)+1 |
2689 1580 8091 0000 lds r24,oldRoll.37 |
2690 1584 9091 0000 lds r25,(oldRoll.37)+1 |
2691 1588 681B sub r22,r24 |
2692 158a 790B sbc r23,r25 |
2693 158c 7093 0000 sts (d2Roll.38)+1,r23 |
2694 1590 6093 0000 sts d2Roll.38,r22 |
2695 1594 4091 0000 lds r20,HiResRoll |
2696 1598 5091 0000 lds r21,(HiResRoll)+1 |
2697 159c 480F add r20,r24 |
2698 159e 591F adc r21,r25 |
2699 15a0 57FF sbrs r21,7 |
2700 15a2 02C0 rjmp .L124 |
2701 15a4 4F5F subi r20,lo8(-(1)) |
2702 15a6 5F4F sbci r21,hi8(-(1)) |
2703 .L124: |
2704 15a8 5595 asr r21 |
2705 15aa 4795 ror r20 |
2706 15ac 5093 0000 sts (oldRoll.37)+1,r21 |
2707 15b0 4093 0000 sts oldRoll.37,r20 |
2708 15b4 6138 cpi r22,129 |
2709 15b6 7105 cpc r23,__zero_reg__ |
2710 15b8 1CF0 brlt .L125 |
2711 15ba 80E8 ldi r24,lo8(128) |
2712 15bc 90E0 ldi r25,hi8(128) |
2713 15be 05C0 rjmp .L166 |
2714 .L125: |
2715 15c0 6058 subi r22,lo8(-128) |
2716 15c2 7F4F sbci r23,hi8(-128) |
2717 15c4 34F4 brge .L126 |
2718 15c6 80E8 ldi r24,lo8(-128) |
2719 15c8 9FEF ldi r25,hi8(-128) |
2720 .L166: |
2721 15ca 9093 0000 sts (d2Roll.38)+1,r25 |
2722 15ce 8093 0000 sts d2Roll.38,r24 |
2723 .L126: |
2724 15d2 2E2F mov r18,r30 |
2725 15d4 3327 clr r19 |
2726 15d6 8091 0000 lds r24,d2Roll.38 |
2727 15da 9091 0000 lds r25,(d2Roll.38)+1 |
2728 15de 829F mul r24,r18 |
2729 15e0 B001 movw r22,r0 |
2730 15e2 839F mul r24,r19 |
2731 15e4 700D add r23,r0 |
2732 15e6 929F mul r25,r18 |
2733 15e8 700D add r23,r0 |
2734 15ea 1124 clr r1 |
2735 15ec AB01 movw r20,r22 |
2736 15ee 77FF sbrs r23,7 |
2737 15f0 02C0 rjmp .L128 |
2738 15f2 415F subi r20,lo8(-(15)) |
2739 15f4 5F4F sbci r21,hi8(-(15)) |
2740 .L128: |
2741 15f6 E4E0 ldi r30,4 |
2742 15f8 5595 1: asr r21 |
2743 15fa 4795 ror r20 |
2744 15fc EA95 dec r30 |
2745 15fe E1F7 brne 1b |
2746 1600 8091 0000 lds r24,MesswertRoll |
2747 1604 9091 0000 lds r25,(MesswertRoll)+1 |
2748 1608 840F add r24,r20 |
2749 160a 951F adc r25,r21 |
2750 160c 9093 0000 sts (MesswertRoll)+1,r25 |
2751 1610 8093 0000 sts MesswertRoll,r24 |
2752 1614 A29F mul r26,r18 |
2753 1616 C001 movw r24,r0 |
2754 1618 A39F mul r26,r19 |
2755 161a 900D add r25,r0 |
2756 161c B29F mul r27,r18 |
2757 161e 900D add r25,r0 |
2758 1620 1124 clr r1 |
2759 1622 9C01 movw r18,r24 |
2760 1624 8091 0000 lds r24,HiResNick |
2761 1628 9091 0000 lds r25,(HiResNick)+1 |
2762 162c 820F add r24,r18 |
2763 162e 931F adc r25,r19 |
2764 1630 9093 0000 sts (HiResNick)+1,r25 |
2765 1634 8093 0000 sts HiResNick,r24 |
2766 1638 8091 0000 lds r24,HiResRoll |
2767 163c 9091 0000 lds r25,(HiResRoll)+1 |
2768 1640 860F add r24,r22 |
2769 1642 971F adc r25,r23 |
2770 1644 9093 0000 sts (HiResRoll)+1,r25 |
2771 1648 8093 0000 sts HiResRoll,r24 |
2772 .L118: |
2773 164c 0091 0000 lds r16,RohMesswertRoll |
2774 1650 1091 0000 lds r17,(RohMesswertRoll)+1 |
2775 1654 8091 0000 lds r24,KopplungsteilNickRoll |
2776 1658 9091 0000 lds r25,(KopplungsteilNickRoll)+1 |
2777 165c 1016 cp __zero_reg__,r16 |
2778 165e 1106 cpc __zero_reg__,r17 |
2779 1660 5CF5 brge .L129 |
2780 1662 9C01 movw r18,r24 |
2781 1664 97FF sbrs r25,7 |
2782 1666 04C0 rjmp .L130 |
2783 1668 2227 clr r18 |
2784 166a 3327 clr r19 |
2785 166c 281B sub r18,r24 |
2786 166e 390B sbc r19,r25 |
2787 .L130: |
2788 1670 C901 movw r24,r18 |
2789 1672 AA27 clr r26 |
2790 1674 97FD sbrc r25,7 |
2791 1676 A095 com r26 |
2792 1678 BA2F mov r27,r26 |
2793 167a 2091 0000 lds r18,Parameter_CouplingYawCorrection |
2794 167e 3327 clr r19 |
2795 1680 4427 clr r20 |
2796 1682 5527 clr r21 |
2797 1684 BC01 movw r22,r24 |
2798 1686 CD01 movw r24,r26 |
2799 1688 0E94 0000 call __mulsi3 |
2800 168c 9B01 movw r18,r22 |
2801 168e AC01 movw r20,r24 |
2802 1690 97FF sbrs r25,7 |
2803 1692 04C0 rjmp .L131 |
2804 1694 215C subi r18,lo8(-(63)) |
2805 1696 3F4F sbci r19,hi8(-(63)) |
2806 1698 4F4F sbci r20,hlo8(-(63)) |
2807 169a 5F4F sbci r21,hhi8(-(63)) |
2808 .L131: |
2809 169c 76E0 ldi r23,6 |
2810 169e 5595 1: asr r21 |
2811 16a0 4795 ror r20 |
2812 16a2 3795 ror r19 |
2813 16a4 2795 ror r18 |
2814 16a6 7A95 dec r23 |
2815 16a8 D1F7 brne 1b |
2816 16aa 8091 0000 lds r24,TrimRoll |
2817 16ae 9091 0000 lds r25,(TrimRoll)+1 |
2818 16b2 820F add r24,r18 |
2819 16b4 931F adc r25,r19 |
2820 16b6 27C0 rjmp .L167 |
2821 .L129: |
2822 16b8 97FF sbrs r25,7 |
2823 16ba 03C0 rjmp .L133 |
2824 16bc 9095 com r25 |
2825 16be 8195 neg r24 |
2826 16c0 9F4F sbci r25,lo8(-1) |
2827 .L133: |
2828 16c2 AA27 clr r26 |
2829 16c4 97FD sbrc r25,7 |
2830 16c6 A095 com r26 |
2831 16c8 BA2F mov r27,r26 |
2832 16ca 2091 0000 lds r18,Parameter_CouplingYawCorrection |
2833 16ce 3327 clr r19 |
2834 16d0 4427 clr r20 |
2835 16d2 5527 clr r21 |
2836 16d4 BC01 movw r22,r24 |
2837 16d6 CD01 movw r24,r26 |
2838 16d8 0E94 0000 call __mulsi3 |
2839 16dc 9B01 movw r18,r22 |
2840 16de AC01 movw r20,r24 |
2841 16e0 97FF sbrs r25,7 |
2842 16e2 04C0 rjmp .L134 |
2843 16e4 215C subi r18,lo8(-(63)) |
2844 16e6 3F4F sbci r19,hi8(-(63)) |
2845 16e8 4F4F sbci r20,hlo8(-(63)) |
2846 16ea 5F4F sbci r21,hhi8(-(63)) |
2847 .L134: |
2848 16ec 66E0 ldi r22,6 |
2849 16ee 5595 1: asr r21 |
2850 16f0 4795 ror r20 |
2851 16f2 3795 ror r19 |
2852 16f4 2795 ror r18 |
2853 16f6 6A95 dec r22 |
2854 16f8 D1F7 brne 1b |
2855 16fa 8091 0000 lds r24,TrimRoll |
2856 16fe 9091 0000 lds r25,(TrimRoll)+1 |
2857 1702 821B sub r24,r18 |
2858 1704 930B sbc r25,r19 |
2859 .L167: |
2860 1706 9093 0000 sts (TrimRoll)+1,r25 |
2861 170a 8093 0000 sts TrimRoll,r24 |
2862 170e E090 0000 lds r14,RohMesswertNick |
2863 1712 F090 0000 lds r15,(RohMesswertNick)+1 |
2864 1716 8091 0000 lds r24,KopplungsteilRollNick |
2865 171a 9091 0000 lds r25,(KopplungsteilRollNick)+1 |
2866 171e 1E14 cp __zero_reg__,r14 |
2867 1720 1F04 cpc __zero_reg__,r15 |
2868 1722 5CF5 brge .L135 |
2869 1724 9C01 movw r18,r24 |
2870 1726 97FF sbrs r25,7 |
2871 1728 04C0 rjmp .L136 |
2872 172a 2227 clr r18 |
2873 172c 3327 clr r19 |
2874 172e 281B sub r18,r24 |
2875 1730 390B sbc r19,r25 |
2876 .L136: |
2877 1732 C901 movw r24,r18 |
2878 1734 AA27 clr r26 |
2879 1736 97FD sbrc r25,7 |
2880 1738 A095 com r26 |
2881 173a BA2F mov r27,r26 |
2882 173c 2091 0000 lds r18,Parameter_CouplingYawCorrection |
2883 1740 3327 clr r19 |
2884 1742 4427 clr r20 |
2885 1744 5527 clr r21 |
2886 1746 BC01 movw r22,r24 |
2887 1748 CD01 movw r24,r26 |
2888 174a 0E94 0000 call __mulsi3 |
2889 174e 9B01 movw r18,r22 |
2890 1750 AC01 movw r20,r24 |
2891 1752 97FF sbrs r25,7 |
2892 1754 04C0 rjmp .L137 |
2893 1756 215C subi r18,lo8(-(63)) |
2894 1758 3F4F sbci r19,hi8(-(63)) |
2895 175a 4F4F sbci r20,hlo8(-(63)) |
2896 175c 5F4F sbci r21,hhi8(-(63)) |
2897 .L137: |
2898 175e 96E0 ldi r25,6 |
2899 1760 5595 1: asr r21 |
2900 1762 4795 ror r20 |
2901 1764 3795 ror r19 |
2902 1766 2795 ror r18 |
2903 1768 9A95 dec r25 |
2904 176a D1F7 brne 1b |
2905 176c 8091 0000 lds r24,TrimNick |
2906 1770 9091 0000 lds r25,(TrimNick)+1 |
2907 1774 820F add r24,r18 |
2908 1776 931F adc r25,r19 |
2909 1778 27C0 rjmp .L168 |
2910 .L135: |
2911 177a 97FF sbrs r25,7 |
2912 177c 03C0 rjmp .L139 |
2913 177e 9095 com r25 |
2914 1780 8195 neg r24 |
2915 1782 9F4F sbci r25,lo8(-1) |
2916 .L139: |
2917 1784 AA27 clr r26 |
2918 1786 97FD sbrc r25,7 |
2919 1788 A095 com r26 |
2920 178a BA2F mov r27,r26 |
2921 178c 2091 0000 lds r18,Parameter_CouplingYawCorrection |
2922 1790 3327 clr r19 |
2923 1792 4427 clr r20 |
2924 1794 5527 clr r21 |
2925 1796 BC01 movw r22,r24 |
2926 1798 CD01 movw r24,r26 |
2927 179a 0E94 0000 call __mulsi3 |
2928 179e 9B01 movw r18,r22 |
2929 17a0 AC01 movw r20,r24 |
2930 17a2 97FF sbrs r25,7 |
2931 17a4 04C0 rjmp .L140 |
2932 17a6 215C subi r18,lo8(-(63)) |
2933 17a8 3F4F sbci r19,hi8(-(63)) |
2934 17aa 4F4F sbci r20,hlo8(-(63)) |
2935 17ac 5F4F sbci r21,hhi8(-(63)) |
2936 .L140: |
2937 17ae 86E0 ldi r24,6 |
2938 17b0 5595 1: asr r21 |
2939 17b2 4795 ror r20 |
2940 17b4 3795 ror r19 |
2941 17b6 2795 ror r18 |
2942 17b8 8A95 dec r24 |
2943 17ba D1F7 brne 1b |
2944 17bc 8091 0000 lds r24,TrimNick |
2945 17c0 9091 0000 lds r25,(TrimNick)+1 |
2946 17c4 821B sub r24,r18 |
2947 17c6 930B sbc r25,r19 |
2948 .L168: |
2949 17c8 9093 0000 sts (TrimNick)+1,r25 |
2950 17cc 8093 0000 sts TrimNick,r24 |
2951 17d0 8091 0000 lds r24,EE_Parameter+13 |
2952 17d4 87FF sbrs r24,7 |
2953 17d6 44C0 rjmp .L141 |
2954 17d8 9989 ldd r25,Y+17 |
2955 17da 9923 tst r25 |
2956 17dc 09F0 breq .+2 |
2957 17de 40C0 rjmp .L141 |
2958 17e0 8091 0000 lds r24,Looping_Roll |
2959 17e4 8823 tst r24 |
2960 17e6 E1F5 brne .L141 |
2961 17e8 A1E0 ldi r26,lo8(257) |
2962 17ea EA16 cp r14,r26 |
2963 17ec A1E0 ldi r26,hi8(257) |
2964 17ee FA06 cpc r15,r26 |
2965 17f0 4CF0 brlt .L142 |
2966 17f2 8091 0000 lds r24,MesswertNick |
2967 17f6 9091 0000 lds r25,(MesswertNick)+1 |
2968 17fa 8E0D add r24,r14 |
2969 17fc 9F1D adc r25,r15 |
2970 17fe 8050 subi r24,lo8(-(-256)) |
2971 1800 9140 sbci r25,hi8(-(-256)) |
2972 1802 0DC0 rjmp .L169 |
2973 .L142: |
2974 1804 B0E0 ldi r27,lo8(-256) |
2975 1806 EB16 cp r14,r27 |
2976 1808 BFEF ldi r27,hi8(-256) |
2977 180a FB06 cpc r15,r27 |
2978 180c 64F4 brge .L143 |
2979 180e 8091 0000 lds r24,MesswertNick |
2980 1812 9091 0000 lds r25,(MesswertNick)+1 |
2981 1816 8E0D add r24,r14 |
2982 1818 9F1D adc r25,r15 |
2983 181a 8050 subi r24,lo8(-(256)) |
2984 181c 9F4F sbci r25,hi8(-(256)) |
2985 .L169: |
2986 181e 9093 0000 sts (MesswertNick)+1,r25 |
2987 1822 8093 0000 sts MesswertNick,r24 |
2988 .L143: |
2989 1826 E1E0 ldi r30,hi8(257) |
2990 1828 0130 cpi r16,lo8(257) |
2991 182a 1E07 cpc r17,r30 |
2992 182c 4CF0 brlt .L145 |
2993 182e 8091 0000 lds r24,MesswertRoll |
2994 1832 9091 0000 lds r25,(MesswertRoll)+1 |
2995 1836 800F add r24,r16 |
2996 1838 911F adc r25,r17 |
2997 183a 8050 subi r24,lo8(-(-256)) |
2998 183c 9140 sbci r25,hi8(-(-256)) |
2999 183e 0CC0 rjmp .L170 |
3000 .L145: |
3001 1840 FFEF ldi r31,hi8(-256) |
3002 1842 0030 cpi r16,lo8(-256) |
3003 1844 1F07 cpc r17,r31 |
3004 1846 64F4 brge .L141 |
3005 1848 8091 0000 lds r24,MesswertRoll |
3006 184c 9091 0000 lds r25,(MesswertRoll)+1 |
3007 1850 800F add r24,r16 |
3008 1852 911F adc r25,r17 |
3009 1854 8050 subi r24,lo8(-(256)) |
3010 1856 9F4F sbci r25,hi8(-(256)) |
3011 .L170: |
3012 1858 9093 0000 sts (MesswertRoll)+1,r25 |
3013 185c 8093 0000 sts MesswertRoll,r24 |
3014 .L141: |
3015 1860 A0E0 ldi r26,lo8(Poti) |
3016 1862 B0E0 ldi r27,hi8(Poti) |
3017 1864 60E0 ldi r22,lo8(EE_Parameter+5) |
3018 1866 70E0 ldi r23,hi8(EE_Parameter+5) |
3019 1868 57E0 ldi r21,lo8(7) |
3020 .L158: |
3021 186a FB01 movw r30,r22 |
3022 186c 8191 ld r24,Z+ |
3023 186e BF01 movw r22,r30 |
3024 1870 E82F mov r30,r24 |
3025 1872 FF27 clr r31 |
3026 1874 EE0F add r30,r30 |
3027 1876 FF1F adc r31,r31 |
3028 1878 E050 subi r30,lo8(-(PPM_in)) |
3029 187a F040 sbci r31,hi8(-(PPM_in)) |
3030 187c 0190 ld __tmp_reg__,Z+ |
3031 187e F081 ld r31,Z |
3032 1880 E02D mov r30,__tmp_reg__ |
3033 1882 E259 subi r30,lo8(-(110)) |
3034 1884 FF4F sbci r31,hi8(-(110)) |
3035 1886 EF3F cpi r30,255 |
3036 1888 F105 cpc r31,__zero_reg__ |
3037 188a 21F0 breq .L151 |
3038 188c 1CF0 brlt .L151 |
3039 188e EFEF ldi r30,lo8(255) |
3040 1890 F0E0 ldi r31,hi8(255) |
3041 1892 04C0 rjmp .L152 |
3042 .L151: |
3043 1894 F7FF sbrs r31,7 |
3044 1896 02C0 rjmp .L152 |
3045 1898 E0E0 ldi r30,lo8(0) |
3046 189a F0E0 ldi r31,hi8(0) |
3047 .L152: |
3048 189c 4C91 ld r20,X |
3049 189e 242F mov r18,r20 |
3050 18a0 3327 clr r19 |
3051 18a2 E217 cp r30,r18 |
3052 18a4 F307 cpc r31,r19 |
3053 18a6 B1F0 breq .L150 |
3054 18a8 CF01 movw r24,r30 |
3055 18aa 821B sub r24,r18 |
3056 18ac 930B sbc r25,r19 |
3057 18ae 97FD sbrc r25,7 |
3058 18b0 0796 adiw r24,7 |
3059 .L155: |
3060 18b2 13E0 ldi r17,3 |
3061 18b4 9595 1: asr r25 |
3062 18b6 8795 ror r24 |
3063 18b8 1A95 dec r17 |
3064 18ba E1F7 brne 1b |
3065 18bc 242F mov r18,r20 |
3066 18be 280F add r18,r24 |
3067 18c0 2C93 st X,r18 |
3068 18c2 822F mov r24,r18 |
3069 18c4 9927 clr r25 |
3070 18c6 E817 cp r30,r24 |
3071 18c8 F907 cpc r31,r25 |
3072 18ca 14F4 brge .L156 |
3073 18cc 2150 subi r18,lo8(-(-1)) |
3074 18ce 01C0 rjmp .L171 |
3075 .L156: |
3076 18d0 2F5F subi r18,lo8(-(1)) |
3077 .L171: |
3078 18d2 2C93 st X,r18 |
3079 .L150: |
3080 18d4 5150 subi r21,lo8(-(-1)) |
3081 18d6 1196 adiw r26,1 |
3082 18d8 57FF sbrs r21,7 |
3083 18da C7CF rjmp .L158 |
3084 /* epilogue: frame size=19 */ |
3085 18dc E2E1 ldi r30,18 |
3086 18de CD5E subi r28,-19 |
3087 18e0 0C94 0000 jmp __epilogue_restores__+0 |
3088 /* epilogue end (size=4) */ |
3089 /* function Mittelwert size 2071 (2061) */ |
3091 .global SendMotorData |
3093 SendMotorData: |
3094 /* prologue: frame size=0 */ |
3095 /* prologue end (size=0) */ |
3096 18e4 8091 0000 lds r24,MotorenEin |
3097 18e8 8823 tst r24 |
3098 18ea 01F5 brne .L173 |
3099 18ec 8091 0000 lds r24,FCFlags |
3100 18f0 8C7F andi r24,lo8(-4) |
3101 18f2 8093 0000 sts FCFlags,r24 |
3102 18f6 A0E0 ldi r26,lo8(MotorTest) |
3103 18f8 B0E0 ldi r27,hi8(MotorTest) |
3104 18fa E0E0 ldi r30,lo8(Motor) |
3105 18fc F0E0 ldi r31,hi8(Motor) |
3106 18fe 9BE0 ldi r25,lo8(11) |
3107 .L178: |
3108 1900 8091 0000 lds r24,PC_MotortestActive |
3109 1904 8823 tst r24 |
3110 1906 09F4 brne .L177 |
3111 1908 8C93 st X,r24 |
3112 .L177: |
3113 190a 8D91 ld r24,X+ |
3114 190c 8183 std Z+1,r24 |
3115 190e 1282 std Z+2,__zero_reg__ |
3116 1910 9150 subi r25,lo8(-(-1)) |
3117 1912 3896 adiw r30,8 |
3118 1914 97FF sbrs r25,7 |
3119 1916 F4CF rjmp .L178 |
3120 1918 8091 0000 lds r24,PC_MotortestActive |
3121 191c 8823 tst r24 |
3122 191e 59F0 breq .L180 |
3123 1920 8091 0000 lds r24,PC_MotortestActive |
3124 1924 8150 subi r24,lo8(-(-1)) |
3125 1926 8093 0000 sts PC_MotortestActive,r24 |
3126 192a 05C0 rjmp .L180 |
3127 .L173: |
3128 192c 8091 0000 lds r24,FCFlags |
3129 1930 8160 ori r24,lo8(1) |
3130 1932 8093 0000 sts FCFlags,r24 |
3131 .L180: |
3132 1936 1092 0000 sts motor_write,__zero_reg__ |
3133 193a 1092 0000 sts twi_state,__zero_reg__ |
3134 193e 8091 0000 lds r24,BLFlags |
3135 1942 8E7F andi r24,lo8(-2) |
3136 1944 8093 0000 sts BLFlags,r24 |
3137 1948 85EA ldi r24,lo8(-91) |
3138 194a 8093 BC00 sts 188,r24 |
3139 /* epilogue: frame size=0 */ |
3140 194e 0895 ret |
3141 /* epilogue end (size=1) */ |
3142 /* function SendMotorData size 54 (53) */ |
3144 .global ParameterZuordnung |
3146 ParameterZuordnung: |
3147 /* prologue: frame size=0 */ |
3148 /* prologue end (size=0) */ |
3149 1950 8091 0000 lds r24,EE_Parameter+15 |
3150 1954 883F cpi r24,lo8(-8) |
3151 1956 38F0 brlo .L275 |
3152 1958 EFEF ldi r30,lo8(255) |
3153 195a F0E0 ldi r31,hi8(255) |
3154 195c E81B sub r30,r24 |
3155 195e F109 sbc r31,__zero_reg__ |
3156 1960 E050 subi r30,lo8(-(Poti)) |
3157 1962 F040 sbci r31,hi8(-(Poti)) |
3158 1964 8081 ld r24,Z |
3159 .L275: |
3160 1966 8093 0000 sts Parameter_Luftdruck_D,r24 |
3161 196a 8091 0000 lds r24,Parameter_Luftdruck_D |
3162 196e 8823 tst r24 |
3163 1970 29F0 breq .L187 |
3164 1972 8436 cpi r24,lo8(100) |
3165 1974 18F0 brlo .L187 |
3166 1976 84E6 ldi r24,lo8(100) |
3167 1978 8093 0000 sts Parameter_Luftdruck_D,r24 |
3168 .L187: |
3169 197c 8091 0000 lds r24,EE_Parameter+17 |
3170 1980 883F cpi r24,lo8(-8) |
3171 1982 38F0 brlo .L276 |
3172 1984 EFEF ldi r30,lo8(255) |
3173 1986 F0E0 ldi r31,hi8(255) |
3174 1988 E81B sub r30,r24 |
3175 198a F109 sbc r31,__zero_reg__ |
3176 198c E050 subi r30,lo8(-(Poti)) |
3177 198e F040 sbci r31,hi8(-(Poti)) |
3178 1990 8081 ld r24,Z |
3179 .L276: |
3180 1992 8093 0000 sts Parameter_Hoehe_P,r24 |
3181 1996 8091 0000 lds r24,Parameter_Hoehe_P |
3182 199a 8823 tst r24 |
3183 199c 29F0 breq .L192 |
3184 199e 8436 cpi r24,lo8(100) |
3185 19a0 18F0 brlo .L192 |
3186 19a2 84E6 ldi r24,lo8(100) |
3187 19a4 8093 0000 sts Parameter_Hoehe_P,r24 |
3188 .L192: |
3189 19a8 8091 0000 lds r24,EE_Parameter+30 |
3190 19ac 883F cpi r24,lo8(-8) |
3191 19ae 38F0 brlo .L277 |
3192 19b0 EFEF ldi r30,lo8(255) |
3193 19b2 F0E0 ldi r31,hi8(255) |
3194 19b4 E81B sub r30,r24 |
3195 19b6 F109 sbc r31,__zero_reg__ |
3196 19b8 E050 subi r30,lo8(-(Poti)) |
3197 19ba F040 sbci r31,hi8(-(Poti)) |
3198 19bc 8081 ld r24,Z |
3199 .L277: |
3200 19be 8093 0000 sts Parameter_Gyro_P,r24 |
3201 19c2 8091 0000 lds r24,Parameter_Gyro_P |
3202 19c6 8B30 cpi r24,lo8(11) |
3203 19c8 10F4 brsh .L196 |
3204 19ca 8AE0 ldi r24,lo8(10) |
3205 19cc 02C0 rjmp .L278 |
3206 .L196: |
3207 19ce 8F3F cpi r24,lo8(-1) |
3208 19d0 11F4 brne .L197 |
3209 .L278: |
3210 19d2 8093 0000 sts Parameter_Gyro_P,r24 |
3211 .L197: |
3212 19d6 8091 0000 lds r24,EE_Parameter+73 |
3213 19da 883F cpi r24,lo8(-8) |
3214 19dc 38F0 brlo .L279 |
3215 19de EFEF ldi r30,lo8(255) |
3216 19e0 F0E0 ldi r31,hi8(255) |
3217 19e2 E81B sub r30,r24 |
3218 19e4 F109 sbc r31,__zero_reg__ |
3219 19e6 E050 subi r30,lo8(-(Poti)) |
3220 19e8 F040 sbci r31,hi8(-(Poti)) |
3221 19ea 8081 ld r24,Z |
3222 .L279: |
3223 19ec 8093 0000 sts Parameter_J16Timing,r24 |
3224 19f0 8091 0000 lds r24,Parameter_J16Timing |
3225 19f4 8230 cpi r24,lo8(2) |
3226 19f6 10F4 brsh .L201 |
3227 19f8 81E0 ldi r24,lo8(1) |
3228 19fa 02C0 rjmp .L280 |
3229 .L201: |
3230 19fc 8F3F cpi r24,lo8(-1) |
3231 19fe 11F4 brne .L202 |
3232 .L280: |
3233 1a00 8093 0000 sts Parameter_J16Timing,r24 |
3234 .L202: |
3235 1a04 8091 0000 lds r24,EE_Parameter+75 |
3236 1a08 883F cpi r24,lo8(-8) |
3237 1a0a 38F0 brlo .L281 |
3238 1a0c EFEF ldi r30,lo8(255) |
3239 1a0e F0E0 ldi r31,hi8(255) |
3240 1a10 E81B sub r30,r24 |
3241 1a12 F109 sbc r31,__zero_reg__ |
3242 1a14 E050 subi r30,lo8(-(Poti)) |
3243 1a16 F040 sbci r31,hi8(-(Poti)) |
3244 1a18 8081 ld r24,Z |
3245 .L281: |
3246 1a1a 8093 0000 sts Parameter_J17Timing,r24 |
3247 1a1e 8091 0000 lds r24,Parameter_J17Timing |
3248 1a22 8230 cpi r24,lo8(2) |
3249 1a24 10F4 brsh .L206 |
3250 1a26 81E0 ldi r24,lo8(1) |
3251 1a28 02C0 rjmp .L282 |
3252 .L206: |
3253 1a2a 8F3F cpi r24,lo8(-1) |
3254 1a2c 11F4 brne .L207 |
3255 .L282: |
3256 1a2e 8093 0000 sts Parameter_J17Timing,r24 |
3257 .L207: |
3258 1a32 8091 0000 lds r24,EE_Parameter+54 |
3259 1a36 883F cpi r24,lo8(-8) |
3260 1a38 38F0 brlo .L283 |
3261 1a3a EFEF ldi r30,lo8(255) |
3262 1a3c F0E0 ldi r31,hi8(255) |
3263 1a3e E81B sub r30,r24 |
3264 1a40 F109 sbc r31,__zero_reg__ |
3265 1a42 E050 subi r30,lo8(-(Poti)) |
3266 1a44 F040 sbci r31,hi8(-(Poti)) |
3267 1a46 8081 ld r24,Z |
3268 .L283: |
3269 1a48 8093 0000 sts Parameter_Servo3,r24 |
3270 1a4c 8091 0000 lds r24,EE_Parameter+55 |
3271 1a50 883F cpi r24,lo8(-8) |
3272 1a52 38F0 brlo .L284 |
3273 1a54 EFEF ldi r30,lo8(255) |
3274 1a56 F0E0 ldi r31,hi8(255) |
3275 1a58 E81B sub r30,r24 |
3276 1a5a F109 sbc r31,__zero_reg__ |
3277 1a5c E050 subi r30,lo8(-(Poti)) |
3278 1a5e F040 sbci r31,hi8(-(Poti)) |
3279 1a60 8081 ld r24,Z |
3280 .L284: |
3281 1a62 8093 0000 sts Parameter_Servo4,r24 |
3282 1a66 8091 0000 lds r24,EE_Parameter+56 |
3283 1a6a 883F cpi r24,lo8(-8) |
3284 1a6c 38F0 brlo .L285 |
3285 1a6e EFEF ldi r30,lo8(255) |
3286 1a70 F0E0 ldi r31,hi8(255) |
3287 1a72 E81B sub r30,r24 |
3288 1a74 F109 sbc r31,__zero_reg__ |
3289 1a76 E050 subi r30,lo8(-(Poti)) |
3290 1a78 F040 sbci r31,hi8(-(Poti)) |
3291 1a7a 8081 ld r24,Z |
3292 .L285: |
3293 1a7c 8093 0000 sts Parameter_Servo5,r24 |
3294 1a80 9091 0000 lds r25,EE_Parameter+16 |
3295 1a84 983F cpi r25,lo8(-8) |
3296 1a86 18F4 brsh .L215 |
3297 1a88 9093 0000 sts Parameter_MaxHoehe,r25 |
3298 1a8c 09C0 rjmp .L216 |
3299 .L215: |
3300 1a8e EFEF ldi r30,lo8(255) |
3301 1a90 F0E0 ldi r31,hi8(255) |
3302 1a92 E91B sub r30,r25 |
3303 1a94 F109 sbc r31,__zero_reg__ |
3304 1a96 E050 subi r30,lo8(-(Poti)) |
3305 1a98 F040 sbci r31,hi8(-(Poti)) |
3306 1a9a 8081 ld r24,Z |
3307 1a9c 8093 0000 sts Parameter_MaxHoehe,r24 |
3308 .L216: |
3309 1aa0 983F cpi r25,lo8(-8) |
3310 1aa2 18F4 brsh .L217 |
3311 1aa4 9093 0000 sts Parameter_MaxHoehe,r25 |
3312 1aa8 09C0 rjmp .L218 |
3313 .L217: |
3314 1aaa EFEF ldi r30,lo8(255) |
3315 1aac F0E0 ldi r31,hi8(255) |
3316 1aae E91B sub r30,r25 |
3317 1ab0 F109 sbc r31,__zero_reg__ |
3318 1ab2 E050 subi r30,lo8(-(Poti)) |
3319 1ab4 F040 sbci r31,hi8(-(Poti)) |
3320 1ab6 8081 ld r24,Z |
3321 1ab8 8093 0000 sts Parameter_MaxHoehe,r24 |
3322 .L218: |
3323 1abc 8091 0000 lds r24,EE_Parameter+19 |
3324 1ac0 883F cpi r24,lo8(-8) |
3325 1ac2 38F0 brlo .L286 |
3326 1ac4 EFEF ldi r30,lo8(255) |
3327 1ac6 F0E0 ldi r31,hi8(255) |
3328 1ac8 E81B sub r30,r24 |
3329 1aca F109 sbc r31,__zero_reg__ |
3330 1acc E050 subi r30,lo8(-(Poti)) |
3331 1ace F040 sbci r31,hi8(-(Poti)) |
3332 1ad0 8081 ld r24,Z |
3333 .L286: |
3334 1ad2 8093 0000 sts Parameter_Hoehe_ACC_Wirkung,r24 |
3335 1ad6 8091 0000 lds r24,EE_Parameter+21 |
3336 1ada 883F cpi r24,lo8(-8) |
3337 1adc 38F0 brlo .L287 |
3338 1ade EFEF ldi r30,lo8(255) |
3339 1ae0 F0E0 ldi r31,hi8(255) |
3340 1ae2 E81B sub r30,r24 |
3341 1ae4 F109 sbc r31,__zero_reg__ |
3342 1ae6 E050 subi r30,lo8(-(Poti)) |
3343 1ae8 F040 sbci r31,hi8(-(Poti)) |
3344 1aea 8081 ld r24,Z |
3345 .L287: |
3346 1aec 8093 0000 sts Parameter_Hoehe_GPS_Z,r24 |
3347 1af0 8091 0000 lds r24,EE_Parameter+29 |
3348 1af4 883F cpi r24,lo8(-8) |
3349 1af6 38F0 brlo .L288 |
3350 1af8 EFEF ldi r30,lo8(255) |
3351 1afa F0E0 ldi r31,hi8(255) |
3352 1afc E81B sub r30,r24 |
3353 1afe F109 sbc r31,__zero_reg__ |
3354 1b00 E050 subi r30,lo8(-(Poti)) |
3355 1b02 F040 sbci r31,hi8(-(Poti)) |
3356 1b04 8081 ld r24,Z |
3357 .L288: |
3358 1b06 8093 0000 sts Parameter_KompassWirkung,r24 |
3359 1b0a 8091 0000 lds r24,EE_Parameter+31 |
3360 1b0e 883F cpi r24,lo8(-8) |
3361 1b10 38F0 brlo .L289 |
3362 1b12 EFEF ldi r30,lo8(255) |
3363 1b14 F0E0 ldi r31,hi8(255) |
3364 1b16 E81B sub r30,r24 |
3365 1b18 F109 sbc r31,__zero_reg__ |
3366 1b1a E050 subi r30,lo8(-(Poti)) |
3367 1b1c F040 sbci r31,hi8(-(Poti)) |
3368 1b1e 8081 ld r24,Z |
3369 .L289: |
3370 1b20 8093 0000 sts Parameter_Gyro_I,r24 |
3371 1b24 8091 0000 lds r24,EE_Parameter+32 |
3372 1b28 883F cpi r24,lo8(-8) |
3373 1b2a 38F0 brlo .L290 |
3374 1b2c EFEF ldi r30,lo8(255) |
3375 1b2e F0E0 ldi r31,hi8(255) |
3376 1b30 E81B sub r30,r24 |
3377 1b32 F109 sbc r31,__zero_reg__ |
3378 1b34 E050 subi r30,lo8(-(Poti)) |
3379 1b36 F040 sbci r31,hi8(-(Poti)) |
3380 1b38 8081 ld r24,Z |
3381 .L290: |
3382 1b3a 8093 0000 sts Parameter_Gyro_D,r24 |
3383 1b3e 8091 0000 lds r24,EE_Parameter+33 |
3384 1b42 883F cpi r24,lo8(-8) |
3385 1b44 38F0 brlo .L291 |
3386 1b46 EFEF ldi r30,lo8(255) |
3387 1b48 F0E0 ldi r31,hi8(255) |
3388 1b4a E81B sub r30,r24 |
3389 1b4c F109 sbc r31,__zero_reg__ |
3390 1b4e E050 subi r30,lo8(-(Poti)) |
3391 1b50 F040 sbci r31,hi8(-(Poti)) |
3392 1b52 8081 ld r24,Z |
3393 .L291: |
3394 1b54 8093 0000 sts Parameter_Gyro_Gier_P,r24 |
3395 1b58 8091 0000 lds r24,EE_Parameter+34 |
3396 1b5c 883F cpi r24,lo8(-8) |
3397 1b5e 38F0 brlo .L292 |
3398 1b60 EFEF ldi r30,lo8(255) |
3399 1b62 F0E0 ldi r31,hi8(255) |
3400 1b64 E81B sub r30,r24 |
3401 1b66 F109 sbc r31,__zero_reg__ |
3402 1b68 E050 subi r30,lo8(-(Poti)) |
3403 1b6a F040 sbci r31,hi8(-(Poti)) |
3404 1b6c 8081 ld r24,Z |
3405 .L292: |
3406 1b6e 8093 0000 sts Parameter_Gyro_Gier_I,r24 |
3407 1b72 8091 0000 lds r24,EE_Parameter+40 |
3408 1b76 883F cpi r24,lo8(-8) |
3409 1b78 38F0 brlo .L293 |
3410 1b7a EFEF ldi r30,lo8(255) |
3411 1b7c F0E0 ldi r31,hi8(255) |
3412 1b7e E81B sub r30,r24 |
3413 1b80 F109 sbc r31,__zero_reg__ |
3414 1b82 E050 subi r30,lo8(-(Poti)) |
3415 1b84 F040 sbci r31,hi8(-(Poti)) |
3416 1b86 8081 ld r24,Z |
3417 .L293: |
3418 1b88 8093 0000 sts Parameter_I_Faktor,r24 |
3419 1b8c 8091 0000 lds r24,EE_Parameter+41 |
3420 1b90 883F cpi r24,lo8(-8) |
3421 1b92 38F0 brlo .L294 |
3422 1b94 EFEF ldi r30,lo8(255) |
3423 1b96 F0E0 ldi r31,hi8(255) |
3424 1b98 E81B sub r30,r24 |
3425 1b9a F109 sbc r31,__zero_reg__ |
3426 1b9c E050 subi r30,lo8(-(Poti)) |
3427 1b9e F040 sbci r31,hi8(-(Poti)) |
3428 1ba0 8081 ld r24,Z |
3429 .L294: |
3430 1ba2 8093 0000 sts Parameter_UserParam1,r24 |
3431 1ba6 8091 0000 lds r24,EE_Parameter+42 |
3432 1baa 883F cpi r24,lo8(-8) |
3433 1bac 38F0 brlo .L295 |
3434 1bae EFEF ldi r30,lo8(255) |
3435 1bb0 F0E0 ldi r31,hi8(255) |
3436 1bb2 E81B sub r30,r24 |
3437 1bb4 F109 sbc r31,__zero_reg__ |
3438 1bb6 E050 subi r30,lo8(-(Poti)) |
3439 1bb8 F040 sbci r31,hi8(-(Poti)) |
3440 1bba 8081 ld r24,Z |
3441 .L295: |
3442 1bbc 8093 0000 sts Parameter_UserParam2,r24 |
3443 1bc0 8091 0000 lds r24,EE_Parameter+43 |
3444 1bc4 883F cpi r24,lo8(-8) |
3445 1bc6 38F0 brlo .L296 |
3446 1bc8 EFEF ldi r30,lo8(255) |
3447 1bca F0E0 ldi r31,hi8(255) |
3448 1bcc E81B sub r30,r24 |
3449 1bce F109 sbc r31,__zero_reg__ |
3450 1bd0 E050 subi r30,lo8(-(Poti)) |
3451 1bd2 F040 sbci r31,hi8(-(Poti)) |
3452 1bd4 8081 ld r24,Z |
3453 .L296: |
3454 1bd6 8093 0000 sts Parameter_UserParam3,r24 |
3455 1bda 8091 0000 lds r24,EE_Parameter+44 |
3456 1bde 883F cpi r24,lo8(-8) |
3457 1be0 38F0 brlo .L297 |
3458 1be2 EFEF ldi r30,lo8(255) |
3459 1be4 F0E0 ldi r31,hi8(255) |
3460 1be6 E81B sub r30,r24 |
3461 1be8 F109 sbc r31,__zero_reg__ |
3462 1bea E050 subi r30,lo8(-(Poti)) |
3463 1bec F040 sbci r31,hi8(-(Poti)) |
3464 1bee 8081 ld r24,Z |
3465 .L297: |
3466 1bf0 8093 0000 sts Parameter_UserParam4,r24 |
3467 1bf4 8091 0000 lds r24,EE_Parameter+68 |
3468 1bf8 883F cpi r24,lo8(-8) |
3469 1bfa 38F0 brlo .L298 |
3470 1bfc EFEF ldi r30,lo8(255) |
3471 1bfe F0E0 ldi r31,hi8(255) |
3472 1c00 E81B sub r30,r24 |
3473 1c02 F109 sbc r31,__zero_reg__ |
3474 1c04 E050 subi r30,lo8(-(Poti)) |
3475 1c06 F040 sbci r31,hi8(-(Poti)) |
3476 1c08 8081 ld r24,Z |
3477 .L298: |
3478 1c0a 8093 0000 sts Parameter_UserParam5,r24 |
3479 1c0e 8091 0000 lds r24,EE_Parameter+69 |
3480 1c12 883F cpi r24,lo8(-8) |
3481 1c14 38F0 brlo .L299 |
3482 1c16 EFEF ldi r30,lo8(255) |
3483 1c18 F0E0 ldi r31,hi8(255) |
3484 1c1a E81B sub r30,r24 |
3485 1c1c F109 sbc r31,__zero_reg__ |
3486 1c1e E050 subi r30,lo8(-(Poti)) |
3487 1c20 F040 sbci r31,hi8(-(Poti)) |
3488 1c22 8081 ld r24,Z |
3489 .L299: |
3490 1c24 8093 0000 sts Parameter_UserParam6,r24 |
3491 1c28 8091 0000 lds r24,EE_Parameter+70 |
3492 1c2c 883F cpi r24,lo8(-8) |
3493 1c2e 38F0 brlo .L300 |
3494 1c30 EFEF ldi r30,lo8(255) |
3495 1c32 F0E0 ldi r31,hi8(255) |
3496 1c34 E81B sub r30,r24 |
3497 1c36 F109 sbc r31,__zero_reg__ |
3498 1c38 E050 subi r30,lo8(-(Poti)) |
3499 1c3a F040 sbci r31,hi8(-(Poti)) |
3500 1c3c 8081 ld r24,Z |
3501 .L300: |
3502 1c3e 8093 0000 sts Parameter_UserParam7,r24 |
3503 1c42 8091 0000 lds r24,EE_Parameter+71 |
3504 1c46 883F cpi r24,lo8(-8) |
3505 1c48 38F0 brlo .L301 |
3506 1c4a EFEF ldi r30,lo8(255) |
3507 1c4c F0E0 ldi r31,hi8(255) |
3508 1c4e E81B sub r30,r24 |
3509 1c50 F109 sbc r31,__zero_reg__ |
3510 1c52 E050 subi r30,lo8(-(Poti)) |
3511 1c54 F040 sbci r31,hi8(-(Poti)) |
3512 1c56 8081 ld r24,Z |
3513 .L301: |
3514 1c58 8093 0000 sts Parameter_UserParam8,r24 |
3515 1c5c 8091 0000 lds r24,EE_Parameter+45 |
3516 1c60 883F cpi r24,lo8(-8) |
3517 1c62 38F0 brlo .L302 |
3518 1c64 EFEF ldi r30,lo8(255) |
3519 1c66 F0E0 ldi r31,hi8(255) |
3520 1c68 E81B sub r30,r24 |
3521 1c6a F109 sbc r31,__zero_reg__ |
3522 1c6c E050 subi r30,lo8(-(Poti)) |
3523 1c6e F040 sbci r31,hi8(-(Poti)) |
3524 1c70 8081 ld r24,Z |
3525 .L302: |
3526 1c72 8093 0000 sts Parameter_ServoNickControl,r24 |
3527 1c76 8091 0000 lds r24,EE_Parameter+49 |
3528 1c7a 883F cpi r24,lo8(-8) |
3529 1c7c 38F0 brlo .L303 |
3530 1c7e EFEF ldi r30,lo8(255) |
3531 1c80 F0E0 ldi r31,hi8(255) |
3532 1c82 E81B sub r30,r24 |
3533 1c84 F109 sbc r31,__zero_reg__ |
3534 1c86 E050 subi r30,lo8(-(Poti)) |
3535 1c88 F040 sbci r31,hi8(-(Poti)) |
3536 1c8a 8081 ld r24,Z |
3537 .L303: |
3538 1c8c 8093 0000 sts Parameter_ServoRollControl,r24 |
3539 1c90 8091 0000 lds r24,EE_Parameter+57 |
3540 1c94 883F cpi r24,lo8(-8) |
3541 1c96 38F0 brlo .L304 |
3542 1c98 EFEF ldi r30,lo8(255) |
3543 1c9a F0E0 ldi r31,hi8(255) |
3544 1c9c E81B sub r30,r24 |
3545 1c9e F109 sbc r31,__zero_reg__ |
3546 1ca0 E050 subi r30,lo8(-(Poti)) |
3547 1ca2 F040 sbci r31,hi8(-(Poti)) |
3548 1ca4 8081 ld r24,Z |
3549 .L304: |
3550 1ca6 8093 0000 sts Parameter_LoopGasLimit,r24 |
3551 1caa 8091 0000 lds r24,EE_Parameter+60 |
3552 1cae 883F cpi r24,lo8(-8) |
3553 1cb0 38F0 brlo .L305 |
3554 1cb2 EFEF ldi r30,lo8(255) |
3555 1cb4 F0E0 ldi r31,hi8(255) |
3556 1cb6 E81B sub r30,r24 |
3557 1cb8 F109 sbc r31,__zero_reg__ |
3558 1cba E050 subi r30,lo8(-(Poti)) |
3559 1cbc F040 sbci r31,hi8(-(Poti)) |
3560 1cbe 8081 ld r24,Z |
3561 .L305: |
3562 1cc0 8093 0000 sts Parameter_AchsKopplung1,r24 |
3563 1cc4 8091 0000 lds r24,EE_Parameter+61 |
3564 1cc8 883F cpi r24,lo8(-8) |
3565 1cca 38F0 brlo .L306 |
3566 1ccc EFEF ldi r30,lo8(255) |
3567 1cce F0E0 ldi r31,hi8(255) |
3568 1cd0 E81B sub r30,r24 |
3569 1cd2 F109 sbc r31,__zero_reg__ |
3570 1cd4 E050 subi r30,lo8(-(Poti)) |
3571 1cd6 F040 sbci r31,hi8(-(Poti)) |
3572 1cd8 8081 ld r24,Z |
3573 .L306: |
3574 1cda 8093 0000 sts Parameter_AchsKopplung2,r24 |
3575 1cde 8091 0000 lds r24,EE_Parameter+62 |
3576 1ce2 883F cpi r24,lo8(-8) |
3577 1ce4 38F0 brlo .L307 |
3578 1ce6 EFEF ldi r30,lo8(255) |
3579 1ce8 F0E0 ldi r31,hi8(255) |
3580 1cea E81B sub r30,r24 |
3581 1cec F109 sbc r31,__zero_reg__ |
3582 1cee E050 subi r30,lo8(-(Poti)) |
3583 1cf0 F040 sbci r31,hi8(-(Poti)) |
3584 1cf2 8081 ld r24,Z |
3585 .L307: |
3586 1cf4 8093 0000 sts Parameter_CouplingYawCorrection,r24 |
3587 1cf8 8091 0000 lds r24,EE_Parameter+67 |
3588 1cfc 883F cpi r24,lo8(-8) |
3589 1cfe 38F0 brlo .L308 |
3590 1d00 EFEF ldi r30,lo8(255) |
3591 1d02 F0E0 ldi r31,hi8(255) |
3592 1d04 E81B sub r30,r24 |
3593 1d06 F109 sbc r31,__zero_reg__ |
3594 1d08 E050 subi r30,lo8(-(Poti)) |
3595 1d0a F040 sbci r31,hi8(-(Poti)) |
3596 1d0c 8081 ld r24,Z |
3597 .L308: |
3598 1d0e 8093 0000 sts Parameter_DynamicStability,r24 |
3599 1d12 8091 0000 lds r24,EE_Parameter+94 |
3600 1d16 883F cpi r24,lo8(-8) |
3601 1d18 38F0 brlo .L309 |
3602 1d1a EFEF ldi r30,lo8(255) |
3603 1d1c F0E0 ldi r31,hi8(255) |
3604 1d1e E81B sub r30,r24 |
3605 1d20 F109 sbc r31,__zero_reg__ |
3606 1d22 E050 subi r30,lo8(-(Poti)) |
3607 1d24 F040 sbci r31,hi8(-(Poti)) |
3608 1d26 8081 ld r24,Z |
3609 .L309: |
3610 1d28 8093 0000 sts Parameter_ExternalControl,r24 |
3611 1d2c 8091 0000 lds r24,Parameter_I_Faktor |
3612 1d30 282F mov r18,r24 |
3613 1d32 3327 clr r19 |
3614 1d34 2F5F subi r18,lo8(-(1)) |
3615 1d36 3F4F sbci r19,hi8(-(1)) |
3616 1d38 8CE3 ldi r24,lo8(10300) |
3617 1d3a 98E2 ldi r25,hi8(10300) |
3618 1d3c B901 movw r22,r18 |
3619 1d3e 0E94 0000 call __divmodhi4 |
3620 1d42 7093 0000 sts (Ki)+1,r23 |
3621 1d46 6093 0000 sts Ki,r22 |
3622 1d4a 8091 0000 lds r24,EE_Parameter+27 |
3623 1d4e 8093 0000 sts MAX_GAS,r24 |
3624 1d52 8091 0000 lds r24,EE_Parameter+26 |
3625 1d56 8093 0000 sts MIN_GAS,r24 |
3626 1d5a 9091 0000 lds r25,EE_Parameter+96 |
3627 1d5e 9333 cpi r25,lo8(51) |
3628 1d60 20F1 brlo .L267 |
3629 1d62 81E0 ldi r24,lo8(1) |
3630 1d64 8093 0000 sts CareFree,r24 |
3631 1d68 983F cpi r25,lo8(-8) |
3632 1d6a 58F0 brlo .L268 |
3633 1d6c EFEF ldi r30,lo8(255) |
3634 1d6e F0E0 ldi r31,hi8(255) |
3635 1d70 E91B sub r30,r25 |
3636 1d72 F109 sbc r31,__zero_reg__ |
3637 1d74 E050 subi r30,lo8(-(Poti)) |
3638 1d76 F040 sbci r31,hi8(-(Poti)) |
3639 1d78 8081 ld r24,Z |
3640 1d7a 8233 cpi r24,lo8(50) |
3641 1d7c 10F4 brsh .L268 |
3642 1d7e 1092 0000 sts CareFree,__zero_reg__ |
3643 .L268: |
3644 1d82 8091 0000 lds r24,FromNaviCtrl+7 |
3645 1d86 9091 0000 lds r25,(FromNaviCtrl+7)+1 |
3646 1d8a 97FF sbrs r25,7 |
3647 1d8c 08C0 rjmp .L269 |
3648 1d8e 8091 0000 lds r24,CareFree |
3649 1d92 8823 tst r24 |
3650 1d94 21F0 breq .L269 |
3651 1d96 8091 0000 lds r24,VersionInfo+5 |
3652 1d9a 8068 ori r24,lo8(-128) |
3653 1d9c 03C0 rjmp .L310 |
3654 .L269: |
3655 1d9e 8091 0000 lds r24,VersionInfo+5 |
3656 1da2 8F77 andi r24,lo8(127) |
3657 .L310: |
3658 1da4 8093 0000 sts VersionInfo+5,r24 |
3659 1da8 02C0 rjmp .L271 |
3660 .L267: |
3661 1daa 1092 0000 sts CareFree,__zero_reg__ |
3662 .L271: |
3663 1dae 8091 0000 lds r24,FromNaviCtrl+7 |
3664 1db2 9091 0000 lds r25,(FromNaviCtrl+7)+1 |
3665 1db6 97FF sbrs r25,7 |
3666 1db8 1DC0 rjmp .L272 |
3667 1dba 8091 0000 lds r24,MotorenEin |
3668 1dbe 8823 tst r24 |
3669 1dc0 C9F0 breq .L272 |
3670 1dc2 8091 0000 lds r24,CareFree |
3671 1dc6 8823 tst r24 |
3672 1dc8 A9F0 breq .L272 |
3673 1dca 8091 0000 lds r24,BeepMuster |
3674 1dce 9091 0000 lds r25,(BeepMuster)+1 |
3675 1dd2 8F5F subi r24,lo8(-1) |
3676 1dd4 9F4F sbci r25,hi8(-1) |
3677 1dd6 71F4 brne .L272 |
3678 1dd8 88E9 ldi r24,lo8(15000) |
3679 1dda 9AE3 ldi r25,hi8(15000) |
3680 1ddc 9093 0000 sts (beeptime)+1,r25 |
3681 1de0 8093 0000 sts beeptime,r24 |
3682 1de4 80E0 ldi r24,lo8(-23552) |
3683 1de6 94EA ldi r25,hi8(-23552) |
3684 1de8 9093 0000 sts (BeepMuster)+1,r25 |
3685 1dec 8093 0000 sts BeepMuster,r24 |
3686 1df0 1092 0000 sts CareFree,__zero_reg__ |
3687 .L272: |
3688 1df4 8091 0000 lds r24,CareFree |
3689 1df8 8823 tst r24 |
3690 1dfa 39F0 breq .L183 |
3691 1dfc 8091 0000 lds r24,Parameter_AchsKopplung1 |
3692 1e00 823D cpi r24,lo8(-46) |
3693 1e02 18F4 brsh .L183 |
3694 1e04 825E subi r24,lo8(-(30)) |
3695 1e06 8093 0000 sts Parameter_AchsKopplung1,r24 |
3696 .L183: |
3697 1e0a 0895 ret |
3698 /* epilogue: frame size=0 */ |
3699 /* epilogue: noreturn */ |
3700 /* epilogue end (size=0) */ |
3701 /* function ParameterZuordnung size 607 (607) */ |
3703 .lcomm sollGier.0,4 |
3704 .lcomm tmp_long.1,4 |
3705 .lcomm tmp_long2.2,4 |
3706 .lcomm IntegralFehlerNick.3,4 |
3707 .lcomm IntegralFehlerRoll.4,4 |
3708 .lcomm RcLostTimer.5,2 |
3709 .lcomm delay_neutral.6,1 |
3710 .lcomm delay_einschalten.7,1 |
3711 .lcomm delay_ausschalten.8,1 |
3712 .lcomm calibration_done.9,1 |
3713 .lcomm NeueKompassRichtungMerken.10,1 |
3714 .lcomm ausgleichNick.11,4 |
3715 .lcomm ausgleichRoll.12,4 |
3716 .lcomm stick_nick.13,2 |
3717 .lcomm stick_roll.14,2 |
3718 .lcomm cnt.15,2 |
3719 .lcomm last_n_p.16,1 |
3720 .lcomm last_n_n.17,1 |
3721 .lcomm last_r_p.18,1 |
3722 .lcomm last_r_n.19,1 |
3723 .lcomm MittelIntegralNick_Alt.20,4 |
3724 .lcomm MittelIntegralRoll_Alt.21,4 |
3725 .lcomm HeightTrimming.22,2 |
3726 .lcomm FilterHCGas.23,2 |
3727 .data |
3730 StickGasHover.24: |
3731 0027 7800 .word 120 |
3732 .lcomm HoverGasMin.25,2 |
3735 HoverGasMax.26: |
3736 0029 FF03 .word 1023 |
3737 .lcomm HoverGasFilter.27,4 |
3740 delay.28: |
3741 002b 64 .byte 100 |
3742 .lcomm BaroAtUpperLimit.29,1 |
3743 .lcomm BaroAtLowerLimit.30,1 |
3744 .lcomm HeightTrimmingFlag.31,1 |
3745 .LC0: |
3746 002c 00 .byte 0 |
3747 002d 02 .byte 2 |
3748 002e 04 .byte 4 |
3749 002f 06 .byte 6 |
3750 0030 07 .byte 7 |
3751 0031 08 .byte 8 |
3752 0032 08 .byte 8 |
3753 0033 08 .byte 8 |
3754 0034 07 .byte 7 |
3755 0035 06 .byte 6 |
3756 0036 04 .byte 4 |
3757 0037 02 .byte 2 |
3758 0038 00 .byte 0 |
3759 0039 FE .byte -2 |
3760 003a FC .byte -4 |
3761 003b FA .byte -6 |
3762 003c F9 .byte -7 |
3763 003d F8 .byte -8 |
3764 003e F8 .byte -8 |
3765 003f F8 .byte -8 |
3766 0040 F9 .byte -7 |
3767 0041 FA .byte -6 |
3768 0042 FC .byte -4 |
3769 0043 FE .byte -2 |
3770 0044 00 .byte 0 |
3771 0045 02 .byte 2 |
3772 0046 04 .byte 4 |
3773 0047 06 .byte 6 |
3774 0048 07 .byte 7 |
3775 0049 08 .byte 8 |
3776 004a 08 .byte 8 |
3777 .text |
3778 .global MotorRegler |
3780 MotorRegler: |
3781 /* prologue: frame size=53 */ |
3782 1e0c A5E3 ldi r26,lo8(53) |
3783 1e0e B0E0 ldi r27,hi8(53) |
3784 1e10 E0E0 ldi r30,pm_lo8(1f) |
3785 1e12 F0E0 ldi r31,pm_hi8(1f) |
3786 1e14 0C94 0000 jmp __prologue_saves__+0 |
3787 1: |
3788 /* prologue end (size=6) */ |
3789 1e18 0E94 0000 call Mittelwert |
3790 1e1c 3091 0000 lds r19,PlatinenVersion |
3791 1e20 3C30 cpi r19,lo8(12) |
3792 1e22 10F4 brsh .L312 |
3793 1e24 299A sbi 37-0x20,1 |
3794 1e26 01C0 rjmp .L313 |
3795 .L312: |
3796 1e28 2998 cbi 37-0x20,1 |
3797 .L313: |
3798 1e2a E090 0000 lds r14,StickGas |
3799 1e2e F090 0000 lds r15,(StickGas)+1 |
3800 1e32 F9A2 std Y+33,r15 |
3801 1e34 E8A2 std Y+32,r14 |
3802 1e36 8091 0000 lds r24,MIN_GAS |
3803 1e3a 9927 clr r25 |
3804 1e3c 0A96 adiw r24,10 |
3805 1e3e E816 cp r14,r24 |
3806 1e40 F906 cpc r15,r25 |
3807 1e42 14F4 brge .L314 |
3808 1e44 99A3 std Y+33,r25 |
3809 1e46 88A3 std Y+32,r24 |
3810 .L314: |
3811 1e48 8091 0000 lds r24,SenderOkay |
3812 1e4c 8436 cpi r24,lo8(100) |
3813 1e4e 08F0 brlo .+2 |
3814 1e50 5CC0 rjmp .L315 |
3815 1e52 8091 0000 lds r24,RcLostTimer.5 |
3816 1e56 9091 0000 lds r25,(RcLostTimer.5)+1 |
3817 1e5a 0097 sbiw r24,0 |
3818 1e5c 31F0 breq .L316 |
3819 1e5e 0197 sbiw r24,1 |
3820 1e60 9093 0000 sts (RcLostTimer.5)+1,r25 |
3821 1e64 8093 0000 sts RcLostTimer.5,r24 |
3822 1e68 07C0 rjmp .L317 |
3823 .L316: |
3824 1e6a 1092 0000 sts MotorenEin,__zero_reg__ |
3825 1e6e 8091 0000 lds r24,FCFlags |
3826 1e72 8F7E andi r24,lo8(-17) |
3827 1e74 8093 0000 sts FCFlags,r24 |
3828 .L317: |
3829 1e78 3A30 cpi r19,lo8(10) |
3830 1e7a 11F0 breq .L319 |
3831 1e7c 3431 cpi r19,lo8(20) |
3832 1e7e 10F0 brlo .L318 |
3833 .L319: |
3834 1e80 289A sbi 37-0x20,0 |
3835 1e82 01C0 rjmp .L320 |
3836 .L318: |
3837 1e84 2898 cbi 37-0x20,0 |
3838 .L320: |
3839 1e86 8091 0000 lds r24,modell_fliegt |
3840 1e8a 9091 0000 lds r25,(modell_fliegt)+1 |
3841 1e8e 895E subi r24,lo8(1001) |
3842 1e90 9340 sbci r25,hi8(1001) |
3843 1e92 C0F1 brlo .L321 |
3844 1e94 8091 0000 lds r24,EE_Parameter+37 |
3845 1e98 282F mov r18,r24 |
3846 1e9a 3327 clr r19 |
3847 1e9c 39A3 std Y+33,r19 |
3848 1e9e 28A3 std Y+32,r18 |
3849 1ea0 8091 0000 lds r24,FCFlags |
3850 1ea4 8061 ori r24,lo8(16) |
3851 1ea6 8093 0000 sts FCFlags,r24 |
3852 1eaa 8091 0000 lds r24,EE_Parameter+1 |
3853 1eae A82F mov r26,r24 |
3854 1eb0 BB27 clr r27 |
3855 1eb2 AA0F add r26,r26 |
3856 1eb4 BB1F adc r27,r27 |
3857 1eb6 FD01 movw r30,r26 |
3858 1eb8 E050 subi r30,lo8(-(PPM_diff)) |
3859 1eba F040 sbci r31,hi8(-(PPM_diff)) |
3860 1ebc 1182 std Z+1,__zero_reg__ |
3861 1ebe 1082 st Z,__zero_reg__ |
3862 1ec0 8091 0000 lds r24,EE_Parameter+2 |
3863 1ec4 282F mov r18,r24 |
3864 1ec6 3327 clr r19 |
3865 1ec8 220F add r18,r18 |
3866 1eca 331F adc r19,r19 |
3867 1ecc C901 movw r24,r18 |
3868 1ece 8050 subi r24,lo8(-(PPM_diff)) |
3869 1ed0 9040 sbci r25,hi8(-(PPM_diff)) |
3870 1ed2 FC01 movw r30,r24 |
3871 1ed4 1182 std Z+1,__zero_reg__ |
3872 1ed6 1082 st Z,__zero_reg__ |
3873 1ed8 A050 subi r26,lo8(-(PPM_in)) |
3874 1eda B040 sbci r27,hi8(-(PPM_in)) |
3875 1edc 1196 adiw r26,1 |
3876 1ede 1C92 st X,__zero_reg__ |
3877 1ee0 1E92 st -X,__zero_reg__ |
3878 1ee2 2050 subi r18,lo8(-(PPM_in)) |
3879 1ee4 3040 sbci r19,hi8(-(PPM_in)) |
3880 1ee6 D901 movw r26,r18 |
3881 1ee8 1196 adiw r26,1 |
3882 1eea 1C92 st X,__zero_reg__ |
3883 1eec 1E92 st -X,__zero_reg__ |
3884 1eee 8091 0000 lds r24,EE_Parameter+4 |
3885 1ef2 E82F mov r30,r24 |
3886 1ef4 FF27 clr r31 |
3887 1ef6 EE0F add r30,r30 |
3888 1ef8 FF1F adc r31,r31 |
3889 1efa E050 subi r30,lo8(-(PPM_in)) |
3890 1efc F040 sbci r31,hi8(-(PPM_in)) |
3891 1efe 1182 std Z+1,__zero_reg__ |
3892 1f00 1082 st Z,__zero_reg__ |
3893 1f02 AAC2 rjmp .L323 |
3894 .L321: |
3895 1f04 1092 0000 sts MotorenEin,__zero_reg__ |
3896 1f08 A7C2 rjmp .L323 |
3897 .L315: |
3898 1f0a 8091 0000 lds r24,SenderOkay |
3899 1f0e 8D38 cpi r24,lo8(-115) |
3900 1f10 08F4 brsh .+2 |
3901 1f12 A2C2 rjmp .L323 |
3902 1f14 8091 0000 lds r24,FCFlags |
3903 1f18 8F7E andi r24,lo8(-17) |
3904 1f1a 8093 0000 sts FCFlags,r24 |
3905 1f1e 9091 0000 lds r25,EE_Parameter+38 |
3906 1f22 82E3 ldi r24,lo8(50) |
3907 1f24 989F mul r25,r24 |
3908 1f26 C001 movw r24,r0 |
3909 1f28 1124 clr r1 |
3910 1f2a 9093 0000 sts (RcLostTimer.5)+1,r25 |
3911 1f2e 8093 0000 sts RcLostTimer.5,r24 |
3912 1f32 E8A1 ldd r30,Y+32 |
3913 1f34 F9A1 ldd r31,Y+33 |
3914 1f36 B997 sbiw r30,41 |
3915 1f38 8CF0 brlt .L325 |
3916 1f3a 8091 0000 lds r24,MotorenEin |
3917 1f3e 8823 tst r24 |
3918 1f40 69F0 breq .L325 |
3919 1f42 8091 0000 lds r24,modell_fliegt |
3920 1f46 9091 0000 lds r25,(modell_fliegt)+1 |
3921 1f4a FFEF ldi r31,hi8(-1) |
3922 1f4c 8F3F cpi r24,lo8(-1) |
3923 1f4e 9F07 cpc r25,r31 |
3924 1f50 29F0 breq .L325 |
3925 1f52 0196 adiw r24,1 |
3926 1f54 9093 0000 sts (modell_fliegt)+1,r25 |
3927 1f58 8093 0000 sts modell_fliegt,r24 |
3928 .L325: |
3929 1f5c 8091 0000 lds r24,modell_fliegt |
3930 1f60 9091 0000 lds r25,(modell_fliegt)+1 |
3931 1f64 8F3F cpi r24,255 |
3932 1f66 9105 cpc r25,__zero_reg__ |
3933 1f68 09F0 breq .+2 |
3934 1f6a 38F5 brsh .L327 |
3935 1f6c 1092 0000 sts SummeNick,__zero_reg__ |
3936 1f70 1092 0000 sts (SummeNick)+1,__zero_reg__ |
3937 1f74 1092 0000 sts (SummeNick)+2,__zero_reg__ |
3938 1f78 1092 0000 sts (SummeNick)+3,__zero_reg__ |
3939 1f7c 1092 0000 sts SummeRoll,__zero_reg__ |
3940 1f80 1092 0000 sts (SummeRoll)+1,__zero_reg__ |
3941 1f84 1092 0000 sts (SummeRoll)+2,__zero_reg__ |
3942 1f88 1092 0000 sts (SummeRoll)+3,__zero_reg__ |
3943 1f8c 1092 0000 sts sollGier.0,__zero_reg__ |
3944 1f90 1092 0000 sts (sollGier.0)+1,__zero_reg__ |
3945 1f94 1092 0000 sts (sollGier.0)+2,__zero_reg__ |
3946 1f98 1092 0000 sts (sollGier.0)+3,__zero_reg__ |
3947 1f9c 1092 0000 sts Mess_Integral_Gier,__zero_reg__ |
3948 1fa0 1092 0000 sts (Mess_Integral_Gier)+1,__zero_reg__ |
3949 1fa4 1092 0000 sts (Mess_Integral_Gier)+2,__zero_reg__ |
3950 1fa8 1092 0000 sts (Mess_Integral_Gier)+3,__zero_reg__ |
3951 1fac 8A3F cpi r24,250 |
3952 1fae 9105 cpc r25,__zero_reg__ |
3953 1fb0 49F4 brne .L329 |
3954 1fb2 81E0 ldi r24,lo8(1) |
3955 1fb4 8093 0000 sts NeueKompassRichtungMerken.10,r24 |
3956 1fb8 05C0 rjmp .L329 |
3957 .L327: |
3958 1fba 8091 0000 lds r24,FCFlags |
3959 1fbe 8260 ori r24,lo8(2) |
3960 1fc0 8093 0000 sts FCFlags,r24 |
3961 .L329: |
3962 1fc4 8091 0000 lds r24,EE_Parameter+3 |
3963 1fc8 E82F mov r30,r24 |
3964 1fca FF27 clr r31 |
3965 1fcc EE0F add r30,r30 |
3966 1fce FF1F adc r31,r31 |
3967 1fd0 E050 subi r30,lo8(-(PPM_in)) |
3968 1fd2 F040 sbci r31,hi8(-(PPM_in)) |
3969 1fd4 8081 ld r24,Z |
3970 1fd6 9181 ldd r25,Z+1 |
3971 1fd8 8135 cpi r24,81 |
3972 1fda 9105 cpc r25,__zero_reg__ |
3973 1fdc 0CF4 brge .+2 |
3974 1fde 41C1 rjmp .L330 |
3975 1fe0 2091 0000 lds r18,MotorenEin |
3976 1fe4 2223 tst r18 |
3977 1fe6 09F0 breq .+2 |
3978 1fe8 3CC1 rjmp .L330 |
3979 1fea 8091 0000 lds r24,EE_Parameter+4 |
3980 1fee E82F mov r30,r24 |
3981 1ff0 FF27 clr r31 |
3982 1ff2 EE0F add r30,r30 |
3983 1ff4 FF1F adc r31,r31 |
3984 1ff6 E050 subi r30,lo8(-(PPM_in)) |
3985 1ff8 F040 sbci r31,hi8(-(PPM_in)) |
3986 1ffa 8081 ld r24,Z |
3987 1ffc 9181 ldd r25,Z+1 |
3988 1ffe 8C34 cpi r24,76 |
3989 2000 9105 cpc r25,__zero_reg__ |
3990 2002 0CF4 brge .+2 |
3991 2004 06C1 rjmp .L331 |
3992 2006 8091 0000 lds r24,delay_neutral.6 |
3993 200a 8F5F subi r24,lo8(-(1)) |
3994 200c 8093 0000 sts delay_neutral.6,r24 |
3995 2010 893C cpi r24,lo8(-55) |
3996 2012 08F4 brsh .+2 |
3997 2014 26C1 rjmp .L330 |
3998 2016 3C30 cpi r19,lo8(12) |
3999 2018 10F4 brsh .L333 |
4000 201a 2998 cbi 37-0x20,1 |
4001 201c 01C0 rjmp .L334 |
4002 .L333: |
4003 201e 299A sbi 37-0x20,1 |
4004 .L334: |
4005 2020 1092 0000 sts MotorenEin,__zero_reg__ |
4006 2024 1092 0000 sts delay_neutral.6,__zero_reg__ |
4007 2028 1092 0000 sts (modell_fliegt)+1,__zero_reg__ |
4008 202c 1092 0000 sts modell_fliegt,__zero_reg__ |
4009 2030 3091 0000 lds r19,EE_Parameter+1 |
4010 2034 E32F mov r30,r19 |
4011 2036 FF27 clr r31 |
4012 2038 EE0F add r30,r30 |
4013 203a FF1F adc r31,r31 |
4014 203c E050 subi r30,lo8(-(PPM_in)) |
4015 203e F040 sbci r31,hi8(-(PPM_in)) |
4016 2040 8081 ld r24,Z |
4017 2042 9181 ldd r25,Z+1 |
4018 2044 8734 cpi r24,71 |
4019 2046 9105 cpc r25,__zero_reg__ |
4020 2048 B4F4 brge .L336 |
4021 204a 8091 0000 lds r24,EE_Parameter+2 |
4022 204e E82F mov r30,r24 |
4023 2050 FF27 clr r31 |
4024 2052 EE0F add r30,r30 |
4025 2054 FF1F adc r31,r31 |
4026 2056 E050 subi r30,lo8(-(PPM_in)) |
4027 2058 F040 sbci r31,hi8(-(PPM_in)) |
4028 205a 8081 ld r24,Z |
4029 205c 9181 ldd r25,Z+1 |
4030 205e 0190 ld __tmp_reg__,Z+ |
4031 2060 F081 ld r31,Z |
4032 2062 E02D mov r30,__tmp_reg__ |
4033 2064 F7FF sbrs r31,7 |
4034 2066 03C0 rjmp .L337 |
4035 2068 F095 com r31 |
4036 206a E195 neg r30 |
4037 206c FF4F sbci r31,lo8(-1) |
4038 .L337: |
4039 206e E734 cpi r30,71 |
4040 2070 F105 cpc r31,__zero_reg__ |
4041 2072 0CF4 brge .+2 |
4042 2074 78C0 rjmp .L335 |
4043 .L336: |
4044 2076 41E0 ldi r20,lo8(1) |
4045 2078 2091 0000 lds r18,EE_Parameter+2 |
4046 207c A22F mov r26,r18 |
4047 207e BB27 clr r27 |
4048 2080 AA0F add r26,r26 |
4049 2082 BB1F adc r27,r27 |
4050 2084 A050 subi r26,lo8(-(PPM_in)) |
4051 2086 B040 sbci r27,hi8(-(PPM_in)) |
4052 2088 8D91 ld r24,X+ |
4053 208a 9C91 ld r25,X |
4054 208c 1197 sbiw r26,1 |
4055 208e 8734 cpi r24,71 |
4056 2090 9105 cpc r25,__zero_reg__ |
4057 2092 44F0 brlt .L338 |
4058 2094 E32F mov r30,r19 |
4059 2096 FF27 clr r31 |
4060 2098 EE0F add r30,r30 |
4061 209a FF1F adc r31,r31 |
4062 209c E050 subi r30,lo8(-(PPM_in)) |
4063 209e F040 sbci r31,hi8(-(PPM_in)) |
4064 20a0 8081 ld r24,Z |
4065 20a2 9181 ldd r25,Z+1 |
4066 .L338: |
4067 20a4 8D91 ld r24,X+ |
4068 20a6 9C91 ld r25,X |
4069 20a8 8734 cpi r24,71 |
4070 20aa 9105 cpc r25,__zero_reg__ |
4071 20ac 74F0 brlt .L339 |
4072 20ae 8091 0000 lds r24,EE_Parameter+1 |
4073 20b2 E82F mov r30,r24 |
4074 20b4 FF27 clr r31 |
4075 20b6 EE0F add r30,r30 |
4076 20b8 FF1F adc r31,r31 |
4077 20ba E050 subi r30,lo8(-(PPM_in)) |
4078 20bc F040 sbci r31,hi8(-(PPM_in)) |
4079 20be 8081 ld r24,Z |
4080 20c0 9181 ldd r25,Z+1 |
4081 20c2 8734 cpi r24,71 |
4082 20c4 9105 cpc r25,__zero_reg__ |
4083 20c6 0CF0 brlt .L339 |
4084 20c8 42E0 ldi r20,lo8(2) |
4085 .L339: |
4086 20ca E22F mov r30,r18 |
4087 20cc FF27 clr r31 |
4088 20ce EE0F add r30,r30 |
4089 20d0 FF1F adc r31,r31 |
4090 20d2 E050 subi r30,lo8(-(PPM_in)) |
4091 20d4 F040 sbci r31,hi8(-(PPM_in)) |
4092 20d6 8081 ld r24,Z |
4093 20d8 9181 ldd r25,Z+1 |
4094 20da 8634 cpi r24,70 |
4095 20dc 9105 cpc r25,__zero_reg__ |
4096 20de 74F4 brge .L340 |
4097 20e0 8091 0000 lds r24,EE_Parameter+1 |
4098 20e4 E82F mov r30,r24 |
4099 20e6 FF27 clr r31 |
4100 20e8 EE0F add r30,r30 |
4101 20ea FF1F adc r31,r31 |
4102 20ec E050 subi r30,lo8(-(PPM_in)) |
4103 20ee F040 sbci r31,hi8(-(PPM_in)) |
4104 20f0 8081 ld r24,Z |
4105 20f2 9181 ldd r25,Z+1 |
4106 20f4 8734 cpi r24,71 |
4107 20f6 9105 cpc r25,__zero_reg__ |
4108 20f8 0CF0 brlt .L340 |
4109 20fa 43E0 ldi r20,lo8(3) |
4110 .L340: |
4111 20fc E22F mov r30,r18 |
4112 20fe FF27 clr r31 |
4113 2100 EE0F add r30,r30 |
4114 2102 FF1F adc r31,r31 |
4115 2104 E050 subi r30,lo8(-(PPM_in)) |
4116 2106 F040 sbci r31,hi8(-(PPM_in)) |
4117 2108 8081 ld r24,Z |
4118 210a 9181 ldd r25,Z+1 |
4119 210c 8A5B subi r24,lo8(-70) |
4120 210e 9F4F sbci r25,hi8(-70) |
4121 2110 74F4 brge .L341 |
4122 2112 8091 0000 lds r24,EE_Parameter+1 |
4123 2116 E82F mov r30,r24 |
4124 2118 FF27 clr r31 |
4125 211a EE0F add r30,r30 |
4126 211c FF1F adc r31,r31 |
4127 211e E050 subi r30,lo8(-(PPM_in)) |
4128 2120 F040 sbci r31,hi8(-(PPM_in)) |
4129 2122 8081 ld r24,Z |
4130 2124 9181 ldd r25,Z+1 |
4131 2126 8734 cpi r24,71 |
4132 2128 9105 cpc r25,__zero_reg__ |
4133 212a 0CF0 brlt .L341 |
4134 212c 44E0 ldi r20,lo8(4) |
4135 .L341: |
4136 212e E22F mov r30,r18 |
4137 2130 FF27 clr r31 |
4138 2132 EE0F add r30,r30 |
4139 2134 FF1F adc r31,r31 |
4140 2136 E050 subi r30,lo8(-(PPM_in)) |
4141 2138 F040 sbci r31,hi8(-(PPM_in)) |
4142 213a 8081 ld r24,Z |
4143 213c 9181 ldd r25,Z+1 |
4144 213e 8A5B subi r24,lo8(-70) |
4145 2140 9F4F sbci r25,hi8(-70) |
4146 2142 74F4 brge .L342 |
4147 2144 8091 0000 lds r24,EE_Parameter+1 |
4148 2148 E82F mov r30,r24 |
4149 214a FF27 clr r31 |
4150 214c EE0F add r30,r30 |
4151 214e FF1F adc r31,r31 |
4152 2150 E050 subi r30,lo8(-(PPM_in)) |
4153 2152 F040 sbci r31,hi8(-(PPM_in)) |
4154 2154 8081 ld r24,Z |
4155 2156 9181 ldd r25,Z+1 |
4156 2158 8634 cpi r24,70 |
4157 215a 9105 cpc r25,__zero_reg__ |
4158 215c 0CF4 brge .L342 |
4159 215e 45E0 ldi r20,lo8(5) |
4160 .L342: |
4161 2160 842F mov r24,r20 |
4162 2162 0E94 0000 call SetActiveParamSet |
4163 .L335: |
4164 2166 8091 0000 lds r24,EE_Parameter+2 |
4165 216a E82F mov r30,r24 |
4166 216c FF27 clr r31 |
4167 216e EE0F add r30,r30 |
4168 2170 FF1F adc r31,r31 |
4169 2172 E050 subi r30,lo8(-(PPM_in)) |
4170 2174 F040 sbci r31,hi8(-(PPM_in)) |
4171 2176 8081 ld r24,Z |
4172 2178 9181 ldd r25,Z+1 |
4173 217a 0190 ld __tmp_reg__,Z+ |
4174 217c F081 ld r31,Z |
4175 217e E02D mov r30,__tmp_reg__ |
4176 2180 F7FF sbrs r31,7 |
4177 2182 03C0 rjmp .L344 |
4178 2184 F095 com r31 |
4179 2186 E195 neg r30 |
4180 2188 FF4F sbci r31,lo8(-1) |
4181 .L344: |
4182 218a 7E97 sbiw r30,30 |
4183 218c BCF4 brge .L343 |
4184 218e 8091 0000 lds r24,EE_Parameter+1 |
4185 2192 E82F mov r30,r24 |
4186 2194 FF27 clr r31 |
4187 2196 EE0F add r30,r30 |
4188 2198 FF1F adc r31,r31 |
4189 219a E050 subi r30,lo8(-(PPM_in)) |
4190 219c F040 sbci r31,hi8(-(PPM_in)) |
4191 219e 8081 ld r24,Z |
4192 21a0 9181 ldd r25,Z+1 |
4193 21a2 8A5B subi r24,lo8(-70) |
4194 21a4 9F4F sbci r25,hi8(-70) |
4195 21a6 54F4 brge .L343 |
4196 21a8 81E0 ldi r24,lo8(1) |
4197 21aa 8093 0000 sts WinkelOut+6,r24 |
4198 21ae 88EE ldi r24,lo8(1000) |
4199 21b0 93E0 ldi r25,hi8(1000) |
4200 21b2 9093 0000 sts (beeptime)+1,r25 |
4201 21b6 8093 0000 sts beeptime,r24 |
4202 21ba 53C0 rjmp .L330 |
4203 .L343: |
4204 21bc 0E94 0000 call GetActiveParamSet |
4205 21c0 0E94 0000 call ParamSet_ReadFromEEProm |
4206 21c4 80E0 ldi r24,lo8(0) |
4207 21c6 0E94 0000 call LipoDetection |
4208 21ca 8091 0000 lds r24,EE_Parameter+39 |
4209 21ce 0E94 0000 call LIBFC_ReceiverInit |
4210 21d2 8091 0000 lds r24,EE_Parameter+13 |
4211 21d6 80FF sbrs r24,0 |
4212 21d8 10C0 rjmp .L346 |
4213 21da 8091 0000 lds r24,MessLuftdruck |
4214 21de 9091 0000 lds r25,(MessLuftdruck)+1 |
4215 21e2 875B subi r24,lo8(951) |
4216 21e4 9340 sbci r25,hi8(951) |
4217 21e6 38F4 brsh .L348 |
4218 21e8 8091 0000 lds r24,MessLuftdruck |
4219 21ec 9091 0000 lds r25,(MessLuftdruck)+1 |
4220 21f0 8E5E subi r24,lo8(750) |
4221 21f2 9240 sbci r25,hi8(750) |
4222 21f4 10F4 brsh .L346 |
4223 .L348: |
4224 21f6 0E94 0000 call SucheLuftruckOffset |
4225 .L346: |
4226 21fa 1092 0000 sts ServoActive,__zero_reg__ |
4227 21fe 80E0 ldi r24,lo8(0) |
4228 2200 0E94 0000 call SetNeutral |
4229 2204 81E0 ldi r24,lo8(1) |
4230 2206 8093 0000 sts calibration_done.9,r24 |
4231 220a 8093 0000 sts ServoActive,r24 |
4232 220e 579A sbi 42-0x20,7 |
4233 2210 1FC0 rjmp .L781 |
4234 .L331: |
4235 2212 8081 ld r24,Z |
4236 2214 9181 ldd r25,Z+1 |
4237 2216 855B subi r24,lo8(-75) |
4238 2218 9F4F sbci r25,hi8(-75) |
4239 221a 0CF5 brge .L350 |
4240 221c 8091 0000 lds r24,delay_neutral.6 |
4241 2220 8F5F subi r24,lo8(-(1)) |
4242 2222 8093 0000 sts delay_neutral.6,r24 |
4243 2226 893C cpi r24,lo8(-55) |
4244 2228 E0F0 brlo .L330 |
4245 222a 3C30 cpi r19,lo8(12) |
4246 222c 10F4 brsh .L352 |
4247 222e 2998 cbi 37-0x20,1 |
4248 2230 01C0 rjmp .L353 |
4249 .L352: |
4250 2232 299A sbi 37-0x20,1 |
4251 .L353: |
4252 2234 1092 0000 sts MotorenEin,__zero_reg__ |
4253 2238 1092 0000 sts delay_neutral.6,__zero_reg__ |
4254 223c 1092 0000 sts (modell_fliegt)+1,__zero_reg__ |
4255 2240 1092 0000 sts modell_fliegt,__zero_reg__ |
4256 2244 81E0 ldi r24,lo8(1) |
4257 2246 0E94 0000 call SetNeutral |
4258 224a 81E0 ldi r24,lo8(1) |
4259 224c 8093 0000 sts calibration_done.9,r24 |
4260 .L781: |
4261 2250 0E94 0000 call GetActiveParamSet |
4262 2254 68E7 ldi r22,lo8(120) |
4263 2256 70E0 ldi r23,hi8(120) |
4264 2258 0E94 0000 call Piep |
4265 225c 02C0 rjmp .L330 |
4266 .L350: |
4267 225e 2093 0000 sts delay_neutral.6,r18 |
4268 .L330: |
4269 2262 8091 0000 lds r24,EE_Parameter+3 |
4270 2266 E82F mov r30,r24 |
4271 2268 FF27 clr r31 |
4272 226a EE0F add r30,r30 |
4273 226c FF1F adc r31,r31 |
4274 226e E050 subi r30,lo8(-(PPM_in)) |
4275 2270 F040 sbci r31,hi8(-(PPM_in)) |
4276 2272 8081 ld r24,Z |
4277 2274 9181 ldd r25,Z+1 |
4278 2276 8B5A subi r24,lo8(-85) |
4279 2278 9F4F sbci r25,hi8(-85) |
4280 227a 0CF0 brlt .+2 |
4281 227c EDC0 rjmp .L323 |
4282 227e 2091 0000 lds r18,MotorenEin |
4283 2282 E091 0000 lds r30,EE_Parameter+4 |
4284 2286 2223 tst r18 |
4285 2288 09F0 breq .+2 |
4286 228a CAC0 rjmp .L356 |
4287 228c FF27 clr r31 |
4288 228e EE0F add r30,r30 |
4289 2290 FF1F adc r31,r31 |
4290 2292 E050 subi r30,lo8(-(PPM_in)) |
4291 2294 F040 sbci r31,hi8(-(PPM_in)) |
4292 2296 8081 ld r24,Z |
4293 2298 9181 ldd r25,Z+1 |
4294 229a 855B subi r24,lo8(-75) |
4295 229c 9F4F sbci r25,hi8(-75) |
4296 229e 0CF0 brlt .+2 |
4297 22a0 BCC0 rjmp .L357 |
4298 22a2 8091 0000 lds r24,delay_einschalten.7 |
4299 22a6 8F5F subi r24,lo8(-(1)) |
4300 22a8 8093 0000 sts delay_einschalten.7,r24 |
4301 22ac 893C cpi r24,lo8(-55) |
4302 22ae 08F4 brsh .+2 |
4303 22b0 D3C0 rjmp .L323 |
4304 22b2 2093 0000 sts delay_einschalten.7,r18 |
4305 22b6 8091 0000 lds r24,VersionInfo+5 |
4306 22ba 8823 tst r24 |
4307 22bc 09F0 breq .+2 |
4308 22be A6C0 rjmp .L359 |
4309 22c0 8091 0000 lds r24,calibration_done.9 |
4310 22c4 8823 tst r24 |
4311 22c6 09F4 brne .+2 |
4312 22c8 A1C0 rjmp .L359 |
4313 22ca 81E0 ldi r24,lo8(1) |
4314 22cc 90E0 ldi r25,hi8(1) |
4315 22ce 9093 0000 sts (modell_fliegt)+1,r25 |
4316 22d2 8093 0000 sts modell_fliegt,r24 |
4317 22d6 81E0 ldi r24,lo8(1) |
4318 22d8 8093 0000 sts MotorenEin,r24 |
4319 22dc 1092 0000 sts sollGier.0,__zero_reg__ |
4320 22e0 1092 0000 sts (sollGier.0)+1,__zero_reg__ |
4321 22e4 1092 0000 sts (sollGier.0)+2,__zero_reg__ |
4322 22e8 1092 0000 sts (sollGier.0)+3,__zero_reg__ |
4323 22ec 1092 0000 sts Mess_Integral_Gier,__zero_reg__ |
4324 22f0 1092 0000 sts (Mess_Integral_Gier)+1,__zero_reg__ |
4325 22f4 1092 0000 sts (Mess_Integral_Gier)+2,__zero_reg__ |
4326 22f8 1092 0000 sts (Mess_Integral_Gier)+3,__zero_reg__ |
4327 22fc 1092 0000 sts Mess_Integral_Gier2,__zero_reg__ |
4328 2300 1092 0000 sts (Mess_Integral_Gier2)+1,__zero_reg__ |
4329 2304 1092 0000 sts (Mess_Integral_Gier2)+2,__zero_reg__ |
4330 2308 1092 0000 sts (Mess_Integral_Gier2)+3,__zero_reg__ |
4331 230c 8091 0000 lds r24,EE_Parameter+28 |
4332 2310 E82E mov r14,r24 |
4333 2312 FF24 clr r15 |
4334 2314 0027 clr r16 |
4335 2316 1127 clr r17 |
4336 2318 8091 0000 lds r24,Mittelwert_AccNick |
4337 231c 9091 0000 lds r25,(Mittelwert_AccNick)+1 |
4338 2320 9C01 movw r18,r24 |
4339 2322 4427 clr r20 |
4340 2324 37FD sbrc r19,7 |
4341 2326 4095 com r20 |
4342 2328 542F mov r21,r20 |
4343 232a C801 movw r24,r16 |
4344 232c B701 movw r22,r14 |
4345 232e 0E94 0000 call __mulsi3 |
4346 2332 DC01 movw r26,r24 |
4347 2334 CB01 movw r24,r22 |
4348 2336 8093 0000 sts Mess_IntegralNick,r24 |
4349 233a 9093 0000 sts (Mess_IntegralNick)+1,r25 |
4350 233e A093 0000 sts (Mess_IntegralNick)+2,r26 |
4351 2342 B093 0000 sts (Mess_IntegralNick)+3,r27 |
4352 2346 8091 0000 lds r24,Mittelwert_AccRoll |
4353 234a 9091 0000 lds r25,(Mittelwert_AccRoll)+1 |
4354 234e 9C01 movw r18,r24 |
4355 2350 4427 clr r20 |
4356 2352 37FD sbrc r19,7 |
4357 2354 4095 com r20 |
4358 2356 542F mov r21,r20 |
4359 2358 C801 movw r24,r16 |
4360 235a B701 movw r22,r14 |
4361 235c 0E94 0000 call __mulsi3 |
4362 2360 DC01 movw r26,r24 |
4363 2362 CB01 movw r24,r22 |
4364 2364 8093 0000 sts Mess_IntegralRoll,r24 |
4365 2368 9093 0000 sts (Mess_IntegralRoll)+1,r25 |
4366 236c A093 0000 sts (Mess_IntegralRoll)+2,r26 |
4367 2370 B093 0000 sts (Mess_IntegralRoll)+3,r27 |
4368 2374 8091 0000 lds r24,IntegralNick |
4369 2378 9091 0000 lds r25,(IntegralNick)+1 |
4370 237c A091 0000 lds r26,(IntegralNick)+2 |
4371 2380 B091 0000 lds r27,(IntegralNick)+3 |
4372 2384 8093 0000 sts Mess_IntegralNick2,r24 |
4373 2388 9093 0000 sts (Mess_IntegralNick2)+1,r25 |
4374 238c A093 0000 sts (Mess_IntegralNick2)+2,r26 |
4375 2390 B093 0000 sts (Mess_IntegralNick2)+3,r27 |
4376 2394 8091 0000 lds r24,IntegralRoll |
4377 2398 9091 0000 lds r25,(IntegralRoll)+1 |
4378 239c A091 0000 lds r26,(IntegralRoll)+2 |
4379 23a0 B091 0000 lds r27,(IntegralRoll)+3 |
4380 23a4 8093 0000 sts Mess_IntegralRoll2,r24 |
4381 23a8 9093 0000 sts (Mess_IntegralRoll2)+1,r25 |
4382 23ac A093 0000 sts (Mess_IntegralRoll2)+2,r26 |
4383 23b0 B093 0000 sts (Mess_IntegralRoll2)+3,r27 |
4384 23b4 1092 0000 sts SummeNick,__zero_reg__ |
4385 23b8 1092 0000 sts (SummeNick)+1,__zero_reg__ |
4386 23bc 1092 0000 sts (SummeNick)+2,__zero_reg__ |
4387 23c0 1092 0000 sts (SummeNick)+3,__zero_reg__ |
4388 23c4 1092 0000 sts SummeRoll,__zero_reg__ |
4389 23c8 1092 0000 sts (SummeRoll)+1,__zero_reg__ |
4390 23cc 1092 0000 sts (SummeRoll)+2,__zero_reg__ |
4391 23d0 1092 0000 sts (SummeRoll)+3,__zero_reg__ |
4392 23d4 8091 0000 lds r24,FCFlags |
4393 23d8 8860 ori r24,lo8(8) |
4394 23da 8093 0000 sts FCFlags,r24 |
4395 23de 9091 0000 lds r25,EE_Parameter+95 |
4396 23e2 8FE0 ldi r24,lo8(15) |
4397 23e4 989F mul r25,r24 |
4398 23e6 9001 movw r18,r0 |
4399 23e8 1124 clr r1 |
4400 23ea 8091 0000 lds r24,KompassValue |
4401 23ee 9091 0000 lds r25,(KompassValue)+1 |
4402 23f2 820F add r24,r18 |
4403 23f4 931F adc r25,r19 |
4404 23f6 68E6 ldi r22,lo8(360) |
4405 23f8 71E0 ldi r23,hi8(360) |
4406 23fa 0E94 0000 call __divmodhi4 |
4407 23fe 97FD sbrc r25,7 |
4408 2400 0196 adiw r24,1 |
4409 .L360: |
4410 2402 9595 asr r25 |
4411 2404 8795 ror r24 |
4412 2406 8093 0000 sts ControlHeading,r24 |
4413 240a 26C0 rjmp .L323 |
4414 .L359: |
4415 240c 8CED ldi r24,lo8(1500) |
4416 240e 95E0 ldi r25,hi8(1500) |
4417 2410 9093 0000 sts (beeptime)+1,r25 |
4418 2414 8093 0000 sts beeptime,r24 |
4419 2418 1FC0 rjmp .L323 |
4420 .L357: |
4421 241a 2093 0000 sts delay_einschalten.7,r18 |
4422 241e 1CC0 rjmp .L323 |
4423 .L356: |
4424 2420 FF27 clr r31 |
4425 2422 EE0F add r30,r30 |
4426 2424 FF1F adc r31,r31 |
4427 2426 E050 subi r30,lo8(-(PPM_in)) |
4428 2428 F040 sbci r31,hi8(-(PPM_in)) |
4429 242a 8081 ld r24,Z |
4430 242c 9181 ldd r25,Z+1 |
4431 242e 8C34 cpi r24,76 |
4432 2430 9105 cpc r25,__zero_reg__ |
4433 2432 84F0 brlt .L364 |
4434 2434 8091 0000 lds r24,delay_ausschalten.8 |
4435 2438 8F5F subi r24,lo8(-(1)) |
4436 243a 8093 0000 sts delay_ausschalten.8,r24 |
4437 243e 893C cpi r24,lo8(-55) |
4438 2440 58F0 brlo .L323 |
4439 2442 1092 0000 sts MotorenEin,__zero_reg__ |
4440 2446 1092 0000 sts delay_ausschalten.8,__zero_reg__ |
4441 244a 1092 0000 sts (modell_fliegt)+1,__zero_reg__ |
4442 244e 1092 0000 sts modell_fliegt,__zero_reg__ |
4443 2452 02C0 rjmp .L323 |
4444 .L364: |
4445 2454 1092 0000 sts delay_ausschalten.8,__zero_reg__ |
4446 .L323: |
4447 2458 8091 0000 lds r24,NewPpmData |
4448 245c 8150 subi r24,lo8(-(-1)) |
4449 245e 8093 0000 sts NewPpmData,r24 |
4450 2462 8091 0000 lds r24,NewPpmData |
4451 2466 8F3F cpi r24,lo8(-1) |
4452 2468 21F0 breq .L368 |
4453 246a 8091 0000 lds r24,FCFlags |
4454 246e 84FF sbrs r24,4 |
4455 2470 82C3 rjmp .L367 |
4456 .L368: |
4457 2472 0E94 0000 call ParameterZuordnung |
4458 2476 8091 0000 lds r24,stick_nick.13 |
4459 247a 9091 0000 lds r25,(stick_nick.13)+1 |
4460 247e 9C01 movw r18,r24 |
4461 2480 220F lsl r18 |
4462 2482 331F rol r19 |
4463 2484 280F add r18,r24 |
4464 2486 391F adc r19,r25 |
4465 2488 A090 0000 lds r10,EE_Parameter+1 |
4466 248c AA2D mov r26,r10 |
4467 248e BB27 clr r27 |
4468 2490 AA0F add r26,r26 |
4469 2492 BB1F adc r27,r27 |
4470 2494 FD01 movw r30,r26 |
4471 2496 E050 subi r30,lo8(-(PPM_in)) |
4472 2498 F040 sbci r31,hi8(-(PPM_in)) |
4473 249a 9090 0000 lds r9,EE_Parameter+23 |
4474 249e 492D mov r20,r9 |
4475 24a0 5527 clr r21 |
4476 24a2 8081 ld r24,Z |
4477 24a4 9181 ldd r25,Z+1 |
4478 24a6 849F mul r24,r20 |
4479 24a8 F001 movw r30,r0 |
4480 24aa 859F mul r24,r21 |
4481 24ac F00D add r31,r0 |
4482 24ae 949F mul r25,r20 |
4483 24b0 F00D add r31,r0 |
4484 24b2 1124 clr r1 |
4485 24b4 2E0F add r18,r30 |
4486 24b6 3F1F adc r19,r31 |
4487 24b8 37FF sbrs r19,7 |
4488 24ba 02C0 rjmp .L369 |
4489 24bc 2D5F subi r18,lo8(-(3)) |
4490 24be 3F4F sbci r19,hi8(-(3)) |
4491 .L369: |
4492 24c0 B901 movw r22,r18 |
4493 24c2 7595 asr r23 |
4494 24c4 6795 ror r22 |
4495 24c6 7595 asr r23 |
4496 24c8 6795 ror r22 |
4497 24ca A050 subi r26,lo8(-(PPM_diff)) |
4498 24cc B040 sbci r27,hi8(-(PPM_diff)) |
4499 24ce 8091 0000 lds r24,EE_Parameter+24 |
4500 24d2 082F mov r16,r24 |
4501 24d4 1127 clr r17 |
4502 24d6 8D91 ld r24,X+ |
4503 24d8 9C91 ld r25,X |
4504 24da 809F mul r24,r16 |
4505 24dc 7001 movw r14,r0 |
4506 24de 819F mul r24,r17 |
4507 24e0 F00C add r15,r0 |
4508 24e2 909F mul r25,r16 |
4509 24e4 F00C add r15,r0 |
4510 24e6 1124 clr r1 |
4511 24e8 6E0D add r22,r14 |
4512 24ea 7F1D adc r23,r15 |
4513 24ec 7093 0000 sts (stick_nick.13)+1,r23 |
4514 24f0 6093 0000 sts stick_nick.13,r22 |
4515 24f4 8091 0000 lds r24,stick_roll.14 |
4516 24f8 9091 0000 lds r25,(stick_roll.14)+1 |
4517 24fc 9C01 movw r18,r24 |
4518 24fe 220F lsl r18 |
4519 2500 331F rol r19 |
4520 2502 280F add r18,r24 |
4521 2504 391F adc r19,r25 |
4522 2506 B090 0000 lds r11,EE_Parameter+2 |
4523 250a AB2D mov r26,r11 |
4524 250c BB27 clr r27 |
4525 250e AA0F add r26,r26 |
4526 2510 BB1F adc r27,r27 |
4527 2512 FD01 movw r30,r26 |
4528 2514 E050 subi r30,lo8(-(PPM_in)) |
4529 2516 F040 sbci r31,hi8(-(PPM_in)) |
4530 2518 8081 ld r24,Z |
4531 251a 9181 ldd r25,Z+1 |
4532 251c 849F mul r24,r20 |
4533 251e F001 movw r30,r0 |
4534 2520 859F mul r24,r21 |
4535 2522 F00D add r31,r0 |
4536 2524 949F mul r25,r20 |
4537 2526 F00D add r31,r0 |
4538 2528 1124 clr r1 |
4539 252a 2E0F add r18,r30 |
4540 252c 3F1F adc r19,r31 |
4541 252e 37FF sbrs r19,7 |
4542 2530 02C0 rjmp .L370 |
4543 2532 2D5F subi r18,lo8(-(3)) |
4544 2534 3F4F sbci r19,hi8(-(3)) |
4545 .L370: |
4546 2536 A901 movw r20,r18 |
4547 2538 5595 asr r21 |
4548 253a 4795 ror r20 |
4549 253c 5595 asr r21 |
4550 253e 4795 ror r20 |
4551 2540 A050 subi r26,lo8(-(PPM_diff)) |
4552 2542 B040 sbci r27,hi8(-(PPM_diff)) |
4553 2544 8D91 ld r24,X+ |
4554 2546 9C91 ld r25,X |
4555 2548 809F mul r24,r16 |
4556 254a 7001 movw r14,r0 |
4557 254c 819F mul r24,r17 |
4558 254e F00C add r15,r0 |
4559 2550 909F mul r25,r16 |
4560 2552 F00C add r15,r0 |
4561 2554 1124 clr r1 |
4562 2556 4E0D add r20,r14 |
4563 2558 5F1D adc r21,r15 |
4564 255a 5093 0000 sts (stick_roll.14)+1,r21 |
4565 255e 4093 0000 sts stick_roll.14,r20 |
4566 2562 9E01 movw r18,r28 |
4567 2564 2F5F subi r18,lo8(-(1)) |
4568 2566 3F4F sbci r19,hi8(-(1)) |
4569 2568 8FE1 ldi r24,lo8(31) |
4570 256a E0E0 ldi r30,lo8(.LC0) |
4571 256c F0E0 ldi r31,hi8(.LC0) |
4572 256e D901 movw r26,r18 |
4573 2570 0190 ld __tmp_reg__,Z+ |
4574 2572 0D92 st X+,__tmp_reg__ |
4575 2574 8A95 dec r24 |
4576 2576 E1F7 brne .-8 |
4577 2578 8091 0000 lds r24,CareFree |
4578 257c 8823 tst r24 |
4579 257e 09F4 brne .+2 |
4580 2580 48C0 rjmp .L371 |
4581 2582 CB01 movw r24,r22 |
4582 2584 77FD sbrc r23,7 |
4583 2586 0396 adiw r24,3 |
4584 .L372: |
4585 2588 DC01 movw r26,r24 |
4586 258a B595 asr r27 |
4587 258c A795 ror r26 |
4588 258e B595 asr r27 |
4589 2590 A795 ror r26 |
4590 2592 CA01 movw r24,r20 |
4591 2594 57FD sbrc r21,7 |
4592 2596 0396 adiw r24,3 |
4593 .L373: |
4594 2598 FC01 movw r30,r24 |
4595 259a F595 asr r31 |
4596 259c E795 ror r30 |
4597 259e F595 asr r31 |
4598 25a0 E795 ror r30 |
4599 25a2 8091 0000 lds r24,FromNC_Rotate_C |
4600 25a6 682F mov r22,r24 |
4601 25a8 7727 clr r23 |
4602 25aa 67FD sbrc r22,7 |
4603 25ac 7095 com r23 |
4604 25ae 6A9F mul r22,r26 |
4605 25b0 9001 movw r18,r0 |
4606 25b2 6B9F mul r22,r27 |
4607 25b4 300D add r19,r0 |
4608 25b6 7A9F mul r23,r26 |
4609 25b8 300D add r19,r0 |
4610 25ba 1124 clr r1 |
4611 25bc 8091 0000 lds r24,FromNC_Rotate_S |
4612 25c0 482F mov r20,r24 |
4613 25c2 5527 clr r21 |
4614 25c4 47FD sbrc r20,7 |
4615 25c6 5095 com r21 |
4616 25c8 4E9F mul r20,r30 |
4617 25ca C001 movw r24,r0 |
4618 25cc 4F9F mul r20,r31 |
4619 25ce 900D add r25,r0 |
4620 25d0 5E9F mul r21,r30 |
4621 25d2 900D add r25,r0 |
4622 25d4 1124 clr r1 |
4623 25d6 280F add r18,r24 |
4624 25d8 391F adc r19,r25 |
4625 25da 37FF sbrs r19,7 |
4626 25dc 02C0 rjmp .L374 |
4627 25de 295F subi r18,lo8(-(7)) |
4628 25e0 3F4F sbci r19,hi8(-(7)) |
4629 .L374: |
4630 25e2 03E0 ldi r16,3 |
4631 25e4 3595 1: asr r19 |
4632 25e6 2795 ror r18 |
4633 25e8 0A95 dec r16 |
4634 25ea E1F7 brne 1b |
4635 25ec 3093 0000 sts (StickNick)+1,r19 |
4636 25f0 2093 0000 sts StickNick,r18 |
4637 25f4 6E9F mul r22,r30 |
4638 25f6 9001 movw r18,r0 |
4639 25f8 6F9F mul r22,r31 |
4640 25fa 300D add r19,r0 |
4641 25fc 7E9F mul r23,r30 |
4642 25fe 300D add r19,r0 |
4643 2600 1124 clr r1 |
4644 2602 4A9F mul r20,r26 |
4645 2604 C001 movw r24,r0 |
4646 2606 4B9F mul r20,r27 |
4647 2608 900D add r25,r0 |
4648 260a 5A9F mul r21,r26 |
4649 260c 900D add r25,r0 |
4650 260e 1124 clr r1 |
4651 2610 44C0 rjmp .L807 |
4652 .L371: |
4653 2612 8091 0000 lds r24,EE_Parameter+95 |
4654 2616 082F mov r16,r24 |
4655 2618 1127 clr r17 |
4656 261a DE01 movw r26,r28 |
4657 261c A00F add r26,r16 |
4658 261e B11F adc r27,r17 |
4659 2620 FD01 movw r30,r26 |
4660 2622 9781 ldd r25,Z+7 |
4661 2624 9093 0000 sts FromNC_Rotate_C,r25 |
4662 2628 020F add r16,r18 |
4663 262a 131F adc r17,r19 |
4664 262c D801 movw r26,r16 |
4665 262e 8C91 ld r24,X |
4666 2630 8093 0000 sts FromNC_Rotate_S,r24 |
4667 2634 A92F mov r26,r25 |
4668 2636 BB27 clr r27 |
4669 2638 A7FD sbrc r26,7 |
4670 263a B095 com r27 |
4671 263c A69F mul r26,r22 |
4672 263e 9001 movw r18,r0 |
4673 2640 A79F mul r26,r23 |
4674 2642 300D add r19,r0 |
4675 2644 B69F mul r27,r22 |
4676 2646 300D add r19,r0 |
4677 2648 1124 clr r1 |
4678 264a E82F mov r30,r24 |
4679 264c FF27 clr r31 |
4680 264e E7FD sbrc r30,7 |
4681 2650 F095 com r31 |
4682 2652 E49F mul r30,r20 |
4683 2654 C001 movw r24,r0 |
4684 2656 E59F mul r30,r21 |
4685 2658 900D add r25,r0 |
4686 265a F49F mul r31,r20 |
4687 265c 900D add r25,r0 |
4688 265e 1124 clr r1 |
4689 2660 280F add r18,r24 |
4690 2662 391F adc r19,r25 |
4691 2664 37FF sbrs r19,7 |
4692 2666 02C0 rjmp .L377 |
4693 2668 295F subi r18,lo8(-(7)) |
4694 266a 3F4F sbci r19,hi8(-(7)) |
4695 .L377: |
4696 266c 13E0 ldi r17,3 |
4697 266e 3595 1: asr r19 |
4698 2670 2795 ror r18 |
4699 2672 1A95 dec r17 |
4700 2674 E1F7 brne 1b |
4701 2676 3093 0000 sts (StickNick)+1,r19 |
4702 267a 2093 0000 sts StickNick,r18 |
4703 267e A49F mul r26,r20 |
4704 2680 9001 movw r18,r0 |
4705 2682 A59F mul r26,r21 |
4706 2684 300D add r19,r0 |
4707 2686 B49F mul r27,r20 |
4708 2688 300D add r19,r0 |
4709 268a 1124 clr r1 |
4710 268c E69F mul r30,r22 |
4711 268e C001 movw r24,r0 |
4712 2690 E79F mul r30,r23 |
4713 2692 900D add r25,r0 |
4714 2694 F69F mul r31,r22 |
4715 2696 900D add r25,r0 |
4716 2698 1124 clr r1 |
4717 .L807: |
4718 269a 281B sub r18,r24 |
4719 269c 390B sbc r19,r25 |
4720 269e 37FF sbrs r19,7 |
4721 26a0 02C0 rjmp .L378 |
4722 26a2 295F subi r18,lo8(-(7)) |
4723 26a4 3F4F sbci r19,hi8(-(7)) |
4724 .L378: |
4725 26a6 F3E0 ldi r31,3 |
4726 26a8 3595 1: asr r19 |
4727 26aa 2795 ror r18 |
4728 26ac FA95 dec r31 |
4729 26ae E1F7 brne 1b |
4730 26b0 3093 0000 sts (StickRoll)+1,r19 |
4731 26b4 2093 0000 sts StickRoll,r18 |
4732 26b8 8091 0000 lds r24,EE_Parameter+4 |
4733 26bc E82F mov r30,r24 |
4734 26be FF27 clr r31 |
4735 26c0 EE0F add r30,r30 |
4736 26c2 FF1F adc r31,r31 |
4737 26c4 E050 subi r30,lo8(-(PPM_in)) |
4738 26c6 F040 sbci r31,hi8(-(PPM_in)) |
4739 26c8 8081 ld r24,Z |
4740 26ca 9181 ldd r25,Z+1 |
4741 26cc 9095 com r25 |
4742 26ce 8195 neg r24 |
4743 26d0 9F4F sbci r25,lo8(-1) |
4744 26d2 9093 0000 sts (StickGier)+1,r25 |
4745 26d6 8093 0000 sts StickGier,r24 |
4746 26da 8330 cpi r24,3 |
4747 26dc 9105 cpc r25,__zero_reg__ |
4748 26de 14F0 brlt .L379 |
4749 26e0 0297 sbiw r24,2 |
4750 26e2 05C0 rjmp .L782 |
4751 .L379: |
4752 26e4 BFEF ldi r27,hi8(-2) |
4753 26e6 8E3F cpi r24,lo8(-2) |
4754 26e8 9B07 cpc r25,r27 |
4755 26ea 34F4 brge .L381 |
4756 26ec 0296 adiw r24,2 |
4757 .L782: |
4758 26ee 9093 0000 sts (StickGier)+1,r25 |
4759 26f2 8093 0000 sts StickGier,r24 |
4760 26f6 04C0 rjmp .L380 |
4761 .L381: |
4762 26f8 1092 0000 sts (StickGier)+1,__zero_reg__ |
4763 26fc 1092 0000 sts StickGier,__zero_reg__ |
4764 .L380: |
4765 2700 8091 0000 lds r24,GPS_Nick |
4766 2704 9091 0000 lds r25,(GPS_Nick)+1 |
4767 2708 2091 0000 lds r18,GPS_Nick2 |
4768 270c 3091 0000 lds r19,(GPS_Nick2)+1 |
4769 2710 820F add r24,r18 |
4770 2712 931F adc r25,r19 |
4771 2714 C090 0000 lds r12,StickNick |
4772 2718 D090 0000 lds r13,(StickNick)+1 |
4773 271c C81A sub r12,r24 |
4774 271e D90A sbc r13,r25 |
4775 2720 D092 0000 sts (StickNick)+1,r13 |
4776 2724 C092 0000 sts StickNick,r12 |
4777 2728 8091 0000 lds r24,GPS_Roll |
4778 272c 9091 0000 lds r25,(GPS_Roll)+1 |
4779 2730 2091 0000 lds r18,GPS_Roll2 |
4780 2734 3091 0000 lds r19,(GPS_Roll2)+1 |
4781 2738 820F add r24,r18 |
4782 273a 931F adc r25,r19 |
4783 273c 0091 0000 lds r16,StickRoll |
4784 2740 1091 0000 lds r17,(StickRoll)+1 |
4785 2744 081B sub r16,r24 |
4786 2746 190B sbc r17,r25 |
4787 2748 1093 0000 sts (StickRoll)+1,r17 |
4788 274c 0093 0000 sts StickRoll,r16 |
4789 2750 8091 0000 lds r24,EE_Parameter+3 |
4790 2754 E82F mov r30,r24 |
4791 2756 FF27 clr r31 |
4792 2758 EE0F add r30,r30 |
4793 275a FF1F adc r31,r31 |
4794 275c E050 subi r30,lo8(-(PPM_in)) |
4795 275e F040 sbci r31,hi8(-(PPM_in)) |
4796 2760 E080 ld r14,Z |
4797 2762 F180 ldd r15,Z+1 |
4798 2764 E8E7 ldi r30,lo8(120) |
4799 2766 F0E0 ldi r31,hi8(120) |
4800 2768 EE0E add r14,r30 |
4801 276a FF1E adc r15,r31 |
4802 276c F092 0000 sts (StickGas)+1,r15 |
4803 2770 E092 0000 sts StickGas,r14 |
4804 2774 8091 0000 lds r24,Parameter_Gyro_P |
4805 2778 9927 clr r25 |
4806 277a AA27 clr r26 |
4807 277c 97FD sbrc r25,7 |
4808 277e A095 com r26 |
4809 2780 BA2F mov r27,r26 |
4810 2782 BC01 movw r22,r24 |
4811 2784 CD01 movw r24,r26 |
4812 2786 0E94 0000 call __floatsisf |
4813 278a DC01 movw r26,r24 |
4814 278c CB01 movw r24,r22 |
4815 278e 20E0 ldi r18,lo8(0x41200000) |
4816 2790 30E0 ldi r19,hi8(0x41200000) |
4817 2792 40E2 ldi r20,hlo8(0x41200000) |
4818 2794 51E4 ldi r21,hhi8(0x41200000) |
4819 2796 BC01 movw r22,r24 |
4820 2798 CD01 movw r24,r26 |
4821 279a 0E94 0000 call __addsf3 |
4822 279e DC01 movw r26,r24 |
4823 27a0 CB01 movw r24,r22 |
4824 27a2 BC01 movw r22,r24 |
4825 27a4 CD01 movw r24,r26 |
4826 27a6 0E94 0000 call __fixunssfsi |
4827 27aa DC01 movw r26,r24 |
4828 27ac CB01 movw r24,r22 |
4829 27ae 8093 0000 sts GyroFaktor,r24 |
4830 27b2 8091 0000 lds r24,Parameter_Gyro_I |
4831 27b6 8093 0000 sts IntegralFaktor,r24 |
4832 27ba 8091 0000 lds r24,Parameter_Gyro_Gier_P |
4833 27be 9927 clr r25 |
4834 27c0 AA27 clr r26 |
4835 27c2 97FD sbrc r25,7 |
4836 27c4 A095 com r26 |
4837 27c6 BA2F mov r27,r26 |
4838 27c8 BC01 movw r22,r24 |
4839 27ca CD01 movw r24,r26 |
4840 27cc 0E94 0000 call __floatsisf |
4841 27d0 DC01 movw r26,r24 |
4842 27d2 CB01 movw r24,r22 |
4843 27d4 20E0 ldi r18,lo8(0x41200000) |
4844 27d6 30E0 ldi r19,hi8(0x41200000) |
4845 27d8 40E2 ldi r20,hlo8(0x41200000) |
4846 27da 51E4 ldi r21,hhi8(0x41200000) |
4847 27dc BC01 movw r22,r24 |
4848 27de CD01 movw r24,r26 |
4849 27e0 0E94 0000 call __addsf3 |
4850 27e4 DC01 movw r26,r24 |
4851 27e6 CB01 movw r24,r22 |
4852 27e8 BC01 movw r22,r24 |
4853 27ea CD01 movw r24,r26 |
4854 27ec 0E94 0000 call __fixunssfsi |
4855 27f0 DC01 movw r26,r24 |
4856 27f2 CB01 movw r24,r22 |
4857 27f4 8093 0000 sts GyroFaktorGier,r24 |
4858 27f8 8091 0000 lds r24,Parameter_Gyro_Gier_I |
4859 27fc 8093 0000 sts IntegralFaktorGier,r24 |
4860 2800 8091 0000 lds r24,ExternControl+10 |
4861 2804 80FF sbrs r24,0 |
4862 2806 59C0 rjmp .L383 |
4863 2808 8091 0000 lds r24,Parameter_ExternalControl |
4864 280c 8138 cpi r24,lo8(-127) |
4865 280e 08F4 brsh .+2 |
4866 2810 54C0 rjmp .L383 |
4867 2812 8091 0000 lds r24,ExternControl+3 |
4868 2816 9927 clr r25 |
4869 2818 87FD sbrc r24,7 |
4870 281a 9095 com r25 |
4871 281c 292D mov r18,r9 |
4872 281e 3327 clr r19 |
4873 2820 829F mul r24,r18 |
4874 2822 A001 movw r20,r0 |
4875 2824 839F mul r24,r19 |
4876 2826 500D add r21,r0 |
4877 2828 929F mul r25,r18 |
4878 282a 500D add r21,r0 |
4879 282c 1124 clr r1 |
4880 282e C40E add r12,r20 |
4881 2830 D51E adc r13,r21 |
4882 2832 D092 0000 sts (StickNick)+1,r13 |
4883 2836 C092 0000 sts StickNick,r12 |
4884 283a 8091 0000 lds r24,ExternControl+4 |
4885 283e 9927 clr r25 |
4886 2840 87FD sbrc r24,7 |
4887 2842 9095 com r25 |
4888 2844 829F mul r24,r18 |
4889 2846 B001 movw r22,r0 |
4890 2848 839F mul r24,r19 |
4891 284a 700D add r23,r0 |
4892 284c 929F mul r25,r18 |
4893 284e 700D add r23,r0 |
4894 2850 1124 clr r1 |
4895 2852 060F add r16,r22 |
4896 2854 171F adc r17,r23 |
4897 2856 1093 0000 sts (StickRoll)+1,r17 |
4898 285a 0093 0000 sts StickRoll,r16 |
4899 285e 8091 0000 lds r24,ExternControl+5 |
4900 2862 282F mov r18,r24 |
4901 2864 3327 clr r19 |
4902 2866 27FD sbrc r18,7 |
4903 2868 3095 com r19 |
4904 286a 8091 0000 lds r24,StickGier |
4905 286e 9091 0000 lds r25,(StickGier)+1 |
4906 2872 820F add r24,r18 |
4907 2874 931F adc r25,r19 |
4908 2876 9093 0000 sts (StickGier)+1,r25 |
4909 287a 8093 0000 sts StickGier,r24 |
4910 287e 8091 0000 lds r24,ExternControl+7 |
4911 2882 282F mov r18,r24 |
4912 2884 3327 clr r19 |
4913 2886 27FD sbrc r18,7 |
4914 2888 3095 com r19 |
4915 288a 8091 0000 lds r24,EE_Parameter+18 |
4916 288e 9927 clr r25 |
4917 2890 289F mul r18,r24 |
4918 2892 D001 movw r26,r0 |
4919 2894 299F mul r18,r25 |
4920 2896 B00D add r27,r0 |
4921 2898 389F mul r19,r24 |
4922 289a B00D add r27,r0 |
4923 289c 1124 clr r1 |
4924 289e B093 0000 sts (ExternHoehenValue)+1,r27 |
4925 28a2 A093 0000 sts ExternHoehenValue,r26 |
4926 28a6 8091 0000 lds r24,ExternControl+6 |
4927 28aa 9927 clr r25 |
4928 28ac 8E15 cp r24,r14 |
4929 28ae 9F05 cpc r25,r15 |
4930 28b0 24F4 brge .L383 |
4931 28b2 9093 0000 sts (StickGas)+1,r25 |
4932 28b6 8093 0000 sts StickGas,r24 |
4933 .L383: |
4934 28ba 8091 0000 lds r24,StickGas |
4935 28be 9091 0000 lds r25,(StickGas)+1 |
4936 28c2 97FF sbrs r25,7 |
4937 28c4 04C0 rjmp .L385 |
4938 28c6 1092 0000 sts (StickGas)+1,__zero_reg__ |
4939 28ca 1092 0000 sts StickGas,__zero_reg__ |
4940 .L385: |
4941 28ce 8091 0000 lds r24,EE_Parameter+13 |
4942 28d2 82FF sbrs r24,2 |
4943 28d4 02C0 rjmp .L386 |
4944 28d6 1092 0000 sts IntegralFaktor,__zero_reg__ |
4945 .L386: |
4946 28da 4091 0000 lds r20,StickNick |
4947 28de 5091 0000 lds r21,(StickNick)+1 |
4948 28e2 CA01 movw r24,r20 |
4949 28e4 57FD sbrc r21,7 |
4950 28e6 0396 adiw r24,3 |
4951 .L388: |
4952 28e8 9C01 movw r18,r24 |
4953 28ea 3595 asr r19 |
4954 28ec 2795 ror r18 |
4955 28ee 3595 asr r19 |
4956 28f0 2795 ror r18 |
4957 28f2 37FF sbrs r19,7 |
4958 28f4 03C0 rjmp .L389 |
4959 28f6 3095 com r19 |
4960 28f8 2195 neg r18 |
4961 28fa 3F4F sbci r19,lo8(-1) |
4962 .L389: |
4963 28fc 8091 0000 lds r24,MaxStickNick |
4964 2900 9091 0000 lds r25,(MaxStickNick)+1 |
4965 2904 8217 cp r24,r18 |
4966 2906 9307 cpc r25,r19 |
4967 2908 B4F4 brge .L387 |
4968 290a CA01 movw r24,r20 |
4969 290c 57FF sbrs r21,7 |
4970 290e 03C0 rjmp .L390 |
4971 2910 9095 com r25 |
4972 2912 8195 neg r24 |
4973 2914 9F4F sbci r25,lo8(-1) |
4974 .L390: |
4975 2916 97FD sbrc r25,7 |
4976 2918 0396 adiw r24,3 |
4977 .L391: |
4978 291a 9595 asr r25 |
4979 291c 8795 ror r24 |
4980 291e 9595 asr r25 |
4981 2920 8795 ror r24 |
4982 2922 9093 0000 sts (MaxStickNick)+1,r25 |
4983 2926 8093 0000 sts MaxStickNick,r24 |
4984 292a 8536 cpi r24,101 |
4985 292c 9105 cpc r25,__zero_reg__ |
4986 292e 44F0 brlt .L393 |
4987 2930 84E6 ldi r24,lo8(100) |
4988 2932 90E0 ldi r25,hi8(100) |
4989 2934 01C0 rjmp .L783 |
4990 .L387: |
4991 2936 0197 sbiw r24,1 |
4992 .L783: |
4993 2938 9093 0000 sts (MaxStickNick)+1,r25 |
4994 293c 8093 0000 sts MaxStickNick,r24 |
4995 .L393: |
4996 2940 4091 0000 lds r20,StickRoll |
4997 2944 5091 0000 lds r21,(StickRoll)+1 |
4998 2948 CA01 movw r24,r20 |
4999 294a 57FD sbrc r21,7 |
5000 294c 0396 adiw r24,3 |
5001 .L395: |
5002 294e 9C01 movw r18,r24 |
5003 2950 3595 asr r19 |
5004 2952 2795 ror r18 |
5005 2954 3595 asr r19 |
5006 2956 2795 ror r18 |
5007 2958 37FF sbrs r19,7 |
5008 295a 03C0 rjmp .L396 |
5009 295c 3095 com r19 |
5010 295e 2195 neg r18 |
5011 2960 3F4F sbci r19,lo8(-1) |
5012 .L396: |
5013 2962 8091 0000 lds r24,MaxStickRoll |
5014 2966 9091 0000 lds r25,(MaxStickRoll)+1 |
5015 296a 8217 cp r24,r18 |
5016 296c 9307 cpc r25,r19 |
5017 296e B4F4 brge .L394 |
5018 2970 CA01 movw r24,r20 |
5019 2972 57FF sbrs r21,7 |
5020 2974 03C0 rjmp .L397 |
5021 2976 9095 com r25 |
5022 2978 8195 neg r24 |
5023 297a 9F4F sbci r25,lo8(-1) |
5024 .L397: |
5025 297c 97FD sbrc r25,7 |
5026 297e 0396 adiw r24,3 |
5027 .L398: |
5028 2980 9595 asr r25 |
5029 2982 8795 ror r24 |
5030 2984 9595 asr r25 |
5031 2986 8795 ror r24 |
5032 2988 9093 0000 sts (MaxStickRoll)+1,r25 |
5033 298c 8093 0000 sts MaxStickRoll,r24 |
5034 2990 8536 cpi r24,101 |
5035 2992 9105 cpc r25,__zero_reg__ |
5036 2994 44F0 brlt .L400 |
5037 2996 84E6 ldi r24,lo8(100) |
5038 2998 90E0 ldi r25,hi8(100) |
5039 299a 01C0 rjmp .L784 |
5040 .L394: |
5041 299c 0197 sbiw r24,1 |
5042 .L784: |
5043 299e 9093 0000 sts (MaxStickRoll)+1,r25 |
5044 29a2 8093 0000 sts MaxStickRoll,r24 |
5045 .L400: |
5046 29a6 8091 0000 lds r24,FCFlags |
5047 29aa 84FF sbrs r24,4 |
5048 29ac 08C0 rjmp .L401 |
5049 29ae 1092 0000 sts (MaxStickNick)+1,__zero_reg__ |
5050 29b2 1092 0000 sts MaxStickNick,__zero_reg__ |
5051 29b6 1092 0000 sts (MaxStickRoll)+1,__zero_reg__ |
5052 29ba 1092 0000 sts MaxStickRoll,__zero_reg__ |
5053 .L401: |
5054 29be EB2D mov r30,r11 |
5055 29c0 FF27 clr r31 |
5056 29c2 EE0F add r30,r30 |
5057 29c4 FF1F adc r31,r31 |
5058 29c6 E050 subi r30,lo8(-(PPM_in)) |
5059 29c8 F040 sbci r31,hi8(-(PPM_in)) |
5060 29ca 4091 0000 lds r20,EE_Parameter+58 |
5061 29ce 242F mov r18,r20 |
5062 29d0 3327 clr r19 |
5063 29d2 8081 ld r24,Z |
5064 29d4 9181 ldd r25,Z+1 |
5065 29d6 2817 cp r18,r24 |
5066 29d8 3907 cpc r19,r25 |
5067 29da 44F4 brge .L402 |
5068 29dc 8091 0000 lds r24,EE_Parameter+97 |
5069 29e0 82FF sbrs r24,2 |
5070 29e2 04C0 rjmp .L402 |
5071 29e4 81E0 ldi r24,lo8(1) |
5072 29e6 8093 0000 sts Looping_Links,r24 |
5073 29ea 13C0 rjmp .L403 |
5074 .L402: |
5075 29ec EB2D mov r30,r11 |
5076 29ee FF27 clr r31 |
5077 29f0 EE0F add r30,r30 |
5078 29f2 FF1F adc r31,r31 |
5079 29f4 E050 subi r30,lo8(-(PPM_in)) |
5080 29f6 F040 sbci r31,hi8(-(PPM_in)) |
5081 29f8 842F mov r24,r20 |
5082 29fa 9927 clr r25 |
5083 29fc 2091 0000 lds r18,EE_Parameter+59 |
5084 2a00 821B sub r24,r18 |
5085 2a02 9109 sbc r25,__zero_reg__ |
5086 2a04 2081 ld r18,Z |
5087 2a06 3181 ldd r19,Z+1 |
5088 2a08 2817 cp r18,r24 |
5089 2a0a 3907 cpc r19,r25 |
5090 2a0c 14F4 brge .L403 |
5091 2a0e 1092 0000 sts Looping_Links,__zero_reg__ |
5092 .L403: |
5093 2a12 4091 0000 lds r20,EE_Parameter+2 |
5094 2a16 E42F mov r30,r20 |
5095 2a18 FF27 clr r31 |
5096 2a1a EE0F add r30,r30 |
5097 2a1c FF1F adc r31,r31 |
5098 2a1e E050 subi r30,lo8(-(PPM_in)) |
5099 2a20 F040 sbci r31,hi8(-(PPM_in)) |
5100 2a22 5091 0000 lds r21,EE_Parameter+58 |
5101 2a26 852F mov r24,r21 |
5102 2a28 9927 clr r25 |
5103 2a2a 2227 clr r18 |
5104 2a2c 3327 clr r19 |
5105 2a2e 281B sub r18,r24 |
5106 2a30 390B sbc r19,r25 |
5107 2a32 8081 ld r24,Z |
5108 2a34 9181 ldd r25,Z+1 |
5109 2a36 8217 cp r24,r18 |
5110 2a38 9307 cpc r25,r19 |
5111 2a3a 44F4 brge .L405 |
5112 2a3c 8091 0000 lds r24,EE_Parameter+97 |
5113 2a40 83FF sbrs r24,3 |
5114 2a42 04C0 rjmp .L405 |
5115 2a44 81E0 ldi r24,lo8(1) |
5116 2a46 8093 0000 sts Looping_Rechts,r24 |
5117 2a4a 16C0 rjmp .L406 |
5118 .L405: |
5119 2a4c 8091 0000 lds r24,Looping_Rechts |
5120 2a50 8823 tst r24 |
5121 2a52 91F0 breq .L406 |
5122 2a54 E42F mov r30,r20 |
5123 2a56 FF27 clr r31 |
5124 2a58 EE0F add r30,r30 |
5125 2a5a FF1F adc r31,r31 |
5126 2a5c E050 subi r30,lo8(-(PPM_in)) |
5127 2a5e F040 sbci r31,hi8(-(PPM_in)) |
5128 2a60 8091 0000 lds r24,EE_Parameter+59 |
5129 2a64 9927 clr r25 |
5130 2a66 851B sub r24,r21 |
5131 2a68 9109 sbc r25,__zero_reg__ |
5132 2a6a 2081 ld r18,Z |
5133 2a6c 3181 ldd r19,Z+1 |
5134 2a6e 8217 cp r24,r18 |
5135 2a70 9307 cpc r25,r19 |
5136 2a72 14F4 brge .L406 |
5137 2a74 1092 0000 sts Looping_Rechts,__zero_reg__ |
5138 .L406: |
5139 2a78 EA2D mov r30,r10 |
5140 2a7a FF27 clr r31 |
5141 2a7c EE0F add r30,r30 |
5142 2a7e FF1F adc r31,r31 |
5143 2a80 E050 subi r30,lo8(-(PPM_in)) |
5144 2a82 F040 sbci r31,hi8(-(PPM_in)) |
5145 2a84 4091 0000 lds r20,EE_Parameter+58 |
5146 2a88 242F mov r18,r20 |
5147 2a8a 3327 clr r19 |
5148 2a8c 8081 ld r24,Z |
5149 2a8e 9181 ldd r25,Z+1 |
5150 2a90 2817 cp r18,r24 |
5151 2a92 3907 cpc r19,r25 |
5152 2a94 44F4 brge .L409 |
5153 2a96 8091 0000 lds r24,EE_Parameter+97 |
5154 2a9a 80FF sbrs r24,0 |
5155 2a9c 04C0 rjmp .L409 |
5156 2a9e 81E0 ldi r24,lo8(1) |
5157 2aa0 8093 0000 sts Looping_Oben,r24 |
5158 2aa4 17C0 rjmp .L410 |
5159 .L409: |
5160 2aa6 8091 0000 lds r24,Looping_Oben |
5161 2aaa 8823 tst r24 |
5162 2aac 99F0 breq .L410 |
5163 2aae EA2D mov r30,r10 |
5164 2ab0 FF27 clr r31 |
5165 2ab2 EE0F add r30,r30 |
5166 2ab4 FF1F adc r31,r31 |
5167 2ab6 E050 subi r30,lo8(-(PPM_in)) |
5168 2ab8 F040 sbci r31,hi8(-(PPM_in)) |
5169 2aba 842F mov r24,r20 |
5170 2abc 9927 clr r25 |
5171 2abe 2091 0000 lds r18,EE_Parameter+59 |
5172 2ac2 821B sub r24,r18 |
5173 2ac4 9109 sbc r25,__zero_reg__ |
5174 2ac6 2081 ld r18,Z |
5175 2ac8 3181 ldd r19,Z+1 |
5176 2aca 2817 cp r18,r24 |
5177 2acc 3907 cpc r19,r25 |
5178 2ace 14F4 brge .L410 |
5179 2ad0 1092 0000 sts Looping_Oben,__zero_reg__ |
5180 .L410: |
5181 2ad4 4091 0000 lds r20,EE_Parameter+1 |
5182 2ad8 E42F mov r30,r20 |
5183 2ada FF27 clr r31 |
5184 2adc EE0F add r30,r30 |
5185 2ade FF1F adc r31,r31 |
5186 2ae0 E050 subi r30,lo8(-(PPM_in)) |
5187 2ae2 F040 sbci r31,hi8(-(PPM_in)) |
5188 2ae4 5091 0000 lds r21,EE_Parameter+58 |
5189 2ae8 852F mov r24,r21 |
5190 2aea 9927 clr r25 |
5191 2aec 2227 clr r18 |
5192 2aee 3327 clr r19 |
5193 2af0 281B sub r18,r24 |
5194 2af2 390B sbc r19,r25 |
5195 2af4 8081 ld r24,Z |
5196 2af6 9181 ldd r25,Z+1 |
5197 2af8 8217 cp r24,r18 |
5198 2afa 9307 cpc r25,r19 |
5199 2afc 44F4 brge .L413 |
5200 2afe 8091 0000 lds r24,EE_Parameter+97 |
5201 2b02 81FF sbrs r24,1 |
5202 2b04 04C0 rjmp .L413 |
5203 2b06 81E0 ldi r24,lo8(1) |
5204 2b08 8093 0000 sts Looping_Unten,r24 |
5205 2b0c 16C0 rjmp .L414 |
5206 .L413: |
5207 2b0e 8091 0000 lds r24,Looping_Unten |
5208 2b12 8823 tst r24 |
5209 2b14 91F0 breq .L414 |
5210 2b16 E42F mov r30,r20 |
5211 2b18 FF27 clr r31 |
5212 2b1a EE0F add r30,r30 |
5213 2b1c FF1F adc r31,r31 |
5214 2b1e E050 subi r30,lo8(-(PPM_in)) |
5215 2b20 F040 sbci r31,hi8(-(PPM_in)) |
5216 2b22 8091 0000 lds r24,EE_Parameter+59 |
5217 2b26 9927 clr r25 |
5218 2b28 851B sub r24,r21 |
5219 2b2a 9109 sbc r25,__zero_reg__ |
5220 2b2c 2081 ld r18,Z |
5221 2b2e 3181 ldd r19,Z+1 |
5222 2b30 8217 cp r24,r18 |
5223 2b32 9307 cpc r25,r19 |
5224 2b34 14F4 brge .L414 |
5225 2b36 1092 0000 sts Looping_Unten,__zero_reg__ |
5226 .L414: |
5227 2b3a 8091 0000 lds r24,Looping_Links |
5228 2b3e 8823 tst r24 |
5229 2b40 19F4 brne .L418 |
5230 2b42 8091 0000 lds r24,Looping_Rechts |
5231 2b46 8111 cpse r24,__zero_reg__ |
5232 .L418: |
5233 2b48 81E0 ldi r24,lo8(1) |
5234 .L417: |
5235 2b4a 8093 0000 sts Looping_Roll,r24 |
5236 2b4e 8091 0000 lds r24,Looping_Oben |
5237 2b52 8823 tst r24 |
5238 2b54 21F4 brne .L421 |
5239 2b56 8091 0000 lds r24,Looping_Unten |
5240 2b5a 8823 tst r24 |
5241 2b5c 51F0 breq .L420 |
5242 .L421: |
5243 2b5e 81E0 ldi r24,lo8(1) |
5244 2b60 8093 0000 sts Looping_Nick,r24 |
5245 2b64 1092 0000 sts Looping_Roll,__zero_reg__ |
5246 2b68 1092 0000 sts Looping_Links,__zero_reg__ |
5247 2b6c 1092 0000 sts Looping_Rechts,__zero_reg__ |
5248 2b70 02C0 rjmp .L367 |
5249 .L420: |
5250 2b72 8093 0000 sts Looping_Nick,r24 |
5251 .L367: |
5252 2b76 8091 0000 lds r24,Looping_Roll |
5253 2b7a 8823 tst r24 |
5254 2b7c 21F4 brne .L424 |
5255 2b7e 8091 0000 lds r24,Looping_Nick |
5256 2b82 8823 tst r24 |
5257 2b84 69F0 breq .L423 |
5258 .L424: |
5259 2b86 8091 0000 lds r24,EE_Parameter+57 |
5260 2b8a 9927 clr r25 |
5261 2b8c E8A1 ldd r30,Y+32 |
5262 2b8e F9A1 ldd r31,Y+33 |
5263 2b90 8E17 cp r24,r30 |
5264 2b92 9F07 cpc r25,r31 |
5265 2b94 14F4 brge .L425 |
5266 2b96 99A3 std Y+33,r25 |
5267 2b98 88A3 std Y+32,r24 |
5268 .L425: |
5269 2b9a 81E0 ldi r24,lo8(1) |
5270 2b9c 8093 0000 sts TrichterFlug,r24 |
5271 .L423: |
5272 2ba0 8091 0000 lds r24,FCFlags |
5273 2ba4 84FF sbrs r24,4 |
5274 2ba6 1AC0 rjmp .L426 |
5275 2ba8 1092 0000 sts (StickGier)+1,__zero_reg__ |
5276 2bac 1092 0000 sts StickGier,__zero_reg__ |
5277 2bb0 1092 0000 sts (StickNick)+1,__zero_reg__ |
5278 2bb4 1092 0000 sts StickNick,__zero_reg__ |
5279 2bb8 1092 0000 sts (StickRoll)+1,__zero_reg__ |
5280 2bbc 1092 0000 sts StickRoll,__zero_reg__ |
5281 2bc0 9AE5 ldi r25,lo8(90) |
5282 2bc2 9093 0000 sts GyroFaktor,r25 |
5283 2bc6 88E7 ldi r24,lo8(120) |
5284 2bc8 8093 0000 sts IntegralFaktor,r24 |
5285 2bcc 9093 0000 sts GyroFaktorGier,r25 |
5286 2bd0 8093 0000 sts IntegralFaktorGier,r24 |
5287 2bd4 1092 0000 sts Looping_Roll,__zero_reg__ |
5288 2bd8 1092 0000 sts Looping_Nick,__zero_reg__ |
5289 .L426: |
5290 2bdc 8091 0000 lds r24,MittelIntegralNick |
5291 2be0 9091 0000 lds r25,(MittelIntegralNick)+1 |
5292 2be4 A091 0000 lds r26,(MittelIntegralNick)+2 |
5293 2be8 B091 0000 lds r27,(MittelIntegralNick)+3 |
5294 2bec 2091 0000 lds r18,IntegralNick |
5295 2bf0 3091 0000 lds r19,(IntegralNick)+1 |
5296 2bf4 4091 0000 lds r20,(IntegralNick)+2 |
5297 2bf8 5091 0000 lds r21,(IntegralNick)+3 |
5298 2bfc 820F add r24,r18 |
5299 2bfe 931F adc r25,r19 |
5300 2c00 A41F adc r26,r20 |
5301 2c02 B51F adc r27,r21 |
5302 2c04 8093 0000 sts MittelIntegralNick,r24 |
5303 2c08 9093 0000 sts (MittelIntegralNick)+1,r25 |
5304 2c0c A093 0000 sts (MittelIntegralNick)+2,r26 |
5305 2c10 B093 0000 sts (MittelIntegralNick)+3,r27 |
5306 2c14 8091 0000 lds r24,MittelIntegralRoll |
5307 2c18 9091 0000 lds r25,(MittelIntegralRoll)+1 |
5308 2c1c A091 0000 lds r26,(MittelIntegralRoll)+2 |
5309 2c20 B091 0000 lds r27,(MittelIntegralRoll)+3 |
5310 2c24 2090 0000 lds r2,IntegralRoll |
5311 2c28 3090 0000 lds r3,(IntegralRoll)+1 |
5312 2c2c 4090 0000 lds r4,(IntegralRoll)+2 |
5313 2c30 5090 0000 lds r5,(IntegralRoll)+3 |
5314 2c34 820D add r24,r2 |
5315 2c36 931D adc r25,r3 |
5316 2c38 A41D adc r26,r4 |
5317 2c3a B51D adc r27,r5 |
5318 2c3c 8093 0000 sts MittelIntegralRoll,r24 |
5319 2c40 9093 0000 sts (MittelIntegralRoll)+1,r25 |
5320 2c44 A093 0000 sts (MittelIntegralRoll)+2,r26 |
5321 2c48 B093 0000 sts (MittelIntegralRoll)+3,r27 |
5322 2c4c 8091 0000 lds r24,MittelIntegralNick2 |
5323 2c50 9091 0000 lds r25,(MittelIntegralNick2)+1 |
5324 2c54 A091 0000 lds r26,(MittelIntegralNick2)+2 |
5325 2c58 B091 0000 lds r27,(MittelIntegralNick2)+3 |
5326 2c5c E090 0000 lds r14,IntegralNick2 |
5327 2c60 F090 0000 lds r15,(IntegralNick2)+1 |
5328 2c64 0091 0000 lds r16,(IntegralNick2)+2 |
5329 2c68 1091 0000 lds r17,(IntegralNick2)+3 |
5330 2c6c EAA2 std Y+34,r14 |
5331 2c6e FBA2 std Y+35,r15 |
5332 2c70 0CA3 std Y+36,r16 |
5333 2c72 1DA3 std Y+37,r17 |
5334 2c74 8E0D add r24,r14 |
5335 2c76 9F1D adc r25,r15 |
5336 2c78 A01F adc r26,r16 |
5337 2c7a B11F adc r27,r17 |
5338 2c7c 8093 0000 sts MittelIntegralNick2,r24 |
5339 2c80 9093 0000 sts (MittelIntegralNick2)+1,r25 |
5340 2c84 A093 0000 sts (MittelIntegralNick2)+2,r26 |
5341 2c88 B093 0000 sts (MittelIntegralNick2)+3,r27 |
5342 2c8c 8091 0000 lds r24,MittelIntegralRoll2 |
5343 2c90 9091 0000 lds r25,(MittelIntegralRoll2)+1 |
5344 2c94 A091 0000 lds r26,(MittelIntegralRoll2)+2 |
5345 2c98 B091 0000 lds r27,(MittelIntegralRoll2)+3 |
5346 2c9c E090 0000 lds r14,IntegralRoll2 |
5347 2ca0 F090 0000 lds r15,(IntegralRoll2)+1 |
5348 2ca4 0091 0000 lds r16,(IntegralRoll2)+2 |
5349 2ca8 1091 0000 lds r17,(IntegralRoll2)+3 |
5350 2cac EEA2 std Y+38,r14 |
5351 2cae FFA2 std Y+39,r15 |
5352 2cb0 08A7 std Y+40,r16 |
5353 2cb2 19A7 std Y+41,r17 |
5354 2cb4 8E0D add r24,r14 |
5355 2cb6 9F1D adc r25,r15 |
5356 2cb8 A01F adc r26,r16 |
5357 2cba B11F adc r27,r17 |
5358 2cbc 8093 0000 sts MittelIntegralRoll2,r24 |
5359 2cc0 9093 0000 sts (MittelIntegralRoll2)+1,r25 |
5360 2cc4 A093 0000 sts (MittelIntegralRoll2)+2,r26 |
5361 2cc8 B093 0000 sts (MittelIntegralRoll2)+3,r27 |
5362 2ccc F090 0000 lds r15,Looping_Nick |
5363 2cd0 FAA6 std Y+42,r15 |
5364 2cd2 FF20 tst r15 |
5365 2cd4 29F4 brne .L428 |
5366 2cd6 8091 0000 lds r24,Looping_Roll |
5367 2cda 8823 tst r24 |
5368 2cdc 09F4 brne .+2 |
5369 2cde 60C0 rjmp .L779 |
5370 .L428: |
5371 2ce0 1092 0000 sts IntegralAccNick,__zero_reg__ |
5372 2ce4 1092 0000 sts (IntegralAccNick)+1,__zero_reg__ |
5373 2ce8 1092 0000 sts (IntegralAccNick)+2,__zero_reg__ |
5374 2cec 1092 0000 sts (IntegralAccNick)+3,__zero_reg__ |
5375 2cf0 1092 0000 sts IntegralAccRoll,__zero_reg__ |
5376 2cf4 1092 0000 sts (IntegralAccRoll)+1,__zero_reg__ |
5377 2cf8 1092 0000 sts (IntegralAccRoll)+2,__zero_reg__ |
5378 2cfc 1092 0000 sts (IntegralAccRoll)+3,__zero_reg__ |
5379 2d00 1092 0000 sts MittelIntegralNick,__zero_reg__ |
5380 2d04 1092 0000 sts (MittelIntegralNick)+1,__zero_reg__ |
5381 2d08 1092 0000 sts (MittelIntegralNick)+2,__zero_reg__ |
5382 2d0c 1092 0000 sts (MittelIntegralNick)+3,__zero_reg__ |
5383 2d10 1092 0000 sts MittelIntegralRoll,__zero_reg__ |
5384 2d14 1092 0000 sts (MittelIntegralRoll)+1,__zero_reg__ |
5385 2d18 1092 0000 sts (MittelIntegralRoll)+2,__zero_reg__ |
5386 2d1c 1092 0000 sts (MittelIntegralRoll)+3,__zero_reg__ |
5387 2d20 1092 0000 sts MittelIntegralNick2,__zero_reg__ |
5388 2d24 1092 0000 sts (MittelIntegralNick2)+1,__zero_reg__ |
5389 2d28 1092 0000 sts (MittelIntegralNick2)+2,__zero_reg__ |
5390 2d2c 1092 0000 sts (MittelIntegralNick2)+3,__zero_reg__ |
5391 2d30 1092 0000 sts MittelIntegralRoll2,__zero_reg__ |
5392 2d34 1092 0000 sts (MittelIntegralRoll2)+1,__zero_reg__ |
5393 2d38 1092 0000 sts (MittelIntegralRoll2)+2,__zero_reg__ |
5394 2d3c 1092 0000 sts (MittelIntegralRoll2)+3,__zero_reg__ |
5395 2d40 8091 0000 lds r24,Mess_IntegralNick |
5396 2d44 9091 0000 lds r25,(Mess_IntegralNick)+1 |
5397 2d48 A091 0000 lds r26,(Mess_IntegralNick)+2 |
5398 2d4c B091 0000 lds r27,(Mess_IntegralNick)+3 |
5399 2d50 8093 0000 sts Mess_IntegralNick2,r24 |
5400 2d54 9093 0000 sts (Mess_IntegralNick2)+1,r25 |
5401 2d58 A093 0000 sts (Mess_IntegralNick2)+2,r26 |
5402 2d5c B093 0000 sts (Mess_IntegralNick2)+3,r27 |
5403 2d60 8091 0000 lds r24,Mess_IntegralRoll |
5404 2d64 9091 0000 lds r25,(Mess_IntegralRoll)+1 |
5405 2d68 A091 0000 lds r26,(Mess_IntegralRoll)+2 |
5406 2d6c B091 0000 lds r27,(Mess_IntegralRoll)+3 |
5407 2d70 8093 0000 sts Mess_IntegralRoll2,r24 |
5408 2d74 9093 0000 sts (Mess_IntegralRoll2)+1,r25 |
5409 2d78 A093 0000 sts (Mess_IntegralRoll2)+2,r26 |
5410 2d7c B093 0000 sts (Mess_IntegralRoll2)+3,r27 |
5411 2d80 1092 0000 sts (ZaehlMessungen)+1,__zero_reg__ |
5412 2d84 1092 0000 sts ZaehlMessungen,__zero_reg__ |
5413 2d88 1092 0000 sts (LageKorrekturNick)+1,__zero_reg__ |
5414 2d8c 1092 0000 sts LageKorrekturNick,__zero_reg__ |
5415 2d90 1092 0000 sts (LageKorrekturRoll)+1,__zero_reg__ |
5416 2d94 1092 0000 sts LageKorrekturRoll,__zero_reg__ |
5417 2d98 0AA5 ldd r16,Y+42 |
5418 2d9a 0023 tst r16 |
5419 2d9c 09F0 breq .+2 |
5420 2d9e F2C1 rjmp .L429 |
5421 .L779: |
5422 2da0 8091 0000 lds r24,Looping_Roll |
5423 2da4 8823 tst r24 |
5424 2da6 09F0 breq .+2 |
5425 2da8 EDC1 rjmp .L429 |
5426 2daa 8091 0000 lds r24,Aktuell_az |
5427 2dae 9091 0000 lds r25,(Aktuell_az)+1 |
5428 2db2 8150 subi r24,lo8(513) |
5429 2db4 9240 sbci r25,hi8(513) |
5430 2db6 2CF4 brge .L430 |
5431 2db8 8091 0000 lds r24,MotorenEin |
5432 2dbc 8823 tst r24 |
5433 2dbe 09F4 brne .+2 |
5434 2dc0 E1C1 rjmp .L429 |
5435 .L430: |
5436 2dc2 9090 0000 lds r9,FromNaviCtrl_Value |
5437 2dc6 A090 0000 lds r10,EE_Parameter+28 |
5438 2dca 6091 0000 lds r22,Mittelwert_AccNick |
5439 2dce 7091 0000 lds r23,(Mittelwert_AccNick)+1 |
5440 2dd2 7BAB std Y+51,r23 |
5441 2dd4 6AAB std Y+50,r22 |
5442 2dd6 8091 0000 lds r24,Mittelwert_AccRoll |
5443 2dda 9091 0000 lds r25,(Mittelwert_AccRoll)+1 |
5444 2dde 9DAB std Y+53,r25 |
5445 2de0 8CAB std Y+52,r24 |
5446 2de2 9FEF ldi r25,lo8(-1) |
5447 2de4 9916 cp r9,r25 |
5448 2de6 09F4 brne .+2 |
5449 2de8 D9C0 rjmp .L431 |
5450 2dea BB24 clr r11 |
5451 2dec CC24 clr r12 |
5452 2dee DD24 clr r13 |
5453 2df0 CA01 movw r24,r20 |
5454 2df2 B901 movw r22,r18 |
5455 2df4 A601 movw r20,r12 |
5456 2df6 9501 movw r18,r10 |
5457 2df8 0E94 0000 call __divmodsi4 |
5458 2dfc 7901 movw r14,r18 |
5459 2dfe 8A01 movw r16,r20 |
5460 2e00 EAA9 ldd r30,Y+50 |
5461 2e02 FBA9 ldd r31,Y+51 |
5462 2e04 CF01 movw r24,r30 |
5463 2e06 AA27 clr r26 |
5464 2e08 97FD sbrc r25,7 |
5465 2e0a A095 com r26 |
5466 2e0c BA2F mov r27,r26 |
5467 2e0e E81A sub r14,r24 |
5468 2e10 F90A sbc r15,r25 |
5469 2e12 0A0B sbc r16,r26 |
5470 2e14 1B0B sbc r17,r27 |
5471 2e16 C201 movw r24,r4 |
5472 2e18 B101 movw r22,r2 |
5473 2e1a A601 movw r20,r12 |
5474 2e1c 9501 movw r18,r10 |
5475 2e1e 0E94 0000 call __divmodsi4 |
5476 2e22 5901 movw r10,r18 |
5477 2e24 6A01 movw r12,r20 |
5478 2e26 2CA9 ldd r18,Y+52 |
5479 2e28 3DA9 ldd r19,Y+53 |
5480 2e2a C901 movw r24,r18 |
5481 2e2c AA27 clr r26 |
5482 2e2e 97FD sbrc r25,7 |
5483 2e30 A095 com r26 |
5484 2e32 BA2F mov r27,r26 |
5485 2e34 A81A sub r10,r24 |
5486 2e36 B90A sbc r11,r25 |
5487 2e38 CA0A sbc r12,r26 |
5488 2e3a DB0A sbc r13,r27 |
5489 2e3c 292C mov r2,r9 |
5490 2e3e 3324 clr r3 |
5491 2e40 27FC sbrc r2,7 |
5492 2e42 3094 com r3 |
5493 2e44 432C mov r4,r3 |
5494 2e46 532C mov r5,r3 |
5495 2e48 C801 movw r24,r16 |
5496 2e4a B701 movw r22,r14 |
5497 2e4c A201 movw r20,r4 |
5498 2e4e 9101 movw r18,r2 |
5499 2e50 0E94 0000 call __mulsi3 |
5500 2e54 97FF sbrs r25,7 |
5501 2e56 04C0 rjmp .L432 |
5502 2e58 6150 subi r22,lo8(-(511)) |
5503 2e5a 7E4F sbci r23,hi8(-(511)) |
5504 2e5c 8F4F sbci r24,hlo8(-(511)) |
5505 2e5e 9F4F sbci r25,hhi8(-(511)) |
5506 .L432: |
5507 2e60 3B01 movw r6,r22 |
5508 2e62 4C01 movw r8,r24 |
5509 2e64 09E0 ldi r16,9 |
5510 2e66 9594 1: asr r9 |
5511 2e68 8794 ror r8 |
5512 2e6a 7794 ror r7 |
5513 2e6c 6794 ror r6 |
5514 2e6e 0A95 dec r16 |
5515 2e70 D1F7 brne 1b |
5516 2e72 C601 movw r24,r12 |
5517 2e74 B501 movw r22,r10 |
5518 2e76 A201 movw r20,r4 |
5519 2e78 9101 movw r18,r2 |
5520 2e7a 0E94 0000 call __mulsi3 |
5521 2e7e 97FF sbrs r25,7 |
5522 2e80 04C0 rjmp .L433 |
5523 2e82 6150 subi r22,lo8(-(511)) |
5524 2e84 7E4F sbci r23,hi8(-(511)) |
5525 2e86 8F4F sbci r24,hlo8(-(511)) |
5526 2e88 9F4F sbci r25,hhi8(-(511)) |
5527 .L433: |
5528 2e8a 5B01 movw r10,r22 |
5529 2e8c 6C01 movw r12,r24 |
5530 2e8e 19E0 ldi r17,9 |
5531 2e90 D594 1: asr r13 |
5532 2e92 C794 ror r12 |
5533 2e94 B794 ror r11 |
5534 2e96 A794 ror r10 |
5535 2e98 1A95 dec r17 |
5536 2e9a D1F7 brne 1b |
5537 2e9c 8091 0000 lds r24,MaxStickNick |
5538 2ea0 9091 0000 lds r25,(MaxStickNick)+1 |
5539 2ea4 8134 cpi r24,65 |
5540 2ea6 9105 cpc r25,__zero_reg__ |
5541 2ea8 3CF4 brge .L435 |
5542 2eaa 8091 0000 lds r24,MaxStickRoll |
5543 2eae 9091 0000 lds r25,(MaxStickRoll)+1 |
5544 2eb2 8134 cpi r24,65 |
5545 2eb4 9105 cpc r25,__zero_reg__ |
5546 2eb6 D4F0 brlt .L434 |
5547 .L435: |
5548 2eb8 D401 movw r26,r8 |
5549 2eba C301 movw r24,r6 |
5550 2ebc 97FE sbrs r9,7 |
5551 2ebe 03C0 rjmp .L436 |
5552 2ec0 0196 adiw r24,1 |
5553 2ec2 A11D adc r26,__zero_reg__ |
5554 2ec4 B11D adc r27,__zero_reg__ |
5555 .L436: |
5556 2ec6 3C01 movw r6,r24 |
5557 2ec8 4D01 movw r8,r26 |
5558 2eca 9594 asr r9 |
5559 2ecc 8794 ror r8 |
5560 2ece 7794 ror r7 |
5561 2ed0 6794 ror r6 |
5562 2ed2 D601 movw r26,r12 |
5563 2ed4 C501 movw r24,r10 |
5564 2ed6 D7FE sbrs r13,7 |
5565 2ed8 03C0 rjmp .L437 |
5566 2eda 0196 adiw r24,1 |
5567 2edc A11D adc r26,__zero_reg__ |
5568 2ede B11D adc r27,__zero_reg__ |
5569 .L437: |
5570 2ee0 5C01 movw r10,r24 |
5571 2ee2 6D01 movw r12,r26 |
5572 2ee4 D594 asr r13 |
5573 2ee6 C794 ror r12 |
5574 2ee8 B794 ror r11 |
5575 2eea A794 ror r10 |
5576 .L434: |
5577 2eec 8091 0000 lds r24,EE_Parameter+4 |
5578 2ef0 E82F mov r30,r24 |
5579 2ef2 FF27 clr r31 |
5580 2ef4 EE0F add r30,r30 |
5581 2ef6 FF1F adc r31,r31 |
5582 2ef8 E050 subi r30,lo8(-(PPM_in)) |
5583 2efa F040 sbci r31,hi8(-(PPM_in)) |
5584 2efc 8081 ld r24,Z |
5585 2efe 9181 ldd r25,Z+1 |
5586 2f00 0190 ld __tmp_reg__,Z+ |
5587 2f02 F081 ld r31,Z |
5588 2f04 E02D mov r30,__tmp_reg__ |
5589 2f06 F7FF sbrs r31,7 |
5590 2f08 03C0 rjmp .L439 |
5591 2f0a F095 com r31 |
5592 2f0c E195 neg r30 |
5593 2f0e FF4F sbci r31,lo8(-1) |
5594 .L439: |
5595 2f10 7A97 sbiw r30,26 |
5596 2f12 A4F0 brlt .L438 |
5597 2f14 C401 movw r24,r8 |
5598 2f16 B301 movw r22,r6 |
5599 2f18 23E0 ldi r18,lo8(3) |
5600 2f1a 30E0 ldi r19,hi8(3) |
5601 2f1c 40E0 ldi r20,hlo8(3) |
5602 2f1e 50E0 ldi r21,hhi8(3) |
5603 2f20 0E94 0000 call __divmodsi4 |
5604 2f24 3901 movw r6,r18 |
5605 2f26 4A01 movw r8,r20 |
5606 2f28 C601 movw r24,r12 |
5607 2f2a B501 movw r22,r10 |
5608 2f2c 23E0 ldi r18,lo8(3) |
5609 2f2e 30E0 ldi r19,hi8(3) |
5610 2f30 40E0 ldi r20,hlo8(3) |
5611 2f32 50E0 ldi r21,hhi8(3) |
5612 2f34 0E94 0000 call __divmodsi4 |
5613 2f38 5901 movw r10,r18 |
5614 2f3a 6A01 movw r12,r20 |
5615 .L438: |
5616 2f3c 8091 0000 lds r24,FromNaviCtrl_Value+2 |
5617 2f40 282F mov r18,r24 |
5618 2f42 3327 clr r19 |
5619 2f44 27FD sbrc r18,7 |
5620 2f46 3095 com r19 |
5621 2f48 432F mov r20,r19 |
5622 2f4a 532F mov r21,r19 |
5623 2f4c 2615 cp r18,r6 |
5624 2f4e 3705 cpc r19,r7 |
5625 2f50 4805 cpc r20,r8 |
5626 2f52 5905 cpc r21,r9 |
5627 2f54 14F4 brge .L440 |
5628 2f56 3901 movw r6,r18 |
5629 2f58 4A01 movw r8,r20 |
5630 .L440: |
5631 2f5a 9927 clr r25 |
5632 2f5c 87FD sbrc r24,7 |
5633 2f5e 9095 com r25 |
5634 2f60 9095 com r25 |
5635 2f62 8195 neg r24 |
5636 2f64 9F4F sbci r25,lo8(-1) |
5637 2f66 AA27 clr r26 |
5638 2f68 97FD sbrc r25,7 |
5639 2f6a A095 com r26 |
5640 2f6c BA2F mov r27,r26 |
5641 2f6e 6816 cp r6,r24 |
5642 2f70 7906 cpc r7,r25 |
5643 2f72 8A06 cpc r8,r26 |
5644 2f74 9B06 cpc r9,r27 |
5645 2f76 14F4 brge .L441 |
5646 2f78 3C01 movw r6,r24 |
5647 2f7a 4D01 movw r8,r26 |
5648 .L441: |
5649 2f7c 2A15 cp r18,r10 |
5650 2f7e 3B05 cpc r19,r11 |
5651 2f80 4C05 cpc r20,r12 |
5652 2f82 5D05 cpc r21,r13 |
5653 2f84 14F4 brge .L442 |
5654 2f86 5901 movw r10,r18 |
5655 2f88 6A01 movw r12,r20 |
5656 .L442: |
5657 2f8a A816 cp r10,r24 |
5658 2f8c B906 cpc r11,r25 |
5659 2f8e CA06 cpc r12,r26 |
5660 2f90 DB06 cpc r13,r27 |
5661 2f92 0CF0 brlt .+2 |
5662 2f94 CFC0 rjmp .L444 |
5663 2f96 5C01 movw r10,r24 |
5664 2f98 6D01 movw r12,r26 |
5665 2f9a CCC0 rjmp .L444 |
5666 .L431: |
5667 2f9c EA2C mov r14,r10 |
5668 2f9e FF24 clr r15 |
5669 2fa0 0027 clr r16 |
5670 2fa2 1127 clr r17 |
5671 2fa4 CA01 movw r24,r20 |
5672 2fa6 B901 movw r22,r18 |
5673 2fa8 A801 movw r20,r16 |
5674 2faa 9701 movw r18,r14 |
5675 2fac 0E94 0000 call __divmodsi4 |
5676 2fb0 3901 movw r6,r18 |
5677 2fb2 4A01 movw r8,r20 |
5678 2fb4 4AA9 ldd r20,Y+50 |
5679 2fb6 5BA9 ldd r21,Y+51 |
5680 2fb8 CA01 movw r24,r20 |
5681 2fba AA27 clr r26 |
5682 2fbc 97FD sbrc r25,7 |
5683 2fbe A095 com r26 |
5684 2fc0 BA2F mov r27,r26 |
5685 2fc2 681A sub r6,r24 |
5686 2fc4 790A sbc r7,r25 |
5687 2fc6 8A0A sbc r8,r26 |
5688 2fc8 9B0A sbc r9,r27 |
5689 2fca C201 movw r24,r4 |
5690 2fcc B101 movw r22,r2 |
5691 2fce A801 movw r20,r16 |
5692 2fd0 9701 movw r18,r14 |
5693 2fd2 0E94 0000 call __divmodsi4 |
5694 2fd6 5901 movw r10,r18 |
5695 2fd8 6A01 movw r12,r20 |
5696 2fda 6CA9 ldd r22,Y+52 |
5697 2fdc 7DA9 ldd r23,Y+53 |
5698 2fde CB01 movw r24,r22 |
5699 2fe0 AA27 clr r26 |
5700 2fe2 97FD sbrc r25,7 |
5701 2fe4 A095 com r26 |
5702 2fe6 BA2F mov r27,r26 |
5703 2fe8 A81A sub r10,r24 |
5704 2fea B90A sbc r11,r25 |
5705 2fec CA0A sbc r12,r26 |
5706 2fee DB0A sbc r13,r27 |
5707 2ff0 D401 movw r26,r8 |
5708 2ff2 C301 movw r24,r6 |
5709 2ff4 97FE sbrs r9,7 |
5710 2ff6 03C0 rjmp .L445 |
5711 2ff8 0F96 adiw r24,15 |
5712 2ffa A11D adc r26,__zero_reg__ |
5713 2ffc B11D adc r27,__zero_reg__ |
5714 .L445: |
5715 2ffe 3C01 movw r6,r24 |
5716 3000 4D01 movw r8,r26 |
5717 3002 F4E0 ldi r31,4 |
5718 3004 9594 1: asr r9 |
5719 3006 8794 ror r8 |
5720 3008 7794 ror r7 |
5721 300a 6794 ror r6 |
5722 300c FA95 dec r31 |
5723 300e D1F7 brne 1b |
5724 3010 D601 movw r26,r12 |
5725 3012 C501 movw r24,r10 |
5726 3014 D7FE sbrs r13,7 |
5727 3016 03C0 rjmp .L446 |
5728 3018 0F96 adiw r24,15 |
5729 301a A11D adc r26,__zero_reg__ |
5730 301c B11D adc r27,__zero_reg__ |
5731 .L446: |
5732 301e 5C01 movw r10,r24 |
5733 3020 6D01 movw r12,r26 |
5734 3022 E4E0 ldi r30,4 |
5735 3024 D594 1: asr r13 |
5736 3026 C794 ror r12 |
5737 3028 B794 ror r11 |
5738 302a A794 ror r10 |
5739 302c EA95 dec r30 |
5740 302e D1F7 brne 1b |
5741 3030 8091 0000 lds r24,MaxStickNick |
5742 3034 9091 0000 lds r25,(MaxStickNick)+1 |
5743 3038 8134 cpi r24,65 |
5744 303a 9105 cpc r25,__zero_reg__ |
5745 303c 3CF4 brge .L448 |
5746 303e 8091 0000 lds r24,MaxStickRoll |
5747 3042 9091 0000 lds r25,(MaxStickRoll)+1 |
5748 3046 8134 cpi r24,65 |
5749 3048 9105 cpc r25,__zero_reg__ |
5750 304a A4F0 brlt .L447 |
5751 .L448: |
5752 304c C401 movw r24,r8 |
5753 304e B301 movw r22,r6 |
5754 3050 23E0 ldi r18,lo8(3) |
5755 3052 30E0 ldi r19,hi8(3) |
5756 3054 40E0 ldi r20,hlo8(3) |
5757 3056 50E0 ldi r21,hhi8(3) |
5758 3058 0E94 0000 call __divmodsi4 |
5759 305c 3901 movw r6,r18 |
5760 305e 4A01 movw r8,r20 |
5761 3060 C601 movw r24,r12 |
5762 3062 B501 movw r22,r10 |
5763 3064 23E0 ldi r18,lo8(3) |
5764 3066 30E0 ldi r19,hi8(3) |
5765 3068 40E0 ldi r20,hlo8(3) |
5766 306a 50E0 ldi r21,hhi8(3) |
5767 306c 0E94 0000 call __divmodsi4 |
5768 3070 5901 movw r10,r18 |
5769 3072 6A01 movw r12,r20 |
5770 .L447: |
5771 3074 8091 0000 lds r24,EE_Parameter+4 |
5772 3078 E82F mov r30,r24 |
5773 307a FF27 clr r31 |
5774 307c EE0F add r30,r30 |
5775 307e FF1F adc r31,r31 |
5776 3080 E050 subi r30,lo8(-(PPM_in)) |
5777 3082 F040 sbci r31,hi8(-(PPM_in)) |
5778 3084 8081 ld r24,Z |
5779 3086 9181 ldd r25,Z+1 |
5780 3088 0190 ld __tmp_reg__,Z+ |
5781 308a F081 ld r31,Z |
5782 308c E02D mov r30,__tmp_reg__ |
5783 308e F7FF sbrs r31,7 |
5784 3090 03C0 rjmp .L450 |
5785 3092 F095 com r31 |
5786 3094 E195 neg r30 |
5787 3096 FF4F sbci r31,lo8(-1) |
5788 .L450: |
5789 3098 7A97 sbiw r30,26 |
5790 309a A4F0 brlt .L449 |
5791 309c C401 movw r24,r8 |
5792 309e B301 movw r22,r6 |
5793 30a0 23E0 ldi r18,lo8(3) |
5794 30a2 30E0 ldi r19,hi8(3) |
5795 30a4 40E0 ldi r20,hlo8(3) |
5796 30a6 50E0 ldi r21,hhi8(3) |
5797 30a8 0E94 0000 call __divmodsi4 |
5798 30ac 3901 movw r6,r18 |
5799 30ae 4A01 movw r8,r20 |
5800 30b0 C601 movw r24,r12 |
5801 30b2 B501 movw r22,r10 |
5802 30b4 23E0 ldi r18,lo8(3) |
5803 30b6 30E0 ldi r19,hi8(3) |
5804 30b8 40E0 ldi r20,hlo8(3) |
5805 30ba 50E0 ldi r21,hhi8(3) |
5806 30bc 0E94 0000 call __divmodsi4 |
5807 30c0 5901 movw r10,r18 |
5808 30c2 6A01 movw r12,r20 |
5809 .L449: |
5810 30c4 71E2 ldi r23,lo8(33) |
5811 30c6 6716 cp r6,r23 |
5812 30c8 7104 cpc r7,__zero_reg__ |
5813 30ca 8104 cpc r8,__zero_reg__ |
5814 30cc 9104 cpc r9,__zero_reg__ |
5815 30ce 2CF0 brlt .L451 |
5816 30d0 70E2 ldi r23,lo8(32) |
5817 30d2 672E mov r6,r23 |
5818 30d4 712C mov r7,__zero_reg__ |
5819 30d6 812C mov r8,__zero_reg__ |
5820 30d8 912C mov r9,__zero_reg__ |
5821 .L451: |
5822 30da 80EE ldi r24,lo8(-32) |
5823 30dc 6816 cp r6,r24 |
5824 30de 8FEF ldi r24,hi8(-32) |
5825 30e0 7806 cpc r7,r24 |
5826 30e2 8FEF ldi r24,hlo8(-32) |
5827 30e4 8806 cpc r8,r24 |
5828 30e6 8FEF ldi r24,hhi8(-32) |
5829 30e8 9806 cpc r9,r24 |
5830 30ea 44F4 brge .L452 |
5831 30ec 60EE ldi r22,lo8(-32) |
5832 30ee 662E mov r6,r22 |
5833 30f0 6FEF ldi r22,hi8(-32) |
5834 30f2 762E mov r7,r22 |
5835 30f4 6FEF ldi r22,hlo8(-32) |
5836 30f6 862E mov r8,r22 |
5837 30f8 6FEF ldi r22,hhi8(-32) |
5838 30fa 962E mov r9,r22 |
5839 .L452: |
5840 30fc 91E2 ldi r25,lo8(33) |
5841 30fe A916 cp r10,r25 |
5842 3100 B104 cpc r11,__zero_reg__ |
5843 3102 C104 cpc r12,__zero_reg__ |
5844 3104 D104 cpc r13,__zero_reg__ |
5845 3106 2CF0 brlt .L453 |
5846 3108 50E2 ldi r21,lo8(32) |
5847 310a A52E mov r10,r21 |
5848 310c B12C mov r11,__zero_reg__ |
5849 310e C12C mov r12,__zero_reg__ |
5850 3110 D12C mov r13,__zero_reg__ |
5851 .L453: |
5852 3112 A0EE ldi r26,lo8(-32) |
5853 3114 AA16 cp r10,r26 |
5854 3116 AFEF ldi r26,hi8(-32) |
5855 3118 BA06 cpc r11,r26 |
5856 311a AFEF ldi r26,hlo8(-32) |
5857 311c CA06 cpc r12,r26 |
5858 311e AFEF ldi r26,hhi8(-32) |
5859 3120 DA06 cpc r13,r26 |
5860 3122 44F4 brge .L444 |
5861 3124 40EE ldi r20,lo8(-32) |
5862 3126 A42E mov r10,r20 |
5863 3128 4FEF ldi r20,hi8(-32) |
5864 312a B42E mov r11,r20 |
5865 312c 4FEF ldi r20,hlo8(-32) |
5866 312e C42E mov r12,r20 |
5867 3130 4FEF ldi r20,hhi8(-32) |
5868 3132 D42E mov r13,r20 |
5869 .L444: |
5870 3134 8091 0000 lds r24,Mess_IntegralNick |
5871 3138 9091 0000 lds r25,(Mess_IntegralNick)+1 |
5872 313c A091 0000 lds r26,(Mess_IntegralNick)+2 |
5873 3140 B091 0000 lds r27,(Mess_IntegralNick)+3 |
5874 3144 8619 sub r24,r6 |
5875 3146 9709 sbc r25,r7 |
5876 3148 A809 sbc r26,r8 |
5877 314a B909 sbc r27,r9 |
5878 314c 8093 0000 sts Mess_IntegralNick,r24 |
5879 3150 9093 0000 sts (Mess_IntegralNick)+1,r25 |
5880 3154 A093 0000 sts (Mess_IntegralNick)+2,r26 |
5881 3158 B093 0000 sts (Mess_IntegralNick)+3,r27 |
5882 315c 8091 0000 lds r24,Mess_IntegralRoll |
5883 3160 9091 0000 lds r25,(Mess_IntegralRoll)+1 |
5884 3164 A091 0000 lds r26,(Mess_IntegralRoll)+2 |
5885 3168 B091 0000 lds r27,(Mess_IntegralRoll)+3 |
5886 316c 8A19 sub r24,r10 |
5887 316e 9B09 sbc r25,r11 |
5888 3170 AC09 sbc r26,r12 |
5889 3172 BD09 sbc r27,r13 |
5890 3174 8093 0000 sts Mess_IntegralRoll,r24 |
5891 3178 9093 0000 sts (Mess_IntegralRoll)+1,r25 |
5892 317c A093 0000 sts (Mess_IntegralRoll)+2,r26 |
5893 3180 B093 0000 sts (Mess_IntegralRoll)+3,r27 |
5894 .L429: |
5895 3184 8091 0000 lds r24,ZaehlMessungen |
5896 3188 9091 0000 lds r25,(ZaehlMessungen)+1 |
5897 318c 8F3F cpi r24,255 |
5898 318e 9105 cpc r25,__zero_reg__ |
5899 3190 09F0 breq .+2 |
5900 3192 08F4 brsh .+2 |
5901 3194 C4C5 rjmp .L455 |
5902 3196 BAA5 ldd r27,Y+42 |
5903 3198 BB23 tst r27 |
5904 319a 09F0 breq .+2 |
5905 319c 4EC5 rjmp .L456 |
5906 319e 8091 0000 lds r24,Looping_Roll |
5907 31a2 8823 tst r24 |
5908 31a4 09F0 breq .+2 |
5909 31a6 49C5 rjmp .L456 |
5910 31a8 8091 0000 lds r24,TrichterFlug |
5911 31ac 8823 tst r24 |
5912 31ae 09F0 breq .+2 |
5913 31b0 44C5 rjmp .L456 |
5914 31b2 E091 0000 lds r30,EE_Parameter+66 |
5915 31b6 EBA7 std Y+43,r30 |
5916 31b8 EE23 tst r30 |
5917 31ba 09F4 brne .+2 |
5918 31bc 3EC5 rjmp .L456 |
5919 31be 8091 0000 lds r24,MittelIntegralNick |
5920 31c2 9091 0000 lds r25,(MittelIntegralNick)+1 |
5921 31c6 A091 0000 lds r26,(MittelIntegralNick)+2 |
5922 31ca B091 0000 lds r27,(MittelIntegralNick)+3 |
5923 31ce B7FF sbrs r27,7 |
5924 31d0 04C0 rjmp .L457 |
5925 31d2 8150 subi r24,lo8(-(255)) |
5926 31d4 9F4F sbci r25,hi8(-(255)) |
5927 31d6 AF4F sbci r26,hlo8(-(255)) |
5928 31d8 BF4F sbci r27,hhi8(-(255)) |
5929 .L457: |
5930 31da E92E mov r14,r25 |
5931 31dc FA2E mov r15,r26 |
5932 31de 0B2F mov r16,r27 |
5933 31e0 1127 clr r17 |
5934 31e2 07FD sbrc r16,7 |
5935 31e4 1A95 dec r17 |
5936 31e6 E092 0000 sts MittelIntegralNick,r14 |
5937 31ea F092 0000 sts (MittelIntegralNick)+1,r15 |
5938 31ee 0093 0000 sts (MittelIntegralNick)+2,r16 |
5939 31f2 1093 0000 sts (MittelIntegralNick)+3,r17 |
5940 31f6 8091 0000 lds r24,MittelIntegralRoll |
5941 31fa 9091 0000 lds r25,(MittelIntegralRoll)+1 |
5942 31fe A091 0000 lds r26,(MittelIntegralRoll)+2 |
5943 3202 B091 0000 lds r27,(MittelIntegralRoll)+3 |
5944 3206 B7FF sbrs r27,7 |
5945 3208 04C0 rjmp .L458 |
5946 320a 8150 subi r24,lo8(-(255)) |
5947 320c 9F4F sbci r25,hi8(-(255)) |
5948 320e AF4F sbci r26,hlo8(-(255)) |
5949 3210 BF4F sbci r27,hhi8(-(255)) |
5950 .L458: |
5951 3212 892F mov r24,r25 |
5952 3214 9A2F mov r25,r26 |
5953 3216 AB2F mov r26,r27 |
5954 3218 BB27 clr r27 |
5955 321a A7FD sbrc r26,7 |
5956 321c BA95 dec r27 |
5957 321e 8CA7 std Y+44,r24 |
5958 3220 9DA7 std Y+45,r25 |
5959 3222 AEA7 std Y+46,r26 |
5960 3224 BFA7 std Y+47,r27 |
5961 3226 8093 0000 sts MittelIntegralRoll,r24 |
5962 322a 9093 0000 sts (MittelIntegralRoll)+1,r25 |
5963 322e A093 0000 sts (MittelIntegralRoll)+2,r26 |
5964 3232 B093 0000 sts (MittelIntegralRoll)+3,r27 |
5965 3236 8091 0000 lds r24,EE_Parameter+28 |
5966 323a A82E mov r10,r24 |
5967 323c BB24 clr r11 |
5968 323e CC24 clr r12 |
5969 3240 DD24 clr r13 |
5970 3242 2091 0000 lds r18,IntegralAccNick |
5971 3246 3091 0000 lds r19,(IntegralAccNick)+1 |
5972 324a 4091 0000 lds r20,(IntegralAccNick)+2 |
5973 324e 5091 0000 lds r21,(IntegralAccNick)+3 |
5974 3252 C601 movw r24,r12 |
5975 3254 B501 movw r22,r10 |
5976 3256 0E94 0000 call __mulsi3 |
5977 325a 97FF sbrs r25,7 |
5978 325c 04C0 rjmp .L459 |
5979 325e 6150 subi r22,lo8(-(255)) |
5980 3260 7F4F sbci r23,hi8(-(255)) |
5981 3262 8F4F sbci r24,hlo8(-(255)) |
5982 3264 9F4F sbci r25,hhi8(-(255)) |
5983 .L459: |
5984 3266 672E mov r6,r23 |
5985 3268 782E mov r7,r24 |
5986 326a 892E mov r8,r25 |
5987 326c 9924 clr r9 |
5988 326e 87FC sbrc r8,7 |
5989 3270 9A94 dec r9 |
5990 3272 6092 0000 sts IntegralAccNick,r6 |
5991 3276 7092 0000 sts (IntegralAccNick)+1,r7 |
5992 327a 8092 0000 sts (IntegralAccNick)+2,r8 |
5993 327e 9092 0000 sts (IntegralAccNick)+3,r9 |
5994 3282 2091 0000 lds r18,IntegralAccRoll |
5995 3286 3091 0000 lds r19,(IntegralAccRoll)+1 |
5996 328a 4091 0000 lds r20,(IntegralAccRoll)+2 |
5997 328e 5091 0000 lds r21,(IntegralAccRoll)+3 |
5998 3292 C601 movw r24,r12 |
5999 3294 B501 movw r22,r10 |
6000 3296 0E94 0000 call __mulsi3 |
6001 329a 97FF sbrs r25,7 |
6002 329c 04C0 rjmp .L460 |
6003 329e 6150 subi r22,lo8(-(255)) |
6004 32a0 7F4F sbci r23,hi8(-(255)) |
6005 32a2 8F4F sbci r24,hlo8(-(255)) |
6006 32a4 9F4F sbci r25,hhi8(-(255)) |
6007 .L460: |
6008 32a6 272E mov r2,r23 |
6009 32a8 382E mov r3,r24 |
6010 32aa 492E mov r4,r25 |
6011 32ac 5524 clr r5 |
6012 32ae 47FC sbrc r4,7 |
6013 32b0 5A94 dec r5 |
6014 32b2 2092 0000 sts IntegralAccRoll,r2 |
6015 32b6 3092 0000 sts (IntegralAccRoll)+1,r3 |
6016 32ba 4092 0000 sts (IntegralAccRoll)+2,r4 |
6017 32be 5092 0000 sts (IntegralAccRoll)+3,r5 |
6018 32c2 8091 0000 lds r24,IntegralAccZ |
6019 32c6 9091 0000 lds r25,(IntegralAccZ)+1 |
6020 32ca A091 0000 lds r26,(IntegralAccZ)+2 |
6021 32ce B091 0000 lds r27,(IntegralAccZ)+3 |
6022 32d2 B7FF sbrs r27,7 |
6023 32d4 04C0 rjmp .L461 |
6024 32d6 8150 subi r24,lo8(-(255)) |
6025 32d8 9F4F sbci r25,hi8(-(255)) |
6026 32da AF4F sbci r26,hlo8(-(255)) |
6027 32dc BF4F sbci r27,hhi8(-(255)) |
6028 .L461: |
6029 32de 892F mov r24,r25 |
6030 32e0 9A2F mov r25,r26 |
6031 32e2 AB2F mov r26,r27 |
6032 32e4 BB27 clr r27 |
6033 32e6 A7FD sbrc r26,7 |
6034 32e8 BA95 dec r27 |
6035 32ea 8093 0000 sts IntegralAccZ,r24 |
6036 32ee 9093 0000 sts (IntegralAccZ)+1,r25 |
6037 32f2 A093 0000 sts (IntegralAccZ)+2,r26 |
6038 32f6 B093 0000 sts (IntegralAccZ)+3,r27 |
6039 32fa D801 movw r26,r16 |
6040 32fc C701 movw r24,r14 |
6041 32fe 8619 sub r24,r6 |
6042 3300 9709 sbc r25,r7 |
6043 3302 A809 sbc r26,r8 |
6044 3304 B909 sbc r27,r9 |
6045 3306 8093 0000 sts IntegralFehlerNick.3,r24 |
6046 330a 9093 0000 sts (IntegralFehlerNick.3)+1,r25 |
6047 330e A093 0000 sts (IntegralFehlerNick.3)+2,r26 |
6048 3312 B093 0000 sts (IntegralFehlerNick.3)+3,r27 |
6049 3316 2091 0000 lds r18,EE_Parameter+65 |
6050 331a E22E mov r14,r18 |
6051 331c FF24 clr r15 |
6052 331e 0027 clr r16 |
6053 3320 1127 clr r17 |
6054 3322 BC01 movw r22,r24 |
6055 3324 CD01 movw r24,r26 |
6056 3326 A801 movw r20,r16 |
6057 3328 9701 movw r18,r14 |
6058 332a 0E94 0000 call __divmodsi4 |
6059 332e 5901 movw r10,r18 |
6060 3330 6A01 movw r12,r20 |
6061 3332 2093 0000 sts ausgleichNick.11,r18 |
6062 3336 3093 0000 sts (ausgleichNick.11)+1,r19 |
6063 333a 4093 0000 sts (ausgleichNick.11)+2,r20 |
6064 333e 5093 0000 sts (ausgleichNick.11)+3,r21 |
6065 3342 8CA5 ldd r24,Y+44 |
6066 3344 9DA5 ldd r25,Y+45 |
6067 3346 AEA5 ldd r26,Y+46 |
6068 3348 BFA5 ldd r27,Y+47 |
6069 334a 8219 sub r24,r2 |
6070 334c 9309 sbc r25,r3 |
6071 334e A409 sbc r26,r4 |
6072 3350 B509 sbc r27,r5 |
6073 3352 8093 0000 sts IntegralFehlerRoll.4,r24 |
6074 3356 9093 0000 sts (IntegralFehlerRoll.4)+1,r25 |
6075 335a A093 0000 sts (IntegralFehlerRoll.4)+2,r26 |
6076 335e B093 0000 sts (IntegralFehlerRoll.4)+3,r27 |
6077 3362 BC01 movw r22,r24 |
6078 3364 CD01 movw r24,r26 |
6079 3366 A801 movw r20,r16 |
6080 3368 9701 movw r18,r14 |
6081 336a 0E94 0000 call __divmodsi4 |
6082 336e 2093 0000 sts ausgleichRoll.12,r18 |
6083 3372 3093 0000 sts (ausgleichRoll.12)+1,r19 |
6084 3376 4093 0000 sts (ausgleichRoll.12)+2,r20 |
6085 337a 5093 0000 sts (ausgleichRoll.12)+3,r21 |
6086 337e D601 movw r26,r12 |
6087 3380 C501 movw r24,r10 |
6088 3382 D7FE sbrs r13,7 |
6089 3384 04C0 rjmp .L462 |
6090 3386 8150 subi r24,lo8(-(255)) |
6091 3388 9F4F sbci r25,hi8(-(255)) |
6092 338a AF4F sbci r26,hlo8(-(255)) |
6093 338c BF4F sbci r27,hhi8(-(255)) |
6094 .L462: |
6095 338e 892F mov r24,r25 |
6096 3390 9A2F mov r25,r26 |
6097 3392 AB2F mov r26,r27 |
6098 3394 BB27 clr r27 |
6099 3396 A7FD sbrc r26,7 |
6100 3398 BA95 dec r27 |
6101 339a 9093 0000 sts (LageKorrekturNick)+1,r25 |
6102 339e 8093 0000 sts LageKorrekturNick,r24 |
6103 33a2 57FF sbrs r21,7 |
6104 33a4 04C0 rjmp .L463 |
6105 33a6 2150 subi r18,lo8(-(255)) |
6106 33a8 3F4F sbci r19,hi8(-(255)) |
6107 33aa 4F4F sbci r20,hlo8(-(255)) |
6108 33ac 5F4F sbci r21,hhi8(-(255)) |
6109 .L463: |
6110 33ae BB27 clr r27 |
6111 33b0 57FD sbrc r21,7 |
6112 33b2 BA95 dec r27 |
6113 33b4 A52F mov r26,r21 |
6114 33b6 942F mov r25,r20 |
6115 33b8 832F mov r24,r19 |
6116 33ba 9093 0000 sts (LageKorrekturRoll)+1,r25 |
6117 33be 8093 0000 sts LageKorrekturRoll,r24 |
6118 33c2 8091 0000 lds r24,MaxStickNick |
6119 33c6 9091 0000 lds r25,(MaxStickNick)+1 |
6120 33ca 8134 cpi r24,65 |
6121 33cc 9105 cpc r25,__zero_reg__ |
6122 33ce DCF4 brge .L465 |
6123 33d0 8091 0000 lds r24,MaxStickRoll |
6124 33d4 9091 0000 lds r25,(MaxStickRoll)+1 |
6125 33d8 8134 cpi r24,65 |
6126 33da 9105 cpc r25,__zero_reg__ |
6127 33dc A4F4 brge .L465 |
6128 33de 8091 0000 lds r24,EE_Parameter+4 |
6129 33e2 E82F mov r30,r24 |
6130 33e4 FF27 clr r31 |
6131 33e6 EE0F add r30,r30 |
6132 33e8 FF1F adc r31,r31 |
6133 33ea E050 subi r30,lo8(-(PPM_in)) |
6134 33ec F040 sbci r31,hi8(-(PPM_in)) |
6135 33ee 8081 ld r24,Z |
6136 33f0 9181 ldd r25,Z+1 |
6137 33f2 0190 ld __tmp_reg__,Z+ |
6138 33f4 F081 ld r31,Z |
6139 33f6 E02D mov r30,__tmp_reg__ |
6140 33f8 F7FF sbrs r31,7 |
6141 33fa 03C0 rjmp .L466 |
6142 33fc F095 com r31 |
6143 33fe E195 neg r30 |
6144 3400 FF4F sbci r31,lo8(-1) |
6145 .L466: |
6146 3402 7A97 sbiw r30,26 |
6147 3404 E4F0 brlt .L464 |
6148 .L465: |
6149 3406 8091 0000 lds r24,FromNaviCtrl_Value |
6150 340a 8F3F cpi r24,lo8(-1) |
6151 340c C1F4 brne .L464 |
6152 340e 8091 0000 lds r24,LageKorrekturNick |
6153 3412 9091 0000 lds r25,(LageKorrekturNick)+1 |
6154 3416 97FD sbrc r25,7 |
6155 3418 0196 adiw r24,1 |
6156 .L467: |
6157 341a 9595 asr r25 |
6158 341c 8795 ror r24 |
6159 341e 9093 0000 sts (LageKorrekturNick)+1,r25 |
6160 3422 8093 0000 sts LageKorrekturNick,r24 |
6161 3426 8091 0000 lds r24,LageKorrekturRoll |
6162 342a 9091 0000 lds r25,(LageKorrekturRoll)+1 |
6163 342e 97FD sbrc r25,7 |
6164 3430 0196 adiw r24,1 |
6165 .L468: |
6166 3432 9595 asr r25 |
6167 3434 8795 ror r24 |
6168 3436 9093 0000 sts (LageKorrekturRoll)+1,r25 |
6169 343a 8093 0000 sts LageKorrekturRoll,r24 |
6170 .L464: |
6171 343e 8091 0000 lds r24,MittelIntegralNick2 |
6172 3442 9091 0000 lds r25,(MittelIntegralNick2)+1 |
6173 3446 A091 0000 lds r26,(MittelIntegralNick2)+2 |
6174 344a B091 0000 lds r27,(MittelIntegralNick2)+3 |
6175 344e B7FF sbrs r27,7 |
6176 3450 04C0 rjmp .L469 |
6177 3452 8150 subi r24,lo8(-(255)) |
6178 3454 9F4F sbci r25,hi8(-(255)) |
6179 3456 AF4F sbci r26,hlo8(-(255)) |
6180 3458 BF4F sbci r27,hhi8(-(255)) |
6181 .L469: |
6182 345a 892F mov r24,r25 |
6183 345c 9A2F mov r25,r26 |
6184 345e AB2F mov r26,r27 |
6185 3460 BB27 clr r27 |
6186 3462 A7FD sbrc r26,7 |
6187 3464 BA95 dec r27 |
6188 3466 8093 0000 sts MittelIntegralNick2,r24 |
6189 346a 9093 0000 sts (MittelIntegralNick2)+1,r25 |
6190 346e A093 0000 sts (MittelIntegralNick2)+2,r26 |
6191 3472 B093 0000 sts (MittelIntegralNick2)+3,r27 |
6192 3476 8091 0000 lds r24,MittelIntegralRoll2 |
6193 347a 9091 0000 lds r25,(MittelIntegralRoll2)+1 |
6194 347e A091 0000 lds r26,(MittelIntegralRoll2)+2 |
6195 3482 B091 0000 lds r27,(MittelIntegralRoll2)+3 |
6196 3486 B7FF sbrs r27,7 |
6197 3488 04C0 rjmp .L470 |
6198 348a 8150 subi r24,lo8(-(255)) |
6199 348c 9F4F sbci r25,hi8(-(255)) |
6200 348e AF4F sbci r26,hlo8(-(255)) |
6201 3490 BF4F sbci r27,hhi8(-(255)) |
6202 .L470: |
6203 3492 892F mov r24,r25 |
6204 3494 9A2F mov r25,r26 |
6205 3496 AB2F mov r26,r27 |
6206 3498 BB27 clr r27 |
6207 349a A7FD sbrc r26,7 |
6208 349c BA95 dec r27 |
6209 349e 8093 0000 sts MittelIntegralRoll2,r24 |
6210 34a2 9093 0000 sts (MittelIntegralRoll2)+1,r25 |
6211 34a6 A093 0000 sts (MittelIntegralRoll2)+2,r26 |
6212 34aa B093 0000 sts (MittelIntegralRoll2)+3,r27 |
6213 34ae 8091 0000 lds r24,IntegralNick |
6214 34b2 9091 0000 lds r25,(IntegralNick)+1 |
6215 34b6 A091 0000 lds r26,(IntegralNick)+2 |
6216 34ba B091 0000 lds r27,(IntegralNick)+3 |
6217 34be 2AA1 ldd r18,Y+34 |
6218 34c0 3BA1 ldd r19,Y+35 |
6219 34c2 4CA1 ldd r20,Y+36 |
6220 34c4 5DA1 ldd r21,Y+37 |
6221 34c6 281B sub r18,r24 |
6222 34c8 390B sbc r19,r25 |
6223 34ca 4A0B sbc r20,r26 |
6224 34cc 5B0B sbc r21,r27 |
6225 34ce 2093 0000 sts tmp_long.1,r18 |
6226 34d2 3093 0000 sts (tmp_long.1)+1,r19 |
6227 34d6 4093 0000 sts (tmp_long.1)+2,r20 |
6228 34da 5093 0000 sts (tmp_long.1)+3,r21 |
6229 34de 8091 0000 lds r24,IntegralRoll |
6230 34e2 9091 0000 lds r25,(IntegralRoll)+1 |
6231 34e6 A091 0000 lds r26,(IntegralRoll)+2 |
6232 34ea B091 0000 lds r27,(IntegralRoll)+3 |
6233 34ee EEA0 ldd r14,Y+38 |
6234 34f0 FFA0 ldd r15,Y+39 |
6235 34f2 08A5 ldd r16,Y+40 |
6236 34f4 19A5 ldd r17,Y+41 |
6237 34f6 E81A sub r14,r24 |
6238 34f8 F90A sbc r15,r25 |
6239 34fa 0A0B sbc r16,r26 |
6240 34fc 1B0B sbc r17,r27 |
6241 34fe E092 0000 sts tmp_long2.2,r14 |
6242 3502 F092 0000 sts (tmp_long2.2)+1,r15 |
6243 3506 0093 0000 sts (tmp_long2.2)+2,r16 |
6244 350a 1093 0000 sts (tmp_long2.2)+3,r17 |
6245 350e 2093 0000 sts IntegralFehlerNick.3,r18 |
6246 3512 3093 0000 sts (IntegralFehlerNick.3)+1,r19 |
6247 3516 4093 0000 sts (IntegralFehlerNick.3)+2,r20 |
6248 351a 5093 0000 sts (IntegralFehlerNick.3)+3,r21 |
6249 351e E092 0000 sts IntegralFehlerRoll.4,r14 |
6250 3522 F092 0000 sts (IntegralFehlerRoll.4)+1,r15 |
6251 3526 0093 0000 sts (IntegralFehlerRoll.4)+2,r16 |
6252 352a 1093 0000 sts (IntegralFehlerRoll.4)+3,r17 |
6253 352e 8091 0000 lds r24,Mess_IntegralNick2 |
6254 3532 9091 0000 lds r25,(Mess_IntegralNick2)+1 |
6255 3536 A091 0000 lds r26,(Mess_IntegralNick2)+2 |
6256 353a B091 0000 lds r27,(Mess_IntegralNick2)+3 |
6257 353e 821B sub r24,r18 |
6258 3540 930B sbc r25,r19 |
6259 3542 A40B sbc r26,r20 |
6260 3544 B50B sbc r27,r21 |
6261 3546 8093 0000 sts Mess_IntegralNick2,r24 |
6262 354a 9093 0000 sts (Mess_IntegralNick2)+1,r25 |
6263 354e A093 0000 sts (Mess_IntegralNick2)+2,r26 |
6264 3552 B093 0000 sts (Mess_IntegralNick2)+3,r27 |
6265 3556 8091 0000 lds r24,Mess_IntegralRoll2 |
6266 355a 9091 0000 lds r25,(Mess_IntegralRoll2)+1 |
6267 355e A091 0000 lds r26,(Mess_IntegralRoll2)+2 |
6268 3562 B091 0000 lds r27,(Mess_IntegralRoll2)+3 |
6269 3566 8E19 sub r24,r14 |
6270 3568 9F09 sbc r25,r15 |
6271 356a A00B sbc r26,r16 |
6272 356c B10B sbc r27,r17 |
6273 356e 8093 0000 sts Mess_IntegralRoll2,r24 |
6274 3572 9093 0000 sts (Mess_IntegralRoll2)+1,r25 |
6275 3576 A093 0000 sts (Mess_IntegralRoll2)+2,r26 |
6276 357a B093 0000 sts (Mess_IntegralRoll2)+3,r27 |
6277 357e FBA5 ldd r31,Y+43 |
6278 3580 FF23 tst r31 |
6279 3582 E1F0 breq .L471 |
6280 3584 2091 0000 lds r18,GierGyroFehler |
6281 3588 3091 0000 lds r19,(GierGyroFehler)+1 |
6282 358c 2138 cpi r18,129 |
6283 358e 3105 cpc r19,__zero_reg__ |
6284 3590 4CF0 brlt .L472 |
6285 3592 8091 0000 lds r24,AdNeutralGier |
6286 3596 9091 0000 lds r25,(AdNeutralGier)+1 |
6287 359a 0196 adiw r24,1 |
6288 359c 9093 0000 sts (AdNeutralGier)+1,r25 |
6289 35a0 8093 0000 sts AdNeutralGier,r24 |
6290 .L472: |
6291 35a4 2058 subi r18,lo8(-128) |
6292 35a6 3F4F sbci r19,hi8(-128) |
6293 35a8 4CF4 brge .L471 |
6294 35aa 8091 0000 lds r24,AdNeutralGier |
6295 35ae 9091 0000 lds r25,(AdNeutralGier)+1 |
6296 35b2 0197 sbiw r24,1 |
6297 35b4 9093 0000 sts (AdNeutralGier)+1,r25 |
6298 35b8 8093 0000 sts AdNeutralGier,r24 |
6299 .L471: |
6300 35bc 1092 0000 sts (GierGyroFehler)+1,__zero_reg__ |
6301 35c0 1092 0000 sts GierGyroFehler,__zero_reg__ |
6302 35c4 81E0 ldi r24,lo8(1) |
6303 35c6 90E0 ldi r25,hi8(1) |
6304 35c8 9093 0000 sts (cnt.15)+1,r25 |
6305 35cc 8093 0000 sts cnt.15,r24 |
6306 35d0 A090 0000 lds r10,IntegralFehlerNick.3 |
6307 35d4 B090 0000 lds r11,(IntegralFehlerNick.3)+1 |
6308 35d8 C090 0000 lds r12,(IntegralFehlerNick.3)+2 |
6309 35dc D090 0000 lds r13,(IntegralFehlerNick.3)+3 |
6310 35e0 D601 movw r26,r12 |
6311 35e2 C501 movw r24,r10 |
6312 35e4 D7FE sbrs r13,7 |
6313 35e6 07C0 rjmp .L475 |
6314 35e8 8827 clr r24 |
6315 35ea 9927 clr r25 |
6316 35ec DC01 movw r26,r24 |
6317 35ee 8A19 sub r24,r10 |
6318 35f0 9B09 sbc r25,r11 |
6319 35f2 AC09 sbc r26,r12 |
6320 35f4 BD09 sbc r27,r13 |
6321 .L475: |
6322 35f6 8150 subi r24,lo8(513) |
6323 35f8 9240 sbci r25,hi8(513) |
6324 35fa A040 sbci r26,hlo8(513) |
6325 35fc B040 sbci r27,hhi8(513) |
6326 35fe 34F0 brlt .L474 |
6327 3600 84E0 ldi r24,lo8(4) |
6328 3602 90E0 ldi r25,hi8(4) |
6329 3604 9093 0000 sts (cnt.15)+1,r25 |
6330 3608 8093 0000 sts cnt.15,r24 |
6331 .L474: |
6332 360c 8091 0000 lds r24,MittelIntegralNick_Alt.20 |
6333 3610 9091 0000 lds r25,(MittelIntegralNick_Alt.20)+1 |
6334 3614 A091 0000 lds r26,(MittelIntegralNick_Alt.20)+2 |
6335 3618 B091 0000 lds r27,(MittelIntegralNick_Alt.20)+3 |
6336 361c 2091 0000 lds r18,MittelIntegralNick |
6337 3620 3091 0000 lds r19,(MittelIntegralNick)+1 |
6338 3624 4091 0000 lds r20,(MittelIntegralNick)+2 |
6339 3628 5091 0000 lds r21,(MittelIntegralNick)+3 |
6340 362c 821B sub r24,r18 |
6341 362e 930B sbc r25,r19 |
6342 3630 A40B sbc r26,r20 |
6343 3632 B50B sbc r27,r21 |
6344 3634 815E subi r24,lo8(-(19999)) |
6345 3636 914B sbci r25,hi8(-(19999)) |
6346 3638 AF4F sbci r26,hlo8(-(19999)) |
6347 363a BF4F sbci r27,hhi8(-(19999)) |
6348 363c 8F53 subi r24,lo8(39999) |
6349 363e 9C49 sbci r25,hi8(39999) |
6350 3640 A040 sbci r26,hlo8(39999) |
6351 3642 B040 sbci r27,hhi8(39999) |
6352 3644 28F0 brlo .L477 |
6353 3646 8091 0000 lds r24,FromNaviCtrl_Value+1 |
6354 364a 8931 cpi r24,lo8(25) |
6355 364c 0CF4 brge .+2 |
6356 364e FFC0 rjmp .L476 |
6357 .L477: |
6358 3650 31E0 ldi r19,lo8(4097) |
6359 3652 A316 cp r10,r19 |
6360 3654 30E1 ldi r19,hi8(4097) |
6361 3656 B306 cpc r11,r19 |
6362 3658 30E0 ldi r19,hlo8(4097) |
6363 365a C306 cpc r12,r19 |
6364 365c 30E0 ldi r19,hhi8(4097) |
6365 365e D306 cpc r13,r19 |
6366 3660 0CF4 brge .+2 |
6367 3662 73C0 rjmp .L478 |
6368 3664 8091 0000 lds r24,last_n_p.16 |
6369 3668 8823 tst r24 |
6370 366a 09F4 brne .+2 |
6371 366c 6AC0 rjmp .L479 |
6372 366e D601 movw r26,r12 |
6373 3670 C501 movw r24,r10 |
6374 3672 D7FE sbrs r13,7 |
6375 3674 07C0 rjmp .L480 |
6376 3676 8827 clr r24 |
6377 3678 9927 clr r25 |
6378 367a DC01 movw r26,r24 |
6379 367c 8A19 sub r24,r10 |
6380 367e 9B09 sbc r25,r11 |
6381 3680 AC09 sbc r26,r12 |
6382 3682 BD09 sbc r27,r13 |
6383 .L480: |
6384 3684 9C01 movw r18,r24 |
6385 3686 AD01 movw r20,r26 |
6386 3688 B7FF sbrs r27,7 |
6387 368a 04C0 rjmp .L481 |
6388 368c 2150 subi r18,lo8(-(511)) |
6389 368e 3E4F sbci r19,hi8(-(511)) |
6390 3690 4F4F sbci r20,hlo8(-(511)) |
6391 3692 5F4F sbci r21,hhi8(-(511)) |
6392 .L481: |
6393 3694 F9E0 ldi r31,9 |
6394 3696 5595 1: asr r21 |
6395 3698 4795 ror r20 |
6396 369a 3795 ror r19 |
6397 369c 2795 ror r18 |
6398 369e FA95 dec r31 |
6399 36a0 D1F7 brne 1b |
6400 36a2 8091 0000 lds r24,cnt.15 |
6401 36a6 9091 0000 lds r25,(cnt.15)+1 |
6402 36aa 820F add r24,r18 |
6403 36ac 931F adc r25,r19 |
6404 36ae 9093 0000 sts (cnt.15)+1,r25 |
6405 36b2 8093 0000 sts cnt.15,r24 |
6406 36b6 D601 movw r26,r12 |
6407 36b8 C501 movw r24,r10 |
6408 36ba D7FE sbrs r13,7 |
6409 36bc 03C0 rjmp .L482 |
6410 36be 0796 adiw r24,7 |
6411 36c0 A11D adc r26,__zero_reg__ |
6412 36c2 B11D adc r27,__zero_reg__ |
6413 .L482: |
6414 36c4 E3E0 ldi r30,3 |
6415 36c6 B595 1: asr r27 |
6416 36c8 A795 ror r26 |
6417 36ca 9795 ror r25 |
6418 36cc 8795 ror r24 |
6419 36ce EA95 dec r30 |
6420 36d0 D1F7 brne 1b |
6421 36d2 8093 0000 sts ausgleichNick.11,r24 |
6422 36d6 9093 0000 sts (ausgleichNick.11)+1,r25 |
6423 36da A093 0000 sts (ausgleichNick.11)+2,r26 |
6424 36de B093 0000 sts (ausgleichNick.11)+3,r27 |
6425 36e2 8958 subi r24,lo8(5001) |
6426 36e4 9341 sbci r25,hi8(5001) |
6427 36e6 A040 sbci r26,hlo8(5001) |
6428 36e8 B040 sbci r27,hhi8(5001) |
6429 36ea 64F0 brlt .L483 |
6430 36ec 88E8 ldi r24,lo8(5000) |
6431 36ee 93E1 ldi r25,hi8(5000) |
6432 36f0 A0E0 ldi r26,hlo8(5000) |
6433 36f2 B0E0 ldi r27,hhi8(5000) |
6434 36f4 8093 0000 sts ausgleichNick.11,r24 |
6435 36f8 9093 0000 sts (ausgleichNick.11)+1,r25 |
6436 36fc A093 0000 sts (ausgleichNick.11)+2,r26 |
6437 3700 B093 0000 sts (ausgleichNick.11)+3,r27 |
6438 .L483: |
6439 3704 2091 0000 lds r18,ausgleichNick.11 |
6440 3708 3091 0000 lds r19,(ausgleichNick.11)+1 |
6441 370c 4091 0000 lds r20,(ausgleichNick.11)+2 |
6442 3710 5091 0000 lds r21,(ausgleichNick.11)+3 |
6443 3714 57FF sbrs r21,7 |
6444 3716 04C0 rjmp .L484 |
6445 3718 2150 subi r18,lo8(-(255)) |
6446 371a 3F4F sbci r19,hi8(-(255)) |
6447 371c 4F4F sbci r20,hlo8(-(255)) |
6448 371e 5F4F sbci r21,hhi8(-(255)) |
6449 .L484: |
6450 3720 232F mov r18,r19 |
6451 3722 342F mov r19,r20 |
6452 3724 452F mov r20,r21 |
6453 3726 5527 clr r21 |
6454 3728 47FD sbrc r20,7 |
6455 372a 5A95 dec r21 |
6456 372c 8091 0000 lds r24,LageKorrekturNick |
6457 3730 9091 0000 lds r25,(LageKorrekturNick)+1 |
6458 3734 820F add r24,r18 |
6459 3736 931F adc r25,r19 |
6460 3738 9093 0000 sts (LageKorrekturNick)+1,r25 |
6461 373c 8093 0000 sts LageKorrekturNick,r24 |
6462 3740 06C0 rjmp .L486 |
6463 .L479: |
6464 3742 81E0 ldi r24,lo8(1) |
6465 3744 8093 0000 sts last_n_p.16,r24 |
6466 3748 02C0 rjmp .L486 |
6467 .L478: |
6468 374a 1092 0000 sts last_n_p.16,__zero_reg__ |
6469 .L486: |
6470 374e 50E0 ldi r21,lo8(-4096) |
6471 3750 A516 cp r10,r21 |
6472 3752 50EF ldi r21,hi8(-4096) |
6473 3754 B506 cpc r11,r21 |
6474 3756 5FEF ldi r21,hlo8(-4096) |
6475 3758 C506 cpc r12,r21 |
6476 375a 5FEF ldi r21,hhi8(-4096) |
6477 375c D506 cpc r13,r21 |
6478 375e 0CF0 brlt .+2 |
6479 3760 73C0 rjmp .L487 |
6480 3762 8091 0000 lds r24,last_n_n.17 |
6481 3766 8823 tst r24 |
6482 3768 09F4 brne .+2 |
6483 376a 6AC0 rjmp .L488 |
6484 376c D601 movw r26,r12 |
6485 376e C501 movw r24,r10 |
6486 3770 D7FE sbrs r13,7 |
6487 3772 07C0 rjmp .L489 |
6488 3774 8827 clr r24 |
6489 3776 9927 clr r25 |
6490 3778 DC01 movw r26,r24 |
6491 377a 8A19 sub r24,r10 |
6492 377c 9B09 sbc r25,r11 |
6493 377e AC09 sbc r26,r12 |
6494 3780 BD09 sbc r27,r13 |
6495 .L489: |
6496 3782 9C01 movw r18,r24 |
6497 3784 AD01 movw r20,r26 |
6498 3786 B7FF sbrs r27,7 |
6499 3788 04C0 rjmp .L490 |
6500 378a 2150 subi r18,lo8(-(511)) |
6501 378c 3E4F sbci r19,hi8(-(511)) |
6502 378e 4F4F sbci r20,hlo8(-(511)) |
6503 3790 5F4F sbci r21,hhi8(-(511)) |
6504 .L490: |
6505 3792 69E0 ldi r22,9 |
6506 3794 5595 1: asr r21 |
6507 3796 4795 ror r20 |
6508 3798 3795 ror r19 |
6509 379a 2795 ror r18 |
6510 379c 6A95 dec r22 |
6511 379e D1F7 brne 1b |
6512 37a0 8091 0000 lds r24,cnt.15 |
6513 37a4 9091 0000 lds r25,(cnt.15)+1 |
6514 37a8 820F add r24,r18 |
6515 37aa 931F adc r25,r19 |
6516 37ac 9093 0000 sts (cnt.15)+1,r25 |
6517 37b0 8093 0000 sts cnt.15,r24 |
6518 37b4 D601 movw r26,r12 |
6519 37b6 C501 movw r24,r10 |
6520 37b8 D7FE sbrs r13,7 |
6521 37ba 03C0 rjmp .L491 |
6522 37bc 0796 adiw r24,7 |
6523 37be A11D adc r26,__zero_reg__ |
6524 37c0 B11D adc r27,__zero_reg__ |
6525 .L491: |
6526 37c2 23E0 ldi r18,3 |
6527 37c4 B595 1: asr r27 |
6528 37c6 A795 ror r26 |
6529 37c8 9795 ror r25 |
6530 37ca 8795 ror r24 |
6531 37cc 2A95 dec r18 |
6532 37ce D1F7 brne 1b |
6533 37d0 8093 0000 sts ausgleichNick.11,r24 |
6534 37d4 9093 0000 sts (ausgleichNick.11)+1,r25 |
6535 37d8 A093 0000 sts (ausgleichNick.11)+2,r26 |
6536 37dc B093 0000 sts (ausgleichNick.11)+3,r27 |
6537 37e0 8857 subi r24,lo8(-5000) |
6538 37e2 9C4E sbci r25,hi8(-5000) |
6539 37e4 AF4F sbci r26,hlo8(-5000) |
6540 37e6 BF4F sbci r27,hhi8(-5000) |
6541 37e8 64F4 brge .L492 |
6542 37ea 88E7 ldi r24,lo8(-5000) |
6543 37ec 9CEE ldi r25,hi8(-5000) |
6544 37ee AFEF ldi r26,hlo8(-5000) |
6545 37f0 BFEF ldi r27,hhi8(-5000) |
6546 37f2 8093 0000 sts ausgleichNick.11,r24 |
6547 37f6 9093 0000 sts (ausgleichNick.11)+1,r25 |
6548 37fa A093 0000 sts (ausgleichNick.11)+2,r26 |
6549 37fe B093 0000 sts (ausgleichNick.11)+3,r27 |
6550 .L492: |
6551 3802 2091 0000 lds r18,ausgleichNick.11 |
6552 3806 3091 0000 lds r19,(ausgleichNick.11)+1 |
6553 380a 4091 0000 lds r20,(ausgleichNick.11)+2 |
6554 380e 5091 0000 lds r21,(ausgleichNick.11)+3 |
6555 3812 57FF sbrs r21,7 |
6556 3814 04C0 rjmp .L493 |
6557 3816 2150 subi r18,lo8(-(255)) |
6558 3818 3F4F sbci r19,hi8(-(255)) |
6559 381a 4F4F sbci r20,hlo8(-(255)) |
6560 381c 5F4F sbci r21,hhi8(-(255)) |
6561 .L493: |
6562 381e 232F mov r18,r19 |
6563 3820 342F mov r19,r20 |
6564 3822 452F mov r20,r21 |
6565 3824 5527 clr r21 |
6566 3826 47FD sbrc r20,7 |
6567 3828 5A95 dec r21 |
6568 382a 8091 0000 lds r24,LageKorrekturNick |
6569 382e 9091 0000 lds r25,(LageKorrekturNick)+1 |
6570 3832 820F add r24,r18 |
6571 3834 931F adc r25,r19 |
6572 3836 9093 0000 sts (LageKorrekturNick)+1,r25 |
6573 383a 8093 0000 sts LageKorrekturNick,r24 |
6574 383e 11C0 rjmp .L496 |
6575 .L488: |
6576 3840 81E0 ldi r24,lo8(1) |
6577 3842 8093 0000 sts last_n_n.17,r24 |
6578 3846 0DC0 rjmp .L496 |
6579 .L487: |
6580 3848 1092 0000 sts last_n_n.17,__zero_reg__ |
6581 384c 0AC0 rjmp .L496 |
6582 .L476: |
6583 384e 1092 0000 sts (cnt.15)+1,__zero_reg__ |
6584 3852 1092 0000 sts cnt.15,__zero_reg__ |
6585 3856 88EE ldi r24,lo8(1000) |
6586 3858 93E0 ldi r25,hi8(1000) |
6587 385a 9093 0000 sts (KompassSignalSchlecht)+1,r25 |
6588 385e 8093 0000 sts KompassSignalSchlecht,r24 |
6589 .L496: |
6590 3862 7BA5 ldd r23,Y+43 |
6591 3864 272F mov r18,r23 |
6592 3866 3327 clr r19 |
6593 3868 8091 0000 lds r24,cnt.15 |
6594 386c 9091 0000 lds r25,(cnt.15)+1 |
6595 3870 2817 cp r18,r24 |
6596 3872 3907 cpc r19,r25 |
6597 3874 24F4 brge .L497 |
6598 3876 3093 0000 sts (cnt.15)+1,r19 |
6599 387a 2093 0000 sts cnt.15,r18 |
6600 .L497: |
6601 387e E091 0000 lds r30,FromNaviCtrl_Value+1 |
6602 3882 EE23 tst r30 |
6603 3884 79F0 breq .L498 |
6604 3886 2E2F mov r18,r30 |
6605 3888 3327 clr r19 |
6606 388a 27FD sbrc r18,7 |
6607 388c 3095 com r19 |
6608 388e 8091 0000 lds r24,cnt.15 |
6609 3892 9091 0000 lds r25,(cnt.15)+1 |
6610 3896 2817 cp r18,r24 |
6611 3898 3907 cpc r19,r25 |
6612 389a 24F4 brge .L498 |
6613 389c 3093 0000 sts (cnt.15)+1,r19 |
6614 38a0 2093 0000 sts cnt.15,r18 |
6615 .L498: |
6616 38a4 4091 0000 lds r20,IntegralFehlerNick.3 |
6617 38a8 5091 0000 lds r21,(IntegralFehlerNick.3)+1 |
6618 38ac 6091 0000 lds r22,(IntegralFehlerNick.3)+2 |
6619 38b0 7091 0000 lds r23,(IntegralFehlerNick.3)+3 |
6620 38b4 4138 cpi r20,lo8(129) |
6621 38b6 5105 cpc r21,__zero_reg__ |
6622 38b8 6105 cpc r22,__zero_reg__ |
6623 38ba 7105 cpc r23,__zero_reg__ |
6624 38bc 74F0 brlt .L500 |
6625 38be 8091 0000 lds r24,AdNeutralNick |
6626 38c2 9091 0000 lds r25,(AdNeutralNick)+1 |
6627 38c6 2091 0000 lds r18,cnt.15 |
6628 38ca 3091 0000 lds r19,(cnt.15)+1 |
6629 38ce 820F add r24,r18 |
6630 38d0 931F adc r25,r19 |
6631 38d2 9093 0000 sts (AdNeutralNick)+1,r25 |
6632 38d6 8093 0000 sts AdNeutralNick,r24 |
6633 .L500: |
6634 38da 4058 subi r20,lo8(-128) |
6635 38dc 5F4F sbci r21,hi8(-128) |
6636 38de 6F4F sbci r22,hlo8(-128) |
6637 38e0 7F4F sbci r23,hhi8(-128) |
6638 38e2 74F4 brge .L501 |
6639 38e4 8091 0000 lds r24,AdNeutralNick |
6640 38e8 9091 0000 lds r25,(AdNeutralNick)+1 |
6641 38ec 2091 0000 lds r18,cnt.15 |
6642 38f0 3091 0000 lds r19,(cnt.15)+1 |
6643 38f4 821B sub r24,r18 |
6644 38f6 930B sbc r25,r19 |
6645 38f8 9093 0000 sts (AdNeutralNick)+1,r25 |
6646 38fc 8093 0000 sts AdNeutralNick,r24 |
6647 .L501: |
6648 3900 81E0 ldi r24,lo8(1) |
6649 3902 90E0 ldi r25,hi8(1) |
6650 3904 9093 0000 sts (cnt.15)+1,r25 |
6651 3908 8093 0000 sts cnt.15,r24 |
6652 390c A090 0000 lds r10,IntegralFehlerRoll.4 |
6653 3910 B090 0000 lds r11,(IntegralFehlerRoll.4)+1 |
6654 3914 C090 0000 lds r12,(IntegralFehlerRoll.4)+2 |
6655 3918 D090 0000 lds r13,(IntegralFehlerRoll.4)+3 |
6656 391c D601 movw r26,r12 |
6657 391e C501 movw r24,r10 |
6658 3920 D7FE sbrs r13,7 |
6659 3922 07C0 rjmp .L503 |
6660 3924 8827 clr r24 |
6661 3926 9927 clr r25 |
6662 3928 DC01 movw r26,r24 |
6663 392a 8A19 sub r24,r10 |
6664 392c 9B09 sbc r25,r11 |
6665 392e AC09 sbc r26,r12 |
6666 3930 BD09 sbc r27,r13 |
6667 .L503: |
6668 3932 8150 subi r24,lo8(513) |
6669 3934 9240 sbci r25,hi8(513) |
6670 3936 A040 sbci r26,hlo8(513) |
6671 3938 B040 sbci r27,hhi8(513) |
6672 393a 34F0 brlt .L502 |
6673 393c 84E0 ldi r24,lo8(4) |
6674 393e 90E0 ldi r25,hi8(4) |
6675 3940 9093 0000 sts (cnt.15)+1,r25 |
6676 3944 8093 0000 sts cnt.15,r24 |
6677 .L502: |
6678 3948 8091 0000 lds r24,MittelIntegralRoll_Alt.21 |
6679 394c 9091 0000 lds r25,(MittelIntegralRoll_Alt.21)+1 |
6680 3950 A091 0000 lds r26,(MittelIntegralRoll_Alt.21)+2 |
6681 3954 B091 0000 lds r27,(MittelIntegralRoll_Alt.21)+3 |
6682 3958 2091 0000 lds r18,MittelIntegralRoll |
6683 395c 3091 0000 lds r19,(MittelIntegralRoll)+1 |
6684 3960 4091 0000 lds r20,(MittelIntegralRoll)+2 |
6685 3964 5091 0000 lds r21,(MittelIntegralRoll)+3 |
6686 3968 821B sub r24,r18 |
6687 396a 930B sbc r25,r19 |
6688 396c A40B sbc r26,r20 |
6689 396e B50B sbc r27,r21 |
6690 3970 815E subi r24,lo8(-(19999)) |
6691 3972 914B sbci r25,hi8(-(19999)) |
6692 3974 AF4F sbci r26,hlo8(-(19999)) |
6693 3976 BF4F sbci r27,hhi8(-(19999)) |
6694 3978 8F53 subi r24,lo8(39999) |
6695 397a 9C49 sbci r25,hi8(39999) |
6696 397c A040 sbci r26,hlo8(39999) |
6697 397e B040 sbci r27,hhi8(39999) |
6698 3980 18F0 brlo .L505 |
6699 3982 E931 cpi r30,lo8(25) |
6700 3984 0CF4 brge .+2 |
6701 3986 FFC0 rjmp .L504 |
6702 .L505: |
6703 3988 11E0 ldi r17,lo8(4097) |
6704 398a A116 cp r10,r17 |
6705 398c 10E1 ldi r17,hi8(4097) |
6706 398e B106 cpc r11,r17 |
6707 3990 10E0 ldi r17,hlo8(4097) |
6708 3992 C106 cpc r12,r17 |
6709 3994 10E0 ldi r17,hhi8(4097) |
6710 3996 D106 cpc r13,r17 |
6711 3998 0CF4 brge .+2 |
6712 399a 73C0 rjmp .L506 |
6713 399c 8091 0000 lds r24,last_r_p.18 |
6714 39a0 8823 tst r24 |
6715 39a2 09F4 brne .+2 |
6716 39a4 6AC0 rjmp .L507 |
6717 39a6 D601 movw r26,r12 |
6718 39a8 C501 movw r24,r10 |
6719 39aa D7FE sbrs r13,7 |
6720 39ac 07C0 rjmp .L508 |
6721 39ae 8827 clr r24 |
6722 39b0 9927 clr r25 |
6723 39b2 DC01 movw r26,r24 |
6724 39b4 8A19 sub r24,r10 |
6725 39b6 9B09 sbc r25,r11 |
6726 39b8 AC09 sbc r26,r12 |
6727 39ba BD09 sbc r27,r13 |
6728 .L508: |
6729 39bc 9C01 movw r18,r24 |
6730 39be AD01 movw r20,r26 |
6731 39c0 B7FF sbrs r27,7 |
6732 39c2 04C0 rjmp .L509 |
6733 39c4 2150 subi r18,lo8(-(511)) |
6734 39c6 3E4F sbci r19,hi8(-(511)) |
6735 39c8 4F4F sbci r20,hlo8(-(511)) |
6736 39ca 5F4F sbci r21,hhi8(-(511)) |
6737 .L509: |
6738 39cc 09E0 ldi r16,9 |
6739 39ce 5595 1: asr r21 |
6740 39d0 4795 ror r20 |
6741 39d2 3795 ror r19 |
6742 39d4 2795 ror r18 |
6743 39d6 0A95 dec r16 |
6744 39d8 D1F7 brne 1b |
6745 39da 8091 0000 lds r24,cnt.15 |
6746 39de 9091 0000 lds r25,(cnt.15)+1 |
6747 39e2 820F add r24,r18 |
6748 39e4 931F adc r25,r19 |
6749 39e6 9093 0000 sts (cnt.15)+1,r25 |
6750 39ea 8093 0000 sts cnt.15,r24 |
6751 39ee D601 movw r26,r12 |
6752 39f0 C501 movw r24,r10 |
6753 39f2 D7FE sbrs r13,7 |
6754 39f4 03C0 rjmp .L510 |
6755 39f6 0796 adiw r24,7 |
6756 39f8 A11D adc r26,__zero_reg__ |
6757 39fa B11D adc r27,__zero_reg__ |
6758 .L510: |
6759 39fc 13E0 ldi r17,3 |
6760 39fe B595 1: asr r27 |
6761 3a00 A795 ror r26 |
6762 3a02 9795 ror r25 |
6763 3a04 8795 ror r24 |
6764 3a06 1A95 dec r17 |
6765 3a08 D1F7 brne 1b |
6766 3a0a 8093 0000 sts ausgleichRoll.12,r24 |
6767 3a0e 9093 0000 sts (ausgleichRoll.12)+1,r25 |
6768 3a12 A093 0000 sts (ausgleichRoll.12)+2,r26 |
6769 3a16 B093 0000 sts (ausgleichRoll.12)+3,r27 |
6770 3a1a 8958 subi r24,lo8(5001) |
6771 3a1c 9341 sbci r25,hi8(5001) |
6772 3a1e A040 sbci r26,hlo8(5001) |
6773 3a20 B040 sbci r27,hhi8(5001) |
6774 3a22 64F0 brlt .L511 |
6775 3a24 88E8 ldi r24,lo8(5000) |
6776 3a26 93E1 ldi r25,hi8(5000) |
6777 3a28 A0E0 ldi r26,hlo8(5000) |
6778 3a2a B0E0 ldi r27,hhi8(5000) |
6779 3a2c 8093 0000 sts ausgleichRoll.12,r24 |
6780 3a30 9093 0000 sts (ausgleichRoll.12)+1,r25 |
6781 3a34 A093 0000 sts (ausgleichRoll.12)+2,r26 |
6782 3a38 B093 0000 sts (ausgleichRoll.12)+3,r27 |
6783 .L511: |
6784 3a3c 2091 0000 lds r18,ausgleichRoll.12 |
6785 3a40 3091 0000 lds r19,(ausgleichRoll.12)+1 |
6786 3a44 4091 0000 lds r20,(ausgleichRoll.12)+2 |
6787 3a48 5091 0000 lds r21,(ausgleichRoll.12)+3 |
6788 3a4c 57FF sbrs r21,7 |
6789 3a4e 04C0 rjmp .L512 |
6790 3a50 2150 subi r18,lo8(-(255)) |
6791 3a52 3F4F sbci r19,hi8(-(255)) |
6792 3a54 4F4F sbci r20,hlo8(-(255)) |
6793 3a56 5F4F sbci r21,hhi8(-(255)) |
6794 .L512: |
6795 3a58 232F mov r18,r19 |
6796 3a5a 342F mov r19,r20 |
6797 3a5c 452F mov r20,r21 |
6798 3a5e 5527 clr r21 |
6799 3a60 47FD sbrc r20,7 |
6800 3a62 5A95 dec r21 |
6801 3a64 8091 0000 lds r24,LageKorrekturRoll |
6802 3a68 9091 0000 lds r25,(LageKorrekturRoll)+1 |
6803 3a6c 820F add r24,r18 |
6804 3a6e 931F adc r25,r19 |
6805 3a70 9093 0000 sts (LageKorrekturRoll)+1,r25 |
6806 3a74 8093 0000 sts LageKorrekturRoll,r24 |
6807 3a78 06C0 rjmp .L514 |
6808 .L507: |
6809 3a7a 81E0 ldi r24,lo8(1) |
6810 3a7c 8093 0000 sts last_r_p.18,r24 |
6811 3a80 02C0 rjmp .L514 |
6812 .L506: |
6813 3a82 1092 0000 sts last_r_p.18,__zero_reg__ |
6814 .L514: |
6815 3a86 30E0 ldi r19,lo8(-4096) |
6816 3a88 A316 cp r10,r19 |
6817 3a8a 30EF ldi r19,hi8(-4096) |
6818 3a8c B306 cpc r11,r19 |
6819 3a8e 3FEF ldi r19,hlo8(-4096) |
6820 3a90 C306 cpc r12,r19 |
6821 3a92 3FEF ldi r19,hhi8(-4096) |
6822 3a94 D306 cpc r13,r19 |
6823 3a96 0CF0 brlt .+2 |
6824 3a98 73C0 rjmp .L515 |
6825 3a9a 8091 0000 lds r24,last_r_n.19 |
6826 3a9e 8823 tst r24 |
6827 3aa0 09F4 brne .+2 |
6828 3aa2 6AC0 rjmp .L516 |
6829 3aa4 D601 movw r26,r12 |
6830 3aa6 C501 movw r24,r10 |
6831 3aa8 D7FE sbrs r13,7 |
6832 3aaa 07C0 rjmp .L517 |
6833 3aac 8827 clr r24 |
6834 3aae 9927 clr r25 |
6835 3ab0 DC01 movw r26,r24 |
6836 3ab2 8A19 sub r24,r10 |
6837 3ab4 9B09 sbc r25,r11 |
6838 3ab6 AC09 sbc r26,r12 |
6839 3ab8 BD09 sbc r27,r13 |
6840 .L517: |
6841 3aba 9C01 movw r18,r24 |
6842 3abc AD01 movw r20,r26 |
6843 3abe B7FF sbrs r27,7 |
6844 3ac0 04C0 rjmp .L518 |
6845 3ac2 2150 subi r18,lo8(-(511)) |
6846 3ac4 3E4F sbci r19,hi8(-(511)) |
6847 3ac6 4F4F sbci r20,hlo8(-(511)) |
6848 3ac8 5F4F sbci r21,hhi8(-(511)) |
6849 .L518: |
6850 3aca E9E0 ldi r30,9 |
6851 3acc 5595 1: asr r21 |
6852 3ace 4795 ror r20 |
6853 3ad0 3795 ror r19 |
6854 3ad2 2795 ror r18 |
6855 3ad4 EA95 dec r30 |
6856 3ad6 D1F7 brne 1b |
6857 3ad8 8091 0000 lds r24,cnt.15 |
6858 3adc 9091 0000 lds r25,(cnt.15)+1 |
6859 3ae0 820F add r24,r18 |
6860 3ae2 931F adc r25,r19 |
6861 3ae4 9093 0000 sts (cnt.15)+1,r25 |
6862 3ae8 8093 0000 sts cnt.15,r24 |
6863 3aec D601 movw r26,r12 |
6864 3aee C501 movw r24,r10 |
6865 3af0 D7FE sbrs r13,7 |
6866 3af2 03C0 rjmp .L519 |
6867 3af4 0796 adiw r24,7 |
6868 3af6 A11D adc r26,__zero_reg__ |
6869 3af8 B11D adc r27,__zero_reg__ |
6870 .L519: |
6871 3afa 73E0 ldi r23,3 |
6872 3afc B595 1: asr r27 |
6873 3afe A795 ror r26 |
6874 3b00 9795 ror r25 |
6875 3b02 8795 ror r24 |
6876 3b04 7A95 dec r23 |
6877 3b06 D1F7 brne 1b |
6878 3b08 8093 0000 sts ausgleichRoll.12,r24 |
6879 3b0c 9093 0000 sts (ausgleichRoll.12)+1,r25 |
6880 3b10 A093 0000 sts (ausgleichRoll.12)+2,r26 |
6881 3b14 B093 0000 sts (ausgleichRoll.12)+3,r27 |
6882 3b18 8857 subi r24,lo8(-5000) |
6883 3b1a 9C4E sbci r25,hi8(-5000) |
6884 3b1c AF4F sbci r26,hlo8(-5000) |
6885 3b1e BF4F sbci r27,hhi8(-5000) |
6886 3b20 64F4 brge .L520 |
6887 3b22 88E7 ldi r24,lo8(-5000) |
6888 3b24 9CEE ldi r25,hi8(-5000) |
6889 3b26 AFEF ldi r26,hlo8(-5000) |
6890 3b28 BFEF ldi r27,hhi8(-5000) |
6891 3b2a 8093 0000 sts ausgleichRoll.12,r24 |
6892 3b2e 9093 0000 sts (ausgleichRoll.12)+1,r25 |
6893 3b32 A093 0000 sts (ausgleichRoll.12)+2,r26 |
6894 3b36 B093 0000 sts (ausgleichRoll.12)+3,r27 |
6895 .L520: |
6896 3b3a 2091 0000 lds r18,ausgleichRoll.12 |
6897 3b3e 3091 0000 lds r19,(ausgleichRoll.12)+1 |
6898 3b42 4091 0000 lds r20,(ausgleichRoll.12)+2 |
6899 3b46 5091 0000 lds r21,(ausgleichRoll.12)+3 |
6900 3b4a 57FF sbrs r21,7 |
6901 3b4c 04C0 rjmp .L521 |
6902 3b4e 2150 subi r18,lo8(-(255)) |
6903 3b50 3F4F sbci r19,hi8(-(255)) |
6904 3b52 4F4F sbci r20,hlo8(-(255)) |
6905 3b54 5F4F sbci r21,hhi8(-(255)) |
6906 .L521: |
6907 3b56 232F mov r18,r19 |
6908 3b58 342F mov r19,r20 |
6909 3b5a 452F mov r20,r21 |
6910 3b5c 5527 clr r21 |
6911 3b5e 47FD sbrc r20,7 |
6912 3b60 5A95 dec r21 |
6913 3b62 8091 0000 lds r24,LageKorrekturRoll |
6914 3b66 9091 0000 lds r25,(LageKorrekturRoll)+1 |
6915 3b6a 820F add r24,r18 |
6916 3b6c 931F adc r25,r19 |
6917 3b6e 9093 0000 sts (LageKorrekturRoll)+1,r25 |
6918 3b72 8093 0000 sts LageKorrekturRoll,r24 |
6919 3b76 11C0 rjmp .L524 |
6920 .L516: |
6921 3b78 81E0 ldi r24,lo8(1) |
6922 3b7a 8093 0000 sts last_r_n.19,r24 |
6923 3b7e 0DC0 rjmp .L524 |
6924 .L515: |
6925 3b80 1092 0000 sts last_r_n.19,__zero_reg__ |
6926 3b84 0AC0 rjmp .L524 |
6927 .L504: |
6928 3b86 1092 0000 sts (cnt.15)+1,__zero_reg__ |
6929 3b8a 1092 0000 sts cnt.15,__zero_reg__ |
6930 3b8e 88EE ldi r24,lo8(1000) |
6931 3b90 93E0 ldi r25,hi8(1000) |
6932 3b92 9093 0000 sts (KompassSignalSchlecht)+1,r25 |
6933 3b96 8093 0000 sts KompassSignalSchlecht,r24 |
6934 .L524: |
6935 3b9a 5BA5 ldd r21,Y+43 |
6936 3b9c 252F mov r18,r21 |
6937 3b9e 3327 clr r19 |
6938 3ba0 8091 0000 lds r24,cnt.15 |
6939 3ba4 9091 0000 lds r25,(cnt.15)+1 |
6940 3ba8 2817 cp r18,r24 |
6941 3baa 3907 cpc r19,r25 |
6942 3bac 24F4 brge .L525 |
6943 3bae 3093 0000 sts (cnt.15)+1,r19 |
6944 3bb2 2093 0000 sts cnt.15,r18 |
6945 .L525: |
6946 3bb6 8091 0000 lds r24,FromNaviCtrl_Value+1 |
6947 3bba 8823 tst r24 |
6948 3bbc 79F0 breq .L526 |
6949 3bbe 282F mov r18,r24 |
6950 3bc0 3327 clr r19 |
6951 3bc2 27FD sbrc r18,7 |
6952 3bc4 3095 com r19 |
6953 3bc6 8091 0000 lds r24,cnt.15 |
6954 3bca 9091 0000 lds r25,(cnt.15)+1 |
6955 3bce 2817 cp r18,r24 |
6956 3bd0 3907 cpc r19,r25 |
6957 3bd2 24F4 brge .L526 |
6958 3bd4 3093 0000 sts (cnt.15)+1,r19 |
6959 3bd8 2093 0000 sts cnt.15,r18 |
6960 .L526: |
6961 3bdc 4091 0000 lds r20,IntegralFehlerRoll.4 |
6962 3be0 5091 0000 lds r21,(IntegralFehlerRoll.4)+1 |
6963 3be4 6091 0000 lds r22,(IntegralFehlerRoll.4)+2 |
6964 3be8 7091 0000 lds r23,(IntegralFehlerRoll.4)+3 |
6965 3bec 4138 cpi r20,lo8(129) |
6966 3bee 5105 cpc r21,__zero_reg__ |
6967 3bf0 6105 cpc r22,__zero_reg__ |
6968 3bf2 7105 cpc r23,__zero_reg__ |
6969 3bf4 74F0 brlt .L528 |
6970 3bf6 8091 0000 lds r24,AdNeutralRoll |
6971 3bfa 9091 0000 lds r25,(AdNeutralRoll)+1 |
6972 3bfe 2091 0000 lds r18,cnt.15 |
6973 3c02 3091 0000 lds r19,(cnt.15)+1 |
6974 3c06 820F add r24,r18 |
6975 3c08 931F adc r25,r19 |
6976 3c0a 9093 0000 sts (AdNeutralRoll)+1,r25 |
6977 3c0e 8093 0000 sts AdNeutralRoll,r24 |
6978 .L528: |
6979 3c12 4058 subi r20,lo8(-128) |
6980 3c14 5F4F sbci r21,hi8(-128) |
6981 3c16 6F4F sbci r22,hlo8(-128) |
6982 3c18 7F4F sbci r23,hhi8(-128) |
6983 3c1a CCF4 brge .L530 |
6984 3c1c 8091 0000 lds r24,AdNeutralRoll |
6985 3c20 9091 0000 lds r25,(AdNeutralRoll)+1 |
6986 3c24 2091 0000 lds r18,cnt.15 |
6987 3c28 3091 0000 lds r19,(cnt.15)+1 |
6988 3c2c 821B sub r24,r18 |
6989 3c2e 930B sbc r25,r19 |
6990 3c30 9093 0000 sts (AdNeutralRoll)+1,r25 |
6991 3c34 8093 0000 sts AdNeutralRoll,r24 |
6992 3c38 0AC0 rjmp .L530 |
6993 .L456: |
6994 3c3a 1092 0000 sts (LageKorrekturRoll)+1,__zero_reg__ |
6995 3c3e 1092 0000 sts LageKorrekturRoll,__zero_reg__ |
6996 3c42 1092 0000 sts (LageKorrekturNick)+1,__zero_reg__ |
6997 3c46 1092 0000 sts LageKorrekturNick,__zero_reg__ |
6998 3c4a 1092 0000 sts TrichterFlug,__zero_reg__ |
6999 .L530: |
7000 3c4e 8091 0000 lds r24,IntegralFaktor |
7001 3c52 8823 tst r24 |
7002 3c54 41F4 brne .L531 |
7003 3c56 1092 0000 sts (LageKorrekturRoll)+1,__zero_reg__ |
7004 3c5a 1092 0000 sts LageKorrekturRoll,__zero_reg__ |
7005 3c5e 1092 0000 sts (LageKorrekturNick)+1,__zero_reg__ |
7006 3c62 1092 0000 sts LageKorrekturNick,__zero_reg__ |
7007 .L531: |
7008 3c66 8091 0000 lds r24,MittelIntegralNick |
7009 3c6a 9091 0000 lds r25,(MittelIntegralNick)+1 |
7010 3c6e A091 0000 lds r26,(MittelIntegralNick)+2 |
7011 3c72 B091 0000 lds r27,(MittelIntegralNick)+3 |
7012 3c76 8093 0000 sts MittelIntegralNick_Alt.20,r24 |
7013 3c7a 9093 0000 sts (MittelIntegralNick_Alt.20)+1,r25 |
7014 3c7e A093 0000 sts (MittelIntegralNick_Alt.20)+2,r26 |
7015 3c82 B093 0000 sts (MittelIntegralNick_Alt.20)+3,r27 |
7016 3c86 8091 0000 lds r24,MittelIntegralRoll |
7017 3c8a 9091 0000 lds r25,(MittelIntegralRoll)+1 |
7018 3c8e A091 0000 lds r26,(MittelIntegralRoll)+2 |
7019 3c92 B091 0000 lds r27,(MittelIntegralRoll)+3 |
7020 3c96 8093 0000 sts MittelIntegralRoll_Alt.21,r24 |
7021 3c9a 9093 0000 sts (MittelIntegralRoll_Alt.21)+1,r25 |
7022 3c9e A093 0000 sts (MittelIntegralRoll_Alt.21)+2,r26 |
7023 3ca2 B093 0000 sts (MittelIntegralRoll_Alt.21)+3,r27 |
7024 3ca6 1092 0000 sts IntegralAccNick,__zero_reg__ |
7025 3caa 1092 0000 sts (IntegralAccNick)+1,__zero_reg__ |
7026 3cae 1092 0000 sts (IntegralAccNick)+2,__zero_reg__ |
7027 3cb2 1092 0000 sts (IntegralAccNick)+3,__zero_reg__ |
7028 3cb6 1092 0000 sts IntegralAccRoll,__zero_reg__ |
7029 3cba 1092 0000 sts (IntegralAccRoll)+1,__zero_reg__ |
7030 3cbe 1092 0000 sts (IntegralAccRoll)+2,__zero_reg__ |
7031 3cc2 1092 0000 sts (IntegralAccRoll)+3,__zero_reg__ |
7032 3cc6 1092 0000 sts IntegralAccZ,__zero_reg__ |
7033 3cca 1092 0000 sts (IntegralAccZ)+1,__zero_reg__ |
7034 3cce 1092 0000 sts (IntegralAccZ)+2,__zero_reg__ |
7035 3cd2 1092 0000 sts (IntegralAccZ)+3,__zero_reg__ |
7036 3cd6 1092 0000 sts MittelIntegralNick,__zero_reg__ |
7037 3cda 1092 0000 sts (MittelIntegralNick)+1,__zero_reg__ |
7038 3cde 1092 0000 sts (MittelIntegralNick)+2,__zero_reg__ |
7039 3ce2 1092 0000 sts (MittelIntegralNick)+3,__zero_reg__ |
7040 3ce6 1092 0000 sts MittelIntegralRoll,__zero_reg__ |
7041 3cea 1092 0000 sts (MittelIntegralRoll)+1,__zero_reg__ |
7042 3cee 1092 0000 sts (MittelIntegralRoll)+2,__zero_reg__ |
7043 3cf2 1092 0000 sts (MittelIntegralRoll)+3,__zero_reg__ |
7044 3cf6 1092 0000 sts MittelIntegralNick2,__zero_reg__ |
7045 3cfa 1092 0000 sts (MittelIntegralNick2)+1,__zero_reg__ |
7046 3cfe 1092 0000 sts (MittelIntegralNick2)+2,__zero_reg__ |
7047 3d02 1092 0000 sts (MittelIntegralNick2)+3,__zero_reg__ |
7048 3d06 1092 0000 sts MittelIntegralRoll2,__zero_reg__ |
7049 3d0a 1092 0000 sts (MittelIntegralRoll2)+1,__zero_reg__ |
7050 3d0e 1092 0000 sts (MittelIntegralRoll2)+2,__zero_reg__ |
7051 3d12 1092 0000 sts (MittelIntegralRoll2)+3,__zero_reg__ |
7052 3d16 1092 0000 sts (ZaehlMessungen)+1,__zero_reg__ |
7053 3d1a 1092 0000 sts ZaehlMessungen,__zero_reg__ |
7054 .L455: |
7055 3d1e 0091 0000 lds r16,StickGier |
7056 3d22 1091 0000 lds r17,(StickGier)+1 |
7057 3d26 C801 movw r24,r16 |
7058 3d28 17FF sbrs r17,7 |
7059 3d2a 04C0 rjmp .L533 |
7060 3d2c 8827 clr r24 |
7061 3d2e 9927 clr r25 |
7062 3d30 801B sub r24,r16 |
7063 3d32 910B sbc r25,r17 |
7064 .L533: |
7065 3d34 4097 sbiw r24,16 |
7066 3d36 6CF0 brlt .L532 |
7067 3d38 88EE ldi r24,lo8(1000) |
7068 3d3a 93E0 ldi r25,hi8(1000) |
7069 3d3c 9093 0000 sts (KompassSignalSchlecht)+1,r25 |
7070 3d40 8093 0000 sts KompassSignalSchlecht,r24 |
7071 3d44 8091 0000 lds r24,EE_Parameter+13 |
7072 3d48 84FD sbrc r24,4 |
7073 3d4a 03C0 rjmp .L532 |
7074 3d4c 81E0 ldi r24,lo8(1) |
7075 3d4e 8093 0000 sts NeueKompassRichtungMerken.10,r24 |
7076 .L532: |
7077 3d52 F090 0000 lds r15,EE_Parameter+25 |
7078 3d56 AF2C mov r10,r15 |
7079 3d58 BB24 clr r11 |
7080 3d5a CC24 clr r12 |
7081 3d5c DD24 clr r13 |
7082 3d5e B801 movw r22,r16 |
7083 3d60 8827 clr r24 |
7084 3d62 77FD sbrc r23,7 |
7085 3d64 8095 com r24 |
7086 3d66 982F mov r25,r24 |
7087 3d68 9801 movw r18,r16 |
7088 3d6a 17FF sbrs r17,7 |
7089 3d6c 04C0 rjmp .L535 |
7090 3d6e 2227 clr r18 |
7091 3d70 3327 clr r19 |
7092 3d72 201B sub r18,r16 |
7093 3d74 310B sbc r19,r17 |
7094 .L535: |
7095 3d76 4427 clr r20 |
7096 3d78 37FD sbrc r19,7 |
7097 3d7a 4095 com r20 |
7098 3d7c 542F mov r21,r20 |
7099 3d7e 0E94 0000 call __mulsi3 |
7100 3d82 9B01 movw r18,r22 |
7101 3d84 AC01 movw r20,r24 |
7102 3d86 C601 movw r24,r12 |
7103 3d88 B501 movw r22,r10 |
7104 3d8a 0E94 0000 call __mulsi3 |
7105 3d8e 97FF sbrs r25,7 |
7106 3d90 04C0 rjmp .L536 |
7107 3d92 6150 subi r22,lo8(-(511)) |
7108 3d94 7E4F sbci r23,hi8(-(511)) |
7109 3d96 8F4F sbci r24,hlo8(-(511)) |
7110 3d98 9F4F sbci r25,hhi8(-(511)) |
7111 .L536: |
7112 3d9a 59E0 ldi r21,9 |
7113 3d9c 9595 1: asr r25 |
7114 3d9e 8795 ror r24 |
7115 3da0 7795 ror r23 |
7116 3da2 6795 ror r22 |
7117 3da4 5A95 dec r21 |
7118 3da6 D1F7 brne 1b |
7119 3da8 9B01 movw r18,r22 |
7120 3daa 8F2D mov r24,r15 |
7121 3dac 9927 clr r25 |
7122 3dae 809F mul r24,r16 |
7123 3db0 D001 movw r26,r0 |
7124 3db2 819F mul r24,r17 |
7125 3db4 B00D add r27,r0 |
7126 3db6 909F mul r25,r16 |
7127 3db8 B00D add r27,r0 |
7128 3dba 1124 clr r1 |
7129 3dbc CD01 movw r24,r26 |
7130 3dbe B7FD sbrc r27,7 |
7131 3dc0 0396 adiw r24,3 |
7132 .L537: |
7133 3dc2 9595 asr r25 |
7134 3dc4 8795 ror r24 |
7135 3dc6 9595 asr r25 |
7136 3dc8 8795 ror r24 |
7137 3dca 280F add r18,r24 |
7138 3dcc 391F adc r19,r25 |
7139 3dce 4427 clr r20 |
7140 3dd0 37FD sbrc r19,7 |
7141 3dd2 4095 com r20 |
7142 3dd4 542F mov r21,r20 |
7143 3dd6 2093 0000 sts sollGier.0,r18 |
7144 3dda 3093 0000 sts (sollGier.0)+1,r19 |
7145 3dde 4093 0000 sts (sollGier.0)+2,r20 |
7146 3de2 5093 0000 sts (sollGier.0)+3,r21 |
7147 3de6 8091 0000 lds r24,Mess_Integral_Gier |
7148 3dea 9091 0000 lds r25,(Mess_Integral_Gier)+1 |
7149 3dee A091 0000 lds r26,(Mess_Integral_Gier)+2 |
7150 3df2 B091 0000 lds r27,(Mess_Integral_Gier)+3 |
7151 3df6 821B sub r24,r18 |
7152 3df8 930B sbc r25,r19 |
7153 3dfa A40B sbc r26,r20 |
7154 3dfc B50B sbc r27,r21 |
7155 3dfe 8093 0000 sts Mess_Integral_Gier,r24 |
7156 3e02 9093 0000 sts (Mess_Integral_Gier)+1,r25 |
7157 3e06 A093 0000 sts (Mess_Integral_Gier)+2,r26 |
7158 3e0a B093 0000 sts (Mess_Integral_Gier)+3,r27 |
7159 3e0e 8155 subi r24,lo8(50001) |
7160 3e10 934C sbci r25,hi8(50001) |
7161 3e12 A040 sbci r26,hlo8(50001) |
7162 3e14 B040 sbci r27,hhi8(50001) |
7163 3e16 64F0 brlt .L538 |
7164 3e18 80E5 ldi r24,lo8(50000) |
7165 3e1a 93EC ldi r25,hi8(50000) |
7166 3e1c A0E0 ldi r26,hlo8(50000) |
7167 3e1e B0E0 ldi r27,hhi8(50000) |
7168 3e20 8093 0000 sts Mess_Integral_Gier,r24 |
7169 3e24 9093 0000 sts (Mess_Integral_Gier)+1,r25 |
7170 3e28 A093 0000 sts (Mess_Integral_Gier)+2,r26 |
7171 3e2c B093 0000 sts (Mess_Integral_Gier)+3,r27 |
7172 .L538: |
7173 3e30 8091 0000 lds r24,Mess_Integral_Gier |
7174 3e34 9091 0000 lds r25,(Mess_Integral_Gier)+1 |
7175 3e38 A091 0000 lds r26,(Mess_Integral_Gier)+2 |
7176 3e3c B091 0000 lds r27,(Mess_Integral_Gier)+3 |
7177 3e40 805B subi r24,lo8(-50000) |
7178 3e42 9C43 sbci r25,hi8(-50000) |
7179 3e44 AF4F sbci r26,hlo8(-50000) |
7180 3e46 BF4F sbci r27,hhi8(-50000) |
7181 3e48 64F4 brge .L539 |
7182 3e4a 80EB ldi r24,lo8(-50000) |
7183 3e4c 9CE3 ldi r25,hi8(-50000) |
7184 3e4e AFEF ldi r26,hlo8(-50000) |
7185 3e50 BFEF ldi r27,hhi8(-50000) |
7186 3e52 8093 0000 sts Mess_Integral_Gier,r24 |
7187 3e56 9093 0000 sts (Mess_Integral_Gier)+1,r25 |
7188 3e5a A093 0000 sts (Mess_Integral_Gier)+2,r26 |
7189 3e5e B093 0000 sts (Mess_Integral_Gier)+3,r27 |
7190 .L539: |
7191 3e62 A090 0000 lds r10,KompassValue |
7192 3e66 B090 0000 lds r11,(KompassValue)+1 |
7193 3e6a A114 cp r10,__zero_reg__ |
7194 3e6c B104 cpc r11,__zero_reg__ |
7195 3e6e 09F4 brne .+2 |
7196 3e70 78C1 rjmp .L540 |
7197 3e72 8091 0000 lds r24,EE_Parameter+13 |
7198 3e76 83FF sbrs r24,3 |
7199 3e78 74C1 rjmp .L540 |
7200 3e7a 8091 0000 lds r24,IntegralNick |
7201 3e7e 9091 0000 lds r25,(IntegralNick)+1 |
7202 3e82 A091 0000 lds r26,(IntegralNick)+2 |
7203 3e86 B091 0000 lds r27,(IntegralNick)+3 |
7204 3e8a B7FF sbrs r27,7 |
7205 3e8c 04C0 rjmp .L541 |
7206 3e8e 8150 subi r24,lo8(-(511)) |
7207 3e90 9E4F sbci r25,hi8(-(511)) |
7208 3e92 AF4F sbci r26,hlo8(-(511)) |
7209 3e94 BF4F sbci r27,hhi8(-(511)) |
7210 .L541: |
7211 3e96 29E0 ldi r18,9 |
7212 3e98 B595 1: asr r27 |
7213 3e9a A795 ror r26 |
7214 3e9c 9795 ror r25 |
7215 3e9e 8795 ror r24 |
7216 3ea0 2A95 dec r18 |
7217 3ea2 D1F7 brne 1b |
7218 3ea4 6C01 movw r12,r24 |
7219 3ea6 97FF sbrs r25,7 |
7220 3ea8 04C0 rjmp .L542 |
7221 3eaa D094 com r13 |
7222 3eac C194 neg r12 |
7223 3eae D108 sbc r13,__zero_reg__ |
7224 3eb0 D394 inc r13 |
7225 .L542: |
7226 3eb2 8091 0000 lds r24,IntegralRoll |
7227 3eb6 9091 0000 lds r25,(IntegralRoll)+1 |
7228 3eba A091 0000 lds r26,(IntegralRoll)+2 |
7229 3ebe B091 0000 lds r27,(IntegralRoll)+3 |
7230 3ec2 B7FF sbrs r27,7 |
7231 3ec4 04C0 rjmp .L543 |
7232 3ec6 8150 subi r24,lo8(-(511)) |
7233 3ec8 9E4F sbci r25,hi8(-(511)) |
7234 3eca AF4F sbci r26,hlo8(-(511)) |
7235 3ecc BF4F sbci r27,hhi8(-(511)) |
7236 .L543: |
7237 3ece 09E0 ldi r16,9 |
7238 3ed0 B595 1: asr r27 |
7239 3ed2 A795 ror r26 |
7240 3ed4 9795 ror r25 |
7241 3ed6 8795 ror r24 |
7242 3ed8 0A95 dec r16 |
7243 3eda D1F7 brne 1b |
7244 3edc BC01 movw r22,r24 |
7245 3ede 97FF sbrs r25,7 |
7246 3ee0 03C0 rjmp .L544 |
7247 3ee2 7095 com r23 |
7248 3ee4 6195 neg r22 |
7249 3ee6 7F4F sbci r23,lo8(-1) |
7250 .L544: |
7251 3ee8 C616 cp r12,r22 |
7252 3eea D706 cpc r13,r23 |
7253 3eec 0CF4 brge .L545 |
7254 3eee 6B01 movw r12,r22 |
7255 .L545: |
7256 3ef0 B601 movw r22,r12 |
7257 3ef2 D7FE sbrs r13,7 |
7258 3ef4 02C0 rjmp .L546 |
7259 3ef6 695F subi r22,lo8(-(7)) |
7260 3ef8 7F4F sbci r23,hi8(-(7)) |
7261 .L546: |
7262 3efa 2B01 movw r4,r22 |
7263 3efc 13E0 ldi r17,3 |
7264 3efe 5594 1: asr r5 |
7265 3f00 4794 ror r4 |
7266 3f02 1A95 dec r17 |
7267 3f04 E1F7 brne 1b |
7268 3f06 B2E0 ldi r27,lo8(2) |
7269 3f08 EB2E mov r14,r27 |
7270 3f0a F12C mov r15,__zero_reg__ |
7271 3f0c 4E0C add r4,r14 |
7272 3f0e 5F1C adc r5,r15 |
7273 3f10 0CE1 ldi r16,lo8(540) |
7274 3f12 12E0 ldi r17,hi8(540) |
7275 3f14 A00E add r10,r16 |
7276 3f16 B11E adc r11,r17 |
7277 3f18 7501 movw r14,r10 |
7278 3f1a 0027 clr r16 |
7279 3f1c F7FC sbrc r15,7 |
7280 3f1e 0095 com r16 |
7281 3f20 102F mov r17,r16 |
7282 3f22 24EE ldi r18,lo8(-540) |
7283 3f24 3DEF ldi r19,hi8(-540) |
7284 3f26 A20E add r10,r18 |
7285 3f28 B31E adc r11,r19 |
7286 3f2a 8091 0000 lds r24,ErsatzKompass |
7287 3f2e 9091 0000 lds r25,(ErsatzKompass)+1 |
7288 3f32 A091 0000 lds r26,(ErsatzKompass)+2 |
7289 3f36 B091 0000 lds r27,(ErsatzKompass)+3 |
7290 3f3a 6090 0000 lds r6,GIER_GRAD_FAKTOR |
7291 3f3e 7090 0000 lds r7,(GIER_GRAD_FAKTOR)+1 |
7292 3f42 8090 0000 lds r8,(GIER_GRAD_FAKTOR)+2 |
7293 3f46 9090 0000 lds r9,(GIER_GRAD_FAKTOR)+3 |
7294 3f4a BC01 movw r22,r24 |
7295 3f4c CD01 movw r24,r26 |
7296 3f4e A401 movw r20,r8 |
7297 3f50 9301 movw r18,r6 |
7298 3f52 0E94 0000 call __divmodsi4 |
7299 3f56 E21A sub r14,r18 |
7300 3f58 F30A sbc r15,r19 |
7301 3f5a 040B sbc r16,r20 |
7302 3f5c 150B sbc r17,r21 |
7303 3f5e C801 movw r24,r16 |
7304 3f60 B701 movw r22,r14 |
7305 3f62 28E6 ldi r18,lo8(360) |
7306 3f64 31E0 ldi r19,hi8(360) |
7307 3f66 40E0 ldi r20,hlo8(360) |
7308 3f68 50E0 ldi r21,hhi8(360) |
7309 3f6a 0E94 0000 call __divmodsi4 |
7310 3f6e DC01 movw r26,r24 |
7311 3f70 CB01 movw r24,r22 |
7312 3f72 ACE4 ldi r26,lo8(-180) |
7313 3f74 EA2E mov r14,r26 |
7314 3f76 AFEF ldi r26,hi8(-180) |
7315 3f78 FA2E mov r15,r26 |
7316 3f7a E80E add r14,r24 |
7317 3f7c F91E adc r15,r25 |
7318 3f7e 0091 0000 lds r16,KompassSignalSchlecht |
7319 3f82 1091 0000 lds r17,(KompassSignalSchlecht)+1 |
7320 3f86 0115 cp r16,__zero_reg__ |
7321 3f88 1105 cpc r17,__zero_reg__ |
7322 3f8a 89F5 brne .L547 |
7323 3f8c 39E1 ldi r19,lo8(25) |
7324 3f8e C316 cp r12,r19 |
7325 3f90 D104 cpc r13,__zero_reg__ |
7326 3f92 6CF5 brge .L547 |
7327 3f94 8091 0000 lds r24,GierGyroFehler |
7328 3f98 9091 0000 lds r25,(GierGyroFehler)+1 |
7329 3f9c 8E0D add r24,r14 |
7330 3f9e 9F1D adc r25,r15 |
7331 3fa0 9093 0000 sts (GierGyroFehler)+1,r25 |
7332 3fa4 8093 0000 sts GierGyroFehler,r24 |
7333 3fa8 8091 0000 lds r24,NeueKompassRichtungMerken.10 |
7334 3fac 8823 tst r24 |
7335 3fae F9F0 breq .L547 |
7336 3fb0 C501 movw r24,r10 |
7337 3fb2 AA27 clr r26 |
7338 3fb4 97FD sbrc r25,7 |
7339 3fb6 A095 com r26 |
7340 3fb8 BA2F mov r27,r26 |
7341 3fba BC01 movw r22,r24 |
7342 3fbc CD01 movw r24,r26 |
7343 3fbe A401 movw r20,r8 |
7344 3fc0 9301 movw r18,r6 |
7345 3fc2 0E94 0000 call __mulsi3 |
7346 3fc6 DC01 movw r26,r24 |
7347 3fc8 CB01 movw r24,r22 |
7348 3fca 8093 0000 sts ErsatzKompass,r24 |
7349 3fce 9093 0000 sts (ErsatzKompass)+1,r25 |
7350 3fd2 A093 0000 sts (ErsatzKompass)+2,r26 |
7351 3fd6 B093 0000 sts (ErsatzKompass)+3,r27 |
7352 3fda BC01 movw r22,r24 |
7353 3fdc CD01 movw r24,r26 |
7354 3fde 0E94 0000 call __divmodsi4 |
7355 3fe2 3093 0000 sts (KompassStartwert)+1,r19 |
7356 3fe6 2093 0000 sts KompassStartwert,r18 |
7357 3fea 1092 0000 sts NeueKompassRichtungMerken.10,__zero_reg__ |
7358 .L547: |
7359 3fee C701 movw r24,r14 |
7360 3ff0 F4E0 ldi r31,4 |
7361 3ff2 880F 1: lsl r24 |
7362 3ff4 991F rol r25 |
7363 3ff6 FA95 dec r31 |
7364 3ff8 E1F7 brne 1b |
7365 3ffa B201 movw r22,r4 |
7366 3ffc 0E94 0000 call __divmodhi4 |
7367 4000 CB01 movw r24,r22 |
7368 4002 AA27 clr r26 |
7369 4004 97FD sbrc r25,7 |
7370 4006 A095 com r26 |
7371 4008 BA2F mov r27,r26 |
7372 400a 2091 0000 lds r18,ErsatzKompass |
7373 400e 3091 0000 lds r19,(ErsatzKompass)+1 |
7374 4012 4091 0000 lds r20,(ErsatzKompass)+2 |
7375 4016 5091 0000 lds r21,(ErsatzKompass)+3 |
7376 401a 280F add r18,r24 |
7377 401c 391F adc r19,r25 |
7378 401e 4A1F adc r20,r26 |
7379 4020 5B1F adc r21,r27 |
7380 4022 2093 0000 sts ErsatzKompass,r18 |
7381 4026 3093 0000 sts (ErsatzKompass)+1,r19 |
7382 402a 4093 0000 sts (ErsatzKompass)+2,r20 |
7383 402e 5093 0000 sts (ErsatzKompass)+3,r21 |
7384 4032 F090 0000 lds r15,Parameter_KompassWirkung |
7385 4036 6F2D mov r22,r15 |
7386 4038 7727 clr r23 |
7387 403a C69E mul r12,r22 |
7388 403c C001 movw r24,r0 |
7389 403e C79E mul r12,r23 |
7390 4040 900D add r25,r0 |
7391 4042 D69E mul r13,r22 |
7392 4044 900D add r25,r0 |
7393 4046 1124 clr r1 |
7394 4048 97FD sbrc r25,7 |
7395 404a 4F96 adiw r24,31 |
7396 .L549: |
7397 404c 6C01 movw r12,r24 |
7398 404e E5E0 ldi r30,5 |
7399 4050 D594 1: asr r13 |
7400 4052 C794 ror r12 |
7401 4054 EA95 dec r30 |
7402 4056 E1F7 brne 1b |
7403 4058 6C19 sub r22,r12 |
7404 405a 7D09 sbc r23,r13 |
7405 405c 6B01 movw r12,r22 |
7406 405e 77FD sbrc r23,7 |
7407 4060 7AC0 rjmp .L550 |
7408 4062 0115 cp r16,__zero_reg__ |
7409 4064 1105 cpc r17,__zero_reg__ |
7410 4066 09F0 breq .+2 |
7411 4068 6FC0 rjmp .L780 |
7412 406a 0091 0000 lds r16,MaxStickNick |
7413 406e 1091 0000 lds r17,(MaxStickNick)+1 |
7414 4072 8091 0000 lds r24,MaxStickRoll |
7415 4076 9091 0000 lds r25,(MaxStickRoll)+1 |
7416 407a 080F add r16,r24 |
7417 407c 191F adc r17,r25 |
7418 407e 17FF sbrs r17,7 |
7419 4080 02C0 rjmp .L552 |
7420 4082 095F subi r16,lo8(-(7)) |
7421 4084 1F4F sbci r17,hi8(-(7)) |
7422 .L552: |
7423 4086 73E0 ldi r23,3 |
7424 4088 1595 1: asr r17 |
7425 408a 0795 ror r16 |
7426 408c 7A95 dec r23 |
7427 408e E1F7 brne 1b |
7428 4090 005C subi r16,lo8(-(64)) |
7429 4092 1F4F sbci r17,hi8(-(64)) |
7430 4094 CA01 movw r24,r20 |
7431 4096 B901 movw r22,r18 |
7432 4098 A401 movw r20,r8 |
7433 409a 9301 movw r18,r6 |
7434 409c 0E94 0000 call __divmodsi4 |
7435 40a0 DA01 movw r26,r20 |
7436 40a2 C901 movw r24,r18 |
7437 40a4 2091 0000 lds r18,KompassStartwert |
7438 40a8 3091 0000 lds r19,(KompassStartwert)+1 |
7439 40ac 4427 clr r20 |
7440 40ae 37FD sbrc r19,7 |
7441 40b0 4095 com r20 |
7442 40b2 542F mov r21,r20 |
7443 40b4 821B sub r24,r18 |
7444 40b6 930B sbc r25,r19 |
7445 40b8 A40B sbc r26,r20 |
7446 40ba B50B sbc r27,r21 |
7447 40bc 845E subi r24,lo8(-(540)) |
7448 40be 9D4F sbci r25,hi8(-(540)) |
7449 40c0 AF4F sbci r26,hlo8(-(540)) |
7450 40c2 BF4F sbci r27,hhi8(-(540)) |
7451 40c4 BC01 movw r22,r24 |
7452 40c6 CD01 movw r24,r26 |
7453 40c8 28E6 ldi r18,lo8(360) |
7454 40ca 31E0 ldi r19,hi8(360) |
7455 40cc 40E0 ldi r20,hlo8(360) |
7456 40ce 50E0 ldi r21,hhi8(360) |
7457 40d0 0E94 0000 call __divmodsi4 |
7458 40d4 DC01 movw r26,r24 |
7459 40d6 CB01 movw r24,r22 |
7460 40d8 845B subi r24,lo8(-(-180)) |
7461 40da 9040 sbci r25,hi8(-(-180)) |
7462 40dc 8C9D mul r24,r12 |
7463 40de A001 movw r20,r0 |
7464 40e0 8D9D mul r24,r13 |
7465 40e2 500D add r21,r0 |
7466 40e4 9C9D mul r25,r12 |
7467 40e6 500D add r21,r0 |
7468 40e8 1124 clr r1 |
7469 40ea CA01 movw r24,r20 |
7470 40ec B801 movw r22,r16 |
7471 40ee 0E94 0000 call __divmodhi4 |
7472 40f2 83E0 ldi r24,lo8(3) |
7473 40f4 F89E mul r15,r24 |
7474 40f6 6001 movw r12,r0 |
7475 40f8 1124 clr r1 |
7476 40fa C616 cp r12,r22 |
7477 40fc D706 cpc r13,r23 |
7478 40fe 14F4 brge .L553 |
7479 4100 B601 movw r22,r12 |
7480 4102 08C0 rjmp .L554 |
7481 .L553: |
7482 4104 8827 clr r24 |
7483 4106 9927 clr r25 |
7484 4108 8C19 sub r24,r12 |
7485 410a 9D09 sbc r25,r13 |
7486 410c 6817 cp r22,r24 |
7487 410e 7907 cpc r23,r25 |
7488 4110 0CF4 brge .L554 |
7489 4112 BC01 movw r22,r24 |
7490 .L554: |
7491 4114 9B01 movw r18,r22 |
7492 4116 4427 clr r20 |
7493 4118 37FD sbrc r19,7 |
7494 411a 4095 com r20 |
7495 411c 542F mov r21,r20 |
7496 411e 8091 0000 lds r24,Mess_Integral_Gier |
7497 4122 9091 0000 lds r25,(Mess_Integral_Gier)+1 |
7498 4126 A091 0000 lds r26,(Mess_Integral_Gier)+2 |
7499 412a B091 0000 lds r27,(Mess_Integral_Gier)+3 |
7500 412e 820F add r24,r18 |
7501 4130 931F adc r25,r19 |
7502 4132 A41F adc r26,r20 |
7503 4134 B51F adc r27,r21 |
7504 4136 8093 0000 sts Mess_Integral_Gier,r24 |
7505 413a 9093 0000 sts (Mess_Integral_Gier)+1,r25 |
7506 413e A093 0000 sts (Mess_Integral_Gier)+2,r26 |
7507 4142 B093 0000 sts (Mess_Integral_Gier)+3,r27 |
7508 4146 0DC0 rjmp .L540 |
7509 .L780: |
7510 4148 0150 subi r16,lo8(-(-1)) |
7511 414a 1040 sbci r17,hi8(-(-1)) |
7512 414c 1093 0000 sts (KompassSignalSchlecht)+1,r17 |
7513 4150 0093 0000 sts KompassSignalSchlecht,r16 |
7514 4154 06C0 rjmp .L540 |
7515 .L550: |
7516 4156 84EF ldi r24,lo8(500) |
7517 4158 91E0 ldi r25,hi8(500) |
7518 415a 9093 0000 sts (KompassSignalSchlecht)+1,r25 |
7519 415e 8093 0000 sts KompassSignalSchlecht,r24 |
7520 .L540: |
7521 4162 8091 0000 lds r24,TrichterFlug |
7522 4166 8823 tst r24 |
7523 4168 81F0 breq .L558 |
7524 416a 1092 0000 sts SummeRoll,__zero_reg__ |
7525 416e 1092 0000 sts (SummeRoll)+1,__zero_reg__ |
7526 4172 1092 0000 sts (SummeRoll)+2,__zero_reg__ |
7527 4176 1092 0000 sts (SummeRoll)+3,__zero_reg__ |
7528 417a 1092 0000 sts SummeNick,__zero_reg__ |
7529 417e 1092 0000 sts (SummeNick)+1,__zero_reg__ |
7530 4182 1092 0000 sts (SummeNick)+2,__zero_reg__ |
7531 4186 1092 0000 sts (SummeNick)+3,__zero_reg__ |
7532 .L558: |
7533 418a 7090 0000 lds r7,Looping_Nick |
7534 418e 7720 tst r7 |
7535 4190 F1F4 brne .L559 |
7536 4192 8091 0000 lds r24,IntegralFaktor |
7537 4196 282F mov r18,r24 |
7538 4198 3327 clr r19 |
7539 419a 4427 clr r20 |
7540 419c 5527 clr r21 |
7541 419e 8091 0000 lds r24,IntegralNick |
7542 41a2 9091 0000 lds r25,(IntegralNick)+1 |
7543 41a6 A091 0000 lds r26,(IntegralNick)+2 |
7544 41aa B091 0000 lds r27,(IntegralNick)+3 |
7545 41ae BC01 movw r22,r24 |
7546 41b0 CD01 movw r24,r26 |
7547 41b2 0E94 0000 call __mulsi3 |
7548 41b6 DC01 movw r26,r24 |
7549 41b8 CB01 movw r24,r22 |
7550 41ba BC01 movw r22,r24 |
7551 41bc CD01 movw r24,r26 |
7552 41be 28EF ldi r18,lo8(11000) |
7553 41c0 3AE2 ldi r19,hi8(11000) |
7554 41c2 40E0 ldi r20,hlo8(11000) |
7555 41c4 50E0 ldi r21,hhi8(11000) |
7556 41c6 0E94 0000 call __divmodsi4 |
7557 41ca 2901 movw r4,r18 |
7558 41cc 02C0 rjmp .L560 |
7559 .L559: |
7560 41ce 4424 clr r4 |
7561 41d0 5524 clr r5 |
7562 .L560: |
7563 41d2 9090 0000 lds r9,Looping_Roll |
7564 41d6 9920 tst r9 |
7565 41d8 F1F4 brne .L561 |
7566 41da 8091 0000 lds r24,IntegralFaktor |
7567 41de 282F mov r18,r24 |
7568 41e0 3327 clr r19 |
7569 41e2 4427 clr r20 |
7570 41e4 5527 clr r21 |
7571 41e6 8091 0000 lds r24,IntegralRoll |
7572 41ea 9091 0000 lds r25,(IntegralRoll)+1 |
7573 41ee A091 0000 lds r26,(IntegralRoll)+2 |
7574 41f2 B091 0000 lds r27,(IntegralRoll)+3 |
7575 41f6 BC01 movw r22,r24 |
7576 41f8 CD01 movw r24,r26 |
7577 41fa 0E94 0000 call __mulsi3 |
7578 41fe DC01 movw r26,r24 |
7579 4200 CB01 movw r24,r22 |
7580 4202 BC01 movw r22,r24 |
7581 4204 CD01 movw r24,r26 |
7582 4206 28EF ldi r18,lo8(11000) |
7583 4208 3AE2 ldi r19,hi8(11000) |
7584 420a 40E0 ldi r20,hlo8(11000) |
7585 420c 50E0 ldi r21,hhi8(11000) |
7586 420e 0E94 0000 call __divmodsi4 |
7587 4212 1901 movw r2,r18 |
7588 4214 02C0 rjmp .L562 |
7589 .L561: |
7590 4216 2224 clr r2 |
7591 4218 3324 clr r3 |
7592 .L562: |
7593 421a 8091 0000 lds r24,TrimNick |
7594 421e 9091 0000 lds r25,(TrimNick)+1 |
7595 4222 893C cpi r24,201 |
7596 4224 9105 cpc r25,__zero_reg__ |
7597 4226 1CF0 brlt .L563 |
7598 4228 88EC ldi r24,lo8(200) |
7599 422a 90E0 ldi r25,hi8(200) |
7600 422c 05C0 rjmp .L785 |
7601 .L563: |
7602 422e 8853 subi r24,lo8(-200) |
7603 4230 9F4F sbci r25,hi8(-200) |
7604 4232 34F4 brge .L564 |
7605 4234 88E3 ldi r24,lo8(-200) |
7606 4236 9FEF ldi r25,hi8(-200) |
7607 .L785: |
7608 4238 9093 0000 sts (TrimNick)+1,r25 |
7609 423c 8093 0000 sts TrimNick,r24 |
7610 .L564: |
7611 4240 8091 0000 lds r24,TrimRoll |
7612 4244 9091 0000 lds r25,(TrimRoll)+1 |
7613 4248 893C cpi r24,201 |
7614 424a 9105 cpc r25,__zero_reg__ |
7615 424c 1CF0 brlt .L566 |
7616 424e 88EC ldi r24,lo8(200) |
7617 4250 90E0 ldi r25,hi8(200) |
7618 4252 05C0 rjmp .L786 |
7619 .L566: |
7620 4254 8853 subi r24,lo8(-200) |
7621 4256 9F4F sbci r25,hi8(-200) |
7622 4258 34F4 brge .L567 |
7623 425a 88E3 ldi r24,lo8(-200) |
7624 425c 9FEF ldi r25,hi8(-200) |
7625 .L786: |
7626 425e 9093 0000 sts (TrimRoll)+1,r25 |
7627 4262 8093 0000 sts TrimRoll,r24 |
7628 .L567: |
7629 4266 8091 0000 lds r24,MesswertNick |
7630 426a 9091 0000 lds r25,(MesswertNick)+1 |
7631 426e AA27 clr r26 |
7632 4270 97FD sbrc r25,7 |
7633 4272 A095 com r26 |
7634 4274 BA2F mov r27,r26 |
7635 4276 2091 0000 lds r18,GyroFaktor |
7636 427a A22E mov r10,r18 |
7637 427c BB24 clr r11 |
7638 427e CC24 clr r12 |
7639 4280 DD24 clr r13 |
7640 4282 BC01 movw r22,r24 |
7641 4284 CD01 movw r24,r26 |
7642 4286 A601 movw r20,r12 |
7643 4288 9501 movw r18,r10 |
7644 428a 0E94 0000 call __mulsi3 |
7645 428e 9B01 movw r18,r22 |
7646 4290 AC01 movw r20,r24 |
7647 4292 8091 0000 lds r24,TrimNick |
7648 4296 9091 0000 lds r25,(TrimNick)+1 |
7649 429a AA27 clr r26 |
7650 429c 97FD sbrc r25,7 |
7651 429e A095 com r26 |
7652 42a0 BA2F mov r27,r26 |
7653 42a2 67E0 ldi r22,7 |
7654 42a4 880F 1: lsl r24 |
7655 42a6 991F rol r25 |
7656 42a8 AA1F rol r26 |
7657 42aa BB1F rol r27 |
7658 42ac 6A95 dec r22 |
7659 42ae D1F7 brne 1b |
7660 42b0 280F add r18,r24 |
7661 42b2 391F adc r19,r25 |
7662 42b4 4A1F adc r20,r26 |
7663 42b6 5B1F adc r21,r27 |
7664 42b8 57FF sbrs r21,7 |
7665 42ba 04C0 rjmp .L569 |
7666 42bc 215C subi r18,lo8(-(63)) |
7667 42be 3F4F sbci r19,hi8(-(63)) |
7668 42c0 4F4F sbci r20,hlo8(-(63)) |
7669 42c2 5F4F sbci r21,hhi8(-(63)) |
7670 .L569: |
7671 42c4 06E0 ldi r16,6 |
7672 42c6 5595 1: asr r21 |
7673 42c8 4795 ror r20 |
7674 42ca 3795 ror r19 |
7675 42cc 2795 ror r18 |
7676 42ce 0A95 dec r16 |
7677 42d0 D1F7 brne 1b |
7678 42d2 7201 movw r14,r4 |
7679 42d4 E20E add r14,r18 |
7680 42d6 F31E adc r15,r19 |
7681 42d8 F092 0000 sts (MesswertNick)+1,r15 |
7682 42dc E092 0000 sts MesswertNick,r14 |
7683 42e0 8091 0000 lds r24,MesswertRoll |
7684 42e4 9091 0000 lds r25,(MesswertRoll)+1 |
7685 42e8 AA27 clr r26 |
7686 42ea 97FD sbrc r25,7 |
7687 42ec A095 com r26 |
7688 42ee BA2F mov r27,r26 |
7689 42f0 BC01 movw r22,r24 |
7690 42f2 CD01 movw r24,r26 |
7691 42f4 A601 movw r20,r12 |
7692 42f6 9501 movw r18,r10 |
7693 42f8 0E94 0000 call __mulsi3 |
7694 42fc 9B01 movw r18,r22 |
7695 42fe AC01 movw r20,r24 |
7696 4300 8091 0000 lds r24,TrimRoll |
7697 4304 9091 0000 lds r25,(TrimRoll)+1 |
7698 4308 AA27 clr r26 |
7699 430a 97FD sbrc r25,7 |
7700 430c A095 com r26 |
7701 430e BA2F mov r27,r26 |
7702 4310 17E0 ldi r17,7 |
7703 4312 880F 1: lsl r24 |
7704 4314 991F rol r25 |
7705 4316 AA1F rol r26 |
7706 4318 BB1F rol r27 |
7707 431a 1A95 dec r17 |
7708 431c D1F7 brne 1b |
7709 431e 280F add r18,r24 |
7710 4320 391F adc r19,r25 |
7711 4322 4A1F adc r20,r26 |
7712 4324 5B1F adc r21,r27 |
7713 4326 57FF sbrs r21,7 |
7714 4328 04C0 rjmp .L570 |
7715 432a 215C subi r18,lo8(-(63)) |
7716 432c 3F4F sbci r19,hi8(-(63)) |
7717 432e 4F4F sbci r20,hlo8(-(63)) |
7718 4330 5F4F sbci r21,hhi8(-(63)) |
7719 .L570: |
7720 4332 B6E0 ldi r27,6 |
7721 4334 5595 1: asr r21 |
7722 4336 4795 ror r20 |
7723 4338 3795 ror r19 |
7724 433a 2795 ror r18 |
7725 433c BA95 dec r27 |
7726 433e D1F7 brne 1b |
7727 4340 8101 movw r16,r2 |
7728 4342 020F add r16,r18 |
7729 4344 131F adc r17,r19 |
7730 4346 1093 0000 sts (MesswertRoll)+1,r17 |
7731 434a 0093 0000 sts MesswertRoll,r16 |
7732 434e 8091 0000 lds r24,MesswertGier |
7733 4352 9091 0000 lds r25,(MesswertGier)+1 |
7734 4356 880F add r24,r24 |
7735 4358 991F adc r25,r25 |
7736 435a AA27 clr r26 |
7737 435c 97FD sbrc r25,7 |
7738 435e A095 com r26 |
7739 4360 BA2F mov r27,r26 |
7740 4362 2091 0000 lds r18,GyroFaktorGier |
7741 4366 3327 clr r19 |
7742 4368 4427 clr r20 |
7743 436a 5527 clr r21 |
7744 436c BC01 movw r22,r24 |
7745 436e CD01 movw r24,r26 |
7746 4370 0E94 0000 call __mulsi3 |
7747 4374 5B01 movw r10,r22 |
7748 4376 6C01 movw r12,r24 |
7749 4378 97FF sbrs r25,7 |
7750 437a 08C0 rjmp .L571 |
7751 437c 8FE3 ldi r24,lo8(63) |
7752 437e 90E0 ldi r25,hi8(63) |
7753 4380 A0E0 ldi r26,hlo8(63) |
7754 4382 B0E0 ldi r27,hhi8(63) |
7755 4384 A80E add r10,r24 |
7756 4386 B91E adc r11,r25 |
7757 4388 CA1E adc r12,r26 |
7758 438a DB1E adc r13,r27 |
7759 .L571: |
7760 438c A6E0 ldi r26,6 |
7761 438e D594 1: asr r13 |
7762 4390 C794 ror r12 |
7763 4392 B794 ror r11 |
7764 4394 A794 ror r10 |
7765 4396 AA95 dec r26 |
7766 4398 D1F7 brne 1b |
7767 439a 8091 0000 lds r24,IntegralFaktorGier |
7768 439e 282F mov r18,r24 |
7769 43a0 3327 clr r19 |
7770 43a2 4427 clr r20 |
7771 43a4 5527 clr r21 |
7772 43a6 8091 0000 lds r24,Integral_Gier |
7773 43aa 9091 0000 lds r25,(Integral_Gier)+1 |
7774 43ae A091 0000 lds r26,(Integral_Gier)+2 |
7775 43b2 B091 0000 lds r27,(Integral_Gier)+3 |
7776 43b6 BC01 movw r22,r24 |
7777 43b8 CD01 movw r24,r26 |
7778 43ba 0E94 0000 call __mulsi3 |
7779 43be DC01 movw r26,r24 |
7780 43c0 CB01 movw r24,r22 |
7781 43c2 BC01 movw r22,r24 |
7782 43c4 CD01 movw r24,r26 |
7783 43c6 20EF ldi r18,lo8(22000) |
7784 43c8 35E5 ldi r19,hi8(22000) |
7785 43ca 40E0 ldi r20,hlo8(22000) |
7786 43cc 50E0 ldi r21,hhi8(22000) |
7787 43ce 0E94 0000 call __divmodsi4 |
7788 43d2 B501 movw r22,r10 |
7789 43d4 620F add r22,r18 |
7790 43d6 731F adc r23,r19 |
7791 43d8 7093 0000 sts (MesswertGier)+1,r23 |
7792 43dc 6093 0000 sts MesswertGier,r22 |
7793 43e0 91E0 ldi r25,lo8(4097) |
7794 43e2 E916 cp r14,r25 |
7795 43e4 90E1 ldi r25,hi8(4097) |
7796 43e6 F906 cpc r15,r25 |
7797 43e8 34F0 brlt .L572 |
7798 43ea 80E0 ldi r24,lo8(4096) |
7799 43ec 90E1 ldi r25,hi8(4096) |
7800 43ee 9093 0000 sts (MesswertNick)+1,r25 |
7801 43f2 8093 0000 sts MesswertNick,r24 |
7802 .L572: |
7803 43f6 8091 0000 lds r24,MesswertNick |
7804 43fa 9091 0000 lds r25,(MesswertNick)+1 |
7805 43fe 8050 subi r24,lo8(-4096) |
7806 4400 904F sbci r25,hi8(-4096) |
7807 4402 34F4 brge .L573 |
7808 4404 80E0 ldi r24,lo8(-4096) |
7809 4406 90EF ldi r25,hi8(-4096) |
7810 4408 9093 0000 sts (MesswertNick)+1,r25 |
7811 440c 8093 0000 sts MesswertNick,r24 |
7812 .L573: |
7813 4410 0150 subi r16,lo8(4097) |
7814 4412 1041 sbci r17,hi8(4097) |
7815 4414 34F0 brlt .L574 |
7816 4416 80E0 ldi r24,lo8(4096) |
7817 4418 90E1 ldi r25,hi8(4096) |
7818 441a 9093 0000 sts (MesswertRoll)+1,r25 |
7819 441e 8093 0000 sts MesswertRoll,r24 |
7820 .L574: |
7821 4422 8091 0000 lds r24,MesswertRoll |
7822 4426 9091 0000 lds r25,(MesswertRoll)+1 |
7823 442a 8050 subi r24,lo8(-4096) |
7824 442c 904F sbci r25,hi8(-4096) |
7825 442e 34F4 brge .L575 |
7826 4430 80E0 ldi r24,lo8(-4096) |
7827 4432 90EF ldi r25,hi8(-4096) |
7828 4434 9093 0000 sts (MesswertRoll)+1,r25 |
7829 4438 8093 0000 sts MesswertRoll,r24 |
7830 .L575: |
7831 443c 6150 subi r22,lo8(4097) |
7832 443e 7041 sbci r23,hi8(4097) |
7833 4440 34F0 brlt .L576 |
7834 4442 80E0 ldi r24,lo8(4096) |
7835 4444 90E1 ldi r25,hi8(4096) |
7836 4446 9093 0000 sts (MesswertGier)+1,r25 |
7837 444a 8093 0000 sts MesswertGier,r24 |
7838 .L576: |
7839 444e 8091 0000 lds r24,MesswertGier |
7840 4452 9091 0000 lds r25,(MesswertGier)+1 |
7841 4456 8050 subi r24,lo8(-4096) |
7842 4458 904F sbci r25,hi8(-4096) |
7843 445a 34F4 brge .L577 |
7844 445c 80E0 ldi r24,lo8(-4096) |
7845 445e 90EF ldi r25,hi8(-4096) |
7846 4460 9093 0000 sts (MesswertGier)+1,r25 |
7847 4464 8093 0000 sts MesswertGier,r24 |
7848 .L577: |
7849 4468 8091 0000 lds r24,BattLowVoltageWarning |
7850 446c 482F mov r20,r24 |
7851 446e 5527 clr r21 |
7852 4470 8091 0000 lds r24,UBat |
7853 4474 9091 0000 lds r25,(UBat)+1 |
7854 4478 4817 cp r20,r24 |
7855 447a 5907 cpc r21,r25 |
7856 447c 94F4 brge .L578 |
7857 447e 2091 0000 lds r18,UBat |
7858 4482 3091 0000 lds r19,(UBat)+1 |
7859 4486 68A1 ldd r22,Y+32 |
7860 4488 79A1 ldd r23,Y+33 |
7861 448a 649F mul r22,r20 |
7862 448c C001 movw r24,r0 |
7863 448e 659F mul r22,r21 |
7864 4490 900D add r25,r0 |
7865 4492 749F mul r23,r20 |
7866 4494 900D add r25,r0 |
7867 4496 1124 clr r1 |
7868 4498 B901 movw r22,r18 |
7869 449a 0E94 0000 call __udivmodhi4 |
7870 449e 79A3 std Y+33,r23 |
7871 44a0 68A3 std Y+32,r22 |
7872 .L578: |
7873 44a2 88A1 ldd r24,Y+32 |
7874 44a4 99A1 ldd r25,Y+33 |
7875 44a6 880F lsl r24 |
7876 44a8 991F rol r25 |
7877 44aa 880F lsl r24 |
7878 44ac 991F rol r25 |
7879 44ae 99A3 std Y+33,r25 |
7880 44b0 88A3 std Y+32,r24 |
7881 44b2 4091 0000 lds r20,EE_Parameter+13 |
7882 44b6 40FF sbrs r20,0 |
7883 44b8 A7C6 rjmp .L579 |
7884 44ba 9920 tst r9 |
7885 44bc 09F0 breq .+2 |
7886 44be A4C6 rjmp .L579 |
7887 44c0 7720 tst r7 |
7888 44c2 09F0 breq .+2 |
7889 44c4 A1C6 rjmp .L579 |
7890 44c6 CC24 clr r12 |
7891 44c8 DD24 clr r13 |
7892 44ca 4601 movw r8,r12 |
7893 44cc 8091 0000 lds r24,HoverGas |
7894 44d0 9091 0000 lds r25,(HoverGas)+1 |
7895 44d4 9093 0000 sts (DebugOut+44)+1,r25 |
7896 44d8 8093 0000 sts DebugOut+44,r24 |
7897 44dc 2091 0000 lds r18,BaroExpandActive |
7898 44e0 3091 0000 lds r19,(BaroExpandActive)+1 |
7899 44e4 2115 cp r18,__zero_reg__ |
7900 44e6 3105 cpc r19,__zero_reg__ |
7901 44e8 09F0 breq .+2 |
7902 44ea 3FC0 rjmp .L580 |
7903 44ec 8091 0000 lds r24,MessLuftdruck |
7904 44f0 9091 0000 lds r25,(MessLuftdruck)+1 |
7905 44f4 8959 subi r24,lo8(921) |
7906 44f6 9340 sbci r25,hi8(921) |
7907 44f8 58F0 brlo .L581 |
7908 44fa 87B5 in r24,71-0x20 |
7909 44fc 853F cpi r24,lo8(-11) |
7910 44fe 20F4 brsh .L582 |
7911 4500 8091 0000 lds r24,ExpandBaro |
7912 4504 8150 subi r24,lo8(-(-1)) |
7913 4506 11C0 rjmp .L787 |
7914 .L582: |
7915 4508 81E0 ldi r24,lo8(1) |
7916 450a 8093 0000 sts BaroAtLowerLimit.30,r24 |
7917 450e 4EC0 rjmp .L589 |
7918 .L581: |
7919 4510 8091 0000 lds r24,MessLuftdruck |
7920 4514 9091 0000 lds r25,(MessLuftdruck)+1 |
7921 4518 8436 cpi r24,100 |
7922 451a 9105 cpc r25,__zero_reg__ |
7923 451c 08F5 brsh .L585 |
7924 451e 87B5 in r24,71-0x20 |
7925 4520 8B30 cpi r24,lo8(11) |
7926 4522 D0F0 brlo .L586 |
7927 4524 8091 0000 lds r24,ExpandBaro |
7928 4528 8F5F subi r24,lo8(-(1)) |
7929 .L787: |
7930 452a 8093 0000 sts ExpandBaro,r24 |
7931 452e 9AE0 ldi r25,lo8(10) |
7932 4530 8902 muls r24,r25 |
7933 4532 9001 movw r18,r0 |
7934 4534 1124 clr r1 |
7935 4536 8091 0000 lds r24,DruckOffsetSetting |
7936 453a 821B sub r24,r18 |
7937 453c 87BD out 71-0x20,r24 |
7938 453e 8CE2 ldi r24,lo8(300) |
7939 4540 91E0 ldi r25,hi8(300) |
7940 4542 9093 0000 sts (beeptime)+1,r25 |
7941 4546 8093 0000 sts beeptime,r24 |
7942 454a 8EE5 ldi r24,lo8(350) |
7943 454c 91E0 ldi r25,hi8(350) |
7944 454e 9093 0000 sts (BaroExpandActive)+1,r25 |
7945 4552 8093 0000 sts BaroExpandActive,r24 |
7946 4556 2AC0 rjmp .L589 |
7947 .L586: |
7948 4558 81E0 ldi r24,lo8(1) |
7949 455a 8093 0000 sts BaroAtUpperLimit.29,r24 |
7950 455e 26C0 rjmp .L589 |
7951 .L585: |
7952 4560 7092 0000 sts BaroAtUpperLimit.29,r7 |
7953 4564 7092 0000 sts BaroAtLowerLimit.30,r7 |
7954 4568 21C0 rjmp .L589 |
7955 .L580: |
7956 456a 8091 0000 lds r24,HoehenWert |
7957 456e 9091 0000 lds r25,(HoehenWert)+1 |
7958 4572 A091 0000 lds r26,(HoehenWert)+2 |
7959 4576 B091 0000 lds r27,(HoehenWert)+3 |
7960 457a E4E0 ldi r30,4 |
7961 457c 880F 1: lsl r24 |
7962 457e 991F rol r25 |
7963 4580 AA1F rol r26 |
7964 4582 BB1F rol r27 |
7965 4584 EA95 dec r30 |
7966 4586 D1F7 brne 1b |
7967 4588 8093 0000 sts SummenHoehe,r24 |
7968 458c 9093 0000 sts (SummenHoehe)+1,r25 |
7969 4590 A093 0000 sts (SummenHoehe)+2,r26 |
7970 4594 B093 0000 sts (SummenHoehe)+3,r27 |
7971 4598 D092 0000 sts (VarioMeter)+1,r13 |
7972 459c C092 0000 sts VarioMeter,r12 |
7973 45a0 2150 subi r18,lo8(-(-1)) |
7974 45a2 3040 sbci r19,hi8(-(-1)) |
7975 45a4 3093 0000 sts (BaroExpandActive)+1,r19 |
7976 45a8 2093 0000 sts BaroExpandActive,r18 |
7977 .L589: |
7978 45ac 2091 0000 lds r18,Parameter_MaxHoehe |
7979 45b0 41FF sbrs r20,1 |
7980 45b2 24C0 rjmp .L590 |
7981 45b4 2233 cpi r18,lo8(50) |
7982 45b6 D8F4 brsh .L591 |
7983 45b8 8091 0000 lds r24,delay.28 |
7984 45bc 8150 subi r24,lo8(-(-1)) |
7985 45be 8093 0000 sts delay.28,r24 |
7986 45c2 8F3F cpi r24,lo8(-1) |
7987 45c4 D9F5 brne .L594 |
7988 45c6 1092 0000 sts HoehenReglerAktiv,__zero_reg__ |
7989 45ca 8091 0000 lds r24,HoehenWert |
7990 45ce 9091 0000 lds r25,(HoehenWert)+1 |
7991 45d2 A091 0000 lds r26,(HoehenWert)+2 |
7992 45d6 B091 0000 lds r27,(HoehenWert)+3 |
7993 45da 8093 0000 sts SollHoehe,r24 |
7994 45de 9093 0000 sts (SollHoehe)+1,r25 |
7995 45e2 A093 0000 sts (SollHoehe)+2,r26 |
7996 45e6 B093 0000 sts (SollHoehe)+3,r27 |
7997 45ea 81E0 ldi r24,lo8(1) |
7998 45ec 04C0 rjmp .L788 |
7999 .L591: |
8000 45ee 81E0 ldi r24,lo8(1) |
8001 45f0 8093 0000 sts HoehenReglerAktiv,r24 |
8002 45f4 88EC ldi r24,lo8(-56) |
8003 .L788: |
8004 45f6 8093 0000 sts delay.28,r24 |
8005 45fa 20C0 rjmp .L594 |
8006 .L590: |
8007 45fc 8091 0000 lds r24,ExternHoehenValue |
8008 4600 9091 0000 lds r25,(ExternHoehenValue)+1 |
8009 4604 820F add r24,r18 |
8010 4606 911D adc r25,__zero_reg__ |
8011 4608 2091 0000 lds r18,EE_Parameter+18 |
8012 460c 3327 clr r19 |
8013 460e 829F mul r24,r18 |
8014 4610 F001 movw r30,r0 |
8015 4612 839F mul r24,r19 |
8016 4614 F00D add r31,r0 |
8017 4616 929F mul r25,r18 |
8018 4618 F00D add r31,r0 |
8019 461a 1124 clr r1 |
8020 461c CF01 movw r24,r30 |
8021 461e AA27 clr r26 |
8022 4620 97FD sbrc r25,7 |
8023 4622 A095 com r26 |
8024 4624 BA2F mov r27,r26 |
8025 4626 8093 0000 sts SollHoehe,r24 |
8026 462a 9093 0000 sts (SollHoehe)+1,r25 |
8027 462e A093 0000 sts (SollHoehe)+2,r26 |
8028 4632 B093 0000 sts (SollHoehe)+3,r27 |
8029 4636 81E0 ldi r24,lo8(1) |
8030 4638 8093 0000 sts HoehenReglerAktiv,r24 |
8031 .L594: |
8032 463c 8091 0000 lds r24,IntegralNick |
8033 4640 9091 0000 lds r25,(IntegralNick)+1 |
8034 4644 A091 0000 lds r26,(IntegralNick)+2 |
8035 4648 B091 0000 lds r27,(IntegralNick)+3 |
8036 464c E090 0000 lds r14,GIER_GRAD_FAKTOR |
8037 4650 F090 0000 lds r15,(GIER_GRAD_FAKTOR)+1 |
8038 4654 0091 0000 lds r16,(GIER_GRAD_FAKTOR)+2 |
8039 4658 1091 0000 lds r17,(GIER_GRAD_FAKTOR)+3 |
8040 465c BC01 movw r22,r24 |
8041 465e CD01 movw r24,r26 |
8042 4660 A801 movw r20,r16 |
8043 4662 9701 movw r18,r14 |
8044 4664 0E94 0000 call __divmodsi4 |
8045 4668 5901 movw r10,r18 |
8046 466a 6A01 movw r12,r20 |
8047 466c 8091 0000 lds r24,IntegralRoll |
8048 4670 9091 0000 lds r25,(IntegralRoll)+1 |
8049 4674 A091 0000 lds r26,(IntegralRoll)+2 |
8050 4678 B091 0000 lds r27,(IntegralRoll)+3 |
8051 467c BC01 movw r22,r24 |
8052 467e CD01 movw r24,r26 |
8053 4680 A801 movw r20,r16 |
8054 4682 9701 movw r18,r14 |
8055 4684 0E94 0000 call __divmodsi4 |
8056 4688 B901 movw r22,r18 |
8057 468a C501 movw r24,r10 |
8058 468c 0E94 0000 call ihypot |
8059 4690 3C01 movw r6,r24 |
8060 4692 CC97 sbiw r24,60 |
8061 4694 1CF0 brlt .L595 |
8062 4696 7CE3 ldi r23,lo8(60) |
8063 4698 672E mov r6,r23 |
8064 469a 712C mov r7,__zero_reg__ |
8065 .L595: |
8066 469c C301 movw r24,r6 |
8067 469e 0E94 0000 call c_cos_8192 |
8068 46a2 3C01 movw r6,r24 |
8069 46a4 80E2 ldi r24,lo8(32) |
8070 46a6 8093 0000 sts VarioCharacter,r24 |
8071 46aa 8091 0000 lds r24,HoehenReglerAktiv |
8072 46ae 8823 tst r24 |
8073 46b0 09F4 brne .+2 |
8074 46b2 36C4 rjmp .L596 |
8075 46b4 8091 0000 lds r24,FCFlags |
8076 46b8 9927 clr r25 |
8077 46ba 9C01 movw r18,r24 |
8078 46bc 2071 andi r18,lo8(16) |
8079 46be 3070 andi r19,hi8(16) |
8080 46c0 84FD sbrc r24,4 |
8081 46c2 2EC4 rjmp .L596 |
8082 46c4 6091 0000 lds r22,EE_Parameter+99 |
8083 46c8 60FD sbrc r22,0 |
8084 46ca 04C0 rjmp .L598 |
8085 46cc 8091 0000 lds r24,EE_Parameter+13 |
8086 46d0 81FD sbrc r24,1 |
8087 46d2 07C0 rjmp .L597 |
8088 .L598: |
8089 46d4 08A1 ldd r16,Y+32 |
8090 46d6 19A1 ldd r17,Y+33 |
8091 46d8 3093 0000 sts (HeightTrimming.22)+1,r19 |
8092 46dc 2093 0000 sts HeightTrimming.22,r18 |
8093 46e0 97C1 rjmp .L599 |
8094 .L597: |
8095 46e2 8091 0000 lds r24,FCFlags |
8096 46e6 81FF sbrs r24,1 |
8097 46e8 69C1 rjmp .L600 |
8098 46ea 4091 0000 lds r20,StickGasHover.24 |
8099 46ee 5091 0000 lds r21,(StickGasHover.24)+1 |
8100 46f2 CA01 movw r24,r20 |
8101 46f4 0F96 adiw r24,15 |
8102 46f6 2091 0000 lds r18,StickGas |
8103 46fa 3091 0000 lds r19,(StickGas)+1 |
8104 46fe 8217 cp r24,r18 |
8105 4700 9307 cpc r25,r19 |
8106 4702 ACF5 brge .L601 |
8107 4704 8091 0000 lds r24,BaroAtUpperLimit.29 |
8108 4708 8823 tst r24 |
8109 470a 89F5 brne .L601 |
8110 470c 8091 0000 lds r24,HeightTrimmingFlag.31 |
8111 4710 81FF sbrs r24,1 |
8112 4712 13C0 rjmp .L602 |
8113 4714 8D7F andi r24,lo8(-3) |
8114 4716 8093 0000 sts HeightTrimmingFlag.31,r24 |
8115 471a 8091 0000 lds r24,HoehenWert |
8116 471e 9091 0000 lds r25,(HoehenWert)+1 |
8117 4722 A091 0000 lds r26,(HoehenWert)+2 |
8118 4726 B091 0000 lds r27,(HoehenWert)+3 |
8119 472a 8093 0000 sts SollHoehe,r24 |
8120 472e 9093 0000 sts (SollHoehe)+1,r25 |
8121 4732 A093 0000 sts (SollHoehe)+2,r26 |
8122 4736 B093 0000 sts (SollHoehe)+3,r27 |
8123 .L602: |
8124 473a 8091 0000 lds r24,HeightTrimmingFlag.31 |
8125 473e 8160 ori r24,lo8(1) |
8126 4740 8093 0000 sts HeightTrimmingFlag.31,r24 |
8127 4744 241B sub r18,r20 |
8128 4746 350B sbc r19,r21 |
8129 4748 2F50 subi r18,lo8(-(-15)) |
8130 474a 3040 sbci r19,hi8(-(-15)) |
8131 474c 37FF sbrs r19,7 |
8132 474e 03C0 rjmp .L603 |
8133 4750 3095 com r19 |
8134 4752 2195 neg r18 |
8135 4754 3F4F sbci r19,lo8(-1) |
8136 .L603: |
8137 4756 8091 0000 lds r24,HeightTrimming.22 |
8138 475a 9091 0000 lds r25,(HeightTrimming.22)+1 |
8139 475e 820F add r24,r18 |
8140 4760 931F adc r25,r19 |
8141 4762 9093 0000 sts (HeightTrimming.22)+1,r25 |
8142 4766 8093 0000 sts HeightTrimming.22,r24 |
8143 476a 8BE2 ldi r24,lo8(43) |
8144 476c 6EC0 rjmp .L789 |
8145 .L601: |
8146 476e CA01 movw r24,r20 |
8147 4770 0F97 sbiw r24,15 |
8148 4772 2817 cp r18,r24 |
8149 4774 3907 cpc r19,r25 |
8150 4776 ACF5 brge .L605 |
8151 4778 8091 0000 lds r24,BaroAtLowerLimit.30 |
8152 477c 8823 tst r24 |
8153 477e 89F5 brne .L605 |
8154 4780 8091 0000 lds r24,HeightTrimmingFlag.31 |
8155 4784 80FF sbrs r24,0 |
8156 4786 13C0 rjmp .L606 |
8157 4788 8E7F andi r24,lo8(-2) |
8158 478a 8093 0000 sts HeightTrimmingFlag.31,r24 |
8159 478e 8091 0000 lds r24,HoehenWert |
8160 4792 9091 0000 lds r25,(HoehenWert)+1 |
8161 4796 A091 0000 lds r26,(HoehenWert)+2 |
8162 479a B091 0000 lds r27,(HoehenWert)+3 |
8163 479e 8093 0000 sts SollHoehe,r24 |
8164 47a2 9093 0000 sts (SollHoehe)+1,r25 |
8165 47a6 A093 0000 sts (SollHoehe)+2,r26 |
8166 47aa B093 0000 sts (SollHoehe)+3,r27 |
8167 .L606: |
8168 47ae 8091 0000 lds r24,HeightTrimmingFlag.31 |
8169 47b2 8260 ori r24,lo8(2) |
8170 47b4 8093 0000 sts HeightTrimmingFlag.31,r24 |
8171 47b8 241B sub r18,r20 |
8172 47ba 350B sbc r19,r21 |
8173 47bc 215F subi r18,lo8(-(15)) |
8174 47be 3F4F sbci r19,hi8(-(15)) |
8175 47c0 37FF sbrs r19,7 |
8176 47c2 03C0 rjmp .L607 |
8177 47c4 3095 com r19 |
8178 47c6 2195 neg r18 |
8179 47c8 3F4F sbci r19,lo8(-1) |
8180 .L607: |
8181 47ca 8091 0000 lds r24,HeightTrimming.22 |
8182 47ce 9091 0000 lds r25,(HeightTrimming.22)+1 |
8183 47d2 821B sub r24,r18 |
8184 47d4 930B sbc r25,r19 |
8185 47d6 9093 0000 sts (HeightTrimming.22)+1,r25 |
8186 47da 8093 0000 sts HeightTrimming.22,r24 |
8187 47de 8DE2 ldi r24,lo8(45) |
8188 47e0 34C0 rjmp .L789 |
8189 .L605: |
8190 47e2 2091 0000 lds r18,HeightTrimmingFlag.31 |
8191 47e6 822F mov r24,r18 |
8192 47e8 9927 clr r25 |
8193 47ea 8370 andi r24,lo8(3) |
8194 47ec 9070 andi r25,hi8(3) |
8195 47ee 892B or r24,r25 |
8196 47f0 59F1 breq .L609 |
8197 47f2 2C7F andi r18,lo8(-4) |
8198 47f4 2093 0000 sts HeightTrimmingFlag.31,r18 |
8199 47f8 1092 0000 sts (HeightTrimming.22)+1,__zero_reg__ |
8200 47fc 1092 0000 sts HeightTrimming.22,__zero_reg__ |
8201 4800 2091 0000 lds r18,HoehenWert |
8202 4804 3091 0000 lds r19,(HoehenWert)+1 |
8203 4808 4091 0000 lds r20,(HoehenWert)+2 |
8204 480c 5091 0000 lds r21,(HoehenWert)+3 |
8205 4810 2093 0000 sts SollHoehe,r18 |
8206 4814 3093 0000 sts (SollHoehe)+1,r19 |
8207 4818 4093 0000 sts (SollHoehe)+2,r20 |
8208 481c 5093 0000 sts (SollHoehe)+3,r21 |
8209 4820 61FF sbrs r22,1 |
8210 4822 06C0 rjmp .L610 |
8211 4824 84EF ldi r24,lo8(500) |
8212 4826 91E0 ldi r25,hi8(500) |
8213 4828 9093 0000 sts (beeptime)+1,r25 |
8214 482c 8093 0000 sts beeptime,r24 |
8215 .L610: |
8216 4830 8091 0000 lds r24,StartTrigger |
8217 4834 8823 tst r24 |
8218 4836 41F4 brne .L609 |
8219 4838 2333 cpi r18,lo8(51) |
8220 483a 3105 cpc r19,__zero_reg__ |
8221 483c 4105 cpc r20,__zero_reg__ |
8222 483e 5105 cpc r21,__zero_reg__ |
8223 4840 1CF0 brlt .L609 |
8224 4842 81E0 ldi r24,lo8(1) |
8225 4844 8093 0000 sts StartTrigger,r24 |
8226 .L609: |
8227 4848 8DE3 ldi r24,lo8(61) |
8228 .L789: |
8229 484a 8093 0000 sts VarioCharacter,r24 |
8230 484e 2091 0000 lds r18,HeightTrimming.22 |
8231 4852 3091 0000 lds r19,(HeightTrimming.22)+1 |
8232 4856 C901 movw r24,r18 |
8233 4858 37FF sbrs r19,7 |
8234 485a 04C0 rjmp .L613 |
8235 485c 8827 clr r24 |
8236 485e 9927 clr r25 |
8237 4860 821B sub r24,r18 |
8238 4862 930B sbc r25,r19 |
8239 .L613: |
8240 4864 8150 subi r24,lo8(513) |
8241 4866 9240 sbci r25,hi8(513) |
8242 4868 0CF4 brge .+2 |
8243 486a 91C0 rjmp .L612 |
8244 486c 8091 0000 lds r24,EE_Parameter+18 |
8245 4870 9927 clr r25 |
8246 4872 289F mul r18,r24 |
8247 4874 A001 movw r20,r0 |
8248 4876 299F mul r18,r25 |
8249 4878 500D add r21,r0 |
8250 487a 389F mul r19,r24 |
8251 487c 500D add r21,r0 |
8252 487e 1124 clr r1 |
8253 4880 CA01 movw r24,r20 |
8254 4882 60E0 ldi r22,lo8(1280) |
8255 4884 75E0 ldi r23,hi8(1280) |
8256 4886 0E94 0000 call __divmodhi4 |
8257 488a CB01 movw r24,r22 |
8258 488c AA27 clr r26 |
8259 488e 97FD sbrc r25,7 |
8260 4890 A095 com r26 |
8261 4892 BA2F mov r27,r26 |
8262 4894 2091 0000 lds r18,SollHoehe |
8263 4898 3091 0000 lds r19,(SollHoehe)+1 |
8264 489c 4091 0000 lds r20,(SollHoehe)+2 |
8265 48a0 5091 0000 lds r21,(SollHoehe)+3 |
8266 48a4 280F add r18,r24 |
8267 48a6 391F adc r19,r25 |
8268 48a8 4A1F adc r20,r26 |
8269 48aa 5B1F adc r21,r27 |
8270 48ac 2093 0000 sts SollHoehe,r18 |
8271 48b0 3093 0000 sts (SollHoehe)+1,r19 |
8272 48b4 4093 0000 sts (SollHoehe)+2,r20 |
8273 48b8 5093 0000 sts (SollHoehe)+3,r21 |
8274 48bc 1092 0000 sts (HeightTrimming.22)+1,__zero_reg__ |
8275 48c0 1092 0000 sts HeightTrimming.22,__zero_reg__ |
8276 48c4 A090 0000 lds r10,HoehenWert |
8277 48c8 B090 0000 lds r11,(HoehenWert)+1 |
8278 48cc C090 0000 lds r12,(HoehenWert)+2 |
8279 48d0 D090 0000 lds r13,(HoehenWert)+3 |
8280 48d4 D601 movw r26,r12 |
8281 48d6 C501 movw r24,r10 |
8282 48d8 8050 subi r24,lo8(-(-1024)) |
8283 48da 9440 sbci r25,hi8(-(-1024)) |
8284 48dc A040 sbci r26,hlo8(-(-1024)) |
8285 48de B040 sbci r27,hhi8(-(-1024)) |
8286 48e0 8217 cp r24,r18 |
8287 48e2 9307 cpc r25,r19 |
8288 48e4 A407 cpc r26,r20 |
8289 48e6 B507 cpc r27,r21 |
8290 48e8 5CF4 brge .L790 |
8291 48ea D601 movw r26,r12 |
8292 48ec C501 movw r24,r10 |
8293 48ee 8050 subi r24,lo8(-(1024)) |
8294 48f0 9C4F sbci r25,hi8(-(1024)) |
8295 48f2 AF4F sbci r26,hlo8(-(1024)) |
8296 48f4 BF4F sbci r27,hhi8(-(1024)) |
8297 48f6 2817 cp r18,r24 |
8298 48f8 3907 cpc r19,r25 |
8299 48fa 4A07 cpc r20,r26 |
8300 48fc 5B07 cpc r21,r27 |
8301 48fe 44F0 brlt .L615 |
8302 .L790: |
8303 4900 8093 0000 sts SollHoehe,r24 |
8304 4904 9093 0000 sts (SollHoehe)+1,r25 |
8305 4908 A093 0000 sts (SollHoehe)+2,r26 |
8306 490c B093 0000 sts (SollHoehe)+3,r27 |
8307 .L615: |
8308 4910 8091 0000 lds r24,EE_Parameter+99 |
8309 4914 81FF sbrs r24,1 |
8310 4916 06C0 rjmp .L617 |
8311 4918 84E6 ldi r24,lo8(100) |
8312 491a 90E0 ldi r25,hi8(100) |
8313 491c 9093 0000 sts (beeptime)+1,r25 |
8314 4920 8093 0000 sts beeptime,r24 |
8315 .L617: |
8316 4924 8091 0000 lds r24,EE_Parameter+22 |
8317 4928 8823 tst r24 |
8318 492a 89F5 brne .L612 |
8319 492c 4091 0000 lds r20,HoverGas |
8320 4930 5091 0000 lds r21,(HoverGas)+1 |
8321 4934 57FF sbrs r21,7 |
8322 4936 02C0 rjmp .L619 |
8323 4938 4D5F subi r20,lo8(-(3)) |
8324 493a 5F4F sbci r21,hi8(-(3)) |
8325 .L619: |
8326 493c 5595 asr r21 |
8327 493e 4795 ror r20 |
8328 4940 5595 asr r21 |
8329 4942 4795 ror r20 |
8330 4944 8091 0000 lds r24,UBat |
8331 4948 9091 0000 lds r25,(UBat)+1 |
8332 494c 2091 0000 lds r18,BattLowVoltageWarning |
8333 4950 3327 clr r19 |
8334 4952 489F mul r20,r24 |
8335 4954 B001 movw r22,r0 |
8336 4956 499F mul r20,r25 |
8337 4958 700D add r23,r0 |
8338 495a 589F mul r21,r24 |
8339 495c 700D add r23,r0 |
8340 495e 1124 clr r1 |
8341 4960 CB01 movw r24,r22 |
8342 4962 B901 movw r22,r18 |
8343 4964 0E94 0000 call __divmodhi4 |
8344 4968 7093 0000 sts (StickGasHover.24)+1,r23 |
8345 496c 6093 0000 sts StickGasHover.24,r22 |
8346 4970 6634 cpi r22,70 |
8347 4972 7105 cpc r23,__zero_reg__ |
8348 4974 1CF4 brge .L620 |
8349 4976 86E4 ldi r24,lo8(70) |
8350 4978 90E0 ldi r25,hi8(70) |
8351 497a 05C0 rjmp .L791 |
8352 .L620: |
8353 497c 6739 cpi r22,151 |
8354 497e 7105 cpc r23,__zero_reg__ |
8355 4980 34F0 brlt .L612 |
8356 4982 86E9 ldi r24,lo8(150) |
8357 4984 90E0 ldi r25,hi8(150) |
8358 .L791: |
8359 4986 9093 0000 sts (StickGasHover.24)+1,r25 |
8360 498a 8093 0000 sts StickGasHover.24,r24 |
8361 .L612: |
8362 498e 8091 0000 lds r24,BaroExpandActive |
8363 4992 9091 0000 lds r25,(BaroExpandActive)+1 |
8364 4996 892B or r24,r25 |
8365 4998 B9F1 breq .L624 |
8366 499a 8091 0000 lds r24,HoehenWert |
8367 499e 9091 0000 lds r25,(HoehenWert)+1 |
8368 49a2 A091 0000 lds r26,(HoehenWert)+2 |
8369 49a6 B091 0000 lds r27,(HoehenWert)+3 |
8370 49aa 8093 0000 sts SollHoehe,r24 |
8371 49ae 9093 0000 sts (SollHoehe)+1,r25 |
8372 49b2 A093 0000 sts (SollHoehe)+2,r26 |
8373 49b6 B093 0000 sts (SollHoehe)+3,r27 |
8374 49ba 26C0 rjmp .L624 |
8375 .L600: |
8376 49bc 8091 0000 lds r24,HoehenWert |
8377 49c0 9091 0000 lds r25,(HoehenWert)+1 |
8378 49c4 A091 0000 lds r26,(HoehenWert)+2 |
8379 49c8 B091 0000 lds r27,(HoehenWert)+3 |
8380 49cc 8059 subi r24,lo8(-(-400)) |
8381 49ce 9140 sbci r25,hi8(-(-400)) |
8382 49d0 A040 sbci r26,hlo8(-(-400)) |
8383 49d2 B040 sbci r27,hhi8(-(-400)) |
8384 49d4 8093 0000 sts SollHoehe,r24 |
8385 49d8 9093 0000 sts (SollHoehe)+1,r25 |
8386 49dc A093 0000 sts (SollHoehe)+2,r26 |
8387 49e0 B093 0000 sts (SollHoehe)+3,r27 |
8388 49e4 8091 0000 lds r24,EE_Parameter+22 |
8389 49e8 8823 tst r24 |
8390 49ea 11F0 breq .L625 |
8391 49ec 9927 clr r25 |
8392 49ee 02C0 rjmp .L792 |
8393 .L625: |
8394 49f0 88E7 ldi r24,lo8(120) |
8395 49f2 90E0 ldi r25,hi8(120) |
8396 .L792: |
8397 49f4 9093 0000 sts (StickGasHover.24)+1,r25 |
8398 49f8 8093 0000 sts StickGasHover.24,r24 |
8399 49fc 88A1 ldd r24,Y+32 |
8400 49fe 99A1 ldd r25,Y+33 |
8401 4a00 9093 0000 sts (HoverGas)+1,r25 |
8402 4a04 8093 0000 sts HoverGas,r24 |
8403 .L624: |
8404 4a08 0091 0000 lds r16,HoverGas |
8405 4a0c 1091 0000 lds r17,(HoverGas)+1 |
8406 .L599: |
8407 4a10 A090 0000 lds r10,HoehenWert |
8408 4a14 B090 0000 lds r11,(HoehenWert)+1 |
8409 4a18 C090 0000 lds r12,(HoehenWert)+2 |
8410 4a1c D090 0000 lds r13,(HoehenWert)+3 |
8411 4a20 2091 0000 lds r18,SollHoehe |
8412 4a24 3091 0000 lds r19,(SollHoehe)+1 |
8413 4a28 4091 0000 lds r20,(SollHoehe)+2 |
8414 4a2c 5091 0000 lds r21,(SollHoehe)+3 |
8415 4a30 2A15 cp r18,r10 |
8416 4a32 3B05 cpc r19,r11 |
8417 4a34 4C05 cpc r20,r12 |
8418 4a36 5D05 cpc r21,r13 |
8419 4a38 24F0 brlt .L628 |
8420 4a3a 8091 0000 lds r24,EE_Parameter+99 |
8421 4a3e 80FD sbrc r24,0 |
8422 4a40 B1C2 rjmp .L686 |
8423 .L628: |
8424 4a42 8091 0000 lds r24,BaroExpandActive |
8425 4a46 9091 0000 lds r25,(BaroExpandActive)+1 |
8426 4a4a 892B or r24,r25 |
8427 4a4c 39F0 breq .L629 |
8428 4a4e 0091 0000 lds r16,HoverGas |
8429 4a52 1091 0000 lds r17,(HoverGas)+1 |
8430 4a56 CC24 clr r12 |
8431 4a58 DD24 clr r13 |
8432 4a5a D7C0 rjmp .L630 |
8433 .L629: |
8434 4a5c D601 movw r26,r12 |
8435 4a5e C501 movw r24,r10 |
8436 4a60 821B sub r24,r18 |
8437 4a62 930B sbc r25,r19 |
8438 4a64 A40B sbc r26,r20 |
8439 4a66 B50B sbc r27,r21 |
8440 4a68 8093 0000 sts tmp_long.1,r24 |
8441 4a6c 9093 0000 sts (tmp_long.1)+1,r25 |
8442 4a70 A093 0000 sts (tmp_long.1)+2,r26 |
8443 4a74 B093 0000 sts (tmp_long.1)+3,r27 |
8444 4a78 8230 cpi r24,lo8(-32766) |
8445 4a7a E0E8 ldi r30,hi8(-32766) |
8446 4a7c 9E07 cpc r25,r30 |
8447 4a7e EFEF ldi r30,hlo8(-32766) |
8448 4a80 AE07 cpc r26,r30 |
8449 4a82 EFEF ldi r30,hhi8(-32766) |
8450 4a84 BE07 cpc r27,r30 |
8451 4a86 2CF4 brge .L631 |
8452 4a88 81E0 ldi r24,lo8(-32767) |
8453 4a8a 90E8 ldi r25,hi8(-32767) |
8454 4a8c AFEF ldi r26,hlo8(-32767) |
8455 4a8e BFEF ldi r27,hhi8(-32767) |
8456 4a90 09C0 rjmp .L793 |
8457 .L631: |
8458 4a92 8F5F subi r24,lo8(32767) |
8459 4a94 9F47 sbci r25,hi8(32767) |
8460 4a96 A040 sbci r26,hlo8(32767) |
8461 4a98 B040 sbci r27,hhi8(32767) |
8462 4a9a 64F0 brlt .L632 |
8463 4a9c 8FEF ldi r24,lo8(32767) |
8464 4a9e 9FE7 ldi r25,hi8(32767) |
8465 4aa0 A0E0 ldi r26,hlo8(32767) |
8466 4aa2 B0E0 ldi r27,hhi8(32767) |
8467 .L793: |
8468 4aa4 8093 0000 sts tmp_long.1,r24 |
8469 4aa8 9093 0000 sts (tmp_long.1)+1,r25 |
8470 4aac A093 0000 sts (tmp_long.1)+2,r26 |
8471 4ab0 B093 0000 sts (tmp_long.1)+3,r27 |
8472 .L632: |
8473 4ab4 C090 0000 lds r12,tmp_long.1 |
8474 4ab8 D090 0000 lds r13,(tmp_long.1)+1 |
8475 4abc 8091 0000 lds r24,Parameter_Hoehe_P |
8476 4ac0 282F mov r18,r24 |
8477 4ac2 3327 clr r19 |
8478 4ac4 4427 clr r20 |
8479 4ac6 5527 clr r21 |
8480 4ac8 8091 0000 lds r24,tmp_long.1 |
8481 4acc 9091 0000 lds r25,(tmp_long.1)+1 |
8482 4ad0 A091 0000 lds r26,(tmp_long.1)+2 |
8483 4ad4 B091 0000 lds r27,(tmp_long.1)+3 |
8484 4ad8 BC01 movw r22,r24 |
8485 4ada CD01 movw r24,r26 |
8486 4adc 0E94 0000 call __mulsi3 |
8487 4ae0 97FF sbrs r25,7 |
8488 4ae2 04C0 rjmp .L634 |
8489 4ae4 615E subi r22,lo8(-(31)) |
8490 4ae6 7F4F sbci r23,hi8(-(31)) |
8491 4ae8 8F4F sbci r24,hlo8(-(31)) |
8492 4aea 9F4F sbci r25,hhi8(-(31)) |
8493 .L634: |
8494 4aec 55E0 ldi r21,5 |
8495 4aee 9595 1: asr r25 |
8496 4af0 8795 ror r24 |
8497 4af2 7795 ror r23 |
8498 4af4 6795 ror r22 |
8499 4af6 5A95 dec r21 |
8500 4af8 D1F7 brne 1b |
8501 4afa 6093 0000 sts tmp_long.1,r22 |
8502 4afe 7093 0000 sts (tmp_long.1)+1,r23 |
8503 4b02 8093 0000 sts (tmp_long.1)+2,r24 |
8504 4b06 9093 0000 sts (tmp_long.1)+3,r25 |
8505 4b0a 6530 cpi r22,lo8(-507) |
8506 4b0c 2EEF ldi r18,hi8(-507) |
8507 4b0e 7207 cpc r23,r18 |
8508 4b10 2FEF ldi r18,hlo8(-507) |
8509 4b12 8207 cpc r24,r18 |
8510 4b14 2FEF ldi r18,hhi8(-507) |
8511 4b16 9207 cpc r25,r18 |
8512 4b18 2CF4 brge .L635 |
8513 4b1a 84E0 ldi r24,lo8(-508) |
8514 4b1c 9EEF ldi r25,hi8(-508) |
8515 4b1e AFEF ldi r26,hlo8(-508) |
8516 4b20 BFEF ldi r27,hhi8(-508) |
8517 4b22 09C0 rjmp .L794 |
8518 .L635: |
8519 4b24 6050 subi r22,lo8(1024) |
8520 4b26 7440 sbci r23,hi8(1024) |
8521 4b28 8040 sbci r24,hlo8(1024) |
8522 4b2a 9040 sbci r25,hhi8(1024) |
8523 4b2c 64F0 brlt .L636 |
8524 4b2e 80E0 ldi r24,lo8(1024) |
8525 4b30 94E0 ldi r25,hi8(1024) |
8526 4b32 A0E0 ldi r26,hlo8(1024) |
8527 4b34 B0E0 ldi r27,hhi8(1024) |
8528 .L794: |
8529 4b36 8093 0000 sts tmp_long.1,r24 |
8530 4b3a 9093 0000 sts (tmp_long.1)+1,r25 |
8531 4b3e A093 0000 sts (tmp_long.1)+2,r26 |
8532 4b42 B093 0000 sts (tmp_long.1)+3,r27 |
8533 .L636: |
8534 4b46 8090 0000 lds r8,tmp_long.1 |
8535 4b4a 9090 0000 lds r9,(tmp_long.1)+1 |
8536 4b4e 2091 0000 lds r18,VarioMeter |
8537 4b52 3091 0000 lds r19,(VarioMeter)+1 |
8538 4b56 37FF sbrs r19,7 |
8539 4b58 02C0 rjmp .L638 |
8540 4b5a 295F subi r18,lo8(-(7)) |
8541 4b5c 3F4F sbci r19,hi8(-(7)) |
8542 .L638: |
8543 4b5e 43E0 ldi r20,3 |
8544 4b60 3595 1: asr r19 |
8545 4b62 2795 ror r18 |
8546 4b64 4A95 dec r20 |
8547 4b66 E1F7 brne 1b |
8548 4b68 4FEF ldi r20,hi8(-126) |
8549 4b6a 2238 cpi r18,lo8(-126) |
8550 4b6c 3407 cpc r19,r20 |
8551 4b6e 1CF4 brge .L639 |
8552 4b70 21E8 ldi r18,lo8(-127) |
8553 4b72 3FEF ldi r19,hi8(-127) |
8554 4b74 05C0 rjmp .L640 |
8555 .L639: |
8556 4b76 2038 cpi r18,128 |
8557 4b78 3105 cpc r19,__zero_reg__ |
8558 4b7a 14F0 brlt .L640 |
8559 4b7c 20E8 ldi r18,lo8(128) |
8560 4b7e 30E0 ldi r19,hi8(128) |
8561 .L640: |
8562 4b80 C901 movw r24,r18 |
8563 4b82 AA27 clr r26 |
8564 4b84 97FD sbrc r25,7 |
8565 4b86 A095 com r26 |
8566 4b88 BA2F mov r27,r26 |
8567 4b8a 2091 0000 lds r18,Parameter_Luftdruck_D |
8568 4b8e 3327 clr r19 |
8569 4b90 4427 clr r20 |
8570 4b92 5527 clr r21 |
8571 4b94 BC01 movw r22,r24 |
8572 4b96 CD01 movw r24,r26 |
8573 4b98 0E94 0000 call __mulsi3 |
8574 4b9c 97FF sbrs r25,7 |
8575 4b9e 04C0 rjmp .L642 |
8576 4ba0 6D5F subi r22,lo8(-(3)) |
8577 4ba2 7F4F sbci r23,hi8(-(3)) |
8578 4ba4 8F4F sbci r24,hlo8(-(3)) |
8579 4ba6 9F4F sbci r25,hhi8(-(3)) |
8580 .L642: |
8581 4ba8 22E0 ldi r18,2 |
8582 4baa 9595 1: asr r25 |
8583 4bac 8795 ror r24 |
8584 4bae 7795 ror r23 |
8585 4bb0 6795 ror r22 |
8586 4bb2 2A95 dec r18 |
8587 4bb4 D1F7 brne 1b |
8588 4bb6 9B01 movw r18,r22 |
8589 4bb8 5FEF ldi r21,hi8(-255) |
8590 4bba 6130 cpi r22,lo8(-255) |
8591 4bbc 7507 cpc r23,r21 |
8592 4bbe 1CF4 brge .L643 |
8593 4bc0 20E0 ldi r18,lo8(-256) |
8594 4bc2 3FEF ldi r19,hi8(-256) |
8595 4bc4 06C0 rjmp .L644 |
8596 .L643: |
8597 4bc6 6F3F cpi r22,255 |
8598 4bc8 7105 cpc r23,__zero_reg__ |
8599 4bca 19F0 breq .L644 |
8600 4bcc 14F0 brlt .L644 |
8601 4bce 20E0 ldi r18,lo8(256) |
8602 4bd0 31E0 ldi r19,hi8(256) |
8603 .L644: |
8604 4bd2 8091 0000 lds r24,HeightTrimmingFlag.31 |
8605 4bd6 8823 tst r24 |
8606 4bd8 49F0 breq .L646 |
8607 4bda C901 movw r24,r18 |
8608 4bdc 37FD sbrc r19,7 |
8609 4bde 0396 adiw r24,3 |
8610 .L647: |
8611 4be0 9C01 movw r18,r24 |
8612 4be2 3595 asr r19 |
8613 4be4 2795 ror r18 |
8614 4be6 3595 asr r19 |
8615 4be8 2795 ror r18 |
8616 4bea 0DC0 rjmp .L648 |
8617 .L646: |
8618 4bec 8091 0000 lds r24,EE_Parameter+99 |
8619 4bf0 80FF sbrs r24,0 |
8620 4bf2 09C0 rjmp .L648 |
8621 4bf4 C901 movw r24,r18 |
8622 4bf6 37FD sbrc r19,7 |
8623 4bf8 0796 adiw r24,7 |
8624 .L650: |
8625 4bfa 9C01 movw r18,r24 |
8626 4bfc A3E0 ldi r26,3 |
8627 4bfe 3595 1: asr r19 |
8628 4c00 2795 ror r18 |
8629 4c02 AA95 dec r26 |
8630 4c04 E1F7 brne 1b |
8631 .L648: |
8632 4c06 820E add r8,r18 |
8633 4c08 931E adc r9,r19 |
8634 .L630: |
8635 4c0a 2091 0000 lds r18,Parameter_Hoehe_ACC_Wirkung |
8636 4c0e 2223 tst r18 |
8637 4c10 09F4 brne .+2 |
8638 4c12 54C0 rjmp .L651 |
8639 4c14 6091 0000 lds r22,Mess_Integral_Hoch |
8640 4c18 7091 0000 lds r23,(Mess_Integral_Hoch)+1 |
8641 4c1c 8091 0000 lds r24,(Mess_Integral_Hoch)+2 |
8642 4c20 9091 0000 lds r25,(Mess_Integral_Hoch)+3 |
8643 4c24 97FF sbrs r25,7 |
8644 4c26 04C0 rjmp .L652 |
8645 4c28 6158 subi r22,lo8(-(127)) |
8646 4c2a 7F4F sbci r23,hi8(-(127)) |
8647 4c2c 8F4F sbci r24,hlo8(-(127)) |
8648 4c2e 9F4F sbci r25,hhi8(-(127)) |
8649 .L652: |
8650 4c30 F7E0 ldi r31,7 |
8651 4c32 9595 1: asr r25 |
8652 4c34 8795 ror r24 |
8653 4c36 7795 ror r23 |
8654 4c38 6795 ror r22 |
8655 4c3a FA95 dec r31 |
8656 4c3c D1F7 brne 1b |
8657 4c3e 3327 clr r19 |
8658 4c40 4427 clr r20 |
8659 4c42 5527 clr r21 |
8660 4c44 0E94 0000 call __mulsi3 |
8661 4c48 97FF sbrs r25,7 |
8662 4c4a 04C0 rjmp .L653 |
8663 4c4c 615E subi r22,lo8(-(31)) |
8664 4c4e 7F4F sbci r23,hi8(-(31)) |
8665 4c50 8F4F sbci r24,hlo8(-(31)) |
8666 4c52 9F4F sbci r25,hhi8(-(31)) |
8667 .L653: |
8668 4c54 E5E0 ldi r30,5 |
8669 4c56 9595 1: asr r25 |
8670 4c58 8795 ror r24 |
8671 4c5a 7795 ror r23 |
8672 4c5c 6795 ror r22 |
8673 4c5e EA95 dec r30 |
8674 4c60 D1F7 brne 1b |
8675 4c62 6093 0000 sts tmp_long.1,r22 |
8676 4c66 7093 0000 sts (tmp_long.1)+1,r23 |
8677 4c6a 8093 0000 sts (tmp_long.1)+2,r24 |
8678 4c6e 9093 0000 sts (tmp_long.1)+3,r25 |
8679 4c72 6138 cpi r22,lo8(-127) |
8680 4c74 AFEF ldi r26,hi8(-127) |
8681 4c76 7A07 cpc r23,r26 |
8682 4c78 AFEF ldi r26,hlo8(-127) |
8683 4c7a 8A07 cpc r24,r26 |
8684 4c7c AFEF ldi r26,hhi8(-127) |
8685 4c7e 9A07 cpc r25,r26 |
8686 4c80 2CF4 brge .L654 |
8687 4c82 80E8 ldi r24,lo8(-128) |
8688 4c84 9FEF ldi r25,hi8(-128) |
8689 4c86 AFEF ldi r26,hlo8(-128) |
8690 4c88 BFEF ldi r27,hhi8(-128) |
8691 4c8a 0AC0 rjmp .L795 |
8692 .L654: |
8693 4c8c 6F3F cpi r22,lo8(255) |
8694 4c8e 7105 cpc r23,__zero_reg__ |
8695 4c90 8105 cpc r24,__zero_reg__ |
8696 4c92 9105 cpc r25,__zero_reg__ |
8697 4c94 69F0 breq .L655 |
8698 4c96 64F0 brlt .L655 |
8699 4c98 80E0 ldi r24,lo8(256) |
8700 4c9a 91E0 ldi r25,hi8(256) |
8701 4c9c A0E0 ldi r26,hlo8(256) |
8702 4c9e B0E0 ldi r27,hhi8(256) |
8703 .L795: |
8704 4ca0 8093 0000 sts tmp_long.1,r24 |
8705 4ca4 9093 0000 sts (tmp_long.1)+1,r25 |
8706 4ca8 A093 0000 sts (tmp_long.1)+2,r26 |
8707 4cac B093 0000 sts (tmp_long.1)+3,r27 |
8708 .L655: |
8709 4cb0 8091 0000 lds r24,tmp_long.1 |
8710 4cb4 9091 0000 lds r25,(tmp_long.1)+1 |
8711 4cb8 880E add r8,r24 |
8712 4cba 991E adc r9,r25 |
8713 .L651: |
8714 4cbc 8091 0000 lds r24,Parameter_Hoehe_GPS_Z |
8715 4cc0 282F mov r18,r24 |
8716 4cc2 3327 clr r19 |
8717 4cc4 8091 0000 lds r24,FromNaviCtrl_Value+4 |
8718 4cc8 9927 clr r25 |
8719 4cca 87FD sbrc r24,7 |
8720 4ccc 9095 com r25 |
8721 4cce 289F mul r18,r24 |
8722 4cd0 F001 movw r30,r0 |
8723 4cd2 299F mul r18,r25 |
8724 4cd4 F00D add r31,r0 |
8725 4cd6 389F mul r19,r24 |
8726 4cd8 F00D add r31,r0 |
8727 4cda 1124 clr r1 |
8728 4cdc 9F01 movw r18,r30 |
8729 4cde F7FF sbrs r31,7 |
8730 4ce0 02C0 rjmp .L657 |
8731 4ce2 2158 subi r18,lo8(-(127)) |
8732 4ce4 3F4F sbci r19,hi8(-(127)) |
8733 .L657: |
8734 4ce6 220F lsl r18 |
8735 4ce8 232F mov r18,r19 |
8736 4cea 221F rol r18 |
8737 4cec 330B sbc r19,r19 |
8738 4cee FFEF ldi r31,hi8(-127) |
8739 4cf0 2138 cpi r18,lo8(-127) |
8740 4cf2 3F07 cpc r19,r31 |
8741 4cf4 1CF4 brge .L658 |
8742 4cf6 20E8 ldi r18,lo8(-128) |
8743 4cf8 3FEF ldi r19,hi8(-128) |
8744 4cfa 06C0 rjmp .L659 |
8745 .L658: |
8746 4cfc 2F3F cpi r18,255 |
8747 4cfe 3105 cpc r19,__zero_reg__ |
8748 4d00 19F0 breq .L659 |
8749 4d02 14F0 brlt .L659 |
8750 4d04 20E0 ldi r18,lo8(256) |
8751 4d06 31E0 ldi r19,hi8(256) |
8752 .L659: |
8753 4d08 820E add r8,r18 |
8754 4d0a 931E adc r9,r19 |
8755 4d0c C401 movw r24,r8 |
8756 4d0e AA27 clr r26 |
8757 4d10 97FD sbrc r25,7 |
8758 4d12 A095 com r26 |
8759 4d14 BA2F mov r27,r26 |
8760 4d16 E090 0000 lds r14,HoverGas |
8761 4d1a F090 0000 lds r15,(HoverGas)+1 |
8762 4d1e 9701 movw r18,r14 |
8763 4d20 4427 clr r20 |
8764 4d22 37FD sbrc r19,7 |
8765 4d24 4095 com r20 |
8766 4d26 542F mov r21,r20 |
8767 4d28 BC01 movw r22,r24 |
8768 4d2a CD01 movw r24,r26 |
8769 4d2c 0E94 0000 call __mulsi3 |
8770 4d30 97FF sbrs r25,7 |
8771 4d32 04C0 rjmp .L661 |
8772 4d34 6150 subi r22,lo8(-(511)) |
8773 4d36 7E4F sbci r23,hi8(-(511)) |
8774 4d38 8F4F sbci r24,hlo8(-(511)) |
8775 4d3a 9F4F sbci r25,hhi8(-(511)) |
8776 .L661: |
8777 4d3c 59E0 ldi r21,9 |
8778 4d3e 9595 1: asr r25 |
8779 4d40 8795 ror r24 |
8780 4d42 7795 ror r23 |
8781 4d44 6795 ror r22 |
8782 4d46 5A95 dec r21 |
8783 4d48 D1F7 brne 1b |
8784 4d4a 061B sub r16,r22 |
8785 4d4c 170B sbc r17,r23 |
8786 4d4e 8091 0000 lds r24,HeightTrimming.22 |
8787 4d52 9091 0000 lds r25,(HeightTrimming.22)+1 |
8788 4d56 892B or r24,r25 |
8789 4d58 09F0 breq .+2 |
8790 4d5a 60C0 rjmp .L662 |
8791 4d5c 1E14 cp __zero_reg__,r14 |
8792 4d5e 1F04 cpc __zero_reg__,r15 |
8793 4d60 0CF0 brlt .+2 |
8794 4d62 5CC0 rjmp .L662 |
8795 4d64 9601 movw r18,r12 |
8796 4d66 D7FE sbrs r13,7 |
8797 4d68 03C0 rjmp .L663 |
8798 4d6a 3095 com r19 |
8799 4d6c 2195 neg r18 |
8800 4d6e 3F4F sbci r19,lo8(-1) |
8801 .L663: |
8802 4d70 2D33 cpi r18,61 |
8803 4d72 3105 cpc r19,__zero_reg__ |
8804 4d74 40F4 brsh .L664 |
8805 4d76 8091 0000 lds r24,HoverGasMin.25 |
8806 4d7a 9091 0000 lds r25,(HoverGasMin.25)+1 |
8807 4d7e 8017 cp r24,r16 |
8808 4d80 9107 cpc r25,r17 |
8809 4d82 74F5 brge .L797 |
8810 4d84 26C0 rjmp .L806 |
8811 .L664: |
8812 4d86 2C53 subi r18,lo8(-(-60)) |
8813 4d88 3040 sbci r19,hi8(-(-60)) |
8814 4d8a 45E0 ldi r20,5 |
8815 4d8c 3695 1: lsr r19 |
8816 4d8e 2795 ror r18 |
8817 4d90 4A95 dec r20 |
8818 4d92 E1F7 brne 1b |
8819 4d94 2031 cpi r18,16 |
8820 4d96 3105 cpc r19,__zero_reg__ |
8821 4d98 10F0 brlo .L669 |
8822 4d9a 2FE0 ldi r18,lo8(15) |
8823 4d9c 30E0 ldi r19,hi8(15) |
8824 .L669: |
8825 4d9e 4091 0000 lds r20,HoverGasMin.25 |
8826 4da2 5091 0000 lds r21,(HoverGasMin.25)+1 |
8827 4da6 1C14 cp __zero_reg__,r12 |
8828 4da8 1D04 cpc __zero_reg__,r13 |
8829 4daa E4F4 brge .L670 |
8830 4dac 80E1 ldi r24,lo8(16) |
8831 4dae 90E0 ldi r25,hi8(16) |
8832 4db0 821B sub r24,r18 |
8833 4db2 930B sbc r25,r19 |
8834 4db4 489F mul r20,r24 |
8835 4db6 9001 movw r18,r0 |
8836 4db8 499F mul r20,r25 |
8837 4dba 300D add r19,r0 |
8838 4dbc 589F mul r21,r24 |
8839 4dbe 300D add r19,r0 |
8840 4dc0 1124 clr r1 |
8841 4dc2 94E0 ldi r25,4 |
8842 4dc4 3695 1: lsr r19 |
8843 4dc6 2795 ror r18 |
8844 4dc8 9A95 dec r25 |
8845 4dca E1F7 brne 1b |
8846 4dcc 2017 cp r18,r16 |
8847 4dce 3107 cpc r19,r17 |
8848 4dd0 20F5 brsh .L796 |
8849 .L806: |
8850 4dd2 8091 0000 lds r24,HoverGasMax.26 |
8851 4dd6 9091 0000 lds r25,(HoverGasMax.26)+1 |
8852 4dda 0817 cp r16,r24 |
8853 4ddc 1907 cpc r17,r25 |
8854 4dde F4F0 brlt .L662 |
8855 .L797: |
8856 4de0 8C01 movw r16,r24 |
8857 4de2 1CC0 rjmp .L662 |
8858 .L670: |
8859 4de4 205F subi r18,lo8(-(16)) |
8860 4de6 3F4F sbci r19,hi8(-(16)) |
8861 4de8 8091 0000 lds r24,HoverGasMax.26 |
8862 4dec 9091 0000 lds r25,(HoverGasMax.26)+1 |
8863 4df0 829F mul r24,r18 |
8864 4df2 B001 movw r22,r0 |
8865 4df4 839F mul r24,r19 |
8866 4df6 700D add r23,r0 |
8867 4df8 929F mul r25,r18 |
8868 4dfa 700D add r23,r0 |
8869 4dfc 1124 clr r1 |
8870 4dfe 9B01 movw r18,r22 |
8871 4e00 84E0 ldi r24,4 |
8872 4e02 3695 1: lsr r19 |
8873 4e04 2795 ror r18 |
8874 4e06 8A95 dec r24 |
8875 4e08 E1F7 brne 1b |
8876 4e0a 4017 cp r20,r16 |
8877 4e0c 5107 cpc r21,r17 |
8878 4e0e 14F0 brlt .L675 |
8879 4e10 8A01 movw r16,r20 |
8880 4e12 04C0 rjmp .L662 |
8881 .L675: |
8882 4e14 0217 cp r16,r18 |
8883 4e16 1307 cpc r17,r19 |
8884 4e18 08F0 brlo .L662 |
8885 .L796: |
8886 4e1a 8901 movw r16,r18 |
8887 .L662: |
8888 4e1c C801 movw r24,r16 |
8889 4e1e AA27 clr r26 |
8890 4e20 97FD sbrc r25,7 |
8891 4e22 A095 com r26 |
8892 4e24 BA2F mov r27,r26 |
8893 4e26 1DE0 ldi r17,13 |
8894 4e28 880F 1: lsl r24 |
8895 4e2a 991F rol r25 |
8896 4e2c AA1F rol r26 |
8897 4e2e BB1F rol r27 |
8898 4e30 1A95 dec r17 |
8899 4e32 D1F7 brne 1b |
8900 4e34 9301 movw r18,r6 |
8901 4e36 4427 clr r20 |
8902 4e38 37FD sbrc r19,7 |
8903 4e3a 4095 com r20 |
8904 4e3c 542F mov r21,r20 |
8905 4e3e BC01 movw r22,r24 |
8906 4e40 CD01 movw r24,r26 |
8907 4e42 0E94 0000 call __divmodsi4 |
8908 4e46 2093 0000 sts tmp_long2.2,r18 |
8909 4e4a 3093 0000 sts (tmp_long2.2)+1,r19 |
8910 4e4e 4093 0000 sts (tmp_long2.2)+2,r20 |
8911 4e52 5093 0000 sts (tmp_long2.2)+3,r21 |
8912 4e56 0091 0000 lds r16,tmp_long2.2 |
8913 4e5a 1091 0000 lds r17,(tmp_long2.2)+1 |
8914 4e5e 8091 0000 lds r24,FilterHCGas.23 |
8915 4e62 9091 0000 lds r25,(FilterHCGas.23)+1 |
8916 4e66 9C01 movw r18,r24 |
8917 4e68 220F lsl r18 |
8918 4e6a 331F rol r19 |
8919 4e6c 280F add r18,r24 |
8920 4e6e 391F adc r19,r25 |
8921 4e70 200F add r18,r16 |
8922 4e72 311F adc r19,r17 |
8923 4e74 37FF sbrs r19,7 |
8924 4e76 02C0 rjmp .L678 |
8925 4e78 2D5F subi r18,lo8(-(3)) |
8926 4e7a 3F4F sbci r19,hi8(-(3)) |
8927 .L678: |
8928 4e7c A901 movw r20,r18 |
8929 4e7e 5595 asr r21 |
8930 4e80 4795 ror r20 |
8931 4e82 5595 asr r21 |
8932 4e84 4795 ror r20 |
8933 4e86 5093 0000 sts (FilterHCGas.23)+1,r21 |
8934 4e8a 4093 0000 sts FilterHCGas.23,r20 |
8935 4e8e 8091 0000 lds r24,EE_Parameter+14 |
8936 4e92 282F mov r18,r24 |
8937 4e94 3327 clr r19 |
8938 4e96 220F lsl r18 |
8939 4e98 331F rol r19 |
8940 4e9a 220F lsl r18 |
8941 4e9c 331F rol r19 |
8942 4e9e 2417 cp r18,r20 |
8943 4ea0 3507 cpc r19,r21 |
8944 4ea2 6CF4 brge .L798 |
8945 4ea4 8091 0000 lds r24,MAX_GAS |
8946 4ea8 282F mov r18,r24 |
8947 4eaa 3327 clr r19 |
8948 4eac 220F lsl r18 |
8949 4eae 331F rol r19 |
8950 4eb0 220F lsl r18 |
8951 4eb2 331F rol r19 |
8952 4eb4 2055 subi r18,lo8(-(-80)) |
8953 4eb6 3040 sbci r19,hi8(-(-80)) |
8954 4eb8 4217 cp r20,r18 |
8955 4eba 5307 cpc r21,r19 |
8956 4ebc 24F0 brlt .L680 |
8957 .L798: |
8958 4ebe 3093 0000 sts (FilterHCGas.23)+1,r19 |
8959 4ec2 2093 0000 sts FilterHCGas.23,r18 |
8960 .L680: |
8961 4ec6 8091 0000 lds r24,EE_Parameter+99 |
8962 4eca 80FF sbrs r24,0 |
8963 4ecc 14C0 rjmp .L682 |
8964 4ece 8091 0000 lds r24,FilterHCGas.23 |
8965 4ed2 9091 0000 lds r25,(FilterHCGas.23)+1 |
8966 4ed6 A8A1 ldd r26,Y+32 |
8967 4ed8 B9A1 ldd r27,Y+33 |
8968 4eda 8A17 cp r24,r26 |
8969 4edc 9B07 cpc r25,r27 |
8970 4ede 24F0 brlt .L683 |
8971 4ee0 B093 0000 sts (FilterHCGas.23)+1,r27 |
8972 4ee4 A093 0000 sts FilterHCGas.23,r26 |
8973 .L683: |
8974 4ee8 E091 0000 lds r30,FilterHCGas.23 |
8975 4eec F091 0000 lds r31,(FilterHCGas.23)+1 |
8976 4ef0 F9A3 std Y+33,r31 |
8977 4ef2 E8A3 std Y+32,r30 |
8978 4ef4 57C0 rjmp .L686 |
8979 .L682: |
8980 4ef6 28A1 ldd r18,Y+32 |
8981 4ef8 39A1 ldd r19,Y+33 |
8982 4efa 2E19 sub r18,r14 |
8983 4efc 3F09 sbc r19,r15 |
8984 4efe 37FF sbrs r19,7 |
8985 4f00 02C0 rjmp .L685 |
8986 4f02 2D5F subi r18,lo8(-(3)) |
8987 4f04 3F4F sbci r19,hi8(-(3)) |
8988 .L685: |
8989 4f06 3595 asr r19 |
8990 4f08 2795 ror r18 |
8991 4f0a 3595 asr r19 |
8992 4f0c 2795 ror r18 |
8993 4f0e E090 0000 lds r14,FilterHCGas.23 |
8994 4f12 F090 0000 lds r15,(FilterHCGas.23)+1 |
8995 4f16 E20E add r14,r18 |
8996 4f18 F31E adc r15,r19 |
8997 4f1a F9A2 std Y+33,r15 |
8998 4f1c E8A2 std Y+32,r14 |
8999 4f1e 42C0 rjmp .L686 |
9000 .L596: |
9001 4f20 8091 0000 lds r24,EE_Parameter+22 |
9002 4f24 8823 tst r24 |
9003 4f26 01F5 brne .L687 |
9004 4f28 6091 0000 lds r22,HoverGas |
9005 4f2c 7091 0000 lds r23,(HoverGas)+1 |
9006 4f30 77FF sbrs r23,7 |
9007 4f32 02C0 rjmp .L688 |
9008 4f34 6D5F subi r22,lo8(-(3)) |
9009 4f36 7F4F sbci r23,hi8(-(3)) |
9010 .L688: |
9011 4f38 7595 asr r23 |
9012 4f3a 6795 ror r22 |
9013 4f3c 7595 asr r23 |
9014 4f3e 6795 ror r22 |
9015 4f40 4091 0000 lds r20,UBat |
9016 4f44 5091 0000 lds r21,(UBat)+1 |
9017 4f48 8091 0000 lds r24,BattLowVoltageWarning |
9018 4f4c 282F mov r18,r24 |
9019 4f4e 3327 clr r19 |
9020 4f50 649F mul r22,r20 |
9021 4f52 C001 movw r24,r0 |
9022 4f54 659F mul r22,r21 |
9023 4f56 900D add r25,r0 |
9024 4f58 749F mul r23,r20 |
9025 4f5a 900D add r25,r0 |
9026 4f5c 1124 clr r1 |
9027 4f5e B901 movw r22,r18 |
9028 4f60 0E94 0000 call __divmodhi4 |
9029 4f64 CB01 movw r24,r22 |
9030 4f66 01C0 rjmp .L799 |
9031 .L687: |
9032 4f68 9927 clr r25 |
9033 .L799: |
9034 4f6a 9093 0000 sts (StickGasHover.24)+1,r25 |
9035 4f6e 8093 0000 sts StickGasHover.24,r24 |
9036 4f72 8091 0000 lds r24,StickGasHover.24 |
9037 4f76 9091 0000 lds r25,(StickGasHover.24)+1 |
9038 4f7a 8734 cpi r24,71 |
9039 4f7c 9105 cpc r25,__zero_reg__ |
9040 4f7e 1CF4 brge .L690 |
9041 4f80 86E4 ldi r24,lo8(70) |
9042 4f82 90E0 ldi r25,hi8(70) |
9043 4f84 05C0 rjmp .L800 |
9044 .L690: |
9045 4f86 8639 cpi r24,150 |
9046 4f88 9105 cpc r25,__zero_reg__ |
9047 4f8a 34F0 brlt .L691 |
9048 4f8c 86E9 ldi r24,lo8(150) |
9049 4f8e 90E0 ldi r25,hi8(150) |
9050 .L800: |
9051 4f90 9093 0000 sts (StickGasHover.24)+1,r25 |
9052 4f94 8093 0000 sts StickGasHover.24,r24 |
9053 .L691: |
9054 4f98 08A1 ldd r16,Y+32 |
9055 4f9a 19A1 ldd r17,Y+33 |
9056 4f9c 1093 0000 sts (FilterHCGas.23)+1,r17 |
9057 4fa0 0093 0000 sts FilterHCGas.23,r16 |
9058 .L686: |
9059 4fa4 8091 0000 lds r24,FCFlags |
9060 4fa8 9927 clr r25 |
9061 4faa 9C01 movw r18,r24 |
9062 4fac 2270 andi r18,lo8(2) |
9063 4fae 3070 andi r19,hi8(2) |
9064 4fb0 81FF sbrs r24,1 |
9065 4fb2 1CC1 rjmp .L693 |
9066 4fb4 8091 0000 lds r24,HoverGasFilter.27 |
9067 4fb8 9091 0000 lds r25,(HoverGasFilter.27)+1 |
9068 4fbc A091 0000 lds r26,(HoverGasFilter.27)+2 |
9069 4fc0 B091 0000 lds r27,(HoverGasFilter.27)+3 |
9070 4fc4 0097 sbiw r24,0 |
9071 4fc6 A105 cpc r26,__zero_reg__ |
9072 4fc8 B105 cpc r27,__zero_reg__ |
9073 4fca 21F0 breq .L695 |
9074 4fcc 8091 0000 lds r24,StartTrigger |
9075 4fd0 8130 cpi r24,lo8(1) |
9076 4fd2 B1F4 brne .L694 |
9077 .L695: |
9078 4fd4 28A1 ldd r18,Y+32 |
9079 4fd6 39A1 ldd r19,Y+33 |
9080 4fd8 C901 movw r24,r18 |
9081 4fda AA27 clr r26 |
9082 4fdc 97FD sbrc r25,7 |
9083 4fde A095 com r26 |
9084 4fe0 BA2F mov r27,r26 |
9085 4fe2 2EE0 ldi r18,14 |
9086 4fe4 880F 1: lsl r24 |
9087 4fe6 991F rol r25 |
9088 4fe8 AA1F rol r26 |
9089 4fea BB1F rol r27 |
9090 4fec 2A95 dec r18 |
9091 4fee D1F7 brne 1b |
9092 4ff0 8093 0000 sts HoverGasFilter.27,r24 |
9093 4ff4 9093 0000 sts (HoverGasFilter.27)+1,r25 |
9094 4ff8 A093 0000 sts (HoverGasFilter.27)+2,r26 |
9095 4ffc B093 0000 sts (HoverGasFilter.27)+3,r27 |
9096 .L694: |
9097 5000 8091 0000 lds r24,StartTrigger |
9098 5004 8130 cpi r24,lo8(1) |
9099 5006 19F4 brne .L696 |
9100 5008 82E0 ldi r24,lo8(2) |
9101 500a 8093 0000 sts StartTrigger,r24 |
9102 .L696: |
9103 500e 48A1 ldd r20,Y+32 |
9104 5010 59A1 ldd r21,Y+33 |
9105 5012 CA01 movw r24,r20 |
9106 5014 AA27 clr r26 |
9107 5016 97FD sbrc r25,7 |
9108 5018 A095 com r26 |
9109 501a BA2F mov r27,r26 |
9110 501c 9301 movw r18,r6 |
9111 501e 4427 clr r20 |
9112 5020 37FD sbrc r19,7 |
9113 5022 4095 com r20 |
9114 5024 542F mov r21,r20 |
9115 5026 BC01 movw r22,r24 |
9116 5028 CD01 movw r24,r26 |
9117 502a 0E94 0000 call __mulsi3 |
9118 502e DC01 movw r26,r24 |
9119 5030 CB01 movw r24,r22 |
9120 5032 8093 0000 sts tmp_long2.2,r24 |
9121 5036 9093 0000 sts (tmp_long2.2)+1,r25 |
9122 503a A093 0000 sts (tmp_long2.2)+2,r26 |
9123 503e B093 0000 sts (tmp_long2.2)+3,r27 |
9124 5042 B7FF sbrs r27,7 |
9125 5044 04C0 rjmp .L697 |
9126 5046 8150 subi r24,lo8(-(8191)) |
9127 5048 904E sbci r25,hi8(-(8191)) |
9128 504a AF4F sbci r26,hlo8(-(8191)) |
9129 504c BF4F sbci r27,hhi8(-(8191)) |
9130 .L697: |
9131 504e 5C01 movw r10,r24 |
9132 5050 6D01 movw r12,r26 |
9133 5052 8DE0 ldi r24,13 |
9134 5054 D594 1: asr r13 |
9135 5056 C794 ror r12 |
9136 5058 B794 ror r11 |
9137 505a A794 ror r10 |
9138 505c 8A95 dec r24 |
9139 505e D1F7 brne 1b |
9140 5060 A092 0000 sts tmp_long2.2,r10 |
9141 5064 B092 0000 sts (tmp_long2.2)+1,r11 |
9142 5068 C092 0000 sts (tmp_long2.2)+2,r12 |
9143 506c D092 0000 sts (tmp_long2.2)+3,r13 |
9144 5070 6091 0000 lds r22,modell_fliegt |
9145 5074 7091 0000 lds r23,(modell_fliegt)+1 |
9146 5078 5FE0 ldi r21,hi8(4000) |
9147 507a 603A cpi r22,lo8(4000) |
9148 507c 7507 cpc r23,r21 |
9149 507e 50F5 brsh .L698 |
9150 5080 8091 0000 lds r24,HoverGasFilter.27 |
9151 5084 9091 0000 lds r25,(HoverGasFilter.27)+1 |
9152 5088 A091 0000 lds r26,(HoverGasFilter.27)+2 |
9153 508c B091 0000 lds r27,(HoverGasFilter.27)+3 |
9154 5090 9C01 movw r18,r24 |
9155 5092 AD01 movw r20,r26 |
9156 5094 0AE0 ldi r16,10 |
9157 5096 5695 1: lsr r21 |
9158 5098 4795 ror r20 |
9159 509a 3795 ror r19 |
9160 509c 2795 ror r18 |
9161 509e 0A95 dec r16 |
9162 50a0 D1F7 brne 1b |
9163 50a2 821B sub r24,r18 |
9164 50a4 930B sbc r25,r19 |
9165 50a6 A40B sbc r26,r20 |
9166 50a8 B50B sbc r27,r21 |
9167 50aa A601 movw r20,r12 |
9168 50ac 9501 movw r18,r10 |
9169 50ae 14E0 ldi r17,4 |
9170 50b0 220F 1: lsl r18 |
9171 50b2 331F rol r19 |
9172 50b4 441F rol r20 |
9173 50b6 551F rol r21 |
9174 50b8 1A95 dec r17 |
9175 50ba D1F7 brne 1b |
9176 50bc 820F add r24,r18 |
9177 50be 931F adc r25,r19 |
9178 50c0 A41F adc r26,r20 |
9179 50c2 B51F adc r27,r21 |
9180 50c4 8093 0000 sts HoverGasFilter.27,r24 |
9181 50c8 9093 0000 sts (HoverGasFilter.27)+1,r25 |
9182 50cc A093 0000 sts (HoverGasFilter.27)+2,r26 |
9183 50d0 B093 0000 sts (HoverGasFilter.27)+3,r27 |
9184 .L698: |
9185 50d4 6054 subi r22,lo8(8000) |
9186 50d6 7F41 sbci r23,hi8(8000) |
9187 50d8 18F5 brsh .L699 |
9188 50da 8091 0000 lds r24,HoverGasFilter.27 |
9189 50de 9091 0000 lds r25,(HoverGasFilter.27)+1 |
9190 50e2 A091 0000 lds r26,(HoverGasFilter.27)+2 |
9191 50e6 B091 0000 lds r27,(HoverGasFilter.27)+3 |
9192 50ea 9C01 movw r18,r24 |
9193 50ec AD01 movw r20,r26 |
9194 50ee FCE0 ldi r31,12 |
9195 50f0 5695 1: lsr r21 |
9196 50f2 4795 ror r20 |
9197 50f4 3795 ror r19 |
9198 50f6 2795 ror r18 |
9199 50f8 FA95 dec r31 |
9200 50fa D1F7 brne 1b |
9201 50fc 821B sub r24,r18 |
9202 50fe 930B sbc r25,r19 |
9203 5100 A40B sbc r26,r20 |
9204 5102 B50B sbc r27,r21 |
9205 5104 A601 movw r20,r12 |
9206 5106 9501 movw r18,r10 |
9207 5108 E2E0 ldi r30,2 |
9208 510a 220F 1: lsl r18 |
9209 510c 331F rol r19 |
9210 510e 441F rol r20 |
9211 5110 551F rol r21 |
9212 5112 EA95 dec r30 |
9213 5114 D1F7 brne 1b |
9214 5116 820F add r24,r18 |
9215 5118 931F adc r25,r19 |
9216 511a A41F adc r26,r20 |
9217 511c B51F adc r27,r21 |
9218 511e 29C0 rjmp .L801 |
9219 .L699: |
9220 5120 8091 0000 lds r24,VarioMeter |
9221 5124 9091 0000 lds r25,(VarioMeter)+1 |
9222 5128 8091 0000 lds r24,VarioMeter |
9223 512c 9091 0000 lds r25,(VarioMeter)+1 |
9224 5130 97FF sbrs r25,7 |
9225 5132 03C0 rjmp .L702 |
9226 5134 9095 com r25 |
9227 5136 8195 neg r24 |
9228 5138 9F4F sbci r25,lo8(-1) |
9229 .L702: |
9230 513a 8436 cpi r24,100 |
9231 513c 9105 cpc r25,__zero_reg__ |
9232 513e 0CF5 brge .L700 |
9233 5140 8091 0000 lds r24,HoverGasFilter.27 |
9234 5144 9091 0000 lds r25,(HoverGasFilter.27)+1 |
9235 5148 A091 0000 lds r26,(HoverGasFilter.27)+2 |
9236 514c B091 0000 lds r27,(HoverGasFilter.27)+3 |
9237 5150 9C01 movw r18,r24 |
9238 5152 AD01 movw r20,r26 |
9239 5154 7EE0 ldi r23,14 |
9240 5156 5695 1: lsr r21 |
9241 5158 4795 ror r20 |
9242 515a 3795 ror r19 |
9243 515c 2795 ror r18 |
9244 515e 7A95 dec r23 |
9245 5160 D1F7 brne 1b |
9246 5162 821B sub r24,r18 |
9247 5164 930B sbc r25,r19 |
9248 5166 A40B sbc r26,r20 |
9249 5168 B50B sbc r27,r21 |
9250 516a 8A0D add r24,r10 |
9251 516c 9B1D adc r25,r11 |
9252 516e AC1D adc r26,r12 |
9253 5170 BD1D adc r27,r13 |
9254 .L801: |
9255 5172 8093 0000 sts HoverGasFilter.27,r24 |
9256 5176 9093 0000 sts (HoverGasFilter.27)+1,r25 |
9257 517a A093 0000 sts (HoverGasFilter.27)+2,r26 |
9258 517e B093 0000 sts (HoverGasFilter.27)+3,r27 |
9259 .L700: |
9260 5182 8091 0000 lds r24,HoverGasFilter.27 |
9261 5186 9091 0000 lds r25,(HoverGasFilter.27)+1 |
9262 518a A091 0000 lds r26,(HoverGasFilter.27)+2 |
9263 518e B091 0000 lds r27,(HoverGasFilter.27)+3 |
9264 5192 6EE0 ldi r22,14 |
9265 5194 B695 1: lsr r27 |
9266 5196 A795 ror r26 |
9267 5198 9795 ror r25 |
9268 519a 8795 ror r24 |
9269 519c 6A95 dec r22 |
9270 519e D1F7 brne 1b |
9271 51a0 9093 0000 sts (HoverGas)+1,r25 |
9272 51a4 8093 0000 sts HoverGas,r24 |
9273 51a8 4091 0000 lds r20,EE_Parameter+20 |
9274 51ac 4423 tst r20 |
9275 51ae 99F0 breq .L703 |
9276 51b0 5527 clr r21 |
9277 51b2 9C01 movw r18,r24 |
9278 51b4 BA01 movw r22,r20 |
9279 51b6 0E94 0000 call __divmodhi4 |
9280 51ba C901 movw r24,r18 |
9281 51bc 861B sub r24,r22 |
9282 51be 970B sbc r25,r23 |
9283 51c0 9093 0000 sts (HoverGasMin.25)+1,r25 |
9284 51c4 8093 0000 sts HoverGasMin.25,r24 |
9285 51c8 260F add r18,r22 |
9286 51ca 371F adc r19,r23 |
9287 51cc 3093 0000 sts (HoverGasMax.26)+1,r19 |
9288 51d0 2093 0000 sts HoverGasMax.26,r18 |
9289 51d4 19C0 rjmp .L579 |
9290 .L703: |
9291 51d6 1092 0000 sts (HoverGasMin.25)+1,__zero_reg__ |
9292 51da 1092 0000 sts HoverGasMin.25,__zero_reg__ |
9293 51de 8FEF ldi r24,lo8(1023) |
9294 51e0 93E0 ldi r25,hi8(1023) |
9295 51e2 9093 0000 sts (HoverGasMax.26)+1,r25 |
9296 51e6 8093 0000 sts HoverGasMax.26,r24 |
9297 51ea 0EC0 rjmp .L579 |
9298 .L693: |
9299 51ec 1092 0000 sts StartTrigger,__zero_reg__ |
9300 51f0 1092 0000 sts HoverGasFilter.27,__zero_reg__ |
9301 51f4 1092 0000 sts (HoverGasFilter.27)+1,__zero_reg__ |
9302 51f8 1092 0000 sts (HoverGasFilter.27)+2,__zero_reg__ |
9303 51fc 1092 0000 sts (HoverGasFilter.27)+3,__zero_reg__ |
9304 5200 3093 0000 sts (HoverGas)+1,r19 |
9305 5204 2093 0000 sts HoverGas,r18 |
9306 .L579: |
9307 5208 9091 0000 lds r25,MIN_GAS |
9308 520c 98AB std Y+48,r25 |
9309 520e 292F mov r18,r25 |
9310 5210 3327 clr r19 |
9311 5212 220F lsl r18 |
9312 5214 331F rol r19 |
9313 5216 220F lsl r18 |
9314 5218 331F rol r19 |
9315 521a 285D subi r18,lo8(-(40)) |
9316 521c 3F4F sbci r19,hi8(-(40)) |
9317 521e A8A1 ldd r26,Y+32 |
9318 5220 B9A1 ldd r27,Y+33 |
9319 5222 2A17 cp r18,r26 |
9320 5224 3B07 cpc r19,r27 |
9321 5226 14F0 brlt .L706 |
9322 5228 39A3 std Y+33,r19 |
9323 522a 28A3 std Y+32,r18 |
9324 .L706: |
9325 522c B091 0000 lds r27,MAX_GAS |
9326 5230 B9AB std Y+49,r27 |
9327 5232 8B2F mov r24,r27 |
9328 5234 9927 clr r25 |
9329 5236 880F lsl r24 |
9330 5238 991F rol r25 |
9331 523a 880F lsl r24 |
9332 523c 991F rol r25 |
9333 523e 8055 subi r24,lo8(-(-80)) |
9334 5240 9040 sbci r25,hi8(-(-80)) |
9335 5242 E8A1 ldd r30,Y+32 |
9336 5244 F9A1 ldd r31,Y+33 |
9337 5246 8E17 cp r24,r30 |
9338 5248 9F07 cpc r25,r31 |
9339 524a 14F4 brge .L707 |
9340 524c 99A3 std Y+33,r25 |
9341 524e 88A3 std Y+32,r24 |
9342 .L707: |
9343 5250 8091 0000 lds r24,MissingMotor |
9344 5254 8823 tst r24 |
9345 5256 21F4 brne .L709 |
9346 5258 8091 0000 lds r24,Capacity+6 |
9347 525c 8F3F cpi r24,lo8(-1) |
9348 525e A1F0 breq .L708 |
9349 .L709: |
9350 5260 8091 0000 lds r24,modell_fliegt |
9351 5264 9091 0000 lds r25,(modell_fliegt)+1 |
9352 5268 0297 sbiw r24,2 |
9353 526a C097 sbiw r24,48 |
9354 526c 68F4 brsh .L708 |
9355 526e E8A0 ldd r14,Y+32 |
9356 5270 F9A0 ldd r15,Y+33 |
9357 5272 1E14 cp __zero_reg__,r14 |
9358 5274 1F04 cpc __zero_reg__,r15 |
9359 5276 44F4 brge .L708 |
9360 5278 81E0 ldi r24,lo8(1) |
9361 527a 90E0 ldi r25,hi8(1) |
9362 527c 9093 0000 sts (modell_fliegt)+1,r25 |
9363 5280 8093 0000 sts modell_fliegt,r24 |
9364 5284 39A3 std Y+33,r19 |
9365 5286 28A3 std Y+32,r18 |
9366 .L708: |
9367 5288 08A1 ldd r16,Y+32 |
9368 528a 19A1 ldd r17,Y+33 |
9369 528c 1093 0000 sts (DebugOut+16)+1,r17 |
9370 5290 0093 0000 sts DebugOut+16,r16 |
9371 5294 8091 0000 lds r24,sollGier.0 |
9372 5298 9091 0000 lds r25,(sollGier.0)+1 |
9373 529c A091 0000 lds r26,(sollGier.0)+2 |
9374 52a0 B091 0000 lds r27,(sollGier.0)+3 |
9375 52a4 22E0 ldi r18,2 |
9376 52a6 880F 1: lsl r24 |
9377 52a8 991F rol r25 |
9378 52aa AA1F rol r26 |
9379 52ac BB1F rol r27 |
9380 52ae 2A95 dec r18 |
9381 52b0 D1F7 brne 1b |
9382 52b2 C090 0000 lds r12,MesswertGier |
9383 52b6 D090 0000 lds r13,(MesswertGier)+1 |
9384 52ba C81A sub r12,r24 |
9385 52bc D90A sbc r13,r25 |
9386 52be 013A cpi r16,161 |
9387 52c0 1105 cpc r17,__zero_reg__ |
9388 52c2 8CF0 brlt .L711 |
9389 52c4 C801 movw r24,r16 |
9390 52c6 17FD sbrc r17,7 |
9391 52c8 0196 adiw r24,1 |
9392 .L713: |
9393 52ca 9595 asr r25 |
9394 52cc 8795 ror r24 |
9395 52ce 8C15 cp r24,r12 |
9396 52d0 9D05 cpc r25,r13 |
9397 52d2 0CF4 brge .L712 |
9398 52d4 6C01 movw r12,r24 |
9399 .L712: |
9400 52d6 9095 com r25 |
9401 52d8 8195 neg r24 |
9402 52da 9F4F sbci r25,lo8(-1) |
9403 52dc C816 cp r12,r24 |
9404 52de D906 cpc r13,r25 |
9405 52e0 94F4 brge .L718 |
9406 52e2 6C01 movw r12,r24 |
9407 52e4 10C0 rjmp .L718 |
9408 .L711: |
9409 52e6 11E5 ldi r17,lo8(81) |
9410 52e8 C116 cp r12,r17 |
9411 52ea D104 cpc r13,__zero_reg__ |
9412 52ec 1CF0 brlt .L719 |
9413 52ee E0E5 ldi r30,lo8(80) |
9414 52f0 CE2E mov r12,r30 |
9415 52f2 D12C mov r13,__zero_reg__ |
9416 .L719: |
9417 52f4 20EB ldi r18,lo8(-80) |
9418 52f6 C216 cp r12,r18 |
9419 52f8 2FEF ldi r18,hi8(-80) |
9420 52fa D206 cpc r13,r18 |
9421 52fc 24F4 brge .L718 |
9422 52fe 70EB ldi r23,lo8(-80) |
9423 5300 C72E mov r12,r23 |
9424 5302 7FEF ldi r23,hi8(-80) |
9425 5304 D72E mov r13,r23 |
9426 .L718: |
9427 5306 49A9 ldd r20,Y+49 |
9428 5308 242F mov r18,r20 |
9429 530a 3327 clr r19 |
9430 530c 220F lsl r18 |
9431 530e 331F rol r19 |
9432 5310 220F lsl r18 |
9433 5312 331F rol r19 |
9434 5314 C901 movw r24,r18 |
9435 5316 68A1 ldd r22,Y+32 |
9436 5318 79A1 ldd r23,Y+33 |
9437 531a 861B sub r24,r22 |
9438 531c 970B sbc r25,r23 |
9439 531e 8C15 cp r24,r12 |
9440 5320 9D05 cpc r25,r13 |
9441 5322 0CF4 brge .L721 |
9442 5324 6C01 movw r12,r24 |
9443 .L721: |
9444 5326 88A1 ldd r24,Y+32 |
9445 5328 99A1 ldd r25,Y+33 |
9446 532a 821B sub r24,r18 |
9447 532c 930B sbc r25,r19 |
9448 532e C816 cp r12,r24 |
9449 5330 D906 cpc r13,r25 |
9450 5332 0CF4 brge .L722 |
9451 5334 6C01 movw r12,r24 |
9452 .L722: |
9453 5336 8091 0000 lds r24,MesswertNick |
9454 533a 9091 0000 lds r25,(MesswertNick)+1 |
9455 533e 6091 0000 lds r22,StickNick |
9456 5342 7091 0000 lds r23,(StickNick)+1 |
9457 5346 861B sub r24,r22 |
9458 5348 970B sbc r25,r23 |
9459 534a 9093 0000 sts (DiffNick)+1,r25 |
9460 534e 8093 0000 sts DiffNick,r24 |
9461 5352 A090 0000 lds r10,IntegralFaktor |
9462 5356 2091 0000 lds r18,SummeNick |
9463 535a 3091 0000 lds r19,(SummeNick)+1 |
9464 535e 4091 0000 lds r20,(SummeNick)+2 |
9465 5362 5091 0000 lds r21,(SummeNick)+3 |
9466 5366 AA20 tst r10 |
9467 5368 41F0 breq .L723 |
9468 536a 461A sub r4,r22 |
9469 536c 570A sbc r5,r23 |
9470 536e C201 movw r24,r4 |
9471 5370 AA27 clr r26 |
9472 5372 97FD sbrc r25,7 |
9473 5374 A095 com r26 |
9474 5376 BA2F mov r27,r26 |
9475 5378 04C0 rjmp .L802 |
9476 .L723: |
9477 537a AA27 clr r26 |
9478 537c 97FD sbrc r25,7 |
9479 537e A095 com r26 |
9480 5380 BA2F mov r27,r26 |
9481 .L802: |
9482 5382 280F add r18,r24 |
9483 5384 391F adc r19,r25 |
9484 5386 4A1F adc r20,r26 |
9485 5388 5B1F adc r21,r27 |
9486 538a 2093 0000 sts SummeNick,r18 |
9487 538e 3093 0000 sts (SummeNick)+1,r19 |
9488 5392 4093 0000 sts (SummeNick)+2,r20 |
9489 5396 5093 0000 sts (SummeNick)+3,r21 |
9490 539a 8091 0000 lds r24,SummeNick |
9491 539e 9091 0000 lds r25,(SummeNick)+1 |
9492 53a2 A091 0000 lds r26,(SummeNick)+2 |
9493 53a6 B091 0000 lds r27,(SummeNick)+3 |
9494 53aa 8150 subi r24,lo8(64001) |
9495 53ac 9A4F sbci r25,hi8(64001) |
9496 53ae A040 sbci r26,hlo8(64001) |
9497 53b0 B040 sbci r27,hhi8(64001) |
9498 53b2 64F0 brlt .L725 |
9499 53b4 80E0 ldi r24,lo8(64000) |
9500 53b6 9AEF ldi r25,hi8(64000) |
9501 53b8 A0E0 ldi r26,hlo8(64000) |
9502 53ba B0E0 ldi r27,hhi8(64000) |
9503 53bc 8093 0000 sts SummeNick,r24 |
9504 53c0 9093 0000 sts (SummeNick)+1,r25 |
9505 53c4 A093 0000 sts (SummeNick)+2,r26 |
9506 53c8 B093 0000 sts (SummeNick)+3,r27 |
9507 .L725: |
9508 53cc 8091 0000 lds r24,SummeNick |
9509 53d0 9091 0000 lds r25,(SummeNick)+1 |
9510 53d4 A091 0000 lds r26,(SummeNick)+2 |
9511 53d8 B091 0000 lds r27,(SummeNick)+3 |
9512 53dc 8050 subi r24,lo8(-64000) |
9513 53de 9640 sbci r25,hi8(-64000) |
9514 53e0 AF4F sbci r26,hlo8(-64000) |
9515 53e2 BF4F sbci r27,hhi8(-64000) |
9516 53e4 64F4 brge .L726 |
9517 53e6 80E0 ldi r24,lo8(-64000) |
9518 53e8 96E0 ldi r25,hi8(-64000) |
9519 53ea AFEF ldi r26,hlo8(-64000) |
9520 53ec BFEF ldi r27,hhi8(-64000) |
9521 53ee 8093 0000 sts SummeNick,r24 |
9522 53f2 9093 0000 sts (SummeNick)+1,r25 |
9523 53f6 A093 0000 sts (SummeNick)+2,r26 |
9524 53fa B093 0000 sts (SummeNick)+3,r27 |
9525 .L726: |
9526 53fe B090 0000 lds r11,EE_Parameter+35 |
9527 5402 2B2D mov r18,r11 |
9528 5404 3327 clr r19 |
9529 5406 8091 0000 lds r24,DiffNick |
9530 540a 9091 0000 lds r25,(DiffNick)+1 |
9531 540e 289F mul r18,r24 |
9532 5410 7001 movw r14,r0 |
9533 5412 299F mul r18,r25 |
9534 5414 F00C add r15,r0 |
9535 5416 389F mul r19,r24 |
9536 5418 F00C add r15,r0 |
9537 541a 1124 clr r1 |
9538 541c 9701 movw r18,r14 |
9539 541e F7FE sbrs r15,7 |
9540 5420 02C0 rjmp .L727 |
9541 5422 295F subi r18,lo8(-(7)) |
9542 5424 3F4F sbci r19,hi8(-(7)) |
9543 .L727: |
9544 5426 7901 movw r14,r18 |
9545 5428 53E0 ldi r21,3 |
9546 542a F594 1: asr r15 |
9547 542c E794 ror r14 |
9548 542e 5A95 dec r21 |
9549 5430 E1F7 brne 1b |
9550 5432 0091 0000 lds r16,Ki |
9551 5436 1091 0000 lds r17,(Ki)+1 |
9552 543a 9801 movw r18,r16 |
9553 543c 4427 clr r20 |
9554 543e 37FD sbrc r19,7 |
9555 5440 4095 com r20 |
9556 5442 542F mov r21,r20 |
9557 5444 8091 0000 lds r24,SummeNick |
9558 5448 9091 0000 lds r25,(SummeNick)+1 |
9559 544c A091 0000 lds r26,(SummeNick)+2 |
9560 5450 B091 0000 lds r27,(SummeNick)+3 |
9561 5454 BC01 movw r22,r24 |
9562 5456 CD01 movw r24,r26 |
9563 5458 0E94 0000 call __divmodsi4 |
9564 545c E20E add r14,r18 |
9565 545e F31E adc r15,r19 |
9566 5460 9090 0000 lds r9,Parameter_DynamicStability |
9567 5464 692D mov r22,r9 |
9568 5466 7727 clr r23 |
9569 5468 8827 clr r24 |
9570 546a 9927 clr r25 |
9571 546c 9601 movw r18,r12 |
9572 546e D7FE sbrs r13,7 |
9573 5470 04C0 rjmp .L728 |
9574 5472 2227 clr r18 |
9575 5474 3327 clr r19 |
9576 5476 2C19 sub r18,r12 |
9577 5478 3D09 sbc r19,r13 |
9578 .L728: |
9579 547a 37FF sbrs r19,7 |
9580 547c 02C0 rjmp .L729 |
9581 547e 2F5F subi r18,lo8(-(1)) |
9582 5480 3F4F sbci r19,hi8(-(1)) |
9583 .L729: |
9584 5482 3595 asr r19 |
9585 5484 2795 ror r18 |
9586 5486 48A1 ldd r20,Y+32 |
9587 5488 59A1 ldd r21,Y+33 |
9588 548a 240F add r18,r20 |
9589 548c 351F adc r19,r21 |
9590 548e 4427 clr r20 |
9591 5490 37FD sbrc r19,7 |
9592 5492 4095 com r20 |
9593 5494 542F mov r21,r20 |
9594 5496 0E94 0000 call __mulsi3 |
9595 549a 97FF sbrs r25,7 |
9596 549c 04C0 rjmp .L730 |
9597 549e 615C subi r22,lo8(-(63)) |
9598 54a0 7F4F sbci r23,hi8(-(63)) |
9599 54a2 8F4F sbci r24,hlo8(-(63)) |
9600 54a4 9F4F sbci r25,hhi8(-(63)) |
9601 .L730: |
9602 54a6 26E0 ldi r18,6 |
9603 54a8 9595 1: asr r25 |
9604 54aa 8795 ror r24 |
9605 54ac 7795 ror r23 |
9606 54ae 6795 ror r22 |
9607 54b0 2A95 dec r18 |
9608 54b2 D1F7 brne 1b |
9609 54b4 9B01 movw r18,r22 |
9610 54b6 6E15 cp r22,r14 |
9611 54b8 7F05 cpc r23,r15 |
9612 54ba 0CF4 brge .L731 |
9613 54bc 7B01 movw r14,r22 |
9614 .L731: |
9615 54be 3095 com r19 |
9616 54c0 2195 neg r18 |
9617 54c2 3F4F sbci r19,lo8(-1) |
9618 54c4 E216 cp r14,r18 |
9619 54c6 F306 cpc r15,r19 |
9620 54c8 0CF4 brge .L732 |
9621 54ca 7901 movw r14,r18 |
9622 .L732: |
9623 54cc 8091 0000 lds r24,MesswertRoll |
9624 54d0 9091 0000 lds r25,(MesswertRoll)+1 |
9625 54d4 6091 0000 lds r22,StickRoll |
9626 54d8 7091 0000 lds r23,(StickRoll)+1 |
9627 54dc 861B sub r24,r22 |
9628 54de 970B sbc r25,r23 |
9629 54e0 9093 0000 sts (DiffRoll)+1,r25 |
9630 54e4 8093 0000 sts DiffRoll,r24 |
9631 54e8 2091 0000 lds r18,SummeRoll |
9632 54ec 3091 0000 lds r19,(SummeRoll)+1 |
9633 54f0 4091 0000 lds r20,(SummeRoll)+2 |
9634 54f4 5091 0000 lds r21,(SummeRoll)+3 |
9635 54f8 AA20 tst r10 |
9636 54fa 41F0 breq .L733 |
9637 54fc 261A sub r2,r22 |
9638 54fe 370A sbc r3,r23 |
9639 5500 C101 movw r24,r2 |
9640 5502 AA27 clr r26 |
9641 5504 97FD sbrc r25,7 |
9642 5506 A095 com r26 |
9643 5508 BA2F mov r27,r26 |
9644 550a 04C0 rjmp .L803 |
9645 .L733: |
9646 550c AA27 clr r26 |
9647 550e 97FD sbrc r25,7 |
9648 5510 A095 com r26 |
9649 5512 BA2F mov r27,r26 |
9650 .L803: |
9651 5514 280F add r18,r24 |
9652 5516 391F adc r19,r25 |
9653 5518 4A1F adc r20,r26 |
9654 551a 5B1F adc r21,r27 |
9655 551c 2093 0000 sts SummeRoll,r18 |
9656 5520 3093 0000 sts (SummeRoll)+1,r19 |
9657 5524 4093 0000 sts (SummeRoll)+2,r20 |
9658 5528 5093 0000 sts (SummeRoll)+3,r21 |
9659 552c 8091 0000 lds r24,SummeRoll |
9660 5530 9091 0000 lds r25,(SummeRoll)+1 |
9661 5534 A091 0000 lds r26,(SummeRoll)+2 |
9662 5538 B091 0000 lds r27,(SummeRoll)+3 |
9663 553c 8150 subi r24,lo8(64001) |
9664 553e 9A4F sbci r25,hi8(64001) |
9665 5540 A040 sbci r26,hlo8(64001) |
9666 5542 B040 sbci r27,hhi8(64001) |
9667 5544 64F0 brlt .L735 |
9668 5546 80E0 ldi r24,lo8(64000) |
9669 5548 9AEF ldi r25,hi8(64000) |
9670 554a A0E0 ldi r26,hlo8(64000) |
9671 554c B0E0 ldi r27,hhi8(64000) |
9672 554e 8093 0000 sts SummeRoll,r24 |
9673 5552 9093 0000 sts (SummeRoll)+1,r25 |
9674 5556 A093 0000 sts (SummeRoll)+2,r26 |
9675 555a B093 0000 sts (SummeRoll)+3,r27 |
9676 .L735: |
9677 555e 8091 0000 lds r24,SummeRoll |
9678 5562 9091 0000 lds r25,(SummeRoll)+1 |
9679 5566 A091 0000 lds r26,(SummeRoll)+2 |
9680 556a B091 0000 lds r27,(SummeRoll)+3 |
9681 556e 8050 subi r24,lo8(-64000) |
9682 5570 9640 sbci r25,hi8(-64000) |
9683 5572 AF4F sbci r26,hlo8(-64000) |
9684 5574 BF4F sbci r27,hhi8(-64000) |
9685 5576 64F4 brge .L736 |
9686 5578 80E0 ldi r24,lo8(-64000) |
9687 557a 96E0 ldi r25,hi8(-64000) |
9688 557c AFEF ldi r26,hlo8(-64000) |
9689 557e BFEF ldi r27,hhi8(-64000) |
9690 5580 8093 0000 sts SummeRoll,r24 |
9691 5584 9093 0000 sts (SummeRoll)+1,r25 |
9692 5588 A093 0000 sts (SummeRoll)+2,r26 |
9693 558c B093 0000 sts (SummeRoll)+3,r27 |
9694 .L736: |
9695 5590 2B2D mov r18,r11 |
9696 5592 3327 clr r19 |
9697 5594 8091 0000 lds r24,DiffRoll |
9698 5598 9091 0000 lds r25,(DiffRoll)+1 |
9699 559c 289F mul r18,r24 |
9700 559e D001 movw r26,r0 |
9701 55a0 299F mul r18,r25 |
9702 55a2 B00D add r27,r0 |
9703 55a4 389F mul r19,r24 |
9704 55a6 B00D add r27,r0 |
9705 55a8 1124 clr r1 |
9706 55aa 9D01 movw r18,r26 |
9707 55ac B7FF sbrs r27,7 |
9708 55ae 02C0 rjmp .L737 |
9709 55b0 295F subi r18,lo8(-(7)) |
9710 55b2 3F4F sbci r19,hi8(-(7)) |
9711 .L737: |
9712 55b4 5901 movw r10,r18 |
9713 55b6 B3E0 ldi r27,3 |
9714 55b8 B594 1: asr r11 |
9715 55ba A794 ror r10 |
9716 55bc BA95 dec r27 |
9717 55be E1F7 brne 1b |
9718 55c0 9801 movw r18,r16 |
9719 55c2 4427 clr r20 |
9720 55c4 37FD sbrc r19,7 |
9721 55c6 4095 com r20 |
9722 55c8 542F mov r21,r20 |
9723 55ca 8091 0000 lds r24,SummeRoll |
9724 55ce 9091 0000 lds r25,(SummeRoll)+1 |
9725 55d2 A091 0000 lds r26,(SummeRoll)+2 |
9726 55d6 B091 0000 lds r27,(SummeRoll)+3 |
9727 55da BC01 movw r22,r24 |
9728 55dc CD01 movw r24,r26 |
9729 55de 0E94 0000 call __divmodsi4 |
9730 55e2 A20E add r10,r18 |
9731 55e4 B31E adc r11,r19 |
9732 55e6 692D mov r22,r9 |
9733 55e8 7727 clr r23 |
9734 55ea 8827 clr r24 |
9735 55ec 9927 clr r25 |
9736 55ee 9601 movw r18,r12 |
9737 55f0 D7FE sbrs r13,7 |
9738 55f2 04C0 rjmp .L738 |
9739 55f4 2227 clr r18 |
9740 55f6 3327 clr r19 |
9741 55f8 2C19 sub r18,r12 |
9742 55fa 3D09 sbc r19,r13 |
9743 .L738: |
9744 55fc 37FF sbrs r19,7 |
9745 55fe 02C0 rjmp .L739 |
9746 5600 2F5F subi r18,lo8(-(1)) |
9747 5602 3F4F sbci r19,hi8(-(1)) |
9748 .L739: |
9749 5604 3595 asr r19 |
9750 5606 2795 ror r18 |
9751 5608 E8A1 ldd r30,Y+32 |
9752 560a F9A1 ldd r31,Y+33 |
9753 560c 2E0F add r18,r30 |
9754 560e 3F1F adc r19,r31 |
9755 5610 4427 clr r20 |
9756 5612 37FD sbrc r19,7 |
9757 5614 4095 com r20 |
9758 5616 542F mov r21,r20 |
9759 5618 0E94 0000 call __mulsi3 |
9760 561c 97FF sbrs r25,7 |
9761 561e 04C0 rjmp .L740 |
9762 5620 615C subi r22,lo8(-(63)) |
9763 5622 7F4F sbci r23,hi8(-(63)) |
9764 5624 8F4F sbci r24,hlo8(-(63)) |
9765 5626 9F4F sbci r25,hhi8(-(63)) |
9766 .L740: |
9767 5628 F6E0 ldi r31,6 |
9768 562a 9595 1: asr r25 |
9769 562c 8795 ror r24 |
9770 562e 7795 ror r23 |
9771 5630 6795 ror r22 |
9772 5632 FA95 dec r31 |
9773 5634 D1F7 brne 1b |
9774 5636 9B01 movw r18,r22 |
9775 5638 6A15 cp r22,r10 |
9776 563a 7B05 cpc r23,r11 |
9777 563c 0CF4 brge .L741 |
9778 563e 5B01 movw r10,r22 |
9779 .L741: |
9780 5640 3095 com r19 |
9781 5642 2195 neg r18 |
9782 5644 3F4F sbci r19,lo8(-1) |
9783 5646 A216 cp r10,r18 |
9784 5648 B306 cpc r11,r19 |
9785 564a 0CF4 brge .L742 |
9786 564c 5901 movw r10,r18 |
9787 .L742: |
9788 564e 2090 0000 lds r2,Parameter_UserParam7 |
9789 5652 E0E0 ldi r30,lo8(Motor) |
9790 5654 6E2E mov r6,r30 |
9791 5656 E0E0 ldi r30,hi8(Motor) |
9792 5658 7E2E mov r7,r30 |
9793 565a 70E0 ldi r23,lo8(Mixer+13) |
9794 565c 872E mov r8,r23 |
9795 565e 70E0 ldi r23,hi8(Mixer+13) |
9796 5660 972E mov r9,r23 |
9797 5662 6BE0 ldi r22,lo8(11) |
9798 5664 362E mov r3,r22 |
9799 5666 50E0 ldi r21,lo8(tmp_motorwert) |
9800 5668 452E mov r4,r21 |
9801 566a 50E0 ldi r21,hi8(tmp_motorwert) |
9802 566c 552E mov r5,r21 |
9803 .L776: |
9804 566e D401 movw r26,r8 |
9805 5670 2C91 ld r18,X |
9806 5672 1216 cp __zero_reg__,r18 |
9807 5674 0CF0 brlt .+2 |
9808 5676 ECC0 rjmp .L746 |
9809 5678 2034 cpi r18,lo8(64) |
9810 567a 19F4 brne .L747 |
9811 567c 08A1 ldd r16,Y+32 |
9812 567e 19A1 ldd r17,Y+33 |
9813 5680 1EC0 rjmp .L748 |
9814 .L747: |
9815 5682 E8A1 ldd r30,Y+32 |
9816 5684 F9A1 ldd r31,Y+33 |
9817 5686 CF01 movw r24,r30 |
9818 5688 AA27 clr r26 |
9819 568a 97FD sbrc r25,7 |
9820 568c A095 com r26 |
9821 568e BA2F mov r27,r26 |
9822 5690 3327 clr r19 |
9823 5692 27FD sbrc r18,7 |
9824 5694 3095 com r19 |
9825 5696 432F mov r20,r19 |
9826 5698 532F mov r21,r19 |
9827 569a BC01 movw r22,r24 |
9828 569c CD01 movw r24,r26 |
9829 569e 0E94 0000 call __mulsi3 |
9830 56a2 97FF sbrs r25,7 |
9831 56a4 04C0 rjmp .L749 |
9832 56a6 615C subi r22,lo8(-(63)) |
9833 56a8 7F4F sbci r23,hi8(-(63)) |
9834 56aa 8F4F sbci r24,hlo8(-(63)) |
9835 56ac 9F4F sbci r25,hhi8(-(63)) |
9836 .L749: |
9837 56ae 46E0 ldi r20,6 |
9838 56b0 9595 1: asr r25 |
9839 56b2 8795 ror r24 |
9840 56b4 7795 ror r23 |
9841 56b6 6795 ror r22 |
9842 56b8 4A95 dec r20 |
9843 56ba D1F7 brne 1b |
9844 56bc 8B01 movw r16,r22 |
9845 .L748: |
9846 56be F401 movw r30,r8 |
9847 56c0 2181 ldd r18,Z+1 |
9848 56c2 2034 cpi r18,lo8(64) |
9849 56c4 19F4 brne .L750 |
9850 56c6 0E0D add r16,r14 |
9851 56c8 1F1D adc r17,r15 |
9852 56ca 22C0 rjmp .L751 |
9853 .L750: |
9854 56cc 203C cpi r18,lo8(-64) |
9855 56ce 19F4 brne .L752 |
9856 56d0 0E19 sub r16,r14 |
9857 56d2 1F09 sbc r17,r15 |
9858 56d4 1DC0 rjmp .L751 |
9859 .L752: |
9860 56d6 C701 movw r24,r14 |
9861 56d8 AA27 clr r26 |
9862 56da 97FD sbrc r25,7 |
9863 56dc A095 com r26 |
9864 56de BA2F mov r27,r26 |
9865 56e0 3327 clr r19 |
9866 56e2 27FD sbrc r18,7 |
9867 56e4 3095 com r19 |
9868 56e6 432F mov r20,r19 |
9869 56e8 532F mov r21,r19 |
9870 56ea BC01 movw r22,r24 |
9871 56ec CD01 movw r24,r26 |
9872 56ee 0E94 0000 call __mulsi3 |
9873 56f2 97FF sbrs r25,7 |
9874 56f4 04C0 rjmp .L754 |
9875 56f6 615C subi r22,lo8(-(63)) |
9876 56f8 7F4F sbci r23,hi8(-(63)) |
9877 56fa 8F4F sbci r24,hlo8(-(63)) |
9878 56fc 9F4F sbci r25,hhi8(-(63)) |
9879 .L754: |
9880 56fe 36E0 ldi r19,6 |
9881 5700 9595 1: asr r25 |
9882 5702 8795 ror r24 |
9883 5704 7795 ror r23 |
9884 5706 6795 ror r22 |
9885 5708 3A95 dec r19 |
9886 570a D1F7 brne 1b |
9887 570c 060F add r16,r22 |
9888 570e 171F adc r17,r23 |
9889 .L751: |
9890 5710 F401 movw r30,r8 |
9891 5712 2281 ldd r18,Z+2 |
9892 5714 2034 cpi r18,lo8(64) |
9893 5716 19F4 brne .L755 |
9894 5718 0A0D add r16,r10 |
9895 571a 1B1D adc r17,r11 |
9896 571c 22C0 rjmp .L756 |
9897 .L755: |
9898 571e 203C cpi r18,lo8(-64) |
9899 5720 19F4 brne .L757 |
9900 5722 0A19 sub r16,r10 |
9901 5724 1B09 sbc r17,r11 |
9902 5726 1DC0 rjmp .L756 |
9903 .L757: |
9904 5728 C501 movw r24,r10 |
9905 572a AA27 clr r26 |
9906 572c 97FD sbrc r25,7 |
9907 572e A095 com r26 |
9908 5730 BA2F mov r27,r26 |
9909 5732 3327 clr r19 |
9910 5734 27FD sbrc r18,7 |
9911 5736 3095 com r19 |
9912 5738 432F mov r20,r19 |
9913 573a 532F mov r21,r19 |
9914 573c BC01 movw r22,r24 |
9915 573e CD01 movw r24,r26 |
9916 5740 0E94 0000 call __mulsi3 |
9917 5744 97FF sbrs r25,7 |
9918 5746 04C0 rjmp .L759 |
9919 5748 615C subi r22,lo8(-(63)) |
9920 574a 7F4F sbci r23,hi8(-(63)) |
9921 574c 8F4F sbci r24,hlo8(-(63)) |
9922 574e 9F4F sbci r25,hhi8(-(63)) |
9923 .L759: |
9924 5750 26E0 ldi r18,6 |
9925 5752 9595 1: asr r25 |
9926 5754 8795 ror r24 |
9927 5756 7795 ror r23 |
9928 5758 6795 ror r22 |
9929 575a 2A95 dec r18 |
9930 575c D1F7 brne 1b |
9931 575e 060F add r16,r22 |
9932 5760 171F adc r17,r23 |
9933 .L756: |
9934 5762 F401 movw r30,r8 |
9935 5764 2381 ldd r18,Z+3 |
9936 5766 2034 cpi r18,lo8(64) |
9937 5768 19F4 brne .L760 |
9938 576a 0C0D add r16,r12 |
9939 576c 1D1D adc r17,r13 |
9940 576e 22C0 rjmp .L761 |
9941 .L760: |
9942 5770 203C cpi r18,lo8(-64) |
9943 5772 19F4 brne .L762 |
9944 5774 0C19 sub r16,r12 |
9945 5776 1D09 sbc r17,r13 |
9946 5778 1DC0 rjmp .L761 |
9947 .L762: |
9948 577a C601 movw r24,r12 |
9949 577c AA27 clr r26 |
9950 577e 97FD sbrc r25,7 |
9951 5780 A095 com r26 |
9952 5782 BA2F mov r27,r26 |
9953 5784 3327 clr r19 |
9954 5786 27FD sbrc r18,7 |
9955 5788 3095 com r19 |
9956 578a 432F mov r20,r19 |
9957 578c 532F mov r21,r19 |
9958 578e BC01 movw r22,r24 |
9959 5790 CD01 movw r24,r26 |
9960 5792 0E94 0000 call __mulsi3 |
9961 5796 97FF sbrs r25,7 |
9962 5798 04C0 rjmp .L764 |
9963 579a 615C subi r22,lo8(-(63)) |
9964 579c 7F4F sbci r23,hi8(-(63)) |
9965 579e 8F4F sbci r24,hlo8(-(63)) |
9966 57a0 9F4F sbci r25,hhi8(-(63)) |
9967 .L764: |
9968 57a2 B6E0 ldi r27,6 |
9969 57a4 9595 1: asr r25 |
9970 57a6 8795 ror r24 |
9971 57a8 7795 ror r23 |
9972 57aa 6795 ror r22 |
9973 57ac BA95 dec r27 |
9974 57ae D1F7 brne 1b |
9975 57b0 060F add r16,r22 |
9976 57b2 171F adc r17,r23 |
9977 .L761: |
9978 57b4 D201 movw r26,r4 |
9979 57b6 8D91 ld r24,X+ |
9980 57b8 9C91 ld r25,X |
9981 57ba 8017 cp r24,r16 |
9982 57bc 9107 cpc r25,r17 |
9983 57be 5CF4 brge .L765 |
9984 57c0 BC01 movw r22,r24 |
9985 57c2 600F add r22,r16 |
9986 57c4 711F adc r23,r17 |
9987 57c6 77FF sbrs r23,7 |
9988 57c8 02C0 rjmp .L766 |
9989 57ca 6F5F subi r22,lo8(-(1)) |
9990 57cc 7F4F sbci r23,hi8(-(1)) |
9991 .L766: |
9992 57ce 8B01 movw r16,r22 |
9993 57d0 1595 asr r17 |
9994 57d2 0795 ror r16 |
9995 57d4 11C0 rjmp .L767 |
9996 .L765: |
9997 57d6 B1E0 ldi r27,lo8(1) |
9998 57d8 B215 cp r27,r2 |
9999 57da 28F0 brlo .L768 |
10000 57dc 000F add r16,r16 |
10001 57de 111F adc r17,r17 |
10002 57e0 081B sub r16,r24 |
10003 57e2 190B sbc r17,r25 |
10004 57e4 09C0 rjmp .L767 |
10005 .L768: |
10006 57e6 222D mov r18,r2 |
10007 57e8 3327 clr r19 |
10008 57ea 801B sub r24,r16 |
10009 57ec 910B sbc r25,r17 |
10010 57ee B901 movw r22,r18 |
10011 57f0 0E94 0000 call __divmodhi4 |
10012 57f4 060F add r16,r22 |
10013 57f6 171F adc r17,r23 |
10014 .L767: |
10015 57f8 E8A9 ldd r30,Y+48 |
10016 57fa 8E2F mov r24,r30 |
10017 57fc 9927 clr r25 |
10018 57fe 880F lsl r24 |
10019 5800 991F rol r25 |
10020 5802 880F lsl r24 |
10021 5804 991F rol r25 |
10022 5806 8017 cp r24,r16 |
10023 5808 9107 cpc r25,r17 |
10024 580a 54F4 brge .L804 |
10025 580c F9A9 ldd r31,Y+49 |
10026 580e 8F2F mov r24,r31 |
10027 5810 9927 clr r25 |
10028 5812 880F lsl r24 |
10029 5814 991F rol r25 |
10030 5816 880F lsl r24 |
10031 5818 991F rol r25 |
10032 581a 0817 cp r16,r24 |
10033 581c 1907 cpc r17,r25 |
10034 581e 0CF0 brlt .L771 |
10035 .L804: |
10036 5820 8C01 movw r16,r24 |
10037 .L771: |
10038 5822 C801 movw r24,r16 |
10039 5824 17FD sbrc r17,7 |
10040 5826 0396 adiw r24,3 |
10041 .L773: |
10042 5828 9595 asr r25 |
10043 582a 8795 ror r24 |
10044 582c 9595 asr r25 |
10045 582e 8795 ror r24 |
10046 5830 F301 movw r30,r6 |
10047 5832 8183 std Z+1,r24 |
10048 5834 880F lsl r24 |
10049 5836 991F rol r25 |
10050 5838 880F lsl r24 |
10051 583a 991F rol r25 |
10052 583c 9801 movw r18,r16 |
10053 583e 281B sub r18,r24 |
10054 5840 390B sbc r19,r25 |
10055 5842 C901 movw r24,r18 |
10056 5844 880F lsl r24 |
10057 5846 8283 std Z+2,r24 |
10058 5848 D201 movw r26,r4 |
10059 584a 0D93 st X+,r16 |
10060 584c 1C93 st X,r17 |
10061 584e 03C0 rjmp .L745 |
10062 .L746: |
10063 5850 F301 movw r30,r6 |
10064 5852 1182 std Z+1,__zero_reg__ |
10065 5854 1282 std Z+2,__zero_reg__ |
10066 .L745: |
10067 5856 3A94 dec r3 |
10068 5858 02E0 ldi r16,lo8(2) |
10069 585a 10E0 ldi r17,hi8(2) |
10070 585c 400E add r4,r16 |
10071 585e 511E adc r5,r17 |
10072 5860 24E0 ldi r18,lo8(4) |
10073 5862 30E0 ldi r19,hi8(4) |
10074 5864 820E add r8,r18 |
10075 5866 931E adc r9,r19 |
10076 5868 48E0 ldi r20,lo8(8) |
10077 586a 50E0 ldi r21,hi8(8) |
10078 586c 640E add r6,r20 |
10079 586e 751E adc r7,r21 |
10080 5870 37FE sbrs r3,7 |
10081 5872 FDCE rjmp .L776 |
10082 /* epilogue: frame size=53 */ |
10083 5874 E2E1 ldi r30,18 |
10084 5876 CB5C subi r28,-53 |
10085 5878 0C94 0000 jmp __epilogue_restores__+0 |
10086 /* epilogue end (size=4) */ |
10087 /* function MotorRegler size 7579 (7569) */ |
10089 .comm TrimNick,2,1 |
10090 .comm TrimRoll,2,1 |
10091 .comm ErsatzKompass,4,1 |
10092 .comm ErsatzKompassInGrad,2,1 |
10093 .comm MesswertNick,2,1 |
10094 .comm MesswertRoll,2,1 |
10095 .comm MesswertGier,2,1 |
10096 .comm Mittelwert_AccNick,2,1 |
10097 .comm Mittelwert_AccRoll,2,1 |
10098 .comm NaviAccNick,2,1 |
10099 .comm NaviAccRoll,2,1 |
10100 .comm h,1,1 |
10101 .comm m,1,1 |
10102 .comm s,1,1 |
10103 .comm DiffNick,2,1 |
10104 .comm DiffRoll,2,1 |
10105 .comm Parameter_Servo3,1,1 |
10106 .comm Parameter_Servo4,1,1 |
10107 .comm Parameter_Servo5,1,1 |
10108 .comm Parameter_J16Bitmask,1,1 |
10109 .comm Parameter_J16Timing,1,1 |
10110 .comm Parameter_J17Bitmask,1,1 |
10111 .comm Parameter_J17Timing,1,1 |
10112 .comm MesswertGierBias,2,1 |
10113 .comm RohMesswertNick,2,1 |
10114 .comm RohMesswertRoll,2,1 |
10115 .comm MittelIntegralNick,4,1 |
10116 .comm MittelIntegralRoll,4,1 |
10117 .comm MittelIntegralNick2,4,1 |
10118 .comm MittelIntegralRoll2,4,1 |
10119 .comm MAX_GAS,1,1 |
10120 .comm MIN_GAS,1,1 |
10121 .comm GyroFaktor,1,1 |
10122 .comm GyroFaktorGier,1,1 |
10123 .comm IntegralFaktor,1,1 |
10124 .comm IntegralFaktorGier,1,1 |
10125 .comm Parameter_NaviGpsModeControl,1,1 |
10126 .comm Parameter_NaviGpsGain,1,1 |
10127 .comm Parameter_NaviGpsP,1,1 |
10128 .comm Parameter_NaviGpsI,1,1 |
10129 .comm Parameter_NaviGpsD,1,1 |
10130 .comm Parameter_NaviGpsACC,1,1 |
10131 .comm Parameter_NaviOperatingRadius,1,1 |
10132 .comm Parameter_NaviWindCorrection,1,1 |
10133 .comm Parameter_NaviSpeedCompensation,1,1 |
10134 .comm Parameter_ExternalControl,1,1 |
10135 .comm KopplungsteilNickRoll,2,1 |
10136 .comm KopplungsteilRollNick,2,1 |
10137 .comm tmp_motorwert,24,1 |
10138 /* File "fc.c": code 11471 = 0x2ccf (11418), prologues 27, epilogues 26 */ |
DEFINED SYMBOLS |
*ABS*:00000000 fc.c |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:2 *ABS*:0000003f __SREG__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:3 *ABS*:0000003e __SP_H__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:4 *ABS*:0000003d __SP_L__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:5 *ABS*:00000034 __CCP__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:6 *ABS*:00000000 __tmp_reg__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:7 *ABS*:00000001 __zero_reg__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:11 .text:00000000 CopyDebugValues |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8659 .bss:00000015 IntegralNick |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8671 .bss:0000001d IntegralRoll |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:3 *ABS*:0000003f __SREG__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:4 *ABS*:0000003e __SP_H__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:5 *ABS*:0000003d __SP_L__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:6 *ABS*:00000000 __tmp_reg__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:7 *ABS*:00000001 __zero_reg__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:14 .data:00000000 VarioCharacter |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:19 .data:00000001 GIER_GRAD_FAKTOR |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:26 .bss:00000000 FCFlags |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:32 .bss:00000001 modell_fliegt |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:38 .bss:00000003 MaxStickRoll |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:44 .bss:00000005 MaxStickNick |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:50 .data:00000005 ExternHoehenValue |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:57 .bss:00000007 ExternStickGier |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:63 .bss:00000009 ExternStickRoll |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:69 .bss:0000000b ExternStickNick |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:75 .bss:0000000d CareFree |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:81 .data:00000007 Parameter_DynamicStability |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:86 .data:00000008 Parameter_CouplingYawCorrection |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:91 .data:00000009 Parameter_AchsKopplung2 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:96 .data:0000000a Parameter_AchsKopplung1 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:101 .data:0000000b Parameter_LoopGasLimit |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:106 .data:0000000c Parameter_ServoRollControl |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:111 .data:0000000d Parameter_ServoNickControl |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:118 .bss:0000000e Parameter_UserParam8 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:124 .bss:0000000f Parameter_UserParam7 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:130 .bss:00000010 Parameter_UserParam6 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:136 .bss:00000011 Parameter_UserParam5 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:142 .bss:00000012 Parameter_UserParam4 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:148 .bss:00000013 Parameter_UserParam3 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:154 .bss:00000014 Parameter_UserParam2 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:160 .bss:00000015 Parameter_UserParam1 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:166 .data:0000000e Parameter_I_Faktor |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:171 .data:0000000f Parameter_Gier_P |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:176 .data:00000010 Parameter_Gyro_Gier_I |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:181 .data:00000011 Parameter_Gyro_Gier_P |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:186 .data:00000012 Parameter_Gyro_I |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:191 .data:00000013 Parameter_Gyro_P |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:196 .data:00000014 Parameter_Gyro_D |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:201 .data:00000015 Parameter_Hoehe_GPS_Z |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:206 .data:00000016 Parameter_KompassWirkung |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:211 .data:00000017 Parameter_Hoehe_ACC_Wirkung |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:216 .data:00000018 Parameter_Hoehe_P |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:221 .data:00000019 Parameter_MaxHoehe |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:226 .data:0000001a Parameter_Luftdruck_D |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:233 .bss:00000016 Looping_Oben |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:239 .bss:00000017 Looping_Unten |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:245 .bss:00000018 Looping_Rechts |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:251 .bss:00000019 Looping_Links |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:257 .bss:0000001a Looping_Roll |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:263 .bss:0000001b Looping_Nick |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:269 .data:0000001b Ki |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:276 .bss:0000001c HoverGas |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:282 .bss:0000001e LageKorrekturNick |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:288 .bss:00000020 LageKorrekturRoll |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:294 .bss:00000022 SollHoehe |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:300 .bss:00000026 HoehenWert |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:306 .bss:0000002a StartTrigger |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:312 .bss:0000002b MotorenEin |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:318 .bss:0000002c StickGas |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:324 .bss:0000002e StickGier |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:330 .bss:00000030 StickRoll |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:336 .bss:00000032 StickNick |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:342 .bss:00000034 SenderOkay |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:348 .bss:00000035 Poti |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:354 .bss:0000003e GierGyroFehler |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:360 .data:0000001d Umschlag180Roll |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:365 .data:00000021 Umschlag180Nick |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:372 .bss:00000040 TrichterFlug |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:378 .bss:00000041 HoehenReglerAktiv |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:384 .data:00000025 KompassSignalSchlecht |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:391 .bss:00000042 KompassRichtung |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:397 .bss:00000044 KompassStartwert |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:403 .bss:00000046 KompassValue |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:409 .bss:00000048 Mess_Integral_Hoch |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:415 .bss:0000004c SummeRoll |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:421 .bss:00000050 SummeNick |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:427 .bss:00000054 Mess_Integral_Gier2 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:433 .bss:00000058 Mess_Integral_Gier |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:439 .bss:0000005c Mess_IntegralRoll2 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:445 .bss:00000060 Mess_IntegralRoll |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:451 .bss:00000064 Mess_IntegralNick2 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:457 .bss:00000068 Mess_IntegralNick |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:463 .bss:0000006c Integral_Gier |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:469 .bss:00000070 IntegralAccZ |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:475 .bss:00000074 IntegralAccRoll |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:481 .bss:00000078 IntegralAccNick |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:487 .bss:0000007c IntegralRoll2 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:493 .bss:00000080 IntegralRoll |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:499 .bss:00000084 IntegralNick2 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:505 .bss:00000088 IntegralNick |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:511 .bss:0000008c ControlHeading |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:517 .bss:0000008d NeutralAccZ |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:523 .bss:0000008f NaviCntAcc |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:529 .bss:00000091 NeutralAccY |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:535 .bss:00000093 NeutralAccX |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:541 .bss:00000095 StartNeutralNick |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:547 .bss:00000097 StartNeutralRoll |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:553 .bss:00000099 AdNeutralGier |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:559 .bss:0000009b AdNeutralRoll |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:565 .bss:0000009d AdNeutralNick |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:571 .bss:0000009f BaroExpandActive |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:576 .text:00000000 CopyDebugValues |
*COM*:00000002 Mittelwert_AccNick |
*COM*:00000002 Mittelwert_AccRoll |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8611 .bss:00000006 AdNeutralGier |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8870 .bss:00000077 HoehenWert |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8761 .bss:00000059 KompassValue |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8828 .bss:0000006c SenderOkay |
*COM*:00000004 ErsatzKompass |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9150 .data:00000022 GIER_GRAD_FAKTOR |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:167 .text:000001ea Mittelwert |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:754 .text:00000214 Piep |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:793 .text:00000256 CalibrierMittelwert |
*COM*:00000002 MesswertNick |
*COM*:00000002 MesswertRoll |
*COM*:00000002 MesswertGier |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:935 .progmem.data:00000000 __c.40 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:940 .text:00000398 SetNeutral |
.bss:000000a1 tmpl.32 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:1441 .bss:000000a5 tmpl2.33 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:1442 .bss:000000a9 tmpl3.34 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:1443 .bss:000000ad tmpl4.35 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:1444 .bss:000000b1 oldNick.36 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:1445 .bss:000000b3 oldRoll.37 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:1446 .bss:000000b5 d2Roll.38 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:1447 .bss:000000b7 d2Nick.39 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:1451 .text:000008f4 Mittelwert |
*COM*:00000002 RohMesswertNick |
*COM*:00000002 RohMesswertRoll |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8683 .bss:00000025 IntegralAccNick |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8689 .bss:00000029 IntegralAccRoll |
*COM*:00000002 NaviAccNick |
*COM*:00000002 NaviAccRoll |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8641 .bss:00000010 NaviCntAcc |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8647 .bss:00000012 NeutralAccZ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8695 .bss:0000002d IntegralAccZ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8719 .bss:0000003d Mess_IntegralRoll |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8707 .bss:00000035 Mess_IntegralNick |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8731 .bss:00000045 Mess_Integral_Gier |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8907 .bss:00000085 Looping_Nick |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8913 .bss:00000086 Looping_Roll |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9078 .data:0000001d Parameter_AchsKopplung2 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9239 .bss:000000ef tmpl3.2602 |
*COM*:00000002 KopplungsteilNickRoll |
*COM*:00000002 KopplungsteilRollNick |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9238 .bss:000000eb tmpl4.2603 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9083 .data:0000001e Parameter_CouplingYawCorrection |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9073 .data:0000001c Parameter_AchsKopplung1 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9241 .bss:000000f7 tmpl.2600 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9240 .bss:000000f3 tmpl2.2601 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8792 .bss:00000060 TrichterFlug |
*COM*:00000002 TrimRoll |
*COM*:00000002 TrimNick |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8725 .bss:00000041 Mess_IntegralRoll2 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8882 .bss:0000007f LageKorrekturRoll |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8806 .data:00000006 Umschlag180Roll |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8713 .bss:00000039 Mess_IntegralNick2 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8888 .bss:00000081 LageKorrekturNick |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8798 .data:00000002 Umschlag180Nick |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8701 .bss:00000031 Integral_Gier |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8665 .bss:00000019 IntegralNick2 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8677 .bss:00000021 IntegralRoll2 |
*COM*:00000002 MesswertNick |
*COM*:00000002 MesswertRoll |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8973 .data:00000012 Parameter_Gyro_D |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9237 .bss:000000e9 oldNick.2604 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9200 .bss:000000e3 d2Nick.2607 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9236 .bss:000000e7 oldRoll.2605 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9235 .bss:000000e5 d2Roll.2606 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8822 .bss:00000063 Poti |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:1586 .text:00001016 SendMotorData |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8858 .bss:00000075 MotorenEin |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9144 .bss:000000a0 FCFlags |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:1637 .text:00001082 ParameterZuordnung |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8943 .data:0000000c Parameter_Luftdruck_D |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8953 .data:0000000e Parameter_Hoehe_P |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8978 .data:00000013 Parameter_Gyro_P |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:3093 .text:000018e4 SendMotorData |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:3146 .text:00001950 ParameterZuordnung |
*COM*:00000001 Parameter_J16Timing |
*COM*:00000001 Parameter_J17Timing |
*COM*:00000001 Parameter_Servo3 |
*COM*:00000001 Parameter_Servo4 |
*COM*:00000001 Parameter_Servo5 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8948 .data:0000000d Parameter_MaxHoehe |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8958 .data:0000000f Parameter_Hoehe_ACC_Wirkung |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8968 .data:00000011 Parameter_Hoehe_GPS_Z |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8963 .data:00000010 Parameter_KompassWirkung |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8983 .data:00000014 Parameter_Gyro_I |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8988 .data:00000015 Parameter_Gyro_Gier_P |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8993 .data:00000016 Parameter_Gyro_Gier_I |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9003 .data:00000018 Parameter_I_Faktor |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9010 .bss:0000008b Parameter_UserParam1 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9016 .bss:0000008c Parameter_UserParam2 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9022 .bss:0000008d Parameter_UserParam3 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9028 .bss:0000008e Parameter_UserParam4 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9034 .bss:0000008f Parameter_UserParam5 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9040 .bss:00000090 Parameter_UserParam6 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9046 .bss:00000091 Parameter_UserParam7 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9052 .bss:00000092 Parameter_UserParam8 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9058 .data:00000019 Parameter_ServoNickControl |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9063 .data:0000001a Parameter_ServoRollControl |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9068 .data:0000001b Parameter_LoopGasLimit |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9088 .data:0000001f Parameter_DynamicStability |
*COM*:00000001 Parameter_ExternalControl |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8900 .data:0000000a Ki |
*COM*:00000001 MAX_GAS |
*COM*:00000001 MIN_GAS |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9095 .bss:00000093 CareFree |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:2212 .text:00001524 CalibrierMittelwert |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:2339 .text:0000164a SetNeutral |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8629 .bss:0000000c NeutralAccX |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8635 .bss:0000000e NeutralAccY |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8599 .bss:00000002 AdNeutralNick |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8605 .bss:00000004 AdNeutralRoll |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8617 .bss:00000008 StartNeutralRoll |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8623 .bss:0000000a StartNeutralNick |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9246 .progmem.data:00000000 __c.2485 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8755 .bss:00000055 Mess_Integral_Hoch |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8767 .bss:0000005b KompassStartwert |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9119 .data:00000020 ExternHoehenValue |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8816 .bss:00000061 GierGyroFehler |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:2827 .text:00001b8c Piep |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:2869 .text:00001bd6 MotorRegler |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8852 .bss:00000073 StickGas |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9194 .bss:000000cd RcLostTimer.3047 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9138 .bss:0000009e modell_fliegt |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8743 .bss:0000004d SummeNick |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8749 .bss:00000051 SummeRoll |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9199 .bss:000000df sollGier.3042 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9189 .bss:000000c8 NeueKompassRichtungMerken.3052 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9193 .bss:000000cc delay_neutral.3048 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9190 .bss:000000c9 calibration_done.3051 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9192 .bss:000000cb delay_einschalten.3049 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8737 .bss:00000049 Mess_Integral_Gier2 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8653 .bss:00000014 ControlHeading |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9191 .bss:000000ca delay_ausschalten.3050 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9186 .bss:000000be stick_nick.3059 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9185 .bss:000000bc stick_roll.3060 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9203 .data:0000002c C.354.3251 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8834 .bss:0000006d StickNick |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8840 .bss:0000006f StickRoll |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8846 .bss:00000071 StickGier |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:1448 .bss:000000b9 sollGier.0 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:3703 .bss:000000bd tmp_long.1 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:3704 .bss:000000c1 tmp_long2.2 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:3705 .bss:000000c5 IntegralFehlerNick.3 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:3706 .bss:000000c9 IntegralFehlerRoll.4 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:3707 .bss:000000cd RcLostTimer.5 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:3708 .bss:000000cf delay_neutral.6 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:3709 .bss:000000d0 delay_einschalten.7 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:3710 .bss:000000d1 delay_ausschalten.8 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:3711 .bss:000000d2 calibration_done.9 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:3712 .bss:000000d3 NeueKompassRichtungMerken.10 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:3713 .bss:000000d4 ausgleichNick.11 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:3714 .bss:000000d8 ausgleichRoll.12 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:3715 .bss:000000dc stick_nick.13 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:3716 .bss:000000de stick_roll.14 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:3717 .bss:000000e0 cnt.15 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:3718 .bss:000000e2 last_n_p.16 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:3719 .bss:000000e3 last_n_n.17 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:3720 .bss:000000e4 last_r_p.18 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:3721 .bss:000000e5 last_r_n.19 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:3722 .bss:000000e6 MittelIntegralNick_Alt.20 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:3723 .bss:000000ea MittelIntegralRoll_Alt.21 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:3724 .bss:000000ee HeightTrimming.22 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:3725 .bss:000000f0 FilterHCGas.23 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:3730 .data:00000027 StickGasHover.24 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:3726 .bss:000000f2 HoverGasMin.25 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:3735 .data:00000029 HoverGasMax.26 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:3732 .bss:000000f4 HoverGasFilter.27 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:3740 .data:0000002b delay.28 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:3737 .bss:000000f8 BaroAtUpperLimit.29 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:3742 .bss:000000f9 BaroAtLowerLimit.30 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:3743 .bss:000000fa HeightTrimmingFlag.31 |
C:\Users\Arthur-P\AppData\Local\Temp/ccOUbaaa.s:3780 .text:00001e0c MotorRegler |
*COM*:00000001 GyroFaktor |
*COM*:00000001 IntegralFaktor |
*COM*:00000001 GyroFaktorGier |
*COM*:00000001 IntegralFaktorGier |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9126 .bss:0000009a MaxStickNick |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9132 .bss:0000009c MaxStickRoll |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8919 .bss:00000087 Looping_Links |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8925 .bss:00000088 Looping_Rechts |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8937 .bss:0000008a Looping_Oben |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8931 .bss:00000089 Looping_Unten |
*COM*:00000004 MittelIntegralNick |
*COM*:00000004 MittelIntegralRoll |
*COM*:00000004 MittelIntegralNick2 |
*COM*:00000004 MittelIntegralRoll2 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9196 .bss:000000d3 IntegralFehlerNick.3045 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9188 .bss:000000c4 ausgleichNick.3053 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9195 .bss:000000cf IntegralFehlerRoll.3046 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9187 .bss:000000c0 ausgleichRoll.3054 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9198 .bss:000000db tmp_long.3043 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9197 .bss:000000d7 tmp_long2.3044 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9184 .bss:000000ba cnt.3066 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9179 .bss:000000b2 MittelIntegralNick_Alt.3071 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9183 .bss:000000b9 last_n_p.3067 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9182 .bss:000000b8 last_n_n.3068 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8779 .data:00000000 KompassSignalSchlecht |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9178 .bss:000000ae MittelIntegralRoll_Alt.3072 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9181 .bss:000000b7 last_r_p.3069 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9180 .bss:000000b6 last_r_n.3070 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8894 .bss:00000083 HoverGas |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8593 .bss:00000000 BaroExpandActive |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9160 .bss:000000a2 BaroAtLowerLimit.3089 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9161 .bss:000000a3 BaroAtUpperLimit.3088 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9165 .data:00000027 delay.3087 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8786 .bss:0000005f HoehenReglerAktiv |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8876 .bss:0000007b SollHoehe |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9158 .data:00000026 VarioCharacter |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9177 .bss:000000ac HeightTrimming.3081 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9175 .data:0000002a StickGasHover.3083 |
.bss:000000a1 HeightTrimmingFlag.3091 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8864 .bss:00000076 StartTrigger |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9167 .bss:000000a8 HoverGasMin.3084 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9170 .data:00000028 HoverGasMax.3085 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9172 .bss:000000aa FilterHCGas.3082 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9162 .bss:000000a4 HoverGasFilter.3086 |
*COM*:00000002 DiffNick |
*COM*:00000002 DiffRoll |
*COM*:00000018 tmp_motorwert |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8773 .bss:0000005d KompassRichtung |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:8998 .data:00000017 Parameter_Gier_P |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9101 .bss:00000094 ExternStickNick |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9107 .bss:00000096 ExternStickRoll |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccQw6Gjs.s:9113 .bss:00000098 ExternStickGier |
*COM*:00000002 ErsatzKompassInGrad |
*COM*:00000001 h |
*COM*:00000001 m |
9289,10 → 10129,11 |
*COM*:00000001 Parameter_NaviSpeedCompensation |
UNDEFINED SYMBOLS |
__do_copy_data |
__do_clear_bss |
EE_Parameter |
__divmodsi4 |
DebugOut |
__divmodhi4 |
AdWertGier |
AdWertAccHoch |
UBat |
9302,34 → 10143,23 |
GPS_Nick |
GPS_Roll |
VersionInfo |
__prologue_saves__ |
AdWertNickFilter |
AdWertRollFilter |
beeptime |
Delay_ms |
PlatinenVersion |
SucheGyroOffset |
AdWertNick |
AdWertRoll |
AdWertAccNick |
AdWertAccRoll |
Aktuell_az |
AdReady |
PPM_in |
__mulsi3 |
HiResNick |
HiResRoll |
AdWertNick |
PlatinenVersion |
AdWertRoll |
PPM_in |
__epilogue_restores__ |
MotorTest |
PC_MotortestActive |
motor_write |
twi_state |
BLFlags |
FromNaviCtrl |
BeepMuster |
beeptime |
SucheGyroOffset |
__prologue_saves__ |
ExpandBaro |
Delay_ms_Mess |
MessLuftdruck |
SucheLuftruckOffset |
__divmodhi4 |
Aktuell_az |
SetParamWord |
GetParamWord |
uart_putchar |
9342,7 → 10172,19 |
LED_Init |
FromNaviCtrl_Value |
ServoActive |
Delay_ms |
__epilogue_restores__ |
AdWertNickFilter |
AdWertRollFilter |
AdReady |
HiResNick |
HiResRoll |
MotorTest |
PC_MotortestActive |
motor_write |
twi_state |
BLFlags |
FromNaviCtrl |
BeepMuster |
PPM_diff |
SetActiveParamSet |
WinkelOut |
9351,8 → 10193,8 |
LipoDetection |
LIBFC_ReceiverInit |
NewPpmData |
FromNC_Rotate_C |
FromNC_Rotate_S |
FromNC_Rotate_C |
GPS_Nick2 |
GPS_Roll2 |
__floatsisf |
9368,5 → 10210,3 |
c_cos_8192 |
MissingMotor |
Mixer |
__do_copy_data |
__do_clear_bss |
/branches/V0.80g-Arthur-P1/isqrt.lst |
---|
1,4 → 1,5 |
1 # 1 "isqrt.S" |
2 # 1 "<built-in>" |
1 ;-----------------------------------------------------------------------------; |
0 |
0 |
202,6 → 203,7 |
199:isqrt.S **** clr r1 |
200 rjmp isqrt32 |
DEFINED SYMBOLS |
*ABS*:00000000 isqrt.S |
isqrt.S:26 .text:00000000 isqrt32 |
isqrt.S:101 .text:0000006a isqrt16 |
isqrt.S:157 .text:000000ac ihypot |
/branches/V0.80g-Arthur-P1/jetimenu.lst |
---|
1,1030 → 1,839 |
1 .file "jetimenu.c" |
2 __SREG__ = 0x3f |
3 __SP_H__ = 0x3e |
4 __SP_L__ = 0x3d |
5 __CCP__ = 0x34 |
2 .arch atmega644p |
3 __SREG__ = 0x3f |
4 __SP_H__ = 0x3e |
5 __SP_L__ = 0x3d |
6 __tmp_reg__ = 0 |
7 __zero_reg__ = 1 |
8 .text |
9 .global JetiBox_Update |
11 JetiBox_Update: |
12 0000 1F93 push r17 |
13 /* prologue: function */ |
14 /* frame size = 0 */ |
15 0002 182F mov r17,r24 |
16 0004 9091 0000 lds r25,item.2348 |
17 0008 9093 0000 sts last_item.2349,r25 |
18 000c 8F32 cpi r24,lo8(47) |
19 000e 01F0 breq .L4 |
20 0010 8033 cpi r24,lo8(48) |
21 0012 00F4 brsh .L7 |
22 0014 8F31 cpi r24,lo8(31) |
23 0016 01F4 brne .L2 |
24 0018 00C0 rjmp .L13 |
25 .L7: |
26 001a 8F34 cpi r24,lo8(79) |
27 001c 01F0 breq .L5 |
28 001e 8F38 cpi r24,lo8(-113) |
29 0020 01F4 brne .L2 |
30 0022 9923 tst r25 |
31 0024 01F4 brne .L8 |
32 0026 81E0 ldi r24,lo8(1) |
33 0028 00C0 rjmp .L9 |
34 .L8: |
35 002a E6E0 ldi r30,lo8(6) |
36 002c 9E9F mul r25,r30 |
37 002e F001 movw r30,r0 |
38 0030 1124 clr r1 |
39 0032 E050 subi r30,lo8(-(JetiBox_Menu)) |
40 0034 F040 sbci r31,hi8(-(JetiBox_Menu)) |
41 /* #APP */ |
42 ; 138 "jetimenu.c" 1 |
43 0036 E491 lpm r30, Z |
44 |
45 ; 0 "" 2 |
46 /* #NOAPP */ |
47 0038 00C0 rjmp .L12 |
48 .L13: |
49 003a E6E0 ldi r30,lo8(6) |
50 003c 9E9F mul r25,r30 |
51 003e F001 movw r30,r0 |
52 0040 1124 clr r1 |
53 0042 E050 subi r30,lo8(-(JetiBox_Menu+1)) |
54 0044 F040 sbci r31,hi8(-(JetiBox_Menu+1)) |
55 /* #APP */ |
56 ; 141 "jetimenu.c" 1 |
57 0046 E491 lpm r30, Z |
58 |
59 ; 0 "" 2 |
60 /* #NOAPP */ |
61 0048 00C0 rjmp .L12 |
62 .L4: |
63 004a E6E0 ldi r30,lo8(6) |
64 004c 9E9F mul r25,r30 |
65 004e F001 movw r30,r0 |
66 0050 1124 clr r1 |
67 0052 E050 subi r30,lo8(-(JetiBox_Menu+2)) |
68 0054 F040 sbci r31,hi8(-(JetiBox_Menu+2)) |
69 /* #APP */ |
70 ; 144 "jetimenu.c" 1 |
71 0056 E491 lpm r30, Z |
72 |
73 ; 0 "" 2 |
74 /* #NOAPP */ |
75 0058 00C0 rjmp .L12 |
76 .L5: |
77 005a E6E0 ldi r30,lo8(6) |
78 005c 9E9F mul r25,r30 |
79 005e F001 movw r30,r0 |
80 0060 1124 clr r1 |
81 0062 E050 subi r30,lo8(-(JetiBox_Menu+3)) |
82 0064 F040 sbci r31,hi8(-(JetiBox_Menu+3)) |
83 /* #APP */ |
84 ; 147 "jetimenu.c" 1 |
85 0066 E491 lpm r30, Z |
86 |
87 ; 0 "" 2 |
88 /* #NOAPP */ |
89 .L12: |
90 0068 E093 0000 sts item.2348,r30 |
91 .L2: |
92 006c 8091 0000 lds r24,item.2348 |
93 0070 8913 cpse r24,r25 |
94 0072 10E0 ldi r17,lo8(0) |
95 .L10: |
96 0074 0E94 0000 call LIBFC_JetiBox_Clear |
97 0078 8091 0000 lds r24,item.2348 |
98 007c 96E0 ldi r25,lo8(6) |
99 007e 899F mul r24,r25 |
100 0080 C001 movw r24,r0 |
101 0082 1124 clr r1 |
102 0084 8050 subi r24,lo8(-(JetiBox_Menu+4)) |
103 0086 9040 sbci r25,hi8(-(JetiBox_Menu+4)) |
104 0088 FC01 movw r30,r24 |
105 /* #APP */ |
106 ; 158 "jetimenu.c" 1 |
107 008a 2591 lpm r18, Z+ |
108 008c 3491 lpm r19, Z |
109 |
110 ; 0 "" 2 |
111 /* #NOAPP */ |
112 008e 812F mov r24,r17 |
113 0090 F901 movw r30,r18 |
114 0092 0995 icall |
115 0094 80E0 ldi r24,lo8(0) |
116 .L9: |
117 /* epilogue start */ |
118 0096 1F91 pop r17 |
119 0098 0895 ret |
121 .global Menu_PosInfo |
123 Menu_PosInfo: |
124 009a CF93 push r28 |
125 009c DF93 push r29 |
126 /* prologue: function */ |
127 /* frame size = 0 */ |
128 009e 8091 0000 lds r24,NaviDataOkay |
129 00a2 C0E0 ldi r28,lo8(gs(LIBFC_JetiBox_Putchar)) |
130 00a4 D0E0 ldi r29,hi8(gs(LIBFC_JetiBox_Putchar)) |
131 00a6 8823 tst r24 |
132 00a8 01F4 brne .+2 |
133 00aa 00C0 rjmp .L15 |
134 00ac 80E0 ldi r24,lo8(0) |
135 00ae 0E94 0000 call LIBFC_JetiBox_SetPos |
136 00b2 8DB7 in r24,__SP_L__ |
137 00b4 9EB7 in r25,__SP_H__ |
138 00b6 0897 sbiw r24,8 |
139 00b8 8DBF out __SP_L__,r24 |
140 00ba EDB7 in r30,__SP_L__ |
141 00bc FEB7 in r31,__SP_H__ |
142 00be 3196 adiw r30,1 |
143 00c0 ADB7 in r26,__SP_L__ |
144 00c2 BEB7 in r27,__SP_H__ |
145 00c4 1296 adiw r26,1+1 |
146 00c6 DC93 st X,r29 |
147 00c8 CE93 st -X,r28 |
148 00ca 1197 sbiw r26,1 |
149 00cc 80E0 ldi r24,lo8(__c.2304) |
150 00ce 90E0 ldi r25,hi8(__c.2304) |
151 00d0 9383 std Z+3,r25 |
152 00d2 8283 std Z+2,r24 |
153 00d4 8091 0000 lds r24,GPSInfo+3 |
154 00d8 8483 std Z+4,r24 |
155 00da 1582 std Z+5,__zero_reg__ |
156 00dc 8091 0000 lds r24,GPSInfo+1 |
157 00e0 8683 std Z+6,r24 |
158 00e2 1782 std Z+7,__zero_reg__ |
159 00e4 E091 0000 lds r30,_printf_P |
160 00e8 F091 0000 lds r31,(_printf_P)+1 |
161 00ec 0995 icall |
162 00ee EDB7 in r30,__SP_L__ |
163 00f0 FEB7 in r31,__SP_H__ |
164 00f2 3896 adiw r30,8 |
165 00f4 EDBF out __SP_L__,r30 |
166 00f6 8091 0000 lds r24,GPSInfo+2 |
167 00fa 8330 cpi r24,lo8(3) |
168 00fc 01F4 brne .L22 |
169 00fe 8CE0 ldi r24,lo8(12) |
170 0100 0E94 0000 call LIBFC_JetiBox_SetPos |
171 0104 00D0 rcall . |
172 0106 00D0 rcall . |
173 0108 ADB7 in r26,__SP_L__ |
174 010a BEB7 in r27,__SP_H__ |
175 010c 1296 adiw r26,1+1 |
176 010e DC93 st X,r29 |
177 0110 CE93 st -X,r28 |
178 0112 1197 sbiw r26,1 |
179 0114 80E0 ldi r24,lo8(__c.2307) |
180 0116 90E0 ldi r25,hi8(__c.2307) |
181 0118 1496 adiw r26,3+1 |
182 011a 9C93 st X,r25 |
183 011c 8E93 st -X,r24 |
184 011e 1397 sbiw r26,3 |
185 0120 00C0 rjmp .L23 |
186 .L22: |
187 0122 8CE0 ldi r24,lo8(12) |
188 0124 0E94 0000 call LIBFC_JetiBox_SetPos |
189 0128 00D0 rcall . |
190 012a 00D0 rcall . |
191 012c EDB7 in r30,__SP_L__ |
192 012e FEB7 in r31,__SP_H__ |
193 0130 D283 std Z+2,r29 |
194 0132 C183 std Z+1,r28 |
195 0134 80E0 ldi r24,lo8(__c.2313) |
196 0136 90E0 ldi r25,hi8(__c.2313) |
197 0138 9483 std Z+4,r25 |
198 013a 8383 std Z+3,r24 |
199 .L23: |
200 013c E091 0000 lds r30,_printf_P |
201 0140 F091 0000 lds r31,(_printf_P)+1 |
202 0144 0995 icall |
203 0146 0F90 pop __tmp_reg__ |
204 0148 0F90 pop __tmp_reg__ |
205 014a 0F90 pop __tmp_reg__ |
206 014c 0F90 pop __tmp_reg__ |
207 014e 8091 0000 lds r24,GPSInfo |
208 0152 81FF sbrs r24,1 |
209 0154 00C0 rjmp .L19 |
210 0156 8CE0 ldi r24,lo8(12) |
211 0158 0E94 0000 call LIBFC_JetiBox_SetPos |
212 015c 00D0 rcall . |
213 015e 00D0 rcall . |
214 0160 80E0 ldi r24,lo8(gs(LIBFC_JetiBox_Putchar)) |
215 0162 90E0 ldi r25,hi8(gs(LIBFC_JetiBox_Putchar)) |
216 0164 ADB7 in r26,__SP_L__ |
217 0166 BEB7 in r27,__SP_H__ |
218 0168 1296 adiw r26,1+1 |
219 016a 9C93 st X,r25 |
220 016c 8E93 st -X,r24 |
221 016e 1197 sbiw r26,1 |
222 0170 80E0 ldi r24,lo8(__c.2315) |
223 0172 90E0 ldi r25,hi8(__c.2315) |
224 0174 1496 adiw r26,3+1 |
225 0176 9C93 st X,r25 |
226 0178 8E93 st -X,r24 |
227 017a 1397 sbiw r26,3 |
228 017c E091 0000 lds r30,_printf_P |
229 0180 F091 0000 lds r31,(_printf_P)+1 |
230 0184 0995 icall |
231 0186 0F90 pop __tmp_reg__ |
232 0188 0F90 pop __tmp_reg__ |
233 018a 0F90 pop __tmp_reg__ |
234 018c 0F90 pop __tmp_reg__ |
235 .L19: |
236 018e 80E1 ldi r24,lo8(16) |
237 0190 0E94 0000 call LIBFC_JetiBox_SetPos |
238 0194 EDB7 in r30,__SP_L__ |
239 0196 FEB7 in r31,__SP_H__ |
240 0198 3A97 sbiw r30,10 |
241 019a EDBF out __SP_L__,r30 |
242 019c 3196 adiw r30,1 |
243 019e 80E0 ldi r24,lo8(gs(LIBFC_JetiBox_Putchar)) |
244 01a0 90E0 ldi r25,hi8(gs(LIBFC_JetiBox_Putchar)) |
245 01a2 ADB7 in r26,__SP_L__ |
246 01a4 BEB7 in r27,__SP_H__ |
247 01a6 1296 adiw r26,1+1 |
248 01a8 9C93 st X,r25 |
249 01aa 8E93 st -X,r24 |
250 01ac 1197 sbiw r26,1 |
251 01ae 80E0 ldi r24,lo8(__c.2317) |
252 01b0 90E0 ldi r25,hi8(__c.2317) |
253 01b2 9383 std Z+3,r25 |
254 01b4 8283 std Z+2,r24 |
255 01b6 8091 0000 lds r24,GPSInfo+4 |
256 01ba 9091 0000 lds r25,(GPSInfo+4)+1 |
257 01be 6AE0 ldi r22,lo8(10) |
258 01c0 70E0 ldi r23,hi8(10) |
259 01c2 0E94 0000 call __udivmodhi4 |
260 01c6 7583 std Z+5,r23 |
261 01c8 6483 std Z+4,r22 |
262 01ca 8091 0000 lds r24,GPSInfo+6 |
263 01ce 9091 0000 lds r25,(GPSInfo+6)+1 |
264 01d2 9783 std Z+7,r25 |
265 01d4 8683 std Z+6,r24 |
266 01d6 8FED ldi r24,lo8(223) |
267 01d8 90E0 ldi r25,hi8(223) |
268 01da 9187 std Z+9,r25 |
269 01dc 8087 std Z+8,r24 |
270 01de E091 0000 lds r30,_printf_P |
271 01e2 F091 0000 lds r31,(_printf_P)+1 |
272 01e6 0995 icall |
273 01e8 EDB7 in r30,__SP_L__ |
274 01ea FEB7 in r31,__SP_H__ |
275 01ec 3A96 adiw r30,10 |
276 01ee EDBF out __SP_L__,r30 |
277 01f0 00C0 rjmp .L21 |
278 .L15: |
279 01f2 82E0 ldi r24,lo8(2) |
280 01f4 0E94 0000 call LIBFC_JetiBox_SetPos |
281 01f8 00D0 rcall . |
282 01fa 00D0 rcall . |
283 01fc ADB7 in r26,__SP_L__ |
284 01fe BEB7 in r27,__SP_H__ |
285 0200 1296 adiw r26,1+1 |
286 0202 DC93 st X,r29 |
287 0204 CE93 st -X,r28 |
288 0206 1197 sbiw r26,1 |
289 0208 80E0 ldi r24,lo8(__c.2319) |
290 020a 90E0 ldi r25,hi8(__c.2319) |
291 020c 1496 adiw r26,3+1 |
292 020e 9C93 st X,r25 |
293 0210 8E93 st -X,r24 |
294 0212 1397 sbiw r26,3 |
295 0214 E091 0000 lds r30,_printf_P |
296 0218 F091 0000 lds r31,(_printf_P)+1 |
297 021c 0995 icall |
298 021e 0F90 pop __tmp_reg__ |
299 0220 0F90 pop __tmp_reg__ |
300 0222 0F90 pop __tmp_reg__ |
301 0224 0F90 pop __tmp_reg__ |
302 .L21: |
303 /* epilogue start */ |
304 0226 DF91 pop r29 |
305 0228 CF91 pop r28 |
306 022a 0895 ret |
308 .global Menu_Battery |
310 Menu_Battery: |
311 022c CF92 push r12 |
312 022e DF92 push r13 |
313 0230 EF92 push r14 |
314 0232 FF92 push r15 |
315 0234 0F93 push r16 |
316 0236 1F93 push r17 |
317 /* prologue: function */ |
318 /* frame size = 0 */ |
319 0238 80E0 ldi r24,lo8(0) |
320 023a 0E94 0000 call LIBFC_JetiBox_SetPos |
321 023e 8091 0000 lds r24,UBat |
322 0242 9091 0000 lds r25,(UBat)+1 |
323 0246 0091 0000 lds r16,UBat |
324 024a 1091 0000 lds r17,(UBat)+1 |
325 024e E090 0000 lds r14,Capacity |
326 0252 F090 0000 lds r15,(Capacity)+1 |
327 0256 2DB7 in r18,__SP_L__ |
328 0258 3EB7 in r19,__SP_H__ |
329 025a 2C50 subi r18,lo8(-(-12)) |
330 025c 3040 sbci r19,hi8(-(-12)) |
331 025e 2DBF out __SP_L__,r18 |
332 0260 EDB7 in r30,__SP_L__ |
333 0262 FEB7 in r31,__SP_H__ |
334 0264 3196 adiw r30,1 |
335 0266 20E0 ldi r18,lo8(gs(LIBFC_JetiBox_Putchar)) |
336 0268 C22E mov r12,r18 |
337 026a 20E0 ldi r18,hi8(gs(LIBFC_JetiBox_Putchar)) |
338 026c D22E mov r13,r18 |
339 026e ADB7 in r26,__SP_L__ |
340 0270 BEB7 in r27,__SP_H__ |
341 0272 1296 adiw r26,1+1 |
342 0274 DC92 st X,r13 |
343 0276 CE92 st -X,r12 |
344 0278 1197 sbiw r26,1 |
345 027a 20E0 ldi r18,lo8(__c.2287) |
346 027c 30E0 ldi r19,hi8(__c.2287) |
347 027e 3383 std Z+3,r19 |
348 0280 2283 std Z+2,r18 |
349 0282 6AE0 ldi r22,lo8(10) |
350 0284 70E0 ldi r23,hi8(10) |
351 0286 0E94 0000 call __divmodhi4 |
352 028a 7583 std Z+5,r23 |
353 028c 6483 std Z+4,r22 |
354 028e C801 movw r24,r16 |
355 0290 6AE0 ldi r22,lo8(10) |
356 0292 70E0 ldi r23,hi8(10) |
357 0294 0E94 0000 call __divmodhi4 |
358 0298 9783 std Z+7,r25 |
359 029a 8683 std Z+6,r24 |
360 029c C701 movw r24,r14 |
361 029e 6AE0 ldi r22,lo8(10) |
362 02a0 70E0 ldi r23,hi8(10) |
363 02a2 0E94 0000 call __udivmodhi4 |
364 02a6 7187 std Z+9,r23 |
365 02a8 6087 std Z+8,r22 |
366 02aa C701 movw r24,r14 |
367 02ac 6AE0 ldi r22,lo8(10) |
368 02ae 70E0 ldi r23,hi8(10) |
369 02b0 0E94 0000 call __udivmodhi4 |
370 02b4 9387 std Z+11,r25 |
371 02b6 8287 std Z+10,r24 |
372 02b8 E091 0000 lds r30,_printf_P |
373 02bc F091 0000 lds r31,(_printf_P)+1 |
374 02c0 0995 icall |
375 02c2 2DB7 in r18,__SP_L__ |
376 02c4 3EB7 in r19,__SP_H__ |
377 02c6 245F subi r18,lo8(-(12)) |
378 02c8 3F4F sbci r19,hi8(-(12)) |
379 02ca 2DBF out __SP_L__,r18 |
380 02cc 80E1 ldi r24,lo8(16) |
381 02ce 0E94 0000 call LIBFC_JetiBox_SetPos |
382 02d2 8DB7 in r24,__SP_L__ |
383 02d4 9EB7 in r25,__SP_H__ |
384 02d6 0897 sbiw r24,8 |
385 02d8 8DBF out __SP_L__,r24 |
386 02da EDB7 in r30,__SP_L__ |
387 02dc FEB7 in r31,__SP_H__ |
388 02de 3196 adiw r30,1 |
389 02e0 ADB7 in r26,__SP_L__ |
390 02e2 BEB7 in r27,__SP_H__ |
391 02e4 1296 adiw r26,1+1 |
392 02e6 DC92 st X,r13 |
393 02e8 CE92 st -X,r12 |
394 02ea 1197 sbiw r26,1 |
395 02ec 80E0 ldi r24,lo8(__c.2289) |
396 02ee 90E0 ldi r25,hi8(__c.2289) |
397 02f0 9383 std Z+3,r25 |
398 02f2 8283 std Z+2,r24 |
399 02f4 8091 0000 lds r24,Capacity+2 |
400 02f8 9091 0000 lds r25,(Capacity+2)+1 |
401 02fc 9583 std Z+5,r25 |
402 02fe 8483 std Z+4,r24 |
403 0300 8091 0000 lds r24,Capacity+4 |
404 0304 9091 0000 lds r25,(Capacity+4)+1 |
405 0308 9783 std Z+7,r25 |
406 030a 8683 std Z+6,r24 |
407 030c E091 0000 lds r30,_printf_P |
408 0310 F091 0000 lds r31,(_printf_P)+1 |
409 0314 0995 icall |
410 0316 2DB7 in r18,__SP_L__ |
411 0318 3EB7 in r19,__SP_H__ |
412 031a 285F subi r18,lo8(-(8)) |
413 031c 3F4F sbci r19,hi8(-(8)) |
414 031e 2DBF out __SP_L__,r18 |
415 /* epilogue start */ |
416 0320 1F91 pop r17 |
417 0322 0F91 pop r16 |
418 0324 FF90 pop r15 |
419 0326 EF90 pop r14 |
420 0328 DF90 pop r13 |
421 032a CF90 pop r12 |
422 032c 0895 ret |
424 .global Menu_Temperature |
426 Menu_Temperature: |
427 032e CF93 push r28 |
428 0330 DF93 push r29 |
429 /* prologue: function */ |
430 /* frame size = 0 */ |
431 0332 80E0 ldi r24,lo8(0) |
432 0334 0E94 0000 call LIBFC_JetiBox_SetPos |
433 0338 2DB7 in r18,__SP_L__ |
434 033a 3EB7 in r19,__SP_H__ |
435 033c 2C50 subi r18,lo8(-(-12)) |
436 033e 3040 sbci r19,hi8(-(-12)) |
437 0340 2DBF out __SP_L__,r18 |
438 0342 EDB7 in r30,__SP_L__ |
439 0344 FEB7 in r31,__SP_H__ |
440 0346 3196 adiw r30,1 |
441 0348 C0E0 ldi r28,lo8(gs(LIBFC_JetiBox_Putchar)) |
442 034a D0E0 ldi r29,hi8(gs(LIBFC_JetiBox_Putchar)) |
443 034c ADB7 in r26,__SP_L__ |
444 034e BEB7 in r27,__SP_H__ |
445 0350 1296 adiw r26,1+1 |
446 0352 DC93 st X,r29 |
447 0354 CE93 st -X,r28 |
448 0356 1197 sbiw r26,1 |
449 0358 80E0 ldi r24,lo8(__c.2258) |
450 035a 90E0 ldi r25,hi8(__c.2258) |
451 035c 9383 std Z+3,r25 |
452 035e 8283 std Z+2,r24 |
453 0360 8091 0000 lds r24,Motor+7 |
454 0364 9927 clr r25 |
455 0366 87FD sbrc r24,7 |
456 0368 9095 com r25 |
457 036a 9583 std Z+5,r25 |
458 036c 8483 std Z+4,r24 |
459 036e 8091 0000 lds r24,Motor+15 |
460 0372 9927 clr r25 |
461 0374 87FD sbrc r24,7 |
462 0376 9095 com r25 |
463 0378 9783 std Z+7,r25 |
464 037a 8683 std Z+6,r24 |
465 037c 8091 0000 lds r24,Motor+23 |
466 0380 9927 clr r25 |
467 0382 87FD sbrc r24,7 |
468 0384 9095 com r25 |
469 0386 9187 std Z+9,r25 |
470 0388 8087 std Z+8,r24 |
471 038a 8091 0000 lds r24,Motor+31 |
472 038e 9927 clr r25 |
473 0390 87FD sbrc r24,7 |
474 0392 9095 com r25 |
475 0394 9387 std Z+11,r25 |
476 0396 8287 std Z+10,r24 |
477 0398 E091 0000 lds r30,_printf_P |
478 039c F091 0000 lds r31,(_printf_P)+1 |
479 03a0 0995 icall |
480 03a2 EDB7 in r30,__SP_L__ |
481 03a4 FEB7 in r31,__SP_H__ |
482 03a6 3C96 adiw r30,12 |
483 03a8 EDBF out __SP_L__,r30 |
484 03aa 80E1 ldi r24,lo8(16) |
485 03ac 0E94 0000 call LIBFC_JetiBox_SetPos |
486 03b0 2DB7 in r18,__SP_L__ |
487 03b2 3EB7 in r19,__SP_H__ |
488 03b4 2C50 subi r18,lo8(-(-12)) |
489 03b6 3040 sbci r19,hi8(-(-12)) |
490 03b8 2DBF out __SP_L__,r18 |
491 03ba EDB7 in r30,__SP_L__ |
492 03bc FEB7 in r31,__SP_H__ |
493 03be 3196 adiw r30,1 |
494 03c0 ADB7 in r26,__SP_L__ |
495 03c2 BEB7 in r27,__SP_H__ |
496 03c4 1296 adiw r26,1+1 |
497 03c6 DC93 st X,r29 |
498 03c8 CE93 st -X,r28 |
499 03ca 1197 sbiw r26,1 |
500 03cc 80E0 ldi r24,lo8(__c.2260) |
501 03ce 90E0 ldi r25,hi8(__c.2260) |
502 03d0 9383 std Z+3,r25 |
503 03d2 8283 std Z+2,r24 |
504 03d4 8091 0000 lds r24,Motor+39 |
505 03d8 9927 clr r25 |
506 03da 87FD sbrc r24,7 |
507 03dc 9095 com r25 |
508 03de 9583 std Z+5,r25 |
509 03e0 8483 std Z+4,r24 |
510 03e2 8091 0000 lds r24,Motor+47 |
511 03e6 9927 clr r25 |
512 03e8 87FD sbrc r24,7 |
513 03ea 9095 com r25 |
514 03ec 9783 std Z+7,r25 |
515 03ee 8683 std Z+6,r24 |
516 03f0 8091 0000 lds r24,Motor+55 |
517 03f4 9927 clr r25 |
518 03f6 87FD sbrc r24,7 |
519 03f8 9095 com r25 |
520 03fa 9187 std Z+9,r25 |
521 03fc 8087 std Z+8,r24 |
522 03fe 8091 0000 lds r24,Motor+63 |
523 0402 9927 clr r25 |
524 0404 87FD sbrc r24,7 |
525 0406 9095 com r25 |
526 0408 9387 std Z+11,r25 |
527 040a 8287 std Z+10,r24 |
528 040c E091 0000 lds r30,_printf_P |
529 0410 F091 0000 lds r31,(_printf_P)+1 |
530 0414 0995 icall |
531 0416 8091 0000 lds r24,RequiredMotors |
532 041a EDB7 in r30,__SP_L__ |
533 041c FEB7 in r31,__SP_H__ |
534 041e 3C96 adiw r30,12 |
535 0420 EDBF out __SP_L__,r30 |
536 0422 8530 cpi r24,lo8(5) |
537 0424 00F4 brsh .L27 |
538 0426 80E1 ldi r24,lo8(16) |
539 0428 0E94 0000 call LIBFC_JetiBox_SetPos |
540 042c 00D0 rcall . |
541 042e 00D0 rcall . |
542 0430 ADB7 in r26,__SP_L__ |
543 0432 BEB7 in r27,__SP_H__ |
544 0434 1296 adiw r26,1+1 |
545 0436 DC93 st X,r29 |
546 0438 CE93 st -X,r28 |
547 043a 1197 sbiw r26,1 |
548 043c 80E0 ldi r24,lo8(__c.2262) |
549 043e 90E0 ldi r25,hi8(__c.2262) |
550 0440 1496 adiw r26,3+1 |
551 0442 9C93 st X,r25 |
552 0444 8E93 st -X,r24 |
553 0446 1397 sbiw r26,3 |
554 0448 E091 0000 lds r30,_printf_P |
555 044c F091 0000 lds r31,(_printf_P)+1 |
556 0450 0995 icall |
557 0452 0F90 pop __tmp_reg__ |
558 0454 0F90 pop __tmp_reg__ |
559 0456 0F90 pop __tmp_reg__ |
560 0458 0F90 pop __tmp_reg__ |
561 045a 00C0 rjmp .L29 |
562 .L27: |
563 045c 8730 cpi r24,lo8(7) |
564 045e 00F4 brsh .L29 |
565 0460 88E1 ldi r24,lo8(24) |
566 0462 0E94 0000 call LIBFC_JetiBox_SetPos |
567 0466 00D0 rcall . |
568 0468 00D0 rcall . |
569 046a 00D0 rcall . |
570 046c EDB7 in r30,__SP_L__ |
571 046e FEB7 in r31,__SP_H__ |
572 0470 3196 adiw r30,1 |
573 0472 ADB7 in r26,__SP_L__ |
574 0474 BEB7 in r27,__SP_H__ |
575 0476 1296 adiw r26,1+1 |
576 0478 DC93 st X,r29 |
577 047a CE93 st -X,r28 |
578 047c 1197 sbiw r26,1 |
579 047e 80E0 ldi r24,lo8(__c.2264) |
580 0480 90E0 ldi r25,hi8(__c.2264) |
581 0482 9383 std Z+3,r25 |
582 0484 8283 std Z+2,r24 |
583 0486 8FED ldi r24,lo8(223) |
584 0488 90E0 ldi r25,hi8(223) |
585 048a 9583 std Z+5,r25 |
586 048c 8483 std Z+4,r24 |
587 048e E091 0000 lds r30,_printf_P |
588 0492 F091 0000 lds r31,(_printf_P)+1 |
589 0496 0995 icall |
590 0498 EDB7 in r30,__SP_L__ |
591 049a FEB7 in r31,__SP_H__ |
592 049c 3696 adiw r30,6 |
593 049e EDBF out __SP_L__,r30 |
594 .L29: |
595 /* epilogue start */ |
596 04a0 DF91 pop r29 |
597 04a2 CF91 pop r28 |
598 04a4 0895 ret |
600 .global Menu_Status |
602 Menu_Status: |
603 04a6 0F93 push r16 |
604 04a8 1F93 push r17 |
605 04aa CF93 push r28 |
606 04ac DF93 push r29 |
607 /* prologue: function */ |
608 /* frame size = 0 */ |
609 04ae 80E0 ldi r24,lo8(0) |
610 04b0 0E94 0000 call LIBFC_JetiBox_SetPos |
611 04b4 8091 0000 lds r24,UBat |
612 04b8 9091 0000 lds r25,(UBat)+1 |
613 04bc 0091 0000 lds r16,UBat |
614 04c0 1091 0000 lds r17,(UBat)+1 |
615 04c4 2DB7 in r18,__SP_L__ |
616 04c6 3EB7 in r19,__SP_H__ |
617 04c8 2850 subi r18,lo8(-(-8)) |
618 04ca 3040 sbci r19,hi8(-(-8)) |
619 04cc 2DBF out __SP_L__,r18 |
620 04ce EDB7 in r30,__SP_L__ |
621 04d0 FEB7 in r31,__SP_H__ |
622 04d2 3196 adiw r30,1 |
623 04d4 C0E0 ldi r28,lo8(gs(LIBFC_JetiBox_Putchar)) |
624 04d6 D0E0 ldi r29,hi8(gs(LIBFC_JetiBox_Putchar)) |
625 04d8 ADB7 in r26,__SP_L__ |
626 04da BEB7 in r27,__SP_H__ |
627 04dc 1296 adiw r26,1+1 |
628 04de DC93 st X,r29 |
629 04e0 CE93 st -X,r28 |
630 04e2 1197 sbiw r26,1 |
631 04e4 20E0 ldi r18,lo8(__c.2216) |
632 04e6 30E0 ldi r19,hi8(__c.2216) |
633 04e8 3383 std Z+3,r19 |
634 04ea 2283 std Z+2,r18 |
635 04ec 6AE0 ldi r22,lo8(10) |
636 04ee 70E0 ldi r23,hi8(10) |
637 04f0 0E94 0000 call __divmodhi4 |
638 04f4 7583 std Z+5,r23 |
639 04f6 6483 std Z+4,r22 |
640 04f8 C801 movw r24,r16 |
641 04fa 6AE0 ldi r22,lo8(10) |
642 04fc 70E0 ldi r23,hi8(10) |
643 04fe 0E94 0000 call __divmodhi4 |
644 0502 9783 std Z+7,r25 |
645 0504 8683 std Z+6,r24 |
646 0506 E091 0000 lds r30,_printf_P |
647 050a F091 0000 lds r31,(_printf_P)+1 |
648 050e 0995 icall |
649 0510 EDB7 in r30,__SP_L__ |
650 0512 FEB7 in r31,__SP_H__ |
651 0514 3896 adiw r30,8 |
652 0516 EDBF out __SP_L__,r30 |
653 0518 8091 0000 lds r24,NaviDataOkay |
654 051c 8823 tst r24 |
655 051e 01F4 brne .+2 |
656 0520 00C0 rjmp .L31 |
657 0522 86E0 ldi r24,lo8(6) |
658 0524 0E94 0000 call LIBFC_JetiBox_SetPos |
659 0528 2DB7 in r18,__SP_L__ |
660 052a 3EB7 in r19,__SP_H__ |
661 052c 2A50 subi r18,lo8(-(-10)) |
662 052e 3040 sbci r19,hi8(-(-10)) |
663 0530 2DBF out __SP_L__,r18 |
664 0532 0DB7 in r16,__SP_L__ |
665 0534 1EB7 in r17,__SP_H__ |
666 0536 0F5F subi r16,lo8(-(1)) |
667 0538 1F4F sbci r17,hi8(-(1)) |
668 053a ADB7 in r26,__SP_L__ |
669 053c BEB7 in r27,__SP_H__ |
670 053e 1296 adiw r26,1+1 |
671 0540 DC93 st X,r29 |
672 0542 CE93 st -X,r28 |
673 0544 1197 sbiw r26,1 |
674 0546 80E0 ldi r24,lo8(__c.2218) |
675 0548 90E0 ldi r25,hi8(__c.2218) |
676 054a F801 movw r30,r16 |
677 054c 9383 std Z+3,r25 |
678 054e 8283 std Z+2,r24 |
679 0550 6091 0000 lds r22,ErsatzKompass |
680 0554 7091 0000 lds r23,(ErsatzKompass)+1 |
681 0558 8091 0000 lds r24,(ErsatzKompass)+2 |
682 055c 9091 0000 lds r25,(ErsatzKompass)+3 |
683 0560 2091 0000 lds r18,GIER_GRAD_FAKTOR |
684 0564 3091 0000 lds r19,(GIER_GRAD_FAKTOR)+1 |
685 0568 4091 0000 lds r20,(GIER_GRAD_FAKTOR)+2 |
686 056c 5091 0000 lds r21,(GIER_GRAD_FAKTOR)+3 |
687 0570 0E94 0000 call __divmodsi4 |
688 0574 D801 movw r26,r16 |
689 0576 1596 adiw r26,4+1 |
690 0578 3C93 st X,r19 |
691 057a 2E93 st -X,r18 |
692 057c 1497 sbiw r26,4 |
693 057e 8FED ldi r24,lo8(223) |
694 0580 90E0 ldi r25,hi8(223) |
695 0582 1796 adiw r26,6+1 |
696 0584 9C93 st X,r25 |
697 0586 8E93 st -X,r24 |
698 0588 1697 sbiw r26,6 |
699 058a 8091 0000 lds r24,GPSInfo+4 |
700 058e 9091 0000 lds r25,(GPSInfo+4)+1 |
701 0592 6AE0 ldi r22,lo8(10) |
702 0594 70E0 ldi r23,hi8(10) |
703 0596 0E94 0000 call __udivmodhi4 |
704 059a F801 movw r30,r16 |
705 059c 7187 std Z+9,r23 |
706 059e 6087 std Z+8,r22 |
707 05a0 E091 0000 lds r30,_printf_P |
708 05a4 F091 0000 lds r31,(_printf_P)+1 |
709 05a8 0995 icall |
710 05aa 2DB7 in r18,__SP_L__ |
711 05ac 3EB7 in r19,__SP_H__ |
712 05ae 265F subi r18,lo8(-(10)) |
713 05b0 3F4F sbci r19,hi8(-(10)) |
714 05b2 2DBF out __SP_L__,r18 |
715 05b4 00C0 rjmp .L32 |
716 .L31: |
717 05b6 86E0 ldi r24,lo8(6) |
718 05b8 0E94 0000 call LIBFC_JetiBox_SetPos |
719 05bc 00D0 rcall . |
720 05be 00D0 rcall . |
721 05c0 ADB7 in r26,__SP_L__ |
722 05c2 BEB7 in r27,__SP_H__ |
723 05c4 1296 adiw r26,1+1 |
724 05c6 DC93 st X,r29 |
725 05c8 CE93 st -X,r28 |
726 05ca 1197 sbiw r26,1 |
727 05cc 80E0 ldi r24,lo8(__c.2220) |
728 05ce 90E0 ldi r25,hi8(__c.2220) |
729 05d0 1496 adiw r26,3+1 |
730 05d2 9C93 st X,r25 |
731 05d4 8E93 st -X,r24 |
732 05d6 1397 sbiw r26,3 |
733 05d8 E091 0000 lds r30,_printf_P |
734 05dc F091 0000 lds r31,(_printf_P)+1 |
735 05e0 0995 icall |
736 05e2 0F90 pop __tmp_reg__ |
737 05e4 0F90 pop __tmp_reg__ |
738 05e6 0F90 pop __tmp_reg__ |
739 05e8 0F90 pop __tmp_reg__ |
740 .L32: |
741 05ea 8091 0000 lds r24,NC_ErrorCode |
742 05ee 8823 tst r24 |
743 05f0 01F0 breq .L33 |
744 05f2 86E0 ldi r24,lo8(6) |
745 05f4 0E94 0000 call LIBFC_JetiBox_SetPos |
746 05f8 00D0 rcall . |
747 05fa 00D0 rcall . |
748 05fc 00D0 rcall . |
749 05fe EDB7 in r30,__SP_L__ |
750 0600 FEB7 in r31,__SP_H__ |
751 0602 3196 adiw r30,1 |
752 0604 80E0 ldi r24,lo8(gs(LIBFC_JetiBox_Putchar)) |
753 0606 90E0 ldi r25,hi8(gs(LIBFC_JetiBox_Putchar)) |
754 0608 ADB7 in r26,__SP_L__ |
755 060a BEB7 in r27,__SP_H__ |
756 060c 1296 adiw r26,1+1 |
757 060e 9C93 st X,r25 |
758 0610 8E93 st -X,r24 |
759 0612 1197 sbiw r26,1 |
760 0614 80E0 ldi r24,lo8(__c.2222) |
761 0616 90E0 ldi r25,hi8(__c.2222) |
762 0618 9383 std Z+3,r25 |
763 061a 8283 std Z+2,r24 |
764 061c 8091 0000 lds r24,NC_ErrorCode |
765 0620 8483 std Z+4,r24 |
766 0622 1582 std Z+5,__zero_reg__ |
767 0624 E091 0000 lds r30,_printf_P |
768 0628 F091 0000 lds r31,(_printf_P)+1 |
769 062c 0995 icall |
770 062e EDB7 in r30,__SP_L__ |
771 0630 FEB7 in r31,__SP_H__ |
772 0632 3696 adiw r30,6 |
773 0634 EDBF out __SP_L__,r30 |
774 .L33: |
775 0636 80E1 ldi r24,lo8(16) |
776 0638 0E94 0000 call LIBFC_JetiBox_SetPos |
777 063c 2091 0000 lds r18,FlugSekunden |
778 0640 3091 0000 lds r19,(FlugSekunden)+1 |
779 0644 8DB7 in r24,__SP_L__ |
780 0646 9EB7 in r25,__SP_H__ |
781 0648 0A97 sbiw r24,10 |
782 064a 8DBF out __SP_L__,r24 |
783 064c EDB7 in r30,__SP_L__ |
784 064e FEB7 in r31,__SP_H__ |
785 0650 3196 adiw r30,1 |
786 0652 C0E0 ldi r28,lo8(gs(LIBFC_JetiBox_Putchar)) |
787 0654 D0E0 ldi r29,hi8(gs(LIBFC_JetiBox_Putchar)) |
788 0656 ADB7 in r26,__SP_L__ |
789 0658 BEB7 in r27,__SP_H__ |
790 065a 1296 adiw r26,1+1 |
791 065c DC93 st X,r29 |
792 065e CE93 st -X,r28 |
793 0660 1197 sbiw r26,1 |
794 0662 80E0 ldi r24,lo8(__c.2224) |
795 0664 90E0 ldi r25,hi8(__c.2224) |
796 0666 9383 std Z+3,r25 |
797 0668 8283 std Z+2,r24 |
798 066a 8091 0000 lds r24,Capacity+4 |
799 066e 9091 0000 lds r25,(Capacity+4)+1 |
800 0672 9583 std Z+5,r25 |
801 0674 8483 std Z+4,r24 |
802 0676 C901 movw r24,r18 |
803 0678 6CE3 ldi r22,lo8(60) |
804 067a 70E0 ldi r23,hi8(60) |
805 067c 0E94 0000 call __udivmodhi4 |
806 0680 7783 std Z+7,r23 |
807 0682 6683 std Z+6,r22 |
808 0684 C901 movw r24,r18 |
809 0686 6CE3 ldi r22,lo8(60) |
810 0688 70E0 ldi r23,hi8(60) |
811 068a 0E94 0000 call __udivmodhi4 |
812 068e 9187 std Z+9,r25 |
813 0690 8087 std Z+8,r24 |
814 0692 E091 0000 lds r30,_printf_P |
815 0696 F091 0000 lds r31,(_printf_P)+1 |
816 069a 0995 icall |
817 069c 8091 0000 lds r24,EE_Parameter+13 |
818 06a0 EDB7 in r30,__SP_L__ |
819 06a2 FEB7 in r31,__SP_H__ |
820 06a4 3A96 adiw r30,10 |
821 06a6 EDBF out __SP_L__,r30 |
822 06a8 80FF sbrs r24,0 |
823 06aa 00C0 rjmp .L35 |
824 06ac 8AE1 ldi r24,lo8(26) |
825 06ae 0E94 0000 call LIBFC_JetiBox_SetPos |
826 06b2 2DB7 in r18,__SP_L__ |
827 06b4 3EB7 in r19,__SP_H__ |
828 06b6 2850 subi r18,lo8(-(-8)) |
829 06b8 3040 sbci r19,hi8(-(-8)) |
830 06ba 2DBF out __SP_L__,r18 |
831 06bc 0DB7 in r16,__SP_L__ |
832 06be 1EB7 in r17,__SP_H__ |
833 06c0 0F5F subi r16,lo8(-(1)) |
834 06c2 1F4F sbci r17,hi8(-(1)) |
835 06c4 ADB7 in r26,__SP_L__ |
836 06c6 BEB7 in r27,__SP_H__ |
837 06c8 1296 adiw r26,1+1 |
838 06ca DC93 st X,r29 |
839 06cc CE93 st -X,r28 |
840 06ce 1197 sbiw r26,1 |
841 06d0 80E0 ldi r24,lo8(__c.2226) |
842 06d2 90E0 ldi r25,hi8(__c.2226) |
843 06d4 F801 movw r30,r16 |
844 06d6 9383 std Z+3,r25 |
845 06d8 8283 std Z+2,r24 |
846 06da 6091 0000 lds r22,HoehenWert |
847 06de 7091 0000 lds r23,(HoehenWert)+1 |
848 06e2 8091 0000 lds r24,(HoehenWert)+2 |
849 06e6 9091 0000 lds r25,(HoehenWert)+3 |
850 06ea 24E6 ldi r18,lo8(100) |
851 06ec 30E0 ldi r19,hi8(100) |
852 06ee 40E0 ldi r20,hlo8(100) |
853 06f0 50E0 ldi r21,hhi8(100) |
854 06f2 0E94 0000 call __divmodsi4 |
855 06f6 D801 movw r26,r16 |
856 06f8 1596 adiw r26,4+1 |
857 06fa 3C93 st X,r19 |
858 06fc 2E93 st -X,r18 |
859 06fe 1497 sbiw r26,4 |
860 0700 8091 0000 lds r24,VarioCharacter |
861 0704 1696 adiw r26,6 |
862 0706 8C93 st X,r24 |
863 0708 1697 sbiw r26,6 |
864 070a 1796 adiw r26,7 |
865 070c 1C92 st X,__zero_reg__ |
866 070e E091 0000 lds r30,_printf_P |
867 0712 F091 0000 lds r31,(_printf_P)+1 |
868 0716 0995 icall |
869 0718 EDB7 in r30,__SP_L__ |
870 071a FEB7 in r31,__SP_H__ |
871 071c 3896 adiw r30,8 |
872 071e EDBF out __SP_L__,r30 |
873 .L35: |
874 /* epilogue start */ |
875 0720 DF91 pop r29 |
876 0722 CF91 pop r28 |
877 0724 1F91 pop r17 |
878 0726 0F91 pop r16 |
879 0728 0895 ret |
881 .global JetiBox_Menu |
882 .section .progmem.data,"a",@progbits |
885 JetiBox_Menu: |
886 0000 03 .byte 3 |
887 0001 01 .byte 1 |
888 0002 00 .byte 0 |
889 0003 00 .byte 0 |
890 0004 0000 .word gs(Menu_Status) |
891 0006 00 .byte 0 |
892 0007 02 .byte 2 |
893 0008 01 .byte 1 |
894 0009 01 .byte 1 |
895 000a 0000 .word gs(Menu_Temperature) |
896 000c 01 .byte 1 |
897 000d 03 .byte 3 |
898 000e 02 .byte 2 |
899 000f 02 .byte 2 |
900 0010 0000 .word gs(Menu_Battery) |
901 0012 02 .byte 2 |
902 0013 00 .byte 0 |
903 0014 03 .byte 3 |
904 0015 03 .byte 3 |
905 0016 0000 .word gs(Menu_PosInfo) |
906 .lcomm last_item.2349,1 |
907 .lcomm item.2348,1 |
910 __c.2319: |
911 0018 4E6F 204E .string "No NaviCtrl!" |
911 6176 6943 |
911 7472 6C21 |
911 00 |
914 __c.2317: |
915 0025 486F 6D65 .string "Home:%3dm %3d%c" |
915 3A25 3364 |
915 6D20 2533 |
915 6425 6300 |
918 __c.2315: |
919 0035 4447 5053 .string "DGPS" |
919 00 |
922 __c.2313: |
923 003a 4E6F 4678 .string "NoFx" |
923 00 |
926 __c.2307: |
927 003f 2020 3344 .string " 3D" |
927 00 |
930 __c.2304: |
931 0044 2532 756D .string "%2um/s Sat:%d " |
931 2F73 2053 |
931 6174 3A25 |
931 6420 00 |
934 __c.2289: |
935 0053 2534 6957 .string "%4iW %6imAh" |
935 2025 3669 |
935 6D41 6800 |
938 __c.2287: |
939 005f 2532 692E .string "%2i.%1iV %3i.%1iA" |
939 2531 6956 |
939 2020 2533 |
939 692E 2531 |
939 6941 00 |
942 __c.2264: |
943 0072 2563 4320 .string "%cC " |
943 2020 2020 |
943 00 |
946 __c.2262: |
947 007b 5465 6D70 .string "Temperatures " |
947 6572 6174 |
947 7572 6573 |
947 2020 2020 |
947 00 |
950 __c.2260: |
951 008c 2533 6920 .string "%3i %3i %3i %3i" |
951 2533 6920 |
951 2533 6920 |
951 2533 6900 |
954 __c.2258: |
955 009c 2533 6920 .string "%3i %3i %3i %3i" |
955 2533 6920 |
955 2533 6920 |
955 2533 6900 |
958 __c.2226: |
959 00ac 2534 696D .string "%4im%c" |
959 2563 00 |
962 __c.2224: |
963 00b3 2534 6920 .string "%4i %2i:%02i" |
963 2532 693A |
963 2530 3269 |
963 00 |
966 __c.2222: |
967 00c0 4552 524F .string "ERROR: %2d" |
967 523A 2025 |
967 3264 00 |
970 __c.2220: |
971 00cb 5374 6174 .string "Status" |
971 7573 00 |
974 __c.2218: |
975 00d2 2533 6425 .string "%3d%c %03dm" |
975 6320 2530 |
975 3364 6D00 |
978 __c.2216: |
979 00de 2532 692E .string "%2i.%1iV" |
979 2531 6956 |
979 00 |
980 .global __do_clear_bss |
8 .global __do_copy_data |
9 .global __do_clear_bss |
10 .global JetiBox_Menu |
11 .section .progmem.data,"a",@progbits |
14 JetiBox_Menu: |
15 0000 03 .byte 3 |
16 0001 01 .byte 1 |
17 0002 00 .byte 0 |
18 0003 00 .byte 0 |
19 0004 0000 .word pm(Menu_Status) |
20 0006 00 .byte 0 |
21 0007 02 .byte 2 |
22 0008 01 .byte 1 |
23 0009 01 .byte 1 |
24 000a 0000 .word pm(Menu_Temperature) |
25 000c 01 .byte 1 |
26 000d 03 .byte 3 |
27 000e 02 .byte 2 |
28 000f 02 .byte 2 |
29 0010 0000 .word pm(Menu_Battery) |
30 0012 02 .byte 2 |
31 0013 00 .byte 0 |
32 0014 03 .byte 3 |
33 0015 03 .byte 3 |
34 0016 0000 .word pm(Menu_PosInfo) |
37 __c.14: |
38 0018 2532 692E .string "%2i.%1iV" |
38 2531 6956 |
38 00 |
41 __c.15: |
42 0021 2533 6425 .string "%3d%c %03dm" |
42 6320 2530 |
42 3364 6D00 |
45 __c.16: |
46 002d 5374 6174 .string "Status" |
46 7573 00 |
49 __c.17: |
50 0034 4552 524F .string "ERROR: %2d" |
50 523A 2025 |
50 3264 00 |
53 __c.18: |
54 003f 2534 6920 .string "%4i %2i:%02i" |
54 2532 693A |
54 2530 3269 |
54 00 |
57 __c.19: |
58 004c 2534 696D .string "%4im%c" |
58 2563 00 |
59 .text |
60 .global Menu_Status |
62 Menu_Status: |
63 /* prologue: frame size=0 */ |
64 0000 CF93 push r28 |
65 0002 DF93 push r29 |
66 /* prologue end (size=2) */ |
67 0004 80E0 ldi r24,lo8(0) |
68 0006 0E94 0000 call LIBFC_JetiBox_SetPos |
69 000a 8091 0000 lds r24,UBat |
70 000e 9091 0000 lds r25,(UBat)+1 |
71 0012 6AE0 ldi r22,lo8(10) |
72 0014 70E0 ldi r23,hi8(10) |
73 0016 0E94 0000 call __divmodhi4 |
74 001a 9F93 push r25 |
75 001c 8F93 push r24 |
76 001e 8091 0000 lds r24,UBat |
77 0022 9091 0000 lds r25,(UBat)+1 |
78 0026 6AE0 ldi r22,lo8(10) |
79 0028 70E0 ldi r23,hi8(10) |
80 002a 0E94 0000 call __divmodhi4 |
81 002e 7F93 push r23 |
82 0030 6F93 push r22 |
83 0032 80E0 ldi r24,lo8(__c.14) |
84 0034 90E0 ldi r25,hi8(__c.14) |
85 0036 9F93 push r25 |
86 0038 8F93 push r24 |
87 003a C0E0 ldi r28,lo8(pm(LIBFC_JetiBox_Putchar)) |
88 003c D0E0 ldi r29,hi8(pm(LIBFC_JetiBox_Putchar)) |
89 003e DF93 push r29 |
90 0040 CF93 push r28 |
91 0042 E091 0000 lds r30,_printf_P |
92 0046 F091 0000 lds r31,(_printf_P)+1 |
93 004a 0995 icall |
94 004c 2DB7 in r18,__SP_L__ |
95 004e 3EB7 in r19,__SP_H__ |
96 0050 285F subi r18,lo8(-(8)) |
97 0052 3F4F sbci r19,hi8(-(8)) |
98 0054 2DBF out __SP_L__,r18 |
99 0056 8091 0000 lds r24,NaviDataOkay |
100 005a 8823 tst r24 |
101 005c B9F1 breq .L2 |
102 005e 86E0 ldi r24,lo8(6) |
103 0060 0E94 0000 call LIBFC_JetiBox_SetPos |
104 0064 8091 0000 lds r24,GPSInfo+4 |
105 0068 9091 0000 lds r25,(GPSInfo+4)+1 |
106 006c 6AE0 ldi r22,lo8(10) |
107 006e 70E0 ldi r23,hi8(10) |
108 0070 0E94 0000 call __udivmodhi4 |
109 0074 7F93 push r23 |
110 0076 6F93 push r22 |
111 0078 8FED ldi r24,lo8(223) |
112 007a 90E0 ldi r25,hi8(223) |
113 007c 9F93 push r25 |
114 007e 8F93 push r24 |
115 0080 8091 0000 lds r24,ErsatzKompass |
116 0084 9091 0000 lds r25,(ErsatzKompass)+1 |
117 0088 A091 0000 lds r26,(ErsatzKompass)+2 |
118 008c B091 0000 lds r27,(ErsatzKompass)+3 |
119 0090 2091 0000 lds r18,GIER_GRAD_FAKTOR |
120 0094 3091 0000 lds r19,(GIER_GRAD_FAKTOR)+1 |
121 0098 4091 0000 lds r20,(GIER_GRAD_FAKTOR)+2 |
122 009c 5091 0000 lds r21,(GIER_GRAD_FAKTOR)+3 |
123 00a0 BC01 movw r22,r24 |
124 00a2 CD01 movw r24,r26 |
125 00a4 0E94 0000 call __divmodsi4 |
126 00a8 3F93 push r19 |
127 00aa 2F93 push r18 |
128 00ac 80E0 ldi r24,lo8(__c.15) |
129 00ae 90E0 ldi r25,hi8(__c.15) |
130 00b0 9F93 push r25 |
131 00b2 8F93 push r24 |
132 00b4 DF93 push r29 |
133 00b6 CF93 push r28 |
134 00b8 E091 0000 lds r30,_printf_P |
135 00bc F091 0000 lds r31,(_printf_P)+1 |
136 00c0 0995 icall |
137 00c2 8DB7 in r24,__SP_L__ |
138 00c4 9EB7 in r25,__SP_H__ |
139 00c6 0A96 adiw r24,10 |
140 00c8 8DBF out __SP_L__,r24 |
141 00ca 12C0 rjmp .L3 |
142 .L2: |
143 00cc 86E0 ldi r24,lo8(6) |
144 00ce 0E94 0000 call LIBFC_JetiBox_SetPos |
145 00d2 80E0 ldi r24,lo8(__c.16) |
146 00d4 90E0 ldi r25,hi8(__c.16) |
147 00d6 9F93 push r25 |
148 00d8 8F93 push r24 |
149 00da DF93 push r29 |
150 00dc CF93 push r28 |
151 00de E091 0000 lds r30,_printf_P |
152 00e2 F091 0000 lds r31,(_printf_P)+1 |
153 00e6 0995 icall |
154 00e8 0F90 pop __tmp_reg__ |
155 00ea 0F90 pop __tmp_reg__ |
156 00ec 0F90 pop __tmp_reg__ |
157 00ee 0F90 pop __tmp_reg__ |
158 .L3: |
159 00f0 8091 0000 lds r24,NC_ErrorCode |
160 00f4 8823 tst r24 |
161 00f6 C1F0 breq .L4 |
162 00f8 86E0 ldi r24,lo8(6) |
163 00fa 0E94 0000 call LIBFC_JetiBox_SetPos |
164 00fe 8091 0000 lds r24,NC_ErrorCode |
165 0102 9927 clr r25 |
166 0104 9F93 push r25 |
167 0106 8F93 push r24 |
168 0108 80E0 ldi r24,lo8(__c.17) |
169 010a 90E0 ldi r25,hi8(__c.17) |
170 010c 9F93 push r25 |
171 010e 8F93 push r24 |
172 0110 DF93 push r29 |
173 0112 CF93 push r28 |
174 0114 E091 0000 lds r30,_printf_P |
175 0118 F091 0000 lds r31,(_printf_P)+1 |
176 011c 0995 icall |
177 011e 2DB7 in r18,__SP_L__ |
178 0120 3EB7 in r19,__SP_H__ |
179 0122 2A5F subi r18,lo8(-(6)) |
180 0124 3F4F sbci r19,hi8(-(6)) |
181 0126 2DBF out __SP_L__,r18 |
182 .L4: |
183 0128 80E1 ldi r24,lo8(16) |
184 012a 0E94 0000 call LIBFC_JetiBox_SetPos |
185 012e 8091 0000 lds r24,FlugSekunden |
186 0132 9091 0000 lds r25,(FlugSekunden)+1 |
187 0136 6CE3 ldi r22,lo8(60) |
188 0138 70E0 ldi r23,hi8(60) |
189 013a 0E94 0000 call __udivmodhi4 |
190 013e 9F93 push r25 |
191 0140 8F93 push r24 |
192 0142 8091 0000 lds r24,FlugSekunden |
193 0146 9091 0000 lds r25,(FlugSekunden)+1 |
194 014a 6CE3 ldi r22,lo8(60) |
195 014c 70E0 ldi r23,hi8(60) |
196 014e 0E94 0000 call __udivmodhi4 |
197 0152 7F93 push r23 |
198 0154 6F93 push r22 |
199 0156 8091 0000 lds r24,Capacity+4 |
200 015a 9091 0000 lds r25,(Capacity+4)+1 |
201 015e 9F93 push r25 |
202 0160 8F93 push r24 |
203 0162 80E0 ldi r24,lo8(__c.18) |
204 0164 90E0 ldi r25,hi8(__c.18) |
205 0166 9F93 push r25 |
206 0168 8F93 push r24 |
207 016a C0E0 ldi r28,lo8(pm(LIBFC_JetiBox_Putchar)) |
208 016c D0E0 ldi r29,hi8(pm(LIBFC_JetiBox_Putchar)) |
209 016e DF93 push r29 |
210 0170 CF93 push r28 |
211 0172 E091 0000 lds r30,_printf_P |
212 0176 F091 0000 lds r31,(_printf_P)+1 |
213 017a 0995 icall |
214 017c 8091 0000 lds r24,EE_Parameter+13 |
215 0180 2DB7 in r18,__SP_L__ |
216 0182 3EB7 in r19,__SP_H__ |
217 0184 265F subi r18,lo8(-(10)) |
218 0186 3F4F sbci r19,hi8(-(10)) |
219 0188 2DBF out __SP_L__,r18 |
220 018a 80FF sbrs r24,0 |
221 018c 29C0 rjmp .L1 |
222 018e 8AE1 ldi r24,lo8(26) |
223 0190 0E94 0000 call LIBFC_JetiBox_SetPos |
224 0194 8091 0000 lds r24,VarioCharacter |
225 0198 9927 clr r25 |
226 019a 9F93 push r25 |
227 019c 8F93 push r24 |
228 019e 8091 0000 lds r24,HoehenWert |
229 01a2 9091 0000 lds r25,(HoehenWert)+1 |
230 01a6 A091 0000 lds r26,(HoehenWert)+2 |
231 01aa B091 0000 lds r27,(HoehenWert)+3 |
232 01ae BC01 movw r22,r24 |
233 01b0 CD01 movw r24,r26 |
234 01b2 24E6 ldi r18,lo8(100) |
235 01b4 30E0 ldi r19,hi8(100) |
236 01b6 40E0 ldi r20,hlo8(100) |
237 01b8 50E0 ldi r21,hhi8(100) |
238 01ba 0E94 0000 call __divmodsi4 |
239 01be 3F93 push r19 |
240 01c0 2F93 push r18 |
241 01c2 80E0 ldi r24,lo8(__c.19) |
242 01c4 90E0 ldi r25,hi8(__c.19) |
243 01c6 9F93 push r25 |
244 01c8 8F93 push r24 |
245 01ca DF93 push r29 |
246 01cc CF93 push r28 |
247 01ce E091 0000 lds r30,_printf_P |
248 01d2 F091 0000 lds r31,(_printf_P)+1 |
249 01d6 0995 icall |
250 01d8 8DB7 in r24,__SP_L__ |
251 01da 9EB7 in r25,__SP_H__ |
252 01dc 0896 adiw r24,8 |
253 01de 8DBF out __SP_L__,r24 |
254 .L1: |
255 /* epilogue: frame size=0 */ |
256 01e0 DF91 pop r29 |
257 01e2 CF91 pop r28 |
258 01e4 0895 ret |
259 /* epilogue end (size=3) */ |
260 /* function Menu_Status size 243 (238) */ |
262 .section .progmem.data |
265 __c.10: |
266 0053 2533 6920 .string "%3i %3i %3i %3i" |
266 2533 6920 |
266 2533 6920 |
266 2533 6900 |
269 __c.11: |
270 0063 2533 6920 .string "%3i %3i %3i %3i" |
270 2533 6920 |
270 2533 6920 |
270 2533 6900 |
273 __c.12: |
274 0073 5465 6D70 .string "Temperatures " |
274 6572 6174 |
274 7572 6573 |
274 2020 2020 |
274 00 |
277 __c.13: |
278 0084 2563 4320 .string "%cC " |
278 2020 2020 |
278 00 |
279 .text |
280 .global Menu_Temperature |
282 Menu_Temperature: |
283 /* prologue: frame size=0 */ |
284 01e6 CF93 push r28 |
285 01e8 DF93 push r29 |
286 /* prologue end (size=2) */ |
287 01ea 80E0 ldi r24,lo8(0) |
288 01ec 0E94 0000 call LIBFC_JetiBox_SetPos |
289 01f0 8091 0000 lds r24,Motor+31 |
290 01f4 9927 clr r25 |
291 01f6 87FD sbrc r24,7 |
292 01f8 9095 com r25 |
293 01fa 9F93 push r25 |
294 01fc 8F93 push r24 |
295 01fe 8091 0000 lds r24,Motor+23 |
296 0202 9927 clr r25 |
297 0204 87FD sbrc r24,7 |
298 0206 9095 com r25 |
299 0208 9F93 push r25 |
300 020a 8F93 push r24 |
301 020c 8091 0000 lds r24,Motor+15 |
302 0210 9927 clr r25 |
303 0212 87FD sbrc r24,7 |
304 0214 9095 com r25 |
305 0216 9F93 push r25 |
306 0218 8F93 push r24 |
307 021a 8091 0000 lds r24,Motor+7 |
308 021e 9927 clr r25 |
309 0220 87FD sbrc r24,7 |
310 0222 9095 com r25 |
311 0224 9F93 push r25 |
312 0226 8F93 push r24 |
313 0228 80E0 ldi r24,lo8(__c.10) |
314 022a 90E0 ldi r25,hi8(__c.10) |
315 022c 9F93 push r25 |
316 022e 8F93 push r24 |
317 0230 C0E0 ldi r28,lo8(pm(LIBFC_JetiBox_Putchar)) |
318 0232 D0E0 ldi r29,hi8(pm(LIBFC_JetiBox_Putchar)) |
319 0234 DF93 push r29 |
320 0236 CF93 push r28 |
321 0238 E091 0000 lds r30,_printf_P |
322 023c F091 0000 lds r31,(_printf_P)+1 |
323 0240 0995 icall |
324 0242 80E1 ldi r24,lo8(16) |
325 0244 0E94 0000 call LIBFC_JetiBox_SetPos |
326 0248 2DB7 in r18,__SP_L__ |
327 024a 3EB7 in r19,__SP_H__ |
328 024c 245F subi r18,lo8(-(12)) |
329 024e 3F4F sbci r19,hi8(-(12)) |
330 0250 2DBF out __SP_L__,r18 |
331 0252 8091 0000 lds r24,Motor+63 |
332 0256 9927 clr r25 |
333 0258 87FD sbrc r24,7 |
334 025a 9095 com r25 |
335 025c 9F93 push r25 |
336 025e 8F93 push r24 |
337 0260 8091 0000 lds r24,Motor+55 |
338 0264 9927 clr r25 |
339 0266 87FD sbrc r24,7 |
340 0268 9095 com r25 |
341 026a 9F93 push r25 |
342 026c 8F93 push r24 |
343 026e 8091 0000 lds r24,Motor+47 |
344 0272 9927 clr r25 |
345 0274 87FD sbrc r24,7 |
346 0276 9095 com r25 |
347 0278 9F93 push r25 |
348 027a 8F93 push r24 |
349 027c 8091 0000 lds r24,Motor+39 |
350 0280 9927 clr r25 |
351 0282 87FD sbrc r24,7 |
352 0284 9095 com r25 |
353 0286 9F93 push r25 |
354 0288 8F93 push r24 |
355 028a 80E0 ldi r24,lo8(__c.11) |
356 028c 90E0 ldi r25,hi8(__c.11) |
357 028e 9F93 push r25 |
358 0290 8F93 push r24 |
359 0292 DF93 push r29 |
360 0294 CF93 push r28 |
361 0296 E091 0000 lds r30,_printf_P |
362 029a F091 0000 lds r31,(_printf_P)+1 |
363 029e 0995 icall |
364 02a0 8091 0000 lds r24,RequiredMotors |
365 02a4 2DB7 in r18,__SP_L__ |
366 02a6 3EB7 in r19,__SP_H__ |
367 02a8 245F subi r18,lo8(-(12)) |
368 02aa 3F4F sbci r19,hi8(-(12)) |
369 02ac 2DBF out __SP_L__,r18 |
370 02ae 8530 cpi r24,lo8(5) |
371 02b0 98F4 brsh .L7 |
372 02b2 80E1 ldi r24,lo8(16) |
373 02b4 0E94 0000 call LIBFC_JetiBox_SetPos |
374 02b8 80E0 ldi r24,lo8(__c.12) |
375 02ba 90E0 ldi r25,hi8(__c.12) |
376 02bc 9F93 push r25 |
377 02be 8F93 push r24 |
378 02c0 DF93 push r29 |
379 02c2 CF93 push r28 |
380 02c4 E091 0000 lds r30,_printf_P |
381 02c8 F091 0000 lds r31,(_printf_P)+1 |
382 02cc 0995 icall |
383 02ce 0F90 pop __tmp_reg__ |
384 02d0 0F90 pop __tmp_reg__ |
385 02d2 0F90 pop __tmp_reg__ |
386 02d4 0F90 pop __tmp_reg__ |
387 02d6 18C0 rjmp .L6 |
388 .L7: |
389 02d8 8730 cpi r24,lo8(7) |
390 02da B0F4 brsh .L6 |
391 02dc 88E1 ldi r24,lo8(24) |
392 02de 0E94 0000 call LIBFC_JetiBox_SetPos |
393 02e2 8FED ldi r24,lo8(223) |
394 02e4 90E0 ldi r25,hi8(223) |
395 02e6 9F93 push r25 |
396 02e8 8F93 push r24 |
397 02ea 80E0 ldi r24,lo8(__c.13) |
398 02ec 90E0 ldi r25,hi8(__c.13) |
399 02ee 9F93 push r25 |
400 02f0 8F93 push r24 |
401 02f2 DF93 push r29 |
402 02f4 CF93 push r28 |
403 02f6 E091 0000 lds r30,_printf_P |
404 02fa F091 0000 lds r31,(_printf_P)+1 |
405 02fe 0995 icall |
406 0300 8DB7 in r24,__SP_L__ |
407 0302 9EB7 in r25,__SP_H__ |
408 0304 0696 adiw r24,6 |
409 0306 8DBF out __SP_L__,r24 |
410 .L6: |
411 /* epilogue: frame size=0 */ |
412 0308 DF91 pop r29 |
413 030a CF91 pop r28 |
414 030c 0895 ret |
415 /* epilogue end (size=3) */ |
416 /* function Menu_Temperature size 148 (143) */ |
418 .section .progmem.data |
421 __c.8: |
422 008d 2532 692E .string "%2i.%1iV %3i.%1iA" |
422 2531 6956 |
422 2020 2533 |
422 692E 2531 |
422 6941 00 |
425 __c.9: |
426 00a0 2534 6957 .string "%4iW %6imAh" |
426 2025 3669 |
426 6D41 6800 |
427 .text |
428 .global Menu_Battery |
430 Menu_Battery: |
431 /* prologue: frame size=0 */ |
432 030e 0F93 push r16 |
433 0310 1F93 push r17 |
434 /* prologue end (size=2) */ |
435 0312 80E0 ldi r24,lo8(0) |
436 0314 0E94 0000 call LIBFC_JetiBox_SetPos |
437 0318 2AE0 ldi r18,lo8(10) |
438 031a 30E0 ldi r19,hi8(10) |
439 031c 8091 0000 lds r24,Capacity |
440 0320 9091 0000 lds r25,(Capacity)+1 |
441 0324 B901 movw r22,r18 |
442 0326 0E94 0000 call __udivmodhi4 |
443 032a 9F93 push r25 |
444 032c 8F93 push r24 |
445 032e 8091 0000 lds r24,Capacity |
446 0332 9091 0000 lds r25,(Capacity)+1 |
447 0336 B901 movw r22,r18 |
448 0338 0E94 0000 call __udivmodhi4 |
449 033c 7F93 push r23 |
450 033e 6F93 push r22 |
451 0340 8091 0000 lds r24,UBat |
452 0344 9091 0000 lds r25,(UBat)+1 |
453 0348 B901 movw r22,r18 |
454 034a 0E94 0000 call __divmodhi4 |
455 034e 9F93 push r25 |
456 0350 8F93 push r24 |
457 0352 8091 0000 lds r24,UBat |
458 0356 9091 0000 lds r25,(UBat)+1 |
459 035a B901 movw r22,r18 |
460 035c 0E94 0000 call __divmodhi4 |
461 0360 7F93 push r23 |
462 0362 6F93 push r22 |
463 0364 80E0 ldi r24,lo8(__c.8) |
464 0366 90E0 ldi r25,hi8(__c.8) |
465 0368 9F93 push r25 |
466 036a 8F93 push r24 |
467 036c 00E0 ldi r16,lo8(pm(LIBFC_JetiBox_Putchar)) |
468 036e 10E0 ldi r17,hi8(pm(LIBFC_JetiBox_Putchar)) |
469 0370 1F93 push r17 |
470 0372 0F93 push r16 |
471 0374 E091 0000 lds r30,_printf_P |
472 0378 F091 0000 lds r31,(_printf_P)+1 |
473 037c 0995 icall |
474 037e 80E1 ldi r24,lo8(16) |
475 0380 0E94 0000 call LIBFC_JetiBox_SetPos |
476 0384 8DB7 in r24,__SP_L__ |
477 0386 9EB7 in r25,__SP_H__ |
478 0388 0C96 adiw r24,12 |
479 038a 8DBF out __SP_L__,r24 |
480 038c 8091 0000 lds r24,Capacity+4 |
481 0390 9091 0000 lds r25,(Capacity+4)+1 |
482 0394 9F93 push r25 |
483 0396 8F93 push r24 |
484 0398 8091 0000 lds r24,Capacity+2 |
485 039c 9091 0000 lds r25,(Capacity+2)+1 |
486 03a0 9F93 push r25 |
487 03a2 8F93 push r24 |
488 03a4 80E0 ldi r24,lo8(__c.9) |
489 03a6 90E0 ldi r25,hi8(__c.9) |
490 03a8 9F93 push r25 |
491 03aa 8F93 push r24 |
492 03ac 1F93 push r17 |
493 03ae 0F93 push r16 |
494 03b0 E091 0000 lds r30,_printf_P |
495 03b4 F091 0000 lds r31,(_printf_P)+1 |
496 03b8 0995 icall |
497 03ba 8DB7 in r24,__SP_L__ |
498 03bc 9EB7 in r25,__SP_H__ |
499 03be 0896 adiw r24,8 |
500 03c0 8DBF out __SP_L__,r24 |
501 /* epilogue: frame size=0 */ |
502 03c2 1F91 pop r17 |
503 03c4 0F91 pop r16 |
504 03c6 0895 ret |
505 /* epilogue end (size=3) */ |
506 /* function Menu_Battery size 93 (88) */ |
508 .section .progmem.data |
511 __c.2: |
512 00ac 2532 756D .string "%2um/s Sat:%d " |
512 2F73 2053 |
512 6174 3A25 |
512 6420 00 |
515 __c.3: |
516 00bb 2020 3344 .string " 3D" |
516 00 |
519 __c.4: |
520 00c0 4E6F 4678 .string "NoFx" |
520 00 |
523 __c.5: |
524 00c5 4447 5053 .string "DGPS" |
524 00 |
527 __c.6: |
528 00ca 486F 6D65 .string "Home:%3dm %3d%c" |
528 3A25 3364 |
528 6D20 2533 |
528 6425 6300 |
531 __c.7: |
532 00da 4E6F 204E .string "No NaviCtrl!" |
532 6176 6943 |
532 7472 6C21 |
532 00 |
533 .text |
534 .global Menu_PosInfo |
536 Menu_PosInfo: |
537 /* prologue: frame size=0 */ |
538 03c8 0F93 push r16 |
539 03ca 1F93 push r17 |
540 03cc CF93 push r28 |
541 03ce DF93 push r29 |
542 /* prologue end (size=4) */ |
543 03d0 8091 0000 lds r24,NaviDataOkay |
544 03d4 C0E0 ldi r28,lo8(pm(LIBFC_JetiBox_Putchar)) |
545 03d6 D0E0 ldi r29,hi8(pm(LIBFC_JetiBox_Putchar)) |
546 03d8 8823 tst r24 |
547 03da 09F4 brne .+2 |
548 03dc 78C0 rjmp .L12 |
549 03de 80E0 ldi r24,lo8(0) |
550 03e0 0E94 0000 call LIBFC_JetiBox_SetPos |
551 03e4 8091 0000 lds r24,GPSInfo+1 |
552 03e8 9927 clr r25 |
553 03ea 9F93 push r25 |
554 03ec 8F93 push r24 |
555 03ee 8091 0000 lds r24,GPSInfo+3 |
556 03f2 9927 clr r25 |
557 03f4 9F93 push r25 |
558 03f6 8F93 push r24 |
559 03f8 80E0 ldi r24,lo8(__c.2) |
560 03fa 90E0 ldi r25,hi8(__c.2) |
561 03fc 9F93 push r25 |
562 03fe 8F93 push r24 |
563 0400 8E01 movw r16,r28 |
564 0402 DF93 push r29 |
565 0404 CF93 push r28 |
566 0406 E091 0000 lds r30,_printf_P |
567 040a F091 0000 lds r31,(_printf_P)+1 |
568 040e 0995 icall |
569 0410 8DB7 in r24,__SP_L__ |
570 0412 9EB7 in r25,__SP_H__ |
571 0414 0896 adiw r24,8 |
572 0416 8DBF out __SP_L__,r24 |
573 0418 8091 0000 lds r24,GPSInfo+2 |
574 041c 8330 cpi r24,lo8(3) |
575 041e 31F4 brne .L17 |
576 0420 8CE0 ldi r24,lo8(12) |
577 0422 0E94 0000 call LIBFC_JetiBox_SetPos |
578 0426 80E0 ldi r24,lo8(__c.3) |
579 0428 90E0 ldi r25,hi8(__c.3) |
580 042a 05C0 rjmp .L20 |
581 .L17: |
582 042c 8CE0 ldi r24,lo8(12) |
583 042e 0E94 0000 call LIBFC_JetiBox_SetPos |
584 0432 80E0 ldi r24,lo8(__c.4) |
585 0434 90E0 ldi r25,hi8(__c.4) |
586 .L20: |
587 0436 9F93 push r25 |
588 0438 8F93 push r24 |
589 043a DF93 push r29 |
590 043c CF93 push r28 |
591 043e E091 0000 lds r30,_printf_P |
592 0442 F091 0000 lds r31,(_printf_P)+1 |
593 0446 0995 icall |
594 0448 0F90 pop __tmp_reg__ |
595 044a 0F90 pop __tmp_reg__ |
596 044c 0F90 pop __tmp_reg__ |
597 044e 0F90 pop __tmp_reg__ |
598 0450 8091 0000 lds r24,GPSInfo |
599 0454 81FF sbrs r24,1 |
600 0456 12C0 rjmp .L18 |
601 0458 8CE0 ldi r24,lo8(12) |
602 045a 0E94 0000 call LIBFC_JetiBox_SetPos |
603 045e 80E0 ldi r24,lo8(__c.5) |
604 0460 90E0 ldi r25,hi8(__c.5) |
605 0462 9F93 push r25 |
606 0464 8F93 push r24 |
607 0466 1F93 push r17 |
608 0468 0F93 push r16 |
609 046a E091 0000 lds r30,_printf_P |
610 046e F091 0000 lds r31,(_printf_P)+1 |
611 0472 0995 icall |
612 0474 0F90 pop __tmp_reg__ |
613 0476 0F90 pop __tmp_reg__ |
614 0478 0F90 pop __tmp_reg__ |
615 047a 0F90 pop __tmp_reg__ |
616 .L18: |
617 047c 80E1 ldi r24,lo8(16) |
618 047e 0E94 0000 call LIBFC_JetiBox_SetPos |
619 0482 8FED ldi r24,lo8(223) |
620 0484 90E0 ldi r25,hi8(223) |
621 0486 9F93 push r25 |
622 0488 8F93 push r24 |
623 048a 8091 0000 lds r24,GPSInfo+6 |
624 048e 9091 0000 lds r25,(GPSInfo+6)+1 |
625 0492 9F93 push r25 |
626 0494 8F93 push r24 |
627 0496 8091 0000 lds r24,GPSInfo+4 |
628 049a 9091 0000 lds r25,(GPSInfo+4)+1 |
629 049e 6AE0 ldi r22,lo8(10) |
630 04a0 70E0 ldi r23,hi8(10) |
631 04a2 0E94 0000 call __udivmodhi4 |
632 04a6 7F93 push r23 |
633 04a8 6F93 push r22 |
634 04aa 80E0 ldi r24,lo8(__c.6) |
635 04ac 90E0 ldi r25,hi8(__c.6) |
636 04ae 9F93 push r25 |
637 04b0 8F93 push r24 |
638 04b2 80E0 ldi r24,lo8(pm(LIBFC_JetiBox_Putchar)) |
639 04b4 90E0 ldi r25,hi8(pm(LIBFC_JetiBox_Putchar)) |
640 04b6 9F93 push r25 |
641 04b8 8F93 push r24 |
642 04ba E091 0000 lds r30,_printf_P |
643 04be F091 0000 lds r31,(_printf_P)+1 |
644 04c2 0995 icall |
645 04c4 8DB7 in r24,__SP_L__ |
646 04c6 9EB7 in r25,__SP_H__ |
647 04c8 0A96 adiw r24,10 |
648 04ca 8DBF out __SP_L__,r24 |
649 04cc 12C0 rjmp .L11 |
650 .L12: |
651 04ce 82E0 ldi r24,lo8(2) |
652 04d0 0E94 0000 call LIBFC_JetiBox_SetPos |
653 04d4 80E0 ldi r24,lo8(__c.7) |
654 04d6 90E0 ldi r25,hi8(__c.7) |
655 04d8 9F93 push r25 |
656 04da 8F93 push r24 |
657 04dc DF93 push r29 |
658 04de CF93 push r28 |
659 04e0 E091 0000 lds r30,_printf_P |
660 04e4 F091 0000 lds r31,(_printf_P)+1 |
661 04e8 0995 icall |
662 04ea 0F90 pop __tmp_reg__ |
663 04ec 0F90 pop __tmp_reg__ |
664 04ee 0F90 pop __tmp_reg__ |
665 04f0 0F90 pop __tmp_reg__ |
666 .L11: |
667 /* epilogue: frame size=0 */ |
668 04f2 DF91 pop r29 |
669 04f4 CF91 pop r28 |
670 04f6 1F91 pop r17 |
671 04f8 0F91 pop r16 |
672 04fa 0895 ret |
673 /* epilogue end (size=5) */ |
674 /* function Menu_PosInfo size 154 (145) */ |
676 .lcomm item.0,1 |
677 .lcomm last_item.1,1 |
678 .global JetiBox_Update |
680 JetiBox_Update: |
681 /* prologue: frame size=0 */ |
682 04fc CF93 push r28 |
683 /* prologue end (size=1) */ |
684 04fe C82F mov r28,r24 |
685 0500 2091 0000 lds r18,item.0 |
686 0504 2093 0000 sts last_item.1,r18 |
687 0508 9927 clr r25 |
688 050a 8F32 cpi r24,47 |
689 050c 9105 cpc r25,__zero_reg__ |
690 050e 09F1 breq .L27 |
691 0510 8033 cpi r24,48 |
692 0512 9105 cpc r25,__zero_reg__ |
693 0514 1CF4 brge .L30 |
694 0516 4F97 sbiw r24,31 |
695 0518 A1F0 breq .L26 |
696 051a 2CC0 rjmp .L22 |
697 .L30: |
698 051c 8F34 cpi r24,79 |
699 051e 9105 cpc r25,__zero_reg__ |
700 0520 01F1 breq .L28 |
701 0522 8F38 cpi r24,143 |
702 0524 9105 cpc r25,__zero_reg__ |
703 0526 31F5 brne .L22 |
704 0528 2223 tst r18 |
705 052a 19F4 brne .L24 |
706 052c 81E0 ldi r24,lo8(1) |
707 052e 90E0 ldi r25,hi8(1) |
708 0530 38C0 rjmp .L21 |
709 .L24: |
710 0532 86E0 ldi r24,lo8(6) |
711 0534 289F mul r18,r24 |
712 0536 F001 movw r30,r0 |
713 0538 1124 clr r1 |
714 053a E050 subi r30,lo8(-(JetiBox_Menu)) |
715 053c F040 sbci r31,hi8(-(JetiBox_Menu)) |
716 /* #APP */ |
717 053e 8491 lpm r24, Z |
718 |
719 /* #NOAPP */ |
720 0540 17C0 rjmp .L32 |
721 .L26: |
722 0542 86E0 ldi r24,lo8(6) |
723 0544 289F mul r18,r24 |
724 0546 F001 movw r30,r0 |
725 0548 1124 clr r1 |
726 054a E050 subi r30,lo8(-(JetiBox_Menu+1)) |
727 054c F040 sbci r31,hi8(-(JetiBox_Menu+1)) |
728 /* #APP */ |
729 054e 8491 lpm r24, Z |
730 |
731 /* #NOAPP */ |
732 0550 0FC0 rjmp .L32 |
733 .L27: |
734 0552 86E0 ldi r24,lo8(6) |
735 0554 289F mul r18,r24 |
736 0556 F001 movw r30,r0 |
737 0558 1124 clr r1 |
738 055a E050 subi r30,lo8(-(JetiBox_Menu+2)) |
739 055c F040 sbci r31,hi8(-(JetiBox_Menu+2)) |
740 /* #APP */ |
741 055e 8491 lpm r24, Z |
742 |
743 /* #NOAPP */ |
744 0560 07C0 rjmp .L32 |
745 .L28: |
746 0562 86E0 ldi r24,lo8(6) |
747 0564 289F mul r18,r24 |
748 0566 F001 movw r30,r0 |
749 0568 1124 clr r1 |
750 056a E050 subi r30,lo8(-(JetiBox_Menu+3)) |
751 056c F040 sbci r31,hi8(-(JetiBox_Menu+3)) |
752 /* #APP */ |
753 056e 8491 lpm r24, Z |
754 |
755 /* #NOAPP */ |
756 .L32: |
757 0570 8093 0000 sts item.0,r24 |
758 .L22: |
759 0574 9091 0000 lds r25,item.0 |
760 0578 8091 0000 lds r24,last_item.1 |
761 057c 9813 cpse r25,r24 |
762 057e C0E0 ldi r28,lo8(0) |
763 .L31: |
764 0580 0E94 0000 call LIBFC_JetiBox_Clear |
765 0584 9091 0000 lds r25,item.0 |
766 0588 86E0 ldi r24,lo8(6) |
767 058a 989F mul r25,r24 |
768 058c F001 movw r30,r0 |
769 058e 1124 clr r1 |
770 0590 E050 subi r30,lo8(-(JetiBox_Menu+4)) |
771 0592 F040 sbci r31,hi8(-(JetiBox_Menu+4)) |
772 /* #APP */ |
773 0594 2591 lpm r18, Z+ |
774 0596 3491 lpm r19, Z |
775 |
776 /* #NOAPP */ |
777 0598 8C2F mov r24,r28 |
778 059a F901 movw r30,r18 |
779 059c 0995 icall |
780 059e 80E0 ldi r24,lo8(0) |
781 05a0 90E0 ldi r25,hi8(0) |
782 .L21: |
783 /* epilogue: frame size=0 */ |
784 05a2 CF91 pop r28 |
785 05a4 0895 ret |
786 /* epilogue end (size=2) */ |
787 /* function JetiBox_Update size 103 (100) */ |
789 /* File "jetimenu.c": code 741 = 0x02e5 ( 714), prologues 11, epilogues 16 */ |
DEFINED SYMBOLS |
*ABS*:00000000 jetimenu.c |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccJr6Gjs.s:2 *ABS*:0000003f __SREG__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccJr6Gjs.s:3 *ABS*:0000003e __SP_H__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccJr6Gjs.s:4 *ABS*:0000003d __SP_L__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccJr6Gjs.s:5 *ABS*:00000034 __CCP__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccJr6Gjs.s:6 *ABS*:00000000 __tmp_reg__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccJr6Gjs.s:7 *ABS*:00000001 __zero_reg__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccJr6Gjs.s:11 .text:00000000 JetiBox_Update |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccJr6Gjs.s:906 .bss:00000001 item.2348 |
.bss:00000000 last_item.2349 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccJr6Gjs.s:885 .progmem.data:00000000 JetiBox_Menu |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccJr6Gjs.s:123 .text:0000009a Menu_PosInfo |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccJr6Gjs.s:930 .progmem.data:00000044 __c.2304 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccJr6Gjs.s:926 .progmem.data:0000003f __c.2307 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccJr6Gjs.s:922 .progmem.data:0000003a __c.2313 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccJr6Gjs.s:918 .progmem.data:00000035 __c.2315 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccJr6Gjs.s:914 .progmem.data:00000025 __c.2317 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccJr6Gjs.s:910 .progmem.data:00000018 __c.2319 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccJr6Gjs.s:310 .text:0000022c Menu_Battery |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccJr6Gjs.s:938 .progmem.data:0000005f __c.2287 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccJr6Gjs.s:934 .progmem.data:00000053 __c.2289 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccJr6Gjs.s:426 .text:0000032e Menu_Temperature |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccJr6Gjs.s:954 .progmem.data:0000009c __c.2258 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccJr6Gjs.s:950 .progmem.data:0000008c __c.2260 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccJr6Gjs.s:946 .progmem.data:0000007b __c.2262 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccJr6Gjs.s:942 .progmem.data:00000072 __c.2264 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccJr6Gjs.s:602 .text:000004a6 Menu_Status |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccJr6Gjs.s:978 .progmem.data:000000de __c.2216 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccJr6Gjs.s:974 .progmem.data:000000d2 __c.2218 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccJr6Gjs.s:970 .progmem.data:000000cb __c.2220 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccJr6Gjs.s:966 .progmem.data:000000c0 __c.2222 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccJr6Gjs.s:962 .progmem.data:000000b3 __c.2224 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccJr6Gjs.s:958 .progmem.data:000000ac __c.2226 |
C:\Users\Arthur-P\AppData\Local\Temp/cc00baaa.s:3 *ABS*:0000003f __SREG__ |
C:\Users\Arthur-P\AppData\Local\Temp/cc00baaa.s:4 *ABS*:0000003e __SP_H__ |
C:\Users\Arthur-P\AppData\Local\Temp/cc00baaa.s:5 *ABS*:0000003d __SP_L__ |
C:\Users\Arthur-P\AppData\Local\Temp/cc00baaa.s:6 *ABS*:00000000 __tmp_reg__ |
C:\Users\Arthur-P\AppData\Local\Temp/cc00baaa.s:7 *ABS*:00000001 __zero_reg__ |
C:\Users\Arthur-P\AppData\Local\Temp/cc00baaa.s:14 .progmem.data:00000000 JetiBox_Menu |
C:\Users\Arthur-P\AppData\Local\Temp/cc00baaa.s:62 .text:00000000 Menu_Status |
C:\Users\Arthur-P\AppData\Local\Temp/cc00baaa.s:282 .text:000001e6 Menu_Temperature |
C:\Users\Arthur-P\AppData\Local\Temp/cc00baaa.s:430 .text:0000030e Menu_Battery |
C:\Users\Arthur-P\AppData\Local\Temp/cc00baaa.s:536 .text:000003c8 Menu_PosInfo |
C:\Users\Arthur-P\AppData\Local\Temp/cc00baaa.s:37 .progmem.data:00000018 __c.14 |
C:\Users\Arthur-P\AppData\Local\Temp/cc00baaa.s:41 .progmem.data:00000021 __c.15 |
C:\Users\Arthur-P\AppData\Local\Temp/cc00baaa.s:45 .progmem.data:0000002d __c.16 |
C:\Users\Arthur-P\AppData\Local\Temp/cc00baaa.s:49 .progmem.data:00000034 __c.17 |
C:\Users\Arthur-P\AppData\Local\Temp/cc00baaa.s:53 .progmem.data:0000003f __c.18 |
C:\Users\Arthur-P\AppData\Local\Temp/cc00baaa.s:57 .progmem.data:0000004c __c.19 |
C:\Users\Arthur-P\AppData\Local\Temp/cc00baaa.s:265 .progmem.data:00000053 __c.10 |
C:\Users\Arthur-P\AppData\Local\Temp/cc00baaa.s:269 .progmem.data:00000063 __c.11 |
C:\Users\Arthur-P\AppData\Local\Temp/cc00baaa.s:273 .progmem.data:00000073 __c.12 |
C:\Users\Arthur-P\AppData\Local\Temp/cc00baaa.s:277 .progmem.data:00000084 __c.13 |
C:\Users\Arthur-P\AppData\Local\Temp/cc00baaa.s:421 .progmem.data:0000008d __c.8 |
C:\Users\Arthur-P\AppData\Local\Temp/cc00baaa.s:425 .progmem.data:000000a0 __c.9 |
C:\Users\Arthur-P\AppData\Local\Temp/cc00baaa.s:511 .progmem.data:000000ac __c.2 |
C:\Users\Arthur-P\AppData\Local\Temp/cc00baaa.s:515 .progmem.data:000000bb __c.3 |
C:\Users\Arthur-P\AppData\Local\Temp/cc00baaa.s:519 .progmem.data:000000c0 __c.4 |
C:\Users\Arthur-P\AppData\Local\Temp/cc00baaa.s:523 .progmem.data:000000c5 __c.5 |
C:\Users\Arthur-P\AppData\Local\Temp/cc00baaa.s:527 .progmem.data:000000ca __c.6 |
C:\Users\Arthur-P\AppData\Local\Temp/cc00baaa.s:531 .progmem.data:000000da __c.7 |
.bss:00000000 item.0 |
C:\Users\Arthur-P\AppData\Local\Temp/cc00baaa.s:676 .bss:00000001 last_item.1 |
C:\Users\Arthur-P\AppData\Local\Temp/cc00baaa.s:680 .text:000004fc JetiBox_Update |
UNDEFINED SYMBOLS |
LIBFC_JetiBox_Clear |
__do_copy_data |
__do_clear_bss |
LIBFC_JetiBox_SetPos |
UBat |
__divmodhi4 |
LIBFC_JetiBox_Putchar |
_printf_P |
NaviDataOkay |
LIBFC_JetiBox_Putchar |
LIBFC_JetiBox_SetPos |
GPSInfo |
_printf_P |
__udivmodhi4 |
UBat |
Capacity |
__divmodhi4 |
Motor |
RequiredMotors |
ErsatzKompass |
GIER_GRAD_FAKTOR |
__divmodsi4 |
NC_ErrorCode |
FlugSekunden |
Capacity |
EE_Parameter |
VarioCharacter |
HoehenWert |
VarioCharacter |
__do_clear_bss |
Motor |
RequiredMotors |
LIBFC_JetiBox_Clear |
/branches/V0.80g-Arthur-P1/led.lst |
---|
1,297 → 1,315 |
1 .file "led.c" |
2 __SREG__ = 0x3f |
3 __SP_H__ = 0x3e |
4 __SP_L__ = 0x3d |
5 __CCP__ = 0x34 |
2 .arch atmega644p |
3 __SREG__ = 0x3f |
4 __SP_H__ = 0x3e |
5 __SP_L__ = 0x3d |
6 __tmp_reg__ = 0 |
7 __zero_reg__ = 1 |
8 .text |
9 .global LED_Init |
11 LED_Init: |
12 /* prologue: function */ |
13 /* frame size = 0 */ |
14 0000 87B1 in r24,39-32 |
15 0002 8C60 ori r24,lo8(12) |
16 0004 87B9 out 39-32,r24 |
17 0006 4298 cbi 40-32,2 |
18 0008 4398 cbi 40-32,3 |
19 000a 1092 0000 sts J16Blinkcount,__zero_reg__ |
20 000e 80E8 ldi r24,lo8(-128) |
21 0010 8093 0000 sts J16Mask,r24 |
22 0014 1092 0000 sts J17Blinkcount,__zero_reg__ |
23 0018 8093 0000 sts J17Mask,r24 |
24 /* epilogue start */ |
25 001c 0895 ret |
27 .global LED_Update |
29 LED_Update: |
30 /* prologue: function */ |
31 /* frame size = 0 */ |
32 001e 8091 0000 lds r24,delay.2231 |
33 0022 8150 subi r24,lo8(-(-1)) |
34 0024 8093 0000 sts delay.2231,r24 |
35 0028 8F5F subi r24,lo8(-(1)) |
36 002a 01F0 breq .+2 |
37 002c 00C0 rjmp .L37 |
38 002e 94E0 ldi r25,lo8(4) |
39 0030 9093 0000 sts delay.2231,r25 |
40 0034 8091 0000 lds r24,FCFlags |
41 0038 807B andi r24,lo8(-80) |
42 003a 01F0 breq .L5 |
43 003c 8091 0000 lds r24,EE_Parameter+76 |
44 0040 8823 tst r24 |
45 0042 01F0 breq .L6 |
46 0044 8091 0000 lds r24,J16Warn.2234 |
47 0048 8823 tst r24 |
48 004a 01F4 brne .L7 |
49 004c 9093 0000 sts J16Blinkcount,r25 |
50 .L7: |
51 0050 81E0 ldi r24,lo8(1) |
52 0052 8093 0000 sts J16Warn.2234,r24 |
53 .L6: |
54 0056 8091 0000 lds r24,EE_Parameter+77 |
55 005a 8823 tst r24 |
56 005c 01F0 breq .L8 |
57 005e 8091 0000 lds r24,J17Warn.2235 |
58 0062 8823 tst r24 |
59 0064 01F4 brne .L9 |
60 0066 84E0 ldi r24,lo8(4) |
61 0068 8093 0000 sts J17Blinkcount,r24 |
62 .L9: |
63 006c 81E0 ldi r24,lo8(1) |
64 006e 8093 0000 sts J17Warn.2235,r24 |
65 0072 00C0 rjmp .L8 |
66 .L5: |
67 0074 1092 0000 sts J16Warn.2234,__zero_reg__ |
68 0078 1092 0000 sts J17Warn.2235,__zero_reg__ |
69 007c 8091 0000 lds r24,EE_Parameter+72 |
70 0080 8093 0000 sts J16Bitmask.2232,r24 |
71 0084 8091 0000 lds r24,EE_Parameter+74 |
72 0088 8093 0000 sts J17Bitmask.2233,r24 |
73 .L8: |
74 008c 8091 0000 lds r24,J16Warn.2234 |
75 0090 8823 tst r24 |
76 0092 01F4 brne .L10 |
77 0094 8091 0000 lds r24,EE_Parameter+97 |
78 0098 982F mov r25,r24 |
79 009a 84FF sbrs r24,4 |
80 009c 00C0 rjmp .L11 |
81 009e 8091 0000 lds r24,MotorenEin |
82 00a2 8823 tst r24 |
83 00a4 01F4 brne .L11 |
84 00a6 95FF sbrs r25,5 |
85 00a8 00C0 rjmp .L23 |
86 00aa 00C0 rjmp .L41 |
87 .L11: |
88 00ac 8091 0000 lds r24,EE_Parameter+73 |
89 00b0 883F cpi r24,lo8(-8) |
90 00b2 00F0 brlo .L14 |
91 00b4 8091 0000 lds r24,Parameter_J16Timing |
92 00b8 8D3D cpi r24,lo8(-35) |
93 00ba 00F0 brlo .L15 |
94 00bc 8091 0000 lds r24,J16Bitmask.2232 |
95 00c0 87FF sbrs r24,7 |
96 00c2 00C0 rjmp .L23 |
97 00c4 00C0 rjmp .L41 |
98 .L15: |
99 00c6 8A30 cpi r24,lo8(10) |
100 00c8 00F4 brsh .L14 |
101 00ca 8091 0000 lds r24,J16Bitmask.2232 |
102 00ce 87FF sbrs r24,7 |
103 00d0 00C0 rjmp .L41 |
104 00d2 00C0 rjmp .L23 |
105 .L14: |
106 00d4 8091 0000 lds r24,J16Blinkcount |
107 00d8 8150 subi r24,lo8(-(-1)) |
108 00da 8093 0000 sts J16Blinkcount,r24 |
109 00de 8F5F subi r24,lo8(-(1)) |
110 00e0 01F4 brne .L13 |
111 00e2 8091 0000 lds r24,Parameter_J16Timing |
112 00e6 8150 subi r24,lo8(-(-1)) |
113 00e8 8093 0000 sts J16Blinkcount,r24 |
114 00ec 8091 0000 lds r24,J16Mask |
115 00f0 8130 cpi r24,lo8(1) |
116 00f2 01F4 brne .L18 |
117 00f4 80E8 ldi r24,lo8(-128) |
118 00f6 00C0 rjmp .L38 |
119 .L18: |
120 00f8 8695 lsr r24 |
121 .L38: |
122 00fa 8093 0000 sts J16Mask,r24 |
123 00fe 8091 0000 lds r24,J16Bitmask.2232 |
124 0102 00C0 rjmp .L46 |
125 .L10: |
126 0104 8091 0000 lds r24,J16Blinkcount |
127 0108 8150 subi r24,lo8(-(-1)) |
128 010a 8093 0000 sts J16Blinkcount,r24 |
129 010e 8F5F subi r24,lo8(-(1)) |
130 0110 01F4 brne .L13 |
131 0112 89E0 ldi r24,lo8(9) |
132 0114 8093 0000 sts J16Blinkcount,r24 |
133 0118 8091 0000 lds r24,J16Mask |
134 011c 8130 cpi r24,lo8(1) |
135 011e 01F4 brne .L21 |
136 0120 80E8 ldi r24,lo8(-128) |
137 0122 00C0 rjmp .L39 |
138 .L21: |
139 0124 8695 lsr r24 |
140 .L39: |
141 0126 8093 0000 sts J16Mask,r24 |
142 012a 8091 0000 lds r24,EE_Parameter+76 |
143 .L46: |
144 012e 9091 0000 lds r25,J16Mask |
145 0132 8923 and r24,r25 |
146 0134 01F0 breq .L23 |
147 .L41: |
148 0136 429A sbi 40-32,2 |
149 0138 00C0 rjmp .L13 |
150 .L23: |
151 013a 4298 cbi 40-32,2 |
152 .L13: |
153 013c 8091 0000 lds r24,J17Warn.2235 |
154 0140 8823 tst r24 |
155 0142 01F0 breq .+2 |
156 0144 00C0 rjmp .L24 |
157 0146 8091 0000 lds r24,EE_Parameter+97 |
158 014a 982F mov r25,r24 |
159 014c 84FF sbrs r24,4 |
160 014e 00C0 rjmp .L25 |
161 0150 8091 0000 lds r24,MotorenEin |
162 0154 8823 tst r24 |
163 0156 01F4 brne .L25 |
164 0158 96FF sbrs r25,6 |
165 015a 00C0 rjmp .L33 |
166 015c 00C0 rjmp .L44 |
167 .L25: |
168 015e 8091 0000 lds r24,EE_Parameter+75 |
169 0162 883F cpi r24,lo8(-8) |
170 0164 00F0 brlo .L27 |
171 0166 8091 0000 lds r24,Parameter_J17Timing |
172 016a 8D3D cpi r24,lo8(-35) |
173 016c 00F0 brlo .L28 |
174 016e 8091 0000 lds r24,J17Bitmask.2233 |
175 0172 87FF sbrs r24,7 |
176 0174 00C0 rjmp .L33 |
177 0176 00C0 rjmp .L44 |
178 .L28: |
179 0178 8A30 cpi r24,lo8(10) |
180 017a 00F4 brsh .L27 |
181 017c 8091 0000 lds r24,J17Bitmask.2233 |
182 0180 87FF sbrs r24,7 |
183 0182 00C0 rjmp .L44 |
184 0184 00C0 rjmp .L33 |
185 .L27: |
186 0186 8091 0000 lds r24,J17Blinkcount |
187 018a 8150 subi r24,lo8(-(-1)) |
188 018c 8093 0000 sts J17Blinkcount,r24 |
189 0190 8F5F subi r24,lo8(-(1)) |
190 0192 01F4 brne .L37 |
191 0194 8091 0000 lds r24,Parameter_J17Timing |
192 0198 8150 subi r24,lo8(-(-1)) |
193 019a 8093 0000 sts J17Blinkcount,r24 |
194 019e 8091 0000 lds r24,J17Mask |
195 01a2 8130 cpi r24,lo8(1) |
196 01a4 01F4 brne .L31 |
197 01a6 80E8 ldi r24,lo8(-128) |
198 01a8 00C0 rjmp .L42 |
199 .L31: |
200 01aa 8695 lsr r24 |
201 .L42: |
202 01ac 8093 0000 sts J17Mask,r24 |
203 01b0 8091 0000 lds r24,J17Bitmask.2233 |
204 01b4 9091 0000 lds r25,J17Mask |
205 01b8 8923 and r24,r25 |
206 01ba 01F4 brne .L44 |
207 .L33: |
208 01bc 4398 cbi 40-32,3 |
209 01be 0895 ret |
210 .L24: |
211 01c0 8091 0000 lds r24,J17Blinkcount |
212 01c4 8150 subi r24,lo8(-(-1)) |
213 01c6 8093 0000 sts J17Blinkcount,r24 |
214 01ca 8F5F subi r24,lo8(-(1)) |
215 01cc 01F4 brne .L37 |
216 01ce 89E0 ldi r24,lo8(9) |
217 01d0 8093 0000 sts J17Blinkcount,r24 |
218 01d4 8091 0000 lds r24,J17Mask |
219 01d8 8130 cpi r24,lo8(1) |
220 01da 01F4 brne .L34 |
221 01dc 80E8 ldi r24,lo8(-128) |
222 01de 00C0 rjmp .L43 |
223 .L34: |
224 01e0 8695 lsr r24 |
225 .L43: |
226 01e2 8093 0000 sts J17Mask,r24 |
227 01e6 8091 0000 lds r24,EE_Parameter+77 |
228 01ea 9091 0000 lds r25,J17Mask |
229 01ee 8923 and r24,r25 |
230 01f0 01F0 breq .L36 |
231 .L44: |
232 01f2 439A sbi 40-32,3 |
233 01f4 0895 ret |
234 .L36: |
235 01f6 4398 cbi 40-32,3 |
236 .L37: |
237 01f8 0895 ret |
239 .global LED1_Timing |
240 .global LED1_Timing |
241 .section .bss |
244 LED1_Timing: |
245 0000 0000 .skip 2,0 |
246 .global LED2_Timing |
247 .global LED2_Timing |
250 LED2_Timing: |
251 0002 0000 .skip 2,0 |
252 .global J16Blinkcount |
253 .global J16Blinkcount |
256 J16Blinkcount: |
257 0004 00 .skip 1,0 |
258 .global J16Mask |
259 .data |
262 J16Mask: |
263 0000 01 .byte 1 |
264 .global J17Blinkcount |
265 .global J17Blinkcount |
266 .section .bss |
269 J17Blinkcount: |
270 0005 00 .skip 1,0 |
271 .global J17Mask |
272 .data |
275 J17Mask: |
276 0001 01 .byte 1 |
277 .lcomm J17Warn.2235,1 |
278 .lcomm J16Warn.2234,1 |
279 .lcomm J17Bitmask.2233,1 |
280 .lcomm J16Bitmask.2232,1 |
281 .lcomm delay.2231,1 |
282 .global __do_copy_data |
283 .global __do_clear_bss |
8 .global __do_copy_data |
9 .global __do_clear_bss |
10 .global J17Mask |
11 .data |
14 J17Mask: |
15 0000 01 .byte 1 |
16 .global J17Blinkcount |
17 .global J17Blinkcount |
18 .section .bss |
21 J17Blinkcount: |
22 0000 00 .skip 1,0 |
23 .global J16Mask |
24 .data |
27 J16Mask: |
28 0001 01 .byte 1 |
29 .global J16Blinkcount |
30 .global J16Blinkcount |
31 .section .bss |
34 J16Blinkcount: |
35 0001 00 .skip 1,0 |
36 .global LED2_Timing |
37 .global LED2_Timing |
40 LED2_Timing: |
41 0002 0000 .skip 2,0 |
42 .global LED1_Timing |
43 .global LED1_Timing |
46 LED1_Timing: |
47 0004 0000 .skip 2,0 |
48 .text |
49 .global LED_Init |
51 LED_Init: |
52 /* prologue: frame size=0 */ |
53 /* prologue end (size=0) */ |
54 0000 87B1 in r24,39-0x20 |
55 0002 8C60 ori r24,lo8(12) |
56 0004 87B9 out 39-0x20,r24 |
57 0006 4298 cbi 40-0x20,2 |
58 0008 4398 cbi 40-0x20,3 |
59 000a 1092 0000 sts J16Blinkcount,__zero_reg__ |
60 000e 80E8 ldi r24,lo8(-128) |
61 0010 8093 0000 sts J16Mask,r24 |
62 0014 1092 0000 sts J17Blinkcount,__zero_reg__ |
63 0018 8093 0000 sts J17Mask,r24 |
64 /* epilogue: frame size=0 */ |
65 001c 0895 ret |
66 /* epilogue end (size=1) */ |
67 /* function LED_Init size 15 (14) */ |
69 .lcomm delay.0,1 |
70 .lcomm J16Bitmask.1,1 |
71 .lcomm J17Bitmask.2,1 |
72 .lcomm J16Warn.3,1 |
73 .lcomm J17Warn.4,1 |
74 .global LED_Update |
76 LED_Update: |
77 /* prologue: frame size=0 */ |
78 /* prologue end (size=0) */ |
79 001e 8091 0000 lds r24,delay.0 |
80 0022 8150 subi r24,lo8(-(-1)) |
81 0024 8093 0000 sts delay.0,r24 |
82 0028 8F3F cpi r24,lo8(-1) |
83 002a 09F0 breq .+2 |
84 002c F4C0 rjmp .L2 |
85 002e 94E0 ldi r25,lo8(4) |
86 0030 9093 0000 sts delay.0,r25 |
87 0034 8091 0000 lds r24,FCFlags |
88 0038 807B andi r24,lo8(-80) |
89 003a E1F0 breq .L4 |
90 003c 8091 0000 lds r24,EE_Parameter+76 |
91 0040 8823 tst r24 |
92 0042 49F0 breq .L5 |
93 0044 8091 0000 lds r24,J16Warn.3 |
94 0048 8823 tst r24 |
95 004a 11F4 brne .L6 |
96 004c 9093 0000 sts J16Blinkcount,r25 |
97 .L6: |
98 0050 81E0 ldi r24,lo8(1) |
99 0052 8093 0000 sts J16Warn.3,r24 |
100 .L5: |
101 0056 8091 0000 lds r24,EE_Parameter+77 |
102 005a 8823 tst r24 |
103 005c B9F0 breq .L9 |
104 005e 8091 0000 lds r24,J17Warn.4 |
105 0062 8823 tst r24 |
106 0064 19F4 brne .L8 |
107 0066 84E0 ldi r24,lo8(4) |
108 0068 8093 0000 sts J17Blinkcount,r24 |
109 .L8: |
110 006c 81E0 ldi r24,lo8(1) |
111 006e 8093 0000 sts J17Warn.4,r24 |
112 0072 0CC0 rjmp .L9 |
113 .L4: |
114 0074 8093 0000 sts J16Warn.3,r24 |
115 0078 8093 0000 sts J17Warn.4,r24 |
116 007c 8091 0000 lds r24,EE_Parameter+72 |
117 0080 8093 0000 sts J16Bitmask.1,r24 |
118 0084 8091 0000 lds r24,EE_Parameter+74 |
119 0088 8093 0000 sts J17Bitmask.2,r24 |
120 .L9: |
121 008c 8091 0000 lds r24,J16Warn.3 |
122 0090 8823 tst r24 |
123 0092 09F0 breq .+2 |
124 0094 40C0 rjmp .L10 |
125 0096 8091 0000 lds r24,EE_Parameter+97 |
126 009a 282F mov r18,r24 |
127 009c 3327 clr r19 |
128 009e 24FF sbrs r18,4 |
129 00a0 07C0 rjmp .L11 |
130 00a2 8091 0000 lds r24,MotorenEin |
131 00a6 8823 tst r24 |
132 00a8 19F4 brne .L11 |
133 00aa 25FD sbrc r18,5 |
134 00ac 4DC0 rjmp .L60 |
135 00ae 4EC0 rjmp .L32 |
136 .L11: |
137 00b0 9091 0000 lds r25,EE_Parameter+73 |
138 00b4 983F cpi r25,lo8(-8) |
139 00b6 50F0 brlo .L15 |
140 00b8 8091 0000 lds r24,Parameter_J16Timing |
141 00bc 8D3D cpi r24,lo8(-35) |
142 00be 30F0 brlo .L15 |
143 00c0 8091 0000 lds r24,J16Bitmask.1 |
144 00c4 8823 tst r24 |
145 00c6 0CF4 brge .+2 |
146 00c8 3FC0 rjmp .L60 |
147 00ca 40C0 rjmp .L32 |
148 .L15: |
149 00cc 983F cpi r25,lo8(-8) |
150 00ce 48F0 brlo .L19 |
151 00d0 8091 0000 lds r24,Parameter_J16Timing |
152 00d4 8A30 cpi r24,lo8(10) |
153 00d6 28F4 brsh .L19 |
154 00d8 8091 0000 lds r24,J16Bitmask.1 |
155 00dc 8823 tst r24 |
156 00de B4F1 brlt .L32 |
157 00e0 33C0 rjmp .L60 |
158 .L19: |
159 00e2 8091 0000 lds r24,J16Blinkcount |
160 00e6 8150 subi r24,lo8(-(-1)) |
161 00e8 8093 0000 sts J16Blinkcount,r24 |
162 00ec 8F3F cpi r24,lo8(-1) |
163 00ee 79F5 brne .L28 |
164 00f0 8091 0000 lds r24,Parameter_J16Timing |
165 00f4 8150 subi r24,lo8(-(-1)) |
166 00f6 8093 0000 sts J16Blinkcount,r24 |
167 00fa 8091 0000 lds r24,J16Mask |
168 00fe 8130 cpi r24,lo8(1) |
169 0100 11F4 brne .L24 |
170 0102 80E8 ldi r24,lo8(-128) |
171 0104 01C0 rjmp .L58 |
172 .L24: |
173 0106 8695 lsr r24 |
174 .L58: |
175 0108 8093 0000 sts J16Mask,r24 |
176 010c 8091 0000 lds r24,J16Mask |
177 0110 9091 0000 lds r25,J16Bitmask.1 |
178 0114 17C0 rjmp .L67 |
179 .L10: |
180 0116 8091 0000 lds r24,J16Blinkcount |
181 011a 8150 subi r24,lo8(-(-1)) |
182 011c 8093 0000 sts J16Blinkcount,r24 |
183 0120 8F3F cpi r24,lo8(-1) |
184 0122 A9F4 brne .L28 |
185 0124 89E0 ldi r24,lo8(9) |
186 0126 8093 0000 sts J16Blinkcount,r24 |
187 012a 8091 0000 lds r24,J16Mask |
188 012e 8130 cpi r24,lo8(1) |
189 0130 11F4 brne .L30 |
190 0132 80E8 ldi r24,lo8(-128) |
191 0134 01C0 rjmp .L59 |
192 .L30: |
193 0136 8695 lsr r24 |
194 .L59: |
195 0138 8093 0000 sts J16Mask,r24 |
196 013c 8091 0000 lds r24,J16Mask |
197 0140 9091 0000 lds r25,EE_Parameter+76 |
198 .L67: |
199 0144 8923 and r24,r25 |
200 0146 11F0 breq .L32 |
201 .L60: |
202 0148 429A sbi 40-0x20,2 |
203 014a 01C0 rjmp .L28 |
204 .L32: |
205 014c 4298 cbi 40-0x20,2 |
206 .L28: |
207 014e 8091 0000 lds r24,J17Warn.4 |
208 0152 8823 tst r24 |
209 0154 09F0 breq .+2 |
210 0156 43C0 rjmp .L34 |
211 0158 8091 0000 lds r24,EE_Parameter+97 |
212 015c 282F mov r18,r24 |
213 015e 3327 clr r19 |
214 0160 24FF sbrs r18,4 |
215 0162 07C0 rjmp .L35 |
216 0164 8091 0000 lds r24,MotorenEin |
217 0168 8823 tst r24 |
218 016a 19F4 brne .L35 |
219 016c 26FD sbrc r18,6 |
220 016e 50C0 rjmp .L66 |
221 0170 34C0 rjmp .L50 |
222 .L35: |
223 0172 9091 0000 lds r25,EE_Parameter+75 |
224 0176 983F cpi r25,lo8(-8) |
225 0178 50F0 brlo .L39 |
226 017a 8091 0000 lds r24,Parameter_J17Timing |
227 017e 8D3D cpi r24,lo8(-35) |
228 0180 30F0 brlo .L39 |
229 0182 8091 0000 lds r24,J17Bitmask.2 |
230 0186 8823 tst r24 |
231 0188 0CF4 brge .+2 |
232 018a 42C0 rjmp .L66 |
233 018c 26C0 rjmp .L50 |
234 .L39: |
235 018e 983F cpi r25,lo8(-8) |
236 0190 48F0 brlo .L43 |
237 0192 8091 0000 lds r24,Parameter_J17Timing |
238 0196 8A30 cpi r24,lo8(10) |
239 0198 28F4 brsh .L43 |
240 019a 8091 0000 lds r24,J17Bitmask.2 |
241 019e 8823 tst r24 |
242 01a0 E4F0 brlt .L50 |
243 01a2 36C0 rjmp .L66 |
244 .L43: |
245 01a4 8091 0000 lds r24,J17Blinkcount |
246 01a8 8150 subi r24,lo8(-(-1)) |
247 01aa 8093 0000 sts J17Blinkcount,r24 |
248 01ae 8F3F cpi r24,lo8(-1) |
249 01b0 91F5 brne .L2 |
250 01b2 8091 0000 lds r24,Parameter_J17Timing |
251 01b6 8150 subi r24,lo8(-(-1)) |
252 01b8 8093 0000 sts J17Blinkcount,r24 |
253 01bc 8091 0000 lds r24,J17Mask |
254 01c0 8130 cpi r24,lo8(1) |
255 01c2 11F4 brne .L48 |
256 01c4 80E8 ldi r24,lo8(-128) |
257 01c6 01C0 rjmp .L61 |
258 .L48: |
259 01c8 8695 lsr r24 |
260 .L61: |
261 01ca 8093 0000 sts J17Mask,r24 |
262 01ce 8091 0000 lds r24,J17Mask |
263 01d2 9091 0000 lds r25,J17Bitmask.2 |
264 01d6 8923 and r24,r25 |
265 01d8 D9F4 brne .L66 |
266 .L50: |
267 01da 4398 cbi 40-0x20,3 |
268 01dc 0895 ret |
269 .L34: |
270 01de 8091 0000 lds r24,J17Blinkcount |
271 01e2 8150 subi r24,lo8(-(-1)) |
272 01e4 8093 0000 sts J17Blinkcount,r24 |
273 01e8 8F3F cpi r24,lo8(-1) |
274 01ea A9F4 brne .L2 |
275 01ec 89E0 ldi r24,lo8(9) |
276 01ee 8093 0000 sts J17Blinkcount,r24 |
277 01f2 8091 0000 lds r24,J17Mask |
278 01f6 8130 cpi r24,lo8(1) |
279 01f8 11F4 brne .L54 |
280 01fa 80E8 ldi r24,lo8(-128) |
281 01fc 01C0 rjmp .L62 |
282 .L54: |
283 01fe 8695 lsr r24 |
284 .L62: |
285 0200 8093 0000 sts J17Mask,r24 |
286 0204 8091 0000 lds r24,J17Mask |
287 0208 9091 0000 lds r25,EE_Parameter+77 |
288 020c 8923 and r24,r25 |
289 020e 11F0 breq .L56 |
290 .L66: |
291 0210 439A sbi 40-0x20,3 |
292 0212 0895 ret |
293 .L56: |
294 0214 4398 cbi 40-0x20,3 |
295 .L2: |
296 0216 0895 ret |
297 /* epilogue: frame size=0 */ |
298 /* epilogue: noreturn */ |
299 /* epilogue end (size=0) */ |
300 /* function LED_Update size 261 (261) */ |
302 /* File "led.c": code 276 = 0x0114 ( 275), prologues 0, epilogues 1 */ |
DEFINED SYMBOLS |
*ABS*:00000000 led.c |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc8KmXBy.s:2 *ABS*:0000003f __SREG__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc8KmXBy.s:3 *ABS*:0000003e __SP_H__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc8KmXBy.s:4 *ABS*:0000003d __SP_L__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc8KmXBy.s:5 *ABS*:00000034 __CCP__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc8KmXBy.s:6 *ABS*:00000000 __tmp_reg__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc8KmXBy.s:7 *ABS*:00000001 __zero_reg__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc8KmXBy.s:11 .text:00000000 LED_Init |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc8KmXBy.s:256 .bss:00000004 J16Blinkcount |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc8KmXBy.s:262 .data:00000000 J16Mask |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc8KmXBy.s:269 .bss:00000005 J17Blinkcount |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc8KmXBy.s:275 .data:00000001 J17Mask |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc8KmXBy.s:29 .text:0000001e LED_Update |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc8KmXBy.s:280 .bss:0000000a delay.2231 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc8KmXBy.s:277 .bss:00000007 J16Warn.2234 |
.bss:00000006 J17Warn.2235 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc8KmXBy.s:279 .bss:00000009 J16Bitmask.2232 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc8KmXBy.s:278 .bss:00000008 J17Bitmask.2233 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc8KmXBy.s:244 .bss:00000000 LED1_Timing |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/cc8KmXBy.s:250 .bss:00000002 LED2_Timing |
C:\Users\Arthur-P\AppData\Local\Temp/ccK0baaa.s:3 *ABS*:0000003f __SREG__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccK0baaa.s:4 *ABS*:0000003e __SP_H__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccK0baaa.s:5 *ABS*:0000003d __SP_L__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccK0baaa.s:6 *ABS*:00000000 __tmp_reg__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccK0baaa.s:7 *ABS*:00000001 __zero_reg__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccK0baaa.s:14 .data:00000000 J17Mask |
C:\Users\Arthur-P\AppData\Local\Temp/ccK0baaa.s:21 .bss:00000000 J17Blinkcount |
C:\Users\Arthur-P\AppData\Local\Temp/ccK0baaa.s:27 .data:00000001 J16Mask |
C:\Users\Arthur-P\AppData\Local\Temp/ccK0baaa.s:34 .bss:00000001 J16Blinkcount |
C:\Users\Arthur-P\AppData\Local\Temp/ccK0baaa.s:40 .bss:00000002 LED2_Timing |
C:\Users\Arthur-P\AppData\Local\Temp/ccK0baaa.s:46 .bss:00000004 LED1_Timing |
C:\Users\Arthur-P\AppData\Local\Temp/ccK0baaa.s:51 .text:00000000 LED_Init |
.bss:00000006 delay.0 |
C:\Users\Arthur-P\AppData\Local\Temp/ccK0baaa.s:69 .bss:00000007 J16Bitmask.1 |
C:\Users\Arthur-P\AppData\Local\Temp/ccK0baaa.s:70 .bss:00000008 J17Bitmask.2 |
C:\Users\Arthur-P\AppData\Local\Temp/ccK0baaa.s:71 .bss:00000009 J16Warn.3 |
C:\Users\Arthur-P\AppData\Local\Temp/ccK0baaa.s:72 .bss:0000000a J17Warn.4 |
C:\Users\Arthur-P\AppData\Local\Temp/ccK0baaa.s:76 .text:0000001e LED_Update |
UNDEFINED SYMBOLS |
__do_copy_data |
__do_clear_bss |
FCFlags |
EE_Parameter |
MotorenEin |
Parameter_J16Timing |
Parameter_J17Timing |
__do_copy_data |
__do_clear_bss |
/branches/V0.80g-Arthur-P1/main.lst |
---|
1,1332 → 1,1239 |
1 .file "main.c" |
2 __SREG__ = 0x3f |
3 __SP_H__ = 0x3e |
4 __SP_L__ = 0x3d |
5 __CCP__ = 0x34 |
2 .arch atmega644p |
3 __SREG__ = 0x3f |
4 __SP_H__ = 0x3e |
5 __SP_L__ = 0x3d |
6 __tmp_reg__ = 0 |
7 __zero_reg__ = 1 |
8 .text |
9 .global LipoDetection |
11 LipoDetection: |
12 0000 1F93 push r17 |
13 0002 CF93 push r28 |
14 0004 DF93 push r29 |
15 /* prologue: function */ |
16 /* frame size = 0 */ |
17 0006 182F mov r17,r24 |
18 0008 8823 tst r24 |
19 000a 01F0 breq .L2 |
20 000c 00D0 rcall . |
21 000e 00D0 rcall . |
22 0010 80E0 ldi r24,lo8(gs(uart_putchar)) |
23 0012 90E0 ldi r25,hi8(gs(uart_putchar)) |
24 0014 ADB7 in r26,__SP_L__ |
25 0016 BEB7 in r27,__SP_H__ |
26 0018 1296 adiw r26,1+1 |
27 001a 9C93 st X,r25 |
28 001c 8E93 st -X,r24 |
29 001e 1197 sbiw r26,1 |
30 0020 80E0 ldi r24,lo8(__c.2236) |
31 0022 90E0 ldi r25,hi8(__c.2236) |
32 0024 1496 adiw r26,3+1 |
33 0026 9C93 st X,r25 |
34 0028 8E93 st -X,r24 |
35 002a 1397 sbiw r26,3 |
36 002c E091 0000 lds r30,_printf_P |
37 0030 F091 0000 lds r31,(_printf_P)+1 |
38 0034 0995 icall |
39 0036 0F90 pop __tmp_reg__ |
40 0038 0F90 pop __tmp_reg__ |
41 003a 0F90 pop __tmp_reg__ |
42 003c 0F90 pop __tmp_reg__ |
43 .L2: |
44 003e 8091 0000 lds r24,EE_Parameter+36 |
45 0042 8233 cpi r24,lo8(50) |
46 0044 00F0 brlo .+2 |
47 0046 00C0 rjmp .L3 |
48 0048 84EF ldi r24,lo8(500) |
49 004a 91E0 ldi r25,hi8(500) |
50 004c 0E94 0000 call SetDelay |
51 0050 EC01 movw r28,r24 |
52 0052 1123 tst r17 |
53 0054 01F0 breq .L4 |
54 .L11: |
55 0056 CE01 movw r24,r28 |
56 0058 0E94 0000 call CheckDelay |
57 005c 8823 tst r24 |
58 005e 01F0 breq .L11 |
59 .L4: |
60 0060 C2E0 ldi r28,lo8(2) |
61 0062 D0E0 ldi r29,hi8(2) |
62 0064 26E5 ldi r18,lo8(86) |
63 0066 30E0 ldi r19,hi8(86) |
64 .L7: |
65 0068 8091 0000 lds r24,UBat |
66 006c 9091 0000 lds r25,(UBat)+1 |
67 0070 8217 cp r24,r18 |
68 0072 9307 cpc r25,r19 |
69 0074 00F0 brlo .L6 |
70 0076 2196 adiw r28,1 |
71 0078 255D subi r18,lo8(-(43)) |
72 007a 3F4F sbci r19,hi8(-(43)) |
73 007c C730 cpi r28,7 |
74 007e D105 cpc r29,__zero_reg__ |
75 0080 01F4 brne .L7 |
76 .L6: |
77 0082 8091 0000 lds r24,EE_Parameter+36 |
78 0086 90E0 ldi r25,lo8(0) |
79 0088 FC01 movw r30,r24 |
80 008a CE9F mul r28,r30 |
81 008c C001 movw r24,r0 |
82 008e CF9F mul r28,r31 |
83 0090 900D add r25,r0 |
84 0092 DE9F mul r29,r30 |
85 0094 900D add r25,r0 |
86 0096 1124 clr r1 |
87 0098 8093 0000 sts BattLowVoltageWarning,r24 |
88 009c 1123 tst r17 |
89 009e 01F4 brne .+2 |
90 00a0 00C0 rjmp .L10 |
91 00a2 8C2F mov r24,r28 |
92 00a4 68EC ldi r22,lo8(200) |
93 00a6 70E0 ldi r23,hi8(200) |
94 00a8 0E94 0000 call Piep |
95 00ac 00D0 rcall . |
96 00ae 00D0 rcall . |
97 00b0 00D0 rcall . |
98 00b2 EDB7 in r30,__SP_L__ |
99 00b4 FEB7 in r31,__SP_H__ |
100 00b6 3196 adiw r30,1 |
101 00b8 80E0 ldi r24,lo8(gs(uart_putchar)) |
102 00ba 90E0 ldi r25,hi8(gs(uart_putchar)) |
103 00bc ADB7 in r26,__SP_L__ |
104 00be BEB7 in r27,__SP_H__ |
105 00c0 1296 adiw r26,1+1 |
106 00c2 9C93 st X,r25 |
107 00c4 8E93 st -X,r24 |
108 00c6 1197 sbiw r26,1 |
109 00c8 80E0 ldi r24,lo8(__c.2244) |
110 00ca 90E0 ldi r25,hi8(__c.2244) |
111 00cc 9383 std Z+3,r25 |
112 00ce 8283 std Z+2,r24 |
113 00d0 D583 std Z+5,r29 |
114 00d2 C483 std Z+4,r28 |
115 00d4 E091 0000 lds r30,_printf_P |
116 00d8 F091 0000 lds r31,(_printf_P)+1 |
117 00dc 0995 icall |
118 00de EDB7 in r30,__SP_L__ |
119 00e0 FEB7 in r31,__SP_H__ |
120 00e2 3696 adiw r30,6 |
121 00e4 EDBF out __SP_L__,r30 |
122 00e6 00C0 rjmp .L9 |
123 .L3: |
124 00e8 8093 0000 sts BattLowVoltageWarning,r24 |
125 00ec 1123 tst r17 |
126 00ee 01F0 breq .L10 |
127 .L9: |
128 00f0 2091 0000 lds r18,BattLowVoltageWarning |
129 00f4 8DB7 in r24,__SP_L__ |
130 00f6 9EB7 in r25,__SP_H__ |
131 00f8 0897 sbiw r24,8 |
132 00fa 8DBF out __SP_L__,r24 |
133 00fc EDB7 in r30,__SP_L__ |
134 00fe FEB7 in r31,__SP_H__ |
135 0100 3196 adiw r30,1 |
136 0102 80E0 ldi r24,lo8(gs(uart_putchar)) |
137 0104 90E0 ldi r25,hi8(gs(uart_putchar)) |
138 0106 ADB7 in r26,__SP_L__ |
139 0108 BEB7 in r27,__SP_H__ |
140 010a 1296 adiw r26,1+1 |
141 010c 9C93 st X,r25 |
142 010e 8E93 st -X,r24 |
143 0110 1197 sbiw r26,1 |
144 0112 80E0 ldi r24,lo8(__c.2246) |
145 0114 90E0 ldi r25,hi8(__c.2246) |
146 0116 9383 std Z+3,r25 |
147 0118 8283 std Z+2,r24 |
148 011a 822F mov r24,r18 |
149 011c 6AE0 ldi r22,lo8(10) |
150 011e 0E94 0000 call __udivmodqi4 |
151 0122 8483 std Z+4,r24 |
152 0124 1582 std Z+5,__zero_reg__ |
153 0126 822F mov r24,r18 |
154 0128 0E94 0000 call __udivmodqi4 |
155 012c 9683 std Z+6,r25 |
156 012e 1782 std Z+7,__zero_reg__ |
157 0130 E091 0000 lds r30,_printf_P |
158 0134 F091 0000 lds r31,(_printf_P)+1 |
159 0138 0995 icall |
160 013a EDB7 in r30,__SP_L__ |
161 013c FEB7 in r31,__SP_H__ |
162 013e 3896 adiw r30,8 |
163 0140 EDBF out __SP_L__,r30 |
164 .L10: |
165 /* epilogue start */ |
166 0142 DF91 pop r29 |
167 0144 CF91 pop r28 |
168 0146 1F91 pop r17 |
169 0148 0895 ret |
171 .global CalMk3Mag |
173 CalMk3Mag: |
174 /* prologue: function */ |
175 /* frame size = 0 */ |
176 014a 8091 0000 lds r24,EE_Parameter+1 |
177 014e A82F mov r26,r24 |
178 0150 B0E0 ldi r27,lo8(0) |
179 0152 FD01 movw r30,r26 |
180 0154 EE0F lsl r30 |
181 0156 FF1F rol r31 |
182 0158 E050 subi r30,lo8(-(PPM_in)) |
183 015a F040 sbci r31,hi8(-(PPM_in)) |
184 015c 8081 ld r24,Z |
185 015e 9181 ldd r25,Z+1 |
186 0160 8D5E subi r24,lo8(-19) |
187 0162 9F4F sbci r25,hi8(-19) |
188 0164 04F0 brlt .L15 |
189 0166 1092 0000 sts stick.2222,__zero_reg__ |
190 .L15: |
191 016a AA0F lsl r26 |
192 016c BB1F rol r27 |
193 016e A050 subi r26,lo8(-(PPM_in)) |
194 0170 B040 sbci r27,hi8(-(PPM_in)) |
195 0172 8D91 ld r24,X+ |
196 0174 9C91 ld r25,X |
197 0176 8A5B subi r24,lo8(-70) |
198 0178 9F4F sbci r25,hi8(-70) |
199 017a 04F4 brge .L16 |
200 017c 8091 0000 lds r24,stick.2222 |
201 0180 8823 tst r24 |
202 0182 01F4 brne .L16 |
203 0184 81E0 ldi r24,lo8(1) |
204 0186 8093 0000 sts stick.2222,r24 |
205 018a 8091 0000 lds r24,WinkelOut+6 |
206 018e 8F5F subi r24,lo8(-(1)) |
207 0190 8093 0000 sts WinkelOut+6,r24 |
208 0194 8530 cpi r24,lo8(5) |
209 0196 00F0 brlo .L17 |
210 0198 88EE ldi r24,lo8(1000) |
211 019a 93E0 ldi r25,hi8(1000) |
212 019c 9093 0000 sts (beeptime)+1,r25 |
213 01a0 8093 0000 sts beeptime,r24 |
214 01a4 00C0 rjmp .L16 |
215 .L17: |
216 01a6 66E9 ldi r22,lo8(150) |
217 01a8 70E0 ldi r23,hi8(150) |
218 01aa 0E94 0000 call Piep |
219 .L16: |
220 01ae 8091 0000 lds r24,WinkelOut+6 |
221 01b2 8093 0000 sts DebugOut+40,r24 |
222 01b6 1092 0000 sts DebugOut+41,__zero_reg__ |
223 /* epilogue start */ |
224 01ba 0895 ret |
226 .global main |
228 main: |
229 01bc A0E0 ldi r26,lo8(0) |
230 01be B0E0 ldi r27,hi8(0) |
231 01c0 E0E0 ldi r30,lo8(gs(1f)) |
232 01c2 F0E0 ldi r31,hi8(gs(1f)) |
233 01c4 0C94 0000 jmp __prologue_saves__+((18 - 18) * 2) |
234 1: |
235 /* prologue: function */ |
236 /* frame size = 0 */ |
237 01c8 14B8 out 36-32,__zero_reg__ |
238 01ca 15B8 out 37-32,__zero_reg__ |
239 01cc 189B sbis 35-32,0 |
240 01ce 00C0 rjmp .L20 |
241 01d0 199B sbis 35-32,1 |
242 01d2 00C0 rjmp .L21 |
243 01d4 8DE0 ldi r24,lo8(13) |
244 01d6 00C0 rjmp .L97 |
245 .L21: |
246 01d8 8BE0 ldi r24,lo8(11) |
247 01da 00C0 rjmp .L97 |
248 .L20: |
249 01dc 199B sbis 35-32,1 |
250 01de 00C0 rjmp .L23 |
251 01e0 84E1 ldi r24,lo8(20) |
252 01e2 00C0 rjmp .L97 |
253 .L23: |
254 01e4 8AE0 ldi r24,lo8(10) |
255 .L97: |
256 01e6 8093 0000 sts PlatinenVersion,r24 |
257 01ea 81E8 ldi r24,lo8(-127) |
258 01ec 87B9 out 39-32,r24 |
259 01ee 3E9A sbi 39-32,6 |
260 01f0 8FEF ldi r24,lo8(-1) |
261 01f2 88B9 out 40-32,r24 |
262 01f4 8BE1 ldi r24,lo8(27) |
263 01f6 84B9 out 36-32,r24 |
264 01f8 81E0 ldi r24,lo8(1) |
265 01fa 85B9 out 37-32,r24 |
266 01fc 8EE3 ldi r24,lo8(62) |
267 01fe 8AB9 out 42-32,r24 |
268 0200 87E4 ldi r24,lo8(71) |
269 0202 8BB9 out 43-32,r24 |
270 0204 469A sbi 40-32,6 |
271 0206 84B7 in r24,84-32 |
272 0208 877F andi r24,lo8(-9) |
273 020a 84BF out 84-32,r24 |
274 020c 8091 6000 lds r24,96 |
275 0210 8861 ori r24,lo8(24) |
276 0212 8093 6000 sts 96,r24 |
277 0216 1092 6000 sts 96,__zero_reg__ |
278 021a 84EC ldi r24,lo8(2500) |
279 021c 99E0 ldi r25,hi8(2500) |
280 021e 9093 0000 sts (beeptime)+1,r25 |
281 0222 8093 0000 sts beeptime,r24 |
282 0226 1092 0000 sts (StickGier)+1,__zero_reg__ |
283 022a 1092 0000 sts StickGier,__zero_reg__ |
284 022e 1092 0000 sts (PPM_in+4)+1,__zero_reg__ |
285 0232 1092 0000 sts PPM_in+4,__zero_reg__ |
286 0236 1092 0000 sts (StickRoll)+1,__zero_reg__ |
287 023a 1092 0000 sts StickRoll,__zero_reg__ |
288 023e 1092 0000 sts (StickNick)+1,__zero_reg__ |
289 0242 1092 0000 sts StickNick,__zero_reg__ |
290 0246 8091 0000 lds r24,PlatinenVersion |
291 024a 8431 cpi r24,lo8(20) |
292 024c 00F0 brlo .L24 |
293 024e 84EC ldi r24,lo8(1220) |
294 0250 94E0 ldi r25,hi8(1220) |
295 0252 A0E0 ldi r26,hlo8(1220) |
296 0254 B0E0 ldi r27,hhi8(1220) |
297 0256 00C0 rjmp .L98 |
298 .L24: |
299 0258 8BE0 ldi r24,lo8(1291) |
300 025a 95E0 ldi r25,hi8(1291) |
301 025c A0E0 ldi r26,hlo8(1291) |
302 025e B0E0 ldi r27,hhi8(1291) |
303 .L98: |
304 0260 8093 0000 sts GIER_GRAD_FAKTOR,r24 |
305 0264 9093 0000 sts (GIER_GRAD_FAKTOR)+1,r25 |
306 0268 A093 0000 sts (GIER_GRAD_FAKTOR)+2,r26 |
307 026c B093 0000 sts (GIER_GRAD_FAKTOR)+3,r27 |
308 0270 8091 0000 lds r24,PlatinenVersion |
309 0274 8A30 cpi r24,lo8(10) |
310 0276 01F0 breq .L26 |
311 0278 8431 cpi r24,lo8(20) |
312 027a 00F0 brlo .L27 |
313 .L26: |
314 027c 2898 cbi 37-32,0 |
315 027e 00C0 rjmp .L28 |
316 .L27: |
317 0280 289A sbi 37-32,0 |
318 .L28: |
319 0282 0E94 0000 call Timer_Init |
320 0286 0E94 0000 call TIMER2_Init |
321 028a 0E94 0000 call UART_Init |
322 028e 0E94 0000 call rc_sum_init |
323 0292 0E94 0000 call ADC_Init |
324 0296 0E94 0000 call I2C_Init |
325 029a 0E94 0000 call SPI_MasterInit |
326 029e 0E94 0000 call Capacity_Init |
327 02a2 0E94 0000 call LIBFC_Init |
328 02a6 8091 0000 lds r24,PlatinenVersion |
329 02aa 8C30 cpi r24,lo8(12) |
330 02ac 00F4 brsh .L29 |
331 02ae 299A sbi 37-32,1 |
332 02b0 00C0 rjmp .L30 |
333 .L29: |
334 02b2 2998 cbi 37-32,1 |
335 .L30: |
336 /* #APP */ |
337 ; 164 "main.c" 1 |
338 02b4 7894 sei |
339 ; 0 "" 2 |
340 /* #NOAPP */ |
341 02b6 0E94 0000 call ParamSet_Init |
342 02ba 8091 0000 lds r24,BLFlags |
343 02be 8260 ori r24,lo8(2) |
344 02c0 8093 0000 sts BLFlags,r24 |
345 02c4 1092 0000 sts motor_read,__zero_reg__ |
346 02c8 0E94 0000 call SendMotorData |
347 02cc 84EF ldi r24,lo8(500) |
348 02ce 91E0 ldi r25,hi8(500) |
349 02d0 0E94 0000 call SetDelay |
350 02d4 8C01 movw r16,r24 |
351 .L32: |
352 02d6 8091 0000 lds r24,BLFlags |
353 02da 80FD sbrc r24,0 |
354 02dc 00C0 rjmp .L31 |
355 02de C801 movw r24,r16 |
356 02e0 0E94 0000 call CheckDelay |
357 02e4 8823 tst r24 |
358 02e6 01F0 breq .L32 |
359 .L31: |
360 02e8 00D0 rcall . |
361 02ea 00D0 rcall . |
362 02ec 00E0 ldi r16,lo8(gs(uart_putchar)) |
363 02ee 10E0 ldi r17,hi8(gs(uart_putchar)) |
364 02f0 ADB7 in r26,__SP_L__ |
365 02f2 BEB7 in r27,__SP_H__ |
366 02f4 1296 adiw r26,1+1 |
367 02f6 1C93 st X,r17 |
368 02f8 0E93 st -X,r16 |
369 02fa 1197 sbiw r26,1 |
370 02fc 80E0 ldi r24,lo8(__c.2277) |
371 02fe 90E0 ldi r25,hi8(__c.2277) |
372 0300 1496 adiw r26,3+1 |
373 0302 9C93 st X,r25 |
374 0304 8E93 st -X,r24 |
375 0306 1397 sbiw r26,3 |
376 0308 E091 0000 lds r30,_printf_P |
377 030c F091 0000 lds r31,(_printf_P)+1 |
378 0310 0995 icall |
379 0312 0F90 pop __tmp_reg__ |
380 0314 0F90 pop __tmp_reg__ |
381 0316 0F90 pop __tmp_reg__ |
382 0318 0F90 pop __tmp_reg__ |
383 031a 80EA ldi r24,lo8(4000) |
384 031c 9FE0 ldi r25,hi8(4000) |
385 031e 0E94 0000 call SetDelay |
386 0322 4C01 movw r8,r24 |
387 0324 B0E0 ldi r27,lo8(Motor+3) |
388 0326 CB2E mov r12,r27 |
389 0328 B0E0 ldi r27,hi8(Motor+3) |
390 032a DB2E mov r13,r27 |
391 032c A0E0 ldi r26,lo8(Mixer+13) |
392 032e 6A2E mov r6,r26 |
393 0330 A0E0 ldi r26,hi8(Mixer+13) |
394 0332 7A2E mov r7,r26 |
395 0334 7601 movw r14,r12 |
396 0336 5301 movw r10,r6 |
397 0338 C1E0 ldi r28,lo8(1) |
398 033a D0E0 ldi r29,hi8(1) |
399 033c 2801 movw r4,r16 |
400 033e 00E0 ldi r16,lo8(__c.2288) |
401 0340 10E0 ldi r17,hi8(__c.2288) |
402 .L40: |
403 0342 0E94 0000 call SendMotorData |
404 .L34: |
405 0346 8091 0000 lds r24,BLFlags |
406 034a 80FD sbrc r24,0 |
407 034c 00C0 rjmp .L33 |
408 034e C401 movw r24,r8 |
409 0350 0E94 0000 call CheckDelay |
410 0354 8823 tst r24 |
411 0356 01F0 breq .L34 |
412 .L33: |
413 0358 F501 movw r30,r10 |
414 035a 8081 ld r24,Z |
415 035c 1816 cp __zero_reg__,r24 |
416 035e 04F0 brlt .L95 |
417 0360 00C0 rjmp .L36 |
418 .L38: |
419 0362 0E94 0000 call SendMotorData |
420 .L37: |
421 0366 8091 0000 lds r24,BLFlags |
422 036a 80FD sbrc r24,0 |
423 036c 00C0 rjmp .L95 |
424 036e C401 movw r24,r8 |
425 0370 0E94 0000 call CheckDelay |
426 0374 8823 tst r24 |
427 0376 01F0 breq .L37 |
428 .L95: |
429 0378 C401 movw r24,r8 |
430 037a 0E94 0000 call CheckDelay |
431 037e 8823 tst r24 |
432 0380 01F4 brne .L36 |
433 0382 D701 movw r26,r14 |
434 0384 8C91 ld r24,X |
435 0386 87FF sbrs r24,7 |
436 0388 00C0 rjmp .L38 |
437 .L36: |
438 038a F701 movw r30,r14 |
439 038c 8081 ld r24,Z |
440 038e 87FF sbrs r24,7 |
441 0390 00C0 rjmp .L39 |
442 0392 00D0 rcall . |
443 0394 00D0 rcall . |
444 0396 00D0 rcall . |
445 0398 EDB7 in r30,__SP_L__ |
446 039a FEB7 in r31,__SP_H__ |
447 039c 3196 adiw r30,1 |
448 039e ADB7 in r26,__SP_L__ |
449 03a0 BEB7 in r27,__SP_H__ |
450 03a2 1196 adiw r26,1 |
451 03a4 4C92 st X,r4 |
452 03a6 1197 sbiw r26,1 |
453 03a8 1296 adiw r26,2 |
454 03aa 5C92 st X,r5 |
455 03ac 1383 std Z+3,r17 |
456 03ae 0283 std Z+2,r16 |
457 03b0 D583 std Z+5,r29 |
458 03b2 C483 std Z+4,r28 |
459 03b4 E091 0000 lds r30,_printf_P |
460 03b8 F091 0000 lds r31,(_printf_P)+1 |
461 03bc 0995 icall |
462 03be 8091 0000 lds r24,FoundMotors |
463 03c2 8F5F subi r24,lo8(-(1)) |
464 03c4 8093 0000 sts FoundMotors,r24 |
465 03c8 EDB7 in r30,__SP_L__ |
466 03ca FEB7 in r31,__SP_H__ |
467 03cc 3696 adiw r30,6 |
468 03ce EDBF out __SP_L__,r30 |
469 .L39: |
470 03d0 2196 adiw r28,1 |
471 03d2 88E0 ldi r24,lo8(8) |
472 03d4 90E0 ldi r25,hi8(8) |
473 03d6 E80E add r14,r24 |
474 03d8 F91E adc r15,r25 |
475 03da A4E0 ldi r26,lo8(4) |
476 03dc B0E0 ldi r27,hi8(4) |
477 03de AA0E add r10,r26 |
478 03e0 BB1E adc r11,r27 |
479 03e2 CD30 cpi r28,13 |
480 03e4 D105 cpc r29,__zero_reg__ |
481 03e6 01F0 breq .+2 |
482 03e8 00C0 rjmp .L40 |
483 03ea 01E0 ldi r16,lo8(1) |
484 03ec 10E0 ldi r17,hi8(1) |
485 03ee F0E0 ldi r31,lo8(gs(uart_putchar)) |
486 03f0 EF2E mov r14,r31 |
487 03f2 F0E0 ldi r31,hi8(gs(uart_putchar)) |
488 03f4 FF2E mov r15,r31 |
489 03f6 C0E0 ldi r28,lo8(__c.2293) |
490 03f8 D0E0 ldi r29,hi8(__c.2293) |
491 03fa E2E0 ldi r30,lo8(2) |
492 03fc BE2E mov r11,r30 |
493 .L42: |
494 03fe F601 movw r30,r12 |
495 0400 8081 ld r24,Z |
496 0402 87FD sbrc r24,7 |
497 0404 00C0 rjmp .L41 |
498 0406 D301 movw r26,r6 |
499 0408 8C91 ld r24,X |
500 040a 1816 cp __zero_reg__,r24 |
501 040c 04F4 brge .L41 |
502 040e 00D0 rcall . |
503 0410 00D0 rcall . |
504 0412 00D0 rcall . |
505 0414 EDB7 in r30,__SP_L__ |
506 0416 FEB7 in r31,__SP_H__ |
507 0418 3196 adiw r30,1 |
508 041a ADB7 in r26,__SP_L__ |
509 041c BEB7 in r27,__SP_H__ |
510 041e 1296 adiw r26,1+1 |
511 0420 FC92 st X,r15 |
512 0422 EE92 st -X,r14 |
513 0424 1197 sbiw r26,1 |
514 0426 D383 std Z+3,r29 |
515 0428 C283 std Z+2,r28 |
516 042a 1583 std Z+5,r17 |
517 042c 0483 std Z+4,r16 |
518 042e E091 0000 lds r30,_printf_P |
519 0432 F091 0000 lds r31,(_printf_P)+1 |
520 0436 0995 icall |
521 0438 B092 0000 sts ServoActive,r11 |
522 043c EDB7 in r30,__SP_L__ |
523 043e FEB7 in r31,__SP_H__ |
524 0440 3696 adiw r30,6 |
525 0442 EDBF out __SP_L__,r30 |
526 .L41: |
527 0444 D601 movw r26,r12 |
528 0446 8C91 ld r24,X |
529 0448 8078 andi r24,lo8(-128) |
530 044a 8C93 st X,r24 |
531 044c 0F5F subi r16,lo8(-(1)) |
532 044e 1F4F sbci r17,hi8(-(1)) |
533 0450 E8E0 ldi r30,lo8(8) |
534 0452 F0E0 ldi r31,hi8(8) |
535 0454 CE0E add r12,r30 |
536 0456 DF1E adc r13,r31 |
537 0458 84E0 ldi r24,lo8(4) |
538 045a 90E0 ldi r25,hi8(4) |
539 045c 680E add r6,r24 |
540 045e 791E adc r7,r25 |
541 0460 0D30 cpi r16,13 |
542 0462 1105 cpc r17,__zero_reg__ |
543 0464 01F4 brne .L42 |
544 0466 00D0 rcall . |
545 0468 00D0 rcall . |
546 046a 80E0 ldi r24,lo8(gs(uart_putchar)) |
547 046c 90E0 ldi r25,hi8(gs(uart_putchar)) |
548 046e ADB7 in r26,__SP_L__ |
549 0470 BEB7 in r27,__SP_H__ |
550 0472 1296 adiw r26,1+1 |
551 0474 9C93 st X,r25 |
552 0476 8E93 st -X,r24 |
553 0478 1197 sbiw r26,1 |
554 047a 80E0 ldi r24,lo8(__c.2298) |
555 047c 90E0 ldi r25,hi8(__c.2298) |
556 047e 1496 adiw r26,3+1 |
557 0480 9C93 st X,r25 |
558 0482 8E93 st -X,r24 |
559 0484 1397 sbiw r26,3 |
560 0486 E091 0000 lds r30,_printf_P |
561 048a F091 0000 lds r31,(_printf_P)+1 |
562 048e 0995 icall |
563 0490 0F90 pop __tmp_reg__ |
564 0492 0F90 pop __tmp_reg__ |
565 0494 0F90 pop __tmp_reg__ |
566 0496 0F90 pop __tmp_reg__ |
567 0498 9091 0000 lds r25,RequiredMotors |
568 049c 8091 0000 lds r24,FoundMotors |
569 04a0 9817 cp r25,r24 |
570 04a2 00F4 brsh .L43 |
571 04a4 8091 0000 lds r24,VersionInfo+6 |
572 04a8 8061 ori r24,lo8(16) |
573 04aa 8093 0000 sts VersionInfo+6,r24 |
574 .L43: |
575 04ae 00D0 rcall . |
576 04b0 00D0 rcall . |
577 04b2 80E0 ldi r24,lo8(gs(uart_putchar)) |
578 04b4 90E0 ldi r25,hi8(gs(uart_putchar)) |
579 04b6 EDB7 in r30,__SP_L__ |
580 04b8 FEB7 in r31,__SP_H__ |
581 04ba 9283 std Z+2,r25 |
582 04bc 8183 std Z+1,r24 |
583 04be 80E0 ldi r24,lo8(__c.2300) |
584 04c0 90E0 ldi r25,hi8(__c.2300) |
585 04c2 9483 std Z+4,r25 |
586 04c4 8383 std Z+3,r24 |
587 04c6 E091 0000 lds r30,_printf_P |
588 04ca F091 0000 lds r31,(_printf_P)+1 |
589 04ce 0995 icall |
590 04d0 0F90 pop __tmp_reg__ |
591 04d2 0F90 pop __tmp_reg__ |
592 04d4 0F90 pop __tmp_reg__ |
593 04d6 0F90 pop __tmp_reg__ |
594 04d8 88EE ldi r24,lo8(1000) |
595 04da 93E0 ldi r25,hi8(1000) |
596 04dc 0E94 0000 call SetDelay |
597 04e0 8C01 movw r16,r24 |
598 04e2 0E94 0000 call SucheLuftruckOffset |
599 .L44: |
600 04e6 C801 movw r24,r16 |
601 04e8 0E94 0000 call CheckDelay |
602 04ec 8823 tst r24 |
603 04ee 01F0 breq .L44 |
604 04f0 00D0 rcall . |
605 04f2 00D0 rcall . |
606 04f4 80E0 ldi r24,lo8(gs(uart_putchar)) |
607 04f6 90E0 ldi r25,hi8(gs(uart_putchar)) |
608 04f8 ADB7 in r26,__SP_L__ |
609 04fa BEB7 in r27,__SP_H__ |
610 04fc 1296 adiw r26,1+1 |
611 04fe 9C93 st X,r25 |
612 0500 8E93 st -X,r24 |
613 0502 1197 sbiw r26,1 |
614 0504 80E0 ldi r24,lo8(__c.2305) |
615 0506 90E0 ldi r25,hi8(__c.2305) |
616 0508 1496 adiw r26,3+1 |
617 050a 9C93 st X,r25 |
618 050c 8E93 st -X,r24 |
619 050e 1397 sbiw r26,3 |
620 0510 E091 0000 lds r30,_printf_P |
621 0514 F091 0000 lds r31,(_printf_P)+1 |
622 0518 0995 icall |
623 051a 0F90 pop __tmp_reg__ |
624 051c 0F90 pop __tmp_reg__ |
625 051e 0F90 pop __tmp_reg__ |
626 0520 0F90 pop __tmp_reg__ |
627 0522 80E0 ldi r24,lo8(0) |
628 0524 0E94 0000 call SetNeutral |
629 0528 8091 0000 lds r24,PlatinenVersion |
630 052c 8A30 cpi r24,lo8(10) |
631 052e 01F0 breq .L45 |
632 0530 8431 cpi r24,lo8(20) |
633 0532 00F0 brlo .L46 |
634 .L45: |
635 0534 2898 cbi 37-32,0 |
636 0536 00C0 rjmp .L47 |
637 .L46: |
638 0538 289A sbi 37-32,0 |
639 .L47: |
640 053a 80ED ldi r24,lo8(2000) |
641 053c 97E0 ldi r25,hi8(2000) |
642 053e 9093 0000 sts (beeptime)+1,r25 |
643 0542 8093 0000 sts beeptime,r24 |
644 0546 85E5 ldi r24,lo8(85) |
645 0548 8093 0000 sts ExternControl,r24 |
646 054c 8EE0 ldi r24,lo8(14) |
647 054e 90E0 ldi r25,hi8(14) |
648 0550 0E94 0000 call GetParamByte |
649 0554 182F mov r17,r24 |
650 0556 8FE0 ldi r24,lo8(15) |
651 0558 90E0 ldi r25,hi8(15) |
652 055a 0E94 0000 call GetParamByte |
653 055e 312F mov r19,r17 |
654 0560 20E0 ldi r18,lo8(0) |
655 0562 280F add r18,r24 |
656 0564 311D adc r19,__zero_reg__ |
657 0566 3093 0000 sts (FlugMinuten)+1,r19 |
658 056a 2093 0000 sts FlugMinuten,r18 |
659 056e 8AE0 ldi r24,lo8(10) |
660 0570 90E0 ldi r25,hi8(10) |
661 0572 0E94 0000 call GetParamByte |
662 0576 182F mov r17,r24 |
663 0578 8BE0 ldi r24,lo8(11) |
664 057a 90E0 ldi r25,hi8(11) |
665 057c 0E94 0000 call GetParamByte |
666 0580 312F mov r19,r17 |
667 0582 20E0 ldi r18,lo8(0) |
668 0584 280F add r18,r24 |
669 0586 311D adc r19,__zero_reg__ |
670 0588 3093 0000 sts (FlugMinutenGesamt)+1,r19 |
671 058c 2093 0000 sts FlugMinutenGesamt,r18 |
672 0590 2F5F subi r18,lo8(-1) |
673 0592 3F4F sbci r19,hi8(-1) |
674 0594 01F0 breq .L48 |
675 0596 8091 0000 lds r24,FlugMinuten |
676 059a 9091 0000 lds r25,(FlugMinuten)+1 |
677 059e 8F5F subi r24,lo8(-1) |
678 05a0 9F4F sbci r25,hi8(-1) |
679 05a2 01F4 brne .L49 |
680 .L48: |
681 05a4 1092 0000 sts (FlugMinuten)+1,__zero_reg__ |
682 05a8 1092 0000 sts FlugMinuten,__zero_reg__ |
683 05ac 1092 0000 sts (FlugMinutenGesamt)+1,__zero_reg__ |
684 05b0 1092 0000 sts FlugMinutenGesamt,__zero_reg__ |
685 .L49: |
686 05b4 8DB7 in r24,__SP_L__ |
687 05b6 9EB7 in r25,__SP_H__ |
688 05b8 0897 sbiw r24,8 |
689 05ba 8DBF out __SP_L__,r24 |
690 05bc EDB7 in r30,__SP_L__ |
691 05be FEB7 in r31,__SP_H__ |
692 05c0 3196 adiw r30,1 |
693 05c2 00E0 ldi r16,lo8(gs(uart_putchar)) |
694 05c4 10E0 ldi r17,hi8(gs(uart_putchar)) |
695 05c6 ADB7 in r26,__SP_L__ |
696 05c8 BEB7 in r27,__SP_H__ |
697 05ca 1296 adiw r26,1+1 |
698 05cc 1C93 st X,r17 |
699 05ce 0E93 st -X,r16 |
700 05d0 1197 sbiw r26,1 |
701 05d2 80E0 ldi r24,lo8(__c.2307) |
702 05d4 90E0 ldi r25,hi8(__c.2307) |
703 05d6 9383 std Z+3,r25 |
704 05d8 8283 std Z+2,r24 |
705 05da 8091 0000 lds r24,FlugMinuten |
706 05de 9091 0000 lds r25,(FlugMinuten)+1 |
707 05e2 9583 std Z+5,r25 |
708 05e4 8483 std Z+4,r24 |
709 05e6 8091 0000 lds r24,FlugMinutenGesamt |
710 05ea 9091 0000 lds r25,(FlugMinutenGesamt)+1 |
711 05ee 9783 std Z+7,r25 |
712 05f0 8683 std Z+6,r24 |
713 05f2 E091 0000 lds r30,_printf_P |
714 05f6 F091 0000 lds r31,(_printf_P)+1 |
715 05fa 0995 icall |
716 05fc 0F90 pop __tmp_reg__ |
717 05fe 0F90 pop __tmp_reg__ |
718 0600 0F90 pop __tmp_reg__ |
719 0602 0F90 pop __tmp_reg__ |
720 0604 EDB7 in r30,__SP_L__ |
721 0606 FEB7 in r31,__SP_H__ |
722 0608 1283 std Z+2,r17 |
723 060a 0183 std Z+1,r16 |
724 060c 80E0 ldi r24,lo8(__c.2309) |
725 060e 90E0 ldi r25,hi8(__c.2309) |
726 0610 9483 std Z+4,r25 |
727 0612 8383 std Z+3,r24 |
728 0614 E091 0000 lds r30,_printf_P |
729 0618 F091 0000 lds r31,(_printf_P)+1 |
730 061c 0995 icall |
731 061e 8091 0000 lds r24,EE_Parameter+13 |
732 0622 0F90 pop __tmp_reg__ |
733 0624 0F90 pop __tmp_reg__ |
734 0626 0F90 pop __tmp_reg__ |
735 0628 0F90 pop __tmp_reg__ |
736 062a 82FF sbrs r24,2 |
737 062c 00C0 rjmp .L50 |
738 062e 00D0 rcall . |
739 0630 00D0 rcall . |
740 0632 ADB7 in r26,__SP_L__ |
741 0634 BEB7 in r27,__SP_H__ |
742 0636 1296 adiw r26,1+1 |
743 0638 1C93 st X,r17 |
744 063a 0E93 st -X,r16 |
745 063c 1197 sbiw r26,1 |
746 063e 80E0 ldi r24,lo8(__c.2311) |
747 0640 90E0 ldi r25,hi8(__c.2311) |
748 0642 1496 adiw r26,3+1 |
749 0644 9C93 st X,r25 |
750 0646 8E93 st -X,r24 |
751 0648 1397 sbiw r26,3 |
752 064a 00C0 rjmp .L99 |
753 .L50: |
754 064c 00D0 rcall . |
755 064e 00D0 rcall . |
756 0650 EDB7 in r30,__SP_L__ |
757 0652 FEB7 in r31,__SP_H__ |
758 0654 1283 std Z+2,r17 |
759 0656 0183 std Z+1,r16 |
760 0658 80E0 ldi r24,lo8(__c.2313) |
761 065a 90E0 ldi r25,hi8(__c.2313) |
762 065c 9483 std Z+4,r25 |
763 065e 8383 std Z+3,r24 |
764 .L99: |
765 0660 E091 0000 lds r30,_printf_P |
766 0664 F091 0000 lds r31,(_printf_P)+1 |
767 0668 0995 icall |
768 066a 0F90 pop __tmp_reg__ |
769 066c 0F90 pop __tmp_reg__ |
770 066e 0F90 pop __tmp_reg__ |
771 0670 0F90 pop __tmp_reg__ |
772 0672 0E94 0000 call LcdClear |
773 0676 88E8 ldi r24,lo8(5000) |
774 0678 93E1 ldi r25,hi8(5000) |
775 067a 9093 0000 sts (I2CTimeout)+1,r25 |
776 067e 8093 0000 sts I2CTimeout,r24 |
777 0682 81E0 ldi r24,lo8(1) |
778 0684 8093 0000 sts WinkelOut+7,r24 |
779 0688 0E94 0000 call LipoDetection |
780 068c 8091 0000 lds r24,EE_Parameter+39 |
781 0690 0E94 0000 call LIBFC_ReceiverInit |
782 0694 00D0 rcall . |
783 0696 00D0 rcall . |
784 0698 80E0 ldi r24,lo8(gs(uart_putchar)) |
785 069a 90E0 ldi r25,hi8(gs(uart_putchar)) |
786 069c ADB7 in r26,__SP_L__ |
787 069e BEB7 in r27,__SP_H__ |
788 06a0 1296 adiw r26,1+1 |
789 06a2 9C93 st X,r25 |
790 06a4 8E93 st -X,r24 |
791 06a6 1197 sbiw r26,1 |
792 06a8 80E0 ldi r24,lo8(__c.2315) |
793 06aa 90E0 ldi r25,hi8(__c.2315) |
794 06ac 1496 adiw r26,3+1 |
795 06ae 9C93 st X,r25 |
796 06b0 8E93 st -X,r24 |
797 06b2 1397 sbiw r26,3 |
798 06b4 E091 0000 lds r30,_printf_P |
799 06b8 F091 0000 lds r31,(_printf_P)+1 |
800 06bc 0995 icall |
801 06be 0F90 pop __tmp_reg__ |
802 06c0 0F90 pop __tmp_reg__ |
803 06c2 0F90 pop __tmp_reg__ |
804 06c4 0F90 pop __tmp_reg__ |
805 06c6 80ED ldi r24,lo8(2000) |
806 06c8 97E0 ldi r25,hi8(2000) |
807 06ca 0E94 0000 call SetDelay |
808 06ce 8C01 movw r16,r24 |
809 06d0 8AEF ldi r24,lo8(250) |
810 06d2 90E0 ldi r25,hi8(250) |
811 06d4 0E94 0000 call SetDelay |
812 06d8 7C01 movw r14,r24 |
813 06da 83E0 ldi r24,lo8(3) |
814 06dc 8093 0000 sts DebugOut,r24 |
815 06e0 C0E0 ldi r28,lo8(0) |
816 06e2 D0E0 ldi r29,hi8(0) |
817 06e4 78E9 ldi r23,lo8(15000) |
818 06e6 C72E mov r12,r23 |
819 06e8 7AE3 ldi r23,hi8(15000) |
820 06ea D72E mov r13,r23 |
821 06ec 412C mov r4,__zero_reg__ |
822 06ee 68EA ldi r22,hi8(-22528) |
823 06f0 562E mov r5,r22 |
824 06f2 212C mov r2,__zero_reg__ |
825 06f4 5CE0 ldi r21,hi8(3072) |
826 06f6 352E mov r3,r21 |
827 06f8 40E1 ldi r20,lo8(10000) |
828 06fa A42E mov r10,r20 |
829 06fc 47E2 ldi r20,hi8(10000) |
830 06fe B42E mov r11,r20 |
831 0700 30E8 ldi r19,lo8(128) |
832 0702 832E mov r8,r19 |
833 0704 912C mov r9,__zero_reg__ |
834 0706 25E0 ldi r18,lo8(5) |
835 0708 622E mov r6,r18 |
836 070a 712C mov r7,__zero_reg__ |
837 .L96: |
838 070c C701 movw r24,r14 |
839 070e 0E94 0000 call CheckDelay |
840 0712 8823 tst r24 |
841 0714 01F0 breq .L52 |
842 0716 84E6 ldi r24,lo8(100) |
843 0718 90E0 ldi r25,hi8(100) |
844 071a 0E94 0000 call SetDelay |
845 071e 7C01 movw r14,r24 |
846 0720 0E94 0000 call LIBFC_Polling |
847 .L52: |
848 0724 8091 0000 lds r24,UpdateMotor |
849 0728 8823 tst r24 |
850 072a 01F4 brne .+2 |
851 072c 00C0 rjmp .L53 |
852 072e 8091 0000 lds r24,AdReady |
853 0732 8823 tst r24 |
854 0734 01F4 brne .+2 |
855 0736 00C0 rjmp .L53 |
856 0738 1092 0000 sts UpdateMotor,__zero_reg__ |
857 073c 8091 0000 lds r24,WinkelOut+6 |
858 0740 8823 tst r24 |
859 0742 01F0 breq .L54 |
860 0744 0E94 0000 call CalMk3Mag |
861 0748 00C0 rjmp .L55 |
862 .L54: |
863 074a 0E94 0000 call MotorRegler |
864 .L55: |
865 074e 0E94 0000 call SendMotorData |
866 0752 8091 0000 lds r24,PlatinenVersion |
867 0756 8A30 cpi r24,lo8(10) |
868 0758 01F0 breq .L56 |
869 075a 8431 cpi r24,lo8(20) |
870 075c 00F0 brlo .L57 |
871 .L56: |
872 075e 2898 cbi 37-32,0 |
873 0760 00C0 rjmp .L58 |
874 .L57: |
875 0762 289A sbi 37-32,0 |
876 .L58: |
877 0764 8091 0000 lds r24,SenderOkay |
878 0768 8823 tst r24 |
879 076a 01F0 breq .L59 |
880 076c 8091 0000 lds r24,SenderOkay |
881 0770 8150 subi r24,lo8(-(-1)) |
882 0772 8093 0000 sts SenderOkay,r24 |
883 0776 8091 0000 lds r24,VersionInfo+6 |
884 077a 877F andi r24,lo8(-9) |
885 077c 00C0 rjmp .L100 |
886 .L59: |
887 077e 8091 6F00 lds r24,111 |
888 0782 8062 ori r24,lo8(32) |
889 0784 8093 6F00 sts 111,r24 |
890 0788 1092 0000 sts (PPM_in)+1,__zero_reg__ |
891 078c 1092 0000 sts PPM_in,__zero_reg__ |
892 0790 8091 0000 lds r24,VersionInfo+6 |
893 0794 8860 ori r24,lo8(8) |
894 .L100: |
895 0796 8093 0000 sts VersionInfo+6,r24 |
896 079a 8091 0000 lds r24,I2CTimeout |
897 079e 9091 0000 lds r25,(I2CTimeout)+1 |
898 07a2 0197 sbiw r24,1 |
899 07a4 9093 0000 sts (I2CTimeout)+1,r25 |
900 07a8 8093 0000 sts I2CTimeout,r24 |
901 07ac 8091 0000 lds r24,I2CTimeout |
902 07b0 9091 0000 lds r25,(I2CTimeout)+1 |
903 07b4 892B or r24,r25 |
904 07b6 01F0 breq .L61 |
905 07b8 8091 0000 lds r24,MissingMotor |
906 07bc 8823 tst r24 |
907 07be 01F0 breq .L62 |
908 .L61: |
909 07c0 8091 0000 lds r24,I2CTimeout |
910 07c4 9091 0000 lds r25,(I2CTimeout)+1 |
911 07c8 892B or r24,r25 |
912 07ca 01F4 brne .L63 |
913 07cc 0E94 0000 call I2C_Reset |
914 07d0 7092 0000 sts (I2CTimeout)+1,r7 |
915 07d4 6092 0000 sts I2CTimeout,r6 |
916 07d8 8091 0000 lds r24,DebugOut+58 |
917 07dc 9091 0000 lds r25,(DebugOut+58)+1 |
918 07e0 0196 adiw r24,1 |
919 07e2 9093 0000 sts (DebugOut+58)+1,r25 |
920 07e6 8093 0000 sts DebugOut+58,r24 |
921 07ea 8091 0000 lds r24,FCFlags |
922 07ee 8068 ori r24,lo8(-128) |
923 07f0 8093 0000 sts FCFlags,r24 |
924 07f4 8091 0000 lds r24,VersionInfo+6 |
925 07f8 8160 ori r24,lo8(1) |
926 07fa 8093 0000 sts VersionInfo+6,r24 |
927 07fe 8091 0000 lds r24,DebugOut+1 |
928 0802 8260 ori r24,lo8(2) |
929 0804 8093 0000 sts DebugOut+1,r24 |
930 .L63: |
931 0808 8091 0000 lds r24,BeepMuster |
932 080c 9091 0000 lds r25,(BeepMuster)+1 |
933 0810 8F5F subi r24,lo8(-1) |
934 0812 9F4F sbci r25,hi8(-1) |
935 0814 01F4 brne .L64 |
936 0816 8091 0000 lds r24,MotorenEin |
937 081a 8823 tst r24 |
938 081c 01F0 breq .L64 |
939 081e B092 0000 sts (beeptime)+1,r11 |
940 0822 A092 0000 sts beeptime,r10 |
941 0826 9092 0000 sts (BeepMuster)+1,r9 |
942 082a 8092 0000 sts BeepMuster,r8 |
943 082e 00C0 rjmp .L64 |
944 .L62: |
945 0830 8091 0000 lds r24,PlatinenVersion |
946 0834 8A30 cpi r24,lo8(10) |
947 0836 01F0 breq .L65 |
948 0838 8431 cpi r24,lo8(20) |
949 083a 00F0 brlo .L66 |
950 .L65: |
951 083c 2898 cbi 37-32,0 |
952 083e 00C0 rjmp .L67 |
953 .L66: |
954 0840 289A sbi 37-32,0 |
955 .L67: |
956 0842 8091 0000 lds r24,beeptime |
957 0846 9091 0000 lds r25,(beeptime)+1 |
958 084a 892B or r24,r25 |
959 084c 01F4 brne .L64 |
960 084e 8091 0000 lds r24,FCFlags |
961 0852 8F77 andi r24,lo8(127) |
962 0854 8093 0000 sts FCFlags,r24 |
963 .L64: |
964 0858 8091 0000 lds r24,UpdateMotor |
965 085c 8823 tst r24 |
966 085e 01F0 breq .+2 |
967 0860 00C0 rjmp .L53 |
968 0862 0E94 0000 call DatenUebertragung |
969 0866 0E94 0000 call BearbeiteRxDaten |
970 086a C801 movw r24,r16 |
971 086c 0E94 0000 call CheckDelay |
972 0870 8823 tst r24 |
973 0872 01F4 brne .+2 |
974 0874 00C0 rjmp .L68 |
975 0876 8091 0000 lds r24,MissingMotor |
976 087a 8823 tst r24 |
977 087c 01F0 breq .L69 |
978 087e 8091 0000 lds r24,VersionInfo+6 |
979 0882 8260 ori r24,lo8(2) |
980 0884 8093 0000 sts VersionInfo+6,r24 |
981 0888 8091 0000 lds r24,DebugOut+1 |
982 088c 8260 ori r24,lo8(2) |
983 088e 00C0 rjmp .L101 |
984 .L69: |
985 0890 8091 0000 lds r24,VersionInfo+6 |
986 0894 8D7F andi r24,lo8(-3) |
987 0896 8093 0000 sts VersionInfo+6,r24 |
988 089a 8091 0000 lds r24,I2CTimeout |
989 089e 9091 0000 lds r25,(I2CTimeout)+1 |
990 08a2 0797 sbiw r24,7 |
991 08a4 00F0 brlo .L70 |
992 08a6 8091 0000 lds r24,DebugOut+1 |
993 08aa 8D7F andi r24,lo8(-3) |
994 .L101: |
995 08ac 8093 0000 sts DebugOut+1,r24 |
996 .L70: |
997 08b0 8091 0000 lds r24,I2CTimeout |
998 08b4 9091 0000 lds r25,(I2CTimeout)+1 |
999 08b8 0797 sbiw r24,7 |
1000 08ba 00F0 brlo .L71 |
1001 08bc 8091 0000 lds r24,VersionInfo+6 |
1002 08c0 8E7F andi r24,lo8(-2) |
1003 08c2 8093 0000 sts VersionInfo+6,r24 |
1004 .L71: |
1005 08c6 8091 0000 lds r24,PcZugriff |
1006 08ca 8823 tst r24 |
1007 08cc 01F0 breq .L72 |
1008 08ce 8150 subi r24,lo8(-(-1)) |
1009 08d0 8093 0000 sts PcZugriff,r24 |
1010 08d4 00C0 rjmp .L73 |
1011 .L72: |
1012 08d6 1092 0000 sts ExternControl+10,__zero_reg__ |
1013 08da 1092 0000 sts (ExternStickNick)+1,__zero_reg__ |
1014 08de 1092 0000 sts ExternStickNick,__zero_reg__ |
1015 08e2 1092 0000 sts (ExternStickRoll)+1,__zero_reg__ |
1016 08e6 1092 0000 sts ExternStickRoll,__zero_reg__ |
1017 08ea 1092 0000 sts (ExternStickGier)+1,__zero_reg__ |
1018 08ee 1092 0000 sts ExternStickGier,__zero_reg__ |
1019 08f2 8091 0000 lds r24,BeepMuster |
1020 08f6 9091 0000 lds r25,(BeepMuster)+1 |
1021 08fa 8F5F subi r24,lo8(-1) |
1022 08fc 9F4F sbci r25,hi8(-1) |
1023 08fe 01F4 brne .L73 |
1024 0900 8091 0000 lds r24,SenderOkay |
1025 0904 8823 tst r24 |
1026 0906 01F4 brne .L73 |
1027 0908 D092 0000 sts (beeptime)+1,r13 |
1028 090c C092 0000 sts beeptime,r12 |
1029 0910 3092 0000 sts (BeepMuster)+1,r3 |
1030 0914 2092 0000 sts BeepMuster,r2 |
1031 .L73: |
1032 0918 8091 0000 lds r24,NaviDataOkay |
1033 091c 893C cpi r24,lo8(-55) |
1034 091e 00F0 brlo .L74 |
1035 0920 8150 subi r24,lo8(-(-1)) |
1036 0922 8093 0000 sts NaviDataOkay,r24 |
1037 0926 8091 0000 lds r24,FCFlags |
1038 092a 8F7B andi r24,lo8(-65) |
1039 092c 8093 0000 sts FCFlags,r24 |
1040 0930 8091 0000 lds r24,VersionInfo+6 |
1041 0934 8B7F andi r24,lo8(-5) |
1042 0936 8093 0000 sts VersionInfo+6,r24 |
1043 093a 00C0 rjmp .L75 |
1044 .L74: |
1045 093c 8091 0000 lds r24,NC_Version+3 |
1046 0940 8823 tst r24 |
1047 0942 01F0 breq .L76 |
1048 0944 8091 0000 lds r24,FCFlags |
1049 0948 8064 ori r24,lo8(64) |
1050 094a 8093 0000 sts FCFlags,r24 |
1051 094e 8091 0000 lds r24,VersionInfo+6 |
1052 0952 8460 ori r24,lo8(4) |
1053 0954 8093 0000 sts VersionInfo+6,r24 |
1054 0958 8091 0000 lds r24,BeepMuster |
1055 095c 9091 0000 lds r25,(BeepMuster)+1 |
1056 0960 8F5F subi r24,lo8(-1) |
1057 0962 9F4F sbci r25,hi8(-1) |
1058 0964 01F4 brne .L76 |
1059 0966 8091 0000 lds r24,MotorenEin |
1060 096a 8823 tst r24 |
1061 096c 01F0 breq .L76 |
1062 096e D092 0000 sts (beeptime)+1,r13 |
1063 0972 C092 0000 sts beeptime,r12 |
1064 0976 5092 0000 sts (BeepMuster)+1,r5 |
1065 097a 4092 0000 sts BeepMuster,r4 |
1066 .L76: |
1067 097e 1092 0000 sts (GPS_Nick)+1,__zero_reg__ |
1068 0982 1092 0000 sts GPS_Nick,__zero_reg__ |
1069 0986 1092 0000 sts (GPS_Roll)+1,__zero_reg__ |
1070 098a 1092 0000 sts GPS_Roll,__zero_reg__ |
1071 098e 8FEF ldi r24,lo8(-1) |
1072 0990 9FEF ldi r25,hi8(-1) |
1073 0992 9093 0000 sts (FromNaviCtrl+7)+1,r25 |
1074 0996 8093 0000 sts FromNaviCtrl+7,r24 |
1075 099a 1092 0000 sts NaviDataOkay,__zero_reg__ |
1076 .L75: |
1077 099e 2091 0000 lds r18,UBat |
1078 09a2 3091 0000 lds r19,(UBat)+1 |
1079 09a6 8091 0000 lds r24,BattLowVoltageWarning |
1080 09aa 90E0 ldi r25,lo8(0) |
1081 09ac 2817 cp r18,r24 |
1082 09ae 3907 cpc r19,r25 |
1083 09b0 04F4 brge .L77 |
1084 09b2 8091 0000 lds r24,FCFlags |
1085 09b6 8062 ori r24,lo8(32) |
1086 09b8 8093 0000 sts FCFlags,r24 |
1087 09bc 8091 0000 lds r24,BeepMuster |
1088 09c0 9091 0000 lds r25,(BeepMuster)+1 |
1089 09c4 8F5F subi r24,lo8(-1) |
1090 09c6 9F4F sbci r25,hi8(-1) |
1091 09c8 01F4 brne .L78 |
1092 09ca E0E7 ldi r30,lo8(6000) |
1093 09cc F7E1 ldi r31,hi8(6000) |
1094 09ce F093 0000 sts (beeptime)+1,r31 |
1095 09d2 E093 0000 sts beeptime,r30 |
1096 09d6 80E0 ldi r24,lo8(768) |
1097 09d8 93E0 ldi r25,hi8(768) |
1098 09da 9093 0000 sts (BeepMuster)+1,r25 |
1099 09de 8093 0000 sts BeepMuster,r24 |
1100 09e2 00C0 rjmp .L78 |
1101 .L77: |
1102 09e4 8091 0000 lds r24,beeptime |
1103 09e8 9091 0000 lds r25,(beeptime)+1 |
1104 09ec 892B or r24,r25 |
1105 09ee 01F4 brne .L78 |
1106 09f0 8091 0000 lds r24,FCFlags |
1107 09f4 8F7D andi r24,lo8(-33) |
1108 09f6 8093 0000 sts FCFlags,r24 |
1109 .L78: |
1110 09fa 0E94 0000 call SPI_StartTransmitPacket |
1111 09fe 94E0 ldi r25,lo8(4) |
1112 0a00 9093 0000 sts SendSPI,r25 |
1113 0a04 8091 0000 lds r24,MotorenEin |
1114 0a08 8823 tst r24 |
1115 0a0a 01F4 brne .L79 |
1116 0a0c CAEA ldi r28,lo8(1450) |
1117 0a0e D5E0 ldi r29,hi8(1450) |
1118 0a10 00C0 rjmp .L80 |
1119 .L79: |
1120 0a12 8091 0000 lds r24,second.2317 |
1121 0a16 8F5F subi r24,lo8(-(1)) |
1122 0a18 8093 0000 sts second.2317,r24 |
1123 0a1c 8133 cpi r24,lo8(49) |
1124 0a1e 01F4 brne .L80 |
1125 0a20 1092 0000 sts second.2317,__zero_reg__ |
1126 0a24 8091 0000 lds r24,FlugSekunden |
1127 0a28 9091 0000 lds r25,(FlugSekunden)+1 |
1128 0a2c 0196 adiw r24,1 |
1129 0a2e 9093 0000 sts (FlugSekunden)+1,r25 |
1130 0a32 8093 0000 sts FlugSekunden,r24 |
1131 .L80: |
1132 0a36 2196 adiw r28,1 |
1133 0a38 ABE0 ldi r26,hi8(2930) |
1134 0a3a C237 cpi r28,lo8(2930) |
1135 0a3c DA07 cpc r29,r26 |
1136 0a3e 01F0 breq .L81 |
1137 0a40 0C5E subi r16,lo8(-(20)) |
1138 0a42 1F4F sbci r17,hi8(-(20)) |
1139 0a44 00C0 rjmp .L68 |
1140 .L81: |
1141 0a46 8091 0000 lds r24,FlugMinuten |
1142 0a4a 9091 0000 lds r25,(FlugMinuten)+1 |
1143 0a4e 0196 adiw r24,1 |
1144 0a50 9093 0000 sts (FlugMinuten)+1,r25 |
1145 0a54 8093 0000 sts FlugMinuten,r24 |
1146 0a58 8091 0000 lds r24,FlugMinutenGesamt |
1147 0a5c 9091 0000 lds r25,(FlugMinutenGesamt)+1 |
1148 0a60 0196 adiw r24,1 |
1149 0a62 9093 0000 sts (FlugMinutenGesamt)+1,r25 |
1150 0a66 8093 0000 sts FlugMinutenGesamt,r24 |
1151 0a6a 6091 0000 lds r22,FlugMinuten+1 |
1152 0a6e 8EE0 ldi r24,lo8(14) |
1153 0a70 90E0 ldi r25,hi8(14) |
1154 0a72 0E94 0000 call SetParamByte |
1155 0a76 8FE0 ldi r24,lo8(15) |
1156 0a78 90E0 ldi r25,hi8(15) |
1157 0a7a 6091 0000 lds r22,FlugMinuten |
1158 0a7e 0E94 0000 call SetParamByte |
1159 0a82 6091 0000 lds r22,FlugMinutenGesamt+1 |
1160 0a86 8AE0 ldi r24,lo8(10) |
1161 0a88 90E0 ldi r25,hi8(10) |
1162 0a8a 0E94 0000 call SetParamByte |
1163 0a8e 8BE0 ldi r24,lo8(11) |
1164 0a90 90E0 ldi r25,hi8(11) |
1165 0a92 6091 0000 lds r22,FlugMinutenGesamt |
1166 0a96 0E94 0000 call SetParamByte |
1167 0a9a 84E1 ldi r24,lo8(20) |
1168 0a9c 90E0 ldi r25,hi8(20) |
1169 0a9e 0E94 0000 call SetDelay |
1170 0aa2 8C01 movw r16,r24 |
1171 0aa4 C0E0 ldi r28,lo8(0) |
1172 0aa6 D0E0 ldi r29,hi8(0) |
1173 .L68: |
1174 0aa8 0E94 0000 call LED_Update |
1175 0aac 0E94 0000 call Capacity_Update |
1176 .L53: |
1177 0ab0 8091 0000 lds r24,SendSPI |
1178 0ab4 8823 tst r24 |
1179 0ab6 01F0 breq .+2 |
1180 0ab8 00C0 rjmp .L96 |
1181 0aba 0E94 0000 call SPI_TransmitByte |
1182 0abe 00C0 rjmp .L96 |
1184 .global PlatinenVersion |
1185 .data |
1188 PlatinenVersion: |
1189 0000 0A .byte 10 |
1190 .global SendVersionToNavi |
1193 SendVersionToNavi: |
1194 0001 01 .byte 1 |
1195 .global BattLowVoltageWarning |
1198 BattLowVoltageWarning: |
1199 0002 5E .byte 94 |
1200 .global FlugMinuten |
1201 .global FlugMinuten |
1202 .section .bss |
1205 FlugMinuten: |
1206 0000 0000 .skip 2,0 |
1207 .global FlugMinutenGesamt |
1208 .global FlugMinutenGesamt |
1211 FlugMinutenGesamt: |
1212 0002 0000 .skip 2,0 |
1213 .global FlugSekunden |
1214 .global FlugSekunden |
1217 FlugSekunden: |
1218 0004 0000 .skip 2,0 |
1219 .global FoundMotors |
1220 .global FoundMotors |
1223 FoundMotors: |
1224 0006 00 .skip 1,0 |
1225 .lcomm second.2317,1 |
1226 .section .progmem.data,"a",@progbits |
1229 __c.2315: |
1230 0000 0A0D 3D3D .string "\n\r===================================\n\r" |
1230 3D3D 3D3D |
1230 3D3D 3D3D |
1230 3D3D 3D3D |
1230 3D3D 3D3D |
1233 __c.2313: |
1234 0028 4E6F 726D .string "Normal (ACC-Mode)" |
1234 616C 2028 |
1234 4143 432D |
1234 4D6F 6465 |
1234 2900 |
1237 __c.2311: |
1238 003a 4865 6164 .string "HeadingHold" |
1238 696E 6748 |
1238 6F6C 6400 |
1241 __c.2309: |
1242 0046 0A0D 436F .string "\n\rControl: " |
1242 6E74 726F |
1242 6C3A 2000 |
1245 __c.2307: |
1246 0052 0A0D 466C .string "\n\rFlight-time %u min Total:%u min" |
1246 6967 6874 |
1246 2D74 696D |
1246 6520 2575 |
1246 206D 696E |
1249 __c.2305: |
1250 0075 4F4B 0A0D .string "OK\n\r" |
1250 00 |
1253 __c.2300: |
1254 007a 0A0D 4361 .string "\n\rCalibrating pressure sensor.." |
1254 6C69 6272 |
1254 6174 696E |
1254 6720 7072 |
1254 6573 7375 |
1257 __c.2298: |
1258 009a 0A0D 3D3D .string "\n\r===================================" |
1258 3D3D 3D3D |
1258 3D3D 3D3D |
1258 3D3D 3D3D |
1258 3D3D 3D3D |
1261 __c.2293: |
1262 00c0 0A0D 0A0D .string "\n\r\n\r!! MISSING BL-CTRL: %d !!" |
1262 2121 204D |
1262 4953 5349 |
1262 4E47 2042 |
1262 4C2D 4354 |
1265 __c.2288: |
1266 00de 2564 00 .string "%d" |
1269 __c.2277: |
1270 00e1 0A0D 466F .string "\n\rFound BL-Ctrl: " |
1270 756E 6420 |
1270 424C 2D43 |
1270 7472 6C3A |
1270 2000 |
1273 __c.2246: |
1274 00f3 204C 6F77 .string " Low warning level: %d.%d" |
1274 2077 6172 |
1274 6E69 6E67 |
1274 206C 6576 |
1274 656C 3A20 |
1277 __c.2244: |
1278 010d 2025 6420 .string " %d Cells " |
1278 4365 6C6C |
1278 7320 00 |
1281 __c.2236: |
1282 0118 0A0D 4261 .string "\n\rBatt:" |
1282 7474 3A00 |
1283 .data |
1286 stick.2222: |
1287 0003 01 .byte 1 |
1288 .comm _printf_P,2,1 |
1289 .global __do_copy_data |
1290 .global __do_clear_bss |
8 .global __do_copy_data |
9 .global __do_clear_bss |
10 .global FoundMotors |
11 .global FoundMotors |
12 .section .bss |
15 FoundMotors: |
16 0000 00 .skip 1,0 |
17 .global FlugSekunden |
18 .global FlugSekunden |
21 FlugSekunden: |
22 0001 0000 .skip 2,0 |
23 .global FlugMinutenGesamt |
24 .global FlugMinutenGesamt |
27 FlugMinutenGesamt: |
28 0003 0000 .skip 2,0 |
29 .global FlugMinuten |
30 .global FlugMinuten |
33 FlugMinuten: |
34 0005 0000 .skip 2,0 |
35 .global BattLowVoltageWarning |
36 .data |
39 BattLowVoltageWarning: |
40 0000 5E .byte 94 |
41 .global SendVersionToNavi |
44 SendVersionToNavi: |
45 0001 01 .byte 1 |
46 .global PlatinenVersion |
49 PlatinenVersion: |
50 0002 0A .byte 10 |
53 stick.15: |
54 0003 01 .byte 1 |
55 .text |
56 .global CalMk3Mag |
58 CalMk3Mag: |
59 /* prologue: frame size=0 */ |
60 /* prologue end (size=0) */ |
61 0000 8091 0000 lds r24,EE_Parameter+1 |
62 0004 E82F mov r30,r24 |
63 0006 FF27 clr r31 |
64 0008 EE0F add r30,r30 |
65 000a FF1F adc r31,r31 |
66 000c E050 subi r30,lo8(-(PPM_in)) |
67 000e F040 sbci r31,hi8(-(PPM_in)) |
68 0010 8081 ld r24,Z |
69 0012 9181 ldd r25,Z+1 |
70 0014 8D5E subi r24,lo8(-19) |
71 0016 9F4F sbci r25,hi8(-19) |
72 0018 14F0 brlt .L2 |
73 001a 1092 0000 sts stick.15,__zero_reg__ |
74 .L2: |
75 001e 8081 ld r24,Z |
76 0020 9181 ldd r25,Z+1 |
77 0022 8A5B subi r24,lo8(-70) |
78 0024 9F4F sbci r25,hi8(-70) |
79 0026 CCF4 brge .L3 |
80 0028 8091 0000 lds r24,stick.15 |
81 002c 8823 tst r24 |
82 002e A9F4 brne .L3 |
83 0030 81E0 ldi r24,lo8(1) |
84 0032 8093 0000 sts stick.15,r24 |
85 0036 8091 0000 lds r24,WinkelOut+6 |
86 003a 8F5F subi r24,lo8(-(1)) |
87 003c 8093 0000 sts WinkelOut+6,r24 |
88 0040 8530 cpi r24,lo8(5) |
89 0042 38F0 brlo .L4 |
90 0044 88EE ldi r24,lo8(1000) |
91 0046 93E0 ldi r25,hi8(1000) |
92 0048 9093 0000 sts (beeptime)+1,r25 |
93 004c 8093 0000 sts beeptime,r24 |
94 0050 04C0 rjmp .L3 |
95 .L4: |
96 0052 66E9 ldi r22,lo8(150) |
97 0054 70E0 ldi r23,hi8(150) |
98 0056 0E94 0000 call Piep |
99 .L3: |
100 005a 8091 0000 lds r24,WinkelOut+6 |
101 005e 9927 clr r25 |
102 0060 9093 0000 sts (DebugOut+40)+1,r25 |
103 0064 8093 0000 sts DebugOut+40,r24 |
104 /* epilogue: frame size=0 */ |
105 0068 0895 ret |
106 /* epilogue end (size=1) */ |
107 /* function CalMk3Mag size 55 (54) */ |
109 .section .progmem.data,"a",@progbits |
112 __c.12: |
113 0000 0A0D 4261 .string "\n\rBatt:" |
113 7474 3A00 |
116 __c.13: |
117 0008 2025 6420 .string " %d Cells " |
117 4365 6C6C |
117 7320 00 |
120 __c.14: |
121 0013 204C 6F77 .string " Low warning level: %d.%d" |
121 2077 6172 |
121 6E69 6E67 |
121 206C 6576 |
121 656C 3A20 |
122 .text |
123 .global LipoDetection |
125 LipoDetection: |
126 /* prologue: frame size=0 */ |
127 006a 1F93 push r17 |
128 006c CF93 push r28 |
129 006e DF93 push r29 |
130 /* prologue end (size=3) */ |
131 0070 182F mov r17,r24 |
132 0072 8823 tst r24 |
133 0074 89F0 breq .L7 |
134 0076 80E0 ldi r24,lo8(__c.12) |
135 0078 90E0 ldi r25,hi8(__c.12) |
136 007a 9F93 push r25 |
137 007c 8F93 push r24 |
138 007e 80E0 ldi r24,lo8(pm(uart_putchar)) |
139 0080 90E0 ldi r25,hi8(pm(uart_putchar)) |
140 0082 9F93 push r25 |
141 0084 8F93 push r24 |
142 0086 E091 0000 lds r30,_printf_P |
143 008a F091 0000 lds r31,(_printf_P)+1 |
144 008e 0995 icall |
145 0090 0F90 pop __tmp_reg__ |
146 0092 0F90 pop __tmp_reg__ |
147 0094 0F90 pop __tmp_reg__ |
148 0096 0F90 pop __tmp_reg__ |
149 .L7: |
150 0098 8091 0000 lds r24,EE_Parameter+36 |
151 009c 8233 cpi r24,lo8(50) |
152 009e 08F0 brlo .+2 |
153 00a0 44C0 rjmp .L8 |
154 00a2 84EF ldi r24,lo8(500) |
155 00a4 91E0 ldi r25,hi8(500) |
156 00a6 0E94 0000 call SetDelay |
157 00aa EC01 movw r28,r24 |
158 00ac 1123 tst r17 |
159 00ae 29F0 breq .L9 |
160 .L10: |
161 00b0 CE01 movw r24,r28 |
162 00b2 0E94 0000 call CheckDelay |
163 00b6 8823 tst r24 |
164 00b8 D9F3 breq .L10 |
165 .L9: |
166 00ba C2E0 ldi r28,lo8(2) |
167 00bc D0E0 ldi r29,hi8(2) |
168 00be 26E5 ldi r18,lo8(86) |
169 00c0 30E0 ldi r19,hi8(86) |
170 .L17: |
171 00c2 8091 0000 lds r24,UBat |
172 00c6 9091 0000 lds r25,(UBat)+1 |
173 00ca 8217 cp r24,r18 |
174 00cc 9307 cpc r25,r19 |
175 00ce 30F0 brlo .L14 |
176 00d0 2196 adiw r28,1 |
177 00d2 255D subi r18,lo8(-(43)) |
178 00d4 3F4F sbci r19,hi8(-(43)) |
179 00d6 C730 cpi r28,7 |
180 00d8 D105 cpc r29,__zero_reg__ |
181 00da 98F3 brlo .L17 |
182 .L14: |
183 00dc 8091 0000 lds r24,EE_Parameter+36 |
184 00e0 9927 clr r25 |
185 00e2 C89F mul r28,r24 |
186 00e4 9001 movw r18,r0 |
187 00e6 C99F mul r28,r25 |
188 00e8 300D add r19,r0 |
189 00ea D89F mul r29,r24 |
190 00ec 300D add r19,r0 |
191 00ee 1124 clr r1 |
192 00f0 2093 0000 sts BattLowVoltageWarning,r18 |
193 00f4 1123 tst r17 |
194 00f6 D9F0 breq .L19 |
195 00f8 68EC ldi r22,lo8(200) |
196 00fa 70E0 ldi r23,hi8(200) |
197 00fc 8C2F mov r24,r28 |
198 00fe 0E94 0000 call Piep |
199 0102 DF93 push r29 |
200 0104 CF93 push r28 |
201 0106 80E0 ldi r24,lo8(__c.13) |
202 0108 90E0 ldi r25,hi8(__c.13) |
203 010a 9F93 push r25 |
204 010c 8F93 push r24 |
205 010e 80E0 ldi r24,lo8(pm(uart_putchar)) |
206 0110 90E0 ldi r25,hi8(pm(uart_putchar)) |
207 0112 9F93 push r25 |
208 0114 8F93 push r24 |
209 0116 E091 0000 lds r30,_printf_P |
210 011a F091 0000 lds r31,(_printf_P)+1 |
211 011e 0995 icall |
212 0120 8DB7 in r24,__SP_L__ |
213 0122 9EB7 in r25,__SP_H__ |
214 0124 0696 adiw r24,6 |
215 0126 8DBF out __SP_L__,r24 |
216 0128 02C0 rjmp .L19 |
217 .L8: |
218 012a 8093 0000 sts BattLowVoltageWarning,r24 |
219 .L19: |
220 012e 1123 tst r17 |
221 0130 11F1 breq .L6 |
222 0132 8091 0000 lds r24,BattLowVoltageWarning |
223 0136 6AE0 ldi r22,lo8(10) |
224 0138 0E94 0000 call __udivmodqi4 |
225 013c 892F mov r24,r25 |
226 013e 9927 clr r25 |
227 0140 9F93 push r25 |
228 0142 8F93 push r24 |
229 0144 8091 0000 lds r24,BattLowVoltageWarning |
230 0148 0E94 0000 call __udivmodqi4 |
231 014c 9927 clr r25 |
232 014e 9F93 push r25 |
233 0150 8F93 push r24 |
234 0152 80E0 ldi r24,lo8(__c.14) |
235 0154 90E0 ldi r25,hi8(__c.14) |
236 0156 9F93 push r25 |
237 0158 8F93 push r24 |
238 015a 80E0 ldi r24,lo8(pm(uart_putchar)) |
239 015c 90E0 ldi r25,hi8(pm(uart_putchar)) |
240 015e 9F93 push r25 |
241 0160 8F93 push r24 |
242 0162 E091 0000 lds r30,_printf_P |
243 0166 F091 0000 lds r31,(_printf_P)+1 |
244 016a 0995 icall |
245 016c 2DB7 in r18,__SP_L__ |
246 016e 3EB7 in r19,__SP_H__ |
247 0170 285F subi r18,lo8(-(8)) |
248 0172 3F4F sbci r19,hi8(-(8)) |
249 0174 2DBF out __SP_L__,r18 |
250 .L6: |
251 /* epilogue: frame size=0 */ |
252 0176 DF91 pop r29 |
253 0178 CF91 pop r28 |
254 017a 1F91 pop r17 |
255 017c 0895 ret |
256 /* epilogue end (size=4) */ |
257 /* function LipoDetection size 138 (131) */ |
259 .section .progmem.data |
262 __c.0: |
263 002d 0A0D 466F .string "\n\rFound BL-Ctrl: " |
263 756E 6420 |
263 424C 2D43 |
263 7472 6C3A |
263 2000 |
266 __c.1: |
267 003f 2564 00 .string "%d" |
270 __c.2: |
271 0042 0A0D 0A0D .string "\n\r\n\r!! MISSING BL-CTRL: %d !!" |
271 2121 204D |
271 4953 5349 |
271 4E47 2042 |
271 4C2D 4354 |
274 __c.3: |
275 0060 0A0D 3D3D .string "\n\r===================================" |
275 3D3D 3D3D |
275 3D3D 3D3D |
275 3D3D 3D3D |
275 3D3D 3D3D |
278 __c.4: |
279 0086 0A0D 4361 .string "\n\rCalibrating pressure sensor.." |
279 6C69 6272 |
279 6174 696E |
279 6720 7072 |
279 6573 7375 |
282 __c.5: |
283 00a6 4F4B 0A0D .string "OK\n\r" |
283 00 |
286 __c.6: |
287 00ab 0A0D 466C .string "\n\rFlight-time %u min Total:%u min" |
287 6967 6874 |
287 2D74 696D |
287 6520 2575 |
287 206D 696E |
290 __c.7: |
291 00ce 0A0D 436F .string "\n\rControl: " |
291 6E74 726F |
291 6C3A 2000 |
294 __c.8: |
295 00da 4865 6164 .string "HeadingHold" |
295 696E 6748 |
295 6F6C 6400 |
298 __c.9: |
299 00e6 4E6F 726D .string "Normal (ACC-Mode)" |
299 616C 2028 |
299 4143 432D |
299 4D6F 6465 |
299 2900 |
302 __c.10: |
303 00f8 0A0D 3D3D .string "\n\r===================================\n\r" |
303 3D3D 3D3D |
303 3D3D 3D3D |
303 3D3D 3D3D |
303 3D3D 3D3D |
304 .lcomm second.11,1 |
305 .text |
306 .global main |
308 main: |
309 /* prologue: frame size=0 */ |
310 017e C0E0 ldi r28,lo8(__stack - 0) |
311 0180 D0E0 ldi r29,hi8(__stack - 0) |
312 0182 DEBF out __SP_H__,r29 |
313 0184 CDBF out __SP_L__,r28 |
314 /* prologue end (size=4) */ |
315 0186 8824 clr r8 |
316 0188 9924 clr r9 |
317 018a 14B8 out 36-0x20,__zero_reg__ |
318 018c 15B8 out 37-0x20,__zero_reg__ |
319 018e 07EE ldi r16,lo8(999) |
320 0190 13E0 ldi r17,hi8(999) |
321 .L26: |
322 0192 0253 subi r16,lo8(-(-50)) |
323 0194 1040 sbci r17,hi8(-(-50)) |
324 0196 17FF sbrs r17,7 |
325 0198 FCCF rjmp .L26 |
326 019a 189B sbis 35-0x20,0 |
327 019c 06C0 rjmp .L27 |
328 019e 199B sbis 35-0x20,1 |
329 01a0 02C0 rjmp .L28 |
330 01a2 8DE0 ldi r24,lo8(13) |
331 01a4 07C0 rjmp .L228 |
332 .L28: |
333 01a6 8BE0 ldi r24,lo8(11) |
334 01a8 05C0 rjmp .L228 |
335 .L27: |
336 01aa 199B sbis 35-0x20,1 |
337 01ac 02C0 rjmp .L31 |
338 01ae 84E1 ldi r24,lo8(20) |
339 01b0 01C0 rjmp .L228 |
340 .L31: |
341 01b2 8AE0 ldi r24,lo8(10) |
342 .L228: |
343 01b4 8093 0000 sts PlatinenVersion,r24 |
344 01b8 81E8 ldi r24,lo8(-127) |
345 01ba 87B9 out 39-0x20,r24 |
346 01bc 3E9A sbi 39-0x20,6 |
347 01be 8FEF ldi r24,lo8(-1) |
348 01c0 88B9 out 40-0x20,r24 |
349 01c2 8BE1 ldi r24,lo8(27) |
350 01c4 84B9 out 36-0x20,r24 |
351 01c6 81E0 ldi r24,lo8(1) |
352 01c8 85B9 out 37-0x20,r24 |
353 01ca 8EE3 ldi r24,lo8(62) |
354 01cc 8AB9 out 42-0x20,r24 |
355 01ce 87E4 ldi r24,lo8(71) |
356 01d0 8BB9 out 43-0x20,r24 |
357 01d2 469A sbi 40-0x20,6 |
358 01d4 84B7 in r24,84-0x20 |
359 01d6 877F andi r24,lo8(-9) |
360 01d8 84BF out 84-0x20,r24 |
361 01da 8091 6000 lds r24,96 |
362 01de 8861 ori r24,lo8(24) |
363 01e0 8093 6000 sts 96,r24 |
364 01e4 1092 6000 sts 96,__zero_reg__ |
365 01e8 84EC ldi r24,lo8(2500) |
366 01ea 99E0 ldi r25,hi8(2500) |
367 01ec 9093 0000 sts (beeptime)+1,r25 |
368 01f0 8093 0000 sts beeptime,r24 |
369 01f4 1092 0000 sts (StickGier)+1,__zero_reg__ |
370 01f8 1092 0000 sts StickGier,__zero_reg__ |
371 01fc 1092 0000 sts (PPM_in+4)+1,__zero_reg__ |
372 0200 1092 0000 sts PPM_in+4,__zero_reg__ |
373 0204 1092 0000 sts (StickRoll)+1,__zero_reg__ |
374 0208 1092 0000 sts StickRoll,__zero_reg__ |
375 020c 1092 0000 sts (StickNick)+1,__zero_reg__ |
376 0210 1092 0000 sts StickNick,__zero_reg__ |
377 0214 2091 0000 lds r18,PlatinenVersion |
378 0218 2431 cpi r18,lo8(20) |
379 021a 28F0 brlo .L33 |
380 021c 84EC ldi r24,lo8(1220) |
381 021e 94E0 ldi r25,hi8(1220) |
382 0220 A0E0 ldi r26,hlo8(1220) |
383 0222 B0E0 ldi r27,hhi8(1220) |
384 0224 04C0 rjmp .L229 |
385 .L33: |
386 0226 8BE0 ldi r24,lo8(1291) |
387 0228 95E0 ldi r25,hi8(1291) |
388 022a A0E0 ldi r26,hlo8(1291) |
389 022c B0E0 ldi r27,hhi8(1291) |
390 .L229: |
391 022e 8093 0000 sts GIER_GRAD_FAKTOR,r24 |
392 0232 9093 0000 sts (GIER_GRAD_FAKTOR)+1,r25 |
393 0236 A093 0000 sts (GIER_GRAD_FAKTOR)+2,r26 |
394 023a B093 0000 sts (GIER_GRAD_FAKTOR)+3,r27 |
395 023e 2A30 cpi r18,lo8(10) |
396 0240 11F0 breq .L36 |
397 0242 2431 cpi r18,lo8(20) |
398 0244 10F0 brlo .L35 |
399 .L36: |
400 0246 2898 cbi 37-0x20,0 |
401 0248 01C0 rjmp .L37 |
402 .L35: |
403 024a 289A sbi 37-0x20,0 |
404 .L37: |
405 024c 0E94 0000 call Timer_Init |
406 0250 0E94 0000 call TIMER2_Init |
407 0254 0E94 0000 call UART_Init |
408 0258 0E94 0000 call rc_sum_init |
409 025c 0E94 0000 call ADC_Init |
410 0260 0E94 0000 call I2C_Init |
411 0264 0E94 0000 call SPI_MasterInit |
412 0268 0E94 0000 call Capacity_Init |
413 026c 0E94 0000 call LIBFC_Init |
414 0270 8091 0000 lds r24,PlatinenVersion |
415 0274 8C30 cpi r24,lo8(12) |
416 0276 10F4 brsh .L38 |
417 0278 299A sbi 37-0x20,1 |
418 027a 01C0 rjmp .L39 |
419 .L38: |
420 027c 2998 cbi 37-0x20,1 |
421 .L39: |
422 /* #APP */ |
423 027e 7894 sei |
424 /* #NOAPP */ |
425 0280 0E94 0000 call ParamSet_Init |
426 0284 8091 0000 lds r24,BLFlags |
427 0288 8260 ori r24,lo8(2) |
428 028a 8093 0000 sts BLFlags,r24 |
429 028e 1092 0000 sts motor_read,__zero_reg__ |
430 0292 0E94 0000 call SendMotorData |
431 0296 84EF ldi r24,lo8(500) |
432 0298 91E0 ldi r25,hi8(500) |
433 029a 0E94 0000 call SetDelay |
434 029e 8C01 movw r16,r24 |
435 .L40: |
436 02a0 8091 0000 lds r24,BLFlags |
437 02a4 80FD sbrc r24,0 |
438 02a6 05C0 rjmp .L41 |
439 02a8 C801 movw r24,r16 |
440 02aa 0E94 0000 call CheckDelay |
441 02ae 8823 tst r24 |
442 02b0 B9F3 breq .L40 |
443 .L41: |
444 02b2 80E0 ldi r24,lo8(__c.0) |
445 02b4 90E0 ldi r25,hi8(__c.0) |
446 02b6 9F93 push r25 |
447 02b8 8F93 push r24 |
448 02ba B0E0 ldi r27,lo8(pm(uart_putchar)) |
449 02bc AB2E mov r10,r27 |
450 02be B0E0 ldi r27,hi8(pm(uart_putchar)) |
451 02c0 BB2E mov r11,r27 |
452 02c2 BF92 push r11 |
453 02c4 AF92 push r10 |
454 02c6 E091 0000 lds r30,_printf_P |
455 02ca F091 0000 lds r31,(_printf_P)+1 |
456 02ce 0995 icall |
457 02d0 80EA ldi r24,lo8(4000) |
458 02d2 9FE0 ldi r25,hi8(4000) |
459 02d4 0E94 0000 call SetDelay |
460 02d8 8C01 movw r16,r24 |
461 02da C0E0 ldi r28,lo8(0) |
462 02dc D0E0 ldi r29,hi8(0) |
463 02de 0F90 pop __tmp_reg__ |
464 02e0 0F90 pop __tmp_reg__ |
465 02e2 0F90 pop __tmp_reg__ |
466 02e4 0F90 pop __tmp_reg__ |
467 02e6 A0E0 ldi r26,lo8(Motor+3) |
468 02e8 EA2E mov r14,r26 |
469 02ea A0E0 ldi r26,hi8(Motor+3) |
470 02ec FA2E mov r15,r26 |
471 02ee F0E0 ldi r31,lo8(Mixer+13) |
472 02f0 CF2E mov r12,r31 |
473 02f2 F0E0 ldi r31,hi8(Mixer+13) |
474 02f4 DF2E mov r13,r31 |
475 .L57: |
476 02f6 0E94 0000 call SendMotorData |
477 .L46: |
478 02fa 8091 0000 lds r24,BLFlags |
479 02fe 80FD sbrc r24,0 |
480 0300 05C0 rjmp .L47 |
481 0302 C801 movw r24,r16 |
482 0304 0E94 0000 call CheckDelay |
483 0308 8823 tst r24 |
484 030a B9F3 breq .L46 |
485 .L47: |
486 030c F601 movw r30,r12 |
487 030e 8081 ld r24,Z |
488 0310 1816 cp __zero_reg__,r24 |
489 0312 ACF4 brge .L49 |
490 0314 0BC0 rjmp .L233 |
491 .L55: |
492 0316 0E94 0000 call SendMotorData |
493 .L52: |
494 031a 8091 0000 lds r24,BLFlags |
495 031e 80FD sbrc r24,0 |
496 0320 05C0 rjmp .L233 |
497 0322 C801 movw r24,r16 |
498 0324 0E94 0000 call CheckDelay |
499 0328 8823 tst r24 |
500 032a B9F3 breq .L52 |
501 .L233: |
502 032c C801 movw r24,r16 |
503 032e 0E94 0000 call CheckDelay |
504 0332 8823 tst r24 |
505 0334 21F4 brne .L49 |
506 0336 F701 movw r30,r14 |
507 0338 8081 ld r24,Z |
508 033a 8823 tst r24 |
509 033c 64F7 brge .L55 |
510 .L49: |
511 033e F701 movw r30,r14 |
512 0340 8081 ld r24,Z |
513 0342 87FF sbrs r24,7 |
514 0344 18C0 rjmp .L45 |
515 0346 2196 adiw r28,1 |
516 0348 DF93 push r29 |
517 034a CF93 push r28 |
518 034c 2197 sbiw r28,1 |
519 034e 80E0 ldi r24,lo8(__c.1) |
520 0350 90E0 ldi r25,hi8(__c.1) |
521 0352 9F93 push r25 |
522 0354 8F93 push r24 |
523 0356 BF92 push r11 |
524 0358 AF92 push r10 |
525 035a E091 0000 lds r30,_printf_P |
526 035e F091 0000 lds r31,(_printf_P)+1 |
527 0362 0995 icall |
528 0364 8091 0000 lds r24,FoundMotors |
529 0368 8F5F subi r24,lo8(-(1)) |
530 036a 8093 0000 sts FoundMotors,r24 |
531 036e 8DB7 in r24,__SP_L__ |
532 0370 9EB7 in r25,__SP_H__ |
533 0372 0696 adiw r24,6 |
534 0374 8DBF out __SP_L__,r24 |
535 .L45: |
536 0376 2196 adiw r28,1 |
537 0378 E4E0 ldi r30,lo8(4) |
538 037a F0E0 ldi r31,hi8(4) |
539 037c CE0E add r12,r30 |
540 037e DF1E adc r13,r31 |
541 0380 88E0 ldi r24,lo8(8) |
542 0382 90E0 ldi r25,hi8(8) |
543 0384 E80E add r14,r24 |
544 0386 F91E adc r15,r25 |
545 0388 CC30 cpi r28,12 |
546 038a D105 cpc r29,__zero_reg__ |
547 038c 08F4 brsh .+2 |
548 038e B3CF rjmp .L57 |
549 0390 C0E0 ldi r28,lo8(0) |
550 0392 D0E0 ldi r29,hi8(0) |
551 0394 00E0 ldi r16,lo8(Motor) |
552 0396 10E0 ldi r17,hi8(Motor) |
553 0398 E0E0 ldi r30,lo8(Mixer+13) |
554 039a EE2E mov r14,r30 |
555 039c E0E0 ldi r30,hi8(Mixer+13) |
556 039e FE2E mov r15,r30 |
557 .L62: |
558 03a0 F801 movw r30,r16 |
559 03a2 8381 ldd r24,Z+3 |
560 03a4 87FD sbrc r24,7 |
561 03a6 1CC0 rjmp .L61 |
562 03a8 F701 movw r30,r14 |
563 03aa 8081 ld r24,Z |
564 03ac 1816 cp __zero_reg__,r24 |
565 03ae C4F4 brge .L61 |
566 03b0 2196 adiw r28,1 |
567 03b2 DF93 push r29 |
568 03b4 CF93 push r28 |
569 03b6 2197 sbiw r28,1 |
570 03b8 80E0 ldi r24,lo8(__c.2) |
571 03ba 90E0 ldi r25,hi8(__c.2) |
572 03bc 9F93 push r25 |
573 03be 8F93 push r24 |
574 03c0 80E0 ldi r24,lo8(pm(uart_putchar)) |
575 03c2 90E0 ldi r25,hi8(pm(uart_putchar)) |
576 03c4 9F93 push r25 |
577 03c6 8F93 push r24 |
578 03c8 E091 0000 lds r30,_printf_P |
579 03cc F091 0000 lds r31,(_printf_P)+1 |
580 03d0 0995 icall |
581 03d2 82E0 ldi r24,lo8(2) |
582 03d4 8093 0000 sts ServoActive,r24 |
583 03d8 8DB7 in r24,__SP_L__ |
584 03da 9EB7 in r25,__SP_H__ |
585 03dc 0696 adiw r24,6 |
586 03de 8DBF out __SP_L__,r24 |
587 .L61: |
588 03e0 F801 movw r30,r16 |
589 03e2 8381 ldd r24,Z+3 |
590 03e4 8078 andi r24,lo8(-128) |
591 03e6 8383 std Z+3,r24 |
592 03e8 2196 adiw r28,1 |
593 03ea 84E0 ldi r24,lo8(4) |
594 03ec 90E0 ldi r25,hi8(4) |
595 03ee E80E add r14,r24 |
596 03f0 F91E adc r15,r25 |
597 03f2 085F subi r16,lo8(-(8)) |
598 03f4 1F4F sbci r17,hi8(-(8)) |
599 03f6 CC30 cpi r28,12 |
600 03f8 D105 cpc r29,__zero_reg__ |
601 03fa 90F2 brlo .L62 |
602 03fc 80E0 ldi r24,lo8(__c.3) |
603 03fe 90E0 ldi r25,hi8(__c.3) |
604 0400 9F93 push r25 |
605 0402 8F93 push r24 |
606 0404 C0E0 ldi r28,lo8(pm(uart_putchar)) |
607 0406 D0E0 ldi r29,hi8(pm(uart_putchar)) |
608 0408 DF93 push r29 |
609 040a CF93 push r28 |
610 040c E091 0000 lds r30,_printf_P |
611 0410 F091 0000 lds r31,(_printf_P)+1 |
612 0414 0995 icall |
613 0416 9091 0000 lds r25,RequiredMotors |
614 041a 8091 0000 lds r24,FoundMotors |
615 041e 0F90 pop __tmp_reg__ |
616 0420 0F90 pop __tmp_reg__ |
617 0422 0F90 pop __tmp_reg__ |
618 0424 0F90 pop __tmp_reg__ |
619 0426 9817 cp r25,r24 |
620 0428 28F4 brsh .L63 |
621 042a 8091 0000 lds r24,VersionInfo+6 |
622 042e 8061 ori r24,lo8(16) |
623 0430 8093 0000 sts VersionInfo+6,r24 |
624 .L63: |
625 0434 80E0 ldi r24,lo8(__c.4) |
626 0436 90E0 ldi r25,hi8(__c.4) |
627 0438 9F93 push r25 |
628 043a 8F93 push r24 |
629 043c DF93 push r29 |
630 043e CF93 push r28 |
631 0440 E091 0000 lds r30,_printf_P |
632 0444 F091 0000 lds r31,(_printf_P)+1 |
633 0448 0995 icall |
634 044a 88EE ldi r24,lo8(1000) |
635 044c 93E0 ldi r25,hi8(1000) |
636 044e 0E94 0000 call SetDelay |
637 0452 8C01 movw r16,r24 |
638 0454 0E94 0000 call SucheLuftruckOffset |
639 0458 0F90 pop __tmp_reg__ |
640 045a 0F90 pop __tmp_reg__ |
641 045c 0F90 pop __tmp_reg__ |
642 045e 0F90 pop __tmp_reg__ |
643 .L64: |
644 0460 C801 movw r24,r16 |
645 0462 0E94 0000 call CheckDelay |
646 0466 8823 tst r24 |
647 0468 D9F3 breq .L64 |
648 046a 80E0 ldi r24,lo8(__c.5) |
649 046c 90E0 ldi r25,hi8(__c.5) |
650 046e 9F93 push r25 |
651 0470 8F93 push r24 |
652 0472 DF93 push r29 |
653 0474 CF93 push r28 |
654 0476 E091 0000 lds r30,_printf_P |
655 047a F091 0000 lds r31,(_printf_P)+1 |
656 047e 0995 icall |
657 0480 80E0 ldi r24,lo8(0) |
658 0482 0E94 0000 call SetNeutral |
659 0486 8091 0000 lds r24,PlatinenVersion |
660 048a 0F90 pop __tmp_reg__ |
661 048c 0F90 pop __tmp_reg__ |
662 048e 0F90 pop __tmp_reg__ |
663 0490 0F90 pop __tmp_reg__ |
664 0492 8A30 cpi r24,lo8(10) |
665 0494 11F0 breq .L68 |
666 0496 8431 cpi r24,lo8(20) |
667 0498 10F0 brlo .L67 |
668 .L68: |
669 049a 2898 cbi 37-0x20,0 |
670 049c 01C0 rjmp .L69 |
671 .L67: |
672 049e 289A sbi 37-0x20,0 |
673 .L69: |
674 04a0 80ED ldi r24,lo8(2000) |
675 04a2 97E0 ldi r25,hi8(2000) |
676 04a4 9093 0000 sts (beeptime)+1,r25 |
677 04a8 8093 0000 sts beeptime,r24 |
678 04ac 85E5 ldi r24,lo8(85) |
679 04ae 8093 0000 sts ExternControl,r24 |
680 04b2 8EE0 ldi r24,lo8(14) |
681 04b4 90E0 ldi r25,hi8(14) |
682 04b6 0E94 0000 call GetParamByte |
683 04ba 9927 clr r25 |
684 04bc 182F mov r17,r24 |
685 04be 0027 clr r16 |
686 04c0 8FE0 ldi r24,lo8(15) |
687 04c2 90E0 ldi r25,hi8(15) |
688 04c4 0E94 0000 call GetParamByte |
689 04c8 080F add r16,r24 |
690 04ca 111D adc r17,__zero_reg__ |
691 04cc 1093 0000 sts (FlugMinuten)+1,r17 |
692 04d0 0093 0000 sts FlugMinuten,r16 |
693 04d4 8AE0 ldi r24,lo8(10) |
694 04d6 90E0 ldi r25,hi8(10) |
695 04d8 0E94 0000 call GetParamByte |
696 04dc 9927 clr r25 |
697 04de 182F mov r17,r24 |
698 04e0 0027 clr r16 |
699 04e2 8BE0 ldi r24,lo8(11) |
700 04e4 90E0 ldi r25,hi8(11) |
701 04e6 0E94 0000 call GetParamByte |
702 04ea 080F add r16,r24 |
703 04ec 111D adc r17,__zero_reg__ |
704 04ee 1093 0000 sts (FlugMinutenGesamt)+1,r17 |
705 04f2 0093 0000 sts FlugMinutenGesamt,r16 |
706 04f6 0F5F subi r16,lo8(-1) |
707 04f8 1F4F sbci r17,hi8(-1) |
708 04fa 39F0 breq .L71 |
709 04fc 8091 0000 lds r24,FlugMinuten |
710 0500 9091 0000 lds r25,(FlugMinuten)+1 |
711 0504 8F5F subi r24,lo8(-1) |
712 0506 9F4F sbci r25,hi8(-1) |
713 0508 41F4 brne .L70 |
714 .L71: |
715 050a 1092 0000 sts (FlugMinuten)+1,__zero_reg__ |
716 050e 1092 0000 sts FlugMinuten,__zero_reg__ |
717 0512 1092 0000 sts (FlugMinutenGesamt)+1,__zero_reg__ |
718 0516 1092 0000 sts FlugMinutenGesamt,__zero_reg__ |
719 .L70: |
720 051a 8091 0000 lds r24,FlugMinutenGesamt |
721 051e 9091 0000 lds r25,(FlugMinutenGesamt)+1 |
722 0522 9F93 push r25 |
723 0524 8F93 push r24 |
724 0526 8091 0000 lds r24,FlugMinuten |
725 052a 9091 0000 lds r25,(FlugMinuten)+1 |
726 052e 9F93 push r25 |
727 0530 8F93 push r24 |
728 0532 80E0 ldi r24,lo8(__c.6) |
729 0534 90E0 ldi r25,hi8(__c.6) |
730 0536 9F93 push r25 |
731 0538 8F93 push r24 |
732 053a DF93 push r29 |
733 053c CF93 push r28 |
734 053e E091 0000 lds r30,_printf_P |
735 0542 F091 0000 lds r31,(_printf_P)+1 |
736 0546 0995 icall |
737 0548 8DB7 in r24,__SP_L__ |
738 054a 9EB7 in r25,__SP_H__ |
739 054c 0896 adiw r24,8 |
740 054e 8DBF out __SP_L__,r24 |
741 0550 80E0 ldi r24,lo8(__c.7) |
742 0552 90E0 ldi r25,hi8(__c.7) |
743 0554 9F93 push r25 |
744 0556 8F93 push r24 |
745 0558 DF93 push r29 |
746 055a CF93 push r28 |
747 055c E091 0000 lds r30,_printf_P |
748 0560 F091 0000 lds r31,(_printf_P)+1 |
749 0564 0995 icall |
750 0566 8091 0000 lds r24,EE_Parameter+13 |
751 056a 0F90 pop __tmp_reg__ |
752 056c 0F90 pop __tmp_reg__ |
753 056e 0F90 pop __tmp_reg__ |
754 0570 0F90 pop __tmp_reg__ |
755 0572 E091 0000 lds r30,_printf_P |
756 0576 F091 0000 lds r31,(_printf_P)+1 |
757 057a 82FF sbrs r24,2 |
758 057c 07C0 rjmp .L72 |
759 057e 80E0 ldi r24,lo8(__c.8) |
760 0580 90E0 ldi r25,hi8(__c.8) |
761 0582 9F93 push r25 |
762 0584 8F93 push r24 |
763 0586 DF93 push r29 |
764 0588 CF93 push r28 |
765 058a 08C0 rjmp .L230 |
766 .L72: |
767 058c 80E0 ldi r24,lo8(__c.9) |
768 058e 90E0 ldi r25,hi8(__c.9) |
769 0590 9F93 push r25 |
770 0592 8F93 push r24 |
771 0594 80E0 ldi r24,lo8(pm(uart_putchar)) |
772 0596 90E0 ldi r25,hi8(pm(uart_putchar)) |
773 0598 9F93 push r25 |
774 059a 8F93 push r24 |
775 .L230: |
776 059c 0995 icall |
777 059e 0F90 pop __tmp_reg__ |
778 05a0 0F90 pop __tmp_reg__ |
779 05a2 0F90 pop __tmp_reg__ |
780 05a4 0F90 pop __tmp_reg__ |
781 05a6 0E94 0000 call LcdClear |
782 05aa 88E8 ldi r24,lo8(5000) |
783 05ac 93E1 ldi r25,hi8(5000) |
784 05ae 9093 0000 sts (I2CTimeout)+1,r25 |
785 05b2 8093 0000 sts I2CTimeout,r24 |
786 05b6 81E0 ldi r24,lo8(1) |
787 05b8 8093 0000 sts WinkelOut+7,r24 |
788 05bc 0E94 0000 call LipoDetection |
789 05c0 8091 0000 lds r24,EE_Parameter+39 |
790 05c4 0E94 0000 call LIBFC_ReceiverInit |
791 05c8 80E0 ldi r24,lo8(__c.10) |
792 05ca 90E0 ldi r25,hi8(__c.10) |
793 05cc 9F93 push r25 |
794 05ce 8F93 push r24 |
795 05d0 DF93 push r29 |
796 05d2 CF93 push r28 |
797 05d4 E091 0000 lds r30,_printf_P |
798 05d8 F091 0000 lds r31,(_printf_P)+1 |
799 05dc 0995 icall |
800 05de 80ED ldi r24,lo8(2000) |
801 05e0 97E0 ldi r25,hi8(2000) |
802 05e2 0E94 0000 call SetDelay |
803 05e6 8C01 movw r16,r24 |
804 05e8 8AEF ldi r24,lo8(250) |
805 05ea 90E0 ldi r25,hi8(250) |
806 05ec 0E94 0000 call SetDelay |
807 05f0 EC01 movw r28,r24 |
808 05f2 83E0 ldi r24,lo8(3) |
809 05f4 8093 0000 sts DebugOut,r24 |
810 05f8 0F90 pop __tmp_reg__ |
811 05fa 0F90 pop __tmp_reg__ |
812 05fc 0F90 pop __tmp_reg__ |
813 05fe 0F90 pop __tmp_reg__ |
814 .L234: |
815 0600 CE01 movw r24,r28 |
816 0602 0E94 0000 call CheckDelay |
817 0606 8823 tst r24 |
818 0608 39F0 breq .L76 |
819 060a 84E6 ldi r24,lo8(100) |
820 060c 90E0 ldi r25,hi8(100) |
821 060e 0E94 0000 call SetDelay |
822 0612 EC01 movw r28,r24 |
823 0614 0E94 0000 call LIBFC_Polling |
824 .L76: |
825 0618 8091 0000 lds r24,UpdateMotor |
826 061c 8823 tst r24 |
827 061e 09F4 brne .+2 |
828 0620 DFC1 rjmp .L77 |
829 0622 8091 0000 lds r24,AdReady |
830 0626 8823 tst r24 |
831 0628 09F4 brne .+2 |
832 062a DAC1 rjmp .L77 |
833 062c 1092 0000 sts UpdateMotor,__zero_reg__ |
834 0630 8091 0000 lds r24,WinkelOut+6 |
835 0634 8823 tst r24 |
836 0636 19F0 breq .L78 |
837 0638 0E94 0000 call CalMk3Mag |
838 063c 02C0 rjmp .L79 |
839 .L78: |
840 063e 0E94 0000 call MotorRegler |
841 .L79: |
842 0642 0E94 0000 call SendMotorData |
843 0646 2091 0000 lds r18,PlatinenVersion |
844 064a 2A30 cpi r18,lo8(10) |
845 064c 11F0 breq .L81 |
846 064e 2431 cpi r18,lo8(20) |
847 0650 10F0 brlo .L80 |
848 .L81: |
849 0652 2898 cbi 37-0x20,0 |
850 0654 01C0 rjmp .L82 |
851 .L80: |
852 0656 289A sbi 37-0x20,0 |
853 .L82: |
854 0658 8091 0000 lds r24,SenderOkay |
855 065c 9091 0000 lds r25,VersionInfo+6 |
856 0660 8823 tst r24 |
857 0662 39F0 breq .L83 |
858 0664 8091 0000 lds r24,SenderOkay |
859 0668 8150 subi r24,lo8(-(-1)) |
860 066a 8093 0000 sts SenderOkay,r24 |
861 066e 977F andi r25,lo8(-9) |
862 0670 0AC0 rjmp .L231 |
863 .L83: |
864 0672 8091 6F00 lds r24,111 |
865 0676 8062 ori r24,lo8(32) |
866 0678 8093 6F00 sts 111,r24 |
867 067c 1092 0000 sts (PPM_in)+1,__zero_reg__ |
868 0680 1092 0000 sts PPM_in,__zero_reg__ |
869 0684 9860 ori r25,lo8(8) |
870 .L231: |
871 0686 9093 0000 sts VersionInfo+6,r25 |
872 068a 8091 0000 lds r24,I2CTimeout |
873 068e 9091 0000 lds r25,(I2CTimeout)+1 |
874 0692 0197 sbiw r24,1 |
875 0694 9093 0000 sts (I2CTimeout)+1,r25 |
876 0698 8093 0000 sts I2CTimeout,r24 |
877 069c 8091 0000 lds r24,I2CTimeout |
878 06a0 9091 0000 lds r25,(I2CTimeout)+1 |
879 06a4 892B or r24,r25 |
880 06a6 29F0 breq .L86 |
881 06a8 8091 0000 lds r24,MissingMotor |
882 06ac 8823 tst r24 |
883 06ae 09F4 brne .+2 |
884 06b0 3EC0 rjmp .L85 |
885 .L86: |
886 06b2 8091 0000 lds r24,I2CTimeout |
887 06b6 9091 0000 lds r25,(I2CTimeout)+1 |
888 06ba 892B or r24,r25 |
889 06bc 01F5 brne .L87 |
890 06be 0E94 0000 call I2C_Reset |
891 06c2 85E0 ldi r24,lo8(5) |
892 06c4 90E0 ldi r25,hi8(5) |
893 06c6 9093 0000 sts (I2CTimeout)+1,r25 |
894 06ca 8093 0000 sts I2CTimeout,r24 |
895 06ce 8091 0000 lds r24,DebugOut+58 |
896 06d2 9091 0000 lds r25,(DebugOut+58)+1 |
897 06d6 0196 adiw r24,1 |
898 06d8 9093 0000 sts (DebugOut+58)+1,r25 |
899 06dc 8093 0000 sts DebugOut+58,r24 |
900 06e0 8091 0000 lds r24,FCFlags |
901 06e4 8068 ori r24,lo8(-128) |
902 06e6 8093 0000 sts FCFlags,r24 |
903 06ea 8091 0000 lds r24,VersionInfo+6 |
904 06ee 8160 ori r24,lo8(1) |
905 06f0 8093 0000 sts VersionInfo+6,r24 |
906 06f4 8091 0000 lds r24,DebugOut+1 |
907 06f8 8260 ori r24,lo8(2) |
908 06fa 8093 0000 sts DebugOut+1,r24 |
909 .L87: |
910 06fe 8091 0000 lds r24,BeepMuster |
911 0702 9091 0000 lds r25,(BeepMuster)+1 |
912 0706 8F5F subi r24,lo8(-1) |
913 0708 9F4F sbci r25,hi8(-1) |
914 070a 19F5 brne .L89 |
915 070c 8091 0000 lds r24,MotorenEin |
916 0710 8823 tst r24 |
917 0712 F9F0 breq .L89 |
918 0714 80E1 ldi r24,lo8(10000) |
919 0716 97E2 ldi r25,hi8(10000) |
920 0718 9093 0000 sts (beeptime)+1,r25 |
921 071c 8093 0000 sts beeptime,r24 |
922 0720 80E8 ldi r24,lo8(128) |
923 0722 90E0 ldi r25,hi8(128) |
924 0724 9093 0000 sts (BeepMuster)+1,r25 |
925 0728 8093 0000 sts BeepMuster,r24 |
926 072c 12C0 rjmp .L89 |
927 .L85: |
928 072e 2A30 cpi r18,lo8(10) |
929 0730 11F0 breq .L91 |
930 0732 2431 cpi r18,lo8(20) |
931 0734 10F0 brlo .L90 |
932 .L91: |
933 0736 2898 cbi 37-0x20,0 |
934 0738 01C0 rjmp .L92 |
935 .L90: |
936 073a 289A sbi 37-0x20,0 |
937 .L92: |
938 073c 8091 0000 lds r24,beeptime |
939 0740 9091 0000 lds r25,(beeptime)+1 |
940 0744 892B or r24,r25 |
941 0746 29F4 brne .L89 |
942 0748 8091 0000 lds r24,FCFlags |
943 074c 8F77 andi r24,lo8(127) |
944 074e 8093 0000 sts FCFlags,r24 |
945 .L89: |
946 0752 8091 0000 lds r24,UpdateMotor |
947 0756 8823 tst r24 |
948 0758 09F0 breq .+2 |
949 075a 42C1 rjmp .L77 |
950 075c 0E94 0000 call DatenUebertragung |
951 0760 0E94 0000 call BearbeiteRxDaten |
952 0764 C801 movw r24,r16 |
953 0766 0E94 0000 call CheckDelay |
954 076a 8823 tst r24 |
955 076c 09F4 brne .+2 |
956 076e 34C1 rjmp .L95 |
957 0770 0C5E subi r16,lo8(-(20)) |
958 0772 1F4F sbci r17,hi8(-(20)) |
959 0774 8091 0000 lds r24,MissingMotor |
960 0778 9091 0000 lds r25,VersionInfo+6 |
961 077c 8823 tst r24 |
962 077e 39F0 breq .L96 |
963 0780 9260 ori r25,lo8(2) |
964 0782 9093 0000 sts VersionInfo+6,r25 |
965 0786 8091 0000 lds r24,DebugOut+1 |
966 078a 8260 ori r24,lo8(2) |
967 078c 0CC0 rjmp .L232 |
968 .L96: |
969 078e 9D7F andi r25,lo8(-3) |
970 0790 9093 0000 sts VersionInfo+6,r25 |
971 0794 8091 0000 lds r24,I2CTimeout |
972 0798 9091 0000 lds r25,(I2CTimeout)+1 |
973 079c 0797 sbiw r24,7 |
974 079e 28F0 brlo .L97 |
975 07a0 8091 0000 lds r24,DebugOut+1 |
976 07a4 8D7F andi r24,lo8(-3) |
977 .L232: |
978 07a6 8093 0000 sts DebugOut+1,r24 |
979 .L97: |
980 07aa 8091 0000 lds r24,I2CTimeout |
981 07ae 9091 0000 lds r25,(I2CTimeout)+1 |
982 07b2 0797 sbiw r24,7 |
983 07b4 28F0 brlo .L99 |
984 07b6 8091 0000 lds r24,VersionInfo+6 |
985 07ba 8E7F andi r24,lo8(-2) |
986 07bc 8093 0000 sts VersionInfo+6,r24 |
987 .L99: |
988 07c0 8091 0000 lds r24,PcZugriff |
989 07c4 8823 tst r24 |
990 07c6 21F0 breq .L100 |
991 07c8 8150 subi r24,lo8(-(-1)) |
992 07ca 8093 0000 sts PcZugriff,r24 |
993 07ce 25C0 rjmp .L101 |
994 .L100: |
995 07d0 8093 0000 sts ExternControl+10,r24 |
996 07d4 1092 0000 sts (ExternStickNick)+1,__zero_reg__ |
997 07d8 1092 0000 sts ExternStickNick,__zero_reg__ |
998 07dc 1092 0000 sts (ExternStickRoll)+1,__zero_reg__ |
999 07e0 1092 0000 sts ExternStickRoll,__zero_reg__ |
1000 07e4 1092 0000 sts (ExternStickGier)+1,__zero_reg__ |
1001 07e8 1092 0000 sts ExternStickGier,__zero_reg__ |
1002 07ec 8091 0000 lds r24,BeepMuster |
1003 07f0 9091 0000 lds r25,(BeepMuster)+1 |
1004 07f4 8F5F subi r24,lo8(-1) |
1005 07f6 9F4F sbci r25,hi8(-1) |
1006 07f8 81F4 brne .L101 |
1007 07fa 8091 0000 lds r24,SenderOkay |
1008 07fe 8823 tst r24 |
1009 0800 61F4 brne .L101 |
1010 0802 88E9 ldi r24,lo8(15000) |
1011 0804 9AE3 ldi r25,hi8(15000) |
1012 0806 9093 0000 sts (beeptime)+1,r25 |
1013 080a 8093 0000 sts beeptime,r24 |
1014 080e 80E0 ldi r24,lo8(3072) |
1015 0810 9CE0 ldi r25,hi8(3072) |
1016 0812 9093 0000 sts (BeepMuster)+1,r25 |
1017 0816 8093 0000 sts BeepMuster,r24 |
1018 .L101: |
1019 081a 8091 0000 lds r24,NaviDataOkay |
1020 081e 893C cpi r24,lo8(-55) |
1021 0820 70F0 brlo .L103 |
1022 0822 8150 subi r24,lo8(-(-1)) |
1023 0824 8093 0000 sts NaviDataOkay,r24 |
1024 0828 8091 0000 lds r24,FCFlags |
1025 082c 8F7B andi r24,lo8(-65) |
1026 082e 8093 0000 sts FCFlags,r24 |
1027 0832 8091 0000 lds r24,VersionInfo+6 |
1028 0836 8B7F andi r24,lo8(-5) |
1029 0838 8093 0000 sts VersionInfo+6,r24 |
1030 083c 35C0 rjmp .L104 |
1031 .L103: |
1032 083e 8091 0000 lds r24,NC_Version+3 |
1033 0842 8823 tst r24 |
1034 0844 09F1 breq .L105 |
1035 0846 8091 0000 lds r24,FCFlags |
1036 084a 8064 ori r24,lo8(64) |
1037 084c 8093 0000 sts FCFlags,r24 |
1038 0850 8091 0000 lds r24,VersionInfo+6 |
1039 0854 8460 ori r24,lo8(4) |
1040 0856 8093 0000 sts VersionInfo+6,r24 |
1041 085a 8091 0000 lds r24,BeepMuster |
1042 085e 9091 0000 lds r25,(BeepMuster)+1 |
1043 0862 8F5F subi r24,lo8(-1) |
1044 0864 9F4F sbci r25,hi8(-1) |
1045 0866 81F4 brne .L105 |
1046 0868 8091 0000 lds r24,MotorenEin |
1047 086c 8823 tst r24 |
1048 086e 61F0 breq .L105 |
1049 0870 88E9 ldi r24,lo8(15000) |
1050 0872 9AE3 ldi r25,hi8(15000) |
1051 0874 9093 0000 sts (beeptime)+1,r25 |
1052 0878 8093 0000 sts beeptime,r24 |
1053 087c 80E0 ldi r24,lo8(-22528) |
1054 087e 98EA ldi r25,hi8(-22528) |
1055 0880 9093 0000 sts (BeepMuster)+1,r25 |
1056 0884 8093 0000 sts BeepMuster,r24 |
1057 .L105: |
1058 0888 1092 0000 sts (GPS_Nick)+1,__zero_reg__ |
1059 088c 1092 0000 sts GPS_Nick,__zero_reg__ |
1060 0890 1092 0000 sts (GPS_Roll)+1,__zero_reg__ |
1061 0894 1092 0000 sts GPS_Roll,__zero_reg__ |
1062 0898 8FEF ldi r24,lo8(-1) |
1063 089a 9FEF ldi r25,hi8(-1) |
1064 089c 9093 0000 sts (FromNaviCtrl+7)+1,r25 |
1065 08a0 8093 0000 sts FromNaviCtrl+7,r24 |
1066 08a4 1092 0000 sts NaviDataOkay,__zero_reg__ |
1067 .L104: |
1068 08a8 8091 0000 lds r24,BattLowVoltageWarning |
1069 08ac 282F mov r18,r24 |
1070 08ae 3327 clr r19 |
1071 08b0 8091 0000 lds r24,UBat |
1072 08b4 9091 0000 lds r25,(UBat)+1 |
1073 08b8 8217 cp r24,r18 |
1074 08ba 9307 cpc r25,r19 |
1075 08bc CCF4 brge .L107 |
1076 08be 8091 0000 lds r24,FCFlags |
1077 08c2 8062 ori r24,lo8(32) |
1078 08c4 8093 0000 sts FCFlags,r24 |
1079 08c8 8091 0000 lds r24,BeepMuster |
1080 08cc 9091 0000 lds r25,(BeepMuster)+1 |
1081 08d0 8F5F subi r24,lo8(-1) |
1082 08d2 9F4F sbci r25,hi8(-1) |
1083 08d4 C1F4 brne .L109 |
1084 08d6 80E7 ldi r24,lo8(6000) |
1085 08d8 97E1 ldi r25,hi8(6000) |
1086 08da 9093 0000 sts (beeptime)+1,r25 |
1087 08de 8093 0000 sts beeptime,r24 |
1088 08e2 80E0 ldi r24,lo8(768) |
1089 08e4 93E0 ldi r25,hi8(768) |
1090 08e6 9093 0000 sts (BeepMuster)+1,r25 |
1091 08ea 8093 0000 sts BeepMuster,r24 |
1092 08ee 0BC0 rjmp .L109 |
1093 .L107: |
1094 08f0 8091 0000 lds r24,beeptime |
1095 08f4 9091 0000 lds r25,(beeptime)+1 |
1096 08f8 892B or r24,r25 |
1097 08fa 29F4 brne .L109 |
1098 08fc 8091 0000 lds r24,FCFlags |
1099 0900 8F7D andi r24,lo8(-33) |
1100 0902 8093 0000 sts FCFlags,r24 |
1101 .L109: |
1102 0906 0E94 0000 call SPI_StartTransmitPacket |
1103 090a 84E0 ldi r24,lo8(4) |
1104 090c 8093 0000 sts SendSPI,r24 |
1105 0910 8091 0000 lds r24,MotorenEin |
1106 0914 8823 tst r24 |
1107 0916 29F4 brne .L111 |
1108 0918 5AEA ldi r21,lo8(1450) |
1109 091a 852E mov r8,r21 |
1110 091c 55E0 ldi r21,hi8(1450) |
1111 091e 952E mov r9,r21 |
1112 0920 12C0 rjmp .L112 |
1113 .L111: |
1114 0922 8091 0000 lds r24,second.11 |
1115 0926 8F5F subi r24,lo8(-(1)) |
1116 0928 8093 0000 sts second.11,r24 |
1117 092c 8133 cpi r24,lo8(49) |
1118 092e 59F4 brne .L112 |
1119 0930 1092 0000 sts second.11,__zero_reg__ |
1120 0934 8091 0000 lds r24,FlugSekunden |
1121 0938 9091 0000 lds r25,(FlugSekunden)+1 |
1122 093c 0196 adiw r24,1 |
1123 093e 9093 0000 sts (FlugSekunden)+1,r25 |
1124 0942 8093 0000 sts FlugSekunden,r24 |
1125 .L112: |
1126 0946 0894 sec |
1127 0948 811C adc r8,__zero_reg__ |
1128 094a 911C adc r9,__zero_reg__ |
1129 094c F2E7 ldi r31,lo8(2930) |
1130 094e 8F16 cp r8,r31 |
1131 0950 FBE0 ldi r31,hi8(2930) |
1132 0952 9F06 cpc r9,r31 |
1133 0954 09F0 breq .+2 |
1134 0956 40C0 rjmp .L95 |
1135 0958 8824 clr r8 |
1136 095a 9924 clr r9 |
1137 095c 2091 0000 lds r18,FlugMinuten |
1138 0960 3091 0000 lds r19,(FlugMinuten)+1 |
1139 0964 2F5F subi r18,lo8(-(1)) |
1140 0966 3F4F sbci r19,hi8(-(1)) |
1141 0968 3093 0000 sts (FlugMinuten)+1,r19 |
1142 096c 2093 0000 sts FlugMinuten,r18 |
1143 0970 8091 0000 lds r24,FlugMinutenGesamt |
1144 0974 9091 0000 lds r25,(FlugMinutenGesamt)+1 |
1145 0978 0196 adiw r24,1 |
1146 097a 9093 0000 sts (FlugMinutenGesamt)+1,r25 |
1147 097e 8093 0000 sts FlugMinutenGesamt,r24 |
1148 0982 832F mov r24,r19 |
1149 0984 9927 clr r25 |
1150 0986 682F mov r22,r24 |
1151 0988 8EE0 ldi r24,lo8(14) |
1152 098a 90E0 ldi r25,hi8(14) |
1153 098c 0E94 0000 call SetParamByte |
1154 0990 8091 0000 lds r24,FlugMinuten |
1155 0994 9091 0000 lds r25,(FlugMinuten)+1 |
1156 0998 9070 andi r25,hi8(255) |
1157 099a 682F mov r22,r24 |
1158 099c 8FE0 ldi r24,lo8(15) |
1159 099e 90E0 ldi r25,hi8(15) |
1160 09a0 0E94 0000 call SetParamByte |
1161 09a4 8091 0000 lds r24,FlugMinutenGesamt |
1162 09a8 9091 0000 lds r25,(FlugMinutenGesamt)+1 |
1163 09ac 892F mov r24,r25 |
1164 09ae 9927 clr r25 |
1165 09b0 682F mov r22,r24 |
1166 09b2 8AE0 ldi r24,lo8(10) |
1167 09b4 90E0 ldi r25,hi8(10) |
1168 09b6 0E94 0000 call SetParamByte |
1169 09ba 8091 0000 lds r24,FlugMinutenGesamt |
1170 09be 9091 0000 lds r25,(FlugMinutenGesamt)+1 |
1171 09c2 9070 andi r25,hi8(255) |
1172 09c4 682F mov r22,r24 |
1173 09c6 8BE0 ldi r24,lo8(11) |
1174 09c8 90E0 ldi r25,hi8(11) |
1175 09ca 0E94 0000 call SetParamByte |
1176 09ce 84E1 ldi r24,lo8(20) |
1177 09d0 90E0 ldi r25,hi8(20) |
1178 09d2 0E94 0000 call SetDelay |
1179 09d6 8C01 movw r16,r24 |
1180 .L95: |
1181 09d8 0E94 0000 call LED_Update |
1182 09dc 0E94 0000 call Capacity_Update |
1183 .L77: |
1184 09e0 8091 0000 lds r24,SendSPI |
1185 09e4 8823 tst r24 |
1186 09e6 09F0 breq .+2 |
1187 09e8 0BCE rjmp .L234 |
1188 09ea 0E94 0000 call SPI_TransmitByte |
1189 09ee 08CE rjmp .L234 |
1190 /* epilogue: frame size=0 */ |
1191 /* epilogue: noreturn */ |
1192 /* epilogue end (size=0) */ |
1193 /* function main size 1092 (1088) */ |
1195 .comm _printf_P,2,1 |
1196 /* File "main.c": code 1285 = 0x0505 (1273), prologues 7, epilogues 5 */ |
DEFINED SYMBOLS |
*ABS*:00000000 main.c |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:2 *ABS*:0000003f __SREG__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:3 *ABS*:0000003e __SP_H__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:4 *ABS*:0000003d __SP_L__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:5 *ABS*:00000034 __CCP__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:6 *ABS*:00000000 __tmp_reg__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:7 *ABS*:00000001 __zero_reg__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:11 .text:00000000 LipoDetection |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1281 .progmem.data:00000118 __c.2236 |
C:\Users\Arthur-P\AppData\Local\Temp/cc27baaa.s:3 *ABS*:0000003f __SREG__ |
C:\Users\Arthur-P\AppData\Local\Temp/cc27baaa.s:4 *ABS*:0000003e __SP_H__ |
C:\Users\Arthur-P\AppData\Local\Temp/cc27baaa.s:5 *ABS*:0000003d __SP_L__ |
C:\Users\Arthur-P\AppData\Local\Temp/cc27baaa.s:6 *ABS*:00000000 __tmp_reg__ |
C:\Users\Arthur-P\AppData\Local\Temp/cc27baaa.s:7 *ABS*:00000001 __zero_reg__ |
C:\Users\Arthur-P\AppData\Local\Temp/cc27baaa.s:15 .bss:00000000 FoundMotors |
C:\Users\Arthur-P\AppData\Local\Temp/cc27baaa.s:21 .bss:00000001 FlugSekunden |
C:\Users\Arthur-P\AppData\Local\Temp/cc27baaa.s:27 .bss:00000003 FlugMinutenGesamt |
C:\Users\Arthur-P\AppData\Local\Temp/cc27baaa.s:33 .bss:00000005 FlugMinuten |
C:\Users\Arthur-P\AppData\Local\Temp/cc27baaa.s:39 .data:00000000 BattLowVoltageWarning |
C:\Users\Arthur-P\AppData\Local\Temp/cc27baaa.s:44 .data:00000001 SendVersionToNavi |
C:\Users\Arthur-P\AppData\Local\Temp/cc27baaa.s:49 .data:00000002 PlatinenVersion |
C:\Users\Arthur-P\AppData\Local\Temp/cc27baaa.s:53 .data:00000003 stick.15 |
C:\Users\Arthur-P\AppData\Local\Temp/cc27baaa.s:58 .text:00000000 CalMk3Mag |
C:\Users\Arthur-P\AppData\Local\Temp/cc27baaa.s:112 .progmem.data:00000000 __c.12 |
C:\Users\Arthur-P\AppData\Local\Temp/cc27baaa.s:116 .progmem.data:00000008 __c.13 |
C:\Users\Arthur-P\AppData\Local\Temp/cc27baaa.s:120 .progmem.data:00000013 __c.14 |
C:\Users\Arthur-P\AppData\Local\Temp/cc27baaa.s:125 .text:0000006a LipoDetection |
*COM*:00000002 _printf_P |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1198 .data:00000002 BattLowVoltageWarning |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1277 .progmem.data:0000010d __c.2244 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1273 .progmem.data:000000f3 __c.2246 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:173 .text:0000014a CalMk3Mag |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1286 .data:00000003 stick.2222 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:228 .text:000001bc main |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1188 .data:00000000 PlatinenVersion |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1269 .progmem.data:000000e1 __c.2277 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1265 .progmem.data:000000de __c.2288 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1223 .bss:00000006 FoundMotors |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1261 .progmem.data:000000c0 __c.2293 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1257 .progmem.data:0000009a __c.2298 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1253 .progmem.data:0000007a __c.2300 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1249 .progmem.data:00000075 __c.2305 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1205 .bss:00000000 FlugMinuten |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1211 .bss:00000002 FlugMinutenGesamt |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1245 .progmem.data:00000052 __c.2307 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1241 .progmem.data:00000046 __c.2309 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1237 .progmem.data:0000003a __c.2311 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1233 .progmem.data:00000028 __c.2313 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1229 .progmem.data:00000000 __c.2315 |
.bss:00000007 second.2317 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1217 .bss:00000004 FlugSekunden |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccWNlXkL.s:1193 .data:00000001 SendVersionToNavi |
C:\Users\Arthur-P\AppData\Local\Temp/cc27baaa.s:262 .progmem.data:0000002d __c.0 |
C:\Users\Arthur-P\AppData\Local\Temp/cc27baaa.s:266 .progmem.data:0000003f __c.1 |
C:\Users\Arthur-P\AppData\Local\Temp/cc27baaa.s:270 .progmem.data:00000042 __c.2 |
C:\Users\Arthur-P\AppData\Local\Temp/cc27baaa.s:274 .progmem.data:00000060 __c.3 |
C:\Users\Arthur-P\AppData\Local\Temp/cc27baaa.s:278 .progmem.data:00000086 __c.4 |
C:\Users\Arthur-P\AppData\Local\Temp/cc27baaa.s:282 .progmem.data:000000a6 __c.5 |
C:\Users\Arthur-P\AppData\Local\Temp/cc27baaa.s:286 .progmem.data:000000ab __c.6 |
C:\Users\Arthur-P\AppData\Local\Temp/cc27baaa.s:290 .progmem.data:000000ce __c.7 |
C:\Users\Arthur-P\AppData\Local\Temp/cc27baaa.s:294 .progmem.data:000000da __c.8 |
C:\Users\Arthur-P\AppData\Local\Temp/cc27baaa.s:298 .progmem.data:000000e6 __c.9 |
C:\Users\Arthur-P\AppData\Local\Temp/cc27baaa.s:302 .progmem.data:000000f8 __c.10 |
.bss:00000007 second.11 |
C:\Users\Arthur-P\AppData\Local\Temp/cc27baaa.s:308 .text:0000017e main |
UNDEFINED SYMBOLS |
__do_copy_data |
__do_clear_bss |
EE_Parameter |
PPM_in |
WinkelOut |
beeptime |
Piep |
DebugOut |
uart_putchar |
EE_Parameter |
SetDelay |
CheckDelay |
UBat |
Piep |
__udivmodqi4 |
PPM_in |
WinkelOut |
beeptime |
DebugOut |
__prologue_saves__ |
__stack |
StickGier |
StickRoll |
StickNick |
1383,5 → 1290,3 |
LED_Update |
Capacity_Update |
SPI_TransmitByte |
__do_copy_data |
__do_clear_bss |
/branches/V0.80g-Arthur-P1/menu.lst |
---|
1,3337 → 1,3034 |
1 .file "menu.c" |
2 __SREG__ = 0x3f |
3 __SP_H__ = 0x3e |
4 __SP_L__ = 0x3d |
5 __CCP__ = 0x34 |
2 .arch atmega644p |
3 __SREG__ = 0x3f |
4 __SP_H__ = 0x3e |
5 __SP_L__ = 0x3d |
6 __tmp_reg__ = 0 |
7 __zero_reg__ = 1 |
8 .text |
9 .global LcdClear |
11 LcdClear: |
12 /* prologue: function */ |
13 /* frame size = 0 */ |
14 0000 E0E0 ldi r30,lo8(DisplayBuff) |
15 0002 F0E0 ldi r31,hi8(DisplayBuff) |
16 0004 80E2 ldi r24,lo8(32) |
17 .L2: |
18 0006 8193 st Z+,r24 |
19 0008 90E0 ldi r25,hi8(DisplayBuff+80) |
20 000a E030 cpi r30,lo8(DisplayBuff+80) |
21 000c F907 cpc r31,r25 |
22 000e 01F4 brne .L2 |
23 /* epilogue start */ |
24 0010 0895 ret |
26 .global Menu_Putchar |
28 Menu_Putchar: |
29 /* prologue: function */ |
30 /* frame size = 0 */ |
31 0012 9091 0000 lds r25,DispPtr |
32 0016 E0E0 ldi r30,lo8(DisplayBuff) |
33 0018 F0E0 ldi r31,hi8(DisplayBuff) |
34 001a E90F add r30,r25 |
35 001c F11D adc r31,__zero_reg__ |
36 001e 8083 st Z,r24 |
37 0020 9F5F subi r25,lo8(-(1)) |
38 0022 9093 0000 sts DispPtr,r25 |
39 /* epilogue start */ |
40 0026 0895 ret |
42 .global Menu |
44 Menu: |
45 0028 EF92 push r14 |
46 002a FF92 push r15 |
47 002c 0F93 push r16 |
48 002e 1F93 push r17 |
49 0030 CF93 push r28 |
50 0032 DF93 push r29 |
51 /* prologue: function */ |
52 /* frame size = 0 */ |
53 0034 8091 0000 lds r24,RemoteKeys |
54 0038 80FF sbrs r24,0 |
55 003a 00C0 rjmp .L8 |
56 003c 8091 0000 lds r24,MenuePunkt |
57 0040 8823 tst r24 |
58 0042 01F0 breq .L9 |
59 0044 8150 subi r24,lo8(-(-1)) |
60 0046 00C0 rjmp .L49 |
61 .L9: |
62 0048 8091 0000 lds r24,MaxMenue |
63 .L49: |
64 004c 8093 0000 sts MenuePunkt,r24 |
65 .L8: |
66 0050 8091 0000 lds r24,RemoteKeys |
67 0054 81FF sbrs r24,1 |
68 0056 00C0 rjmp .L10 |
69 0058 9091 0000 lds r25,MenuePunkt |
70 005c 8091 0000 lds r24,MaxMenue |
71 0060 9817 cp r25,r24 |
72 0062 01F4 brne .L11 |
73 0064 1092 0000 sts MenuePunkt,__zero_reg__ |
74 0068 00C0 rjmp .L10 |
75 .L11: |
76 006a 9F5F subi r25,lo8(-(1)) |
77 006c 9093 0000 sts MenuePunkt,r25 |
78 .L10: |
79 0070 8091 0000 lds r24,RemoteKeys |
80 0074 8370 andi r24,lo8(3) |
81 0076 8330 cpi r24,lo8(3) |
82 0078 01F4 brne .L12 |
83 007a 1092 0000 sts MenuePunkt,__zero_reg__ |
84 .L12: |
85 007e E0E0 ldi r30,lo8(DisplayBuff) |
86 0080 F0E0 ldi r31,hi8(DisplayBuff) |
87 0082 80E2 ldi r24,lo8(32) |
88 .L13: |
89 0084 8193 st Z+,r24 |
90 0086 20E0 ldi r18,hi8(DisplayBuff+80) |
91 0088 E030 cpi r30,lo8(DisplayBuff+80) |
92 008a F207 cpc r31,r18 |
93 008c 01F4 brne .L13 |
94 008e 8091 0000 lds r24,MenuePunkt |
95 0092 C0E0 ldi r28,lo8(gs(Menu_Putchar)) |
96 0094 D0E0 ldi r29,hi8(gs(Menu_Putchar)) |
97 0096 8A30 cpi r24,lo8(10) |
98 0098 00F4 brsh .L14 |
99 009a 81E1 ldi r24,lo8(17) |
100 009c 8093 0000 sts DispPtr,r24 |
101 00a0 00D0 rcall . |
102 00a2 00D0 rcall . |
103 00a4 00D0 rcall . |
104 00a6 EDB7 in r30,__SP_L__ |
105 00a8 FEB7 in r31,__SP_H__ |
106 00aa 3196 adiw r30,1 |
107 00ac ADB7 in r26,__SP_L__ |
108 00ae BEB7 in r27,__SP_H__ |
109 00b0 1296 adiw r26,1+1 |
110 00b2 DC93 st X,r29 |
111 00b4 CE93 st -X,r28 |
112 00b6 1197 sbiw r26,1 |
113 00b8 80E0 ldi r24,lo8(__c.2233) |
114 00ba 90E0 ldi r25,hi8(__c.2233) |
115 00bc 00C0 rjmp .L50 |
116 .L14: |
117 00be 80E1 ldi r24,lo8(16) |
118 00c0 8093 0000 sts DispPtr,r24 |
119 00c4 00D0 rcall . |
120 00c6 00D0 rcall . |
121 00c8 00D0 rcall . |
122 00ca EDB7 in r30,__SP_L__ |
123 00cc FEB7 in r31,__SP_H__ |
124 00ce 3196 adiw r30,1 |
125 00d0 ADB7 in r26,__SP_L__ |
126 00d2 BEB7 in r27,__SP_H__ |
127 00d4 1296 adiw r26,1+1 |
128 00d6 DC93 st X,r29 |
129 00d8 CE93 st -X,r28 |
130 00da 1197 sbiw r26,1 |
131 00dc 80E0 ldi r24,lo8(__c.2235) |
132 00de 90E0 ldi r25,hi8(__c.2235) |
133 .L50: |
134 00e0 9383 std Z+3,r25 |
135 00e2 8283 std Z+2,r24 |
136 00e4 8091 0000 lds r24,MenuePunkt |
137 00e8 8483 std Z+4,r24 |
138 00ea 1582 std Z+5,__zero_reg__ |
139 00ec E091 0000 lds r30,_printf_P |
140 00f0 F091 0000 lds r31,(_printf_P)+1 |
141 00f4 0995 icall |
142 00f6 EDB7 in r30,__SP_L__ |
143 00f8 FEB7 in r31,__SP_H__ |
144 00fa 3696 adiw r30,6 |
145 00fc EDBF out __SP_L__,r30 |
146 00fe 9091 0000 lds r25,MenuePunkt |
147 0102 E92F mov r30,r25 |
148 0104 F0E0 ldi r31,lo8(0) |
149 0106 E231 cpi r30,18 |
150 0108 F105 cpc r31,__zero_reg__ |
151 010a 00F0 brlo .+4 |
152 010c 0C94 0000 jmp .L16 |
153 0110 E050 subi r30,lo8(-(gs(.L35))) |
154 0112 F040 sbci r31,hi8(-(gs(.L35))) |
155 0114 C0E0 ldi r28,lo8(gs(Menu_Putchar)) |
156 0116 D0E0 ldi r29,hi8(gs(Menu_Putchar)) |
157 0118 0C94 0000 jmp __tablejump2__ |
158 .data |
159 .section .progmem.gcc_sw_table, "a", @progbits |
160 .p2align 1 |
161 .L35: |
162 .data |
163 .section .progmem.gcc_sw_table, "a", @progbits |
164 .p2align 1 |
165 0000 0000 .word gs(.L17) |
166 0002 0000 .word gs(.L18) |
167 0004 0000 .word gs(.L19) |
168 0006 0000 .word gs(.L20) |
169 0008 0000 .word gs(.L21) |
170 000a 0000 .word gs(.L22) |
171 000c 0000 .word gs(.L23) |
172 000e 0000 .word gs(.L24) |
173 0010 0000 .word gs(.L25) |
174 0012 0000 .word gs(.L26) |
175 0014 0000 .word gs(.L27) |
176 0016 0000 .word gs(.L28) |
177 0018 0000 .word gs(.L29) |
178 001a 0000 .word gs(.L30) |
179 001c 0000 .word gs(.L31) |
180 001e 0000 .word gs(.L32) |
181 0020 0000 .word gs(.L33) |
182 0022 0000 .word gs(.L34) |
183 .text |
184 .L17: |
185 011c 1092 0000 sts DispPtr,__zero_reg__ |
186 0120 00D0 rcall . |
187 0122 00D0 rcall . |
188 0124 ADB7 in r26,__SP_L__ |
189 0126 BEB7 in r27,__SP_H__ |
190 0128 1296 adiw r26,1+1 |
191 012a DC93 st X,r29 |
192 012c CE93 st -X,r28 |
193 012e 1197 sbiw r26,1 |
194 0130 80E0 ldi r24,lo8(__c.2238) |
195 0132 90E0 ldi r25,hi8(__c.2238) |
196 0134 1496 adiw r26,3+1 |
197 0136 9C93 st X,r25 |
198 0138 8E93 st -X,r24 |
199 013a 1397 sbiw r26,3 |
200 013c E091 0000 lds r30,_printf_P |
201 0140 F091 0000 lds r31,(_printf_P)+1 |
202 0144 0995 icall |
203 0146 84E1 ldi r24,lo8(20) |
204 0148 8093 0000 sts DispPtr,r24 |
205 014c 2091 0000 lds r18,PlatinenVersion |
206 0150 EDB7 in r30,__SP_L__ |
207 0152 FEB7 in r31,__SP_H__ |
208 0154 3A97 sbiw r30,10 |
209 0156 EDBF out __SP_L__,r30 |
210 0158 3196 adiw r30,1 |
211 015a ADB7 in r26,__SP_L__ |
212 015c BEB7 in r27,__SP_H__ |
213 015e 1296 adiw r26,1+1 |
214 0160 DC93 st X,r29 |
215 0162 CE93 st -X,r28 |
216 0164 1197 sbiw r26,1 |
217 0166 80E0 ldi r24,lo8(__c.2240) |
218 0168 90E0 ldi r25,hi8(__c.2240) |
219 016a 9383 std Z+3,r25 |
220 016c 8283 std Z+2,r24 |
221 016e 822F mov r24,r18 |
222 0170 6AE0 ldi r22,lo8(10) |
223 0172 0E94 0000 call __udivmodqi4 |
224 0176 8483 std Z+4,r24 |
225 0178 1582 std Z+5,__zero_reg__ |
226 017a 822F mov r24,r18 |
227 017c 0E94 0000 call __udivmodqi4 |
228 0180 9683 std Z+6,r25 |
229 0182 1782 std Z+7,__zero_reg__ |
230 0184 1186 std Z+9,__zero_reg__ |
231 0186 1086 std Z+8,__zero_reg__ |
232 0188 80E5 ldi r24,lo8(80) |
233 018a 90E0 ldi r25,hi8(80) |
234 018c 9387 std Z+11,r25 |
235 018e 8287 std Z+10,r24 |
236 0190 87E6 ldi r24,lo8(103) |
237 0192 90E0 ldi r25,hi8(103) |
238 0194 9587 std Z+13,r25 |
239 0196 8487 std Z+12,r24 |
240 0198 E091 0000 lds r30,_printf_P |
241 019c F091 0000 lds r31,(_printf_P)+1 |
242 01a0 0995 icall |
243 01a2 88E2 ldi r24,lo8(40) |
244 01a4 8093 0000 sts DispPtr,r24 |
245 01a8 0091 0000 lds r16,_printf_P |
246 01ac 1091 0000 lds r17,(_printf_P)+1 |
247 01b0 EDB7 in r30,__SP_L__ |
248 01b2 FEB7 in r31,__SP_H__ |
249 01b4 3E96 adiw r30,14 |
250 01b6 EDBF out __SP_L__,r30 |
251 01b8 0E94 0000 call GetActiveParamSet |
252 01bc 2DB7 in r18,__SP_L__ |
253 01be 3EB7 in r19,__SP_H__ |
254 01c0 2850 subi r18,lo8(-(-8)) |
255 01c2 3040 sbci r19,hi8(-(-8)) |
256 01c4 2DBF out __SP_L__,r18 |
257 01c6 EDB7 in r30,__SP_L__ |
258 01c8 FEB7 in r31,__SP_H__ |
259 01ca 3196 adiw r30,1 |
260 01cc ADB7 in r26,__SP_L__ |
261 01ce BEB7 in r27,__SP_H__ |
262 01d0 1296 adiw r26,1+1 |
263 01d2 DC93 st X,r29 |
264 01d4 CE93 st -X,r28 |
265 01d6 1197 sbiw r26,1 |
266 01d8 20E0 ldi r18,lo8(__c.2242) |
267 01da 30E0 ldi r19,hi8(__c.2242) |
268 01dc 3383 std Z+3,r19 |
269 01de 2283 std Z+2,r18 |
270 01e0 8483 std Z+4,r24 |
271 01e2 1582 std Z+5,__zero_reg__ |
272 01e4 80E0 ldi r24,lo8(Mixer+1) |
273 01e6 90E0 ldi r25,hi8(Mixer+1) |
274 01e8 9783 std Z+7,r25 |
275 01ea 8683 std Z+6,r24 |
276 01ec F801 movw r30,r16 |
277 01ee 0995 icall |
278 01f0 EDB7 in r30,__SP_L__ |
279 01f2 FEB7 in r31,__SP_H__ |
280 01f4 3896 adiw r30,8 |
281 01f6 EDBF out __SP_L__,r30 |
282 01f8 8091 0000 lds r24,VersionInfo+5 |
283 01fc 8823 tst r24 |
284 01fe 01F0 breq .L36 |
285 0200 8CE3 ldi r24,lo8(60) |
286 0202 8093 0000 sts DispPtr,r24 |
287 0206 00D0 rcall . |
288 0208 00D0 rcall . |
289 020a 00D0 rcall . |
290 020c EDB7 in r30,__SP_L__ |
291 020e FEB7 in r31,__SP_H__ |
292 0210 3196 adiw r30,1 |
293 0212 ADB7 in r26,__SP_L__ |
294 0214 BEB7 in r27,__SP_H__ |
295 0216 1296 adiw r26,1+1 |
296 0218 DC93 st X,r29 |
297 021a CE93 st -X,r28 |
298 021c 1197 sbiw r26,1 |
299 021e 80E0 ldi r24,lo8(__c.2244) |
300 0220 90E0 ldi r25,hi8(__c.2244) |
301 0222 9383 std Z+3,r25 |
302 0224 8283 std Z+2,r24 |
303 0226 8091 0000 lds r24,VersionInfo+5 |
304 022a 00C0 rjmp .L62 |
305 .L36: |
306 022c 8091 0000 lds r24,MissingMotor |
307 0230 8823 tst r24 |
308 0232 01F0 breq .L38 |
309 0234 8CE3 ldi r24,lo8(60) |
310 0236 8093 0000 sts DispPtr,r24 |
311 023a 00D0 rcall . |
312 023c 00D0 rcall . |
313 023e 00D0 rcall . |
314 0240 EDB7 in r30,__SP_L__ |
315 0242 FEB7 in r31,__SP_H__ |
316 0244 3196 adiw r30,1 |
317 0246 ADB7 in r26,__SP_L__ |
318 0248 BEB7 in r27,__SP_H__ |
319 024a 1296 adiw r26,1+1 |
320 024c DC93 st X,r29 |
321 024e CE93 st -X,r28 |
322 0250 1197 sbiw r26,1 |
323 0252 80E0 ldi r24,lo8(__c.2246) |
324 0254 90E0 ldi r25,hi8(__c.2246) |
325 0256 9383 std Z+3,r25 |
326 0258 8283 std Z+2,r24 |
327 025a 8091 0000 lds r24,MissingMotor |
328 .L62: |
329 025e 8483 std Z+4,r24 |
330 0260 00C0 rjmp .L51 |
331 .L38: |
332 0262 8091 0000 lds r24,VersionInfo+6 |
333 0266 84FF sbrs r24,4 |
334 0268 00C0 rjmp .L39 |
335 026a 8CE3 ldi r24,lo8(60) |
336 026c 8093 0000 sts DispPtr,r24 |
337 0270 00D0 rcall . |
338 0272 00D0 rcall . |
339 0274 ADB7 in r26,__SP_L__ |
340 0276 BEB7 in r27,__SP_H__ |
341 0278 1296 adiw r26,1+1 |
342 027a DC93 st X,r29 |
343 027c CE93 st -X,r28 |
344 027e 1197 sbiw r26,1 |
345 0280 80E0 ldi r24,lo8(__c.2248) |
346 0282 90E0 ldi r25,hi8(__c.2248) |
347 0284 0C94 0000 jmp .L60 |
348 .L39: |
349 0288 8091 0000 lds r24,I2CTimeout |
350 028c 9091 0000 lds r25,(I2CTimeout)+1 |
351 0290 0697 sbiw r24,6 |
352 0292 00F0 brlo .+4 |
353 0294 0C94 0000 jmp .L37 |
354 0298 8CE3 ldi r24,lo8(60) |
355 029a 8093 0000 sts DispPtr,r24 |
356 029e 00D0 rcall . |
357 02a0 00D0 rcall . |
358 02a2 EDB7 in r30,__SP_L__ |
359 02a4 FEB7 in r31,__SP_H__ |
360 02a6 D283 std Z+2,r29 |
361 02a8 C183 std Z+1,r28 |
362 02aa 80E0 ldi r24,lo8(__c.2250) |
363 02ac 90E0 ldi r25,hi8(__c.2250) |
364 02ae 00C0 rjmp .L59 |
365 .L18: |
366 02b0 8091 0000 lds r24,EE_Parameter+13 |
367 02b4 C0E0 ldi r28,lo8(gs(Menu_Putchar)) |
368 02b6 D0E0 ldi r29,hi8(gs(Menu_Putchar)) |
369 02b8 80FF sbrs r24,0 |
370 02ba 00C0 rjmp .L40 |
371 02bc 1092 0000 sts DispPtr,__zero_reg__ |
372 02c0 00D0 rcall . |
373 02c2 00D0 rcall . |
374 02c4 00D0 rcall . |
375 02c6 0DB7 in r16,__SP_L__ |
376 02c8 1EB7 in r17,__SP_H__ |
377 02ca 0F5F subi r16,lo8(-(1)) |
378 02cc 1F4F sbci r17,hi8(-(1)) |
379 02ce ADB7 in r26,__SP_L__ |
380 02d0 BEB7 in r27,__SP_H__ |
381 02d2 1296 adiw r26,1+1 |
382 02d4 DC93 st X,r29 |
383 02d6 CE93 st -X,r28 |
384 02d8 1197 sbiw r26,1 |
385 02da 80E0 ldi r24,lo8(__c.2254) |
386 02dc 90E0 ldi r25,hi8(__c.2254) |
387 02de F801 movw r30,r16 |
388 02e0 9383 std Z+3,r25 |
389 02e2 8283 std Z+2,r24 |
390 02e4 6091 0000 lds r22,HoehenWert |
391 02e8 7091 0000 lds r23,(HoehenWert)+1 |
392 02ec 8091 0000 lds r24,(HoehenWert)+2 |
393 02f0 9091 0000 lds r25,(HoehenWert)+3 |
394 02f4 25E0 ldi r18,lo8(5) |
395 02f6 30E0 ldi r19,hi8(5) |
396 02f8 40E0 ldi r20,hlo8(5) |
397 02fa 50E0 ldi r21,hhi8(5) |
398 02fc 0E94 0000 call __divmodsi4 |
399 0300 D801 movw r26,r16 |
400 0302 1596 adiw r26,4+1 |
401 0304 3C93 st X,r19 |
402 0306 2E93 st -X,r18 |
403 0308 1497 sbiw r26,4 |
404 030a E091 0000 lds r30,_printf_P |
405 030e F091 0000 lds r31,(_printf_P)+1 |
406 0312 0995 icall |
407 0314 84E1 ldi r24,lo8(20) |
408 0316 8093 0000 sts DispPtr,r24 |
409 031a 0DB7 in r16,__SP_L__ |
410 031c 1EB7 in r17,__SP_H__ |
411 031e 0F5F subi r16,lo8(-(1)) |
412 0320 1F4F sbci r17,hi8(-(1)) |
413 0322 EDB7 in r30,__SP_L__ |
414 0324 FEB7 in r31,__SP_H__ |
415 0326 D283 std Z+2,r29 |
416 0328 C183 std Z+1,r28 |
417 032a 80E0 ldi r24,lo8(__c.2256) |
418 032c 90E0 ldi r25,hi8(__c.2256) |
419 032e D801 movw r26,r16 |
420 0330 1396 adiw r26,2+1 |
421 0332 9C93 st X,r25 |
422 0334 8E93 st -X,r24 |
423 0336 1297 sbiw r26,2 |
424 0338 6091 0000 lds r22,SollHoehe |
425 033c 7091 0000 lds r23,(SollHoehe)+1 |
426 0340 8091 0000 lds r24,(SollHoehe)+2 |
427 0344 9091 0000 lds r25,(SollHoehe)+3 |
428 0348 25E0 ldi r18,lo8(5) |
429 034a 30E0 ldi r19,hi8(5) |
430 034c 40E0 ldi r20,hlo8(5) |
431 034e 50E0 ldi r21,hhi8(5) |
432 0350 0E94 0000 call __divmodsi4 |
433 0354 F801 movw r30,r16 |
434 0356 3583 std Z+5,r19 |
435 0358 2483 std Z+4,r18 |
436 035a E091 0000 lds r30,_printf_P |
437 035e F091 0000 lds r31,(_printf_P)+1 |
438 0362 0995 icall |
439 0364 88E2 ldi r24,lo8(40) |
440 0366 8093 0000 sts DispPtr,r24 |
441 036a 2091 0000 lds r18,MessLuftdruck |
442 036e 3091 0000 lds r19,(MessLuftdruck)+1 |
443 0372 EDB7 in r30,__SP_L__ |
444 0374 FEB7 in r31,__SP_H__ |
445 0376 3196 adiw r30,1 |
446 0378 ADB7 in r26,__SP_L__ |
447 037a BEB7 in r27,__SP_H__ |
448 037c 1296 adiw r26,1+1 |
449 037e DC93 st X,r29 |
450 0380 CE93 st -X,r28 |
451 0382 1197 sbiw r26,1 |
452 0384 80E0 ldi r24,lo8(__c.2258) |
453 0386 90E0 ldi r25,hi8(__c.2258) |
454 0388 9383 std Z+3,r25 |
455 038a 8283 std Z+2,r24 |
456 038c 3583 std Z+5,r19 |
457 038e 2483 std Z+4,r18 |
458 0390 E091 0000 lds r30,_printf_P |
459 0394 F091 0000 lds r31,(_printf_P)+1 |
460 0398 0995 icall |
461 039a 8CE3 ldi r24,lo8(60) |
462 039c 8093 0000 sts DispPtr,r24 |
463 03a0 27B5 in r18,71-32 |
464 03a2 EDB7 in r30,__SP_L__ |
465 03a4 FEB7 in r31,__SP_H__ |
466 03a6 3196 adiw r30,1 |
467 03a8 ADB7 in r26,__SP_L__ |
468 03aa BEB7 in r27,__SP_H__ |
469 03ac 1296 adiw r26,1+1 |
470 03ae DC93 st X,r29 |
471 03b0 CE93 st -X,r28 |
472 03b2 1197 sbiw r26,1 |
473 03b4 80E0 ldi r24,lo8(__c.2260) |
474 03b6 90E0 ldi r25,hi8(__c.2260) |
475 03b8 9383 std Z+3,r25 |
476 03ba 8283 std Z+2,r24 |
477 03bc 2483 std Z+4,r18 |
478 .L51: |
479 03be 1582 std Z+5,__zero_reg__ |
480 .L53: |
481 03c0 E091 0000 lds r30,_printf_P |
482 03c4 F091 0000 lds r31,(_printf_P)+1 |
483 03c8 0995 icall |
484 03ca EDB7 in r30,__SP_L__ |
485 03cc FEB7 in r31,__SP_H__ |
486 03ce 3696 adiw r30,6 |
487 .L54: |
488 03d0 EDBF out __SP_L__,r30 |
489 03d2 0C94 0000 jmp .L37 |
490 .L40: |
491 03d6 1092 0000 sts DispPtr,__zero_reg__ |
492 03da 00D0 rcall . |
493 03dc 00D0 rcall . |
494 03de ADB7 in r26,__SP_L__ |
495 03e0 BEB7 in r27,__SP_H__ |
496 03e2 1296 adiw r26,1+1 |
497 03e4 DC93 st X,r29 |
498 03e6 CE93 st -X,r28 |
499 03e8 1197 sbiw r26,1 |
500 03ea 80E0 ldi r24,lo8(__c.2262) |
501 03ec 90E0 ldi r25,hi8(__c.2262) |
502 03ee 1496 adiw r26,3+1 |
503 03f0 9C93 st X,r25 |
504 03f2 8E93 st -X,r24 |
505 03f4 1397 sbiw r26,3 |
506 03f6 E091 0000 lds r30,_printf_P |
507 03fa F091 0000 lds r31,(_printf_P)+1 |
508 03fe 0995 icall |
509 0400 84E1 ldi r24,lo8(20) |
510 0402 8093 0000 sts DispPtr,r24 |
511 0406 EDB7 in r30,__SP_L__ |
512 0408 FEB7 in r31,__SP_H__ |
513 040a D283 std Z+2,r29 |
514 040c C183 std Z+1,r28 |
515 040e 80E0 ldi r24,lo8(__c.2264) |
516 0410 90E0 ldi r25,hi8(__c.2264) |
517 0412 9483 std Z+4,r25 |
518 0414 8383 std Z+3,r24 |
519 0416 E091 0000 lds r30,_printf_P |
520 041a F091 0000 lds r31,(_printf_P)+1 |
521 041e 0995 icall |
522 0420 88E2 ldi r24,lo8(40) |
523 0422 8093 0000 sts DispPtr,r24 |
524 0426 ADB7 in r26,__SP_L__ |
525 0428 BEB7 in r27,__SP_H__ |
526 042a 1296 adiw r26,1+1 |
527 042c DC93 st X,r29 |
528 042e CE93 st -X,r28 |
529 0430 1197 sbiw r26,1 |
530 0432 80E0 ldi r24,lo8(__c.2266) |
531 0434 90E0 ldi r25,hi8(__c.2266) |
532 0436 1496 adiw r26,3+1 |
533 0438 9C93 st X,r25 |
534 043a 8E93 st -X,r24 |
535 043c 1397 sbiw r26,3 |
536 043e E091 0000 lds r30,_printf_P |
537 0442 F091 0000 lds r31,(_printf_P)+1 |
538 0446 0995 icall |
539 0448 8CE3 ldi r24,lo8(60) |
540 044a 8093 0000 sts DispPtr,r24 |
541 044e EDB7 in r30,__SP_L__ |
542 0450 FEB7 in r31,__SP_H__ |
543 0452 D283 std Z+2,r29 |
544 0454 C183 std Z+1,r28 |
545 0456 80E0 ldi r24,lo8(__c.2268) |
546 0458 90E0 ldi r25,hi8(__c.2268) |
547 .L59: |
548 045a 9483 std Z+4,r25 |
549 045c 8383 std Z+3,r24 |
550 045e 0C94 0000 jmp .L52 |
551 .L19: |
552 0462 1092 0000 sts DispPtr,__zero_reg__ |
553 0466 00D0 rcall . |
554 0468 00D0 rcall . |
555 046a ADB7 in r26,__SP_L__ |
556 046c BEB7 in r27,__SP_H__ |
557 046e 1296 adiw r26,1+1 |
558 0470 DC93 st X,r29 |
559 0472 CE93 st -X,r28 |
560 0474 1197 sbiw r26,1 |
561 0476 80E0 ldi r24,lo8(__c.2271) |
562 0478 90E0 ldi r25,hi8(__c.2271) |
563 047a 1496 adiw r26,3+1 |
564 047c 9C93 st X,r25 |
565 047e 8E93 st -X,r24 |
566 0480 1397 sbiw r26,3 |
567 0482 E091 0000 lds r30,_printf_P |
568 0486 F091 0000 lds r31,(_printf_P)+1 |
569 048a 0995 icall |
570 048c 84E1 ldi r24,lo8(20) |
571 048e 8093 0000 sts DispPtr,r24 |
572 0492 00D0 rcall . |
573 0494 00D0 rcall . |
574 0496 0DB7 in r16,__SP_L__ |
575 0498 1EB7 in r17,__SP_H__ |
576 049a 0F5F subi r16,lo8(-(1)) |
577 049c 1F4F sbci r17,hi8(-(1)) |
578 049e EDB7 in r30,__SP_L__ |
579 04a0 FEB7 in r31,__SP_H__ |
580 04a2 D283 std Z+2,r29 |
581 04a4 C183 std Z+1,r28 |
582 04a6 80E0 ldi r24,lo8(__c.2273) |
583 04a8 90E0 ldi r25,hi8(__c.2273) |
584 04aa D801 movw r26,r16 |
585 04ac 1396 adiw r26,2+1 |
586 04ae 9C93 st X,r25 |
587 04b0 8E93 st -X,r24 |
588 04b2 1297 sbiw r26,2 |
589 04b4 6091 0000 lds r22,IntegralNick |
590 04b8 7091 0000 lds r23,(IntegralNick)+1 |
591 04bc 8091 0000 lds r24,(IntegralNick)+2 |
592 04c0 9091 0000 lds r25,(IntegralNick)+3 |
593 04c4 20E0 ldi r18,lo8(1024) |
594 04c6 34E0 ldi r19,hi8(1024) |
595 04c8 40E0 ldi r20,hlo8(1024) |
596 04ca 50E0 ldi r21,hhi8(1024) |
597 04cc 0E94 0000 call __divmodsi4 |
598 04d0 F801 movw r30,r16 |
599 04d2 2483 std Z+4,r18 |
600 04d4 3583 std Z+5,r19 |
601 04d6 4683 std Z+6,r20 |
602 04d8 5783 std Z+7,r21 |
603 04da E091 0000 lds r30,_printf_P |
604 04de F091 0000 lds r31,(_printf_P)+1 |
605 04e2 0995 icall |
606 04e4 88E2 ldi r24,lo8(40) |
607 04e6 8093 0000 sts DispPtr,r24 |
608 04ea 0DB7 in r16,__SP_L__ |
609 04ec 1EB7 in r17,__SP_H__ |
610 04ee 0F5F subi r16,lo8(-(1)) |
611 04f0 1F4F sbci r17,hi8(-(1)) |
612 04f2 ADB7 in r26,__SP_L__ |
613 04f4 BEB7 in r27,__SP_H__ |
614 04f6 1296 adiw r26,1+1 |
615 04f8 DC93 st X,r29 |
616 04fa CE93 st -X,r28 |
617 04fc 1197 sbiw r26,1 |
618 04fe 80E0 ldi r24,lo8(__c.2275) |
619 0500 90E0 ldi r25,hi8(__c.2275) |
620 0502 F801 movw r30,r16 |
621 0504 9383 std Z+3,r25 |
622 0506 8283 std Z+2,r24 |
623 0508 6091 0000 lds r22,IntegralRoll |
624 050c 7091 0000 lds r23,(IntegralRoll)+1 |
625 0510 8091 0000 lds r24,(IntegralRoll)+2 |
626 0514 9091 0000 lds r25,(IntegralRoll)+3 |
627 0518 20E0 ldi r18,lo8(1024) |
628 051a 34E0 ldi r19,hi8(1024) |
629 051c 40E0 ldi r20,hlo8(1024) |
630 051e 50E0 ldi r21,hhi8(1024) |
631 0520 0E94 0000 call __divmodsi4 |
632 0524 D801 movw r26,r16 |
633 0526 1496 adiw r26,4 |
634 0528 2D93 st X+,r18 |
635 052a 3D93 st X+,r19 |
636 052c 4D93 st X+,r20 |
637 052e 5C93 st X,r21 |
638 0530 1797 sbiw r26,4+3 |
639 0532 E091 0000 lds r30,_printf_P |
640 0536 F091 0000 lds r31,(_printf_P)+1 |
641 053a 0995 icall |
642 053c 8CE3 ldi r24,lo8(60) |
643 053e 8093 0000 sts DispPtr,r24 |
644 0542 0F90 pop __tmp_reg__ |
645 0544 0F90 pop __tmp_reg__ |
646 0546 EDB7 in r30,__SP_L__ |
647 0548 FEB7 in r31,__SP_H__ |
648 054a 3196 adiw r30,1 |
649 054c ADB7 in r26,__SP_L__ |
650 054e BEB7 in r27,__SP_H__ |
651 0550 1296 adiw r26,1+1 |
652 0552 DC93 st X,r29 |
653 0554 CE93 st -X,r28 |
654 0556 1197 sbiw r26,1 |
655 0558 80E0 ldi r24,lo8(__c.2277) |
656 055a 90E0 ldi r25,hi8(__c.2277) |
657 055c 9383 std Z+3,r25 |
658 055e 8283 std Z+2,r24 |
659 0560 8091 0000 lds r24,KompassValue |
660 0564 9091 0000 lds r25,(KompassValue)+1 |
661 0568 00C0 rjmp .L61 |
662 .L20: |
663 056a 1092 0000 sts DispPtr,__zero_reg__ |
664 056e 2091 0000 lds r18,PPM_in+2 |
665 0572 3091 0000 lds r19,(PPM_in+2)+1 |
666 0576 4091 0000 lds r20,PPM_in+4 |
667 057a 5091 0000 lds r21,(PPM_in+4)+1 |
668 057e 8DB7 in r24,__SP_L__ |
669 0580 9EB7 in r25,__SP_H__ |
670 0582 0897 sbiw r24,8 |
671 0584 8DBF out __SP_L__,r24 |
672 0586 EDB7 in r30,__SP_L__ |
673 0588 FEB7 in r31,__SP_H__ |
674 058a 3196 adiw r30,1 |
675 058c ADB7 in r26,__SP_L__ |
676 058e BEB7 in r27,__SP_H__ |
677 0590 1296 adiw r26,1+1 |
678 0592 DC93 st X,r29 |
679 0594 CE93 st -X,r28 |
680 0596 1197 sbiw r26,1 |
681 0598 80E0 ldi r24,lo8(__c.2280) |
682 059a 90E0 ldi r25,hi8(__c.2280) |
683 059c 9383 std Z+3,r25 |
684 059e 8283 std Z+2,r24 |
685 05a0 3583 std Z+5,r19 |
686 05a2 2483 std Z+4,r18 |
687 05a4 5783 std Z+7,r21 |
688 05a6 4683 std Z+6,r20 |
689 05a8 E091 0000 lds r30,_printf_P |
690 05ac F091 0000 lds r31,(_printf_P)+1 |
691 05b0 0995 icall |
692 05b2 84E1 ldi r24,lo8(20) |
693 05b4 8093 0000 sts DispPtr,r24 |
694 05b8 2091 0000 lds r18,PPM_in+6 |
695 05bc 3091 0000 lds r19,(PPM_in+6)+1 |
696 05c0 4091 0000 lds r20,PPM_in+8 |
697 05c4 5091 0000 lds r21,(PPM_in+8)+1 |
698 05c8 EDB7 in r30,__SP_L__ |
699 05ca FEB7 in r31,__SP_H__ |
700 05cc 3196 adiw r30,1 |
701 05ce ADB7 in r26,__SP_L__ |
702 05d0 BEB7 in r27,__SP_H__ |
703 05d2 1296 adiw r26,1+1 |
704 05d4 DC93 st X,r29 |
705 05d6 CE93 st -X,r28 |
706 05d8 1197 sbiw r26,1 |
707 05da 80E0 ldi r24,lo8(__c.2282) |
708 05dc 90E0 ldi r25,hi8(__c.2282) |
709 05de 9383 std Z+3,r25 |
710 05e0 8283 std Z+2,r24 |
711 05e2 3583 std Z+5,r19 |
712 05e4 2483 std Z+4,r18 |
713 05e6 5783 std Z+7,r21 |
714 05e8 4683 std Z+6,r20 |
715 05ea E091 0000 lds r30,_printf_P |
716 05ee F091 0000 lds r31,(_printf_P)+1 |
717 05f2 0995 icall |
718 05f4 88E2 ldi r24,lo8(40) |
719 05f6 8093 0000 sts DispPtr,r24 |
720 05fa 2091 0000 lds r18,PPM_in+10 |
721 05fe 3091 0000 lds r19,(PPM_in+10)+1 |
722 0602 4091 0000 lds r20,PPM_in+12 |
723 0606 5091 0000 lds r21,(PPM_in+12)+1 |
724 060a EDB7 in r30,__SP_L__ |
725 060c FEB7 in r31,__SP_H__ |
726 060e 3196 adiw r30,1 |
727 0610 ADB7 in r26,__SP_L__ |
728 0612 BEB7 in r27,__SP_H__ |
729 0614 1296 adiw r26,1+1 |
730 0616 DC93 st X,r29 |
731 0618 CE93 st -X,r28 |
732 061a 1197 sbiw r26,1 |
733 061c 80E0 ldi r24,lo8(__c.2284) |
734 061e 90E0 ldi r25,hi8(__c.2284) |
735 0620 9383 std Z+3,r25 |
736 0622 8283 std Z+2,r24 |
737 0624 3583 std Z+5,r19 |
738 0626 2483 std Z+4,r18 |
739 0628 5783 std Z+7,r21 |
740 062a 4683 std Z+6,r20 |
741 062c E091 0000 lds r30,_printf_P |
742 0630 F091 0000 lds r31,(_printf_P)+1 |
743 0634 0995 icall |
744 0636 8CE3 ldi r24,lo8(60) |
745 0638 8093 0000 sts DispPtr,r24 |
746 063c 2091 0000 lds r18,PPM_in+14 |
747 0640 3091 0000 lds r19,(PPM_in+14)+1 |
748 0644 4091 0000 lds r20,PPM_in+16 |
749 0648 5091 0000 lds r21,(PPM_in+16)+1 |
750 064c EDB7 in r30,__SP_L__ |
751 064e FEB7 in r31,__SP_H__ |
752 0650 3196 adiw r30,1 |
753 0652 ADB7 in r26,__SP_L__ |
754 0654 BEB7 in r27,__SP_H__ |
755 0656 1296 adiw r26,1+1 |
756 0658 DC93 st X,r29 |
757 065a CE93 st -X,r28 |
758 065c 1197 sbiw r26,1 |
759 065e 80E0 ldi r24,lo8(__c.2286) |
760 0660 90E0 ldi r25,hi8(__c.2286) |
761 0662 9383 std Z+3,r25 |
762 0664 8283 std Z+2,r24 |
763 0666 3583 std Z+5,r19 |
764 0668 2483 std Z+4,r18 |
765 066a 5783 std Z+7,r21 |
766 066c 4683 std Z+6,r20 |
767 066e 00C0 rjmp .L55 |
768 .L21: |
769 0670 1092 0000 sts DispPtr,__zero_reg__ |
770 0674 E091 0000 lds r30,EE_Parameter+1 |
771 0678 F0E0 ldi r31,lo8(0) |
772 067a EE0F lsl r30 |
773 067c FF1F rol r31 |
774 067e E050 subi r30,lo8(-(PPM_in)) |
775 0680 F040 sbci r31,hi8(-(PPM_in)) |
776 0682 4081 ld r20,Z |
777 0684 5181 ldd r21,Z+1 |
778 0686 E091 0000 lds r30,EE_Parameter+2 |
779 068a F0E0 ldi r31,lo8(0) |
780 068c EE0F lsl r30 |
781 068e FF1F rol r31 |
782 0690 E050 subi r30,lo8(-(PPM_in)) |
783 0692 F040 sbci r31,hi8(-(PPM_in)) |
784 0694 2081 ld r18,Z |
785 0696 3181 ldd r19,Z+1 |
786 0698 8DB7 in r24,__SP_L__ |
787 069a 9EB7 in r25,__SP_H__ |
788 069c 0897 sbiw r24,8 |
789 069e 8DBF out __SP_L__,r24 |
790 06a0 EDB7 in r30,__SP_L__ |
791 06a2 FEB7 in r31,__SP_H__ |
792 06a4 3196 adiw r30,1 |
793 06a6 ADB7 in r26,__SP_L__ |
794 06a8 BEB7 in r27,__SP_H__ |
795 06aa 1296 adiw r26,1+1 |
796 06ac DC93 st X,r29 |
797 06ae CE93 st -X,r28 |
798 06b0 1197 sbiw r26,1 |
799 06b2 80E0 ldi r24,lo8(__c.2289) |
800 06b4 90E0 ldi r25,hi8(__c.2289) |
801 06b6 9383 std Z+3,r25 |
802 06b8 8283 std Z+2,r24 |
803 06ba 5583 std Z+5,r21 |
804 06bc 4483 std Z+4,r20 |
805 06be 3783 std Z+7,r19 |
806 06c0 2683 std Z+6,r18 |
807 06c2 E091 0000 lds r30,_printf_P |
808 06c6 F091 0000 lds r31,(_printf_P)+1 |
809 06ca 0995 icall |
810 06cc 84E1 ldi r24,lo8(20) |
811 06ce 8093 0000 sts DispPtr,r24 |
812 06d2 E091 0000 lds r30,EE_Parameter+3 |
813 06d6 F0E0 ldi r31,lo8(0) |
814 06d8 EE0F lsl r30 |
815 06da FF1F rol r31 |
816 06dc E050 subi r30,lo8(-(PPM_in)) |
817 06de F040 sbci r31,hi8(-(PPM_in)) |
818 06e0 2081 ld r18,Z |
819 06e2 3181 ldd r19,Z+1 |
820 06e4 E091 0000 lds r30,EE_Parameter+4 |
821 06e8 F0E0 ldi r31,lo8(0) |
822 06ea EE0F lsl r30 |
823 06ec FF1F rol r31 |
824 06ee E050 subi r30,lo8(-(PPM_in)) |
825 06f0 F040 sbci r31,hi8(-(PPM_in)) |
826 06f2 4081 ld r20,Z |
827 06f4 5181 ldd r21,Z+1 |
828 06f6 EDB7 in r30,__SP_L__ |
829 06f8 FEB7 in r31,__SP_H__ |
830 06fa 3196 adiw r30,1 |
831 06fc ADB7 in r26,__SP_L__ |
832 06fe BEB7 in r27,__SP_H__ |
833 0700 1296 adiw r26,1+1 |
834 0702 DC93 st X,r29 |
835 0704 CE93 st -X,r28 |
836 0706 1197 sbiw r26,1 |
837 0708 80E0 ldi r24,lo8(__c.2291) |
838 070a 90E0 ldi r25,hi8(__c.2291) |
839 070c 9383 std Z+3,r25 |
840 070e 8283 std Z+2,r24 |
841 0710 2858 subi r18,lo8(-(120)) |
842 0712 3F4F sbci r19,hi8(-(120)) |
843 0714 3583 std Z+5,r19 |
844 0716 2483 std Z+4,r18 |
845 0718 5783 std Z+7,r21 |
846 071a 4683 std Z+6,r20 |
847 071c E091 0000 lds r30,_printf_P |
848 0720 F091 0000 lds r31,(_printf_P)+1 |
849 0724 0995 icall |
850 0726 88E2 ldi r24,lo8(40) |
851 0728 8093 0000 sts DispPtr,r24 |
852 072c E091 0000 lds r30,EE_Parameter+5 |
853 0730 F0E0 ldi r31,lo8(0) |
854 0732 EE0F lsl r30 |
855 0734 FF1F rol r31 |
856 0736 E050 subi r30,lo8(-(PPM_in)) |
857 0738 F040 sbci r31,hi8(-(PPM_in)) |
858 073a 4081 ld r20,Z |
859 073c 5181 ldd r21,Z+1 |
860 073e E091 0000 lds r30,EE_Parameter+6 |
861 0742 F0E0 ldi r31,lo8(0) |
862 0744 EE0F lsl r30 |
863 0746 FF1F rol r31 |
864 0748 E050 subi r30,lo8(-(PPM_in)) |
865 074a F040 sbci r31,hi8(-(PPM_in)) |
866 074c 2081 ld r18,Z |
867 074e 3181 ldd r19,Z+1 |
868 0750 EDB7 in r30,__SP_L__ |
869 0752 FEB7 in r31,__SP_H__ |
870 0754 3196 adiw r30,1 |
871 0756 ADB7 in r26,__SP_L__ |
872 0758 BEB7 in r27,__SP_H__ |
873 075a 1296 adiw r26,1+1 |
874 075c DC93 st X,r29 |
875 075e CE93 st -X,r28 |
876 0760 1197 sbiw r26,1 |
877 0762 80E0 ldi r24,lo8(__c.2293) |
878 0764 90E0 ldi r25,hi8(__c.2293) |
879 0766 9383 std Z+3,r25 |
880 0768 8283 std Z+2,r24 |
881 076a 4259 subi r20,lo8(-(110)) |
882 076c 5F4F sbci r21,hi8(-(110)) |
883 076e 5583 std Z+5,r21 |
884 0770 4483 std Z+4,r20 |
885 0772 2259 subi r18,lo8(-(110)) |
886 0774 3F4F sbci r19,hi8(-(110)) |
887 0776 3783 std Z+7,r19 |
888 0778 2683 std Z+6,r18 |
889 077a E091 0000 lds r30,_printf_P |
890 077e F091 0000 lds r31,(_printf_P)+1 |
891 0782 0995 icall |
892 0784 8CE3 ldi r24,lo8(60) |
893 0786 8093 0000 sts DispPtr,r24 |
894 078a E091 0000 lds r30,EE_Parameter+7 |
895 078e F0E0 ldi r31,lo8(0) |
896 0790 EE0F lsl r30 |
897 0792 FF1F rol r31 |
898 0794 E050 subi r30,lo8(-(PPM_in)) |
899 0796 F040 sbci r31,hi8(-(PPM_in)) |
900 0798 4081 ld r20,Z |
901 079a 5181 ldd r21,Z+1 |
902 079c E091 0000 lds r30,EE_Parameter+8 |
903 07a0 F0E0 ldi r31,lo8(0) |
904 07a2 EE0F lsl r30 |
905 07a4 FF1F rol r31 |
906 07a6 E050 subi r30,lo8(-(PPM_in)) |
907 07a8 F040 sbci r31,hi8(-(PPM_in)) |
908 07aa 2081 ld r18,Z |
909 07ac 3181 ldd r19,Z+1 |
910 07ae EDB7 in r30,__SP_L__ |
911 07b0 FEB7 in r31,__SP_H__ |
912 07b2 3196 adiw r30,1 |
913 07b4 ADB7 in r26,__SP_L__ |
914 07b6 BEB7 in r27,__SP_H__ |
915 07b8 1296 adiw r26,1+1 |
916 07ba DC93 st X,r29 |
917 07bc CE93 st -X,r28 |
918 07be 1197 sbiw r26,1 |
919 07c0 80E0 ldi r24,lo8(__c.2295) |
920 07c2 90E0 ldi r25,hi8(__c.2295) |
921 07c4 9383 std Z+3,r25 |
922 07c6 8283 std Z+2,r24 |
923 07c8 4259 subi r20,lo8(-(110)) |
924 07ca 5F4F sbci r21,hi8(-(110)) |
925 07cc 5583 std Z+5,r21 |
926 07ce 4483 std Z+4,r20 |
927 07d0 2259 subi r18,lo8(-(110)) |
928 07d2 3F4F sbci r19,hi8(-(110)) |
929 07d4 00C0 rjmp .L58 |
930 .L22: |
931 07d6 1092 0000 sts DispPtr,__zero_reg__ |
932 07da 00D0 rcall . |
933 07dc 00D0 rcall . |
934 07de ADB7 in r26,__SP_L__ |
935 07e0 BEB7 in r27,__SP_H__ |
936 07e2 1296 adiw r26,1+1 |
937 07e4 DC93 st X,r29 |
938 07e6 CE93 st -X,r28 |
939 07e8 1197 sbiw r26,1 |
940 07ea 80E0 ldi r24,lo8(__c.2298) |
941 07ec 90E0 ldi r25,hi8(__c.2298) |
942 07ee 1496 adiw r26,3+1 |
943 07f0 9C93 st X,r25 |
944 07f2 8E93 st -X,r24 |
945 07f4 1397 sbiw r26,3 |
946 07f6 E091 0000 lds r30,_printf_P |
947 07fa F091 0000 lds r31,(_printf_P)+1 |
948 07fe 0995 icall |
949 0800 8091 0000 lds r24,PlatinenVersion |
950 0804 0F90 pop __tmp_reg__ |
951 0806 0F90 pop __tmp_reg__ |
952 0808 0F90 pop __tmp_reg__ |
953 080a 0F90 pop __tmp_reg__ |
954 080c 8A30 cpi r24,lo8(10) |
955 080e 01F0 breq .+2 |
956 0810 00C0 rjmp .L41 |
957 0812 84E1 ldi r24,lo8(20) |
958 0814 8093 0000 sts DispPtr,r24 |
959 0818 2091 0000 lds r18,AdWertNick |
960 081c 3091 0000 lds r19,(AdWertNick)+1 |
961 0820 0091 0000 lds r16,AdNeutralNick |
962 0824 1091 0000 lds r17,(AdNeutralNick)+1 |
963 0828 EDB7 in r30,__SP_L__ |
964 082a FEB7 in r31,__SP_H__ |
965 082c 3A97 sbiw r30,10 |
966 082e EDBF out __SP_L__,r30 |
967 0830 3196 adiw r30,1 |
968 0832 ADB7 in r26,__SP_L__ |
969 0834 BEB7 in r27,__SP_H__ |
970 0836 1296 adiw r26,1+1 |
971 0838 DC93 st X,r29 |
972 083a CE93 st -X,r28 |
973 083c 1197 sbiw r26,1 |
974 083e 80E0 ldi r24,lo8(__c.2300) |
975 0840 90E0 ldi r25,hi8(__c.2300) |
976 0842 9383 std Z+3,r25 |
977 0844 8283 std Z+2,r24 |
978 0846 C801 movw r24,r16 |
979 0848 68E0 ldi r22,lo8(8) |
980 084a 70E0 ldi r23,hi8(8) |
981 084c 0E94 0000 call __divmodhi4 |
982 0850 261B sub r18,r22 |
983 0852 370B sbc r19,r23 |
984 0854 3583 std Z+5,r19 |
985 0856 2483 std Z+4,r18 |
986 0858 C801 movw r24,r16 |
987 085a 68E0 ldi r22,lo8(8) |
988 085c 70E0 ldi r23,hi8(8) |
989 085e 0E94 0000 call __divmodhi4 |
990 0862 7783 std Z+7,r23 |
991 0864 6683 std Z+6,r22 |
992 0866 C801 movw r24,r16 |
993 0868 68E0 ldi r22,lo8(8) |
994 086a 70E0 ldi r23,hi8(8) |
995 086c 0E94 0000 call __divmodhi4 |
996 0870 9187 std Z+9,r25 |
997 0872 8087 std Z+8,r24 |
998 0874 E091 0000 lds r30,_printf_P |
999 0878 F091 0000 lds r31,(_printf_P)+1 |
1000 087c 0995 icall |
1001 087e 88E2 ldi r24,lo8(40) |
1002 0880 8093 0000 sts DispPtr,r24 |
1003 0884 2091 0000 lds r18,AdWertRoll |
1004 0888 3091 0000 lds r19,(AdWertRoll)+1 |
1005 088c 0091 0000 lds r16,AdNeutralRoll |
1006 0890 1091 0000 lds r17,(AdNeutralRoll)+1 |
1007 0894 EDB7 in r30,__SP_L__ |
1008 0896 FEB7 in r31,__SP_H__ |
1009 0898 3196 adiw r30,1 |
1010 089a ADB7 in r26,__SP_L__ |
1011 089c BEB7 in r27,__SP_H__ |
1012 089e 1296 adiw r26,1+1 |
1013 08a0 DC93 st X,r29 |
1014 08a2 CE93 st -X,r28 |
1015 08a4 1197 sbiw r26,1 |
1016 08a6 80E0 ldi r24,lo8(__c.2302) |
1017 08a8 90E0 ldi r25,hi8(__c.2302) |
1018 08aa 9383 std Z+3,r25 |
1019 08ac 8283 std Z+2,r24 |
1020 08ae C801 movw r24,r16 |
1021 08b0 68E0 ldi r22,lo8(8) |
1022 08b2 70E0 ldi r23,hi8(8) |
1023 08b4 0E94 0000 call __divmodhi4 |
1024 08b8 261B sub r18,r22 |
1025 08ba 370B sbc r19,r23 |
1026 08bc 3583 std Z+5,r19 |
1027 08be 2483 std Z+4,r18 |
1028 08c0 C801 movw r24,r16 |
1029 08c2 68E0 ldi r22,lo8(8) |
1030 08c4 70E0 ldi r23,hi8(8) |
1031 08c6 0E94 0000 call __divmodhi4 |
1032 08ca 7783 std Z+7,r23 |
1033 08cc 6683 std Z+6,r22 |
1034 08ce C801 movw r24,r16 |
1035 08d0 68E0 ldi r22,lo8(8) |
1036 08d2 70E0 ldi r23,hi8(8) |
1037 08d4 0E94 0000 call __divmodhi4 |
1038 08d8 9187 std Z+9,r25 |
1039 08da 8087 std Z+8,r24 |
1040 08dc E091 0000 lds r30,_printf_P |
1041 08e0 F091 0000 lds r31,(_printf_P)+1 |
1042 08e4 0995 icall |
1043 08e6 8CE3 ldi r24,lo8(60) |
1044 08e8 8093 0000 sts DispPtr,r24 |
1045 08ec 2091 0000 lds r18,AdNeutralGier |
1046 08f0 3091 0000 lds r19,(AdNeutralGier)+1 |
1047 08f4 4091 0000 lds r20,AdWertGier |
1048 08f8 5091 0000 lds r21,(AdWertGier)+1 |
1049 08fc 0F90 pop __tmp_reg__ |
1050 08fe 0F90 pop __tmp_reg__ |
1051 0900 EDB7 in r30,__SP_L__ |
1052 0902 FEB7 in r31,__SP_H__ |
1053 0904 3196 adiw r30,1 |
1054 0906 ADB7 in r26,__SP_L__ |
1055 0908 BEB7 in r27,__SP_H__ |
1056 090a 1296 adiw r26,1+1 |
1057 090c DC93 st X,r29 |
1058 090e CE93 st -X,r28 |
1059 0910 1197 sbiw r26,1 |
1060 0912 80E0 ldi r24,lo8(__c.2304) |
1061 0914 90E0 ldi r25,hi8(__c.2304) |
1062 0916 9383 std Z+3,r25 |
1063 0918 8283 std Z+2,r24 |
1064 091a C901 movw r24,r18 |
1065 091c 841B sub r24,r20 |
1066 091e 950B sbc r25,r21 |
1067 0920 9583 std Z+5,r25 |
1068 0922 8483 std Z+4,r24 |
1069 .L58: |
1070 0924 3783 std Z+7,r19 |
1071 0926 2683 std Z+6,r18 |
1072 0928 00C0 rjmp .L55 |
1073 .L41: |
1074 092a 8B30 cpi r24,lo8(11) |
1075 092c 01F0 breq .L42 |
1076 092e 8431 cpi r24,lo8(20) |
1077 0930 00F4 brsh .+2 |
1078 0932 00C0 rjmp .L43 |
1079 .L42: |
1080 0934 84E1 ldi r24,lo8(20) |
1081 0936 8093 0000 sts DispPtr,r24 |
1082 093a 2091 0000 lds r18,AdWertNick |
1083 093e 3091 0000 lds r19,(AdWertNick)+1 |
1084 0942 0091 0000 lds r16,AdNeutralNick |
1085 0946 1091 0000 lds r17,(AdNeutralNick)+1 |
1086 094a 8DB7 in r24,__SP_L__ |
1087 094c 9EB7 in r25,__SP_H__ |
1088 094e 0A97 sbiw r24,10 |
1089 0950 8DBF out __SP_L__,r24 |
1090 0952 EDB7 in r30,__SP_L__ |
1091 0954 FEB7 in r31,__SP_H__ |
1092 0956 3196 adiw r30,1 |
1093 0958 40E0 ldi r20,lo8(gs(Menu_Putchar)) |
1094 095a E42E mov r14,r20 |
1095 095c 40E0 ldi r20,hi8(gs(Menu_Putchar)) |
1096 095e F42E mov r15,r20 |
1097 0960 ADB7 in r26,__SP_L__ |
1098 0962 BEB7 in r27,__SP_H__ |
1099 0964 1296 adiw r26,1+1 |
1100 0966 FC92 st X,r15 |
1101 0968 EE92 st -X,r14 |
1102 096a 1197 sbiw r26,1 |
1103 096c 80E0 ldi r24,lo8(__c.2306) |
1104 096e 90E0 ldi r25,hi8(__c.2306) |
1105 0970 9383 std Z+3,r25 |
1106 0972 8283 std Z+2,r24 |
1107 0974 C801 movw r24,r16 |
1108 0976 68E0 ldi r22,lo8(8) |
1109 0978 70E0 ldi r23,hi8(8) |
1110 097a 0E94 0000 call __divmodhi4 |
1111 097e 261B sub r18,r22 |
1112 0980 370B sbc r19,r23 |
1113 0982 3583 std Z+5,r19 |
1114 0984 2483 std Z+4,r18 |
1115 0986 C801 movw r24,r16 |
1116 0988 60E1 ldi r22,lo8(16) |
1117 098a 70E0 ldi r23,hi8(16) |
1118 098c 0E94 0000 call __divmodhi4 |
1119 0990 7783 std Z+7,r23 |
1120 0992 6683 std Z+6,r22 |
1121 0994 C801 movw r24,r16 |
1122 0996 60E1 ldi r22,lo8(16) |
1123 0998 70E0 ldi r23,hi8(16) |
1124 099a 0E94 0000 call __divmodhi4 |
1125 099e 62E0 ldi r22,lo8(2) |
1126 09a0 70E0 ldi r23,hi8(2) |
1127 09a2 0E94 0000 call __divmodhi4 |
1128 09a6 7187 std Z+9,r23 |
1129 09a8 6087 std Z+8,r22 |
1130 09aa E091 0000 lds r30,_printf_P |
1131 09ae F091 0000 lds r31,(_printf_P)+1 |
1132 09b2 0995 icall |
1133 09b4 88E2 ldi r24,lo8(40) |
1134 09b6 8093 0000 sts DispPtr,r24 |
1135 09ba 2091 0000 lds r18,AdWertRoll |
1136 09be 3091 0000 lds r19,(AdWertRoll)+1 |
1137 09c2 E091 0000 lds r30,AdNeutralRoll |
1138 09c6 F091 0000 lds r31,(AdNeutralRoll)+1 |
1139 09ca 0DB7 in r16,__SP_L__ |
1140 09cc 1EB7 in r17,__SP_H__ |
1141 09ce 0F5F subi r16,lo8(-(1)) |
1142 09d0 1F4F sbci r17,hi8(-(1)) |
1143 09d2 ADB7 in r26,__SP_L__ |
1144 09d4 BEB7 in r27,__SP_H__ |
1145 09d6 1296 adiw r26,1+1 |
1146 09d8 FC92 st X,r15 |
1147 09da EE92 st -X,r14 |
1148 09dc 1197 sbiw r26,1 |
1149 09de 80E0 ldi r24,lo8(__c.2308) |
1150 09e0 90E0 ldi r25,hi8(__c.2308) |
1151 09e2 D801 movw r26,r16 |
1152 09e4 1396 adiw r26,2+1 |
1153 09e6 9C93 st X,r25 |
1154 09e8 8E93 st -X,r24 |
1155 09ea 1297 sbiw r26,2 |
1156 09ec CF01 movw r24,r30 |
1157 09ee 68E0 ldi r22,lo8(8) |
1158 09f0 70E0 ldi r23,hi8(8) |
1159 09f2 0E94 0000 call __divmodhi4 |
1160 09f6 261B sub r18,r22 |
1161 09f8 370B sbc r19,r23 |
1162 09fa D801 movw r26,r16 |
1163 09fc 1596 adiw r26,4+1 |
1164 09fe 3C93 st X,r19 |
1165 0a00 2E93 st -X,r18 |
1166 0a02 1497 sbiw r26,4 |
1167 0a04 CF01 movw r24,r30 |
1168 0a06 60E1 ldi r22,lo8(16) |
1169 0a08 70E0 ldi r23,hi8(16) |
1170 0a0a 0E94 0000 call __divmodhi4 |
1171 0a0e D801 movw r26,r16 |
1172 0a10 1796 adiw r26,6+1 |
1173 0a12 7C93 st X,r23 |
1174 0a14 6E93 st -X,r22 |
1175 0a16 1697 sbiw r26,6 |
1176 0a18 CF01 movw r24,r30 |
1177 0a1a 60E1 ldi r22,lo8(16) |
1178 0a1c 70E0 ldi r23,hi8(16) |
1179 0a1e 0E94 0000 call __divmodhi4 |
1180 0a22 62E0 ldi r22,lo8(2) |
1181 0a24 70E0 ldi r23,hi8(2) |
1182 0a26 0E94 0000 call __divmodhi4 |
1183 0a2a F801 movw r30,r16 |
1184 0a2c 7187 std Z+9,r23 |
1185 0a2e 6087 std Z+8,r22 |
1186 0a30 E091 0000 lds r30,_printf_P |
1187 0a34 F091 0000 lds r31,(_printf_P)+1 |
1188 0a38 0995 icall |
1189 0a3a 8CE3 ldi r24,lo8(60) |
1190 0a3c 8093 0000 sts DispPtr,r24 |
1191 0a40 8091 0000 lds r24,AdNeutralGier |
1192 0a44 9091 0000 lds r25,(AdNeutralGier)+1 |
1193 0a48 4091 0000 lds r20,AdWertGier |
1194 0a4c 5091 0000 lds r21,(AdWertGier)+1 |
1195 0a50 0F90 pop __tmp_reg__ |
1196 0a52 0F90 pop __tmp_reg__ |
1197 0a54 EDB7 in r30,__SP_L__ |
1198 0a56 FEB7 in r31,__SP_H__ |
1199 0a58 3196 adiw r30,1 |
1200 0a5a ADB7 in r26,__SP_L__ |
1201 0a5c BEB7 in r27,__SP_H__ |
1202 0a5e 1296 adiw r26,1+1 |
1203 0a60 FC92 st X,r15 |
1204 0a62 EE92 st -X,r14 |
1205 0a64 1197 sbiw r26,1 |
1206 0a66 20E0 ldi r18,lo8(__c.2310) |
1207 0a68 30E0 ldi r19,hi8(__c.2310) |
1208 0a6a 3383 std Z+3,r19 |
1209 0a6c 2283 std Z+2,r18 |
1210 0a6e 9C01 movw r18,r24 |
1211 0a70 241B sub r18,r20 |
1212 0a72 350B sbc r19,r21 |
1213 0a74 3583 std Z+5,r19 |
1214 0a76 2483 std Z+4,r18 |
1215 0a78 62E0 ldi r22,lo8(2) |
1216 0a7a 70E0 ldi r23,hi8(2) |
1217 0a7c 0E94 0000 call __divmodhi4 |
1218 0a80 7783 std Z+7,r23 |
1219 0a82 6683 std Z+6,r22 |
1220 .L55: |
1221 0a84 E091 0000 lds r30,_printf_P |
1222 0a88 F091 0000 lds r31,(_printf_P)+1 |
1223 0a8c 0995 icall |
1224 0a8e EDB7 in r30,__SP_L__ |
1225 0a90 FEB7 in r31,__SP_H__ |
1226 0a92 3896 adiw r30,8 |
1227 0a94 00C0 rjmp .L54 |
1228 .L43: |
1229 0a96 8D30 cpi r24,lo8(13) |
1230 0a98 01F0 breq .+2 |
1231 0a9a 00C0 rjmp .L37 |
1232 0a9c 84E1 ldi r24,lo8(20) |
1233 0a9e 8093 0000 sts DispPtr,r24 |
1234 0aa2 2091 0000 lds r18,AdWertNick |
1235 0aa6 3091 0000 lds r19,(AdWertNick)+1 |
1236 0aaa 0091 0000 lds r16,AdNeutralNick |
1237 0aae 1091 0000 lds r17,(AdNeutralNick)+1 |
1238 0ab2 8DB7 in r24,__SP_L__ |
1239 0ab4 9EB7 in r25,__SP_H__ |
1240 0ab6 0A97 sbiw r24,10 |
1241 0ab8 8DBF out __SP_L__,r24 |
1242 0aba EDB7 in r30,__SP_L__ |
1243 0abc FEB7 in r31,__SP_H__ |
1244 0abe 3196 adiw r30,1 |
1245 0ac0 ADB7 in r26,__SP_L__ |
1246 0ac2 BEB7 in r27,__SP_H__ |
1247 0ac4 1296 adiw r26,1+1 |
1248 0ac6 DC93 st X,r29 |
1249 0ac8 CE93 st -X,r28 |
1250 0aca 1197 sbiw r26,1 |
1251 0acc 80E0 ldi r24,lo8(__c.2312) |
1252 0ace 90E0 ldi r25,hi8(__c.2312) |
1253 0ad0 9383 std Z+3,r25 |
1254 0ad2 8283 std Z+2,r24 |
1255 0ad4 C801 movw r24,r16 |
1256 0ad6 68E0 ldi r22,lo8(8) |
1257 0ad8 70E0 ldi r23,hi8(8) |
1258 0ada 0E94 0000 call __divmodhi4 |
1259 0ade 261B sub r18,r22 |
1260 0ae0 370B sbc r19,r23 |
1261 0ae2 3583 std Z+5,r19 |
1262 0ae4 2483 std Z+4,r18 |
1263 0ae6 C801 movw r24,r16 |
1264 0ae8 60E1 ldi r22,lo8(16) |
1265 0aea 70E0 ldi r23,hi8(16) |
1266 0aec 0E94 0000 call __divmodhi4 |
1267 0af0 7783 std Z+7,r23 |
1268 0af2 6683 std Z+6,r22 |
1269 0af4 8091 0000 lds r24,AnalogOffsetNick |
1270 0af8 8087 std Z+8,r24 |
1271 0afa 1186 std Z+9,__zero_reg__ |
1272 0afc E091 0000 lds r30,_printf_P |
1273 0b00 F091 0000 lds r31,(_printf_P)+1 |
1274 0b04 0995 icall |
1275 0b06 88E2 ldi r24,lo8(40) |
1276 0b08 8093 0000 sts DispPtr,r24 |
1277 0b0c 2091 0000 lds r18,AdWertRoll |
1278 0b10 3091 0000 lds r19,(AdWertRoll)+1 |
1279 0b14 0091 0000 lds r16,AdNeutralRoll |
1280 0b18 1091 0000 lds r17,(AdNeutralRoll)+1 |
1281 0b1c EDB7 in r30,__SP_L__ |
1282 0b1e FEB7 in r31,__SP_H__ |
1283 0b20 3196 adiw r30,1 |
1284 0b22 ADB7 in r26,__SP_L__ |
1285 0b24 BEB7 in r27,__SP_H__ |
1286 0b26 1296 adiw r26,1+1 |
1287 0b28 DC93 st X,r29 |
1288 0b2a CE93 st -X,r28 |
1289 0b2c 1197 sbiw r26,1 |
1290 0b2e 80E0 ldi r24,lo8(__c.2314) |
1291 0b30 90E0 ldi r25,hi8(__c.2314) |
1292 0b32 9383 std Z+3,r25 |
1293 0b34 8283 std Z+2,r24 |
1294 0b36 C801 movw r24,r16 |
1295 0b38 68E0 ldi r22,lo8(8) |
1296 0b3a 70E0 ldi r23,hi8(8) |
1297 0b3c 0E94 0000 call __divmodhi4 |
1298 0b40 261B sub r18,r22 |
1299 0b42 370B sbc r19,r23 |
1300 0b44 3583 std Z+5,r19 |
1301 0b46 2483 std Z+4,r18 |
1302 0b48 C801 movw r24,r16 |
1303 0b4a 60E1 ldi r22,lo8(16) |
1304 0b4c 70E0 ldi r23,hi8(16) |
1305 0b4e 0E94 0000 call __divmodhi4 |
1306 0b52 7783 std Z+7,r23 |
1307 0b54 6683 std Z+6,r22 |
1308 0b56 8091 0000 lds r24,AnalogOffsetRoll |
1309 0b5a 8087 std Z+8,r24 |
1310 0b5c 1186 std Z+9,__zero_reg__ |
1311 0b5e E091 0000 lds r30,_printf_P |
1312 0b62 F091 0000 lds r31,(_printf_P)+1 |
1313 0b66 0995 icall |
1314 0b68 8CE3 ldi r24,lo8(60) |
1315 0b6a 8093 0000 sts DispPtr,r24 |
1316 0b6e 8091 0000 lds r24,AdNeutralGier |
1317 0b72 9091 0000 lds r25,(AdNeutralGier)+1 |
1318 0b76 4091 0000 lds r20,AdWertGier |
1319 0b7a 5091 0000 lds r21,(AdWertGier)+1 |
1320 0b7e EDB7 in r30,__SP_L__ |
1321 0b80 FEB7 in r31,__SP_H__ |
1322 0b82 3196 adiw r30,1 |
1323 0b84 ADB7 in r26,__SP_L__ |
1324 0b86 BEB7 in r27,__SP_H__ |
1325 0b88 1296 adiw r26,1+1 |
1326 0b8a DC93 st X,r29 |
1327 0b8c CE93 st -X,r28 |
1328 0b8e 1197 sbiw r26,1 |
1329 0b90 20E0 ldi r18,lo8(__c.2316) |
1330 0b92 30E0 ldi r19,hi8(__c.2316) |
1331 0b94 3383 std Z+3,r19 |
1332 0b96 2283 std Z+2,r18 |
1333 0b98 9C01 movw r18,r24 |
1334 0b9a 241B sub r18,r20 |
1335 0b9c 350B sbc r19,r21 |
1336 0b9e 3583 std Z+5,r19 |
1337 0ba0 2483 std Z+4,r18 |
1338 0ba2 62E0 ldi r22,lo8(2) |
1339 0ba4 70E0 ldi r23,hi8(2) |
1340 0ba6 0E94 0000 call __divmodhi4 |
1341 0baa 7783 std Z+7,r23 |
1342 0bac 6683 std Z+6,r22 |
1343 0bae 8091 0000 lds r24,AnalogOffsetGier |
1344 0bb2 8087 std Z+8,r24 |
1345 0bb4 1186 std Z+9,__zero_reg__ |
1346 0bb6 E091 0000 lds r30,_printf_P |
1347 0bba F091 0000 lds r31,(_printf_P)+1 |
1348 0bbe 0995 icall |
1349 0bc0 EDB7 in r30,__SP_L__ |
1350 0bc2 FEB7 in r31,__SP_H__ |
1351 0bc4 3A96 adiw r30,10 |
1352 0bc6 00C0 rjmp .L54 |
1353 .L23: |
1354 0bc8 1092 0000 sts DispPtr,__zero_reg__ |
1355 0bcc 00D0 rcall . |
1356 0bce 00D0 rcall . |
1357 0bd0 ADB7 in r26,__SP_L__ |
1358 0bd2 BEB7 in r27,__SP_H__ |
1359 0bd4 1296 adiw r26,1+1 |
1360 0bd6 DC93 st X,r29 |
1361 0bd8 CE93 st -X,r28 |
1362 0bda 1197 sbiw r26,1 |
1363 0bdc 80E0 ldi r24,lo8(__c.2319) |
1364 0bde 90E0 ldi r25,hi8(__c.2319) |
1365 0be0 1496 adiw r26,3+1 |
1366 0be2 9C93 st X,r25 |
1367 0be4 8E93 st -X,r24 |
1368 0be6 1397 sbiw r26,3 |
1369 0be8 E091 0000 lds r30,_printf_P |
1370 0bec F091 0000 lds r31,(_printf_P)+1 |
1371 0bf0 0995 icall |
1372 0bf2 84E1 ldi r24,lo8(20) |
1373 0bf4 8093 0000 sts DispPtr,r24 |
1374 0bf8 2091 0000 lds r18,AdWertAccNick |
1375 0bfc 3091 0000 lds r19,(AdWertAccNick)+1 |
1376 0c00 00D0 rcall . |
1377 0c02 00D0 rcall . |
1378 0c04 EDB7 in r30,__SP_L__ |
1379 0c06 FEB7 in r31,__SP_H__ |
1380 0c08 3196 adiw r30,1 |
1381 0c0a ADB7 in r26,__SP_L__ |
1382 0c0c BEB7 in r27,__SP_H__ |
1383 0c0e 1296 adiw r26,1+1 |
1384 0c10 DC93 st X,r29 |
1385 0c12 CE93 st -X,r28 |
1386 0c14 1197 sbiw r26,1 |
1387 0c16 80E0 ldi r24,lo8(__c.2321) |
1388 0c18 90E0 ldi r25,hi8(__c.2321) |
1389 0c1a 9383 std Z+3,r25 |
1390 0c1c 8283 std Z+2,r24 |
1391 0c1e 3583 std Z+5,r19 |
1392 0c20 2483 std Z+4,r18 |
1393 0c22 8091 0000 lds r24,NeutralAccX |
1394 0c26 9091 0000 lds r25,(NeutralAccX)+1 |
1395 0c2a 9783 std Z+7,r25 |
1396 0c2c 8683 std Z+6,r24 |
1397 0c2e E091 0000 lds r30,_printf_P |
1398 0c32 F091 0000 lds r31,(_printf_P)+1 |
1399 0c36 0995 icall |
1400 0c38 88E2 ldi r24,lo8(40) |
1401 0c3a 8093 0000 sts DispPtr,r24 |
1402 0c3e 2091 0000 lds r18,AdWertAccRoll |
1403 0c42 3091 0000 lds r19,(AdWertAccRoll)+1 |
1404 0c46 EDB7 in r30,__SP_L__ |
1405 0c48 FEB7 in r31,__SP_H__ |
1406 0c4a 3196 adiw r30,1 |
1407 0c4c ADB7 in r26,__SP_L__ |
1408 0c4e BEB7 in r27,__SP_H__ |
1409 0c50 1296 adiw r26,1+1 |
1410 0c52 DC93 st X,r29 |
1411 0c54 CE93 st -X,r28 |
1412 0c56 1197 sbiw r26,1 |
1413 0c58 80E0 ldi r24,lo8(__c.2323) |
1414 0c5a 90E0 ldi r25,hi8(__c.2323) |
1415 0c5c 9383 std Z+3,r25 |
1416 0c5e 8283 std Z+2,r24 |
1417 0c60 3583 std Z+5,r19 |
1418 0c62 2483 std Z+4,r18 |
1419 0c64 8091 0000 lds r24,NeutralAccY |
1420 0c68 9091 0000 lds r25,(NeutralAccY)+1 |
1421 0c6c 9783 std Z+7,r25 |
1422 0c6e 8683 std Z+6,r24 |
1423 0c70 E091 0000 lds r30,_printf_P |
1424 0c74 F091 0000 lds r31,(_printf_P)+1 |
1425 0c78 0995 icall |
1426 0c7a 8CE3 ldi r24,lo8(60) |
1427 0c7c 8093 0000 sts DispPtr,r24 |
1428 0c80 2091 0000 lds r18,AdWertAccHoch |
1429 0c84 3091 0000 lds r19,(AdWertAccHoch)+1 |
1430 0c88 EDB7 in r30,__SP_L__ |
1431 0c8a FEB7 in r31,__SP_H__ |
1432 0c8c 3196 adiw r30,1 |
1433 0c8e ADB7 in r26,__SP_L__ |
1434 0c90 BEB7 in r27,__SP_H__ |
1435 0c92 1296 adiw r26,1+1 |
1436 0c94 DC93 st X,r29 |
1437 0c96 CE93 st -X,r28 |
1438 0c98 1197 sbiw r26,1 |
1439 0c9a 80E0 ldi r24,lo8(__c.2325) |
1440 0c9c 90E0 ldi r25,hi8(__c.2325) |
1441 0c9e 9383 std Z+3,r25 |
1442 0ca0 8283 std Z+2,r24 |
1443 0ca2 3583 std Z+5,r19 |
1444 0ca4 2483 std Z+4,r18 |
1445 0ca6 8091 0000 lds r24,NeutralAccZ |
1446 0caa 9091 0000 lds r25,(NeutralAccZ)+1 |
1447 0cae 9783 std Z+7,r25 |
1448 0cb0 8683 std Z+6,r24 |
1449 0cb2 00C0 rjmp .L55 |
1450 .L24: |
1451 0cb4 1092 0000 sts DispPtr,__zero_reg__ |
1452 0cb8 8091 0000 lds r24,UBat |
1453 0cbc 9091 0000 lds r25,(UBat)+1 |
1454 0cc0 0091 0000 lds r16,UBat |
1455 0cc4 1091 0000 lds r17,(UBat)+1 |
1456 0cc8 2DB7 in r18,__SP_L__ |
1457 0cca 3EB7 in r19,__SP_H__ |
1458 0ccc 2850 subi r18,lo8(-(-8)) |
1459 0cce 3040 sbci r19,hi8(-(-8)) |
1460 0cd0 2DBF out __SP_L__,r18 |
1461 0cd2 EDB7 in r30,__SP_L__ |
1462 0cd4 FEB7 in r31,__SP_H__ |
1463 0cd6 3196 adiw r30,1 |
1464 0cd8 ADB7 in r26,__SP_L__ |
1465 0cda BEB7 in r27,__SP_H__ |
1466 0cdc 1296 adiw r26,1+1 |
1467 0cde DC93 st X,r29 |
1468 0ce0 CE93 st -X,r28 |
1469 0ce2 1197 sbiw r26,1 |
1470 0ce4 20E0 ldi r18,lo8(__c.2328) |
1471 0ce6 30E0 ldi r19,hi8(__c.2328) |
1472 0ce8 3383 std Z+3,r19 |
1473 0cea 2283 std Z+2,r18 |
1474 0cec 6AE0 ldi r22,lo8(10) |
1475 0cee 70E0 ldi r23,hi8(10) |
1476 0cf0 0E94 0000 call __divmodhi4 |
1477 0cf4 7583 std Z+5,r23 |
1478 0cf6 6483 std Z+4,r22 |
1479 0cf8 C801 movw r24,r16 |
1480 0cfa 6AE0 ldi r22,lo8(10) |
1481 0cfc 70E0 ldi r23,hi8(10) |
1482 0cfe 0E94 0000 call __divmodhi4 |
1483 0d02 9783 std Z+7,r25 |
1484 0d04 8683 std Z+6,r24 |
1485 0d06 E091 0000 lds r30,_printf_P |
1486 0d0a F091 0000 lds r31,(_printf_P)+1 |
1487 0d0e 0995 icall |
1488 0d10 84E1 ldi r24,lo8(20) |
1489 0d12 8093 0000 sts DispPtr,r24 |
1490 0d16 2091 0000 lds r18,Capacity |
1491 0d1a 3091 0000 lds r19,(Capacity)+1 |
1492 0d1e EDB7 in r30,__SP_L__ |
1493 0d20 FEB7 in r31,__SP_H__ |
1494 0d22 3196 adiw r30,1 |
1495 0d24 ADB7 in r26,__SP_L__ |
1496 0d26 BEB7 in r27,__SP_H__ |
1497 0d28 1296 adiw r26,1+1 |
1498 0d2a DC93 st X,r29 |
1499 0d2c CE93 st -X,r28 |
1500 0d2e 1197 sbiw r26,1 |
1501 0d30 80E0 ldi r24,lo8(__c.2330) |
1502 0d32 90E0 ldi r25,hi8(__c.2330) |
1503 0d34 9383 std Z+3,r25 |
1504 0d36 8283 std Z+2,r24 |
1505 0d38 C901 movw r24,r18 |
1506 0d3a 6AE0 ldi r22,lo8(10) |
1507 0d3c 70E0 ldi r23,hi8(10) |
1508 0d3e 0E94 0000 call __udivmodhi4 |
1509 0d42 7583 std Z+5,r23 |
1510 0d44 6483 std Z+4,r22 |
1511 0d46 C901 movw r24,r18 |
1512 0d48 6AE0 ldi r22,lo8(10) |
1513 0d4a 70E0 ldi r23,hi8(10) |
1514 0d4c 0E94 0000 call __udivmodhi4 |
1515 0d50 9783 std Z+7,r25 |
1516 0d52 8683 std Z+6,r24 |
1517 0d54 E091 0000 lds r30,_printf_P |
1518 0d58 F091 0000 lds r31,(_printf_P)+1 |
1519 0d5c 0995 icall |
1520 0d5e 88E2 ldi r24,lo8(40) |
1521 0d60 8093 0000 sts DispPtr,r24 |
1522 0d64 0F90 pop __tmp_reg__ |
1523 0d66 0F90 pop __tmp_reg__ |
1524 0d68 EDB7 in r30,__SP_L__ |
1525 0d6a FEB7 in r31,__SP_H__ |
1526 0d6c 3196 adiw r30,1 |
1527 0d6e ADB7 in r26,__SP_L__ |
1528 0d70 BEB7 in r27,__SP_H__ |
1529 0d72 1296 adiw r26,1+1 |
1530 0d74 DC93 st X,r29 |
1531 0d76 CE93 st -X,r28 |
1532 0d78 1197 sbiw r26,1 |
1533 0d7a 80E0 ldi r24,lo8(__c.2332) |
1534 0d7c 90E0 ldi r25,hi8(__c.2332) |
1535 0d7e 9383 std Z+3,r25 |
1536 0d80 8283 std Z+2,r24 |
1537 0d82 8091 0000 lds r24,Capacity+2 |
1538 0d86 9091 0000 lds r25,(Capacity+2)+1 |
1539 0d8a 9583 std Z+5,r25 |
1540 0d8c 8483 std Z+4,r24 |
1541 0d8e E091 0000 lds r30,_printf_P |
1542 0d92 F091 0000 lds r31,(_printf_P)+1 |
1543 0d96 0995 icall |
1544 0d98 8CE3 ldi r24,lo8(60) |
1545 0d9a 8093 0000 sts DispPtr,r24 |
1546 0d9e EDB7 in r30,__SP_L__ |
1547 0da0 FEB7 in r31,__SP_H__ |
1548 0da2 3196 adiw r30,1 |
1549 0da4 ADB7 in r26,__SP_L__ |
1550 0da6 BEB7 in r27,__SP_H__ |
1551 0da8 1296 adiw r26,1+1 |
1552 0daa DC93 st X,r29 |
1553 0dac CE93 st -X,r28 |
1554 0dae 1197 sbiw r26,1 |
1555 0db0 80E0 ldi r24,lo8(__c.2334) |
1556 0db2 90E0 ldi r25,hi8(__c.2334) |
1557 0db4 9383 std Z+3,r25 |
1558 0db6 8283 std Z+2,r24 |
1559 0db8 8091 0000 lds r24,Capacity+4 |
1560 0dbc 9091 0000 lds r25,(Capacity+4)+1 |
1561 0dc0 00C0 rjmp .L61 |
1562 .L25: |
1563 0dc2 1092 0000 sts DispPtr,__zero_reg__ |
1564 0dc6 00D0 rcall . |
1565 0dc8 00D0 rcall . |
1566 0dca ADB7 in r26,__SP_L__ |
1567 0dcc BEB7 in r27,__SP_H__ |
1568 0dce 1296 adiw r26,1+1 |
1569 0dd0 DC93 st X,r29 |
1570 0dd2 CE93 st -X,r28 |
1571 0dd4 1197 sbiw r26,1 |
1572 0dd6 80E0 ldi r24,lo8(__c.2337) |
1573 0dd8 90E0 ldi r25,hi8(__c.2337) |
1574 0dda 1496 adiw r26,3+1 |
1575 0ddc 9C93 st X,r25 |
1576 0dde 8E93 st -X,r24 |
1577 0de0 1397 sbiw r26,3 |
1578 0de2 E091 0000 lds r30,_printf_P |
1579 0de6 F091 0000 lds r31,(_printf_P)+1 |
1580 0dea 0995 icall |
1581 0dec 84E1 ldi r24,lo8(20) |
1582 0dee 8093 0000 sts DispPtr,r24 |
1583 0df2 2091 0000 lds r18,PPM_in |
1584 0df6 3091 0000 lds r19,(PPM_in)+1 |
1585 0dfa 00D0 rcall . |
1586 0dfc EDB7 in r30,__SP_L__ |
1587 0dfe FEB7 in r31,__SP_H__ |
1588 0e00 3196 adiw r30,1 |
1589 0e02 ADB7 in r26,__SP_L__ |
1590 0e04 BEB7 in r27,__SP_H__ |
1591 0e06 1296 adiw r26,1+1 |
1592 0e08 DC93 st X,r29 |
1593 0e0a CE93 st -X,r28 |
1594 0e0c 1197 sbiw r26,1 |
1595 0e0e 80E0 ldi r24,lo8(__c.2339) |
1596 0e10 90E0 ldi r25,hi8(__c.2339) |
1597 0e12 9383 std Z+3,r25 |
1598 0e14 8283 std Z+2,r24 |
1599 0e16 3583 std Z+5,r19 |
1600 0e18 2483 std Z+4,r18 |
1601 0e1a E091 0000 lds r30,_printf_P |
1602 0e1e F091 0000 lds r31,(_printf_P)+1 |
1603 0e22 0995 icall |
1604 0e24 88E2 ldi r24,lo8(40) |
1605 0e26 8093 0000 sts DispPtr,r24 |
1606 0e2a 2091 0000 lds r18,SenderOkay |
1607 0e2e EDB7 in r30,__SP_L__ |
1608 0e30 FEB7 in r31,__SP_H__ |
1609 0e32 3196 adiw r30,1 |
1610 0e34 ADB7 in r26,__SP_L__ |
1611 0e36 BEB7 in r27,__SP_H__ |
1612 0e38 1296 adiw r26,1+1 |
1613 0e3a DC93 st X,r29 |
1614 0e3c CE93 st -X,r28 |
1615 0e3e 1197 sbiw r26,1 |
1616 0e40 80E0 ldi r24,lo8(__c.2341) |
1617 0e42 90E0 ldi r25,hi8(__c.2341) |
1618 0e44 9383 std Z+3,r25 |
1619 0e46 8283 std Z+2,r24 |
1620 0e48 2483 std Z+4,r18 |
1621 0e4a 1582 std Z+5,__zero_reg__ |
1622 0e4c E091 0000 lds r30,_printf_P |
1623 0e50 F091 0000 lds r31,(_printf_P)+1 |
1624 0e54 0995 icall |
1625 0e56 8CE3 ldi r24,lo8(60) |
1626 0e58 8093 0000 sts DispPtr,r24 |
1627 0e5c 2091 0000 lds r18,Channels |
1628 0e60 EDB7 in r30,__SP_L__ |
1629 0e62 FEB7 in r31,__SP_H__ |
1630 0e64 3196 adiw r30,1 |
1631 0e66 ADB7 in r26,__SP_L__ |
1632 0e68 BEB7 in r27,__SP_H__ |
1633 0e6a 1296 adiw r26,1+1 |
1634 0e6c DC93 st X,r29 |
1635 0e6e CE93 st -X,r28 |
1636 0e70 1197 sbiw r26,1 |
1637 0e72 80E0 ldi r24,lo8(__c.2343) |
1638 0e74 90E0 ldi r25,hi8(__c.2343) |
1639 0e76 9383 std Z+3,r25 |
1640 0e78 8283 std Z+2,r24 |
1641 0e7a 30E0 ldi r19,lo8(0) |
1642 0e7c 2150 subi r18,lo8(-(-1)) |
1643 0e7e 3040 sbci r19,hi8(-(-1)) |
1644 0e80 3583 std Z+5,r19 |
1645 0e82 2483 std Z+4,r18 |
1646 0e84 00C0 rjmp .L53 |
1647 .L26: |
1648 0e86 1092 0000 sts DispPtr,__zero_reg__ |
1649 0e8a 00D0 rcall . |
1650 0e8c 00D0 rcall . |
1651 0e8e ADB7 in r26,__SP_L__ |
1652 0e90 BEB7 in r27,__SP_H__ |
1653 0e92 1296 adiw r26,1+1 |
1654 0e94 DC93 st X,r29 |
1655 0e96 CE93 st -X,r28 |
1656 0e98 1197 sbiw r26,1 |
1657 0e9a 80E0 ldi r24,lo8(__c.2346) |
1658 0e9c 90E0 ldi r25,hi8(__c.2346) |
1659 0e9e 1496 adiw r26,3+1 |
1660 0ea0 9C93 st X,r25 |
1661 0ea2 8E93 st -X,r24 |
1662 0ea4 1397 sbiw r26,3 |
1663 0ea6 E091 0000 lds r30,_printf_P |
1664 0eaa F091 0000 lds r31,(_printf_P)+1 |
1665 0eae 0995 icall |
1666 0eb0 84E1 ldi r24,lo8(20) |
1667 0eb2 8093 0000 sts DispPtr,r24 |
1668 0eb6 00D0 rcall . |
1669 0eb8 EDB7 in r30,__SP_L__ |
1670 0eba FEB7 in r31,__SP_H__ |
1671 0ebc 3196 adiw r30,1 |
1672 0ebe ADB7 in r26,__SP_L__ |
1673 0ec0 BEB7 in r27,__SP_H__ |
1674 0ec2 1296 adiw r26,1+1 |
1675 0ec4 DC93 st X,r29 |
1676 0ec6 CE93 st -X,r28 |
1677 0ec8 1197 sbiw r26,1 |
1678 0eca 80E0 ldi r24,lo8(__c.2348) |
1679 0ecc 90E0 ldi r25,hi8(__c.2348) |
1680 0ece 9383 std Z+3,r25 |
1681 0ed0 8283 std Z+2,r24 |
1682 0ed2 8091 0000 lds r24,KompassRichtung |
1683 0ed6 9091 0000 lds r25,(KompassRichtung)+1 |
1684 0eda 9583 std Z+5,r25 |
1685 0edc 8483 std Z+4,r24 |
1686 0ede E091 0000 lds r30,_printf_P |
1687 0ee2 F091 0000 lds r31,(_printf_P)+1 |
1688 0ee6 0995 icall |
1689 0ee8 88E2 ldi r24,lo8(40) |
1690 0eea 8093 0000 sts DispPtr,r24 |
1691 0eee EDB7 in r30,__SP_L__ |
1692 0ef0 FEB7 in r31,__SP_H__ |
1693 0ef2 3196 adiw r30,1 |
1694 0ef4 ADB7 in r26,__SP_L__ |
1695 0ef6 BEB7 in r27,__SP_H__ |
1696 0ef8 1296 adiw r26,1+1 |
1697 0efa DC93 st X,r29 |
1698 0efc CE93 st -X,r28 |
1699 0efe 1197 sbiw r26,1 |
1700 0f00 80E0 ldi r24,lo8(__c.2350) |
1701 0f02 90E0 ldi r25,hi8(__c.2350) |
1702 0f04 9383 std Z+3,r25 |
1703 0f06 8283 std Z+2,r24 |
1704 0f08 8091 0000 lds r24,KompassValue |
1705 0f0c 9091 0000 lds r25,(KompassValue)+1 |
1706 0f10 9583 std Z+5,r25 |
1707 0f12 8483 std Z+4,r24 |
1708 0f14 E091 0000 lds r30,_printf_P |
1709 0f18 F091 0000 lds r31,(_printf_P)+1 |
1710 0f1c 0995 icall |
1711 0f1e 8CE3 ldi r24,lo8(60) |
1712 0f20 8093 0000 sts DispPtr,r24 |
1713 0f24 EDB7 in r30,__SP_L__ |
1714 0f26 FEB7 in r31,__SP_H__ |
1715 0f28 3196 adiw r30,1 |
1716 0f2a ADB7 in r26,__SP_L__ |
1717 0f2c BEB7 in r27,__SP_H__ |
1718 0f2e 1296 adiw r26,1+1 |
1719 0f30 DC93 st X,r29 |
1720 0f32 CE93 st -X,r28 |
1721 0f34 1197 sbiw r26,1 |
1722 0f36 80E0 ldi r24,lo8(__c.2352) |
1723 0f38 90E0 ldi r25,hi8(__c.2352) |
1724 0f3a 9383 std Z+3,r25 |
1725 0f3c 8283 std Z+2,r24 |
1726 0f3e 8091 0000 lds r24,KompassStartwert |
1727 0f42 9091 0000 lds r25,(KompassStartwert)+1 |
1728 .L61: |
1729 0f46 9583 std Z+5,r25 |
1730 0f48 8483 std Z+4,r24 |
1731 0f4a 00C0 rjmp .L53 |
1732 .L27: |
1733 0f4c 1092 0000 sts DispPtr,__zero_reg__ |
1734 0f50 00D0 rcall . |
1735 0f52 00D0 rcall . |
1736 0f54 00D0 rcall . |
1737 0f56 EDB7 in r30,__SP_L__ |
1738 0f58 FEB7 in r31,__SP_H__ |
1739 0f5a 3196 adiw r30,1 |
1740 0f5c ADB7 in r26,__SP_L__ |
1741 0f5e BEB7 in r27,__SP_H__ |
1742 0f60 1296 adiw r26,1+1 |
1743 0f62 DC93 st X,r29 |
1744 0f64 CE93 st -X,r28 |
1745 0f66 1197 sbiw r26,1 |
1746 0f68 80E0 ldi r24,lo8(__c.2355) |
1747 0f6a 90E0 ldi r25,hi8(__c.2355) |
1748 0f6c 9383 std Z+3,r25 |
1749 0f6e 8283 std Z+2,r24 |
1750 0f70 8091 0000 lds r24,Poti |
1751 0f74 8483 std Z+4,r24 |
1752 0f76 1582 std Z+5,__zero_reg__ |
1753 0f78 E091 0000 lds r30,_printf_P |
1754 0f7c F091 0000 lds r31,(_printf_P)+1 |
1755 0f80 0995 icall |
1756 0f82 84E1 ldi r24,lo8(20) |
1757 0f84 8093 0000 sts DispPtr,r24 |
1758 0f88 EDB7 in r30,__SP_L__ |
1759 0f8a FEB7 in r31,__SP_H__ |
1760 0f8c 3196 adiw r30,1 |
1761 0f8e ADB7 in r26,__SP_L__ |
1762 0f90 BEB7 in r27,__SP_H__ |
1763 0f92 1296 adiw r26,1+1 |
1764 0f94 DC93 st X,r29 |
1765 0f96 CE93 st -X,r28 |
1766 0f98 1197 sbiw r26,1 |
1767 0f9a 80E0 ldi r24,lo8(__c.2357) |
1768 0f9c 90E0 ldi r25,hi8(__c.2357) |
1769 0f9e 9383 std Z+3,r25 |
1770 0fa0 8283 std Z+2,r24 |
1771 0fa2 8091 0000 lds r24,Poti+1 |
1772 0fa6 8483 std Z+4,r24 |
1773 0fa8 1582 std Z+5,__zero_reg__ |
1774 0faa E091 0000 lds r30,_printf_P |
1775 0fae F091 0000 lds r31,(_printf_P)+1 |
1776 0fb2 0995 icall |
1777 0fb4 88E2 ldi r24,lo8(40) |
1778 0fb6 8093 0000 sts DispPtr,r24 |
1779 0fba EDB7 in r30,__SP_L__ |
1780 0fbc FEB7 in r31,__SP_H__ |
1781 0fbe 3196 adiw r30,1 |
1782 0fc0 ADB7 in r26,__SP_L__ |
1783 0fc2 BEB7 in r27,__SP_H__ |
1784 0fc4 1296 adiw r26,1+1 |
1785 0fc6 DC93 st X,r29 |
1786 0fc8 CE93 st -X,r28 |
1787 0fca 1197 sbiw r26,1 |
1788 0fcc 80E0 ldi r24,lo8(__c.2359) |
1789 0fce 90E0 ldi r25,hi8(__c.2359) |
1790 0fd0 9383 std Z+3,r25 |
1791 0fd2 8283 std Z+2,r24 |
1792 0fd4 8091 0000 lds r24,Poti+2 |
1793 0fd8 8483 std Z+4,r24 |
1794 0fda 1582 std Z+5,__zero_reg__ |
1795 0fdc E091 0000 lds r30,_printf_P |
1796 0fe0 F091 0000 lds r31,(_printf_P)+1 |
1797 0fe4 0995 icall |
1798 0fe6 8CE3 ldi r24,lo8(60) |
1799 0fe8 8093 0000 sts DispPtr,r24 |
1800 0fec EDB7 in r30,__SP_L__ |
1801 0fee FEB7 in r31,__SP_H__ |
1802 0ff0 3196 adiw r30,1 |
1803 0ff2 ADB7 in r26,__SP_L__ |
1804 0ff4 BEB7 in r27,__SP_H__ |
1805 0ff6 1296 adiw r26,1+1 |
1806 0ff8 DC93 st X,r29 |
1807 0ffa CE93 st -X,r28 |
1808 0ffc 1197 sbiw r26,1 |
1809 0ffe 80E0 ldi r24,lo8(__c.2361) |
1810 1000 90E0 ldi r25,hi8(__c.2361) |
1811 1002 9383 std Z+3,r25 |
1812 1004 8283 std Z+2,r24 |
1813 1006 8091 0000 lds r24,Poti+3 |
1814 100a 00C0 rjmp .L62 |
1815 .L28: |
1816 100c 1092 0000 sts DispPtr,__zero_reg__ |
1817 1010 00D0 rcall . |
1818 1012 00D0 rcall . |
1819 1014 00D0 rcall . |
1820 1016 EDB7 in r30,__SP_L__ |
1821 1018 FEB7 in r31,__SP_H__ |
1822 101a 3196 adiw r30,1 |
1823 101c ADB7 in r26,__SP_L__ |
1824 101e BEB7 in r27,__SP_H__ |
1825 1020 1296 adiw r26,1+1 |
1826 1022 DC93 st X,r29 |
1827 1024 CE93 st -X,r28 |
1828 1026 1197 sbiw r26,1 |
1829 1028 80E0 ldi r24,lo8(__c.2364) |
1830 102a 90E0 ldi r25,hi8(__c.2364) |
1831 102c 9383 std Z+3,r25 |
1832 102e 8283 std Z+2,r24 |
1833 1030 8091 0000 lds r24,Poti+4 |
1834 1034 8483 std Z+4,r24 |
1835 1036 1582 std Z+5,__zero_reg__ |
1836 1038 E091 0000 lds r30,_printf_P |
1837 103c F091 0000 lds r31,(_printf_P)+1 |
1838 1040 0995 icall |
1839 1042 84E1 ldi r24,lo8(20) |
1840 1044 8093 0000 sts DispPtr,r24 |
1841 1048 EDB7 in r30,__SP_L__ |
1842 104a FEB7 in r31,__SP_H__ |
1843 104c 3196 adiw r30,1 |
1844 104e ADB7 in r26,__SP_L__ |
1845 1050 BEB7 in r27,__SP_H__ |
1846 1052 1296 adiw r26,1+1 |
1847 1054 DC93 st X,r29 |
1848 1056 CE93 st -X,r28 |
1849 1058 1197 sbiw r26,1 |
1850 105a 80E0 ldi r24,lo8(__c.2366) |
1851 105c 90E0 ldi r25,hi8(__c.2366) |
1852 105e 9383 std Z+3,r25 |
1853 1060 8283 std Z+2,r24 |
1854 1062 8091 0000 lds r24,Poti+5 |
1855 1066 8483 std Z+4,r24 |
1856 1068 1582 std Z+5,__zero_reg__ |
1857 106a E091 0000 lds r30,_printf_P |
1858 106e F091 0000 lds r31,(_printf_P)+1 |
1859 1072 0995 icall |
1860 1074 88E2 ldi r24,lo8(40) |
1861 1076 8093 0000 sts DispPtr,r24 |
1862 107a EDB7 in r30,__SP_L__ |
1863 107c FEB7 in r31,__SP_H__ |
1864 107e 3196 adiw r30,1 |
1865 1080 ADB7 in r26,__SP_L__ |
1866 1082 BEB7 in r27,__SP_H__ |
1867 1084 1296 adiw r26,1+1 |
1868 1086 DC93 st X,r29 |
1869 1088 CE93 st -X,r28 |
1870 108a 1197 sbiw r26,1 |
1871 108c 80E0 ldi r24,lo8(__c.2368) |
1872 108e 90E0 ldi r25,hi8(__c.2368) |
1873 1090 9383 std Z+3,r25 |
1874 1092 8283 std Z+2,r24 |
1875 1094 8091 0000 lds r24,Poti+6 |
1876 1098 8483 std Z+4,r24 |
1877 109a 1582 std Z+5,__zero_reg__ |
1878 109c E091 0000 lds r30,_printf_P |
1879 10a0 F091 0000 lds r31,(_printf_P)+1 |
1880 10a4 0995 icall |
1881 10a6 8CE3 ldi r24,lo8(60) |
1882 10a8 8093 0000 sts DispPtr,r24 |
1883 10ac EDB7 in r30,__SP_L__ |
1884 10ae FEB7 in r31,__SP_H__ |
1885 10b0 3196 adiw r30,1 |
1886 10b2 ADB7 in r26,__SP_L__ |
1887 10b4 BEB7 in r27,__SP_H__ |
1888 10b6 1296 adiw r26,1+1 |
1889 10b8 DC93 st X,r29 |
1890 10ba CE93 st -X,r28 |
1891 10bc 1197 sbiw r26,1 |
1892 10be 80E0 ldi r24,lo8(__c.2370) |
1893 10c0 90E0 ldi r25,hi8(__c.2370) |
1894 10c2 9383 std Z+3,r25 |
1895 10c4 8283 std Z+2,r24 |
1896 10c6 8091 0000 lds r24,Poti+7 |
1897 10ca 00C0 rjmp .L62 |
1898 .L29: |
1899 10cc 1092 0000 sts DispPtr,__zero_reg__ |
1900 10d0 00D0 rcall . |
1901 10d2 00D0 rcall . |
1902 10d4 ADB7 in r26,__SP_L__ |
1903 10d6 BEB7 in r27,__SP_H__ |
1904 10d8 1296 adiw r26,1+1 |
1905 10da DC93 st X,r29 |
1906 10dc CE93 st -X,r28 |
1907 10de 1197 sbiw r26,1 |
1908 10e0 80E0 ldi r24,lo8(__c.2373) |
1909 10e2 90E0 ldi r25,hi8(__c.2373) |
1910 10e4 1496 adiw r26,3+1 |
1911 10e6 9C93 st X,r25 |
1912 10e8 8E93 st -X,r24 |
1913 10ea 1397 sbiw r26,3 |
1914 10ec E091 0000 lds r30,_printf_P |
1915 10f0 F091 0000 lds r31,(_printf_P)+1 |
1916 10f4 0995 icall |
1917 10f6 84E1 ldi r24,lo8(20) |
1918 10f8 8093 0000 sts DispPtr,r24 |
1919 10fc 00D0 rcall . |
1920 10fe EDB7 in r30,__SP_L__ |
1921 1100 FEB7 in r31,__SP_H__ |
1922 1102 3196 adiw r30,1 |
1923 1104 ADB7 in r26,__SP_L__ |
1924 1106 BEB7 in r27,__SP_H__ |
1925 1108 1296 adiw r26,1+1 |
1926 110a DC93 st X,r29 |
1927 110c CE93 st -X,r28 |
1928 110e 1197 sbiw r26,1 |
1929 1110 80E0 ldi r24,lo8(__c.2375) |
1930 1112 90E0 ldi r25,hi8(__c.2375) |
1931 1114 9383 std Z+3,r25 |
1932 1116 8283 std Z+2,r24 |
1933 1118 8091 0000 lds r24,Parameter_ServoNickControl |
1934 111c 8483 std Z+4,r24 |
1935 111e 1582 std Z+5,__zero_reg__ |
1936 1120 E091 0000 lds r30,_printf_P |
1937 1124 F091 0000 lds r31,(_printf_P)+1 |
1938 1128 0995 icall |
1939 112a 88E2 ldi r24,lo8(40) |
1940 112c 8093 0000 sts DispPtr,r24 |
1941 1130 2091 0000 lds r18,ServoNickValue |
1942 1134 3091 0000 lds r19,(ServoNickValue)+1 |
1943 1138 EDB7 in r30,__SP_L__ |
1944 113a FEB7 in r31,__SP_H__ |
1945 113c 3196 adiw r30,1 |
1946 113e ADB7 in r26,__SP_L__ |
1947 1140 BEB7 in r27,__SP_H__ |
1948 1142 1296 adiw r26,1+1 |
1949 1144 DC93 st X,r29 |
1950 1146 CE93 st -X,r28 |
1951 1148 1197 sbiw r26,1 |
1952 114a 80E0 ldi r24,lo8(__c.2377) |
1953 114c 90E0 ldi r25,hi8(__c.2377) |
1954 114e 9383 std Z+3,r25 |
1955 1150 8283 std Z+2,r24 |
1956 1152 3583 std Z+5,r19 |
1957 1154 2483 std Z+4,r18 |
1958 1156 E091 0000 lds r30,_printf_P |
1959 115a F091 0000 lds r31,(_printf_P)+1 |
1960 115e 0995 icall |
1961 1160 8CE3 ldi r24,lo8(60) |
1962 1162 8093 0000 sts DispPtr,r24 |
1963 1166 00D0 rcall . |
1964 1168 EDB7 in r30,__SP_L__ |
1965 116a FEB7 in r31,__SP_H__ |
1966 116c 3196 adiw r30,1 |
1967 116e ADB7 in r26,__SP_L__ |
1968 1170 BEB7 in r27,__SP_H__ |
1969 1172 1296 adiw r26,1+1 |
1970 1174 DC93 st X,r29 |
1971 1176 CE93 st -X,r28 |
1972 1178 1197 sbiw r26,1 |
1973 117a 80E0 ldi r24,lo8(__c.2379) |
1974 117c 90E0 ldi r25,hi8(__c.2379) |
1975 117e 9383 std Z+3,r25 |
1976 1180 8283 std Z+2,r24 |
1977 1182 8091 0000 lds r24,EE_Parameter+47 |
1978 1186 8483 std Z+4,r24 |
1979 1188 1582 std Z+5,__zero_reg__ |
1980 118a 8091 0000 lds r24,EE_Parameter+48 |
1981 118e 00C0 rjmp .L57 |
1982 .L30: |
1983 1190 1092 0000 sts DispPtr,__zero_reg__ |
1984 1194 00D0 rcall . |
1985 1196 00D0 rcall . |
1986 1198 ADB7 in r26,__SP_L__ |
1987 119a BEB7 in r27,__SP_H__ |
1988 119c 1296 adiw r26,1+1 |
1989 119e DC93 st X,r29 |
1990 11a0 CE93 st -X,r28 |
1991 11a2 1197 sbiw r26,1 |
1992 11a4 80E0 ldi r24,lo8(__c.2382) |
1993 11a6 90E0 ldi r25,hi8(__c.2382) |
1994 11a8 1496 adiw r26,3+1 |
1995 11aa 9C93 st X,r25 |
1996 11ac 8E93 st -X,r24 |
1997 11ae 1397 sbiw r26,3 |
1998 11b0 E091 0000 lds r30,_printf_P |
1999 11b4 F091 0000 lds r31,(_printf_P)+1 |
2000 11b8 0995 icall |
2001 11ba 84E1 ldi r24,lo8(20) |
2002 11bc 8093 0000 sts DispPtr,r24 |
2003 11c0 00D0 rcall . |
2004 11c2 00D0 rcall . |
2005 11c4 EDB7 in r30,__SP_L__ |
2006 11c6 FEB7 in r31,__SP_H__ |
2007 11c8 3196 adiw r30,1 |
2008 11ca ADB7 in r26,__SP_L__ |
2009 11cc BEB7 in r27,__SP_H__ |
2010 11ce 1296 adiw r26,1+1 |
2011 11d0 DC93 st X,r29 |
2012 11d2 CE93 st -X,r28 |
2013 11d4 1197 sbiw r26,1 |
2014 11d6 80E0 ldi r24,lo8(__c.2384) |
2015 11d8 90E0 ldi r25,hi8(__c.2384) |
2016 11da 9383 std Z+3,r25 |
2017 11dc 8283 std Z+2,r24 |
2018 11de 8091 0000 lds r24,ExternControl+3 |
2019 11e2 9927 clr r25 |
2020 11e4 87FD sbrc r24,7 |
2021 11e6 9095 com r25 |
2022 11e8 9583 std Z+5,r25 |
2023 11ea 8483 std Z+4,r24 |
2024 11ec 8091 0000 lds r24,ExternControl+4 |
2025 11f0 9927 clr r25 |
2026 11f2 87FD sbrc r24,7 |
2027 11f4 9095 com r25 |
2028 11f6 9783 std Z+7,r25 |
2029 11f8 8683 std Z+6,r24 |
2030 11fa E091 0000 lds r30,_printf_P |
2031 11fe F091 0000 lds r31,(_printf_P)+1 |
2032 1202 0995 icall |
2033 1204 88E2 ldi r24,lo8(40) |
2034 1206 8093 0000 sts DispPtr,r24 |
2035 120a EDB7 in r30,__SP_L__ |
2036 120c FEB7 in r31,__SP_H__ |
2037 120e 3196 adiw r30,1 |
2038 1210 ADB7 in r26,__SP_L__ |
2039 1212 BEB7 in r27,__SP_H__ |
2040 1214 1296 adiw r26,1+1 |
2041 1216 DC93 st X,r29 |
2042 1218 CE93 st -X,r28 |
2043 121a 1197 sbiw r26,1 |
2044 121c 80E0 ldi r24,lo8(__c.2386) |
2045 121e 90E0 ldi r25,hi8(__c.2386) |
2046 1220 9383 std Z+3,r25 |
2047 1222 8283 std Z+2,r24 |
2048 1224 8091 0000 lds r24,ExternControl+6 |
2049 1228 8483 std Z+4,r24 |
2050 122a 1582 std Z+5,__zero_reg__ |
2051 122c 8091 0000 lds r24,ExternControl+5 |
2052 1230 9927 clr r25 |
2053 1232 87FD sbrc r24,7 |
2054 1234 9095 com r25 |
2055 1236 9783 std Z+7,r25 |
2056 1238 8683 std Z+6,r24 |
2057 123a E091 0000 lds r30,_printf_P |
2058 123e F091 0000 lds r31,(_printf_P)+1 |
2059 1242 0995 icall |
2060 1244 8CE3 ldi r24,lo8(60) |
2061 1246 8093 0000 sts DispPtr,r24 |
2062 124a EDB7 in r30,__SP_L__ |
2063 124c FEB7 in r31,__SP_H__ |
2064 124e 3196 adiw r30,1 |
2065 1250 ADB7 in r26,__SP_L__ |
2066 1252 BEB7 in r27,__SP_H__ |
2067 1254 1296 adiw r26,1+1 |
2068 1256 DC93 st X,r29 |
2069 1258 CE93 st -X,r28 |
2070 125a 1197 sbiw r26,1 |
2071 125c 80E0 ldi r24,lo8(__c.2388) |
2072 125e 90E0 ldi r25,hi8(__c.2388) |
2073 1260 9383 std Z+3,r25 |
2074 1262 8283 std Z+2,r24 |
2075 1264 8091 0000 lds r24,ExternControl+7 |
2076 1268 9927 clr r25 |
2077 126a 87FD sbrc r24,7 |
2078 126c 9095 com r25 |
2079 126e 9583 std Z+5,r25 |
2080 1270 8483 std Z+4,r24 |
2081 1272 8091 0000 lds r24,ExternControl+10 |
2082 .L57: |
2083 1276 8683 std Z+6,r24 |
2084 1278 1782 std Z+7,__zero_reg__ |
2085 127a 00C0 rjmp .L55 |
2086 .L31: |
2087 127c 1092 0000 sts DispPtr,__zero_reg__ |
2088 1280 00D0 rcall . |
2089 1282 00D0 rcall . |
2090 1284 ADB7 in r26,__SP_L__ |
2091 1286 BEB7 in r27,__SP_H__ |
2092 1288 1296 adiw r26,1+1 |
2093 128a DC93 st X,r29 |
2094 128c CE93 st -X,r28 |
2095 128e 1197 sbiw r26,1 |
2096 1290 80E0 ldi r24,lo8(__c.2391) |
2097 1292 90E0 ldi r25,hi8(__c.2391) |
2098 1294 1496 adiw r26,3+1 |
2099 1296 9C93 st X,r25 |
2100 1298 8E93 st -X,r24 |
2101 129a 1397 sbiw r26,3 |
2102 129c E091 0000 lds r30,_printf_P |
2103 12a0 F091 0000 lds r31,(_printf_P)+1 |
2104 12a4 0995 icall |
2105 12a6 84E1 ldi r24,lo8(20) |
2106 12a8 8093 0000 sts DispPtr,r24 |
2107 12ac EDB7 in r30,__SP_L__ |
2108 12ae FEB7 in r31,__SP_H__ |
2109 12b0 3897 sbiw r30,8 |
2110 12b2 EDBF out __SP_L__,r30 |
2111 12b4 3196 adiw r30,1 |
2112 12b6 ADB7 in r26,__SP_L__ |
2113 12b8 BEB7 in r27,__SP_H__ |
2114 12ba 1296 adiw r26,1+1 |
2115 12bc DC93 st X,r29 |
2116 12be CE93 st -X,r28 |
2117 12c0 1197 sbiw r26,1 |
2118 12c2 80E0 ldi r24,lo8(__c.2393) |
2119 12c4 90E0 ldi r25,hi8(__c.2393) |
2120 12c6 9383 std Z+3,r25 |
2121 12c8 8283 std Z+2,r24 |
2122 12ca 8091 0000 lds r24,Motor+3 |
2123 12ce 90E0 ldi r25,lo8(0) |
2124 12d0 8F77 andi r24,lo8(127) |
2125 12d2 9070 andi r25,hi8(127) |
2126 12d4 9583 std Z+5,r25 |
2127 12d6 8483 std Z+4,r24 |
2128 12d8 8091 0000 lds r24,Motor+11 |
2129 12dc 90E0 ldi r25,lo8(0) |
2130 12de 8F77 andi r24,lo8(127) |
2131 12e0 9070 andi r25,hi8(127) |
2132 12e2 9783 std Z+7,r25 |
2133 12e4 8683 std Z+6,r24 |
2134 12e6 8091 0000 lds r24,Motor+19 |
2135 12ea 90E0 ldi r25,lo8(0) |
2136 12ec 8F77 andi r24,lo8(127) |
2137 12ee 9070 andi r25,hi8(127) |
2138 12f0 9187 std Z+9,r25 |
2139 12f2 8087 std Z+8,r24 |
2140 12f4 8091 0000 lds r24,Motor+27 |
2141 12f8 90E0 ldi r25,lo8(0) |
2142 12fa 8F77 andi r24,lo8(127) |
2143 12fc 9070 andi r25,hi8(127) |
2144 12fe 9387 std Z+11,r25 |
2145 1300 8287 std Z+10,r24 |
2146 1302 E091 0000 lds r30,_printf_P |
2147 1306 F091 0000 lds r31,(_printf_P)+1 |
2148 130a 0995 icall |
2149 130c 88E2 ldi r24,lo8(40) |
2150 130e 8093 0000 sts DispPtr,r24 |
2151 1312 EDB7 in r30,__SP_L__ |
2152 1314 FEB7 in r31,__SP_H__ |
2153 1316 3196 adiw r30,1 |
2154 1318 ADB7 in r26,__SP_L__ |
2155 131a BEB7 in r27,__SP_H__ |
2156 131c 1296 adiw r26,1+1 |
2157 131e DC93 st X,r29 |
2158 1320 CE93 st -X,r28 |
2159 1322 1197 sbiw r26,1 |
2160 1324 80E0 ldi r24,lo8(__c.2395) |
2161 1326 90E0 ldi r25,hi8(__c.2395) |
2162 1328 9383 std Z+3,r25 |
2163 132a 8283 std Z+2,r24 |
2164 132c 8091 0000 lds r24,Motor+35 |
2165 1330 90E0 ldi r25,lo8(0) |
2166 1332 8F77 andi r24,lo8(127) |
2167 1334 9070 andi r25,hi8(127) |
2168 1336 9583 std Z+5,r25 |
2169 1338 8483 std Z+4,r24 |
2170 133a 8091 0000 lds r24,Motor+43 |
2171 133e 90E0 ldi r25,lo8(0) |
2172 1340 8F77 andi r24,lo8(127) |
2173 1342 9070 andi r25,hi8(127) |
2174 1344 9783 std Z+7,r25 |
2175 1346 8683 std Z+6,r24 |
2176 1348 8091 0000 lds r24,Motor+51 |
2177 134c 90E0 ldi r25,lo8(0) |
2178 134e 8F77 andi r24,lo8(127) |
2179 1350 9070 andi r25,hi8(127) |
2180 1352 9187 std Z+9,r25 |
2181 1354 8087 std Z+8,r24 |
2182 1356 8091 0000 lds r24,Motor+59 |
2183 135a 90E0 ldi r25,lo8(0) |
2184 135c 8F77 andi r24,lo8(127) |
2185 135e 9070 andi r25,hi8(127) |
2186 1360 9387 std Z+11,r25 |
2187 1362 8287 std Z+10,r24 |
2188 1364 E091 0000 lds r30,_printf_P |
2189 1368 F091 0000 lds r31,(_printf_P)+1 |
2190 136c 0995 icall |
2191 136e 8CE3 ldi r24,lo8(60) |
2192 1370 8093 0000 sts DispPtr,r24 |
2193 1374 EDB7 in r30,__SP_L__ |
2194 1376 FEB7 in r31,__SP_H__ |
2195 1378 3196 adiw r30,1 |
2196 137a ADB7 in r26,__SP_L__ |
2197 137c BEB7 in r27,__SP_H__ |
2198 137e 1296 adiw r26,1+1 |
2199 1380 DC93 st X,r29 |
2200 1382 CE93 st -X,r28 |
2201 1384 1197 sbiw r26,1 |
2202 1386 80E0 ldi r24,lo8(__c.2397) |
2203 1388 90E0 ldi r25,hi8(__c.2397) |
2204 138a 9383 std Z+3,r25 |
2205 138c 8283 std Z+2,r24 |
2206 138e 8091 0000 lds r24,Motor+67 |
2207 1392 90E0 ldi r25,lo8(0) |
2208 1394 8F77 andi r24,lo8(127) |
2209 1396 9070 andi r25,hi8(127) |
2210 1398 9583 std Z+5,r25 |
2211 139a 8483 std Z+4,r24 |
2212 139c 8091 0000 lds r24,Motor+75 |
2213 13a0 90E0 ldi r25,lo8(0) |
2214 13a2 8F77 andi r24,lo8(127) |
2215 13a4 9070 andi r25,hi8(127) |
2216 13a6 9783 std Z+7,r25 |
2217 13a8 8683 std Z+6,r24 |
2218 13aa 8091 0000 lds r24,Motor+83 |
2219 13ae 90E0 ldi r25,lo8(0) |
2220 13b0 8F77 andi r24,lo8(127) |
2221 13b2 9070 andi r25,hi8(127) |
2222 13b4 9187 std Z+9,r25 |
2223 13b6 8087 std Z+8,r24 |
2224 13b8 8091 0000 lds r24,Motor+91 |
2225 13bc 90E0 ldi r25,lo8(0) |
2226 13be 8F77 andi r24,lo8(127) |
2227 13c0 9070 andi r25,hi8(127) |
2228 13c2 00C0 rjmp .L56 |
2229 .L32: |
2230 13c4 1092 0000 sts DispPtr,__zero_reg__ |
2231 13c8 00D0 rcall . |
2232 13ca 00D0 rcall . |
2233 13cc ADB7 in r26,__SP_L__ |
2234 13ce BEB7 in r27,__SP_H__ |
2235 13d0 1296 adiw r26,1+1 |
2236 13d2 DC93 st X,r29 |
2237 13d4 CE93 st -X,r28 |
2238 13d6 1197 sbiw r26,1 |
2239 13d8 80E0 ldi r24,lo8(__c.2400) |
2240 13da 90E0 ldi r25,hi8(__c.2400) |
2241 13dc 1496 adiw r26,3+1 |
2242 13de 9C93 st X,r25 |
2243 13e0 8E93 st -X,r24 |
2244 13e2 1397 sbiw r26,3 |
2245 13e4 E091 0000 lds r30,_printf_P |
2246 13e8 F091 0000 lds r31,(_printf_P)+1 |
2247 13ec 0995 icall |
2248 13ee 84E1 ldi r24,lo8(20) |
2249 13f0 8093 0000 sts DispPtr,r24 |
2250 13f4 EDB7 in r30,__SP_L__ |
2251 13f6 FEB7 in r31,__SP_H__ |
2252 13f8 3897 sbiw r30,8 |
2253 13fa EDBF out __SP_L__,r30 |
2254 13fc 3196 adiw r30,1 |
2255 13fe ADB7 in r26,__SP_L__ |
2256 1400 BEB7 in r27,__SP_H__ |
2257 1402 1296 adiw r26,1+1 |
2258 1404 DC93 st X,r29 |
2259 1406 CE93 st -X,r28 |
2260 1408 1197 sbiw r26,1 |
2261 140a 80E0 ldi r24,lo8(__c.2402) |
2262 140c 90E0 ldi r25,hi8(__c.2402) |
2263 140e 9383 std Z+3,r25 |
2264 1410 8283 std Z+2,r24 |
2265 1412 8091 0000 lds r24,Motor+7 |
2266 1416 9927 clr r25 |
2267 1418 87FD sbrc r24,7 |
2268 141a 9095 com r25 |
2269 141c 9583 std Z+5,r25 |
2270 141e 8483 std Z+4,r24 |
2271 1420 8091 0000 lds r24,Motor+15 |
2272 1424 9927 clr r25 |
2273 1426 87FD sbrc r24,7 |
2274 1428 9095 com r25 |
2275 142a 9783 std Z+7,r25 |
2276 142c 8683 std Z+6,r24 |
2277 142e 8091 0000 lds r24,Motor+23 |
2278 1432 9927 clr r25 |
2279 1434 87FD sbrc r24,7 |
2280 1436 9095 com r25 |
2281 1438 9187 std Z+9,r25 |
2282 143a 8087 std Z+8,r24 |
2283 143c 8091 0000 lds r24,Motor+31 |
2284 1440 9927 clr r25 |
2285 1442 87FD sbrc r24,7 |
2286 1444 9095 com r25 |
2287 1446 9387 std Z+11,r25 |
2288 1448 8287 std Z+10,r24 |
2289 144a E091 0000 lds r30,_printf_P |
2290 144e F091 0000 lds r31,(_printf_P)+1 |
2291 1452 0995 icall |
2292 1454 88E2 ldi r24,lo8(40) |
2293 1456 8093 0000 sts DispPtr,r24 |
2294 145a EDB7 in r30,__SP_L__ |
2295 145c FEB7 in r31,__SP_H__ |
2296 145e 3196 adiw r30,1 |
2297 1460 ADB7 in r26,__SP_L__ |
2298 1462 BEB7 in r27,__SP_H__ |
2299 1464 1296 adiw r26,1+1 |
2300 1466 DC93 st X,r29 |
2301 1468 CE93 st -X,r28 |
2302 146a 1197 sbiw r26,1 |
2303 146c 80E0 ldi r24,lo8(__c.2404) |
2304 146e 90E0 ldi r25,hi8(__c.2404) |
2305 1470 9383 std Z+3,r25 |
2306 1472 8283 std Z+2,r24 |
2307 1474 8091 0000 lds r24,Motor+39 |
2308 1478 9927 clr r25 |
2309 147a 87FD sbrc r24,7 |
2310 147c 9095 com r25 |
2311 147e 9583 std Z+5,r25 |
2312 1480 8483 std Z+4,r24 |
2313 1482 8091 0000 lds r24,Motor+47 |
2314 1486 9927 clr r25 |
2315 1488 87FD sbrc r24,7 |
2316 148a 9095 com r25 |
2317 148c 9783 std Z+7,r25 |
2318 148e 8683 std Z+6,r24 |
2319 1490 8091 0000 lds r24,Motor+55 |
2320 1494 9927 clr r25 |
2321 1496 87FD sbrc r24,7 |
2322 1498 9095 com r25 |
2323 149a 9187 std Z+9,r25 |
2324 149c 8087 std Z+8,r24 |
2325 149e 8091 0000 lds r24,Motor+63 |
2326 14a2 9927 clr r25 |
2327 14a4 87FD sbrc r24,7 |
2328 14a6 9095 com r25 |
2329 14a8 9387 std Z+11,r25 |
2330 14aa 8287 std Z+10,r24 |
2331 14ac E091 0000 lds r30,_printf_P |
2332 14b0 F091 0000 lds r31,(_printf_P)+1 |
2333 14b4 0995 icall |
2334 14b6 8CE3 ldi r24,lo8(60) |
2335 14b8 8093 0000 sts DispPtr,r24 |
2336 14bc EDB7 in r30,__SP_L__ |
2337 14be FEB7 in r31,__SP_H__ |
2338 14c0 3196 adiw r30,1 |
2339 14c2 ADB7 in r26,__SP_L__ |
2340 14c4 BEB7 in r27,__SP_H__ |
2341 14c6 1296 adiw r26,1+1 |
2342 14c8 DC93 st X,r29 |
2343 14ca CE93 st -X,r28 |
2344 14cc 1197 sbiw r26,1 |
2345 14ce 80E0 ldi r24,lo8(__c.2406) |
2346 14d0 90E0 ldi r25,hi8(__c.2406) |
2347 14d2 9383 std Z+3,r25 |
2348 14d4 8283 std Z+2,r24 |
2349 14d6 8091 0000 lds r24,Motor+71 |
2350 14da 9927 clr r25 |
2351 14dc 87FD sbrc r24,7 |
2352 14de 9095 com r25 |
2353 14e0 9583 std Z+5,r25 |
2354 14e2 8483 std Z+4,r24 |
2355 14e4 8091 0000 lds r24,Motor+79 |
2356 14e8 9927 clr r25 |
2357 14ea 87FD sbrc r24,7 |
2358 14ec 9095 com r25 |
2359 14ee 9783 std Z+7,r25 |
2360 14f0 8683 std Z+6,r24 |
2361 14f2 8091 0000 lds r24,Motor+87 |
2362 14f6 9927 clr r25 |
2363 14f8 87FD sbrc r24,7 |
2364 14fa 9095 com r25 |
2365 14fc 9187 std Z+9,r25 |
2366 14fe 8087 std Z+8,r24 |
2367 1500 8091 0000 lds r24,Motor+95 |
2368 1504 9927 clr r25 |
2369 1506 87FD sbrc r24,7 |
2370 1508 9095 com r25 |
2371 .L56: |
2372 150a 9387 std Z+11,r25 |
2373 150c 8287 std Z+10,r24 |
2374 150e E091 0000 lds r30,_printf_P |
2375 1512 F091 0000 lds r31,(_printf_P)+1 |
2376 1516 0995 icall |
2377 1518 EDB7 in r30,__SP_L__ |
2378 151a FEB7 in r31,__SP_H__ |
2379 151c 3C96 adiw r30,12 |
2380 151e 0C94 0000 jmp .L54 |
2381 .L33: |
2382 1522 1092 0000 sts DispPtr,__zero_reg__ |
2383 1526 00D0 rcall . |
2384 1528 00D0 rcall . |
2385 152a ADB7 in r26,__SP_L__ |
2386 152c BEB7 in r27,__SP_H__ |
2387 152e 1296 adiw r26,1+1 |
2388 1530 DC93 st X,r29 |
2389 1532 CE93 st -X,r28 |
2390 1534 1197 sbiw r26,1 |
2391 1536 80E0 ldi r24,lo8(__c.2409) |
2392 1538 90E0 ldi r25,hi8(__c.2409) |
2393 153a 1496 adiw r26,3+1 |
2394 153c 9C93 st X,r25 |
2395 153e 8E93 st -X,r24 |
2396 1540 1397 sbiw r26,3 |
2397 1542 E091 0000 lds r30,_printf_P |
2398 1546 F091 0000 lds r31,(_printf_P)+1 |
2399 154a 0995 icall |
2400 154c 84E1 ldi r24,lo8(20) |
2401 154e 8093 0000 sts DispPtr,r24 |
2402 1552 EDB7 in r30,__SP_L__ |
2403 1554 FEB7 in r31,__SP_H__ |
2404 1556 3897 sbiw r30,8 |
2405 1558 EDBF out __SP_L__,r30 |
2406 155a 3196 adiw r30,1 |
2407 155c ADB7 in r26,__SP_L__ |
2408 155e BEB7 in r27,__SP_H__ |
2409 1560 1296 adiw r26,1+1 |
2410 1562 DC93 st X,r29 |
2411 1564 CE93 st -X,r28 |
2412 1566 1197 sbiw r26,1 |
2413 1568 80E0 ldi r24,lo8(__c.2411) |
2414 156a 90E0 ldi r25,hi8(__c.2411) |
2415 156c 9383 std Z+3,r25 |
2416 156e 8283 std Z+2,r24 |
2417 1570 8091 0000 lds r24,Motor+3 |
2418 1574 881F rol r24 |
2419 1576 8827 clr r24 |
2420 1578 881F rol r24 |
2421 157a 90E0 ldi r25,lo8(0) |
2422 157c 880F lsl r24 |
2423 157e 991F rol r25 |
2424 1580 880F lsl r24 |
2425 1582 991F rol r25 |
2426 1584 8D96 adiw r24,45 |
2427 1586 9583 std Z+5,r25 |
2428 1588 8483 std Z+4,r24 |
2429 158a 8091 0000 lds r24,Motor+11 |
2430 158e 881F rol r24 |
2431 1590 8827 clr r24 |
2432 1592 881F rol r24 |
2433 1594 25E0 ldi r18,lo8(5) |
2434 1596 829F mul r24,r18 |
2435 1598 C001 movw r24,r0 |
2436 159a 1124 clr r1 |
2437 159c 8D96 adiw r24,45 |
2438 159e 9783 std Z+7,r25 |
2439 15a0 8683 std Z+6,r24 |
2440 15a2 8091 0000 lds r24,Motor+19 |
2441 15a6 881F rol r24 |
2442 15a8 8827 clr r24 |
2443 15aa 881F rol r24 |
2444 15ac 26E0 ldi r18,lo8(6) |
2445 15ae 829F mul r24,r18 |
2446 15b0 C001 movw r24,r0 |
2447 15b2 1124 clr r1 |
2448 15b4 8D96 adiw r24,45 |
2449 15b6 9187 std Z+9,r25 |
2450 15b8 8087 std Z+8,r24 |
2451 15ba 8091 0000 lds r24,Motor+27 |
2452 15be 881F rol r24 |
2453 15c0 8827 clr r24 |
2454 15c2 881F rol r24 |
2455 15c4 27E0 ldi r18,lo8(7) |
2456 15c6 829F mul r24,r18 |
2457 15c8 C001 movw r24,r0 |
2458 15ca 1124 clr r1 |
2459 15cc 8D96 adiw r24,45 |
2460 15ce 9387 std Z+11,r25 |
2461 15d0 8287 std Z+10,r24 |
2462 15d2 E091 0000 lds r30,_printf_P |
2463 15d6 F091 0000 lds r31,(_printf_P)+1 |
2464 15da 0995 icall |
2465 15dc 88E2 ldi r24,lo8(40) |
2466 15de 8093 0000 sts DispPtr,r24 |
2467 15e2 EDB7 in r30,__SP_L__ |
2468 15e4 FEB7 in r31,__SP_H__ |
2469 15e6 3196 adiw r30,1 |
2470 15e8 ADB7 in r26,__SP_L__ |
2471 15ea BEB7 in r27,__SP_H__ |
2472 15ec 1296 adiw r26,1+1 |
2473 15ee DC93 st X,r29 |
2474 15f0 CE93 st -X,r28 |
2475 15f2 1197 sbiw r26,1 |
2476 15f4 80E0 ldi r24,lo8(__c.2413) |
2477 15f6 90E0 ldi r25,hi8(__c.2413) |
2478 15f8 9383 std Z+3,r25 |
2479 15fa 8283 std Z+2,r24 |
2480 15fc 8091 0000 lds r24,Motor+35 |
2481 1600 881F rol r24 |
2482 1602 8827 clr r24 |
2483 1604 881F rol r24 |
2484 1606 90E0 ldi r25,lo8(0) |
2485 1608 23E0 ldi r18,3 |
2486 160a 880F 1: lsl r24 |
2487 160c 991F rol r25 |
2488 160e 2A95 dec r18 |
2489 1610 01F4 brne 1b |
2490 1612 8D96 adiw r24,45 |
2491 1614 9583 std Z+5,r25 |
2492 1616 8483 std Z+4,r24 |
2493 1618 8091 0000 lds r24,Motor+43 |
2494 161c 881F rol r24 |
2495 161e 8827 clr r24 |
2496 1620 881F rol r24 |
2497 1622 29E0 ldi r18,lo8(9) |
2498 1624 829F mul r24,r18 |
2499 1626 C001 movw r24,r0 |
2500 1628 1124 clr r1 |
2501 162a 8D96 adiw r24,45 |
2502 162c 9783 std Z+7,r25 |
2503 162e 8683 std Z+6,r24 |
2504 1630 8091 0000 lds r24,Motor+51 |
2505 1634 881F rol r24 |
2506 1636 8827 clr r24 |
2507 1638 881F rol r24 |
2508 163a 2AE0 ldi r18,lo8(10) |
2509 163c 829F mul r24,r18 |
2510 163e C001 movw r24,r0 |
2511 1640 1124 clr r1 |
2512 1642 8D96 adiw r24,45 |
2513 1644 9187 std Z+9,r25 |
2514 1646 8087 std Z+8,r24 |
2515 1648 8091 0000 lds r24,Motor+59 |
2516 164c 881F rol r24 |
2517 164e 8827 clr r24 |
2518 1650 881F rol r24 |
2519 1652 2BE0 ldi r18,lo8(11) |
2520 1654 829F mul r24,r18 |
2521 1656 C001 movw r24,r0 |
2522 1658 1124 clr r1 |
2523 165a 8D96 adiw r24,45 |
2524 165c 9387 std Z+11,r25 |
2525 165e 8287 std Z+10,r24 |
2526 1660 E091 0000 lds r30,_printf_P |
2527 1664 F091 0000 lds r31,(_printf_P)+1 |
2528 1668 0995 icall |
2529 166a 8CE3 ldi r24,lo8(60) |
2530 166c 8093 0000 sts DispPtr,r24 |
2531 1670 EDB7 in r30,__SP_L__ |
2532 1672 FEB7 in r31,__SP_H__ |
2533 1674 3696 adiw r30,6 |
2534 1676 EDBF out __SP_L__,r30 |
2535 1678 3196 adiw r30,1 |
2536 167a ADB7 in r26,__SP_L__ |
2537 167c BEB7 in r27,__SP_H__ |
2538 167e 1296 adiw r26,1+1 |
2539 1680 DC93 st X,r29 |
2540 1682 CE93 st -X,r28 |
2541 1684 1197 sbiw r26,1 |
2542 1686 80E0 ldi r24,lo8(__c.2415) |
2543 1688 90E0 ldi r25,hi8(__c.2415) |
2544 168a 9383 std Z+3,r25 |
2545 168c 8283 std Z+2,r24 |
2546 168e 8091 0000 lds r24,Motor+67 |
2547 1692 881F rol r24 |
2548 1694 8827 clr r24 |
2549 1696 881F rol r24 |
2550 1698 2CE0 ldi r18,lo8(12) |
2551 169a 829F mul r24,r18 |
2552 169c C001 movw r24,r0 |
2553 169e 1124 clr r1 |
2554 16a0 8D96 adiw r24,45 |
2555 16a2 9583 std Z+5,r25 |
2556 16a4 8483 std Z+4,r24 |
2557 16a6 E091 0000 lds r30,_printf_P |
2558 16aa F091 0000 lds r31,(_printf_P)+1 |
2559 16ae 0995 icall |
2560 16b0 EDB7 in r30,__SP_L__ |
2561 16b2 FEB7 in r31,__SP_H__ |
2562 16b4 3696 adiw r30,6 |
2563 16b6 EDBF out __SP_L__,r30 |
2564 16b8 8091 0000 lds r24,Motor+75 |
2565 16bc 87FF sbrs r24,7 |
2566 16be 00C0 rjmp .L44 |
2567 16c0 80E4 ldi r24,lo8(64) |
2568 16c2 8093 0000 sts DispPtr,r24 |
2569 16c6 00D0 rcall . |
2570 16c8 00D0 rcall . |
2571 16ca ADB7 in r26,__SP_L__ |
2572 16cc BEB7 in r27,__SP_H__ |
2573 16ce 1296 adiw r26,1+1 |
2574 16d0 DC93 st X,r29 |
2575 16d2 CE93 st -X,r28 |
2576 16d4 1197 sbiw r26,1 |
2577 16d6 80E0 ldi r24,lo8(__c.2417) |
2578 16d8 90E0 ldi r25,hi8(__c.2417) |
2579 16da 1496 adiw r26,3+1 |
2580 16dc 9C93 st X,r25 |
2581 16de 8E93 st -X,r24 |
2582 16e0 1397 sbiw r26,3 |
2583 16e2 E091 0000 lds r30,_printf_P |
2584 16e6 F091 0000 lds r31,(_printf_P)+1 |
2585 16ea 0995 icall |
2586 16ec 0F90 pop __tmp_reg__ |
2587 16ee 0F90 pop __tmp_reg__ |
2588 16f0 0F90 pop __tmp_reg__ |
2589 16f2 0F90 pop __tmp_reg__ |
2590 .L44: |
2591 16f4 8091 0000 lds r24,Motor+83 |
2592 16f8 87FF sbrs r24,7 |
2593 16fa 00C0 rjmp .L45 |
2594 16fc 84E4 ldi r24,lo8(68) |
2595 16fe 8093 0000 sts DispPtr,r24 |
2596 1702 00D0 rcall . |
2597 1704 00D0 rcall . |
2598 1706 80E0 ldi r24,lo8(gs(Menu_Putchar)) |
2599 1708 90E0 ldi r25,hi8(gs(Menu_Putchar)) |
2600 170a EDB7 in r30,__SP_L__ |
2601 170c FEB7 in r31,__SP_H__ |
2602 170e 9283 std Z+2,r25 |
2603 1710 8183 std Z+1,r24 |
2604 1712 80E0 ldi r24,lo8(__c.2419) |
2605 1714 90E0 ldi r25,hi8(__c.2419) |
2606 1716 9483 std Z+4,r25 |
2607 1718 8383 std Z+3,r24 |
2608 171a E091 0000 lds r30,_printf_P |
2609 171e F091 0000 lds r31,(_printf_P)+1 |
2610 1722 0995 icall |
2611 1724 0F90 pop __tmp_reg__ |
2612 1726 0F90 pop __tmp_reg__ |
2613 1728 0F90 pop __tmp_reg__ |
2614 172a 0F90 pop __tmp_reg__ |
2615 .L45: |
2616 172c 8091 0000 lds r24,Motor+91 |
2617 1730 87FF sbrs r24,7 |
2618 1732 00C0 rjmp .L37 |
2619 1734 88E4 ldi r24,lo8(72) |
2620 1736 8093 0000 sts DispPtr,r24 |
2621 173a 00D0 rcall . |
2622 173c 00D0 rcall . |
2623 173e 80E0 ldi r24,lo8(gs(Menu_Putchar)) |
2624 1740 90E0 ldi r25,hi8(gs(Menu_Putchar)) |
2625 1742 ADB7 in r26,__SP_L__ |
2626 1744 BEB7 in r27,__SP_H__ |
2627 1746 1296 adiw r26,1+1 |
2628 1748 9C93 st X,r25 |
2629 174a 8E93 st -X,r24 |
2630 174c 1197 sbiw r26,1 |
2631 174e 80E0 ldi r24,lo8(__c.2421) |
2632 1750 90E0 ldi r25,hi8(__c.2421) |
2633 .L60: |
2634 1752 1496 adiw r26,3+1 |
2635 1754 9C93 st X,r25 |
2636 1756 8E93 st -X,r24 |
2637 1758 1397 sbiw r26,3 |
2638 .L52: |
2639 175a E091 0000 lds r30,_printf_P |
2640 175e F091 0000 lds r31,(_printf_P)+1 |
2641 1762 0995 icall |
2642 1764 0F90 pop __tmp_reg__ |
2643 1766 0F90 pop __tmp_reg__ |
2644 1768 0F90 pop __tmp_reg__ |
2645 176a 0F90 pop __tmp_reg__ |
2646 176c 00C0 rjmp .L37 |
2647 .L34: |
2648 176e 1092 0000 sts DispPtr,__zero_reg__ |
2649 1772 00D0 rcall . |
2650 1774 00D0 rcall . |
2651 1776 EDB7 in r30,__SP_L__ |
2652 1778 FEB7 in r31,__SP_H__ |
2653 177a D283 std Z+2,r29 |
2654 177c C183 std Z+1,r28 |
2655 177e 80E0 ldi r24,lo8(__c.2424) |
2656 1780 90E0 ldi r25,hi8(__c.2424) |
2657 1782 9483 std Z+4,r25 |
2658 1784 8383 std Z+3,r24 |
2659 1786 E091 0000 lds r30,_printf_P |
2660 178a F091 0000 lds r31,(_printf_P)+1 |
2661 178e 0995 icall |
2662 1790 84E1 ldi r24,lo8(20) |
2663 1792 8093 0000 sts DispPtr,r24 |
2664 1796 00D0 rcall . |
2665 1798 EDB7 in r30,__SP_L__ |
2666 179a FEB7 in r31,__SP_H__ |
2667 179c 3196 adiw r30,1 |
2668 179e ADB7 in r26,__SP_L__ |
2669 17a0 BEB7 in r27,__SP_H__ |
2670 17a2 1296 adiw r26,1+1 |
2671 17a4 DC93 st X,r29 |
2672 17a6 CE93 st -X,r28 |
2673 17a8 1197 sbiw r26,1 |
2674 17aa 80E0 ldi r24,lo8(__c.2426) |
2675 17ac 90E0 ldi r25,hi8(__c.2426) |
2676 17ae 9383 std Z+3,r25 |
2677 17b0 8283 std Z+2,r24 |
2678 17b2 8091 0000 lds r24,FlugMinutenGesamt |
2679 17b6 9091 0000 lds r25,(FlugMinutenGesamt)+1 |
2680 17ba 9583 std Z+5,r25 |
2681 17bc 8483 std Z+4,r24 |
2682 17be E091 0000 lds r30,_printf_P |
2683 17c2 F091 0000 lds r31,(_printf_P)+1 |
2684 17c6 0995 icall |
2685 17c8 88E2 ldi r24,lo8(40) |
2686 17ca 8093 0000 sts DispPtr,r24 |
2687 17ce EDB7 in r30,__SP_L__ |
2688 17d0 FEB7 in r31,__SP_H__ |
2689 17d2 3196 adiw r30,1 |
2690 17d4 ADB7 in r26,__SP_L__ |
2691 17d6 BEB7 in r27,__SP_H__ |
2692 17d8 1296 adiw r26,1+1 |
2693 17da DC93 st X,r29 |
2694 17dc CE93 st -X,r28 |
2695 17de 1197 sbiw r26,1 |
2696 17e0 80E0 ldi r24,lo8(__c.2428) |
2697 17e2 90E0 ldi r25,hi8(__c.2428) |
2698 17e4 9383 std Z+3,r25 |
2699 17e6 8283 std Z+2,r24 |
2700 17e8 8091 0000 lds r24,FlugMinuten |
2701 17ec 9091 0000 lds r25,(FlugMinuten)+1 |
2702 17f0 9583 std Z+5,r25 |
2703 17f2 8483 std Z+4,r24 |
2704 17f4 E091 0000 lds r30,_printf_P |
2705 17f8 F091 0000 lds r31,(_printf_P)+1 |
2706 17fc 0995 icall |
2707 17fe 89E4 ldi r24,lo8(73) |
2708 1800 8093 0000 sts DispPtr,r24 |
2709 1804 0F90 pop __tmp_reg__ |
2710 1806 0F90 pop __tmp_reg__ |
2711 1808 EDB7 in r30,__SP_L__ |
2712 180a FEB7 in r31,__SP_H__ |
2713 180c D283 std Z+2,r29 |
2714 180e C183 std Z+1,r28 |
2715 1810 80E0 ldi r24,lo8(__c.2430) |
2716 1812 90E0 ldi r25,hi8(__c.2430) |
2717 1814 9483 std Z+4,r25 |
2718 1816 8383 std Z+3,r24 |
2719 1818 E091 0000 lds r30,_printf_P |
2720 181c F091 0000 lds r31,(_printf_P)+1 |
2721 1820 0995 icall |
2722 1822 8091 0000 lds r24,RemoteKeys |
2723 1826 0F90 pop __tmp_reg__ |
2724 1828 0F90 pop __tmp_reg__ |
2725 182a 0F90 pop __tmp_reg__ |
2726 182c 0F90 pop __tmp_reg__ |
2727 182e 83FF sbrs r24,3 |
2728 1830 00C0 rjmp .L37 |
2729 1832 1092 0000 sts (FlugMinuten)+1,__zero_reg__ |
2730 1836 1092 0000 sts FlugMinuten,__zero_reg__ |
2731 183a 8EE0 ldi r24,lo8(14) |
2732 183c 90E0 ldi r25,hi8(14) |
2733 183e 60E0 ldi r22,lo8(0) |
2734 1840 70E0 ldi r23,hi8(0) |
2735 1842 0E94 0000 call SetParamWord |
2736 1846 00C0 rjmp .L37 |
2737 .L16: |
2738 1848 8091 0000 lds r24,MaxMenue |
2739 184c 9817 cp r25,r24 |
2740 184e 01F4 brne .L46 |
2741 1850 9150 subi r25,lo8(-(-1)) |
2742 1852 9093 0000 sts MaxMenue,r25 |
2743 .L46: |
2744 1856 1092 0000 sts MenuePunkt,__zero_reg__ |
2745 .L37: |
2746 185a 1092 0000 sts RemoteKeys,__zero_reg__ |
2747 /* epilogue start */ |
2748 185e CDB7 in r28,__SP_L__ |
2749 1860 DEB7 in r29,__SP_H__ |
2750 1862 E6E0 ldi r30, lo8(6) |
2751 1864 0C94 0000 jmp __epilogue_restores__ + ((18 - 6) * 2) |
2753 .global DisplayBuff |
2754 .data |
2757 DisplayBuff: |
2758 0000 4865 6C6C .string "Hello World" |
2758 6F20 576F |
2758 726C 6400 |
2759 000c 0000 0000 .skip 68,0 |
2759 0000 0000 |
2759 0000 0000 |
2759 0000 0000 |
2759 0000 0000 |
2760 .global DispPtr |
2761 .global DispPtr |
2762 .section .bss |
2765 DispPtr: |
2766 0000 00 .skip 1,0 |
2767 .global MaxMenue |
2768 .data |
2771 MaxMenue: |
2772 0050 11 .byte 17 |
2773 .global MenuePunkt |
2774 .global MenuePunkt |
2775 .section .bss |
2778 MenuePunkt: |
2779 0001 00 .skip 1,0 |
2780 .global RemoteKeys |
2781 .global RemoteKeys |
2784 RemoteKeys: |
2785 0002 00 .skip 1,0 |
2786 .section .progmem.data,"a",@progbits |
2789 __c.2430: |
2790 0000 2872 6573 .string "(reset)" |
2790 6574 2900 |
2793 __c.2428: |
2794 0008 4163 743A .string "Act: %5umin" |
2794 2020 2535 |
2794 756D 696E |
2794 00 |
2797 __c.2426: |
2798 0015 546F 7461 .string "Total:%5umin" |
2798 6C3A 2535 |
2798 756D 696E |
2798 00 |
2801 __c.2424: |
2802 0022 466C 6967 .string "Flight-Time " |
2802 6874 2D54 |
2802 696D 6520 |
2802 2000 |
2805 __c.2421: |
2806 0030 3132 00 .string "12" |
2809 __c.2419: |
2810 0033 3131 00 .string "11" |
2813 __c.2417: |
2814 0036 3130 00 .string "10" |
2817 __c.2415: |
2818 0039 2025 6320 .string " %c - - - " |
2818 2020 2D20 |
2818 2020 2D20 |
2818 2020 2D20 |
2818 00 |
2821 __c.2413: |
2822 004a 2025 6320 .string " %c %c %c %c " |
2822 2020 2563 |
2822 2020 2025 |
2822 6320 2020 |
2822 2563 2000 |
2825 __c.2411: |
2826 005e 2025 6320 .string " %c %c %c %c " |
2826 2020 2563 |
2826 2020 2025 |
2826 6320 2020 |
2826 2563 2000 |
2829 __c.2409: |
2830 0072 424C 2D43 .string "BL-Ctrl found " |
2830 7472 6C20 |
2830 666F 756E |
2830 6420 00 |
2833 __c.2406: |
2834 0081 2533 6920 .string "%3i %3i %3i %3i " |
2834 2533 6920 |
2834 2533 6920 |
2834 2533 6920 |
2834 00 |
2837 __c.2404: |
2838 0092 2533 6920 .string "%3i %3i %3i %3i " |
2838 2533 6920 |
2838 2533 6920 |
2838 2533 6920 |
2838 00 |
2841 __c.2402: |
2842 00a3 2533 6920 .string "%3i %3i %3i %3i " |
2842 2533 6920 |
2842 2533 6920 |
2842 2533 6920 |
2842 00 |
2845 __c.2400: |
2846 00b4 424C 2054 .string "BL Temperature" |
2846 656D 7065 |
2846 7261 7475 |
2846 7265 00 |
2849 __c.2397: |
2850 00c3 2533 6420 .string "%3d %3d %3d %3d " |
2850 2533 6420 |
2850 2533 6420 |
2850 2533 6420 |
2850 00 |
2853 __c.2395: |
2854 00d4 2533 6420 .string "%3d %3d %3d %3d " |
2854 2533 6420 |
2854 2533 6420 |
2854 2533 6420 |
2854 00 |
2857 __c.2393: |
2858 00e5 2533 6420 .string "%3d %3d %3d %3d " |
2858 2533 6420 |
2858 2533 6420 |
2858 2533 6420 |
2858 00 |
2861 __c.2391: |
2862 00f6 424C 2D43 .string "BL-Ctrl Errors " |
2862 7472 6C20 |
2862 4572 726F |
2862 7273 2000 |
2865 __c.2388: |
2866 0106 4869 3A25 .string "Hi:%4i Cf:%4i " |
2866 3469 2020 |
2866 4366 3A25 |
2866 3469 2000 |
2869 __c.2386: |
2870 0116 4773 3A25 .string "Gs:%4i Gi:%4i " |
2870 3469 2020 |
2870 4769 3A25 |
2870 3469 2000 |
2873 __c.2384: |
2874 0126 4E69 3A25 .string "Ni:%4i Ro:%4i " |
2874 3469 2020 |
2874 526F 3A25 |
2874 3469 2000 |
2877 __c.2382: |
2878 0136 4578 7465 .string "ExternControl " |
2878 726E 436F |
2878 6E74 726F |
2878 6C20 2000 |
2881 __c.2379: |
2882 0146 5261 6E67 .string "Range:%3i-%3i" |
2882 653A 2533 |
2882 692D 2533 |
2882 6900 |
2885 __c.2377: |
2886 0154 506F 7369 .string "Position: %3i" |
2886 7469 6F6E |
2886 3A20 2533 |
2886 6900 |
2889 __c.2375: |
2890 0162 5365 7470 .string "Setpoint %3i" |
2890 6F69 6E74 |
2890 2020 2533 |
2890 6900 |
2893 __c.2373: |
2894 0170 5365 7276 .string "Servo " |
2894 6F20 2000 |
2897 __c.2370: |
2898 0178 506F 7469 .string "Poti8: %3i" |
2898 383A 2020 |
2898 2533 6900 |
2901 __c.2368: |
2902 0184 506F 7469 .string "Poti7: %3i" |
2902 373A 2020 |
2902 2533 6900 |
2905 __c.2366: |
2906 0190 506F 7469 .string "Poti6: %3i" |
2906 363A 2020 |
2906 2533 6900 |
2909 __c.2364: |
2910 019c 506F 7469 .string "Poti5: %3i" |
2910 353A 2020 |
2910 2533 6900 |
2913 __c.2361: |
2914 01a8 506F 7469 .string "Poti4: %3i" |
2914 343A 2020 |
2914 2533 6900 |
2917 __c.2359: |
2918 01b4 506F 7469 .string "Poti3: %3i" |
2918 333A 2020 |
2918 2533 6900 |
2921 __c.2357: |
2922 01c0 506F 7469 .string "Poti2: %3i" |
2922 323A 2020 |
2922 2533 6900 |
2925 __c.2355: |
2926 01cc 506F 7469 .string "Poti1: %3i" |
2926 313A 2020 |
2926 2533 6900 |
2929 __c.2352: |
2930 01d8 5374 6172 .string "Start: %5i" |
2930 743A 2020 |
2930 2020 2535 |
2930 6900 |
2933 __c.2350: |
2934 01e6 5661 6C75 .string "Value: %5i" |
2934 653A 2020 |
2934 2020 2535 |
2934 6900 |
2937 __c.2348: |
2938 01f4 4865 6164 .string "Heading: %5i" |
2938 696E 673A |
2938 2020 2535 |
2938 6900 |
2941 __c.2346: |
2942 0202 436F 6D70 .string "Compass" |
2942 6173 7300 |
2945 __c.2343: |
2946 020a 5243 2D43 .string "RC-Channels:%4i" |
2946 6861 6E6E |
2946 656C 733A |
2946 2534 6900 |
2949 __c.2341: |
2950 021a 5243 2D51 .string "RC-Quality: %4i" |
2950 7561 6C69 |
2950 7479 3A20 |
2950 2534 6900 |
2953 __c.2339: |
2954 022a 5243 2D52 .string "RC-RSSI: %4i" |
2954 5353 493A |
2954 2020 2020 |
2954 2534 6900 |
2957 __c.2337: |
2958 023a 5265 6365 .string "Receiver" |
2958 6976 6572 |
2958 00 |
2961 __c.2334: |
2962 0243 4469 7363 .string "Discharge: %5imAh" |
2962 6861 7267 |
2962 653A 2025 |
2962 3569 6D41 |
2962 6800 |
2965 __c.2332: |
2966 0255 506F 7765 .string "Power: %4iW" |
2966 723A 2020 |
2966 2020 2025 |
2966 3469 5700 |
2969 __c.2330: |
2970 0265 4375 7272 .string "Current: %3i.%1iA" |
2970 656E 743A |
2970 2020 2025 |
2970 3369 2E25 |
2970 3169 4100 |
2973 __c.2328: |
2974 0279 566F 6C74 .string "Voltage: %3i.%1iV" |
2974 6167 653A |
2974 2020 2025 |
2974 3369 2E25 |
2974 3169 5600 |
2977 __c.2325: |
2978 028d 5A20 2020 .string "Z %4i (%3i)" |
2978 2025 3469 |
2978 2028 2533 |
2978 6929 00 |
2981 __c.2323: |
2982 029c 526F 6C6C .string "Roll %4i (%3i)" |
2982 2025 3469 |
2982 2028 2533 |
2982 6929 00 |
2985 __c.2321: |
2986 02ab 4E69 636B .string "Nick %4i (%3i)" |
2986 2025 3469 |
2986 2028 2533 |
2986 6929 00 |
2989 __c.2319: |
2990 02ba 4143 4320 .string "ACC - Sensor" |
2990 2D20 5365 |
2990 6E73 6F72 |
2990 00 |
2993 __c.2316: |
2994 02c7 5961 7720 .string "Yaw %4i (%3i)(%3i)" |
2994 2025 3469 |
2994 2028 2533 |
2994 6929 2825 |
2994 3369 2900 |
2997 __c.2314: |
2998 02db 526F 6C6C .string "Roll %4i (%3i)(%3i)" |
2998 2025 3469 |
2998 2028 2533 |
2998 6929 2825 |
2998 3369 2900 |
3001 __c.2312: |
3002 02ef 4E69 636B .string "Nick %4i (%3i)(%3i)" |
3002 2025 3469 |
3002 2028 2533 |
3002 6929 2825 |
3002 3369 2900 |
3005 __c.2310: |
3006 0303 5961 7720 .string "Yaw %4i (%3i)" |
3006 2025 3469 |
3006 2028 2533 |
3006 6929 00 |
3009 __c.2308: |
3010 0312 526F 6C6C .string "Roll %4i (%3i.%x)" |
3010 2025 3469 |
3010 2028 2533 |
3010 692E 2578 |
3010 2900 |
3013 __c.2306: |
3014 0324 4E69 636B .string "Nick %4i (%3i.%x)" |
3014 2025 3469 |
3014 2028 2533 |
3014 692E 2578 |
3014 2900 |
3017 __c.2304: |
3018 0336 4769 6572 .string "Gier%4i (%3i)" |
3018 2534 6920 |
3018 2825 3369 |
3018 2900 |
3021 __c.2302: |
3022 0344 526F 6C6C .string "Roll%4i (%3i.%i)" |
3022 2534 6920 |
3022 2825 3369 |
3022 2E25 6929 |
3022 00 |
3025 __c.2300: |
3026 0355 4E69 636B .string "Nick%4i (%3i.%i)" |
3026 2534 6920 |
3026 2825 3369 |
3026 2E25 6929 |
3026 00 |
3029 __c.2298: |
3030 0366 4779 726F .string "Gyro - Sensor" |
3030 202D 2053 |
3030 656E 736F |
3030 7200 |
3033 __c.2295: |
3034 0374 5033 3A25 .string "P3:%4i P4:%4i " |
3034 3469 2020 |
3034 5034 3A25 |
3034 3469 2000 |
3037 __c.2293: |
3038 0384 5031 3A25 .string "P1:%4i P2:%4i " |
3038 3469 2020 |
3038 5032 3A25 |
3038 3469 2000 |
3041 __c.2291: |
3042 0394 4773 3A25 .string "Gs:%4i Gi:%4i " |
3042 3469 2020 |
3042 4769 3A25 |
3042 3469 2000 |
3045 __c.2289: |
3046 03a4 4E69 3A25 .string "Ni:%4i Ro:%4i " |
3046 3469 2020 |
3046 526F 3A25 |
3046 3469 2000 |
3049 __c.2286: |
3050 03b4 4B37 3A25 .string "K7:%4i K8:%4i " |
3050 3469 2020 |
3050 4B38 3A25 |
3050 3469 2000 |
3053 __c.2284: |
3054 03c4 4B35 3A25 .string "K5:%4i K6:%4i " |
3054 3469 2020 |
3054 4B36 3A25 |
3054 3469 2000 |
3057 __c.2282: |
3058 03d4 4B33 3A25 .string "K3:%4i K4:%4i " |
3058 3469 2020 |
3058 4B34 3A25 |
3058 3469 2000 |
3061 __c.2280: |
3062 03e4 4B31 3A25 .string "K1:%4i K2:%4i " |
3062 3469 2020 |
3062 4B32 3A25 |
3062 3469 2000 |
3065 __c.2277: |
3066 03f4 436F 6D70 .string "Compass: %5i" |
3066 6173 733A |
3066 2020 2025 |
3066 3569 00 |
3069 __c.2275: |
3070 0403 526F 6C6C .string "Roll: %5i" |
3070 3A20 2020 |
3070 2020 2025 |
3070 3569 00 |
3073 __c.2273: |
3074 0412 4E69 636B .string "Nick: %5i" |
3074 3A20 2020 |
3074 2020 2025 |
3074 3569 00 |
3077 __c.2271: |
3078 0421 6163 742E .string "act. bearing" |
3078 2062 6561 |
3078 7269 6E67 |
3078 00 |
3081 __c.2268: |
3082 042e 4449 5341 .string "DISABLED" |
3082 424C 4544 |
3082 00 |
3085 __c.2266: |
3086 0437 4865 6967 .string "Height control" |
3086 6874 2063 |
3086 6F6E 7472 |
3086 6F6C 00 |
3089 __c.2264: |
3090 0446 4449 5341 .string "DISABLED" |
3090 424C 4544 |
3090 00 |
3093 __c.2262: |
3094 044f 4865 6967 .string "Height control" |
3094 6874 2063 |
3094 6F6E 7472 |
3094 6F6C 00 |
3097 __c.2260: |
3098 045e 4F66 6673 .string "Offset: %5i" |
3098 6574 3A20 |
3098 2025 3569 |
3098 00 |
3101 __c.2258: |
3102 046b 5072 6573 .string "Pressure:%5i" |
3102 7375 7265 |
3102 3A25 3569 |
3102 00 |
3105 __c.2256: |
3106 0478 5365 7470 .string "Setpoint:%5i" |
3106 6F69 6E74 |
3106 3A25 3569 |
3106 00 |
3109 __c.2254: |
3110 0485 4865 6967 .string "Height: %5i" |
3110 6874 3A20 |
3110 2025 3569 |
3110 00 |
3113 __c.2250: |
3114 0492 4932 4320 .string "I2C ERROR!!!" |
3114 4552 524F |
3114 5221 2121 |
3114 00 |
3117 __c.2248: |
3118 049f 4D69 7865 .string "Mixer Error!" |
3118 7220 4572 |
3118 726F 7221 |
3118 00 |
3121 __c.2246: |
3122 04ac 4D69 7373 .string "Missing BL-Ctrl:%d!!" |
3122 696E 6720 |
3122 424C 2D43 |
3122 7472 6C3A |
3122 2564 2121 |
3125 __c.2244: |
3126 04c1 4861 7264 .string "Hardware Error 1:%d !!" |
3126 7761 7265 |
3126 2045 7272 |
3126 6F72 2031 |
3126 3A25 6420 |
3129 __c.2242: |
3130 04d8 5365 7474 .string "Setting:%d %s" |
3130 696E 673A |
3130 2564 2025 |
3130 7300 |
3133 __c.2240: |
3134 04e6 4857 3A56 .string "HW:V%d.%d SW:%d.%d%c-Arthur-P1" |
3134 2564 2E25 |
3134 6420 5357 |
3134 3A25 642E |
3134 2564 2563 |
3137 __c.2238: |
3138 0505 2B20 4D69 .string "+ MikroKopter +" |
3138 6B72 6F4B |
3138 6F70 7465 |
3138 7220 2B00 |
3141 __c.2235: |
3142 0515 5B25 695D .string "[%i]" |
3142 00 |
3145 __c.2233: |
3146 051a 5B25 695D .string "[%i]" |
3146 00 |
3147 .global __do_copy_data |
3148 .global __do_clear_bss |
8 .global __do_copy_data |
9 .global __do_clear_bss |
10 .global RemoteKeys |
11 .global RemoteKeys |
12 .section .bss |
15 RemoteKeys: |
16 0000 00 .skip 1,0 |
17 .global MenuePunkt |
18 .global MenuePunkt |
21 MenuePunkt: |
22 0001 00 .skip 1,0 |
23 .global MaxMenue |
24 .data |
27 MaxMenue: |
28 0000 11 .byte 17 |
29 .global DispPtr |
30 .global DispPtr |
31 .section .bss |
34 DispPtr: |
35 0002 00 .skip 1,0 |
36 .global DisplayBuff |
37 .data |
40 DisplayBuff: |
41 0001 4865 6C6C .string "Hello World" |
41 6F20 576F |
41 726C 6400 |
42 000d 0000 0000 .skip 68,0 |
42 0000 0000 |
42 0000 0000 |
42 0000 0000 |
42 0000 0000 |
43 .text |
44 .global LcdClear |
46 LcdClear: |
47 /* prologue: frame size=0 */ |
48 /* prologue end (size=0) */ |
49 0000 90E2 ldi r25,lo8(32) |
50 0002 E0E0 ldi r30,lo8(DisplayBuff) |
51 0004 F0E0 ldi r31,hi8(DisplayBuff) |
52 0006 8FE4 ldi r24,lo8(79) |
53 .L5: |
54 0008 9193 st Z+,r25 |
55 000a 8150 subi r24,lo8(-(-1)) |
56 000c 87FF sbrs r24,7 |
57 000e FCCF rjmp .L5 |
58 /* epilogue: frame size=0 */ |
59 0010 0895 ret |
60 /* epilogue end (size=1) */ |
61 /* function LcdClear size 9 (8) */ |
63 .global Menu_Putchar |
65 Menu_Putchar: |
66 /* prologue: frame size=0 */ |
67 /* prologue end (size=0) */ |
68 0012 9091 0000 lds r25,DispPtr |
69 0016 E0E0 ldi r30,lo8(DisplayBuff) |
70 0018 F0E0 ldi r31,hi8(DisplayBuff) |
71 001a E90F add r30,r25 |
72 001c F11D adc r31,__zero_reg__ |
73 001e 8083 st Z,r24 |
74 0020 9F5F subi r25,lo8(-(1)) |
75 0022 9093 0000 sts DispPtr,r25 |
76 /* epilogue: frame size=0 */ |
77 0026 0895 ret |
78 /* epilogue end (size=1) */ |
79 /* function Menu_Putchar size 11 (10) */ |
81 .section .progmem.data,"a",@progbits |
84 __c.0: |
85 0000 5B25 695D .string "[%i]" |
85 00 |
88 __c.1: |
89 0005 5B25 695D .string "[%i]" |
89 00 |
92 __c.2: |
93 000a 2B20 4D69 .string "+ MikroKopter +" |
93 6B72 6F4B |
93 6F70 7465 |
93 7220 2B00 |
96 __c.3: |
97 001a 4857 3A56 .string "HW:V%d.%d SW:%d.%d%c-Arthur-P1" |
97 2564 2E25 |
97 6420 5357 |
97 3A25 642E |
97 2564 2563 |
100 __c.4: |
101 0039 5365 7474 .string "Setting:%d %s" |
101 696E 673A |
101 2564 2025 |
101 7300 |
104 __c.5: |
105 0047 4861 7264 .string "Hardware Error 1:%d !!" |
105 7761 7265 |
105 2045 7272 |
105 6F72 2031 |
105 3A25 6420 |
108 __c.6: |
109 005e 4D69 7373 .string "Missing BL-Ctrl:%d!!" |
109 696E 6720 |
109 424C 2D43 |
109 7472 6C3A |
109 2564 2121 |
112 __c.7: |
113 0073 4D69 7865 .string "Mixer Error!" |
113 7220 4572 |
113 726F 7221 |
113 00 |
116 __c.8: |
117 0080 4932 4320 .string "I2C ERROR!!!" |
117 4552 524F |
117 5221 2121 |
117 00 |
120 __c.9: |
121 008d 4865 6967 .string "Height: %5i" |
121 6874 3A20 |
121 2025 3569 |
121 00 |
124 __c.10: |
125 009a 5365 7470 .string "Setpoint:%5i" |
125 6F69 6E74 |
125 3A25 3569 |
125 00 |
128 __c.11: |
129 00a7 5072 6573 .string "Pressure:%5i" |
129 7375 7265 |
129 3A25 3569 |
129 00 |
132 __c.12: |
133 00b4 4F66 6673 .string "Offset: %5i" |
133 6574 3A20 |
133 2025 3569 |
133 00 |
136 __c.13: |
137 00c1 4865 6967 .string "Height control" |
137 6874 2063 |
137 6F6E 7472 |
137 6F6C 00 |
140 __c.14: |
141 00d0 4449 5341 .string "DISABLED" |
141 424C 4544 |
141 00 |
144 __c.15: |
145 00d9 4865 6967 .string "Height control" |
145 6874 2063 |
145 6F6E 7472 |
145 6F6C 00 |
148 __c.16: |
149 00e8 4449 5341 .string "DISABLED" |
149 424C 4544 |
149 00 |
152 __c.17: |
153 00f1 6163 742E .string "act. bearing" |
153 2062 6561 |
153 7269 6E67 |
153 00 |
156 __c.18: |
157 00fe 4E69 636B .string "Nick: %5i" |
157 3A20 2020 |
157 2020 2025 |
157 3569 00 |
160 __c.19: |
161 010d 526F 6C6C .string "Roll: %5i" |
161 3A20 2020 |
161 2020 2025 |
161 3569 00 |
164 __c.20: |
165 011c 436F 6D70 .string "Compass: %5i" |
165 6173 733A |
165 2020 2025 |
165 3569 00 |
168 __c.21: |
169 012b 4B31 3A25 .string "K1:%4i K2:%4i " |
169 3469 2020 |
169 4B32 3A25 |
169 3469 2000 |
172 __c.22: |
173 013b 4B33 3A25 .string "K3:%4i K4:%4i " |
173 3469 2020 |
173 4B34 3A25 |
173 3469 2000 |
176 __c.23: |
177 014b 4B35 3A25 .string "K5:%4i K6:%4i " |
177 3469 2020 |
177 4B36 3A25 |
177 3469 2000 |
180 __c.24: |
181 015b 4B37 3A25 .string "K7:%4i K8:%4i " |
181 3469 2020 |
181 4B38 3A25 |
181 3469 2000 |
184 __c.25: |
185 016b 4E69 3A25 .string "Ni:%4i Ro:%4i " |
185 3469 2020 |
185 526F 3A25 |
185 3469 2000 |
188 __c.26: |
189 017b 4773 3A25 .string "Gs:%4i Gi:%4i " |
189 3469 2020 |
189 4769 3A25 |
189 3469 2000 |
192 __c.27: |
193 018b 5031 3A25 .string "P1:%4i P2:%4i " |
193 3469 2020 |
193 5032 3A25 |
193 3469 2000 |
196 __c.28: |
197 019b 5033 3A25 .string "P3:%4i P4:%4i " |
197 3469 2020 |
197 5034 3A25 |
197 3469 2000 |
200 __c.29: |
201 01ab 4779 726F .string "Gyro - Sensor" |
201 202D 2053 |
201 656E 736F |
201 7200 |
204 __c.30: |
205 01b9 4E69 636B .string "Nick%4i (%3i.%i)" |
205 2534 6920 |
205 2825 3369 |
205 2E25 6929 |
205 00 |
208 __c.31: |
209 01ca 526F 6C6C .string "Roll%4i (%3i.%i)" |
209 2534 6920 |
209 2825 3369 |
209 2E25 6929 |
209 00 |
212 __c.32: |
213 01db 4769 6572 .string "Gier%4i (%3i)" |
213 2534 6920 |
213 2825 3369 |
213 2900 |
216 __c.33: |
217 01e9 4E69 636B .string "Nick %4i (%3i.%x)" |
217 2025 3469 |
217 2028 2533 |
217 692E 2578 |
217 2900 |
220 __c.34: |
221 01fb 526F 6C6C .string "Roll %4i (%3i.%x)" |
221 2025 3469 |
221 2028 2533 |
221 692E 2578 |
221 2900 |
224 __c.35: |
225 020d 5961 7720 .string "Yaw %4i (%3i)" |
225 2025 3469 |
225 2028 2533 |
225 6929 00 |
228 __c.36: |
229 021c 4E69 636B .string "Nick %4i (%3i)(%3i)" |
229 2025 3469 |
229 2028 2533 |
229 6929 2825 |
229 3369 2900 |
232 __c.37: |
233 0230 526F 6C6C .string "Roll %4i (%3i)(%3i)" |
233 2025 3469 |
233 2028 2533 |
233 6929 2825 |
233 3369 2900 |
236 __c.38: |
237 0244 5961 7720 .string "Yaw %4i (%3i)(%3i)" |
237 2025 3469 |
237 2028 2533 |
237 6929 2825 |
237 3369 2900 |
240 __c.39: |
241 0258 4143 4320 .string "ACC - Sensor" |
241 2D20 5365 |
241 6E73 6F72 |
241 00 |
244 __c.40: |
245 0265 4E69 636B .string "Nick %4i (%3i)" |
245 2025 3469 |
245 2028 2533 |
245 6929 00 |
248 __c.41: |
249 0274 526F 6C6C .string "Roll %4i (%3i)" |
249 2025 3469 |
249 2028 2533 |
249 6929 00 |
252 __c.42: |
253 0283 5A20 2020 .string "Z %4i (%3i)" |
253 2025 3469 |
253 2028 2533 |
253 6929 00 |
256 __c.43: |
257 0292 566F 6C74 .string "Voltage: %3i.%1iV" |
257 6167 653A |
257 2020 2025 |
257 3369 2E25 |
257 3169 5600 |
260 __c.44: |
261 02a6 4375 7272 .string "Current: %3i.%1iA" |
261 656E 743A |
261 2020 2025 |
261 3369 2E25 |
261 3169 4100 |
264 __c.45: |
265 02ba 506F 7765 .string "Power: %4iW" |
265 723A 2020 |
265 2020 2025 |
265 3469 5700 |
268 __c.46: |
269 02ca 4469 7363 .string "Discharge: %5imAh" |
269 6861 7267 |
269 653A 2025 |
269 3569 6D41 |
269 6800 |
272 __c.47: |
273 02dc 5265 6365 .string "Receiver" |
273 6976 6572 |
273 00 |
276 __c.48: |
277 02e5 5243 2D52 .string "RC-RSSI: %4i" |
277 5353 493A |
277 2020 2020 |
277 2534 6900 |
280 __c.49: |
281 02f5 5243 2D51 .string "RC-Quality: %4i" |
281 7561 6C69 |
281 7479 3A20 |
281 2534 6900 |
284 __c.50: |
285 0305 5243 2D43 .string "RC-Channels:%4i" |
285 6861 6E6E |
285 656C 733A |
285 2534 6900 |
288 __c.51: |
289 0315 436F 6D70 .string "Compass" |
289 6173 7300 |
292 __c.52: |
293 031d 4865 6164 .string "Heading: %5i" |
293 696E 673A |
293 2020 2535 |
293 6900 |
296 __c.53: |
297 032b 5661 6C75 .string "Value: %5i" |
297 653A 2020 |
297 2020 2535 |
297 6900 |
300 __c.54: |
301 0339 5374 6172 .string "Start: %5i" |
301 743A 2020 |
301 2020 2535 |
301 6900 |
304 __c.55: |
305 0347 506F 7469 .string "Poti1: %3i" |
305 313A 2020 |
305 2533 6900 |
308 __c.56: |
309 0353 506F 7469 .string "Poti2: %3i" |
309 323A 2020 |
309 2533 6900 |
312 __c.57: |
313 035f 506F 7469 .string "Poti3: %3i" |
313 333A 2020 |
313 2533 6900 |
316 __c.58: |
317 036b 506F 7469 .string "Poti4: %3i" |
317 343A 2020 |
317 2533 6900 |
320 __c.59: |
321 0377 506F 7469 .string "Poti5: %3i" |
321 353A 2020 |
321 2533 6900 |
324 __c.60: |
325 0383 506F 7469 .string "Poti6: %3i" |
325 363A 2020 |
325 2533 6900 |
328 __c.61: |
329 038f 506F 7469 .string "Poti7: %3i" |
329 373A 2020 |
329 2533 6900 |
332 __c.62: |
333 039b 506F 7469 .string "Poti8: %3i" |
333 383A 2020 |
333 2533 6900 |
336 __c.63: |
337 03a7 5365 7276 .string "Servo " |
337 6F20 2000 |
340 __c.64: |
341 03af 5365 7470 .string "Setpoint %3i" |
341 6F69 6E74 |
341 2020 2533 |
341 6900 |
344 __c.65: |
345 03bd 506F 7369 .string "Position: %3i" |
345 7469 6F6E |
345 3A20 2533 |
345 6900 |
348 __c.66: |
349 03cb 5261 6E67 .string "Range:%3i-%3i" |
349 653A 2533 |
349 692D 2533 |
349 6900 |
352 __c.67: |
353 03d9 4578 7465 .string "ExternControl " |
353 726E 436F |
353 6E74 726F |
353 6C20 2000 |
356 __c.68: |
357 03e9 4E69 3A25 .string "Ni:%4i Ro:%4i " |
357 3469 2020 |
357 526F 3A25 |
357 3469 2000 |
360 __c.69: |
361 03f9 4773 3A25 .string "Gs:%4i Gi:%4i " |
361 3469 2020 |
361 4769 3A25 |
361 3469 2000 |
364 __c.70: |
365 0409 4869 3A25 .string "Hi:%4i Cf:%4i " |
365 3469 2020 |
365 4366 3A25 |
365 3469 2000 |
368 __c.71: |
369 0419 424C 2D43 .string "BL-Ctrl Errors " |
369 7472 6C20 |
369 4572 726F |
369 7273 2000 |
372 __c.72: |
373 0429 2533 6420 .string "%3d %3d %3d %3d " |
373 2533 6420 |
373 2533 6420 |
373 2533 6420 |
373 00 |
376 __c.73: |
377 043a 2533 6420 .string "%3d %3d %3d %3d " |
377 2533 6420 |
377 2533 6420 |
377 2533 6420 |
377 00 |
380 __c.74: |
381 044b 2533 6420 .string "%3d %3d %3d %3d " |
381 2533 6420 |
381 2533 6420 |
381 2533 6420 |
381 00 |
384 __c.75: |
385 045c 424C 2054 .string "BL Temperature" |
385 656D 7065 |
385 7261 7475 |
385 7265 00 |
388 __c.76: |
389 046b 2533 6920 .string "%3i %3i %3i %3i " |
389 2533 6920 |
389 2533 6920 |
389 2533 6920 |
389 00 |
392 __c.77: |
393 047c 2533 6920 .string "%3i %3i %3i %3i " |
393 2533 6920 |
393 2533 6920 |
393 2533 6920 |
393 00 |
396 __c.78: |
397 048d 2533 6920 .string "%3i %3i %3i %3i " |
397 2533 6920 |
397 2533 6920 |
397 2533 6920 |
397 00 |
400 __c.79: |
401 049e 424C 2D43 .string "BL-Ctrl found " |
401 7472 6C20 |
401 666F 756E |
401 6420 00 |
404 __c.80: |
405 04ad 2025 6320 .string " %c %c %c %c " |
405 2020 2563 |
405 2020 2025 |
405 6320 2020 |
405 2563 2000 |
408 __c.81: |
409 04c1 2025 6320 .string " %c %c %c %c " |
409 2020 2563 |
409 2020 2025 |
409 6320 2020 |
409 2563 2000 |
412 __c.82: |
413 04d5 2025 6320 .string " %c - - - " |
413 2020 2D20 |
413 2020 2D20 |
413 2020 2D20 |
413 00 |
416 __c.83: |
417 04e6 3130 00 .string "10" |
420 __c.84: |
421 04e9 3131 00 .string "11" |
424 __c.85: |
425 04ec 3132 00 .string "12" |
428 __c.86: |
429 04ef 466C 6967 .string "Flight-Time " |
429 6874 2D54 |
429 696D 6520 |
429 2000 |
432 __c.87: |
433 04fd 546F 7461 .string "Total:%5umin" |
433 6C3A 2535 |
433 756D 696E |
433 00 |
436 __c.88: |
437 050a 4163 743A .string "Act: %5umin" |
437 2020 2535 |
437 756D 696E |
437 00 |
440 __c.89: |
441 0517 2872 6573 .string "(reset)" |
441 6574 2900 |
442 .text |
443 .global Menu |
445 Menu: |
446 /* prologue: frame size=0 */ |
447 0028 EF92 push r14 |
448 002a FF92 push r15 |
449 002c 0F93 push r16 |
450 002e 1F93 push r17 |
451 0030 CF93 push r28 |
452 0032 DF93 push r29 |
453 /* prologue end (size=6) */ |
454 0034 2091 0000 lds r18,RemoteKeys |
455 0038 20FF sbrs r18,0 |
456 003a 0AC0 rjmp .L10 |
457 003c 8091 0000 lds r24,MenuePunkt |
458 0040 8823 tst r24 |
459 0042 11F0 breq .L11 |
460 0044 8150 subi r24,lo8(-(-1)) |
461 0046 02C0 rjmp .L82 |
462 .L11: |
463 0048 8091 0000 lds r24,MaxMenue |
464 .L82: |
465 004c 8093 0000 sts MenuePunkt,r24 |
466 .L10: |
467 0050 21FF sbrs r18,1 |
468 0052 0CC0 rjmp .L13 |
469 0054 9091 0000 lds r25,MenuePunkt |
470 0058 8091 0000 lds r24,MaxMenue |
471 005c 9817 cp r25,r24 |
472 005e 19F4 brne .L14 |
473 0060 1092 0000 sts MenuePunkt,__zero_reg__ |
474 0064 03C0 rjmp .L13 |
475 .L14: |
476 0066 9F5F subi r25,lo8(-(1)) |
477 0068 9093 0000 sts MenuePunkt,r25 |
478 .L13: |
479 006c 822F mov r24,r18 |
480 006e 9927 clr r25 |
481 0070 80FF sbrs r24,0 |
482 0072 04C0 rjmp .L16 |
483 0074 81FF sbrs r24,1 |
484 0076 02C0 rjmp .L16 |
485 0078 1092 0000 sts MenuePunkt,__zero_reg__ |
486 .L16: |
487 007c 0E94 0000 call LcdClear |
488 0080 8091 0000 lds r24,MenuePunkt |
489 0084 282F mov r18,r24 |
490 0086 3327 clr r19 |
491 0088 C0E0 ldi r28,lo8(pm(Menu_Putchar)) |
492 008a EC2E mov r14,r28 |
493 008c C0E0 ldi r28,hi8(pm(Menu_Putchar)) |
494 008e FC2E mov r15,r28 |
495 0090 C091 0000 lds r28,_printf_P |
496 0094 D091 0000 lds r29,(_printf_P)+1 |
497 0098 8A30 cpi r24,lo8(10) |
498 009a 98F4 brsh .L17 |
499 009c 81E1 ldi r24,lo8(17) |
500 009e 8093 0000 sts DispPtr,r24 |
501 00a2 3F93 push r19 |
502 00a4 2F93 push r18 |
503 00a6 80E0 ldi r24,lo8(__c.0) |
504 00a8 90E0 ldi r25,hi8(__c.0) |
505 00aa 9F93 push r25 |
506 00ac 8F93 push r24 |
507 00ae FF92 push r15 |
508 00b0 EF92 push r14 |
509 00b2 FE01 movw r30,r28 |
510 00b4 0995 icall |
511 00b6 2DB7 in r18,__SP_L__ |
512 00b8 3EB7 in r19,__SP_H__ |
513 00ba 2A5F subi r18,lo8(-(6)) |
514 00bc 3F4F sbci r19,hi8(-(6)) |
515 00be 2DBF out __SP_L__,r18 |
516 00c0 11C0 rjmp .L18 |
517 .L17: |
518 00c2 80E1 ldi r24,lo8(16) |
519 00c4 8093 0000 sts DispPtr,r24 |
520 00c8 3F93 push r19 |
521 00ca 2F93 push r18 |
522 00cc 80E0 ldi r24,lo8(__c.1) |
523 00ce 90E0 ldi r25,hi8(__c.1) |
524 00d0 9F93 push r25 |
525 00d2 8F93 push r24 |
526 00d4 FF92 push r15 |
527 00d6 EF92 push r14 |
528 00d8 FE01 movw r30,r28 |
529 00da 0995 icall |
530 00dc 8DB7 in r24,__SP_L__ |
531 00de 9EB7 in r25,__SP_H__ |
532 00e0 0696 adiw r24,6 |
533 00e2 8DBF out __SP_L__,r24 |
534 .L18: |
535 00e4 2091 0000 lds r18,MenuePunkt |
536 00e8 822F mov r24,r18 |
537 00ea 9927 clr r25 |
538 00ec AA27 clr r26 |
539 00ee BB27 clr r27 |
540 00f0 FC01 movw r30,r24 |
541 00f2 4297 sbiw r24,18 |
542 00f4 10F0 brlo .+4 |
543 00f6 0C94 0000 jmp .L79 |
544 00fa E050 subi r30,lo8(-(pm(.L81))) |
545 00fc F040 sbci r31,hi8(-(pm(.L81))) |
546 00fe B0E0 ldi r27,lo8(pm(Menu_Putchar)) |
547 0100 EB2E mov r14,r27 |
548 0102 B0E0 ldi r27,hi8(pm(Menu_Putchar)) |
549 0104 FB2E mov r15,r27 |
550 0106 C091 0000 lds r28,_printf_P |
551 010a D091 0000 lds r29,(_printf_P)+1 |
552 010e 0C94 0000 jmp __tablejump2__ |
553 .data |
554 .section .progmem.gcc_sw_table, "a", @progbits |
555 .p2align 1 |
556 .L81: |
557 0000 0000 .word pm(.L20) |
558 0002 0000 .word pm(.L28) |
559 0004 0000 .word pm(.L31) |
560 0006 0000 .word pm(.L34) |
561 0008 0000 .word pm(.L35) |
562 000a 0000 .word pm(.L36) |
563 000c 0000 .word pm(.L63) |
564 000e 0000 .word pm(.L64) |
565 0010 0000 .word pm(.L65) |
566 0012 0000 .word pm(.L66) |
567 0014 0000 .word pm(.L67) |
568 0016 0000 .word pm(.L68) |
569 0018 0000 .word pm(.L69) |
570 001a 0000 .word pm(.L70) |
571 001c 0000 .word pm(.L71) |
572 001e 0000 .word pm(.L72) |
573 0020 0000 .word pm(.L73) |
574 0022 0000 .word pm(.L77) |
575 .text |
576 .L20: |
577 0112 1092 0000 sts DispPtr,__zero_reg__ |
578 0116 80E0 ldi r24,lo8(__c.2) |
579 0118 90E0 ldi r25,hi8(__c.2) |
580 011a 9F93 push r25 |
581 011c 8F93 push r24 |
582 011e 00E0 ldi r16,lo8(pm(Menu_Putchar)) |
583 0120 10E0 ldi r17,hi8(pm(Menu_Putchar)) |
584 0122 FF92 push r15 |
585 0124 EF92 push r14 |
586 0126 FE01 movw r30,r28 |
587 0128 0995 icall |
588 012a 84E1 ldi r24,lo8(20) |
589 012c 8093 0000 sts DispPtr,r24 |
590 0130 0F90 pop __tmp_reg__ |
591 0132 0F90 pop __tmp_reg__ |
592 0134 0F90 pop __tmp_reg__ |
593 0136 0F90 pop __tmp_reg__ |
594 0138 87E6 ldi r24,lo8(103) |
595 013a 90E0 ldi r25,hi8(103) |
596 013c 9F93 push r25 |
597 013e 8F93 push r24 |
598 0140 80E5 ldi r24,lo8(80) |
599 0142 90E0 ldi r25,hi8(80) |
600 0144 9F93 push r25 |
601 0146 8F93 push r24 |
602 0148 1F92 push __zero_reg__ |
603 014a 1F92 push __zero_reg__ |
604 014c 8091 0000 lds r24,PlatinenVersion |
605 0150 6AE0 ldi r22,lo8(10) |
606 0152 0E94 0000 call __udivmodqi4 |
607 0156 892F mov r24,r25 |
608 0158 9927 clr r25 |
609 015a 9F93 push r25 |
610 015c 8F93 push r24 |
611 015e 8091 0000 lds r24,PlatinenVersion |
612 0162 0E94 0000 call __udivmodqi4 |
613 0166 9927 clr r25 |
614 0168 9F93 push r25 |
615 016a 8F93 push r24 |
616 016c 80E0 ldi r24,lo8(__c.3) |
617 016e 90E0 ldi r25,hi8(__c.3) |
618 0170 9F93 push r25 |
619 0172 8F93 push r24 |
620 0174 FF92 push r15 |
621 0176 EF92 push r14 |
622 0178 E091 0000 lds r30,_printf_P |
623 017c F091 0000 lds r31,(_printf_P)+1 |
624 0180 0995 icall |
625 0182 88E2 ldi r24,lo8(40) |
626 0184 8093 0000 sts DispPtr,r24 |
627 0188 2DB7 in r18,__SP_L__ |
628 018a 3EB7 in r19,__SP_H__ |
629 018c 225F subi r18,lo8(-(14)) |
630 018e 3F4F sbci r19,hi8(-(14)) |
631 0190 2DBF out __SP_L__,r18 |
632 0192 80E0 ldi r24,lo8(Mixer+1) |
633 0194 90E0 ldi r25,hi8(Mixer+1) |
634 0196 9F93 push r25 |
635 0198 8F93 push r24 |
636 019a 0E94 0000 call GetActiveParamSet |
637 019e 9927 clr r25 |
638 01a0 9F93 push r25 |
639 01a2 8F93 push r24 |
640 01a4 80E0 ldi r24,lo8(__c.4) |
641 01a6 90E0 ldi r25,hi8(__c.4) |
642 01a8 9F93 push r25 |
643 01aa 8F93 push r24 |
644 01ac FF92 push r15 |
645 01ae EF92 push r14 |
646 01b0 E091 0000 lds r30,_printf_P |
647 01b4 F091 0000 lds r31,(_printf_P)+1 |
648 01b8 0995 icall |
649 01ba 8DB7 in r24,__SP_L__ |
650 01bc 9EB7 in r25,__SP_H__ |
651 01be 0896 adiw r24,8 |
652 01c0 8DBF out __SP_L__,r24 |
653 01c2 9091 0000 lds r25,VersionInfo+5 |
654 01c6 9923 tst r25 |
655 01c8 51F0 breq .L21 |
656 01ca 8CE3 ldi r24,lo8(60) |
657 01cc 8093 0000 sts DispPtr,r24 |
658 01d0 892F mov r24,r25 |
659 01d2 9927 clr r25 |
660 01d4 9F93 push r25 |
661 01d6 8F93 push r24 |
662 01d8 80E0 ldi r24,lo8(__c.5) |
663 01da 90E0 ldi r25,hi8(__c.5) |
664 01dc 85C6 rjmp .L93 |
665 .L21: |
666 01de 9091 0000 lds r25,MissingMotor |
667 01e2 9923 tst r25 |
668 01e4 71F0 breq .L23 |
669 01e6 8CE3 ldi r24,lo8(60) |
670 01e8 8093 0000 sts DispPtr,r24 |
671 01ec 892F mov r24,r25 |
672 01ee 9927 clr r25 |
673 01f0 9F93 push r25 |
674 01f2 8F93 push r24 |
675 01f4 80E0 ldi r24,lo8(__c.6) |
676 01f6 90E0 ldi r25,hi8(__c.6) |
677 01f8 9F93 push r25 |
678 01fa 8F93 push r24 |
679 01fc 1F93 push r17 |
680 01fe 0F93 push r16 |
681 0200 91C0 rjmp .L86 |
682 .L23: |
683 0202 8091 0000 lds r24,VersionInfo+6 |
684 0206 84FF sbrs r24,4 |
685 0208 07C0 rjmp .L25 |
686 020a 8CE3 ldi r24,lo8(60) |
687 020c 8093 0000 sts DispPtr,r24 |
688 0210 80E0 ldi r24,lo8(__c.7) |
689 0212 90E0 ldi r25,hi8(__c.7) |
690 0214 0C94 0000 jmp .L91 |
691 .L25: |
692 0218 8091 0000 lds r24,I2CTimeout |
693 021c 9091 0000 lds r25,(I2CTimeout)+1 |
694 0220 0697 sbiw r24,6 |
695 0222 10F0 brlo .+4 |
696 0224 0C94 0000 jmp .L19 |
697 0228 8CE3 ldi r24,lo8(60) |
698 022a 8093 0000 sts DispPtr,r24 |
699 022e 80E0 ldi r24,lo8(__c.8) |
700 0230 90E0 ldi r25,hi8(__c.8) |
701 0232 0C94 0000 jmp .L91 |
702 .L28: |
703 0236 8091 0000 lds r24,EE_Parameter+13 |
704 023a A0E0 ldi r26,lo8(pm(Menu_Putchar)) |
705 023c EA2E mov r14,r26 |
706 023e A0E0 ldi r26,hi8(pm(Menu_Putchar)) |
707 0240 FA2E mov r15,r26 |
708 0242 C091 0000 lds r28,_printf_P |
709 0246 D091 0000 lds r29,(_printf_P)+1 |
710 024a 80FF sbrs r24,0 |
711 024c 74C0 rjmp .L29 |
712 024e 1092 0000 sts DispPtr,__zero_reg__ |
713 0252 8091 0000 lds r24,HoehenWert |
714 0256 9091 0000 lds r25,(HoehenWert)+1 |
715 025a A091 0000 lds r26,(HoehenWert)+2 |
716 025e B091 0000 lds r27,(HoehenWert)+3 |
717 0262 BC01 movw r22,r24 |
718 0264 CD01 movw r24,r26 |
719 0266 25E0 ldi r18,lo8(5) |
720 0268 30E0 ldi r19,hi8(5) |
721 026a 40E0 ldi r20,hlo8(5) |
722 026c 50E0 ldi r21,hhi8(5) |
723 026e 0E94 0000 call __divmodsi4 |
724 0272 3F93 push r19 |
725 0274 2F93 push r18 |
726 0276 80E0 ldi r24,lo8(__c.9) |
727 0278 90E0 ldi r25,hi8(__c.9) |
728 027a 9F93 push r25 |
729 027c 8F93 push r24 |
730 027e FF92 push r15 |
731 0280 EF92 push r14 |
732 0282 FE01 movw r30,r28 |
733 0284 0995 icall |
734 0286 84E1 ldi r24,lo8(20) |
735 0288 8093 0000 sts DispPtr,r24 |
736 028c 2DB7 in r18,__SP_L__ |
737 028e 3EB7 in r19,__SP_H__ |
738 0290 2A5F subi r18,lo8(-(6)) |
739 0292 3F4F sbci r19,hi8(-(6)) |
740 0294 2DBF out __SP_L__,r18 |
741 0296 8091 0000 lds r24,SollHoehe |
742 029a 9091 0000 lds r25,(SollHoehe)+1 |
743 029e A091 0000 lds r26,(SollHoehe)+2 |
744 02a2 B091 0000 lds r27,(SollHoehe)+3 |
745 02a6 BC01 movw r22,r24 |
746 02a8 CD01 movw r24,r26 |
747 02aa 25E0 ldi r18,lo8(5) |
748 02ac 30E0 ldi r19,hi8(5) |
749 02ae 40E0 ldi r20,hlo8(5) |
750 02b0 50E0 ldi r21,hhi8(5) |
751 02b2 0E94 0000 call __divmodsi4 |
752 02b6 3F93 push r19 |
753 02b8 2F93 push r18 |
754 02ba 80E0 ldi r24,lo8(__c.10) |
755 02bc 90E0 ldi r25,hi8(__c.10) |
756 02be 9F93 push r25 |
757 02c0 8F93 push r24 |
758 02c2 FF92 push r15 |
759 02c4 EF92 push r14 |
760 02c6 E091 0000 lds r30,_printf_P |
761 02ca F091 0000 lds r31,(_printf_P)+1 |
762 02ce 0995 icall |
763 02d0 88E2 ldi r24,lo8(40) |
764 02d2 8093 0000 sts DispPtr,r24 |
765 02d6 8DB7 in r24,__SP_L__ |
766 02d8 9EB7 in r25,__SP_H__ |
767 02da 0696 adiw r24,6 |
768 02dc 8DBF out __SP_L__,r24 |
769 02de 8091 0000 lds r24,MessLuftdruck |
770 02e2 9091 0000 lds r25,(MessLuftdruck)+1 |
771 02e6 9F93 push r25 |
772 02e8 8F93 push r24 |
773 02ea 80E0 ldi r24,lo8(__c.11) |
774 02ec 90E0 ldi r25,hi8(__c.11) |
775 02ee 9F93 push r25 |
776 02f0 8F93 push r24 |
777 02f2 FF92 push r15 |
778 02f4 EF92 push r14 |
779 02f6 E091 0000 lds r30,_printf_P |
780 02fa F091 0000 lds r31,(_printf_P)+1 |
781 02fe 0995 icall |
782 0300 8CE3 ldi r24,lo8(60) |
783 0302 8093 0000 sts DispPtr,r24 |
784 0306 2DB7 in r18,__SP_L__ |
785 0308 3EB7 in r19,__SP_H__ |
786 030a 2A5F subi r18,lo8(-(6)) |
787 030c 3F4F sbci r19,hi8(-(6)) |
788 030e 2DBF out __SP_L__,r18 |
789 0310 87B5 in r24,71-0x20 |
790 0312 9927 clr r25 |
791 0314 9F93 push r25 |
792 0316 8F93 push r24 |
793 0318 80E0 ldi r24,lo8(__c.12) |
794 031a 90E0 ldi r25,hi8(__c.12) |
795 .L92: |
796 031c 9F93 push r25 |
797 031e 8F93 push r24 |
798 0320 FF92 push r15 |
799 0322 EF92 push r14 |
800 .L86: |
801 0324 E091 0000 lds r30,_printf_P |
802 0328 F091 0000 lds r31,(_printf_P)+1 |
803 032c 0995 icall |
804 032e 8DB7 in r24,__SP_L__ |
805 0330 9EB7 in r25,__SP_H__ |
806 0332 0696 adiw r24,6 |
807 0334 2FC7 rjmp .L84 |
808 .L29: |
809 0336 1092 0000 sts DispPtr,__zero_reg__ |
810 033a 80E0 ldi r24,lo8(__c.13) |
811 033c 90E0 ldi r25,hi8(__c.13) |
812 033e 9F93 push r25 |
813 0340 8F93 push r24 |
814 0342 FF92 push r15 |
815 0344 EF92 push r14 |
816 0346 FE01 movw r30,r28 |
817 0348 0995 icall |
818 034a 84E1 ldi r24,lo8(20) |
819 034c 8093 0000 sts DispPtr,r24 |
820 0350 0F90 pop __tmp_reg__ |
821 0352 0F90 pop __tmp_reg__ |
822 0354 0F90 pop __tmp_reg__ |
823 0356 0F90 pop __tmp_reg__ |
824 0358 80E0 ldi r24,lo8(__c.14) |
825 035a 90E0 ldi r25,hi8(__c.14) |
826 035c 9F93 push r25 |
827 035e 8F93 push r24 |
828 0360 FF92 push r15 |
829 0362 EF92 push r14 |
830 0364 E091 0000 lds r30,_printf_P |
831 0368 F091 0000 lds r31,(_printf_P)+1 |
832 036c 0995 icall |
833 036e 88E2 ldi r24,lo8(40) |
834 0370 8093 0000 sts DispPtr,r24 |
835 0374 0F90 pop __tmp_reg__ |
836 0376 0F90 pop __tmp_reg__ |
837 0378 0F90 pop __tmp_reg__ |
838 037a 0F90 pop __tmp_reg__ |
839 037c 80E0 ldi r24,lo8(__c.15) |
840 037e 90E0 ldi r25,hi8(__c.15) |
841 0380 9F93 push r25 |
842 0382 8F93 push r24 |
843 0384 FF92 push r15 |
844 0386 EF92 push r14 |
845 0388 E091 0000 lds r30,_printf_P |
846 038c F091 0000 lds r31,(_printf_P)+1 |
847 0390 0995 icall |
848 0392 8CE3 ldi r24,lo8(60) |
849 0394 8093 0000 sts DispPtr,r24 |
850 0398 0F90 pop __tmp_reg__ |
851 039a 0F90 pop __tmp_reg__ |
852 039c 0F90 pop __tmp_reg__ |
853 039e 0F90 pop __tmp_reg__ |
854 03a0 80E0 ldi r24,lo8(__c.16) |
855 03a2 90E0 ldi r25,hi8(__c.16) |
856 03a4 9F93 push r25 |
857 03a6 8F93 push r24 |
858 03a8 FF92 push r15 |
859 03aa EF92 push r14 |
860 03ac 0C94 0000 jmp .L85 |
861 .L31: |
862 03b0 1092 0000 sts DispPtr,__zero_reg__ |
863 03b4 80E0 ldi r24,lo8(__c.17) |
864 03b6 90E0 ldi r25,hi8(__c.17) |
865 03b8 9F93 push r25 |
866 03ba 8F93 push r24 |
867 03bc 00E0 ldi r16,lo8(pm(Menu_Putchar)) |
868 03be 10E0 ldi r17,hi8(pm(Menu_Putchar)) |
869 03c0 FF92 push r15 |
870 03c2 EF92 push r14 |
871 03c4 FE01 movw r30,r28 |
872 03c6 0995 icall |
873 03c8 84E1 ldi r24,lo8(20) |
874 03ca 8093 0000 sts DispPtr,r24 |
875 03ce 0F90 pop __tmp_reg__ |
876 03d0 0F90 pop __tmp_reg__ |
877 03d2 0F90 pop __tmp_reg__ |
878 03d4 0F90 pop __tmp_reg__ |
879 03d6 8091 0000 lds r24,IntegralNick |
880 03da 9091 0000 lds r25,(IntegralNick)+1 |
881 03de A091 0000 lds r26,(IntegralNick)+2 |
882 03e2 B091 0000 lds r27,(IntegralNick)+3 |
883 03e6 B7FF sbrs r27,7 |
884 03e8 04C0 rjmp .L32 |
885 03ea 8150 subi r24,lo8(-(1023)) |
886 03ec 9C4F sbci r25,hi8(-(1023)) |
887 03ee AF4F sbci r26,hlo8(-(1023)) |
888 03f0 BF4F sbci r27,hhi8(-(1023)) |
889 .L32: |
890 03f2 FAE0 ldi r31,10 |
891 03f4 B595 1: asr r27 |
892 03f6 A795 ror r26 |
893 03f8 9795 ror r25 |
894 03fa 8795 ror r24 |
895 03fc FA95 dec r31 |
896 03fe D1F7 brne 1b |
897 0400 BF93 push r27 |
898 0402 AF93 push r26 |
899 0404 9F93 push r25 |
900 0406 8F93 push r24 |
901 0408 80E0 ldi r24,lo8(__c.18) |
902 040a 90E0 ldi r25,hi8(__c.18) |
903 040c 9F93 push r25 |
904 040e 8F93 push r24 |
905 0410 1F93 push r17 |
906 0412 0F93 push r16 |
907 0414 E091 0000 lds r30,_printf_P |
908 0418 F091 0000 lds r31,(_printf_P)+1 |
909 041c 0995 icall |
910 041e 88E2 ldi r24,lo8(40) |
911 0420 8093 0000 sts DispPtr,r24 |
912 0424 2DB7 in r18,__SP_L__ |
913 0426 3EB7 in r19,__SP_H__ |
914 0428 285F subi r18,lo8(-(8)) |
915 042a 3F4F sbci r19,hi8(-(8)) |
916 042c 2DBF out __SP_L__,r18 |
917 042e 8091 0000 lds r24,IntegralRoll |
918 0432 9091 0000 lds r25,(IntegralRoll)+1 |
919 0436 A091 0000 lds r26,(IntegralRoll)+2 |
920 043a B091 0000 lds r27,(IntegralRoll)+3 |
921 043e B7FF sbrs r27,7 |
922 0440 04C0 rjmp .L33 |
923 0442 8150 subi r24,lo8(-(1023)) |
924 0444 9C4F sbci r25,hi8(-(1023)) |
925 0446 AF4F sbci r26,hlo8(-(1023)) |
926 0448 BF4F sbci r27,hhi8(-(1023)) |
927 .L33: |
928 044a EAE0 ldi r30,10 |
929 044c B595 1: asr r27 |
930 044e A795 ror r26 |
931 0450 9795 ror r25 |
932 0452 8795 ror r24 |
933 0454 EA95 dec r30 |
934 0456 D1F7 brne 1b |
935 0458 BF93 push r27 |
936 045a AF93 push r26 |
937 045c 9F93 push r25 |
938 045e 8F93 push r24 |
939 0460 80E0 ldi r24,lo8(__c.19) |
940 0462 90E0 ldi r25,hi8(__c.19) |
941 0464 9F93 push r25 |
942 0466 8F93 push r24 |
943 0468 1F93 push r17 |
944 046a 0F93 push r16 |
945 046c E091 0000 lds r30,_printf_P |
946 0470 F091 0000 lds r31,(_printf_P)+1 |
947 0474 0995 icall |
948 0476 8CE3 ldi r24,lo8(60) |
949 0478 8093 0000 sts DispPtr,r24 |
950 047c 8DB7 in r24,__SP_L__ |
951 047e 9EB7 in r25,__SP_H__ |
952 0480 0896 adiw r24,8 |
953 0482 8DBF out __SP_L__,r24 |
954 0484 8091 0000 lds r24,KompassValue |
955 0488 9091 0000 lds r25,(KompassValue)+1 |
956 048c 9F93 push r25 |
957 048e 8F93 push r24 |
958 0490 80E0 ldi r24,lo8(__c.20) |
959 0492 90E0 ldi r25,hi8(__c.20) |
960 0494 9F93 push r25 |
961 0496 8F93 push r24 |
962 0498 1F93 push r17 |
963 049a 0F93 push r16 |
964 .L88: |
965 049c E091 0000 lds r30,_printf_P |
966 04a0 F091 0000 lds r31,(_printf_P)+1 |
967 04a4 0995 icall |
968 04a6 2DB7 in r18,__SP_L__ |
969 04a8 3EB7 in r19,__SP_H__ |
970 04aa 2A5F subi r18,lo8(-(6)) |
971 04ac 3F4F sbci r19,hi8(-(6)) |
972 04ae 0DC7 rjmp .L83 |
973 .L34: |
974 04b0 1092 0000 sts DispPtr,__zero_reg__ |
975 04b4 8091 0000 lds r24,PPM_in+4 |
976 04b8 9091 0000 lds r25,(PPM_in+4)+1 |
977 04bc 9F93 push r25 |
978 04be 8F93 push r24 |
979 04c0 8091 0000 lds r24,PPM_in+2 |
980 04c4 9091 0000 lds r25,(PPM_in+2)+1 |
981 04c8 9F93 push r25 |
982 04ca 8F93 push r24 |
983 04cc 80E0 ldi r24,lo8(__c.21) |
984 04ce 90E0 ldi r25,hi8(__c.21) |
985 04d0 9F93 push r25 |
986 04d2 8F93 push r24 |
987 04d4 FF92 push r15 |
988 04d6 EF92 push r14 |
989 04d8 FE01 movw r30,r28 |
990 04da 0995 icall |
991 04dc 84E1 ldi r24,lo8(20) |
992 04de 8093 0000 sts DispPtr,r24 |
993 04e2 8DB7 in r24,__SP_L__ |
994 04e4 9EB7 in r25,__SP_H__ |
995 04e6 0896 adiw r24,8 |
996 04e8 8DBF out __SP_L__,r24 |
997 04ea 8091 0000 lds r24,PPM_in+8 |
998 04ee 9091 0000 lds r25,(PPM_in+8)+1 |
999 04f2 9F93 push r25 |
1000 04f4 8F93 push r24 |
1001 04f6 8091 0000 lds r24,PPM_in+6 |
1002 04fa 9091 0000 lds r25,(PPM_in+6)+1 |
1003 04fe 9F93 push r25 |
1004 0500 8F93 push r24 |
1005 0502 80E0 ldi r24,lo8(__c.22) |
1006 0504 90E0 ldi r25,hi8(__c.22) |
1007 0506 9F93 push r25 |
1008 0508 8F93 push r24 |
1009 050a FF92 push r15 |
1010 050c EF92 push r14 |
1011 050e E091 0000 lds r30,_printf_P |
1012 0512 F091 0000 lds r31,(_printf_P)+1 |
1013 0516 0995 icall |
1014 0518 88E2 ldi r24,lo8(40) |
1015 051a 8093 0000 sts DispPtr,r24 |
1016 051e 2DB7 in r18,__SP_L__ |
1017 0520 3EB7 in r19,__SP_H__ |
1018 0522 285F subi r18,lo8(-(8)) |
1019 0524 3F4F sbci r19,hi8(-(8)) |
1020 0526 2DBF out __SP_L__,r18 |
1021 0528 8091 0000 lds r24,PPM_in+12 |
1022 052c 9091 0000 lds r25,(PPM_in+12)+1 |
1023 0530 9F93 push r25 |
1024 0532 8F93 push r24 |
1025 0534 8091 0000 lds r24,PPM_in+10 |
1026 0538 9091 0000 lds r25,(PPM_in+10)+1 |
1027 053c 9F93 push r25 |
1028 053e 8F93 push r24 |
1029 0540 80E0 ldi r24,lo8(__c.23) |
1030 0542 90E0 ldi r25,hi8(__c.23) |
1031 0544 9F93 push r25 |
1032 0546 8F93 push r24 |
1033 0548 FF92 push r15 |
1034 054a EF92 push r14 |
1035 054c E091 0000 lds r30,_printf_P |
1036 0550 F091 0000 lds r31,(_printf_P)+1 |
1037 0554 0995 icall |
1038 0556 8CE3 ldi r24,lo8(60) |
1039 0558 8093 0000 sts DispPtr,r24 |
1040 055c 8DB7 in r24,__SP_L__ |
1041 055e 9EB7 in r25,__SP_H__ |
1042 0560 0896 adiw r24,8 |
1043 0562 8DBF out __SP_L__,r24 |
1044 0564 8091 0000 lds r24,PPM_in+16 |
1045 0568 9091 0000 lds r25,(PPM_in+16)+1 |
1046 056c 9F93 push r25 |
1047 056e 8F93 push r24 |
1048 0570 8091 0000 lds r24,PPM_in+14 |
1049 0574 9091 0000 lds r25,(PPM_in+14)+1 |
1050 0578 9F93 push r25 |
1051 057a 8F93 push r24 |
1052 057c 80E0 ldi r24,lo8(__c.24) |
1053 057e 90E0 ldi r25,hi8(__c.24) |
1054 0580 A2C0 rjmp .L89 |
1055 .L35: |
1056 0582 1092 0000 sts DispPtr,__zero_reg__ |
1057 0586 8091 0000 lds r24,EE_Parameter+2 |
1058 058a E82F mov r30,r24 |
1059 058c FF27 clr r31 |
1060 058e EE0F add r30,r30 |
1061 0590 FF1F adc r31,r31 |
1062 0592 E050 subi r30,lo8(-(PPM_in)) |
1063 0594 F040 sbci r31,hi8(-(PPM_in)) |
1064 0596 8081 ld r24,Z |
1065 0598 9181 ldd r25,Z+1 |
1066 059a 9F93 push r25 |
1067 059c 8F93 push r24 |
1068 059e 8091 0000 lds r24,EE_Parameter+1 |
1069 05a2 E82F mov r30,r24 |
1070 05a4 FF27 clr r31 |
1071 05a6 EE0F add r30,r30 |
1072 05a8 FF1F adc r31,r31 |
1073 05aa E050 subi r30,lo8(-(PPM_in)) |
1074 05ac F040 sbci r31,hi8(-(PPM_in)) |
1075 05ae 8081 ld r24,Z |
1076 05b0 9181 ldd r25,Z+1 |
1077 05b2 9F93 push r25 |
1078 05b4 8F93 push r24 |
1079 05b6 80E0 ldi r24,lo8(__c.25) |
1080 05b8 90E0 ldi r25,hi8(__c.25) |
1081 05ba 9F93 push r25 |
1082 05bc 8F93 push r24 |
1083 05be FF92 push r15 |
1084 05c0 EF92 push r14 |
1085 05c2 FE01 movw r30,r28 |
1086 05c4 0995 icall |
1087 05c6 84E1 ldi r24,lo8(20) |
1088 05c8 8093 0000 sts DispPtr,r24 |
1089 05cc 8DB7 in r24,__SP_L__ |
1090 05ce 9EB7 in r25,__SP_H__ |
1091 05d0 0896 adiw r24,8 |
1092 05d2 8DBF out __SP_L__,r24 |
1093 05d4 8091 0000 lds r24,EE_Parameter+4 |
1094 05d8 E82F mov r30,r24 |
1095 05da FF27 clr r31 |
1096 05dc EE0F add r30,r30 |
1097 05de FF1F adc r31,r31 |
1098 05e0 E050 subi r30,lo8(-(PPM_in)) |
1099 05e2 F040 sbci r31,hi8(-(PPM_in)) |
1100 05e4 8081 ld r24,Z |
1101 05e6 9181 ldd r25,Z+1 |
1102 05e8 9F93 push r25 |
1103 05ea 8F93 push r24 |
1104 05ec 8091 0000 lds r24,EE_Parameter+3 |
1105 05f0 E82F mov r30,r24 |
1106 05f2 FF27 clr r31 |
1107 05f4 EE0F add r30,r30 |
1108 05f6 FF1F adc r31,r31 |
1109 05f8 E050 subi r30,lo8(-(PPM_in)) |
1110 05fa F040 sbci r31,hi8(-(PPM_in)) |
1111 05fc 8081 ld r24,Z |
1112 05fe 9181 ldd r25,Z+1 |
1113 0600 8858 subi r24,lo8(-(120)) |
1114 0602 9F4F sbci r25,hi8(-(120)) |
1115 0604 9F93 push r25 |
1116 0606 8F93 push r24 |
1117 0608 80E0 ldi r24,lo8(__c.26) |
1118 060a 90E0 ldi r25,hi8(__c.26) |
1119 060c 9F93 push r25 |
1120 060e 8F93 push r24 |
1121 0610 FF92 push r15 |
1122 0612 EF92 push r14 |
1123 0614 E091 0000 lds r30,_printf_P |
1124 0618 F091 0000 lds r31,(_printf_P)+1 |
1125 061c 0995 icall |
1126 061e 88E2 ldi r24,lo8(40) |
1127 0620 8093 0000 sts DispPtr,r24 |
1128 0624 2DB7 in r18,__SP_L__ |
1129 0626 3EB7 in r19,__SP_H__ |
1130 0628 285F subi r18,lo8(-(8)) |
1131 062a 3F4F sbci r19,hi8(-(8)) |
1132 062c 2DBF out __SP_L__,r18 |
1133 062e 8091 0000 lds r24,EE_Parameter+6 |
1134 0632 E82F mov r30,r24 |
1135 0634 FF27 clr r31 |
1136 0636 EE0F add r30,r30 |
1137 0638 FF1F adc r31,r31 |
1138 063a E050 subi r30,lo8(-(PPM_in)) |
1139 063c F040 sbci r31,hi8(-(PPM_in)) |
1140 063e 8081 ld r24,Z |
1141 0640 9181 ldd r25,Z+1 |
1142 0642 8259 subi r24,lo8(-(110)) |
1143 0644 9F4F sbci r25,hi8(-(110)) |
1144 0646 9F93 push r25 |
1145 0648 8F93 push r24 |
1146 064a 8091 0000 lds r24,EE_Parameter+5 |
1147 064e E82F mov r30,r24 |
1148 0650 FF27 clr r31 |
1149 0652 EE0F add r30,r30 |
1150 0654 FF1F adc r31,r31 |
1151 0656 E050 subi r30,lo8(-(PPM_in)) |
1152 0658 F040 sbci r31,hi8(-(PPM_in)) |
1153 065a 8081 ld r24,Z |
1154 065c 9181 ldd r25,Z+1 |
1155 065e 8259 subi r24,lo8(-(110)) |
1156 0660 9F4F sbci r25,hi8(-(110)) |
1157 0662 9F93 push r25 |
1158 0664 8F93 push r24 |
1159 0666 80E0 ldi r24,lo8(__c.27) |
1160 0668 90E0 ldi r25,hi8(__c.27) |
1161 066a 9F93 push r25 |
1162 066c 8F93 push r24 |
1163 066e FF92 push r15 |
1164 0670 EF92 push r14 |
1165 0672 E091 0000 lds r30,_printf_P |
1166 0676 F091 0000 lds r31,(_printf_P)+1 |
1167 067a 0995 icall |
1168 067c 8CE3 ldi r24,lo8(60) |
1169 067e 8093 0000 sts DispPtr,r24 |
1170 0682 8DB7 in r24,__SP_L__ |
1171 0684 9EB7 in r25,__SP_H__ |
1172 0686 0896 adiw r24,8 |
1173 0688 8DBF out __SP_L__,r24 |
1174 068a 8091 0000 lds r24,EE_Parameter+8 |
1175 068e E82F mov r30,r24 |
1176 0690 FF27 clr r31 |
1177 0692 EE0F add r30,r30 |
1178 0694 FF1F adc r31,r31 |
1179 0696 E050 subi r30,lo8(-(PPM_in)) |
1180 0698 F040 sbci r31,hi8(-(PPM_in)) |
1181 069a 8081 ld r24,Z |
1182 069c 9181 ldd r25,Z+1 |
1183 069e 8259 subi r24,lo8(-(110)) |
1184 06a0 9F4F sbci r25,hi8(-(110)) |
1185 06a2 9F93 push r25 |
1186 06a4 8F93 push r24 |
1187 06a6 8091 0000 lds r24,EE_Parameter+7 |
1188 06aa E82F mov r30,r24 |
1189 06ac FF27 clr r31 |
1190 06ae EE0F add r30,r30 |
1191 06b0 FF1F adc r31,r31 |
1192 06b2 E050 subi r30,lo8(-(PPM_in)) |
1193 06b4 F040 sbci r31,hi8(-(PPM_in)) |
1194 06b6 8081 ld r24,Z |
1195 06b8 9181 ldd r25,Z+1 |
1196 06ba 8259 subi r24,lo8(-(110)) |
1197 06bc 9F4F sbci r25,hi8(-(110)) |
1198 06be 9F93 push r25 |
1199 06c0 8F93 push r24 |
1200 06c2 80E0 ldi r24,lo8(__c.28) |
1201 06c4 90E0 ldi r25,hi8(__c.28) |
1202 .L89: |
1203 06c6 9F93 push r25 |
1204 06c8 8F93 push r24 |
1205 06ca FF92 push r15 |
1206 06cc EF92 push r14 |
1207 .L90: |
1208 06ce E091 0000 lds r30,_printf_P |
1209 06d2 F091 0000 lds r31,(_printf_P)+1 |
1210 06d6 0995 icall |
1211 06d8 2DB7 in r18,__SP_L__ |
1212 06da 3EB7 in r19,__SP_H__ |
1213 06dc 285F subi r18,lo8(-(8)) |
1214 06de 3F4F sbci r19,hi8(-(8)) |
1215 06e0 F4C5 rjmp .L83 |
1216 .L36: |
1217 06e2 1092 0000 sts DispPtr,__zero_reg__ |
1218 06e6 80E0 ldi r24,lo8(__c.29) |
1219 06e8 90E0 ldi r25,hi8(__c.29) |
1220 06ea 9F93 push r25 |
1221 06ec 8F93 push r24 |
1222 06ee 00E0 ldi r16,lo8(pm(Menu_Putchar)) |
1223 06f0 10E0 ldi r17,hi8(pm(Menu_Putchar)) |
1224 06f2 FF92 push r15 |
1225 06f4 EF92 push r14 |
1226 06f6 FE01 movw r30,r28 |
1227 06f8 0995 icall |
1228 06fa 8091 0000 lds r24,PlatinenVersion |
1229 06fe 0F90 pop __tmp_reg__ |
1230 0700 0F90 pop __tmp_reg__ |
1231 0702 0F90 pop __tmp_reg__ |
1232 0704 0F90 pop __tmp_reg__ |
1233 0706 8A30 cpi r24,lo8(10) |
1234 0708 09F0 breq .+2 |
1235 070a A1C0 rjmp .L37 |
1236 070c 84E1 ldi r24,lo8(20) |
1237 070e 8093 0000 sts DispPtr,r24 |
1238 0712 8091 0000 lds r24,AdNeutralNick |
1239 0716 9091 0000 lds r25,(AdNeutralNick)+1 |
1240 071a 9C01 movw r18,r24 |
1241 071c 97FF sbrs r25,7 |
1242 071e 02C0 rjmp .L38 |
1243 0720 295F subi r18,lo8(-(7)) |
1244 0722 3F4F sbci r19,hi8(-(7)) |
1245 .L38: |
1246 0724 287F andi r18,lo8(-8) |
1247 0726 821B sub r24,r18 |
1248 0728 930B sbc r25,r19 |
1249 072a 9F93 push r25 |
1250 072c 8F93 push r24 |
1251 072e 8091 0000 lds r24,AdNeutralNick |
1252 0732 9091 0000 lds r25,(AdNeutralNick)+1 |
1253 0736 97FD sbrc r25,7 |
1254 0738 0796 adiw r24,7 |
1255 .L39: |
1256 073a 73E0 ldi r23,3 |
1257 073c 9595 1: asr r25 |
1258 073e 8795 ror r24 |
1259 0740 7A95 dec r23 |
1260 0742 E1F7 brne 1b |
1261 0744 9F93 push r25 |
1262 0746 8F93 push r24 |
1263 0748 2091 0000 lds r18,AdNeutralNick |
1264 074c 3091 0000 lds r19,(AdNeutralNick)+1 |
1265 0750 37FF sbrs r19,7 |
1266 0752 02C0 rjmp .L40 |
1267 0754 295F subi r18,lo8(-(7)) |
1268 0756 3F4F sbci r19,hi8(-(7)) |
1269 .L40: |
1270 0758 63E0 ldi r22,3 |
1271 075a 3595 1: asr r19 |
1272 075c 2795 ror r18 |
1273 075e 6A95 dec r22 |
1274 0760 E1F7 brne 1b |
1275 0762 8091 0000 lds r24,AdWertNick |
1276 0766 9091 0000 lds r25,(AdWertNick)+1 |
1277 076a 821B sub r24,r18 |
1278 076c 930B sbc r25,r19 |
1279 076e 9F93 push r25 |
1280 0770 8F93 push r24 |
1281 0772 80E0 ldi r24,lo8(__c.30) |
1282 0774 90E0 ldi r25,hi8(__c.30) |
1283 0776 9F93 push r25 |
1284 0778 8F93 push r24 |
1285 077a 1F93 push r17 |
1286 077c 0F93 push r16 |
1287 077e E091 0000 lds r30,_printf_P |
1288 0782 F091 0000 lds r31,(_printf_P)+1 |
1289 0786 0995 icall |
1290 0788 88E2 ldi r24,lo8(40) |
1291 078a 8093 0000 sts DispPtr,r24 |
1292 078e 8DB7 in r24,__SP_L__ |
1293 0790 9EB7 in r25,__SP_H__ |
1294 0792 0A96 adiw r24,10 |
1295 0794 8DBF out __SP_L__,r24 |
1296 0796 8091 0000 lds r24,AdNeutralRoll |
1297 079a 9091 0000 lds r25,(AdNeutralRoll)+1 |
1298 079e 9C01 movw r18,r24 |
1299 07a0 97FF sbrs r25,7 |
1300 07a2 02C0 rjmp .L41 |
1301 07a4 295F subi r18,lo8(-(7)) |
1302 07a6 3F4F sbci r19,hi8(-(7)) |
1303 .L41: |
1304 07a8 287F andi r18,lo8(-8) |
1305 07aa 821B sub r24,r18 |
1306 07ac 930B sbc r25,r19 |
1307 07ae 9F93 push r25 |
1308 07b0 8F93 push r24 |
1309 07b2 8091 0000 lds r24,AdNeutralRoll |
1310 07b6 9091 0000 lds r25,(AdNeutralRoll)+1 |
1311 07ba 97FD sbrc r25,7 |
1312 07bc 0796 adiw r24,7 |
1313 .L42: |
1314 07be 53E0 ldi r21,3 |
1315 07c0 9595 1: asr r25 |
1316 07c2 8795 ror r24 |
1317 07c4 5A95 dec r21 |
1318 07c6 E1F7 brne 1b |
1319 07c8 9F93 push r25 |
1320 07ca 8F93 push r24 |
1321 07cc 2091 0000 lds r18,AdNeutralRoll |
1322 07d0 3091 0000 lds r19,(AdNeutralRoll)+1 |
1323 07d4 37FF sbrs r19,7 |
1324 07d6 02C0 rjmp .L43 |
1325 07d8 295F subi r18,lo8(-(7)) |
1326 07da 3F4F sbci r19,hi8(-(7)) |
1327 .L43: |
1328 07dc 43E0 ldi r20,3 |
1329 07de 3595 1: asr r19 |
1330 07e0 2795 ror r18 |
1331 07e2 4A95 dec r20 |
1332 07e4 E1F7 brne 1b |
1333 07e6 8091 0000 lds r24,AdWertRoll |
1334 07ea 9091 0000 lds r25,(AdWertRoll)+1 |
1335 07ee 821B sub r24,r18 |
1336 07f0 930B sbc r25,r19 |
1337 07f2 9F93 push r25 |
1338 07f4 8F93 push r24 |
1339 07f6 80E0 ldi r24,lo8(__c.31) |
1340 07f8 90E0 ldi r25,hi8(__c.31) |
1341 07fa 9F93 push r25 |
1342 07fc 8F93 push r24 |
1343 07fe 1F93 push r17 |
1344 0800 0F93 push r16 |
1345 0802 E091 0000 lds r30,_printf_P |
1346 0806 F091 0000 lds r31,(_printf_P)+1 |
1347 080a 0995 icall |
1348 080c 8CE3 ldi r24,lo8(60) |
1349 080e 8093 0000 sts DispPtr,r24 |
1350 0812 2DB7 in r18,__SP_L__ |
1351 0814 3EB7 in r19,__SP_H__ |
1352 0816 265F subi r18,lo8(-(10)) |
1353 0818 3F4F sbci r19,hi8(-(10)) |
1354 081a 2DBF out __SP_L__,r18 |
1355 081c 8091 0000 lds r24,AdNeutralGier |
1356 0820 9091 0000 lds r25,(AdNeutralGier)+1 |
1357 0824 9F93 push r25 |
1358 0826 8F93 push r24 |
1359 0828 8091 0000 lds r24,AdNeutralGier |
1360 082c 9091 0000 lds r25,(AdNeutralGier)+1 |
1361 0830 2091 0000 lds r18,AdWertGier |
1362 0834 3091 0000 lds r19,(AdWertGier)+1 |
1363 0838 821B sub r24,r18 |
1364 083a 930B sbc r25,r19 |
1365 083c 9F93 push r25 |
1366 083e 8F93 push r24 |
1367 0840 80E0 ldi r24,lo8(__c.32) |
1368 0842 90E0 ldi r25,hi8(__c.32) |
1369 0844 9F93 push r25 |
1370 0846 8F93 push r24 |
1371 0848 1F93 push r17 |
1372 084a 0F93 push r16 |
1373 084c A3C3 rjmp .L87 |
1374 .L37: |
1375 084e 8B30 cpi r24,lo8(11) |
1376 0850 19F0 breq .L46 |
1377 0852 8431 cpi r24,lo8(20) |
1378 0854 08F4 brsh .+2 |
1379 0856 ADC0 rjmp .L45 |
1380 .L46: |
1381 0858 84E1 ldi r24,lo8(20) |
1382 085a 8093 0000 sts DispPtr,r24 |
1383 085e 8091 0000 lds r24,AdNeutralNick |
1384 0862 9091 0000 lds r25,(AdNeutralNick)+1 |
1385 0866 9C01 movw r18,r24 |
1386 0868 97FF sbrs r25,7 |
1387 086a 02C0 rjmp .L47 |
1388 086c 215F subi r18,lo8(-(15)) |
1389 086e 3F4F sbci r19,hi8(-(15)) |
1390 .L47: |
1391 0870 207F andi r18,lo8(-16) |
1392 0872 821B sub r24,r18 |
1393 0874 930B sbc r25,r19 |
1394 0876 97FD sbrc r25,7 |
1395 0878 0196 adiw r24,1 |
1396 .L48: |
1397 087a 9595 asr r25 |
1398 087c 8795 ror r24 |
1399 087e 9F93 push r25 |
1400 0880 8F93 push r24 |
1401 0882 8091 0000 lds r24,AdNeutralNick |
1402 0886 9091 0000 lds r25,(AdNeutralNick)+1 |
1403 088a 97FD sbrc r25,7 |
1404 088c 0F96 adiw r24,15 |
1405 .L49: |
1406 088e 24E0 ldi r18,4 |
1407 0890 9595 1: asr r25 |
1408 0892 8795 ror r24 |
1409 0894 2A95 dec r18 |
1410 0896 E1F7 brne 1b |
1411 0898 9F93 push r25 |
1412 089a 8F93 push r24 |
1413 089c 2091 0000 lds r18,AdNeutralNick |
1414 08a0 3091 0000 lds r19,(AdNeutralNick)+1 |
1415 08a4 37FF sbrs r19,7 |
1416 08a6 02C0 rjmp .L50 |
1417 08a8 295F subi r18,lo8(-(7)) |
1418 08aa 3F4F sbci r19,hi8(-(7)) |
1419 .L50: |
1420 08ac 83E0 ldi r24,3 |
1421 08ae 3595 1: asr r19 |
1422 08b0 2795 ror r18 |
1423 08b2 8A95 dec r24 |
1424 08b4 E1F7 brne 1b |
1425 08b6 8091 0000 lds r24,AdWertNick |
1426 08ba 9091 0000 lds r25,(AdWertNick)+1 |
1427 08be 821B sub r24,r18 |
1428 08c0 930B sbc r25,r19 |
1429 08c2 9F93 push r25 |
1430 08c4 8F93 push r24 |
1431 08c6 80E0 ldi r24,lo8(__c.33) |
1432 08c8 90E0 ldi r25,hi8(__c.33) |
1433 08ca 9F93 push r25 |
1434 08cc 8F93 push r24 |
1435 08ce 1F93 push r17 |
1436 08d0 0F93 push r16 |
1437 08d2 E091 0000 lds r30,_printf_P |
1438 08d6 F091 0000 lds r31,(_printf_P)+1 |
1439 08da 0995 icall |
1440 08dc 88E2 ldi r24,lo8(40) |
1441 08de 8093 0000 sts DispPtr,r24 |
1442 08e2 2DB7 in r18,__SP_L__ |
1443 08e4 3EB7 in r19,__SP_H__ |
1444 08e6 265F subi r18,lo8(-(10)) |
1445 08e8 3F4F sbci r19,hi8(-(10)) |
1446 08ea 2DBF out __SP_L__,r18 |
1447 08ec 8091 0000 lds r24,AdNeutralRoll |
1448 08f0 9091 0000 lds r25,(AdNeutralRoll)+1 |
1449 08f4 9C01 movw r18,r24 |
1450 08f6 97FF sbrs r25,7 |
1451 08f8 02C0 rjmp .L51 |
1452 08fa 215F subi r18,lo8(-(15)) |
1453 08fc 3F4F sbci r19,hi8(-(15)) |
1454 .L51: |
1455 08fe 207F andi r18,lo8(-16) |
1456 0900 821B sub r24,r18 |
1457 0902 930B sbc r25,r19 |
1458 0904 97FD sbrc r25,7 |
1459 0906 0196 adiw r24,1 |
1460 .L52: |
1461 0908 9595 asr r25 |
1462 090a 8795 ror r24 |
1463 090c 9F93 push r25 |
1464 090e 8F93 push r24 |
1465 0910 8091 0000 lds r24,AdNeutralRoll |
1466 0914 9091 0000 lds r25,(AdNeutralRoll)+1 |
1467 0918 97FD sbrc r25,7 |
1468 091a 0F96 adiw r24,15 |
1469 .L53: |
1470 091c B4E0 ldi r27,4 |
1471 091e 9595 1: asr r25 |
1472 0920 8795 ror r24 |
1473 0922 BA95 dec r27 |
1474 0924 E1F7 brne 1b |
1475 0926 9F93 push r25 |
1476 0928 8F93 push r24 |
1477 092a 2091 0000 lds r18,AdNeutralRoll |
1478 092e 3091 0000 lds r19,(AdNeutralRoll)+1 |
1479 0932 37FF sbrs r19,7 |
1480 0934 02C0 rjmp .L54 |
1481 0936 295F subi r18,lo8(-(7)) |
1482 0938 3F4F sbci r19,hi8(-(7)) |
1483 .L54: |
1484 093a A3E0 ldi r26,3 |
1485 093c 3595 1: asr r19 |
1486 093e 2795 ror r18 |
1487 0940 AA95 dec r26 |
1488 0942 E1F7 brne 1b |
1489 0944 8091 0000 lds r24,AdWertRoll |
1490 0948 9091 0000 lds r25,(AdWertRoll)+1 |
1491 094c 821B sub r24,r18 |
1492 094e 930B sbc r25,r19 |
1493 0950 9F93 push r25 |
1494 0952 8F93 push r24 |
1495 0954 80E0 ldi r24,lo8(__c.34) |
1496 0956 90E0 ldi r25,hi8(__c.34) |
1497 0958 9F93 push r25 |
1498 095a 8F93 push r24 |
1499 095c 1F93 push r17 |
1500 095e 0F93 push r16 |
1501 0960 E091 0000 lds r30,_printf_P |
1502 0964 F091 0000 lds r31,(_printf_P)+1 |
1503 0968 0995 icall |
1504 096a 8CE3 ldi r24,lo8(60) |
1505 096c 8093 0000 sts DispPtr,r24 |
1506 0970 8DB7 in r24,__SP_L__ |
1507 0972 9EB7 in r25,__SP_H__ |
1508 0974 0A96 adiw r24,10 |
1509 0976 8DBF out __SP_L__,r24 |
1510 0978 8091 0000 lds r24,AdNeutralGier |
1511 097c 9091 0000 lds r25,(AdNeutralGier)+1 |
1512 0980 97FD sbrc r25,7 |
1513 0982 0196 adiw r24,1 |
1514 .L55: |
1515 0984 9595 asr r25 |
1516 0986 8795 ror r24 |
1517 0988 9F93 push r25 |
1518 098a 8F93 push r24 |
1519 098c 8091 0000 lds r24,AdNeutralGier |
1520 0990 9091 0000 lds r25,(AdNeutralGier)+1 |
1521 0994 2091 0000 lds r18,AdWertGier |
1522 0998 3091 0000 lds r19,(AdWertGier)+1 |
1523 099c 821B sub r24,r18 |
1524 099e 930B sbc r25,r19 |
1525 09a0 9F93 push r25 |
1526 09a2 8F93 push r24 |
1527 09a4 80E0 ldi r24,lo8(__c.35) |
1528 09a6 90E0 ldi r25,hi8(__c.35) |
1529 09a8 9F93 push r25 |
1530 09aa 8F93 push r24 |
1531 09ac 1F93 push r17 |
1532 09ae 0F93 push r16 |
1533 09b0 8ECE rjmp .L90 |
1534 .L45: |
1535 09b2 8D30 cpi r24,lo8(13) |
1536 09b4 09F0 breq .+2 |
1537 09b6 EEC5 rjmp .L19 |
1538 09b8 84E1 ldi r24,lo8(20) |
1539 09ba 8093 0000 sts DispPtr,r24 |
1540 09be 8091 0000 lds r24,AnalogOffsetNick |
1541 09c2 9927 clr r25 |
1542 09c4 9F93 push r25 |
1543 09c6 8F93 push r24 |
1544 09c8 8091 0000 lds r24,AdNeutralNick |
1545 09cc 9091 0000 lds r25,(AdNeutralNick)+1 |
1546 09d0 97FD sbrc r25,7 |
1547 09d2 0F96 adiw r24,15 |
1548 .L58: |
1549 09d4 E4E0 ldi r30,4 |
1550 09d6 9595 1: asr r25 |
1551 09d8 8795 ror r24 |
1552 09da EA95 dec r30 |
1553 09dc E1F7 brne 1b |
1554 09de 9F93 push r25 |
1555 09e0 8F93 push r24 |
1556 09e2 2091 0000 lds r18,AdNeutralNick |
1557 09e6 3091 0000 lds r19,(AdNeutralNick)+1 |
1558 09ea 37FF sbrs r19,7 |
1559 09ec 02C0 rjmp .L59 |
1560 09ee 295F subi r18,lo8(-(7)) |
1561 09f0 3F4F sbci r19,hi8(-(7)) |
1562 .L59: |
1563 09f2 73E0 ldi r23,3 |
1564 09f4 3595 1: asr r19 |
1565 09f6 2795 ror r18 |
1566 09f8 7A95 dec r23 |
1567 09fa E1F7 brne 1b |
1568 09fc 8091 0000 lds r24,AdWertNick |
1569 0a00 9091 0000 lds r25,(AdWertNick)+1 |
1570 0a04 821B sub r24,r18 |
1571 0a06 930B sbc r25,r19 |
1572 0a08 9F93 push r25 |
1573 0a0a 8F93 push r24 |
1574 0a0c 80E0 ldi r24,lo8(__c.36) |
1575 0a0e 90E0 ldi r25,hi8(__c.36) |
1576 0a10 9F93 push r25 |
1577 0a12 8F93 push r24 |
1578 0a14 1F93 push r17 |
1579 0a16 0F93 push r16 |
1580 0a18 E091 0000 lds r30,_printf_P |
1581 0a1c F091 0000 lds r31,(_printf_P)+1 |
1582 0a20 0995 icall |
1583 0a22 88E2 ldi r24,lo8(40) |
1584 0a24 8093 0000 sts DispPtr,r24 |
1585 0a28 8DB7 in r24,__SP_L__ |
1586 0a2a 9EB7 in r25,__SP_H__ |
1587 0a2c 0A96 adiw r24,10 |
1588 0a2e 8DBF out __SP_L__,r24 |
1589 0a30 8091 0000 lds r24,AnalogOffsetRoll |
1590 0a34 9927 clr r25 |
1591 0a36 9F93 push r25 |
1592 0a38 8F93 push r24 |
1593 0a3a 8091 0000 lds r24,AdNeutralRoll |
1594 0a3e 9091 0000 lds r25,(AdNeutralRoll)+1 |
1595 0a42 97FD sbrc r25,7 |
1596 0a44 0F96 adiw r24,15 |
1597 .L60: |
1598 0a46 64E0 ldi r22,4 |
1599 0a48 9595 1: asr r25 |
1600 0a4a 8795 ror r24 |
1601 0a4c 6A95 dec r22 |
1602 0a4e E1F7 brne 1b |
1603 0a50 9F93 push r25 |
1604 0a52 8F93 push r24 |
1605 0a54 2091 0000 lds r18,AdNeutralRoll |
1606 0a58 3091 0000 lds r19,(AdNeutralRoll)+1 |
1607 0a5c 37FF sbrs r19,7 |
1608 0a5e 02C0 rjmp .L61 |
1609 0a60 295F subi r18,lo8(-(7)) |
1610 0a62 3F4F sbci r19,hi8(-(7)) |
1611 .L61: |
1612 0a64 53E0 ldi r21,3 |
1613 0a66 3595 1: asr r19 |
1614 0a68 2795 ror r18 |
1615 0a6a 5A95 dec r21 |
1616 0a6c E1F7 brne 1b |
1617 0a6e 8091 0000 lds r24,AdWertRoll |
1618 0a72 9091 0000 lds r25,(AdWertRoll)+1 |
1619 0a76 821B sub r24,r18 |
1620 0a78 930B sbc r25,r19 |
1621 0a7a 9F93 push r25 |
1622 0a7c 8F93 push r24 |
1623 0a7e 80E0 ldi r24,lo8(__c.37) |
1624 0a80 90E0 ldi r25,hi8(__c.37) |
1625 0a82 9F93 push r25 |
1626 0a84 8F93 push r24 |
1627 0a86 1F93 push r17 |
1628 0a88 0F93 push r16 |
1629 0a8a E091 0000 lds r30,_printf_P |
1630 0a8e F091 0000 lds r31,(_printf_P)+1 |
1631 0a92 0995 icall |
1632 0a94 8CE3 ldi r24,lo8(60) |
1633 0a96 8093 0000 sts DispPtr,r24 |
1634 0a9a 2DB7 in r18,__SP_L__ |
1635 0a9c 3EB7 in r19,__SP_H__ |
1636 0a9e 265F subi r18,lo8(-(10)) |
1637 0aa0 3F4F sbci r19,hi8(-(10)) |
1638 0aa2 2DBF out __SP_L__,r18 |
1639 0aa4 8091 0000 lds r24,AnalogOffsetGier |
1640 0aa8 9927 clr r25 |
1641 0aaa 9F93 push r25 |
1642 0aac 8F93 push r24 |
1643 0aae 8091 0000 lds r24,AdNeutralGier |
1644 0ab2 9091 0000 lds r25,(AdNeutralGier)+1 |
1645 0ab6 97FD sbrc r25,7 |
1646 0ab8 0196 adiw r24,1 |
1647 .L62: |
1648 0aba 9595 asr r25 |
1649 0abc 8795 ror r24 |
1650 0abe 9F93 push r25 |
1651 0ac0 8F93 push r24 |
1652 0ac2 8091 0000 lds r24,AdNeutralGier |
1653 0ac6 9091 0000 lds r25,(AdNeutralGier)+1 |
1654 0aca 2091 0000 lds r18,AdWertGier |
1655 0ace 3091 0000 lds r19,(AdWertGier)+1 |
1656 0ad2 821B sub r24,r18 |
1657 0ad4 930B sbc r25,r19 |
1658 0ad6 9F93 push r25 |
1659 0ad8 8F93 push r24 |
1660 0ada 80E0 ldi r24,lo8(__c.38) |
1661 0adc 90E0 ldi r25,hi8(__c.38) |
1662 0ade 9F93 push r25 |
1663 0ae0 8F93 push r24 |
1664 0ae2 1F93 push r17 |
1665 0ae4 0F93 push r16 |
1666 0ae6 E091 0000 lds r30,_printf_P |
1667 0aea F091 0000 lds r31,(_printf_P)+1 |
1668 0aee 0995 icall |
1669 0af0 8DB7 in r24,__SP_L__ |
1670 0af2 9EB7 in r25,__SP_H__ |
1671 0af4 0A96 adiw r24,10 |
1672 0af6 4EC3 rjmp .L84 |
1673 .L63: |
1674 0af8 1092 0000 sts DispPtr,__zero_reg__ |
1675 0afc 80E0 ldi r24,lo8(__c.39) |
1676 0afe 90E0 ldi r25,hi8(__c.39) |
1677 0b00 9F93 push r25 |
1678 0b02 8F93 push r24 |
1679 0b04 FF92 push r15 |
1680 0b06 EF92 push r14 |
1681 0b08 FE01 movw r30,r28 |
1682 0b0a 0995 icall |
1683 0b0c 84E1 ldi r24,lo8(20) |
1684 0b0e 8093 0000 sts DispPtr,r24 |
1685 0b12 0F90 pop __tmp_reg__ |
1686 0b14 0F90 pop __tmp_reg__ |
1687 0b16 0F90 pop __tmp_reg__ |
1688 0b18 0F90 pop __tmp_reg__ |
1689 0b1a 8091 0000 lds r24,NeutralAccX |
1690 0b1e 9091 0000 lds r25,(NeutralAccX)+1 |
1691 0b22 9F93 push r25 |
1692 0b24 8F93 push r24 |
1693 0b26 8091 0000 lds r24,AdWertAccNick |
1694 0b2a 9091 0000 lds r25,(AdWertAccNick)+1 |
1695 0b2e 9F93 push r25 |
1696 0b30 8F93 push r24 |
1697 0b32 80E0 ldi r24,lo8(__c.40) |
1698 0b34 90E0 ldi r25,hi8(__c.40) |
1699 0b36 9F93 push r25 |
1700 0b38 8F93 push r24 |
1701 0b3a FF92 push r15 |
1702 0b3c EF92 push r14 |
1703 0b3e E091 0000 lds r30,_printf_P |
1704 0b42 F091 0000 lds r31,(_printf_P)+1 |
1705 0b46 0995 icall |
1706 0b48 88E2 ldi r24,lo8(40) |
1707 0b4a 8093 0000 sts DispPtr,r24 |
1708 0b4e 2DB7 in r18,__SP_L__ |
1709 0b50 3EB7 in r19,__SP_H__ |
1710 0b52 285F subi r18,lo8(-(8)) |
1711 0b54 3F4F sbci r19,hi8(-(8)) |
1712 0b56 2DBF out __SP_L__,r18 |
1713 0b58 8091 0000 lds r24,NeutralAccY |
1714 0b5c 9091 0000 lds r25,(NeutralAccY)+1 |
1715 0b60 9F93 push r25 |
1716 0b62 8F93 push r24 |
1717 0b64 8091 0000 lds r24,AdWertAccRoll |
1718 0b68 9091 0000 lds r25,(AdWertAccRoll)+1 |
1719 0b6c 9F93 push r25 |
1720 0b6e 8F93 push r24 |
1721 0b70 80E0 ldi r24,lo8(__c.41) |
1722 0b72 90E0 ldi r25,hi8(__c.41) |
1723 0b74 9F93 push r25 |
1724 0b76 8F93 push r24 |
1725 0b78 FF92 push r15 |
1726 0b7a EF92 push r14 |
1727 0b7c E091 0000 lds r30,_printf_P |
1728 0b80 F091 0000 lds r31,(_printf_P)+1 |
1729 0b84 0995 icall |
1730 0b86 8CE3 ldi r24,lo8(60) |
1731 0b88 8093 0000 sts DispPtr,r24 |
1732 0b8c 8DB7 in r24,__SP_L__ |
1733 0b8e 9EB7 in r25,__SP_H__ |
1734 0b90 0896 adiw r24,8 |
1735 0b92 8DBF out __SP_L__,r24 |
1736 0b94 8091 0000 lds r24,NeutralAccZ |
1737 0b98 9091 0000 lds r25,(NeutralAccZ)+1 |
1738 0b9c 9F93 push r25 |
1739 0b9e 8F93 push r24 |
1740 0ba0 8091 0000 lds r24,AdWertAccHoch |
1741 0ba4 9091 0000 lds r25,(AdWertAccHoch)+1 |
1742 0ba8 9F93 push r25 |
1743 0baa 8F93 push r24 |
1744 0bac 80E0 ldi r24,lo8(__c.42) |
1745 0bae 90E0 ldi r25,hi8(__c.42) |
1746 0bb0 8ACD rjmp .L89 |
1747 .L64: |
1748 0bb2 1092 0000 sts DispPtr,__zero_reg__ |
1749 0bb6 8091 0000 lds r24,UBat |
1750 0bba 9091 0000 lds r25,(UBat)+1 |
1751 0bbe 6AE0 ldi r22,lo8(10) |
1752 0bc0 70E0 ldi r23,hi8(10) |
1753 0bc2 0E94 0000 call __divmodhi4 |
1754 0bc6 9F93 push r25 |
1755 0bc8 8F93 push r24 |
1756 0bca 8091 0000 lds r24,UBat |
1757 0bce 9091 0000 lds r25,(UBat)+1 |
1758 0bd2 6AE0 ldi r22,lo8(10) |
1759 0bd4 70E0 ldi r23,hi8(10) |
1760 0bd6 0E94 0000 call __divmodhi4 |
1761 0bda 7F93 push r23 |
1762 0bdc 6F93 push r22 |
1763 0bde 80E0 ldi r24,lo8(__c.43) |
1764 0be0 90E0 ldi r25,hi8(__c.43) |
1765 0be2 9F93 push r25 |
1766 0be4 8F93 push r24 |
1767 0be6 FF92 push r15 |
1768 0be8 EF92 push r14 |
1769 0bea FE01 movw r30,r28 |
1770 0bec 0995 icall |
1771 0bee 84E1 ldi r24,lo8(20) |
1772 0bf0 8093 0000 sts DispPtr,r24 |
1773 0bf4 8DB7 in r24,__SP_L__ |
1774 0bf6 9EB7 in r25,__SP_H__ |
1775 0bf8 0896 adiw r24,8 |
1776 0bfa 8DBF out __SP_L__,r24 |
1777 0bfc 8091 0000 lds r24,Capacity |
1778 0c00 9091 0000 lds r25,(Capacity)+1 |
1779 0c04 6AE0 ldi r22,lo8(10) |
1780 0c06 70E0 ldi r23,hi8(10) |
1781 0c08 0E94 0000 call __udivmodhi4 |
1782 0c0c 9F93 push r25 |
1783 0c0e 8F93 push r24 |
1784 0c10 8091 0000 lds r24,Capacity |
1785 0c14 9091 0000 lds r25,(Capacity)+1 |
1786 0c18 6AE0 ldi r22,lo8(10) |
1787 0c1a 70E0 ldi r23,hi8(10) |
1788 0c1c 0E94 0000 call __udivmodhi4 |
1789 0c20 7F93 push r23 |
1790 0c22 6F93 push r22 |
1791 0c24 80E0 ldi r24,lo8(__c.44) |
1792 0c26 90E0 ldi r25,hi8(__c.44) |
1793 0c28 9F93 push r25 |
1794 0c2a 8F93 push r24 |
1795 0c2c FF92 push r15 |
1796 0c2e EF92 push r14 |
1797 0c30 E091 0000 lds r30,_printf_P |
1798 0c34 F091 0000 lds r31,(_printf_P)+1 |
1799 0c38 0995 icall |
1800 0c3a 88E2 ldi r24,lo8(40) |
1801 0c3c 8093 0000 sts DispPtr,r24 |
1802 0c40 2DB7 in r18,__SP_L__ |
1803 0c42 3EB7 in r19,__SP_H__ |
1804 0c44 285F subi r18,lo8(-(8)) |
1805 0c46 3F4F sbci r19,hi8(-(8)) |
1806 0c48 2DBF out __SP_L__,r18 |
1807 0c4a 8091 0000 lds r24,Capacity+2 |
1808 0c4e 9091 0000 lds r25,(Capacity+2)+1 |
1809 0c52 9F93 push r25 |
1810 0c54 8F93 push r24 |
1811 0c56 80E0 ldi r24,lo8(__c.45) |
1812 0c58 90E0 ldi r25,hi8(__c.45) |
1813 0c5a 9F93 push r25 |
1814 0c5c 8F93 push r24 |
1815 0c5e FF92 push r15 |
1816 0c60 EF92 push r14 |
1817 0c62 E091 0000 lds r30,_printf_P |
1818 0c66 F091 0000 lds r31,(_printf_P)+1 |
1819 0c6a 0995 icall |
1820 0c6c 8CE3 ldi r24,lo8(60) |
1821 0c6e 8093 0000 sts DispPtr,r24 |
1822 0c72 8DB7 in r24,__SP_L__ |
1823 0c74 9EB7 in r25,__SP_H__ |
1824 0c76 0696 adiw r24,6 |
1825 0c78 8DBF out __SP_L__,r24 |
1826 0c7a 8091 0000 lds r24,Capacity+4 |
1827 0c7e 9091 0000 lds r25,(Capacity+4)+1 |
1828 0c82 9F93 push r25 |
1829 0c84 8F93 push r24 |
1830 0c86 80E0 ldi r24,lo8(__c.46) |
1831 0c88 90E0 ldi r25,hi8(__c.46) |
1832 0c8a 2EC1 rjmp .L93 |
1833 .L65: |
1834 0c8c 1092 0000 sts DispPtr,__zero_reg__ |
1835 0c90 80E0 ldi r24,lo8(__c.47) |
1836 0c92 90E0 ldi r25,hi8(__c.47) |
1837 0c94 9F93 push r25 |
1838 0c96 8F93 push r24 |
1839 0c98 FF92 push r15 |
1840 0c9a EF92 push r14 |
1841 0c9c FE01 movw r30,r28 |
1842 0c9e 0995 icall |
1843 0ca0 84E1 ldi r24,lo8(20) |
1844 0ca2 8093 0000 sts DispPtr,r24 |
1845 0ca6 0F90 pop __tmp_reg__ |
1846 0ca8 0F90 pop __tmp_reg__ |
1847 0caa 0F90 pop __tmp_reg__ |
1848 0cac 0F90 pop __tmp_reg__ |
1849 0cae 8091 0000 lds r24,PPM_in |
1850 0cb2 9091 0000 lds r25,(PPM_in)+1 |
1851 0cb6 9F93 push r25 |
1852 0cb8 8F93 push r24 |
1853 0cba 80E0 ldi r24,lo8(__c.48) |
1854 0cbc 90E0 ldi r25,hi8(__c.48) |
1855 0cbe 9F93 push r25 |
1856 0cc0 8F93 push r24 |
1857 0cc2 FF92 push r15 |
1858 0cc4 EF92 push r14 |
1859 0cc6 E091 0000 lds r30,_printf_P |
1860 0cca F091 0000 lds r31,(_printf_P)+1 |
1861 0cce 0995 icall |
1862 0cd0 88E2 ldi r24,lo8(40) |
1863 0cd2 8093 0000 sts DispPtr,r24 |
1864 0cd6 8DB7 in r24,__SP_L__ |
1865 0cd8 9EB7 in r25,__SP_H__ |
1866 0cda 0696 adiw r24,6 |
1867 0cdc 8DBF out __SP_L__,r24 |
1868 0cde 8091 0000 lds r24,SenderOkay |
1869 0ce2 9927 clr r25 |
1870 0ce4 9F93 push r25 |
1871 0ce6 8F93 push r24 |
1872 0ce8 80E0 ldi r24,lo8(__c.49) |
1873 0cea 90E0 ldi r25,hi8(__c.49) |
1874 0cec 9F93 push r25 |
1875 0cee 8F93 push r24 |
1876 0cf0 FF92 push r15 |
1877 0cf2 EF92 push r14 |
1878 0cf4 E091 0000 lds r30,_printf_P |
1879 0cf8 F091 0000 lds r31,(_printf_P)+1 |
1880 0cfc 0995 icall |
1881 0cfe 8CE3 ldi r24,lo8(60) |
1882 0d00 8093 0000 sts DispPtr,r24 |
1883 0d04 2DB7 in r18,__SP_L__ |
1884 0d06 3EB7 in r19,__SP_H__ |
1885 0d08 2A5F subi r18,lo8(-(6)) |
1886 0d0a 3F4F sbci r19,hi8(-(6)) |
1887 0d0c 2DBF out __SP_L__,r18 |
1888 0d0e 8091 0000 lds r24,Channels |
1889 0d12 9927 clr r25 |
1890 0d14 0197 sbiw r24,1 |
1891 0d16 9F93 push r25 |
1892 0d18 8F93 push r24 |
1893 0d1a 80E0 ldi r24,lo8(__c.50) |
1894 0d1c 90E0 ldi r25,hi8(__c.50) |
1895 0d1e FECA rjmp .L92 |
1896 .L66: |
1897 0d20 1092 0000 sts DispPtr,__zero_reg__ |
1898 0d24 80E0 ldi r24,lo8(__c.51) |
1899 0d26 90E0 ldi r25,hi8(__c.51) |
1900 0d28 9F93 push r25 |
1901 0d2a 8F93 push r24 |
1902 0d2c FF92 push r15 |
1903 0d2e EF92 push r14 |
1904 0d30 FE01 movw r30,r28 |
1905 0d32 0995 icall |
1906 0d34 84E1 ldi r24,lo8(20) |
1907 0d36 8093 0000 sts DispPtr,r24 |
1908 0d3a 0F90 pop __tmp_reg__ |
1909 0d3c 0F90 pop __tmp_reg__ |
1910 0d3e 0F90 pop __tmp_reg__ |
1911 0d40 0F90 pop __tmp_reg__ |
1912 0d42 8091 0000 lds r24,KompassRichtung |
1913 0d46 9091 0000 lds r25,(KompassRichtung)+1 |
1914 0d4a 9F93 push r25 |
1915 0d4c 8F93 push r24 |
1916 0d4e 80E0 ldi r24,lo8(__c.52) |
1917 0d50 90E0 ldi r25,hi8(__c.52) |
1918 0d52 9F93 push r25 |
1919 0d54 8F93 push r24 |
1920 0d56 FF92 push r15 |
1921 0d58 EF92 push r14 |
1922 0d5a E091 0000 lds r30,_printf_P |
1923 0d5e F091 0000 lds r31,(_printf_P)+1 |
1924 0d62 0995 icall |
1925 0d64 88E2 ldi r24,lo8(40) |
1926 0d66 8093 0000 sts DispPtr,r24 |
1927 0d6a 2DB7 in r18,__SP_L__ |
1928 0d6c 3EB7 in r19,__SP_H__ |
1929 0d6e 2A5F subi r18,lo8(-(6)) |
1930 0d70 3F4F sbci r19,hi8(-(6)) |
1931 0d72 2DBF out __SP_L__,r18 |
1932 0d74 8091 0000 lds r24,KompassValue |
1933 0d78 9091 0000 lds r25,(KompassValue)+1 |
1934 0d7c 9F93 push r25 |
1935 0d7e 8F93 push r24 |
1936 0d80 80E0 ldi r24,lo8(__c.53) |
1937 0d82 90E0 ldi r25,hi8(__c.53) |
1938 0d84 9F93 push r25 |
1939 0d86 8F93 push r24 |
1940 0d88 FF92 push r15 |
1941 0d8a EF92 push r14 |
1942 0d8c E091 0000 lds r30,_printf_P |
1943 0d90 F091 0000 lds r31,(_printf_P)+1 |
1944 0d94 0995 icall |
1945 0d96 8CE3 ldi r24,lo8(60) |
1946 0d98 8093 0000 sts DispPtr,r24 |
1947 0d9c 8DB7 in r24,__SP_L__ |
1948 0d9e 9EB7 in r25,__SP_H__ |
1949 0da0 0696 adiw r24,6 |
1950 0da2 8DBF out __SP_L__,r24 |
1951 0da4 8091 0000 lds r24,KompassStartwert |
1952 0da8 9091 0000 lds r25,(KompassStartwert)+1 |
1953 0dac 9F93 push r25 |
1954 0dae 8F93 push r24 |
1955 0db0 80E0 ldi r24,lo8(__c.54) |
1956 0db2 90E0 ldi r25,hi8(__c.54) |
1957 0db4 99C0 rjmp .L93 |
1958 .L67: |
1959 0db6 1092 0000 sts DispPtr,__zero_reg__ |
1960 0dba 8091 0000 lds r24,Poti |
1961 0dbe 9927 clr r25 |
1962 0dc0 9F93 push r25 |
1963 0dc2 8F93 push r24 |
1964 0dc4 80E0 ldi r24,lo8(__c.55) |
1965 0dc6 90E0 ldi r25,hi8(__c.55) |
1966 0dc8 9F93 push r25 |
1967 0dca 8F93 push r24 |
1968 0dcc FF92 push r15 |
1969 0dce EF92 push r14 |
1970 0dd0 FE01 movw r30,r28 |
1971 0dd2 0995 icall |
1972 0dd4 84E1 ldi r24,lo8(20) |
1973 0dd6 8093 0000 sts DispPtr,r24 |
1974 0dda 8DB7 in r24,__SP_L__ |
1975 0ddc 9EB7 in r25,__SP_H__ |
1976 0dde 0696 adiw r24,6 |
1977 0de0 8DBF out __SP_L__,r24 |
1978 0de2 8091 0000 lds r24,Poti+1 |
1979 0de6 9927 clr r25 |
1980 0de8 9F93 push r25 |
1981 0dea 8F93 push r24 |
1982 0dec 80E0 ldi r24,lo8(__c.56) |
1983 0dee 90E0 ldi r25,hi8(__c.56) |
1984 0df0 9F93 push r25 |
1985 0df2 8F93 push r24 |
1986 0df4 FF92 push r15 |
1987 0df6 EF92 push r14 |
1988 0df8 E091 0000 lds r30,_printf_P |
1989 0dfc F091 0000 lds r31,(_printf_P)+1 |
1990 0e00 0995 icall |
1991 0e02 88E2 ldi r24,lo8(40) |
1992 0e04 8093 0000 sts DispPtr,r24 |
1993 0e08 2DB7 in r18,__SP_L__ |
1994 0e0a 3EB7 in r19,__SP_H__ |
1995 0e0c 2A5F subi r18,lo8(-(6)) |
1996 0e0e 3F4F sbci r19,hi8(-(6)) |
1997 0e10 2DBF out __SP_L__,r18 |
1998 0e12 8091 0000 lds r24,Poti+2 |
1999 0e16 9927 clr r25 |
2000 0e18 9F93 push r25 |
2001 0e1a 8F93 push r24 |
2002 0e1c 80E0 ldi r24,lo8(__c.57) |
2003 0e1e 90E0 ldi r25,hi8(__c.57) |
2004 0e20 9F93 push r25 |
2005 0e22 8F93 push r24 |
2006 0e24 FF92 push r15 |
2007 0e26 EF92 push r14 |
2008 0e28 E091 0000 lds r30,_printf_P |
2009 0e2c F091 0000 lds r31,(_printf_P)+1 |
2010 0e30 0995 icall |
2011 0e32 8CE3 ldi r24,lo8(60) |
2012 0e34 8093 0000 sts DispPtr,r24 |
2013 0e38 8DB7 in r24,__SP_L__ |
2014 0e3a 9EB7 in r25,__SP_H__ |
2015 0e3c 0696 adiw r24,6 |
2016 0e3e 8DBF out __SP_L__,r24 |
2017 0e40 8091 0000 lds r24,Poti+3 |
2018 0e44 9927 clr r25 |
2019 0e46 9F93 push r25 |
2020 0e48 8F93 push r24 |
2021 0e4a 80E0 ldi r24,lo8(__c.58) |
2022 0e4c 90E0 ldi r25,hi8(__c.58) |
2023 0e4e 4CC0 rjmp .L93 |
2024 .L68: |
2025 0e50 1092 0000 sts DispPtr,__zero_reg__ |
2026 0e54 8091 0000 lds r24,Poti+4 |
2027 0e58 9927 clr r25 |
2028 0e5a 9F93 push r25 |
2029 0e5c 8F93 push r24 |
2030 0e5e 80E0 ldi r24,lo8(__c.59) |
2031 0e60 90E0 ldi r25,hi8(__c.59) |
2032 0e62 9F93 push r25 |
2033 0e64 8F93 push r24 |
2034 0e66 FF92 push r15 |
2035 0e68 EF92 push r14 |
2036 0e6a FE01 movw r30,r28 |
2037 0e6c 0995 icall |
2038 0e6e 84E1 ldi r24,lo8(20) |
2039 0e70 8093 0000 sts DispPtr,r24 |
2040 0e74 8DB7 in r24,__SP_L__ |
2041 0e76 9EB7 in r25,__SP_H__ |
2042 0e78 0696 adiw r24,6 |
2043 0e7a 8DBF out __SP_L__,r24 |
2044 0e7c 8091 0000 lds r24,Poti+5 |
2045 0e80 9927 clr r25 |
2046 0e82 9F93 push r25 |
2047 0e84 8F93 push r24 |
2048 0e86 80E0 ldi r24,lo8(__c.60) |
2049 0e88 90E0 ldi r25,hi8(__c.60) |
2050 0e8a 9F93 push r25 |
2051 0e8c 8F93 push r24 |
2052 0e8e FF92 push r15 |
2053 0e90 EF92 push r14 |
2054 0e92 E091 0000 lds r30,_printf_P |
2055 0e96 F091 0000 lds r31,(_printf_P)+1 |
2056 0e9a 0995 icall |
2057 0e9c 88E2 ldi r24,lo8(40) |
2058 0e9e 8093 0000 sts DispPtr,r24 |
2059 0ea2 2DB7 in r18,__SP_L__ |
2060 0ea4 3EB7 in r19,__SP_H__ |
2061 0ea6 2A5F subi r18,lo8(-(6)) |
2062 0ea8 3F4F sbci r19,hi8(-(6)) |
2063 0eaa 2DBF out __SP_L__,r18 |
2064 0eac 8091 0000 lds r24,Poti+6 |
2065 0eb0 9927 clr r25 |
2066 0eb2 9F93 push r25 |
2067 0eb4 8F93 push r24 |
2068 0eb6 80E0 ldi r24,lo8(__c.61) |
2069 0eb8 90E0 ldi r25,hi8(__c.61) |
2070 0eba 9F93 push r25 |
2071 0ebc 8F93 push r24 |
2072 0ebe FF92 push r15 |
2073 0ec0 EF92 push r14 |
2074 0ec2 E091 0000 lds r30,_printf_P |
2075 0ec6 F091 0000 lds r31,(_printf_P)+1 |
2076 0eca 0995 icall |
2077 0ecc 8CE3 ldi r24,lo8(60) |
2078 0ece 8093 0000 sts DispPtr,r24 |
2079 0ed2 8DB7 in r24,__SP_L__ |
2080 0ed4 9EB7 in r25,__SP_H__ |
2081 0ed6 0696 adiw r24,6 |
2082 0ed8 8DBF out __SP_L__,r24 |
2083 0eda 8091 0000 lds r24,Poti+7 |
2084 0ede 9927 clr r25 |
2085 0ee0 9F93 push r25 |
2086 0ee2 8F93 push r24 |
2087 0ee4 80E0 ldi r24,lo8(__c.62) |
2088 0ee6 90E0 ldi r25,hi8(__c.62) |
2089 .L93: |
2090 0ee8 9F93 push r25 |
2091 0eea 8F93 push r24 |
2092 0eec FF92 push r15 |
2093 0eee EF92 push r14 |
2094 0ef0 D5CA rjmp .L88 |
2095 .L69: |
2096 0ef2 1092 0000 sts DispPtr,__zero_reg__ |
2097 0ef6 80E0 ldi r24,lo8(__c.63) |
2098 0ef8 90E0 ldi r25,hi8(__c.63) |
2099 0efa 9F93 push r25 |
2100 0efc 8F93 push r24 |
2101 0efe FF92 push r15 |
2102 0f00 EF92 push r14 |
2103 0f02 FE01 movw r30,r28 |
2104 0f04 0995 icall |
2105 0f06 84E1 ldi r24,lo8(20) |
2106 0f08 8093 0000 sts DispPtr,r24 |
2107 0f0c 0F90 pop __tmp_reg__ |
2108 0f0e 0F90 pop __tmp_reg__ |
2109 0f10 0F90 pop __tmp_reg__ |
2110 0f12 0F90 pop __tmp_reg__ |
2111 0f14 8091 0000 lds r24,Parameter_ServoNickControl |
2112 0f18 9927 clr r25 |
2113 0f1a 9F93 push r25 |
2114 0f1c 8F93 push r24 |
2115 0f1e 80E0 ldi r24,lo8(__c.64) |
2116 0f20 90E0 ldi r25,hi8(__c.64) |
2117 0f22 9F93 push r25 |
2118 0f24 8F93 push r24 |
2119 0f26 FF92 push r15 |
2120 0f28 EF92 push r14 |
2121 0f2a E091 0000 lds r30,_printf_P |
2122 0f2e F091 0000 lds r31,(_printf_P)+1 |
2123 0f32 0995 icall |
2124 0f34 88E2 ldi r24,lo8(40) |
2125 0f36 8093 0000 sts DispPtr,r24 |
2126 0f3a 8DB7 in r24,__SP_L__ |
2127 0f3c 9EB7 in r25,__SP_H__ |
2128 0f3e 0696 adiw r24,6 |
2129 0f40 8DBF out __SP_L__,r24 |
2130 0f42 8091 0000 lds r24,ServoNickValue |
2131 0f46 9091 0000 lds r25,(ServoNickValue)+1 |
2132 0f4a 9F93 push r25 |
2133 0f4c 8F93 push r24 |
2134 0f4e 80E0 ldi r24,lo8(__c.65) |
2135 0f50 90E0 ldi r25,hi8(__c.65) |
2136 0f52 9F93 push r25 |
2137 0f54 8F93 push r24 |
2138 0f56 FF92 push r15 |
2139 0f58 EF92 push r14 |
2140 0f5a E091 0000 lds r30,_printf_P |
2141 0f5e F091 0000 lds r31,(_printf_P)+1 |
2142 0f62 0995 icall |
2143 0f64 8CE3 ldi r24,lo8(60) |
2144 0f66 8093 0000 sts DispPtr,r24 |
2145 0f6a 2DB7 in r18,__SP_L__ |
2146 0f6c 3EB7 in r19,__SP_H__ |
2147 0f6e 2A5F subi r18,lo8(-(6)) |
2148 0f70 3F4F sbci r19,hi8(-(6)) |
2149 0f72 2DBF out __SP_L__,r18 |
2150 0f74 8091 0000 lds r24,EE_Parameter+48 |
2151 0f78 9927 clr r25 |
2152 0f7a 9F93 push r25 |
2153 0f7c 8F93 push r24 |
2154 0f7e 8091 0000 lds r24,EE_Parameter+47 |
2155 0f82 9927 clr r25 |
2156 0f84 9F93 push r25 |
2157 0f86 8F93 push r24 |
2158 0f88 80E0 ldi r24,lo8(__c.66) |
2159 0f8a 90E0 ldi r25,hi8(__c.66) |
2160 0f8c 9F93 push r25 |
2161 0f8e 8F93 push r24 |
2162 0f90 FF92 push r15 |
2163 0f92 EF92 push r14 |
2164 .L87: |
2165 0f94 E091 0000 lds r30,_printf_P |
2166 0f98 F091 0000 lds r31,(_printf_P)+1 |
2167 0f9c 0995 icall |
2168 0f9e 8DB7 in r24,__SP_L__ |
2169 0fa0 9EB7 in r25,__SP_H__ |
2170 0fa2 0896 adiw r24,8 |
2171 0fa4 F7C0 rjmp .L84 |
2172 .L70: |
2173 0fa6 1092 0000 sts DispPtr,__zero_reg__ |
2174 0faa 80E0 ldi r24,lo8(__c.67) |
2175 0fac 90E0 ldi r25,hi8(__c.67) |
2176 0fae 9F93 push r25 |
2177 0fb0 8F93 push r24 |
2178 0fb2 FF92 push r15 |
2179 0fb4 EF92 push r14 |
2180 0fb6 FE01 movw r30,r28 |
2181 0fb8 0995 icall |
2182 0fba 84E1 ldi r24,lo8(20) |
2183 0fbc 8093 0000 sts DispPtr,r24 |
2184 0fc0 0F90 pop __tmp_reg__ |
2185 0fc2 0F90 pop __tmp_reg__ |
2186 0fc4 0F90 pop __tmp_reg__ |
2187 0fc6 0F90 pop __tmp_reg__ |
2188 0fc8 8091 0000 lds r24,ExternControl+4 |
2189 0fcc 9927 clr r25 |
2190 0fce 87FD sbrc r24,7 |
2191 0fd0 9095 com r25 |
2192 0fd2 9F93 push r25 |
2193 0fd4 8F93 push r24 |
2194 0fd6 8091 0000 lds r24,ExternControl+3 |
2195 0fda 9927 clr r25 |
2196 0fdc 87FD sbrc r24,7 |
2197 0fde 9095 com r25 |
2198 0fe0 9F93 push r25 |
2199 0fe2 8F93 push r24 |
2200 0fe4 80E0 ldi r24,lo8(__c.68) |
2201 0fe6 90E0 ldi r25,hi8(__c.68) |
2202 0fe8 9F93 push r25 |
2203 0fea 8F93 push r24 |
2204 0fec FF92 push r15 |
2205 0fee EF92 push r14 |
2206 0ff0 E091 0000 lds r30,_printf_P |
2207 0ff4 F091 0000 lds r31,(_printf_P)+1 |
2208 0ff8 0995 icall |
2209 0ffa 88E2 ldi r24,lo8(40) |
2210 0ffc 8093 0000 sts DispPtr,r24 |
2211 1000 2DB7 in r18,__SP_L__ |
2212 1002 3EB7 in r19,__SP_H__ |
2213 1004 285F subi r18,lo8(-(8)) |
2214 1006 3F4F sbci r19,hi8(-(8)) |
2215 1008 2DBF out __SP_L__,r18 |
2216 100a 8091 0000 lds r24,ExternControl+5 |
2217 100e 9927 clr r25 |
2218 1010 87FD sbrc r24,7 |
2219 1012 9095 com r25 |
2220 1014 9F93 push r25 |
2221 1016 8F93 push r24 |
2222 1018 8091 0000 lds r24,ExternControl+6 |
2223 101c 9927 clr r25 |
2224 101e 9F93 push r25 |
2225 1020 8F93 push r24 |
2226 1022 80E0 ldi r24,lo8(__c.69) |
2227 1024 90E0 ldi r25,hi8(__c.69) |
2228 1026 9F93 push r25 |
2229 1028 8F93 push r24 |
2230 102a FF92 push r15 |
2231 102c EF92 push r14 |
2232 102e E091 0000 lds r30,_printf_P |
2233 1032 F091 0000 lds r31,(_printf_P)+1 |
2234 1036 0995 icall |
2235 1038 8CE3 ldi r24,lo8(60) |
2236 103a 8093 0000 sts DispPtr,r24 |
2237 103e 8DB7 in r24,__SP_L__ |
2238 1040 9EB7 in r25,__SP_H__ |
2239 1042 0896 adiw r24,8 |
2240 1044 8DBF out __SP_L__,r24 |
2241 1046 8091 0000 lds r24,ExternControl+10 |
2242 104a 9927 clr r25 |
2243 104c 9F93 push r25 |
2244 104e 8F93 push r24 |
2245 1050 8091 0000 lds r24,ExternControl+7 |
2246 1054 9927 clr r25 |
2247 1056 87FD sbrc r24,7 |
2248 1058 9095 com r25 |
2249 105a 9F93 push r25 |
2250 105c 8F93 push r24 |
2251 105e 80E0 ldi r24,lo8(__c.70) |
2252 1060 90E0 ldi r25,hi8(__c.70) |
2253 1062 31CB rjmp .L89 |
2254 .L71: |
2255 1064 1092 0000 sts DispPtr,__zero_reg__ |
2256 1068 80E0 ldi r24,lo8(__c.71) |
2257 106a 90E0 ldi r25,hi8(__c.71) |
2258 106c 9F93 push r25 |
2259 106e 8F93 push r24 |
2260 1070 FF92 push r15 |
2261 1072 EF92 push r14 |
2262 1074 FE01 movw r30,r28 |
2263 1076 0995 icall |
2264 1078 84E1 ldi r24,lo8(20) |
2265 107a 8093 0000 sts DispPtr,r24 |
2266 107e 0F90 pop __tmp_reg__ |
2267 1080 0F90 pop __tmp_reg__ |
2268 1082 0F90 pop __tmp_reg__ |
2269 1084 0F90 pop __tmp_reg__ |
2270 1086 8091 0000 lds r24,Motor+27 |
2271 108a 9927 clr r25 |
2272 108c 8F77 andi r24,lo8(127) |
2273 108e 9070 andi r25,hi8(127) |
2274 1090 9F93 push r25 |
2275 1092 8F93 push r24 |
2276 1094 8091 0000 lds r24,Motor+19 |
2277 1098 9927 clr r25 |
2278 109a 8F77 andi r24,lo8(127) |
2279 109c 9070 andi r25,hi8(127) |
2280 109e 9F93 push r25 |
2281 10a0 8F93 push r24 |
2282 10a2 8091 0000 lds r24,Motor+11 |
2283 10a6 9927 clr r25 |
2284 10a8 8F77 andi r24,lo8(127) |
2285 10aa 9070 andi r25,hi8(127) |
2286 10ac 9F93 push r25 |
2287 10ae 8F93 push r24 |
2288 10b0 8091 0000 lds r24,Motor+3 |
2289 10b4 9927 clr r25 |
2290 10b6 8F77 andi r24,lo8(127) |
2291 10b8 9070 andi r25,hi8(127) |
2292 10ba 9F93 push r25 |
2293 10bc 8F93 push r24 |
2294 10be 80E0 ldi r24,lo8(__c.72) |
2295 10c0 90E0 ldi r25,hi8(__c.72) |
2296 10c2 9F93 push r25 |
2297 10c4 8F93 push r24 |
2298 10c6 FF92 push r15 |
2299 10c8 EF92 push r14 |
2300 10ca E091 0000 lds r30,_printf_P |
2301 10ce F091 0000 lds r31,(_printf_P)+1 |
2302 10d2 0995 icall |
2303 10d4 88E2 ldi r24,lo8(40) |
2304 10d6 8093 0000 sts DispPtr,r24 |
2305 10da 8DB7 in r24,__SP_L__ |
2306 10dc 9EB7 in r25,__SP_H__ |
2307 10de 0C96 adiw r24,12 |
2308 10e0 8DBF out __SP_L__,r24 |
2309 10e2 8091 0000 lds r24,Motor+59 |
2310 10e6 9927 clr r25 |
2311 10e8 8F77 andi r24,lo8(127) |
2312 10ea 9070 andi r25,hi8(127) |
2313 10ec 9F93 push r25 |
2314 10ee 8F93 push r24 |
2315 10f0 8091 0000 lds r24,Motor+51 |
2316 10f4 9927 clr r25 |
2317 10f6 8F77 andi r24,lo8(127) |
2318 10f8 9070 andi r25,hi8(127) |
2319 10fa 9F93 push r25 |
2320 10fc 8F93 push r24 |
2321 10fe 8091 0000 lds r24,Motor+43 |
2322 1102 9927 clr r25 |
2323 1104 8F77 andi r24,lo8(127) |
2324 1106 9070 andi r25,hi8(127) |
2325 1108 9F93 push r25 |
2326 110a 8F93 push r24 |
2327 110c 8091 0000 lds r24,Motor+35 |
2328 1110 9927 clr r25 |
2329 1112 8F77 andi r24,lo8(127) |
2330 1114 9070 andi r25,hi8(127) |
2331 1116 9F93 push r25 |
2332 1118 8F93 push r24 |
2333 111a 80E0 ldi r24,lo8(__c.73) |
2334 111c 90E0 ldi r25,hi8(__c.73) |
2335 111e 9F93 push r25 |
2336 1120 8F93 push r24 |
2337 1122 FF92 push r15 |
2338 1124 EF92 push r14 |
2339 1126 E091 0000 lds r30,_printf_P |
2340 112a F091 0000 lds r31,(_printf_P)+1 |
2341 112e 0995 icall |
2342 1130 8CE3 ldi r24,lo8(60) |
2343 1132 8093 0000 sts DispPtr,r24 |
2344 1136 2DB7 in r18,__SP_L__ |
2345 1138 3EB7 in r19,__SP_H__ |
2346 113a 245F subi r18,lo8(-(12)) |
2347 113c 3F4F sbci r19,hi8(-(12)) |
2348 113e 2DBF out __SP_L__,r18 |
2349 1140 8091 0000 lds r24,Motor+91 |
2350 1144 9927 clr r25 |
2351 1146 8F77 andi r24,lo8(127) |
2352 1148 9070 andi r25,hi8(127) |
2353 114a 9F93 push r25 |
2354 114c 8F93 push r24 |
2355 114e 8091 0000 lds r24,Motor+83 |
2356 1152 9927 clr r25 |
2357 1154 8F77 andi r24,lo8(127) |
2358 1156 9070 andi r25,hi8(127) |
2359 1158 9F93 push r25 |
2360 115a 8F93 push r24 |
2361 115c 8091 0000 lds r24,Motor+75 |
2362 1160 9927 clr r25 |
2363 1162 8F77 andi r24,lo8(127) |
2364 1164 9070 andi r25,hi8(127) |
2365 1166 9F93 push r25 |
2366 1168 8F93 push r24 |
2367 116a 8091 0000 lds r24,Motor+67 |
2368 116e 9927 clr r25 |
2369 1170 8F77 andi r24,lo8(127) |
2370 1172 9070 andi r25,hi8(127) |
2371 1174 9F93 push r25 |
2372 1176 8F93 push r24 |
2373 1178 80E0 ldi r24,lo8(__c.74) |
2374 117a 90E0 ldi r25,hi8(__c.74) |
2375 117c 9F93 push r25 |
2376 117e 8F93 push r24 |
2377 1180 FF92 push r15 |
2378 1182 EF92 push r14 |
2379 1184 E091 0000 lds r30,_printf_P |
2380 1188 F091 0000 lds r31,(_printf_P)+1 |
2381 118c 0995 icall |
2382 118e 8DB7 in r24,__SP_L__ |
2383 1190 9EB7 in r25,__SP_H__ |
2384 1192 0C96 adiw r24,12 |
2385 .L84: |
2386 1194 8DBF out __SP_L__,r24 |
2387 1196 FEC1 rjmp .L19 |
2388 .L72: |
2389 1198 1092 0000 sts DispPtr,__zero_reg__ |
2390 119c 80E0 ldi r24,lo8(__c.75) |
2391 119e 90E0 ldi r25,hi8(__c.75) |
2392 11a0 9F93 push r25 |
2393 11a2 8F93 push r24 |
2394 11a4 FF92 push r15 |
2395 11a6 EF92 push r14 |
2396 11a8 FE01 movw r30,r28 |
2397 11aa 0995 icall |
2398 11ac 84E1 ldi r24,lo8(20) |
2399 11ae 8093 0000 sts DispPtr,r24 |
2400 11b2 0F90 pop __tmp_reg__ |
2401 11b4 0F90 pop __tmp_reg__ |
2402 11b6 0F90 pop __tmp_reg__ |
2403 11b8 0F90 pop __tmp_reg__ |
2404 11ba 8091 0000 lds r24,Motor+31 |
2405 11be 9927 clr r25 |
2406 11c0 87FD sbrc r24,7 |
2407 11c2 9095 com r25 |
2408 11c4 9F93 push r25 |
2409 11c6 8F93 push r24 |
2410 11c8 8091 0000 lds r24,Motor+23 |
2411 11cc 9927 clr r25 |
2412 11ce 87FD sbrc r24,7 |
2413 11d0 9095 com r25 |
2414 11d2 9F93 push r25 |
2415 11d4 8F93 push r24 |
2416 11d6 8091 0000 lds r24,Motor+15 |
2417 11da 9927 clr r25 |
2418 11dc 87FD sbrc r24,7 |
2419 11de 9095 com r25 |
2420 11e0 9F93 push r25 |
2421 11e2 8F93 push r24 |
2422 11e4 8091 0000 lds r24,Motor+7 |
2423 11e8 9927 clr r25 |
2424 11ea 87FD sbrc r24,7 |
2425 11ec 9095 com r25 |
2426 11ee 9F93 push r25 |
2427 11f0 8F93 push r24 |
2428 11f2 80E0 ldi r24,lo8(__c.76) |
2429 11f4 90E0 ldi r25,hi8(__c.76) |
2430 11f6 9F93 push r25 |
2431 11f8 8F93 push r24 |
2432 11fa FF92 push r15 |
2433 11fc EF92 push r14 |
2434 11fe E091 0000 lds r30,_printf_P |
2435 1202 F091 0000 lds r31,(_printf_P)+1 |
2436 1206 0995 icall |
2437 1208 88E2 ldi r24,lo8(40) |
2438 120a 8093 0000 sts DispPtr,r24 |
2439 120e 2DB7 in r18,__SP_L__ |
2440 1210 3EB7 in r19,__SP_H__ |
2441 1212 245F subi r18,lo8(-(12)) |
2442 1214 3F4F sbci r19,hi8(-(12)) |
2443 1216 2DBF out __SP_L__,r18 |
2444 1218 8091 0000 lds r24,Motor+63 |
2445 121c 9927 clr r25 |
2446 121e 87FD sbrc r24,7 |
2447 1220 9095 com r25 |
2448 1222 9F93 push r25 |
2449 1224 8F93 push r24 |
2450 1226 8091 0000 lds r24,Motor+55 |
2451 122a 9927 clr r25 |
2452 122c 87FD sbrc r24,7 |
2453 122e 9095 com r25 |
2454 1230 9F93 push r25 |
2455 1232 8F93 push r24 |
2456 1234 8091 0000 lds r24,Motor+47 |
2457 1238 9927 clr r25 |
2458 123a 87FD sbrc r24,7 |
2459 123c 9095 com r25 |
2460 123e 9F93 push r25 |
2461 1240 8F93 push r24 |
2462 1242 8091 0000 lds r24,Motor+39 |
2463 1246 9927 clr r25 |
2464 1248 87FD sbrc r24,7 |
2465 124a 9095 com r25 |
2466 124c 9F93 push r25 |
2467 124e 8F93 push r24 |
2468 1250 80E0 ldi r24,lo8(__c.77) |
2469 1252 90E0 ldi r25,hi8(__c.77) |
2470 1254 9F93 push r25 |
2471 1256 8F93 push r24 |
2472 1258 FF92 push r15 |
2473 125a EF92 push r14 |
2474 125c E091 0000 lds r30,_printf_P |
2475 1260 F091 0000 lds r31,(_printf_P)+1 |
2476 1264 0995 icall |
2477 1266 8CE3 ldi r24,lo8(60) |
2478 1268 8093 0000 sts DispPtr,r24 |
2479 126c 8DB7 in r24,__SP_L__ |
2480 126e 9EB7 in r25,__SP_H__ |
2481 1270 0C96 adiw r24,12 |
2482 1272 8DBF out __SP_L__,r24 |
2483 1274 8091 0000 lds r24,Motor+95 |
2484 1278 9927 clr r25 |
2485 127a 87FD sbrc r24,7 |
2486 127c 9095 com r25 |
2487 127e 9F93 push r25 |
2488 1280 8F93 push r24 |
2489 1282 8091 0000 lds r24,Motor+87 |
2490 1286 9927 clr r25 |
2491 1288 87FD sbrc r24,7 |
2492 128a 9095 com r25 |
2493 128c 9F93 push r25 |
2494 128e 8F93 push r24 |
2495 1290 8091 0000 lds r24,Motor+79 |
2496 1294 9927 clr r25 |
2497 1296 87FD sbrc r24,7 |
2498 1298 9095 com r25 |
2499 129a 9F93 push r25 |
2500 129c 8F93 push r24 |
2501 129e 8091 0000 lds r24,Motor+71 |
2502 12a2 9927 clr r25 |
2503 12a4 87FD sbrc r24,7 |
2504 12a6 9095 com r25 |
2505 12a8 9F93 push r25 |
2506 12aa 8F93 push r24 |
2507 12ac 80E0 ldi r24,lo8(__c.78) |
2508 12ae 90E0 ldi r25,hi8(__c.78) |
2509 12b0 9F93 push r25 |
2510 12b2 8F93 push r24 |
2511 12b4 FF92 push r15 |
2512 12b6 EF92 push r14 |
2513 12b8 E091 0000 lds r30,_printf_P |
2514 12bc F091 0000 lds r31,(_printf_P)+1 |
2515 12c0 0995 icall |
2516 12c2 2DB7 in r18,__SP_L__ |
2517 12c4 3EB7 in r19,__SP_H__ |
2518 12c6 245F subi r18,lo8(-(12)) |
2519 12c8 3F4F sbci r19,hi8(-(12)) |
2520 .L83: |
2521 12ca 2DBF out __SP_L__,r18 |
2522 12cc 63C1 rjmp .L19 |
2523 .L73: |
2524 12ce 1092 0000 sts DispPtr,__zero_reg__ |
2525 12d2 80E0 ldi r24,lo8(__c.79) |
2526 12d4 90E0 ldi r25,hi8(__c.79) |
2527 12d6 9F93 push r25 |
2528 12d8 8F93 push r24 |
2529 12da 00E0 ldi r16,lo8(pm(Menu_Putchar)) |
2530 12dc 10E0 ldi r17,hi8(pm(Menu_Putchar)) |
2531 12de FF92 push r15 |
2532 12e0 EF92 push r14 |
2533 12e2 FE01 movw r30,r28 |
2534 12e4 0995 icall |
2535 12e6 84E1 ldi r24,lo8(20) |
2536 12e8 8093 0000 sts DispPtr,r24 |
2537 12ec 0F90 pop __tmp_reg__ |
2538 12ee 0F90 pop __tmp_reg__ |
2539 12f0 0F90 pop __tmp_reg__ |
2540 12f2 0F90 pop __tmp_reg__ |
2541 12f4 8091 0000 lds r24,Motor+27 |
2542 12f8 881F rol r24 |
2543 12fa 8827 clr r24 |
2544 12fc 881F rol r24 |
2545 12fe 97E0 ldi r25,lo8(7) |
2546 1300 899F mul r24,r25 |
2547 1302 C001 movw r24,r0 |
2548 1304 1124 clr r1 |
2549 1306 8D96 adiw r24,45 |
2550 1308 9F93 push r25 |
2551 130a 8F93 push r24 |
2552 130c 8091 0000 lds r24,Motor+19 |
2553 1310 881F rol r24 |
2554 1312 8827 clr r24 |
2555 1314 881F rol r24 |
2556 1316 96E0 ldi r25,lo8(6) |
2557 1318 899F mul r24,r25 |
2558 131a C001 movw r24,r0 |
2559 131c 1124 clr r1 |
2560 131e 8D96 adiw r24,45 |
2561 1320 9F93 push r25 |
2562 1322 8F93 push r24 |
2563 1324 8091 0000 lds r24,Motor+11 |
2564 1328 881F rol r24 |
2565 132a 8827 clr r24 |
2566 132c 881F rol r24 |
2567 132e 95E0 ldi r25,lo8(5) |
2568 1330 899F mul r24,r25 |
2569 1332 C001 movw r24,r0 |
2570 1334 1124 clr r1 |
2571 1336 8D96 adiw r24,45 |
2572 1338 9F93 push r25 |
2573 133a 8F93 push r24 |
2574 133c 8091 0000 lds r24,Motor+3 |
2575 1340 881F rol r24 |
2576 1342 8827 clr r24 |
2577 1344 881F rol r24 |
2578 1346 9927 clr r25 |
2579 1348 880F lsl r24 |
2580 134a 991F rol r25 |
2581 134c 880F lsl r24 |
2582 134e 991F rol r25 |
2583 1350 8D96 adiw r24,45 |
2584 1352 9F93 push r25 |
2585 1354 8F93 push r24 |
2586 1356 80E0 ldi r24,lo8(__c.80) |
2587 1358 90E0 ldi r25,hi8(__c.80) |
2588 135a 9F93 push r25 |
2589 135c 8F93 push r24 |
2590 135e FF92 push r15 |
2591 1360 EF92 push r14 |
2592 1362 E091 0000 lds r30,_printf_P |
2593 1366 F091 0000 lds r31,(_printf_P)+1 |
2594 136a 0995 icall |
2595 136c 88E2 ldi r24,lo8(40) |
2596 136e 8093 0000 sts DispPtr,r24 |
2597 1372 8DB7 in r24,__SP_L__ |
2598 1374 9EB7 in r25,__SP_H__ |
2599 1376 0C96 adiw r24,12 |
2600 1378 8DBF out __SP_L__,r24 |
2601 137a 8091 0000 lds r24,Motor+59 |
2602 137e 881F rol r24 |
2603 1380 8827 clr r24 |
2604 1382 881F rol r24 |
2605 1384 9BE0 ldi r25,lo8(11) |
2606 1386 899F mul r24,r25 |
2607 1388 C001 movw r24,r0 |
2608 138a 1124 clr r1 |
2609 138c 8D96 adiw r24,45 |
2610 138e 9F93 push r25 |
2611 1390 8F93 push r24 |
2612 1392 8091 0000 lds r24,Motor+51 |
2613 1396 881F rol r24 |
2614 1398 8827 clr r24 |
2615 139a 881F rol r24 |
2616 139c 9AE0 ldi r25,lo8(10) |
2617 139e 899F mul r24,r25 |
2618 13a0 C001 movw r24,r0 |
2619 13a2 1124 clr r1 |
2620 13a4 8D96 adiw r24,45 |
2621 13a6 9F93 push r25 |
2622 13a8 8F93 push r24 |
2623 13aa 8091 0000 lds r24,Motor+43 |
2624 13ae 881F rol r24 |
2625 13b0 8827 clr r24 |
2626 13b2 881F rol r24 |
2627 13b4 99E0 ldi r25,lo8(9) |
2628 13b6 899F mul r24,r25 |
2629 13b8 C001 movw r24,r0 |
2630 13ba 1124 clr r1 |
2631 13bc 8D96 adiw r24,45 |
2632 13be 9F93 push r25 |
2633 13c0 8F93 push r24 |
2634 13c2 8091 0000 lds r24,Motor+35 |
2635 13c6 881F rol r24 |
2636 13c8 8827 clr r24 |
2637 13ca 881F rol r24 |
2638 13cc 9927 clr r25 |
2639 13ce 23E0 ldi r18,3 |
2640 13d0 880F 1: lsl r24 |
2641 13d2 991F rol r25 |
2642 13d4 2A95 dec r18 |
2643 13d6 E1F7 brne 1b |
2644 13d8 8D96 adiw r24,45 |
2645 13da 9F93 push r25 |
2646 13dc 8F93 push r24 |
2647 13de 80E0 ldi r24,lo8(__c.81) |
2648 13e0 90E0 ldi r25,hi8(__c.81) |
2649 13e2 9F93 push r25 |
2650 13e4 8F93 push r24 |
2651 13e6 FF92 push r15 |
2652 13e8 EF92 push r14 |
2653 13ea E091 0000 lds r30,_printf_P |
2654 13ee F091 0000 lds r31,(_printf_P)+1 |
2655 13f2 0995 icall |
2656 13f4 8CE3 ldi r24,lo8(60) |
2657 13f6 8093 0000 sts DispPtr,r24 |
2658 13fa 2DB7 in r18,__SP_L__ |
2659 13fc 3EB7 in r19,__SP_H__ |
2660 13fe 245F subi r18,lo8(-(12)) |
2661 1400 3F4F sbci r19,hi8(-(12)) |
2662 1402 2DBF out __SP_L__,r18 |
2663 1404 8091 0000 lds r24,Motor+67 |
2664 1408 881F rol r24 |
2665 140a 8827 clr r24 |
2666 140c 881F rol r24 |
2667 140e 9CE0 ldi r25,lo8(12) |
2668 1410 899F mul r24,r25 |
2669 1412 C001 movw r24,r0 |
2670 1414 1124 clr r1 |
2671 1416 8D96 adiw r24,45 |
2672 1418 9F93 push r25 |
2673 141a 8F93 push r24 |
2674 141c 80E0 ldi r24,lo8(__c.82) |
2675 141e 90E0 ldi r25,hi8(__c.82) |
2676 1420 9F93 push r25 |
2677 1422 8F93 push r24 |
2678 1424 FF92 push r15 |
2679 1426 EF92 push r14 |
2680 1428 E091 0000 lds r30,_printf_P |
2681 142c F091 0000 lds r31,(_printf_P)+1 |
2682 1430 0995 icall |
2683 1432 8091 0000 lds r24,Motor+75 |
2684 1436 2DB7 in r18,__SP_L__ |
2685 1438 3EB7 in r19,__SP_H__ |
2686 143a 2A5F subi r18,lo8(-(6)) |
2687 143c 3F4F sbci r19,hi8(-(6)) |
2688 143e 2DBF out __SP_L__,r18 |
2689 1440 87FF sbrs r24,7 |
2690 1442 12C0 rjmp .L74 |
2691 1444 80E4 ldi r24,lo8(64) |
2692 1446 8093 0000 sts DispPtr,r24 |
2693 144a 80E0 ldi r24,lo8(__c.83) |
2694 144c 90E0 ldi r25,hi8(__c.83) |
2695 144e 9F93 push r25 |
2696 1450 8F93 push r24 |
2697 1452 FF92 push r15 |
2698 1454 EF92 push r14 |
2699 1456 E091 0000 lds r30,_printf_P |
2700 145a F091 0000 lds r31,(_printf_P)+1 |
2701 145e 0995 icall |
2702 1460 0F90 pop __tmp_reg__ |
2703 1462 0F90 pop __tmp_reg__ |
2704 1464 0F90 pop __tmp_reg__ |
2705 1466 0F90 pop __tmp_reg__ |
2706 .L74: |
2707 1468 8091 0000 lds r24,Motor+83 |
2708 146c 87FF sbrs r24,7 |
2709 146e 12C0 rjmp .L75 |
2710 1470 84E4 ldi r24,lo8(68) |
2711 1472 8093 0000 sts DispPtr,r24 |
2712 1476 80E0 ldi r24,lo8(__c.84) |
2713 1478 90E0 ldi r25,hi8(__c.84) |
2714 147a 9F93 push r25 |
2715 147c 8F93 push r24 |
2716 147e 1F93 push r17 |
2717 1480 0F93 push r16 |
2718 1482 E091 0000 lds r30,_printf_P |
2719 1486 F091 0000 lds r31,(_printf_P)+1 |
2720 148a 0995 icall |
2721 148c 0F90 pop __tmp_reg__ |
2722 148e 0F90 pop __tmp_reg__ |
2723 1490 0F90 pop __tmp_reg__ |
2724 1492 0F90 pop __tmp_reg__ |
2725 .L75: |
2726 1494 8091 0000 lds r24,Motor+91 |
2727 1498 87FF sbrs r24,7 |
2728 149a 7CC0 rjmp .L19 |
2729 149c 88E4 ldi r24,lo8(72) |
2730 149e 8093 0000 sts DispPtr,r24 |
2731 14a2 80E0 ldi r24,lo8(__c.85) |
2732 14a4 90E0 ldi r25,hi8(__c.85) |
2733 .L91: |
2734 14a6 9F93 push r25 |
2735 14a8 8F93 push r24 |
2736 14aa 1F93 push r17 |
2737 14ac 0F93 push r16 |
2738 .L85: |
2739 14ae E091 0000 lds r30,_printf_P |
2740 14b2 F091 0000 lds r31,(_printf_P)+1 |
2741 14b6 0995 icall |
2742 14b8 0F90 pop __tmp_reg__ |
2743 14ba 0F90 pop __tmp_reg__ |
2744 14bc 0F90 pop __tmp_reg__ |
2745 14be 0F90 pop __tmp_reg__ |
2746 14c0 69C0 rjmp .L19 |
2747 .L77: |
2748 14c2 1092 0000 sts DispPtr,__zero_reg__ |
2749 14c6 80E0 ldi r24,lo8(__c.86) |
2750 14c8 90E0 ldi r25,hi8(__c.86) |
2751 14ca 9F93 push r25 |
2752 14cc 8F93 push r24 |
2753 14ce FF92 push r15 |
2754 14d0 EF92 push r14 |
2755 14d2 FE01 movw r30,r28 |
2756 14d4 0995 icall |
2757 14d6 84E1 ldi r24,lo8(20) |
2758 14d8 8093 0000 sts DispPtr,r24 |
2759 14dc 0F90 pop __tmp_reg__ |
2760 14de 0F90 pop __tmp_reg__ |
2761 14e0 0F90 pop __tmp_reg__ |
2762 14e2 0F90 pop __tmp_reg__ |
2763 14e4 8091 0000 lds r24,FlugMinutenGesamt |
2764 14e8 9091 0000 lds r25,(FlugMinutenGesamt)+1 |
2765 14ec 9F93 push r25 |
2766 14ee 8F93 push r24 |
2767 14f0 80E0 ldi r24,lo8(__c.87) |
2768 14f2 90E0 ldi r25,hi8(__c.87) |
2769 14f4 9F93 push r25 |
2770 14f6 8F93 push r24 |
2771 14f8 FF92 push r15 |
2772 14fa EF92 push r14 |
2773 14fc E091 0000 lds r30,_printf_P |
2774 1500 F091 0000 lds r31,(_printf_P)+1 |
2775 1504 0995 icall |
2776 1506 88E2 ldi r24,lo8(40) |
2777 1508 8093 0000 sts DispPtr,r24 |
2778 150c 8DB7 in r24,__SP_L__ |
2779 150e 9EB7 in r25,__SP_H__ |
2780 1510 0696 adiw r24,6 |
2781 1512 8DBF out __SP_L__,r24 |
2782 1514 8091 0000 lds r24,FlugMinuten |
2783 1518 9091 0000 lds r25,(FlugMinuten)+1 |
2784 151c 9F93 push r25 |
2785 151e 8F93 push r24 |
2786 1520 80E0 ldi r24,lo8(__c.88) |
2787 1522 90E0 ldi r25,hi8(__c.88) |
2788 1524 9F93 push r25 |
2789 1526 8F93 push r24 |
2790 1528 FF92 push r15 |
2791 152a EF92 push r14 |
2792 152c E091 0000 lds r30,_printf_P |
2793 1530 F091 0000 lds r31,(_printf_P)+1 |
2794 1534 0995 icall |
2795 1536 89E4 ldi r24,lo8(73) |
2796 1538 8093 0000 sts DispPtr,r24 |
2797 153c 2DB7 in r18,__SP_L__ |
2798 153e 3EB7 in r19,__SP_H__ |
2799 1540 2A5F subi r18,lo8(-(6)) |
2800 1542 3F4F sbci r19,hi8(-(6)) |
2801 1544 2DBF out __SP_L__,r18 |
2802 1546 80E0 ldi r24,lo8(__c.89) |
2803 1548 90E0 ldi r25,hi8(__c.89) |
2804 154a 9F93 push r25 |
2805 154c 8F93 push r24 |
2806 154e FF92 push r15 |
2807 1550 EF92 push r14 |
2808 1552 E091 0000 lds r30,_printf_P |
2809 1556 F091 0000 lds r31,(_printf_P)+1 |
2810 155a 0995 icall |
2811 155c 8091 0000 lds r24,RemoteKeys |
2812 1560 0F90 pop __tmp_reg__ |
2813 1562 0F90 pop __tmp_reg__ |
2814 1564 0F90 pop __tmp_reg__ |
2815 1566 0F90 pop __tmp_reg__ |
2816 1568 83FF sbrs r24,3 |
2817 156a 14C0 rjmp .L19 |
2818 156c 1092 0000 sts (FlugMinuten)+1,__zero_reg__ |
2819 1570 1092 0000 sts FlugMinuten,__zero_reg__ |
2820 1574 60E0 ldi r22,lo8(0) |
2821 1576 70E0 ldi r23,hi8(0) |
2822 1578 8EE0 ldi r24,lo8(14) |
2823 157a 90E0 ldi r25,hi8(14) |
2824 157c 0E94 0000 call SetParamWord |
2825 1580 09C0 rjmp .L19 |
2826 .L79: |
2827 1582 8091 0000 lds r24,MaxMenue |
2828 1586 2817 cp r18,r24 |
2829 1588 19F4 brne .L80 |
2830 158a 2150 subi r18,lo8(-(-1)) |
2831 158c 2093 0000 sts MaxMenue,r18 |
2832 .L80: |
2833 1590 1092 0000 sts MenuePunkt,__zero_reg__ |
2834 .L19: |
2835 1594 1092 0000 sts RemoteKeys,__zero_reg__ |
2836 /* epilogue: frame size=0 */ |
2837 1598 E6E0 ldi r30,6 |
2838 159a CDB7 in r28,__SP_L__ |
2839 159c DEB7 in r29,__SP_H__ |
2840 159e 0C94 0000 jmp __epilogue_restores__+24 |
2841 /* epilogue end (size=5) */ |
2842 /* function Menu size 2783 (2772) */ |
2844 /* File "menu.c": code 2803 = 0x0af3 (2790), prologues 6, epilogues 7 */ |
DEFINED SYMBOLS |
*ABS*:00000000 menu.c |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2 *ABS*:0000003f __SREG__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:3 *ABS*:0000003e __SP_H__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:4 *ABS*:0000003d __SP_L__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:5 *ABS*:00000034 __CCP__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:6 *ABS*:00000000 __tmp_reg__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:7 *ABS*:00000001 __zero_reg__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:11 .text:00000000 LcdClear |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2757 .data:00000000 DisplayBuff |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:28 .text:00000012 Menu_Putchar |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2765 .bss:00000000 DispPtr |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:44 .text:00000028 Menu |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2784 .bss:00000002 RemoteKeys |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2778 .bss:00000001 MenuePunkt |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2771 .data:00000050 MaxMenue |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:3145 .progmem.data:0000051a __c.2233 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:3141 .progmem.data:00000515 __c.2235 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:3137 .progmem.data:00000505 __c.2238 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:3133 .progmem.data:000004e6 __c.2240 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:3129 .progmem.data:000004d8 __c.2242 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:3125 .progmem.data:000004c1 __c.2244 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:3121 .progmem.data:000004ac __c.2246 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:3117 .progmem.data:0000049f __c.2248 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:3113 .progmem.data:00000492 __c.2250 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:3109 .progmem.data:00000485 __c.2254 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:3105 .progmem.data:00000478 __c.2256 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:3101 .progmem.data:0000046b __c.2258 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:3097 .progmem.data:0000045e __c.2260 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:3093 .progmem.data:0000044f __c.2262 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:3089 .progmem.data:00000446 __c.2264 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:3085 .progmem.data:00000437 __c.2266 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:3081 .progmem.data:0000042e __c.2268 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:3077 .progmem.data:00000421 __c.2271 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:3073 .progmem.data:00000412 __c.2273 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:3069 .progmem.data:00000403 __c.2275 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:3065 .progmem.data:000003f4 __c.2277 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:3061 .progmem.data:000003e4 __c.2280 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:3057 .progmem.data:000003d4 __c.2282 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:3053 .progmem.data:000003c4 __c.2284 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:3049 .progmem.data:000003b4 __c.2286 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:3045 .progmem.data:000003a4 __c.2289 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:3041 .progmem.data:00000394 __c.2291 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:3037 .progmem.data:00000384 __c.2293 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:3033 .progmem.data:00000374 __c.2295 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:3029 .progmem.data:00000366 __c.2298 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:3025 .progmem.data:00000355 __c.2300 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:3021 .progmem.data:00000344 __c.2302 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:3017 .progmem.data:00000336 __c.2304 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:3013 .progmem.data:00000324 __c.2306 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:3009 .progmem.data:00000312 __c.2308 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:3005 .progmem.data:00000303 __c.2310 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:3001 .progmem.data:000002ef __c.2312 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2997 .progmem.data:000002db __c.2314 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2993 .progmem.data:000002c7 __c.2316 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2989 .progmem.data:000002ba __c.2319 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2985 .progmem.data:000002ab __c.2321 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2981 .progmem.data:0000029c __c.2323 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2977 .progmem.data:0000028d __c.2325 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2973 .progmem.data:00000279 __c.2328 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2969 .progmem.data:00000265 __c.2330 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2965 .progmem.data:00000255 __c.2332 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2961 .progmem.data:00000243 __c.2334 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2957 .progmem.data:0000023a __c.2337 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2953 .progmem.data:0000022a __c.2339 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2949 .progmem.data:0000021a __c.2341 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2945 .progmem.data:0000020a __c.2343 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2941 .progmem.data:00000202 __c.2346 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2937 .progmem.data:000001f4 __c.2348 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2933 .progmem.data:000001e6 __c.2350 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2929 .progmem.data:000001d8 __c.2352 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2925 .progmem.data:000001cc __c.2355 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2921 .progmem.data:000001c0 __c.2357 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2917 .progmem.data:000001b4 __c.2359 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2913 .progmem.data:000001a8 __c.2361 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2909 .progmem.data:0000019c __c.2364 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2905 .progmem.data:00000190 __c.2366 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2901 .progmem.data:00000184 __c.2368 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2897 .progmem.data:00000178 __c.2370 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2893 .progmem.data:00000170 __c.2373 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2889 .progmem.data:00000162 __c.2375 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2885 .progmem.data:00000154 __c.2377 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2881 .progmem.data:00000146 __c.2379 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2877 .progmem.data:00000136 __c.2382 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2873 .progmem.data:00000126 __c.2384 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2869 .progmem.data:00000116 __c.2386 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2865 .progmem.data:00000106 __c.2388 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2861 .progmem.data:000000f6 __c.2391 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2857 .progmem.data:000000e5 __c.2393 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2853 .progmem.data:000000d4 __c.2395 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2849 .progmem.data:000000c3 __c.2397 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2845 .progmem.data:000000b4 __c.2400 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2841 .progmem.data:000000a3 __c.2402 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2837 .progmem.data:00000092 __c.2404 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2833 .progmem.data:00000081 __c.2406 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2829 .progmem.data:00000072 __c.2409 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2825 .progmem.data:0000005e __c.2411 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2821 .progmem.data:0000004a __c.2413 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2817 .progmem.data:00000039 __c.2415 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2813 .progmem.data:00000036 __c.2417 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2809 .progmem.data:00000033 __c.2419 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2805 .progmem.data:00000030 __c.2421 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2801 .progmem.data:00000022 __c.2424 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2797 .progmem.data:00000015 __c.2426 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2793 .progmem.data:00000008 __c.2428 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccEZZ8VC.s:2789 .progmem.data:00000000 __c.2430 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:3 *ABS*:0000003f __SREG__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:4 *ABS*:0000003e __SP_H__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:5 *ABS*:0000003d __SP_L__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:6 *ABS*:00000000 __tmp_reg__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:7 *ABS*:00000001 __zero_reg__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:15 .bss:00000000 RemoteKeys |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:21 .bss:00000001 MenuePunkt |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:27 .data:00000000 MaxMenue |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:34 .bss:00000002 DispPtr |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:40 .data:00000001 DisplayBuff |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:46 .text:00000000 LcdClear |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:65 .text:00000012 Menu_Putchar |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:84 .progmem.data:00000000 __c.0 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:88 .progmem.data:00000005 __c.1 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:92 .progmem.data:0000000a __c.2 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:96 .progmem.data:0000001a __c.3 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:100 .progmem.data:00000039 __c.4 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:104 .progmem.data:00000047 __c.5 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:108 .progmem.data:0000005e __c.6 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:112 .progmem.data:00000073 __c.7 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:116 .progmem.data:00000080 __c.8 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:120 .progmem.data:0000008d __c.9 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:124 .progmem.data:0000009a __c.10 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:128 .progmem.data:000000a7 __c.11 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:132 .progmem.data:000000b4 __c.12 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:136 .progmem.data:000000c1 __c.13 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:140 .progmem.data:000000d0 __c.14 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:144 .progmem.data:000000d9 __c.15 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:148 .progmem.data:000000e8 __c.16 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:152 .progmem.data:000000f1 __c.17 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:156 .progmem.data:000000fe __c.18 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:160 .progmem.data:0000010d __c.19 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:164 .progmem.data:0000011c __c.20 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:168 .progmem.data:0000012b __c.21 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:172 .progmem.data:0000013b __c.22 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:176 .progmem.data:0000014b __c.23 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:180 .progmem.data:0000015b __c.24 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:184 .progmem.data:0000016b __c.25 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:188 .progmem.data:0000017b __c.26 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:192 .progmem.data:0000018b __c.27 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:196 .progmem.data:0000019b __c.28 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:200 .progmem.data:000001ab __c.29 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:204 .progmem.data:000001b9 __c.30 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:208 .progmem.data:000001ca __c.31 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:212 .progmem.data:000001db __c.32 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:216 .progmem.data:000001e9 __c.33 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:220 .progmem.data:000001fb __c.34 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:224 .progmem.data:0000020d __c.35 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:228 .progmem.data:0000021c __c.36 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:232 .progmem.data:00000230 __c.37 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:236 .progmem.data:00000244 __c.38 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:240 .progmem.data:00000258 __c.39 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:244 .progmem.data:00000265 __c.40 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:248 .progmem.data:00000274 __c.41 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:252 .progmem.data:00000283 __c.42 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:256 .progmem.data:00000292 __c.43 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:260 .progmem.data:000002a6 __c.44 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:264 .progmem.data:000002ba __c.45 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:268 .progmem.data:000002ca __c.46 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:272 .progmem.data:000002dc __c.47 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:276 .progmem.data:000002e5 __c.48 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:280 .progmem.data:000002f5 __c.49 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:284 .progmem.data:00000305 __c.50 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:288 .progmem.data:00000315 __c.51 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:292 .progmem.data:0000031d __c.52 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:296 .progmem.data:0000032b __c.53 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:300 .progmem.data:00000339 __c.54 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:304 .progmem.data:00000347 __c.55 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:308 .progmem.data:00000353 __c.56 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:312 .progmem.data:0000035f __c.57 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:316 .progmem.data:0000036b __c.58 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:320 .progmem.data:00000377 __c.59 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:324 .progmem.data:00000383 __c.60 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:328 .progmem.data:0000038f __c.61 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:332 .progmem.data:0000039b __c.62 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:336 .progmem.data:000003a7 __c.63 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:340 .progmem.data:000003af __c.64 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:344 .progmem.data:000003bd __c.65 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:348 .progmem.data:000003cb __c.66 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:352 .progmem.data:000003d9 __c.67 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:356 .progmem.data:000003e9 __c.68 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:360 .progmem.data:000003f9 __c.69 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:364 .progmem.data:00000409 __c.70 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:368 .progmem.data:00000419 __c.71 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:372 .progmem.data:00000429 __c.72 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:376 .progmem.data:0000043a __c.73 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:380 .progmem.data:0000044b __c.74 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:384 .progmem.data:0000045c __c.75 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:388 .progmem.data:0000046b __c.76 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:392 .progmem.data:0000047c __c.77 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:396 .progmem.data:0000048d __c.78 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:400 .progmem.data:0000049e __c.79 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:404 .progmem.data:000004ad __c.80 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:408 .progmem.data:000004c1 __c.81 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:412 .progmem.data:000004d5 __c.82 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:416 .progmem.data:000004e6 __c.83 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:420 .progmem.data:000004e9 __c.84 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:424 .progmem.data:000004ec __c.85 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:428 .progmem.data:000004ef __c.86 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:432 .progmem.data:000004fd __c.87 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:436 .progmem.data:0000050a __c.88 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:440 .progmem.data:00000517 __c.89 |
C:\Users\Arthur-P\AppData\Local\Temp/ccIhcaaa.s:445 .text:00000028 Menu |
UNDEFINED SYMBOLS |
__do_copy_data |
__do_clear_bss |
_printf_P |
__tablejump2__ |
PlatinenVersion |
__udivmodqi4 |
Mixer |
GetActiveParamSet |
Mixer |
VersionInfo |
MissingMotor |
I2CTimeout |
3344,23 → 3041,23 |
IntegralRoll |
KompassValue |
PPM_in |
AdNeutralNick |
AdWertNick |
AdNeutralNick |
__divmodhi4 |
AdNeutralRoll |
AdWertRoll |
AdNeutralRoll |
AdNeutralGier |
AdWertGier |
AnalogOffsetNick |
AnalogOffsetRoll |
AnalogOffsetGier |
NeutralAccX |
AdWertAccNick |
NeutralAccX |
NeutralAccY |
AdWertAccRoll |
NeutralAccY |
NeutralAccZ |
AdWertAccHoch |
NeutralAccZ |
UBat |
__divmodhi4 |
Capacity |
__udivmodhi4 |
SenderOkay |
3376,5 → 3073,3 |
FlugMinuten |
SetParamWord |
__epilogue_restores__ |
__do_copy_data |
__do_clear_bss |
/branches/V0.80g-Arthur-P1/mymath.lst |
---|
1,223 → 1,226 |
1 .file "mymath.c" |
2 __SREG__ = 0x3f |
3 __SP_H__ = 0x3e |
4 __SP_L__ = 0x3d |
5 __CCP__ = 0x34 |
2 .arch atmega644p |
3 __SREG__ = 0x3f |
4 __SP_H__ = 0x3e |
5 __SP_L__ = 0x3d |
6 __tmp_reg__ = 0 |
7 __zero_reg__ = 1 |
8 .text |
9 .global c_sin_8192 |
11 c_sin_8192: |
12 /* prologue: function */ |
13 /* frame size = 0 */ |
14 0000 97FD sbrc r25,7 |
15 0002 00C0 rjmp .L2 |
16 0004 41E0 ldi r20,lo8(1) |
17 0006 00C0 rjmp .L3 |
18 .L2: |
19 0008 9095 com r25 |
20 000a 8195 neg r24 |
21 000c 9F4F sbci r25,lo8(-1) |
22 000e 4FEF ldi r20,lo8(-1) |
23 .L3: |
24 0010 68E6 ldi r22,lo8(360) |
25 0012 71E0 ldi r23,hi8(360) |
26 0014 0E94 0000 call __divmodhi4 |
27 0018 9C01 movw r18,r24 |
28 001a 8B35 cpi r24,91 |
29 001c 9105 cpc r25,__zero_reg__ |
30 001e 04F0 brlt .L9 |
31 .L4: |
32 0020 8B55 subi r24,lo8(-(-91)) |
33 0022 9040 sbci r25,hi8(-(-91)) |
34 0024 8A35 cpi r24,90 |
35 0026 9105 cpc r25,__zero_reg__ |
36 0028 00F4 brsh .L6 |
37 002a 84EB ldi r24,lo8(180) |
38 002c 90E0 ldi r25,hi8(180) |
39 002e BC01 movw r22,r24 |
40 0030 621B sub r22,r18 |
41 0032 730B sbc r23,r19 |
42 0034 9B01 movw r18,r22 |
43 .L9: |
44 0036 81E0 ldi r24,lo8(1) |
45 0038 00C0 rjmp .L5 |
46 .L6: |
47 003a C901 movw r24,r18 |
48 003c 855B subi r24,lo8(-(-181)) |
49 003e 9040 sbci r25,hi8(-(-181)) |
50 0040 8A35 cpi r24,90 |
51 0042 9105 cpc r25,__zero_reg__ |
52 0044 00F4 brsh .L7 |
53 0046 245B subi r18,lo8(-(-180)) |
54 0048 3040 sbci r19,hi8(-(-180)) |
55 004a 00C0 rjmp .L10 |
56 .L7: |
57 004c 88E6 ldi r24,lo8(360) |
58 004e 91E0 ldi r25,hi8(360) |
59 0050 BC01 movw r22,r24 |
60 0052 621B sub r22,r18 |
61 0054 730B sbc r23,r19 |
62 0056 9B01 movw r18,r22 |
63 .L10: |
64 0058 8FEF ldi r24,lo8(-1) |
65 .L5: |
66 005a F901 movw r30,r18 |
67 005c EE0F lsl r30 |
68 005e FF1F rol r31 |
69 0060 E050 subi r30,lo8(-(pgm_sinlookup)) |
70 0062 F040 sbci r31,hi8(-(pgm_sinlookup)) |
71 /* #APP */ |
72 ; 32 "mymath.c" 1 |
73 0064 2591 lpm r18, Z+ |
74 0066 3491 lpm r19, Z |
75 |
76 ; 0 "" 2 |
77 /* #NOAPP */ |
78 0068 9927 clr r25 |
79 006a 87FD sbrc r24,7 |
80 006c 9095 com r25 |
81 006e B901 movw r22,r18 |
82 0070 689F mul r22,r24 |
83 0072 9001 movw r18,r0 |
84 0074 699F mul r22,r25 |
85 0076 300D add r19,r0 |
86 0078 789F mul r23,r24 |
87 007a 300D add r19,r0 |
88 007c 1124 clr r1 |
89 007e 842F mov r24,r20 |
90 0080 9927 clr r25 |
91 0082 87FD sbrc r24,7 |
92 0084 9095 com r25 |
93 0086 A901 movw r20,r18 |
94 0088 489F mul r20,r24 |
95 008a 9001 movw r18,r0 |
96 008c 499F mul r20,r25 |
97 008e 300D add r19,r0 |
98 0090 589F mul r21,r24 |
99 0092 300D add r19,r0 |
100 0094 1124 clr r1 |
101 0096 C901 movw r24,r18 |
102 /* epilogue start */ |
103 0098 0895 ret |
105 .global c_cos_8192 |
107 c_cos_8192: |
108 /* prologue: function */ |
109 /* frame size = 0 */ |
110 009a 2AE5 ldi r18,lo8(90) |
111 009c 30E0 ldi r19,hi8(90) |
112 009e A901 movw r20,r18 |
113 00a0 481B sub r20,r24 |
114 00a2 590B sbc r21,r25 |
115 00a4 CA01 movw r24,r20 |
116 00a6 0E94 0000 call c_sin_8192 |
117 /* epilogue start */ |
118 00aa 0895 ret |
120 .global pgm_sinlookup |
121 .section .progmem.data,"a",@progbits |
124 pgm_sinlookup: |
125 0000 0000 .word 0 |
126 0002 8F00 .word 143 |
127 0004 1E01 .word 286 |
128 0006 AD01 .word 429 |
129 0008 3B02 .word 571 |
130 000a CA02 .word 714 |
131 000c 5803 .word 856 |
132 000e E603 .word 998 |
133 0010 7404 .word 1140 |
134 0012 0205 .word 1282 |
135 0014 8F05 .word 1423 |
136 0016 1B06 .word 1563 |
137 0018 A706 .word 1703 |
138 001a 3307 .word 1843 |
139 001c BE07 .word 1982 |
140 001e 4808 .word 2120 |
141 0020 D208 .word 2258 |
142 0022 5B09 .word 2395 |
143 0024 E309 .word 2531 |
144 0026 6B0A .word 2667 |
145 0028 F20A .word 2802 |
146 002a 780B .word 2936 |
147 002c FD0B .word 3069 |
148 002e 810C .word 3201 |
149 0030 040D .word 3332 |
150 0032 860D .word 3462 |
151 0034 070E .word 3591 |
152 0036 870E .word 3719 |
153 0038 060F .word 3846 |
154 003a 840F .word 3972 |
155 003c 0010 .word 4096 |
156 003e 7B10 .word 4219 |
157 0040 F510 .word 4341 |
158 0042 6E11 .word 4462 |
159 0044 E511 .word 4581 |
160 0046 5B12 .word 4699 |
161 0048 CF12 .word 4815 |
162 004a 4213 .word 4930 |
163 004c B313 .word 5043 |
164 004e 2314 .word 5155 |
165 0050 9214 .word 5266 |
166 0052 FE14 .word 5374 |
167 0054 6A15 .word 5482 |
168 0056 D315 .word 5587 |
169 0058 3B16 .word 5691 |
170 005a A116 .word 5793 |
171 005c 0517 .word 5893 |
172 005e 6717 .word 5991 |
173 0060 C817 .word 6088 |
174 0062 2718 .word 6183 |
175 0064 8318 .word 6275 |
176 0066 DE18 .word 6366 |
177 0068 3719 .word 6455 |
178 006a 8E19 .word 6542 |
179 006c E319 .word 6627 |
180 006e 361A .word 6710 |
181 0070 871A .word 6791 |
182 0072 D61A .word 6870 |
183 0074 231B .word 6947 |
184 0076 6E1B .word 7022 |
185 0078 B61B .word 7094 |
186 007a FD1B .word 7165 |
187 007c 411C .word 7233 |
188 007e 831C .word 7299 |
189 0080 C31C .word 7363 |
190 0082 001D .word 7424 |
191 0084 3C1D .word 7484 |
192 0086 751D .word 7541 |
193 0088 AB1D .word 7595 |
194 008a E01D .word 7648 |
195 008c 121E .word 7698 |
196 008e 421E .word 7746 |
197 0090 6F1E .word 7791 |
198 0092 9A1E .word 7834 |
199 0094 C31E .word 7875 |
200 0096 E91E .word 7913 |
201 0098 0D1F .word 7949 |
202 009a 2E1F .word 7982 |
203 009c 4D1F .word 8013 |
204 009e 691F .word 8041 |
205 00a0 841F .word 8068 |
206 00a2 9B1F .word 8091 |
207 00a4 B01F .word 8112 |
208 00a6 C31F .word 8131 |
209 00a8 D31F .word 8147 |
210 00aa E11F .word 8161 |
211 00ac EC1F .word 8172 |
212 00ae F51F .word 8181 |
213 00b0 FB1F .word 8187 |
214 00b2 FF1F .word 8191 |
215 00b4 0020 .word 8192 |
8 .global __do_copy_data |
9 .global __do_clear_bss |
10 .global pgm_sinlookup |
11 .section .progmem.data,"a",@progbits |
14 pgm_sinlookup: |
15 0000 0000 .word 0 |
16 0002 8F00 .word 143 |
17 0004 1E01 .word 286 |
18 0006 AD01 .word 429 |
19 0008 3B02 .word 571 |
20 000a CA02 .word 714 |
21 000c 5803 .word 856 |
22 000e E603 .word 998 |
23 0010 7404 .word 1140 |
24 0012 0205 .word 1282 |
25 0014 8F05 .word 1423 |
26 0016 1B06 .word 1563 |
27 0018 A706 .word 1703 |
28 001a 3307 .word 1843 |
29 001c BE07 .word 1982 |
30 001e 4808 .word 2120 |
31 0020 D208 .word 2258 |
32 0022 5B09 .word 2395 |
33 0024 E309 .word 2531 |
34 0026 6B0A .word 2667 |
35 0028 F20A .word 2802 |
36 002a 780B .word 2936 |
37 002c FD0B .word 3069 |
38 002e 810C .word 3201 |
39 0030 040D .word 3332 |
40 0032 860D .word 3462 |
41 0034 070E .word 3591 |
42 0036 870E .word 3719 |
43 0038 060F .word 3846 |
44 003a 840F .word 3972 |
45 003c 0010 .word 4096 |
46 003e 7B10 .word 4219 |
47 0040 F510 .word 4341 |
48 0042 6E11 .word 4462 |
49 0044 E511 .word 4581 |
50 0046 5B12 .word 4699 |
51 0048 CF12 .word 4815 |
52 004a 4213 .word 4930 |
53 004c B313 .word 5043 |
54 004e 2314 .word 5155 |
55 0050 9214 .word 5266 |
56 0052 FE14 .word 5374 |
57 0054 6A15 .word 5482 |
58 0056 D315 .word 5587 |
59 0058 3B16 .word 5691 |
60 005a A116 .word 5793 |
61 005c 0517 .word 5893 |
62 005e 6717 .word 5991 |
63 0060 C817 .word 6088 |
64 0062 2718 .word 6183 |
65 0064 8318 .word 6275 |
66 0066 DE18 .word 6366 |
67 0068 3719 .word 6455 |
68 006a 8E19 .word 6542 |
69 006c E319 .word 6627 |
70 006e 361A .word 6710 |
71 0070 871A .word 6791 |
72 0072 D61A .word 6870 |
73 0074 231B .word 6947 |
74 0076 6E1B .word 7022 |
75 0078 B61B .word 7094 |
76 007a FD1B .word 7165 |
77 007c 411C .word 7233 |
78 007e 831C .word 7299 |
79 0080 C31C .word 7363 |
80 0082 001D .word 7424 |
81 0084 3C1D .word 7484 |
82 0086 751D .word 7541 |
83 0088 AB1D .word 7595 |
84 008a E01D .word 7648 |
85 008c 121E .word 7698 |
86 008e 421E .word 7746 |
87 0090 6F1E .word 7791 |
88 0092 9A1E .word 7834 |
89 0094 C31E .word 7875 |
90 0096 E91E .word 7913 |
91 0098 0D1F .word 7949 |
92 009a 2E1F .word 7982 |
93 009c 4D1F .word 8013 |
94 009e 691F .word 8041 |
95 00a0 841F .word 8068 |
96 00a2 9B1F .word 8091 |
97 00a4 B01F .word 8112 |
98 00a6 C31F .word 8131 |
99 00a8 D31F .word 8147 |
100 00aa E11F .word 8161 |
101 00ac EC1F .word 8172 |
102 00ae F51F .word 8181 |
103 00b0 FB1F .word 8187 |
104 00b2 FF1F .word 8191 |
105 00b4 0020 .word 8192 |
106 .text |
107 .global c_sin_8192 |
109 c_sin_8192: |
110 /* prologue: frame size=0 */ |
111 0000 CF93 push r28 |
112 /* prologue end (size=1) */ |
113 0002 FC01 movw r30,r24 |
114 0004 97FF sbrs r25,7 |
115 0006 05C0 rjmp .L2 |
116 0008 CFEF ldi r28,lo8(-1) |
117 000a F095 com r31 |
118 000c E195 neg r30 |
119 000e FF4F sbci r31,lo8(-1) |
120 0010 01C0 rjmp .L4 |
121 .L2: |
122 0012 C1E0 ldi r28,lo8(1) |
123 .L4: |
124 0014 28E6 ldi r18,lo8(360) |
125 0016 31E0 ldi r19,hi8(360) |
126 0018 CF01 movw r24,r30 |
127 001a B901 movw r22,r18 |
128 001c 0E94 0000 call __divmodhi4 |
129 0020 FC01 movw r30,r24 |
130 0022 8B35 cpi r24,91 |
131 0024 9105 cpc r25,__zero_reg__ |
132 0026 54F0 brlt .L12 |
133 0028 8B55 subi r24,lo8(-(-91)) |
134 002a 9040 sbci r25,hi8(-(-91)) |
135 002c 8A35 cpi r24,90 |
136 002e 9105 cpc r25,__zero_reg__ |
137 0030 38F4 brsh .L7 |
138 0032 84EB ldi r24,lo8(180) |
139 0034 90E0 ldi r25,hi8(180) |
140 0036 8E1B sub r24,r30 |
141 0038 9F0B sbc r25,r31 |
142 003a FC01 movw r30,r24 |
143 .L12: |
144 003c 41E0 ldi r20,lo8(1) |
145 003e 0DC0 rjmp .L6 |
146 .L7: |
147 0040 CF01 movw r24,r30 |
148 0042 855B subi r24,lo8(-(-181)) |
149 0044 9040 sbci r25,hi8(-(-181)) |
150 0046 8A35 cpi r24,90 |
151 0048 9105 cpc r25,__zero_reg__ |
152 004a 18F4 brsh .L9 |
153 004c E45B subi r30,lo8(-(-180)) |
154 004e F040 sbci r31,hi8(-(-180)) |
155 0050 03C0 rjmp .L11 |
156 .L9: |
157 0052 2E1B sub r18,r30 |
158 0054 3F0B sbc r19,r31 |
159 0056 F901 movw r30,r18 |
160 .L11: |
161 0058 4FEF ldi r20,lo8(-1) |
162 .L6: |
163 005a EE0F add r30,r30 |
164 005c FF1F adc r31,r31 |
165 005e E050 subi r30,lo8(-(pgm_sinlookup)) |
166 0060 F040 sbci r31,hi8(-(pgm_sinlookup)) |
167 /* #APP */ |
168 0062 2591 lpm r18, Z+ |
169 0064 3491 lpm r19, Z |
170 |
171 /* #NOAPP */ |
172 0066 8C2F mov r24,r28 |
173 0068 9927 clr r25 |
174 006a 87FD sbrc r24,7 |
175 006c 9095 com r25 |
176 006e 289F mul r18,r24 |
177 0070 B001 movw r22,r0 |
178 0072 299F mul r18,r25 |
179 0074 700D add r23,r0 |
180 0076 389F mul r19,r24 |
181 0078 700D add r23,r0 |
182 007a 1124 clr r1 |
183 007c 842F mov r24,r20 |
184 007e 9927 clr r25 |
185 0080 87FD sbrc r24,7 |
186 0082 9095 com r25 |
187 0084 689F mul r22,r24 |
188 0086 A001 movw r20,r0 |
189 0088 699F mul r22,r25 |
190 008a 500D add r21,r0 |
191 008c 789F mul r23,r24 |
192 008e 500D add r21,r0 |
193 0090 1124 clr r1 |
194 0092 CA01 movw r24,r20 |
195 /* epilogue: frame size=0 */ |
196 0094 CF91 pop r28 |
197 0096 0895 ret |
198 /* epilogue end (size=2) */ |
199 /* function c_sin_8192 size 80 (77) */ |
201 .global c_cos_8192 |
203 c_cos_8192: |
204 /* prologue: frame size=0 */ |
205 /* prologue end (size=0) */ |
206 0098 2AE5 ldi r18,lo8(90) |
207 009a 30E0 ldi r19,hi8(90) |
208 009c 281B sub r18,r24 |
209 009e 390B sbc r19,r25 |
210 00a0 C901 movw r24,r18 |
211 00a2 0E94 0000 call c_sin_8192 |
212 /* epilogue: frame size=0 */ |
213 00a6 0895 ret |
214 /* epilogue end (size=1) */ |
215 /* function c_cos_8192 size 8 (7) */ |
217 /* File "mymath.c": code 88 = 0x0058 ( 84), prologues 1, epilogues 3 */ |
DEFINED SYMBOLS |
*ABS*:00000000 mymath.c |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccAR78Pj.s:2 *ABS*:0000003f __SREG__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccAR78Pj.s:3 *ABS*:0000003e __SP_H__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccAR78Pj.s:4 *ABS*:0000003d __SP_L__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccAR78Pj.s:5 *ABS*:00000034 __CCP__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccAR78Pj.s:6 *ABS*:00000000 __tmp_reg__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccAR78Pj.s:7 *ABS*:00000001 __zero_reg__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccAR78Pj.s:11 .text:00000000 c_sin_8192 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccAR78Pj.s:124 .progmem.data:00000000 pgm_sinlookup |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccAR78Pj.s:107 .text:0000009a c_cos_8192 |
C:\Users\Arthur-P\AppData\Local\Temp/ccodcaaa.s:3 *ABS*:0000003f __SREG__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccodcaaa.s:4 *ABS*:0000003e __SP_H__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccodcaaa.s:5 *ABS*:0000003d __SP_L__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccodcaaa.s:6 *ABS*:00000000 __tmp_reg__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccodcaaa.s:7 *ABS*:00000001 __zero_reg__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccodcaaa.s:14 .progmem.data:00000000 pgm_sinlookup |
C:\Users\Arthur-P\AppData\Local\Temp/ccodcaaa.s:109 .text:00000000 c_sin_8192 |
C:\Users\Arthur-P\AppData\Local\Temp/ccodcaaa.s:203 .text:00000098 c_cos_8192 |
UNDEFINED SYMBOLS |
__do_copy_data |
__do_clear_bss |
__divmodhi4 |
/branches/V0.80g-Arthur-P1/rc.lst |
---|
1,643 → 1,685 |
1 .file "rc.c" |
2 __SREG__ = 0x3f |
3 __SP_H__ = 0x3e |
4 __SP_L__ = 0x3d |
5 __CCP__ = 0x34 |
2 .arch atmega644p |
3 __SREG__ = 0x3f |
4 __SP_H__ = 0x3e |
5 __SP_L__ = 0x3d |
6 __tmp_reg__ = 0 |
7 __zero_reg__ = 1 |
8 .text |
9 .global rc_sum_init |
11 rc_sum_init: |
12 /* prologue: function */ |
13 /* frame size = 0 */ |
14 0000 80E0 ldi r24,lo8(0) |
15 0002 90E0 ldi r25,hi8(0) |
16 .L2: |
17 0004 FC01 movw r30,r24 |
18 0006 EE0F lsl r30 |
19 0008 FF1F rol r31 |
20 000a DF01 movw r26,r30 |
21 000c A050 subi r26,lo8(-(PPM_in)) |
22 000e B040 sbci r27,hi8(-(PPM_in)) |
23 0010 1196 adiw r26,1 |
24 0012 1C92 st X,__zero_reg__ |
25 0014 1E92 st -X,__zero_reg__ |
26 0016 E050 subi r30,lo8(-(PPM_diff)) |
27 0018 F040 sbci r31,hi8(-(PPM_diff)) |
28 001a 1182 std Z+1,__zero_reg__ |
29 001c 1082 st Z,__zero_reg__ |
30 001e 0196 adiw r24,1 |
31 0020 8A31 cpi r24,26 |
32 0022 9105 cpc r25,__zero_reg__ |
33 0024 01F4 brne .L2 |
34 0026 1092 0000 sts (AdNeutralGier)+1,__zero_reg__ |
35 002a 1092 0000 sts AdNeutralGier,__zero_reg__ |
36 002e 1092 0000 sts (AdNeutralRoll)+1,__zero_reg__ |
37 0032 1092 0000 sts AdNeutralRoll,__zero_reg__ |
38 0036 1092 0000 sts (AdNeutralNick)+1,__zero_reg__ |
39 003a 1092 0000 sts AdNeutralNick,__zero_reg__ |
40 /* epilogue start */ |
41 003e 0895 ret |
43 .global __vector_12 |
45 __vector_12: |
46 0040 1F92 push __zero_reg__ |
47 0042 0F92 push r0 |
48 0044 0FB6 in r0,__SREG__ |
49 0046 0F92 push r0 |
50 0048 1124 clr __zero_reg__ |
51 004a 0F93 push r16 |
52 004c 1F93 push r17 |
53 004e 2F93 push r18 |
54 0050 3F93 push r19 |
55 0052 4F93 push r20 |
56 0054 5F93 push r21 |
57 0056 6F93 push r22 |
58 0058 7F93 push r23 |
59 005a 8F93 push r24 |
60 005c 9F93 push r25 |
61 005e AF93 push r26 |
62 0060 BF93 push r27 |
63 0062 CF93 push r28 |
64 0064 DF93 push r29 |
65 0066 EF93 push r30 |
66 0068 FF93 push r31 |
67 /* prologue: Signal */ |
68 /* frame size = 0 */ |
69 006a 8091 0000 lds r24,EE_Parameter+99 |
70 006e 82FD sbrc r24,2 |
71 0070 00C0 rjmp .L6 |
72 0072 2091 8600 lds r18,134 |
73 0076 3091 8700 lds r19,(134)+1 |
74 007a 8091 0000 lds r24,AltICR.2229 |
75 007e 9091 0000 lds r25,(AltICR.2229)+1 |
76 0082 281B sub r18,r24 |
77 0084 390B sbc r19,r25 |
78 0086 8091 8600 lds r24,134 |
79 008a 9091 8700 lds r25,(134)+1 |
80 008e 9093 0000 sts (AltICR.2229)+1,r25 |
81 0092 8093 0000 sts AltICR.2229,r24 |
82 0096 C901 movw r24,r18 |
83 0098 8D54 subi r24,lo8(-(-1101)) |
84 009a 9440 sbci r25,hi8(-(-1101)) |
85 009c 0091 0000 lds r16,index.2232 |
86 00a0 1091 0000 lds r17,(index.2232)+1 |
87 00a4 835F subi r24,lo8(6899) |
88 00a6 9A41 sbci r25,hi8(6899) |
89 00a8 00F4 brsh .L7 |
90 00aa 0093 0000 sts Channels,r16 |
91 00ae 0430 cpi r16,4 |
92 00b0 1105 cpc r17,__zero_reg__ |
93 00b2 04F0 brlt .L8 |
94 00b4 1092 0000 sts NewPpmData,__zero_reg__ |
95 .L8: |
96 00b8 81E0 ldi r24,lo8(1) |
97 00ba 90E0 ldi r25,hi8(1) |
98 00bc 9093 0000 sts (index.2232)+1,r25 |
99 00c0 8093 0000 sts index.2232,r24 |
100 00c4 00C0 rjmp .L53 |
101 .L7: |
102 00c6 0D30 cpi r16,13 |
103 00c8 1105 cpc r17,__zero_reg__ |
104 00ca 04F0 brlt .+2 |
105 00cc 00C0 rjmp .L53 |
106 00ce C901 movw r24,r18 |
107 00d0 8B5F subi r24,lo8(-(-251)) |
108 00d2 9040 sbci r25,hi8(-(-251)) |
109 00d4 845B subi r24,lo8(436) |
110 00d6 9140 sbci r25,hi8(436) |
111 00d8 00F0 brlo .+2 |
112 00da 00C0 rjmp .L10 |
113 00dc E901 movw r28,r18 |
114 00de C25D subi r28,lo8(-(-466)) |
115 00e0 D140 sbci r29,hi8(-(-466)) |
116 00e2 F801 movw r30,r16 |
117 00e4 EE0F lsl r30 |
118 00e6 FF1F rol r31 |
119 00e8 E050 subi r30,lo8(-(PPM_in)) |
120 00ea F040 sbci r31,hi8(-(PPM_in)) |
121 00ec 8081 ld r24,Z |
122 00ee 9181 ldd r25,Z+1 |
123 00f0 FE01 movw r30,r28 |
124 00f2 E81B sub r30,r24 |
125 00f4 F90B sbc r31,r25 |
126 00f6 CF01 movw r24,r30 |
127 00f8 F7FF sbrs r31,7 |
128 00fa 00C0 rjmp .L12 |
129 00fc 9095 com r25 |
130 00fe 8195 neg r24 |
131 0100 9F4F sbci r25,lo8(-1) |
132 .L12: |
133 0102 0697 sbiw r24,6 |
134 0104 04F4 brge .L11 |
135 0106 8091 0000 lds r24,SenderOkay |
136 010a 883C cpi r24,lo8(-56) |
137 010c 00F4 brsh .L13 |
138 010e 8091 0000 lds r24,SenderOkay |
139 0112 865F subi r24,lo8(-(10)) |
140 0114 00C0 rjmp .L55 |
141 .L13: |
142 0116 88EC ldi r24,lo8(-56) |
143 .L55: |
144 0118 8093 0000 sts SenderOkay,r24 |
145 .L11: |
146 011c F801 movw r30,r16 |
147 011e EE0F lsl r30 |
148 0120 FF1F rol r31 |
149 0122 E050 subi r30,lo8(-(PPM_in)) |
150 0124 F040 sbci r31,hi8(-(PPM_in)) |
151 0126 2081 ld r18,Z |
152 0128 3181 ldd r19,Z+1 |
153 012a C901 movw r24,r18 |
154 012c 880F lsl r24 |
155 012e 991F rol r25 |
156 0130 820F add r24,r18 |
157 0132 931F adc r25,r19 |
158 0134 8C0F add r24,r28 |
159 0136 9D1F adc r25,r29 |
160 0138 64E0 ldi r22,lo8(4) |
161 013a 70E0 ldi r23,hi8(4) |
162 013c 0E94 0000 call __divmodhi4 |
163 0140 9B01 movw r18,r22 |
164 0142 CE01 movw r24,r28 |
165 0144 0196 adiw r24,1 |
166 0146 8617 cp r24,r22 |
167 0148 9707 cpc r25,r23 |
168 014a 04F4 brge .L14 |
169 014c 2150 subi r18,lo8(-(-1)) |
170 014e 3040 sbci r19,hi8(-(-1)) |
171 0150 00C0 rjmp .L15 |
172 .L14: |
173 0152 2197 sbiw r28,1 |
174 0154 6C17 cp r22,r28 |
175 0156 7D07 cpc r23,r29 |
176 0158 04F4 brge .L15 |
177 015a 2F5F subi r18,lo8(-(1)) |
178 015c 3F4F sbci r19,hi8(-(1)) |
179 .L15: |
180 015e 8091 0000 lds r24,SenderOkay |
181 0162 E801 movw r28,r16 |
182 0164 CC0F lsl r28 |
183 0166 DD1F rol r29 |
184 0168 833C cpi r24,lo8(-61) |
185 016a 00F0 brlo .L16 |
186 016c FE01 movw r30,r28 |
187 016e E050 subi r30,lo8(-(PPM_in)) |
188 0170 F040 sbci r31,hi8(-(PPM_in)) |
189 0172 8081 ld r24,Z |
190 0174 9181 ldd r25,Z+1 |
191 0176 A901 movw r20,r18 |
192 0178 481B sub r20,r24 |
193 017a 590B sbc r21,r25 |
194 017c CA01 movw r24,r20 |
195 017e 63E0 ldi r22,lo8(3) |
196 0180 70E0 ldi r23,hi8(3) |
197 0182 0E94 0000 call __divmodhi4 |
198 0186 CB01 movw r24,r22 |
199 0188 880F lsl r24 |
200 018a 991F rol r25 |
201 018c 860F add r24,r22 |
202 018e 971F adc r25,r23 |
203 0190 C050 subi r28,lo8(-(PPM_diff)) |
204 0192 D040 sbci r29,hi8(-(PPM_diff)) |
205 0194 9983 std Y+1,r25 |
206 0196 8883 st Y,r24 |
207 0198 00C0 rjmp .L17 |
208 .L16: |
209 019a C050 subi r28,lo8(-(PPM_diff)) |
210 019c D040 sbci r29,hi8(-(PPM_diff)) |
211 019e 1982 std Y+1,__zero_reg__ |
212 01a0 1882 st Y,__zero_reg__ |
213 .L17: |
214 01a2 F801 movw r30,r16 |
215 01a4 EE0F lsl r30 |
216 01a6 FF1F rol r31 |
217 01a8 E050 subi r30,lo8(-(PPM_in)) |
218 01aa F040 sbci r31,hi8(-(PPM_in)) |
219 01ac 3183 std Z+1,r19 |
220 01ae 2083 st Z,r18 |
221 .L10: |
222 01b0 F801 movw r30,r16 |
223 01b2 3196 adiw r30,1 |
224 01b4 F093 0000 sts (index.2232)+1,r31 |
225 01b8 E093 0000 sts index.2232,r30 |
226 01bc 8091 0000 lds r24,PlatinenVersion |
227 01c0 8431 cpi r24,lo8(20) |
228 01c2 00F0 brlo .+2 |
229 01c4 00C0 rjmp .L53 |
230 01c6 E530 cpi r30,5 |
231 01c8 F105 cpc r31,__zero_reg__ |
232 01ca 01F4 brne .L18 |
233 01cc 5D9A sbi 43-32,5 |
234 01ce 00C0 rjmp .L19 |
235 .L18: |
236 01d0 5D98 cbi 43-32,5 |
237 01d2 E630 cpi r30,6 |
238 01d4 F105 cpc r31,__zero_reg__ |
239 01d6 01F4 brne .L19 |
240 01d8 5C9A sbi 43-32,4 |
241 01da 00C0 rjmp .L20 |
242 .L19: |
243 01dc 5C98 cbi 43-32,4 |
244 01de 3797 sbiw r30,7 |
245 01e0 01F4 brne .L20 |
246 01e2 5B9A sbi 43-32,3 |
247 01e4 00C0 rjmp .L53 |
248 .L20: |
249 01e6 5B98 cbi 43-32,3 |
250 01e8 00C0 rjmp .L53 |
251 .L6: |
252 01ea 2091 8600 lds r18,134 |
253 01ee 3091 8700 lds r19,(134)+1 |
254 01f2 8091 0000 lds r24,AltICR.2233 |
255 01f6 9091 0000 lds r25,(AltICR.2233)+1 |
256 01fa 281B sub r18,r24 |
257 01fc 390B sbc r19,r25 |
258 01fe 8091 8600 lds r24,134 |
259 0202 9091 8700 lds r25,(134)+1 |
260 0206 9093 0000 sts (AltICR.2233)+1,r25 |
261 020a 8093 0000 sts AltICR.2233,r24 |
262 020e C901 movw r24,r18 |
263 0210 8D54 subi r24,lo8(-(-1101)) |
264 0212 9440 sbci r25,hi8(-(-1101)) |
265 0214 4091 0000 lds r20,index.2240 |
266 0218 835F subi r24,lo8(6899) |
267 021a 9A41 sbci r25,hi8(6899) |
268 021c 00F0 brlo .+2 |
269 021e 00C0 rjmp .L21 |
270 0220 4093 0000 sts tmpChannels,r20 |
271 0224 8091 0000 lds r24,tmpChannels |
272 0228 8430 cpi r24,lo8(4) |
273 022a 00F4 brsh .+2 |
274 022c 00C0 rjmp .L22 |
275 022e 9091 0000 lds r25,Channels |
276 0232 8091 0000 lds r24,tmpChannels |
277 0236 9817 cp r25,r24 |
278 0238 01F0 breq .+2 |
279 023a 00C0 rjmp .L22 |
280 023c 3091 0000 lds r19,okay_cnt.2241 |
281 0240 3B30 cpi r19,lo8(11) |
282 0242 00F0 brlo .L23 |
283 0244 1092 0000 sts NewPpmData,__zero_reg__ |
284 0248 20E0 ldi r18,lo8(0) |
285 024a 00C0 rjmp .L24 |
286 .L26: |
287 024c 3F31 cpi r19,lo8(31) |
288 024e 00F0 brlo .L25 |
289 0250 E22F mov r30,r18 |
290 0252 F0E0 ldi r31,lo8(0) |
291 0254 EE0F lsl r30 |
292 0256 FF1F rol r31 |
293 0258 DF01 movw r26,r30 |
294 025a A050 subi r26,lo8(-(PPM_in)) |
295 025c B040 sbci r27,hi8(-(PPM_in)) |
296 025e 8D91 ld r24,X+ |
297 0260 9C91 ld r25,X |
298 0262 DF01 movw r26,r30 |
299 0264 A050 subi r26,lo8(-(old_ppm_in.2236)) |
300 0266 B040 sbci r27,hi8(-(old_ppm_in.2236)) |
301 0268 8D93 st X+,r24 |
302 026a 9C93 st X,r25 |
303 026c DF01 movw r26,r30 |
304 026e A050 subi r26,lo8(-(PPM_diff)) |
305 0270 B040 sbci r27,hi8(-(PPM_diff)) |
306 0272 8D91 ld r24,X+ |
307 0274 9C91 ld r25,X |
308 0276 E050 subi r30,lo8(-(old_ppm_diff.2237)) |
309 0278 F040 sbci r31,hi8(-(old_ppm_diff.2237)) |
310 027a 9183 std Z+1,r25 |
311 027c 8083 st Z,r24 |
312 .L25: |
313 027e E22F mov r30,r18 |
314 0280 F0E0 ldi r31,lo8(0) |
315 0282 EE0F lsl r30 |
316 0284 FF1F rol r31 |
317 0286 DF01 movw r26,r30 |
318 0288 A050 subi r26,lo8(-(ppm_in.2234)) |
319 028a B040 sbci r27,hi8(-(ppm_in.2234)) |
320 028c 8D91 ld r24,X+ |
321 028e 9C91 ld r25,X |
322 0290 DF01 movw r26,r30 |
323 0292 A050 subi r26,lo8(-(PPM_in)) |
324 0294 B040 sbci r27,hi8(-(PPM_in)) |
325 0296 1196 adiw r26,1 |
326 0298 9C93 st X,r25 |
327 029a 8E93 st -X,r24 |
328 029c DF01 movw r26,r30 |
329 029e A050 subi r26,lo8(-(ppm_diff.2235)) |
330 02a0 B040 sbci r27,hi8(-(ppm_diff.2235)) |
331 02a2 8D91 ld r24,X+ |
332 02a4 9C91 ld r25,X |
333 02a6 E050 subi r30,lo8(-(PPM_diff)) |
334 02a8 F040 sbci r31,hi8(-(PPM_diff)) |
335 02aa 9183 std Z+1,r25 |
336 02ac 8083 st Z,r24 |
337 02ae 2F5F subi r18,lo8(-(1)) |
338 .L24: |
339 02b0 2D30 cpi r18,lo8(13) |
340 02b2 00F0 brlo .L26 |
341 02b4 3F3F cpi r19,lo8(-1) |
342 02b6 01F0 breq .L27 |
343 .L23: |
344 02b8 3F5F subi r19,lo8(-(1)) |
345 02ba 3093 0000 sts okay_cnt.2241,r19 |
346 02be 00C0 rjmp .L27 |
347 .L22: |
348 02c0 8091 0000 lds r24,okay_cnt.2241 |
349 02c4 8536 cpi r24,lo8(101) |
350 02c6 00F0 brlo .L28 |
351 02c8 8AE0 ldi r24,lo8(10) |
352 02ca 8093 0000 sts okay_cnt.2241,r24 |
353 02ce 00C0 rjmp .L29 |
354 .L28: |
355 02d0 1092 0000 sts okay_cnt.2241,__zero_reg__ |
356 .L29: |
357 02d4 8091 0000 lds r24,PlatinenVersion |
358 02d8 8A30 cpi r24,lo8(10) |
359 02da 01F0 breq .L30 |
360 02dc 8431 cpi r24,lo8(20) |
361 02de 00F0 brlo .L31 |
362 .L30: |
363 02e0 289A sbi 37-32,0 |
364 02e2 00C0 rjmp .L27 |
365 .L31: |
366 02e4 2898 cbi 37-32,0 |
367 .L27: |
368 02e6 81E0 ldi r24,lo8(1) |
369 02e8 8093 0000 sts index.2240,r24 |
370 02ec 8091 0000 lds r24,MotorenEin |
371 02f0 8823 tst r24 |
372 02f2 01F0 breq .+2 |
373 02f4 00C0 rjmp .L53 |
374 02f6 8091 0000 lds r24,tmpChannels |
375 02fa 8093 0000 sts Channels,r24 |
376 02fe 00C0 rjmp .L53 |
377 .L21: |
378 0300 4D30 cpi r20,lo8(13) |
379 0302 00F0 brlo .+2 |
380 0304 00C0 rjmp .L32 |
381 0306 C901 movw r24,r18 |
382 0308 8B5F subi r24,lo8(-(-251)) |
383 030a 9040 sbci r25,hi8(-(-251)) |
384 030c 845B subi r24,lo8(436) |
385 030e 9140 sbci r25,hi8(436) |
386 0310 00F0 brlo .+2 |
387 0312 00C0 rjmp .L33 |
388 0314 E901 movw r28,r18 |
389 0316 C25D subi r28,lo8(-(-466)) |
390 0318 D140 sbci r29,hi8(-(-466)) |
391 031a 042F mov r16,r20 |
392 031c 10E0 ldi r17,lo8(0) |
393 031e F801 movw r30,r16 |
394 0320 EE0F lsl r30 |
395 0322 FF1F rol r31 |
396 0324 E050 subi r30,lo8(-(ppm_in.2234)) |
397 0326 F040 sbci r31,hi8(-(ppm_in.2234)) |
398 0328 0190 ld __tmp_reg__,Z+ |
399 032a F081 ld r31,Z |
400 032c E02D mov r30,__tmp_reg__ |
401 032e CE01 movw r24,r28 |
402 0330 8E1B sub r24,r30 |
403 0332 9F0B sbc r25,r31 |
404 0334 0596 adiw r24,5 |
405 0336 0B97 sbiw r24,11 |
406 0338 00F4 brsh .L34 |
407 033a 8091 0000 lds r24,okay_cnt.2241 |
408 033e 8A31 cpi r24,lo8(26) |
409 0340 00F0 brlo .L35 |
410 0342 8091 0000 lds r24,SenderOkay |
411 0346 865F subi r24,lo8(-(10)) |
412 0348 00C0 rjmp .L56 |
413 .L35: |
414 034a 8B30 cpi r24,lo8(11) |
415 034c 00F0 brlo .L36 |
416 034e 8091 0000 lds r24,SenderOkay |
417 0352 8E5F subi r24,lo8(-(2)) |
418 .L56: |
419 0354 8093 0000 sts SenderOkay,r24 |
420 .L36: |
421 0358 8091 0000 lds r24,SenderOkay |
422 035c 893C cpi r24,lo8(-55) |
423 035e 00F0 brlo .L34 |
424 0360 88EC ldi r24,lo8(-56) |
425 0362 8093 0000 sts SenderOkay,r24 |
426 .L34: |
427 0366 CF01 movw r24,r30 |
428 0368 880F lsl r24 |
429 036a 991F rol r25 |
430 036c 8E0F add r24,r30 |
431 036e 9F1F adc r25,r31 |
432 0370 8C0F add r24,r28 |
433 0372 9D1F adc r25,r29 |
434 0374 64E0 ldi r22,lo8(4) |
435 0376 70E0 ldi r23,hi8(4) |
436 0378 0E94 0000 call __divmodhi4 |
437 037c 9B01 movw r18,r22 |
438 037e CE01 movw r24,r28 |
439 0380 0196 adiw r24,1 |
440 0382 8617 cp r24,r22 |
441 0384 9707 cpc r25,r23 |
442 0386 04F4 brge .L37 |
443 0388 2150 subi r18,lo8(-(-1)) |
444 038a 3040 sbci r19,hi8(-(-1)) |
445 038c 00C0 rjmp .L38 |
446 .L37: |
447 038e 2197 sbiw r28,1 |
448 0390 6C17 cp r22,r28 |
449 0392 7D07 cpc r23,r29 |
450 0394 04F4 brge .L38 |
451 0396 2F5F subi r18,lo8(-(1)) |
452 0398 3F4F sbci r19,hi8(-(1)) |
453 .L38: |
454 039a 8091 0000 lds r24,SenderOkay |
455 039e E801 movw r28,r16 |
456 03a0 CC0F lsl r28 |
457 03a2 DD1F rol r29 |
458 03a4 8E3B cpi r24,lo8(-66) |
459 03a6 00F0 brlo .L39 |
460 03a8 C050 subi r28,lo8(-(ppm_diff.2235)) |
461 03aa D040 sbci r29,hi8(-(ppm_diff.2235)) |
462 03ac C901 movw r24,r18 |
463 03ae 8E1B sub r24,r30 |
464 03b0 9F0B sbc r25,r31 |
465 03b2 63E0 ldi r22,lo8(3) |
466 03b4 70E0 ldi r23,hi8(3) |
467 03b6 0E94 0000 call __divmodhi4 |
468 03ba CB01 movw r24,r22 |
469 03bc 880F lsl r24 |
470 03be 991F rol r25 |
471 03c0 860F add r24,r22 |
472 03c2 971F adc r25,r23 |
473 03c4 9983 std Y+1,r25 |
474 03c6 8883 st Y,r24 |
475 03c8 00C0 rjmp .L40 |
476 .L39: |
477 03ca C050 subi r28,lo8(-(ppm_diff.2235)) |
478 03cc D040 sbci r29,hi8(-(ppm_diff.2235)) |
479 03ce 1982 std Y+1,__zero_reg__ |
480 03d0 1882 st Y,__zero_reg__ |
481 .L40: |
482 03d2 000F lsl r16 |
483 03d4 111F rol r17 |
484 03d6 0050 subi r16,lo8(-(ppm_in.2234)) |
485 03d8 1040 sbci r17,hi8(-(ppm_in.2234)) |
486 03da F801 movw r30,r16 |
487 03dc 3183 std Z+1,r19 |
488 03de 2083 st Z,r18 |
489 03e0 00C0 rjmp .L41 |
490 .L33: |
491 03e2 8091 0000 lds r24,PlatinenVersion |
492 03e6 8A30 cpi r24,lo8(10) |
493 03e8 01F0 breq .L42 |
494 03ea 8431 cpi r24,lo8(20) |
495 03ec 00F0 brlo .L43 |
496 .L42: |
497 03ee 289A sbi 37-32,0 |
498 03f0 00C0 rjmp .L41 |
499 .L43: |
500 03f2 2898 cbi 37-32,0 |
501 .L41: |
502 03f4 8091 0000 lds r24,PlatinenVersion |
503 03f8 8431 cpi r24,lo8(20) |
504 03fa 00F4 brsh .L44 |
505 03fc 4530 cpi r20,lo8(5) |
506 03fe 01F4 brne .L45 |
507 0400 5D9A sbi 43-32,5 |
508 0402 00C0 rjmp .L46 |
509 .L45: |
510 0404 5D98 cbi 43-32,5 |
511 0406 4630 cpi r20,lo8(6) |
512 0408 01F4 brne .L46 |
513 040a 5C9A sbi 43-32,4 |
514 040c 00C0 rjmp .L47 |
515 .L46: |
516 040e 5C98 cbi 43-32,4 |
517 0410 4730 cpi r20,lo8(7) |
518 0412 01F4 brne .L47 |
519 0414 5B9A sbi 43-32,3 |
520 0416 00C0 rjmp .L44 |
521 .L47: |
522 0418 5B98 cbi 43-32,3 |
523 041a 00C0 rjmp .L44 |
524 .L32: |
525 041c 4431 cpi r20,lo8(20) |
526 041e 00F4 brsh .L48 |
527 .L44: |
528 0420 4F5F subi r20,lo8(-(1)) |
529 0422 4093 0000 sts index.2240,r20 |
530 0426 00C0 rjmp .L53 |
531 .L48: |
532 0428 4431 cpi r20,lo8(20) |
533 042a 01F4 brne .L53 |
534 042c 8091 0000 lds r24,PlatinenVersion |
535 0430 8A30 cpi r24,lo8(10) |
536 0432 01F0 breq .L49 |
537 0434 8431 cpi r24,lo8(20) |
538 0436 00F0 brlo .L50 |
539 .L49: |
540 0438 289A sbi 37-32,0 |
541 043a 00C0 rjmp .L51 |
542 .L50: |
543 043c 2898 cbi 37-32,0 |
544 .L51: |
545 043e 8EE1 ldi r24,lo8(30) |
546 0440 8093 0000 sts index.2240,r24 |
547 0444 C0E0 ldi r28,lo8(old_ppm_in.2236) |
548 0446 D0E0 ldi r29,hi8(old_ppm_in.2236) |
549 0448 20E0 ldi r18,lo8(0) |
550 044a 30E0 ldi r19,hi8(0) |
551 .L52: |
552 044c 8991 ld r24,Y+ |
553 044e 9991 ld r25,Y+ |
554 0450 F901 movw r30,r18 |
555 0452 EE0F lsl r30 |
556 0454 FF1F rol r31 |
557 0456 DF01 movw r26,r30 |
558 0458 A050 subi r26,lo8(-(PPM_in)) |
559 045a B040 sbci r27,hi8(-(PPM_in)) |
560 045c 1196 adiw r26,1 |
561 045e 9C93 st X,r25 |
562 0460 8E93 st -X,r24 |
563 0462 E050 subi r30,lo8(-(PPM_diff)) |
564 0464 F040 sbci r31,hi8(-(PPM_diff)) |
565 0466 1182 std Z+1,__zero_reg__ |
566 0468 1082 st Z,__zero_reg__ |
567 046a 2F5F subi r18,lo8(-(1)) |
568 046c 3F4F sbci r19,hi8(-(1)) |
569 046e 2D30 cpi r18,13 |
570 0470 3105 cpc r19,__zero_reg__ |
571 0472 01F4 brne .L52 |
572 .L53: |
573 /* epilogue start */ |
574 0474 FF91 pop r31 |
575 0476 EF91 pop r30 |
576 0478 DF91 pop r29 |
577 047a CF91 pop r28 |
578 047c BF91 pop r27 |
579 047e AF91 pop r26 |
580 0480 9F91 pop r25 |
581 0482 8F91 pop r24 |
582 0484 7F91 pop r23 |
583 0486 6F91 pop r22 |
584 0488 5F91 pop r21 |
585 048a 4F91 pop r20 |
586 048c 3F91 pop r19 |
587 048e 2F91 pop r18 |
588 0490 1F91 pop r17 |
589 0492 0F91 pop r16 |
590 0494 0F90 pop r0 |
591 0496 0FBE out __SREG__,r0 |
592 0498 0F90 pop r0 |
593 049a 1F90 pop __zero_reg__ |
594 049c 1895 reti |
596 .global tmpChannels |
597 .global tmpChannels |
598 .section .bss |
601 tmpChannels: |
602 0000 00 .skip 1,0 |
603 .global NewPpmData |
604 .data |
607 NewPpmData: |
608 0000 01 .byte 1 |
609 .lcomm okay_cnt.2241,1 |
610 .lcomm index.2240,1 |
611 .lcomm old_ppm_diff.2237,26 |
612 .lcomm old_ppm_in.2236,26 |
613 .lcomm ppm_diff.2235,26 |
614 .lcomm ppm_in.2234,26 |
615 .lcomm AltICR.2233,2 |
616 .lcomm index.2232,2 |
617 .lcomm AltICR.2229,2 |
618 .comm PPM_in,52,1 |
619 .comm PPM_diff,52,1 |
620 .comm Channels,1,1 |
621 .global __do_copy_data |
622 .global __do_clear_bss |
8 .global __do_copy_data |
9 .global __do_clear_bss |
10 .global NewPpmData |
11 .data |
14 NewPpmData: |
15 0000 01 .byte 1 |
16 .global tmpChannels |
17 .global tmpChannels |
18 .section .bss |
21 tmpChannels: |
22 0000 00 .skip 1,0 |
23 .text |
24 .global rc_sum_init |
26 rc_sum_init: |
27 /* prologue: frame size=0 */ |
28 /* prologue end (size=0) */ |
29 0000 89E1 ldi r24,lo8(25) |
30 0002 A0E0 ldi r26,lo8(PPM_diff) |
31 0004 B0E0 ldi r27,hi8(PPM_diff) |
32 0006 E0E0 ldi r30,lo8(PPM_in) |
33 0008 F0E0 ldi r31,hi8(PPM_in) |
34 .L5: |
35 000a 1182 std Z+1,__zero_reg__ |
36 000c 1082 st Z,__zero_reg__ |
37 000e 3296 adiw r30,2 |
38 0010 1196 adiw r26,1 |
39 0012 1C92 st X,__zero_reg__ |
40 0014 1E92 st -X,__zero_reg__ |
41 0016 1296 adiw r26,2 |
42 0018 8150 subi r24,lo8(-(-1)) |
43 001a 87FF sbrs r24,7 |
44 001c F6CF rjmp .L5 |
45 001e 1092 0000 sts (AdNeutralGier)+1,__zero_reg__ |
46 0022 1092 0000 sts AdNeutralGier,__zero_reg__ |
47 0026 1092 0000 sts (AdNeutralRoll)+1,__zero_reg__ |
48 002a 1092 0000 sts AdNeutralRoll,__zero_reg__ |
49 002e 1092 0000 sts (AdNeutralNick)+1,__zero_reg__ |
50 0032 1092 0000 sts AdNeutralNick,__zero_reg__ |
51 /* epilogue: frame size=0 */ |
52 0036 0895 ret |
53 /* epilogue end (size=1) */ |
54 /* function rc_sum_init size 28 (27) */ |
56 .lcomm AltICR.0,2 |
57 .lcomm index.1,2 |
58 .lcomm AltICR.2,2 |
59 .lcomm ppm_in.3,26 |
60 .lcomm ppm_diff.4,26 |
61 .lcomm old_ppm_in.5,26 |
62 .lcomm old_ppm_diff.6,26 |
63 .lcomm index.7,1 |
64 .lcomm okay_cnt.8,1 |
65 .global __vector_12 |
67 __vector_12: |
68 /* prologue: frame size=0 */ |
69 0038 1F92 push __zero_reg__ |
70 003a 0F92 push __tmp_reg__ |
71 003c 0FB6 in __tmp_reg__,__SREG__ |
72 003e 0F92 push __tmp_reg__ |
73 0040 1124 clr __zero_reg__ |
74 0042 0F93 push r16 |
75 0044 1F93 push r17 |
76 0046 2F93 push r18 |
77 0048 3F93 push r19 |
78 004a 4F93 push r20 |
79 004c 5F93 push r21 |
80 004e 6F93 push r22 |
81 0050 7F93 push r23 |
82 0052 8F93 push r24 |
83 0054 9F93 push r25 |
84 0056 AF93 push r26 |
85 0058 BF93 push r27 |
86 005a CF93 push r28 |
87 005c DF93 push r29 |
88 005e EF93 push r30 |
89 0060 FF93 push r31 |
90 /* prologue end (size=21) */ |
91 0062 8091 0000 lds r24,EE_Parameter+99 |
92 0066 82FD sbrc r24,2 |
93 0068 CFC0 rjmp .L9 |
94 006a 4091 8600 lds r20,134 |
95 006e 5091 8700 lds r21,(134)+1 |
96 0072 8091 0000 lds r24,AltICR.0 |
97 0076 9091 0000 lds r25,(AltICR.0)+1 |
98 007a 481B sub r20,r24 |
99 007c 590B sbc r21,r25 |
100 007e 8091 8600 lds r24,134 |
101 0082 9091 8700 lds r25,(134)+1 |
102 0086 9093 0000 sts (AltICR.0)+1,r25 |
103 008a 8093 0000 sts AltICR.0,r24 |
104 008e CA01 movw r24,r20 |
105 0090 8D54 subi r24,lo8(-(-1101)) |
106 0092 9440 sbci r25,hi8(-(-1101)) |
107 0094 A091 0000 lds r26,index.1 |
108 0098 B091 0000 lds r27,(index.1)+1 |
109 009c 835F subi r24,lo8(6899) |
110 009e 9A41 sbci r25,hi8(6899) |
111 00a0 78F4 brsh .L10 |
112 00a2 8091 0000 lds r24,index.1 |
113 00a6 8093 0000 sts Channels,r24 |
114 00aa 1497 sbiw r26,4 |
115 00ac 14F0 brlt .L11 |
116 00ae 1092 0000 sts NewPpmData,__zero_reg__ |
117 .L11: |
118 00b2 81E0 ldi r24,lo8(1) |
119 00b4 90E0 ldi r25,hi8(1) |
120 00b6 9093 0000 sts (index.1)+1,r25 |
121 00ba 8093 0000 sts index.1,r24 |
122 00be 07C2 rjmp .L8 |
123 .L10: |
124 00c0 AD30 cpi r26,13 |
125 00c2 B105 cpc r27,__zero_reg__ |
126 00c4 0CF0 brlt .+2 |
127 00c6 03C2 rjmp .L8 |
128 00c8 CA01 movw r24,r20 |
129 00ca 8B5F subi r24,lo8(-(-251)) |
130 00cc 9040 sbci r25,hi8(-(-251)) |
131 00ce 845B subi r24,lo8(436) |
132 00d0 9140 sbci r25,hi8(436) |
133 00d2 08F0 brlo .+2 |
134 00d4 74C0 rjmp .L14 |
135 00d6 425D subi r20,lo8(-(-466)) |
136 00d8 5140 sbci r21,hi8(-(-466)) |
137 00da FD01 movw r30,r26 |
138 00dc EA0F add r30,r26 |
139 00de FB1F adc r31,r27 |
140 00e0 E050 subi r30,lo8(-(PPM_in)) |
141 00e2 F040 sbci r31,hi8(-(PPM_in)) |
142 00e4 8081 ld r24,Z |
143 00e6 9181 ldd r25,Z+1 |
144 00e8 FA01 movw r30,r20 |
145 00ea E81B sub r30,r24 |
146 00ec F90B sbc r31,r25 |
147 00ee CF01 movw r24,r30 |
148 00f0 F7FF sbrs r31,7 |
149 00f2 03C0 rjmp .L16 |
150 00f4 9095 com r25 |
151 00f6 8195 neg r24 |
152 00f8 9F4F sbci r25,lo8(-1) |
153 .L16: |
154 00fa 0697 sbiw r24,6 |
155 00fc 5CF4 brge .L15 |
156 00fe 8091 0000 lds r24,SenderOkay |
157 0102 883C cpi r24,lo8(-56) |
158 0104 20F4 brsh .L17 |
159 0106 8091 0000 lds r24,SenderOkay |
160 010a 865F subi r24,lo8(-(10)) |
161 010c 01C0 rjmp .L87 |
162 .L17: |
163 010e 88EC ldi r24,lo8(-56) |
164 .L87: |
165 0110 8093 0000 sts SenderOkay,r24 |
166 .L15: |
167 0114 FD01 movw r30,r26 |
168 0116 EA0F add r30,r26 |
169 0118 FB1F adc r31,r27 |
170 011a E050 subi r30,lo8(-(PPM_in)) |
171 011c F040 sbci r31,hi8(-(PPM_in)) |
172 011e 8081 ld r24,Z |
173 0120 9181 ldd r25,Z+1 |
174 0122 9C01 movw r18,r24 |
175 0124 220F lsl r18 |
176 0126 331F rol r19 |
177 0128 280F add r18,r24 |
178 012a 391F adc r19,r25 |
179 012c 240F add r18,r20 |
180 012e 351F adc r19,r21 |
181 0130 37FF sbrs r19,7 |
182 0132 02C0 rjmp .L19 |
183 0134 2D5F subi r18,lo8(-(3)) |
184 0136 3F4F sbci r19,hi8(-(3)) |
185 .L19: |
186 0138 E901 movw r28,r18 |
187 013a D595 asr r29 |
188 013c C795 ror r28 |
189 013e D595 asr r29 |
190 0140 C795 ror r28 |
191 0142 CA01 movw r24,r20 |
192 0144 0196 adiw r24,1 |
193 0146 8C17 cp r24,r28 |
194 0148 9D07 cpc r25,r29 |
195 014a 14F4 brge .L20 |
196 014c 2197 sbiw r28,1 |
197 014e 06C0 rjmp .L21 |
198 .L20: |
199 0150 4150 subi r20,lo8(-(-1)) |
200 0152 5040 sbci r21,hi8(-(-1)) |
201 0154 C417 cp r28,r20 |
202 0156 D507 cpc r29,r21 |
203 0158 0CF4 brge .L21 |
204 015a 2196 adiw r28,1 |
205 .L21: |
206 015c 8091 0000 lds r24,SenderOkay |
207 0160 833C cpi r24,lo8(-61) |
208 0162 E0F0 brlo .L23 |
209 0164 8D01 movw r16,r26 |
210 0166 0A0F add r16,r26 |
211 0168 1B1F adc r17,r27 |
212 016a F801 movw r30,r16 |
213 016c E050 subi r30,lo8(-(PPM_in)) |
214 016e F040 sbci r31,hi8(-(PPM_in)) |
215 0170 8081 ld r24,Z |
216 0172 9181 ldd r25,Z+1 |
217 0174 9E01 movw r18,r28 |
218 0176 281B sub r18,r24 |
219 0178 390B sbc r19,r25 |
220 017a C901 movw r24,r18 |
221 017c 63E0 ldi r22,lo8(3) |
222 017e 70E0 ldi r23,hi8(3) |
223 0180 0E94 0000 call __divmodhi4 |
224 0184 CB01 movw r24,r22 |
225 0186 880F lsl r24 |
226 0188 991F rol r25 |
227 018a 860F add r24,r22 |
228 018c 971F adc r25,r23 |
229 018e 0050 subi r16,lo8(-(PPM_diff)) |
230 0190 1040 sbci r17,hi8(-(PPM_diff)) |
231 0192 D801 movw r26,r16 |
232 0194 1196 adiw r26,1 |
233 0196 9C93 st X,r25 |
234 0198 8E93 st -X,r24 |
235 019a 07C0 rjmp .L24 |
236 .L23: |
237 019c AA0F add r26,r26 |
238 019e BB1F adc r27,r27 |
239 01a0 A050 subi r26,lo8(-(PPM_diff)) |
240 01a2 B040 sbci r27,hi8(-(PPM_diff)) |
241 01a4 1196 adiw r26,1 |
242 01a6 1C92 st X,__zero_reg__ |
243 01a8 1E92 st -X,__zero_reg__ |
244 .L24: |
245 01aa E091 0000 lds r30,index.1 |
246 01ae F091 0000 lds r31,(index.1)+1 |
247 01b2 EE0F add r30,r30 |
248 01b4 FF1F adc r31,r31 |
249 01b6 E050 subi r30,lo8(-(PPM_in)) |
250 01b8 F040 sbci r31,hi8(-(PPM_in)) |
251 01ba D183 std Z+1,r29 |
252 01bc C083 st Z,r28 |
253 .L14: |
254 01be 2091 0000 lds r18,index.1 |
255 01c2 3091 0000 lds r19,(index.1)+1 |
256 01c6 2F5F subi r18,lo8(-(1)) |
257 01c8 3F4F sbci r19,hi8(-(1)) |
258 01ca 3093 0000 sts (index.1)+1,r19 |
259 01ce 2093 0000 sts index.1,r18 |
260 01d2 8091 0000 lds r24,PlatinenVersion |
261 01d6 8431 cpi r24,lo8(20) |
262 01d8 08F0 brlo .+2 |
263 01da 79C1 rjmp .L8 |
264 01dc 2530 cpi r18,5 |
265 01de 3105 cpc r19,__zero_reg__ |
266 01e0 11F4 brne .L26 |
267 01e2 5D9A sbi 43-0x20,5 |
268 01e4 01C0 rjmp .L27 |
269 .L26: |
270 01e6 5D98 cbi 43-0x20,5 |
271 .L27: |
272 01e8 8091 0000 lds r24,index.1 |
273 01ec 9091 0000 lds r25,(index.1)+1 |
274 01f0 8630 cpi r24,6 |
275 01f2 9105 cpc r25,__zero_reg__ |
276 01f4 11F4 brne .L28 |
277 01f6 5C9A sbi 43-0x20,4 |
278 01f8 01C0 rjmp .L29 |
279 .L28: |
280 01fa 5C98 cbi 43-0x20,4 |
281 .L29: |
282 01fc 0797 sbiw r24,7 |
283 01fe 11F4 brne .L30 |
284 0200 5B9A sbi 43-0x20,3 |
285 0202 65C1 rjmp .L8 |
286 .L30: |
287 0204 5B98 cbi 43-0x20,3 |
288 0206 63C1 rjmp .L8 |
289 .L9: |
290 0208 4091 8600 lds r20,134 |
291 020c 5091 8700 lds r21,(134)+1 |
292 0210 8091 0000 lds r24,AltICR.2 |
293 0214 9091 0000 lds r25,(AltICR.2)+1 |
294 0218 481B sub r20,r24 |
295 021a 590B sbc r21,r25 |
296 021c 8091 8600 lds r24,134 |
297 0220 9091 8700 lds r25,(134)+1 |
298 0224 9093 0000 sts (AltICR.2)+1,r25 |
299 0228 8093 0000 sts AltICR.2,r24 |
300 022c CA01 movw r24,r20 |
301 022e 8D54 subi r24,lo8(-(-1101)) |
302 0230 9440 sbci r25,hi8(-(-1101)) |
303 0232 6091 0000 lds r22,index.7 |
304 0236 835F subi r24,lo8(6899) |
305 0238 9A41 sbci r25,hi8(6899) |
306 023a 08F0 brlo .+2 |
307 023c 7AC0 rjmp .L33 |
308 023e 6093 0000 sts tmpChannels,r22 |
309 0242 8091 0000 lds r24,tmpChannels |
310 0246 8430 cpi r24,lo8(4) |
311 0248 08F4 brsh .+2 |
312 024a 53C0 rjmp .L34 |
313 024c 9091 0000 lds r25,Channels |
314 0250 8091 0000 lds r24,tmpChannels |
315 0254 9817 cp r25,r24 |
316 0256 09F0 breq .+2 |
317 0258 4CC0 rjmp .L34 |
318 025a 5091 0000 lds r21,okay_cnt.8 |
319 025e 5B30 cpi r21,lo8(11) |
320 0260 08F4 brsh .+2 |
321 0262 3FC0 rjmp .L35 |
322 0264 1092 0000 sts NewPpmData,__zero_reg__ |
323 0268 1092 0000 sts index.7,__zero_reg__ |
324 026c 40E0 ldi r20,lo8(0) |
325 .L40: |
326 026e 5F31 cpi r21,lo8(31) |
327 0270 C0F0 brlo .L39 |
328 0272 E42F mov r30,r20 |
329 0274 FF27 clr r31 |
330 0276 EE0F add r30,r30 |
331 0278 FF1F adc r31,r31 |
332 027a 9F01 movw r18,r30 |
333 027c 2050 subi r18,lo8(-(old_ppm_in.5)) |
334 027e 3040 sbci r19,hi8(-(old_ppm_in.5)) |
335 0280 DF01 movw r26,r30 |
336 0282 A050 subi r26,lo8(-(PPM_in)) |
337 0284 B040 sbci r27,hi8(-(PPM_in)) |
338 0286 8D91 ld r24,X+ |
339 0288 9C91 ld r25,X |
340 028a D901 movw r26,r18 |
341 028c 8D93 st X+,r24 |
342 028e 9C93 st X,r25 |
343 0290 DF01 movw r26,r30 |
344 0292 A050 subi r26,lo8(-(PPM_diff)) |
345 0294 B040 sbci r27,hi8(-(PPM_diff)) |
346 0296 8D91 ld r24,X+ |
347 0298 9C91 ld r25,X |
348 029a E050 subi r30,lo8(-(old_ppm_diff.6)) |
349 029c F040 sbci r31,hi8(-(old_ppm_diff.6)) |
350 029e 9183 std Z+1,r25 |
351 02a0 8083 st Z,r24 |
352 .L39: |
353 02a2 E42F mov r30,r20 |
354 02a4 FF27 clr r31 |
355 02a6 EE0F add r30,r30 |
356 02a8 FF1F adc r31,r31 |
357 02aa 9F01 movw r18,r30 |
358 02ac 2050 subi r18,lo8(-(PPM_in)) |
359 02ae 3040 sbci r19,hi8(-(PPM_in)) |
360 02b0 DF01 movw r26,r30 |
361 02b2 A050 subi r26,lo8(-(ppm_in.3)) |
362 02b4 B040 sbci r27,hi8(-(ppm_in.3)) |
363 02b6 8D91 ld r24,X+ |
364 02b8 9C91 ld r25,X |
365 02ba D901 movw r26,r18 |
366 02bc 1196 adiw r26,1 |
367 02be 9C93 st X,r25 |
368 02c0 8E93 st -X,r24 |
369 02c2 DF01 movw r26,r30 |
370 02c4 A050 subi r26,lo8(-(ppm_diff.4)) |
371 02c6 B040 sbci r27,hi8(-(ppm_diff.4)) |
372 02c8 8D91 ld r24,X+ |
373 02ca 9C91 ld r25,X |
374 02cc E050 subi r30,lo8(-(PPM_diff)) |
375 02ce F040 sbci r31,hi8(-(PPM_diff)) |
376 02d0 9183 std Z+1,r25 |
377 02d2 8083 st Z,r24 |
378 02d4 842F mov r24,r20 |
379 02d6 8F5F subi r24,lo8(-(1)) |
380 02d8 482F mov r20,r24 |
381 02da 8D30 cpi r24,lo8(13) |
382 02dc 40F2 brlo .L40 |
383 02de 8093 0000 sts index.7,r24 |
384 .L35: |
385 02e2 8091 0000 lds r24,okay_cnt.8 |
386 02e6 8F3F cpi r24,lo8(-1) |
387 02e8 B9F0 breq .L42 |
388 02ea 8F5F subi r24,lo8(-(1)) |
389 02ec 8093 0000 sts okay_cnt.8,r24 |
390 02f0 13C0 rjmp .L42 |
391 .L34: |
392 02f2 8091 0000 lds r24,okay_cnt.8 |
393 02f6 8536 cpi r24,lo8(101) |
394 02f8 20F0 brlo .L43 |
395 02fa 8AE0 ldi r24,lo8(10) |
396 02fc 8093 0000 sts okay_cnt.8,r24 |
397 0300 02C0 rjmp .L44 |
398 .L43: |
399 0302 1092 0000 sts okay_cnt.8,__zero_reg__ |
400 .L44: |
401 0306 8091 0000 lds r24,PlatinenVersion |
402 030a 8A30 cpi r24,lo8(10) |
403 030c 11F0 breq .L46 |
404 030e 8431 cpi r24,lo8(20) |
405 0310 10F0 brlo .L45 |
406 .L46: |
407 0312 289A sbi 37-0x20,0 |
408 0314 01C0 rjmp .L42 |
409 .L45: |
410 0316 2898 cbi 37-0x20,0 |
411 .L42: |
412 0318 81E0 ldi r24,lo8(1) |
413 031a 8093 0000 sts index.7,r24 |
414 031e 8091 0000 lds r24,MotorenEin |
415 0322 8823 tst r24 |
416 0324 09F0 breq .+2 |
417 0326 D3C0 rjmp .L8 |
418 0328 8091 0000 lds r24,tmpChannels |
419 032c 8093 0000 sts Channels,r24 |
420 0330 CEC0 rjmp .L8 |
421 .L33: |
422 0332 6D30 cpi r22,lo8(13) |
423 0334 08F0 brlo .+2 |
424 0336 A3C0 rjmp .L50 |
425 0338 CA01 movw r24,r20 |
426 033a 8B5F subi r24,lo8(-(-251)) |
427 033c 9040 sbci r25,hi8(-(-251)) |
428 033e 845B subi r24,lo8(436) |
429 0340 9140 sbci r25,hi8(436) |
430 0342 08F0 brlo .+2 |
431 0344 7EC0 rjmp .L51 |
432 0346 425D subi r20,lo8(-(-466)) |
433 0348 5140 sbci r21,hi8(-(-466)) |
434 034a E62F mov r30,r22 |
435 034c FF27 clr r31 |
436 034e EE0F add r30,r30 |
437 0350 FF1F adc r31,r31 |
438 0352 E050 subi r30,lo8(-(ppm_in.3)) |
439 0354 F040 sbci r31,hi8(-(ppm_in.3)) |
440 0356 8081 ld r24,Z |
441 0358 9181 ldd r25,Z+1 |
442 035a FA01 movw r30,r20 |
443 035c E81B sub r30,r24 |
444 035e F90B sbc r31,r25 |
445 0360 CF01 movw r24,r30 |
446 0362 0596 adiw r24,5 |
447 0364 0B97 sbiw r24,11 |
448 0366 B0F4 brsh .L52 |
449 0368 8091 0000 lds r24,okay_cnt.8 |
450 036c 8A31 cpi r24,lo8(26) |
451 036e 20F0 brlo .L53 |
452 0370 8091 0000 lds r24,SenderOkay |
453 0374 865F subi r24,lo8(-(10)) |
454 0376 05C0 rjmp .L88 |
455 .L53: |
456 0378 8B30 cpi r24,lo8(11) |
457 037a 28F0 brlo .L54 |
458 037c 8091 0000 lds r24,SenderOkay |
459 0380 8E5F subi r24,lo8(-(2)) |
460 .L88: |
461 0382 8093 0000 sts SenderOkay,r24 |
462 .L54: |
463 0386 8091 0000 lds r24,SenderOkay |
464 038a 893C cpi r24,lo8(-55) |
465 038c 18F0 brlo .L52 |
466 038e 88EC ldi r24,lo8(-56) |
467 0390 8093 0000 sts SenderOkay,r24 |
468 .L52: |
469 0394 E62F mov r30,r22 |
470 0396 FF27 clr r31 |
471 0398 EE0F add r30,r30 |
472 039a FF1F adc r31,r31 |
473 039c E050 subi r30,lo8(-(ppm_in.3)) |
474 039e F040 sbci r31,hi8(-(ppm_in.3)) |
475 03a0 8081 ld r24,Z |
476 03a2 9181 ldd r25,Z+1 |
477 03a4 9C01 movw r18,r24 |
478 03a6 220F lsl r18 |
479 03a8 331F rol r19 |
480 03aa 280F add r18,r24 |
481 03ac 391F adc r19,r25 |
482 03ae 240F add r18,r20 |
483 03b0 351F adc r19,r21 |
484 03b2 37FF sbrs r19,7 |
485 03b4 02C0 rjmp .L57 |
486 03b6 2D5F subi r18,lo8(-(3)) |
487 03b8 3F4F sbci r19,hi8(-(3)) |
488 .L57: |
489 03ba E901 movw r28,r18 |
490 03bc D595 asr r29 |
491 03be C795 ror r28 |
492 03c0 D595 asr r29 |
493 03c2 C795 ror r28 |
494 03c4 CA01 movw r24,r20 |
495 03c6 0196 adiw r24,1 |
496 03c8 8C17 cp r24,r28 |
497 03ca 9D07 cpc r25,r29 |
498 03cc 14F4 brge .L58 |
499 03ce 2197 sbiw r28,1 |
500 03d0 06C0 rjmp .L59 |
501 .L58: |
502 03d2 4150 subi r20,lo8(-(-1)) |
503 03d4 5040 sbci r21,hi8(-(-1)) |
504 03d6 C417 cp r28,r20 |
505 03d8 D507 cpc r29,r21 |
506 03da 0CF4 brge .L59 |
507 03dc 2196 adiw r28,1 |
508 .L59: |
509 03de 8091 0000 lds r24,SenderOkay |
510 03e2 8E3B cpi r24,lo8(-66) |
511 03e4 D8F0 brlo .L61 |
512 03e6 E62F mov r30,r22 |
513 03e8 FF27 clr r31 |
514 03ea EE0F add r30,r30 |
515 03ec FF1F adc r31,r31 |
516 03ee DF01 movw r26,r30 |
517 03f0 A050 subi r26,lo8(-(ppm_in.3)) |
518 03f2 B040 sbci r27,hi8(-(ppm_in.3)) |
519 03f4 8D91 ld r24,X+ |
520 03f6 9C91 ld r25,X |
521 03f8 9E01 movw r18,r28 |
522 03fa 281B sub r18,r24 |
523 03fc 390B sbc r19,r25 |
524 03fe C901 movw r24,r18 |
525 0400 63E0 ldi r22,lo8(3) |
526 0402 70E0 ldi r23,hi8(3) |
527 0404 0E94 0000 call __divmodhi4 |
528 0408 CB01 movw r24,r22 |
529 040a 880F lsl r24 |
530 040c 991F rol r25 |
531 040e 860F add r24,r22 |
532 0410 971F adc r25,r23 |
533 0412 E050 subi r30,lo8(-(ppm_diff.4)) |
534 0414 F040 sbci r31,hi8(-(ppm_diff.4)) |
535 0416 9183 std Z+1,r25 |
536 0418 8083 st Z,r24 |
537 041a 08C0 rjmp .L62 |
538 .L61: |
539 041c E62F mov r30,r22 |
540 041e FF27 clr r31 |
541 0420 EE0F add r30,r30 |
542 0422 FF1F adc r31,r31 |
543 0424 E050 subi r30,lo8(-(ppm_diff.4)) |
544 0426 F040 sbci r31,hi8(-(ppm_diff.4)) |
545 0428 1182 std Z+1,__zero_reg__ |
546 042a 1082 st Z,__zero_reg__ |
547 .L62: |
548 042c 8091 0000 lds r24,index.7 |
549 0430 E82F mov r30,r24 |
550 0432 FF27 clr r31 |
551 0434 EE0F add r30,r30 |
552 0436 FF1F adc r31,r31 |
553 0438 E050 subi r30,lo8(-(ppm_in.3)) |
554 043a F040 sbci r31,hi8(-(ppm_in.3)) |
555 043c D183 std Z+1,r29 |
556 043e C083 st Z,r28 |
557 0440 09C0 rjmp .L63 |
558 .L51: |
559 0442 8091 0000 lds r24,PlatinenVersion |
560 0446 8A30 cpi r24,lo8(10) |
561 0448 11F0 breq .L65 |
562 044a 8431 cpi r24,lo8(20) |
563 044c 10F0 brlo .L64 |
564 .L65: |
565 044e 289A sbi 37-0x20,0 |
566 0450 01C0 rjmp .L63 |
567 .L64: |
568 0452 2898 cbi 37-0x20,0 |
569 .L63: |
570 0454 8091 0000 lds r24,PlatinenVersion |
571 0458 8431 cpi r24,lo8(20) |
572 045a 88F4 brsh .L50 |
573 045c 8091 0000 lds r24,index.7 |
574 0460 8530 cpi r24,lo8(5) |
575 0462 11F4 brne .L68 |
576 0464 5D9A sbi 43-0x20,5 |
577 0466 05C0 rjmp .L70 |
578 .L68: |
579 0468 5D98 cbi 43-0x20,5 |
580 046a 8630 cpi r24,lo8(6) |
581 046c 11F4 brne .L70 |
582 046e 5C9A sbi 43-0x20,4 |
583 0470 05C0 rjmp .L72 |
584 .L70: |
585 0472 5C98 cbi 43-0x20,4 |
586 0474 8730 cpi r24,lo8(7) |
587 0476 11F4 brne .L72 |
588 0478 5B9A sbi 43-0x20,3 |
589 047a 01C0 rjmp .L50 |
590 .L72: |
591 047c 5B98 cbi 43-0x20,3 |
592 .L50: |
593 047e 8091 0000 lds r24,index.7 |
594 0482 8431 cpi r24,lo8(20) |
595 0484 20F4 brsh .L74 |
596 0486 8F5F subi r24,lo8(-(1)) |
597 0488 8093 0000 sts index.7,r24 |
598 048c 20C0 rjmp .L8 |
599 .L74: |
600 048e 8431 cpi r24,lo8(20) |
601 0490 F1F4 brne .L8 |
602 0492 8091 0000 lds r24,PlatinenVersion |
603 0496 8A30 cpi r24,lo8(10) |
604 0498 11F0 breq .L78 |
605 049a 8431 cpi r24,lo8(20) |
606 049c 10F0 brlo .L77 |
607 .L78: |
608 049e 289A sbi 37-0x20,0 |
609 04a0 01C0 rjmp .L79 |
610 .L77: |
611 04a2 2898 cbi 37-0x20,0 |
612 .L79: |
613 04a4 8EE1 ldi r24,lo8(30) |
614 04a6 8093 0000 sts index.7,r24 |
615 04aa 2CE0 ldi r18,lo8(12) |
616 04ac C0E0 ldi r28,lo8(PPM_diff) |
617 04ae D0E0 ldi r29,hi8(PPM_diff) |
618 04b0 A0E0 ldi r26,lo8(old_ppm_in.5) |
619 04b2 B0E0 ldi r27,hi8(old_ppm_in.5) |
620 04b4 E0E0 ldi r30,lo8(PPM_in) |
621 04b6 F0E0 ldi r31,hi8(PPM_in) |
622 .L83: |
623 04b8 8D91 ld r24,X+ |
624 04ba 9D91 ld r25,X+ |
625 04bc 9183 std Z+1,r25 |
626 04be 8083 st Z,r24 |
627 04c0 3296 adiw r30,2 |
628 04c2 1982 std Y+1,__zero_reg__ |
629 04c4 1882 st Y,__zero_reg__ |
630 04c6 2296 adiw r28,2 |
631 04c8 2150 subi r18,lo8(-(-1)) |
632 04ca 27FF sbrs r18,7 |
633 04cc F5CF rjmp .L83 |
634 .L8: |
635 /* epilogue: frame size=0 */ |
636 04ce FF91 pop r31 |
637 04d0 EF91 pop r30 |
638 04d2 DF91 pop r29 |
639 04d4 CF91 pop r28 |
640 04d6 BF91 pop r27 |
641 04d8 AF91 pop r26 |
642 04da 9F91 pop r25 |
643 04dc 8F91 pop r24 |
644 04de 7F91 pop r23 |
645 04e0 6F91 pop r22 |
646 04e2 5F91 pop r21 |
647 04e4 4F91 pop r20 |
648 04e6 3F91 pop r19 |
649 04e8 2F91 pop r18 |
650 04ea 1F91 pop r17 |
651 04ec 0F91 pop r16 |
652 04ee 0F90 pop __tmp_reg__ |
653 04f0 0FBE out __SREG__,__tmp_reg__ |
654 04f2 0F90 pop __tmp_reg__ |
655 04f4 1F90 pop __zero_reg__ |
656 04f6 1895 reti |
657 /* epilogue end (size=21) */ |
658 /* function __vector_12 size 615 (573) */ |
660 .comm PPM_in,52,1 |
661 .comm PPM_diff,52,1 |
662 .comm Channels,1,1 |
663 /* File "rc.c": code 643 = 0x0283 ( 600), prologues 21, epilogues 22 */ |
DEFINED SYMBOLS |
*ABS*:00000000 rc.c |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccRlEfUb.s:2 *ABS*:0000003f __SREG__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccRlEfUb.s:3 *ABS*:0000003e __SP_H__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccRlEfUb.s:4 *ABS*:0000003d __SP_L__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccRlEfUb.s:5 *ABS*:00000034 __CCP__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccRlEfUb.s:6 *ABS*:00000000 __tmp_reg__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccRlEfUb.s:7 *ABS*:00000001 __zero_reg__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccRlEfUb.s:11 .text:00000000 rc_sum_init |
C:\Users\Arthur-P\AppData\Local\Temp/cc21baaa.s:3 *ABS*:0000003f __SREG__ |
C:\Users\Arthur-P\AppData\Local\Temp/cc21baaa.s:4 *ABS*:0000003e __SP_H__ |
C:\Users\Arthur-P\AppData\Local\Temp/cc21baaa.s:5 *ABS*:0000003d __SP_L__ |
C:\Users\Arthur-P\AppData\Local\Temp/cc21baaa.s:6 *ABS*:00000000 __tmp_reg__ |
C:\Users\Arthur-P\AppData\Local\Temp/cc21baaa.s:7 *ABS*:00000001 __zero_reg__ |
C:\Users\Arthur-P\AppData\Local\Temp/cc21baaa.s:14 .data:00000000 NewPpmData |
C:\Users\Arthur-P\AppData\Local\Temp/cc21baaa.s:21 .bss:00000000 tmpChannels |
C:\Users\Arthur-P\AppData\Local\Temp/cc21baaa.s:26 .text:00000000 rc_sum_init |
*COM*:00000034 PPM_diff |
*COM*:00000034 PPM_in |
*COM*:00000034 PPM_diff |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccRlEfUb.s:45 .text:00000040 __vector_12 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccRlEfUb.s:616 .bss:0000006f AltICR.2229 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccRlEfUb.s:615 .bss:0000006d index.2232 |
.bss:00000001 AltICR.0 |
C:\Users\Arthur-P\AppData\Local\Temp/cc21baaa.s:56 .bss:00000003 index.1 |
C:\Users\Arthur-P\AppData\Local\Temp/cc21baaa.s:57 .bss:00000005 AltICR.2 |
C:\Users\Arthur-P\AppData\Local\Temp/cc21baaa.s:58 .bss:00000007 ppm_in.3 |
C:\Users\Arthur-P\AppData\Local\Temp/cc21baaa.s:59 .bss:00000021 ppm_diff.4 |
C:\Users\Arthur-P\AppData\Local\Temp/cc21baaa.s:60 .bss:0000003b old_ppm_in.5 |
C:\Users\Arthur-P\AppData\Local\Temp/cc21baaa.s:61 .bss:00000055 old_ppm_diff.6 |
C:\Users\Arthur-P\AppData\Local\Temp/cc21baaa.s:62 .bss:0000006f index.7 |
C:\Users\Arthur-P\AppData\Local\Temp/cc21baaa.s:63 .bss:00000070 okay_cnt.8 |
C:\Users\Arthur-P\AppData\Local\Temp/cc21baaa.s:67 .text:00000038 __vector_12 |
*COM*:00000001 Channels |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccRlEfUb.s:607 .data:00000000 NewPpmData |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccRlEfUb.s:614 .bss:0000006b AltICR.2233 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccRlEfUb.s:609 .bss:00000002 index.2240 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccRlEfUb.s:601 .bss:00000000 tmpChannels |
.bss:00000001 okay_cnt.2241 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccRlEfUb.s:611 .bss:0000001d old_ppm_in.2236 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccRlEfUb.s:610 .bss:00000003 old_ppm_diff.2237 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccRlEfUb.s:613 .bss:00000051 ppm_in.2234 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccRlEfUb.s:612 .bss:00000037 ppm_diff.2235 |
UNDEFINED SYMBOLS |
__do_copy_data |
__do_clear_bss |
AdNeutralGier |
AdNeutralRoll |
AdNeutralNick |
646,5 → 688,3 |
__divmodhi4 |
PlatinenVersion |
MotorenEin |
__do_copy_data |
__do_clear_bss |
/branches/V0.80g-Arthur-P1/spi.lst |
---|
1,961 → 1,951 |
1 .file "spi.c" |
2 __SREG__ = 0x3f |
3 __SP_H__ = 0x3e |
4 __SP_L__ = 0x3d |
5 __CCP__ = 0x34 |
2 .arch atmega644p |
3 __SREG__ = 0x3f |
4 __SP_H__ = 0x3e |
5 __SP_L__ = 0x3d |
6 __tmp_reg__ = 0 |
7 __zero_reg__ = 1 |
8 .text |
9 .global SPI_MasterInit |
11 SPI_MasterInit: |
12 /* prologue: function */ |
13 /* frame size = 0 */ |
14 0000 84B1 in r24,36-32 |
15 0002 806A ori r24,lo8(-96) |
16 0004 84B9 out 36-32,r24 |
17 0006 3D9A sbi 39-32,5 |
18 0008 82E5 ldi r24,lo8(82) |
19 000a 8CBD out 76-32,r24 |
20 000c 1DBC out 77-32,__zero_reg__ |
21 000e 459A sbi 40-32,5 |
22 0010 81E0 ldi r24,lo8(1) |
23 0012 8093 0000 sts SPITransferCompleted,r24 |
24 0016 8AEA ldi r24,lo8(-86) |
25 0018 8093 0000 sts ToNaviCtrl,r24 |
26 001c 83E8 ldi r24,lo8(-125) |
27 001e 8093 0000 sts ToNaviCtrl+1,r24 |
28 0022 8AE0 ldi r24,lo8(10) |
29 0024 8093 0000 sts ToNaviCtrl+2,r24 |
30 0028 1092 0000 sts (ToNaviCtrl+3)+1,__zero_reg__ |
31 002c 1092 0000 sts ToNaviCtrl+3,__zero_reg__ |
32 0030 1092 0000 sts (ToNaviCtrl+5)+1,__zero_reg__ |
33 0034 1092 0000 sts ToNaviCtrl+5,__zero_reg__ |
34 0038 1092 0000 sts FromNaviCtrl_Value+3,__zero_reg__ |
35 003c 1092 0000 sts SPI_RxDataValid,__zero_reg__ |
36 /* epilogue start */ |
37 0040 0895 ret |
39 .global UpdateSPI_Buffer |
41 UpdateSPI_Buffer: |
42 0042 EF92 push r14 |
43 0044 FF92 push r15 |
44 0046 0F93 push r16 |
45 0048 1F93 push r17 |
46 /* prologue: function */ |
47 /* frame size = 0 */ |
48 004a E090 0000 lds r14,EE_Parameter+28 |
49 004e FF24 clr r15 |
50 0050 EE0C lsl r14 |
51 0052 FF1C rol r15 |
52 0054 EE0C lsl r14 |
53 0056 FF1C rol r15 |
54 0058 0027 clr r16 |
55 005a F7FC sbrc r15,7 |
56 005c 0095 com r16 |
57 005e 102F mov r17,r16 |
58 0060 6091 0000 lds r22,IntegralNick |
59 0064 7091 0000 lds r23,(IntegralNick)+1 |
60 0068 8091 0000 lds r24,(IntegralNick)+2 |
61 006c 9091 0000 lds r25,(IntegralNick)+3 |
62 0070 A801 movw r20,r16 |
63 0072 9701 movw r18,r14 |
64 0074 0E94 0000 call __divmodsi4 |
65 0078 3093 0000 sts (ToNaviCtrl+3)+1,r19 |
66 007c 2093 0000 sts ToNaviCtrl+3,r18 |
67 0080 6091 0000 lds r22,IntegralRoll |
68 0084 7091 0000 lds r23,(IntegralRoll)+1 |
69 0088 8091 0000 lds r24,(IntegralRoll)+2 |
70 008c 9091 0000 lds r25,(IntegralRoll)+3 |
71 0090 A801 movw r20,r16 |
72 0092 9701 movw r18,r14 |
73 0094 0E94 0000 call __divmodsi4 |
74 0098 3093 0000 sts (ToNaviCtrl+5)+1,r19 |
75 009c 2093 0000 sts ToNaviCtrl+5,r18 |
76 00a0 6091 0000 lds r22,ErsatzKompass |
77 00a4 7091 0000 lds r23,(ErsatzKompass)+1 |
78 00a8 8091 0000 lds r24,(ErsatzKompass)+2 |
79 00ac 9091 0000 lds r25,(ErsatzKompass)+3 |
80 00b0 2AE0 ldi r18,lo8(10) |
81 00b2 30E0 ldi r19,hi8(10) |
82 00b4 40E0 ldi r20,hlo8(10) |
83 00b6 50E0 ldi r21,hhi8(10) |
84 00b8 0E94 0000 call __mulsi3 |
85 00bc 2091 0000 lds r18,GIER_GRAD_FAKTOR |
86 00c0 3091 0000 lds r19,(GIER_GRAD_FAKTOR)+1 |
87 00c4 4091 0000 lds r20,(GIER_GRAD_FAKTOR)+2 |
88 00c8 5091 0000 lds r21,(GIER_GRAD_FAKTOR)+3 |
89 00cc 0E94 0000 call __divmodsi4 |
90 00d0 3093 0000 sts (ToNaviCtrl+11)+1,r19 |
91 00d4 2093 0000 sts ToNaviCtrl+11,r18 |
92 00d8 2091 0000 lds r18,AdWertGier |
93 00dc 3091 0000 lds r19,(AdWertGier)+1 |
94 00e0 8091 0000 lds r24,AdNeutralGier |
95 00e4 9091 0000 lds r25,(AdNeutralGier)+1 |
96 00e8 821B sub r24,r18 |
97 00ea 930B sbc r25,r19 |
98 00ec 9093 0000 sts (ToNaviCtrl+17)+1,r25 |
99 00f0 8093 0000 sts ToNaviCtrl+17,r24 |
100 00f4 2091 0000 lds r18,NaviCntAcc |
101 00f8 3091 0000 lds r19,(NaviCntAcc)+1 |
102 00fc 8091 0000 lds r24,NaviAccNick |
103 0100 9091 0000 lds r25,(NaviAccNick)+1 |
104 0104 B901 movw r22,r18 |
105 0106 0E94 0000 call __divmodhi4 |
106 010a CB01 movw r24,r22 |
107 010c 880F lsl r24 |
108 010e 991F rol r25 |
109 0110 860F add r24,r22 |
110 0112 971F adc r25,r23 |
111 0114 880F lsl r24 |
112 0116 991F rol r25 |
113 0118 64E0 ldi r22,lo8(4) |
114 011a 70E0 ldi r23,hi8(4) |
115 011c 0E94 0000 call __divmodhi4 |
116 0120 7093 0000 sts (ToNaviCtrl+7)+1,r23 |
117 0124 6093 0000 sts ToNaviCtrl+7,r22 |
118 0128 8091 0000 lds r24,NaviAccRoll |
119 012c 9091 0000 lds r25,(NaviAccRoll)+1 |
120 0130 B901 movw r22,r18 |
121 0132 0E94 0000 call __divmodhi4 |
122 0136 CB01 movw r24,r22 |
123 0138 880F lsl r24 |
124 013a 991F rol r25 |
125 013c 860F add r24,r22 |
126 013e 971F adc r25,r23 |
127 0140 880F lsl r24 |
128 0142 991F rol r25 |
129 0144 64E0 ldi r22,lo8(4) |
130 0146 70E0 ldi r23,hi8(4) |
131 0148 0E94 0000 call __divmodhi4 |
132 014c 7093 0000 sts (ToNaviCtrl+9)+1,r23 |
133 0150 6093 0000 sts ToNaviCtrl+9,r22 |
134 0154 1092 0000 sts (NaviCntAcc)+1,__zero_reg__ |
135 0158 1092 0000 sts NaviCntAcc,__zero_reg__ |
136 015c 1092 0000 sts (NaviAccNick)+1,__zero_reg__ |
137 0160 1092 0000 sts NaviAccNick,__zero_reg__ |
138 0164 1092 0000 sts (NaviAccRoll)+1,__zero_reg__ |
139 0168 1092 0000 sts NaviAccRoll,__zero_reg__ |
140 016c 8091 0000 lds r24,ToNaviCtrl+2 |
141 0170 8D30 cpi r24,lo8(13) |
142 0172 01F4 brne .+2 |
143 0174 00C0 rjmp .L8 |
144 0176 8E30 cpi r24,lo8(14) |
145 0178 00F4 brsh .L12 |
146 017a 8B30 cpi r24,lo8(11) |
147 017c 01F4 brne .+2 |
148 017e 00C0 rjmp .L6 |
149 0180 8C30 cpi r24,lo8(12) |
150 0182 00F0 brlo .+2 |
151 0184 00C0 rjmp .L7 |
152 0186 8A30 cpi r24,lo8(10) |
153 0188 01F0 breq .+2 |
154 018a 00C0 rjmp .L4 |
155 018c 00C0 rjmp .L33 |
156 .L12: |
157 018e 8F30 cpi r24,lo8(15) |
158 0190 01F4 brne .+2 |
159 0192 00C0 rjmp .L10 |
160 0194 8F30 cpi r24,lo8(15) |
161 0196 00F4 brsh .+2 |
162 0198 00C0 rjmp .L9 |
163 019a 8031 cpi r24,lo8(16) |
164 019c 01F0 breq .+2 |
165 019e 00C0 rjmp .L4 |
166 01a0 00C0 rjmp .L34 |
167 .L33: |
168 01a2 8091 0000 lds r24,Parameter_UserParam1 |
169 01a6 8093 0000 sts ToNaviCtrl+19,r24 |
170 01aa 8091 0000 lds r24,Parameter_UserParam2 |
171 01ae 8093 0000 sts ToNaviCtrl+20,r24 |
172 01b2 8091 0000 lds r24,Parameter_UserParam3 |
173 01b6 8093 0000 sts ToNaviCtrl+21,r24 |
174 01ba 8091 0000 lds r24,Parameter_UserParam4 |
175 01be 8093 0000 sts ToNaviCtrl+22,r24 |
176 01c2 8091 0000 lds r24,Parameter_UserParam5 |
177 01c6 8093 0000 sts ToNaviCtrl+23,r24 |
178 01ca 8091 0000 lds r24,Parameter_UserParam6 |
179 01ce 8093 0000 sts ToNaviCtrl+24,r24 |
180 01d2 8091 0000 lds r24,Parameter_UserParam7 |
181 01d6 8093 0000 sts ToNaviCtrl+25,r24 |
182 01da 8091 0000 lds r24,Parameter_UserParam8 |
183 01de 8093 0000 sts ToNaviCtrl+26,r24 |
184 01e2 8091 0000 lds r24,FCFlags |
185 01e6 8093 0000 sts ToNaviCtrl+27,r24 |
186 01ea 8091 0000 lds r24,FCFlags |
187 01ee 837F andi r24,lo8(-13) |
188 01f0 8093 0000 sts FCFlags,r24 |
189 01f4 0E94 0000 call GetActiveParamSet |
190 01f8 8093 0000 sts ToNaviCtrl+28,r24 |
191 01fc 8091 0000 lds r24,ControlHeading |
192 0200 8093 0000 sts ToNaviCtrl+29,r24 |
193 0204 00C0 rjmp .L4 |
194 .L34: |
195 0206 8091 0000 lds r24,Capacity |
196 020a 9091 0000 lds r25,(Capacity)+1 |
197 020e 9093 0000 sts (ToNaviCtrl+19)+1,r25 |
198 0212 8093 0000 sts ToNaviCtrl+19,r24 |
199 0216 8091 0000 lds r24,Capacity+4 |
200 021a 9091 0000 lds r25,(Capacity+4)+1 |
201 021e 9093 0000 sts (ToNaviCtrl+21)+1,r25 |
202 0222 8093 0000 sts ToNaviCtrl+21,r24 |
203 0226 8091 0000 lds r24,UBat |
204 022a 9091 0000 lds r25,(UBat)+1 |
205 022e 8093 0000 sts ToNaviCtrl+23,r24 |
206 0232 8091 0000 lds r24,BattLowVoltageWarning |
207 0236 8093 0000 sts ToNaviCtrl+24,r24 |
208 023a 00C0 rjmp .L4 |
209 .L8: |
210 023c 8091 0000 lds r24,EE_Parameter+78 |
211 0240 8093 0000 sts ToNaviCtrl+19,r24 |
212 0244 8091 0000 lds r24,EE_Parameter+79 |
213 0248 8093 0000 sts ToNaviCtrl+20,r24 |
214 024c 8091 0000 lds r24,EE_Parameter+80 |
215 0250 8093 0000 sts ToNaviCtrl+21,r24 |
216 0254 8091 0000 lds r24,EE_Parameter+81 |
217 0258 8093 0000 sts ToNaviCtrl+22,r24 |
218 025c 8091 0000 lds r24,EE_Parameter+82 |
219 0260 8093 0000 sts ToNaviCtrl+23,r24 |
220 0264 8091 0000 lds r24,EE_Parameter+86 |
221 0268 8093 0000 sts ToNaviCtrl+24,r24 |
222 026c 8091 0000 lds r24,EE_Parameter+87 |
223 0270 8093 0000 sts ToNaviCtrl+25,r24 |
224 0274 8091 0000 lds r24,EE_Parameter+88 |
225 0278 8093 0000 sts ToNaviCtrl+26,r24 |
226 027c 8091 0000 lds r24,EE_Parameter+91 |
227 0280 8093 0000 sts ToNaviCtrl+27,r24 |
228 0284 8091 0000 lds r24,EE_Parameter+89 |
229 0288 8093 0000 sts ToNaviCtrl+28,r24 |
230 028c 8091 0000 lds r24,EE_Parameter+90 |
231 0290 8093 0000 sts ToNaviCtrl+29,r24 |
232 0294 8091 0000 lds r24,EE_Parameter+92 |
233 0298 00C0 rjmp .L32 |
234 .L6: |
235 /* #APP */ |
236 ; 209 "spi.c" 1 |
237 029a F894 cli |
238 ; 0 "" 2 |
239 /* #NOAPP */ |
240 029c E091 0000 lds r30,EE_Parameter+3 |
241 02a0 F0E0 ldi r31,lo8(0) |
242 02a2 EE0F lsl r30 |
243 02a4 FF1F rol r31 |
244 02a6 E050 subi r30,lo8(-(PPM_in)) |
245 02a8 F040 sbci r31,hi8(-(PPM_in)) |
246 02aa 0190 ld __tmp_reg__,Z+ |
247 02ac F081 ld r31,Z |
248 02ae E02D mov r30,__tmp_reg__ |
249 02b0 2FEF ldi r18,hi8(-127) |
250 02b2 E138 cpi r30,lo8(-127) |
251 02b4 F207 cpc r31,r18 |
252 02b6 04F4 brge .L13 |
253 02b8 E1E8 ldi r30,lo8(-127) |
254 02ba FFEF ldi r31,hi8(-127) |
255 .L13: |
256 02bc E038 cpi r30,128 |
257 02be F105 cpc r31,__zero_reg__ |
258 02c0 04F0 brlt .L14 |
259 02c2 EFE7 ldi r30,lo8(127) |
260 02c4 F0E0 ldi r31,hi8(127) |
261 .L14: |
262 02c6 E093 0000 sts ToNaviCtrl+19,r30 |
263 02ca E091 0000 lds r30,EE_Parameter+4 |
264 02ce F0E0 ldi r31,lo8(0) |
265 02d0 EE0F lsl r30 |
266 02d2 FF1F rol r31 |
267 02d4 E050 subi r30,lo8(-(PPM_in)) |
268 02d6 F040 sbci r31,hi8(-(PPM_in)) |
269 02d8 0190 ld __tmp_reg__,Z+ |
270 02da F081 ld r31,Z |
271 02dc E02D mov r30,__tmp_reg__ |
272 02de 6FEF ldi r22,hi8(-127) |
273 02e0 E138 cpi r30,lo8(-127) |
274 02e2 F607 cpc r31,r22 |
275 02e4 04F4 brge .L15 |
276 02e6 E1E8 ldi r30,lo8(-127) |
277 02e8 FFEF ldi r31,hi8(-127) |
278 .L15: |
279 02ea E038 cpi r30,128 |
280 02ec F105 cpc r31,__zero_reg__ |
281 02ee 04F0 brlt .L16 |
282 02f0 EFE7 ldi r30,lo8(127) |
283 02f2 F0E0 ldi r31,hi8(127) |
284 .L16: |
285 02f4 E093 0000 sts ToNaviCtrl+20,r30 |
286 02f8 E091 0000 lds r30,EE_Parameter+2 |
287 02fc F0E0 ldi r31,lo8(0) |
288 02fe EE0F lsl r30 |
289 0300 FF1F rol r31 |
290 0302 E050 subi r30,lo8(-(PPM_in)) |
291 0304 F040 sbci r31,hi8(-(PPM_in)) |
292 0306 0190 ld __tmp_reg__,Z+ |
293 0308 F081 ld r31,Z |
294 030a E02D mov r30,__tmp_reg__ |
295 030c 8FEF ldi r24,hi8(-127) |
296 030e E138 cpi r30,lo8(-127) |
297 0310 F807 cpc r31,r24 |
298 0312 04F4 brge .L17 |
299 0314 E1E8 ldi r30,lo8(-127) |
300 0316 FFEF ldi r31,hi8(-127) |
301 .L17: |
302 0318 E038 cpi r30,128 |
303 031a F105 cpc r31,__zero_reg__ |
304 031c 04F0 brlt .L18 |
305 031e EFE7 ldi r30,lo8(127) |
306 0320 F0E0 ldi r31,hi8(127) |
307 .L18: |
308 0322 E093 0000 sts ToNaviCtrl+21,r30 |
309 0326 E091 0000 lds r30,EE_Parameter+1 |
310 032a F0E0 ldi r31,lo8(0) |
311 032c EE0F lsl r30 |
312 032e FF1F rol r31 |
313 0330 E050 subi r30,lo8(-(PPM_in)) |
314 0332 F040 sbci r31,hi8(-(PPM_in)) |
315 0334 0190 ld __tmp_reg__,Z+ |
316 0336 F081 ld r31,Z |
317 0338 E02D mov r30,__tmp_reg__ |
318 033a 2FEF ldi r18,hi8(-127) |
319 033c E138 cpi r30,lo8(-127) |
320 033e F207 cpc r31,r18 |
321 0340 04F4 brge .L19 |
322 0342 E1E8 ldi r30,lo8(-127) |
323 0344 FFEF ldi r31,hi8(-127) |
324 .L19: |
325 /* #APP */ |
326 ; 217 "spi.c" 1 |
327 0346 7894 sei |
328 ; 0 "" 2 |
329 /* #NOAPP */ |
330 0348 E038 cpi r30,128 |
331 034a F105 cpc r31,__zero_reg__ |
332 034c 04F0 brlt .L20 |
333 034e EFE7 ldi r30,lo8(127) |
334 0350 F0E0 ldi r31,hi8(127) |
335 .L20: |
336 0352 E093 0000 sts ToNaviCtrl+22,r30 |
337 0356 8091 0000 lds r24,Poti |
338 035a 8093 0000 sts ToNaviCtrl+23,r24 |
339 035e 8091 0000 lds r24,Poti+1 |
340 0362 8093 0000 sts ToNaviCtrl+24,r24 |
341 0366 8091 0000 lds r24,Poti+2 |
342 036a 8093 0000 sts ToNaviCtrl+25,r24 |
343 036e 8091 0000 lds r24,Poti+3 |
344 0372 8093 0000 sts ToNaviCtrl+26,r24 |
345 0376 8091 0000 lds r24,Poti+4 |
346 037a 8093 0000 sts ToNaviCtrl+27,r24 |
347 037e 8091 0000 lds r24,Poti+5 |
348 0382 8093 0000 sts ToNaviCtrl+28,r24 |
349 0386 8091 0000 lds r24,Poti+6 |
350 038a 8093 0000 sts ToNaviCtrl+29,r24 |
351 038e 8091 0000 lds r24,Poti+7 |
352 .L32: |
353 0392 8093 0000 sts ToNaviCtrl+30,r24 |
354 0396 00C0 rjmp .L4 |
355 .L7: |
356 0398 8091 0000 lds r24,WinkelOut+6 |
357 039c 8630 cpi r24,lo8(6) |
358 039e 00F0 brlo .L21 |
359 03a0 1092 0000 sts WinkelOut+6,__zero_reg__ |
360 03a4 85E0 ldi r24,lo8(5) |
361 .L21: |
362 03a6 8093 0000 sts ToNaviCtrl+19,r24 |
363 03aa 8091 0000 lds r24,EE_Parameter+93 |
364 03ae 8093 0000 sts ToNaviCtrl+20,r24 |
365 03b2 6091 0000 lds r22,HoehenWert |
366 03b6 7091 0000 lds r23,(HoehenWert)+1 |
367 03ba 8091 0000 lds r24,(HoehenWert)+2 |
368 03be 9091 0000 lds r25,(HoehenWert)+3 |
369 03c2 25E0 ldi r18,lo8(5) |
370 03c4 30E0 ldi r19,hi8(5) |
371 03c6 40E0 ldi r20,hlo8(5) |
372 03c8 50E0 ldi r21,hhi8(5) |
373 03ca 0E94 0000 call __divmodsi4 |
374 03ce 3093 0000 sts (ToNaviCtrl+21)+1,r19 |
375 03d2 2093 0000 sts ToNaviCtrl+21,r18 |
376 03d6 6091 0000 lds r22,SollHoehe |
377 03da 7091 0000 lds r23,(SollHoehe)+1 |
378 03de 8091 0000 lds r24,(SollHoehe)+2 |
379 03e2 9091 0000 lds r25,(SollHoehe)+3 |
380 03e6 25E0 ldi r18,lo8(5) |
381 03e8 30E0 ldi r19,hi8(5) |
382 03ea 40E0 ldi r20,hlo8(5) |
383 03ec 50E0 ldi r21,hhi8(5) |
384 03ee 0E94 0000 call __divmodsi4 |
385 03f2 3093 0000 sts (ToNaviCtrl+23)+1,r19 |
386 03f6 2093 0000 sts ToNaviCtrl+23,r18 |
387 03fa 8091 0000 lds r24,EE_Parameter+83 |
388 03fe 8093 0000 sts ToNaviCtrl+25,r24 |
389 0402 8091 0000 lds r24,EE_Parameter+84 |
390 0406 8093 0000 sts ToNaviCtrl+26,r24 |
391 040a 8091 0000 lds r24,EE_Parameter+85 |
392 040e 8093 0000 sts ToNaviCtrl+27,r24 |
393 0412 8091 0000 lds r24,SenderOkay |
394 0416 8093 0000 sts ToNaviCtrl+28,r24 |
395 041a 8091 0000 lds r24,PPM_in |
396 041e 9091 0000 lds r25,(PPM_in)+1 |
397 0422 8093 0000 sts ToNaviCtrl+29,r24 |
398 0426 8091 0000 lds r24,DebugOut+16 |
399 042a 9091 0000 lds r25,(DebugOut+16)+1 |
400 042e 64E0 ldi r22,lo8(4) |
401 0430 70E0 ldi r23,hi8(4) |
402 0432 0E94 0000 call __divmodhi4 |
403 0436 6093 0000 sts ToNaviCtrl+30,r22 |
404 043a 00C0 rjmp .L4 |
405 .L9: |
406 043c 1092 0000 sts ToNaviCtrl+19,__zero_reg__ |
407 0440 80E5 ldi r24,lo8(80) |
408 0442 8093 0000 sts ToNaviCtrl+20,r24 |
409 0446 86E0 ldi r24,lo8(6) |
410 0448 8093 0000 sts ToNaviCtrl+21,r24 |
411 044c 8EE0 ldi r24,lo8(14) |
412 044e 8093 0000 sts ToNaviCtrl+22,r24 |
413 0452 8091 0000 lds r24,PlatinenVersion |
414 0456 8093 0000 sts ToNaviCtrl+23,r24 |
415 045a 8091 0000 lds r24,VersionInfo+5 |
416 045e 8093 0000 sts ToNaviCtrl+24,r24 |
417 0462 8091 0000 lds r24,VersionInfo+6 |
418 0466 8093 0000 sts ToNaviCtrl+25,r24 |
419 046a 8091 0000 lds r24,VersionInfo+7 |
420 046e 8093 0000 sts ToNaviCtrl+26,r24 |
421 0472 00C0 rjmp .L4 |
422 .L10: |
423 0474 8091 0000 lds r24,EE_Parameter+53 |
424 0478 8093 0000 sts ToNaviCtrl+19,r24 |
425 047c 8091 0000 lds r24,EE_Parameter+98 |
426 0480 8093 0000 sts ToNaviCtrl+20,r24 |
427 0484 8091 0000 lds r24,Parameter_ServoNickControl |
428 0488 8093 0000 sts ToNaviCtrl+21,r24 |
429 048c 8091 0000 lds r24,EE_Parameter+46 |
430 0490 8093 0000 sts ToNaviCtrl+22,r24 |
431 0494 8091 0000 lds r24,EE_Parameter+47 |
432 0498 8093 0000 sts ToNaviCtrl+23,r24 |
433 049c 8091 0000 lds r24,EE_Parameter+48 |
434 04a0 8093 0000 sts ToNaviCtrl+24,r24 |
435 04a4 8091 0000 lds r24,Parameter_ServoRollControl |
436 04a8 8093 0000 sts ToNaviCtrl+25,r24 |
437 04ac 8091 0000 lds r24,EE_Parameter+50 |
438 04b0 8093 0000 sts ToNaviCtrl+26,r24 |
439 04b4 8091 0000 lds r24,EE_Parameter+51 |
440 04b8 8093 0000 sts ToNaviCtrl+27,r24 |
441 04bc 8091 0000 lds r24,EE_Parameter+52 |
442 04c0 8093 0000 sts ToNaviCtrl+28,r24 |
443 .L4: |
444 04c4 8091 0000 lds r24,SPI_RxDataValid |
445 04c8 8823 tst r24 |
446 04ca 01F4 brne .+2 |
447 04cc 00C0 rjmp .L23 |
448 04ce 8AEF ldi r24,lo8(-6) |
449 04d0 8093 0000 sts NaviDataOkay,r24 |
450 04d4 4091 0000 lds r20,FromNaviCtrl+1 |
451 04d8 5091 0000 lds r21,(FromNaviCtrl+1)+1 |
452 04dc CA01 movw r24,r20 |
453 04de 8150 subi r24,lo8(-(511)) |
454 04e0 9E4F sbci r25,hi8(-(511)) |
455 04e2 8F5F subi r24,lo8(1023) |
456 04e4 9340 sbci r25,hi8(1023) |
457 04e6 00F4 brsh .L24 |
458 04e8 2091 0000 lds r18,FromNaviCtrl+3 |
459 04ec 3091 0000 lds r19,(FromNaviCtrl+3)+1 |
460 04f0 C901 movw r24,r18 |
461 04f2 8150 subi r24,lo8(-(511)) |
462 04f4 9E4F sbci r25,hi8(-(511)) |
463 04f6 8F5F subi r24,lo8(1023) |
464 04f8 9340 sbci r25,hi8(1023) |
465 04fa 00F4 brsh .L24 |
466 04fc 8091 0000 lds r24,EE_Parameter+13 |
467 0500 85FF sbrs r24,5 |
468 0502 00C0 rjmp .L24 |
469 0504 5093 0000 sts (GPS_Nick)+1,r21 |
470 0508 4093 0000 sts GPS_Nick,r20 |
471 050c 3093 0000 sts (GPS_Roll)+1,r19 |
472 0510 2093 0000 sts GPS_Roll,r18 |
473 .L24: |
474 0514 8091 0000 lds r24,FromNaviCtrl+7 |
475 0518 9091 0000 lds r25,(FromNaviCtrl+7)+1 |
476 051c 21E0 ldi r18,hi8(361) |
477 051e 8936 cpi r24,lo8(361) |
478 0520 9207 cpc r25,r18 |
479 0522 04F4 brge .L25 |
480 0524 9093 0000 sts (KompassValue)+1,r25 |
481 0528 8093 0000 sts KompassValue,r24 |
482 .L25: |
483 052c 8091 0000 lds r24,KompassValue |
484 0530 9091 0000 lds r25,(KompassValue)+1 |
485 0534 845E subi r24,lo8(-(540)) |
486 0536 9D4F sbci r25,hi8(-(540)) |
487 0538 2091 0000 lds r18,KompassStartwert |
488 053c 3091 0000 lds r19,(KompassStartwert)+1 |
489 0540 821B sub r24,r18 |
490 0542 930B sbc r25,r19 |
491 0544 68E6 ldi r22,lo8(360) |
492 0546 71E0 ldi r23,hi8(360) |
493 0548 0E94 0000 call __divmodhi4 |
494 054c 845B subi r24,lo8(-(-180)) |
495 054e 9040 sbci r25,hi8(-(-180)) |
496 0550 9093 0000 sts (KompassRichtung)+1,r25 |
497 0554 8093 0000 sts KompassRichtung,r24 |
498 0558 2091 0000 lds r18,FromNaviCtrl+11 |
499 055c 3091 0000 lds r19,(FromNaviCtrl+11)+1 |
500 0560 8091 0000 lds r24,beeptime |
501 0564 9091 0000 lds r25,(beeptime)+1 |
502 0568 8217 cp r24,r18 |
503 056a 9307 cpc r25,r19 |
504 056c 00F4 brsh .L26 |
505 056e 8091 0000 lds r24,WinkelOut+6 |
506 0572 8823 tst r24 |
507 0574 01F4 brne .L26 |
508 0576 3093 0000 sts (beeptime)+1,r19 |
509 057a 2093 0000 sts beeptime,r18 |
510 .L26: |
511 057e 8091 0000 lds r24,FromNaviCtrl |
512 0582 8836 cpi r24,lo8(104) |
513 0584 01F0 breq .L29 |
514 0586 8936 cpi r24,lo8(105) |
515 0588 01F4 brne .+2 |
516 058a 00C0 rjmp .L30 |
517 058c 8736 cpi r24,lo8(103) |
518 058e 01F0 breq .+2 |
519 0590 00C0 rjmp .L31 |
520 0592 8091 0000 lds r24,FromNaviCtrl+13 |
521 0596 8093 0000 sts FromNaviCtrl_Value,r24 |
522 059a 8091 0000 lds r24,FromNaviCtrl+14 |
523 059e 8093 0000 sts FromNaviCtrl_Value+2,r24 |
524 05a2 8091 0000 lds r24,FromNaviCtrl+15 |
525 05a6 8093 0000 sts FromNaviCtrl_Value+1,r24 |
526 05aa 8091 0000 lds r24,FromNaviCtrl+16 |
527 05ae 8093 0000 sts FromNaviCtrl_Value+3,r24 |
528 05b2 8091 0000 lds r24,FromNaviCtrl+17 |
529 05b6 8093 0000 sts FromNaviCtrl_Value+4,r24 |
530 05ba 8091 0000 lds r24,FromNaviCtrl+18 |
531 05be 8093 0000 sts FromNC_Rotate_C,r24 |
532 05c2 8091 0000 lds r24,FromNaviCtrl+19 |
533 05c6 8093 0000 sts FromNC_Rotate_S,r24 |
534 05ca 00C0 rjmp .L31 |
535 .L29: |
536 05cc 8091 0000 lds r24,FromNaviCtrl+13 |
537 05d0 8093 0000 sts NC_Version,r24 |
538 05d4 8091 0000 lds r24,FromNaviCtrl+14 |
539 05d8 8093 0000 sts NC_Version+1,r24 |
540 05dc 8091 0000 lds r24,FromNaviCtrl+15 |
541 05e0 8093 0000 sts NC_Version+2,r24 |
542 05e4 8091 0000 lds r24,FromNaviCtrl+16 |
543 05e8 8093 0000 sts NC_Version+3,r24 |
544 05ec 8091 0000 lds r24,FromNaviCtrl+17 |
545 05f0 8093 0000 sts NC_Version+4,r24 |
546 05f4 8091 0000 lds r24,FromNaviCtrl+18 |
547 05f8 9091 0000 lds r25,DebugOut |
548 05fc 892B or r24,r25 |
549 05fe 8093 0000 sts DebugOut,r24 |
550 0602 9091 0000 lds r25,FromNaviCtrl+19 |
551 0606 9093 0000 sts NC_ErrorCode,r25 |
552 060a 9C70 andi r25,lo8(12) |
553 060c 8091 0000 lds r24,DebugOut+1 |
554 0610 8370 andi r24,lo8(3) |
555 0612 982B or r25,r24 |
556 0614 9093 0000 sts DebugOut+1,r25 |
557 0618 00C0 rjmp .L31 |
558 .L30: |
559 061a 8091 0000 lds r24,FromNaviCtrl+13 |
560 061e 8093 0000 sts GPSInfo,r24 |
561 0622 8091 0000 lds r24,FromNaviCtrl+14 |
562 0626 8093 0000 sts GPSInfo+1,r24 |
563 062a 8091 0000 lds r24,FromNaviCtrl+15 |
564 062e 8093 0000 sts GPSInfo+2,r24 |
565 0632 8091 0000 lds r24,FromNaviCtrl+16 |
566 0636 8093 0000 sts GPSInfo+3,r24 |
567 063a 8091 0000 lds r24,FromNaviCtrl+17 |
568 063e 9091 0000 lds r25,(FromNaviCtrl+17)+1 |
569 0642 9093 0000 sts (GPSInfo+4)+1,r25 |
570 0646 8093 0000 sts GPSInfo+4,r24 |
571 064a 8091 0000 lds r24,FromNaviCtrl+19 |
572 064e 9091 0000 lds r25,(FromNaviCtrl+19)+1 |
573 0652 9093 0000 sts (GPSInfo+6)+1,r25 |
574 0656 8093 0000 sts GPSInfo+6,r24 |
575 065a 00C0 rjmp .L31 |
576 .L23: |
577 065c 1092 0000 sts (GPS_Nick)+1,__zero_reg__ |
578 0660 1092 0000 sts GPS_Nick,__zero_reg__ |
579 0664 1092 0000 sts (GPS_Roll)+1,__zero_reg__ |
580 0668 1092 0000 sts GPS_Roll,__zero_reg__ |
581 .L31: |
582 /* epilogue start */ |
583 066c 1F91 pop r17 |
584 066e 0F91 pop r16 |
585 0670 FF90 pop r15 |
586 0672 EF90 pop r14 |
587 0674 0895 ret |
589 .global SPI_StartTransmitPacket |
591 SPI_StartTransmitPacket: |
592 /* prologue: function */ |
593 /* frame size = 0 */ |
594 0676 8091 0000 lds r24,SPITransferCompleted |
595 067a 8823 tst r24 |
596 067c 01F4 brne .+2 |
597 067e 00C0 rjmp .L38 |
598 0680 4598 cbi 40-32,5 |
599 0682 80E0 ldi r24,lo8(ToNaviCtrl) |
600 0684 90E0 ldi r25,hi8(ToNaviCtrl) |
601 0686 9093 0000 sts (SPI_TX_Buffer)+1,r25 |
602 068a 8093 0000 sts SPI_TX_Buffer,r24 |
603 068e 9091 0000 lds r25,SPI_CommandCounter |
604 0692 E92F mov r30,r25 |
605 0694 F0E0 ldi r31,lo8(0) |
606 0696 E050 subi r30,lo8(-(SPI_CommandSequence)) |
607 0698 F040 sbci r31,hi8(-(SPI_CommandSequence)) |
608 069a 8081 ld r24,Z |
609 069c 8093 0000 sts ToNaviCtrl+2,r24 |
610 06a0 9F5F subi r25,lo8(-(1)) |
611 06a2 9093 0000 sts SPI_CommandCounter,r25 |
612 06a6 9930 cpi r25,lo8(9) |
613 06a8 00F0 brlo .L37 |
614 06aa 1092 0000 sts SPI_CommandCounter,__zero_reg__ |
615 .L37: |
616 06ae 1092 0000 sts SPITransferCompleted,__zero_reg__ |
617 06b2 0E94 0000 call UpdateSPI_Buffer |
618 06b6 81E0 ldi r24,lo8(1) |
619 06b8 8093 0000 sts SPI_BufferIndex,r24 |
620 /* #APP */ |
621 ; 75 "spi.c" 1 |
622 06bc 0000 nop |
623 ; 0 "" 2 |
624 ; 75 "spi.c" 1 |
625 06be 0000 nop |
626 ; 0 "" 2 |
627 ; 75 "spi.c" 1 |
628 06c0 0000 nop |
629 ; 0 "" 2 |
630 ; 75 "spi.c" 1 |
631 06c2 0000 nop |
632 ; 0 "" 2 |
633 ; 75 "spi.c" 1 |
634 06c4 0000 nop |
635 ; 0 "" 2 |
636 ; 75 "spi.c" 1 |
637 06c6 0000 nop |
638 ; 0 "" 2 |
639 ; 75 "spi.c" 1 |
640 06c8 0000 nop |
641 ; 0 "" 2 |
642 ; 75 "spi.c" 1 |
643 06ca 0000 nop |
644 ; 0 "" 2 |
645 ; 76 "spi.c" 1 |
646 06cc 0000 nop |
647 ; 0 "" 2 |
648 ; 76 "spi.c" 1 |
649 06ce 0000 nop |
650 ; 0 "" 2 |
651 ; 76 "spi.c" 1 |
652 06d0 0000 nop |
653 ; 0 "" 2 |
654 ; 76 "spi.c" 1 |
655 06d2 0000 nop |
656 ; 0 "" 2 |
657 ; 76 "spi.c" 1 |
658 06d4 0000 nop |
659 ; 0 "" 2 |
660 ; 76 "spi.c" 1 |
661 06d6 0000 nop |
662 ; 0 "" 2 |
663 ; 76 "spi.c" 1 |
664 06d8 0000 nop |
665 ; 0 "" 2 |
666 ; 76 "spi.c" 1 |
667 06da 0000 nop |
668 ; 0 "" 2 |
669 ; 77 "spi.c" 1 |
670 06dc 0000 nop |
671 ; 0 "" 2 |
672 ; 77 "spi.c" 1 |
673 06de 0000 nop |
674 ; 0 "" 2 |
675 ; 77 "spi.c" 1 |
676 06e0 0000 nop |
677 ; 0 "" 2 |
678 ; 77 "spi.c" 1 |
679 06e2 0000 nop |
680 ; 0 "" 2 |
681 ; 77 "spi.c" 1 |
682 06e4 0000 nop |
683 ; 0 "" 2 |
684 ; 77 "spi.c" 1 |
685 06e6 0000 nop |
686 ; 0 "" 2 |
687 ; 77 "spi.c" 1 |
688 06e8 0000 nop |
689 ; 0 "" 2 |
690 ; 77 "spi.c" 1 |
691 06ea 0000 nop |
692 ; 0 "" 2 |
693 /* #NOAPP */ |
694 06ec 8091 0000 lds r24,ToNaviCtrl |
695 06f0 8093 0000 sts ToNaviCtrl+31,r24 |
696 06f4 8EBD out 78-32,r24 |
697 .L38: |
698 06f6 0895 ret |
700 .global SPI_TransmitByte |
702 SPI_TransmitByte: |
703 /* prologue: function */ |
704 /* frame size = 0 */ |
705 06f8 8091 0000 lds r24,SPITransferCompleted |
706 06fc 8823 tst r24 |
707 06fe 01F0 breq .+2 |
708 0700 00C0 rjmp .L52 |
709 0702 0DB4 in __tmp_reg__,77-32 |
710 0704 07FE sbrs __tmp_reg__,7 |
711 0706 00C0 rjmp .L52 |
712 0708 84E0 ldi r24,lo8(4) |
713 070a 8093 0000 sts SendSPI,r24 |
714 070e 459A sbi 40-32,5 |
715 0710 2EB5 in r18,78-32 |
716 0712 8091 0000 lds r24,SPI_RXState.2259 |
717 0716 8130 cpi r24,lo8(1) |
718 0718 01F0 breq .L43 |
719 071a 8130 cpi r24,lo8(1) |
720 071c 00F0 brlo .L42 |
721 071e 8230 cpi r24,lo8(2) |
722 0720 01F4 brne .L41 |
723 0722 00C0 rjmp .L55 |
724 .L42: |
725 0724 1092 0000 sts SPI_RxBufferIndex,__zero_reg__ |
726 0728 2093 0000 sts rxchksum.2261,r18 |
727 072c 2138 cpi r18,lo8(-127) |
728 072e 01F4 brne .L41 |
729 0730 81E0 ldi r24,lo8(1) |
730 0732 00C0 rjmp .L54 |
731 .L43: |
732 0734 2535 cpi r18,lo8(85) |
733 0736 01F4 brne .L49 |
734 0738 8091 0000 lds r24,rxchksum.2261 |
735 073c 8B5A subi r24,lo8(-(85)) |
736 073e 8093 0000 sts rxchksum.2261,r24 |
737 0742 82E0 ldi r24,lo8(2) |
738 .L54: |
739 0744 8093 0000 sts SPI_RXState.2259,r24 |
740 0748 00C0 rjmp .L41 |
741 .L55: |
742 074a 8091 0000 lds r24,SPI_RxBufferIndex |
743 074e E82F mov r30,r24 |
744 0750 F0E0 ldi r31,lo8(0) |
745 0752 E050 subi r30,lo8(-(SPI_Buffer)) |
746 0754 F040 sbci r31,hi8(-(SPI_Buffer)) |
747 0756 2083 st Z,r18 |
748 0758 8F5F subi r24,lo8(-(1)) |
749 075a 8093 0000 sts SPI_RxBufferIndex,r24 |
750 075e 9091 0000 lds r25,rxchksum.2261 |
751 0762 8A31 cpi r24,lo8(26) |
752 0764 00F0 brlo .L46 |
753 0766 2917 cp r18,r25 |
754 0768 01F4 brne .L47 |
755 076a A0E0 ldi r26,lo8(FromNaviCtrl) |
756 076c B0E0 ldi r27,hi8(FromNaviCtrl) |
757 076e E0E0 ldi r30,lo8(SPI_Buffer) |
758 0770 F0E0 ldi r31,hi8(SPI_Buffer) |
759 0772 8AE1 ldi r24,lo8(26) |
760 .L48: |
761 0774 0190 ld r0,Z+ |
762 0776 0D92 st X+,r0 |
763 0778 8150 subi r24,lo8(-(-1)) |
764 077a 01F4 brne .L48 |
765 077c 81E0 ldi r24,lo8(1) |
766 077e 8093 0000 sts SPI_RxDataValid,r24 |
767 0782 00C0 rjmp .L49 |
768 .L47: |
769 0784 1092 0000 sts SPI_RxDataValid,__zero_reg__ |
770 .L49: |
771 0788 1092 0000 sts SPI_RXState.2259,__zero_reg__ |
772 078c 00C0 rjmp .L41 |
773 .L46: |
774 078e 920F add r25,r18 |
775 0790 9093 0000 sts rxchksum.2261,r25 |
776 .L41: |
777 0794 2091 0000 lds r18,SPI_BufferIndex |
778 0798 2032 cpi r18,lo8(32) |
779 079a 00F0 brlo .+2 |
780 079c 00C0 rjmp .L50 |
781 079e 4598 cbi 40-32,5 |
782 /* #APP */ |
783 ; 141 "spi.c" 1 |
784 07a0 0000 nop |
785 ; 0 "" 2 |
786 ; 141 "spi.c" 1 |
787 07a2 0000 nop |
788 ; 0 "" 2 |
789 ; 141 "spi.c" 1 |
790 07a4 0000 nop |
791 ; 0 "" 2 |
792 ; 141 "spi.c" 1 |
793 07a6 0000 nop |
794 ; 0 "" 2 |
795 ; 141 "spi.c" 1 |
796 07a8 0000 nop |
797 ; 0 "" 2 |
798 ; 141 "spi.c" 1 |
799 07aa 0000 nop |
800 ; 0 "" 2 |
801 ; 141 "spi.c" 1 |
802 07ac 0000 nop |
803 ; 0 "" 2 |
804 ; 141 "spi.c" 1 |
805 07ae 0000 nop |
806 ; 0 "" 2 |
807 ; 142 "spi.c" 1 |
808 07b0 0000 nop |
809 ; 0 "" 2 |
810 ; 142 "spi.c" 1 |
811 07b2 0000 nop |
812 ; 0 "" 2 |
813 ; 142 "spi.c" 1 |
814 07b4 0000 nop |
815 ; 0 "" 2 |
816 ; 142 "spi.c" 1 |
817 07b6 0000 nop |
818 ; 0 "" 2 |
819 ; 142 "spi.c" 1 |
820 07b8 0000 nop |
821 ; 0 "" 2 |
822 ; 142 "spi.c" 1 |
823 07ba 0000 nop |
824 ; 0 "" 2 |
825 ; 142 "spi.c" 1 |
826 07bc 0000 nop |
827 ; 0 "" 2 |
828 ; 142 "spi.c" 1 |
829 07be 0000 nop |
830 ; 0 "" 2 |
831 ; 143 "spi.c" 1 |
832 07c0 0000 nop |
833 ; 0 "" 2 |
834 ; 143 "spi.c" 1 |
835 07c2 0000 nop |
836 ; 0 "" 2 |
837 ; 143 "spi.c" 1 |
838 07c4 0000 nop |
839 ; 0 "" 2 |
840 ; 143 "spi.c" 1 |
841 07c6 0000 nop |
842 ; 0 "" 2 |
843 ; 143 "spi.c" 1 |
844 07c8 0000 nop |
845 ; 0 "" 2 |
846 ; 143 "spi.c" 1 |
847 07ca 0000 nop |
848 ; 0 "" 2 |
849 ; 143 "spi.c" 1 |
850 07cc 0000 nop |
851 ; 0 "" 2 |
852 ; 143 "spi.c" 1 |
853 07ce 0000 nop |
854 ; 0 "" 2 |
855 /* #NOAPP */ |
856 07d0 E091 0000 lds r30,SPI_TX_Buffer |
857 07d4 F091 0000 lds r31,(SPI_TX_Buffer)+1 |
858 07d8 E20F add r30,r18 |
859 07da F11D adc r31,__zero_reg__ |
860 07dc 8081 ld r24,Z |
861 07de 8EBD out 78-32,r24 |
862 07e0 9091 0000 lds r25,ToNaviCtrl+31 |
863 07e4 890F add r24,r25 |
864 07e6 8093 0000 sts ToNaviCtrl+31,r24 |
865 07ea 00C0 rjmp .L51 |
866 .L50: |
867 07ec 81E0 ldi r24,lo8(1) |
868 07ee 8093 0000 sts SPITransferCompleted,r24 |
869 .L51: |
870 07f2 2F5F subi r18,lo8(-(1)) |
871 07f4 2093 0000 sts SPI_BufferIndex,r18 |
872 .L52: |
873 07f8 0895 ret |
875 .global FromNC_Rotate_C |
876 .data |
879 FromNC_Rotate_C: |
880 0000 20 .byte 32 |
881 .global FromNC_Rotate_S |
882 .global FromNC_Rotate_S |
883 .section .bss |
886 FromNC_Rotate_S: |
887 0000 00 .skip 1,0 |
888 .global NaviDataOkay |
889 .data |
892 NaviDataOkay: |
893 0001 FA .byte -6 |
894 .global SPI_CommandSequence |
897 SPI_CommandSequence: |
898 0002 0B .byte 11 |
899 0003 0A .byte 10 |
900 0004 0D .byte 13 |
901 0005 0B .byte 11 |
902 0006 0C .byte 12 |
903 0007 0E .byte 14 |
904 0008 0B .byte 11 |
905 0009 0F .byte 15 |
906 000a 10 .byte 16 |
907 .global SPI_CommandCounter |
908 .global SPI_CommandCounter |
909 .section .bss |
912 SPI_CommandCounter: |
913 0001 00 .skip 1,0 |
914 .global NC_ErrorCode |
915 .global NC_ErrorCode |
918 NC_ErrorCode: |
919 0002 00 .skip 1,0 |
920 .lcomm rxchksum.2261,1 |
921 .lcomm SPI_RXState.2259,1 |
922 .comm GPSInfo,8,1 |
923 .comm NC_Version,5,1 |
924 .comm FromNaviCtrl_Value,5,1 |
925 .comm ToNaviCtrl,32,1 |
926 .comm FromNaviCtrl,26,1 |
927 .comm SPI_BufferIndex,1,1 |
928 .comm SPI_RxBufferIndex,1,1 |
929 .comm SPI_Buffer,26,1 |
930 .comm SPI_TX_Buffer,2,1 |
931 .comm SPITransferCompleted,1,1 |
932 .comm SPI_ChkSum,1,1 |
933 .comm SPI_RxDataValid,1,1 |
934 .global __do_copy_data |
935 .global __do_clear_bss |
8 .global __do_copy_data |
9 .global __do_clear_bss |
10 .global NC_ErrorCode |
11 .global NC_ErrorCode |
12 .section .bss |
15 NC_ErrorCode: |
16 0000 00 .skip 1,0 |
17 .global SPI_CommandCounter |
18 .global SPI_CommandCounter |
21 SPI_CommandCounter: |
22 0001 00 .skip 1,0 |
23 .global SPI_CommandSequence |
24 .data |
27 SPI_CommandSequence: |
28 0000 0B .byte 11 |
29 0001 0A .byte 10 |
30 0002 0D .byte 13 |
31 0003 0B .byte 11 |
32 0004 0C .byte 12 |
33 0005 0E .byte 14 |
34 0006 0B .byte 11 |
35 0007 0F .byte 15 |
36 0008 10 .byte 16 |
37 .global NaviDataOkay |
40 NaviDataOkay: |
41 0009 FA .byte -6 |
42 .global FromNC_Rotate_S |
43 .global FromNC_Rotate_S |
44 .section .bss |
47 FromNC_Rotate_S: |
48 0002 00 .skip 1,0 |
49 .global FromNC_Rotate_C |
50 .data |
53 FromNC_Rotate_C: |
54 000a 20 .byte 32 |
55 .text |
56 .global SPI_MasterInit |
58 SPI_MasterInit: |
59 /* prologue: frame size=0 */ |
60 /* prologue end (size=0) */ |
61 0000 84B1 in r24,36-0x20 |
62 0002 806A ori r24,lo8(-96) |
63 0004 84B9 out 36-0x20,r24 |
64 0006 3D9A sbi 39-0x20,5 |
65 0008 82E5 ldi r24,lo8(82) |
66 000a 8CBD out 76-0x20,r24 |
67 000c 1DBC out 77-0x20,__zero_reg__ |
68 000e 459A sbi 40-0x20,5 |
69 0010 81E0 ldi r24,lo8(1) |
70 0012 8093 0000 sts SPITransferCompleted,r24 |
71 0016 8AEA ldi r24,lo8(-86) |
72 0018 8093 0000 sts ToNaviCtrl,r24 |
73 001c 83E8 ldi r24,lo8(-125) |
74 001e 8093 0000 sts ToNaviCtrl+1,r24 |
75 0022 8AE0 ldi r24,lo8(10) |
76 0024 8093 0000 sts ToNaviCtrl+2,r24 |
77 0028 1092 0000 sts (ToNaviCtrl+3)+1,__zero_reg__ |
78 002c 1092 0000 sts ToNaviCtrl+3,__zero_reg__ |
79 0030 1092 0000 sts (ToNaviCtrl+5)+1,__zero_reg__ |
80 0034 1092 0000 sts ToNaviCtrl+5,__zero_reg__ |
81 0038 1092 0000 sts FromNaviCtrl_Value+3,__zero_reg__ |
82 003c 1092 0000 sts SPI_RxDataValid,__zero_reg__ |
83 /* epilogue: frame size=0 */ |
84 0040 0895 ret |
85 /* epilogue end (size=1) */ |
86 /* function SPI_MasterInit size 33 (32) */ |
88 .lcomm SPI_RXState.0,1 |
89 .lcomm rxchksum.1,1 |
90 .global SPI_TransmitByte |
92 SPI_TransmitByte: |
93 /* prologue: frame size=0 */ |
94 /* prologue end (size=0) */ |
95 0042 3091 0000 lds r19,SPITransferCompleted |
96 0046 3323 tst r19 |
97 0048 09F0 breq .+2 |
98 004a 85C0 rjmp .L2 |
99 004c 0DB4 in __tmp_reg__,77-0x20 |
100 004e 07FE sbrs __tmp_reg__,7 |
101 0050 82C0 rjmp .L2 |
102 0052 84E0 ldi r24,lo8(4) |
103 0054 8093 0000 sts SendSPI,r24 |
104 0058 459A sbi 40-0x20,5 |
105 005a 2EB5 in r18,78-0x20 |
106 005c 8091 0000 lds r24,SPI_RXState.0 |
107 0060 9927 clr r25 |
108 0062 8130 cpi r24,1 |
109 0064 9105 cpc r25,__zero_reg__ |
110 0066 89F0 breq .L8 |
111 0068 8230 cpi r24,2 |
112 006a 9105 cpc r25,__zero_reg__ |
113 006c 1CF4 brge .L16 |
114 006e 892B or r24,r25 |
115 0070 21F0 breq .L6 |
116 0072 3EC0 rjmp .L5 |
117 .L16: |
118 0074 0297 sbiw r24,2 |
119 0076 B9F0 breq .L11 |
120 0078 3BC0 rjmp .L5 |
121 .L6: |
122 007a 3093 0000 sts SPI_RxBufferIndex,r19 |
123 007e 2093 0000 sts rxchksum.1,r18 |
124 0082 2138 cpi r18,lo8(-127) |
125 0084 A9F5 brne .L5 |
126 0086 81E0 ldi r24,lo8(1) |
127 0088 08C0 rjmp .L19 |
128 .L8: |
129 008a 2535 cpi r18,lo8(85) |
130 008c 49F4 brne .L9 |
131 008e 8091 0000 lds r24,rxchksum.1 |
132 0092 820F add r24,r18 |
133 0094 8093 0000 sts rxchksum.1,r24 |
134 0098 82E0 ldi r24,lo8(2) |
135 .L19: |
136 009a 8093 0000 sts SPI_RXState.0,r24 |
137 009e 28C0 rjmp .L5 |
138 .L9: |
139 00a0 3093 0000 sts SPI_RXState.0,r19 |
140 00a4 25C0 rjmp .L5 |
141 .L11: |
142 00a6 8091 0000 lds r24,SPI_RxBufferIndex |
143 00aa E82F mov r30,r24 |
144 00ac FF27 clr r31 |
145 00ae E050 subi r30,lo8(-(SPI_Buffer)) |
146 00b0 F040 sbci r31,hi8(-(SPI_Buffer)) |
147 00b2 2083 st Z,r18 |
148 00b4 8F5F subi r24,lo8(-(1)) |
149 00b6 8093 0000 sts SPI_RxBufferIndex,r24 |
150 00ba 9091 0000 lds r25,rxchksum.1 |
151 00be 8A31 cpi r24,lo8(26) |
152 00c0 A0F0 brlo .L12 |
153 00c2 2917 cp r18,r25 |
154 00c4 69F4 brne .L13 |
155 00c6 8AE1 ldi r24,lo8(26) |
156 00c8 A0E0 ldi r26,lo8(SPI_Buffer) |
157 00ca B0E0 ldi r27,hi8(SPI_Buffer) |
158 00cc E0E0 ldi r30,lo8(FromNaviCtrl) |
159 00ce F0E0 ldi r31,hi8(FromNaviCtrl) |
160 00d0 0D90 ld __tmp_reg__,X+ |
161 00d2 0192 st Z+,__tmp_reg__ |
162 00d4 8A95 dec r24 |
163 00d6 E1F7 brne .-8 |
164 00d8 81E0 ldi r24,lo8(1) |
165 00da 8093 0000 sts SPI_RxDataValid,r24 |
166 00de 02C0 rjmp .L14 |
167 .L13: |
168 00e0 3093 0000 sts SPI_RxDataValid,r19 |
169 .L14: |
170 00e4 1092 0000 sts SPI_RXState.0,__zero_reg__ |
171 00e8 03C0 rjmp .L5 |
172 .L12: |
173 00ea 920F add r25,r18 |
174 00ec 9093 0000 sts rxchksum.1,r25 |
175 .L5: |
176 00f0 2091 0000 lds r18,SPI_BufferIndex |
177 00f4 2032 cpi r18,lo8(32) |
178 00f6 08F0 brlo .+2 |
179 00f8 28C0 rjmp .L17 |
180 00fa 4598 cbi 40-0x20,5 |
181 /* #APP */ |
182 00fc 0000 nop |
183 00fe 0000 nop |
184 0100 0000 nop |
185 0102 0000 nop |
186 0104 0000 nop |
187 0106 0000 nop |
188 0108 0000 nop |
189 010a 0000 nop |
190 010c 0000 nop |
191 010e 0000 nop |
192 0110 0000 nop |
193 0112 0000 nop |
194 0114 0000 nop |
195 0116 0000 nop |
196 0118 0000 nop |
197 011a 0000 nop |
198 011c 0000 nop |
199 011e 0000 nop |
200 0120 0000 nop |
201 0122 0000 nop |
202 0124 0000 nop |
203 0126 0000 nop |
204 0128 0000 nop |
205 012a 0000 nop |
206 /* #NOAPP */ |
207 012c E091 0000 lds r30,SPI_TX_Buffer |
208 0130 F091 0000 lds r31,(SPI_TX_Buffer)+1 |
209 0134 E20F add r30,r18 |
210 0136 F11D adc r31,__zero_reg__ |
211 0138 8081 ld r24,Z |
212 013a 8EBD out 78-0x20,r24 |
213 013c 8091 0000 lds r24,ToNaviCtrl+31 |
214 0140 9081 ld r25,Z |
215 0142 890F add r24,r25 |
216 0144 8093 0000 sts ToNaviCtrl+31,r24 |
217 0148 03C0 rjmp .L18 |
218 .L17: |
219 014a 81E0 ldi r24,lo8(1) |
220 014c 8093 0000 sts SPITransferCompleted,r24 |
221 .L18: |
222 0150 2F5F subi r18,lo8(-(1)) |
223 0152 2093 0000 sts SPI_BufferIndex,r18 |
224 .L2: |
225 0156 0895 ret |
226 /* epilogue: frame size=0 */ |
227 /* epilogue: noreturn */ |
228 /* epilogue end (size=0) */ |
229 /* function SPI_TransmitByte size 164 (164) */ |
231 .global UpdateSPI_Buffer |
233 UpdateSPI_Buffer: |
234 /* prologue: frame size=0 */ |
235 0158 EF92 push r14 |
236 015a FF92 push r15 |
237 015c 0F93 push r16 |
238 015e 1F93 push r17 |
239 /* prologue end (size=4) */ |
240 0160 8091 0000 lds r24,EE_Parameter+28 |
241 0164 9927 clr r25 |
242 0166 880F lsl r24 |
243 0168 991F rol r25 |
244 016a 880F lsl r24 |
245 016c 991F rol r25 |
246 016e 7C01 movw r14,r24 |
247 0170 0027 clr r16 |
248 0172 F7FC sbrc r15,7 |
249 0174 0095 com r16 |
250 0176 102F mov r17,r16 |
251 0178 8091 0000 lds r24,IntegralNick |
252 017c 9091 0000 lds r25,(IntegralNick)+1 |
253 0180 A091 0000 lds r26,(IntegralNick)+2 |
254 0184 B091 0000 lds r27,(IntegralNick)+3 |
255 0188 BC01 movw r22,r24 |
256 018a CD01 movw r24,r26 |
257 018c A801 movw r20,r16 |
258 018e 9701 movw r18,r14 |
259 0190 0E94 0000 call __divmodsi4 |
260 0194 3093 0000 sts (ToNaviCtrl+3)+1,r19 |
261 0198 2093 0000 sts ToNaviCtrl+3,r18 |
262 019c 8091 0000 lds r24,IntegralRoll |
263 01a0 9091 0000 lds r25,(IntegralRoll)+1 |
264 01a4 A091 0000 lds r26,(IntegralRoll)+2 |
265 01a8 B091 0000 lds r27,(IntegralRoll)+3 |
266 01ac BC01 movw r22,r24 |
267 01ae CD01 movw r24,r26 |
268 01b0 A801 movw r20,r16 |
269 01b2 9701 movw r18,r14 |
270 01b4 0E94 0000 call __divmodsi4 |
271 01b8 3093 0000 sts (ToNaviCtrl+5)+1,r19 |
272 01bc 2093 0000 sts ToNaviCtrl+5,r18 |
273 01c0 2091 0000 lds r18,ErsatzKompass |
274 01c4 3091 0000 lds r19,(ErsatzKompass)+1 |
275 01c8 4091 0000 lds r20,(ErsatzKompass)+2 |
276 01cc 5091 0000 lds r21,(ErsatzKompass)+3 |
277 01d0 DA01 movw r26,r20 |
278 01d2 C901 movw r24,r18 |
279 01d4 E3E0 ldi r30,3 |
280 01d6 880F 1: lsl r24 |
281 01d8 991F rol r25 |
282 01da AA1F rol r26 |
283 01dc BB1F rol r27 |
284 01de EA95 dec r30 |
285 01e0 D1F7 brne 1b |
286 01e2 820F add r24,r18 |
287 01e4 931F adc r25,r19 |
288 01e6 A41F adc r26,r20 |
289 01e8 B51F adc r27,r21 |
290 01ea 820F add r24,r18 |
291 01ec 931F adc r25,r19 |
292 01ee A41F adc r26,r20 |
293 01f0 B51F adc r27,r21 |
294 01f2 2091 0000 lds r18,GIER_GRAD_FAKTOR |
295 01f6 3091 0000 lds r19,(GIER_GRAD_FAKTOR)+1 |
296 01fa 4091 0000 lds r20,(GIER_GRAD_FAKTOR)+2 |
297 01fe 5091 0000 lds r21,(GIER_GRAD_FAKTOR)+3 |
298 0202 BC01 movw r22,r24 |
299 0204 CD01 movw r24,r26 |
300 0206 0E94 0000 call __divmodsi4 |
301 020a 3093 0000 sts (ToNaviCtrl+11)+1,r19 |
302 020e 2093 0000 sts ToNaviCtrl+11,r18 |
303 0212 8091 0000 lds r24,AdNeutralGier |
304 0216 9091 0000 lds r25,(AdNeutralGier)+1 |
305 021a 2091 0000 lds r18,AdWertGier |
306 021e 3091 0000 lds r19,(AdWertGier)+1 |
307 0222 821B sub r24,r18 |
308 0224 930B sbc r25,r19 |
309 0226 9093 0000 sts (ToNaviCtrl+17)+1,r25 |
310 022a 8093 0000 sts ToNaviCtrl+17,r24 |
311 022e E091 0000 lds r30,NaviCntAcc |
312 0232 F091 0000 lds r31,(NaviCntAcc)+1 |
313 0236 8091 0000 lds r24,NaviAccNick |
314 023a 9091 0000 lds r25,(NaviAccNick)+1 |
315 023e BF01 movw r22,r30 |
316 0240 0E94 0000 call __divmodhi4 |
317 0244 CB01 movw r24,r22 |
318 0246 9B01 movw r18,r22 |
319 0248 220F lsl r18 |
320 024a 331F rol r19 |
321 024c 220F lsl r18 |
322 024e 331F rol r19 |
323 0250 280F add r18,r24 |
324 0252 391F adc r19,r25 |
325 0254 280F add r18,r24 |
326 0256 391F adc r19,r25 |
327 0258 37FF sbrs r19,7 |
328 025a 02C0 rjmp .L21 |
329 025c 2D5F subi r18,lo8(-(3)) |
330 025e 3F4F sbci r19,hi8(-(3)) |
331 .L21: |
332 0260 3595 asr r19 |
333 0262 2795 ror r18 |
334 0264 3595 asr r19 |
335 0266 2795 ror r18 |
336 0268 3093 0000 sts (ToNaviCtrl+7)+1,r19 |
337 026c 2093 0000 sts ToNaviCtrl+7,r18 |
338 0270 8091 0000 lds r24,NaviAccRoll |
339 0274 9091 0000 lds r25,(NaviAccRoll)+1 |
340 0278 BF01 movw r22,r30 |
341 027a 0E94 0000 call __divmodhi4 |
342 027e 9B01 movw r18,r22 |
343 0280 220F lsl r18 |
344 0282 331F rol r19 |
345 0284 220F lsl r18 |
346 0286 331F rol r19 |
347 0288 260F add r18,r22 |
348 028a 371F adc r19,r23 |
349 028c 260F add r18,r22 |
350 028e 371F adc r19,r23 |
351 0290 37FF sbrs r19,7 |
352 0292 02C0 rjmp .L22 |
353 0294 2D5F subi r18,lo8(-(3)) |
354 0296 3F4F sbci r19,hi8(-(3)) |
355 .L22: |
356 0298 3595 asr r19 |
357 029a 2795 ror r18 |
358 029c 3595 asr r19 |
359 029e 2795 ror r18 |
360 02a0 3093 0000 sts (ToNaviCtrl+9)+1,r19 |
361 02a4 2093 0000 sts ToNaviCtrl+9,r18 |
362 02a8 1092 0000 sts (NaviCntAcc)+1,__zero_reg__ |
363 02ac 1092 0000 sts NaviCntAcc,__zero_reg__ |
364 02b0 1092 0000 sts (NaviAccNick)+1,__zero_reg__ |
365 02b4 1092 0000 sts NaviAccNick,__zero_reg__ |
366 02b8 1092 0000 sts (NaviAccRoll)+1,__zero_reg__ |
367 02bc 1092 0000 sts NaviAccRoll,__zero_reg__ |
368 02c0 8091 0000 lds r24,ToNaviCtrl+2 |
369 02c4 9927 clr r25 |
370 02c6 8D30 cpi r24,13 |
371 02c8 9105 cpc r25,__zero_reg__ |
372 02ca 09F4 brne .+2 |
373 02cc 66C0 rjmp .L26 |
374 02ce 8E30 cpi r24,14 |
375 02d0 9105 cpc r25,__zero_reg__ |
376 02d2 5CF4 brge .L46 |
377 02d4 8B30 cpi r24,11 |
378 02d6 9105 cpc r25,__zero_reg__ |
379 02d8 09F4 brne .+2 |
380 02da 8EC0 rjmp .L27 |
381 02dc 8C30 cpi r24,12 |
382 02de 9105 cpc r25,__zero_reg__ |
383 02e0 0CF0 brlt .+2 |
384 02e2 0FC1 rjmp .L40 |
385 02e4 0A97 sbiw r24,10 |
386 02e6 61F0 breq .L24 |
387 02e8 A8C1 rjmp .L23 |
388 .L46: |
389 02ea 8F30 cpi r24,15 |
390 02ec 9105 cpc r25,__zero_reg__ |
391 02ee 09F4 brne .+2 |
392 02f0 7CC1 rjmp .L45 |
393 02f2 8F30 cpi r24,15 |
394 02f4 9105 cpc r25,__zero_reg__ |
395 02f6 0CF4 brge .+2 |
396 02f8 5CC1 rjmp .L44 |
397 02fa 4097 sbiw r24,16 |
398 02fc 99F1 breq .L25 |
399 02fe 9DC1 rjmp .L23 |
400 .L24: |
401 0300 8091 0000 lds r24,Parameter_UserParam1 |
402 0304 8093 0000 sts ToNaviCtrl+19,r24 |
403 0308 8091 0000 lds r24,Parameter_UserParam2 |
404 030c 8093 0000 sts ToNaviCtrl+20,r24 |
405 0310 8091 0000 lds r24,Parameter_UserParam3 |
406 0314 8093 0000 sts ToNaviCtrl+21,r24 |
407 0318 8091 0000 lds r24,Parameter_UserParam4 |
408 031c 8093 0000 sts ToNaviCtrl+22,r24 |
409 0320 8091 0000 lds r24,Parameter_UserParam5 |
410 0324 8093 0000 sts ToNaviCtrl+23,r24 |
411 0328 8091 0000 lds r24,Parameter_UserParam6 |
412 032c 8093 0000 sts ToNaviCtrl+24,r24 |
413 0330 8091 0000 lds r24,Parameter_UserParam7 |
414 0334 8093 0000 sts ToNaviCtrl+25,r24 |
415 0338 8091 0000 lds r24,Parameter_UserParam8 |
416 033c 8093 0000 sts ToNaviCtrl+26,r24 |
417 0340 8091 0000 lds r24,FCFlags |
418 0344 8093 0000 sts ToNaviCtrl+27,r24 |
419 0348 8091 0000 lds r24,FCFlags |
420 034c 837F andi r24,lo8(-13) |
421 034e 8093 0000 sts FCFlags,r24 |
422 0352 0E94 0000 call GetActiveParamSet |
423 0356 8093 0000 sts ToNaviCtrl+28,r24 |
424 035a 8091 0000 lds r24,ControlHeading |
425 035e 8093 0000 sts ToNaviCtrl+29,r24 |
426 0362 6BC1 rjmp .L23 |
427 .L25: |
428 0364 8091 0000 lds r24,Capacity |
429 0368 9091 0000 lds r25,(Capacity)+1 |
430 036c 9093 0000 sts (ToNaviCtrl+19)+1,r25 |
431 0370 8093 0000 sts ToNaviCtrl+19,r24 |
432 0374 8091 0000 lds r24,Capacity+4 |
433 0378 9091 0000 lds r25,(Capacity+4)+1 |
434 037c 9093 0000 sts (ToNaviCtrl+21)+1,r25 |
435 0380 8093 0000 sts ToNaviCtrl+21,r24 |
436 0384 8091 0000 lds r24,UBat |
437 0388 9091 0000 lds r25,(UBat)+1 |
438 038c 8093 0000 sts ToNaviCtrl+23,r24 |
439 0390 8091 0000 lds r24,BattLowVoltageWarning |
440 0394 8093 0000 sts ToNaviCtrl+24,r24 |
441 0398 50C1 rjmp .L23 |
442 .L26: |
443 039a 8091 0000 lds r24,EE_Parameter+78 |
444 039e 8093 0000 sts ToNaviCtrl+19,r24 |
445 03a2 8091 0000 lds r24,EE_Parameter+79 |
446 03a6 8093 0000 sts ToNaviCtrl+20,r24 |
447 03aa 8091 0000 lds r24,EE_Parameter+80 |
448 03ae 8093 0000 sts ToNaviCtrl+21,r24 |
449 03b2 8091 0000 lds r24,EE_Parameter+81 |
450 03b6 8093 0000 sts ToNaviCtrl+22,r24 |
451 03ba 8091 0000 lds r24,EE_Parameter+82 |
452 03be 8093 0000 sts ToNaviCtrl+23,r24 |
453 03c2 8091 0000 lds r24,EE_Parameter+86 |
454 03c6 8093 0000 sts ToNaviCtrl+24,r24 |
455 03ca 8091 0000 lds r24,EE_Parameter+87 |
456 03ce 8093 0000 sts ToNaviCtrl+25,r24 |
457 03d2 8091 0000 lds r24,EE_Parameter+88 |
458 03d6 8093 0000 sts ToNaviCtrl+26,r24 |
459 03da 8091 0000 lds r24,EE_Parameter+91 |
460 03de 8093 0000 sts ToNaviCtrl+27,r24 |
461 03e2 8091 0000 lds r24,EE_Parameter+89 |
462 03e6 8093 0000 sts ToNaviCtrl+28,r24 |
463 03ea 8091 0000 lds r24,EE_Parameter+90 |
464 03ee 8093 0000 sts ToNaviCtrl+29,r24 |
465 03f2 8091 0000 lds r24,EE_Parameter+92 |
466 03f6 DAC0 rjmp .L58 |
467 .L27: |
468 /* #APP */ |
469 03f8 F894 cli |
470 /* #NOAPP */ |
471 03fa 8091 0000 lds r24,EE_Parameter+3 |
472 03fe E82F mov r30,r24 |
473 0400 FF27 clr r31 |
474 0402 EE0F add r30,r30 |
475 0404 FF1F adc r31,r31 |
476 0406 E050 subi r30,lo8(-(PPM_in)) |
477 0408 F040 sbci r31,hi8(-(PPM_in)) |
478 040a 0190 ld __tmp_reg__,Z+ |
479 040c F081 ld r31,Z |
480 040e E02D mov r30,__tmp_reg__ |
481 0410 E038 cpi r30,128 |
482 0412 F105 cpc r31,__zero_reg__ |
483 0414 1CF0 brlt .L28 |
484 0416 EFE7 ldi r30,lo8(127) |
485 0418 F0E0 ldi r31,hi8(127) |
486 041a 06C0 rjmp .L29 |
487 .L28: |
488 041c 2FEF ldi r18,hi8(-127) |
489 041e E138 cpi r30,lo8(-127) |
490 0420 F207 cpc r31,r18 |
491 0422 14F4 brge .L29 |
492 0424 E1E8 ldi r30,lo8(-127) |
493 0426 FFEF ldi r31,hi8(-127) |
494 .L29: |
495 0428 E093 0000 sts ToNaviCtrl+19,r30 |
496 042c 8091 0000 lds r24,EE_Parameter+4 |
497 0430 E82F mov r30,r24 |
498 0432 FF27 clr r31 |
499 0434 EE0F add r30,r30 |
500 0436 FF1F adc r31,r31 |
501 0438 E050 subi r30,lo8(-(PPM_in)) |
502 043a F040 sbci r31,hi8(-(PPM_in)) |
503 043c 0190 ld __tmp_reg__,Z+ |
504 043e F081 ld r31,Z |
505 0440 E02D mov r30,__tmp_reg__ |
506 0442 E038 cpi r30,128 |
507 0444 F105 cpc r31,__zero_reg__ |
508 0446 1CF0 brlt .L31 |
509 0448 EFE7 ldi r30,lo8(127) |
510 044a F0E0 ldi r31,hi8(127) |
511 044c 06C0 rjmp .L32 |
512 .L31: |
513 044e 6FEF ldi r22,hi8(-127) |
514 0450 E138 cpi r30,lo8(-127) |
515 0452 F607 cpc r31,r22 |
516 0454 14F4 brge .L32 |
517 0456 E1E8 ldi r30,lo8(-127) |
518 0458 FFEF ldi r31,hi8(-127) |
519 .L32: |
520 045a E093 0000 sts ToNaviCtrl+20,r30 |
521 045e 8091 0000 lds r24,EE_Parameter+2 |
522 0462 E82F mov r30,r24 |
523 0464 FF27 clr r31 |
524 0466 EE0F add r30,r30 |
525 0468 FF1F adc r31,r31 |
526 046a E050 subi r30,lo8(-(PPM_in)) |
527 046c F040 sbci r31,hi8(-(PPM_in)) |
528 046e 0190 ld __tmp_reg__,Z+ |
529 0470 F081 ld r31,Z |
530 0472 E02D mov r30,__tmp_reg__ |
531 0474 E038 cpi r30,128 |
532 0476 F105 cpc r31,__zero_reg__ |
533 0478 1CF0 brlt .L34 |
534 047a EFE7 ldi r30,lo8(127) |
535 047c F0E0 ldi r31,hi8(127) |
536 047e 06C0 rjmp .L35 |
537 .L34: |
538 0480 8FEF ldi r24,hi8(-127) |
539 0482 E138 cpi r30,lo8(-127) |
540 0484 F807 cpc r31,r24 |
541 0486 14F4 brge .L35 |
542 0488 E1E8 ldi r30,lo8(-127) |
543 048a FFEF ldi r31,hi8(-127) |
544 .L35: |
545 048c E093 0000 sts ToNaviCtrl+21,r30 |
546 0490 8091 0000 lds r24,EE_Parameter+1 |
547 0494 E82F mov r30,r24 |
548 0496 FF27 clr r31 |
549 0498 EE0F add r30,r30 |
550 049a FF1F adc r31,r31 |
551 049c E050 subi r30,lo8(-(PPM_in)) |
552 049e F040 sbci r31,hi8(-(PPM_in)) |
553 04a0 0190 ld __tmp_reg__,Z+ |
554 04a2 F081 ld r31,Z |
555 04a4 E02D mov r30,__tmp_reg__ |
556 04a6 E038 cpi r30,128 |
557 04a8 F105 cpc r31,__zero_reg__ |
558 04aa 1CF0 brlt .L37 |
559 04ac EFE7 ldi r30,lo8(127) |
560 04ae F0E0 ldi r31,hi8(127) |
561 04b0 06C0 rjmp .L38 |
562 .L37: |
563 04b2 2FEF ldi r18,hi8(-127) |
564 04b4 E138 cpi r30,lo8(-127) |
565 04b6 F207 cpc r31,r18 |
566 04b8 14F4 brge .L38 |
567 04ba E1E8 ldi r30,lo8(-127) |
568 04bc FFEF ldi r31,hi8(-127) |
569 .L38: |
570 /* #APP */ |
571 04be 7894 sei |
572 /* #NOAPP */ |
573 04c0 E093 0000 sts ToNaviCtrl+22,r30 |
574 04c4 8091 0000 lds r24,Poti |
575 04c8 8093 0000 sts ToNaviCtrl+23,r24 |
576 04cc 8091 0000 lds r24,Poti+1 |
577 04d0 8093 0000 sts ToNaviCtrl+24,r24 |
578 04d4 8091 0000 lds r24,Poti+2 |
579 04d8 8093 0000 sts ToNaviCtrl+25,r24 |
580 04dc 8091 0000 lds r24,Poti+3 |
581 04e0 8093 0000 sts ToNaviCtrl+26,r24 |
582 04e4 8091 0000 lds r24,Poti+4 |
583 04e8 8093 0000 sts ToNaviCtrl+27,r24 |
584 04ec 8091 0000 lds r24,Poti+5 |
585 04f0 8093 0000 sts ToNaviCtrl+28,r24 |
586 04f4 8091 0000 lds r24,Poti+6 |
587 04f8 8093 0000 sts ToNaviCtrl+29,r24 |
588 04fc 8091 0000 lds r24,Poti+7 |
589 0500 55C0 rjmp .L58 |
590 .L40: |
591 0502 8091 0000 lds r24,WinkelOut+6 |
592 0506 8630 cpi r24,lo8(6) |
593 0508 18F0 brlo .L41 |
594 050a 1092 0000 sts WinkelOut+6,__zero_reg__ |
595 050e 85E0 ldi r24,lo8(5) |
596 .L41: |
597 0510 8093 0000 sts ToNaviCtrl+19,r24 |
598 0514 8091 0000 lds r24,EE_Parameter+93 |
599 0518 8093 0000 sts ToNaviCtrl+20,r24 |
600 051c 8091 0000 lds r24,HoehenWert |
601 0520 9091 0000 lds r25,(HoehenWert)+1 |
602 0524 A091 0000 lds r26,(HoehenWert)+2 |
603 0528 B091 0000 lds r27,(HoehenWert)+3 |
604 052c BC01 movw r22,r24 |
605 052e CD01 movw r24,r26 |
606 0530 25E0 ldi r18,lo8(5) |
607 0532 30E0 ldi r19,hi8(5) |
608 0534 40E0 ldi r20,hlo8(5) |
609 0536 50E0 ldi r21,hhi8(5) |
610 0538 0E94 0000 call __divmodsi4 |
611 053c 3093 0000 sts (ToNaviCtrl+21)+1,r19 |
612 0540 2093 0000 sts ToNaviCtrl+21,r18 |
613 0544 8091 0000 lds r24,SollHoehe |
614 0548 9091 0000 lds r25,(SollHoehe)+1 |
615 054c A091 0000 lds r26,(SollHoehe)+2 |
616 0550 B091 0000 lds r27,(SollHoehe)+3 |
617 0554 BC01 movw r22,r24 |
618 0556 CD01 movw r24,r26 |
619 0558 25E0 ldi r18,lo8(5) |
620 055a 30E0 ldi r19,hi8(5) |
621 055c 40E0 ldi r20,hlo8(5) |
622 055e 50E0 ldi r21,hhi8(5) |
623 0560 0E94 0000 call __divmodsi4 |
624 0564 3093 0000 sts (ToNaviCtrl+23)+1,r19 |
625 0568 2093 0000 sts ToNaviCtrl+23,r18 |
626 056c 8091 0000 lds r24,EE_Parameter+83 |
627 0570 8093 0000 sts ToNaviCtrl+25,r24 |
628 0574 8091 0000 lds r24,EE_Parameter+84 |
629 0578 8093 0000 sts ToNaviCtrl+26,r24 |
630 057c 8091 0000 lds r24,EE_Parameter+85 |
631 0580 8093 0000 sts ToNaviCtrl+27,r24 |
632 0584 8091 0000 lds r24,SenderOkay |
633 0588 8093 0000 sts ToNaviCtrl+28,r24 |
634 058c 8091 0000 lds r24,PPM_in |
635 0590 9091 0000 lds r25,(PPM_in)+1 |
636 0594 8093 0000 sts ToNaviCtrl+29,r24 |
637 0598 8091 0000 lds r24,DebugOut+16 |
638 059c 9091 0000 lds r25,(DebugOut+16)+1 |
639 05a0 97FD sbrc r25,7 |
640 05a2 0396 adiw r24,3 |
641 .L43: |
642 05a4 9595 asr r25 |
643 05a6 8795 ror r24 |
644 05a8 9595 asr r25 |
645 05aa 8795 ror r24 |
646 .L58: |
647 05ac 8093 0000 sts ToNaviCtrl+30,r24 |
648 05b0 44C0 rjmp .L23 |
649 .L44: |
650 05b2 1092 0000 sts ToNaviCtrl+19,__zero_reg__ |
651 05b6 80E5 ldi r24,lo8(80) |
652 05b8 8093 0000 sts ToNaviCtrl+20,r24 |
653 05bc 86E0 ldi r24,lo8(6) |
654 05be 8093 0000 sts ToNaviCtrl+21,r24 |
655 05c2 8EE0 ldi r24,lo8(14) |
656 05c4 8093 0000 sts ToNaviCtrl+22,r24 |
657 05c8 8091 0000 lds r24,PlatinenVersion |
658 05cc 8093 0000 sts ToNaviCtrl+23,r24 |
659 05d0 8091 0000 lds r24,VersionInfo+5 |
660 05d4 8093 0000 sts ToNaviCtrl+24,r24 |
661 05d8 8091 0000 lds r24,VersionInfo+6 |
662 05dc 8093 0000 sts ToNaviCtrl+25,r24 |
663 05e0 8091 0000 lds r24,VersionInfo+7 |
664 05e4 8093 0000 sts ToNaviCtrl+26,r24 |
665 05e8 28C0 rjmp .L23 |
666 .L45: |
667 05ea 8091 0000 lds r24,EE_Parameter+53 |
668 05ee 8093 0000 sts ToNaviCtrl+19,r24 |
669 05f2 8091 0000 lds r24,EE_Parameter+98 |
670 05f6 8093 0000 sts ToNaviCtrl+20,r24 |
671 05fa 8091 0000 lds r24,Parameter_ServoNickControl |
672 05fe 8093 0000 sts ToNaviCtrl+21,r24 |
673 0602 8091 0000 lds r24,EE_Parameter+46 |
674 0606 8093 0000 sts ToNaviCtrl+22,r24 |
675 060a 8091 0000 lds r24,EE_Parameter+47 |
676 060e 8093 0000 sts ToNaviCtrl+23,r24 |
677 0612 8091 0000 lds r24,EE_Parameter+48 |
678 0616 8093 0000 sts ToNaviCtrl+24,r24 |
679 061a 8091 0000 lds r24,Parameter_ServoRollControl |
680 061e 8093 0000 sts ToNaviCtrl+25,r24 |
681 0622 8091 0000 lds r24,EE_Parameter+50 |
682 0626 8093 0000 sts ToNaviCtrl+26,r24 |
683 062a 8091 0000 lds r24,EE_Parameter+51 |
684 062e 8093 0000 sts ToNaviCtrl+27,r24 |
685 0632 8091 0000 lds r24,EE_Parameter+52 |
686 0636 8093 0000 sts ToNaviCtrl+28,r24 |
687 .L23: |
688 063a 8091 0000 lds r24,SPI_RxDataValid |
689 063e 8823 tst r24 |
690 0640 09F4 brne .+2 |
691 0642 CFC0 rjmp .L47 |
692 0644 8AEF ldi r24,lo8(-6) |
693 0646 8093 0000 sts NaviDataOkay,r24 |
694 064a 4091 0000 lds r20,FromNaviCtrl+1 |
695 064e 5091 0000 lds r21,(FromNaviCtrl+1)+1 |
696 0652 CA01 movw r24,r20 |
697 0654 8150 subi r24,lo8(-(511)) |
698 0656 9E4F sbci r25,hi8(-(511)) |
699 0658 8F5F subi r24,lo8(1023) |
700 065a 9340 sbci r25,hi8(1023) |
701 065c B0F4 brsh .L48 |
702 065e 2091 0000 lds r18,FromNaviCtrl+3 |
703 0662 3091 0000 lds r19,(FromNaviCtrl+3)+1 |
704 0666 C901 movw r24,r18 |
705 0668 8150 subi r24,lo8(-(511)) |
706 066a 9E4F sbci r25,hi8(-(511)) |
707 066c 8F5F subi r24,lo8(1023) |
708 066e 9340 sbci r25,hi8(1023) |
709 0670 60F4 brsh .L48 |
710 0672 8091 0000 lds r24,EE_Parameter+13 |
711 0676 85FF sbrs r24,5 |
712 0678 08C0 rjmp .L48 |
713 067a 5093 0000 sts (GPS_Nick)+1,r21 |
714 067e 4093 0000 sts GPS_Nick,r20 |
715 0682 3093 0000 sts (GPS_Roll)+1,r19 |
716 0686 2093 0000 sts GPS_Roll,r18 |
717 .L48: |
718 068a 8091 0000 lds r24,FromNaviCtrl+7 |
719 068e 9091 0000 lds r25,(FromNaviCtrl+7)+1 |
720 0692 21E0 ldi r18,hi8(361) |
721 0694 8936 cpi r24,lo8(361) |
722 0696 9207 cpc r25,r18 |
723 0698 24F4 brge .L49 |
724 069a 9093 0000 sts (KompassValue)+1,r25 |
725 069e 8093 0000 sts KompassValue,r24 |
726 .L49: |
727 06a2 8091 0000 lds r24,KompassValue |
728 06a6 9091 0000 lds r25,(KompassValue)+1 |
729 06aa 2091 0000 lds r18,KompassStartwert |
730 06ae 3091 0000 lds r19,(KompassStartwert)+1 |
731 06b2 821B sub r24,r18 |
732 06b4 930B sbc r25,r19 |
733 06b6 845E subi r24,lo8(-(540)) |
734 06b8 9D4F sbci r25,hi8(-(540)) |
735 06ba 68E6 ldi r22,lo8(360) |
736 06bc 71E0 ldi r23,hi8(360) |
737 06be 0E94 0000 call __divmodhi4 |
738 06c2 845B subi r24,lo8(-(-180)) |
739 06c4 9040 sbci r25,hi8(-(-180)) |
740 06c6 9093 0000 sts (KompassRichtung)+1,r25 |
741 06ca 8093 0000 sts KompassRichtung,r24 |
742 06ce 2091 0000 lds r18,FromNaviCtrl+11 |
743 06d2 3091 0000 lds r19,(FromNaviCtrl+11)+1 |
744 06d6 8091 0000 lds r24,beeptime |
745 06da 9091 0000 lds r25,(beeptime)+1 |
746 06de 8217 cp r24,r18 |
747 06e0 9307 cpc r25,r19 |
748 06e2 40F4 brsh .L50 |
749 06e4 8091 0000 lds r24,WinkelOut+6 |
750 06e8 8823 tst r24 |
751 06ea 21F4 brne .L50 |
752 06ec 3093 0000 sts (beeptime)+1,r19 |
753 06f0 2093 0000 sts beeptime,r18 |
754 .L50: |
755 06f4 8091 0000 lds r24,FromNaviCtrl |
756 06f8 9927 clr r25 |
757 06fa 8836 cpi r24,104 |
758 06fc 9105 cpc r25,__zero_reg__ |
759 06fe 49F1 breq .L53 |
760 0700 8936 cpi r24,105 |
761 0702 9105 cpc r25,__zero_reg__ |
762 0704 24F4 brge .L56 |
763 0706 8736 cpi r24,103 |
764 0708 9105 cpc r25,__zero_reg__ |
765 070a 31F0 breq .L52 |
766 070c 72C0 rjmp .L20 |
767 .L56: |
768 070e 8936 cpi r24,105 |
769 0710 9105 cpc r25,__zero_reg__ |
770 0712 09F4 brne .+2 |
771 0714 45C0 rjmp .L54 |
772 0716 6DC0 rjmp .L20 |
773 .L52: |
774 0718 8091 0000 lds r24,FromNaviCtrl+13 |
775 071c 8093 0000 sts FromNaviCtrl_Value,r24 |
776 0720 8091 0000 lds r24,FromNaviCtrl+14 |
777 0724 8093 0000 sts FromNaviCtrl_Value+2,r24 |
778 0728 8091 0000 lds r24,FromNaviCtrl+15 |
779 072c 8093 0000 sts FromNaviCtrl_Value+1,r24 |
780 0730 8091 0000 lds r24,FromNaviCtrl+16 |
781 0734 8093 0000 sts FromNaviCtrl_Value+3,r24 |
782 0738 8091 0000 lds r24,FromNaviCtrl+17 |
783 073c 8093 0000 sts FromNaviCtrl_Value+4,r24 |
784 0740 8091 0000 lds r24,FromNaviCtrl+18 |
785 0744 8093 0000 sts FromNC_Rotate_C,r24 |
786 0748 8091 0000 lds r24,FromNaviCtrl+19 |
787 074c 8093 0000 sts FromNC_Rotate_S,r24 |
788 0750 50C0 rjmp .L20 |
789 .L53: |
790 0752 8091 0000 lds r24,FromNaviCtrl+13 |
791 0756 8093 0000 sts NC_Version,r24 |
792 075a 8091 0000 lds r24,FromNaviCtrl+14 |
793 075e 8093 0000 sts NC_Version+1,r24 |
794 0762 8091 0000 lds r24,FromNaviCtrl+15 |
795 0766 8093 0000 sts NC_Version+2,r24 |
796 076a 8091 0000 lds r24,FromNaviCtrl+16 |
797 076e 8093 0000 sts NC_Version+3,r24 |
798 0772 8091 0000 lds r24,FromNaviCtrl+17 |
799 0776 8093 0000 sts NC_Version+4,r24 |
800 077a 8091 0000 lds r24,DebugOut |
801 077e 9091 0000 lds r25,FromNaviCtrl+18 |
802 0782 892B or r24,r25 |
803 0784 8093 0000 sts DebugOut,r24 |
804 0788 9091 0000 lds r25,FromNaviCtrl+19 |
805 078c 9093 0000 sts NC_ErrorCode,r25 |
806 0790 8091 0000 lds r24,DebugOut+1 |
807 0794 8370 andi r24,lo8(3) |
808 0796 9C70 andi r25,lo8(12) |
809 0798 892B or r24,r25 |
810 079a 8093 0000 sts DebugOut+1,r24 |
811 079e 29C0 rjmp .L20 |
812 .L54: |
813 07a0 8091 0000 lds r24,FromNaviCtrl+13 |
814 07a4 8093 0000 sts GPSInfo,r24 |
815 07a8 8091 0000 lds r24,FromNaviCtrl+14 |
816 07ac 8093 0000 sts GPSInfo+1,r24 |
817 07b0 8091 0000 lds r24,FromNaviCtrl+15 |
818 07b4 8093 0000 sts GPSInfo+2,r24 |
819 07b8 8091 0000 lds r24,FromNaviCtrl+16 |
820 07bc 8093 0000 sts GPSInfo+3,r24 |
821 07c0 8091 0000 lds r24,FromNaviCtrl+17 |
822 07c4 9091 0000 lds r25,(FromNaviCtrl+17)+1 |
823 07c8 9093 0000 sts (GPSInfo+4)+1,r25 |
824 07cc 8093 0000 sts GPSInfo+4,r24 |
825 07d0 8091 0000 lds r24,FromNaviCtrl+19 |
826 07d4 9091 0000 lds r25,(FromNaviCtrl+19)+1 |
827 07d8 9093 0000 sts (GPSInfo+6)+1,r25 |
828 07dc 8093 0000 sts GPSInfo+6,r24 |
829 07e0 08C0 rjmp .L20 |
830 .L47: |
831 07e2 1092 0000 sts (GPS_Nick)+1,__zero_reg__ |
832 07e6 1092 0000 sts GPS_Nick,__zero_reg__ |
833 07ea 1092 0000 sts (GPS_Roll)+1,__zero_reg__ |
834 07ee 1092 0000 sts GPS_Roll,__zero_reg__ |
835 .L20: |
836 /* epilogue: frame size=0 */ |
837 07f2 1F91 pop r17 |
838 07f4 0F91 pop r16 |
839 07f6 FF90 pop r15 |
840 07f8 EF90 pop r14 |
841 07fa 0895 ret |
842 /* epilogue end (size=5) */ |
843 /* function UpdateSPI_Buffer size 857 (848) */ |
845 .global SPI_StartTransmitPacket |
847 SPI_StartTransmitPacket: |
848 /* prologue: frame size=0 */ |
849 /* prologue end (size=0) */ |
850 07fc 8091 0000 lds r24,SPITransferCompleted |
851 0800 8823 tst r24 |
852 0802 09F4 brne .+2 |
853 0804 3BC0 rjmp .L59 |
854 0806 4598 cbi 40-0x20,5 |
855 0808 80E0 ldi r24,lo8(ToNaviCtrl) |
856 080a 90E0 ldi r25,hi8(ToNaviCtrl) |
857 080c 9093 0000 sts (SPI_TX_Buffer)+1,r25 |
858 0810 8093 0000 sts SPI_TX_Buffer,r24 |
859 0814 9091 0000 lds r25,SPI_CommandCounter |
860 0818 E92F mov r30,r25 |
861 081a FF27 clr r31 |
862 081c E050 subi r30,lo8(-(SPI_CommandSequence)) |
863 081e F040 sbci r31,hi8(-(SPI_CommandSequence)) |
864 0820 9F5F subi r25,lo8(-(1)) |
865 0822 9093 0000 sts SPI_CommandCounter,r25 |
866 0826 8081 ld r24,Z |
867 0828 8093 0000 sts ToNaviCtrl+2,r24 |
868 082c 9930 cpi r25,lo8(9) |
869 082e 10F0 brlo .L61 |
870 0830 1092 0000 sts SPI_CommandCounter,__zero_reg__ |
871 .L61: |
872 0834 1092 0000 sts SPITransferCompleted,__zero_reg__ |
873 0838 0E94 0000 call UpdateSPI_Buffer |
874 083c 81E0 ldi r24,lo8(1) |
875 083e 8093 0000 sts SPI_BufferIndex,r24 |
876 /* #APP */ |
877 0842 0000 nop |
878 0844 0000 nop |
879 0846 0000 nop |
880 0848 0000 nop |
881 084a 0000 nop |
882 084c 0000 nop |
883 084e 0000 nop |
884 0850 0000 nop |
885 0852 0000 nop |
886 0854 0000 nop |
887 0856 0000 nop |
888 0858 0000 nop |
889 085a 0000 nop |
890 085c 0000 nop |
891 085e 0000 nop |
892 0860 0000 nop |
893 0862 0000 nop |
894 0864 0000 nop |
895 0866 0000 nop |
896 0868 0000 nop |
897 086a 0000 nop |
898 086c 0000 nop |
899 086e 0000 nop |
900 0870 0000 nop |
901 /* #NOAPP */ |
902 0872 8091 0000 lds r24,ToNaviCtrl |
903 0876 8093 0000 sts ToNaviCtrl+31,r24 |
904 087a 8EBD out 78-0x20,r24 |
905 .L59: |
906 087c 0895 ret |
907 /* epilogue: frame size=0 */ |
908 /* epilogue: noreturn */ |
909 /* epilogue end (size=0) */ |
910 /* function SPI_StartTransmitPacket size 89 (89) */ |
912 .comm GPSInfo,8,1 |
913 .comm NC_Version,5,1 |
914 .comm FromNaviCtrl_Value,5,1 |
915 .comm ToNaviCtrl,32,1 |
916 .comm FromNaviCtrl,26,1 |
917 .comm SPI_BufferIndex,1,1 |
918 .comm SPI_RxBufferIndex,1,1 |
919 .comm SPI_Buffer,26,1 |
920 .comm SPI_TX_Buffer,2,1 |
921 .comm SPITransferCompleted,1,1 |
922 .comm SPI_ChkSum,1,1 |
923 .comm SPI_RxDataValid,1,1 |
924 /* File "spi.c": code 1143 = 0x0477 (1133), prologues 4, epilogues 6 */ |
DEFINED SYMBOLS |
*ABS*:00000000 spi.c |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccV068Pj.s:2 *ABS*:0000003f __SREG__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccV068Pj.s:3 *ABS*:0000003e __SP_H__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccV068Pj.s:4 *ABS*:0000003d __SP_L__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccV068Pj.s:5 *ABS*:00000034 __CCP__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccV068Pj.s:6 *ABS*:00000000 __tmp_reg__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccV068Pj.s:7 *ABS*:00000001 __zero_reg__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccV068Pj.s:11 .text:00000000 SPI_MasterInit |
C:\Users\Arthur-P\AppData\Local\Temp/ccM3baaa.s:3 *ABS*:0000003f __SREG__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccM3baaa.s:4 *ABS*:0000003e __SP_H__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccM3baaa.s:5 *ABS*:0000003d __SP_L__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccM3baaa.s:6 *ABS*:00000000 __tmp_reg__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccM3baaa.s:7 *ABS*:00000001 __zero_reg__ |
C:\Users\Arthur-P\AppData\Local\Temp/ccM3baaa.s:15 .bss:00000000 NC_ErrorCode |
C:\Users\Arthur-P\AppData\Local\Temp/ccM3baaa.s:21 .bss:00000001 SPI_CommandCounter |
C:\Users\Arthur-P\AppData\Local\Temp/ccM3baaa.s:27 .data:00000000 SPI_CommandSequence |
C:\Users\Arthur-P\AppData\Local\Temp/ccM3baaa.s:40 .data:00000009 NaviDataOkay |
C:\Users\Arthur-P\AppData\Local\Temp/ccM3baaa.s:47 .bss:00000002 FromNC_Rotate_S |
C:\Users\Arthur-P\AppData\Local\Temp/ccM3baaa.s:53 .data:0000000a FromNC_Rotate_C |
C:\Users\Arthur-P\AppData\Local\Temp/ccM3baaa.s:58 .text:00000000 SPI_MasterInit |
*COM*:00000001 SPITransferCompleted |
*COM*:00000020 ToNaviCtrl |
*COM*:00000005 FromNaviCtrl_Value |
*COM*:00000001 SPI_RxDataValid |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccV068Pj.s:41 .text:00000042 UpdateSPI_Buffer |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccV068Pj.s:892 .data:00000001 NaviDataOkay |
.bss:00000003 SPI_RXState.0 |
C:\Users\Arthur-P\AppData\Local\Temp/ccM3baaa.s:88 .bss:00000004 rxchksum.1 |
C:\Users\Arthur-P\AppData\Local\Temp/ccM3baaa.s:92 .text:00000042 SPI_TransmitByte |
*COM*:00000001 SPI_RxBufferIndex |
*COM*:0000001a SPI_Buffer |
*COM*:0000001a FromNaviCtrl |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccV068Pj.s:879 .data:00000000 FromNC_Rotate_C |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccV068Pj.s:886 .bss:00000000 FromNC_Rotate_S |
*COM*:00000001 SPI_BufferIndex |
*COM*:00000002 SPI_TX_Buffer |
C:\Users\Arthur-P\AppData\Local\Temp/ccM3baaa.s:233 .text:00000158 UpdateSPI_Buffer |
*COM*:00000005 NC_Version |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccV068Pj.s:918 .bss:00000002 NC_ErrorCode |
*COM*:00000008 GPSInfo |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccV068Pj.s:591 .text:00000676 SPI_StartTransmitPacket |
*COM*:00000002 SPI_TX_Buffer |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccV068Pj.s:912 .bss:00000001 SPI_CommandCounter |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccV068Pj.s:897 .data:00000002 SPI_CommandSequence |
*COM*:00000001 SPI_BufferIndex |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccV068Pj.s:702 .text:000006f8 SPI_TransmitByte |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccV068Pj.s:920 .bss:00000004 SPI_RXState.2259 |
*COM*:00000001 SPI_RxBufferIndex |
.bss:00000003 rxchksum.2261 |
*COM*:0000001a SPI_Buffer |
C:\Users\Arthur-P\AppData\Local\Temp/ccM3baaa.s:847 .text:000007fc SPI_StartTransmitPacket |
*COM*:00000001 SPI_ChkSum |
UNDEFINED SYMBOLS |
__do_copy_data |
__do_clear_bss |
SendSPI |
EE_Parameter |
IntegralNick |
__divmodsi4 |
IntegralRoll |
ErsatzKompass |
__mulsi3 |
GIER_GRAD_FAKTOR |
AdNeutralGier |
AdWertGier |
AdNeutralGier |
NaviCntAcc |
NaviAccNick |
__divmodhi4 |
991,6 → 981,3 |
KompassStartwert |
KompassRichtung |
beeptime |
SendSPI |
__do_copy_data |
__do_clear_bss |
/branches/V0.80g-Arthur-P1/timer0.lst |
---|
1,1267 → 1,1393 |
1 .file "timer0.c" |
2 __SREG__ = 0x3f |
3 __SP_H__ = 0x3e |
4 __SP_L__ = 0x3d |
5 __CCP__ = 0x34 |
2 .arch atmega644p |
3 __SREG__ = 0x3f |
4 __SP_H__ = 0x3e |
5 __SP_L__ = 0x3d |
6 __tmp_reg__ = 0 |
7 __zero_reg__ = 1 |
8 .text |
9 .global __vector_18 |
11 __vector_18: |
12 0000 1F92 push __zero_reg__ |
13 0002 0F92 push r0 |
14 0004 0FB6 in r0,__SREG__ |
15 0006 0F92 push r0 |
16 0008 1124 clr __zero_reg__ |
17 000a 2F93 push r18 |
18 000c 3F93 push r19 |
19 000e 5F93 push r21 |
20 0010 6F93 push r22 |
21 0012 7F93 push r23 |
22 0014 8F93 push r24 |
23 0016 9F93 push r25 |
24 0018 AF93 push r26 |
25 001a BF93 push r27 |
26 /* prologue: Signal */ |
27 /* frame size = 0 */ |
28 001c 8091 0000 lds r24,SendSPI |
29 0020 8823 tst r24 |
30 0022 01F0 breq .L2 |
31 0024 8091 0000 lds r24,SendSPI |
32 0028 8150 subi r24,lo8(-(-1)) |
33 002a 8093 0000 sts SendSPI,r24 |
34 .L2: |
35 002e 8091 0000 lds r24,SpektrumTimer |
36 0032 8823 tst r24 |
37 0034 01F0 breq .L3 |
38 0036 8150 subi r24,lo8(-(-1)) |
39 0038 8093 0000 sts SpektrumTimer,r24 |
40 .L3: |
41 003c 8091 0000 lds r24,cnt.2239 |
42 0040 8150 subi r24,lo8(-(-1)) |
43 0042 8093 0000 sts cnt.2239,r24 |
44 0046 8F5F subi r24,lo8(-(1)) |
45 0048 01F0 breq .+2 |
46 004a 00C0 rjmp .L4 |
47 004c 89E0 ldi r24,lo8(9) |
48 004e 8093 0000 sts cnt.2239,r24 |
49 0052 8091 0000 lds r24,CountMilliseconds |
50 0056 9091 0000 lds r25,(CountMilliseconds)+1 |
51 005a 0196 adiw r24,1 |
52 005c 9093 0000 sts (CountMilliseconds)+1,r25 |
53 0060 8093 0000 sts CountMilliseconds,r24 |
54 0064 8091 0000 lds r24,cnt_1ms.2238 |
55 0068 8F5F subi r24,lo8(-(1)) |
56 006a 8170 andi r24,lo8(1) |
57 006c 8093 0000 sts cnt_1ms.2238,r24 |
58 0070 8823 tst r24 |
59 0072 01F4 brne .L5 |
60 0074 81E0 ldi r24,lo8(1) |
61 0076 8093 0000 sts UpdateMotor,r24 |
62 .L5: |
63 007a 3499 sbic 38-32,4 |
64 007c 00C0 rjmp .L6 |
65 007e 81E0 ldi r24,lo8(1) |
66 0080 8093 0000 sts compass_active.2240,r24 |
67 .L6: |
68 0084 8091 0000 lds r24,beeptime |
69 0088 9091 0000 lds r25,(beeptime)+1 |
70 008c 892B or r24,r25 |
71 008e 01F0 breq .L7 |
72 0090 8091 0000 lds r24,beeptime |
73 0094 9091 0000 lds r25,(beeptime)+1 |
74 0098 0B97 sbiw r24,11 |
75 009a 00F0 brlo .L8 |
76 009c 8091 0000 lds r24,beeptime |
77 00a0 9091 0000 lds r25,(beeptime)+1 |
78 00a4 0A97 sbiw r24,10 |
79 00a6 9093 0000 sts (beeptime)+1,r25 |
80 00aa 8093 0000 sts beeptime,r24 |
81 00ae 00C0 rjmp .L9 |
82 .L8: |
83 00b0 1092 0000 sts (beeptime)+1,__zero_reg__ |
84 00b4 1092 0000 sts beeptime,__zero_reg__ |
85 .L9: |
86 00b8 8091 0000 lds r24,beeptime |
87 00bc 9091 0000 lds r25,(beeptime)+1 |
88 00c0 2091 0000 lds r18,BeepMuster |
89 00c4 3091 0000 lds r19,(BeepMuster)+1 |
90 00c8 8223 and r24,r18 |
91 00ca 9323 and r25,r19 |
92 00cc 892B or r24,r25 |
93 00ce 01F0 breq .+2 |
94 00d0 00C0 rjmp .L10 |
95 00d2 00C0 rjmp .L11 |
96 .L7: |
97 00d4 8FEF ldi r24,lo8(-1) |
98 00d6 9FEF ldi r25,hi8(-1) |
99 00d8 9093 0000 sts (BeepMuster)+1,r25 |
100 00dc 8093 0000 sts BeepMuster,r24 |
101 .L11: |
102 00e0 8091 0000 lds r24,PlatinenVersion |
103 00e4 8A30 cpi r24,lo8(10) |
104 00e6 01F4 brne .L22 |
105 00e8 00C0 rjmp .L24 |
106 .L25: |
107 00ea 5A9A sbi 43-32,2 |
108 00ec 00C0 rjmp .L4 |
109 .L23: |
110 00ee 479A sbi 40-32,7 |
111 00f0 00C0 rjmp .L4 |
112 .L24: |
113 00f2 5A98 cbi 43-32,2 |
114 00f4 00C0 rjmp .L4 |
115 .L22: |
116 00f6 4798 cbi 40-32,7 |
117 .L4: |
118 00f8 8091 0000 lds r24,compass_active.2240 |
119 00fc 8823 tst r24 |
120 00fe 01F4 brne .+2 |
121 0100 00C0 rjmp .L21 |
122 0102 8091 0000 lds r24,NaviDataOkay |
123 0106 8823 tst r24 |
124 0108 01F0 breq .+2 |
125 010a 00C0 rjmp .L21 |
126 010c 8091 0000 lds r24,EE_Parameter+13 |
127 0110 83FF sbrs r24,3 |
128 0112 00C0 rjmp .L21 |
129 0114 349B sbis 38-32,4 |
130 0116 00C0 rjmp .L15 |
131 0118 8091 0000 lds r24,cntKompass |
132 011c 9091 0000 lds r25,(cntKompass)+1 |
133 0120 0196 adiw r24,1 |
134 0122 9093 0000 sts (cntKompass)+1,r25 |
135 0126 8093 0000 sts cntKompass,r24 |
136 012a 8091 0000 lds r24,cntKompass |
137 012e 9091 0000 lds r25,(cntKompass)+1 |
138 0132 895E subi r24,lo8(1001) |
139 0134 9340 sbci r25,hi8(1001) |
140 0136 00F4 brsh .+2 |
141 0138 00C0 rjmp .L21 |
142 013a 1092 0000 sts compass_active.2240,__zero_reg__ |
143 013e 00C0 rjmp .L21 |
144 .L15: |
145 0140 8091 0000 lds r24,cntKompass |
146 0144 9091 0000 lds r25,(cntKompass)+1 |
147 0148 892B or r24,r25 |
148 014a 01F4 brne .+2 |
149 014c 00C0 rjmp .L16 |
150 014e 8091 0000 lds r24,cntKompass |
151 0152 9091 0000 lds r25,(cntKompass)+1 |
152 0156 8A56 subi r24,lo8(362) |
153 0158 9140 sbci r25,hi8(362) |
154 015a 00F4 brsh .L16 |
155 015c 2091 0000 lds r18,cntKompass |
156 0160 3091 0000 lds r19,(cntKompass)+1 |
157 0164 8091 0000 lds r24,cntKompass |
158 0168 9091 0000 lds r25,(cntKompass)+1 |
159 016c 69E2 ldi r22,lo8(41) |
160 016e 70E0 ldi r23,hi8(41) |
161 0170 0E94 0000 call __udivmodhi4 |
162 0174 260F add r18,r22 |
163 0176 371F adc r19,r23 |
164 0178 3093 0000 sts (cntKompass)+1,r19 |
165 017c 2093 0000 sts cntKompass,r18 |
166 0180 8091 0000 lds r24,cntKompass |
167 0184 9091 0000 lds r25,(cntKompass)+1 |
168 0188 0B97 sbiw r24,11 |
169 018a 00F0 brlo .L17 |
170 018c 8091 0000 lds r24,cntKompass |
171 0190 9091 0000 lds r25,(cntKompass)+1 |
172 0194 0A97 sbiw r24,10 |
173 0196 9093 0000 sts (KompassValue)+1,r25 |
174 019a 8093 0000 sts KompassValue,r24 |
175 019e 00C0 rjmp .L18 |
176 .L17: |
177 01a0 1092 0000 sts (KompassValue)+1,__zero_reg__ |
178 01a4 1092 0000 sts KompassValue,__zero_reg__ |
179 .L18: |
180 01a8 8091 0000 lds r24,KompassValue |
181 01ac 9091 0000 lds r25,(KompassValue)+1 |
182 01b0 845E subi r24,lo8(-(540)) |
183 01b2 9D4F sbci r25,hi8(-(540)) |
184 01b4 2091 0000 lds r18,KompassStartwert |
185 01b8 3091 0000 lds r19,(KompassStartwert)+1 |
186 01bc 821B sub r24,r18 |
187 01be 930B sbc r25,r19 |
188 01c0 68E6 ldi r22,lo8(360) |
189 01c2 71E0 ldi r23,hi8(360) |
190 01c4 0E94 0000 call __divmodhi4 |
191 01c8 845B subi r24,lo8(-(-180)) |
192 01ca 9040 sbci r25,hi8(-(-180)) |
193 01cc 9093 0000 sts (KompassRichtung)+1,r25 |
194 01d0 8093 0000 sts KompassRichtung,r24 |
195 .L16: |
196 01d4 1092 0000 sts (cntKompass)+1,__zero_reg__ |
197 01d8 1092 0000 sts cntKompass,__zero_reg__ |
198 01dc 00C0 rjmp .L21 |
199 .L10: |
200 01de 8091 0000 lds r24,PlatinenVersion |
201 01e2 8A30 cpi r24,lo8(10) |
202 01e4 01F0 breq .+2 |
203 01e6 00C0 rjmp .L23 |
204 01e8 00C0 rjmp .L25 |
205 .L21: |
206 /* epilogue start */ |
207 01ea BF91 pop r27 |
208 01ec AF91 pop r26 |
209 01ee 9F91 pop r25 |
210 01f0 8F91 pop r24 |
211 01f2 7F91 pop r23 |
212 01f4 6F91 pop r22 |
213 01f6 5F91 pop r21 |
214 01f8 3F91 pop r19 |
215 01fa 2F91 pop r18 |
216 01fc 0F90 pop r0 |
217 01fe 0FBE out __SREG__,r0 |
218 0200 0F90 pop r0 |
219 0202 1F90 pop __zero_reg__ |
220 0204 1895 reti |
222 .global SetDelay |
224 SetDelay: |
225 /* prologue: function */ |
226 /* frame size = 0 */ |
227 0206 2091 0000 lds r18,CountMilliseconds |
228 020a 3091 0000 lds r19,(CountMilliseconds)+1 |
229 020e 2F5F subi r18,lo8(-(1)) |
230 0210 3F4F sbci r19,hi8(-(1)) |
231 0212 280F add r18,r24 |
232 0214 391F adc r19,r25 |
233 0216 C901 movw r24,r18 |
234 /* epilogue start */ |
235 0218 0895 ret |
237 .global CheckDelay |
239 CheckDelay: |
240 /* prologue: function */ |
241 /* frame size = 0 */ |
242 021a 2091 0000 lds r18,CountMilliseconds |
243 021e 3091 0000 lds r19,(CountMilliseconds)+1 |
244 0222 821B sub r24,r18 |
245 0224 930B sbc r25,r19 |
246 0226 8070 andi r24,lo8(-32768) |
247 0228 9078 andi r25,hi8(-32768) |
248 022a 892F mov r24,r25 |
249 022c 8695 lsr r24 |
250 /* epilogue start */ |
251 022e 0895 ret |
253 .global Delay_ms |
255 Delay_ms: |
256 /* prologue: function */ |
257 /* frame size = 0 */ |
258 0230 2091 0000 lds r18,CountMilliseconds |
259 0234 3091 0000 lds r19,(CountMilliseconds)+1 |
260 0238 2F5F subi r18,lo8(-(1)) |
261 023a 3F4F sbci r19,hi8(-(1)) |
262 023c 280F add r18,r24 |
263 023e 391F adc r19,r25 |
264 .L31: |
265 0240 8091 0000 lds r24,CountMilliseconds |
266 0244 9091 0000 lds r25,(CountMilliseconds)+1 |
267 0248 A901 movw r20,r18 |
268 024a 481B sub r20,r24 |
269 024c 590B sbc r21,r25 |
270 024e CA01 movw r24,r20 |
271 0250 8070 andi r24,lo8(-32768) |
272 0252 9078 andi r25,hi8(-32768) |
273 0254 892F mov r24,r25 |
274 0256 8695 lsr r24 |
275 0258 01F0 breq .L31 |
276 /* epilogue start */ |
277 025a 0895 ret |
279 .global Delay_ms_Mess |
281 Delay_ms_Mess: |
282 /* prologue: function */ |
283 /* frame size = 0 */ |
284 025c 2091 0000 lds r18,CountMilliseconds |
285 0260 3091 0000 lds r19,(CountMilliseconds)+1 |
286 0264 2F5F subi r18,lo8(-(1)) |
287 0266 3F4F sbci r19,hi8(-(1)) |
288 0268 280F add r18,r24 |
289 026a 391F adc r19,r25 |
290 026c 4FEC ldi r20,lo8(-49) |
291 026e 00C0 rjmp .L40 |
292 .L36: |
293 0270 8091 0000 lds r24,AdReady |
294 0274 8823 tst r24 |
295 0276 01F0 breq .L40 |
296 0278 1092 0000 sts AdReady,__zero_reg__ |
297 027c 4093 7A00 sts 122,r20 |
298 .L40: |
299 0280 8091 0000 lds r24,CountMilliseconds |
300 0284 9091 0000 lds r25,(CountMilliseconds)+1 |
301 0288 B901 movw r22,r18 |
302 028a 681B sub r22,r24 |
303 028c 790B sbc r23,r25 |
304 028e CB01 movw r24,r22 |
305 0290 8070 andi r24,lo8(-32768) |
306 0292 9078 andi r25,hi8(-32768) |
307 0294 892F mov r24,r25 |
308 0296 8695 lsr r24 |
309 0298 01F0 breq .L36 |
310 /* epilogue start */ |
311 029a 0895 ret |
313 .global TIMER2_Init |
315 TIMER2_Init: |
316 /* prologue: function */ |
317 /* frame size = 0 */ |
318 029c 4FB7 in r20,__SREG__ |
319 029e 2091 0000 lds r18,Parameter_UserParam8 |
320 02a2 30E0 ldi r19,lo8(0) |
321 02a4 2F77 andi r18,lo8(127) |
322 02a6 3070 andi r19,hi8(127) |
323 02a8 C901 movw r24,r18 |
324 02aa 880F lsl r24 |
325 02ac 991F rol r25 |
326 02ae 880F lsl r24 |
327 02b0 991F rol r25 |
328 02b2 820F add r24,r18 |
329 02b4 931F adc r25,r19 |
330 02b6 9093 0000 sts (CameraShutterCycle)+1,r25 |
331 02ba 8093 0000 sts CameraShutterCycle,r24 |
332 /* #APP */ |
333 ; 176 "timer0.c" 1 |
334 02be F894 cli |
335 ; 0 "" 2 |
336 /* #NOAPP */ |
337 02c0 5F98 cbi 43-32,7 |
338 02c2 3E9A sbi 39-32,6 |
339 02c4 469A sbi 40-32,6 |
340 02c6 A0EB ldi r26,lo8(176) |
341 02c8 B0E0 ldi r27,hi8(176) |
342 02ca 8C91 ld r24,X |
343 02cc 8F70 andi r24,lo8(15) |
344 02ce 8C93 st X,r24 |
345 02d0 8C91 ld r24,X |
346 02d2 8360 ori r24,lo8(3) |
347 02d4 8C93 st X,r24 |
348 02d6 E1EB ldi r30,lo8(177) |
349 02d8 F0E0 ldi r31,hi8(177) |
350 02da 8081 ld r24,Z |
351 02dc 8B73 andi r24,lo8(59) |
352 02de 8083 st Z,r24 |
353 02e0 8081 ld r24,Z |
354 02e2 8B60 ori r24,lo8(11) |
355 02e4 8083 st Z,r24 |
356 02e6 1092 B200 sts 178,__zero_reg__ |
357 02ea 8FEF ldi r24,lo8(-1) |
358 02ec 8093 B300 sts 179,r24 |
359 02f0 8C91 ld r24,X |
360 02f2 8068 ori r24,lo8(-128) |
361 02f4 8C93 st X,r24 |
362 02f6 E0E7 ldi r30,lo8(112) |
363 02f8 F0E0 ldi r31,hi8(112) |
364 02fa 8081 ld r24,Z |
365 02fc 8A7F andi r24,lo8(-6) |
366 02fe 8083 st Z,r24 |
367 0300 8081 ld r24,Z |
368 0302 8260 ori r24,lo8(2) |
369 0304 8083 st Z,r24 |
370 0306 4FBF out __SREG__,r20 |
371 /* epilogue start */ |
372 0308 0895 ret |
374 .global Timer_Init |
376 Timer_Init: |
377 /* prologue: function */ |
378 /* frame size = 0 */ |
379 030a 8091 0000 lds r24,CountMilliseconds |
380 030e 9091 0000 lds r25,(CountMilliseconds)+1 |
381 0312 0B96 adiw r24,11 |
382 0314 9093 0000 sts (tim_main)+1,r25 |
383 0318 8093 0000 sts tim_main,r24 |
384 031c 82E0 ldi r24,lo8(2) |
385 031e 85BD out 69-32,r24 |
386 0320 83EA ldi r24,lo8(-93) |
387 0322 84BD out 68-32,r24 |
388 0324 17BC out 71-32,__zero_reg__ |
389 0326 84EB ldi r24,lo8(-76) |
390 0328 88BD out 72-32,r24 |
391 032a 86E0 ldi r24,lo8(6) |
392 032c 86BD out 70-32,r24 |
393 032e EEE6 ldi r30,lo8(110) |
394 0330 F0E0 ldi r31,hi8(110) |
395 0332 8081 ld r24,Z |
396 0334 8160 ori r24,lo8(1) |
397 0336 8083 st Z,r24 |
398 /* epilogue start */ |
399 0338 0895 ret |
401 .global __vector_9 |
403 __vector_9: |
404 033a 1F92 push __zero_reg__ |
405 033c 0F92 push r0 |
406 033e 0FB6 in r0,__SREG__ |
407 0340 0F92 push r0 |
408 0342 1124 clr __zero_reg__ |
409 0344 CF92 push r12 |
410 0346 DF92 push r13 |
411 0348 EF92 push r14 |
412 034a FF92 push r15 |
413 034c 0F93 push r16 |
414 034e 1F93 push r17 |
415 0350 2F93 push r18 |
416 0352 3F93 push r19 |
417 0354 4F93 push r20 |
418 0356 5F93 push r21 |
419 0358 6F93 push r22 |
420 035a 7F93 push r23 |
421 035c 8F93 push r24 |
422 035e 9F93 push r25 |
423 0360 AF93 push r26 |
424 0362 BF93 push r27 |
425 0364 EF93 push r30 |
426 0366 FF93 push r31 |
427 /* prologue: Signal */ |
428 /* frame size = 0 */ |
429 0368 8091 0000 lds r24,PlatinenVersion |
430 036c 8431 cpi r24,lo8(20) |
431 036e 00F0 brlo .+2 |
432 0370 00C0 rjmp .L46 |
433 0372 8091 0000 lds r24,Parameter_UserParam8 |
434 0376 87FD sbrc r24,7 |
435 0378 00C0 rjmp .L46 |
436 037a 8091 0000 lds r24,PulseOutput.2393 |
437 037e 8823 tst r24 |
438 0380 01F0 breq .+2 |
439 0382 00C0 rjmp .L47 |
440 0384 8091 B000 lds r24,176 |
441 0388 86FF sbrs r24,6 |
442 038a 00C0 rjmp .L48 |
443 038c 8091 B000 lds r24,176 |
444 0390 8F7B andi r24,lo8(-65) |
445 0392 8093 B000 sts 176,r24 |
446 0396 8091 0000 lds r24,Parameter_ServoNickControl |
447 039a 90E0 ldi r25,lo8(0) |
448 039c 880F lsl r24 |
449 039e 991F rol r25 |
450 03a0 880F lsl r24 |
451 03a2 991F rol r25 |
452 03a4 4091 0000 lds r20,ServoNickOffset.2397 |
453 03a8 5091 0000 lds r21,(ServoNickOffset.2397)+1 |
454 03ac 9A01 movw r18,r20 |
455 03ae 220F lsl r18 |
456 03b0 331F rol r19 |
457 03b2 240F add r18,r20 |
458 03b4 351F adc r19,r21 |
459 03b6 820F add r24,r18 |
460 03b8 931F adc r25,r19 |
461 03ba 64E0 ldi r22,lo8(4) |
462 03bc 70E0 ldi r23,hi8(4) |
463 03be 0E94 0000 call __divmodhi4 |
464 03c2 7093 0000 sts (ServoNickOffset.2397)+1,r23 |
465 03c6 6093 0000 sts ServoNickOffset.2397,r22 |
466 03ca 7093 0000 sts (ServoNickValue)+1,r23 |
467 03ce 6093 0000 sts ServoNickValue,r22 |
468 03d2 8091 0000 lds r24,EE_Parameter+98 |
469 03d6 2091 0000 lds r18,IntegralNick |
470 03da 3091 0000 lds r19,(IntegralNick)+1 |
471 03de 4091 0000 lds r20,(IntegralNick)+2 |
472 03e2 5091 0000 lds r21,(IntegralNick)+3 |
473 03e6 80FF sbrs r24,0 |
474 03e8 00C0 rjmp .L49 |
475 03ea C090 0000 lds r12,ServoNickValue |
476 03ee D090 0000 lds r13,(ServoNickValue)+1 |
477 03f2 E090 0000 lds r14,EE_Parameter+46 |
478 03f6 FF24 clr r15 |
479 03f8 00E0 ldi r16,lo8(0) |
480 03fa 10E0 ldi r17,hi8(0) |
481 03fc CA01 movw r24,r20 |
482 03fe B901 movw r22,r18 |
483 0400 20E8 ldi r18,lo8(128) |
484 0402 30E0 ldi r19,hi8(128) |
485 0404 40E0 ldi r20,hlo8(128) |
486 0406 50E0 ldi r21,hhi8(128) |
487 0408 0E94 0000 call __divmodsi4 |
488 040c C801 movw r24,r16 |
489 040e B701 movw r22,r14 |
490 0410 0E94 0000 call __mulsi3 |
491 0414 F2E0 ldi r31,2 |
492 0416 660F 1: lsl r22 |
493 0418 771F rol r23 |
494 041a 881F rol r24 |
495 041c 991F rol r25 |
496 041e FA95 dec r31 |
497 0420 01F4 brne 1b |
498 0422 20E0 ldi r18,lo8(256) |
499 0424 31E0 ldi r19,hi8(256) |
500 0426 40E0 ldi r20,hlo8(256) |
501 0428 50E0 ldi r21,hhi8(256) |
502 042a 0E94 0000 call __divmodsi4 |
503 042e C20E add r12,r18 |
504 0430 D31E adc r13,r19 |
505 0432 00C0 rjmp .L90 |
506 .L49: |
507 0434 C090 0000 lds r12,ServoNickValue |
508 0438 D090 0000 lds r13,(ServoNickValue)+1 |
509 043c E090 0000 lds r14,EE_Parameter+46 |
510 0440 FF24 clr r15 |
511 0442 00E0 ldi r16,lo8(0) |
512 0444 10E0 ldi r17,hi8(0) |
513 0446 CA01 movw r24,r20 |
514 0448 B901 movw r22,r18 |
515 044a 20E8 ldi r18,lo8(128) |
516 044c 30E0 ldi r19,hi8(128) |
517 044e 40E0 ldi r20,hlo8(128) |
518 0450 50E0 ldi r21,hhi8(128) |
519 0452 0E94 0000 call __divmodsi4 |
520 0456 C801 movw r24,r16 |
521 0458 B701 movw r22,r14 |
522 045a 0E94 0000 call __mulsi3 |
523 045e E2E0 ldi r30,2 |
524 0460 660F 1: lsl r22 |
525 0462 771F rol r23 |
526 0464 881F rol r24 |
527 0466 991F rol r25 |
528 0468 EA95 dec r30 |
529 046a 01F4 brne 1b |
530 046c 20E0 ldi r18,lo8(256) |
531 046e 31E0 ldi r19,hi8(256) |
532 0470 40E0 ldi r20,hlo8(256) |
533 0472 50E0 ldi r21,hhi8(256) |
534 0474 0E94 0000 call __divmodsi4 |
535 0478 C21A sub r12,r18 |
536 047a D30A sbc r13,r19 |
537 .L90: |
538 047c D092 0000 sts (ServoNickValue)+1,r13 |
539 0480 C092 0000 sts ServoNickValue,r12 |
540 0484 2091 0000 lds r18,ServoNickValue |
541 0488 3091 0000 lds r19,(ServoNickValue)+1 |
542 048c 8091 0000 lds r24,EE_Parameter+47 |
543 0490 90E0 ldi r25,lo8(0) |
544 0492 880F lsl r24 |
545 0494 991F rol r25 |
546 0496 880F lsl r24 |
547 0498 991F rol r25 |
548 049a 2817 cp r18,r24 |
549 049c 3907 cpc r19,r25 |
550 049e 04F0 brlt .L91 |
551 .L51: |
552 04a0 2091 0000 lds r18,ServoNickValue |
553 04a4 3091 0000 lds r19,(ServoNickValue)+1 |
554 04a8 8091 0000 lds r24,EE_Parameter+48 |
555 04ac 90E0 ldi r25,lo8(0) |
556 04ae 880F lsl r24 |
557 04b0 991F rol r25 |
558 04b2 880F lsl r24 |
559 04b4 991F rol r25 |
560 04b6 8217 cp r24,r18 |
561 04b8 9307 cpc r25,r19 |
562 04ba 04F4 brge .L52 |
563 .L91: |
564 04bc 9093 0000 sts (ServoNickValue)+1,r25 |
565 04c0 8093 0000 sts ServoNickValue,r24 |
566 .L52: |
567 04c4 2091 0000 lds r18,ServoNickValue |
568 04c8 3091 0000 lds r19,(ServoNickValue)+1 |
569 04cc 2755 subi r18,lo8(-(425)) |
570 04ce 3E4F sbci r19,hi8(-(425)) |
571 04d0 3093 0000 sts (RemainingPulse.2394)+1,r19 |
572 04d4 2093 0000 sts RemainingPulse.2394,r18 |
573 04d8 8091 0000 lds r24,ServoNickValue |
574 04dc 9091 0000 lds r25,(ServoNickValue)+1 |
575 04e0 64E0 ldi r22,lo8(4) |
576 04e2 70E0 ldi r23,hi8(4) |
577 04e4 0E94 0000 call __divmodhi4 |
578 04e8 7093 0000 sts (ServoNickValue)+1,r23 |
579 04ec 6093 0000 sts ServoNickValue,r22 |
580 04f0 45E0 ldi r20,hi8(1501) |
581 04f2 2D3D cpi r18,lo8(1501) |
582 04f4 3407 cpc r19,r20 |
583 04f6 00F0 brlo .L53 |
584 04f8 8CED ldi r24,lo8(1500) |
585 04fa 95E0 ldi r25,hi8(1500) |
586 04fc 00C0 rjmp .L92 |
587 .L53: |
588 04fe 2757 subi r18,lo8(375) |
589 0500 3140 sbci r19,hi8(375) |
590 0502 00F4 brsh .L54 |
591 0504 87E7 ldi r24,lo8(375) |
592 0506 91E0 ldi r25,hi8(375) |
593 .L92: |
594 0508 9093 0000 sts (RemainingPulse.2394)+1,r25 |
595 050c 8093 0000 sts RemainingPulse.2394,r24 |
596 .L54: |
597 0510 8091 0000 lds r24,RemainingPulse.2394 |
598 0514 9091 0000 lds r25,(RemainingPulse.2394)+1 |
599 0518 00C0 rjmp .L103 |
600 .L48: |
601 051a 8091 B000 lds r24,176 |
602 051e 8064 ori r24,lo8(64) |
603 0520 8093 B000 sts 176,r24 |
604 0524 8091 0000 lds r24,EE_Parameter+53 |
605 0528 90E0 ldi r25,lo8(0) |
606 052a 2DED ldi r18,lo8(1757) |
607 052c 36E0 ldi r19,hi8(1757) |
608 052e AC01 movw r20,r24 |
609 0530 429F mul r20,r18 |
610 0532 C001 movw r24,r0 |
611 0534 439F mul r20,r19 |
612 0536 900D add r25,r0 |
613 0538 529F mul r21,r18 |
614 053a 900D add r25,r0 |
615 053c 1124 clr r1 |
616 053e 2091 0000 lds r18,ServoFrameTime.2395 |
617 0542 3091 0000 lds r19,(ServoFrameTime.2395)+1 |
618 0546 821B sub r24,r18 |
619 0548 930B sbc r25,r19 |
620 054a 9093 0000 sts (RemainingPulse.2394)+1,r25 |
621 054e 8093 0000 sts RemainingPulse.2394,r24 |
622 0552 00C0 rjmp .L58 |
623 .L46: |
624 0554 8091 0000 lds r24,PulseOutput.2393 |
625 0558 8823 tst r24 |
626 055a 01F0 breq .+2 |
627 055c 00C0 rjmp .L47 |
628 055e 8091 B000 lds r24,176 |
629 0562 86FF sbrs r24,6 |
630 0564 00C0 rjmp .L56 |
631 0566 8091 B000 lds r24,176 |
632 056a 8F7B andi r24,lo8(-65) |
633 056c 8093 B000 sts 176,r24 |
634 0570 E091 0000 lds r30,ServoIndex.2396 |
635 0574 EE23 tst r30 |
636 0576 01F4 brne .L57 |
637 0578 8091 0000 lds r24,EE_Parameter+53 |
638 057c 90E0 ldi r25,lo8(0) |
639 057e 2DED ldi r18,lo8(1757) |
640 0580 36E0 ldi r19,hi8(1757) |
641 0582 AC01 movw r20,r24 |
642 0584 429F mul r20,r18 |
643 0586 C001 movw r24,r0 |
644 0588 439F mul r20,r19 |
645 058a 900D add r25,r0 |
646 058c 529F mul r21,r18 |
647 058e 900D add r25,r0 |
648 0590 1124 clr r1 |
649 0592 2091 0000 lds r18,ServoFrameTime.2395 |
650 0596 3091 0000 lds r19,(ServoFrameTime.2395)+1 |
651 059a 821B sub r24,r18 |
652 059c 930B sbc r25,r19 |
653 059e 9093 0000 sts (RemainingPulse.2394)+1,r25 |
654 05a2 8093 0000 sts RemainingPulse.2394,r24 |
655 05a6 1092 0000 sts (ServoFrameTime.2395)+1,__zero_reg__ |
656 05aa 1092 0000 sts ServoFrameTime.2395,__zero_reg__ |
657 05ae 469A sbi 40-32,6 |
658 05b0 00C0 rjmp .L58 |
659 .L57: |
660 05b2 49EA ldi r20,lo8(937) |
661 05b4 53E0 ldi r21,hi8(937) |
662 05b6 5093 0000 sts (RemainingPulse.2394)+1,r21 |
663 05ba 4093 0000 sts RemainingPulse.2394,r20 |
664 05be E330 cpi r30,lo8(3) |
665 05c0 01F4 brne .+2 |
666 05c2 00C0 rjmp .L62 |
667 05c4 E430 cpi r30,lo8(4) |
668 05c6 00F4 brsh .L65 |
669 05c8 E130 cpi r30,lo8(1) |
670 05ca 01F0 breq .L60 |
671 05cc E230 cpi r30,lo8(2) |
672 05ce 01F0 breq .+2 |
673 05d0 00C0 rjmp .L59 |
674 05d2 00C0 rjmp .L104 |
675 .L65: |
676 05d4 E430 cpi r30,lo8(4) |
677 05d6 01F4 brne .+2 |
678 05d8 00C0 rjmp .L63 |
679 05da E530 cpi r30,lo8(5) |
680 05dc 01F0 breq .+2 |
681 05de 00C0 rjmp .L59 |
682 05e0 00C0 rjmp .L105 |
683 .L60: |
684 05e2 8091 0000 lds r24,Parameter_ServoNickControl |
685 05e6 90E0 ldi r25,lo8(0) |
686 05e8 880F lsl r24 |
687 05ea 991F rol r25 |
688 05ec 880F lsl r24 |
689 05ee 991F rol r25 |
690 05f0 4091 0000 lds r20,ServoNickOffset.2397 |
691 05f4 5091 0000 lds r21,(ServoNickOffset.2397)+1 |
692 05f8 9A01 movw r18,r20 |
693 05fa 220F lsl r18 |
694 05fc 331F rol r19 |
695 05fe 240F add r18,r20 |
696 0600 351F adc r19,r21 |
697 0602 820F add r24,r18 |
698 0604 931F adc r25,r19 |
699 0606 64E0 ldi r22,lo8(4) |
700 0608 70E0 ldi r23,hi8(4) |
701 060a 0E94 0000 call __divmodhi4 |
702 060e 7093 0000 sts (ServoNickOffset.2397)+1,r23 |
703 0612 6093 0000 sts ServoNickOffset.2397,r22 |
704 0616 7093 0000 sts (ServoNickValue)+1,r23 |
705 061a 6093 0000 sts ServoNickValue,r22 |
706 061e 8091 0000 lds r24,EE_Parameter+98 |
707 0622 2091 0000 lds r18,IntegralNick |
708 0626 3091 0000 lds r19,(IntegralNick)+1 |
709 062a 4091 0000 lds r20,(IntegralNick)+2 |
710 062e 5091 0000 lds r21,(IntegralNick)+3 |
711 0632 80FF sbrs r24,0 |
712 0634 00C0 rjmp .L66 |
713 0636 C090 0000 lds r12,ServoNickValue |
714 063a D090 0000 lds r13,(ServoNickValue)+1 |
715 063e E090 0000 lds r14,EE_Parameter+46 |
716 0642 FF24 clr r15 |
717 0644 00E0 ldi r16,lo8(0) |
718 0646 10E0 ldi r17,hi8(0) |
719 0648 CA01 movw r24,r20 |
720 064a B901 movw r22,r18 |
721 064c 20E8 ldi r18,lo8(128) |
722 064e 30E0 ldi r19,hi8(128) |
723 0650 40E0 ldi r20,hlo8(128) |
724 0652 50E0 ldi r21,hhi8(128) |
725 0654 0E94 0000 call __divmodsi4 |
726 0658 C801 movw r24,r16 |
727 065a B701 movw r22,r14 |
728 065c 0E94 0000 call __mulsi3 |
729 0660 B2E0 ldi r27,2 |
730 0662 660F 1: lsl r22 |
731 0664 771F rol r23 |
732 0666 881F rol r24 |
733 0668 991F rol r25 |
734 066a BA95 dec r27 |
735 066c 01F4 brne 1b |
736 066e 20E0 ldi r18,lo8(256) |
737 0670 31E0 ldi r19,hi8(256) |
738 0672 40E0 ldi r20,hlo8(256) |
739 0674 50E0 ldi r21,hhi8(256) |
740 0676 0E94 0000 call __divmodsi4 |
741 067a C20E add r12,r18 |
742 067c D31E adc r13,r19 |
743 067e 00C0 rjmp .L93 |
744 .L66: |
745 0680 C090 0000 lds r12,ServoNickValue |
746 0684 D090 0000 lds r13,(ServoNickValue)+1 |
747 0688 E090 0000 lds r14,EE_Parameter+46 |
748 068c FF24 clr r15 |
749 068e 00E0 ldi r16,lo8(0) |
750 0690 10E0 ldi r17,hi8(0) |
751 0692 CA01 movw r24,r20 |
752 0694 B901 movw r22,r18 |
753 0696 20E8 ldi r18,lo8(128) |
754 0698 30E0 ldi r19,hi8(128) |
755 069a 40E0 ldi r20,hlo8(128) |
756 069c 50E0 ldi r21,hhi8(128) |
757 069e 0E94 0000 call __divmodsi4 |
758 06a2 C801 movw r24,r16 |
759 06a4 B701 movw r22,r14 |
760 06a6 0E94 0000 call __mulsi3 |
761 06aa A2E0 ldi r26,2 |
762 06ac 660F 1: lsl r22 |
763 06ae 771F rol r23 |
764 06b0 881F rol r24 |
765 06b2 991F rol r25 |
766 06b4 AA95 dec r26 |
767 06b6 01F4 brne 1b |
768 06b8 20E0 ldi r18,lo8(256) |
769 06ba 31E0 ldi r19,hi8(256) |
770 06bc 40E0 ldi r20,hlo8(256) |
771 06be 50E0 ldi r21,hhi8(256) |
772 06c0 0E94 0000 call __divmodsi4 |
773 06c4 C21A sub r12,r18 |
774 06c6 D30A sbc r13,r19 |
775 .L93: |
776 06c8 D092 0000 sts (ServoNickValue)+1,r13 |
777 06cc C092 0000 sts ServoNickValue,r12 |
778 06d0 2091 0000 lds r18,ServoNickValue |
779 06d4 3091 0000 lds r19,(ServoNickValue)+1 |
780 06d8 8091 0000 lds r24,EE_Parameter+47 |
781 06dc 90E0 ldi r25,lo8(0) |
782 06de 880F lsl r24 |
783 06e0 991F rol r25 |
784 06e2 880F lsl r24 |
785 06e4 991F rol r25 |
786 06e6 2817 cp r18,r24 |
787 06e8 3907 cpc r19,r25 |
788 06ea 04F0 brlt .L94 |
789 .L68: |
790 06ec 2091 0000 lds r18,ServoNickValue |
791 06f0 3091 0000 lds r19,(ServoNickValue)+1 |
792 06f4 8091 0000 lds r24,EE_Parameter+48 |
793 06f8 90E0 ldi r25,lo8(0) |
794 06fa 880F lsl r24 |
795 06fc 991F rol r25 |
796 06fe 880F lsl r24 |
797 0700 991F rol r25 |
798 0702 8217 cp r24,r18 |
799 0704 9307 cpc r25,r19 |
800 0706 04F4 brge .L69 |
801 .L94: |
802 0708 9093 0000 sts (ServoNickValue)+1,r25 |
803 070c 8093 0000 sts ServoNickValue,r24 |
804 .L69: |
805 0710 8091 0000 lds r24,ServoNickValue |
806 0714 9091 0000 lds r25,(ServoNickValue)+1 |
807 0718 8755 subi r24,lo8(-(425)) |
808 071a 9E4F sbci r25,hi8(-(425)) |
809 071c 9093 0000 sts (RemainingPulse.2394)+1,r25 |
810 0720 8093 0000 sts RemainingPulse.2394,r24 |
811 0724 8091 0000 lds r24,ServoNickValue |
812 0728 9091 0000 lds r25,(ServoNickValue)+1 |
813 072c 64E0 ldi r22,lo8(4) |
814 072e 70E0 ldi r23,hi8(4) |
815 0730 0E94 0000 call __divmodhi4 |
816 0734 7093 0000 sts (ServoNickValue)+1,r23 |
817 0738 6093 0000 sts ServoNickValue,r22 |
818 073c 00C0 rjmp .L70 |
819 .L104: |
820 073e 8091 0000 lds r24,Parameter_ServoRollControl |
821 0742 90E0 ldi r25,lo8(0) |
822 0744 880F lsl r24 |
823 0746 991F rol r25 |
824 0748 880F lsl r24 |
825 074a 991F rol r25 |
826 074c 4091 0000 lds r20,ServoRollOffset.2398 |
827 0750 5091 0000 lds r21,(ServoRollOffset.2398)+1 |
828 0754 9A01 movw r18,r20 |
829 0756 220F lsl r18 |
830 0758 331F rol r19 |
831 075a 240F add r18,r20 |
832 075c 351F adc r19,r21 |
833 075e 820F add r24,r18 |
834 0760 931F adc r25,r19 |
835 0762 64E0 ldi r22,lo8(4) |
836 0764 70E0 ldi r23,hi8(4) |
837 0766 0E94 0000 call __divmodhi4 |
838 076a 7093 0000 sts (ServoRollOffset.2398)+1,r23 |
839 076e 6093 0000 sts ServoRollOffset.2398,r22 |
840 0772 7093 0000 sts (ServoRollValue)+1,r23 |
841 0776 6093 0000 sts ServoRollValue,r22 |
842 077a 8091 0000 lds r24,EE_Parameter+98 |
843 077e 2091 0000 lds r18,IntegralRoll |
844 0782 3091 0000 lds r19,(IntegralRoll)+1 |
845 0786 4091 0000 lds r20,(IntegralRoll)+2 |
846 078a 5091 0000 lds r21,(IntegralRoll)+3 |
847 078e 81FF sbrs r24,1 |
848 0790 00C0 rjmp .L71 |
849 0792 C090 0000 lds r12,ServoRollValue |
850 0796 D090 0000 lds r13,(ServoRollValue)+1 |
851 079a E090 0000 lds r14,EE_Parameter+50 |
852 079e FF24 clr r15 |
853 07a0 00E0 ldi r16,lo8(0) |
854 07a2 10E0 ldi r17,hi8(0) |
855 07a4 CA01 movw r24,r20 |
856 07a6 B901 movw r22,r18 |
857 07a8 20E8 ldi r18,lo8(128) |
858 07aa 30E0 ldi r19,hi8(128) |
859 07ac 40E0 ldi r20,hlo8(128) |
860 07ae 50E0 ldi r21,hhi8(128) |
861 07b0 0E94 0000 call __divmodsi4 |
862 07b4 C801 movw r24,r16 |
863 07b6 B701 movw r22,r14 |
864 07b8 0E94 0000 call __mulsi3 |
865 07bc 22E0 ldi r18,2 |
866 07be 660F 1: lsl r22 |
867 07c0 771F rol r23 |
868 07c2 881F rol r24 |
869 07c4 991F rol r25 |
870 07c6 2A95 dec r18 |
871 07c8 01F4 brne 1b |
872 07ca 20E0 ldi r18,lo8(256) |
873 07cc 31E0 ldi r19,hi8(256) |
874 07ce 40E0 ldi r20,hlo8(256) |
875 07d0 50E0 ldi r21,hhi8(256) |
876 07d2 0E94 0000 call __divmodsi4 |
877 07d6 C20E add r12,r18 |
878 07d8 D31E adc r13,r19 |
879 07da 00C0 rjmp .L95 |
880 .L71: |
881 07dc C090 0000 lds r12,ServoRollValue |
882 07e0 D090 0000 lds r13,(ServoRollValue)+1 |
883 07e4 E090 0000 lds r14,EE_Parameter+50 |
884 07e8 FF24 clr r15 |
885 07ea 00E0 ldi r16,lo8(0) |
886 07ec 10E0 ldi r17,hi8(0) |
887 07ee CA01 movw r24,r20 |
888 07f0 B901 movw r22,r18 |
889 07f2 20E8 ldi r18,lo8(128) |
890 07f4 30E0 ldi r19,hi8(128) |
891 07f6 40E0 ldi r20,hlo8(128) |
892 07f8 50E0 ldi r21,hhi8(128) |
893 07fa 0E94 0000 call __divmodsi4 |
894 07fe C801 movw r24,r16 |
895 0800 B701 movw r22,r14 |
896 0802 0E94 0000 call __mulsi3 |
897 0806 02E0 ldi r16,2 |
898 0808 660F 1: lsl r22 |
899 080a 771F rol r23 |
900 080c 881F rol r24 |
901 080e 991F rol r25 |
902 0810 0A95 dec r16 |
903 0812 01F4 brne 1b |
904 0814 20E0 ldi r18,lo8(256) |
905 0816 31E0 ldi r19,hi8(256) |
906 0818 40E0 ldi r20,hlo8(256) |
907 081a 50E0 ldi r21,hhi8(256) |
908 081c 0E94 0000 call __divmodsi4 |
909 0820 C21A sub r12,r18 |
910 0822 D30A sbc r13,r19 |
911 .L95: |
912 0824 D092 0000 sts (ServoRollValue)+1,r13 |
913 0828 C092 0000 sts ServoRollValue,r12 |
914 082c 2091 0000 lds r18,ServoRollValue |
915 0830 3091 0000 lds r19,(ServoRollValue)+1 |
916 0834 8091 0000 lds r24,EE_Parameter+51 |
917 0838 90E0 ldi r25,lo8(0) |
918 083a 880F lsl r24 |
919 083c 991F rol r25 |
920 083e 880F lsl r24 |
921 0840 991F rol r25 |
922 0842 2817 cp r18,r24 |
923 0844 3907 cpc r19,r25 |
924 0846 04F0 brlt .L96 |
925 .L73: |
926 0848 2091 0000 lds r18,ServoRollValue |
927 084c 3091 0000 lds r19,(ServoRollValue)+1 |
928 0850 8091 0000 lds r24,EE_Parameter+52 |
929 0854 90E0 ldi r25,lo8(0) |
930 0856 880F lsl r24 |
931 0858 991F rol r25 |
932 085a 880F lsl r24 |
933 085c 991F rol r25 |
934 085e 8217 cp r24,r18 |
935 0860 9307 cpc r25,r19 |
936 0862 04F4 brge .L74 |
937 .L96: |
938 0864 9093 0000 sts (ServoRollValue)+1,r25 |
939 0868 8093 0000 sts ServoRollValue,r24 |
940 .L74: |
941 086c 8091 0000 lds r24,ServoRollValue |
942 0870 9091 0000 lds r25,(ServoRollValue)+1 |
943 0874 8755 subi r24,lo8(-(425)) |
944 0876 9E4F sbci r25,hi8(-(425)) |
945 0878 9093 0000 sts (RemainingPulse.2394)+1,r25 |
946 087c 8093 0000 sts RemainingPulse.2394,r24 |
947 0880 8091 0000 lds r24,ServoRollValue |
948 0884 9091 0000 lds r25,(ServoRollValue)+1 |
949 0888 64E0 ldi r22,lo8(4) |
950 088a 70E0 ldi r23,hi8(4) |
951 088c 0E94 0000 call __divmodhi4 |
952 0890 7093 0000 sts (ServoRollValue)+1,r23 |
953 0894 6093 0000 sts ServoRollValue,r22 |
954 0898 00C0 rjmp .L70 |
955 .L62: |
956 089a 8091 0000 lds r24,EE_Parameter+7 |
957 089e E82F mov r30,r24 |
958 08a0 F0E0 ldi r31,lo8(0) |
959 08a2 EE0F lsl r30 |
960 08a4 FF1F rol r31 |
961 08a6 E050 subi r30,lo8(-(PPM_in)) |
962 08a8 F040 sbci r31,hi8(-(PPM_in)) |
963 08aa 8081 ld r24,Z |
964 08ac 9181 ldd r25,Z+1 |
965 08ae 805E subi r24,lo8(-32) |
966 08b0 9F4F sbci r25,hi8(-32) |
967 08b2 04F0 brlt .L101 |
968 .L75: |
969 08b4 8081 ld r24,Z |
970 08b6 9181 ldd r25,Z+1 |
971 08b8 8197 sbiw r24,33 |
972 08ba 04F0 brlt .L76 |
973 08bc 8CED ldi r24,lo8(1500) |
974 08be 95E0 ldi r25,hi8(1500) |
975 08c0 00C0 rjmp .L97 |
976 .L76: |
977 08c2 8091 0000 lds r24,CameraShutterCycle |
978 08c6 9091 0000 lds r25,(CameraShutterCycle)+1 |
979 08ca C297 sbiw r24,50 |
980 08cc 00F0 brlo .L98 |
981 .L77: |
982 08ce 2091 0000 lds r18,CameraShutterCycleCounter |
983 08d2 3091 0000 lds r19,(CameraShutterCycleCounter)+1 |
984 08d6 8091 0000 lds r24,CameraShutterCycle |
985 08da 9091 0000 lds r25,(CameraShutterCycle)+1 |
986 08de 2817 cp r18,r24 |
987 08e0 3907 cpc r19,r25 |
988 08e2 01F4 brne .L78 |
989 08e4 1092 0000 sts (CameraShutterCycleCounter)+1,__zero_reg__ |
990 08e8 1092 0000 sts CameraShutterCycleCounter,__zero_reg__ |
991 .L98: |
992 08ec 5093 0000 sts (RemainingPulse.2394)+1,r21 |
993 08f0 4093 0000 sts RemainingPulse.2394,r20 |
994 08f4 00C0 rjmp .L70 |
995 .L78: |
996 08f6 8091 0000 lds r24,CameraShutterCycleCounter |
997 08fa 9091 0000 lds r25,(CameraShutterCycleCounter)+1 |
998 08fe 0196 adiw r24,1 |
999 0900 9093 0000 sts (CameraShutterCycleCounter)+1,r25 |
1000 0904 8093 0000 sts CameraShutterCycleCounter,r24 |
1001 0908 2091 0000 lds r18,CameraShutterCycleCounter |
1002 090c 3091 0000 lds r19,(CameraShutterCycleCounter)+1 |
1003 0910 8091 0000 lds r24,CameraShutterCycleOnCount |
1004 0914 9091 0000 lds r25,(CameraShutterCycleOnCount)+1 |
1005 0918 2817 cp r18,r24 |
1006 091a 3907 cpc r19,r25 |
1007 091c 01F4 brne .L70 |
1008 .L101: |
1009 091e 87E7 ldi r24,lo8(375) |
1010 0920 91E0 ldi r25,hi8(375) |
1011 0922 00C0 rjmp .L97 |
1012 .L63: |
1013 0924 8091 0000 lds r24,Parameter_Servo4 |
1014 0928 00C0 rjmp .L102 |
1015 .L105: |
1016 092a 8091 0000 lds r24,Parameter_Servo5 |
1017 .L102: |
1018 092e 90E0 ldi r25,lo8(0) |
1019 0930 880F lsl r24 |
1020 0932 991F rol r25 |
1021 0934 880F lsl r24 |
1022 0936 991F rol r25 |
1023 0938 8755 subi r24,lo8(-(425)) |
1024 093a 9E4F sbci r25,hi8(-(425)) |
1025 093c 00C0 rjmp .L97 |
1026 .L59: |
1027 093e F0E0 ldi r31,lo8(0) |
1028 0940 EE0F lsl r30 |
1029 0942 FF1F rol r31 |
1030 0944 E050 subi r30,lo8(-(PPM_in)) |
1031 0946 F040 sbci r31,hi8(-(PPM_in)) |
1032 0948 8081 ld r24,Z |
1033 094a 9181 ldd r25,Z+1 |
1034 094c 880F lsl r24 |
1035 094e 991F rol r25 |
1036 0950 8755 subi r24,lo8(-(937)) |
1037 0952 9C4F sbci r25,hi8(-(937)) |
1038 .L97: |
1039 0954 9093 0000 sts (RemainingPulse.2394)+1,r25 |
1040 0958 8093 0000 sts RemainingPulse.2394,r24 |
1041 .L70: |
1042 095c 8091 0000 lds r24,RemainingPulse.2394 |
1043 0960 9091 0000 lds r25,(RemainingPulse.2394)+1 |
1044 0964 45E0 ldi r20,hi8(1501) |
1045 0966 8D3D cpi r24,lo8(1501) |
1046 0968 9407 cpc r25,r20 |
1047 096a 00F0 brlo .L79 |
1048 096c 8CED ldi r24,lo8(1500) |
1049 096e 95E0 ldi r25,hi8(1500) |
1050 0970 00C0 rjmp .L99 |
1051 .L79: |
1052 0972 8757 subi r24,lo8(375) |
1053 0974 9140 sbci r25,hi8(375) |
1054 0976 00F4 brsh .L80 |
1055 0978 87E7 ldi r24,lo8(375) |
1056 097a 91E0 ldi r25,hi8(375) |
1057 .L99: |
1058 097c 9093 0000 sts (RemainingPulse.2394)+1,r25 |
1059 0980 8093 0000 sts RemainingPulse.2394,r24 |
1060 .L80: |
1061 0984 2091 0000 lds r18,RemainingPulse.2394 |
1062 0988 3091 0000 lds r19,(RemainingPulse.2394)+1 |
1063 098c 2C5B subi r18,lo8(-(-188)) |
1064 098e 3040 sbci r19,hi8(-(-188)) |
1065 0990 3093 0000 sts (RemainingPulse.2394)+1,r19 |
1066 0994 2093 0000 sts RemainingPulse.2394,r18 |
1067 0998 8091 0000 lds r24,ServoFrameTime.2395 |
1068 099c 9091 0000 lds r25,(ServoFrameTime.2395)+1 |
1069 09a0 820F add r24,r18 |
1070 09a2 931F adc r25,r19 |
1071 .L103: |
1072 09a4 9093 0000 sts (ServoFrameTime.2395)+1,r25 |
1073 09a8 8093 0000 sts ServoFrameTime.2395,r24 |
1074 09ac 00C0 rjmp .L58 |
1075 .L56: |
1076 09ae 8091 B000 lds r24,176 |
1077 09b2 8064 ori r24,lo8(64) |
1078 09b4 8093 B000 sts 176,r24 |
1079 09b8 8CEB ldi r24,lo8(188) |
1080 09ba 90E0 ldi r25,hi8(188) |
1081 09bc 9093 0000 sts (RemainingPulse.2394)+1,r25 |
1082 09c0 8093 0000 sts RemainingPulse.2394,r24 |
1083 09c4 8091 0000 lds r24,ServoFrameTime.2395 |
1084 09c8 9091 0000 lds r25,(ServoFrameTime.2395)+1 |
1085 09cc 8454 subi r24,lo8(-(188)) |
1086 09ce 9F4F sbci r25,hi8(-(188)) |
1087 09d0 9093 0000 sts (ServoFrameTime.2395)+1,r25 |
1088 09d4 8093 0000 sts ServoFrameTime.2395,r24 |
1089 09d8 8091 0000 lds r24,ServoActive |
1090 09dc 8823 tst r24 |
1091 09de 01F0 breq .L81 |
1092 09e0 8091 0000 lds r24,SenderOkay |
1093 09e4 853B cpi r24,lo8(-75) |
1094 09e6 00F4 brsh .L82 |
1095 .L81: |
1096 09e8 8091 0000 lds r24,ServoActive |
1097 09ec 8230 cpi r24,lo8(2) |
1098 09ee 01F4 brne .L83 |
1099 .L82: |
1100 09f0 4698 cbi 40-32,6 |
1101 09f2 00C0 rjmp .L84 |
1102 .L83: |
1103 09f4 469A sbi 40-32,6 |
1104 .L84: |
1105 09f6 8091 0000 lds r24,ServoIndex.2396 |
1106 09fa 8F5F subi r24,lo8(-(1)) |
1107 09fc 8093 0000 sts ServoIndex.2396,r24 |
1108 0a00 9091 0000 lds r25,EE_Parameter+53 |
1109 0a04 9817 cp r25,r24 |
1110 0a06 00F4 brsh .L58 |
1111 0a08 1092 0000 sts ServoIndex.2396,__zero_reg__ |
1112 .L58: |
1113 0a0c 81E0 ldi r24,lo8(1) |
1114 0a0e 8093 0000 sts PulseOutput.2393,r24 |
1115 .L47: |
1116 0a12 2091 0000 lds r18,RemainingPulse.2394 |
1117 0a16 3091 0000 lds r19,(RemainingPulse.2394)+1 |
1118 0a1a 81E0 ldi r24,hi8(383) |
1119 0a1c 2F37 cpi r18,lo8(383) |
1120 0a1e 3807 cpc r19,r24 |
1121 0a20 00F0 brlo .L85 |
1122 0a22 8FEF ldi r24,lo8(-1) |
1123 0a24 8093 B300 sts 179,r24 |
1124 0a28 2F5F subi r18,lo8(-(-255)) |
1125 0a2a 3040 sbci r19,hi8(-(-255)) |
1126 0a2c 00C0 rjmp .L100 |
1127 .L85: |
1128 0a2e 2F3F cpi r18,255 |
1129 0a30 3105 cpc r19,__zero_reg__ |
1130 0a32 01F0 breq .L87 |
1131 0a34 00F0 brlo .L87 |
1132 0a36 A901 movw r20,r18 |
1133 0a38 4F5F subi r20,lo8(-(-255)) |
1134 0a3a 5040 sbci r21,hi8(-(-255)) |
1135 0a3c 4F37 cpi r20,127 |
1136 0a3e 5105 cpc r21,__zero_reg__ |
1137 0a40 00F4 brsh .L88 |
1138 0a42 80E8 ldi r24,lo8(-128) |
1139 0a44 8093 B300 sts 179,r24 |
1140 0a48 2058 subi r18,lo8(-(-128)) |
1141 0a4a 3040 sbci r19,hi8(-(-128)) |
1142 .L100: |
1143 0a4c 3093 0000 sts (RemainingPulse.2394)+1,r19 |
1144 0a50 2093 0000 sts RemainingPulse.2394,r18 |
1145 0a54 00C0 rjmp .L89 |
1146 .L88: |
1147 0a56 8FEF ldi r24,lo8(-1) |
1148 0a58 8093 B300 sts 179,r24 |
1149 0a5c 5093 0000 sts (RemainingPulse.2394)+1,r21 |
1150 0a60 4093 0000 sts RemainingPulse.2394,r20 |
1151 0a64 00C0 rjmp .L89 |
1152 .L87: |
1153 0a66 2093 B300 sts 179,r18 |
1154 0a6a 1092 0000 sts (RemainingPulse.2394)+1,__zero_reg__ |
1155 0a6e 1092 0000 sts RemainingPulse.2394,__zero_reg__ |
1156 0a72 1092 0000 sts PulseOutput.2393,__zero_reg__ |
1157 .L89: |
1158 /* epilogue start */ |
1159 0a76 FF91 pop r31 |
1160 0a78 EF91 pop r30 |
1161 0a7a BF91 pop r27 |
1162 0a7c AF91 pop r26 |
1163 0a7e 9F91 pop r25 |
1164 0a80 8F91 pop r24 |
1165 0a82 7F91 pop r23 |
1166 0a84 6F91 pop r22 |
1167 0a86 5F91 pop r21 |
1168 0a88 4F91 pop r20 |
1169 0a8a 3F91 pop r19 |
1170 0a8c 2F91 pop r18 |
1171 0a8e 1F91 pop r17 |
1172 0a90 0F91 pop r16 |
1173 0a92 FF90 pop r15 |
1174 0a94 EF90 pop r14 |
1175 0a96 DF90 pop r13 |
1176 0a98 CF90 pop r12 |
1177 0a9a 0F90 pop r0 |
1178 0a9c 0FBE out __SREG__,r0 |
1179 0a9e 0F90 pop r0 |
1180 0aa0 1F90 pop __zero_reg__ |
1181 0aa2 1895 reti |
1183 .global CountMilliseconds |
1184 .global CountMilliseconds |
1185 .section .bss |
1188 CountMilliseconds: |
1189 0000 0000 .skip 2,0 |
1190 .global UpdateMotor |
1191 .global UpdateMotor |
1194 UpdateMotor: |
1195 0002 00 .skip 1,0 |
1196 .global cntKompass |
1197 .global cntKompass |
1200 cntKompass: |
1201 0003 0000 .skip 2,0 |
1202 .global beeptime |
1203 .global beeptime |
1206 beeptime: |
1207 0005 0000 .skip 2,0 |
1208 .global SendSPI |
1209 .global SendSPI |
1212 SendSPI: |
1213 0007 00 .skip 1,0 |
1214 .global ServoActive |
1215 .global ServoActive |
1218 ServoActive: |
1219 0008 00 .skip 1,0 |
1220 .global BeepMuster |
1221 .data |
1224 BeepMuster: |
1225 0000 FFFF .word -1 |
1226 .global ServoNickValue |
1227 .global ServoNickValue |
1228 .section .bss |
1231 ServoNickValue: |
1232 0009 0000 .skip 2,0 |
1233 .global ServoRollValue |
1234 .global ServoRollValue |
1237 ServoRollValue: |
1238 000b 0000 .skip 2,0 |
1239 .lcomm CameraShutterCycle,2 |
1240 .lcomm CameraShutterCycleCounter,2 |
1241 .data |
1244 CameraShutterCycleOnCount: |
1245 0002 1400 .word 20 |
1248 ServoRollOffset.2398: |
1249 0004 FC01 .word 508 |
1252 ServoNickOffset.2397: |
1253 0006 FC01 .word 508 |
1254 .lcomm ServoIndex.2396,1 |
1255 .lcomm ServoFrameTime.2395,2 |
1256 .lcomm RemainingPulse.2394,2 |
1257 .lcomm PulseOutput.2393,1 |
1258 .lcomm compass_active.2240,1 |
1259 .lcomm cnt.2239,1 |
1262 cnt_1ms.2238: |
1263 0008 01 .byte 1 |
1264 .lcomm tim_main,2 |
1265 .global __do_copy_data |
1266 .global __do_clear_bss |
8 .global __do_copy_data |
9 .global __do_clear_bss |
10 .global ServoRollValue |
11 .global ServoRollValue |
12 .section .bss |
15 ServoRollValue: |
16 0000 0000 .skip 2,0 |
17 .global ServoNickValue |
18 .global ServoNickValue |
21 ServoNickValue: |
22 0002 0000 .skip 2,0 |
23 .global BeepMuster |
24 .data |
27 BeepMuster: |
28 0000 FFFF .word -1 |
29 .global ServoActive |
30 .global ServoActive |
31 .section .bss |
34 ServoActive: |
35 0004 00 .skip 1,0 |
36 .global SendSPI |
37 .global SendSPI |
40 SendSPI: |
41 0005 00 .skip 1,0 |
42 .global beeptime |
43 .global beeptime |
46 beeptime: |
47 0006 0000 .skip 2,0 |
48 .global cntKompass |
49 .global cntKompass |
52 cntKompass: |
53 0008 0000 .skip 2,0 |
54 .global UpdateMotor |
55 .global UpdateMotor |
58 UpdateMotor: |
59 000a 00 .skip 1,0 |
60 .global CountMilliseconds |
61 .global CountMilliseconds |
64 CountMilliseconds: |
65 000b 0000 .skip 2,0 |
66 .data |
69 CameraShutterCycleOnCount: |
70 0002 1400 .word 20 |
71 .lcomm CameraShutterCycleCounter,2 |
72 .lcomm CameraShutterCycle,2 |
75 cnt_1ms.6: |
76 0004 01 .byte 1 |
77 .lcomm cnt.7,1 |
78 .lcomm compass_active.8,1 |
79 .text |
80 .global __vector_18 |
82 __vector_18: |
83 /* prologue: frame size=0 */ |
84 0000 1F92 push __zero_reg__ |
85 0002 0F92 push __tmp_reg__ |
86 0004 0FB6 in __tmp_reg__,__SREG__ |
87 0006 0F92 push __tmp_reg__ |
88 0008 1124 clr __zero_reg__ |
89 000a 2F93 push r18 |
90 000c 3F93 push r19 |
91 000e 5F93 push r21 |
92 0010 6F93 push r22 |
93 0012 7F93 push r23 |
94 0014 8F93 push r24 |
95 0016 9F93 push r25 |
96 0018 AF93 push r26 |
97 001a BF93 push r27 |
98 001c EF93 push r30 |
99 001e FF93 push r31 |
100 /* prologue end (size=16) */ |
101 0020 20E0 ldi r18,lo8(0) |
102 0022 8091 0000 lds r24,SendSPI |
103 0026 8823 tst r24 |
104 0028 29F0 breq .L2 |
105 002a 8091 0000 lds r24,SendSPI |
106 002e 8150 subi r24,lo8(-(-1)) |
107 0030 8093 0000 sts SendSPI,r24 |
108 .L2: |
109 0034 8091 0000 lds r24,SpektrumTimer |
110 0038 8823 tst r24 |
111 003a 19F0 breq .L3 |
112 003c 8150 subi r24,lo8(-(-1)) |
113 003e 8093 0000 sts SpektrumTimer,r24 |
114 .L3: |
115 0042 8091 0000 lds r24,cnt.7 |
116 0046 8150 subi r24,lo8(-(-1)) |
117 0048 8093 0000 sts cnt.7,r24 |
118 004c 8F3F cpi r24,lo8(-1) |
119 004e 09F0 breq .+2 |
120 0050 5BC0 rjmp .L4 |
121 0052 89E0 ldi r24,lo8(9) |
122 0054 8093 0000 sts cnt.7,r24 |
123 0058 8091 0000 lds r24,CountMilliseconds |
124 005c 9091 0000 lds r25,(CountMilliseconds)+1 |
125 0060 0196 adiw r24,1 |
126 0062 9093 0000 sts (CountMilliseconds)+1,r25 |
127 0066 8093 0000 sts CountMilliseconds,r24 |
128 006a 8091 0000 lds r24,cnt_1ms.6 |
129 006e 8F5F subi r24,lo8(-(1)) |
130 0070 8170 andi r24,lo8(1) |
131 0072 8093 0000 sts cnt_1ms.6,r24 |
132 0076 8823 tst r24 |
133 0078 19F4 brne .L5 |
134 007a 81E0 ldi r24,lo8(1) |
135 007c 8093 0000 sts UpdateMotor,r24 |
136 .L5: |
137 0080 3499 sbic 38-0x20,4 |
138 0082 03C0 rjmp .L6 |
139 0084 81E0 ldi r24,lo8(1) |
140 0086 8093 0000 sts compass_active.8,r24 |
141 .L6: |
142 008a 8091 0000 lds r24,beeptime |
143 008e 9091 0000 lds r25,(beeptime)+1 |
144 0092 892B or r24,r25 |
145 0094 21F1 breq .L7 |
146 0096 8091 0000 lds r24,beeptime |
147 009a 9091 0000 lds r25,(beeptime)+1 |
148 009e 0B97 sbiw r24,11 |
149 00a0 50F0 brlo .L8 |
150 00a2 8091 0000 lds r24,beeptime |
151 00a6 9091 0000 lds r25,(beeptime)+1 |
152 00aa 0A97 sbiw r24,10 |
153 00ac 9093 0000 sts (beeptime)+1,r25 |
154 00b0 8093 0000 sts beeptime,r24 |
155 00b4 04C0 rjmp .L9 |
156 .L8: |
157 00b6 1092 0000 sts (beeptime)+1,__zero_reg__ |
158 00ba 1092 0000 sts beeptime,__zero_reg__ |
159 .L9: |
160 00be 8091 0000 lds r24,beeptime |
161 00c2 9091 0000 lds r25,(beeptime)+1 |
162 00c6 2091 0000 lds r18,BeepMuster |
163 00ca 3091 0000 lds r19,(BeepMuster)+1 |
164 00ce 8223 and r24,r18 |
165 00d0 9323 and r25,r19 |
166 00d2 892B or r24,r25 |
167 00d4 11F0 breq .L10 |
168 00d6 21E0 ldi r18,lo8(1) |
169 00d8 08C0 rjmp .L12 |
170 .L10: |
171 00da 20E0 ldi r18,lo8(0) |
172 00dc 06C0 rjmp .L12 |
173 .L7: |
174 00de 8FEF ldi r24,lo8(-1) |
175 00e0 9FEF ldi r25,hi8(-1) |
176 00e2 9093 0000 sts (BeepMuster)+1,r25 |
177 00e6 8093 0000 sts BeepMuster,r24 |
178 .L12: |
179 00ea 8091 0000 lds r24,PlatinenVersion |
180 00ee 2223 tst r18 |
181 00f0 31F0 breq .L13 |
182 00f2 8A30 cpi r24,lo8(10) |
183 00f4 11F4 brne .L14 |
184 00f6 5A9A sbi 43-0x20,2 |
185 00f8 07C0 rjmp .L4 |
186 .L14: |
187 00fa 479A sbi 40-0x20,7 |
188 00fc 05C0 rjmp .L4 |
189 .L13: |
190 00fe 8A30 cpi r24,lo8(10) |
191 0100 11F4 brne .L17 |
192 0102 5A98 cbi 43-0x20,2 |
193 0104 01C0 rjmp .L4 |
194 .L17: |
195 0106 4798 cbi 40-0x20,7 |
196 .L4: |
197 0108 8091 0000 lds r24,compass_active.8 |
198 010c 8823 tst r24 |
199 010e 09F4 brne .+2 |
200 0110 72C0 rjmp .L1 |
201 0112 2091 0000 lds r18,NaviDataOkay |
202 0116 2223 tst r18 |
203 0118 09F0 breq .+2 |
204 011a 6DC0 rjmp .L1 |
205 011c 8091 0000 lds r24,EE_Parameter+13 |
206 0120 83FF sbrs r24,3 |
207 0122 69C0 rjmp .L1 |
208 0124 86B1 in r24,38-0x20 |
209 0126 9927 clr r25 |
210 0128 FC01 movw r30,r24 |
211 012a E071 andi r30,lo8(16) |
212 012c F070 andi r31,hi8(16) |
213 012e 84FF sbrs r24,4 |
214 0130 14C0 rjmp .L20 |
215 0132 8091 0000 lds r24,cntKompass |
216 0136 9091 0000 lds r25,(cntKompass)+1 |
217 013a 0196 adiw r24,1 |
218 013c 9093 0000 sts (cntKompass)+1,r25 |
219 0140 8093 0000 sts cntKompass,r24 |
220 0144 8091 0000 lds r24,cntKompass |
221 0148 9091 0000 lds r25,(cntKompass)+1 |
222 014c 895E subi r24,lo8(1001) |
223 014e 9340 sbci r25,hi8(1001) |
224 0150 08F4 brsh .+2 |
225 0152 51C0 rjmp .L1 |
226 0154 2093 0000 sts compass_active.8,r18 |
227 0158 4EC0 rjmp .L1 |
228 .L20: |
229 015a 8091 0000 lds r24,cntKompass |
230 015e 9091 0000 lds r25,(cntKompass)+1 |
231 0162 892B or r24,r25 |
232 0164 09F4 brne .+2 |
233 0166 43C0 rjmp .L23 |
234 0168 8091 0000 lds r24,cntKompass |
235 016c 9091 0000 lds r25,(cntKompass)+1 |
236 0170 8A56 subi r24,lo8(362) |
237 0172 9140 sbci r25,hi8(362) |
238 0174 E0F5 brsh .L23 |
239 0176 8091 0000 lds r24,cntKompass |
240 017a 9091 0000 lds r25,(cntKompass)+1 |
241 017e 69E2 ldi r22,lo8(41) |
242 0180 70E0 ldi r23,hi8(41) |
243 0182 0E94 0000 call __udivmodhi4 |
244 0186 8091 0000 lds r24,cntKompass |
245 018a 9091 0000 lds r25,(cntKompass)+1 |
246 018e 860F add r24,r22 |
247 0190 971F adc r25,r23 |
248 0192 9093 0000 sts (cntKompass)+1,r25 |
249 0196 8093 0000 sts cntKompass,r24 |
250 019a 8091 0000 lds r24,cntKompass |
251 019e 9091 0000 lds r25,(cntKompass)+1 |
252 01a2 0B97 sbiw r24,11 |
253 01a4 50F0 brlo .L24 |
254 01a6 8091 0000 lds r24,cntKompass |
255 01aa 9091 0000 lds r25,(cntKompass)+1 |
256 01ae 0A97 sbiw r24,10 |
257 01b0 9093 0000 sts (KompassValue)+1,r25 |
258 01b4 8093 0000 sts KompassValue,r24 |
259 01b8 04C0 rjmp .L25 |
260 .L24: |
261 01ba F093 0000 sts (KompassValue)+1,r31 |
262 01be E093 0000 sts KompassValue,r30 |
263 .L25: |
264 01c2 8091 0000 lds r24,KompassValue |
265 01c6 9091 0000 lds r25,(KompassValue)+1 |
266 01ca 2091 0000 lds r18,KompassStartwert |
267 01ce 3091 0000 lds r19,(KompassStartwert)+1 |
268 01d2 821B sub r24,r18 |
269 01d4 930B sbc r25,r19 |
270 01d6 845E subi r24,lo8(-(540)) |
271 01d8 9D4F sbci r25,hi8(-(540)) |
272 01da 68E6 ldi r22,lo8(360) |
273 01dc 71E0 ldi r23,hi8(360) |
274 01de 0E94 0000 call __divmodhi4 |
275 01e2 845B subi r24,lo8(-(-180)) |
276 01e4 9040 sbci r25,hi8(-(-180)) |
277 01e6 9093 0000 sts (KompassRichtung)+1,r25 |
278 01ea 8093 0000 sts KompassRichtung,r24 |
279 .L23: |
280 01ee 1092 0000 sts (cntKompass)+1,__zero_reg__ |
281 01f2 1092 0000 sts cntKompass,__zero_reg__ |
282 .L1: |
283 /* epilogue: frame size=0 */ |
284 01f6 FF91 pop r31 |
285 01f8 EF91 pop r30 |
286 01fa BF91 pop r27 |
287 01fc AF91 pop r26 |
288 01fe 9F91 pop r25 |
289 0200 8F91 pop r24 |
290 0202 7F91 pop r23 |
291 0204 6F91 pop r22 |
292 0206 5F91 pop r21 |
293 0208 3F91 pop r19 |
294 020a 2F91 pop r18 |
295 020c 0F90 pop __tmp_reg__ |
296 020e 0FBE out __SREG__,__tmp_reg__ |
297 0210 0F90 pop __tmp_reg__ |
298 0212 1F90 pop __zero_reg__ |
299 0214 1895 reti |
300 /* epilogue end (size=16) */ |
301 /* function __vector_18 size 271 (239) */ |
303 .global SetDelay |
305 SetDelay: |
306 /* prologue: frame size=0 */ |
307 /* prologue end (size=0) */ |
308 0216 2091 0000 lds r18,CountMilliseconds |
309 021a 3091 0000 lds r19,(CountMilliseconds)+1 |
310 021e 280F add r18,r24 |
311 0220 391F adc r19,r25 |
312 0222 C901 movw r24,r18 |
313 0224 0196 adiw r24,1 |
314 /* epilogue: frame size=0 */ |
315 0226 0895 ret |
316 /* epilogue end (size=1) */ |
317 /* function SetDelay size 9 (8) */ |
319 .global CheckDelay |
321 CheckDelay: |
322 /* prologue: frame size=0 */ |
323 /* prologue end (size=0) */ |
324 0228 2091 0000 lds r18,CountMilliseconds |
325 022c 3091 0000 lds r19,(CountMilliseconds)+1 |
326 0230 821B sub r24,r18 |
327 0232 930B sbc r25,r19 |
328 0234 892F mov r24,r25 |
329 0236 9927 clr r25 |
330 0238 8695 lsr r24 |
331 023a 8074 andi r24,lo8(64) |
332 023c 9070 andi r25,hi8(64) |
333 /* epilogue: frame size=0 */ |
334 023e 0895 ret |
335 /* epilogue end (size=1) */ |
336 /* function CheckDelay size 12 (11) */ |
338 .global Delay_ms |
340 Delay_ms: |
341 /* prologue: frame size=0 */ |
342 0240 CF93 push r28 |
343 0242 DF93 push r29 |
344 /* prologue end (size=2) */ |
345 0244 0E94 0000 call SetDelay |
346 0248 EC01 movw r28,r24 |
347 .L29: |
348 024a CE01 movw r24,r28 |
349 024c 0E94 0000 call CheckDelay |
350 0250 8823 tst r24 |
351 0252 D9F3 breq .L29 |
352 /* epilogue: frame size=0 */ |
353 0254 DF91 pop r29 |
354 0256 CF91 pop r28 |
355 0258 0895 ret |
356 /* epilogue end (size=3) */ |
357 /* function Delay_ms size 13 (8) */ |
359 .global Delay_ms_Mess |
361 Delay_ms_Mess: |
362 /* prologue: frame size=0 */ |
363 025a CF93 push r28 |
364 025c DF93 push r29 |
365 /* prologue end (size=2) */ |
366 025e 0E94 0000 call SetDelay |
367 0262 EC01 movw r28,r24 |
368 0264 09C0 rjmp .L40 |
369 .L36: |
370 0266 8091 0000 lds r24,AdReady |
371 026a 8823 tst r24 |
372 026c 29F0 breq .L40 |
373 026e 9093 0000 sts AdReady,r25 |
374 0272 8FEC ldi r24,lo8(-49) |
375 0274 8093 7A00 sts 122,r24 |
376 .L40: |
377 0278 CE01 movw r24,r28 |
378 027a 0E94 0000 call CheckDelay |
379 027e 982F mov r25,r24 |
380 0280 8823 tst r24 |
381 0282 89F3 breq .L36 |
382 /* epilogue: frame size=0 */ |
383 0284 DF91 pop r29 |
384 0286 CF91 pop r28 |
385 0288 0895 ret |
386 /* epilogue end (size=3) */ |
387 /* function Delay_ms_Mess size 24 (19) */ |
389 .global TIMER2_Init |
391 TIMER2_Init: |
392 /* prologue: frame size=0 */ |
393 /* prologue end (size=0) */ |
394 028a 4FB7 in r20,95-0x20 |
395 028c 8091 0000 lds r24,Parameter_UserParam8 |
396 0290 282F mov r18,r24 |
397 0292 3327 clr r19 |
398 0294 2F77 andi r18,lo8(127) |
399 0296 3070 andi r19,hi8(127) |
400 0298 C901 movw r24,r18 |
401 029a 880F lsl r24 |
402 029c 991F rol r25 |
403 029e 880F lsl r24 |
404 02a0 991F rol r25 |
405 02a2 820F add r24,r18 |
406 02a4 931F adc r25,r19 |
407 02a6 9093 0000 sts (CameraShutterCycle)+1,r25 |
408 02aa 8093 0000 sts CameraShutterCycle,r24 |
409 /* #APP */ |
410 02ae F894 cli |
411 /* #NOAPP */ |
412 02b0 5F98 cbi 43-0x20,7 |
413 02b2 3E9A sbi 39-0x20,6 |
414 02b4 469A sbi 40-0x20,6 |
415 02b6 8091 B000 lds r24,176 |
416 02ba 8F70 andi r24,lo8(15) |
417 02bc 8093 B000 sts 176,r24 |
418 02c0 8091 B000 lds r24,176 |
419 02c4 8360 ori r24,lo8(3) |
420 02c6 8093 B000 sts 176,r24 |
421 02ca 8091 B100 lds r24,177 |
422 02ce 8B73 andi r24,lo8(59) |
423 02d0 8093 B100 sts 177,r24 |
424 02d4 8091 B100 lds r24,177 |
425 02d8 8B60 ori r24,lo8(11) |
426 02da 8093 B100 sts 177,r24 |
427 02de 1092 B200 sts 178,__zero_reg__ |
428 02e2 8FEF ldi r24,lo8(-1) |
429 02e4 8093 B300 sts 179,r24 |
430 02e8 8091 B000 lds r24,176 |
431 02ec 8068 ori r24,lo8(-128) |
432 02ee 8093 B000 sts 176,r24 |
433 02f2 8091 7000 lds r24,112 |
434 02f6 8A7F andi r24,lo8(-6) |
435 02f8 8093 7000 sts 112,r24 |
436 02fc 8091 7000 lds r24,112 |
437 0300 8260 ori r24,lo8(2) |
438 0302 8093 7000 sts 112,r24 |
439 0306 4FBF out 95-0x20,r20 |
440 /* epilogue: frame size=0 */ |
441 0308 0895 ret |
442 /* epilogue end (size=1) */ |
443 /* function TIMER2_Init size 65 (64) */ |
445 .global Timer_Init |
447 Timer_Init: |
448 /* prologue: frame size=0 */ |
449 /* prologue end (size=0) */ |
450 030a 8AE0 ldi r24,lo8(10) |
451 030c 90E0 ldi r25,hi8(10) |
452 030e 0E94 0000 call SetDelay |
453 0312 9093 0000 sts (tim_main)+1,r25 |
454 0316 8093 0000 sts tim_main,r24 |
455 031a 82E0 ldi r24,lo8(2) |
456 031c 85BD out 69-0x20,r24 |
457 031e 83EA ldi r24,lo8(-93) |
458 0320 84BD out 68-0x20,r24 |
459 0322 17BC out 71-0x20,__zero_reg__ |
460 0324 84EB ldi r24,lo8(-76) |
461 0326 88BD out 72-0x20,r24 |
462 0328 86E0 ldi r24,lo8(6) |
463 032a 86BD out 70-0x20,r24 |
464 032c 8091 6E00 lds r24,110 |
465 0330 8160 ori r24,lo8(1) |
466 0332 8093 6E00 sts 110,r24 |
467 /* epilogue: frame size=0 */ |
468 0336 0895 ret |
469 /* epilogue end (size=1) */ |
470 /* function Timer_Init size 23 (22) */ |
472 .lcomm PulseOutput.0,1 |
473 .lcomm RemainingPulse.1,2 |
474 .lcomm ServoFrameTime.2,2 |
475 .lcomm ServoIndex.3,1 |
476 .data |
479 ServoNickOffset.4: |
480 0005 FC01 .word 508 |
483 ServoRollOffset.5: |
484 0007 FC01 .word 508 |
485 .text |
486 .global __vector_9 |
488 __vector_9: |
489 /* prologue: frame size=0 */ |
490 0338 1F92 push __zero_reg__ |
491 033a 0F92 push __tmp_reg__ |
492 033c 0FB6 in __tmp_reg__,__SREG__ |
493 033e 0F92 push __tmp_reg__ |
494 0340 1124 clr __zero_reg__ |
495 0342 2F93 push r18 |
496 0344 3F93 push r19 |
497 0346 4F93 push r20 |
498 0348 5F93 push r21 |
499 034a 6F93 push r22 |
500 034c 7F93 push r23 |
501 034e 8F93 push r24 |
502 0350 9F93 push r25 |
503 0352 AF93 push r26 |
504 0354 BF93 push r27 |
505 0356 CF93 push r28 |
506 0358 DF93 push r29 |
507 035a EF93 push r30 |
508 035c FF93 push r31 |
509 /* prologue end (size=19) */ |
510 035e 8091 0000 lds r24,PlatinenVersion |
511 0362 8431 cpi r24,lo8(20) |
512 0364 08F0 brlo .+2 |
513 0366 17C1 rjmp .L44 |
514 0368 8091 0000 lds r24,Parameter_UserParam8 |
515 036c 87FD sbrc r24,7 |
516 036e 13C1 rjmp .L44 |
517 0370 8091 0000 lds r24,PulseOutput.0 |
518 0374 8823 tst r24 |
519 0376 09F0 breq .+2 |
520 0378 AEC3 rjmp .L62 |
521 037a 8091 B000 lds r24,176 |
522 037e 86FF sbrs r24,6 |
523 0380 ECC0 rjmp .L46 |
524 0382 8091 B000 lds r24,176 |
525 0386 8F7B andi r24,lo8(-65) |
526 0388 8093 B000 sts 176,r24 |
527 038c 89EA ldi r24,lo8(937) |
528 038e 93E0 ldi r25,hi8(937) |
529 0390 9093 0000 sts (RemainingPulse.1)+1,r25 |
530 0394 8093 0000 sts RemainingPulse.1,r24 |
531 0398 8091 0000 lds r24,ServoNickOffset.4 |
532 039c 9091 0000 lds r25,(ServoNickOffset.4)+1 |
533 03a0 9C01 movw r18,r24 |
534 03a2 220F lsl r18 |
535 03a4 331F rol r19 |
536 03a6 280F add r18,r24 |
537 03a8 391F adc r19,r25 |
538 03aa 8091 0000 lds r24,Parameter_ServoNickControl |
539 03ae 9927 clr r25 |
540 03b0 880F lsl r24 |
541 03b2 991F rol r25 |
542 03b4 880F lsl r24 |
543 03b6 991F rol r25 |
544 03b8 280F add r18,r24 |
545 03ba 391F adc r19,r25 |
546 03bc 37FF sbrs r19,7 |
547 03be 02C0 rjmp .L47 |
548 03c0 2D5F subi r18,lo8(-(3)) |
549 03c2 3F4F sbci r19,hi8(-(3)) |
550 .L47: |
551 03c4 C901 movw r24,r18 |
552 03c6 9595 asr r25 |
553 03c8 8795 ror r24 |
554 03ca 9595 asr r25 |
555 03cc 8795 ror r24 |
556 03ce 9093 0000 sts (ServoNickOffset.4)+1,r25 |
557 03d2 8093 0000 sts ServoNickOffset.4,r24 |
558 03d6 9093 0000 sts (ServoNickValue)+1,r25 |
559 03da 8093 0000 sts ServoNickValue,r24 |
560 03de 8091 0000 lds r24,EE_Parameter+98 |
561 03e2 6091 0000 lds r22,EE_Parameter+46 |
562 03e6 2091 0000 lds r18,IntegralNick |
563 03ea 3091 0000 lds r19,(IntegralNick)+1 |
564 03ee 4091 0000 lds r20,(IntegralNick)+2 |
565 03f2 5091 0000 lds r21,(IntegralNick)+3 |
566 03f6 80FF sbrs r24,0 |
567 03f8 2CC0 rjmp .L48 |
568 03fa 7727 clr r23 |
569 03fc 8827 clr r24 |
570 03fe 9927 clr r25 |
571 0400 EA01 movw r28,r20 |
572 0402 D901 movw r26,r18 |
573 0404 57FF sbrs r21,7 |
574 0406 04C0 rjmp .L49 |
575 0408 A158 subi r26,lo8(-(127)) |
576 040a BF4F sbci r27,hi8(-(127)) |
577 040c CF4F sbci r28,hlo8(-(127)) |
578 040e DF4F sbci r29,hhi8(-(127)) |
579 .L49: |
580 0410 E7E0 ldi r30,7 |
581 0412 D595 1: asr r29 |
582 0414 C795 ror r28 |
583 0416 B795 ror r27 |
584 0418 A795 ror r26 |
585 041a EA95 dec r30 |
586 041c D1F7 brne 1b |
587 041e 9D01 movw r18,r26 |
588 0420 AE01 movw r20,r28 |
589 0422 0E94 0000 call __mulsi3 |
590 0426 9B01 movw r18,r22 |
591 0428 AC01 movw r20,r24 |
592 042a 97FF sbrs r25,7 |
593 042c 04C0 rjmp .L50 |
594 042e 215C subi r18,lo8(-(63)) |
595 0430 3F4F sbci r19,hi8(-(63)) |
596 0432 4F4F sbci r20,hlo8(-(63)) |
597 0434 5F4F sbci r21,hhi8(-(63)) |
598 .L50: |
599 0436 66E0 ldi r22,6 |
600 0438 5595 1: asr r21 |
601 043a 4795 ror r20 |
602 043c 3795 ror r19 |
603 043e 2795 ror r18 |
604 0440 6A95 dec r22 |
605 0442 D1F7 brne 1b |
606 0444 8091 0000 lds r24,ServoNickValue |
607 0448 9091 0000 lds r25,(ServoNickValue)+1 |
608 044c 820F add r24,r18 |
609 044e 931F adc r25,r19 |
610 0450 2BC0 rjmp .L121 |
611 .L48: |
612 0452 7727 clr r23 |
613 0454 8827 clr r24 |
614 0456 9927 clr r25 |
615 0458 EA01 movw r28,r20 |
616 045a D901 movw r26,r18 |
617 045c 57FF sbrs r21,7 |
618 045e 04C0 rjmp .L52 |
619 0460 A158 subi r26,lo8(-(127)) |
620 0462 BF4F sbci r27,hi8(-(127)) |
621 0464 CF4F sbci r28,hlo8(-(127)) |
622 0466 DF4F sbci r29,hhi8(-(127)) |
623 .L52: |
624 0468 27E0 ldi r18,7 |
625 046a D595 1: asr r29 |
626 046c C795 ror r28 |
627 046e B795 ror r27 |
628 0470 A795 ror r26 |
629 0472 2A95 dec r18 |
630 0474 D1F7 brne 1b |
631 0476 9D01 movw r18,r26 |
632 0478 AE01 movw r20,r28 |
633 047a 0E94 0000 call __mulsi3 |
634 047e 9B01 movw r18,r22 |
635 0480 AC01 movw r20,r24 |
636 0482 97FF sbrs r25,7 |
637 0484 04C0 rjmp .L53 |
638 0486 215C subi r18,lo8(-(63)) |
639 0488 3F4F sbci r19,hi8(-(63)) |
640 048a 4F4F sbci r20,hlo8(-(63)) |
641 048c 5F4F sbci r21,hhi8(-(63)) |
642 .L53: |
643 048e F6E0 ldi r31,6 |
644 0490 5595 1: asr r21 |
645 0492 4795 ror r20 |
646 0494 3795 ror r19 |
647 0496 2795 ror r18 |
648 0498 FA95 dec r31 |
649 049a D1F7 brne 1b |
650 049c 8091 0000 lds r24,ServoNickValue |
651 04a0 9091 0000 lds r25,(ServoNickValue)+1 |
652 04a4 821B sub r24,r18 |
653 04a6 930B sbc r25,r19 |
654 .L121: |
655 04a8 9093 0000 sts (ServoNickValue)+1,r25 |
656 04ac 8093 0000 sts ServoNickValue,r24 |
657 04b0 8091 0000 lds r24,EE_Parameter+47 |
658 04b4 282F mov r18,r24 |
659 04b6 3327 clr r19 |
660 04b8 220F lsl r18 |
661 04ba 331F rol r19 |
662 04bc 220F lsl r18 |
663 04be 331F rol r19 |
664 04c0 8091 0000 lds r24,ServoNickValue |
665 04c4 9091 0000 lds r25,(ServoNickValue)+1 |
666 04c8 8217 cp r24,r18 |
667 04ca 9307 cpc r25,r19 |
668 04cc 7CF0 brlt .L122 |
669 04ce 8091 0000 lds r24,EE_Parameter+48 |
670 04d2 282F mov r18,r24 |
671 04d4 3327 clr r19 |
672 04d6 220F lsl r18 |
673 04d8 331F rol r19 |
674 04da 220F lsl r18 |
675 04dc 331F rol r19 |
676 04de 8091 0000 lds r24,ServoNickValue |
677 04e2 9091 0000 lds r25,(ServoNickValue)+1 |
678 04e6 2817 cp r18,r24 |
679 04e8 3907 cpc r19,r25 |
680 04ea 24F4 brge .L55 |
681 .L122: |
682 04ec 3093 0000 sts (ServoNickValue)+1,r19 |
683 04f0 2093 0000 sts ServoNickValue,r18 |
684 .L55: |
685 04f4 2091 0000 lds r18,RemainingPulse.1 |
686 04f8 3091 0000 lds r19,(RemainingPulse.1)+1 |
687 04fc 8091 0000 lds r24,ServoNickValue |
688 0500 9091 0000 lds r25,(ServoNickValue)+1 |
689 0504 280F add r18,r24 |
690 0506 391F adc r19,r25 |
691 0508 2050 subi r18,lo8(-(-512)) |
692 050a 3240 sbci r19,hi8(-(-512)) |
693 050c 3093 0000 sts (RemainingPulse.1)+1,r19 |
694 0510 2093 0000 sts RemainingPulse.1,r18 |
695 0514 8091 0000 lds r24,ServoNickValue |
696 0518 9091 0000 lds r25,(ServoNickValue)+1 |
697 051c 97FD sbrc r25,7 |
698 051e 0396 adiw r24,3 |
699 .L57: |
700 0520 9595 asr r25 |
701 0522 8795 ror r24 |
702 0524 9595 asr r25 |
703 0526 8795 ror r24 |
704 0528 9093 0000 sts (ServoNickValue)+1,r25 |
705 052c 8093 0000 sts ServoNickValue,r24 |
706 0530 45E0 ldi r20,hi8(1501) |
707 0532 2D3D cpi r18,lo8(1501) |
708 0534 3407 cpc r19,r20 |
709 0536 18F0 brlo .L58 |
710 0538 8CED ldi r24,lo8(1500) |
711 053a 95E0 ldi r25,hi8(1500) |
712 053c 05C0 rjmp .L123 |
713 .L58: |
714 053e 2757 subi r18,lo8(375) |
715 0540 3140 sbci r19,hi8(375) |
716 0542 30F4 brsh .L59 |
717 0544 87E7 ldi r24,lo8(375) |
718 0546 91E0 ldi r25,hi8(375) |
719 .L123: |
720 0548 9093 0000 sts (RemainingPulse.1)+1,r25 |
721 054c 8093 0000 sts RemainingPulse.1,r24 |
722 .L59: |
723 0550 8091 0000 lds r24,RemainingPulse.1 |
724 0554 9091 0000 lds r25,(RemainingPulse.1)+1 |
725 0558 87C2 rjmp .L134 |
726 .L46: |
727 055a 8091 B000 lds r24,176 |
728 055e 8064 ori r24,lo8(64) |
729 0560 8093 B000 sts 176,r24 |
730 0564 8091 0000 lds r24,EE_Parameter+53 |
731 0568 282F mov r18,r24 |
732 056a 3327 clr r19 |
733 056c 8DED ldi r24,lo8(1757) |
734 056e 96E0 ldi r25,hi8(1757) |
735 0570 289F mul r18,r24 |
736 0572 A001 movw r20,r0 |
737 0574 299F mul r18,r25 |
738 0576 500D add r21,r0 |
739 0578 389F mul r19,r24 |
740 057a 500D add r21,r0 |
741 057c 1124 clr r1 |
742 057e CA01 movw r24,r20 |
743 0580 2091 0000 lds r18,ServoFrameTime.2 |
744 0584 3091 0000 lds r19,(ServoFrameTime.2)+1 |
745 0588 821B sub r24,r18 |
746 058a 930B sbc r25,r19 |
747 058c 9093 0000 sts (RemainingPulse.1)+1,r25 |
748 0590 8093 0000 sts RemainingPulse.1,r24 |
749 0594 9DC2 rjmp .L109 |
750 .L44: |
751 0596 8091 0000 lds r24,PulseOutput.0 |
752 059a 8823 tst r24 |
753 059c 09F0 breq .+2 |
754 059e 9BC2 rjmp .L62 |
755 05a0 8091 B000 lds r24,176 |
756 05a4 86FF sbrs r24,6 |
757 05a6 65C2 rjmp .L64 |
758 05a8 8091 B000 lds r24,176 |
759 05ac 8F7B andi r24,lo8(-65) |
760 05ae 8093 B000 sts 176,r24 |
761 05b2 E091 0000 lds r30,ServoIndex.3 |
762 05b6 EE23 tst r30 |
763 05b8 F1F4 brne .L65 |
764 05ba 8091 0000 lds r24,EE_Parameter+53 |
765 05be 282F mov r18,r24 |
766 05c0 3327 clr r19 |
767 05c2 8DED ldi r24,lo8(1757) |
768 05c4 96E0 ldi r25,hi8(1757) |
769 05c6 289F mul r18,r24 |
770 05c8 A001 movw r20,r0 |
771 05ca 299F mul r18,r25 |
772 05cc 500D add r21,r0 |
773 05ce 389F mul r19,r24 |
774 05d0 500D add r21,r0 |
775 05d2 1124 clr r1 |
776 05d4 CA01 movw r24,r20 |
777 05d6 2091 0000 lds r18,ServoFrameTime.2 |
778 05da 3091 0000 lds r19,(ServoFrameTime.2)+1 |
779 05de 821B sub r24,r18 |
780 05e0 930B sbc r25,r19 |
781 05e2 9093 0000 sts (RemainingPulse.1)+1,r25 |
782 05e6 8093 0000 sts RemainingPulse.1,r24 |
783 05ea 1092 0000 sts (ServoFrameTime.2)+1,__zero_reg__ |
784 05ee 1092 0000 sts ServoFrameTime.2,__zero_reg__ |
785 05f2 469A sbi 40-0x20,6 |
786 05f4 6DC2 rjmp .L109 |
787 .L65: |
788 05f6 49EA ldi r20,lo8(937) |
789 05f8 53E0 ldi r21,hi8(937) |
790 05fa 5093 0000 sts (RemainingPulse.1)+1,r21 |
791 05fe 4093 0000 sts RemainingPulse.1,r20 |
792 0602 8E2F mov r24,r30 |
793 0604 9927 clr r25 |
794 0606 8330 cpi r24,3 |
795 0608 9105 cpc r25,__zero_reg__ |
796 060a 09F4 brne .+2 |
797 060c A4C1 rjmp .L92 |
798 060e 8430 cpi r24,4 |
799 0610 9105 cpc r25,__zero_reg__ |
800 0612 3CF4 brge .L105 |
801 0614 8130 cpi r24,1 |
802 0616 9105 cpc r25,__zero_reg__ |
803 0618 61F0 breq .L68 |
804 061a 0297 sbiw r24,2 |
805 061c 09F4 brne .+2 |
806 061e D2C0 rjmp .L80 |
807 0620 ECC1 rjmp .L104 |
808 .L105: |
809 0622 8430 cpi r24,4 |
810 0624 9105 cpc r25,__zero_reg__ |
811 0626 09F4 brne .+2 |
812 0628 DBC1 rjmp .L102 |
813 062a 0597 sbiw r24,5 |
814 062c 09F4 brne .+2 |
815 062e DBC1 rjmp .L103 |
816 0630 E4C1 rjmp .L104 |
817 .L68: |
818 0632 8091 0000 lds r24,ServoNickOffset.4 |
819 0636 9091 0000 lds r25,(ServoNickOffset.4)+1 |
820 063a 9C01 movw r18,r24 |
821 063c 220F lsl r18 |
822 063e 331F rol r19 |
823 0640 280F add r18,r24 |
824 0642 391F adc r19,r25 |
825 0644 8091 0000 lds r24,Parameter_ServoNickControl |
826 0648 9927 clr r25 |
827 064a 880F lsl r24 |
828 064c 991F rol r25 |
829 064e 880F lsl r24 |
830 0650 991F rol r25 |
831 0652 280F add r18,r24 |
832 0654 391F adc r19,r25 |
833 0656 37FF sbrs r19,7 |
834 0658 02C0 rjmp .L69 |
835 065a 2D5F subi r18,lo8(-(3)) |
836 065c 3F4F sbci r19,hi8(-(3)) |
837 .L69: |
838 065e C901 movw r24,r18 |
839 0660 9595 asr r25 |
840 0662 8795 ror r24 |
841 0664 9595 asr r25 |
842 0666 8795 ror r24 |
843 0668 9093 0000 sts (ServoNickOffset.4)+1,r25 |
844 066c 8093 0000 sts ServoNickOffset.4,r24 |
845 0670 9093 0000 sts (ServoNickValue)+1,r25 |
846 0674 8093 0000 sts ServoNickValue,r24 |
847 0678 8091 0000 lds r24,EE_Parameter+98 |
848 067c 6091 0000 lds r22,EE_Parameter+46 |
849 0680 2091 0000 lds r18,IntegralNick |
850 0684 3091 0000 lds r19,(IntegralNick)+1 |
851 0688 4091 0000 lds r20,(IntegralNick)+2 |
852 068c 5091 0000 lds r21,(IntegralNick)+3 |
853 0690 80FF sbrs r24,0 |
854 0692 2CC0 rjmp .L70 |
855 0694 7727 clr r23 |
856 0696 8827 clr r24 |
857 0698 9927 clr r25 |
858 069a EA01 movw r28,r20 |
859 069c D901 movw r26,r18 |
860 069e 57FF sbrs r21,7 |
861 06a0 04C0 rjmp .L71 |
862 06a2 A158 subi r26,lo8(-(127)) |
863 06a4 BF4F sbci r27,hi8(-(127)) |
864 06a6 CF4F sbci r28,hlo8(-(127)) |
865 06a8 DF4F sbci r29,hhi8(-(127)) |
866 .L71: |
867 06aa 27E0 ldi r18,7 |
868 06ac D595 1: asr r29 |
869 06ae C795 ror r28 |
870 06b0 B795 ror r27 |
871 06b2 A795 ror r26 |
872 06b4 2A95 dec r18 |
873 06b6 D1F7 brne 1b |
874 06b8 9D01 movw r18,r26 |
875 06ba AE01 movw r20,r28 |
876 06bc 0E94 0000 call __mulsi3 |
877 06c0 9B01 movw r18,r22 |
878 06c2 AC01 movw r20,r24 |
879 06c4 97FF sbrs r25,7 |
880 06c6 04C0 rjmp .L72 |
881 06c8 215C subi r18,lo8(-(63)) |
882 06ca 3F4F sbci r19,hi8(-(63)) |
883 06cc 4F4F sbci r20,hlo8(-(63)) |
884 06ce 5F4F sbci r21,hhi8(-(63)) |
885 .L72: |
886 06d0 F6E0 ldi r31,6 |
887 06d2 5595 1: asr r21 |
888 06d4 4795 ror r20 |
889 06d6 3795 ror r19 |
890 06d8 2795 ror r18 |
891 06da FA95 dec r31 |
892 06dc D1F7 brne 1b |
893 06de 8091 0000 lds r24,ServoNickValue |
894 06e2 9091 0000 lds r25,(ServoNickValue)+1 |
895 06e6 820F add r24,r18 |
896 06e8 931F adc r25,r19 |
897 06ea 27C0 rjmp .L124 |
898 .L70: |
899 06ec 7727 clr r23 |
900 06ee 8827 clr r24 |
901 06f0 9927 clr r25 |
902 06f2 57FF sbrs r21,7 |
903 06f4 04C0 rjmp .L74 |
904 06f6 2158 subi r18,lo8(-(127)) |
905 06f8 3F4F sbci r19,hi8(-(127)) |
906 06fa 4F4F sbci r20,hlo8(-(127)) |
907 06fc 5F4F sbci r21,hhi8(-(127)) |
908 .L74: |
909 06fe E7E0 ldi r30,7 |
910 0700 5595 1: asr r21 |
911 0702 4795 ror r20 |
912 0704 3795 ror r19 |
913 0706 2795 ror r18 |
914 0708 EA95 dec r30 |
915 070a D1F7 brne 1b |
916 070c 0E94 0000 call __mulsi3 |
917 0710 9B01 movw r18,r22 |
918 0712 AC01 movw r20,r24 |
919 0714 97FF sbrs r25,7 |
920 0716 04C0 rjmp .L75 |
921 0718 215C subi r18,lo8(-(63)) |
922 071a 3F4F sbci r19,hi8(-(63)) |
923 071c 4F4F sbci r20,hlo8(-(63)) |
924 071e 5F4F sbci r21,hhi8(-(63)) |
925 .L75: |
926 0720 66E0 ldi r22,6 |
927 0722 5595 1: asr r21 |
928 0724 4795 ror r20 |
929 0726 3795 ror r19 |
930 0728 2795 ror r18 |
931 072a 6A95 dec r22 |
932 072c D1F7 brne 1b |
933 072e 8091 0000 lds r24,ServoNickValue |
934 0732 9091 0000 lds r25,(ServoNickValue)+1 |
935 0736 821B sub r24,r18 |
936 0738 930B sbc r25,r19 |
937 .L124: |
938 073a 9093 0000 sts (ServoNickValue)+1,r25 |
939 073e 8093 0000 sts ServoNickValue,r24 |
940 0742 8091 0000 lds r24,EE_Parameter+47 |
941 0746 282F mov r18,r24 |
942 0748 3327 clr r19 |
943 074a 220F lsl r18 |
944 074c 331F rol r19 |
945 074e 220F lsl r18 |
946 0750 331F rol r19 |
947 0752 8091 0000 lds r24,ServoNickValue |
948 0756 9091 0000 lds r25,(ServoNickValue)+1 |
949 075a 8217 cp r24,r18 |
950 075c 9307 cpc r25,r19 |
951 075e 7CF0 brlt .L125 |
952 0760 8091 0000 lds r24,EE_Parameter+48 |
953 0764 282F mov r18,r24 |
954 0766 3327 clr r19 |
955 0768 220F lsl r18 |
956 076a 331F rol r19 |
957 076c 220F lsl r18 |
958 076e 331F rol r19 |
959 0770 8091 0000 lds r24,ServoNickValue |
960 0774 9091 0000 lds r25,(ServoNickValue)+1 |
961 0778 2817 cp r18,r24 |
962 077a 3907 cpc r19,r25 |
963 077c 24F4 brge .L77 |
964 .L125: |
965 077e 3093 0000 sts (ServoNickValue)+1,r19 |
966 0782 2093 0000 sts ServoNickValue,r18 |
967 .L77: |
968 0786 8091 0000 lds r24,RemainingPulse.1 |
969 078a 9091 0000 lds r25,(RemainingPulse.1)+1 |
970 078e 2091 0000 lds r18,ServoNickValue |
971 0792 3091 0000 lds r19,(ServoNickValue)+1 |
972 0796 820F add r24,r18 |
973 0798 931F adc r25,r19 |
974 079a 8050 subi r24,lo8(-(-512)) |
975 079c 9240 sbci r25,hi8(-(-512)) |
976 079e 9093 0000 sts (RemainingPulse.1)+1,r25 |
977 07a2 8093 0000 sts RemainingPulse.1,r24 |
978 07a6 8091 0000 lds r24,ServoNickValue |
979 07aa 9091 0000 lds r25,(ServoNickValue)+1 |
980 07ae 97FD sbrc r25,7 |
981 07b0 0396 adiw r24,3 |
982 .L79: |
983 07b2 9595 asr r25 |
984 07b4 8795 ror r24 |
985 07b6 9595 asr r25 |
986 07b8 8795 ror r24 |
987 07ba 9093 0000 sts (ServoNickValue)+1,r25 |
988 07be 8093 0000 sts ServoNickValue,r24 |
989 07c2 2EC1 rjmp .L67 |
990 .L80: |
991 07c4 8091 0000 lds r24,ServoRollOffset.5 |
992 07c8 9091 0000 lds r25,(ServoRollOffset.5)+1 |
993 07cc 9C01 movw r18,r24 |
994 07ce 220F lsl r18 |
995 07d0 331F rol r19 |
996 07d2 280F add r18,r24 |
997 07d4 391F adc r19,r25 |
998 07d6 8091 0000 lds r24,Parameter_ServoRollControl |
999 07da 9927 clr r25 |
1000 07dc 880F lsl r24 |
1001 07de 991F rol r25 |
1002 07e0 880F lsl r24 |
1003 07e2 991F rol r25 |
1004 07e4 280F add r18,r24 |
1005 07e6 391F adc r19,r25 |
1006 07e8 37FF sbrs r19,7 |
1007 07ea 02C0 rjmp .L81 |
1008 07ec 2D5F subi r18,lo8(-(3)) |
1009 07ee 3F4F sbci r19,hi8(-(3)) |
1010 .L81: |
1011 07f0 C901 movw r24,r18 |
1012 07f2 9595 asr r25 |
1013 07f4 8795 ror r24 |
1014 07f6 9595 asr r25 |
1015 07f8 8795 ror r24 |
1016 07fa 9093 0000 sts (ServoRollOffset.5)+1,r25 |
1017 07fe 8093 0000 sts ServoRollOffset.5,r24 |
1018 0802 9093 0000 sts (ServoRollValue)+1,r25 |
1019 0806 8093 0000 sts ServoRollValue,r24 |
1020 080a 8091 0000 lds r24,EE_Parameter+98 |
1021 080e 6091 0000 lds r22,EE_Parameter+50 |
1022 0812 A091 0000 lds r26,IntegralRoll |
1023 0816 B091 0000 lds r27,(IntegralRoll)+1 |
1024 081a C091 0000 lds r28,(IntegralRoll)+2 |
1025 081e D091 0000 lds r29,(IntegralRoll)+3 |
1026 0822 81FF sbrs r24,1 |
1027 0824 2AC0 rjmp .L82 |
1028 0826 7727 clr r23 |
1029 0828 8827 clr r24 |
1030 082a 9927 clr r25 |
1031 082c 9D01 movw r18,r26 |
1032 082e AE01 movw r20,r28 |
1033 0830 D7FF sbrs r29,7 |
1034 0832 04C0 rjmp .L83 |
1035 0834 2158 subi r18,lo8(-(127)) |
1036 0836 3F4F sbci r19,hi8(-(127)) |
1037 0838 4F4F sbci r20,hlo8(-(127)) |
1038 083a 5F4F sbci r21,hhi8(-(127)) |
1039 .L83: |
1040 083c E7E0 ldi r30,7 |
1041 083e 5595 1: asr r21 |
1042 0840 4795 ror r20 |
1043 0842 3795 ror r19 |
1044 0844 2795 ror r18 |
1045 0846 EA95 dec r30 |
1046 0848 D1F7 brne 1b |
1047 084a 0E94 0000 call __mulsi3 |
1048 084e 9B01 movw r18,r22 |
1049 0850 AC01 movw r20,r24 |
1050 0852 97FF sbrs r25,7 |
1051 0854 04C0 rjmp .L84 |
1052 0856 215C subi r18,lo8(-(63)) |
1053 0858 3F4F sbci r19,hi8(-(63)) |
1054 085a 4F4F sbci r20,hlo8(-(63)) |
1055 085c 5F4F sbci r21,hhi8(-(63)) |
1056 .L84: |
1057 085e C6E0 ldi r28,6 |
1058 0860 5595 1: asr r21 |
1059 0862 4795 ror r20 |
1060 0864 3795 ror r19 |
1061 0866 2795 ror r18 |
1062 0868 CA95 dec r28 |
1063 086a D1F7 brne 1b |
1064 086c 8091 0000 lds r24,ServoRollValue |
1065 0870 9091 0000 lds r25,(ServoRollValue)+1 |
1066 0874 820F add r24,r18 |
1067 0876 931F adc r25,r19 |
1068 0878 29C0 rjmp .L126 |
1069 .L82: |
1070 087a 7727 clr r23 |
1071 087c 8827 clr r24 |
1072 087e 9927 clr r25 |
1073 0880 9D01 movw r18,r26 |
1074 0882 AE01 movw r20,r28 |
1075 0884 D7FF sbrs r29,7 |
1076 0886 04C0 rjmp .L86 |
1077 0888 2158 subi r18,lo8(-(127)) |
1078 088a 3F4F sbci r19,hi8(-(127)) |
1079 088c 4F4F sbci r20,hlo8(-(127)) |
1080 088e 5F4F sbci r21,hhi8(-(127)) |
1081 .L86: |
1082 0890 B7E0 ldi r27,7 |
1083 0892 5595 1: asr r21 |
1084 0894 4795 ror r20 |
1085 0896 3795 ror r19 |
1086 0898 2795 ror r18 |
1087 089a BA95 dec r27 |
1088 089c D1F7 brne 1b |
1089 089e 0E94 0000 call __mulsi3 |
1090 08a2 9B01 movw r18,r22 |
1091 08a4 AC01 movw r20,r24 |
1092 08a6 97FF sbrs r25,7 |
1093 08a8 04C0 rjmp .L87 |
1094 08aa 215C subi r18,lo8(-(63)) |
1095 08ac 3F4F sbci r19,hi8(-(63)) |
1096 08ae 4F4F sbci r20,hlo8(-(63)) |
1097 08b0 5F4F sbci r21,hhi8(-(63)) |
1098 .L87: |
1099 08b2 A6E0 ldi r26,6 |
1100 08b4 5595 1: asr r21 |
1101 08b6 4795 ror r20 |
1102 08b8 3795 ror r19 |
1103 08ba 2795 ror r18 |
1104 08bc AA95 dec r26 |
1105 08be D1F7 brne 1b |
1106 08c0 8091 0000 lds r24,ServoRollValue |
1107 08c4 9091 0000 lds r25,(ServoRollValue)+1 |
1108 08c8 821B sub r24,r18 |
1109 08ca 930B sbc r25,r19 |
1110 .L126: |
1111 08cc 9093 0000 sts (ServoRollValue)+1,r25 |
1112 08d0 8093 0000 sts ServoRollValue,r24 |
1113 08d4 8091 0000 lds r24,EE_Parameter+51 |
1114 08d8 282F mov r18,r24 |
1115 08da 3327 clr r19 |
1116 08dc 220F lsl r18 |
1117 08de 331F rol r19 |
1118 08e0 220F lsl r18 |
1119 08e2 331F rol r19 |
1120 08e4 8091 0000 lds r24,ServoRollValue |
1121 08e8 9091 0000 lds r25,(ServoRollValue)+1 |
1122 08ec 8217 cp r24,r18 |
1123 08ee 9307 cpc r25,r19 |
1124 08f0 7CF0 brlt .L127 |
1125 08f2 8091 0000 lds r24,EE_Parameter+52 |
1126 08f6 282F mov r18,r24 |
1127 08f8 3327 clr r19 |
1128 08fa 220F lsl r18 |
1129 08fc 331F rol r19 |
1130 08fe 220F lsl r18 |
1131 0900 331F rol r19 |
1132 0902 8091 0000 lds r24,ServoRollValue |
1133 0906 9091 0000 lds r25,(ServoRollValue)+1 |
1134 090a 2817 cp r18,r24 |
1135 090c 3907 cpc r19,r25 |
1136 090e 24F4 brge .L89 |
1137 .L127: |
1138 0910 3093 0000 sts (ServoRollValue)+1,r19 |
1139 0914 2093 0000 sts ServoRollValue,r18 |
1140 .L89: |
1141 0918 8091 0000 lds r24,RemainingPulse.1 |
1142 091c 9091 0000 lds r25,(RemainingPulse.1)+1 |
1143 0920 2091 0000 lds r18,ServoRollValue |
1144 0924 3091 0000 lds r19,(ServoRollValue)+1 |
1145 0928 820F add r24,r18 |
1146 092a 931F adc r25,r19 |
1147 092c 8050 subi r24,lo8(-(-512)) |
1148 092e 9240 sbci r25,hi8(-(-512)) |
1149 0930 9093 0000 sts (RemainingPulse.1)+1,r25 |
1150 0934 8093 0000 sts RemainingPulse.1,r24 |
1151 0938 8091 0000 lds r24,ServoRollValue |
1152 093c 9091 0000 lds r25,(ServoRollValue)+1 |
1153 0940 97FD sbrc r25,7 |
1154 0942 0396 adiw r24,3 |
1155 .L91: |
1156 0944 9595 asr r25 |
1157 0946 8795 ror r24 |
1158 0948 9595 asr r25 |
1159 094a 8795 ror r24 |
1160 094c 9093 0000 sts (ServoRollValue)+1,r25 |
1161 0950 8093 0000 sts ServoRollValue,r24 |
1162 0954 65C0 rjmp .L67 |
1163 .L92: |
1164 0956 8091 0000 lds r24,EE_Parameter+7 |
1165 095a E82F mov r30,r24 |
1166 095c FF27 clr r31 |
1167 095e EE0F add r30,r30 |
1168 0960 FF1F adc r31,r31 |
1169 0962 E050 subi r30,lo8(-(PPM_in)) |
1170 0964 F040 sbci r31,hi8(-(PPM_in)) |
1171 0966 8081 ld r24,Z |
1172 0968 9181 ldd r25,Z+1 |
1173 096a 805E subi r24,lo8(-32) |
1174 096c 9F4F sbci r25,hi8(-32) |
1175 096e ACF1 brlt .L132 |
1176 0970 8081 ld r24,Z |
1177 0972 9181 ldd r25,Z+1 |
1178 0974 8197 sbiw r24,33 |
1179 0976 1CF0 brlt .L95 |
1180 0978 8CED ldi r24,lo8(1500) |
1181 097a 95E0 ldi r25,hi8(1500) |
1182 097c 4DC0 rjmp .L128 |
1183 .L95: |
1184 097e 8091 0000 lds r24,CameraShutterCycle |
1185 0982 9091 0000 lds r25,(CameraShutterCycle)+1 |
1186 0986 C297 sbiw r24,50 |
1187 0988 78F0 brlo .L129 |
1188 098a 2091 0000 lds r18,CameraShutterCycleCounter |
1189 098e 3091 0000 lds r19,(CameraShutterCycleCounter)+1 |
1190 0992 8091 0000 lds r24,CameraShutterCycle |
1191 0996 9091 0000 lds r25,(CameraShutterCycle)+1 |
1192 099a 2817 cp r18,r24 |
1193 099c 3907 cpc r19,r25 |
1194 099e 49F4 brne .L99 |
1195 09a0 1092 0000 sts (CameraShutterCycleCounter)+1,__zero_reg__ |
1196 09a4 1092 0000 sts CameraShutterCycleCounter,__zero_reg__ |
1197 .L129: |
1198 09a8 5093 0000 sts (RemainingPulse.1)+1,r21 |
1199 09ac 4093 0000 sts RemainingPulse.1,r20 |
1200 09b0 37C0 rjmp .L67 |
1201 .L99: |
1202 09b2 8091 0000 lds r24,CameraShutterCycleCounter |
1203 09b6 9091 0000 lds r25,(CameraShutterCycleCounter)+1 |
1204 09ba 0196 adiw r24,1 |
1205 09bc 9093 0000 sts (CameraShutterCycleCounter)+1,r25 |
1206 09c0 8093 0000 sts CameraShutterCycleCounter,r24 |
1207 09c4 2091 0000 lds r18,CameraShutterCycleCounter |
1208 09c8 3091 0000 lds r19,(CameraShutterCycleCounter)+1 |
1209 09cc 8091 0000 lds r24,CameraShutterCycleOnCount |
1210 09d0 9091 0000 lds r25,(CameraShutterCycleOnCount)+1 |
1211 09d4 2817 cp r18,r24 |
1212 09d6 3907 cpc r19,r25 |
1213 09d8 19F5 brne .L67 |
1214 .L132: |
1215 09da 87E7 ldi r24,lo8(375) |
1216 09dc 91E0 ldi r25,hi8(375) |
1217 09de 1CC0 rjmp .L128 |
1218 .L102: |
1219 09e0 8091 0000 lds r24,Parameter_Servo4 |
1220 09e4 02C0 rjmp .L133 |
1221 .L103: |
1222 09e6 8091 0000 lds r24,Parameter_Servo5 |
1223 .L133: |
1224 09ea 9927 clr r25 |
1225 09ec 880F lsl r24 |
1226 09ee 991F rol r25 |
1227 09f0 880F lsl r24 |
1228 09f2 991F rol r25 |
1229 09f4 8755 subi r24,lo8(-(425)) |
1230 09f6 9E4F sbci r25,hi8(-(425)) |
1231 09f8 0FC0 rjmp .L128 |
1232 .L104: |
1233 09fa FF27 clr r31 |
1234 09fc EE0F add r30,r30 |
1235 09fe FF1F adc r31,r31 |
1236 0a00 E050 subi r30,lo8(-(PPM_in)) |
1237 0a02 F040 sbci r31,hi8(-(PPM_in)) |
1238 0a04 2081 ld r18,Z |
1239 0a06 3181 ldd r19,Z+1 |
1240 0a08 220F add r18,r18 |
1241 0a0a 331F adc r19,r19 |
1242 0a0c 8091 0000 lds r24,RemainingPulse.1 |
1243 0a10 9091 0000 lds r25,(RemainingPulse.1)+1 |
1244 0a14 820F add r24,r18 |
1245 0a16 931F adc r25,r19 |
1246 .L128: |
1247 0a18 9093 0000 sts (RemainingPulse.1)+1,r25 |
1248 0a1c 8093 0000 sts RemainingPulse.1,r24 |
1249 .L67: |
1250 0a20 8091 0000 lds r24,RemainingPulse.1 |
1251 0a24 9091 0000 lds r25,(RemainingPulse.1)+1 |
1252 0a28 45E0 ldi r20,hi8(1501) |
1253 0a2a 8D3D cpi r24,lo8(1501) |
1254 0a2c 9407 cpc r25,r20 |
1255 0a2e 18F0 brlo .L106 |
1256 0a30 8CED ldi r24,lo8(1500) |
1257 0a32 95E0 ldi r25,hi8(1500) |
1258 0a34 05C0 rjmp .L130 |
1259 .L106: |
1260 0a36 8757 subi r24,lo8(375) |
1261 0a38 9140 sbci r25,hi8(375) |
1262 0a3a 30F4 brsh .L107 |
1263 0a3c 87E7 ldi r24,lo8(375) |
1264 0a3e 91E0 ldi r25,hi8(375) |
1265 .L130: |
1266 0a40 9093 0000 sts (RemainingPulse.1)+1,r25 |
1267 0a44 8093 0000 sts RemainingPulse.1,r24 |
1268 .L107: |
1269 0a48 2091 0000 lds r18,RemainingPulse.1 |
1270 0a4c 3091 0000 lds r19,(RemainingPulse.1)+1 |
1271 0a50 2C5B subi r18,lo8(-(-188)) |
1272 0a52 3040 sbci r19,hi8(-(-188)) |
1273 0a54 3093 0000 sts (RemainingPulse.1)+1,r19 |
1274 0a58 2093 0000 sts RemainingPulse.1,r18 |
1275 0a5c 8091 0000 lds r24,ServoFrameTime.2 |
1276 0a60 9091 0000 lds r25,(ServoFrameTime.2)+1 |
1277 0a64 820F add r24,r18 |
1278 0a66 931F adc r25,r19 |
1279 .L134: |
1280 0a68 9093 0000 sts (ServoFrameTime.2)+1,r25 |
1281 0a6c 8093 0000 sts ServoFrameTime.2,r24 |
1282 0a70 2FC0 rjmp .L109 |
1283 .L64: |
1284 0a72 8091 B000 lds r24,176 |
1285 0a76 8064 ori r24,lo8(64) |
1286 0a78 8093 B000 sts 176,r24 |
1287 0a7c 8CEB ldi r24,lo8(188) |
1288 0a7e 90E0 ldi r25,hi8(188) |
1289 0a80 9093 0000 sts (RemainingPulse.1)+1,r25 |
1290 0a84 8093 0000 sts RemainingPulse.1,r24 |
1291 0a88 8091 0000 lds r24,ServoFrameTime.2 |
1292 0a8c 9091 0000 lds r25,(ServoFrameTime.2)+1 |
1293 0a90 8454 subi r24,lo8(-(188)) |
1294 0a92 9F4F sbci r25,hi8(-(188)) |
1295 0a94 9093 0000 sts (ServoFrameTime.2)+1,r25 |
1296 0a98 8093 0000 sts ServoFrameTime.2,r24 |
1297 0a9c 8091 0000 lds r24,ServoActive |
1298 0aa0 8823 tst r24 |
1299 0aa2 21F0 breq .L112 |
1300 0aa4 8091 0000 lds r24,SenderOkay |
1301 0aa8 853B cpi r24,lo8(-75) |
1302 0aaa 20F4 brsh .L111 |
1303 .L112: |
1304 0aac 8091 0000 lds r24,ServoActive |
1305 0ab0 8230 cpi r24,lo8(2) |
1306 0ab2 11F4 brne .L110 |
1307 .L111: |
1308 0ab4 4698 cbi 40-0x20,6 |
1309 0ab6 01C0 rjmp .L113 |
1310 .L110: |
1311 0ab8 469A sbi 40-0x20,6 |
1312 .L113: |
1313 0aba 8091 0000 lds r24,ServoIndex.3 |
1314 0abe 8F5F subi r24,lo8(-(1)) |
1315 0ac0 8093 0000 sts ServoIndex.3,r24 |
1316 0ac4 9091 0000 lds r25,EE_Parameter+53 |
1317 0ac8 9817 cp r25,r24 |
1318 0aca 10F4 brsh .L109 |
1319 0acc 1092 0000 sts ServoIndex.3,__zero_reg__ |
1320 .L109: |
1321 0ad0 81E0 ldi r24,lo8(1) |
1322 0ad2 8093 0000 sts PulseOutput.0,r24 |
1323 .L62: |
1324 0ad6 2091 0000 lds r18,RemainingPulse.1 |
1325 0ada 3091 0000 lds r19,(RemainingPulse.1)+1 |
1326 0ade 81E0 ldi r24,hi8(383) |
1327 0ae0 2F37 cpi r18,lo8(383) |
1328 0ae2 3807 cpc r19,r24 |
1329 0ae4 30F0 brlo .L115 |
1330 0ae6 8FEF ldi r24,lo8(-1) |
1331 0ae8 8093 B300 sts 179,r24 |
1332 0aec 2F5F subi r18,lo8(-(-255)) |
1333 0aee 3040 sbci r19,hi8(-(-255)) |
1334 0af0 0FC0 rjmp .L131 |
1335 .L115: |
1336 0af2 2F3F cpi r18,255 |
1337 0af4 3105 cpc r19,__zero_reg__ |
1338 0af6 C9F0 breq .L117 |
1339 0af8 C0F0 brlo .L117 |
1340 0afa A901 movw r20,r18 |
1341 0afc 4F5F subi r20,lo8(-(-255)) |
1342 0afe 5040 sbci r21,hi8(-(-255)) |
1343 0b00 4F37 cpi r20,127 |
1344 0b02 5105 cpc r21,__zero_reg__ |
1345 0b04 50F4 brsh .L118 |
1346 0b06 80E8 ldi r24,lo8(-128) |
1347 0b08 8093 B300 sts 179,r24 |
1348 0b0c 2058 subi r18,lo8(-(-128)) |
1349 0b0e 3040 sbci r19,hi8(-(-128)) |
1350 .L131: |
1351 0b10 3093 0000 sts (RemainingPulse.1)+1,r19 |
1352 0b14 2093 0000 sts RemainingPulse.1,r18 |
1353 0b18 12C0 rjmp .L43 |
1354 .L118: |
1355 0b1a 8FEF ldi r24,lo8(-1) |
1356 0b1c 8093 B300 sts 179,r24 |
1357 0b20 5093 0000 sts (RemainingPulse.1)+1,r21 |
1358 0b24 4093 0000 sts RemainingPulse.1,r20 |
1359 0b28 0AC0 rjmp .L43 |
1360 .L117: |
1361 0b2a 8091 0000 lds r24,RemainingPulse.1 |
1362 0b2e 8093 B300 sts 179,r24 |
1363 0b32 1092 0000 sts (RemainingPulse.1)+1,__zero_reg__ |
1364 0b36 1092 0000 sts RemainingPulse.1,__zero_reg__ |
1365 0b3a 1092 0000 sts PulseOutput.0,__zero_reg__ |
1366 .L43: |
1367 /* epilogue: frame size=0 */ |
1368 0b3e FF91 pop r31 |
1369 0b40 EF91 pop r30 |
1370 0b42 DF91 pop r29 |
1371 0b44 CF91 pop r28 |
1372 0b46 BF91 pop r27 |
1373 0b48 AF91 pop r26 |
1374 0b4a 9F91 pop r25 |
1375 0b4c 8F91 pop r24 |
1376 0b4e 7F91 pop r23 |
1377 0b50 6F91 pop r22 |
1378 0b52 5F91 pop r21 |
1379 0b54 4F91 pop r20 |
1380 0b56 3F91 pop r19 |
1381 0b58 2F91 pop r18 |
1382 0b5a 0F90 pop __tmp_reg__ |
1383 0b5c 0FBE out __SREG__,__tmp_reg__ |
1384 0b5e 0F90 pop __tmp_reg__ |
1385 0b60 1F90 pop __zero_reg__ |
1386 0b62 1895 reti |
1387 /* epilogue end (size=19) */ |
1388 /* function __vector_9 size 1056 (1018) */ |
1390 .lcomm tim_main,2 |
1391 /* File "timer0.c": code 1473 = 0x05c1 (1389), prologues 39, epilogues 45 */ |
DEFINED SYMBOLS |
*ABS*:00000000 timer0.c |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccT5cFTS.s:2 *ABS*:0000003f __SREG__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccT5cFTS.s:3 *ABS*:0000003e __SP_H__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccT5cFTS.s:4 *ABS*:0000003d __SP_L__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccT5cFTS.s:5 *ABS*:00000034 __CCP__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccT5cFTS.s:6 *ABS*:00000000 __tmp_reg__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccT5cFTS.s:7 *ABS*:00000001 __zero_reg__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccT5cFTS.s:11 .text:00000000 __vector_18 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccT5cFTS.s:1212 .bss:00000007 SendSPI |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccT5cFTS.s:1258 .bss:00000018 cnt.2239 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccT5cFTS.s:1188 .bss:00000000 CountMilliseconds |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccT5cFTS.s:1262 .data:00000008 cnt_1ms.2238 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccT5cFTS.s:1194 .bss:00000002 UpdateMotor |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccT5cFTS.s:1257 .bss:00000017 compass_active.2240 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccT5cFTS.s:1206 .bss:00000005 beeptime |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccT5cFTS.s:1224 .data:00000000 BeepMuster |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccT5cFTS.s:1200 .bss:00000003 cntKompass |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccT5cFTS.s:224 .text:00000206 SetDelay |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccT5cFTS.s:239 .text:0000021a CheckDelay |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccT5cFTS.s:255 .text:00000230 Delay_ms |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccT5cFTS.s:281 .text:0000025c Delay_ms_Mess |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccT5cFTS.s:315 .text:0000029c TIMER2_Init |
.bss:0000000d CameraShutterCycle |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccT5cFTS.s:376 .text:0000030a Timer_Init |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccT5cFTS.s:1259 .bss:00000019 tim_main |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccT5cFTS.s:403 .text:0000033a __vector_9 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccT5cFTS.s:1256 .bss:00000016 PulseOutput.2393 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccT5cFTS.s:1252 .data:00000006 ServoNickOffset.2397 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccT5cFTS.s:1231 .bss:00000009 ServoNickValue |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccT5cFTS.s:1255 .bss:00000014 RemainingPulse.2394 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccT5cFTS.s:1254 .bss:00000012 ServoFrameTime.2395 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccT5cFTS.s:1240 .bss:00000011 ServoIndex.2396 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccT5cFTS.s:1248 .data:00000004 ServoRollOffset.2398 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccT5cFTS.s:1237 .bss:0000000b ServoRollValue |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccT5cFTS.s:1239 .bss:0000000f CameraShutterCycleCounter |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccT5cFTS.s:1244 .data:00000002 CameraShutterCycleOnCount |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccT5cFTS.s:1218 .bss:00000008 ServoActive |
C:\Users\Arthur-P\AppData\Local\Temp/cccRbaaa.s:3 *ABS*:0000003f __SREG__ |
C:\Users\Arthur-P\AppData\Local\Temp/cccRbaaa.s:4 *ABS*:0000003e __SP_H__ |
C:\Users\Arthur-P\AppData\Local\Temp/cccRbaaa.s:5 *ABS*:0000003d __SP_L__ |
C:\Users\Arthur-P\AppData\Local\Temp/cccRbaaa.s:6 *ABS*:00000000 __tmp_reg__ |
C:\Users\Arthur-P\AppData\Local\Temp/cccRbaaa.s:7 *ABS*:00000001 __zero_reg__ |
C:\Users\Arthur-P\AppData\Local\Temp/cccRbaaa.s:15 .bss:00000000 ServoRollValue |
C:\Users\Arthur-P\AppData\Local\Temp/cccRbaaa.s:21 .bss:00000002 ServoNickValue |
C:\Users\Arthur-P\AppData\Local\Temp/cccRbaaa.s:27 .data:00000000 BeepMuster |
C:\Users\Arthur-P\AppData\Local\Temp/cccRbaaa.s:34 .bss:00000004 ServoActive |
C:\Users\Arthur-P\AppData\Local\Temp/cccRbaaa.s:40 .bss:00000005 SendSPI |
C:\Users\Arthur-P\AppData\Local\Temp/cccRbaaa.s:46 .bss:00000006 beeptime |
C:\Users\Arthur-P\AppData\Local\Temp/cccRbaaa.s:52 .bss:00000008 cntKompass |
C:\Users\Arthur-P\AppData\Local\Temp/cccRbaaa.s:58 .bss:0000000a UpdateMotor |
C:\Users\Arthur-P\AppData\Local\Temp/cccRbaaa.s:64 .bss:0000000b CountMilliseconds |
C:\Users\Arthur-P\AppData\Local\Temp/cccRbaaa.s:69 .data:00000002 CameraShutterCycleOnCount |
.bss:0000000d CameraShutterCycleCounter |
C:\Users\Arthur-P\AppData\Local\Temp/cccRbaaa.s:71 .bss:0000000f CameraShutterCycle |
C:\Users\Arthur-P\AppData\Local\Temp/cccRbaaa.s:75 .data:00000004 cnt_1ms.6 |
C:\Users\Arthur-P\AppData\Local\Temp/cccRbaaa.s:72 .bss:00000011 cnt.7 |
C:\Users\Arthur-P\AppData\Local\Temp/cccRbaaa.s:77 .bss:00000012 compass_active.8 |
C:\Users\Arthur-P\AppData\Local\Temp/cccRbaaa.s:82 .text:00000000 __vector_18 |
C:\Users\Arthur-P\AppData\Local\Temp/cccRbaaa.s:305 .text:00000216 SetDelay |
C:\Users\Arthur-P\AppData\Local\Temp/cccRbaaa.s:321 .text:00000228 CheckDelay |
C:\Users\Arthur-P\AppData\Local\Temp/cccRbaaa.s:340 .text:00000240 Delay_ms |
C:\Users\Arthur-P\AppData\Local\Temp/cccRbaaa.s:361 .text:0000025a Delay_ms_Mess |
C:\Users\Arthur-P\AppData\Local\Temp/cccRbaaa.s:391 .text:0000028a TIMER2_Init |
C:\Users\Arthur-P\AppData\Local\Temp/cccRbaaa.s:447 .text:0000030a Timer_Init |
C:\Users\Arthur-P\AppData\Local\Temp/cccRbaaa.s:475 .bss:00000019 tim_main |
C:\Users\Arthur-P\AppData\Local\Temp/cccRbaaa.s:78 .bss:00000013 PulseOutput.0 |
C:\Users\Arthur-P\AppData\Local\Temp/cccRbaaa.s:472 .bss:00000014 RemainingPulse.1 |
C:\Users\Arthur-P\AppData\Local\Temp/cccRbaaa.s:473 .bss:00000016 ServoFrameTime.2 |
C:\Users\Arthur-P\AppData\Local\Temp/cccRbaaa.s:474 .bss:00000018 ServoIndex.3 |
C:\Users\Arthur-P\AppData\Local\Temp/cccRbaaa.s:479 .data:00000005 ServoNickOffset.4 |
C:\Users\Arthur-P\AppData\Local\Temp/cccRbaaa.s:483 .data:00000007 ServoRollOffset.5 |
C:\Users\Arthur-P\AppData\Local\Temp/cccRbaaa.s:488 .text:00000338 __vector_9 |
UNDEFINED SYMBOLS |
__do_copy_data |
__do_clear_bss |
SpektrumTimer |
PlatinenVersion |
NaviDataOkay |
1275,7 → 1401,6 |
Parameter_UserParam8 |
Parameter_ServoNickControl |
IntegralNick |
__divmodsi4 |
__mulsi3 |
Parameter_ServoRollControl |
IntegralRoll |
1283,5 → 1408,3 |
Parameter_Servo4 |
Parameter_Servo5 |
SenderOkay |
__do_copy_data |
__do_clear_bss |
/branches/V0.80g-Arthur-P1/twimaster.lst |
---|
1,1132 → 1,1175 |
1 .file "twimaster.c" |
2 __SREG__ = 0x3f |
3 __SP_H__ = 0x3e |
4 __SP_L__ = 0x3d |
5 __CCP__ = 0x34 |
2 .arch atmega644p |
3 __SREG__ = 0x3f |
4 __SP_H__ = 0x3e |
5 __SP_L__ = 0x3d |
6 __tmp_reg__ = 0 |
7 __zero_reg__ = 1 |
8 .text |
9 .global I2C_Init |
11 I2C_Init: |
12 /* prologue: function */ |
13 /* frame size = 0 */ |
14 0000 9FB7 in r25,__SREG__ |
15 /* #APP */ |
16 ; 100 "twimaster.c" 1 |
17 0002 F894 cli |
18 ; 0 "" 2 |
19 /* #NOAPP */ |
20 0004 3998 cbi 39-32,1 |
21 0006 389A sbi 39-32,0 |
22 0008 88B1 in r24,40-32 |
23 000a 8360 ori r24,lo8(3) |
24 000c 88B9 out 40-32,r24 |
25 000e 8091 B900 lds r24,185 |
26 0012 8C7F andi r24,lo8(-4) |
27 0014 8093 B900 sts 185,r24 |
28 0018 8AE2 ldi r24,lo8(42) |
29 001a 8093 B800 sts 184,r24 |
30 001e 1092 0000 sts twi_state,__zero_reg__ |
31 0022 1092 0000 sts motor_write,__zero_reg__ |
32 0026 1092 0000 sts motor_read,__zero_reg__ |
33 002a E0E0 ldi r30,lo8(Motor) |
34 002c F0E0 ldi r31,hi8(Motor) |
35 .L2: |
36 002e 1082 st Z,__zero_reg__ |
37 0030 1182 std Z+1,__zero_reg__ |
38 0032 1282 std Z+2,__zero_reg__ |
39 0034 1382 std Z+3,__zero_reg__ |
40 0036 1482 std Z+4,__zero_reg__ |
41 0038 1582 std Z+5,__zero_reg__ |
42 003a 1682 std Z+6,__zero_reg__ |
43 003c 1782 std Z+7,__zero_reg__ |
44 003e 3896 adiw r30,8 |
45 0040 80E0 ldi r24,hi8(Motor+96) |
46 0042 E030 cpi r30,lo8(Motor+96) |
47 0044 F807 cpc r31,r24 |
48 0046 01F4 brne .L2 |
49 0048 9FBF out __SREG__,r25 |
50 /* epilogue start */ |
51 004a 0895 ret |
53 .global I2C_Reset |
55 I2C_Reset: |
56 004c EF92 push r14 |
57 004e FF92 push r15 |
58 0050 0F93 push r16 |
59 0052 1F93 push r17 |
60 /* prologue: function */ |
61 /* frame size = 0 */ |
62 0054 1092 0000 sts twi_state,__zero_reg__ |
63 0058 8CEB ldi r24,lo8(188) |
64 005a E82E mov r14,r24 |
65 005c F12C mov r15,__zero_reg__ |
66 005e 84E9 ldi r24,lo8(-108) |
67 0060 F701 movw r30,r14 |
68 0062 8083 st Z,r24 |
69 0064 1092 0000 sts motor_write,__zero_reg__ |
70 0068 1092 0000 sts motor_read,__zero_reg__ |
71 006c 80E8 ldi r24,lo8(-128) |
72 006e 8083 st Z,r24 |
73 0070 1092 BD00 sts 189,__zero_reg__ |
74 0074 1092 BA00 sts 186,__zero_reg__ |
75 0078 0BEB ldi r16,lo8(187) |
76 007a 10E0 ldi r17,hi8(187) |
77 007c F801 movw r30,r16 |
78 007e 1082 st Z,__zero_reg__ |
79 0080 1092 B900 sts 185,__zero_reg__ |
80 0084 1092 B800 sts 184,__zero_reg__ |
81 0088 0E94 0000 call I2C_Init |
82 008c F801 movw r30,r16 |
83 008e 1082 st Z,__zero_reg__ |
84 0090 85E8 ldi r24,lo8(-123) |
85 0092 F701 movw r30,r14 |
86 0094 8083 st Z,r24 |
87 0096 8091 0000 lds r24,BLFlags |
88 009a 8260 ori r24,lo8(2) |
89 009c 8093 0000 sts BLFlags,r24 |
90 /* epilogue start */ |
91 00a0 1F91 pop r17 |
92 00a2 0F91 pop r16 |
93 00a4 FF90 pop r15 |
94 00a6 EF90 pop r14 |
95 00a8 0895 ret |
97 .global __vector_26 |
99 __vector_26: |
100 00aa 1F92 push __zero_reg__ |
101 00ac 0F92 push r0 |
102 00ae 0FB6 in r0,__SREG__ |
103 00b0 0F92 push r0 |
104 00b2 1124 clr __zero_reg__ |
105 00b4 2F93 push r18 |
106 00b6 3F93 push r19 |
107 00b8 4F93 push r20 |
108 00ba 8F93 push r24 |
109 00bc 9F93 push r25 |
110 00be AF93 push r26 |
111 00c0 BF93 push r27 |
112 00c2 EF93 push r30 |
113 00c4 FF93 push r31 |
114 /* prologue: Signal */ |
115 /* frame size = 0 */ |
116 00c6 8091 0000 lds r24,twi_state |
117 00ca 8F5F subi r24,lo8(-(1)) |
118 00cc 8093 0000 sts twi_state,r24 |
119 00d0 8150 subi r24,lo8(-(-1)) |
120 00d2 E82F mov r30,r24 |
121 00d4 F0E0 ldi r31,lo8(0) |
122 00d6 E731 cpi r30,23 |
123 00d8 F105 cpc r31,__zero_reg__ |
124 00da 00F0 brlo .+2 |
125 00dc 00C0 rjmp .L8 |
126 00de E050 subi r30,lo8(-(gs(.L21))) |
127 00e0 F040 sbci r31,hi8(-(gs(.L21))) |
128 00e2 0C94 0000 jmp __tablejump2__ |
129 .data |
130 .section .progmem.gcc_sw_table, "a", @progbits |
131 .p2align 1 |
132 .L21: |
133 .data |
134 .section .progmem.gcc_sw_table, "a", @progbits |
135 .p2align 1 |
136 0000 0000 .word gs(.L55) |
137 0002 0000 .word gs(.L10) |
138 0004 0000 .word gs(.L11) |
139 0006 0000 .word gs(.L12) |
140 0008 0000 .word gs(.L13) |
141 000a 0000 .word gs(.L14) |
142 000c 0000 .word gs(.L15) |
143 000e 0000 .word gs(.L8) |
144 0010 0000 .word gs(.L8) |
145 0012 0000 .word gs(.L8) |
146 0014 0000 .word gs(.L8) |
147 0016 0000 .word gs(.L8) |
148 0018 0000 .word gs(.L8) |
149 001a 0000 .word gs(.L8) |
150 001c 0000 .word gs(.L8) |
151 001e 0000 .word gs(.L8) |
152 0020 0000 .word gs(.L8) |
153 0022 0000 .word gs(.L8) |
154 0024 0000 .word gs(.L16) |
155 0026 0000 .word gs(.L17) |
156 0028 0000 .word gs(.L18) |
157 002a 0000 .word gs(.L19) |
158 002c 0000 .word gs(.L20) |
159 .text |
160 .L23: |
161 00e6 8091 0000 lds r24,motor_write |
162 00ea 8F5F subi r24,lo8(-(1)) |
163 00ec 8093 0000 sts motor_write,r24 |
164 .L55: |
165 00f0 E091 0000 lds r30,motor_write |
166 00f4 F0E0 ldi r31,lo8(0) |
167 00f6 EE0F lsl r30 |
168 00f8 FF1F rol r31 |
169 00fa EE0F lsl r30 |
170 00fc FF1F rol r31 |
171 00fe E050 subi r30,lo8(-(Mixer)) |
172 0100 F040 sbci r31,hi8(-(Mixer)) |
173 0102 8585 ldd r24,Z+13 |
174 0104 1816 cp __zero_reg__,r24 |
175 0106 04F0 brlt .L22 |
176 0108 8091 0000 lds r24,motor_write |
177 010c 8C30 cpi r24,lo8(12) |
178 010e 00F0 brlo .L23 |
179 .L22: |
180 0110 8091 0000 lds r24,motor_write |
181 0114 8C30 cpi r24,lo8(12) |
182 0116 00F0 brlo .L24 |
183 0118 1092 0000 sts (BLConfig_WriteMask)+1,__zero_reg__ |
184 011c 1092 0000 sts BLConfig_WriteMask,__zero_reg__ |
185 0120 1092 0000 sts motor_write,__zero_reg__ |
186 0124 85E0 ldi r24,lo8(5) |
187 0126 8093 0000 sts twi_state,r24 |
188 012a 8091 0000 lds r24,motor_read |
189 012e 880F lsl r24 |
190 0130 8D5A subi r24,lo8(-(83)) |
191 0132 00C0 rjmp .L63 |
192 .L24: |
193 0134 8091 0000 lds r24,motor_write |
194 0138 880F lsl r24 |
195 013a 8E5A subi r24,lo8(-(82)) |
196 .L63: |
197 013c 8093 BB00 sts 187,r24 |
198 0140 85E8 ldi r24,lo8(-123) |
199 0142 00C0 rjmp .L59 |
200 .L10: |
201 0144 E091 0000 lds r30,motor_write |
202 0148 F0E0 ldi r31,lo8(0) |
203 014a 93E0 ldi r25,3 |
204 014c EE0F 1: lsl r30 |
205 014e FF1F rol r31 |
206 0150 9A95 dec r25 |
207 0152 01F4 brne 1b |
208 0154 E050 subi r30,lo8(-(Motor)) |
209 0156 F040 sbci r31,hi8(-(Motor)) |
210 0158 8181 ldd r24,Z+1 |
211 015a 8093 BB00 sts 187,r24 |
212 015e 85E8 ldi r24,lo8(-123) |
213 0160 8093 BC00 sts 188,r24 |
214 0164 E091 0000 lds r30,motor_write |
215 0168 F0E0 ldi r31,lo8(0) |
216 016a 83E0 ldi r24,3 |
217 016c EE0F 1: lsl r30 |
218 016e FF1F rol r31 |
219 0170 8A95 dec r24 |
220 0172 01F4 brne 1b |
221 0174 E050 subi r30,lo8(-(Motor)) |
222 0176 F040 sbci r31,hi8(-(Motor)) |
223 0178 8081 ld r24,Z |
224 017a 80FF sbrs r24,0 |
225 017c 00C0 rjmp .L30 |
226 .L26: |
227 017e E091 0000 lds r30,motor_write |
228 0182 F0E0 ldi r31,lo8(0) |
229 0184 B3E0 ldi r27,3 |
230 0186 EE0F 1: lsl r30 |
231 0188 FF1F rol r31 |
232 018a BA95 dec r27 |
233 018c 01F4 brne 1b |
234 018e E050 subi r30,lo8(-(Motor)) |
235 0190 F040 sbci r31,hi8(-(Motor)) |
236 0192 8281 ldd r24,Z+2 |
237 0194 8823 tst r24 |
238 0196 01F0 breq .L27 |
239 0198 8091 0000 lds r24,RequiredMotors |
240 019c 8730 cpi r24,lo8(7) |
241 019e 00F4 brsh .+2 |
242 01a0 00C0 rjmp .L54 |
243 .L27: |
244 01a2 8091 0000 lds r24,BLConfig_WriteMask |
245 01a6 9091 0000 lds r25,(BLConfig_WriteMask)+1 |
246 01aa 892B or r24,r25 |
247 01ac 01F0 breq .+2 |
248 01ae 00C0 rjmp .L54 |
249 01b0 8091 0000 lds r24,BLConfig_ReadMask |
250 01b4 9091 0000 lds r25,(BLConfig_ReadMask)+1 |
251 01b8 892B or r24,r25 |
252 01ba 01F0 breq .+2 |
253 01bc 00C0 rjmp .L54 |
254 01be 00C0 rjmp .L30 |
255 .L11: |
256 01c0 4091 0000 lds r20,motor_write |
257 01c4 2091 0000 lds r18,BLConfig_ReadMask |
258 01c8 3091 0000 lds r19,(BLConfig_ReadMask)+1 |
259 01cc 81E0 ldi r24,lo8(1) |
260 01ce 90E0 ldi r25,hi8(1) |
261 01d0 00C0 rjmp 2f |
262 01d2 880F 1: lsl r24 |
263 01d4 991F rol r25 |
264 01d6 4A95 2: dec r20 |
265 01d8 02F4 brpl 1b |
266 01da 8223 and r24,r18 |
267 01dc 9323 and r25,r19 |
268 01de 892B or r24,r25 |
269 01e0 01F0 breq .L28 |
270 01e2 E091 0000 lds r30,motor_write |
271 01e6 F0E0 ldi r31,lo8(0) |
272 01e8 A3E0 ldi r26,3 |
273 01ea EE0F 1: lsl r30 |
274 01ec FF1F rol r31 |
275 01ee AA95 dec r26 |
276 01f0 01F4 brne 1b |
277 01f2 E050 subi r30,lo8(-(Motor)) |
278 01f4 F040 sbci r31,hi8(-(Motor)) |
279 01f6 80E1 ldi r24,lo8(16) |
280 01f8 8483 std Z+4,r24 |
281 01fa 00C0 rjmp .L29 |
282 .L28: |
283 01fc E091 0000 lds r30,motor_write |
284 0200 F0E0 ldi r31,lo8(0) |
285 0202 43E0 ldi r20,3 |
286 0204 EE0F 1: lsl r30 |
287 0206 FF1F rol r31 |
288 0208 4A95 dec r20 |
289 020a 01F4 brne 1b |
290 020c E050 subi r30,lo8(-(Motor)) |
291 020e F040 sbci r31,hi8(-(Motor)) |
292 0210 1482 std Z+4,__zero_reg__ |
293 .L29: |
294 0212 E091 0000 lds r30,motor_write |
295 0216 A091 0000 lds r26,motor_write |
296 021a F0E0 ldi r31,lo8(0) |
297 021c 33E0 ldi r19,3 |
298 021e EE0F 1: lsl r30 |
299 0220 FF1F rol r31 |
300 0222 3A95 dec r19 |
301 0224 01F4 brne 1b |
302 0226 E050 subi r30,lo8(-(Motor)) |
303 0228 F040 sbci r31,hi8(-(Motor)) |
304 022a 9481 ldd r25,Z+4 |
305 022c 990F lsl r25 |
306 022e 990F lsl r25 |
307 0230 990F lsl r25 |
308 0232 B0E0 ldi r27,lo8(0) |
309 0234 23E0 ldi r18,3 |
310 0236 AA0F 1: lsl r26 |
311 0238 BB1F rol r27 |
312 023a 2A95 dec r18 |
313 023c 01F4 brne 1b |
314 023e A050 subi r26,lo8(-(Motor)) |
315 0240 B040 sbci r27,hi8(-(Motor)) |
316 0242 1296 adiw r26,2 |
317 0244 8C91 ld r24,X |
318 0246 8770 andi r24,lo8(7) |
319 0248 982B or r25,r24 |
320 024a 9093 BB00 sts 187,r25 |
321 024e 85E8 ldi r24,lo8(-123) |
322 0250 8093 BC00 sts 188,r24 |
323 0254 4091 0000 lds r20,motor_write |
324 0258 2091 0000 lds r18,BLConfig_WriteMask |
325 025c 3091 0000 lds r19,(BLConfig_WriteMask)+1 |
326 0260 81E0 ldi r24,lo8(1) |
327 0262 90E0 ldi r25,hi8(1) |
328 0264 00C0 rjmp 2f |
329 0266 880F 1: lsl r24 |
330 0268 991F rol r25 |
331 026a 4A95 2: dec r20 |
332 026c 02F4 brpl 1b |
333 026e 8223 and r24,r18 |
334 0270 9323 and r25,r19 |
335 0272 892B or r24,r25 |
336 0274 01F0 breq .L30 |
337 0276 80E0 ldi r24,lo8(BLConfig) |
338 0278 90E0 ldi r25,hi8(BLConfig) |
339 027a 9093 0000 sts (pBuff.1659)+1,r25 |
340 027e 8093 0000 sts pBuff.1659,r24 |
341 0282 88E0 ldi r24,lo8(8) |
342 0284 8093 0000 sts BuffLen.1660,r24 |
343 0288 00C0 rjmp .L54 |
344 .L30: |
345 028a 84E0 ldi r24,lo8(4) |
346 028c 00C0 rjmp .L61 |
347 .L12: |
348 028e E091 0000 lds r30,pBuff.1659 |
349 0292 F091 0000 lds r31,(pBuff.1659)+1 |
350 0296 8191 ld r24,Z+ |
351 0298 8093 BB00 sts 187,r24 |
352 029c 85E8 ldi r24,lo8(-123) |
353 029e 8093 BC00 sts 188,r24 |
354 02a2 F093 0000 sts (pBuff.1659)+1,r31 |
355 02a6 E093 0000 sts pBuff.1659,r30 |
356 02aa 8091 0000 lds r24,BuffLen.1660 |
357 02ae 8150 subi r24,lo8(-(-1)) |
358 02b0 8093 0000 sts BuffLen.1660,r24 |
359 02b4 8823 tst r24 |
360 02b6 01F4 brne .+2 |
361 02b8 00C0 rjmp .L54 |
362 02ba 83E0 ldi r24,lo8(3) |
363 02bc 00C0 rjmp .L61 |
364 .L13: |
365 02be 8091 B900 lds r24,185 |
366 02c2 8033 cpi r24,lo8(48) |
367 02c4 01F4 brne .L31 |
368 02c6 8091 0000 lds r24,missing_motor.1657 |
369 02ca 8823 tst r24 |
370 02cc 01F4 brne .L32 |
371 02ce 8091 0000 lds r24,motor_write |
372 02d2 8F5F subi r24,lo8(-(1)) |
373 02d4 8093 0000 sts missing_motor.1657,r24 |
374 .L32: |
375 02d8 E091 0000 lds r30,motor_write |
376 02dc F0E0 ldi r31,lo8(0) |
377 02de 93E0 ldi r25,3 |
378 02e0 EE0F 1: lsl r30 |
379 02e2 FF1F rol r31 |
380 02e4 9A95 dec r25 |
381 02e6 01F4 brne 1b |
382 02e8 E050 subi r30,lo8(-(Motor)) |
383 02ea F040 sbci r31,hi8(-(Motor)) |
384 02ec 8381 ldd r24,Z+3 |
385 02ee 8F77 andi r24,lo8(127) |
386 02f0 8F37 cpi r24,lo8(127) |
387 02f2 01F0 breq .L31 |
388 02f4 E091 0000 lds r30,motor_write |
389 02f8 F0E0 ldi r31,lo8(0) |
390 02fa 83E0 ldi r24,3 |
391 02fc EE0F 1: lsl r30 |
392 02fe FF1F rol r31 |
393 0300 8A95 dec r24 |
394 0302 01F4 brne 1b |
395 0304 E050 subi r30,lo8(-(Motor)) |
396 0306 F040 sbci r31,hi8(-(Motor)) |
397 0308 8381 ldd r24,Z+3 |
398 030a 8F5F subi r24,lo8(-(1)) |
399 030c 8383 std Z+3,r24 |
400 .L31: |
401 030e 1092 0000 sts twi_state,__zero_reg__ |
402 0312 84E9 ldi r24,lo8(-108) |
403 0314 8093 BC00 sts 188,r24 |
404 0318 8AE0 ldi r24,lo8(10) |
405 031a 90E0 ldi r25,hi8(10) |
406 031c 9093 0000 sts (I2CTimeout)+1,r25 |
407 0320 8093 0000 sts I2CTimeout,r24 |
408 0324 8091 0000 lds r24,motor_write |
409 0328 8F5F subi r24,lo8(-(1)) |
410 032a 8093 0000 sts motor_write,r24 |
411 032e 1092 0000 sts twi_state,__zero_reg__ |
412 0332 00C0 rjmp .L64 |
413 .L14: |
414 0334 8091 B900 lds r24,185 |
415 0338 8034 cpi r24,lo8(64) |
416 033a 01F0 breq .L33 |
417 033c E091 0000 lds r30,motor_read |
418 0340 F0E0 ldi r31,lo8(0) |
419 0342 B3E0 ldi r27,3 |
420 0344 EE0F 1: lsl r30 |
421 0346 FF1F rol r31 |
422 0348 BA95 dec r27 |
423 034a 01F4 brne 1b |
424 034c E050 subi r30,lo8(-(Motor)) |
425 034e F040 sbci r31,hi8(-(Motor)) |
426 0350 8381 ldd r24,Z+3 |
427 0352 8F77 andi r24,lo8(127) |
428 0354 8383 std Z+3,r24 |
429 0356 8091 0000 lds r24,motor_read |
430 035a 8F5F subi r24,lo8(-(1)) |
431 035c 8093 0000 sts motor_read,r24 |
432 0360 8091 0000 lds r24,motor_read |
433 0364 8C30 cpi r24,lo8(12) |
434 0366 00F0 brlo .L34 |
435 0368 1092 0000 sts motor_read,__zero_reg__ |
436 036c 1092 0000 sts (BLConfig_ReadMask)+1,__zero_reg__ |
437 0370 1092 0000 sts BLConfig_ReadMask,__zero_reg__ |
438 0374 8091 0000 lds r24,motor_read_temperature.1658 |
439 0378 8F5F subi r24,lo8(-(1)) |
440 037a 8093 0000 sts motor_read_temperature.1658,r24 |
441 037e 8C30 cpi r24,lo8(12) |
442 0380 00F0 brlo .L34 |
443 0382 1092 0000 sts motor_read_temperature.1658,__zero_reg__ |
444 0386 8091 0000 lds r24,BLFlags |
445 038a 8D7F andi r24,lo8(-3) |
446 038c 8093 0000 sts BLFlags,r24 |
447 .L34: |
448 0390 8091 0000 lds r24,BLFlags |
449 0394 8160 ori r24,lo8(1) |
450 0396 8093 0000 sts BLFlags,r24 |
451 039a 1092 0000 sts twi_state,__zero_reg__ |
452 039e 84E9 ldi r24,lo8(-108) |
453 03a0 00C0 rjmp .L57 |
454 .L33: |
455 03a2 E091 0000 lds r30,motor_read |
456 03a6 F0E0 ldi r31,lo8(0) |
457 03a8 A3E0 ldi r26,3 |
458 03aa EE0F 1: lsl r30 |
459 03ac FF1F rol r31 |
460 03ae AA95 dec r26 |
461 03b0 01F4 brne 1b |
462 03b2 E050 subi r30,lo8(-(Motor)) |
463 03b4 F040 sbci r31,hi8(-(Motor)) |
464 03b6 8381 ldd r24,Z+3 |
465 03b8 8068 ori r24,lo8(-128) |
466 03ba 8383 std Z+3,r24 |
467 03bc E091 0000 lds r30,motor_read |
468 03c0 F0E0 ldi r31,lo8(0) |
469 03c2 43E0 ldi r20,3 |
470 03c4 EE0F 1: lsl r30 |
471 03c6 FF1F rol r31 |
472 03c8 4A95 dec r20 |
473 03ca 01F4 brne 1b |
474 03cc E050 subi r30,lo8(-(Motor)) |
475 03ce F040 sbci r31,hi8(-(Motor)) |
476 03d0 8081 ld r24,Z |
477 03d2 80FF sbrs r24,0 |
478 03d4 00C0 rjmp .L36 |
479 03d6 E091 0000 lds r30,motor_read |
480 03da F0E0 ldi r31,lo8(0) |
481 03dc 33E0 ldi r19,3 |
482 03de EE0F 1: lsl r30 |
483 03e0 FF1F rol r31 |
484 03e2 3A95 dec r19 |
485 03e4 01F4 brne 1b |
486 03e6 E050 subi r30,lo8(-(Motor)) |
487 03e8 F040 sbci r31,hi8(-(Motor)) |
488 03ea 8481 ldd r24,Z+4 |
489 03ec 8823 tst r24 |
490 03ee 01F0 breq .L38 |
491 03f0 8031 cpi r24,lo8(16) |
492 03f2 01F4 brne .L37 |
493 03f4 80E0 ldi r24,lo8(BLConfig) |
494 03f6 90E0 ldi r25,hi8(BLConfig) |
495 03f8 9093 0000 sts (pBuff.1659)+1,r25 |
496 03fc 8093 0000 sts pBuff.1659,r24 |
497 0400 88E0 ldi r24,lo8(8) |
498 0402 00C0 rjmp .L56 |
499 .L38: |
500 0404 8091 0000 lds r24,motor_read |
501 0408 90E0 ldi r25,lo8(0) |
502 040a 23E0 ldi r18,3 |
503 040c 880F 1: lsl r24 |
504 040e 991F rol r25 |
505 0410 2A95 dec r18 |
506 0412 01F4 brne 1b |
507 0414 8050 subi r24,lo8(-(Motor+5)) |
508 0416 9040 sbci r25,hi8(-(Motor+5)) |
509 0418 9093 0000 sts (pBuff.1659)+1,r25 |
510 041c 8093 0000 sts pBuff.1659,r24 |
511 0420 9091 0000 lds r25,motor_read |
512 0424 8091 0000 lds r24,motor_read_temperature.1658 |
513 0428 9817 cp r25,r24 |
514 042a 01F4 brne .L42 |
515 042c 83E0 ldi r24,lo8(3) |
516 042e 00C0 rjmp .L56 |
517 .L36: |
518 0430 8091 0000 lds r24,motor_read |
519 0434 90E0 ldi r25,lo8(0) |
520 0436 B3E0 ldi r27,3 |
521 0438 880F 1: lsl r24 |
522 043a 991F rol r25 |
523 043c BA95 dec r27 |
524 043e 01F4 brne 1b |
525 0440 8050 subi r24,lo8(-(Motor+5)) |
526 0442 9040 sbci r25,hi8(-(Motor+5)) |
527 0444 9093 0000 sts (pBuff.1659)+1,r25 |
528 0448 8093 0000 sts pBuff.1659,r24 |
529 044c 8091 0000 lds r24,BLFlags |
530 0450 81FD sbrc r24,1 |
531 0452 00C0 rjmp .L41 |
532 0454 9091 0000 lds r25,motor_read |
533 0458 8091 0000 lds r24,motor_read_temperature.1658 |
534 045c 9817 cp r25,r24 |
535 045e 01F4 brne .L42 |
536 .L41: |
537 0460 82E0 ldi r24,lo8(2) |
538 0462 00C0 rjmp .L56 |
539 .L42: |
540 0464 81E0 ldi r24,lo8(1) |
541 .L56: |
542 0466 8093 0000 sts BuffLen.1660,r24 |
543 .L37: |
544 046a 8091 0000 lds r24,BuffLen.1660 |
545 046e 8130 cpi r24,lo8(1) |
546 0470 01F4 brne .L43 |
547 0472 85E8 ldi r24,lo8(-123) |
548 0474 00C0 rjmp .L57 |
549 .L43: |
550 0476 85EC ldi r24,lo8(-59) |
551 .L57: |
552 0478 8093 BC00 sts 188,r24 |
553 047c 8091 0000 lds r24,missing_motor.1657 |
554 0480 8093 0000 sts MissingMotor,r24 |
555 0484 1092 0000 sts missing_motor.1657,__zero_reg__ |
556 0488 00C0 rjmp .L54 |
557 .L15: |
558 048a 8091 BB00 lds r24,187 |
559 048e E091 0000 lds r30,pBuff.1659 |
560 0492 F091 0000 lds r31,(pBuff.1659)+1 |
561 0496 8193 st Z+,r24 |
562 0498 F093 0000 sts (pBuff.1659)+1,r31 |
563 049c E093 0000 sts pBuff.1659,r30 |
564 04a0 8091 0000 lds r24,BuffLen.1660 |
565 04a4 8150 subi r24,lo8(-(-1)) |
566 04a6 8093 0000 sts BuffLen.1660,r24 |
567 04aa 8230 cpi r24,lo8(2) |
568 04ac 00F0 brlo .L44 |
569 04ae 85EC ldi r24,lo8(-59) |
570 04b0 00C0 rjmp .L58 |
571 .L44: |
572 04b2 8130 cpi r24,lo8(1) |
573 04b4 01F4 brne .L46 |
574 04b6 85E8 ldi r24,lo8(-123) |
575 .L58: |
576 04b8 8093 BC00 sts 188,r24 |
577 04bc 86E0 ldi r24,lo8(6) |
578 04be 00C0 rjmp .L61 |
579 .L46: |
580 04c0 8091 0000 lds r24,BLFlags |
581 04c4 81FF sbrs r24,1 |
582 04c6 00C0 rjmp .L47 |
583 04c8 8091 0000 lds r24,FCFlags |
584 04cc 80FD sbrc r24,0 |
585 04ce 00C0 rjmp .L48 |
586 04d0 E091 0000 lds r30,motor_read |
587 04d4 F0E0 ldi r31,lo8(0) |
588 04d6 A3E0 ldi r26,3 |
589 04d8 EE0F 1: lsl r30 |
590 04da FF1F rol r31 |
591 04dc AA95 dec r26 |
592 04de 01F4 brne 1b |
593 04e0 E050 subi r30,lo8(-(Motor)) |
594 04e2 F040 sbci r31,hi8(-(Motor)) |
595 04e4 8681 ldd r24,Z+6 |
596 04e6 8A3F cpi r24,lo8(-6) |
597 04e8 01F4 brne .L48 |
598 04ea E091 0000 lds r30,motor_read |
599 04ee F0E0 ldi r31,lo8(0) |
600 04f0 43E0 ldi r20,3 |
601 04f2 EE0F 1: lsl r30 |
602 04f4 FF1F rol r31 |
603 04f6 4A95 dec r20 |
604 04f8 01F4 brne 1b |
605 04fa E050 subi r30,lo8(-(Motor)) |
606 04fc F040 sbci r31,hi8(-(Motor)) |
607 04fe 8081 ld r24,Z |
608 0500 8160 ori r24,lo8(1) |
609 0502 8083 st Z,r24 |
610 0504 00C0 rjmp .L47 |
611 .L48: |
612 0506 E091 0000 lds r30,motor_read |
613 050a F0E0 ldi r31,lo8(0) |
614 050c 33E0 ldi r19,3 |
615 050e EE0F 1: lsl r30 |
616 0510 FF1F rol r31 |
617 0512 3A95 dec r19 |
618 0514 01F4 brne 1b |
619 0516 E050 subi r30,lo8(-(Motor)) |
620 0518 F040 sbci r31,hi8(-(Motor)) |
621 051a 1082 st Z,__zero_reg__ |
622 .L47: |
623 051c 8091 0000 lds r24,motor_read |
624 0520 8F5F subi r24,lo8(-(1)) |
625 0522 8093 0000 sts motor_read,r24 |
626 0526 8091 0000 lds r24,motor_read |
627 052a 8C30 cpi r24,lo8(12) |
628 052c 00F0 brlo .L49 |
629 052e 1092 0000 sts motor_read,__zero_reg__ |
630 0532 1092 0000 sts (BLConfig_ReadMask)+1,__zero_reg__ |
631 0536 1092 0000 sts BLConfig_ReadMask,__zero_reg__ |
632 053a 8091 0000 lds r24,motor_read_temperature.1658 |
633 053e 8F5F subi r24,lo8(-(1)) |
634 0540 8093 0000 sts motor_read_temperature.1658,r24 |
635 0544 8C30 cpi r24,lo8(12) |
636 0546 00F0 brlo .L49 |
637 0548 1092 0000 sts motor_read_temperature.1658,__zero_reg__ |
638 054c 8091 0000 lds r24,BLFlags |
639 0550 8D7F andi r24,lo8(-3) |
640 0552 8093 0000 sts BLFlags,r24 |
641 .L49: |
642 0556 1092 0000 sts twi_state,__zero_reg__ |
643 055a 84E9 ldi r24,lo8(-108) |
644 055c 8093 BC00 sts 188,r24 |
645 0560 00C0 rjmp .L62 |
646 .L61: |
647 0562 8093 0000 sts twi_state,r24 |
648 0566 00C0 rjmp .L54 |
649 .L16: |
650 0568 88E9 ldi r24,lo8(-104) |
651 056a 00C0 rjmp .L63 |
652 .L17: |
653 056c 8091 0000 lds r24,dac_channel |
654 0570 90E0 ldi r25,lo8(0) |
655 0572 0896 adiw r24,8 |
656 0574 880F lsl r24 |
657 0576 991F rol r25 |
658 0578 00C0 rjmp .L63 |
659 .L18: |
660 057a 8091 0000 lds r24,dac_channel |
661 057e 8130 cpi r24,lo8(1) |
662 0580 01F0 breq .L51 |
663 0582 8130 cpi r24,lo8(1) |
664 0584 00F0 brlo .L50 |
665 0586 8230 cpi r24,lo8(2) |
666 0588 01F0 breq .+2 |
667 058a 00C0 rjmp .L54 |
668 058c 00C0 rjmp .L65 |
669 .L50: |
670 058e 8091 0000 lds r24,AnalogOffsetNick |
671 0592 00C0 rjmp .L63 |
672 .L51: |
673 0594 8091 0000 lds r24,AnalogOffsetRoll |
674 0598 00C0 rjmp .L63 |
675 .L65: |
676 059a 8091 0000 lds r24,AnalogOffsetGier |
677 059e 00C0 rjmp .L63 |
678 .L19: |
679 05a0 80E8 ldi r24,lo8(-128) |
680 05a2 00C0 rjmp .L63 |
681 .L20: |
682 05a4 1092 0000 sts twi_state,__zero_reg__ |
683 05a8 84E9 ldi r24,lo8(-108) |
684 05aa 8093 BC00 sts 188,r24 |
685 05ae 8AE0 ldi r24,lo8(10) |
686 05b0 90E0 ldi r25,hi8(10) |
687 05b2 9093 0000 sts (I2CTimeout)+1,r25 |
688 05b6 8093 0000 sts I2CTimeout,r24 |
689 05ba 8091 0000 lds r24,dac_channel |
690 05be 8230 cpi r24,lo8(2) |
691 05c0 00F4 brsh .L53 |
692 05c2 8091 0000 lds r24,dac_channel |
693 05c6 8F5F subi r24,lo8(-(1)) |
694 05c8 8093 0000 sts dac_channel,r24 |
695 05cc 82E1 ldi r24,lo8(18) |
696 05ce 8093 0000 sts twi_state,r24 |
697 .L64: |
698 05d2 8091 0000 lds r24,BLFlags |
699 05d6 8E7F andi r24,lo8(-2) |
700 05d8 8093 0000 sts BLFlags,r24 |
701 05dc 85EA ldi r24,lo8(-91) |
702 .L59: |
703 05de 8093 BC00 sts 188,r24 |
704 05e2 00C0 rjmp .L54 |
705 .L53: |
706 05e4 1092 0000 sts dac_channel,__zero_reg__ |
707 .L62: |
708 05e8 8091 0000 lds r24,BLFlags |
709 05ec 8160 ori r24,lo8(1) |
710 05ee 8093 0000 sts BLFlags,r24 |
711 05f2 00C0 rjmp .L54 |
712 .L8: |
713 05f4 1092 0000 sts twi_state,__zero_reg__ |
714 05f8 84E9 ldi r24,lo8(-108) |
715 05fa 8093 BC00 sts 188,r24 |
716 05fe 8091 0000 lds r24,BLFlags |
717 0602 8160 ori r24,lo8(1) |
718 0604 8093 0000 sts BLFlags,r24 |
719 0608 8AE0 ldi r24,lo8(10) |
720 060a 90E0 ldi r25,hi8(10) |
721 060c 9093 0000 sts (I2CTimeout)+1,r25 |
722 0610 8093 0000 sts I2CTimeout,r24 |
723 0614 1092 0000 sts motor_write,__zero_reg__ |
724 0618 1092 0000 sts motor_read,__zero_reg__ |
725 .L54: |
726 /* epilogue start */ |
727 061c FF91 pop r31 |
728 061e EF91 pop r30 |
729 0620 BF91 pop r27 |
730 0622 AF91 pop r26 |
731 0624 9F91 pop r25 |
732 0626 8F91 pop r24 |
733 0628 4F91 pop r20 |
734 062a 3F91 pop r19 |
735 062c 2F91 pop r18 |
736 062e 0F90 pop r0 |
737 0630 0FBE out __SREG__,r0 |
738 0632 0F90 pop r0 |
739 0634 1F90 pop __zero_reg__ |
740 0636 1895 reti |
742 .global I2C_ReadBLConfig |
744 I2C_ReadBLConfig: |
745 0638 FF92 push r15 |
746 063a 0F93 push r16 |
747 063c 1F93 push r17 |
748 063e CF93 push r28 |
749 0640 DF93 push r29 |
750 /* prologue: function */ |
751 /* frame size = 0 */ |
752 0642 982F mov r25,r24 |
753 0644 8091 0000 lds r24,MotorenEin |
754 0648 8823 tst r24 |
755 064a 01F0 breq .+2 |
756 064c 00C0 rjmp .L67 |
757 064e 8091 0000 lds r24,PC_MotortestActive |
758 0652 8823 tst r24 |
759 0654 01F0 breq .+2 |
760 0656 00C0 rjmp .L67 |
761 0658 9D30 cpi r25,lo8(13) |
762 065a 00F0 brlo .+2 |
763 065c 00C0 rjmp .L68 |
764 065e 9923 tst r25 |
765 0660 01F4 brne .L69 |
766 0662 86E0 ldi r24,lo8(6) |
767 0664 00C0 rjmp .L70 |
768 .L69: |
769 0666 C92F mov r28,r25 |
770 0668 D0E0 ldi r29,lo8(0) |
771 066a 2197 sbiw r28,1 |
772 066c FE01 movw r30,r28 |
773 066e 43E0 ldi r20,3 |
774 0670 EE0F 1: lsl r30 |
775 0672 FF1F rol r31 |
776 0674 4A95 dec r20 |
777 0676 01F4 brne 1b |
778 0678 E050 subi r30,lo8(-(Motor)) |
779 067a F040 sbci r31,hi8(-(Motor)) |
780 067c 8381 ldd r24,Z+3 |
781 067e 87FF sbrs r24,7 |
782 0680 00C0 rjmp .L68 |
783 0682 8081 ld r24,Z |
784 0684 80FD sbrc r24,0 |
785 0686 00C0 rjmp .L71 |
786 0688 83E0 ldi r24,lo8(3) |
787 068a 00C0 rjmp .L70 |
788 .L71: |
789 068c 80ED ldi r24,lo8(2000) |
790 068e 97E0 ldi r25,hi8(2000) |
791 0690 0E94 0000 call SetDelay |
792 0694 8C01 movw r16,r24 |
793 .L73: |
794 0696 8091 0000 lds r24,BLFlags |
795 069a 80FD sbrc r24,0 |
796 069c 00C0 rjmp .L72 |
797 069e C801 movw r24,r16 |
798 06a0 0E94 0000 call CheckDelay |
799 06a4 8823 tst r24 |
800 06a6 01F0 breq .L73 |
801 .L72: |
802 06a8 81E0 ldi r24,lo8(1) |
803 06aa 90E0 ldi r25,hi8(1) |
804 06ac 00C0 rjmp 2f |
805 06ae 880F 1: lsl r24 |
806 06b0 991F rol r25 |
807 06b2 CA95 2: dec r28 |
808 06b4 02F4 brpl 1b |
809 06b6 9093 0000 sts (BLConfig_ReadMask)+1,r25 |
810 06ba 8093 0000 sts BLConfig_ReadMask,r24 |
811 06be E0E0 ldi r30,lo8(Motor+1) |
812 06c0 F0E0 ldi r31,hi8(Motor+1) |
813 06c2 40E0 ldi r20,lo8(0) |
814 06c4 50E0 ldi r21,hi8(0) |
815 06c6 61E0 ldi r22,lo8(1) |
816 06c8 70E0 ldi r23,hi8(1) |
817 .L75: |
818 06ca 2091 0000 lds r18,BLConfig_ReadMask |
819 06ce 3091 0000 lds r19,(BLConfig_ReadMask)+1 |
820 06d2 CB01 movw r24,r22 |
821 06d4 042E mov r0,r20 |
822 06d6 00C0 rjmp 2f |
823 06d8 880F 1: lsl r24 |
824 06da 991F rol r25 |
825 06dc 0A94 2: dec r0 |
826 06de 02F4 brpl 1b |
827 06e0 8223 and r24,r18 |
828 06e2 9323 and r25,r19 |
829 06e4 892B or r24,r25 |
830 06e6 01F0 breq .L74 |
831 06e8 1082 st Z,__zero_reg__ |
832 06ea 1182 std Z+1,__zero_reg__ |
833 .L74: |
834 06ec 4F5F subi r20,lo8(-(1)) |
835 06ee 5F4F sbci r21,hi8(-(1)) |
836 06f0 3896 adiw r30,8 |
837 06f2 4C30 cpi r20,12 |
838 06f4 5105 cpc r21,__zero_reg__ |
839 06f6 01F4 brne .L75 |
840 06f8 1092 0000 sts motor_read,__zero_reg__ |
841 06fc 1092 0000 sts BLConfig,__zero_reg__ |
842 0700 1092 0000 sts BLConfig+7,__zero_reg__ |
843 0704 35EA ldi r19,lo8(-91) |
844 0706 F32E mov r15,r19 |
845 .L79: |
846 0708 1092 0000 sts twi_state,__zero_reg__ |
847 070c 8091 0000 lds r24,BLFlags |
848 0710 8E7F andi r24,lo8(-2) |
849 0712 8093 0000 sts BLFlags,r24 |
850 0716 F092 BC00 sts 188,r15 |
851 .L77: |
852 071a 8091 0000 lds r24,BLFlags |
853 071e 80FD sbrc r24,0 |
854 0720 00C0 rjmp .L76 |
855 0722 C801 movw r24,r16 |
856 0724 0E94 0000 call CheckDelay |
857 0728 8823 tst r24 |
858 072a 01F0 breq .L77 |
859 .L76: |
860 072c 8091 0000 lds r24,BLConfig_ReadMask |
861 0730 9091 0000 lds r25,(BLConfig_ReadMask)+1 |
862 0734 892B or r24,r25 |
863 0736 01F0 breq .L78 |
864 0738 C801 movw r24,r16 |
865 073a 0E94 0000 call CheckDelay |
866 073e 8823 tst r24 |
867 0740 01F0 breq .L79 |
868 .L78: |
869 0742 8091 0000 lds r24,BLConfig |
870 0746 8230 cpi r24,lo8(2) |
871 0748 01F0 breq .L80 |
872 074a 84E0 ldi r24,lo8(4) |
873 074c 00C0 rjmp .L70 |
874 .L80: |
875 074e 80E0 ldi r24,lo8(BLConfig) |
876 0750 90E0 ldi r25,hi8(BLConfig) |
877 0752 67E0 ldi r22,lo8(7) |
878 0754 70E0 ldi r23,hi8(7) |
879 0756 0E94 0000 call RAM_Checksum |
880 075a 9091 0000 lds r25,BLConfig+7 |
881 075e 8917 cp r24,r25 |
882 0760 01F4 brne .L81 |
883 0762 80E0 ldi r24,lo8(0) |
884 0764 00C0 rjmp .L70 |
885 .L81: |
886 0766 85E0 ldi r24,lo8(5) |
887 0768 00C0 rjmp .L70 |
888 .L67: |
889 076a 81E0 ldi r24,lo8(1) |
890 076c 00C0 rjmp .L70 |
891 .L68: |
892 076e 82E0 ldi r24,lo8(2) |
893 .L70: |
894 /* epilogue start */ |
895 0770 CDB7 in r28,__SP_L__ |
896 0772 DEB7 in r29,__SP_H__ |
897 0774 E5E0 ldi r30, lo8(5) |
898 0776 0C94 0000 jmp __epilogue_restores__ + ((18 - 5) * 2) |
900 .global I2C_WriteBLConfig |
902 I2C_WriteBLConfig: |
903 077a 1F93 push r17 |
904 077c CF93 push r28 |
905 077e DF93 push r29 |
906 /* prologue: function */ |
907 /* frame size = 0 */ |
908 0780 182F mov r17,r24 |
909 0782 8091 0000 lds r24,MotorenEin |
910 0786 8823 tst r24 |
911 0788 01F0 breq .+2 |
912 078a 00C0 rjmp .L88 |
913 078c 8091 0000 lds r24,PC_MotortestActive |
914 0790 8823 tst r24 |
915 0792 01F0 breq .+2 |
916 0794 00C0 rjmp .L88 |
917 0796 1D30 cpi r17,lo8(13) |
918 0798 00F0 brlo .+2 |
919 079a 00C0 rjmp .L89 |
920 079c 1123 tst r17 |
921 079e 01F0 breq .L90 |
922 07a0 E12F mov r30,r17 |
923 07a2 F0E0 ldi r31,lo8(0) |
924 07a4 53E0 ldi r21,3 |
925 07a6 EE0F 1: lsl r30 |
926 07a8 FF1F rol r31 |
927 07aa 5A95 dec r21 |
928 07ac 01F4 brne 1b |
929 07ae E050 subi r30,lo8(-(Motor-8)) |
930 07b0 F040 sbci r31,hi8(-(Motor-8)) |
931 07b2 8381 ldd r24,Z+3 |
932 07b4 87FF sbrs r24,7 |
933 07b6 00C0 rjmp .L89 |
934 07b8 8081 ld r24,Z |
935 07ba 80FD sbrc r24,0 |
936 07bc 00C0 rjmp .L90 |
937 07be 83E0 ldi r24,lo8(3) |
938 07c0 00C0 rjmp .L91 |
939 .L90: |
940 07c2 8091 0000 lds r24,BLConfig |
941 07c6 8230 cpi r24,lo8(2) |
942 07c8 01F0 breq .L92 |
943 07ca 84E0 ldi r24,lo8(4) |
944 07cc 00C0 rjmp .L91 |
945 .L92: |
946 07ce 80E0 ldi r24,lo8(BLConfig) |
947 07d0 90E0 ldi r25,hi8(BLConfig) |
948 07d2 67E0 ldi r22,lo8(7) |
949 07d4 70E0 ldi r23,hi8(7) |
950 07d6 0E94 0000 call RAM_Checksum |
951 07da 9091 0000 lds r25,BLConfig+7 |
952 07de 8917 cp r24,r25 |
953 07e0 01F0 breq .L93 |
954 07e2 85E0 ldi r24,lo8(5) |
955 07e4 00C0 rjmp .L91 |
956 .L93: |
957 07e6 80ED ldi r24,lo8(2000) |
958 07e8 97E0 ldi r25,hi8(2000) |
959 07ea 0E94 0000 call SetDelay |
960 07ee EC01 movw r28,r24 |
961 .L95: |
962 07f0 8091 0000 lds r24,BLFlags |
963 07f4 80FD sbrc r24,0 |
964 07f6 00C0 rjmp .L94 |
965 07f8 CE01 movw r24,r28 |
966 07fa 0E94 0000 call CheckDelay |
967 07fe 8823 tst r24 |
968 0800 01F0 breq .L95 |
969 .L94: |
970 0802 1123 tst r17 |
971 0804 01F4 brne .L96 |
972 0806 8FEF ldi r24,lo8(255) |
973 0808 90E0 ldi r25,hi8(255) |
974 .L109: |
975 080a 9093 0000 sts (BLConfig_WriteMask)+1,r25 |
976 080e 8093 0000 sts BLConfig_WriteMask,r24 |
977 0812 E0E0 ldi r30,lo8(Motor+1) |
978 0814 F0E0 ldi r31,hi8(Motor+1) |
979 0816 40E0 ldi r20,lo8(0) |
980 0818 50E0 ldi r21,hi8(0) |
981 081a 61E0 ldi r22,lo8(1) |
982 081c 70E0 ldi r23,hi8(1) |
983 081e 00C0 rjmp .L97 |
984 .L96: |
985 0820 212F mov r18,r17 |
986 0822 30E0 ldi r19,lo8(0) |
987 0824 2150 subi r18,lo8(-(-1)) |
988 0826 3040 sbci r19,hi8(-(-1)) |
989 0828 81E0 ldi r24,lo8(1) |
990 082a 90E0 ldi r25,hi8(1) |
991 082c 00C0 rjmp 2f |
992 082e 880F 1: lsl r24 |
993 0830 991F rol r25 |
994 0832 2A95 2: dec r18 |
995 0834 02F4 brpl 1b |
996 0836 00C0 rjmp .L109 |
997 .L97: |
998 0838 2091 0000 lds r18,BLConfig_WriteMask |
999 083c 3091 0000 lds r19,(BLConfig_WriteMask)+1 |
1000 0840 CB01 movw r24,r22 |
1001 0842 042E mov r0,r20 |
1002 0844 00C0 rjmp 2f |
1003 0846 880F 1: lsl r24 |
1004 0848 991F rol r25 |
1005 084a 0A94 2: dec r0 |
1006 084c 02F4 brpl 1b |
1007 084e 8223 and r24,r18 |
1008 0850 9323 and r25,r19 |
1009 0852 892B or r24,r25 |
1010 0854 01F0 breq .L99 |
1011 0856 1082 st Z,__zero_reg__ |
1012 0858 1182 std Z+1,__zero_reg__ |
1013 .L99: |
1014 085a 4F5F subi r20,lo8(-(1)) |
1015 085c 5F4F sbci r21,hi8(-(1)) |
1016 085e 3896 adiw r30,8 |
1017 0860 4C30 cpi r20,12 |
1018 0862 5105 cpc r21,__zero_reg__ |
1019 0864 01F4 brne .L97 |
1020 0866 1092 0000 sts motor_write,__zero_reg__ |
1021 086a 15EA ldi r17,lo8(-91) |
1022 .L103: |
1023 086c 1092 0000 sts twi_state,__zero_reg__ |
1024 0870 8091 0000 lds r24,BLFlags |
1025 0874 8E7F andi r24,lo8(-2) |
1026 0876 8093 0000 sts BLFlags,r24 |
1027 087a 1093 BC00 sts 188,r17 |
1028 .L101: |
1029 087e 8091 0000 lds r24,BLFlags |
1030 0882 80FD sbrc r24,0 |
1031 0884 00C0 rjmp .L100 |
1032 0886 CE01 movw r24,r28 |
1033 0888 0E94 0000 call CheckDelay |
1034 088c 8823 tst r24 |
1035 088e 01F0 breq .L101 |
1036 .L100: |
1037 0890 8091 0000 lds r24,BLConfig_WriteMask |
1038 0894 9091 0000 lds r25,(BLConfig_WriteMask)+1 |
1039 0898 892B or r24,r25 |
1040 089a 01F0 breq .L102 |
1041 089c CE01 movw r24,r28 |
1042 089e 0E94 0000 call CheckDelay |
1043 08a2 8823 tst r24 |
1044 08a4 01F0 breq .L103 |
1045 .L102: |
1046 08a6 8091 0000 lds r24,BLConfig_WriteMask |
1047 08aa 9091 0000 lds r25,(BLConfig_WriteMask)+1 |
1048 08ae 892B or r24,r25 |
1049 08b0 01F4 brne .L89 |
1050 08b2 80E0 ldi r24,lo8(0) |
1051 08b4 00C0 rjmp .L91 |
1052 .L88: |
1053 08b6 81E0 ldi r24,lo8(1) |
1054 08b8 00C0 rjmp .L91 |
1055 .L89: |
1056 08ba 82E0 ldi r24,lo8(2) |
1057 .L91: |
1058 /* epilogue start */ |
1059 08bc DF91 pop r29 |
1060 08be CF91 pop r28 |
1061 08c0 1F91 pop r17 |
1062 08c2 0895 ret |
1064 .global twi_state |
1065 .global twi_state |
1066 .section .bss |
1069 twi_state: |
1070 0000 00 .skip 1,0 |
1071 .global dac_channel |
1072 .global dac_channel |
1075 dac_channel: |
1076 0001 00 .skip 1,0 |
1077 .global motor_write |
1078 .global motor_write |
1081 motor_write: |
1082 0002 00 .skip 1,0 |
1083 .global motor_read |
1084 .global motor_read |
1087 motor_read: |
1088 0003 00 .skip 1,0 |
1089 .global I2CTimeout |
1090 .data |
1093 I2CTimeout: |
1094 0000 6400 .word 100 |
1095 .global MissingMotor |
1096 .global MissingMotor |
1097 .section .bss |
1100 MissingMotor: |
1101 0004 00 .skip 1,0 |
1102 .global BLFlags |
1103 .global BLFlags |
1106 BLFlags: |
1107 0005 00 .skip 1,0 |
1108 .global BLConfig_WriteMask |
1109 .global BLConfig_WriteMask |
1112 BLConfig_WriteMask: |
1113 0006 0000 .skip 2,0 |
1114 .global BLConfig_ReadMask |
1115 .global BLConfig_ReadMask |
1118 BLConfig_ReadMask: |
1119 0008 0000 .skip 2,0 |
1120 .lcomm BuffLen.1660,1 |
1121 .lcomm pBuff.1659,2 |
1122 .lcomm motor_read_temperature.1658,1 |
1123 .lcomm missing_motor.1657,1 |
1124 .comm Motor,96,1 |
1125 .comm BLConfig,8,1 |
1126 .global __do_copy_data |
1127 .global __do_clear_bss |
8 .global __do_copy_data |
9 .global __do_clear_bss |
10 .global BLConfig_ReadMask |
11 .global BLConfig_ReadMask |
12 .section .bss |
15 BLConfig_ReadMask: |
16 0000 0000 .skip 2,0 |
17 .global BLConfig_WriteMask |
18 .global BLConfig_WriteMask |
21 BLConfig_WriteMask: |
22 0002 0000 .skip 2,0 |
23 .global BLFlags |
24 .global BLFlags |
27 BLFlags: |
28 0004 00 .skip 1,0 |
29 .global MissingMotor |
30 .global MissingMotor |
33 MissingMotor: |
34 0005 00 .skip 1,0 |
35 .global I2CTimeout |
36 .data |
39 I2CTimeout: |
40 0000 6400 .word 100 |
41 .global motor_read |
42 .global motor_read |
43 .section .bss |
46 motor_read: |
47 0006 00 .skip 1,0 |
48 .global motor_write |
49 .global motor_write |
52 motor_write: |
53 0007 00 .skip 1,0 |
54 .global dac_channel |
55 .global dac_channel |
58 dac_channel: |
59 0008 00 .skip 1,0 |
60 .global twi_state |
61 .global twi_state |
64 twi_state: |
65 0009 00 .skip 1,0 |
66 .text |
67 .global I2C_Init |
69 I2C_Init: |
70 /* prologue: frame size=0 */ |
71 /* prologue end (size=0) */ |
72 0000 9FB7 in r25,95-0x20 |
73 /* #APP */ |
74 0002 F894 cli |
75 /* #NOAPP */ |
76 0004 3998 cbi 39-0x20,1 |
77 0006 389A sbi 39-0x20,0 |
78 0008 88B1 in r24,40-0x20 |
79 000a 8360 ori r24,lo8(3) |
80 000c 88B9 out 40-0x20,r24 |
81 000e 8091 B900 lds r24,185 |
82 0012 8C7F andi r24,lo8(-4) |
83 0014 8093 B900 sts 185,r24 |
84 0018 8AE2 ldi r24,lo8(42) |
85 001a 8093 B800 sts 184,r24 |
86 001e 1092 0000 sts twi_state,__zero_reg__ |
87 0022 1092 0000 sts motor_write,__zero_reg__ |
88 0026 1092 0000 sts motor_read,__zero_reg__ |
89 002a E0E0 ldi r30,lo8(Motor) |
90 002c F0E0 ldi r31,hi8(Motor) |
91 002e 8BE0 ldi r24,lo8(11) |
92 .L5: |
93 0030 1082 st Z,__zero_reg__ |
94 0032 1182 std Z+1,__zero_reg__ |
95 0034 1282 std Z+2,__zero_reg__ |
96 0036 1382 std Z+3,__zero_reg__ |
97 0038 1482 std Z+4,__zero_reg__ |
98 003a 1582 std Z+5,__zero_reg__ |
99 003c 1682 std Z+6,__zero_reg__ |
100 003e 1782 std Z+7,__zero_reg__ |
101 0040 8150 subi r24,lo8(-(-1)) |
102 0042 3896 adiw r30,8 |
103 0044 87FF sbrs r24,7 |
104 0046 F4CF rjmp .L5 |
105 0048 9FBF out 95-0x20,r25 |
106 /* epilogue: frame size=0 */ |
107 004a 0895 ret |
108 /* epilogue end (size=1) */ |
109 /* function I2C_Init size 39 (38) */ |
111 .global I2C_Reset |
113 I2C_Reset: |
114 /* prologue: frame size=0 */ |
115 /* prologue end (size=0) */ |
116 004c 1092 0000 sts twi_state,__zero_reg__ |
117 0050 84E9 ldi r24,lo8(-108) |
118 0052 8093 BC00 sts 188,r24 |
119 0056 1092 0000 sts motor_write,__zero_reg__ |
120 005a 1092 0000 sts motor_read,__zero_reg__ |
121 005e 80E8 ldi r24,lo8(-128) |
122 0060 8093 BC00 sts 188,r24 |
123 0064 1092 BD00 sts 189,__zero_reg__ |
124 0068 1092 BA00 sts 186,__zero_reg__ |
125 006c 1092 BB00 sts 187,__zero_reg__ |
126 0070 1092 B900 sts 185,__zero_reg__ |
127 0074 1092 B800 sts 184,__zero_reg__ |
128 0078 0E94 0000 call I2C_Init |
129 007c 1092 BB00 sts 187,__zero_reg__ |
130 0080 85E8 ldi r24,lo8(-123) |
131 0082 8093 BC00 sts 188,r24 |
132 0086 8091 0000 lds r24,BLFlags |
133 008a 8260 ori r24,lo8(2) |
134 008c 8093 0000 sts BLFlags,r24 |
135 /* epilogue: frame size=0 */ |
136 0090 0895 ret |
137 /* epilogue end (size=1) */ |
138 /* function I2C_Reset size 35 (34) */ |
140 .lcomm missing_motor.0,1 |
141 .lcomm motor_read_temperature.1,1 |
142 .lcomm pBuff.2,2 |
143 .lcomm BuffLen.3,1 |
144 .global __vector_26 |
146 __vector_26: |
147 /* prologue: frame size=0 */ |
148 0092 1F92 push __zero_reg__ |
149 0094 0F92 push __tmp_reg__ |
150 0096 0FB6 in __tmp_reg__,__SREG__ |
151 0098 0F92 push __tmp_reg__ |
152 009a 1124 clr __zero_reg__ |
153 009c 2F93 push r18 |
154 009e 3F93 push r19 |
155 00a0 4F93 push r20 |
156 00a2 5F93 push r21 |
157 00a4 8F93 push r24 |
158 00a6 9F93 push r25 |
159 00a8 EF93 push r30 |
160 00aa FF93 push r31 |
161 /* prologue end (size=13) */ |
162 00ac 8091 0000 lds r24,twi_state |
163 00b0 282F mov r18,r24 |
164 00b2 3327 clr r19 |
165 00b4 4427 clr r20 |
166 00b6 5527 clr r21 |
167 00b8 8F5F subi r24,lo8(-(1)) |
168 00ba 8093 0000 sts twi_state,r24 |
169 00be F901 movw r30,r18 |
170 00c0 2731 cpi r18,23 |
171 00c2 3105 cpc r19,__zero_reg__ |
172 00c4 08F0 brlo .+2 |
173 00c6 B3C2 rjmp .L72 |
174 00c8 E050 subi r30,lo8(-(pm(.L73))) |
175 00ca F040 sbci r31,hi8(-(pm(.L73))) |
176 00cc 0C94 0000 jmp __tablejump2__ |
177 .data |
178 .section .progmem.gcc_sw_table, "a", @progbits |
179 .p2align 1 |
180 .L73: |
181 0000 0000 .word pm(.L76) |
182 0002 0000 .word pm(.L17) |
183 0004 0000 .word pm(.L22) |
184 0006 0000 .word pm(.L27) |
185 0008 0000 .word pm(.L29) |
186 000a 0000 .word pm(.L33) |
187 000c 0000 .word pm(.L50) |
188 000e 0000 .word pm(.L72) |
189 0010 0000 .word pm(.L72) |
190 0012 0000 .word pm(.L72) |
191 0014 0000 .word pm(.L72) |
192 0016 0000 .word pm(.L72) |
193 0018 0000 .word pm(.L72) |
194 001a 0000 .word pm(.L72) |
195 001c 0000 .word pm(.L72) |
196 001e 0000 .word pm(.L72) |
197 0020 0000 .word pm(.L72) |
198 0022 0000 .word pm(.L72) |
199 0024 0000 .word pm(.L60) |
200 0026 0000 .word pm(.L61) |
201 0028 0000 .word pm(.L62) |
202 002a 0000 .word pm(.L68) |
203 002c 0000 .word pm(.L69) |
204 .text |
205 .L75: |
206 00d0 8091 0000 lds r24,motor_write |
207 00d4 8C30 cpi r24,lo8(12) |
208 00d6 90F4 brsh .L13 |
209 00d8 8091 0000 lds r24,motor_write |
210 00dc 8F5F subi r24,lo8(-(1)) |
211 00de 8093 0000 sts motor_write,r24 |
212 .L76: |
213 00e2 8091 0000 lds r24,motor_write |
214 00e6 E82F mov r30,r24 |
215 00e8 FF27 clr r31 |
216 00ea EE0F lsl r30 |
217 00ec FF1F rol r31 |
218 00ee EE0F lsl r30 |
219 00f0 FF1F rol r31 |
220 00f2 E050 subi r30,lo8(-(Mixer)) |
221 00f4 F040 sbci r31,hi8(-(Mixer)) |
222 00f6 8585 ldd r24,Z+13 |
223 00f8 1816 cp __zero_reg__,r24 |
224 00fa 54F7 brge .L75 |
225 .L13: |
226 00fc 8091 0000 lds r24,motor_write |
227 0100 8C30 cpi r24,lo8(12) |
228 0102 70F0 brlo .L15 |
229 0104 1092 0000 sts (BLConfig_WriteMask)+1,__zero_reg__ |
230 0108 1092 0000 sts BLConfig_WriteMask,__zero_reg__ |
231 010c 1092 0000 sts motor_write,__zero_reg__ |
232 0110 85E0 ldi r24,lo8(5) |
233 0112 8093 0000 sts twi_state,r24 |
234 0116 8091 0000 lds r24,motor_read |
235 011a 880F lsl r24 |
236 011c 8D5A subi r24,lo8(-(83)) |
237 011e 04C0 rjmp .L84 |
238 .L15: |
239 0120 8091 0000 lds r24,motor_write |
240 0124 880F lsl r24 |
241 0126 8E5A subi r24,lo8(-(82)) |
242 .L84: |
243 0128 8093 BB00 sts 187,r24 |
244 012c 85E8 ldi r24,lo8(-123) |
245 012e 74C2 rjmp .L80 |
246 .L17: |
247 0130 8091 0000 lds r24,motor_write |
248 0134 E82F mov r30,r24 |
249 0136 FF27 clr r31 |
250 0138 83E0 ldi r24,3 |
251 013a EE0F 1: lsl r30 |
252 013c FF1F rol r31 |
253 013e 8A95 dec r24 |
254 0140 E1F7 brne 1b |
255 0142 E050 subi r30,lo8(-(Motor)) |
256 0144 F040 sbci r31,hi8(-(Motor)) |
257 0146 8181 ldd r24,Z+1 |
258 0148 8093 BB00 sts 187,r24 |
259 014c 85E8 ldi r24,lo8(-123) |
260 014e 8093 BC00 sts 188,r24 |
261 0152 8091 0000 lds r24,motor_write |
262 0156 E82F mov r30,r24 |
263 0158 FF27 clr r31 |
264 015a EE0F lsl r30 |
265 015c FF1F rol r31 |
266 015e EE0F lsl r30 |
267 0160 FF1F rol r31 |
268 0162 EE0F lsl r30 |
269 0164 FF1F rol r31 |
270 0166 E050 subi r30,lo8(-(Motor)) |
271 0168 F040 sbci r31,hi8(-(Motor)) |
272 016a 8081 ld r24,Z |
273 016c 80FF sbrs r24,0 |
274 016e 91C0 rjmp .L25 |
275 0170 8091 0000 lds r24,motor_write |
276 0174 E82F mov r30,r24 |
277 0176 FF27 clr r31 |
278 0178 EE0F lsl r30 |
279 017a FF1F rol r31 |
280 017c EE0F lsl r30 |
281 017e FF1F rol r31 |
282 0180 EE0F lsl r30 |
283 0182 FF1F rol r31 |
284 0184 E050 subi r30,lo8(-(Motor)) |
285 0186 F040 sbci r31,hi8(-(Motor)) |
286 0188 8281 ldd r24,Z+2 |
287 018a 8823 tst r24 |
288 018c 29F0 breq .L21 |
289 018e 8091 0000 lds r24,RequiredMotors |
290 0192 8730 cpi r24,lo8(7) |
291 0194 08F4 brsh .+2 |
292 0196 5FC2 rjmp .L9 |
293 .L21: |
294 0198 8091 0000 lds r24,BLConfig_WriteMask |
295 019c 9091 0000 lds r25,(BLConfig_WriteMask)+1 |
296 01a0 892B or r24,r25 |
297 01a2 09F0 breq .+2 |
298 01a4 58C2 rjmp .L9 |
299 01a6 8091 0000 lds r24,BLConfig_ReadMask |
300 01aa 9091 0000 lds r25,(BLConfig_ReadMask)+1 |
301 01ae 892B or r24,r25 |
302 01b0 09F0 breq .+2 |
303 01b2 51C2 rjmp .L9 |
304 01b4 6EC0 rjmp .L25 |
305 .L22: |
306 01b6 8091 0000 lds r24,motor_write |
307 01ba 21E0 ldi r18,lo8(1) |
308 01bc 30E0 ldi r19,hi8(1) |
309 01be 02C0 rjmp 2f |
310 01c0 220F 1: lsl r18 |
311 01c2 331F rol r19 |
312 01c4 8A95 2: dec r24 |
313 01c6 E2F7 brpl 1b |
314 01c8 8091 0000 lds r24,BLConfig_ReadMask |
315 01cc 9091 0000 lds r25,(BLConfig_ReadMask)+1 |
316 01d0 2823 and r18,r24 |
317 01d2 3923 and r19,r25 |
318 01d4 232B or r18,r19 |
319 01d6 79F0 breq .L23 |
320 01d8 8091 0000 lds r24,motor_write |
321 01dc E82F mov r30,r24 |
322 01de FF27 clr r31 |
323 01e0 EE0F lsl r30 |
324 01e2 FF1F rol r31 |
325 01e4 EE0F lsl r30 |
326 01e6 FF1F rol r31 |
327 01e8 EE0F lsl r30 |
328 01ea FF1F rol r31 |
329 01ec E050 subi r30,lo8(-(Motor)) |
330 01ee F040 sbci r31,hi8(-(Motor)) |
331 01f0 80E1 ldi r24,lo8(16) |
332 01f2 8483 std Z+4,r24 |
333 01f4 0DC0 rjmp .L24 |
334 .L23: |
335 01f6 8091 0000 lds r24,motor_write |
336 01fa E82F mov r30,r24 |
337 01fc FF27 clr r31 |
338 01fe EE0F lsl r30 |
339 0200 FF1F rol r31 |
340 0202 EE0F lsl r30 |
341 0204 FF1F rol r31 |
342 0206 EE0F lsl r30 |
343 0208 FF1F rol r31 |
344 020a E050 subi r30,lo8(-(Motor)) |
345 020c F040 sbci r31,hi8(-(Motor)) |
346 020e 1482 std Z+4,__zero_reg__ |
347 .L24: |
348 0210 8091 0000 lds r24,motor_write |
349 0214 E82F mov r30,r24 |
350 0216 FF27 clr r31 |
351 0218 53E0 ldi r21,3 |
352 021a EE0F 1: lsl r30 |
353 021c FF1F rol r31 |
354 021e 5A95 dec r21 |
355 0220 E1F7 brne 1b |
356 0222 E050 subi r30,lo8(-(Motor)) |
357 0224 F040 sbci r31,hi8(-(Motor)) |
358 0226 8481 ldd r24,Z+4 |
359 0228 282F mov r18,r24 |
360 022a 3327 clr r19 |
361 022c 43E0 ldi r20,3 |
362 022e 220F 1: lsl r18 |
363 0230 331F rol r19 |
364 0232 4A95 dec r20 |
365 0234 E1F7 brne 1b |
366 0236 8091 0000 lds r24,motor_write |
367 023a E82F mov r30,r24 |
368 023c FF27 clr r31 |
369 023e 93E0 ldi r25,3 |
370 0240 EE0F 1: lsl r30 |
371 0242 FF1F rol r31 |
372 0244 9A95 dec r25 |
373 0246 E1F7 brne 1b |
374 0248 E050 subi r30,lo8(-(Motor)) |
375 024a F040 sbci r31,hi8(-(Motor)) |
376 024c 8281 ldd r24,Z+2 |
377 024e 8770 andi r24,lo8(7) |
378 0250 822B or r24,r18 |
379 0252 8093 BB00 sts 187,r24 |
380 0256 85E8 ldi r24,lo8(-123) |
381 0258 8093 BC00 sts 188,r24 |
382 025c 2091 0000 lds r18,motor_write |
383 0260 81E0 ldi r24,lo8(1) |
384 0262 90E0 ldi r25,hi8(1) |
385 0264 02C0 rjmp 2f |
386 0266 880F 1: lsl r24 |
387 0268 991F rol r25 |
388 026a 2A95 2: dec r18 |
389 026c E2F7 brpl 1b |
390 026e 2091 0000 lds r18,BLConfig_WriteMask |
391 0272 3091 0000 lds r19,(BLConfig_WriteMask)+1 |
392 0276 8223 and r24,r18 |
393 0278 9323 and r25,r19 |
394 027a 892B or r24,r25 |
395 027c 51F0 breq .L25 |
396 027e 80E0 ldi r24,lo8(BLConfig) |
397 0280 90E0 ldi r25,hi8(BLConfig) |
398 0282 9093 0000 sts (pBuff.2)+1,r25 |
399 0286 8093 0000 sts pBuff.2,r24 |
400 028a 88E0 ldi r24,lo8(8) |
401 028c 8093 0000 sts BuffLen.3,r24 |
402 0290 E2C1 rjmp .L9 |
403 .L25: |
404 0292 84E0 ldi r24,lo8(4) |
405 0294 80C1 rjmp .L82 |
406 .L27: |
407 0296 E091 0000 lds r30,pBuff.2 |
408 029a F091 0000 lds r31,(pBuff.2)+1 |
409 029e 8191 ld r24,Z+ |
410 02a0 8093 BB00 sts 187,r24 |
411 02a4 85E8 ldi r24,lo8(-123) |
412 02a6 8093 BC00 sts 188,r24 |
413 02aa F093 0000 sts (pBuff.2)+1,r31 |
414 02ae E093 0000 sts pBuff.2,r30 |
415 02b2 8091 0000 lds r24,BuffLen.3 |
416 02b6 8150 subi r24,lo8(-(-1)) |
417 02b8 8093 0000 sts BuffLen.3,r24 |
418 02bc 8823 tst r24 |
419 02be 09F4 brne .+2 |
420 02c0 CAC1 rjmp .L9 |
421 02c2 83E0 ldi r24,lo8(3) |
422 02c4 68C1 rjmp .L82 |
423 .L29: |
424 02c6 8091 B900 lds r24,185 |
425 02ca 8033 cpi r24,lo8(48) |
426 02cc 51F5 brne .L30 |
427 02ce 8091 0000 lds r24,missing_motor.0 |
428 02d2 8823 tst r24 |
429 02d4 29F4 brne .L31 |
430 02d6 8091 0000 lds r24,motor_write |
431 02da 8F5F subi r24,lo8(-(1)) |
432 02dc 8093 0000 sts missing_motor.0,r24 |
433 .L31: |
434 02e0 8091 0000 lds r24,motor_write |
435 02e4 E82F mov r30,r24 |
436 02e6 FF27 clr r31 |
437 02e8 83E0 ldi r24,3 |
438 02ea EE0F 1: lsl r30 |
439 02ec FF1F rol r31 |
440 02ee 8A95 dec r24 |
441 02f0 E1F7 brne 1b |
442 02f2 E050 subi r30,lo8(-(Motor)) |
443 02f4 F040 sbci r31,hi8(-(Motor)) |
444 02f6 8381 ldd r24,Z+3 |
445 02f8 9927 clr r25 |
446 02fa 8F77 andi r24,lo8(127) |
447 02fc 9070 andi r25,hi8(127) |
448 02fe 8F37 cpi r24,127 |
449 0300 9105 cpc r25,__zero_reg__ |
450 0302 7CF4 brge .L30 |
451 0304 8091 0000 lds r24,motor_write |
452 0308 E82F mov r30,r24 |
453 030a FF27 clr r31 |
454 030c EE0F lsl r30 |
455 030e FF1F rol r31 |
456 0310 EE0F lsl r30 |
457 0312 FF1F rol r31 |
458 0314 EE0F lsl r30 |
459 0316 FF1F rol r31 |
460 0318 E050 subi r30,lo8(-(Motor)) |
461 031a F040 sbci r31,hi8(-(Motor)) |
462 031c 8381 ldd r24,Z+3 |
463 031e 8F5F subi r24,lo8(-(1)) |
464 0320 8383 std Z+3,r24 |
465 .L30: |
466 0322 1092 0000 sts twi_state,__zero_reg__ |
467 0326 84E9 ldi r24,lo8(-108) |
468 0328 8093 BC00 sts 188,r24 |
469 032c 8AE0 ldi r24,lo8(10) |
470 032e 90E0 ldi r25,hi8(10) |
471 0330 9093 0000 sts (I2CTimeout)+1,r25 |
472 0334 8093 0000 sts I2CTimeout,r24 |
473 0338 8091 0000 lds r24,motor_write |
474 033c 8F5F subi r24,lo8(-(1)) |
475 033e 8093 0000 sts motor_write,r24 |
476 0342 1092 0000 sts twi_state,__zero_reg__ |
477 0346 62C1 rjmp .L85 |
478 .L33: |
479 0348 8091 B900 lds r24,185 |
480 034c 8034 cpi r24,lo8(64) |
481 034e A9F1 breq .L34 |
482 0350 8091 0000 lds r24,motor_read |
483 0354 E82F mov r30,r24 |
484 0356 FF27 clr r31 |
485 0358 EE0F lsl r30 |
486 035a FF1F rol r31 |
487 035c EE0F lsl r30 |
488 035e FF1F rol r31 |
489 0360 EE0F lsl r30 |
490 0362 FF1F rol r31 |
491 0364 E050 subi r30,lo8(-(Motor)) |
492 0366 F040 sbci r31,hi8(-(Motor)) |
493 0368 8381 ldd r24,Z+3 |
494 036a 8F77 andi r24,lo8(127) |
495 036c 8383 std Z+3,r24 |
496 036e 8091 0000 lds r24,motor_read |
497 0372 8F5F subi r24,lo8(-(1)) |
498 0374 8093 0000 sts motor_read,r24 |
499 0378 8091 0000 lds r24,motor_read |
500 037c 8C30 cpi r24,lo8(12) |
501 037e A0F0 brlo .L35 |
502 0380 1092 0000 sts motor_read,__zero_reg__ |
503 0384 1092 0000 sts (BLConfig_ReadMask)+1,__zero_reg__ |
504 0388 1092 0000 sts BLConfig_ReadMask,__zero_reg__ |
505 038c 8091 0000 lds r24,motor_read_temperature.1 |
506 0390 8F5F subi r24,lo8(-(1)) |
507 0392 8093 0000 sts motor_read_temperature.1,r24 |
508 0396 8C30 cpi r24,lo8(12) |
509 0398 38F0 brlo .L35 |
510 039a 1092 0000 sts motor_read_temperature.1,__zero_reg__ |
511 039e 8091 0000 lds r24,BLFlags |
512 03a2 8D7F andi r24,lo8(-3) |
513 03a4 8093 0000 sts BLFlags,r24 |
514 .L35: |
515 03a8 8091 0000 lds r24,BLFlags |
516 03ac 8160 ori r24,lo8(1) |
517 03ae 8093 0000 sts BLFlags,r24 |
518 03b2 1092 0000 sts twi_state,__zero_reg__ |
519 03b6 84E9 ldi r24,lo8(-108) |
520 03b8 71C0 rjmp .L78 |
521 .L34: |
522 03ba 8091 0000 lds r24,motor_read |
523 03be E82F mov r30,r24 |
524 03c0 FF27 clr r31 |
525 03c2 EE0F lsl r30 |
526 03c4 FF1F rol r31 |
527 03c6 EE0F lsl r30 |
528 03c8 FF1F rol r31 |
529 03ca EE0F lsl r30 |
530 03cc FF1F rol r31 |
531 03ce E050 subi r30,lo8(-(Motor)) |
532 03d0 F040 sbci r31,hi8(-(Motor)) |
533 03d2 8381 ldd r24,Z+3 |
534 03d4 8068 ori r24,lo8(-128) |
535 03d6 8383 std Z+3,r24 |
536 03d8 8091 0000 lds r24,motor_read |
537 03dc E82F mov r30,r24 |
538 03de FF27 clr r31 |
539 03e0 EE0F lsl r30 |
540 03e2 FF1F rol r31 |
541 03e4 EE0F lsl r30 |
542 03e6 FF1F rol r31 |
543 03e8 EE0F lsl r30 |
544 03ea FF1F rol r31 |
545 03ec E050 subi r30,lo8(-(Motor)) |
546 03ee F040 sbci r31,hi8(-(Motor)) |
547 03f0 8081 ld r24,Z |
548 03f2 80FF sbrs r24,0 |
549 03f4 2FC0 rjmp .L38 |
550 03f6 8091 0000 lds r24,motor_read |
551 03fa E82F mov r30,r24 |
552 03fc FF27 clr r31 |
553 03fe 53E0 ldi r21,3 |
554 0400 EE0F 1: lsl r30 |
555 0402 FF1F rol r31 |
556 0404 5A95 dec r21 |
557 0406 E1F7 brne 1b |
558 0408 E050 subi r30,lo8(-(Motor)) |
559 040a F040 sbci r31,hi8(-(Motor)) |
560 040c 8481 ldd r24,Z+4 |
561 040e 9927 clr r25 |
562 0410 0097 sbiw r24,0 |
563 0412 51F0 breq .L41 |
564 0414 4097 sbiw r24,16 |
565 0416 D9F5 brne .L44 |
566 0418 80E0 ldi r24,lo8(BLConfig) |
567 041a 90E0 ldi r25,hi8(BLConfig) |
568 041c 9093 0000 sts (pBuff.2)+1,r25 |
569 0420 8093 0000 sts pBuff.2,r24 |
570 0424 88E0 ldi r24,lo8(8) |
571 0426 31C0 rjmp .L77 |
572 .L41: |
573 0428 8091 0000 lds r24,motor_read |
574 042c 9927 clr r25 |
575 042e 43E0 ldi r20,3 |
576 0430 880F 1: lsl r24 |
577 0432 991F rol r25 |
578 0434 4A95 dec r20 |
579 0436 E1F7 brne 1b |
580 0438 8050 subi r24,lo8(-(Motor+5)) |
581 043a 9040 sbci r25,hi8(-(Motor+5)) |
582 043c 9093 0000 sts (pBuff.2)+1,r25 |
583 0440 8093 0000 sts pBuff.2,r24 |
584 0444 9091 0000 lds r25,motor_read |
585 0448 8091 0000 lds r24,motor_read_temperature.1 |
586 044c 9817 cp r25,r24 |
587 044e E1F4 brne .L45 |
588 0450 83E0 ldi r24,lo8(3) |
589 0452 1BC0 rjmp .L77 |
590 .L38: |
591 0454 8091 0000 lds r24,motor_read |
592 0458 9927 clr r25 |
593 045a 33E0 ldi r19,3 |
594 045c 880F 1: lsl r24 |
595 045e 991F rol r25 |
596 0460 3A95 dec r19 |
597 0462 E1F7 brne 1b |
598 0464 8050 subi r24,lo8(-(Motor+5)) |
599 0466 9040 sbci r25,hi8(-(Motor+5)) |
600 0468 9093 0000 sts (pBuff.2)+1,r25 |
601 046c 8093 0000 sts pBuff.2,r24 |
602 0470 8091 0000 lds r24,BLFlags |
603 0474 81FD sbrc r24,1 |
604 0476 06C0 rjmp .L46 |
605 0478 9091 0000 lds r25,motor_read |
606 047c 8091 0000 lds r24,motor_read_temperature.1 |
607 0480 9817 cp r25,r24 |
608 0482 11F4 brne .L45 |
609 .L46: |
610 0484 82E0 ldi r24,lo8(2) |
611 0486 01C0 rjmp .L77 |
612 .L45: |
613 0488 81E0 ldi r24,lo8(1) |
614 .L77: |
615 048a 8093 0000 sts BuffLen.3,r24 |
616 .L44: |
617 048e 8091 0000 lds r24,BuffLen.3 |
618 0492 8130 cpi r24,lo8(1) |
619 0494 11F4 brne .L48 |
620 0496 85E8 ldi r24,lo8(-123) |
621 0498 01C0 rjmp .L78 |
622 .L48: |
623 049a 85EC ldi r24,lo8(-59) |
624 .L78: |
625 049c 8093 BC00 sts 188,r24 |
626 04a0 8091 0000 lds r24,missing_motor.0 |
627 04a4 8093 0000 sts MissingMotor,r24 |
628 04a8 1092 0000 sts missing_motor.0,__zero_reg__ |
629 04ac D4C0 rjmp .L9 |
630 .L50: |
631 04ae E091 0000 lds r30,pBuff.2 |
632 04b2 F091 0000 lds r31,(pBuff.2)+1 |
633 04b6 8091 BB00 lds r24,187 |
634 04ba 8083 st Z,r24 |
635 04bc 8091 0000 lds r24,pBuff.2 |
636 04c0 9091 0000 lds r25,(pBuff.2)+1 |
637 04c4 0196 adiw r24,1 |
638 04c6 9093 0000 sts (pBuff.2)+1,r25 |
639 04ca 8093 0000 sts pBuff.2,r24 |
640 04ce 8091 0000 lds r24,BuffLen.3 |
641 04d2 8150 subi r24,lo8(-(-1)) |
642 04d4 8093 0000 sts BuffLen.3,r24 |
643 04d8 8230 cpi r24,lo8(2) |
644 04da 10F0 brlo .L51 |
645 04dc 85EC ldi r24,lo8(-59) |
646 04de 58C0 rjmp .L79 |
647 .L51: |
648 04e0 8130 cpi r24,lo8(1) |
649 04e2 11F4 brne .L53 |
650 04e4 85E8 ldi r24,lo8(-123) |
651 04e6 54C0 rjmp .L79 |
652 .L53: |
653 04e8 8091 0000 lds r24,BLFlags |
654 04ec 81FF sbrs r24,1 |
655 04ee 2DC0 rjmp .L55 |
656 04f0 8091 0000 lds r24,FCFlags |
657 04f4 80FD sbrc r24,0 |
658 04f6 1DC0 rjmp .L56 |
659 04f8 8091 0000 lds r24,motor_read |
660 04fc E82F mov r30,r24 |
661 04fe FF27 clr r31 |
662 0500 23E0 ldi r18,3 |
663 0502 EE0F 1: lsl r30 |
664 0504 FF1F rol r31 |
665 0506 2A95 dec r18 |
666 0508 E1F7 brne 1b |
667 050a E050 subi r30,lo8(-(Motor)) |
668 050c F040 sbci r31,hi8(-(Motor)) |
669 050e 8681 ldd r24,Z+6 |
670 0510 8A3F cpi r24,lo8(-6) |
671 0512 79F4 brne .L56 |
672 0514 8091 0000 lds r24,motor_read |
673 0518 E82F mov r30,r24 |
674 051a FF27 clr r31 |
675 051c 93E0 ldi r25,3 |
676 051e EE0F 1: lsl r30 |
677 0520 FF1F rol r31 |
678 0522 9A95 dec r25 |
679 0524 E1F7 brne 1b |
680 0526 E050 subi r30,lo8(-(Motor)) |
681 0528 F040 sbci r31,hi8(-(Motor)) |
682 052a 8081 ld r24,Z |
683 052c 8160 ori r24,lo8(1) |
684 052e 8083 st Z,r24 |
685 0530 0CC0 rjmp .L55 |
686 .L56: |
687 0532 8091 0000 lds r24,motor_read |
688 0536 E82F mov r30,r24 |
689 0538 FF27 clr r31 |
690 053a 83E0 ldi r24,3 |
691 053c EE0F 1: lsl r30 |
692 053e FF1F rol r31 |
693 0540 8A95 dec r24 |
694 0542 E1F7 brne 1b |
695 0544 E050 subi r30,lo8(-(Motor)) |
696 0546 F040 sbci r31,hi8(-(Motor)) |
697 0548 1082 st Z,__zero_reg__ |
698 .L55: |
699 054a 8091 0000 lds r24,motor_read |
700 054e 8F5F subi r24,lo8(-(1)) |
701 0550 8093 0000 sts motor_read,r24 |
702 0554 8091 0000 lds r24,motor_read |
703 0558 8C30 cpi r24,lo8(12) |
704 055a A0F0 brlo .L58 |
705 055c 1092 0000 sts motor_read,__zero_reg__ |
706 0560 1092 0000 sts (BLConfig_ReadMask)+1,__zero_reg__ |
707 0564 1092 0000 sts BLConfig_ReadMask,__zero_reg__ |
708 0568 8091 0000 lds r24,motor_read_temperature.1 |
709 056c 8F5F subi r24,lo8(-(1)) |
710 056e 8093 0000 sts motor_read_temperature.1,r24 |
711 0572 8C30 cpi r24,lo8(12) |
712 0574 38F0 brlo .L58 |
713 0576 1092 0000 sts motor_read_temperature.1,__zero_reg__ |
714 057a 8091 0000 lds r24,BLFlags |
715 057e 8D7F andi r24,lo8(-3) |
716 0580 8093 0000 sts BLFlags,r24 |
717 .L58: |
718 0584 1092 0000 sts twi_state,__zero_reg__ |
719 0588 84E9 ldi r24,lo8(-108) |
720 058a 8093 BC00 sts 188,r24 |
721 058e 49C0 rjmp .L81 |
722 .L79: |
723 0590 8093 BC00 sts 188,r24 |
724 0594 86E0 ldi r24,lo8(6) |
725 .L82: |
726 0596 8093 0000 sts twi_state,r24 |
727 059a 5DC0 rjmp .L9 |
728 .L60: |
729 059c 88E9 ldi r24,lo8(-104) |
730 059e C4CD rjmp .L84 |
731 .L61: |
732 05a0 8091 0000 lds r24,dac_channel |
733 05a4 880F lsl r24 |
734 05a6 805F subi r24,lo8(-(16)) |
735 05a8 BFCD rjmp .L84 |
736 .L62: |
737 05aa 8091 0000 lds r24,dac_channel |
738 05ae 9927 clr r25 |
739 05b0 8130 cpi r24,1 |
740 05b2 9105 cpc r25,__zero_reg__ |
741 05b4 61F0 breq .L65 |
742 05b6 8230 cpi r24,2 |
743 05b8 9105 cpc r25,__zero_reg__ |
744 05ba 1CF4 brge .L67 |
745 05bc 892B or r24,r25 |
746 05be 21F0 breq .L64 |
747 05c0 4AC0 rjmp .L9 |
748 .L67: |
749 05c2 0297 sbiw r24,2 |
750 05c4 39F0 breq .L66 |
751 05c6 47C0 rjmp .L9 |
752 .L64: |
753 05c8 8091 0000 lds r24,AnalogOffsetNick |
754 05cc ADCD rjmp .L84 |
755 .L65: |
756 05ce 8091 0000 lds r24,AnalogOffsetRoll |
757 05d2 AACD rjmp .L84 |
758 .L66: |
759 05d4 8091 0000 lds r24,AnalogOffsetGier |
760 05d8 A7CD rjmp .L84 |
761 .L68: |
762 05da 80E8 ldi r24,lo8(-128) |
763 05dc A5CD rjmp .L84 |
764 .L69: |
765 05de 1092 0000 sts twi_state,__zero_reg__ |
766 05e2 84E9 ldi r24,lo8(-108) |
767 05e4 8093 BC00 sts 188,r24 |
768 05e8 8AE0 ldi r24,lo8(10) |
769 05ea 90E0 ldi r25,hi8(10) |
770 05ec 9093 0000 sts (I2CTimeout)+1,r25 |
771 05f0 8093 0000 sts I2CTimeout,r24 |
772 05f4 8091 0000 lds r24,dac_channel |
773 05f8 8230 cpi r24,lo8(2) |
774 05fa 88F4 brsh .L70 |
775 05fc 8091 0000 lds r24,dac_channel |
776 0600 8F5F subi r24,lo8(-(1)) |
777 0602 8093 0000 sts dac_channel,r24 |
778 0606 82E1 ldi r24,lo8(18) |
779 0608 8093 0000 sts twi_state,r24 |
780 .L85: |
781 060c 8091 0000 lds r24,BLFlags |
782 0610 8E7F andi r24,lo8(-2) |
783 0612 8093 0000 sts BLFlags,r24 |
784 0616 85EA ldi r24,lo8(-91) |
785 .L80: |
786 0618 8093 BC00 sts 188,r24 |
787 061c 1CC0 rjmp .L9 |
788 .L70: |
789 061e 1092 0000 sts dac_channel,__zero_reg__ |
790 .L81: |
791 0622 8091 0000 lds r24,BLFlags |
792 0626 8160 ori r24,lo8(1) |
793 0628 8093 0000 sts BLFlags,r24 |
794 062c 14C0 rjmp .L9 |
795 .L72: |
796 062e 1092 0000 sts twi_state,__zero_reg__ |
797 0632 84E9 ldi r24,lo8(-108) |
798 0634 8093 BC00 sts 188,r24 |
799 0638 8091 0000 lds r24,BLFlags |
800 063c 8160 ori r24,lo8(1) |
801 063e 8093 0000 sts BLFlags,r24 |
802 0642 8AE0 ldi r24,lo8(10) |
803 0644 90E0 ldi r25,hi8(10) |
804 0646 9093 0000 sts (I2CTimeout)+1,r25 |
805 064a 8093 0000 sts I2CTimeout,r24 |
806 064e 1092 0000 sts motor_write,__zero_reg__ |
807 0652 1092 0000 sts motor_read,__zero_reg__ |
808 .L9: |
809 /* epilogue: frame size=0 */ |
810 0656 FF91 pop r31 |
811 0658 EF91 pop r30 |
812 065a 9F91 pop r25 |
813 065c 8F91 pop r24 |
814 065e 5F91 pop r21 |
815 0660 4F91 pop r20 |
816 0662 3F91 pop r19 |
817 0664 2F91 pop r18 |
818 0666 0F90 pop __tmp_reg__ |
819 0668 0FBE out __SREG__,__tmp_reg__ |
820 066a 0F90 pop __tmp_reg__ |
821 066c 1F90 pop __zero_reg__ |
822 066e 1895 reti |
823 /* epilogue end (size=13) */ |
824 /* function __vector_26 size 779 (753) */ |
826 .global I2C_WriteBLConfig |
828 I2C_WriteBLConfig: |
829 /* prologue: frame size=0 */ |
830 0670 1F93 push r17 |
831 0672 CF93 push r28 |
832 0674 DF93 push r29 |
833 /* prologue end (size=3) */ |
834 0676 182F mov r17,r24 |
835 0678 8091 0000 lds r24,MotorenEin |
836 067c 8823 tst r24 |
837 067e 21F4 brne .L88 |
838 0680 8091 0000 lds r24,PC_MotortestActive |
839 0684 8823 tst r24 |
840 0686 19F0 breq .L87 |
841 .L88: |
842 0688 81E0 ldi r24,lo8(1) |
843 068a 90E0 ldi r25,hi8(1) |
844 068c 97C0 rjmp .L86 |
845 .L87: |
846 068e 1D30 cpi r17,lo8(13) |
847 0690 08F0 brlo .+2 |
848 0692 92C0 rjmp .L115 |
849 0694 1123 tst r17 |
850 0696 B1F0 breq .L90 |
851 0698 E12F mov r30,r17 |
852 069a FF27 clr r31 |
853 069c 23E0 ldi r18,3 |
854 069e EE0F 1: lsl r30 |
855 06a0 FF1F rol r31 |
856 06a2 2A95 dec r18 |
857 06a4 E1F7 brne 1b |
858 06a6 E050 subi r30,lo8(-(Motor)) |
859 06a8 F040 sbci r31,hi8(-(Motor)) |
860 06aa 3597 sbiw r30,5 |
861 06ac 8081 ld r24,Z |
862 06ae 3596 adiw r30,5 |
863 06b0 8823 tst r24 |
864 06b2 0CF0 brlt .+2 |
865 06b4 81C0 rjmp .L115 |
866 06b6 3897 sbiw r30,8 |
867 06b8 8081 ld r24,Z |
868 06ba 80FD sbrc r24,0 |
869 06bc 03C0 rjmp .L90 |
870 06be 83E0 ldi r24,lo8(3) |
871 06c0 90E0 ldi r25,hi8(3) |
872 06c2 7CC0 rjmp .L86 |
873 .L90: |
874 06c4 8091 0000 lds r24,BLConfig |
875 06c8 8230 cpi r24,lo8(2) |
876 06ca 19F0 breq .L93 |
877 06cc 84E0 ldi r24,lo8(4) |
878 06ce 90E0 ldi r25,hi8(4) |
879 06d0 75C0 rjmp .L86 |
880 .L93: |
881 06d2 67E0 ldi r22,lo8(7) |
882 06d4 70E0 ldi r23,hi8(7) |
883 06d6 80E0 ldi r24,lo8(BLConfig) |
884 06d8 90E0 ldi r25,hi8(BLConfig) |
885 06da 0E94 0000 call RAM_Checksum |
886 06de 9091 0000 lds r25,BLConfig+7 |
887 06e2 8917 cp r24,r25 |
888 06e4 19F0 breq .L94 |
889 06e6 85E0 ldi r24,lo8(5) |
890 06e8 90E0 ldi r25,hi8(5) |
891 06ea 68C0 rjmp .L86 |
892 .L94: |
893 06ec 80ED ldi r24,lo8(2000) |
894 06ee 97E0 ldi r25,hi8(2000) |
895 06f0 0E94 0000 call SetDelay |
896 06f4 EC01 movw r28,r24 |
897 .L95: |
898 06f6 8091 0000 lds r24,BLFlags |
899 06fa 80FD sbrc r24,0 |
900 06fc 05C0 rjmp .L96 |
901 06fe CE01 movw r24,r28 |
902 0700 0E94 0000 call CheckDelay |
903 0704 8823 tst r24 |
904 0706 B9F3 breq .L95 |
905 .L96: |
906 0708 1123 tst r17 |
907 070a 19F4 brne .L98 |
908 070c 8FEF ldi r24,lo8(255) |
909 070e 90E0 ldi r25,hi8(255) |
910 0710 0BC0 rjmp .L114 |
911 .L98: |
912 0712 212F mov r18,r17 |
913 0714 3327 clr r19 |
914 0716 2150 subi r18,lo8(-(-1)) |
915 0718 3040 sbci r19,hi8(-(-1)) |
916 071a 81E0 ldi r24,lo8(1) |
917 071c 90E0 ldi r25,hi8(1) |
918 071e 02C0 rjmp 2f |
919 0720 880F 1: lsl r24 |
920 0722 991F rol r25 |
921 0724 2A95 2: dec r18 |
922 0726 E2F7 brpl 1b |
923 .L114: |
924 0728 9093 0000 sts (BLConfig_WriteMask)+1,r25 |
925 072c 8093 0000 sts BLConfig_WriteMask,r24 |
926 0730 A1E0 ldi r26,lo8(1) |
927 0732 B0E0 ldi r27,hi8(1) |
928 0734 E0E0 ldi r30,lo8(Motor) |
929 0736 F0E0 ldi r31,hi8(Motor) |
930 0738 40E0 ldi r20,lo8(0) |
931 073a 50E0 ldi r21,hi8(0) |
932 073c 6BE0 ldi r22,lo8(11) |
933 .L104: |
934 073e CD01 movw r24,r26 |
935 0740 042E mov r0,r20 |
936 0742 02C0 rjmp 2f |
937 0744 880F 1: lsl r24 |
938 0746 991F rol r25 |
939 0748 0A94 2: dec r0 |
940 074a E2F7 brpl 1b |
941 074c 2091 0000 lds r18,BLConfig_WriteMask |
942 0750 3091 0000 lds r19,(BLConfig_WriteMask)+1 |
943 0754 8223 and r24,r18 |
944 0756 9323 and r25,r19 |
945 0758 892B or r24,r25 |
946 075a 11F0 breq .L102 |
947 075c 1182 std Z+1,__zero_reg__ |
948 075e 1282 std Z+2,__zero_reg__ |
949 .L102: |
950 0760 6150 subi r22,lo8(-(-1)) |
951 0762 4F5F subi r20,lo8(-(1)) |
952 0764 5F4F sbci r21,hi8(-(1)) |
953 0766 3896 adiw r30,8 |
954 0768 67FF sbrs r22,7 |
955 076a E9CF rjmp .L104 |
956 076c 1092 0000 sts motor_write,__zero_reg__ |
957 .L105: |
958 0770 1092 0000 sts twi_state,__zero_reg__ |
959 0774 8091 0000 lds r24,BLFlags |
960 0778 8E7F andi r24,lo8(-2) |
961 077a 8093 0000 sts BLFlags,r24 |
962 077e 85EA ldi r24,lo8(-91) |
963 0780 8093 BC00 sts 188,r24 |
964 .L108: |
965 0784 8091 0000 lds r24,BLFlags |
966 0788 80FD sbrc r24,0 |
967 078a 05C0 rjmp .L109 |
968 078c CE01 movw r24,r28 |
969 078e 0E94 0000 call CheckDelay |
970 0792 8823 tst r24 |
971 0794 B9F3 breq .L108 |
972 .L109: |
973 0796 8091 0000 lds r24,BLConfig_WriteMask |
974 079a 9091 0000 lds r25,(BLConfig_WriteMask)+1 |
975 079e 892B or r24,r25 |
976 07a0 29F0 breq .L106 |
977 07a2 CE01 movw r24,r28 |
978 07a4 0E94 0000 call CheckDelay |
979 07a8 8823 tst r24 |
980 07aa 11F3 breq .L105 |
981 .L106: |
982 07ac 8091 0000 lds r24,BLConfig_WriteMask |
983 07b0 9091 0000 lds r25,(BLConfig_WriteMask)+1 |
984 07b4 0097 sbiw r24,0 |
985 07b6 11F0 breq .L86 |
986 .L115: |
987 07b8 82E0 ldi r24,lo8(2) |
988 07ba 90E0 ldi r25,hi8(2) |
989 .L86: |
990 /* epilogue: frame size=0 */ |
991 07bc DF91 pop r29 |
992 07be CF91 pop r28 |
993 07c0 1F91 pop r17 |
994 07c2 0895 ret |
995 /* epilogue end (size=4) */ |
996 /* function I2C_WriteBLConfig size 172 (165) */ |
998 .global I2C_ReadBLConfig |
1000 I2C_ReadBLConfig: |
1001 /* prologue: frame size=0 */ |
1002 07c4 0F93 push r16 |
1003 07c6 1F93 push r17 |
1004 07c8 CF93 push r28 |
1005 07ca DF93 push r29 |
1006 /* prologue end (size=4) */ |
1007 07cc 982F mov r25,r24 |
1008 07ce 8091 0000 lds r24,MotorenEin |
1009 07d2 8823 tst r24 |
1010 07d4 21F4 brne .L118 |
1011 07d6 8091 0000 lds r24,PC_MotortestActive |
1012 07da 8823 tst r24 |
1013 07dc 19F0 breq .L117 |
1014 .L118: |
1015 07de 81E0 ldi r24,lo8(1) |
1016 07e0 90E0 ldi r25,hi8(1) |
1017 07e2 92C0 rjmp .L116 |
1018 .L117: |
1019 07e4 9D30 cpi r25,lo8(13) |
1020 07e6 A0F4 brsh .L141 |
1021 07e8 9923 tst r25 |
1022 07ea 19F4 brne .L120 |
1023 07ec 86E0 ldi r24,lo8(6) |
1024 07ee 90E0 ldi r25,hi8(6) |
1025 07f0 8BC0 rjmp .L116 |
1026 .L120: |
1027 07f2 C92F mov r28,r25 |
1028 07f4 DD27 clr r29 |
1029 07f6 FE01 movw r30,r28 |
1030 07f8 33E0 ldi r19,3 |
1031 07fa EE0F 1: lsl r30 |
1032 07fc FF1F rol r31 |
1033 07fe 3A95 dec r19 |
1034 0800 E1F7 brne 1b |
1035 0802 E050 subi r30,lo8(-(Motor)) |
1036 0804 F040 sbci r31,hi8(-(Motor)) |
1037 0806 3597 sbiw r30,5 |
1038 0808 8081 ld r24,Z |
1039 080a 3596 adiw r30,5 |
1040 080c 87FD sbrc r24,7 |
1041 080e 03C0 rjmp .L121 |
1042 .L141: |
1043 0810 82E0 ldi r24,lo8(2) |
1044 0812 90E0 ldi r25,hi8(2) |
1045 0814 79C0 rjmp .L116 |
1046 .L121: |
1047 0816 3897 sbiw r30,8 |
1048 0818 8081 ld r24,Z |
1049 081a 80FD sbrc r24,0 |
1050 081c 03C0 rjmp .L122 |
1051 081e 83E0 ldi r24,lo8(3) |
1052 0820 90E0 ldi r25,hi8(3) |
1053 0822 72C0 rjmp .L116 |
1054 .L122: |
1055 0824 80ED ldi r24,lo8(2000) |
1056 0826 97E0 ldi r25,hi8(2000) |
1057 0828 0E94 0000 call SetDelay |
1058 082c 8C01 movw r16,r24 |
1059 .L123: |
1060 082e 8091 0000 lds r24,BLFlags |
1061 0832 80FD sbrc r24,0 |
1062 0834 05C0 rjmp .L124 |
1063 0836 C801 movw r24,r16 |
1064 0838 0E94 0000 call CheckDelay |
1065 083c 8823 tst r24 |
1066 083e B9F3 breq .L123 |
1067 .L124: |
1068 0840 2197 sbiw r28,1 |
1069 0842 21E0 ldi r18,lo8(1) |
1070 0844 30E0 ldi r19,hi8(1) |
1071 0846 C901 movw r24,r18 |
1072 0848 02C0 rjmp 2f |
1073 084a 880F 1: lsl r24 |
1074 084c 991F rol r25 |
1075 084e CA95 2: dec r28 |
1076 0850 E2F7 brpl 1b |
1077 0852 9093 0000 sts (BLConfig_ReadMask)+1,r25 |
1078 0856 8093 0000 sts BLConfig_ReadMask,r24 |
1079 085a D901 movw r26,r18 |
1080 085c E0E0 ldi r30,lo8(Motor) |
1081 085e F0E0 ldi r31,hi8(Motor) |
1082 0860 40E0 ldi r20,lo8(0) |
1083 0862 50E0 ldi r21,hi8(0) |
1084 0864 6BE0 ldi r22,lo8(11) |
1085 .L130: |
1086 0866 CD01 movw r24,r26 |
1087 0868 042E mov r0,r20 |
1088 086a 02C0 rjmp 2f |
1089 086c 880F 1: lsl r24 |
1090 086e 991F rol r25 |
1091 0870 0A94 2: dec r0 |
1092 0872 E2F7 brpl 1b |
1093 0874 2091 0000 lds r18,BLConfig_ReadMask |
1094 0878 3091 0000 lds r19,(BLConfig_ReadMask)+1 |
1095 087c 8223 and r24,r18 |
1096 087e 9323 and r25,r19 |
1097 0880 892B or r24,r25 |
1098 0882 11F0 breq .L128 |
1099 0884 1182 std Z+1,__zero_reg__ |
1100 0886 1282 std Z+2,__zero_reg__ |
1101 .L128: |
1102 0888 6150 subi r22,lo8(-(-1)) |
1103 088a 4F5F subi r20,lo8(-(1)) |
1104 088c 5F4F sbci r21,hi8(-(1)) |
1105 088e 3896 adiw r30,8 |
1106 0890 67FF sbrs r22,7 |
1107 0892 E9CF rjmp .L130 |
1108 0894 1092 0000 sts motor_read,__zero_reg__ |
1109 0898 1092 0000 sts BLConfig,__zero_reg__ |
1110 089c 1092 0000 sts BLConfig+7,__zero_reg__ |
1111 .L131: |
1112 08a0 1092 0000 sts twi_state,__zero_reg__ |
1113 08a4 8091 0000 lds r24,BLFlags |
1114 08a8 8E7F andi r24,lo8(-2) |
1115 08aa 8093 0000 sts BLFlags,r24 |
1116 08ae 85EA ldi r24,lo8(-91) |
1117 08b0 8093 BC00 sts 188,r24 |
1118 .L134: |
1119 08b4 8091 0000 lds r24,BLFlags |
1120 08b8 80FD sbrc r24,0 |
1121 08ba 05C0 rjmp .L135 |
1122 08bc C801 movw r24,r16 |
1123 08be 0E94 0000 call CheckDelay |
1124 08c2 8823 tst r24 |
1125 08c4 B9F3 breq .L134 |
1126 .L135: |
1127 08c6 8091 0000 lds r24,BLConfig_ReadMask |
1128 08ca 9091 0000 lds r25,(BLConfig_ReadMask)+1 |
1129 08ce 892B or r24,r25 |
1130 08d0 29F0 breq .L132 |
1131 08d2 C801 movw r24,r16 |
1132 08d4 0E94 0000 call CheckDelay |
1133 08d8 8823 tst r24 |
1134 08da 11F3 breq .L131 |
1135 .L132: |
1136 08dc 8091 0000 lds r24,BLConfig |
1137 08e0 8230 cpi r24,lo8(2) |
1138 08e2 19F0 breq .L137 |
1139 08e4 84E0 ldi r24,lo8(4) |
1140 08e6 90E0 ldi r25,hi8(4) |
1141 08e8 0FC0 rjmp .L116 |
1142 .L137: |
1143 08ea 67E0 ldi r22,lo8(7) |
1144 08ec 70E0 ldi r23,hi8(7) |
1145 08ee 80E0 ldi r24,lo8(BLConfig) |
1146 08f0 90E0 ldi r25,hi8(BLConfig) |
1147 08f2 0E94 0000 call RAM_Checksum |
1148 08f6 9091 0000 lds r25,BLConfig+7 |
1149 08fa 8917 cp r24,r25 |
1150 08fc 19F0 breq .L138 |
1151 08fe 85E0 ldi r24,lo8(5) |
1152 0900 90E0 ldi r25,hi8(5) |
1153 0902 02C0 rjmp .L116 |
1154 .L138: |
1155 0904 80E0 ldi r24,lo8(0) |
1156 0906 90E0 ldi r25,hi8(0) |
1157 .L116: |
1158 /* epilogue: frame size=0 */ |
1159 0908 DF91 pop r29 |
1160 090a CF91 pop r28 |
1161 090c 1F91 pop r17 |
1162 090e 0F91 pop r16 |
1163 0910 0895 ret |
1164 /* epilogue end (size=5) */ |
1165 /* function I2C_ReadBLConfig size 168 (159) */ |
1167 .comm Motor,96,1 |
1168 .comm BLConfig,8,1 |
1169 /* File "twimaster.c": code 1193 = 0x04a9 (1149), prologues 20, epilogues 24 */ |
DEFINED SYMBOLS |
*ABS*:00000000 twimaster.c |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccHkTAFJ.s:2 *ABS*:0000003f __SREG__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccHkTAFJ.s:3 *ABS*:0000003e __SP_H__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccHkTAFJ.s:4 *ABS*:0000003d __SP_L__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccHkTAFJ.s:5 *ABS*:00000034 __CCP__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccHkTAFJ.s:6 *ABS*:00000000 __tmp_reg__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccHkTAFJ.s:7 *ABS*:00000001 __zero_reg__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccHkTAFJ.s:11 .text:00000000 I2C_Init |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccHkTAFJ.s:1069 .bss:00000000 twi_state |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccHkTAFJ.s:1081 .bss:00000002 motor_write |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccHkTAFJ.s:1087 .bss:00000003 motor_read |
C:\Users\Arthur-P\AppData\Local\Temp/cciecaaa.s:3 *ABS*:0000003f __SREG__ |
C:\Users\Arthur-P\AppData\Local\Temp/cciecaaa.s:4 *ABS*:0000003e __SP_H__ |
C:\Users\Arthur-P\AppData\Local\Temp/cciecaaa.s:5 *ABS*:0000003d __SP_L__ |
C:\Users\Arthur-P\AppData\Local\Temp/cciecaaa.s:6 *ABS*:00000000 __tmp_reg__ |
C:\Users\Arthur-P\AppData\Local\Temp/cciecaaa.s:7 *ABS*:00000001 __zero_reg__ |
C:\Users\Arthur-P\AppData\Local\Temp/cciecaaa.s:15 .bss:00000000 BLConfig_ReadMask |
C:\Users\Arthur-P\AppData\Local\Temp/cciecaaa.s:21 .bss:00000002 BLConfig_WriteMask |
C:\Users\Arthur-P\AppData\Local\Temp/cciecaaa.s:27 .bss:00000004 BLFlags |
C:\Users\Arthur-P\AppData\Local\Temp/cciecaaa.s:33 .bss:00000005 MissingMotor |
C:\Users\Arthur-P\AppData\Local\Temp/cciecaaa.s:39 .data:00000000 I2CTimeout |
C:\Users\Arthur-P\AppData\Local\Temp/cciecaaa.s:46 .bss:00000006 motor_read |
C:\Users\Arthur-P\AppData\Local\Temp/cciecaaa.s:52 .bss:00000007 motor_write |
C:\Users\Arthur-P\AppData\Local\Temp/cciecaaa.s:58 .bss:00000008 dac_channel |
C:\Users\Arthur-P\AppData\Local\Temp/cciecaaa.s:64 .bss:00000009 twi_state |
C:\Users\Arthur-P\AppData\Local\Temp/cciecaaa.s:69 .text:00000000 I2C_Init |
*COM*:00000060 Motor |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccHkTAFJ.s:55 .text:0000004c I2C_Reset |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccHkTAFJ.s:1106 .bss:00000005 BLFlags |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccHkTAFJ.s:99 .text:000000aa __vector_26 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccHkTAFJ.s:1112 .bss:00000006 BLConfig_WriteMask |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccHkTAFJ.s:1118 .bss:00000008 BLConfig_ReadMask |
C:\Users\Arthur-P\AppData\Local\Temp/cciecaaa.s:113 .text:0000004c I2C_Reset |
.bss:0000000a missing_motor.0 |
C:\Users\Arthur-P\AppData\Local\Temp/cciecaaa.s:140 .bss:0000000b motor_read_temperature.1 |
C:\Users\Arthur-P\AppData\Local\Temp/cciecaaa.s:141 .bss:0000000c pBuff.2 |
C:\Users\Arthur-P\AppData\Local\Temp/cciecaaa.s:142 .bss:0000000e BuffLen.3 |
C:\Users\Arthur-P\AppData\Local\Temp/cciecaaa.s:146 .text:00000092 __vector_26 |
*COM*:00000008 BLConfig |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccHkTAFJ.s:1120 .bss:0000000b pBuff.1659 |
.bss:0000000a BuffLen.1660 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccHkTAFJ.s:1122 .bss:0000000e missing_motor.1657 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccHkTAFJ.s:1093 .data:00000000 I2CTimeout |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccHkTAFJ.s:1121 .bss:0000000d motor_read_temperature.1658 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccHkTAFJ.s:1100 .bss:00000004 MissingMotor |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccHkTAFJ.s:1075 .bss:00000001 dac_channel |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccHkTAFJ.s:744 .text:00000638 I2C_ReadBLConfig |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccHkTAFJ.s:902 .text:0000077a I2C_WriteBLConfig |
C:\Users\Arthur-P\AppData\Local\Temp/cciecaaa.s:828 .text:00000670 I2C_WriteBLConfig |
C:\Users\Arthur-P\AppData\Local\Temp/cciecaaa.s:1000 .text:000007c4 I2C_ReadBLConfig |
UNDEFINED SYMBOLS |
__do_copy_data |
__do_clear_bss |
__tablejump2__ |
Mixer |
RequiredMotors |
1136,9 → 1179,6 |
AnalogOffsetGier |
MotorenEin |
PC_MotortestActive |
RAM_Checksum |
SetDelay |
CheckDelay |
RAM_Checksum |
__epilogue_restores__ |
__do_copy_data |
__do_clear_bss |
/branches/V0.80g-Arthur-P1/uart.lst |
---|
1,2539 → 1,2499 |
1 .file "uart.c" |
2 __SREG__ = 0x3f |
3 __SP_H__ = 0x3e |
4 __SP_L__ = 0x3d |
5 __CCP__ = 0x34 |
2 .arch atmega644p |
3 __SREG__ = 0x3f |
4 __SP_H__ = 0x3e |
5 __SP_L__ = 0x3d |
6 __tmp_reg__ = 0 |
7 __zero_reg__ = 1 |
8 .text |
9 .global __vector_22 |
11 __vector_22: |
12 0000 1F92 push __zero_reg__ |
13 0002 0F92 push r0 |
14 0004 0FB6 in r0,__SREG__ |
15 0006 0F92 push r0 |
16 0008 1124 clr __zero_reg__ |
17 000a 8F93 push r24 |
18 000c 9F93 push r25 |
19 000e EF93 push r30 |
20 0010 FF93 push r31 |
21 /* prologue: Signal */ |
22 /* frame size = 0 */ |
23 0012 8091 0000 lds r24,UebertragungAbgeschlossen |
24 0016 8823 tst r24 |
25 0018 01F4 brne .L2 |
26 001a 8091 0000 lds r24,ptr.2267 |
27 001e 9091 0000 lds r25,(ptr.2267)+1 |
28 0022 0196 adiw r24,1 |
29 0024 9093 0000 sts (ptr.2267)+1,r25 |
30 0028 8093 0000 sts ptr.2267,r24 |
31 002c FC01 movw r30,r24 |
32 002e E050 subi r30,lo8(-(TxdBuffer)) |
33 0030 F040 sbci r31,hi8(-(TxdBuffer)) |
34 0032 E081 ld r30,Z |
35 0034 ED30 cpi r30,lo8(13) |
36 0036 01F0 breq .L3 |
37 0038 803A cpi r24,160 |
38 003a 9105 cpc r25,__zero_reg__ |
39 003c 01F4 brne .L4 |
40 .L3: |
41 003e 1092 0000 sts (ptr.2267)+1,__zero_reg__ |
42 0042 1092 0000 sts ptr.2267,__zero_reg__ |
43 0046 81E0 ldi r24,lo8(1) |
44 0048 8093 0000 sts UebertragungAbgeschlossen,r24 |
45 .L4: |
46 004c E093 C600 sts 198,r30 |
47 0050 00C0 rjmp .L6 |
48 .L2: |
49 0052 1092 0000 sts (ptr.2267)+1,__zero_reg__ |
50 0056 1092 0000 sts ptr.2267,__zero_reg__ |
51 .L6: |
52 /* epilogue start */ |
53 005a FF91 pop r31 |
54 005c EF91 pop r30 |
55 005e 9F91 pop r25 |
56 0060 8F91 pop r24 |
57 0062 0F90 pop r0 |
58 0064 0FBE out __SREG__,r0 |
59 0066 0F90 pop r0 |
60 0068 1F90 pop __zero_reg__ |
61 006a 1895 reti |
63 .global AddCRC |
65 AddCRC: |
66 /* prologue: function */ |
67 /* frame size = 0 */ |
68 006c DC01 movw r26,r24 |
69 006e 20E0 ldi r18,lo8(0) |
70 0070 30E0 ldi r19,hi8(0) |
71 0072 40E0 ldi r20,lo8(0) |
72 0074 50E0 ldi r21,hi8(0) |
73 0076 00C0 rjmp .L8 |
74 .L9: |
75 0078 FA01 movw r30,r20 |
76 007a E050 subi r30,lo8(-(TxdBuffer)) |
77 007c F040 sbci r31,hi8(-(TxdBuffer)) |
78 007e 8081 ld r24,Z |
79 0080 280F add r18,r24 |
80 0082 311D adc r19,__zero_reg__ |
81 0084 4F5F subi r20,lo8(-(1)) |
82 0086 5F4F sbci r21,hi8(-(1)) |
83 .L8: |
84 0088 4A17 cp r20,r26 |
85 008a 5B07 cpc r21,r27 |
86 008c 00F0 brlo .L9 |
87 008e 3F70 andi r19,hi8(4095) |
88 0090 C901 movw r24,r18 |
89 0092 36E0 ldi r19,6 |
90 0094 9695 1: lsr r25 |
91 0096 8795 ror r24 |
92 0098 3A95 dec r19 |
93 009a 01F4 brne 1b |
94 009c 835C subi r24,lo8(-(61)) |
95 009e FD01 movw r30,r26 |
96 00a0 E050 subi r30,lo8(-(TxdBuffer)) |
97 00a2 F040 sbci r31,hi8(-(TxdBuffer)) |
98 00a4 8083 st Z,r24 |
99 00a6 1196 adiw r26,1 |
100 00a8 2F73 andi r18,lo8(63) |
101 00aa 235C subi r18,lo8(-(61)) |
102 00ac FD01 movw r30,r26 |
103 00ae E050 subi r30,lo8(-(TxdBuffer)) |
104 00b0 F040 sbci r31,hi8(-(TxdBuffer)) |
105 00b2 2083 st Z,r18 |
106 00b4 A050 subi r26,lo8(-(TxdBuffer+1)) |
107 00b6 B040 sbci r27,hi8(-(TxdBuffer+1)) |
108 00b8 8DE0 ldi r24,lo8(13) |
109 00ba 8C93 st X,r24 |
110 00bc 1092 0000 sts UebertragungAbgeschlossen,__zero_reg__ |
111 00c0 8091 0000 lds r24,TxdBuffer |
112 00c4 8093 C600 sts 198,r24 |
113 /* epilogue start */ |
114 00c8 0895 ret |
116 .global Decode64 |
118 Decode64: |
119 /* prologue: function */ |
120 /* frame size = 0 */ |
121 00ca 5091 0000 lds r21,AnzahlEmpfangsBytes |
122 00ce 5650 subi r21,lo8(-(-6)) |
123 00d0 33E0 ldi r19,lo8(3) |
124 00d2 43E0 ldi r20,lo8(3) |
125 00d4 00C0 rjmp .L12 |
126 .L16: |
127 00d6 E32F mov r30,r19 |
128 00d8 F0E0 ldi r31,lo8(0) |
129 00da E050 subi r30,lo8(-(RxdBuffer)) |
130 00dc F040 sbci r31,hi8(-(RxdBuffer)) |
131 00de 8081 ld r24,Z |
132 00e0 3F5F subi r19,lo8(-(1)) |
133 00e2 E32F mov r30,r19 |
134 00e4 F0E0 ldi r31,lo8(0) |
135 00e6 E050 subi r30,lo8(-(RxdBuffer)) |
136 00e8 F040 sbci r31,hi8(-(RxdBuffer)) |
137 00ea 2081 ld r18,Z |
138 00ec 2D53 subi r18,lo8(-(-61)) |
139 00ee 3F5F subi r19,lo8(-(1)) |
140 00f0 E32F mov r30,r19 |
141 00f2 F0E0 ldi r31,lo8(0) |
142 00f4 E050 subi r30,lo8(-(RxdBuffer)) |
143 00f6 F040 sbci r31,hi8(-(RxdBuffer)) |
144 00f8 7081 ld r23,Z |
145 00fa 3F5F subi r19,lo8(-(1)) |
146 00fc E32F mov r30,r19 |
147 00fe F0E0 ldi r31,lo8(0) |
148 0100 3350 subi r19,lo8(-(-3)) |
149 0102 E050 subi r30,lo8(-(RxdBuffer)) |
150 0104 F040 sbci r31,hi8(-(RxdBuffer)) |
151 0106 6081 ld r22,Z |
152 0108 922F mov r25,r18 |
153 010a 9295 swap r25 |
154 010c 9F70 andi r25,lo8(15) |
155 010e 8D53 subi r24,lo8(-(-61)) |
156 0110 880F lsl r24 |
157 0112 880F lsl r24 |
158 0114 892B or r24,r25 |
159 0116 E42F mov r30,r20 |
160 0118 F0E0 ldi r31,lo8(0) |
161 011a E050 subi r30,lo8(-(RxdBuffer)) |
162 011c F040 sbci r31,hi8(-(RxdBuffer)) |
163 011e 8083 st Z,r24 |
164 0120 E42F mov r30,r20 |
165 0122 EF5F subi r30,lo8(-(1)) |
166 0124 5130 cpi r21,lo8(1) |
167 0126 01F0 breq .L18 |
168 .L13: |
169 0128 972F mov r25,r23 |
170 012a 9D53 subi r25,lo8(-(-61)) |
171 012c F0E0 ldi r31,lo8(0) |
172 012e 2295 swap r18 |
173 0130 207F andi r18,lo8(-16) |
174 0132 892F mov r24,r25 |
175 0134 8695 lsr r24 |
176 0136 8695 lsr r24 |
177 0138 282B or r18,r24 |
178 013a E050 subi r30,lo8(-(RxdBuffer)) |
179 013c F040 sbci r31,hi8(-(RxdBuffer)) |
180 013e 2083 st Z,r18 |
181 0140 E42F mov r30,r20 |
182 0142 EE5F subi r30,lo8(-(2)) |
183 0144 5230 cpi r21,lo8(2) |
184 0146 01F4 brne .L15 |
185 .L18: |
186 0148 4E2F mov r20,r30 |
187 014a 00C0 rjmp .L14 |
188 .L15: |
189 014c 3C5F subi r19,lo8(-(4)) |
190 014e 5350 subi r21,lo8(-(-3)) |
191 0150 F0E0 ldi r31,lo8(0) |
192 0152 9295 swap r25 |
193 0154 990F lsl r25 |
194 0156 990F lsl r25 |
195 0158 907C andi r25,lo8(-64) |
196 015a 6D53 subi r22,lo8(-(-61)) |
197 015c 962B or r25,r22 |
198 015e E050 subi r30,lo8(-(RxdBuffer)) |
199 0160 F040 sbci r31,hi8(-(RxdBuffer)) |
200 0162 9083 st Z,r25 |
201 0164 4D5F subi r20,lo8(-(3)) |
202 .L12: |
203 0166 5523 tst r21 |
204 0168 01F0 breq .+2 |
205 016a 00C0 rjmp .L16 |
206 .L14: |
207 016c 80E0 ldi r24,lo8(RxdBuffer+3) |
208 016e 90E0 ldi r25,hi8(RxdBuffer+3) |
209 0170 9093 0000 sts (pRxData)+1,r25 |
210 0174 8093 0000 sts pRxData,r24 |
211 0178 4350 subi r20,lo8(-(-3)) |
212 017a 4093 0000 sts RxDataLen,r20 |
213 /* epilogue start */ |
214 017e 0895 ret |
216 .global uart_putchar |
218 uart_putchar: |
219 /* prologue: function */ |
220 /* frame size = 0 */ |
221 0180 982F mov r25,r24 |
222 .L20: |
223 0182 8091 C000 lds r24,192 |
224 0186 85FF sbrs r24,5 |
225 0188 00C0 rjmp .L20 |
226 018a 9093 C600 sts 198,r25 |
227 /* epilogue start */ |
228 018e 0895 ret |
230 .global UART_Init |
232 UART_Init: |
233 /* prologue: function */ |
234 /* frame size = 0 */ |
235 0190 E1EC ldi r30,lo8(193) |
236 0192 F0E0 ldi r31,hi8(193) |
237 0194 88E1 ldi r24,lo8(24) |
238 0196 8083 st Z,r24 |
239 0198 A0EC ldi r26,lo8(192) |
240 019a B0E0 ldi r27,hi8(192) |
241 019c 8C91 ld r24,X |
242 019e 8260 ori r24,lo8(2) |
243 01a0 8C93 st X,r24 |
244 01a2 8081 ld r24,Z |
245 01a4 8068 ori r24,lo8(-128) |
246 01a6 8083 st Z,r24 |
247 01a8 8081 ld r24,Z |
248 01aa 8064 ori r24,lo8(64) |
249 01ac 8083 st Z,r24 |
250 01ae 1092 C500 sts 197,__zero_reg__ |
251 01b2 8AE2 ldi r24,lo8(42) |
252 01b4 8093 C400 sts 196,r24 |
253 01b8 8091 0000 lds r24,DebugDataIntervall |
254 01bc 9091 0000 lds r25,(DebugDataIntervall)+1 |
255 01c0 0E94 0000 call SetDelay |
256 01c4 9093 0000 sts (Debug_Timer)+1,r25 |
257 01c8 8093 0000 sts Debug_Timer,r24 |
258 01cc 8CED ldi r24,lo8(220) |
259 01ce 90E0 ldi r25,hi8(220) |
260 01d0 0E94 0000 call SetDelay |
261 01d4 9093 0000 sts (Kompass_Timer)+1,r25 |
262 01d8 8093 0000 sts Kompass_Timer,r24 |
263 01dc 1092 0000 sts VersionInfo,__zero_reg__ |
264 01e0 80E5 ldi r24,lo8(80) |
265 01e2 8093 0000 sts VersionInfo+1,r24 |
266 01e6 86E0 ldi r24,lo8(6) |
267 01e8 8093 0000 sts VersionInfo+4,r24 |
268 01ec 8BE0 ldi r24,lo8(11) |
269 01ee 8093 0000 sts VersionInfo+2,r24 |
270 01f2 1092 0000 sts VersionInfo+3,__zero_reg__ |
271 01f6 1092 0000 sts (pRxData)+1,__zero_reg__ |
272 01fa 1092 0000 sts pRxData,__zero_reg__ |
273 01fe 1092 0000 sts RxDataLen,__zero_reg__ |
274 /* epilogue start */ |
275 0202 0895 ret |
277 .global SendOutData |
279 SendOutData: |
280 0204 A0E0 ldi r26,lo8(0) |
281 0206 B0E0 ldi r27,hi8(0) |
282 0208 E0E0 ldi r30,lo8(gs(1f)) |
283 020a F0E0 ldi r31,hi8(gs(1f)) |
284 020c 0C94 0000 jmp __prologue_saves__+((18 - 7) * 2) |
285 1: |
286 /* prologue: function */ |
287 /* frame size = 0 */ |
288 0210 8B85 ldd r24,Y+11 |
289 0212 7C85 ldd r23,Y+12 |
290 0214 93E2 ldi r25,lo8(35) |
291 0216 9093 0000 sts TxdBuffer,r25 |
292 021a 8F59 subi r24,lo8(-(97)) |
293 021c 8093 0000 sts TxdBuffer+1,r24 |
294 0220 8A85 ldd r24,Y+10 |
295 0222 8093 0000 sts TxdBuffer+2,r24 |
296 0226 DE01 movw r26,r28 |
297 0228 1D96 adiw r26,13 |
298 022a 7723 tst r23 |
299 022c 01F4 brne .L26 |
300 022e EE24 clr r14 |
301 0230 FF24 clr r15 |
302 0232 40E0 ldi r20,lo8(0) |
303 0234 50E0 ldi r21,hi8(0) |
304 0236 00C0 rjmp .L27 |
305 .L26: |
306 0238 ED84 ldd r14,Y+13 |
307 023a FE84 ldd r15,Y+14 |
308 023c DE01 movw r26,r28 |
309 023e 5196 adiw r26,17 |
310 0240 4F85 ldd r20,Y+15 |
311 0242 5889 ldd r21,Y+16 |
312 0244 7150 subi r23,lo8(-(-1)) |
313 .L27: |
314 0246 03E0 ldi r16,lo8(3) |
315 0248 10E0 ldi r17,hi8(3) |
316 024a 30E0 ldi r19,lo8(0) |
317 024c 00C0 rjmp .L28 |
318 .L36: |
319 024e F701 movw r30,r14 |
320 0250 E30F add r30,r19 |
321 0252 F11D adc r31,__zero_reg__ |
322 0254 9081 ld r25,Z |
323 0256 3F5F subi r19,lo8(-(1)) |
324 0258 4150 subi r20,lo8(-(-1)) |
325 025a 5040 sbci r21,hi8(-(-1)) |
326 025c 01F4 brne .L29 |
327 025e 7723 tst r23 |
328 0260 01F4 brne .+2 |
329 0262 00C0 rjmp .L30 |
330 0264 FD01 movw r30,r26 |
331 0266 3296 adiw r30,2 |
332 0268 ED90 ld r14,X+ |
333 026a FC90 ld r15,X |
334 026c DF01 movw r26,r30 |
335 026e 1296 adiw r26,2 |
336 0270 0190 ld __tmp_reg__,Z+ |
337 0272 F081 ld r31,Z |
338 0274 E02D mov r30,__tmp_reg__ |
339 0276 7150 subi r23,lo8(-(-1)) |
340 0278 3097 sbiw r30,0 |
341 027a 01F4 brne .+2 |
342 027c 00C0 rjmp .L31 |
343 027e AF01 movw r20,r30 |
344 0280 30E0 ldi r19,lo8(0) |
345 .L29: |
346 0282 F701 movw r30,r14 |
347 0284 E30F add r30,r19 |
348 0286 F11D adc r31,__zero_reg__ |
349 0288 D080 ld r13,Z |
350 028a 3F5F subi r19,lo8(-(1)) |
351 028c 4150 subi r20,lo8(-(-1)) |
352 028e 5040 sbci r21,hi8(-(-1)) |
353 0290 01F4 brne .L32 |
354 0292 7723 tst r23 |
355 0294 01F4 brne .L33 |
356 0296 60E0 ldi r22,lo8(0) |
357 0298 00C0 rjmp .L34 |
358 .L33: |
359 029a FD01 movw r30,r26 |
360 029c 3296 adiw r30,2 |
361 029e ED90 ld r14,X+ |
362 02a0 FC90 ld r15,X |
363 02a2 DF01 movw r26,r30 |
364 02a4 1296 adiw r26,2 |
365 02a6 4081 ld r20,Z |
366 02a8 5181 ldd r21,Z+1 |
367 02aa 7150 subi r23,lo8(-(-1)) |
368 02ac 4115 cp r20,__zero_reg__ |
369 02ae 5105 cpc r21,__zero_reg__ |
370 02b0 01F4 brne .L35 |
371 02b2 60E0 ldi r22,lo8(0) |
372 02b4 00C0 rjmp .L38 |
373 .L35: |
374 02b6 30E0 ldi r19,lo8(0) |
375 .L32: |
376 02b8 F701 movw r30,r14 |
377 02ba E30F add r30,r19 |
378 02bc F11D adc r31,__zero_reg__ |
379 02be 6081 ld r22,Z |
380 02c0 3F5F subi r19,lo8(-(1)) |
381 02c2 4150 subi r20,lo8(-(-1)) |
382 02c4 5040 sbci r21,hi8(-(-1)) |
383 02c6 01F4 brne .L34 |
384 02c8 7723 tst r23 |
385 02ca 01F0 breq .L34 |
386 02cc FD01 movw r30,r26 |
387 02ce 3296 adiw r30,2 |
388 02d0 ED90 ld r14,X+ |
389 02d2 FC90 ld r15,X |
390 02d4 DF01 movw r26,r30 |
391 02d6 1296 adiw r26,2 |
392 02d8 4081 ld r20,Z |
393 02da 5181 ldd r21,Z+1 |
394 02dc 7150 subi r23,lo8(-(-1)) |
395 .L38: |
396 02de 30E0 ldi r19,lo8(0) |
397 .L34: |
398 02e0 892F mov r24,r25 |
399 02e2 8695 lsr r24 |
400 02e4 8695 lsr r24 |
401 02e6 835C subi r24,lo8(-(61)) |
402 02e8 F801 movw r30,r16 |
403 02ea E050 subi r30,lo8(-(TxdBuffer)) |
404 02ec F040 sbci r31,hi8(-(TxdBuffer)) |
405 02ee 8083 st Z,r24 |
406 02f0 2D2D mov r18,r13 |
407 02f2 2295 swap r18 |
408 02f4 2F70 andi r18,lo8(15) |
409 02f6 892F mov r24,r25 |
410 02f8 90E0 ldi r25,lo8(0) |
411 02fa 8370 andi r24,lo8(3) |
412 02fc 9070 andi r25,hi8(3) |
413 02fe F4E0 ldi r31,4 |
414 0300 880F 1: lsl r24 |
415 0302 991F rol r25 |
416 0304 FA95 dec r31 |
417 0306 01F4 brne 1b |
418 0308 282B or r18,r24 |
419 030a 235C subi r18,lo8(-(61)) |
420 030c F801 movw r30,r16 |
421 030e E050 subi r30,lo8(-(TxdBuffer+1)) |
422 0310 F040 sbci r31,hi8(-(TxdBuffer+1)) |
423 0312 2083 st Z,r18 |
424 0314 8D2D mov r24,r13 |
425 0316 90E0 ldi r25,lo8(0) |
426 0318 8F70 andi r24,lo8(15) |
427 031a 9070 andi r25,hi8(15) |
428 031c 880F lsl r24 |
429 031e 991F rol r25 |
430 0320 880F lsl r24 |
431 0322 991F rol r25 |
432 0324 262F mov r18,r22 |
433 0326 2295 swap r18 |
434 0328 2695 lsr r18 |
435 032a 2695 lsr r18 |
436 032c 2370 andi r18,lo8(3) |
437 032e 282B or r18,r24 |
438 0330 235C subi r18,lo8(-(61)) |
439 0332 F801 movw r30,r16 |
440 0334 E050 subi r30,lo8(-(TxdBuffer+2)) |
441 0336 F040 sbci r31,hi8(-(TxdBuffer+2)) |
442 0338 2083 st Z,r18 |
443 033a 6F73 andi r22,lo8(63) |
444 033c 635C subi r22,lo8(-(61)) |
445 033e F801 movw r30,r16 |
446 0340 E050 subi r30,lo8(-(TxdBuffer+3)) |
447 0342 F040 sbci r31,hi8(-(TxdBuffer+3)) |
448 0344 6083 st Z,r22 |
449 0346 0C5F subi r16,lo8(-(4)) |
450 0348 1F4F sbci r17,hi8(-(4)) |
451 .L28: |
452 034a 4115 cp r20,__zero_reg__ |
453 034c 5105 cpc r21,__zero_reg__ |
454 034e 01F0 breq .+2 |
455 0350 00C0 rjmp .L36 |
456 0352 C801 movw r24,r16 |
457 0354 0E94 0000 call AddCRC |
458 /* epilogue start */ |
459 0358 2096 adiw r28,0 |
460 035a E7E0 ldi r30, lo8(7) |
461 035c 0C94 0000 jmp __epilogue_restores__ + ((18 - 7) * 2) |
462 .L31: |
463 0360 30E0 ldi r19,lo8(0) |
464 .L30: |
465 0362 60E0 ldi r22,lo8(0) |
466 0364 DD24 clr r13 |
467 0366 00C0 rjmp .L34 |
469 .global DatenUebertragung |
471 DatenUebertragung: |
472 0368 A0E1 ldi r26,lo8(16) |
473 036a B0E0 ldi r27,hi8(16) |
474 036c E0E0 ldi r30,lo8(gs(1f)) |
475 036e F0E0 ldi r31,hi8(gs(1f)) |
476 0370 0C94 0000 jmp __prologue_saves__+((18 - 6) * 2) |
477 1: |
478 /* prologue: function */ |
479 /* frame size = 16 */ |
480 0374 8091 0000 lds r24,UebertragungAbgeschlossen |
481 0378 8823 tst r24 |
482 037a 01F4 brne .+2 |
483 037c 00C0 rjmp .L58 |
484 037e 8091 0000 lds r24,AboTimeOut |
485 0382 9091 0000 lds r25,(AboTimeOut)+1 |
486 0386 0E94 0000 call CheckDelay |
487 038a 8823 tst r24 |
488 038c 01F0 breq .L41 |
489 038e 1092 0000 sts (Display_Interval)+1,__zero_reg__ |
490 0392 1092 0000 sts Display_Interval,__zero_reg__ |
491 0396 1092 0000 sts (DebugDataIntervall)+1,__zero_reg__ |
492 039a 1092 0000 sts DebugDataIntervall,__zero_reg__ |
493 039e 1092 0000 sts (Intervall3D)+1,__zero_reg__ |
494 03a2 1092 0000 sts Intervall3D,__zero_reg__ |
495 .L41: |
496 03a6 8091 0000 lds r24,Display_Interval |
497 03aa 9091 0000 lds r25,(Display_Interval)+1 |
498 03ae 892B or r24,r25 |
499 03b0 01F0 breq .L42 |
500 03b2 8091 0000 lds r24,Display_Timer |
501 03b6 9091 0000 lds r25,(Display_Timer)+1 |
502 03ba 0E94 0000 call CheckDelay |
503 03be 8823 tst r24 |
504 03c0 01F4 brne .L43 |
505 .L42: |
506 03c2 8091 0000 lds r24,DebugDisplayAnforderung |
507 03c6 8823 tst r24 |
508 03c8 01F4 brne .+2 |
509 03ca 00C0 rjmp .L44 |
510 .L43: |
511 03cc 8091 0000 lds r24,UebertragungAbgeschlossen |
512 03d0 8823 tst r24 |
513 03d2 01F4 brne .+2 |
514 03d4 00C0 rjmp .L44 |
515 03d6 8091 0000 lds r24,DisplayLine |
516 03da 00E0 ldi r16,lo8(DisplayBuff) |
517 03dc 10E0 ldi r17,hi8(DisplayBuff) |
518 03de 8430 cpi r24,lo8(4) |
519 03e0 00F0 brlo .L45 |
520 03e2 0E94 0000 call Menu |
521 03e6 2DB7 in r18,__SP_L__ |
522 03e8 3EB7 in r19,__SP_H__ |
523 03ea 2750 subi r18,lo8(-(-7)) |
524 03ec 3040 sbci r19,hi8(-(-7)) |
525 03ee 2DBF out __SP_L__,r18 |
526 03f0 EDB7 in r30,__SP_L__ |
527 03f2 FEB7 in r31,__SP_H__ |
528 03f4 3196 adiw r30,1 |
529 03f6 88E4 ldi r24,lo8(72) |
530 03f8 ADB7 in r26,__SP_L__ |
531 03fa BEB7 in r27,__SP_H__ |
532 03fc 1196 adiw r26,1 |
533 03fe 8C93 st X,r24 |
534 0400 81E0 ldi r24,lo8(1) |
535 0402 8183 std Z+1,r24 |
536 0404 8283 std Z+2,r24 |
537 0406 1483 std Z+4,r17 |
538 0408 0383 std Z+3,r16 |
539 040a 80E5 ldi r24,lo8(80) |
540 040c 90E0 ldi r25,hi8(80) |
541 040e 9683 std Z+6,r25 |
542 0410 8583 std Z+5,r24 |
543 0412 0E94 0000 call SendOutData |
544 0416 EDB7 in r30,__SP_L__ |
545 0418 FEB7 in r31,__SP_H__ |
546 041a 3796 adiw r30,7 |
547 041c EDBF out __SP_L__,r30 |
548 041e 00C0 rjmp .L46 |
549 .L45: |
550 0420 1092 0000 sts DispPtr,__zero_reg__ |
551 0424 00D0 rcall . |
552 0426 00D0 rcall . |
553 0428 80E0 ldi r24,lo8(gs(Menu_Putchar)) |
554 042a 90E0 ldi r25,hi8(gs(Menu_Putchar)) |
555 042c ADB7 in r26,__SP_L__ |
556 042e BEB7 in r27,__SP_H__ |
557 0430 1296 adiw r26,1+1 |
558 0432 9C93 st X,r25 |
559 0434 8E93 st -X,r24 |
560 0436 1197 sbiw r26,1 |
561 0438 80E0 ldi r24,lo8(__c.2679) |
562 043a 90E0 ldi r25,hi8(__c.2679) |
563 043c 1496 adiw r26,3+1 |
564 043e 9C93 st X,r25 |
565 0440 8E93 st -X,r24 |
566 0442 1397 sbiw r26,3 |
567 0444 E091 0000 lds r30,_printf_P |
568 0448 F091 0000 lds r31,(_printf_P)+1 |
569 044c 0995 icall |
570 044e EDB7 in r30,__SP_L__ |
571 0450 FEB7 in r31,__SP_H__ |
572 0452 3797 sbiw r30,7 |
573 0454 EDBF out __SP_L__,r30 |
574 0456 3196 adiw r30,1 |
575 0458 88E4 ldi r24,lo8(72) |
576 045a ADB7 in r26,__SP_L__ |
577 045c BEB7 in r27,__SP_H__ |
578 045e 1196 adiw r26,1 |
579 0460 8C93 st X,r24 |
580 0462 81E0 ldi r24,lo8(1) |
581 0464 8183 std Z+1,r24 |
582 0466 82E0 ldi r24,lo8(2) |
583 0468 8283 std Z+2,r24 |
584 046a 80E0 ldi r24,lo8(DisplayLine) |
585 046c 90E0 ldi r25,hi8(DisplayLine) |
586 046e 9483 std Z+4,r25 |
587 0470 8383 std Z+3,r24 |
588 0472 81E0 ldi r24,lo8(1) |
589 0474 90E0 ldi r25,hi8(1) |
590 0476 9683 std Z+6,r25 |
591 0478 8583 std Z+5,r24 |
592 047a 1087 std Z+8,r17 |
593 047c 0783 std Z+7,r16 |
594 047e 84E1 ldi r24,lo8(20) |
595 0480 90E0 ldi r25,hi8(20) |
596 0482 9287 std Z+10,r25 |
597 0484 8187 std Z+9,r24 |
598 0486 0E94 0000 call SendOutData |
599 048a 8091 0000 lds r24,DisplayLine |
600 048e 8F5F subi r24,lo8(-(1)) |
601 0490 8093 0000 sts DisplayLine,r24 |
602 0494 8150 subi r24,lo8(-(-1)) |
603 0496 EDB7 in r30,__SP_L__ |
604 0498 FEB7 in r31,__SP_H__ |
605 049a 3B96 adiw r30,11 |
606 049c EDBF out __SP_L__,r30 |
607 049e 8430 cpi r24,lo8(4) |
608 04a0 00F0 brlo .L46 |
609 04a2 1092 0000 sts DisplayLine,__zero_reg__ |
610 .L46: |
611 04a6 8091 0000 lds r24,Display_Interval |
612 04aa 9091 0000 lds r25,(Display_Interval)+1 |
613 04ae 0E94 0000 call SetDelay |
614 04b2 9093 0000 sts (Display_Timer)+1,r25 |
615 04b6 8093 0000 sts Display_Timer,r24 |
616 04ba 1092 0000 sts DebugDisplayAnforderung,__zero_reg__ |
617 .L44: |
618 04be 8091 0000 lds r24,DebugDisplayAnforderung1 |
619 04c2 8823 tst r24 |
620 04c4 01F0 breq .L47 |
621 04c6 8091 0000 lds r24,UebertragungAbgeschlossen |
622 04ca 8823 tst r24 |
623 04cc 01F0 breq .L47 |
624 04ce 0E94 0000 call Menu |
625 04d2 2DB7 in r18,__SP_L__ |
626 04d4 3EB7 in r19,__SP_H__ |
627 04d6 2F50 subi r18,lo8(-(-15)) |
628 04d8 3040 sbci r19,hi8(-(-15)) |
629 04da 2DBF out __SP_L__,r18 |
630 04dc EDB7 in r30,__SP_L__ |
631 04de FEB7 in r31,__SP_H__ |
632 04e0 3196 adiw r30,1 |
633 04e2 8CE4 ldi r24,lo8(76) |
634 04e4 ADB7 in r26,__SP_L__ |
635 04e6 BEB7 in r27,__SP_H__ |
636 04e8 1196 adiw r26,1 |
637 04ea 8C93 st X,r24 |
638 04ec 81E0 ldi r24,lo8(1) |
639 04ee 8183 std Z+1,r24 |
640 04f0 83E0 ldi r24,lo8(3) |
641 04f2 8283 std Z+2,r24 |
642 04f4 80E0 ldi r24,lo8(MenuePunkt) |
643 04f6 90E0 ldi r25,hi8(MenuePunkt) |
644 04f8 9483 std Z+4,r25 |
645 04fa 8383 std Z+3,r24 |
646 04fc 21E0 ldi r18,lo8(1) |
647 04fe 30E0 ldi r19,hi8(1) |
648 0500 3683 std Z+6,r19 |
649 0502 2583 std Z+5,r18 |
650 0504 80E0 ldi r24,lo8(MaxMenue) |
651 0506 90E0 ldi r25,hi8(MaxMenue) |
652 0508 9087 std Z+8,r25 |
653 050a 8783 std Z+7,r24 |
654 050c 3287 std Z+10,r19 |
655 050e 2187 std Z+9,r18 |
656 0510 80E0 ldi r24,lo8(DisplayBuff) |
657 0512 90E0 ldi r25,hi8(DisplayBuff) |
658 0514 9487 std Z+12,r25 |
659 0516 8387 std Z+11,r24 |
660 0518 80E5 ldi r24,lo8(80) |
661 051a 90E0 ldi r25,hi8(80) |
662 051c 9687 std Z+14,r25 |
663 051e 8587 std Z+13,r24 |
664 0520 0E94 0000 call SendOutData |
665 0524 1092 0000 sts DebugDisplayAnforderung1,__zero_reg__ |
666 0528 EDB7 in r30,__SP_L__ |
667 052a FEB7 in r31,__SP_H__ |
668 052c 3F96 adiw r30,15 |
669 052e EDBF out __SP_L__,r30 |
670 .L47: |
671 0530 8091 0000 lds r24,GetVersionAnforderung |
672 0534 8823 tst r24 |
673 0536 01F0 breq .L48 |
674 0538 8091 0000 lds r24,UebertragungAbgeschlossen |
675 053c 8823 tst r24 |
676 053e 01F0 breq .L48 |
677 0540 2DB7 in r18,__SP_L__ |
678 0542 3EB7 in r19,__SP_H__ |
679 0544 2750 subi r18,lo8(-(-7)) |
680 0546 3040 sbci r19,hi8(-(-7)) |
681 0548 2DBF out __SP_L__,r18 |
682 054a EDB7 in r30,__SP_L__ |
683 054c FEB7 in r31,__SP_H__ |
684 054e 3196 adiw r30,1 |
685 0550 86E5 ldi r24,lo8(86) |
686 0552 ADB7 in r26,__SP_L__ |
687 0554 BEB7 in r27,__SP_H__ |
688 0556 1196 adiw r26,1 |
689 0558 8C93 st X,r24 |
690 055a 81E0 ldi r24,lo8(1) |
691 055c 8183 std Z+1,r24 |
692 055e 8283 std Z+2,r24 |
693 0560 80E0 ldi r24,lo8(VersionInfo) |
694 0562 90E0 ldi r25,hi8(VersionInfo) |
695 0564 9483 std Z+4,r25 |
696 0566 8383 std Z+3,r24 |
697 0568 8AE0 ldi r24,lo8(10) |
698 056a 90E0 ldi r25,hi8(10) |
699 056c 9683 std Z+6,r25 |
700 056e 8583 std Z+5,r24 |
701 0570 0E94 0000 call SendOutData |
702 0574 1092 0000 sts GetVersionAnforderung,__zero_reg__ |
703 0578 EDB7 in r30,__SP_L__ |
704 057a FEB7 in r31,__SP_H__ |
705 057c 3796 adiw r30,7 |
706 057e EDBF out __SP_L__,r30 |
707 .L48: |
708 0580 8091 0000 lds r24,GetExternalControl |
709 0584 8823 tst r24 |
710 0586 01F0 breq .L49 |
711 0588 8091 0000 lds r24,UebertragungAbgeschlossen |
712 058c 8823 tst r24 |
713 058e 01F0 breq .L49 |
714 0590 2DB7 in r18,__SP_L__ |
715 0592 3EB7 in r19,__SP_H__ |
716 0594 2750 subi r18,lo8(-(-7)) |
717 0596 3040 sbci r19,hi8(-(-7)) |
718 0598 2DBF out __SP_L__,r18 |
719 059a EDB7 in r30,__SP_L__ |
720 059c FEB7 in r31,__SP_H__ |
721 059e 3196 adiw r30,1 |
722 05a0 87E4 ldi r24,lo8(71) |
723 05a2 ADB7 in r26,__SP_L__ |
724 05a4 BEB7 in r27,__SP_H__ |
725 05a6 1196 adiw r26,1 |
726 05a8 8C93 st X,r24 |
727 05aa 8091 0000 lds r24,MeineSlaveAdresse |
728 05ae 8183 std Z+1,r24 |
729 05b0 81E0 ldi r24,lo8(1) |
730 05b2 8283 std Z+2,r24 |
731 05b4 80E0 ldi r24,lo8(ExternControl) |
732 05b6 90E0 ldi r25,hi8(ExternControl) |
733 05b8 9483 std Z+4,r25 |
734 05ba 8383 std Z+3,r24 |
735 05bc 8BE0 ldi r24,lo8(11) |
736 05be 90E0 ldi r25,hi8(11) |
737 05c0 9683 std Z+6,r25 |
738 05c2 8583 std Z+5,r24 |
739 05c4 0E94 0000 call SendOutData |
740 05c8 1092 0000 sts GetExternalControl,__zero_reg__ |
741 05cc EDB7 in r30,__SP_L__ |
742 05ce FEB7 in r31,__SP_H__ |
743 05d0 3796 adiw r30,7 |
744 05d2 EDBF out __SP_L__,r30 |
745 .L49: |
746 05d4 8091 0000 lds r24,Kompass_Timer |
747 05d8 9091 0000 lds r25,(Kompass_Timer)+1 |
748 05dc 0E94 0000 call CheckDelay |
749 05e0 8823 tst r24 |
750 05e2 01F4 brne .+2 |
751 05e4 00C0 rjmp .L50 |
752 05e6 8091 0000 lds r24,UebertragungAbgeschlossen |
753 05ea 8823 tst r24 |
754 05ec 01F4 brne .+2 |
755 05ee 00C0 rjmp .L50 |
756 05f0 E090 0000 lds r14,EE_Parameter+28 |
757 05f4 FF24 clr r15 |
758 05f6 EE0C lsl r14 |
759 05f8 FF1C rol r15 |
760 05fa EE0C lsl r14 |
761 05fc FF1C rol r15 |
762 05fe 0027 clr r16 |
763 0600 F7FC sbrc r15,7 |
764 0602 0095 com r16 |
765 0604 102F mov r17,r16 |
766 0606 6091 0000 lds r22,IntegralNick |
767 060a 7091 0000 lds r23,(IntegralNick)+1 |
768 060e 8091 0000 lds r24,(IntegralNick)+2 |
769 0612 9091 0000 lds r25,(IntegralNick)+3 |
770 0616 A801 movw r20,r16 |
771 0618 9701 movw r18,r14 |
772 061a 0E94 0000 call __divmodsi4 |
773 061e 3093 0000 sts (WinkelOut)+1,r19 |
774 0622 2093 0000 sts WinkelOut,r18 |
775 0626 6091 0000 lds r22,IntegralRoll |
776 062a 7091 0000 lds r23,(IntegralRoll)+1 |
777 062e 8091 0000 lds r24,(IntegralRoll)+2 |
778 0632 9091 0000 lds r25,(IntegralRoll)+3 |
779 0636 A801 movw r20,r16 |
780 0638 9701 movw r18,r14 |
781 063a 0E94 0000 call __divmodsi4 |
782 063e 3093 0000 sts (WinkelOut+2)+1,r19 |
783 0642 2093 0000 sts WinkelOut+2,r18 |
784 0646 8091 0000 lds r24,Parameter_UserParam1 |
785 064a 8093 0000 sts WinkelOut+4,r24 |
786 064e 8091 0000 lds r24,Parameter_UserParam2 |
787 0652 8093 0000 sts WinkelOut+5,r24 |
788 0656 2DB7 in r18,__SP_L__ |
789 0658 3EB7 in r19,__SP_H__ |
790 065a 2750 subi r18,lo8(-(-7)) |
791 065c 3040 sbci r19,hi8(-(-7)) |
792 065e 2DBF out __SP_L__,r18 |
793 0660 EDB7 in r30,__SP_L__ |
794 0662 FEB7 in r31,__SP_H__ |
795 0664 3196 adiw r30,1 |
796 0666 8BE6 ldi r24,lo8(107) |
797 0668 ADB7 in r26,__SP_L__ |
798 066a BEB7 in r27,__SP_H__ |
799 066c 1196 adiw r26,1 |
800 066e 8C93 st X,r24 |
801 0670 83E0 ldi r24,lo8(3) |
802 0672 8183 std Z+1,r24 |
803 0674 81E0 ldi r24,lo8(1) |
804 0676 8283 std Z+2,r24 |
805 0678 80E0 ldi r24,lo8(WinkelOut) |
806 067a 90E0 ldi r25,hi8(WinkelOut) |
807 067c 9483 std Z+4,r25 |
808 067e 8383 std Z+3,r24 |
809 0680 88E0 ldi r24,lo8(8) |
810 0682 90E0 ldi r25,hi8(8) |
811 0684 9683 std Z+6,r25 |
812 0686 8583 std Z+5,r24 |
813 0688 0E94 0000 call SendOutData |
814 068c EDB7 in r30,__SP_L__ |
815 068e FEB7 in r31,__SP_H__ |
816 0690 3796 adiw r30,7 |
817 0692 EDBF out __SP_L__,r30 |
818 0694 8091 0000 lds r24,WinkelOut+6 |
819 0698 8530 cpi r24,lo8(5) |
820 069a 00F0 brlo .L51 |
821 069c 86E0 ldi r24,lo8(6) |
822 069e 8093 0000 sts WinkelOut+6,r24 |
823 .L51: |
824 06a2 83E6 ldi r24,lo8(99) |
825 06a4 90E0 ldi r25,hi8(99) |
826 06a6 0E94 0000 call SetDelay |
827 06aa 9093 0000 sts (Kompass_Timer)+1,r25 |
828 06ae 8093 0000 sts Kompass_Timer,r24 |
829 .L50: |
830 06b2 8091 0000 lds r24,DebugDataIntervall |
831 06b6 9091 0000 lds r25,(DebugDataIntervall)+1 |
832 06ba 892B or r24,r25 |
833 06bc 01F0 breq .L52 |
834 06be 8091 0000 lds r24,Debug_Timer |
835 06c2 9091 0000 lds r25,(Debug_Timer)+1 |
836 06c6 0E94 0000 call CheckDelay |
837 06ca 8823 tst r24 |
838 06cc 01F4 brne .L53 |
839 .L52: |
840 06ce 8091 0000 lds r24,DebugDataAnforderung |
841 06d2 8823 tst r24 |
842 06d4 01F0 breq .L54 |
843 .L53: |
844 06d6 8091 0000 lds r24,UebertragungAbgeschlossen |
845 06da 8823 tst r24 |
846 06dc 01F0 breq .L54 |
847 06de 0E94 0000 call CopyDebugValues |
848 06e2 2DB7 in r18,__SP_L__ |
849 06e4 3EB7 in r19,__SP_H__ |
850 06e6 2750 subi r18,lo8(-(-7)) |
851 06e8 3040 sbci r19,hi8(-(-7)) |
852 06ea 2DBF out __SP_L__,r18 |
853 06ec EDB7 in r30,__SP_L__ |
854 06ee FEB7 in r31,__SP_H__ |
855 06f0 3196 adiw r30,1 |
856 06f2 84E4 ldi r24,lo8(68) |
857 06f4 ADB7 in r26,__SP_L__ |
858 06f6 BEB7 in r27,__SP_H__ |
859 06f8 1196 adiw r26,1 |
860 06fa 8C93 st X,r24 |
861 06fc 81E0 ldi r24,lo8(1) |
862 06fe 8183 std Z+1,r24 |
863 0700 8283 std Z+2,r24 |
864 0702 80E0 ldi r24,lo8(DebugOut) |
865 0704 90E0 ldi r25,hi8(DebugOut) |
866 0706 9483 std Z+4,r25 |
867 0708 8383 std Z+3,r24 |
868 070a 82E4 ldi r24,lo8(66) |
869 070c 90E0 ldi r25,hi8(66) |
870 070e 9683 std Z+6,r25 |
871 0710 8583 std Z+5,r24 |
872 0712 0E94 0000 call SendOutData |
873 0716 1092 0000 sts DebugDataAnforderung,__zero_reg__ |
874 071a 8091 0000 lds r24,DebugDataIntervall |
875 071e 9091 0000 lds r25,(DebugDataIntervall)+1 |
876 0722 EDB7 in r30,__SP_L__ |
877 0724 FEB7 in r31,__SP_H__ |
878 0726 3796 adiw r30,7 |
879 0728 EDBF out __SP_L__,r30 |
880 072a 0097 sbiw r24,0 |
881 072c 01F0 breq .L54 |
882 072e 0E94 0000 call SetDelay |
883 0732 9093 0000 sts (Debug_Timer)+1,r25 |
884 0736 8093 0000 sts Debug_Timer,r24 |
885 .L54: |
886 073a 8091 0000 lds r24,Intervall3D |
887 073e 9091 0000 lds r25,(Intervall3D)+1 |
888 0742 892B or r24,r25 |
889 0744 01F4 brne .+2 |
890 0746 00C0 rjmp .L55 |
891 0748 8091 0000 lds r24,Timer3D |
892 074c 9091 0000 lds r25,(Timer3D)+1 |
893 0750 0E94 0000 call CheckDelay |
894 0754 8823 tst r24 |
895 0756 01F4 brne .+2 |
896 0758 00C0 rjmp .L55 |
897 075a 8091 0000 lds r24,UebertragungAbgeschlossen |
898 075e 8823 tst r24 |
899 0760 01F4 brne .+2 |
900 0762 00C0 rjmp .L55 |
901 0764 E090 0000 lds r14,EE_Parameter+28 |
902 0768 FF24 clr r15 |
903 076a EE0C lsl r14 |
904 076c FF1C rol r15 |
905 076e EE0C lsl r14 |
906 0770 FF1C rol r15 |
907 0772 0027 clr r16 |
908 0774 F7FC sbrc r15,7 |
909 0776 0095 com r16 |
910 0778 102F mov r17,r16 |
911 077a 6091 0000 lds r22,IntegralNick |
912 077e 7091 0000 lds r23,(IntegralNick)+1 |
913 0782 8091 0000 lds r24,(IntegralNick)+2 |
914 0786 9091 0000 lds r25,(IntegralNick)+3 |
915 078a A801 movw r20,r16 |
916 078c 9701 movw r18,r14 |
917 078e 0E94 0000 call __divmodsi4 |
918 0792 3093 0000 sts (Data3D)+1,r19 |
919 0796 2093 0000 sts Data3D,r18 |
920 079a 6091 0000 lds r22,IntegralRoll |
921 079e 7091 0000 lds r23,(IntegralRoll)+1 |
922 07a2 8091 0000 lds r24,(IntegralRoll)+2 |
923 07a6 9091 0000 lds r25,(IntegralRoll)+3 |
924 07aa A801 movw r20,r16 |
925 07ac 9701 movw r18,r14 |
926 07ae 0E94 0000 call __divmodsi4 |
927 07b2 3093 0000 sts (Data3D+2)+1,r19 |
928 07b6 2093 0000 sts Data3D+2,r18 |
929 07ba 6091 0000 lds r22,ErsatzKompass |
930 07be 7091 0000 lds r23,(ErsatzKompass)+1 |
931 07c2 8091 0000 lds r24,(ErsatzKompass)+2 |
932 07c6 9091 0000 lds r25,(ErsatzKompass)+3 |
933 07ca 2AE0 ldi r18,lo8(10) |
934 07cc 30E0 ldi r19,hi8(10) |
935 07ce 40E0 ldi r20,hlo8(10) |
936 07d0 50E0 ldi r21,hhi8(10) |
937 07d2 0E94 0000 call __mulsi3 |
938 07d6 2091 0000 lds r18,GIER_GRAD_FAKTOR |
939 07da 3091 0000 lds r19,(GIER_GRAD_FAKTOR)+1 |
940 07de 4091 0000 lds r20,(GIER_GRAD_FAKTOR)+2 |
941 07e2 5091 0000 lds r21,(GIER_GRAD_FAKTOR)+3 |
942 07e6 0E94 0000 call __divmodsi4 |
943 07ea 3093 0000 sts (Data3D+4)+1,r19 |
944 07ee 2093 0000 sts Data3D+4,r18 |
945 07f2 8091 0000 lds r24,SummeNick |
946 07f6 9091 0000 lds r25,(SummeNick)+1 |
947 07fa A091 0000 lds r26,(SummeNick)+2 |
948 07fe B091 0000 lds r27,(SummeNick)+3 |
949 0802 49E0 ldi r20,9 |
950 0804 B595 1: asr r27 |
951 0806 A795 ror r26 |
952 0808 9795 ror r25 |
953 080a 8795 ror r24 |
954 080c 4A95 dec r20 |
955 080e 01F4 brne 1b |
956 0810 8093 0000 sts Data3D+6,r24 |
957 0814 8091 0000 lds r24,SummeRoll |
958 0818 9091 0000 lds r25,(SummeRoll)+1 |
959 081c A091 0000 lds r26,(SummeRoll)+2 |
960 0820 B091 0000 lds r27,(SummeRoll)+3 |
961 0824 39E0 ldi r19,9 |
962 0826 B595 1: asr r27 |
963 0828 A795 ror r26 |
964 082a 9795 ror r25 |
965 082c 8795 ror r24 |
966 082e 3A95 dec r19 |
967 0830 01F4 brne 1b |
968 0832 8093 0000 sts Data3D+7,r24 |
969 0836 8091 0000 lds r24,Mess_Integral_Gier |
970 083a 9091 0000 lds r25,(Mess_Integral_Gier)+1 |
971 083e A091 0000 lds r26,(Mess_Integral_Gier)+2 |
972 0842 B091 0000 lds r27,(Mess_Integral_Gier)+3 |
973 0846 29E0 ldi r18,9 |
974 0848 B595 1: asr r27 |
975 084a A795 ror r26 |
976 084c 9795 ror r25 |
977 084e 8795 ror r24 |
978 0850 2A95 dec r18 |
979 0852 01F4 brne 1b |
980 0854 8093 0000 sts Data3D+8,r24 |
981 0858 2DB7 in r18,__SP_L__ |
982 085a 3EB7 in r19,__SP_H__ |
983 085c 2750 subi r18,lo8(-(-7)) |
984 085e 3040 sbci r19,hi8(-(-7)) |
985 0860 2DBF out __SP_L__,r18 |
986 0862 EDB7 in r30,__SP_L__ |
987 0864 FEB7 in r31,__SP_H__ |
988 0866 3196 adiw r30,1 |
989 0868 83E4 ldi r24,lo8(67) |
990 086a ADB7 in r26,__SP_L__ |
991 086c BEB7 in r27,__SP_H__ |
992 086e 1196 adiw r26,1 |
993 0870 8C93 st X,r24 |
994 0872 81E0 ldi r24,lo8(1) |
995 0874 8183 std Z+1,r24 |
996 0876 8283 std Z+2,r24 |
997 0878 80E0 ldi r24,lo8(Data3D) |
998 087a 90E0 ldi r25,hi8(Data3D) |
999 087c 9483 std Z+4,r25 |
1000 087e 8383 std Z+3,r24 |
1001 0880 8EE0 ldi r24,lo8(14) |
1002 0882 90E0 ldi r25,hi8(14) |
1003 0884 9683 std Z+6,r25 |
1004 0886 8583 std Z+5,r24 |
1005 0888 0E94 0000 call SendOutData |
1006 088c EDB7 in r30,__SP_L__ |
1007 088e FEB7 in r31,__SP_H__ |
1008 0890 3796 adiw r30,7 |
1009 0892 EDBF out __SP_L__,r30 |
1010 0894 8091 0000 lds r24,Intervall3D |
1011 0898 9091 0000 lds r25,(Intervall3D)+1 |
1012 089c 0E94 0000 call SetDelay |
1013 08a0 9093 0000 sts (Timer3D)+1,r25 |
1014 08a4 8093 0000 sts Timer3D,r24 |
1015 .L55: |
1016 08a8 6091 0000 lds r22,DebugTextAnforderung |
1017 08ac 6F3F cpi r22,lo8(-1) |
1018 08ae 01F0 breq .L56 |
1019 08b0 70E0 ldi r23,lo8(0) |
1020 08b2 A4E0 ldi r26,4 |
1021 08b4 660F 1: lsl r22 |
1022 08b6 771F rol r23 |
1023 08b8 AA95 dec r26 |
1024 08ba 01F4 brne 1b |
1025 08bc 6050 subi r22,lo8(-(ANALOG_TEXT)) |
1026 08be 7040 sbci r23,hi8(-(ANALOG_TEXT)) |
1027 08c0 8E01 movw r16,r28 |
1028 08c2 0F5F subi r16,lo8(-(1)) |
1029 08c4 1F4F sbci r17,hi8(-(1)) |
1030 08c6 C801 movw r24,r16 |
1031 08c8 40E1 ldi r20,lo8(16) |
1032 08ca 50E0 ldi r21,hi8(16) |
1033 08cc 0E94 0000 call memcpy_P |
1034 08d0 2DB7 in r18,__SP_L__ |
1035 08d2 3EB7 in r19,__SP_H__ |
1036 08d4 2B50 subi r18,lo8(-(-11)) |
1037 08d6 3040 sbci r19,hi8(-(-11)) |
1038 08d8 2DBF out __SP_L__,r18 |
1039 08da EDB7 in r30,__SP_L__ |
1040 08dc FEB7 in r31,__SP_H__ |
1041 08de 3196 adiw r30,1 |
1042 08e0 81E4 ldi r24,lo8(65) |
1043 08e2 ADB7 in r26,__SP_L__ |
1044 08e4 BEB7 in r27,__SP_H__ |
1045 08e6 1196 adiw r26,1 |
1046 08e8 8C93 st X,r24 |
1047 08ea 81E0 ldi r24,lo8(1) |
1048 08ec 8183 std Z+1,r24 |
1049 08ee 82E0 ldi r24,lo8(2) |
1050 08f0 8283 std Z+2,r24 |
1051 08f2 80E0 ldi r24,lo8(DebugTextAnforderung) |
1052 08f4 90E0 ldi r25,hi8(DebugTextAnforderung) |
1053 08f6 9483 std Z+4,r25 |
1054 08f8 8383 std Z+3,r24 |
1055 08fa 81E0 ldi r24,lo8(1) |
1056 08fc 90E0 ldi r25,hi8(1) |
1057 08fe 9683 std Z+6,r25 |
1058 0900 8583 std Z+5,r24 |
1059 0902 1087 std Z+8,r17 |
1060 0904 0783 std Z+7,r16 |
1061 0906 80E1 ldi r24,lo8(16) |
1062 0908 90E0 ldi r25,hi8(16) |
1063 090a 9287 std Z+10,r25 |
1064 090c 8187 std Z+9,r24 |
1065 090e 0E94 0000 call SendOutData |
1066 0912 8FEF ldi r24,lo8(-1) |
1067 0914 8093 0000 sts DebugTextAnforderung,r24 |
1068 0918 EDB7 in r30,__SP_L__ |
1069 091a FEB7 in r31,__SP_H__ |
1070 091c 3B96 adiw r30,11 |
1071 091e EDBF out __SP_L__,r30 |
1072 .L56: |
1073 0920 8091 0000 lds r24,ConfirmFrame |
1074 0924 8823 tst r24 |
1075 0926 01F0 breq .L57 |
1076 0928 8091 0000 lds r24,UebertragungAbgeschlossen |
1077 092c 8823 tst r24 |
1078 092e 01F0 breq .L57 |
1079 0930 2DB7 in r18,__SP_L__ |
1080 0932 3EB7 in r19,__SP_H__ |
1081 0934 2750 subi r18,lo8(-(-7)) |
1082 0936 3040 sbci r19,hi8(-(-7)) |
1083 0938 2DBF out __SP_L__,r18 |
1084 093a EDB7 in r30,__SP_L__ |
1085 093c FEB7 in r31,__SP_H__ |
1086 093e 3196 adiw r30,1 |
1087 0940 82E4 ldi r24,lo8(66) |
1088 0942 ADB7 in r26,__SP_L__ |
1089 0944 BEB7 in r27,__SP_H__ |
1090 0946 1196 adiw r26,1 |
1091 0948 8C93 st X,r24 |
1092 094a 81E0 ldi r24,lo8(1) |
1093 094c 8183 std Z+1,r24 |
1094 094e 8283 std Z+2,r24 |
1095 0950 80E0 ldi r24,lo8(ConfirmFrame) |
1096 0952 90E0 ldi r25,hi8(ConfirmFrame) |
1097 0954 9483 std Z+4,r25 |
1098 0956 8383 std Z+3,r24 |
1099 0958 81E0 ldi r24,lo8(1) |
1100 095a 90E0 ldi r25,hi8(1) |
1101 095c 9683 std Z+6,r25 |
1102 095e 8583 std Z+5,r24 |
1103 0960 0E94 0000 call SendOutData |
1104 0964 1092 0000 sts ConfirmFrame,__zero_reg__ |
1105 0968 EDB7 in r30,__SP_L__ |
1106 096a FEB7 in r31,__SP_H__ |
1107 096c 3796 adiw r30,7 |
1108 096e EDBF out __SP_L__,r30 |
1109 .L57: |
1110 0970 8091 0000 lds r24,GetPPMChannelAnforderung |
1111 0974 8823 tst r24 |
1112 0976 01F0 breq .L58 |
1113 0978 8091 0000 lds r24,UebertragungAbgeschlossen |
1114 097c 8823 tst r24 |
1115 097e 01F0 breq .L58 |
1116 0980 2DB7 in r18,__SP_L__ |
1117 0982 3EB7 in r19,__SP_H__ |
1118 0984 2750 subi r18,lo8(-(-7)) |
1119 0986 3040 sbci r19,hi8(-(-7)) |
1120 0988 2DBF out __SP_L__,r18 |
1121 098a EDB7 in r30,__SP_L__ |
1122 098c FEB7 in r31,__SP_H__ |
1123 098e 3196 adiw r30,1 |
1124 0990 80E5 ldi r24,lo8(80) |
1125 0992 ADB7 in r26,__SP_L__ |
1126 0994 BEB7 in r27,__SP_H__ |
1127 0996 1196 adiw r26,1 |
1128 0998 8C93 st X,r24 |
1129 099a 81E0 ldi r24,lo8(1) |
1130 099c 8183 std Z+1,r24 |
1131 099e 8283 std Z+2,r24 |
1132 09a0 80E0 ldi r24,lo8(PPM_in) |
1133 09a2 90E0 ldi r25,hi8(PPM_in) |
1134 09a4 9483 std Z+4,r25 |
1135 09a6 8383 std Z+3,r24 |
1136 09a8 84E3 ldi r24,lo8(52) |
1137 09aa 90E0 ldi r25,hi8(52) |
1138 09ac 9683 std Z+6,r25 |
1139 09ae 8583 std Z+5,r24 |
1140 09b0 0E94 0000 call SendOutData |
1141 09b4 1092 0000 sts GetPPMChannelAnforderung,__zero_reg__ |
1142 09b8 EDB7 in r30,__SP_L__ |
1143 09ba FEB7 in r31,__SP_H__ |
1144 09bc 3796 adiw r30,7 |
1145 09be EDBF out __SP_L__,r30 |
1146 .L58: |
1147 /* epilogue start */ |
1148 09c0 6096 adiw r28,16 |
1149 09c2 E6E0 ldi r30, lo8(6) |
1150 09c4 0C94 0000 jmp __epilogue_restores__ + ((18 - 6) * 2) |
1152 .global BearbeiteRxDaten |
1154 BearbeiteRxDaten: |
1155 09c8 A2E0 ldi r26,lo8(2) |
1156 09ca B0E0 ldi r27,hi8(2) |
1157 09cc E0E0 ldi r30,lo8(gs(1f)) |
1158 09ce F0E0 ldi r31,hi8(gs(1f)) |
1159 09d0 0C94 0000 jmp __prologue_saves__+((18 - 4) * 2) |
1160 1: |
1161 /* prologue: function */ |
1162 /* frame size = 2 */ |
1163 09d4 8091 0000 lds r24,NeuerDatensatzEmpfangen |
1164 09d8 8823 tst r24 |
1165 09da 01F4 brne .+2 |
1166 09dc 00C0 rjmp .L122 |
1167 09de 0E94 0000 call Decode64 |
1168 09e2 8091 0000 lds r24,RxdBuffer+1 |
1169 09e6 8236 cpi r24,lo8(98) |
1170 09e8 01F0 breq .+2 |
1171 09ea 00C0 rjmp .L61 |
1172 09ec 8091 0000 lds r24,RxdBuffer+2 |
1173 09f0 8137 cpi r24,lo8(113) |
1174 09f2 01F4 brne .+2 |
1175 09f4 00C0 rjmp .L68 |
1176 09f6 8237 cpi r24,lo8(114) |
1177 09f8 00F4 brsh .L74 |
1178 09fa 8D36 cpi r24,lo8(109) |
1179 09fc 01F4 brne .+2 |
1180 09fe 00C0 rjmp .L65 |
1181 0a00 8E36 cpi r24,lo8(110) |
1182 0a02 00F4 brsh .L75 |
1183 0a04 8B34 cpi r24,lo8(75) |
1184 0a06 01F0 breq .L63 |
1185 0a08 8636 cpi r24,lo8(102) |
1186 0a0a 01F0 breq .+2 |
1187 0a0c 00C0 rjmp .L61 |
1188 0a0e 00C0 rjmp .L153 |
1189 .L75: |
1190 0a10 8E36 cpi r24,lo8(110) |
1191 0a12 01F4 brne .+2 |
1192 0a14 00C0 rjmp .L128 |
1193 0a16 8037 cpi r24,lo8(112) |
1194 0a18 01F0 breq .+2 |
1195 0a1a 00C0 rjmp .L61 |
1196 0a1c 00C0 rjmp .L154 |
1197 .L74: |
1198 0a1e 8537 cpi r24,lo8(117) |
1199 0a20 01F4 brne .+2 |
1200 0a22 00C0 rjmp .L71 |
1201 0a24 8637 cpi r24,lo8(118) |
1202 0a26 00F4 brsh .L76 |
1203 0a28 8337 cpi r24,lo8(115) |
1204 0a2a 01F4 brne .+2 |
1205 0a2c 00C0 rjmp .L69 |
1206 0a2e 8437 cpi r24,lo8(116) |
1207 0a30 01F0 breq .+2 |
1208 0a32 00C0 rjmp .L61 |
1209 0a34 00C0 rjmp .L155 |
1210 .L76: |
1211 0a36 8737 cpi r24,lo8(119) |
1212 0a38 01F4 brne .+2 |
1213 0a3a 00C0 rjmp .L72 |
1214 0a3c 8937 cpi r24,lo8(121) |
1215 0a3e 01F0 breq .+2 |
1216 0a40 00C0 rjmp .L61 |
1217 0a42 00C0 rjmp .L156 |
1218 .L63: |
1219 0a44 E091 0000 lds r30,pRxData |
1220 0a48 F091 0000 lds r31,(pRxData)+1 |
1221 0a4c 8081 ld r24,Z |
1222 0a4e 9181 ldd r25,Z+1 |
1223 0a50 9093 0000 sts (KompassValue)+1,r25 |
1224 0a54 8093 0000 sts KompassValue,r24 |
1225 0a58 845E subi r24,lo8(-(540)) |
1226 0a5a 9D4F sbci r25,hi8(-(540)) |
1227 0a5c 2091 0000 lds r18,KompassStartwert |
1228 0a60 3091 0000 lds r19,(KompassStartwert)+1 |
1229 0a64 821B sub r24,r18 |
1230 0a66 930B sbc r25,r19 |
1231 0a68 68E6 ldi r22,lo8(360) |
1232 0a6a 71E0 ldi r23,hi8(360) |
1233 0a6c 0E94 0000 call __divmodhi4 |
1234 0a70 845B subi r24,lo8(-(-180)) |
1235 0a72 9040 sbci r25,hi8(-(-180)) |
1236 0a74 9093 0000 sts (KompassRichtung)+1,r25 |
1237 0a78 8093 0000 sts KompassRichtung,r24 |
1238 0a7c 00C0 rjmp .L61 |
1239 .L155: |
1240 0a7e 8091 0000 lds r24,AnzahlEmpfangsBytes |
1241 0a82 8531 cpi r24,lo8(21) |
1242 0a84 00F0 brlo .L77 |
1243 0a86 A0E0 ldi r26,lo8(MotorTest) |
1244 0a88 B0E0 ldi r27,hi8(MotorTest) |
1245 0a8a 8091 0000 lds r24,pRxData |
1246 0a8e 9091 0000 lds r25,pRxData+1 |
1247 0a92 9C01 movw r18,r24 |
1248 0a94 F901 movw r30,r18 |
1249 0a96 80E1 ldi r24,lo8(16) |
1250 .L78: |
1251 0a98 0190 ld r0,Z+ |
1252 0a9a 0D92 st X+,r0 |
1253 0a9c 8150 subi r24,lo8(-(-1)) |
1254 0a9e 01F4 brne .L78 |
1255 0aa0 00C0 rjmp .L79 |
1256 .L77: |
1257 0aa2 E091 0000 lds r30,pRxData |
1258 0aa6 F091 0000 lds r31,(pRxData)+1 |
1259 0aaa 8081 ld r24,Z |
1260 0aac 9181 ldd r25,Z+1 |
1261 0aae A281 ldd r26,Z+2 |
1262 0ab0 B381 ldd r27,Z+3 |
1263 0ab2 8093 0000 sts MotorTest,r24 |
1264 0ab6 9093 0000 sts (MotorTest)+1,r25 |
1265 0aba A093 0000 sts (MotorTest)+2,r26 |
1266 0abe B093 0000 sts (MotorTest)+3,r27 |
1267 .L79: |
1268 0ac2 80EF ldi r24,lo8(-16) |
1269 0ac4 8093 0000 sts PC_MotortestActive,r24 |
1270 0ac8 00C0 rjmp .L144 |
1271 .L128: |
1272 0aca 8091 0000 lds r24,UebertragungAbgeschlossen |
1273 0ace 8823 tst r24 |
1274 0ad0 01F0 breq .L128 |
1275 0ad2 8DB7 in r24,__SP_L__ |
1276 0ad4 9EB7 in r25,__SP_H__ |
1277 0ad6 0797 sbiw r24,7 |
1278 0ad8 8DBF out __SP_L__,r24 |
1279 0ada EDB7 in r30,__SP_L__ |
1280 0adc FEB7 in r31,__SP_H__ |
1281 0ade 3196 adiw r30,1 |
1282 0ae0 8EE4 ldi r24,lo8(78) |
1283 0ae2 ADB7 in r26,__SP_L__ |
1284 0ae4 BEB7 in r27,__SP_H__ |
1285 0ae6 1196 adiw r26,1 |
1286 0ae8 8C93 st X,r24 |
1287 0aea 81E0 ldi r24,lo8(1) |
1288 0aec 8183 std Z+1,r24 |
1289 0aee 8283 std Z+2,r24 |
1290 0af0 80E0 ldi r24,lo8(Mixer) |
1291 0af2 90E0 ldi r25,hi8(Mixer) |
1292 0af4 9483 std Z+4,r25 |
1293 0af6 8383 std Z+3,r24 |
1294 0af8 8DE4 ldi r24,lo8(77) |
1295 0afa 90E0 ldi r25,hi8(77) |
1296 0afc 00C0 rjmp .L149 |
1297 .L65: |
1298 0afe E091 0000 lds r30,pRxData |
1299 0b02 F091 0000 lds r31,(pRxData)+1 |
1300 0b06 8081 ld r24,Z |
1301 0b08 8130 cpi r24,lo8(1) |
1302 0b0a 01F4 brne .L80 |
1303 0b0c A0E0 ldi r26,lo8(Mixer) |
1304 0b0e B0E0 ldi r27,hi8(Mixer) |
1305 0b10 8DE4 ldi r24,lo8(77) |
1306 .L81: |
1307 0b12 0190 ld r0,Z+ |
1308 0b14 0D92 st X+,r0 |
1309 0b16 8150 subi r24,lo8(-(-1)) |
1310 0b18 01F4 brne .L81 |
1311 0b1a 0E94 0000 call MixerTable_WriteToEEProm |
1312 0b1e 81E0 ldi r24,lo8(1) |
1313 0b20 8983 std Y+1,r24 |
1314 0b22 8091 0000 lds r24,VersionInfo+6 |
1315 0b26 8F7E andi r24,lo8(-17) |
1316 0b28 8093 0000 sts VersionInfo+6,r24 |
1317 0b2c 00C0 rjmp .L127 |
1318 .L80: |
1319 0b2e 1982 std Y+1,__zero_reg__ |
1320 .L127: |
1321 0b30 8091 0000 lds r24,UebertragungAbgeschlossen |
1322 0b34 8823 tst r24 |
1323 0b36 01F0 breq .L127 |
1324 0b38 8DB7 in r24,__SP_L__ |
1325 0b3a 9EB7 in r25,__SP_H__ |
1326 0b3c 0797 sbiw r24,7 |
1327 0b3e 8DBF out __SP_L__,r24 |
1328 0b40 EDB7 in r30,__SP_L__ |
1329 0b42 FEB7 in r31,__SP_H__ |
1330 0b44 3196 adiw r30,1 |
1331 0b46 8DE4 ldi r24,lo8(77) |
1332 0b48 ADB7 in r26,__SP_L__ |
1333 0b4a BEB7 in r27,__SP_H__ |
1334 0b4c 1196 adiw r26,1 |
1335 0b4e 8C93 st X,r24 |
1336 0b50 81E0 ldi r24,lo8(1) |
1337 0b52 8183 std Z+1,r24 |
1338 0b54 8283 std Z+2,r24 |
1339 0b56 CE01 movw r24,r28 |
1340 0b58 0196 adiw r24,1 |
1341 0b5a 9483 std Z+4,r25 |
1342 0b5c 8383 std Z+3,r24 |
1343 0b5e 81E0 ldi r24,lo8(1) |
1344 0b60 90E0 ldi r25,hi8(1) |
1345 .L149: |
1346 0b62 9683 std Z+6,r25 |
1347 0b64 8583 std Z+5,r24 |
1348 0b66 0E94 0000 call SendOutData |
1349 0b6a EDB7 in r30,__SP_L__ |
1350 0b6c FEB7 in r31,__SP_H__ |
1351 0b6e 3796 adiw r30,7 |
1352 0b70 00C0 rjmp .L145 |
1353 .L154: |
1354 0b72 81E0 ldi r24,lo8(1) |
1355 0b74 8093 0000 sts GetPPMChannelAnforderung,r24 |
1356 .L144: |
1357 0b78 8FEF ldi r24,lo8(-1) |
1358 0b7a 8093 0000 sts PcZugriff,r24 |
1359 0b7e 00C0 rjmp .L61 |
1360 .L68: |
1361 0b80 0091 0000 lds r16,pRxData |
1362 0b84 1091 0000 lds r17,(pRxData)+1 |
1363 0b88 D801 movw r26,r16 |
1364 0b8a 8C91 ld r24,X |
1365 0b8c 8F3F cpi r24,lo8(-1) |
1366 0b8e 01F4 brne .L83 |
1367 0b90 0E94 0000 call GetActiveParamSet |
1368 0b94 F801 movw r30,r16 |
1369 0b96 8083 st Z,r24 |
1370 .L83: |
1371 0b98 E091 0000 lds r30,pRxData |
1372 0b9c F091 0000 lds r31,(pRxData)+1 |
1373 0ba0 8081 ld r24,Z |
1374 0ba2 8823 tst r24 |
1375 0ba4 01F4 brne .L84 |
1376 0ba6 81E0 ldi r24,lo8(1) |
1377 0ba8 00C0 rjmp .L143 |
1378 .L84: |
1379 0baa 8630 cpi r24,lo8(6) |
1380 0bac 00F0 brlo .L85 |
1381 0bae 85E0 ldi r24,lo8(5) |
1382 .L143: |
1383 0bb0 8083 st Z,r24 |
1384 .L85: |
1385 0bb2 E091 0000 lds r30,pRxData |
1386 0bb6 F091 0000 lds r31,(pRxData)+1 |
1387 0bba 8081 ld r24,Z |
1388 0bbc 0E94 0000 call ParamSet_ReadFromEEProm |
1389 0bc0 E091 0000 lds r30,pRxData |
1390 0bc4 F091 0000 lds r31,(pRxData)+1 |
1391 0bc8 8081 ld r24,Z |
1392 0bca 8983 std Y+1,r24 |
1393 .L86: |
1394 0bcc 8091 0000 lds r24,UebertragungAbgeschlossen |
1395 0bd0 8823 tst r24 |
1396 0bd2 01F0 breq .L86 |
1397 0bd4 8DB7 in r24,__SP_L__ |
1398 0bd6 9EB7 in r25,__SP_H__ |
1399 0bd8 0B97 sbiw r24,11 |
1400 0bda 8DBF out __SP_L__,r24 |
1401 0bdc EDB7 in r30,__SP_L__ |
1402 0bde FEB7 in r31,__SP_H__ |
1403 0be0 3196 adiw r30,1 |
1404 0be2 81E5 ldi r24,lo8(81) |
1405 0be4 ADB7 in r26,__SP_L__ |
1406 0be6 BEB7 in r27,__SP_H__ |
1407 0be8 1196 adiw r26,1 |
1408 0bea 8C93 st X,r24 |
1409 0bec 81E0 ldi r24,lo8(1) |
1410 0bee 8183 std Z+1,r24 |
1411 0bf0 82E0 ldi r24,lo8(2) |
1412 0bf2 8283 std Z+2,r24 |
1413 0bf4 CE01 movw r24,r28 |
1414 0bf6 0196 adiw r24,1 |
1415 0bf8 9483 std Z+4,r25 |
1416 0bfa 8383 std Z+3,r24 |
1417 0bfc 81E0 ldi r24,lo8(1) |
1418 0bfe 90E0 ldi r25,hi8(1) |
1419 0c00 9683 std Z+6,r25 |
1420 0c02 8583 std Z+5,r24 |
1421 0c04 80E0 ldi r24,lo8(EE_Parameter) |
1422 0c06 90E0 ldi r25,hi8(EE_Parameter) |
1423 0c08 9087 std Z+8,r25 |
1424 0c0a 8783 std Z+7,r24 |
1425 0c0c 80E7 ldi r24,lo8(112) |
1426 0c0e 90E0 ldi r25,hi8(112) |
1427 0c10 9287 std Z+10,r25 |
1428 0c12 8187 std Z+9,r24 |
1429 0c14 00C0 rjmp .L150 |
1430 .L69: |
1431 0c16 E091 0000 lds r30,pRxData |
1432 0c1a F091 0000 lds r31,(pRxData)+1 |
1433 0c1e 8081 ld r24,Z |
1434 0c20 8150 subi r24,lo8(-(-1)) |
1435 0c22 8530 cpi r24,lo8(5) |
1436 0c24 00F4 brsh .L87 |
1437 0c26 8181 ldd r24,Z+1 |
1438 0c28 8435 cpi r24,lo8(84) |
1439 0c2a 01F4 brne .L87 |
1440 0c2c A0E0 ldi r26,lo8(EE_Parameter) |
1441 0c2e B0E0 ldi r27,hi8(EE_Parameter) |
1442 0c30 3196 adiw r30,1 |
1443 0c32 80E7 ldi r24,lo8(112) |
1444 .L88: |
1445 0c34 0190 ld r0,Z+ |
1446 0c36 0D92 st X+,r0 |
1447 0c38 8150 subi r24,lo8(-(-1)) |
1448 0c3a 01F4 brne .L88 |
1449 0c3c E091 0000 lds r30,pRxData |
1450 0c40 F091 0000 lds r31,(pRxData)+1 |
1451 0c44 8081 ld r24,Z |
1452 0c46 0E94 0000 call ParamSet_WriteToEEProm |
1453 0c4a 6091 0000 lds r22,EE_Parameter+63 |
1454 0c4e 70E0 ldi r23,lo8(0) |
1455 0c50 80E0 ldi r24,lo8(0) |
1456 0c52 90E0 ldi r25,hi8(0) |
1457 0c54 24EC ldi r18,lo8(2500) |
1458 0c56 39E0 ldi r19,hi8(2500) |
1459 0c58 40E0 ldi r20,hlo8(2500) |
1460 0c5a 50E0 ldi r21,hhi8(2500) |
1461 0c5c 0E94 0000 call __mulsi3 |
1462 0c60 6093 0000 sts Umschlag180Nick,r22 |
1463 0c64 7093 0000 sts (Umschlag180Nick)+1,r23 |
1464 0c68 8093 0000 sts (Umschlag180Nick)+2,r24 |
1465 0c6c 9093 0000 sts (Umschlag180Nick)+3,r25 |
1466 0c70 6091 0000 lds r22,EE_Parameter+64 |
1467 0c74 70E0 ldi r23,lo8(0) |
1468 0c76 80E0 ldi r24,lo8(0) |
1469 0c78 90E0 ldi r25,hi8(0) |
1470 0c7a 0E94 0000 call __mulsi3 |
1471 0c7e 6093 0000 sts Umschlag180Roll,r22 |
1472 0c82 7093 0000 sts (Umschlag180Roll)+1,r23 |
1473 0c86 8093 0000 sts (Umschlag180Roll)+2,r24 |
1474 0c8a 9093 0000 sts (Umschlag180Roll)+3,r25 |
1475 0c8e 0E94 0000 call GetActiveParamSet |
1476 0c92 8983 std Y+1,r24 |
1477 0c94 00C0 rjmp .L126 |
1478 .L87: |
1479 0c96 1982 std Y+1,__zero_reg__ |
1480 .L126: |
1481 0c98 8091 0000 lds r24,UebertragungAbgeschlossen |
1482 0c9c 8823 tst r24 |
1483 0c9e 01F0 breq .L126 |
1484 0ca0 8DB7 in r24,__SP_L__ |
1485 0ca2 9EB7 in r25,__SP_H__ |
1486 0ca4 0797 sbiw r24,7 |
1487 0ca6 8DBF out __SP_L__,r24 |
1488 0ca8 EDB7 in r30,__SP_L__ |
1489 0caa FEB7 in r31,__SP_H__ |
1490 0cac 3196 adiw r30,1 |
1491 0cae 83E5 ldi r24,lo8(83) |
1492 0cb0 00C0 rjmp .L152 |
1493 .L153: |
1494 0cb2 E091 0000 lds r30,pRxData |
1495 0cb6 F091 0000 lds r31,(pRxData)+1 |
1496 0cba E081 ld r30,Z |
1497 0cbc 8E2F mov r24,r30 |
1498 0cbe 8150 subi r24,lo8(-(-1)) |
1499 0cc0 8530 cpi r24,lo8(5) |
1500 0cc2 00F4 brsh .L91 |
1501 0cc4 8E2F mov r24,r30 |
1502 0cc6 0E94 0000 call ParamSet_ReadFromEEProm |
1503 .L91: |
1504 0cca 0E94 0000 call GetActiveParamSet |
1505 0cce 8983 std Y+1,r24 |
1506 .L92: |
1507 0cd0 8091 0000 lds r24,UebertragungAbgeschlossen |
1508 0cd4 8823 tst r24 |
1509 0cd6 01F0 breq .L92 |
1510 0cd8 8DB7 in r24,__SP_L__ |
1511 0cda 9EB7 in r25,__SP_H__ |
1512 0cdc 0797 sbiw r24,7 |
1513 0cde 8DBF out __SP_L__,r24 |
1514 0ce0 EDB7 in r30,__SP_L__ |
1515 0ce2 FEB7 in r31,__SP_H__ |
1516 0ce4 3196 adiw r30,1 |
1517 0ce6 86E4 ldi r24,lo8(70) |
1518 .L152: |
1519 0ce8 ADB7 in r26,__SP_L__ |
1520 0cea BEB7 in r27,__SP_H__ |
1521 0cec 1196 adiw r26,1 |
1522 0cee 8C93 st X,r24 |
1523 0cf0 81E0 ldi r24,lo8(1) |
1524 0cf2 8183 std Z+1,r24 |
1525 0cf4 8283 std Z+2,r24 |
1526 0cf6 CE01 movw r24,r28 |
1527 0cf8 0196 adiw r24,1 |
1528 0cfa 9483 std Z+4,r25 |
1529 0cfc 8383 std Z+3,r24 |
1530 0cfe 81E0 ldi r24,lo8(1) |
1531 0d00 90E0 ldi r25,hi8(1) |
1532 0d02 9683 std Z+6,r25 |
1533 0d04 8583 std Z+5,r24 |
1534 0d06 0E94 0000 call SendOutData |
1535 0d0a EDB7 in r30,__SP_L__ |
1536 0d0c FEB7 in r31,__SP_H__ |
1537 0d0e 3796 adiw r30,7 |
1538 0d10 EDBF out __SP_L__,r30 |
1539 0d12 8091 0000 lds r24,MotorenEin |
1540 0d16 8823 tst r24 |
1541 0d18 01F4 brne .L93 |
1542 0d1a 8981 ldd r24,Y+1 |
1543 0d1c 6EE6 ldi r22,lo8(110) |
1544 0d1e 70E0 ldi r23,hi8(110) |
1545 0d20 0E94 0000 call Piep |
1546 .L93: |
1547 0d24 80E0 ldi r24,lo8(0) |
1548 0d26 0E94 0000 call LipoDetection |
1549 0d2a 8091 0000 lds r24,EE_Parameter+39 |
1550 0d2e 0E94 0000 call LIBFC_ReceiverInit |
1551 0d32 00C0 rjmp .L61 |
1552 .L156: |
1553 0d34 E091 0000 lds r30,pRxData |
1554 0d38 F091 0000 lds r31,(pRxData)+1 |
1555 0d3c 8081 ld r24,Z |
1556 0d3e 9927 clr r25 |
1557 0d40 87FD sbrc r24,7 |
1558 0d42 9095 com r25 |
1559 0d44 9093 0000 sts (PPM_in+26)+1,r25 |
1560 0d48 8093 0000 sts PPM_in+26,r24 |
1561 0d4c 8181 ldd r24,Z+1 |
1562 0d4e 9927 clr r25 |
1563 0d50 87FD sbrc r24,7 |
1564 0d52 9095 com r25 |
1565 0d54 9093 0000 sts (PPM_in+28)+1,r25 |
1566 0d58 8093 0000 sts PPM_in+28,r24 |
1567 0d5c 8281 ldd r24,Z+2 |
1568 0d5e 9927 clr r25 |
1569 0d60 87FD sbrc r24,7 |
1570 0d62 9095 com r25 |
1571 0d64 9093 0000 sts (PPM_in+30)+1,r25 |
1572 0d68 8093 0000 sts PPM_in+30,r24 |
1573 0d6c 8381 ldd r24,Z+3 |
1574 0d6e 9927 clr r25 |
1575 0d70 87FD sbrc r24,7 |
1576 0d72 9095 com r25 |
1577 0d74 9093 0000 sts (PPM_in+32)+1,r25 |
1578 0d78 8093 0000 sts PPM_in+32,r24 |
1579 0d7c 8481 ldd r24,Z+4 |
1580 0d7e 9927 clr r25 |
1581 0d80 87FD sbrc r24,7 |
1582 0d82 9095 com r25 |
1583 0d84 9093 0000 sts (PPM_in+34)+1,r25 |
1584 0d88 8093 0000 sts PPM_in+34,r24 |
1585 0d8c 8581 ldd r24,Z+5 |
1586 0d8e 9927 clr r25 |
1587 0d90 87FD sbrc r24,7 |
1588 0d92 9095 com r25 |
1589 0d94 9093 0000 sts (PPM_in+36)+1,r25 |
1590 0d98 8093 0000 sts PPM_in+36,r24 |
1591 0d9c 8681 ldd r24,Z+6 |
1592 0d9e 9927 clr r25 |
1593 0da0 87FD sbrc r24,7 |
1594 0da2 9095 com r25 |
1595 0da4 9093 0000 sts (PPM_in+38)+1,r25 |
1596 0da8 8093 0000 sts PPM_in+38,r24 |
1597 0dac 8781 ldd r24,Z+7 |
1598 0dae 9927 clr r25 |
1599 0db0 87FD sbrc r24,7 |
1600 0db2 9095 com r25 |
1601 0db4 9093 0000 sts (PPM_in+40)+1,r25 |
1602 0db8 8093 0000 sts PPM_in+40,r24 |
1603 0dbc 8085 ldd r24,Z+8 |
1604 0dbe 9927 clr r25 |
1605 0dc0 87FD sbrc r24,7 |
1606 0dc2 9095 com r25 |
1607 0dc4 9093 0000 sts (PPM_in+42)+1,r25 |
1608 0dc8 8093 0000 sts PPM_in+42,r24 |
1609 0dcc 8185 ldd r24,Z+9 |
1610 0dce 9927 clr r25 |
1611 0dd0 87FD sbrc r24,7 |
1612 0dd2 9095 com r25 |
1613 0dd4 9093 0000 sts (PPM_in+44)+1,r25 |
1614 0dd8 8093 0000 sts PPM_in+44,r24 |
1615 0ddc 8285 ldd r24,Z+10 |
1616 0dde 9927 clr r25 |
1617 0de0 87FD sbrc r24,7 |
1618 0de2 9095 com r25 |
1619 0de4 9093 0000 sts (PPM_in+46)+1,r25 |
1620 0de8 8093 0000 sts PPM_in+46,r24 |
1621 0dec 8385 ldd r24,Z+11 |
1622 0dee 9927 clr r25 |
1623 0df0 87FD sbrc r24,7 |
1624 0df2 9095 com r25 |
1625 0df4 9093 0000 sts (PPM_in+48)+1,r25 |
1626 0df8 8093 0000 sts PPM_in+48,r24 |
1627 0dfc 00C0 rjmp .L61 |
1628 .L71: |
1629 0dfe E091 0000 lds r30,pRxData |
1630 0e02 F091 0000 lds r31,(pRxData)+1 |
1631 0e06 8081 ld r24,Z |
1632 0e08 0E94 0000 call I2C_ReadBLConfig |
1633 0e0c 8A83 std Y+2,r24 |
1634 0e0e 8823 tst r24 |
1635 0e10 01F4 brne .L94 |
1636 0e12 81E0 ldi r24,lo8(1) |
1637 0e14 8983 std Y+1,r24 |
1638 0e16 00C0 rjmp .L124 |
1639 .L94: |
1640 0e18 1982 std Y+1,__zero_reg__ |
1641 .L124: |
1642 0e1a 8091 0000 lds r24,UebertragungAbgeschlossen |
1643 0e1e 8823 tst r24 |
1644 0e20 01F0 breq .L124 |
1645 0e22 8DB7 in r24,__SP_L__ |
1646 0e24 9EB7 in r25,__SP_H__ |
1647 0e26 4397 sbiw r24,19 |
1648 0e28 8DBF out __SP_L__,r24 |
1649 0e2a EDB7 in r30,__SP_L__ |
1650 0e2c FEB7 in r31,__SP_H__ |
1651 0e2e 3196 adiw r30,1 |
1652 0e30 85E5 ldi r24,lo8(85) |
1653 0e32 ADB7 in r26,__SP_L__ |
1654 0e34 BEB7 in r27,__SP_H__ |
1655 0e36 1196 adiw r26,1 |
1656 0e38 8C93 st X,r24 |
1657 0e3a 81E0 ldi r24,lo8(1) |
1658 0e3c 8183 std Z+1,r24 |
1659 0e3e 84E0 ldi r24,lo8(4) |
1660 0e40 8283 std Z+2,r24 |
1661 0e42 CE01 movw r24,r28 |
1662 0e44 0196 adiw r24,1 |
1663 0e46 9483 std Z+4,r25 |
1664 0e48 8383 std Z+3,r24 |
1665 0e4a 21E0 ldi r18,lo8(1) |
1666 0e4c 30E0 ldi r19,hi8(1) |
1667 0e4e 3683 std Z+6,r19 |
1668 0e50 2583 std Z+5,r18 |
1669 0e52 CE01 movw r24,r28 |
1670 0e54 0296 adiw r24,2 |
1671 0e56 9087 std Z+8,r25 |
1672 0e58 8783 std Z+7,r24 |
1673 0e5a 3287 std Z+10,r19 |
1674 0e5c 2187 std Z+9,r18 |
1675 0e5e 8091 0000 lds r24,pRxData |
1676 0e62 9091 0000 lds r25,(pRxData)+1 |
1677 0e66 9487 std Z+12,r25 |
1678 0e68 8387 std Z+11,r24 |
1679 0e6a 3687 std Z+14,r19 |
1680 0e6c 2587 std Z+13,r18 |
1681 0e6e 80E0 ldi r24,lo8(BLConfig) |
1682 0e70 90E0 ldi r25,hi8(BLConfig) |
1683 0e72 908B std Z+16,r25 |
1684 0e74 8787 std Z+15,r24 |
1685 0e76 88E0 ldi r24,lo8(8) |
1686 0e78 90E0 ldi r25,hi8(8) |
1687 0e7a 928B std Z+18,r25 |
1688 0e7c 818B std Z+17,r24 |
1689 0e7e 0E94 0000 call SendOutData |
1690 0e82 EDB7 in r30,__SP_L__ |
1691 0e84 FEB7 in r31,__SP_H__ |
1692 0e86 7396 adiw r30,19 |
1693 0e88 00C0 rjmp .L145 |
1694 .L72: |
1695 0e8a 8091 0000 lds r24,RxDataLen |
1696 0e8e 8930 cpi r24,lo8(9) |
1697 0e90 00F4 brsh .+2 |
1698 0e92 00C0 rjmp .L61 |
1699 0e94 E091 0000 lds r30,pRxData |
1700 0e98 F091 0000 lds r31,(pRxData)+1 |
1701 0e9c A0E0 ldi r26,lo8(BLConfig) |
1702 0e9e B0E0 ldi r27,hi8(BLConfig) |
1703 0ea0 3196 adiw r30,1 |
1704 0ea2 88E0 ldi r24,lo8(8) |
1705 .L96: |
1706 0ea4 0190 ld r0,Z+ |
1707 0ea6 0D92 st X+,r0 |
1708 0ea8 8150 subi r24,lo8(-(-1)) |
1709 0eaa 01F4 brne .L96 |
1710 0eac E091 0000 lds r30,pRxData |
1711 0eb0 F091 0000 lds r31,(pRxData)+1 |
1712 0eb4 8081 ld r24,Z |
1713 0eb6 0E94 0000 call I2C_WriteBLConfig |
1714 0eba 8A83 std Y+2,r24 |
1715 0ebc 8823 tst r24 |
1716 0ebe 01F4 brne .L97 |
1717 0ec0 81E0 ldi r24,lo8(1) |
1718 0ec2 8983 std Y+1,r24 |
1719 0ec4 00C0 rjmp .L125 |
1720 .L97: |
1721 0ec6 1982 std Y+1,__zero_reg__ |
1722 .L125: |
1723 0ec8 8091 0000 lds r24,UebertragungAbgeschlossen |
1724 0ecc 8823 tst r24 |
1725 0ece 01F0 breq .L125 |
1726 0ed0 8DB7 in r24,__SP_L__ |
1727 0ed2 9EB7 in r25,__SP_H__ |
1728 0ed4 0B97 sbiw r24,11 |
1729 0ed6 8DBF out __SP_L__,r24 |
1730 0ed8 EDB7 in r30,__SP_L__ |
1731 0eda FEB7 in r31,__SP_H__ |
1732 0edc 3196 adiw r30,1 |
1733 0ede 87E5 ldi r24,lo8(87) |
1734 0ee0 ADB7 in r26,__SP_L__ |
1735 0ee2 BEB7 in r27,__SP_H__ |
1736 0ee4 1196 adiw r26,1 |
1737 0ee6 8C93 st X,r24 |
1738 0ee8 81E0 ldi r24,lo8(1) |
1739 0eea 8183 std Z+1,r24 |
1740 0eec 82E0 ldi r24,lo8(2) |
1741 0eee 8283 std Z+2,r24 |
1742 0ef0 CE01 movw r24,r28 |
1743 0ef2 0196 adiw r24,1 |
1744 0ef4 9483 std Z+4,r25 |
1745 0ef6 8383 std Z+3,r24 |
1746 0ef8 21E0 ldi r18,lo8(1) |
1747 0efa 30E0 ldi r19,hi8(1) |
1748 0efc 3683 std Z+6,r19 |
1749 0efe 2583 std Z+5,r18 |
1750 0f00 CE01 movw r24,r28 |
1751 0f02 0296 adiw r24,2 |
1752 0f04 9087 std Z+8,r25 |
1753 0f06 8783 std Z+7,r24 |
1754 0f08 3287 std Z+10,r19 |
1755 0f0a 2187 std Z+9,r18 |
1756 .L150: |
1757 0f0c 0E94 0000 call SendOutData |
1758 0f10 EDB7 in r30,__SP_L__ |
1759 0f12 FEB7 in r31,__SP_H__ |
1760 0f14 3B96 adiw r30,11 |
1761 .L145: |
1762 0f16 EDBF out __SP_L__,r30 |
1763 .L61: |
1764 0f18 8091 0000 lds r24,RxdBuffer+2 |
1765 0f1c 8436 cpi r24,lo8(100) |
1766 0f1e 01F4 brne .+2 |
1767 0f20 00C0 rjmp .L104 |
1768 0f22 8536 cpi r24,lo8(101) |
1769 0f24 00F4 brsh .L110 |
1770 0f26 8136 cpi r24,lo8(97) |
1771 0f28 01F4 brne .+2 |
1772 0f2a 00C0 rjmp .L101 |
1773 0f2c 8236 cpi r24,lo8(98) |
1774 0f2e 00F4 brsh .L111 |
1775 0f30 8B34 cpi r24,lo8(75) |
1776 0f32 01F0 breq .+2 |
1777 0f34 00C0 rjmp .L99 |
1778 0f36 00C0 rjmp .L157 |
1779 .L111: |
1780 0f38 8236 cpi r24,lo8(98) |
1781 0f3a 01F4 brne .+2 |
1782 0f3c 00C0 rjmp .L102 |
1783 0f3e 8336 cpi r24,lo8(99) |
1784 0f40 01F0 breq .+2 |
1785 0f42 00C0 rjmp .L99 |
1786 0f44 00C0 rjmp .L158 |
1787 .L110: |
1788 0f46 8C36 cpi r24,lo8(108) |
1789 0f48 01F4 brne .+2 |
1790 0f4a 00C0 rjmp .L107 |
1791 0f4c 8D36 cpi r24,lo8(109) |
1792 0f4e 00F4 brsh .L112 |
1793 0f50 8736 cpi r24,lo8(103) |
1794 0f52 01F4 brne .+2 |
1795 0f54 00C0 rjmp .L105 |
1796 0f56 8836 cpi r24,lo8(104) |
1797 0f58 01F0 breq .+2 |
1798 0f5a 00C0 rjmp .L99 |
1799 0f5c 00C0 rjmp .L159 |
1800 .L112: |
1801 0f5e 8437 cpi r24,lo8(116) |
1802 0f60 01F0 breq .L108 |
1803 0f62 8637 cpi r24,lo8(118) |
1804 0f64 01F0 breq .+2 |
1805 0f66 00C0 rjmp .L99 |
1806 0f68 00C0 rjmp .L160 |
1807 .L108: |
1808 0f6a 8091 0000 lds r24,AnzahlEmpfangsBytes |
1809 0f6e 8031 cpi r24,lo8(16) |
1810 0f70 00F0 brlo .L113 |
1811 0f72 A0E0 ldi r26,lo8(MotorTest) |
1812 0f74 B0E0 ldi r27,hi8(MotorTest) |
1813 0f76 8091 0000 lds r24,pRxData |
1814 0f7a 9091 0000 lds r25,pRxData+1 |
1815 0f7e 9C01 movw r18,r24 |
1816 0f80 F901 movw r30,r18 |
1817 0f82 80E1 ldi r24,lo8(16) |
1818 .L114: |
1819 0f84 0190 ld r0,Z+ |
1820 0f86 0D92 st X+,r0 |
1821 0f88 8150 subi r24,lo8(-(-1)) |
1822 0f8a 01F4 brne .L114 |
1823 0f8c 00C0 rjmp .L123 |
1824 .L113: |
1825 0f8e E091 0000 lds r30,pRxData |
1826 0f92 F091 0000 lds r31,(pRxData)+1 |
1827 0f96 8081 ld r24,Z |
1828 0f98 9181 ldd r25,Z+1 |
1829 0f9a A281 ldd r26,Z+2 |
1830 0f9c B381 ldd r27,Z+3 |
1831 0f9e 8093 0000 sts MotorTest,r24 |
1832 0fa2 9093 0000 sts (MotorTest)+1,r25 |
1833 0fa6 A093 0000 sts (MotorTest)+2,r26 |
1834 0faa B093 0000 sts (MotorTest)+3,r27 |
1835 .L123: |
1836 0fae 8091 0000 lds r24,UebertragungAbgeschlossen |
1837 0fb2 8823 tst r24 |
1838 0fb4 01F0 breq .L123 |
1839 0fb6 00D0 rcall . |
1840 0fb8 0F92 push __tmp_reg__ |
1841 0fba EDB7 in r30,__SP_L__ |
1842 0fbc FEB7 in r31,__SP_H__ |
1843 0fbe 3196 adiw r30,1 |
1844 0fc0 84E5 ldi r24,lo8(84) |
1845 0fc2 ADB7 in r26,__SP_L__ |
1846 0fc4 BEB7 in r27,__SP_H__ |
1847 0fc6 1196 adiw r26,1 |
1848 0fc8 8C93 st X,r24 |
1849 0fca 8091 0000 lds r24,MeineSlaveAdresse |
1850 0fce 8183 std Z+1,r24 |
1851 0fd0 1282 std Z+2,__zero_reg__ |
1852 0fd2 0E94 0000 call SendOutData |
1853 0fd6 8AEF ldi r24,lo8(-6) |
1854 0fd8 8093 0000 sts PC_MotortestActive,r24 |
1855 0fdc 8FEF ldi r24,lo8(-1) |
1856 0fde 8093 0000 sts PcZugriff,r24 |
1857 0fe2 0F90 pop __tmp_reg__ |
1858 0fe4 0F90 pop __tmp_reg__ |
1859 0fe6 0F90 pop __tmp_reg__ |
1860 0fe8 00C0 rjmp .L146 |
1861 .L157: |
1862 0fea E091 0000 lds r30,pRxData |
1863 0fee F091 0000 lds r31,(pRxData)+1 |
1864 0ff2 8081 ld r24,Z |
1865 0ff4 9181 ldd r25,Z+1 |
1866 0ff6 9093 0000 sts (KompassValue)+1,r25 |
1867 0ffa 8093 0000 sts KompassValue,r24 |
1868 0ffe 845E subi r24,lo8(-(540)) |
1869 1000 9D4F sbci r25,hi8(-(540)) |
1870 1002 2091 0000 lds r18,KompassStartwert |
1871 1006 3091 0000 lds r19,(KompassStartwert)+1 |
1872 100a 821B sub r24,r18 |
1873 100c 930B sbc r25,r19 |
1874 100e 68E6 ldi r22,lo8(360) |
1875 1010 71E0 ldi r23,hi8(360) |
1876 1012 0E94 0000 call __divmodhi4 |
1877 1016 845B subi r24,lo8(-(-180)) |
1878 1018 9040 sbci r25,hi8(-(-180)) |
1879 101a 9093 0000 sts (KompassRichtung)+1,r25 |
1880 101e 8093 0000 sts KompassRichtung,r24 |
1881 1022 00C0 rjmp .L99 |
1882 .L101: |
1883 1024 E091 0000 lds r30,pRxData |
1884 1028 F091 0000 lds r31,(pRxData)+1 |
1885 102c 8081 ld r24,Z |
1886 102e 8093 0000 sts DebugTextAnforderung,r24 |
1887 1032 8032 cpi r24,lo8(32) |
1888 1034 00F0 brlo .L147 |
1889 1036 8FE1 ldi r24,lo8(31) |
1890 1038 8093 0000 sts DebugTextAnforderung,r24 |
1891 103c 00C0 rjmp .L147 |
1892 .L102: |
1893 103e A0E0 ldi r26,lo8(ExternControl) |
1894 1040 B0E0 ldi r27,hi8(ExternControl) |
1895 1042 8091 0000 lds r24,pRxData |
1896 1046 9091 0000 lds r25,pRxData+1 |
1897 104a 9C01 movw r18,r24 |
1898 104c F901 movw r30,r18 |
1899 104e 8BE0 ldi r24,lo8(11) |
1900 .L117: |
1901 1050 0190 ld r0,Z+ |
1902 1052 0D92 st X+,r0 |
1903 1054 8150 subi r24,lo8(-(-1)) |
1904 1056 01F4 brne .L117 |
1905 1058 8091 0000 lds r24,ExternControl+9 |
1906 105c 8093 0000 sts ConfirmFrame,r24 |
1907 .L147: |
1908 1060 8FEF ldi r24,lo8(-1) |
1909 1062 8093 0000 sts PcZugriff,r24 |
1910 1066 00C0 rjmp .L99 |
1911 .L158: |
1912 1068 8091 0000 lds r24,Intervall3D |
1913 106c 9091 0000 lds r25,(Intervall3D)+1 |
1914 1070 892B or r24,r25 |
1915 1072 01F4 brne .L118 |
1916 1074 E091 0000 lds r30,pRxData |
1917 1078 F091 0000 lds r31,(pRxData)+1 |
1918 107c E081 ld r30,Z |
1919 107e EE23 tst r30 |
1920 1080 01F0 breq .L118 |
1921 1082 8AE0 ldi r24,lo8(10) |
1922 1084 E89F mul r30,r24 |
1923 1086 C001 movw r24,r0 |
1924 1088 1124 clr r1 |
1925 108a 0E94 0000 call SetDelay |
1926 108e 9093 0000 sts (Timer3D)+1,r25 |
1927 1092 8093 0000 sts Timer3D,r24 |
1928 .L118: |
1929 1096 E091 0000 lds r30,pRxData |
1930 109a F091 0000 lds r31,(pRxData)+1 |
1931 109e 8081 ld r24,Z |
1932 10a0 2AE0 ldi r18,lo8(10) |
1933 10a2 829F mul r24,r18 |
1934 10a4 C001 movw r24,r0 |
1935 10a6 1124 clr r1 |
1936 10a8 9093 0000 sts (Intervall3D)+1,r25 |
1937 10ac 8093 0000 sts Intervall3D,r24 |
1938 .L146: |
1939 10b0 80EA ldi r24,lo8(4000) |
1940 10b2 9FE0 ldi r25,hi8(4000) |
1941 10b4 0E94 0000 call SetDelay |
1942 10b8 9093 0000 sts (AboTimeOut)+1,r25 |
1943 10bc 8093 0000 sts AboTimeOut,r24 |
1944 10c0 00C0 rjmp .L99 |
1945 .L104: |
1946 10c2 8FEF ldi r24,lo8(-1) |
1947 10c4 8093 0000 sts PcZugriff,r24 |
1948 10c8 E091 0000 lds r30,pRxData |
1949 10cc F091 0000 lds r31,(pRxData)+1 |
1950 10d0 8081 ld r24,Z |
1951 10d2 2AE0 ldi r18,lo8(10) |
1952 10d4 829F mul r24,r18 |
1953 10d6 C001 movw r24,r0 |
1954 10d8 1124 clr r1 |
1955 10da 9093 0000 sts (DebugDataIntervall)+1,r25 |
1956 10de 8093 0000 sts DebugDataIntervall,r24 |
1957 10e2 892B or r24,r25 |
1958 10e4 01F0 breq .L146 |
1959 10e6 81E0 ldi r24,lo8(1) |
1960 10e8 8093 0000 sts DebugDataAnforderung,r24 |
1961 10ec 00C0 rjmp .L146 |
1962 .L159: |
1963 10ee 8FEF ldi r24,lo8(-1) |
1964 10f0 8093 0000 sts PcZugriff,r24 |
1965 10f4 E091 0000 lds r30,pRxData |
1966 10f8 F091 0000 lds r31,(pRxData)+1 |
1967 10fc 9081 ld r25,Z |
1968 10fe 97FD sbrc r25,7 |
1969 1100 00C0 rjmp .L120 |
1970 1102 82E0 ldi r24,lo8(2) |
1971 1104 8093 0000 sts DisplayLine,r24 |
1972 1108 1092 0000 sts (Display_Interval)+1,__zero_reg__ |
1973 110c 1092 0000 sts Display_Interval,__zero_reg__ |
1974 1110 00C0 rjmp .L121 |
1975 .L120: |
1976 1112 9095 com r25 |
1977 1114 8091 0000 lds r24,RemoteKeys |
1978 1118 892B or r24,r25 |
1979 111a 8093 0000 sts RemoteKeys,r24 |
1980 111e 8181 ldd r24,Z+1 |
1981 1120 2AE0 ldi r18,lo8(10) |
1982 1122 829F mul r24,r18 |
1983 1124 C001 movw r24,r0 |
1984 1126 1124 clr r1 |
1985 1128 9093 0000 sts (Display_Interval)+1,r25 |
1986 112c 8093 0000 sts Display_Interval,r24 |
1987 1130 84E0 ldi r24,lo8(4) |
1988 1132 8093 0000 sts DisplayLine,r24 |
1989 1136 80EA ldi r24,lo8(4000) |
1990 1138 9FE0 ldi r25,hi8(4000) |
1991 113a 0E94 0000 call SetDelay |
1992 113e 9093 0000 sts (AboTimeOut)+1,r25 |
1993 1142 8093 0000 sts AboTimeOut,r24 |
1994 .L121: |
1995 1146 81E0 ldi r24,lo8(1) |
1996 1148 8093 0000 sts DebugDisplayAnforderung,r24 |
1997 114c 00C0 rjmp .L99 |
1998 .L107: |
1999 114e 8FEF ldi r24,lo8(-1) |
2000 1150 8093 0000 sts PcZugriff,r24 |
2001 1154 E091 0000 lds r30,pRxData |
2002 1158 F091 0000 lds r31,(pRxData)+1 |
2003 115c 8081 ld r24,Z |
2004 115e 8093 0000 sts MenuePunkt,r24 |
2005 1162 81E0 ldi r24,lo8(1) |
2006 1164 8093 0000 sts DebugDisplayAnforderung1,r24 |
2007 1168 00C0 rjmp .L99 |
2008 .L160: |
2009 116a 81E0 ldi r24,lo8(1) |
2010 116c 8093 0000 sts GetVersionAnforderung,r24 |
2011 1170 00C0 rjmp .L99 |
2012 .L105: |
2013 1172 81E0 ldi r24,lo8(1) |
2014 1174 8093 0000 sts GetExternalControl,r24 |
2015 .L99: |
2016 1178 1092 0000 sts NeuerDatensatzEmpfangen,__zero_reg__ |
2017 117c 1092 0000 sts (pRxData)+1,__zero_reg__ |
2018 1180 1092 0000 sts pRxData,__zero_reg__ |
2019 1184 1092 0000 sts RxDataLen,__zero_reg__ |
2020 .L122: |
2021 /* epilogue start */ |
2022 1188 2296 adiw r28,2 |
2023 118a E4E0 ldi r30, lo8(4) |
2024 118c 0C94 0000 jmp __epilogue_restores__ + ((18 - 4) * 2) |
2026 .global __vector_20 |
2028 __vector_20: |
2029 1190 1F92 push __zero_reg__ |
2030 1192 0F92 push r0 |
2031 1194 0FB6 in r0,__SREG__ |
2032 1196 0F92 push r0 |
2033 1198 1124 clr __zero_reg__ |
2034 119a 2F93 push r18 |
2035 119c 3F93 push r19 |
2036 119e 4F93 push r20 |
2037 11a0 5F93 push r21 |
2038 11a2 6F93 push r22 |
2039 11a4 7F93 push r23 |
2040 11a6 8F93 push r24 |
2041 11a8 9F93 push r25 |
2042 11aa AF93 push r26 |
2043 11ac BF93 push r27 |
2044 11ae CF93 push r28 |
2045 11b0 DF93 push r29 |
2046 11b2 EF93 push r30 |
2047 11b4 FF93 push r31 |
2048 /* prologue: Signal */ |
2049 /* frame size = 0 */ |
2050 11b6 8091 C600 lds r24,198 |
2051 11ba 8093 0000 sts SioTmp,r24 |
2052 11be 4091 0000 lds r20,buf_ptr.2283 |
2053 11c2 403A cpi r20,lo8(-96) |
2054 11c4 00F0 brlo .L162 |
2055 11c6 1092 0000 sts UartState.2284,__zero_reg__ |
2056 .L162: |
2057 11ca 8091 0000 lds r24,SioTmp |
2058 11ce 8D30 cpi r24,lo8(13) |
2059 11d0 01F0 breq .+2 |
2060 11d2 00C0 rjmp .L163 |
2061 11d4 8091 0000 lds r24,UartState.2284 |
2062 11d8 8230 cpi r24,lo8(2) |
2063 11da 01F0 breq .+2 |
2064 11dc 00C0 rjmp .L163 |
2065 11de 1092 0000 sts UartState.2284,__zero_reg__ |
2066 11e2 A42F mov r26,r20 |
2067 11e4 B0E0 ldi r27,lo8(0) |
2068 11e6 FD01 movw r30,r26 |
2069 11e8 E050 subi r30,lo8(-(RxdBuffer-2)) |
2070 11ea F040 sbci r31,hi8(-(RxdBuffer-2)) |
2071 11ec 3081 ld r19,Z |
2072 11ee ED01 movw r28,r26 |
2073 11f0 C050 subi r28,lo8(-(RxdBuffer-1)) |
2074 11f2 D040 sbci r29,hi8(-(RxdBuffer-1)) |
2075 11f4 2881 ld r18,Y |
2076 11f6 8091 0000 lds r24,crc.2280 |
2077 11fa 9091 0000 lds r25,(crc.2280)+1 |
2078 11fe 831B sub r24,r19 |
2079 1200 9109 sbc r25,__zero_reg__ |
2080 1202 821B sub r24,r18 |
2081 1204 9109 sbc r25,__zero_reg__ |
2082 1206 9F70 andi r25,hi8(4095) |
2083 1208 9093 0000 sts (crc.2280)+1,r25 |
2084 120c 8093 0000 sts crc.2280,r24 |
2085 1210 9C01 movw r18,r24 |
2086 1212 76E0 ldi r23,6 |
2087 1214 3695 1: lsr r19 |
2088 1216 2795 ror r18 |
2089 1218 7A95 dec r23 |
2090 121a 01F4 brne 1b |
2091 121c 235C subi r18,lo8(-(61)) |
2092 121e 2093 0000 sts crc1.2281,r18 |
2093 1222 982F mov r25,r24 |
2094 1224 9F73 andi r25,lo8(63) |
2095 1226 935C subi r25,lo8(-(61)) |
2096 1228 9093 0000 sts crc2.2282,r25 |
2097 122c 8081 ld r24,Z |
2098 122e 2817 cp r18,r24 |
2099 1230 01F4 brne .L164 |
2100 1232 8881 ld r24,Y |
2101 1234 9817 cp r25,r24 |
2102 1236 01F4 brne .L164 |
2103 1238 91E0 ldi r25,lo8(1) |
2104 123a 00C0 rjmp .L165 |
2105 .L164: |
2106 123c 8091 0000 lds r24,CntCrcError |
2107 1240 8F5F subi r24,lo8(-(1)) |
2108 1242 8093 0000 sts CntCrcError,r24 |
2109 1246 90E0 ldi r25,lo8(0) |
2110 .L165: |
2111 1248 8091 0000 lds r24,NeuerDatensatzEmpfangen |
2112 124c 8823 tst r24 |
2113 124e 01F0 breq .+2 |
2114 1250 00C0 rjmp .L174 |
2115 1252 9923 tst r25 |
2116 1254 01F4 brne .+2 |
2117 1256 00C0 rjmp .L174 |
2118 1258 81E0 ldi r24,lo8(1) |
2119 125a 8093 0000 sts NeuerDatensatzEmpfangen,r24 |
2120 125e 4F5F subi r20,lo8(-(1)) |
2121 1260 4093 0000 sts AnzahlEmpfangsBytes,r20 |
2122 1264 A050 subi r26,lo8(-(RxdBuffer)) |
2123 1266 B040 sbci r27,hi8(-(RxdBuffer)) |
2124 1268 8DE0 ldi r24,lo8(13) |
2125 126a 8C93 st X,r24 |
2126 126c 8091 0000 lds r24,RxdBuffer+2 |
2127 1270 8235 cpi r24,lo8(82) |
2128 1272 01F0 breq .+2 |
2129 1274 00C0 rjmp .L174 |
2130 1276 0E94 0000 call LcdClear |
2131 127a 2CE0 ldi r18,lo8(12) |
2132 127c 88E1 ldi r24,lo8(24) |
2133 127e 90E0 ldi r25,hi8(24) |
2134 /* #APP */ |
2135 ; 171 "uart.c" 1 |
2136 1280 0FB6 in __tmp_reg__,__SREG__ |
2137 1282 F894 cli |
2138 1284 A895 wdr |
2139 1286 8093 6000 sts 96,r24 |
2140 128a 0FBE out __SREG__,__tmp_reg__ |
2141 128c 2093 6000 sts 96,r18 |
2142 |
2143 ; 0 "" 2 |
2144 /* #NOAPP */ |
2145 1290 1092 0000 sts ServoActive,__zero_reg__ |
2146 1294 00C0 rjmp .L174 |
2147 .L163: |
2148 1296 8091 0000 lds r24,UartState.2284 |
2149 129a 8130 cpi r24,lo8(1) |
2150 129c 01F0 breq .L169 |
2151 129e 8130 cpi r24,lo8(1) |
2152 12a0 00F0 brlo .L168 |
2153 12a2 8230 cpi r24,lo8(2) |
2154 12a4 01F0 breq .+2 |
2155 12a6 00C0 rjmp .L175 |
2156 12a8 00C0 rjmp .L177 |
2157 .L168: |
2158 12aa 8091 0000 lds r24,SioTmp |
2159 12ae 8332 cpi r24,lo8(35) |
2160 12b0 01F4 brne .L171 |
2161 12b2 8091 0000 lds r24,NeuerDatensatzEmpfangen |
2162 12b6 8823 tst r24 |
2163 12b8 01F4 brne .L171 |
2164 12ba 81E0 ldi r24,lo8(1) |
2165 12bc 8093 0000 sts UartState.2284,r24 |
2166 .L171: |
2167 12c0 8091 0000 lds r24,SioTmp |
2168 12c4 8093 0000 sts RxdBuffer,r24 |
2169 12c8 81E0 ldi r24,lo8(1) |
2170 12ca 8093 0000 sts buf_ptr.2283,r24 |
2171 12ce 8091 0000 lds r24,SioTmp |
2172 12d2 8093 0000 sts crc.2280,r24 |
2173 12d6 1092 0000 sts crc.2280+1,__zero_reg__ |
2174 12da 00C0 rjmp .L174 |
2175 .L169: |
2176 12dc 82E0 ldi r24,lo8(2) |
2177 12de 8093 0000 sts UartState.2284,r24 |
2178 12e2 E42F mov r30,r20 |
2179 12e4 F0E0 ldi r31,lo8(0) |
2180 12e6 8091 0000 lds r24,SioTmp |
2181 12ea E050 subi r30,lo8(-(RxdBuffer)) |
2182 12ec F040 sbci r31,hi8(-(RxdBuffer)) |
2183 12ee 8083 st Z,r24 |
2184 12f0 00C0 rjmp .L176 |
2185 .L177: |
2186 12f2 E42F mov r30,r20 |
2187 12f4 F0E0 ldi r31,lo8(0) |
2188 12f6 8091 0000 lds r24,SioTmp |
2189 12fa E050 subi r30,lo8(-(RxdBuffer)) |
2190 12fc F040 sbci r31,hi8(-(RxdBuffer)) |
2191 12fe 8083 st Z,r24 |
2192 1300 403A cpi r20,lo8(-96) |
2193 1302 00F4 brsh .L172 |
2194 .L176: |
2195 1304 4F5F subi r20,lo8(-(1)) |
2196 1306 4093 0000 sts buf_ptr.2283,r20 |
2197 130a 00C0 rjmp .L173 |
2198 .L172: |
2199 130c 1092 0000 sts UartState.2284,__zero_reg__ |
2200 .L173: |
2201 1310 2091 0000 lds r18,SioTmp |
2202 1314 8091 0000 lds r24,crc.2280 |
2203 1318 9091 0000 lds r25,(crc.2280)+1 |
2204 131c 820F add r24,r18 |
2205 131e 911D adc r25,__zero_reg__ |
2206 1320 9093 0000 sts (crc.2280)+1,r25 |
2207 1324 8093 0000 sts crc.2280,r24 |
2208 1328 00C0 rjmp .L174 |
2209 .L175: |
2210 132a 1092 0000 sts UartState.2284,__zero_reg__ |
2211 .L174: |
2212 /* epilogue start */ |
2213 132e FF91 pop r31 |
2214 1330 EF91 pop r30 |
2215 1332 DF91 pop r29 |
2216 1334 CF91 pop r28 |
2217 1336 BF91 pop r27 |
2218 1338 AF91 pop r26 |
2219 133a 9F91 pop r25 |
2220 133c 8F91 pop r24 |
2221 133e 7F91 pop r23 |
2222 1340 6F91 pop r22 |
2223 1342 5F91 pop r21 |
2224 1344 4F91 pop r20 |
2225 1346 3F91 pop r19 |
2226 1348 2F91 pop r18 |
2227 134a 0F90 pop r0 |
2228 134c 0FBE out __SREG__,r0 |
2229 134e 0F90 pop r0 |
2230 1350 1F90 pop __zero_reg__ |
2231 1352 1895 reti |
2233 .global GetExternalControl |
2234 .global GetExternalControl |
2235 .section .bss |
2238 GetExternalControl: |
2239 0000 00 .skip 1,0 |
2240 .global DebugDisplayAnforderung1 |
2241 .global DebugDisplayAnforderung1 |
2244 DebugDisplayAnforderung1: |
2245 0001 00 .skip 1,0 |
2246 .global DebugDisplayAnforderung |
2247 .global DebugDisplayAnforderung |
2250 DebugDisplayAnforderung: |
2251 0002 00 .skip 1,0 |
2252 .global DebugDataAnforderung |
2253 .global DebugDataAnforderung |
2256 DebugDataAnforderung: |
2257 0003 00 .skip 1,0 |
2258 .global GetVersionAnforderung |
2259 .global GetVersionAnforderung |
2262 GetVersionAnforderung: |
2263 0004 00 .skip 1,0 |
2264 .global GetPPMChannelAnforderung |
2265 .global GetPPMChannelAnforderung |
2268 GetPPMChannelAnforderung: |
2269 0005 00 .skip 1,0 |
2270 .global DisplayLine |
2271 .global DisplayLine |
2274 DisplayLine: |
2275 0006 00 .skip 1,0 |
2276 .global SioTmp |
2277 .global SioTmp |
2280 SioTmp: |
2281 0007 00 .skip 1,0 |
2282 .global NeuerDatensatzEmpfangen |
2283 .global NeuerDatensatzEmpfangen |
2286 NeuerDatensatzEmpfangen: |
2287 0008 00 .skip 1,0 |
2288 .global NeueKoordinateEmpfangen |
2289 .global NeueKoordinateEmpfangen |
2292 NeueKoordinateEmpfangen: |
2293 0009 00 .skip 1,0 |
2294 .global UebertragungAbgeschlossen |
2295 .data |
2298 UebertragungAbgeschlossen: |
2299 0000 01 .byte 1 |
2300 .global CntCrcError |
2301 .global CntCrcError |
2302 .section .bss |
2305 CntCrcError: |
2306 000a 00 .skip 1,0 |
2307 .global AnzahlEmpfangsBytes |
2308 .global AnzahlEmpfangsBytes |
2311 AnzahlEmpfangsBytes: |
2312 000b 00 .skip 1,0 |
2313 .global pRxData |
2314 .global pRxData |
2317 pRxData: |
2318 000c 0000 .skip 2,0 |
2319 .global RxDataLen |
2320 .global RxDataLen |
2323 RxDataLen: |
2324 000e 00 .skip 1,0 |
2325 .global PC_DebugTimeout |
2326 .global PC_DebugTimeout |
2329 PC_DebugTimeout: |
2330 000f 00 .skip 1,0 |
2331 .global PC_MotortestActive |
2332 .global PC_MotortestActive |
2335 PC_MotortestActive: |
2336 0010 00 .skip 1,0 |
2337 .global DebugTextAnforderung |
2338 .data |
2341 DebugTextAnforderung: |
2342 0001 FF .byte -1 |
2343 .global PcZugriff |
2346 PcZugriff: |
2347 0002 64 .byte 100 |
2348 .global MeineSlaveAdresse |
2351 MeineSlaveAdresse: |
2352 0003 01 .byte 1 |
2353 .global DebugDataIntervall |
2354 .global DebugDataIntervall |
2355 .section .bss |
2358 DebugDataIntervall: |
2359 0011 0000 .skip 2,0 |
2360 .global Intervall3D |
2361 .global Intervall3D |
2364 Intervall3D: |
2365 0013 0000 .skip 2,0 |
2366 .global Display_Interval |
2367 .global Display_Interval |
2370 Display_Interval: |
2371 0015 0000 .skip 2,0 |
2372 .global AboTimeOut |
2373 .global AboTimeOut |
2376 AboTimeOut: |
2377 0017 0000 .skip 2,0 |
2378 .global ANALOG_TEXT |
2379 .section .progmem.data,"a",@progbits |
2382 ANALOG_TEXT: |
2383 0000 416E 676C .ascii "AngleNick " |
2383 654E 6963 |
2383 6B20 2020 |
2383 2020 2020 |
2384 0010 416E 676C .ascii "AngleRoll " |
2384 6552 6F6C |
2384 6C20 2020 |
2384 2020 2020 |
2385 0020 4163 634E .ascii "AccNick " |
2385 6963 6B20 |
2385 2020 2020 |
2385 2020 2020 |
2386 0030 4163 6352 .ascii "AccRoll " |
2386 6F6C 6C20 |
2386 2020 2020 |
2386 2020 2020 |
2387 0040 5961 7747 .ascii "YawGyro " |
2387 7972 6F20 |
2387 2020 2020 |
2387 2020 2020 |
2388 0050 4865 6967 .ascii "Height Value " |
2388 6874 2056 |
2388 616C 7565 |
2388 2020 2020 |
2389 0060 4163 635A .ascii "AccZ " |
2389 2020 2020 |
2389 2020 2020 |
2389 2020 2020 |
2390 0070 4761 7320 .ascii "Gas " |
2390 2020 2020 |
2390 2020 2020 |
2390 2020 2020 |
2391 0080 436F 6D70 .ascii "Compass Value " |
2391 6173 7320 |
2391 5661 6C75 |
2391 6520 2020 |
2392 0090 566F 6C74 .ascii "Voltage [0.1V] " |
2392 6167 6520 |
2392 5B30 2E31 |
2392 565D 2020 |
2393 00a0 5265 6365 .ascii "Receiver Level " |
2393 6976 6572 |
2393 204C 6576 |
2393 656C 2020 |
2394 00b0 4779 726F .ascii "Gyro Compass " |
2394 2043 6F6D |
2394 7061 7373 |
2394 2020 2020 |
2395 00c0 4D6F 746F .ascii "Motor 1 " |
2395 7220 3120 |
2395 2020 2020 |
2395 2020 2020 |
2396 00d0 4D6F 746F .ascii "Motor 2 " |
2396 7220 3220 |
2396 2020 2020 |
2396 2020 2020 |
2397 00e0 4D6F 746F .ascii "Motor 3 " |
2397 7220 3320 |
2397 2020 2020 |
2397 2020 2020 |
2398 00f0 4D6F 746F .ascii "Motor 4 " |
2398 7220 3420 |
2398 2020 2020 |
2398 2020 2020 |
2399 0100 3136 2020 .ascii "16 " |
2399 2020 2020 |
2399 2020 2020 |
2399 2020 2020 |
2400 0110 3137 2020 .ascii "17 " |
2400 2020 2020 |
2400 2020 2020 |
2400 2020 2020 |
2401 0120 3138 2020 .ascii "18 " |
2401 2020 2020 |
2401 2020 2020 |
2401 2020 2020 |
2402 0130 3139 2020 .ascii "19 " |
2402 2020 2020 |
2402 2020 2020 |
2402 2020 2020 |
2403 0140 5365 7276 .ascii "Servo " |
2403 6F20 2020 |
2403 2020 2020 |
2403 2020 2020 |
2404 0150 486F 7665 .ascii "Hovergas " |
2404 7267 6173 |
2404 2020 2020 |
2404 2020 2020 |
2405 0160 4375 7272 .ascii "Current [0.1A] " |
2405 656E 7420 |
2405 5B30 2E31 |
2405 415D 2020 |
2406 0170 4361 7061 .ascii "Capacity [mAh] " |
2406 6369 7479 |
2406 205B 6D41 |
2406 685D 2020 |
2407 0180 3234 2020 .ascii "24 " |
2407 2020 2020 |
2407 2020 2020 |
2407 2020 2020 |
2408 0190 3235 2020 .ascii "25 " |
2408 2020 2020 |
2408 2020 2020 |
2408 2020 2020 |
2409 01a0 3236 2020 .ascii "26 " |
2409 2020 2020 |
2409 2020 2020 |
2409 2020 2020 |
2410 01b0 3237 2020 .ascii "27 " |
2410 2020 2020 |
2410 2020 2020 |
2410 2020 2020 |
2411 01c0 4932 432D .ascii "I2C-Error " |
2411 4572 726F |
2411 7220 2020 |
2411 2020 2020 |
2412 01d0 424C 204C .ascii "BL Limit " |
2412 696D 6974 |
2412 2020 2020 |
2412 2020 2020 |
2413 01e0 4750 535F .ascii "GPS_Nick " |
2413 4E69 636B |
2413 2020 2020 |
2413 2020 2020 |
2414 01f0 4750 535F .ascii "GPS_Roll " |
2414 526F 6C6C |
2414 2020 2020 |
2414 2020 2020 |
2417 __c.2679: |
2418 0200 2121 2120 .string "!!! INCOMPATIBLE !!!" |
2418 494E 434F |
2418 4D50 4154 |
2418 4942 4C45 |
2418 2021 2121 |
2419 .lcomm UartState.2284,1 |
2420 .lcomm buf_ptr.2283,1 |
2421 .lcomm crc2.2282,1 |
2422 .lcomm crc1.2281,1 |
2423 .lcomm crc.2280,2 |
2424 .lcomm ptr.2267,2 |
2425 .comm Debug_Timer,2,1 |
2426 .comm Kompass_Timer,2,1 |
2427 .comm MotorTest,16,1 |
2428 .comm DebugOut,66,1 |
2429 .comm WinkelOut,8,1 |
2430 .comm Data3D,14,1 |
2431 .comm ExternControl,11,1 |
2432 .comm VersionInfo,10,1 |
2433 .comm TxdBuffer,160,1 |
2434 .comm RxdBuffer,160,1 |
2435 .comm ConfirmFrame,1,1 |
2436 .comm Display_Timer,2,1 |
2437 .comm Timer3D,2,1 |
2438 .global __do_copy_data |
2439 .global __do_clear_bss |
8 .global __do_copy_data |
9 .global __do_clear_bss |
10 .global ANALOG_TEXT |
11 .section .progmem.data,"a",@progbits |
14 ANALOG_TEXT: |
15 0000 416E 676C .ascii "AngleNick " |
15 654E 6963 |
15 6B20 2020 |
15 2020 2020 |
16 0010 416E 676C .ascii "AngleRoll " |
16 6552 6F6C |
16 6C20 2020 |
16 2020 2020 |
17 0020 4163 634E .ascii "AccNick " |
17 6963 6B20 |
17 2020 2020 |
17 2020 2020 |
18 0030 4163 6352 .ascii "AccRoll " |
18 6F6C 6C20 |
18 2020 2020 |
18 2020 2020 |
19 0040 5961 7747 .ascii "YawGyro " |
19 7972 6F20 |
19 2020 2020 |
19 2020 2020 |
20 0050 4865 6967 .ascii "Height Value " |
20 6874 2056 |
20 616C 7565 |
20 2020 2020 |
21 0060 4163 635A .ascii "AccZ " |
21 2020 2020 |
21 2020 2020 |
21 2020 2020 |
22 0070 4761 7320 .ascii "Gas " |
22 2020 2020 |
22 2020 2020 |
22 2020 2020 |
23 0080 436F 6D70 .ascii "Compass Value " |
23 6173 7320 |
23 5661 6C75 |
23 6520 2020 |
24 0090 566F 6C74 .ascii "Voltage [0.1V] " |
24 6167 6520 |
24 5B30 2E31 |
24 565D 2020 |
25 00a0 5265 6365 .ascii "Receiver Level " |
25 6976 6572 |
25 204C 6576 |
25 656C 2020 |
26 00b0 4779 726F .ascii "Gyro Compass " |
26 2043 6F6D |
26 7061 7373 |
26 2020 2020 |
27 00c0 4D6F 746F .ascii "Motor 1 " |
27 7220 3120 |
27 2020 2020 |
27 2020 2020 |
28 00d0 4D6F 746F .ascii "Motor 2 " |
28 7220 3220 |
28 2020 2020 |
28 2020 2020 |
29 00e0 4D6F 746F .ascii "Motor 3 " |
29 7220 3320 |
29 2020 2020 |
29 2020 2020 |
30 00f0 4D6F 746F .ascii "Motor 4 " |
30 7220 3420 |
30 2020 2020 |
30 2020 2020 |
31 0100 3136 2020 .ascii "16 " |
31 2020 2020 |
31 2020 2020 |
31 2020 2020 |
32 0110 3137 2020 .ascii "17 " |
32 2020 2020 |
32 2020 2020 |
32 2020 2020 |
33 0120 3138 2020 .ascii "18 " |
33 2020 2020 |
33 2020 2020 |
33 2020 2020 |
34 0130 3139 2020 .ascii "19 " |
34 2020 2020 |
34 2020 2020 |
34 2020 2020 |
35 0140 5365 7276 .ascii "Servo " |
35 6F20 2020 |
35 2020 2020 |
35 2020 2020 |
36 0150 486F 7665 .ascii "Hovergas " |
36 7267 6173 |
36 2020 2020 |
36 2020 2020 |
37 0160 4375 7272 .ascii "Current [0.1A] " |
37 656E 7420 |
37 5B30 2E31 |
37 415D 2020 |
38 0170 4361 7061 .ascii "Capacity [mAh] " |
38 6369 7479 |
38 205B 6D41 |
38 685D 2020 |
39 0180 3234 2020 .ascii "24 " |
39 2020 2020 |
39 2020 2020 |
39 2020 2020 |
40 0190 3235 2020 .ascii "25 " |
40 2020 2020 |
40 2020 2020 |
40 2020 2020 |
41 01a0 3236 2020 .ascii "26 " |
41 2020 2020 |
41 2020 2020 |
41 2020 2020 |
42 01b0 3237 2020 .ascii "27 " |
42 2020 2020 |
42 2020 2020 |
42 2020 2020 |
43 01c0 4932 432D .ascii "I2C-Error " |
43 4572 726F |
43 7220 2020 |
43 2020 2020 |
44 01d0 424C 204C .ascii "BL Limit " |
44 696D 6974 |
44 2020 2020 |
44 2020 2020 |
45 01e0 4750 535F .ascii "GPS_Nick " |
45 4E69 636B |
45 2020 2020 |
45 2020 2020 |
46 01f0 4750 535F .ascii "GPS_Roll " |
46 526F 6C6C |
46 2020 2020 |
46 2020 2020 |
47 .global AboTimeOut |
48 .global AboTimeOut |
49 .section .bss |
52 AboTimeOut: |
53 0000 0000 .skip 2,0 |
54 .global Display_Interval |
55 .global Display_Interval |
58 Display_Interval: |
59 0002 0000 .skip 2,0 |
60 .global Intervall3D |
61 .global Intervall3D |
64 Intervall3D: |
65 0004 0000 .skip 2,0 |
66 .global DebugDataIntervall |
67 .global DebugDataIntervall |
70 DebugDataIntervall: |
71 0006 0000 .skip 2,0 |
72 .global MeineSlaveAdresse |
73 .data |
76 MeineSlaveAdresse: |
77 0000 01 .byte 1 |
78 .global PcZugriff |
81 PcZugriff: |
82 0001 64 .byte 100 |
83 .global DebugTextAnforderung |
86 DebugTextAnforderung: |
87 0002 FF .byte -1 |
88 .global PC_MotortestActive |
89 .global PC_MotortestActive |
90 .section .bss |
93 PC_MotortestActive: |
94 0008 00 .skip 1,0 |
95 .global PC_DebugTimeout |
96 .global PC_DebugTimeout |
99 PC_DebugTimeout: |
100 0009 00 .skip 1,0 |
101 .global RxDataLen |
102 .global RxDataLen |
105 RxDataLen: |
106 000a 00 .skip 1,0 |
107 .global pRxData |
108 .global pRxData |
111 pRxData: |
112 000b 0000 .skip 2,0 |
113 .global AnzahlEmpfangsBytes |
114 .global AnzahlEmpfangsBytes |
117 AnzahlEmpfangsBytes: |
118 000d 00 .skip 1,0 |
119 .global CntCrcError |
120 .global CntCrcError |
123 CntCrcError: |
124 000e 00 .skip 1,0 |
125 .global UebertragungAbgeschlossen |
126 .data |
129 UebertragungAbgeschlossen: |
130 0003 01 .byte 1 |
131 .global NeueKoordinateEmpfangen |
132 .global NeueKoordinateEmpfangen |
133 .section .bss |
136 NeueKoordinateEmpfangen: |
137 000f 00 .skip 1,0 |
138 .global NeuerDatensatzEmpfangen |
139 .global NeuerDatensatzEmpfangen |
142 NeuerDatensatzEmpfangen: |
143 0010 00 .skip 1,0 |
144 .global SioTmp |
145 .global SioTmp |
148 SioTmp: |
149 0011 00 .skip 1,0 |
150 .global DisplayLine |
151 .global DisplayLine |
154 DisplayLine: |
155 0012 00 .skip 1,0 |
156 .global GetPPMChannelAnforderung |
157 .global GetPPMChannelAnforderung |
160 GetPPMChannelAnforderung: |
161 0013 00 .skip 1,0 |
162 .global GetVersionAnforderung |
163 .global GetVersionAnforderung |
166 GetVersionAnforderung: |
167 0014 00 .skip 1,0 |
168 .global DebugDataAnforderung |
169 .global DebugDataAnforderung |
172 DebugDataAnforderung: |
173 0015 00 .skip 1,0 |
174 .global DebugDisplayAnforderung |
175 .global DebugDisplayAnforderung |
178 DebugDisplayAnforderung: |
179 0016 00 .skip 1,0 |
180 .global DebugDisplayAnforderung1 |
181 .global DebugDisplayAnforderung1 |
184 DebugDisplayAnforderung1: |
185 0017 00 .skip 1,0 |
186 .global GetExternalControl |
187 .global GetExternalControl |
190 GetExternalControl: |
191 0018 00 .skip 1,0 |
192 .lcomm ptr.6,2 |
193 .text |
194 .global __vector_22 |
196 __vector_22: |
197 /* prologue: frame size=0 */ |
198 0000 1F92 push __zero_reg__ |
199 0002 0F92 push __tmp_reg__ |
200 0004 0FB6 in __tmp_reg__,__SREG__ |
201 0006 0F92 push __tmp_reg__ |
202 0008 1124 clr __zero_reg__ |
203 000a 8F93 push r24 |
204 000c 9F93 push r25 |
205 000e EF93 push r30 |
206 0010 FF93 push r31 |
207 /* prologue end (size=9) */ |
208 0012 8091 0000 lds r24,UebertragungAbgeschlossen |
209 0016 8823 tst r24 |
210 0018 E1F4 brne .L2 |
211 001a 8091 0000 lds r24,ptr.6 |
212 001e 9091 0000 lds r25,(ptr.6)+1 |
213 0022 0196 adiw r24,1 |
214 0024 9093 0000 sts (ptr.6)+1,r25 |
215 0028 8093 0000 sts ptr.6,r24 |
216 002c FC01 movw r30,r24 |
217 002e E050 subi r30,lo8(-(TxdBuffer)) |
218 0030 F040 sbci r31,hi8(-(TxdBuffer)) |
219 0032 E081 ld r30,Z |
220 0034 ED30 cpi r30,lo8(13) |
221 0036 19F0 breq .L4 |
222 0038 803A cpi r24,160 |
223 003a 9105 cpc r25,__zero_reg__ |
224 003c 39F4 brne .L3 |
225 .L4: |
226 003e 1092 0000 sts (ptr.6)+1,__zero_reg__ |
227 0042 1092 0000 sts ptr.6,__zero_reg__ |
228 0046 81E0 ldi r24,lo8(1) |
229 0048 8093 0000 sts UebertragungAbgeschlossen,r24 |
230 .L3: |
231 004c E093 C600 sts 198,r30 |
232 0050 04C0 rjmp .L1 |
233 .L2: |
234 0052 1092 0000 sts (ptr.6)+1,__zero_reg__ |
235 0056 1092 0000 sts ptr.6,__zero_reg__ |
236 .L1: |
237 /* epilogue: frame size=0 */ |
238 005a FF91 pop r31 |
239 005c EF91 pop r30 |
240 005e 9F91 pop r25 |
241 0060 8F91 pop r24 |
242 0062 0F90 pop __tmp_reg__ |
243 0064 0FBE out __SREG__,__tmp_reg__ |
244 0066 0F90 pop __tmp_reg__ |
245 0068 1F90 pop __zero_reg__ |
246 006a 1895 reti |
247 /* epilogue end (size=9) */ |
248 /* function __vector_22 size 54 (36) */ |
250 .lcomm crc.1,2 |
251 .lcomm crc1.2,1 |
252 .lcomm crc2.3,1 |
253 .lcomm buf_ptr.4,1 |
254 .lcomm UartState.5,1 |
255 .global __vector_20 |
257 __vector_20: |
258 /* prologue: frame size=0 */ |
259 006c 1F92 push __zero_reg__ |
260 006e 0F92 push __tmp_reg__ |
261 0070 0FB6 in __tmp_reg__,__SREG__ |
262 0072 0F92 push __tmp_reg__ |
263 0074 1124 clr __zero_reg__ |
264 0076 2F93 push r18 |
265 0078 3F93 push r19 |
266 007a 4F93 push r20 |
267 007c 5F93 push r21 |
268 007e 6F93 push r22 |
269 0080 7F93 push r23 |
270 0082 8F93 push r24 |
271 0084 9F93 push r25 |
272 0086 AF93 push r26 |
273 0088 BF93 push r27 |
274 008a CF93 push r28 |
275 008c EF93 push r30 |
276 008e FF93 push r31 |
277 /* prologue end (size=18) */ |
278 0090 90E0 ldi r25,lo8(0) |
279 0092 8091 C600 lds r24,198 |
280 0096 8093 0000 sts SioTmp,r24 |
281 009a 5091 0000 lds r21,buf_ptr.4 |
282 009e 503A cpi r21,lo8(-96) |
283 00a0 10F0 brlo .L7 |
284 00a2 9093 0000 sts UartState.5,r25 |
285 .L7: |
286 00a6 8091 0000 lds r24,SioTmp |
287 00aa 8D30 cpi r24,lo8(13) |
288 00ac 09F0 breq .+2 |
289 00ae 65C0 rjmp .L8 |
290 00b0 8091 0000 lds r24,UartState.5 |
291 00b4 8230 cpi r24,lo8(2) |
292 00b6 09F0 breq .+2 |
293 00b8 60C0 rjmp .L8 |
294 00ba 9093 0000 sts UartState.5,r25 |
295 00be 852F mov r24,r21 |
296 00c0 9927 clr r25 |
297 00c2 8050 subi r24,lo8(-(RxdBuffer)) |
298 00c4 9040 sbci r25,hi8(-(RxdBuffer)) |
299 00c6 FC01 movw r30,r24 |
300 00c8 3297 sbiw r30,2 |
301 00ca 4081 ld r20,Z |
302 00cc 2091 0000 lds r18,crc.1 |
303 00d0 3091 0000 lds r19,(crc.1)+1 |
304 00d4 241B sub r18,r20 |
305 00d6 3109 sbc r19,__zero_reg__ |
306 00d8 DC01 movw r26,r24 |
307 00da 1197 sbiw r26,1 |
308 00dc 8C91 ld r24,X |
309 00de 281B sub r18,r24 |
310 00e0 3109 sbc r19,__zero_reg__ |
311 00e2 C901 movw r24,r18 |
312 00e4 9F70 andi r25,hi8(4095) |
313 00e6 9093 0000 sts (crc.1)+1,r25 |
314 00ea 8093 0000 sts crc.1,r24 |
315 00ee 46E0 ldi r20,6 |
316 00f0 9695 1: lsr r25 |
317 00f2 8795 ror r24 |
318 00f4 4A95 dec r20 |
319 00f6 E1F7 brne 1b |
320 00f8 982F mov r25,r24 |
321 00fa 935C subi r25,lo8(-(61)) |
322 00fc 9093 0000 sts crc1.2,r25 |
323 0100 2F73 andi r18,lo8(63) |
324 0102 3070 andi r19,hi8(63) |
325 0104 235C subi r18,lo8(-(61)) |
326 0106 2093 0000 sts crc2.3,r18 |
327 010a 8081 ld r24,Z |
328 010c 9817 cp r25,r24 |
329 010e 29F4 brne .L9 |
330 0110 8C91 ld r24,X |
331 0112 2817 cp r18,r24 |
332 0114 11F4 brne .L9 |
333 0116 91E0 ldi r25,lo8(1) |
334 0118 06C0 rjmp .L10 |
335 .L9: |
336 011a 90E0 ldi r25,lo8(0) |
337 011c 8091 0000 lds r24,CntCrcError |
338 0120 8F5F subi r24,lo8(-(1)) |
339 0122 8093 0000 sts CntCrcError,r24 |
340 .L10: |
341 0126 C091 0000 lds r28,NeuerDatensatzEmpfangen |
342 012a CC23 tst r28 |
343 012c 09F0 breq .+2 |
344 012e 74C0 rjmp .L6 |
345 0130 9923 tst r25 |
346 0132 09F4 brne .+2 |
347 0134 71C0 rjmp .L6 |
348 0136 81E0 ldi r24,lo8(1) |
349 0138 8093 0000 sts NeuerDatensatzEmpfangen,r24 |
350 013c 580F add r21,r24 |
351 013e 5093 0000 sts AnzahlEmpfangsBytes,r21 |
352 0142 5150 subi r21,lo8(-(-1)) |
353 0144 E52F mov r30,r21 |
354 0146 FF27 clr r31 |
355 0148 E050 subi r30,lo8(-(RxdBuffer)) |
356 014a F040 sbci r31,hi8(-(RxdBuffer)) |
357 014c 8DE0 ldi r24,lo8(13) |
358 014e 8083 st Z,r24 |
359 0150 8091 0000 lds r24,RxdBuffer+2 |
360 0154 8235 cpi r24,lo8(82) |
361 0156 09F0 breq .+2 |
362 0158 5FC0 rjmp .L6 |
363 015a 0E94 0000 call LcdClear |
364 015e 88E1 ldi r24,lo8(24) |
365 0160 90E0 ldi r25,hi8(24) |
366 0162 2CE0 ldi r18,lo8(12) |
367 /* #APP */ |
368 0164 0FB6 in __tmp_reg__,__SREG__ |
369 0166 F894 cli |
370 0168 A895 wdr |
371 016a 8093 6000 sts 96,r24 |
372 016e 0FBE out __SREG__,__tmp_reg__ |
373 0170 2093 6000 sts 96,r18 |
374 /* #NOAPP */ |
375 0174 C093 0000 sts ServoActive,r28 |
376 0178 4FC0 rjmp .L6 |
377 .L8: |
378 017a 2091 0000 lds r18,UartState.5 |
379 017e 822F mov r24,r18 |
380 0180 9927 clr r25 |
381 0182 8130 cpi r24,1 |
382 0184 9105 cpc r25,__zero_reg__ |
383 0186 F9F0 breq .L17 |
384 0188 8230 cpi r24,2 |
385 018a 9105 cpc r25,__zero_reg__ |
386 018c 1CF4 brge .L22 |
387 018e 892B or r24,r25 |
388 0190 21F0 breq .L15 |
389 0192 40C0 rjmp .L21 |
390 .L22: |
391 0194 0297 sbiw r24,2 |
392 0196 11F1 breq .L18 |
393 0198 3DC0 rjmp .L21 |
394 .L15: |
395 019a 8091 0000 lds r24,SioTmp |
396 019e 8332 cpi r24,lo8(35) |
397 01a0 39F4 brne .L16 |
398 01a2 8091 0000 lds r24,NeuerDatensatzEmpfangen |
399 01a6 8823 tst r24 |
400 01a8 19F4 brne .L16 |
401 01aa 81E0 ldi r24,lo8(1) |
402 01ac 8093 0000 sts UartState.5,r24 |
403 .L16: |
404 01b0 8091 0000 lds r24,SioTmp |
405 01b4 8093 0000 sts RxdBuffer,r24 |
406 01b8 81E0 ldi r24,lo8(1) |
407 01ba 8093 0000 sts buf_ptr.4,r24 |
408 01be 8091 0000 lds r24,SioTmp |
409 01c2 9927 clr r25 |
410 01c4 22C0 rjmp .L23 |
411 .L17: |
412 01c6 2F5F subi r18,lo8(-(1)) |
413 01c8 2093 0000 sts UartState.5,r18 |
414 01cc E52F mov r30,r21 |
415 01ce FF27 clr r31 |
416 01d0 E050 subi r30,lo8(-(RxdBuffer)) |
417 01d2 F040 sbci r31,hi8(-(RxdBuffer)) |
418 01d4 8091 0000 lds r24,SioTmp |
419 01d8 8083 st Z,r24 |
420 01da 09C0 rjmp .L24 |
421 .L18: |
422 01dc E52F mov r30,r21 |
423 01de FF27 clr r31 |
424 01e0 E050 subi r30,lo8(-(RxdBuffer)) |
425 01e2 F040 sbci r31,hi8(-(RxdBuffer)) |
426 01e4 8091 0000 lds r24,SioTmp |
427 01e8 8083 st Z,r24 |
428 01ea 503A cpi r21,lo8(-96) |
429 01ec 20F4 brsh .L19 |
430 .L24: |
431 01ee 5F5F subi r21,lo8(-(1)) |
432 01f0 5093 0000 sts buf_ptr.4,r21 |
433 01f4 02C0 rjmp .L20 |
434 .L19: |
435 01f6 1092 0000 sts UartState.5,__zero_reg__ |
436 .L20: |
437 01fa 2091 0000 lds r18,SioTmp |
438 01fe 8091 0000 lds r24,crc.1 |
439 0202 9091 0000 lds r25,(crc.1)+1 |
440 0206 820F add r24,r18 |
441 0208 911D adc r25,__zero_reg__ |
442 .L23: |
443 020a 9093 0000 sts (crc.1)+1,r25 |
444 020e 8093 0000 sts crc.1,r24 |
445 0212 02C0 rjmp .L6 |
446 .L21: |
447 0214 1092 0000 sts UartState.5,__zero_reg__ |
448 .L6: |
449 /* epilogue: frame size=0 */ |
450 0218 FF91 pop r31 |
451 021a EF91 pop r30 |
452 021c CF91 pop r28 |
453 021e BF91 pop r27 |
454 0220 AF91 pop r26 |
455 0222 9F91 pop r25 |
456 0224 8F91 pop r24 |
457 0226 7F91 pop r23 |
458 0228 6F91 pop r22 |
459 022a 5F91 pop r21 |
460 022c 4F91 pop r20 |
461 022e 3F91 pop r19 |
462 0230 2F91 pop r18 |
463 0232 0F90 pop __tmp_reg__ |
464 0234 0FBE out __SREG__,__tmp_reg__ |
465 0236 0F90 pop __tmp_reg__ |
466 0238 1F90 pop __zero_reg__ |
467 023a 1895 reti |
468 /* epilogue end (size=18) */ |
469 /* function __vector_20 size 238 (202) */ |
471 .global AddCRC |
473 AddCRC: |
474 /* prologue: frame size=0 */ |
475 /* prologue end (size=0) */ |
476 023c AC01 movw r20,r24 |
477 023e A0E0 ldi r26,lo8(0) |
478 0240 B0E0 ldi r27,hi8(0) |
479 0242 9D01 movw r18,r26 |
480 0244 A817 cp r26,r24 |
481 0246 B907 cpc r27,r25 |
482 0248 48F4 brsh .L31 |
483 024a E0E0 ldi r30,lo8(TxdBuffer) |
484 024c F0E0 ldi r31,hi8(TxdBuffer) |
485 .L29: |
486 024e 8191 ld r24,Z+ |
487 0250 280F add r18,r24 |
488 0252 311D adc r19,__zero_reg__ |
489 0254 1196 adiw r26,1 |
490 0256 A417 cp r26,r20 |
491 0258 B507 cpc r27,r21 |
492 025a C8F3 brlo .L29 |
493 .L31: |
494 025c 3F70 andi r19,hi8(4095) |
495 025e FD01 movw r30,r26 |
496 0260 E050 subi r30,lo8(-(TxdBuffer)) |
497 0262 F040 sbci r31,hi8(-(TxdBuffer)) |
498 0264 C901 movw r24,r18 |
499 0266 56E0 ldi r21,6 |
500 0268 9695 1: lsr r25 |
501 026a 8795 ror r24 |
502 026c 5A95 dec r21 |
503 026e E1F7 brne 1b |
504 0270 835C subi r24,lo8(-(61)) |
505 0272 8083 st Z,r24 |
506 0274 1196 adiw r26,1 |
507 0276 FD01 movw r30,r26 |
508 0278 E050 subi r30,lo8(-(TxdBuffer)) |
509 027a F040 sbci r31,hi8(-(TxdBuffer)) |
510 027c 2F73 andi r18,lo8(63) |
511 027e 3070 andi r19,hi8(63) |
512 0280 822F mov r24,r18 |
513 0282 835C subi r24,lo8(-(61)) |
514 0284 8083 st Z,r24 |
515 0286 A050 subi r26,lo8(-(TxdBuffer+1)) |
516 0288 B040 sbci r27,hi8(-(TxdBuffer+1)) |
517 028a 8DE0 ldi r24,lo8(13) |
518 028c 8C93 st X,r24 |
519 028e 1092 0000 sts UebertragungAbgeschlossen,__zero_reg__ |
520 0292 8091 0000 lds r24,TxdBuffer |
521 0296 8093 C600 sts 198,r24 |
522 /* epilogue: frame size=0 */ |
523 029a 0895 ret |
524 /* epilogue end (size=1) */ |
525 /* function AddCRC size 49 (48) */ |
527 .global SendOutData |
529 SendOutData: |
530 /* prologue: frame size=0 */ |
531 029c A0E0 ldi r26,lo8(0) |
532 029e B0E0 ldi r27,hi8(0) |
533 02a0 E0E0 ldi r30,pm_lo8(1f) |
534 02a2 F0E0 ldi r31,pm_hi8(1f) |
535 02a4 0C94 0000 jmp __prologue_saves__+18 |
536 1: |
537 /* prologue end (size=6) */ |
538 02a8 2C85 ldd r18,Y+12 |
539 02aa 9D85 ldd r25,Y+13 |
540 02ac 0E85 ldd r16,Y+14 |
541 02ae BB24 clr r11 |
542 02b0 83E2 ldi r24,lo8(35) |
543 02b2 8093 0000 sts TxdBuffer,r24 |
544 02b6 9F59 subi r25,lo8(-(97)) |
545 02b8 9093 0000 sts TxdBuffer+1,r25 |
546 02bc 2093 0000 sts TxdBuffer+2,r18 |
547 02c0 33E0 ldi r19,lo8(3) |
548 02c2 E32E mov r14,r19 |
549 02c4 F12C mov r15,__zero_reg__ |
550 02c6 0023 tst r16 |
551 02c8 09F4 brne .+2 |
552 02ca 9EC0 rjmp .L47 |
553 02cc CF84 ldd r12,Y+15 |
554 02ce D888 ldd r13,Y+16 |
555 02d0 BE01 movw r22,r28 |
556 02d2 6D5E subi r22,lo8(-(19)) |
557 02d4 7F4F sbci r23,hi8(-(19)) |
558 02d6 A989 ldd r26,Y+17 |
559 02d8 BA89 ldd r27,Y+18 |
560 02da 0150 subi r16,lo8(-(-1)) |
561 .L48: |
562 02dc 1097 sbiw r26,0 |
563 02de 09F4 brne .+2 |
564 02e0 93C0 rjmp .L47 |
565 02e2 1097 sbiw r26,0 |
566 02e4 B9F0 breq .L36 |
567 02e6 F601 movw r30,r12 |
568 02e8 EB0D add r30,r11 |
569 02ea F11D adc r31,__zero_reg__ |
570 02ec B394 inc r11 |
571 02ee 9081 ld r25,Z |
572 02f0 1197 sbiw r26,1 |
573 02f2 91F4 brne .L38 |
574 02f4 0023 tst r16 |
575 02f6 49F1 breq .L39 |
576 02f8 FB01 movw r30,r22 |
577 02fa 6E5F subi r22,lo8(-(2)) |
578 02fc 7F4F sbci r23,hi8(-(2)) |
579 02fe DB01 movw r26,r22 |
580 0300 C080 ld r12,Z |
581 0302 D180 ldd r13,Z+1 |
582 0304 6E5F subi r22,lo8(-(2)) |
583 0306 7F4F sbci r23,hi8(-(2)) |
584 0308 0D90 ld __tmp_reg__,X+ |
585 030a BC91 ld r27,X |
586 030c A02D mov r26,__tmp_reg__ |
587 030e BB24 clr r11 |
588 0310 0150 subi r16,lo8(-(-1)) |
589 0312 02C0 rjmp .L38 |
590 .L36: |
591 0314 90E0 ldi r25,lo8(0) |
592 0316 19C0 rjmp .L39 |
593 .L38: |
594 0318 1097 sbiw r26,0 |
595 031a B9F0 breq .L39 |
596 031c F601 movw r30,r12 |
597 031e EB0D add r30,r11 |
598 0320 F11D adc r31,__zero_reg__ |
599 0322 B394 inc r11 |
600 0324 4081 ld r20,Z |
601 0326 1197 sbiw r26,1 |
602 0328 91F4 brne .L41 |
603 032a 0023 tst r16 |
604 032c 41F1 breq .L42 |
605 032e FB01 movw r30,r22 |
606 0330 6E5F subi r22,lo8(-(2)) |
607 0332 7F4F sbci r23,hi8(-(2)) |
608 0334 DB01 movw r26,r22 |
609 0336 C080 ld r12,Z |
610 0338 D180 ldd r13,Z+1 |
611 033a 6E5F subi r22,lo8(-(2)) |
612 033c 7F4F sbci r23,hi8(-(2)) |
613 033e 0D90 ld __tmp_reg__,X+ |
614 0340 BC91 ld r27,X |
615 0342 A02D mov r26,__tmp_reg__ |
616 0344 BB24 clr r11 |
617 0346 0150 subi r16,lo8(-(-1)) |
618 0348 02C0 rjmp .L41 |
619 .L39: |
620 034a 40E0 ldi r20,lo8(0) |
621 034c 18C0 rjmp .L42 |
622 .L41: |
623 034e 1097 sbiw r26,0 |
624 0350 B1F0 breq .L42 |
625 0352 F601 movw r30,r12 |
626 0354 EB0D add r30,r11 |
627 0356 F11D adc r31,__zero_reg__ |
628 0358 B394 inc r11 |
629 035a 1081 ld r17,Z |
630 035c 1197 sbiw r26,1 |
631 035e 81F4 brne .L44 |
632 0360 0023 tst r16 |
633 0362 71F0 breq .L44 |
634 0364 FB01 movw r30,r22 |
635 0366 3296 adiw r30,2 |
636 0368 DB01 movw r26,r22 |
637 036a CD90 ld r12,X+ |
638 036c DC90 ld r13,X |
639 036e BF01 movw r22,r30 |
640 0370 6E5F subi r22,lo8(-(2)) |
641 0372 7F4F sbci r23,hi8(-(2)) |
642 0374 A081 ld r26,Z |
643 0376 B181 ldd r27,Z+1 |
644 0378 BB24 clr r11 |
645 037a 0150 subi r16,lo8(-(-1)) |
646 037c 01C0 rjmp .L44 |
647 .L42: |
648 037e 10E0 ldi r17,lo8(0) |
649 .L44: |
650 0380 F701 movw r30,r14 |
651 0382 E050 subi r30,lo8(-(TxdBuffer)) |
652 0384 F040 sbci r31,hi8(-(TxdBuffer)) |
653 0386 892F mov r24,r25 |
654 0388 8695 lsr r24 |
655 038a 8695 lsr r24 |
656 038c 835C subi r24,lo8(-(61)) |
657 038e 8083 st Z,r24 |
658 0390 0894 sec |
659 0392 E11C adc r14,__zero_reg__ |
660 0394 F11C adc r15,__zero_reg__ |
661 0396 F701 movw r30,r14 |
662 0398 E050 subi r30,lo8(-(TxdBuffer)) |
663 039a F040 sbci r31,hi8(-(TxdBuffer)) |
664 039c 892F mov r24,r25 |
665 039e 9927 clr r25 |
666 03a0 8370 andi r24,lo8(3) |
667 03a2 9070 andi r25,hi8(3) |
668 03a4 24E0 ldi r18,4 |
669 03a6 880F 1: lsl r24 |
670 03a8 991F rol r25 |
671 03aa 2A95 dec r18 |
672 03ac E1F7 brne 1b |
673 03ae 5527 clr r21 |
674 03b0 9A01 movw r18,r20 |
675 03b2 94E0 ldi r25,4 |
676 03b4 3695 1: lsr r19 |
677 03b6 2795 ror r18 |
678 03b8 9A95 dec r25 |
679 03ba E1F7 brne 1b |
680 03bc 822B or r24,r18 |
681 03be 835C subi r24,lo8(-(61)) |
682 03c0 8083 st Z,r24 |
683 03c2 0894 sec |
684 03c4 E11C adc r14,__zero_reg__ |
685 03c6 F11C adc r15,__zero_reg__ |
686 03c8 F701 movw r30,r14 |
687 03ca E050 subi r30,lo8(-(TxdBuffer)) |
688 03cc F040 sbci r31,hi8(-(TxdBuffer)) |
689 03ce 4F70 andi r20,lo8(15) |
690 03d0 5070 andi r21,hi8(15) |
691 03d2 440F lsl r20 |
692 03d4 551F rol r21 |
693 03d6 440F lsl r20 |
694 03d8 551F rol r21 |
695 03da 812F mov r24,r17 |
696 03dc 9927 clr r25 |
697 03de 26E0 ldi r18,6 |
698 03e0 9695 1: lsr r25 |
699 03e2 8795 ror r24 |
700 03e4 2A95 dec r18 |
701 03e6 E1F7 brne 1b |
702 03e8 842B or r24,r20 |
703 03ea 835C subi r24,lo8(-(61)) |
704 03ec 8083 st Z,r24 |
705 03ee 0894 sec |
706 03f0 E11C adc r14,__zero_reg__ |
707 03f2 F11C adc r15,__zero_reg__ |
708 03f4 F701 movw r30,r14 |
709 03f6 E050 subi r30,lo8(-(TxdBuffer)) |
710 03f8 F040 sbci r31,hi8(-(TxdBuffer)) |
711 03fa 1F73 andi r17,lo8(63) |
712 03fc 135C subi r17,lo8(-(61)) |
713 03fe 1083 st Z,r17 |
714 0400 0894 sec |
715 0402 E11C adc r14,__zero_reg__ |
716 0404 F11C adc r15,__zero_reg__ |
717 0406 6ACF rjmp .L48 |
718 .L47: |
719 0408 C701 movw r24,r14 |
720 040a 0E94 0000 call AddCRC |
721 /* epilogue: frame size=0 */ |
722 040e E9E0 ldi r30,9 |
723 0410 0C94 0000 jmp __epilogue_restores__+18 |
724 /* epilogue end (size=3) */ |
725 /* function SendOutData size 191 (182) */ |
727 .global Decode64 |
729 Decode64: |
730 /* prologue: frame size=0 */ |
731 /* prologue end (size=0) */ |
732 0414 A3E0 ldi r26,lo8(3) |
733 0416 7A2F mov r23,r26 |
734 0418 4091 0000 lds r20,AnzahlEmpfangsBytes |
735 041c 4650 subi r20,lo8(-(-6)) |
736 .L60: |
737 041e 4423 tst r20 |
738 0420 09F4 brne .+2 |
739 0422 58C0 rjmp .L51 |
740 0424 E72F mov r30,r23 |
741 0426 FF27 clr r31 |
742 0428 E050 subi r30,lo8(-(RxdBuffer)) |
743 042a F040 sbci r31,hi8(-(RxdBuffer)) |
744 042c 8081 ld r24,Z |
745 042e 8D53 subi r24,lo8(-(-61)) |
746 0430 7F5F subi r23,lo8(-(1)) |
747 0432 E72F mov r30,r23 |
748 0434 FF27 clr r31 |
749 0436 E050 subi r30,lo8(-(RxdBuffer)) |
750 0438 F040 sbci r31,hi8(-(RxdBuffer)) |
751 043a 2081 ld r18,Z |
752 043c 2D53 subi r18,lo8(-(-61)) |
753 043e 7F5F subi r23,lo8(-(1)) |
754 0440 E72F mov r30,r23 |
755 0442 FF27 clr r31 |
756 0444 E050 subi r30,lo8(-(RxdBuffer)) |
757 0446 F040 sbci r31,hi8(-(RxdBuffer)) |
758 0448 3081 ld r19,Z |
759 044a 3D53 subi r19,lo8(-(-61)) |
760 044c 7F5F subi r23,lo8(-(1)) |
761 044e E72F mov r30,r23 |
762 0450 FF27 clr r31 |
763 0452 E050 subi r30,lo8(-(RxdBuffer)) |
764 0454 F040 sbci r31,hi8(-(RxdBuffer)) |
765 0456 6081 ld r22,Z |
766 0458 6D53 subi r22,lo8(-(-61)) |
767 045a 7F5F subi r23,lo8(-(1)) |
768 045c 9927 clr r25 |
769 045e 880F lsl r24 |
770 0460 991F rol r25 |
771 0462 880F lsl r24 |
772 0464 991F rol r25 |
773 0466 522F mov r21,r18 |
774 0468 5295 swap r21 |
775 046a 5F70 andi r21,0x0f |
776 046c 582B or r21,r24 |
777 046e 822F mov r24,r18 |
778 0470 9927 clr r25 |
779 0472 8F70 andi r24,lo8(15) |
780 0474 9070 andi r25,hi8(15) |
781 0476 F4E0 ldi r31,4 |
782 0478 880F 1: lsl r24 |
783 047a 991F rol r25 |
784 047c FA95 dec r31 |
785 047e E1F7 brne 1b |
786 0480 232F mov r18,r19 |
787 0482 2695 lsr r18 |
788 0484 2695 lsr r18 |
789 0486 282B or r18,r24 |
790 0488 832F mov r24,r19 |
791 048a 9927 clr r25 |
792 048c 8370 andi r24,lo8(3) |
793 048e 9070 andi r25,hi8(3) |
794 0490 E6E0 ldi r30,6 |
795 0492 880F 1: lsl r24 |
796 0494 991F rol r25 |
797 0496 EA95 dec r30 |
798 0498 E1F7 brne 1b |
799 049a 682B or r22,r24 |
800 049c 4150 subi r20,lo8(-(-1)) |
801 049e 4F3F cpi r20,lo8(-1) |
802 04a0 C9F0 breq .L51 |
803 04a2 EA2F mov r30,r26 |
804 04a4 FF27 clr r31 |
805 04a6 E050 subi r30,lo8(-(RxdBuffer)) |
806 04a8 F040 sbci r31,hi8(-(RxdBuffer)) |
807 04aa 5083 st Z,r21 |
808 04ac AF5F subi r26,lo8(-(1)) |
809 04ae 4150 subi r20,lo8(-(-1)) |
810 04b0 4F3F cpi r20,lo8(-1) |
811 04b2 81F0 breq .L51 |
812 04b4 EA2F mov r30,r26 |
813 04b6 FF27 clr r31 |
814 04b8 E050 subi r30,lo8(-(RxdBuffer)) |
815 04ba F040 sbci r31,hi8(-(RxdBuffer)) |
816 04bc 2083 st Z,r18 |
817 04be AF5F subi r26,lo8(-(1)) |
818 04c0 4150 subi r20,lo8(-(-1)) |
819 04c2 4F3F cpi r20,lo8(-1) |
820 04c4 39F0 breq .L51 |
821 04c6 EA2F mov r30,r26 |
822 04c8 FF27 clr r31 |
823 04ca E050 subi r30,lo8(-(RxdBuffer)) |
824 04cc F040 sbci r31,hi8(-(RxdBuffer)) |
825 04ce 6083 st Z,r22 |
826 04d0 AF5F subi r26,lo8(-(1)) |
827 04d2 A5CF rjmp .L60 |
828 .L51: |
829 04d4 80E0 ldi r24,lo8(RxdBuffer+3) |
830 04d6 90E0 ldi r25,hi8(RxdBuffer+3) |
831 04d8 9093 0000 sts (pRxData)+1,r25 |
832 04dc 8093 0000 sts pRxData,r24 |
833 04e0 A350 subi r26,lo8(-(-3)) |
834 04e2 A093 0000 sts RxDataLen,r26 |
835 /* epilogue: frame size=0 */ |
836 04e6 0895 ret |
837 /* epilogue end (size=1) */ |
838 /* function Decode64 size 106 (105) */ |
840 .global BearbeiteRxDaten |
842 BearbeiteRxDaten: |
843 /* prologue: frame size=2 */ |
844 04e8 A2E0 ldi r26,lo8(2) |
845 04ea B0E0 ldi r27,hi8(2) |
846 04ec E0E0 ldi r30,pm_lo8(1f) |
847 04ee F0E0 ldi r31,pm_hi8(1f) |
848 04f0 0C94 0000 jmp __prologue_saves__+30 |
849 1: |
850 /* prologue end (size=6) */ |
851 04f4 8091 0000 lds r24,NeuerDatensatzEmpfangen |
852 04f8 8823 tst r24 |
853 04fa 09F4 brne .+2 |
854 04fc C7C3 rjmp .L61 |
855 04fe 0E94 0000 call Decode64 |
856 0502 8091 0000 lds r24,RxdBuffer+1 |
857 0506 8236 cpi r24,lo8(98) |
858 0508 09F0 breq .+2 |
859 050a 81C2 rjmp .L119 |
860 050c 8091 0000 lds r24,RxdBuffer+2 |
861 0510 9927 clr r25 |
862 0512 8137 cpi r24,113 |
863 0514 9105 cpc r25,__zero_reg__ |
864 0516 09F4 brne .+2 |
865 0518 C0C0 rjmp .L81 |
866 051a 8237 cpi r24,114 |
867 051c 9105 cpc r25,__zero_reg__ |
868 051e C4F4 brge .L116 |
869 0520 8D36 cpi r24,109 |
870 0522 9105 cpc r25,__zero_reg__ |
871 0524 09F4 brne .+2 |
872 0526 82C0 rjmp .L74 |
873 0528 8E36 cpi r24,110 |
874 052a 9105 cpc r25,__zero_reg__ |
875 052c 44F4 brge .L117 |
876 052e 8B34 cpi r24,75 |
877 0530 9105 cpc r25,__zero_reg__ |
878 0532 31F1 breq .L66 |
879 0534 8636 cpi r24,102 |
880 0536 9105 cpc r25,__zero_reg__ |
881 0538 09F4 brne .+2 |
882 053a 54C1 rjmp .L96 |
883 053c 68C2 rjmp .L119 |
884 .L117: |
885 053e 8E36 cpi r24,110 |
886 0540 9105 cpc r25,__zero_reg__ |
887 0542 09F4 brne .+2 |
888 0544 5BC0 rjmp .L71 |
889 0546 8037 cpi r24,112 |
890 0548 9105 cpc r25,__zero_reg__ |
891 054a 09F4 brne .+2 |
892 054c 9FC0 rjmp .L80 |
893 054e 5FC2 rjmp .L119 |
894 .L116: |
895 0550 8537 cpi r24,117 |
896 0552 9105 cpc r25,__zero_reg__ |
897 0554 09F4 brne .+2 |
898 0556 E2C1 rjmp .L103 |
899 0558 8637 cpi r24,118 |
900 055a 9105 cpc r25,__zero_reg__ |
901 055c 44F4 brge .L118 |
902 055e 8337 cpi r24,115 |
903 0560 9105 cpc r25,__zero_reg__ |
904 0562 09F4 brne .+2 |
905 0564 DCC0 rjmp .L89 |
906 0566 8437 cpi r24,116 |
907 0568 9105 cpc r25,__zero_reg__ |
908 056a 39F1 breq .L67 |
909 056c 50C2 rjmp .L119 |
910 .L118: |
911 056e 8737 cpi r24,119 |
912 0570 9105 cpc r25,__zero_reg__ |
913 0572 09F4 brne .+2 |
914 0574 10C2 rjmp .L109 |
915 0576 8937 cpi r24,121 |
916 0578 9105 cpc r25,__zero_reg__ |
917 057a 09F4 brne .+2 |
918 057c 6AC1 rjmp .L102 |
919 057e 47C2 rjmp .L119 |
920 .L66: |
921 0580 E091 0000 lds r30,pRxData |
922 0584 F091 0000 lds r31,(pRxData)+1 |
923 0588 8081 ld r24,Z |
924 058a 9181 ldd r25,Z+1 |
925 058c 9093 0000 sts (KompassValue)+1,r25 |
926 0590 8093 0000 sts KompassValue,r24 |
927 0594 2091 0000 lds r18,KompassStartwert |
928 0598 3091 0000 lds r19,(KompassStartwert)+1 |
929 059c 821B sub r24,r18 |
930 059e 930B sbc r25,r19 |
931 05a0 845E subi r24,lo8(-(540)) |
932 05a2 9D4F sbci r25,hi8(-(540)) |
933 05a4 68E6 ldi r22,lo8(360) |
934 05a6 71E0 ldi r23,hi8(360) |
935 05a8 0E94 0000 call __divmodhi4 |
936 05ac 845B subi r24,lo8(-(-180)) |
937 05ae 9040 sbci r25,hi8(-(-180)) |
938 05b0 9093 0000 sts (KompassRichtung)+1,r25 |
939 05b4 8093 0000 sts KompassRichtung,r24 |
940 05b8 2AC2 rjmp .L119 |
941 .L67: |
942 05ba 8091 0000 lds r24,AnzahlEmpfangsBytes |
943 05be A091 0000 lds r26,pRxData |
944 05c2 B091 0000 lds r27,(pRxData)+1 |
945 05c6 8531 cpi r24,lo8(21) |
946 05c8 40F0 brlo .L68 |
947 05ca 80E1 ldi r24,lo8(16) |
948 05cc E0E0 ldi r30,lo8(MotorTest) |
949 05ce F0E0 ldi r31,hi8(MotorTest) |
950 05d0 0D90 ld __tmp_reg__,X+ |
951 05d2 0192 st Z+,__tmp_reg__ |
952 05d4 8A95 dec r24 |
953 05d6 E1F7 brne .-8 |
954 05d8 0DC0 rjmp .L69 |
955 .L68: |
956 05da 8D91 ld r24,X+ |
957 05dc 9D91 ld r25,X+ |
958 05de 0D90 ld __tmp_reg__,X+ |
959 05e0 BC91 ld r27,X |
960 05e2 A02D mov r26,__tmp_reg__ |
961 05e4 8093 0000 sts MotorTest,r24 |
962 05e8 9093 0000 sts (MotorTest)+1,r25 |
963 05ec A093 0000 sts (MotorTest)+2,r26 |
964 05f0 B093 0000 sts (MotorTest)+3,r27 |
965 .L69: |
966 05f4 80EF ldi r24,lo8(-16) |
967 05f6 8093 0000 sts PC_MotortestActive,r24 |
968 05fa 4BC0 rjmp .L148 |
969 .L71: |
970 05fc 8091 0000 lds r24,UebertragungAbgeschlossen |
971 0600 8823 tst r24 |
972 0602 E1F3 breq .L71 |
973 0604 8DE4 ldi r24,lo8(77) |
974 0606 90E0 ldi r25,hi8(77) |
975 0608 9F93 push r25 |
976 060a 8F93 push r24 |
977 060c 80E0 ldi r24,lo8(Mixer) |
978 060e 90E0 ldi r25,hi8(Mixer) |
979 0610 9F93 push r25 |
980 0612 8F93 push r24 |
981 0614 81E0 ldi r24,lo8(1) |
982 0616 8F93 push r24 |
983 0618 8F93 push r24 |
984 061a 8EE4 ldi r24,lo8(78) |
985 061c 8F93 push r24 |
986 061e 0E94 0000 call SendOutData |
987 0622 8DB7 in r24,__SP_L__ |
988 0624 9EB7 in r25,__SP_H__ |
989 0626 0796 adiw r24,7 |
990 0628 8DBF out __SP_L__,r24 |
991 062a F1C1 rjmp .L119 |
992 .L74: |
993 062c A091 0000 lds r26,pRxData |
994 0630 B091 0000 lds r27,(pRxData)+1 |
995 0634 1C91 ld r17,X |
996 0636 1130 cpi r17,lo8(1) |
997 0638 81F4 brne .L75 |
998 063a 8DE4 ldi r24,lo8(77) |
999 063c E0E0 ldi r30,lo8(Mixer) |
1000 063e F0E0 ldi r31,hi8(Mixer) |
1001 0640 0D90 ld __tmp_reg__,X+ |
1002 0642 0192 st Z+,__tmp_reg__ |
1003 0644 8A95 dec r24 |
1004 0646 E1F7 brne .-8 |
1005 0648 0E94 0000 call MixerTable_WriteToEEProm |
1006 064c 1983 std Y+1,r17 |
1007 064e 8091 0000 lds r24,VersionInfo+6 |
1008 0652 8F7E andi r24,lo8(-17) |
1009 0654 8093 0000 sts VersionInfo+6,r24 |
1010 0658 01C0 rjmp .L77 |
1011 .L75: |
1012 065a 1982 std Y+1,__zero_reg__ |
1013 .L77: |
1014 065c 8091 0000 lds r24,UebertragungAbgeschlossen |
1015 0660 8823 tst r24 |
1016 0662 E1F3 breq .L77 |
1017 0664 81E0 ldi r24,lo8(1) |
1018 0666 90E0 ldi r25,hi8(1) |
1019 0668 9F93 push r25 |
1020 066a 8F93 push r24 |
1021 066c CE01 movw r24,r28 |
1022 066e 0196 adiw r24,1 |
1023 0670 9F93 push r25 |
1024 0672 8F93 push r24 |
1025 0674 81E0 ldi r24,lo8(1) |
1026 0676 8F93 push r24 |
1027 0678 8F93 push r24 |
1028 067a 8DE4 ldi r24,lo8(77) |
1029 067c 8F93 push r24 |
1030 067e 0E94 0000 call SendOutData |
1031 0682 ADB7 in r26,__SP_L__ |
1032 0684 BEB7 in r27,__SP_H__ |
1033 0686 1796 adiw r26,7 |
1034 0688 ADBF out __SP_L__,r26 |
1035 068a C1C1 rjmp .L119 |
1036 .L80: |
1037 068c 81E0 ldi r24,lo8(1) |
1038 068e 8093 0000 sts GetPPMChannelAnforderung,r24 |
1039 .L148: |
1040 0692 8FEF ldi r24,lo8(-1) |
1041 0694 8093 0000 sts PcZugriff,r24 |
1042 0698 BAC1 rjmp .L119 |
1043 .L81: |
1044 069a E091 0000 lds r30,pRxData |
1045 069e F091 0000 lds r31,(pRxData)+1 |
1046 06a2 8081 ld r24,Z |
1047 06a4 8F3F cpi r24,lo8(-1) |
1048 06a6 39F4 brne .L82 |
1049 06a8 0E94 0000 call GetActiveParamSet |
1050 06ac E091 0000 lds r30,pRxData |
1051 06b0 F091 0000 lds r31,(pRxData)+1 |
1052 06b4 8083 st Z,r24 |
1053 .L82: |
1054 06b6 E091 0000 lds r30,pRxData |
1055 06ba F091 0000 lds r31,(pRxData)+1 |
1056 06be 8081 ld r24,Z |
1057 06c0 8823 tst r24 |
1058 06c2 11F4 brne .L83 |
1059 06c4 81E0 ldi r24,lo8(1) |
1060 06c6 03C0 rjmp .L146 |
1061 .L83: |
1062 06c8 8630 cpi r24,lo8(6) |
1063 06ca 10F0 brlo .L84 |
1064 06cc 85E0 ldi r24,lo8(5) |
1065 .L146: |
1066 06ce 8083 st Z,r24 |
1067 .L84: |
1068 06d0 E091 0000 lds r30,pRxData |
1069 06d4 F091 0000 lds r31,(pRxData)+1 |
1070 06d8 8081 ld r24,Z |
1071 06da 0E94 0000 call ParamSet_ReadFromEEProm |
1072 06de E091 0000 lds r30,pRxData |
1073 06e2 F091 0000 lds r31,(pRxData)+1 |
1074 06e6 8081 ld r24,Z |
1075 06e8 8983 std Y+1,r24 |
1076 .L86: |
1077 06ea 8091 0000 lds r24,UebertragungAbgeschlossen |
1078 06ee 8823 tst r24 |
1079 06f0 E1F3 breq .L86 |
1080 06f2 80E7 ldi r24,lo8(112) |
1081 06f4 90E0 ldi r25,hi8(112) |
1082 06f6 9F93 push r25 |
1083 06f8 8F93 push r24 |
1084 06fa 80E0 ldi r24,lo8(EE_Parameter) |
1085 06fc 90E0 ldi r25,hi8(EE_Parameter) |
1086 06fe 9F93 push r25 |
1087 0700 8F93 push r24 |
1088 0702 81E0 ldi r24,lo8(1) |
1089 0704 90E0 ldi r25,hi8(1) |
1090 0706 9F93 push r25 |
1091 0708 8F93 push r24 |
1092 070a CE01 movw r24,r28 |
1093 070c 0196 adiw r24,1 |
1094 070e 9F93 push r25 |
1095 0710 8F93 push r24 |
1096 0712 82E0 ldi r24,lo8(2) |
1097 0714 8F93 push r24 |
1098 0716 81E0 ldi r24,lo8(1) |
1099 0718 8F93 push r24 |
1100 071a 81E5 ldi r24,lo8(81) |
1101 071c 71C1 rjmp .L151 |
1102 .L89: |
1103 071e 2091 0000 lds r18,pRxData |
1104 0722 3091 0000 lds r19,(pRxData)+1 |
1105 0726 D901 movw r26,r18 |
1106 0728 8C91 ld r24,X |
1107 072a 8150 subi r24,lo8(-(-1)) |
1108 072c 8530 cpi r24,lo8(5) |
1109 072e 08F0 brlo .+2 |
1110 0730 40C0 rjmp .L90 |
1111 0732 F901 movw r30,r18 |
1112 0734 8181 ldd r24,Z+1 |
1113 0736 8435 cpi r24,lo8(84) |
1114 0738 E1F5 brne .L90 |
1115 073a 2F5F subi r18,lo8(-(1)) |
1116 073c 3F4F sbci r19,hi8(-(1)) |
1117 073e 80E7 ldi r24,lo8(112) |
1118 0740 E0E0 ldi r30,lo8(EE_Parameter) |
1119 0742 F0E0 ldi r31,hi8(EE_Parameter) |
1120 0744 D901 movw r26,r18 |
1121 0746 0D90 ld __tmp_reg__,X+ |
1122 0748 0192 st Z+,__tmp_reg__ |
1123 074a 8A95 dec r24 |
1124 074c E1F7 brne .-8 |
1125 074e F901 movw r30,r18 |
1126 0750 8291 ld r24,-Z |
1127 0752 0E94 0000 call ParamSet_WriteToEEProm |
1128 0756 8091 0000 lds r24,EE_Parameter+63 |
1129 075a 9927 clr r25 |
1130 075c AA27 clr r26 |
1131 075e BB27 clr r27 |
1132 0760 BC01 movw r22,r24 |
1133 0762 CD01 movw r24,r26 |
1134 0764 24EC ldi r18,lo8(2500) |
1135 0766 39E0 ldi r19,hi8(2500) |
1136 0768 40E0 ldi r20,hlo8(2500) |
1137 076a 50E0 ldi r21,hhi8(2500) |
1138 076c 0E94 0000 call __mulsi3 |
1139 0770 DC01 movw r26,r24 |
1140 0772 CB01 movw r24,r22 |
1141 0774 8093 0000 sts Umschlag180Nick,r24 |
1142 0778 9093 0000 sts (Umschlag180Nick)+1,r25 |
1143 077c A093 0000 sts (Umschlag180Nick)+2,r26 |
1144 0780 B093 0000 sts (Umschlag180Nick)+3,r27 |
1145 0784 8091 0000 lds r24,EE_Parameter+64 |
1146 0788 9927 clr r25 |
1147 078a AA27 clr r26 |
1148 078c BB27 clr r27 |
1149 078e BC01 movw r22,r24 |
1150 0790 CD01 movw r24,r26 |
1151 0792 0E94 0000 call __mulsi3 |
1152 0796 DC01 movw r26,r24 |
1153 0798 CB01 movw r24,r22 |
1154 079a 8093 0000 sts Umschlag180Roll,r24 |
1155 079e 9093 0000 sts (Umschlag180Roll)+1,r25 |
1156 07a2 A093 0000 sts (Umschlag180Roll)+2,r26 |
1157 07a6 B093 0000 sts (Umschlag180Roll)+3,r27 |
1158 07aa 0E94 0000 call GetActiveParamSet |
1159 07ae 8983 std Y+1,r24 |
1160 07b0 01C0 rjmp .L92 |
1161 .L90: |
1162 07b2 1982 std Y+1,__zero_reg__ |
1163 .L92: |
1164 07b4 8091 0000 lds r24,UebertragungAbgeschlossen |
1165 07b8 8823 tst r24 |
1166 07ba E1F3 breq .L92 |
1167 07bc 81E0 ldi r24,lo8(1) |
1168 07be 90E0 ldi r25,hi8(1) |
1169 07c0 9F93 push r25 |
1170 07c2 8F93 push r24 |
1171 07c4 CE01 movw r24,r28 |
1172 07c6 0196 adiw r24,1 |
1173 07c8 9F93 push r25 |
1174 07ca 8F93 push r24 |
1175 07cc 81E0 ldi r24,lo8(1) |
1176 07ce 8F93 push r24 |
1177 07d0 8F93 push r24 |
1178 07d2 83E5 ldi r24,lo8(83) |
1179 07d4 8F93 push r24 |
1180 07d6 0E94 0000 call SendOutData |
1181 07da 8DB7 in r24,__SP_L__ |
1182 07dc 9EB7 in r25,__SP_H__ |
1183 07de 0796 adiw r24,7 |
1184 07e0 8DBF out __SP_L__,r24 |
1185 07e2 26C0 rjmp .L152 |
1186 .L96: |
1187 07e4 E091 0000 lds r30,pRxData |
1188 07e8 F091 0000 lds r31,(pRxData)+1 |
1189 07ec E081 ld r30,Z |
1190 07ee 8E2F mov r24,r30 |
1191 07f0 8150 subi r24,lo8(-(-1)) |
1192 07f2 8530 cpi r24,lo8(5) |
1193 07f4 18F4 brsh .L97 |
1194 07f6 8E2F mov r24,r30 |
1195 07f8 0E94 0000 call ParamSet_ReadFromEEProm |
1196 .L97: |
1197 07fc 0E94 0000 call GetActiveParamSet |
1198 0800 8983 std Y+1,r24 |
1199 .L98: |
1200 0802 8091 0000 lds r24,UebertragungAbgeschlossen |
1201 0806 8823 tst r24 |
1202 0808 E1F3 breq .L98 |
1203 080a 81E0 ldi r24,lo8(1) |
1204 080c 90E0 ldi r25,hi8(1) |
1205 080e 9F93 push r25 |
1206 0810 8F93 push r24 |
1207 0812 CE01 movw r24,r28 |
1208 0814 0196 adiw r24,1 |
1209 0816 9F93 push r25 |
1210 0818 8F93 push r24 |
1211 081a 81E0 ldi r24,lo8(1) |
1212 081c 8F93 push r24 |
1213 081e 8F93 push r24 |
1214 0820 86E4 ldi r24,lo8(70) |
1215 0822 8F93 push r24 |
1216 0824 0E94 0000 call SendOutData |
1217 0828 ADB7 in r26,__SP_L__ |
1218 082a BEB7 in r27,__SP_H__ |
1219 082c 1796 adiw r26,7 |
1220 082e ADBF out __SP_L__,r26 |
1221 .L152: |
1222 0830 8091 0000 lds r24,MotorenEin |
1223 0834 8823 tst r24 |
1224 0836 29F4 brne .L101 |
1225 0838 6EE6 ldi r22,lo8(110) |
1226 083a 70E0 ldi r23,hi8(110) |
1227 083c 8981 ldd r24,Y+1 |
1228 083e 0E94 0000 call Piep |
1229 .L101: |
1230 0842 80E0 ldi r24,lo8(0) |
1231 0844 0E94 0000 call LipoDetection |
1232 0848 8091 0000 lds r24,EE_Parameter+39 |
1233 084c 0E94 0000 call LIBFC_ReceiverInit |
1234 0850 DEC0 rjmp .L119 |
1235 .L102: |
1236 0852 E091 0000 lds r30,pRxData |
1237 0856 F091 0000 lds r31,(pRxData)+1 |
1238 085a 8081 ld r24,Z |
1239 085c 9927 clr r25 |
1240 085e 87FD sbrc r24,7 |
1241 0860 9095 com r25 |
1242 0862 9093 0000 sts (PPM_in+26)+1,r25 |
1243 0866 8093 0000 sts PPM_in+26,r24 |
1244 086a 8181 ldd r24,Z+1 |
1245 086c 9927 clr r25 |
1246 086e 87FD sbrc r24,7 |
1247 0870 9095 com r25 |
1248 0872 9093 0000 sts (PPM_in+28)+1,r25 |
1249 0876 8093 0000 sts PPM_in+28,r24 |
1250 087a 8281 ldd r24,Z+2 |
1251 087c 9927 clr r25 |
1252 087e 87FD sbrc r24,7 |
1253 0880 9095 com r25 |
1254 0882 9093 0000 sts (PPM_in+30)+1,r25 |
1255 0886 8093 0000 sts PPM_in+30,r24 |
1256 088a 8381 ldd r24,Z+3 |
1257 088c 9927 clr r25 |
1258 088e 87FD sbrc r24,7 |
1259 0890 9095 com r25 |
1260 0892 9093 0000 sts (PPM_in+32)+1,r25 |
1261 0896 8093 0000 sts PPM_in+32,r24 |
1262 089a 8481 ldd r24,Z+4 |
1263 089c 9927 clr r25 |
1264 089e 87FD sbrc r24,7 |
1265 08a0 9095 com r25 |
1266 08a2 9093 0000 sts (PPM_in+34)+1,r25 |
1267 08a6 8093 0000 sts PPM_in+34,r24 |
1268 08aa 8581 ldd r24,Z+5 |
1269 08ac 9927 clr r25 |
1270 08ae 87FD sbrc r24,7 |
1271 08b0 9095 com r25 |
1272 08b2 9093 0000 sts (PPM_in+36)+1,r25 |
1273 08b6 8093 0000 sts PPM_in+36,r24 |
1274 08ba 8681 ldd r24,Z+6 |
1275 08bc 9927 clr r25 |
1276 08be 87FD sbrc r24,7 |
1277 08c0 9095 com r25 |
1278 08c2 9093 0000 sts (PPM_in+38)+1,r25 |
1279 08c6 8093 0000 sts PPM_in+38,r24 |
1280 08ca 8781 ldd r24,Z+7 |
1281 08cc 9927 clr r25 |
1282 08ce 87FD sbrc r24,7 |
1283 08d0 9095 com r25 |
1284 08d2 9093 0000 sts (PPM_in+40)+1,r25 |
1285 08d6 8093 0000 sts PPM_in+40,r24 |
1286 08da 8085 ldd r24,Z+8 |
1287 08dc 9927 clr r25 |
1288 08de 87FD sbrc r24,7 |
1289 08e0 9095 com r25 |
1290 08e2 9093 0000 sts (PPM_in+42)+1,r25 |
1291 08e6 8093 0000 sts PPM_in+42,r24 |
1292 08ea 8185 ldd r24,Z+9 |
1293 08ec 9927 clr r25 |
1294 08ee 87FD sbrc r24,7 |
1295 08f0 9095 com r25 |
1296 08f2 9093 0000 sts (PPM_in+44)+1,r25 |
1297 08f6 8093 0000 sts PPM_in+44,r24 |
1298 08fa 8285 ldd r24,Z+10 |
1299 08fc 9927 clr r25 |
1300 08fe 87FD sbrc r24,7 |
1301 0900 9095 com r25 |
1302 0902 9093 0000 sts (PPM_in+46)+1,r25 |
1303 0906 8093 0000 sts PPM_in+46,r24 |
1304 090a 8385 ldd r24,Z+11 |
1305 090c 9927 clr r25 |
1306 090e 87FD sbrc r24,7 |
1307 0910 9095 com r25 |
1308 0912 9093 0000 sts (PPM_in+48)+1,r25 |
1309 0916 8093 0000 sts PPM_in+48,r24 |
1310 091a 79C0 rjmp .L119 |
1311 .L103: |
1312 091c E091 0000 lds r30,pRxData |
1313 0920 F091 0000 lds r31,(pRxData)+1 |
1314 0924 8081 ld r24,Z |
1315 0926 0E94 0000 call I2C_ReadBLConfig |
1316 092a 8A83 std Y+2,r24 |
1317 092c 8823 tst r24 |
1318 092e 19F4 brne .L104 |
1319 0930 81E0 ldi r24,lo8(1) |
1320 0932 8983 std Y+1,r24 |
1321 0934 01C0 rjmp .L106 |
1322 .L104: |
1323 0936 1982 std Y+1,__zero_reg__ |
1324 .L106: |
1325 0938 8091 0000 lds r24,UebertragungAbgeschlossen |
1326 093c 8823 tst r24 |
1327 093e E1F3 breq .L106 |
1328 0940 88E0 ldi r24,lo8(8) |
1329 0942 90E0 ldi r25,hi8(8) |
1330 0944 9F93 push r25 |
1331 0946 8F93 push r24 |
1332 0948 80E0 ldi r24,lo8(BLConfig) |
1333 094a 90E0 ldi r25,hi8(BLConfig) |
1334 094c 9F93 push r25 |
1335 094e 8F93 push r24 |
1336 0950 21E0 ldi r18,lo8(1) |
1337 0952 30E0 ldi r19,hi8(1) |
1338 0954 3F93 push r19 |
1339 0956 2F93 push r18 |
1340 0958 8091 0000 lds r24,pRxData |
1341 095c 9091 0000 lds r25,(pRxData)+1 |
1342 0960 9F93 push r25 |
1343 0962 8F93 push r24 |
1344 0964 3F93 push r19 |
1345 0966 2F93 push r18 |
1346 0968 CE01 movw r24,r28 |
1347 096a 0296 adiw r24,2 |
1348 096c 9F93 push r25 |
1349 096e 8F93 push r24 |
1350 0970 3F93 push r19 |
1351 0972 2F93 push r18 |
1352 0974 CE01 movw r24,r28 |
1353 0976 820F add r24,r18 |
1354 0978 931F adc r25,r19 |
1355 097a 9F93 push r25 |
1356 097c 8F93 push r24 |
1357 097e 84E0 ldi r24,lo8(4) |
1358 0980 8F93 push r24 |
1359 0982 81E0 ldi r24,lo8(1) |
1360 0984 8F93 push r24 |
1361 0986 85E5 ldi r24,lo8(85) |
1362 0988 8F93 push r24 |
1363 098a 0E94 0000 call SendOutData |
1364 098e EDB7 in r30,__SP_L__ |
1365 0990 FEB7 in r31,__SP_H__ |
1366 0992 7396 adiw r30,19 |
1367 0994 3BC0 rjmp .L147 |
1368 .L109: |
1369 0996 8091 0000 lds r24,RxDataLen |
1370 099a 8930 cpi r24,lo8(9) |
1371 099c C0F1 brlo .L119 |
1372 099e 2091 0000 lds r18,pRxData |
1373 09a2 3091 0000 lds r19,(pRxData)+1 |
1374 09a6 2F5F subi r18,lo8(-(1)) |
1375 09a8 3F4F sbci r19,hi8(-(1)) |
1376 09aa 88E0 ldi r24,lo8(8) |
1377 09ac A0E0 ldi r26,lo8(BLConfig) |
1378 09ae B0E0 ldi r27,hi8(BLConfig) |
1379 09b0 F901 movw r30,r18 |
1380 09b2 0190 ld __tmp_reg__,Z+ |
1381 09b4 0D92 st X+,__tmp_reg__ |
1382 09b6 8A95 dec r24 |
1383 09b8 E1F7 brne .-8 |
1384 09ba D901 movw r26,r18 |
1385 09bc 8E91 ld r24,-X |
1386 09be 0E94 0000 call I2C_WriteBLConfig |
1387 09c2 8A83 std Y+2,r24 |
1388 09c4 8823 tst r24 |
1389 09c6 19F4 brne .L111 |
1390 09c8 81E0 ldi r24,lo8(1) |
1391 09ca 8983 std Y+1,r24 |
1392 09cc 01C0 rjmp .L113 |
1393 .L111: |
1394 09ce 1982 std Y+1,__zero_reg__ |
1395 .L113: |
1396 09d0 8091 0000 lds r24,UebertragungAbgeschlossen |
1397 09d4 8823 tst r24 |
1398 09d6 E1F3 breq .L113 |
1399 09d8 21E0 ldi r18,lo8(1) |
1400 09da 30E0 ldi r19,hi8(1) |
1401 09dc 3F93 push r19 |
1402 09de 2F93 push r18 |
1403 09e0 CE01 movw r24,r28 |
1404 09e2 0296 adiw r24,2 |
1405 09e4 9F93 push r25 |
1406 09e6 8F93 push r24 |
1407 09e8 3F93 push r19 |
1408 09ea 2F93 push r18 |
1409 09ec CE01 movw r24,r28 |
1410 09ee 820F add r24,r18 |
1411 09f0 931F adc r25,r19 |
1412 09f2 9F93 push r25 |
1413 09f4 8F93 push r24 |
1414 09f6 82E0 ldi r24,lo8(2) |
1415 09f8 8F93 push r24 |
1416 09fa 81E0 ldi r24,lo8(1) |
1417 09fc 8F93 push r24 |
1418 09fe 87E5 ldi r24,lo8(87) |
1419 .L151: |
1420 0a00 8F93 push r24 |
1421 0a02 0E94 0000 call SendOutData |
1422 0a06 EDB7 in r30,__SP_L__ |
1423 0a08 FEB7 in r31,__SP_H__ |
1424 0a0a 3B96 adiw r30,11 |
1425 .L147: |
1426 0a0c EDBF out __SP_L__,r30 |
1427 .L119: |
1428 0a0e 8091 0000 lds r24,RxdBuffer+2 |
1429 0a12 9927 clr r25 |
1430 0a14 8436 cpi r24,100 |
1431 0a16 9105 cpc r25,__zero_reg__ |
1432 0a18 09F4 brne .+2 |
1433 0a1a CDC0 rjmp .L134 |
1434 0a1c 8536 cpi r24,101 |
1435 0a1e 9105 cpc r25,__zero_reg__ |
1436 0a20 ACF4 brge .L143 |
1437 0a22 8136 cpi r24,97 |
1438 0a24 9105 cpc r25,__zero_reg__ |
1439 0a26 09F4 brne .+2 |
1440 0a28 81C0 rjmp .L128 |
1441 0a2a 8236 cpi r24,98 |
1442 0a2c 9105 cpc r25,__zero_reg__ |
1443 0a2e 2CF4 brge .L144 |
1444 0a30 8B34 cpi r24,75 |
1445 0a32 9105 cpc r25,__zero_reg__ |
1446 0a34 09F4 brne .+2 |
1447 0a36 5DC0 rjmp .L127 |
1448 0a38 21C1 rjmp .L63 |
1449 .L144: |
1450 0a3a 8236 cpi r24,98 |
1451 0a3c 9105 cpc r25,__zero_reg__ |
1452 0a3e 09F4 brne .+2 |
1453 0a40 82C0 rjmp .L130 |
1454 0a42 8336 cpi r24,99 |
1455 0a44 9105 cpc r25,__zero_reg__ |
1456 0a46 09F4 brne .+2 |
1457 0a48 91C0 rjmp .L131 |
1458 0a4a 18C1 rjmp .L63 |
1459 .L143: |
1460 0a4c 8C36 cpi r24,108 |
1461 0a4e 9105 cpc r25,__zero_reg__ |
1462 0a50 09F4 brne .+2 |
1463 0a52 FFC0 rjmp .L139 |
1464 0a54 8D36 cpi r24,109 |
1465 0a56 9105 cpc r25,__zero_reg__ |
1466 0a58 4CF4 brge .L145 |
1467 0a5a 8736 cpi r24,103 |
1468 0a5c 9105 cpc r25,__zero_reg__ |
1469 0a5e 09F4 brne .+2 |
1470 0a60 0AC1 rjmp .L141 |
1471 0a62 8836 cpi r24,104 |
1472 0a64 9105 cpc r25,__zero_reg__ |
1473 0a66 09F4 brne .+2 |
1474 0a68 C4C0 rjmp .L136 |
1475 0a6a 08C1 rjmp .L63 |
1476 .L145: |
1477 0a6c 8437 cpi r24,116 |
1478 0a6e 9105 cpc r25,__zero_reg__ |
1479 0a70 29F0 breq .L121 |
1480 0a72 8637 cpi r24,118 |
1481 0a74 9105 cpc r25,__zero_reg__ |
1482 0a76 09F4 brne .+2 |
1483 0a78 FAC0 rjmp .L140 |
1484 0a7a 00C1 rjmp .L63 |
1485 .L121: |
1486 0a7c 8091 0000 lds r24,AnzahlEmpfangsBytes |
1487 0a80 A091 0000 lds r26,pRxData |
1488 0a84 B091 0000 lds r27,(pRxData)+1 |
1489 0a88 8031 cpi r24,lo8(16) |
1490 0a8a 40F0 brlo .L122 |
1491 0a8c 80E1 ldi r24,lo8(16) |
1492 0a8e E0E0 ldi r30,lo8(MotorTest) |
1493 0a90 F0E0 ldi r31,hi8(MotorTest) |
1494 0a92 0D90 ld __tmp_reg__,X+ |
1495 0a94 0192 st Z+,__tmp_reg__ |
1496 0a96 8A95 dec r24 |
1497 0a98 E1F7 brne .-8 |
1498 0a9a 0DC0 rjmp .L124 |
1499 .L122: |
1500 0a9c 8D91 ld r24,X+ |
1501 0a9e 9D91 ld r25,X+ |
1502 0aa0 0D90 ld __tmp_reg__,X+ |
1503 0aa2 BC91 ld r27,X |
1504 0aa4 A02D mov r26,__tmp_reg__ |
1505 0aa6 8093 0000 sts MotorTest,r24 |
1506 0aaa 9093 0000 sts (MotorTest)+1,r25 |
1507 0aae A093 0000 sts (MotorTest)+2,r26 |
1508 0ab2 B093 0000 sts (MotorTest)+3,r27 |
1509 .L124: |
1510 0ab6 8091 0000 lds r24,UebertragungAbgeschlossen |
1511 0aba 8823 tst r24 |
1512 0abc E1F3 breq .L124 |
1513 0abe 1F92 push __zero_reg__ |
1514 0ac0 8091 0000 lds r24,MeineSlaveAdresse |
1515 0ac4 8F93 push r24 |
1516 0ac6 84E5 ldi r24,lo8(84) |
1517 0ac8 8F93 push r24 |
1518 0aca 0E94 0000 call SendOutData |
1519 0ace 8AEF ldi r24,lo8(-6) |
1520 0ad0 8093 0000 sts PC_MotortestActive,r24 |
1521 0ad4 8FEF ldi r24,lo8(-1) |
1522 0ad6 8093 0000 sts PcZugriff,r24 |
1523 0ada 80EA ldi r24,lo8(4000) |
1524 0adc 9FE0 ldi r25,hi8(4000) |
1525 0ade 0E94 0000 call SetDelay |
1526 0ae2 9093 0000 sts (AboTimeOut)+1,r25 |
1527 0ae6 8093 0000 sts AboTimeOut,r24 |
1528 0aea 0F90 pop __tmp_reg__ |
1529 0aec 0F90 pop __tmp_reg__ |
1530 0aee 0F90 pop __tmp_reg__ |
1531 0af0 C5C0 rjmp .L63 |
1532 .L127: |
1533 0af2 E091 0000 lds r30,pRxData |
1534 0af6 F091 0000 lds r31,(pRxData)+1 |
1535 0afa 8081 ld r24,Z |
1536 0afc 9181 ldd r25,Z+1 |
1537 0afe 9093 0000 sts (KompassValue)+1,r25 |
1538 0b02 8093 0000 sts KompassValue,r24 |
1539 0b06 2091 0000 lds r18,KompassStartwert |
1540 0b0a 3091 0000 lds r19,(KompassStartwert)+1 |
1541 0b0e 821B sub r24,r18 |
1542 0b10 930B sbc r25,r19 |
1543 0b12 845E subi r24,lo8(-(540)) |
1544 0b14 9D4F sbci r25,hi8(-(540)) |
1545 0b16 68E6 ldi r22,lo8(360) |
1546 0b18 71E0 ldi r23,hi8(360) |
1547 0b1a 0E94 0000 call __divmodhi4 |
1548 0b1e 845B subi r24,lo8(-(-180)) |
1549 0b20 9040 sbci r25,hi8(-(-180)) |
1550 0b22 9093 0000 sts (KompassRichtung)+1,r25 |
1551 0b26 8093 0000 sts KompassRichtung,r24 |
1552 0b2a A8C0 rjmp .L63 |
1553 .L128: |
1554 0b2c E091 0000 lds r30,pRxData |
1555 0b30 F091 0000 lds r31,(pRxData)+1 |
1556 0b34 8081 ld r24,Z |
1557 0b36 8093 0000 sts DebugTextAnforderung,r24 |
1558 0b3a 8032 cpi r24,lo8(32) |
1559 0b3c 98F0 brlo .L149 |
1560 0b3e 8FE1 ldi r24,lo8(31) |
1561 0b40 8093 0000 sts DebugTextAnforderung,r24 |
1562 0b44 0FC0 rjmp .L149 |
1563 .L130: |
1564 0b46 A091 0000 lds r26,pRxData |
1565 0b4a B091 0000 lds r27,(pRxData)+1 |
1566 0b4e 8BE0 ldi r24,lo8(11) |
1567 0b50 E0E0 ldi r30,lo8(ExternControl) |
1568 0b52 F0E0 ldi r31,hi8(ExternControl) |
1569 0b54 0D90 ld __tmp_reg__,X+ |
1570 0b56 0192 st Z+,__tmp_reg__ |
1571 0b58 8A95 dec r24 |
1572 0b5a E1F7 brne .-8 |
1573 0b5c 8091 0000 lds r24,ExternControl+9 |
1574 0b60 8093 0000 sts ConfirmFrame,r24 |
1575 .L149: |
1576 0b64 8FEF ldi r24,lo8(-1) |
1577 0b66 8093 0000 sts PcZugriff,r24 |
1578 0b6a 88C0 rjmp .L63 |
1579 .L131: |
1580 0b6c 8091 0000 lds r24,Intervall3D |
1581 0b70 9091 0000 lds r25,(Intervall3D)+1 |
1582 0b74 892B or r24,r25 |
1583 0b76 89F4 brne .L132 |
1584 0b78 E091 0000 lds r30,pRxData |
1585 0b7c F091 0000 lds r31,(pRxData)+1 |
1586 0b80 E081 ld r30,Z |
1587 0b82 EE23 tst r30 |
1588 0b84 51F0 breq .L132 |
1589 0b86 8AE0 ldi r24,lo8(10) |
1590 0b88 E89F mul r30,r24 |
1591 0b8a C001 movw r24,r0 |
1592 0b8c 1124 clr r1 |
1593 0b8e 0E94 0000 call SetDelay |
1594 0b92 9093 0000 sts (Timer3D)+1,r25 |
1595 0b96 8093 0000 sts Timer3D,r24 |
1596 .L132: |
1597 0b9a E091 0000 lds r30,pRxData |
1598 0b9e F091 0000 lds r31,(pRxData)+1 |
1599 0ba2 9081 ld r25,Z |
1600 0ba4 8AE0 ldi r24,lo8(10) |
1601 0ba6 989F mul r25,r24 |
1602 0ba8 C001 movw r24,r0 |
1603 0baa 1124 clr r1 |
1604 0bac 9093 0000 sts (Intervall3D)+1,r25 |
1605 0bb0 8093 0000 sts Intervall3D,r24 |
1606 0bb4 15C0 rjmp .L135 |
1607 .L134: |
1608 0bb6 8FEF ldi r24,lo8(-1) |
1609 0bb8 8093 0000 sts PcZugriff,r24 |
1610 0bbc E091 0000 lds r30,pRxData |
1611 0bc0 F091 0000 lds r31,(pRxData)+1 |
1612 0bc4 9081 ld r25,Z |
1613 0bc6 8AE0 ldi r24,lo8(10) |
1614 0bc8 989F mul r25,r24 |
1615 0bca C001 movw r24,r0 |
1616 0bcc 1124 clr r1 |
1617 0bce 9093 0000 sts (DebugDataIntervall)+1,r25 |
1618 0bd2 8093 0000 sts DebugDataIntervall,r24 |
1619 0bd6 892B or r24,r25 |
1620 0bd8 19F0 breq .L135 |
1621 0bda 81E0 ldi r24,lo8(1) |
1622 0bdc 8093 0000 sts DebugDataAnforderung,r24 |
1623 .L135: |
1624 0be0 80EA ldi r24,lo8(4000) |
1625 0be2 9FE0 ldi r25,hi8(4000) |
1626 0be4 0E94 0000 call SetDelay |
1627 0be8 9093 0000 sts (AboTimeOut)+1,r25 |
1628 0bec 8093 0000 sts AboTimeOut,r24 |
1629 0bf0 45C0 rjmp .L63 |
1630 .L136: |
1631 0bf2 8FEF ldi r24,lo8(-1) |
1632 0bf4 8093 0000 sts PcZugriff,r24 |
1633 0bf8 E091 0000 lds r30,pRxData |
1634 0bfc F091 0000 lds r31,(pRxData)+1 |
1635 0c00 9081 ld r25,Z |
1636 0c02 97FD sbrc r25,7 |
1637 0c04 08C0 rjmp .L137 |
1638 0c06 82E0 ldi r24,lo8(2) |
1639 0c08 8093 0000 sts DisplayLine,r24 |
1640 0c0c 1092 0000 sts (Display_Interval)+1,__zero_reg__ |
1641 0c10 1092 0000 sts Display_Interval,__zero_reg__ |
1642 0c14 1AC0 rjmp .L138 |
1643 .L137: |
1644 0c16 9095 com r25 |
1645 0c18 8091 0000 lds r24,RemoteKeys |
1646 0c1c 892B or r24,r25 |
1647 0c1e 8093 0000 sts RemoteKeys,r24 |
1648 0c22 9181 ldd r25,Z+1 |
1649 0c24 8AE0 ldi r24,lo8(10) |
1650 0c26 989F mul r25,r24 |
1651 0c28 C001 movw r24,r0 |
1652 0c2a 1124 clr r1 |
1653 0c2c 9093 0000 sts (Display_Interval)+1,r25 |
1654 0c30 8093 0000 sts Display_Interval,r24 |
1655 0c34 84E0 ldi r24,lo8(4) |
1656 0c36 8093 0000 sts DisplayLine,r24 |
1657 0c3a 80EA ldi r24,lo8(4000) |
1658 0c3c 9FE0 ldi r25,hi8(4000) |
1659 0c3e 0E94 0000 call SetDelay |
1660 0c42 9093 0000 sts (AboTimeOut)+1,r25 |
1661 0c46 8093 0000 sts AboTimeOut,r24 |
1662 .L138: |
1663 0c4a 81E0 ldi r24,lo8(1) |
1664 0c4c 8093 0000 sts DebugDisplayAnforderung,r24 |
1665 0c50 15C0 rjmp .L63 |
1666 .L139: |
1667 0c52 8FEF ldi r24,lo8(-1) |
1668 0c54 8093 0000 sts PcZugriff,r24 |
1669 0c58 E091 0000 lds r30,pRxData |
1670 0c5c F091 0000 lds r31,(pRxData)+1 |
1671 0c60 8081 ld r24,Z |
1672 0c62 8093 0000 sts MenuePunkt,r24 |
1673 0c66 81E0 ldi r24,lo8(1) |
1674 0c68 8093 0000 sts DebugDisplayAnforderung1,r24 |
1675 0c6c 07C0 rjmp .L63 |
1676 .L140: |
1677 0c6e 81E0 ldi r24,lo8(1) |
1678 0c70 8093 0000 sts GetVersionAnforderung,r24 |
1679 0c74 03C0 rjmp .L63 |
1680 .L141: |
1681 0c76 81E0 ldi r24,lo8(1) |
1682 0c78 8093 0000 sts GetExternalControl,r24 |
1683 .L63: |
1684 0c7c 1092 0000 sts NeuerDatensatzEmpfangen,__zero_reg__ |
1685 0c80 1092 0000 sts (pRxData)+1,__zero_reg__ |
1686 0c84 1092 0000 sts pRxData,__zero_reg__ |
1687 0c88 1092 0000 sts RxDataLen,__zero_reg__ |
1688 .L61: |
1689 /* epilogue: frame size=2 */ |
1690 0c8c E3E0 ldi r30,3 |
1691 0c8e CE5F subi r28,-2 |
1692 0c90 0C94 0000 jmp __epilogue_restores__+30 |
1693 /* epilogue end (size=4) */ |
1694 /* function BearbeiteRxDaten size 982 (972) */ |
1696 .global uart_putchar |
1698 uart_putchar: |
1699 /* prologue: frame size=0 */ |
1700 /* prologue end (size=0) */ |
1701 0c94 982F mov r25,r24 |
1702 .L154: |
1703 0c96 8091 C000 lds r24,192 |
1704 0c9a 85FF sbrs r24,5 |
1705 0c9c FCCF rjmp .L154 |
1706 0c9e 9093 C600 sts 198,r25 |
1707 /* epilogue: frame size=0 */ |
1708 0ca2 0895 ret |
1709 /* epilogue end (size=1) */ |
1710 /* function uart_putchar size 8 (7) */ |
1712 .global UART_Init |
1714 UART_Init: |
1715 /* prologue: frame size=0 */ |
1716 0ca4 0F93 push r16 |
1717 0ca6 1F93 push r17 |
1718 /* prologue end (size=2) */ |
1719 0ca8 88E1 ldi r24,lo8(24) |
1720 0caa 8093 C100 sts 193,r24 |
1721 0cae 8091 C000 lds r24,192 |
1722 0cb2 8260 ori r24,lo8(2) |
1723 0cb4 8093 C000 sts 192,r24 |
1724 0cb8 8091 C100 lds r24,193 |
1725 0cbc 8068 ori r24,lo8(-128) |
1726 0cbe 8093 C100 sts 193,r24 |
1727 0cc2 8091 C100 lds r24,193 |
1728 0cc6 8064 ori r24,lo8(64) |
1729 0cc8 8093 C100 sts 193,r24 |
1730 0ccc 00E0 ldi r16,lo8(0) |
1731 0cce 10E0 ldi r17,hi8(0) |
1732 0cd0 0093 C500 sts 197,r16 |
1733 0cd4 8AE2 ldi r24,lo8(42) |
1734 0cd6 90E0 ldi r25,hi8(42) |
1735 0cd8 8093 C400 sts 196,r24 |
1736 0cdc 8091 0000 lds r24,DebugDataIntervall |
1737 0ce0 9091 0000 lds r25,(DebugDataIntervall)+1 |
1738 0ce4 0E94 0000 call SetDelay |
1739 0ce8 9093 0000 sts (Debug_Timer)+1,r25 |
1740 0cec 8093 0000 sts Debug_Timer,r24 |
1741 0cf0 8CED ldi r24,lo8(220) |
1742 0cf2 90E0 ldi r25,hi8(220) |
1743 0cf4 0E94 0000 call SetDelay |
1744 0cf8 9093 0000 sts (Kompass_Timer)+1,r25 |
1745 0cfc 8093 0000 sts Kompass_Timer,r24 |
1746 0d00 1092 0000 sts VersionInfo,__zero_reg__ |
1747 0d04 80E5 ldi r24,lo8(80) |
1748 0d06 8093 0000 sts VersionInfo+1,r24 |
1749 0d0a 86E0 ldi r24,lo8(6) |
1750 0d0c 8093 0000 sts VersionInfo+4,r24 |
1751 0d10 8BE0 ldi r24,lo8(11) |
1752 0d12 8093 0000 sts VersionInfo+2,r24 |
1753 0d16 1092 0000 sts VersionInfo+3,__zero_reg__ |
1754 0d1a 1093 0000 sts (pRxData)+1,r17 |
1755 0d1e 0093 0000 sts pRxData,r16 |
1756 0d22 1092 0000 sts RxDataLen,__zero_reg__ |
1757 /* epilogue: frame size=0 */ |
1758 0d26 1F91 pop r17 |
1759 0d28 0F91 pop r16 |
1760 0d2a 0895 ret |
1761 /* epilogue end (size=3) */ |
1762 /* function UART_Init size 68 (63) */ |
1764 .section .progmem.data |
1767 __c.0: |
1768 0200 2121 2120 .string "!!! INCOMPATIBLE !!!" |
1768 494E 434F |
1768 4D50 4154 |
1768 4942 4C45 |
1768 2021 2121 |
1769 .text |
1770 .global DatenUebertragung |
1772 DatenUebertragung: |
1773 /* prologue: frame size=16 */ |
1774 0d2c A0E1 ldi r26,lo8(16) |
1775 0d2e B0E0 ldi r27,hi8(16) |
1776 0d30 E0E0 ldi r30,pm_lo8(1f) |
1777 0d32 F0E0 ldi r31,pm_hi8(1f) |
1778 0d34 0C94 0000 jmp __prologue_saves__+24 |
1779 1: |
1780 /* prologue end (size=6) */ |
1781 0d38 8091 0000 lds r24,UebertragungAbgeschlossen |
1782 0d3c 8823 tst r24 |
1783 0d3e 09F4 brne .+2 |
1784 0d40 C1C2 rjmp .L158 |
1785 0d42 8091 0000 lds r24,AboTimeOut |
1786 0d46 9091 0000 lds r25,(AboTimeOut)+1 |
1787 0d4a 0E94 0000 call CheckDelay |
1788 0d4e 8823 tst r24 |
1789 0d50 61F0 breq .L160 |
1790 0d52 1092 0000 sts (Display_Interval)+1,__zero_reg__ |
1791 0d56 1092 0000 sts Display_Interval,__zero_reg__ |
1792 0d5a 1092 0000 sts (DebugDataIntervall)+1,__zero_reg__ |
1793 0d5e 1092 0000 sts DebugDataIntervall,__zero_reg__ |
1794 0d62 1092 0000 sts (Intervall3D)+1,__zero_reg__ |
1795 0d66 1092 0000 sts Intervall3D,__zero_reg__ |
1796 .L160: |
1797 0d6a 8091 0000 lds r24,Display_Interval |
1798 0d6e 9091 0000 lds r25,(Display_Interval)+1 |
1799 0d72 892B or r24,r25 |
1800 0d74 41F0 breq .L163 |
1801 0d76 8091 0000 lds r24,Display_Timer |
1802 0d7a 9091 0000 lds r25,(Display_Timer)+1 |
1803 0d7e 0E94 0000 call CheckDelay |
1804 0d82 8823 tst r24 |
1805 0d84 29F4 brne .L162 |
1806 .L163: |
1807 0d86 8091 0000 lds r24,DebugDisplayAnforderung |
1808 0d8a 8823 tst r24 |
1809 0d8c 09F4 brne .+2 |
1810 0d8e 60C0 rjmp .L161 |
1811 .L162: |
1812 0d90 8091 0000 lds r24,UebertragungAbgeschlossen |
1813 0d94 8823 tst r24 |
1814 0d96 09F4 brne .+2 |
1815 0d98 5BC0 rjmp .L161 |
1816 0d9a 8091 0000 lds r24,DisplayLine |
1817 0d9e 00E0 ldi r16,lo8(DisplayBuff) |
1818 0da0 10E0 ldi r17,hi8(DisplayBuff) |
1819 0da2 8430 cpi r24,lo8(4) |
1820 0da4 A8F0 brlo .L164 |
1821 0da6 0E94 0000 call Menu |
1822 0daa 80E5 ldi r24,lo8(80) |
1823 0dac 90E0 ldi r25,hi8(80) |
1824 0dae 9F93 push r25 |
1825 0db0 8F93 push r24 |
1826 0db2 1F93 push r17 |
1827 0db4 0F93 push r16 |
1828 0db6 81E0 ldi r24,lo8(1) |
1829 0db8 8F93 push r24 |
1830 0dba 8F93 push r24 |
1831 0dbc 88E4 ldi r24,lo8(72) |
1832 0dbe 8F93 push r24 |
1833 0dc0 0E94 0000 call SendOutData |
1834 0dc4 2DB7 in r18,__SP_L__ |
1835 0dc6 3EB7 in r19,__SP_H__ |
1836 0dc8 295F subi r18,lo8(-(7)) |
1837 0dca 3F4F sbci r19,hi8(-(7)) |
1838 0dcc 2DBF out __SP_L__,r18 |
1839 0dce 34C0 rjmp .L165 |
1840 .L164: |
1841 0dd0 1092 0000 sts DispPtr,__zero_reg__ |
1842 0dd4 80E0 ldi r24,lo8(__c.0) |
1843 0dd6 90E0 ldi r25,hi8(__c.0) |
1844 0dd8 9F93 push r25 |
1845 0dda 8F93 push r24 |
1846 0ddc 80E0 ldi r24,lo8(pm(Menu_Putchar)) |
1847 0dde 90E0 ldi r25,hi8(pm(Menu_Putchar)) |
1848 0de0 9F93 push r25 |
1849 0de2 8F93 push r24 |
1850 0de4 E091 0000 lds r30,_printf_P |
1851 0de8 F091 0000 lds r31,(_printf_P)+1 |
1852 0dec 0995 icall |
1853 0dee 84E1 ldi r24,lo8(20) |
1854 0df0 90E0 ldi r25,hi8(20) |
1855 0df2 9F93 push r25 |
1856 0df4 8F93 push r24 |
1857 0df6 1F93 push r17 |
1858 0df8 0F93 push r16 |
1859 0dfa 81E0 ldi r24,lo8(1) |
1860 0dfc 90E0 ldi r25,hi8(1) |
1861 0dfe 9F93 push r25 |
1862 0e00 8F93 push r24 |
1863 0e02 80E0 ldi r24,lo8(DisplayLine) |
1864 0e04 90E0 ldi r25,hi8(DisplayLine) |
1865 0e06 9F93 push r25 |
1866 0e08 8F93 push r24 |
1867 0e0a 82E0 ldi r24,lo8(2) |
1868 0e0c 8F93 push r24 |
1869 0e0e 81E0 ldi r24,lo8(1) |
1870 0e10 8F93 push r24 |
1871 0e12 88E4 ldi r24,lo8(72) |
1872 0e14 8F93 push r24 |
1873 0e16 0E94 0000 call SendOutData |
1874 0e1a 8091 0000 lds r24,DisplayLine |
1875 0e1e 982F mov r25,r24 |
1876 0e20 8F5F subi r24,lo8(-(1)) |
1877 0e22 8093 0000 sts DisplayLine,r24 |
1878 0e26 2DB7 in r18,__SP_L__ |
1879 0e28 3EB7 in r19,__SP_H__ |
1880 0e2a 215F subi r18,lo8(-(15)) |
1881 0e2c 3F4F sbci r19,hi8(-(15)) |
1882 0e2e 2DBF out __SP_L__,r18 |
1883 0e30 9430 cpi r25,lo8(4) |
1884 0e32 10F0 brlo .L165 |
1885 0e34 1092 0000 sts DisplayLine,__zero_reg__ |
1886 .L165: |
1887 0e38 8091 0000 lds r24,Display_Interval |
1888 0e3c 9091 0000 lds r25,(Display_Interval)+1 |
1889 0e40 0E94 0000 call SetDelay |
1890 0e44 9093 0000 sts (Display_Timer)+1,r25 |
1891 0e48 8093 0000 sts Display_Timer,r24 |
1892 0e4c 1092 0000 sts DebugDisplayAnforderung,__zero_reg__ |
1893 .L161: |
1894 0e50 8091 0000 lds r24,DebugDisplayAnforderung1 |
1895 0e54 8823 tst r24 |
1896 0e56 51F1 breq .L167 |
1897 0e58 8091 0000 lds r24,UebertragungAbgeschlossen |
1898 0e5c 8823 tst r24 |
1899 0e5e 31F1 breq .L167 |
1900 0e60 0E94 0000 call Menu |
1901 0e64 80E5 ldi r24,lo8(80) |
1902 0e66 90E0 ldi r25,hi8(80) |
1903 0e68 9F93 push r25 |
1904 0e6a 8F93 push r24 |
1905 0e6c 80E0 ldi r24,lo8(DisplayBuff) |
1906 0e6e 90E0 ldi r25,hi8(DisplayBuff) |
1907 0e70 9F93 push r25 |
1908 0e72 8F93 push r24 |
1909 0e74 21E0 ldi r18,lo8(1) |
1910 0e76 30E0 ldi r19,hi8(1) |
1911 0e78 3F93 push r19 |
1912 0e7a 2F93 push r18 |
1913 0e7c 80E0 ldi r24,lo8(MaxMenue) |
1914 0e7e 90E0 ldi r25,hi8(MaxMenue) |
1915 0e80 9F93 push r25 |
1916 0e82 8F93 push r24 |
1917 0e84 3F93 push r19 |
1918 0e86 2F93 push r18 |
1919 0e88 80E0 ldi r24,lo8(MenuePunkt) |
1920 0e8a 90E0 ldi r25,hi8(MenuePunkt) |
1921 0e8c 9F93 push r25 |
1922 0e8e 8F93 push r24 |
1923 0e90 83E0 ldi r24,lo8(3) |
1924 0e92 8F93 push r24 |
1925 0e94 81E0 ldi r24,lo8(1) |
1926 0e96 8F93 push r24 |
1927 0e98 8CE4 ldi r24,lo8(76) |
1928 0e9a 8F93 push r24 |
1929 0e9c 0E94 0000 call SendOutData |
1930 0ea0 1092 0000 sts DebugDisplayAnforderung1,__zero_reg__ |
1931 0ea4 8DB7 in r24,__SP_L__ |
1932 0ea6 9EB7 in r25,__SP_H__ |
1933 0ea8 0F96 adiw r24,15 |
1934 0eaa 8DBF out __SP_L__,r24 |
1935 .L167: |
1936 0eac 8091 0000 lds r24,GetVersionAnforderung |
1937 0eb0 8823 tst r24 |
1938 0eb2 D1F0 breq .L168 |
1939 0eb4 8091 0000 lds r24,UebertragungAbgeschlossen |
1940 0eb8 8823 tst r24 |
1941 0eba B1F0 breq .L168 |
1942 0ebc 8AE0 ldi r24,lo8(10) |
1943 0ebe 90E0 ldi r25,hi8(10) |
1944 0ec0 9F93 push r25 |
1945 0ec2 8F93 push r24 |
1946 0ec4 80E0 ldi r24,lo8(VersionInfo) |
1947 0ec6 90E0 ldi r25,hi8(VersionInfo) |
1948 0ec8 9F93 push r25 |
1949 0eca 8F93 push r24 |
1950 0ecc 81E0 ldi r24,lo8(1) |
1951 0ece 8F93 push r24 |
1952 0ed0 8F93 push r24 |
1953 0ed2 86E5 ldi r24,lo8(86) |
1954 0ed4 8F93 push r24 |
1955 0ed6 0E94 0000 call SendOutData |
1956 0eda 1092 0000 sts GetVersionAnforderung,__zero_reg__ |
1957 0ede 2DB7 in r18,__SP_L__ |
1958 0ee0 3EB7 in r19,__SP_H__ |
1959 0ee2 295F subi r18,lo8(-(7)) |
1960 0ee4 3F4F sbci r19,hi8(-(7)) |
1961 0ee6 2DBF out __SP_L__,r18 |
1962 .L168: |
1963 0ee8 8091 0000 lds r24,GetExternalControl |
1964 0eec 8823 tst r24 |
1965 0eee D9F0 breq .L169 |
1966 0ef0 8091 0000 lds r24,UebertragungAbgeschlossen |
1967 0ef4 8823 tst r24 |
1968 0ef6 B9F0 breq .L169 |
1969 0ef8 8BE0 ldi r24,lo8(11) |
1970 0efa 90E0 ldi r25,hi8(11) |
1971 0efc 9F93 push r25 |
1972 0efe 8F93 push r24 |
1973 0f00 80E0 ldi r24,lo8(ExternControl) |
1974 0f02 90E0 ldi r25,hi8(ExternControl) |
1975 0f04 9F93 push r25 |
1976 0f06 8F93 push r24 |
1977 0f08 81E0 ldi r24,lo8(1) |
1978 0f0a 8F93 push r24 |
1979 0f0c 8091 0000 lds r24,MeineSlaveAdresse |
1980 0f10 8F93 push r24 |
1981 0f12 87E4 ldi r24,lo8(71) |
1982 0f14 8F93 push r24 |
1983 0f16 0E94 0000 call SendOutData |
1984 0f1a 1092 0000 sts GetExternalControl,__zero_reg__ |
1985 0f1e 8DB7 in r24,__SP_L__ |
1986 0f20 9EB7 in r25,__SP_H__ |
1987 0f22 0796 adiw r24,7 |
1988 0f24 8DBF out __SP_L__,r24 |
1989 .L169: |
1990 0f26 8091 0000 lds r24,Kompass_Timer |
1991 0f2a 9091 0000 lds r25,(Kompass_Timer)+1 |
1992 0f2e 0E94 0000 call CheckDelay |
1993 0f32 8823 tst r24 |
1994 0f34 09F4 brne .+2 |
1995 0f36 61C0 rjmp .L170 |
1996 0f38 8091 0000 lds r24,UebertragungAbgeschlossen |
1997 0f3c 8823 tst r24 |
1998 0f3e 09F4 brne .+2 |
1999 0f40 5CC0 rjmp .L170 |
2000 0f42 8091 0000 lds r24,EE_Parameter+28 |
2001 0f46 9927 clr r25 |
2002 0f48 880F lsl r24 |
2003 0f4a 991F rol r25 |
2004 0f4c 880F lsl r24 |
2005 0f4e 991F rol r25 |
2006 0f50 7C01 movw r14,r24 |
2007 0f52 0027 clr r16 |
2008 0f54 F7FC sbrc r15,7 |
2009 0f56 0095 com r16 |
2010 0f58 102F mov r17,r16 |
2011 0f5a 8091 0000 lds r24,IntegralNick |
2012 0f5e 9091 0000 lds r25,(IntegralNick)+1 |
2013 0f62 A091 0000 lds r26,(IntegralNick)+2 |
2014 0f66 B091 0000 lds r27,(IntegralNick)+3 |
2015 0f6a BC01 movw r22,r24 |
2016 0f6c CD01 movw r24,r26 |
2017 0f6e A801 movw r20,r16 |
2018 0f70 9701 movw r18,r14 |
2019 0f72 0E94 0000 call __divmodsi4 |
2020 0f76 3093 0000 sts (WinkelOut)+1,r19 |
2021 0f7a 2093 0000 sts WinkelOut,r18 |
2022 0f7e 8091 0000 lds r24,IntegralRoll |
2023 0f82 9091 0000 lds r25,(IntegralRoll)+1 |
2024 0f86 A091 0000 lds r26,(IntegralRoll)+2 |
2025 0f8a B091 0000 lds r27,(IntegralRoll)+3 |
2026 0f8e BC01 movw r22,r24 |
2027 0f90 CD01 movw r24,r26 |
2028 0f92 A801 movw r20,r16 |
2029 0f94 9701 movw r18,r14 |
2030 0f96 0E94 0000 call __divmodsi4 |
2031 0f9a 3093 0000 sts (WinkelOut+2)+1,r19 |
2032 0f9e 2093 0000 sts WinkelOut+2,r18 |
2033 0fa2 8091 0000 lds r24,Parameter_UserParam1 |
2034 0fa6 8093 0000 sts WinkelOut+4,r24 |
2035 0faa 8091 0000 lds r24,Parameter_UserParam2 |
2036 0fae 8093 0000 sts WinkelOut+5,r24 |
2037 0fb2 88E0 ldi r24,lo8(8) |
2038 0fb4 90E0 ldi r25,hi8(8) |
2039 0fb6 9F93 push r25 |
2040 0fb8 8F93 push r24 |
2041 0fba 80E0 ldi r24,lo8(WinkelOut) |
2042 0fbc 90E0 ldi r25,hi8(WinkelOut) |
2043 0fbe 9F93 push r25 |
2044 0fc0 8F93 push r24 |
2045 0fc2 81E0 ldi r24,lo8(1) |
2046 0fc4 8F93 push r24 |
2047 0fc6 83E0 ldi r24,lo8(3) |
2048 0fc8 8F93 push r24 |
2049 0fca 8BE6 ldi r24,lo8(107) |
2050 0fcc 8F93 push r24 |
2051 0fce 0E94 0000 call SendOutData |
2052 0fd2 8091 0000 lds r24,WinkelOut+6 |
2053 0fd6 2DB7 in r18,__SP_L__ |
2054 0fd8 3EB7 in r19,__SP_H__ |
2055 0fda 295F subi r18,lo8(-(7)) |
2056 0fdc 3F4F sbci r19,hi8(-(7)) |
2057 0fde 2DBF out __SP_L__,r18 |
2058 0fe0 8530 cpi r24,lo8(5) |
2059 0fe2 18F0 brlo .L171 |
2060 0fe4 86E0 ldi r24,lo8(6) |
2061 0fe6 8093 0000 sts WinkelOut+6,r24 |
2062 .L171: |
2063 0fea 83E6 ldi r24,lo8(99) |
2064 0fec 90E0 ldi r25,hi8(99) |
2065 0fee 0E94 0000 call SetDelay |
2066 0ff2 9093 0000 sts (Kompass_Timer)+1,r25 |
2067 0ff6 8093 0000 sts Kompass_Timer,r24 |
2068 .L170: |
2069 0ffa 8091 0000 lds r24,DebugDataIntervall |
2070 0ffe 9091 0000 lds r25,(DebugDataIntervall)+1 |
2071 1002 892B or r24,r25 |
2072 1004 41F0 breq .L174 |
2073 1006 8091 0000 lds r24,Debug_Timer |
2074 100a 9091 0000 lds r25,(Debug_Timer)+1 |
2075 100e 0E94 0000 call CheckDelay |
2076 1012 8823 tst r24 |
2077 1014 21F4 brne .L173 |
2078 .L174: |
2079 1016 8091 0000 lds r24,DebugDataAnforderung |
2080 101a 8823 tst r24 |
2081 101c 39F1 breq .L172 |
2082 .L173: |
2083 101e 8091 0000 lds r24,UebertragungAbgeschlossen |
2084 1022 8823 tst r24 |
2085 1024 19F1 breq .L172 |
2086 1026 0E94 0000 call CopyDebugValues |
2087 102a 82E4 ldi r24,lo8(66) |
2088 102c 90E0 ldi r25,hi8(66) |
2089 102e 9F93 push r25 |
2090 1030 8F93 push r24 |
2091 1032 80E0 ldi r24,lo8(DebugOut) |
2092 1034 90E0 ldi r25,hi8(DebugOut) |
2093 1036 9F93 push r25 |
2094 1038 8F93 push r24 |
2095 103a 81E0 ldi r24,lo8(1) |
2096 103c 8F93 push r24 |
2097 103e 8F93 push r24 |
2098 1040 84E4 ldi r24,lo8(68) |
2099 1042 8F93 push r24 |
2100 1044 0E94 0000 call SendOutData |
2101 1048 1092 0000 sts DebugDataAnforderung,__zero_reg__ |
2102 104c 8DB7 in r24,__SP_L__ |
2103 104e 9EB7 in r25,__SP_H__ |
2104 1050 0796 adiw r24,7 |
2105 1052 8DBF out __SP_L__,r24 |
2106 1054 8091 0000 lds r24,DebugDataIntervall |
2107 1058 9091 0000 lds r25,(DebugDataIntervall)+1 |
2108 105c 0097 sbiw r24,0 |
2109 105e 31F0 breq .L172 |
2110 1060 0E94 0000 call SetDelay |
2111 1064 9093 0000 sts (Debug_Timer)+1,r25 |
2112 1068 8093 0000 sts Debug_Timer,r24 |
2113 .L172: |
2114 106c 8091 0000 lds r24,Intervall3D |
2115 1070 9091 0000 lds r25,(Intervall3D)+1 |
2116 1074 892B or r24,r25 |
2117 1076 09F4 brne .+2 |
2118 1078 B8C0 rjmp .L176 |
2119 107a 8091 0000 lds r24,Timer3D |
2120 107e 9091 0000 lds r25,(Timer3D)+1 |
2121 1082 0E94 0000 call CheckDelay |
2122 1086 8823 tst r24 |
2123 1088 09F4 brne .+2 |
2124 108a AFC0 rjmp .L176 |
2125 108c 8091 0000 lds r24,UebertragungAbgeschlossen |
2126 1090 8823 tst r24 |
2127 1092 09F4 brne .+2 |
2128 1094 AAC0 rjmp .L176 |
2129 1096 8091 0000 lds r24,EE_Parameter+28 |
2130 109a 9927 clr r25 |
2131 109c 880F lsl r24 |
2132 109e 991F rol r25 |
2133 10a0 880F lsl r24 |
2134 10a2 991F rol r25 |
2135 10a4 7C01 movw r14,r24 |
2136 10a6 0027 clr r16 |
2137 10a8 F7FC sbrc r15,7 |
2138 10aa 0095 com r16 |
2139 10ac 102F mov r17,r16 |
2140 10ae 8091 0000 lds r24,IntegralNick |
2141 10b2 9091 0000 lds r25,(IntegralNick)+1 |
2142 10b6 A091 0000 lds r26,(IntegralNick)+2 |
2143 10ba B091 0000 lds r27,(IntegralNick)+3 |
2144 10be BC01 movw r22,r24 |
2145 10c0 CD01 movw r24,r26 |
2146 10c2 A801 movw r20,r16 |
2147 10c4 9701 movw r18,r14 |
2148 10c6 0E94 0000 call __divmodsi4 |
2149 10ca 3093 0000 sts (Data3D)+1,r19 |
2150 10ce 2093 0000 sts Data3D,r18 |
2151 10d2 8091 0000 lds r24,IntegralRoll |
2152 10d6 9091 0000 lds r25,(IntegralRoll)+1 |
2153 10da A091 0000 lds r26,(IntegralRoll)+2 |
2154 10de B091 0000 lds r27,(IntegralRoll)+3 |
2155 10e2 BC01 movw r22,r24 |
2156 10e4 CD01 movw r24,r26 |
2157 10e6 A801 movw r20,r16 |
2158 10e8 9701 movw r18,r14 |
2159 10ea 0E94 0000 call __divmodsi4 |
2160 10ee 3093 0000 sts (Data3D+2)+1,r19 |
2161 10f2 2093 0000 sts Data3D+2,r18 |
2162 10f6 2091 0000 lds r18,ErsatzKompass |
2163 10fa 3091 0000 lds r19,(ErsatzKompass)+1 |
2164 10fe 4091 0000 lds r20,(ErsatzKompass)+2 |
2165 1102 5091 0000 lds r21,(ErsatzKompass)+3 |
2166 1106 DA01 movw r26,r20 |
2167 1108 C901 movw r24,r18 |
2168 110a 63E0 ldi r22,3 |
2169 110c 880F 1: lsl r24 |
2170 110e 991F rol r25 |
2171 1110 AA1F rol r26 |
2172 1112 BB1F rol r27 |
2173 1114 6A95 dec r22 |
2174 1116 D1F7 brne 1b |
2175 1118 820F add r24,r18 |
2176 111a 931F adc r25,r19 |
2177 111c A41F adc r26,r20 |
2178 111e B51F adc r27,r21 |
2179 1120 820F add r24,r18 |
2180 1122 931F adc r25,r19 |
2181 1124 A41F adc r26,r20 |
2182 1126 B51F adc r27,r21 |
2183 1128 2091 0000 lds r18,GIER_GRAD_FAKTOR |
2184 112c 3091 0000 lds r19,(GIER_GRAD_FAKTOR)+1 |
2185 1130 4091 0000 lds r20,(GIER_GRAD_FAKTOR)+2 |
2186 1134 5091 0000 lds r21,(GIER_GRAD_FAKTOR)+3 |
2187 1138 BC01 movw r22,r24 |
2188 113a CD01 movw r24,r26 |
2189 113c 0E94 0000 call __divmodsi4 |
2190 1140 3093 0000 sts (Data3D+4)+1,r19 |
2191 1144 2093 0000 sts Data3D+4,r18 |
2192 1148 8091 0000 lds r24,SummeNick |
2193 114c 9091 0000 lds r25,(SummeNick)+1 |
2194 1150 A091 0000 lds r26,(SummeNick)+2 |
2195 1154 B091 0000 lds r27,(SummeNick)+3 |
2196 1158 39E0 ldi r19,9 |
2197 115a B595 1: asr r27 |
2198 115c A795 ror r26 |
2199 115e 9795 ror r25 |
2200 1160 8795 ror r24 |
2201 1162 3A95 dec r19 |
2202 1164 D1F7 brne 1b |
2203 1166 8093 0000 sts Data3D+6,r24 |
2204 116a 8091 0000 lds r24,SummeRoll |
2205 116e 9091 0000 lds r25,(SummeRoll)+1 |
2206 1172 A091 0000 lds r26,(SummeRoll)+2 |
2207 1176 B091 0000 lds r27,(SummeRoll)+3 |
2208 117a 29E0 ldi r18,9 |
2209 117c B595 1: asr r27 |
2210 117e A795 ror r26 |
2211 1180 9795 ror r25 |
2212 1182 8795 ror r24 |
2213 1184 2A95 dec r18 |
2214 1186 D1F7 brne 1b |
2215 1188 8093 0000 sts Data3D+7,r24 |
2216 118c 8091 0000 lds r24,Mess_Integral_Gier |
2217 1190 9091 0000 lds r25,(Mess_Integral_Gier)+1 |
2218 1194 A091 0000 lds r26,(Mess_Integral_Gier)+2 |
2219 1198 B091 0000 lds r27,(Mess_Integral_Gier)+3 |
2220 119c 09E0 ldi r16,9 |
2221 119e B595 1: asr r27 |
2222 11a0 A795 ror r26 |
2223 11a2 9795 ror r25 |
2224 11a4 8795 ror r24 |
2225 11a6 0A95 dec r16 |
2226 11a8 D1F7 brne 1b |
2227 11aa 8093 0000 sts Data3D+8,r24 |
2228 11ae 8EE0 ldi r24,lo8(14) |
2229 11b0 90E0 ldi r25,hi8(14) |
2230 11b2 9F93 push r25 |
2231 11b4 8F93 push r24 |
2232 11b6 80E0 ldi r24,lo8(Data3D) |
2233 11b8 90E0 ldi r25,hi8(Data3D) |
2234 11ba 9F93 push r25 |
2235 11bc 8F93 push r24 |
2236 11be 81E0 ldi r24,lo8(1) |
2237 11c0 8F93 push r24 |
2238 11c2 8F93 push r24 |
2239 11c4 83E4 ldi r24,lo8(67) |
2240 11c6 8F93 push r24 |
2241 11c8 0E94 0000 call SendOutData |
2242 11cc 8091 0000 lds r24,Intervall3D |
2243 11d0 9091 0000 lds r25,(Intervall3D)+1 |
2244 11d4 0E94 0000 call SetDelay |
2245 11d8 9093 0000 sts (Timer3D)+1,r25 |
2246 11dc 8093 0000 sts Timer3D,r24 |
2247 11e0 2DB7 in r18,__SP_L__ |
2248 11e2 3EB7 in r19,__SP_H__ |
2249 11e4 295F subi r18,lo8(-(7)) |
2250 11e6 3F4F sbci r19,hi8(-(7)) |
2251 11e8 2DBF out __SP_L__,r18 |
2252 .L176: |
2253 11ea 8091 0000 lds r24,DebugTextAnforderung |
2254 11ee 8F3F cpi r24,lo8(-1) |
2255 11f0 71F1 breq .L177 |
2256 11f2 9927 clr r25 |
2257 11f4 14E0 ldi r17,4 |
2258 11f6 880F 1: lsl r24 |
2259 11f8 991F rol r25 |
2260 11fa 1A95 dec r17 |
2261 11fc E1F7 brne 1b |
2262 11fe 8050 subi r24,lo8(-(ANALOG_TEXT)) |
2263 1200 9040 sbci r25,hi8(-(ANALOG_TEXT)) |
2264 1202 40E1 ldi r20,lo8(16) |
2265 1204 50E0 ldi r21,hi8(16) |
2266 1206 BC01 movw r22,r24 |
2267 1208 CE01 movw r24,r28 |
2268 120a 0196 adiw r24,1 |
2269 120c 0E94 0000 call memcpy_P |
2270 1210 80E1 ldi r24,lo8(16) |
2271 1212 90E0 ldi r25,hi8(16) |
2272 1214 9F93 push r25 |
2273 1216 8F93 push r24 |
2274 1218 CE01 movw r24,r28 |
2275 121a 0196 adiw r24,1 |
2276 121c 9F93 push r25 |
2277 121e 8F93 push r24 |
2278 1220 81E0 ldi r24,lo8(1) |
2279 1222 90E0 ldi r25,hi8(1) |
2280 1224 9F93 push r25 |
2281 1226 8F93 push r24 |
2282 1228 80E0 ldi r24,lo8(DebugTextAnforderung) |
2283 122a 90E0 ldi r25,hi8(DebugTextAnforderung) |
2284 122c 9F93 push r25 |
2285 122e 8F93 push r24 |
2286 1230 82E0 ldi r24,lo8(2) |
2287 1232 8F93 push r24 |
2288 1234 81E0 ldi r24,lo8(1) |
2289 1236 8F93 push r24 |
2290 1238 81E4 ldi r24,lo8(65) |
2291 123a 8F93 push r24 |
2292 123c 0E94 0000 call SendOutData |
2293 1240 8FEF ldi r24,lo8(-1) |
2294 1242 8093 0000 sts DebugTextAnforderung,r24 |
2295 1246 8DB7 in r24,__SP_L__ |
2296 1248 9EB7 in r25,__SP_H__ |
2297 124a 0B96 adiw r24,11 |
2298 124c 8DBF out __SP_L__,r24 |
2299 .L177: |
2300 124e 8091 0000 lds r24,ConfirmFrame |
2301 1252 8823 tst r24 |
2302 1254 D1F0 breq .L178 |
2303 1256 8091 0000 lds r24,UebertragungAbgeschlossen |
2304 125a 8823 tst r24 |
2305 125c B1F0 breq .L178 |
2306 125e 81E0 ldi r24,lo8(1) |
2307 1260 90E0 ldi r25,hi8(1) |
2308 1262 9F93 push r25 |
2309 1264 8F93 push r24 |
2310 1266 80E0 ldi r24,lo8(ConfirmFrame) |
2311 1268 90E0 ldi r25,hi8(ConfirmFrame) |
2312 126a 9F93 push r25 |
2313 126c 8F93 push r24 |
2314 126e 81E0 ldi r24,lo8(1) |
2315 1270 8F93 push r24 |
2316 1272 8F93 push r24 |
2317 1274 82E4 ldi r24,lo8(66) |
2318 1276 8F93 push r24 |
2319 1278 0E94 0000 call SendOutData |
2320 127c 1092 0000 sts ConfirmFrame,__zero_reg__ |
2321 1280 2DB7 in r18,__SP_L__ |
2322 1282 3EB7 in r19,__SP_H__ |
2323 1284 295F subi r18,lo8(-(7)) |
2324 1286 3F4F sbci r19,hi8(-(7)) |
2325 1288 2DBF out __SP_L__,r18 |
2326 .L178: |
2327 128a 8091 0000 lds r24,GetPPMChannelAnforderung |
2328 128e 8823 tst r24 |
2329 1290 C9F0 breq .L158 |
2330 1292 8091 0000 lds r24,UebertragungAbgeschlossen |
2331 1296 8823 tst r24 |
2332 1298 A9F0 breq .L158 |
2333 129a 84E3 ldi r24,lo8(52) |
2334 129c 90E0 ldi r25,hi8(52) |
2335 129e 9F93 push r25 |
2336 12a0 8F93 push r24 |
2337 12a2 80E0 ldi r24,lo8(PPM_in) |
2338 12a4 90E0 ldi r25,hi8(PPM_in) |
2339 12a6 9F93 push r25 |
2340 12a8 8F93 push r24 |
2341 12aa 81E0 ldi r24,lo8(1) |
2342 12ac 8F93 push r24 |
2343 12ae 8F93 push r24 |
2344 12b0 80E5 ldi r24,lo8(80) |
2345 12b2 8F93 push r24 |
2346 12b4 0E94 0000 call SendOutData |
2347 12b8 1092 0000 sts GetPPMChannelAnforderung,__zero_reg__ |
2348 12bc 8DB7 in r24,__SP_L__ |
2349 12be 9EB7 in r25,__SP_H__ |
2350 12c0 0796 adiw r24,7 |
2351 12c2 8DBF out __SP_L__,r24 |
2352 .L158: |
2353 /* epilogue: frame size=16 */ |
2354 12c4 E6E0 ldi r30,6 |
2355 12c6 C05F subi r28,-16 |
2356 12c8 0C94 0000 jmp __epilogue_restores__+24 |
2357 /* epilogue end (size=4) */ |
2358 /* function DatenUebertragung size 720 (710) */ |
2360 .comm Debug_Timer,2,1 |
2361 .comm Kompass_Timer,2,1 |
2362 .comm MotorTest,16,1 |
2363 .comm DebugOut,66,1 |
2364 .comm WinkelOut,8,1 |
2365 .comm Data3D,14,1 |
2366 .comm ExternControl,11,1 |
2367 .comm VersionInfo,10,1 |
2368 .comm TxdBuffer,160,1 |
2369 .comm RxdBuffer,160,1 |
2370 .comm ConfirmFrame,1,1 |
2371 .comm Display_Timer,2,1 |
2372 .comm Timer3D,2,1 |
2373 /* File "uart.c": code 2416 = 0x0970 (2325), prologues 47, epilogues 44 */ |
DEFINED SYMBOLS |
*ABS*:00000000 uart.c |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:2 *ABS*:0000003f __SREG__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:3 *ABS*:0000003e __SP_H__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:4 *ABS*:0000003d __SP_L__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:5 *ABS*:00000034 __CCP__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:6 *ABS*:00000000 __tmp_reg__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:7 *ABS*:00000001 __zero_reg__ |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:11 .text:00000000 __vector_22 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:2298 .data:00000000 UebertragungAbgeschlossen |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:2423 .bss:0000001f ptr.2267 |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:3 *ABS*:0000003f __SREG__ |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:4 *ABS*:0000003e __SP_H__ |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:5 *ABS*:0000003d __SP_L__ |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:6 *ABS*:00000000 __tmp_reg__ |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:7 *ABS*:00000001 __zero_reg__ |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:14 .progmem.data:00000000 ANALOG_TEXT |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:52 .bss:00000000 AboTimeOut |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:58 .bss:00000002 Display_Interval |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:64 .bss:00000004 Intervall3D |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:70 .bss:00000006 DebugDataIntervall |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:76 .data:00000000 MeineSlaveAdresse |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:81 .data:00000001 PcZugriff |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:86 .data:00000002 DebugTextAnforderung |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:93 .bss:00000008 PC_MotortestActive |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:99 .bss:00000009 PC_DebugTimeout |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:105 .bss:0000000a RxDataLen |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:111 .bss:0000000b pRxData |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:117 .bss:0000000d AnzahlEmpfangsBytes |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:123 .bss:0000000e CntCrcError |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:129 .data:00000003 UebertragungAbgeschlossen |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:136 .bss:0000000f NeueKoordinateEmpfangen |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:142 .bss:00000010 NeuerDatensatzEmpfangen |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:148 .bss:00000011 SioTmp |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:154 .bss:00000012 DisplayLine |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:160 .bss:00000013 GetPPMChannelAnforderung |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:166 .bss:00000014 GetVersionAnforderung |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:172 .bss:00000015 DebugDataAnforderung |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:178 .bss:00000016 DebugDisplayAnforderung |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:184 .bss:00000017 DebugDisplayAnforderung1 |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:190 .bss:00000018 GetExternalControl |
.bss:00000019 ptr.6 |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:196 .text:00000000 __vector_22 |
*COM*:000000a0 TxdBuffer |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:65 .text:0000006c AddCRC |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:118 .text:000000ca Decode64 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:2311 .bss:0000000b AnzahlEmpfangsBytes |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:192 .bss:0000001b crc.1 |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:250 .bss:0000001d crc1.2 |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:251 .bss:0000001e crc2.3 |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:252 .bss:0000001f buf_ptr.4 |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:253 .bss:00000020 UartState.5 |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:257 .text:0000006c __vector_20 |
*COM*:000000a0 RxdBuffer |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:2317 .bss:0000000c pRxData |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:2323 .bss:0000000e RxDataLen |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:218 .text:00000180 uart_putchar |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:232 .text:00000190 UART_Init |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:2358 .bss:00000011 DebugDataIntervall |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:473 .text:0000023c AddCRC |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:529 .text:0000029c SendOutData |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:729 .text:00000414 Decode64 |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:842 .text:000004e8 BearbeiteRxDaten |
*COM*:00000010 MotorTest |
*COM*:0000000a VersionInfo |
*COM*:0000000b ExternControl |
*COM*:00000001 ConfirmFrame |
*COM*:00000002 Timer3D |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:1698 .text:00000c94 uart_putchar |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:1714 .text:00000ca4 UART_Init |
*COM*:00000002 Debug_Timer |
*COM*:00000002 Kompass_Timer |
*COM*:0000000a VersionInfo |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:279 .text:00000204 SendOutData |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:471 .text:00000368 DatenUebertragung |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:2376 .bss:00000017 AboTimeOut |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:2370 .bss:00000015 Display_Interval |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:2364 .bss:00000013 Intervall3D |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:1767 .progmem.data:00000200 __c.0 |
C:\Users\Arthur-P\AppData\Local\Temp/cc61baaa.s:1772 .text:00000d2c DatenUebertragung |
*COM*:00000002 Display_Timer |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:2250 .bss:00000002 DebugDisplayAnforderung |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:2274 .bss:00000006 DisplayLine |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:2417 .progmem.data:00000200 __c.2679 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:2244 .bss:00000001 DebugDisplayAnforderung1 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:2262 .bss:00000004 GetVersionAnforderung |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:2238 .bss:00000000 GetExternalControl |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:2351 .data:00000003 MeineSlaveAdresse |
*COM*:0000000b ExternControl |
*COM*:00000008 WinkelOut |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:2256 .bss:00000003 DebugDataAnforderung |
*COM*:00000042 DebugOut |
*COM*:00000002 Timer3D |
*COM*:0000000e Data3D |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:2341 .data:00000001 DebugTextAnforderung |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:2382 .progmem.data:00000000 ANALOG_TEXT |
*COM*:00000001 ConfirmFrame |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:2268 .bss:00000005 GetPPMChannelAnforderung |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:1154 .text:000009c8 BearbeiteRxDaten |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:2286 .bss:00000008 NeuerDatensatzEmpfangen |
*COM*:00000010 MotorTest |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:2335 .bss:00000010 PC_MotortestActive |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:2346 .data:00000002 PcZugriff |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:2028 .text:00001190 __vector_20 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:2280 .bss:00000007 SioTmp |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:2419 .bss:0000001a buf_ptr.2283 |
.bss:00000019 UartState.2284 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:2422 .bss:0000001d crc.2280 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:2421 .bss:0000001c crc1.2281 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:2420 .bss:0000001b crc2.2282 |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:2305 .bss:0000000a CntCrcError |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:2292 .bss:00000009 NeueKoordinateEmpfangen |
C:\DOCUME~1\ADMINI~1\LOCALS~1\Temp/ccVkirab.s:2329 .bss:0000000f PC_DebugTimeout |
UNDEFINED SYMBOLS |
SetDelay |
__do_copy_data |
__do_clear_bss |
LcdClear |
ServoActive |
__prologue_saves__ |
__epilogue_restores__ |
KompassValue |
KompassStartwert |
__divmodhi4 |
KompassRichtung |
Mixer |
MixerTable_WriteToEEProm |
GetActiveParamSet |
ParamSet_ReadFromEEProm |
EE_Parameter |
ParamSet_WriteToEEProm |
__mulsi3 |
Umschlag180Nick |
Umschlag180Roll |
MotorenEin |
Piep |
LipoDetection |
LIBFC_ReceiverInit |
PPM_in |
I2C_ReadBLConfig |
BLConfig |
I2C_WriteBLConfig |
SetDelay |
RemoteKeys |
MenuePunkt |
CheckDelay |
DisplayBuff |
Menu |
2540,9 → 2500,7 |
DispPtr |
Menu_Putchar |
_printf_P |
MenuePunkt |
MaxMenue |
EE_Parameter |
IntegralNick |
__divmodsi4 |
IntegralRoll |
2550,33 → 2508,8 |
Parameter_UserParam2 |
CopyDebugValues |
ErsatzKompass |
__mulsi3 |
GIER_GRAD_FAKTOR |
SummeNick |
SummeRoll |
Mess_Integral_Gier |
memcpy_P |
PPM_in |
KompassValue |
KompassStartwert |
__divmodhi4 |
KompassRichtung |
Mixer |
MixerTable_WriteToEEProm |
GetActiveParamSet |
ParamSet_ReadFromEEProm |
ParamSet_WriteToEEProm |
Umschlag180Nick |
Umschlag180Roll |
MotorenEin |
Piep |
LipoDetection |
LIBFC_ReceiverInit |
I2C_ReadBLConfig |
BLConfig |
I2C_WriteBLConfig |
RemoteKeys |
LcdClear |
ServoActive |
__do_copy_data |
__do_clear_bss |