--First draft of auto-driving logic complete.  Committing before cleaning up old comments and adding Kalman code into the-force.