removing old code
small changes to run the motor control in a PID fashion
adding declination handling to the imu service. Checked gps fix valid before integrating into the kalman filter
improving the speed computation to avoid the car to stall or to accelerate when reaching the waypoint (was previously only based on steering)
adding small description of control loop in the code