CN102615646A - 主从式液压机械臂控制器 - Google Patents
主从式液压机械臂控制器 Download PDFInfo
- Publication number
- CN102615646A CN102615646A CN2012100961565A CN201210096156A CN102615646A CN 102615646 A CN102615646 A CN 102615646A CN 2012100961565 A CN2012100961565 A CN 2012100961565A CN 201210096156 A CN201210096156 A CN 201210096156A CN 102615646 A CN102615646 A CN 102615646A
- Authority
- CN
- China
- Prior art keywords
- microprocessor
- converter
- mechanical arm
- master
- address bus
- 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.)
- Granted
Links
Images
Landscapes
- Manipulator (AREA)
- Control Of Position Or Direction (AREA)
- Numerical Control (AREA)
Abstract
本发明涉及一种主从式液压机械臂控制器,其手持终端包括微处理器I,它分别与人机接口单元和嵌入式主手控制器相连;嵌入式主手控制器包括微处理器II,它分别与微处理器I、A/D转换器I、串口转光纤模块连接;A/D转换器I与主手的若干电位器(在每个关节运动轴处)相连;机械臂控制器包括微处理器III,它分别与A/D转换器II、D/A转换器、电磁阀连接,微处理器III通过光纤转串口模块与串口转光纤模块通信;A/D转换器II与机械臂上的若干电位器(在每个关节运动轴处)连接;D/A转换器与液压放大器、若干伺服阀、相应液压缸连接,液压缸输出轴与机械臂连接。本发明处理速度快、成本低、性能稳定可靠。
Description
技术领域:
本发明涉及一种机器人控制技术,尤其是一种主从式液压机械臂控制器。
背景技术:
为了提高带电作业的自动化水平和安全性,减轻操作人员的劳动强度和强电磁场对操作人员的人身威胁,从80年代起许多国家都先后开展了带电作业机器人的研究,如日本、西班牙、美国、加拿大、法国等国家先后开展了对带电作业机器人的研究。2002年我国也进行了高压带电作业机器人产品化样机的研制。
目前机械臂的驱动方式主要有三种:气压驱动、液压驱动和电机驱动。气压驱动机械臂的缺点:气体压缩性大,精度低,阻尼效果差,低速不易控制,难以实现伺服控制,并且排气时有噪声,效率低,适用于中小负载,精度要求较低有限点位程序控制机械臂。
电机驱动机械臂的缺点:直流有刷电动机换向时有火花,对环境的防爆性能较差,成本高,结构设计复杂,适用于中小负载,要求具有较高的位置控制精度,速度较高的机械臂。
液压驱动机械臂的缺点:存在漏油、液压传动对油温的变化比较敏感、发生故障不易检查和排除,适用于大负载,要求控制精度不太高的机械臂。
目前机械臂的控制方式主要有两种:示教再现方式和主从式方式。其中示教再现方式操作灵活性较差、运动速度较低,机器人运动轨迹算法编程复杂,开发难度。主从控制方式应用在控制灵活,但是控制精度低的场合。目前机械臂主从控制***一般分为两类:一类采用工控机和控制卡,从设备及控制技术来讲,专用性很强且价格较为昂贵,限制了主从技术的进一步发展;另一类采用PLC,体积大、功耗大、控制速度慢、改变控制程序困难、控制复杂时可靠性差。如何更方便、快捷、廉价地控制主从机械臂,已经成为主从机械臂技术的一个突出问题。
发明内容:
本发明的目的在于解决下述问题,提供一种主从式液压机械臂控制器,此主从式液压机械臂控制器采用位置伺服闭环控制方式,并通过光纤将高压电场与人隔离,控制精度高、实时性好、性能稳定可靠、操作更加方便,满足高压带电机器人作业任务的要求。
为实现上述目的,本发明采用如下技术方案:
一种主从式液压机械臂控制器,包括手持终端、嵌入式主手控制器和机械臂控制器,所述手持终端包括微处理器I,它分别与人机接口单元和嵌入式主手控制器相连;所述嵌入式主手控制器包括微处理器II,它分别与微处理器I、串口转光纤模块连接;同时,微处理器II通过数据总线、地址总线、控制总线与A/D转换器I的数据总线、地址总线、控制总线通信,A/D转换器I与主手的若干电位器之间通过地址总线、数据总线和控制总线通信;所述机械臂控制器包括微处理器III,它通过数据总线和时钟总线与D/A转换器连接,通过地址总线、数据总线和控制总线与A/D转换器II连接,微处理器III还与电磁阀、光纤转串口模块连接;同时,A/D转换器II与机械臂上每个关节运动轴处的若干电位器连接;D/A转换器与液压放大器连接;液压放大器与若干伺服阀连接,各伺服阀与相应液压缸连接,液压缸输出轴与机械臂连接。
所述伺服阀为射流管式电液流量伺服阀;电磁阀的控制电压是直流24V,并抑制泵升电压;所述主手上的以及机械臂上的各电位器均采用5KΩ的360度旋转电位器,传感器精度1‰。
所述人机接口单元包括液晶模块和键盘。
所述微处理器I与微处理器II之间通过串口通信连接。
所述微处理器I、微处理器II和微处理器III均采用TMS320F2812芯片;A/D转换器I、A/D转换器II均采用MAX1312芯片;D/A转换器采用DAC7678芯片。
本发明的工作原理:
机械臂控制***的结构采用主从式微处理器进行控制,微处理器II作为主机,它担当***管理、机械臂语言编译和人机接口功能,并定时地把运算结果作为关节运动的增量送到公共内存,供微处理器III读取它。微处理器III完成全部关节位置数字控制。它从公共内存读给定值,也把各关节实际位置送回公共内存中,微处理器II使用。
本发明的工作过程:
主从式液压机械臂控制***软件分为主端和从端两部分。操作者操作主手运动,主手控制器采集主手电位器的位置信息并实时地将位置信息发送给机械臂控制器,机械臂控制器通过对主手的位置跟踪来完成机械臂的运动;另一方面机械臂在运动过程中由电位器检测到的位置信息也通过光纤通信反馈给主手控制器,主手控制器再将该位置信息发送给手持终端,供显示。
采用上述方案,本发明具有以下优点:
一是主从式液压机械臂***经实验验证,可以满足高压带电作业机器人要求,控制精度高、实时性好、持重大、自重小、性能稳定可靠操作更加方便运行可靠;
二是该***控制部分采用嵌入式控制方式,自重轻、尺寸小、控制***功耗低,适合高压带电作业机器人的应用需要。
三是采用主从式控制方式机械臂***操作灵活方便,不需要复杂的直线插补、圆弧插补等复杂运动学算法;
四是***采用模块化设计,具有开放性、可读性、可扩展性、可维护性,以便持续开发。
五是主从控制***通讯方式采用光纤通信,通讯速率快,可实现高电压绝缘。
六是控制***带有各种标准接口、机械限位、软件限位,功能齐全,位置精度高。
附图说明
图1是本发明总框图;
图2是本发明主手控制器电气连接图;
图3是本发明机械臂从控制器电气连接图;
图4是本发明手持终端电路连接图;
图5是本发明手持终端示意图;
图6是本发明工作流程图。
其中,1.手持终端,2.主控制器,3.机械臂控制器,11.微处理器I,12.液晶模块,13.键盘,14.逻辑电平转换器,15.键盘管理模块,16.稳压芯片I,17.稳压芯片II,18.串口接收发送器I,19.串口,21.微处理器II,22.串口转光纤模块,23.A/D转换器I,24.主手的电位器,25.串口接收发送器II,301.微处理器III,302.光纤转串口模块,303.电磁阀,304.A/D转换器II,305.D/A转换器,306.机械臂的电位器,307.机械臂,308.液压缸,309.伺服阀,310.液压放大器。
具体实施方式
下面结合附图与实施例对本发明做进一步说明。
参见图1,一种主从式液压机械臂控制器,包括相连接的手持终端1和嵌入式主手控制器2以及机械臂控制器3,所述手持终端1包括微处理器I11,微处理器I11分别与人机接口单元和主控制器2的微处理器II21相连;所述主控制器2包括微处理器II21,微处理器II21分别与A/D转换器I23、串口转光纤模块22连接;A/D转换器I21与主手的电位器24相连;机械臂控制器3的微处理器III301分别与A/D转换器II304、D/A转换器305、电磁阀303连接;A/D转换器II304与机械臂的电位器306连接;D/A转换器305与液压放大器310连接;液压放大器310与若干伺服阀309连接,若干伺服阀309与相应的液压缸308连接,各液压缸308输出轴与机械臂307连接。
伺服阀309为射流管式电液流量伺服阀。
电磁阀303的控制电压是直流24V,并带有抑制泵升电压功能。
人机接口单元包括液晶模块12和键盘13。
微处理器I11与微处理器II21通过串口通信连接。
微处理器I11、微处理器II21和微处理器III301均采用TMS320F2812芯片。A/D转换器I23、A/D转换器II304均采用MAX1312芯片。D/A转换器305采用DAC7678芯片。
各电位器采用5KΩ的360度旋转电位器,传感器精度1‰。
微处理器II21的数据总线、地址总线、控制总线与A/D转换器I23的数据总线、地址总线、控制总线相连,微处理器III301的数据总线、地址总线、控制总线与A/D转换器II304的数据总线、地址总线、控制总线相连,微处理器III301的数据总线、时钟总线与D/A转换器305的数据总线、时钟总线相连。
参见图2,嵌入式主手控制器2包括A/D转换器I23、微处理器II21、串口接收发送器II25、串口转光纤模块22、主手的电位器24。
A/D转换器I23MAX1312的D0-11、/OEL、/WR、/RD、/CS接微处理器II21的/XD0-11、XINT2、/XWE、/XRD、/XZCS2脚。主手的电位器24接A/D转换器I23MAX1312的CH0-7脚;微处理器II21的SCITXDA接串口接收发送器II25MAX3232的11脚,SCIRXDA接12脚;串口接收发送器II25MAX3232的13、14脚接到串口转光纤模块22。
所述主手的电位器24的输出口与A/D转换器I23的输入口相连,机械臂的电位器306的输出口与A/D转换器II304的输入口相连,D/A转换器305的输出口与液压放大器310的输入口相连,液压放大器310的输出口与伺服阀309的输入口相连,伺服阀309的输出口与液压缸308的输入口相连。
所述串口转光纤模块22与光纤转串口模块302通过发送光纤和接收光纤连接。
所述微处理器II21、微处理器III301分别与串口转光纤模块22、光纤转串口模块302通过串口通信连接。
机械臂控制***的结构采用主从式微处理器进行控制,微处理器II21作为主机,它担当***管理、机械臂语言编译和人机接口功能,并定时地把运算结果作为关节运动的增量送到公共内存,供微处理器III301读取它。微处理器III301作为从机完成全部关节位置数字控制。它从公共内存读给定值,也把各关节实际位置送回公共内存中,微处理器II21使用。
参见图3,嵌入式机械臂控制器3包括A/D转换器II304、微处理器III301、D/A转换器305、液压放大器310。
微处理器III301的XD0-11、XINT2、/XWE、/XRD、/XZCS2接A/D转换器II304MAX1312的D0-11、/OEL、/WR、/RD、/CS脚。机械臂的电位器306接A/D转换器II304MAX1312的CH0-7脚。微处理器III301的GPIOA0接D/A转换器305的SDA、GPIOA1接SCL。D/A转换器305的Vout0-7接液压放大器310。
参见图4,手持终端1由微处理器I11、液晶模块12、逻辑电平转换器14、键盘管理模块15、键盘13、稳压芯片I16、稳压芯片II17、串口接收发送器18以及串口19组成。稳压芯片I16、稳压芯片II17给微处理器I11供电。微处理器I11的GIPIOB1与逻辑电平转换器14ADG3308的2脚连接,GPIOB5与5脚连接,XINT2与6脚连接,GPIOA0-7与液晶模块12的DB0-7连接,GPIOB0与REQ连接,GPIOB2与CS连接,液晶模块12得到5V供电。逻辑电平转换器14ADG3308的16脚与键盘管理模块15HD7279的DATA脚连接,15与KEY脚连接。微处理器I11的GPIOB3与键盘管理模块15HD7279的CS脚连接,GPIOB4与CLK脚连接。键盘13的输出接键盘管理模块15HD7279的DIG0-7、DP-SG。微处理器I11的SCITXDA接串口接收发送器I18MAX3232的11脚,SCIRXDA接12脚,串口接收发送器18MAX3232的13、14脚接到串口19。
参见图5,手持终端1是一个低功耗的,带液晶显示的模块。液晶模块12可以显示4行、每行20个字符。液晶模块12自带白色的背景光,可以应用在混暗或没有光的环境。背景光的强度可以有7种选择。通过设置参数来选择光的强度。
操作盒有16个按键,呈4×4矩阵式排列。自带蜂鸣器提供按键报警声。可以知道是否正确地按下某个按键。
参见图6,主从式液压机械臂控制***软件分为主端和从端两部分。操作者操作主手运动,主手控制器采集主手电位器的位置信息并实时地将位置信息发送给机械臂控制器,机械臂控制器通过对主手的位置跟踪来完成机械臂的运动;另一方面机械臂在运动过程中由电位器检测到的位置信息也通过光纤通信反馈给主手控制器,主手控制器再将该位置信息发送给手持终端,供显示。
Claims (5)
1.一种主从式液压机械臂控制器,包括手持终端、嵌入式主手控制器和机械臂控制器,其特征是,所述手持终端包括微处理器I,它分别与人机接口单元和嵌入式主手控制器相连;所述嵌入式主手控制器包括微处理器II,它分别与微处理器I、串口转光纤模块连接;同时,微处理器II通过数据总线、地址总线、控制总线与A/D转换器I的数据总线、地址总线、控制总线通信,A/D转换器I与主手的若干电位器之间通过地址总线、数据总线和控制总线通信;所述机械臂控制器包括微处理器III,它通过数据总线和时钟总线与D/A转换器连接,通过地址总线、数据总线和控制总线与A/D转换器II连接,微处理器III还与电磁阀、光纤转串口模块连接;同时,A/D转换器II与机械臂上每个关节运动轴处的若干电位器连接;D/A转换器与液压放大器连接;液压放大器与若干伺服阀连接,各伺服阀与相应液压缸连接,液压缸输出轴与机械臂连接。
2.如权利要求1所述的主从式液压机械臂控制器,其特征是,所述伺服阀为射流管式电液流量伺服阀;电磁阀的控制电压是直流24V,并抑制泵升电压;所述主手上的以及机械臂上的各电位器均采用5KΩ的360度旋转电位器,传感器精度1‰。
3.如权利要求1所述的主从式液压机械臂控制器,其特征是,所述人机接口单元包括液晶模块和键盘。
4.如权利要求1所述的主从式液压机械臂控制器,其特征是,所述微处理器I与微处理器II之间通过串口通信连接。
5.如权利要求1所述的主从式液压机械臂控制器,其特征是,所述微处理器I、微处理器II和微处理器III均采用TMS320F2812芯片;A/D转换器I、A/D转换器II均采用MAX1312芯片;D/A转换器采用DAC7678芯片。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210096156.5A CN102615646B (zh) | 2012-04-01 | 2012-04-01 | 主从式液压机械臂控制器 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210096156.5A CN102615646B (zh) | 2012-04-01 | 2012-04-01 | 主从式液压机械臂控制器 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102615646A true CN102615646A (zh) | 2012-08-01 |
CN102615646B CN102615646B (zh) | 2014-07-09 |
Family
ID=46556028
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201210096156.5A Active CN102615646B (zh) | 2012-04-01 | 2012-04-01 | 主从式液压机械臂控制器 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102615646B (zh) |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103085055A (zh) * | 2013-01-29 | 2013-05-08 | 山东电力集团公司电力科学研究院 | 带电抢修机器人位置反馈主手*** |
CN104867394A (zh) * | 2015-04-28 | 2015-08-26 | 国家电网公司 | 一种液压机械臂现实虚拟互动综合实验平台 |
CN105005332A (zh) * | 2014-09-10 | 2015-10-28 | 国家电网公司 | 变电站带电水冲洗机器人液压伺服驱动*** |
CN105945989A (zh) * | 2015-12-08 | 2016-09-21 | 北京航空航天大学 | 一种基于液压摆动缸驱动关节的机器人液压机械臂 |
CN107511826A (zh) * | 2017-09-08 | 2017-12-26 | 国机智能技术研究院有限公司 | 一种液压机器人的控制方法和*** |
CN107561972A (zh) * | 2017-07-27 | 2018-01-09 | 安徽工程大学 | 一种多姿态爬杆机器人无线控制*** |
CN107577168A (zh) * | 2017-09-08 | 2018-01-12 | 国机智能技术研究院有限公司 | 一种机器人控制***及方法 |
CN108397446A (zh) * | 2018-03-20 | 2018-08-14 | 哈尔滨理工大学 | 一种集成式液压机器人关节控制器 |
CN112388611A (zh) * | 2020-10-15 | 2021-02-23 | 南京晨光集团有限责任公司 | 一种机械臂旋转运动的全液压驱动*** |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS59111503A (ja) * | 1982-12-16 | 1984-06-27 | Matsushita Electric Ind Co Ltd | ロボツト制御装置 |
CN1418762A (zh) * | 2002-12-16 | 2003-05-21 | 北京航空航天大学 | 多轴伺服运动控制装置 |
WO2009029127A2 (en) * | 2007-08-24 | 2009-03-05 | Elite Engineering Corporation | Robotic arm and control system |
CN201808061U (zh) * | 2010-08-02 | 2011-04-27 | 山东电力研究院 | 高压带电作业机器人绝缘*** |
CN201989150U (zh) * | 2011-01-17 | 2011-09-28 | 蒋霞 | 变电设备高压带电清扫机器控制*** |
CN202491240U (zh) * | 2012-04-01 | 2012-10-17 | 山东鲁能智能技术有限公司 | 主从式液压机械臂控制器 |
-
2012
- 2012-04-01 CN CN201210096156.5A patent/CN102615646B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS59111503A (ja) * | 1982-12-16 | 1984-06-27 | Matsushita Electric Ind Co Ltd | ロボツト制御装置 |
CN1418762A (zh) * | 2002-12-16 | 2003-05-21 | 北京航空航天大学 | 多轴伺服运动控制装置 |
WO2009029127A2 (en) * | 2007-08-24 | 2009-03-05 | Elite Engineering Corporation | Robotic arm and control system |
CN201808061U (zh) * | 2010-08-02 | 2011-04-27 | 山东电力研究院 | 高压带电作业机器人绝缘*** |
CN201989150U (zh) * | 2011-01-17 | 2011-09-28 | 蒋霞 | 变电设备高压带电清扫机器控制*** |
CN202491240U (zh) * | 2012-04-01 | 2012-10-17 | 山东鲁能智能技术有限公司 | 主从式液压机械臂控制器 |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103085055A (zh) * | 2013-01-29 | 2013-05-08 | 山东电力集团公司电力科学研究院 | 带电抢修机器人位置反馈主手*** |
CN103085055B (zh) * | 2013-01-29 | 2016-06-22 | 山东电力集团公司电力科学研究院 | 带电抢修机器人位置反馈主手*** |
CN105005332A (zh) * | 2014-09-10 | 2015-10-28 | 国家电网公司 | 变电站带电水冲洗机器人液压伺服驱动*** |
CN104867394A (zh) * | 2015-04-28 | 2015-08-26 | 国家电网公司 | 一种液压机械臂现实虚拟互动综合实验平台 |
CN105945989A (zh) * | 2015-12-08 | 2016-09-21 | 北京航空航天大学 | 一种基于液压摆动缸驱动关节的机器人液压机械臂 |
CN107561972A (zh) * | 2017-07-27 | 2018-01-09 | 安徽工程大学 | 一种多姿态爬杆机器人无线控制*** |
CN107511826A (zh) * | 2017-09-08 | 2017-12-26 | 国机智能技术研究院有限公司 | 一种液压机器人的控制方法和*** |
CN107577168A (zh) * | 2017-09-08 | 2018-01-12 | 国机智能技术研究院有限公司 | 一种机器人控制***及方法 |
CN108397446A (zh) * | 2018-03-20 | 2018-08-14 | 哈尔滨理工大学 | 一种集成式液压机器人关节控制器 |
CN108397446B (zh) * | 2018-03-20 | 2019-08-02 | 哈尔滨理工大学 | 一种集成式液压机器人关节控制器 |
CN112388611A (zh) * | 2020-10-15 | 2021-02-23 | 南京晨光集团有限责任公司 | 一种机械臂旋转运动的全液压驱动*** |
CN112388611B (zh) * | 2020-10-15 | 2022-06-21 | 南京晨光集团有限责任公司 | 一种机械臂旋转运动的全液压驱动*** |
Also Published As
Publication number | Publication date |
---|---|
CN102615646B (zh) | 2014-07-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102615646B (zh) | 主从式液压机械臂控制器 | |
CN102615638B (zh) | 高压带电作业机器人主从式液压机械臂*** | |
CN103085054B (zh) | 带电抢修机器人主从式液压力反馈机械臂控制***及方法 | |
CN203077287U (zh) | 带电抢修机器人主从式液压力反馈机械臂控制*** | |
CN103485784A (zh) | 基于虚拟现实技术的采煤机远程操纵***及远程控制方法 | |
CN101937205A (zh) | 新型便携式plc编程装置 | |
CN202491238U (zh) | 高压带电作业机器人主从式液压机械臂*** | |
CN202491240U (zh) | 主从式液压机械臂控制器 | |
CN201754241U (zh) | 嵌入式阀门遥控控制装置 | |
CN103812392A (zh) | 电机驱动控制器及其控制双电机的方法 | |
CN101586589A (zh) | 电液运动一体化模块装置 | |
CN202878317U (zh) | 一种多自由度工业机器人运动控制器 | |
CN102183894A (zh) | 旁通式适配器及其航空发动机快速原型控制方法 | |
CN103085055A (zh) | 带电抢修机器人位置反馈主手*** | |
CN202694024U (zh) | 一种智能仿真仪表 | |
CN104699089A (zh) | 基于can总线的插秧机自动控制*** | |
CN202149789U (zh) | 手持式工程机械故障诊断装置 | |
CN202042119U (zh) | 汽车电控***实验台 | |
CN208271019U (zh) | 一种机器人多轴运动控制装置 | |
CN203228237U (zh) | 一种学习记忆型机械手臂*** | |
CN205212741U (zh) | 一种闭环控制方式单极步进电机控制器 | |
CN202886924U (zh) | 一种小型plc控制器 | |
CN105375840A (zh) | 闭环控制方式单极步进电机控制器 | |
CN213690313U (zh) | 运动控制器及伺服控制*** | |
CN214617262U (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 | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CP03 | Change of name, title or address |
Address after: 250101 Electric Power Intelligent Robot Production Project 101 in Jinan City, Shandong Province, South of Feiyue Avenue and East of No. 26 Road (ICT Industrial Park) Patentee after: National Network Intelligent Technology Co., Ltd. Address before: 250101 Qilu Software Park building, Ji'nan hi tech Zone, Shandong, B-205 Patentee before: Shandong Luneng Intelligent Technology Co., Ltd. |
|
CP03 | Change of name, title or address |