* @brief Some structured light sensors produce invalid measurements in the first few columns, setting these to zero */

* @brief Crop the depth image to given rectangle */

* @brief If plan failed replan is called when replanning is enabled */

* @brief Reset all stats */

* @brief Reset all stats */

* @brief Score node */

* @brief Get all required parameters from configuration */

* @brief Set the current path */

* @brief Set the current robot pose. Goal distances greater than GoalDistancecutoff will be clipped to max value */

* @brief Properly set wheel orinetation in the first node for visualization */

* @brief Pre-calculate fixed values */

* @brief calculate values which are not set manually */

* @brief Calculate distance from a point to a path segment */

Declare a test