Difference between revisions of "Line Following Sensor"

From RoboWiki
Jump to: navigation, search
(New page: This page describes the connection of the i2c line following sensor to the Boe-Bot robot. * [http://www.roboticsconnection.com/p-67-line-following-sensor.aspx I2C Line Following Sensor] ...)
 
 
(5 intermediate revisions by the same user not shown)
Line 1: Line 1:
 
This page describes the connection of the i2c line following sensor to the Boe-Bot robot.
 
This page describes the connection of the i2c line following sensor to the Boe-Bot robot.
  
 +
[[Image:LineSensorI2Cphoto.jpg]]
  
 
* [http://www.roboticsconnection.com/p-67-line-following-sensor.aspx I2C Line Following Sensor] by the [http://www.roboticsconnection.com Robotics Connection Inc.]
 
* [http://www.roboticsconnection.com/p-67-line-following-sensor.aspx I2C Line Following Sensor] by the [http://www.roboticsconnection.com Robotics Connection Inc.]
 +
 +
This sensor uses an i2c bus for connection with the processor. To understand more about the
 +
communication, read following two articles:
  
 
* Jon Williams: [http://www.parallax.com/dl/docs/cols/nv/vol3/col/nv85.pdf I2C Fun For Everyone]
 
* Jon Williams: [http://www.parallax.com/dl/docs/cols/nv/vol3/col/nv85.pdf I2C Fun For Everyone]
* Jon Williams: [http://www.parallax.com/dl/docs/cols/nv/vol5/col/nv115.pdf I2C Again – And the Case for Continuos
+
* Jon Williams: [http://www.parallax.com/dl/docs/cols/nv/vol5/col/nv115.pdf I2C Again – And the Case for Continuos Improvement]
Improvement]
+
 
 +
 
 +
Please, read the [http://www.roboticsconnection.com/userForums/Topic944-10-1.aspx following communication] in case of the problems with line detection. And there is a [http://www.roboticsconnection.com/userForums/Topic1217-10-1.aspx solution]: sensors used to be separated from themselves.
 +
 
 +
 
  
  
 
The connection diagram:
 
The connection diagram:
  
[[Image:LineSensorConnection.png]]
+
[[Image:LineSensorConnection.png|300px]]
  
 
The photo of the connection:
 
The photo of the connection:
  
[[Image:LineSensorPhoto.jpg]]
+
[[Image:LineSensorPhoto.jpg|300px]]
  
 
The demonstration software:
 
The demonstration software:
  
<code lang="basic">
+
<source lang="basic">
</code>
+
'  {$STAMP BS2}
 +
'  {$PBASIC 2.5}
 +
 
 +
' -----[ I/O Definitions ]-------------------------------------------------
 +
SDA            PIN    0                      ' I2C serial data line
 +
SCL            PIN    1                      ' I2C serial clock line
 +
 
 +
' -----[ Constants ]-------------------------------------------------------
 +
Ack            CON    0                      ' acknowledge bit
 +
Nak            CON    1                      ' no ack bit
 +
 
 +
' -----[ Variables ]-------------------------------------------------------
 +
slvAddr        VAR    Byte                    ' slave address
 +
devNum          VAR    Nib                    ' device number (0 - 7)
 +
addrLen        VAR    Nib                    ' 0, 1 or 2
 +
devAddr        VAR    Word                    ' address in device
 +
 
 +
i2cData        VAR    Byte                    ' data to/from device
 +
i2cWork        VAR    Byte                    ' work byte for TX routine
 +
i2cAck          VAR    Bit                    ' Ack bit from device
 +
 
 +
' -----[ Initialization ]--------------------------------------------------
 +
 
 +
  devNum = 0                                    ' device address %000
 +
  slvAddr = $50
 +
  addrLen = 0                                  ' no internal addresses
 +
 
 +
  DEBUG CLS,
 +
        "Line Sensor Demo"                        ' setup output screen
 +
 
 +
' -----[ Program Code ]----------------------------------------------------
 +
 
 +
  DO
 +
      GOSUB Read_Byte                          ' read switches
 +
                                                ' report
 +
      DEBUG CRSRXY, 0, 2, "In.... ", BIN5 i2cData
 +
      PAUSE 100
 +
  LOOP
 +
 
 +
END
 +
 
 +
 
 +
 
 +
 
 +
' -----[ Subroutines - Don't change nothing here!!! ]----------------------
 +
 
 +
 
 +
' -----[ High Level I2C Subroutines]---------------------------------------
 +
 
 +
' Random location read
 +
' -- pass device slave address in "slvAddr"
 +
' -- pass address bytes (0, 1 or 2) in "addrLen"
 +
' -- register address passed in "devAddr"
 +
' -- data byte read is returned in "i2cData"
 +
 
 +
Read_Byte:
 +
  GOSUB I2C_Start                              ' send Start
 +
  i2cWork = slvAddr | %00000001                ' send slave ID (read)
 +
  GOSUB I2C_TX_Byte
 +
  GOSUB I2C_RX_Byte_Nak
 +
  GOSUB I2C_Stop
 +
  i2cData = i2cWork
 +
  RETURN
 +
 
 +
 
 +
' -----[ Low Level I2C Subroutines]----------------------------------------
 +
 
 +
' *** Start Sequence ***
 +
 
 +
I2C_Start:                                      ' I2C start bit sequence
 +
  INPUT SDA
 +
  INPUT SCL
 +
  LOW SDA
 +
 
 +
Clock_Hold:
 +
  DO : LOOP UNTIL (SCL = 1)                    ' wait for clock release
 +
  RETURN
 +
 
 +
 
 +
' *** Transmit Byte ***
 +
 
 +
I2C_TX_Byte:
 +
  SHIFTOUT SDA, SCL, MSBFIRST, [i2cWork\8]      ' send byte to device
 +
  SHIFTIN SDA, SCL, MSBPRE, [i2cAck\1]          ' get acknowledge bit
 +
  RETURN
 +
 
 +
 
 +
' *** Receive Byte ***
 +
 
 +
I2C_RX_Byte_Nak:
 +
  i2cAck = Nak                                  ' no Ack = high
 +
  GOTO I2C_RX
 +
 
 +
I2C_RX_Byte:
 +
  i2cAck = Ack                                  ' Ack = low
 +
 
 +
I2C_RX:
 +
  SHIFTIN SDA, SCL, MSBPRE, [i2cWork\8]        ' get byte from device
 +
  SHIFTOUT SDA, SCL, LSBFIRST, [i2cAck\1]      ' send ack or nak
 +
  RETURN
 +
 
 +
 
 +
' *** Stop Sequence ***
 +
 
 +
I2C_Stop:                                      ' I2C stop bit sequence
 +
  LOW SDA
 +
  INPUT SCL
 +
  INPUT SDA
 +
  RETURN</source>
  
 
Results:
 
Results:
 
[[Image:LineSensorScreenshot.png]]
 
[[Image:LineSensorScreenshot.png]]
 +
 +
[[Category:Sensors]]

Latest revision as of 11:38, 24 January 2012

This page describes the connection of the i2c line following sensor to the Boe-Bot robot.

LineSensorI2Cphoto.jpg

This sensor uses an i2c bus for connection with the processor. To understand more about the communication, read following two articles:


Please, read the following communication in case of the problems with line detection. And there is a solution: sensors used to be separated from themselves.



The connection diagram:

LineSensorConnection.png

The photo of the connection:

LineSensorPhoto.jpg

The demonstration software:

'   {$STAMP BS2}
'   {$PBASIC 2.5}

' -----[ I/O Definitions ]-------------------------------------------------
SDA             PIN     0                       ' I2C serial data line
SCL             PIN     1                       ' I2C serial clock line

' -----[ Constants ]-------------------------------------------------------
Ack             CON     0                       ' acknowledge bit
Nak             CON     1                       ' no ack bit

' -----[ Variables ]-------------------------------------------------------
slvAddr         VAR     Byte                    ' slave address
devNum          VAR     Nib                     ' device number (0 - 7)
addrLen         VAR     Nib                     ' 0, 1 or 2
devAddr         VAR     Word                    ' address in device

i2cData         VAR     Byte                    ' data to/from device
i2cWork         VAR     Byte                    ' work byte for TX routine
i2cAck          VAR     Bit                     ' Ack bit from device

' -----[ Initialization ]--------------------------------------------------

  devNum = 0                                    ' device address %000
  slvAddr = $50
  addrLen = 0                                   ' no internal addresses

  DEBUG CLS,
        "Line Sensor Demo"                         ' setup output screen

' -----[ Program Code ]----------------------------------------------------

  DO
      GOSUB Read_Byte                           ' read switches
                                                ' report
      DEBUG CRSRXY, 0, 2, "In.... ", BIN5 i2cData
      PAUSE 100
  LOOP

END




' -----[ Subroutines - Don't change nothing here!!! ]----------------------


' -----[ High Level I2C Subroutines]---------------------------------------

' Random location read
' -- pass device slave address in "slvAddr"
' -- pass address bytes (0, 1 or 2) in "addrLen"
' -- register address passed in "devAddr"
' -- data byte read is returned in "i2cData"

Read_Byte:
  GOSUB I2C_Start                               ' send Start
  i2cWork = slvAddr | %00000001                 ' send slave ID (read)
  GOSUB I2C_TX_Byte
  GOSUB I2C_RX_Byte_Nak
  GOSUB I2C_Stop
  i2cData = i2cWork
  RETURN


' -----[ Low Level I2C Subroutines]----------------------------------------

' *** Start Sequence ***

I2C_Start:                                      ' I2C start bit sequence
  INPUT SDA
  INPUT SCL
  LOW SDA

Clock_Hold:
  DO : LOOP UNTIL (SCL = 1)                     ' wait for clock release
  RETURN


' *** Transmit Byte ***

I2C_TX_Byte:
  SHIFTOUT SDA, SCL, MSBFIRST, [i2cWork\8]      ' send byte to device
  SHIFTIN SDA, SCL, MSBPRE, [i2cAck\1]          ' get acknowledge bit
  RETURN


' *** Receive Byte ***

I2C_RX_Byte_Nak:
  i2cAck = Nak                                  ' no Ack = high
  GOTO I2C_RX

I2C_RX_Byte:
  i2cAck = Ack                                  ' Ack = low

I2C_RX:
  SHIFTIN SDA, SCL, MSBPRE, [i2cWork\8]         ' get byte from device
  SHIFTOUT SDA, SCL, LSBFIRST, [i2cAck\1]       ' send ack or nak
  RETURN


' *** Stop Sequence ***

I2C_Stop:                                       ' I2C stop bit sequence
  LOW SDA
  INPUT SCL
  INPUT SDA
  RETURN

Results: LineSensorScreenshot.png