@JvmStatic fun calculateRobotPoseError(targetFieldPose: Pose2d, currentFieldPose: Pose2d): Pose2d
Returns the error between targetFieldPose and currentFieldPose in the robot frame.