; OSTC - diving computer code

; Copyright (C) 2008 HeinrichsWeikamp GbR



;    This program is free software: you can redistribute it and/or modify

;    it under the terms of the GNU General Public License as published by

;    the Free Software Foundation, either version 3 of the License, or

;    (at your option) any later version.



;    This program is distributed in the hope that it will be useful,

;    but WITHOUT ANY WARRANTY; without even the implied warranty of

;    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

;    GNU General Public License for more details.



;    You should have received a copy of the GNU General Public License

;    along with this program.  If not, see <http://www.gnu.org/licenses/>.





; routine for extra temperature compensation

; written by: Matthias Heinrichs, info@heinrichsweikamp.com

; written: 01/12/08

; last updated: 08/08/31

; known bugs:

; ToDo:



; routine echoes the "f" command as ready signal

; PC has to send 2 bytes containing the actual temperature in 0.1C

; Byte1: low

; Byte2: high





compensate_temperature:
	bcf		uart_compensate_temp		; clear flag
	bcf		PIE1,RCIE					; no interrupt for UART
;
;	call	set_LEDusb					; LEDusb ON
;
;	bcf		PIR1,RCIF					; clear flag
;
;
;
;	movlw	"f"							; send echo
;
;	movwf	TXREG						
;
;	call	rs232_wait_tx				; wait for UART
;
;	
;
;	call	rs232_get_byte				; low byte
;
;	movff	RCREG, lo
;
;
;
;	call	rs232_get_byte				; high byte
;
;	movff	RCREG, hi
;
;
;
;	clrf	temperature_correction		; wait for uncompensated temperature value!
;
;	WAITMS	d'250'						; wait for new temperature
;
;	WAITMS	d'250'
;
;	WAITMS	d'250'
;
;	WAITMS	d'250'
;
;
;
;	movff	lo,sub_a+0					; calculate difference
;
;	movff	hi,sub_a+1
;
;	movff	temperature+0, sub_b+0
;
;	movff	temperature+1, sub_b+1
;
;	call	sub16						;  sub_c = sub_a - sub_b
;
;	
;
;	movf	sub_c+0,W
;
;	btfsc	neg_flag					; compensate negative?
;
;	movlw	d'0'						; use zero compensation!
;
;	movwf	sub_c+0
;
;
;
;	movff	sub_c+0,TXREG				; Send answer
;
;
;
;	movff	sub_c+0,EEDATA				; store low byte only!
;
;	movff	sub_c+0,temperature_correction	; no reboot required then...
;
;	movlw	0x01
;
;	movwf	EEADRH
;
;	movlw	0x00
;
;	movwf	EEADR
;
;	call	write_eeprom		; stores in internal eeprom
;
;
;
;	movlw	0x00
;
;	movwf	EEADRH				; reset high address byte
;
;
;
;	call	clear_LEDusb		; LEDusb OFF
;
;	bcf		PIR1,RCIF					; clear flag
	bsf		PIE1,RCIE					; enable interrupt for UART
	goto	surfloop_loop				; return to surface loop