ESTIMATING POSITION AND ORIENTATION OF AN UNDERWATER VEHICLE BASED ON CORRELATED SENSOR DATA
First Claim
1. A method of estimating position and orientation (pose) of an underwater vehicle comprising:
- receiving pose data from one source;
receiving pose data from another source, the data from the another source is correlated with the data from the one source;
combining the data from the one source and the another source, the combination resulting in a fused pose estimate;
determining whether to generate a forward prediction of the data received from either the one source or the another source, and generating the forward prediction if needed; and
determining an updated pose of the underwater vehicle based on the fused pose estimate; and
determining when to and updating the one source or the another source based on the fused pose.
1 Assignment
0 Petitions
Accused Products
Abstract
A method and system are described that can be used for combining two sources of position and orientation (pose) information where the information from one source is correlated with the information from the other and the sources produce information at differing rates. For example, the method and system allow for estimating position and orientation (pose) of an underwater vehicle relative to underwater structures by combining pose information computed from a 3D imaging sonar with pose information from a vehicle navigation system. To combine the information from the two sources, a determination is made as to whether to generate a forward prediction of the pose estimate of one of the sources relative to the other, and generating the forward prediction if needed. An updated pose of the underwater vehicle is determined based on the fused pose estimate, and which is used for vehicle guidance and control.
-
Citations
9 Claims
-
1. A method of estimating position and orientation (pose) of an underwater vehicle comprising:
-
receiving pose data from one source; receiving pose data from another source, the data from the another source is correlated with the data from the one source; combining the data from the one source and the another source, the combination resulting in a fused pose estimate; determining whether to generate a forward prediction of the data received from either the one source or the another source, and generating the forward prediction if needed; and determining an updated pose of the underwater vehicle based on the fused pose estimate; and determining when to and updating the one source or the another source based on the fused pose. - View Dependent Claims (2, 3, 4, 5, 6, 7, 8)
-
-
9. A system for estimating the position or pose of an underwater vehicle comprising:
-
a sensor onboard an underwater vehicle, the sensor is configured to direct an acoustic sonar wave toward an underwater structure, the reflected acoustic sonar wave being processed to produce an image sensor-based estimate of pose; a vehicle navigation system onboard the underwater vehicle, the vehicle navigation system is configured to provide an estimate of pose of the underwater vehicle, the image sensor-based pose estimate provided by the sensor is correlated with the estimate provided by the vehicle navigation system; a data storage onboard the underwater vehicle that is configured to receive the image sensor-based pose estimate; and a data processor onboard the underwater vehicle, the data processor is configured to receive both the image sensor-based pose estimate and the estimate from the vehicle navigation system, the processor is configured to combine the image sensor-based pose estimate provided by the sensor and the estimate provided by the vehicle navigation system, the combination resulting in a fused pose estimate, the processor configured to determine whether to generate a forward prediction of the image sensor-based pose estimate, and configured to generate the forward prediction if needed, and the processor configured to determine an updated pose of the underwater vehicle based on the fused pose estimate.
-
Specification