device-envoy-esp 0.1.0

Build ESP32 applications with composable device abstractions
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
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89

//! Dual servo control example.
//!
//! Moves two servos in opposite directions for 2 seconds.
//!
//! Wiring:
//! - Servo A signal -> GPIO10
//! - Servo B signal -> GPIO18
//! - Servo power -> 5V (do not use 3.3V for typical hobby servos)
//! - Servo ground -> GND (shared with ESP32 GND)
//! - If using a separate 5V supply, connect supply GND to ESP32 GND (common ground required)
//! - Do not power a servo directly from a GPIO pin
//! - Common red/brown/yellow wiring (each servo):
//!   red -> 5V, brown -> GND, yellow -> signal (GPIO10 or GPIO18)

#![no_std]
#![no_main]

use core::{convert::Infallible, future::pending};

use embassy_executor::Spawner;
use embassy_time::{Duration, Instant, Timer};
use esp_backtrace as _;
use log::info;

use device_envoy_esp::{Result, init_and_start, servo, servo::Servo as _};

esp_bootloader_esp_idf::esp_app_desc!();

servo! {
    ServoA {
        pin: GPIO10,
        timer: Timer0,
        channel: Channel0,
    }
}

servo! {
    ServoB {
        pin: GPIO18,
        timer: Timer1,
        channel: Channel1,
    }
}

#[esp_rtos::main]
async fn main(spawner: Spawner) -> ! {
    let err = inner_main(spawner).await.unwrap_err();
    panic!("{err:?}");
}

async fn inner_main(_spawner: Spawner) -> Result<Infallible> {
    init_and_start!(p, ledc: ledc);
    esp_println::logger::init_logger(log::LevelFilter::Info);

    info!("Starting dual servo example");

    let servo_a = ServoA::new(&ledc, p.GPIO10)?;
    let servo_b = ServoB::new(&ledc, p.GPIO18)?;

    info!("Moving servos in opposite directions for 2 seconds");

    let start = Instant::now();
    let duration = Duration::from_secs(2);

    loop {
        if start.elapsed() > duration {
            break;
        }

        servo_a.set_degrees(0);
        servo_b.set_degrees(180);
        Timer::after_millis(500).await;

        servo_a.set_degrees(180);
        servo_b.set_degrees(0);
        Timer::after_millis(500).await;
    }

    info!("Centering servos");
    servo_a.set_degrees(90);
    servo_b.set_degrees(90);
    Timer::after_millis(500).await;

    info!("Relaxing servos");
    servo_a.relax();
    servo_b.relax();

    pending().await
}