Added functions to the OccupancyGrid class to add & remove shapes from the distance field. Added support for old arm nav msgs and new moveit msgs.