use thunderborg_driver::ThunderborgDriver;
fn send_event(msg: &str)
{
eprintln!("{}", msg);
}
fn main() -> Result<(), rppal::i2c::Error>
{
let driver = ThunderborgDriver::new()?;
driver.set_led_color(0, 255, 0)?;
let voltage = match driver.get_battery_voltage()
{
Ok(voltage) => voltage,
Err(e) =>
{
send_event(&e.to_string());
-1.0
},
};
println!("Current battery voltage: {}", voltage);
driver.drive_fwd_for_ms(2000)?;
driver.drive_rev_for_ms(2000)?;
driver.spin_left_for_ms(2000)?;
driver.spin_right_for_ms(2000)?;
Ok(())
}