|
|
@ -80,9 +80,9 @@ struct WrapAff |
|
|
|
WrapAff(const Mat& aff) : F(aff.ptr<double>()) {} |
|
|
|
WrapAff(const Mat& aff) : F(aff.ptr<double>()) {} |
|
|
|
Point3f operator()(const Point3f& p) |
|
|
|
Point3f operator()(const Point3f& p) |
|
|
|
{ |
|
|
|
{ |
|
|
|
return Point3d( p.x * F[0] + p.y * F[1] + p.z * F[2] + F[3], |
|
|
|
return Point3f( (float)(p.x * F[0] + p.y * F[1] + p.z * F[2] + F[3]), |
|
|
|
p.x * F[4] + p.y * F[5] + p.z * F[6] + F[7], |
|
|
|
(float)(p.x * F[4] + p.y * F[5] + p.z * F[6] + F[7]), |
|
|
|
p.x * F[8] + p.y * F[9] + p.z * F[10] + F[11] ); |
|
|
|
(float)(p.x * F[8] + p.y * F[9] + p.z * F[10] + F[11]) ); |
|
|
|
} |
|
|
|
} |
|
|
|
}; |
|
|
|
}; |
|
|
|
|
|
|
|
|
|
|
|