#![no_std]
use embedded_dma::{ReadBuffer, WriteBuffer};
use embedded_graphics::{
draw_target::DrawTarget,
geometry::OriginDimensions,
prelude::{PixelColor, Point, Size},
Pixel,
};
pub mod backends;
use backends::{DMACapableFrameBufferBackend, FrameBufferBackend};
pub struct FrameBuf<C: PixelColor, B: FrameBufferBackend<Color = C>> {
pub data: B,
width: usize,
height: usize,
origin: Point,
}
impl<C: PixelColor, B: FrameBufferBackend<Color = C>> FrameBuf<C, B> {
pub fn new(data: B, width: usize, height: usize) -> Self {
Self::new_with_origin(data, width, height, Point::new(0, 0))
}
pub fn new_with_origin(data: B, width: usize, height: usize, origin: Point) -> Self {
assert_eq!(
data.nr_elements(),
width * height,
"FrameBuf underlying data size does not match width ({}) * height ({}) = {} but is {}",
width,
height,
width * height,
data.nr_elements(),
);
Self {
data,
width,
height,
origin,
}
}
pub fn width(&self) -> usize {
self.width
}
pub fn height(&self) -> usize {
self.height
}
pub fn size(&self) -> Size {
Size::new(self.width as u32, self.height as u32)
}
pub fn origin(&self) -> Point {
self.origin
}
fn point_to_index(&self, p: Point) -> usize {
self.width * p.y as usize + p.x as usize
}
pub fn set_color_at(&mut self, p: Point, color: C) {
self.data.set(self.point_to_index(p), color)
}
pub fn get_color_at(&self, p: Point) -> C {
self.data.get(self.point_to_index(p))
}
}
impl<C: PixelColor + Default, B: FrameBufferBackend<Color = C>> FrameBuf<C, B> {
pub fn reset(&mut self) {
self.clear(C::default()).unwrap();
}
}
impl<'a, C: PixelColor, B: FrameBufferBackend<Color = C>> IntoIterator for &'a FrameBuf<C, B> {
type Item = Pixel<C>;
type IntoIter = PixelIterator<'a, C, B>;
fn into_iter(self) -> Self::IntoIter {
PixelIterator {
fbuf: self,
index: 0,
}
}
}
impl<C: PixelColor, B: FrameBufferBackend<Color = C>> OriginDimensions for FrameBuf<C, B> {
fn size(&self) -> Size {
self.size()
}
}
impl<C: PixelColor, B: FrameBufferBackend<Color = C>> DrawTarget for FrameBuf<C, B> {
type Color = C;
type Error = core::convert::Infallible;
fn draw_iter<I>(&mut self, pixels: I) -> Result<(), Self::Error>
where
I: IntoIterator<Item = Pixel<Self::Color>>,
{
for Pixel(coord, color) in pixels.into_iter() {
if coord.x >= 0
&& coord.x < self.width as i32
&& coord.y >= 0
&& coord.y < self.height as i32
{
self.set_color_at(coord, color);
}
}
Ok(())
}
fn clear(&mut self, color: Self::Color) -> Result<(), Self::Error> {
for y in 0..self.height {
for x in 0..self.width {
self.set_color_at(Point::new(x as i32, y as i32), color);
}
}
Ok(())
}
}
pub struct PixelIterator<'a, C: PixelColor, B: FrameBufferBackend<Color = C>> {
fbuf: &'a FrameBuf<C, B>,
index: usize,
}
impl<'a, C: PixelColor, B: FrameBufferBackend<Color = C>> Iterator for PixelIterator<'a, C, B> {
type Item = Pixel<C>;
fn next(&mut self) -> Option<Pixel<C>> {
let y = self.index / self.fbuf.width;
let x = self.index - y * self.fbuf.width;
if self.index >= self.fbuf.width * self.fbuf.height {
return None;
}
self.index += 1;
let p = Point::new(x as i32, y as i32);
Some(Pixel(self.fbuf.origin + p, self.fbuf.get_color_at(p)))
}
}
unsafe impl<C: PixelColor, B: DMACapableFrameBufferBackend<Color = C>> ReadBuffer
for FrameBuf<C, B>
{
type Word = u8;
unsafe fn read_buffer(&self) -> (*const Self::Word, usize) {
(
(self.data.data_ptr() as *const Self::Word),
self.height
* self.width
* (core::mem::size_of::<C>() / core::mem::size_of::<Self::Word>()),
)
}
}
unsafe impl<C: PixelColor, B: DMACapableFrameBufferBackend<Color = C>> WriteBuffer
for FrameBuf<C, B>
{
type Word = u8;
unsafe fn write_buffer(&mut self) -> (*mut Self::Word, usize) {
(
(self.data.data_ptr() as *mut Self::Word),
self.height
* self.width
* (core::mem::size_of::<C>() / core::mem::size_of::<Self::Word>()),
)
}
}
#[cfg(test)]
mod tests {
extern crate std;
use embedded_graphics::mock_display::MockDisplay;
use embedded_graphics::pixelcolor::BinaryColor;
use embedded_graphics::prelude::Point;
use embedded_graphics::prelude::Primitive;
use embedded_graphics::primitives::Line;
use embedded_graphics::primitives::PrimitiveStyle;
use embedded_graphics::Drawable;
use embedded_graphics::{pixelcolor::Rgb565, prelude::RgbColor};
use std::collections::HashMap;
use std::fmt::Debug;
use std::hash::Hash;
use super::*;
fn get_px_nums<C: PixelColor, B: FrameBufferBackend<Color = C>>(
fbuf: &FrameBuf<C, B>,
) -> HashMap<C, i32>
where
C: Hash,
C: std::cmp::Eq,
{
let mut px_nums: HashMap<C, i32> = HashMap::new();
for px in fbuf.into_iter() {
match px_nums.get_mut(&px.1) {
Some(v) => *v += 1,
None => {
px_nums.insert(px.1, 1);
}
};
}
px_nums
}
#[test]
fn clears_buffer() {
let mut data = [Rgb565::WHITE; 5 * 10];
let mut fbuf = FrameBuf::new(&mut data, 5, 10);
fbuf.reset();
let px_nums = get_px_nums(&fbuf);
assert_eq!(px_nums.get(&Rgb565::BLACK).unwrap(), &50);
assert_eq!(px_nums.get(&Rgb565::WHITE), None);
}
#[test]
fn clears_with_color() {
let mut data = [Rgb565::WHITE; 5 * 5];
let mut fbuf = FrameBuf::new(&mut data, 5, 5);
fbuf.clear(Rgb565::BLUE).unwrap();
let px_nums = get_px_nums(&fbuf);
assert_eq!(px_nums.get(&Rgb565::BLUE).unwrap(), &25);
assert_eq!(px_nums.get(&Rgb565::RED), None);
}
#[test]
fn draws_into_display() {
let mut data = [BinaryColor::Off; 12 * 11];
let mut fbuf = FrameBuf::new(&mut data, 12, 11);
let mut display: MockDisplay<BinaryColor> = MockDisplay::new();
Line::new(Point::new(2, 2), Point::new(10, 2))
.into_styled(PrimitiveStyle::with_stroke(BinaryColor::On, 2))
.draw(&mut fbuf)
.unwrap();
Line::new(Point::new(2, 5), Point::new(2, 10))
.into_styled(PrimitiveStyle::with_stroke(BinaryColor::On, 3))
.draw(&mut fbuf)
.unwrap();
display.draw_iter(fbuf.into_iter()).unwrap();
display.assert_pattern(&[
"............",
"..#########.",
"..#########.",
"............",
"............",
".###........",
".###........",
".###........",
".###........",
".###........",
".###........",
]);
}
fn draw_into_drawtarget<D>(mut dt: D)
where
D: DrawTarget<Color = BinaryColor>,
D::Error: Debug,
{
Line::new(Point::new(2, 2), Point::new(10, 2))
.into_styled(PrimitiveStyle::with_stroke(BinaryColor::On, 2))
.draw(&mut dt)
.unwrap();
}
#[test]
fn usable_as_draw_target() {
let mut data = [BinaryColor::Off; 15 * 5];
let fbuf = FrameBuf::new(&mut data, 15, 5);
draw_into_drawtarget(fbuf)
}
#[test]
fn raw_data() {
let mut data = [Rgb565::new(1, 2, 3); 3 * 3];
let mut fbuf = FrameBuf::new(&mut data, 3, 3);
fbuf.set_color_at(Point { x: 1, y: 0 }, Rgb565::new(3, 2, 1));
let mut raw_iter = fbuf.data.iter();
assert_eq!(*raw_iter.next().unwrap(), Rgb565::new(1, 2, 3));
assert_eq!(*raw_iter.next().unwrap(), Rgb565::new(3, 2, 1));
}
#[test]
#[should_panic]
fn wrong_data_size() {
let mut data = [BinaryColor::Off; 5 * 5];
let _ = &mut FrameBuf::new(&mut data, 12, 3);
}
}