For localisation of unknown non-cooperative targets in space, the existence of interference points causes inaccuracy of pose estimation while utilizing point cloud registration. To address this issue, this paper proposes a new iterative closest point (ICP) algorithm combined with distributed weights to intensify the dependability and robustness of the non-cooperative target localisation. As interference points in space have not yet been extensively studied, we classify them into two broad categories, far interference points and near interference points. For the former, the statistical outlier elimination algorithm is employed. For the latter, the Gaussian distributed weights, simultaneously valuing with the variation of the Euclidean distance from each point to the centroid, are commingled to the traditional ICP algorithm. In each iteration, the weight matrix $W$ in connection with the overall localisation is obtained, and the singular value decomposition is adopted to accomplish high-precision estimation of the target pose. Finally, the experiments are implemented by shooting the satellite model and setting the position of interference points. The outcomes suggest that the proposed algorithm can effectively suppress interference points and enhance the accuracy of non-cooperative target pose estimation. When the interference point number reaches about 700, the average error of angle is superior to 0.88°.
1 June 2023 in Journal of Systems Engineering and Electronics
To address the eccentric error of circular marks in camera calibration, a circle location method based on the invariance of collinear points and pole–polar constraint is proposed in this paper. Firstly, the centers of the ellipses are extracted, and the real concentric circle center projection equation is established by exploiting the cross ratio invariance of the collinear points. Subsequently, since the infinite lines passing through the centers of the marks are parallel, the other center projection coordinates are expressed as the solution problem of linear equations. The problem of projection deviation caused by using the center of the ellipse as the real circle center projection is addressed, and the results are utilized as the true image points to achieve the high precision camera calibration. As demonstrated by the simulations and practical experiments, the proposed method performs a better location and calibration performance by achieving the actual center projection of circular marks. The relevant results confirm the precision and robustness of the proposed approach.
A fundamental matrix estimation based on matching points is a critical problem in epipolar geometry. In this paper, a global fundamental matrix estimation method based on inlier updating is proposed. Firstly, the coplanar constraint was incorporated into the solution of the fundamental matrix to reduce the number of parameters to be solved. Subsequently, an inlier updating matrix was introduced according to the threshold of the epipolar geometry distance to eliminate the potential outliers and obtain a reliable initial value of the fundamental matrix. On this basis, we employed a four-point iterative method to estimate the fundamental matrix and make it satisfy the rank constraint at the same time. Finally, the epipolar geometry in binocular vision was extended to triple-view, and the fundamental matrix obtained in the previous step was globally optimized by minimizing the coordinate deviation between the intersection point and feature point in each group of images. The experiments show that the proposed fundamental matrix estimation method is robust to noise and outliers. In the attitude measurement, the maximum static error was 0.104° and dynamic measurement error was superior to 0.273°, which improved the reconstruction accuracy of feature points. Indoor images were further used to test the method, and the mean rotation angle error was 0.362°. The results demonstrate that the estimation method proposed in this paper has a good practical application prospect in multi-view 3D reconstruction and visual localization.
A concentric circle target is commonly used in the vision measurement system for its detection accuracy and robustness. To enhance the camera calibration accuracy, this paper proposes an improved calibration method that utilizes concentric circle grids as the calibration target. The method involves accurately locating the imaged center and optimizing camera parameters. The imaged concentric circle center obtained by cross-ratio invariance is not affected by perspective projection, which ensures the location accuracy of the feature point. Subsequently, the impact of lens distortion on camera calibration is comprehensively investigated. The sub-pixel coordinates of imaged centers are taken into the iterative calibration method, and camera parameters are updated. Through simulations and real experiments, the proposed method effectively reduces the residual error and improves the accuracy of camera parameters.
To facilitate the practical deployment and engineering implementation of multi-robot coordination for biomimetic underwater spherical robots (BUSRs), it is imperative to develop a formation tracking control method with a simple structure, a small number of tunable parameters, convenient parameter tuning and strong anti-disturbance capability. This study proposes a formation controller integrating virtual structure (VS), consensus protocol, and parallel output-velocity-type active disturbance rejection control (POV-ADRC), denoted as VS-C-POV-ADRC. A rotating global (RG) coordinate system is established to decouple robot positions from heading angles, which makes the parameter tuning more convenient. A double-loop control architecture is constructed, where the outer consensus control loop generates the desired velocity for each robot based on virtual-structure reference positions, and the inner POV-ADRC loop achieves high-precision velocity tracking. The proposed controller features a compact structure with only five adjustable parameters per motion direction, realizing easy engineering implementation and adaptation to the limited computing capacity of BUSRs. The simulation and experiment results demonstrate that the proposed algorithm enables robots to maintain a stable formation and achieve trajectory tracking accuracy within one body length, while exhibiting superior disturbance rejection. The proposed method provides a feasible and practical solution for BUSR formation control.