CN102059699B - 三自由度混合驱动柔索并联机器人控制装置及方法 - Google Patents

三自由度混合驱动柔索并联机器人控制装置及方法 Download PDF

Info

Publication number
CN102059699B
CN102059699B CN2010105801915A CN201010580191A CN102059699B CN 102059699 B CN102059699 B CN 102059699B CN 2010105801915 A CN2010105801915 A CN 2010105801915A CN 201010580191 A CN201010580191 A CN 201010580191A CN 102059699 B CN102059699 B CN 102059699B
Authority
CN
China
Prior art keywords
parallel robot
gentle
programmable logic
industrial computer
logic controller
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.)
Expired - Fee Related
Application number
CN2010105801915A
Other languages
English (en)
Other versions
CN102059699A (zh
Inventor
訾斌
朱真才
魏明生
曹建斌
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
China University of Mining and Technology CUMT
Original Assignee
China University of Mining and Technology CUMT
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by China University of Mining and Technology CUMT filed Critical China University of Mining and Technology CUMT
Priority to CN2010105801915A priority Critical patent/CN102059699B/zh
Publication of CN102059699A publication Critical patent/CN102059699A/zh
Application granted granted Critical
Publication of CN102059699B publication Critical patent/CN102059699B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Manipulator (AREA)

Abstract

一种三自由度混合驱动柔索并联机器人控制装置及方法,包括柔索并联机器人、主控工控机、测量工控机、通信装置、可编程逻辑控制器、传感器和混合驱动控制器,主控工控机通过通信装置与可编程逻辑控制器连接,混合驱动控制器的输出端与柔索并联机器人连接,柔索并联机器人通过传感器与测量工控机连接,测量工控机通过通信装置与主控工控机连接。通过测量工控机实时处理测量数据并通过通信装置把测量数据发送给主控工控机,经主控工控机、可编程逻辑控制器、测量工控机之间以串行总线方式进行通信,可控制四组混合驱动控制器实现四根柔索的协调收放,完成混合驱动柔索并联机器人空间三维平动自由度的高精度运动;系统响应快速、稳定性和精确性强。

Description

三自由度混合驱动柔索并联机器人控制装置及方法
技术领域
本发明涉及一种机器人控制装置及方法,特别是一种三自由度混合驱动柔索并联机器人控制装置及方法。
背景技术
三自由度柔索并联机器人具有重要的应用价值,可用于起重、加工、检测、装配、搬运等操作任务。在专利申请号为200910233341.2的专利文献中,公开了《空间三维平动自由度混合驱动柔索并联机构》,该混合驱动柔索并联机器人机构是一种结构简单,能够完成大负载运转、复杂运动规律,实现高性能运动输出的新型空间三维平动自由度柔索并联机器人。尽管该混合驱动柔索并联机器人机构可以完成机器人重物块的运动,但由于该机器人系统具有大惯性、多输入多输出、非线性等特点,并且受系统模型的参数摄动以及重物块在运动中随机风等外界干扰的影响,使得混合驱动柔索并联机器人运动灵活性、稳定性和精确性还不够完善。
发明内容
本发明的目的是要提供一种:能够完善机器人运动灵活性、稳定性和精确性的三自由度混合驱动柔索并联机器人控制装置及方法。
本发明的目的是这样实现的:三自由度混合驱动柔索并联机器人控制装置,包括柔索并联机器人、主控工控机、测量工控机、通信装置、可编程逻辑控制器、传感器和混合驱动控制器,主控工控机通过通信装置与可编程逻辑控制器连接,混合驱动控制器的输出端与柔索并联机器人连接,柔索并联机器人通过传感器与测量工控机连接,测量工控机通过通信装置与主控工控机连接。
所述的混合驱动控制器共有四组,每一组结构相同,包括混合驱动机构、光电编码器、变频器和驱动器,可编程逻辑控制器的输出端与变频器和驱动器的输入端连接,变频器和驱动器的输出端与混合驱动机构连接,光电编码器的输出端与可编程逻辑控制器的输入端连接。
所述的混合驱动机构包括交流三相异步电机、交流伺服电机和双曲柄五连杆机构,交流三相异步电机和交流伺服电机分别与双曲柄五连杆机构的两个曲柄相连接,交流三相异步电机、交流伺服电机两种类型的输入通过连杆铰接合成;交流三相异步电机与变频器连接,交流伺服电机与驱动器连接,四根柔索的末端与柔索并联机器人的重物块连接,四组混合驱动机构均与一台可编程逻辑控制器连接,四组变频器、四组伺服驱动器、四组混合驱动机构硬件布置及连线均相同。
所述的传感器包括光电编码器、光栅位移传感器、测力传感器、称重传感器和接近传感器;光电编码器分别安装在混合驱动机构中的交流伺服电机和交流三相异步电机上,在柔索并联机器人的重物块上安装3个光栅位移传感器,称重传感器安装在重物块上,同时在重物块上安装有接近传感器,在四根柔索上各安装一个相同的测力传感器。
所述的柔索并联机器人是由四根相连成十字形对称设置的索塔支架、导向滑轮、四根柔索、重物块组成,每根索塔支架之上均设有柔索导向滑轮,四根柔索通过导向滑轮在索塔支架上的支撑与重物块连接。
所述装置的控制方法包括如下步骤:
1、混合驱动柔索并联机器人牵引重物块运动时,安装在混合驱动柔索并联机器人重物块上的光栅位移传感器、称重传感器和接近传感器,以及在四根柔索上安装的测力传感器,所有传感器将测得的信号,并将所需信号传送到测量工控机;
2、测量工控机实时处理测量数据并通过通信装置把测量数据发送给主控工控机;
3、主控工控机对接收到的信号进行分析处理并完成人机交互功能、混合驱动柔索并联机器人力学计算,控制系统解算,形成控制误差信号通过通信装置传送给可编程逻辑控制器;可编程逻辑控制器还接受来自与交流伺服驱动器、交流伺服电机相配套的光电编码器测得交流伺服电机的转角与转速信号,并与反馈给可编程逻辑控制器的光电编码器接口构成位置反馈控制;此外,在运动控制过程中,可编程逻辑控制器同时还对连接在交流三相异步电机上的光电编码器测得的启动转速和速度变化信号进行处理,并与变频器接口构成速度反馈控制以保证交流三相异步电机转速恒定;
4、可编程逻辑控制器对接受的控制指令进行分析,计算出控制信号同时输出给交流伺服驱动器和变频器;
5、交流伺服驱动器和变频器分别将信号发送给交流伺服电机和交流三相异步电机完成同时协调运转共同驱动双曲柄五连杆机构,双曲柄五连杆机构实时控制四根柔索进行收索与放索协调动作,进而实现混合驱动柔索并联机器人对重物块的高精度运动;
6、主控工控机、可编程逻辑控制器、测量工控机之间以串行总线方式进行通信,构成一个通信网络系统。
有益效果:由于采用了上述方案,能够实现空间三维平动自由度运动的混合驱动柔索并联机器人控制装置;混合驱动柔索并联机器人控制装置采用分布式结构,由操作管理级主控工控机、重物块控制级可编程逻辑控制器,以及负责实时测量并进行反馈信号的测量工控机、混合驱动柔索并联机器人、通信装置构成,这种控制模式综合了可编程逻辑控制器控制精度高、抗干扰能力强、可靠性好和工控机开放性程度高、信息处理能力强、实时调整优点突出、通用性好的特点;以测量工控机为中心的测量系统,采用数据采集与传感器相结合的方式,最大限度地完成测试工作的全过程,既能实现对信号的检测,又能对所获信号进行分析处理;通过测力传感器、称重传感器和接近传感器还可以确定牵引混合驱动柔索并联机器人重物块的柔索张力、重物块的重量,以及用于重物块运动的避障和防止冲击以实现柔性输出运动;从而能够完善混合驱动柔索并联机器人运动灵活性、稳定性和精确性,达到了本发明的目的。
优点:该混合驱动柔索并联机器人控制装置及方法能够有效控制四组混合驱动控制器实现四根柔索的协调收放完成混合驱动柔索并联机器人空间三维平动自由度的高精度运动;采用由主控工控机、测量工控机、可编程逻辑控制器和通信装置组成的分布式控制模式,具有系统响应快速、信息处理能力强、可靠性好;系统中采用测力传感器、称重传感器和接近传感器可以监测柔索张力、所载工件的重量,以及重物块运动的避障和防止冲击,从而大大提高了混合驱动柔索并联机器人的运动灵活性、稳定性和精确性。 
附图说明
图1 为本发明所述的混合驱动柔索并联机器人控制装置示意框图。
具体实施方式
下面结合附图对本发明的实施例作详细说明:本实施例在以本发明技术方案为前提下进行实施,给出了详细的实施方式和具体的操作过程,但本发明的保护范围不限于下述的实施例。
实施例1:图1中,机器人控制装置包括柔索并联机器人、混合驱动控制器、传感器、主控工控机、测量工控机、通信装置和可编程逻辑控制器,主控工控机通过通信装置与可编程逻辑控制器连接,混合驱动控制器的输出端与柔索并联机器人连接,柔索并联机器人通过传感器与测量工控机连接,测量工控机通过通信装置与主控工控机连接。
所述的混合驱动机构包括交流三相异步电机、交流伺服电机和双曲柄五连杆机构,交流三相异步电机和交流伺服电机分别与双曲柄五连杆机构的两个曲柄相连接,交流三相异步电机为双曲柄五连杆机构提供主要的动力功率,交流伺服电机控制双曲柄五连杆机构的柔性输出,而这两种类型的输入运动通过连杆铰接合成,这样使混合驱动机构在保证输出运动的同时,混合驱动机构的动力分配等特性也得到改善。混合驱动机构由做常速运动的交流三相异步电机和做变速运动的交流伺服电机的两个电机共同驱动,交流三相异步电机提供主要功率并通过变频器进行调速以保证交流三相异步电机转速恒定,交流伺服电机主要对柔索并联机器人运动提供控制调节作用,通过四根柔索协同牵引控制柔索并联机器人的重物块高精度运动,而四组混合驱动机构的联动是通过一台可编程逻辑控制器来控制实现,四组变频器、四组伺服驱动器、四组混合驱动机构硬件布置及连线均相同。
所述的柔索并联机器人是由四根相连成十字形对称设置的索塔支架、导向滑轮、四根柔索、重物块等组成,每根索塔支架之上均设有柔索导向滑轮,四根柔索通过导向滑轮在索塔支架上支撑、牵引重物块运动。
所述的传感器包括光电编码器、光栅位移传感器、测力传感器、称重传感器和接近传感器;光电编码器分别安装在交流伺服电机和交流三相异步电机上,在柔索并联机器人的重物块上安装3个光栅位移传感器,称重传感器安装在重物块上,同时在重物块上安装有接近传感器,在四根柔索上各安装一个相同的测力传感器。
所述的通信装置选用专用通信RS-232/RS-485转换器用于主控工控机、可编程逻辑控制器和测量工控机之间的通信。所述主控工控机负责机器人系统轨迹规划、人机交互、系统维护,数据的保存、处理、显示、优化等多方面的功能。所述可编程逻辑控制器负责互联的四组混合驱动柔索牵引系统的位置协调控制。所述测量工控机负责对测量数据的采集、处理、运行状态信息实时传送至主控工控机,主控工控机、测量工控机与可编程逻辑控制器之间采用ISA总线相连,用于设备的设置、程序下载和运行中的数据传递。
所述的传感器测得混合驱动柔索并联机器人所需的信号,并将信号传送到测量工控机,测量工控机实时处理测量数据并通过通信装置把测量数据发送给主控工控机,主控工控机对接收到的信号进行分析处理,形成控制误差信号通过通信装置传送给可编程逻辑控制器,可编程逻辑控制器对控制指令进行分析,计算出控制信号下发给混合驱动控制器,混合驱动控制器驱动四根柔索的协调收放实现柔索并联机器人的运动,进而构成一个大的闭环传递过程。
所述机器人控制装置的方法,混合驱动柔索并联机器人牵引重物块运动时,安装在混合驱动柔索并联机器人重物块上的3个光栅位移传感器测得重物块的三维平动自由度位移、称重传感器测得重物块的重量,接近传感器测得重物块的极限位移,安装在四根柔索上四个相同测力传感器测得柔索的张力,将传感器测得所需的信号传送到测量工控机;测量工控机实时处理测量数据并通过通信装置把测量数据发送给主控工控机;主控工控机对接收到的信号进行分析处理并完成人机交互功能、混合驱动柔索并联机器人力学计算,控制系统解算,形成控制误差信号通过通信装置传送给可编程逻辑控制器;
可编程逻辑控制器还接受来自与交流伺服驱动器、交流伺服电机相配套的光电编码器测得交流伺服电机的转角与转速信号,并与反馈给可编程逻辑控制器的光电编码器接口构成位置反馈控制;此外,在运动控制过程中,可编程逻辑控制器同时还对连接在交流三相异步电机上的光电编码器测得的启动转速和速度变化信号进行处理,并与变频器接口构成速度反馈控制以保证交流三相异步电机转速恒定;可编程逻辑控制器对接受的控制指令进行分析,计算出控制信号同时输出给交流伺服驱动器和变频器;交流伺服驱动器和变频器分别将信号发送给交流伺服电机和交流三相异步电机完成同时协调运转共同驱动双曲柄五连杆机构,双曲柄五连杆机构实时控制四根柔索进行收索与放索协调动作,进而提高混合驱动柔索并联机器人完成重物块运动的灵活性、稳定性和精确性;主控工控机、可编程逻辑控制器、测量工控机之间以串行总线方式进行通信,构成一个通信网络系统。

Claims (3)

1.一种三自由度混合驱动柔索并联机器人控制装置,其特征是:三自由度混合驱动柔索并联机器人控制装置,包括柔索并联机器人、主控工控机、测量工控机、通信装置、可编程逻辑控制器、传感器和混合驱动控制器,主控工控机通过通信装置与可编程逻辑控制器连接,混合驱动控制器的输出端与柔索并联机器人连接,柔索并联机器人通过传感器与测量工控机连接,测量工控机通过通信装置与主控工控机连接;
所述的混合驱动控制器共有四组,每一组结构相同,包括混合驱动机构、光电编码器、变频器和驱动器,可编程逻辑控制器的输出端与变频器和驱动器的输入端连接,变频器和驱动器的输出端与混合驱动机构连接,光电编码器的输出端与可编程逻辑控制器的输入端连接;
所述的混合驱动机构包括交流三相异步电机、交流伺服电机和双曲柄五连杆机构,交流三相异步电机和交流伺服电机分别与双曲柄五连杆机构的两个曲柄相连接,交流三相异步电机、交流伺服电机两种类型的输入通过连杆铰接合成;交流三相异步电机与变频器连接,交流伺服电机与驱动器连接,四根柔索的末端与柔索并联机器人的重物块连接,四组混合驱动机构均与一台可编程逻辑控制器连接,四组变频器、四组伺服驱动器、四组混合驱动机构硬件布置及连线均相同;
所述的柔索并联机器人是由四根相连成十字形对称设置的索塔支架、导向滑轮、四根柔索、重物块组成,每根索塔支架之上均设有柔索导向滑轮,四根柔索通过导向滑轮在索塔支架上的支撑与重物块连接。
2.根据权利要求1所述的三自由度混合驱动柔索并联机器人控制装置,其特征是:所述的传感器包括光电编码器、光栅位移传感器、测力传感器、称重传感器和接近传感器;光电编码器分别安装在混合驱动机构中的交流伺服电机和交流三相异步电机上,在柔索并联机器人的重物块上安装3个光栅位移传感器,称重传感器安装在重物块上,同时在重物块上安装有接近传感器,在四根柔索上各安装一个相同的测力传感器。
3.一种三自由度混合驱动柔索并联机器人控制方法,其特征是:所述的控制方法包括如下步骤:
(1)、混合驱动柔索并联机器人牵引重物块运动时,安装在混合驱动柔索并联机器人重物块上的光栅位移传感器、称重传感器和接近传感器,以及在四根柔索上安装的测力传感器,所有传感器将测得的信号传送到测量工控机;
(2)、测量工控机实时处理测量数据并通过通信装置把测量数据发送给主控工控机;
(3)、主控工控机对接收到的信号进行分析处理并完成人机交互功能、混合驱动柔索并联机器人力学计算、控制系统解算,形成控制误差信号通过通信装置传送给可编程逻辑控制器;可编程逻辑控制器还接受来自与交流伺服驱动器、交流伺服电机相配套的光电编码器测得交流伺服电机的转角与转速信号,并与反馈给可编程逻辑控制器的光电编码器接口构成位置反馈控制;此外,在运动控制过程中,可编程逻辑控制器同时还对连接在交流三相异步电机上的光电编码器测得的启动转速和速度变化信号进行处理,并与变频器接口构成速度反馈控制以保证交流三相异步电机转速恒定;
(4)、可编程逻辑控制器对接受的控制指令进行分析,计算出控制信号同时输出给交流伺服驱动器和变频器;
(5)、交流伺服驱动器和变频器分别将信号发送给交流伺服电机和交流三相异步电机完成同时协调运转共同驱动双曲柄五连杆机构,双曲柄五连杆机构实时控制四根柔索进行收索与放索协调动作,进而实现混合驱动柔索并联机器人对重物块的高精度运动;
(6)、主控工控机、可编程逻辑控制器、测量工控机之间以串行总线方式进行通信,构成一个通信网络系统。
CN2010105801915A 2010-12-09 2010-12-09 三自由度混合驱动柔索并联机器人控制装置及方法 Expired - Fee Related CN102059699B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN2010105801915A CN102059699B (zh) 2010-12-09 2010-12-09 三自由度混合驱动柔索并联机器人控制装置及方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN2010105801915A CN102059699B (zh) 2010-12-09 2010-12-09 三自由度混合驱动柔索并联机器人控制装置及方法

Publications (2)

Publication Number Publication Date
CN102059699A CN102059699A (zh) 2011-05-18
CN102059699B true CN102059699B (zh) 2012-07-04

Family

ID=43995298

Family Applications (1)

Application Number Title Priority Date Filing Date
CN2010105801915A Expired - Fee Related CN102059699B (zh) 2010-12-09 2010-12-09 三自由度混合驱动柔索并联机器人控制装置及方法

Country Status (1)

Country Link
CN (1) CN102059699B (zh)

Families Citing this family (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102431036B (zh) * 2011-09-19 2014-07-16 中国矿业大学 混合驱动柔索并联机器人实时故障检测装置及方法
CN102601797B (zh) * 2012-04-07 2014-08-06 大连创奇科技有限公司 一种三维平动和一维转动的高速并联机器人
CN103072136B (zh) * 2012-12-28 2015-11-18 北京中科智恒科技有限公司 一种应用于防护材料测试系统的机械人
CN103846649B (zh) * 2014-03-20 2016-08-17 清华大学 一种用于精密装配的两级并联机器人装置
CN104385300B (zh) * 2014-07-24 2015-12-02 合肥工业大学 可缠绕式混合驱动柔索并联机器人运行监测装置及方法
CN104385303B (zh) * 2014-09-23 2016-05-11 合肥工业大学 用于柔索并联机器人的圆轨道式安全监控装置及监控方法
CN104440870B (zh) * 2014-10-23 2016-08-31 合肥工业大学 可变结构参数柔索并联机器人系统及控制方法
CN106964128B (zh) * 2017-03-22 2019-07-16 哈尔滨工程大学 花样滑冰捻转托举保护装置的控制方法
CN107115649B (zh) * 2017-03-22 2019-07-16 哈尔滨工程大学 花样滑冰捻转托举动作保护装置
CN107984333B (zh) * 2017-11-28 2019-07-26 中国矿业大学 一种柔索驱动的光学加工试验机控制系统及方法
CN108481322B (zh) * 2018-03-05 2019-08-16 北京镁伽机器人科技有限公司 具有精确控制功能的机器人、运动控制部件、方法和介质
CN113043272B (zh) * 2021-03-17 2021-09-28 哈尔滨工业大学 应用于空间多自由度绳驱并联机器人的控制系统

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101700657A (zh) * 2009-10-09 2010-05-05 中国矿业大学 空间三维平动自由度混合驱动柔索并联机构
CN201922446U (zh) * 2010-12-09 2011-08-10 中国矿业大学 三自由度混合驱动柔索并联机器人控制装置

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2008188722A (ja) * 2007-02-06 2008-08-21 Fanuc Ltd ロボット制御装置

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101700657A (zh) * 2009-10-09 2010-05-05 中国矿业大学 空间三维平动自由度混合驱动柔索并联机构
CN201922446U (zh) * 2010-12-09 2011-08-10 中国矿业大学 三自由度混合驱动柔索并联机器人控制装置

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
JP特开2008-188722A 2008.08.21
訾斌等.柔索驱动并联机器人运动控制研究.《振动与冲击》.2009,第28卷(第09期),49-51,73,213. *

Also Published As

Publication number Publication date
CN102059699A (zh) 2011-05-18

Similar Documents

Publication Publication Date Title
CN102059699B (zh) 三自由度混合驱动柔索并联机器人控制装置及方法
CN104440870B (zh) 可变结构参数柔索并联机器人系统及控制方法
CN103308338B (zh) 一种基于三自由度并联机构的机床加载装置及加载试验方法
CN108033039B (zh) 一种可调姿态的索驱动太空悬浮装配状态模拟装置
CN111400917B (zh) 一种可变结构的绳索牵引并联机器人的运动学优化求解方法
CN102866030B (zh) 一种五轴联动机床加载试验装置及加载试验方法
CN100581753C (zh) 施釉机器人离线示教装置的示教方法
CN102431036B (zh) 混合驱动柔索并联机器人实时故障检测装置及方法
Zirn Machine tool analysis: modelling, simulation and control of machine tool manipulators
CN103344449B (zh) 一种单自由度数控机床加载装置及加载试验方法
CN105334459B (zh) 工业机器人用伺服电机测试系统
CN109955225A (zh) 一种并联式三自由度力反馈手控器及其控制方法
CN108890625B (zh) 一种可调刚度索驱动并联装置
CN111319028A (zh) 可变结构的绳索牵引并联机器人及其运动学多解求解方法
CN102778890B (zh) 四轴全电驱土工离心机器人
CN115057245B (zh) 一种基于总线控制器与伺服系统的拆码垛系统
CN105234942A (zh) 大持重液压小吊臂的控制系统及其控制方法
CN201922446U (zh) 三自由度混合驱动柔索并联机器人控制装置
CN106363624A (zh) 具有自重平衡装置的柔索并联机械臂系统及其控制方法
CN102049775A (zh) 力伺服控制的电动机械手
CN103495969A (zh) 一种基于接触式传感器的柔性铰链并联机器人控制装置
CN102701076B (zh) 六自由度起重吊装协作柔索并联构型装备控制装置及方法
Do et al. Design and control of dual-arm robot for cell manufacturing process
CN201544232U (zh) 用于电动机械手的控制系统
CN202533226U (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
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20120704

Termination date: 20171209

CF01 Termination of patent right due to non-payment of annual fee