Little more work on simulator.
Merge branch 'master' of https://github.com/dgitz/icarus_drone_server
Worked on code for automatic movements for slam registration.