One kind is based on the micro- inertia autonomous navigation method of indoor walking
Technical field
It is the invention belongs to technical field of inertial, in particular to a kind of based on the micro- inertia independent navigation side of indoor walking
Method.
Background technique
In walking micro-inertial navigation equipment, since the error of Mierotubule-associated proteins is larger, it will usually be led using some other
Boat system or sensor composition integrated navigation system application, such as satellite navigation, WLAN, ultra-wide band positioning etc., but this
A little ancillary techniques are perhaps difficult to work normally the additional hardware infrastructure layout of perhaps needs indoors or increase itself
Hardware facility is also unfavorable for keeping the independence of equipment.In the present invention, using the relatively regular feature of indoor landform, by sentencing
The track situation that line-break is walked provides virtual course error observed quantity for micro-inertial navigation, without being combined with other information,
Addition device hardware is not needed, without the support of infrastructure, while keeping micro-inertial navigation independence, improves walking
The positioning accuracy of micro- inertia independent navigation equipment.
Summary of the invention
Presently, there are aiming at the problem that, propose a kind of based on the micro- inertia autonomous navigation method of indoor walking, lead to and do not increasing
Device hardware and infrastructure, and while keep micro-inertial navigation independence, improve indoor walking micro-inertial navigation equipment
Precision.
In order to realize the purpose, the technical solution adopted by the present invention is that:
One kind includes seven steps based on the micro- inertia autonomous navigation method of indoor walking, this method, and step 1 is initially aligned,
It is initially aligned using paper feeding method, obtains the higher initial navigation state of precision;Step 2 calculates course deviation and position
Deviation;Step 3 averages to deviation;Step 4 obtains current location and calculates;Step 5 judges whether to meet linear rows
It walks;Step 6 judges (1) again;Step 7 judges (2) again;Step 8: updating.
One kind calculating course deviation and position deviation based on the micro- inertia autonomous navigation method of indoor walking, the step 2,
It is after initial alignment, along straight line walking n1Step, the inertial navigation during which carried out under zero-velocity curve auxiliary calculates, sliding simultaneously
It is dynamic to calculate nearest n2The course deviation δ ψ of stepi(i=1,2 ... a) and lateral position deviation δ P relative to straight line pathi(i=1,
2 ... a), wherein n1=n2+ a-1, n2>=3, a >=3 are sliding window quantity.
For one kind based on the micro- inertia autonomous navigation method of indoor walking, it is to preceding n that the step 3, which averages to deviation,1
Course deviation δ ψ obtained in stepi(i=1,2 ... a) and lateral position deviation δ P relative to straight line pathi(i=1,2 ... a) is asked
Average value obtains course deviation mean valueWith lateral position deviation mean value
One kind is obtained current location and is simultaneously calculated based on the indoor micro- inertia autonomous navigation method of walking, the step 4, be
In normal use, pedestrian indoors arbitrarily walk by environment, and walking micro-inertial navigation equipment still carries out used under zero-velocity curve auxiliary
Property navigation, externally export positioning result, i.e. current location P, and sliding calculates nearest n at the same time2Navigation boat in the time of step
To deviation δ ψkWith the lateral position deviation δ P relative to straight line pathk, save nearest n2The inertance element sampled value of step and zero
The state estimation and error co-variance matrix of fast correction wave filter.
Based on the micro- inertia autonomous navigation method of indoor walking, the step 5 judges whether to meet straight line walking one kind, is
Judge nearest n2In the time of step, navigational course deviation δ ψkWith the lateral position deviation δ P relative to straight line pathkWhether meet
Straight line walking criterion, i.e.,
It is whether true.
Wherein α and β is respectively precedence constraints coefficient, α < 1 and β > 1.
One kind is based on the micro- inertia autonomous navigation method of indoor walking, and the step 6 judges (1) again, if the criterion of step 5
It sets up, and previous step also meets straight line walking criterion, then is increased in zero-velocity curve using the course of previous step as observation
Air Canada re-starts filtering to observed quantity and calculates, and obtains new present orientation and current location.
One kind is based on the micro- inertia autonomous navigation method of indoor walking, and the step 7 judges (2) again, if the criterion of step 5
It sets up, but previous step is unsatisfactory for straight line walking criterion, then needs to judge current course and when meeting straight line criterion of the last time
The relationship in the course at quarter, due to the indoor environment largely built all be it is upright, it is believed that the course phase of each straight line path
Poor 90 ° or 90 ° of multiple, i.e.,
One of set up.
WhereinFor current course observation, ψk-For the last course for meeting the straight line criterion moment.
UsingAs observation, increases course observed quantity in zero-velocity curve and re-start filtering calculating, obtain new
Present orientation and current location.
One kind is updated based on the micro- inertia autonomous navigation method of indoor walking, the step 8;If logical for current navigation state
It crosses to recalculate and be updated, need the state of the corresponding inertance element sampled value of synchronized update and zero-velocity curve filter
Estimated value and error co-variance matrix.
The invention has the benefit that
In the indoor conditions application of walking micro-inertial navigation equipment, using the relatively regular feature of indoor landform, pass through
Judge that the track situation of walking provides virtual course error observed quantity for micro-inertial navigation, inhibits course error accumulation, reach
Inhibit the purpose of position error diverging.Walking micro-inertial navigation equipment does not need addition and sets without being combined with other information
While keeping micro-inertial navigation independence, it is certainly leading to improve the micro- inertia of walking without the support of infrastructure for standby hardware
The positioning accuracy for equipment of navigating.
Detailed description of the invention
Fig. 1 is the flow chart of the method for the present invention.
Specific embodiment
The specific embodiment of the invention is as follows:
Further to illustrate technological means and its effect adopted by the present invention, preferred implementation of the invention is once combined
And its attached drawing is described in detail.
One kind is specific as follows based on the micro- inertia autonomous navigation method of indoor walking, including seven steps:
Step 1: initial alignment;
It is initially aligned using known method, obtains the higher initial navigation state of precision.
Step 2: calculating course deviation and position deviation;
After initial alignment, along straight line walking n1Step, the inertial navigation during which carried out under zero-velocity curve auxiliary calculate, together
When sliding calculate nearest n2The course deviation δ ψ of stepi(i=1,2 ... a) and lateral position deviation δ P relative to straight line pathi(i
=1,2 ... a), wherein n1=n2+ a-1, n2>=3, a >=3 are sliding window quantity.
Step 3: averaging to deviation;
To preceding n1Course deviation δ ψ obtained in stepi(i=1,2 ... a) and lateral position deviation δ relative to straight line path
Pi(i=1,2 ... a) average, and obtain course deviation mean valueWith lateral position deviation mean value
Step 4: obtaining current location and calculating;
During normal use, pedestrian indoors arbitrarily walk by environment, and walking micro-inertial navigation equipment still carries out zero-velocity curve
Inertial navigation under auxiliary, externally exports positioning result, i.e. current location P, and sliding calculates nearest n at the same time2The time of step
Interior navigational course deviation δ ψkWith the lateral position deviation δ P relative to straight line pathk, save nearest n2The inertance element of step is adopted
The state estimation and error co-variance matrix of sample value and zero-velocity curve filter.
Step 5: judging whether to meet straight line walking;
Judge nearest n2In the time of step, navigational course deviation δ ψkWith the lateral position deviation δ P relative to straight line pathk
Whether straight line walking criterion is met, i.e.,
It is whether true.
Wherein α and β is respectively precedence constraints coefficient, α < 1 and β > 1.
Step 6: judging (1) again;
If the criterion of step 5 is set up, and previous step also meets straight line walking criterion, then is made using the course of previous step
For observation, increases course observed quantity in zero-velocity curve and re-start filtering calculating, obtain new present orientation and present bit
It sets.
Step 7: judging (2) again;
If the criterion of step 5 is set up, but previous step be unsatisfactory for straight line walking criterion, then need to judge current course with most
The relationship in the nearly primary course for meeting the straight line criterion moment, since the indoor environment largely built all is upright, so
Think that the course of each straight line path differs 90 ° or 90 ° of multiple, i.e.,
One of set up.
WhereinFor current course observation, ψk-For the last course for meeting the straight line criterion moment.
UsingAs observation, increases course observed quantity in zero-velocity curve and re-start filtering calculating, obtain new
Present orientation and current location.
Step 8: updating;
If current navigation state is updated by recalculating, the corresponding inertance element sampled value of synchronized update is needed
And the state estimation and error co-variance matrix of zero-velocity curve filter.