Function p3p::nordberg::error

pub fn error(point_3d: &[f32; 3], bearing_vector: &[f32; 3], pose: &Pose) -> f32

Compute the angular residual between the bearing vector and the 3D point projection vector. Return 1 - cos(angle).