1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78

use crate::prelude::*;
use crate::source::beast::DataSource;
use futures_util::pin_mut;
use std::time::{SystemTime, UNIX_EPOCH};
use tokio::net::{TcpStream, UdpSocket};
use tokio::sync::mpsc;

pub async fn receiver(
    address: String,
    tx: mpsc::Sender<TimedMessage>,
    idx: usize,
) {
    match TcpStream::connect(&address).await {
        Ok(stream) => {
            let msg_stream = beast::next_msg(DataSource::Tcp(stream)).await;
            pin_mut!(msg_stream); // needed for iteration
            loop {
                while let Some(msg) = msg_stream.next().await {
                    let msg = process_radarcape(&msg, idx);
                    tx.send(msg).await.expect("Connection closed");
                }
            }
        }
        Err(err_tcp) => {
            match UdpSocket::bind(&address).await {
                Ok(socket) => {
                    let msg_stream =
                        beast::next_msg(DataSource::Udp(socket)).await;
                    pin_mut!(msg_stream); // needed for iteration
                    loop {
                        while let Some(msg) = msg_stream.next().await {
                            let msg = process_radarcape(&msg, idx);
                            tx.send(msg).await.expect("Connection closed");
                        }
                    }
                }
                Err(err_udp) => {
                    panic!(
                        "Failed to connect in TCP ({}) and UDP ({})",
                        err_tcp, err_udp
                    );
                }
            }
        }
    }
}

fn today() -> i64 {
    86_400
        * (SystemTime::now()
            .duration_since(UNIX_EPOCH)
            .expect("SystemTime before unix epoch")
            .as_secs() as i64
            / 86_400)
}

fn process_radarcape(msg: &[u8], idx: usize) -> TimedMessage {
    // Copy the bytes from the slice into the array starting from index 2
    let mut array = [0u8; 8];
    array[2..8].copy_from_slice(&msg[2..8]);

    let ts = u64::from_be_bytes(array);
    let seconds = ts >> 30;
    let nanos = ts & 0x00003FFFFFFF;
    let ts = seconds as f64 + nanos as f64 * 1e-9;
    let frame = msg[9..]
        .iter()
        .map(|&b| format!("{:02x}", b))
        .collect::<Vec<String>>()
        .join("");

    TimedMessage {
        timestamp: today() as f64 + ts,
        frame,
        message: None,
        idx,
    }
}