Sunteți pe pagina 1din 5

#pragma config(StandardModel, "Clawbot IQ With Sensors")

//*!!Code automatically generated by 'ROBOTC' configuration wizard !!*//

task main()

// TOPIC 1: GYRO SENSOR

// 1. TURN RIGHT 90 DEGREES

resetGyro (gyroSensor);

wait (2, seconds);

setMotorSpeed (rightMotor, -50);

setMotorSpeed (leftMotor, 50);

waitUntil (getGyroDegrees (gyroSensor) <= -90);

setMotorSpeed (rightMotor, 0);

setMotorSpeed (leftMotor, 0);

// 2. TURN LEFT 90 DEGREES

resetGyro (gyroSensor);

wait (2, seconds);

setMotorSpeed (rightMotor, 50);

setMotorSpeed (leftMotor, -50);

waitUntil (getGyroDegrees (gyroSensor) >= 90);

setMotorSpeed (rightMotor, 0);

setMotorSpeed (leftMotor, 0);

// TOPIC 2. COLOR SENSOR - if and if/Else Conditions and statement

// EXAMPLE COLOR SENSOR, GYRO SENSOR AND IF/ELSE CONDITIONS AND


STATEMENTS
forward (3, rotations, 50);

if (getColorName (colorDetector) == colorOrange);

resetGyro (gyroSensor);

wait (2, seconds);

setMotorSpeed (rightMotor, -50);

setMotorSpeed (leftMotor, 50);

waitUntil (getGyroDegrees (gyroSensor) <= -90);

setMotorSpeed (rightMotor, 0);

setMotorSpeed (leftMotor, 0);

else

resetGyro (gyroSensor);

wait (2, seconds);

setMotorSpeed (rightMotor, 50);

setMotorSpeed (leftMotor, -50);

waitUntil (getGyroDegrees (gyroSensor) >= 90);

setMotorSpeed (rightMotor, 0);

setMotorSpeed (leftMotor, 0);

//TOPIC 3: DISTANCE SENSOR

// 1. MOVE UNTIL NEAR - PARAMETER

setMotorSpeed (rightMotor, -50);

setMotorSpeed (leftMotor, -50);


waitUntil (getDistanceValue (distanceMM) < 90);

setMotorSpeed (rightMotor, 0);

setMotorSpeed (leftMotor, 0);

// EXAMPLE MOVE UNTIL NEAR

setMultipleMotors (50, rightMotor, leftMotor);

if (getDistanceValue (distanceMM <= 100));

resetGyro (gyroSensor);

wait (2, seconds);

setMotorSpeed (rightMotor, 50);

setMotorSpeed (leftMotor, -50);

waitUntil (getGyroDegrees (gyroSensor) >= 90);

setMotorSpeed (rightMotor, 0);

setMotorSpeed (leftMotor, 0);

// 2. MOVE UNTIL FAR

setMotorSpeed (rightMotor, 50);

setMotorSpeed (leftMotor, 50);

waitUntil (getDistanceValue (distanceMM) >90);

setMotorSpeed (rightMotor, 0);

setMotorSpeed (leftMotor, 0);

// EXAMPLE MOVE UNTIL FAR

setMultipleMotors (50, rightMotor, leftMotor);


if (getDistanceValue (distanceMM) > 300);

resetGyro (gyroSensor);

wait (2, seconds);

setMotorSpeed (rightMotor, -50);

setMotorSpeed (leftMotor, 50);

waitUntil (getGyroDegrees (gyroSensor) <= 90);

setMotorSpeed (rightMotor, 0);

setMotorSpeed (leftMotor, 0);

//TOPIC 4: BUMPER SWITCH -

// 0 - not pressed

// 1 - pressed

setMotorSpeed (rightMotor, 50);

setMotorSpeed (leftMotor, 50);

waitUntil (getBumperValue(bumpSwitch) == 1);

setMotorSpeed (rightMotor, 0);

setMotorSpeed (leftMotor, 0);

// EXAMPLE BUMPER SWITCH

setMultipleMotors (50, rightMotor, leftMotor);

if (getBumperValue (bumpSwitch)== 1);

resetGyro (gyroSensor);
wait (2, seconds);

setMotorSpeed (rightMotor, -50);

setMotorSpeed (leftMotor, 50);

waitUntil (getGyroDegrees (gyroSensor) <= -90);

setMotorSpeed (rightMotor, 0);

setMotorSpeed (leftMotor, 0);

S-ar putea să vă placă și