Mercurial > public > mk2
annotate code_part1/OSTC_code_asm_part1/surfmode.asm @ 101:526d2c016645
1.74beta...
author | heinrichsweikamp |
---|---|
date | Tue, 14 Dec 2010 08:59:44 +0100 |
parents | db4a20b413df |
children | a2b9eca1f396 |
rev | line source |
---|---|
0 | 1 |
2 ; OSTC - diving computer code | |
3 ; Copyright (C) 2008 HeinrichsWeikamp GbR | |
4 | |
5 ; This program is free software: you can redistribute it and/or modify | |
6 ; it under the terms of the GNU General Public License as published by | |
7 ; the Free Software Foundation, either version 3 of the License, or | |
8 ; (at your option) any later version. | |
9 | |
10 ; This program is distributed in the hope that it will be useful, | |
11 ; but WITHOUT ANY WARRANTY; without even the implied warranty of | |
12 ; MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
13 ; GNU General Public License for more details. | |
14 | |
15 ; You should have received a copy of the GNU General Public License | |
16 ; along with this program. If not, see <http://www.gnu.org/licenses/>. | |
17 | |
18 | |
19 ; routines for Surface mode | |
20 ; written by: Matthias Heinrichs, info@heinrichsweikamp.com | |
21 ; written: 10/01/05 | |
22 ; last updated: 080905 | |
23 ; known bugs: | |
24 ; ToDo: | |
25 | |
26 surfloop: | |
27 ; Boot tasks for all modes | |
28 call restart_set_modes_and_flags ; Sets decomode flags | |
29 clrf lo | |
30 movff lo,char_I_const_ppO2 ; reset to standard mode, OSTC assumes Air breathing at the surface! | |
31 | |
32 call PLED_brightness_full ;max. brightness | |
33 | |
34 call I2CReset | |
35 call enable_rs232 | |
36 call PLED_boot | |
37 call PLED_serial ; Show OSTC serial and firmware version | |
38 call PLED_clock ; display time | |
39 call update_date ; display date | |
40 movff last_surfpressure_30min+0,int_I_pres_respiration+0 ; copy surface air pressure to deco routine | |
41 movff last_surfpressure_30min+1,int_I_pres_respiration+1 ; 30min old values | |
42 movff last_surfpressure_30min+0,int_I_pres_surface+0 ; copy surface air pressure to deco routine | |
43 movff last_surfpressure_30min+1,int_I_pres_surface+1 ; 30min old values | |
44 | |
45 btfsc gauge_mode ; Ignore in gauge mode | |
46 bra surfloop1 | |
47 btfsc FLAG_apnoe_mode ; Ignore in Apnoe mode | |
48 bra surfloop1 | |
49 | |
50 ; Startup tasks for decompression modes | |
43 | 51 call PLED_display_cns_surface ; Update surface CNS display (If allowed by CF15) |
0 | 52 call PLED_desaturation_time ; display desaturation time |
53 call PLED_nofly_time ; display nofly time | |
13 | 54 |
55 btfss pre_dive_screen ; Show predive screen | |
56 call PLED_tissue_saturation_graph ; no, display saturation graph | |
57 btfsc pre_dive_screen ; Show predive screen | |
58 call PLED_pre_dive_screen ; yes, display Pre-Dive Screen | |
59 | |
0 | 60 call PLED_active_gas_surfmode ; Show start gas |
61 call PLED_display_decotype_surface ; Show deco mode (ZH-L16, const. ppO2 or Multi-GF) | |
62 | |
63 surfloop1: | |
64 btfss gauge_mode ; Display only in gauge mode | |
65 bra surfloop2 | |
66 DISPLAYTEXT d'103' ; Gauge mode | |
67 surfloop2: | |
68 btfss FLAG_apnoe_mode ; Display only in Apnoe mode | |
69 bra surfloop3 | |
70 DISPLAYTEXT d'116' ; Apnoe mode | |
71 | |
72 surfloop3: | |
73 ; Startup tasks for all modes | |
74 clrf timeout_counter2 | |
75 clrf timeout_counter3 | |
76 bcf premenu ; clear premenu flag | |
77 bcf menubit ; clear menu flag | |
78 bcf pressure_refresh | |
79 clrf last_pressure+0 | |
80 clrf last_pressure+1 | |
81 clrf last_temperature+0 | |
82 clrf last_temperature+1 | |
83 | |
84 movlw d'5' | |
85 movwf timeout_counter ; reload counter | |
86 | |
21 | 87 bcf LED_blue |
88 bcf LED_red | |
0 | 89 bcf simulatormode_active ; Quit simulator mode (if active) |
90 bcf standalone_simulator ; Quit simulator mode (if active) | |
91 WIN_TOP .0 | |
92 WIN_LEFT .0 | |
93 WIN_FONT FT_SMALL | |
94 WIN_INVERT .0 ; Init new Wordprocessor | |
3 | 95 call PLED_standard_color |
96 | |
0 | 97 bcf switch_left |
98 bcf switch_right | |
4 | 99 call PLED_active_gas_surfmode ; Show start gas / SetPoint |
0 | 100 call PLED_custom_text ; Displays custom text |
100 | 101 clrf cf_checker_counter ; next cf to check |
0 | 102 ostc_debug 'G' ; Sends debug-information to screen if debugmode active |
103 GETCUSTOM8 d'12' ; Desaturation multiplier % | |
104 movwf wait_temp | |
105 movff wait_temp,char_I_desaturation_multiplier | |
106 GETCUSTOM8 d'11' ; Saturation multiplier % | |
107 movwf wait_temp | |
108 movff wait_temp,char_I_saturation_multiplier | |
109 call deco_main_calc_desaturation_time; calculate desaturation time | |
110 movlb b'00000001' ; select ram bank 1 | |
111 ostc_debug 'H' ; Sends debug-information to screen if debugmode active | |
112 | |
113 call wait_switches ; Waits until switches are released, resets flag if button stays pressed! | |
114 | |
115 surfloop_loop: | |
116 btfss onesecupdate ; do every second tasks? | |
117 bra surfloop_loop2 ; no, loop | |
118 | |
119 btfss FLAG_const_ppO2_mode ; are we in const. ppO2 mode? | |
120 bra surfloop_loop1 ; No | |
121 ; One Second tasks for ppO2 modes | |
122 | |
123 bra surfloop_loop1 ; Do not search for sensor in CC mode | |
124 | |
125 | |
126 surfloop_loop1: | |
127 ; One Second tasks for all modes | |
128 call PLED_clock ; update clock | |
129 call test_charger ; check if charger IC is active | |
130 call timeout_surfmode ; check timeout | |
131 call get_battery_voltage ; get battery voltage | |
132 call update_batt_voltage ; display battery voltage | |
133 call timeout_premenu ; timeout premenu | |
134 call set_leds_surfmode ; Sets Warning and No-Fly LEDs | |
94 | 135 call check_customfunctions ; Checks CF functions and displays warning symbol if something critical is wrong |
0 | 136 call PLED_display_decotype_surface ; Show deco mode |
137 btfsc enter_error_sleep ; Enter Fatal Error Routine? | |
86
b40a0a6284da
adding custom functions with limits (jeando)
heinrichsweikamp
parents:
70
diff
changeset
|
138 call fatal_error_sleep ; Yes (In Sleepmode.asm!) |
0 | 139 bcf onesecupdate ; every second tasks done |
140 | |
141 surfloop_loop2: | |
142 ; Tasks approx. every 50ms for all modes | |
143 call test_switches_surfmode ; check switches | |
144 | |
145 ; Sensor tasks for all modes | |
146 btfsc pressure_refresh ; new pressure available? | |
147 call update_surf_press ; display surface pressure | |
148 btfsc pressure_refresh ; new temperature available? | |
149 call PLED_temp_surfmode ; Displays temperature | |
150 btfsc pressure_refresh ; new pressure available? | |
151 call set_dive_modes ; tests if depth>threshold | |
152 bcf pressure_refresh ; until new pressure is available | |
153 | |
154 ; One minute tasks for all modes | |
155 btfsc oneminupdate ; do every minute tasks | |
156 call update_surfloop60 ; yes, e.g. update time and date | |
157 | |
158 ; Mode tasks | |
159 btfsc menubit ; Menu? | |
160 goto menu ; Menu! | |
161 btfsc divemode ; Divemode active? | |
162 goto diveloop ; Yes, switch into Divemode! | |
163 btfsc sleepmode ; Sleepmode active? | |
164 goto sleeploop ; Yes, switch into sleepmode! | |
165 ; Check for the different UART flags | |
166 btfsc dump_external_eeprom ; Start interface (dumps EEPROM BANK 0 + additional data)? | |
167 goto menu_interface ; Yes! | |
168 btfsc uart_settime ; Sync clock with PC? | |
169 goto sync_clock ; Yes! | |
170 btfsc internal_eeprom_write ; Access internal EEPROM BANK 0 via UART module | |
171 goto internal_eeprom_access_b0 ; Yes! | |
172 btfsc internal_eeprom_write2 ; Access internal EEPROM BANK 1 via UART module | |
173 goto internal_eeprom_access_b1 ; Yes! | |
174 btfsc uart_send_hash ; Send MD2 hash values | |
175 goto send_md2_hash ; Yes! | |
176 btfsc uart_send_int_eeprom ; Send internal EEPROM BANK 0 | |
177 goto send_int_eeprom_b0 ; Yes! | |
178 btfsc uart_reset_decodata ; Reset Deco Data? | |
179 goto reset_decodata ; Yes! | |
180 btfsc uart_send_int_eeprom2 ; Send internal EEPROM BANK 1 | |
181 goto send_int_eeprom_b1 ; Yes! | |
182 btfsc uart_store_tissue_data ; Store tissue data?` | |
183 goto uart_store_tissues ; Yes! | |
184 | |
185 bra surfloop_loop ; loop surfacemode | |
186 | |
187 | |
188 update_surfloop60: | |
189 ; One minute tasks for all modes | |
4 | 190 ; call PLED_active_gas_surfmode ; Show start gas / SetPoint |
0 | 191 call update_date ; and date in divemode |
192 call calc_deko_surfmode ; calculate desaturation every minute | |
193 call check_temp_extrema ; check for new temperature extremas | |
194 call PLED_custom_text ; Displays custom text | |
195 call calc_surface_interval ; Increases Surface-Interval time | |
196 | |
197 btfsc gauge_mode ; Ignore in gauge mode | |
198 bra update_surfloop60_2 | |
199 btfsc FLAG_apnoe_mode ; Ignore in Apnoe mode | |
200 bra update_surfloop60_2 | |
201 | |
202 ; One Minute tasks for deco modes | |
43 | 203 call PLED_display_cns_surface ; Update surface CNS display (If allowed by CF15) |
0 | 204 call PLED_nofly_time ; display nofly time |
205 call PLED_desaturation_time ; display desaturation time | |
13 | 206 btfsc premenu ; Not when "Menu?" is displayed! |
207 bra update_surfloop60_2 | |
208 | |
209 btfss pre_dive_screen ; Show predive screen | |
210 call PLED_tissue_saturation_graph ; no, display saturation graph | |
211 btfsc pre_dive_screen ; Show predive screen | |
212 call PLED_pre_dive_screen ; yes, display Pre-Dive Screen | |
0 | 213 |
214 update_surfloop60_2: | |
215 call nofly_timeout60 ; checks if nofly time is > 0 | |
216 bcf oneminupdate | |
217 return | |
218 | |
219 nofly_timeout60: | |
220 bsf nofly_active ; Set flag | |
221 movlw d'1' | |
222 subwf nofly_time+0,F | |
223 movlw d'0' | |
224 subwfb nofly_time+1,F ; reduce by one | |
225 tstfsz nofly_time+0 ; =0? | |
226 return | |
227 tstfsz nofly_time+1 ; =0? | |
228 return | |
229 bcf nofly_active ; Clear flag | |
21 | 230 bcf LED_blue |
0 | 231 incf nofly_time+0,F ; =1 |
232 return | |
233 | |
234 calc_surface_interval: | |
235 movff int_O_desaturation_time+0,lo ; divide by 60... | |
236 movff int_O_desaturation_time+1,hi | |
237 tstfsz lo ;=0? | |
238 bra calc_surface_interval2 ; No | |
239 tstfsz hi ;=0? | |
240 bra calc_surface_interval2 ; No | |
241 clrf surface_interval+0 | |
242 clrf surface_interval+1 ; Clear surface interval timer | |
243 return | |
244 | |
245 calc_surface_interval2: ; Increase surface interval timer | |
246 movlw d'1' | |
247 addwf surface_interval+0,F | |
248 movlw d'0' | |
249 addwfc surface_interval+1,F | |
250 return | |
251 | |
252 set_leds_surfmode: | |
253 btfsc nofly_active | |
21 | 254 btg LED_blue |
0 | 255 return |
256 | |
257 calc_deko_surfmode: | |
21 | 258 bsf LED_red |
0 | 259 ostc_debug 'I' ; Sends debug-information to screen if debugmode active |
260 | |
261 movff last_surfpressure+0,int_I_pres_surface+0 ; copy surface air pressure to deco routine | |
262 movff last_surfpressure+1,int_I_pres_surface+1 | |
263 clrf wait_temp ; Use as buffer | |
264 movff wait_temp,char_I_He_ratio ; No He at the Surface | |
265 movlw d'79' ; 79% N2 | |
266 movwf wait_temp ; Use as buffer | |
267 movff wait_temp,char_I_N2_ratio ; No He at the Surface | |
268 | |
269 movff amb_pressure+0,int_I_pres_respiration+0 ; copy surface air pressure to deco routine | |
270 movff amb_pressure+1,int_I_pres_respiration+1 | |
271 GETCUSTOM8 d'11' ; Saturation multiplier % | |
272 movwf wait_temp | |
273 movff wait_temp,char_I_saturation_multiplier | |
274 GETCUSTOM8 d'12' ; Desaturation multiplier % | |
275 movwf wait_temp | |
276 movff wait_temp,char_I_desaturation_multiplier | |
277 | |
278 call deco_main_calc_wo_deco_step_1_m ; calculate deco in surface mode | |
279 movlb b'00000001' ; select ram bank 1 | |
280 ostc_debug 'J' ; Sends debug-information to screen if debugmode active | |
21 | 281 bcf LED_red |
0 | 282 return |
283 | |
284 | |
285 test_charger: | |
286 bcf TRISC,1 ; CHRG_OUT output | |
287 bsf CHRG_OUT | |
288 | |
289 bcf cc_active ; Constant Current mode active? | |
290 btfss CHRG_IN ; If CHRG_IN=0 -> CC active | |
291 bsf cc_active ; Constant Current mode Active! | |
292 | |
293 bcf CHRG_OUT | |
294 bsf TRISC,1 ; CHRG_OUT high impedance | |
295 | |
296 WAIT10US d'10' | |
297 | |
298 bcf cv_active ; Constant Voltage mode Active? | |
299 btfss CHRG_IN ; If CHRG_IN=0 -> CV active | |
300 bsf cv_active ; Constant Voltage mode active! | |
301 | |
302 bcf TRISC,1 ; CHRG_OUT output | |
303 bcf CHRG_OUT | |
304 | |
305 btfsc cc_active | |
306 bra show_cc_active | |
307 btfsc cv_active | |
308 bra show_cv_active | |
309 | |
310 bsf TRISC,1 ; CHRG_OUT high impedance | |
311 | |
312 ; Charger inactive or ready | |
313 btfss charge_done ; charge done? | |
314 bra test_charger2 ; No, add incomplete cycle! | |
315 | |
316 ; Yes, store all data for complete cycle | |
317 bcf charge_started ; Clear flag | |
318 bcf charge_done ; Clear flag | |
319 ; Store incomplete/total cycles | |
320 read_int_eeprom d'50' ; Read byte (stored in EEDATA) | |
321 movff EEDATA,temp1 ; Low byte | |
322 read_int_eeprom d'51' ; Read byte (stored in EEDATA) | |
323 movff EEDATA,temp2 ; high byte | |
324 bcf STATUS,C | |
325 movlw d'1' | |
326 addwf temp1 | |
327 movlw d'0' | |
328 addwfc temp2 | |
329 movff temp1,EEDATA | |
330 write_int_eeprom d'50' ; write byte stored in EEDATA | |
331 movff temp2,EEDATA | |
332 write_int_eeprom d'51' ; write byte stored in EEDATA | |
333 | |
334 ; Store complete cycles | |
335 read_int_eeprom d'52' ; Read byte (stored in EEDATA) | |
336 movff EEDATA,temp1 ; Low byte | |
337 read_int_eeprom d'53' ; Read byte (stored in EEDATA) | |
338 movff EEDATA,temp2 ; high byte | |
339 bcf STATUS,C | |
340 movlw d'1' | |
341 addwf temp1 | |
342 movlw d'0' | |
343 addwfc temp2 | |
344 movff temp1,EEDATA | |
345 write_int_eeprom d'52' ; write byte stored in EEDATA | |
346 movff temp2,EEDATA | |
347 write_int_eeprom d'53' ; write byte stored in EEDATA | |
348 ; Store date of complete cycle | |
349 movff month,EEDATA | |
350 write_int_eeprom d'47' | |
351 movff day,EEDATA | |
352 write_int_eeprom d'48' | |
353 movff year,EEDATA | |
354 write_int_eeprom d'49' | |
355 | |
356 return | |
357 | |
358 test_charger2: | |
359 btfss charge_started ; Did the charger ever start? | |
360 return ; No, quit! | |
361 | |
362 bcf charge_started ; Clear flag | |
363 ; Store incomplete/total cycles | |
364 read_int_eeprom d'50' ; Read byte (stored in EEDATA) | |
365 movff EEDATA,temp1 ; Low byte | |
366 read_int_eeprom d'51' ; Read byte (stored in EEDATA) | |
367 movff EEDATA,temp2 ; high byte | |
368 bcf STATUS,C | |
369 movlw d'1' | |
370 addwf temp1 | |
371 movlw d'0' | |
372 addwfc temp2 | |
373 movff temp1,EEDATA | |
374 write_int_eeprom d'50' ; write byte stored in EEDATA | |
375 movff temp2,EEDATA | |
376 write_int_eeprom d'51' ; write byte stored in EEDATA | |
377 return | |
378 | |
379 show_cv_active: ; CV mode | |
21 | 380 bsf LED_red |
0 | 381 WAITMS d'100' |
21 | 382 bcf LED_red |
0 | 383 WAITMS d'100' |
21 | 384 bsf LED_red |
0 | 385 bsf charge_done ; Charge cycle finished |
386 return | |
387 | |
388 show_cc_active: ; CC mode | |
21 | 389 bsf LED_red |
0 | 390 bsf charge_started ; Charger started in CC mode |
391 bcf charge_done ; Charge cycle not finished | |
392 return | |
393 | |
394 | |
395 timeout_premenu: | |
396 btfss premenu ; is "Menu?" displayed? | |
397 return ; No | |
398 incf timeout_counter3,F ; Yes... | |
399 GETCUSTOM8 d'4' ; loads premenu_timeout into WREG | |
400 cpfsgt timeout_counter3 ; ... longer then premenu_timeout | |
401 return ; No! | |
402 bcf premenu ; Yes, so clear "Menu?" and clear pre_menu bit | |
403 | |
404 call PLED_topline_box_clear ; Clears Bar at the top | |
405 | |
406 btfsc gauge_mode | |
407 bra timeout_premenu2 ; Skip in Gauge mode | |
408 btfsc FLAG_apnoe_mode | |
409 bra timeout_premenu2 ; Skip in Apnoe mode | |
13 | 410 |
411 btfss pre_dive_screen ; Show predive screen | |
412 call PLED_tissue_saturation_graph ; no, display saturation graph | |
413 btfsc pre_dive_screen ; Show predive screen | |
414 call PLED_pre_dive_screen ; yes, display Pre-Dive Screen | |
415 | |
0 | 416 timeout_premenu2: |
417 call update_surf_press ; rewrite serial number | |
418 call PLED_serial ; rewrite serial number | |
419 clrf timeout_counter3 ; Also clear timeout | |
420 bcf switch_left ; and debounce switches | |
421 bcf switch_right | |
422 return | |
423 | |
424 test_switches_surfmode: ; checks switches in surfacemode | |
425 btfsc switch_left | |
426 bra test_switches_surfmode2 | |
427 btfsc switch_right | |
428 bra test_switches_surfmode3 | |
429 | |
430 ; No button press, reset timer0 | |
431 bcf T0CON,TMR0ON ; Stop Timer 0 | |
432 bcf INTCON,TMR0IF ; Clear flag | |
433 clrf TMR0H | |
434 clrf TMR0L | |
435 bcf INTCON,INT0IF ; Clear flag | |
436 bcf INTCON3,INT1IF ; Clear flag | |
437 return | |
438 | |
439 test_switches_surfmode3: | |
440 bcf switch_right | |
441 call PLED_topline_box ; Write a filled bar at the top | |
442 WIN_INVERT .1 ; Init new Wordprocessor | |
443 DISPLAYTEXT .4 ;Menu? | |
444 WIN_INVERT .0 ; Init new Wordprocessor | |
445 bsf premenu | |
446 clrf timeout_counter2 | |
447 return | |
448 | |
449 test_switches_surfmode2: | |
450 bcf switch_left | |
451 btfss premenu | |
13 | 452 bra test_switches_surfmode4 |
0 | 453 bsf menubit ; Enter Menu! |
454 return | |
455 | |
13 | 456 test_switches_surfmode4: |
457 btg pre_dive_screen | |
0 | 458 |
13 | 459 btfss pre_dive_screen ; Show predive screen |
460 call PLED_tissue_saturation_graph ; no, display saturation graph | |
461 btfsc pre_dive_screen ; Show predive screen | |
462 call PLED_pre_dive_screen ; yes, display Pre-Dive Screen | |
463 | |
464 return | |
0 | 465 |
466 timeout_surfmode: | |
467 incf timeout_counter2,F ; increase timeout counter | |
468 GETCUSTOM8 d'3' ; loads surfloop_timeout into WREG | |
469 addlw d'5' ; adds five seconds in case timout=zero! | |
470 btfsc STATUS,C ; > 255? | |
471 movlw d'255' ; Set to 255... | |
472 decf WREG,F ; Limit to 254 | |
473 cpfsgt timeout_counter2 ; Compare with timeout_counter2 | |
474 return ; return, no timeout | |
475 bsf sleepmode ; Set Flag | |
476 return ; Return |