radomctld/src/main.rs

mod logger;
mod rotctlprotocol;
mod rotor;

use anyhow::Result;
use fern::colors::{Color, ColoredLevelConfig};
use log::{debug, error, info, warn};
use std::io;
use tokio::{
    self,
    io::{AsyncBufReadExt, AsyncWriteExt, BufStream},
    net::{TcpListener, TcpStream},
    sync::{self, mpsc, watch},
    time,
};

use logger::setup_logger;
use rotor::control_rotor;

use rotctlprotocol::{parse_command, Command};

async fn process_socket(
    socket: TcpStream,
    cmd_tx: mpsc::Sender<Command>,
    mut pos_rx: watch::Receiver<(f32, f32)>,
) {
    let mut stream = BufStream::new(socket);

    let mut line = String::new();

    loop {
        if let Ok(n) = stream.read_line(&mut line).await {
            if n == 0 {
                return;
            }

            debug!("Received: {}", line.strip_suffix("\n").unwrap());

            match parse_command(&line) {
                Ok(cmd) => match cmd {
                    Command::GetPos => {
                        let (az, el) = pos_rx.borrow().clone();

                        stream
                            .write_all(format!("{}\n{}\n", az, el).as_bytes())
                            .await
                            .unwrap();
                        stream.flush().await.unwrap();
                    }
                    Command::Exit => {
                        stream.write_all("RPRT 0\n".as_bytes()).await.unwrap();
                        stream.flush().await.unwrap();
                        return;
                    }
                    cmd => {
                        cmd_tx.send(cmd).await.unwrap();
                        stream.write_all("RPRT 0\n".as_bytes()).await.unwrap();
                        stream.flush().await.unwrap();
                    }
                },
                Err(msg) => {
                    error!("Unable to parse input:\n{}", msg);
                    stream.write_all("RPRT 6\n".as_bytes()).await.unwrap();
                    stream.flush().await.unwrap();
                }
            }

            line.clear();
        } else {
            return;
        }
    }
}

#[tokio::main]
async fn main() -> Result<()> {
    setup_logger()?;

    let (cmd_tx, cmd_rx) = mpsc::channel::<Command>(16);

    let (pos_tx, pos_rx) = watch::channel::<(f32, f32)>((0.0, 0.0));

    tokio::spawn(async move {
        control_rotor(cmd_rx, pos_tx).await;
    });

    let listener = TcpListener::bind("127.0.0.1:1337").await?;

    loop {
        let (socket, _) = listener.accept().await?;

        let cmd_tx = cmd_tx.clone();
        let pos_rx = pos_rx.clone();
        tokio::spawn(async move {
            process_socket(socket, cmd_tx, pos_rx).await;
        });
    }
}