Mercurial > public > hwos_code

annotate src/compass_ops.asm @ 391:682199d87b5c

Find changesets by keywords (author, files, the commit message), revision number or hash, or revset expression.
add profile version to compact headers
author heinrichsweikamp
date Mon, 02 Nov 2015 17:48:20 +0100
parents 3c55627d5f8f
children eccae727702f
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 low( d'219' ) ; position of the label
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
926 movwf sub_a+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
927 movlw high( d'219' )
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
928 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
929 btfss print_compass_label ; Yes?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
930 bra dcr_1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
931 STRCPY_TEXT_PRINT tSW ; yes - print it
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
932 dcr_1:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
933 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
934
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
935 movlw low( d'267' ) ; position of the label
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
936 movwf sub_a+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
937 movlw high( d'267' )
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
938 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
939 btfss print_compass_label ; Yes?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
940 bra dcr_2
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
941 STRCPY_TEXT_PRINT tW ; yes - print it
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
942 dcr_2:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
943 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
944
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
945 movlw low( d'309' ) ; position of the label
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
946 movwf sub_a+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
947 movlw high( d'309' )
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
948 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
949 btfss print_compass_label ; Yes?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
950 bra dcr_3
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
951 STRCPY_TEXT_PRINT tNW ; yes - print it
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
952 dcr_3:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
953 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
954
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
955 movlw low( d'358' ) ; position of the label
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
956 movwf sub_a+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
957 movlw high( d'358' )
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
958 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
959 btfss print_compass_label ; Yes?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
960 bra dcr_4
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
961 STRCPY_TEXT_PRINT tN ; yes - print it
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
962 dcr_4:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
963 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
964
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
965 movlw low( d'399' ) ; position of the label
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
966 movwf sub_a+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
967 movlw high( d'399' )
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
968 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
969 btfss print_compass_label ; Yes?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
970 bra dcr_5
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
971 STRCPY_TEXT_PRINT tNE ; yes - print it
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
972 dcr_5:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
973 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
974
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
975 movlw low( d'448' ) ; position of the label
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
976 movwf sub_a+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
977 movlw high( d'448' )
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
978 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
979 btfss print_compass_label ; Yes?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
980 bra dcr_6
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
981 STRCPY_TEXT_PRINT tE ; yes - print it
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
982 dcr_6:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
983 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
984
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
985 movlw low( d'489' ) ; position of the label
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
986 movwf sub_a+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
987 movlw high( d'489' )
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
988 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
989 btfss print_compass_label ; Yes?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
990 bra dcr_7
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
991 STRCPY_TEXT_PRINT tSE ; yes - print it
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
992 dcr_7:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
993 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
994
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
995 movlw low( d'538' ) ; position of the label
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
996 movwf sub_a+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
997 movlw high( d'538' )
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
998 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
999 btfss print_compass_label ; Yes?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1000 bra dcr_8
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1001 STRCPY_TEXT_PRINT tS ; yes - print it
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1002 dcr_8:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1003 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
1004
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1005 movlw low( d'579' ) ; 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'579' )
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1008 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
1009 btfss print_compass_label ; Yes?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1010 bra dcr_9
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1011 STRCPY_TEXT_PRINT tSW ; yes - print it
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1012 dcr_9:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1013 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
1014
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1015 movlw low( d'627' ) ; position of the label
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1016 movwf sub_a+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1017 movlw high( d'627' )
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1018 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
1019 btfss print_compass_label ; Yes?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1020 bra dcr_10
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1021 STRCPY_TEXT_PRINT tW ; yes - print it
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1022 dcr_10:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1023 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
1024
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1025 movlw low( d'669' ) ; position of the label
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1026 movwf sub_a+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1027 movlw high( d'669' )
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1028 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
1029 btfss print_compass_label ; Yes?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1030 bra dcr_11
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1031 STRCPY_TEXT_PRINT tNW ; yes - print it
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1032 dcr_11:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1033 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
1034
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1035 movlw low( d'718' ) ; position of the label
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1036 movwf sub_a+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1037 movlw high( d'718' )
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1038 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
1039 btfss print_compass_label ; Yes?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1040 bra dcr_12
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1041 STRCPY_TEXT_PRINT tN ; yes - print it
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1042 dcr_12:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1043 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
1044
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1045 TFT_dive_compass_label_end:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1046 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
1047 ; restore lo and hi for the final cleanup
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1048 movff xLO,lo
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1049 movff xHI,hi
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1050 ; clear the rest of the SQ area if there are more space
370
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1051 movlw d'159'
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1052 cpfslt hi
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1053 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
1054 ; position left to end of display to clear the remaining area
370
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1055 movlw d'158'
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1056 movwf lo
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1057 ; clear it
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1058 rcall TFT_dive_compass_clr_label
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1059 TFT_dive_compass_label_end2:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1060 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
1061 ; do we have bearing set?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1062 btfsc compass_bearing_set
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1063 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
1064 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
1065 rcall TFT_dive_compass_dir_rclr
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1066 bra TFT_dive_compass_text
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1067
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1068 TFT_dive_compass_dir_text:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1069 ; bearing set, but does it point to heading?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1070 btfss compass_bearing_eq
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1071 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
1072 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
1073 rcall TFT_dive_compass_dir_rclr
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1074 bra TFT_dive_compass_text
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1075
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1076 TFT_dive_compass_dir_text_2:
257
5dd0f39d05d4 minor speed and size improvements for the compass routine
heinrichsweikamp
parents: 256
diff changeset
1077 movlw color_green
5dd0f39d05d4 minor speed and size improvements for the compass routine
heinrichsweikamp
parents: 256
diff changeset
1078 call TFT_set_color
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1079 btfsc compass_bearing_lft
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1080 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
1081 ;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
1082 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
1083 STRCPY_PRINT ">>"
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1084 ; do not forget to clear the left
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1085 rcall TFT_dive_compass_dir_lclr
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1086 bra TFT_dive_compass_text
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1087
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1088 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
1089 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
1090 STRCPY_PRINT "<<"
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1091 ; do not forget to clear the right
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1092 rcall TFT_dive_compass_dir_rclr
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1093 ;bra TFT_dive_compass_text
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1094
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1095 TFT_dive_compass_text:
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1096 ; Clear some unused space on the right mH
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1097 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
1098
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1099 ; Text output
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1100 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
1101 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
1102 rcall TFT_surface_compass_heading_com ; Show "000° N"
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1103 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1104
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1105 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
1106 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
1107 STRCPY_PRINT " "
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1108 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1109
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1110 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
1111 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
1112 STRCPY_PRINT " "
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1113 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1114
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1115 TFT_dive_compass_label_proc:
386
3c55627d5f8f some cleanups, jump to 1.90 stable
heinrichsweikamp
parents: 382
diff changeset
1116 movwf sub_a+1
3c55627d5f8f some cleanups, jump to 1.90 stable
heinrichsweikamp
parents: 382
diff changeset
1117 movlw d'14'
3c55627d5f8f some cleanups, jump to 1.90 stable
heinrichsweikamp
parents: 382
diff changeset
1118 movwf up ; cardinal width in px
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1119 ; Input:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1120 ; xHI: DD - display'a current position
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1121 ; xRD: RD - ruler display offset
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1122 ; sub_a: RP - item's ruler display offset
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1123 ; get the RD abck to sub_b
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1124 ; movff xHI,hi ; mH
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1125 bcf print_compass_label
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1126 ; 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
1127 ; 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
1128 movff xRD+0,sub_b+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1129 movff xRD+1,sub_b+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1130 call subU16 ; sub_c = sub_a - sub_b
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1131 btfsc neg_flag ; >=0?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1132 return ; No
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1133 ; store the RO=RP-RD for drawing
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1134 movff sub_c+0,xC+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1135 movff sub_c+1,xC+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1136
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1137 ; 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
1138 ; 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
1139 movff up,WREG ; take care about the width
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1140 addwf sub_a+0,1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1141 btfsc STATUS, C
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1142 incf sub_a+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1143
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1144 movff xRDr+0,sub_b+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1145 movff xRDr+1,sub_b+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1146 call subU16 ; sub_c = sub_a - sub_b
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1147 btfss neg_flag ; ? <0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1148 bra TFT_dive_compass_label_end ; No
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1149
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1150 ; 2. restore RO=RP-RD from 1/a.
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1151 movff xC+0,lo
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1152
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1153 ; 3. Clear the segment from DD(hi) to lo
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1154 ; 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
1155 ; ?because of the width underflow?
370
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1156 movlw d'1'
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1157 cpfsgt lo
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1158 bra TFT_dive_compass_label_proc_p
257
5dd0f39d05d4 minor speed and size improvements for the compass routine
heinrichsweikamp
parents: 256
diff changeset
1159 rcall TFT_dive_compass_clr_label
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1160 TFT_dive_compass_label_proc_p:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1161 ; 4. print the SQ on the screen
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1162 call TFT_standard_color
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1163 bsf print_compass_label
257
5dd0f39d05d4 minor speed and size improvements for the compass routine
heinrichsweikamp
parents: 256
diff changeset
1164 ;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
1165 movlw dm_custom_compass_label_row
257
5dd0f39d05d4 minor speed and size improvements for the compass routine
heinrichsweikamp
parents: 256
diff changeset
1166 movff WREG,win_top
5dd0f39d05d4 minor speed and size improvements for the compass routine
heinrichsweikamp
parents: 256
diff changeset
1167 movff lo,win_leftx2
5dd0f39d05d4 minor speed and size improvements for the compass routine
heinrichsweikamp
parents: 256
diff changeset
1168 movlw FT_SMALL
5dd0f39d05d4 minor speed and size improvements for the compass routine
heinrichsweikamp
parents: 256
diff changeset
1169 movff WREG,win_font
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1170 ; 6. retain the new display positions
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1171 ; 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
1172 movff lo,hi
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1173 movff up,WREG
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1174 addwf hi,F
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1175 movff lo,xLO
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1176 movff hi,xHI
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1177 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1178
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1179 TFT_dive_compass_c_mk:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1180 ; Common task to draw center line and marker
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1181 ; until a proper implementation make it simple:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1182 rcall TFT_dive_compass_mk
370
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1183 movlw color_yellow
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1184 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
1185 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1186
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1187 TFT_dive_compass_mk:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1188 ; 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
1189 btfss compass_bearing_set
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1190 return ; bearing_set=0 nothing to display
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1191
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1192 btfss compass_bearing_vis
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1193 return ; bearing set but not visible
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1194
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1195 ; save lo/hi from trashing
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1196 movff lo,xA+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1197 movff hi,xA+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1198
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1199 ; did we just update the marker's position?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1200 ; DD.......DD
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1201 ; CM+2>=DD(old) or CM-2<=DD
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1202 ; ToDo
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1203
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1204 btfss compass_bearing_ahd
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1205 bra TFT_dive_compass_mk_rear
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1206 ;TFT_dive_compass_mk_front:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1207 clrf lo
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1208 movff xCM,lo
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1209 bsf print_compass_label ; set=green marker
257
5dd0f39d05d4 minor speed and size improvements for the compass routine
heinrichsweikamp
parents: 256
diff changeset
1210 rcall TFT_dive_compass_mk_print
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1211 bcf print_compass_label
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1212 bra TFT_dive_compass_mk_end
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1213
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1214 TFT_dive_compass_mk_rear:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1215 clrf lo
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1216 movff xCM,lo
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1217 bcf print_compass_label ; set=red marker
257
5dd0f39d05d4 minor speed and size improvements for the compass routine
heinrichsweikamp
parents: 256
diff changeset
1218 rcall TFT_dive_compass_mk_print
256
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_end:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1221 movff xA+0,lo
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1222 movff xA+1,hi
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1223 return
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 TFT_dive_compass_mk_print:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1226 movlw d'1'
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1227 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
1228 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
1229 movlw d'2'
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1230 subwf lo,0
257
5dd0f39d05d4 minor speed and size improvements for the compass routine
heinrichsweikamp
parents: 256
diff changeset
1231 ; movff WREG,win_leftx2
5dd0f39d05d4 minor speed and size improvements for the compass routine
heinrichsweikamp
parents: 256
diff changeset
1232 rcall TFT_dive_compass_mk_print_3
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1233 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
1234 ; 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
1235 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
1236 movff lo,divA+0
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1237 ; 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
1238 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
1239 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
1240 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
1241 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
1242 ; 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
1243 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
1244 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
1245 ; 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
1246 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
1247 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
1248 ; finally print the right marker line
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1249 movlw d'2'
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1250 addwf lo,0
257
5dd0f39d05d4 minor speed and size improvements for the compass routine
heinrichsweikamp
parents: 256
diff changeset
1251 ; rcall TFT_dive_compass_mk_print_3
5dd0f39d05d4 minor speed and size improvements for the compass routine
heinrichsweikamp
parents: 256
diff changeset
1252 ; return
5dd0f39d05d4 minor speed and size improvements for the compass routine
heinrichsweikamp
parents: 256
diff changeset
1253 TFT_dive_compass_mk_print_3:
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1254 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
1255 movlw dm_custom_compass_label_row
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1256 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
1257 movlw dm_custom_compass_label_height-.2
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1258 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
1259 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
1260 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
1261 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
1262 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
1263 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
1264 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
1265 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
1266 TFT_dive_compass_mk_print_4:
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1267 banksel win_leftx2
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1268 movlw .158
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1269 cpfslt win_leftx2
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1270 bra TFT_dive_compass_mk_print_5
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1271 movlw d'2'
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1272 movwf win_width
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1273 movwf win_bargraph
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1274 banksel common
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1275 movlw color_green
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1276 btfss print_compass_label
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1277 movlw color_red
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1278 call TFT_set_color
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1279 call TFT_box
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1280 TFT_dive_compass_mk_print_5:
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1281 banksel common
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1282 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1283
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1284 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
1285 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
1286 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
1287 movlw dm_custom_compass_label_height+.2
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1288 movff WREG,win_height
257
5dd0f39d05d4 minor speed and size improvements for the compass routine
heinrichsweikamp
parents: 256
diff changeset
1289 rcall TFT_dive_compass_clear
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1290 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1291
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1292 TFT_dive_compass_clr_ruler:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1293 ; top tick
300
5ad479f2a868 Merged Screen layout mod #1 into Screen layout work #3
Janos Kovacs <kovjanos@gmail.com>
parents: 282
diff changeset
1294 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
1295 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
1296 movlw dm_custom_compass_tick_height
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1297 movff WREG,win_height
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1298 rcall TFT_dive_compass_clear
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1299 ;bottom tick
300
5ad479f2a868 Merged Screen layout mod #1 into Screen layout work #3
Janos Kovacs <kovjanos@gmail.com>
parents: 282
diff changeset
1300 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
1301 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
1302 movlw dm_custom_compass_tick_height
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1303 movff WREG,win_height
257
5dd0f39d05d4 minor speed and size improvements for the compass routine
heinrichsweikamp
parents: 256
diff changeset
1304 ; rcall TFT_dive_compass_clear
5dd0f39d05d4 minor speed and size improvements for the compass routine
heinrichsweikamp
parents: 256
diff changeset
1305 ; return
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1306 TFT_dive_compass_clear:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1307 ; we receive RM in lo and DD in hi
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1308 ; calculate width = RM-D
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1309 movff hi,WREG
371
fec5eec4c8b7 fix some display issues with display1
heinrichsweikamp
parents: 370
diff changeset
1310 subwf lo,W
370
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1311 bz TFT_dive_compass_clear3 ; Do nothing if there is nothing to do
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1312 movff WREG,win_width ; RM-DD
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1313 movff WREG,win_bargraph
370
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1314 banksel win_width
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1315 movlw .1
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1316 cpfsgt win_width
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1317 bra TFT_dive_compass_clear3 ; Do not clear a single pixel (or less)
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1318 banksel common
259
151148e2281f minor cleanup
heinrichsweikamp
parents: 258
diff changeset
1319 movff hi,win_leftx2
370
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1320 ;TFT_dive_compass_clear1:
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1321 ; movff win_leftx2,tft_temp1 ; Copy
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1322 ; ; check right border
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1323 ; movff win_width,WREG
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1324 ; addwf tft_temp1,F
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1325 ; movlw .159
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1326 ; cpfsgt tft_temp1 ; >159?
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1327 ; bra TFT_dive_compass_clear2 ; no
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1328 ; banksel win_width
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1329 ; decf win_width,F ; -1
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1330 ; banksel common
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1331 ; bra TFT_dive_compass_clear1
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1332 ;TFT_dive_compass_clear2:
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1333 movlw color_black
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1334 call TFT_set_color
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1335 call TFT_box
370
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1336 TFT_dive_compass_clear3:
67e631aa5b8c debugging the compass screen
heinrichsweikamp
parents: 337
diff changeset
1337 banksel common
256
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1338 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1339
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1340 tft_compass_cardinal:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1341 btfsc hi,0 ; Heading >255°?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1342 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
1343 ; 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
1344 movlw .23
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1345 subwf lo,W
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1346 btfss STATUS,C
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1347 bra tft_compass_cardinal_N
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1348 movlw .68
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1349 subwf lo,W
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1350 btfss STATUS,C
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1351 bra tft_compass_cardinal_NE
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1352 movlw .113
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1353 subwf lo,W
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1354 btfss STATUS,C
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1355 bra tft_compass_cardinal_E
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1356 movlw .158
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1357 subwf lo,W
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1358 btfss STATUS,C
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1359 bra tft_compass_cardinal_SE
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1360 movlw .203
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1361 subwf lo,W
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1362 btfss STATUS,C
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1363 bra tft_compass_cardinal_S
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1364 movlw .248
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1365 subwf lo,W
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1366 btfss STATUS,C
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1367 bra tft_compass_cardinal_SW
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1368 bra tft_compass_cardinal_W
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1369
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1370 tft_compass_cardinal2:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1371 movlw .37
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1372 subwf lo,W
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1373 btfss STATUS,C
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1374 bra tft_compass_cardinal_W
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1375 movlw .82
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1376 subwf lo,W
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1377 btfss STATUS,C
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1378 bra tft_compass_cardinal_NW
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1379 ; bra tft_compass_cardinal_N
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1380 tft_compass_cardinal_N:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1381 STRCAT_TEXT tN
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1382 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1383 tft_compass_cardinal_NE:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1384 STRCAT_TEXT tNE
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1385 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1386 tft_compass_cardinal_E:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1387 STRCAT_TEXT tE
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1388 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1389 tft_compass_cardinal_SE:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1390 STRCAT_TEXT tSE
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1391 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1392 tft_compass_cardinal_S:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1393 STRCAT_TEXT tS
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1394 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1395 tft_compass_cardinal_SW:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1396 STRCAT_TEXT tSW
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1397 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1398 tft_compass_cardinal_W:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1399 STRCAT_TEXT tW
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1400 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1401 tft_compass_cardinal_NW:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1402 STRCAT_TEXT tNW
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1403 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1404
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1405 compass_heading_common:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1406 call speed_normal
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1407 movlw compass_averaging ; numbers of extra averaging
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1408 movwf up
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1409 compass_heading_common2:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1410 rcall TFT_get_compass
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1411 decfsz up,F
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1412 bra compass_heading_common2
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1413 extern compass
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1414 call compass ; Do compass corrections.
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1415 banksel common
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1416
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1417 ; More then compass_fast_treshold?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1418 movff compass_heading_old+0,sub_a+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1419 movff compass_heading_old+1,sub_a+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1420 movff compass_heading+0,sub_b+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1421 movff compass_heading+1,sub_b+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1422 call sub16
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1423 btfss neg_flag ; <0?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1424 bra compass_heading_common3 ; No, test for threshold
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1425 ; Yes, subtract the other way round
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1426 movff compass_heading+0,sub_a+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1427 movff compass_heading+1,sub_a+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1428 movff compass_heading_old+0,sub_b+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1429 movff compass_heading_old+1,sub_b+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1430 call sub16
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1431 compass_heading_common3:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1432 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
1433 movff compass_heading+1,compass_heading_old+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1434
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1435 bcf compass_fast_mode
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1436 movlw compass_fast_treshold
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1437 cpfslt sub_c+0 ; > compass_fast_treshold?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1438 bsf compass_fast_mode ; Yes!
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1439
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1440 btfss compass_fast_mode ; In fast mode?
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1441 return ; No.
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1442 ; Yes.
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1443 movff compass_heading+0,lo
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1444 movff compass_heading+1,hi
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1445 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
1446 movff lo,compass_heading_shown+0
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1447 movff hi,compass_heading_shown+1
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1448 return
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 TFT_get_compass:
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1451 call I2C_RX_compass ; Test Compass
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1452 call I2C_RX_accelerometer ; Test Accelerometer
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1453 call compass_filter ; Filter Raw compass + accel readings.
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1454 banksel common
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1455 return
5b4ef0b9090d place compass display code into compass_ops.asm
heinrichsweikamp
parents: 214
diff changeset
1456
382
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
1457 global TFT_surf_set_bearing
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
1458 TFT_surf_set_bearing:
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
1459 btfsc premenu
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
1460 return ; Already shown, return
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
1461 bsf premenu ; set flag
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
1462 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
1463 WIN_SMALL surf_compass_bear_column,surf_compass_bear_row
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
1464 WIN_COLOR color_yellow
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
1465 bsf win_invert
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
1466 STRCPY_TEXT_PRINT tSetHeading ; 7 chars
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
1467 bcf win_invert
6f3530eb48f9 allow compass bearing on surface
heinrichsweikamp
parents: 371
diff changeset
1468 return
147
fdd4e30846ae some cleanup
heinrichsweikamp
parents: 0
diff changeset
1469
0
heinrichsweikamp
parents:
diff changeset
1470 END