realizzazione sketc robot ultrasuoni e servomotori

Salve a tutti premetto che sono un neofita e sto realizzando un robot con due servo 360 parallax per le ruote , un sensore ad ultrasuoni ed una pinza meccanica con due motori dc

sto riscontrando qualche piccola difficoltà per lo sviluppo del software e vorrei sapere se il mio scatch può essere migliorato,reso più snello o modificare qualcosa
e vorrei sapere inoltre fare a programmare il pulsante + led che ho installato per fare partire il programma
e premendo di nuovo farlo fermare con rispettivo led acceso o spento

grazie a tutti

lo scatch è questo:

sketch_robot_silvio.ino (2.1 KB)

Devi dirci:

  • che tipo di Arduino stai usando
  • come hai collegato i servo all'Arduino
  • che cosa vuoi fare esattamente (IN ITALIANO)
    esempio (per ora senza pulsante):
    Appena accendo Arduino

LOOP
RILEVO distanza
SE distanza > minimo
SERVO1 avanti
SERVO2 avanti
ALTRIMENTI
SERVO1 fermo
SERVO2 avanti

Queste istruzioni fanno procedere il robot o lo fanno curvare fino a trovare strada libera. Se non la trova continuerà a girare in cerchio.

È questo che vuoi fare (più pulsante)?

Ciao,
P.