forked from https://kforge.ros.org/armnavigation/armnavigation