Added closed loop (PD) servo gimbal control sketch