Fault Tolerant ROV Navigation System based on Particle Filter using Hydro-acoustic Position and...
-
Upload
jobermaxim -
Category
Documents
-
view
351 -
download
2
Transcript of Fault Tolerant ROV Navigation System based on Particle Filter using Hydro-acoustic Position and...
![Page 1: Fault Tolerant ROV Navigation System based on Particle Filter using Hydro-acoustic Position and Doppler Velocity Measurements](https://reader038.fdocuments.in/reader038/viewer/2022110309/5585e8add8b42a48148b4775/html5/thumbnails/1.jpg)
Fault Tolerant ROV Navigation Systembased on Particle Filter
using Hydro-acoustic Position and Doppler Velocity Measurements
![Page 2: Fault Tolerant ROV Navigation System based on Particle Filter using Hydro-acoustic Position and Doppler Velocity Measurements](https://reader038.fdocuments.in/reader038/viewer/2022110309/5585e8add8b42a48148b4775/html5/thumbnails/2.jpg)
Bo Zhao, Ph.D. candidate in CeSOS, NTNUResearch topic: Fault tolerant control for DP
?-2009 M.Eng. in Navigation, Guidance and Control (for aircrafts)
Nov. 2009 Start my Ph.D.
Spring, 2010 Courses, preliminary research
Fall, 2010 Courses, preliminary research
Spring, 2011 Courses in DTU, Denmark. Hooked up with the particle filter
Fall, 2011 Course, research, and papers
Spring, 2012 Research, papers, go to conferences, prepare for experiment
Fall, 2012 Research, papers, go to conferences, do experiment
![Page 3: Fault Tolerant ROV Navigation System based on Particle Filter using Hydro-acoustic Position and Doppler Velocity Measurements](https://reader038.fdocuments.in/reader038/viewer/2022110309/5585e8add8b42a48148b4775/html5/thumbnails/3.jpg)
1. Introduction2. System modeling
3. Fault analysis and modeling
4. Particle filter for fault detection
5. Results
1. Introduction
![Page 4: Fault Tolerant ROV Navigation System based on Particle Filter using Hydro-acoustic Position and Doppler Velocity Measurements](https://reader038.fdocuments.in/reader038/viewer/2022110309/5585e8add8b42a48148b4775/html5/thumbnails/4.jpg)
x
y
z
![Page 5: Fault Tolerant ROV Navigation System based on Particle Filter using Hydro-acoustic Position and Doppler Velocity Measurements](https://reader038.fdocuments.in/reader038/viewer/2022110309/5585e8add8b42a48148b4775/html5/thumbnails/5.jpg)
Length: 144 cm
Width: 82 cm
Height: 80 cm
Net weight: 405 kgPayload: 20 kg
BASIC PARAMETERS x
y
z
![Page 6: Fault Tolerant ROV Navigation System based on Particle Filter using Hydro-acoustic Position and Doppler Velocity Measurements](https://reader038.fdocuments.in/reader038/viewer/2022110309/5585e8add8b42a48148b4775/html5/thumbnails/6.jpg)
Tunnel thruster
2×Main thrusters
2×Vertical thrusters
PROPULSION SYSTEM
Horizontal: 2.0 knot
Vertical: 1.2 knot
Lateral: 1.3 knot
Yaw rate: 60°/s
x
y
z
![Page 7: Fault Tolerant ROV Navigation System based on Particle Filter using Hydro-acoustic Position and Doppler Velocity Measurements](https://reader038.fdocuments.in/reader038/viewer/2022110309/5585e8add8b42a48148b4775/html5/thumbnails/7.jpg)
Camera
Manipulators
Lights
ACCESSORIES x
y
z
![Page 8: Fault Tolerant ROV Navigation System based on Particle Filter using Hydro-acoustic Position and Doppler Velocity Measurements](https://reader038.fdocuments.in/reader038/viewer/2022110309/5585e8add8b42a48148b4775/html5/thumbnails/8.jpg)
DVL (Dopple Velocity Log)depth sensor
HPR (Hydroacoustic position reference)
SENSOR SYSTEM compass
Yaw rate gyro
x
y
z
![Page 9: Fault Tolerant ROV Navigation System based on Particle Filter using Hydro-acoustic Position and Doppler Velocity Measurements](https://reader038.fdocuments.in/reader038/viewer/2022110309/5585e8add8b42a48148b4775/html5/thumbnails/9.jpg)
HPR – Hydro acoustic position reference
Faults: 1. Dropout – when no signal received2. Outlier – Measurement has
significant difference from the true position
![Page 10: Fault Tolerant ROV Navigation System based on Particle Filter using Hydro-acoustic Position and Doppler Velocity Measurements](https://reader038.fdocuments.in/reader038/viewer/2022110309/5585e8add8b42a48148b4775/html5/thumbnails/10.jpg)
DVL – Doppler velocity log
Faults: 1. Dropout – when no signal received2. Bias – small-size constant difference
between the measurement and the true velocity
![Page 11: Fault Tolerant ROV Navigation System based on Particle Filter using Hydro-acoustic Position and Doppler Velocity Measurements](https://reader038.fdocuments.in/reader038/viewer/2022110309/5585e8add8b42a48148b4775/html5/thumbnails/11.jpg)
Navigation: Obtain the position and velocity of the ROV
Disturbance and noise1. System noise2. Model uncertainty3. Measurement noise4. Current 5. Failures
![Page 12: Fault Tolerant ROV Navigation System based on Particle Filter using Hydro-acoustic Position and Doppler Velocity Measurements](https://reader038.fdocuments.in/reader038/viewer/2022110309/5585e8add8b42a48148b4775/html5/thumbnails/12.jpg)
Failure modes1. HPR dropout2. HPR outlier3. DVL dropout4. DVL bias5. Thruster loss
Navigation: Obtain the position and velocity of the ROV
Disturbance and noise1. System noise2. Model uncertainty3. Measurement noise4. Current 5. Failures
![Page 13: Fault Tolerant ROV Navigation System based on Particle Filter using Hydro-acoustic Position and Doppler Velocity Measurements](https://reader038.fdocuments.in/reader038/viewer/2022110309/5585e8add8b42a48148b4775/html5/thumbnails/13.jpg)
2. System modeling
3. Fault analysis and modeling
4. Particle filter for fault detection
5. Results
1. Introduction
![Page 14: Fault Tolerant ROV Navigation System based on Particle Filter using Hydro-acoustic Position and Doppler Velocity Measurements](https://reader038.fdocuments.in/reader038/viewer/2022110309/5585e8add8b42a48148b4775/html5/thumbnails/14.jpg)
Kinematics:
Kinetics:
Current:
DVL:
HPR:
![Page 15: Fault Tolerant ROV Navigation System based on Particle Filter using Hydro-acoustic Position and Doppler Velocity Measurements](https://reader038.fdocuments.in/reader038/viewer/2022110309/5585e8add8b42a48148b4775/html5/thumbnails/15.jpg)
Pictures from http://www.gris.uni-tuebingen.de/people/staff/sfleck/smartsurv3d/http://perception.inrialpes.fr/~chari/myweb/Research/http://wires.wiley.com/WileyCDA/WiresArticle/articles.html?doi=10.1002%2Fwics.1210
Particle filter
Observer for ROV :
![Page 16: Fault Tolerant ROV Navigation System based on Particle Filter using Hydro-acoustic Position and Doppler Velocity Measurements](https://reader038.fdocuments.in/reader038/viewer/2022110309/5585e8add8b42a48148b4775/html5/thumbnails/16.jpg)
3. Fault analysis and modeling
4. Particle filter for fault detection
5. Results
2. System modeling1. Introduction
![Page 17: Fault Tolerant ROV Navigation System based on Particle Filter using Hydro-acoustic Position and Doppler Velocity Measurements](https://reader038.fdocuments.in/reader038/viewer/2022110309/5585e8add8b42a48148b4775/html5/thumbnails/17.jpg)
Failure modes1. HPR dropout2. HPR outlier3. DVL dropout4. DVL bias5. Thruster loss
![Page 18: Fault Tolerant ROV Navigation System based on Particle Filter using Hydro-acoustic Position and Doppler Velocity Measurements](https://reader038.fdocuments.in/reader038/viewer/2022110309/5585e8add8b42a48148b4775/html5/thumbnails/18.jpg)
Failure modes1. HPR dropout2. HPR outlier3. DVL dropout4. DVL bias5. Thruster loss
HPR data
HPR update interval
![Page 19: Fault Tolerant ROV Navigation System based on Particle Filter using Hydro-acoustic Position and Doppler Velocity Measurements](https://reader038.fdocuments.in/reader038/viewer/2022110309/5585e8add8b42a48148b4775/html5/thumbnails/19.jpg)
Failure modes1. HPR dropout2. HPR outlier3. DVL dropout4. DVL bias5. Thruster loss
HPR data
HPR update interval
![Page 20: Fault Tolerant ROV Navigation System based on Particle Filter using Hydro-acoustic Position and Doppler Velocity Measurements](https://reader038.fdocuments.in/reader038/viewer/2022110309/5585e8add8b42a48148b4775/html5/thumbnails/20.jpg)
Failure modes1. HPR dropout2. HPR outlier3. DVL dropout4. DVL bias5. Thruster loss
5400 5600 5800 6000 6200-35
-30
-25
-20
-15
-10
-5
0
Time [sec]
Eas
t ve
loci
ty [m
/sec
]
DVL data
![Page 21: Fault Tolerant ROV Navigation System based on Particle Filter using Hydro-acoustic Position and Doppler Velocity Measurements](https://reader038.fdocuments.in/reader038/viewer/2022110309/5585e8add8b42a48148b4775/html5/thumbnails/21.jpg)
Failure modes1. HPR dropout2. HPR outlier3. DVL dropout4. DVL bias5. Thruster loss
![Page 22: Fault Tolerant ROV Navigation System based on Particle Filter using Hydro-acoustic Position and Doppler Velocity Measurements](https://reader038.fdocuments.in/reader038/viewer/2022110309/5585e8add8b42a48148b4775/html5/thumbnails/22.jpg)
Failure modes1. HPR dropout2. HPR outlier3. DVL dropout4. DVL bias5. Thruster loss
𝝉𝐭𝐡𝐫={𝝉𝐜𝐦𝐝 ,𝝉𝐜𝐦𝐝<𝝉𝟎
𝝉𝟎 ,𝝉𝐜𝐦𝐝≥𝝉𝟎
![Page 23: Fault Tolerant ROV Navigation System based on Particle Filter using Hydro-acoustic Position and Doppler Velocity Measurements](https://reader038.fdocuments.in/reader038/viewer/2022110309/5585e8add8b42a48148b4775/html5/thumbnails/23.jpg)
Failure modes1. HPR dropout2. HPR outlier3. DVL dropout4. DVL bias5. Thruster loss
54005600
58006000
6200
-35
-30
-25
-20
-15
-10
-5
0
Time [sec]
Eas
t ve
loci
ty [m
/sec
]
Comment:0. If the fault in the system is known, we can design an filter to solve the observation problem1. It is not easy to design observers for the
system models in different failure modes2. Even if a bank of observers is designed, it is
hard to decide which one to use, since the failure mode is unknown.
Comment:0. If the fault in the system is known, we can design an filter to solve the observation problem
![Page 24: Fault Tolerant ROV Navigation System based on Particle Filter using Hydro-acoustic Position and Doppler Velocity Measurements](https://reader038.fdocuments.in/reader038/viewer/2022110309/5585e8add8b42a48148b4775/html5/thumbnails/24.jpg)
4. Particle filter for fault detection
5. Results
3. Fault analysis and modeling
2. System modeling1. Introduction
![Page 25: Fault Tolerant ROV Navigation System based on Particle Filter using Hydro-acoustic Position and Doppler Velocity Measurements](https://reader038.fdocuments.in/reader038/viewer/2022110309/5585e8add8b42a48148b4775/html5/thumbnails/25.jpg)
How do we cognize the world?
Observation
CorrectionPrediction
![Page 26: Fault Tolerant ROV Navigation System based on Particle Filter using Hydro-acoustic Position and Doppler Velocity Measurements](https://reader038.fdocuments.in/reader038/viewer/2022110309/5585e8add8b42a48148b4775/html5/thumbnails/26.jpg)
How do we diagnose a fault?
Fault Free
Faulty
PredictedFault free behavior
PredictedFaulty behavior
Prediction
![Page 27: Fault Tolerant ROV Navigation System based on Particle Filter using Hydro-acoustic Position and Doppler Velocity Measurements](https://reader038.fdocuments.in/reader038/viewer/2022110309/5585e8add8b42a48148b4775/html5/thumbnails/27.jpg)
How do we diagnose a fault?
Fault Free
Faulty
PredictedFault free behavior
PredictedFaulty behavior
Prediction
![Page 28: Fault Tolerant ROV Navigation System based on Particle Filter using Hydro-acoustic Position and Doppler Velocity Measurements](https://reader038.fdocuments.in/reader038/viewer/2022110309/5585e8add8b42a48148b4775/html5/thumbnails/28.jpg)
How do we diagnose a fault?
Fault Free
Faulty
PredictedFault free behavior
PredictedFaulty behavior
Prediction ObservationTake the measurement
Correction
H1
H2
Obs
Compare
![Page 29: Fault Tolerant ROV Navigation System based on Particle Filter using Hydro-acoustic Position and Doppler Velocity Measurements](https://reader038.fdocuments.in/reader038/viewer/2022110309/5585e8add8b42a48148b4775/html5/thumbnails/29.jpg)
Introduction to Particle FilterOutline • Example - Measurement noise
System States
State Estimation
Kalman Filter
Particle Filter
Case Study
p
USED
SLIDES
![Page 30: Fault Tolerant ROV Navigation System based on Particle Filter using Hydro-acoustic Position and Doppler Velocity Measurements](https://reader038.fdocuments.in/reader038/viewer/2022110309/5585e8add8b42a48148b4775/html5/thumbnails/30.jpg)
Introduction to Particle FilterOutline • Example - Measurement noise
System States
State Estimation
Kalman Filter
Particle Filter
Case Study
mp
p
Measuring
USED
SLIDES
![Page 31: Fault Tolerant ROV Navigation System based on Particle Filter using Hydro-acoustic Position and Doppler Velocity Measurements](https://reader038.fdocuments.in/reader038/viewer/2022110309/5585e8add8b42a48148b4775/html5/thumbnails/31.jpg)
Introduction to Particle FilterOutline • Example - Measurement noise
System States
State Estimation
Kalman Filter
Particle Filter
Case Study
mp
Estimating
USED
SLIDES
![Page 32: Fault Tolerant ROV Navigation System based on Particle Filter using Hydro-acoustic Position and Doppler Velocity Measurements](https://reader038.fdocuments.in/reader038/viewer/2022110309/5585e8add8b42a48148b4775/html5/thumbnails/32.jpg)
Introduction to Particle FilterOutline • Example - Measurement noise
System States
State Estimation
Kalman Filter
Particle Filter
Case Study
p
mp
Estimating
USED
SLIDES
![Page 33: Fault Tolerant ROV Navigation System based on Particle Filter using Hydro-acoustic Position and Doppler Velocity Measurements](https://reader038.fdocuments.in/reader038/viewer/2022110309/5585e8add8b42a48148b4775/html5/thumbnails/33.jpg)
p
mp
H1
H2
ObsCorrection
![Page 34: Fault Tolerant ROV Navigation System based on Particle Filter using Hydro-acoustic Position and Doppler Velocity Measurements](https://reader038.fdocuments.in/reader038/viewer/2022110309/5585e8add8b42a48148b4775/html5/thumbnails/34.jpg)
How do we diagnose a fault?
Fault Free
Faulty
PredictedFault free behavior
PredictedFaulty behavior
Prediction ObservationTake the measurement
Correction
H1
H2
Obs
Compare
![Page 35: Fault Tolerant ROV Navigation System based on Particle Filter using Hydro-acoustic Position and Doppler Velocity Measurements](https://reader038.fdocuments.in/reader038/viewer/2022110309/5585e8add8b42a48148b4775/html5/thumbnails/35.jpg)
5. Results
4. Particle filter for fault detection
3. Fault analysis and modeling
2. System modeling1. Introduction
![Page 36: Fault Tolerant ROV Navigation System based on Particle Filter using Hydro-acoustic Position and Doppler Velocity Measurements](https://reader038.fdocuments.in/reader038/viewer/2022110309/5585e8add8b42a48148b4775/html5/thumbnails/36.jpg)
What has been talked about?• ROV, and its navigation sensors• Faults in the sensors and their model• The concept of fault detection with
particle filter• Simulation results
What are the advantages?• Straight-forward modeling• Do the navigation and fault
handling with in a single structure• Extendable