added servo code and library