CN113199491A - 一种工业机器人恒力打磨方法 - Google Patents
一种工业机器人恒力打磨方法 Download PDFInfo
- Publication number
- CN113199491A CN113199491A CN202110574992.9A CN202110574992A CN113199491A CN 113199491 A CN113199491 A CN 113199491A CN 202110574992 A CN202110574992 A CN 202110574992A CN 113199491 A CN113199491 A CN 113199491A
- Authority
- CN
- China
- Prior art keywords
- force
- data
- robot
- polishing
- grinding
- 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.)
- Withdrawn
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J11/00—Manipulators not otherwise provided for
- B25J11/005—Manipulators for mechanical processing tasks
- B25J11/0065—Polishing or grinding
-
- 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/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
-
- 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/1679—Programme controls characterised by the tasks executed
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
- Finish Polishing, Edge Sharpening, And Grinding By Specific Grinding Devices (AREA)
Abstract
本发明公开了一种工业机器人恒力打磨方法,包括以下步骤:S1、对机器人的力传感器检测到的力进行重力补偿;S2、根据打磨位置计算初始打磨数据,并控制机器人按照规划的初始打磨数据进行运动;S3、根据实时反馈的打磨力数据计算机器人各关节上由于实时打磨力而产生的转矩,并对相应的关节驱动器进行力矩补偿;S4、形成修正打磨数据,控制机器人按新打磨路径进行运动;S5、打磨作业结束。本发明能够实时有效的对打磨路径进行修正,能够保证打磨的运动精度,提高打磨质量。
Description
技术领域
本发明属于工业机器人打磨技术领域,尤其涉及一种机器人应用于打磨工件的打磨方法。
背景技术
在打磨过程中,机器人末端刀具与工件表面产生磨削力,机器人末端打磨头在磨抛过程中会与被加工工件产生接触力,由于被加工工件外形的不规则性,在机器人位置控制模式下,接触力会随时变化,若接触力较大可能会损坏打磨头、机器人以及工件,而接触力较小时又不能保持磨抛过程中打磨头与工件很好的贴合,进行影响被加工零件的表面质量仅通过机器人位置控制系统达不到打磨任务要求。因此,机器人打磨加工过程中必须控制打磨力的大小,对接触力进行反馈调节,从而能够主动适应环境的变化,满足生产加工中的要求
打磨是一道非常重要的工序,一旦打磨质量不满足要求,往往会导致整个工件的报废。打磨加工表面粗糙度好坏与打磨机器人的位置精度直接相关。为了使打磨的质量和效率达到最优,需要对打磨机器人的运动精度进行提高。
在实际应用中由于关节柔性的存在,打磨头不能很好的跟随预定的打磨轨迹运动,本发明通过将打磨力反馈直接引入位置控制和驱动器电流环,实现对打磨力实时快速的响应,保障打磨机器人的运动精度。
发明内容
本发明的目的在于提高工业机器人打磨的运动精度,提供一种基于六维力传感器的打磨控制方法。
为实现上述目的,本发明采用了以下技术方案:
一种工业机器人恒力打磨方法,其包括以下步骤:
S1、对机器人的力传感器检测到的力进行打磨工具的重力补偿;
S2、根据打磨位置计算初始打磨数据,并控制机器人按照规划的初始打磨数据进行运动,所述初始打磨数据包括初始路径数据、初始位置数据和初始速度数据;
S3、根据实时反馈的打磨力数据计算机器人各关节上由于实时打磨力而产生的转矩,并对相应的关节驱动器进行力矩补偿;
S4、获取实时反馈力数据并计算实时打磨力数据,根据实时打磨力数据更新初始打磨数据,形成修正打磨数据,控制机器人按新打磨路径进行运动;
S5、打磨作业结束;
其中步骤S3和步骤S4是机器人在打磨过程中同时进行的步骤。
步骤S1具体包括如下步骤:
S11、力传感器的零点数据记为:F0=[fx0 fy0 fz0]T,实际传感器力的读数记为:F=[fx fy fz]T,末端工具重力记为G,G在力传感器坐标系上产生的力和力矩记为:Gs=[gx gygz]T。
S12、末端工具重力G在机器人基坐标系O的分力表示为G0=[0 0 -G]T,通过位姿变换矩阵,可得到G在传感器坐标系S上的分力Gs=[gx gy gz]T。
其中:
A、B、C——机器人姿态角;s、c——三角函数sin、cos缩写。
传感器安装偏角α可采用如下公式计算求得,传感器安装偏角α是指传感器坐标系X轴和末端法兰坐标系X轴之间的偏转角。
S13、为了结果的准确性,选取最少3组不同姿态下,通过实验的方法,记录下多组机器人姿态数据,从而求出安装偏角α平均值。补偿后得到的力方向的数值即为真实接触力,可以直接用于力位控制算法。经补偿后的力Fr为:
Fr=[fx-fx0-gx fy-fy0-gy fz-fz0-gz]T
步骤S4具体包括以下步骤:
S41、基于实时打磨力数据对初始位置数据进行修正以得到修正位置数据,通过以下公式将采集到的力F(i)转换为当前位移修正量x(i)
其中,F(i)为机器人第i个采样时刻末端受到的力,Md为惯性系数,Bd为阻尼系数,Kd为刚度系数,x(i)、x(i-1)、x(i-2)为机器人第i个采样时刻末端修正量、第i-1个采样时刻末端修正量、第i-2个采样时刻末端修正量;
S42、基于实时打磨力数据对初始速度数据进行修正以得到修正速度数据v(i);
其中,T为采样周期;
S43、基于实时打磨力数据对初始加速度数据进行修正以得到修正加速度数据;
其中,T为采样周期,v(i)为步骤S41所得修正速度数据。
步骤S3具体包括如下步骤:
S31、数据经滤波处理后通过机器人动力学计算求得各个关节所需的转矩;
S32、求取计算所得转矩与实际驱动器力矩的差值,并经折算为电流值后输入驱动器电流环进行力矩补偿。
采用上述技术方案后,本发明具有如下优点:本发明通过使用六维力传感器实时读取机器人打磨力,通过计算模块将其分解为各电机轴上的力矩,注入电流环进行力矩补偿。同时将六维力传感器测量的力信号引入位置控制系统,可以构成力反馈型阻抗控制,将实时打磨力转换为实时运动偏差,实现对运动偏差的补偿。本发明能够实时有效的对打磨路径进行修正,能够保证打磨的运动精度,提高打磨质量。
附图说明
图1为本方法所述的打磨方法的流程图
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
本发明优选实施例提供了一种工业机器人恒力打磨方法,本发明的力传感器安装于打磨机器人末端法兰与打磨电主轴之间,通过力传感器获取反馈力,如图1所示,本发明包括如下步骤:
S1、对力传感器检测到的力进行打磨工具的重力补偿,消除打磨工具重力的干扰
在5种不同的机器人末端姿态角下进行实验测试,数据经处理后计算求得传感器安装偏角α,并对传感器进行重力补偿;具体步骤如下:
S11、力传感器的零点数据记为:F0=[fx0 fy0 fz0]T,实际传感器力的读数记为:F=[fx fy fz]T,末端打磨工具重力记为G,G在力传感器坐标系上产生的力和力矩记为:Gs=[gxgy gz]T。
S12、末端工具重力G在机器人基坐标系O的分力表示为G0=[0 0 -G]T,通过位姿变换矩阵,可得到G在传感器坐标系S上的分力Gs=[gx gy gz]T。
其中:
A、B、C——机器人姿态角;s、c——三角函数sin、cos缩写。
传感器安装偏角α可采用如下公式计算求得。
S13、为了结果的准确性,选取最少3组不同姿态下,通过实验的方法,记录下多组机器人姿态数据,从而求出安装偏角α平均值。补偿后得到的力方向的数值即为真实接触力,可以直接用于力位控制算法。经补偿后的力Fr为:
Fr=[fx-fx0-gx fy-fy0-gy fz-fz0-gz]T
S2、根据打磨位置计算机器人初始打磨数据,将初始打磨数据下发给工业机器人,控制机器人进行打磨作业,其中初始打磨数据包括初始位置数据、初始速度数据和初始加速度数据;
利用视觉手段获取铸件待打磨区域的位置信息,识别需打磨的领域,并在上位机控制系统中根据打磨位置信息进行轨迹规划,生成机器人初始打磨数据,初始打磨数据包括初始位置数据、初始速度数据和初始加速度数据;
S3、打磨力矩补偿
在打磨过程中,六维力传感器会实时生成打磨力数据并反馈给位置控制和关节驱动器电流环,根据实时反馈的末端打磨力数据计算机器人各关节上由于实时打磨力而产生的各关节所需转矩,并将其引入相应的关节驱动器进行力矩补偿;
S31、对力传感器打磨力数据进行滤波处理,排除干扰的影响,处理后的打磨力进行机器人动力学计算,将末端打磨力分解为各个关节所需的转矩τni。机器人动力学详细计算可参考机械工业出版社出版的《机器人学导论》(原书第4版)/(美)约翰J.克雷格著,贠超、王伟译;
S32、计算所得转矩τni与实际驱动器力矩τri的差值Δτi,并经折算为电流值Δi后写入驱动器电流环对应得PDO地址实现对驱动器的力矩补偿。
S4、修正打磨数据,修正打磨数据包括修正位置数据、修正速度数据和修正加速度数据,控制机器人按新打磨路径进行运动;
机器人按初始打磨数据进行打磨时,获取实时反馈力并经零点标定和重力补偿计算实时打磨力数据;根据实时打磨力数据更新初始打磨数据,形成修正打磨数据,将修正打磨数据引入控制系统对初始打磨数据进行修正后重新下发给机器人,进而不断的修正打磨轨迹,保障打磨运动的精度;具体步骤如下:
S41、基于实时打磨力数据对初始位置数据进行修正以得到修正位置数据,通过以下公式将采集到的力F(i)转换为当前位移修正量x(i)
其中,F(i)为机器人第i个采样时刻末端受到的力,Md为惯性系数,Bd为阻尼系数,Kd为刚度系数,x(i)、x(i-1)、x(i-2)为机器人第i个采样时刻末端修正量、第i-1个采样时刻末端修正量、第i-2个采样时刻末端修正量;
S42、基于实时打磨力数据对初始速度数据进行修正以得到修正速度数据v(i);
其中,T为采样周期。
S43、基于实时打磨力数据对初始加速度数据进行修正以得到修正加速度数据;
S5、打磨作业结束后,将工业机器人停止运动,机器人和控制器断电。
Claims (4)
1.一种工业机器人恒力打磨方法,其特征在于,包括以下步骤:
S1、对机器人的力传感器检测到的力进行打磨工具的重力补偿;
S2、根据打磨位置计算初始打磨数据,并控制机器人按照规划的初始打磨数据进行运动,所述初始打磨数据包括初始路径数据、初始位置数据和初始速度数据;
S3、根据实时反馈的打磨力数据计算机器人各关节上由于实时打磨力而产生的转矩,并对相应的关节驱动器进行力矩补偿;
S4、获取实时反馈力数据并计算实时打磨力数据,根据实时打磨力数据更新初始打磨数据,形成修正打磨数据,控制机器人按新打磨路径进行运动;
S5、打磨作业结束;
其中步骤S3和步骤S4在机器人打磨过程中同时进行。
2.如权利要求1所述的一种工业机器人恒力打磨方法,其特征在于:步骤S1具体包括如下步骤:
S11、力传感器的零点数据记为:F0=[fx0 fy0 fz0]T,实际传感器力的读数记为:F=[fxfy fz]T,末端工具重力记为G,G在力传感器坐标系上产生的力和力矩记为:Gs=[gx gy gz]T;
S12、末端工具重力G在机器人基坐标系O的分力表示为G0=[0 0 -G]T,通过位姿变换矩阵,可得到G在传感器坐标系S上的分力Gs=[gx gy gz]T
其中:
A、B、C——机器人姿态角;s、c——三角函数sin、cos缩写;
传感器安装偏角α采用如下公式计算求得,传感器安装偏角α是指传感器坐标系X轴和末端法兰坐标系X轴之间的偏转角;
S13、为了结果的准确性,选取至少3组不同姿态下,通过实验的方法,记录下多组机器人姿态数据,从而求出安装偏角α平均值,补偿后得到的力方向的数值即为真实接触力,经补偿后的力Fr为:
Fr=[fx-fx0-gx fy-fy0-gy fz-fz0-gz]T。
3.如权利要求1所述的一种工业机器人恒力打磨方法,其特征在于,所述步骤S4具体包括以下步骤:
S41、基于实时打磨力数据对初始位置数据进行修正以得到修正位置数据,通过以下公式将采集到的力F(i)转换为当前位移修正量x(i)
其中,F(i)为机器人第i个采样时刻末端受到的力,Md为惯性系数,Bd为阻尼系数,Kd为刚度系数,x(i)、x(i-1)、x(i-2)为机器人第i个采样时刻末端修正量、第i-1个采样时刻末端修正量、第i-2个采样时刻末端修正量;
S42、基于实时打磨力数据对初始速度数据进行修正以得到修正速度数据v(i);
其中,T为采样周期;
S43、基于实时打磨力数据对初始加速度数据进行修正以得到修正加速度数据;
其中,T为采样周期,v(i)为步骤S41所得修正速度数据。
4.如权利要求1所述的一种工业机器人恒力打磨方法,其特征在于,所述步骤S3具体包括如下步骤:
S31、数据经滤波处理后通过机器人动力学计算求得各个关节所需的转矩;
S32、求取计算所得转矩与实际驱动器力矩的差值,并经折算为电流值后输入驱动器电流环进行力矩补偿。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110574992.9A CN113199491A (zh) | 2021-05-26 | 2021-05-26 | 一种工业机器人恒力打磨方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110574992.9A CN113199491A (zh) | 2021-05-26 | 2021-05-26 | 一种工业机器人恒力打磨方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN113199491A true CN113199491A (zh) | 2021-08-03 |
Family
ID=77023163
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110574992.9A Withdrawn CN113199491A (zh) | 2021-05-26 | 2021-05-26 | 一种工业机器人恒力打磨方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113199491A (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113714991A (zh) * | 2021-08-25 | 2021-11-30 | 西安交通大学 | 一种实现精确力控制的刻线装置、方法及系统 |
CN113925563A (zh) * | 2021-10-13 | 2022-01-14 | 杭州柳叶刀机器人有限公司 | 一种打磨功率调节方法、装置、电子设备及存储介质 |
CN115365910A (zh) * | 2022-10-24 | 2022-11-22 | 烟台新浩阳轴承有限公司 | 一种转盘轴承的打磨支撑装置及具有其的打磨系统 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH11156776A (ja) * | 1997-11-21 | 1999-06-15 | Seiko Seiki Co Ltd | スライディングモード非干渉制御を用いた多関節研磨ロボット |
JP2002331477A (ja) * | 2001-05-02 | 2002-11-19 | Matsushita Electric Ind Co Ltd | ロボット制御方法および制御装置 |
CN105500147A (zh) * | 2015-12-14 | 2016-04-20 | 中国科学院沈阳自动化研究所 | 基于力控制的龙门吊装机器人打磨加工方法 |
CN105549545A (zh) * | 2016-02-19 | 2016-05-04 | 泉州华中科技大学智能制造研究院 | 一种基于磨边机恒线速度磨削的控制算法 |
CN106553126A (zh) * | 2016-11-18 | 2017-04-05 | 东兴自动化投资有限公司 | 抛光过程的压力检测、控制与自动补偿的方法 |
CN108942940A (zh) * | 2018-08-01 | 2018-12-07 | 东南大学 | 一种基于多传感器融合的遥操作机器人打磨控制系统 |
CN110666799A (zh) * | 2019-10-15 | 2020-01-10 | 吉林大学 | 一种基于重力补偿的六自由度串联机器人柔顺控制方法 |
CN111823221A (zh) * | 2019-03-27 | 2020-10-27 | 天津工业大学 | 一种基于多传感器的机器人打磨方法 |
CN112720482A (zh) * | 2020-12-22 | 2021-04-30 | 上海新时达机器人有限公司 | 一种工业机器人运动控制方法 |
-
2021
- 2021-05-26 CN CN202110574992.9A patent/CN113199491A/zh not_active Withdrawn
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH11156776A (ja) * | 1997-11-21 | 1999-06-15 | Seiko Seiki Co Ltd | スライディングモード非干渉制御を用いた多関節研磨ロボット |
JP2002331477A (ja) * | 2001-05-02 | 2002-11-19 | Matsushita Electric Ind Co Ltd | ロボット制御方法および制御装置 |
CN105500147A (zh) * | 2015-12-14 | 2016-04-20 | 中国科学院沈阳自动化研究所 | 基于力控制的龙门吊装机器人打磨加工方法 |
CN105549545A (zh) * | 2016-02-19 | 2016-05-04 | 泉州华中科技大学智能制造研究院 | 一种基于磨边机恒线速度磨削的控制算法 |
CN106553126A (zh) * | 2016-11-18 | 2017-04-05 | 东兴自动化投资有限公司 | 抛光过程的压力检测、控制与自动补偿的方法 |
CN108942940A (zh) * | 2018-08-01 | 2018-12-07 | 东南大学 | 一种基于多传感器融合的遥操作机器人打磨控制系统 |
CN111823221A (zh) * | 2019-03-27 | 2020-10-27 | 天津工业大学 | 一种基于多传感器的机器人打磨方法 |
CN110666799A (zh) * | 2019-10-15 | 2020-01-10 | 吉林大学 | 一种基于重力补偿的六自由度串联机器人柔顺控制方法 |
CN112720482A (zh) * | 2020-12-22 | 2021-04-30 | 上海新时达机器人有限公司 | 一种工业机器人运动控制方法 |
Non-Patent Citations (2)
Title |
---|
缪新;田威;: "机器人打磨系统控制技术研究" * |
高培阳: "基于力传感器的工业机器人恒力磨抛系统研究" * |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113714991A (zh) * | 2021-08-25 | 2021-11-30 | 西安交通大学 | 一种实现精确力控制的刻线装置、方法及系统 |
CN113925563A (zh) * | 2021-10-13 | 2022-01-14 | 杭州柳叶刀机器人有限公司 | 一种打磨功率调节方法、装置、电子设备及存储介质 |
CN115365910A (zh) * | 2022-10-24 | 2022-11-22 | 烟台新浩阳轴承有限公司 | 一种转盘轴承的打磨支撑装置及具有其的打磨系统 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113199491A (zh) | 一种工业机器人恒力打磨方法 | |
KR940003204B1 (ko) | 제어로봇 | |
Chen et al. | Robotic grinding of a blisk with two degrees of freedom contact force control | |
Li et al. | Contact force plan and control of robotic grinding towards ensuring contour accuracy of curved surfaces | |
JP5399624B2 (ja) | 数値制御方法及び数値制御装置 | |
Oba et al. | Simultaneous tool posture and polishing force control of unknown curved surface using serial-parallel mechanism polishing machine | |
CN113518690B (zh) | 切削装置以及接触位置确定程序 | |
JP5765615B2 (ja) | 加工ロボットの軌道追従装置と方法 | |
JP6942577B2 (ja) | 工作機械の数値制御装置及び数値制御方法 | |
JP6684962B2 (ja) | 工具経路生成方法および装置 | |
CN113156819B (zh) | 协调打磨机械臂系统自适应神经网络同步阻抗控制方法 | |
CN110394802B (zh) | 一种打磨机器人及位置补偿方法 | |
CN108972343A (zh) | 一种二自由度磨抛接触力控制方法及系统 | |
CN109927028A (zh) | 一种力控机器人磨抛加工的力位混合控制方法 | |
CN110497423A (zh) | 一种机械手自适应加工方法 | |
CN110039449B (zh) | 应用于打磨机器人的打磨方法和系统 | |
Zhan et al. | Study on error compensation of machining force in aspheric surfaces polishing by profile-adaptive hybrid movement–force control | |
CN111975579A (zh) | 一种基于打磨模型和迭代算法的机器人恒力打磨系统 | |
CN111843714B (zh) | 一种三自由度磨抛装置及其力位耦合控制方法 | |
CN114454060A (zh) | 一种机器人自适应曲面跟踪恒力磨抛方法及系统 | |
CN113110290B (zh) | 一种基于力反馈控制的大型薄壁零件镜像加工方法 | |
JP5765557B2 (ja) | 加工ロボットの軌道追従装置と方法 | |
Park et al. | Gantry type lapping manipulator toward unmanned lapping process for a large work surface | |
CN111070045A (zh) | 一种叶片磨抛加工防碰撞与力过冲检测系统及方法 | |
JP6323744B2 (ja) | 研磨ロボットとその制御方法 |
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 | ||
WW01 | Invention patent application withdrawn after publication | ||
WW01 | Invention patent application withdrawn after publication |
Application publication date: 20210803 |