三轮全向机器人原理及matlab仿真

选择MATLAB2016a版，高版本不能安装。

安装好按照下面的操作做出来，然后截图做成Word文档发给我。

MATLAB2016a版同学们网上下载安装，安装方法网上随便可找到。

机器人工具箱我发给你们。

一、将文件夹放到MATLAB安装文件夹指定目录下放到安装目录的toolbox文件夹下，如下图是笔者的电脑的位置，其中那个installation address是我自己取得名字，英语不好，不要见怪。

三、打开MATLAB软件，进行手动启动（1）打开matlab，依次点击file（文件）-setpath（设置路径）-add with subfolder （添加子文件夹），然后选择这个rvctools文件夹就好了，然后save（保存）-close （关闭）（2）在命令行窗口输入startup_rvc，回车，如图，显示了一段英语，我恩可以看到，版本是9.10。

本文主要是给大家一个系统的概念，如何用Matlab实现六轴机器人的建模和实现轨迹规划。

以后将会给大家讲解如何手写正逆解以及轨迹插补的程序。

程序是基于Matlab2016a，工具箱版本为Robotic Toolbox 9.10。

1.D-H建模三个两两相互垂直的XYZ轴构成欧几里得空间，存在六个自由度：沿XYZ 平移的三个自由度，绕XYZ旋转的三个自由度。

在欧几里得空间中任意线性变换都可以通过这六个自由度完成。

Denavit-Hartenberg提出的D-H参数模型能满足机器人学中的最小线性表示约定，用4个参数就能描述坐标变换：绕X轴平移距离a；绕X轴旋转角度alpha；绕Z轴平移距离d；绕Z轴旋转角度theta。

2.标准D-H模型和改进D-H模型对比来看参数并没有改变，标准的D-H 模型是将连杆的坐标系固定在该连杆的输出端（下一关节），也即坐标系i-1与关节i对齐；改进的D-H模型则是将坐标系固定在该连杆的输入端（上一关节），也即坐标系i-1与关节对齐i-1。

MATLAB 机器人工具箱仿真程序:1) 运动学仿真模型程序()L1=link([pi/2 150 0 0])L2=link([0 570 0 0])L3=link([pi/2 130 0 0])L4=link([-pi/2 0 0 640])L5=link([pi/2 0 0 0])L6=link([0 0 0 95]) r=robot({L1 L2 L3 L4 L5L6}) ='MOTOMAN-UP '6 % 模型的名称 >>drivebot(r)2）正运动学仿真程序 （）L1=link([pi/2 150 0 0]) L2=link([0 570 0 0])L3=link([pi/2 130 0 0]) L4=link([-pi/2 0 0640]) L5=link([pi/2 0 0 0]) L6=link([0 0 095]) r=robot({L1 L2 L3 L4 L5 L6})='MOTOMAN-UP '6 t=[0::10];% 产生时间向量 qA=[00 0 0 0 0 ]; % 机械手初始关节角度 qAB=[-pi/2-pi/3 0 pi/6 pi/3 pi/2 ];%figure('Name','up6 机器人正运动学仿真演示q=jtraj(qA,qAB,t);% 生成关节运动轨迹T=fkine(r,q);% 正向运动学仿真函数plot(r,q);% 生成机器人的运动figure('Name','up6 机器人末端位移图 ' )subplot(3,1,1);plot(t, squeeze(T(1,4,:))); xlabel('Time (s)'); ylabel('X (m)');subplot(3,1,2); plot(t, squeeze(T(2,4,:)));xlabel('Time (s)');ylabel('Y (m)'); subplot(3,1,3);plot(t, squeeze(T(3,4,:))); xlabel('Time(s)'); ylabel('Z (m)'); x=squeeze(T(1,4,:)); 机械手终止关节角度 '）;% 给仿真图像命名y=squeeze(T(2,4,:)); z=squeeze(T(3,4,:)); figure('Name','up6 机器人末端轨迹图');plot3(x,y,z);3)机器人各关节转动角度仿真程序： ()L1=link([pi/2 150 0 0 ])L2=link([0 570 0 0]) L3=link([pi/2 130 0 0]) L4=link([-pi/2 0 0 640]) L5=link([pi/2 0 0 0 ]) L6=link([0 0 0 95]) r=robot({L1 L2 L3 L4 L5 L6}) ='motoman-up6' t=[0::10];qA=[0 0 0 0 0 0 ]; qAB=[ pi/6 pi/6 pi/6 pi/6 pi/6 pi/6]; q=jtraj(qA,qAB,t);Plot(r,q); subplot(6,1,1); plot(t,q(:,1)); title(' 转动关节1');xlabel（' 时间/s'）; ylabel（' 角度/rad'）; subplot（6,1,2）; plot（t,q（:,2））;title（' 转动关节2'）; xlabel（' 时间/s'）; ylabel（' 角度/rad'）; subplot（6,1,3）; plot（t,q（:,3））;title（' 转动关节3'）; xlabel（' 时间/s'）; ylabel（' 角度/rad'）; subplot（6,1,4）; plot（t,q（:,4））;title（' 转动关节4'）; xlabel（' 时间/s'）; ylabel（' 角度/rad' ）; subplot（6,1,5）; plot（t,q（:,5））;title（' 转动关节5'）; xlabel（' 时间/s'）; ylabel（' 角度/rad'）; subplot（6,1,6）; plot（t,q（:,6））;title（' 转动关节6'）; xlabel（' 时间/s'）; ylabel（' 角度/rad'）;4）机器人各关节转动角速度仿真程序：（）t=[0::10];qA=[0 0 0 0 0 0 ];% 机械手初始关节量qAB=[ ];[q,qd,qdd]=jtraj（qA,qAB,t）;Plot(r,q); subplot(6,1,1); plot(t,qd(:,1));title(' 转动关节1'); xlabel(' 时间/s'); ylabel('rad/s'); subplot(6,1,2); plot(t,qd(:,2));title(' 转动关节2'); xlabel(' 时间/s'); ylabel('rad/s'); subplot(6,1,3); plot(t,qd(:,3));title(' 转动关节3'); xlabel(' 时间/s'); ylabel('rad/s'); subplot(6,1,4); plot(t,qd(:,4));title(' 转动关节4'); xlabel(' 时间/s'); ylabel('rad/s' ); subplot(6,1,5); plot(t,qd(:,5));title(' 转动关节5'); xlabel(' 时间/s'); ylabel('rad/s'); subplot(6,1,6); plot(t,qd(:,6));title(' 转动关节6'); xlabel(' 时间/s');ylabel('rad/s');5）机器人各关节转动角加速度仿真程序：（）t=[0::10];% 产生时间向量qA=[0 0 0 0 0 0] qAB =[ ];[q,qd,qdd]=jtraj(qA,qAB,t);figure('name','up6 机器人机械手各关节加速度曲线'); subplot(6,1,1);plot(t,qdd(:,1));title(' 关节1');xlabel(' 时间(s)');ylabel('加速度(rad/s^)');subplot(6,1,2);plot(t,qdd(:,2));title(' 关节2');xlabel(' 时间(s)');ylabel('加速度(rad/s^)');subplot(6,1,3); plot(t,qdd(:,3));title(' 关节3');xlabel(' 时间(s)');ylabel('加速度(rad/s^)')subplot(6,1,4); plot(t,qdd(:,4));title(' 关节4');xlabel(' 时间(s)');ylabel('加速度(rad/s^)')subplot(6,1,5); plot(t,qdd(:,5)); title(' 关节5');xlabel(' 时间(s)');ylabel('加速度(rad/s^)')subplot(6,1,6); plot(t,qdd(:,6)); title(' 关节6');xlabel(' 时间(s)');ylabel('加速度(rad/s^)')。

机器人仿真原理一、机器人仿真的基本概念和意义机器人仿真是指在计算机上以某种方法模拟机器人的运动、操作、控制等过程的方法。

广泛应用于机器人系统设计、控制算法验证等领域。

机器人仿真系统通常包括机械结构、传动系统、控制系统、传感器系统和软件系统等部分，采用某种仿真软件，通过建立机器人的数学模型，利用计算机来对机器人的行为进行模拟，验证控制算法的性能和优良，以及进行设计上的优化。

机器人仿真在机器人研究和开发中具有重要的意义。

首先机器人仿真可以降低实验成本，减少对设计样机、实体试验的需求，加速研发周期，增强研发人员的开发能力和工作效率；其次，通过模拟机器人或其供应商感应人员之间的相互关系，间接提高生产线上的效率，把人工操作转化为自动化操作；最后，利用机器人仿真技术，我们可以在设计过程中发现问题并及时解决,最终提高了机器人制造的质量。

二、机器人仿真的数学建模机器人仿真的数学模型是机器人控制系统仿真的基础，也是模拟机器人运动、位置、速度、力和扭矩等行为的理论基础。

机器人的数学模型通常由以下几个部分组成：机器人动力学模型、机器人运动学模型、传动系统模型、传感器模型、环境模型和控制算法模型。

1、机器人动力学模型机器人动力学模型主要用于描述机器人的运动轨迹和动态特性，包括机器人的质量、摩擦、惯性、外力和力矩等因素。

机器人动力学模型包括牛顿运动定律、欧拉定理等，利用这些定理建立的运动学模型可以描述机器人的加速度、速度和位置等物理量。

2、机器人运动学模型机器人运动学模型主要用于描述机器人的位置、角度、末端执行器的位置和速度等运动状态。

其主要基于欧拉角、欧拉转角变换等数学模型，通过这些模型建立了机器人末端在三维空间中与其基座之间的几何关系。

3、传动系统模型传动系统模型描述机器人用户在机器人控制系统中的传动和调节过程，包括机器人公差、误差、刚度、噪声和传动系统控制等因素。

4、传感器模型传感器模型用于描述机器人的感应元件，包括视觉传感器、力矩传感器、距离传感器等。

三轮全向机器人运动特性分析1.全方向移动能力：三轮全向机器人通过将三个轮子安装在平衡的位置上，可以实现全方向移动。

每个轮子都可以独立地控制并进行旋转。

这使得机器人在狭小的空间内可以自由移动，并能够在任意方向上快速转向。

这种特性使得三轮全向机器人在繁忙的环境中具有灵活性和机动性。

2.高度可交互性：三轮全向机器人还具有很高的可交互性。

它可以通过传感器和摄像头来感知周围环境，并能够与人进行有效的交互。

这使得机器人可以在人群中安全运动，并可以执行一些与人互动的任务，如自主导航、传递物品等。

这种可交互性使得三轮全向机器人在服务行业中有广泛的应用潜力。

3.运动灵活性：三轮全向机器人具有非常好的运动灵活性。

不仅可以在水平面上自由移动，还可以实现沿任意方向的旋转。

这种灵活性使得机器人可以根据不同的任务需求进行自适应运动，并可以在狭小的空间中灵活穿梭。

这种运动灵活性使得机器人在仓储、物流和生产等领域具有广泛的应用前景。

4.稳定性和准确性：三轮全向机器人在移动过程中具有良好的稳定性和准确性。

由于每个轮子都可以独立控制，机器人可以根据需要进行微调和平衡，这使得机器人可以在不同地面上保持稳定移动。

此外，机器人还可以通过精确控制轮子的旋转来实现精确定位和导航。

这种稳定性和准确性使得机器人能够执行一些精确度要求较高的任务，如精确导航、运输和操作等。

尽管三轮全向机器人具有上述的优势特点，但也存在一些挑战和限制。

例如，由于机器人需要较强的计算能力和感知能力来实现全方向移动和交互功能，所以需要配备先进的计算控制系统和感知设备。

此外，机器人在特殊地形上的运动性能可能会受到限制，如不平整地面、斜坡等。

因此，在设计和应用三轮全向机器人时需要综合考虑这些限制因素，以实现机器人的良好性能和可靠性。

总的来说，三轮全向机器人在机动性、交互性、灵活性、稳定性和准确性方面具有优势。

它在服务行业、仓储物流和生产等领域有广泛的应用前景，可以帮助人们提高工作效率和生活质量。

计算机辅助设计报告三轮全向移动机器人运动控制仿真9004 余杨广9019 沈阳9031 陈斌人员分工：余杨广：总体负责，系统理解及控制器设计，PPT制作，后期报告审查及修改陈斌：PPT制作，报告撰写沈阳：资料收集，辅助其余两人完成任务目录一、实验目的............................................................................................错误!未定义书签。

二、实验原理............................................................................................错误!未定义书签。

控制对象——三轮全向机器人....................................................错误!未定义书签。

控制系统结构 .........................................................................................错误!未定义书签。

三、实验内容............................................................................................错误!未定义书签。

电机模型....................................................................................................错误!未定义书签。

物理建模............................................................................................错误!未定义书签。

轮全向机器人原理及m a t l a b仿真--------------------------------------------------------------------------作者: _____________--------------------------------------------------------------------------日期: _____________计算机辅助设计报告三轮全向移动机器人运动控制仿真004 余杨广沈阳人员分工：余杨广：总体负责，系统理解及控制器设计，PPT制作，后期报告审查及修改陈斌：PPT制作，报告撰写沈阳：资料收集，辅助其余两人完成任务目录一、实验目的.............................................................................................................................二、实验原理.............................................................................................................................2.1控制对象——三轮全向机器人.....................................................................................2.2 控制系统结构 ...................................................................................................................三、实验内容.............................................................................................................................3.1电机模型 ............................................................................................................................3.1.1物理建模 ..................................................................................................................3.1.2 Simulink模块搭建.....................................................................................................3.1.3无刷直流电机仿真模型的验证..............................................................................3.2运动学模型 ........................................................................................................................3.2.1物理建模..................................................................................................................3.2.2 Simulink模块搭建 ....................................................................................................3.3 路径规划 ...........................................................................................................................3.4. 传感器设计 .....................................................................................................................3.5.控制器设计 .......................................................................................................................3.5.1 电机控制器设计......................................................................................................3.5.2 运动控制器设计 ....................................................................................................3.6 观测器 ...............................................................................................................................四、结果验收 ....................................................................................................................................4.1 x轴方向的误差 ................................................................................................................4.2 y轴方向的误差 ................................................................................................................4.3 前进方向偏角θ .................................................................................................................4.4 速度误差 ...........................................................................................................................五、致谢 ............................................................................................................................................六、附录（路径规划函数）.............................................................................................................一、实验目的（一）建立三轮全向机器人系统的数学模型，然后基于simulink建立该系统的仿真模型并设计控制器，最终满足控制要求；（二）控制的最终目的是使该机器人能够良好跟踪预期的运动轨迹；（三）通过对复杂系统的分析、建模、仿真、验证，全面提高利用计算机对复杂系统进行辅助设计的能力；（四）通过集体作业、分工完成任务的方式培养团队意识，提高团队集体攻关能力二、实验原理2.1控制对象——三轮全向机器人三轮全向移动机器人其驱动轮由三个全向轮组成，径向对称安装，各轮互成120°角，滚柱垂直于各主轮。

三轮机器人的运动学分析为了精确的定位及可靠地控制机器人，有必要对机器人进行运动学分析，已得到机器人的运动规律。

为了计算各个原动件的驱动力、驱动转矩以及各个零部件的受力，应进行机构的动力学分析，从而为原动件选型、零部件的设计与校核提供理论依据。

本章将首先对上一章所选择的各功能模块机构建立运动学和动力学模型，进行理论计算，得到相应的规律和参数，从而完成对理论分析。

1.1 机器人的运动分析1.1.1 机器人运动标准模型三个全向轮驱动的机器人共有三个运动自由度，两个平动一个转动。

在实际情况中实际制作出来的机器人不可能完全与理论设计的一样，这里通过合理假设简化问题、忽略次要因素。

假设：1、不考虑机器人加工装配的误差，臂长都为0a ，各臂间夹角都为120度轮子安装都与臂相垂直。

2、不考虑机器人各部分受力后的变形导致几何尺寸的变化。

3、地面水平无凹凸。

图1.1三全向轮驱动机器人标准模型简图如图3.1所示，令321a a a 分别为中心到各轮中心的矢量，长度称为臂长。

⎪⎩⎪⎨⎧⋅⋅=⋅⋅==)0),sin(),cos(()0),sin(),cos(()0,0,(34343323221ππππa a a a a a a a(1.1)以逆时针为正，则机器人三轮转动的线速度单位方向向量为⎪⎩⎪⎨⎧===），，（），，（），，（0)sin()cos(0)sin()cos(0)sin()cos(611611367672221ππππππv v v e e e(1.2) 三轮线速度大小为321V V V 、、三个轮子中心及机器人中心移动的速度为 ⎪⎪⎩⎪⎪⎨⎧====），（），（），（），（0,0,0,0,2232221110y x y x y x y x v v v v v v v v v v v v(1.3) 机器人旋转的角速度为）（ωω,0,0=则由矢量关系得i i a v v⨯+=ω0 (1.4)vi i i e v V∙= (1.5)通过matlab 编程求解得到机器人运动状态与机器人三轮转动的线速度的关系为⎪⎪⎩⎪⎪⎨⎧+-=+--=+=ωωωa v v V a v v V a v V y x y x y 21233212321 (1.6) 令⎥⎥⎥⎦⎤⎢⎢⎢⎣⎡=321V V V V ，a a aA 2123212310---=，⎥⎥⎥⎦⎤⎢⎢⎢⎣⎡=ωy x v v RB (1.7)关系式写成矩阵形式为：RB A V ⋅= (1.8)式（3.8）便是机器人运动与三个驱动轮的转动速度的关系式。