Ultrasonic Rangefinder Forward till Near - ROBOTC.net

Sensing
Ultrasonic Rangefinder Forward till Near (cont.)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
void moveStraight()
{
if(SensorValue[leftEncoder] > SensorValue[rightEncoder])
{
motor[port3] = 50;
motor[port2] = 63;
}
if(SensorValue[leftEncoder] < SensorValue[rightEncoder])
{
motor[port3] = 63;
motor[port2] = 50;
}
if(SensorValue[leftEncoder] == SensorValue[rightEncoder])
{
motor[port3] = 63;
motor[port2] = 63;
}
}
}
© Carnegie Mellon Robotics Academy / For use with VEX ® Robotics Systems
9i. Copy this code
Select Edit > Copy to put the
highlighted code on the clipboard.
9j. Select File > Open and Compile
ROBOTC
9g. Open MineArmStraight
Instead of re-entering the movingstraight
code, we’ll take a copy of
it from the Encoders program.
9h. Highlight code
Find the void
moveStraight()
function and highlight it.
Ultrasonic Rangefinder • 8