Indigo

Ported the simulator to work on indigo with gazebo 2.2.

This may be better located on a different "indigo" branch.