x328-proto 0.2.0

use std::collections::HashMap;
use std::error::Error;
use std::io::{self, Read, Write};

use x328_proto::node::Node;
use x328_proto::{addr, NodeState};

fn node_main_loop() -> Result<(), Box<dyn Error>> {
    let mut registers = HashMap::new();

    let mut node = Node::new(addr(10));
    let mut token = node.reset();

    loop {
        match node.state(token) {
            NodeState::ReceiveData(recv) => {
                // print!("Reading one byte from stdin\n");
                let mut data_in = vec![0];
                if io::stdin().read(data_in.as_mut_slice())? == 0 {
                    break;
                }
                token = recv.receive_data(&data_in);
            }

            NodeState::SendData(send) => {
                io::stdout().write_all(send.send_data())?;
                token = send.data_sent();
            }

            NodeState::ReadParameter(read_command) => {
                print!("Received read command {:?}", read_command);
                token = if read_command.parameter() == 3 {
                    read_command.send_invalid_parameter()
                } else {
                    read_command.send_reply_ok(4u16.into())
                }
            }

            NodeState::WriteParameter(write_command) => {
                print!("Received write command at {:?}", write_command);
                let param = write_command.parameter();
                token = if param == 3 {
                    write_command.write_error()
                } else {
                    registers.insert(param, write_command.value());
                    write_command.write_ok()
                };
            }
        };
    }
    Ok(())
}

fn main() -> Result<(), Box<dyn Error>> {
    node_main_loop()
}