Added initial copy of PID Controller
Wrote new PID Controller. Wrote documentation on how PIDController works within PIDController.c