[发明专利]一种多自由度机械手的控制系统

说明书

技术领域

本发明涉及一种机械手装置，特别是一种多自由度机械手的控制系统。

背景技术

随着工业自动化的发展，机械手在工业中得到了广泛的应用。机械手具有如下优势，一是安全性高。用人手进入模内取产品，如果注塑机故障或误按键造成合模，有夹伤手之危险，使用机械手能确保安全。二是能够提高效率和质量。三是降低产品不良率。刚成型产品温度过高，人员取出产品会造成手痕，产生不良品，因机械手使用特别治具取出，所以不会伤到产品。四是是节省人力和时间。五是节省原料，降低成本，人员取产品时间不定，原料的特殊性会造成产品缩水、变型，因机械手取出的时间固定，所以质量稳定。

然而现有技术中的机械手具有固有的缺陷，如机械手运动形式简单，仅能实现单一的操作。结构不够坚固，极容易被损坏。定位不精准，且控制性能低，不易被认为操作。

为解决现有技术中的缺陷，CN102229142A公开了一种五自由度电动机械手，该机械手采用摩擦轮电机和皮带轮电机制动的方式对机械手进行操控，结构相对简单，且可以实现多种运动形式，但由于电机制动不够灵活，导致该机械手定位不够准确，控制性能低，不易操作，而且手爪功能单一，应用效果不强。

发明内容

针对现有技术存在的缺点。本发明的目的在于提供一种多自由度机械手的控制系统，实现对机械手的精确控制，能够达到定位准确，控制性强，操作方便，用途广泛的技术效果。

本发明提供了一种多自由度机械手的控制系统，包括五自由度机械手和数控系统，所述数控系统包括计算机控制系统、24路伺服电机主电路板和五个伺服电机控制电路板，所述五自由度机械手包括底座、转台、大臂、小臂、手腕和手爪，所述底座与转台连接，转台与大臂通过肩部连接，大臂通过肘部与小臂连接，小臂通过腕部与手爪连接，其特征在于，所述底座与转台之间设置第一自由度，肩部设置第二自由度，肘部设置第三自由度，腕部设置第四自由度，手爪设置第五自由度；所述自由度由伺服电机实现，伺服电机由数控系统控制。

进一步优选，所述计算机控制系统和24路伺服电机主电路板位于底座内，五个伺服电机控制电路板分别设置于转台、手爪、肩部肘部和腕部中。

进一步优选，所述计算机控制系统和24路伺服电机主电路板通过串口线连接，24路伺服电机主电路板通过伺服电机连接线与五个伺服电机控制电路板连接。

进一步优选，所述计算机控制系统用于编程控制工作，采用3维立体虚拟编程系统，将程序通过串口线传输至24路伺服电机主电路板。

进一步优选，所述第一自由度为转台旋转、第二自由度为肩部升降、第三自由度为肘部升降、第四自由度为腕部升降、第五自由度为手爪夹紧。

进一步优选所述底座、转台、大臂、小臂、手腕和手爪的材质为铝合金。

进一步优选所述第二自由度的伺服电机的扭矩是第四自由度的伺服电机的扭矩的3 倍。所述第一自由度的伺服电机的扭矩是30kg.cm。

进一步优选所述机械手高度为400mm—600mm；所述机械手宽度为150mm—210mm。

进一步优选所述大臂的长度为150mm—200mm；所述小臂的长度为120mm—160mm。

进一步优选所述的手爪采用双推进机构，使手爪夹持角度始终保持在0度。

进一步优选所述手爪具有手指，所述手指与物品间加装垫片；所述手指的夹持力为10 公斤。

进一步优选所述机械手采用锂聚合物电池。

24路伺服电机主电路板采用单片机控制系统，将指令通过伺服电机连接线发送至五个伺服电机控制电路板。

五个伺服电机控制电路板采集指令并控制位于转台、手爪、肩部，肘部和腕部的伺服电机完成转台旋转、肩部升降、肘部升降、腕部升降和手爪夹紧等操作。

采用本发明的控制系统具有如下优点：采用伺服电机实现五个自由度，伺服电机由数控系统控制，操作方便，控制性强、运动灵活、关节力量大且定位准确；采用合金和ABS工程塑料材质，使机械手坚固耐用，使用寿命长；手爪采用双推进机构，并在手指与物品间加装垫片，增加手爪的应用范围，使机械手的用途更加广泛。

具体实施方式