一种用于机器人力矩控制的微分控制电路及控制方法技术

本发明专利技术公开了一种用于机器人力矩控制的微分控制电路及控制方法

【技术实现步骤摘要】
一种用于机器人力矩控制的微分控制电路及控制方法


[0001]本专利技术涉及力矩控制
，尤其是一种用于机器人力矩控制的微分控制电路及控制方法
。

技术介绍

[0002]机器人在完成一些与环境存在力发生作用的任务如打磨
、
装配工作时，采用单纯的位置控制会由于位置误差而引起过大的作用力，从而对零件或机器人产生伤害
。
为了避免这类伤害，当机器人在这类受限环境中运作时，除了对机器人进行位置控制外，还要对机器人进行力矩控制
。
[0003]常规的机器人力矩控制主要通过
PID
控制器实现，将
PID
控制器的微分项置0，仅使用比例参数和积分参数两项进行控制，然而单纯的
PI
控制容易造成电流变化过快或过慢的问题，同时控制精度也不达预期，因此无法实现多个电机协同的力矩控制
。

技术实现思路

[0004]有鉴于此，本专利技术实施例提供一种用于机器人力矩控制的微分控制电路及控制方法
。
[0005]本专利技术的第一方面提供了一种用于机器人力矩控制的微分控制电路，其特征在于，包括
PI
控制器
、
电流微分环和受控电机；所述
PI
控制器
、
电流微分环和受控电机组成用于力矩控制的电流环；所述电流环以期望电流值为输入
、
实际电流值为输出；
[0006]所述
PI
控制器以所述期望电流值与上一时刻所述实际电流值的电流差为输入，对所述电流差进行比例积分控制后输出参考电流值；
[0007]所述电流微分环以所述参考电流值为输入，进行微分反馈后输出微分电流值；
[0008]所述受控电机以所述微分电流值为输入，驱动电机运转形成实际电流值并输出
。
[0009]进一步地，所述电流微分环包括顺序连接的微分单元和微分器；所述微分单元以所述参考电流值和上一时刻微分电流值的电流微分差值为输入，添加微分偏置后输入微分器进行微分运算，得到微分电流值输出
。
[0010]进一步地，所述期望电流值表示对机器人进行力矩控制最理想的电流值；所述实际电流值表示上一时刻电机实际输出的电流值；所述期望电流值与所述实际电流值的电流差以如下形式表示：
[0011]e
i
(t)
＝
I0(t)
‑
I(t)
[0012]其中
I0(t)
是期望电流值，
I(t)
是实际电流值；
t
表示时间
。
[0013]进一步地，所述所述
PI
控制器以如下形式表示：
[0014][0015]其中
K
p
是所述
PI
控制器的比例参数，
K
i
是所述
PI
控制器的积分参数，
K
d
是所述
PI
控制器的微分参数，
t
表示时间；
[0016]当取
K
d
＝0时，所述
PI
控制器对所述电流差进行比例积分控制后得到的参考电流值以如下形式表示：
[0017][0018]其中
μ
(t)
表示参考电流值
。
[0019]进一步地，所述参考电流值表示所述
PI
控制器所输出的电流补偿值，所述所述参考电流值和上一时刻微分电流值的电流微分差值以如下形式表示：
[0020]e
u
(t)
＝
μ
(t)
‑
μ
‘
(t)
[0021]所述微分器进行微分运算得到的微分电流值输出以如下形式表示：
[0022][0023]其中
μ
'(t)
表示微分电流值，
K'
d
表示所述微分器的微分参数值
。
[0024]进一步地，所述受控电机输出实际电流值后，将实际电流值与预设的转矩系数相乘，得到用于控制机器人的目标力矩：
[0025]F
＝
K
c
×
I(t)
[0026]其中，
F
是目标力矩，
K
c
是电机转矩系数，
I(t)
是实际电流值
。
[0027]本专利技术第二方面一种用于机器人力矩控制的微分控制方法，应用于所述的一种用于机器人力矩控制的微分控制电路，包括以下步骤：
[0028]设定力矩分配策略，根据所述力矩分配策略确定每个微分控制电路的期望电流值；
[0029]将所述期望电流值输入微分控制电路，得到实际电流值；
[0030]将所述实际电流值转化为力矩并作用于机器人上
。
[0031]进一步地，所述将所述实际电流值转化为力矩并作用于机器人上，具体包括以下步骤：
[0032]将实际电流值与预设的转矩系数相乘，得到用于控制机器人的目标力矩：
[0033]F
＝
K
c
×
I(t)
[0034]其中，
F
是目标力矩，
K
c
是电机转矩系数，
I(t)
是实际电流值；
[0035]使用所述目标力矩对机器人进行控制
。
[0036]进一步地，所述力矩分配策略包括平均分配
、
线性分配和非线性分配；当所述力矩分配策略为平均分配时，每个所述微分控制电路的期望电流值设置为相同值；当所述力矩分配策略为线性分配时，所述微分控制电路的期望电流值呈线性递增关系；当所述力矩分配策略为非线性分配时，所述微分控制电路的期望电流值根据预设非线性关系函数确定
。
[0037]本专利技术实施例还公开了一种计算机程序产品或计算机程序，该计算机程序产品或计算机程序包括计算机指令，该计算机指令存储在计算机可读存储介质中
。
计算机设备的处理器可以从计算机可读存储介质读取该计算机指令，处理器执行该计算机指令，使得该计算机设备执行前面的方法
。
[0038]本专利技术的实施例具有如下有益效果：本专利技术在
PI
控制器的电流环之下增加了电流微分环，通过电流微分环检测电流环的动态特性，防止电流变化过快过慢，提高系统稳定性的同时也确保了实际输出电流的精度
。
本专利技术兼容多个电机协同进行力矩控制，针对每个
电机分别设置一个电流微分环，能够使得每个电机更好地完成力矩分配
。
[0039]本专利技术的附加方面和优点将在下面的描述部分中给出，部分将从下面的描述中变得明显，或通过本专利技术的实践了解到
。
附图说明<本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.
一种用于机器人力矩控制的微分控制电路，其特征在于，包括
PI
控制器
、
电流微分环和受控电机；所述
PI
控制器
、
电流微分环和受控电机组成用于力矩控制的电流环；所述电流环以期望电流值为输入
、
实际电流值为输出；所述
PI
控制器以所述期望电流值与上一时刻所述实际电流值的电流差为输入，对所述电流差进行比例积分控制后输出参考电流值；所述电流微分环以所述参考电流值为输入，进行微分反馈后输出微分电流值；所述受控电机以所述微分电流值为输入，驱动电机运转形成实际电流值并输出
。2.
根据权利要求1所述的一种用于机器人力矩控制的微分控制电路，其特征在于，所述电流微分环包括顺序连接的微分单元和微分器；所述微分单元以所述参考电流值和上一时刻微分电流值的电流微分差值为输入，添加微分偏置后输入微分器进行微分运算，得到微分电流值输出
。3.
根据权利要求2所述的一种用于机器人力矩控制的微分控制电路，其特征在于，所述期望电流值表示对机器人进行力矩控制最理想的电流值；所述实际电流值表示上一时刻电机实际输出的电流值；所述期望电流值与所述实际电流值的电流差以如下形式表示：
e
i
(t)
＝
I0(t)
‑
I(t)
其中
I0(t)
是期望电流值，
I(t)
是实际电流值；
t
表示时间
。4.
根据权利要求3所述的一种用于机器人力矩控制的微分控制电路，其特征在于，所述所述
PI
控制器以如下形式表示：其中
K
p
是所述
PI
控制器的比例参数，
K
i
是所述
PI
控制器的积分参数，
K
d
是所述
PI
控制器的微分参数，
t
表示时间；当取
K
d
＝0时，所述
PI
控制器对所述电流差进行比例积分控制后得到的参考电流值以如下形式表示：
μ
(t)
＝
K
P
e
i
(t)+K
i
∫
0n
e
i
(t)dt
其中
μ
(t)
表示参考...

【专利技术属性】
技术研发人员：席宁，张家维，陈丽燕，王宇，张启毅，
申请(专利权)人：深圳市智能机器人研究院，
类型：发明
国别省市：