1.本实用新型涉及一种公路施工交通管制辅助机械，具体涉及一种双臂收放锥筒机器人的伺服驱动系统。
背景技术：
2.锥筒，是一种使用塑料或橡胶制成的一种空心椎体状安全标志，锥筒底部开口，并在锥筒底部设置有外檐，用于公路封闭或应急施工以及交通潮汐分车道分流工作中，往往需要布放安全锥筒对部分道路进行隔离，并在使用完毕后进行收。现有的布放及回收方式均多为使用人力，工作量大，工作效率低，工作环境异常危险。
3.目前行业内急需一种操作简单，伺服驱动的双臂收集、布放公路安全锥筒，并对锥筒集成码垛的小型化机器人。
技术实现要素：
4.针对现有技术中提到的问题，本实用新型提供一种双臂收放锥筒机器人的伺服驱动系统可控制双臂交错升降完成输送锥筒，通过旋转90
°
完成锥筒的夹取及码垛工作，效率高，设备造价低，设备运行稳定。
5.本实用新型一种双臂收放锥筒机器人的伺服驱动系统，包括控制器和为控制器提供电源的电源开关，所述控制器包括分别连接的旋转动力头、链条电机、电动推拉杆以及感应系统，所述电源开关还与感应系统相连为其提供工作电源。
6.优选地，所述感应系统包括感应探头、感应探头、感应探头ⅲ及感应探头ⅳ。
7.优选地，所述感应探头、感应探头、感应探头ⅲ及感应探头ⅳ的型号均为pr18
‑
8dn。
8.优选地，所述控制器上还设有收集按钮与布放按钮。
9.本实用新型相对于现有技术，取得了以下的技术效果：
10.本实用新型结构简单，设备造价低，通过控制机械手可完成锥筒的夹取和松开工作，自动化程度高，布放的锥筒间距均匀，收集与码垛同步完成，速度快、效率高，设备运行稳定。
附图说明
11.图1为实用新型结构示意图。
12.图2为图1的左视结构示意图。
13.图3为图1中的机械手正视结构示意图。
14.图4为图3机械手俯视结构示意图。
15.图5为图3机械手左视结构示意图。
16.图6为伺服驱动系统连接示意图。
17.附图标记：1
‑
链条，2
‑
感应探头，3
‑
探头感应片，4
‑
输送臂，4.1
‑
左臂输送臂，4.2
‑
右臂输送臂，5
‑
第一轴承套，6
‑
第二轴承套，7
‑
轴承，8
‑
旋转动力头，9
‑
连接板，10
‑
链条电机，11
‑
链条连接板，12
‑
车厢固定架，13
‑
链条导向槽，14
‑
机械主体，15
‑
主传动链轮，16
‑
紧固链轮，17
‑
感应探头，18
‑
转向链轮，19
‑
感应探头ⅲ，20
‑
可拆卸连接口，21
‑
连接锁扣，22
‑
机械臂，23
‑
夹具连接杆，24
‑
机械手夹具，25
‑
连接螺杆，26
‑
电动推拉杆，27
‑
机械手支架，28
‑
感应探头ⅳ， 29
‑
接触杆，30
‑
定位销，31
‑
定位调整孔，32
‑
导向调节机构，33
‑
活塞杆，34
‑
复位弹簧，35
‑
机械手，36
‑
机械手机械手，37
‑
螺栓，38
‑
控制器，39
‑
电源开关，40
‑
收集按钮，41
‑
布放按钮。
具体实施方式实施例
18.本实用新型一种双臂收放锥筒机器人的伺服驱动系统，包括控制器38和为控制器38提供电源的电源开关39，所述控制器38包括分别连接的旋转动力头8、链条电机10、电动推拉杆26以及感应系统，所述电源开关29还与感应系统相连为其提供工作电源。所述感应系统包括感应探头2、感应探头17、感应探头ⅲ19及感应探头ⅳ28。所述感应探头2、感应探头17、感应探头ⅲ19及感应探头ⅳ28的型号均为pr18
‑
8dn。所述控制器38上还设有收集按钮40与布放按钮41。
19.以下结合附图对本实用新型进一步说明：
20.如图1所示，本发明的机械主体14为一长方体固定结构，在机械主体14的侧壁上设有车厢固定架12，车厢固定架12呈倒“u”型结构，可通过车厢固定架12卡入车辆的车厢边沿上并螺纹固定安装。
21.如图2所示，所示本实施例中设置有两个输送臂4分别为左臂输送臂4.1和右臂输送臂4.2，两个输送臂4均为方管结构，左臂输送臂4.1和右臂输送臂4.2相互平行并通过设置在上端和设置在下端的连接板9与机械主体14相连，其中连接板9上还设有轴承座，左臂输送臂4.1和右臂输送臂4.2均与两端的轴承座相连，位于左臂输送臂4.1和右臂输送臂4.2下端还设有两个旋转动力头8和动力电机，两个旋转动力头8均与左臂输送臂4.1和右臂输送臂4.2相连，动力电机带动旋转动力头8旋转，旋转动力头8带动相连地左臂输送臂4.1和右臂输送臂4.2绕自身旋转角度。
22.如图1所示，机械主体14的四个角上均设置有转向链轮18，绕过四个转向链轮18设有链条1，机械主体14上设置有链条导向槽13，链条1位于链条导向槽13内设置，其链条1大小与链条导向槽13的开口大小相匹配，机械主体14底端还设有主传动链轮15和2个紧固链轮16，紧固链轮16一端还连接有链条电机10，链条1绕过转向链轮18、主传动链轮15、紧固链轮16，通过多个链轮的配合带动链条1在机械主体14上运动。
23.本实施例中，左臂输送臂4.1和右臂输送臂4.2的运动轨迹如图1所示，机械手35安装在右臂输送臂4.2上端，机械手安装在右臂输送臂4.2上端，机械手36安装在左臂输送臂4.1的下端，机械手35和机械手35和机械手36均与感应探头17的探视方向在同一水平线上；此时，链条1作顺时针旋转，机械手17的探视方向在同一水平线上；此时，链条1作顺时针旋转，机械手36在左臂输送臂4.1由下端向上移动到感应探头17限位上端停止；同步，机械手35在右臂输送臂4.2由上端移动到下端停止；当机械手35与机械手35与机械手36运动位置互换后，链条1作
逆时针旋转，机械手35在右臂输送臂4.2由下端移动到感应探头17限位上端停止，同步，机械手机械手36在左臂输送臂4.1由上端移动到下端停止；
24.如图3、图4、图5所示为本实用新型机械手结构示意图，本实施例中的机械手设置有两个，分别是机械手35与机械手35与机械手36，且机械手35与机械手35与机械手36结构相同；
25.如图3所示，机械臂22一端设置的可拆卸连接口20与连接锁扣21是配合与第一轴承套5相连接，另一端上连接有机械手夹具24，通过机械手夹具24来夹取或放开锥筒，机械手夹具24与夹具连接杆23均为一对设置，机械手夹具24包括相连地长臂和短臂，其长臂和短臂之间呈90
°
夹角设置，长臂和短臂相连接处还与机械臂22通过螺栓37相连接，短臂另一端与夹具连接杆23一端通过连接螺杆25相连，而夹具连接杆23另一端呈交叉设置并与活塞杆33螺纹相连，活塞杆33还与电动推拉杆26相连；机械臂22底部设置的接触杆29用于与锥筒相接触，为伺服驱动系统提供信号，同时在复位弹簧34的作用下能迅速复位。
26.导向调节机构32包括张开机构和连接臂，连接臂与张开机构垂直设置，其中连接臂与机械臂22之间通过定位销30相连，连接臂上还设有与定位销30相匹配设有多个定位调整孔31，可通过定位调整孔31来调节导向调节机构32在机械臂22上的位置，张开机构用于将锥筒导入定位于机械手夹具24的下方，方便于机械手夹具24定位抓握。
27.本实施例中的机械手夹具24的工作原理为：当锥筒触碰接触杆29并将接触杆29推出机械手支架27外面时，感应探头ⅳ28感应到接触杆29的信号并将信号传递给控制器38，控制器38启动电动推拉杆26，电动推拉杆26带动活塞杆33向右移动，带动夹具连接杆23张开，从而带动机械手夹具24缩合力夹取锥筒；当电动推拉杆26的活塞杆33向左移动，带动夹具连接杆23收缩，使机械手夹具24的张开以此放开锥筒，锥筒离开后，接触杆29在复位弹簧34作用下归位。
28.本实施例中的链条电机10型号：model:zdbld510,zdbldc controller；
29.电动推拉杆26型号：model:ijc
‑
c2
‑
24
‑
50
‑
80
‑
200
‑
11；
30.感应探头型号：pr18
‑
8dn。
31.本实施例中感应探头2与感应探头ⅲ19均安装在机械主体14上端的连接板9上，其中，感应探头2与感应探头ⅲ19呈90
°
夹角安装，且感应探头2与感应探头ⅲ19的探视方向均垂直于水平面；所述感应探头17对称安装在输送臂4上，感应探头17的探视方向与水平面相平行；所述感应探头ⅳ28安装在机械手支架27底部，且位置高于接触杆29，感应探头ⅳ28的探视方向对准接触杆29设置。
32.实施例1
33.本实用新型布放和收集锥筒的工作方法，其待机安装状态为：如图1所示，机械手35停止在右臂输送臂4.2上端，机械手35停止在右臂输送臂4.2上端，机械手36停止在左臂输送臂4.1的下端，机械手36停止在左臂输送臂4.1的下端，机械手36按图1所示状态安装，机械手35按图2所示状态安装：
34.1、收集、码垛锥筒步骤
35.（1.1)开机自动复位
36.接通电源后，点击收集按钮40，控制器38向右臂输送臂4.2的旋转动力头8发出顺时针旋转复位信号，旋转动力头8带动连接的右臂输送臂4.2以及连接的探头感应片3、机械手35以右臂输送臂4.2为轴心作顺时针旋转，当右臂输送臂4.2旋转90度，感应探头2感应
到探头感应片3的信号传递给控制器38，控制器38向旋转动力头8发出停止信号（复位信号），右臂输送臂4.2及连接的机械手35完成90度顺时针旋转。开机自动复位收集锥筒状态为：机械手35旋转到以图1所示状态停止在左臂输送臂4.1的上端，机械手35旋转到以图1所示状态停止在左臂输送臂4.1的上端，机械手36以图2所示状态停止在左臂输送臂4.1的下端；
37.（1.2）左臂机械手抓握锥筒
38.按车辆倒车行驶对准公路上原布放的锥筒线运行，随着车辆倒车运行，左臂机械手手36的导向调节机构32将锥筒导入到机械手夹具24中，感应探头ⅳ28将锥筒触碰接触杆29的信号传递给控制器38，控制器38启动电动推拉杆26，电动推拉杆26的活塞杆33收回使机械手夹具24的剪刀结构缩合力夹取锥筒，电流控制的夹取锥筒识别信号传递给控制器38，电流到设定值说明夹取锥筒已经加固稳定；
39.（1.3）顺时针输送锥筒
40.步骤（1.2）电流控制的夹取锥筒稳定识别信号与步骤（1.1）控制器38向旋转动力头8发出停止信号（复位信号）重叠时，控制器38按程序控制链条1顺时针旋转，机械手头8发出停止信号（复位信号）重叠时，控制器38按程序控制链条1顺时针旋转，机械手36在左臂输送臂4.1上向上滑动，同时机械手35在右臂输送臂4.2上向下滑动；当左臂的感应探头17感应到机械手17感应到机械手36的信号传递给控制器38，控制器38向链条电机10发出停止信号；此时，机械手35已停止在右臂输送臂4.2的下端；
41.（1.4）收集、码垛锥筒
42.当步骤（1.3）控制器38向链条电机10发出停止信号与控制器38向左臂输送臂4.1的旋转动力头8发出逆时针旋转传动信号重叠时，旋转动力头8带动连接的左臂输送臂4.1以及连接的探头感应片3、机械手以及连接的探头感应片3、机械手36以左臂输送臂4.1为轴心作逆时针旋转，当左臂输送臂4.1旋转90度，感应探头ⅲ19感应到探头感应片3的信号传递给控制器38，控制器38向旋转动力头8发出停止信号；停止信号与控制器38向机械手转动力头8发出停止信号；停止信号与控制器38向机械手36发出锥筒松开信号重叠时，电动推拉杆26推动机械手械手36松开锥筒，锥筒落入车厢中，完成椎筒自动堆积、码垛程序。
43.（1.5）右臂机械手抓握锥筒
44.右臂机械手右臂机械手36抓握锥筒步骤与（1.2）左臂抓握锥筒步骤相同，电流控制的夹取锥筒识别信号传递给控制器38，控制器38等待左臂机械手复位信号；
45.（1.6）左臂机械手复位
46.步骤（1.4）机械手步骤（1.4）机械手36松开锥筒信号传递给控制器38，控制器38向左臂输送臂4.1的旋转动力头8发出顺时针旋转复位信号，旋转动力头8带动连接的左臂输送臂4.1以及连接的探头感应片3、机械手35以左臂输送臂4.1为轴心作顺时针旋转，当左臂输送臂4.1旋转90度，感应探头2感应到探头感应片3的信号传递给控制器38，控制器38向旋转动力头8发出停止信号，左臂输送臂4.1及连接的机械手发出停止信号，左臂输送臂4.1及连接的机械手36完成90度顺时针旋转，使左臂机械手复位；
47.（1.7）逆时针输送锥筒
48.当步骤（1.5）电流控制的夹取锥筒识别信号与步骤（1.6）控制器38向旋转动力头8发出停止信号（复位信号）重叠时，控制器38按程序控制链条1逆时针旋转，机械手发出停止信号（复位信号）重叠时，控制器38按程序控制链条1逆时针旋转，机械手36在左臂输送臂4.1上向下滑动，同时机械手35在右臂输送臂4.2上向上滑动；当右臂的感应探头
17感应到机械手35的信号传递给控制器38，控制器38向链条电机10发出停止信号；此时，机械手时，机械手36已停止在右臂输送臂4.2的下端；
49.重复以上步骤即可循环完成锥筒收集、码垛工作。
50.实施例2
51.2、布放锥筒步骤
52.（2.1)开机自动复位
53.如图1所示，接通电源后，点击布放按钮41，控制器38自动控制双臂机械手自动运行到布放待机复位状态：机械手35停止在右臂输送臂4.2上端，机械手35停止在右臂输送臂4.2上端，机械手36停止在左臂输送臂4.1的下端，机械手臂4.1的下端，机械手36为图1所示状态，机械手35为图2所示状态。
54.（2.2）右臂机械手抓握锥筒
55.将车厢中的锥筒导入右臂机械手35的机械手夹具24中，感应探头ⅳ28将锥筒触碰接触杆29的信号传递给控制器38，控制器38启动电动推拉杆26，电动推拉杆26的活塞杆33收回使机械手夹具24的剪刀结构缩合力夹取锥筒，电流控制的夹取锥筒识别信号传递给控制器38，电流到设定值说明夹取锥筒已经加固稳定；
56.当电流控制的夹取锥筒稳定识别信号与控制器38向右臂输送臂4.2的旋转动力头8发出顺时针旋转信号重叠时，旋转动力头8带动连接的右臂输送臂4.2以及连接的探头感应片3、机械手35以右臂输送臂4.2为轴心作顺时针旋转，当右臂输送臂4.2旋转90度，感应探头2感应到探头感应片3的信号传递给控制器38，控制器38向旋转动力头8发出停止信号，右臂输送臂4.2及连接的机械手35完成90度顺时针旋转。
57.（2.3）顺时针输送锥筒
58.当步骤（2.2）控制器38向旋转动力头8发出停止信号，控制器38按程序控制链条1顺时针旋转，机械手顺时针旋转，机械手36在左臂输送臂4.1上向上滑动，同时机械手35在右臂输送臂4.2上向下滑动；当左臂的感应探头17感应到机械手17感应到机械手36的信号传递给控制器38，控制器38向链条电机10发出停止信号；此时，机械手35已停止在右臂输送臂4.2的下端；
59.（2.4）布放锥筒
60.当步骤（2.3）控制器38向链条电机10发出停止信号与控制器38向左臂输送臂4.1的旋转动力头8发出逆时针旋转传动信号重叠时，旋转动力头8带动连接的左臂输送臂4.1以及连接的探头感应片3、机械手以及连接的探头感应片3、机械手36以左臂输送臂4.1为轴心作逆时针旋转，当左臂输送臂4.1旋转90度，感应探头ⅲ19感应到探头感应片3的信号传递给控制器38，控制器38向旋转动力头8发出停止信号；停止信号与控制器38向机械手35发出锥筒松开信号重叠时，电动推拉杆26推动机械手35松开锥筒，锥筒在导向调节机构32中经扶正端立在公路上，完成椎筒自动布放工作程序。
61.（2.5）左臂机械手抓握锥筒
62.左臂机械手左臂机械手36抓握锥筒步骤与（2.2）右臂机械手抓握锥筒步骤相同；当左臂机械手械手36电流控制的夹取锥筒稳定识别信号与控制器38向左臂输送臂4.1的旋转动力头8发出顺时针旋转信号重叠时，旋转动力头8带动连接的左臂输送臂4.1以及连接的探头感应片3、机械手片3、机械手36以左臂输送臂4.1为轴心作顺时针旋转，当左臂输送臂4.1旋转90度，感应
探头2感应到探头感应片3的信号传递给控制器38，控制器38向旋转动力头8发出停止信号，左臂输送臂4.1及连接的机械手号，左臂输送臂4.1及连接的机械手36完成90度顺时针旋转。
63.（2.6）逆时针输送锥筒
64.当步骤（2.5）控制器38向旋转动力头8发出停止信号，控制器38按程序控制链条1逆时针旋转，机械手逆时针旋转，机械手36在左臂输送臂6上向下滑动，同时机械手35在右臂输送臂4.2上向上滑动；当右臂的感应探头17感应到机械手35的信号传递给控制器38，控制器38向链条电机10发出停止信号；此时，机械手电机10发出停止信号；此时，机械手36已停止在右臂输送臂4.2的下端；
65.重复以上步骤即可循环完成锥筒布放工作。