Working version. Problem was not with the code, but with BT/Linux. Once I removed the modemmanager package things started working. Vehicle1 will move the bot until it gets too close to an object