use anyhow::{Context, bail};
use clap::Parser;
use futures::StreamExt;
use futures::stream::FuturesUnordered;
use moqros::ros::MoqToRos;
use moqros_cli::{BroadcastSpec, QosArgs, RelayArgs, init_logging};
#[derive(Debug, Parser)]
#[command(version, about)]
struct Cli {
#[arg(long, default_value = "image_raw")]
broadcast: Vec<BroadcastSpec>,
#[arg(long)]
topic: Option<String>,
#[arg(long, default_value = "camera")]
frame_id: String,
#[arg(id = "type", long = "type")]
ros_type: Option<String>,
#[command(flatten)]
relay: RelayArgs,
#[command(flatten)]
qos: QosArgs,
}
#[tokio::main]
async fn main() -> anyhow::Result<()> {
init_logging();
let (cli, mut node) = moqros_cli::init::<Cli>("moqros_sub")?;
let broadcasts = moqros_cli::sub_broadcasts(cli.broadcast, cli.topic, cli.ros_type, &cli.frame_id)?;
let subscriber = moqros::Subscriber::connect(&cli.relay.config())?;
tracing::info!(url = %cli.relay.url, broadcasts = broadcasts.len(), "connecting to the relay");
let mut subscribing: FuturesUnordered<_> = broadcasts
.into_iter()
.map(|broadcast| {
let subscriber = subscriber.clone();
async move { (MoqToRos::subscribe(subscriber, &broadcast.broadcast).await, broadcast) }
})
.collect();
let mut bridges = FuturesUnordered::new();
let ctrl_c = tokio::signal::ctrl_c();
tokio::pin!(ctrl_c);
loop {
tokio::select! {
Some((ready, broadcast)) = subscribing.next() => {
let bridge = ready.spawn(
&mut node,
&broadcast.topic,
cli.qos.profile(),
&broadcast.frame_id,
broadcast.ros_type.as_deref(),
);
match bridge {
Ok(bridge) => {
tracing::info!(broadcast = broadcast.broadcast, topic = broadcast.topic, "bridging MoQ -> ROS");
bridges.push(async move { (broadcast.broadcast, bridge.await) });
}
Err(err) => {
tracing::error!(%err, broadcast = broadcast.broadcast, topic = broadcast.topic, "skipping broadcast");
if subscribing.is_empty() && bridges.is_empty() {
bail!("no broadcast could be republished");
}
}
}
}
Some((broadcast, res)) = bridges.next() => {
res.context("bridge panicked")?.with_context(|| format!("broadcast {broadcast}"))?;
return Ok(());
}
_ = &mut ctrl_c => {
tracing::info!("interrupted");
return Ok(());
}
}
}
}