Add simple Sodar class and loop
Fix formatting
Add loop for LED robot in another file
Fix spacing, make robot functionality based on definitions
Only limit main loop to just SODAR or LED for now
cleaner output on debug
added first draft of driving code to sodar
Merge pull request #1 from tlunter/add_sodar

Add SODAR