Added gps logging, and fixed connection for velocity output