一种球形电机三维力矩解耦与独立控制系统的制作方法
本发明涉及电机运动控制,具体是指一种球形电机三维力矩解耦与独立控制系统。
背景技术:
1、球形电机作为一类集成偏航、俯仰、滚转三轴运动输出的多自由度电磁执行机构,摒弃传统串联多轴电机机械传动结构,依靠单台电机即可实现三维空间姿态调节,具备结构紧凑、响应速度快、动态集成度高等优势,是人形机器人肩/髋关节、小型航天器姿态调整装置的核心驱动部件。
2、球形电机内部布置多相分布式绕组,单一组绕组通入激励电流会同时在偏航、俯仰、滚转三个自由度产生力矩输出,三轴力矩与多相绕组电流之间存在强耦合效应,三轴运动相互干扰,是制约球形电机高精度控制落地的核心瓶颈。现有主流球形电机控制方案存在如下固有缺陷:
3、传统控制策略直接采用多绕组电流统一调节方式,未建立标准化力矩-电流耦合数学模型,调整任意一轴目标力矩时,其余两轴力矩会同步产生偏移,姿态稳态误差大,无法满足机器人精准运动、精密平台稳像等高精度工况需求。
4、现有控制方法仅满足力矩输出约束,未对多相绕组电流幅值做优化约束,各相绕组电流幅值分布无序,绕组铜耗无最低化控制逻辑,电机持续运行发热严重、能量转换效率低,大幅缩短球形电机连续工作时长。
5、球形电机转子姿态实时改变,气隙磁场等效分布、绕组空间耦合系数随转子位置非线性变化,传统固定解耦矩阵方案无法实时更新耦合参数,电机大角度偏转工况下解耦效果急剧衰减,三轴耦合误差显著增大。
6、现有开环解耦架构未引入力矩反馈闭环,建模误差、外部机械扰动、电磁参数温漂会持续引入力矩偏差;同时缺少绕组故障容错逻辑,任一相绕组断路/短路故障后,系统直接丧失三轴力矩调节能力,设备可靠性、容错性不足。
7、传统控制方案三轴力矩无法独立解耦输出,上层运动控制器无法单独下发单轴力矩指令,运动规划算法需额外解耦运算,增加主控芯片算力负担,运动控制架构兼容性差。
8、综上,现有球形电机控制技术难以同时实现三轴独立力矩控制、低损耗运行、全姿态高精度解耦、故障容错闭环调节,行业亟需一套完整、可工程落地的三维力矩解耦与独立控制软硬件系统。
技术实现思路
1、本发明要解决的技术问题是本发明提供一种球形电机三维力矩解耦与独立控制系统,基于气隙磁场精准建模构建动态力矩-电流耦合矩阵,通过矩阵逆变换实现三轴完全解耦,依托绕组冗余自由度完成最小铜耗电流优化分配,配套实时力矩闭环补偿与绕组容错控制单元,实现偏航、俯仰、滚转三轴力矩独立、精准、高效、可靠控制。
2、为解决上述技术问题,本发明提供的技术方案为:一种球形电机三维力矩解耦与独立控制系统,其特征在于:包括沿信号流向依次连接的目标力矩输入模块、磁场分布模型与耦合矩阵构建模块、解耦变换模块、多相绕组电流最优分配模块、电流指令输出模块;还设有闭环调节的力矩反馈补偿模块;
3、所述目标力矩输入模块,用于接收上层运动控制器下发的球形电机三轴目标力矩,三轴目标力矩包括偏航力矩、俯仰力矩和滚转力矩,输出滤波平滑后的三轴目标力矩向量;
4、所述磁场分布模型与耦合矩阵构建模块,分别连接所述目标力矩输入模块、球形电机转子位置传感器与解耦变换模块,用于采集转子实时姿态角,基于预存气隙磁场模型动态更新参数,构建反映各相绕组电流与三轴力矩耦合关系的力矩-电流耦合矩阵;
5、所述解耦变换模块,用于对实时更新的耦合矩阵求逆或伪逆得到解耦变换矩阵,通过解耦运算将三轴目标力矩向量转换为多相绕组期望电流向量,消除三轴力矩交叉耦合,实现三轴力矩独立控制;
6、所述多相绕组电流最优分配模块,输入端连接解耦变换模块,用于以绕组总铜耗最小为优化目标,利用多相绕组冗余自由度求解满足三轴力矩约束的最优绕组电流分配方案;
7、所述电流指令输出模块,连接多相绕组电流最优分配模块与球形电机功率驱动器,用于输出最优分配后的各相绕组电流驱动指令;
8、所述力矩反馈补偿模块分别与目标力矩输入模块、电流指令输出模块、球形电机力矩检测单元连接,用于采集三轴实际输出力矩,计算力矩偏差并映射为电流修正量叠加至绕组电流指令,实现闭环力矩补偿。
9、进一步地,所述磁场分布模型与耦合矩阵构建模块中的力矩-电流耦合矩阵维度为3×n,n为球形电机绕组相数;耦合矩阵内每个元素由球形电机气隙磁场磁通密度、绕组有效匝数、绕组空间排布角度、转子实时三维姿态角共同计算确定;转子姿态角每更新一次,模块同步重新求解耦合矩阵。
10、进一步地,所述解耦变换模块区分绕组冗余状态执行运算:当绕组相数n=3无冗余时,对耦合方阵直接求逆得到解耦矩阵;当绕组相数n>3存在冗余绕组时,对长耦合矩阵求解摩尔-彭若斯伪逆作为解耦变换矩阵;通过完成力矩到绕组期望电流的解耦转换。
11、进一步地,所述多相绕组电流最优分配模块内置最小铜耗优化求解单元,以绕组总铜耗为目标函数,以为等式约束,采用拉格朗日乘数法求解最优电流分配向量,在满足三轴力矩输出要求的前提下最小化绕组整体铜耗。
12、进一步地,所述多相绕组电流最优分配模块还内置容错控制单元;所述容错控制单元实时采集各相绕组电流反馈识别断路、短路故障;当检测到任意一相绕组故障时,剔除耦合矩阵中故障绕组对应列,基于剩余有效绕组子耦合矩阵重新求解解耦变换与最优电流分配方案,在降级模式下维持三轴力矩输出。
13、进一步地,所述力矩反馈补偿模块的力矩检测单元采用三轴力矩传感器或电磁力矩观测器两种方式采集实际三轴力矩;计算目标力矩与实际力矩的偏差向量,通过解耦变换矩阵将力矩偏差映射为各相绕组电流修正量,叠加至电流指令输出模块下发的基础电流指令实现闭环补偿,抵消建模误差与外部负载扰动。
14、进一步地,所述目标力矩输入模块内置数字低通滤波单元,对上层运动控制器下发的离散三轴力矩指令进行滤波降噪,输出连续平滑的力矩向量至磁场分布模型与耦合矩阵构建模块。
15、进一步地,所述电流指令输出模块集成pwm调制单元与过流保护单元,将数字最优电流指令转换为多路pwm驱动信号输出至功率驱动器,并限制单绕组最大工作电流。
16、本发明与现有技术相比的优点在于:
17、(1)基于磁场分布模型的力矩解耦算法有效消除三轴交叉耦合,实现三轴力矩的精确独立控制;
18、(2)多相绕组电流最优分配策略在满足力矩要求的前提下使铜耗最小,提高电机效率;
19、(3)解耦变换随转子位置实时更新,保证全运动范围内的解耦精度;
20、(4)力矩反馈补偿机制进一步消除建模误差和外部扰动,提高控制鲁棒性;
21、(5)绕组冗余自由度提供容错能力,某相绕组故障时仍可维持降级运行。
1.一种球形电机三维力矩解耦与独立控制系统,其特征在于,包括:
2.根据权利要求1所述的一种球形电机三维力矩解耦与独立控制系统,其特征在于:所述磁场分布模型与耦合矩阵构建模块中的力矩-电流耦合矩阵维度为3×n,n为球形电机绕组相数;耦合矩阵内每个元素由球形电机气隙磁场磁通密度、绕组有效匝数、绕组空间排布角度、转子实时三维姿态角共同计算确定;转子姿态角每更新一次,模块同步重新求解耦合矩阵。
3.根据权利要求2所述的一种球形电机三维力矩解耦与独立控制系统,其特征在于:所述解耦变换模块区分绕组冗余状态执行运算:当绕组相数n=3无冗余时,对耦合方阵直接求逆得到解耦矩阵;当绕组相数n>3存在冗余绕组时,对长耦合矩阵求解摩尔-彭若斯伪逆作为解耦变换矩阵。
4.根据权利要求3所述的一种球形电机三维力矩解耦与独立控制系统,其特征在于:所述多相绕组电流最优分配模块内置最小铜耗优化求解单元,以绕组总铜耗最小为优化目标,采用拉格朗日乘数法求解最优电流分配向量,在满足三轴力矩输出要求的前提下最小化绕组整体铜耗。
5.根据权利要求4所述的一种球形电机三维力矩解耦与独立控制系统,其特征在于:所述多相绕组电流最优分配模块还内置容错控制单元;所述容错控制单元实时采集各相绕组电流反馈识别断路、短路故障;当检测到任意一相绕组故障时,剔除耦合矩阵中故障绕组对应列,基于剩余有效绕组子耦合矩阵重新求解解耦变换与最优电流分配方案,在降级模式下维持三轴力矩输出。
6.根据权利要求5所述的一种球形电机三维力矩解耦与独立控制系统,其特征在于:所述力矩反馈补偿模块的力矩检测单元采用三轴力矩传感器或电磁力矩观测器两种方式采集实际三轴力矩;计算目标力矩与实际力矩的偏差向量,通过解耦变换矩阵将力矩偏差映射为各相绕组电流修正量,叠加至电流指令输出模块下发的基础电流指令实现闭环补偿,抵消建模误差与外部负载扰动。
7.根据权利要求6所述的一种球形电机三维力矩解耦与独立控制系统,其特征在于:所述目标力矩输入模块内置数字低通滤波单元,对上层运动控制器下发的离散三轴力矩指令进行滤波降噪,输出连续平滑的力矩向量至磁场分布模型与耦合矩阵构建模块。
8.根据权利要求7所述的一种球形电机三维力矩解耦与独立控制系统,其特征在于:所述电流指令输出模块集成pwm调制单元与过流保护单元,将数字最优电流指令转换为多路pwm驱动信号输出至功率驱动器,并限制单绕组最大工作电流。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com