mirror of
https://github.com/saymrwulf/xous-core.git
synced 2026-11-19 09:00:54 +00:00
debug fixed point underflow issue
This commit is contained in:
parent
fc95e8b7b3
commit
0bad04856b
1 changed files with 18 additions and 4 deletions
|
|
@ -52,7 +52,7 @@ pub fn find_homography(src_points: [(f32, f32); 4], dst_points: [(f32, f32); 4])
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
const HOM_FP_SHIFT: i32 = 16;
|
const HOM_FP_SHIFT: i32 = 18;
|
||||||
const HOM_FP_SCALE: i32 = 1 << HOM_FP_SHIFT;
|
const HOM_FP_SCALE: i32 = 1 << HOM_FP_SHIFT;
|
||||||
|
|
||||||
pub fn matrix3_to_fixp(h: Matrix3<f32>) -> Matrix3<i32> {
|
pub fn matrix3_to_fixp(h: Matrix3<f32>) -> Matrix3<i32> {
|
||||||
|
|
@ -78,8 +78,22 @@ pub fn apply_fixp_homography(homography: &Matrix3<i32>, point: (i32, i32)) -> (i
|
||||||
let tw = homography[(2, 0)] * x + homography[(2, 1)] * y + homography[(2, 2)];
|
let tw = homography[(2, 0)] * x + homography[(2, 1)] * y + homography[(2, 2)];
|
||||||
|
|
||||||
// Normalize by w to get the final coordinates
|
// Normalize by w to get the final coordinates
|
||||||
let x_transformed = tx / tw;
|
if tw != 0 {
|
||||||
let y_transformed = ty / tw;
|
let x_transformed = tx / tw;
|
||||||
|
let y_transformed = ty / tw;
|
||||||
|
|
||||||
(x_transformed, y_transformed)
|
(x_transformed, y_transformed)
|
||||||
|
} else {
|
||||||
|
log::info!(
|
||||||
|
"Homography transformation would divide by 0: possible fixed-point underflow!\n\r {}, {}\n\r {} * {} + {} * {} + {}",
|
||||||
|
tx,
|
||||||
|
ty,
|
||||||
|
homography[(2, 0)],
|
||||||
|
x,
|
||||||
|
homography[(2, 1)],
|
||||||
|
y,
|
||||||
|
homography[(2, 2)]
|
||||||
|
);
|
||||||
|
(0, 0)
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
|
||||||
Loading…
Reference in a new issue