Created branch for groovy. Added some small functions to utils.
Added functions for working with RPY
Added functions for reading/writing Vector3d points to a file.
Upgraded mesh utils to work with the newer version "moveit version" of the geometric_shapes package.
Adding files that do easy reading and writing of STL files.
NOTE: Reading of STL files is done inefficiently. It makes many copies of the same vertex.
Added functions for reading from binvox files, converting between ROS and system paths
Added comments
Added functions for writing ASCII versions of STL files. Overall the stl.h set of functions are still experimental.
Added functions to get scale from collada file, get extension of filename etc
Added functions for get a folder's contents as a list of strings, and getting the time
Added function to get link mesh
Added back in missing CELL3V
Removed some debug output
Fixed getPoseViz, added function for replacing joint position in a sensor_msgs::JointState msg
Added getString() for ints.
Added some conversion utils. They aren't great.
Added param for getting joint limits to choose between safety & hard if both are available.
Added function to convert vector path to JointTrajectory. It should really also take in a vector of strings to be used as joint names.
Added functions to get markers for Arrows and Axes
Added function to print pose vector