CN113400143A - 机器人力控末端执行器及其控制方法 - Google Patents

机器人力控末端执行器及其控制方法 Download PDF

Info

Publication number
CN113400143A
CN113400143A CN202011024169.2A CN202011024169A CN113400143A CN 113400143 A CN113400143 A CN 113400143A CN 202011024169 A CN202011024169 A CN 202011024169A CN 113400143 A CN113400143 A CN 113400143A
Authority
CN
China
Prior art keywords
force
robot
end effector
voice coil
coil motor
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
Application number
CN202011024169.2A
Other languages
English (en)
Other versions
CN113400143B (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.)
Tianjin University of Technology
Original Assignee
Tianjin University of Technology
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 Tianjin University of Technology filed Critical Tianjin University of Technology
Priority to CN202011024169.2A priority Critical patent/CN113400143B/zh
Publication of CN113400143A publication Critical patent/CN113400143A/zh
Application granted granted Critical
Publication of CN113400143B publication Critical patent/CN113400143B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B24—GRINDING; POLISHING
    • B24B—MACHINES, DEVICES, OR PROCESSES FOR GRINDING OR POLISHING; DRESSING OR CONDITIONING OF ABRADING SURFACES; FEEDING OF GRINDING, POLISHING, OR LAPPING AGENTS
    • B24B19/00—Single-purpose machines or devices for particular grinding operations not covered by any other main group
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B24—GRINDING; POLISHING
    • B24B—MACHINES, DEVICES, OR PROCESSES FOR GRINDING OR POLISHING; DRESSING OR CONDITIONING OF ABRADING SURFACES; FEEDING OF GRINDING, POLISHING, OR LAPPING AGENTS
    • B24B41/00—Component parts such as frames, beds, carriages, headstocks
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B24—GRINDING; POLISHING
    • B24B—MACHINES, DEVICES, OR PROCESSES FOR GRINDING OR POLISHING; DRESSING OR CONDITIONING OF ABRADING SURFACES; FEEDING OF GRINDING, POLISHING, OR LAPPING AGENTS
    • B24B41/00—Component parts such as frames, beds, carriages, headstocks
    • B24B41/04—Headstocks; Working-spindles; Features relating thereto
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B24—GRINDING; POLISHING
    • B24B—MACHINES, DEVICES, OR PROCESSES FOR GRINDING OR POLISHING; DRESSING OR CONDITIONING OF ABRADING SURFACES; FEEDING OF GRINDING, POLISHING, OR LAPPING AGENTS
    • B24B47/00—Drives or gearings; Equipment therefor
    • B24B47/20—Drives or gearings; Equipment therefor relating to feed movement
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B24—GRINDING; POLISHING
    • B24B—MACHINES, DEVICES, OR PROCESSES FOR GRINDING OR POLISHING; DRESSING OR CONDITIONING OF ABRADING SURFACES; FEEDING OF GRINDING, POLISHING, OR LAPPING AGENTS
    • B24B49/00—Measuring or gauging equipment for controlling the feed movement of the grinding tool or work; Arrangements of indicating or measuring equipment, e.g. for indicating the start of the grinding operation
    • B24B49/12—Measuring or gauging equipment for controlling the feed movement of the grinding tool or work; Arrangements of indicating or measuring equipment, e.g. for indicating the start of the grinding operation involving optical means
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B24—GRINDING; POLISHING
    • B24B—MACHINES, DEVICES, OR PROCESSES FOR GRINDING OR POLISHING; DRESSING OR CONDITIONING OF ABRADING SURFACES; FEEDING OF GRINDING, POLISHING, OR LAPPING AGENTS
    • B24B51/00—Arrangements for automatic control of a series of individual steps in grinding a workpiece

Abstract

本发明公开了一种机器人力控末端执行器及其控制方法，机器人力控末端执行器包括：连接法兰、音圈电机模块和打磨模块，音圈电机模块包括：音圈电机、支架、直线导轨和位移传感器，直线导轨和音圈电机的定子均固装在支架上，音圈电机的动子与直线导轨上的滑块固装，连接法兰与支架固装；力传感器的一端与音圈电机的动子固装，另一端安装有打磨模块，位移传感器安装在直线导轨上，打磨模块包括：电主轴以及固装在该电主轴一端的打磨头；控制器读取力传感器和位移传感器的信号并控制音圈电机和电主轴。本发明采用控制器处理位移传感器信号和力传感器信号，通过机器人力控末端执行器磨抛力大小和姿态的实时调节，实现末端执行器恒力打磨控制。

Description

机器人力控末端执行器及其控制方法
技术领域
本发明属于自动化设备及机器人技术领域，具体来说涉及一种机器人力控末端执行器及其控制方法。
背景技术
随着自由形状工件表面质量要求的提高，例如大型风扇叶片、飞机涡轮叶片和螺旋桨，抛光过程复杂化伴随着越来越高的精度水平要求。目前，大多数抛光仍是需要熟练的技术人员手动进行的，存在危险性高、劳动强度大、加工成本高、作业效率低和精度低的问题。为了解决人工抛光的局限性和不足，已经提出并开发了机器人抛光系统以及其他类型的自动抛光设备。其中工业机器人具有价格低廉、工作空间大、灵活性强等优点，但其缺乏面向工件抛光加工过程的力控技术，因此力控技术是实现机器人自由形状工件表面加工的关键技术，亟待解决。
主动柔顺运动控制方法是高抛光质量的主要研究趋势。通过硬件平台实现主动柔顺运动控制有两种方法：直臂式系统和绕臂式系统。直臂式系统通过机器人每个关节的运动实现接触应力控制，由于机器人自身所具有的尺寸大和重量大的特点，在控制过程中动态响应通常较为缓慢，同时机器人自身具备的较大惯性将对工具以及工件产生很大的冲击力，容易损坏工具或工件。然而，抛光过程需要动态地高频调整接触应力，以适应工件表面曲率的突然变化。绕臂式系统采用外部主动式末端执行器运动实现接触力控制，更适用于高速重载的工业机器人。
在力控末端执行器研究领域，机器人磨抛力控末端执行器多通过采用气动马达作为动力源来降低执行器总质量，通过滚珠花键及传动轴等机械结构实现打磨头旋转。但气动式驱动方式存在响应速度慢、迟滞等缺点，机械结构传动存在机构复杂、运动中机械振动大、控制性能差等缺陷。
发明内容
针对现有技术的不足，本发明的目的在于提供一种机器人力控末端执行器，该机器人力控末端执行器采用了音圈电机驱动和电主轴打磨的方式，提高力控精度和响应速度的同时降低了机器人力控末端执行器整体质量，同时通过控制器的设置，实现机器人末端位置补偿控制和磨抛力的闭环控制，具有质量轻、精度高、响应快的优点。
本发明的另一目的是提供上述机器人力控末端执行器的控制方法。
本发明的目的是通过下述技术方案予以实现的。
一种机器人力控末端执行器，包括：连接法兰、音圈电机模块、力传感器、控制器和打磨模块，所述音圈电机模块包括：音圈电机、支架、直线导轨和位移传感器，直线导轨和所述音圈电机的定子均固装在所述支架上，所述音圈电机的动子与直线导轨上的滑块固装，所述连接法兰与支架固装，用于将音圈电机模块与机器人固装；所述力传感器的一端与所述音圈电机的动子固装，另一端安装有所述打磨模块，用于检测该打磨模块的接触力和力矩，所述位移传感器安装在所述直线导轨上，用于检测所述动子的位置，所述打磨模块包括：电主轴以及固装在该电主轴一端的打磨头；
所述控制器读取所述力传感器和位移传感器的信号并控制所述音圈电机和电主轴。
在上述技术方案中，所述力传感器通过一安装法兰与所述音圈电机的动子固装。
在上述技术方案中，所述电主轴与所述直线导轨上滑块的滑动方向平行或垂直。
在上述技术方案中，当所述电主轴与所述直线导轨上滑块的滑动方向平行时，所述打磨模块还包括：套筒，所述套筒安装在所述力传感器上，所述电主轴的一端位于所述套筒内且另一端从所述套筒伸出并与所述打磨头固装。
在上述技术方案中，所述电主轴通过固定法兰与所述套筒固装。
在上述技术方案中，当所述电主轴与所述直线导轨上滑块的滑动方向垂直时，所述打磨模块还包括：用于将所述电主轴固装在所述力传感器上的固定卡箍，所述电主轴通过所述固定卡箍与所述力传感器连接。
上述机器人力控末端执行器的控制方法，包括以下步骤：
步骤1，将机器人力控末端执行器中音圈电机的动子的行程的中间位置定义为运动参考位置Pd，采用PD控制方法使音圈电机的动子保持在运动参考位置Pd；
基于宏运动控制算法使机器人移动机器人力控末端执行器，使机器人力控末端执行器不与待加工物体接触，所述控制器读取所述力传感器的力值，机器人的控制柜采集机器人的姿态，将力传感器的力值以此时的姿态进行投影，得到该姿态下力传感器的力值为打磨模块的质量M；对所述力传感器的力值进行补偿处理：控制器将力传感器的获得力值减去质量M作为补偿后力值；
在所述步骤1中，宏运动控制算法为基于重力补偿的PD控制方法。
步骤2，使机器人移动机器人力控末端执行器并向待加工物体靠近，基于补偿后力值，控制器判断所述打磨头是否与待加工物体接触，当所述打磨头与待加工物体接触时，进行步骤3；当所述打磨头与待加工物体不接触时，使机器人移动机器人力控末端执行器继续向待加工物体靠近直至所述打磨头与待加工物体接触；
在所述步骤2中，当补偿后力值处于力归零状态误差范围时，所述打磨头与待加工物体不接触；当补偿后力值处于力归零状态误差范围外时，所述打磨头与待加工物体接触。
步骤3，将期望力传感器获得的力值设定为fr，使机器人移动机器人力控末端执行器且力传感器此时获得的力值为f，f大于fr，设定η1为待加工物体和打磨头之间的摩擦系数且η1＜η2，η2为0.6～1.2,首先，调整f以使η1fr＜f-fr＜η2fr，此时使机器人移动机器人力控末端执行器的速度降低至原速度的0.5；
在使机器人移动机器人力控末端执行器的速度降低至原速度的0.5的前提下，当η2fr＜f-fr＜2fr时，此时，使机器人移动机器人力控末端执行器的速度降低至接近零，控制器将PD控制方法切换为自适应阻抗控制方法，使保持在运动参考位置Pd的动子开始移动直至f＝fr；
在所述步骤3中，所述自适应阻抗控制方法通过引入间接自适应控制方法，设计自适应控制器，实现音圈电机的动子的位移跟踪情况下对fr的跟踪。
步骤4，使机器人调整机器人力控末端执行器在待加工物体表面的姿态和位置，所述控制器读取所述力传感器的力矩值M1，打磨头与待加工物体表面接触期望力矩值为Mr，计算M1和Mr的偏差，将偏差转换为机器人调整机器人力控末端执行器的偏转角度；
所述控制器读取位移传感器读数，检测音圈电机的动子的位置，将此时位置与运动参考位置Pd的误差反馈至机器人的控制柜，基于宏运动控制算法使机器人沿音圈电机运动方向移动，采用自适应阻抗控制方法使音圈电机的动子移动至运动参考位置Pd，机器人使移动机器人力控末端执行器沿着待加工物体表面开始移动且此时启动电主轴；
步骤5，当力传感器获得的力值f小于fr，重复步骤2～4。
本发明的有益效果如下：
1、针对待加工物体抛光加工过程引入力控技术，控制器采用基于重力补偿的PD控制方法和自适应阻抗控制方法处理位移传感器位置信号和力传感器的力、力矩信号，实现机器人对力控末端执行器磨抛力大小和姿态的实时调节，满足机器人沿工件表面力控加工过程。
2、针对抛光过程硬件平台响应速度慢及负载大的特点，机器人力控末端执行器采用音圈电机驱动及电主轴实现打磨运动的方案，方案结构简单紧凑，提高力控精度和响应速度，同时降低机器人力控末端执行器的运动冲击，降低运动引起的噪声和振动。
3、针对抛光对象尺寸变化，采用两种打磨模块来实现电主轴水平或垂直安装，进行机器人力控末端执行器整体尺寸调整，用以改变磨抛机器人工作范围以及磨抛头加工方向，满足更多场合使用。
附图说明
图1为本发明机器人力控末端执行器的结构示意图(电主轴与直线导轨上滑块的滑动方向平行)；
图2为本发明机器人力控末端执行器的结构示意图(电主轴与直线导轨上滑块的滑动方向垂直)；
图3为安装有本发明机器人力控末端执行器的机器人的结构示意图(电主轴与直线导轨上滑块的滑动方向平行)；
图4为安装有本发明机器人力控末端执行器的机器人的结构示意图(电主轴与直线导轨上滑块的滑动方向垂直)。
其中，1：连接法兰，2：音圈电机模块，3：支架，4：位移传感器，5：定子，6：动子：7：直线导轨，8：安装法兰，9：力传感器，10：打磨模块，11：套筒，12：固定法兰，13：打磨头，14：固定卡箍，15：电主轴。
具体实施方式
下面结合具体实施例进一步说明本发明的技术方案。
实施例1
一种机器人力控末端执行器，包括：连接法兰1、音圈电机模块2、力传感器9、控制器和打磨模块10，音圈电机模块2包括：音圈电机、支架3、直线导轨7和位移传感器4，直线导轨7和音圈电机的定子均固装在支架3上，音圈电机的动子与直线导轨上的滑块固装，直线导轨作为连接音圈电机动子和定子的导向装置，连接法兰1与支架3固装，用于将音圈电机模块2与机器人固装，以实现将机器人的位姿控制和机器人力控末端执行器的磨抛力控制连接起来；力传感器9的一端与音圈电机的动子固装，另一端安装有打磨模块10，用于检测该打磨模块10的接触力和力矩，位移传感器4安装在直线导轨7上，用于检测动子的位置，打磨模块10包括：电主轴以及固装在该电主轴一端的打磨头13；
控制器读取力传感器9和位移传感器4的信号并控制音圈电机和电主轴。
实施例2
在实施例1的基础上，力传感器9通过一安装法兰8与音圈电机的动子固装。电主轴与直线导轨7上滑块的滑动方向平行(轴向打磨)或垂直(径向打磨)。
实施例3
在实施例2的基础上，当电主轴与直线导轨7上滑块的滑动方向平行时，打磨模块10还包括：套筒11，套筒11安装在力传感器9上，电主轴的一端位于套筒11内且另一端从套筒11伸出并与打磨头13固装。电主轴通过固定法兰12与套筒固装。
实施例4
在实施例2的基础上，当电主轴与直线导轨7上滑块的滑动方向垂直时，打磨模块10还包括：用于将电主轴15固装在力传感器9上的固定卡箍14，电主轴15通过固定卡箍14与力传感器9连接。
本发明的机器人力控末端执行器为磨抛装置，可以实现径向打磨和轴向打磨两套方案。机器人为六自由度串联工业机器人，用于提供机器人力控末端执行器的位置和姿态，使其按照规划的刀路轨迹运动。
作为进一步解释，固定卡箍14的外形包括：一圆盘以及固装在该圆盘一侧由两半圆拼接成的圆环形，圆环形内用于放置电主轴，圆环形的尺寸可根据电主轴15的轴径进行调整，在圆环顶部留有夹紧螺栓孔，螺栓孔内安装螺栓，满足加工过程固定电主轴的需求，实现加工过程稳定，电主轴与打磨头连接方式不发生改变，电主轴为高速电机与传动轴一体装置。
位移传感器4为光栅位移传感器。控制器将驱动音圈电机模块带动打磨模块线性运动，位置控制环由位移传感器4控制行程和位置精度，力控制环通过力传感器9获取打磨模块实际接触力信息，并将其转换为音圈电机模块的驱动信号和工业机器人的姿态调整信号，用于机器人力控末端执行器磨抛力大小和姿态的实时调节，实现磨头与待加工物体之间接触应力的闭环控制。
打磨模块10实现打磨过程，音圈电机模块2驱动打磨模块线性运动，由此实现打磨模块沿机器人力控末端执行器轴向线性运动，从而实现打磨模块磨抛力的调整。
上述机器人力控末端执行器的控制方法，包括以下步骤：
步骤1，将机器人力控末端执行器中音圈电机的动子的行程的中间位置定义为运动参考位置Pd，采用PD控制方法(参考文献：Ma,Zheng,et al.Control and Modeling ofan End-Effector in a Macro-Mini Manipulator System for IndustrialApplications[C].2017 IEEE International Conference on Advanced IntelligentMechatronics(AIM),2017,pp.676–681.)使音圈电机的动子保持在运动参考位置Pd；
基于宏运动控制算法(参考文献：Zamora-Gómez,Griselda I.,et al.An Output-Feedback Global Continuous Control Scheme with Desired Gravity Compensationfor the Finite-Time and Exponential Regulation of Bounded-Input RoboticSystems[J].IFAC-PapersOnLine,vol.51,no.22,2018,pp.108–114.)使机器人移动机器人力控末端执行器，使机器人力控末端执行器不与待加工物体接触，宏运动控制算法为基于重力补偿的PD控制方法。控制器读取力传感器9的力值，机器人的控制柜采集机器人的姿态，将力传感器9的力值以此时的姿态进行投影，得到该姿态下力传感器9的力值为打磨模块10的质量M；对力传感器9的力值进行补偿处理：控制器将力传感器9的获得力值减去质量M作为补偿后力值；
步骤2，使机器人移动机器人力控末端执行器并向待加工物体靠近，基于补偿后力值，控制器判断打磨头13是否与待加工物体接触，当打磨头13与待加工物体接触时(接触场景)，进行步骤3；当打磨头13与待加工物体不接触时(非接触场景)，使机器人移动机器人力控末端执行器继续向待加工物体靠近直至打磨头13与待加工物体接触；其中，当补偿后力值处于力归零状态误差范围时，打磨头13与待加工物体不接触；当补偿后力值处于力归零状态误差范围外时，打磨头13与待加工物体接触。
步骤3，将期望力传感器9获得的力值设定为fr，使机器人移动机器人力控末端执行器且力传感器9此时获得的力值为f(打磨模块10的接触力)，f大于fr，设定η1为待加工物体和打磨头13之间的摩擦系数且η1＜η2，η2为0.6～1.2，首先，调整f以使η1fr＜f-fr＜η2fr，此时使机器人移动机器人力控末端执行器的速度降低至原速度的0.5；
在使机器人移动机器人力控末端执行器的速度降低至原速度的0.5的前提下，当η2fr＜f-fr＜2fr时，使机器人移动机器人力控末端执行器的速度降低至接近零，控制器将PD控制方法切换为自适应阻抗控制方法(参考文献：Seraji,Homayoun,and RichardColbaugh.Force tracking in impedance control[J].The International Journal ofRobotics Research,vol.16,no.1,pp.97-117,1997.)，使保持在运动参考位置Pd的动子开始移动直至f＝fr；
其中，自适应阻抗控制方法通过引入间接自适应控制方法，设计自适应控制器，实现音圈电机的动子的位移跟踪情况下对fr的跟踪。
步骤4，使机器人调整机器人力控末端执行器在待加工物体表面的姿态和位置，控制器读取力传感器9的力矩值M1，打磨头与待加工物体表面接触期望力矩值为Mr，计算M1和Mr的偏差，将偏差转换为机器人调整机器人力控末端执行器的偏转角度(参考文献：Bosheng,Ye,et al.A Study of Force and Position Tracking Control for RobotContact with an Arbitrarily Inclined Plane[J],International Journal ofAdvanced Robotic Systems,vol.10,no.1,2013.)；
控制器读取位移传感器读数，检测音圈电机的动子的位置，将此时位置与运动参考位置Pd的误差反馈至机器人的控制柜，控制柜基于宏运动控制算法使机器人沿音圈电机运动方向移动，控制器采用自适应阻抗控制方法使音圈电机的动子移动至运动参考位置Pd，机器人使移动机器人力控末端执行器沿着待加工物体表面开始移动且此时启动电主轴；
步骤5，当力传感器9获得的力值f小于fr，重复步骤2～4。
通过本发明的技术方案，在待加工物体出现较大的外形尺寸误差时，机器人通过力传感器获得的力和力矩数据和位移传感器获得的位置数据进行机器人力控末端执行器姿态和位置调整，可以使机器人沿着未知的工件轮廓运动而不会失去接触。当待加工物体几何尺寸变化的速率在机器人系统带宽之内，就可以满足机器人的跟踪能力，但此方案在超出机器人力控末端执行器工作范围的情况下，也能发挥相应功能。
以上对本发明做了示例性的描述，应该说明的是，在不脱离本发明的核心的情况下，任何简单的变形、修改或者其他本领域技术人员能够不花费创造性劳动的等同替换均落入本发明的保护范围。

Claims (10)

1.一种机器人力控末端执行器，其特征在于，包括：连接法兰(1)、音圈电机模块(2)、力传感器(9)、控制器和打磨模块(10)，所述音圈电机模块(2)包括：音圈电机、支架(3)、直线导轨(7)和位移传感器(4)，所述直线导轨(7)和所述音圈电机的定子(5)均固装在所述支架(3)上，所述音圈电机的动子(6)与直线导轨(7)上的滑块固装，所述连接法兰(1)与支架(3)固装，用于将音圈电机模块(2)与机器人固装，所述力传感器(9)的一端与所述音圈电机的动子(6)固装，另一端安装有所述打磨模块(10)，用于检测该打磨模块(10)的接触力和力矩，所述位移传感器(4)安装在所述直线导轨(7)上，用于检测所述动子(6)的位置，所述打磨模块(10)包括：电主轴(15)以及固装在该电主轴(15)一端的打磨头(13)；
所述控制器读取所述力传感器(9)和位移传感器(4)的信号并控制所述音圈电机和电主轴(15)。
2.根据权利要求1所述的机器人力控末端执行器，其特征在于，所述力传感器(9)通过一安装法兰(8)与所述音圈电机的动子(6)固装。
3.根据权利要求1或2所述的机器人力控末端执行器，其特征在于，所述电主轴(15)与所述直线导轨(7)上滑块的滑动方向平行或垂直。
4.根据权利要求3所述的机器人力控末端执行器，其特征在于，当所述电主轴(15)与所述直线导轨(7)上滑块的滑动方向平行时，所述打磨模块(10)还包括：套筒(11)，所述套筒(11)安装在所述力传感器(9)上，所述电主轴(15)的一端位于所述套筒(11)内且另一端从所述套筒(11)伸出并与所述打磨头(13)固装。
5.根据权利要求4所述的机器人力控末端执行器，其特征在于，所述电主轴(15)通过固定法兰(12)与所述套筒(11)固装。
6.根据权利要求3所述的机器人力控末端执行器，其特征在于，当所述电主轴(15)与所述直线导轨(7)上滑块的滑动方向垂直时，所述打磨模块(10)还包括：用于将所述电主轴(15)固装在所述力传感器(9)上的固定卡箍(14)，所述电主轴(15)通过所述固定卡箍(14)与所述力传感器(9)连接。
7.如权利要求1所述机器人力控末端执行器的控制方法，其特征在于，包括以下步骤：
步骤1，将机器人力控末端执行器中音圈电机的动子(6)的行程的中间位置定义为运动参考位置Pd，采用PD控制方法使音圈电机的动子(6)保持在运动参考位置Pd；
基于宏运动控制算法使机器人移动机器人力控末端执行器，使机器人力控末端执行器不与待加工物体接触，所述控制器读取所述力传感器(9)的力值，机器人的控制柜采集机器人的姿态，将力传感器(9)的力值以此时的姿态进行投影，得到该姿态下力传感器9的力值为打磨模块(10)的质量M；对所述力传感器(9)的力值进行补偿处理：控制器将力传感器(9)的获得力值减去质量M作为补偿后力值；
步骤2，使机器人移动机器人力控末端执行器并向待加工物体靠近，基于补偿后力值，控制器判断所述打磨头(13)是否与待加工物体接触，当所述打磨头(13)与待加工物体接触时，进行步骤3；当所述打磨头(13)与待加工物体不接触时，使机器人移动机器人力控末端执行器继续向待加工物体靠近直至所述打磨头(13)与待加工物体接触；
步骤3，将期望力传感器(9)获得的力值设定为fr，使机器人移动机器人力控末端执行器且力传感器(9)此时获得的力值为f，f大于fr，设定η1为待加工物体和打磨头(13)之间的摩擦系数且η1＜η2，η2为0.6～1.2,首先，调整f以使η1fr＜f-fr＜η2fr，此时使机器人移动机器人力控末端执行器的速度降低至原速度的0.5；
在使机器人移动机器人力控末端执行器的速度降低至原速度的0.5的前提下，当η2fr＜f-fr＜2fr时，使机器人移动机器人力控末端执行器的速度降低至接近零，控制器将PD控制方法切换为自适应阻抗控制方法，使保持在运动参考位置Pd的动子(6)开始移动直至f＝fr；
步骤4，使机器人调整机器人力控末端执行器在待加工物体表面的姿态和位置，所述控制器读取所述力传感器(9)的力矩值M1，打磨头(13)与待加工物体表面接触期望力矩值为Mr，计算M1和Mr的偏差，将偏差转换为机器人调整机器人力控末端执行器的偏转角度；
所述控制器读取位移传感器(4)读数，检测音圈电机的动子(6)的位置，将此时位置与运动参考位置Pd的误差反馈至机器人的控制柜，基于宏运动控制算法使机器人沿音圈电机运动方向移动，采用自适应阻抗控制方法使音圈电机的动子(6)移动至运动参考位置Pd，机器人使移动机器人力控末端执行器沿着待加工物体表面开始移动且此时启动电主轴(15)；
步骤5，当力传感器(9)获得的力值f小于fr，重复步骤2～4。
8.根据权利要求7所述的控制方法，其特征在于，在所述步骤1中，宏运动控制算法为基于重力补偿的PD控制方法。
9.根据权利要求7所述的控制方法，其特征在于，在所述步骤2中，当补偿后力值处于力归零状态误差范围时，所述打磨头(13)与待加工物体不接触；当补偿后力值处于力归零状态误差范围外时，所述打磨头(13)与待加工物体接触。
10.根据权利要求7所述的控制方法，其特征在于，在所述步骤3中，所述自适应阻抗控制方法通过引入间接自适应控制方法，设计自适应控制器，实现音圈电机的动子(6)的位移跟踪情况下对fr的跟踪。
CN202011024169.2A 2020-09-25 2020-09-25 机器人力控末端执行器及其控制方法 Active CN113400143B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202011024169.2A CN113400143B (zh) 2020-09-25 2020-09-25 机器人力控末端执行器及其控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202011024169.2A CN113400143B (zh) 2020-09-25 2020-09-25 机器人力控末端执行器及其控制方法

Publications (2)

Publication Number Publication Date
CN113400143A true CN113400143A (zh) 2021-09-17
CN113400143B CN113400143B (zh) 2022-04-19

Family

ID=77677367

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202011024169.2A Active CN113400143B (zh) 2020-09-25 2020-09-25 机器人力控末端执行器及其控制方法

Country Status (1)

Country Link
CN (1) CN113400143B (zh)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114448320A (zh) * 2021-12-22 2022-05-06 上海智能制造功能平台有限公司 一种基于音圈电机的电磁顺应装置
CN115026702A (zh) * 2022-08-11 2022-09-09 四川至臻光电有限公司 一种高效抛光装置
US20230294303A1 (en) * 2022-03-21 2023-09-21 National Taipei University Of Technology Flange device using voice coil motor and contact control method thereof

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2001078418A (ja) * 1999-09-08 2001-03-23 Shin Etsu Chem Co Ltd ハードディスクドライブ用ボイスコイルモーターのヨーク部品及びヨーク部品のバリ取り方法並びにボイスコイルモーター
JP2001260020A (ja) * 2000-03-16 2001-09-25 Canon Inc 加圧力可変研磨装置
CN201611867U (zh) * 2010-02-05 2010-10-20 桂林电子科技大学 直线音圈电机非线性特性的智能补偿控制系统
CN103894903A (zh) * 2014-04-10 2014-07-02 哈尔滨工业大学 一种可控接触压力抛光装置
CN204442084U (zh) * 2015-02-14 2015-07-01 广东工业大学 电磁一维恒力装置
CN105751218A (zh) * 2016-05-05 2016-07-13 佛山市新鹏机器人技术有限公司 一种用于机器人末端的恒力装置及其控制方法
CN107054395A (zh) * 2017-03-21 2017-08-18 中车山东机车车辆有限公司 一种主动控制式作动器及转向架
CN110861097A (zh) * 2019-12-24 2020-03-06 中国科学院宁波材料技术与工程研究所 减小机械臂振动的力控末端执行机构及力控方法
CN110977760A (zh) * 2019-12-24 2020-04-10 华中科技大学 一种单自由度高带宽力控磨抛装置及其应用

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2001078418A (ja) * 1999-09-08 2001-03-23 Shin Etsu Chem Co Ltd ハードディスクドライブ用ボイスコイルモーターのヨーク部品及びヨーク部品のバリ取り方法並びにボイスコイルモーター
JP2001260020A (ja) * 2000-03-16 2001-09-25 Canon Inc 加圧力可変研磨装置
CN201611867U (zh) * 2010-02-05 2010-10-20 桂林电子科技大学 直线音圈电机非线性特性的智能补偿控制系统
CN103894903A (zh) * 2014-04-10 2014-07-02 哈尔滨工业大学 一种可控接触压力抛光装置
CN204442084U (zh) * 2015-02-14 2015-07-01 广东工业大学 电磁一维恒力装置
CN105751218A (zh) * 2016-05-05 2016-07-13 佛山市新鹏机器人技术有限公司 一种用于机器人末端的恒力装置及其控制方法
CN107054395A (zh) * 2017-03-21 2017-08-18 中车山东机车车辆有限公司 一种主动控制式作动器及转向架
CN110861097A (zh) * 2019-12-24 2020-03-06 中国科学院宁波材料技术与工程研究所 减小机械臂振动的力控末端执行机构及力控方法
CN110977760A (zh) * 2019-12-24 2020-04-10 华中科技大学 一种单自由度高带宽力控磨抛装置及其应用

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114448320A (zh) * 2021-12-22 2022-05-06 上海智能制造功能平台有限公司 一种基于音圈电机的电磁顺应装置
US20230294303A1 (en) * 2022-03-21 2023-09-21 National Taipei University Of Technology Flange device using voice coil motor and contact control method thereof
US11820002B2 (en) * 2022-03-21 2023-11-21 National Taipei University Of Technology Flange device using voice coil motor and contact control method thereof
CN115026702A (zh) * 2022-08-11 2022-09-09 四川至臻光电有限公司 一种高效抛光装置

Also Published As

Publication number Publication date
CN113400143B (zh) 2022-04-19

Similar Documents

Publication Publication Date Title
CN113400143B (zh) 机器人力控末端执行器及其控制方法
Chen et al. Robotic grinding of a blisk with two degrees of freedom contact force control
CN109986542A (zh) 一种气电混合驱动的刚柔混合型力控末端执行器
CN111843766B (zh) 一种用于机器人研抛加工的高精度力位混合控制装置
CN110103116B (zh) 一种自适应姿态的主被动柔顺磨抛装置及磨抛机器人
CN111708322B (zh) 三坐标定位器调姿运控方法、系统、调姿控制器及存储介质
CN107855791B (zh) 一种多并联柔索式光学镜面加工装置
CN105729305A (zh) 力位耦合微动精密抛光装置及在线力检测与控制方法
CN110977760A (zh) 一种单自由度高带宽力控磨抛装置及其应用
CN114310540B (zh) 一种机匣流道焊缝机器人自动磨削的装备及方法
CN112172953B (zh) 一种爬壁机器人吸附腔位姿调整机构及控制方法
CN111745536A (zh) 一种用于机器人的气电混合式力控末端执行器
CN209868599U (zh) 一种气电混合驱动的刚柔混合型力控末端执行器
CN113172511A (zh) 一种基于常力机构的机器人打磨执行器
CN111716355A (zh) 机器人绝对定位精度补偿系统及方法
CN114434325B (zh) 一种基于串联弹性执行器的单自由度力控磨头装置
Deng et al. A review of robot grinding and polishing force control mode
CN112440293B (zh) 一种力控末端执行器及工业机器人
CN108638103B (zh) 一种自动抓取及位姿调整的机器人末端执行器及调整方法
CN107378336A (zh) 一种多维度焊接机器人
JP4392251B2 (ja) 送り駆動系の制御装置
US20220193857A1 (en) Device for the Robot-Assisted Machining of Surfaces
CN114800551B (zh) 一种针对复杂曲面的机器人力控磨抛装置及控制方法
CN216463647U (zh) 一种多轴光学元件小磨头抛光装备
CN107085392B (zh) 一种工业机器人的打磨抛光工具及打磨抛光控制方法

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
OL01 Intention to license declared