'{$STAMP BS2}

'***********************************************************
'**                                                       **
'**            I2C Routines for the Basic Stamp           **
'**                to change addr of SRF08                **
'**                                                       **
'**             Copyright 2002 - Devantech Ltd            **
'**     Commercial use of this software is prohibited     **
'**     Private and educational use only is permitted     **
'**                                                       **
'**        Written by Gerald Coe - January 2002           **
'**                                                       **
'**      This Code has been Tested on BS2 and BS2p        **
'**  It should work equally well on the BS2e and BS2sx    **
'**                                                       **
'***********************************************************


NEW_SRF08_ADDRESS		con	$e2	' Place new address for SRF08 here 
'avaliable addresses are: e0, e2, e4, e6, e8, ea, ec, ee
'                         f0, f2, f4, f6, f8, fa, fc, fe


SCL  		con	9			' I2C clock
SDA		con	8			' I2C data
SDAin		var	in8
SDAout	var	out8			' To change the pins used, alter these 5 lines 
SDAdir	var	dir8			' The 4 SDA numbers must be the same, of course

loop		var	byte			' just a looping counter
I2cBuf	var	byte			' I2c read/write buffer
I2cAddr	var	byte			' Address of I2C device
I2cReg	var	byte			' Register number within I2C device
I2cData	var	word			' Data to read/write
I2cAck	var	bit			' Acknowledge bit
	

Main:

	I2cAddr = 0				' use general broadcast address ($00) if don't know current SRF08 address  
	I2cReg = 0				' command register
	I2cData = $a0			' 1st command in address change sequence
	gosub	I2cByteWrite
	I2cData = $aa			' 2nd command in address change sequence
	gosub	I2cByteWrite
	I2cData = $a5			' 3rd command in address change sequence
	gosub	I2cByteWrite
	I2cData = NEW_SRF08_ADDRESS		
	gosub	I2cByteWrite

endlessloop:
	I2cAddr = NEW_SRF08_ADDRESS			
	I2cReg = 0
	I2cData = 81			' one of the ranging commands
	gosub	I2cByteWrite
	pause	70				' wait for ranging to complete
	goto	endlessloop


'--------------------------------------------------------------------------------------------
' I2C subroutines follow
'--------------------------------------------------------------------------------------------

I2cByteWrite:				' writes I2cData.lowbyte to I2cReg at I2cAddr
	gosub	I2cStart
	I2cBuf = I2cAddr	
	gosub	I2cOutByte			' send device address
	I2cBuf = I2cReg	
	gosub	I2cOutByte			' send register number
	I2cBuf = I2cData.lowbyte	
	gosub	I2cOutByte			' send the data
	gosub	I2cStop
	return
	

I2cWordWrite:				' writes I2cData to I2cReg at I2cAddr
	gosub	I2cStart
	I2cBuf = I2cAddr	
	gosub	I2cOutByte			' send device address
	I2cBuf = I2cReg	
	gosub	I2cOutByte			' send register number
	I2cBuf = I2cData.highbyte
	gosub	I2cOutByte			' send the data - high byte
	I2cBuf = I2cData.lowbyte
	gosub	I2cOutByte			' send the data - low byte
	gosub	I2cStop
	return
	

I2CByteRead:
	gosub	I2cStart
	I2cBuf = I2cAddr	
	gosub	I2cOutByte			' send device address
	I2cBuf = I2cReg	
	gosub	I2cOutByte			' send register number
	gosub	I2cStart			' repeated start
	I2cBuf = I2cAddr | 1	
	gosub	I2cOutByte			' send device address (with read set)
	I2cAck = 0				' send Nak
	gosub	I2cInByte
	I2cData.lowbyte = I2cBuf	' read the data
	I2cData.highbyte = 0
	gosub	I2cStop
	return


I2CWordRead:
	gosub	I2cStart
	I2cBuf = I2cAddr	
	gosub	I2cOutByte			' send device address
	I2cBuf = I2cReg	
	gosub	I2cOutByte			' send register number
	gosub	I2cStart			' repeated start
	I2cBuf = I2cAddr | 1	
	I2cAck = 1				' send Ack
	gosub	I2cOutByte			' send device address (with read set)
	gosub	I2cInByte
	I2cData.highbyte = I2cBuf	' read the data
	I2cAck = 0				' send Nak
	gosub	I2cInByte
	I2cData.lowbyte = I2cBuf
	gosub	I2cStop
	return


I2cOutByte:
	shiftout SDA, SCL, MSBFIRST, [I2cBuf]
	input	SDA
	high	SCL					' clock in the ack' bit
	low	SCL
	return

 
I2cInByte:
	shiftin SDA, SCL, MSBPRE, [I2cBuf]
	SDAout = 0
	SDAdir = I2cAck
	high	SCL					' clock out the ack' bit
	low 	SCL
	input	SDA
	return


I2cStart						' I2C start bit sequence
	high	SDA
	high	SCL
	low	SDA
	low	SCL
	return


I2cStop:						' I2C stop bit sequence
	low	SDA
	high	SCL
	high	SDA
	return