Added PID classes for the longitudinal controller. Moved the set-point variables outside the loop
Conformed the longitudinal PID controllers to the new PID constructor signature
Merge branch 'Longitudal_Controls'