change as suggested by original programmer and user of ecc software

This commit is contained in:
StevenPuttemans 2015-08-06 14:59:15 +02:00
parent 573858f134
commit dd8589c352

View File

@ -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];