К численным методам решения ОЗК, получившим наибольшее распространение, относится метод Ньютона и методы, основанные на процедурах градиентного поиска.
Поясним содержание метода Ньютона на примере скалярной функции.
Пусть задано некоторое уравнение функции F* своего аргумента x вида F*(x)=0. Тогда решение этого уравнения может быть определено в численном виде посредством итерационной процедуры, записываемой в виде следующего выражения [10]:
, , (1.49)
где .
Выражение (1.49) определяет содержание метода Ньютона. Задается искомое решение исходного уравнения (его корень) произвольным образом и оно же выбирается в качестве нулевого приближения x0. Вычисляется 1-е приближение корня по выражению (1.49), которое на втором шаге подставляется в правую часть выражения (1.49), позволяя вычислить 2-е приближение искомого корня и т.д. Причем выход из процедуры (1.49) определяется заданной погрешностью вычислений Δ и может быть осуществлен, например, при выполнении неравенства xi +1 - xi < Δ.
Пусть, например, F*(x)=4x-20=0. Решение этого уравнения очевидно: x=5. Но попытаемся найти его, используя метод Ньютона. Поскольку , то выражение (1.49) может быть представлено в виде
.
В качестве нулевого приближения при i=0 примем x0=20. Подставим его в последнее равенство. Имеем: x1=5. Т.е. уже на первом шаге процедуры искомое решение найдено.
|
, (1.50)
корни которой и являются искомым решением ОЗК.
Тогда, в соответствии с выражением (1.49), получим:
, (1.51)
где J Ф- матрица Якоби решения ПЗК, определенная нами в п. 1.8.2.
Рассмотрим использование выражения (1.51) на примере манипуляционного робота с цилиндрической системой координат.
Пример 1.12. Пусть требуется решить ОЗК для МР с цилиндрической системой координат для желаемого положения схвата, заданного вектором P ж = (-0,233, 0,596, 0,650)Т. Используем выражение (1.51), приняв q 0 = (80o, 0,8 м, 0,13 м)Т. Число шагов итерации определяется погрешностью позиционирования схвата, которая по каждой из внешних координат не должна превышать 1 мм.
Решение. Используем решение ПЗК (1.38) для рассматриваемого МР, полученное нами в п.1.7. Матрица Якоби данного манипулятора определена в примере 1.11, п. 1.8.2. Результаты использования процедуры (1.51) приведены в табл. 4.
Таблица 4
Результаты решения ОЗК методом Ньютона
Значения
Параметра
Шаг итерации
Из табл. 4 видно, что обобщенные координаты принимают значения q=(59,989, 0,6, 0,1)Т, удовлетворяющие поставленной задаче, уже на 3-м шаге итерации. Результаты решения ОЗК согласуются с полученными нами в примере 1.10, п. 1.8.1.
Следует отметить, что в области больших отклонений нулевого приближения от истинного значения корней уравнения (1.50), процедура, основанная на выражении (1.51), может и не дать устойчивых решений. Кроме того, найденные в результате итераций значения могут и не принадлежать области допустимых значений аргумента. Так, например, уже при q10=90o использование метода Ньютона дает значение q3=0,899, что невозможно в силу конструктивных особенностей рассматриваемого манипулятора, поскольку должно соблюдаться очевидное условие: q3<l4=0.5. Поэтому при больших начальных отклонениях аргумента рассматриваемых функций от искомых значений их корней используются градиентные методы [10].
|
, (1.52)
где - i-е приближение j- й координаты; δ- «направление» i-го шага; Δ - величина i-го шага по j- ой координате.
Причем значения δ и Δ выбираются таким образом, чтобы минимизировать значения функции . Т.е. требуется выполнение следующей последовательности неравенств:
, (1.53)
здесь k- конечный шаг итерации.
В этом случае функция I (1.50) называется функцией невязки. Получаемые промежуточные значения обобщенных координат могут быть использованы при формировании траектории перехода j-го звена из точки в точку , определяемую желаемым положением рабочего органа МР.
Естественно, при использовании численных методов решения ОЗК на каждом шаге итерации, необходимо удовлетворять ограничениям, накладываемым на обобщенные координаты и ориентацию рабочего органа МР, а также учитывать наличие препятствий, расположенных в рабочем пространстве манипулятора.
Для более детальной проработки вопросов, связанных с решением ОЗК, рекомендуется литература [3, 11].
Следует отметить, что в работе [6] предложены подходы к управлению манипуляционными роботами, не требующие решения обратной задачи кинематики.
Дата: 2019-04-23, просмотров: 446.