If you are working with ROS, have a look here