aubo-i5机械臂（1）-正运动学求解-Toy模板网

这篇具有很好参考价值的文章主要介绍了aubo-i5机械臂（1）-正运动学求解。希望对大家有所帮助。如果存在错误或未考虑完全的地方，请大家不吝赐教，您也可以点击"举报违法"按钮提交疑问。

1.DH表建立

2.Matlab实现正运动学求解

1.DH表建立

libpyauboi5,机械臂运动学求解与轨迹规划,matlab,矩阵,人工智能,自动化

注：使用改进DH表建立的

libpyauboi5,机械臂运动学求解与轨迹规划,matlab,矩阵,人工智能,自动化

根据公式求出相邻连杆的变换矩阵 libpyauboi5,机械臂运动学求解与轨迹规划,matlab,矩阵,人工智能,自动化

2.Matlab实现正运动学求解

function [H, H_i] = aubo_fkin(DHtable,q)
% H 为输出，末端到基座的 4X4 齐次变换矩阵；
% H_i 为输出，相邻连杆的 4X4 齐次变换矩阵，由于有 n 个连杆，因此 H_i 应该为包含 n 个元素的 cell；
% DHtable 为输入，是一个 nX4 的矩阵，满足 DH 改进约定的 DH 表
% q 为输入，是一个 1xN 的向量，表示关节坐标

%%%！！！！注：机械臂零位的角度应先加到q中,而DH表不含有零位角度！！！！！！！%%

%%相邻连杆的 4X4 齐次变换矩阵%%
    first=1;
    last=size(DHtable,1);%%计算出有多少个连杆
 for i=first:last
    theta=q(i);
    d=DHtable(i,2);
    a=DHtable(i,3);
    alpha=DHtable(i,4);
  T1(:,:,i)=[ cos(theta)                 -sin(theta)                 0                    a;
              sin(theta)*cos(alpha)      cos(theta)*cos(alpha)     -sin(alpha)       -d*sin(alpha);
              sin(theta)*sin(alpha)      cos(theta)*sin(alpha)      cos(alpha)       d*cos(alpha);
                0               0                       0           1];
 T(:,:,i)=double(T1(:,:,i));
 end
 %%
 %%计算末端到基座的 4X4 齐次变换矩阵和将相邻连杆的 4X4 齐次变换矩阵放置到元胞数组%%
  H1=eye(4);
  H_i=cell(1,last);  %%%预先分配内存
for i=first:last
    H1=H1* T(:,:,i);
    H_i{i}=T(:,:,i);
end
 H_i
 H=double(H1)

因公式相同，则使用for循环求出相邻连杆的齐次变换矩阵并相乘得出末端到基座的其次变换矩阵。文章来源地址https://www.toymoban.com/news/detail-783367.html

到了这里，关于aubo-i5机械臂（1）-正运动学求解的文章就介绍完了。如果您还想了解更多内容，请在右上角搜索TOY模板网以前的文章或继续浏览下面的相关文章，希望大家以后多多支持TOY模板网！