Change Gazebo messages to use proper types

[Agustin Alba Chicar]

Waypoints ids are being passed around as floats. We must use the correct types for the messages to avoid future bugs in comparisons and conversions of types. It's also a good opportunity to deprecate Gazebo math and messages, and switch to Ignition (looking forward to Gazebo 8).