Mercurial > public > hwos_code

annotate src/compass_ops.asm @ 385:b075fa71b659

Find changesets by keywords (author, files, the commit message), revision number or hash, or revset expression.
BUGFIX: +5min for stopwatch during simulation did not work
author heinrichsweikamp
date Wed, 07 Oct 2015 13:14:09 +0200
parents 6f3530eb48f9
children 3c55627d5f8f
Ignore whitespace changes - Everywhere: Within whitespace: At end of lines:
rev   line source
275
653a3ab08062 rename into hwOS
heinrichsweikamp
parents: 264
diff changeset
1 #include "hwos.inc"
147
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
2 #include "i2c.inc"
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
3 #include "tft_outputs.inc"
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
4 #include "isr.inc"
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
5 #include "tft.inc"
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
6 #include "strings.inc"
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
7 #include "wait.inc" ; speed_*
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
8 #include "surfmode.inc"
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
9 #include "divemode.inc"
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
10 #include "math.inc"
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
11 #include "convert.inc"
147
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
12
0
heinrichsweikamp
parents:
diff changeset
13
heinrichsweikamp
parents:
diff changeset
14 ; Make sure symbols from the .inc are available to the C code:
heinrichsweikamp
parents:
diff changeset
15 ; Filtered data
heinrichsweikamp
parents:
diff changeset
16 global compass_DX_f, compass_DY_f, compass_DZ_f
heinrichsweikamp
parents:
diff changeset
17 global accel_DX_f, accel_DY_f, accel_DZ_f
heinrichsweikamp
parents:
diff changeset
18
heinrichsweikamp
parents:
diff changeset
19 ; Calibration data
heinrichsweikamp
parents:
diff changeset
20 global compass_CX_f
heinrichsweikamp
parents:
diff changeset
21 global compass_CY_f
heinrichsweikamp
parents:
diff changeset
22 global compass_CZ_f
heinrichsweikamp
parents:
diff changeset
23
heinrichsweikamp
parents:
diff changeset
24 ; Tmp values to pass Q15 arithmetics around
heinrichsweikamp
parents:
diff changeset
25 global compass_a
heinrichsweikamp
parents:
diff changeset
26 global compass_b
heinrichsweikamp
parents:
diff changeset
27
heinrichsweikamp
parents:
diff changeset
28 ; Result
214
a17359244d93 compass changes
heinrichsweikamp
parents: 148
diff changeset
29 global compass_heading; , compass_roll, compass_pitch
0
heinrichsweikamp
parents:
diff changeset
30
147
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
31 extern compass
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
32 extern compass_reset_calibration
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
33 extern compass_add_calibration
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
34 extern compass_solve_calibration
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
35
337
508d7fb98b34 cleanup menu, add "Auto SP" option (Not working yet), minor layout change in compass menu
heinrichsweikamp
parents: 300
diff changeset
36 extern menu_processor_bottom_line
508d7fb98b34 cleanup menu, add "Auto SP" option (Not working yet), minor layout change in compass menu
heinrichsweikamp
parents: 300
diff changeset
37
282
7d9edd3b8c86 Make a more compact COMPASS calibration code (<7KB), and add more tests.
jDG
parents: 275
diff changeset
38 compass_ops code
0
heinrichsweikamp
parents:
diff changeset
39 ;-----------------------------------------------------------------------------
heinrichsweikamp
parents:
diff changeset
40 ; Filter compass values
heinrichsweikamp
parents:
diff changeset
41 ;
heinrichsweikamp
parents:
diff changeset
42 ; Apply linear filtering to input parameters.
heinrichsweikamp
parents:
diff changeset
43
heinrichsweikamp
parents:
diff changeset
44 ; Apply filtering formula:
heinrichsweikamp
parents:
diff changeset
45 ; reg_f += (reg - reg_f) / 4
heinrichsweikamp
parents:
diff changeset
46 FILTER16 MACRO reg, reg_f
heinrichsweikamp
parents:
diff changeset
47 movf reg_f+0,W
heinrichsweikamp
parents:
diff changeset
48 subwf reg+0,W
heinrichsweikamp
parents:
diff changeset
49 movwf PRODL
heinrichsweikamp
parents:
diff changeset
50 movf reg_f+1,W
heinrichsweikamp
parents:
diff changeset
51 subwfb reg+1,W
148
022b886eddaf some cleanup
heinrichsweikamp
parents: 147
diff changeset
52 rcall filter_16_common
022b886eddaf some cleanup
heinrichsweikamp
parents: 147
diff changeset
53 addwf reg_f+0,F
022b886eddaf some cleanup
heinrichsweikamp
parents: 147
diff changeset
54 movf PRODH,W
022b886eddaf some cleanup
heinrichsweikamp
parents: 147
diff changeset
55 addwfc reg_f+1,F
022b886eddaf some cleanup
heinrichsweikamp
parents: 147
diff changeset
56 ENDM
022b886eddaf some cleanup
heinrichsweikamp
parents: 147
diff changeset
57
022b886eddaf some cleanup
heinrichsweikamp
parents: 147
diff changeset
58 filter_16_common:
0
heinrichsweikamp
parents:
diff changeset
59 movwf PRODH
heinrichsweikamp
parents:
diff changeset
60
heinrichsweikamp
parents:
diff changeset
61 bcf STATUS,C ; Copy sign bit into carry
heinrichsweikamp
parents:
diff changeset
62 btfsc PRODH,7
heinrichsweikamp
parents:
diff changeset
63 bsf STATUS,C
heinrichsweikamp
parents:
diff changeset
64 rrcf PRODH,F ; 16bit shift right
heinrichsweikamp
parents:
diff changeset
65 rrcf PRODL,F
heinrichsweikamp
parents:
diff changeset
66
heinrichsweikamp
parents:
diff changeset
67 bcf STATUS,C ; Copy sign bit into carry
heinrichsweikamp
parents:
diff changeset
68 btfsc PRODH,7
heinrichsweikamp
parents:
diff changeset
69 bsf STATUS,C
heinrichsweikamp
parents:
diff changeset
70 rrcf PRODH,F ; 16bit shift right
heinrichsweikamp
parents:
diff changeset
71 rrcf PRODL,W
148
022b886eddaf some cleanup
heinrichsweikamp
parents: 147
diff changeset
72 return
0
heinrichsweikamp
parents:
diff changeset
73
147
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
74 global compass_filter
0
heinrichsweikamp
parents:
diff changeset
75 compass_filter:
heinrichsweikamp
parents:
diff changeset
76 banksel compass_DX
heinrichsweikamp
parents:
diff changeset
77
heinrichsweikamp
parents:
diff changeset
78 FILTER16 compass_DX, compass_DX_f
heinrichsweikamp
parents:
diff changeset
79 FILTER16 compass_DY, compass_DY_f
heinrichsweikamp
parents:
diff changeset
80 FILTER16 compass_DZ, compass_DZ_f
heinrichsweikamp
parents:
diff changeset
81 FILTER16 accel_DX, accel_DX_f
heinrichsweikamp
parents:
diff changeset
82 FILTER16 accel_DY, accel_DY_f
heinrichsweikamp
parents:
diff changeset
83 FILTER16 accel_DZ, accel_DZ_f
heinrichsweikamp
parents:
diff changeset
84 banksel common
heinrichsweikamp
parents:
diff changeset
85 return
heinrichsweikamp
parents:
diff changeset
86
heinrichsweikamp
parents:
diff changeset
87 ;-----------------------------------------------------------------------------
heinrichsweikamp
parents:
diff changeset
88
heinrichsweikamp
parents:
diff changeset
89 compass_filter_init:
heinrichsweikamp
parents:
diff changeset
90 movff compass_DX+0, compass_DX_f+0
heinrichsweikamp
parents:
diff changeset
91 movff compass_DX+1, compass_DX_f+1
heinrichsweikamp
parents:
diff changeset
92 movff compass_DY+0, compass_DY_f+0
heinrichsweikamp
parents:
diff changeset
93 movff compass_DY+1, compass_DY_f+1
heinrichsweikamp
parents:
diff changeset
94 movff compass_DZ+0, compass_DZ_f+0
heinrichsweikamp
parents:
diff changeset
95 movff compass_DZ+1, compass_DZ_f+1
heinrichsweikamp
parents:
diff changeset
96 movff accel_DX+0, accel_DX_f+0
heinrichsweikamp
parents:
diff changeset
97 movff accel_DX+1, accel_DX_f+1
heinrichsweikamp
parents:
diff changeset
98 movff accel_DY+0, accel_DY_f+0
heinrichsweikamp
parents:
diff changeset
99 movff accel_DY+1, accel_DY_f+1
heinrichsweikamp
parents:
diff changeset
100 movff accel_DZ+0, accel_DZ_f+0
heinrichsweikamp
parents:
diff changeset
101 movff accel_DZ+1, accel_DZ_f+1
heinrichsweikamp
parents:
diff changeset
102 return
heinrichsweikamp
parents:
diff changeset
103
heinrichsweikamp
parents:
diff changeset
104 ;-----------------------------------------------------------------------------
heinrichsweikamp
parents:
diff changeset
105 ; Q15 fractional numbers: a * b / 2**16 (UNSIGNED)
heinrichsweikamp
parents:
diff changeset
106 ;
heinrichsweikamp
parents:
diff changeset
107 ; Uses 16x16->16 multiply, for positiv integers, keeping only the most
heinrichsweikamp
parents:
diff changeset
108 ; revelant bits.
heinrichsweikamp
parents:
diff changeset
109 ;
heinrichsweikamp
parents:
diff changeset
110 ; Used to multiply two Q15 numbers, in the range 0..1,
heinrichsweikamp
parents:
diff changeset
111 ; represented as 0..32767, that is a / 2**15.
heinrichsweikamp
parents:
diff changeset
112 ;
heinrichsweikamp
parents:
diff changeset
113 ; (a/2**15) * (b/2**15) = a*b / 2**30 = (a*b/2**16) / 2**14.
heinrichsweikamp
parents:
diff changeset
114 ; So to get back a Q15 number, we need a shift-left...
heinrichsweikamp
parents:
diff changeset
115 global compass_umul
heinrichsweikamp
parents:
diff changeset
116 compass_umul:
heinrichsweikamp
parents:
diff changeset
117 rcall compass_mul_16
heinrichsweikamp
parents:
diff changeset
118
heinrichsweikamp
parents:
diff changeset
119 ; The 2x time, by left-shifting inserting the missing bit:
heinrichsweikamp
parents:
diff changeset
120 compass_mul_2:
heinrichsweikamp
parents:
diff changeset
121 rlcf compass_r+2,F ; Missing bit into carry
heinrichsweikamp
parents:
diff changeset
122 rlcf compass_r+0,F
heinrichsweikamp
parents:
diff changeset
123 rlcf compass_r+1,F
heinrichsweikamp
parents:
diff changeset
124 movff compass_r+0,PRODL ; return value into ProdH:L
heinrichsweikamp
parents:
diff changeset
125 movff compass_r+1,PRODH
heinrichsweikamp
parents:
diff changeset
126 return
heinrichsweikamp
parents:
diff changeset
127
heinrichsweikamp
parents:
diff changeset
128 ; The 16x16-> multiply:
heinrichsweikamp
parents:
diff changeset
129 compass_mul_16:
heinrichsweikamp
parents:
diff changeset
130 banksel compass_a
heinrichsweikamp
parents:
diff changeset
131
heinrichsweikamp
parents:
diff changeset
132 movf compass_a+1,W ; Block ah*bh
heinrichsweikamp
parents:
diff changeset
133 mulwf compass_b+1
heinrichsweikamp
parents:
diff changeset
134 movff PRODL,compass_r+0 ; and copy
heinrichsweikamp
parents:
diff changeset
135 movff PRODH,compass_r+1
heinrichsweikamp
parents:
diff changeset
136
heinrichsweikamp
parents:
diff changeset
137 movf compass_a+0,W ; Block al*bl
heinrichsweikamp
parents:
diff changeset
138 mulwf compass_b+0
heinrichsweikamp
parents:
diff changeset
139 movff PRODH,compass_r+2 ; Into fraction byte
heinrichsweikamp
parents:
diff changeset
140
heinrichsweikamp
parents:
diff changeset
141 movf compass_a+1,W ; Block ah*bl
heinrichsweikamp
parents:
diff changeset
142 mulwf compass_b+0
heinrichsweikamp
parents:
diff changeset
143 movf PRODL,W
heinrichsweikamp
parents:
diff changeset
144 addwf compass_r+2,F ; Fraction part to carry.
heinrichsweikamp
parents:
diff changeset
145 movf PRODH,W ; and add16
heinrichsweikamp
parents:
diff changeset
146 addwfc compass_r+0,F
heinrichsweikamp
parents:
diff changeset
147 movlw 0
heinrichsweikamp
parents:
diff changeset
148 addwfc compass_r+1,F
heinrichsweikamp
parents:
diff changeset
149
heinrichsweikamp
parents:
diff changeset
150 movf compass_a+0,W ; Block al*bh
heinrichsweikamp
parents:
diff changeset
151 mulwf compass_b+1
heinrichsweikamp
parents:
diff changeset
152 movf PRODL,W
heinrichsweikamp
parents:
diff changeset
153 addwf compass_r+2,F ; Fraction part to carry.
heinrichsweikamp
parents:
diff changeset
154 movf PRODH,W ; and add16
heinrichsweikamp
parents:
diff changeset
155 addwfc compass_r+0,F
heinrichsweikamp
parents:
diff changeset
156 movlw 0
heinrichsweikamp
parents:
diff changeset
157 addwfc compass_r+1,F
heinrichsweikamp
parents:
diff changeset
158
heinrichsweikamp
parents:
diff changeset
159 return
heinrichsweikamp
parents:
diff changeset
160
heinrichsweikamp
parents:
diff changeset
161 ;-----------------------------------------------------------------------------
heinrichsweikamp
parents:
diff changeset
162 ; Q15 fractional numbers: a * b / 2**16 (SIGNED)
heinrichsweikamp
parents:
diff changeset
163
heinrichsweikamp
parents:
diff changeset
164 global compass_imul
heinrichsweikamp
parents:
diff changeset
165 compass_imul:
heinrichsweikamp
parents:
diff changeset
166 rcall compass_mul_16
heinrichsweikamp
parents:
diff changeset
167
heinrichsweikamp
parents:
diff changeset
168 btfss compass_b+1,7
heinrichsweikamp
parents:
diff changeset
169 bra compass_mul_3
heinrichsweikamp
parents:
diff changeset
170
heinrichsweikamp
parents:
diff changeset
171 movf compass_a+0,W
heinrichsweikamp
parents:
diff changeset
172 subwf compass_r+0,F
heinrichsweikamp
parents:
diff changeset
173 movf compass_a+1,W
heinrichsweikamp
parents:
diff changeset
174 subwfb compass_r+1,F
heinrichsweikamp
parents:
diff changeset
175
heinrichsweikamp
parents:
diff changeset
176 compass_mul_3:
heinrichsweikamp
parents:
diff changeset
177 btfss compass_a+1,7
heinrichsweikamp
parents:
diff changeset
178 bra compass_mul_4
heinrichsweikamp
parents:
diff changeset
179
heinrichsweikamp
parents:
diff changeset
180 movf compass_b+0,W
heinrichsweikamp
parents:
diff changeset
181 subwf compass_r+0,F
heinrichsweikamp
parents:
diff changeset
182 movf compass_b+1,W
heinrichsweikamp
parents:
diff changeset
183 subwfb compass_r+1,F
heinrichsweikamp
parents:
diff changeset
184
heinrichsweikamp
parents:
diff changeset
185 compass_mul_4:
heinrichsweikamp
parents:
diff changeset
186 bcf compass_r+1,6 ; Copy bit 7 to 6, so keep it after 2x
heinrichsweikamp
parents:
diff changeset
187 btfsc compass_r+1,7
heinrichsweikamp
parents:
diff changeset
188 bsf compass_r+1,6
heinrichsweikamp
parents:
diff changeset
189 bra compass_mul_2
heinrichsweikamp
parents:
diff changeset
190
147
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
191 global compass_calibration_loop
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
192 compass_calibration_loop: ; Compass calibration
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
193 bsf no_sensor_int ; No Sensor ISR
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
194 call I2C_sleep_accelerometer ; Stop accelerometer
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
195 call I2C_sleep_compass ; Stop compass
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
196 call TFT_ClearScreen
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
197 ; Mask
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
198 WIN_COLOR color_greenish
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
199 WIN_SMALL .16,.0
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
200 STRCPY_TEXT_PRINT tCompassMenu
337
508d7fb98b34 cleanup menu, add "Auto SP" option (Not working yet), minor layout change in compass menu
heinrichsweikamp
parents: 300
diff changeset
201
508d7fb98b34 cleanup menu, add "Auto SP" option (Not working yet), minor layout change in compass menu
heinrichsweikamp
parents: 300
diff changeset
202 call menu_processor_bottom_line
508d7fb98b34 cleanup menu, add "Auto SP" option (Not working yet), minor layout change in compass menu
heinrichsweikamp
parents: 300
diff changeset
203 btfss switch_right2 ; wait until right button is released
147
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
204 bra $-4
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
205
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
206 call TFT_standard_color
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
207 ; WIN_SMALL .0,.215
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
208 ; STRCPY_TEXT_PRINT tExit
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
209 WAITMS d'255'
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
210 WAITMS d'255'
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
211 movlw .7 ; Gain init
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
212 movff WREG,opt_compass_gain
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
213 compass_calibration_gainset: ; Reduce the gain, set bank here!
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
214 banksel opt_compass_gain
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
215 decf opt_compass_gain,F ; Reduce by one
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
216 btfsc STATUS,N ; <0?
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
217 clrf opt_compass_gain ; Yes, keep at zero
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
218
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
219 banksel common
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
220 call I2C_init_accelerometer
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
221 call I2C_init_compass_fast
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
222 rcall TFT_compass_show_gain ; Show the current compass gain
147
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
223
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
224 WAITMS d'100'
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
225
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
226 clrf timeout_counter2
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
227 clrf timeout_counter3
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
228
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
229 call speed_fastest
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
230 call I2C_RX_compass ; read compass
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
231 call I2C_RX_accelerometer ; read Accelerometer
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
232
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
233 ; Test all axes for +4096 (Hi byte=16)
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
234 banksel compass_DX+1
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
235 movlw .16
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
236 cpfseq compass_DX+1
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
237 bra $+4
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
238 bra compass_calibration_gainset
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
239 cpfseq compass_DY+1
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
240 bra $+4
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
241 bra compass_calibration_gainset
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
242 cpfseq compass_DZ+1
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
243 bra $+4
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
244 bra compass_calibration_gainset
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
245
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
246 ; Test all axes for -4096 (Hi byte=240)
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
247 movlw .240
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
248 cpfseq compass_DX+1
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
249 bra $+4
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
250 bra compass_calibration_gainset
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
251 cpfseq compass_DY+1
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
252 bra $+4
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
253 bra compass_calibration_gainset
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
254 cpfseq compass_DZ+1
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
255 bra $+4
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
256 bra compass_calibration_gainset
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
257 banksel common
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
258
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
259 rcall compass_filter_init ; set DX_f values
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
260 call compass_reset_calibration ; Reset CX_f values
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
261 banksel common
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
262
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
263 compass_calibration_loop2:
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
264 call I2C_RX_compass ; read compass
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
265 call I2C_RX_accelerometer ; Test Accelerometer
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
266 rcall compass_filter ; Filter compass raw data
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
267 banksel common
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
268
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
269 ; Twice
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
270 call I2C_RX_compass ; read compass
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
271 call I2C_RX_accelerometer ; Test Accelerometer
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
272 rcall compass_filter ; Filter compass raw data
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
273 banksel common
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
274
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
275 ; Test all axes for +4096 (Hi byte=16)
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
276 banksel compass_DX+1
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
277 movlw .16
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
278 cpfseq compass_DX+1
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
279 bra $+4
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
280 bra compass_calibration_gainset
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
281 cpfseq compass_DY+1
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
282 bra $+4
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
283 bra compass_calibration_gainset
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
284 cpfseq compass_DZ+1
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
285 bra $+4
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
286 bra compass_calibration_gainset
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
287
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
288 ; Test all axes for -4096 (Hi byte=240)
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
289 movlw .240
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
290 cpfseq compass_DX+1
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
291 bra $+4
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
292 bra compass_calibration_gainset
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
293 cpfseq compass_DY+1
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
294 bra $+4
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
295 bra compass_calibration_gainset
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
296 cpfseq compass_DZ+1
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
297 bra $+4
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
298 bra compass_calibration_gainset
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
299 banksel common
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
300 ;
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
301 ; ; Three
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
302 ; call I2C_RX_compass ; read compass
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
303 ; call I2C_RX_accelerometer ; Test Accelerometer
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
304 ; call compass_filter ; Filter compass raw data
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
305 ; banksel common
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
306 ;
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
307 ; ; Four times to get cleaner values
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
308 ; call I2C_RX_compass ; read compass
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
309 ; call I2C_RX_accelerometer ; Test Accelerometer
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
310 ; call compass_filter ; Filter compass raw data
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
311
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
312 ; And register only one value out of four:
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
313 call compass_add_calibration ; check and store new max/min values
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
314 banksel common
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
315
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
316 call TFT_compass_fast ; show values
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
317
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
318 btfsc sleepmode ; Sleepmode active?
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
319 bra compass_calibration_exit ; Yes, exit
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
320
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
321 ; btfsc switch_left ; Button pressed?
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
322 ; bra compass_calibration_exit ; Yes, exit
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
323
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
324 btfss onesecupdate ; do every second tasks?
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
325 bra compass_calibration_loop2 ; no, loop here
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
326
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
327 movlw .60
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
328 call timeout_testmode ; check timeout
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
329 movlw .60
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
330 rcall TFT_show_timeout_testmode ; Show the timeout
147
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
331
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
332 bcf onesecupdate ; clear flag
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
333
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
334 bra compass_calibration_loop2 ; loop here
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
335
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
336 compass_calibration_exit:
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
337 call compass_solve_calibration
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
338 banksel common
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
339 extern option_save_all
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
340 call option_save_all ; save all settings into EEPROM
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
341 bcf sleepmode ; Clear the flag before exiting to surfacemode
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
342 movlw .6
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
343 movwf customview_surfmode ; Set to compass view...
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
344 goto surfloop ; ...and exit
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
345
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
346 global TFT_compass_fast
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
347 TFT_compass_fast:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
348 WIN_TINY .20,.50
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
349 STRCPY "X:"
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
350 movff compass_DX+0,lo
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
351 movff compass_DX+1,hi
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
352 call TFT_convert_signed_16bit ; converts lo:hi into signed-short and adds '-' to POSTINC2 if required
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
353 output_16
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
354 STRCAT " Y:"
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
355 movff compass_DY+0,lo
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
356 movff compass_DY+1,hi
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
357 call TFT_convert_signed_16bit ; converts lo:hi into signed-short and adds '-' to POSTINC2 if required
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
358 output_16
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
359 STRCAT " Z:"
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
360 movff compass_DZ+0,lo
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
361 movff compass_DZ+1,hi
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
362 call TFT_convert_signed_16bit ; converts lo:hi into signed-short and adds '-' to POSTINC2 if required
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
363 output_16
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
364 STRCAT_PRINT " "
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
365 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
366
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
367 TFT_show_timeout_testmode: ; With timeout in WREG...
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
368 movwf hi
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
369 WIN_TINY .20,.68
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
370 STRCPY "T:"
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
371 movf timeout_counter2,W ; current timeout
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
372 subwf hi,W ; subtract from timeout value
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
373 addlw .1 ; +1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
374 movwf lo
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
375 bsf leftbind
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
376 output_8 ; Display timeout
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
377 bcf leftbind
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
378 STRCAT_PRINT "s "
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
379 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
380
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
381
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
382 TFT_compass_show_gain: ; Show the current compass gain
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
383 movff opt_compass_gain,lo ; 0-7 (230LSB/Gauss to 1370LSB/Gaus)
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
384 tstfsz lo
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
385 return ; Do not show unless gain=0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
386 WIN_TINY .20,.86
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
387 STRCPY_TEXT tCompassGain
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
388 movff opt_compass_gain,lo ; 0-7 (230LSB/Gauss to 1370LSB/Gaus)
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
389 bsf leftbind
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
390 output_8
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
391 bcf leftbind
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
392 STRCAT_PRINT "!"
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
393 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
394
382
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
395 TFT_surface_compass_bearing:
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
396 WIN_SMALL surf_compass_bear_column,surf_compass_bear_row
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
397 movff compass_bearing+0,lo
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
398 movff compass_bearing+1,hi
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
399 PUTC "("
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
400 bsf leftbind
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
401 output_16dp .2 ; Result is "0.000"
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
402 bcf leftbind
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
403 ; rearrange figures to "000"
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
404 movff buffer+3,buffer+1
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
405 movff buffer+4,buffer+2
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
406 movff buffer+5,buffer+3
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
407 lfsr FSR2,buffer+4
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
408 STRCAT "° "
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
409 rcall tft_compass_cardinal ; Add cardinal and ordinal to POSTINC2
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
410 STRCAT_PRINT ")"
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
411 return
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
412
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
413 global TFT_surface_compass_mask
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
414 TFT_surface_compass_mask:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
415 WIN_SMALL surf_compass_mask_column,surf_compass_mask_row
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
416 call TFT_standard_color
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
417 STRCPY_TEXT_PRINT tHeading ; Heading:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
418 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
419
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
420 global TFT_dive_compass_mask
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
421 TFT_dive_compass_mask:
300
5ad479f2a868 Merged Screen layout mod #1 into Screen layout work #3
Janos Kovacs <kovjanos@gmail.com>
parents: 282
diff changeset
422 WIN_FRAME_STD dm_custom_compass_graph_row, dm_custom_compass_graph_row+dm_custom_compass_graph_height, .0, .159
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
423 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
424
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
425 global TFT_surface_compass_heading
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
426 TFT_surface_compass_heading:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
427 rcall compass_heading_common
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
428 WIN_STD surf_compass_head_column,surf_compass_head_row
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
429 call TFT_standard_color
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
430 TFT_surface_compass_heading_com: ; Show "000° N"
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
431 movff compass_heading+0,lo
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
432 movff compass_heading+1,hi
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
433 call TFT_convert_signed_16bit ; converts lo:hi into signed-short and adds '-' to POSTINC2 if required
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
434
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
435 ; Shown and actual identical?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
436 movff compass_heading_shown+0,WREG
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
437 cpfseq lo
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
438 bra TFT_surface_compass_heading_com1 ; Not equal
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
439 movff compass_heading_shown+1,WREG
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
440 cpfseq hi
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
441 bra TFT_surface_compass_heading_com1 ; Not equal
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
442 bra TFT_surface_compass_heading_com3 ; equal, skip smoothing
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
443
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
444 TFT_surface_compass_heading_com1:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
445 movff lo,sub_a+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
446 movff hi,sub_a+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
447 movff compass_heading_shown+0,sub_b+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
448 movff compass_heading_shown+1,sub_b+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
449 call subU16
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
450 btfsc neg_flag
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
451 bra TFT_surface_compass_heading_com2 ; shown > actual
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
452 ; shown < actual
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
453 banksel compass_heading_shown
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
454 infsnz compass_heading_shown+0,F
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
455 incf compass_heading_shown+1,F ; +1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
456 bra TFT_surface_compass_heading_com3
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
457
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
458 TFT_surface_compass_heading_com2:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
459 banksel compass_heading_shown
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
460 movlw d'1'
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
461 subwf compass_heading_shown+0,F
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
462 movlw d'0'
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
463 subwfb compass_heading_shown+1,F ; -1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
464
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
465 TFT_surface_compass_heading_com3:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
466 banksel common
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
467 movff compass_heading_shown+0,lo
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
468 movff compass_heading_shown+1,hi
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
469 bsf leftbind
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
470 output_16dp .2 ; Result is "0.000"
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
471 bcf leftbind
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
472 ; rearrange figures to "000"
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
473 movff buffer+2,buffer+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
474 movff buffer+3,buffer+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
475 movff buffer+4,buffer+2
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
476 lfsr FSR2,buffer+3
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
477 STRCAT "° "
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
478 rcall tft_compass_cardinal ; Add cardinal and ordinal to POSTINC2
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
479 clrf WREG
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
480 movff WREG,buffer+.7 ; limit to 7 chars
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
481 STRCAT_PRINT ""
382
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
482
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
483 btfsc divemode
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
484 return ; Done for divemode.
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
485 ; Show bearing on the surface?
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
486 btfss compass_bearing_set
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
487 return ; No, return
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
488 btfsc premenu ; "Bearing?" shown?
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
489 return ; Yes, return
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
490 bra TFT_surface_compass_bearing
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
491
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
492 global TFT_dive_compass_heading
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
493 TFT_dive_compass_heading:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
494 rcall compass_heading_common
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
495 ; ; ToDo - these are for development only, hardcoding the bearing position
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
496 ; ; 244° : SW - W
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
497 ; movlw low(d'244')
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
498 ; movff WREG,compass_bearing+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
499 ; movlw high(d'244')
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
500 ; movff WREG,compass_bearing+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
501
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
502 movff compass_heading_shown+0,xA+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
503 movff compass_heading_shown+1,xA+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
504 ; xRD and xRDlft
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
505 ; 1. 160° viewing angle: +360 offset if xA<=292; for non-negative scale
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
506 movlw high(d'292')
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
507 movff WREG,sub_a+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
508 movlw low(d'292')
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
509 movff WREG,sub_a+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
510 movff xA+1,sub_b+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
511 movff xA+0,sub_b+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
512 call subU16 ; sub_c = sub_a - sub_b
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
513 btfsc neg_flag ; xA>292
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
514 bra TFT_dive_compass_heading_1 ;yes
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
515 ; no, xA<=292
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
516 movlw high(d'360')
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
517 addwf xA+1,1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
518 movlw low(d'360')
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
519 addwf xA+0,1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
520 btfsc STATUS,C
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
521 incf xA+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
522 TFT_dive_compass_heading_1:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
523 ; 2. -80: left pixel offset from the center
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
524 movlw low( d'80' )
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
525 subwf xA+0,1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
526 btfss STATUS,C
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
527 decf xA+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
528 ; 3. save it to xRD
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
529 movff xA+0,xRD+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
530 movff xA+1,xRD+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
531 ; 4. add 160 (display px width)
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
532 movlw high(d'160')
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
533 addwf xA+1,1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
534 movlw low(d'160')
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
535 addwf xA+0,1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
536 btfsc STATUS,C
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
537 incf xA+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
538 ; 5. save it to xRDr
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
539 movff xA+0,xRDr+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
540 movff xA+1,xRDr+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
541
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
542 btfss compass_bearing_set
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
543 bra TFT_dive_compass_ruler ; no value in the bearing, skip calc
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
544
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
545 ; we have bearing set, we will need xRD180 calculated
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
546 ; xRD180 is xRDr-180
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
547 movff xRDr+1,sub_a+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
548 movff xRDr+0,sub_a+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
549 movlw high(d'180')
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
550 movff WREG,sub_b+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
551 movlw low(d'180')
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
552 movff WREG,sub_b+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
553 call subU16 ; sub_c = sub_a - sub_b
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
554 movff sub_c+1,xRD180+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
555 movff sub_c+0,xRD180+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
556
258
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
557 TFT_dive_compass_bearing_1:
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
558 ; calculate bearing position and visibility (ahead or behind)
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
559 bcf compass_bearing_vis ; default is not-visibly
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
560 bcf compass_bearing_ahd ; default is behind
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
561 ; get the bearing virtual display offset, store it to divA
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
562 movff compass_bearing+0,xA+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
563 movff compass_bearing+1,xA+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
564 movlw high(d'360')
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
565 addwf xA+1,1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
566 movlw low(d'360')
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
567 addwf xA+0,1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
568 btfsc STATUS,C
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
569 incf xA+1
258
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
570 ; save it to reuse for upper/lower turns and ahead/behind checks
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
571 movff xA+1,divA+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
572 movff xA+0,divA+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
573
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
574 ; check if it's ahead
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
575 ; load the bearing offset into sub_a
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
576 movff divA+1,sub_a+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
577 movff divA+0,sub_a+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
578 ; load the display offset back to sub_b
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
579 movff xRD+0,sub_b+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
580 movff xRD+1,sub_b+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
581 rcall TFT_dive_compass_bearing_ap
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
582 ;test if we found it
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
583 btfsc compass_bearing_vis
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
584 bra TFT_dive_compass_bearing_dir
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
585
258
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
586 ; check if it's ahead with an upper turn
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
587 ; load the bearing offset into sub_a
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
588 movff divA+1,sub_a+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
589 movff divA+0,sub_a+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
590 ; load the display offset back to sub_b
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
591 movff xRD+0,sub_b+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
592 movff xRD+1,sub_b+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
593 movlw high(d'360')
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
594 addwf sub_b+1,1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
595 movlw low(d'360')
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
596 addwf sub_b+0,1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
597 btfsc STATUS,C
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
598 incf sub_b+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
599 rcall TFT_dive_compass_bearing_ap
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
600 ;test if we found it
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
601 btfsc compass_bearing_vis
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
602 bra TFT_dive_compass_bearing_dir
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
603
258
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
604 ; check if it's ahead with a lower turn
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
605 ; load the bearing offset into sub_a
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
606 movff divA+1,sub_a+1
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
607 movff divA+0,sub_a+0
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
608 movlw high(d'360')
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
609 addwf sub_a+1,1
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
610 movlw low(d'360')
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
611 addwf sub_a+0,1
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
612 btfsc STATUS,C
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
613 incf sub_a+1
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
614 ; load the display offset back to sub_b
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
615 movff xRD+0,sub_b+0
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
616 movff xRD+1,sub_b+1
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
617 rcall TFT_dive_compass_bearing_ap
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
618 ;test if we found it
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
619 btfsc compass_bearing_vis
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
620 bra TFT_dive_compass_bearing_dir
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
621
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
622 ; marker is not ahead of us, check if it's behind us
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
623 ; use the (160 - (xRD180 - xCM)) formula to see if it's on the display
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
624 ; load the display offset back to sub_a
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
625 movff xRD180+0,sub_a+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
626 movff xRD180+1,sub_a+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
627 ; load the marker's offset into sub_b
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
628 movff divA+0,sub_b+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
629 movff divA+1,sub_b+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
630 rcall TFT_dive_compass_bearing_bp
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
631 ;test if we found it
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
632 btfsc compass_bearing_vis
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
633 bra TFT_dive_compass_bearing_dir
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
634
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
635 ;check if it's behind with the lower turn
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
636 movff xRD180+0,sub_a+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
637 movff xRD180+1,sub_a+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
638 movlw high(d'360')
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
639 addwf sub_a+1,1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
640 movlw low(d'360')
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
641 addwf sub_a+0,1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
642 btfsc STATUS,C
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
643 incf sub_a+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
644 ; load the marker's offset into sub_b
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
645 movff divA+0,sub_b+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
646 movff divA+1,sub_b+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
647 rcall TFT_dive_compass_bearing_bp
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
648 ;test if we found it
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
649 btfsc compass_bearing_vis
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
650 bra TFT_dive_compass_bearing_dir
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
651
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
652 ; check if it's behind with the upper turn
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
653 movff divA+1,sub_b+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
654 movff divA+0,sub_b+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
655 movlw high(d'360')
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
656 addwf sub_b+1,1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
657 movlw low(d'360')
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
658 addwf sub_b+0,1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
659 btfsc STATUS,C
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
660 incf sub_b+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
661 rcall TFT_dive_compass_bearing_bp
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
662 bra TFT_dive_compass_bearing_dir
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
663
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
664 TFT_dive_compass_bearing_ap:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
665 ; xCM received in sub_a
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
666 ; xRD received in sub_b
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
667 ; 1/a. check if it's viewable from the left side
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
668 call subU16 ; sub_c = sub_a - sub_b
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
669 btfsc neg_flag ; xRD>divA
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
670 return ;no,
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
671 ; yes, store the RO=RP-RD for drawing
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
672 movff sub_c+0,xC+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
673 movff sub_c+1,xC+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
674 ; 1/b. check if it's viewable from the right side?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
675 movlw d'2' ; avoid thin mess on the side of the display
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
676 addwf sub_a+0,1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
677 btfsc STATUS, C
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
678 incf sub_a+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
679 ; load the display offset right side into sub_b
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
680 movlw high(d'158')
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
681 addwf sub_b+1,1
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
682 movlw low(d'158')
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
683 addwf sub_b+0,1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
684 btfsc STATUS,C
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
685 incf sub_b+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
686 call subU16 ; sub_c = sub_a - sub_b
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
687 btfss neg_flag ; xRDr>xA(+2)
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
688 return ; no,
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
689 ; print the bearing lines on the screen
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
690 movff xC+0,xCM
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
691 bsf compass_bearing_vis ; set visible
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
692 bsf compass_bearing_ahd ; set ahead
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
693 return ; done,
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
694
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
695 TFT_dive_compass_bearing_bp:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
696 ; use the (160 - (xRD180 - xCM)) formula to see if it's on the display
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
697 ; the marker's offset received in sub_b
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
698 ; the xRD180 display offset received in sub_a
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
699 ; xRD180 - xCM
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
700 call subU16 ; sub_c = sub_a - sub_b
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
701 btfsc neg_flag ; CM>xRD180
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
702 return ; no, not on screen
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
703 ; 160 - (X)
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
704 movlw high(d'158')
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
705 movff WREG,sub_a+1
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
706 movlw low(d'158')
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
707 movff WREG,sub_a+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
708 movff sub_c+1,sub_b+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
709 movff sub_c+0,sub_b+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
710 call subU16 ; sub_c = sub_a - sub_b
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
711 btfsc neg_flag ; X>160
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
712 return ; no, not on screen
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
713 ; check if not overflow - this sounds a double check...
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
714 movlw d'1'
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
715 cpfslt sub_c+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
716 return ; high set, >160
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
717 movlw d'158'
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
718 cpfslt sub_c+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
719 return ; low >160
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
720 ; print the bearing lines on the screen
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
721 movff sub_c+0,xCM
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
722 bsf compass_bearing_vis
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
723 return ; done
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
724
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
725 TFT_dive_compass_bearing_dir:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
726 ; check if bearing to heading, and calculate the direction
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
727 bcf compass_bearing_eq
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
728 btfss compass_bearing_vis
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
729 bra TFT_dive_compass_bearing_lr
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
730 btfss compass_bearing_ahd
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
731 bra TFT_dive_compass_bearing_lr
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
732 movff xCM,xA+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
733 movlw d'80'
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
734 cpfseq xA+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
735 bra TFT_dive_compass_bearing_lr
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
736 bsf compass_bearing_eq
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
737 bra TFT_dive_compass_ruler ; bearing points to heading, no signs are required, go to the ruler
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
738
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
739 TFT_dive_compass_bearing_lr:
258
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
740 ; get the bearing virtual display offset
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
741 movff compass_bearing+0,xA+0
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
742 movff compass_bearing+1,xA+1
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
743 ; divA =IF (U10>292;U10;U10+360)
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
744 movlw high(d'292')
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
745 movff WREG,sub_a+1
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
746 movlw low(d'292')
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
747 movff WREG,sub_a+0
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
748 movff xA+1,sub_b+1
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
749 movff xA+0,sub_b+0
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
750 call subU16 ; sub_c = sub_a - sub_b
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
751 btfsc neg_flag ; xA>292
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
752 bra TFT_dive_compass_bearing_lr_1 ;yes
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
753 ; no, xA<=292
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
754 movlw high(d'360')
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
755 addwf xA+1,1
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
756 movlw low(d'360')
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
757 addwf xA+0,1
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
758 btfsc STATUS,C
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
759 incf xA+1
da9074180bff patch for bearing issue
heinrichsweikamp
parents: 257
diff changeset
760 TFT_dive_compass_bearing_lr_1:
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
761 ; 1. calculate whether bearing is to left or to right
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
762 bsf compass_bearing_lft ; to the left by default
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
763 ; xC: save center value to compare the direction to front value
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
764 movff xA+1,xC+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
765 movff xA+0,xC+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
766 ; xB: we need the left side for comparism... left = -180
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
767 movff xA+1,sub_a+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
768 movff xA+0,sub_a+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
769 movlw high(d'180')
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
770 movff WREG,sub_b+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
771 movlw low(d'180')
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
772 movff WREG,sub_b+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
773 call subU16 ; sub_c = sub_a - sub_b
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
774 movff sub_c+1,xB+1 ; xB has the left side of the 180° distance center
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
775 movff sub_c+0,xB+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
776 ; xA = IF(xRD>(xC+100);xRD-280;xRD+80)
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
777 movff xC+1,sub_a+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
778 movff xC+0,sub_a+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
779 movlw d'100'
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
780 addwf sub_a+0,1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
781 btfsc STATUS,C
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
782 incf sub_a+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
783 movff xRD+1,sub_b+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
784 movff xRD+0,sub_b+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
785 call subU16 ; sub_c = sub_a - sub_b
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
786 btfsc neg_flag ; xRD>xC+100
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
787 bra TFT_dive_compass_bearing_lr_2 ; yes, xA=xRD-280
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
788 ; no, xA = xRD+80
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
789 movff xRD+1,xA+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
790 movff xRD+0,xA+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
791 movlw d'80'
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
792 addwf xA+0,1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
793 btfsc STATUS,C
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
794 incf xA+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
795 bra TFT_dive_compass_bearing_lr_c
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
796
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
797 TFT_dive_compass_bearing_lr_2:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
798 ; xA=xRD-280
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
799 movff xRD+1,sub_a+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
800 movff xRD+0,sub_a+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
801 movlw high(d'280')
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
802 movff WREG,sub_b+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
803 movlw low(d'280')
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
804 movff WREG,sub_b+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
805 call subU16 ; sub_c = sub_a - sub_b
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
806 movff sub_c+1,xA+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
807 movff sub_c+0,xA+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
808 ;bra TFT_dive_compass_bearing_lr_c
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
809
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
810 TFT_dive_compass_bearing_lr_c:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
811 ; xB < xA < xC => right, otherwise left (default)
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
812 movff xA+1,sub_b+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
813 movff xA+0,sub_b+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
814 movff xB+1,sub_a+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
815 movff xB+0,sub_a+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
816 call subU16 ; sub_c = sub_a - sub_b
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
817 btfss neg_flag ; xA>xB ?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
818 bra TFT_dive_compass_ruler ; No, xB >= xA, keep default left
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
819 movff xA+1,sub_a+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
820 movff xA+0,sub_a+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
821 movff xC+1,sub_b+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
822 movff xC+0,sub_b+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
823 call subU16 ; sub_c = sub_a - sub_b
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
824 btfss neg_flag ; xC>xA ?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
825 bra TFT_dive_compass_ruler ; No, xA >= xC, keep default left
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
826 bcf compass_bearing_lft
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
827
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
828 TFT_dive_compass_ruler:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
829 ; calculate mod15 for the ticks
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
830 movff xRD+0,xA+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
831 movff xRD+1,xA+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
832 movlw d'15'
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
833 movwf xB+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
834 clrf xB+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
835 call div16x16 ;xA/xB=xC with xA+0 as remainder
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
836 ; check xA+0, it has the remainder
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
837 movlw d'0'
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
838 cpfsgt xA+0 ; mod15 > 0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
839 bra TFT_dive_compass_ruler_1 ; no, RM = 0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
840 ; yes RM = 15 - RDmod15
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
841 movlw d'15'
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
842 subfwb xA+0,1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
843 TFT_dive_compass_ruler_1:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
844 ; xA+0 holds the RM, store it to 'lo'
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
845 movff xA+0,lo
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
846 ; init DD to zero, store it to 'hi'
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
847 clrf hi
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
848
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
849 TFT_dive_compass_ruler_loop:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
850 ; 1. check if we run of from the display
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
851 movlw d'159' ; Looks like 159 works because TFT_box limits the dispay
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
852 cpfslt lo,1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
853 bra TFT_dive_compass_ruler_lend ; xRM >= W
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
854 ; 2. Clear the tick area from DD to RM - in segments to avoid blinking
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
855 ; don't do a clear if we are at 0 (zero) otherwise it will blink
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
856 ; because of the width underflow
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
857 movlw d'0'
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
858 cpfsgt lo,1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
859 bra TFT_dive_compass_ruler_loop_zz
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
860 rcall TFT_dive_compass_clr_ruler
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
861 TFT_dive_compass_ruler_loop_zz:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
862 ; 3. Draw the markers @ RM
370
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
863 ; we receive RM in lo and DD in hi
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
864 movlw dm_custom_compass_tick_top_top
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
865 movff WREG,win_top
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
866 movlw dm_custom_compass_tick_height
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
867 movff WREG,win_height
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
868 movlw d'2'
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
869 movff WREG,win_width
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
870 movff WREG,win_bargraph
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
871 movff lo,win_leftx2 ; 0..159
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
872 call TFT_standard_color
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
873 call TFT_box
370
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
874 movlw dm_custom_compass_tick_bot_top
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
875 movff WREG,win_top
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
876 movlw dm_custom_compass_tick_height
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
877 movff WREG,win_height
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
878 call TFT_standard_color ; color in WREG is trashed, must be set again!
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
879 call TFT_box
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
880 ; 4. If D<82 and RM>79: means we put something over the center line
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
881 ; redraw the center line
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
882 movlw d'82'
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
883 cpfslt hi,1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
884 bra TFT_dive_compass_ruler_loop_zz2
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
885 movlw d'79'
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
886 cpfsgt lo,1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
887 bra TFT_dive_compass_ruler_loop_zz2
370
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
888 ;enough to print cline as bearing marker is not in the ticker area
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
889 movlw color_yellow
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
890 WIN_BOX_COLOR dm_custom_compass_tick_top_top, dm_custom_compass_tick_bot_bot,.80,.81 ; center line in yellow
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
891 TFT_dive_compass_ruler_loop_zz2:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
892 ; 5. set D = RM + 2 : position after the 2px tick
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
893 movff lo,hi
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
894 movlw d'2'
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
895 addwf hi,F
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
896 ; 6. set RM = RM + 15 : position to the next tick
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
897 movlw d'15'
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
898 addwf lo,F
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
899 ; 7. loop
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
900 bra TFT_dive_compass_ruler_loop
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
901
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
902 TFT_dive_compass_ruler_lend: ; loop end
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
903 ; 8. clear the rest of the tick area if D<160
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
904 movlw d'160'
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
905 cpfslt hi
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
906 bra TFT_dive_compass_ruler_lend2 ; D >= W
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
907 ; 9. position left to end of display to clear the remaining area
370
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
908 movlw d'159'
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
909 movwf lo
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
910 ; 10. clear it
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
911 rcall TFT_dive_compass_clr_ruler
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
912
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
913 TFT_dive_compass_ruler_lend2:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
914 ; done with the compass ruler, put the labels on the screen
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
915 ; get the RD abck to sub_b
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
916 movff xRD+0,sub_b+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
917 movff xRD+1,sub_b+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
918 ; hi stores the display position
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
919 clrf hi
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
920 clrf xHI
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
921 ; lo stores the last item's display position
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
922 clrf lo
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
923 clrf xLO
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
924
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
925 movlw d'14'
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
926 movwf up ; cardinal width in px
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
927 movlw low( d'219' ) ; position of the label
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
928 movwf sub_a+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
929 movlw high( d'219' )
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
930 movwf sub_a+1
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
931 rcall TFT_dive_compass_label_proc ; check if the label should be on screen
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
932 btfss print_compass_label ; Yes?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
933 bra dcr_1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
934 STRCPY_TEXT_PRINT tSW ; yes - print it
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
935 dcr_1:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
936 rcall TFT_dive_compass_c_mk ; check if label is on the center line or the marker
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
937
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
938 movlw d'14'
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
939 movwf up ; cardinal width in px
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
940 movlw low( d'267' ) ; position of the label
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
941 movwf sub_a+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
942 movlw high( d'267' )
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
943 movwf sub_a+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
944 rcall TFT_dive_compass_label_proc ; check if the label should be on screen
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
945 btfss print_compass_label ; Yes?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
946 bra dcr_2
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
947 STRCPY_TEXT_PRINT tW ; yes - print it
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
948 dcr_2:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
949 rcall TFT_dive_compass_c_mk ; check if label is on the center line or the marker
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
950
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
951 movlw d'14'
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
952 movwf up ; cardinal width in px
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
953 movlw low( d'309' ) ; position of the label
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
954 movwf sub_a+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
955 movlw high( d'309' )
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
956 movwf sub_a+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
957 rcall TFT_dive_compass_label_proc ; check if the label should be on screen
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
958 btfss print_compass_label ; Yes?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
959 bra dcr_3
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
960 STRCPY_TEXT_PRINT tNW ; yes - print it
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
961 dcr_3:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
962 rcall TFT_dive_compass_c_mk ; check if label is on the center line or the marker
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
963
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
964 movlw d'14'
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
965 movwf up ; cardinal width in px
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
966 movlw low( d'358' ) ; position of the label
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
967 movwf sub_a+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
968 movlw high( d'358' )
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
969 movwf sub_a+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
970 rcall TFT_dive_compass_label_proc ; check if the label should be on screen
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
971 btfss print_compass_label ; Yes?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
972 bra dcr_4
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
973 STRCPY_TEXT_PRINT tN ; yes - print it
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
974 dcr_4:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
975 rcall TFT_dive_compass_c_mk ; check if label is on the center line or the marker
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
976
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
977 movlw d'14'
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
978 movwf up ; cardinal width in px
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
979 movlw low( d'399' ) ; position of the label
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
980 movwf sub_a+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
981 movlw high( d'399' )
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
982 movwf sub_a+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
983 rcall TFT_dive_compass_label_proc ; check if the label should be on screen
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
984 btfss print_compass_label ; Yes?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
985 bra dcr_5
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
986 STRCPY_TEXT_PRINT tNE ; yes - print it
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
987 dcr_5:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
988 rcall TFT_dive_compass_c_mk ; check if label is on the center line or the marker
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
989
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
990 movlw d'14'
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
991 movwf up ; cardinal width in px
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
992 movlw low( d'448' ) ; position of the label
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
993 movwf sub_a+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
994 movlw high( d'448' )
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
995 movwf sub_a+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
996 rcall TFT_dive_compass_label_proc ; check if the label should be on screen
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
997 btfss print_compass_label ; Yes?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
998 bra dcr_6
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
999 STRCPY_TEXT_PRINT tE ; yes - print it
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1000 dcr_6:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1001 rcall TFT_dive_compass_c_mk ; check if label is on the center line or the marker
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1002
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1003 movlw d'14'
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1004 movwf up ; cardinal width in px
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1005 movlw low( d'489' ) ; position of the label
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1006 movwf sub_a+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1007 movlw high( d'489' )
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1008 movwf sub_a+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1009 rcall TFT_dive_compass_label_proc ; check if the label should be on screen
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1010 btfss print_compass_label ; Yes?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1011 bra dcr_7
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1012 STRCPY_TEXT_PRINT tSE ; yes - print it
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1013 dcr_7:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1014 rcall TFT_dive_compass_c_mk ; check if label is on the center line or the marker
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1015
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1016 movlw d'14'
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1017 movwf up ; cardinal width in px
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1018 movlw low( d'538' ) ; position of the label
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1019 movwf sub_a+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1020 movlw high( d'538' )
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1021 movwf sub_a+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1022 rcall TFT_dive_compass_label_proc ; check if the label should be on screen
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1023 btfss print_compass_label ; Yes?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1024 bra dcr_8
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1025 STRCPY_TEXT_PRINT tS ; yes - print it
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1026 dcr_8:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1027 rcall TFT_dive_compass_c_mk ; check if label is on the center line or the marker
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1028
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1029 movlw d'14'
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1030 movwf up ; cardinal width in px
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1031 movlw low( d'579' ) ; position of the label
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1032 movwf sub_a+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1033 movlw high( d'579' )
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1034 movwf sub_a+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1035 rcall TFT_dive_compass_label_proc ; check if the label should be on screen
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1036 btfss print_compass_label ; Yes?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1037 bra dcr_9
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1038 STRCPY_TEXT_PRINT tSW ; yes - print it
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1039 dcr_9:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1040 rcall TFT_dive_compass_c_mk ; check if label is on the center line or the marker
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1041
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1042 movlw d'14'
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1043 movwf up ; cardinal width in px
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1044 movlw low( d'627' ) ; position of the label
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1045 movwf sub_a+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1046 movlw high( d'627' )
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1047 movwf sub_a+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1048 rcall TFT_dive_compass_label_proc ; check if the label should be on screen
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1049 btfss print_compass_label ; Yes?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1050 bra dcr_10
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1051 STRCPY_TEXT_PRINT tW ; yes - print it
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1052 dcr_10:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1053 rcall TFT_dive_compass_c_mk ; check if label is on the center line or the marker
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1054
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1055 movlw d'14'
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1056 movwf up ; cardinal width in px
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1057 movlw low( d'669' ) ; position of the label
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1058 movwf sub_a+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1059 movlw high( d'669' )
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1060 movwf sub_a+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1061 rcall TFT_dive_compass_label_proc ; check if the label should be on screen
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1062 btfss print_compass_label ; Yes?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1063 bra dcr_11
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1064 STRCPY_TEXT_PRINT tNW ; yes - print it
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1065 dcr_11:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1066 rcall TFT_dive_compass_c_mk ; check if label is on the center line or the marker
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1067
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1068 movlw d'14'
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1069 movwf up ; cardinal width in px
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1070 movlw low( d'718' ) ; position of the label
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1071 movwf sub_a+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1072 movlw high( d'718' )
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1073 movwf sub_a+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1074 rcall TFT_dive_compass_label_proc ; check if the label should be on screen
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1075 btfss print_compass_label ; Yes?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1076 bra dcr_12
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1077 STRCPY_TEXT_PRINT tN ; yes - print it
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1078 dcr_12:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1079 rcall TFT_dive_compass_c_mk ; check if label is on the center line or the marker
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1080
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1081 TFT_dive_compass_label_end:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1082 rcall TFT_dive_compass_c_mk ; check if label is on the center line or the marker
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1083 ; restore lo and hi for the final cleanup
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1084 movff xLO,lo
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1085 movff xHI,hi
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1086 ; clear the rest of the SQ area if there are more space
370
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1087 movlw d'159'
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1088 cpfslt hi
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1089 bra TFT_dive_compass_label_end2 ; D >= 160, no more space
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1090 ; position left to end of display to clear the remaining area
370
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1091 movlw d'158'
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1092 movwf lo
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1093 ; clear it
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1094 rcall TFT_dive_compass_clr_label
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1095 TFT_dive_compass_label_end2:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1096 rcall TFT_dive_compass_c_mk ; check if label is on the center line or the marker
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1097 ; do we have bearing set?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1098 btfsc compass_bearing_set
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1099 bra TFT_dive_compass_dir_text ; bearing_set=1 - go and print the dir (<< or >>)
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1100 rcall TFT_dive_compass_dir_lclr ; no, clear the area (e.g. we had but removed)
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1101 rcall TFT_dive_compass_dir_rclr
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1102 bra TFT_dive_compass_text
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1103
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1104 TFT_dive_compass_dir_text:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1105 ; bearing set, but does it point to heading?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1106 btfss compass_bearing_eq
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1107 bra TFT_dive_compass_dir_text_2 ; bearing != heading - go and print the dir
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1108 rcall TFT_dive_compass_dir_lclr ; bearing = heading, no need for direction markers
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1109 rcall TFT_dive_compass_dir_rclr
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1110 bra TFT_dive_compass_text
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1111
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1112 TFT_dive_compass_dir_text_2:
257
5dd0f39d05d4 minor speed and size improvements for the compass routine
heinrichsweikamp
parents: 256
diff changeset
1113 movlw color_green
5dd0f39d05d4 minor speed and size improvements for the compass routine
heinrichsweikamp
parents: 256
diff changeset
1114 call TFT_set_color
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1115 btfsc compass_bearing_lft
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1116 bra TFT_dive_compass_dir_ldir ; bearing_lft=1, print the left marker
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1117 ;TFT_dive_compass_text_rdir:
300
5ad479f2a868 Merged Screen layout mod #1 into Screen layout work #3
Janos Kovacs <kovjanos@gmail.com>
parents: 282
diff changeset
1118 WIN_SMALL dm_custom_compass_rdir_column, dm_custom_compass_head_row
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1119 STRCPY_PRINT ">>"
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1120 ; do not forget to clear the left
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1121 rcall TFT_dive_compass_dir_lclr
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1122 bra TFT_dive_compass_text
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1123
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1124 TFT_dive_compass_dir_ldir:
300
5ad479f2a868 Merged Screen layout mod #1 into Screen layout work #3
Janos Kovacs <kovjanos@gmail.com>
parents: 282
diff changeset
1125 WIN_SMALL dm_custom_compass_ldir_column, dm_custom_compass_head_row
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1126 STRCPY_PRINT "<<"
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1127 ; do not forget to clear the right
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1128 rcall TFT_dive_compass_dir_rclr
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1129 ;bra TFT_dive_compass_text
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1130
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1131 TFT_dive_compass_text:
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1132 ; Clear some unused space on the right mH
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1133 WIN_BOX_BLACK dm_custom_compass_tick_top_bot+.1,dm_custom_compass_tick_bot_top-.1,.158,.159 ; top, bottom, left, right
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1134
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1135 ; Text output
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1136 call TFT_standard_color
300
5ad479f2a868 Merged Screen layout mod #1 into Screen layout work #3
Janos Kovacs <kovjanos@gmail.com>
parents: 282
diff changeset
1137 WIN_SMALL dm_custom_compass_head_column, dm_custom_compass_head_row
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1138 rcall TFT_surface_compass_heading_com ; Show "000° N"
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1139 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1140
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1141 TFT_dive_compass_dir_lclr:
300
5ad479f2a868 Merged Screen layout mod #1 into Screen layout work #3
Janos Kovacs <kovjanos@gmail.com>
parents: 282
diff changeset
1142 WIN_SMALL dm_custom_compass_ldir_column, dm_custom_compass_head_row
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1143 STRCPY_PRINT " "
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1144 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1145
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1146 TFT_dive_compass_dir_rclr:
300
5ad479f2a868 Merged Screen layout mod #1 into Screen layout work #3
Janos Kovacs <kovjanos@gmail.com>
parents: 282
diff changeset
1147 WIN_SMALL dm_custom_compass_rdir_column, dm_custom_compass_head_row
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1148 STRCPY_PRINT " "
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1149 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1150
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1151 TFT_dive_compass_label_proc:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1152 ; Input:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1153 ; xHI: DD - display'a current position
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1154 ; xRD: RD - ruler display offset
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1155 ; sub_a: RP - item's ruler display offset
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1156 ; get the RD abck to sub_b
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1157 ; movff xHI,hi ; mH
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1158 bcf print_compass_label
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1159 ; 1/a. check if it's viewable ? sub_a(RP) >= sub_b(RD) ?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1160 ; set the carry flag if sub_b(xRD) is equal to or greater than sub_a(xRP):
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1161 movff xRD+0,sub_b+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1162 movff xRD+1,sub_b+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1163 call subU16 ; sub_c = sub_a - sub_b
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1164 btfsc neg_flag ; >=0?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1165 return ; No
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1166 ; store the RO=RP-RD for drawing
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1167 movff sub_c+0,xC+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1168 movff sub_c+1,xC+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1169
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1170 ; 1/b. check if it's viewable ? sub_a(RP)+up(width) < sub_b(RD)+160
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1171 ; if already above, no need to process the rest of the labels
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1172 movff up,WREG ; take care about the width
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1173 addwf sub_a+0,1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1174 btfsc STATUS, C
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1175 incf sub_a+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1176
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1177 movff xRDr+0,sub_b+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1178 movff xRDr+1,sub_b+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1179 call subU16 ; sub_c = sub_a - sub_b
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1180 btfss neg_flag ; ? <0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1181 bra TFT_dive_compass_label_end ; No
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1182
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1183 ; 2. restore RO=RP-RD from 1/a.
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1184 movff xC+0,lo
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1185
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1186 ; 3. Clear the segment from DD(hi) to lo
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1187 ; don't do a clear if we are at 0 (zero) otherwise it will blink
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1188 ; ?because of the width underflow?
370
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1189 movlw d'1'
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1190 cpfsgt lo
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1191 bra TFT_dive_compass_label_proc_p
257
5dd0f39d05d4 minor speed and size improvements for the compass routine
heinrichsweikamp
parents: 256
diff changeset
1192 rcall TFT_dive_compass_clr_label
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1193 TFT_dive_compass_label_proc_p:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1194 ; 4. print the SQ on the screen
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1195 call TFT_standard_color
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1196 bsf print_compass_label
257
5dd0f39d05d4 minor speed and size improvements for the compass routine
heinrichsweikamp
parents: 256
diff changeset
1197 ;TFT_dive_compass_label_print:
300
5ad479f2a868 Merged Screen layout mod #1 into Screen layout work #3
Janos Kovacs <kovjanos@gmail.com>
parents: 282
diff changeset
1198 movlw dm_custom_compass_label_row
257
5dd0f39d05d4 minor speed and size improvements for the compass routine
heinrichsweikamp
parents: 256
diff changeset
1199 movff WREG,win_top
5dd0f39d05d4 minor speed and size improvements for the compass routine
heinrichsweikamp
parents: 256
diff changeset
1200 movff lo,win_leftx2
5dd0f39d05d4 minor speed and size improvements for the compass routine
heinrichsweikamp
parents: 256
diff changeset
1201 movlw FT_SMALL
5dd0f39d05d4 minor speed and size improvements for the compass routine
heinrichsweikamp
parents: 256
diff changeset
1202 movff WREG,win_font
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1203 ; 6. retain the new display positions
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1204 ; movff hi,divB ; old-hi will be used by the c_mk : clear+marker printing mH
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1205 movff lo,hi
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1206 movff up,WREG
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1207 addwf hi,F
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1208 movff lo,xLO
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1209 movff hi,xHI
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1210 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1211
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1212 TFT_dive_compass_c_mk:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1213 ; Common task to draw center line and marker
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1214 ; until a proper implementation make it simple:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1215 rcall TFT_dive_compass_mk
370
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1216 movlw color_yellow
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1217 WIN_BOX_COLOR dm_custom_compass_tick_top_top, dm_custom_compass_tick_bot_bot,.80,.81 ; center line in yellow
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1218 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1219
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1220 TFT_dive_compass_mk:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1221 ; draw the bearing on the screen if visible and if we just put something over it
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1222 btfss compass_bearing_set
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1223 return ; bearing_set=0 nothing to display
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1224
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1225 btfss compass_bearing_vis
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1226 return ; bearing set but not visible
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1227
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1228 ; save lo/hi from trashing
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1229 movff lo,xA+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1230 movff hi,xA+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1231
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1232 ; did we just update the marker's position?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1233 ; DD.......DD
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1234 ; CM+2>=DD(old) or CM-2<=DD
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1235 ; ToDo
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1236
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1237 btfss compass_bearing_ahd
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1238 bra TFT_dive_compass_mk_rear
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1239 ;TFT_dive_compass_mk_front:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1240 clrf lo
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1241 movff xCM,lo
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1242 bsf print_compass_label ; set=green marker
257
5dd0f39d05d4 minor speed and size improvements for the compass routine
heinrichsweikamp
parents: 256
diff changeset
1243 rcall TFT_dive_compass_mk_print
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1244 bcf print_compass_label
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1245 bra TFT_dive_compass_mk_end
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1246
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1247 TFT_dive_compass_mk_rear:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1248 clrf lo
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1249 movff xCM,lo
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1250 bcf print_compass_label ; set=red marker
257
5dd0f39d05d4 minor speed and size improvements for the compass routine
heinrichsweikamp
parents: 256
diff changeset
1251 rcall TFT_dive_compass_mk_print
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1252
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1253 TFT_dive_compass_mk_end:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1254 movff xA+0,lo
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1255 movff xA+1,hi
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1256 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1257
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1258 TFT_dive_compass_mk_print:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1259 movlw d'1'
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1260 cpfsgt lo
264
9dbdb060d44c Fix compass ruler's missing bottom ticks; Clear between the bearing marker lines and draw a dot.
janos_kovacs <kovjanos@gmail.com>
parents: 259
diff changeset
1261 bra TFT_dive_compass_mk_print_2 ; lo<=1, skip the first line
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1262 movlw d'2'
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1263 subwf lo,0
257
5dd0f39d05d4 minor speed and size improvements for the compass routine
heinrichsweikamp
parents: 256
diff changeset
1264 ; movff WREG,win_leftx2
5dd0f39d05d4 minor speed and size improvements for the compass routine
heinrichsweikamp
parents: 256
diff changeset
1265 rcall TFT_dive_compass_mk_print_3
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1266 TFT_dive_compass_mk_print_2:
264
9dbdb060d44c Fix compass ruler's missing bottom ticks; Clear between the bearing marker lines and draw a dot.
janos_kovacs <kovjanos@gmail.com>
parents: 259
diff changeset
1267 ; save hi/lo
9dbdb060d44c Fix compass ruler's missing bottom ticks; Clear between the bearing marker lines and draw a dot.
janos_kovacs <kovjanos@gmail.com>
parents: 259
diff changeset
1268 movff hi,divA+1
9dbdb060d44c Fix compass ruler's missing bottom ticks; Clear between the bearing marker lines and draw a dot.
janos_kovacs <kovjanos@gmail.com>
parents: 259
diff changeset
1269 movff lo,divA+0
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1270 ; clear the middle of the bearing marker
264
9dbdb060d44c Fix compass ruler's missing bottom ticks; Clear between the bearing marker lines and draw a dot.
janos_kovacs <kovjanos@gmail.com>
parents: 259
diff changeset
1271 movff lo,hi
9dbdb060d44c Fix compass ruler's missing bottom ticks; Clear between the bearing marker lines and draw a dot.
janos_kovacs <kovjanos@gmail.com>
parents: 259
diff changeset
1272 movlw d'2'
9dbdb060d44c Fix compass ruler's missing bottom ticks; Clear between the bearing marker lines and draw a dot.
janos_kovacs <kovjanos@gmail.com>
parents: 259
diff changeset
1273 addwf lo,1
9dbdb060d44c Fix compass ruler's missing bottom ticks; Clear between the bearing marker lines and draw a dot.
janos_kovacs <kovjanos@gmail.com>
parents: 259
diff changeset
1274 rcall TFT_dive_compass_clr_label
9dbdb060d44c Fix compass ruler's missing bottom ticks; Clear between the bearing marker lines and draw a dot.
janos_kovacs <kovjanos@gmail.com>
parents: 259
diff changeset
1275 ; restore hi/lo
9dbdb060d44c Fix compass ruler's missing bottom ticks; Clear between the bearing marker lines and draw a dot.
janos_kovacs <kovjanos@gmail.com>
parents: 259
diff changeset
1276 movff divA+1,hi
9dbdb060d44c Fix compass ruler's missing bottom ticks; Clear between the bearing marker lines and draw a dot.
janos_kovacs <kovjanos@gmail.com>
parents: 259
diff changeset
1277 movff divA+0,lo
9dbdb060d44c Fix compass ruler's missing bottom ticks; Clear between the bearing marker lines and draw a dot.
janos_kovacs <kovjanos@gmail.com>
parents: 259
diff changeset
1278 ; print a dot on the middle
9dbdb060d44c Fix compass ruler's missing bottom ticks; Clear between the bearing marker lines and draw a dot.
janos_kovacs <kovjanos@gmail.com>
parents: 259
diff changeset
1279 movff lo,WREG
9dbdb060d44c Fix compass ruler's missing bottom ticks; Clear between the bearing marker lines and draw a dot.
janos_kovacs <kovjanos@gmail.com>
parents: 259
diff changeset
1280 rcall TFT_dive_compass_mk_print_dot
9dbdb060d44c Fix compass ruler's missing bottom ticks; Clear between the bearing marker lines and draw a dot.
janos_kovacs <kovjanos@gmail.com>
parents: 259
diff changeset
1281 ; finally print the right marker line
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1282 movlw d'2'
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1283 addwf lo,0
257
5dd0f39d05d4 minor speed and size improvements for the compass routine
heinrichsweikamp
parents: 256
diff changeset
1284 ; rcall TFT_dive_compass_mk_print_3
5dd0f39d05d4 minor speed and size improvements for the compass routine
heinrichsweikamp
parents: 256
diff changeset
1285 ; return
5dd0f39d05d4 minor speed and size improvements for the compass routine
heinrichsweikamp
parents: 256
diff changeset
1286 TFT_dive_compass_mk_print_3:
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1287 movff WREG,win_leftx2
300
5ad479f2a868 Merged Screen layout mod #1 into Screen layout work #3
Janos Kovacs <kovjanos@gmail.com>
parents: 282
diff changeset
1288 movlw dm_custom_compass_label_row
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1289 movff WREG,win_top
300
5ad479f2a868 Merged Screen layout mod #1 into Screen layout work #3
Janos Kovacs <kovjanos@gmail.com>
parents: 282
diff changeset
1290 movlw dm_custom_compass_label_height-.2
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1291 movff WREG,win_height
264
9dbdb060d44c Fix compass ruler's missing bottom ticks; Clear between the bearing marker lines and draw a dot.
janos_kovacs <kovjanos@gmail.com>
parents: 259
diff changeset
1292 bra TFT_dive_compass_mk_print_4
9dbdb060d44c Fix compass ruler's missing bottom ticks; Clear between the bearing marker lines and draw a dot.
janos_kovacs <kovjanos@gmail.com>
parents: 259
diff changeset
1293 TFT_dive_compass_mk_print_dot:
9dbdb060d44c Fix compass ruler's missing bottom ticks; Clear between the bearing marker lines and draw a dot.
janos_kovacs <kovjanos@gmail.com>
parents: 259
diff changeset
1294 movff WREG,win_leftx2
300
5ad479f2a868 Merged Screen layout mod #1 into Screen layout work #3
Janos Kovacs <kovjanos@gmail.com>
parents: 282
diff changeset
1295 movlw dm_custom_compass_label_row + .9
264
9dbdb060d44c Fix compass ruler's missing bottom ticks; Clear between the bearing marker lines and draw a dot.
janos_kovacs <kovjanos@gmail.com>
parents: 259
diff changeset
1296 movff WREG,win_top
9dbdb060d44c Fix compass ruler's missing bottom ticks; Clear between the bearing marker lines and draw a dot.
janos_kovacs <kovjanos@gmail.com>
parents: 259
diff changeset
1297 movlw d'4'
9dbdb060d44c Fix compass ruler's missing bottom ticks; Clear between the bearing marker lines and draw a dot.
janos_kovacs <kovjanos@gmail.com>
parents: 259
diff changeset
1298 movff WREG,win_height
9dbdb060d44c Fix compass ruler's missing bottom ticks; Clear between the bearing marker lines and draw a dot.
janos_kovacs <kovjanos@gmail.com>
parents: 259
diff changeset
1299 TFT_dive_compass_mk_print_4:
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1300 banksel win_leftx2
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1301 movlw .158
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1302 cpfslt win_leftx2
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1303 bra TFT_dive_compass_mk_print_5
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1304 movlw d'2'
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1305 movwf win_width
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1306 movwf win_bargraph
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1307 banksel common
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1308 movlw color_green
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1309 btfss print_compass_label
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1310 movlw color_red
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1311 call TFT_set_color
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1312 call TFT_box
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1313 TFT_dive_compass_mk_print_5:
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1314 banksel common
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1315 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1316
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1317 TFT_dive_compass_clr_label:
300
5ad479f2a868 Merged Screen layout mod #1 into Screen layout work #3
Janos Kovacs <kovjanos@gmail.com>
parents: 282
diff changeset
1318 movlw dm_custom_compass_label_row-.2 ; set top & height
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1319 movff WREG,win_top
300
5ad479f2a868 Merged Screen layout mod #1 into Screen layout work #3
Janos Kovacs <kovjanos@gmail.com>
parents: 282
diff changeset
1320 movlw dm_custom_compass_label_height+.2
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1321 movff WREG,win_height
257
5dd0f39d05d4 minor speed and size improvements for the compass routine
heinrichsweikamp
parents: 256
diff changeset
1322 rcall TFT_dive_compass_clear
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1323 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1324
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1325 TFT_dive_compass_clr_ruler:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1326 ; top tick
300
5ad479f2a868 Merged Screen layout mod #1 into Screen layout work #3
Janos Kovacs <kovjanos@gmail.com>
parents: 282
diff changeset
1327 movlw dm_custom_compass_tick_top_top ; set top & height
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1328 movff WREG,win_top
300
5ad479f2a868 Merged Screen layout mod #1 into Screen layout work #3
Janos Kovacs <kovjanos@gmail.com>
parents: 282
diff changeset
1329 movlw dm_custom_compass_tick_height
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1330 movff WREG,win_height
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1331 rcall TFT_dive_compass_clear
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1332 ;bottom tick
300
5ad479f2a868 Merged Screen layout mod #1 into Screen layout work #3
Janos Kovacs <kovjanos@gmail.com>
parents: 282
diff changeset
1333 movlw dm_custom_compass_tick_bot_top ; set top & height
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1334 movff WREG,win_top
300
5ad479f2a868 Merged Screen layout mod #1 into Screen layout work #3
Janos Kovacs <kovjanos@gmail.com>
parents: 282
diff changeset
1335 movlw dm_custom_compass_tick_height
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1336 movff WREG,win_height
257
5dd0f39d05d4 minor speed and size improvements for the compass routine
heinrichsweikamp
parents: 256
diff changeset
1337 ; rcall TFT_dive_compass_clear
5dd0f39d05d4 minor speed and size improvements for the compass routine
heinrichsweikamp
parents: 256
diff changeset
1338 ; return
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1339 TFT_dive_compass_clear:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1340 ; we receive RM in lo and DD in hi
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1341 ; calculate width = RM-D
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1342 movff hi,WREG
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1343 subwf lo,W
370
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1344 bz TFT_dive_compass_clear3 ; Do nothing if there is nothing to do
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1345 movff WREG,win_width ; RM-DD
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1346 movff WREG,win_bargraph
370
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1347 banksel win_width
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1348 movlw .1
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1349 cpfsgt win_width
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1350 bra TFT_dive_compass_clear3 ; Do not clear a single pixel (or less)
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1351 banksel common
259
151148e2281f minor cleanup
heinrichsweikamp
parents: 258
diff changeset
1352 movff hi,win_leftx2
370
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1353 ;TFT_dive_compass_clear1:
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1354 ; movff win_leftx2,tft_temp1 ; Copy
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1355 ; ; check right border
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1356 ; movff win_width,WREG
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1357 ; addwf tft_temp1,F
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1358 ; movlw .159
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1359 ; cpfsgt tft_temp1 ; >159?
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1360 ; bra TFT_dive_compass_clear2 ; no
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1361 ; banksel win_width
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1362 ; decf win_width,F ; -1
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1363 ; banksel common
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1364 ; bra TFT_dive_compass_clear1
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1365 ;TFT_dive_compass_clear2:
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1366 movlw color_black
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1367 call TFT_set_color
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1368 call TFT_box
370
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1369 TFT_dive_compass_clear3:
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1370 banksel common
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1371 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1372
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1373 tft_compass_cardinal:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1374 btfsc hi,0 ; Heading >255°?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1375 bra tft_compass_cardinal2 ; Yes must be W, NW or N
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1376 ; No, Must be W, SW, S, SE, E, NE or N
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1377 movlw .23
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1378 subwf lo,W
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1379 btfss STATUS,C
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1380 bra tft_compass_cardinal_N
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1381 movlw .68
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1382 subwf lo,W
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1383 btfss STATUS,C
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1384 bra tft_compass_cardinal_NE
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1385 movlw .113
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1386 subwf lo,W
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1387 btfss STATUS,C
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1388 bra tft_compass_cardinal_E
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1389 movlw .158
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1390 subwf lo,W
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1391 btfss STATUS,C
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1392 bra tft_compass_cardinal_SE
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1393 movlw .203
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1394 subwf lo,W
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1395 btfss STATUS,C
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1396 bra tft_compass_cardinal_S
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1397 movlw .248
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1398 subwf lo,W
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1399 btfss STATUS,C
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1400 bra tft_compass_cardinal_SW
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1401 bra tft_compass_cardinal_W
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1402
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1403 tft_compass_cardinal2:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1404 movlw .37
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1405 subwf lo,W
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1406 btfss STATUS,C
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1407 bra tft_compass_cardinal_W
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1408 movlw .82
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1409 subwf lo,W
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1410 btfss STATUS,C
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1411 bra tft_compass_cardinal_NW
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1412 ; bra tft_compass_cardinal_N
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1413 tft_compass_cardinal_N:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1414 STRCAT_TEXT tN
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1415 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1416 tft_compass_cardinal_NE:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1417 STRCAT_TEXT tNE
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1418 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1419 tft_compass_cardinal_E:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1420 STRCAT_TEXT tE
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1421 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1422 tft_compass_cardinal_SE:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1423 STRCAT_TEXT tSE
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1424 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1425 tft_compass_cardinal_S:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1426 STRCAT_TEXT tS
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1427 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1428 tft_compass_cardinal_SW:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1429 STRCAT_TEXT tSW
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1430 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1431 tft_compass_cardinal_W:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1432 STRCAT_TEXT tW
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1433 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1434 tft_compass_cardinal_NW:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1435 STRCAT_TEXT tNW
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1436 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1437
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1438 compass_heading_common:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1439 call speed_normal
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1440 movlw compass_averaging ; numbers of extra averaging
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1441 movwf up
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1442 compass_heading_common2:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1443 rcall TFT_get_compass
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1444 decfsz up,F
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1445 bra compass_heading_common2
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1446 extern compass
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1447 call compass ; Do compass corrections.
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1448 banksel common
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1449
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1450 ; More then compass_fast_treshold?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1451 movff compass_heading_old+0,sub_a+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1452 movff compass_heading_old+1,sub_a+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1453 movff compass_heading+0,sub_b+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1454 movff compass_heading+1,sub_b+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1455 call sub16
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1456 btfss neg_flag ; <0?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1457 bra compass_heading_common3 ; No, test for threshold
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1458 ; Yes, subtract the other way round
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1459 movff compass_heading+0,sub_a+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1460 movff compass_heading+1,sub_a+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1461 movff compass_heading_old+0,sub_b+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1462 movff compass_heading_old+1,sub_b+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1463 call sub16
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1464 compass_heading_common3:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1465 movff compass_heading+0,compass_heading_old+0 ; copy new "old"
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1466 movff compass_heading+1,compass_heading_old+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1467
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1468 bcf compass_fast_mode
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1469 movlw compass_fast_treshold
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1470 cpfslt sub_c+0 ; > compass_fast_treshold?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1471 bsf compass_fast_mode ; Yes!
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1472
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1473 btfss compass_fast_mode ; In fast mode?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1474 return ; No.
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1475 ; Yes.
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1476 movff compass_heading+0,lo
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1477 movff compass_heading+1,hi
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1478 call TFT_convert_signed_16bit ; converts lo:hi into signed-short and adds '-' to POSTINC2 if required
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1479 movff lo,compass_heading_shown+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1480 movff hi,compass_heading_shown+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1481 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1482
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1483 TFT_get_compass:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1484 call I2C_RX_compass ; Test Compass
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1485 call I2C_RX_accelerometer ; Test Accelerometer
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1486 call compass_filter ; Filter Raw compass + accel readings.
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1487 banksel common
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1488 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1489
382
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
1490 global TFT_surf_set_bearing
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
1491 TFT_surf_set_bearing:
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
1492 btfsc premenu
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
1493 return ; Already shown, return
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
1494 bsf premenu ; set flag
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
1495 WIN_BOX_BLACK surf_compass_bear_row,surf_warning1_row-1, surf_compass_bear_column, surf_decotype_column-.1 ; top, bottom, left, right
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
1496 WIN_SMALL surf_compass_bear_column,surf_compass_bear_row
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
1497 WIN_COLOR color_yellow
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
1498 bsf win_invert
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
1499 STRCPY_TEXT_PRINT tSetHeading ; 7 chars
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
1500 bcf win_invert
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
1501 return
147
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
1502
0
heinrichsweikamp
parents:
diff changeset
1503 END