POSIM v1.0.1Platform for Ocean Simulation · Dokumentation
Dokumentationsmenü
POSIM / Roboter steuern

Mit Python steuern

Starten Sie das REXROV-Beispiel in Terminal A und lassen Sie es laufen. Lesen Sie im vorbereiteten Terminal B seine Position und steuern Sie anschließend kurz einen Thruster an.

Position abonnieren

Speichern Sie dieses Programm als observe.py und starten Sie python3 observe.py in der geladenen ROS-Umgebung.

import rclpy
from nav_msgs.msg import Odometry
from rclpy.node import Node

class Observer(Node):
    def __init__(self):
        super().__init__('posim_observer')
        self.subscription = self.create_subscription(
            Odometry, '/model/rexrov/odometry', self.on_pose, 10)

    def on_pose(self, message):
        p = message.pose.pose.position
        self.get_logger().info(
            f'x={p.x:.2f}, y={p.y:.2f}, z={p.z:.2f}', throttle_duration_sec=1.0)

rclpy.init()
node = Observer()
try:
    rclpy.spin(node)
except KeyboardInterrupt:
    pass
finally:
    node.destroy_node()
    if rclpy.ok():
        rclpy.shutdown()

Etwa einmal pro Sekunde erscheint die Position. Strg+C beendet den Beobachter; der Simulator läuft weiter.

Zeitlich begrenzten Befehl senden

Speichern Sie das folgende Programm als pulse_thruster.py und starten Sie python3 pulse_thruster.py. Es wartet auf einen Subscriber, gibt für ungefähr zwei Sekunden Host-Zeit 5 N an Thruster 1 vor und sendet danach null. Die Einbauachse bestimmt die entstehende Kraft und das Drehmoment.

import time
import rclpy
from rclpy.node import Node
from rclpy.signals import SignalHandlerOptions
from std_msgs.msg import Float64

rclpy.init(signal_handler_options=SignalHandlerOptions.NO)
node = Node('posim_thruster_pulse')
publisher = node.create_publisher(
    Float64, '/model/rexrov/joint/thruster1_joint/cmd_thrust', 10)
deadline = time.monotonic() + 10.0
try:
    while publisher.get_subscription_count() == 0:
        if time.monotonic() >= deadline:
            raise RuntimeError('Start REXROV and load its ROS workspace first.')
        rclpy.spin_once(node, timeout_sec=0.1)
    print('Applying 5 N to thruster 1', flush=True)
    for _ in range(20):
        publisher.publish(Float64(data=5.0))
        rclpy.spin_once(node, timeout_sec=0.1)
except KeyboardInterrupt:
    pass
finally:
    for _ in range(5):
        publisher.publish(Float64(data=0.0))
        rclpy.spin_once(node, timeout_sec=0.1)
    print('Thruster command returned to zero', flush=True)
    node.destroy_node()
    rclpy.shutdown()

Die Signaleinstellung sorgt dafür, dass Strg+C den Aufräumblock erreicht, während der ROS-Publisher noch verfügbar ist. Bei einem erzwungenen Prozessabbruch beenden Sie den Simulator oder senden neutrale Befehle wie unter Thruster-Steuerung.

Reaktion beobachten

Beobachten Sie die Winkelgeschwindigkeit während des Impulses in einem weiteren vorbereiteten Terminal:

ros2 topic echo --no-daemon /model/rexrov/joint/thruster1_joint/ang_vel std_msgs/msg/Float64

Sie sollte auf den Befehl reagieren und anschließend gegen null gehen. Vergleichen Sie die Odometrie, um Aktuatorreaktion und Fahrzeugbewegung zu unterscheiden. Strg+C beendet die Anzeige.

Eigenen Regler entwickeln

Verteilen Sie die Kräfte anhand des gemessenen Zustands und Ihres Regelgesetzes auf die acht REXROV-Thruster. Halten Sie Topics, Einbauachsen und Einheiten konsistent. Verwenden Sie Simulationszeit für die Versuchslogik und setzen Sie beim Beenden alle angesteuerten Aktuatoren auf neutral.

BlueROV2 nutzt den MAVROS-/ArduSub-Pfad. Für den Vergleich von Versuchen können Sie Beobachtungen aufzeichnen.