Added support for footprint from rosparam.  Test currently crashing.