pathLength

Длина пути

свернуть все на странице

Синтаксис

len = pathLength(path)

Описание

пример

len = pathLength(path) возвращает общую длину пути путем подведения итогов расстояний между каждой последовательной парой состояний в пути. Функция использует объект пространства состояний, сопоставленный с path вычислить расстояние между каждой парой состояния.

Примеры

свернуть все

Скрипт Open Live Script

Создайте navPath основанное на объектах на нескольких waypoints на пробеле Dubins.

dubinsSpace = stateSpaceDubins([0 25; 0 25; -pi pi])
dubinsSpace = 
  stateSpaceDubins with properties:

   SE2 Properties
                 Name: 'SE2 Dubins'
          StateBounds: [3×2 double]
    NumStateVariables: 3

   Dubins Vehicle Properties
     MinTurningRadius: 1


pathobj = navPath(dubinsSpace)
pathobj = 
  navPath with properties:

    StateSpace: [1×1 stateSpaceDubins]
        States: [0×3 double]
     NumStates: 0


waypoints = [...
    8 10 pi/2;
    10 12 pi/4;
    12 17 pi/2;
    11 10 -pi];
append(pathobj, waypoints);

Интерполируйте тот путь так, чтобы он содержал точно 250 точек.

interpolate(pathobj, 250)

Визуализируйте интерполированный путь и исходный waypoints.

figure;
grid on;
axis equal;
hold on;
plot(pathobj.States(:,1), pathobj.States(:,2), ".b");
plot(waypoints(:,1), waypoints(:,2), "*r", "MarkerSize", 10)

Вычислите длину пути.

len = pathLength(pathobj);
disp("Path length = " + num2str(len))
Path length = 19.37

Входные параметры

свернуть все

Объект контуров в виде navPath объект.

Типы данных: object

Выходные аргументы

свернуть все

Длина пути, возвращенного как неотрицательный скаляр.

Смотрите также

Введенный в R2019b

Документация Navigation Toolbox

Поддержка

Для просмотра документации необходимо авторизоваться на сайте