# Patent

## Title
Method for estimating rotation axis and mass center of spatial target based on binocular optical flows

## Abstract

A method for estimating a rotation axis and a mass center of a spatial target based on binocular optical flows. The method includes: extracting feature points from binocular image sequences sequentially and respectively, and calculating binocular optical flows formed thereby; removing areas ineffective for reconstructing a three-dimensional movement trajectory from the binocular optical flows of the feature points, whereby obtaining effective area-constrained binocular optical flows, and reconstructing a three-dimensional movement trajectory of a spatial target; and removing areas with comparatively large errors in reconstructing three-dimensional motion vectors from the optical flows by multiple iterations, estimating a rotation axis according to a three-dimensional motion vector sequence of each of the feature points obtained thereby, obtaining a spatial equation of an estimated rotation axis by weighted average of estimated results of the feature points, and obtaining spatial coordinates of a mass center of the target according to two estimated rotation axes.

## Background
CROSS-REFERENCE TO RELATED APPLICATIONS
This application is a continuation-in-part of International Patent Application No. PCT/CN2014/085886 with an international filing date of Sep. 4, 2014, designating the United States, now pending, and further claims priority benefits to Chinese Patent Application No. 201310736940.2 filed Dec. 26, 2013. The contents of all of the aforementioned applications, including any intervening amendments thereto, are incorporated herein by reference. Inquiries from the public to applicants or assignees concerning this document or the related applications should be directed to: Matthias Scholl P.C., Attn.: Dr. Matthias Scholl Esq., 245 First Street, 18th Floor, Cambridge, Mass. 02142.


BACKGROUND OF THE INVENTION
1. Field of the Invention
The invention relates to a robust method for estimating a rotation axis and a mass center of a spatial target based on binocular optical flows.
2. Description of the Related Art
It is one of the basic tasks for computer vision to calculate information of structure, position and motion of a target in a three-dimensional space according to two-dimensional image information obtained by cameras, and to reconstruct, identify and track the target thereby, where trajectory of each of the feature points on surface of the spatial target corresponds to a corresponding feature point in each image of an image sequence. Detection, identification and tracking of a spatial target followed by motion analysis and attitude estimation thereby are required for spatial tasks such as space rendezvous and docking of spacecrafts, fly-around and accompanying flying of a dual-satellite formation, and accompanying flying and navigation of a multi-satellite formation. Therefore, vision systems and algorithms featuring in high accuracy, external information independence, and excellent perception of complex environments are in urgent need to reconstruct attitude and trajectory of a spatial target, and highly accurate quantitative measurement should be performed on structure, trajectory, spatial position, and three-dimensional attitude of the target. Image sequence-based analysis is an important method for obtaining the information, however, reconstruction methods in prior art are limited in many ways for existence of areas ineffective for reconstructing three-dimensional motion vectors in an optical flow in a reconstruction process by binocular optical flows as a result of discretization errors, and it is critical to improve accuracy and stability of detection, tracking and reconstruction of a spatial target. There is provided a robust method for estimating a rotation axis and a mass center of a spatial target based on binocular optical flows, which is capable of improving accuracy of tracking and reconstruction of a trajectory of a spatial target effectively and reconstructing motion information of the spatial target accurately.
Motion structure reconstruction is a theory and a method for research in obtaining information of structure, position and motion of a target in a scenario from image sequences of the scenario, which is widely used in fields of robot navigation, automotive intelligent transportation, non-contact measurement of an object, etc. In unknown environments, autonomous navigation, such as robot navigation, space satellite tracking formation, etc., has technical difficulties not only in avoiding stationary objects, but also in adapting to a changing environment, and tracking, detecting and avoiding moving objects. On many occasions, a vision system is required to track and detect unknown objects automatically, and to realize close observation of properties and relative navigation of the unknown target, where it is critical to estimate a relative position and a relative attitude between a vision system and a target, and establish a motion equation of relative navigation. Therefore, mass center or a rotation axis of a target should be estimated first.
Errors may exist in reconstruction process in a conventional method for estimating a rotation axis and a mass center of a spatial target based on binocular optical flows, which does not analyze reasons for the errors and does not provide a corresponding solution. However, the present invention analyzes the existing problems and provides a solution.
SUMMARY OF THE INVENTION
In view of the above-mentioned problems, it is an objective of the invention to provide a robust method for estimating a rotation axis and a mass center of a spatial target based on binocular optical flows under the condition of not knowing any prior information of a target, which obtains time-based image sequences of a scenario by binocular cameras, extracts feature points of a target in the scenario from the image sequences of the scenario, obtains binocular optical flows for each feature point, removing areas ineffective for reconstructing three-dimensional motion vectors form the binocular optical flows, obtains effective area-constrained binocular optical flows, reconstructs real three-dimensional motion vectors of the target by multiple iterations, and estimates a rotation axis and mass center of the target. Rotation of a spatial object may happen in the following two cases: a spin-stabilized satellite and an attitude adjusting satellite.
Assume an object rotates around two different axes in two different time periods T1 and T2. As both axes pass through mass center of the object according to dynamics law, mass center of the object may be obtained by estimating positions of the two axes and calculating an intersection point thereof. Specific steps are as follows:
(1) extracting feature points from a stereo image pair respectively;
(2) calculating binocular optical flows formed by feature points in image sequences sequentially;
(3) removing areas ineffective for reconstructing a three-dimensional movement trajectory from the binocular optical flows of the feature points thereby obtaining effective area-constrained binocular optical flows;
(4) reconstructing a three-dimensional movement trajectory of each of the feature points according to the effective area-constrained binocular optical flows thereof obtained in step (3);
(5) calculating a normal vector of a three-dimensional movement trajectory plane of each of the feature points, calculating a cosine distance between the normal vector of each of the feature points and a direction vector of each segment of the trajectory thereof sequentially, and removing a segment of the trajectory of each of the feature points with a maximum modulus of cosine distance;
(6) recalculating a normal vector of a trajectory plane of each of the feature points according to the residual trajectory thereof, calculating a cosine distance between the two normal vectors of each of the feature points, determining whether the cosine distance between the two normal vectors of each of the feature points is greater than a preset cosine distance threshold, and returning to step (5) and performing calculation according to the residual trajectory of each of the feature points if yes;
(7) estimating a trajectory plane of each of the feature points and center and radius of the trajectory thereof;
(8) performing weighted average on normal vectors of the trajectory planes and on centers of the trajectories respectively according to the radius of the trajectory of each of the feature points, whereby obtaining a spatial equation of a final rotation axis; and
(9) repeating steps (1)-(8) when the rotation axis of the spatial target changes, whereby obtaining a spatial equation of a second rotation axis, and combining the spatial equation of the second rotation axis with that of the former rotation axis, whereby calculating coordinate of mass center of the spatial target.
The present invention provides a method for estimating a rotation axis and a mass center of a spatial target, which reconstructs trajectory of the spatial target accurately by using feature points obtained by detection algorithms for edges, lines and corners as optical flow tracking points without marking the spatial object. Optical flows are formed in a left camera and a right camera respectively during rotation of a target. The present invention extracts binocular optical flows effective for reconstructing three-dimensional motion vectors, reconstructs three-dimensional motion vectors for each of the feature points according to effective area-constrained binocular optical flows, fits out a three-dimensional movement trajectory for each of the feature points according to a series of three-dimensional motion vectors thereof, removes areas with comparatively large errors from optical flow trajectories by multiple iterations, and reconstructs a three-dimensional movement trajectory for each of the feature points fitted out by three-dimensional motion vectors thereof. As optical flows formed on imaging planes of two sensors are different for a feature point during rotation of an object, the present invention reconstructs three-dimensional motion vectors for each of the feature points according to the differences, fits out a three-dimensional movement trajectory for each of the feature points by a series of three-dimensional motion vectors thereof, performs weighted averaging on normal vectors of trajectory planes of the feature points and on centers of the trajectories thereof respectively, obtains a spatial equation of a rotation axis in a current spinning process, and estimates another rotation axis in another time period by the same method. As a rotation axis passes through mass center of a spinning object according to dynamics law, spatial coordinates of mass center of the object may be obtained by calculating an intersection point of two rotation axes in two time periods.



BRIEF DESCRIPTION OF THE DRAWINGS
FIG. 1 is a flow chart of a method for estimating a rotation axis and a mass center of a spatial target according to the present invention;
FIG. 2 illustrates a module of a three-dimensional motion vector being projected onto a binocular imaging system;
FIG. 3 illustrates an arc trajectory of a feature point;
FIG. 4 is a schematic diagram of reconstructing a three-dimensional movement trajectory of a target by binocular optical flows thereof;
FIG. 5 is a schematic diagram of an inflection point being caused by an area ineffective for reconstruction in an optical flow trajectory;
FIG. 6 is a schematic diagram illustrating influence of inflection points in an estimated spatial trajectory of a feature point on estimation of a rotation axis;
FIG. 7 is a schematic diagram of four feature points detected in a time period T1;
FIG. 8A illustrates a schematic diagram of a trajectory of a feature point A estimated by optical flows calculated by every other frame (the solid line) compared with a real arc trajectory thereof (the dotted line) when a target rotates around a first rotation axis;
FIG. 8B illustrates a schematic diagram of a trajectory of a feature point B estimated by optical flows calculated by every other frame (the solid line) compared with a real arc trajectory thereof (the dotted line) when the target rotates around the first rotation axis;
FIG. 8C illustrates a schematic diagram of a trajectory of a feature point C estimated by optical flows calculated by every other frame (the solid line) compared with a real arc trajectory thereof (the dotted line) when the target rotates around the first rotation axis;
FIG. 8D illustrates a schematic diagram of a trajectory of a feature point D estimated by optical flows calculated by every other frame (the solid line) compared with a real arc trajectory thereof (the dotted line) when the target rotates around the first rotation axis;
FIG. 9 illustrates a schematic diagram of an estimated rotation axis L′ (the dotted line) compared with a real rotation axis L (the solid line) when the target rotates around the first rotation axis;
FIG. 10 illustrates a schematic diagram of an ideal three-dimensional movement trajectory formed by a spinning spatial target;
FIG. 11A illustrates a left image out of image sequences of a scenario captured by binocular cameras;
FIG. 11B illustrates a right image out of image sequences of the scenario captured by binocular cameras;
FIGS. 12A and 12B illustrate optical flows obtained by image sequences of a rotational target captured by a stereo camera and areas ineffective for reconstruction thereof;
FIG. 13 illustrates a schematic diagram of motion vectors of a three-dimensional movement trajectory of the target reconstructed by binocular optical flows containing areas ineffective for reconstruction;
FIG. 14 illustrates an analytical schematic diagram of X, Y and Z components of a trajectory reconstructed by binocular optical flows without removing areas ineffective for reconstruction thereof;
FIG. 15 illustrates a schematic diagram of motion vectors of a three-dimensional movement trajectory of the target reconstructed by binocular optical flows after removing areas ineffective for reconstruction thereof;
FIG. 16 illustrates a schematic diagram of a trajectory reconstructed by removing areas ineffective for reconstruction or with comparatively large errors from binocular optical flows via iterative calculation;
FIGS. 17A and 17B illustrate optical flows obtained by image sequences of a rotational target captured by a stereo camera and multiple areas ineffective for reconstruction thereof;
FIG. 18 illustrates a schematic diagram of motion vectors of a three-dimensional movement trajectory of the target reconstructed by binocular optical flows containing areas ineffective for reconstruction thereof;
FIG. 19 illustrates an analytical schematic diagram of X, Y and Z components of a trajectory reconstructed by binocular optical flows containing multiple areas ineffective for reconstruction;
FIG. 20 illustrates a schematic diagram of a trajectory reconstructed by removing areas ineffective for reconstruction or with comparatively large errors from binocular optical flows via iterative calculation; and
FIG. 21 illustrates results of estimating rotation axes and mass center of the target.



DETAILED DESCRIPTION OF THE EMBODIMENTS
For clear understanding of the objectives, features and advantages of the invention, detailed description of the invention will be given below in conjunction with accompanying drawings and specific embodiments. It should be noted that the embodiments are only meant to explain the invention, and not to limit the scope of the invention.
Related concepts and terminologies are illustrated first for better understanding of the present invention, comprising three coordinate systems in machine vision: image coordinate system (U,V), camera coordinate system and spatial coordinate system, where image data captured by machine vision are illustrated by an image coordinate system, namely row and column locations of pixels of an image, objective locations and sizes of measured objects and interrelations therebetween are illustrated by a spatial coordinate system, and the two coordinate systems are transformed by a camera coordinate system.
1. Image Coordinate System
Digital image captured by a camera can be stored as an array in a computer, where value of each element of the array represents brightness of an image point. Define a rectangular coordinate system U-V on an image, where coordinate of each pixel thereof (U, V) is represented by column number and row number of the pixel in the array. Therefore, (U, V) represents a coordinate of a pixel in the image coordinate system, where an origin O, a main point of the image, is defined as intersection of optical axis of the camera and the image plane.
2. Camera Coordinate System
Geometric relationship of imaging by cameras is shown in FIG. 2, where O1 and O2 are optical centers of a left camera and a right camera respectively; axes X1 and Y1 are parallel with axes U1 and V1 of an imaging plane coordinate system respectively, axis Z1 is optical axis of the left camera and is perpendicular to the image plane, and intersection of the optical axis and the image plane is a main point of the image O1′; and axes X2 and Y2 are parallel with axes U2 and V2 of another imaging plane coordinate system respectively, axis Z2 is an optical axis of the right camera and is perpendicular to the image plane, and intersection of the optical axis and the image plane is a main point of the image O2′. A rectangular coordinate system formed by the point O1, and the axes X1, Y1 and Z1 is called as left camera coordinate system, where O1O1′ is focal length of the left camera, and a rectangular coordinate system formed by the point O2, and the axes X2, Y2 and Z2 is called as right camera coordinate system, where O2O2′ is focal length of the right camera.
3. Spatial Coordinate System
Spatial coordinate system is a reference coordinate system chosen to illustrate locations of cameras and objects in an environment. Relationship between a camera coordinate system and a spatial coordinate system may be illustrated by a rotation matrix and a translation vector. The left camera coordinate system is used as a spatial coordinate system hereafter.
In one embodiment of the present invention, a binocular stereo vision system formed by visible binocular cameras is used to capture a spinning target. An overall flow chart is shown in FIG. 1.
Feature points of a spatial target (such as corners, edge points, inflections, bright points in a dark area and dark points in a bright area) generate two-dimensional projections of a trajectory thereof on imaging planes of binocular cameras, and those two-dimensional projections of the three-dimensional movement trajectory on the imaging planes are called as optical flows, and optical flows formed on two cameras by a same feature point are called as optical flow stereo pair. The method of the present invention is to estimate trajectory of a spatial target accurately by optical flow stereo pairs formed on binocular cameras by multiple feature points of the spinning target.
(1) Extracting feature points from a stereo image pair respectively.
A spatial target is rich in surface structures containing a large number of point primitives and line primitives. For example, geometry of a star body may be a prism, a cube or an octahedron, and solar panels are generally cuboid. Many targets are formed by lines or curves, where line is one of the most basic geometric units for composing a target, and many artificial targets are composed by basic geometries such as cubes and columns formed by parallel lines and vertical lines. Feature points of a target can be detected by extracting edge information of the target by edge operators, and by detecting line segments according to Hough transform and calculating intersections of adjacent line segments. Harris corner detection algorithm or SUSAN corner detection algorithm can also be used as a supplementary means for corner detection of the target to improve accuracy of feature point detection.
(2) Calculating binocular optical flows formed by feature points in image sequences sequentially.
Generally, time-based image sequences of a scenario are obtained while rotating the target at a uniform speed, and feature points obtained by step (1) are used as optical flow tracking points. Binocular optical flows formed by feature points in image sequences are obtained by calculating feature points in each frame of the image sequences sequentially, where a comparatively large or small optical flow may be obtained by controlling the rotation speed, which may be adjusted according to a specific situation in practice.
(3) Removing areas ineffective for reconstructing a three-dimensional movement trajectory from the binocular optical flows of the feature points thereby obtaining effective area-constrained binocular optical flows.
Optical flows, generated by three-dimensional motion vectors projected onto imaging planes of two cameras, are unable to reconstruct three-dimensional motion vectors accurately and effectively or cause comparatively large loss of information in reconstruction at certain moments, which leads to comparatively large reconstruction errors, where local errors may seriously affect following analysis and estimation of movement of the target and corresponding areas are ineffective for reconstructing three-dimensional motion vectors. Therefore, optical flow segments ineffective for reconstructing three-dimensional motion vectors should be removed in reconstructing spatial trajectories of three-dimensional motion vectors, whereby obtaining effective area-constrained binocular optical flows.
As in FIG. 2, P is projection of a point P on an imaging plane of a left camera, P′1 is projection of a point P′ on an imaging plane of the left camera, and {right arrow over (P1P′1)} is an optical flow generated by a three-dimensional motion vector {right arrow over (PP′)} projected onto imaging plane of the left camera. Similarly, {right arrow over (P2P′2)} is an optical flow generated by PP′ projected onto imaging plane of a right camera.
In an imaging plane coordinate system O′1U1V1 of the left camera, (U1,V1) represent coordinate of P1 and (U′1,V′1) represent coordinate of P′1. In an imaging plane coordinate system O′2U2V2 of the right camera, (U2,V2) represent coordinate of P2 and (U′2,V′2) represent coordinate of P′2.
Slope and intercept of a line passing through an optical flow may be calculated. Assume slope and intercept of l1 are k1 and m1 respectively, and slope and intercept of l2 are k2 and m2 respectively (slope is defined as




  k
  =
  
    
      Δ
      ⁢
      
        
      
      ⁢
      u
    
    
      Δ
      ⁢
      
        
      
      ⁢
      v
    
  




herein), therefore, l1 and l2 may be expressed by the following equations:

l1:U1−k1V1=m1 and

l2:U2−k2V2=m2.

When no parallax occurs in a direction U for an optical flow, Δu=0 and therefore k1=k2=0; and when no parallax occurs in a direction V for an optical flow, Δv=0 and therefore k1=k2=∞. It is impossible to reconstruct motion vectors of a feature point of the target by the optical flow segment under the above two conditions. As shown in FIG. 5, it is obvious that an inflection point exists in a trajectory reconstructed by binocular optical flows without removing an area ineffective for reconstructing the three-dimensional movement trajectory, which is labeled as A.
Assume an optical flow of a left image sequence is P1P′1, P′1P′′1, P′′1P′′′1 . . . P1(n−1)P1(n) and an optical flow of a right image sequence is P2P′2, P′2P′′2, P′′2P′′′2 . . . P2(n−1)P2(n) for the feature point P of the target, calculate difference in the direction U and the direction V respectively for each segment of the optical flows P1(i−1)P1(i) and P2(i−1)P2(i), where i=1, 2 . . . n, and remove any segment of the optical flows P1(i−1)P1(i) and P2(i−1)P2(i) with a difference of 0 in the direction U or the direction V.
(4) Reconstructing a three-dimensional movement trajectory of each of the feature points according to the effective area-constrained binocular optical flows thereof obtained in step (3).
FIG. 2 shows a module of a three-dimensional motion vector being projected onto a binocular imaging system, where a target rotates around a rotation axis and is shown in solid lines and dotted line before and after the rotation respectively, a point P corresponds to a point P′ after rotation, and {right arrow over (PP′)} is a three-dimensional motion vector of a feature point of the target.
O1X1Y1Z1 represents a left camera coordinate system, O2X2Y2Z2 represents a right camera coordinate system, O′1U1V1 represents imaging plane coordinate system of the left camera and is parallel with a plane O1X1Y1, and O′2U2V2 represents imaging plane coordinate system of the right camera and is parallel with a plane O2X2Y2. Both cameras are based on pinhole module, where O1 and O2 are pinholes of the left camera and the right camera respectively, and O1O′1 and O2O′2 are focal lengths of the left camera and the right camera respectively, both of which equal f. Optical axes O1Z1 and O2Z2 of the two cameras are parallel, and a baseline distance therebetween O1O2 equals b.
Generally, a spatial coordinate system is defined overlapping with the left camera coordinate system O2X1Y1Z1 for convenience of calculation. Therefore, no rotation or translation occurs for the left camera coordinate system relative to the spatial coordinate system, while only a parallel movement occurs for the right camera coordinate system relative to the spatial coordinate system and the offset is the baseline distance of the two cameras b.
P1 is projection of the point P on an imaging plane of the left camera, P′1 is projection of the point P′ on an imaging plane of the left camera, and {right arrow over (P1P′1)} is an optical flow segment generated by a three-dimensional motion vector {right arrow over (PP′ )}projected onto imaging plane of the left camera. Similarly, {right arrow over (P2P′2)} is an optical flow segment generated by {right arrow over (PP′ )}projected onto imaging plane of the right camera.
Coordinates of P1 and P′1 are (U1,V1) and (U′1,V′1) respectively in imaging plane coordinate system O′1U1V1 of the left camera, coordinates of P2 and P′2 are (U2,V2) and (U′2,V′2) respectively in imaging plane coordinate system O′2U2V2 of the right camera, and coordinates of P and P′ are (X,Y,Z) and (X′,Y′,Z′) respectively in the spatial coordinate system.
The following equations may be obtained according to pinhole module of the cameras:




  
    
      
        
          
            
              {
              
                
                  
                    
                      
                        U
                        1
                      
                      =
                      
                        X
                        ⁢
                        
                          
                            
                              
                            
                            ⁢
                            
                              f
                              
                                x
                                ⁢
                                
                                  
                                
                                ⁢
                                1
                              
                            
                          
                          Z
                        
                      
                    
                  
                
                
                  
                    
                      
                        V
                        1
                      
                      =
                      
                        Y
                        ⁢
                        
                          
                            
                              
                            
                            ⁢
                            
                              f
                              
                                x
                                ⁢
                                
                                  
                                
                                ⁢
                                1
                              
                            
                          
                          Z
                        
                      
                    
                  
                
              
            
          
          
            
              {
              
                
                  
                    
                      
                        U
                        1
                        ′
                      
                      =
                      
                        
                          X
                          ′
                        
                        ⁢
                        
                          
                            
                              
                            
                            ⁢
                            
                              f
                              
                                x
                                ⁢
                                
                                  
                                
                                ⁢
                                1
                              
                            
                          
                          
                            Z
                            ′
                          
                        
                      
                    
                  
                
                
                  
                    
                      
                        V
                        1
                        ′
                      
                      =
                      
                        
                          Y
                          ′
                        
                        ⁢
                        
                          
                            
                              
                            
                            ⁢
                            
                              f
                              
                                x
                                ⁢
                                
                                  
                                
                                ⁢
                                1
                              
                            
                          
                          
                            Z
                            ′
                          
                        
                      
                    
                  
                
              
            
          
        
      
    
    
      
        (
        1
        )
      
    
  
  
    
      
        
          
            
              {
              
                
                  
                    
                      
                        U
                        2
                      
                      =
                      
                        
                          (
                          
                            X
                            -
                            
                              b
                              0
                            
                          
                          )
                        
                        ⁢
                        
                          
                            f
                            
                              
                                x
                                ⁢
                                
                                  
                                
                                ⁢
                                2
                              
                              ⁢
                              
                                
                              
                            
                          
                          Z
                        
                      
                    
                  
                
                
                  
                    
                      
                        V
                        2
                      
                      =
                      
                        Y
                        ⁢
                        
                          
                        
                        ⁢
                        
                          
                            f
                            
                              y
                              ⁢
                              
                                
                              
                              ⁢
                              2
                            
                          
                          Z
                        
                      
                    
                  
                
              
            
          
          
            
              {
              
                
                  
                    
                      
                        U
                        2
                        ′
                      
                      =
                      
                        
                          (
                          
                            
                              X
                              ′
                            
                            -
                            
                              b
                              0
                            
                          
                          )
                        
                        ⁢
                        
                          
                            f
                            
                              
                                x
                                ⁢
                                
                                  
                                
                                ⁢
                                2
                              
                              ⁢
                              
                                
                              
                            
                          
                          
                            Z
                            ′
                          
                        
                      
                    
                  
                
                
                  
                    
                      
                        V
                        2
                        ′
                      
                      =
                      
                        
                          Y
                          ′
                        
                        ⁢
                        
                          
                        
                        ⁢
                        
                          
                            f
                            
                              y
                              ⁢
                              
                                
                              
                              ⁢
                              2
                            
                          
                          
                            Z
                            ′
                          
                        
                      
                    
                  
                
              
            
          
        
      
    
    
      
        (
        2
        )
      
    
  




An equation of a line passing through {right arrow over (P1P′1)} in the coordinate system O′1U1V1 is as follows:




  
    
      
        V
        =
        
          
            
              
                
                  V
                  1
                
                -
                
                  V
                  1
                  ′
                
              
              
                
                  U
                  1
                
                -
                
                  U
                  1
                  ′
                
              
            
            ⁢
            
              (
              
                U
                -
                
                  U
                  1
                
              
              )
            
          
          +
          
            V
            1
          
        
      
    
    
      
        (
        3
        )
      
    
  




An equation of a line passing through {right arrow over (P2P′2)} in the coordinate system O′2U2V2 is as follows:




  
    
      
        V
        =
        
          
            
              
                
                  V
                  2
                
                -
                
                  V
                  2
                  ′
                
              
              
                
                  U
                  2
                
                -
                
                  U
                  2
                  ′
                
              
            
            ⁢
            
              (
              
                U
                -
                
                  U
                  2
                
              
              )
            
          
          +
          
            V
            2
          
        
      
    
    
      
        (
        4
        )
      
    
  




An equation of a line passing through the three-dimensional motion vector {right arrow over (PP′)} in the spatial coordinate system is as follows:




  
    
      
        {
        
          
            
              
                
                  x
                  =
                  
                    az
                    +
                    p
                  
                
              
            
            
              
                
                  y
                  =
                  
                    bz
                    +
                    q
                  
                
              
            
          
          ,
          
            (
            
              q
              ≠
              0
            
            )
          
        
      
    
    
      
        (
        5
        )
      
    
  




Assume l1 is a line passing through the optical flow segment {right arrow over (P1P′1)} on an imaging plane of the left camera, and l2 is a line passing through the optical flow segment {right arrow over (P2P′2)} on an imaging plane of the right camera. According to equations (3), (4) and (5), equations of l1 and l2 in respective imaging plane coordinate systems are as follows:

l1:qfy1U1−pfx1V1=(aq−bp)fx1fy1  (6)

l2:qfy2U2−(p−b0)fx2V2=[aq−b(p−b0)]fx2fy2  (7)

where b0 is a baseline length between the left camera and the right camera, fx1 and fy1 are equivalent focal lengths of the left camera in a direction X and a direction Y respectively, and fx2 and fy2 are equivalent focal lengths of the right camera in the direction X and the direction Y respectively.
Since optical flows may be detected directly in image sequences, slope and intercept of a line passing through an optical flow segment may be calculated. Assume slope and intercept of l1 are k1 and m1 respectively, and slope and intercept of l2 are k2 and m2 respectively (slope is defined as




  k
  =
  
    
      Δ
      ⁢
      
        
      
      ⁢
      u
    
    
      Δ
      ⁢
      
        
      
    
  




herein), therefore, l1 and l2 may be expressed by the following equations:

l1:U1−k1V1=m1  (8)

l2:U2−k2V2=m2  (9)

The following equations may be obtained according to equations (6)-(9):




  
    
      
        {
        
          
            
              
                
                  k
                  1
                
                =
                
                  
                    pf
                    
                      x
                      ⁢
                      
                        
                      
                      ⁢
                      1
                    
                  
                  
                    qf
                    
                      y
                      ⁢
                      
                        
                      
                      ⁢
                      1
                    
                  
                
              
            
          
          
            
              
                
                  m
                  1
                
                =
                
                  
                    
                      aq
                      -
                      bp
                    
                    q
                  
                  ⁢
                  
                    f
                    
                      x
                      ⁢
                      
                        
                      
                      ⁢
                      1
                    
                  
                
              
            
          
          
            
              
                
                  k
                  2
                
                =
                
                  
                    
                      p
                      -
                      
                        b
                        0
                      
                    
                    
                      qf
                      
                        y
                        ⁢
                        
                          
                        
                        ⁢
                        2
                      
                    
                  
                  ⁢
                  
                    f
                    
                      x
                      ⁢
                      
                        
                      
                      ⁢
                      2
                    
                  
                
              
            
          
          
            
              
                
                  m
                  2
                
                =
                
                  
                    
                      aq
                      -
                      bp
                      +
                      
                        bb
                        0
                      
                    
                    q
                  
                  ⁢
                  
                    f
                    
                      x
                      ⁢
                      
                        
                      
                      ⁢
                      2
                    
                  
                
              
            
          
        
      
    
    
      
        (
        10
        )
      
    
  




a, b, p and q may be calculated by equation (10) and are as follows:




  
    
      
        {
        
          
            
              
                a
                =
                
                  
                    (
                    
                      
                        
                          m
                          2
                        
                        ⁢
                        
                          f
                          
                            x
                            ⁢
                            
                              
                            
                            ⁢
                            1
                          
                        
                      
                      -
                      
                        
                          m
                          1
                        
                        ⁢
                        
                          f
                          
                            
                              
                            
                            ⁢
                            
                              x
                              ⁢
                              
                                
                              
                              ⁢
                              2
                            
                          
                        
                      
                    
                    )
                  
                  /
                  
                    (
                    
                      
                        
                          k
                          1
                        
                        ⁢
                        
                          f
                          
                            x
                            ⁢
                            
                              
                            
                            ⁢
                            2
                          
                        
                        ⁢
                        
                          f
                          
                            y
                            ⁢
                            
                              
                            
                            ⁢
                            1
                          
                        
                      
                      -
                      
                        
                          k
                          2
                        
                        ⁢
                        
                          f
                          
                            x
                            ⁢
                            
                              
                            
                            ⁢
                            1
                          
                        
                        ⁢
                        
                          f
                          
                            y
                            ⁢
                            
                              
                            
                            ⁢
                            2
                          
                        
                      
                    
                    )
                  
                
              
            
          
          
            
              
                b
                =
                
                  
                    (
                    
                      
                        
                          m
                          2
                        
                        ⁢
                        
                          f
                          
                            x
                            ⁢
                            
                              
                            
                            ⁢
                            1
                          
                        
                      
                      -
                      
                        
                          m
                          1
                        
                        ⁢
                        
                          f
                          
                            x
                            ⁢
                            
                              
                            
                            ⁢
                            2
                          
                        
                      
                    
                    )
                  
                  /
                  
                    (
                    
                      
                        
                          k
                          1
                        
                        ⁢
                        
                          f
                          
                            x
                            ⁢
                            
                              
                            
                            ⁢
                            2
                          
                        
                        ⁢
                        
                          f
                          
                            y
                            ⁢
                            
                              
                            
                            ⁢
                            1
                          
                        
                      
                      -
                      
                        
                          k
                          2
                        
                        ⁢
                        
                          f
                          
                            x
                            ⁢
                            
                              
                            
                            ⁢
                            1
                          
                        
                        ⁢
                        
                          f
                          
                            y
                            ⁢
                            
                              
                            
                            ⁢
                            2
                          
                        
                      
                    
                    )
                  
                
              
            
          
          
            
              
                p
                =
                
                  
                    k
                    1
                  
                  ⁢
                  
                    b
                    0
                  
                  ⁢
                  
                    f
                    
                      x
                      ⁢
                      
                        
                      
                      ⁢
                      2
                    
                  
                  ⁢
                  
                    
                      f
                      
                        y
                        ⁢
                        
                          
                        
                        ⁢
                        1
                      
                    
                    /
                    
                      (
                      
                        
                          
                            k
                            1
                          
                          ⁢
                          
                            f
                            x2
                          
                          ⁢
                          
                            f
                            y1
                          
                        
                        -
                        
                          
                            k
                            2
                          
                          ⁢
                          
                            f
                            
                              x
                              ⁢
                              
                                
                              
                              ⁢
                              1
                            
                          
                          ⁢
                          
                            f
                            
                              y
                              ⁢
                              
                                
                              
                              ⁢
                              2
                            
                          
                        
                      
                      )
                    
                  
                
              
            
          
          
            
              
                q
                =
                
                  
                    b
                    0
                  
                  ⁢
                  
                    f
                    
                      x
                      ⁢
                      
                        
                      
                      ⁢
                      1
                    
                  
                  ⁢
                  
                    
                      f
                      
                        x
                        ⁢
                        
                          
                        
                        ⁢
                        2
                      
                    
                    /
                    
                      (
                      
                        
                          
                            k
                            1
                          
                          ⁢
                          
                            f
                            
                              x
                              ⁢
                              
                                
                              
                              ⁢
                              2
                            
                          
                          ⁢
                          
                            f
                            
                              y
                              ⁢
                              
                                
                              
                              ⁢
                              1
                            
                          
                        
                        -
                        
                          
                            k
                            2
                          
                          ⁢
                          
                            f
                            
                              x
                              ⁢
                              
                                
                              
                              ⁢
                              1
                            
                          
                          ⁢
                          
                            f
                            
                              y
                              ⁢
                              
                                
                              
                              ⁢
                              2
                            
                          
                        
                      
                      )
                    
                  
                
              
            
          
        
      
    
    
      
        (
        11
        )
      
    
  




The equation of the line passing through the three-dimensional motion vector in the spatial coordinate system may be obtained by combining equation (11) and equation (5).
(5) calculating a normal vector of a three-dimensional movement trajectory plane of each of the feature points, calculating inner product of the normal vector of each of the feature points and a direction vector of each segment of the trajectory thereof sequentially, removing a segment of the trajectory of each of the feature points with a maximum inner product, recalculating a normal vector of a trajectory plane of each of the feature points according to the residual trajectory thereof, and calculating a cosine distance between the two normal vectors of each of the feature points.
n motion vectors may be reconstructed for a feature point P of the target rotating around a rotation axis by n optical flow segments obtained from left images and right images respectively. P1 is projection of P on a left image, P2 is projection of P on a right image, n optical flow segments obtained from left images are from P1 to P1(n), n optical flow segments obtained from right images are from P2 to P2(n), and reconstructed motion vectors are {right arrow over (PP′)}, {right arrow over (P′P′′)}, {right arrow over (P′′P′′′)} . . . {right arrow over (P(n−1)P(n))}. As shown in FIG. 4, a motion vector of a current optical flow trajectory plane is calculated and is represented by {right arrow over (wt)}=(wtx,wty,wtz)T, and an equation of a line passing through any one of the three-dimensional motion vectors {right arrow over (PP′)}, {right arrow over (P′P′′)}, {right arrow over (P′′P′′′)} . . . {right arrow over (P(n−1)P(n))} calculated by step (4) is as follows:




  
    
      
        {
        
          
            
              
                
                  x
                  =
                  
                    az
                    +
                    p
                  
                
              
            
            
              
                
                  y
                  =
                  
                    bz
                    +
                    q
                  
                
              
            
          
          ,
          
            (
            
              q
              ≠
              0
            
            )
          
        
      
    
    
      
        (
        12
        )
      
    
  




where the direction of each motion vector is {right arrow over (wi)}=(a,b,1), and i=1, 2 . . . n. Cosine distance is used to estimate similarity between two motion vectors herein for it is applicable for describing difference between directions of two vectors. Calculate cosine distance cos(θi) between each of the motion vectors of each of the feature points and the normal vector of the optical flow trajectory plane thereof, where




  
    
      
        
          
            cos
            ⁡
            
              (
              
                θ
                i
              
              )
            
          
          =
          
            
              
                
                  
                    w
                    t
                  
                  →
                
                T
              
              ·
              
                
                  w
                  i
                
                →
              
            
            
              
                
                
                  
                    w
                    i
                  
                  →
                
                
              
              ⁢
              
                
                
                  
                    w
                    i
                  
                  →
                
                
              
            
          
        
        ,
        
          (
          
            
              i
              =
              1
            
            ,
            
              2
              ⁢
              
                
              
              ⁢
              ...
              ⁢
              
                
              
              ⁢
              n
            
          
          )
        
      
    
    
      
        (
        13
        )
      
    
  




cos(θi) is in a range of [−1, 1], where the larger the cosine distance is, the smaller the angle between the two vectors is; the smaller the cosine distance is, the larger the angle between the two vector is; the cosine distance equals a maximum value 1 when directions of the two vectors overlaps; and the cosine distance equals a minimum value −1 when directions of the two vectors are opposite. Maximum of modulus of the cosine distance is calculated by the following equation:

E(j)=max(|cos(θi)|),(i=1,2 . . . n)  (14)

(6) repeating calculations in step (4) and step (5) until cosine distance between normal vectors of the two trajectory planes remains the same or changes slightly.
Remove a segment of binocular optical flows of the feature points with a maximum modulus of cosine distance from obtained k segments of binocular optical flows thereof, whereby obtaining residual k−1 segments of binocular optical flows for each of the feature points, recalculate a normal vector {right arrow over (w′t)}=(w′tx,w′ty,w′tz)T estimated by the k−1 segments of binocular optical flows for each of the feature points, and calculate cosine distance between the two normal vectors




  
    
      
        
          cos
          ⁡
          
            (
            α
            )
          
        
        =
        
          
            
              
                
                  w
                  t
                
                →
              
              T
            
            ·
            
              
                w
                t
                ′
              
              →
            
          
          
            
              
              
                
                  w
                  T
                
                →
              
              
            
            ⁢
            
              
              
                
                  w
                  i
                  ′
                
                →
              
              
            
          
        
      
    
    
      
        (
        15
        )
      
    
  




A threshold of the cosine distance is set to L. When cosine distance between the two normal vectors is greater than the threshold, repeat step (4) and step (5) until the cosine distance is no more than the threshold.
At times when optical flows formed by a three-dimensional motion vector projected onto imaging planes of the two cameras are far smaller than the three-dimensional motion vector itself (namely an angle between the three-dimensional motion vector and the imaging plane is comparatively large), loss of depth information is comparatively large during reconstructing the three-dimensional motion vector for binocular parallax of the optical flows is comparatively small, and therefore inflections appear apparently in certain moments of the reconstructed trajectory during reconstructing spatial trajectory of the three-dimensional motion vectors (refer to A and B in FIG. 6). In terms of the above analysis, effective areas of binocular optical flows of the reconstructed three-dimensional motion vector sequence should be estimated first before estimating the rotation axis, otherwise, accuracy of estimation of the rotation axis would be seriously affected. In FIG. 6, L is a real rotation axis, L′ is an estimated rotation axis, and P is center of a wrongly-estimated circular trajectory.
(7) Estimating a trajectory plane of each of the feature points and center of the trajectory thereof.
As shown in FIG. 3, a point of a target moves around a rotation axis from a point A to a point B during a unit of time period t, where radius of the arc trajectory is R, a rotation angle is θ, and a line speed is {right arrow over (v0)}. In the unit of time period t, an average speed from A to B is {right arrow over (v)}, and an angle between the two vectors {right arrow over (v0)} and {right arrow over (v)} is φ. Relationship between {right arrow over (v0)} and {right arrow over (v)} is illustrated by equation (16):




  
    
      
        
          
            
            
              v
              →
            
            
          
          
            
            
              
                v
                0
              
              →
            
            
          
        
        =
        
          
            
              
              
                AB
                →
              
              
            
            
              
              
                AB
                (
              
              
            
          
          =
          
            
              
                2
                ⁢
                
                  
                
                ⁢
                R
                ⁢
                
                  
                
                ⁢
                sin
                ⁢
                
                  θ
                  2
                
              
              
                θ
                ⁢
                
                  
                
                ⁢
                R
              
            
            =
            
              
                sin
                ⁢
                
                  
                
                ⁢
                φ
              
              φ
            
          
        
      
    
    
      
        (
        16
        )
      
    
  




Assume an angle speed of the spinning target is {right arrow over (ω)}=(ωx,ωy,ωz)T and Ω=|{right arrow over (ω)}|, and the following equation may be obtained by equation (16):




  
    
      
        
          
            
            
              v
              →
            
            
          
          
            
            
              
                v
                0
              
              →
            
            
          
        
        =
        
          
            sin
            ⁡
            
              (
              
                
                  1
                  2
                
                ⁢
                Ω
                ⁢
                
                  
                
                ⁢
                t
              
              )
            
          
          
            
              1
              2
            
            ⁢
            Ω
            ⁢
            
              
            
            ⁢
            t
          
        
      
    
    
      
        (
        17
        )
      
    
  




Relationship of modulus of {right arrow over (v0)} and {right arrow over (v)} is analyzed above, where the vector {right arrow over (v)} may be regarded as a result of the vector {right arrow over (v0)} rotating an angle of φ and experiencing a modulus scaling process thereafter. Assume Rt is a rotation matrix from {right arrow over (v0)} to {right arrow over (v)}, and a matrix {circumflex over (ω)}′ is expressed by the following equation:




  
    
      
        
          
            ω
            ′
          
          ^
        
        =
        
          [
          
            
              
                0
              
              
                
                  -
                  
                    ω
                    z
                    ′
                  
                
              
              
                
                  ω
                  y
                  ′
                
              
            
            
              
                
                  ω
                  z
                  ′
                
              
              
                0
              
              
                
                  -
                  
                    ω
                    x
                    ′
                  
                
              
            
            
              
                
                  -
                  
                    ω
                    y
                    ′
                  
                
              
              
                
                  ω
                  x
                  ′
                
              
              
                0
              
            
          
          ]
        
      
    
    
      
        (
        18
        )
      
    
  




where {right arrow over (ω′)}=(ω′x,ω′y,ω′z)T, {right arrow over (ω′)} is a unit vector of {right arrow over (ω)}, and

Rt=I+sin(1⁄2Ωt)·{circumflex over (ω)}′+[1−cos(1⁄2Ωt)]·{circumflex over (ω)}′2.

Relationship of {right arrow over (v0)} and {right arrow over (v)} is obtained by the above analysis and is expressed by the following equation:




  
    
      
        
          v
          →
        
        =
        
          
            
              sin
              ⁡
              
                (
                
                  
                    1
                    2
                  
                  ⁢
                  Ω
                  ⁢
                  
                    
                  
                  ⁢
                  t
                
                )
              
            
            
              
                1
                2
              
              ⁢
              Ω
              ⁢
              
                
              
              ⁢
              t
            
          
          ⁢
          
            R
            t
          
          ⁢
          
            
              v
              0
            
            →
          
        
      
    
    
      
        (
        19
        )
      
    
  




As {right arrow over (v0)}={right arrow over (ω)}×{right arrow over (OA)}=Ω·{circumflex over (ω)}′·{right arrow over (OA)}, the following equation may be obtained:




  
    
      
        
          AB
          →
        
        =
        
        ⁢
        
          
            
              v
              →
            
            ·
            t
          
          =
          
            
              
                
                  sin
                  ⁡
                  
                    (
                    
                      
                        1
                        2
                      
                      ⁢
                      Ω
                      ⁢
                      
                        
                      
                      ⁢
                      t
                    
                    )
                  
                
                
                  
                    1
                    2
                  
                  ⁢
                  Ω
                  ⁢
                  
                    
                  
                  ⁢
                  t
                
              
              ⁢
              
                
                  R
                  t
                
                ·
                
                  
                    v
                    0
                  
                  →
                
                ·
                t
              
            
            =
            
            ⁢
            
              
                {
                
                  
                    
                      sin
                      ⁡
                      
                        (
                        
                          Ω
                          ⁢
                          
                            
                          
                          ⁢
                          t
                        
                        )
                      
                    
                    ·
                    
                      
                        ω
                        ′
                      
                      ^
                    
                  
                  +
                  
                    
                      [
                      
                        1
                        -
                        
                          cos
                          ⁡
                          
                            (
                            
                              Ω
                              ⁢
                              
                                
                              
                              ⁢
                              t
                            
                            )
                          
                        
                      
                      ]
                    
                    ·
                    
                      
                        
                          ω
                          ′
                        
                        ^
                      
                      2
                    
                  
                
                }
              
              ·
              
                OA
                →
              
            
          
        
      
    
    
      
        (
        20
        )
      
    
  




Assume M=sin(Ωt)·{circumflex over (ω)}′+[1−cos(Ωt)]·{circumflex over (ω)}′2 which is further expressed by the following equation:




  
    
      
        M
        =
        
          [
          
            
              
                
                  
                    
                      
                        -
                        
                          (
                          
                            1
                            -
                            
                              cos
                              ⁢
                              
                                
                              
                              ⁢
                              Ω
                              ⁢
                              
                                
                              
                              ⁢
                              t
                            
                          
                          )
                        
                      
                    
                  
                  
                    
                      
                        (
                        
                          1
                          -
                          
                            ω
                            x
                            
                              ′
                              ⁢
                              
                                
                              
                              ⁢
                              2
                            
                          
                        
                        )
                      
                    
                  
                
              
              
                
                  
                    
                      
                        
                          
                            (
                            
                              1
                              -
                              
                                cos
                                ⁢
                                
                                  
                                
                                ⁢
                                Ω
                                ⁢
                                
                                  
                                
                                ⁢
                                t
                              
                            
                            )
                          
                          ⁢
                          
                            w
                            x
                            ′
                          
                          ⁢
                          
                            ω
                            y
                            ′
                          
                        
                        -
                      
                    
                  
                  
                    
                      
                        
                          ω
                          z
                          ′
                        
                        ⁢
                        sin
                        ⁢
                        
                          
                        
                        ⁢
                        Ω
                        ⁢
                        
                          
                        
                        ⁢
                        t
                      
                    
                  
                
              
              
                
                  
                    
                      
                        
                          
                            (
                            
                              1
                              -
                              
                                cos
                                ⁢
                                
                                  
                                
                                ⁢
                                Ω
                                ⁢
                                
                                  
                                
                                ⁢
                                t
                              
                            
                            )
                          
                          ⁢
                          
                            ω
                            x
                            ′
                          
                          ⁢
                          
                            ω
                            z
                            ′
                          
                        
                        +
                      
                    
                  
                  
                    
                      
                        
                          ω
                          y
                          ′
                        
                        ⁢
                        sin
                        ⁢
                        
                          
                        
                        ⁢
                        Ω
                        ⁢
                        
                          
                        
                        ⁢
                        t
                      
                    
                  
                
              
            
            
              
                
                  
                    
                      
                        
                          
                            (
                            
                              1
                              -
                              
                                cos
                                ⁢
                                
                                  
                                
                                ⁢
                                Ω
                                ⁢
                                
                                  
                                
                                ⁢
                                t
                              
                            
                            )
                          
                          ⁢
                          
                            w
                            x
                            ′
                          
                          ⁢
                          
                            ω
                            y
                            ′
                          
                        
                        +
                      
                    
                  
                  
                    
                      
                        
                          ω
                          z
                          ′
                        
                        ⁢
                        sin
                        ⁢
                        
                          
                        
                        ⁢
                        Ω
                        ⁢
                        
                          
                        
                        ⁢
                        t
                      
                    
                  
                
              
              
                
                  
                    
                      
                        -
                        
                          (
                          
                            1
                            -
                            
                              cos
                              ⁢
                              
                                
                              
                              ⁢
                              Ω
                              ⁢
                              
                                
                              
                              ⁢
                              t
                            
                          
                          )
                        
                      
                    
                  
                  
                    
                      
                        (
                        
                          1
                          -
                          
                            ω
                            y
                            
                              ′
                              ⁢
                              
                                
                              
                              ⁢
                              2
                            
                          
                        
                        )
                      
                    
                  
                
              
              
                
                  
                    
                      
                        
                          
                            (
                            
                              1
                              -
                              
                                cos
                                ⁢
                                
                                  
                                
                                ⁢
                                Ω
                                ⁢
                                
                                  
                                
                                ⁢
                                t
                              
                            
                            )
                          
                          ⁢
                          
                            ω
                            y
                            ′
                          
                          ⁢
                          
                            ω
                            z
                            ′
                          
                        
                        -
                      
                    
                  
                  
                    
                      
                        
                          ω
                          x
                          ′
                        
                        ⁢
                        sin
                        ⁢
                        
                          
                        
                        ⁢
                        Ω
                        ⁢
                        
                          
                        
                        ⁢
                        t
                      
                    
                  
                
              
            
            
              
                
                  
                    
                      
                        
                          
                            (
                            
                              1
                              -
                              
                                cos
                                ⁢
                                
                                  
                                
                                ⁢
                                Ω
                                ⁢
                                
                                  
                                
                                ⁢
                                t
                              
                            
                            )
                          
                          ⁢
                          
                            ω
                            x
                            ′
                          
                          ⁢
                          
                            ω
                            z
                            ′
                          
                        
                        -
                      
                    
                  
                  
                    
                      
                        
                          ω
                          y
                          ′
                        
                        ⁢
                        sin
                        ⁢
                        
                          
                        
                        ⁢
                        Ω
                        ⁢
                        
                          
                        
                        ⁢
                        t
                      
                    
                  
                
              
              
                
                  
                    
                      
                        
                          
                            (
                            
                              1
                              -
                              
                                cos
                                ⁢
                                
                                  
                                
                                ⁢
                                Ω
                                ⁢
                                
                                  
                                
                                ⁢
                                t
                              
                            
                            )
                          
                          ⁢
                          
                            w
                            y
                            ′
                          
                          ⁢
                          
                            ω
                            z
                            ′
                          
                        
                        +
                      
                    
                  
                  
                    
                      
                        
                          ω
                          x
                          ′
                        
                        ⁢
                        sin
                        ⁢
                        
                          
                        
                        ⁢
                        Ω
                        ⁢
                        
                          
                        
                        ⁢
                        t
                      
                    
                  
                
              
              
                
                  
                    
                      
                        -
                        
                          (
                          
                            1
                            -
                            
                              cos
                              ⁢
                              
                                
                              
                              ⁢
                              Ω
                              ⁢
                              
                                
                              
                              ⁢
                              t
                            
                          
                          )
                        
                      
                    
                  
                  
                    
                      
                        (
                        
                          1
                          -
                          
                            ω
                            z
                            
                              ′
                              ⁢
                              
                                
                              
                              ⁢
                              2
                            
                          
                        
                        )
                      
                    
                  
                
              
            
          
          ]
        
      
    
    
      
        (
        21
        )
      
    
  




Assume coordinate of the point A is (xA,yA,zA)T, and coordinate of the point O is (xO,yO,zO)T, and the vector {right arrow over (AB)} may be reconstructed by binocular optical flows. Assume {right arrow over (AB)}=(x,y,z)T, whereby obtaining the following equation:




  
    
      
        
          M
          ·
          
            [
            
              
                
                  
                    
                      x
                      A
                    
                    -
                    
                      x
                      O
                    
                  
                
              
              
                
                  
                    
                      y
                      A
                    
                    -
                    
                      y
                      O
                    
                  
                
              
              
                
                  
                    
                      z
                      A
                    
                    -
                    
                      z
                      O
                    
                  
                
              
            
            ]
          
        
        =
        
          [
          
            
              
                x
              
            
            
              
                y
              
            
            
              
                z
              
            
          
          ]
        
      
    
    
      
        (
        22
        )
      
    
  




Substitute variables according to the following equations:

Q1=(1−cos Ωt)(1−ω′x2),

Q2=(1−cos Ωt)(1−ω′y2),

Q3=(1−cos Ωt)(1−ω′z2),

Q4=(1−cos Ωt)ω′xω′y,

Q5=(1−cos Ωt)ω′xωz,

Q6=(1−cos Ωt)ω′yω′z,

Q7=ω′x sin Ωt, 

Q8=ω′y sin Ωt, 

Q9=ω′z sin Ωt, 

Q10=x0Q1y0Q4−z0Q5−z0Q8+y0Q9,

Q11=y0Q2−x0Q4−z0Q6+z0Q7−x0Q9, 

Q12=zOQ3−x0Q5−y0Q6−y0Q7+x0Q8,

An equation may be obtained as follows:




  
    
      
        
          [
          
            
              
                
                  -
                  
                    x
                    A
                  
                
              
              
                0
              
              
                0
              
              
                
                  y
                  A
                
              
              
                
                  z
                  A
                
              
              
                0
              
              
                0
              
              
                
                  z
                  A
                
              
              
                
                  -
                  
                    y
                    A
                  
                
              
              
                1
              
              
                0
              
              
                0
              
            
            
              
                0
              
              
                
                  -
                  
                    y
                    A
                  
                
              
              
                0
              
              
                
                  x
                  A
                
              
              
                0
              
              
                
                  z
                  A
                
              
              
                
                  -
                  
                    z
                    A
                  
                
              
              
                0
              
              
                
                  x
                  A
                
              
              
                0
              
              
                1
              
              
                0
              
            
            
              
                0
              
              
                0
              
              
                
                  -
                  
                    z
                    A
                  
                
              
              
                0
              
              
                
                  x
                  A
                
              
              
                
                  y
                  A
                
              
              
                
                  y
                  A
                
              
              
                
                  -
                  
                    x
                    A
                  
                
              
              
                0
              
              
                0
              
              
                0
              
              
                1
              
            
          
          ]
        
        ·
        
           
          
            
              [
              
                
                  
                    
                      Q
                      1
                    
                  
                
                
                  
                    ⋮
                  
                
                
                  
                    
                      Q
                      12
                    
                  
                
              
              ]
            
            =
            
              [
              
                
                  
                    x
                  
                
                
                  
                    y
                  
                
                
                  
                    z
                  
                
              
              ]
            
          
        
      
    
    
      
        (
        23
        )
      
    
  




The above 3 equations may be obtained if spatial location variation of a feature point in a time period is observed, and Q1 to Q12 may be calculated if spatial location variation of multiple feature points in multiple time periods is observed, which makes coefficient matrix of the equation have more than 12 rows.
As




  
    
      
        
          
            [
            
              
                
                  
                    Q
                    1
                  
                
                
                  
                    
                      Q
                      9
                    
                    -
                    
                      Q
                      4
                    
                  
                
                
                  
                    -
                    
                      (
                      
                        
                          Q
                          5
                        
                        +
                        
                          Q
                          8
                        
                      
                      )
                    
                  
                
              
              
                
                  
                    -
                    
                      (
                      
                        
                          Q
                          9
                        
                        +
                        
                          Q
                          4
                        
                      
                      )
                    
                  
                
                
                  
                    Q
                    2
                  
                
                
                  
                    
                      Q
                      7
                    
                    -
                    
                      Q
                      6
                    
                  
                
              
              
                
                  
                    
                      Q
                      8
                    
                    -
                    
                      Q
                      5
                    
                  
                
                
                  
                    -
                    
                      (
                      
                        
                          Q
                          6
                        
                        +
                        
                          Q
                          7
                        
                      
                      )
                    
                  
                
                
                  
                    Q
                    3
                  
                
              
            
            ]
          
          ·
          
            [
            
              
                
                  
                    x
                    0
                  
                
              
              
                
                  
                    y
                    0
                  
                
              
              
                
                  
                    z
                    0
                  
                
              
            
            ]
          
        
        =
        
          [
          
            
              
                
                  Q
                  10
                
              
            
            
              
                
                  Q
                  11
                
              
            
            
              
                
                  Q
                  12
                
              
            
          
          ]
        
      
    
    
      
        (
        24
        )
      
    
  




coordinate (xO,yO,zO)T of O may be calculated.
Since

ω′x:ω′y:ω′z=Q7:Q8:Q9.  (25)

and {right arrow over (ω′)}=(ω′x,ω′y,ω′z)T which is a unit vector, it can be derived that ω′x2+ω′y2+ωz2=1. (ω′x,ω′y,ω′z)T may be calculated by combining with equation (25). Since direction of the rotation axis is the same as that of {right arrow over (ω′)}, and the rotation axis passes through the point (xO,yO,zO)T, an equation of the rotation axis in the spatial coordinate system is as follows:




  
    
      
        
          
            X
            -
            
              x
              0
            
          
          
            ω
            x
            ′
          
        
        =
        
          
            
              Y
              -
              
                y
                0
              
            
            
              ω
              y
              ′
            
          
          =
          
            
              
                Z
                -
                
                  z
                  0
                
              
              
                ω
                z
                ′
              
            
            .
          
        
      
    
    
      
        (
        26
        )
      
    
  




and a radius




  
    
      
        
          R
          ′
        
        =
        
          
            
              
              
                
                  (
                  
                    
                      
                        x
                        o
                      
                      -
                      
                        x
                        A
                      
                    
                    ,
                    
                      
                        y
                        o
                      
                      -
                      
                        y
                        A
                      
                    
                    ,
                    
                      
                        z
                        o
                      
                      -
                      
                        z
                        A
                      
                    
                  
                  )
                
                ×
                
                  (
                  
                    x
                    ,
                    y
                    ,
                    z
                  
                  )
                
              
              
            
            
              
                
                  x
                  2
                
                +
                
                  y
                  2
                
                +
                
                  z
                  2
                
              
            
          
          .
        
      
    
    
      
        
      
    
  




Besides, angle speed of the spinning target may be obtained according to an equation




  Ω
  =
  
    
      
        1
        t
      
      ⁢
      arcsin
      ⁢
      
        
          Q
          7
        
        
          ω
          x
          ′
        
      
    
    =
    
      
        
          1
          t
        
        ⁢
        arcsin
        ⁢
        
          
            Q
            8
          
          
            ω
            y
            ′
          
        
      
      =
      
        
          1
          t
        
        ⁢
        arcsin
        ⁢
        
          
            
              Q
              9
            
            
              ω
              z
              ′
            
          
          .
        
      
    
  




In terms of the above principles, optical flows formed by discrete movement of a feature point of the target projected onto the left camera and the right camera in a series of time periods may be obtained according to left image sequences and right image sequence of the target rotating around a rotation axis. Remove areas ineffective for reconstructing a three-dimensional movement trajectory from binocular optical flows of the feature points, whereby obtaining effective area-constrained binocular optical flows, by which three-dimensional motion vectors are reconstructed. Capture four (or more) groups of optical flow stereo image pairs for each of the feature points, substitute the reconstructed three-dimensional motion vectors into equation (22), whereby obtaining direction of a rotation axis estimated by the trajectory of each of the feature points and center and radius of the trajectory thereof.
(8) Performing weighted average on normal vectors of the trajectory planes and on centers of the trajectories respectively according to the radius of the fitted trajectory of each of the feature points, whereby obtaining a spatial equation of a final rotation axis.
Center of an arc trajectory of a feature point and normal direction of the trajectory plane may be obtained by the trajectory of the feature point. In theory, direction of the rotation axis of the target is the same as normal direction of the trajectory plane of each of the feature point and the rotation axis passes through centers of the arc trajectories, therefore, direction of the rotation axis and a point thereon (derived by weighted average of centers of the arc trajectories) may be estimated with comparatively small errors by performing weighted average on directions of rotation axes and centers determined by trajectories of the feature points respectively, where centers and normal directions of arc trajectories with comparatively great radiuses share comparatively great weights in the weighted average process for optical flows formed by feature points rotating with comparatively great radiuses may be detected with comparatively small errors.
For each of the arc trajectories, assume center coordinate is (xi,yi,zi), radius is ri, normal direction of the trajectory plane is (ai,bi,ci), and a final center coordinate (x, y, z) and a final normal direction {ā, b, c} are calculated by the following equations:




  
    
      
        
          
            x
            _
          
          =
          
            
              ∑
              
                i
                =
                1
              
              n
            
            ⁢
            
              (
              
                
                  
                    r
                    i
                  
                  ⁢
                  
                    x
                    i
                  
                
                
                  
                    ∑
                    
                      j
                      =
                      1
                    
                    n
                  
                  ⁢
                  
                    r
                    j
                  
                
              
              )
            
          
        
        ,
        
          
            y
            _
          
          =
          
            
              ∑
              
                i
                =
                1
              
              n
            
            ⁢
            
              (
              
                
                  
                    r
                    i
                  
                  ⁢
                  
                    y
                    i
                  
                
                
                  
                    ∑
                    
                      j
                      =
                      1
                    
                    n
                  
                  ⁢
                  
                    r
                    j
                  
                
              
              )
            
          
        
        ,
        
          
            z
            _
          
          =
          
            
              ∑
              
                i
                =
                1
              
              n
            
            ⁢
            
              (
              
                
                  
                    r
                    i
                  
                  ⁢
                  
                    z
                    i
                  
                
                
                  
                    ∑
                    
                      j
                      =
                      1
                    
                    n
                  
                  ⁢
                  
                    r
                    j
                  
                
              
              )
            
          
        
      
    
    
      
        (
        27
        )
      
    
  
  
    
      
        
          
            a
            _
          
          =
          
            
              ∑
              
                i
                =
                1
              
              n
            
            ⁢
            
              (
              
                
                  
                    r
                    i
                  
                  ⁢
                  
                    a
                    i
                  
                
                
                  
                    ∑
                    
                      j
                      =
                      1
                    
                    n
                  
                  ⁢
                  
                    r
                    j
                  
                
              
              )
            
          
        
        ,
        
          
            b
            _
          
          =
          
            
              ∑
              
                i
                =
                1
              
              n
            
            ⁢
            
              (
              
                
                  
                    r
                    i
                  
                  ⁢
                  
                    b
                    i
                  
                
                
                  
                    ∑
                    
                      j
                      =
                      1
                    
                    n
                  
                  ⁢
                  
                    r
                    j
                  
                
              
              )
            
          
        
        ,
        
          
            and
            ⁢
            
              
            
            ⁢
            
              c
              _
            
          
          =
          
            
              ∑
              
                i
                =
                1
              
              n
            
            ⁢
            
              (
              
                
                  
                    r
                    i
                  
                  ⁢
                  
                    c
                    i
                  
                
                
                  
                    ∑
                    
                      j
                      =
                      1
                    
                    n
                  
                  ⁢
                  
                    r
                    j
                  
                
              
              )
            
          
        
        ,
      
    
    
      
        (
        28
        )
      
    
  




The equation of the final rotation axis is as follows:




  
    
      
        
          
            x
            -
            
              x
              _
            
          
          
            a
            _
          
        
        =
        
          
            
              y
              -
              
                y
                _
              
            
            
              b
              _
            
          
          =
          
            
              z
              -
              
                z
                _
              
            
            
              c
              _
            
          
        
      
    
    
      
        (
        29
        )
      
    
  




(9) repeating steps (1)-(8) when the rotation axis of the spatial target changes in a time period T2 or T3, whereby obtaining a spatial equation of a second rotation axis, and combining the spatial equation of the second rotation axis with that of the former rotation axis, whereby calculating coordinate of mass center of the spatial target.
According to the present invention, effective area-constrained binocular optical flows are obtained by processing image sequences and calculating binocular optical flows, and three-dimensional trajectories of the spatial target are reconstructed by iterations to estimate rotation axes and mass center thereof, which may be used to accurately analyze trajectories of a spatial target quantitatively and estimate an attitude thereof, and is applicable for an observation satellite to measure properties of a spatial target in spinning or attitude adjusting and for autonomous image navigation of an observation satellite gradually moving towards a spatial target.
Correctness and effectiveness of the method of the present invention are further illustrated by simulations and image sequence experiments.
During a time period T1, distance between a simulation satellite and a camera is 20 m, spectacular angle of the camera is 10 degrees, L in FIG. 7 is a rotation axis of the satellite, and A, B, C and D in FIG. 7 are detected feature points. Trajectories of feature points A, B, C and D estimated by optical flows calculated by every other frame compared with real arc trajectories thereof are illustrated in FIGS. 8A-8D, in each of which a straight line is an ideal rotation axis, an asterisk labels estimated center of an arc trajectory obtained by step (3), a solid line represents an estimated trajectory of a feature point, a dotted line represents a real arc trajectory thereof, L represents a real rotation axis, and P represents center of the estimated trajectory.
FIG. 9 illustrates a rotation axis estimated by three-dimensional motion vectors of B after optical flow calculation by every other frame, where the solid line L is the real rotation axis, a dotted line L′ is an estimated rotation axis, and P represent center of the estimated trajectory.
In an experiment, a module of Shenzhou spacecraft is used as a target, and feature points on a solar panel of the module are used as tracking points. FIG. 11 illustrates a left image and a right image out of image sequences of a scenario captured by binocular cameras, and binocular optical flows are generated by coordinates of feature points extracted from image sequences of the scenario in left and right image pairs. FIGS. 12A and 12B illustrate optical flows generated by the moving target on the binocular cameras, where areas ineffective for reconstruction are marked out. Three-dimensional motion vectors of the target reconstructed by binocular optical flows containing areas ineffective for reconstruction are shown in FIG. 13, where obvious inflections occur in trajectory segments reconstructed by the areas. Variation of X, Y and Z components of intersections among motion vectors of the reconstructed trajectory is analyzed in FIG. 14 and it can be concluded that comparatively small difference of an optical flow in a direction U or V results in comparatively large error. Referring to ellipse-marked areas in FIGS. 12A and 12B, each of the optical flow segments has no difference in the direction V, and X, Y and Z components thereof are 0. Three-dimensional motion vectors of the target reconstructed by effective area-constrained binocular optical flows after removing areas ineffective for reconstruction are shown in FIG. 15, and a trajectory reconstructed by removing areas with comparatively large errors from binocular optical flows via iterative calculation is shown in FIG. 16.
Considering multiple areas ineffective for reconstructing three-dimensional motion vectors may exist in binocular optical flows, a situation of dead areas existing in the directions U and V is analyzed (as shown in FIGS. 17A and 17B), where optical flow segments with no difference exist in both directions. Three-dimensional motion vectors reconstructed by areas ineffective for reconstructing three-dimensional motion vectors in binocular optical flows deviate significantly (as shown in FIG. 18). FIG. 19 illustrates X, Y and Z components of a trajectory reconstructed by binocular optical flows containing multiple areas ineffective for reconstruction, FIG. 20 illustrates a trajectory reconstructed by removing areas ineffective for reconstruction or with comparatively large errors from binocular optical flows via iterative calculation, and FIG. 21 illustrates reconstructed trajectories of the target rotating around two rotation axes, real trajectories, estimated rotation axes, real axes, a mass center of the spatial target calculated by the two estimated rotation axes and a real mass center thereof.
While particular embodiments of the invention have been shown and described, it will be obvious to those skilled in the art that changes and modifications may be made without departing from the invention in its broader aspects, and therefore, the aim in the appended claims is to cover all such changes and modifications as fall within the true spirit and scope of the invention.

## Claims

1. A method for estimating a rotation axis and a mass center of a spatial target based on binocular optical flows, the method comprising:
(1) extracting feature points from a stereo image pair respectively;
(2) calculating binocular optical flows formed by feature points in image sequences sequentially;
(3) removing areas ineffective for reconstructing a three-dimensional movement trajectory from the binocular optical flows of the feature points, thereby obtaining effective area-constrained binocular optical flows;
(4) reconstructing a three-dimensional movement trajectory of each of the feature points according to the effective area-constrained binocular optical flows thereof obtained in step (3);
(5) calculating a normal vector of a three-dimensional movement trajectory plane of each of the feature points, calculating a cosine distance between the normal vector of each of the feature points and a direction vector of each segment of the trajectory thereof sequentially, and removing a segment of the trajectory of each of the feature points with a maximum modulus of cosine distance;
(6) recalculating a normal vector of a trajectory plane of each of the feature points according to the residual trajectory thereof, calculating a cosine distance between the two normal vectors of each of the feature points, determining whether the cosine distance between the two normal vectors of each of the feature points is greater than a preset cosine distance threshold, and returning to step (5) and performing calculation according to the residual trajectory of each of the feature points if yes;
(7) estimating a trajectory plane of each of the feature points and center and radius of the trajectory thereof;
(8) performing weighted average on normal vectors of the trajectory planes and on centers of the trajectories respectively according to the radius of the trajectory of each of the feature points, whereby obtaining a spatial equation of a final rotation axis; and
(9) repeating steps (1)-(8) when the rotation axis of the spatial target changes, whereby obtaining a spatial equation of a second rotation axis, and combining the spatial equation of the second rotation axis with that of the former rotation axis, whereby calculating coordinate of mass center of the spatial target.

2. The method of claim 1, wherein in step (3), said process of removing areas ineffective for reconstructing a three-dimensional movement trajectory from the binocular optical flows of the feature points further comprises:
assuming an optical flow of a left image sequence is P1P′1, P′1P′′1, P′′1P′′′1 . . . P1(n−1)P2(n) and an optical flow of a right image sequence is P2P′2, P′2P′′2, P′′2P′′′2 . . . P2(n−1)P2(n) for a feature point P of the target, calculating difference in a direction U and a direction V respectively for each segment of the optical flows P1(i−1)P1(i) and P2(i−1)P2(i), where i=1, 2 . . . n, and removing any segment of the optical flows P1(i−1)P1(i) and P2(i−1)P2(i) with a difference of 0 in the direction U or the direction V.

3. The method of claim 2, wherein in step (4), said process of reconstructing a three-dimensional movement trajectory of each of the feature points according to the effective area-constrained binocular optical flows thereof obtained in step (3) further comprises:
obtaining n segments of optical flow from a left image sequence and a right image sequence respectively for a feature point P, reconstructing n motion vectors of the feature point spinning around a rotation axis, where P1 is a projection of P in a left image, P2 is a projection of P in a right image, the n segments of optical flow obtained from the left image sequence is from P1 to P1(n), the n segments of optical flow obtained from the right image sequence is from P2 to P2(n), and the reconstructed n motion vectors are {right arrow over (PP′)}, {right arrow over (P′P′′)}, {right arrow over (P′′P′′′)} . . . {right arrow over (P(n−1)P(n))}, and obtaining a three-dimensional movement trajectory of the feature point, where an equation of a motion vector {right arrow over (P(i−1)P(i))} in a spatial coordinate system is as follows:





  {
  
    
      
        
          
            
              x
              =
              
                az
                +
                p
              
            
          
        
        
          
            
              
                y
                =
                
                  bz
                  +
                  q
                
              
              ,
            
          
        
      
      ⁢
      
        (
        
          q
          ≠
          0
        
        )
      
    
    ,
    
      
        where
        ⁢
        
          

        
        ⁢
        i
      
      =
      1
    
    ,
    
      2
      ⁢
      
        
      
      ⁢
      ...
      ⁢
      
        
      
      ⁢
      n
      ⁢
      
        
      
      ⁢
      and
      ⁢
      
        

      
      ⁢
      
        {
        
          
            
              
                
                  a
                  =
                  
                    
                      (
                      
                        
                          
                            m
                            2
                          
                          ⁢
                          
                            f
                            
                              x
                              ⁢
                              
                                
                              
                              ⁢
                              1
                            
                          
                        
                        -
                        
                          
                            m
                            1
                          
                          ⁢
                          
                            f
                            
                              x
                              ⁢
                              
                                
                              
                              ⁢
                              2
                            
                          
                        
                      
                      )
                    
                    /
                    
                      (
                      
                        
                          
                            k
                            1
                          
                          ⁢
                          
                            f
                            
                              x
                              ⁢
                              
                                
                              
                              ⁢
                              2
                            
                          
                          ⁢
                          
                            f
                            
                              y
                              ⁢
                              
                                
                              
                              ⁢
                              1
                            
                          
                        
                        -
                        
                          
                            k
                            2
                          
                          ⁢
                          
                            f
                            
                              x
                              ⁢
                              
                                
                              
                              ⁢
                              1
                            
                          
                          ⁢
                          
                            f
                            
                              y
                              ⁢
                              
                                
                              
                              ⁢
                              2
                            
                          
                        
                      
                      )
                    
                  
                
              
            
            
              
                
                  b
                  =
                  
                    
                      (
                      
                        
                          
                            m
                            2
                          
                          ⁢
                          
                            f
                            
                              x
                              ⁢
                              
                                
                              
                              ⁢
                              1
                            
                          
                        
                        -
                        
                          
                            m
                            1
                          
                          ⁢
                          
                            f
                            
                              x
                              ⁢
                              
                                
                              
                              ⁢
                              2
                            
                          
                        
                      
                      )
                    
                    /
                    
                      (
                      
                        
                          k
                          1
                        
                        ,
                        
                          f
                          
                            x
                            ⁢
                            
                              
                            
                            ⁢
                            2
                          
                        
                        ,
                        
                          
                            f
                            
                              y
                              ⁢
                              
                                
                              
                              ⁢
                              1
                            
                          
                          -
                          
                            
                              k
                              2
                            
                            ⁢
                            
                              f
                              
                                x
                                ⁢
                                
                                  
                                
                                ⁢
                                1
                              
                            
                            ⁢
                            
                              f
                              
                                y
                                ⁢
                                
                                  
                                
                                ⁢
                                2
                              
                            
                          
                        
                      
                      )
                    
                  
                
              
            
            
              
                
                  p
                  =
                  
                    
                      k
                      1
                    
                    ⁢
                    
                      b
                      0
                    
                    ⁢
                    
                      f
                      
                        x
                        ⁢
                        
                          
                        
                        ⁢
                        2
                      
                    
                    ⁢
                    
                      
                        f
                        
                          y
                          ⁢
                          
                            
                          
                          ⁢
                          1
                        
                      
                      /
                      
                        (
                        
                          
                            
                              k
                              1
                            
                            ⁢
                            
                              f
                              
                                x
                                ⁢
                                
                                  
                                
                                ⁢
                                2
                              
                            
                            ⁢
                            
                              f
                              
                                y
                                ⁢
                                
                                  
                                
                                ⁢
                                1
                              
                            
                          
                          -
                          
                            
                              k
                              2
                            
                            ⁢
                            
                              f
                              
                                x
                                ⁢
                                
                                  
                                
                                ⁢
                                1
                              
                            
                            ⁢
                            
                              f
                              
                                y
                                ⁢
                                
                                  
                                
                                ⁢
                                2
                              
                            
                          
                        
                        )
                      
                    
                  
                
              
            
            
              
                
                  q
                  =
                  
                    
                      b
                      0
                    
                    ⁢
                    
                      f
                      
                        x
                        ⁢
                        
                          
                        
                        ⁢
                        1
                      
                    
                    ⁢
                    
                      
                        f
                        
                          x
                          ⁢
                          
                            
                          
                          ⁢
                          2
                        
                      
                      /
                      
                        (
                        
                          
                            
                              k
                              1
                            
                            ⁢
                            
                              f
                              
                                x
                                ⁢
                                
                                  
                                
                                ⁢
                                2
                              
                            
                            ⁢
                            
                              f
                              
                                y
                                ⁢
                                
                                  
                                
                                ⁢
                                1
                              
                            
                          
                          -
                          
                            
                              k
                              2
                            
                            ⁢
                            
                              f
                              
                                x
                                ⁢
                                
                                  
                                
                                ⁢
                                1
                              
                            
                            ⁢
                            
                              f
                              
                                y
                                ⁢
                                
                                  
                                
                                ⁢
                                2
                              
                            
                          
                        
                        )
                      
                    
                  
                
              
            
          
          ,
        
      
    
  




where
b0 is a baseline length between a left camera and a right camera, fx1 and fy1 are equivalent focal lengths of the left camera in a direction X and a direction Y respectively, fx2 and fy2 are equivalent focal lengths of the right camera in the direction X and the direction Y respectively, k1 and m1 are slope and intercept of a line l1 passing through a segment of optical flow {right arrow over (P1(i−1)P1(i))} of the feature point P formed on an imaging plane of the left camera respectively, and k2 and m2 are slope and intercept of a line l2 passing through a segment of optical flow {right arrow over (P2(i−1)P2(i))} of the feature point P formed on an imaging plane of the right camera respectively.

4. The method of claim 3, wherein step (5) further comprises:
calculating a normal vector {right arrow over (wt)}=(wtx,wty,wtz)T of a current optical flow trajectory plane of each of the feature points according to three-dimensional motion vectors {right arrow over (PP′)}, {right arrow over (P′P′′)}, {right arrow over (P′′P′′′)} . . . {right arrow over (P(n−1)P(n))}, thereof obtained in step (4), where the direction of each motion vector is {right arrow over (wi)}=(a,b,1), and i=1, 2 . . . n;
calculating a cosine distance cos(θi) between each of the motion vectors of each of the feature points and the normal vector of the optical flow trajectory plane thereof, where





  
    cos
    ⁡
    
      (
      
        θ
        i
      
      )
    
  
  =
  
    
      
        
          w
          →
        
        t
        T
      
      ·
      
        
          w
          i
        
        →
      
    
    
      
        
        
          
            w
            t
          
          →
        
        
      
      ⁢
      
        
        
          
            w
            i
          
          →
        
        
      
    
  




and i=1, 2 . . . n; and
removing a segment of binocular optical flows of the feature points with a maximum modulus of cosine distance, and obtaining residual k−1 segments of binocular optical flows for each of the feature points.

5. The method of claim 4, wherein step (6) further comprises:
recalculating a normal vector {right arrow over (w′t)}=(w′tx,w′ty,w′tz)T according to the k−1 segments of binocular optical flows for each of the feature points, calculating a cosine distance





  
    cos
    ⁡
    
      (
      α
      )
    
  
  =
  
    
      
        
          w
          →
        
        t
        T
      
      ·
      
        
          w
          t
          ′
        
        →
      
    
    
      
        
        
          
            w
            t
          
          →
        
        
      
      ⁢
      
        
        
          
            w
            t
            ′
          
          →
        
        
      
    
  




between the two normal vectors, and returning to step (5) and performing calculation according to the residual trajectory of each of the feature points if the cosine distance between the two normal vectors is greater than a preset cosine distance threshold.

6. The method of claim 5, wherein in step (7), (xO,yO,zO)T represents center coordinate of the trajectory of each of the feature points and is calculated by the following equation:




  
    
      
        [
        
          
            
              
                Q
                1
              
            
            
              
                
                  Q
                  9
                
                -
                
                  Q
                  4
                
              
            
            
              
                -
                
                  (
                  
                    
                      Q
                      5
                    
                    +
                    
                      Q
                      8
                    
                  
                  )
                
              
            
          
          
            
              
                -
                
                  (
                  
                    
                      Q
                      9
                    
                    +
                    
                      Q
                      4
                    
                  
                  )
                
              
            
            
              
                Q
                2
              
            
            
              
                
                  Q
                  7
                
                -
                
                  Q
                  6
                
              
            
          
          
            
              
                
                  Q
                  8
                
                -
                
                  Q
                  5
                
              
            
            
              
                -
                
                  (
                  
                    
                      Q
                      6
                    
                    +
                    
                      Q
                      7
                    
                  
                  )
                
              
            
            
              
                Q
                3
              
            
          
        
        ]
      
      ·
      
        [
        
          
            
              
                x
                0
              
            
          
          
            
              
                y
                0
              
            
          
          
            
              
                z
                0
              
            
          
        
        ]
      
    
    =
    
      [
      
        
          
            
              Q
              10
            
          
        
        
          
            
              Q
              11
            
          
        
        
          
            
              Q
              12
            
          
        
      
      ]
    
  
  ,



{right arrow over (ω′)}=(ω′x,ω′y,ωz)T represents normal vector direction of the trajectory of each of the feature points and is calculated by the following equation:


ω′x:ω′y:ω′z=Q7:Q8:Q9, and


R′ represents a radius of the trajectory of each of the feature points and is calculated by the following equation:





  
    
      R
      ′
    
    =
    
      
        
        
          
            (
            
              
                
                  x
                  o
                
                -
                
                  x
                  A
                
              
              ,
              
                
                  y
                  o
                
                -
                
                  y
                  A
                
              
              ,
              
                
                  z
                  o
                
                -
                
                  z
                  A
                
              
            
            )
          
          ×
          
            (
            
              x
              ,
              y
              ,
              z
            
            )
          
        
        
      
      
        
          
            x
            2
          
          +
          
            y
            2
          
          +
          
            z
            2
          
        
      
    
  
  ,




where


Q1=(1−cos Ωt)(1−ω′x2),



Q2=(1−cos Ωt)(1−ω′y2),



Q3=(1−cos Ωt)(1−ω′z2),



Q4=(1−cos Ωt)ω′xω′y,



Q5=(1−cos Ωt)ω′xωz,



Q6=(1−cos Ωt)ω′yω′z,



Q7=ω′x sin Ωt, 



Q8=ω′y sin Ωt, 



Q9=ω′z sin Ωt, 



Q10=x0Q1y0Q4−z0Q5−z0Q8+y0Q9,



Q11=y0Q2−x0Q4−z0Q6+z0Q7−x0Q9, 



Q12=zOQ3−x0Q5−y0Q6−y0Q7+x0Q8,

(xA,yA,zA)T represents a coordinate of a starting point of the trajectory of the feature point, (x,y,z)T represents an optical flow corresponding to the trajectory of the feature point, and Ω is modulus of a rotational angular velocity vector {right arrow over (ω)} of the target.

7. The method of claim 6, wherein in step (8), a final center coordinate (x, y, z) and a final normal direction {ā, b, c} are calculated by the following equations:




  
    
      x
      _
    
    =
    
      
        ∑
        
          i
          =
          1
        
        n
      
      ⁢
      
        (
        
          
            
              r
              i
            
            ⁢
            
              x
              i
            
          
          
            
              ∑
              
                j
                =
                1
              
              n
            
            ⁢
            
              r
              j
            
          
        
        )
      
    
  
  ,
  
    
      y
      _
    
    =
    
      
        ∑
        
          i
          =
          1
        
        n
      
      ⁢
      
        (
        
          
            
              r
              i
            
            ⁢
            
              y
              i
            
          
          
            
              ∑
              
                j
                =
                1
              
              n
            
            ⁢
            
              r
              j
            
          
        
        )
      
    
  
  ,
  
    
      z
      _
    
    =
    
      
        ∑
        
          i
          =
          1
        
        n
      
      ⁢
      
        (
        
          
            
              r
              i
            
            ⁢
            
              z
              i
            
          
          
            
              ∑
              
                j
                =
                1
              
              n
            
            ⁢
            
              r
              j
            
          
        
        )
      
    
  
  ,
  
    
  
  ⁢
  
    
      a
      _
    
    =
    
      
        ∑
        
          i
          =
          1
        
        n
      
      ⁢
      
        (
        
          
            
              r
              i
            
            ⁢
            
              a
              i
            
          
          
            
              ∑
              
                j
                =
                1
              
              n
            
            ⁢
            
              r
              j
            
          
        
        )
      
    
  
  ,
  
    
      b
      _
    
    =
    
      
        ∑
        
          i
          =
          1
        
        n
      
      ⁢
      
        (
        
          
            
              r
              i
            
            ⁢
            
              b
              i
            
          
          
            
              ∑
              
                j
                =
                1
              
              n
            
            ⁢
            
              r
              j
            
          
        
        )
      
    
  
  ,
  
    
      and
      ⁢
      
        
      
      ⁢
      
        c
        _
      
    
    =
    
      
        ∑
        
          i
          =
          1
        
        n
      
      ⁢
      
        (
        
          
            
              r
              i
            
            ⁢
            
              c
              i
            
          
          
            
              ∑
              
                j
                =
                1
              
              n
            
            ⁢
            
              r
              j
            
          
        
        )
      
    
  
  ,




and
the equation of the final rotation axis is as follows:





  
    
      
        x
        -
        
          x
          _
        
      
      
        a
        _
      
    
    =
    
      
        
          y
          -
          
            y
            _
          
        
        
          b
          _
        
      
      =
      
        
          z
          -
          
            z
            _
          
        
        
          c
          _
        
      
    
  
  ,




where
center coordinate of the trajectory of the ith feature point is represented by (xi,yi,zi), radius thereof is represented by ri, normal direction of the trajectory plane is represented by (ai,bi,ci), and i=1, 2 . . . n.