具体实施方式

为使本发明要解决的技术问题、技术方案和优点更加清楚，下面将结合附图及具体实施例进行详细描述。

本发明的实施例首先提供了一种机器人关节的电机速度环振荡抑制优化方法，如图1所示，该方法包括以下步骤：

建立机器人关节对应的永磁同步电机的数据模型；

根据所述永磁同步电机的数学模型，建立速度环PI控制器；

根据所述速度环PI控制器进行数据采集，获取速度反馈数据，判断所述机器人关节的运行状态，所述运行状态包括发生振荡或不发生振荡；

当所述运行状态为发生振荡时，将所述速度反馈数据反馈至所述速度环PI控制器，通过预设的速度环的PI参数优化算法，对所述速度环PI控制器的参数进行优化，以消除所述机器人关节的振荡状态。

本发明实施例中，将基于数据驱动的方法应用到永磁同步电机矢量控制系统速度环PI参数优化中，能够提高矢量控制系统的控制性能，解决了机器人关节在一些高精度控制工作场合振荡问题，从而显著提高机器人关节的控制性能。

进一步地，所述永磁同步电机的数据模型包括：

所述永磁同步电机的数学模型表示为：

其中，ω_r、i_d、i_q分别表示电机角速度、d轴电流、q轴电流，u_d为d轴电压，u_q为q轴电压，p_n为磁极对数，L为直轴与交轴电感，ψ_f为转子总磁链矢量，J为转动惯量，R_s为定子电阻，T_L为负载转矩，B为摩擦系数。

进一步地，根据所述永磁同步电机的数学模型，建立速度环PI控制器的过程如图2所示，其中，w_ref为速度给定值，T_oi为滤波时间常数，ASR为转速调节器，T为惯性环节综合时间常数，K_L,K_t为放大系数，J_m转动惯量，R_s定子电阻，B为摩擦系数，J_L为负载转动惯量，s表示拉氏变换，K_s为电流检测方法系数，T_i为速度环滤波时间常数，w_r为转子角速度，s表示拉氏变换。

进一步地，简化得到永磁同步电机矢量控制系统速度环PI控制器如图3所示。其中，w_ref为速度给定值，ASR为转速调节器，T为惯性环节综合时间常数，K_L,K_t为放大系数，J_m电子转子转动惯量，R_s定子电阻，B为摩擦系数，J_L为负载转动惯量，K_s为电流检测方法系数，T_i为速度环滤波时间常数，w_r为转子角速度，s表示拉氏变换。

进一步地，所述根据所述速度环PI控制器进行数据采集，包括：

设计动态数据采集窗口，窗口取值范围选取如下：根据电流环周期设定，每5个电流环周期计算一次速度环数据，以2000个速度环数据作为数据采集的取值范围，共计取数据2000个。

进一步地，所述获取速度反馈数据，判断所述机器人关节的运行状态，所述运行状态包括发生振荡或不发生振荡，包括：

根据所述速度反馈数据拟合出速度反馈曲线，如果发现所述速度反馈曲线发生超调振荡，即通过数据拟合的曲线上下波峰值均超出误差带的次数大于五次，则确定所述机器人关节的运行状态为发生振荡，否则为不发生振荡。

进一步地，所述通过预设的速度环的PI参数优化算法，对所述速度环PI控制器的参数进行优化，包括：

同时减少所述速度环PI控制器的比例系数P_w和积分系数I_w，每次减小1％，即P_w＝P_w*99％、I_w＝I_w*99％，直到所述机器人关节的运行状态为不发生振荡为止。

在前述机器人关节的电机速度环振荡抑制优化方法的具体实施方式中，进一步地，所述方法还包括：

将系统当前指标参数与系统给定指标参数进行比较，根据参数的比较结果，通过基于数据驱动算法的规则进行参数优化。

作为本发明的一种具体实施方式，如图4所示，采用电流内环，转速外环双闭环控制的过程为：将转速参考值ω^*与转速检测器检测到的电机角速度ω_r作差得到差值，差值通过速度控制器经过参数优化后输出的q轴电流参考值I_q*与q轴电流I_q作差，d轴电流参考值I_d ^*和d轴电流I_d作差，经过基于数据驱动的PI电流控制器得到控制电压d轴电压u_d和q轴电压u_q，u_d和u_q经过二相旋转坐标系到两相静止坐标系变换后，输出两相静止αβ坐标系下的控制电压值u_α和u_β，u_α和u_β经空间矢量脉宽调制(Space Vector Pulse Width Modulation，SVPWM)，将输出的三相电压控制信号输入逆变器，从而对永磁同步电机进行控制；逆变器输出的A、B、C三相电流值ia,ib,ic经过3s/2s(三相静止坐标系变换到二相静止坐标系)变换后输出两相静止αβ坐标系下的电流i_α,i_β，i_α,i_β经过2s/2r(两相静止坐标系变换到二相旋转坐标系)后输出d、q轴电流I_d,I_q,反馈至比较器，与电流参考值I_d ^*比较形成控制闭环。

作为本发明的一种具体实施方式，如图5所示，数据采集窗口算法流程为：比较这一时刻指令输出与指令给定若指令差值小于给定值Δ₁，认为系统进入稳态，在系统进入稳定状态的情况下，采集速度反馈数据，通过数据拟合的曲线上下波峰值连续五次均超出误差带Δ₂以上视为振荡，即峰值e_∞＞Δ₂，认为系统振荡，速度反馈拟合曲线每超过一次误差带计数器counter1加1，满5次进行一次参数调整，比例系数P减小百分之一，积分系数I减小百分之一。若发现速度给定变化，计数器counter1清零，重新采集数据，共采集2000个速度环数据，完成一次参数整定。

此外，本发明的实施例还提供了一种机器人关节的电机速度环振荡抑制优化装置，所述装置包括：

建立单元，用于建立机器人关节对应的永磁同步电机的数据模型；

所述建立单元，用于根据所述永磁同步电机的数学模型，建立速度环PI控制器；

判断单元，用于根据所述速度环PI控制器进行数据采集，获取速度反馈数据，判断所述机器人关节的运行状态，所述运行状态包括发生振荡或不发生振荡；

优化单元，用于当所述运行状态为发生振荡时，将所述速度反馈数据反馈至所述速度环PI控制器，通过预设的速度环的PI参数优化算法，对所述速度环PI控制器的参数进行优化，以消除所述机器人关节的振荡状态。

进一步地，所述永磁同步电机的数据模型包括：

所述永磁同步电机的数学模型表示为：

其中，ω_r、i_d、i_q分别表示电机角速度、d轴电流、q轴电流，u_d为d轴电压，u_q为q轴电压，p_n为磁极对数，L为直轴与交轴电感，ψ_f为转子总磁链矢量，J为转动惯量，R_s为定子电阻，T_L为负载转矩，B为摩擦系数。

进一步地，所述判断单元，用于：

根据电流环周期设定，每5个电流环周期计算一次速度环数据，以2000个速度环数据作为数据采集的取值范围，共计取数据2000个。

进一步地，所述判断单元，用于：

根据所述速度反馈数据拟合出速度反馈曲线，如果发现所述速度反馈曲线发生超调振荡，即通过数据拟合的曲线上下波峰值均超出误差带的次数大于五次，则确定所述机器人关节的运行状态为发生振荡，否则为不发生振荡。

进一步地，所述优化单元，用于：

同时减少所述速度环PI控制器的比例系数P_w和积分系数I_w，每次减小1％，即P_w＝P_w*99％、I_w＝I_w*99％，直到所述机器人关节的运行状态为不发生振荡为止。

综上所述，本发明提供的种基于数据驱动的机器人关节的电机速度环振荡抑制优化方法及装置，无需额外的硬件设备，通过直接在永磁同步电机矢量控制系统数学模型上进行设计，将系统当前指标参数与系统给定指标参数进行比较，根据参数的比较结果，判断机器人关节运动状态，通过基于数据驱动的规则进行参数优化，能够解决高精度控制场合机器人关机振荡的问题，提高系统控制性能。

本领域普通技术人员可以理解实现上述实施例的全部或部分步骤可以通过硬件来完成，也可以通过程序来指令相关的硬件完成，所述的程序可以存储于一种计算机可读存储介质中，上述提到的存储介质可以是只读存储器，磁盘或光盘等。

以上所述是本发明的优选实施方式，应当指出，对于本技术领域的普通技术人员来说，在不脱离本发明所述原理的前提下，还可以做出若干改进和润饰，这些改进和润饰也应视为本发明的保护范围。