一种用于机器人的动态调节电机的控制方法技术

本发明专利技术属于电机控制领域，具体说是一种用于机器人的动态调节电机的控制方法。包括以下步骤：1)实时采集电机输出信号，将实时反馈的电机输出信号作为k

【技术实现步骤摘要】
一种用于机器人的动态调节电机的控制方法


[0001]本专利技术属于电机控制领域，具体说是一种用于机器人的动态调节电机的控制方法。

技术介绍

[0002]在机器人中的电机控制领域，由于机器人的负载不同或机器人当前位置的不同，系统在启动和停止时，往往会有启动时间长、过冲等问题，传统的增益调节方法若想保证启动时间短，则会造成过冲等问题，若想避免过冲，则会使系统启动时间增长，传统方法无法同时保证较短的启动时间和避免过冲。为了提高系统的响应，缩短系统调整时间，防止系统过冲，为此设计了一种实时调节电机运行效果的方法。

技术实现思路

[0003]本专利技术目的是提供一种用于机器人的动态调节电机的控制方法，该方法适用于机器人在不同应用场景。机器人运行过程包括静止阶段、启动阶段、运行阶段、停止阶段。对于启动阶段和运行阶段，要求机器人具有快速跟踪性能和高响应性能，对于静止阶段和停止阶段，要求机器人具有高稳定性，具有抵抗外界扰动的能力。某些特殊场合要求停止阶段还需具有快速整定能力，要求整定时间短。
[0004]本专利技术为实现上述目的所采用的技术方案是：一种用于机器人的动态调节电机的控制方法，包括以下步骤：
[0005]1)实时采集电机输出信号，将实时反馈的电机输出信号作为k
‑
1时刻的电机输入信号Vin(k
‑
1)，机器人控制器的控制指令作为k时刻的输入信号Vin(k)；
[0006]2)构建多种不同的电机切换条件，并设置阈值系数，实现根据设定的阈值系数，选择满足要求的电机切换条件；
[0007]3)根据k
‑
1时刻的电机输入信号Vin(k
‑
1)和k时刻的输入信号Vin(k)，构建多种不同的控制模式；
[0008]4)根据机器人系统需要的应用场景，选取不同的电机切换条件，判断Vin(k)与阈值系数之间的关系，并在不同的切换条件中选择满足要求的不同的控制模式；
[0009]5)根据相应的控制模式获取输出信号Vout(k)。
[0010]所述步骤2)，构建多种不同的电机切换条件，具体为：
[0011]根据应用场景的不同，设置5个不同的切换条件，分别为：
[0012]切换条件A，用于表示当需要保证机器人系统在运行过程中系统稳定性；
[0013]切换条件B，用于表示当需要机器人系统对机器人控制器的控制指令进行快速的跟随；
[0014]切换条件C，用于表示需要保证机器人系统运行的平稳性，保证机器人末端的运行轨迹稳定；
[0015]切换条件D，用于表示当需要防止机器人系统响应滞后；
[0016]切换条件E，用于表示机器人系统未规定时刻到达目标位置。
[0017]所述步骤2)中，并设置阈值系数，实现机器人系统根据设定的阈值系数，选择满足要求的电机切换条件；具体为：
[0018]切换条件A：将机器人控制器的控制指令Vin(k)的变化作为阈值系数；
[0019]切换条件B：将k*Vref作为阈值系数，k表示切换等级，0<k<1；Vref为目标指令，用于根据控制指令Vin(k)得到控制电机的目标指令；
[0020]切换条件C：将k*dVref/dt作为阈值系数，k表示切换等级，0<k<1；其中，dVref/dt为目标指令的微分，用于对机器人进行平稳性判断；
[0021]切换条件D：将k*(Vref
‑
Vrefold)作为阈值系数，k表示切换等级，0<k<1；其中，Vrefold为前一时刻的目标指令；
[0022]切换条件E：将k*Vfbk作为阈值系数，k表示切换等级，0<k<1；Vfbk为实时采集的实际反馈值，包括位置、速度、电流中的某一种。
[0023]所述控制模式，包括：用于抑制振动的控制模式A、用于加快响应速度的控制模式B以及用于缩短整定时间的控制模式C。
[0024]所述步骤3)具体为：
[0025]控制模式A为：
[0026][0027]其中，Vin(k)为k时刻输入信号，Vin(k
‑
1)为k
‑
1时刻的输入，K1、I1为控制系数，Vout(k)为k时刻的输出信号；
[0028]控制模式B为：
[0029][0030]其中，K2、I2为调节系数，K2>K1。
[0031]步骤4)中，根据机器人系统需要的应用场景，选取不同的电机切换条件，判断Vin(k)与阈值系数之间的关系，并在不同的切换条件中选择满足要求的不同的控制模式；具体为：
[0032]当选择切换条件A时，判断机器人控制器的控制信号是否发生变化，若指令未发生变化，采用控制模式A，反之，采用控制模式B；
[0033]切换条件B中，判断Vin(k)与k*Vref之间的大小关系，若Vin(k)＜k*Vref，采用控制模式A，反之，采用控制模式B；
[0034]切换条件C中，判断Vin(k)与k*dVref/dt之间的大小关系，若Vin(k)＜k*dVref/dt，采用控制模式A，反之，采用控制模式B；
[0035]切换条件D中，判断Vin(k)与k*(Vref
‑
Vrefold)之间的大小关系，若Vin(k)＜k*Vref，采用控制模式A，反之，采用控制模式B；
[0036]切换条件E中，判断Vin(k)与k*Vfbk之间的大小关系，若Vin(k)＜k*Vref，采用控制模式A，反之，采用控制模式B。
[0037]所述切换条件还根据机器人系统的实际需要设置有迟滞时间，用于延长所述控制模式B的作用时间；当需要延长控制模式B的作用时间，设定迟滞时间以满足机器人系统的实际需要，反之，直接输出Vout(k)。
[0038]所述步骤5)具体为：
[0039]当机器人系统从运行阶段切换到停止阶段时，则切换相应的控制模式进行控制，得到的输出信号Vout(k)输出至机器人系统，以控制机器人系统的电机，进而对机器人系统进行动态控制；
[0040]反之，当机器人系统处于静止阶段或启动阶段的运行过程时，直接将输出信号Vout(k)发送至机器人系统。
[0041]所述根据相应的控制模式获取输出信号Vout(k)，具体为：
[0042]当机器人系统从运行阶段切换到停止阶段时，则采用切换控制模式C进行控制；其中，切换方式为：
[0043]设定控制模式C的控制时间，任意一种切换条件的输出信号Vout(k)作为控制模式C的Vin(k)；
[0044]当控制模式C作用时间未达到控制时间时，控制模式C得到输出信号Vout(k)传输至机器人系统；
[0045]当控制模式C作用时间达到控制时间后，将控制模式C切换至控制模式A，控制模式C中的Vin(k)切换至控制模式A中，作为控制本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种用于机器人的动态调节电机的控制方法，其特征在于，包括以下步骤：1)实时采集电机输出信号，将实时反馈的电机输出信号作为k
‑
1时刻的电机输入信号Vin(k
‑
1)，机器人控制器的控制指令作为k时刻的输入信号Vin(k)；2)构建多种不同的电机切换条件，并设置阈值系数，实现根据设定的阈值系数，选择满足要求的电机切换条件；3)根据k
‑
1时刻的电机输入信号Vin(k
‑
1)和k时刻的输入信号Vin(k)，构建多种不同的控制模式；4)根据机器人系统需要的应用场景，选取不同的电机切换条件，判断Vin(k)与阈值系数之间的关系，并在不同的切换条件中选择满足要求的不同的控制模式；5)根据相应的控制模式获取输出信号Vout(k)。2.根据权利要求1所述的一种用于机器人的动态调节电机的控制方法，其特征在于，所述步骤2)，构建多种不同的电机切换条件，具体为：根据应用场景的不同，设置5个不同的切换条件，分别为：切换条件A，用于表示当需要保证机器人系统在运行过程中系统稳定性；切换条件B，用于表示当需要机器人系统对机器人控制器的控制指令进行快速的跟随；切换条件C，用于表示需要保证机器人系统运行的平稳性，保证机器人末端的运行轨迹稳定；切换条件D，用于表示当需要防止机器人系统响应滞后；切换条件E，用于表示机器人系统未规定时刻到达目标位置。3.根据权利要求1所述的一种用于机器人的动态调节电机的控制方法，其特征在于，所述步骤2)中，并设置阈值系数，实现机器人系统根据设定的阈值系数，选择满足要求的电机切换条件；具体为：切换条件A：将机器人控制器的控制指令Vin(k)的变化作为阈值系数；切换条件B：将k*Vref作为阈值系数，k表示切换等级，0<k<1；Vref为目标指令，用于根据控制指令Vin(k)得到控制电机的目标指令；切换条件C：将k*dVref/dt作为阈值系数，k表示切换等级，0<k<1；其中，dVref/dt为目标指令的微分，用于对机器人进行平稳性判断；切换条件D：将k*(Vref
‑
Vrefold)作为阈值系数，k表示切换等级，0<k<1；其中，Vrefold为前一时刻的目标指令；切换条件E：将k*Vfbk作为阈值系数，k表示切换等级，0<k<1；Vfbk为实时采集的实际反馈值，包括位置、速度、电流中的某一种。4.根据权利要求1所述的一种用于机器人的动态调节电机的控制方法，其特征在于，所述控制模式，包括：用于抑制振动的控制模式A、用于加快响应速度的控制模式B以及用于缩短整定时间的控制模式C。5.根据权利要求1所述的一种用于机器人的动态调节电机的控制方法，其特征在于，所述步骤3)具体为：控制模式A为：
其中，Vin(k)为k时刻输入信号，Vin(k

【专利技术属性】
技术研发人员：宋吉来，刘世昌，栾显晔，梁亮，孙铭泽，王晓峰，
申请(专利权)人：山东新松工业软件研究院股份有限公司，
类型：发明
国别省市：