Control con Python
Inicia el ejemplo REXROV en la terminal A y mantenlo activo. En la terminal B preparada, lee su posición y aplica un impulso breve a un propulsor.
Suscribirse a la posición
Guarda este programa como observe.py y ejecuta python3 observe.py en el entorno ROS preparado.
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()
Verás una posición aproximadamente cada segundo. Ctrl+C detiene el observador y deja la simulación activa.
Enviar una orden limitada
Guarda el siguiente programa como pulse_thruster.py y ejecuta python3 pulse_thruster.py. Espera al suscriptor, aplica 5 N al propulsor 1 durante unos dos segundos del equipo anfitrión y envía cero al terminar. El eje de montaje determina la fuerza y el par resultantes.
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()
La configuración de señales permite ejecutar la limpieza al pulsar Ctrl+C mientras el publicador aún está disponible. Si fuerzas la terminación del proceso, detén la simulación o envía órdenes neutras según Control de propulsores.
Observar la respuesta
En otra terminal preparada, observa la velocidad angular durante el impulso:
ros2 topic echo --no-daemon /model/rexrov/joint/thruster1_joint/ang_vel std_msgs/msg/Float64
La velocidad debe responder y volver hacia cero. Compara la odometría para distinguir el movimiento del actuador del movimiento del vehículo. Ctrl+C cierra el visor.
Crear un controlador
Distribuye las fuerzas entre los ocho propulsores de REXROV usando el estado medido y tu ley de control. Respeta los tópicos, ejes y unidades. Usa tiempo simulado para la lógica del experimento y devuelve a neutro todos los actuadores utilizados al terminar.
BlueROV2 sigue la ruta MAVROS/ArduSub. Para comparar ensayos, graba las observaciones.