Subversion Repositories FlightCtrl

Rev

Rev 36 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 36 Rev 37
Line 28... Line 28...
28
  29 001c 9091 0000 		lds r25,(Poti1)+1
28
  29 001c 9091 0000 		lds r25,(Poti1)+1
29
  30 0020 1816      		cp __zero_reg__,r24
29
  30 0020 1816      		cp __zero_reg__,r24
30
  31 0022 1906      		cpc __zero_reg__,r25
30
  31 0022 1906      		cpc __zero_reg__,r25
31
  32 0024 04F0      		brlt .+2
31
  32 0024 04F0      		brlt .+2
32
  33 0026 00C0      		rjmp .L2
32
  33 0026 00C0      		rjmp .L2
33
  34 0028 8091 0000 		lds r24,actualPos+32
33
  34 0028 8091 0000 		lds r24,actualPos+24
34
  35 002c 8823      		tst r24
34
  35 002c 8823      		tst r24
35
  36 002e 01F4      		brne .+2
35
  36 002e 01F4      		brne .+2
36
  37 0030 00C0      		rjmp .L2
36
  37 0030 00C0      		rjmp .L2
37
  38 0032 8091 0000 		lds r24,gps_getpos
37
  38 0032 8091 0000 		lds r24,gps_getpos
38
  39 0036 9091 0000 		lds r25,(gps_getpos)+1
38
  39 0036 9091 0000 		lds r25,(gps_getpos)+1
Line 40... Line 40...
40
  41 003c 01F0      		breq .L5
40
  41 003c 01F0      		breq .L5
41
  42 003e 8091 0000 		lds r24,actualPos
41
  42 003e 8091 0000 		lds r24,actualPos
42
  43 0042 9091 0000 		lds r25,(actualPos)+1
42
  43 0042 9091 0000 		lds r25,(actualPos)+1
43
  44 0046 A091 0000 		lds r26,(actualPos)+2
43
  44 0046 A091 0000 		lds r26,(actualPos)+2
44
  45 004a B091 0000 		lds r27,(actualPos)+3
44
  45 004a B091 0000 		lds r27,(actualPos)+3
45
  46 004e 8093 0000 		sts gps_northing,r24
45
  46 004e 8093 0000 		sts target_x,r24
46
  47 0052 9093 0000 		sts (gps_northing)+1,r25
46
  47 0052 9093 0000 		sts (target_x)+1,r25
47
  48 0056 A093 0000 		sts (gps_northing)+2,r26
47
  48 0056 A093 0000 		sts (target_x)+2,r26
48
  49 005a B093 0000 		sts (gps_northing)+3,r27
48
  49 005a B093 0000 		sts (target_x)+3,r27
49
  50 005e 8091 0000 		lds r24,actualPos+4
49
  50 005e 8091 0000 		lds r24,actualPos+4
50
  51 0062 9091 0000 		lds r25,(actualPos+4)+1
50
  51 0062 9091 0000 		lds r25,(actualPos+4)+1
51
  52 0066 A091 0000 		lds r26,(actualPos+4)+2
51
  52 0066 A091 0000 		lds r26,(actualPos+4)+2
52
  53 006a B091 0000 		lds r27,(actualPos+4)+3
52
  53 006a B091 0000 		lds r27,(actualPos+4)+3
53
  54 006e 8093 0000 		sts gps_easting,r24
53
  54 006e 8093 0000 		sts target_y,r24
54
  55 0072 9093 0000 		sts (gps_easting)+1,r25
54
  55 0072 9093 0000 		sts (target_y)+1,r25
55
  56 0076 A093 0000 		sts (gps_easting)+2,r26
55
  56 0076 A093 0000 		sts (target_y)+2,r26
56
  57 007a B093 0000 		sts (gps_easting)+3,r27
56
  57 007a B093 0000 		sts (target_y)+3,r27
57
  58 007e 8091 0000 		lds r24,actualPos+8
57
  58 007e 8091 0000 		lds r24,actualPos+8
58
  59 0082 9091 0000 		lds r25,(actualPos+8)+1
58
  59 0082 9091 0000 		lds r25,(actualPos+8)+1
59
  60 0086 A091 0000 		lds r26,(actualPos+8)+2
59
  60 0086 A091 0000 		lds r26,(actualPos+8)+2
60
  61 008a B091 0000 		lds r27,(actualPos+8)+3
60
  61 008a B091 0000 		lds r27,(actualPos+8)+3
61
  62 008e 8093 0000 		sts gps_altitude,r24
61
  62 008e 8093 0000 		sts target_z,r24
62
  63 0092 9093 0000 		sts (gps_altitude)+1,r25
62
  63 0092 9093 0000 		sts (target_z)+1,r25
63
  64 0096 A093 0000 		sts (gps_altitude)+2,r26
63
  64 0096 A093 0000 		sts (target_z)+2,r26
64
  65 009a B093 0000 		sts (gps_altitude)+3,r27
64
  65 009a B093 0000 		sts (target_z)+3,r27
65
  66 009e 82E3      		ldi r24,lo8(50)
65
  66 009e 82E3      		ldi r24,lo8(50)
66
  67 00a0 90E0      		ldi r25,hi8(50)
66
  67 00a0 90E0      		ldi r25,hi8(50)
67
  68 00a2 9093 0000 		sts (beeptime)+1,r25
67
  68 00a2 9093 0000 		sts (beeptime)+1,r25
68
  69 00a6 8093 0000 		sts beeptime,r24
68
  69 00a6 8093 0000 		sts beeptime,r24
69
  70 00aa 1092 0000 		sts (gps_getpos)+1,__zero_reg__
69
  70 00aa 1092 0000 		sts (gps_getpos)+1,__zero_reg__
70
  71 00ae 1092 0000 		sts gps_getpos,__zero_reg__
70
  71 00ae 1092 0000 		sts gps_getpos,__zero_reg__
71
  72               	.L5:
71
  72               	.L5:
72
  73 00b2 A090 0000 		lds r10,gps_p
72
  73 00b2 A090 0000 		lds r10,gps_p
73
  74 00b6 B090 0000 		lds r11,(gps_p)+1
73
  74 00b6 B090 0000 		lds r11,(gps_p)+1
74
  75 00ba 6091 0000 		lds r22,gps_altitude
74
  75 00ba 6091 0000 		lds r22,target_z
75
  76 00be 7091 0000 		lds r23,(gps_altitude)+1
75
  76 00be 7091 0000 		lds r23,(target_z)+1
76
  77 00c2 8091 0000 		lds r24,(gps_altitude)+2
76
  77 00c2 8091 0000 		lds r24,(target_z)+2
77
  78 00c6 9091 0000 		lds r25,(gps_altitude)+3
77
  78 00c6 9091 0000 		lds r25,(target_z)+3
78
  79 00ca 6E5F      		subi r22,lo8(-(2))
78
  79 00ca 6E5F      		subi r22,lo8(-(2))
79
  80 00cc 7F4F      		sbci r23,hi8(-(2))
79
  80 00cc 7F4F      		sbci r23,hi8(-(2))
80
  81 00ce 8F4F      		sbci r24,hlo8(-(2))
80
  81 00ce 8F4F      		sbci r24,hlo8(-(2))
81
  82 00d0 9F4F      		sbci r25,hhi8(-(2))
81
  82 00d0 9F4F      		sbci r25,hhi8(-(2))
82
  83 00d2 2091 0000 		lds r18,gps_northing
82
  83 00d2 2091 0000 		lds r18,target_x
83
  84 00d6 3091 0000 		lds r19,(gps_northing)+1
83
  84 00d6 3091 0000 		lds r19,(target_x)+1
84
  85 00da 4091 0000 		lds r20,(gps_northing)+2
84
  85 00da 4091 0000 		lds r20,(target_x)+2
85
  86 00de 5091 0000 		lds r21,(gps_northing)+3
85
  86 00de 5091 0000 		lds r21,(target_x)+3
86
  87 00e2 E2E0      		ldi r30,lo8(2)
86
  87 00e2 E2E0      		ldi r30,lo8(2)
87
  88 00e4 EE2E      		mov r14,r30
87
  88 00e4 EE2E      		mov r14,r30
88
  89 00e6 F12C      		mov r15,__zero_reg__
88
  89 00e6 F12C      		mov r15,__zero_reg__
89
  90 00e8 012D      		mov r16,__zero_reg__
89
  90 00e8 012D      		mov r16,__zero_reg__
90
  91 00ea 112D      		mov r17,__zero_reg__
90
  91 00ea 112D      		mov r17,__zero_reg__
Line 139... Line 139...
139
 140 0168 9B01      		movw r18,r22
139
 140 0168 9B01      		movw r18,r22
140
 141 016a AC01      		movw r20,r24
140
 141 016a AC01      		movw r20,r24
141
 142 016c C801      		movw r24,r16
141
 142 016c C801      		movw r24,r16
142
 143 016e B701      		movw r22,r14
142
 143 016e B701      		movw r22,r14
143
 144 0170 0E94 0000 		call __mulsf3
143
 144 0170 0E94 0000 		call __mulsf3
144
 145 0174 20E0      		ldi r18,lo8(0x3e000000)
144
 145 0174 20E0      		ldi r18,lo8(0x41200000)
145
 146 0176 30E0      		ldi r19,hi8(0x3e000000)
145
 146 0176 30E0      		ldi r19,hi8(0x41200000)
146
 147 0178 40E0      		ldi r20,hlo8(0x3e000000)
146
 147 0178 40E2      		ldi r20,hlo8(0x41200000)
147
 148 017a 5EE3      		ldi r21,hhi8(0x3e000000)
147
 148 017a 51E4      		ldi r21,hhi8(0x41200000)
148
 149 017c 0E94 0000 		call __mulsf3
148
 149 017c 0E94 0000 		call __divsf3
149
 150 0180 0E94 0000 		call __fixsfsi
149
 150 0180 0E94 0000 		call __fixsfsi
150
 151 0184 5B01      		movw r10,r22
150
 151 0184 3B01      		movw r6,r22
151
 152 0186 6C01      		movw r12,r24
151
 152 0186 4C01      		movw r8,r24
152
 153 0188 6093 0000 		sts zwn,r22
152
 153 0188 6093 0000 		sts zwn,r22
153
 154 018c 7093 0000 		sts (zwn)+1,r23
153
 154 018c 7093 0000 		sts (zwn)+1,r23
154
 155 0190 8093 0000 		sts (zwn)+2,r24
154
 155 0190 8093 0000 		sts (zwn)+2,r24
155
 156 0194 9093 0000 		sts (zwn)+3,r25
155
 156 0194 9093 0000 		sts (zwn)+3,r25
156
 157 0198 2091 0000 		lds r18,gps_p
156
 157 0198 2091 0000 		lds r18,gps_p
157
 158 019c 3091 0000 		lds r19,(gps_p)+1
157
 158 019c 3091 0000 		lds r19,(gps_p)+1
158
 159 01a0 6091 0000 		lds r22,gps_easting
158
 159 01a0 6091 0000 		lds r22,target_y
159
 160 01a4 7091 0000 		lds r23,(gps_easting)+1
159
 160 01a4 7091 0000 		lds r23,(target_y)+1
160
 161 01a8 8091 0000 		lds r24,(gps_easting)+2
160
 161 01a8 8091 0000 		lds r24,(target_y)+2
161
 162 01ac 9091 0000 		lds r25,(gps_easting)+3
161
 162 01ac 9091 0000 		lds r25,(target_y)+3
162
 163 01b0 E090 0000 		lds r14,actualPos+4
162
 163 01b0 E090 0000 		lds r14,actualPos+4
163
 164 01b4 F090 0000 		lds r15,(actualPos+4)+1
163
 164 01b4 F090 0000 		lds r15,(actualPos+4)+1
164
 165 01b8 0091 0000 		lds r16,(actualPos+4)+2
164
 165 01b8 0091 0000 		lds r16,(actualPos+4)+2
165
 166 01bc 1091 0000 		lds r17,(actualPos+4)+3
165
 166 01bc 1091 0000 		lds r17,(actualPos+4)+3
166
 167 01c0 6E19      		sub r22,r14
166
 167 01c0 6E19      		sub r22,r14
Line 170... Line 170...
170
 171 01c8 4427      		clr r20
170
 171 01c8 4427      		clr r20
171
 172 01ca 37FD      		sbrc r19,7
171
 172 01ca 37FD      		sbrc r19,7
172
 173 01cc 4095      		com r20
172
 173 01cc 4095      		com r20
173
 174 01ce 542F      		mov r21,r20
173
 174 01ce 542F      		mov r21,r20
174
 175 01d0 0E94 0000 		call __mulsi3
174
 175 01d0 0E94 0000 		call __mulsi3
175
 176 01d4 28E0      		ldi r18,lo8(8)
175
 176 01d4 2AE0      		ldi r18,lo8(10)
176
 177 01d6 30E0      		ldi r19,hi8(8)
176
 177 01d6 30E0      		ldi r19,hi8(10)
177
 178 01d8 40E0      		ldi r20,hlo8(8)
177
 178 01d8 40E0      		ldi r20,hlo8(10)
178
 179 01da 50E0      		ldi r21,hhi8(8)
178
 179 01da 50E0      		ldi r21,hhi8(10)
179
 180 01dc 0E94 0000 		call __divmodsi4
179
 180 01dc 0E94 0000 		call __divmodsi4
180
 181 01e0 3901      		movw r6,r18
180
 181 01e0 5901      		movw r10,r18
181
 182 01e2 4A01      		movw r8,r20
181
 182 01e2 6A01      		movw r12,r20
182
 183 01e4 2093 0000 		sts zwe,r18
182
 183 01e4 2093 0000 		sts zwe,r18
183
 184 01e8 3093 0000 		sts (zwe)+1,r19
183
 184 01e8 3093 0000 		sts (zwe)+1,r19
184
 185 01ec 4093 0000 		sts (zwe)+2,r20
184
 185 01ec 4093 0000 		sts (zwe)+2,r20
185
 186 01f0 5093 0000 		sts (zwe)+3,r21
185
 186 01f0 5093 0000 		sts (zwe)+3,r21
186
 187 01f4 6091 0000 		lds r22,gps_d
186
 187 01f4 6091 0000 		lds r22,gps_d
Line 192... Line 192...
192
 193 0204 2091 0000 		lds r18,actualPos+12
192
 193 0204 2091 0000 		lds r18,actualPos+12
193
 194 0208 3091 0000 		lds r19,(actualPos+12)+1
193
 194 0208 3091 0000 		lds r19,(actualPos+12)+1
194
 195 020c 4091 0000 		lds r20,(actualPos+12)+2
194
 195 020c 4091 0000 		lds r20,(actualPos+12)+2
195
 196 0210 5091 0000 		lds r21,(actualPos+12)+3
195
 196 0210 5091 0000 		lds r21,(actualPos+12)+3
196
 197 0214 0E94 0000 		call __mulsi3
196
 197 0214 0E94 0000 		call __mulsi3
197
 198 0218 22E0      		ldi r18,lo8(2)
197
 198 0218 2DEF      		ldi r18,lo8(-3)
198
 199 021a 30E0      		ldi r19,hi8(2)
198
 199 021a 3FEF      		ldi r19,hi8(-3)
199
 200 021c 40E0      		ldi r20,hlo8(2)
199
 200 021c 4FEF      		ldi r20,hlo8(-3)
200
 201 021e 50E0      		ldi r21,hhi8(2)
200
 201 021e 5FEF      		ldi r21,hhi8(-3)
201
 202 0220 0E94 0000 		call __divmodsi4
201
 202 0220 0E94 0000 		call __divmodsi4
202
 203 0224 7901      		movw r14,r18
202
 203 0224 7901      		movw r14,r18
203
 204 0226 8A01      		movw r16,r20
203
 204 0226 8A01      		movw r16,r20
453
DEFINED SYMBOLS
423
DEFINED SYMBOLS
454
                            *ABS*:00000000 GPS.c
424
                            *ABS*:00000000 GPS.c
455
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:3      *ABS*:0000003f __SREG__
425
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccZtEoZ3.s:3      *ABS*:0000003f __SREG__
456
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:4      *ABS*:0000003e __SP_H__
426
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccZtEoZ3.s:4      *ABS*:0000003e __SP_H__
457
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:5      *ABS*:0000003d __SP_L__
427
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccZtEoZ3.s:5      *ABS*:0000003d __SP_L__
458
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:6      *ABS*:00000000 __tmp_reg__
428
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccZtEoZ3.s:6      *ABS*:00000000 __tmp_reg__
459
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:7      *ABS*:00000001 __zero_reg__
429
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccZtEoZ3.s:7      *ABS*:00000001 __zero_reg__
460
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:13     .text:00000000 gps_main
430
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccZtEoZ3.s:13     .text:00000000 gps_main
461
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:414    .data:00000000 gps_getpos
431
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccZtEoZ3.s:382    .data:00000000 gps_getpos
462
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:354    .bss:00000002 gps_northing
432
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccZtEoZ3.s:322    .bss:00000000 target_x
463
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:360    .bss:00000006 gps_easting
433
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccZtEoZ3.s:328    .bss:00000004 target_y
464
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:366    .bss:0000000a gps_altitude
434
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccZtEoZ3.s:334    .bss:00000008 target_z
465
                            *COM*:00000002 gps_p
435
                            *COM*:00000002 gps_p
466
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:378    .bss:00000010 zwn
436
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccZtEoZ3.s:346    .bss:0000000e zwn
467
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:384    .bss:00000014 zwe
437
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccZtEoZ3.s:352    .bss:00000012 zwe
468
                            *COM*:00000002 gps_d
438
                            *COM*:00000002 gps_d
469
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:402    .bss:00000020 zwn2
439
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccZtEoZ3.s:370    .bss:0000001e zwn2
470
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:408    .bss:00000024 zwe2
440
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccZtEoZ3.s:376    .bss:00000022 zwe2
471
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:446    .bss:00000032 GPS_Nick
441
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccZtEoZ3.s:414    .bss:00000030 GPS_Nick
472
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:452    .bss:00000034 GPS_Roll
442
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccZtEoZ3.s:420    .bss:00000032 GPS_Roll
473
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:439    .data:00000002 gpsmax
443
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccZtEoZ3.s:407    .data:00000002 gpsmax
474
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:390    .bss:00000018 zwn1
444
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccZtEoZ3.s:340    .bss:0000000c alpha
475
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:396    .bss:0000001c zwe1
445
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccZtEoZ3.s:358    .bss:00000016 zwn1
476
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:348    .bss:00000000 loop
446
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccZtEoZ3.s:364    .bss:0000001a zwe1
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
447
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccZtEoZ3.s:389    .bss:00000026 gps_home_x
479
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:427    .bss:0000002c gps_home_e
448
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccZtEoZ3.s:395    .bss:0000002a gps_home_y
480
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccFhrJpg.s:433    .bss:00000030 komp_dreh
449
C:\DOKUME~1\CHRIST~1\LOKALE~1\Temp/ccZtEoZ3.s:401    .bss:0000002e komp_dreh
481
                            *COM*:00000002 DiffNick
450
                            *COM*:00000002 DiffNick
482
                            *COM*:00000002 DiffRoll
451
                            *COM*:00000002 DiffRoll
483
                            *COM*:00000001 SenderOkay
452
                            *COM*:00000001 SenderOkay
484
                            *COM*:00000001 CosinusNickWinkel
453
                            *COM*:00000001 CosinusNickWinkel
485
                            *COM*:00000001 CosinusRollWinkel
454
                            *COM*:00000001 CosinusRollWinkel
Line 521... Line 490...
521
beeptime
490
beeptime
522
__floatsisf
491
__floatsisf
523
sqrt
492
sqrt
524
__subsf3
493
__subsf3
525
__mulsf3
494
__mulsf3
-
 
495
__divsf3
526
__fixsfsi
496
__fixsfsi
527
__mulsi3
497
__mulsi3
528
__divmodsi4
498
__divmodsi4