危险品处理机器人机械手控制系统设计方案

《危险品处理机器人机械手控制系统设计方案》由会员上传分享，免费在线阅读，更多相关内容在工程资料-天天文库。

1、危险品处理机器人机械手控制系统设计方案发布时间：2010-8-2115:46发布者：lavida阅读次数：75一：系统概述危睑品处理机器人是用于危睑弹药（一般在野外）夹持、拔出、搬运和放置作业，并可携带和放置的装置。该项目的完成将解决长期困扰我军的事故炮弹、战争遗留弹等危险弹药安全处理问题。机械手是危险品处理机器人操作过程中直接与弹药接触的重要部件，主要用于执行对危险弹药的夹持、拆除、搬运和放置作业，机械手工作的稳定性直接决定務弹药处理的成功率，因此机械手的设计至关重要。二：机械手1.结构形式为保证作业的灵活性，机械

2、手设计为由腰身、大臂、小臂、手爪组成，共具有3个关节（腰身-大臂、大臂-小臂、小臂-手爪）7个自由度（腰身ldof,大臂ldof,小臂ldof,手腕4dof）。其中:腰身一一1口由度，做旋转运动。固定安装在机器人车底盘上，以车体正前方为基准，可分别向左右旋转约135°（具体可旋转角度应参考车体镯驶控制室位置确定，以避免机械手向后方旋转时碰到駕驶控制室或其它物体），两端各有限位装置以避免自体碰撞。由液压控制运动，在底部装有电位计反馈准确位置以保证控制糟度。大臂、小臂一一各1自由度，分别相对于前一级关节做上下运动。以车体

3、水平面为基准，大肾可向上运动45。、向下运动30o,小臂可向上运动25。、向下运动60o。由液压控制运动，用电位计回馈，保证关节位置准确。手爪一一4自由度，分别做上下摆动、旋转、伸缩、夹持运动。以小臂延长线为基准，手爪可上下摆动±90°,又可以小臂为基准轴旋转±180。，伸1米，均采用伺服电机提供动力，通过减速箱减速保证功率需求，由伺服电机控制器控制。冇编码盘反馈，保证位置准确。腰身，大小臂液压回路冇压力传感器保护。油压冇稳定装置。2.控制系统机械手操作可在视觉传感器及控制系统的指示、控制下进行粗定位，操作人员能够凭

4、视图像进行准确定位、夹持等动作控制。摄像机安装在机器人车前端以及机械手腕上，以供环境及操作对象的立体图像和近距离图像。机械手控制系统由总控制器、液压控制器、伺服控制器组成，各控制器的控制芯片2407DSP。总控制器通过RS232总线接收遥控端指令，通过can总线分配任务给液压和伺控制器控制机械手各执行机构动作。机械手运动分单轴动和联动：单轴动是接收上位机发的的步进指令：联动是接收上位机发送的空间位置，通过运动学计算，转换成机械手在其座坐标系的坐标，将机械手运动、调整到指定位胃•和姿态，同时要解决机械手运动与抓取周围环

5、境的干涉。机械手的手动控制方式如下：遥控端控制面板上有伺服电机控制和液压控制按钮，和两个摇杆，摇杆有上下左右4个方向，当按下伺服电机控制按钮后第一个摇杆的上下方向控制旋转自由度的伺服电机，上左转,下右转，同时AD采样可采到摇杆的推动幅度来控制输出电压，从而控制伺服电机转速，同理第一个摇杆的左右方向和第二摇杆的两对方向控制另外三个伺服电机，当按下液压按钮时液压油泵和阀开关打开，同时两个摇杆冇三对方向分别控制液压的旋转、大臂、小臂的工作，在每个口由度上都装冇限位开关，限制各动作幅度。3、硬件设计机械手的三块控制器的控制

6、芯片都为2407DSP,虽然三块控制器实现的功能不同，但在硕件电路设计时按照DSP管脚的功能，设计外围电路如下：(1)PWM管脚：DSP的每个爭件管理器都有与比较单元和关的PWM电路，能够产生六路带可编程死区和输出极性的PWM输出，但是都是成对输岀的，对于本控制器需要的独立的输出，每个事件管理器只有3路,一个DSP冇两个事件管理器，可以独立的输出6路PWH波。液压控制器需要6路PW1波驱动电业比例阀,而伺服屯机控制器需耍4路0-5V的加速器信号调节电机转速，在设计电路时将这两种电路设计在一起，并制成印刷电路板，焊板

7、时按每板的功能焊接即可，液压控制器需要输出PWM波形，芯片用LM393做比较器，此时电阻R19和电容C71不焊即可，但要有R21上拉电阻，R17和R18将2脚电压分在1.7V左右比较合适。伺服控制器需要输出0-5V电压芯片用LM2901做运放用，焊电阻R19和电容C17不用M0S管、R21和外接电源，也不用焊R17,直接将DSP输出0-3.3V电压放大到0-5V输出。PWM/电压输出电路图见图1：图1PWM/电压输出电路(2)T口：DSP的数字I/O口模块具有控制专用T/0和复用引脚的功能，可以输出输入高低电平信

8、号,根据其功能将其设计成开关量输出，输入，并用英控制继电器，作为控的开关。开关量输入只要用电阻分压即可,开关量输出使用光耦隔离,本设计用的光耦PC817,比较适合DSP使用。当DSP输出高电平时继电器吸合，CNETA1和CNETA2两脚导通继电器电路图见图2：图2继电器电路图（3）QEP电路：DSP的每个时间管理器都冇一个正交编码器脉冲（QEP