mirror of
https://github.com/saymrwulf/xous-core.git
synced 2026-11-18 08:52:45 +00:00
add affine skew correction step
This commit is contained in:
parent
407dec86a3
commit
b3f038ca06
1 changed files with 50 additions and 11 deletions
|
|
@ -1,4 +1,5 @@
|
||||||
// dev code for QR code algorithms
|
// dev code for QR code algorithms
|
||||||
|
use cramium_hal::minigfx::Point;
|
||||||
|
|
||||||
const SEQ_LEN: usize = 5;
|
const SEQ_LEN: usize = 5;
|
||||||
|
|
||||||
|
|
@ -22,15 +23,6 @@ struct FinderSeq {
|
||||||
pub color: Color,
|
pub color: Color,
|
||||||
}
|
}
|
||||||
|
|
||||||
#[derive(Copy, Clone, PartialEq, Eq, Debug)]
|
|
||||||
pub struct Point {
|
|
||||||
pub x: usize,
|
|
||||||
pub y: usize,
|
|
||||||
}
|
|
||||||
impl Point {
|
|
||||||
pub fn new(x: usize, y: usize) -> Self { Point { x, y } }
|
|
||||||
}
|
|
||||||
|
|
||||||
#[derive(Copy, Clone, PartialEq, Eq, Debug)]
|
#[derive(Copy, Clone, PartialEq, Eq, Debug)]
|
||||||
enum Color {
|
enum Color {
|
||||||
Black,
|
Black,
|
||||||
|
|
@ -45,6 +37,53 @@ impl Default for Color {
|
||||||
fn default() -> Self { Color::Black }
|
fn default() -> Self { Color::Black }
|
||||||
}
|
}
|
||||||
|
|
||||||
|
const AFF_FP_SHIFT: isize = 16;
|
||||||
|
const AFF_FP_ONE: f32 = (1 << AFF_FP_SHIFT) as f32;
|
||||||
|
pub struct AffineTransform {
|
||||||
|
pub a: isize,
|
||||||
|
pub b: isize,
|
||||||
|
pub c: isize,
|
||||||
|
pub d: isize,
|
||||||
|
pub tx: isize,
|
||||||
|
pub ty: isize,
|
||||||
|
pub rows: isize,
|
||||||
|
pub cols: isize,
|
||||||
|
}
|
||||||
|
|
||||||
|
impl AffineTransform {
|
||||||
|
pub fn from_coordinates(tl: Point, tr: Point, cols: usize, rows: usize) -> Self {
|
||||||
|
// crate::println!("{}/{}", tr.y - tl.y, tr.x - tl.x);
|
||||||
|
let angle: f32 = libm::atan2f(tr.y as f32 - tl.y as f32, tr.x as f32 - tl.x as f32);
|
||||||
|
// crate::println!("angle: {}", angle);
|
||||||
|
Self {
|
||||||
|
a: (libm::cosf(angle) * AFF_FP_ONE) as isize,
|
||||||
|
b: (-libm::sinf(angle) * AFF_FP_ONE) as isize,
|
||||||
|
c: (libm::sinf(angle) * AFF_FP_ONE) as isize,
|
||||||
|
d: (libm::cosf(angle) * AFF_FP_ONE) as isize,
|
||||||
|
tx: 0,
|
||||||
|
ty: 0,
|
||||||
|
cols: cols as isize,
|
||||||
|
rows: rows as isize,
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
pub fn transform(&self, src: &[u8], dst: &mut [core::mem::MaybeUninit<u8>]) {
|
||||||
|
for y in 0..self.rows as usize {
|
||||||
|
for x in 0..self.cols as usize {
|
||||||
|
let x_src = (self.a * x as isize + self.b * y as isize + self.tx) >> AFF_FP_SHIFT;
|
||||||
|
let y_src = (self.c * x as isize + self.d * y as isize + self.ty) >> AFF_FP_SHIFT;
|
||||||
|
dst[y * self.cols as usize + x] = core::mem::MaybeUninit::new(
|
||||||
|
if x_src >= 0 && x_src < self.cols && y_src >= 0 && y_src < self.rows {
|
||||||
|
src[x_src as usize + y_src as usize * self.cols as usize]
|
||||||
|
} else {
|
||||||
|
0
|
||||||
|
},
|
||||||
|
);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
struct SeqBuffer {
|
struct SeqBuffer {
|
||||||
buffer: [Option<FinderSeq>; 5],
|
buffer: [Option<FinderSeq>; 5],
|
||||||
start: usize,
|
start: usize,
|
||||||
|
|
@ -158,7 +197,7 @@ pub fn find_finders(candidates: &mut [Option<Point>], image: &[u8], thresh: u8,
|
||||||
// manage the sequence index
|
// manage the sequence index
|
||||||
if let Some(pos) = seq_buffer.search() {
|
if let Some(pos) = seq_buffer.search() {
|
||||||
// crate::println!("row candidate {}, {}", pos, y);
|
// crate::println!("row candidate {}, {}", pos, y);
|
||||||
row_candidates[row_candidate_index] = Some(Point::new(pos, y));
|
row_candidates[row_candidate_index] = Some(Point::new(pos as _, y as _));
|
||||||
row_candidate_index += 1;
|
row_candidate_index += 1;
|
||||||
if row_candidate_index == row_candidates.len() {
|
if row_candidate_index == row_candidates.len() {
|
||||||
// just abort the search if we run out of space to store results
|
// just abort the search if we run out of space to store results
|
||||||
|
|
@ -189,7 +228,7 @@ pub fn find_finders(candidates: &mut [Option<Point>], image: &[u8], thresh: u8,
|
||||||
last_color = pix;
|
last_color = pix;
|
||||||
run_length = 1;
|
run_length = 1;
|
||||||
if let Some(pos) = seq_buffer.search() {
|
if let Some(pos) = seq_buffer.search() {
|
||||||
let search_point = Point::new(x, pos);
|
let search_point = Point::new(x as _, pos as _);
|
||||||
// crate::println!("col candidate {}, {}", x, pos);
|
// crate::println!("col candidate {}, {}", x, pos);
|
||||||
|
|
||||||
// now cross the candidate against row candidates; only report those that match
|
// now cross the candidate against row candidates; only report those that match
|
||||||
|
|
|
||||||
Loading…
Reference in a new issue