Suchfahrt mit Sensor

  • Moin,

    ich soll mit einem KRC4 eine Suchfahrt programmieren.

    Vorne am Greifer befindet sich ein Wenglor Sensor der 2 Schaltpunkte liefert.

    Ab dem ersten Schaltpunkt soll der Roboter langsamer fahren, beim 2. Schaltpunkt soll er stoppen.


    Wie wäre die Logic dafür ?

    Programmiere übers Panel.

  • Schritt für Schritt zum Roboterprofi!
  • Willst du ein ganzes Programm oder nur wissen wie du die Schaltpunkte richtig auswertest? Die Auswertung von Eingängen via Interrupt zum Stoppen des Roboters ist schon ein paar mal besprochen wurden. In der Suche wirst du bestimmt fündig!

  • HI


    deklariere dir 2 mal ein interrupt.....


    beim ersten geschwindigkeit reduzieren....


    beim zweiten mit brake oder Halt anhalten....


    zb.


    INTERRUPT DECL 1 WHEN Sensor1 DO Langsam ( )

    INTERRUPT DECL 2 WHEN Sensor2 DO STOP_ROBOT ( )



    PTP HOME

    PTP P1

    Interrupt ON 1

    Interrupt ON 2


    PTP P2


    PTP HOME

    -------------------------------------------

    DEF Langsam()

    Interrupt Off 1


    $VEL_CP = 0.1

    $VEL_PTP = 10


    END

    -------------------------------------------------


    DEF STOP_ROBOT()

    Interrupt Off 2


    BRAKE

    HALT


    END

Erstelle ein Benutzerkonto oder melde dich an um zu kommentieren

Du musst ein Benutzerkonto haben um einen Kommentar hinterlassen zu können

Benutzerkonto erstellen
Neues Benutzerkonto für unsere Community erstellen. Geht einfach!
Neues Benutzerkonto erstellen
Anmelden
Du hast bereits ein Benutzerkonto? Melde dich hier an.
Jetzt anmelden