Hi everyone this is my first year programming in First Robotics and I need some help programming a gyro in autonomus. My goal is to have our bot drive forward and make a sudden 90 degree turn. I have figured out how to make a sudden turn however, the bot does not stop and it continues to spin. Any help would be greatly appreciated.
Here's my code:
Code:
public void autonomous() {
while (isAutonomous() && isEnabled()) {
SmartDashboard.putNumber(" angle " , gyro1.getAngle());
double angle = gyro1.getAngle() + 90;
//robot.drive(-0.15, angle * Kp); this is for driving straight
robot.drive(-0.10, angle / 30); // the turn
gyro1.reset();
if(angle < 90) {
robot.stopMotor();
}
}
}