CN107414860A - 一种用于机器人砂带打磨的运动路径避碰调整方法 - Google Patents
一种用于机器人砂带打磨的运动路径避碰调整方法 Download PDFInfo
- Publication number
- CN107414860A CN107414860A CN201710764395.6A CN201710764395A CN107414860A CN 107414860 A CN107414860 A CN 107414860A CN 201710764395 A CN201710764395 A CN 201710764395A CN 107414860 A CN107414860 A CN 107414860A
- Authority
- CN
- China
- Prior art keywords
- robot
- cutter
- coordinate system
- motion path
- path
- 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
- 238000000034 method Methods 0.000 title claims abstract description 37
- 230000002265 prevention Effects 0.000 title claims abstract description 30
- 238000005498 polishing Methods 0.000 claims abstract description 23
- 238000004519 manufacturing process Methods 0.000 claims abstract description 18
- 230000008569 process Effects 0.000 claims abstract description 12
- 238000005259 measurement Methods 0.000 claims abstract description 5
- 238000013519 translation Methods 0.000 claims description 34
- 235000013350 formula milk Nutrition 0.000 claims description 12
- 239000011159 matrix material Substances 0.000 claims description 8
- 238000012545 processing Methods 0.000 claims description 6
- 230000009466 transformation Effects 0.000 claims description 6
- 230000010354 integration Effects 0.000 claims description 4
- 238000005457 optimization Methods 0.000 claims description 2
- 238000010586 diagram Methods 0.000 description 15
- 230000008859 change Effects 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 2
- 238000010009 beating Methods 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000009776 industrial production Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
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
- B25J9/1666—Avoiding collision or forbidden zones
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Finish Polishing, Edge Sharpening, And Grinding By Specific Grinding Devices (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种用于机器人砂带打磨的运动路径避碰调整方法,包括步骤:1)机器人运动路径生成的步骤,即将工件的打磨路径转化为机器人运动路径;2)机器人运动路径的避碰调整的步骤,即通过改变机器人打磨时运动路径上的各刀触点的位姿从而令机器人避免在加工过程中发生碰撞。本发明具有灵活实用的特点,将三维问题简化为碰撞图层中的可靠区域寻找优化曲线的二维问题,能有效地避免机器人在砂带打磨工件过程中发生碰撞,同时还能保证打磨精度和效率。
Description
技术领域
本发明涉及了一种用于机器人砂带打磨的运动路径避碰调整方法,包括机器人运动路径生成方法与机器人运动路径的避碰调整方法,与作为执行装置的机器人与砂带机组成一个机器人砂带打磨***。
背景技术
机器人砂带打磨能克服手工砂带打磨精度差、效率低的缺点,所以现已广泛地应用于工业生产。随着工件形状的日益复杂,机器人砂带打磨过程中很容易发生诸如工件与刀具、机器人与刀具的碰撞,所以研究用于机器人砂带打磨的运动路径避碰调整方法就很有必要。
发明内容
本发明提供了一种用于机器人砂带打磨的运动路径避碰调整方法,包括机器人运动路径生成方法与机器人运动路径的避碰调整方法。其中机器人运动路径生成方法解决了将工件打磨路径转化为机器人运动路径的问题,机器人运动路径的避碰调整的方法解决了机器人打磨过程中可能发生碰撞的问题。本发明具有灵活实用的特点,能有效地避免机器人在砂带打磨工件过程中发生碰撞。
本发明的目的通过下述技术方案来实现:
一种用于机器人砂带打磨的运动路径避碰调整方法,包括步骤:
1)机器人运动路径生成的步骤,即将工件的打磨路径转化为机器人运动路径;
2)机器人运动路径的避碰调整的步骤,即通过改变机器人打磨时运动路径上的各刀触点的位姿从而令机器人避免在加工过程中发生碰撞。
进一步地,步骤1)中将工件的打磨路径转化为机器人运动路径的步骤具体为将打磨路径上的各刀触点映射到机器人运动路径上对应的路径点的位姿。
进一步地,所述将打磨路径上的各刀触点映射到机器人运动路径上对应的路径点的位姿的步骤具体包括:
11)为工件打磨路径上的每个刀触点添加坐标系,其轴与该点在工件表面处的单位外法向量相同;
12)确定所有刀触点坐标系{M}的相对于工具坐标系{Tool}的位姿
13)确定机器人工具坐标系{Tool}相对于基坐标系的位姿
14)在砂带上的某点处定义一个加工坐标系{M′},其位姿用机器人的基坐标系{B}来描述,即当打磨路径上的刀触点坐标系{M}与{M′}重合时,即表示砂带加工到该刀触点;
15)计算机器人工具坐标系{Tool}相对于基坐标系{B}的位姿
16)根据机器人逆运动学解算法与即可求得机器人运动路径上各点的关节空间位姿θ=[θ1 θ2 θ3 θ4 θ5 θ6]。
进一步地,步骤12)中,因采用机器人末端夹持工件的打磨方式,令机器人末端的工具坐标系{Tool}与工件坐标系{O}重合,则路径上的所有刀触点坐标系{M}均可以用{Tool}来描述位姿
进一步地,所述步骤15)具体包括:
由{M}={M′}得:
故:
其中:
进一步地,所述的步骤2)中改变机器人运动路径上的点的位姿的步骤是通过调整刀触点所对应的的值,进而改变避开产生碰撞的关节位姿,实现机器人运动路径无碰撞优化,具体包括步骤:
21)调整加工坐标系{M′}相对于机器人基坐标系{B}的位姿包括沿接触轮转轴方向的平移调整和绕切线方向的旋转调整;
22)整合加工坐标系{M′}平移调整和旋转调整;
23)基于机器人砂带打磨仿真,建立碰撞图层;
24)在碰撞图层中求得依次经过所有刀触点的优化曲线,用该优化曲线来计算机器人运动路径上各点的位姿,即可实现机器人运动路径的避碰调整。
进一步地,所述沿接触轮转轴方向的平移调整具体包括步骤:
201)当机器人打磨到工件上某个刀触点前,先将初始加工坐标系{Mo′}沿接触轮的轴向平移距离a得到新的加工坐标系{M′},接触轮的半径为R,砂带的宽度为W,则a的取值范围为[-W/2,W/2];
202)求得初始加工坐标系{Mo′}、新的加工坐标系{M′}相对于机器人基坐标系{B}的位姿分别为则有:
其中,为新的加工坐标系{M′}相对于初始加工坐标系{Mo′}的位姿;
203)计算的值:
当{Mo′}的X轴与接触轮的轴线平行时,则有:
当{Mo′}的Y轴与接触轮的轴线平行时,则有:
进一步地,所述绕切线方向的旋转调整具体包括步骤:
211)当由初始加工坐标系{Mo′}轴向平移到砂带边缘,得到坐标系{Me′},用砂带边缘加工打磨路径上的某刀触点前,将加工坐标系{M′}绕砂带在点Me′处的切线旋转α角度得新的加工坐标系{M′},α最大角度为A,最小的旋转角度为0;
212)求新的加工坐标系{M′}相对于初始加工坐标系{Mo′}的位姿矩阵
当{Me′}的轴与切线共线且同向时,有:
当{Me′}的轴与切线共线且同向时,有:
213)根据公式求新的加工坐标系{M′}相对于机器人基坐标{B}的位姿矩阵
进一步地,所述的步骤22)具体包括步骤:
为加工坐标系{M′}建立一个坐标轴的直线部分表示{M′}轴向平移,圆弧部分表示{M′}绕切线旋转,所述坐标轴的直线部分与接触轮转轴平行且其中点为Mo′点,设加工坐标系{M′}从{Mo′}处开始在坐标轴上进行调整,调整的距离为d,当d=0时,{M′}={Mo′},当d∈[-W/2,W/2]时,{M′}为轴向平移,当d∈[-A-W/2,-W/2)或d∈[W/2,A+W/2)时,{M′}为绕轴旋转调整,设变量t,有公式:
若d∈[-W/2,W/2],则将a=t代入加工坐标系轴向平移的变换公式中计算矩阵否则将α=t,a=t/|t|·W/2代入式加工坐标系绕切线旋转的变换公式中计算矩阵
进一步地,所述步骤23)中,
所述碰撞图层的横坐标为工件打磨路径上的刀触点序号,纵坐标为加工坐标系{M′}在坐标轴上的位置d,图中的点的坐标为(n,d)表示第n个刀触点所对应的{M′}在上的位置d,两条横线d=A+W/2和d=-A-W/2之间的区域为可行区域,表示{M′}在上的调整范围,当点(n,d)落在碰撞区域时,{M′}在上的位置为d,此时机器人打磨第n个刀触点时会发生碰撞,其余区域为无碰撞区域。
相比现有技术,本发明具有灵活实用的特点,将三维问题简化为碰撞图层中的可靠区域寻找优化曲线的二维问题,能有效地避免机器人在砂带打磨工件过程中发生碰撞,同时还能保证打磨精度和效率。
附图说明
图1为工件的打磨路径转化成机器人的运动路径示意图。
图2为机器人砂带打磨的坐标系示意图。
图3a为砂带上加工坐标系所在位置示意图。
图3b为初始时刻加工坐标系所在位置示意图。
图4a为机器人打磨到工件上某个刀触点时,工件与刀具发生碰撞时的示意图。
图4b为将加工坐标系{M′}沿接触轮的轴的方向平移距离a后避免碰撞的示意图。
图5a为当初始加工坐标系{Mo′}的X轴与接触轮的轴线平行时的轴向平移的原理示意图。
图5b为当初始加工坐标系{Mo′}的Y轴与接触轮的轴线平行时的轴向平移的原理示意图。
图6a为加工坐标系轴向平移到砂带边缘加工时,工件与刀具发生碰撞示意图。
图6b为将加工坐标系{M′}沿旋转α角度后,再用砂带边缘加工工件避免碰撞时的示意图。
图7a为当{Me′}的轴与切线共线且同向时的旋转调整的示意图。
图7b为当{Me′}的轴与切线共线且同向时的旋转调整的示意图。
图8加工坐标系平移和旋转调整方法的整合后的示意图。
图9b为基于机器人砂带打磨仿真建立的碰撞图层及优化曲线示意图。
图9b为通过优化曲线计算机器人运动路径上各点的位姿示意图。
具体实施方式
下面将结合附图和实施例对本发明作进一步详细的描述,但本发明的实施方式不限于此。
如图1所示,一种用于机器人砂带打磨的运动路径避碰调整方法,包括步骤:
1)机器人运动路径生成的步骤,即将工件的打磨路径转化为机器人运动路径;
2)机器人运动路径的避碰调整的步骤,即通过改变机器人打磨时运动路径上的各刀触点的位姿从而令机器人避免在加工过程中发生碰撞。
具体而言,步骤1)中将工件的打磨路径转化为机器人运动路径的步骤具体为将打磨路径上的各刀触点映射到机器人运动路径上对应的路径点的位姿。
具体而言,所述将打磨路径上的各刀触点映射到机器人运动路径上对应的路径点的位姿的步骤具体包括:
11)为工件打磨路径上的每个刀触点添加坐标系,其轴与该点在工件表面处的单位外法向量相同;另外,工件坐标系为{O},打磨路径上第i个点的坐标系为{Mi},则{Mi}相对于{O}的位姿为
12)确定所有刀触点坐标系{M}的相对于工具坐标系{Tool}的位姿因采用机器人末端夹持工件的打磨方式,令机器人末端的工具坐标系{Tool}与工件坐标系{O}重合,则路径上的所有刀触点坐标系{M}均可以用{Tool}来描述位姿
13)确定机器人工具坐标系{Tool}相对于基坐标系的位姿
14)在砂带上的某点处定义一个加工坐标系{M′},其位姿用机器人的基坐标系{B}来描述,即当打磨路径上的刀触点坐标系{M}与{M′}重合时,即表示砂带加工到该刀触点(见图2);
15)计算机器人工具坐标系{Tool}相对于基坐标系{B}的位姿由于工件的打磨路径已经生成并为每个刀触点添加了坐标系,即所有刀触点坐标系的位姿已经确定,为了确定机器人运动路径上各点的关节空间位姿,需要知道机器人工具坐标系相对于基坐标系的位姿具体为:由{M}={M′}得:
故:
其中:
16)根据机器人逆运动学解算法与即可求得机器人运动路径上各点的关节空间位姿θ=[θ1 θ2 θ3 θ4 θ5 θ6]。
具体而言,所述的步骤2)中改变机器人运动路径上的点的位姿的步骤是通过调整刀触点所对应的的值,进而改变避开产生碰撞的关节位姿,实现机器人运动路径无碰撞优化,当机器人在砂带打磨过程中,发生了诸如工件与刀具、机器人与刀具之间的碰撞,此时需要对机器人运动路径进行调整以避开发生碰撞的机器人位姿。根据公式可知,当工件的打磨路径生成后,对于某个刀触点而言,是固定的,如果对其进行修改,则势必影响加工质量,而是可以改变的,其作用相当于改变砂带上的加工坐标系{M′}的位姿,用砂带的不同部分对刀触点作相同的加工,并不会过多地改变加工的质量。所以,当机器人在加工过程中发生碰撞时,可以通过调整该刀触点所对应的的值,进而改变在保证加工质量变化不大的前提下,避开产生碰撞的关节位姿,实现机器人运动路径无碰撞优化,具体包括步骤:
21)调整加工坐标系{M′}相对于机器人基坐标系{B}的位姿包括沿接触轮转轴方向的平移调整和绕切线方向的旋转调整,加工坐标系{M′}位于砂带上,如附图3(a)所示;初始时刻,加工坐标系位于如附图3(b)所示的{Mo′}位置处(即砂带的中央),其中{S}为砂带机的坐标系;
22)整合加工坐标系{M′}平移调整和旋转调整;
23)基于机器人砂带打磨仿真,建立碰撞图层;
24)在碰撞图层中求得依次经过所有刀触点的优化曲线,用该优化曲线来计算机器人运动路径上各点的位姿,即可实现机器人运动路径的避碰调整。
具体而言,关于所述沿接触轮转轴方向的平移调整,如附图4(a)所示,当机器人打磨到工件上某个刀触点(即附图4中的黄点)时,工件与刀具发生碰撞。如果先将加工坐标系{M′}沿接触轮的轴向(即轴的方向)平移距离a,然后再打磨该刀触点,则工件与刀具不会发生碰撞,如附图4(b)所示。从而实现无碰撞地加工该刀触点,具体包括步骤:
201)如图5所示,当机器人打磨到工件上某个刀触点前,先将初始加工坐标系{Mo′}沿接触轮的轴向平移距离a得到新的加工坐标系{M′},接触轮的半径为R,砂带的宽度为W,则a的取值范围为[-W/2,W/2],平移距离的正负方向见图5中箭头所示;
202)求得初始加工坐标系{Mo′}、新的加工坐标系{M′}相对于机器人基坐标系{B}的位姿分别为则有:
其中,为新的加工坐标系{M′}相对于初始加工坐标系{Mo′}的位姿;
203)计算的值,分两种情况:
当{Mo′}的X轴与接触轮的轴线平行时,如图5a所示则有:
当{Mo′}的Y轴与接触轮的轴线平行时,如附图5b所示,则有:
具体而言,所述绕切线方向的旋转调整如图6所示,具体包括步骤:
211)当由初始加工坐标系{Mo′}轴向平移到砂带边缘,得到坐标系{Me′},由于工件形状的缘故,工件与刀具发生碰撞,因此用砂带边缘加工打磨路径上的某刀触点前,将加工坐标系{M′}绕砂带在点Me′处的切线旋转α角度得新的加工坐标系{M′},α最大角度为A,最小的旋转角度为0;
212)求新的加工坐标系{M′}相对于初始加工坐标系{Mo′}的位姿矩阵
当{Me′}的轴与切线共线且同向时,有:
当{Me′}的轴与切线共线且同向时,有:
213)根据公式求新的加工坐标系{M′}相对于机器人基坐标{B}的位姿矩阵
如图6所示,当加工坐标系轴向平移到砂带边缘时,用砂带边缘加工打磨路径上的某刀触点,由于工件形状的缘故,工件与刀具发生碰撞,如果先将{M′}沿旋转α角度,再用砂带边缘加工该刀触点,如附图6b所示,则可实现无碰撞地加工该刀触点。
附图7是加工坐标系{M′}绕切线旋转调整的示意图,切线上的箭头表示切线的正向。只有当加工坐标系轴向平移到砂带边缘时才进行这种旋转调整,否则工件肯定会与刀具发生碰撞。当{M′}轴向平移到砂带边缘时,得到坐标系{Me′},如图7中所示的虚线坐标系;{Me′}的或会与砂带在点Me′处的切线共线且同向,{Me′}绕切线旋转α角度得新的加工坐标系{M′},{Me′}在砂带的左边缘(见图7a)和右边缘(见图7b)的旋转方向是不同的,其旋转方向如附图7所示。
具体而言,如图8所示,所述的步骤22)具体包括步骤:
为加工坐标系{M′}建立一个坐标轴的直线部分表示{M′}轴向平移,圆弧部分表示{M′}绕切线旋转,所述坐标轴的直线部分与接触轮转轴平行且其中点为Mo′点,设加工坐标系{M′}从{Mo′}处开始在坐标轴上进行调整,调整的距离为d,当d=0时,{M′}={Mo′},当d∈[-W/2,W/2]时,{M′}为轴向平移,当d∈[-A-W/2,-W/2)或d∈[W/2,A+W/2)时,{M′}为绕轴旋转调整,设变量t,有公式:
若d∈[-W/2,W/2],则将a=t代入加工坐标系轴向平移的变换公式中计算矩阵否则将α=t,a=t/|t|·W/2代入式加工坐标系绕切线旋转的变换公式中计算矩阵
具体而言,所述步骤23)中,
如图9a所示,所述碰撞图层的横坐标为工件打磨路径上的刀触点序号,纵坐标为加工坐标系{M′}在坐标轴上的位置d,图中的点的坐标为(n,d)表示第n个刀触点所对应的{M′}在上的位置d,两条横线d=A+W/2和d=-A-W/2之间的区域为可行区域,表示{M′}在上的调整范围,当点(n,d)落在碰撞区域时,{M′}在上的位置为d,此时机器人打磨第n个刀触点时会发生碰撞,其余区域为无碰撞区域。
具体而言,所述步骤24)中,在碰撞图层中求得依次经过所有刀触点的优化曲线具体包括:
如附图9a所示,设有N个刀触点,在碰撞图层的可行区域中,从n=1出发,寻找一条到达n=N直线处的优化曲线,用该优化曲线来计算机器人运动路径上各点的位姿,即可实现机器人运动路径的避碰调整,如附图9b所示。
本实施例将加工坐标系的轴向平移调整与绕切线的旋转调整整合起来,在一条坐标系上进行统一表示,非常方便加工坐标系的调整计算。同时生成碰撞图层,将机器人运动路径的避碰调整这个三维问题转化为碰撞图层中的可靠区域寻找优化曲线的二维问题。大大地将问题简化。
以上实施例仅供说明本发明之用,而非对本发明的限制,有关技术领域的技术人员,在不脱离本发明的精神和范围的情况下,还可以作出各种变换或变型,因此所有等同的技术方案也应该属于本发明的范畴,应由各权利要求所限定。
Claims (10)
1.一种用于机器人砂带打磨的运动路径避碰调整方法,其特征在于,包括步骤:
1)机器人运动路径生成的步骤,即将工件的打磨路径转化为机器人运动路径;
2)机器人运动路径的避碰调整的步骤,即通过改变机器人打磨时运动路径上的各刀触点的位姿从而令机器人避免在加工过程中发生碰撞。
2.根据权利要求1所述的用于机器人砂带打磨的运动路径避碰调整方法,其特征在于,步骤1)中将工件的打磨路径转化为机器人运动路径的步骤具体为将打磨路径上的各刀触点映射到机器人运动路径上对应的路径点的位姿。
3.根据权利要求2所述的用于机器人砂带打磨的运动路径避碰调整方法,其特征在于:所述将打磨路径上的各刀触点映射到机器人运动路径上对应的路径点的位姿的步骤具体包括:
11)为工件打磨路径上的每个刀触点添加坐标系,其轴与该点在工件表面处的单位外法向量相同;
12)确定所有刀触点坐标系{M}的相对于工具坐标系{Tool}的位姿
13)确定机器人工具坐标系{Tool}相对于基坐标系的位姿
14)在砂带上的某点处定义一个加工坐标系{M′},其位姿用机器人的基坐标系{B}来描述,即当打磨路径上的刀触点坐标系{M}与{M′}重合时,即表示砂带加工到该刀触点;
15)计算机器人工具坐标系{Tool}相对于基坐标系{B}的位姿
16)根据机器人逆运动学解算法与即可求得机器人运动路径上各点的关节空间位姿θ=[θ1 θ2 θ3 θ4 θ5 θ6]。
4.根据权利要求1所述的用于机器人砂带打磨的运动路径避碰调整方法,其特征在于,步骤12)中,因采用机器人末端夹持工件的打磨方式,令机器人末端的工具坐标系{Tool}与工件坐标系{O}重合,则路径上的所有刀触点坐标系{M}均可以用{Tool}来描述位姿。
5.根据权利要求1所述的用于机器人砂带打磨的运动路径避碰调整方法,其特征在于,所述步骤15)具体包括:
由{M}={M′}得:
故:
其中:
6.根据权利要求1所述的用于机器人砂带打磨的运动路径避碰调整方法,其特征在于,所述的步骤2)中改变机器人运动路径上的点的位姿的步骤是通过调整刀触点所对应的的值,进而改变避开产生碰撞的关节位姿,实现机器人运动路径无碰撞优化,具体包括步骤:
21)调整加工坐标系{M′}相对于机器人基坐标系{B}的位姿包括沿接触轮转轴方向的平移调整和绕切线方向的旋转调整;
22)整合加工坐标系{M′}平移调整和旋转调整;
23)基于机器人砂带打磨仿真,建立碰撞图层;
24)在碰撞图层中求得依次经过所有刀触点的优化曲线,用该优化曲线来计算机器人运动路径上各点的位姿,即可实现机器人运动路径的避碰调整。
7.根据权利要求6所述的用于机器人砂带打磨的运动路径避碰调整方法,其特征在于,所述沿接触轮转轴方向的平移调整具体包括步骤:
201)当机器人打磨到工件上某个刀触点前,先将初始加工坐标系{Mo′}沿接触轮的轴向平移距离a得到新的加工坐标系{M′},接触轮的半径为R,砂带的宽度为W,则a的取值范围为[-W/2,W/2];
202)求得初始加工坐标系{Mo′}、新的加工坐标系{M′}相对于机器人基坐标系{B}的位姿分别为则有:
其中,为新的加工坐标系{M′}相对于初始加工坐标系{Mo′}的位姿;
203)计算的值:
当{Mo′}的X轴与接触轮的轴线平行时,则有:
当{Mo′}的Y轴与接触轮的轴线平行时,则有:
8.根据权利要求7所述的用于机器人砂带打磨的运动路径避碰调整方法,其特征在于:所述绕切线方向的旋转调整具体包括步骤:
211)当由初始加工坐标系{Mo′}轴向平移到砂带边缘,得到坐标系{Me′},用砂带边缘加工打磨路径上的某刀触点前,将加工坐标系{M′}绕砂带在点Me′处的切线旋转α角度得新的加工坐标系{M′},α最大角度为A,最小的旋转角度为0;
212)求新的加工坐标系{M′}相对于初始加工坐标系{Mo′}的位姿矩阵
当{Me′}的轴与切线共线且同向时,有:
当{Me′}的轴与切线共线且同向时,有:
213)根据公式求新的加工坐标系{M′}相对于机器人基坐标{B}的位姿矩阵
9.根据权利要求8所述的用于机器人砂带打磨的运动路径避碰调整方法,其特征在于:所述的步骤22)具体包括步骤:
为加工坐标系{M′}建立一个坐标轴 的直线部分表示{M′}轴向平移,圆弧部分表示{M′}绕切线旋转,所述坐标轴的直线部分与接触轮转轴平行且其中点为Mo′点,设加工坐标系{M′}从{Mo′}处开始在坐标轴上进行调整,调整的距离为d,当d=0时,{M′}={Mo′},当d∈[-W/2,W/2]时,{M′}为轴向平移,当d∈[-A-W/2,-W/2)或d∈[W/2,A+W/2)时,{M′}为绕轴旋转调整,设变量t,有公式:
若d∈[-W/2,W/2],则将a=t代入加工坐标系轴向平移的变换公式中计算矩阵否则将α=t,a=t/|t|·W/2代入式加工坐标系绕切线旋转的变换公式中计算矩阵
10.根据权利要求9所述的用于机器人砂带打磨的运动路径避碰调整方法,其特征在于,所述步骤23)中,
所述碰撞图层的横坐标为工件打磨路径上的刀触点序号,纵坐标为加工坐标系{M′}在坐标轴上的位置d,图中的点的坐标为(n,d)表示第n个刀触点所对应的{M′}在上的位置d,两条横线d=A+W/2和d=-A-W/2之间的区域为可行区域,表示{M′}在上的调整范围,当点(n,d)落在碰撞区域时,{M′}在上的位置为d,此时机器人打磨第n个刀触点时会发生碰撞,其余区域为无碰撞区域。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710764395.6A CN107414860B (zh) | 2017-08-30 | 2017-08-30 | 一种用于机器人砂带打磨的运动路径避碰调整方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710764395.6A CN107414860B (zh) | 2017-08-30 | 2017-08-30 | 一种用于机器人砂带打磨的运动路径避碰调整方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107414860A true CN107414860A (zh) | 2017-12-01 |
CN107414860B CN107414860B (zh) | 2021-02-12 |
Family
ID=60435202
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710764395.6A Expired - Fee Related CN107414860B (zh) | 2017-08-30 | 2017-08-30 | 一种用于机器人砂带打磨的运动路径避碰调整方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107414860B (zh) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109664296A (zh) * | 2018-12-13 | 2019-04-23 | 华南理工大学 | 一种面向机器人砂带打磨的优化轨迹搜索方法 |
CN110227994A (zh) * | 2019-05-28 | 2019-09-13 | 华中科技大学 | 一种高阶切触包络式磨抛加工方法及其应用 |
CN111730488A (zh) * | 2020-06-30 | 2020-10-02 | 天津大学 | 一种五自由度混联机器人模具抛光***及方法 |
CN112462685A (zh) * | 2020-10-26 | 2021-03-09 | 吉林省齐智科技有限公司 | 一种避免碰撞自动转换3+2加工的控制方法及其应用 |
CN112706008A (zh) * | 2021-01-06 | 2021-04-27 | 广东博智林机器人有限公司 | 一种天花打磨方法及装置 |
WO2021253391A1 (zh) * | 2020-06-19 | 2021-12-23 | 浙江大学 | 一种使用机械臂完成不可重复覆盖任务抬起次数最少的方法 |
WO2022069993A1 (en) * | 2020-09-30 | 2022-04-07 | Auris Health, Inc. | Collision avoidance in surgical robotics based on non-contact information |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2008001275A2 (en) * | 2006-06-30 | 2008-01-03 | Philips Intellectual Property & Standards Gmbh | Method of controlling the position of at least part of an autonomously moveable device |
CN101456452A (zh) * | 2008-12-25 | 2009-06-17 | 浙江大学 | 一种飞机机身柔性化、自动化调姿方法 |
CN103692320A (zh) * | 2013-12-31 | 2014-04-02 | 深圳先进技术研究院 | 一种实现六轴抛光打磨机械臂离线编程的方法和装置 |
CN105269565A (zh) * | 2015-10-30 | 2016-01-27 | 福建长江工业有限公司 | 一种六轴磨抛工业机器人离线编程及修正方法 |
CN105834735A (zh) * | 2016-04-19 | 2016-08-10 | 北京航空航天大学 | 一种基于激光跟踪仪的零部件自动装配方法 |
CN106182018A (zh) * | 2016-07-30 | 2016-12-07 | 福州大学 | 一种基于工件三维图形的磨抛工业机器人离线编程方法 |
-
2017
- 2017-08-30 CN CN201710764395.6A patent/CN107414860B/zh not_active Expired - Fee Related
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2008001275A2 (en) * | 2006-06-30 | 2008-01-03 | Philips Intellectual Property & Standards Gmbh | Method of controlling the position of at least part of an autonomously moveable device |
CN101456452A (zh) * | 2008-12-25 | 2009-06-17 | 浙江大学 | 一种飞机机身柔性化、自动化调姿方法 |
CN103692320A (zh) * | 2013-12-31 | 2014-04-02 | 深圳先进技术研究院 | 一种实现六轴抛光打磨机械臂离线编程的方法和装置 |
CN105269565A (zh) * | 2015-10-30 | 2016-01-27 | 福建长江工业有限公司 | 一种六轴磨抛工业机器人离线编程及修正方法 |
CN105834735A (zh) * | 2016-04-19 | 2016-08-10 | 北京航空航天大学 | 一种基于激光跟踪仪的零部件自动装配方法 |
CN106182018A (zh) * | 2016-07-30 | 2016-12-07 | 福州大学 | 一种基于工件三维图形的磨抛工业机器人离线编程方法 |
Non-Patent Citations (2)
Title |
---|
张明德等: "船用螺旋桨叶片五轴联动砂带磨削方法研究", 《现代制造工程》 * |
赵扬: "机器人磨削叶片关键技术研究", 《中国博士学位论文全文数据库 (信息科技辑)》 * |
Cited By (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109664296A (zh) * | 2018-12-13 | 2019-04-23 | 华南理工大学 | 一种面向机器人砂带打磨的优化轨迹搜索方法 |
CN109664296B (zh) * | 2018-12-13 | 2021-12-17 | 华南理工大学 | 一种面向机器人砂带打磨的优化轨迹搜索方法 |
CN110227994A (zh) * | 2019-05-28 | 2019-09-13 | 华中科技大学 | 一种高阶切触包络式磨抛加工方法及其应用 |
CN110227994B (zh) * | 2019-05-28 | 2020-07-10 | 华中科技大学 | 一种高阶切触包络式磨抛加工方法及其应用 |
WO2021253391A1 (zh) * | 2020-06-19 | 2021-12-23 | 浙江大学 | 一种使用机械臂完成不可重复覆盖任务抬起次数最少的方法 |
US11897143B2 (en) | 2020-06-19 | 2024-02-13 | Zhejiang University | Method for performing non-revisiting coverage task by manipulator with least number of lift-offs |
JP7254384B2 (ja) | 2020-06-19 | 2023-04-10 | 浙江大学 | マニピュレータを使用して最も少ない持ち上げ回数で繰り返し不可能な被覆タスクを完了する方法 |
JP2022542729A (ja) * | 2020-06-19 | 2022-10-07 | 浙江大学 | マニピュレータを使用して最も少ない持ち上げ回数で繰り返し不可能な被覆タスクを完了する方法 |
CN111730488B (zh) * | 2020-06-30 | 2021-06-08 | 天津大学 | 一种五自由度混联机器人模具抛光***及方法 |
CN111730488A (zh) * | 2020-06-30 | 2020-10-02 | 天津大学 | 一种五自由度混联机器人模具抛光***及方法 |
WO2022069993A1 (en) * | 2020-09-30 | 2022-04-07 | Auris Health, Inc. | Collision avoidance in surgical robotics based on non-contact information |
CN112462685A (zh) * | 2020-10-26 | 2021-03-09 | 吉林省齐智科技有限公司 | 一种避免碰撞自动转换3+2加工的控制方法及其应用 |
CN112706008A (zh) * | 2021-01-06 | 2021-04-27 | 广东博智林机器人有限公司 | 一种天花打磨方法及装置 |
Also Published As
Publication number | Publication date |
---|---|
CN107414860B (zh) | 2021-02-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107414860A (zh) | 一种用于机器人砂带打磨的运动路径避碰调整方法 | |
CN107253102A (zh) | 一种异形薄壁复杂结构工件的超精密磨削加工方法 | |
CN104526070B (zh) | 环面蜗杆多轴联动加工位置标定方法 | |
CN109927028A (zh) | 一种力控机器人磨抛加工的力位混合控制方法 | |
CN110039449A (zh) | 应用于打磨机器人的打磨方法和*** | |
CN103771729B (zh) | 一种可降低行程的离子束加工方法 | |
CN102091980B (zh) | 缓进给端面磨削外廓形线为凸函数回转件的加工方法 | |
CN115032945A (zh) | 复杂曲面零件慢刀伺服磨削加工刀具轨迹规划方法 | |
Chen et al. | A novel CNC grinding method for the rake face of a taper ball-end mill with a CBN spherical grinding wheel | |
CN103128663A (zh) | 气囊抛光工具修整器 | |
CN110497727A (zh) | 一种立体石雕加工的最优加工空间选取方法 | |
CN112091778A (zh) | 子弹头类型非球面模具单点磨削加工工艺 | |
CN104875080B (zh) | 一种倾斜入射的离子束抛光修形加工方法 | |
CN103995979B (zh) | 非球面平行磨削加工的磨削力计算方法 | |
CN104385084B (zh) | 可变成型基圆平面包络凸曲面工件五轴磨削加工方法 | |
CN105607577B (zh) | 一种基于轴向精度的小线段过渡方法 | |
CN107942930B (zh) | 基于五轴数控***进行斜边加工的方法 | |
Peng et al. | Error analysis and compensation of line contact spherical grinding with cup-shaped wheel | |
CN107861467B (zh) | 环形刀四轴定轴加工刀位确定方法、装置及电子设备 | |
CN105598790B (zh) | 涡轮叶片锯齿形叶冠结构的加工方法 | |
CN114460900B (zh) | 一种异形曲面玻璃轮廓的加工方法及装置 | |
CN108549323A (zh) | 一种五轴数控工具磨床通用后置处理方法 | |
CN109465677A (zh) | 一种机器人恒力抛光方法 | |
CN109857060A (zh) | 一种叶片类零件磨削加工刀轴位姿的调整方法 | |
CN110703691B (zh) | 一种横磨外圆磨刃轨迹三维建模方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20210212 |
|
CF01 | Termination of patent right due to non-payment of annual fee |