C code for avr microcontrollers that controls an arm by a servo to move forward to give a high five