Finished servos.c library