/** * Kills other robots * * @param programm Current program running */ public void killThemAll(String program) { if (program == "") { drive.moveForward(drive.maxSpeed()); Delay.msDelay(TIME_TO_DESTRUCT); } }
public Collision( boolean destructionMode, Drive drive, EV3TouchSensor leftSensor, EV3TouchSensor rightSensor, EV3UltrasonicSensor sonicSensor) { this.drive = drive; this.leftSensor = leftSensor; this.rightSensor = rightSensor; this.sonicSensor = sonicSensor; speed = drive.maxSpeed(); collision = "none"; terminateCollisionEstimation = false; this.destructionMode = destructionMode; }
private void elevatorCollision() { LCD.clear(); LCD.drawString("Collision: " + collision, 0, 4); Delay.msDelay(3000); float[] dist = new float[sonicSensor.getDistanceMode().sampleSize()]; sonicSensor.getDistanceMode().fetchSample(dist, 0); if ((dist[0] - DISTANCE_TO_WALL) > 0.005) { drive.turnRight(5, false); } else { drive.turnLeft(5, false); } if (collision == "Wall") { drive.stop(); } else if (collision == "Left Wall") { drive.turnRight(5, false); } else if (collision == "Right Wall") { drive.moveDistance(drive.maxSpeed(), -2); drive.turnLeft(20, false); } }