Algorithm 2: Pseudo code of hardware based Adaptive SLAM for robotic services |
Service Robot (SR) initialize services and ready at parking station.
If (Task assigned)
Case (Task type)
State_1: (Task type = Multitask)? State_2: Static SLAM.
State_2: (Task sort)? Task destination: Task sort.
Case (Task_destination)
State_11: (Task_destination = Static Task sort _n)? State_12: Accomplished.
State_12: (Task_destination = Adaptive Task)? Adaptive SLAM: SLAM static.
Case (Static SLAM)
State_SS1: (Navigation sort_n = Task_destination_n)? Accomplished: State_SS2.
State_SS2: if (Current Node == Dest_ Node) begin
Current Node <= start position.
else {Current Node <= Current Node + 1}.
Case (Adaptive SLAM)
State_AS1: (Adaptive task)? Task assigned <= Adaptive task: Task_destination.
State_AS2: (Adaptive task sort)? State_AS3: State_AS2.
State_AS3: (Task destination <= Task sort)? Static SLAM: State_AS3.
end case, End.
|