Mobile object position estimation apparatus and method
원문보기
IPC분류정보
국가/구분 |
United States(US) Patent
등록
|
국제특허분류(IPC7판) |
|
출원번호 |
US-0092088
(2006-11-17)
|
등록번호 |
US-8145419
(2012-03-27)
|
우선권정보 |
JP-2005-334395 (2005-11-18) |
국제출원번호 |
PCT/IB2006/003309
(2006-11-17)
|
§371/§102 date |
20080430
(20080430)
|
국제공개번호 |
WO2007/057771
(2007-05-24)
|
발명자
/ 주소 |
- Onome, Hirohisa
- Kagawa, Kazunori
- Tajima, Yasuhiro
- Maeda, Iwao
- Nagamiya, Kiyomi
- Ueda, Akihiro
|
출원인 / 주소 |
- Toyota Jidosha Kabushiki Kaisha
|
대리인 / 주소 |
Oblon, Spivak, McClelland, Maier & Neustadt, L.L.P.
|
인용정보 |
피인용 횟수 :
7 인용 특허 :
5 |
초록
▼
A mobile object position estimation apparatus mounted in a mobile object includes a first estimation mechanism for estimating the mobile object position based on the outputs from an inertial navigation sensor device (acceleration sensor, and yaw rate sensor, or the like) mounted on the mobile object
A mobile object position estimation apparatus mounted in a mobile object includes a first estimation mechanism for estimating the mobile object position based on the outputs from an inertial navigation sensor device (acceleration sensor, and yaw rate sensor, or the like) mounted on the mobile object, a storage for storing map information including at least node information, a second estimation mechanism for estimating the mobile object position based on a predicted path of traveling of the mobile object predicted from the node information, and a synthesis mechanism for determining the final estimated mobile object position by synthesizing the mobile object position estimated by the first estimation mechanism and the mobile object position estimated by the second estimation mechanism.
대표청구항
▼
1. A mobile object position estimation apparatus, comprising: a position detection device that detects absolute coordinates of a mobile object position using communication;a first estimation device that estimates the mobile object position based on output from inertial navigation sensor devices moun
1. A mobile object position estimation apparatus, comprising: a position detection device that detects absolute coordinates of a mobile object position using communication;a first estimation device that estimates the mobile object position based on output from inertial navigation sensor devices mounted on a mobile object;a storage device that stores map information including at least node information;a second estimation device that estimates the mobile object position based on a predicted travel path of the mobile object as predicted from the node information, the predicted travel path being a line that is an estimated road contour line shifted by an offset, the estimated road contour line being a line connecting nodes of the node information in a vicinity of the mobile object, and the offset being determined by the second estimation device in a road widthwise direction between the estimated road contour line and the mobile object position detected by the position detection device; anda synthesizing device that determines a final estimated mobile object position by synthesizing the mobile object position estimated by the first estimation device and the mobile object position estimated by the second estimation device. 2. The mobile object position estimation apparatus according to claim 1, wherein when the final estimated mobile object position is determined by the synthesizing device, the first estimation device uses a preceding final estimated position as a new starting point for estimating the mobile object position based on the output from the inertial navigation sensor devices. 3. The mobile object position estimation apparatus according to claim 1, wherein the inertial navigation sensor devices include an acceleration sensor and a yaw rate sensor. 4. The mobile object position estimation apparatus according to claim 1, wherein the inertial navigation sensor devices include a wheel speed sensor and a steering angle sensor. 5. The mobile object position estimation apparatus according to claim 1, wherein the first estimation device, the second estimation device, and the synthesizing device operate when the position detection device fails to perform the communication. 6. The mobile object position estimation apparatus according to claim 1, wherein the first estimation device, the second estimation device, and the synthesizing device operate when the position detection device determines that reliability of data detected from the position detection device decreases. 7. The mobile object position estimation apparatus according to claim 1, wherein the second estimation device adopts the estimated road contour line to be a curve based on a prescribed interpolation method connecting nodes in the vicinity. 8. The mobile object position estimation apparatus according to claim 7, wherein the prescribed interpolation method is a clothoid interpolation method. 9. The mobile object position estimation apparatus according to claim 7, wherein the prescribed interpolation method is a spline interpolation method. 10. The mobile object position estimation apparatus according to claim 1, wherein the second estimation device includes a distance detection device that detects a travel distance of the mobile object, and adopts, as a new mobile object position, a position that is moved along the predicted travel path by an amount of traveling detected by the distance detection device from a time when the second estimation device previously estimated the mobile object position. 11. The mobile object position estimation apparatus according to claim 10, wherein the distance detection device includes a wheel speed sensor, and wherein the travel distance is calculated based on an amount of time elapsed from a previous prediction of the estimated mobile object position and output from the wheel speed sensor. 12. The mobile object position estimation apparatus according to claim 1, wherein the second estimation device adopts, as a final mobile object position, a point of intersection of a vertical line extended to the predicted travel path from the estimated mobile object position estimated by the first estimation device with the predicted travel path. 13. A method for estimating a position of a mobile object, comprising: detecting absolute coordinates of a mobile object position using a communication device;estimating of the mobile object position based on outputs from inertial navigation sensor devices;setting a predicted travel path of the mobile object based on node information included in map information, the setting including determining the predicted travel path as a line that is an estimated road contour line shifted by an offset, the estimated road contour line being a line connecting nodes of the node information in a vicinity of the mobile object, and the offset being determined in a road widthwise direction between the estimated road contour line and the mobile object position detected by the detecting step;estimating the mobile object position based on the predicted travel path; anddetermining a final estimated mobile object position by synthesizing the mobile object position estimated based on the outputs from the inertial navigation sensor devices and the mobile object position estimated based on the predicted travel path.
이 특허에 인용된 특허 (5)
-
Gudat Adam J. ; Shin Dong Hun ; Whittaker William L. ; Kleimenhagen Karl W. ; Clow Richard G. ; Singh Sanjiv J. ; Christensen Dana A. ; Kemner Carl A. ; Bradbury Walter J. ; Koehrsen Craig L. ; Kyrts, Apparatus and method for autonomous vehicle navigation using absolute data.
-
Tanaka,Hiromichi, Map display device.
-
Endo Koichi,JPX ; Shishido Kan,JPX, Navigation apparatus.
-
Karunanidhi Upparapalli, Navigation system using position network for map matching.
-
Ito Toru,JPX, Road data maintenance system and on-vehicle terminal apparatus compatible therewith.
이 특허를 인용한 특허 (7)
-
Hakim, Daniel; Giles, Christopher; Karvounis, John; Funk, Benjamin; Napora, Jared; Teolis, Carole, Fusion of sensor and map data using constraint based optimization.
-
Young, Travis; Miller, John; Karvounis, John; Hakim, Dan; Napora, Jared; Funk, Benjamin; Teolis, Carole, Heading constraints in a particle filter.
-
Bandyopadhyay, Amrit; Beisel, Brian; Karvounis, John; Funk, Benjamin; Teolis, Carole; Giles, Christopher, Irregular feature mapping.
-
Bandyopadhyay, Amrit; Beisel, Brian; Karvounis, John; Funk, Benjamin; Teolis, Carole; Giles, Christopher, Irregular feature mapping.
-
Young, Travis; Miller, John Riley; Karvounis, John; Hakim, Dan; Napora, Jared; Funk, Benjamin; Teolis, Carole, Particle filter based heading correction.
-
Baranga, Alex; Georgieff, Chris; Gilmore, Michael; Ward, Thomas, Systems and methods for monitoring roadways using magnetic signatures.
-
Bandyopadhyay, Amrit; Hakim, Daniel; Teolis, Carole, Wi-Fi enhanced tracking algorithms.
※ AI-Helper는 부적절한 답변을 할 수 있습니다.