advancements on autonomous

still having problems with driving straight- otherwise it would be too
easy.