DRAFT

ROB-68989

В роботе используется: мотора с кастомными редукторами для передвижения, 2 колеса напечатанных на 3d принтере, полиуретановые насадки для улучшения сцепления с полигоном, сепаратор на моторе NXT, 2 щетки соединенных с помощью угловой передачи, REV COntrol HUB, дверца для выгрузки шайб на сервомоторе, ряд зубьев напечатанных на 3d принтере для удержания шайб, public class 

пример сортировки для сепаратора:Bread extends LinearOpMode {
   private void drive(double speed, double rotate){
       Devices.RightDrive.setPower(speed + rotate);
       Devices.LeftDrive.setPower(speed - rotate);
   }

   private int _pos = 0;
   private ElapsedTime _separatorTime = new ElapsedTime();

   private void updateSeparator(){
       if(_separatorTime.seconds() > Configs.Intake.PuckDetectDelaySec) {
           double puckDetect = Devices.PuckSensor.getVoltage();

           if (Math.abs(puckDetect - Configs.Intake.RedVoltage) < Configs.Intake.PuckDetectSensitivity) {
               _pos += Configs.Intake.Shift;
               Devices.SeparatorMotor.setTargetPosition(_pos);
               _separatorTime.reset();
           } else if (Math.abs(puckDetect - Configs.Intake.BlueVoltage) < Configs.Intake.PuckDetectSensitivity) {
               _pos -= Configs.Intake.Shift;
               Devices.SeparatorMotor.setTargetPosition(_pos);
               _separatorTime.reset();
           }
       }
   }