Refactor velocity into separate class and change some of the member variables to make more sense with speeds
Skeleton code for Imu and Thrusters