use std::sync::Arc;
use std::sync::atomic::{AtomicBool, AtomicU8, Ordering};
use std::time::{Duration, Instant};
use parking_lot::Mutex;
use crate::error::{Error, Result};
use crate::protocol::command::{catch_payload, inject_payload, lock_payload};
use crate::protocol::opcode::Q_VERSION;
use crate::protocol::{FrameDecoder, FrameType, Resp, encode, parse_resp};
use crate::transport::Transport;
use crate::types::Version;
use super::counters::Counters;
use super::reconcile::DesiredState;
use super::slot::TransportSlot;
use super::{Link, write_frame};
const AUTO_RECONNECT_MIN: Duration = Duration::from_millis(100);
const AUTO_RECONNECT_MAX: Duration = Duration::from_secs(2);
const PROBE_DEADLINE: Duration = Duration::from_millis(1200);
const PROBE_QUERY_GAP: Duration = Duration::from_millis(300);
#[derive(Clone, Debug)]
pub(crate) struct BoxIdentity {
pub(crate) serial: Option<String>,
pub(crate) mac: [u8; 6],
}
pub(crate) struct ReconnectCtx {
pub(crate) transport: Arc<TransportSlot>,
pub(crate) write_lock: Arc<Mutex<()>>,
pub(crate) seq: Arc<AtomicU8>,
pub(crate) counters: Arc<Counters>,
pub(crate) desired: Arc<Mutex<DesiredState>>,
pub(crate) reconnect_lock: Arc<Mutex<()>>,
pub(crate) identity: Arc<Mutex<Option<BoxIdentity>>>,
}
fn probe_version(transport: &dyn Transport) -> Option<Version> {
let frame = encode(FrameType::Query, 0, &[Q_VERSION]).ok()?;
let mut decoder = FrameDecoder::new();
let start = Instant::now();
let mut last_query: Option<Instant> = None;
let mut found = None;
let mut rx = [0u8; 256];
while found.is_none() && start.elapsed() < PROBE_DEADLINE {
if last_query.is_none_or(|t| t.elapsed() >= PROBE_QUERY_GAP) {
if transport.write_all(&frame).is_err() {
return None;
}
last_query = Some(Instant::now());
}
match transport.read(&mut rx) {
Ok(0) => {}
Ok(n) => decoder.feed(&rx[..n], |f| {
if f.ty == FrameType::Resp {
if let Some(Resp::Version(v)) = parse_resp(&f.payload) {
found = Some(v);
}
}
}),
Err(_) => return None,
}
}
found
}
fn reconnect(ctx: &ReconnectCtx) -> Result<()> {
let _guard = ctx.reconnect_lock.lock();
let identity = ctx.identity.lock().clone();
let ports = crate::transport::scan::find_medius();
let candidates: Vec<_> = match &identity {
Some(id) if id.serial.is_some() => {
let matched: Vec<_> = ports
.iter()
.filter(|p| p.serial == id.serial)
.cloned()
.collect();
if matched.is_empty() { ports } else { matched }
}
_ => ports,
};
if candidates.is_empty() {
return Err(Error::NotFound);
}
ctx.transport.swap(Arc::new(crate::transport::Disconnected));
std::thread::sleep(Duration::from_millis(200));
for port in candidates {
let serial =
match crate::transport::serial::SerialTransport::open(std::path::Path::new(&port.path))
{
Ok(s) => s,
Err(_) => continue,
};
if let Some(id) = &identity {
match probe_version(&serial) {
Some(v) if v.mac == id.mac => {}
_ => continue,
}
}
ctx.transport.swap(Arc::new(serial));
ctx.counters.inc_reconnects();
trace_event!(
target: "medius::device",
tracing::Level::INFO,
port = %port.path,
reason = "rescan",
"reconnected",
);
return reapply_held(ctx);
}
Err(Error::NotFound)
}
fn reapply_held(ctx: &ReconnectCtx) -> Result<()> {
let (held, held_locks, catch) = {
let d = ctx.desired.lock();
(
d.held().collect::<Vec<_>>(),
d.held_locks().collect::<Vec<_>>(),
d.catch(),
)
};
for (usage, action) in held {
let (class, id) = usage.class_id();
let seq = ctx.seq.fetch_add(1, Ordering::Relaxed);
write_frame(
&ctx.transport,
&ctx.write_lock,
&ctx.counters,
seq,
FrameType::Inject,
&inject_payload(class, id, action.as_u8()),
)?;
}
for (class, usage, direction) in held_locks {
let seq = ctx.seq.fetch_add(1, Ordering::Relaxed);
write_frame(
&ctx.transport,
&ctx.write_lock,
&ctx.counters,
seq,
FrameType::Lock,
&lock_payload(class, usage, direction, 1),
)?;
}
if !catch.is_empty() {
let seq = ctx.seq.fetch_add(1, Ordering::Relaxed);
write_frame(
&ctx.transport,
&ctx.write_lock,
&ctx.counters,
seq,
FrameType::Catch,
&catch_payload(catch.bits()),
)?;
}
Ok(())
}
pub(crate) fn auto_reconnect(ctx: &ReconnectCtx, stop: &AtomicBool) {
let mut backoff = AUTO_RECONNECT_MIN;
while !stop.load(Ordering::SeqCst) {
if reconnect(ctx).is_ok() {
return;
}
std::thread::sleep(backoff);
backoff = (backoff * 2).min(AUTO_RECONNECT_MAX);
}
}
impl Link {
fn reconnect_ctx(&self) -> ReconnectCtx {
ReconnectCtx {
transport: Arc::clone(&self.inner.transport),
write_lock: Arc::clone(&self.inner.write_lock),
seq: Arc::clone(&self.inner.seq),
counters: Arc::clone(&self.inner.counters),
desired: Arc::clone(&self.inner.desired),
reconnect_lock: Arc::clone(&self.inner.reconnect_lock),
identity: Arc::clone(&self.inner.identity),
}
}
pub(crate) fn set_identity(&self, id: BoxIdentity) {
*self.inner.identity.lock() = Some(id);
}
pub(crate) fn reconnect(&self) -> Result<()> {
reconnect(&self.reconnect_ctx())
}
pub(crate) fn reapply(&self) -> Result<()> {
reapply_held(&self.reconnect_ctx())
}
}