Added closed loop (PID) servo gimbal control sketch