Расстояние между двумя состояниями, возвращенными в виде числа или m - вектор-столбец элемента. Этот расчет расстояния является основным компонентом в оценке затрат на пути. Для призматических соединений расстояние между двумя состояниями является Евклидовой нормой различия между векторами состояния. Для шарнирных соединений с бесконечными границами разность в объединенных значениях вычислена с помощью angdiff.
Для шарнирных соединений расстояния измеряют объединенные различия в радианах. Для призматических соединений расстояния измеряют смещение в метрах.
Размеры state1 и state2 определите размер выхода dist:
Векторы состояния и расстояния
state1 Size | state2 Size | dist Size |
|---|
| n- вектор-строка элемента | n- вектор-строка элемента | скаляр |
| n- вектор-строка элемента | m-by-n матрица | m- вектор-столбец элемента |
| m-by-n матрица | n- вектор-строка элемента | m- вектор-столбец элемента |
| m-by-n матрица | m-by-n матрица | m- вектор-столбец элемента |
