[实用新型]一种带运动控制器的小型高精度串联机械臂

说明书

本实用新型公开了一种带运动控制器的小型高精度串联机械臂，包括包括机械结构和运动控制器，所述运动控制器包括：轨迹计算器、上级微控制器、下级微控制器、运动补偿控制器、主动式动态平衡控制器、驱动单元、所述机械结构包括第1轴、第2轴、第3轴、第4轴、第5轴、第6轴、联轴器、锥齿器1、锥齿器2、6路滑环、三指灵巧手、14路滑环、5路滑环、五自由度电机安全套，本实用新型具有低成本、精度高、体积小且应用范围广、对机械臂本身刚度的依赖小的优点。

技术领域

本实用新型涉及机械臂技术领域，具体为一种带运动控制器的小型高精度串联机械臂。

背景技术

机械臂是一个多输入多输出、高度非线性、强耦合的复杂系统。因其独特的操作灵活性,已在工业装配、安全防爆等领域得到广泛应用。

串联机械臂是机械臂的一种。串联机械臂的精度取决于许多因素的交互影响，串联机械臂组成构件的尺寸误差、装配误差、运动部件间隙、运动轴线的歪斜、构件受力后产生的弹性变形、温度变化后所产生的热变形、摩擦磨损等原始误差，以及在实际操作过程中机械臂负载变化带来的尺寸延展变化等因素，都可能对串联机械臂造成几何偏差和运动偏差，从而影响串联机械臂的运动精度。由于产生的误差原因复杂，目前的运动控制器，尤其是小型、低成本运动控制器大多满足不了机械臂的精度要求。

部分带有高精度控制器的机械臂大都存在体积庞大、能耗高、算法复杂、开发难度大、成本居高不下的特点，对机械臂的民用化普及产生了阻碍。同时，能够达到相应精度的控制器除了上述对控制器本身的要求高以外，对机械臂的刚度也有更高的要求，这就使得要满足高精度要求，机械臂本身成本也居高不下。

实用新型内容

本实用新型的目的在于提供一种带运动控制器的小型高精度串联机械臂，采用控制器对机械臂进行控制，具有低成本、精度高、体积小且应用范围广、对机械臂本身刚度的依赖小的优点，解决了现有机械臂精度低、体积大的问题。

为实现上述目的，本实用新型提供如下技术方案：一种带运动控制器的小型高精度串联机械臂，包括包括机械结构和运动控制器，所述运动控制器包括：

轨迹计算器，用于接收机械结构的关节信息、位姿信息，并采用空间直线、圆弧等基本元素对机械臂在笛卡尔空间的运动轨迹进行规划，并根据任务空间的运动轨迹，将其转换至机械臂的关节空间，并通过逆运动学计算获取运动轨迹对应的关节空间内各关节位置相对时间的序列值；

上级微控制器，包括嵌入式微处理器，用于负责整个系统管理以及运动学计算、轨迹规划、主控逻辑、数字I/O和传感器信息处理等；

下级微控制器，包括嵌入式微处理器，用于轨迹插补计算、运动伺服控制；

运动补偿控制器，用于接收上级微控制器传来的规划后轨迹点位图，和下级微控制器传来的补差数据，然后采用实时预测补偿控制方法，将关节位置期望输入信号和跟踪位姿误差预测估计来控制变量补偿量，作为控制系统的参考输入，优化关节位置闭环控制系统，对机械臂末端执行器的位姿误差进行补偿，减小由连杆参数几何误差造成的积累误差；

主动式动态平衡控制器，包括力矩传感器、平衡机构，用于接受来自运动补偿控制器的补偿信号，采用力矩传感器测量机械臂在运动过程中产生的振动力矩，根据检测的振动力矩信号驱动平衡机构工作，验证该机构的动态性能以及其主动消振性能；

驱动单元，包括伺服电机，用于接受主动式动态平衡控制器的位姿信息），并驱动机械臂正常工作，所述伺服电机设置在各个轴的连接位置，

所述机械结构包括第1轴、第2轴、第3轴、第4轴、第5轴、第6轴、联轴器、锥齿器1、锥齿器2、6路滑环、三指灵巧手、14路滑环、5路滑环、五自由度电机安全套，所述第1轴与第2轴连接，第2轴与第3轴连接，第3轴与第4轴连接，第4轴与第5轴连接，第5轴与第6轴连接，第6轴与三指灵巧手连接；所述联轴器与五自由度电机安全套通过螺栓连接。