0
  • 聊天消息
  • 系统消息
  • 评论与回复
登录后你可以
  • 下载海量资料
  • 学习在线课程
  • 观看技术视频
  • 写文章/发帖/加入社区
创作中心

完善资料让更多小伙伴认识你,还能领取20积分哦,立即完善>

3天内不再提示

基于DSP和2407DSP处理器实现机械手控制系统的设计

电子设计 来源:微计算机信息 作者:万文斌,钱园园 2021-04-07 11:38 次阅读

一:系统概述

危险品处理机器人是用于危险弹药(一般在野外)夹持、拔出、搬运和放置作业,并可携带和放置的装置。该项目的完成将解决长期困扰我军的事故炮弹、战争遗留弹等危险弹药安全处理问题。机械手是危险品处理机器人操作过程中直接与弹药接触的重要部件,主要用于执行对危险弹药的夹持、拆除、搬运和放置作业, 机械手工作的稳定性直接决定着弹药处理的成功率,因此机械手的设计至关重要。

二:机械手

1. 结构形式

为保证作业的灵活性,机械手设计为由腰身、大臂、小臂、手爪组成,共具有3 个关节(腰身-大臂、大臂-小臂、小臂-手爪)7 个自由度(腰身1dof,大臂1dof,小臂1dof,手腕4dof)。其中:

腰身——1 自由度,做旋转运动。固定安装在机器人车底盘上,以车体正前方为基准,可分别向左右旋转约135°(具体可旋转角度应参考车体驾驶控制室位置确定,以避免机械手向后方旋转时碰到驾驶控制室或其它物体),两端各有限位装置以避免自体碰撞。由液压控制运动,在底部装有电位计反馈准确位置以保证控制精度。

大臂、小臂——各1 自由度,分别相对于前一级关节做上下运动。以车体水平面为基准,大臂可向上运动45o、向下运动30o,小臂可向上运动25o、向下运动60o。由液压控制运动,用电位计回馈,保证关节位置准确。

手爪——4 自由度,分别做上下摆动、旋转、伸缩、夹持运动。以小臂延长线为基准,手爪可上下摆动±90°,又可以小臂为基准轴旋转±180°,伸1 米,均采用伺服电机提供动力,通过减速箱减速保证功率需求,由伺服电机控制器控制。有编码盘反馈,保证位置准确。

腰身,大小臂液压回路有压力传感器保护。油压有稳定装置。

2. 控制系统

机械手操作可在视觉传感器及控制系统的指示、控制下进行粗定位,操作人员能够凭视图像进行准确定位、夹持等动作控制。摄像机安装在机器人车前端以及机械手腕上,以供环境及操作对象的立体图像和近距离图像。

机械手控制系统由总控制器、液压控制器、伺服控制器组成,各控制器的控制芯片2407DSP。总控制器通过RS232 总线接收遥控端指令,通过can 总线分配任务给液压和伺控制器控制机械手各执行机构动作。机械手运动分单轴动和联动:单轴动是接收上位机发的的步进指令;联动是接收上位机发送的空间位置,通过运动学计算,转换成机械手在其座坐标系的坐标,将机械手运动、调整到指定位置和姿态,同时要解决机械手运动与抓取周围环境的干涉。

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

3、硬件设计

机械手的三块控制器的控制芯片都为2407DSP,虽然三块控制器实现的功能不同,但在硬件电路设计时按照DSP 管脚的功能,设计外围电路如下:

(1)PWM 管脚:DSP 的每个事件管理器都有与比较单元相关的PWM 电路,能够产生六路带可编程死区和输出极性的PWM 输出,但是都是成对输出的,对于本控制器需要的独立的输出,每个事件管理器只有3 路,一个DSP 有两个事件管理器,可以独立的输出6 路PWM 波。液压控制器需要6 路PWM 波驱动电业比例阀,而伺服电机控制器需要4 路0-5V 的加速器信号调节电机转速,在设计电路时将这两种电路设计在一起,并制成印刷电路板,焊板时按每板的功能焊接即可,液压控制器需要输出PWM 波形,芯片用LM393 做比较器,此时电阻R19 和电容C71 不焊即可,但要有R21 上拉电阻,R17 和R18 将2 脚电压分在1.7V 左右比较合适。伺服控制器需要输出0-5V 电压芯片用LM2904 做运放用,焊电阻R19 和电容C17不用MOS 管、R21 和外接电源,也不用焊R17,直接将DSP 输出0-3.3V 电压放大到0-5V 输出。PWM/电压输出电路图见图1:

基于DSP和2407DSP处理器实现机械手控制系统的设计

图1 PWM/电压输出电路

(2)I\O 口:DSP 的数字I/O 口模块具有控制专用I/O 和复用引脚的功能,可以输出输入高低电平信号,根据其功能将其设计成开关量输出,输入,并用其控制继电器,作为控的开关。开关量输入只要用电阻分压即可,开关量输出使用光耦隔离,本设计用的光耦PC817,比较适合DSP 使用。当DSP 输出高电平时继电器吸合,CNETA1 和CNETA2 两脚导通继电器电路图见图2:

基于DSP和2407DSP处理器实现机械手控制系统的设计

图2 继电器电路图

(3)QEP 电路:DSP 的每个时间管理器都有一个正交编码器脉冲(QEP)电路。当QEP电路被使能时可以对CAP1/QEP1 和CAP2/QEP2(对于EVA 模块)引脚上的正交编码输入脉冲进行解码和计数。正交编码脉冲电路可用于连接光电编码器以获得旋转机械的位置和速率。伺服电机控制器需要使用QEP 电路,由于一个伺服电机控制器需要控制4 台伺服电机,所以码盘信号使用74153 芯片选择输入,同时码盘的每路信号都有正负两根线通过运放放大后再到74153 选择后输入DSP,码盘选择电路见图3:

基于DSP和2407DSP处理器实现机械手控制系统的设计

图3 码盘选择电路

其中W/R#/IOPC0 为使能信号,XINT1/IOPA2 和XINT2/ADCSOC/IOPDO 构成选择信号,74153 通过选择信号的选择码选择一对信号从7 脚和9 脚输出给DSP。其他硬件电路设计包括电源、串口、CAN 总线和DSP 外围接线等都是典型的设计。

4、软件设计

机械手控制的三块控制器之间的DSP 通过CAN 总线进行通信。总体设计思想是使用一块DSP 作为总控制器通过RS232 总线接收遥控端的指令,并通过CAN 总线将相应的指令发送给液压、伺服控制器中的DSP,从而实现其控制。液压控制系统用于控制回转平台的旋转以及大臂、小臂的升降。该系统通过一块DSP的CAN 模块接收总控制器发出的指令,并根据接收到的指令产生相应的6 路PWM 信号以控制电液比例阀的6 路输出。其中每两路控制一个动作的两个方向,有3 路I\O 口控制继电器的开关来控制泵,溢流阀,以及电源的开关,同时将位置传感器的回馈信号经过A/D 采样返回给DSP,进行的死循环控制。

伺服电机控制系统用于控制伸缩臂的伸缩,手爪的旋转、俯仰以及夹持操作。该控制器通过CAN 总线接收总控制器指令并根据指令控制两路独立的PWM 输出,通过硬件电路转化成0-5V 输出,作为加速信号,通过I\O 口控制电机的电源以及换向。通过码盘和转角传感器的回馈信号经过A/D 采样返回给DSP,从而实现了相应的死循环。

三、结束语

整个机器人车现在已完成,经过一个月的安装调试,机械手完全符合设计要求,达到如下技术指标:

最大作业幅度约2.5m;

最大作业深度:地下1m;

最大作业幅度下夹持提升力≤80kg;

最大夹持弹药直径160mm;

目前国内还没有这种专业的处理危险品的机器人批量生产,本产品的成功完成为将来的批量生产奠定了坚实的基础,市场潜力巨大。

责任编辑:gt

声明:本文内容及配图由入驻作者撰写或者入驻合作网站授权转载。文章观点仅代表作者本人,不代表电子发烧友网立场。文章及其配图仅供工程师学习之用,如有内容侵权或者其他违规问题,请联系本站处理。 举报投诉
  • 处理器
    +关注

    关注

    68

    文章

    17943

    浏览量

    221419
  • dsp
    dsp
    +关注

    关注

    544

    文章

    7657

    浏览量

    343809
  • 机器人
    +关注

    关注

    206

    文章

    26736

    浏览量

    200911
收藏 人收藏

    评论

    相关推荐

    机械手视觉系统外围电路设计攻略 —电路图天天读(79)

    机械手的三块控制器的控制芯片都为2407DSP,虽然三块控制实现的功能不同,但在硬件电路设计时
    发表于 12-31 10:29 8363次阅读

    基于DSP的高低速CAN总线汽车控制系统设计

    基于DSP的高低速CAN总线汽车控制系统设计摘 要 采用TI公司内嵌CAN 2.0B模块的数字信号处理器TMS320LF2407A作为汽车计算机控制
    发表于 10-06 14:57

    注塑机机械手控制系统设计要点

    `注塑机机械手的所有动作都在控制系统的指挥下完成,尤其是机械手与注塑机的协调工作关系,更是要依赖控制系统来达到。在控制系统的指挥下,
    发表于 09-11 09:43

    基于DSP的马达控制系统

      先进的马达控制系统实现马达与硅芯片技术以及软件的高度集成,以便在提升性能的同时显著节约成本。先进控制器采用的高级技术可提高性能与马达驱动的工作特性。基于数字信号处理器 (
    发表于 11-28 15:36

    【TL6748 DSP申请】大豆籽粒的机械视觉无损精选控制系统

    化、节省空间等优点。单独采用机器视觉技术并不能实现一个完整的大豆精选体系,需要综合利用机械设计原理、自动控制原理和机器视觉技术,才能建立成一体化的实用型大豆精选系统。应用
    发表于 09-10 11:16

    【TL6748 DSP申请】BLDC电机的控制系统

    申请理由:现用的是2407DSP,打算升级控制器,做科学研究。有相关的项目,后期会跟进项目描述:直流无刷电机的控制器实现对执行的驱动
    发表于 09-10 11:18

    【NanoPi2申请】变约束连杆机械手控制系统研究

    实现机械手对抓取物体的主动自适应性能,在机械结构优化设计之后,为了进一步提高整体性能,希望在控制系统上有所突破.
    发表于 12-02 16:06

    什么是DSP,DSP处理器有什么特点?

    调速SVPWM算法。3、视频采集卡,如:DSP做视频压缩算法(H.265),ARM在局域网上做流媒体传输。4、指纹识别,如:公司里的指纹打卡机。5、运动控制卡,如:机床、机械手控制
    发表于 09-04 10:31

    使用桁架式机械手有哪些优势?

    稳定性好、速度快、精度高的特点,能增强作业,保证生产效率。7、桁架机械手可以以被用于恶劣的环境,也可不间断地工作,简便的构造使其便于操作和维修。8、桁架式机械手控制系统不仅能对自身进行智能检测,还具有自动报警等功能。
    发表于 11-25 15:24

    如何设计一款基于STM32的仿生机械手

    远程操控仿生机械手抓取实物。仿生机械手控制系统硬件设计仿生机械手控制系统硬件设计图数据手套软件控制
    发表于 01-07 06:55

    基于DSP的运动控制系统设计

    为了满足CNC齿轮测量中心的测量精要求,针对定点数字信号处理器DSP)TMS320LF2407A的特点,设计一种以DSP运动控制为核心的运
    发表于 02-11 12:23 79次下载

    基于DSP的滞环跟踪型有源电力滤波器数字控制系统

    基于DSP的滞环跟踪型有源电力滤波器数字控制系统 摘要:介绍了一种基于新型数字信号处理器DSP)TMS320F2407
    发表于 07-07 13:07 553次阅读
    基于<b class='flag-5'>DSP</b>的滞环跟踪型有源电力滤波器数字<b class='flag-5'>控制系统</b>

    基于DSP+TMS320LF2407的温度控制系统的研究

    基于DSP+TMS320LF2407的温度控制系统的研究
    发表于 05-06 16:54 13次下载

    TI中基于单片DSP的双异步电机控制系统实现

    本文利用TI公司的电机控制专用DSP芯片TMS320LF2407A实现了基于单片DSP的双异步电机控制
    发表于 04-08 10:20 2次下载
    TI中基于单片<b class='flag-5'>DSP</b>的双异步电机<b class='flag-5'>控制系统</b><b class='flag-5'>实现</b>

    基于DSP TMS320LF2407的温度控制系统

    本论文主要是研究一种基于DsP TMS320LF2407的温度控制系统,并将其应用于半自动生化分析仪当中。
    发表于 05-12 10:09 8次下载