一种具有五自由度的码垛机械臂的制作方法
【技术领域】
[0001]本实用新型涉及一种具有五自由度的码垛机械臂，用于搬运、码垛、装货及卸货等多种场合。
【背景技术】
[0002]随着机器人技术在码垛工艺中的应用，码垛机械臂在工业领域中得到了广泛应用，进而降低了人工码垛的工作强度，提高了生产效率。与此同时，针对码垛机械臂的产品方案设计也层出不穷，以满足不同的码垛任务和要求。
【发明内容】
[0003]本实用新型的目的在于提供一种结构紧凑、重量轻、可用于多种场合且工作效率高的具有五自由度的码垛机械臂。
[0004]本实用新型的具有五自由度的码垛机械臂，包括机械臂体及控制系统，所述的机械臂体包括底板、两块支座板、第一圆板、第二圆板、U型底座、前臂、后臂、手掌、第一连杆、第二连杆、第三连杆、第四连杆、三角状肘连杆、第一直流伺服电机、第二直流伺服电机及第三直流伺服电机；
[0005]两块支座板相对固定于底板上，第一圆板固定在两支座板上，第二圆板通过垫筒固定于第一圆板上，且第二圆板上装有转动轴承，第一直流伺服电机固定于第一圆板的下表面，其输出轴穿过第一圆板并通过第二圆板上的转动轴承与U型底座连接，第二直流伺服电机与第三直流伺服电机同轴线地分别固定于U型底座的两个侧板外表面，第二直流伺服电机的输出轴穿过侧板与后臂的下端固定，该侧板上具有以第二直流伺服电机输出轴为圆心的圆弧槽，第三直流伺服电机的输出轴穿过另一侧板与第二连杆的一端固定，前臂的中部、后臂的上端及三角状肘连杆的一端铰接，三角状肘连杆的另一端与第一连杆的一端铰接，第一连杆的另一端与U型底座侧板的圆弧槽处铰接，后臂、三角状肘连杆、第一连杆及固定第二直流伺服电机的底座侧板构成第一个空间平行四边形机构，第二连杆的另一端与第三连杆的一端铰接，第三连杆的另一端与前臂的上端铰接，后臂、第二连杆、第三连杆及前臂的上端构成第二个空间平行四边形机构，前臂的下端与手掌的下端铰接，三角状肘连杆的第三端与第四连杆的一端铰接，第四连杆的另一端与手掌的上端铰接，前臂、三角状肘连杆、第四连杆及手掌构成第三个空间平行四边形机构；
[0006]手掌上表面固定有第四直流伺服电机，第四直流伺服电机的输出轴穿过手掌与安装板固定，安装板上具有安装孔；
[0007]所述的码垛机械臂还包括支撑架和支撑轴，支撑架置于U型底座的两侧板间并固定于U型底座上，支撑轴穿过支撑架的上部并固定于支撑架上，支撑轴与第二直流伺服电机的输出轴、第三直流伺服电机的输出轴位于同一轴线，支撑轴通过转动轴承与后臂连接，转动轴承的内圈与支撑轴固定，外圈与后臂固定。
[0008]在第二圆板上固定有用于检测U型底座转角信息的第一位置传感器，在固定第二直流伺服电机的U型底座侧板上固定有用于检测后臂位置信息的第二位置传感器，在固定第三直流伺服电机的U型底座侧板上固定有用于检测前臂位置信息的第三位置传感器；
[0009]所述的控制系统包括工控机、运动控制卡和分别用于驱动第一直流伺服电机、第二直流伺服电机、第三直流伺服电机及第四直流伺服电机的第一驱动器、第二驱动器、第三驱动器及第四驱动器，所述的工控机与运动控制卡连接，运动控制卡的输出端分别连接第一驱动器的输入端、第二驱动器的输入端、第三驱动器的输入端及第四驱动器的输入端，第一位置传感器的信号输出端、第二位置传感器的信号输出端及第三位置传感器的信号输出端均与运动控制卡的输入端连接。
[0010]上述技术方案中，所述的第一直流伺服电机可以采用涡轮蜗杆式直流伺服电机，带动底座转动。
[0011]所述的前臂与后臂均采用中空板状结构，以减轻机械臂重量，并保证机械臂的强度。
[0012]底板可固定在移动平台上，使得整个码垛机械臂可随移动平台一起移动；此外第一直流伺服电机通过转动轴承可带动U型底座从而带动机械臂绕支座转动，实现机械臂的圆周运动；后臂装在底座上，由第二直流伺服电机驱动，实现后臂的前后摆动；前臂装在后臂上，可以通过第一个空间平行四边形机构或/和第二个空间平行四边形机构来实现前臂的摆动，再结合第三个空间平行四边形机构带动手掌运动；手掌装在前臂上，可以通过调整第一连杆与U型底座侧板上圆弧槽的铰接点的位置，以实现手掌与地面间角度的调节；手掌末端可以根据实际需要安装不同的末端执行器，且装有第四直流伺服电机，用以控制末端执行器的转动，可实现不同的码垛任务。支撑架和支撑轴可以辅助支撑后臂、前臂及手掌，防止第二直流伺服电机输出轴及第三直流伺服电机输出轴因径向受力过大而发生弯曲变形。
[0013]本实用新型的有益效果在于:本实用新型为四轴驱动五自由度机械臂，由机械结构和控制系统组成，采用多个直流伺服电机，辅助以三个空间平行四边形机构，实现机械臂的整体转动控制，相比于现有技术而言，本实用新型的机械臂重量轻、结构紧凑、占地面积小、工作效率高且能耗低。此外，手掌处可根据不同的码垛要求安装不同的末端执行器，可以实现多种码垛任务。
【附图说明】
[0014]图1是具有五自由度的码垛机械臂的机械臂体结构示意图；
[0015]图2是具有五自由度的码垛机械臂的机械臂体的后视部分结构示意图；
[0016]图3是具有五自由度的码垛机械臂的机械臂体另一角度的结构示意图；
[0017]图4是具有五自由度的码垛机械臂中支撑座及支撑轴的结构示意图；
[0018]图5是放大的支撑轴与后臂的连接处示意图；
[0019]图6是具有五自由度的码垛机械臂的控制原理示意图。
[0020]图中:1.底板，2.支座板，3-1.第一圆板，3-2.第二圆板，4.U型底座，4-1.圆弧槽，5.第二直流伺服电机，6.第三直流伺服电机，7.第一直流伺服电机，8.第二连杆，9.第一连杆，10.第三连杆，11.三角状肘连杆，12.前臂，13.后臂，14.第四连杆，15.手掌，16.第一位置传感器，17.第二位置传感器，18.第三位置传感器，19.工控机，20.运动控制卡，21.第一驱动器，22.第二驱动器，23.第三驱动器，24.第四驱动器，25.第四直流伺服电机，26.安装板，27.支撑架，28.支撑轴。
【具体实施方式】
[0021]下面结合附图对本实用新型作进一步说明。
[0022]参照图1、图2、图3及图4，本实用新型的具有五自由度的码垛机械臂，包括机械臂体及控制系统，所述的机械臂体包括底板1、两块支座板2、第一圆板3-1、第二圆板3-2、U型底座4、前臂12、后臂13、手掌15、第一连杆9、第二连杆8、第三连杆10、第四连杆14、三角状肘连杆11、第一直流伺服电机7、第二直流伺服电机5及第三直流伺服电机6 ;
[0023]两块支座板2相对固定于底板上，第一圆板3-1固定在两支座板2上，第二圆板3-2通过垫筒固定于第一圆板3-1上，且第二圆板3-2上装有转动轴承，第一直流伺服电机7固定于第一圆板3-1的下表面，其输出轴穿过第一圆板3-1并通过第二圆板3-2上的转动轴承与U型底座4连接，第二直流伺服电机5与第三直流伺服电机6同轴线地分别固定于U型底座4的两个侧板外表面，第二直流伺服电机5的输出轴穿过侧板与后臂13的下端固定，该侧板上具有以第二直流伺服电机输出轴为圆心的圆弧槽4-1，第三直流伺服电机6的输出轴穿过另一侧板与第二连杆8的一端固定，前臂12的中部、后臂13的上端及三角状肘连杆11的一端铰接，三角状肘连杆11的另一端与第一连杆9的一端铰接，第一连杆9的另一端与U型底座侧板的圆弧槽处铰接，后臂13、三角状肘连杆11、第一连杆9及固定第二直流伺服电机的底座侧板构成第一个空间平行四边形机构，第二连杆8的另一端与第三连杆10的一端铰接，第三连杆10的另一端与前臂12的上端铰接，后臂13、第二连杆8、第三连杆10及前臂12的上端构成第二个空间平行四边形机构，前臂12的下端与手掌15的下端铰接，三角状肘连杆11的第三端与第四连杆14的一端铰接，第四连杆14的另一端与手掌15的上端铰接，前臂、三角状肘连杆11、第四连杆14及手掌15构成第三个空间平行四边形机构；
[