added set angle limit for servo function and fixed some stuff