com.acmerobotics.roadrunner.localization

Class ThreeTrackingWheelLocalizer

com.acmerobotics.roadrunner.localization.ThreeTrackingWheelLocalizer

All Implemented Interfaces:

Localizer

public class ThreeTrackingWheelLocalizer
implements Localizer

Localizer based on three unpowered tracking omni wheels.

Constructor Detail

ThreeTrackingWheelLocalizer

public ThreeTrackingWheelLocalizer(@NotNull
                                   java.util.List<com.acmerobotics.roadrunner.geometry.Pose2d> wheelPoses)

Localizer based on three unpowered tracking omni wheels.

Parameters:

wheelPoses - wheel poses relative to the center of the robot (positive X points forward on the robot)

Method Detail

getPoseEstimate

@NotNull
public Pose2d getPoseEstimate()

Current robot pose estimate.

setPoseEstimate

public void setPoseEstimate(@NotNull
                            Pose2d value)

Current robot pose estimate.

getPoseVelocity

@Nullable
public Pose2d getPoseVelocity()

Current robot pose velocity (optional)

setPoseVelocity

public void setPoseVelocity(@Nullable
                            Pose2d p)

Current robot pose velocity (optional)

update

public void update()

Completes a single localization update.

getWheelPositions

@NotNull
public java.util.List<java.lang.Double> getWheelPositions()

Returns the positions of the tracking wheels in the desired distance units (not encoder counts!)

getWheelVelocities

@Nullable
public java.util.List<java.lang.Double> getWheelVelocities()

Returns the velocities of the tracking wheels in the desired distance units (not encoder counts!)