1. Field of the Invention
The present invention relates to computer techniques, and more particularly to ergonomic inertial positioning systems and methods.
2. Description of the Related Art
Most current positioning techniques utilize signals from global positioning system (GPS) satellites or wireless local area networks (LAN) to calculate positions. GPS signals may be interrupted when the signal source is obstructed by buildings or forest. The accuracy of wireless-LAN-based positioning is easily affected by space factors, such as crowds.
Traditional inertial positioning measures the acceleration of an object to calculate the displacement thereof, and is thus not affected by the environment. Accelerators are more expensive as they offer improved accuracy in acceleration detection. Table 1 shows the exemplary accuracy and prices of accelerators.
Traditional inertial positioning suffers from the accumulated errors caused by sensor noise or numerical calculation. As measured acceleration is integrated twice for displacement calculation, displacement errors increase progressively with time.
Traditional inertial positioning immune to environmental factors is typically implemented in aircrafts, vehicles, and similar machines due to regular and smooth variation in their velocities, but may not work with objects moving in complex ways, such as animals and humans.
An exemplary embodiment of an ergonomic inertial positioning system comprises a motion sensor, an angle sensor, and a processor. The motion sensor detects movement of an object. The angle sensor detects angle variation of the heading of the object. The processor determines motion status of the object based on detected data provided by the motion sensor and the angle sensor, and calculates displacement of the object utilizing the detected angle variation thereof based on the motion status.
An exemplary embodiment of an ergonomic inertial positioning method is provided. Movement of an object is detected utilizing a motion sensor. Angle variation of the heading of the object is detected utilizing an angle sensor. Motion status of the object is determined based on detected data provided by the motion sensor and the angle sensor. Displacement of the object is calculated utilizing the detected angle variation thereof based on the motion status.
A detailed description is given in the following embodiments with reference to the accompanying drawings.
The invention can be more fully understood by reading the subsequent detailed description and examples with references made to the accompanying drawings, wherein:
The following description is of the best-contemplated mode of carrying out the invention. This description is made for the purpose of illustrating the general principles of the invention and should not be taken in a limiting sense. The scope of the invention is best determined by reference to the appended claims.
Ergonomic inertial positioning system 100 in
With reference to
Motion status of object 6 may be classified as a stationary status, a turning status, and a moving status, each corresponding to a criterion. When acceleration variation detected by motion sensor 7 is less than a first threshold a, and angle variation detected by angle sensor 8 is less than a second threshold b, processor 1 determines that object 6 is in the stationary status.
When acceleration variation detected by motion sensor 7 is greater than the first threshold a, and angle variation detected by angle sensor 8 is in a range between a third threshold c and the second threshold b, processor 1 determines that object 6 is in the moving status.
When angle variation detected by angle sensor 8 is greater than the second threshold b, processor 1 determines that object 6 is in the turning status. The first threshold a is preferably between 2.0 m/s2 and 5.5 m/s2. The second threshold b is preferably between 10 degrees and 30 degrees. The third threshold c is preferably between 2 degrees and 5 degrees. Note that although processor 1 determines motion status of object 6 based on detected variation of acceleration on the Z-axis and the angle variation, motion status determination may utilize only one type of detected data.
For example, detected data provided by motion sensor 7 and angle sensor 8 is shown in
Processor 1 determines that periods R1, R3, and R5 represents stationary statuses of object 6, period R2 the moving status, and period R4 the turning status. When object 6 is in the stationary status, processor 1 computes object 6's displacement AS and heading angle variation ΔH by ΔS=(0,0) and ΔH=0 (step S6). When object 6 is in the turning status, processor 1 computes displacement ΔS of object 6 and heading angle variation ΔH by ΔS=(0,0) and ΔH=ΔΦ (step S8).
When object 6 is in the moving status, processor 1 computes displacement ΔS object 6 at i-th step utilizing the following formula (step S10):
ΔSi=(d(ΔΦi)×cos Φzi, d(ΔΦi)×sin Φzi), (1)
where i comprises a positive integer, d(ΔΦi) is the pace of object 6 at the i-th step, ΔΦi is the angle variation of object 6 at the i-th step, Φzi is an angle representing the heading of object 6 at the i-th step. When object 6 is in the moving status, angle sensor 8 detects a maximum angle and a minimum angle of headings of object 6 relative to a reference angle at the i-th step, and ΔΦi is the difference between the maximum angle and the reference angle or the difference between the minimum angle and the reference angle. The reference angle may be adjusted during movement of object. Total displacement S of object 6 can be calculated utilizing the following formula:
When object 6 is in the moving status, processor 1 calculates paces thereof utilizing angle variation detected by angle sensor 8. According to experimental results, the pace of object 6 at the i-th step is preferably simulated by a three degree polynomial of a variable ΔΦi. In a preferred embodiment, processor 1 calculates pace d(ΔΦi) of object 6 at the i-th step utilizing the following formula:
d(ΔΦi)=a0+(a1×ΔΦi)+(a2×ΔΦi2)+(a3×ΔΦi3)+ . . . (an×ΔΦin), (3)
where n is a positive integer. The sensor unit, such a single device implemented by motion sensor 7 and angle sensor 8, is preferably disposed at the waist for better angle variation detection.
When n is two, the coefficients of the formula comprise a0=0.015489, a1=0.086503, and a2=−0.0018056.
When n is three, the coefficients of the formula comprise a0=0.32396, a1=−0.015814, a2=0.0088312, and a3=−0.00034889.
When n is four, the coefficients of the formula comprise a0=0.57971, a1=−0.12933, a2=0.026913, a3=−0.001578, and a4=0.00003017.
Memory 2 stores data detected and provided by motion sensor 7 and angle sensor 8. Processor 1 may adjust the reference angle upon each retrieval of a detected peak or valley angle value. The reference angle may be derived with two schemes. First, the reference angle may be derived from a portion of curve 300 during a period when the angle variation of object 6 is less than a predetermined value. For example, the reference angle may comprise an average of detected angle data during period R1, −93 degree. In
Additionally, processor 1 may calculate an average of the maximum angle and the minimum angle of the heading of object 6 at the i-th step to be a new reference angle and calculates angle variation ΔΦi+1 of the heading of object 6 based on the new reference angle.
For example, the average of corresponding angles of P1 and P2 is −96 degree. In
When object 6 in its first step, Φzi=0. When i>1, Φzi comprises an average of a peak angle value Φmax and a valley angle value Φmin, i.e. Φzi=(Φmax+Φmin)/2.
The system reduces time-dependent errors by avoiding acceleration integration. Motion sensor 7 is utilized to determine the motion status of object 6.
When the paces are simulated by a three degree polynomial, positioning utilizing the system with the cheapest accelerator described achieves a root mean square value 0.0633 m/step of position errors according to experiment results. If object 6 moves for one minute at a speed of two steps per second, a position error 7.6 m is obtained, only as much as ¼ to 2/13 of an error the conventional positioning techniques would suffer in the same condition.
While the invention has been described by way of example and in terms of the preferred embodiments, it is to be understood that the invention is not limited to the disclosed embodiments. To the contrary, it is intended to cover various modifications and similar arrangements (as would be apparent to those skilled in the art). Therefore, the scope of the appended claims should be accorded the broadest interpretation so as to encompass all such modifications and similar arrangements.
Number | Date | Country | Kind |
---|---|---|---|
94142789 A | Dec 2005 | TW | national |
Number | Name | Date | Kind |
---|---|---|---|
5736923 | Saab | Apr 1998 | A |
6216079 | Matsuda | Apr 2001 | B1 |
6456920 | Nishio et al. | Sep 2002 | B1 |
6651027 | McCall et al. | Nov 2003 | B2 |
6915205 | Kim et al. | Jul 2005 | B2 |
7032450 | Lee et al. | Apr 2006 | B2 |
20030158665 | McCall et al. | Aug 2003 | A1 |
Number | Date | Country |
---|---|---|
301711 | Apr 1997 | TW |
593981 | Jun 2004 | TW |
Number | Date | Country | |
---|---|---|---|
20070125173 A1 | Jun 2007 | US |