- c -

• check_equality() : sbpl_math.h , sbpl_math.cpp
• check_joint_limits() : pr2_workspace.cpp , pr2_workspace.h
• check_joint_limits_and_append_joint_angles() : pr2_workspace.h , pr2_workspace.cpp
• create_rotation_matrix() : sbpl_math.h , sbpl_math.cpp
• cross_product() : sbpl_math.cpp , sbpl_math.h

- d -

• distance_between() : sbpl_math.h , sbpl_math.cpp
• dot_product() : sbpl_math.cpp , sbpl_math.h

- e -

• elbow_positions_given_endeff_pose() : pr2_workspace.h , pr2_workspace.cpp
• elbow_positions_given_pan() : pr2_workspace.h , pr2_workspace.cpp
• equate() : sbpl_math.cpp , sbpl_math.h

- g -

• get_bresenham3d_parameters() : bresenham.h , bresenham.cpp
• get_current_point3d() : bresenham.cpp , bresenham.h
• get_next_point3d() : bresenham.h , bresenham.cpp
• grid2world() : pr2_workspace.cpp , pr2_workspace.h

- m -

• main() : plan_path.cpp , plan_path_test.cpp , run_bfs_3d.cpp
• matrix_add() : sbpl_math.cpp , sbpl_math.h
• multiply() : sbpl_math.h , sbpl_math.cpp

- p -

• planRobarm() : plan_path.cpp , plan_path_test.cpp
• position() : pr2_workspace.cpp , pr2_workspace.h
• PrintUsage() : plan_path_test.cpp , plan_path.cpp

- r -

• rotate_vector() : sbpl_math.h , sbpl_math.cpp

- s -

• scalar_multiply() : sbpl_math.h , sbpl_math.cpp
• separate_rejected_points() : pr2_workspace.cpp , pr2_workspace.h
• subtract() : sbpl_math.cpp , sbpl_math.h

- t -

• transpose() : sbpl_math.h , sbpl_math.cpp

- v -

• vect_divide() : sbpl_math.h , sbpl_math.cpp
• vect_norm() : sbpl_math.h , sbpl_math.cpp

- w -

• world2grid() : pr2_workspace.h , pr2_workspace.cpp

- x -

• xyzCompare() : environment_robarm3d.cpp