mirror of
https://github.com/italicsjenga/rp-hal-boards.git
synced 2024-12-25 05:31:29 +11:00
97 lines
2.6 KiB
Rust
97 lines
2.6 KiB
Rust
|
//! Rainbow effect color wheel using the onboard NeoPixel on a VCC-GND Studio YD-RP2040 board
|
||
|
//!
|
||
|
//! This flows smoothly through various colors on the onboard NeoPixel.
|
||
|
//! Uses the `ws2812_pio` driver to control the NeoPixel, which in turns uses the
|
||
|
//! RP2040's PIO block.
|
||
|
#![no_std]
|
||
|
#![no_main]
|
||
|
|
||
|
use core::iter::once;
|
||
|
use embedded_hal::timer::CountDown;
|
||
|
use embedded_time::duration::Extensions;
|
||
|
use panic_halt as _;
|
||
|
use smart_leds::{brightness, SmartLedsWrite, RGB8};
|
||
|
use vcc_gnd_yd_rp2040::entry;
|
||
|
use vcc_gnd_yd_rp2040::{
|
||
|
hal::{
|
||
|
clocks::{init_clocks_and_plls, Clock},
|
||
|
pac,
|
||
|
pio::PIOExt,
|
||
|
timer::Timer,
|
||
|
watchdog::Watchdog,
|
||
|
Sio,
|
||
|
},
|
||
|
Pins, XOSC_CRYSTAL_FREQ,
|
||
|
};
|
||
|
use ws2812_pio::Ws2812;
|
||
|
|
||
|
#[entry]
|
||
|
fn main() -> ! {
|
||
|
let mut pac = pac::Peripherals::take().unwrap();
|
||
|
|
||
|
let mut watchdog = Watchdog::new(pac.WATCHDOG);
|
||
|
|
||
|
let clocks = init_clocks_and_plls(
|
||
|
XOSC_CRYSTAL_FREQ,
|
||
|
pac.XOSC,
|
||
|
pac.CLOCKS,
|
||
|
pac.PLL_SYS,
|
||
|
pac.PLL_USB,
|
||
|
&mut pac.RESETS,
|
||
|
&mut watchdog,
|
||
|
)
|
||
|
.ok()
|
||
|
.unwrap();
|
||
|
|
||
|
let sio = Sio::new(pac.SIO);
|
||
|
let pins = Pins::new(
|
||
|
pac.IO_BANK0,
|
||
|
pac.PADS_BANK0,
|
||
|
sio.gpio_bank0,
|
||
|
&mut pac.RESETS,
|
||
|
);
|
||
|
|
||
|
let timer = Timer::new(pac.TIMER, &mut pac.RESETS);
|
||
|
let mut delay = timer.count_down();
|
||
|
|
||
|
// Configure the addressable LED
|
||
|
let (mut pio, sm0, _, _, _) = pac.PIO0.split(&mut pac.RESETS);
|
||
|
let mut ws = Ws2812::new(
|
||
|
// The onboard NeoPixel is attached to GPIO pin #16 on the Feather RP2040.
|
||
|
pins.neopixel.into_mode(),
|
||
|
&mut pio,
|
||
|
sm0,
|
||
|
clocks.peripheral_clock.freq(),
|
||
|
timer.count_down(),
|
||
|
);
|
||
|
|
||
|
// Infinite colour wheel loop
|
||
|
let mut n: u8 = 128;
|
||
|
loop {
|
||
|
ws.write(brightness(once(wheel(n)), 32)).unwrap();
|
||
|
n = n.wrapping_add(1);
|
||
|
|
||
|
delay.start(25.milliseconds());
|
||
|
let _ = nb::block!(delay.wait());
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/// Convert a number from `0..=255` to an RGB color triplet.
|
||
|
///
|
||
|
/// The colours are a transition from red, to green, to blue and back to red.
|
||
|
fn wheel(mut wheel_pos: u8) -> RGB8 {
|
||
|
wheel_pos = 255 - wheel_pos;
|
||
|
if wheel_pos < 85 {
|
||
|
// No green in this sector - red and blue only
|
||
|
(255 - (wheel_pos * 3), 0, wheel_pos * 3).into()
|
||
|
} else if wheel_pos < 170 {
|
||
|
// No red in this sector - green and blue only
|
||
|
wheel_pos -= 85;
|
||
|
(0, wheel_pos * 3, 255 - (wheel_pos * 3)).into()
|
||
|
} else {
|
||
|
// No blue in this sector - red and green only
|
||
|
wheel_pos -= 170;
|
||
|
(wheel_pos * 3, 255 - (wheel_pos * 3), 0).into()
|
||
|
}
|
||
|
}
|