Suppressing jitter noises in a phase locked loop(PLL) is of great importance in order to keep precise and continuous track of global positioning system(GPS) signals characterized by low carrier-to-noise ratio(C/N0). This article proposes and analyzes an improved Kalman-filter-based PLL to process weak carrier signals in GPS software receivers. After reviewing the optimal-bandwidth-based traditional second-order PLL, a Kalman-filter-based estimation algorithm is implemented for the new PLL by decorrelating the model error noises and the measurement noises. Finally, the efficiency of this new Kalman-filter-based PLL is verified by experimental data. Compared to the traditional second-order PLL, this new PLL is in position to make correct estimation of the carrier phase differences and Doppler shifts with less overshoots and noise disturbances and keeps an effective check on the disturbances out of jitter noises in PLL. The results show that during processing normal signals, this improved PLL reduces the standard deviation from 0. 010 69 cycle to 0. 007 63 cycle, and for weak signal processing, the phase jitter range and the Doppler shifts can be controlled within ±17° and ±5 Hz as against ±25° and ±15 Hz by the traditional PLL
In aerial refueling, there exists deformation of the circular feature on the drogue’s stabilizing umbrella to a certain extent, which causes the problem of duality of position estimation by a single circular feature. In this paper, a monocular visual position and attitude estimation method of a drogue is proposed based on the coaxial constraints. Firstly, a procedure for scene recovery from one single circle is introduced. The coaxial constraints of the drogue are proposed and proved to be useful for the duality’s elimination by analyzing the matrix of the spatial structure. Furthermore, we came up with our method, which is composed of fitting the parameters of the spatial circles by restoring the 3D points on it, using the two-level coaxial constraints to eliminate the duality, and optimizing the normal vector of the plane where the inner circle is located. Finally, the effectiveness and robustness of the method proposed in this paper are verified, and the influence of the coaxial circle’s spatial structure on the method is explored through simulations of and experiments on a drogue model. Under the interference of a large amount of noise, the duality elimination success rate of our method can also be maintained at a level that is more than 10% higher than others. In addition, the accuracy of the normal vector obtained by the fusion algorithm is improved, and the mean angle error is reduced by more than 26.7%.
Drogue pose estimation is one of the key problems of AAR during the docking phase. A novel pose estimation method is proposed to remedy the failure of current methods due to the deformation of the flexible drogue. First, the key of flexible drogue pose estimation is suggested, and the concept of space-invariant features is extended. For the construction of 3L-features, a preprocessing method is then proposed. Next, the problem of skeleton pose estimation is transformed into a fourth-order polynomial by constructing virtual points and presenting a point feature-based method. Subsequently, a matching method and the projection invariants of the skeleton are proposed. After that, the correspondences of reprojection points are constructed using the matched 3L-features. An objective function fusing circle and line features and their derivatives are developed for optimizing the drogue pose base on the correspondences. Ultimately, the key techniques are verified in the synthetic and real data.
Satellite signals are easily lost in urban areas, which causes difficulty in vehicles being located with high precision. Visual odometry has been increasingly applied in navigation systems to solve this problem. However, visual odometry relies on dead-reckoning technology, where a slight positioning error can accumulate over time, resulting in a catastrophic positioning error. Thus, this paper proposes a road-network-map-assisted vehicle positioning method based on the theory of pose graph optimization. This method takes the dead-reckoning result of visual odometry as the input and introduces constraints from the point-line form road network map to suppress the accumulated error and improve vehicle positioning accuracy. We design an optimization and prediction model, and the original trajectory of visual odometry is optimized to obtain the corrected trajectory by introducing constraints from map correction points. The vehicle positioning result at the next moment is predicted based on the latest output of the visual odometry and corrected trajectory. The experiments carried out on the KITTI and campus datasets demonstrate the superiority of the proposed method, which can provide stable and accurate vehicle position estimation in real-time, and has higher positioning accuracy than similar map-assisted methods.
Cycle slip detection and repair is a prerequisite to obtain high-precision positioning based on a carrier phase. Traditional triple-frequency pseudorange and phase combination algorithm are highly sensitive to the pseudorange observation accuracy. To solve the problem, a cycle slip detection and repair algorithm based on inertial aiding for a BeiDou navigation satellite system (BDS) triple-frequency signal is proposed. To enhance the robustness, the INS-aided cycle slip detection model with double-differenced observations is derived. Then, the geometry-free phase combination is united to detect the insensitive cycle slip, and the optimal coefficient combination is selected. Furthermore, the L2-norm minimum principle is used to search and confirm the cycle slip repair value. To correct the INS error accumulated over time, the extended Kalman filter based on the BDS/INS tightly coupled system is established. The vehicular experiment is conducted to evaluate the performance of the proposed algorithm from a few aspects. The results indicate that the proposed algorithm can reliably detect and repair all cycle slips that occur in one cycle, including the small and insensitive cycle slips as well as the intensive and continuous cycle slips. Additionally, in signal-challenged environments, the cycle slips occurring 14 s after a satellite signal outage can be correctly detected and repaired.