Application of improved UKF algorithm in initial alignment of SINS

Author(s):  
WanXin Su
Keyword(s):  
2020 ◽  
Author(s):  
Gopi Krishna Erabati

The technology in current research scenario is marching towards automation forhigher productivity with accurate and precise product development. Vision andRobotics are domains which work to create autonomous systems and are the keytechnology in quest for mass productivity. The automation in an industry canbe achieved by detecting interactive objects and estimating the pose to manipulatethem. Therefore the object localization ( i.e., pose) includes position andorientation of object, has profound ?significance. The application of object poseestimation varies from industry automation to entertainment industry and fromhealth care to surveillance. The objective of pose estimation of objects is verysigni?cant in many cases, like in order for the robots to manipulate the objects,for accurate rendering of Augmented Reality (AR) among others.This thesis tries to solve the issue of object pose estimation using 3D dataof scene acquired from 3D sensors (e.g. Kinect, Orbec Astra Pro among others).The 3D data has an advantage of independence from object texture and invarianceto illumination. The proposal is divided into two phases : An o?ine phasewhere the 3D model template of the object ( for estimation of pose) is built usingIterative Closest Point (ICP) algorithm. And an online phase where the pose ofthe object is estimated by aligning the scene to the model using ICP, providedwith an initial alignment using 3D descriptors (like Fast Point Feature Transform(FPFH)).The approach we develop is to be integrated on two di?erent platforms :1)Humanoid robot `Pyrene' which has Orbec Astra Pro 3D sensor for data acquisition,and 2)Unmanned Aerial Vehicle (UAV) which has Intel Realsense Euclidon it. The datasets of objects (like electric drill, brick, a small cylinder, cake box)are acquired using Microsoft Kinect, Orbec Astra Pro and Intel RealSense Euclidsensors to test the performance of this technique. The objects which are used totest this approach are the ones which are used by robot. This technique is testedin two scenarios, fi?rstly, when the object is on the table and secondly when theobject is held in hand by a person. The range of objects from the sensor is 0.6to 1.6m. This technique could handle occlusions of the object by hand (when wehold the object), as ICP can work even if partial object is visible in the scene.


2021 ◽  
Vol 1846 (1) ◽  
pp. 012075
Author(s):  
Chen Yang ◽  
Yuanwen Cai ◽  
Chaojun Xin ◽  
Meiling Shi

2013 ◽  
Vol 415 ◽  
pp. 143-148
Author(s):  
Li Hua Zhu ◽  
Xiang Hong Cheng

The design of an improved alignment method of SINS on a swaying base is presented in this paper. FIR filter is taken to decrease the impact caused by the lever arm effect. And the system also encompasses the online estimation of gyroscopes’ drift with Kalman filter in order to do the compensation, and the inertial freezing alignment algorithm which helps to resolve the attitude matrix with respect to its fast and robust property to provide the mathematical platform for the vehicle. Simulation results show that the proposed method is efficient for the initial alignment of the swaying base navigation system.


2020 ◽  
Vol 11 (4) ◽  
pp. 277-284
Author(s):  
G. I. Emel’yantsev ◽  
A. P. Stepanov ◽  
B. A. Blazhnov

2021 ◽  
Vol 22 (4) ◽  
pp. 217-224
Author(s):  
Yu. N. Chelnokov ◽  
A. V. Molodenkov

For the functioning of algorithms of inertial orientation and navigation of strapdown inertial navigation system (SINS), it is necessary to conduct a mathematical initial alignment of SINS immediately before the operation of these algorithms. An efficient method of initial alignment (not calibration!) of SINS is the method of vector matching. Its essence is to determine the relative orientation of the instrument trihedron Y (related to the unit of SINS sensors) and the reference trihedron X according to the results of measuring the projections of at least two non-collinear vectors of the axes on both trihedrons. We address the estimation of the initial orientation of the object using the method of gyrocompassing, which is a form of vector matching method. This initial alignment method is based upon using the projections of the apparent acceleration vector a and the absolute angular velocity vector ω of the object in the coordinate systems X and Y. It is assumed that the three single-axis accelerometers and the three gyroscopes (generally speaking, the three absolute angular velocity sensors of any type), which measure the projections of the vectors a and ω, are installed along the axes of the instrument coordinate system Y. If the projections of the same vectors on the axes of the base coordinate system X are known, then it is possible to estimate the mutual orientation of X and Y trihedrons. We are solving the problem of the initial alignment of SINS for the case of a fixed base, when the accelerometers measure the projection gi (i = 1, 2, 3) of the gravity acceleration vector g, and the gyroscopes measure the projections u i of the vector u of angular velocity of Earth’s rotation on the body-fixed axes. The projections of the same vectors on the axes of the normal geographic coordinate system X are also estimated using the known formulas. The correlation between the projections of the vectors u and g in X and Y coordinate system is given by known quaternion relations. In these relations the unknown variable is the orientation quaternion of the object in the X coordinate system. By separating the scalar and vector parts in the equations, we obtain an overdetermined system of linear algebraic equations (SLAE), where the unknown variable is the finite rotation vector θ, which aligns the X and Y coordinate systems (it is assumed that there is no half-turn of the X coordinate system with respect to the Y coordinate system). Thus, the mathematical formulation of the problem of SINS initial alignment by means of gyrocompassing is to find the unknown vector θ from the derived overdetermined SLAE. When finding the vector θ directly from the SLAE (algorithm 1) and data containing measurement errors, the components of the vector q are also determined with errors (especially the component of the vector θ, which is responsible for the course ψ of an object). Depending on the pre-defined in the course of numerical experiments values of heading ψ, roll ϑ, pitch γ angles of an object and errors of the input data (measurements of gyroscopes and accelerometers), the errors of estimating the heading angle Δψ of an object may in many cases differ from the errors of estimating the roll Δϑ and pitch Δγ angles by two-three (typically) or more orders. Therefore, in order to smooth out these effects, we have used the A. N. Tikhonov regularization method (algorithm 2), which consists of multiplying the left and right sides of the SLAE by the transposed matrix of coefficients for that SLAE, and adding the system regularization parameter to the elements of the main diagonal of the coefficient matrix for the newly derived SLAE (if necessary, depending on the value of the determinant of this matrix). Analysis of the results of the numerical experiments on the initial alignment shows that the errors of estimating the object’s orientation angles Δψ, Δϑ, Δγ using algorithm 2 are more comparable (more consistent) regarding their order.


Sign in / Sign up

Export Citation Format

Share Document