基于SimMechanics的多刚体机械建模教案分析.ppt

基于SimMechanics的多刚体机械建模 天津科技大学：机械工程肖志鹏 xiao_pcuser2010@sina.cn 主要内容 并联机器人介绍 模型建立 倒立摆模型 实例 并联机器人介绍 有两个或以上的串联机器人来支撑机器人末端执行器的系统称为并联机器人。 在并联机器人应用领域最典型的结构有三种： Stewart平台 Delta机器人 瑞士洛桑理工大学 H4机器人 法国LIPMM实验室 Diamond机器人 天津大学黄田 Tricept机器人 Neumann DELTA机器人机构简图 机器人机械结构 SolidWorks模型 通过Grübler公式可以确定DELTA并联机器人总的自由度: 简化后机构简图 l 连杆数、n 关节总数、f 关节自由度数 结论：DELTA机器人执行末端只有三个沿坐标轴平移自由度。 DELTA机器人自由度 DELTA机器人运动学反解 机器人的运动学分析主要研究机器人的正反解问题。并联机器人运动学反解比较容易，而正解非常复杂。 设执行末端坐标(x0,y0,z0),根据几何关系,可以求出运动学逆解 坐标系 再根据运动学逆解反推，可以求解出运动学正解。 DELTA工作空间 机器人的工作空间是机器人执行末端的工作范围，是衡量机器人性能的一个重要指标。工作空间的分析是机器人结构设计的一个重点。 在MATLAB里计算，尽量不要使用多重for循环，很慢。大部分的循环计算都能使用矩阵运算代替。 初代工作空间 现在工作空间 模型建立 SimMechanics模型 总体模型 SimMechanics模型 单个支链SimMechanics模型 控制系统 控制系统是采用机器人状态反馈信号的半闭环控制系统。控制方法是PID控制。 系统控制框图 PID控制模型 轨迹控制 设计的机器人主要实现抓放操作，即从A点抓取物体移动B点释放。通常的实现方法是采取门形轨迹。 通过机器视觉图像处理的方法获取种子的位置信息。构建出空间上执行末端的运动轨迹，再求出各个关节的理论位置作为参考量提供给控制器。 行走轨迹 种子分拣信息 仿真系统 综合Simulink模型 实例（建一个Delta物理模型） 零件尺寸 静平台： 各个零件图中的坐标都是相对坐标 主动臂： 从动臂： 动平台： 建模步骤 静平台： 轴对称的形状，坐标系旋转对后面建模有很大帮助，三条支链只需使用一样的参数 参数设置： 建模步骤 主动臂： 三个主动臂都是相同的，只需设置一个，其它复制即可。 参数设置： 建模步骤 从动臂： 轴对称的形状，坐标系旋转对后面建模有很大帮助，三条支链只需使用一样的参数 参数设置： 建模步骤 主动臂： 到这物理建模都完成了 参数设置： 倒立摆模型 倒立摆模型 倒立摆仿真模型 封装 经过封装，把模型的一些参数变成可变的。使得模型修改更加方便直观。 倒立摆模型 BLOCK模型 LINK外形是通过函数定义的，其定义是写在模块的封装里头。 LINK模型