abstract class ThreeTrackingWheelLocalizer : Localizer
Localizer based on three unpowered tracking omni wheels.
wheelPoses - wheel poses relative to the center of the robot (positive X points forward on the robot)
ThreeTrackingWheelLocalizer(wheelPoses: List<Pose2d>)
Localizer based on three unpowered tracking omni wheels. |
open var poseEstimate: Pose2d
Current robot pose estimate. |
abstract fun getWheelPositions(): List<Double>
Returns the positions of the tracking wheels in the desired distance units (not encoder counts!) |
|
open fun update(): Unit
Completes a single localization update. |