|
| 1 | +// This file is part of OpenCV project. |
| 2 | +// It is subject to the license terms in the LICENSE file found in the top-level directory |
| 3 | +// of this distribution and at http://opencv.org/license.html. |
| 4 | + |
| 5 | +#include "precomp.hpp" |
| 6 | + |
| 7 | +namespace cv |
| 8 | +{ |
| 9 | + |
| 10 | + static inline Moments operator& ( const Moments & lhs, const Matx22d & rhs ) |
| 11 | + { |
| 12 | + return Moments ( |
| 13 | + lhs.m00, |
| 14 | + rhs ( 0, 0 ) * lhs.m10 + rhs ( 0, 1 ) * lhs.m01, |
| 15 | + rhs ( 1, 0 ) * lhs.m10 + rhs ( 1, 1 ) * lhs.m01, |
| 16 | + rhs ( 0, 0 ) * rhs ( 0, 0 ) * lhs.m20 + rhs ( 0, 1 ) * rhs ( 0, 1 ) * lhs.m02 + 2 * rhs ( 0, 0 ) * rhs ( 0, 1 ) * lhs.m11, |
| 17 | + rhs ( 0, 0 ) * rhs ( 1, 0 ) * lhs.m20 + rhs ( 0, 1 ) * rhs ( 1, 1 ) * lhs.m02 + ( rhs ( 0, 0 ) * rhs ( 1, 1 ) + rhs ( 0, 1 ) * rhs ( 1, 0 ) ) * lhs.m11, |
| 18 | + rhs ( 1, 0 ) * rhs ( 1, 0 ) * lhs.m20 + rhs ( 1, 1 ) * rhs ( 1, 1 ) * lhs.m02 + 2 * rhs ( 1, 0 ) * rhs ( 1, 1 ) * lhs.m11, |
| 19 | + rhs ( 0, 0 ) * rhs ( 0, 0 ) * rhs ( 0, 0 ) * lhs.m30 + 3 * rhs ( 0, 0 ) * rhs ( 0, 0 ) * rhs ( 0, 1 ) * lhs.m21 + 3 * rhs ( 0, 0 ) * rhs ( 0, 1 ) * rhs ( 0, 1 ) * lhs.m12 + rhs ( 0, 1 ) * rhs ( 0, 1 ) * rhs ( 0, 1 ) * lhs.m03, |
| 20 | + rhs ( 0, 0 ) * rhs ( 0, 0 ) * rhs ( 1, 0 ) * lhs.m30 + ( rhs ( 0, 0 ) * rhs ( 0, 0 ) * rhs ( 1, 1 ) + 2 * rhs ( 0, 0 ) * rhs ( 0, 1 ) * rhs ( 1, 0 ) ) * lhs.m21 + ( 2 * rhs ( 0, 0 ) * rhs ( 0, 1 ) * rhs ( 1, 1 ) + rhs ( 0, 1 ) * rhs ( 0, 1 ) * rhs ( 1, 0 ) ) * lhs.m12 + rhs ( 0, 1 ) * rhs ( 0, 1 ) * rhs ( 1, 1 ) * lhs.m03, |
| 21 | + rhs ( 0, 0 ) * rhs ( 1, 0 ) * rhs ( 1, 0 ) * lhs.m30 + ( rhs ( 1, 0 ) * rhs ( 1, 0 ) * rhs ( 0, 1 ) + 2 * rhs ( 0, 0 ) * rhs ( 1, 0 ) * rhs ( 1, 1 ) ) * lhs.m21 + ( 2 * rhs ( 0, 1 ) * rhs ( 1, 0 ) * rhs ( 1, 1 ) + rhs ( 1, 1 ) * rhs ( 1, 1 ) * rhs ( 0, 0 ) ) * lhs.m12 + rhs ( 0, 1 ) * rhs ( 1, 1 ) * rhs ( 1, 1 ) * lhs.m03, |
| 22 | + rhs ( 1, 0 ) * rhs ( 1, 0 ) * rhs ( 1, 0 ) * lhs.m30 + 3 * rhs ( 1, 0 ) * rhs ( 1, 0 ) * rhs ( 1, 1 ) * lhs.m21 + 3 * rhs ( 1, 0 ) * rhs ( 1, 1 ) * rhs ( 1, 1 ) * lhs.m12 + rhs ( 1, 1 ) * rhs ( 1, 1 ) * rhs ( 1, 1 ) * lhs.m03 |
| 23 | + ); |
| 24 | + } |
| 25 | + |
| 26 | + static inline Matx23d operator| ( const Matx22d & lhs, const Matx21d & rhs ) |
| 27 | + { |
| 28 | + return Matx23d ( lhs ( 0, 0 ), lhs ( 0, 1 ), rhs ( 0 ), lhs ( 1, 0 ), lhs ( 1, 1 ), rhs ( 1 ) ); |
| 29 | + } |
| 30 | + |
| 31 | + Matx23d PeiLinNormalization ( InputArray I ) |
| 32 | + { |
| 33 | + const Moments M = moments ( I ); |
| 34 | + const double l1 = ( M.mu20 / M.m00 + M.mu02 / M.m00 + sqrt ( ( M.mu20 / M.m00 - M.mu02 / M.m00 ) * ( M.mu20 / M.m00 - M.mu02 / M.m00 ) + 4 * M.mu11 / M.m00 * M.mu11 / M.m00 ) ) / 2; |
| 35 | + const double l2 = ( M.mu20 / M.m00 + M.mu02 / M.m00 - sqrt ( ( M.mu20 / M.m00 - M.mu02 / M.m00 ) * ( M.mu20 / M.m00 - M.mu02 / M.m00 ) + 4 * M.mu11 / M.m00 * M.mu11 / M.m00 ) ) / 2; |
| 36 | + const double ex = ( M.mu11 / M.m00 ) / sqrt ( ( l1 - M.mu20 / M.m00 ) * ( l1 - M.mu20 / M.m00 ) + M.mu11 / M.m00 * M.mu11 / M.m00 ); |
| 37 | + const double ey = ( l1 - M.mu20 / M.m00 ) / sqrt ( ( l1 - M.mu20 / M.m00 ) * ( l1 - M.mu20 / M.m00 ) + M.mu11 / M.m00 * M.mu11 / M.m00 ); |
| 38 | + const Matx22d E = Matx22d ( ex, ey, -ey, ex ); |
| 39 | + const double p = min ( I.size().height, I.size().width ) / 8; |
| 40 | + const Matx22d W = Matx22d ( p / sqrt ( l1 ), 0, 0, p / sqrt ( l2 ) ); |
| 41 | + const Matx21d c = Matx21d ( M.m10 / M.m00, M.m01 / M.m00 ); |
| 42 | + const Matx21d i = Matx21d ( I.size().width / 2, I.size().height / 2 ); |
| 43 | + const Moments N = M & W * E; |
| 44 | + const double t1 = N.mu12 + N.mu30; |
| 45 | + const double t2 = N.mu03 + N.mu21; |
| 46 | + const double phi = atan2 ( -t1, t2 ); |
| 47 | + const double psi = ( -t1 * sin ( phi ) + t2 * cos ( phi ) >= 0 ) ? phi : ( phi + CV_PI ); |
| 48 | + const Matx22d A = Matx22d ( cos ( psi ), sin ( psi ), -sin ( psi ), cos ( psi ) ); |
| 49 | + return ( A * W * E ) | ( i - A * W * E * c ); |
| 50 | + } |
| 51 | + |
| 52 | + void PeiLinNormalization ( InputArray I, OutputArray T ) |
| 53 | + { |
| 54 | + T.assign ( Mat ( PeiLinNormalization ( I ) ) ); |
| 55 | + } |
| 56 | + |
| 57 | +} |
0 commit comments