Add rviz config and launch
Expand footprint for simulation

Not quite sure why, but this matches the collision model that the
simulator uses. The planner gets stuck far less frequently