Mercurial > public > hwos_code
annotate src/adc_lightsensor.asm @ 160:99ac325586ce
BUGFIX: Fast diluent (w/o dive mode menu) change did not work correctly
| author | heinrichsweikamp |
|---|---|
| date | Mon, 08 Sep 2014 15:39:41 +0200 |
| parents | 683321c09cfa |
| children | 669b5d00706d |
| rev | line source |
|---|---|
| 0 | 1 ;============================================================================= |
| 2 ; | |
| 3 ; File adc.asm | |
| 4 ; | |
| 5 ; | |
| 6 ; Copyright (c) 2011, JD Gascuel, HeinrichsWeikamp, all right reserved. | |
| 7 ;============================================================================= | |
| 8 ; HISTORY | |
| 9 ; 2011-08-08 : [mH] moving from OSTC code | |
| 10 | |
| 11 #include "ostc3.inc" | |
| 12 #include "math.inc" | |
| 13 #include "wait.inc" | |
| 14 #include "eeprom_rs232.inc" | |
| 113 | 15 #include "i2c.inc" |
| 0 | 16 |
| 17 sensors CODE | |
| 18 | |
| 19 wait_adc: | |
| 20 movwf ADCON0 | |
| 21 nop | |
| 22 bsf ADCON0,1 ; start ADC | |
| 23 wait_adc2: | |
| 24 btfsc ADCON0,1 ; Wait... | |
| 25 bra wait_adc2 | |
| 26 return | |
| 27 | |
| 28 global get_battery_voltage | |
| 29 get_battery_voltage: ; starts ADC and waits until fnished | |
| 113 | 30 btfss c3_hardware |
| 31 bra get_battery_voltage1 ; Normal ostc3 hardware | |
| 32 | |
| 33 call lt2942_get_accumulated_charge | |
| 34 call lt2942_get_voltage | |
| 120 | 35 bcf LEDr |
| 36 bcf TRISJ,2 ; Chrg-Out output | |
| 37 bsf CHRG_OUT | |
| 38 | |
| 39 btfss CHRG_IN | |
| 40 bra cc_active | |
| 41 | |
| 42 bcf CHRG_OUT | |
| 43 bsf TRISJ,2 ; Chrg-Out high impedance | |
| 44 | |
| 45 WAITMS d'1' | |
| 46 | |
| 47 btfsc CHRG_IN | |
| 48 return | |
| 49 ;cv_active: | |
| 50 bsf LEDr ; Indicate charging | |
| 51 call lt2942_charge_done ; Reset accumulating registers to 0xFFFF | |
| 52 WAITMS d'10' | |
| 53 bcf LEDr ; Indicate charging | |
| 54 return | |
| 55 | |
| 56 cc_active: | |
| 57 bsf LEDr ; Indicate charging | |
| 58 bcf CHRG_OUT | |
| 59 bsf TRISJ,2 ; Chrg-Out high impedance | |
| 113 | 60 return |
| 61 | |
| 62 get_battery_voltage1: | |
| 0 | 63 bsf adc_running ; =1: The ADC is in use |
| 64 movlw b'00100000' ; 2.048V Vref+ -> 1LSB = 500µV | |
| 65 movwf ADCON1 | |
| 66 movlw b'00011001' ; power on ADC, select AN6 | |
| 67 rcall wait_adc | |
| 68 | |
| 69 movff ADRESH,batt_voltage+1 ; store value | |
| 70 movff ADRESL,batt_voltage+0 ; store value | |
| 71 bcf ADCON0,0 ; power off ADC | |
| 72 | |
| 73 ; Multiply with 2,006 to be excact here... | |
| 74 ; bcf STATUS,C | |
| 75 ; rlcf xA+0,F | |
| 76 ; | |
| 77 ; rlcf xA+1,F ; x2 | |
| 78 | |
| 79 ; movff xA+0,batt_voltage+0 ; store value | |
| 80 ; movff xA+1,batt_voltage+1 | |
| 81 | |
| 82 movlw LOW lithium_36v_low | |
| 83 movwf sub_a+0 | |
| 84 movlw HIGH lithium_36v_low | |
| 85 movwf sub_a+1 | |
| 86 movff batt_voltage+0,sub_b+0 | |
| 87 movff batt_voltage+1,sub_b+1 | |
| 88 call subU16 ; sub_c = sub_a - sub_b | |
| 89 ; Battery is 3,6V (>lithium_36v_low?) | |
| 90 btfss neg_flag | |
| 91 bra get_battery_voltage4 ; No, use 1,5V | |
| 92 | |
| 93 bsf battery_is_36v ; Yes, set flag (Cleared in power-on reset only!) | |
| 94 | |
| 95 ; Check if the battery is near-dead already | |
| 96 movlw LOW lithium_36v_empty | |
| 97 movwf sub_a+0 | |
| 98 movlw HIGH lithium_36v_empty | |
| 99 movwf sub_a+1 | |
| 100 call subU16 ; sub_c = sub_a - sub_b | |
| 101 ; Battery is not dead yet (>lithium_36v_empty?) | |
| 102 btfsc neg_flag | |
| 103 bra get_battery_voltage2 ; Yes, battery is still ok | |
| 104 | |
| 105 ; Battery is probably dead very soon | |
| 106 ; Set ">=24Ah used" into battery gauge registers | |
| 107 movlw .128 | |
| 108 movff WREG,battery_gauge+5 | |
| 109 | |
| 110 get_battery_voltage2: | |
| 111 ; Use 3,6V battery gauging mode | |
| 112 movff battery_gauge+5,xC+3 | |
| 113 movff battery_gauge+4,xC+2 | |
| 114 movff battery_gauge+3,xC+1 | |
| 115 movff battery_gauge+2,xC+0 | |
| 116 ; battery_gauge:6 is nAs | |
| 117 ; devide through 65536 | |
| 118 ; devide through 364 | |
| 119 ; Result is in percent of a 2,4Ah Battery | |
| 120 movlw LOW .364 | |
| 121 movwf xB+0 | |
| 122 movlw HIGH .364 | |
| 123 movwf xB+1 | |
| 124 call div32x16 ; xC:4 / xB:2 = xC+3:xC+2 with xC+1:xC+0 as remainder | |
| 125 movff xC+0,lo | |
| 126 ; Limit to 100 | |
| 127 movlw .100 | |
| 128 cpfslt lo | |
| 129 movwf lo | |
| 130 ; lo will be between 0 (Full) and 100 (empty) | |
| 131 movf lo,W | |
| 132 sublw .100 | |
| 133 movwf lo | |
| 134 get_battery_voltage3: | |
| 135 movlw .100 | |
| 136 cpfslt lo | |
| 137 movwf lo | |
| 138 ; lo will be between 100 (Full) and 0 (empty) | |
|
37
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
139 |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
140 ; use 3,6V battery sensing based on 50mA load |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
141 ; 75% |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
142 movff batt_voltage+0,sub_b+0 |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
143 movff batt_voltage+1,sub_b+1 |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
144 movlw LOW lithium_36v_75 |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
145 movwf sub_a+0 |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
146 movlw HIGH lithium_36v_75 |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
147 movwf sub_a+1 |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
148 call subU16 ; sub_c = sub_a - sub_b |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
149 btfsc neg_flag |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
150 bra get_battery_voltage3a |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
151 movlw .75 |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
152 movwf lo |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
153 get_battery_voltage3a: |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
154 ; 50% |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
155 movlw LOW lithium_36v_50 |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
156 movwf sub_a+0 |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
157 movlw HIGH lithium_36v_50 |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
158 movwf sub_a+1 |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
159 call subU16 ; sub_c = sub_a - sub_b |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
160 btfsc neg_flag |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
161 bra get_battery_voltage3b |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
162 movlw .50 |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
163 movwf lo |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
164 get_battery_voltage3b: |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
165 ; 25% |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
166 movlw LOW lithium_36v_25 |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
167 movwf sub_a+0 |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
168 movlw HIGH lithium_36v_25 |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
169 movwf sub_a+1 |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
170 call subU16 ; sub_c = sub_a - sub_b |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
171 btfsc neg_flag |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
172 bra get_battery_voltage3c |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
173 movlw .25 |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
174 movwf lo |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
175 get_battery_voltage3c: |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
176 ; 10% |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
177 movlw LOW lithium_36v_10 |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
178 movwf sub_a+0 |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
179 movlw HIGH lithium_36v_10 |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
180 movwf sub_a+1 |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
181 call subU16 ; sub_c = sub_a - sub_b |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
182 btfsc neg_flag |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
183 bra get_battery_voltage3d |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
184 movlw .10 |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
185 movwf lo |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
186 get_battery_voltage3d: |
|
44
18fe4e668baa
BUGFIX: Percent display with 1,5V batteries
heinrichsweikamp
parents:
37
diff
changeset
|
187 movlw .100 |
|
18fe4e668baa
BUGFIX: Percent display with 1,5V batteries
heinrichsweikamp
parents:
37
diff
changeset
|
188 cpfslt lo |
|
18fe4e668baa
BUGFIX: Percent display with 1,5V batteries
heinrichsweikamp
parents:
37
diff
changeset
|
189 movwf lo |
|
18fe4e668baa
BUGFIX: Percent display with 1,5V batteries
heinrichsweikamp
parents:
37
diff
changeset
|
190 ; lo will be between 100 (Full) and 0 (empty) |
| 0 | 191 movf batt_percent,W |
| 192 cpfsgt lo ; keep batt_percent on the lowest value found | |
| 193 movff lo,batt_percent ; store value | |
|
37
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
194 ; btfsc battery_is_36v ; but always use computed value for 3,6V battery |
|
0e1723f2761e
use four additional data points for the battery monitor
mh@mh-THINK.fritz.box
parents:
0
diff
changeset
|
195 ; movff lo,batt_percent ; store value |
| 0 | 196 bcf adc_running ; =1: The ADC is in use |
| 197 return | |
| 198 | |
| 199 get_battery_voltage4: | |
| 200 ; Use 1,5V battery voltage mode | |
| 201 ; Use approximation (batt_voltage:2-aa_15v_low)/4 = lo | |
| 202 movff batt_voltage+0,sub_a+0 | |
| 203 movff batt_voltage+1,sub_a+1 | |
| 204 movlw LOW aa_15v_low | |
| 205 movwf sub_b+0 | |
| 206 movlw HIGH aa_15v_low | |
| 207 movwf sub_b+1 | |
| 208 call subU16 ; sub_c = sub_a - sub_b | |
| 209 bcf STATUS,C | |
| 210 rrcf sub_c+1 | |
| 211 rrcf sub_c+0 ; /2 | |
| 212 bcf STATUS,C | |
| 213 rrcf sub_c+1 | |
| 214 rrcf sub_c+0 ; /4 | |
| 215 movff sub_c+0,lo | |
|
44
18fe4e668baa
BUGFIX: Percent display with 1,5V batteries
heinrichsweikamp
parents:
37
diff
changeset
|
216 bra get_battery_voltage3d ; Check limits and return |
| 0 | 217 |
| 218 global get_ambient_level | |
| 219 get_ambient_level: ; starts ADC and waits until finished | |
| 220 btfsc adc_running ; ADC in use? | |
| 221 return ; Yes, return | |
| 222 | |
| 113 | 223 btfss c3_hardware |
| 224 bra get_ambient_level1 ; Normal ostc3 hardware | |
| 225 movlw .250 | |
| 226 movwf ambient_light+0 | |
| 227 clrf ambient_light+1 ; Set to max | |
| 228 bra get_ambient_level2 ; Continue as normal | |
| 229 | |
| 230 get_ambient_level1: | |
| 0 | 231 movlw b'00000000' ; Vref+ = Vdd |
| 232 movwf ADCON1 | |
| 233 movlw b'00011101' ; power on ADC, select AN7 | |
| 234 rcall wait_adc | |
| 235 | |
| 236 movff ADRESH,ambient_light+1 | |
| 237 movff ADRESL,ambient_light+0 | |
| 238 bcf ADCON0,0 ; power off ADC | |
| 239 | |
| 240 ; ambient_light:2 is between 4096 (direct sunlight) and about 200 (darkness) | |
| 241 ; First: Devide through 16 | |
| 242 bcf STATUS,C | |
| 243 rrcf ambient_light+1 | |
| 244 rrcf ambient_light+0 | |
| 245 bcf STATUS,C | |
| 246 rrcf ambient_light+1 | |
| 247 rrcf ambient_light+0 | |
| 248 bcf STATUS,C | |
| 249 rrcf ambient_light+1 | |
| 250 rrcf ambient_light+0 | |
| 251 bcf STATUS,C | |
| 252 rrcf ambient_light+1 | |
| 253 rrcf ambient_light+0 | |
| 254 ; Result: ambient_light:2/16 | |
| 255 ; Now, make sure to have value between ambient_light_low and ambient_light_max | |
| 256 | |
| 257 movlw .254 | |
| 258 tstfsz ambient_light+1 ; >255? | |
| 259 movwf ambient_light+0 ; avoid ADC clipping | |
| 260 | |
| 261 incfsz ambient_light+0,W ; =255? | |
| 262 bra get_ambient_level2 ; No, continue | |
| 263 | |
| 264 movlw .254 | |
| 265 movwf ambient_light+0 ; avoid ADC clipping | |
| 266 | |
| 267 get_ambient_level2: | |
| 268 banksel isr_backup ; Back to Bank0 ISR data | |
| 269 movff opt_brightness,isr1_temp | |
| 270 | |
| 271 btfsc RCSTA1,7 ; UART module on? | |
| 272 clrf isr1_temp ; Yes, set temporally to eco mode | |
| 273 | |
| 274 incf isr1_temp,F ; adjust 0-2 to 1-3 | |
| 275 | |
| 276 banksel common ; flag is in bank1 | |
| 136 | 277 movlw ambient_light_max_high_c3; c3 hardware brightest setting |
| 278 btfss c3_hardware | |
| 279 movlw ambient_light_max_high_15V; 1,5V battery brightest setting | |
| 280 btfsc battery_is_36v ; 3,6V battery in use? | |
| 281 movlw ambient_light_max_high_36V ; 3,6V battery brightest setting | |
| 0 | 282 banksel isr_backup ; Back to Bank0 ISR data |
| 283 | |
| 284 dcfsnz isr1_temp,F | |
| 285 movlw ambient_light_max_eco ; brightest setting | |
| 286 dcfsnz isr1_temp,F | |
| 287 movlw ambient_light_max_medium; brightest setting | |
| 288 | |
| 289 banksel common ; ambient_light is in Bank1 | |
| 290 incf ambient_light+0,F ; +1 | |
| 291 cpfslt ambient_light+0 ; smaller then WREG? | |
| 292 movwf ambient_light+0 ; No, set to max. | |
| 293 | |
| 294 banksel isr_backup ; Back to Bank0 ISR data | |
| 295 movff opt_brightness,isr1_temp | |
| 296 incf isr1_temp,F ; adjust 0-2 to 1-3 | |
| 297 movlw ambient_light_min_high ; darkest setting | |
| 298 | |
| 299 dcfsnz isr1_temp,F | |
| 300 movlw ambient_light_min_eco ; darkest setting | |
| 301 dcfsnz isr1_temp,F | |
| 302 movlw ambient_light_min_medium; darkest setting | |
| 303 dcfsnz isr1_temp,F | |
| 304 movlw ambient_light_min_high ; darkest setting | |
| 305 | |
| 306 banksel common ; ambient_light is in Bank1 | |
| 307 cpfsgt ambient_light+0 ; bigger then WREG? | |
| 308 movwf ambient_light+0 ; No, set to min | |
| 309 | |
| 310 movff ambient_light+0,max_CCPR1L ; Store value for dimming in TMR7 interrupt | |
| 311 return | |
| 312 | |
| 113 | 313 global get_analog_inputs |
| 314 get_analog_inputs: ; starts ADC and waits until finished | |
| 0 | 315 bsf adc_running ; =1: The ADC is in use |
| 113 | 316 btfsc TFT_PWM |
| 317 bra get_analog_inputs ; Wait for PWM low | |
| 318 movlw b'00100000' ; 2.048V Vref+ -> 1LSB = 500µV | |
| 319 movwf ADCON1 | |
| 320 movlw b'00100001' ; power on ADC, select AN8 | |
| 321 rcall wait_adc | |
| 322 bcf STATUS,C | |
| 323 rrcf ADRESH,F ; /2 | |
| 324 rrcf ADRESL,F | |
| 325 movff ADRESL,o2_mv_sensor1+0 ; in 0.1mV steps | |
| 326 movff ADRESH,o2_mv_sensor1+1 | |
| 327 bcf STATUS,C | |
| 328 rlcf ADRESL,F | |
| 329 rlcf ADRESH,F | |
| 0 | 330 movlw b'00100000' ; 2.048V Vref+ |
| 331 movwf ADCON1 | |
| 113 | 332 movlw b'00100101' ; power on ADC, select AN9 |
| 0 | 333 rcall wait_adc |
| 113 | 334 bcf STATUS,C |
| 335 rrcf ADRESH,F ; /2 | |
| 336 rrcf ADRESL,F | |
| 337 movff ADRESL,o2_mv_sensor2+0 ; in 0.1mV steps | |
| 338 movff ADRESH,o2_mv_sensor2+1 | |
| 339 movlw b'00100000' ; 2.048V Vref+ | |
| 340 movwf ADCON1 | |
| 341 movlw b'00101001' ; power on ADC, select AN10 | |
| 342 rcall wait_adc | |
| 343 bcf STATUS,C | |
| 344 rrcf ADRESH,F ; /2 | |
| 345 rrcf ADRESL,F | |
| 346 movff ADRESL,o2_mv_sensor3+0 ; in 0.1mV steps | |
| 347 movff ADRESH,o2_mv_sensor3+1 | |
| 0 | 348 bcf ADCON0,0 ; power off ADC |
| 349 bcf adc_running ; =1: The ADC is in use | |
| 350 return | |
| 351 | |
| 113 | 352 global piezo_config ; Sets up piezo sensitivity of heinrichs weikamp Piezo buttons (~30ms) |
| 117 | 353 piezo_config: ; Settings between 20 and 200 |
| 158 | 354 movlw .75 ; right button |
| 117 | 355 rcall piezo_config_tx |
| 158 | 356 movlw .75 ; left button |
| 117 | 357 rcall piezo_config_tx |
| 358 movlw .200 ; reserved | |
| 359 rcall piezo_config_tx | |
| 360 movlw .200 ; reserved | |
| 361 rcall piezo_config_tx | |
| 113 | 362 return |
| 363 | |
| 117 | 364 piezo_config_tx: ; Send one byte |
| 113 | 365 movwf uart1_temp ; Store byte |
| 366 movlw .8 | |
| 367 movwf uart2_temp ; Bit counter | |
| 368 bcf TX3_PIEZO_CFG ; Startbit | |
| 369 rcall piezo_config_wait_bit | |
| 370 piezo_config_tx_loop: | |
| 371 btfss uart1_temp,0 ; LSB first | |
| 372 bcf TX3_PIEZO_CFG | |
| 373 btfsc uart1_temp,0 ; LSB first | |
| 374 bsf TX3_PIEZO_CFG | |
| 375 rcall piezo_config_wait_bit | |
| 376 rrncf uart1_temp,F | |
| 377 decfsz uart2_temp,F | |
| 378 bra piezo_config_tx_loop | |
| 379 bsf TX3_PIEZO_CFG ; Stopbit | |
| 380 rcall piezo_config_wait_bit | |
| 381 return | |
| 382 | |
| 383 piezo_config_wait_bit: | |
| 384 setf TMR5H | |
| 385 movlw .255-.26 ;26 x 31,5µs = 819us | |
| 386 movwf TMR5L | |
| 387 bcf PIR5,TMR5IF ; Clear flag | |
| 388 piezo_config_wait_bit3: | |
| 389 btfss PIR5,TMR5IF | |
| 390 bra piezo_config_wait_bit3 ; Wait loop | |
| 391 return | |
| 392 | |
| 0 | 393 global reset_battery_pointer |
| 394 reset_battery_pointer: ; Resets battery pointer 0x07-0x0C and battery_gauge:5 | |
| 113 | 395 extern lt2942_charge_done |
| 396 call lt2942_charge_done ; Reset accumulating registers to 0xFFFF | |
| 397 clrf EEADRH | |
| 0 | 398 clrf EEDATA ; Delete to zero |
| 399 write_int_eeprom 0x07 | |
| 400 write_int_eeprom 0x08 | |
| 401 write_int_eeprom 0x09 | |
| 402 write_int_eeprom 0x0A | |
| 403 write_int_eeprom 0x0B | |
| 404 write_int_eeprom 0x0C | |
| 405 banksel battery_gauge+0 | |
| 406 clrf battery_gauge+0 | |
| 407 clrf battery_gauge+1 | |
| 408 clrf battery_gauge+2 | |
| 409 clrf battery_gauge+3 | |
| 410 clrf battery_gauge+4 | |
| 411 clrf battery_gauge+5 | |
| 412 banksel common | |
| 413 movlw .100 | |
| 414 movwf batt_percent | |
| 415 return | |
| 416 | |
| 417 | |
| 418 END |