/** This function is called periodically during operator control */
public void teleopPeriodic() {
Scheduler.getInstance().run();
SmartDashboard.putNumber("Encoder-Value", drivetrain.encoderGet(0));
// SmartDashboard.putNumber("Timer", System.currentTimeMillis() - time);
elevatorPID.safetyCheck();
claw0PID.safetyCheck();
elevatorPID.showPosition();
SmartDashboard.putNumber("Encoder-Value", drivetrain.encoderGet(0));
SmartDashboard.putNumber("Selected Floor", Robot.elevatorPID.getSelectedFloor());
SmartDashboard.putBoolean("Compensation On?", Robot.elevatorPID.isCompSelected());
// camera stuff
// camera.getImage(frame);
// CameraServer.getInstance().setImage(frame);
}
/** This function is called periodically during autonomous */
public void autonomousPeriodic() {
Scheduler.getInstance().run();
// elevatorPID.safetyCheck();
SmartDashboard.putNumber("Encoder-Value", drivetrain.encoderGet(0));
}