function dy = three_dof_arm_dyn(y,u)
y1 = y(1);
y2 = y(2);
y3 = y(3);
y4 = y(4);
y5 = y(5);
y6 = y(6);
u1 = u(1);
u2 = u(2);
u3 = u(3);
L1=1;
L2=1;
L3=1;
M1=1;
M2=1;
M3=1;
g=9.8;
dy1 = y2;
dy2 = (L2*L3*M2*u1 - L2*L3*M2*u2 + L2*L3*M3*u1 - L2*L3*M3*u2 - L1*L3*M2*u2*cos(y3) + L1*L3*M2*u3*cos(y3) - L1*L3*M3*u2*cos(y3) + L1*L3*M3*u3*cos(y3) - L2*L3*M3*u1*cos(y5)^2 + L2*L3*M3*u2*cos(y5)^2 + L1*L2^2*L3*M2^2*y2^2*sin(y3) + L1*L2^2*L3*M2^2*y4^2*sin(y3) - L1*L2*L3*M2^2*g*cos(y1) + (L1^2*L2*L3*M2^2*y2^2*sin(2*y3))/2 + L1*L2*M2*u3*sin(y3)*sin(y5) + L1*L2*M3*u3*sin(y3)*sin(y5) + L1*L3*M3*u2*cos(y3)*cos(y5)^2 - L1*L3*M3*u3*cos(y3)*cos(y5)^2 + L1*L2^2*L3*M2*M3*y2^2*sin(y3) + L1*L2^2*L3*M2*M3*y4^2*sin(y3) - L1*L2*L3*M1*M2*g*cos(y1) - L1*L2*L3*M1*M3*g*cos(y1) - L1*L2*L3*M2*M3*g*cos(y1) + 2*L1*L2^2*L3*M2^2*y2*y4*sin(y3) + (L1^2*L2*L3*M2*M3*y2^2*sin(2*y3))/2 - L1*L3*M3*u2*cos(y5)*sin(y3)*sin(y5) + L1*L3*M3*u3*cos(y5)*sin(y3)*sin(y5) + L1*L2*L3*M2^2*g*cos(y1)*cos(y3)^2 - L1*L2*L3*M2^2*g*cos(y3)*sin(y1)*sin(y3) + 2*L1*L2^2*L3*M2*M3*y2*y4*sin(y3) + L1*L2*L3*M2*M3*g*cos(y1)*cos(y3)^2 + L1*L2*L3*M1*M3*g*cos(y1)*cos(y5)^2 + L1*L2*L3^2*M2*M3*y2^2*cos(y5)*sin(y3) + L1*L2*L3^2*M2*M3*y4^2*cos(y5)*sin(y3) + L1*L2*L3^2*M2*M3*y6^2*cos(y5)*sin(y3) + 2*L1*L2*L3^2*M2*M3*y2*y4*cos(y5)*sin(y3) + 2*L1*L2*L3^2*M2*M3*y2*y6*cos(y5)*sin(y3) + 2*L1*L2*L3^2*M2*M3*y4*y6*cos(y5)*sin(y3) - L1*L2*L3*M2*M3*g*cos(y3)*sin(y1)*sin(y3))/(L1^2*L2*L3*(M2^2 - M2^2*cos(y3)^2 + M1*M2 + M1*M3 + M2*M3 - M2*M3*cos(y3)^2 - M1*M3*cos(y5)^2));
dy3 = y4;
dy4 = -(2*L1^2*L3*M1*u3 - 2*L1^2*L3*M1*u2 - 2*L1^2*L3*M2*u2 + 2*L2^2*L3*M2*u1 + 2*L1^2*L3*M2*u3 - L1^2*L3*M3*u2 - 2*L2^2*L3*M2*u2 + L2^2*L3*M3*u1 + L1^2*L3*M3*u3 - L2^2*L3*M3*u2 + L1*L2^2*M2*u3*cos(y3 - y5) + L1*L2^2*M3*u3*cos(y3 - y5) - L1^2*L2*M2*u3*cos(2*y3 + y5) - L1^2*L2*M3*u3*cos(2*y3 + y5) - L2^2*L3*M3*u1*cos(2*y5) + L2^2*L3*M3*u2*cos(2*y5) + L1^2*L3*M3*u2*cos(2*y3 + 2*y5) - L1^2*L3*M3*u3*cos(2*y3 + 2*y5) - L1*L2^2*M2*u3*cos(y3 + y5) - L1*L2^2*M3*u3*cos(y3 + y5) + 2*L1^2*L2*M1*u3*cos(y5) + L1^2*L2*M2*u3*cos(y5) + L1^2*L2*M3*u3*cos(y5) + 2*L1*L2^3*L3*M2^2*y2^2*sin(y3) + 2*L1^3*L2*L3*M2^2*y2^2*sin(y3) + 2*L1*L2^3*L3*M2^2*y4^2*sin(y3) - L1*L2*L3*M3*u1*cos(y3 + 2*y5) + 2*L1*L2*L3*M3*u2*cos(y3 + 2*y5) - L1*L2*L3*M3*u3*cos(y3 + 2*y5) + L1^2*L2*L3*M2^2*g*cos(y1 + y3) - L1*L2^2*L3*M2^2*g*cos(y1) - L1^2*L2*L3*M2^2*g*cos(y1 - y3) + L1*L2^2*L3*M2^2*g*cos(y1 + 2*y3) + 2*L1^2*L2^2*L3*M2^2*y2^2*sin(2*y3) + L1^2*L2^2*L3*M2^2*y4^2*sin(2*y3) + 2*L1*L2*L3*M2*u1*cos(y3) - 4*L1*L2*L3*M2*u2*cos(y3) + L1*L2*L3*M3*u1*cos(y3) + 2*L1*L2*L3*M2*u3*cos(y3) - 2*L1*L2*L3*M3*u2*cos(y3) + L1*L2*L3*M3*u3*cos(y3) + 2*L1^3*L2*L3*M1*M2*y2^2*sin(y3) + L1^3*L2*L3*M1*M3*y2^2*sin(y3) + 2*L1*L2^3*L3*M2*M3*y2^2*sin(y3) + 2*L1^3*L2*L3*M2*M3*y2^2*sin(y3) + 2*L1*L2^3*L3*M2*M3*y4^2*sin(y3) + 4*L1*L2^3*L3*M2^2*y2*y4*sin(y3) - (L1^2*L2*L3*M1*M3*g*cos(y1 + y3 + 2*y5))/2 - L1^3*L2*L3*M1*M3*y2^2*sin(y3 + 2*y5) + L1*L2^2*L3^2*M2*M3*y2^2*sin(y3 + y5) + L1*L2^2*L3^2*M2*M3*y4^2*sin(y3 + y5) + L1*L2^2*L3^2*M2*M3*y6^2*sin(y3 + y5) + L1^2*L2*L3*M1*M2*g*cos(y1 + y3) + (L1^2*L2*L3*M1*M3*g*cos(y1 + y3))/2 + L1^2*L2*L3*M2*M3*g*cos(y1 + y3) - 2*L1^2*L2*L3^2*M1*M3*y2^2*sin(y5) - L1^2*L2*L3^2*M2*M3*y2^2*sin(y5) - 2*L1^2*L2*L3^2*M1*M3*y4^2*sin(y5) - L1^2*L2*L3^2*M2*M3*y4^2*sin(y5) - 2*L1^2*L2*L3^2*M1*M3*y6^2*sin(y5) - L1^2*L2*L3^2*M2*M3*y6^2*sin(y5) - 2*L1*L2^2*L3*M1*M2*g*cos(y1) - L1*L2^2*L3*M1*M3*g*cos(y1) - L1*L2^2*L3*M2*M3*g*cos(y1) + (L1^2*L2*L3*M1*M3*g*cos(y1 - y3 - 2*y5))/2 + L1*L2^2*L3^2*M2*M3*y2^2*sin(y3 - y5) + L1^2*L2*L3^2*M2*M3*y2^2*sin(2*y3 + y5) + L1*L2^2*L3^2*M2*M3*y4^2*sin(y3 - y5) + L1^2*L2*L3^2*M2*M3*y4^2*sin(2*y3 + y5) + L1*L2^2*L3^2*M2*M3*y6^2*sin(y3 - y5) + L1^2*L2*L3^2*M2*M3*y6^2*sin(2*y3 + y5) - L1^2*L2*L3*M1*M2*g*cos(y1 - y3) - (L1^2*L2*L3*M1*M3*g*cos(y1 - y3))/2 - L1^2*L2*L3*M2*M3*g*cos(y1 - y3) + L1*L2^2*L3*M2*M3*g*cos(y1 + 2*y3) + (L1*L2^2*L3*M1*M3*g*cos(y1 - 2*y5))/2 + (L1*L2^2*L3*M1*M3*g*cos(y1 + 2*y5))/2 + 2*L1^2*L2^2*L3*M2*M3*y2^2*sin(2*y3) - L1^2*L2^2*L3*M1*M3*y2^2*sin(2*y5) + L1^2*L2^2*L3*M2*M3*y4^2*sin(2*y3) - L1^2*L2^2*L3*M1*M3*y4^2*sin(2*y5) + 2*L1^2*L2^2*L3*M2^2*y2*y4*sin(2*y3) + 4*L1*L2^3*L3*M2*M3*y2*y4*sin(y3) + 2*L1*L2^2*L3^2*M2*M3*y2*y4*sin(y3 + y5) + 2*L1*L2^2*L3^2*M2*M3*y2*y6*sin(y3 + y5) + 2*L1*L2^2*L3^2*M2*M3*y4*y6*sin(y3 + y5) - 4*L1^2*L2*L3^2*M1*M3*y2*y4*sin(y5) - 2*L1^2*L2*L3^2*M2*M3*y2*y4*sin(y5) - 4*L1^2*L2*L3^2*M1*M3*y2*y6*sin(y5) - 2*L1^2*L2*L3^2*M2*M3*y2*y6*sin(y5) - 4*L1^2*L2*L3^2*M1*M3*y4*y6*sin(y5) - 2*L1^2*L2*L3^2*M2*M3*y4*y6*sin(y5) + 2*L1*L2^2*L3^2*M2*M3*y2*y4*sin(y3 - y5) + 2*L1^2*L2*L3^2*M2*M3*y2*y4*sin(2*y3 + y5) + 2*L1*L2^2*L3^2*M2*M3*y2*y6*sin(y3 - y5) + 2*L1^2*L2*L3^2*M2*M3*y2*y6*sin(2*y3 + y5) + 2*L1*L2^2*L3^2*M2*M3*y4*y6*sin(y3 - y5) + 2*L1^2*L2*L3^2*M2*M3*y4*y6*sin(2*y3 + y5) + 2*L1^2*L2^2*L3*M2*M3*y2*y4*sin(2*y3) - 2*L1^2*L2^2*L3*M1*M3*y2*y4*sin(2*y5))/(L1^2*L2^2*L3*(M2^2 - M2^2*cos(2*y3) + 2*M1*M2 + M1*M3 + M2*M3 - M2*M3*cos(2*y3) - M1*M3*cos(2*y5)));
dy5 = y6;
dy6 = -(L1*L3^2*M3^2*u2 - L1*L2^2*M3^2*u3 - L1*L2^2*M2^2*u3 - L1*L3^2*M3^2*u3 - L2*L3^2*M3^2*u1*cos(y3) + L2*L3^2*M3^2*u2*cos(y3) - 2*L1*L2^2*M1*M2*u3 - 2*L1*L2^2*M1*M3*u3 + 2*L1*L3^2*M1*M3*u2 - 2*L1*L2^2*M2*M3*u3 - 2*L1*L3^2*M1*M3*u3 + 2*L1*L3^2*M2*M3*u2 - 2*L1*L3^2*M2*M3*u3 + L1*L2^2*M2^2*u3*cos(2*y3) + L1*L2^2*M3^2*u3*cos(2*y3) + L1*L3^2*M3^2*u2*sin(2*y3)*sin(2*y5) - L1*L3^2*M3^2*u3*sin(2*y3)*sin(2*y5) + L1*L2*L3*M3^2*u2*cos(y5) - 2*L1*L2*L3*M3^2*u3*cos(y5) - 2*L2*L3^2*M2*M3*u1*cos(y3) + 2*L2*L3^2*M2*M3*u2*cos(y3) - 2*L2^2*L3*M3^2*u1*sin(y3)*sin(y5) + 2*L2^2*L3*M3^2*u2*sin(y3)*sin(y5) + L2*L3^2*M3^2*u1*cos(2*y5)*cos(y3) - L2*L3^2*M3^2*u2*cos(2*y5)*cos(y3) + 2*L1*L2^2*M2*M3*u3*cos(2*y3) - L2*L3^2*M3^2*u1*sin(2*y5)*sin(y3) + L2*L3^2*M3^2*u2*sin(2*y5)*sin(y3) - L1*L3^2*M3^2*u2*cos(2*y3)*cos(2*y5) + L1*L3^2*M3^2*u3*cos(2*y3)*cos(2*y5) - L1*L2^2*L3^2*M2*M3^2*y2^2*sin(2*y3) - L1*L2^2*L3^2*M2^2*M3*y2^2*sin(2*y3) + 2*L1*L2^2*L3^2*M1*M3^2*y2^2*sin(2*y5) - L1*L2^2*L3^2*M2*M3^2*y4^2*sin(2*y3) - L1*L2^2*L3^2*M2^2*M3*y4^2*sin(2*y3) + 2*L1*L2^2*L3^2*M1*M3^2*y4^2*sin(2*y5) + L1*L2^2*L3^2*M1*M3^2*y6^2*sin(2*y5) + 2*L1*L2*L3*M1*M3*u2*cos(y5) - 4*L1*L2*L3*M1*M3*u3*cos(y5) + L1*L2*L3*M2*M3*u2*cos(y5) - 2*L1*L2*L3*M2*M3*u3*cos(y5) - 2*L2^2*L3*M2*M3*u1*sin(y3)*sin(y5) + 2*L2^2*L3*M2*M3*u2*sin(y3)*sin(y5) + 2*L1*L2*L3^3*M1*M3^2*y2^2*sin(y5) + 2*L1*L2^3*L3*M1*M3^2*y2^2*sin(y5) + L1*L2*L3^3*M2*M3^2*y2^2*sin(y5) + 2*L1*L2*L3^3*M1*M3^2*y4^2*sin(y5) + 2*L1*L2^3*L3*M1*M3^2*y4^2*sin(y5) + L1*L2*L3^3*M2*M3^2*y4^2*sin(y5) + 2*L1*L2*L3^3*M1*M3^2*y6^2*sin(y5) + L1*L2*L3^3*M2*M3^2*y6^2*sin(y5) - L1*L2*L3*M3^2*u2*cos(2*y3)*cos(y5) + 2*L1*L2*L3*M3^2*u3*cos(2*y3)*cos(y5) + L1*L2*L3*M3^2*u2*sin(2*y3)*sin(y5) - 2*L1*L2*L3*M3^2*u3*sin(2*y3)*sin(y5) - L1^2*L2*L3^2*M1*M3^2*y2^2*sin(y3) - 2*L1^2*L2*L3^2*M2*M3^2*y2^2*sin(y3) - 2*L1^2*L2*L3^2*M2^2*M3*y2^2*sin(y3) - 2*L1*L2^2*L3^2*M2*M3^2*y2*y4*sin(2*y3) - 2*L1*L2^2*L3^2*M2^2*M3*y2*y4*sin(2*y3) + 4*L1*L2^2*L3^2*M1*M3^2*y2*y4*sin(2*y5) + 2*L1*L2^2*L3^2*M1*M3^2*y2*y6*sin(2*y5) + 2*L1*L2^2*L3^2*M1*M3^2*y4*y6*sin(2*y5) + 2*L1*L2^3*L3*M1*M2*M3*y2^2*sin(y5) + 2*L1*L2^3*L3*M1*M2*M3*y4^2*sin(y5) - L1*L2*L3*M2*M3*u2*cos(2*y3)*cos(y5) + 2*L1*L2*L3*M2*M3*u3*cos(2*y3)*cos(y5) + 4*L1*L2*L3^3*M1*M3^2*y2*y4*sin(y5) + 4*L1*L2^3*L3*M1*M3^2*y2*y4*sin(y5) + 2*L1*L2*L3^3*M2*M3^2*y2*y4*sin(y5) + 4*L1*L2*L3^3*M1*M3^2*y2*y6*sin(y5) + 2*L1*L2*L3^3*M2*M3^2*y2*y6*sin(y5) + 4*L1*L2*L3^3*M1*M3^2*y4*y6*sin(y5) + 2*L1*L2*L3^3*M2*M3^2*y4*y6*sin(y5) + L1*L2*L3*M2*M3*u2*sin(2*y3)*sin(y5) - 2*L1*L2*L3*M2*M3*u3*sin(2*y3)*sin(y5) - L1*L2*L3^3*M2*M3^2*y2^2*cos(2*y3)*sin(y5) - L1*L2*L3^3*M2*M3^2*y2^2*sin(2*y3)*cos(y5) - L1*L2*L3^3*M2*M3^2*y4^2*cos(2*y3)*sin(y5) - L1*L2*L3^3*M2*M3^2*y4^2*sin(2*y3)*cos(y5) - L1*L2*L3^3*M2*M3^2*y6^2*cos(2*y3)*sin(y5) - L1*L2*L3^3*M2*M3^2*y6^2*sin(2*y3)*cos(y5) + 2*L1^2*L2^2*L3*M1*M3^2*y2^2*cos(y3)*sin(y5) - 2*L1^2*L2*L3^2*M1*M2*M3*y2^2*sin(y3) + L1*L2*L3^2*M1*M3^2*g*sin(y1)*sin(y3) + 2*L1*L2*L3^2*M2*M3^2*g*sin(y1)*sin(y3) + 2*L1*L2*L3^2*M2^2*M3*g*sin(y1)*sin(y3) + L1
没有合适的资源?快使用搜索试试~ 我知道了~
DynamicsModelMATLABSymbolic.zip_integral sliding_sliding_sliding
共8个文件
m:8个
1.该资源内容由用户上传,如若侵权请联系客服进行举报
2.虚拟产品一经售出概不退款(资源遇到问题,请及时私信上传者)
2.虚拟产品一经售出概不退款(资源遇到问题,请及时私信上传者)
版权申诉
0 下载量 91 浏览量
2022-07-15
14:15:04
上传
评论
收藏 6KB ZIP 举报
温馨提示
sliding mode control
资源推荐
资源详情
资源评论
收起资源包目录
DynamicsModelMATLABSymbolic.zip (8个子文件)
DynamicsModelMATLABSymbolic
Symb_Development_2DOF.m 1KB
Symb_Development_3DOF.m 2KB
main_sim_three_dof_arm.m 923B
two_dof_arm_dyn_for_ODE.m 108B
three_dof_arm_dyn_for_ODE.m 2KB
main_sim_two_dof_arm.m 964B
three_dof_arm_dyn.m 9KB
two_dof_arm_dyn.m 1KB
共 8 条
- 1
资源评论
林当时
- 粉丝: 95
- 资源: 1万+
上传资源 快速赚钱
- 我的内容管理 展开
- 我的资源 快来上传第一个资源
- 我的收益 登录查看自己的收益
- 我的积分 登录查看自己的积分
- 我的C币 登录后查看C币余额
- 我的收藏
- 我的下载
- 下载帮助
安全验证
文档复制为VIP权益,开通VIP直接复制
信息提交成功