Wireless Commands Work

Also added some starter code for going towards a point. Haven't tested
it yet