Add servo motor control.

Use the data from gyroscope to control the direction of servo motors.