一种永磁球形电机四元数反馈线性化的运动控制方法技术

本发明专利技术涉及一种永磁球形电机四元数反馈线性化的运动控制方法,所适用的电机的定子线圈位于定子球壳内接正八面体的顶点、棱中点和面心处；永磁磁极的N、S极交替分布于转子球壳内接正六面体的顶点处，包括：根据PMSM定转子结构及洛伦兹法则，建立转子电磁转矩模型；根据PMSM定转子结构及楞次定律，建立定子反电动势模型；根据四元数特性，建立转子运动学模型；根据刚体牛顿‑欧拉旋转公式，建立转子动力学模型；根据运动学模型及动力学模型，建立PMSM整体运动模型；对整体运动模型进行坐标变换，得到解耦后的整体运动模型；对解耦后的整体运动模型进行反馈控制，得到闭环控制系统。

【技术实现步骤摘要】
一种永磁球形电机四元数反馈线性化的运动控制方法
本专利技术属于永磁球形电机控制
，尤其涉及一种将四元数及非线性系统解耦与电机运动特性相结合的控制算法。
技术介绍
传统多自由度执行器由多个单自由度直驱电机和复杂机械传动装置组合而成，体积大、控制精度差且易受到外界扰动影响。与传统多自由度执行器相比，永磁球形电机(PMSM)具有体积小、精度高、响应速度快等优点，在航空航天、工业自动化和智能机器人等领域具有广泛的应用前景。由于PMSM结构特殊且发展时间较短，目前尚无统一的控制理论，因此在实际运用之前建立科学合理的动力模型及控制方案至关重要。由于PMSM可以实现空间自由转动，为实施精确控制，需要对其转子位置进行准确描述。现有控制方法通常采用欧拉角作为球形电机的姿态描述量，但是当PMSM转动角度较大时，这种方法在控制过程中会周期性地出现奇异，增加了控制难度并且恶化了控制效果。此外，与传统电机定转子的平面排布不同，PMSM定转子为空间排布，转子磁场分布函数复杂，定子反电动势模型及转子电磁转矩模型与球形电机结构密切相关，使得PMSM数学模型具有强耦合、非线性等特点。
技术实现思路
本专利技术的目的是克服传统控制方法中由于采用欧拉角而产生的奇异，以及球形电机固有的轴间耦合，提出一种线性化的运动控制方法，技术方案如下：一种永磁球形电机四元数反馈线性化的运动控制方法，所适用的电机的定子线圈位于定子球壳内接正八面体的顶点、棱中点和面心处，共计26个；永磁磁极的N、S极交替分布于转子球壳内接正六面体的顶点处，共计8个，控制方法如下：(1)根据PMSM定转子结构及洛伦兹法则，建立转子电磁转矩模型：式中Ti,j为线圈j、磁极i作用下转子电磁转矩，T为所有线圈磁极共同作用时的转子整体电磁转矩，I为定子线圈电流矢量，G为描述转矩-电流关系的系数矩阵，ri和sj分别为磁极i和线圈j的单位位置矢量，θi,j为线圈j、磁极i间的夹角，f(θi,j)为转子磁场分布的拟合函数。(2)根据PMSM定转子结构及楞次定律，建立定子反电动势模型：式中Ei,j为单线圈单磁极下线圈反电动势，Ej和E分别为定子各线圈反电动势及定子整体反电动势，ω为线圈j、磁极i的相对角速度，g(θi,j)为定子线圈反电动势的拟合函数。(3)根据四元数特性，建立转子运动学模型：式中为q基于时间的导数，q＝[q0q1q2q3]T为姿态四元数，其中qi，i＝1,2,3为转子单位方向向量在XYZ轴上的投影，为姿态四元数补充值；ω＝[ωxωyωz]T为转子角速度矢量，其中ωx、ωy和ωz为转子角速度在XYZ轴上分量。此外，Q(q)为转子运动学模型关系矩阵；此外，根据刚体牛顿-欧拉旋转公式，建立转子动力学模型：式中J＝diag(Jx,Jy,Jz)为转子转动惯量矩阵，其中Jx、Jy和Jz分别为以X、Y和Z轴为旋转轴的转子转动惯量；T＝[TxTyTz]T为施加在转子上的转矩矢量，其中Tx、Ty和Tz分别为转矩矢量在XYZ轴上分量。(4)根据运动学模型及动力学模型，建立PMSM整体运动模型：式中a1＝(Jy-Jz)/Jx，a2＝(Jz-Jx)/Jy，a3＝(Jx-Jy)/Jz。(5)对整体运动模型进行坐标变换，得到解耦后的整体运动模型：式中yi＝qi,i＝1,2,3为输出量，vi为虚拟输入量。(6)对解耦后的整体运动模型实施反馈控制，得到闭环控制系统：式中Kp和Kd分别为比例系数矩阵及微分系数矩阵；y＝[y1y2y3]T和分别为实际输出矢量与期望矢量。本专利技术的技术效果如下：1、以四元数替代欧拉角作为球形电机姿态描述量，避免了欧拉角带来的转动奇异问题，降低了电机控制难度，优化了电机控制效果。2、采用反馈线性化方式对球形电机非线性的运动模型进行解耦处理，消除轴间耦合，最终得出简单二阶线性模型，便于后续增加优化算法。附图说明图1是PMSM结构示意图,(a)为定子，(b)为转子图中：1、永磁球形电机定子部分；101、定子线圈；102、定子球壳；2、永磁球形电机转子部分；201、永磁磁极；202、转子球壳。图2是电磁转矩ANSOFT仿真模型图3是电磁转矩拟合结果图4是反电动势拟合结果图5是PMSM整体模型图6是闭环控制框图图7是无扰动定点运动仿真结果图8是带扰动定点运动仿真结果图9是连续轨迹跟踪仿真结果图10是不连续轨迹跟踪仿真结果具体实施方式本专利技术提供了一种永磁球形电机四元数反馈线性化的运动控制方法，下面结合附图和仿真实例对本专利技术进行详细的描述。本专利技术具体实施步骤如下：1.本专利技术选择如图1所示永磁球形电机作为示例，电机包括定子部分1、转子部分2和支撑部件。定子部分1由定子线圈101和定子球壳102组成，其中定子球壳102所用材质为聚乳酸(PLA)，定子线圈101由PLA圆柱上绕制铜漆包线构成，且定子线圈101位于定子球壳102内接正八面体的顶点、棱中点和面心处，共计26个；转子部分2由永磁磁极201和转子球壳202组成，转子球壳202材质为PLA，永磁磁极201是圆柱型表面粘贴式稀土钕铁硼永磁体，N、S极交替分布于转子球壳202内接正六面体的顶点处，共计8个。此外，定转子间由支撑部件固定，以确保两者之间无摩擦。根据定转子结构参数，利用有限元软件ANSOFT建立单线圈单磁极模型，如图2所示。对定子线圈通1A电流条件下磁极所受电磁转矩进行仿真，并利用MATLAB对所得的电磁转矩进行多项式拟合，拟合结果如图3所示，所得拟合函数为：其中，f(θi,j)为电磁转矩拟合函数，θi,j为磁极线圈间夹角，pm为拟合多项式的各阶系数。根据洛伦兹力特性，可知电磁转矩与线圈电流大小成正比例关系，因此建立单线圈单磁极下电磁转矩模型为：其中，Ti,j为线圈j和磁极i作用时转子电磁转矩，ri和sj分别为磁极i和线圈j的单位方向矢量，ij为线圈j中所通电流。将上式转换为矩阵形式并采用叠加定理，可以得到所有线圈和磁极共同作用时转子整体电磁转矩模型为：其中，T为转子整体电磁转矩，I为定子线圈电流矢量，G为转矩-电流系数矩阵。若已知球形电机转矩，可通过：I＝G+T(4)求解所需定子电流，其中G+＝GT(GGT)-1为转矩矩阵G的广义逆。2.与步骤1类似，利用有限元软件ANSOFT建立单线圈单磁极模型，如图2所示。对定子线圈通恒定电流1A，转子旋转角速度为1rad/s条件下线圈反电动势进行仿真，并利用MATLAB对所得的反电动势进行多项式拟合，拟合结果如图4所示，所得拟合函数为：其中，g(θi,j)为反电动势拟合函数，lm为拟合多项式的各阶系数。根据楞次定律可知，线圈反电动势大小与线圈、磁极相对角速度成正比例关系，因此建立单线圈单磁极下线圈反电动势模型为：Ei,j＝g(θi,j)ω(6)其中，Ei,j为线圈j和磁极i作用时线圈中反电动势，ω为线圈j和磁极i的相对角速度。将上式转换为矩阵形式并采用叠加定理，可以得到定子整体反电动势模型为：其中，Ej和E分别为所有线圈及磁极作用时线圈j反电动势及定子反电动势矢量。此外，参考传统直流电机，建立PMSM电压方程：其中，U为定子电压矢量，R为定子电阻矢量，L＝diag(L1,L2,…L26)为定子电感矩阵。3.(1)建立PMSM运动学模型四元数最早由Hamilton提出，现在常用于表述三维本文档来自技高网...

【技术保护点】
一种永磁球形电机四元数反馈线性化的运动控制方法,所适用的电机的定子线圈位于定子球壳内接正八面体的顶点、棱中点和面心处，共计26个；永磁磁极202的N、S极交替分布于转子球壳内接正六面体的顶点处，共计8个。包括下列步骤：(1)根据PMSM定转子结构及洛伦兹法则，建立转子电磁转矩模型：

【技术特征摘要】
1.一种永磁球形电机四元数反馈线性化的运动控制方法,所适用的电机的定子线圈位于定子球壳内接正八面体的顶点、棱中点和面心处，共计26个；永磁磁极202的N、S极交替分布于转子球壳内接正六面体的顶点处，共计8个。包括下列步骤：(1)根据PMSM定转子结构及洛伦兹法则，建立转子电磁转矩模型：式中Ti,j为线圈j、磁极i作用下转子电磁转矩，T为所有线圈磁极共同作用时的转子整体电磁转矩，I为定子线圈电流矢量，G为描述转矩-电流关系的系数矩阵，ri和sj分别为磁极i和线圈j的单位位置矢量，θi,j为线圈j、磁极i间的夹角，f(θi,j)为转子磁场分布的拟合函数；(2)根据PMSM定转子结构及楞次定律，建立定子反电动势模型：式中Ei,j为单线圈单磁极下线圈反电动势，Ej和E分别为定子各线圈反电动势及定子整体反电动势，ω为线圈j、磁极i的相对角速度，g(θi,j)为定子线圈反电动势的拟合函数；(3)根据四元数特性，建立转子运动学模型：式中为q基于时间的导数，q＝[q0q1q2q3]T为姿态四元数，其中qi，i＝1,2,3为转子单位方向向量在XYZ轴上的投影，为姿态四元数补充值；ω＝[ωxωyωz]T为转子角速度矢量，其中ωx、ωy和ωz为转子角速度在XYZ...

【专利技术属性】
技术研发人员：李斌，李桂丹，邹志强，
申请(专利权)人：天津大学，
类型：发明
国别省市：天津,12