Implemented functions to set the current position, speed and effort.

Implemented functions to get the target position and angle.
Completed the update() function. Servos are moving.