CN106863312A - 一种基于dsp平台的排爆机械臂控制*** - Google Patents
一种基于dsp平台的排爆机械臂控制*** Download PDFInfo
- Publication number
- CN106863312A CN106863312A CN201510916148.4A CN201510916148A CN106863312A CN 106863312 A CN106863312 A CN 106863312A CN 201510916148 A CN201510916148 A CN 201510916148A CN 106863312 A CN106863312 A CN 106863312A
- Authority
- CN
- China
- Prior art keywords
- control system
- mechanical arm
- dsp
- system based
- drive part
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Landscapes
- Manipulator (AREA)
Abstract
一种基于DSP平台的排爆机械臂控制***，利用上位机向DSP发送指令，驱动机械臂，实现6个关节的协调运动。DSP通过地址数据总线和FPCA连接，进而控制驱动部分。驱动部分为8个直流电机，以履带形式走动，驱动部分前端含超声波测距模块及无线视频采集模块，能够识别前方是否有障碍物。实现了串口测试软件向SCI模块发送指令的功能，从而控制机械臂，仿生模仿人手的各类运动。该控制***精度高，调节快，该机械臂有的承重能力，能准确握紧危险品并放于隔离箱中。
Description
技术领域
本发明涉及一种基于DSP平台的排爆机械臂控制***，适用于机械领域。
背景技术
排爆机器人是针对公安、航空、军事、矿井等危险、重要、有害环境下应用的特种作业机器人，它不受任何外界电磁干扰，可以代替人在危险、重要、有害环境中进行观察、检查、搬运、清理、操作及安放特殊装置，用以保证人员的安全、健康。由于科技含量较高，排爆机器人往往“身价”不菲。
发明内容
本发明提出了一种基于DSP平台的排爆机械臂控制***，以DSP为中央处理核心，用6个伺服电机配合铝制合金搭建机械臂硬件结构，利用DSP增强型PWM模块驱动伺服电机，上位机采用PC机进行控制。实现了串口测试软件向SCI模块发送指令的功能，从而控制机械臂，仿生模仿人手的各类运动。该控制***精度高，调节快，该机械臂有的承重能力，能准确握紧危险品并放于隔离箱中。
本发明所采用的技术方案是：所述控制***利用上位机向DSP发送指令，驱动机械臂，实现6个关节的协调运动。DSP通过地址数据总线和FPCA连接，进而控制驱动部分。驱动部分为8个直流电机，以履带形式走动，驱动部分前端含超声波测距模块及无线视频采集模块，能够识别前方是否有障碍物。
所述控制***中，TMS320 F28335拥有浮点数处理单元，6个直接存储器访问DMA通道，12个PWM输出通道，6个高精度PWM通道，3个SCI通信模块，12个可配置外部中断，处理能力比F2812更强，对于复杂的运动控制排爆机器臂而言，DSP选择F28335更为合适。
所述控制***利用EPWM1A-EPWM6A产生6路PWM脉冲信号，完成对机械臂6个关节的控制。6个关节点采用舵机(伺服电机)驱动，设计目标:机械臂总长度为400mm，手爪能够抓起500g的物品，工作电流1~3A,精度控制在1°以内。
所述控制***根据设定的相关参数选择控制方式和执行机构，现场控制模块将采集到的数据通过总线实时地发送给主控机，主控机的决策软件根据上报数据和参数进行运算，并向各控制模块传输控制量，指示相关机构动作。机械臂由6路伺服电机驱动，控制器为TM 5320 F28335。该控制器带有SCI模块，允许使用NRZ协议进行串行通讯，因此可以直接通过SCI模块与主控机通讯。直流伺服电机是一种将输入信号转换为转轴上的角位移或角速度来执行控制任务的直流电机，其转速和转向随输入信号的变化而变化，并具有一定的负载能力，在各类自动控制***中广泛用作执行元件。直流伺服电机具有响应迅速、精度和效率高、调速范围宽、负载能力大、控制特性优良等优点。
所述控制***的软件开发环境为CCS3.3***，硬件平台为TI公司的TMS320 F28335型数字信号处理器。与以往的定点DSP相比，该器件的精度高，成本低，功耗小，性能高，外设集成度高，数据以及程序存储量大，A/D转换更精确快速等。
本发明的有益效果是：该控制***以DSP为中央处理核心，用6个伺服电机配合铝制合金搭建机械臂硬件结构，利用DSP增强型PWM模块驱动伺服电机，上位机采用PC机进行控制。实现了串口测试软件向SCI模块发送指令的功能，从而控制机械臂，仿生模仿人手的各类运动。该控制***精度高，调节快，该机械臂有的承重能力，能准确握紧危险品并放于隔离箱中。
附图说明
图1是本发明的机械臂设计方案图。
图2是本发明的闭环反馈控制***图。
图3是本发明的***软件设计流程图。
具体实施方式
下面结合附图和实施例对本发明作进一步说明。
如图1，控制***利用上位机向DSP发送指令，驱动机械臂，实现6个关节的协调运动。DSP通过地址数据总线和FPCA连接，进而控制驱动部分。驱动部分为8个直流电机，以履带形式走动，驱动部分前端含超声波测距模块及无线视频采集模块，能够识别前方是否有障碍物。
控制***中，TMS320 F28335拥有浮点数处理单元，6个直接存储器访问DMA通道，12个PWM输出通道，6个高精度PWM通道，3个SCI通信模块，12个可配置外部中断，处理能力比F2812更强，对于复杂的运动控制排爆机器臂而言，DSP选择F28335更为合适。
,控制***利用EPWM1A-EPWM6A产生6路PWM脉冲信号，完成对机械臂6个关节的控制。6个关节点采用舵机(伺服电机)驱动，设计目标:机械臂总长度为400mm，手爪能够抓起500g的物品，工作电流1~3A,精度控制在1°以内。
如图2，根据设定的相关参数选择控制方式和执行机构，现场控制模块将采集到的数据通过总线实时地发送给主控机，主控机的决策软件根据上报数据和参数进行运算，并向各控制模块传输控制量，指示相关机构动作。机械臂由6路伺服电机驱动，控制器为TM 5320 F28335。该控制器带有SCI模块，允许使用NRZ协议进行串行通讯，因此可以直接通过SCI模块与主控机通讯。直流伺服电机是一种将输入信号转换为转轴上的角位移或角速度来执行控制任务的直流电机，其转速和转向随输入信号的变化而变化，并具有一定的负载能力，在各类自动控制***中广泛用作执行元件。直流伺服电机具有响应迅速、精度和效率高、调速范围宽、负载能力大、控制特性优良等优点。
如图3，控制***的软件开发环境为CCS3.3***，硬件平台为TI公司的TMS320 F28335型数字信号处理器。与以往的定点DSP相比，该器件的精度高，成本低，功耗小，性能高，外设集成度高，数据以及程序存储量大，A/D转换更精确快速等。
利用DSP的EPWM模块，可以产生周期为20ms的周期性脉冲，并且通过调节CMPA的值改变输入正脉冲宽度，从而实现伺服电机的0°~180°的转动，令机械臂6个关节能够按照设计要求运动。利用DSP的SCI模块，上位机向SCI发送指令，SCI模块接收到指令后送DSP处理，再送EPWM模块。串行通信接口SCI是一个采用发送、接收双线制的异步串行通信接口，即UART口，它支持16级的接收发送FIFO，从而降低了串口通信时CPU的开销。SCI模块支持CPU和其他使用NRZ的***设备之间的数字通信。为了保证数据的完整，SCI模块对接收到的数据进行间断检测、奇偶校验、超限检测以及错误检测。通过对16位的波特率控制寄存器进行编程，可以配置不同的SCI通信速率。增强型SCI的主要特点是自动波特率检测和16级发送/接收FIFO。发送和接收缓冲器增加了两个16级的FIFO，并且都能产生CPU中断。无论什么时候发送的FIFO状态位(TXFFST)与中断触发级别位(TXFFIL)相匹配，都能产生一个中断触发，从而实现可编程的中断触发。
***初始化完成PLL锁相环、看门狗及外设时钟设置，清除所有中断并初始化PIE向量表，把6路EPWM配置为外设引脚模式，把SCI设置为FIFO模式，打开串口中断，用串口中断接收到的数据来更新6路EPWM的CMPA。
Claims (5)
1.一种基于DSP平台的排爆机械臂控制***，其特征是：所述控制***利用上位机向DSP发送指令，驱动机械臂，实现6个关节的协调运动，DSP通过地址数据总线和FPCA连接，进而控制驱动部分，驱动部分为8个直流电机，以履带形式走动，驱动部分前端含超声波测距模块及无线视频采集模块，能够识别前方是否有障碍物。
2.根据权利要求1所述的一种基于DSP平台的排爆机械臂控制***，其特征是：所述控制***中，TMS320 F28335拥有浮点数处理单元，6个直接存储器访问DMA通道，12个PWM输出通道，6个高精度PWM通道，3个SCI通信模块，12个可配置外部中断，处理能力比F2812更强，对于复杂的运动控制排爆机器臂而言，DSP选择F28335更为合适。
3.根据权利要求1所述的一种基于DSP平台的排爆机械臂控制***，其特征是：所述控制***利用EPWM1A-EPWM6A产生6路PWM脉冲信号，完成对机械臂6个关节的控制，6个关节点采用舵机(伺服电机)驱动，设计目标:机械臂总长度为400mm，手爪能够抓起500g的物品，工作电流1~3A,精度控制在1°以内。
4.根据权利要求1所述的一种基于DSP平台的排爆机械臂控制***，其特征是：所述控制***根据设定的相关参数选择控制方式和执行机构，现场控制模块将采集到的数据通过总线实时地发送给主控机，主控机的决策软件根据上报数据和参数进行运算，并向各控制模块传输控制量，指示相关机构动作。
5.根据权利要求1所述的一种基于DSP平台的排爆机械臂控制***，其特征是：所述控制***的软件开发环境为CCS3.3***，硬件平台为TI公司的TMS320
F28335型数字信号处理器，与以往的定点DSP相比，该器件的精度高，成本低，功耗小，性能高，外设集成度高，数据以及程序存储量大，A/D转换更精确快速等。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201510916148.4A CN106863312A (zh) | 2015-12-13 | 2015-12-13 | 一种基于dsp平台的排爆机械臂控制*** |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201510916148.4A CN106863312A (zh) | 2015-12-13 | 2015-12-13 | 一种基于dsp平台的排爆机械臂控制*** |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN106863312A true CN106863312A (zh) | 2017-06-20 |
Family
ID=59178005
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201510916148.4A Pending CN106863312A (zh) | 2015-12-13 | 2015-12-13 | 一种基于dsp平台的排爆机械臂控制*** |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN106863312A (zh) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108225389A (zh) * | 2017-12-22 | 2018-06-29 | 联创汽车电子有限公司 | 超声波传感器驱动装置及其驱动方法 |
-
2015
- 2015-12-13 CN CN201510916148.4A patent/CN106863312A/zh active Pending
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108225389A (zh) * | 2017-12-22 | 2018-06-29 | 联创汽车电子有限公司 | 超声波传感器驱动装置及其驱动方法 |
| CN108225389B (zh) * | 2017-12-22 | 2020-10-23 | 联创汽车电子有限公司 | 超声波传感器驱动装置及其驱动方法 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN106393049B (zh) | 一种用于高危作业的机器人 | |
| CN105643589A (zh) | 一种自主排障式智能车*** | |
| CN106426184A (zh) | 一种机器人控制*** | |
| CN103085054B (zh) | 带电抢修机器人主从式液压力反馈机械臂控制***及方法 | |
| CN103753601A (zh) | 空间串联旋转关节型遥操作机械臂及其组合 | |
| CN104571124B (zh) | 一种用于水下航行器三自由度姿态模拟装置 | |
| CN102981504B (zh) | 基于Zigbee通信的多机器人队形控制***及方法 | |
| CN101817182A (zh) | 一种智能移动机械臂控制*** | |
| CN103895022A (zh) | 穿戴式体感控制机械手 | |
| CN105700465A (zh) | 基于EtherCAT总线的机器人柔顺控制***和方法 | |
| CN203077287U (zh) | 带电抢修机器人主从式液压力反馈机械臂控制*** | |
| CN101819427B (zh) | 基于fpga的数字化关节片上控制*** | |
| CN104175308A (zh) | 自主服务机器人 | |
| CN204832853U (zh) | 一种多接口运动控制器 | |
| CN109605344A (zh) | 一种多自由度开环步进串联机械臂及其控制方法 | |
| CN204856122U (zh) | 冲压机器人控制*** | |
| CN105404744A (zh) | 一种空间机械臂全状态动力学半物理仿真*** | |
| CN106429851B (zh) | 基于远程遥操作的桥式吊车自动控制*** | |
| CN110039561A (zh) | 基于点云的带电作业机器人遥操作人员培训***及方法 | |
| CN101131586A (zh) | 机械臂***中的m-lvds高速串行通信装置及其通信控制方法 | |
| CN203250190U (zh) | 工业机器人控制器 | |
| CN106863312A (zh) | 一种基于dsp平台的排爆机械臂控制*** | |
| CN104353926B (zh) | 一种适用于复杂曲线器件自动化焊接的运动控制方法 | |
| CN206544182U (zh) | 一种机器人控制*** | |
| CN202878317U (zh) | 一种多自由度工业机器人运动控制器 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| WD01 | Invention patent application deemed withdrawn after publication | ||
| WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20170620 |