Using speed for control gain reduction
Merge remote-tracking branch 'origin/GPS_Included' into GPS_Included