METHOD AND SYSTEM FOR MOBILE LOCATION
Background Art
The present invention relates to a positioning system, and particularly, to a mobile positioning method and system.
Global Positioning System (GPS) is widely used in navigating and positioning. Generally, the positioning location of GPS is based on a geodetic coordinate system.
Figure 1 is a schematic diagram of the geodetic coordinate system. The geodetic coordinate system is a coordinate system taking reference ellipsoid surface as datum. In the geodetic coordinate system, the position of point P is usually indicated by geodetic longitude φ, geodetic latitude λ and geodetic altitude h, but the position of point P could be indicated by geodetic longitude φ and geodetic latitude λ only when point P is just on the ellipsoid surface, wherein the geodetic longitude φ of point P is the angle between the prime meridian plane and the geodetic meridian plane passing through point P, the geodetic latitude λ is the angle between the equator and the normal passing through point P, and the geodetic altitude h is the distance from point P to reference ellipsoid surface along the normal.
Besides geodetic coordinate system, there are many other coordinate systems, which'take different references as datum, e.g. Earth-Centered Earth-Fix (ECEF) coordinate system and etc.
Figure 2 is a schematic diagram of ECEF coordinate system. The origin (0,0,0) of ECEF coordinate system is located at the centroid of the Earth, where Z- axis is directed towards the Conventional Terrestrial Pole defined in BIH1984.0, X- axis is directed to the intersection of the equator and the prime meridian plane of BIH1984.0, and Y-axis completes a right-handed system together with X-axis and Z-axis. The position of point P (X, Y, Z) is indicated by the distance from point P to X-axis, Y-axis and Z-axis respectively.
Although GPS is widely used in positioning, GPS receiver can't accurately receive signal in certain areas, especially in closed urban area like in a high building, or in the forest, even when the signal is transmitted from a satellite, because GPS signal is often shielded by landform and objects on the ground.
In addition to GPS, there are multiple techniques aiming for precise positioning, e.g. using mobile network for supplementing GPS to position or asking a person to carry a step counter for calculating the walking distance when the area is small. However, defects of different degrees exist in the techniques above. For example, using a mobile network for supplementing GPS to position is limited by the mobile network. No precise positioning can be carried out in a region with no mobile network or a region in mobile network where the signal does not receive well. Similarly, using a step counter for positioning is limited by the step counter's self-set walking distance.
In all positioning systems, to precisely position a positioning object, the 3- dimension movement information of the positioning object shall be obtained. Therefore, obtaining the 3-dimension movement information of the positioning object is a key problem in the positioning system.
A 3 -dimension handwriting recognition method and system, which is a new
3-dimension information obtaining method and system, is disclosed successively in the patent application under Chinese application No. 02144248.7 (application date: September 28, 2002; inventors: Du Yonggang, Tu Jiawen, Feng Lei, Shao Xiaoling) and the patent application under Chinese application No. 02159784.7 (application date: December 26, 2002; inventors: Shao Xiaoling, Tu Jiawen, Feng
Lei) (contents of the above two patent applications are incorporated herein by reference). The system tracks the user's handwriting input in 3-dimension space, produces corresponding 3-dimension movement data, and constitutes 3-dimension movement tracks, which are projected then on a 2-dimension plane to produce a corresponding 2-dimension image for handwriting recognition. The system can further transmit the tracked 3-dimension movement data or 3-dimension movement tracks to terminals such as PDA, Laptop, mobile phone and etc. via wireless transmission, e.g. Bluetooth, or wired connection.
Therefore, a new mobile positioning method and system is needed due to the drawbacks existing in the above positioning systems.
Contents of the Invention
An object of the present invention is to provide a mobile positioning method and system, being a new application according to the above mentioned invention. The method and system can perform precise positioning by supplementing GPS, or in areas where the conventional GPS receiver can't receive and measure the signal from a GPS satellite.
The present invention provides a method for positioning a moving object. The method comprise: firstly, determining 3 -dimension information of an original point of a moving object, which 3-dimension information is based on a distinguishable coordinate system ; secondly, detecting a 3-dimension movement of the moving object and producing corresponding 3-dimension movement information; finally, transforming the 3-dimension movement information to information conforming to the distinguishable coordinate system.
The distinguishable coordinate system is a geodetic coordinate system, and the 3-dimension movement information is based on another coordinate system, so it is necessary to detect the difference between the distinguishable coordinate system and another coordinate system. The difference can be determined by detecting the direction angle between the distinguishable coordinate system and another coordinate system.
The present invention can precisely position a moving object by setting an original point and using 3-dimension tracking technique. The present invention can perform precise position in connect with GPS, or perform precise position in case the GPS cannot be used, e.g. in regions where the GPS signal can't be received, especially in high buildings or in the forests.
The objects and attainments together with a fuller understanding of the present invention will become apparent and appreciated by referring to the following description and appended claims taken in conjunction with the accompanying drawings.
Description Of Figures
The invention is explained in further detail, and by way of example, with reference to the accompanying drawings wherein:
Figure 1 is a schematic diagram of the geodetic coordinate system;
Figure 2 is the schematic diagram of the Earth-Centered Earth-Fix (ECEF) coordinate system;
Figure 3 is a structural diagram of the mobile positioning system according to an embodiment of the present invention;
Figure 4 is a flowchart of the mobile positioning method according to an embodiment of the present invention; and
Figure 5 is a flowchart illustrating the producing of 3-dimension movement information of a moving object according to an embodiment of the present invention.
Mode of Carrying out the Invention
The present invention is further illustrated with reference to the accompanying drawings and embodiments thereof.
Figure 3 is a structural diagram of the mobile positioning system according to an embodiment of the present invention. System 300 comprises an original point determining device 310, a 3-dimension movement tracking device 320 and a data processing device 330.
The original point determining device 310 determines the 3-dimension information of the original point of a moving object, which 3-dimension information is based on an distinguishable coordinate system, e.g. the geodetic coordinate system used by GPS. The original point determining device 310 can be a GPS receiver, and can also be an input device. When the original point determining device 310 is a GPS receiver, the GPS receiver is used for measuring the 3- dimension information of the original point of a moving object, and the obtained 3- dimension information is based on the geodetic coordinate system; when the original point determining device 310 is an input device, the input device is used for manually inputting the 3-dimension information of original point of the moving object recorded on blueprint which is obtained through pre-measuring, and the 3- dimension information is based on an distinguishable coordinate system, which could be geodetic coordinate system or Earth-Centered Earth-Fix (ECEF) coordinate system.
The 3-dimension movement tracking device 320 comprises a 3- dimension movement detecting device 322 for detecting the 3-dimension movement of a moving object and producing the corresponding original
information of the 3-dimension movement, which is based on a coordinate system. The coordinate system is a coordinate system possessed by the 3-dimension movement detecting device 322 per se. The 3-dimension movement detecting device 322 can be a 3-dimension movement detecting sensor, in which the produced 3-dimension movement information is based on the coordinate system of the sensor. The 3-dimension movement detecting device 322 can further be other devices with the same or similar functions, in which the produced 3-dimension movement information is based on coordinate systems of other types. The producing procedure of the 3-dimension movement information is illustrated in detail in the following Figure 5.
The 3-dimension movement tracking device 320 further comprises a coordinate system difference detecting device 324 for detecting the difference between a distinguishable coordinate system and a coordinate system on which the original information is based. The difference can be determined by detecting the direction angle between the distinguishable coordinate system and the coordinate system on which the original information is based. The coordinate system difference detecting device 324 can be an direction sensor.
The data processing device 330 is used for transforming the 3-dimension movement information into information conforming to the distinguishable coordinate system. The transforming procedure is illustrated in the following Figure
4.
The mobile positioning system 300 further comprises a storage 340, which is connected respectively to the original point determining device 310, 3-dimension
movement tracking device 320 and data processing device 330 for storing information.
Figure 4 is the flowchart of the mobile positioning method according to an embodiment of the present invention.
Firstly, the 3-dimension information of the original point of the moving object in geodetic coordinate system is obtained (step S410).
The 3-dimension information is the 3-dimension position of the original point in a distinguishable coordinate system, e.g. geodetic coordinate system, namely, the geodetic longitude φ, geodetic latitude λ and geodetic altitude h of the original point. The 3-dimension position of the original point can be determined by the pre-measured data recorded on blueprint, or by the data obtained through GPS receiver measuring.
Secondly, the information in the geodetic coordinate is transformed into information in the Earth-Centered Earth-Fix (ECEF) coordinate (step S420). The information transformation between the two coordinates can be implemented through the following coordinate transformation equation (1):
X = (N + h)cos cosλ Y = (N+ h)cosφsinλ
Z = [N(l -e') + h]smφ
(1)
Wherein, φ, λ, h represent the longitude, latitude and altitude in geodetic coordinate system; X, Y, Z represent the coordinates in the Earth-Centered Earth-
Fix (ECEF) coordinate system; N = a/ψ-e' sm \s he prime vertical radius of
curvature in geodetic coordinate system; e ~ 2f f is the eccentricity square; a — b a is the ellipsoid flattening; a is the ellipsoid equatorial radius in the geodetic coordinate system (semi-major earth axis); b is the ellipsoid polar radius in the geodetic coordinate system (semi-minor earth axis).
Thirdly, the information of the coordinate system used by the moving object is obtained (step S430).
The coordinate system used by a moving object is based on the coordinate system possessed by the 3-dimension movement detecting sensor itself, i.e. sensor coordinate system (the so-called right-handed Descartes coordinate system) because the mobile positioning system 300 detects the 3-dirnension movement of the moving object by means of 3-dimension movement detecting sensor and produces information corresponding to the 3-dimension movement. During the movement of the moving object, the sensor coordinate system is always changing relative to the coordinate system used by the original point of the moving object, therefore the coordinate system used by the moving object at the original point can be employed as its coordinate system throughout the whole movement, and the 3-dimension movement information produced thereby is based on the coordinate system.
Next, the difference between the coordinate system used by the moving object and the Earth-Centered Earth-Fix (ECEF) coordinate system is determined
(step S440).
The difference can be determined by detecting the direction angle between the Earth-Centered Earth-Fix (ECEF) coordinate system and the coordinate system used by the moving object, i.e. the coordinate system used by the sensor when the moving object is at the original point. A direction sensor is used for measuring the direction, i.e., roll, inclination and azimuth angles, of the platform to which the direction sensor is attached in order to obtain the direction angle.
The direction sensor measures the direction angle between ECEF coordinate system and the sensor coordinate system by using a magnetic field strength meter, and the north of the direction sensor in the geodetic coordinate system is that the magnetic north is stronger than the true north. Therefore, the difference between the true north and the magnetic north caused by the earth magnetic field must be compensated. The difference can be obtained from existing chart listed with regional differences.
Then, the 3-dimension movement of the moving object is detected, and the corresponding 3-dimension movement information produced thereby is obtained (step S450).
The 3-dimension movement of the moving object can be detected by the
3-dimension movement detecting sensor, and information corresponding to the 3- dimension movement can be produced as well. The 3-dimension movement information can be the 3-dimension movement tracks of the moving object. Since the 3-dimension acceleration information of the moving object is obtained by
detecting of the 3-dimension movement detecting sensor, the movement tracks of the moving object can be obtained through the following Equation (2):
d = vat + - 1 *at 22
0 2 (2)
Wherein, a represents acceleration, t is the time interval, d represents the
movement tracks of the moving object, v° is the initial velocity.
Thus, the position of the moving object at any measurement point in the sensor coordinate system can be obtained through the following Equations (3):
»=0 -^
' 1
Y = Y ( v t +- * α t 2 ) n=0 ^
Z, = ∑ ( v„t„ +- * a„t„2 ) n=0 •-- (3)
Wherein, Xi, Yi, Zi represent the 3-dimension movement distance of the moving
object in the sensor coordinate system, tn represents the sampling interval, α"is
the 3-dimension acceleration information between sampling times ^»-ι>'» _
v" = v"-} + α,,/ represents the velocity at sampling instant tn .
Thereafter, the obtained 3-dimension movement information is transformed into the 3-dimension movement information in ECEF coordinate system (step S460).
Since the obtained 3-dimension movement information is based on sensor coordinate system, so it needs to be transformed into the ECEF coordinate system. The information transformation between the two coordinates can be performed through the following coordinate transforming Equation (4):
XL,=llX,+l2Y,+l3Zl ra =miX,+m2Yf+m3Z, ZB =nX, +n2Y,+n3Z, (4)
Wherein, XEi, YEi, ZEi are the 3-dimension movement tracks of the moving object in the ECEF coordinate system, and
/, = cosθj. cosθz - cosø^ sin<9r sin6>z lz = -cosθy sin0z - cosøy sinθ cosβz /3 =sin(rsinθz
?«, = cosθy sin<9z + cosθy cos sin#z m2 = -smθγ sin#2 + cosøy cos cos#z m3 =-sin0vcos0,.
nx = sin#A.sin#z n2 =sin<Λ.cos#z
«, :COSθv
In which, ΘX, ΘY, ΘZ represent the direction angle between the ECEF coordinate system and the sensor coordinate system.
Next, the current position of the moving object in ECEF coordinate system is determined (step S470).
The current 3-dimension position of the moving object in the ECEF coordinate system can be obtained through the following Equation (5):
ZE = Z0 + ZB (g ^
Wherein, XE, YE, ZE represent the current 3-dimension positions of the moving object in ECEF coordinate system, X0, Y0, Z0 represent the 3-dimension positions of the original point of the moving object in ECEF coordinate system, XEi, YEi, ZEi represent the 3-dimension movement tracks of the moving object in ECEF coordinate system.
In the end, the current position of the moving object in ECEF coordinate system is transformed into the geodetic coordinate system (step S480).
The transformation between the two coordinate systems is illustrated through the following Equation (6):
fZ + e 6sin3 fl, φ = αtan( = - ) p - e2a cos? θ' λ = αtan 2(7,X) h = - -N(φ) cos(φ) (6)
Wherein, φ, λ, h represent the longitude, latitude and altitude in the geodetic coordinate system; X, Y, Z represent the ECEF coordinate, while the intermediate
, ,2 _ a2 - b2
„ - Y
2 Λ. Y-
e ~ 2 variable f - ^
Λ -^ and the intermediate variable a ;
N(φ)- a/ e s
in φ
rep
resent
s the prime vertical radius of curvature in the a- b geodetic coordinate system;
e
a js ellipsoid flattening; a is the ellipsoid equatorial radius of the geodetic coordinate system (semi-major earth axis); b is the ellipsoid polar radius of the geodetic coordinate system (semi-minor earth axis).
Figure 5 is a flowchart illustrating the producing of 3-dimension movement information of the moving object according to an embodiment of the present invention. The 3-dimension movement information is the 3-dimension movement tracks of the moving object. Firstly, the 3-dimension acceleration information of the moving object is obtained (step S510); secondly, 3-dimension coordinates of each point are calculated based on the 3-dimension acceleration information of the moving object (step S520); and thirdly, the 3-dimension movement tracks of the moving object are plotted based on the 3-dimension coordinates of each point (step S530).
While the present invention is described in conjunction with specific embodiments, many alternatives, modifications and variations will be apparent to those ordinarily skilled in the art in light of the foregoing description. It is intended to embrace all such alternatives, modifications and variations as fall within the spirit and scope of the appended claims.