一种五自由度可控机构式圆弧喷涂机器人 |
|||||||
申请号 | CN201710538266.5 | 申请日 | 2017-07-04 | 公开(公告)号 | CN107199559A | 公开(公告)日 | 2017-09-26 |
申请人 | 广西大学; | 发明人 | 蔡敢为; 韦为; 王湘; 叶兵; 吴承亮; 李洪汉; 吴长逸; 何桂尖; 谢声扬; | ||||
摘要 | 一种五 自由度 可控机构式圆弧 喷涂 机器人 ,第一伺服 电机 通过包括第一主动杆的传动链驱动第四末级滑套在小臂上做前后运动,第四末级滑套通过由第一 连杆 至第十五连杆构成的传动链传递后驱动执行器做仰 角 的调整,第二 伺服电机 通过包括第二主动杆的传动链驱动小臂旋转,小臂通过传动链带动执行器在工作平面上做左右摆动,第四伺服电机通过包括第四主动杆的传动链控制 转轴 相对于转动副四为中心的抬升高度动作,即控制了执行器的抬升高度。本 发明 实现将全部电机和减速器安装到 基座 附近的低 重心 轻量化结构设计,电机和减速器都不随运动杆件做大幅度运动,具有结构可靠性高、 稳定性 好和成本低等特点。 | ||||||
权利要求 | 1.一种五自由度可控机构式圆弧喷涂机器人,其特征在于,包括第一支撑杆、第二支撑杆、第四支撑杆、第一大臂、第二大臂、第一主动杆、第二主动杆、第四主动杆、第一初级从动杆、第二初级从动杆、第四初级从动杆、第一初级滑套、第二初级滑套、第四初级滑套、第一次级从动杆、第二次级从动杆、第四次级从动杆、第一三角件、第二三角件、第四三角件、第五三角件、第一三级从动杆、第二三级从动杆、第一次级滑套、第二次级滑套、第一末级从动杆、第二末级从动杆、第一连接块、第二连接块、第三连接块、第一末级滑套、第四末级滑套、第五末级滑套、第六末级滑套、第七末级滑套、第九末级滑套、第一导杆、第二导杆、第一连杆、第二连杆、第三连杆、第四连杆、第五连杆、第六连杆、第七连杆、第九连杆、第十二连杆、第十三连杆、第十四连杆、第十五连杆、小臂、机架、执行器和转轴; |
||||||
说明书全文 | 一种五自由度可控机构式圆弧喷涂机器人技术领域[0001] 本发明涉及机械领域,具体是一种五自由度可控机构式圆弧喷涂机器人。 背景技术[0002] 自从20世纪80年代以来,人们一直希望减少机器人运动件的质量来改善其动态性能,并取得了可喜的成果。但这些工作都是围绕减轻机器人杆件质量展开。而安装在串联机器人关节处的电机、减速器实际上对机器人动态性能影响很大。而且,为了保证电机输出大功率,其输出转速很高,就需要大传动比的减速器将其减速到适合机器人工作的速度。而研制体积小、质量轻的大传动比减速器也是我国机器人行业遇到的比较棘手的问题。目前,国产机器人用电机和减速器与国际先进水平的机器人用电机、减速器的差距之一,就是质量(重量)和体积大,这会导致机器人的转动惯量大、机器人动态性能不佳、易产生较大振动等问题。如果电机、减速器能够安装在机架上,不是安装在关节处随机械臂运动,则没有转动惯量大所带来的各种问题。 发明内容[0003] 本发明针对现有技术的不足,提供一种五自由度可控机构式圆弧喷涂机器人。 [0004] 为了实现上述目的,本发明采用了以下技术方案: [0005] 一种五自由度可控机构式圆弧喷涂机器人,包括第一支撑杆、第二支撑杆、第四支撑杆、第一大臂、第二大臂、第一主动杆、第二主动杆、第四主动杆、第一初级从动杆、第二初级从动杆、第四初级从动杆、第一初级滑套、第二初级滑套、第四初级滑套、第一次级从动杆、第二次级从动杆、第四次级从动杆、第一三角件、第二三角件、第四三角件、第五三角件、第一三级从动杆、第二三级从动杆、第一次级滑套、第二次级滑套、第一末级从动杆、第二末级从动杆、第一连接块、第二连接块、第三连接块、第一末级滑套、第四末级滑套、第五末级滑套、第六末级滑套、第七末级滑套、第九末级滑套、第一导杆、第二导杆、第一连杆、第二连杆、第三连杆、第四连杆、第五连杆、第六连杆、第七连杆、第九连杆、第十二连杆、第十三连杆、第十四连杆、第十五连杆、小臂、机架、执行器和转轴; [0006] 具体结构以及连接关系如下: [0007] 第一支撑杆下端固定在机架上, [0008] 第一支撑杆上端通过转动副一同时与第一三角件第一角以及第一大臂一端连接,[0009] 第一大臂的中部通过转动副四十连接在转轴上; [0010] 第一初级滑套套装在第一支撑杆上, [0011] 第一次级滑套套装在第一大臂上, [0012] 第一主动杆一端通过转动副五连接在机架上, [0013] 第一主动杆另一端通过转动副六与第一初级从动杆一端连接, [0014] 第一初级从动杆另一端通过转动副七连接在第一初级滑套上; [0015] 第一次级从动杆一端通过转动副八连接在第一初级滑套, [0016] 第一次级从动杆另一端通过转动副九与第一三角件的第二角连接; [0017] 第一三级从动杆一端通过转动副十与第一三角件的第三角连接, [0018] 第一三级从动杆另一端通过转动副十一连接在第一次级滑套上; [0019] 第二支撑杆下端固定在机架上, [0020] 第二支撑杆上端通过转动副二同时与第二三角件第一角以及第二大臂一端连接,[0021] 第二大臂的中部通过转动副四十一连接在转轴上, [0022] 第二大臂另一端通过转动副六十七连接在第一连接块上; [0023] 第二初级滑套套装在第二支撑杆上, [0024] 第二次级滑套套装在第二大臂上, [0025] 第二主动杆一端通过转动副四十三连接在机架上, [0026] 第二主动杆另一端通过转动副四十四与第二初级从动杆一端连接,[0027] 第二初级从动杆另一端通过转动副四十五连接在第二初级滑套上; [0028] 第二次级从动杆一端通过转动副四十六连接在第二初级滑套, [0029] 第二次级从动杆另一端通过转动副四十七与第二三角件的第二角连接; [0030] 第二三级从动杆一端通过转动副四十八与第二三角件的第三角连接,[0031] 第二三级从动杆另一端通过转动副四十九连接在第二次级滑套上,[0032] 第四支撑杆下端固定在机架上, [0033] 第四支撑杆上端通过转动副四与第四三角件第一角连接; [0034] 第四初级滑套套装在第四支撑杆上; [0035] 第四主动杆一端通过转动副五十九连接在机架上, [0036] 第四主动杆另一端通过转动副六十与第四初级从动杆一端连接, [0037] 第四初级从动杆另一端通过转动副六十一连接在第四初级滑套上; [0038] 第四次级从动杆一端通过转动副六十二连接在第四初级滑套, [0039] 第四次级从动杆另一端通过转动副六十三与第四三角件的第二角连接,[0040] 第四三角件的第三角通过转动副六十四连接在转轴上; [0041] 小臂一端通过转动副六十五连接在第一连接块上, [0042] 小臂另一端固定连接在第二连接块上; [0043] 第一导杆下端固定连接在第一连接块上, [0044] 第一末级滑套套装在第一导杆上; [0045] 第二末级从动杆一端通过转动副五十连接在在第二次级滑套上; [0046] 第二末级从动杆另一端通过转动副六十六连接在第一末级滑套上,[0047] 第一连杆一端通过转动副十三连接在第一末级滑套上, [0048] 第一连杆另一端通过转动副十四与第二连杆一端连接, [0049] 第二连杆另一端固定连接在小臂上; [0050] 第一末级从动杆一端通过转动副十二连接在在第一次级滑套上, [0051] 第一末级从动杆另一端通过转动副十五连接在第四末级滑套上; [0052] 第四末级滑套与第五末级滑套之间通转动副十六连接, [0053] 第三连杆一端通过转动副十七连接在第五末级滑套上, [0054] 第三连杆另一端通过转动副十八连接在第六末级滑套上, [0055] 第六末级滑套套装在第四连杆上, [0056] 第四连杆一端通过转动副十九连接在第二连接块上, [0057] 第四连杆另一端通过转动副二十在第五三角件的第一角上, [0058] 第五连杆一端通过转动副二十一连接在第六末级滑套上, [0059] 第五连杆另一端通过转动副二十二连接在第五三角件的第二角, [0060] 第六连杆一端通过转动副二十三连接在第五三角件的第三角, [0061] 第六连杆另一端通过转动副二十四连接在第七末级滑套上, [0062] 第七末级滑套套装在第七连杆上, [0063] 第九连杆一端通过转动副二十九连接在第二连接块上, [0064] 第九连杆另一端通过转动副三十连接在第七连杆上; [0065] 第二导杆一端固定连接在第三连接块上, [0066] 第九末级滑套套装在第二导杆上; [0067] 第十二连杆一端通过转动副三十五连接在第七末级滑套上, [0068] 第十二连杆另一端通过转动副三十六连接在第九末级滑套上, [0069] 第十三连杆一端通过转动副三十七连接在第三连接块上, [0070] 第十三连杆另一端固定连接在执行器上, [0071] 第十四连杆一端通过转动副三十八连接在第九末级滑套上, [0072] 第十四连杆另一端通过转动副三十九连接在第十五连杆上, [0073] 第十五连杆另一端固定连接在第十三连杆上。 [0074] 进一步的, [0075] 还包括第一伺服电机、第二伺服电机和第四伺服电机,转动副五由第一伺服电机驱动,转动副四十三由第二伺服电机驱动,转动副五十九由第四伺服电机驱动。 [0076] 进一步的, [0077] 所述转动副十三、转动副十四、转动副六十五和转动副十六的转动平面平行于小臂的径向截面。 [0078] 进一步的, [0079] 所述转动副三十七、转动副三十八、转动副三十九的转动平面平行于第十三连杆的径向截面。 [0080] 进一步的, [0081] 所述转动副一、转动副二、转动副四、转动副五、转动副六、转动副七、转动副八、转动副九、转动副十、转动副十一、转动副十二、转动副十五、转动副十七、转动副十八、转动副十九、转动副二十、转动副二十一、转动副二十二、转动副二十三、转动副二十四、转动副二十九、转动副三十、转动副三十五、转动副三十六、转动副四十、转动副四十一、转动副四十三、转动副四十四、转动副四十五、转动副四十六、转动副四十七、转动副四十八、转动副四十九、转动副五十、转动副五十九、转动副六十、转动副六十一、转动副六十二、转动副六十三、转动副六十四、转动副六十六、转动副六十七和转动副六十八的转动平面平行于小臂的轴向截面。 [0082] 进一步的, [0083] 所述大臂和小臂同轴装配,第一导杆垂直于小臂,第二导杆垂直于第十三连杆;第二连杆垂直于小臂,第十五连杆垂直于第十三连杆。 [0084] 进一步的, [0085] 所述第四末级滑套和第五末级滑套均为正六面体,开设有轴向圆形通孔;小臂均为圆柱杆;第四末级滑套和第五末级滑套通过轴向圆形通孔套装在小臂上。 [0086] 与现有技术相比较,本发明具备的有益效果: [0087] 本发明实现将全部电机和减速器安装到基座附近的低重心轻量化结构设计,电机和减速器都不随运动杆件做大幅度运动。克服了现有焊接机器人将电机和减速器安装在关节上,所产生的运动惯量大、残余振动明显和高速工作定位精度低等缺点,具有结构可靠性高、稳定性好和成本低等特点。 [0088] 本发明将两个相互垂直工作面上的两套曲柄滑块机构,通过正方形滑块的两个垂直表面构联到一起,实现了两个相互垂直工作面上的驱动传动。克服了现有大部分连杆机构只能平面驱动传动和空间刚度差等缺点,具有不需要在关节上安装电机和减速器,就实现了空间驱动传动的特点。 [0089] 本发明实现曲柄滑块机构串联传动,克服了传统四杆传动机构整体刚度低和占用空间大的缺点,具有传动结构紧凑和可靠性高的特点。 [0091] 图1为本发明所述五自由度可控机构式圆弧喷涂机器人的整体结构示意图一。 [0092] 图2为本发明所述五自由度可控机构式圆弧喷涂机器人的控制第一末级从动杆运动的传动链的结构示意图一。 [0093] 图3为本发明所述五自由度可控机构式圆弧喷涂机器人的控制第一末级从动杆运动的传动链的结构示意图二。 [0094] 图4为本发明所述五自由度可控机构式圆弧喷涂机器人的控制第二末级从动杆运动的传动链的结构示意图一。 [0095] 图5为本发明所述五自由度可控机构式圆弧喷涂机器人的控制第二末级从动杆运动的传动链的结构示意图二。 [0096] 图6为本发明所述五自由度可控机构式圆弧喷涂机器人的控制第四三角件运动的传动链的结构示意图一。 [0097] 图7为本发明所述五自由度可控机构式圆弧喷涂机器人的控制第四三角件运动的传动链的结构示意图二。 [0098] 图8为本发明所述五自由度可控机构式圆弧喷涂机器人的小臂、第一导杆和第二末级从动杆之间的装配机构示意图一。 [0099] 图9为本发明所述五自由度可控机构式圆弧喷涂机器人的小臂、第一导杆和第二末级从动杆之间的装配机构示意图二。 [0100] 图10为本发明所述五自由度可控机构式圆弧喷涂机器人的小臂、第一导杆和第二末级从动杆之间的装配机构示意图三。 [0101] 图11为本发明所述五自由度可控机构式圆弧喷涂机器人的控制执行器运动的传动链结构示意图一。 [0102] 图12为本发明所述五自由度可控机构式圆弧喷涂机器人的控制执行器运动的传动链结构示意图二。 [0103] 图13为本发明所述五自由度可控机构式圆弧喷涂机器人的第十三连杆、第十四连杆以及第十五连杆之间的装配结构示意图。 [0104] 图14为本发明所述五自由度可控机构式圆弧喷涂机器人的第十三连杆、第七连杆以及第二导杆之间的装配结构示意图。 [0105] 图15为本发明所述五自由度可控机构式圆弧喷涂机器人的第十二连杆与第九末级滑套之间的装配结构示意图。 [0106] 图16为本发明所述五自由度可控机构式圆弧喷涂机器人的整体结构示意图二。 [0107] 图中: [0108] 第一伺服电机1a、第二伺服电机2a、第四伺服电机4a、 [0109] 第一支撑杆1b、第二支撑杆2b、第四支撑杆4b、 [0110] 第一大臂1c、第二大臂2c、 [0111] 第一主动杆1d、第二主动杆2d、第四主动杆4d、 [0112] 第一初级从动杆1e、第二初级从动杆2e、第四初级从动杆4e、 [0113] 第一初级滑套1f、第二初级滑套2f、第四初级滑套4f、 [0114] 第一次级从动杆1g、第二次级从动杆2g、第四次级从动杆4g、 [0115] 第一三角件1h、第二三角件2h、第四三角件4h、第五三角件5h、 [0116] 第一三级从动杆1i、第二三级从动杆2i、 [0117] 第一次级滑套1j、第二次级滑套2j、 [0118] 第一末级从动杆1k、第二末级从动杆2k、 [0119] 第一连接块1n、第二连接块2n、第三连接块3n、 [0120] 第一末级滑套1p、第四末级滑套4p、第五末级滑套5p、 [0121] 第六末级滑套6p、第七末级滑套7p、第九末级滑套9p、 [0122] 第一导杆1q、第二导杆2q、 [0123] 第一连杆1、第二连杆2、第三连杆3、第四连杆4、第五连杆5、 [0124] 第六连杆6、第七连杆7、第九连杆9、 [0125] 第十二连杆12、第十三连杆13、第十四连杆14、第十五连杆15、 [0126] 小臂100、机架99、执行器98、转轴97。 具体实施方式[0127] 下面通过实施例对本发明的技术方案作进一步阐述。 [0128] 实施例1 [0129] 一种五自由度可控机构式圆弧喷涂机器人,包括第二支撑杆2b、第三支撑杆3b、第四支撑杆4b、第二大臂2c、第三大臂3c、第二主动杆2d、第三主动杆3d、第四主动杆4d、第二初级从动杆2e、第三初级从动杆3e、第四初级从动杆4e、第二初级滑套2f、第三初级滑套3f、第四初级滑套4f、第二次级从动杆2g、第三次级从动杆3g、第四次级从动杆4g、第二三角件2h、第三三角件3h、第四三角件4h、第五三角件5h、第二三级从动杆2i、第三三级从动杆3i、第二次级滑套2j、第三次级滑套3j、第二末级从动杆2k、第三末级从动杆3k、第一连接块1n、第二连接块2n、第一末级滑套1p、第二末级滑套2p、第三末级滑套3p、第八末级滑套8p、第一导杆1q、第一连杆1、第二连杆2、第四连杆4、第七连杆7、第八连杆8、第九连杆9、第十连杆 10、第十一连杆11、小臂100、机架99、执行器98和转轴97, [0130] 具体结构及其连接关系如下: [0131] 如图2和3所示: [0132] 第一支撑杆1b下端固定在机架99上, [0133] 第一支撑杆1b上端通过转动副一101同时与第一三角件1h第一角以及第一大臂1c一端连接, [0134] 第一大臂1c的中部通过转动副四十140连接在转轴97上; [0135] 第一初级滑套1f套装在第一支撑杆1b上, [0136] 第一次级滑套1j套装在第一大臂1c上, [0137] 第一主动杆1d一端通过转动副五105连接在机架99上, [0138] 第一主动杆1d另一端通过转动副六106与第一初级从动杆1e一端连接,[0139] 第一初级从动杆1e另一端通过转动副七107连接在第一初级滑套1f上; [0140] 第一次级从动杆1g一端通过转动副八108连接在第一初级滑套1f, [0141] 第一次级从动杆1g另一端通过转动副九109与第一三角件1h的第二角连接; [0142] 第一三级从动杆1i一端通过转动副十110与第一三角件1h的第三角连接,[0143] 第一三级从动杆1i另一端通过转动副十一111连接在第一次级滑套1j上; [0144] 如图4和5所示: [0145] 第二支撑杆2b下端固定在机架99上, [0146] 第二支撑杆2b上端通过转动副二102同时与第二三角件2h第一角以及第二大臂2c一端连接, [0147] 第二大臂2c的中部通过转动副四十一141连接在转轴97上, [0148] 第二大臂2c另一端通过转动副六十七167连接在第一连接块1n上; [0149] 第二初级滑套2f套装在第二支撑杆2b上, [0150] 第二次级滑套2j套装在第二大臂2c上, [0151] 第二主动杆2d一端通过转动副四十三143连接在机架99上, [0152] 第二主动杆2d另一端通过转动副四十四144与第二初级从动杆2e一端连接,[0153] 第二初级从动杆2e另一端通过转动副四十五145连接在第二初级滑套2f上; [0154] 第二次级从动杆2g一端通过转动副四十六146连接在第二初级滑套2f,[0155] 第二次级从动杆2g另一端通过转动副四十七147与第二三角件2h的第二角连接; [0156] 第二三级从动杆2i一端通过转动副四十八148与第二三角件2h的第三角连接,[0157] 第二三级从动杆2i另一端通过转动副四十九149连接在第二次级滑套2j上,[0158] 图6和7所示 [0159] 第四支撑杆4b下端固定在机架99上, [0160] 第四支撑杆4b上端通过转动副四104与第四三角件4h第一角连接; [0161] 第四初级滑套4f套装在第四支撑杆4b上; [0162] 第四主动杆4d一端通过转动副五十九159连接在机架99上, [0163] 第四主动杆4d另一端通过转动副六十160与第四初级从动杆4e一端连接,[0164] 第四初级从动杆4e另一端通过转动副六十一161连接在第四初级滑套4f上; [0165] 第四次级从动杆4g一端通过转动副六十二162连接在第四初级滑套4f,[0166] 第四次级从动杆4g另一端通过转动副六十三163与第四三角件4h的第二角连接,[0167] 第四三角件4h的第三角通过转动副六十四164连接在转轴97上; [0168] 如图8~10所示: [0169] 小臂100一端通过转动副六十五165连接在第一连接块1n上, [0170] 小臂100另一端固定连接在第二连接块2n上; [0171] 第一导杆1q下端固定连接在第一连接块1n上, [0172] 第一末级滑套1p套装在第一导杆1q上; [0173] 第二末级从动杆2k一端通过转动副五十150连接在在第二次级滑套2j上; [0174] 第二末级从动杆2k另一端通过转动副六十六166连接在第一末级滑套1p上,[0175] 第一连杆1一端通过转动副十三113连接在第一末级滑套1p上, [0176] 第一连杆1另一端通过转动副十四114与第二连杆2一端连接, [0177] 第二连杆2另一端固定连接在小臂100上; [0178] 如图11和12所示: [0179] 第一末级从动杆1k一端通过转动副十二112连接在在第一次级滑套1j上,[0180] 第一末级从动杆1k另一端通过转动副十五115连接在第四末级滑套4p上; [0181] 第四末级滑套4p与第五末级滑套5p之间通转动副十六连接, [0182] 第三连杆3一端通过转动副十七117连接在第五末级滑套5p上, [0183] 第三连杆3另一端通过转动副十八118连接在第六末级滑套6p上, [0184] 第六末级滑套6p套装在第四连杆4上, [0185] 第四连杆4一端通过转动副十九119连接在第二连接块2n上, [0186] 第四连杆4另一端通过转动副二十120在第五三角件5h的第一角上,[0187] 第五连杆5一端通过转动副二十一连接在第六末级滑套6p上, [0188] 第五连杆5另一端通过转动副二十二122连接在第五三角件5h的第二角,[0189] 第六连杆6一端通过转动副二十三123连接在第五三角件5h的第三角,[0190] 第六连杆6另一端通过转动副二十四124连接在第七末级滑套7p上,[0191] 第七末级滑套7p套装在第七连杆7上, [0192] 第九连杆9一端通过转动副二十九129连接在第二连接块2n上, [0193] 第九连杆9另一端通过转动副三十130连接在第七连杆7上; [0194] 如图13~15所示: [0195] 第二导杆2q一端固定连接在第三连接块3n上, [0196] 第九末级滑套9p套装在第二导杆2q上; [0197] 第十二连杆12一端通过转动副三十五135连接在第七末级滑套7p上,[0198] 第十二连杆12另一端通过转动副三十六136连接在第九末级滑套9p上,[0199] 第十三连杆13一端通过转动副三十七137连接在第三连接块3n上, [0200] 第十三连杆13另一端固定连接在执行器98上, [0201] 第十四连杆14一端通过转动副三十八138连接在第九末级滑套9p上,[0202] 第十四连杆14另一端通过转动副三十九139连接在第十五连杆15上,[0203] 第十五连杆15另一端固定连接在第十三连杆13上。 [0204] 进一步的, [0205] 还包括第二伺服电机2a、第三伺服电机3a和第四伺服电机4a, [0206] 转动副五105由第一伺服电机1a驱动, [0207] 转动副四十三143由第二伺服电机2a驱动, [0208] 转动副五十九159由第四伺服电机4a驱动。 [0209] 进一步的, [0210] 所述转动副十三113、转动副十四114、转动副六十五165和转动副十六116的转动平面平行于小臂100的径向截面。 [0211] 进一步的, [0212] 所述转动副三十七137、转动副三十八138、转动副三十九139的转动平面平行于第十三连杆13的径向截面。 [0213] 进一步的, [0214] 转动副一101、转动副二102、转动副四104、转动副五105、转动副六106、转动副七107、转动副八108、转动副九109、转动副十110、转动副十一111、转动副十二112、转动副十五115、转动副十七117、转动副十八118、转动副十九119、转动副二十120、转动副二十一 121、转动副二十二122、转动副二十三123、转动副二十四124、转动副二十九、转动副三十 130、转动副三十五135、转动副三十六136、转动副四十140、转动副四十一141、转动副四十三143、转动副四十四144、转动副四十五145、转动副四十六146、转动副四十七147、转动副四十八148、转动副四十九149、转动副五十150、转动副五十九159、转动副六十160、转动副六十一161、转动副六十二162、转动副六十三163、转动副六十四164、转动副六十六166、转动副六十七167和转动副六十八168的转动平面平行于小臂100的轴向截面。 [0215] 进一步的, [0216] 所述大臂97和小臂100同轴装配, [0217] 第一导杆1q垂直于小臂100, [0218] 第二导杆2q垂直于第十三连杆13; [0219] 第二连杆2垂直于小臂100, [0220] 第十五连杆15垂直于第十三连杆13。 [0221] 进一步的, [0222] 所述第四末级滑套4p和第五末级滑套5p均为正六面体,开设有轴向圆形通孔; [0223] 小臂100均为圆柱杆;第四末级滑套4p和第五末级滑套5p通过轴向圆形通孔套装在小臂100上。 [0224] 第一伺服电机通过包括第一主动杆的传动链驱动第四末级滑套在小臂上做前后运动,第四末级滑套通过由第一连杆至第十五连杆构成的传动链传递后驱动执行器做仰角的调整,第二伺服电机通过包括第二主动杆的传动链驱动小臂旋转,小臂通过传动链带动执行器在工作平面上做左右摆动,第四伺服电机通过包括第四主动杆的传动链控制转轴相对于转动副四为中心的抬升高度动作,即控制了执行器的抬升高度。 |