#![doc = document_features::document_features!()]
#![doc(html_logo_url = "https://avatars.githubusercontent.com/u/46717278")]
#![deny(missing_docs)]
#![no_std]
use core::{fmt::Debug, slice::IterMut};
use esp_hal::{
clock::Clocks,
gpio::{interconnect::PeripheralOutput, Level},
rmt::{
Error as RmtError, PulseCode, TxChannel, TxChannelAsync, TxChannelConfig, TxChannelCreator,
TxChannelCreatorAsync,
},
};
use smart_leds_trait::{SmartLedsWrite, SmartLedsWriteAsync, RGB8};
const RMT_RAM_ONE_LED: usize = 3 * 8;
const SK68XX_CODE_PERIOD: u32 = 1250; const SK68XX_T0H_NS: u32 = 400; const SK68XX_T0L_NS: u32 = SK68XX_CODE_PERIOD - SK68XX_T0H_NS;
const SK68XX_T1H_NS: u32 = 850; const SK68XX_T1L_NS: u32 = SK68XX_CODE_PERIOD - SK68XX_T1H_NS;
#[derive(Debug)]
#[cfg_attr(feature = "defmt", derive(defmt::Format))]
pub enum LedAdapterError {
BufferSizeExceeded,
TransmissionError(RmtError),
}
impl From<RmtError> for LedAdapterError {
fn from(e: RmtError) -> Self {
LedAdapterError::TransmissionError(e)
}
}
fn led_pulses_for_clock(src_clock: u32) -> (u32, u32) {
(
PulseCode::new(
Level::High,
((SK68XX_T0H_NS * src_clock) / 1000) as u16,
Level::Low,
((SK68XX_T0L_NS * src_clock) / 1000) as u16,
),
PulseCode::new(
Level::High,
((SK68XX_T1H_NS * src_clock) / 1000) as u16,
Level::Low,
((SK68XX_T1L_NS * src_clock) / 1000) as u16,
),
)
}
fn led_config() -> TxChannelConfig {
TxChannelConfig::default()
.with_clk_divider(1)
.with_idle_output_level(Level::Low)
.with_carrier_modulation(false)
.with_idle_output(true)
}
fn convert_rgb_to_pulses(
value: RGB8,
mut_iter: &mut IterMut<u32>,
pulses: (u32, u32),
) -> Result<(), LedAdapterError> {
convert_rgb_channel_to_pulses(value.g, mut_iter, pulses)?;
convert_rgb_channel_to_pulses(value.r, mut_iter, pulses)?;
convert_rgb_channel_to_pulses(value.b, mut_iter, pulses)?;
Ok(())
}
fn convert_rgb_channel_to_pulses(
channel_value: u8,
mut_iter: &mut IterMut<u32>,
pulses: (u32, u32),
) -> Result<(), LedAdapterError> {
for position in [128, 64, 32, 16, 8, 4, 2, 1] {
*mut_iter.next().ok_or(LedAdapterError::BufferSizeExceeded)? =
match channel_value & position {
0 => pulses.0,
_ => pulses.1,
}
}
Ok(())
}
pub const fn buffer_size(num_leds: usize) -> usize {
num_leds * RMT_RAM_ONE_LED + 1
}
#[macro_export]
macro_rules! smart_led_buffer {
( $num_leds: expr ) => {
[0u32; $crate::buffer_size($num_leds)]
};
}
#[macro_export]
#[deprecated]
macro_rules! smartLedBuffer {
( $num_leds: expr ) => {
smart_led_buffer!($num_leds);
};
}
pub struct SmartLedsAdapter<TX, const BUFFER_SIZE: usize>
where
TX: TxChannel,
{
channel: Option<TX>,
rmt_buffer: [u32; BUFFER_SIZE],
pulses: (u32, u32),
}
impl<'d, TX, const BUFFER_SIZE: usize> SmartLedsAdapter<TX, BUFFER_SIZE>
where
TX: TxChannel,
{
pub fn new<C, O>(
channel: C,
pin: O,
rmt_buffer: [u32; BUFFER_SIZE],
) -> SmartLedsAdapter<TX, BUFFER_SIZE>
where
O: PeripheralOutput<'d>,
C: TxChannelCreator<'d, TX>,
{
let channel = channel.configure(pin, led_config()).unwrap();
let src_clock = Clocks::get().apb_clock.as_mhz();
Self {
channel: Some(channel),
rmt_buffer,
pulses: led_pulses_for_clock(src_clock),
}
}
}
impl<TX, const BUFFER_SIZE: usize> SmartLedsWrite for SmartLedsAdapter<TX, BUFFER_SIZE>
where
TX: TxChannel,
{
type Error = LedAdapterError;
type Color = RGB8;
fn write<T, I>(&mut self, iterator: T) -> Result<(), Self::Error>
where
T: IntoIterator<Item = I>,
I: Into<Self::Color>,
{
let mut seq_iter = self.rmt_buffer.iter_mut();
for item in iterator {
convert_rgb_to_pulses(item.into(), &mut seq_iter, self.pulses)?;
}
*seq_iter.next().ok_or(LedAdapterError::BufferSizeExceeded)? = 0;
let channel = self.channel.take().unwrap();
match channel.transmit(&self.rmt_buffer)?.wait() {
Ok(chan) => {
self.channel = Some(chan);
Ok(())
}
Err((e, chan)) => {
self.channel = Some(chan);
Err(LedAdapterError::TransmissionError(e))
}
}
}
}
pub const fn buffer_size_async(num_leds: usize) -> usize {
num_leds * (RMT_RAM_ONE_LED + 1)
}
pub struct SmartLedsAdapterAsync<Tx, const BUFFER_SIZE: usize> {
channel: Tx,
rmt_buffer: [u32; BUFFER_SIZE],
pulses: (u32, u32),
}
impl<'d, Tx: TxChannelAsync, const BUFFER_SIZE: usize> SmartLedsAdapterAsync<Tx, BUFFER_SIZE> {
pub fn new<C, O>(
channel: C,
pin: O,
rmt_buffer: [u32; BUFFER_SIZE],
) -> SmartLedsAdapterAsync<Tx, BUFFER_SIZE>
where
O: PeripheralOutput<'d>,
C: TxChannelCreatorAsync<'d, Tx>,
{
let channel = channel.configure(pin, led_config()).unwrap();
let src_clock = Clocks::get().apb_clock.as_mhz();
Self {
channel,
rmt_buffer,
pulses: led_pulses_for_clock(src_clock),
}
}
fn prepare_rmt_buffer<I: Into<RGB8>>(
&mut self,
iterator: impl IntoIterator<Item = I>,
) -> Result<(), LedAdapterError> {
let mut seq_iter = self.rmt_buffer.iter_mut();
for item in iterator {
Self::convert_rgb_to_pulse(item.into(), &mut seq_iter, self.pulses)?;
}
Ok(())
}
fn convert_rgb_to_pulse(
value: RGB8,
mut_iter: &mut IterMut<u32>,
pulses: (u32, u32),
) -> Result<(), LedAdapterError> {
convert_rgb_to_pulses(value, mut_iter, pulses)?;
*mut_iter.next().ok_or(LedAdapterError::BufferSizeExceeded)? = 0;
Ok(())
}
}
impl<Tx: TxChannelAsync, const BUFFER_SIZE: usize> SmartLedsWriteAsync
for SmartLedsAdapterAsync<Tx, BUFFER_SIZE>
{
type Error = LedAdapterError;
type Color = RGB8;
async fn write<T, I>(&mut self, iterator: T) -> Result<(), Self::Error>
where
T: IntoIterator<Item = I>,
I: Into<Self::Color>,
{
self.prepare_rmt_buffer(iterator)?;
for chunk in self.rmt_buffer.chunks(RMT_RAM_ONE_LED + 1) {
self.channel
.transmit(chunk)
.await
.map_err(LedAdapterError::TransmissionError)?;
}
Ok(())
}
}