interpolate

Интерполяция точек вдоль пути

Синтаксис

Описание

пример

interpolate(path,numStates) вставляет в путь несколько состояний и обеспечивает равномерное распределение всех точек в пути. Функция сохраняет все существующие состояния в пути. Значение numStates должно быть больше или равно количеству существующих состояний в пути.

Примеры

свернуть все

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

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)

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

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

Количество состояний, вставленных в путь, заданное как неотрицательное целое число. Его значение должно быть больше или равно количеству существующих состояний в пути.

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

См. также

Введенный в R2019b