| 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 |