Ejemplo 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);
  }
Ejemplo n.º 2
0
 public void teleopInit() {
   // This makes sure that the autonomous stops running when
   // teleop starts running. If you want the autonomous to
   // continue until interrupted by another command, remove
   // this line or comment it out.
   openLog("tele");
   if (autonomousCommand != null) autonomousCommand.cancel();
   elevatorPID.brakeOn();
   print("starting teleop...");
 }
Ejemplo n.º 3
0
 public void disabledInit() {
   if (log != null) log.close();
   elevatorPID.brakeOn();
   setupChooser();
 }