First commit

Tested on 15 June 2014; robot consistently drives East; removed
update_heading_error()
Minor changes for debugging

Inserted debug LED, set gasbrake to neutral, mission stop on third
button press