210 likes | 374 Views
Stingray. Underwater Vehicle Navigation Techniques. Chris Barngrover CSE 237D. Unmanned Vehicle Navigation. Most funding goes to UAVs followed by UGVs Lots of UUV applications (e.g. Moorea) GPS is easiest way to know location, but this fails underwater Need to use other techniques.
E N D
Stingray Underwater Vehicle Navigation Techniques Chris Barngrover CSE 237D
Unmanned Vehicle Navigation • Most funding goes to UAVs followed by UGVs • Lots of UUV applications (e.g. Moorea) • GPS is easiest way to know location, but this fails underwater • Need to use other techniques
Navigation Techniques • Dead Reckoning • Inertial Navigation System (INS) • Doppler Velocity Log (DVL) • Acoustic Techniques • Long Baseline (LBL) • Ultra-short Baseline (USBL) • Geophysical (a priori maps) • Computer Vision
Stingray • Microstrain 3DM-GX1 INS • SSI Technologies Pressure Sensor • 2 Remote Ocean System CE-X-18 Underwater Cameras • OpenCV Library
Quarter Goals • Convert pressure sensor data to depth • Develop module that subscribes to INS, depth, and vision data • Develop a Kalman filter to create position estimation • Use vision techniques to rectify position estimation
Midway Accomplishments • Incorporated Planner Module • Developed LPS Module • Researched pressure to depth conversion • Researched Kalman filter techniques
Further Accomplishments • Depth Conversion Function • Basic Kalman Filter • Ground up development – Stalled • OpenCV Libraray - Success
Depth Conversion • SSI Technologies Pressure Sensor • Take depth measurements at
Depth Conversion • Variables: • Average Function: • Mode Function: • Amalgamation:
Kalman Filter • Created a kalman library • init_kalman() • close_kalman() • kalman_update( time, status ) • kalman_get_location( &loc ) • Manages the CvKalman class from OpenCV
Kalman Filter • State Equation: • : state vector • : transition matrix - relates state vectors • : control matrix – relates control to state • : control vector • : noise vector (k represents current time)
Kalman Filter • State Equation:
Kalman Filter • Measurement Equation: • : measurement vector • : relates state to measurement • : state vector • : noise vector (k represents current time)
Kalman Filter • Measurement Equation:
Future Work • Continue Kalman Filter library • Add control elements – • Use angle and rotation angle to fix accelerations • Add velocity sensor for better results • Consider measured covariance matrices • Use vision to rectify location • Incorporate acoustic pinger triangulation • Other related work • Build standard course with dimensions • Develop visual tool