State estimation device and state estimation method
AssigneesDenso Corporation, Toyota Jidosha Kabushiki Kaisha, MIRISE Technologies Corporation
InventorsNOBUAKI MATSUDAIRA, HUI XU
Life of this patent
Estimating the term…
Abstract
By a state estimation device or a state estimation method, image data is read, a feature point included in the image data is extracted, the feature point is tracked, a position, a velocity, or an attitude of a mobile object is calculated based on inertia data, a bias error of an inertial measurement unit is calculated, correction data is calculated by removing the bias error from the inertia data, and a state including at least one of the position, the velocity, or the attitude of the mobile object is estimated based on the correction data.
Claims12
A state estimation device for estimating a state including at least one of a position, a velocity, or an attitude of a mobile object, the device comprising:
- an input unit configured to read image data output by a capture unit configured to capture an image of a peripheral area of the mobile object and inertia data of the mobile object, the inertia data being output from an inertial measurement unit installed on the mobile object;
- a preprocessing unit configured to
- extract a feature point included in the image data,
- track the feature point, and
- calculate the position, the velocity, or the attitude of the mobile object based on the inertia data;
- a calculation unit configured to calculate a bias error of the inertial measurement unit by performing bundle adjustment on the feature point of the image data, the position, the velocity, or the attitude of the mobile object based on the inertia data;
- a correction unit configured to calculate correction data by removing the bias error from the inertia data;
- and
- an estimation unit configured to estimate a state including at least one of the position, the velocity, or the attitude of the mobile object based on the correction data.
A state estimation method for estimating a state including at least one of a position, a velocity, or an attitude of a mobile object, the method comprising:
- reading image data output by a capture unit configured to capture an image of a peripheral area of the mobile object and inertia data of the mobile object, the inertia data being output from an inertial measurement unit installed on the mobile object;
- extracting a feature point included in the image data;
- tracking the feature point;
- calculating the position, the velocity, or the attitude of the mobile object based on the inertia data;
- calculating a bias error of the inertial measurement unit by performing bundle adjustment on the feature point of the image data and the position, the velocity, and the attitude of the mobile object based on the inertia data;
- calculating correction data by removing the bias error from the inertia data;
- and
- estimating a state including at least one of the position, the velocity, or the attitude of the mobile object based on the correction data.
Dependencies are inferred from the claim text.