Started working on PID controller.
Minor work on EA algorithm