| /* Stage 1.Linear Expansion Algorithm (LE) */ |
| /* For a tail */ |
| If Priority == “” then /* Last robot in the line */ |
| if Object detected Object assigned sonar range limit then |
| Stop driving; |
| else |
| repeat |
| Search for RSSI of AP root 1 “”; |
| until “” RSSI found; |
| if “” RSSI assigned RSSI threshold limit then |
| Stop driving; |
| else |
| Drive straight; |