@@ -20,14 +20,14 @@ cargo run --bin ekf
20
20
* [ Extended kalman filter localization] ( #extended-kalman-filter-localization )
21
21
* Particle filter localization
22
22
* [ SLAM] ( #slam )
23
- * Iterative Closest Point
23
+ * Iterative Closest Point
24
24
* FastSLAM 1.0
25
25
* [ Path Planning] ( #path-planning )
26
26
* [ Bezier Path] ( #bezier-path )
27
27
* [ Cubic Spline] ( #cubic-spline )
28
28
* [ Dynamic Window Approach] ( #dynamic-window-approach )
29
29
* [ Model Predictive Trajectory Generator] ( #model-predictive-trajectory-generator )
30
- * Dijkstra algorithm
30
+ * [ Dijkstra algorithm] ( #dijkstra-algorithm )
31
31
* Potential Field algorithm
32
32
* State Lattice Planner
33
33
* Rapidly-Exploring Random Trees (RRT)
@@ -41,7 +41,7 @@ cargo run --bin ekf
41
41
# Localization
42
42
## Extended Kalman Filter Localization
43
43
44
- <img src =" ./img/ekf.svg " width =" 640px " >
44
+ <img src =" ./img/ekf.svg " width =" 640px " >
45
45
46
46
47
47
Red: GPS , Brue: Ground Truth, Green: EKF , Yellow: Dead Reckoning
@@ -62,7 +62,7 @@ cargo run --bin ekf
62
62
# Path Planning
63
63
## Bezier Path
64
64
65
- <img src =" ./img/bezier_path.svg " width =" 640px " >
65
+ <img src =" ./img/bezier_path.svg " width =" 640px " >
66
66
67
67
Brack: Control points, Green: Path, Red: Start and Goal
68
68
@@ -75,7 +75,7 @@ cargo run --bin bezier_path
75
75
## Cubic Spline
76
76
77
77
78
- <img src =" ./img/csp.svg " width =" 640px " >
78
+ <img src =" ./img/csp.svg " width =" 640px " >
79
79
80
80
Brack: Control points, Green: Path
81
81
@@ -88,7 +88,7 @@ cargo run --bin csp
88
88
89
89
## Dynamic Window Approach
90
90
91
- <img src =" ./img/dwa.svg " width =" 640px " >
91
+ <img src =" ./img/dwa.svg " width =" 640px " >
92
92
93
93
Brack: Obstacles, Green: Trajectry, Yellow: Predected trajectry
94
94
@@ -100,9 +100,9 @@ cargo run --bin dwa
100
100
101
101
## Model Predictive Trajectory Generator
102
102
103
- <img src =" ./img/model_predictive_trajectory_generator.svg " width =" 640px " >
103
+ <img src =" ./img/model_predictive_trajectory_generator.svg " width =" 640px " >
104
104
105
- Green: Path
105
+ Green: Path
106
106
107
107
- [ src] ( https://github.com/rsasaki0109/RustRobotics/blob/master/src/bin/model_predictive_trajectory_generator.rs )
108
108
@@ -112,13 +112,18 @@ cargo run --bin model_predictive_trajectory_generator
112
112
```
113
113
114
114
## Dijkstra algorithm
115
+
116
+ <img src =" ./media/dijkstra-motion-planner.gif " width =" 640px " >
117
+
118
+ - [ src] ( ./src/bin/dijkstra.rs )
119
+
115
120
## Potential Field algorithm
116
121
## State Lattice Planner
117
122
## Rapidly-Exploring Random Trees
118
123
119
124
# Path Tracking
120
- ## Move to Pose
121
- <img src =" ./img/move_to_pose.svg " width =" 640px " >
125
+ ## Move to Pose
126
+ <img src =" ./img/move_to_pose.svg " width =" 640px " >
122
127
123
128
Green: Path, Red: Start and Goal
124
129
@@ -130,9 +135,9 @@ cargo run --bin move_to_pose
130
135
131
136
## Pure Pursuit
132
137
133
- <img src =" ./img/pure_pursuit.svg " width =" 640px " >
138
+ <img src =" ./img/pure_pursuit.svg " width =" 640px " >
134
139
135
- Brack: Planned path, Green: Tracked path
140
+ Brack: Planned path, Green: Tracked path
136
141
137
142
- [ src] ( https://github.com/rsasaki0109/RustRobotics/blob/master/src/bin/pure_pursuit.rs )
138
143
@@ -141,25 +146,25 @@ Brack: Planned path, Green: Tracked path
141
146
cargo run --bin pure_pursuit
142
147
```
143
148
144
- ## Stanly Control
149
+ ## Stanly Control
145
150
146
- <img src =" ./img/stanley_control.svg " width =" 640px " >
151
+ <img src =" ./img/stanley_control.svg " width =" 640px " >
147
152
148
- Brack: Planned path, Green: Tracked path
153
+ Brack: Planned path, Green: Tracked path
149
154
150
155
- [ src] ( https://github.com/rsasaki0109/RustRobotics/blob/master/src/bin/stanley_controller.rs )
151
156
152
157
153
158
```
154
- cargo run --bin stanley_control
159
+ cargo run --bin stanley_controller
155
160
```
156
161
157
162
158
163
## LQR steer control
159
164
160
- <img src =" ./img/lqr_steer_control.svg " width =" 640px " >
165
+ <img src =" ./img/lqr_steer_control.svg " width =" 640px " >
161
166
162
- Brack: Planned path, Green: Tracked path
167
+ Brack: Planned path, Green: Tracked path
163
168
164
169
- [ src] ( https://github.com/rsasaki0109/RustRobotics/blob/master/src/bin/lqr_steer_control.rs )
165
170
0 commit comments