Hasan Arshad Nasir - CYPHYNETS · RRT algorithm for generating large set of candidate paths....
Transcript of Hasan Arshad Nasir - CYPHYNETS · RRT algorithm for generating large set of candidate paths....
![Page 1: Hasan Arshad Nasir - CYPHYNETS · RRT algorithm for generating large set of candidate paths. Generating and Linearizing Dynamics and Observation model. Kalman filter for optimal state](https://reader035.fdocuments.us/reader035/viewer/2022070909/5f95f4475d82033a487c08aa/html5/thumbnails/1.jpg)
Hasan Arshad Nasir
![Page 2: Hasan Arshad Nasir - CYPHYNETS · RRT algorithm for generating large set of candidate paths. Generating and Linearizing Dynamics and Observation model. Kalman filter for optimal state](https://reader035.fdocuments.us/reader035/viewer/2022070909/5f95f4475d82033a487c08aa/html5/thumbnails/2.jpg)
Motion Uncertainty.
Imperfect state information.
![Page 3: Hasan Arshad Nasir - CYPHYNETS · RRT algorithm for generating large set of candidate paths. Generating and Linearizing Dynamics and Observation model. Kalman filter for optimal state](https://reader035.fdocuments.us/reader035/viewer/2022070909/5f95f4475d82033a487c08aa/html5/thumbnails/3.jpg)
![Page 4: Hasan Arshad Nasir - CYPHYNETS · RRT algorithm for generating large set of candidate paths. Generating and Linearizing Dynamics and Observation model. Kalman filter for optimal state](https://reader035.fdocuments.us/reader035/viewer/2022070909/5f95f4475d82033a487c08aa/html5/thumbnails/4.jpg)
![Page 5: Hasan Arshad Nasir - CYPHYNETS · RRT algorithm for generating large set of candidate paths. Generating and Linearizing Dynamics and Observation model. Kalman filter for optimal state](https://reader035.fdocuments.us/reader035/viewer/2022070909/5f95f4475d82033a487c08aa/html5/thumbnails/5.jpg)
![Page 6: Hasan Arshad Nasir - CYPHYNETS · RRT algorithm for generating large set of candidate paths. Generating and Linearizing Dynamics and Observation model. Kalman filter for optimal state](https://reader035.fdocuments.us/reader035/viewer/2022070909/5f95f4475d82033a487c08aa/html5/thumbnails/6.jpg)
Quantify these uncertainties in advance.. Develop optimized path planning..
![Page 7: Hasan Arshad Nasir - CYPHYNETS · RRT algorithm for generating large set of candidate paths. Generating and Linearizing Dynamics and Observation model. Kalman filter for optimal state](https://reader035.fdocuments.us/reader035/viewer/2022070909/5f95f4475d82033a487c08aa/html5/thumbnails/7.jpg)
LQG-MP (Linear Quadratic Gaussian- Motion Planning).
![Page 8: Hasan Arshad Nasir - CYPHYNETS · RRT algorithm for generating large set of candidate paths. Generating and Linearizing Dynamics and Observation model. Kalman filter for optimal state](https://reader035.fdocuments.us/reader035/viewer/2022070909/5f95f4475d82033a487c08aa/html5/thumbnails/8.jpg)
![Page 9: Hasan Arshad Nasir - CYPHYNETS · RRT algorithm for generating large set of candidate paths. Generating and Linearizing Dynamics and Observation model. Kalman filter for optimal state](https://reader035.fdocuments.us/reader035/viewer/2022070909/5f95f4475d82033a487c08aa/html5/thumbnails/9.jpg)
RRT algorithm for generating large set of candidate paths.
Generating and Linearizing Dynamics and Observation model.
Kalman filter for optimal state estimation and LQR for optimal control.
Probability distribution of state and control input.
Based on above choose the best path.
![Page 10: Hasan Arshad Nasir - CYPHYNETS · RRT algorithm for generating large set of candidate paths. Generating and Linearizing Dynamics and Observation model. Kalman filter for optimal state](https://reader035.fdocuments.us/reader035/viewer/2022070909/5f95f4475d82033a487c08aa/html5/thumbnails/10.jpg)
RRT algorithm for generating large set of candidate paths…………….
![Page 11: Hasan Arshad Nasir - CYPHYNETS · RRT algorithm for generating large set of candidate paths. Generating and Linearizing Dynamics and Observation model. Kalman filter for optimal state](https://reader035.fdocuments.us/reader035/viewer/2022070909/5f95f4475d82033a487c08aa/html5/thumbnails/11.jpg)
Its “Rapidly Exploring Random Tree”. It’s the best for this context. Its probabilistic complete algorithm.
![Page 12: Hasan Arshad Nasir - CYPHYNETS · RRT algorithm for generating large set of candidate paths. Generating and Linearizing Dynamics and Observation model. Kalman filter for optimal state](https://reader035.fdocuments.us/reader035/viewer/2022070909/5f95f4475d82033a487c08aa/html5/thumbnails/12.jpg)
1) http://www.kuffner.org/james/plan/algorithm.php
![Page 13: Hasan Arshad Nasir - CYPHYNETS · RRT algorithm for generating large set of candidate paths. Generating and Linearizing Dynamics and Observation model. Kalman filter for optimal state](https://reader035.fdocuments.us/reader035/viewer/2022070909/5f95f4475d82033a487c08aa/html5/thumbnails/13.jpg)
![Page 14: Hasan Arshad Nasir - CYPHYNETS · RRT algorithm for generating large set of candidate paths. Generating and Linearizing Dynamics and Observation model. Kalman filter for optimal state](https://reader035.fdocuments.us/reader035/viewer/2022070909/5f95f4475d82033a487c08aa/html5/thumbnails/14.jpg)
![Page 15: Hasan Arshad Nasir - CYPHYNETS · RRT algorithm for generating large set of candidate paths. Generating and Linearizing Dynamics and Observation model. Kalman filter for optimal state](https://reader035.fdocuments.us/reader035/viewer/2022070909/5f95f4475d82033a487c08aa/html5/thumbnails/15.jpg)
![Page 16: Hasan Arshad Nasir - CYPHYNETS · RRT algorithm for generating large set of candidate paths. Generating and Linearizing Dynamics and Observation model. Kalman filter for optimal state](https://reader035.fdocuments.us/reader035/viewer/2022070909/5f95f4475d82033a487c08aa/html5/thumbnails/16.jpg)
Generating and LinearizingDynamics and Observation model.…………….
![Page 17: Hasan Arshad Nasir - CYPHYNETS · RRT algorithm for generating large set of candidate paths. Generating and Linearizing Dynamics and Observation model. Kalman filter for optimal state](https://reader035.fdocuments.us/reader035/viewer/2022070909/5f95f4475d82033a487c08aa/html5/thumbnails/17.jpg)
).,0(~).,0(~
).()()()().,(
).()()()()()1().,,( 11
tt
tt
ttt
tttt
NNnMNm
knkxkHkznxhz
kmkukBkxkAkxmuxfx
+==
++=+= −−
![Page 18: Hasan Arshad Nasir - CYPHYNETS · RRT algorithm for generating large set of candidate paths. Generating and Linearizing Dynamics and Observation model. Kalman filter for optimal state](https://reader035.fdocuments.us/reader035/viewer/2022070909/5f95f4475d82033a487c08aa/html5/thumbnails/18.jpg)
.)(
)()(
.)()(
)(
.)1()1(
)1(
=
=
++
=+
•
•
ky
kxku
kykx
kx
kykx
kx
r
r
r
r
r
r
.1
.1001
)(
.0
0)(
.1001
)(
=
=
=
=
t
kH
tt
kB
kA
![Page 19: Hasan Arshad Nasir - CYPHYNETS · RRT algorithm for generating large set of candidate paths. Generating and Linearizing Dynamics and Observation model. Kalman filter for optimal state](https://reader035.fdocuments.us/reader035/viewer/2022070909/5f95f4475d82033a487c08aa/html5/thumbnails/19.jpg)
.)()(
)()(
1001
)()(
.)()(
)(
)(0
0)()(
1001
)1()1(
+
=
+
+
=
++
•
•
knkn
kykx
kzkz
kmkm
ky
kxt
tkykx
kykx
y
x
r
r
y
x
y
x
r
r
r
r
r
r
![Page 20: Hasan Arshad Nasir - CYPHYNETS · RRT algorithm for generating large set of candidate paths. Generating and Linearizing Dynamics and Observation model. Kalman filter for optimal state](https://reader035.fdocuments.us/reader035/viewer/2022070909/5f95f4475d82033a487c08aa/html5/thumbnails/20.jpg)
Kalman filter for optimal state estimation and LQR for optimal control..…………….
![Page 21: Hasan Arshad Nasir - CYPHYNETS · RRT algorithm for generating large set of candidate paths. Generating and Linearizing Dynamics and Observation model. Kalman filter for optimal state](https://reader035.fdocuments.us/reader035/viewer/2022070909/5f95f4475d82033a487c08aa/html5/thumbnails/21.jpg)
Process update (prediction). Measurement update (update/filtering).
![Page 22: Hasan Arshad Nasir - CYPHYNETS · RRT algorithm for generating large set of candidate paths. Generating and Linearizing Dynamics and Observation model. Kalman filter for optimal state](https://reader035.fdocuments.us/reader035/viewer/2022070909/5f95f4475d82033a487c08aa/html5/thumbnails/22.jpg)
Cost function:
“lqr” command in MATLAB, generates feedback matrix.
.))()()()((0∑=
+l
kr
Trr
Tr kuRkukxQkx
).()( kLxku rr =
![Page 23: Hasan Arshad Nasir - CYPHYNETS · RRT algorithm for generating large set of candidate paths. Generating and Linearizing Dynamics and Observation model. Kalman filter for optimal state](https://reader035.fdocuments.us/reader035/viewer/2022070909/5f95f4475d82033a487c08aa/html5/thumbnails/23.jpg)
Red star = estimated stateGreen circle = true stateMagenta star = measured state
![Page 24: Hasan Arshad Nasir - CYPHYNETS · RRT algorithm for generating large set of candidate paths. Generating and Linearizing Dynamics and Observation model. Kalman filter for optimal state](https://reader035.fdocuments.us/reader035/viewer/2022070909/5f95f4475d82033a487c08aa/html5/thumbnails/24.jpg)
Probability distribution of state and control input........
![Page 25: Hasan Arshad Nasir - CYPHYNETS · RRT algorithm for generating large set of candidate paths. Generating and Linearizing Dynamics and Observation model. Kalman filter for optimal state](https://reader035.fdocuments.us/reader035/viewer/2022070909/5f95f4475d82033a487c08aa/html5/thumbnails/25.jpg)
![Page 26: Hasan Arshad Nasir - CYPHYNETS · RRT algorithm for generating large set of candidate paths. Generating and Linearizing Dynamics and Observation model. Kalman filter for optimal state](https://reader035.fdocuments.us/reader035/viewer/2022070909/5f95f4475d82033a487c08aa/html5/thumbnails/26.jpg)
Designing a planning objective and selecting the best path........
![Page 27: Hasan Arshad Nasir - CYPHYNETS · RRT algorithm for generating large set of candidate paths. Generating and Linearizing Dynamics and Observation model. Kalman filter for optimal state](https://reader035.fdocuments.us/reader035/viewer/2022070909/5f95f4475d82033a487c08aa/html5/thumbnails/27.jpg)
![Page 28: Hasan Arshad Nasir - CYPHYNETS · RRT algorithm for generating large set of candidate paths. Generating and Linearizing Dynamics and Observation model. Kalman filter for optimal state](https://reader035.fdocuments.us/reader035/viewer/2022070909/5f95f4475d82033a487c08aa/html5/thumbnails/28.jpg)
Path serial number Color Weight/Ratio/Priority
1 Red 2.769
2 Blue 2.8095
3 Black 2.872
4 Yellow 2.880
5 Green 2.795
![Page 29: Hasan Arshad Nasir - CYPHYNETS · RRT algorithm for generating large set of candidate paths. Generating and Linearizing Dynamics and Observation model. Kalman filter for optimal state](https://reader035.fdocuments.us/reader035/viewer/2022070909/5f95f4475d82033a487c08aa/html5/thumbnails/29.jpg)
Jur V.Berg, P. Abbeel, K. Goldberg, “LQG-MP: Optimized Path Planning for Robots with Motion Uncertainty and Imperfect State Information”. International Journal of Robotics, 2011.