calculateRobotPoseError

public final static Pose2d calculateRobotPoseError(Pose2d targetFieldPose, Pose2d currentFieldPose)

Returns the error between targetFieldPose and currentFieldPose in the robot frame.