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.