CN105234939A - 一种四自由度高速并联机械手控制系统 - Google Patents
一种四自由度高速并联机械手控制系统 Download PDFInfo
- Publication number
- CN105234939A CN105234939A CN201510692416.9A CN201510692416A CN105234939A CN 105234939 A CN105234939 A CN 105234939A CN 201510692416 A CN201510692416 A CN 201510692416A CN 105234939 A CN105234939 A CN 105234939A
- Authority
- CN
- China
- Prior art keywords
- module
- arm
- platform
- servomotor
- fixed platform
- 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
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
一种四自由度高速并联机械手控制系统,包括定平台和动平台,其中:所述定平台和动平台之间设有六角手臂组件,所述定平台的顶部设有连接且驱动六角手臂组件的伺服驱动器,所述动平台底部设有连接六角手臂组件的末端执行器,所述定平台和动平台之间还包括三个机械手臂组件,所述三个机械手臂组件均匀等分在定平台和动平台的外侧且并联驱动。本发明四自由度高速并联机械手采用可实现三平动一转动的空间四自由度并联驱动,通过动平台拆分,引入末端执行器的转动自由度,不仅可以实现物料的快速搬运、装箱等功能,同时通过末端执行器的转动自由度可以实现物料的顺序摆放动作,克服了类似机构存在的缺陷。
Description
技术领域
本发明涉及机械手领域,特别是一种四自由度高速并联机械手控制系统。
背景技术
随着工业的发展,自动化设备已经广发应用于各生产领域中,比如能够进行抓取和搬运的机械手,其可以按照设定的运动轨迹运动,实现自动上料和下料。然而,传统的机械手在有限的空间中进行回转或进行其他动作时,因受机械手本身运动的精度限制或转动结构的限制,难以实现空间内移位或更精准的旋转摆动。同时现有简单多臂并联机器手控制器多数为PLC,普通的PLC高脉冲输出和差动输出信号接口少,难以满足多轴运动控制且速度慢,需外扩展接口模块,成本高,且无闭环控制,精度低,存在累计误差。
发明内容
为了克服现有技术的上述缺点,本发明的目的是实现空间三个方向平动和一个转动自由度的四自由度高速转动,提供采用并联驱动的、有效构件惯性和提高系统负载能力的一种四自由度高速并联机械手控制系统。
本发明解决其技术问题所采用的技术方案是:一种四自由度高速并联机械手控制系统,包括机械手和控制机械手的控制模块,其中:所述控制模块包括有电源模块、输入输出模块、储存模块、通信接口模块、时钟计时模块和微处理器,所述为微处理器为ARMCortex-M4内核32位微处理器,所述输入输出模块、储存模块、通信接口模块、时钟计时模块均与微处理器连接;
所述电源模块,接入24V3A直流电源给电路供电,电路板由5V和3.3V稳压;
所述输入输出模块包括有继电器控制IO输出端、PWM隔离输出端和光耦隔离输入端,用于限位开关检测和输出端控制;
所述储存模块,采用32MFLASH,断电后可对重要数据进行保存,不丢失;
通信接口模块,包含485总线接口、CAN总线接口、232电平接口、USB接口和网络接口,实现多种通信方式功能,兼容性好;
所述时钟计时模块,采用工业级时钟模块,为系统提供准确的时间;
所述微处理器,负责与各个模块间的通信或控制;
作为本发明的进一步改进:所述微处理器还设有四路伺服电机接口,所述四路伺服电机接口与机械手连接,支持四路伺服电机或伺服驱动器同时高速运行。所述伺服驱动器和三路伺服电机接入微处理器的伺服电机接口。
作为本发明的进一步改进:一种四自由度高速并联机械手,包括定平台和动平台,其中:所述定平台和动平台之间设有六角手臂组件,所述定平台的顶部设有连接且驱动六角手臂组件的伺服驱动器,所述动平台底部设有连接六角手臂组件的末端执行器,所述定平台和动平台之间还包括三个机械手臂组件,所述三个机械手臂组件均匀等分在定平台和动平台的外侧且并联驱动。
所述伺服驱动器驱动六角手臂组件,作为末端执行器旋转运动的动力来源,引入末端执行器的转动自由度,不仅可以实现物料的快速搬运、装箱,还可以通过末端执行器的转动自由度实现物料的顺序摆放动作。
作为本发明的进一步改进:所述机械手臂组件包括有减速器、伺服电机、主动臂和从动臂,所述减速器固定在定平台上,一端连接伺服电机,另一端连接主动臂,所述从动臂分为左从动臂和右从动臂,所述左右从动臂的顶端分别与主动臂的两侧连接,底端与动平台连接。
所述三个机械手臂组件采用并联驱动,三个伺服电机单独驱动相应连接的主动臂,改变主动的旋转摆动角度,使得下方的动平台在三维空间平动,可有效减低构件惯性和提高系统负载能力,实现动平台在工作空间内大范围平动。
与现有技术相比,本发明的有益效果是:
本发明采用低成本高性能ARMCortex-M4内核微处理器对多轴运动的控制以准确到达目标位置,并通过视觉辨识的方法对目标物体抓取、旋转、移动、放置,实现了机械手的功能。
集成各种通信接口,兼容性好,成本低;成本仅为传统技术的三分之一;兼容性好,支持多种通信接口,可支持与其他设备连接通信。
四自由度高速并联机械手采用可实现三平动一转动的空间四自由度并联驱动,通过动平台拆分,引入末端执行器的转动自由度,不仅可以实现物料的快速搬运、装箱等功能,同时通过末端执行器的转动自由度可以实现物料的顺序摆放动作,克服了类似机构存在的缺陷。
本发明采用四个驱动源,其中三个为并联驱动动平台的动力输入源,另外一个为末端执行器的旋转运动的动力来源。三个伺服电机单独驱动与之连接的主动臂,改变主动臂的旋转摆动角度使得下方的动平台在三维空间平动,同时正上方的伺服驱动器中间的六角轴进行末端执行器的旋转运动,达到四自由度空间运动。
附图说明
图1为本发明的控制系统原理示意图。
图2为本发明的结构示意图。
具体实施方式
现结合附图说明与实施例对本发明进一步说明:
参考图1,一种四自由度高速并联机械手控制系统,包括机械手和控制机械手的控制模块,其中:所述控制模块包括有电源模块、输入输出模块、储存模块、通信接口模块、时钟计时模块和微处理器,,所述输入输出模块、储存模块、通信接口模块、时钟计时模块均与微处理器连接;
所述电源模块,接入24V3A直流电源给电路供电,电路板由5V和3.3V稳压;
所述输入输出模块包括有继电器控制IO输出端、PWM隔离输出端和光耦隔离输入端,用于限位开关检测和输出端控制;
所述储存模块,采用32MFLASH,断电后可对重要数据进行保存,不丢失;
通信接口模块,包含485总线接口、CAN总线接口、232电平接口、USB接口和网络接口,实现多种通信方式功能,兼容性好;所述485总线接口采用RSM485DCHT,双路电源隔离、电气隔离、RS-485接口芯片和总线保护器,电磁辐射EME极低,电磁抗干扰EMI性极高,通信稳定,与微处理器采用UART方式连接。所述CAN总线接口采用CTM1051,带隔离的通用CAN收发器芯片,具有DC2500V隔离功能,对电磁干扰有高的抗干扰性,与微处理器采用CAN接口方式连接。所述网络接口采用芯片W5500,全硬件TCP/IP嵌入式以太网控制器,支持TCP,UDP,IPv4,ICMP,ARP,IGMP以及PPPoE协议,与微处理器采用SPI接口连接。
所述时钟计时模块,采用工业级时钟SD2403AP,内置晶振,可保证时钟精度为±5ppm,与微处理器采用IIC接口连接;
所述为微处理器为ARMCortex-M4内核32位微处理器,并扩展了DSP功能和浮点运算单元,运行最高频率达72MHz,内置256/128Kbytesflash和32KbytesSRAM,负责与各个模块间的通信或控制;
所述微处理器还设有四路伺服电机接口,所述四路伺服电机接口采用SN65C1167差分发收芯片,可高速驱动伺服电机或伺服驱动器,最高输出频率可达1MHZ。所述四路伺服电机接口与机械手连接,支持四路伺服电机或伺服驱动器同时高速运行。所述伺服驱动器和三路伺服电机接入微处理器的伺服电机接口。
参考图2,一种四自由度高速并联机械手,包括定平台1和动平台2,所述定平台1和动平台2之间设有六角手臂组件3,所述六角手臂组件中伸缩轴承采用六角轴滑动伸缩,顶连接定平台1,低端连接动平台2,所述定平台1的顶部设有连接且驱动六角手臂组件3的伺服驱动器4,所述动平台2底部设有连接六角手臂组件3的末端执行器5,所述定平台1和动平台2之间还包括三个机械手臂组件,所述三个机械手臂组件均匀等分在定平台1和动平台2的外侧且并联驱动。
所述机械手臂组件包括有减速器6、伺服电机7、主动臂8和从动臂9,所述减速器固定在定平台1上,一端连接伺服电机7,另一端连接主动臂8,所述从动臂9分为左从动臂和右从动臂,所述左右从动臂的顶端分别与主动臂8的两侧连接,底端与动平台2连接。
综上所述,本领域的普通技术人员阅读本发明文件后,根据本发明的技术方案和技术构思无需创造性脑力劳动而作出其他各种相应的变换方案,均属于本发明所保护的范围。
Claims (5)
1.一种四自由度高速并联机械手控制系统,包括机械手和控制机械手的控制模块,其特征是:所述控制模块包括有电源模块、输入输出模块、储存模块、通信接口模块、时钟计时模块和微处理器,所述为微处理器为ARMCortex-M4内核32位微处理器,所述输入输出模块、储存模块、通信接口模块、时钟计时模块均与微处理器连接;
所述电源模块,接入24V3A直流电源给电路供电,电路板由5V和3.3V稳压;
所述输入输出模块包括有继电器控制IO输出端、PWM隔离输出端和光耦隔离输入端,用于限位开关检测和输出端控制;
所述储存模块,断电后可对重要数据进行保存,不丢失;
通信接口模块,包含485总线接口、CAN总线接口、232电平接口、USB接口和网络接口;
所述时钟计时模块,采用工业级时钟模块,为系统提供准确的时间;
所述微处理器,负责与各个模块间的通信或控制。
2.根据权利要求1所述的一种四自由度高速并联机械手控制系统,其特征是:所述微处理器还设有四路伺服电机接口,所述四路伺服电机接口与机械手连接。
3.一种四自由度高速并联机械手控制系统,包括定平台和动平台,其特征是:所述定平台和动平台之间设有六角手臂组件,所述定平台的顶部设有连接且驱动六角手臂组件的伺服驱动器,所述动平台底部设有连接六角手臂组件的末端执行器,所述定平台和动平台之间还包括三个机械手臂组件,所述三个机械手臂组件均匀等分在定平台和动平台的外侧且并联驱动。
4.根据权利要求3所述的一种四自由度高速并联机械手控制系统,其特征是:所述机械手臂组件包括有减速器、伺服电机、主动臂和从动臂,所述减速器固定在定平台上,一端连接伺服电机,另一端连接主动臂,所述从动臂分为左从动臂和右从动臂,所述左右从动臂的顶端分别与主动臂的两侧连接,底端与动平台连接。
5.根据权利要求4所述的一种四自由度高速并联机械手控制系统,其特征是:所述伺服驱动器和三路伺服电机接入微处理器的伺服电机接口。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510692416.9A CN105234939A (zh) | 2015-10-23 | 2015-10-23 | 一种四自由度高速并联机械手控制系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510692416.9A CN105234939A (zh) | 2015-10-23 | 2015-10-23 | 一种四自由度高速并联机械手控制系统 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN105234939A true CN105234939A (zh) | 2016-01-13 |
Family
ID=55032884
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510692416.9A Pending CN105234939A (zh) | 2015-10-23 | 2015-10-23 | 一种四自由度高速并联机械手控制系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105234939A (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107414840A (zh) * | 2017-09-25 | 2017-12-01 | 常州机电职业技术学院 | 旋臂机械手控制方法及装置 |
CN108858137A (zh) * | 2018-06-15 | 2018-11-23 | 广州启帆工业机器人有限公司 | 基于delta并联机构的机械手 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20100005919A1 (en) * | 2007-01-29 | 2010-01-14 | Michael Breu | Device for displacing and positioning an object in space |
CN102601797A (zh) * | 2012-04-07 | 2012-07-25 | 大连镔海自控股份有限公司 | 一种三维平动和一维转动的高速并联机器人 |
CN103009378A (zh) * | 2012-12-13 | 2013-04-03 | 大连理工计算机控制工程有限公司 | 一种配有视觉的高速并联机器人拾取装置 |
CN103722556A (zh) * | 2013-12-16 | 2014-04-16 | 北京自动化控制设备研究所 | 一种高精度轻型机器人多自由度机械臂驱动控制电路 |
CN104339354A (zh) * | 2014-11-20 | 2015-02-11 | 西安电子科技大学 | 一种用于6自由度并联机器人的专用运动控制器硬件平台 |
DE102013225630A1 (de) * | 2013-12-11 | 2015-06-11 | Majatronic Gmbh | Industrieroboter |
CN204544645U (zh) * | 2015-03-05 | 2015-08-12 | 厦门特盈自动化科技股份有限公司 | delta并联四轴式机械手点胶机 |
CN204658437U (zh) * | 2015-05-06 | 2015-09-23 | 厦门特盈自动化科技股份有限公司 | 带视觉功能的Delta并联机械手 |
CN205058029U (zh) * | 2015-10-23 | 2016-03-02 | 广东惠利普智能科技有限公司 | 一种四自由度高速并联机械手 |
-
2015
- 2015-10-23 CN CN201510692416.9A patent/CN105234939A/zh active Pending
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20100005919A1 (en) * | 2007-01-29 | 2010-01-14 | Michael Breu | Device for displacing and positioning an object in space |
CN102601797A (zh) * | 2012-04-07 | 2012-07-25 | 大连镔海自控股份有限公司 | 一种三维平动和一维转动的高速并联机器人 |
CN103009378A (zh) * | 2012-12-13 | 2013-04-03 | 大连理工计算机控制工程有限公司 | 一种配有视觉的高速并联机器人拾取装置 |
DE102013225630A1 (de) * | 2013-12-11 | 2015-06-11 | Majatronic Gmbh | Industrieroboter |
CN103722556A (zh) * | 2013-12-16 | 2014-04-16 | 北京自动化控制设备研究所 | 一种高精度轻型机器人多自由度机械臂驱动控制电路 |
CN104339354A (zh) * | 2014-11-20 | 2015-02-11 | 西安电子科技大学 | 一种用于6自由度并联机器人的专用运动控制器硬件平台 |
CN204544645U (zh) * | 2015-03-05 | 2015-08-12 | 厦门特盈自动化科技股份有限公司 | delta并联四轴式机械手点胶机 |
CN204658437U (zh) * | 2015-05-06 | 2015-09-23 | 厦门特盈自动化科技股份有限公司 | 带视觉功能的Delta并联机械手 |
CN205058029U (zh) * | 2015-10-23 | 2016-03-02 | 广东惠利普智能科技有限公司 | 一种四自由度高速并联机械手 |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107414840A (zh) * | 2017-09-25 | 2017-12-01 | 常州机电职业技术学院 | 旋臂机械手控制方法及装置 |
CN107414840B (zh) * | 2017-09-25 | 2023-11-07 | 常州机电职业技术学院 | 旋臂机械手控制方法及装置 |
CN108858137A (zh) * | 2018-06-15 | 2018-11-23 | 广州启帆工业机器人有限公司 | 基于delta并联机构的机械手 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN204287906U (zh) | 一种多轴集成的伺服驱动器 | |
CN103203741B (zh) | 一种三自由度并联机器人机构 | |
CN106217364A (zh) | 一种快速拆装的六轴工业机器人 | |
CN205058029U (zh) | 一种四自由度高速并联机械手 | |
CN110936381A (zh) | 一种机器人控制装置及机器人 | |
CN103737577A (zh) | 一种含滚珠丝杠副驱动的六自由度工业机器人 | |
CN203984152U (zh) | 一种集成减速器和反馈控制系统的模块化伺服电机 | |
CN103744376A (zh) | 一种伺服驱动器及使用该伺服驱动器的多轴控制系统 | |
CN103984275A (zh) | 一种基于fpga的通用工业运动控制系统及基于该运动控制系统的控制方法 | |
CN103481283A (zh) | 一种3轴五杆并联机械手 | |
CN103488126A (zh) | 多轴运动控制系统开发平台 | |
CN105234939A (zh) | 一种四自由度高速并联机械手控制系统 | |
CN203250190U (zh) | 工业机器人控制器 | |
CN203427028U (zh) | 四自由度混联机器人 | |
CN103273482B (zh) | 一种主从支链分离式的二平动并联机器人 | |
CN203825438U (zh) | 一种伺服驱动器及使用该伺服驱动器的多轴控制系统 | |
CN108858209A (zh) | 一种工业机器人控制器 | |
CN105373109B (zh) | 一种Delta机器人驱控系统 | |
CN203557381U (zh) | 一种三自由度并联机构 | |
CN103495970A (zh) | 一种三自由度并联机构 | |
CN104511896A (zh) | 一种自动化协同并联操作装置 | |
CN209453579U (zh) | 机器人电动夹手 | |
CN203401490U (zh) | 一种抓包机械手 | |
Du et al. | Motion control system analysis and design for a humanoid robot | |
CN203210367U (zh) | 机械手 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20160113 |
|
RJ01 | Rejection of invention patent application after publication |