CN108746415A - 一种利用机器人弯制带圈泪滴曲的弯制规划方法 - Google Patents
一种利用机器人弯制带圈泪滴曲的弯制规划方法 Download PDFInfo
- Publication number
- CN108746415A CN108746415A CN201810624704.4A CN201810624704A CN108746415A CN 108746415 A CN108746415 A CN 108746415A CN 201810624704 A CN201810624704 A CN 201810624704A CN 108746415 A CN108746415 A CN 108746415A
- Authority
- CN
- China
- Prior art keywords
- pincers
- bend
- robot
- clamping
- bends
- 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
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B21—MECHANICAL METAL-WORKING WITHOUT ESSENTIALLY REMOVING MATERIAL; PUNCHING METAL
- B21F—WORKING OR PROCESSING OF METAL WIRE
- B21F1/00—Bending wire other than coiling; Straightening wire
Abstract
一种利用机器人弯制带圈泪滴曲的弯制规划方法,它涉及正畸弓丝弯制领域,根据带圈泪滴曲的弯制点信息,计算弯丝运动模型,确定了正畸弯丝机器人的弯制规划策略,定义了初始化弯制点,针对弯制过程中的干涉情况提出了特定的弯制规划方法,将带圈泪滴曲上各个弯制点从初始弯制点依次进入弯制规划方法,获得并收集带圈泪滴曲的机器人弯制信息集。技术要点为:带圈泪滴曲的参数化、计算弯丝运动模型、确定机器人弯制规划策略、定义初始弯制点信息、制定基于两种干涉情况的规划策略、获得机器人弯丝运动信息、收集机器人弯制信息集。
Description
技术领域:
本发明专利涉及一种利用机器人弯制带圈泪滴曲的弯制规划方法,属于正畸弓丝弯制技术领域。
背景技术:
正畸弓丝的形态是包含正畸弓丝第一序列曲的弓形、正畸弓丝第二序列曲的特殊功能曲和正畸弓丝的第三序列曲扭转变形等三种形态,它是根据患者牙齿畸形情况进行设计的。正畸弓丝第二序列曲形状多样,种类复杂,但每一种都形状固定,只需修改尺寸参数,以满足如儿童或成人等不同患者牙床高度各不相同的情况。
带圈泪滴曲作为第二序列曲,由直线段和圆形螺旋线段组成,形状较为复杂。当使用正畸弓丝机器人弯制带圈泪滴曲时,会在机器人弯制过程中发生干涉和碰撞,使得机器人弯制难度加大。而且在机器人弯制带圈泪滴的过程中,一个弯制点完成弯制运动,正畸弓丝会生成新的形态,下一个弯制点的弯制运动规划是在新的正畸弓丝形态进行的。因此,随着弯制不断地进行,带圈泪滴曲已成形的部分越来越复杂,同时也容易发生干涉,此时就需要对发生干涉处的弯制点重新规划弯制运动信息。
发明专利内容
针对上述问题,本发明提出一种利用机器人弯制带圈泪滴曲的弯制规划方法,以解决目前机器人弯制带圈泪滴曲易发生干涉,缺少正畸弓丝泪滴曲机器人化弯制规划方法而无法实现正畸弓丝带圈泪滴曲自动化弯制的问题。
一种利用机器人弯制带圈泪滴曲的弯制规划方法,本方法应用于一种正畸弓丝弯制机器人。
一种利用机器人弯制带圈泪滴曲的弯制规划方法,所述方法的具体实现过程为:
步骤一、带圈泪滴曲参数化:
在带圈泪滴曲弯制过程中,以第i-1、i、i+1个弯制点构建弯制第i+1个弯制点的正畸弓丝三维姿态的极坐标系Oi-ρiθiZi,以初始弯制点i=0时为原点O,以第i个弯制点到第i+1个弯制点的直线方向θ=0的位置,以第i-1、i、i+1个弯制点为确定弯制平面为极坐标系Oi-ρiθ所在的平面;
正畸弓丝的第二序列曲的形状都是由离散的几何单元自由排列组合形成的,这些几何单元包括直线段、圆弧段、圆形螺旋线段和矩形螺旋线段等,其表达式分别为L、M、N、P,那么正畸弓丝的带圈泪滴曲的数字化模型表示为f=f{L1,L2,N1,L3,L4},式中f表示第二序列曲,L1,L2,L3和L4表示直线段,N1表示圆形螺旋线段,五个几何单元首尾顺次连接组成带圈序列曲的形状,其中直线段L1可由坐标(ρ0,θ0,z0)和(ρ1,θ1,z1),直线段L2可由坐标(ρ1,θ1,z1)和(ρ2,θ2,z2)表示,N1由坐标(ρ2,θ2,z2)和(ρ3,θ3,z3)为起点和终点的螺旋线,L3可由坐标(ρ3,θ3,z3)和(ρ4,θ4,z4)表示,L4可由坐标(ρ4,θ4,z4)和(ρ5,θ5,z5)表示,因此,直线段Li的长度用两个端点坐标可表示为Li=(ρi+1-ρi,θi+1-θi,zi+1-zi),圆弧段的表达是利用微分的原理将连续的圆弧曲线转化成离散的有限若干点的形式,由此得出在第i+1个弯制点处的弯丝运动轨迹特征模型的坐标矩阵[Fi+1],如式1所示:
式中,Mi+1为将弓丝圆弧段以t=n·Δt(0<t<θi+1)分成n个点(t表示局部圆弧段,Δt表示圆弧上被划分的每个小圆弧段),n个点的坐标矩阵为[Mi+1];
步骤二、计算弯丝运动模型,并确定弯制规划策略:
根据手工弯制带圈泪滴曲的运动轨迹特征,建立弯丝单元运动模型PointAi=[ρi,θi,zi],在正畸弓丝弯制点极坐标系Oi-ρiθiZi下,PointAi表示弯制点Ai的坐标;
在第i个弯制点机器人弯丝运动单元参数模型,如式2所示:
式中BendΔAi的含义为:在第i个弯制点的弯制运动,机器人各个自由度的移动距离或转动的角度,以及实现弯制动作所旋转的角度;1Openi,1Closei表示钳Ⅰ在第i个弯制点的开合或夹紧状态,2Openi,2Closei表示第i个弯制点钳Ⅱ的开合或夹紧状态;βi表示弯制点弯折运动钳Ⅰ弯折旋转角度和位置调整时钳Ⅱ沿Z轴方向旋转的角度βi=2θi+1,为了区分钳Ⅰ和钳Ⅱ,Δ1βi表示钳Ⅰ的折弯旋转角度Δ1βi+1=90+θi+1+g(90+θi+1),g(90+θi+1)表示弯制角度为90+θi+1时的回弹角度值,g(90+θi+1)可由经验值获得,Δ2βi表示钳Ⅱ沿Z轴方向旋转的角度,其中Δ2βi+1=Δ1βi;ri表示弯制点处钳Ⅱ的曲率半径Δ1Li分别表示钳Ⅰ沿Z轴方向移动的距离,式中h是钳Ⅱ沿Z轴方向移动的成常量值,r0和h0分别表示正畸钳头圆锥体的最大底面半径和高,Δ2Li表示钳Ⅱ沿Z轴方向移动的距离Δ2Li+1=h;
步骤三、定义初始弯制点信息i=0:
根据弯丝单元运动模型PointAi=[ρi,θi,zi],将i=0时定义为初始化弯制点PointA0,另外,由于弯制带圈泪滴曲的特点,具有6个弯制点,因此设定i的范围为0≤i≤5;
步骤四、判断折弯旋转角度是否大于270°:
在对带圈泪滴曲进行弯制规划时,设定的规划弯折旋转角度为540°;但在弯折旋转角度大于270°时,便会发生干涉,无法弯制至540°,因此需要判断折弯旋转角度是否为大于270°;
若Δ1βi≥270°,执行基于折弯角度的规划策略,表达式为Benduniti a=[[Fi+1],Δ1βi≥270°],正畸弯丝机器人弯丝规划策略为:
1)钳Ⅱ松开对弯制点PointAi的夹紧,释放弓丝回弹角度g(270°)(回弹角度由经验公式可得),得到弯制点PointAi的成形角度270°-g(270°),进而使钳Ⅱ绕Z轴旋转270°到达新增加的夹紧弯制点PointAi';
2)得到新增加的弯制点PointAi'的弯折角度为Δ1βi-270°+g(270°);
3)得到基于折弯角度的BendaΔAi,如式3所示:
若Δ1βi<270°,则进入步骤五;
步骤五、判断H≥c(式中H为正畸弓丝未成形部分法线方向上的距离,c代表末端执行器的钳嘴结构尺寸):
若H≥c,执行基于折弯距离的规划策略,表达式为:Benduniti b=[[Fi+1],2Close],正畸弯丝机器人弯丝规划策略为:
1)在当前弯制点PointAi和下一个弯制点PointAi+1和之间选择一个点PointAi”,把PointAi”作为一个临时增加弯制点进行位置调整规划,得到位置调整过程中钳Ⅰ移动的距离为Δ1Li',在规划过程中时钳Ⅱ保持夹紧状态,使得末端执行器与弓丝之间保留一个0.5mm-1mm的微小间隙,进而可以使弓丝与末端执行器发生相对位置移动;
2)松开钳Ⅱ直至到达保留与弓丝的微小间隙,继续使钳Ⅱ沿Z轴方向移动Δ2Li,离开弯制点PointAi”的位置;
3)继续松开钳Ⅱ,使钳Ⅱ沿Z轴方向移动Δ2Li',回到当前弯制点PointAi的位置,随后钳Ⅱ夹紧,即实现两层弓丝的夹紧;
4)得到基于折弯距离的BendbΔAi,如式4所示:
若H<c,则进入步骤六;
步骤六、检测钳型是否发生干涉:
若发生干涉,返回步骤四;
若不发生干涉,进行步骤七;
步骤七、获得机器人弯制信息RobotΔAi:
记录当前弯制点PointAi的机器人弯丝运动单元参数模型BendΔAi、BendaΔAi或BendbΔAi,得到当前弯制点PointAi机器人弯丝运动单元模型信息集如式5所示:
RobotΔAi=(BendΔA0,BendΔA1,...,BendΔAi,BendaΔAi,...,BendbΔAi) (5)
步骤八、进行PointAi+1弯制点的弯制:
将弯制点PointAi中的i值加1,得到下一个弯制点PointAi+1,根据带圈泪滴曲的弯制特点,以及步骤三中所设定i的范围为0≤i≤5,各个带圈泪滴曲的弯制点PointAi依次进入上述的机器人弯制规划方法,因此可以依次得到弯制点PointA0至PointA5的机器人弯制信息RobotΔAi(0≤i≤5),而当i>5时,则进行步骤九;
步骤九、收集机器人弯制信息集Robot{Ai}:
收集弯制点PointA0至PointA5的机器人弯制信息RobotΔAi(0≤i≤5),得到机器人弯制信息集Robot{Ai},如式6所示,Robot{Ai}为带圈泪滴曲的弯制规划信息集:
Robot{Ai}={RobotΔA0,RobotΔA1,...,RobotΔA5} (6)。
本发明的有益效果为:
1、本发明以每个弯制点为一个需要规划的单元,将复杂的带圈泪滴曲分割成若干个单元,简化了弯制规划流程,提高了弯制规划方法的规划效率。
2、本发明提取了带圈泪滴曲在极坐标下各弯制点的弯制信息,并确定了正畸弯丝机器人的弯丝规划策略,建立了正畸弯丝机器人钳型运动方式,充分考虑了影响正畸弓丝弯制精度的因素,能够保证根据本方法所弯制正畸弓丝的成形质量。
3、本发明中带圈泪滴曲的各弯制点按顺序依次进入弯制规划方法,降低了规划过程中出现错误率,通过收集各个弯制点的机器人信息,组成机器人弯制信息集,提高了机器人弯制效率,简化了机器人弯制信息的确立过程,同样使得各个弯制点的信息均有迹可循,便于后期的修正和优化。
4、本发明考虑了机器人在弯制带圈泪滴曲过程中的两个干涉情况,规划了发生干涉时的弯制方法,实现了对干涉处的规避,有效的解决了机器人在弯制过程中的干涉问题。
附图说明:
为了易于说明,本发明由下述的具体实施及附图作以详细描述。
图1为一种利用机器人弯制带圈泪滴曲的弯制规划方法;
图2为正畸弓丝弯制点极坐标系示意图;
图3为带圈泪滴曲的参数化模型;
图4为正畸弓丝弯制机器人结构总体示意图;
图5为钳Ⅰ结构轴侧图;
图6为钳Ⅰ夹头分解示意图;
图7为钳Ⅱ结构轴侧图;
图8为钳Ⅱ内部结构示意图;
图9为钳Ⅱ分解示意图;
图10为柱坐标系转台内部结构示意图;
图11为正畸弓丝弯制机器人主体外壳示意图;
图12为正畸弓丝弯制机器人坐标系建立简图。
图中:1、钳Ⅰ;2、钳Ⅱ;3、柱坐标系转台;4、机器人主体外壳;5、弓丝;1-1、钳Ⅰ丝杠导轨滑台;1-2、钳Ⅰ丝杠;1-3、钳Ⅰ旋转主动齿轮;1-4、钳Ⅰ锥形夹头;1-4-1、夹头外壳;1-4-2、夹头夹芯;1-4-3、夹头主轴;1-5、钳Ⅰ夹紧被动齿轮;1-6、钳Ⅰ夹紧主动齿轮;1-7、挡圈;1-8、弹簧;1-9、拨叉;1-10、推杆;1-11、钳Ⅰ直线电机推杆;1-12、滑动挡圈;1-13、钳Ⅰ夹紧电机;1-14、钳Ⅰ旋转被动齿轮;1-15、钳Ⅰ支架;1-16、钳Ⅰ旋转电机;1-17、钳Ⅰ丝杠电机;1-18、钳Ⅰ丝杠螺母;1-19、钳Ⅰ旋转主轴;1-20、钳Ⅰ夹紧主轴;1-21、送丝入口;2-1、钳Ⅱ可动钳口;2-1-1、可动楔形滑块;2-2、钳Ⅱ固定钳口;2-3、夹紧滑块;2-3-1、夹紧楔形滑块;2-4、钳Ⅱ直线电机推杆;2-5、直线电机;2-6、钳Ⅱ旋转被动齿轮;2-7、钳Ⅱ外壳;2-8、钳Ⅱ丝杠;2-9、钳Ⅱ丝杠电机;2-10、钳Ⅱ丝杠螺母;2-11、钳Ⅱ旋转主动齿轮;2-12、钳Ⅱ旋转电机;2-13、复位弹簧;3-1、转台电机;3-2、转台主动齿轮;3-3、转台;3-4、转台被动齿轮;4-1、底座;4-2、环形拉门;4-3、环形外壳;4-4、主体支撑;4-5、外壳支柱;4-6、连接底盘;4-7、外壳顶部;5、正畸弓丝。
具体实施方式:
为使本发明专利的目的、技术方案和优点更加清楚明了,下面通过附图中示出的具体实施例来描述本发明专利,但是应该理解,这些描述只是示例性的,而并非要限制本发明专利的范围,此外,在以下说明中,省略了对公知结构和技术的描述,以避免不必要地混淆本发明专利的概念。
如图1、图2、图3、图4、图5、图6、图7、图8、图9、图10、图11、图12所示,本具体实施方式采用以下技术方案:
所述的一种正畸弓丝弯制机器人,由钳Ⅰ1、钳Ⅱ2、柱坐标系转台3、机器人主体外壳4四部分组成,其特征在于:所述钳Ⅰ1中的钳Ⅰ丝杠导轨滑台1-1通过螺栓与柱坐标系转台3中转台3-3的相连接,柱坐标系转台3的转台3-3通过螺栓与机器人主体外壳4内部的连接底盘4-6相连接,钳Ⅱ2通过螺栓连接固定在机器人主体外壳4外部的外壳顶部4-7;所述的钳Ⅰ1,它包括:钳Ⅰ丝杠导轨滑台1-1、钳Ⅰ丝杠1-2、钳Ⅰ旋转主动齿轮1-3、钳Ⅰ锥形夹头1-4、夹头外壳1-4-1、夹头夹芯1-4-2、夹头主轴1-4-3、钳Ⅰ夹紧被动齿轮1-5、钳Ⅰ夹紧主动齿轮1-6、挡圈1-7、弹簧1-8、拨叉1-9、推杆1-10、钳Ⅰ直线电机推杆1-11、滑动挡圈1-12、钳Ⅰ夹紧电机1-13、钳Ⅰ旋转被动齿轮1-14、钳Ⅰ支架1-15、钳Ⅰ旋转电机1-16、钳Ⅰ丝杠电机1-17、钳Ⅰ丝杠螺母1-18、钳Ⅰ旋转主轴1-19、钳Ⅰ夹紧主轴1-20、送丝入口1-21,钳Ⅰ丝杠1-2通过轴孔装配安装在钳Ⅰ丝杠导轨滑台1-1中,钳Ⅰ丝杠螺母1-18与钳Ⅰ丝杠1-2通过螺纹相连接,钳Ⅰ丝杠电机1-17通过钳Ⅰ丝杠导轨滑台1-1安装在钳Ⅰ丝杠1-2的末端,以驱动钳Ⅰ丝杠1-2的绕钳Ⅰ丝杠电机1-17的电机轴旋转,使得钳Ⅰ丝杠螺母1-18实现沿钳Ⅰ丝杠1-2的轴向左右移动,钳Ⅰ支架1-15的下底面通过螺栓与钳Ⅰ丝杠螺母1-18相连接,钳Ⅰ旋转电机1-16通过钳Ⅰ支架1-15与钳Ⅰ旋转主动齿轮1-3完成装配,以驱动钳Ⅰ旋转主动齿轮1-3绕钳Ⅰ旋转电机1-16的电机轴旋转,钳Ⅰ旋转被动齿轮1-14、钳Ⅰ夹紧被动齿轮1-5和钳Ⅰ锥形夹头1-4均安装在钳Ⅰ旋转主轴1-19上,钳Ⅰ旋转主轴1-19为空心轴,其中钳Ⅰ旋转被动齿轮1-14安装在钳Ⅰ支架1-15内部,与钳Ⅰ旋转主动齿轮1-3相啮合,形成一对啮合齿轮,钳Ⅰ夹紧被动齿轮1-5和钳Ⅰ锥形夹头1-4安装在钳Ⅰ支架1-15外部,送丝入口1-21位于钳Ⅰ旋转主轴1-18的左侧,正畸弓丝5通过送丝入口1-21穿过钳Ⅰ旋转主轴1-19的内部,可以将待弯制的正畸弓丝5送至位于钳Ⅰ旋转主轴1-19末端的钳Ⅰ锥形夹头1-4,完成机器人的送丝环节,其中钳Ⅰ锥形夹头1-4由夹头外壳1-4-1、夹头夹芯1-4-2、夹头主轴1-4-3组成,夹头外壳1-4-1通过螺纹与夹头主轴1-4-3相连接,夹头夹芯1-4-2位于旋转夹头外壳1-4-1和夹头主轴1-4-3的中间,当顺时针旋转夹头外壳1-4-1时,夹头外壳1-4-1与夹头主轴1-4-3之间的空间缩小,此时夹头夹芯1-4-2受到夹头外壳1-4-1的挤压,使得夹头夹芯1-4-2保持夹紧状态,以实现了对正畸弓丝5的夹紧,反之,逆时针旋转夹头夹芯1-4-2实现了对正畸弓丝5的松开;钳Ⅰ夹紧被动齿轮1-5与钳Ⅰ夹紧主动齿轮1-6相啮合,形成一对啮合齿轮,钳Ⅰ夹紧电机1-13通过螺纹连接安装在钳Ⅰ支架1-15的上顶面,钳Ⅰ夹紧电机1-13的主轴与钳Ⅰ夹紧主轴1-20相连接,以驱动钳Ⅰ夹紧主轴1-20绕轴向旋转,拨叉1-9、滑动挡圈1-12、弹簧1-8、挡圈1-7和钳Ⅰ夹紧主动齿轮1-6通过轴孔装配从左至右依次的被安装在钳Ⅰ夹紧主轴1-20上,拨叉1-9通过螺栓与滑动挡圈1-12相连接,弹簧1-8被镶嵌在滑动挡圈1-12和挡圈1-7中,挡圈1-7通过螺栓与钳Ⅰ夹紧主动齿轮1-6相连接,钳Ⅰ夹紧主轴1-20远离电机主轴方向的末端设有轴肩,用于限定钳Ⅰ夹紧主轴1-20上已装配零件的位置,推杆1-10末端安装有钳Ⅰ直线电机推杆1-11,推杆1-10与推杆1-10垂直下方的拨叉1-9相连接,钳Ⅰ直线电机推杆1-11安置在钳Ⅰ夹紧电机1-13上,当钳Ⅰ直线电机推杆1-11推动或拉回推杆1-10时,与推杆1-10相连接的拨叉1-9可带动滑动挡圈1-12、弹簧1-8、挡圈1-7和钳Ⅰ夹紧主动齿轮1-6沿钳Ⅰ夹紧主轴1-20轴向左右移动,进而控制钳Ⅰ夹紧主动齿轮1-6与钳Ⅰ夹紧被动齿轮1-5的啮合情况,另外,钳Ⅰ夹紧电机1-13可驱动钳Ⅰ夹紧被动齿轮1-5绕钳Ⅰ夹紧主轴1-20旋转,从而控制了与钳Ⅰ夹紧被动齿轮1-5相连的钳Ⅰ锥形夹头1-4的顺时旋转或逆时旋转,最终实现了对正畸弓丝5的夹紧与松开。
进一步的,所述的钳Ⅱ2,它包括:钳Ⅱ可动钳口2-1、可动楔形滑块2-1-1、钳Ⅱ固定钳口2-2、夹紧滑块2-3、夹紧楔形滑块2-3-1、钳Ⅱ直线电机推杆2-4、直线电机2-5、钳Ⅱ旋转被动齿轮2-6、钳Ⅱ外壳2-7、钳Ⅱ丝杠2-8、钳Ⅱ丝杠电机2-9、钳Ⅱ丝杠螺母2-10、钳Ⅱ旋转主动齿轮2-11、钳Ⅱ旋转电机2-12、复位弹簧2-13,以钳Ⅱ可动钳口2-1垂直向下为参考方向,钳Ⅱ丝杠电机2-9安装在钳Ⅱ外壳2-7的顶部,以驱动钳Ⅱ丝杠2-8,其中钳Ⅱ丝杠2-8与钳Ⅱ丝杠螺母2-10通过螺纹连接配合,通过钳Ⅱ丝杠电机2-9驱动钳Ⅱ丝杠2-8可以实现钳Ⅱ丝杠螺母2-10沿钳Ⅱ丝杠2-8轴线方向上下移动;直线电机2-5、钳Ⅱ旋转被动齿轮2-6、钳Ⅱ旋转主动齿轮2-11以及钳Ⅱ旋转电机2-12均安装在钳Ⅱ丝杠螺母2-10内,其中钳Ⅱ旋转电机2-12与钳Ⅱ旋转主动齿轮2-11通过轴孔配合相连接,钳Ⅱ旋转主动齿轮2-11与钳Ⅱ旋转被动齿轮2-6相啮合,形成一对啮合齿轮,以实现钳Ⅱ旋转被动齿轮2-6的旋转,另外,直线电机2-5通过轴孔配合被安装在钳Ⅱ旋转被动齿轮2-6中,钳Ⅱ直线电机推杆2-4安装在直线电机2-5中,在直线电机2-5和钳Ⅱ旋转被动齿轮2-6的作用下,钳Ⅱ直线电机推杆2-4即可实现绕钳Ⅱ旋转被动齿轮2-6的轴线进行旋转,又可沿钳Ⅱ旋转被动齿轮2-6的轴线进行平移;夹紧滑块2-3通过螺栓连接固定在钳Ⅱ直线电机推杆2-4上,夹紧滑块2-3上装有夹紧楔形滑块2-3-1,而钳Ⅱ可动钳口2-1上装有可动楔形滑块2-1-1,当钳Ⅱ直线电机推杆2-4被直线电机2-5推出时,夹紧楔形滑块2-3-1与可动楔形滑块2-1-1发生挤压,推动钳Ⅱ可动钳口2-1向钳Ⅱ固定钳口2-2方向移动,实现了钳Ⅱ2对正畸弓丝5的夹紧,当钳Ⅱ直线电机推杆2-4被直线电机2-5拉回时,夹紧楔形滑块2-3-1与可动楔形滑块2-1-1发生分离,复位弹簧2-13将钳Ⅱ可动钳口2-1推离钳Ⅱ固定钳口2-2,实现了钳Ⅱ2对正畸弓丝5的松开。
进一步的,所述的柱坐标系转台3包括:转台电机3-1、转台主动齿轮3-2、转台3-3、转台被动齿轮3-4,转台电机3-1通过轴孔装配与转台主动齿轮3-2相连接,以驱动转台主动齿轮3-2绕转台电机3-1的电机轴旋转,转台主动齿轮3-2与转台被动齿轮3-4相啮合,形成一对啮合齿轮,转台3-3与转台被动齿轮3-4通过螺栓连接相互固定,以实现转台被动齿轮3-4带动转台3-3绕转台3-3中心旋转。
进一步的,所述的机器人主体外壳4包括:底座4-1、环形拉门4-2、环形外壳4-3、主体支撑4-4、外壳支柱4-5、连接底盘4-6、外壳顶部4-7,连接底盘4-6通过螺栓连接安装在机器人主体外壳4的内部,外壳顶部4-7通过螺栓连接安装在机器人主体外壳4的外部,通过环形拉门4-2可实现机器人主体外壳4的开合,以保护操作人员与正畸弓丝弯制机器人;主体支撑4-4和外壳支柱4-5用于支撑机器人主体外壳4。
进一步的,当自动送丝任务完成时,需要正畸弓丝机器人完成弓丝弯制任务的具体实施方式为:首先,根据弯制弓丝的类型有所不同,因此,正畸弓丝机器人的具体实施顺序可能有所差异,本实施方式主要对于该正畸弓丝机器人的弯制功能进行附加说明;自动送丝任务执行完成后,开始执行弓丝弯制任务,此时,正畸弓丝5被安置在钳Ⅰ旋转主轴1-19中且已送至正畸弓丝机器人的工作区域内,钳Ⅰ1的钳Ⅰ锥形夹头1-4对于正畸弓丝5处于松开状态,钳Ⅱ2对于正畸弓丝5处于夹紧状态,在弯制弓丝的过程中,需要将钳Ⅰ1的钳Ⅰ锥形夹头1-4调整为夹紧且旋转的状态,因此,首先控制钳Ⅰ直线电机推杆1-11将推杆1-10推出,经过拨叉1-9、滑动挡圈1-12、弹簧1-8和挡圈1-7之间的力传递,使得钳Ⅰ夹紧主动齿轮1-6与钳Ⅰ夹紧被动齿轮1-5处于啮合状态,此时,启动钳Ⅰ夹紧电机1-13使得钳Ⅰ夹紧主动齿轮1-6逆时针旋转,与钳Ⅰ夹紧主动齿轮1-6外啮合的钳Ⅰ夹紧被动齿轮1-5顺时针旋转,使得与钳Ⅰ夹紧被动齿轮1-5相固定的钳Ⅰ锥形夹头1-4同样处于顺时针旋转状态,进而夹头外壳1-4-1与夹头主轴1-4-3之间的空间缩小,此时夹头夹芯1-4-2受到夹头外壳1-4-1的挤压,使得夹头夹芯1-4-2保持夹紧状态,以实现对正畸弓丝5的夹紧,为机器人绕弯弯制弓丝做准备,此时,启动钳Ⅰ旋转电机1-16且按逆时针方向旋转,驱动钳Ⅰ旋转主动齿轮1-3与相外啮合的钳Ⅰ旋转被动齿轮1-14,使得钳Ⅰ旋转主轴1-19按顺时针旋转,实现了正畸弓丝5在弯制过程中可绕自身旋转,因此,钳Ⅰ夹紧电机1-13和钳Ⅰ旋转电机1-16的启动,使得钳Ⅰ1实现了对正畸弓丝5的旋转和夹紧,此时,根据不同弯制需求,对于钳Ⅰ1的控制顺序有可能存在不同,当发生正畸弓丝弯制过程中干涉现象时,通过启动柱坐标系转台3中的转台电机3-1以驱动转台主动齿轮3-2和相外啮合的转台被动齿轮3-4,进而旋转转台3-3,可实现钳Ⅰ1整体机构绕旋转中心旋转0°至360°,完成了对正畸弓丝5的灵活弯制,另外,如需要沿正畸弓丝5送丝方向的平移时,可启动钳Ⅰ丝杠电机1-17,以驱动钳Ⅰ丝杠1-2,完成钳Ⅰ1整体机构沿正畸弓丝5方向的平移,因此,在正畸弓丝弯制机器人完成弯制任务时,钳Ⅰ1可实现对正畸弓丝5的旋转和夹紧,另外钳Ⅰ1也可实现绕旋转中心旋转以及沿正畸弓丝5送丝方向的平移,提高了弯制的灵活性,在钳Ⅰ1整体机构作用下,可实现正畸弓丝5的进给和位姿的调整;在弯制过程中,钳Ⅱ2除了能够完成对正畸弓丝5的夹紧,还能通过启动钳Ⅱ旋转电机2-12,驱动钳Ⅱ旋转主动齿轮2-11与相外啮合的钳Ⅱ旋转被动齿轮2-6,以实现钳Ⅱ可动钳口2-1和钳Ⅱ固定钳口2-2整体旋转,当发生正畸弓丝弯制过程中干涉现象时,设定钳Ⅱ可动钳口2-1和钳Ⅱ固定钳口2-2整体机构的旋转角度,避免了钳Ⅰ1和钳Ⅱ2发生碰撞,完成对正畸弓丝5上某一弯制点的弯制;因此,结合送丝任务中钳Ⅱ2的执行方式,钳Ⅱ2可实现沿正畸弓丝5垂直方向的移动以及对于正畸弓丝5的夹紧和松开,通过设定旋转角度可避免弓丝弯制过程中的干涉现象;
综上,所述的正畸弓丝弯制机器人中的钳Ⅰ1可实现正畸弓丝5的进给和位姿的调整,其中的钳Ⅱ2可实现正畸弓丝5的夹紧,同时用于避免正畸弓丝弯制过程中干涉现象,在钳Ⅰ1和钳Ⅱ2相互配合下,钳Ⅱ2通过钳Ⅱ可动钳口2-1和钳Ⅱ固定钳口2-2对正畸弓丝5的夹紧,再通过钳Ⅰ1对正畸弓丝5位姿的调整,可使得正畸弓丝5绕钳Ⅱ可动钳口2-1和钳Ⅱ固定钳口2-2完成弯制,进而使弓丝成形。
步骤一、带圈泪滴曲参数化:
在带圈泪滴曲弯制过程中,以第i-1、i、i+1个弯制点构建弯制第i+1个弯制点的正畸弓丝三维姿态的极坐标系Oi-ρiθiZi,以初始弯制点i=0时为原点O,以第i个弯制点到第i+1个弯制点的直线方向θ=0的位置,以第i-1、i、i+1个弯制点为确定弯制平面为极坐标系Oi-ρiθ所在的平面;
正畸弓丝的第二序列曲的形状都是由离散的几何单元自由排列组合形成的,这些几何单元包括直线段、圆弧段、圆形螺旋线段和矩形螺旋线段等,其表达式分别为L、M、N、P,那么正畸弓丝的带圈泪滴曲的数字化模型表示为f=f{L1,L2,N1,L3,L4},式中f表示第二序列曲,L1,L2,L3和L4表示直线段,N1表示圆形螺旋线段,五个几何单元首尾顺次连接组成带圈序列曲的形状,其中直线段L1可由坐标(ρ0,θ0,z0)和(ρ1,θ1,z1),直线段L2可由坐标(ρ1,θ1,z1)和(ρ2,θ2,z2)表示,N1由坐标(ρ2,θ2,z2)和(ρ3,θ3,z3)为起点和终点的螺旋线,L3可由坐标(ρ3,θ3,z3)和(ρ4,θ4,z4)表示,L4可由坐标(ρ4,θ4,z4)和(ρ5,θ5,z5)表示,因此,直线段Li的长度用两个端点坐标可表示为Li=(ρi+1-ρi,θi+1-θi,zi+1-zi),圆弧段的表达是利用微分的原理将连续的圆弧曲线转化成离散的有限若干点的形式,由此得出在第i+1个弯制点处的弯丝运动轨迹特征模型的坐标矩阵[Fi+1],如式1所示:
式中,Mi+1为将弓丝圆弧段以t=n·Δt(0<t<θi+1)分成n个点(t表示局部圆弧段,Δt表示圆弧上被划分的每个小圆弧段),n个点的坐标矩阵为[Mi+1];
步骤二、计算弯丝运动模型,并确定弯制规划策略:
根据手工弯制带圈泪滴曲的运动轨迹特征,建立弯丝单元运动模型PointAi=[ρi,θi,zi],在正畸弓丝弯制点极坐标系Oi-ρiθiZi下,PointAi表示弯制点Ai的坐标;
在第i个弯制点机器人弯丝运动单元参数模型,如式2所示:
式中BendΔAi的含义为:在第i个弯制点的弯制运动,机器人各个自由度的移动距离或转动的角度,以及实现弯制动作所旋转的角度;1Openi,1Closei表示钳Ⅰ在第i个弯制点的开合或夹紧状态,2Openi,2Closei表示第i个弯制点钳Ⅱ的开合或夹紧状态;βi表示弯制点弯折运动钳Ⅰ弯折旋转角度和位置调整时钳Ⅱ沿Z轴方向旋转的角度βi=2θi+1,为了区分钳Ⅰ和钳Ⅱ,Δ1βi表示钳Ⅰ的折弯旋转角度Δ1βi+1=90+θi+1+g(90+θi+1),g(90+θi+1)表示弯制角度为90+θi+1时的回弹角度值,g(90+θi+1)可由经验值获得,Δ2βi表示钳Ⅱ沿Z轴方向旋转的角度,其中Δ2βi+1=Δ1βi;ri表示弯制点处钳Ⅱ的曲率半径Δ1Li分别表示钳Ⅰ沿Z轴方向移动的距离,式中h是钳Ⅱ沿Z轴方向移动的成常量值,r0和h0分别表示正畸钳头圆锥体的最大底面半径和高,Δ2Li表示钳Ⅱ沿Z轴方向移动的距离Δ2Li+1=h;
步骤三、定义初始弯制点信息i=0:
根据弯丝单元运动模型PointAi=[ρi,θi,zi],将i=0时定义为初始化弯制点PointA0,另外,由于弯制带圈泪滴曲的特点,具有6个弯制点,因此设定i的范围为0≤i≤5;
步骤四、判断折弯旋转角度是否大于270°:
在对带圈泪滴曲进行弯制规划时,设定的规划弯折旋转角度为540°;但在弯折旋转角度大于270°时,便会发生干涉,无法弯制至540°,因此需要判断折弯旋转角度是否为大于270°;
若Δ1βi≥270°,执行基于折弯角度的规划策略,表达式为Benduniti a=[[Fi+1],Δ1βi≥270°],正畸弯丝机器人弯丝规划策略为:
1)钳Ⅱ松开对弯制点PointAi的夹紧,释放弓丝回弹角度g(270°)(回弹角度由经验公式可得),得到弯制点PointAi的成形角度270°-g(270°),进而使钳Ⅱ绕Z轴旋转270°到达新增加的夹紧弯制点PointAi';
2)得到新增加的弯制点PointAi'的弯折角度为Δ1βi-270°+g(270°);
3)得到基于折弯角度的BendaΔAi,如式3所示:
若Δ1βi<270°,则进入步骤五;
步骤五、判断H≥c(式中H为正畸弓丝未成形部分法线方向上的距离,c代表末端执行器的钳嘴结构尺寸):
若H≥c,执行基于折弯距离的规划策略,表达式为:Benduniti b=[[Fi+1],2Close],正畸弯丝机器人弯丝规划策略为:
1)在当前弯制点PointAi和下一个弯制点PointAi+1和之间选择一个点PointAi”,把PointAi”作为一个临时增加弯制点进行位置调整规划,得到位置调整过程中钳Ⅰ移动的距离为Δ1Li',在规划过程中时钳Ⅱ保持夹紧状态,使得末端执行器与弓丝之间保留一个0.5mm-1mm的微小间隙,进而可以使弓丝与末端执行器发生相对位置移动;
2)松开钳Ⅱ直至到达保留与弓丝的微小间隙,继续使钳Ⅱ沿Z轴方向移动Δ2Li,离开弯制点PointAi”的位置;
3)继续松开钳Ⅱ,使钳Ⅱ沿Z轴方向移动Δ2Li',回到当前弯制点PointAi的位置,随后钳Ⅱ夹紧,即实现两层弓丝的夹紧;
4)得到基于折弯距离的BendbΔAi,如式4所示:
若H<c,则进入步骤六;
步骤六、检测钳型是否发生干涉:
若发生干涉,返回步骤四;
若不发生干涉,进行步骤七;
步骤七、获得机器人弯制信息RobotΔAi:
记录当前弯制点PointAi的机器人弯丝运动单元参数模型BendΔAi、BendaΔAi或BendbΔAi,得到当前弯制点PointAi机器人弯丝运动单元模型信息集如式5所示:
RobotΔAi=(BendΔA0,BendΔA1,...,BendΔAi,BendaΔAi,...,BendbΔAi) (5)
步骤八、进行PointAi+1弯制点的弯制:
将弯制点PointAi中的i值加1,得到下一个弯制点PointAi+1,根据带圈泪滴曲的弯制特点,以及步骤三中所设定i的范围为0≤i≤5,各个带圈泪滴曲的弯制点PointAi依次进入上述的机器人弯制规划方法,因此可以依次得到弯制点PointA0至PointA5的机器人弯制信息RobotΔAi(0≤i≤5),而当i>5时,则进行步骤九;
步骤九、收集机器人弯制信息集Robot{Ai}:
收集弯制点PointA0至PointA5的机器人弯制信息RobotΔAi(0≤i≤5),得到机器人弯制信息集Robot{Ai},如式6所示,Robot{Ai}为带圈泪滴曲的弯制规划信息集:
Robot{Ai}={RobotΔA0,RobotΔA1,...,RobotΔA5} (6)。
以上显示和描述了本发明专利的基本原理和主要特征和本发明专利的优点,本行业的技术人员应该了解,本发明专利不受上述实施例的限制,上述实施例和说明书中描述的只是说明本发明专利的原理,在不脱离本发明专利精神和范围的前提下,本发明专利还会有各种变化和改进,这些变化和改进都落入要求保护的本发明专利范围内。本发明专利要求保护范围由所附的权利要求书及其等效物界定。
Claims (4)
1.一种正畸弓丝弯制机器人,由钳Ⅰ(1)、钳Ⅱ(2)、柱坐标系转台(3)、机器人主体外壳(4)四部分组成,其特征在于:所述钳Ⅰ(1)中的钳Ⅰ丝杠导轨滑台(1-1)通过螺栓与柱坐标系转台(3)的转台(3-3)相连接,柱坐标系转台(3)的转台(3-3)通过螺栓与机器人主体外壳(4)内部的连接底盘(4-6)相连接,钳Ⅱ(2)通过螺栓固定在机器人主体外壳(4)外部的外壳顶部(4-7);所述的钳Ⅰ(1)属于柱坐标式,它包括:钳Ⅰ丝杠导轨滑台(1-1)、钳Ⅰ丝杠(1-2)、钳Ⅰ旋转主动齿轮(1-3)、钳Ⅰ锥形夹头(1-4)、夹头外壳(1-4-1)、夹头夹芯(1-4-2)、夹头主轴(1-4-3)、钳Ⅰ夹紧被动齿轮(1-5)、钳Ⅰ夹紧主动齿轮(1-6)、挡圈(1-7)、弹簧(1-8)、拨叉(1-9)、推杆(1-10)、钳Ⅰ直线电机推杆(1-11)、滑动挡圈(1-12)、钳Ⅰ夹紧电机(1-13)、钳Ⅰ旋转被动齿轮(1-14)、钳Ⅰ支架(1-15)、钳Ⅰ旋转电机(1-16)、钳Ⅰ丝杠电机(1-17)、钳Ⅰ丝杠螺母(1-18)、钳Ⅰ旋转主轴(1-19)、钳Ⅰ夹紧主轴(1-20)、送丝入口(1-21),钳Ⅰ丝杠(1-2)通过轴孔装配安装在钳Ⅰ丝杠导轨滑台(1-1)中,钳Ⅰ丝杠螺母(1-18)与钳Ⅰ丝杠(1-2)通过螺纹相连接,钳Ⅰ丝杠电机(1-17)通过钳Ⅰ丝杠导轨滑台(1-1)安装在钳Ⅰ丝杠(1-2)的末端,以驱动钳Ⅰ丝杠(1-2)绕钳Ⅰ丝杠电机(1-17)的电机轴旋转,使得钳Ⅰ丝杠螺母(1-18)实现沿钳Ⅰ丝杠(1-2)的轴向左右移动,钳Ⅰ支架(1-15)的下底面通过螺栓与钳Ⅰ丝杠螺母(1-18)相连接,钳Ⅰ旋转电机(1-16)通过钳Ⅰ支架(1-15)与钳Ⅰ旋转主动齿轮(1-3)完成装配,以驱动钳Ⅰ旋转主动齿轮(1-3)绕钳Ⅰ旋转电机(1-16)的电机轴旋转,钳Ⅰ旋转被动齿轮(1-14)、钳Ⅰ夹紧被动齿轮(1-5)和钳Ⅰ锥形夹头(1-4)均安装在钳Ⅰ旋转主轴(1-19)上,钳Ⅰ旋转主轴(1-19)为空心轴,其中钳Ⅰ旋转被动齿轮(1-14)安装在钳Ⅰ支架(1-15)内部,与钳Ⅰ旋转主动齿轮(1-3)相啮合,形成一对啮合齿轮,钳Ⅰ夹紧被动齿轮(1-5)和钳Ⅰ锥形夹头(1-4)安装在钳Ⅰ支架(1-15)外部,送丝入口(1-21)位于钳Ⅰ旋转主轴(1-18)的左侧,正畸弓丝(5)通过送丝入口(1-21)穿过钳Ⅰ旋转主轴(1-19)的内部,可以将待弯制的正畸弓丝(5)送至位于钳Ⅰ旋转主轴(1-19)末端的钳Ⅰ锥形夹头(1-4),完成机器人的送丝,其中钳Ⅰ锥形夹头(1-4)由夹头外壳(1-4-1)、夹头夹芯(1-4-2)、夹头主轴(1-4-3)组成,夹头外壳(1-4-1)通过螺纹与夹头主轴(1-4-3)相连接,夹头夹芯(1-4-2)位于旋转夹头外壳(1-4-1)和夹头主轴(1-4-3)的中间,当顺时针旋转夹头外壳(1-4-1)时,夹头外壳(1-4-1)与夹头主轴(1-4-3)之间的空间缩小,此时夹头夹芯(1-4-2)受到夹头外壳(1-4-1)的挤压,使得夹头夹芯(1-4-2)保持夹紧状态,以实现对正畸弓丝(5)的夹紧,反之,逆时针旋转夹头夹芯(1-4-2)实现了对正畸弓丝(5)的松开;钳Ⅰ夹紧被动齿轮(1-5)与钳Ⅰ夹紧主动齿轮(1-6)相啮合,形成一对啮合齿轮,钳Ⅰ夹紧电机(1-13)通过螺纹连接安装在钳Ⅰ支架(1-15)的上顶面,钳Ⅰ夹紧电机(1-13)的主轴与钳Ⅰ夹紧主轴(1-20)相连接,以驱动钳Ⅰ夹紧主轴(1-20)绕轴向旋转,拨叉(1-9)、滑动挡圈(1-12)、弹簧(1-8)、挡圈(1-7)和钳Ⅰ夹紧主动齿轮(1-6)通过轴孔装配从左至右依次的被安装在钳Ⅰ夹紧主轴(1-20)上,拨叉(1-9)通过螺栓与滑动挡圈(1-12)相连接,弹簧(1-8)被镶嵌在滑动挡圈(1-12)和挡圈(1-7)中,挡圈(1-7)通过螺栓与钳Ⅰ夹紧主动齿轮(1-6)相连接,钳Ⅰ夹紧主轴(1-20)远离电机主轴方向的末端设有轴肩,用于限定钳Ⅰ夹紧主轴(1-20)上已装配零件的位置,推杆(1-10)末端安装有钳Ⅰ直线电机推杆(1-11),推杆(1-10)与推杆(1-10)垂直下方的拨叉(1-9)相连接,钳Ⅰ直线电机推杆(1-11)安置在钳Ⅰ夹紧电机(1-13)上,当钳Ⅰ直线电机推杆(1-11)推动或拉回推杆(1-10)时,与推杆(1-10)相连接的拨叉(1-9)可带动滑动挡圈(1-12)、弹簧(1-8)、挡圈(1-7)和钳Ⅰ夹紧主动齿轮(1-6)沿钳Ⅰ夹紧主轴(1-20)轴向左右移动,进而控制钳Ⅰ夹紧主动齿轮(1-6)与钳Ⅰ夹紧被动齿轮(1-5)的啮合情况,另外,钳Ⅰ夹紧电机(1-13)可驱动钳Ⅰ夹紧被动齿轮(1-5)绕钳Ⅰ夹紧主轴(1-20)旋转,从而控制与钳Ⅰ夹紧被动齿轮(1-5)相连的钳Ⅰ锥形夹头(1-4)的顺时旋转或逆时旋转,最终实现了对正畸弓丝(5)的夹紧与松开;所述的钳Ⅱ(2)属于直角坐标式,它包括:钳Ⅱ可动钳口(2-1)、可动楔形滑块(2-1-1)、钳Ⅱ固定钳口(2-2)、夹紧滑块(2-3)、夹紧楔形滑块(2-3-1)、钳Ⅱ直线电机推杆(2-4)、直线电机(2-5)、钳Ⅱ旋转被动齿轮(2-6)、钳Ⅱ外壳(2-7)、钳Ⅱ丝杠(2-8)、钳Ⅱ丝杠电机(2-9)、钳Ⅱ丝杠螺母(2-10)、钳Ⅱ旋转主动齿轮(2-11)、钳Ⅱ旋转电机(2-12)、复位弹簧(2-13),以钳Ⅱ可动钳口(2-1)垂直向下为参考方向,钳Ⅱ丝杠电机(2-9)安装在钳Ⅱ外壳(2-7)的顶部,以驱动钳Ⅱ丝杠(2-8),其中钳Ⅱ丝杠(2-8)与钳Ⅱ丝杠螺母(2-10)通过螺纹连接配合,通过钳Ⅱ丝杠电机(2-9)驱动钳Ⅱ丝杠(2-8)可以实现钳Ⅱ丝杠螺母(2-10)沿钳Ⅱ丝杠(2-8)轴线方向上下移动;直线电机(2-5)、钳Ⅱ旋转被动齿轮(2-6)、钳Ⅱ旋转主动齿轮(2-11)以及钳Ⅱ旋转电机(2-12)均安装在钳Ⅱ丝杠螺母(2-10)内,其中钳Ⅱ旋转电机(2-12)与钳Ⅱ旋转主动齿轮(2-11)通过轴孔配合相连接,钳Ⅱ旋转主动齿轮(2-11)与钳Ⅱ旋转被动齿轮(2-6)相啮合,形成一对啮合齿轮,以实现钳Ⅱ旋转被动齿轮(2-6)的旋转,另外,直线电机(2-5)通过轴孔配合被安装在钳Ⅱ旋转被动齿轮(2-6)中,钳Ⅱ直线电机推杆(2-4)安装在直线电机(2-5)中,在直线电机(2-5)和钳Ⅱ旋转被动齿轮(2-6)的作用下,钳Ⅱ直线电机推杆(2-4)既可实现绕钳Ⅱ旋转被动齿轮(2-6)的轴线进行旋转,又可沿钳Ⅱ旋转被动齿轮(2-6)的轴线进行平移;夹紧滑块(2-3)通过螺栓连接固定在钳Ⅱ直线电机推杆(2-4)上,夹紧滑块(2-3)上装有夹紧楔形滑块(2-3-1),而钳Ⅱ可动钳口(2-1)上装有可动楔形滑块(2-1-1),当钳Ⅱ直线电机推杆(2-4)被直线电机(2-5)推出时,夹紧楔形滑块(2-3-1)与可动楔形滑块(2-1-1)发生挤压,推动钳Ⅱ可动钳口(2-1)向钳Ⅱ固定钳口(2-2)方向移动,实现了钳Ⅱ(2)对正畸弓丝(5)的夹紧,当钳Ⅱ直线电机推杆(2-4)被直线电机(2-5)拉回时,夹紧楔形滑块(2-3-1)与可动楔形滑块(2-1-1)发生分离,复位弹簧(2-13)将钳Ⅱ可动钳口(2-1)推离钳Ⅱ固定钳口(2-2),实现了钳Ⅱ(2)对正畸弓丝(5)的松开。
2.根据权利要求1所述的一种正畸弓丝弯制机器人,其特征在于:所述的柱坐标系转台(3)包括:转台电机(3-1)、转台主动齿轮(3-2)、转台(3-3)、转台被动齿轮(3-4),转台电机(3-1)通过轴孔装配与转台主动齿轮(3-2)相连接,以驱动转台主动齿轮(3-2)绕转台电机(3-1)的电机轴旋转,转台主动齿轮(3-2)与转台被动齿轮(3-4)相啮合,形成一对啮合齿轮,转台(3-3)与转台被动齿轮(3-4)通过螺栓连接相互固定,以实现转台被动齿轮(3-4)带动转台(3-3)绕转台(3-3)中心旋转;所述的机器人主体外壳(4)包括:底座(4-1)、环形拉门(4-2)、环形外壳(4-3)、主体支撑(4-4)、外壳支柱(4-5)、连接底盘(4-6)、外壳顶部(4-7),连接底盘(4-6)通过螺栓连接安装在机器人主体外壳(4)的内部,外壳顶部(4-7)通过螺栓连接安装在机器人主体外壳(4)的外部,通过环形拉门(4-2)可实现机器人主体外壳(4)的开合,以保护操作人员和柱坐标与直角坐标组合式正畸弓丝弯制机器人;主体支撑(4-4)和外壳支柱(4-5)用于支撑机器人主体外壳(4)。
3.一种利用机器人弯制带圈泪滴曲的弯制规划方法,其特征在于:本方法应用于一种正畸弓丝弯制机器人。
4.一种利用机器人弯制带圈泪滴曲的弯制规划方法,其特征在于:所述方法的具体实现过程为:
步骤一、带圈泪滴曲参数化:
在带圈泪滴曲弯制过程中,以第i-1、i、i+1个弯制点构建弯制第i+1个弯制点的正畸弓丝三维姿态的极坐标系Oi-ρiθiZi,以初始弯制点i=0时为原点O,以第i个弯制点到第i+1个弯制点的直线方向θ=0的位置,以第i-1、i、i+1个弯制点为确定弯制平面为极坐标系Oi-ρiθ所在的平面;
正畸弓丝的第二序列曲的形状都是由离散的几何单元自由排列组合形成的,这些几何单元包括直线段、圆弧段、圆形螺旋线段和矩形螺旋线段等,其表达式分别为L、M、N、P,那么正畸弓丝的带圈泪滴曲的数字化模型表示为f=f{L1,L2,N1,L3,L4},式中f表示第二序列曲,L1,L2,L3和L4表示直线段,N1表示圆形螺旋线段,五个几何单元首尾顺次连接组成带圈序列曲的形状,其中直线段L1可由坐标(ρ0,θ0,z0)和(ρ1,θ1,z1),直线段L2可由坐标(ρ1,θ1,z1)和(ρ2,θ2,z2)表示,N1由坐标(ρ2,θ2,z2)和(ρ3,θ3,z3)为起点和终点的螺旋线,L3可由坐标(ρ3,θ3,z3)和(ρ4,θ4,z4)表示,L4可由坐标(ρ4,θ4,z4)和(ρ5,θ5,z5)表示,因此,直线段Li的长度用两个端点坐标可表示为Li=(ρi+1-ρi,θi+1-θi,zi+1-zi),圆弧段的表达是利用微分的原理将连续的圆弧曲线转化成离散的有限若干点的形式,由此得出在第i+1个弯制点处的弯丝运动轨迹特征模型的坐标矩阵[Fi+1],如式1所示:
式中,Mi+1为将弓丝圆弧段以t=n·Δt(0<t<θi+1)分成n个点(t表示局部圆弧段,Δt表示圆弧上被划分的每个小圆弧段),n个点的坐标矩阵为[Mi+1];
步骤二、计算弯丝运动模型,并确定弯制规划策略:
根据手工弯制带圈泪滴曲的运动轨迹特征,建立弯丝单元运动模型PointAi=[ρi,θi,zi],在正畸弓丝弯制点极坐标系Oi-ρiθiZi下,PointAi表示弯制点Ai的坐标;
在第i个弯制点机器人弯丝运动单元参数模型,如式2所示:
式中BendΔAi的含义为:在第i个弯制点的弯制运动,机器人各个自由度的移动距离或转动的角度,以及实现弯制动作所旋转的角度;1Openi,1Closei表示钳Ⅰ在第i个弯制点的开合或夹紧状态,2Openi,2Closei表示第i个弯制点钳Ⅱ的开合或夹紧状态;βi表示弯制点弯折运动钳Ⅰ弯折旋转角度和位置调整时钳Ⅱ沿Z轴方向旋转的角度βi=2θi+1,为了区分钳Ⅰ和钳Ⅱ,Δ1βi表示钳Ⅰ的折弯旋转角度Δ1βi+1=90+θi+1+g(90+θi+1),g(90+θi+1)表示弯制角度为90+θi+1时的回弹角度值,g(90+θi+1)可由经验值获得,Δ2βi表示钳Ⅱ沿Z轴方向旋转的角度,其中Δ2βi+1=Δ1βi;ri表示弯制点处钳Ⅱ的曲率半径Δ1Li分别表示钳Ⅰ沿Z轴方向移动的距离,式中h是钳Ⅱ沿Z轴方向移动的成常量值,r0和h0分别表示正畸钳头圆锥体的最大底面半径和高,Δ2Li表示钳Ⅱ沿Z轴方向移动的距离Δ2Li+1=h;
步骤三、定义初始弯制点信息i=0:
根据弯丝单元运动模型PointAi=[ρi,θi,zi],将i=0时定义为初始化弯制点PointA0,另外,由于弯制带圈泪滴曲的特点,具有6个弯制点,因此设定i的范围为0≤i≤5;
步骤四、判断折弯旋转角度是否大于270°:
在对带圈泪滴曲进行弯制规划时,设定的规划弯折旋转角度为540°;但在弯折旋转角度大于270°时,便会发生干涉,无法弯制至540°,因此需要判断折弯旋转角度是否为大于270°;
若Δ1βi≥270°,执行基于折弯角度的规划策略,表达式为Benduniti a=[[Fi+1],Δ1βi≥270°],正畸弯丝机器人弯丝规划策略为:
1)钳Ⅱ松开对弯制点PointAi的夹紧,释放弓丝回弹角度g(270°)(回弹角度由经验公式可得),得到弯制点PointAi的成形角度270°-g(270°),进而使钳Ⅱ绕Z轴旋转270°到达新增加的夹紧弯制点PointAi';
2)得到新增加的弯制点PointAi'的弯折角度为Δ1βi-270°+g(270°);
3)得到基于折弯角度的BendaΔAi,如式3所示:
若Δ1βi<270°,则进入步骤五;
步骤五、判断H≥c(式中H为正畸弓丝未成形部分法线方向上的距离,c代表末端执行器的钳嘴结构尺寸):
若H≥c,执行基于折弯距离的规划策略,表达式为:Benduniti b=[[Fi+1],2Close],正畸弯丝机器人弯丝规划策略为:
1)在当前弯制点PointAi和下一个弯制点PointAi+1和之间选择一个点PointAi”,把PointAi”作为一个临时增加弯制点进行位置调整规划,得到位置调整过程中钳Ⅰ移动的距离为Δ1Li',在规划过程中时钳Ⅱ保持夹紧状态,使得末端执行器与弓丝之间保留一个0.5mm-1mm的微小间隙,进而可以使弓丝与末端执行器发生相对位置移动;
2)松开钳Ⅱ直至到达保留与弓丝的微小间隙,继续使钳Ⅱ沿Z轴方向移动Δ2Li,离开弯制点PointAi”的位置;
3)继续松开钳Ⅱ,使钳Ⅱ沿Z轴方向移动Δ2Li',回到当前弯制点PointAi的位置,随后钳Ⅱ夹紧,即实现两层弓丝的夹紧;
4)得到基于折弯距离的BendbΔAi,如式4所示:
若H<c,则进入步骤六;
步骤六、检测钳型是否发生干涉:
若发生干涉,返回步骤四;
若不发生干涉,进行步骤七;
步骤七、获得机器人弯制信息RobotΔAi:
记录当前弯制点PointAi的机器人弯丝运动单元参数模型BendΔAi、BendaΔAi或BendbΔAi,得到当前弯制点PointAi机器人弯丝运动单元模型信息集如式5所示:
RobotΔAi=(BendΔA0,BendΔA1,...,BendΔAi,BendaΔAi,...,BendbΔAi) (5)
步骤八、进行PointAi+1弯制点的弯制:
将弯制点PointAi中的i值加1,得到下一个弯制点PointAi+1,根据带圈泪滴曲的弯制特点,以及步骤三中所设定i的范围为0≤i≤5,各个带圈泪滴曲的弯制点PointAi依次进入上述的机器人弯制规划方法,因此可以依次得到弯制点PointA0至PointA5的机器人弯制信息RobotΔAi(0≤i≤5),而当i>5时,则进行步骤九;
步骤九、收集机器人弯制信息集Robot{Ai}:
收集弯制点PointA0至PointA5的机器人弯制信息RobotΔAi(0≤i≤5),得到机器人弯制信息集Robot{Ai},如式6所示,Robot{Ai}为带圈泪滴曲的弯制规划信息集:
Robot{Ai}={RobotΔA0,RobotΔA1,...,RobotΔA5} (6)。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810624704.4A CN108746415A (zh) | 2018-06-16 | 2018-06-16 | 一种利用机器人弯制带圈泪滴曲的弯制规划方法 |
CN201910354119.1A CN109894545B (zh) | 2018-06-16 | 2019-04-29 | 一种利用机器人弯制带圈泪滴曲的弯制规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810624704.4A CN108746415A (zh) | 2018-06-16 | 2018-06-16 | 一种利用机器人弯制带圈泪滴曲的弯制规划方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN108746415A true CN108746415A (zh) | 2018-11-06 |
Family
ID=63978330
Family Applications (2)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810624704.4A Withdrawn CN108746415A (zh) | 2018-06-16 | 2018-06-16 | 一种利用机器人弯制带圈泪滴曲的弯制规划方法 |
CN201910354119.1A Active CN109894545B (zh) | 2018-06-16 | 2019-04-29 | 一种利用机器人弯制带圈泪滴曲的弯制规划方法 |
Family Applications After (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910354119.1A Active CN109894545B (zh) | 2018-06-16 | 2019-04-29 | 一种利用机器人弯制带圈泪滴曲的弯制规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (2) | CN108746415A (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111588504A (zh) * | 2020-06-01 | 2020-08-28 | 哈尔滨理工大学 | 一种用于正畸弓丝弯制顺序规划的空间变半径球域划分方法 |
CN111588503A (zh) * | 2020-06-01 | 2020-08-28 | 哈尔滨理工大学 | 一种基于弯制点密度的正畸弓丝变半径圆域划分方法 |
CN112906147A (zh) * | 2021-01-18 | 2021-06-04 | 北京安怀信科技股份有限公司 | 基于钣金多次折弯的地面干涉识别方法 |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108670453A (zh) * | 2018-06-16 | 2018-10-19 | 哈尔滨理工大学 | 一种柱坐标与直角坐标组合式弓丝弯制机器人及使用方法 |
CN111588498B (zh) * | 2020-06-01 | 2021-05-18 | 哈尔滨理工大学 | 一种基于正畸弓丝弯制点密度的等角度划分角度确定方法 |
CN111588502B (zh) * | 2020-06-01 | 2021-05-18 | 哈尔滨理工大学 | 一种基于弯制点角距比和的正畸弓丝变半径圆域划分方法 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0565440U (ja) * | 1992-02-03 | 1993-08-31 | 安川商事株式会社 | ワイヤベンディング装置 |
CN103892929B (zh) * | 2014-03-27 | 2016-08-24 | 哈尔滨理工大学 | 口腔正畸弓丝弯制机器人 |
CN203898469U (zh) * | 2014-03-27 | 2014-10-29 | 哈尔滨理工大学 | 口腔正畸弓丝弯制机器人 |
CN105415386A (zh) * | 2016-01-13 | 2016-03-23 | 哈尔滨理工大学 | 一种正畸弓丝弯制机器人的弯制手爪 |
CN106803276B (zh) * | 2017-01-16 | 2020-02-11 | 哈尔滨理工大学 | 一种个性化正畸弓丝曲线交互调整方法 |
CN107538493B (zh) * | 2017-10-20 | 2021-05-07 | 湘潭大学 | 一种避免线缆干涉约束的工业机器人轨迹规划方法 |
-
2018
- 2018-06-16 CN CN201810624704.4A patent/CN108746415A/zh not_active Withdrawn
-
2019
- 2019-04-29 CN CN201910354119.1A patent/CN109894545B/zh active Active
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111588504A (zh) * | 2020-06-01 | 2020-08-28 | 哈尔滨理工大学 | 一种用于正畸弓丝弯制顺序规划的空间变半径球域划分方法 |
CN111588503A (zh) * | 2020-06-01 | 2020-08-28 | 哈尔滨理工大学 | 一种基于弯制点密度的正畸弓丝变半径圆域划分方法 |
CN111588503B (zh) * | 2020-06-01 | 2021-05-28 | 哈尔滨理工大学 | 一种基于弯制点密度的正畸弓丝变半径圆域划分方法 |
CN112906147A (zh) * | 2021-01-18 | 2021-06-04 | 北京安怀信科技股份有限公司 | 基于钣金多次折弯的地面干涉识别方法 |
CN112906147B (zh) * | 2021-01-18 | 2021-09-28 | 北京安怀信科技股份有限公司 | 基于钣金多次折弯的地面干涉识别方法 |
Also Published As
Publication number | Publication date |
---|---|
CN109894545A (zh) | 2019-06-18 |
CN109894545B (zh) | 2020-05-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108746415A (zh) | 一种利用机器人弯制带圈泪滴曲的弯制规划方法 | |
CN108742893A (zh) | 一种弓丝弯制机器人及弯制弓丝运动模型建立方法 | |
CN110090081A (zh) | 一种基于手工弯制的弓丝弯制机器人及其弯制规划方法 | |
CN100411766C (zh) | 管路件加工装置 | |
CN110051445A (zh) | 一种正畸弓丝弯制机器人及弯丝运动映射模型建立方法 | |
CN106531433B (zh) | 一种带六轴下料机构的六轴飞叉式骨架型线圈绕线机 | |
CN106531431B (zh) | 一种带线圈骨架传送机构的六轴飞叉式绕线机 | |
CN104999188A (zh) | 大型罐体机器人自动化焊接工作站及利用该装置焊接的方法 | |
CN109893264A (zh) | 一种柱坐标与直角坐标组合式弓丝弯制机器人及使用方法 | |
EP2705919A2 (de) | Verfahren zur Bearbeitung von Werkstücken zur Herstellung von Verzahnungen durch Verzahnfräsen oder Verzahnstoßen | |
CN106624090B (zh) | 双v型管体坡口加工机床及加工工艺方法 | |
CN206286817U (zh) | 车铣一体数控立式加工中心 | |
CN108994393A (zh) | 用于对工件进行倒角的装置、方法、铣齿加工中心和应用 | |
CN107671150A (zh) | 一种自动化送料弯曲的机器及方法 | |
CN207508809U (zh) | 一种全自动数控铣床机械手 | |
CN111659780A (zh) | 一种机器人弯管加工方法及弯管加工装置 | |
CN107931740A (zh) | 数控旋分刮齿机 | |
CN107521275A (zh) | 一种抽芯式管材压花方法及设备 | |
CN108788577A (zh) | 一种大型罐体机器人自动化焊接工作站 | |
CN106270809A (zh) | 一种弧齿锥齿轮机床数控系统及控制方法 | |
JP2001212624A (ja) | 曲げ加工装置 | |
CN113547004B (zh) | 一种多轴弯管系统及其操作方法和加工方法 | |
CN206259250U (zh) | 一种带线圈骨架传送机构的六轴飞叉式绕线机 | |
CN207086672U (zh) | 一种激光辅助渐进成形一体化通用装夹装置 | |
CN109549699A (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 | ||
WW01 | Invention patent application withdrawn after publication | ||
WW01 | Invention patent application withdrawn after publication |
Application publication date: 20181106 |