Solution

Servo controller solution