device-envoy-rp 0.1.0

Build Pico applications with LED panels, easy Wi-Fi, and 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

//! Dual servo control example.
//! Moves two servos in opposite directions for 2 seconds.
//! Connect servos to GPIO 11 and GPIO 12.

#![no_std]
#![no_main]

use core::future::pending;
use defmt::info;
use defmt_rtt as _;
use device_envoy_rp::{servo, servo::Servo as _};
use embassy_executor::Spawner;
use embassy_time::{Duration, Instant, Timer};
use panic_probe as _;

#[embassy_executor::main]
pub async fn main(_spawner: Spawner) -> ! {
    let p = embassy_rp::init(Default::default());

    info!("Starting dual servo example");
    // TODO in future, create macro servos! (plural) that can share PWM resources.

    // Create servos on GPIO 11 and GPIO 12
    // GPIO 11 → PWM_SLICE5 (channel B)
    // GPIO 12 → PWM_SLICE6 (channel A)
    let servo11 = servo! {
        pin: p.PIN_11,
        slice: p.PWM_SLICE5,
    };
    let servo12 = servo! {
        pin: p.PIN_12,
        slice: p.PWM_SLICE6,
    };

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

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

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

        // Move servos in opposite directions
        servo11.set_degrees(0);
        servo12.set_degrees(180);
        Timer::after_millis(500).await;

        // Move servos in opposite directions (swapped)
        servo11.set_degrees(180);
        servo12.set_degrees(0);
        Timer::after_millis(500).await;
    }

    info!("Done! Centering servos");
    servo11.set_degrees(90);
    servo12.set_degrees(90);

    Timer::after_millis(500).await;

    info!("Relaxing servos");
    servo11.relax();
    servo12.relax();

    pending().await
}