Mercurial > public > hwos_code
annotate src/surfmode.asm @ 451:66049b6f2c0b
speedup analog presses
author | heinrichsweikamp |
---|---|
date | Thu, 01 Sep 2016 13:24:17 +0200 |
parents | 6f3530eb48f9 |
children | 7c10557c248e |
rev | line source |
---|---|
0 | 1 ;============================================================================= |
2 ; | |
3 ; File surfmode.asm | |
4 ; | |
5 ; Surfacemode | |
6 ; | |
7 ; Copyright (c) 2011, JD Gascuel, HeinrichsWeikamp, all right reserved. | |
8 ;============================================================================= | |
9 ; HISTORY | |
10 ; 2011-08-07 : [mH] moving from OSTC code | |
11 | |
275 | 12 #include "hwos.inc" ; Mandatory header |
0 | 13 #include "shared_definitions.h" ; Mailbox from/to p2_deco.c |
14 #include "start.inc" | |
15 #include "tft.inc" | |
16 #include "tft_outputs.inc" | |
17 #include "isr.inc" | |
18 #include "adc_lightsensor.inc" | |
19 #include "menu_processor.inc" | |
20 #include "strings.inc" | |
21 #include "sleepmode.inc" | |
22 #include "wait.inc" ; speed_* | |
23 #include "external_flash.inc" | |
24 #include "customview.inc" | |
25 #include "divemode.inc" | |
26 #include "mcp.inc" ; RX | |
27 #include "i2c.inc" | |
28 #include "comm.inc" | |
29 #include "eeprom_rs232.inc" | |
113 | 30 #include "calibrate.inc" |
0 | 31 |
213 | 32 extern do_main_menu |
33 | |
0 | 34 #DEFINE menu_pos_row .215 |
213 | 35 #DEFINE menu_pos_column .1 |
0 | 36 #DEFINE view_row .215 |
37 #DEFINE view_column .124 | |
38 | |
39 gui CODE | |
40 | |
41 | |
42 ;============================================================================= | |
43 ; Boot tasks for all modes | |
44 global surfloop | |
45 surfloop: | |
46 call speed_normal | |
47 bcf no_sensor_int ; Normal pressure mode | |
48 | |
245 | 49 bcf LEDg |
50 bcf LEDr | |
51 | |
0 | 52 clrf CCP1CON ; stop PWM |
53 bcf PORTC,2 ; Pull PWM output to GND | |
54 call TFT_boot ; Initialize TFT (includes clear screen) | |
55 bcf restore_deco_data | |
56 | |
57 WIN_TOP .50 | |
58 WIN_LEFT .10 | |
59 movlw LOW 0x1E000 | |
60 movwf TBLPTRL | |
61 movlw HIGH 0x1E000 | |
62 movwf TBLPTRH | |
63 movlw UPPER 0x1E000 | |
64 movwf TBLPTRU | |
65 extern color_image | |
66 call color_image ; Show logo | |
67 | |
68 WIN_TOP .100 | |
69 WIN_LEFT .34 | |
275 | 70 extern ostc_logo_block |
71 movlw LOW(ostc_logo_block) | |
0 | 72 movwf TBLPTRL |
275 | 73 movlw HIGH ostc_logo_block;&0xFFFF |
0 | 74 movwf TBLPTRH |
275 | 75 movlw UPPER(ostc_logo_block) |
0 | 76 movwf TBLPTRU |
77 call color_image | |
78 call TFT_Display_FadeIn ; Show splash | |
79 call TFT_serial ; Show serial and firmware version | |
80 | |
81 ;---- Do any usefull initializes that takes time ------------------------- | |
82 call restart_set_modes_and_flags ; Sets decomode flags | |
83 bcf pressure_refresh | |
84 call I2C_init_compass | |
85 call I2C_init_accelerometer | |
86 clrf ext_flash_address+0 | |
87 clrf ext_flash_address+1 | |
88 clrf ext_flash_address+2 | |
89 | |
354 | 90 movlw surface_sp ; in cbar |
91 call transmit_setpoint ; Transmit current setpoint from WREG (in cbar) to external electronics | |
221
90923a081ae7
minor: configure buttons during splash screen
heinrichsweikamp
parents:
213
diff
changeset
|
92 |
0 | 93 clrf timeout_counter2 |
94 clrf timeout_counter3 | |
95 bcf menubit ; clear menu flag | |
382 | 96 bcf premenu |
0 | 97 clrf last_pressure+0 |
98 clrf last_pressure+1 | |
99 bcf is_bailout ; =1: Bailout | |
100 bcf ccr_diluent_setup ; Use OC gases for gaslist routine | |
101 | |
102 bcf simulatormode_active ; Quit simulator mode (if active) | |
103 bcf switch_left | |
104 bcf switch_right | |
105 | |
106 ;---- Fade to standard surface view -------------------------------------- | |
107 ; Wait 1 second | |
108 bcf onesecupdate | |
109 btfss onesecupdate | |
110 bra $-2 | |
111 ; Wait 1 second | |
112 bcf onesecupdate | |
113 btfss onesecupdate | |
114 bra $-2 | |
115 | |
116 call TFT_Display_FadeOut ; Go to black screen | |
117 call TFT_ClearScreen ; Then change everything | |
118 WIN_TOP .0 | |
119 WIN_LEFT .0 | |
120 WIN_FONT FT_SMALL | |
189
e79bc535ef9e
ignore un-calibrated sensors even if they become valid
heinrichsweikamp
parents:
188
diff
changeset
|
121 bcf win_invert ; Reset invert flag |
0 | 122 |
123 WIN_COLOR color_lightblue | |
124 WIN_SMALL menu_pos_column,menu_pos_row | |
125 STRCPY_TEXT_PRINT tMenu ;"<Menu" | |
126 WIN_SMALL view_column,view_row | |
127 STRCPY_TEXT_PRINT tView ;"View>" | |
128 call TFT_standard_color | |
129 | |
48 | 130 ; Logo |
0 | 131 WIN_TOP .0 |
132 WIN_LEFT .70 | |
275 | 133 movlw LOW(ostc_logo_block) |
0 | 134 movwf TBLPTRL |
275 | 135 movlw HIGH ostc_logo_block;&0xFFFF |
0 | 136 movwf TBLPTRH |
275 | 137 movlw UPPER(ostc_logo_block) |
0 | 138 movwf TBLPTRU |
139 call color_image | |
140 | |
158 | 141 call TFT_clock ; display time |
142 call update_surfloop60 | |
143 call get_battery_voltage ; get battery voltage | |
144 call TFT_update_batt_voltage ; display battery voltage | |
145 call TFT_update_surf_press ; display surface pressure | |
146 call TFT_temp_surfmode ; Displays temperature | |
147 call TFT_display_decotype_surface | |
375
a9e35c1327aa
1.88 release, BUGFIX: Start with Sensor use from sleep (cR only), CHANGE: Apply button settings when button menu is closed, NEW: Reset button settings on a magnet reset (cR and OSTC 2)
heinrichsweikamp
parents:
354
diff
changeset
|
148 call compute_ppo2 ; compute mv_sensorX and ppo2_sensorX arrays |
a9e35c1327aa
1.88 release, BUGFIX: Start with Sensor use from sleep (cR only), CHANGE: Apply button settings when button menu is closed, NEW: Reset button settings on a magnet reset (cR and OSTC 2)
heinrichsweikamp
parents:
354
diff
changeset
|
149 call check_sensors ; Set enable/disable flags |
234
57155164faad
Show OSTC2-like active gas boxes in surface mode
heinrichsweikamp
parents:
233
diff
changeset
|
150 |
232 | 151 movff opt_dive_mode,lo ; 0=OC, 1=CC, 2=Gauge, 3=Apnea |
152 tstfsz lo | |
153 bra surfloop_no_oc ; Not OC | |
234
57155164faad
Show OSTC2-like active gas boxes in surface mode
heinrichsweikamp
parents:
233
diff
changeset
|
154 call TFT_show_OC_startgas_surface; Show first gas and "OSTC2-like" active gases |
232 | 155 surfloop_no_oc: |
158 | 156 movff customview_surfmode,menupos3 ; Reload last customview |
157 call surf_customview_mask ; Update #menupos3 view | |
0 | 158 |
159 call TFT_Display_FadeIn ; Display resulting surface screen. | |
160 | |
161 ;---- Late initialisations ----------------------------------------------- | |
162 movff last_surfpressure_30min+0,int_I_pres_respiration+0 ; copy surface air pressure to deco routine | |
163 movff last_surfpressure_30min+1,int_I_pres_respiration+1 ; 30min old values | |
164 movff last_surfpressure_30min+0,int_I_pres_surface+0 ; copy surface air pressure to deco routine | |
165 movff last_surfpressure_30min+1,int_I_pres_surface+1 ; 30min old values | |
166 movff last_surfpressure_30min+0,last_surfpressure+0 ; Use 30min old airpressure | |
167 movff last_surfpressure_30min+1,last_surfpressure+1 ; Use 30min old airpressure | |
168 | |
158 | 169 ; Startup tasks for all modes |
0 | 170 ; Desaturation time needs: |
171 ; int_I_pres_surface | |
172 ; char_I_desaturation_multiplier | |
173 call deco_calc_desaturation_time ; calculate desaturation time | |
174 movlb b'00000001' ; select ram bank 1 | |
175 | |
176 btfsc enable_screen_dumps ; =1: Ignore vin_usb, wait for "l" command (Screen dump) | |
177 call enable_rs232 ; Also sets to speed_normal ... | |
178 | |
179 surfloop_loop: | |
180 btfss onesecupdate ; do every second tasks? | |
181 bra surfloop_loop2 ; no, loop | |
182 | |
183 ; One Second tasks for all modes | |
184 call speed_normal | |
185 call TFT_debug_output | |
186 call TFT_clock ; update clock | |
187 call timeout_surfmode ; check timeout | |
188 call get_battery_voltage ; get battery voltage | |
189 call TFT_update_batt_voltage ; display battery voltage | |
190 call set_dive_modes ; tests if depth>threshold | |
191 btfss secs,0 ; Every two seconds... | |
192 call TFT_temp_surfmode ; Displays temperature | |
193 btfss secs,0 ; Every two seconds... | |
194 call surfmode_check_for_warnings ; ... check for warnings (and display/update) them | |
195 | |
196 bcf onesecupdate ; every second tasks done | |
197 | |
198 surfloop_loop2: | |
199 ; Tasks approx. every 50ms for all modes | |
200 call test_switches_surfmode ; check switches | |
201 | |
202 ; One minute tasks for all modes | |
203 btfsc oneminupdate ; do every minute tasks | |
204 call update_surfloop60 ; yes, e.g. update time and date | |
205 | |
206 ; Mode tasks | |
230
f6548e8f06f5
Bugfix: Check for divemode before checking for menu
mh@mh-THINK
parents:
226
diff
changeset
|
207 btfsc divemode ; Divemode active? |
f6548e8f06f5
Bugfix: Check for divemode before checking for menu
mh@mh-THINK
parents:
226
diff
changeset
|
208 goto diveloop ; Yes, switch into Divemode! |
f6548e8f06f5
Bugfix: Check for divemode before checking for menu
mh@mh-THINK
parents:
226
diff
changeset
|
209 |
0 | 210 btfsc menubit ; Menu? |
211 goto do_main_menu ; Menu! | |
212 | |
213 btfsc pressure_refresh ; new pressure available? | |
214 call TFT_update_surf_press ; display surface pressure | |
215 bcf pressure_refresh ; until new pressure is available | |
216 | |
188
ebc28381f17d
NEW: Show Bailout Gas List in Surface mode (CCR Modes)
heinrichsweikamp
parents:
187
diff
changeset
|
217 ; Updates every 1/4 second |
0 | 218 btfss quarter_second_update |
219 bra surfloop_loop2a | |
188
ebc28381f17d
NEW: Show Bailout Gas List in Surface mode (CCR Modes)
heinrichsweikamp
parents:
187
diff
changeset
|
220 |
0 | 221 bcf quarter_second_update |
188
ebc28381f17d
NEW: Show Bailout Gas List in Surface mode (CCR Modes)
heinrichsweikamp
parents:
187
diff
changeset
|
222 ; Update Sensors |
ebc28381f17d
NEW: Show Bailout Gas List in Surface mode (CCR Modes)
heinrichsweikamp
parents:
187
diff
changeset
|
223 |
ebc28381f17d
NEW: Show Bailout Gas List in Surface mode (CCR Modes)
heinrichsweikamp
parents:
187
diff
changeset
|
224 call compute_ppo2 ; compute mv_sensorX and ppo2_sensorX arrays |
ebc28381f17d
NEW: Show Bailout Gas List in Surface mode (CCR Modes)
heinrichsweikamp
parents:
187
diff
changeset
|
225 call check_sensors ; Set enable/disable flags |
ebc28381f17d
NEW: Show Bailout Gas List in Surface mode (CCR Modes)
heinrichsweikamp
parents:
187
diff
changeset
|
226 btfsc FLAG_ccr_mode ; In CCR mode... |
ebc28381f17d
NEW: Show Bailout Gas List in Surface mode (CCR Modes)
heinrichsweikamp
parents:
187
diff
changeset
|
227 call TFT_surface_sensor ; ...update sensor data in surface mode |
ebc28381f17d
NEW: Show Bailout Gas List in Surface mode (CCR Modes)
heinrichsweikamp
parents:
187
diff
changeset
|
228 |
0 | 229 movlw .6 |
230 cpfseq menupos3 ; in compass view? | |
231 bra surfloop_loop2a ; No | |
256
5b4ef0b9090d
place compass display code into compass_ops.asm
heinrichsweikamp
parents:
245
diff
changeset
|
232 extern TFT_surface_compass_heading |
0 | 233 call TFT_surface_compass_heading ; Yes, update compass heading value |
234 | |
235 surfloop_loop2a: | |
236 btfsc toggle_customview ; Next view? | |
237 call surf_customview_toggle ; Yes, show next customview (and delete this flag) | |
238 | |
239 btfsc enable_screen_dumps ; =1: Ignore vin_usb, wait for "l" command (Screen dump) | |
240 bra surfloop_loop3 | |
241 btfsc vusb_in ; USB plugged in? | |
113 | 242 call comm_mode ; Start COMM mode |
0 | 243 bra surfloop_loop4 |
244 surfloop_loop3: | |
245 btfss vusb_in ; USB (still) plugged in? | |
246 bcf enable_screen_dumps ; No, clear flag | |
247 call rs232_get_byte | |
248 btfsc rs232_recieve_overflow | |
249 bra surfloop_loop4 | |
250 movlw "l" | |
251 cpfseq RCREG1 | |
252 bra surfloop_loop4 | |
253 call TFT_dump_screen ; Dump the screen contents | |
254 surfloop_loop4: | |
255 btfsc sleepmode ; Sleepmode active? | |
256 goto sleeploop ; Yes, switch into sleepmode! | |
257 | |
258 bra surfloop_loop ; loop surfacemode | |
259 | |
260 update_surfloop60: | |
261 ; One minute tasks for all modes | |
262 call TFT_date ; Update date | |
263 call calc_deko_surfmode ; calculate desaturation every minute | |
264 bcf oneminupdate | |
265 return | |
266 | |
267 extern check_cns_violation,check_warn_battery,check_and_store_gf_violation | |
268 surfmode_check_for_warnings: | |
269 movf warning_counter_backup,W | |
270 cpfseq warning_counter ; warning_counter_backup = warning_counter? | |
271 call TFT_clear_warning_text ; No, clear all warnings | |
272 movff warning_counter,warning_counter_backup ; copy warning_counter | |
273 | |
274 bcf warning_active ; Clear flag | |
275 clrf warning_counter ; Clear counter | |
276 | |
277 ; Warnings for all modes | |
278 call check_warn_battery ; Check if the battery level should be displayed/warned | |
205 | 279 rcall surfmode_check_for_nofly ; Check if nofly time should be shown |
280 rcall surfmode_check_for_desat ; Check if desat time should be shown | |
281 rcall surfmode_check_for_interval ; Check if surface interval should be shown | |
0 | 282 |
283 btfsc FLAG_apnoe_mode ; Done for Apnoe or Gauge mode | |
284 bra surfmode_check_for_warnings2 | |
285 btfsc FLAG_gauge_mode ; Done for Apnoe or Gauge mode | |
286 bra surfmode_check_for_warnings2 | |
287 | |
288 ; Warnings only in deco modes | |
289 call check_cns_violation ; Check CNS value and display it, if required | |
290 call check_and_store_gf_violation ; Check GF value and display it, if required | |
291 | |
292 surfmode_check_for_warnings2: | |
293 ; Setup warning_page number | |
294 incf warning_page,F | |
295 bcf STATUS,C | |
296 rlcf warning_page,W ; *2 | |
297 cpfsgt warning_counter ; > warning_counter | |
298 clrf warning_page ; No, clear | |
299 | |
300 ; Clear 2nd row of warnings if there is nothing to show (on this page) | |
301 btfss second_row_warning ; =1: The second row contains a warning | |
302 call TFT_clear_warning_text_2nd_row ; No, clear this row | |
303 return ; Done. | |
304 | |
305 surfmode_check_for_interval: | |
306 movf surface_interval+0,W ; Is interval null ? | |
133
939f1e83c4c2
BUGFIX: Surface interval was not displayed correctly in some cases
heinrichsweikamp
parents:
113
diff
changeset
|
307 iorwf surface_interval+1,W |
0 | 308 bnz surfmode_check_for_interval2 ; No |
309 return | |
310 surfmode_check_for_interval2: | |
311 incf warning_counter,F ; increase counter | |
312 call TFT_interval | |
313 return | |
314 | |
315 | |
316 surfmode_check_for_desat: | |
317 movf desaturation_time+0,W ; Is nofly null ? | |
318 iorwf desaturation_time+1,W | |
319 bnz surfmode_check_for_desat2 ; No | |
320 return | |
321 surfmode_check_for_desat2: | |
322 incf warning_counter,F ; increase counter | |
323 call TFT_desaturation_time | |
324 return | |
325 | |
326 surfmode_check_for_nofly: | |
327 movf nofly_time+0,W ; Is nofly null ? | |
328 iorwf nofly_time+1,W | |
329 bnz surfmode_check_for_nofly2 ; No... | |
330 return | |
331 surfmode_check_for_nofly2: | |
332 incf warning_counter,F ; increase counter | |
333 call TFT_nofly_time | |
334 return | |
335 | |
336 | |
337 ;============================================================================= | |
338 global calc_deko_surfmode | |
339 calc_deko_surfmode: | |
340 SAFE_2BYTE_COPY amb_pressure,int_I_pres_respiration ; copy surface air pressure to deco routine | |
341 call deco_calc_wo_deco_step_1_min ; calculate deco in surface mode | |
342 banksel common | |
343 return | |
344 | |
345 test_switches_surfmode: ; checks switches in surfacemode | |
346 btfsc switch_right | |
347 bra test_switches_surfmode2 | |
348 btfsc switch_left | |
349 bra test_switches_surfmode3 | |
350 | |
351 ; No button press | |
352 return | |
353 | |
354 test_switches_surfmode3: | |
382 | 355 movlw .6 |
356 cpfseq menupos3 ; in compass view? | |
357 bra test_switches_surfmode3a ; No | |
358 | |
359 btfsc premenu ; already shown "Bearing" | |
360 bra test_switches_surfmode3b ; Yes, remove it | |
361 | |
362 extern TFT_surf_set_bearing | |
363 call TFT_surf_set_bearing ; Yes. | |
364 bcf switch_left | |
365 return | |
366 | |
367 test_switches_surfmode3a: | |
0 | 368 bcf switch_left |
369 bsf menubit ; Enter Menu! | |
370 return | |
371 | |
382 | 372 test_switches_surfmode3b: |
373 ; Clear "Heading?" | |
374 WIN_BOX_BLACK .158,.190, .15, .99 ; top, bottom, left, right | |
375 bcf premenu | |
376 bcf switch_left | |
377 return | |
378 | |
0 | 379 test_switches_surfmode2: |
382 | 380 movlw .6 |
381 cpfseq menupos3 ; in compass view? | |
382 bra test_switches_surfmode2a ; No | |
383 btfss premenu ; "Heading?" shown? | |
384 bra test_switches_surfmode2a ; No | |
385 ; Set new heading | |
386 bcf premenu | |
387 bsf compass_bearing_set | |
388 movff compass_heading_shown+0,compass_bearing+0 | |
389 movff compass_heading_shown+1,compass_bearing+1 | |
390 bcf switch_right | |
391 return | |
392 | |
393 test_switches_surfmode2a: | |
0 | 394 bcf switch_right |
395 bsf toggle_customview | |
382 | 396 bcf premenu |
0 | 397 clrf timeout_counter2 ; and reset timeout |
398 return | |
399 | |
400 global timeout_surfmode | |
401 timeout_surfmode: | |
188
ebc28381f17d
NEW: Show Bailout Gas List in Surface mode (CCR Modes)
heinrichsweikamp
parents:
187
diff
changeset
|
402 movlw timeout_surfacemode ; [s] Default timeout |
187
669b5d00706d
CHANGE: Longer timeout (4 min) for calibration menu
heinrichsweikamp
parents:
158
diff
changeset
|
403 btfsc menu_show_sensors2 ; In the "Calibrate" menu? |
188
ebc28381f17d
NEW: Show Bailout Gas List in Surface mode (CCR Modes)
heinrichsweikamp
parents:
187
diff
changeset
|
404 movlw timeout_calibrate_menu ; [s] CCR Calibrate Menu timeout |
ebc28381f17d
NEW: Show Bailout Gas List in Surface mode (CCR Modes)
heinrichsweikamp
parents:
187
diff
changeset
|
405 btfsc menubit ; in Menu? |
ebc28381f17d
NEW: Show Bailout Gas List in Surface mode (CCR Modes)
heinrichsweikamp
parents:
187
diff
changeset
|
406 bra timeout_testmode ; No, done. |
ebc28381f17d
NEW: Show Bailout Gas List in Surface mode (CCR Modes)
heinrichsweikamp
parents:
187
diff
changeset
|
407 ; Must be in surface mode |
ebc28381f17d
NEW: Show Bailout Gas List in Surface mode (CCR Modes)
heinrichsweikamp
parents:
187
diff
changeset
|
408 btfss FLAG_ccr_mode ; =1: CCR mode (Fixed ppO2 or Sensor) active |
ebc28381f17d
NEW: Show Bailout Gas List in Surface mode (CCR Modes)
heinrichsweikamp
parents:
187
diff
changeset
|
409 bra timeout_testmode ; No, not CCR |
ebc28381f17d
NEW: Show Bailout Gas List in Surface mode (CCR Modes)
heinrichsweikamp
parents:
187
diff
changeset
|
410 movlw timeout_ccr_surface ; [s] CCR Surface mode timeout |
ebc28381f17d
NEW: Show Bailout Gas List in Surface mode (CCR Modes)
heinrichsweikamp
parents:
187
diff
changeset
|
411 |
0 | 412 global timeout_testmode |
413 timeout_testmode: | |
414 incf timeout_counter2,F ; increase timeout counter | |
415 cpfsgt timeout_counter2 ; Compare with timeout_counter2 | |
416 return ; return, no timeout | |
417 bsf sleepmode ; Set Flag | |
418 return ; Return | |
419 | |
420 END |