#![no_std]
#![no_main]
#![allow(clippy::uninlined_format_args)]
use core::fmt;
use core::sync::atomic::AtomicU32;
use core::sync::atomic::Ordering;
#[cfg(feature = "defmt")]
use defmt::info;
#[cfg(feature = "defmt")]
use defmt_rtt as _;
use embassy_executor::task;
use embassy_executor::Spawner;
use embassy_time::Duration;
use embassy_time::Instant;
use embassy_time::Timer;
use embedded_graphics::geometry::Point;
use embedded_graphics::mono_font::ascii::FONT_5X7;
use embedded_graphics::mono_font::MonoTextStyleBuilder;
use embedded_graphics::pixelcolor::RgbColor;
use embedded_graphics::text::Alignment;
use embedded_graphics::text::Text;
use embedded_graphics::Drawable;
use esp_backtrace as _;
use esp_hal::clock::CpuClock;
use esp_hal::gpio::Pin;
use esp_hal::interrupt::software::SoftwareInterruptControl;
use esp_hal::interrupt::Priority;
use esp_hal::time::Rate;
use esp_hal::timer::timg::TimerGroup;
use esp_hub75::framebuffer::bitplane::plain::DmaFrameBuffer;
use esp_hub75::framebuffer::compute_rows;
use esp_hub75::Color;
use esp_hub75::Hub75;
use esp_hub75::Hub75Pins16;
use esp_rtos::embassy::InterruptExecutor;
use heapless::String;
#[cfg(feature = "log")]
use log::info;
esp_bootloader_esp_idf::esp_app_desc!();
macro_rules! mk_static {
($t:ty,$val:expr) => {{
static STATIC_CELL: static_cell::StaticCell<$t> = static_cell::StaticCell::new();
#[deny(unused_attributes)]
let x = STATIC_CELL.uninit().write($val);
x
}};
}
static RENDER_RATE: AtomicU32 = AtomicU32::new(0);
static SIMPLE_COUNTER: AtomicU32 = AtomicU32::new(0);
const ROWS: usize = 64;
const COLS: usize = 64;
const NROWS: usize = compute_rows(ROWS);
const PLANES: usize = 7;
const LINE1: i32 = ROWS as i32 - 1 - 14;
const LINE2: i32 = ROWS as i32 - 1 - 7;
const LINE3: i32 = ROWS as i32 - 1;
const NBARS: i32 = ROWS as i32 / 8;
type FBType = DmaFrameBuffer<NROWS, COLS, PLANES>;
#[task]
async fn display_task(hub75: Hub75<esp_hal::Async, FBType>, mut fb: &'static mut FBType) {
info!("display_task: starting!");
let fps_style = MonoTextStyleBuilder::new()
.font(&FONT_5X7)
.text_color(Color::YELLOW)
.background_color(Color::BLACK)
.build();
let mut render_count = 0u32;
let mut refresh_count_start = hub75.frame_count();
let mut start = Instant::now();
let mut refresh_rate = 0u32;
loop {
fb.erase();
const STEP: u8 = (256 / COLS) as u8;
for x in 0..COLS {
let brightness = (x as u8) * STEP;
for y in 0..NBARS {
fb.set_pixel(Point::new(x as i32, y), Color::new(brightness, 0, 0));
fb.set_pixel(
Point::new(x as i32, y + NBARS),
Color::new(0, brightness, 0),
);
fb.set_pixel(
Point::new(x as i32, y + 2 * NBARS),
Color::new(0, 0, brightness),
);
}
}
let mut buffer: String<64> = String::new();
fmt::write(&mut buffer, format_args!("Refresh: {:4}", refresh_rate)).unwrap();
Text::with_alignment(
buffer.as_str(),
Point::new(0, LINE3),
fps_style,
Alignment::Left,
)
.draw(fb)
.unwrap();
buffer.clear();
fmt::write(
&mut buffer,
format_args!("Render: {:5}", RENDER_RATE.load(Ordering::Relaxed)),
)
.unwrap();
Text::with_alignment(
buffer.as_str(),
Point::new(0, LINE2),
fps_style,
Alignment::Left,
)
.draw(fb)
.unwrap();
buffer.clear();
fmt::write(
&mut buffer,
format_args!("Simple: {:5}", SIMPLE_COUNTER.load(Ordering::Relaxed)),
)
.unwrap();
Text::with_alignment(
buffer.as_str(),
Point::new(0, LINE1),
fps_style,
Alignment::Left,
)
.draw(fb)
.unwrap();
let mut xfer = hub75.swap(fb);
xfer.wait_for_done().await;
fb = xfer.wait().expect("DMA transfer failed");
render_count += 1;
const FPS_INTERVAL: Duration = Duration::from_secs(1);
if start.elapsed() > FPS_INTERVAL {
RENDER_RATE.store(render_count, Ordering::Relaxed);
let current_frame_count = hub75.frame_count();
refresh_rate = current_frame_count.wrapping_sub(refresh_count_start);
refresh_count_start = current_frame_count;
render_count = 0;
start = Instant::now();
}
}
}
unsafe extern "C" {
static _stack_end_cpu0: u32;
static _stack_start_cpu0: u32;
}
#[esp_rtos::main]
async fn main(_spawner: Spawner) {
#[cfg(feature = "log")]
esp_println::logger::init_logger(log::LevelFilter::Info);
info!("Main starting!");
info!("ROWS: {}", ROWS);
info!("COLS: {}", COLS);
info!("PLANES: {}", PLANES);
info!("FB size: {}", core::mem::size_of::<FBType>());
info!("main: stack size: {}", unsafe {
core::ptr::addr_of!(_stack_start_cpu0).offset_from(core::ptr::addr_of!(_stack_end_cpu0))
});
let peripherals = esp_hal::init(esp_hal::Config::default().with_cpu_clock(CpuClock::max()));
let sw_ints = SoftwareInterruptControl::new(peripherals.SW_INTERRUPT);
let software_interrupt = sw_ints.software_interrupt2;
let timg0 = TimerGroup::new(peripherals.TIMG0);
info!("init embassy");
esp_rtos::start(timg0.timer0, sw_ints.software_interrupt0);
info!("init framebuffers");
let fb0 = mk_static!(FBType, FBType::new());
fb0.erase();
let fb1 = mk_static!(FBType, FBType::new());
fb1.erase();
info!("fb0: {:?}", fb0);
info!("fb1: {:?}", fb1);
let tx_descriptors = esp_hub75::hub75_dma_descriptors!(FBType);
let pins = Hub75Pins16 {
red1: peripherals.GPIO16.degrade(),
grn1: peripherals.GPIO4.degrade(),
blu1: peripherals.GPIO17.degrade(),
red2: peripherals.GPIO18.degrade(),
grn2: peripherals.GPIO5.degrade(),
blu2: peripherals.GPIO19.degrade(),
addr0: peripherals.GPIO15.degrade(),
addr1: peripherals.GPIO13.degrade(),
addr2: peripherals.GPIO12.degrade(),
addr3: peripherals.GPIO14.degrade(),
addr4: peripherals.GPIO2.degrade(),
blank: peripherals.GPIO25.degrade(),
clock: peripherals.GPIO27.degrade(),
latch: peripherals.GPIO26.degrade(),
};
let hub75 = Hub75::new_async(
peripherals.I2S0,
pins,
peripherals.DMA_I2S0,
tx_descriptors,
Rate::from_mhz(20),
&*fb0,
)
.expect("failed to create Hub75");
let cpu1_fnctn = {
move || {
let hp_executor = mk_static!(
InterruptExecutor<2>,
InterruptExecutor::new(software_interrupt)
);
let high_pri_spawner = hp_executor.start(Priority::Priority3);
high_pri_spawner.spawn(display_task(hub75, fb1).unwrap());
}
};
use esp_hal::system::Stack;
const DISPLAY_STACK_SIZE: usize = 8192;
let app_core_stack = mk_static!(Stack<DISPLAY_STACK_SIZE>, Stack::new());
esp_rtos::start_second_core(
peripherals.CPU_CTRL,
sw_ints.software_interrupt1,
app_core_stack,
cpu1_fnctn,
);
loop {
if SIMPLE_COUNTER.fetch_add(1, Ordering::Relaxed) >= 99999 {
SIMPLE_COUNTER.store(0, Ordering::Relaxed);
}
Timer::after(Duration::from_millis(100)).await;
}
}