\brief Return elapsed physical time.

\brief Push a new element to the buffer. * * If the buffer reached its capacity, the oldest element is overwritten. * * @param element the

\brief Rotate the given vector by the specified angle around the x-axis. * * @param v the vector to rotate * @param ang the rotation angle */

\brief Rotate the given vector by the specified angle around the y-axis. * * @param v the vector to rotate * @param ang the rotation angle */

\brief Rotate the given vector by the specified angle around the z-axis. * * @param v the vector to rotate * @param ang the rotation angle */

* Builds the index */

Frees the previously-built index. Automatically called within buildIndex(). */

\brief Returns the underlying PCL search object. \remarks This function is present only for compatibility with the old segmenters and should not be us

\brief Reset the segments ID counter to the specified ID. \param new_id Value of the next ID that will be assigned to a segment.

\brief Gets the number of segments stored in the segmented cloud. \returns Number of segments stored in the segmented cloud.

Helper function to write an Eigen::MatrixXd to a CSV file.

* Called during search to add an element matching the criteria. * @return true if the search should be continued, false if the result

direct access to data (read-only)

* Create a tree node that subdivides the list of vecs from vind[first] * to vind[last]. The routine is called recursively on each sublist.

* Initializing the Segment matching node * @param params Read from the ROS node paameters * @param num_tracks The number of robots included

Loads a previous index from a binary file. * IMPORTANT NOTE: The set of data points is NOT stored in the file, so the index object must be

Stores the index in a binary file. * IMPORTANT NOTE: The set of data points is NOT stored in the file, so when loading the index object it