POSIM v1.0.1Platform for Ocean Simulation · Documentation
Menu de la documentation
POSIM / Piloter les robots

Commander avec Python

Lancez l’exemple REXROV dans le terminal A et gardez-le actif. Dans le terminal B préparé, lisez sa position, puis appliquez une brève impulsion à un propulseur.

S'abonner à la position

Enregistrez ce programme sous observe.py, puis lancez python3 observe.py dans l'environnement ROS chargé.

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 position s'affiche environ une fois par seconde. Ctrl+C arrête l'observateur sans fermer le simulateur.

Envoyer une commande limitée

Enregistrez le programme suivant sous pulse_thruster.py et lancez python3 pulse_thruster.py. Il attend un abonné, applique 5 N au propulseur 1 pendant environ deux secondes de temps réel, puis envoie zéro. L'axe de montage détermine la force et le couple obtenus.

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

Le réglage des signaux permet à Ctrl+C d'atteindre le bloc de nettoyage alors que la publication ROS reste disponible. En cas d'arrêt forcé du processus, arrêtez la simulation ou envoyez des consignes neutres selon la page Commande des propulseurs.

Observer la réponse

Dans un autre terminal préparé, surveillez la vitesse angulaire pendant l'impulsion :

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

La vitesse doit réagir, puis revenir vers zéro. Comparez l'odométrie pour distinguer la réponse de l'actionneur du déplacement du véhicule. Ctrl+C ferme l'affichage.

Construire un contrôleur

Répartissez les forces entre les huit propulseurs de REXROV selon l'état mesuré et votre loi de commande. Respectez les topics, les axes et les unités. Utilisez le temps simulé dans la logique de l'expérience et remettez au neutre tous les actionneurs commandés à l'arrêt.

BlueROV2 suit le chemin MAVROS/ArduSub. Pour comparer les essais, enregistrez les observations.