永磁同步伺服电机电流环控制方法
【技术领域】
[0001]本发明涉及飞行器控制领域，具体而言，涉及一种永磁同步伺服电机电流环控制方法。
【背景技术】
[0002]对运载火箭及其有效载荷飞行器等的飞行控制执行闭环系统一般统称为机电伺服系统，机电伺服系统典型应用之一就是摇摆发动机或发动机喷管实现推力矢量控制，完成对火箭姿态的控制。固体火箭发动机以固体可燃烧药柱为燃料，具备存储时间长，维护性好，使用准备时间短，使用灵活等优点，是目前世界上主流的火箭发展方向之一。相应的，摇摆固体火箭发动机喷管的闭环控制伺服系统也是必备的控制系统设备。由于中大型固体火箭发动机推力矢量控制功率基本较大(五千瓦至十几千瓦以上)，固体火箭发动机推力矢量控制对伺服系统的控制精度、响应速度以及可靠性都有极高的要求，同时火箭控制系统对产品自身的重量、体积都有严格的要求。因此，在体积与重量等约束条件严格的条件下，实现伺服系统的精确控制和快速响应控制是一个关键的技术问题。
[0003]机电伺服系统主要由以下几个部分组成:机电传动机构、伺服电机、伺服控制驱动器、伺服动力电源。其中伺服动力电源为整个系统提供初级直流电能，伺服控制驱动器通过功率逆变电路，运行闭环控制算法，根据使用要求与系统状态信息，将伺服动力电源提供的直流电能逆变为三相交流电能，提供给伺服电机，而伺服电机作为整个系统的动力执行元件，输出转矩、转速机械功率，带动机电传动机构做功，实现推力矢量控制。
[0004]永磁同步伺服电机在运载火箭推力矢量控制中应用的实际上是三闭环控制方法，分别是电流环(力矩环)、速度环与位置环闭环控制。结合图1所示的典型的永磁同步伺服电机闭环控制原理图，最内环为电流环控制、中间环为速度环控制、最外环为位置环控制，三闭环共同作用，完成整个永磁同步伺服电机的位置伺服特性控制。
[0005]在三环闭环控制中，电流环闭环控制是速度环与位置环闭环控制的基础，也是决定系统稳定性、可靠性、控制精度与响应速度最关键的闭环控制，同时由于永磁同步伺服电机的非线性与耦合性，也是控制过程最复杂的闭环控制。如图2所示的永磁同步伺服电机与伺服控制驱动器连接原理图，应用于固体火箭推力矢量控制的永磁同步伺服电机由于对控制的精确度和响应的速度都有极高的要求，因此电流环控制需要采取创新的控制方法。
【发明内容】
[0006]本发明旨在提供一种提高控制精度和响应速度的永磁同步伺服电机电流环控制方法。
[0007]本发明提供了一种永磁同步伺服电机电流环控制方法，该方法包括将电流环控制解耦为交轴电流控制和直轴电流控制。
[0008]进一步地，交轴电流控制包括电阻补偿控制，电阻补偿控制包括:按照交轴电流指令的大小分为多个区间，且每个区间对应设置电阻补偿参数，将交轴电流指令与其所在的区间的电阻补偿参数的乘积作为电阻补偿控制的输出量。
[0009]进一步地，交轴电流控制还包括比例控制，比例控制包括:按照交轴电流指令的大小分为多个区间，且每个区间对应设置比例参数，将交轴电流指令与交轴反馈电流的差值与交轴电流指令所在的区间的比例参数的乘积作为比例控制的输出量。
[0010]进一步地，交轴电流控制还包括反电势补偿控制，反电势补偿控制包括:按照永磁同步伺服电机转速的大小分为多个区间，且每个区间对应设置反电势补偿参数，将永磁同步伺服电机转速与其所在的区间的反电势补偿参数的乘积作为反电势补偿控制的输出量。
[0011]进一步地，交轴电流控制还包括将电阻补偿控制的输出量、比例控制的输出量和反电势补偿控制的输出量按照逻辑或运算，得到交轴电流控制的输出量。
[0012]进一步地，直轴电流控制包括比例分段控制，按照直轴电流指令的大小分为多个区间，且每个区间对应设置比例参数，将直轴电流指令与直轴反馈电流的差值与直轴电流指令所在的区间的比例参数的乘积作为比例分段控制的输出量。
[0013]进一步地，直轴电流控制还包括积分控制，积分控制包括设置积分系数，将电流偏差与积分系数的积作为积分控制的输出量。
[0014]进一步地，直轴电流控制还包括将比例分段控制的输出量和积分控制的输出量按照逻辑或运算，得到直轴电流控制的输出量。
[0015]根据本发明的永磁同步伺服电机电流环控制方法，通过将电流环控制解耦为交轴电流控制和直轴电流控制，可以基本消除永磁同步伺服电机控制参数在调试过程中的耦合性，使电流环控制与直流有刷电机在调试过程中的难易程度基本相当，即有效地降低永磁同步伺服电机电流环控制的难度和复杂度，从而提高控制精度和响应速度。
【附图说明】
[0016]构成本申请的一部分的附图用来提供对本发明的进一步理解，本发明的示意性实施例及其说明用于解释本发明，并不构成对本发明的不当限定。在附图中:
[0017]图1是现有技术中的永磁同步伺服电机闭环控制方案原理图；
[0018]图2是现有技术中的永磁同步伺服电机与伺服控制驱动器连接原理图；
[0019]图3根据本发明的永磁同步伺服电机的交轴电流控制原理图；
[0020]图4根据本发明的永磁同步伺服电机的直轴电流控制原理图。
【具体实施方式】
[0021]下面将参考附图并结合实施例来详细说明本发明。
[0022]结合图3和图4所示，根据本发明的永磁同步伺服电机电流环控制方法，将电流环控制解耦为如图3所示的交轴(q轴)电流控制10和如图4所述的直轴(d轴)电流控制20，交轴电流与直轴电流会通过永磁同步电机本体进行耦合，在实际控制过程中不能完全解耦，只能尽最大可能完成解耦控制，将耦合性降到最低。
[0023]具体地，结合图3所示，以运载火箭的推力矢量控制为例，永磁同步伺服电机电流环的交轴(q轴)电流控制分为三个组成部分，每个组成部分分别实现不同的控制功能，三个组成部分最终以“或”的关系相加，其相加结果作为交轴(q轴)电流环的控制输出，共同完成交轴(q轴)的电流环闭环控制。这三个组成部分分别为电阻补偿控制11、比例控制12、与反电势补偿控制13，且都使用了非线性分段补偿的控制方法。
[0024]交轴(q轴)电流控制的电阻补偿控制11可以实现在不使用积分控制的条件下，完成交轴(q轴)电流的无静差跟随。由于交轴电流控制取消了积分控制作为内环控制，可以提高系统的响应速度与稳定性，提高系统的带宽。其方法为根据实际的物理系统存在死区等非线性，电阻补偿控制11使用的非线性分段控制方法为根据交轴电流指令的大小，分为多个区间，一般以每15A作为一个区间，每个区间设置不同的补偿参数，用交轴电流指令乘以相对应的补偿参数即为电阻补偿控制11的输出量，采用电阻补偿控制11可以更精确的满足交轴(q轴)电流的跟随情况。即在永磁同步伺服电机转子轴抱死的情况下，在无比例控制12等其他任何控制的情况下，在任何电流指令的输入条件下，均可实现交轴(q轴)电流的准确跟随。
[0025]交轴(q轴)电流控制的比例控制12可以实现交轴(q轴)电流的控制的快速性。其方法为针对推力矢量控制对永磁同步伺服电机的电流控制快速性要求，比例控制12采取了非线性分段控制的方法，根据交轴电流指令的大小，分为多个区间，一般为每15A作为一个区间，每个区间设置不同的比例系数，用电流偏差(即交轴电流指令与交轴反馈电流的差值)乘以比例系数即为比例控制12的输出量，这一方法可以更精确的满足交轴(q轴)电流快速响应的要求，在控制过程中，实现电流的快速跟随，同时电流控制稳定，无振荡环节出现。
[0026]交轴(q轴)电流