POSIM v1.0.1Platform for Ocean Simulation · Documentazione
Menu della documentazione
POSIM / Controllo dei robot

Controllo con Python

Avvia l’esempio REXROV nel terminale A e mantienilo attivo. Nel terminale B preparato, leggi la posizione e applica un breve impulso a un propulsore.

Sottoscrivere la posizione

Salva questo programma come observe.py ed esegui python3 observe.py nell'ambiente ROS caricato.

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()

La posizione compare circa una volta al secondo. Ctrl+C arresta l'osservatore lasciando attivo il simulatore.

Inviare un comando limitato

Salva il programma seguente come pulse_thruster.py ed esegui python3 pulse_thruster.py. Attende un subscriber, applica 5 N al propulsore 1 per circa due secondi misurati sul computer host, poi invia zero. L'asse di montaggio determina forza e momento risultanti.

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()

L'impostazione dei segnali permette a Ctrl+C di eseguire il blocco di pulizia mentre il publisher ROS è ancora disponibile. Se termini forzatamente il processo, arresta la simulazione oppure invia comandi neutri seguendo Controllo dei propulsori.

Osservare la risposta

In un altro terminale preparato, osserva la velocità angolare durante l'impulso:

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

La velocità deve rispondere e tornare verso zero. Confronta l'odometria per distinguere la risposta dell'attuatore dal movimento del veicolo. Ctrl+C chiude il visualizzatore.

Sviluppare un controllore

Distribuisci le forze tra gli otto propulsori di REXROV usando lo stato misurato e la tua legge di controllo. Mantieni coerenti topic, assi e unità. Usa il tempo simulato per la logica dell'esperimento e riporta al neutro tutti gli attuatori comandati quando termini.

BlueROV2 usa il percorso MAVROS/ArduSub. Per confrontare le prove, registra le osservazioni.