Position estimation device and position estimation method

The position estimation device uses a combination of absolute and relative positioning sensors to maintain and update reliable trajectories, addressing accuracy issues in satellite positioning errors and ensuring continuous accurate position estimation.

JP2024168864AActive Publication Date: 2024-12-05MITSUBISHI ELECTRIC CORP

Patent Information

Application Number
JP2023085883
Authority / Receiving Office
JP · JP
Patent Type
Applications
Current Assignee / Owner
Filing Date
2023-05-25
Publication Date
2024-12-05
Estimated Expiration
2043-05-25

AI Technical Summary

Technical Problem

Existing position estimation technologies face accuracy issues due to satellite positioning errors and limitations in dead reckoning when satellite positioning becomes impossible, leading to decreased accuracy in position estimation.

Method used

A position estimation device and method that utilizes both absolute and relative positioning sensors to maintain and update reliable relative positioning trajectories, ensuring accurate position estimation even when absolute positioning is unavailable.

Benefits of technology

Continues highly accurate position estimation by maintaining and updating relative positioning trajectories based on reliable sensor information, even if absolute positioning becomes impossible, thereby enhancing overall positioning accuracy.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure 2024168864000001_ABST
    Figure 2024168864000001_ABST
Patent Text Reader

Abstract

To provide a position estimation device capable of suppressing an estimation position from lowering in precision when a moving body changes positioning means.SOLUTION: A position estimation device 200 is configured to estimate a self-location based upon absolute positioning sensor information by an absolute positioning sensor 20 and relative positioning sensor information by a relative positioning sensor 30 detecting change in position of a moving body 1, and the position estimation device 200 comprises: an absolute positioning location calculation part 50 which calculates the absolute positioning location of the moving body 1 based upon the absolute positioning sensor information; a relative positioning trajectory calculation part 60 which calculates the relative positioning trajectory of the moving body 1, based upon the absolute positioning location, on the basis of the relative positioning sensor information; and a relative positioning trajectory comparison part 90 which outputs the latest location of the moving body 1 on a selected relative positioning trajectory as an estimated location of the moving body 1 when the relative positioning trajectory meets relative positioning trajectory selection conditions.SELECTED DRAWING: Figure 2
Need to check novelty before this filing date? Find Prior Art

Description

[Technical field]

[0001] The present application relates to a position estimation device and a position estimation method. [Background technology]

[0002] Various location estimation technologies have been developed, including location estimation technologies that use positioning satellites such as GPS (Global Positioning System), GNSS (Global Navigation Satellite System), and QZSS (Quasi-Zenith Satellite System), location estimation technologies that use the transmission time or electric field strength of radio waves from multiple wireless LAN base stations or mobile phone base stations, and location estimation technologies that use infrared rays.

[0003] However, for example, in the case of position estimation using a positioning satellite, there are positioning errors due to delays in the ionosphere of signals, multipath caused by buildings, signal interruption, etc. To reduce the effects of these positioning errors, there are technologies such as dead reckoning that estimate the relative position of a moving object. Dead reckoning is a technology that performs position estimation mainly using angular velocity obtained from a gyro sensor and vehicle speed obtained from a vehicle speed sensor. On the other hand, when dead reckoning is started based on a satellite positioning position with reduced accuracy, there is a problem that the accuracy of the positioning position by dead reckoning also decreases at the same time.

[0004] To address these problems, the position detection device described in Patent Document 1 discloses technology that estimates and retains a relative trajectory based on dead navigation using each individual satellite positioning position as a starting point, and when the positioning signal transmitted from the positioning satellite is interrupted, it inherits the relative trajectory before the increase in satellite positioning error and calculates an estimated position based on dead navigation, thereby suppressing a decrease in accuracy of the estimated position using dead navigation. [Prior art documents] [Patent documents]

[0005] [Patent Document 1] Patent No. 6965720 Summary of the Invention [Problem to be solved by the invention]

[0006] According to the position detection device described in Patent Document 1, the relative trajectory before the increase in satellite positioning error is inherited to calculate an estimated position based on dead navigation, and the position estimation by dead navigation is continued. However, since the update and discarding of the relative trajectory are performed successively, when entering an area where satellite positioning is not possible, the options for the relative trajectory for continuing the dead navigation are limited, and the accuracy of the dead navigation may decrease.

[0007] The present disclosure has been made to solve the above-mentioned problems, and aims to provide a position estimation device and a position estimation method that can suppress a decrease in accuracy of the estimated position even when absolute positioning such as satellite positioning is not possible. [Means for solving the problem]

[0008] The position estimation device disclosed in the present application is A position estimation device that estimates its own position based on absolute positioning sensor information acquired by an absolute positioning sensor mounted on a moving body and receiving a plurality of signals each radiated from a known position, and relative positioning sensor information acquired by a relative positioning sensor mounted on the moving body and detecting a change in a relative position of the moving body, an absolute position calculation unit that calculates an absolute position of the moving object based on the absolute positioning sensor information; a relative positioning trajectory calculation unit that calculates a relative positioning trajectory of the moving body based on the relative positioning sensor information and has a relative positioning trajectory storage area that stores the calculated relative positioning trajectory; and a relative positioning trajectory comparison unit that outputs the latest position of the moving body on the selected relative positioning trajectory as an estimated position of the moving body when the relative positioning trajectory satisfies a predetermined relative positioning trajectory selection condition.

[0009] The position estimation method disclosed in the present application comprises: A position estimation method in which the following steps are executed by a position estimation device that estimates a position of a moving object, calculating an absolute position of the moving object based on absolute positioning sensor information acquired by an absolute positioning sensor; calculating a relative positioning trajectory of the moving body based on the absolute positioning position based on relative positioning sensor information acquired by a relative positioning sensor that detects a change in the relative position of the moving body, and storing the calculated relative positioning trajectory in a relative positioning trajectory storage area; a step of estimating, when the relative positioning trajectory satisfies a predefined relative positioning trajectory selection condition, a latest position of the moving object on the selected relative positioning trajectory as a position of the moving object; The method includes a step of repeating a process of storing the latest relative positioning trajectory in the relative positioning trajectory storage area each time the latest relative positioning trajectory satisfies a relative positioning trajectory storage condition based on the relative positioning sensor information, and updating the past relative positioning trajectory stored in the relative positioning trajectory storage area to the latest relative positioning trajectory. Effect of the Invention

[0010] According to the position estimation device and position estimation method disclosed in the present application, by using the absolute positioning position as a reference and retaining and updating the relative positioning trajectory and the relative positioning trajectory reliability at any time based on the relative positioning sensor information obtained from the relative positioning sensor, it is possible to continue highly accurate position estimation using a more reliable relative positioning trajectory even if absolute positioning becomes impossible while the moving body is traveling. [Brief description of the drawings]

[0011] [Figure 1] 1 is a schematic diagram showing a moving body equipped with a position estimation device according to a first embodiment and a positioning system for the moving body. [Diagram 2] 1 is a block diagram showing a configuration of a position estimation device according to a first embodiment. [Diagram 3]4 is a flowchart illustrating the content of a position estimation process according to the position estimation method according to the first embodiment. [Figure 4] 4 is a flowchart illustrating the content of an absolute positioning trajectory reliability calculation process according to the position estimation method according to the first embodiment. [Diagram 5] 4 is a flowchart illustrating a schematic content of a relative positioning trajectory reliability calculation process according to the position estimation method according to the first embodiment. [Figure 6] 4 is a schematic diagram illustrating an example of the operation of the position estimation device according to the first embodiment. FIG. [Figure 7] FIG. 4 is a schematic diagram illustrating another example of the operation of the position estimation device according to the first embodiment. [Figure 8] FIG. 2 is a diagram illustrating an example of hardware of a position estimation device according to the first embodiment. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0012] The objects, features, aspects, and advantages of the present disclosure will become more apparent from the following detailed description and the accompanying drawings. Embodiment 1 FIG. 1 is a schematic diagram showing a moving object 1 equipped with a position estimation device 200 according to the first embodiment, and an entire positioning system for the moving object 1. As shown in FIG.

[0013] The moving body 1 is equipped with a position estimation device 200 according to the first embodiment, an absolute positioning sensor 20 used for absolute positioning of the moving body 1, and a relative positioning sensor 30 used for relative positioning of the moving body 1. Fig. 1 shows a case of satellite positioning by receiving satellite signals from multiple positioning satellites 2 as an example of an absolute positioning means by receiving multiple signals emitted from known positions.

[0014] <Configuration of the Position Estimation Device According to the First Embodiment> 2 is a block diagram showing a configuration of the position estimation device 200 according to the embodiment 1. The position estimation device 200 according to the embodiment 1 includes an absolute positioning position calculation unit 50, a relative positioning trajectory calculation unit 60, a surrounding environment estimation unit 70, a traveling state estimation unit 80, and a relative positioning trajectory comparison unit 90.

[0015] An absolute positioning position storage area 51 is provided inside the absolute positioning position calculation unit 50, and a relative positioning trajectory storage area 61 is provided inside the relative positioning trajectory calculation unit 60.

[0016] Absolute positioning sensor information acquired by an absolute positioning sensor 20 provided outside the position estimation device 200 of embodiment 1, and relative positioning sensor information acquired by a relative positioning sensor 30 also provided outside the position estimation device 200 of embodiment 1 are each output to the position estimation device 200 of embodiment 1.

[0017] The absolute positioning sensor 20 is configured with at least one of a GNSS receiver 21, a UWB receiver 22, an infrared receiver 23, a wireless LAN receiver 24, and the like, for example.

[0018] The relative positioning sensor 30 is configured with at least one of a gyro sensor 31, a wheel speed sensor 32, an acceleration sensor 33, a camera 34, and the like, for example.

[0019] 2, the absolute positioning sensor 20 and the relative positioning sensor 30 are provided outside the position estimation device 200, but they may be provided inside the position estimation device 200. For example, even if the gyro sensor 31, which is an example of the relative positioning sensor 30, is provided inside the position estimation device 200, the position estimation device 200 according to the first embodiment can obtain the same effect regarding position estimation.

[0020] The following describes basic functions of the absolute positioning position calculation unit 50, the relative positioning trajectory calculation unit 60, the surrounding environment estimation unit 70, the traveling state estimation unit 80, and the relative positioning trajectory comparison unit 90, which constitute the position estimation device 200 according to the first embodiment. Note that more detailed functions will be described in detail in the description of the operation of the position estimation device 200 according to the first embodiment.

[0021] The absolute positioning position calculation unit 50 calculates the absolute position of the moving object 1 based on the absolute positioning sensor information acquired from the absolute positioning sensor 20. The calculated absolute position is stored in an absolute positioning position storage area 51 provided inside the absolute positioning position calculation unit 50. In addition, the absolute positioning position calculation unit 50 calculates absolute positioning trajectory reliability indicating the reliability of the absolute positioning trajectory.

[0022] The relative positioning trajectory calculation unit 60 judges whether or not the absolute positioning trajectory reliability calculated by the absolute positioning position calculation unit 50 is equal to or greater than a preset threshold reliability.

[0023] The surrounding environment estimation unit 70 estimates the traveling environment around the moving object 1 based on the absolute positioning sensor information and the relative positioning sensor information acquired from the absolute positioning sensor 20 and the relative positioning sensor 30, respectively.

[0024] The traveling state estimating unit 80 estimates the traveling state of the moving object 1 based on the relative positioning sensor information acquired from the relative positioning sensor 30.

[0025] The relative positioning trajectory comparison unit 90 compares the reliability of the relative positioning trajectories calculated and stored in the relative positioning trajectory calculation unit 60, selects the relative positioning trajectory with the highest relative positioning trajectory reliability, and outputs the absolute position on the relative positioning trajectory (hereinafter also referred to as the latest position of the moving body 1) as the estimated position of the moving body 1.

[0026] <Operation of the position estimation device according to the first embodiment> The outline of the processing performed by the position estimation device 200 according to the first embodiment will be described below with reference to the flowcharts shown in FIGS.

[0027] In the position estimation device 200, the position estimation process as shown in the flowchart of Fig. 3 is repeated. In step S301, the absolute positioning position calculation unit 50 calculates the absolute positioning position of the moving object 1 based on the absolute positioning sensor information acquired from the absolute positioning sensor 20. The calculated absolute positioning position is stored in the absolute positioning position storage area 51. The absolute positioning position stored in the absolute positioning position storage area 51 includes information on the positioning accuracy, such as the convergence of carrier wave estimation in satellite positioning. After the process of step S301, the process proceeds to step S302.

[0028] In step S302, the surrounding environment estimation unit 70 estimates the running environment around the moving object 1 based on the absolute positioning sensor information and the relative positioning sensor information acquired from the absolute positioning sensor 20 and the relative positioning sensor 30, respectively. In addition, the surrounding environment estimation unit 70 stores, that is, holds, the calculated information on the running environment in the absolute positioning position storage area 51. That is, in the process of step S302, the running environment around the moving object 1 is estimated.

[0029] For example, a sky factor that indicates the proportion of the space around the moving object 1 that is free from obstructions is roughly calculated based on the distribution of elevation angles of positioning satellites 2 whose reception strength is equal to or greater than a preset threshold strength among the multiple positioning satellites 2 that are being positioned by the GNSS receiver 21. The calculated sky factor may be stored in the absolute positioning position storage area 51.

[0030] Generally, when the sky factor is low, the satellite positioning accuracy decreases due to the influence of a decrease in the number of positioning satellites 2 or an increase in multipath. In addition, for example, when a camera 34 is installed in front of the moving body 1, the presence and position of surrounding obstructions on the travel path of the moving body 1 may be detected in advance using the camera 34, and stored in the absolute positioning position storage area 51. Obstructions include, for example, high-rise buildings, bridges, road soundproof walls, mountains, trucks, other moving bodies 1 such as buses, etc. After the process of step S302, the process proceeds to step S303.

[0031] In step S303, the absolute positioning position calculation unit 50 refers to the absolute positioning position memory area 51, and if the number of absolute positioning positions stored in the absolute positioning position memory area 51 is equal to or greater than a predetermined threshold number, calculates an absolute positioning trajectory of the moving body 1 based on the stored absolute positioning positions, and updates the absolute position of the moving body 1 on the absolute positioning trajectory (the latest position of the moving body 1) as the absolute positioning position.

[0032] The calculation of the absolute positioning trajectory of the moving object 1 may be based on information on the positioning accuracy of the absolute positioning position stored in the absolute positioning position storage area 51. The absolute positioning position calculation unit 50 also calculates an absolute positioning trajectory reliability indicating the reliability of the absolute positioning trajectory. A method of calculating the absolute positioning trajectory reliability will be described later in detail. After the process of step S303, the process proceeds to step S304.

[0033] In step S304, the absolute positioning position calculation unit 50 deletes information about the absolute positioning position used in the calculation of the absolute positioning trajectory from the absolute positioning position storage area 51. By performing such processing, it is possible to reduce the absolute positioning position storage area 51 required for holding the absolute positioning position. After the processing of step S304, the process proceeds to the processing of step S305.

[0034] In step S305, the relative positioning trajectory calculation unit 60 judges whether the absolute positioning trajectory reliability calculated by the absolute positioning position calculation unit 50 is equal to or greater than a preset threshold reliability. Such a judgment condition is called a relative positioning trajectory calculation condition. If the absolute positioning trajectory reliability is equal to or greater than the threshold reliability, the result is YES, and the process proceeds to step S306. On the other hand, if the absolute positioning trajectory reliability is less than the threshold reliability, the result is NO, and the process proceeds to step S309.

[0035] In step S306, the relative positioning trajectory calculation unit 60 refers to the relative positioning trajectory storage area 61, and when a relative positioning trajectory is already stored in the relative positioning trajectory storage area 61, judges whether or not all the stored relative positioning trajectory reliabilities are less than the threshold reliability. This judgment condition is called a relative positioning trajectory storage condition. When all the stored relative positioning trajectory reliabilities are less than the threshold reliability, the result is YES, and the process proceeds to step S307. On the other hand, when any one of the stored relative positioning trajectory reliability is equal to or greater than the threshold reliability, the result is NO, and the process proceeds to step S309. This suppresses the calculation of unnecessary relative positioning trajectories, and has the effect of reducing memory capacity and processing load.

[0036] In step S307, the traveling state estimation unit 80 estimates the traveling state of the moving object 1 based on the relative positioning sensor information acquired from the relative positioning sensor 30. For example, it is estimated that the moving object 1 is turning based on the rotation detection result of the moving object 1 by the gyro sensor 31, the left and right wheel speed difference detection result by the wheel speed sensor 32, etc. Also, for example, the vibration state or acceleration / deceleration state of the moving object 1 is estimated based on the detection result of the acceleration sensor 33. That is, in the process of step S307, the traveling state of the moving object 1 is estimated.

[0037] In step S308, the relative positioning trajectory calculation unit 60 calculates the relative positioning trajectory of the moving object 1 based on the relative positioning sensor information acquired from the relative positioning sensor 30, using the absolute positioning position as a reference. The relative positioning trajectory calculation unit 60 also calculates a relative positioning trajectory reliability indicating the reliability of the relative positioning trajectory. A method for calculating the relative positioning trajectory reliability will be described later in detail. After the process of step S308, the process proceeds to step S309.

[0038] In step S309, the relative positioning trajectory calculation unit 60 refers to the relative positioning trajectory storage area 61, and if a relative positioning trajectory is already stored in the relative positioning trajectory storage area 61, the relative positioning trajectory calculation unit 60 updates the relative positioning trajectory based on the relative positioning sensor information acquired from the relative positioning sensor 30, with a relative position on the relative positioning trajectory as a reference. Also, the relative positioning trajectory reliability indicating the reliability of the relative positioning trajectory is updated. After the process of step S309, the process proceeds to step S310.

[0039] In step S310, the relative positioning trajectory calculation unit 60 judges whether the relative positioning trajectory reliability calculated in the relative positioning trajectory calculation unit 60 is equal to or greater than the threshold reliability. If the relative positioning trajectory reliability is equal to or greater than the threshold reliability, the result is YES, and the process proceeds to step S311. On the other hand, if the relative positioning trajectory reliability is less than the threshold reliability, the result is NO, and the process proceeds to step S313.

[0040] In step S311, the relative positioning trajectory calculation unit 60 refers to the relative positioning trajectory storage area 61 and determines whether the number of the stored relative positioning trajectories is less than a preset threshold number. If the number of the stored relative positioning trajectories is less than the threshold number, the result is YES, and the process proceeds to step S312. If the number of the stored relative positioning trajectories is equal to or greater than the threshold number, the result is NO, and the process proceeds to step S313.

[0041] In step S312, the calculated or updated relative positioning trajectory is held in the relative positioning trajectory storage area 61. At this time, for the newly calculated relative positioning trajectory, information on the running environment estimated by the surrounding environment estimation unit 70 in step S302 and the running state of the moving object 1 at the time of calculation of the relative positioning trajectory estimated by the running state estimation unit 80 in step S307 are stored in the relative positioning trajectory storage area 61 as information on the relative positioning trajectory.

[0042] In step S313, the relative positioning trajectory calculation unit 60 determines the order of the relative positioning trajectory reliability by comparing the relative positioning trajectory reliability of the target relative positioning trajectory with the relative positioning trajectory reliability of other relative positioning trajectories stored in the relative positioning trajectory storage area 61. If the order of the relative positioning trajectory reliability satisfies the preset allowable order condition, the result is YES, and the process proceeds to step S312. If the order of the relative positioning trajectory reliability does not satisfy the preset allowable order condition, the result is NO, and the process proceeds to step S314.

[0043] In step S314, the relative positioning trajectory calculation unit 60 deletes the calculated or updated relative positioning trajectory, thereby obtaining the effect of reducing the memory capacity.

[0044] The relative positioning trajectory calculation unit 60 repeatedly performs the processes from step S310 to step S314 for the total number n of calculated and updated relative positioning trajectories. After performing the processes from step S310 to step S314, the process proceeds to step S315.

[0045] In step S315, the relative positioning trajectory comparison unit 90 compares the reliabilities of the relative positioning trajectories calculated and stored in the relative positioning trajectory calculation unit 60, selects the relative positioning trajectory with the highest relative positioning trajectory reliability, and outputs the absolute position (latest position of the moving body 1) on the relative positioning trajectory as the estimated position of the moving body 1. Such a selection condition is called a relative positioning trajectory selection condition. The above is an overview of the processing contents performed by the position estimation device 200 according to the first embodiment.

[0046] <Calculation method of absolute positioning trajectory reliability> The specific processing content of the method for calculating the absolute positioning trajectory reliability will be described below with reference to the flowchart of FIG.

[0047] <Initial reliability setting> In step S401, the absolute positioning position calculation unit 50 sets an initial reliability r as an initial value of the absolute positioning trajectory reliability at the timing of calculating the absolute positioning trajectory reliability. The initial reliability r may be set in advance, or may be dynamically changed in a processing step of the position estimation device 200. For example, when the detection performance of the absolute positioning sensor 20 is high, the initial reliability r may be set high in advance.

[0048] Also, for example, when multiple absolute positioning sensors 20 are installed, it is possible to set the initial reliability r high in advance, assuming that there are many sensor inputs for position estimation. Also, for example, when a malfunction of the absolute positioning sensor 20 is suspected in the middle of a processing step of the position estimation device 200, the initial reliability r may be dynamically set to be low.

[0049] In step S402, the absolute positioning position calculation unit 50 compares the estimated error of the absolute positioning position used in calculating the absolute positioning trajectory with a preset allowable error, and increases the initial reliability r if it falls within the allowable error, while decreasing the initial reliability r according to the magnitude of the estimated error if it does not fall within the allowable error. This corresponds to, for example, a case in which the estimated error calculated based on the information on the satellite positioning accuracy stored in the absolute positioning position storage area 51 in step S302 is compared with the preset allowable error. That is, in the process of step S402, the reliability is set according to the accuracy of the absolute positioning position.

[0050] In step S403, the absolute positioning position calculation unit 50 compares the variance value of the position error of the absolute positioning position used in the calculation of the absolute positioning trajectory with a preset allowable variance value, and increases the initial reliability r if it falls within the allowable variance value, and decreases the initial reliability r according to the magnitude of the variance value if it does not fall within the allowable variance value. For example, when the moving body 1 is moving straight, the absolute positioning position ideally coincides with the absolute positioning trajectory, so the variance value of the position error of the absolute positioning position with respect to the absolute positioning trajectory is 0, but if the variance value is larger than the allowable variance value, it can be determined that a position error occurs in one of the absolute positioning positions, and this corresponds to the case where the absolute positioning trajectory reliability is decreased. That is, in the process of step S403, the reliability is set according to the variation of the absolute positioning position.

[0051] In step S404, the absolute positioning position calculation unit 50 compares the distance traveled by the moving object 1 during calculation of the absolute positioning positions used in the calculation of the absolute positioning trajectory with a preset allowable travel distance, and increases the initial reliability r if the distance is within the allowable travel distance, whereas decreases the initial reliability r according to the magnitude of the travel distance if the distance is not within the allowable travel distance. This corresponds to a case where, for example, absolute positioning by the absolute positioning sensor 20 is temporarily interrupted and then absolute positioning is resumed, and the absolute positioning positions before and after the interruption are used to calculate the absolute positioning trajectory. That is, in the process of step S404, the reliability is set according to the distance continuity of the absolute positioning positions.

[0052] The absolute positioning trajectory reliability is set according to the driving environment around the moving object 1. The camera 34, map information, roadside devices, etc. are used to set the absolute positioning trajectory reliability. Obstructions such as buildings have a negative effect on satellite positioning. Therefore, it is necessary to change the degree of increase or decrease in the absolute positioning trajectory reliability.

[0053] In step S405, the absolute position calculation unit 50 compares the running environment around the moving object 1 during calculation of the absolute position used in calculating the absolute position trajectory with a preset allowable environmental condition, and increases the initial reliability r if it falls within the allowable environmental condition, and decreases the initial reliability r if it does not fall within the allowable environmental condition. That is, in the process of step S405, the reliability is set according to the running environment around the moving object 1.

[0054] An example of the permissible environmental condition is the presence or absence of obstructions around the mobile unit 1. This corresponds to a case where, for example, when satellite positioning is used as an absolute positioning means, in an environment where high-rise buildings are present around the mobile unit 1, even if the signal strength from the positioning satellite 2 is strong, the satellite positioning accuracy may be reduced due to multipath caused by the positioning signal being reflected off the walls of the high-rise buildings, thereby reducing the reliability of the satellite positioning accuracy. Signal multipath may occur not only in satellite positioning, but also in, for example, UWB positioning using the UWB receiver 22, which is another absolute positioning means.

[0055] The above-described method for calculating the reliability of the absolute positioning trajectory is based on the basic idea of ​​making it possible to reflect whether the accuracy of the multiple absolute positioning positions used in the calculation of the absolute positioning trajectory is good or not in the reliability of the absolute positioning trajectory. In this case, by using at least one of the methods for calculating the reliability of the absolute positioning trajectory, the effects of the present disclosure can be achieved.

[0056] <Calculation method of relative positioning trajectory reliability> The specific processing content of the method for calculating the reliability of the relative positioning path will be described below with reference to the flowchart of FIG.

[0057] <Initial reliability setting> In step S501, the relative positioning trajectory calculation unit 60 sets an initial reliability ta0 as an initial value of the relative positioning trajectory reliability ta at the timing of calculating the relative positioning trajectory reliability ta of the relative positioning trajectory a to be calculated. The initial reliability ta0 may be set in advance or may be dynamically changed in the processing steps of the position estimation device 200. For example, when the detection performance of the relative positioning sensor 30 is high, the initial reliability ta0 may be set high in advance.

[0058] Also, for example, when there are multiple relative positioning sensors 30, the initial reliability ta0 may be set high in advance on the assumption that there are many sensor inputs for position estimation. Also, for example, when a failure of the relative positioning sensor 30 is suspected in the middle of a processing step of the position estimation device 200, the initial reliability ta0 may be dynamically set to be low.

[0059] In step S502, the relative positioning trajectory calculation unit 60 compares the estimated error of the absolute positioning position used as a calculation reference for the relative positioning trajectory a at the start of calculation of the relative positioning trajectory a with a preset allowable error, and increases the relative positioning trajectory reliability ta if it falls within the allowable error, while decreasing the relative positioning trajectory reliability ta according to the magnitude of the estimated error if it does not fall within the allowable error. This corresponds to, for example, a case where the estimated error calculated based on the information on the satellite positioning accuracy stored in the absolute position storage area 51 in step S302 is compared with a preset allowable error.

[0060] Alternatively, the absolute positioning trajectory reliability may be used as an index instead of the estimation error of the absolute positioning position, and compared with a preset allowable reliability, and if it falls within the allowable reliability, the relative positioning trajectory reliability ta may be increased, and if it does not fall within the allowable reliability, the relative positioning trajectory reliability ta may be decreased according to the magnitude of the absolute positioning trajectory reliability. This corresponds to a case where, for example, if the accuracy of the reference absolute positioning trajectory is good, the accuracy of the relative positioning trajectory is also good. That is, in the process of step S502, the relative positioning trajectory reliability is set according to the estimation error of the absolute positioning position (= absolute positioning trajectory reliability) at the start of calculation of the relative positioning trajectory.

[0061] In step S503, the relative positioning trajectory calculation unit 60 compares the traveling state of the moving object 1 at the start of calculation of the relative positioning trajectory a with a preset allowable traveling condition, and if it falls within the allowable traveling condition, makes it easier to increase the relative positioning trajectory reliability ta in the processing from step S504 onwards, and if it does not fall within the allowable traveling condition, makes it harder to decrease the relative positioning trajectory reliability ta in the processing from step S504 onwards. The traveling state of the moving object 1 is information on the traveling state estimated by the traveling state estimation unit 80 in step S307.

[0062] An example of the allowable traveling condition is the turning radius of the moving body 1. This corresponds to a case where, for example, when a relative positioning trajectory is newly calculated, it is determined that the moving body 1 is turning based on the rotation detection result of the moving body 1 by the gyro sensor 31 and the detection result of the left and right wheel speed difference by the wheel speed sensor 32, and when the turning radius is equal to or larger than a preset threshold turning radius, the accuracy of the absolute positioning trajectory that is the reference of the relative positioning trajectory a is deemed to be reduced, and the increase amount of the relative positioning trajectory reliability ta is reduced when updating the relative positioning trajectory a.

[0063] For example, when satellite positioning by the GNSS receiver 21 is used as an absolute positioning means, the processing cycle of the satellite positioning is generally longer than the processing cycle of the gyro sensor 31 or the wheel speed sensor 32, etc., and the ability to track the traveling trajectory of the moving body 1 often deteriorates during turning.

[0064] In step S504, the relative positioning trajectory calculation unit 60 compares the elapsed time from the calculation start time of the relative positioning trajectory a to the current calculation time or update time with a preset allowable time, and if it is within the allowable time, makes it easier to increase the relative positioning trajectory reliability ta in the processing from step S504 onwards. On the other hand, if it is not within the allowable time, makes it harder to decrease the relative positioning trajectory reliability ta in the processing from step S504 onwards. That is, in the processing of step S504, the reliability is made harder to increase as the elapsed time after the calculation start of the relative positioning trajectory increases.

[0065] Generally, the relative positioning position of the moving object 1 is calculated by integrating the relative movement amount of the moving object 1 estimated based on the relative positioning sensor information acquired from the relative positioning sensor 30, so that the sensor error accumulates with an increase in the integration time, and the relative positioning trajectory reliability decreases. Therefore, by determining the allowable time according to the sensor error characteristics, it becomes possible to appropriately calculate the relative positioning trajectory reliability.

[0066] In step S505, when the estimation error of the latest absolute positioning position falls within a preset tolerance, the relative positioning trajectory calculation unit 60 compares the position error of the relative positioning trajectory a with respect to the latest absolute positioning position as the estimation error of the relative positioning trajectory a with the preset tolerance, and increases the relative positioning trajectory reliability ta if it falls within the tolerance, and decreases the relative positioning trajectory reliability ta according to the magnitude of the estimation error if it does not fall within the tolerance. That is, in the process of step S505, the position error of the relative positioning trajectory is compared with that of a highly accurate absolute positioning position.

[0067] This corresponds to a case where, for example, when the estimated error calculated based on the information on the satellite positioning accuracy stored in the absolute position storage area 51 in step S302 falls within a preset allowable error, the absolute positioning position is regarded as a true value and the reliability of the position accuracy of the relative positioning trajectory is determined. In addition, regarding the absolute positioning position when a plurality of absolute positioning sensors 20 are provided, any one of the absolute positioning positions having the smallest estimated error may be adopted, or the average value of the absolute positioning positions may be adopted, or a weighted average value may be adopted according to the detection performance of the absolute positioning sensors 20.

[0068] In step S506, the relative positioning trajectory calculation unit 60 compares the position error of the relative positioning trajectory a relative to the relative positioning trajectory b stored in the relative positioning trajectory memory area 61 with a tolerance set in advance as an estimated error of the relative positioning trajectory a, and if it falls within the tolerance, increases the relative positioning trajectory reliability ta, and if it does not fall within the tolerance, decreases the relative positioning trajectory reliability ta according to the magnitude of the estimated error.

[0069] The traveling state of the moving object 1 is information on the traveling state estimated by the traveling state estimation unit 80 in step S307. Here, the relative positioning trajectory b is the relative positioning trajectory whose reliability tb is equal to or higher than a preset allowable reliability and is the highest among the relative positioning trajectories stored in the relative positioning trajectory storage area 61.

[0070] This corresponds to a case where, when a relative positioning trajectory with high position accuracy already exists, the relative positioning trajectory is regarded as a true value and the reliability of the position accuracy of the relative positioning trajectory is judged. Note that, when the processing cycles of the absolute positioning and the relative positioning are different and the absolute positioning position is not calculated at the calculation timing of the reliability of the relative positioning trajectory, the processing of step S506 may be omitted.

[0071] In step S507, the relative positioning trajectory calculation unit 60 compares the traveling state estimated by the traveling state estimation unit 80 in step S307 with the preset allowable traveling conditions, and makes it easier to increase ta if it falls within the allowable traveling conditions, and makes it harder to decrease ta if it does not fall within the allowable traveling conditions. As the allowable traveling conditions, it is possible to set the allowable traveling conditions similar to those in step S503. That is, in the process of step S507, it makes it harder to increase the reliability according to the traveling state (acceleration, yaw rate) of the moving object 1 estimated from the absolute positioning sensor 20 and the relative positioning sensor 30. This is because a scale factor error occurs in the relative positioning sensor 30.

[0072] By using at least one of the above-described methods for calculating the reliability of the relative positioning path, the effects of the first embodiment can be obtained.

[0073] In addition, the relative positioning trajectory calculation unit 60 may determine that the relative positioning trajectory storage condition is satisfied when at least one of the following conditions is met for the relative positioning trajectory stored in the relative positioning trajectory memory area 61: the relative positioning trajectory reliability is equal to or greater than a predetermined threshold reliability; the storage amount of the relative positioning trajectory stored in the relative positioning trajectory memory area 61 is less than a predetermined threshold storage amount; or the storage amount of the relative positioning trajectory stored in the relative positioning trajectory memory area 61 is equal to or greater than a predetermined threshold storage amount and the relative positioning trajectory reliability is higher than a predetermined set reliability value within the range of the threshold reliability.

[0074] <Operation of the position estimation device according to the first embodiment> FIG. 6 is a schematic diagram for explaining an example of the operation of the position estimation device 200 according to the first embodiment. Specifically, FIG. 6 shows an example of an absolute positioning position and a relative positioning position, and a relative positioning trajectory calculated from the absolute positioning position and the relative positioning position. The relative positioning trajectory is calculated based on the absolute positioning position at each preset time. In the example shown in FIG. 6, a relative positioning trajectory A is calculated based on an absolute positioning position a measured at a time 0s, and a relative positioning trajectory B is calculated based on an absolute positioning position b measured at a time 4s. That is, a plurality of relative positioning trajectories exist at the same time. As for the latest position of the moving object 1 on the relative positioning trajectory, the latest relative positioning position on the relative positioning trajectory selected from the plurality of relative positioning trajectories is output as an estimated position. The relative positioning trajectory that is the latest in time is called the latest relative positioning trajectory.

[0075] For example, when the positioning result of the absolute position has been acquired as shown in Fig. 6, at time 2s, the relative positioning position a at time 2s is output as the latest position of the moving body 1. Also, at time 6s, if the relative positioning trajectory A is selected, the relative positioning position b is output as the latest position of the moving body 1, and if the relative positioning trajectory B is selected, the relative positioning position c is output as the latest position of the moving body 1.

[0076] Fig. 7 is a schematic diagram for explaining another example of the operation of the position estimation device 200 according to the first embodiment. Specifically, Fig. 7 shows an example of the absolute positioning position and the relative positioning position, and the relative positioning trajectory calculated from the absolute positioning position and the relative positioning position, when the moving object 1 enters an area where absolute positioning is not possible, i.e., an absolute positioning unavailable area. If the absolute positioning position a has high accuracy, while the absolute positioning position b has low accuracy, only the relative positioning trajectory C starting from the highly accurate absolute positioning position a is calculated and continues to be updated, and the relative positioning trajectory D is not calculated. As a result, it is possible to suppress the deterioration of the accuracy of the estimated position.

[0077] In other words, by determining whether or not the relative positioning trajectory can be calculated under the condition that the absolute positioning position satisfies predetermined relative positioning trajectory calculation conditions, relative positioning trajectories with low accuracy are excluded in advance, thereby achieving the effect of suppressing a decrease in accuracy of the estimated position even in cases where absolute positioning is impossible.

[0078] <Advantages of the First Embodiment> As described above, according to the position estimation device and position estimation method of embodiment 1, the absolute positioning position calculated based on the absolute positioning sensor information acquired from the absolute positioning sensor is used as a reference, and the relative positioning trajectory and the relative positioning trajectory reliability are maintained and updated as necessary based on the relative positioning sensor information acquired from the relative positioning sensor, thereby achieving the effect of enabling high-precision position estimation to be continued using a more reliable relative positioning trajectory even when absolute positioning becomes impossible while the moving body is traveling.

[0079] In the configuration of the position estimation device 200 according to the first embodiment described above, the position estimation device 200 has been described as a functional block, but an example of the configuration as hardware that stores the position estimation device 200 is shown in Fig. 8. The hardware 800 includes a processor 801 and a storage device 802. Although not shown, the storage device 802 includes a volatile storage device such as a random access memory, and a non-volatile auxiliary storage device such as a flash memory.

[0080] Also, a hard disk auxiliary storage device may be provided instead of the flash memory. The processor 801 executes a program input from the storage device 802. In this case, the program is input from the auxiliary storage device to the processor 801 via the volatile storage device. The processor 801 may output data such as a calculation result to the volatile storage device of the storage device 802, or may store the data in the auxiliary storage device via the volatile storage device.

[0081] Summary of the various aspects of the present application Various aspects of the present application are summarized below as appendices.

[0082] (Appendix 1) A position estimation device that estimates its own position based on absolute positioning sensor information acquired by an absolute positioning sensor mounted on a moving body and receiving a plurality of signals each radiated from a known position, and relative positioning sensor information acquired by a relative positioning sensor mounted on the moving body and detecting a change in a relative position of the moving body, an absolute position calculation unit that calculates an absolute position of the moving object based on the absolute positioning sensor information; a relative positioning trajectory calculation unit that calculates a relative positioning trajectory of the moving body based on the relative positioning sensor information and has a relative positioning trajectory storage area that stores the calculated relative positioning trajectory; a relative positioning trajectory comparison unit that outputs, when the relative positioning trajectory satisfies a predetermined relative positioning trajectory selection condition, a latest position of the moving object on the selected relative positioning trajectory as an estimated position of the moving object; A position estimation device comprising:

[0083] (Appendix 2) the relative positioning trajectory calculation unit repeats a process of storing the latest relative positioning trajectory in the relative positioning trajectory storage area every time the latest relative positioning trajectory based on the relative positioning sensor information satisfies a relative positioning trajectory storage condition, and updates the past relative positioning trajectory stored in the relative positioning trajectory storage area to the latest relative positioning trajectory; The position estimation device according to claim 1, characterized in that if the latest relative positioning trajectory does not satisfy the predefined relative positioning trajectory storage condition, the latest relative positioning trajectory is deleted without being stored in the relative positioning trajectory storage area.

[0084] (Appendix 3) The position estimation device described in Appendix 2, characterized in that the absolute positioning position calculation unit has an absolute positioning position storage area capable of storing the calculated absolute position, calculates an absolute positioning trajectory of the moving body based on the multiple absolute positioning positions stored in the absolute positioning position storage area, and updates the latest position of the moving body on the absolute positioning trajectory as the absolute positioning position based on the absolute positioning sensor information.

[0085] (Appendix 4) the absolute positioning position calculation unit calculates an absolute positioning trajectory reliability indicating a reliability of the absolute positioning trajectory; The position estimation device according to claim 3, wherein the relative positioning trajectory calculation unit determines that the relative positioning trajectory calculation condition is satisfied when the absolute positioning trajectory reliability is equal to or greater than a preset threshold reliability.

[0086] (Appendix 5) The position estimation device according to claim 4, characterized in that the absolute positioning trajectory reliability is calculated using at least one of an estimation error occurring at each of the plurality of absolute positioning positions used for calculating the absolute positioning trajectory, a position error of each of the plurality of absolute positioning positions used for calculating the absolute positioning trajectory with respect to the relative positioning trajectory, and a distance traveled by the moving body while calculating the plurality of absolute positioning positions used for calculating the absolute positioning trajectory.

[0087] (Appendix 6) a surrounding environment estimation unit that estimates a running environment around the moving object based on the absolute positioning sensor information and the relative positioning sensor information, 6. The position estimation device according to claim 5, further comprising a driving environment around the moving object as an index for calculating the absolute positioning trajectory reliability.

[0088] (Appendix 7) the relative positioning trajectory calculation unit calculates a relative positioning trajectory reliability that is a reliability of the relative positioning trajectory, The position estimation device according to any one of claims 1 to 6, wherein the relative positioning trajectory comparison unit determines that the relative positioning trajectory selection condition is satisfied when the relative positioning trajectory reliability is equal to or greater than a preset threshold reliability.

[0089] (Appendix 8) The position estimation device according to claim 7, characterized in that the relative positioning trajectory reliability is calculated using at least one of an estimation error of the absolute positioning position, a position error of the relative positioning trajectory relative to the absolute positioning position, a position error of the relative positioning trajectory relative to the relative positioning trajectory stored in the relative positioning trajectory storage area, an estimation error of the absolute positioning position at a start time of calculation of the relative positioning trajectory, a running state of the moving body estimated from the absolute positioning sensor information and the relative positioning sensor information, a running state of the moving body at a start time of calculation of the relative positioning trajectory, a running environment around the moving body estimated from the absolute positioning sensor and the relative positioning sensor, a running environment of the moving body at a start time of calculation of the relative positioning trajectory, and an elapsed time that has elapsed since a start time of calculation of the relative positioning trajectory.

[0090] (Appendix 9) A traveling state estimation unit that estimates a traveling state of the moving object based on the absolute positioning sensor information and the relative positioning sensor information, 9. The position estimation device according to claim 8, further comprising, as an index for calculating the reliability of the relative positioning trajectory, a running state of the moving body estimated by the running state estimation unit and a running state of the moving body at a start time of calculation of the relative positioning trajectory.

[0091] (Appendix 10) The position estimation device according to any one of appendices 7 to 9, characterized in that the relative positioning trajectory calculation unit satisfies a relative positioning trajectory calculation condition when all of the relative positioning trajectories reliabilities are less than a preset threshold reliability for the relative positioning trajectories stored in the relative positioning trajectory storage area.

[0092] (Appendix 11) The position estimation device according to any one of appendices 7 to 10, wherein the relative positioning trajectory calculation unit determines that the relative positioning trajectory stored in the relative positioning trajectory storage area satisfies the relative positioning trajectory storage condition when at least one of the following is true: the relative positioning trajectory reliability is equal to or greater than a preset threshold reliability, the storage amount of the relative positioning trajectory stored in the relative positioning trajectory storage area is less than a preset threshold storage amount, or the storage amount of the relative positioning trajectory stored in the relative positioning trajectory storage area is equal to or greater than the threshold storage amount and the relative positioning trajectory reliability is higher than a preset set reliability value within a range of the threshold reliability.

[0093] (Appendix 12) The position estimation device described in Appendix 1, characterized in that when the absolute positioning position satisfies a predetermined relative positioning trajectory calculation condition, the relative positioning trajectory of the moving body is calculated based on the relative positioning sensor information and the absolute positioning position is used as a reference.

[0094] (Appendix 13) A position estimation method in which the following steps are executed by a position estimation device that estimates a position of a moving object, calculating an absolute position of the moving object based on absolute positioning sensor information acquired by an absolute positioning sensor; calculating a relative positioning trajectory of the moving body based on the absolute positioning position based on relative positioning sensor information acquired by a relative positioning sensor that detects a change in the relative position of the moving body, and storing the calculated relative positioning trajectory in a relative positioning trajectory storage area; a step of estimating, when the relative positioning trajectory satisfies a predefined relative positioning trajectory selection condition, a latest position of the moving object on the selected relative positioning trajectory as a position of the moving object; a step of repeating a process of storing the latest relative positioning trajectory in the relative positioning trajectory storage area every time the latest relative positioning trajectory satisfies a relative positioning trajectory storage condition based on the relative positioning sensor information, and updating the past relative positioning trajectory stored in the relative positioning trajectory storage area to the latest relative positioning trajectory; A location estimation method comprising:

[0095] Although the present disclosure describes various exemplary embodiments and examples, the various features, aspects, and functions described in one or more embodiments are not limited to application to a particular embodiment, but may be applied to the embodiments alone or in various combinations.

[0096] Therefore, countless modifications not exemplified are assumed within the scope of the technology disclosed in the present specification, including, for example, modifying, adding, or omitting at least one component, and further, extracting at least one component and combining it with a component of another embodiment. [Explanation of symbols]

[0097] 1 Mobile object, 2 Positioning satellite, 20 Absolute positioning sensor, 21 GNSS receiver, 22 UWB receiver, 23 Infrared receiver, 24 Wireless LAN receiver, 30 Relative positioning sensor, 31 Gyro sensor, 32 Wheel speed sensor, 33 Acceleration sensor, 34 Camera, 50 Absolute positioning position calculation unit, 51 Absolute positioning position storage area, 60 Relative positioning trajectory calculation unit, 61 Relative positioning trajectory storage area, 70 Surrounding environment estimation unit, 80 Running state estimation unit, 90 Relative positioning trajectory comparison unit, 200 Position estimation device, 800 Hardware, 801 Processor, 802 Storage device

Claims

1. A position estimation device that estimates its own position based on absolute positioning sensor information acquired by an absolute positioning sensor mounted on a moving body and receiving a plurality of signals each radiated from a known position, and relative positioning sensor information acquired by a relative positioning sensor mounted on the moving body and detecting a change in a relative position of the moving body, an absolute position calculation unit that calculates an absolute position of the moving object based on the absolute positioning sensor information; a relative positioning trajectory calculation unit that calculates a relative positioning trajectory of the moving body based on the relative positioning sensor information and has a relative positioning trajectory storage area that stores the calculated relative positioning trajectory; a relative positioning trajectory comparison unit that outputs, when the relative positioning trajectory satisfies a predetermined relative positioning trajectory selection condition, a latest position of the moving object on the selected relative positioning trajectory as an estimated position of the moving object; A position estimation device comprising:

2. the relative positioning trajectory calculation unit repeats a process of storing the latest relative positioning trajectory in the relative positioning trajectory storage area every time the latest relative positioning trajectory based on the relative positioning sensor information satisfies a relative positioning trajectory storage condition, and updates the past relative positioning trajectory stored in the relative positioning trajectory storage area to the latest relative positioning trajectory; 2. The position estimation device according to claim 1, characterized in that if the latest relative positioning trajectory does not satisfy the predetermined relative positioning trajectory storage condition, the latest relative positioning trajectory is deleted without being stored in the relative positioning trajectory storage area.

3. The position estimation device according to claim 2, characterized in that the absolute positioning position calculation unit has an absolute positioning position storage area capable of storing the calculated absolute position, calculates an absolute positioning trajectory of the moving body based on the multiple absolute positioning positions stored in the absolute positioning position storage area, and updates the latest position of the moving body on the absolute positioning trajectory as the absolute positioning position based on the absolute positioning sensor information.

4. the absolute positioning position calculation unit calculates an absolute positioning trajectory reliability indicating a reliability of the absolute positioning trajectory; 4. The position estimation device according to claim 3, wherein the relative positioning trajectory calculation unit determines that the relative positioning trajectory calculation condition is satisfied when the absolute positioning trajectory reliability is equal to or greater than a preset threshold reliability.

5. 5. The position estimation device according to claim 4, characterized in that the absolute positioning trajectory reliability is calculated using at least one of an estimation error occurring at each of the multiple absolute positioning positions used for calculating the absolute positioning trajectory, a position error of each of the multiple absolute positioning positions used for calculating the absolute positioning trajectory with respect to the relative positioning trajectory, and a distance traveled by the moving body while calculating the multiple absolute positioning positions used for calculating the absolute positioning trajectory.

6. a surrounding environment estimation unit that estimates a running environment around the moving object based on the absolute positioning sensor information and the relative positioning sensor information, The position estimation device according to claim 5 , further comprising an index for calculating the reliability of the absolute positioning trajectory, the index including a driving environment around the moving object.

7. the relative positioning trajectory calculation unit calculates a relative positioning trajectory reliability that is a reliability of the relative positioning trajectory, 7. The position estimation device according to claim 1, wherein the relative positioning trajectory comparison unit determines that the relative positioning trajectory selection condition is satisfied when the relative positioning trajectory reliability is equal to or greater than a preset threshold reliability.

8. 8. The position estimation device according to claim 7, characterized in that the relative positioning trajectory reliability is calculated using at least one of an estimation error of the absolute positioning position, a position error of the relative positioning trajectory relative to the absolute positioning position, a position error of the relative positioning trajectory relative to the relative positioning trajectory stored in the relative positioning trajectory storage area, an estimation error of the absolute positioning position at a start time of calculation of the relative positioning trajectory, a running state of the moving body estimated from the absolute positioning sensor information and the relative positioning sensor information, a running state of the moving body at a start time of calculation of the relative positioning trajectory, a running environment around the moving body estimated from the absolute positioning sensor and the relative positioning sensor, a running environment of the moving body at a start time of calculation of the relative positioning trajectory, and an elapsed time that has elapsed since a start time of calculation of the relative positioning trajectory.

9. A traveling state estimation unit that estimates a traveling state of the moving object based on the absolute positioning sensor information and the relative positioning sensor information, The position estimation device according to claim 8, further comprising, as an index for calculating the reliability of the relative positioning trajectory, a running state of the moving body estimated by the running state estimation unit and a running state of the moving body at a start time of calculation of the relative positioning trajectory.

10. 10. The position estimation device according to claim 9, wherein the relative positioning trajectory calculation unit satisfies the relative positioning trajectory calculation condition when all of the relative positioning trajectories reliabilities are less than a preset threshold reliability for the relative positioning trajectories stored in the relative positioning trajectory storage area.

11. 8. The position estimation device according to claim 7, wherein the relative positioning trajectory calculation unit determines that the relative positioning trajectory stored in the relative positioning trajectory storage area satisfies the relative positioning trajectory storage condition when at least one of the following is true: the relative positioning trajectory reliability is equal to or greater than a predetermined threshold reliability; the storage amount of the relative positioning trajectory stored in the relative positioning trajectory storage area is less than a predetermined threshold storage amount; or the storage amount of the relative positioning trajectory stored in the relative positioning trajectory storage area is equal to or greater than the threshold storage amount and the relative positioning trajectory reliability is higher than a predetermined set reliability value within a range of the threshold reliability.

12. The position estimation device according to claim 1, characterized in that, when the absolute positioning position satisfies a predetermined relative positioning trajectory calculation condition, the relative positioning trajectory calculation unit calculates a relative positioning trajectory of the moving body based on the absolute positioning position based on the relative positioning sensor information.

13. A position estimation method in which the following steps are executed by a position estimation device that estimates a position of a moving object, calculating an absolute position of the moving object based on absolute positioning sensor information acquired by an absolute positioning sensor; calculating a relative positioning trajectory of the moving body based on the absolute positioning position based on relative positioning sensor information acquired by a relative positioning sensor that detects a change in the relative position of the moving body, and storing the calculated relative positioning trajectory in a relative positioning trajectory storage area; a step of estimating, when the relative positioning trajectory satisfies a predefined relative positioning trajectory selection condition, a latest position of the moving object on the selected relative positioning trajectory as a position of the moving object; a step of repeating a process of storing the latest relative positioning trajectory in the relative positioning trajectory storage area every time the latest relative positioning trajectory satisfies a relative positioning trajectory storage condition based on the relative positioning sensor information, and updating the past relative positioning trajectory stored in the relative positioning trajectory storage area to the latest relative positioning trajectory; A location estimation method comprising:

Citation Information

Patent Citations

  • Hybrid type position measuring instrument

    JP1988108285A

  • On-vehicle navigation device

    JP1991094289A

  • Vehicular navigation device

    JP1994034381A

  • Device for detecting position of travelling object

    JP1996233584A

  • Unmanned running controller

    JP2000284830A

Cited By

  • Artificial neural network-based relative positioning method and device, for recovering lost distance information in environment where fixed node is not present and all nodes are mobile

    WO2026121377A1