Added documentation for ping sensor class
Wrote basic main real time loop and re-implemented PID class.