Dual Semaphore Servo Controller