fix vision publish bugs and add drive to balls code