资源简介
并联机器人,Delta机器人正逆解,MATLAB程序,验证可行

代码片段和文件信息
function [position] = forward_delta(thetasgeometry)
R=geometry(1);
r=geometry(2);
l1=geometry(3);
l2=geometry(4);
theta1=thetas(1)*pi/180;
theta2=thetas(2)*pi/180;
theta3=thetas(3)*pi/180;
beta1=(1-1)*2*pi/3-pi/6;
beta2=(2-1)*2*pi/3-pi/6;
beta3=(3-1)*2*pi/3-pi/6;
OB1=R*[cos(beta1);sin(beta1);0];
OB2=R*[cos(beta2);sin(beta2);0];
OB3=R*[cos(beta3);sin(beta3);0];
B1C1=l1*[cos(beta1)*cos(theta1);sin(beta1)*cos(theta1);-sin(theta1)];
B2C2=l1*[cos(beta2)*cos(theta2);sin(beta2)*cos(theta2);-sin(theta2)];
B3C3=l1*[cos(beta3)*cos(theta3);sin(beta3)*cos(theta3);-sin(theta3)];
OC1=OB1+B1C1;
OC2=OB2+B2C2;
OC3=OB3+B3C3;
O1A1=r*[cos(beta1);sin(beta1);0];
O1A2=r*[cos(beta2);sin(beta2);0];
O1A3=r*[cos(beta3);sin(beta3);0];
OB=OC1-O1A1;
OC=OC2-O1A2;
OD=OC3-O1A3;
BC=OB-OC;
CD=OC-OD;
DB=OD-OB;
a=norm(BC);
b=norm(CD);
c=norm(DB);
p=(a+b+c)/2;
s=sqrt(p*(p-a)*(p-b)*(p-c));
N_BF=a*b*c/(4*s);
N_BE=a/2;
N_EF=sqrt(N_BF^2-N_BE^2);
n_EF=cross(cross(BCCD)BC)/a*b*a;
EF=N_EF*n_EF;
OE=(OB+OC)/2;
OF=OE+EF;
N_FO1=sqrt(l2^2-N_BF^2);
n_FO1=cross(BCCD)/a*b;
FO1=N_FO1*n_FO1;
OO1=OF+FO1;
position=OO1;
属性 大小 日期 时间 名称
----------- --------- ---------- ----- ----
文件 1155 2013-08-01 15:53 forward_delta.m
文件 997 2013-08-01 15:53 inverse_delta.m
----------- --------- ---------- ----- ----
2152 2
- 上一篇:MATLAB与机器学习详细.txt
- 下一篇:UML工资管理系统UML课程设计
相关资源
- 高灵敏度GPS接收机MATLAB仿真,附捕获
- 基于MATLAB的质点弹道计算与外弹道优
- 阵列天线的matlab仿真
- MATLAB 经典程序源代码大全
- MATLAB小波软阈值去噪代码33473
- 天线阵的波束形成在MATLAB仿真程序及
- 非线性SVM算法-matlab实现
- 《MATLAB 智能算法超级学习手册》-程序
- 组合导航matlab程序
- 读取txt文件内容matlab代码实现
- Matlab实现基于相关的模板匹配程序
- matlab优化工具箱讲解
- 基于MATLAB的快速傅里叶变换
- 光纤传输中的分布傅立叶算法matlab实
- 基于matlab的图像处理源程序
- matlab 椭圆拟合程序
- 算术编码解码matlab源代码
- optical_flow 光流法 matlab 实现程序
- 引导图像滤波器 Matlab实现
- 分形几何中一些经典图形的Matlab画法
- OFDM系统MATLAB仿真代码
- SVM工具箱(matlab中运行)
- 图像小波变换MatLab源代码
- LU分解的MATLAB实现
- 冈萨雷斯数字图像处理matlab版(第三
- 替代数据法的matlab程序
- 用matlab实现的多站定位系统性能仿真
- 通过不同方法进行粗糙集属性约简m
- k近邻算法matlab实现
- matlab识别系统
评论
共有 条评论