Updates and bug fixes

Added check for gps lock, current speed and tx interval