double D_y;
double D_x;
- // TODO: Change time to goal on actual comp bot
double timeToGoal = 0.0;
// If the robot is moving, adjust the target position based on velocity
* @param drive The drivetrain
*/
public AcquireGamePiece(Supplier<DetectedObject> gamePiece, Drivetrain drive){
- // TODO: Replace DoNothing with next year's intake command
addCommands(new DoNothing().deadlineFor(new DriveToGamePiece(gamePiece, drive)));
}
}
\ No newline at end of file
public static final Translation3d HUB_BLUE =
new Translation3d(Units.inchesToMeters(156.8 + 20), 4.035 + .67, Units.inchesToMeters(72));
- // TODO: Update all of this
public static final Translation3d NEUTRAL_LEFT =
new Translation3d(field.getFieldLength()*0.5, field.getFieldWidth()*0.25, 0);
public static double MAX_VELOCITY = 10000000; // m/s
public static double MAX_ACCELERATION = 10000000; // m/s^2
- // TODO: FIND THE TURRET WIDTH
public static double TURRET_WIDTH = Units.inchesToMeters(6.4);
public static double TURRET_RADIUS = TURRET_WIDTH / 2;