It's alive !!!!!

Adding the integral and derivative controls, some gain adjustments through hit and trial and here we go......

Quite jerky, but it's an achievement ! Weeeeeeeeeee :D ok, back to work now !