Hallo,

ich habe mir einen Hexapod gebaut, als controller habe ich eine 24ch Maestro Servocontroll von pololu,

Ich stehe noch recht am anfang, bis jetzt läft er und mit hilfe von zwei IR Sensoren entscheidet er ob Rechts oder links bei einem hinternis,

Eure Hilfe benötige ich nun, ich möchte nicht das der Hexa gleich nach dem einschalten losläuft sondern erst eine Sequenz abspielt und nach beendigung dieser dann ganz normal startet und losläuft.

hier ist der code..
Code:
start:
  # wenn beide Sensoren on dann Back
  left_sensor right_sensor logical_and
  if back back  goto start endif

  # wenn linker sensor on dann nach rechts
  left_sensor if back right right goto start endif

  # wenn rechter sensor on dann nach links
  right_sensor if back left left goto start endif

  # wenn kein sensor dann Vorwärts
  forward
  goto start


sub left_sensor
  19 get_position 512 less_than
  return


sub right_sensor
  18 get_position 512 less_than
  return

### Sequence subroutines: ###


sub back
return

sub forward
return

sub left
return

sub right
return

gruss