多轴马达同动控制系统及其方法与流程

文档序号:12277563阅读:来源:国知局

技术特征:

1.一种多轴马达同动控制系统,其包含有:

多个驱动轴,这些驱动轴互相连结,且其中任一个该驱动轴还包含有:

位置回路控制器,根据位置命令产生速度信号;

速度回路控制器,根据该速度信号产生速度命令;以及

马达,根据该速度命令运转;以及

同动校正装置,计算该马达的位置反馈信号及与其相邻的这些驱动轴的这些马达的位置反馈信号的平均值,并反馈至该位置回路控制器,藉此进行同动校正。

2.如权利要求1所述的多轴马达同动控制系统,其中该同动校正装置还将该平均值进行微分产生第一速度补偿值,并反馈至该速度回路控制器,藉此进行该同动校正。

3.如权利要求2所述的多轴马达同动控制系统,其中该同动校正装置包含第一加法器、除法器及第一微分器。

4.如权利要求2所述的多轴马达同动控制系统,其中任一个该驱动轴还包含同动补偿装置,其根据该驱动轴的该马达的位置反馈信号及与其相邻的这些驱动轴的这些马达的位置反馈信号产生第三速度补偿值,并反馈至该驱动轴的该速度回路控制器,藉此进行同动补偿。

5.如权利要求3所述的多轴马达同动控制系统,其中该第一加法器及该除法器计算该平均值,而该微分器对该平均值进行微分产生该第一速度补偿值。

6.如权利要求4所述的多轴马达同动控制系统,其中该同动补偿装置包含乘法器、第二加法器、第三加法器、积分器、第一转移函数控制器、第二转移函数控制器及比例积分控制器。

7.如权利要求4所述的多轴马达同动控制系统,其中任一个该驱动轴还包含前馈控制装置,其对该位置命令进行前馈控制以产生第四速度补偿值,并反馈至该驱动轴的该速度回路控制器,藉此进行前馈补偿。

8.如权利要求6所述的多轴马达同动控制系统,其中该乘法器将该驱动轴的该马达的位置反馈信号乘以整数倍以产生第一计算值,该第二加法器将该第一计算值减去与其相邻的这些驱动轴的这些马达的位置反馈信号以产生 第二计算值,该第一计算值通过该第一转移函数控制器处理后产生第三计算值,该第一计算值通过该积分器及该第二转移函数控制器处理后产生第四计算值,该第三加法器将该第三计算值及该第四计算值相加以产生第五计算值,该比例积分控制器根据该第五计算值产生该第三速度补偿值。

9.如权利要求7所述的多轴马达同动控制系统,其中该前馈控制装置包含第二微分器及第三转移函数控制器。

10.如权利要求7所述的多轴马达同动控制系统,任一个该驱动轴还包含第四加法器,其将该位置命令与该平均值相减以产生位置补偿值,并反馈至该驱动轴的该位置回路控制器以产生第二速度补偿值,并反馈至该驱动轴的该速度回路控制器。

11.如权利要求9所述的多轴马达同动控制系统,其中该位置命令通过该第二微分器及该第三转移函数控制器处理后产生该第四速度补偿值。

12.如权利要求10所述的多轴马达同动控制系统,其中任一个该驱动轴还包含第五加法器,其将该第二速度补偿值、该第三速度补偿值、该第四速度补偿值相加,并减去该第一速度补偿值,以产生总速度补偿值,并反馈至该驱动轴的该速度回路控制器。

13.如权利要求12所述的多轴马达同动控制系统,其中该速度回路控制器根据该总速度补偿值产生该速度命令,以控制该驱动轴的该马达的运转。

14.一种多轴马达同动控制方法,用于多轴马达同动控制系统,该多轴马达同动控制系统包含有多个驱动轴,这些驱动轴互相连结,该多轴马达同动控制方法包含下列步骤:

传送位置命令至各个该驱动轴的位置回路控制器以产生速度信号;

传送该速度信号至各个该驱动轴的速度回路控制器以产生速度命令以驱动各个该驱动轴的马达;

计算各个该驱动轴的马达的位置反馈信号及与其相邻的这些驱动轴的这些马达的位置反馈信号的平均值;以及

将各个该平均值分别反馈至对应的该驱动轴的该位置回路控制器,藉此对该多轴马达同动控制系统进行同动校正。

15.如权利要求14所述的多轴马达同动控制方法,还包含下列步骤:

将各个该平均值进行微分产生第一速度补偿值,并反馈至对应的该驱动轴的该速度回路控制器,藉此进行该同动校正。

16.如权利要求15所述的多轴马达同动控制方法,还包含下列步骤:

根据各个该驱动轴的该马达的位置反馈信号及与其邻近的这些驱动轴的这些马达的位置反馈信号产生第三速度补偿值,并反馈至对应的该驱动轴的该速度回路控制器,藉此对该多轴马达同动控制系统进行同动补偿。

17.如权利要求16所述的多轴马达同动控制方法,还包含下列步骤:

对该位置命令进行前馈控制以产生第四速度补偿值,并反馈至各个该驱动轴的该速度回路控制器,藉此进行前馈补偿。

18.如权利要求17所述的多轴马达同动控制方法,还包含下列步骤;

将该位置命令与各个该平均值相减以分别产生位置补偿值,并反馈至对应的该驱动轴的该位置回路控制器,以产生第二速度补偿值。

19.如权利要求18所述的多轴马达同动控制方法,还包含下列步骤;

将各个该驱动轴的该第二速度补偿值、该第三速度补偿值、该第四速度补偿值相加,并减去该第一速度补偿值,以分别产生总速度补偿值。

20.如权利要求19所述的多轴马达同动控制方法,还包含下列步骤;

将各个该总速度补偿值反馈至对应的该驱动轴的该速度回路控制器,以控制对应的该驱动轴的该马达的运转。

当前第2页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1