Skip to main content

qualia_core_db/p2p/connectivity/
demux.rs

1//! Same-socket STUN/TURN/WireGuard demultiplexer plus overlay port dispatch.
2
3#![cfg(not(target_arch = "wasm32"))]
4
5use crate::p2p::mesh_datagram::{decode_datagram_ref, ports};
6use crate::p2p::stun_observe::MAGIC;
7
8#[derive(Debug, Clone, Copy, PartialEq, Eq)]
9pub enum UdpClass {
10    StunTurn,
11    WireGuard,
12    Unknown,
13}
14
15/// RFC 7983-ish: STUN methods have the top two bits clear and magic cookie.
16pub fn classify_udp(buf: &[u8]) -> UdpClass {
17    if buf.len() >= 20 {
18        let top = buf[0] & 0b1100_0000;
19        let magic = u32::from_be_bytes([buf[4], buf[5], buf[6], buf[7]]);
20        if top == 0 && magic == MAGIC {
21            return UdpClass::StunTurn;
22        }
23    }
24    if !buf.is_empty() {
25        let t = buf[0] & 0x0f;
26        if matches!(t, 1 | 2 | 4) {
27            return UdpClass::WireGuard;
28        }
29    }
30    UdpClass::Unknown
31}
32
33#[derive(Debug, Clone, Copy, PartialEq, Eq)]
34pub enum OverlayPort {
35    Chat,
36    Qdnf,
37    Presence,
38    Share,
39    Other(u16),
40}
41
42/// Consume an inner IPv6/UDP packet once. Chat and QDNF are both returned.
43pub fn classify_overlay(inner: &[u8]) -> Option<(OverlayPort, u16, &[u8])> {
44    let (src, dst, payload) = decode_datagram_ref(inner)?;
45    let port = match dst {
46        ports::CHAT => OverlayPort::Chat,
47        ports::QDNF => OverlayPort::Qdnf,
48        ports::PRESENCE => OverlayPort::Presence,
49        ports::SHARE => OverlayPort::Share,
50        other => OverlayPort::Other(other),
51    };
52    Some((port, src, payload))
53}
54
55#[cfg(test)]
56mod tests {
57    use super::*;
58    use crate::p2p::mesh_datagram::encode_datagram;
59    use crate::p2p::stun_observe::encode_binding_success_v4;
60
61    #[test]
62    fn stun_and_wg_and_overlay_not_lost() {
63        let tid = [1u8; 12];
64        let stun = encode_binding_success_v4(&tid, "1.2.3.4:5".parse().unwrap()).unwrap();
65        assert_eq!(classify_udp(&stun), UdpClass::StunTurn);
66        assert_eq!(classify_udp(&[1, 0, 0, 0]), UdpClass::WireGuard);
67        let chat = encode_datagram(1, ports::CHAT, b"hi");
68        let qdnf = encode_datagram(2, ports::QDNF, b"qf");
69        assert!(matches!(
70            classify_overlay(&chat),
71            Some((OverlayPort::Chat, _, b"hi"))
72        ));
73        assert!(matches!(
74            classify_overlay(&qdnf),
75            Some((OverlayPort::Qdnf, _, b"qf"))
76        ));
77    }
78}