Merge branch 'master' into feature/sensor_fusion
Merge branch 'feature/sensor_fusion' of https://github.com/christofferholmstedt/naiad-auv-software into feature/sensor_fusion