[发明专利]机械手臂教导控制系统

摘要

本发明公开了机械手臂教导控制系统，包含操作接口装置、控制装置以及机械手臂，操作接口装置与所述控制装置连接，操作接口装置用以控制所述控制装置，控制装置与机械手臂连接，机械手臂包含至少一马达驱动部和一末端执行器，马达驱动部用以驱动机械手臂，控制系统包括动态学习模块、教导记忆模块、路径优化模块及路径执行模块，由动态学习模块产生的学习动态模型，教导记忆模块产生机械手臂学习后的路径，以路径优化模块的调整，以使路径执行模块准确的执行使用者所需要的运动路线。具有机械手臂动态模型学习与补偿的功能，使用者可直接进行教导，且不需外加传感器，不需使用教导盒，减少生产成本。

主权项

机械手臂教导控制系统，其特征在于：包含操作接口装置、控制装置以及机械手臂，所述操作接口装置与所述控制装置连接，所述操作接口装置用以控制所述控制装置，所述控制装置与机械手臂连接，所述机械手臂包含至少一马达驱动部和一末端执行器，所述马达驱动部用以驱动机械手臂；所述控制装置包含动态学习模块、教导记忆模块以及路径执行模块，所述动态学习模块，包括：数据读取部，用以读取控制装置的数据设定文件；第一命令生成部，根据数据设定文件建立学习轨迹模型；第一命令输出部，根据学习轨迹模型，计算出每一个马达的位置命令并输出至马达驱动部，其中马达驱动部根据每一马达的位置命令产生一马达扭矩回授；动态模型计算部，根据学习轨迹模型及马达扭矩回授得到机械手臂的学习动态模型；动态模型记忆部，用以储存机械手臂的学习动态模型；所述教导记忆模块，包含动态补偿单元和机构转换单元，动态补偿单元，包括：动态模型读取部，用以读取储存在动态模型记忆部中的机械手臂的学习动态模型；扭矩命令计算部，根据动态模型记忆部所储存的机械手臂的学习动态模型及马达驱动部所量测的马达位置讯号形成一扭矩命令讯号；扭矩命令输出部，接收扭矩命令计算部所形成的扭矩命令讯号并产生扭矩命令输出至马达驱动部；其中马达驱动部处理由扭矩命令输出部所获得的扭矩命令讯号驱动机械手臂，并生成马达位置讯号，回传至扭矩命令计算部处理，以形成一闭回路的动态补偿；机构转换单元，包括：机构转换计算部，根据马达位置回授讯号与机械手臂的机构参数计算出机械手臂的末端执行器的第一位置点；路径记忆部，将机械手臂的末端执行器的第一位置点储存于为机械手臂的操作路径；所述路径执行模块，包括：路径读取部，用以读取储存在路径记忆部的机械手臂的操作路径；第二命令生成部，根据执行机械手臂的一执行轨迹曲线及末端执行器的位置以计算出每一马达的位置命令；第二命令输出部，将第二命令生成部生成的每一马达的位置命令输出至马达驱动部，机械手臂将第二命令输出部输出的数据以驱动机械手臂执行操作路径。