matlab机械手ikine函数,关于Mtalab-robotics工具箱中的fkine和ikine两个函数的问题讨论！...

clear;

clc;

L1 = Link([-pi/2 0 0 0 0],'standard');

L2 = Link([0 10 0 -pi/2 0],'standard');

L3 = Link([0 9.5 0 0 0],'standard');

L4 = Link([-pi/2 3.2 -pi/2 0 0],'standard');

L5 = Link([0 0 0 14.5 0],'standard');

r = SerialLink([L1 L2 L3 L4 L5]);

%r.name = '5R工业机械臂-上电姿态';

q = [0 -pi/2 0 -pi/2 0];

r.teach(q);

T = fkine(r,q);

MDH=[-pi/2 0 0 0 0;

0 10 0 -pi/2 0;

0 9.5 0 0 0;

-pi/2 3.2 -pi/2 0 0;

0 0 0 14.5 0;];

T01=[cos(MDH(1,1)) -sin(MDH(1,1)) 0 MDH(1,3);

cos(MDH(1,4))*sin(MDH(1,1)) cos(MDH(1,4))*cos(MDH(1,1)) -sin(MDH(1,4)) -MDH(1,2)*sin(MDH(1,4));

sin(MDH(1,4))*sin(MDH(1,1)) sin(MDH(1,4))*cos(MDH(1,1)) cos(MDH(1,4)) MDH(1,2)*cos(MDH(1,4));

0 0 0 1];

T12=[cos(MDH(2,1)) -sin(MDH(2,1)) 0 MDH(2,3);

cos(MDH(2,4))*sin(MDH(2,1)) cos(MDH(2,4))*cos(MDH(2,1)) -sin(MDH(2,4)) -MDH(2,2)*sin(MDH(2,4));

sin(MDH(2,4))*sin(MDH(2,1)) sin(MDH(2,4))*cos(MDH(2,1)) cos(MDH(2,4)) MDH(2,2)*cos(MDH(2,4));

0 0 0 1];

T23=[cos(MDH(3,1)) -sin(MDH(3,1)) 0 MDH(3,3);

cos(MDH(3,4))*sin(MDH(3,1)) cos(MDH(3,4))*cos(MDH(3,1)) -sin(MDH(3,4)) -MDH(3,2)*sin(MDH(3,4));

sin(MDH(3,4))*sin(MDH(3,1)) sin(MDH(3,4))*cos(MDH(3,1)) cos(MDH(3,4)) MDH(3,2)*cos(MDH(3,4));

0 0 0 1];

T34=[cos(MDH(4,1)) -sin(MDH(4,1)) 0 MDH(4,3);

cos(MDH(4,4))*sin(MDH(4,1)) cos(MDH(4,4))*cos(MDH(4,1)) -sin(MDH(4,4)) -MDH(4,2)*sin(MDH(4,4));

sin(MDH(4,4))*sin(MDH(4,1)) sin(MDH(4,4))*cos(MDH(4,1)) cos(MDH(4,4)) MDH(4,2)*cos(MDH(4,4));

0 0 0 1];

T45=[cos(MDH(5,1)) -sin(MDH(5,1)) 0 MDH(5,3);

cos(MDH(5,4))*sin(MDH(5,1)) cos(MDH(5,4))*cos(MDH(5,1)) -sin(MDH(5,4)) -MDH(5,2)*sin(MDH(5,4));

sin(MDH(5,4))*sin(MDH(5,1)) sin(MDH(5,4))*cos(MDH(5,1)) cos(MDH(5,4)) MDH(5,2)*cos(MDH(5,4));

0 0 0 1];

% T56=[cos(MDH(6,1)) -sin(MDH(6,1)) 0 MDH(6,3);

% cos(MDH(6,4))*sin(MDH(6,1)) cos(MDH(6,4))*cos(MDH(6,1)) -sin(MDH(6,4)) -MDH(6,2)*sin(MDH(6,4));

% sin(MDH(6,4))*sin(MDH(6,1)) sin(MDH(6,4))*cos(MDH(6,1)) cos(MDH(6,4)) MDH(6,2)*cos(MDH(6,4));

% 0 0 0 1];

T06=T01*T12*T23*T34*T45;

matlab机械手ikine函数,关于Mtalab-robotics工具箱中的fkine和ikine两个函数的问题讨论！...相关推荐

[PB] PB中读写文件通用的两个函数
PB中读写文件通用的两个函数 1.文件读取 : //函数名:f_readfile //功能:读取文件//参数:// io_file:ref blob 大对象类型,存储读出的文件内容:// is_fil ...
c语言如何给阻塞函数加超时,在代码中写一个延时而不阻塞的函数方法，给大家的参考 - 单片机 - 电子工程世界-论坛 - 手机版...
2017-11-10 17:09 鉴于有些人对我以上两个函数不了解的,我将他们详细写出来,不然又要被某些人喷对于以上的用法,当你有要延时后才去执行的内容时,如果使用delay()函数,会造成系统阻塞 ...
c语言函数的参数传递示例_C ++中带有示例的nearint（）函数
c语言函数的参数传递示例 C ++附近的int()函数 (C++ nearbyint() function) nearbyint() function is a library function o ...
python中用于获取用户输入的函数是_在Python中，用于获取用户输入的函数是.
在Python中,用于获取用户输入的函数是. 答:input() 关于新生儿生理性体重下降的恢复时间,下列正确的是出生后答:7~10天中国大学MOOC: 未来城市只有同时具备下列哪几个组成部分,才 ...
在python中数据的输出用哪个函数名_在Python中，数据的输出用哪个函数名
在Python中,数据的输出用哪个函数名工业机器人按照坐标形式可以分为().A:圆柱坐标机器人B:球坐标机器人C:直角坐标机器人D:关节坐标机器人生物膜上脂质主要是磷脂.A:对B:错再结晶退火主 ...
matlab genfunction,Keras / Python相当于nn工具箱中的Matlab的genFunction
我编写了一个带有3个隐藏层的神经网络(使用Python中的Keras模块) . 网的代码如下: # Create the model np.random.seed(1) # Just for repr ...
python函数示例_使用Python中的示例的input（）函数
python函数示例 Python input()函数 (Python input() function) input() function is a library function, it is ...
oracle函数授权,如何在Oracle中以普通用户身份运行dbms_crypto函数？
我在Oracle中使用dbms_crypto.hash()函数时遇到问题. 我使用sqlplus作为"sys / passwd as sysdba"连接到数据库服务器, 然后我安装 ...
js两个问号代表什么_js中的Object.assign接受两个函数为参数的时候会发生什么？...
缘由今天看到一段代码 return Object.assign(func1, func2); 心生疑惑,为什么 Object.assign 的参数可以是函数? 于是有了下面这一堆东西,其实都是老生常 ...

matlab机械手ikine函数,关于Mtalab-robotics工具箱中的fkine和ikine两个函数的问题讨论！...

matlab机械手ikine函数,关于Mtalab-robotics工具箱中的fkine和ikine两个函数的问题讨论！...相关推荐

最新文章

热门文章