[发明专利]一体化多轴同步运动控制系统及同步控制方法有效
申请号: | 202110456631.4 | 申请日: | 2021-04-27 |
公开(公告)号: | CN112994532B | 公开(公告)日: | 2021-11-02 |
发明(设计)人: | 张驰;王宝磊 | 申请(专利权)人: | 中国科学院宁波材料技术与工程研究所 |
主分类号: | H02P5/50 | 分类号: | H02P5/50;H02P21/22;H02P21/18 |
代理公司: | 南京利丰知识产权代理事务所(特殊普通合伙) 32256 | 代理人: | 王锋 |
地址: | 315201 浙江*** | 国省代码: | 浙江;33 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一体化 同步 运动 控制系统 控制 方法 | ||
1.一种多轴同步运动控制方法,其特征在于,包括如下步骤:
多轴同步电流环控制,包括单轴高速电流环控制、多轴并行流水同步电流环调度;
所述单轴高速电流环控制采用并行计算与串行计算相结合的带有PI调节器的空间矢量控制法,包括信号预处理阶段、单轴电流环控制计算阶段、单轴计算结果输出阶段;所述信号预处理阶段完成单轴电流环控制的数据预处理工作;所述单轴电流环控制计算阶段完成单轴电流环控制的数据计算工作;所述单轴计算结果输出阶段完成将单轴电流环控制计算结果输出到IPM功率模块;
所述多轴并行流水同步电流环调度包括信号统一预处理阶段,多轴电流环控制计算阶段、多轴计算结果统一输出阶段;所述信号统一预处理阶段并行完成多轴电流环控制的数据预处理工作;所述多轴电流环控制计算阶段,将电机轴进行分组,各轴组依次完成电流环控制的数据计算工作,每个轴组内各轴电流环控制的数据计算并行完成;多轴计算结果统一输出阶段完成将多轴电流环控制计算结果同时输出到IPM功率模块,实现时序级同步控制多轴电机;
多轴时序同步调度,包括多轴位置环控制误差计算、多轴位置环PI调节、多轴速度环控制误差计算、多轴速度环PI调节,轴组内各轴的位置环控制误差计算、多轴位置环PI调节、多轴速度环控制误差计算、多轴速度环PI调节并行完成,轴组间分时共享复用运算资源;
多轴响应同步控制,采用动态主从耦合同步前馈控制法,根据轨迹位置跟踪误差率确定动态主轴,并将其作为被跟踪轴,将其他轴作为调节跟踪轴,将被跟踪轴和调节跟踪轴的跟踪率相减结果作为同步控制误差,该误差经PD调节器运算后输出作为前馈值输出到电流环输入中;
其中,所述电流环控制的数据预处理工作依次包括前馈电流读取、速度环生成电流读取、反馈电流采样、编码器位置采样、电机速度计算、电角度计算、正余弦求解,在时序上共占用3个时间段;
所述电流环控制的数据计算工作依次包括CLARK变换,PARK变换、电流控制误差计算、电流环PI调节、PARK逆变换、SVPWM计算,在时序上共占用6个时间段。
2.如权利要求1所述的多轴同步运动控制方法,其特征在于,所述正余弦求解采用基于快速查表辅助的泰勒展开计算法,所述表为特殊结构的正余弦值表,表中共含有99个数组,每个数组保存了角度值、相应正弦值、相应余弦值,数组1-数组10保存角度值为表序列为0至0.9、步长为0.1的角度及其正余弦值,数组11-数组99保存角度值为表序列为1至89、步长为1的角度及其正余弦值;将待求解的角度值θ分解为整数部分θ1、小数部分第一位θ2和小数部分除第一位外的其他部分θ3,即θ=θ1+θ2+θ3;在表中分别查出θ1的正余弦值sinθ1、cosθ1和θ2的正余弦值sinθ2、cosθ2,最后由公式(3)计算θ的正余弦值:
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于中国科学院宁波材料技术与工程研究所,未经中国科学院宁波材料技术与工程研究所许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202110456631.4/1.html,转载请声明来源钻瓜专利网。