-
public class MecanumForwardKinematicsMecanum forward kinematics calculator.
Use this class to calculate field position based on the mecanum wheel motor encoders. This is an alternative to dead wheels localization for teams that don't have dead wheels.
-
-
Field Summary
Fields Modifier and Type Field Description private final Pose2DcurrentPose
-
Constructor Summary
Constructors Constructor Description MecanumForwardKinematics(MecanumKinematicsParams mecanumParams, Pose2D initialPose)
-
Method Summary
Modifier and Type Method Description voidsetCurrentPose(Pose2D currentPose)PoseAndVelocitygetPositionVelocity()voidsetCurrentValues(Pose2D currentPose, int flPosition, int frPosition, int rlPosition, int rrPosition)voidupdate(int flPosition, int frPosition, int rlPosition, int rrPosition)-
-
Constructor Detail
-
MecanumForwardKinematics
MecanumForwardKinematics(MecanumKinematicsParams mecanumParams, Pose2D initialPose)
-
-
Method Detail
-
setCurrentPose
void setCurrentPose(Pose2D currentPose)
-
getPositionVelocity
PoseAndVelocity getPositionVelocity()
-
setCurrentValues
void setCurrentValues(Pose2D currentPose, int flPosition, int frPosition, int rlPosition, int rrPosition)
-
update
void update(int flPosition, int frPosition, int rlPosition, int rrPosition)
-
-
-
-