| 35 | } |
| 36 | |
| 37 | void PointToPointAligningTransform::add( const Vector3d& p1, const Vector3d& p2, double w /*= 1.0*/ ) |
| 38 | { |
| 39 | sum12_ += w * outer( p1, p2 ); |
| 40 | sum1_ += w * p1; |
| 41 | sum2_ += w * p2; |
| 42 | sum11_ += w * p1.lengthSq(); |
| 43 | sumW_ += w; |
| 44 | } |
| 45 | |
| 46 | void PointToPointAligningTransform::add( const PointToPointAligningTransform & other ) |
| 47 | { |