def drive_wait(self): self.navx.reset() self.gameData2 = self.sd.getString("gameData2", "No Data") if self.gameData2 == "Right": StatefulAutonomous.next_state(self, name='right_drive_forward') elif self.gameData2 == "Left": StatefulAutonomous.next_state(self, name='left_drive_forward') self.drive.arcadeDrive(0, 0, squaredInputs=False)
def drive_wait(self): self.navx.reset() self.gameData1 = self.sd.getString("gameData1", "No Data") if self.gameData1 == "Left": StatefulAutonomous.next_state(self, name='switch_drive_forward') else: StatefulAutonomous.next_state(self, name='cross_the_line') self.drive.arcadeDrive(0, 0, squaredInputs=False) self.intakeRight.set(0) self.intakeLeft.set(0) self.actuator.set(0)
def drive_wait(self): self.navx.reset() self.gameData1 = self.sd.getString("gameData1", "No Data") if self.gameData1 == "Right": StatefulAutonomous.next_state(self, name='right_rotate') elif self.gameData1 == "Left": StatefulAutonomous.next_state(self, name='left_rotate') self.drive.arcadeDrive(0, 0, squaredInputs=False) self.elevator.set( ctre.ControlMode.Position, int(round(self.drivePosition * self.encoderTicksPerInch))) self.intakeRight.set(0) self.intakeLeft.set(0) self.actuator.set(0)
def drive_wait(self): self.gameData1 = self.sd.getString("gameData1", "No Data") self.gameData2 = self.sd.getString("gameData2", "No Data") self.data = self.gameData.getGameSpecificMessage() if self.data[1] == "L": StatefulAutonomous.next_state(self, name='scale_drive_forward') elif self.data[0] == "L": StatefulAutonomous.next_state(self, name='switch_drive_forward') else: StatefulAutonomous.next_state(self, name='cross_the_line') self.drive.arcadeDrive(0.5, self.navx.drive(0.15, 0.5, -5), squaredInputs=False) self.intakeRight.set(0) self.intakeLeft.set(0) self.actuator.set(0)
def on_iteration(self, tm): self.sensors.update() return StatefulAutonomous.on_iteration(self, tm)
def on_enable(self): StatefulAutonomous.on_enable(self) self.angle_ctrl.reset_angle()
def on_enable(self): StatefulAutonomous.on_enable(self)