added code for servo motors