Skip to content

Instantly share code, notes, and snippets.

@ringodin
Created March 11, 2019 12:20
Show Gist options
  • Star 0 You must be signed in to star a gist
  • Fork 0 You must be signed in to fork a gist
  • Save ringodin/06f51af233be3fa1bd4a55b8923a21f2 to your computer and use it in GitHub Desktop.
Save ringodin/06f51af233be3fa1bd4a55b8923a21f2 to your computer and use it in GitHub Desktop.
this is for solving bball drills up in room 4030, robotown HS
#pragma config(Motor, motor1, leftMotor, tmotorVexIQ, openLoop, encoder)
#pragma config(Motor, motor6, rightMotor, tmotorVexIQ, openLoop, reversed, encoder)
task main()
{
resetMotorEncoder(leftMotor);
resetMotorEncoder(rightMotor);
moveMotorTarget(leftMotor, 540, 75);
moveMotorTarget(rightMotor, 540, 75);
waitUntilMotorStop(leftMotor);
waitUntilMotorStop(rightMotor);
wait1Msec(500);
resetMotorEncoder(leftMotor);
resetMotorEncoder(rightMotor);
moveMotorTarget(leftMotor, -540, -75);
moveMotorTarget(rightMotor, -540, -75);
waitUntilMotorStop(leftMotor);
waitUntilMotorStop(rightMotor);
wait1Msec(500);
resetMotorEncoder(leftMotor);
resetMotorEncoder(rightMotor);
moveMotorTarget(leftMotor, 1245, 75);
moveMotorTarget(rightMotor, 1245, 75);
waitUntilMotorStop(leftMotor);
waitUntilMotorStop(rightMotor);
wait1Msec(500);
resetMotorEncoder(leftMotor);
resetMotorEncoder(rightMotor);
moveMotorTarget(leftMotor, -1245, -75);
moveMotorTarget(rightMotor, -1245, -75);
waitUntilMotorStop(leftMotor);
waitUntilMotorStop(rightMotor);
wait1Msec(500);
}
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment