Source: http://www.google.com/patents/US20100030470?dq=5,675,808
Timestamp: 2016-07-26 18:34:58
Document Index: 480889908

Matched Legal Cases: ['Application No. 61', 'art 200', 'art 300', 'art 300', 'art 400', 'art 400', 'art 500']

Patent US20100030470 - Global positioning system and dead reckoning (gps&dr) integrated navigation ... - Google PatentsSearch Images Maps Play YouTube News Gmail Drive More »Sign inPatentsA global positioning system and dead reckoning (GPS&DR) integrated navigation system includes a GPS receiver coupled to a moving object for periodically generating GPS navigation information of said moving object, a DR system coupled to said moving object for periodically calculating DR navigation information...http://www.google.com/patents/US20100030470?utm_source=gb-gplus-sharePatent US20100030470 - Global positioning system and dead reckoning (gps&dr) integrated navigation systemAdvanced Patent SearchPublication numberUS20100030470 A1Publication typeApplicationApplication numberUS 12/495,349Publication dateFeb 4, 2010Priority dateJul 2, 2008Also published asCN101762805A, CN101762805B, EP2141507A1, EP2141507B1, US8239133Publication number12495349, 495349, US 2010/0030470 A1, US 2010/030470 A1, US 20100030470 A1, US 20100030470A1, US 2010030470 A1, US 2010030470A1, US-A1-20100030470, US-A1-2010030470, US2010/0030470A1, US2010/030470A1, US20100030470 A1, US20100030470A1, US2010030470 A1, US2010030470A1InventorsJames Wang, Xiaoguang Yu, Zhongbao Feng, Yiliang Liu, Shenghong LuOriginal AssigneeO2Micro, Inc.Export CitationBiBTeX, EndNote, RefManPatent Citations (5), Referenced by (51), Classifications (7), Legal Events (4) External Links: USPTO, USPTO Assignment, EspacenetGlobal positioning system and dead reckoning (gps&dr) integrated navigation system
[0001] This application claims priority to U.S. Provisional Application No. 61/133,743, Global Positioning System And Dead Reckoning (GPS&DR) Integration Navigation System, filed on Jul. 2, 2008, which is hereby incorporated by reference in its entirety.
[0003] The present invention relates to navigation systems and in particular to a global positioning system and dead reckoning (GPS&DR) integrated navigation system.
[0005] A global positioning system (GPS) has been widely applied for vehicle navigation to provide an absolute position of a vehicle according to satellite signals since the GPS has the advantages of having global reach and having relatively high precision. However, it may be impossible to realize continuous navigation by the GPS in an urban area where satellite signals are obstructed by tall buildings, trees, tunnels, or the satellite signals are disturbed seriously, etc.
[0006] A dead reckoning (DR) navigation system, mainly composed of localization sensors (e.g., gyroscope, milemeter, etc.), is a self-contained, autonomous and high sampling rate navigation system. However, since the current absolute position of a vehicle is determined by adding a relative displacement calculated currently to a previous absolute positioning point in the DR navigation system, the error of the DR navigation system can accumulate with time.
[0007] The present invention provides a global positioning system and dead reckoning (GPS&DR) integrated navigation system. The GPS&DR integrated navigation system includes a GPS receiver coupled to a moving object for periodically generating GPS navigation information of said moving object, a DR system coupled to said moving object for periodically calculating DR navigation information of said moving object, and a filter coupled to said GPS receiver and said DR system for periodically calculating navigation information of said moving object, wherein said filter calculates observation information by integrating said GPS navigation information and said DR navigation information according to a weight value of said GPS navigation information and a weight value of said DR navigation information, and calculates current navigation information by integrating said observation information with previous navigation information from a plurality of previous cycles.
[0008] In another embodiment, the present invention provides a method for providing navigation information of a moving object. The method includes generating GPS navigation information of said moving object by a GPS receiver, calculating DR navigation information of said moving object by a DR system, calculating observation information by integrating said GPS navigation information and said DR navigation information according to a weight value of said GPS navigation information and a weight value of said DR navigation information at a filter, and calculating current navigation information by integrating said observation information with previous navigation information from a plurality of previous cycles at said filter.
[0010] FIG. 1 illustrates a block diagram of a global positioning system and dead reckoning (GPS&DR) integrated navigation system according to one embodiment of the present invention.
[0011] FIG. 2 illustrates a flowchart of updating a reference position and orientation of a DR system according to one embodiment of the present invention.
[0012] FIG. 3 illustrates a flowchart of estimating the values of parameters of a gyroscope according to one embodiment of the present invention.
[0013] FIG. 4 illustrates a flowchart of estimating the values of parameters of a milemeter according to one embodiment of the present invention.
[0014] FIG. 5 illustrates a flowchart of operation performed by a GPS&DR integrated navigation system.
[0015] Reference will now be made in detail to the embodiments of the present invention. While the invention will be described in conjunction with the embodiments, it will be understood that they are not intended to limit the invention to these embodiments. On the contrary, the invention is intended to cover alternatives, modifications and equivalents, which can be included within the spirit and scope of the invention as defined by the appended claims.
[0016] Furthermore, in the following detailed description of the present invention, numerous specific details are set forth in order to provide a thorough understanding of the present invention. However, it will be recognized by one of ordinary skill in the art that the present invention can be practiced without these specific details. In other instances, well known methods, procedures, components, and circuits have not been described in detail as not to unnecessarily obscure aspects of the present invention.
[0017] FIG. 1 illustrates a block diagram of a GPS&DR (global positioning system & dead reckoning) integrated navigation system 100 according to one embodiment of the present invention. The GPS&DR integrated navigation system 100 can provide more accurate navigation capability than a single navigation system, for example, a single GPS navigation system or a single DR navigation system.
[0018] In one embodiment, the GPS&DR integrated navigation system 100 can include a GPS receiver 102 for receiving satellite signals and for generating GPS navigation information 116 according to the satellite signals. Each satellite signal is generated from a corresponding navigation satellite. In one embodiment, the GPS navigation information 116 includes a position, an orientation, a linear velocity (VGPS) and an angular velocity (WGPS) of a moving object (e.g., a vehicle). In the standard coordinate frame for the earth, the position of the vehicle consists of a longitude component and a latitude component.
[0019] The GPS&DR integrated navigation system 100 can further include a dead reckoning (DR) system 108 for providing DR navigation information of the vehicle by measuring moving information of the vehicle and integrating the moving information of the vehicle with reference position and orientation of the vehicle. The moving information of the vehicle includes a linear velocity and an angular velocity of the vehicle. The DR navigation information includes a position, an orientation, and the moving information of the vehicle. The reference position and orientation of the vehicle in the DR system 108 can be periodically updated with the position and orientation generated from the GPS receiver 102 if the received satellite signals are determined as reliable, and with the previously stored position and orientation calculated by the DR system 108 If the received satellite signals are determined as unreliable.
[0020] The DR system 108 includes a milemeter 110 for measuring the linear velocity VDR 128 of the vehicle, a gyroscope 112 for measuring the angular velocity WDR 130 of the vehicle, and a dead reckoning (DR) module 114 for calculating the position and orientation of the vehicle by integrating the moving information of the vehicle with the reference position and orientation of the vehicle. Since the linear velocity VDR 128 and the angular velocity WDR 130 measured by the milemeter 110 and the gyroscope 112 respectively may have a deviation relative to the real values, the milemeter 110 and the gyroscope 112 need to reduce the deviation of the linear velocity VDR 128 and the angular velocity WDR 130 respectively.
[0021] In one embodiment, the parameters of the milemeter 110 and the gyroscope 112 can be used to reduce the deviation of the linear velocity VDR 128 and the angular velocity WDR 130 respectively. The parameters of the gyroscope 112 can include, but are not limited to, a zero drift and a scale factor of the gyroscope 112. The parameters of the milemeter 110 can include, but are not limited to, the pulse number per circle of a tire of the vehicle, rolling radius of the tire, the proportionality factor representing the rolling radius of the tire divided by a linear velocity, and a static error of the rolling radius of the tire. However, the parameters of the milemeter 110 and the gyroscope 112 may continue to vary with time. Therefore, the milemeter 110 and the gyroscope 112 can each include a Kalman filter 140, 142 for estimating the values of the current parameters of the milemeter 110 and the gyroscope 112 periodically. After reducing the deviation related to the real values, the linear velocity VDR 128 and angular velocity WDR 130 can be output to the DR module 114 for further operation.
[0022] In one embodiment, the angular velocity 130 can be output to the milemeter 110 for determining whether the condition for estimating the values of the parameters of the milemeter 110 is satisfied. In another embodiment, the linear velocity 128 can be output to the gyroscope 112 for determining whether the condition for estimating the value of parameters of the gyroscope 112 is satisfied.
[0023] In one alternative embodiment, an additional filter (e.g., a Kalman filter) 144 can be coupled between the GPS receiver 102 and the DR system 108 for reducing noise within the GPS navigation information 116. Furthermore, the Kalman filter 144 can determine whether the satellite signals received at the GPS receiver 102 are reliable according to a carrier-to-noise ratio (CN0) of the satellite signals and the linear velocity VGPS of the vehicle output from the GPS receiver 102. If the number of the satellite signals with the carrier-to-noise ratio above a predetermined threshold, e.g., 30 dB-Hz, is greater than a predetermined value, e.g., three, and an average value of the linear velocity VGPS is greater than a predetermined threshold, e.g., 6 m/s, the received satellite signals can be determined as reliable. Otherwise, the received satellite signals can be determined as unreliable.
[0024] If the satellite signals received at the GPS receiver 102 are reliable, the GPS navigation information calculated according to the received satellite signals can be determined as reliable. The Kalman filter 144 can reduce the noise of the GPS navigation information 116 and send the position and the orientation of the vehicle 126 indicated in the corrected GPS navigation information to the DR module 114 for updating the reference position and orientation stored in the DR module 114.
[0025] The Kalman filter 144 can also output the linear velocity VGPS and the angular velocity WGPS indicated in the GPS navigation information 116 to the milemeter 110 and the gyroscope 112 for the parameter estimation.
[0026] The DR module 114 can receive a linear velocity 128 from the milemeter 110 and an angular velocity 130 from the gyroscope 112. The DR module 114 can calculate the current position and orientation of the vehicle by integrating the linear velocity 128 and the angular velocity 130 with the reference position and orientation stored in the DR module 114. As present above, the reference position and orientation stored in the DR module 114 can be updated by the position and orientation 126 indicated in the GPS navigation information 116 if the GPS navigation information 116 is reliable.
[0027] In one embodiment, according to the standard coordinate frame for the Earth, the position of the vehicle is defined by a longitude component and a latitude component. The position can be obtained by calculating the longitude component and the latitude component. The longitude component and the latitude component can be calculated based on the linear velocity VDR and the longitude and latitude components of the reference position according to equation (1).
[0000] newLon represents the longitude component of the current position. newLat represents the latitude component of the current position. oldLon represents the longitude component of the reference position. oldLat represents the latitude component of the reference position. VDR — E represents an east component of the linear velocity VDR. VDR — N represents a north component of the linear velocity VDR. T represents a unit interval of the linear velocity, e.g., 1 s. R represents the distance from the reference position to an origin of the standard coordinate frame for the Earth.
[0028] The orientation of the vehicle can be calculated according to equation (2).
[0000] newOri=oldOri+W DR *T (2)
[0000] newOri represents the current orientation. oldOri represents the reference orientation. T represents the unit interval of the angular velocity, e.g., 1 s.
[0029] If the GPS navigation information is not available, the reference position and orientation can be updated with the calculated position and orientation. Then the DR module 114 can calculate next position and orientation based on the updated reference position and orientation.
[0030] Furthermore, the GPS&DR integrated navigation system 100 can include a filter (e.g., Kalman filter) 106 coupled to the GPS receiver 102 and the DR system 108. The Kalman filter 106 can periodically get observation information by integrating the GPS navigation information 116 with the DR navigation information 132 according to a weight value of the GPS navigation information 116 (in short, GPS weight value) and a weight value of the DR navigation information 132 (in short, DR weight value). The Kalman filter 106 can further periodically calculate current navigation information by integrating said observation information with previous navigation information from a plurality of previous cycles. The navigation information 146 of the vehicle can then be displayed on a display screen 148.
[0031] In one embodiment, the GPS weight value and the DR weight value can be calculated by a weight module 104. The weight module 104 receives a position dilution of precision (PDOP) of the satellite signals and the carrier-to-noise ratio (CN0) of the satellite signals from the GPS receiver 102 and generates the GPS weight value and the DR weight value according to the PDOP and the CN0.
[0032] If the number of the satellite signals with CN0>30 db-hz is no less than a predetermined value (e.g., 3), the GPS weight value and the DR weight value can be determined by the PDOP. In this condition, the GPS weight value and the DR weight value are given by equation (3).
[0000] β1 represents the GPS weight value. β2 represents the DR weight value.
[0033] If the number of the satellite signals with CN0>30 dB-Hz is less than the predetermined value (e.g., 3), the GPS weight value and the DR weight value are given by equation (4).
[0034] Advantageously, the GPS&DR integrated navigation system 100 combines the short-term stability of the DR system 108 with the long-term stability of the GPS receiver 102 through the integration of the two systems. Since the GPS receiver 102 can receive the satellite signals in real time and an error of the GPS navigation information will not be accumulated with time, the position and orientation of a moving object (e.g., vehicle) determined by the GPS receiver 102 can have relatively high precision if the received satellite signals are reliable. Hence, the GPS navigation information 116 can be used for updating the reference position and orientation of the DR system 108 if the received satellite signals are reliable. As a result, the accumulated error of the DR system 108 can be reduced or eliminated by updating the reference position and orientation periodically.
[0035] Furthermore, random error may occur in the GPS receiver 102 in some uncertain conditions (e.g., when the vehicle stops before an object or the satellite signals are unreliable). Since the position and orientation of a moving object (e.g., vehicle) reckoned continuously by the DR system 108 has relatively high precision in the short term, the random error in the GPS navigation information 116 can be compensated by setting a relatively low GPS weight value and a relatively high DR weight value for the integration of the GPS navigation information 116 and the DR positioning information 132. As a result, compensation of the random error in the GPS navigation information 116 can smooth the GPS navigation tracking process. Therefore, the GPS&DR integrated navigation system 100 can provide advantages of higher accuracy, better reliability, and improved capability for tracking/receiving satellite signals.
[0036] FIG. 2 illustrates a flowchart 200 of updating a reference position and orientation of a DR system (e.g., the reference position and orientation of the DR system 108 in FIG. 1) according, to one embodiment of the present invention. FIG. 2 is described in combination with FIG. 1.
[0037] In block 202, the GPS receiver 102 generates the GPS navigation information 116 according to satellite signals. In block 204, the Kalman filter 144 reduces the noise in the GPS navigation information 116. In block 206, the Kalman filter 144 determines a reliability of the received satellite signals according to the carrier-to-noise ratio (CN0) of the satellite signals and the linear velocity VGPS of the vehicle measured by the GPS receiver 102.
[0038] If an average value (VGPS — AVER) of the linear velocity (VGPS) during a time interval, e.g., 90 seconds, is larger than a predetermined value VPRE, e.g., 6 m/s, and the number of the satellite signals with the carrier-to-noise ratio above a predetermined threshold, e.g., 30 db-hz, is greater than a predetermined value, e.g., three, the received satellite signals can be determined as reliable. Then the reference position and orientation of the DR system 108 can be updated with the GPS navigation information that is corrected by the Kalman filter 144 in block 208.
[0039] If the average value (VGPS — AVER) of the linear velocity (VGPS) during the time interval is not more than the predetermined velocity VPRE, e.g., 6 m/s, or the number of the satellite signals with the carrier-to-noise ratio above the predetermined threshold, e.g., 30 db-hz, is not greater than the predetermined value NPRE, e.g., three, the received satellite signals can be determined as unreliable. Then the reference position and orientation of the DR system 108 can be updated with the previous DR navigation information from a previous cycle in block 210.
[0040] In block 212, the DR system 108 can measure the moving information of the moving object by a plurality of motion sensors and calculate the DR navigation information by integrating the moving information with the reference position and orientation.
[0041] As shown, the error accumulated with time during the dead reckoning in the DR system 108 can be rectified timely by updating the reference position and orientation of the DR system 108 periodically. As result, when the satellite signals are determined as unreliable, the vehicle position can be calculated by the DR system 108 based on the reference position and orientation updated by the last reliable GPS navigation information. Consequently, smooth switching between the GPS receiver 102 and the DR system 108 can be achieved.
[0042] FIG. 3 illustrates a flowchart 300 for estimating the values of parameters of a gyroscope (e.g., the gyroscope 112 in the DR system 108 in FIG. 1) according to one embodiment of the present invention. As described above, the parameters of the gyroscope 112 can be used to reduce the deviation of the angular velocity measured by the gyroscope 112. The parameters of the gyroscope 112 can include, but are not limited to, the zero drift and the scale factor of the gyroscope 112. Since the parameters of the gyroscope 112 continue to vary with time, which results from, e.g., an influence of a source degree of polarization, the values of the current parameters of the gyroscope 112 need to be estimated periodically during the navigation process. FIG. 3 is described in combination with FIG. 1.
[0043] When the GPS&DR integrated navigation system 100 is powered on, the GPS receiver 102 can start to operate. In block 302, initial parameters of the gyroscope 112 including an initial zero drift BGYRO — 0 and an initial scale factor SGYRO — 0 are read out from a storage unit (not shown in FIG. 1) included in the gyroscope 112. In another embodiment, the storage unit can be configured externally to the gyroscope 112. In block 304, the gyroscope 112 receives the linear velocity (VGPS) and the angular velocity (WGPS) from the GPS receiver 102. In block 306, an angular velocity WGYRO of a moving object, e.g., a vehicle, is measured by the gyroscope 112 and then the angular velocity can be corrected with the initial zero drift BGYRO — 0 according to equation (5).
[0000] W GYRO =W GYRO +B GYRO — 0 (5)
[0044] In block 308, if the VGPS is less than a predetermined threshold VPRE1, which indicates that the vehicle has stopped, or if the VGPS is greater than a predetermined threshold VPRE2 and the absolute value of the WGPS is less than a predetermined threshold WPRE, which indicates that the vehicle is going straight, the angular velocity of the vehicle WGYRO corrected in block 306 is considered as eligible and stored in a storage unit (not shown in FIG. 1) for further calculation. In block 310, if the number of the eligible WGYRO, which are stored in the storage unit, is no less then a predetermined threshold NPRE, a primary offset of the zero drift is calculated with the eligible WGYRO that are stored in the storage unit in block 312. The primary offset of the zero drift can be given by equation (6)
[0000] deltaB1=−mean(W GYRO) (6)
[0000] deltaB1 represents the primary offset of the zero drift of the gyroscope 112. The function mean( ) is used for calculating an average value of the eligible WGYRO. In one embodiment, the value of NPRE can be 50. After calculating the primary offset of the zero drift deltaB1, the storage unit can select the earliest angular velocity WGYRO among the eligible WGYRO and delete it.
[0045] If the VGPS is no less than the predetermined threshold VPRE1 and no greater than the predetermined threshold VPRE2, or the absolute value of the WGPS is no less than the predetermined threshold WPRE in block 308, or if the number of the eligible WGYRO is less then the predetermined threshold NPRE in block 310, the flowchart 300 will return to block 304.
[0046] In block 314, the angular velocity of the vehicle WGYRO corrected in block 306 can be corrected for the second time with the deltaB1 according to equation (7).
[0000] W GYRO =W GYRO+deltaB1 (7)
[0047] In block 316, the angular velocity WGPS output from the GPS receiver 102, the angular velocity WGYRO corrected in block 314 and the initial scale factor SGYRO 0 are sent to the Kalman filter 142 in the gyroscope 112 for estimating the value of the parameters of the gyroscope 112. In one embodiment, the Kalman filter 142 can estimate the value of a secondary offset deltaB2 of the zero drift and a current scale factor SGYRO.
[0048] In block 318, the current zero drift BGYRO of the gyroscope 112 can be calculated according to the primary offset deltaB1 of the zero drift, the secondary offset deltaB2 of the zero drift, and the initial zero drift BGYRO 0 according to equation (8).
[0000] B GYRO =B GYRO0+deltaB1+deltaB2 (8)
[0049] In block 320, the angular velocity of the vehicle WGYRO can be corrected for the third time based on the current scale factor SGYRO estimated in block 316 and the BGYRO calculated in block 318 according to equation (9).
[0000] W GYRO =S GYRO *W GYRO +B GYRO (9)
[0050] Then the WGYRO can be sent to the DR module 114 as the measured angular velocity WDR 130 of the vehicle for calculating the DR navigation information and to the milemeter 110 for controlling the parameters estimation of the milemeter 110, in one embodiment.
[0051] Additionally, after estimating the current scale factor SGYRO in block 316, and calculating the current zero drift BGYRO of the gyroscope 112 in block 318, the initial parameters of the gyroscope 112 including the initial zero drift BGYRO — 0 and the initial scale factor SGYRO — 0 stored in the storage unit can be updated with the BGYRO and the SGYRO respectively every predetermined time interval, e.g., 30 minutes, in block 322.
[0052] FIG. 4 illustrates a flowchart 400 of estimating the values of parameters of a milemeter (e.g., the milemeter 110 in the DR system 108 in FIG. 1) according to one embodiment of the present invention. As described above, the parameters of the milemeter 110 can be used to reduce the deviation of the linear velocity measured by the milemeter 110. The parameters of the milemeter 110 can include, but are not limited to, the pulse number per circle of the tire, the rolling radius of the tire, the proportionality factor representing the rolling radius of the tire divided by a linear velocity, and a static error of the rolling radius of the tire. Since the parameters of milemeter 110 continue to vary with time, which results from, e.g., wearing of a tire when the vehicle is running, the value of the current parameters of the milemeter 110 need to be estimated periodically during the navigation process. FIG. 4 is described in combination with FIG. 1.
[0053] When the GPS&DR integrated navigation system 100 is powered on, the GPS receiver 102 starts to operate. In block 402, initial parameters of the milemeter 110 including the pulse number per circle of the tire KODO 0, an initial rolling radius of the tire RODO 0, an initial proportionality factor CODO 0, and an initial static error deltaR0 of the rolling radius of the tire are read out from a storage unit (not shown in FIG. 1) included in the milemeter 110. In one embodiment, the storage unit can be configured external to the milemeter 110. In block 404, the milemeter 110 receives the linear velocity (VGPS) and the angular velocity (WGPS) from the GPS receiver 102 and also receives the current angular velocity (WDR) 130 from the gyroscope 112. In block 406, a pulse number per interval unit is counted by the milemeter 110 and then a linear velocity of a moving object, e.g., a vehicle, can be calculated based on the counted pulse number per interval unit, the pulse number per circle of the tire KODO 0, and the initial rolling radius of the tire RODO 0 according to equation (10).
[0000] V ODO =K ODO /K ODO0*2π*R ODO0 (10)
[0000] VODO represents the current linear velocity of the vehicle measured by the milemeter 110. KODO represents the counted pulse amount per interval unit.
[0054] If the VGPS is greater than a predetermined threshold VPRE and the WDR 130 is less than a predetermined threshold WPRE, which indicates that the vehicle is running in a normal condition in block 408, the VODO is reliable for estimating the values of the parameters of the milemeter 110 in the next block 410. If the VGPS is no greater than the predetermined threshold VPRE or the WDR 130 is no less than the predetermined threshold WPRE, which indicates that the vehicle is running in an abnormal condition in block 408, the flowchart 400 returns to block 404.
[0055] In block 410, the linear velocity VGPS measured by the GPS receiver 102, the linear velocity VODO measured by the milemeter 110 in block 406, the initial proportionality factor CODO 0, and the initial static error of the rolling radius of the tire deltaR0 are sent to the Kalman filter 140 included in the milemeter 110 for estimating values of the parameters of the milemeter 110. In one embodiment, the Kalman filter 140 can estimate the values of the current proportion factor CODO and the current static error of the rolling radius of the tire deltaR.
[0056] In block 412, the current rolling radius of the tire can be calculated according to equation (11).
[0000] R ODO =C ODO *V ODO +R ODO0+deltaR (11)
[0000] RODO represents the current rolling radius of the tire. CODO represents the current proportionality factor. deltaR represents the current static error of the rolling radius of the tire. VODO represents the linear velocity of the vehicle measured by the milemeter 110. RODO 0 represents the initial rolling radius of the tire.
[0057] In block 414, the linear velocity calculated by the milemeter 110 is corrected based on the current rolling radius of the tire RODO, the pulse number per interval unit KODO, and the pulse number per circle of the tire KODO 0 according to equation (12).
[0000] V ODO=2π*R ODO *K ODO /K ODO0 (12)
[0000] Then the VODO can be sent to the DR module 114 as the measured linear velocity VDR 128 of the vehicle for dead reckoning.
[0058] Additionally, after estimating the values of the CODO and the deltaR in block 410, and calculating the RODO in block 412, the initial parameters including the CODO 0, the deltaR0 and the RODO 0 of the milemeter 110 stored in the storage unit can be updated with the CODO, the deltaR and the RODO respectively every predetermined time interval, e.g., 30 minutes, in block 416.
[0059] FIG. 5 illustrates a flowchart 500 of operation performed by a GPS&DR integrated navigation system (e.g. the GPS&DR integrated navigation system 100 in FIG. 1). FIG. 5 is described in combination with FIG. 1 and FIG. 2.
[0060] After the GPS&DR integrated navigation system 100 is powered on, the GPS receiver 102 starts to generate GPS navigation information 116 according to a plurality of satellite signals in block 502. In block 504, the Kalman filter 144 can reduce the noise within the GPS navigation information 116. In block 506, the Kalman filter 144 can determine the reliability of the received satellite signals according to the carrier-to-noise ratio (CN0) of the satellite signals and the linear velocity VGPS of the vehicle measured by the GPS receiver 102.
[0061] If an average value (VGPS — AVER) of the linear velocity (VGPS) during a time interval, e.g., 90 seconds, is more than a predetermined velocity VPRE, e.g., 6 m/s, and the number of the satellite signals with the carrier-to-noise ratio above a predetermined threshold, e.g., 30 db-hz, is greater than a predetermined value, e.g., three, the received satellite signals can be determined as reliable. Then the reference position and orientation of the DR system 108 can be updated with the GPS navigation information corrected by the Kalman filter 144 in block 508.
[0062] If the average value (VGPS — AVER) of the linear velocity (VGPS) during the time interval is not more than the predetermined velocity VPRE, e.g., 6 m/s, and the number of the satellite signals with the carrier-to-noise ratio above the predetermined threshold, e.g., 30 db-hz, is not greater than the predetermined value NPRE, e.g., three, the received satellite signals can be determined as unreliable. Then the reference position and orientation of the DR system 108 can be updated with the previous DR navigation information from a previous cycle in block 510.
[0063] In block 512, the DR system 108 can measure the moving information of the moving object by a plurality of motion sensors and calculate the DR navigation information 132 by integrating the moving information with the reference position and orientation.
[0064] In block 514, the weight value of the GPS navigation information 116 and the weight value of the DR navigation information 132 are calculated by the weight module 104. In block 516, Kalman filter 106 can get observation information by integrating the GPS navigation information 116 with the DR navigation information 132 according to a weight value of the GPS navigation information 116 and a weight value of the DR navigation information 132. In block 518, the Kalman filter 106 can further calculate current navigation information by integrating the observation information with previous navigation information from a plurality of previous cycles.
[0065] Accordingly, the GPS&DR integrated navigation system 100 includes the GPS receiver 102 for generating GPS navigation information of the moving object according to a plurality of satellite signals, and the DR system 108 for calculating DR navigation information of the moving object by integrating moving information of the moving object with reference position and orientation. The reference position and orientation of the DR system 108 can be updated with the GPS navigation information if the satellite signals are determined as reliable, and can be updated with the previous DR navigation information from a previous cycle if the satellite signals are determined as unreliable. Furthermore, the moving information of the moving object can be measured by a plurality of motion sensors. The linear velocity and the angular velocity generated by the GPS receiver 102 can be input into the DR system 108 for estimating the parameters of the motion sensors and correcting the measured moving information according to the parameters. As result, when GPS signals are determined as unreliable, the up to date parameters of the DR system 108 will be used for smooth switching between the GPS and DR navigation systems.
[0066] The GPS&DR integrated navigation system 100 further includes the Kalman filter 106 for calculating navigation information of the moving object by integrating the GPS navigation information and the DR navigation information according to a weight value of the GPS navigation information and a weight value of the DR navigation information. The weight module 104 can calculate the weight value of the GPS navigation information and the weight value of the DR navigation information according to a position dilution of precision and a carrier-to-noise ratio of the satellite signals.
[0067] While the foregoing description and drawings represent embodiments of the present invention, it will be understood that various additions, modifications and substitutions can be made therein without departing from the spirit and scope of the principles of the present invention as defined in the accompanying claims. One skilled in the art will appreciate that the invention can be used with many modifications of form, structure, arrangement, proportions, materials, elements, and components and otherwise, used in the practice of the invention, which are particularly adapted to specific environments and operative requirements without departing from the principles of the present invention. The presently disclosed embodiments are therefore to be considered in all respects as illustrative and not restrictive, the scope of the invention being indicated by the appended claims and their legal equivalents, and not limited to the foregoing description.
Patent CitationsCited PatentFiling datePublication dateApplicantTitleUS5311195 *Aug 30, 1991May 10, 1994Etak, Inc.Combined relative and absolute positioning method and apparatusUS5390124 *Dec 1, 1992Feb 14, 1995Caterpillar Inc.Method and apparatus for improving the accuracy of position estimates in a satellite based navigation systemUS5416712 *May 28, 1993May 16, 1995Trimble Navigation LimitedPosition and velocity estimation system for adaptive weighting of GPS and dead-reckoning informationUS7512487 *Nov 2, 2006Mar 31, 2009Google Inc.Adaptive and personalized navigation systemUS20070252754 *Apr 28, 2006Nov 1, 2007Alexander Steven BSystem and method for advanced tight coupling of GPS and navigation based on dead reckoning* Cited by examinerReferenced byCiting PatentFiling datePublication dateApplicantTitleUS7835832Jan 5, 2007Nov 16, 2010Hemisphere Gps LlcVehicle control systemUS7885745Jan 31, 2007Feb 8, 2011Hemisphere Gps LlcGNSS control system and methodUS7948769May 24, 2011Hemisphere Gps LlcTightly-coupled PCB GNSS circuit and manufacturing methodUS8000381Aug 16, 2011Hemisphere Gps LlcUnbiased code phase discriminatorUS8018376Sep 13, 2011Hemisphere Gps LlcGNSS-based mobile communication system and methodUS8085196Mar 11, 2009Dec 27, 2011Hemisphere Gps LlcRemoving biases in dual frequency GNSS receivers using SBASUS8138970Jan 7, 2010Mar 20, 2012Hemisphere Gps LlcGNSS-based tracking of fixed or slow-moving structuresUS8140223Jan 17, 2009Mar 20, 2012Hemisphere Gps LlcMultiple-antenna GNSS control system and methodUS8174437Jul 29, 2009May 8, 2012Hemisphere Gps LlcSystem and method for augmenting DGNSS with internally-generated differential correctionUS8190337May 29, 2012Hemisphere GPS, LLCSatellite based vehicle guidance control in straight and contour modesUS8217833Jul 10, 2012Hemisphere Gps LlcGNSS superband ASIC with simultaneous multi-frequency down conversionUS8265826Jul 11, 2008Sep 11, 2012Hemisphere GPS, LLCCombined GNSS gyroscope control system and methodUS8271194Sep 18, 2012Hemisphere Gps LlcMethod and system using GNSS phase measurements for relative positioningUS8311696Jul 17, 2009Nov 13, 2012Hemisphere Gps LlcOptical tracking vehicle control system and methodUS8334804Dec 18, 2012Hemisphere Gps LlcMulti-frequency GNSS receiver baseband DSPUS8386129Feb 26, 2013Hemipshere GPS, LLCRaster-based contour swathing for guidance and variable-rate chemical applicationUS8401704Jul 22, 2009Mar 19, 2013Hemisphere GPS, LLCGNSS control system and method for irrigation and related applicationsUS8456356Oct 5, 2010Jun 4, 2013Hemisphere Gnss Inc.GNSS receiver and external storage device system and GNSS data processing methodUS8548649Oct 19, 2010Oct 1, 2013Agjunction LlcGNSS optimized aircraft control system and methodUS8583315Nov 2, 2010Nov 12, 2013Agjunction LlcMulti-antenna GNSS control system and methodUS8583326Feb 9, 2010Nov 12, 2013Agjunction LlcGNSS contour guidance path selectionUS8594879Aug 16, 2010Nov 26, 2013Agjunction LlcGNSS guidance and machine controlUS8649930Sep 16, 2010Feb 11, 2014Agjunction LlcGNSS integrated multi-sensor control system and methodUS8686900Jan 8, 2009Apr 1, 2014Hemisphere GNSS, Inc.Multi-antenna GNSS positioning method and systemUS9002566Feb 10, 2009Apr 7, 2015AgJunction, LLCVisual, GNSS and gyro autosteering controlUS20070198185 *Jan 31, 2007Aug 23, 2007Mcclure John AGNSS control system and methodUS20080167770 *Jan 5, 2007Jul 10, 2008Beeline Technologies Pty LtdVehicle control systemUS20090085815 *Sep 26, 2008Apr 2, 2009Jakab Andrew JTightly-coupled pcb gnss circuit and manufacturing methodUS20090099730 *Oct 14, 2008Apr 16, 2009Mcclure John ASatellite based vehicle guidance control in straight and contour modesUS20090164067 *Jan 17, 2009Jun 25, 2009Whitehead Michael LMultiple-antenna gnss control system and methodUS20090204281 *Feb 10, 2009Aug 13, 2009Hemisphere Gps LlcVisual, gnss and gyro autosteering controlUS20090251366 *Apr 6, 2009Oct 8, 2009Mcclure John AGnss-based mobile communication system and methodUS20090322600 *Dec 31, 2009Whitehead Michael LMethod and system using gnss phase measurements for relative positioningUS20100109944 *Jan 7, 2010May 6, 2010Whitehead Michael LGnss-based tracking of fixed or slow-moving structuresUS20100161179 *Dec 22, 2008Jun 24, 2010Mcclure John AIntegrated dead reckoning and gnss/ins positioningUS20100176991 *Dec 10, 2009Jul 15, 2010Webber Mark RGnss superband asic with simultaneous multi-frequency down conversionUS20100231443 *Mar 11, 2009Sep 16, 2010Whitehead Michael LRemoving biases in dual frequency gnss receivers using sbasUS20100312428 *Dec 9, 2010Roberge Andre CGnss guidance and machine controlUS20110018765 *Oct 5, 2010Jan 27, 2011Whitehead Michael LGnss receiver and external storage device system and gnss data processing methodUS20110022238 *Jul 22, 2009Jan 27, 2011Pollock Colin JGnss control system and method for irrigation and related applicationsUS20110025555 *Feb 3, 2011Whitehead Michael LSystem and method for augmenting dgnss with internally-generated differential correctionUS20110054729 *Mar 3, 2011Whitehead Michael LMulti-antenna gnss control system and methodUS20110057834 *Sep 7, 2010Mar 10, 2011Miller Steven RMulti-frequency gnss receiver baseband dspUS20110118938 *May 19, 2011Andrew John MacdonaldVehicle control systemUS20110172887 *Jul 14, 2011Reeve David RVehicle assembly control method for collaborative behaviorUS20110188618 *Aug 4, 2011Feller Walter JRf/digital signal-separating gnss receiver and manufacturing methodUS20110196565 *Aug 11, 2011Collins Dennis MGnss contour guidance path selectionUS20140070986 *Nov 5, 2012Mar 13, 2014O2Micro Inc.Apparatuses and methods for tracking a navigation receiverCN102636165A *Apr 27, 2012Aug 15, 2012航天科工惯性技术有限公司Post-treatment integrated navigation method for surveying and mapping track of oil-gas pipelineCN103558617A *Oct 30, 2013Feb 5, 2014无锡赛思汇智科技有限公司Positioning method and deviceWO2015085483A1 *Dec 10, 2013Jun 18, 2015SZ DJI Technology Co., Ltd.Sensor fusion* Cited by examinerClassifications U.S. Classification701/472International ClassificationG01C21/00, G01S5/14Cooperative ClassificationG01S19/49, G01S19/47European ClassificationG01S19/49, G01S19/47Legal EventsDateCodeEventDescriptionOct 20, 2009ASAssignmentOwner name: O2MICRO INC.,CALIFORNIAFree format text: ASSIGNMENT OF ASSIGNORS INTEREST;ASSIGNORS:WANG, JAMES;YU, XIAOGUANG;FENG, ZHONGBAO;AND OTHERS;SIGNING DATES FROM 20090901 TO 20091015;REEL/FRAME:023399/0052Owner name: O2MICRO INC., CALIFORNIAFree format text: ASSIGNMENT OF ASSIGNORS INTEREST;ASSIGNORS:WANG, JAMES;YU, XIAOGUANG;FENG, ZHONGBAO;AND OTHERS;SIGNING DATES FROM 20090901 TO 20091015;REEL/FRAME:023399/0052Jul 11, 2012ASAssignmentOwner name: O2MICRO INTERNATIONAL, LTD., CAYMAN ISLANDSFree format text: ASSIGNMENT OF ASSIGNORS INTEREST;ASSIGNOR:O2MICRO, INC.;REEL/FRAME:028527/0672Effective date: 20120709Nov 12, 2012ASAssignmentOwner name: MAISHI ELECTRONIC (SHANGHAI) LTD., CHINAFree format text: ASSIGNMENT OF ASSIGNORS INTEREST;ASSIGNOR:O2MICRO INTERNATIONAL, LTD.;REEL/FRAME:029281/0948Effective date: 20121106Feb 8, 2016FPAYFee paymentYear of fee payment: 4RotateOriginal ImageGoogle Home - Sitemap - USPTO Bulk Downloads - Privacy Policy - Terms of Service - About Google Patents - Send FeedbackData provided by IFI CLAIMS Patent Services