Commit dd8589c3 authored by StevenPuttemans's avatar StevenPuttemans

change as suggested by original programmer and user of ecc software

parent 573858f1
...@@ -298,11 +298,7 @@ static void update_warping_matrix_ECC (Mat& map_matrix, const Mat& update, const ...@@ -298,11 +298,7 @@ static void update_warping_matrix_ECC (Mat& map_matrix, const Mat& update, const
} }
if (motionType == MOTION_EUCLIDEAN) { if (motionType == MOTION_EUCLIDEAN) {
double new_theta = updatePtr[0]; double new_theta = updatePtr[0];
if (mapPtr[3]>0) new_theta += asin(mapPtr[3]);
new_theta += acos(mapPtr[0]);
if (mapPtr[3]<0)
new_theta -= acos(mapPtr[0]);
mapPtr[2] += updatePtr[1]; mapPtr[2] += updatePtr[1];
mapPtr[5] += updatePtr[2]; mapPtr[5] += updatePtr[2];
......
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment