CN204450538U - 三轴混合驱动式机械臂 - Google Patents
三轴混合驱动式机械臂 Download PDFInfo
- Publication number
- CN204450538U CN204450538U CN201520046536.7U CN201520046536U CN204450538U CN 204450538 U CN204450538 U CN 204450538U CN 201520046536 U CN201520046536 U CN 201520046536U CN 204450538 U CN204450538 U CN 204450538U
- Authority
- CN
- China
- Prior art keywords
- connecting rod
- postbrachium
- solenoid
- forearm
- hinged
- 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 - After Issue
Links
- 210000000245 forearm Anatomy 0.000 claims abstract description 80
- 230000007246 mechanism Effects 0.000 claims abstract description 48
- 238000005259 measurement Methods 0.000 claims abstract description 25
- 230000033001 locomotion Effects 0.000 description 17
- 230000002153 concerted effect Effects 0.000 description 7
- 238000010586 diagram Methods 0.000 description 4
- 238000000034 method Methods 0.000 description 4
- 230000009471 action Effects 0.000 description 3
- 230000005540 biological transmission Effects 0.000 description 3
- 230000008569 process Effects 0.000 description 3
- 230000000694 effects Effects 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000003993 interaction Effects 0.000 description 2
- 230000001154 acute effect Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 239000012636 effector Substances 0.000 description 1
- 230000004907 flux Effects 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 230000016507 interphase Effects 0.000 description 1
- 230000003252 repetitive effect Effects 0.000 description 1
- 230000011664 signaling Effects 0.000 description 1
Landscapes
- Manipulator (AREA)
- Toys (AREA)
Abstract
三轴混合驱动式机械臂,包括底座、支座、后臂、前臂、手掌,所述的手掌通过两个平行四边形机构构成的第一连杆机构连接支座,装在前臂连杆上的第一红外测距仪对准装在后臂连杆上的第二红外测距仪;所述的前臂和后臂内装有驱动前臂与后臂相对开合的电磁线圈驱动机构,所述的电磁线圈驱动机构包括第二连杆机构和电磁线圈;所述的支座内装有用于驱动支座绕底座旋转和后臂绕支座转动的蜗轮蜗杆式直流伺服电机;所述的支座和后臂上都装有位置传感器;所述的位置传感器、第一红外测距仪、第二红外测距仪的输出端都连接控制器的输入端,所述的蜗轮蜗杆式直流伺服电机、第一电磁线圈、第二电磁线圈的控制端都连接控制器的输出端。
Description
技术领域
本实用新型涉及一种三轴混合驱动式机械臂,应用于码垛、搬运等场合。
背景技术
随着物流等行业的快速发展,简单重复性工作的劳动成本逐渐升高,用于替代人工搬运的机构被不断设计并应用于工作场所,如码垛机器人等。码垛机器人的设计方案较多,但多采用电机驱动式并通过多种机械结构实现码垛任务,机构复杂、动作笨拙、传动效率低。
发明内容
本实用新型要克服现有技术的上述缺点,提供一种机构简单、动作灵巧、传动效率高的三轴混合驱动式机械臂。
三轴混合驱动式机械臂,包括底座1、支座2、后臂3、前臂4、手掌5,其特征在于:所述的支座2绕垂直向上的第一轴铰接在所述的底座1上,所述的后臂3的下端绕水平的第二轴8铰接在所述的支座2上,所述的前臂4的上端绕第三轴9铰接在后臂3上,所述的前臂4的下端绕第四轴10与手掌5铰接,所述的第二轴8、第三轴9、第四轴10相互平行;
所述的手掌5连接第一连杆机构,所述的第一连杆机构6包括中部铰接在第三轴9上的第一中间连杆60、在前臂4内延伸的前臂连杆61、在后臂3内延伸的后臂连杆62;所述的后臂连杆62的上端铰接在所述的第一中间连杆60的右侧端部,所述的后臂连杆62的下端 铰接在所述的支座2上;所述的前臂连杆61的上端铰接在所述的第一中间连杆60的左侧端部,所述的前臂连杆61的下端铰接在所述的手掌5上;所述的手掌5、前臂连杆61、第一中间连杆60、前臂4形成平行四边形机构,所述的后臂3、后臂连杆62、第一中间连杆60、支座2形成另一个平行四边形机构;
装在前臂连杆61上的第一红外测距仪63对准装在后臂连杆62上的第二红外测距仪64;
所述的前臂4和后臂3内装有驱动前臂4与后臂3相对开合的电磁线圈驱动机构,所述的电磁线圈驱动机构包括第二连杆机构7和电磁线圈;
所述的第二连杆机构7包括:中部铰接在第三轴9上的第二中间连杆70、在前臂4内延伸的相互平行的第一内杆72和第一外杆71、在后臂3内延伸的相互平行的第二内杆74和第二外杆73;第一内杆72和第一外杆71的上端分别铰接在第二中间连杆70的左侧,第二内杆74和第二外杆73的上端分别铰接在第二中间连杆70的右侧;第一电磁线圈75分别与所述的第一内杆72和第一外杆71铰接,第二电磁线圈76分别与所述的第二内杆74和第二外杆73铰接,第一电磁线圈75与第二电磁线圈76位于同一直线上,形成电磁线圈组;所述的第一内杆72和第一外杆71、第二中间连杆70、第一电磁线圈75形成平行四边形机构,所述的第二内杆74和第二外杆73、第二中间连杆70、第二电磁线圈76形成平行四边形机构;
所述的支座2内装有用于驱动支座2绕底座1旋转和后臂3绕支 座2转动的蜗轮蜗杆式直流伺服电机;
所述的支座2和后臂3上都装有位置传感器;
所述的位置传感器、第一红外测距仪63、第二红外测距仪64的输出端都连接控制器的输入端,所述的蜗轮蜗杆式直流伺服电机、第一电磁线圈75、第二电磁线圈76的控制端都连接控制器的输出端。
所述的电磁线圈组有二个以上,各电磁线圈组位于所述的第二连杆机构7的不同高度上。
本实用新型采用直流伺服电机驱动与电磁线圈驱动的混合式驱动,相比其他的设计方案,本实用新型的优点是:体积小、结构简单、操作方便、动作灵巧,减少空间所占体积且可控性好,传动效率高。
本实用新型的优点是:动作控制精确、前臂和手掌运动平稳、结构简单、体积小。
附图说明
图1是本实用新型的结构示意图
图2是第一连杆机构的示意图,虚线显示了平行四边形机构。
图3是电磁线圈驱动机构的示意图
图4是控制器的控制框图
图5是电磁线圈的位置计算的原理示意图
具体实施方式
下面参照附图1‐5进一步说明本实用新型:
本实用新型所述的三轴混合驱动式机械臂,包括底座1、支座2、 后臂3、前臂4、手掌5,其特征在于:所述的支座2绕垂直向上的第一轴铰接在所述的底座1上,所述的后臂3的下端绕水平的第二轴8铰接在所述的支座2上,所述的前臂4的上端绕第三轴9铰接在后臂3上,所述的前臂4的下端绕第四轴10与手掌5铰接,所述的第二轴8、第三轴9、第四轴10相互平行;
所述的手掌5连接第一连杆机构,所述的第一连杆机构6包括中部铰接在第三轴9上的第一中间连杆60、在前臂4内延伸的前臂连杆61、在后臂3内延伸的后臂连杆62;所述的后臂连杆62的上端铰接在所述的第一中间连杆60的右侧端部,所述的后臂连杆62的下端铰接在所述的支座2上;所述的前臂连杆61的上端铰接在所述的第一中间连杆60的左侧端部,所述的前臂连杆61的下端铰接在所述的手掌5上;所述的手掌5、前臂连杆61、第一中间连杆60、前臂4形成平行四边形机构,所述的后臂3、后臂连杆62、第一中间连杆60、支座2形成另一个平行四边形机构;
装在前臂连杆61上的第一红外测距仪63对准装在后臂连杆62上的第二红外测距仪64;
所述的前臂4和后臂3内装有驱动前臂4与后臂3相对开合的电磁线圈驱动机构,所述的电磁线圈驱动机构包括第二连杆机构7和电磁线圈;
所述的第二连杆机构7包括:中部铰接在第三轴9上的第二中间连杆70、在前臂4内延伸的相互平行的第一内杆72和第一外杆71、在后臂3内延伸的相互平行的第二内杆74和第二外杆73;第一内杆 72和第一外杆71的上端分别铰接在第二中间连杆70的左侧,第二内杆74和第二外杆73的上端分别铰接在第二中间连杆70的右侧;第一电磁线圈75分别与所述的第一内杆72和第一外杆71铰接,第二电磁线圈76分别与所述的第二内杆74和第二外杆73铰接,第一电磁线圈75与第二电磁线圈76位于同一直线上,形成电磁线圈组;所述的第一内杆72和第一外杆71、第二中间连杆70、第一电磁线圈75形成平行四边形机构,所述的第二内杆74和第二外杆73、第二中间连杆70、第二电磁线圈76形成平行四边形机构;
所述的支座2内装有用于驱动支座2绕底座1旋转和后臂3绕支座2转动的蜗轮蜗杆式直流伺服电机;
所述的支座2和后臂3上都装有位置传感器;
所述的位置传感器、第一红外测距仪63、第二红外测距仪64的输出端都连接控制器的输入端,所述的蜗轮蜗杆式直流伺服电机、第一电磁线圈75、第二电磁线圈76的控制端都连接控制器的输出端。
所述的电磁线圈组有二个以上,各电磁线圈组位于所述的第二连杆机构7的不同高度上。
本实用新型主要包括底座1、支座2、后臂3、前臂4和手掌5等部分,如图1所示。
支座1装在底座2上,在蜗轮蜗杆式直流伺服电机的驱动下,绕底座1做圆周运动,其转动角度记为θ1,实现机械臂的圆周转动;后臂3装在支座2上,在直流伺服电机的驱动下,绕轴转动,其转动角度记为θ2,实现后臂3的前后摆动;前臂4装在后臂3上,由电磁线 圈产生的磁场力控制,绕轴转动,其转动角度记为θ3,实现前臂4的摆动;手掌5装在前臂4上,通过前臂连杆61、第一中间连杆60和后臂连杆组62构成的平行四边形机构,如图2所示,始终保持与底座平行,以便满足工作需要;手掌5上装有末端执行器,用于完成特定的任务。
机械臂的前臂3由电磁线圈产生的磁场力控制,其结构如图3所示。
图3中后臂3和前臂4上装有3组电磁线圈、第一红外测距仪63、第二红外测距仪64、第二外杆73、第二内杆74、第二中间连杆70和第一外杆71、第一内杆72等机构。多组电磁线圈成对分布,用于产生磁场力,三组电磁线圈在第二连杆机构7的作用下随前后臂的转动而不断调整位置。
第二中间连杆70的转动角度α由后臂3转动角度θ2和前臂4的转动角度θ3决定,其对应关系为α=θ3-θ2,如此在前臂4和后臂3的转动过程中,第二中间连杆70不断调整转动角度,并带动第二外杆73、第二内杆74和第一外杆71、第一内杆72不断调整转动角度,从而保证电磁线圈组始终处于同一直线上,进而能够以最佳角度驱动前臂4的转动,电磁线圈中的电流大小由控制***根据负载质量、手掌5和前臂4质量、前臂4转动角度等参数信息给定;两组红外测距仪用于检测后臂3与前臂4间的距离,并根据平面三角形的边角关系求得后臂3和前臂4间的实际角度,控制***根据实际角度与期望角度之间的关系给定电磁线圈相应的控制电流。
机械臂的控制***主要包括工控机、运动控制卡、驱动器、直流伺服电机、电磁线圈和红外测量仪等部分,控制***框图如图4所示。
运动控制卡接受来自工控机的指令,并将其转变为运动指令送给驱动器,同时工控机能够实时显示机械臂的位置信号。驱动器将运动指令转变为电流信号控制直流伺服电机和电磁线圈,实现电机的转动和磁力的产生,磁力的大小通过电流的大小进行控制。支座2和后臂3的转动角度通过位置传感器进行检测并传送给运动控制卡,前臂相对后臂的转动角度通过红外测距仪进行检测,检测到的结果传回运动控制卡并计算求解。
电磁线圈的控制过程参照图5进行说明。
图5中,B点和C点为两组红外测距仪,A点为后臂3和前臂4之间的转轴,AB与AC等距离,故三点构成等腰三角形,后臂3和前臂4间的实际角度为θ。取两组红外测距仪所测值的平均值为BC的长度,则实际转角θ可通过平面三角形的边角关系求得:θ=cos-1((AB2+AC2-BC2)/(2AB·AC))。
本实用新型中设计到m(m≥1)组电磁线圈对,后臂3和前臂4在转动的过程中,每组电磁线圈始终保持在一条直线上,根据图4可知每组电磁线圈间距离为:
其中MM、MMi、NNi、MiEi、NiFi为已知长度,故每组电磁线圈间距离与实际转角θ间存在一定的关系。为避免电磁线圈组间磁场的相互干扰,相邻两组电磁线圈间需保持一定的距离。电线线圈通电后MiEi 线圈和NiFi线圈同时产生磁场,且两磁场间相互作用,根据实际需要通过改变电流方向产生吸引力或排斥力。
磁场强度B=μnI,其中μ为真空中的磁导率,n为线圈匝数,I为电流。可见磁场强度与线圈电流大小成正比,故可通过调整电流大小控制磁场强弱,进而控制磁场间的相互作用力。m组电磁线圈产生的合力为电磁线圈产生的合力用来驱动前臂转动。前臂的转动采用机械限位。
本实用新型的工作过程是:
工作开始时,根据给定的末端运动轨迹,通过机械臂的反解计算求得各驱动轴的转动角度,将求得的转动角度作为指令下发给控制***,这部分由工控机和运动控制卡完成。第一轴和第二轴的控制由电机完成,运动控制卡将转动角度信号下发给驱动器,由驱动器产生运动指令控制直流伺服电机的转动,实现支座和后臂的转动。第三轴由电磁线圈控制,运动控制卡根据负载质量、手掌和前臂质量、转动角度等信息,计算需要给各组线圈施加的电流大小,并下发给驱动器,完成各组电磁线圈的磁场控制。
m组线圈产生的磁场合力与负载、手掌与前臂的重力和G合相平衡,红外测距仪用于检测前臂与后臂间的距离,并实时计算前臂与后臂间的转动角度。通过电磁线圈产生磁场力来控制前臂的转动需要一个过程,具体如下:
1)当实际角度未达到给定角度值时,磁场合力F总要大于G合,此时前臂处于加速运动状态;
2)当实际角度快接近给定角度值时,磁场合力F总逐渐减小,并接近G合,此时前臂处于减速运动状态;
3)当实际角度等于腰给定角度时,磁场合力F总等于G合,此时前臂处于平衡状态;
4)当实际角度大于给定角度时,磁场合力F总变方向,改变前臂的运动方向,此时前臂处于减速状态。
本实用新型的创新之处是:
1)采用直流伺服电机驱动和电磁线圈驱动的混合驱动方式,前两轴由直流伺服电机驱动,能够实现支座和后臂的精确控制,第三轴采用电磁线圈控制,电磁线圈驱动避免了空间复杂机构的存在,减少了机械臂所占的空间体积;
2)电磁线圈驱动部分,多组电线线圈在第二中间连杆70、第一外杆71、第一内杆72、第二外杆73、第二内杆74的作用下随前后臂的转动而不断调整位置,始终保持在同一条直线上,如此便可以最佳角度、最大磁场力驱动前臂的转动;
3)多组电磁线圈同时存在,避免了磁场力不足的情况;
4)装有两组红外测距仪,用于实时检测前后臂之间的距离,计算时取两组所测数据的平均值,通过平面三角形的边角关系可求得后臂和前臂之间的实际角度;
5)红外测距仪的存在不仅可以实时检测后臂和前臂间的实际角度,还可以为控制***提供角度信号,避免转动角度不够或过大的现象;
6)当实际转角为锐角时,远离连杆MM的电磁线圈产生的磁场强度最强,提供所需要的大部分磁场力,此时靠近连杆MM的电磁线圈产生微弱的反向磁场力,用以保证前臂运动的平稳;当实际转角为钝角时,靠近连杆MM的电磁线圈产生的磁场强度最强,提供所需磁场力的大部分,此时远离连杆MM的电磁线圈产生反向磁场力,用以保证前臂运动的平稳;
7)多组电磁线圈的存在,可以实现排斥力与吸引力同时存在的情况,以保证前臂能够平稳旋转。
本说明书实施例所述的内容仅仅是对实用新型构思的实现形式的列举,本实用新型的保护范围不应当被视为仅限于实施例所陈述的具体形式,本实用新型的保护范围也及于本领域技术人员根据本实用新型构思所能够想到的等同技术手段。
Claims (2)
1.三轴混合驱动式机械臂,包括底座、支座、后臂、前臂、手掌,其特征在于:所述的支座绕垂直向上的第一轴铰接在所述的底座上,所述的后臂的下端绕水平的第二轴铰接在所述的支座上,所述的前臂的上端绕第三轴铰接在后臂上,所述的前臂的下端绕第四轴与手掌铰接,所述的第二轴、第三轴、第四轴相互平行;
所述的手掌连接第一连杆机构,所述的第一连杆机构包括中部铰接在第三轴上的第一中间连杆、在前臂内延伸的前臂连杆、在后臂内延伸的后臂连杆;所述的后臂连杆的上端铰接在所述的第一中间连杆的右侧端部,所述的后臂连杆的下端铰接在所述的支座上;所述的前臂连杆的上端铰接在所述的第一中间连杆的左侧端部,所述的前臂连杆的下端铰接在所述的手掌上;所述的手掌、前臂连杆、第一中间连杆、前臂形成平行四边形机构,所述的后臂、后臂连杆、第一中间连杆、支座形成另一个平行四边形机构;
装在前臂连杆上的第一红外测距仪对准装在后臂连杆上的第二红外测距仪;
所述的前臂和后臂内装有驱动前臂与后臂相对开合的电磁线圈驱动机构,所述的电磁线圈驱动机构包括第二连杆机构和电磁线圈;
所述的第二连杆机构包括:中部铰接在第三轴上的第二中间连杆、在前臂内延伸的相互平行的第一内杆和第一外杆、在后臂内延伸的相互平行的第二内杆和第二外杆;第一内杆和第一外杆的上端分别铰接在第二中间连杆的左侧,第二内杆和第二外杆的上端分别铰接在第二中间连杆的右侧;第一电磁线圈分别与所述的第一内杆和第一外杆铰接,第二电磁线圈分别与所述的第二内杆和第二外杆铰接,第一电磁线圈与第二电磁线圈位于同一直线上,形成电磁线圈组;所述的第一内杆和第一外杆、第二中间连杆、第一电磁线圈形成平行四边形机构,所述的第二内杆和第二外杆、第二中间连杆、第二电磁线圈形成平行四边形机构;
所述的支座内装有用于驱动支座绕底座旋转和后臂绕支座转动的蜗轮蜗杆式直流伺服电机;
所述的支座和后臂上都装有位置传感器;
所述的位置传感器、第一红外测距仪、第二红外测距仪的输出端都连接控制器的输入端,所述的蜗轮蜗杆式直流伺服电机、第一电磁线圈、第二电磁线圈的控制端都连接控制器的输出端。
2.如权利要求1所述的三轴混合驱动式机械臂,其特征在于:所述的电磁线圈组有二个以上,各电磁线圈组位于所述的第二连杆机构的不同高度上。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201520046536.7U CN204450538U (zh) | 2015-01-23 | 2015-01-23 | 三轴混合驱动式机械臂 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201520046536.7U CN204450538U (zh) | 2015-01-23 | 2015-01-23 | 三轴混合驱动式机械臂 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN204450538U true CN204450538U (zh) | 2015-07-08 |
Family
ID=53657481
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201520046536.7U Withdrawn - After Issue CN204450538U (zh) | 2015-01-23 | 2015-01-23 | 三轴混合驱动式机械臂 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN204450538U (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104608123A (zh) * | 2015-01-23 | 2015-05-13 | 浙江理工大学 | 一种三轴混合驱动式机械臂 |
CN108709711A (zh) * | 2018-05-17 | 2018-10-26 | 南昌华勤电子科技有限公司 | 斜坡跌落测试设备 |
-
2015
- 2015-01-23 CN CN201520046536.7U patent/CN204450538U/zh not_active Withdrawn - After Issue
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104608123A (zh) * | 2015-01-23 | 2015-05-13 | 浙江理工大学 | 一种三轴混合驱动式机械臂 |
CN108709711A (zh) * | 2018-05-17 | 2018-10-26 | 南昌华勤电子科技有限公司 | 斜坡跌落测试设备 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104822617B (zh) | 夹持表面定位*** | |
CN104308831B (zh) | 双动子直线电机驱动的并联机器人 | |
WO2014002275A1 (ja) | 移動体および移動体システム | |
CN107107349A (zh) | 机械臂*** | |
CN202533779U (zh) | 一种点胶机自动纠偏装置 | |
CN202878311U (zh) | 一种简易两自由度机械手 | |
CN203471773U (zh) | 一种可抓取式机械手臂 | |
CN102663966B (zh) | 一种大型六自由度显示屏协同装置 | |
CN204450538U (zh) | 三轴混合驱动式机械臂 | |
CN103786149A (zh) | 一种简易两自由度机械手 | |
CN202703736U (zh) | 六轮步进式机器人全向移动平台 | |
CN202534249U (zh) | 多手臂传送机器人实训装置 | |
CN206172335U (zh) | 一种智能仓储巷道机器人机械手 | |
CN108000871A (zh) | 绳索牵引并联机构3d打印装置 | |
US9174827B2 (en) | Power assist device, method of controlling power assist device, and program of power assist device | |
CN203562136U (zh) | 一种运动控制的教学实验装置 | |
CN106200646A (zh) | 一种基于全向车绕任意点定轴转动的控制方法及*** | |
CN104608123A (zh) | 一种三轴混合驱动式机械臂 | |
CN202592385U (zh) | 数控六自由度柔性机械手装置 | |
CN102658841A (zh) | 六轮步进式机器人全向移动平台 | |
CN209096984U (zh) | 一种带倾转功能的水下机器人 | |
CN208617244U (zh) | 具有防风防撞功能的龙门吊 | |
CN103264961A (zh) | 四卷筒龙门式起重机 | |
CN102854128A (zh) | 翻转测试机 | |
CN205870524U (zh) | 搬运码垛伺服机械手臂 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
AV01 | Patent right actively abandoned |
Granted publication date: 20150708 Effective date of abandoning: 20160511 |
|
C25 | Abandonment of patent right or utility model to avoid double patenting |