工业机器人期末考试复习资料

1、第一章1机器人的分类1.按控制方式分: 操作机器人 程序机器人 示教再现机器人 数控机器人 智能机器人2按机器人的应用领域分类：产业用机器人 极限作业机器人 服务型机器人3.按机器人的关节链接布置形式分类：串联机器人 并联机器人串联机器人的杆件和关节是采用串联方式进行的连接（开链式），并联机器人的杆件和关节是采用并联方式进行的连接（闭链式）。并联机器人的优点：并联机器人具有刚度高，精度高，响应速度快，结构简单的特点，其不足之处在于工作的空间小，控制复杂。2.五种坐标形式的机器人直角坐标型机器人 圆柱坐标型机器人 球坐标型机器人 关节坐标型机器人 SCARA坐标型机器人3.工业机器人系统的组成1

2、.机器人系统是由机器人和作业对象及环境共同构成，其中包括机器人机械系统，驱动系统，控制系统，感知系统四大部分。(1)机械系统包括机身 臂部 手腕 末端操作器（手部）和行走机构组成(2)驱动系统主要指驱动机械系统动作的驱动装置。根据驱动源不同可分为电气压 液压 和气压驱动以及把他们结合起来应用的综合系统。(3)控制系统的任务是根据机器人的作业指令程序及从传感器反馈回来的信号，控制机器人的执行机构，使其完成规定的运动和功能。(4)感知系统由内部传感器和外部传感器组成，起作用是获取机器人内部和外部环境信息，并把这些信息反馈给控制系统。2.工业机器人的组要技术参数一般有自由度 精度 重复定位精度 工作

3、范围 承载能力及最大速度等。（大于6个自由度的称为long余自由度）P11承载能力指的是机器人在作业范围内的任何位姿（位置和姿态）上所能承受的最大质量。第二章1驱动方式：机器人常用的驱动方式主要有液压 气压 电气驱动3种基本类型。2三种驱动的优点和缺点（P19）：3谐波齿轮（重点）p244臂部设计的基本要求：(1)手臂应具有足够的承载能力和刚度 (2)导向性要好 (3)重量和转动惯量要小 (4) 运动要平稳定位精度要高P36的题220要去理解5手部的分类根据用途手部可以分为手爪和工具两大类，手爪具有一定的通用性，工具用于进行某种作业。根据其夹持原理，手部又可为机械钳爪式和吸附式两大类，其中吸附

4、式手部还可以分为磁力吸附式和真空吸附式。吸附式手部结构即为吸盘，主要有磁力吸附式和真空吸附式。6行走机构机器人可以分为固定式和行走式两种行走机构按其运动轨迹可分为固定轨迹式和无固定轨迹式。行走机构按其机构分为车轮式，步行式，履带式和其他方式。第三章计算题是课后16掌握3.1.1 齐次坐标 一、空间任意点的坐标表示在选定的直角坐标系A中，空间任一点P的位置可以用31的位置矢量AP表示，其左上标表示选定的坐标系A，此时有 AP=PX PY PZT 式中：PX、PY、PZ是点P在坐标系A中的三个位置坐标分量，如图1.1所示。坐标轴的方向表示在图1.2中，i、j、k分别表示直角坐标系中X、Y、Z坐标轴

5、的单位矢量，用齐次坐标表示之，则有图1.2 坐标轴的方向表示X=1 0 0 0 TY=0 1 0 0TZ=0 0 1 0T 由上述可知，若规定：4*1列阵a b c wT中第四个元素为零，且满足a2+b2+c2=1，则a b c 0T中a、b、c的表示某轴的方向； 4*1列阵a b c wT中第四个元素不为零，则a b c wT表示空间某点的位置。图1.2中所示的矢量u的方向用41列阵可表达为：u =a b c 0T(1.4)图1.2中所示的矢量u的起点O为坐标原点，用4*1列阵可表达为：O=0 0 0 1T旋转算子公式（必考）3、 算子左、右乘规则若相对固定坐标系进行变换，则算子左乘；若相对

6、动坐标系进行变换，则算子右乘。例1.4 已知坐标系中点U的位置矢量U=7 3 2 1T，将此点绕Z轴旋转90，再绕Y轴旋转90，如图1.11所示，求旋转变换后所得的点W。 连杆参数：连杆长度 连杆扭角 连杆距离 连杆转角。第五章机器人控制系统具有以下特点：（1） 机器人控制系统本质上是一个非线性系统；（2） 机器人控制系统是由多关节组成的一个多变控制系统，而且关节间具有耦合作用；（3） 机器人控制系统是一个时变系统；机器人的位置控制可分为点位控制和连续控制。PID控制是自动化中广泛使用的一种反馈控制，其控制由比例单元（p）积分单元（i）和积分单元（D）组成，利用信号的偏差值，偏差的积分值偏差的

7、微分值的组合来构成操作量，操作两种包括了偏差信号的现在，过去，未来三方面的信息，所以是一种经典的控制方式。第六章1传感器定义传感器利用物体的物理化学变化，并将这些变化变换成电信号（电压，电流和频率）的装置传感器组成：敏感元件 转换元件和基本转换电路敏感元件的基本功能是将某种不容易测量的物理量转换为易测量的物理量。转换元件的功能是将敏感元件输出的物理量转换为电量，它与敏感元件构成传感器的主要部分。基本转换电路的功能是敏感元件产生的不易测量值的小信号进行变换，是传感器的信号输出符合具体工业系统的要求。机器人使用的传感器可分为内部传感器和外部传感器两大类。（1）内部传感器是用于测量机器人自身状态的参

8、数（如手臂间的角度）的功能元件。（2）外部传感器用于测量与机器人作业有关的的外部信息，这些信息通常与机器人的目标识别，作业安全有关。传感器的性能指标：灵敏度 线性度 测量范围 精度 重复性 分辨率 响应时间 抗干扰能力位置和位移传感器根据其工作原理和组成的不同多种形式，常见的有电阻式位移传感器，电容式位移传感器，编码式位移传感器，霍尔元件位移传感器 磁栅式位移传感器电位器式位移传感器可以分成两大类：直线型电位器式位移传感器 旋转型电位器式位移传感器2光电编码器根据测量原理编码器可分为接触式和非接触式两种，接触式编码器采用电刷输出，以电刷接触到点区和绝缘区分别表示代码的1和0，非接触处编码器的敏

9、感元件是光敏元件和磁敏元件，采用光敏元件时以透光区和不透光区表示代码1和0 。根据测出的信号，编码器可分为绝对式和增量式两实验部分舵机的内部结构：一般来说，我们用的舵机有以下几个部分组成：直流电动机、减速器（减速齿轮组）、位置反馈电位计、控制电路板（比较器）。舵机的输入线共有三根，红色在中间，为电源正极线，黑色线是电源负极（地线）线，黄色或者白色线为信号线。其中电源线为舵机提供6V到7V左右电压的电源。2、PWM信号控制精度制定上面已经提到了八位单片机，我们的舵机需要的是方波信号。单片机的精度直接影响了舵机的控制精度，这里就详细的说明一下。我们采用的是8位STC12C5410ADCPU，其数据

10、分辨率为256，那么经过舵机极限参数实验，得到应该将其划分为250份。那么0.5mS-2.5Ms的宽度为2mS = 2000uS。2000uS250=8uS则：PWM的控制精度为8us我们可以以8uS为单位递增控制舵机转动与定位。舵机可以转动185度，那么185度250=0.74度，则：舵机的控制精度为0.74度图4-4我们在这里做了一些名词上的定义。DIV是一个时间位置单位，一个DIV等于8us，关系入公式：1 DIV = 8uS 250DIV=2mS实际寄存器内的数值为：（#01H）01 （#0FAH）250。共185度，分为250个位置，每个位置叫1DIV。则：185250 = 0.74

11、度 / DIVPWM高电平函数： 0.5mS + NDIV 0uS NDIV 2mS 0.5mS 0.5Ms+NDIV 2.5mS根据这些知识，我们就可以开始编程，并做一些初步的实验了，学会舵机控制是研究机器人的一个比较技术手段，需要完全掌握。/ / 函数原型：void sorting()/ 函数名称：排序子程序(Sorting Subroutine)/ 功 能：对所有通道口的数值进行排序。/ 参 数：/ 返 回 值：无/ void sorting()uchar i=0,j=0,x=0;/定义循环变量/为选择的输出通道提供低电平kouchu0=0xFE;/11111110kouchu1=0xF

12、D;/11111101kouchu2=0xFB;/11111011kouchu3=0xF7;/11110111kouchu4=0xEF;/11101111kouchu5=0xDF;/11011111kouchu6=0xBF;/10111111kouchu7=0x7F;/01111111/通过冒泡法排序，将舵机目的位置数值按从小到大的顺序排列起来for(i=0;i=6;i+)for(j=i+1;j=7;j+)if(paixu_nchaipaixu_nchaj) /交换数据x=paixu_nchaj;paixu_nchaj=paixu_nchai;paixu_nchai=x;x=kouchuj;k

13、ouchuj=kouchui; /交换数据kouchui=x;6根据动作需要将各端口输出通道按舵机目的位置的数值大小进行排序7、将排好序的数值进行N差计算，得出每相邻的两个数值间的差值，用于累计延时获/ / 函数原型：void N_value()/ 函数名称：N差子程序(N poor Subroutine)/ 功 能：对临近数值做差，求出相对差值，用于延时。/ 参 数：/ 返 回 值：无/ void N_value()uchar i;/定义循环变量for(i=0;i=6;i+)paixu_nchai=paixu_nchai-paixu_nchai+1; / N差计算得NDIV动作要求高电平时长

14、。/ / 函数原型：sao_wei(uchar saowei)/ 函数名称：扫尾子程序/ 功 能：控制舵机转动的速度和加速度/ 影 响：/ 入口参数：saowei,表示扫尾系数/ 返 回 值：无/ void sao_wei(uchar saowei)uchar i; /定义循环变量for(i=0;isaowei;i+)delay_500us();/调用延时500us函数8、为舵机每一次动作提供间隔延时，用来控制其整体的动作速度任务一：如何让机器人摆头注：减小舵机每次循环的增量可以增加动作的流畅度。baitou(uchar cnt);主函数调用范例：void baitou(uchar cnt)u

15、char i,j;/定义循环变量for(j=0;jcnt;j+)/同一动作整体执行cnt次for(i=0;i100;i+)/循环次数设定为100position1+; /控制1号舵机逆时针旋转，每次循环增量为1，身体右摆100PWM_16();/调用舵机输出子程序控制舵机运动sao_wei(15);/为机器人动作提供间隔延时7.5mS，控制机器人运动速度for(i=0;i200;i+)/循环次数设定为200position1-; /控制1号舵机顺时针旋转，每次循环增量为1，身体左摆200PWM_16();/调用舵机输出子程序控制舵机运动sao_wei(30);/为机器人动作提供间隔延时15mS

16、，控制机器人运动速度for(i=0;i100;i+)/循环次数设定为100position1+; /控制1号舵机逆时针旋转，每次循环增量为1，身体右摆100PWM_16();/调用舵机输出子程序控制舵机运动sao_wei(15);/为机器人动作提供间隔延时7.5mS，控制机器人运动速度动作函数详解：任务二：如何让机器人鞠躬主函数调用范例：jugong(uchar step,uchar times)；动作函数详解：void jugong(uchar step,uchar times) uchar i,j; /定义循环变量 for(i=0;itimes;i+)/设定鞠躬次数 for(j=0;jst

17、ep;j+)/设定鞠躬幅度position0+; /控制0号舵机逆时针旋转，每次循环增量为1，右腿position2-; /控制2号舵机顺时针旋转，每次循环增量为1，左腿PWM_16(); sao_wei(20);for(j=0;jstep;j+)position0-; /控制0号舵机顺时针旋转，每次循环增量为1，右腿position2+; /控制2号舵机逆时针旋转，每次循环增量为1，左腿PWM_16();sao_wei(20); delay_500ms();注：同时控制多部舵机时，虽然是依次进行设置，但是舵机是在得到“PWM_16();”中的动作命令后同步开始执行动作的。任务三：如何让机器人

18、踢球主函数调用范例：tiqiu();动作函数详解：void tiqiu()uchar i;/定义循环变量/左摆头for(i=0;i100;i+)position1-;PWM_16();sao_wei(30);/抬右脚for(i=0;i50;i+)position0+;PWM_16();sao_wei(10);/落右脚for(i=0;i50;i+)position0-;PWM_16();sao_wei(10);/身体复位for(i=0;i100;i+)position1+;PWM_16();sao_wei(30);任务四：如何让机器人左转、右转主函数调用范例：turn_l(3);/左转turn_

19、r(3);/右转动作函数详解：（void turn_l(uchar times)uchar i,j;for(j=0;jtimes;j+)/左摆身,重心左移for(i=0;i40;i+)position1-=2; PWM_16(); sao_wei(15);/抬右脚for(i=0;i10;i+)position0+=2; PWM_16();sao_wei(15);/重心中移for(i=0;i100;i+)position1+=1; PWM_16();sao_wei(15);/磨擦转身for(i=0;i20;i+)position0-=1; position1-; PWM_16(); sao_we

20、i(30);delay_500ms();1）左转（2）右转void turn_r(uchar times)uchar i,j;for(j=0;jtimes;j+)/右摆身,重心右移for(i=0;i40;i+)position1+=2; PWM_16(); sao_wei(15);/抬左脚for(i=0;i10;i+)position2-=2; PWM_16();sao_wei(15);/重心中移for(i=0;i100;i+)position1-=1; PWM_16(); sao_wei(15);/磨擦转身for(i=0;i20;i+)position2+=1;position1+=1;PWM_16(); sao_wei(30); delay_500ms();注：此动作的编写过程中应考虑到重心的偏移，以及脚部与地面的摩擦效果。任务五：如何让机器人行走主函数调用范例：walking(uchar step);动作