发明名称 一种步进电机步距角补偿方法
摘要 本发明涉及一种步进电机步距角补偿方法,其特征在于:设定细分驱动器的细分数和步距角;用精度比步进电机步距角高一个数量级的测量系统测量步距角变化;根据测量结果建立步距角误差模型,微步调整补偿步距角误差,精确控制步进电机转动位置;本发明同现有技术相比,可使步进电机细分数连续变化、无限细分、无级调速、且步进电机的细分倍数可达17179869184倍,可对步进电机的步距角进行灵活补偿且使步距角更加均匀,控制和驱动方式更加灵活,通过补偿前后实际测量结果表明,采用“微步调整虚拟补偿”进行步距角修正的效果非常显著。
申请公布号 CN102158161A 申请公布日期 2011.08.17
申请号 CN201110041034.1 申请日期 2011.02.21
申请人 中国人民解放军第二炮兵工程学院 发明人 谭立龙;张志利;仲启媛
分类号 H02P8/22(2006.01)I 主分类号 H02P8/22(2006.01)I
代理机构 代理人
主权项 1.一种步进电机步距角补偿方法,其特征在于:设定细分驱动器的细分数和步距角;用精度比步进电机步距角高一个数量级的测量系统测量步距角变化;根据测量结果建立步距角误差模型,微步调整补偿步距角误差,精确控制步进电机转动位置;具体步骤如下:步骤1:设定细分驱动器的细分数和步距角已知所使用的步进电机的齿距角为χ,设定的细分数N,则每一微步对应的微步距角<img file="FSA00000436570800011.GIF" wi="76" he="96" />设定步距角α,(<img file="FSA00000436570800012.GIF" wi="112" he="95" />并且是<img file="FSA00000436570800013.GIF" wi="52" he="96" />的整倍数),步进电机转过一个步距角α实际上需要走<img file="FSA00000436570800014.GIF" wi="113" he="116" />微步;式中:α-步距角;N-细分数N;χ-齿距角,与使用的步进电机有关;步骤2:用精度比步进电机步距角高一个数量级的测量系统测量位置误差δ<sub>n</sub>:步骤3:根据测量结果建立步距角误差误差模型δ(n);对应第n步,设实际位置与理想位置的误差为δ(n),则δ(n)可由测量列δ<sub>0</sub>、δ<sub>1</sub>、δ<sub>2</sub>、...、δ<sub>n-1</sub>通过傅里叶逼近得到,即:<maths num="0001"><![CDATA[<math><mrow><mi>&delta;</mi><mrow><mo>(</mo><mi>n</mi><mo>)</mo></mrow><mo>=</mo><munderover><mi>&Sigma;</mi><mrow><mi>k</mi><mo>=</mo><mn>0</mn></mrow><msub><mi>n</mi><mn>2</mn></msub></munderover><msub><mi>c</mi><mi>k</mi></msub><msup><mi>e</mi><mi>ink</mi></msup></mrow></math>]]></maths>式中:n<sub>2</sub>为傅里叶级数保留项,根据步进电机步距角周期性变化规律,一般取值为4,超高精度补偿时可取值到6;通过离散周期数据点的傅里叶逼近得到;<maths num="0002"><![CDATA[<math><mrow><msub><mi>c</mi><mi>k</mi></msub><mo>=</mo><mfrac><mn>1</mn><msub><mi>n</mi><mn>1</mn></msub></mfrac><munderover><mi>&Sigma;</mi><mrow><mi>n</mi><mo>=</mo><mn>0</mn></mrow><mrow><msub><mi>n</mi><mn>1</mn></msub><mo>-</mo><mn>1</mn></mrow></munderover><msub><mi>&delta;</mi><mi>n</mi></msub><msup><mi>e</mi><mrow><mo>-</mo><mi>ink</mi><mfrac><mrow><mn>2</mn><mi>&pi;</mi></mrow><msub><mi>n</mi><mn>1</mn></msub></mfrac></mrow></msup></mrow></math>]]></maths>(k=0,1,...,n<sub>2</sub>-1)步骤4:建立实际转动位置数学模型p(n);p(n)=nα+δ(n)步骤5:计算转动到第m步位置时,实际步距角,即求解方程nα+δ(n)=mα的根n<sub>0</sub>;步骤6:计算微步调整量p:<maths num="0003"><![CDATA[<math><mrow><mi>p</mi><mo>=</mo><mrow><mo>(</mo><msub><mi>n</mi><mn>0</mn></msub><mo>-</mo><mi>m</mi><mo>)</mo></mrow><mfrac><mi>&alpha;N</mi><mi>&chi;</mi></mfrac></mrow></math>]]></maths>步骤7:驱动器控制驱动步进电机实际转动<img file="FSA00000436570800022.GIF" wi="238" he="117" />个微步,实现位置的精确控制,补偿步距角不均匀造成的位置误差。
地址 710025 陕西省西安市灞桥区第二炮兵工程学院科研部