The present invention relates to the field of measurement, in particular to a method for determining pedestrian position, and an apparatus and storage medium for realizing the method.
Pedestrian Dead Reckoning (PDR) measures and counts the number of steps, step lengths and travel directions of a pedestrian when walking, and thereby calculates information such as a walking track and position of the pedestrian.
In a PDR method using an inertial measurement unit (IMU), the step lengths and number of steps of the pedestrian can be calculated on the basis of acceleration information, and a gyroscope or magnetic field sensor can be used to estimate the travel direction, thereby determining the position or movement track of the pedestrian. However, such a method is hampered by the so-called “drift problem” (caused by deviation in acceleration measurements), so positioning precision is poor.
Another PDR method is based on ultra wide band (UWB) technology, measuring distance and performing positioning by means of time differences of received signals, wherein a signal receiver is generally installed in a fixed position, and a moving object is equipped with a signal emitter (e.g. a wireless signal emitting tag). However, the shortcomings of UWB positioning are also obvious. For example, in an indoor environment, due to blocking by obstacles, the signal receiver might be unable to receive a signal sent by the moving object, and this will result in failure of positioning. In addition, this type of positioning technology must obtain the position of the signal receiver in advance, but in certain situations, the signal receiver will become unusable (e.g. the signal receiver is damaged due to fire).
Clearly, it will be a huge challenge for the industry to provide a PDR method that is capable of achieving satisfactory standards in terms of cost, precision and reliability amongst other things, and there is an urgent need for such a technical solution in the market.
An object of the present invention is to provide a method for determining pedestrian position information, having advantages such as high precision, low implementation costs and high reliability.
A method for determining pedestrian position information according to one embodiment of the present invention includes the following steps:
acquiring a step length measurement value and a travel direction measurement value of one or more footsteps of a pedestrian; and
determining position information of the pedestrian from the step length measurement value and the travel direction measurement value, wherein the step length measurement value of each footstep is provided by a signal receiver and a signal emitter, which form a pair and are disposed on different lower limbs of the pedestrian, and the travel direction measurement value is provided by an inertial measurement unit.
Preferably, in the method, the signal receiver, the signal emitter and the inertial measurement unit are disposed on feet of the pedestrian.
Preferably, in the method, the position information comprises a position and/or a walking track of the pedestrian.
Preferably, in the method, a position of the pedestrian is determined according to the following formulae:
where x and y are a horizontal coordinate and a vertical coordinate of the position of the pedestrian respectively; n is the number of footsteps; Δri is a step length of an ith footstep; θi is the travel direction measurement value of the ith footstep; Δrfh,i is a measurement value of the distance between the signal receiver and the signal emitter when the ith footstep begins; Arsh,i is a measurement value of the distance between the signal receiver and the signal emitter when the ith footstep ends; Δrv is the distance between the two feet when the pedestrian is standing with the two feet parallel.
Preferably, in the method, the inertial measurement unit includes a first sub-unit and a second sub-unit, which are disposed on different lower limbs of the pedestrian, and the method determines a position of the pedestrian according to the following formulae:
where x and y are a horizontal coordinate and a vertical coordinate of the position of the pedestrian respectively; n is the number of footsteps; Arr,i and Ar1,i are step lengths of ith footsteps of a right foot and a left foot respectively; θr,i is the travel direction measurement value of the ith footstep provided by one of the first sub-unit and the second sub-unit; θ1,i is the travel direction measurement value of the ith footstep provided by the other one of the first sub-unit and the second sub-unit; Δrfh,r,i is a measurement value of the distance between the signal receiver and the signal emitter when the ith footstep of the right foot begins; Arsh,r,i is a measurement value of the distance between the signal receiver and the signal emitter when the ith footstep of the right foot ends; Arfh,1,i is a measurement value of the distance between the signal receiver and the signal emitter when the ith footstep of the left foot begins; Arsh,1,i is a measurement value of the distance between the signal receiver and the signal emitter when the ith footstep of the left foot ends; Δrv is the distance between the two feet when the pedestrian is standing with the two feet parallel.
Another object of the present invention is to provide an apparatus for determining pedestrian position, having advantages such as high precision, low implementation costs and high reliability.
An apparatus for determining pedestrian position according to one embodiment of the present invention includes:
a signal receiver and a signal emitter, which form a pair and are disposed on different lower limbs of a pedestrian, and are configured to provide a step length measurement value of one or more footsteps of the pedestrian;
an inertial measurement unit, configured to provide a travel direction measurement value of one or more footsteps of the pedestrian; and
a processor, configured to determine position information of the pedestrian from the step length measurement value and the travel direction measurement value.
Another object of the present invention is to provide a computer readable storage medium, which is capable of determining position information of a pedestrian at a low cost with high precision and high reliability.
A computer readable storage medium according to another aspect of the present invention, on which a computer program is stored, characterized in that when executed by a processor, the program realizes the method as described above.
Since the step length measurement value provided by the combination of the signal receiver and the signal emitter is far superior in terms of precision than a step length value measured by the inertial measurement unit, the method and apparatus according to the present invention increase the precision of position information. In addition, the technical solution of the present invention also shakes off dependence on a UWB positioning signal receiver.
The abovementioned and/or other aspects and advantages of the present invention will be made clearer and easier to understand by the following description of various aspects with reference to the accompanying drawings, in which identical or similar units are indicated by identical labels. The drawings comprise:
The present invention is explained more comprehensively below with reference to the accompanying drawings, which show schematic embodiments of the present invention. However, the present invention may be realized in different forms, and should not be interpreted as being limited to the embodiments given herein. Said embodiments are intended to make the disclosure herein comprehensive and complete, and thereby enable a more comprehensive and accurate understanding of the scope of protection of the present invention.
Terms such as “includes” and “comprises” indicate that in addition to having the units and steps directly and explicitly expressed in the description and claims, the technical solution of the present invention does not rule out cases of having other units and steps which are not directly or explicitly expressed.
Terms such as “first” and “second” do not indicate the order of units in time, space or size, etc., being merely used to distinguish between units.
In this text, “position information” should be broadly interpreted as various types of position-related information, e.g. including but not limited to a position and walking track of a pedestrian, etc.
In the vast majority of cases, human walking is performed by the left and right legs alternately. In this text, a footstep means a single pace walked by a left foot or a right foot.
According to one aspect of the present invention, a step length measurement value of each footstep is provided by a signal receiver and a signal emitter, which form a pair and are disposed on different lower limbs of a pedestrian. During walking, the signal receiver and signal emitter disposed on different lower limbs will sense change in the distance therebetween; there is a high degree of correspondence between such a distance signal and a step length value of each footstep, hence the step length measurement value can be obtained therefrom. In addition, a travel direction measurement value of each footstep is provided by an inertial measurement unit. The step length measurement value and travel direction measurement value provided may be used to determine position information of the pedestrian.
The distance between the lower limbs of the pedestrian changes as the pedestrian walks in an alternating fashion; by cooperating with each other, the signal receiver and signal emitter can measure the step length value of each footstep. Since the distance moved by a foot within a plane is almost the distance walked by a person, according to another aspect of the present invention, the signal receiver and signal emitter are disposed on feet of the pedestrian (e.g. the signal receiver and signal emitter are disposed in ankle rings attached to the ankles, etc., or disposed at the bottom of shoes). However, it must be pointed out that other regions of the lower limbs are also feasible.
According to another aspect of the present invention, the inertial measurement unit includes a first sub-unit and a second sub-unit; these two sub-units are disposed on different lower limbs of the pedestrian (e.g. the feet), and each independently provide travel direction measurement values. Two sets of position information corresponding to the two travel direction measurement values can thereby be obtained. The precision of position information can be further increased by suitably combining the two sets of position information (e.g. by taking the arithmetic mean).
According to another aspect of the present invention, after acquiring the step length measurement value and travel direction measurement value of one footstep of the pedestrian, the displacement of this footstep can be determined, and a real-time movement track and position of the pedestrian can thereby be obtained; alternatively, after acquiring the step length measurement values and travel direction measurement values of multiple footsteps of the pedestrian, the displacements of these footsteps can be determined, and a history of position information of the pedestrian can thereby be obtained.
According to another aspect of the present invention, a step length measurement value and a travel direction measurement value of each footstep are both provided by an inertial measurement unit, and a step length measurement value provided by a signal receiver and a signal emitter, which form a pair and are disposed on different lower limbs of the pedestrian, is used to correct the step length measurement value obtained by the inertial measurement unit, thereby solving the drift problem.
Embodiments of the present invention are described in detail below with the aid of the accompanying drawings.
In this embodiment, the signal receiver 110A and the signal emitter 110B are adapted to be disposed on different lower limbs of a pedestrian, being configured to cooperate in order to provide a step length measurement value of one or more footsteps of the pedestrian. The inertial measurement unit 120 is configured to provide a travel direction measurement value of one or more footsteps of the pedestrian. Preferably, the signal receiver 110A, signal emitter 110B and inertial measurement unit 120 are adapted to be disposed on feet of the pedestrian. More advantageously, the inertial measurement unit 120 may be integrated with one of the signal receiver 110A and the signal emitter 110B.
As shown in
Compared with the embodiment shown in
As stated above, the step length measurement value is obtained from a relative distance signal of the signal receiver and the signal emitter, therefore in the embodiments shown in
It must also be pointed out that the processor in the embodiments shown in
It must also be pointed out that the apparatuses 10 and 20 for determining pedestrian position might also comprise other units (e.g. a memory, display screen and wireless transceiver), but those skilled in the art will realize from the following description that the units mentioned above are sufficient to provide the function of determining pedestrian position information, so in order to avoid superfluous description, this embodiment does not describe other units.
The method shown in
Next, the method enters step 320; the processor 130 or 230 determines whether a new step length measurement value from the signal receiver or signal emitter, and a new travel direction measurement value from the inertial measurement unit, are received (in the case of the embodiment shown in
In step 330, the new step length measurement value and travel direction measurement value are stored in an internal memory of the apparatus 10 or 20 for determining pedestrian position information and/or sent to an external device (e.g. a mobile phone or smart wristwatch). In this embodiment, step 330 is optional.
In step 340, the processor 130 or 230 calculates a displacement increment generated by a current footstep.
x
i
=Δr
i*cos θi (1)
y
i
=Δr
i*sin θi (2)
Δri=√{square root over (Δrfh,i2−Δrv2)}+√{square root over (Δrsh,i2−Δrv2)} (3)
Here, xi and yi are displacement increments along the horizontal and vertical axes respectively, generated by the ith footstep (the current footstep) of the pedestrian; Δri is the step length of the ith footstep; θI is the travel direction measurement value of the ith footstep; Δrfh,i is a measurement value of the distance between the signal receiver and the signal emitter when the ith footstep begins; Arsh,i is a measurement value of the distance between the signal receiver and the signal emitter when the ith footstep ends; Δrv is the distance between the two feet when the pedestrian is standing with the two feet parallel.
Formulae (1)-(3) above apply to the scenario where the inertial measurement unit only provides one travel direction measurement value.
Here, xi and yi are displacement increments along the horizontal and vertical axes respectively, generated by an ith footstep (the current footstep) of the pedestrian; Δrr,i and Δr1,i are the step lengths of the ith footsteps of the right foot and the left foot respectively; θr,i is the travel direction measurement value of the ith footstep provided by one of the first sub-unit and the second sub-unit; θ1,i is the travel direction measurement value of the ith footstep provided by the other one of the first sub-unit and the second sub-unit; Δrfh,r,i is a measurement value of the distance between the signal receiver and the signal emitter when the ith footstep of the right foot begins; Δrsh,r,i is a measurement value of the distance between the signal receiver and the signal emitter when the ith footstep of the right foot ends; Δrfh,1,i is a measurement value of the distance between the signal receiver and the signal emitter when the ith footstep of the left foot begins; Δrsh,1,i is a measurement value of the distance between the signal receiver and the signal emitter when the ith footstep of the left foot ends; Δrv is the distance between the two feet when the pedestrian is standing with the two feet parallel.
Preferably, Δrr,i and Δr1,i may be chosen to have the same value, hence the value of just one of Δrr,i and Δr1,i may be calculated according to formula (8) or (9).
Step 350 is entered after step 340 is performed: the apparatus 10 or 20 for determining pedestrian position information outputs the calculated displacement increment generated by the current footstep to an external device (e.g. a mobile phone or smart wristwatch), or draws a movement track and/or current position of the pedestrian on an internal presentation unit (e.g. a display screen) thereof.
Step 360 is then entered: the apparatus 10 or 20 for determining pedestrian position information determines whether an instruction to exit the real-time operating mode is received, and if such an instruction is received, exits the work flow, otherwise returning to step 320.
The method shown in
Step 520 is then entered: the apparatus 10 or 20 for determining pedestrian position information calls historical data of measurement values of the pedestrian from an internal memory or an external device. Preferably, the historical data may carry time stamps to facilitate the calling of measurement values within a set time period.
Step 530 is then entered. In step 530, the processor 130 or 230 calculates the current position of the pedestrian. In the case where the inertial measurement unit only provides one travel direction measurement value, the processor calculates the current position according to the following formulae:
Here, x and y are a horizontal coordinate and a vertical coordinate of the current position of the pedestrian respectively; n is the number of footsteps; Δri is the step length of the ith footstep; θi is the travel direction measurement value of the ith footstep; Δrfh,i is a measurement value of the distance between the signal receiver and the signal emitter when the ith footstep begins; Δrsh,i is a measurement value of the distance between the signal receiver and the signal emitter when the ith footstep ends; Δrv is the distance between the two feet when the pedestrian is standing with the two feet parallel.
In the case where the inertial measurement unit provides two travel direction measurement values, the processor calculates the current position according to the following formulae:
Here, x and y are a horizontal coordinate and a vertical coordinate of a position of the pedestrian respectively; n is the number of footsteps; Δrr,i and Δr1,i are the step lengths of the ith footsteps of the right foot and the left foot respectively; θr,i is the travel direction measurement value of the ith footstep provided by one of the first sub-unit and the second sub-unit; θ1,i is the travel direction measurement value of the ith footstep provided by the other one of the first sub-unit and the second sub-unit; Δrfh,r,i is a measurement value of the distance between the signal receiver and the signal emitter when the ith footstep of the right foot begins; Δrsh,r,i is a measurement value of the distance between the signal receiver and the signal emitter when the ith footstep of the right foot ends; Δrfh,1,i is a measurement value of the distance between the signal receiver and the signal emitter when the ith footstep of the left foot begins; Δrsh,1,i is a measurement value of the distance between the signal receiver and the signal emitter when the ith footstep of the left foot ends; Δrv is the distance between the two feet when the pedestrian is standing with the two feet parallel.
Preferably, Δrr,i and Δr1,i may be chosen to have the same value, hence the value of just one of Δrr,i and Δr1,i may be calculated according to formula (19) or (20).
It must be pointed out that in step 530, the calculated current position of the pedestrian takes an initial position (i.e. the position of the pedestrian before the first footstep) as a reference, but this is merely demonstrative, not necessary.
Step 540 is entered after step 530 is performed: the apparatus 10 or 20 for determining pedestrian position information outputs the calculated position information to an external device (e.g. a mobile phone or smart wristwatch), or draws position information on an internal presentation unit (e.g. a display screen) thereof.
According to another aspect of the present invention, also provided is a computer readable storage medium, on which a computer program is stored; when executed by a processor, the program can realize the method for determining pedestrian position information described above with the aid of
Although some aspects of the present invention have already been displayed and discussed, those skilled in the art should realize that the abovementioned aspects could be changed on condition that the principles and spirit of the present invention are not departed from, therefore the scope of the present invention will be defined by the claims and equivalent content.
Number | Date | Country | Kind |
---|---|---|---|
201710594851.7 | Jul 2017 | CN | national |