gesture raspi servo_main.c revised