Planning, finding and adapting a universal route is an urgent task for autonomous and semi-autonomous vehicles. There are two main problems in route planning at the moment: the need to take into account maps and terrain features for certain logistical units, and the complexity of route realignment in case of abnormal situations or in conditions of uncertainty. These problems cannot be solved numerically, using algorithms such as A* or Dijkstra’s algorithm. This study presents a possible approach to solve the above problems using the ant colony algorithm. Ant colony optimization algorithm is implemented by a simulation, as close as possible to the real environment, built to simulate movement along the route in real time.