Details | Last modification | View Log | RSS feed
| Rev | Author | Line No. | Line |
|---|---|---|---|
| 21 | user | 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=0 */ |
||
| 36 | chris2798 | 14 | 15 0000 6F92 push r6 |
| 15 | 16 0002 7F92 push r7 |
||
| 16 | 17 0004 8F92 push r8 |
||
| 17 | 18 0006 9F92 push r9 |
||
| 18 | 19 0008 AF92 push r10 |
||
| 19 | 20 000a BF92 push r11 |
||
| 20 | 21 000c CF92 push r12 |
||
| 21 | 22 000e DF92 push r13 |
||
| 22 | 23 0010 EF92 push r14 |
||
| 23 | 24 0012 FF92 push r15 |
||
| 24 | 25 0014 0F93 push r16 |
||
| 25 | 26 0016 1F93 push r17 |
||
| 26 | 27 /* prologue end (size=12) */ |
||
| 27 | 28 0018 8091 0000 lds r24,Poti1 |
||
| 28 | 29 001c 9091 0000 lds r25,(Poti1)+1 |
||
| 29 | 30 0020 1816 cp __zero_reg__,r24 |
||
| 30 | 31 0022 1906 cpc __zero_reg__,r25 |
||
| 31 | 32 0024 04F0 brlt .+2 |
||
| 32 | 33 0026 00C0 rjmp .L2 |
||
| 33 | 34 0028 8091 0000 lds r24,actualPos+32 |
||
| 34 | 35 002c 8823 tst r24 |
||
| 35 | 36 002e 01F4 brne .+2 |
||
| 36 | 37 0030 00C0 rjmp .L2 |
||
| 37 | 38 0032 8091 0000 lds r24,gps_getpos |
||
| 38 | 39 0036 9091 0000 lds r25,(gps_getpos)+1 |
||
| 39 | 40 003a 892B or r24,r25 |
||
| 40 | 41 003c 01F0 breq .L5 |
||
| 41 | 42 003e 8091 0000 lds r24,actualPos |
||
| 42 | 43 0042 9091 0000 lds r25,(actualPos)+1 |
||
| 43 | 44 0046 A091 0000 lds r26,(actualPos)+2 |
||
| 44 | 45 004a B091 0000 lds r27,(actualPos)+3 |
||
| 45 | 46 004e 8093 0000 sts gps_northing,r24 |
||
| 46 | 47 0052 9093 0000 sts (gps_northing)+1,r25 |
||
| 47 | 48 0056 A093 0000 sts (gps_northing)+2,r26 |
||
| 48 | 49 005a B093 0000 sts (gps_northing)+3,r27 |
||
| 49 | 50 005e 8091 0000 lds r24,actualPos+4 |
||
| 50 | 51 0062 9091 0000 lds r25,(actualPos+4)+1 |
||
| 51 | 52 0066 A091 0000 lds r26,(actualPos+4)+2 |
||
| 52 | 53 006a B091 0000 lds r27,(actualPos+4)+3 |
||
| 53 | 54 006e 8093 0000 sts gps_easting,r24 |
||
| 54 | 55 0072 9093 0000 sts (gps_easting)+1,r25 |
||
| 55 | 56 0076 A093 0000 sts (gps_easting)+2,r26 |
||
| 56 | 57 007a B093 0000 sts (gps_easting)+3,r27 |
||
| 57 | 58 007e 8091 0000 lds r24,actualPos+8 |
||
| 58 | 59 0082 9091 0000 lds r25,(actualPos+8)+1 |
||
| 59 | 60 0086 A091 0000 lds r26,(actualPos+8)+2 |
||
| 60 | 61 008a B091 0000 lds r27,(actualPos+8)+3 |
||
| 61 | 62 008e 8093 0000 sts gps_altitude,r24 |
||
| 62 | 63 0092 9093 0000 sts (gps_altitude)+1,r25 |
||
| 63 | 64 0096 A093 0000 sts (gps_altitude)+2,r26 |
||
| 64 | 65 009a B093 0000 sts (gps_altitude)+3,r27 |
||
| 65 | 66 009e 82E3 ldi r24,lo8(50) |
||
| 66 | 67 00a0 90E0 ldi r25,hi8(50) |
||
| 67 | 68 00a2 9093 0000 sts (beeptime)+1,r25 |
||
| 68 | 69 00a6 8093 0000 sts beeptime,r24 |
||
| 69 | 70 00aa 1092 0000 sts (gps_getpos)+1,__zero_reg__ |
||
| 70 | 71 00ae 1092 0000 sts gps_getpos,__zero_reg__ |
||
| 71 | 72 .L5: |
||
| 72 | 73 00b2 A090 0000 lds r10,gps_p |
||
| 73 | 74 00b6 B090 0000 lds r11,(gps_p)+1 |
||
| 74 | 75 00ba 6091 0000 lds r22,gps_altitude |
||
| 75 | 76 00be 7091 0000 lds r23,(gps_altitude)+1 |
||
| 76 | 77 00c2 8091 0000 lds r24,(gps_altitude)+2 |
||
| 77 | 78 00c6 9091 0000 lds r25,(gps_altitude)+3 |
||
| 78 | 79 00ca 6E5F subi r22,lo8(-(2)) |
||
| 79 | 80 00cc 7F4F sbci r23,hi8(-(2)) |
||
| 80 | 81 00ce 8F4F sbci r24,hlo8(-(2)) |
||
| 81 | 82 00d0 9F4F sbci r25,hhi8(-(2)) |
||
| 82 | 83 00d2 2091 0000 lds r18,gps_northing |
||
| 83 | 84 00d6 3091 0000 lds r19,(gps_northing)+1 |
||
| 84 | 85 00da 4091 0000 lds r20,(gps_northing)+2 |
||
| 85 | 86 00de 5091 0000 lds r21,(gps_northing)+3 |
||
| 86 | 87 00e2 E2E0 ldi r30,lo8(2) |
||
| 87 | 88 00e4 EE2E mov r14,r30 |
||
| 88 | 89 00e6 F12C mov r15,__zero_reg__ |
||
| 89 | 90 00e8 012D mov r16,__zero_reg__ |
||
| 90 | 91 00ea 112D mov r17,__zero_reg__ |
||
| 91 | 92 00ec 2E25 eor r18,r14 |
||
| 92 | 93 00ee 3F25 eor r19,r15 |
||
| 93 | 94 00f0 4027 eor r20,r16 |
||
| 94 | 95 00f2 5127 eor r21,r17 |
||
| 95 | 96 00f4 6227 eor r22,r18 |
||
| 96 | 97 00f6 7327 eor r23,r19 |
||
| 97 | 98 00f8 8427 eor r24,r20 |
||
| 98 | 99 00fa 9527 eor r25,r21 |
||
| 99 | 100 00fc 0E94 0000 call __floatsisf |
||
| 100 | 101 0100 0E94 0000 call sqrt |
||
| 101 | 102 0104 3B01 movw r6,r22 |
||
| 102 | 103 0106 4C01 movw r8,r24 |
||
| 103 | 104 0108 6091 0000 lds r22,actualPos+8 |
||
| 104 | 105 010c 7091 0000 lds r23,(actualPos+8)+1 |
||
| 105 | 106 0110 8091 0000 lds r24,(actualPos+8)+2 |
||
| 106 | 107 0114 9091 0000 lds r25,(actualPos+8)+3 |
||
| 107 | 108 0118 6E5F subi r22,lo8(-(2)) |
||
| 108 | 109 011a 7F4F sbci r23,hi8(-(2)) |
||
| 109 | 110 011c 8F4F sbci r24,hlo8(-(2)) |
||
| 110 | 111 011e 9F4F sbci r25,hhi8(-(2)) |
||
| 111 | 112 0120 2091 0000 lds r18,actualPos |
||
| 112 | 113 0124 3091 0000 lds r19,(actualPos)+1 |
||
| 113 | 114 0128 4091 0000 lds r20,(actualPos)+2 |
||
| 114 | 115 012c 5091 0000 lds r21,(actualPos)+3 |
||
| 115 | 116 0130 2E25 eor r18,r14 |
||
| 116 | 117 0132 3F25 eor r19,r15 |
||
| 117 | 118 0134 4027 eor r20,r16 |
||
| 118 | 119 0136 5127 eor r21,r17 |
||
| 119 | 120 0138 6227 eor r22,r18 |
||
| 120 | 121 013a 7327 eor r23,r19 |
||
| 121 | 122 013c 8427 eor r24,r20 |
||
| 122 | 123 013e 9527 eor r25,r21 |
||
| 123 | 124 0140 0E94 0000 call __floatsisf |
||
| 124 | 125 0144 0E94 0000 call sqrt |
||
| 125 | 126 0148 9B01 movw r18,r22 |
||
| 126 | 127 014a AC01 movw r20,r24 |
||
| 127 | 128 014c C401 movw r24,r8 |
||
| 128 | 129 014e B301 movw r22,r6 |
||
| 129 | 130 0150 0E94 0000 call __subsf3 |
||
| 130 | 131 0154 7B01 movw r14,r22 |
||
| 131 | 132 0156 8C01 movw r16,r24 |
||
| 132 | 133 0158 CC24 clr r12 |
||
| 133 | 134 015a B7FC sbrc r11,7 |
||
| 134 | 135 015c C094 com r12 |
||
| 135 | 136 015e DC2C mov r13,r12 |
||
| 136 | 137 0160 C601 movw r24,r12 |
||
| 137 | 138 0162 B501 movw r22,r10 |
||
| 138 | 139 0164 0E94 0000 call __floatsisf |
||
| 139 | 140 0168 9B01 movw r18,r22 |
||
| 140 | 141 016a AC01 movw r20,r24 |
||
| 141 | 142 016c C801 movw r24,r16 |
||
| 142 | 143 016e B701 movw r22,r14 |
||
| 143 | 144 0170 0E94 0000 call __mulsf3 |
||
| 144 | 145 0174 20E0 ldi r18,lo8(0x3e000000) |
||
| 145 | 146 0176 30E0 ldi r19,hi8(0x3e000000) |
||
| 146 | 147 0178 40E0 ldi r20,hlo8(0x3e000000) |
||
| 147 | 148 017a 5EE3 ldi r21,hhi8(0x3e000000) |
||
| 148 | 149 017c 0E94 0000 call __mulsf3 |
||
| 149 | 150 0180 0E94 0000 call __fixsfsi |
||
| 150 | 151 0184 5B01 movw r10,r22 |
||
| 151 | 152 0186 6C01 movw r12,r24 |
||
| 152 | 153 0188 6093 0000 sts zwn,r22 |
||
| 153 | 154 018c 7093 0000 sts (zwn)+1,r23 |
||
| 154 | 155 0190 8093 0000 sts (zwn)+2,r24 |
||
| 155 | 156 0194 9093 0000 sts (zwn)+3,r25 |
||
| 156 | 157 0198 2091 0000 lds r18,gps_p |
||
| 157 | 158 019c 3091 0000 lds r19,(gps_p)+1 |
||
| 158 | 159 01a0 6091 0000 lds r22,gps_easting |
||
| 159 | 160 01a4 7091 0000 lds r23,(gps_easting)+1 |
||
| 160 | 161 01a8 8091 0000 lds r24,(gps_easting)+2 |
||
| 161 | 162 01ac 9091 0000 lds r25,(gps_easting)+3 |
||
| 162 | 163 01b0 E090 0000 lds r14,actualPos+4 |
||
| 163 | 164 01b4 F090 0000 lds r15,(actualPos+4)+1 |
||
| 164 | 165 01b8 0091 0000 lds r16,(actualPos+4)+2 |
||
| 165 | 166 01bc 1091 0000 lds r17,(actualPos+4)+3 |
||
| 166 | 167 01c0 6E19 sub r22,r14 |
||
| 167 | 168 01c2 7F09 sbc r23,r15 |
||
| 168 | 169 01c4 800B sbc r24,r16 |
||
| 169 | 170 01c6 910B sbc r25,r17 |
||
| 170 | 171 01c8 4427 clr r20 |
||
| 171 | 172 01ca 37FD sbrc r19,7 |
||
| 172 | 173 01cc 4095 com r20 |
||
| 173 | 174 01ce 542F mov r21,r20 |
||
| 174 | 175 01d0 0E94 0000 call __mulsi3 |
||
| 175 | 176 01d4 28E0 ldi r18,lo8(8) |
||
| 176 | 177 01d6 30E0 ldi r19,hi8(8) |
||
| 177 | 178 01d8 40E0 ldi r20,hlo8(8) |
||
| 178 | 179 01da 50E0 ldi r21,hhi8(8) |
||
| 179 | 180 01dc 0E94 0000 call __divmodsi4 |
||
| 180 | 181 01e0 3901 movw r6,r18 |
||
| 181 | 182 01e2 4A01 movw r8,r20 |
||
| 182 | 183 01e4 2093 0000 sts zwe,r18 |
||
| 183 | 184 01e8 3093 0000 sts (zwe)+1,r19 |
||
| 184 | 185 01ec 4093 0000 sts (zwe)+2,r20 |
||
| 185 | 186 01f0 5093 0000 sts (zwe)+3,r21 |
||
| 186 | 187 01f4 6091 0000 lds r22,gps_d |
||
| 187 | 188 01f8 7091 0000 lds r23,(gps_d)+1 |
||
| 188 | 189 01fc 8827 clr r24 |
||
| 189 | 190 01fe 77FD sbrc r23,7 |
||
| 190 | 191 0200 8095 com r24 |
||
| 191 | 192 0202 982F mov r25,r24 |
||
| 192 | 193 0204 2091 0000 lds r18,actualPos+12 |
||
| 193 | 194 0208 3091 0000 lds r19,(actualPos+12)+1 |
||
| 194 | 195 020c 4091 0000 lds r20,(actualPos+12)+2 |
||
| 195 | 196 0210 5091 0000 lds r21,(actualPos+12)+3 |
||
| 196 | 197 0214 0E94 0000 call __mulsi3 |
||
| 197 | 198 0218 22E0 ldi r18,lo8(2) |
||
| 198 | 199 021a 30E0 ldi r19,hi8(2) |
||
| 199 | 200 021c 40E0 ldi r20,hlo8(2) |
||
| 200 | 201 021e 50E0 ldi r21,hhi8(2) |
||
| 201 | 202 0220 0E94 0000 call __divmodsi4 |
||
| 202 | 203 0224 7901 movw r14,r18 |
||
| 203 | 204 0226 8A01 movw r16,r20 |
||
| 204 | 205 0228 1095 com r17 |
||
| 205 | 206 022a 0095 com r16 |
||
| 206 | 207 022c F094 com r15 |
||
| 207 | 208 022e E094 com r14 |
||
| 208 | 209 0230 E11C adc r14,__zero_reg__ |
||
| 209 | 210 0232 F11C adc r15,__zero_reg__ |
||
| 210 | 211 0234 011D adc r16,__zero_reg__ |
||
| 211 | 212 0236 111D adc r17,__zero_reg__ |
||
| 212 | 213 0238 E092 0000 sts zwn2,r14 |
||
| 213 | 214 023c F092 0000 sts (zwn2)+1,r15 |
||
| 214 | 215 0240 0093 0000 sts (zwn2)+2,r16 |
||
| 215 | 216 0244 1093 0000 sts (zwn2)+3,r17 |
||
| 216 | 217 0248 6091 0000 lds r22,gps_d |
||
| 217 | 218 024c 7091 0000 lds r23,(gps_d)+1 |
||
| 218 | 219 0250 8827 clr r24 |
||
| 219 | 220 0252 77FD sbrc r23,7 |
||
| 220 | 221 0254 8095 com r24 |
||
| 221 | 222 0256 982F mov r25,r24 |
||
| 222 | 223 0258 2091 0000 lds r18,actualPos+16 |
||
| 223 | 224 025c 3091 0000 lds r19,(actualPos+16)+1 |
||
| 224 | 225 0260 4091 0000 lds r20,(actualPos+16)+2 |
||
| 225 | 226 0264 5091 0000 lds r21,(actualPos+16)+3 |
||
| 226 | 227 0268 0E94 0000 call __mulsi3 |
||
| 227 | 228 026c 22E0 ldi r18,lo8(2) |
||
| 228 | 229 026e 30E0 ldi r19,hi8(2) |
||
| 229 | 230 0270 40E0 ldi r20,hlo8(2) |
||
| 230 | 231 0272 50E0 ldi r21,hhi8(2) |
||
| 231 | 232 0274 0E94 0000 call __divmodsi4 |
||
| 232 | 233 0278 5095 com r21 |
||
| 233 | 234 027a 4095 com r20 |
||
| 234 | 235 027c 3095 com r19 |
||
| 235 | 236 027e 2195 neg r18 |
||
| 236 | 237 0280 3F4F sbci r19,lo8(-1) |
||
| 237 | 238 0282 4F4F sbci r20,lo8(-1) |
||
| 238 | 239 0284 5F4F sbci r21,lo8(-1) |
||
| 239 | 240 0286 2093 0000 sts zwe2,r18 |
||
| 240 | 241 028a 3093 0000 sts (zwe2)+1,r19 |
||
| 241 | 242 028e 4093 0000 sts (zwe2)+2,r20 |
||
| 242 | 243 0292 5093 0000 sts (zwe2)+3,r21 |
||
| 243 | 244 0296 AE0C add r10,r14 |
||
| 244 | 245 0298 BF1C adc r11,r15 |
||
| 245 | 246 029a 6627 clr r22 |
||
| 246 | 247 029c 7727 clr r23 |
||
| 247 | 248 029e 6A19 sub r22,r10 |
||
| 248 | 249 02a0 7B09 sbc r23,r11 |
||
| 249 | 250 02a2 7093 0000 sts (GPS_Nick)+1,r23 |
||
| 250 | 251 02a6 6093 0000 sts GPS_Nick,r22 |
||
| 251 | 252 02aa 260D add r18,r6 |
||
| 252 | 253 02ac 371D adc r19,r7 |
||
| 253 | 254 02ae 3093 0000 sts (GPS_Roll)+1,r19 |
||
| 254 | 255 02b2 2093 0000 sts GPS_Roll,r18 |
||
| 255 | 256 02b6 8091 0000 lds r24,gpsmax |
||
| 256 | 257 02ba 9091 0000 lds r25,(gpsmax)+1 |
||
| 257 | 258 02be 8617 cp r24,r22 |
||
| 258 | 259 02c0 9707 cpc r25,r23 |
||
| 259 | 260 02c2 04F4 brge .L7 |
||
| 260 | 261 02c4 8091 0000 lds r24,gpsmax |
||
| 261 | 262 02c8 9091 0000 lds r25,(gpsmax)+1 |
||
| 262 | 263 02cc 00C0 rjmp .L16 |
||
| 263 | 264 .L7: |
||
| 264 | 265 02ce 8091 0000 lds r24,gpsmax |
||
| 265 | 266 02d2 9091 0000 lds r25,(gpsmax)+1 |
||
| 266 | 267 02d6 9095 com r25 |
||
| 267 | 268 02d8 8195 neg r24 |
||
| 268 | 269 02da 9F4F sbci r25,lo8(-1) |
||
| 269 | 270 02dc 6817 cp r22,r24 |
||
| 270 | 271 02de 7907 cpc r23,r25 |
||
| 271 | 272 02e0 04F4 brge .L9 |
||
| 272 | 273 02e2 8091 0000 lds r24,gpsmax |
||
| 273 | 274 02e6 9091 0000 lds r25,(gpsmax)+1 |
||
| 274 | 275 02ea 9095 com r25 |
||
| 275 | 276 02ec 8195 neg r24 |
||
| 276 | 277 02ee 9F4F sbci r25,lo8(-1) |
||
| 277 | 278 .L16: |
||
| 278 | 279 02f0 9093 0000 sts (GPS_Nick)+1,r25 |
||
| 279 | 280 02f4 8093 0000 sts GPS_Nick,r24 |
||
| 280 | 281 .L9: |
||
| 281 | 282 02f8 8091 0000 lds r24,gpsmax |
||
| 282 | 283 02fc 9091 0000 lds r25,(gpsmax)+1 |
||
| 283 | 284 0300 8217 cp r24,r18 |
||
| 284 | 285 0302 9307 cpc r25,r19 |
||
| 285 | 286 0304 04F4 brge .L11 |
||
| 286 | 287 0306 8091 0000 lds r24,gpsmax |
||
| 287 | 288 030a 9091 0000 lds r25,(gpsmax)+1 |
||
| 288 | 289 030e 00C0 rjmp .L17 |
||
| 289 | 290 .L11: |
||
| 290 | 291 0310 8091 0000 lds r24,gpsmax |
||
| 291 | 292 0314 9091 0000 lds r25,(gpsmax)+1 |
||
| 292 | 293 0318 9095 com r25 |
||
| 293 | 294 031a 8195 neg r24 |
||
| 294 | 295 031c 9F4F sbci r25,lo8(-1) |
||
| 295 | 296 031e 2817 cp r18,r24 |
||
| 296 | 297 0320 3907 cpc r19,r25 |
||
| 297 | 298 0322 04F4 brge .L15 |
||
| 298 | 299 0324 8091 0000 lds r24,gpsmax |
||
| 299 | 300 0328 9091 0000 lds r25,(gpsmax)+1 |
||
| 300 | 301 032c 9095 com r25 |
||
| 301 | 302 032e 8195 neg r24 |
||
| 302 | 303 0330 9F4F sbci r25,lo8(-1) |
||
| 303 | 304 .L17: |
||
| 304 | 305 0332 9093 0000 sts (GPS_Roll)+1,r25 |
||
| 305 | 306 0336 8093 0000 sts GPS_Roll,r24 |
||
| 306 | 307 033a 00C0 rjmp .L15 |
||
| 307 | 308 .L2: |
||
| 308 | 309 033c 85E0 ldi r24,lo8(5) |
||
| 309 | 310 033e 90E0 ldi r25,hi8(5) |
||
| 310 | 311 0340 9093 0000 sts (gps_getpos)+1,r25 |
||
| 311 | 312 0344 8093 0000 sts gps_getpos,r24 |
||
| 312 | 313 0348 1092 0000 sts (GPS_Nick)+1,__zero_reg__ |
||
| 313 | 314 034c 1092 0000 sts GPS_Nick,__zero_reg__ |
||
| 314 | 315 0350 1092 0000 sts (GPS_Roll)+1,__zero_reg__ |
||
| 315 | 316 0354 1092 0000 sts GPS_Roll,__zero_reg__ |
||
| 316 | 317 0358 1092 0000 sts zwn1,__zero_reg__ |
||
| 317 | 318 035c 1092 0000 sts (zwn1)+1,__zero_reg__ |
||
| 318 | 319 0360 1092 0000 sts (zwn1)+2,__zero_reg__ |
||
| 319 | 320 0364 1092 0000 sts (zwn1)+3,__zero_reg__ |
||
| 320 | 321 0368 1092 0000 sts zwe1,__zero_reg__ |
||
| 321 | 322 036c 1092 0000 sts (zwe1)+1,__zero_reg__ |
||
| 322 | 323 0370 1092 0000 sts (zwe1)+2,__zero_reg__ |
||
| 323 | 324 0374 1092 0000 sts (zwe1)+3,__zero_reg__ |
||
| 324 | 325 .L15: |
||
| 325 | 326 /* epilogue: frame size=0 */ |
||
| 326 | 327 0378 1F91 pop r17 |
||
| 327 | 328 037a 0F91 pop r16 |
||
| 328 | 329 037c FF90 pop r15 |
||
| 329 | 330 037e EF90 pop r14 |
||
| 330 | 331 0380 DF90 pop r13 |
||
| 331 | 332 0382 CF90 pop r12 |
||
| 332 | 333 0384 BF90 pop r11 |
||
| 333 | 334 0386 AF90 pop r10 |
||
| 334 | 335 0388 9F90 pop r9 |
||
| 335 | 336 038a 8F90 pop r8 |
||
| 336 | 337 038c 7F90 pop r7 |
||
| 337 | 338 038e 6F90 pop r6 |
||
| 338 | 339 0390 0895 ret |
||
| 339 | 340 /* epilogue end (size=13) */ |
||
| 340 | 341 /* function gps_main size 457 (432) */ |
||
| 341 | 343 .global loop |
||
| 342 | 344 .global loop |
||
| 343 | 345 .section .bss |
||
| 344 | 348 loop: |
||
| 345 | 349 0000 0000 .skip 2,0 |
||
| 346 | 350 .global gps_northing |
||
| 347 | 351 .global gps_northing |
||
| 348 | 354 gps_northing: |
||
| 349 | 355 0002 0000 0000 .skip 4,0 |
||
| 350 | 356 .global gps_easting |
||
| 351 | 357 .global gps_easting |
||
| 352 | 360 gps_easting: |
||
| 353 | 361 0006 0000 0000 .skip 4,0 |
||
| 354 | 362 .global gps_altitude |
||
| 355 | 363 .global gps_altitude |
||
| 356 | 366 gps_altitude: |
||
| 357 | 367 000a 0000 0000 .skip 4,0 |
||
| 358 | 368 .global alpha |
||
| 359 | 369 .global alpha |
||
| 360 | 372 alpha: |
||
| 361 | 373 000e 0000 .skip 2,0 |
||
| 362 | 374 .global zwn |
||
| 363 | 375 .global zwn |
||
| 364 | 378 zwn: |
||
| 365 | 379 0010 0000 0000 .skip 4,0 |
||
| 366 | 380 .global zwe |
||
| 367 | 381 .global zwe |
||
| 368 | 384 zwe: |
||
| 369 | 385 0014 0000 0000 .skip 4,0 |
||
| 370 | 386 .global zwn1 |
||
| 371 | 387 .global zwn1 |
||
| 372 | 390 zwn1: |
||
| 373 | 391 0018 0000 0000 .skip 4,0 |
||
| 374 | 392 .global zwe1 |
||
| 375 | 393 .global zwe1 |
||
| 376 | 396 zwe1: |
||
| 377 | 397 001c 0000 0000 .skip 4,0 |
||
| 378 | 398 .global zwn2 |
||
| 379 | 399 .global zwn2 |
||
| 380 | 402 zwn2: |
||
| 381 | 403 0020 0000 0000 .skip 4,0 |
||
| 382 | 404 .global zwe2 |
||
| 383 | 405 .global zwe2 |
||
| 384 | 408 zwe2: |
||
| 385 | 409 0024 0000 0000 .skip 4,0 |
||
| 386 | 410 .global gps_getpos |
||
| 387 | 411 .data |
||
| 388 | 414 gps_getpos: |
||
| 389 | 415 0000 0500 .word 5 |
||
| 390 | 416 .global gps_home_n |
||
| 391 | 417 .global gps_home_n |
||
| 392 | 418 .section .bss |
||
| 393 | 421 gps_home_n: |
||
| 394 | 422 0028 0000 0000 .skip 4,0 |
||
| 395 | 423 .global gps_home_e |
||
| 396 | 424 .global gps_home_e |
||
| 397 | 427 gps_home_e: |
||
| 398 | 428 002c 0000 0000 .skip 4,0 |
||
| 399 | 429 .global komp_dreh |
||
| 400 | 430 .global komp_dreh |
||
| 401 | 433 komp_dreh: |
||
| 402 | 434 0030 0000 .skip 2,0 |
||
| 403 | 435 .global gpsmax |
||
| 404 | 436 .data |
||
| 405 | 439 gpsmax: |
||
| 406 | 440 0002 2300 .word 35 |
||
| 407 | 441 .global GPS_Nick |
||
| 408 | 442 .global GPS_Nick |
||
| 409 | 443 .section .bss |
||
| 410 | 446 GPS_Nick: |
||
| 411 | 447 0032 0000 .skip 2,0 |
||
| 412 | 448 .global GPS_Roll |
||
| 413 | 449 .global GPS_Roll |
||
| 414 | 452 GPS_Roll: |
||
| 415 | 453 0034 0000 .skip 2,0 |
||
| 416 | 454 .comm DiffNick,2,1 |
||
| 417 | 455 .comm DiffRoll,2,1 |
||
| 418 | 456 .comm SenderOkay,1,1 |
||
| 419 | 457 .comm CosinusNickWinkel,1,1 |
||
| 420 | 458 .comm CosinusRollWinkel,1,1 |
||
| 421 | 459 .comm durchschnitt_northing,4,1 |
||
| 422 | 460 .comm durchschnitt_easting,4,1 |
||
| 423 | 461 .comm gps_p,2,1 |
||
| 424 | 462 .comm gps_d,2,1 |
||
| 425 | 463 .comm skal,2,1 |
||
| 426 | 464 .comm gps_gethome,2,1 |
||
| 427 | 465 .comm RemoteTasten,1,1 |
||
| 428 | 466 .comm Timeout,1,1 |
||
| 429 | 467 .comm IntegralNick,4,1 |
||
| 430 | 468 .comm IntegralNick2,4,1 |
||
| 431 | 469 .comm IntegralRoll,4,1 |
||
| 432 | 470 .comm IntegralRoll2,4,1 |
||
| 433 | 471 .comm Mess_IntegralNick,4,1 |
||
| 434 | 472 .comm Mess_IntegralNick2,4,1 |
||
| 435 | 473 .comm Mess_IntegralRoll,4,1 |
||
| 436 | 474 .comm Mess_IntegralRoll2,4,1 |
||
| 437 | 475 .comm Integral_Gier,4,1 |
||
| 438 | 476 .comm Mess_Integral_Gier,4,1 |
||
| 439 | 477 .comm h,1,1 |
||
| 440 | 478 .comm m,1,1 |
||
| 441 | 479 .comm s,1,1 |
||
| 442 | 480 .comm Motor_Vorne,1,1 |
||
| 443 | 481 .comm Motor_Hinten,1,1 |
||
| 444 | 482 .comm Motor_Rechts,1,1 |
||
| 445 | 483 .comm Motor_Links,1,1 |
||
| 446 | 484 .comm Count,1,1 |
||
| 447 | 485 .comm MotorWert,5,1 |
||
| 448 | 486 .comm StickNick,2,1 |
||
| 449 | 487 .comm StickRoll,2,1 |
||
| 450 | 488 .comm StickGier,2,1 |
||
| 451 | 489 .comm MotorenEin,1,1 |
||
| 452 | 490 /* File "GPS.c": code 457 = 0x01c9 ( 432), prologues 12, epilogues 13 */ |
||
| 21 | user | 453 | DEFINED SYMBOLS |
| 454 | *ABS*:00000000 GPS.c |
||
| 36 | chris2798 | 455 | C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:3 *ABS*:0000003f __SREG__ |
| 456 | C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:4 *ABS*:0000003e __SP_H__ |
||
| 457 | C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:5 *ABS*:0000003d __SP_L__ |
||
| 458 | C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:6 *ABS*:00000000 __tmp_reg__ |
||
| 459 | C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:7 *ABS*:00000001 __zero_reg__ |
||
| 460 | C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:13 .text:00000000 gps_main |
||
| 461 | C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:414 .data:00000000 gps_getpos |
||
| 462 | C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:354 .bss:00000002 gps_northing |
||
| 463 | C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:360 .bss:00000006 gps_easting |
||
| 464 | C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:366 .bss:0000000a gps_altitude |
||
| 21 | user | 465 | *COM*:00000002 gps_p |
| 36 | chris2798 | 466 | C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:378 .bss:00000010 zwn |
| 467 | C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:384 .bss:00000014 zwe |
||
| 21 | user | 468 | *COM*:00000002 gps_d |
| 36 | chris2798 | 469 | C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:402 .bss:00000020 zwn2 |
| 470 | C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:408 .bss:00000024 zwe2 |
||
| 471 | C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:446 .bss:00000032 GPS_Nick |
||
| 472 | C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:452 .bss:00000034 GPS_Roll |
||
| 473 | C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:439 .data:00000002 gpsmax |
||
| 474 | C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:390 .bss:00000018 zwn1 |
||
| 475 | C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:396 .bss:0000001c zwe1 |
||
| 476 | C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:348 .bss:00000000 loop |
||
| 477 | C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:372 .bss:0000000e alpha |
||
| 478 | C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:421 .bss:00000028 gps_home_n |
||
| 479 | C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:427 .bss:0000002c gps_home_e |
||
| 480 | C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:433 .bss:00000030 komp_dreh |
||
| 21 | user | 481 | *COM*:00000002 DiffNick |
| 482 | *COM*:00000002 DiffRoll |
||
| 483 | *COM*:00000001 SenderOkay |
||
| 484 | *COM*:00000001 CosinusNickWinkel |
||
| 485 | *COM*:00000001 CosinusRollWinkel |
||
| 486 | *COM*:00000004 durchschnitt_northing |
||
| 487 | *COM*:00000004 durchschnitt_easting |
||
| 36 | chris2798 | 488 | *COM*:00000002 skal |
| 489 | *COM*:00000002 gps_gethome |
||
| 21 | user | 490 | *COM*:00000001 RemoteTasten |
| 491 | *COM*:00000001 Timeout |
||
| 492 | *COM*:00000004 IntegralNick |
||
| 493 | *COM*:00000004 IntegralNick2 |
||
| 494 | *COM*:00000004 IntegralRoll |
||
| 495 | *COM*:00000004 IntegralRoll2 |
||
| 496 | *COM*:00000004 Mess_IntegralNick |
||
| 497 | *COM*:00000004 Mess_IntegralNick2 |
||
| 498 | *COM*:00000004 Mess_IntegralRoll |
||
| 499 | *COM*:00000004 Mess_IntegralRoll2 |
||
| 500 | *COM*:00000004 Integral_Gier |
||
| 501 | *COM*:00000004 Mess_Integral_Gier |
||
| 502 | *COM*:00000001 h |
||
| 503 | *COM*:00000001 m |
||
| 504 | *COM*:00000001 s |
||
| 505 | *COM*:00000001 Motor_Vorne |
||
| 506 | *COM*:00000001 Motor_Hinten |
||
| 507 | *COM*:00000001 Motor_Rechts |
||
| 508 | *COM*:00000001 Motor_Links |
||
| 509 | *COM*:00000001 Count |
||
| 510 | *COM*:00000005 MotorWert |
||
| 511 | *COM*:00000002 StickNick |
||
| 512 | *COM*:00000002 StickRoll |
||
| 513 | *COM*:00000002 StickGier |
||
| 36 | chris2798 | 514 | *COM*:00000001 MotorenEin |
| 21 | user | 515 | |
| 516 | UNDEFINED SYMBOLS |
||
| 517 | __do_copy_data |
||
| 518 | __do_clear_bss |
||
| 36 | chris2798 | 519 | Poti1 |
| 21 | user | 520 | actualPos |
| 521 | beeptime |
||
| 522 | __floatsisf |
||
| 36 | chris2798 | 523 | sqrt |
| 524 | __subsf3 |
||
| 21 | user | 525 | __mulsf3 |
| 526 | __fixsfsi |
||
| 36 | chris2798 | 527 | __mulsi3 |
| 528 | __divmodsi4 |