Adesso mi funziona anche solo con l'Arduino Mega ADK,
ho levato l'inizializzazione del joistick, che non c'e, che bloccava il codice.
........
init_leds();
init_relays();
init_buttons();
//init_joystick( 5 );
// autocalibrate OFF
touch_robot.set_CS_AutocaL_Millis(0xFFFFFFFF);
servos[0].attach(SERVO1);
servos[0].write(90);
........