diff --git a/Larry/commands/drive_by_joystick.py b/Larry/commands/drive_by_joystick.py index 6826b72..a7e4628 100644 --- a/Larry/commands/drive_by_joystick.py +++ b/Larry/commands/drive_by_joystick.py @@ -28,6 +28,9 @@ def execute(self) -> None: self.direction = conversions.Conversions.convertJoystickInputToDegrees(conversions.Conversions.deadband(self.leftx(), constants.kdeadband), conversions.Conversions.deadband(self.lefty(), constants.kdeadband)) + # field concentric + self.direction -= self.drive.gyro.get() + wpilib.SmartDashboard.putNumber(" direction - ", self.direction) wpilib.SmartDashboard.putNumber(" speed - ", self.magnitude) wpilib.SmartDashboard.putNumber(" turn power - ", self.turnPower())