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