Solved a bug in the get_servo_angle() function: the registers address for the...

Solved a bug in the get_servo_angle() function: the registers address for the desired servo was not generated properly.
Solved a bug in the interpretation of negatives values of the current servo angles.