added PrintMsg to debug autonomous