WO2022149383A1 - Dispositif de navigation autonome et procédé de navigation autonome - Google Patents

Dispositif de navigation autonome et procédé de navigation autonome Download PDF

Info

Publication number
WO2022149383A1
WO2022149383A1 PCT/JP2021/044411 JP2021044411W WO2022149383A1 WO 2022149383 A1 WO2022149383 A1 WO 2022149383A1 JP 2021044411 W JP2021044411 W JP 2021044411W WO 2022149383 A1 WO2022149383 A1 WO 2022149383A1
Authority
WO
WIPO (PCT)
Prior art keywords
value
determination
unit
moving body
inertial measurement
Prior art date
Application number
PCT/JP2021/044411
Other languages
English (en)
Japanese (ja)
Inventor
俊 高柳
貴行 築澤
亨宗 白方
Original Assignee
パナソニックＩｐマネジメント株式会社
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by パナソニックＩｐマネジメント株式会社 filed Critical パナソニックＩｐマネジメント株式会社
Publication of WO2022149383A1 publication Critical patent/WO2022149383A1/fr

Links

Images

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/18—Stabilised platforms, e.g. by gyroscope

Definitions

  • This disclosure relates to an autonomous navigation system and an autonomous navigation method.
  • Patent Document 1 discloses a technique for adjusting the number of samples for averaging inertial measurement values as a method for reducing an error in inertial measurement values.
  • an allan variance indicating the magnitude of the error of the inertial measurement value for each number of samples to be averaged is obtained based on the inertial measurement values acquired at a plurality of times during the movement of the moving object. calculate. Then, the number of averaged samples with the smallest error of the inertial measurement value is set based on the calculated Allan variance.
  • the inertial measurement value fluctuates greatly depending on the state of the moving body. Therefore, the accuracy of the allan variance calculated based on the inertial measurement value is lowered, and the average number of samples cannot be set correctly. Therefore, in the prior art, the accuracy of estimating the position and posture of the moving body is lowered.
  • the present disclosure provides an autonomous navigation device and an autonomous navigation method capable of accurately estimating the position and posture of a moving body.
  • the autonomous navigation system is a determination unit that acquires an inertial measurement value of a moving body and determines the motion motion of the moving body based on the inertial measurement value acquired by the measurement unit.
  • the unit includes an estimation unit that estimates the position and posture of the moving body based on the inertial measurement value acquired by the measurement unit and the determination result by the determination unit.
  • the autonomous navigation method includes a step of acquiring an inertial measurement value of a moving body and a step of determining the motion motion of the moving body based on the acquired inertial measurement value. It includes a step of estimating the position and orientation of the moving body based on the inertial measurement value and the result of the determination.
  • the position and posture of the moving body can be estimated with high accuracy.
  • FIG. 1 is a diagram showing a configuration of an autonomous navigation system according to an embodiment.
  • FIG. 2 is a block diagram showing a functional configuration of the autonomous navigation system according to the embodiment.
  • FIG. 3 is a block diagram showing a functional configuration of the position / posture estimation unit according to the embodiment.
  • FIG. 4 is a block diagram showing a functional configuration of the averaging period calculation unit according to the embodiment.
  • FIG. 5 is a flowchart showing the operation of the autonomous navigation system according to the embodiment.
  • FIG. 6A is a diagram showing an example of the movement of the moving body on which the IMU according to the embodiment is mounted.
  • FIG. 6B is a diagram showing an example of inertial measurement data of the moving body that has performed the motion shown in FIG. 6A.
  • FIG. 7 is a flowchart showing the motion determination process (step S20) according to the embodiment.
  • FIG. 8 is a flowchart showing the averaging period calculation process (step S40) according to the embodiment.
  • FIG. 9 is a flowchart showing the dispersion characteristic calculation process (step S42) according to the embodiment.
  • FIG. 10 is a flowchart showing a process of determining the number of averaged samples (step S43) according to the embodiment.
  • FIG. 11 is a diagram showing an example of the dispersion characteristic calculated by the dispersion characteristic calculation unit according to the embodiment.
  • FIG. 12 is a diagram showing the relationship between the motion of the moving body and the average number of samples according to the embodiment.
  • IMU and GNSS are used to determine the position and posture of a moving body.
  • the IMU acquires the inertial measurement value of the moving body.
  • the inertial measurement value includes the acceleration (gravitational acceleration) and the angular velocity acting on the moving body.
  • the posture of the moving body is obtained based on the direction of the vector quantity of the angular velocity or the direction of each vector quantity of the acceleration and the angular velocity. Further, by integrating the accelerations, the speed of the moving body, that is, the distance traveled within a predetermined period is calculated, and the current position of the moving body is obtained by using the direction and the distance.
  • a vehicle speedometer mounted on the moving body may be used to estimate the speed of the moving body.
  • GNSS is an abbreviation for Global Navigation Satellite System.
  • the GNSS can directly obtain the posture and the position based on the positioning information of the GNSS receiver mounted on the moving body.
  • the final position and posture of the moving body can be obtained with high accuracy by combining the positions and postures obtained by these IMUs and GNSS, respectively.
  • the IMU In order to estimate the position and posture of the moving body with high accuracy by the IMU alone, it is necessary to reduce the error of the inertial measurement value. As a method of reducing the error, it is known to average the inertial measurement values.
  • the averaging is to calculate the average value of a plurality of inertial measurement values obtained within a certain period of time. This fixed time is called a time interval or an averaging period, and the position and posture of the moving body are estimated for each averaging period.
  • the magnitude of the error of the inertial measurement value differs depending on the number of inertial measurement values included in the averaging period (that is, the number of averaged samples).
  • the number of averaged samples with the smallest error of the inertial measurement value is set based on the allan dispersion (dispersion characteristic) calculated based on the plurality of inertial measurement values.
  • an object of the present disclosure is to provide an autonomous navigation system or the like capable of accurately estimating the position and posture of a moving body.
  • the autonomous navigation system includes a measuring unit that acquires an inertial measurement value of a moving body, and a motion motion of the moving body based on the inertial measurement value acquired by the measuring unit. It is provided with a determination unit for determining the above, and an estimation unit for estimating the position and posture of the moving body based on the inertial measurement value acquired by the measurement unit and the determination result by the determination unit.
  • the position and posture of the moving body are estimated using the determination result of the motion motion of the moving body, so that the estimation accuracy of the position and the posture can be improved.
  • the measurement unit repeatedly acquires the inertial measurement value of the moving body, the determination unit makes the determination for each inertial measurement value acquired by the measurement unit, and the estimation unit performs the measurement.
  • a plurality of data sets are extracted from a storage unit in which a plurality of data sets of the inertial measurement value acquired by the unit and the determination result corresponding to the inertial measurement value are stored, and based on the extracted plurality of data sets, the said The position and orientation of the moving body may be estimated.
  • the inertial measurement value and the judgment result of the motion motion are stored in association with each other. Therefore, among the obtained multiple inertial measurement values, the inertial measurement value that should not be used for estimating the position and posture of the moving body is selected. , It can be determined based on the determination result. Therefore, since the inertial measurement value that causes the deterioration of the estimation accuracy can be excluded, the estimation accuracy of the position and the posture of the moving body can be improved.
  • the autonomous navigation system may further include the storage unit.
  • the inertial measurement value includes the angular velocity of the moving body
  • the determination unit compares the absolute value of the angular velocity with the first threshold value as the determination, and the absolute value is the first threshold value. If it is smaller, the first determination value is output as the determination result, and if the absolute value is larger than the first threshold value, the second determination value different from the first determination value is output as the determination result.
  • the storage unit may store the output determination result and the angular velocity corresponding to the determination result as the data set in association with each other.
  • the estimation unit includes a dispersion characteristic calculation unit that calculates the dispersion values of a plurality of angular velocities included in a plurality of data sets extracted from the storage unit for each candidate of the averaging period, and the dispersion characteristic calculation unit. Based on the variance value for each candidate of the averaging period calculated by, the inertial measurement value using the averaging period determination unit that determines the averaging period and the averaging period determined by the averaging period determination unit. An average value calculation unit for calculating the average value of the moving body and a position / attitude integration unit for estimating the position and posture of the moving body based on the average value calculated by the average value calculation unit may be included.
  • the averaging period can be calculated accurately and an appropriate number of averaging samples can be set. Therefore, the accuracy of estimating the position and posture of the moving body can be improved.
  • the dispersion characteristic calculation unit does not have to extract the data set including the first determination value and not the data set including the second determination value.
  • the averaging period determination unit performs averaging in which the corresponding variance value is minimized from among a plurality of candidates for the averaging period.
  • An averaging period shorter than the period may be selected.
  • the averaging period determination unit selects an averaging period in which the corresponding variance value is minimized from a plurality of candidates for the averaging period. You may.
  • the estimation accuracy of the position and posture of the moving body can be improved by selecting the averaging period having the smallest dispersion value.
  • the determination unit further compares the absolute value with the second threshold value larger than the first threshold value as the determination, and the absolute value is larger than the first threshold value and the second threshold value is larger than the first threshold value.
  • the second determination value is output as the determination result
  • the absolute value is larger than the second threshold value
  • both the first determination value and the second determination value are output as the determination result.
  • a different third determination value may be output.
  • the averaging period determination unit may select the minimum averaging period from a plurality of candidates for the averaging period when the determination result is the third determination value.
  • the inertial measurement value may include at least one of the acceleration and the velocity of the moving body.
  • the autonomous navigation method includes a step of acquiring an inertial measurement value of a moving body and a step of determining the motion motion of the moving body based on the acquired inertial measurement value. , A step of estimating the position and orientation of the moving body based on the acquired inertial measurement value and the result of the determination.
  • the program according to one aspect of the present disclosure is a program for causing a computer to execute the above-mentioned autonomous navigation method.
  • one aspect of the present disclosure can also be realized as a computer-readable non-temporary recording medium in which the program is stored.
  • the position and posture of the moving body are estimated using the determination result of the motion motion of the moving body, so that the estimation accuracy of the position and the posture can be improved.
  • each figure is a schematic diagram and is not necessarily exactly illustrated. Therefore, for example, the scales and the like do not always match in each figure. Further, in each figure, substantially the same configuration is designated by the same reference numeral, and duplicate description will be omitted or simplified.
  • the numerical range is not an expression expressing only a strict meaning, but an expression meaning that a substantially equivalent range, for example, a difference of about several percent is included.
  • FIG. 1 is a diagram showing an example of the configuration of the autonomous navigation system 100 according to the embodiment.
  • the autonomous navigation device 100 is a device that realizes the operation of the autonomous navigation method according to the present embodiment.
  • the autonomous navigation device 100 performs autonomous navigation of a moving body.
  • the moving object here is mainly assumed to be a vehicle, but a flying object such as an airplane or a drone may be assumed.
  • the autonomous navigation system 100 includes an IMU 101, a processor 102, a memory 103, and a signal line 104.
  • the IMU 101, the processor 102 and the memory 103 are connected to each other via the signal line 104.
  • the IMU101 is mounted on a moving body and measures the inertial measurement value of the moving body.
  • the inertial measurement unit includes the angular velocity of the moving body. Further, the inertial measurement value may include at least one of the acceleration and the velocity of the moving body.
  • the IMU 101 corresponds to the inertial measurement unit 110 shown in FIG. 2, and has a gyro sensor 111 and an acceleration sensor 112.
  • the gyro sensor 111 is an example of an angular velocity sensor that measures the angular velocity of a moving body.
  • the gyro sensor 111 is, for example, a MEMS gyro or a ring laser gyro, but other types of angular velocity meters may be used.
  • MEMS is an abbreviation for Micro Electro Mechanical Systems.
  • the acceleration sensor 112 is an example of an acceleration sensor that measures the acceleration of a moving body.
  • the accelerometer 112 is, for example, a MEMS accelerometer or a servo accelerometer, but other types of accelerometers may be used.
  • the processor 102 is an IC that performs arithmetic processing and controls other hardware. Specifically, the processor 102 is a CPU. IC is an abbreviation for Integrated Circuit. CPU is an abbreviation for Central Processing Unit. The processor 102 has a motion determination unit 120 and a position / posture estimation unit 140 shown in FIG. These processing units are realized as software, for example.
  • the memory 103 is a storage device corresponding to the storage unit 130 shown in FIG. 2, and is a ROM, a RAM, a cache memory, an HDD, or the like.
  • ROM is an abbreviation for Read Only Memory.
  • RAM is an abbreviation for Random Access Memory.
  • HDD is an abbreviation for Hard Disk Drive.
  • the memory 103 stores a navigation program for executing the processing of the motion determination unit 120 and the position / attitude estimation unit 140.
  • the navigation program is loaded into memory 103 and executed by processor 102.
  • the OS is further stored in the memory 103.
  • OS is an abbreviation for Operating System. At least a portion of the OS is loaded into memory 103 and executed by processor 102.
  • the processor 102 executes the navigation program while executing the OS.
  • the input / output data of the navigation program is stored in the memory 103.
  • FIG. 2 is a block diagram showing a functional configuration of the autonomous navigation system 100 according to the embodiment.
  • the autonomous navigation device 100 includes an inertial measurement unit 110, a motion determination unit 120, a storage unit 130, and a position / attitude estimation unit 140.
  • These functional components are realized, for example, by, but not limited to, the IMU 101, the memory 103, and the processor 102, as shown in FIG.
  • the functional components of the autonomous navigation system 100 are realized by any combination of hardware and software.
  • the inertial measurement unit 110 acquires the inertial measurement value of the moving body.
  • the inertial measurement unit 110 repeatedly acquires the acceleration and the angular velocity at regular time intervals. This time interval is called the sampling cycle of the inertial measurement unit 110.
  • the inertial measurement unit 110 is realized by the IMU 101 that measures acceleration and angular velocity, but is not limited thereto.
  • the inertial measurement unit 110 may be realized by at least one of a vehicle speedometer, a directional sensor, and a geomagnetic sensor, and may detect acceleration and angular velocity using the obtained sensor values.
  • the motion determination unit 120 determines the motion motion of the moving body based on the inertial measurement value acquired by the inertial measurement unit 110. Specifically, the motion determination unit 120 makes a determination for each inertial measurement value acquired by the inertial measurement unit 110. That is, the motion determination unit 120 determines the motion motion of the moving body corresponding to the time when the inertial measurement value is acquired.
  • the motion motion includes "straight ahead”, “curve (curve motion)", and "stop”. "Curve” includes “curve (sudden)” and “curve (slow)”. The specific processing method performed by the motion determination unit 120 will be described later.
  • the storage unit 130 stores a plurality of data sets of the inertial measurement value acquired by the inertial measurement unit 110 and the determination result corresponding to the inertial measurement value. That is, the storage unit 130 stores a set of the inertial measurement data output at each time and the motion determination value as a data set.
  • the inertial measurement data includes the angular velocity and acceleration acquired at a predetermined time by the inertial measurement unit 110.
  • the motion determination value is a determination result by the motion determination unit 120, and is information indicating the motion motion of the moving body at the time when the corresponding inertial measurement value is acquired.
  • Each of the plurality of data sets may be associated with the time when the inertial measurement value is acquired. For example, a plurality of data sets are stored as time series data. A plurality of data sets stored in the storage unit 130 are referred to as historical data.
  • the position / posture estimation unit 140 estimates the position and posture of the moving body based on the inertial measurement value acquired by the inertial measurement unit 110 and the determination result by the motion determination unit 120. Specifically, the position / posture estimation unit 140 extracts historical data from the storage unit 130, and estimates the position and posture of the moving body based on the extracted historical data. At this time, the position / posture estimation unit 140 changes the extraction target of the history data based on the determination result. Specifically, the position / orientation estimation unit 140 excludes the inertial measurement value data associated with the determination condition satisfying a predetermined condition from the extraction target. Further, the position / posture estimation unit 140 determines the averaging period based on the motion determination value. This makes it possible to estimate the position and posture of the moving body with high accuracy.
  • FIG. 3 is a block diagram showing a functional configuration of the position / orientation estimation unit 140 according to the embodiment.
  • the position / attitude estimation unit 140 includes an averaging period calculation unit 141, an average value calculation unit 142, and a position / attitude integration unit 143.
  • the averaging period calculation unit 141 determines the inertial measurement value appropriate for estimating the position and posture of the moving body based on the motion determination value output from the motion determination unit 120 and the historical data extracted from the storage unit 130. Calculate the averaging period. Further, the averaging period calculation unit 141 calculates the number of averaging samples based on the calculated averaging period.
  • the averaging period is a period for averaging a plurality of inertial measurement values (specifically, angular velocities) obtained at equal time intervals.
  • the calculation of the averaging period is substantially synonymous with the calculation of the number of inertial measurement units to be averaged, that is, the number of averaging samples.
  • FIG. 4 is a block diagram showing a functional configuration of the averaging period calculation unit 141 according to the embodiment.
  • the averaging period calculation unit 141 includes a variance characteristic calculation unit 141a and an averaging period determination unit 141b.
  • the dispersion characteristic calculation unit 141a calculates the dispersion values of a plurality of angular velocities included in the plurality of data sets extracted from the storage unit 130 for each candidate of the averaging period.
  • the relationship between a plurality of candidates for the averaging period (hereinafter, may be referred to as a candidate averaging period) and the dispersion value corresponding to the candidate is referred to as a variance characteristic. That is, the dispersion characteristic calculation unit 141a calculates the dispersion characteristic of the angular velocity obtained by the measurement.
  • the averaging period determination unit 141b determines the averaging period based on the variance value for each candidate of the averaging period calculated by the variance characteristic calculation unit 141a. That is, the averaging period determination unit 141b determines the averaging period (the number of averaging samples) based on the dispersion characteristics. Further, in the present embodiment, the averaging period determination unit 141b further determines the averaging period based on the exercise determination value. Details will be described later.
  • the average value calculation unit 142 outputs the average value of the inertial measurement values based on the historical data output from the storage unit 130 and the average number of samples output from the average period calculation unit 141. do. Specifically, the mean value calculation unit 142 calculates the average value of the inertial measurement values for each averaging period calculated by the averaging period calculation unit 141. More specifically, the average value calculation unit 142 calculates the average value of the angular velocity data for the number of the most recent averaged samples among the angular velocity data stored in the storage unit 130, and outputs the calculated average value. .. As the historical data used by the average value calculation unit 142, the extraction target is not changed depending on the determination result of the motion motion, and the data of all the inertial measurement values are sequentially used.
  • the position / attitude integration unit 143 estimates the position and attitude of the moving body based on the average value of the inertial measurement values calculated by the average value calculation unit 142.
  • the position and attitude may be estimated using various sensor fusion methods such as an extended Kalman filter.
  • FIG. 5 is a flowchart showing the operation of the autonomous navigation system 100 according to the present embodiment.
  • step S10 the inertial measurement unit 110 acquires and outputs the inertial measurement value of the moving body.
  • step S20 the motion determination unit 120 determines the motion motion of the moving body based on the inertial measurement value output from the inertial measurement unit 110.
  • the motion determination unit 120 outputs an exercise determination value indicating a determination result of the exercise motion. The specific operation of step S20 will be described later.
  • step S30 the storage unit 130 stores a data set of the inertial measurement value output from the inertial measurement unit 110 and the motion determination value output from the motion determination unit 120. Each time an inertial measurement value is obtained, the storage unit 130 stores a data set.
  • the time-series data of the data set of the stored inertial measurement value and the motion judgment value is the historical data.
  • step S40 the averaging period calculation unit 141 calculates the averaging period based on the exercise determination value output from the exercise determination unit 120 and the history data extracted from the storage unit 130. Specifically, the averaging period calculation unit 141 calculates the number of averaging samples. The specific operation of step S40 will be described later.
  • the mean value calculation unit 142 averages the inertial measurement values included in the historical data based on the number of averaged samples calculated by the average period calculation unit 141. Specifically, the average value calculation unit 142 averages the inertial measurement values for the number of the latest averaged samples in the historical data, and outputs the inertial measurement average value.
  • the position / attitude integrating unit 143 estimates the attitude and position of the moving body by integrating the inertial measurement average values. Specifically, the position / attitude integrating unit 143 integrates the inertial measurement average value based on the position and attitude estimated immediately before, and estimates the current position and attitude. For example, the position / attitude integrating unit 143 calculates the moving distance and the moving direction of the moving body based on the inertial measurement average value. The position / posture integrating unit 143 estimates the current position and posture by adding the calculated movement distance and movement direction to the position and posture estimated immediately before.
  • step S20 [3-1. Exercise determination process (step S20)] Next, a specific example of the motion determination process (step S20) will be described with reference to FIGS. 6A, 6B, and 7.
  • FIG. 6A is a diagram showing an example of the movement of the moving body 10 on which the IMU 101 according to the embodiment is mounted.
  • FIG. 6B is a diagram showing an example of inertial measurement data of the moving body 10 that has performed the motion shown in FIG. 6A.
  • the absolute value of the angular velocity when the moving body 10 is traveling on a curve is larger than that when traveling in a straight line. Therefore, it is possible to determine whether the motion of the moving body is a "straight line” motion or a "curve” motion based on the angular velocity of the moving body 10. Specifically, it is possible to determine the motion motion of the moving body based on the comparison result between the absolute value of the angular velocity and the threshold value of 1 or more.
  • FIG. 7 is a flowchart showing the motion determination process (step S20) in the present embodiment.
  • step S21 the motion determination unit 120 determines the motion motion of the moving body based on the acceleration output from the inertial measurement unit 110. Specifically, the motion determination unit 120 compares the acceleration with the threshold value X. If the acceleration is within the threshold value X (Yes in step S21), the process proceeds to step S22, and the motion determination unit 120 determines that the motion of the moving body is in the stopped state, and the motion indicating "stop" as the determination result. Output the judgment value. When the acceleration is larger than the threshold value X (No in step S21), the process proceeds to step S23. Since step S21 is a step of determining whether or not the moving body is "stopped", the determination may be made using other information such as a vehicle speedometer.
  • step S23 the motion determination unit 120 determines the motion motion of the moving body based on the angular velocity output from the inertial measurement unit 110. Specifically, the motion determination unit 120 compares the absolute value of the angular velocity with the threshold value Y.
  • the threshold value Y is an example of the first threshold value.
  • the process proceeds to step S24, and the motion determination unit 120 outputs a motion determination value indicating "straight ahead" as a determination result.
  • the motion determination value representing "straight ahead” is an example of the first determination value.
  • the process proceeds to step S25.
  • step S25 the motion determination unit 120 compares the absolute value of the angular velocity output from the inertial measurement unit 110 with the threshold value Z.
  • the threshold value Z is an example of the second threshold value, and is a value larger than the threshold value Y.
  • the process proceeds to step S26, and the motion determination unit 120 outputs a motion determination value representing "curve (slow)" as the determination result.
  • the motion determination value representing "curve (slow)" is an example of the second determination value.
  • step S25 When the absolute value of the angular velocity is larger than the threshold value Z (No in step S25), the process proceeds to step S27, and the motion determination unit 120 outputs a motion determination value representing "curve (steep)" as the determination result.
  • the motion determination value representing "curve (sudden)" is an example of the third determination value.
  • the motion determination unit 120 has 4 of "stop”, “straight ahead”, “curve (slow)” and “curve (sudden)” as the determination result of the motion motion of the moving body. Outputs one of the two judgment values.
  • the four determination values are labeled with a label such as “curve (loose)” for convenience, but the present invention is not limited to this.
  • the absolute value of acceleration or angular velocity may be larger than the threshold value even when strong vibration is applied to the moving body.
  • the determination value of the motion motion may be expressed by the magnitude and the magnitude of the vibration.
  • steps S23 and S25 are steps for determining whether the moving body is "straight ahead” or “curve movement", and the strength of the curve. Therefore, instead of the angular velocity, the steering of the moving body or the like may be detected to make these determinations.
  • step S40 Average period calculation process
  • FIG. 8 is a flowchart showing the averaging period calculation process (step S40) according to the present embodiment.
  • step S41 the dispersion characteristic calculation unit 141a determines the motion representing "curve (sudden)" or “curve (slow)" among the historical data stored in the storage unit 130. Exclude datasets containing values from extraction. That is, the dispersion characteristic calculation unit 141a extracts a data set including a motion determination value representing "stop" or "straight ahead". In other words, the angular velocity data whose absolute value of the angular velocity is smaller than the threshold value Y is the target of extraction.
  • step S42 the dispersion characteristic calculation unit 141a calculates the dispersion characteristics using the extracted plurality of data sets.
  • the averaging period determination unit 141b calculates the number of averaging samples based on the variance characteristics calculated by the variance characteristic calculation unit 141a.
  • FIG. 9 is a flowchart showing a dispersion characteristic calculation process (step S42) according to the present embodiment.
  • the dispersion characteristic calculation unit 141a selects an unselected averaging period from a plurality of candidate averaging periods.
  • the candidate averaging period is a candidate for a period during which the inertial measurement value is averaged. For example, it is a set of about 10 to 100 pieces obtained by multiplying the sampling period of the inertial measurement unit 110 by a constant.
  • step S422 the variance characteristic calculation unit 141a calculates the variance ⁇ 2 ( ⁇ ) corresponding to the candidate averaging period ⁇ selected in step S421 based on (Equation 1) to (Equation 3).
  • ⁇ T is the sampling period of the IMU 101.
  • m is the number of averaged samples.
  • x i represents an inertial measurement value (specifically, an angular velocity) of the i-sample eye other than “curve (sudden)” and “curve (slow)".
  • the motion determination value is calculated based on historical data other than “curve (sudden)" and “curve (slow)" in the calculation of the dispersion characteristic. That is, since the dispersion characteristic is calculated excluding the angular velocity having a large absolute value, the dispersion characteristic of the inertial measurement unit 110 can be estimated with high accuracy.
  • the criteria for determining the historical data used for calculating the dispersion characteristics may follow other criteria.
  • the motion determination unit 120 detects the vibration state of running, and the history data determined to be "high vibration" is not used for the calculation of the dispersion characteristic.
  • step S423 the variance characteristic calculation unit 141a selects an unselected candidate averaging period (that is, a candidate averaging period for which the corresponding variance value has not been calculated) among the plurality of candidate averaging periods in step S421. Determines if is present. If there is an unselected candidate averaging period (Yes in step S423), the process proceeds to step S421, and the selection of the candidate averaging period and the calculation of the corresponding variance value are repeated. If there is no unselected candidate averaging period (No in step S423), that is, if the variance values for all the candidate averaging periods are calculated, the variance characteristic calculation unit 141a may use the plurality of candidate averaging periods. The set with the corresponding variance value is output as a variance characteristic (for example, information corresponding to the graph shown in FIG. 11).
  • a variance characteristic for example, information corresponding to the graph shown in FIG. 11
  • step S43 Calculation process of averaged sample size
  • FIG. 10 is a flowchart showing a process of determining the number of averaged samples (step S43) according to the present embodiment.
  • FIG. 11 is a diagram showing an example of the dispersion characteristic calculated by the dispersion characteristic calculation unit 141a according to the present embodiment.
  • step S431 when the motion determination value output by the motion determination unit 120 represents a “curve (steep)” (Yes in step S431), the process transitions to step S432.
  • step S432 the averaging period determination unit 141b selects the minimum (shortest) averaging period from the plurality of candidate averaging periods. In the example shown in FIG. 11, the smallest averaging period 31 is selected from the candidate averaging periods corresponding to the 13 black circles.
  • step S433 when the motion determination value represents a “curve (slow)” (Yes in step S433), the process transitions to step S434.
  • step S434 the averaging period determination unit 141b selects an averaging period shorter than the averaging period in which the estimated variance value is minimized among the plurality of candidate averaging periods.
  • the averaging period 33 is the averaging period in which the corresponding variance value is minimized. Therefore, in step S434, the averaging period determination unit 141b selects an averaging period shorter than the averaging period 33.
  • the averaging period 32 is selected, but is not limited to this.
  • the minimum averaging period 31 may be selected. In this case, since it is the same as step S432, the determination in step S431 may not be performed.
  • the averaging period selected in steps S432 and S434 may be selected by a different method.
  • the motion determination unit 120 determines the curvature of the curve of the motion of the moving body, and sets the averaging period in inverse proportion to the magnitude of the curvature.
  • step S435 the averaging period determination unit 141b has the variance value among the variance characteristics calculated by the dispersion characteristic calculation unit 141a. Select the minimum averaging period. In the example shown in FIG. 11, the averaging period 33 is selected.
  • the averaging period selected in step S435 may become an unnecessarily long value, so it is possible to set an upper limit value for the averaging period.
  • the averaging period determination unit 141b selects the averaging period in which the variance value is the minimum within the range of the upper limit value or less.
  • the averaging period determination unit 141b determines the selected averaging period ⁇ as represented by the above-mentioned (Equation 1).
  • the value divided by the sampling period ⁇ T of the IMU 101 is output as the average number of samples m.
  • FIG. 12 is a diagram showing the relationship between the motion of the moving body and the average number of samples according to the present embodiment.
  • FIG. 12A shows the estimated position of the moving body by autonomous navigation when the average number of samples is small during linear motion or stoppage.
  • the white circles indicate the estimated positions at each time. Further, the broken line represents the actual movement locus of the moving body. It should be noted that these illustrated methods are the same for (b) to (d).
  • the number of averaged samples is small refers to a period larger and shorter than the average period 33 selected in step S435, for example, a value near the average period 31 selected in step S432.
  • (B) represents the estimated position of the moving body by autonomous navigation when a large number of averaged samples is taken during linear motion and stoppage.
  • the number of averaged samples is large refers to a value near the average period 33 selected in step S435.
  • the dispersion of the inertial measurement value of the inertial measurement unit 110 becomes smaller by lengthening the averaging period, that is, by taking a large number of averaging samples. This makes it possible to reduce the estimation error in autonomous navigation. Further, at this time, the dispersion characteristic used for determining the averaging period is calculated based on the data excluding the data having a large inertial measurement value as described above. Therefore, since the accuracy of the dispersion characteristics is high, the averaging period and the number of averaging samples can be appropriately selected. Therefore, the position and posture of the moving body can be estimated more accurately.
  • FIG. 12 shows the estimated position of the moving body by autonomous navigation when the average number of samples is taken small during the curve motion.
  • FIG. 12D shows the estimated position of the moving body by autonomous navigation when a large number of averaged samples are taken during the curve motion.
  • averaging sample numbers are selected based on the determination result of the motion determination unit 120. This makes it possible to set an appropriate number of averaged samples according to the motion motion of the moving body, so that the estimation accuracy of the position and posture of the moving body can be improved.
  • the autonomous navigation system 100 includes the storage unit 130, but the autonomous navigation system 100 does not have to include the storage unit 130 (memory 103).
  • the storage unit 130 may be provided in an external device (for example, a server device) different from the autonomous navigation system 100.
  • the autonomous navigation device 100 can communicate with an external device including a storage unit 130 by wire or wirelessly, and may transmit inertial measurement values and motion determination values, and may receive historical data.
  • step S21 the speed and the threshold value may be compared.
  • the motion determination unit 120 may output an exercise determination value indicating "stop" as the determination result. If the speed is greater than the threshold (No in step S21), step S23 may be executed.
  • step S21 may be omitted. That is, the motion determination unit 120 does not have to compare the acceleration with the threshold value X, and the determination result may not include "stop".
  • step S25 may be omitted. That is, the motion determination unit 120 does not have to compare the absolute value of the angular velocity with the threshold value Z. That is, the motion determination unit 120 does not have to discriminate between a gentle curve and a sharp curve. In this case, when the absolute value of the angular velocity is equal to or greater than the threshold value Y (No in step S23), the motion determination unit 120 outputs a motion determination value indicating a “curve” as the determination result.
  • step S431 it is determined whether or not the motion determination value is a “curve”, and step S434 is performed. It may be omitted. In this case, if the motion determination value is not a "curve” (No in step S431), any of steps S434 and S435 may be executed.
  • the curve may be divided into three or more stages. In this case, the steeper the curve, the shorter the averaging period is set.
  • the communication method between the devices described in the above embodiment is not particularly limited.
  • the wireless communication method is, for example, short-range wireless communication such as ZigBee (registered trademark), Bluetooth (registered trademark), or wireless LAN (Local Area Network).
  • the wireless communication method may be communication via a wide area communication network such as the Internet.
  • wired communication may be performed between the devices instead of wireless communication.
  • the wired communication is a power line carrier communication (PLC: Power Line Communication) or a communication using a wired LAN.
  • PLC Power Line Communication
  • another processing unit may execute the processing executed by the specific processing unit. Further, the order of the plurality of processes may be changed, or the plurality of processes may be executed in parallel. For example, the components of one device may be included in another device.
  • the processing described in the above embodiment may be realized by centralized processing using a single device (system), or may be realized by distributed processing using a plurality of devices. good.
  • the number of processors that execute the above program may be singular or plural. That is, centralized processing may be performed, or distributed processing may be performed.
  • all or a part of the components such as the control unit may be configured by dedicated hardware, or may be realized by executing a software program suitable for each component. May be good.
  • Each component may be realized by a program execution unit such as a CPU or a processor reading and executing a software program recorded on a recording medium such as an HDD or a semiconductor memory.
  • a component such as a control unit may be composed of one or a plurality of electronic circuits.
  • the one or more electronic circuits may be general-purpose circuits or dedicated circuits, respectively.
  • One or more electronic circuits may include, for example, a semiconductor device, an IC, an LSI, or the like.
  • the IC or LSI may be integrated on one chip or may be integrated on a plurality of chips.
  • IC or LSI it is called IC or LSI, but the name changes depending on the degree of integration, and it may be called system LSI, VLSI or ULSI.
  • FPGAs programmed after the LSI are manufactured can be used for the same purpose.
  • LSI is an abbreviation for Large Scale Integration.
  • VLSI and ULSI are abbreviations for Very Large Scale Integration and Ultra Large Scale Integration, respectively.
  • FPGA is an abbreviation for Field Programmable Gate Array.
  • the general or specific aspects of the present disclosure may be realized by a system, an apparatus, a method, an integrated circuit or a computer program.
  • a computer-readable non-temporary recording medium such as an optical disk, HDD or semiconductor memory in which the computer program is stored.
  • it may be realized by any combination of a system, an apparatus, a method, an integrated circuit, a computer program and a recording medium.
  • the present disclosure can be used as an autonomous navigation device capable of accurately estimating the position and posture of a moving body, and can be used, for example, for automatic driving of a moving body.

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Navigation (AREA)

Abstract

Le présent dispositif de navigation autonome (100) comprend : une unité de mesure inertielle (110) qui acquiert une valeur de mesure inertielle d'un corps mobile ; une unité d'évaluation de mouvement (120) qui, en fonction de la valeur de mesure inertielle acquise par l'unité de mesure inertielle (110), évalue une action de mouvement du corps mobile ; et une unité d'estimation de position/orientation (140) qui, en fonction de la valeur de mesure inertielle acquise par l'unité de mesure inertielle (110) et du résultat d'évaluation par l'unité d'évaluation de mouvement (120), estime la position et l'orientation du corps mobile.
PCT/JP2021/044411 2021-01-07 2021-12-03 Dispositif de navigation autonome et procédé de navigation autonome WO2022149383A1 (fr)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2021-001748 2021-01-07
JP2021001748 2021-01-07

Publications (1)

Publication Number Publication Date
WO2022149383A1 true WO2022149383A1 (fr) 2022-07-14

Family

ID=82357659

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2021/044411 WO2022149383A1 (fr) 2021-01-07 2021-12-03 Dispositif de navigation autonome et procédé de navigation autonome

Country Status (1)

Country Link
WO (1) WO2022149383A1 (fr)

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2016057205A (ja) * 2014-09-10 2016-04-21 富士通株式会社 電子機器および角速度情報出力プログラム
JP2016057196A (ja) * 2014-09-10 2016-04-21 富士通株式会社 電子機器および角速度検出値補正プログラム
WO2020008878A1 (fr) * 2018-07-02 2020-01-09 ソニー株式会社 Dispositif de positionnement, procédé de positionnement et programme

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2016057205A (ja) * 2014-09-10 2016-04-21 富士通株式会社 電子機器および角速度情報出力プログラム
JP2016057196A (ja) * 2014-09-10 2016-04-21 富士通株式会社 電子機器および角速度検出値補正プログラム
WO2020008878A1 (fr) * 2018-07-02 2020-01-09 ソニー株式会社 Dispositif de positionnement, procédé de positionnement et programme

Similar Documents

Publication Publication Date Title
Collin et al. Inertial sensors and their applications
JP7287997B2 (ja) 位置決め方法、位置決め装置、電子機器、車端機器、自動運転車、コンピュータ可読記憶媒体及びコンピュータプログラム
KR101422374B1 (ko) 관성 측정 유닛（ｉｍｕ）에 대한 공간 정렬 결정
KR102340630B1 (ko) 항법 시스템
CN113108791B (zh) 一种导航定位方法及导航定位设备
US20160097861A1 (en) Method and apparatus for location determination
JP2008076389A (ja) ナビゲーション・システムおよびナビゲーション方法
CN106153069B (zh) 自主导航系统中的姿态修正装置和方法
KR20180052075A (ko) 항법 시스템
EP2372394A1 (fr) Terminal mobile portable et support lisible sur ordinateur
JP5974171B2 (ja) オフセット推定装置、方法、およびプログラム
US10197396B2 (en) Always on compass calibration system and methods
US20160179190A1 (en) Method and apparatus for estimating position of pedestrian walking on locomotion interface device
JP2016057836A (ja) 移動体分析システムおよび移動体の方向軸推定方法
RU2018107795A (ru) Система определения курса и углового пространственного положения, выполненная с возможностью функционирования в полярной области
Wang et al. Scenario-dependent ZUPT-aided pedestrian inertial navigation with sensor fusion
KR101096113B1 (ko) 신뢰도가 향상된 항법 시스템 및 그 제공방법
JP5879977B2 (ja) 速度推定装置及びプログラム
KR101226767B1 (ko) 주행 장치를 위한 위치측정 시스템 및 방법
US20160245924A1 (en) Electronic device and control method
CN106441295B (zh) 步行者行进方向确定方法及装置
WO2022149383A1 (fr) Dispositif de navigation autonome et procédé de navigation autonome
WO2011093447A1 (fr) Dispositif de calcul, procédé de commande pour le dispositif de calcul, programme de commande et support d'enregistrement
JP2016206017A (ja) 電子機器、及び移動速度算出プログラム
Emami et al. A customized H-infinity algorithm for underwater navigation system: With experimental evaluation

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 21917604

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 21917604

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: JP