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