// Called repeatedly when this Command is scheduled to run
protected void execute() {
angle = gyro.getAngle();
Robot.drivetraintalon.driveArcade(power, -angle * Kp);
}
// Called just before this Command runs the first time
protected void initialize() {
gyro.reset();
// setTimeout(SmartDashboard.getNumber("DTS:time after turn", 3));
}