CN108592950A - A kind of monocular camera and Inertial Measurement Unit are with respect to established angle scaling method - Google Patents

A kind of monocular camera and Inertial Measurement Unit are with respect to established angle scaling method Download PDF

Info

Publication number
CN108592950A
CN108592950A CN201810478576.7A CN201810478576A CN108592950A CN 108592950 A CN108592950 A CN 108592950A CN 201810478576 A CN201810478576 A CN 201810478576A CN 108592950 A CN108592950 A CN 108592950A
Authority
CN
China
Prior art keywords
systems
matrix
indicate
rotation
relative
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN201810478576.7A
Other languages
Chinese (zh)
Other versions
CN108592950B (en
Inventor
张海
邱笑晨
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beihang University
Original Assignee
Beihang University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Beihang University filed Critical Beihang University
Priority to CN201810478576.7A priority Critical patent/CN108592950B/en
Publication of CN108592950A publication Critical patent/CN108592950A/en
Application granted granted Critical
Publication of CN108592950B publication Critical patent/CN108592950B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
    • G01C25/005Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices

Landscapes

  • Engineering & Computer Science (AREA)
  • Manufacturing & Machinery (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Gyroscopes (AREA)

Abstract

The invention discloses a kind of monocular cameras and Inertial Measurement Unit with respect to established angle scaling method, belongs to field of sensor calibration, includes the following steps:Step 1:Rotation measuring component acquires calibration data;The measurement assembly includes monocular camera and Inertial Measurement Unit;Step 2:Relative attitude information is extracted from the image that monocular camera acquires;Step 3:Installation matrix is solved using nonlinear least square method.It can be avoided because of the calibrated error that absolute reference information measurement error band comes independent of the measurement to absolute reference information using method provided by the present invention;In addition data acquisition time is short in calibration process, and calibration result precision is high, can meet the spacial alignment demand of monocular camera and Inertial Measurement Unit combination configuration in practical applications.

Description

A kind of monocular camera and Inertial Measurement Unit are with respect to established angle scaling method
Technical field
The invention belongs to field of sensor calibration, more particularly to the measurement group of a kind of monocular camera and Inertial Measurement Unit With respect to the scaling method of established angle, the equipment rotation mode being related in calibration process belongs in measuring coordinate system space both in part Join scaling method outside multisensor.
Background technology
Sensor combinations based on monocular camera and Inertial Measurement Unit (Inertial Measurement Unit, IMU) It is widely used in fields such as navigation, three-dimensional reconstructions, the IMU is made of three axis accelerometer and three-axis gyroscope. IMU output bandwidths are big, good to high maneuver tracking, and computational accuracy is high in short-term, it is possible to provide dimensional information, but long-term calculate accumulates mistake Difference is huge;Accumulated error is not present in the relative movement information obtained by the image information of monocular camera acquisition, and long-time stability are high, But it is influenced by factors such as Feature Points Matchings, computational accuracy is general, and sample rate is low, and carrier can not carry out effective when doing high motor-driven Exercise recovery, monocular camera can not provide scale.Two kinds of sensors measure characteristic on exist complementation, by they combine into Row data fusion can greatly promote system performance.
The data fusion of multisensor first has to solve space-time alignment issues.For spacial alignment, seeking to will not With under sensor measurement data unification to the same coordinate system, this just needs to seek the relative pose relationship between sensor.For The combination of monocular camera and IMU, seeks to the opposite established angle for seeking monocular camera coordinate system and IMU carriers system and origin is flat It moves.
For this problem, there are many scholars to be studied, but it is big be required for relying on absolute reference information come into Row is weighed, such as introduces gravity measurement to find horizontal plane benchmark, or introducing target etc..When gravity can not be measured accurately or be needed Want Fast Calibration can not preset target when, these methods will be no longer applicable in.
Invention content
The present invention is directed to by the connected measurement assembly being composed of both monocular camera and IMU, i.e. involved measurement group Relative position and attitudes vibration between monocular camera and IMU is not present in part in use, or due to opposite position caused by vibrations It sets and can be ignored with attitudes vibration.
The purpose of the present invention is to solve both IMU and monocular camera coordinate system spaces to mark with respect to established angle without support The case where determining problem, but being also applied for target simultaneously proposes a kind of opposite established angle calibration side based on monocular camera and IMU Method, this method, without rigid requirement, the absolute reference target standard of early period are can avoid when needing Fast Calibration for link, together to target When evaded the calibrated error that the when of measuring inaccurate to absolute references such as target or gravitational vectors brings, be the quick of specific application Calibration provides implementation.Simultaneously when there are absolute target, this method is equally applicable.
The monocular camera provided by the invention established angle scaling method opposite with IMU is a kind of nonlinear optimization calibration Method specifically includes following steps:
Step 1:Rotation measuring component acquires calibration data;The measurement assembly includes monocular camera and IMU;
Step 2:Relative attitude information is extracted from the image that monocular camera acquires;
Step 3:Installation matrix is solved using nonlinear least square method, realizes monocular camera and IMU with respect to established angle Calibration.
The advantage of the invention is that:
(1) equipment needed for is simple, and necessary equipment only includes the measurement assembly and mating of monocular camera and IMU compositions Data acquisition device and calibrated and calculated platform;
(2) measurement of the scaling method proposed independent of absolute reference information, can save the early-stage preparations time, keep away simultaneously The calibrated error that absolute reference information measurement error band comes is exempted from;
(3) under specific rotating condition, only very short data acquisition time is needed just to can be calibrated, and so-called specific Rotation is actually easy to carry out;
(4) cost function used introduces the concept of Lie algebra, and the error term model about rotation perturbation is easy to linear Change so that conventional Nonlinear Least Squares Method is applicable in;
(5) calibration result precision is high, can meet the spacial alignment of monocular camera and IMU combinations configuration in numerous applications Demand.
Description of the drawings
Fig. 1 is monocular camera and Inertial Measurement Unit provided by the invention with respect to established angle scaling method flow chart;
The schematic diagram of rotary shaft alternation in rotary course and rotary course when Fig. 2 is monocular camera acquisition image;
Fig. 3 is that handheld camera specifically rotates schematic diagram.
Specific implementation mode
Below in conjunction with the drawings and specific embodiments, the present invention is described in further detail.
In existing monocular camera and IMU measurement assemblies, the opposite established angle scaling method of the two is needed to absolute reference Information measures, and these absolute reference information or needs are arranged in advance, or needs to carry out the measurement of degree of precision, before causing Time phase is long, expense is big, and calibration result is easily influenced by absolute reference information measurement error.It is asked to solve above-mentioned technology Topic, the present invention propose a kind of opposite established angle nonlinear optimization scaling method only relying on relative attitude measurement, give mark Determine several rotation modes that process should be taken, and proposes nonlinear least square method and need the several of the cost function minimized Kind form.
The present invention is a kind of monocular camera and IMU with respect to established angle scaling method, and the purpose is to solve the phase of monocular camera Spin matrix (or " installation matrix ") of the machine coordinate system relative to the carrier system of IMU.
Due to being related to multiple coordinate systems, first make an explanation to each coordinate system symbol and definition:
(1) i systems:Inertial reference system;
(2) b systems:The connected carrier system with Inertial Measurement Unit (IMU), right-handed system, three axis directions be respectively it is right-under-it is preceding, The measurement output of gyro is three axial projection's coordinate of b systems;Each instantaneous carrier system is also an inertial system;
(3) c systems:The camera coordinates system being connected with monocular camera, right-handed system, three axis directions be respectively it is right-under-it is preceding;Each Instantaneous camera coordinates system is also an inertial system;
(4)c1System:The starting instantaneous (initial time is that the first frame image for demarcating acquires the moment) of nominal time section Camera coordinates system, it is constant in its instantaneous direction of starting, therefore it is an inertial system.
The several points for additionally needing explanation have:The method of the present invention only demarcates relative rotational relationship, is not concerned with origin Translation;The method of the present invention does not include the time synchronization strategy of data collecting system, it is believed that the time synchronization of different sensors is Through what is completed;The present invention is to forming the monocular camera of measurement assembly and type selecting, the storage format of data of IMU etc. without hardness It is specifically designed it is required that not being related to the software and hardware of measurement assembly, circuit etc., sample frequency etc. there are certain requirements;The present invention is not related to The noise characteristic of each sensor itself is noted, therefore, it is considered that the measurement noise characteristic of gyroscope is that prior calibration is good, zero bias obtain To effective compensation, the measurement noise in the short time influences integral operation little;This method only focuses on phase between monocular camera and IMU Calibration to established angle, therefore, it is considered that the internal reference matrix of monocular camera is that prior calibration is good.
The monocular camera and IMU includes the following steps with respect to established angle scaling method, flow as shown in Figure 1:
Step 1:Rotation measuring component acquires calibration data;
The measurement assembly includes monocular camera and IMU;The calibration data of acquisition include the angle speed that gyroscope measures The image of degree and monocular camera acquisition.Calibration is adopted with Calibration Field selection, measurement assembly rotating manner, data in data acquisition Collect frequency and acquisition duration should be by following requirement:
(1) Calibration Field selects;
The precision in characteristic point orientation in the image of monocular camera acquisition, will influence the precision of vision measurement attitude algorithm.It is special The precision of sign point is then determined by the distance of monocular camera resolution ratio, focal length and characteristic point corresponding actual point position to monocular camera It is fixed.When being demarcated, monocular camera resolution ratio and focal length have all been fixed, therefore can only rely on the selection of Calibration Field to improve Characteristic point measurement accuracy.
In the case where not considering marginal distortion, it is limited to monocular camera resolution ratio, the corresponding actual point position of characteristic point Remoter away from monocular camera, azimuthal measurement precision is poorer.And when considering marginal distortion, even apart from closer characteristic point, such as Fruit is located at the edge of image, and measurement accuracy also can be poor.The above-mentioned measurement characteristic for considering monocular camera, for indoor machine The focal range (12mm-35mm) and pixel resolution (600 for the monocular camera that people, small drone and mobile phone etc. are often selected Ten thousand dpi-2000, ten thousand dpi), following guidance program is proposed to Calibration Field selection:
The not notable and scene without mobile object of selection feature rich, easy to identify, illumination variation is demarcated, such as is selected There is the street in many shops, before the not single building of architectural style, avoids selection texture-free, weak texture or repetition texture more Scene.The distance of 90% or more the corresponding actual point position of characteristic point to monocular camera should be located at 10m between 20m, and These corresponding actual points of characteristic point for being in suitable distance are distributed relatively uniform in visual field, and most of features is avoided to concentrate on One pocket.
(2) measurement assembly rotating manner;
To realize the on-line proving of established angle, the rotation using measurement assembly is needed, by the short time (in one minute) Vision measurement obtains the estimation of established angle with the otherness that inertia recursion resolves.In rotation process, to realize three-dimensional established angle Estimation need to design specific scheme of rotation from the ornamental angle of established angle.
The core design principle of scheme of rotation is the rotation occurred around not dead axle, that is, carries out rotary shaft alternation or continuously change Become rotary shaft to be directed toward, avoids measurement assembly rotary shaft in rotary course from being directed toward fixed or approximate fixed, the rotation of rotary shaft alternation Schematic diagram as shown in Fig. 2, be shown in figure first around zcAxis rotates, further around xcAxis rotates, finally around ycThe rotary shaft of axis rotation Alternation, but be not necessarily in real process according to this rotational order.The schematic diagram is it is emphasised that should allow three axis can Rotary shaft should change in sensitivity to rotation and rotary course.To prevent, image from obscuring or successive frame lacks altogether simultaneously Depending on characteristic point, during rotary shaft alternation angular velocity of rotation suggestion be no more than 20 °/s, should not be too large, if it is fuzzy existing image occur As then needing reduction rotating speed to make image clearly.
Qualitatively provide angular velocity of rotation, such as following formula during a kind of rotary shaft alternation met the requirements:
WithThe projection of rotational angular velocity vector three axis of x, y, z under corresponding moment camera system is indicated respectively, Unit be °/s.π is pi.It is 10s for the period, amplitude ax°/sine curve of s;For the period be 20s, amplitude is ay°/sine curve of s;It is 20s for the period, amplitude az°/cosine curve of s;T is the time.ax、ayAnd azTake 0.5 °/s.
In the application scenarios of Fast Calibration, actual rotation process is often hand-held carries out, it is impossible to be carried out similar upper The standard rotation stated.The effect for showing above-mentioned formula is to make qualitative description to the alternation concept of rotary shaft, and to rotating amplitude Carry out substantially quantitative demonstration.Actual rotating speed can improve, and not obscured as long as principle is the image taken.
Provide a kind of hand-held scheme of rotation of the measurement assembly that actually can perform.It can according to the definition of camera coordinates system (c systems) Know, X-axis (xc) right, Z axis (z is directed toward by camera photocentrec) be directed toward by camera photocentre before, Y-axis (yc) be directed toward down by camera photocentre. First by camera alignment Calibration Field center (i.e. zcAxis is substantially aligned with Calibration Field center), while making its xcAxis substantially water It is flat, ycAxis is pointed generally in plumb line direction.It is as shown in Figure 3 that subsequent handheld camera carries out specific scheme of rotation:Handheld camera into Row is around yc(observation visual angle is along y for the left and right of axiscAxis direction) rotation, it first turns left, then turn right, eventually passes back to raw bits It sets, rotation amplitude is no more than 30 ° to avoid Calibration Field completely not in the visual field.Then it carries out around xc(the observation visual angle up and down of axis For along xcAxis is reversed) rotation, be first rotated up, rotate still further below, eventually pass back to home position, rotation amplitude be no more than 30 ° with Avoid Calibration Field completely not in the visual field.Then around zcShaft rotation returns to home position in dynamic one week.
(3) data acquiring frequency and acquisition duration;
To ensure that integral accuracy, the data acquiring frequency of gyroscope are not lower than 100Hz.Simultaneously in view of inexpensive inertia The measurement error of device is larger, and the integral of long period will be so that accumulated error be unacceptable, therefore data acquisition time is unsuitable It is long, recommend valid data to acquire duration in 10s between 20s.
To keep the consecutive frame that monocular camera acquires image sensitive as possible to significantly rotation, while in shorter acquisition Interior data volume is enough, and monocular camera picture-taken frequency is recommended in 1Hz between 5Hz.
Image to make monocular camera acquire does not obscure, and shutter speed suggestion is in 10ms or less.
Step 2:Relative attitude information is extracted from the image that monocular camera acquires;
This step will extract relative attitude information, including each image sampling moment in the image acquired from monocular camera Relative attitude of the camera coordinates system relative to upper image sampling moment camera coordinates system, and each image sampling moment Relative attitude of the camera coordinates system relative to calibration initial time camera coordinates system, is missed as cost function in optimization processing below The reference data of poor item.
This method is used without calibration is relied on, as reference without absolute reference system, it is therefore desirable to which selected reference frame is made To define the benchmark of posture.Such a inertial system is chosen to be used as with reference to coordinate system:It is static relative to inertial space, and sits Mark the camera coordinates system (c of origin and first frame image capture moment in calibration data (i.e. starting is instantaneous)1System) origin weight It closes, reference axis and c1The coordinate overlapping of axles of system, in the case where not causing to obscure, it is believed that instantaneous c1System is the reference frame, Its symbol also takes c1
(1) consecutive frame Feature Points Matching;
First carry out the Feature Points Matching of the image between consecutive frame.Slightly matched including single frames feature point extraction, characteristic point and Characteristic point screening after matching etc..
There are many ripe image characteristic point extractions and characteristic point slightly matched method in the prior art, such as Harris angle points (Harris Corner), SIFT (Scale Invariant Feature Transform), SURF (Speeded Up Robust Features) and ORB (Oriented FAST and Rotated BRIEF) etc..For needs The application of Fast Calibration, in the case where not losing precision, should choose arithmetic speed to improve the calculating speed of calibration as possible Fast feature detection and description, ORB features is based on FAST (Features from Accelerated Segment Test) feature is improved, and using BRIEF (Binary Robust Independent Elementary Features) two System description, under the apparent scene of feature, precision and rapidity can be met the requirements.
Individual features and description can be selected to be matched in practical operation according to demand:It needs to may be selected when Fast Calibration Using ORB features;SIFT or SURF features can be used when needing degree of precision without considering calculating speed.As long as the former is suitable for The scene for giving rough established angle as that can carry out fine estimation to installation matrix online in some application scenarios, but needs one A rational initial value, for example, port University of Science and Technology monocular vision inertia odometer plan V SINS.The latter may be only available for disposably marking It is fixed, but the application scenarios by not having special target, such as introduce the monocular vision ORBSLAM schemes of inertia measurement information.
Characteristic point screening after matching includes rejecting error hiding outlier and characteristic point distribution screening.For thick of characteristic point With the error hiding outlier in result, rejected using RANSAC (Random Sample Consensus) algorithm of standard. It rejects in the characteristic point after error hiding outlier, then carries out characteristic point distribution screening, to improve essential matrix computational accuracy, described Stromal matrix be used for describe two field pictures acquisition the moment camera coordinates system between to pole restriction relation, it can reflect two interframe Relative pose relationship.The mode that minimum range between characteristic point in restriction image can be used carries out characteristic point distribution screening so that sieve Characteristic point after choosing is evenly distributed.Meanwhile the characteristic point after the completion of screening should not be close to image border, to reduce pattern distortion shadow It rings, can be realized by limiting the ranks bound of characteristic point pixel coordinate.
(2) consecutive frame spin matrix calculates;
The essential matrix that adjacent two frame is calculated using the characteristic point after screening, can be used 8 methods or 5 methods are solved.
Then restore monocular camera relative motion from essential matrix.SVD decomposition is carried out to essential matrix, obtains multigroup rotation Torque battle array R and multigroup unit translational movement v, and using characteristic point should before monocular camera this characteristic from multigroup R and multigroup v In filter out correct R and v combination.Remember that the spin matrix between -1 frame of kth and kth frame is Rk-1,k, indicate that adjacent interframe rotation is closed The Direct cosine matrix of system is spin matrix, i.e.,
(3) rotation per frame relative to initial frame is calculated;
To image characteristic point be carried out continuously aforesaid operations can be obtained all adjacent two field pictures camera coordinates systems of description it Between attitudes vibration spin matrix R1,2、…、Rk-1,k
Using above-mentioned adjacent two interframe spin matrix, each frame camera coordinates system can be calculated in addition to initial frame relative to first The spin matrix of beginning frame camera coordinates system, the spin matrix (Direct cosine matrix) for calculating initial frame (the 1st frame) to kth frame calculate public Formula is as follows:
In formula, Π indicates even to multiply symbol.
Step 3:Installation matrix is solved using nonlinear least square method, realizes monocular camera and IMU with respect to established angle Calibration;
Next monocular camera is optimized using non-linear least square method relative to the installation matrix of IMU and is asked Solution.The step include design cost function, nonlinear least square method optimization and it is excellent for different reference frame cost functions Change the selection of result.
(1) cost function is designed;
The key for carrying out nonlinear optimization is to determine cost function.According to the choosing for the reference frame for considering relative attitude It selects, the cost function used in the scaling method of proposition is divided into two kinds of fixed reference form and incremental form;In view of solving It is manifold optimization problem to install matrix, can introduce Lie algebra and make further deformation to cost function.Therefore, cost function will have Diversified forms, for each reference frame, can be selected its any one corresponding cost function and carry out in actual calculating Optimization.
1. the cost function of fixed reference form designs;
As the instantaneous c of selection1System is reference frame, when relative attitude is considered with respect to the coordinate system always, cost The form of function is known as fixed reference form.
The angular speed that all sampling instant gyroscopes measure in calibration process can pass through the c for being derived by the corresponding moment as follows System is relative to instantaneous c1The angular speed of system:
WhereinThe angular speed that expression gyroscope measures, i.e. b systems are relative to the angular velocity of rotation of inertial system under b systems Projection;Indicate c1It is projection of the angular velocity of rotation under b systems relative to inertial system;Indicate b systems relative to c1The rotation of system Projection of the tarnsition velocity under b systems, due to c1System is inertial system, therefore this is always 0;Indicate c systems relative to c1System Projection of the angular velocity of rotation under b systems;Angular velocity of rotation projection under b system of the b systems relative to c systems is indicated, due to IMU It is connected always with monocular camera, therefore this is always 0;Indicate c systems relative to c1The angular velocity of rotation of system is under b systems Projection.Instantaneous c is utilized in the derivation of above formula1System is fixed relative to inertial system, and IMU and monocular camera are connected to install and therefore appoint The b systems at meaning moment are fixed relative to c systems.
Matrix is installedIt is defined as the Direct cosine matrix to c systems by b systems.The specific rotation mode of the installation matrix is described Can self-defining, using such as giving a definition in the present invention:B systems and c systems are all made of right-handed system before bottom right, three fix error angle difference For azimuthal error angle ψ, pitch error angle θ and roll error angle γ, then can be missed by three installations by coordinate system between b systems and c systems The rotation successively of declinate describes and constructs installation matrix, has the rotation mode by b systems to c systems to be:First around ybAxis rotates ψ, then Around xbAxis rotates θ, finally around zbAxis rotates γ.Then it can obtainExpression formula it is as follows:
According to above formula, an installation matrix can be calculated in any given one group of fix error angle ψ, θ and γ.Setting one A installation Matrix Estimation valueThe camera coordinates system that corresponding moment monocular camera can be then carried out using gyro to measure is relatively initial The resolving of the relative attitude of frame camera coordinates system:
WhereinIndicate c1It is the estimated value to the Direct cosine matrix of c systems;Indicate c systems relative to c1The rotation angle of system The estimated value of projection of the speed under c systems;Indicate installation Matrix Estimation value;Indicate c systems relative to c1The rotation angle speed of system The projection under b systems is spent, it is equal to the angular speed that gyroscope measures known to Such analysis Indicate angular speedTo time integral, rotating vector will be obtained;∧ operators indicate to be negated symmetrical matrix by vector;Exp () refers to for matrix Number mapping, converts antisymmetric matrix to the element of SO (3) (three-dimensional proper orthogonal group).
Matrix is then installedIt can be obtained by enabling following cost function minimums, reality can optional one when calculating:
Wherein, k=1 ..., n indicates that each sampling instant of monocular camera, n indicate sampling sum;Representing matrixTransposition, i.e.,Function eulr () indicates to seek Eulerian angles by Direct cosine matrix;Logm maps log () and indicates Direct cosine matrix in SO (3) (three-dimensional proper orthogonal group) is transformed intoIn (three-dimensional proper orthogonal group corresponding Lie algebra) Rotating vector antisymmetric matrix;∨ operators indicate to seek rotating vector by antisymmetric matrix;Function qtn () is indicated by direction cosines Battle array seeks unit quaternion;Indicate quaternary number multiplication;||·||2Two norm of matrix is sought in expression;I indicates unit matrix.
In practical calculating, according to the selection of referential, however, it is determined that use the cost function of fixed reference form, and rotate not It will appear unusual influence calculation accuracy, then selecting one in aforementioned four cost function optimizes.
The physical significance of above-mentioned cost function is to be compared with the angular speed that gyroscope measures to project to camera coordinates system product It branches away, the image that the posture and monocular camera relative to initial camera coordinate system acquire is calculated relative to initial phase The posture of machine coordinate system.The Direct cosine matrix of each sampling instant, expression is Current camera coordinate system relative to initial camera The direction cosine matrix of system;The Eulerian angles of each sampling instant, expression is Current camera coordinate system relative to initial camera system Eulerian angles;The physical significance of each sampling instant rotating vector, expression is Current camera coordinate system relative to initial camera The direction of the rotation of system, the vector is the direction of rotary shaft, and the size of modulus value indicates the angle of rotation;Each sampling instant Quaternary number is rotated, expression is that Current camera coordinate system rotates quaternary number (i.e. unit four relative to the normalization of initial camera system First number).In brief, what each error term investigated at this time is that the camera coordinates system of certain frame shooting time is shot relative to first frame The posture of the camera coordinates system at moment.
2. the cost function of incremental form designs;
When each error term in cost function only considers the relative attitude variation of adjacent two frame, incremental form can be designed Cost function.Unified reference frame is not present at this time, when selecting former frame shooting in adjacent two frame in each error term Reference of the camera coordinates system at quarter as measurement relative attitude.
Between monocular camera acquires in calibration process -1 frame image of kth and kth frame image, the angular speed that gyroscope measures can By being derived by the c systems at corresponding moment as follows relative to instantaneous ck-1The angular speed of system:
WhereinThe angular speed that expression gyroscope measures, i.e. b systems are relative to the angular velocity of rotation of inertial system under b systems Projection;Indicate b systems relative to instantaneous ck-1Projection of the angular velocity of rotation of system under b systems,Indicate instantaneous ck-1 It is projection of the angular velocity of rotation under b systems relative to inertial system, due to arbitrarily instantaneous ck-1System is inertial system, therefore this It is always 0;Indicate c systems relative to instantaneous ck-1Projection of the angular velocity of rotation of system under b systems;Indicate that b systems are opposite In projection of the angular velocity of rotation under b systems of c systems, since IMU and monocular camera are connected always, this is always 0; Indicate c systems relative to instantaneous ck-1Projection of the angular velocity of rotation of system under b systems.Instantaneous c is utilized in the derivation of above formulak-1System It is fixed relative to inertial system, and arbitrary instantaneous b systems are fixed relative to c systems.
One installation Matrix Estimation value of settingThe consecutive frame figure of monocular camera acquisition can be then carried out using gyro to measure As the resolving of relative attitude between camera coordinates system:
WhereinIndicate instantaneous ck-1It is to instantaneous ckThe estimated value of the Direct cosine matrix of system;Indicate c systems phase For instantaneous ck-1The estimated value of projection of the angular velocity of rotation of system under c systems;Indicate installation Matrix Estimation value;Table Show c systems relative to instantaneous ck-1It is projection of the angular velocity of rotation under b systems, it is measured equal to gyroscope known to Such analysis Value Indicate angular speedTo time integral, rotating vector will be obtained.
Matrix is then installedFollowing cost function minimums can be enabled to obtain, reality can optional one when calculating:
In practical calculating, according to the selection of referential, however, it is determined that use the cost function of incremental form, and rotation will not go out Existing unusual influence calculation accuracy then selects one in aforementioned four cost function and optimizes.
The physical significance of above-mentioned cost function is to project to camera coordinates system to the angular speed using gyro to measure to integrate out The each camera sampling instant come is calculated relative to the image that the posture increment and monocular camera of last camera sampling instant acquire The consecutive frame posture increment gone out is compared.The Direct cosine matrix of each sampling instant, expression is Current camera coordinate system phase For the direction cosine matrix of previous frame camera coordinates system;The Eulerian angles of each sampling instant, expression is Current camera coordinate It is the Eulerian angles relative to previous frame camera coordinates system;The physical significance of each sampling instant rotating vector, expression is current The direction of rotation of the camera coordinates system relative to previous frame camera coordinates system, the vector is the direction of rotary shaft, and modulus value is big The small angle for indicating rotation;The rotation quaternary number of each sampling instant, expression is Current camera coordinate system relative to previous frame The normalization rotation quaternary number (i.e. unit quaternion) of camera coordinates system.
3. introducing the cost function design of Lie algebra;
In conclusion cost function either general type or incremental form, the mathematical expression mode of posture all include Direct cosine matrix, four elements of Eulerian angles, rotating vector and normalization etc..It, can be according in calibration process when actually calculating The size of rotational steps considers from convenience of nonsingularity, the intuitive of expression and calculating etc., selects suitable generation Valence function.
It solves and makes cost function minimumThis problem can realize by non-linear least square method, and common non- It is required for solving Jocobian matrixes in linear least square method.It is noted that installation matrixBelong to SO (3), to addition It does not close, is not easy to seek Jocobian matrixes, therefore introduce Lie algebra in cost function, be converted in solution procedure For(3) the solution of rotating vector on, the optimization problem being converted into manifold are replaced in cost function with following formula
Wherein exp () maps for matrix exponetial, converts antisymmetric matrix to the element of (3) SO;θbcIndicate installation matrix Corresponding rotating vector;∧ operators indicate to be negated symmetrical matrix by vector.The cost of above-mentioned fixed reference form and incremental form The form variation of function is as follows, and reality can optional one when calculating:
Indicate the angular speed that t moment gyroscope measures.
It is practical to calculate, according to the selection of referential, a fixed reference form and incremental form are first selected respectively Cost function (if in view of rotation is likely to occur unusual influence calculation accuracy, selects the cost function of representation of Lie algebra), i.e., 2, which are selected, in above-mentioned eight cost functions optimizes (F11bc)~F14bc) in selection one;F21bc)~F24bc) Middle selection one).
(2) nonlinear least square method optimizes;
Installation matrix is acquired by minimizing one of above-mentioned cost functionIt is a unconfined non-linear least square Problem solves the problems, such as that the common algorithm includes single order (steepest decline) and the literary Burger-of second order gradient method, gauss-newton method, row Ma Kuiertefa etc..Wherein row text Burger-Ma Kuiertefa is with its higher robustness in non-linear least square problem solving In be widely adopted.This method carries out nonlinear optimization using the literary Burger-Ma Kuiertefa of row.
Optimize above-mentioned corresponding cost function Fjqbc) (j=1,2, q=1,2,3,4) obtain installation matrix process use Mathematical formulae is described as follows:
(3) for the selection of different reference frame cost function optimum results
Cost function for different reference frames are respectively adopted optimize as a result, need to select, determine a kind of generation The result of valence function optimization is final installation matrix.If using a fixed reference form cost function and an incremental form The Direct cosine matrix that cost function acquires is respectivelyWithThe specific method is as follows:
It will using logm mapping log () and ∨ operatorsWithIt is respectively converted into corresponding established angle Rotating vectorWith
It asksWithThe absolute value of the difference of modulus value:
Wherein norm () is vectorial modulo operator;Abs () is that signed magnitude arithmetic(al) is asked to accord with;Δ σ is that two rotations are sweared The absolute value of the difference of modulus value is measured, unit uses degree (°).
When Δ σ is less than certain threshold value (such as taking 0.01 °), it is believed that estimated using the cost function of different reference frames As a result it approaches,WithIn take any one.
When Δ σ is more than or equal to threshold value, then the estimated result of two kinds of reference frame cost functions is substituted into the two of selection respectively In a cost function, by taking the cost function for introducing Lie algebra as an example, i.e., seek respectivelyWith With(m and n appoint in 1~4 takes a value).If judgingAndThen recognize Estimated result for fixed reference system form cost function is good, and final matrix of installing takesIf judging AndThen think that the estimated result of incremental form cost function is good, final matrix of installing takes Then think that this calibration gathered data or other intermediate process errors that resolve are larger when other situations, as a result not adopts, need It re-scales.

Claims (5)

1. a kind of monocular camera and Inertial Measurement Unit are with respect to established angle scaling method, which is characterized in that specifically include step:
Step 1:Rotation measuring component acquires calibration data;The measurement assembly includes monocular camera and inertia measurement list Member;The calibration data of acquisition include the image of the angular speed that gyroscope measures and monocular camera acquisition;
Step 2:Relative attitude information is extracted from the image that monocular camera acquires;
Step 3:Installation matrix is solved using nonlinear least square method, realizes monocular camera and the opposite peace of Inertial Measurement Unit Fill the calibration at angle.
2. monocular camera as described in claim 1 and Inertial Measurement Unit are with respect to established angle scaling method, which is characterized in that step Rotation measuring component described in rapid one, it is the camera coordinates system being connected with monocular camera to define c systems first, according to determining for c systems Justice, xcAxis is perpendicularly oriented to the right side, z with monocular camera optical centercBefore axis overlaps direction with monocular camera optical center, ycAxis and monocular camera light The heart is perpendicularly oriented to down, by monocular camera alignment Calibration Field center, makes xcAxis is horizontal, ycAxis is directed toward plumb line direction, holds single Mesh camera is carried out around ycThe left-right rotation of axis, first turns left, then turns right, and eventually passes back to home position, and rotational angle is small In 30 °;Then it carries out around xcRotating upwardly and downwardly for axis, is first rotated up, and rotates still further below, eventually passes back to home position, rotates width Degree is less than 30 °;Then around zcShaft rotation returns to home position in dynamic one week.
3. monocular camera as described in claim 1 and Inertial Measurement Unit are with respect to established angle scaling method, which is characterized in that institute The frequency acquisition for stating the angular speed of gyroscope measurement is not less than 100Hz, and data acquire duration in 10s between 20s;The monocular The frequency acquisition of the image of camera acquisition is in 1Hz between 5Hz, and shutter speed is in 10ms or less.
4. monocular camera as described in claim 1 and Inertial Measurement Unit are with respect to established angle scaling method, which is characterized in that institute It states step 2 and extracts relative attitude information from the image that monocular camera acquires, include the camera coordinates at each image sampling moment It is the relative attitude relative to upper image sampling moment camera coordinates system, and the camera coordinates at each image sampling moment It is the relative attitude relative to calibration initial time camera coordinates system;
Define c1System is the instantaneous camera coordinates system of the starting of nominal time section, constant in its instantaneous direction of starting, therefore it is one A inertial system;For selected reference frame as the benchmark for defining posture, the reference frame is static relative to inertial space, and Coordinate origin is overlapped with calibration with the origin for originating instantaneous camera coordinates system in data, the starting of reference axis and nominal time section The coordinate overlapping of axles of instantaneous camera coordinates system;
(1) consecutive frame Feature Points Matching include single frames feature point extraction, characteristic point slightly match and matching characteristic point screening;
The matching characteristic point screening includes rejecting error hiding outlier and characteristic point distribution screening, rejects error hiding outlier and uses RANSAC algorithms, characteristic point distribution screening is between limiting characteristic point by the way of minimum range;
(2) consecutive frame spin matrix calculates;
The essential matrix that adjacent two frame is calculated using the characteristic point after screening, decomposes essential matrix, obtains multigroup rotation Matrix R and multigroup unit translational movement v remembers that the spin matrix between -1 frame of kth and kth frame is Rk-1,k
(3) rotation per frame relative to initial frame is calculated;
The spin matrix calculation formula of initial frame to kth frame is as follows:
5. monocular camera as described in claim 1 and Inertial Measurement Unit are with respect to established angle scaling method, which is characterized in that institute Step 3 is stated using nonlinear least square method solution installation matrix to optimize including design cost function, nonlinear least square method With the selection for different reference frame cost function optimum results;
(1) cost function is designed;
1. the cost function of fixed reference form designs;
It is inertial reference system to define i systems, and the camera coordinates system for selecting the starting of nominal time section instantaneous is reference frame, calibration The angular speed that all sampling instant gyroscopes measure in the process by being derived by c systems relative to c as follows1The angular speed of system:
WhereinIndicate the angular speed that gyroscope measures, i.e. angular velocity of rotation projection under b system of the b systems relative to inertial system;Indicate c1It is projection of the angular velocity of rotation under b systems relative to inertial system;Indicate b systems relative to c1The rotation angle of system Projection of the speed under b systems, due to c1System is inertial system;Indicate c systems relative to c1Throwing of the angular velocity of rotation of system under b systems Shadow;Indicate angular velocity of rotation projection under b system of the b systems relative to c systems;Indicate c systems relative to c1The rotation angle of system Projection of the speed under b systems, the b systems are the carrier system being connected with Inertial Measurement Unit, and right-handed system, three axis directions are respectively Right-under-preceding, the measurement output as angular speed of gyro is in three axial projection's coordinate of b systems;Each instantaneous carrier system is also one Inertial system;
Matrix is installedIt is defined as the Direct cosine matrix to c systems by b systems, three fix error angles are respectively azimuthal error angle ψ, bow Error angle θ and roll error angle γ are faced upward, by elder generation around ybAxis rotates ψ, further around xbAxis rotates θ, finally around zbAxis rotates γ,'s Expression formula is as follows:
One installation Matrix Estimation value of setting
Indicate c1It is the estimated value to the Direct cosine matrix of c systems;Indicate c systems relative to c1The angular velocity of rotation of system is in c systems Under projection estimated value;Indicate installation Matrix Estimation value;Indicate c systems relative to c1The angular velocity of rotation of system is under b systems Projection,The angular speed measured equal to gyroscopeIndicate angular speedTo time integral, incite somebody to action To rotating vector;∧ operators indicate to be negated symmetrical matrix by rotating vector;Exp () maps for matrix exponetial, by antisymmetric matrix It is converted into the element of three-dimensional proper orthogonal group SO (3);
Matrix is installedIt is obtained by following any cost functions:
Wherein, k=1 ..., n indicates that each sampling instant of monocular camera, n indicate sampling sum;Indicate spin matrixTransposition;Function eulr () indicates to seek Eulerian angles by Direct cosine matrix;Logm maps log () expressions will be three-dimensional Direct cosine matrix in proper orthogonal group SO (3) is transformed into the rotating vector antisymmetric matrix in so (3);∨ operators are indicated by anti- Symmetrical matrix seeks rotating vector;∧ operators indicate to be negated symmetrical matrix by rotating vector;Function qtn () is indicated by Direct cosine matrix Seek quaternary number;Indicate quaternary number multiplication;||·||2Two norm of matrix is sought in expression;I indicates unit matrix,
2. the cost function of incremental form designs;
Between monocular camera acquires in calibration process -1 frame image of kth and kth frame image, the angular speed that gyroscope measures is by pushing away Lead to obtain c systems relative to instantaneous ck-1The angular speed of system:
WhereinIndicate the angular speed that gyroscope measures, i.e. angular velocity of rotation projection under b system of the b systems relative to inertial system;Indicate instantaneous ck-1It is projection of the angular velocity of rotation under b systems relative to inertial system;Indicate b systems relative to wink When ck-1Projection of the angular velocity of rotation of system under b systems, due to arbitrary instantaneous ck-1System is inertial system;Indicate c systems phase For instantaneous ck-1Projection of the angular velocity of rotation of system under b systems;Indicate b systems relative to c systems angular velocity of rotation in b systems Under projection,Indicate c systems relative to instantaneous ck-1Projection of the angular velocity of rotation of system under b systems;
One installation Matrix Estimation value of setting
Indicate instantaneous ck-1It is to instantaneous ckThe estimated value of the Direct cosine matrix of system;Indicate c systems relative to instantaneous Ck-1The estimated value of projection of the angular velocity of rotation of system under c systems;Indicate installation Matrix Estimation value;Indicate c systems phase For instantaneous ck-1Projection of the angular velocity of rotation of system under b systems;Indicate angular speedTime is accumulated Point, rotating vector will be obtained;
Matrix is installedIt is obtained by following any cost functions:
3. introducing the cost function design of Lie algebra;
It is enabled in cost function
Wherein exp () maps for matrix exponetial, converts antisymmetric matrix to the element of three-dimensional proper orthogonal group SO (3);θbcTable Show installation rotating vector;∧ operators indicate to be negated symmetrical matrix by rotating vector, and the form variation of above-mentioned cost function is as follows,
Indicate the angular speed that t moment gyroscope measurement obtains;
(2) nonlinear least square method optimizes;
Optimize above-mentioned corresponding cost function Fjqbc) obtain installation matrix process it is as follows:
Wherein, j=1,2, q=1,2,3,4;
(3) for the selection of different reference frame cost function optimum results;
Determine that a kind of result of cost function optimization is final installation matrix, if using a fixed reference form cost function The Direct cosine matrix acquired with an incremental form cost function is respectivelyWithThe specific method is as follows:
It will using logm mapping log () and ∨ operatorsWithIt is respectively converted into corresponding established angle rotation VectorWith
It asksWithThe absolute value of the difference of modulus value:
Wherein norm () is vectorial modulo operator;Abs () is that signed magnitude arithmetic(al) is asked to accord with;
When Δ σ is less than threshold value, it is believed that it is close using the cost function estimated result of different reference frames,With In take any one;
When Δ σ is more than or equal to threshold value, then the estimated result of two kinds of reference frame cost functions is substituted into the two of selection respectively In a cost function, by taking the cost function for introducing Lie algebra as an example, i.e., seek respectivelyWith WithM and n appoints in 1~4 takes a value;If judgingAndThen recognize Estimated result for fixed reference system form cost function is good, and final matrix of installing takesIf judging AndThen think that the estimated result of incremental form cost function is good, final matrix of installing takes
CN201810478576.7A 2018-05-17 2018-05-17 Calibration method for relative installation angle of monocular camera and inertial measurement unit Active CN108592950B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810478576.7A CN108592950B (en) 2018-05-17 2018-05-17 Calibration method for relative installation angle of monocular camera and inertial measurement unit

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810478576.7A CN108592950B (en) 2018-05-17 2018-05-17 Calibration method for relative installation angle of monocular camera and inertial measurement unit

Publications (2)

Publication Number Publication Date
CN108592950A true CN108592950A (en) 2018-09-28
CN108592950B CN108592950B (en) 2021-11-26

Family

ID=63631935

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810478576.7A Active CN108592950B (en) 2018-05-17 2018-05-17 Calibration method for relative installation angle of monocular camera and inertial measurement unit

Country Status (1)

Country Link
CN (1) CN108592950B (en)

Cited By (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109442171A (en) * 2018-11-30 2019-03-08 西安交通大学 A kind of single eye stereo vision system and its application method
CN109883452A (en) * 2019-04-16 2019-06-14 百度在线网络技术(北京)有限公司 Parameter calibration method and device, electronic equipment, computer-readable medium
CN109949370A (en) * 2019-03-15 2019-06-28 苏州天准科技股份有限公司 A kind of automatic method for IMU- camera combined calibrating
CN110118572A (en) * 2019-05-08 2019-08-13 北京建筑大学 Multi-view stereo vision and inertial navigation system and relative pose parameter determination method
CN110648370A (en) * 2019-09-29 2020-01-03 百度在线网络技术(北京)有限公司 Calibration data screening method and device and electronic equipment
CN110751123A (en) * 2019-06-25 2020-02-04 北京机械设备研究所 Monocular vision inertial odometer system and method
CN111307176A (en) * 2020-03-02 2020-06-19 北京航空航天大学青岛研究院 Online calibration method for visual inertial odometer in VR head-mounted display equipment
CN111998870A (en) * 2019-05-26 2020-11-27 北京初速度科技有限公司 Calibration method and device of camera inertial navigation system
CN112116664A (en) * 2020-09-04 2020-12-22 季华实验室 Hand-eye calibration track generation method and device, electronic equipment and storage medium
CN112525143A (en) * 2019-09-19 2021-03-19 北京初速度科技有限公司 Method for determining installation angle of equipment and vehicle-mounted terminal
WO2021139396A1 (en) * 2020-01-06 2021-07-15 苏州宝时得电动工具有限公司 Self-moving device and control method thereof
CN113392909A (en) * 2021-06-17 2021-09-14 深圳市睿联技术股份有限公司 Data processing method, data processing device, terminal and readable storage medium
CN113733079A (en) * 2020-05-29 2021-12-03 配天机器人技术有限公司 Robot installation angle checking method and device and computer storage medium

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102435188A (en) * 2011-09-15 2012-05-02 南京航空航天大学 Monocular vision/inertia autonomous navigation method for indoor environment
CN105698765A (en) * 2016-02-22 2016-06-22 天津大学 Method using combination of double IMUs (inertial measurement units) and monocular vision to measure pose of target object under non-inertial system
CN106709222A (en) * 2015-07-29 2017-05-24 中国科学院沈阳自动化研究所 Monocular vision based IMU (inertial measurement unit) drift compensation method
US20170254832A1 (en) * 2011-11-04 2017-09-07 Google Inc. Calibrating Inertial Sensors Using an Image
CN107869989A (en) * 2017-11-06 2018-04-03 东北大学 A kind of localization method and system of the fusion of view-based access control model inertial navigation information

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102435188A (en) * 2011-09-15 2012-05-02 南京航空航天大学 Monocular vision/inertia autonomous navigation method for indoor environment
US20170254832A1 (en) * 2011-11-04 2017-09-07 Google Inc. Calibrating Inertial Sensors Using an Image
CN106709222A (en) * 2015-07-29 2017-05-24 中国科学院沈阳自动化研究所 Monocular vision based IMU (inertial measurement unit) drift compensation method
CN105698765A (en) * 2016-02-22 2016-06-22 天津大学 Method using combination of double IMUs (inertial measurement units) and monocular vision to measure pose of target object under non-inertial system
CN107869989A (en) * 2017-11-06 2018-04-03 东北大学 A kind of localization method and system of the fusion of view-based access control model inertial navigation information

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
GUANG YANG 等: ""Optimal Hand-Eye Calibration of IMU and Camera"", 《 2017 CHINESE AUTOMATION CONGRESS 》 *
TIAN SHAO-XIONG 等: ""Levenberg-Marquardt Algorithm Based Nonlinear Optimization of Camera Calibration for Relative Measurement"", 《PROCEEDINGS OF THE 34TH CHINESE CONTROL CONFERENCE》 *
毛友泽 等: ""无依托状态加速度计的新型标定方法"", 《北京航空航天大学学报》 *

Cited By (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109442171A (en) * 2018-11-30 2019-03-08 西安交通大学 A kind of single eye stereo vision system and its application method
CN109949370A (en) * 2019-03-15 2019-06-28 苏州天准科技股份有限公司 A kind of automatic method for IMU- camera combined calibrating
CN109883452A (en) * 2019-04-16 2019-06-14 百度在线网络技术(北京)有限公司 Parameter calibration method and device, electronic equipment, computer-readable medium
CN110118572A (en) * 2019-05-08 2019-08-13 北京建筑大学 Multi-view stereo vision and inertial navigation system and relative pose parameter determination method
CN111998870A (en) * 2019-05-26 2020-11-27 北京初速度科技有限公司 Calibration method and device of camera inertial navigation system
CN110751123A (en) * 2019-06-25 2020-02-04 北京机械设备研究所 Monocular vision inertial odometer system and method
CN112525143A (en) * 2019-09-19 2021-03-19 北京初速度科技有限公司 Method for determining installation angle of equipment and vehicle-mounted terminal
CN112525143B (en) * 2019-09-19 2022-09-27 北京魔门塔科技有限公司 Method for determining installation angle of equipment and vehicle-mounted terminal
CN110648370B (en) * 2019-09-29 2022-06-03 阿波罗智联(北京)科技有限公司 Calibration data screening method and device and electronic equipment
CN110648370A (en) * 2019-09-29 2020-01-03 百度在线网络技术(北京)有限公司 Calibration data screening method and device and electronic equipment
WO2021139396A1 (en) * 2020-01-06 2021-07-15 苏州宝时得电动工具有限公司 Self-moving device and control method thereof
CN111307176A (en) * 2020-03-02 2020-06-19 北京航空航天大学青岛研究院 Online calibration method for visual inertial odometer in VR head-mounted display equipment
CN111307176B (en) * 2020-03-02 2023-06-16 北京航空航天大学青岛研究院 Online calibration method for visual inertial odometer in VR head-mounted display equipment
CN113733079A (en) * 2020-05-29 2021-12-03 配天机器人技术有限公司 Robot installation angle checking method and device and computer storage medium
CN112116664A (en) * 2020-09-04 2020-12-22 季华实验室 Hand-eye calibration track generation method and device, electronic equipment and storage medium
CN112116664B (en) * 2020-09-04 2024-05-28 季华实验室 Method and device for generating hand-eye calibration track, electronic equipment and storage medium
CN113392909A (en) * 2021-06-17 2021-09-14 深圳市睿联技术股份有限公司 Data processing method, data processing device, terminal and readable storage medium

Also Published As

Publication number Publication date
CN108592950B (en) 2021-11-26

Similar Documents

Publication Publication Date Title
CN108592950A (en) A kind of monocular camera and Inertial Measurement Unit are with respect to established angle scaling method
CN110009681B (en) IMU (inertial measurement unit) assistance-based monocular vision odometer pose processing method
CN112598757B (en) Multi-sensor time-space calibration method and device
CN104704384B (en) Specifically for the image processing method of the positioning of the view-based access control model of device
Matungka et al. Image registration using adaptive polar transform
CN106525074B (en) A kind of compensation method, device, holder and the unmanned plane of holder drift
US9098229B2 (en) Single image pose estimation of image capture devices
CN110296691A (en) Merge the binocular stereo vision measurement method and system of IMU calibration
CN108036785A (en) A kind of aircraft position and orientation estimation method based on direct method and inertial navigation fusion
CN111354042A (en) Method and device for extracting features of robot visual image, robot and medium
CN108982901B (en) Method for measuring rotating speed of uniform-speed rotating body
CN109029433A (en) Join outside the calibration of view-based access control model and inertial navigation fusion SLAM on a kind of mobile platform and the method for timing
CN106052584B (en) A kind of view-based access control model and the orbit space linear measurement method of Inertia information fusion
CN109141433A (en) A kind of robot indoor locating system and localization method
CN112649016A (en) Visual inertial odometer method based on point-line initialization
CN107358633A (en) Join scaling method inside and outside a kind of polyphaser based on 3 points of demarcation things
CN107449444A (en) A kind of the star sensor intrinsic parameter scaling method and its device of more star chart posture associations
CN107516322B (en) Image object size and rotation estimation calculation method based on log polar space
CN107063190B (en) Pose high-precision direct method estimating towards calibration area array cameras image
CN106053874A (en) Drone provided with a vertical-view video camera compensated for the instantaneous rotations for estimation of the horizontal speeds
CN110032201A (en) A method of the airborne visual gesture fusion of IMU based on Kalman filtering
CN105607760A (en) Trace restoration method and system based on micro inertial sensor
CN110246194A (en) Method for quickly calibrating rotation relation between camera and inertia measurement unit
Wu et al. Simultaneous hand–eye/robot–world/camera–IMU calibration
CN106408600B (en) A method of for image registration in sun high-definition picture

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant