changes for autonomous code

autonomous near almost working, need to tweak for all baskets