Algorithm 1: Speed and position updating algorithm | |
1 | for do |
2 |
|
3 |
|
4 |
|
5 |
|
6 |
|
7 |
|
8 | if then |
9 |
|
10 | end |
11 | if then |
12 |
|
13 | end |
14 |
|
15 | end |