changed unsigned long to double for better precision
fixed incorrect type definitions that should have been fixed in last commit
added history based driving
Clean up turning, don't ruin old turning functions
Merge pull request #2 from tlunter/add_sodar

add history to sonar for differential-based turning