TODO: Auton

[caojohnny]

Most recent commit from my fork has this info but I currently have the following to do:

• Figure out the PID values

• Create the auton paths to follow

• Figure out how position can be factored into the closed loop

• Actually test

• Check if Pathfinder has hardcoded the trajectory file dir

• Infinite loop may not exit for NavX init

• pidSet thread safety