Exemplo n.º 1
0
  /** 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);
  }
Exemplo n.º 2
0
 /** This function is called periodically during autonomous */
 public void autonomousPeriodic() {
   Scheduler.getInstance().run();
   // elevatorPID.safetyCheck();
   SmartDashboard.putNumber("Encoder-Value", drivetrain.encoderGet(0));
 }