во вложеном файле расчет по первой функции.
я думаю там какраз то что надо.
+матрица начальных точек плечей относительно О.
самое сложное это вторая функция. но задумки есть. даже мат-описание.
вот еще ссылки.
Расчет_положения_ног_в_шестиногом_роботе

