lss_driver 0.8.4

use async_std::task::sleep;
use std::time::Duration;
use structopt::StructOpt;

#[derive(StructOpt, Debug)]
#[structopt()]
struct Args {
    #[structopt(about = "Serial port to use")]
    port: String,
}

#[tokio::main]
async fn main() -> Result<(), Box<dyn std::error::Error>> {
    let args: Args = Args::from_args();
    let mut driver = lss_driver::LSSDriver::new(&args.port)?;
    let mut ids = vec![];
    for i in 0..254 {
        if driver.query_status(i).await.is_ok() {
            ids.push(i);
            println!("Found servo with ID {}", i)
        }
    }
    for id in &ids {
        driver.set_color(*id, lss_driver::LedColor::Magenta).await?;
    }
    loop {
        let mut frame_buffer = String::new();
        frame_buffer.push('\n');
        for id in &ids {
            let position = driver.query_position(*id).await?;
            frame_buffer.push_str(&format!("{} {}\n", id, position));
            if position > 0.0 {
                driver.set_color(*id, lss_driver::LedColor::Green).await?;
            } else {
                driver.set_color(*id, lss_driver::LedColor::Red).await?;
            }
        }
        print!("{}", frame_buffer);
        sleep(Duration::from_millis(500)).await;
    }
}