PedroPathing/com.pedropathing.localization.localizers/DriveEncoderLocalizer

DriveEncoderLocalizer

public class DriveEncoderLocalizer extends Localizer

This is the DriveEncoderLocalizer class. This class extends the Localizer superclass and is a localizer that uses the drive encoder set up.

Author

Anyi Lin - 10158 Scott's Bots

Constructors

DriveEncoderLocalizer

public void DriveEncoderLocalizer(HardwareMap map)

This creates a new DriveEncoderLocalizer from a HardwareMap, with a starting Pose at (0,0) facing 0 heading.

public void DriveEncoderLocalizer(HardwareMap map, Pose setStartPose)

This creates a new DriveEncoderLocalizer from a HardwareMap and a Pose, with the Pose specifying the starting pose of the localizer.

Properties

FORWARD_TICKS_TO_INCHES

public static double FORWARD_TICKS_TO_INCHES

ROBOT_LENGTH

public static double ROBOT_LENGTH

ROBOT_WIDTH

public static double ROBOT_WIDTH

STRAFE_TICKS_TO_INCHES

public static double STRAFE_TICKS_TO_INCHES

totalHeading

public double totalHeading

TURN_TICKS_TO_RADIANS

public static double TURN_TICKS_TO_RADIANS

Functions

getForwardMultiplier

public double getForwardMultiplier()

This returns the multiplier applied to forward movement measurement to convert from encoder ticks to inches.

getIMU

public IMU getIMU()

This is overridden to return the IMU, if there is one.

getLateralMultiplier

public double getLateralMultiplier()

This returns the multiplier applied to lateral/strafe movement measurement to convert from encoder ticks to inches.

getPose

public Pose getPose()

This returns the current pose estimate.

getRobotDeltas

public Matrix getRobotDeltas()

This calculates the change in position from the perspective of the robot using information from the Encoders.

getTotalHeading

public double getTotalHeading()

This returns how far the robot has turned in radians, in a number not clamped between 0 and 2 * pi radians.

getTurningMultiplier

public double getTurningMultiplier()

This returns the multiplier applied to turning movement measurement to convert from encoder ticks to radians.

getVelocity

public Pose getVelocity()

This returns the current velocity estimate.

getVelocityVector

public Vector getVelocityVector()

This returns the current velocity estimate.

isNAN

public boolean isNAN()

This returns whether if any component of robot's position is NaN.

resetEncoders

public void resetEncoders()

This resets the Encoders.

resetIMU

public void resetIMU()

This does nothing since this localizer does not use the IMU.

setPose

public void setPose(Pose setPose)

This sets the current pose estimate.

setPrevRotationMatrix

public void setPrevRotationMatrix(double heading)

This sets the Matrix that contains the previous pose's heading rotation.

setStartPose

public void setStartPose(Pose setStart)

This sets the start pose.

update

public void update()

This updates the elapsed time timer that keeps track of time between updates, as well as the change position of the Encoders.

updateEncoders

public void updateEncoders()

This updates the Encoders.