Test code for servo motors on Atmega8