Poniżej znajdują się algorytmy sterowania wykorzystujące echosondę. Aby sprawdzić działanie algorytmów należy przygotować tor przeszkód.

1. jedź do przodu
2. jeżeli przeszkoda zatrzymaj się (wskaźnik echosondy poniżej progu) idź do (3) inaczej wróć do (1)
3. obróć się o 90⁰ w prawo
4. idź do (1)

Rule: 1
if ultrasonic_sensor_Value > number
then robot_action is go_foward
 
Rule: 2
if ultrasonic_sensor_Value ≤ number
then robot_action is turn_right_90_degrees
 
Rule: 3
stop

start :-
      ultrasonic_sensor(Value),
      Value > number,
      go(0,speed,force).
start :-
      ultrasonic_sensor(Value),
      Value =< number,
      turn(90,speed).
start :-
      go(0,0,0).

1. jedź do przodu
2. jeżeli przeszkoda zatrzymaj się (wskaźnik echosondy poniżej progu) idź do (3) inaczej wróć do (1)
3. obróć się o 90⁰ w prawo
4. jeżeli przeszkoda zatrzymaj się (wskaźnik echosondy poniżej progu) idź do (3) inaczej idź do (5)
5. zrób krok do przodu
6. jeżeli przeszkoda idź do (3) inaczej idź wykonaj kolejny punkt
7. obróć się o 90⁰ w lewo i idź do (1)

Rule: 1
if ultrasonic_sensor_Value > number
then robot_state is go
 
Rule: 2
if ultrasonic_sensor_Value ≤ number
then robot_state is turn
 
Rule: 3
if robot_state is go
and previous_action is turn_right_90_degrees
then robot_action is go_one_step_foward
 
Rule: 4
if robot_state is go
and previous_action is go_foward
then robot_action is go_foward
 
Rule: 5
if robot_state is go
and previous_action is turn_left_90_degrees
then robot_action is go_foward
 
Rule: 6
if robot_state is turn
and previous_action is go_foward
then robot_action is turn_right_90_degrees
 
Rule: 7
if robot_state is turn
and previous_action is go_one_step_foward
then robot_action is turn_left_90_degrees

state(go_foward). // Knowladge Base => previous state updated in fly.. initial state would also be state(go)
 
start :-
      ultrasonic_sensor(Value),
      Value > number,
      start_go.
 
start :-
      ultrasonic_sensor(Value),
      Value =< number,
      start_turn.
 
start :-
      go(0,0,0).
 
start_go :-
      state(go_foward),
      go(0,speed,force).
 
start_go :-
      state(go_step_foward),
      go_cm(distance,speed).
 
start_turn :-
      state(go_foward),
      turn_degrees(90,speed).
 
start_turn :-
      state(go_step_foward),
      turn_degrees(-90,speed).

1. jedź do przodu
2. jeżeli przeszkoda zatrzymaj się (wskaźnik echosondy poniżej progu) idź do (3) inaczej wróć do (1)
3. obróć się o 45⁰ w prawo i zapisz odczyt czujnika
4. obróć się o 135⁰ w lewo i zapisz odczyt czujnika
5. jeżeli odczyt_1 większy od odczyt_2 obróć się o 135⁰ w prawo
6. idź do (1)

Rule: 1
if ultrasonic_sensor_Value > number
then robot_action is go_foward
 
Rule: 2
if ultrasonic_sensor_Value ≤ number
then robot_action is turn_right
 
Rule: 3 // co z ta reguła ???
if error
then stop

start :-
      ultrasonic_sensor(Value),
      Value > number,
      go(0,speed,force).
start :-
      ultrasonic_sensor(Value),
      Value =< number,
      turn(90,speed).
start :-
      go(0,0,0).