attempt to calculate variable speed and make better turning decisions

NOT WORKING!!