Function slam_mer::utils::__compute_query_vector

Function Documentation

Eigen::Vector3d slam_mer::utils::__compute_query_vector(const point3d_t &point3d_, const pose_t &pose_)

Computes the query vector from the point and pose. The query vector is the normalized vector from the point to the camera center in world coordinates.

Parameters:
  • point3d_ – The 3D point for which to compute the query vector.

  • pose_ – The pose of the camera observing the point.

Returns:

The normalized query vector from the point to the camera center in world coordinates.