GRITS ROS utility package (i.e. useful math, robotics, etc. programs and scripts)