KThree Wheel Odometry
fun KThreeWheelOdometry( leftEnc: KEncoder, rightEnc: KEncoder, perpEnc: KEncoder, TRACK_WIDTH: Double, PERP_OFFSET: Double, startPose: Pose)
Content copied to clipboard
Secondary constructor. Uses TRACK_WIDTH to calculate LEFT_OFFSET and RIGHT_OFFSET. Assumes that the parallel pods are dispersed evenly.
Parameters
TRACK_WIDTH
Distance betwee the parallel odo pods.
fun KThreeWheelOdometry( leftEnc: KEncoder, rightEnc: KEncoder, perpEnc: KEncoder, LEFT_OFFSET: Double, RIGHT_OFFSET: Double, PERP_OFFSET: Double, startPose: Pose)
Content copied to clipboard
Parameters
left Enc
Left encoder
right Enc
Right encoder
perp Enc
Perp encoder
LEFT_OFFSET
Y offset of the left odo pod from (0,0)
RIGHT_OFFSET
Y offset of the right odo pod from (0,0)
PERP_OFFSET
X offset of the perp odo pod from (0,0)