CN114713890B - 基于双臂协作的环面蜗轮滚刀前刀面加工***及其方法 - Google Patents
基于双臂协作的环面蜗轮滚刀前刀面加工***及其方法 Download PDFInfo
- Publication number
- CN114713890B CN114713890B CN202111514287.6A CN202111514287A CN114713890B CN 114713890 B CN114713890 B CN 114713890B CN 202111514287 A CN202111514287 A CN 202111514287A CN 114713890 B CN114713890 B CN 114713890B
- Authority
- CN
- China
- Prior art keywords
- processing
- mechanical arm
- hob
- machining
- worm
- 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
- 238000003754 machining Methods 0.000 title claims description 101
- 238000000034 method Methods 0.000 title claims description 42
- 238000012545 processing Methods 0.000 claims abstract description 143
- 238000003672 processing method Methods 0.000 claims abstract description 5
- 238000004088 simulation Methods 0.000 claims description 29
- 230000033001 locomotion Effects 0.000 claims description 25
- 238000010586 diagram Methods 0.000 claims description 24
- 230000008569 process Effects 0.000 claims description 18
- 239000011159 matrix material Substances 0.000 claims description 15
- 230000009466 transformation Effects 0.000 claims description 13
- 238000004422 calculation algorithm Methods 0.000 claims description 9
- 238000006073 displacement reaction Methods 0.000 claims description 7
- 238000003801 milling Methods 0.000 claims description 7
- 238000001514 detection method Methods 0.000 claims description 6
- 238000007514 turning Methods 0.000 claims description 6
- 238000005516 engineering process Methods 0.000 claims description 4
- 238000000227 grinding Methods 0.000 claims description 3
- 239000000725 suspension Substances 0.000 claims description 3
- 238000010276 construction Methods 0.000 claims description 2
- 238000004804 winding Methods 0.000 claims 1
- 238000004519 manufacturing process Methods 0.000 abstract description 10
- 238000005498 polishing Methods 0.000 description 5
- 230000008859 change Effects 0.000 description 4
- 238000013507 mapping Methods 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 230000010355 oscillation Effects 0.000 description 2
- 230000001360 synchronised effect Effects 0.000 description 2
- 208000002474 Tinea Diseases 0.000 description 1
- 241000893966 Trichophyton verrucosum Species 0.000 description 1
- 230000001133 acceleration Effects 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 238000005520 cutting process Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000009977 dual effect Effects 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000000737 periodic effect Effects 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B23—MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
- B23C—MILLING
- B23C3/00—Milling particular work; Special milling operations; Machines therefor
- B23C3/28—Grooving workpieces
- B23C3/32—Milling helical grooves, e.g. in making twist-drills
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B23—MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
- B23C—MILLING
- B23C9/00—Details or accessories so far as specially adapted to milling machines or cutter
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J18/00—Arms
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Robotics (AREA)
- Manipulator (AREA)
Abstract
本发明涉及一种基于双臂协作的环面蜗轮滚刀前刀面加工***及其方法,该***包括第一机械臂和第二机械臂,所述第一机械臂的末端通过第一电主轴连接安装有滚刀基本蜗杆,所述第二机械臂的末端通过第二电主轴连接安装有加工刀具,所述第一机械臂和第二机械臂分别根据设定的对应的加工轨迹和指令,以分别控制滚刀基本蜗杆的工作位置、加工刀具的工作位置和加工力。与现有技术相比,本发明能够实现环面蜗轮滚刀螺旋槽前刀面的自动化加工,具有加工精度高、加工效率高的优点,尤其适用于狭小空间中复杂曲面的加工制造,同时能够降低生产成本。
Description
技术领域
本发明涉及环面蜗轮加工技术领域,尤其是涉及一种基于双臂协作的环面蜗轮滚刀前刀面加工***及其方法。
背景技术
与圆柱蜗杆传动相比,环面蜗杆传动具有承载能力强、体积小、传动效率高和使用寿命长等优点,能够很好地满足机械行业对传动装置小型化和轻量化的需求。环面蜗杆传动中的蜗轮通常由环面蜗轮滚刀滚切而成,环面蜗轮滚刀以环面蜗杆为基体制造而成,由于环面蜗轮滚刀各个刀齿的形状不同、滚刀基本蜗杆齿面螺旋线上各处的螺旋升角也不相同,导致环面蜗轮滚刀的制造比较复杂,特别是环面蜗轮滚刀螺旋槽前刀面的成形及加工方法,将直接影响刀齿的切削性能和滚切蜗轮的齿面质量。因此有必要提升环面蜗轮滚刀的加工制造水平,以促进二次包络环面蜗杆传动的发展。
目前,针对环面蜗轮滚刀前刀面的加工,大多采用机床铣削方法,对于直槽滚刀而言,机床铣削加工方法简单,不要求机床的C轴联动,但是对于螺旋槽滚刀来说,不仅需要四轴联动的机床,并且由于前刀面是复杂曲面,边齿的齿根等加工区域加工路径复杂,一方面传统机床铣削的加工精度难以保证,另一方面传统机床铣削的加工路径将会对机床本身的灵活性产生更高的要求,数控机床在对复杂曲面进行加工操作时,由于设备本身自由度及操作度的限制,可能存在加工盲区,最终导致无法适用于狭小空间中复杂曲面的加工制造。
发明内容
本发明的目的就是为了克服上述现有技术存在的缺陷而提供一种基于双臂协作的环面蜗轮滚刀前刀面加工***及其方法,以实现环面蜗轮滚刀螺旋槽前刀面的自动化精准加工。
本发明的目的可以通过以下技术方案来实现:一种基于双臂协作的环面蜗轮滚刀前刀面加工***,包括第一机械臂和第二机械臂,所述第一机械臂的末端通过第一电主轴连接安装有滚刀基本蜗杆,所述第二机械臂的末端通过第二电主轴连接安装有加工刀具,所述第一机械臂和第二机械臂分别根据设定的对应的加工轨迹和指令,以分别控制滚刀基本蜗杆的工作位置、加工刀具的工作位置和加工力。
进一步地,所述第一机械臂和第二机械臂分别连接至同一控制器,所述控制器内存储有对应于第一机械臂和第二机械臂的控制程序。
进一步地,所述第二机械臂的末端还安装有用于采集加工接触力的力矩传感器。
进一步地,所述加工刀具为铣刀或指状砂轮。
一种基于双臂协作的环面蜗轮滚刀前刀面加工方法,包括以下步骤:
S1、建立双机械臂运动学模型,并进行基坐标系标定;
S2、生成环面蜗轮滚刀螺旋槽前刀面的加工路径,并规划相应的初步加工轨迹;
S3、构建双机械臂协作加工控制框架;
S4、搭建双机械臂协作加工仿真平台,通过仿真进行碰撞检查及碰撞处理,以保证双机械臂能够平稳连续地运动;
基于仿真结果对初步加工轨迹以及双机械臂的控制指令进行调整;
S5、根据调整后的加工轨迹以及控制指令,离线生成双机械臂协作加工环面蜗轮滚刀螺旋槽前刀面的控制程序;
S6、将待加工的滚刀基本蜗杆安装至第一机械臂的末端、在第二机械臂的末端安装加工刀具;
第一机械臂和第二机械臂分别按照控制程序发生运动,完成环面蜗轮滚刀螺旋槽前刀面加工。
进一步地,所述步骤S1的具体过程为:建立双机械臂与滚刀基本蜗杆、加工刀具之间的封闭运动链,包括两条开环运动链,其中一条开环运动链为第一机械臂基座-第一机械臂末端-滚刀基本蜗杆-加工位置点,另一条开环运动链为第一机械臂基座-第二机械臂基座-第二机械臂末端-加工刀具-加工位置点;
之后使用激光跟踪仪标定第一机械臂、第二机械臂的基坐标系,根据相对坐标变换原理,得到第一机械臂基坐标系与第二机械臂基坐标系之间的相对变换矩阵。
进一步地,所述步骤S2的具体过程为:由加工刀具Σqd展成螺旋槽前刀面Σ3,加工位置点M对应的滚刀基本蜗杆的轴向坐标为Zi,且有-0.5Lw≤Zi≤0.5Lw,其中,Lw为滚刀基本蜗杆的工作长度;
第二机械臂夹持加工刀具沿iqod轴和jqod轴移动的瞬时速度分别为vx和vy,位移分别为并且满足/> 其中,Xqod(0)和Yqod(0)分别为加工刀具沿iqod轴和jqod轴的初始位移;
第一机械臂夹持的滚刀基本蜗杆绕回转轴kqo1的瞬时转速为ωq1,转角为 其中,/>为滚刀基本蜗杆的喉部转到S平面时对应蜗杆毛坯的转角,滚刀基本蜗杆绕回转轴kqo1的瞬时转速ωq1与第二机械臂夹持加工刀具沿jqod轴移动的瞬时速度vy成正比,即ωq1=iqd1·vy,其中,iqd1为滚刀基本蜗杆转动和加工刀具移动的速比;
第二机械臂夹持加工刀具围绕原点运动,加工刀具在滚刀基本蜗杆经过的路径即为加工轨迹,将加工轨迹离散化,得到单位切线矢量τ和单位内法线矢量f两个方向,然后根据这两个矢量方向,进一步确定第二机械臂末端加工刀具的姿态,其切矢量方向为加工路径的方向,法矢量方向是加工力的方向;
根据环面蜗轮滚刀螺旋槽前刀面的加工工艺要求,对第二机械臂末端加工刀具的姿态规定如下:在加工作业过程中,加工轨迹上路径点的法线矢量f与加工刀具TCP坐标系的Xt方向重合,同时也是第二机械臂末端进行恒力控制的方向;TCP坐标系的Yt方向为路径点的切线矢量τ、且指向下一个加工位置点,同时也是加工刀具移动的方向,加工刀具的TCP坐标系的Zt方向与路径点的法线矢量f与切线矢量τ的叉乘方向w=f×τ重合,且符合右手定则。
进一步地,所述步骤S3的具体过程为:第一机械臂夹持滚刀基本蜗杆进行位置控制,以精确跟踪加工轨迹;第二机械臂夹持加工刀具进行加工轨迹跟踪,并通过实时采集加工接触力、基于阻抗控制算法进行加工刀具的恒定加工力控制。
进一步地,所述步骤S4的具体过程为:搭建与实物物理平台比例为1:1的双机械臂协作加工环面蜗轮滚刀螺旋槽前刀面***仿真平台;
仿真过程中启动碰撞检测,若发生碰撞,则将两台机械臂设定为暂停状态;
仿真结束后生成机械臂各关节的转动角度序列图、关节角轨迹跟踪图、关节角轨迹跟踪误差图、期望轨迹与实际轨迹对比图,由各关节转角序列图确定两台机械臂是否平稳连续地运动,并根据关节角轨迹跟踪图、关节角轨迹跟踪误差图、期望轨迹与实际轨迹对比图,以确定加工轨迹、控制算法的正确性,从而对初步加工轨迹以及双机械臂的控制指令进行调整。
进一步地,所述步骤S4具体是采用Solidworks与Matlab/Simulink模块联合搭建双机械臂协作加工环面蜗轮滚刀螺旋槽前刀面***仿真平台。
与现有技术相比,本发明通过设置双机械臂,并在第一机械臂的末端通过第一电主轴连接安装有滚刀基本蜗杆、在第二机械臂的末端通过第二电主轴连接安装有加工刀具,利用第一机械臂和第二机械臂分别根据设定的对应的加工轨迹和指令,以分别控制滚刀基本蜗杆的工作位置、加工刀具的工作位置和加工力。由此实现环面蜗轮滚刀螺旋槽前刀面的自动化加工,能够有效提高生产效率,降低生产成本,尤其适用于狭小空间中复杂曲面的加工制造。
本发明首先建立双机械臂与滚刀基本蜗杆、加工刀具之间的封闭运动链模型,通过生成环面蜗轮滚刀螺旋槽前刀面的加工路径、规划加工轨迹,并构建双机械臂协作加工控制框架,结合仿真模型进行碰撞检查及碰撞处理,以保证双机械臂能够平稳连续地运动;此外还基于仿真结果对初步加工轨迹以及双机械臂的控制指令进行调整,由此保证双机械臂对应的加工轨迹以及控制指令的准确性,进而大大提高环面蜗轮滚刀螺旋槽前刀面的加工精度。
附图说明
图1为本发明的***结构示意图;
图2为双机械臂协作加工坐标系示意图;
图3为螺旋槽前刀面加工原理示意图;
图4为双机械臂之间的位姿约束关系图;
图5为双机械臂协作加工控制架构示意图;
图中标记说明:1、第一机械臂,2、第二机械臂,3、滚刀基本蜗杆,4、第一电主轴,5、加工刀具,6、第二电主轴。
具体实施方式
下面结合附图和具体实施例对本发明进行详细说明。
实施例
如图1所示,一种基于双臂协作的环面蜗轮滚刀前刀面加工***,包括第一机械臂1和第二机械臂2,第一机械臂1的末端通过第一电主轴4连接安装有滚刀基本蜗杆3,第二机械臂2的末端通过第二电主轴6连接安装有加工刀具5,第一机械臂1和第二机械臂2分别根据设定的对应的加工轨迹和指令,以分别控制滚刀基本蜗杆3和加工刀具5的工作位置。
其中,第一机械臂1和第二机械臂2分别连接至同一控制器,控制器内存储有对应于第一机械臂1和第二机械臂2的控制程序。
在实际应用中,第二机械臂2的末端还安装有用于采集加工接触力的力矩传感器,以便对加工刀具5的加工力进行恒定控制。
根据加工需求,加工刀具5可选用铣刀(用于进行环面蜗轮滚刀螺旋槽前刀面的粗加工)或指状砂轮(用于进行环面蜗轮滚刀螺旋槽前刀面的精加工)。
将上述***应用于实际中,以实现一种基于双臂协作的环面蜗轮滚刀前刀面加工方法,包括以下步骤:
S1、建立双机械臂运动学模型,并进行基坐标系标定,具体的:
建立双机械臂与滚刀基本蜗杆、加工刀具之间的封闭运动链,包括两条开环运动链,其中一条开环运动链为第一机械臂基座-第一机械臂末端-滚刀基本蜗杆-加工位置点,另一条开环运动链为第一机械臂基座-第二机械臂基座-第二机械臂末端-加工刀具-加工位置点;
之后使用激光跟踪仪标定第一机械臂、第二机械臂的基坐标系,根据相对坐标变换原理,得到第一机械臂基坐标系与第二机械臂基坐标系之间的相对变换矩阵;
S2、生成环面蜗轮滚刀螺旋槽前刀面的加工路径,并规划相应的初步加工轨迹,具体的:
由加工刀具Σqd展成螺旋槽前刀面Σ3,加工位置点M对应的滚刀基本蜗杆的轴向坐标为Zi,且有-0.5Lw≤Zi≤0.5Lw,其中,Lw为滚刀基本蜗杆的工作长度;
第二机械臂夹持加工刀具沿iqod轴和jqod轴移动的瞬时速度分别为vx和vy,位移分别为并且满足/> 其中,Xqod(0)和Yqod(0)分别为加工刀具沿iqod轴和jqod轴的初始位移;
第一机械臂夹持的滚刀基本蜗杆绕回转轴kqo1的瞬时转速为ωq1,转角为 其中,/>为滚刀基本蜗杆的喉部转到S平面时对应蜗杆毛坯的转角,滚刀基本蜗杆绕回转轴kqo1的瞬时转速ωq1与第二机械臂夹持加工刀具沿jqod轴移动的瞬时速度vy成正比,即ωq1=iqd1·vy,其中,iqd1为滚刀基本蜗杆转动和加工刀具移动的速比;
第二机械臂夹持加工刀具围绕原点运动,加工刀具在滚刀基本蜗杆经过的路径即为加工轨迹,将加工轨迹离散化,得到单位切线矢量τ和单位内法线矢量f两个方向,然后根据这两个矢量方向,进一步确定第二机械臂末端加工刀具的姿态,其切矢量方向为加工路径的方向,法矢量方向是加工力的方向;
根据环面蜗轮滚刀螺旋槽前刀面的加工工艺要求,对第二机械臂末端加工刀具的姿态规定如下:在加工作业过程中,加工轨迹上路径点的法线矢量f与加工刀具TCP坐标系的Xt方向重合,同时也是第二机械臂末端进行恒力控制的方向;TCP坐标系的Yt方向为路径点的切线矢量τ、且指向下一个加工位置点,同时也是加工刀具移动的方向,加工刀具的TCP坐标系的Zt方向与路径点的法线矢量f与切线矢量τ的叉乘方向w=f×τ重合,且符合右手定则;
S3、构建双机械臂协作加工控制框架,具体的:第一机械臂夹持滚刀基本蜗杆进行位置控制,以精确跟踪加工轨迹;第二机械臂夹持加工刀具进行加工轨迹跟踪,并通过实时采集加工接触力、基于阻抗控制算法进行加工刀具的恒定加工力控制;
S4、搭建双机械臂协作加工仿真平台,通过仿真进行碰撞检查及碰撞处理,以保证双机械臂能够平稳连续地运动;
基于仿真结果对初步加工轨迹以及双机械臂的控制指令进行调整;
具体的:
首先搭建与实物物理平台比例为1:1的双机械臂协作加工环面蜗轮滚刀螺旋槽前刀面***仿真平台,本实施例采用Solidworks与Matlab/Simulink模块联合搭建仿真平台;
在仿真过程中启动碰撞检测,若发生碰撞,则将两台机械臂设定为暂停状态;
仿真结束后生成机械臂各关节的转动角度序列图、关节角轨迹跟踪图、关节角轨迹跟踪误差图、期望轨迹与实际轨迹对比图,由各关节转角序列图确定两台机械臂是否平稳连续地运动,并根据关节角轨迹跟踪图、关节角轨迹跟踪误差图、期望轨迹与实际轨迹对比图,以确定加工轨迹、控制算法的正确性,从而对初步加工轨迹以及双机械臂的控制指令进行调整;
S5、根据调整后的加工轨迹以及控制指令,离线生成双机械臂协作加工环面蜗轮滚刀螺旋槽前刀面的控制程序;
S6、将待加工的滚刀基本蜗杆安装至第一机械臂的末端、在第二机械臂的末端安装加工刀具;
第一机械臂和第二机械臂分别按照控制程序发生运动,完成环面蜗轮滚刀螺旋槽前刀面加工。
本实施例以修形的环面蜗杆副为例,其中,环面蜗轮滚刀基本参数为:中心距aq=160mm,传动比i12=10,滚刀头数z1=4,蜗轮分度圆压力角α=21.8667°,蜗轮分度圆直径d2=255mm,蜗杆分度圆直径d1=65mm,滚刀齿顶圆弧半径Ra1=122.24mm,滚刀齿根圆弧半径Rf1=133.24mm,滚刀工作长度Lw=90mm,滚刀喉部分度圆导成角γm=21.4205°,主基圆直径db=95mm。
采用两台型号为ER20-C10的机械臂,其载重为20Kg、自重为220Kg、臂展为1722mm,滚刀基本蜗杆3通过第一电主轴4安装在第一机械臂1末端,加工刀具5则通过第二电主轴6安装在第二机械臂2末端。
基于本技术方案提出的方法过程,本实施例的应用过程包括:
一、首先建立双机械臂协作加工环面蜗轮滚刀螺旋槽前刀面的坐标系***,如图2所示。机械臂与待加工滚刀基本蜗杆之间形成了一条封闭的运动链,其中坐标系定义如下:Tw表示世界坐标系,Tb1、Tb2、Tf1、Tf2分别表示夹持滚刀基本蜗杆的机械臂1和夹持加工刀具的机械臂2的基坐标系、末端坐标系,To表示工件坐标系,Tt表示加工刀具坐标系,Tj表示滚刀基本蜗杆加工路径上任意离散点坐标系,Tw与Tb1重合。根据双机械臂与待加工滚刀基本蜗杆形成的闭链运动学关系,可解耦成两条开式运动链:一条是夹持滚刀基本蜗杆的机械臂1由“机械臂1的基座-末端-夹具-滚刀基本蜗杆-加工点”组成的运动链,另一条是夹持加工刀具的机械臂2由“机械臂1基座-机械臂2基座-末端-加工刀具-加工点”,双机械臂的各自末端相对于基坐标系的映射关系为:
其中,0Tw根据具体加工轨迹要求确定,是一个已知时变矩阵,b1Tb2通过基坐标系标定确定,oTj根据加工轨迹确定,f1To、f2Tt根据安装方式经TCP工具标定确定,wTj,wTt重合。根据双机械臂的各自末端相对于基坐标系的映射关系,分别利用双机械臂的逆运动学,可得到机械臂各关节的运动角度。
利用激光跟踪仪标定***,其中激光跟踪仪坐标系为固定的测量坐标系,分别标定出机械臂1、2的基坐标系相对于测量坐标系的变换矩阵T1,T2。基于相对坐标变换原理,由公式b2Tb1=T1 -1T2,计算得到两台机械臂的基坐标系之间的相对位姿齐次矩阵b1Tb2。
二、如图3所示,由加工刀具∑qd展成螺旋槽前刀面∑3,加工点M对应的滚刀基本蜗杆的轴向坐标为Zi(-45mm≤Zi≤45mm),Lw为滚刀基本蜗杆的工作长度。设定机械臂2夹持加工刀具沿jqod轴的总位移为Yqod=120mm,即从Yqod=-60mm运动到Yqod=60mm,机械臂1夹持的滚刀基本蜗杆绕回转轴kqol的总转角为 转角从530.835°变化到552.312°,其中,滚刀基本蜗杆的喉部转到S平面时对应蜗杆毛坯的转角/>滚刀基本蜗杆转动和加工刀具移动的速比iqdl=0.358。
根据环面蜗轮滚刀加工工艺要求,两台机械臂在协作加工的过程中,它们的运动约束关系如下:机械臂1夹持滚刀基本蜗杆跟踪加工轨迹并不断的调整加工姿态,使加工路径点的法方向f始终保持水平;机械臂2夹持加工刀具,根据闭环约束运动链实时计算得到运动轨迹,同时末端加工刀具的恒力控制Xt方向保持水平,且与加工路径点的法线方向f重合。Yt,Zt方向进行位置跟踪,确保双机械臂协调加工过程中,保持确定的位姿约束关系。双机械臂之间的位姿约束关系如图4所示。
机械臂1的位姿约束为:机械臂1夹持滚刀基本蜗杆,保持滚刀基本蜗杆工件坐标系To相对机械臂1基坐标系Tb1的位置向量b1Po=[x y z]T不变,同时不断调整打磨姿态使加工路径点的法向方向f水平即b1Rj=[1 0 0]T,路径点的位姿变换矩阵b1Tj为:b1Tf1=b1To(oTj)-1(f1To)-1,其中,b1Rf1为末端坐标系相对基坐标系的姿态旋转矩阵,f1Ro为滚刀基本蜗杆工件坐标系相对末端坐标系的姿态旋转矩阵,b1Po为工件坐标系相对基坐标系的位置矩阵,b1Tj、oTj、f1To都已知,根据步骤一建立的双机械臂运动学模型,可计算得到机械臂1各关节的运动角度。
机械臂2的位姿约束为:在机械臂2的笛卡尔操作空间中,对机械臂2进行力/位操作空间分解,即在Xt方向进行恒力控制,Yt,Zt方向进行位置控制。机械臂2夹持加工刀具跟踪加工轨迹,同时保持恒力控制方向与路径点的法向方向f重合。因此在机械臂2加工刀具坐标系的Xt方向进行恒力控制,且始终保持水平即加工姿态为b2Rt=[1 0 0]T,在Yt,Zt方向进行位置控制跟随加工轨迹。根据步骤一建立的双机械臂运动学模型,计算得到机械臂2加工刀具末端的位置b2Pt=[xt yt zt]T=b2Tb1 b1Tf1 f1To[xj yi zj 1]T,其中,b2Tb1为机械臂1相对机械臂2基坐标系的齐次变换矩阵,b1Tf1为机械臂1末端坐标系相对基坐标系的齐次变换矩阵,f1To为滚刀基本蜗杆工件坐标系相对机械臂1末端坐标系的齐次变换矩阵。机械臂2的位姿变换矩阵b2Tt为:b2Tf2=b2Tt(f2Tt)-1,其中,b2Tt、f2Tt都已知,根据步骤一建立的双机械臂运动学模型,可得到机械臂2各关节的运动角度。
三、采用一个控制器实现两台机械臂的控制,其中机械臂1夹持滚刀基本蜗杆进行位置控制,精确跟踪打磨轨迹,根据协调约束关系获得夹持加工刀具的机械臂2的运动轨迹,同时机械臂2进行轨迹跟踪且保持恒力加工,协作完成加工任务。协作控制架构如图5所示。夹持滚刀基本蜗杆的机械臂1采用PD位置控制方式进行加工轨迹跟踪,夹持加工刀具的机械臂2通过末端安装的六维力传感器实时采集加工接触力,采用基于位置的阻抗控制算法进行机械臂1的Xt方向的恒定加工力的控制。
由于本技术方案所搭建控制***的控制周期较短,因此不考虑积分的特性,机械臂1采用单关节PD控制方式。各关节期望位置θti通过逆运动学计算得到,关节位置θi、关节速度通过六维力传感器实时采集获得,则机械臂各关节驱动量为/> 其中kpi为比例系数,kvi为微分系数。
针对各关节伺服控制***中控制参数kpi、kvi的调节,先根据偏差震荡幅度的大小不断调节比例系数以快速减小误差,然后调节微分系数降低偏差的震荡频率,迅速准确地跟踪轨迹的变化,保证整个机械臂运动被控过程是稳定的。将关节伺服控制***中的每个关节视作单输入单输出***,每个关节进行单独控制,然后通过驱动器的周期同步插补模式完成各关节同步联动控制,实现机械臂精确地运动控制。
机械臂2通过末端安装的六维力传感器实时采集与环面蜗杆的接触力信息,经滤波、力传感器重力补偿后得到Xt方向的实际加工力F,其与期望接触力Fd的偏差fe作为一个二阶低通滤波器的输入,输出Xt方向的位置修正值Δx,通过选择矩阵S、S将修正值反馈给机器人笛卡尔操作空间X方向的参考运动轨迹,更新机械臂运动轨迹,经机械臂运动学计算得到各关节角度,当机械臂进入下一个打磨周期时,机械臂2末端的六维力传感器继续采集打磨力接触信息,重复执行上述步骤,不断更新打磨轨迹,直至完成加工环面蜗轮滚刀螺旋槽前刀面的任务。
四、采用Solidworks与Matlab/Simulink模块联合搭建双机械臂协作加工环面蜗轮滚刀螺旋槽前刀面仿真平台,仿真平台由仿真环境搭建、算法开发与编程、仿真数据传输三部分。仿真***的搭建是利用Solidworks三维软件模型建立双机械臂协作加工环面蜗杆螺旋槽前刀面***CAD模型,然后通过Sinmscape Multibody Link插件将***CAD模型导出成Matlab可以读取的XML格式文件和STEP模型,最后通过读取XML格式文件将***STEP模型加载到Matlab/Simulink中,生成加工***仿真模型图。导入Simulink的原始***仿真模型无法进行直接控制,需要进一步对模型进行优化和相关控制参数配置,包络STEP模型路径修改、Rotation输入输出量配置、机械臂初始姿态关节角配置及关节旋转正方向设定等,利用Scope组件、To Workspace组件保存数据,最后封装成一个独立的模块。
五、首先生成机械臂各关节角、速度及加速度变化图,如果变化图中曲线平稳连续,则步骤一中建立的双机械臂加工滚刀螺旋槽前刀面***的运动学模型正确。其次生成实际轨迹与期望轨迹对比图与关节角轨迹跟踪误差图,如果实际轨迹可以按照期望轨迹运动且误差较小,则机械臂1基于PD位置控制方式正确;对机械臂2末端Xt方向施加一个外力,观察轨迹图是否会适应外力进行调整重新回到加工路径上,如果机械臂可以适应外力的变化进行运动轨迹调整,并且当干扰力为零时,机械臂可以快速稳定的继续跟踪期望轨迹,则基于位置阻抗控制算法对机械臂2的加工恒力控制可行。
六、针对仿真结果,对双机械臂加工滚刀螺旋槽前刀面过程进行调整,综合调整后离线生成双机械臂协作加工环面蜗轮滚刀螺旋槽前刀面的程序。
综上可知,采用本发明提出的技术方案,能够实现环面蜗轮滚刀螺旋槽前刀面的自动化加工,可有效提高生产效率和加工精度,尤其适用于狭小空间中复杂曲面的加工制造。
Claims (8)
1.一种基于双臂协作的环面蜗轮滚刀前刀面加工方法,应用于一种环面蜗轮滚刀前刀面加工***,其特征在于,所述环面蜗轮滚刀前刀面加工***包括第一机械臂(1)和第二机械臂(2),所述第一机械臂(1)的末端通过第一电主轴(4)连接安装有滚刀基本蜗杆(3),所述第二机械臂(2)的末端通过第二电主轴(6)连接安装有加工刀具(5),所述第一机械臂(1)和第二机械臂(2)分别根据设定的对应的加工轨迹和指令,以分别控制滚刀基本蜗杆(3)的工作位置、加工刀具(5)的工作位置和加工力;
所述环面蜗轮滚刀前刀面加工方法包括以下步骤:
S1、建立双机械臂运动学模型,并进行基坐标系标定;
S2、生成环面蜗轮滚刀螺旋槽前刀面的加工路径,并规划相应的初步加工轨迹;
S3、构建双机械臂协作加工控制框架;
S4、搭建双机械臂协作加工仿真平台,通过仿真进行碰撞检查及碰撞处理,以保证双机械臂能够平稳连续地运动;
基于仿真结果对初步加工轨迹以及双机械臂的控制指令进行调整;
S5、根据调整后的加工轨迹以及控制指令,离线生成双机械臂协作加工环面蜗轮滚刀螺旋槽前刀面的控制程序;
S6、将待加工的滚刀基本蜗杆安装至第一机械臂的末端、在第二机械臂的末端安装加工刀具;
第一机械臂和第二机械臂分别按照控制程序发生运动,完成环面蜗轮滚刀螺旋槽前刀面加工;
所述步骤S2的具体过程为:由加工刀具Σqd展成螺旋槽前刀面Σ3,加工位置点M对应的滚刀基本蜗杆的轴向坐标为Zi,且有-0.5Lw≤Zi≤0.5Lw,其中,Lw为滚刀基本蜗杆的工作长度;
第二机械臂夹持加工刀具沿iqod轴和jqod轴移动的瞬时速度分别为vx和vy,位移分别为并且满足/> 其中,Xqod(0)和Yqod(0)分别为加工刀具沿iqod轴和jqod轴的初始位移;
第一机械臂夹持的滚刀基本蜗杆绕回转轴kqo1的瞬时转速为ωq1,转角为 其中,/>为滚刀基本蜗杆的喉部转到S平面时对应蜗杆毛坯的转角,滚刀基本蜗杆绕回转轴kqo1的瞬时转速ωq1与第二机械臂夹持加工刀具沿jqod轴移动的瞬时速度vy成正比,即ωq1=iqd1·y,其中,iqd1为滚刀基本蜗杆转动和加工刀具移动的速比;
第二机械臂夹持加工刀具围绕原点运动,加工刀具在滚刀基本蜗杆经过的路径即为加工轨迹,将加工轨迹离散化,得到单位切线矢量τ和单位内法线矢量f两个方向,然后根据这两个矢量方向,进一步确定第二机械臂末端加工刀具的姿态,其切矢量方向为加工路径的方向,法矢量方向是加工力的方向;
根据环面蜗轮滚刀螺旋槽前刀面的加工工艺要求,对第二机械臂末端加工刀具的姿态规定如下:在加工作业过程中,加工轨迹上路径点的法线矢量f与加工刀具TCP坐标系的Xt方向重合,同时也是第二机械臂末端进行恒力控制的方向;TCP坐标系的Yt方向为路径点的切线矢量τ、且指向下一个加工位置点,同时也是加工刀具移动的方向,加工刀具的TCP坐标系的Zt方向与路径点的法线矢量f与切线矢量τ的叉乘方向w=f×τ重合,且符合右手定则。
2.根据权利要求1所述的一种基于双臂协作的环面蜗轮滚刀前刀面加工方法,其特征在于,所述第一机械臂(1)和第二机械臂(2)分别连接至同一控制器,所述控制器内存储有对应于第一机械臂(1)和第二机械臂(2)的控制程序。
3.根据权利要求1所述的一种基于双臂协作的环面蜗轮滚刀前刀面加工方法,其特征在于,所述第二机械臂(2)的末端还安装有用于采集加工接触力的力矩传感器。
4.根据权利要求1所述的一种基于双臂协作的环面蜗轮滚刀前刀面加工方法,其特征在于,所述加工刀具(5)为铣刀或指状砂轮。
5.根据权利要求1所述的一种基于双臂协作的环面蜗轮滚刀前刀面加工方法,其特征在于,所述步骤S1的具体过程为:建立双机械臂与滚刀基本蜗杆、加工刀具之间的封闭运动链,包括两条开环运动链,其中一条开环运动链为第一机械臂基座-第一机械臂末端-滚刀基本蜗杆-加工位置点,另一条开环运动链为第一机械臂基座-第二机械臂基座-第二机械臂末端-加工刀具-加工位置点;
之后使用激光跟踪仪标定第一机械臂、第二机械臂的基坐标系,根据相对坐标变换原理,得到第一机械臂基坐标系与第二机械臂基坐标系之间的相对变换矩阵。
6.根据权利要求1所述的一种基于双臂协作的环面蜗轮滚刀前刀面加工方法,其特征在于,所述步骤S3的具体过程为:第一机械臂夹持滚刀基本蜗杆进行位置控制,以精确跟踪加工轨迹;第二机械臂夹持加工刀具进行加工轨迹跟踪,并通过实时采集加工接触力、基于阻抗控制算法进行加工刀具的恒定加工力控制。
7.根据权利要求1所述的一种基于双臂协作的环面蜗轮滚刀前刀面加工方法,其特征在于,所述步骤S4的具体过程为:搭建与实物物理平台比例为1:1的双机械臂协作加工环面蜗轮滚刀螺旋槽前刀面***仿真平台;
仿真过程中启动碰撞检测,若发生碰撞,则将两台机械臂设定为暂停状态;
仿真结束后生成机械臂各关节的转动角度序列图、关节角轨迹跟踪图、关节角轨迹跟踪误差图、期望轨迹与实际轨迹对比图,由各关节转角序列图确定两台机械臂是否平稳连续地运动,并根据关节角轨迹跟踪图、关节角轨迹跟踪误差图、期望轨迹与实际轨迹对比图,以确定加工轨迹、控制算法的正确性,从而对初步加工轨迹以及双机械臂的控制指令进行调整。
8.根据权利要求7所述的一种基于双臂协作的环面蜗轮滚刀前刀面加工方法,其特征在于,所述步骤S4具体是采用Solidworks与Matlab/Simulink模块联合搭建双机械臂协作加工环面蜗轮滚刀螺旋槽前刀面***仿真平台。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111514287.6A CN114713890B (zh) | 2021-12-13 | 2021-12-13 | 基于双臂协作的环面蜗轮滚刀前刀面加工***及其方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111514287.6A CN114713890B (zh) | 2021-12-13 | 2021-12-13 | 基于双臂协作的环面蜗轮滚刀前刀面加工***及其方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114713890A CN114713890A (zh) | 2022-07-08 |
CN114713890B true CN114713890B (zh) | 2023-08-29 |
Family
ID=82234950
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111514287.6A Active CN114713890B (zh) | 2021-12-13 | 2021-12-13 | 基于双臂协作的环面蜗轮滚刀前刀面加工***及其方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114713890B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
TWI822263B (zh) * | 2022-08-19 | 2023-11-11 | 創博股份有限公司 | 基於機器手臂的點對點運動進行動態物件追蹤的方法 |
Citations (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB554489A (en) * | 1941-09-18 | 1943-07-06 | Warner Swasey Co | Improvements in metal cutting or other machine tools |
EP1602456A2 (de) * | 2004-06-02 | 2005-12-07 | KUKA Roboter GmbH | Verfahren und Vorrichtung zum Steuern von Handhabungsgeräten |
CN101286058A (zh) * | 2008-04-24 | 2008-10-15 | 上海交通大学 | 机器人模块化分布式自适应控制***及方法 |
JP2010137298A (ja) * | 2008-12-09 | 2010-06-24 | Yaskawa Electric Corp | 複腕ロボットの作業プログラム作成方法 |
JP2013202693A (ja) * | 2012-03-27 | 2013-10-07 | Mitsubishi Heavy Ind Ltd | 歯車加工機械 |
CN203449306U (zh) * | 2013-09-02 | 2014-02-26 | 华南理工大学 | 一种主从式双工业机器人协调操作控制*** |
CN106825711A (zh) * | 2017-04-05 | 2017-06-13 | 中国农业大学 | 环面蜗轮滚刀螺旋容屑槽的铣削方法 |
CN106945020A (zh) * | 2017-05-18 | 2017-07-14 | 哈尔滨工业大学 | 一种空间双机械臂***运动协调控制方法 |
DE102018103600A1 (de) * | 2017-02-20 | 2018-08-23 | Aisin Seiki Kabushiki Kaisha | Kombinierte Zahnradschneidevorrichtung |
CN208629159U (zh) * | 2018-07-06 | 2019-03-22 | 广州中国科学院先进技术研究所 | 一种双机器人协同打磨装置 |
CN109623656A (zh) * | 2018-11-12 | 2019-04-16 | 南京航空航天大学 | 基于厚度在线检测的移动式双机器人协同打磨装置及方法 |
CN109877840A (zh) * | 2019-04-02 | 2019-06-14 | 哈尔滨工程大学 | 一种基于相机光轴约束的双机械臂标定方法 |
CN110421547A (zh) * | 2019-07-12 | 2019-11-08 | 中南大学 | 一种基于估计动力学模型的双臂机器人协同阻抗控制方法 |
CN110695988A (zh) * | 2019-09-04 | 2020-01-17 | 南京理工大学 | 双机械臂协同运动方法及*** |
CN110900604A (zh) * | 2019-12-02 | 2020-03-24 | 浙江大学 | 基于双机械臂协作打磨***的动力学模型设计方法 |
CN211052748U (zh) * | 2019-12-12 | 2020-07-21 | 浙江日创机电科技有限公司 | 一种立式数控滚齿机 |
CN111618845A (zh) * | 2019-02-28 | 2020-09-04 | 精工爱普生株式会社 | 机器人*** |
CN113146620A (zh) * | 2021-03-16 | 2021-07-23 | 南京工程学院 | 基于双目视觉的双臂协作机器人***和控制方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6816495B2 (ja) * | 2016-12-19 | 2021-01-20 | 株式会社デンソーウェーブ | ロボットのたわみ補正方法、ロボットの制御装置 |
-
2021
- 2021-12-13 CN CN202111514287.6A patent/CN114713890B/zh active Active
Patent Citations (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB554489A (en) * | 1941-09-18 | 1943-07-06 | Warner Swasey Co | Improvements in metal cutting or other machine tools |
EP1602456A2 (de) * | 2004-06-02 | 2005-12-07 | KUKA Roboter GmbH | Verfahren und Vorrichtung zum Steuern von Handhabungsgeräten |
CN101286058A (zh) * | 2008-04-24 | 2008-10-15 | 上海交通大学 | 机器人模块化分布式自适应控制***及方法 |
JP2010137298A (ja) * | 2008-12-09 | 2010-06-24 | Yaskawa Electric Corp | 複腕ロボットの作業プログラム作成方法 |
JP2013202693A (ja) * | 2012-03-27 | 2013-10-07 | Mitsubishi Heavy Ind Ltd | 歯車加工機械 |
CN203449306U (zh) * | 2013-09-02 | 2014-02-26 | 华南理工大学 | 一种主从式双工业机器人协调操作控制*** |
DE102018103600A1 (de) * | 2017-02-20 | 2018-08-23 | Aisin Seiki Kabushiki Kaisha | Kombinierte Zahnradschneidevorrichtung |
CN106825711A (zh) * | 2017-04-05 | 2017-06-13 | 中国农业大学 | 环面蜗轮滚刀螺旋容屑槽的铣削方法 |
CN106945020A (zh) * | 2017-05-18 | 2017-07-14 | 哈尔滨工业大学 | 一种空间双机械臂***运动协调控制方法 |
CN208629159U (zh) * | 2018-07-06 | 2019-03-22 | 广州中国科学院先进技术研究所 | 一种双机器人协同打磨装置 |
CN109623656A (zh) * | 2018-11-12 | 2019-04-16 | 南京航空航天大学 | 基于厚度在线检测的移动式双机器人协同打磨装置及方法 |
CN111618845A (zh) * | 2019-02-28 | 2020-09-04 | 精工爱普生株式会社 | 机器人*** |
CN109877840A (zh) * | 2019-04-02 | 2019-06-14 | 哈尔滨工程大学 | 一种基于相机光轴约束的双机械臂标定方法 |
CN110421547A (zh) * | 2019-07-12 | 2019-11-08 | 中南大学 | 一种基于估计动力学模型的双臂机器人协同阻抗控制方法 |
CN110695988A (zh) * | 2019-09-04 | 2020-01-17 | 南京理工大学 | 双机械臂协同运动方法及*** |
CN110900604A (zh) * | 2019-12-02 | 2020-03-24 | 浙江大学 | 基于双机械臂协作打磨***的动力学模型设计方法 |
CN211052748U (zh) * | 2019-12-12 | 2020-07-21 | 浙江日创机电科技有限公司 | 一种立式数控滚齿机 |
CN113146620A (zh) * | 2021-03-16 | 2021-07-23 | 南京工程学院 | 基于双目视觉的双臂协作机器人***和控制方法 |
Non-Patent Citations (1)
Title |
---|
汽车轮毂打磨机器人双臂协作运动轨迹规划研究;董涛涛;中国优秀硕士学位论文全文数据库工程科技Ⅱ辑(月刊)(第2021年第8期期);第C035-281页 * |
Also Published As
Publication number | Publication date |
---|---|
CN114713890A (zh) | 2022-07-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US7130718B2 (en) | Pathcorrection for an industrial robot | |
CN114290147B (zh) | 基于双工业机器人协作的汽车轮毂打磨***及其方法 | |
CN102581849B (zh) | 一种基于nc代码的工业机器人轨迹规划方法 | |
US4722063A (en) | Method of calculating actual arm lengths and compensating for angular errors | |
CN111347422B (zh) | 一种提高机器人关节精度的控制方法 | |
Kubela et al. | Assessment of industrial robots accuracy in relation to accuracy improvement in machining processes | |
CN111037542B (zh) | 一种逆动力学控制机器人直线加工的轨迹误差补偿方法 | |
CN114713890B (zh) | 基于双臂协作的环面蜗轮滚刀前刀面加工***及其方法 | |
CN110370271B (zh) | 工业串联机器人的关节传动比误差校准方法 | |
CN103869748B (zh) | 非圆曲面xy直驱加工廓形误差交叉耦合控制***及方法 | |
CN109032072B (zh) | 一种双并联杆钻铆设备的法矢调姿及其偏移补偿方法 | |
Sun et al. | An on-line tool path smoothing algorithm for 6R robot manipulator with geometric and dynamic constraints | |
CN112475475A (zh) | 一种人字齿轮对中度在线测量及修正方法 | |
EP1886771B1 (en) | Rotation center point calculating method, rotation axis calculating method, program creating method, operation method, and robot apparatus | |
CN114654466B (zh) | 自动标定方法、装置、***、电子设备及存储介质 | |
CN114839921A (zh) | 一种基于数据驱动的五轴轮廓控制方法 | |
CN114253217B (zh) | 带有自修正功能的五轴机床rtcp自动标定方法 | |
CN105929791A (zh) | 平面直角坐标运动***的直接轮廓控制方法 | |
CN113325802B (zh) | 一种五轴机床几何误差补偿方法 | |
CN116834009A (zh) | 一种分布式虚实孪生的机器人位姿误差在线补偿*** | |
CN114012719A (zh) | 一种六轴机器人的零点标定方法及*** | |
CN117300330A (zh) | 一种基于多信源融合的机器人搅拌摩擦焊位姿柔顺调控方法 | |
CN110161966B (zh) | 一种多轴联动轮廓误差的实时检测方法 | |
CN112757307B (zh) | 一种机器人加工三元叶轮叶片焊接坡口的装备和方法 | |
CN112379638A (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 |