[发明专利]一种高速并联机器人的模糊前馈控制方法

说明书

本发明公开了一种高速并联机器人的模糊前馈控制方法，属于机器人运动控制领域，包括以下步骤，S1、确定输入及输出变量；S2、将各输入、各输出划分为3个区间，构建模糊规则；S3、采集S1中的三个输入变量并按照步骤S2定义的三个语言变量对其进行分类；然后，根据步骤S2定义的模糊规则进行推理，进而确定两个输出的语言变量；最后，将输出变量清晰化，得到速度与加速度前馈控制器参数的模糊调整量ΔK_vi与ΔK_ai，则可根据如下算法计算速度与加速度前馈控制器参数。本发明可利用简单的模糊规则实现前馈控制器参数的自动快速精确调节，进一步调高各驱动关节的跟随精度。

技术领域

本发明属于机器人运动控制领域，涉及机器人技术和自动化领域，可有效提高这种机器人在高速运行时的运动控制精度，尤其涉及一种高速并联机器人的模糊前馈控制方法。

背景技术

对于现代工业普遍采用的PID控制器，其优点是结构简单，方便计算，但动态控制性能较差，自适应能力有限。考虑到高速并联机器人通常执行高速、高加速度运动轨迹，对于精度要求极高。然而对于时变性的被控对象，固定增益的控制器很难满足高速并联机器人高精度的需求。模糊PID作为一种新型的智能控制器，具有较好的鲁棒性，但无法调节前馈控制器参数。在机器人系统高速、高加速度运行时，因前馈控制器参数整定不准确导致的跟随误差，严重降低关节跟随精度。因此，亟需在原有速度、加速度前馈控制器的基础上实施一种模糊前馈控制算法，实现前馈控制器参数的自动快速精确调节，进一步提高驱动关节的跟随精度。

发明内容

本部分的目的是在于概述本发明的实施例的一些方面以及简要介绍一些较佳实施例。在本部分以及本申请的说明书摘要和发明名称中可能会做些简化或省略以避免使本部分、说明书摘要和发明名称的目的模糊，而这种简化或省略不能用于限制本发明的范围。

鉴于上述背景技术描述中存在的问题，提出了本发明，因此，本发明其中一个目的是提供一种高速并联机器人的模糊前馈控制方法，可根据设定的接触刚度与阻尼自适应调节位置环与速度环的补偿信号，进而改善抛光质量，提高抛光效率。

2、为解决上述技术问题，本发明采用的技术方案是：一种高速并联机器人的模糊前馈控制方法，包括以下步骤，

S1、确定输入及输出变量；

采用三输入双输出的模糊控制结构：输入变量为驱动关节跟随误差e_i(i＝1,2,3,4)、关节速度关节加速度

输出变量为速度前馈控制器参数调整量ΔK_vi(i＝1,2,3,4)与加速度前馈控制器参数调整量ΔK_ai(i＝1,2,3,4)；

S2、构建模糊规则；

将各输入、各输出划分为3个区间，定义对应语言变量为NB-负大，ZO-零，PB-正大，则相应的模糊子集表示为{NB，ZO，PB}，定义模糊规则如下：

If e is PB and is PB and is PB，then ΔK_v is PB and ΔK_a is PB；

If e is PB and is PB and is NB，then ΔK_v is PB and ΔK_a is NB；

If e is PB and is PB and is ZO，then ΔK_v is PB and ΔK_a is ZO；

If e is PB and is NB and is PB，then ΔK_v is NB and ΔK_a is PB；