CN108515519B - 一种基于力传感器的打磨路径自适应校正方法 - Google Patents
一种基于力传感器的打磨路径自适应校正方法 Download PDFInfo
- Publication number
- CN108515519B CN108515519B CN201810332576.6A CN201810332576A CN108515519B CN 108515519 B CN108515519 B CN 108515519B CN 201810332576 A CN201810332576 A CN 201810332576A CN 108515519 B CN108515519 B CN 108515519B
- Authority
- CN
- China
- Prior art keywords
- path
- force sensor
- force
- value
- representing
- 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.)
- Active
Links
Images
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/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
- B25J11/00—Manipulators not otherwise provided for
- B25J11/005—Manipulators for mechanical processing tasks
- B25J11/0065—Polishing or grinding
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
- Finish Polishing, Edge Sharpening, And Grinding By Specific Grinding Devices (AREA)
Abstract
本发明涉及一种基于力传感器的打磨路径自适应校正方法,包括:步骤a,初始路径选择,在保证基本的打磨工艺参数如打磨角度、打磨工具进退速度的基础上,选择较少的路径特征点,得到初始示教路径;步骤b,根据压力曲线校正优化示教路径;步骤c,基于力控自适应跟踪补偿功能校正路径。本发明在通过机器人集成力传感器实现力控制功能的基础上,充分利用力传感器测量的压力变化信息为编程示教提供依据,优化简略示教路径,进而利用力控制功能对路径进行自适应补偿,得到进一步的优化路径。
Description
技术领域
本发明涉及工业机器人技术领域,尤其涉及一种基于力传感器的打磨路径自适应校正方法。
背景技术
现代制造业中有广泛的产品需要进行打磨工序,例如工件去毛刺、金属件抛光、刀具开刃等。然而,许多产品仍然依赖人工打磨,其加工效率低,产品质量一致性无法保证,且现场噪声和打磨粉尘对工人身体健康危害极大。打磨机床虽然可以克服上述缺点,但存在运动空间受限制、成本昂贵、通用性不足等问题。如今,灵活度更高的工业机器人开始涉及各个领域,机器人打磨技术逐渐成为一种高效的自动化打磨手段,可以有效地满足多种形式的打磨任务需求。
与搬运、码垛等基于位置控制的任务不同,打磨属于典型的机器人力控制技术应用场景。执行力控制打磨的过程中仍需要在工具或工件移动方向上执行位置控制,因此良好的示教路径不可或缺。若示教路径质量较差,由于力控制系统动态跟踪能力是有限的,最终形成的工具和工件间的贴合将无法满足打磨工艺要求。
确定打磨路径的传统方法主要是采用手动示教的在线编程方式,编程人员现场手持示教器移动机器人到达目标点,然后逐点记录示教点。为得到满足工艺要求的一条打磨路径甚至需要示教上百个点,并且路径点过渡处需要编程人员仔细调整机器人位置和姿态。因此,为完成一个工件的打磨应用,通常要数天的调校和测试,费时费力,且需要编程人员具有丰富的经验。
另一种方法是采用离线编程软件,通过建立较精确的磨盘、工件和机器人等的模型,在虚拟环境中进行数字化编程和路径生成,并仿真加工过程,可方便地反复修改和优化加工轨迹。但目前的离线编程软件都是商用,价格昂贵,例如应用广泛的离线编程仿真软件RobotMaster价格可达30万,并且需要一定时间的技能培训才能上手。
发明内容
本发明的目的在于提供一种基于力传感器的打磨路径自适应校正方法,用以克服现有技术的技术缺陷。
为实现上述目的,本发明提供一种基于力传感器的打磨路径自适应校正方法,包括:
步骤a,初始路径选择,在保证基本的打磨工艺参数如打磨角度、打磨工具进退速度的基础上,选择较少的路径特征点,得到初始示教路径;
步骤b,根据压力曲线校正优化示教路径;
步骤c,基于力控自适应跟踪补偿功能校正路径。
进一步地,在上述步骤b中,执行初始示教路径的打磨试验并记录压力值,实时查看压力曲线变化是否平缓,若有剧烈的压力波动则记录好波动峰谷处对应的示教路径点,返回优化该处示教点,或者添加过渡点,重复执行该流程,直至得到变化较平缓的压力曲线。
进一步地,在上述步骤b中,对同一受力点采用三个力传感器进行测量,三个力传感器分别对受力点受力进行测量,并传输至选定模块中,所述选定模块按照下述均值运算公式判定第一力传感器、第二力传感器的位置的第一比较值P21:
式中,P21表示第一力传感器、第二力传感器的位置的第一比较值,r1表示第一力传感器的实时采样值,r2表示第二力传感器的实时采样值;r3表示第三力传感器的实时采样值;T表示均方差运算,I表示积分运算;
其中I表示基于二次函数的任意积分运算,上述公式为获取积分的比值信息,基于函数y=ax2,在x取值为(a,b)内,a<b为任意数值。
进一步地,在上述步骤b中,所述的选定模块按照下述公式判定第一力传感器、第三力传感器的位置的第二比较值P31:
式中,P31表示第一力传感器、第三力传感器的位置的第二比较值,r1表示第一力传感器的实时采样值,r2表示第二力传感器的实时采样值;r3表示第三力传感器的实时采样值;T表示均方差运算,I表示积分运算;
其中I表示基于二次函数的任意积分运算,上述公式为获取积分的比值信息,基于函数y=ax2,在x取值为(a,b)内,a<b为任意数值。
进一步地,在上述步骤b中,所述的选定模块按照下述公式判定第二力传感器、第三力传感器的位置的第三比较值P23:
式中,P23表示第二力传感器、第三力传感器的位置的第三比较值,r1表示第一力传感器的实时采样值,r2表示第二力传感器的实时采样值;r3表示第三力传感器的实时采样值;T表示均方差运算,I表示积分运算;
其中I表示基于二次函数的任意积分运算,上述公式为获取积分的比值信息,基于函数y=ax2,在x取值为(a,b)内,a<b为任意数值;
经过上述方式获取的P21、P31、P23,获取三个比较值的差值比较,判定是否超过存储在选定模块的阈值P,若有一个差值超过阈值P,则力的测量结果出现偏差,重新进行测量。
进一步地,在上述步骤c中,开启力控功能并设置力控制参数,降低运动过程力控制的阻尼参数,使机器人处于较柔顺状态,慢速执行初始示教路径;运行过程中,机器人力控制功能实时位置来自适应跟踪补偿压力误差,从而实现了对打磨路径的校正,记录运行过程中的路径点及压力变化,若压力曲线满足工艺要求,则保存经自适应校正后的路径,作为最终的打磨示教路径,若不满足则需返回优化初始路径或调整力控参数。
与现有技术相比本发明的有益效果在于,本发明在通过机器人集成力传感器实现力控制功能的基础上,充分利用力传感器测量的压力变化信息为编程示教提供依据,优化简略示教路径,进而利用力控制功能对路径进行自适应补偿,得到进一步的优化路径。
具体而言,本发明具有下述技术效果:
1)原理简单,对编程人员的技能和经验要求低,可快速上手;
2)可有效减少编程工作量,缩短示教时间,提高编程效率;
3)成本低廉,无需采购昂贵的离线编程软件;
4)稳定性好,可自适应补偿环境误差。
附图说明
图1为本发明基于力传感器的打磨路径自适应校正方法的流程示意图。
具体实施方式
以下结合附图,对本发明上述的和另外的技术特征和优点作更详细的说明。
下面参照附图来描述本发明的优选实施方式。本领域技术座椅机构员应当理解的是,这些实施方式仅仅用于解释本发明的技术原理,并非旨在限制本发明的保护范围。
参阅图1所示,其分别为本发明基于力传感器的打磨路径自适应校正方法的流程示意图,该过程包括:
步骤a,初始路径选择,在保证基本的打磨工艺参数如打磨角度、打磨工具进退速度的基础上,选择较少的路径特征点,得到初始示教路径。
此时力传感器和力控制功能都不设定,机器人处于纯位置控制模式。
步骤b,根据压力曲线校正优化示教路径;
开启力传感器,但不设定力控制功能。执行初始示教路径的打磨试验并记录压力值。实验结束后查看压力曲线变化是否平缓,若有剧烈的压力波动则记录好波动峰谷处对应的示教路径点,返回优化该处示教点,或者添加过渡点。重复执行该流程,直至得到变化较平缓的压力曲线。
本实施例为了对力的检测控制更佳精准,本实施例对同一受力点采用三个力传感器进行测量,三个力传感器分别对受力点受力进行测量,并传输至选定模块中,所述选定模块按照下述均值运算公式判定第一力传感器、第二力传感器的位置的第一比较值P21:
式中,P21表示第一力传感器、第二力传感器的位置的第一比较值,r1表示第一力传感器的实时采样值,r2表示第二力传感器的实时采样值;r3表示第三力传感器的实时采样值;T表示均方差运算,I表示积分运算。
其中I表示基于二次函数的任意积分运算,上述公式为获取积分的比值信息,基于函数y=ax2,在x取值为(a,b)内,a<b为任意数值。
上述均值运算的基本算法为:通过获取在某个时间段内的所有采样点的位置值,对某个时间段内的各个取值进行积分运算和均方差运算,然后取比值,得出相比较的平均值。
所述的选定模块按照下述公式判定第一力传感器、第三力传感器的位置的第二比较值P31:
式中,P31表示第一力传感器、第三力传感器的位置的第二比较值,r1表示第一力传感器的实时采样值,r2表示第二力传感器的实时采样值;r3表示第三力传感器的实时采样值;T表示均方差运算,I表示积分运算。
其中I表示基于二次函数的任意积分运算,上述公式为获取积分的比值信息,基于函数y=ax2,在x取值为(a,b)内,a<b为任意数值。
所述的选定模块按照下述公式判定第二力传感器、第三力传感器的位置的第三比较值P23:
式中,P23表示第二力传感器、第三力传感器的位置的第三比较值,r1表示第一力传感器的实时采样值,r2表示第二力传感器的实时采样值;r3表示第三力传感器的实时采样值;T表示均方差运算,I表示积分运算。
其中I表示基于二次函数的任意积分运算,上述公式为获取积分的比值信息,基于函数y=ax2,在x取值为(a,b)内,a<b为任意数值。
经过上述方式获取的P21、P31、P23,获取三个比较值的差值比较,判定是否超过存储在选定模块的阈值P,若有一个差值超过阈值P,则力的测量结果出现偏差,重新进行测量。
步骤c,基于力控自适应跟踪补偿功能校正路径;
开启力控功能并设置力控制参数,降低运动过程力控制的阻尼参数,使机器人处于较柔顺状态,慢速执行初始示教路径。运行过程中,机器人力控制功能实时位置来自适应跟踪补偿压力误差,从而实现了对打磨路径的校正。记录运行过程中的路径点及压力变化,若压力曲线满足工艺要求,则保存经自适应校正后的路径,作为最终的打磨示教路径,若不满足则需返回优化初始路径或调整力控参数。
至此,已经结合附图所示的优选实施方式描述了本发明的技术方案,但是,本领域技术座椅机构容易理解的是,本发明的保护范围显然不局限于这些具体实施方式。在不偏离本发明的原理的前提下,本领域技术座椅机构可以对相关技术特征作出等同的更改或替换,这些更改或替换之后的技术方案都将落入本发明的保护范围之内。
Claims (3)
1.一种基于力传感器的打磨路径自适应校正方法,其特征在于,包括:
步骤a,初始路径选择,在保证基本的打磨工艺参数如打磨角度、打磨工具进退速度的基础上,选择较少的路径特征点,得到初始示教路径;
步骤b,根据压力曲线校正优化示教路径;
步骤c,基于力控自适应跟踪补偿功能校正路径;
在上述步骤b中,执行初始示教路径的打磨试验并记录压力值,实时查看压力曲线变化是否平缓,若有剧烈的压力波动则记录好波动峰谷处对应的示教路径点,返回优化该处示教点,或者添加过渡点,重复执行该流程,直至得到变化较平缓的压力曲线;
在上述步骤b中,对同一受力点采用三个力传感器进行测量,三个力传感器分别对受力点受力进行测量,并传输至选定模块中,所述选定模块按照下述均值运算公式判定第一力传感器、第二力传感器的位置的第一比较值P21:
式中,P21表示第一力传感器、第二力传感器的位置的第一比较值,r1表示第一力传感器的实时采样值,r2表示第二力传感器的实时采样值;r3表示第三力传感器的实时采样值;T表示均方差运算,I表示积分运算;
其中I表示基于二次函数的任意积分运算,上述公式为获取积分的比值信息,基于函数y=ax2,在x取值为(a,b)内,a<b为任意数值;
在上述步骤c中,开启力控功能并设置力控制参数,降低运动过程力控制的阻尼参数,使机器人处于较柔顺状态,慢速执行初始示教路径;运行过程中,机器人力控制功能实时位置来自适应跟踪补偿压力误差,从而实现了对打磨路径的校正,记录运行过程中的路径点及压力变化,若压力曲线满足工艺要求,则保存经自适应校正后的路径,作为最终的打磨示教路径,若不满足则需返回优化初始路径或调整力控参数。
3.根据权利要求2所述的基于力传感器的打磨路径自适应校正方法,其特征在于,在上述步骤b中,所述的选定模块按照下述公式判定第二力传感器、第三力传感器的位置的第三比较值P23:
式中,P23表示第二力传感器、第三力传感器的位置的第三比较值,r1表示第一力传感器的实时采样值,r2表示第二力传感器的实时采样值;r3表示第三力传感器的实时采样值;T表示均方差运算,I表示积分运算;
其中I表示基于二次函数的任意积分运算,上述公式为获取积分的比值信息,基于函数y=ax2,在x取值为(a,b)内,a<b为任意数值;
经过上述方式获取的P21、P31、P23,获取三个比较值的差值比较,判定是否超过存储在选定模块的阈值P,若有一个差值超过阈值P,则力的测量结果出现偏差,重新进行测量。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810332576.6A CN108515519B (zh) | 2018-04-13 | 2018-04-13 | 一种基于力传感器的打磨路径自适应校正方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810332576.6A CN108515519B (zh) | 2018-04-13 | 2018-04-13 | 一种基于力传感器的打磨路径自适应校正方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108515519A CN108515519A (zh) | 2018-09-11 |
CN108515519B true CN108515519B (zh) | 2021-03-26 |
Family
ID=63432581
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810332576.6A Active CN108515519B (zh) | 2018-04-13 | 2018-04-13 | 一种基于力传感器的打磨路径自适应校正方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108515519B (zh) |
Families Citing this family (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109405381A (zh) * | 2018-09-19 | 2019-03-01 | 东莞市正旭新能源设备科技有限公司 | 一种基于时间比较的化霜方法 |
CN109483532A (zh) * | 2018-11-01 | 2019-03-19 | 东莞市中天自动化科技有限公司 | 机床及其粗磨机器人控制方法 |
CN109514571A (zh) * | 2018-12-05 | 2019-03-26 | 上海发那科机器人有限公司 | 一种利用机器人视觉和力传感器对车体打磨点精确定位的方法 |
CN109434843B (zh) * | 2018-12-10 | 2020-07-10 | 华中科技大学 | 一种基于拖动示教的机器人力控打磨叶片的设备及方法 |
CN110181509A (zh) * | 2019-05-14 | 2019-08-30 | 浙江树人学院(浙江树人大学) | 一种基于误差补偿的工业机器人运动控制方法 |
CN110362787A (zh) * | 2019-07-15 | 2019-10-22 | 碧桂园智慧物业服务集团股份有限公司 | 基于卡尔曼算法的压力变送器压力预测方法 |
CN112123341B (zh) * | 2020-11-24 | 2021-03-02 | 季华实验室 | 机器人双臂协调运动控制方法、装置和电子设备 |
CN113134840A (zh) * | 2021-05-26 | 2021-07-20 | 苏州艾利特机器人有限公司 | 一种实时设置力控参数的工业机器人及方法 |
CN116100418A (zh) * | 2023-01-10 | 2023-05-12 | 重庆智能机器人研究院 | 一种工业机器人笔电打磨工艺量化的参数化编程方法 |
Family Cites Families (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1854037B1 (en) * | 2005-02-25 | 2014-12-31 | Abb Research Ltd. | Method of and apparatus for automated path learning |
KR101778028B1 (ko) * | 2010-12-20 | 2017-09-13 | 삼성전자주식회사 | 로봇 및 로봇의 경로 생성 방법 |
CN203779279U (zh) * | 2013-12-07 | 2014-08-20 | 泸州职业技术学院 | 自适应压力机械手打磨装置 |
CN103878666B (zh) * | 2014-03-28 | 2016-06-29 | 中国科学院自动化研究所 | 一种自由曲面机器人打磨系统 |
CN104972362B (zh) * | 2014-04-14 | 2017-10-31 | 沈阳远大科技园有限公司 | 智能力控机器人磨削加工系统和方法 |
CN104858782B (zh) * | 2015-04-03 | 2017-06-20 | 华南理工大学 | 基于模糊自适应力控制的恒力自动打磨装置及方法 |
CN106142081B (zh) * | 2015-05-14 | 2021-03-02 | 发那科株式会社 | 对加工工具转速和工件进给速度进行调整的加工系统 |
CN105690209B (zh) * | 2016-02-03 | 2017-09-29 | 河北工业大学 | 一种大型曲面磨削自适应控制方法 |
CN106891339B (zh) * | 2017-02-10 | 2019-08-06 | 广东省智能制造研究所 | 带重力补偿的打磨机器人及其打磨方法 |
CN107838920A (zh) * | 2017-12-20 | 2018-03-27 | 芜湖哈特机器人产业技术研究院有限公司 | 一种机器人打磨力控制系统和方法 |
-
2018
- 2018-04-13 CN CN201810332576.6A patent/CN108515519B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN108515519A (zh) | 2018-09-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108515519B (zh) | 一种基于力传感器的打磨路径自适应校正方法 | |
CN110948504B (zh) | 机器人加工作业法向恒力跟踪方法和装置 | |
CN108748159B (zh) | 一种机械臂工具坐标系自标定方法 | |
CN111367236B (zh) | 一种面向加工过程的移动机器人系统标定方法及系统 | |
CN110193829B (zh) | 一种耦合运动学与刚度参数辨识的机器人精度控制方法 | |
CN109782601B (zh) | 一种协调机械臂自适应神经网络同步鲁棒控制器设计方法 | |
WO2020237407A1 (zh) | 机器人运动学参数自标定方法、系统及存储装置 | |
CN110497423B (zh) | 一种机械手自适应加工方法 | |
Oba et al. | Simultaneous tool posture and polishing force control of unknown curved surface using serial-parallel mechanism polishing machine | |
CN107796276B (zh) | 一种估算工业机器人绝对定位精度的装置及方法 | |
CN105312632A (zh) | 将工具按压至工件来进行作业的机器人的控制装置 | |
CN113400088B (zh) | Ac双转台五轴机床的位置无关几何误差建模和辨识方法 | |
CN109848989B (zh) | 一种基于红宝石探针的机器人执行末端自动标定及检测方法 | |
CN113156819B (zh) | 协调打磨机械臂系统自适应神经网络同步阻抗控制方法 | |
CN109465831B (zh) | 一种提升工业机器人工具坐标系标定精度的方法 | |
CN110370271B (zh) | 工业串联机器人的关节传动比误差校准方法 | |
CN103713579A (zh) | 一种工业机器人作业方法 | |
CN111546334A (zh) | 一种减小轮廓误差的工业机器人在线位姿误差补偿方法 | |
CN111975579A (zh) | 一种基于打磨模型和迭代算法的机器人恒力打磨系统 | |
CN111390914B (zh) | 一种机器人零位和工具坐标标定方法 | |
CN115963779A (zh) | 数字孪生 | |
CN114839921A (zh) | 一种基于数据驱动的五轴轮廓控制方法 | |
Izquierdo et al. | Feedforward control of multistage assembly processes using programmable tooling | |
JP5765557B2 (ja) | 加工ロボットの軌道追従装置と方法 | |
CN114029982A (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 |