| Algorithm 1: Pseudocode for identification of robot position during indoor parking |
| 1. Initialize sensory distance and reference distances, digital compass directions 2. Case A: estimation of robot position in parking 3. State 1: if ((Dxθ = θref) && ((SXL & SXR) = dmin))? Case B: State 2. 4. State 2: if ((Dxθ ≠ θref) && ((SXL & SXR) = dmin))? Case C: Case A. 5. Case B: robot at perpendicular parking in static/dynamic state 6. State 11: if ((Dxθ = θref) && ((SXB_0 & SXR_135 & SXL_225) = dmax))? State 12: State 13. 7. State 12: Algorithm_2 of Case _A//Switch to RR & Behavioral 8. State 13: Algorithm_3 of Case _3A//Switch to FCFS & ACC algorithm 9. Case C: robot at inclination parking in static/dynamic state 10. State 21: if ((Dxθ ≠ θref) && ((SXB_0 & SXR_135 & SXL_225) = dmax))? State 22: State 23. 11. State 22: Algorithm_2 of Case _A//Switch to RR & Behavioral 12. State 23: Algorithm_3 of Case _3A//Switch to FCFS & ACC 13. end cases. |