Page 24 · SumoBot – Mini Sumo Robotics
After the QTI is activated, the capacitor is discharged by bringing the R line high and
holding it for about one millisecond.
RCTIME is then used to measure the time required
to charge the capacitor to a specified level. This timing will be controlled by the current
flow through the phototransistor side of the QRD1114. When over the black playing
field, the phototransistor current flow will be very low so the capacitor will take a long
time to charge, hence
RCTIME will return a large value. When the QTI is positioned over
the white border line, the current flow through the phototransistor is high, so the capacitor
charge time is fast and RCTIME returns a small value.
Load and run program 3.1 to test and evaluate the QTI sensors.
' SumoBot_3.1_Line_Sensor_Test.BS2
' {$STAMP BS2}
' {$PBASIC 2.5}
' -----[ I/O Definitions ]-------------------------------------------------
LLinePwr PIN 10 ' left line sensor power
LLineIn PIN 9 ' left line sensor input
RLinePwr PIN 7 ' right line sensor power
RLineIn PIN 8 ' right line sensor input
' -----[ Variables ]-------------------------------------------------------
lLine VAR Word ' left sensor raw reading
rLine VAR Word ' right sensor raw reading
' -----[ Program Code ]----------------------------------------------------
Main:
DO
GOSUB Read_Left
GOSUB Read_Right
DEBUG HOME,
"Left ", TAB, "Right", CR,
"-----", TAB, "-----", CR,
DEC lLine, CLREOL, TAB, DEC rLine, CLREOL
PAUSE 100
LOOP
END
' -----[ Subroutines ]-----------------------------------------------------
To Next Page
Loading...
Need help?
General