* @brief Adds a node to the graph of visited nodes. * @param index The index of the node in the graph. * @return A pointer to the added node. */

* @brief Add a node to the open set * @param cost The cost to sort into the open set of the node * @param node Node pointer reference to add to open

retrieve the alternatively pruned diagram. see updateAlternativePrunedDiagram()

* Compute the complement of the angle with respect to 2*pi. * @param angle Angle in radians. * @return Complement angle in radians. */

* @brief Calculate the smallest angular difference between two angles. * @param angle_1 The starting angle in radians. * @param angle_2 The ending a

* @brief angular velocity regularization * @param w_in raw angular velocity * @param w_d desired angular velocity * @return w regulated angul

Applies common styles which apply to person visuals, such as line width etc.

* @brief Given a set of N data points, D0, D1, ..., Dn, a degree k, and a number H, where N > H > k >= 1, * find a B-spline curve of degree k defi

* @brief Backtraces from the given node to reconstruct the path. * @param node The final node in the path. * @param path The reconstructed path cons

* @brief Calculate base function using Cox-deBoor function. * @param i The index of base function * @param k The degree of curve * @par

* @brief Calculate the Bezier curve point. * @param t scale factor * @param control_pts control points * @return point point in Bezier curve with t

* @brief Generate the path. * @param k The degree of curve * @param knot The knot vector * @param control_points The cont

* @brief Re-builds k-d tree * @param points set of points */

* @brief Calculate the value of fitness function * @param position the control points calculated by PSO * @return fitness the value of fitness func

* @brief Calculate the value of fitness function * @param position the control points calculated by PSO * @return fitness the value of fitness func

* @brief Calculate the value of fitness function * @param position the control points calculated by PSO * @return fitness the value of fitness func

Calculates the points on a rotated ellipse given by center xc, yc, half axes a, b and angle phi. Returns number of points np and points in Cart. coord

Calculates the points on a 95%-iso-probability ellipse given by the bivarate RV with mean xc, yc and covariance matrix sxx, syy, sxy. Returns number o

Calculates the points on a 99%-iso-probability ellipse given by the bivarate RV with mean xc, yc and covariance matrix sxx, syy, sxy. Returns number o

* @brief Calculate the key of s * * @param s LNode pointer * @return the key value */

* @brief Calculate the key of s * @param s LNode pointer * @return the key value */

* This function is used when other strategies are to be applied, * but the cost functions for obstacles are to be reused. */

* @brief Clear graph of nodes searched */

* @brief Clear heuristic queue of nodes to search */

* @brief Main process of D* lite */

* @brief Main process of LPA* */

* @brief Given the current position, orientation, and velocity of the robot, compute the * velocity commands * @param cmd_vel will be filled with th

* @brief Given the current position, orientation, and velocity of the robot, compute the * velocity commands * @param cmd_vel will be filled with th

* @brief Static commands * @param cmd_vel will be filled with the velocity command to be passed to the robot base * @return true if a valid traject

* @brief Given the current position, orientation, and velocity of the robot, compute the * velocity commands * @param cmd_vel will be filled with th

* @brief Given the current position, orientation, and velocity of the robot, compute the * velocity commands * @param cmd_vel will be filled with th

* @brief Given the current position, orientation, and velocity of the robot, compute the * velocity commands * @param cmd_vel will be filled with th

Rotate the position (xyz) part of a pose covariance matrix into the fixed frame used for visualization The covariance matrix needs to be transformed f

Create human element of world file. Parameters ---------- config: dict configure dat

* @brief Creates a path between the start and goal points while expanding nodes. * @param start The starting node in (x, y, theta). * @param goal

Create a visual representation of the person itself, if not set yet

* @brief Create and configure planner * @param nh ROS node handler * @param costmap_ros costmap ROS wrapper * @param planner_props planner property

* @brief Extract the expanded Nodes (CLOSED) * @param expand expanded Nodes in vector */

* @brief Extract path for map * @param start start node * @param goal goal node */

* @brief Extract path for map * * @param start start node * @param goal goal node * @return flag true if extract successfully else do not */

* @brief Extract path for map * * @param start start node * @param goal goal node * @return flag true if extract successfully else do not */

* @brief factorial calculation * @param n number * @return n! */

Update position of deleted tracks (because they are not being updated by ROS messages any more)

We are using this FrameListener callback to orient the mesh towards the camera. Using a SceneManager::Listener and its preUpdateSceneGraph(SceneManage

* Convert degrees to radians. * @param degrees Angle in degrees. * @return Angle in radians. */

* @brief Generate the path. * @param start Initial pose (x, y, yaw) * @param goal Target pose (x, y, yaw) * @param path The smoothed trajectory p

* @brief Generate the path. * @param start Initial pose (x, y, yaw) * @param goal Target pose (x, y, yaw) * @param path The smoothed trajectory p

* @brief Generate the path. * @param start Initial pose (x, y, yaw) * @param goal Target pose (x, y, yaw) * @param path The smoothed trajectory p

* @brief Generate the path. * @param start Initial pose (x, y, yaw) * @param goal Target pose (x, y, yaw) * @param path The smoothed trajectory p