lss_driver 0.8.4

Driver for Lynxmotion LSS servos
Documentation 
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

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,
    #[structopt(about = "ID you want to give to the connected servo", long = "id")]
    id: u8,
}

#[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).unwrap();
    driver
        .set_color(lss_driver::BROADCAST_ID, lss_driver::LedColor::Red)
        .await?;
    driver.set_id(lss_driver::BROADCAST_ID, args.id).await?;
    driver.reset(lss_driver::BROADCAST_ID).await?;
    // After reset servo becomes unresponsive for a bit
    sleep(Duration::from_secs(2)).await;
    let new_id = driver.query_id(lss_driver::BROADCAST_ID).await?;
    if new_id == args.id {
        println!("ID set successfully");
        driver
            .set_color(lss_driver::BROADCAST_ID, lss_driver::LedColor::Green)
            .await?;
    } else {
        eprintln!("ID setting failed!");
    }
    Ok(())
}