Lab 6c (servo control)