具有修正滚珠丝杠的伸缩量的功能的伺服控制装置制造方法
【专利摘要】本发明提供一种具有修正滚珠丝杠的伸缩量的功能的伺服控制装置。即使在滚珠丝杠上移动的移动体位于任何位置，都能够高精度地控制该移动体的移动。伺服控制装置具有：生成伺服电动机的位置指令值的位置指令生成部；根据该位置指令值和编码器检测出的位置检测值生成伺服电动机的速度指令值的速度指令生成部；根据该速度指令值和编码器检测出的速度检测值生成伺服电动机的转矩指令值的转矩指令生成部；以及根据从伺服电动机到在滚珠丝杠上螺合的螺母的距离和转矩指令生成部生成的转矩指令值，求出滚珠丝杠的伸缩量，根据该伸缩量计算螺母的位置修正量的位置修正量计算部。
【专利说明】具有修正滚珠丝杠的伸缩量的功能的伺服控制装置
【技术领域】
[0001]本发明涉及伺服控制装置，特别涉及控制使用滚珠丝杠把伺服电动机的旋转运动变换为直线运动的进给轴的伺服控制装置。
【背景技术】
[0002]—般，在使用滚珠丝杠的进给轴中，在使安装在该进给轴上的移动体的移动方向反转时,通过齿隙(机械的间隙)或者摩擦产生反转动作的延迟。为修正该反转时的延迟,通过对位置指令值给予与齿隙的量相当的位置修正量、对速度指令值给予用于补偿通过该摩擦产生的延迟的速度修正量，能够分别进行修正。另外，可以根据反转方向(从+方向向一方向或者反之)适宜变更这些修正量。
[0003]使用滚珠丝杠的进给轴中的精度降低的原因，除了上述齿隙之外，还可以举出滚珠丝杠向轴方向的伸缩，为进行考虑这点的修正而提倡利用转矩的技术。例如在日本特开2000 - 172341号公报中，记载有“在根据从位置指令生成部输出的位置指令值，进行反馈控制以及前馈控制，由此控制电动机发生的转矩的控制系统中，因为构成为在电动机发生的转矩上或者在与该转矩相当的信号上乘以预定的常数后与位置指令值相加，所以通过对转矩进行常数倍这样简单的操作，能够通过电动机发生的转矩以相当于机械的刚性的弹簧伸缩的量修正对电动机的位置指令”。
[0004]另外在日本特开2004 - 187432号公报中，记载有“根据通过负荷模型推定出的轴扭曲量或者伸缩量，修正应该减少轴扭曲量或者伸缩量的位置指令值”。
[0005]再有在日本特开2003 - 058213号公报中，记载有“在上述方式I到8中，负荷修正部9把弹簧常数(刚性)设为固定值K0，但是在弹簧常数依存负荷I的位置Θ I而变动的情况下，也可以构成负荷修正部9把弹簧常数设为变量计算负荷转矩修正值27的数值控制
盤晋”
目.ο
[0006]滚珠丝杠，通过来自在滚珠丝杠上螺合的螺母等移动体的反力在轴方向伸缩。在需要移动体的高精度的定位精度的情况下，也需要考虑该伸缩量，但是因为该伸缩量根据从伺服电动机到移动体的距离变化，所以根据移动体加减速(特别是反转)的位置而产生精度恶化的问题。例如，在把比较接近伺服电动机的位置作为基准来求出位置修正量的情况下，在其附近能够进行高精度的控制，但是在离伺服电动机比较远的位置精度恶化。反之，在把离伺服电动机比较远的位置作为基准来求出位置修正量的情况下，在其附近能够进行高精度的控制，但是在比较接近伺服电动机的位置精度恶化。
[0007]在日本特开2000 - 172341号公报中，在以与机械的刚性相当的弹簧伸缩的量来修正对电动机的位置指令时，暗示把常数倍的转矩加在位置指令值上的想法，但是不是进行考虑滚珠丝杠上的移动体的位置的修正。另外，在日本特开2004 — 187432号公报中，向负荷模型输入位置检测值和速度检测值而得到位置推定值，但是在求出位置推定值时未考虑转矩。
[0008]进而在日本特开2003 - 058213号公报中，记载了考虑弹簧常数依存负荷的位置变动的情况，把弹簧常数作为变量计算负荷转矩的想法，但是未记载根据负荷的位置求出适当的位置修正量在反馈中利用的想法。
【发明内容】
[0009]因此，本发明的目的是提供一种伺服控制装置，即使在滚珠丝杠上移动的移动体位于任何位置，都能够高精度地控制该移动体的移动。
[0010]为实现上述目的，本申请发明提供一种伺服控制装置，其使用在滚珠丝杠上连接的伺服电动机控制机床的进给轴，其中，具有:生成进给轴的位置指令值的位置指令生成部；检测上述伺服电动机的角度位置的位置检测部；根据上述位置指令生成部生成的位置指令值和上述位置检测部检测出的位置检测值生成上述伺服电动机的速度指令值的速度指令生成部；检测上述伺服电动机的速度的速度检测部；根据上述速度指令生成部生成的速度指令值和上述速度检测部检测出的速度检测值生成上述伺服电动机的转矩指令值的转矩指令生成部；根据上述滚珠丝杠的伸缩量计算在上述滚珠丝杠上螺合的移动体的位置修正量的位置修正量计算部，上述位置修正量计算部，根据从上述伺服电动机到上述移动体的距离和上述转矩指令生成部生成的转矩指令值，计算上述滚珠丝杠的伸缩量，根据计算出的上述滚珠丝杠的伸缩量计算上述位置修正量。
[0011]在优选的实施方式中，伺服控制装置还具有距离计算部，其使用上述伺服电动机的角度位置计算从上述伺服电动机到在上述滚珠丝杠上螺合的移动体的距离。此外，距离计算部，也可以把从伺服电动机到在滚珠丝杠上螺合的移动体的距离作为从滚珠丝杠的伺服电动机侧的固定部到在上述滚珠丝杠上螺合的移动体的距离来计算。
[0012]在优选的实施方式中，上述距离计算部，通过使用基于各结构元件的尺寸预先规定上述移动体和上述伺服电动机之间的距离、与上述滚珠丝杠的旋转角度位置的关系的参数，实时计算上述位置检测部检测出的上述伺服电动机的角度位置处的上述移动体与上述伺服电动机之间的距离。作为基于各结构元件的尺寸预先规定的参数，可以设定滚珠丝杠的直径、横截面面积或者杨氏模量。
[0013]在优选的实施方式中，上述位置修正量计算部，在从上述伺服电动机到上述移动体的距离上乘以上述转矩指令值，进而乘以关于上述滚珠丝杠的第一系数，求出上述位置
修正量。
[0014]在优选的实施方式中，上述位置修正量计算部，对在从上述伺服电动机到上述移动体的距离上乘以关于上述滚珠丝杠的第一系数而得的积，相加关于连结上述伺服电动机和上述滚珠丝杠的联接器的第二系数，进而在得到的和上乘以转矩指令值，求出位置修正量。
【专利附图】
【附图说明】
[0015]通过以下参照附图对于优选的实施方式的说明进一步明了本发明的上述或者其他的目的、特征以及优点。
[0016]图1是与用伺服电动机驱动的进给轴一起表示本发明的实施方式的伺服控制装置的概要结构的图，
[0017]图2是表示伺服控制装置的处理的一例的流程图，[0018]图3是表示未应用本申请发明以及齿隙修正的情况下的移动体的轨迹的一例的图表，
[0019]图4是表示不应用本申请发明但是应用齿隙修正的情况下的移动体的轨迹的一例的图表，
[0020]图5是表示应用本申请发明以及齿隙修正的情况下的移动体的轨迹的一例的图表，
[0021]图6是表示螺母位于比较接近伺服电动机的位置的状态的图，
[0022]图7是表示螺母位于比较远离伺服电动机的位置的状态的图，
[0023]图8是表示在工作台上连结两个螺母的例子的图。
【具体实施方式】
[0024]图1表示本发明的伺服控制装置的基本结构。伺服控制装置10是使用与滚珠丝杠12连接的伺服电动机14控制机床的进给轴的控制装置。在图示的例子中，滚珠丝杠12经由联接器16与伺服电动机14连结，通过伺服电动机14的旋转驱动，使在滚珠丝杠12上螺合的螺母18等移动体在滚珠丝杠12上沿其轴方向移动。另外，假定在螺母18上连接工作台20。伺服电动机14的旋转角度位置以及旋转角度，可以通过与伺服电动机14关联的编码器22等位置/速度检测部检测，检测出的位置以及速度分别可以作为位置反馈以及速度反馈利用。
[0025]伺服控制装置10具有:位置指令生成部24，用于遵照从未图示的上位控制装置或者外部输入装置等输入的程序或者命令，生成伺服电动机14的位置指令值；速度指令生成部26，用于根据位置指令生成部24生成的位置指令值和编码器22检测出的位置检测值(位置反馈值)生成伺服电动机14的速度指令值；转矩指令生成部28，用于根据速度指令生成部26生成的速度指令值和编码器22检测出的速度检测值(速度反馈值)生成伺服电动机14的转矩指令值；和位置修正量计算部32，用于根据从伺服电动机14到在滚珠丝杠12上螺合的螺母18的距离和转矩指令生成部28生成的转矩指令值求出滚珠丝杠12的伸缩量，根据该伸缩量计算螺母18的位置修正量。另外，伺服控制装置10还可以具有距离计算部30，用于使用伺服电动机14的位置，计算从伺服电动机14到滚珠丝杠12上的螺母18的距离L。
[0026]位置修正量计算部32，根据距离计算部30计算出的从伺服电动机14到螺母18的距离L、和转矩指令生成部28生成的转矩指令值计算滚珠丝杠12的伸缩量，根据计算出的滚珠丝杠12的伸缩量计算位置的修正量。下面说明其细节。
[0027]图2是说明使用伺服控制装置10进行对于伺服电动机14的指令的修正的处理的一例的流程图。首先在步骤SI，上述的位置指令生成部24生成进给轴的位置指令值。接着在步骤S2，使用编码器22等位置检测部检测伺服电动机14的位置反馈值。进而在步骤S3，上述的速度指令生成部26根据位置指令生成部24生成的位置指令值和编码器22检测出的位置反馈值生成用于伺服电动机14的速度指令值。
[0028]接着在步骤S4，使用编码器等速度检测部检测伺服电动机14的速度反馈值，进而在步骤S5，上述转矩指令生成部28根据速度指令生成部26生成的速度指令值和编码器22检测出的速度反馈值生成用于伺服电动机14的转矩指令值。[0029]接着在步骤S6，上述距离计算部30计算从伺服电动机14到螺母18的距离。例如，通过使用基于联接器16、滚珠丝杠12以及螺母18等各结构元件的尺寸等预先规定滚珠丝杠12上的螺母18 (的代表点)和伺服电动机14 (的代表点)之间的距离L (参照图1)、与伺服电动机14的旋转角度位置(或者滚珠丝杠12的旋转角度位置)的关系的参数(例如滚珠丝杠12的直径、横截面面积或者杨氏模量)，能够实时计算编码器22检测出的伺服电动机14的旋转角度位置处的距离L。或者距离计算部30，也可以代替从伺服电动机14到螺母18的距离，计算从位于伺服电动机侧的滚珠丝杠12的固定部到螺母18的距离。接着在步骤S7，根据在步骤S6计算出的距离L、和转矩指令生成部28生成的转矩指令值，计算滚珠丝杠12的轴方向的伸缩量，进而根据需要计算由于联接器16的旋转方向的扭曲而经由滚珠丝杠12产生的螺母18的定位误差量。下面说明其计算方法。
[0030]在与工作台20连结的螺母18通过伺服电动机14的旋转转矩在滚珠丝杠12上移动的情况下，通过来自螺母18的反力，轴方向的压缩力或者拉伸力作用，成为滚珠丝杠12中与从伺服电动机14 (联接器16)到螺母18的距离L相当的部分。因此，当设与距离L相当的部分的滚珠丝杠12的杨氏模量为E时，下式(I)成立。式中，k是与滚珠丝杠12的距离L相当的部分的弹簧常数，S是滚珠丝杠12的径向的横截面面积。
[0031]K=E.S/L(I)
[0032]伺服电动机14的旋转转矩T和滚珠丝杠12的伸缩量ε I的关系可以用下式(2)求出。式中，α I以及α I’是关于滚珠丝杠12的第一系数，具体说可以根据滚珠丝杠12的杨氏模量以及径向的横截面面积等求出。或者α I以及α I’也可以用实验方式求出。
[0033]
【权利要求】
1.一种伺服控制装置(10)，其使用在滚珠丝杠(12)上连接的伺服电动机(14)控制机床的进给轴，其特征在于， 具有: 生成进给轴的位置指令值的位置指令生成部(24)； 检测上述伺服电动机(14)的角度位置的位置检测部(22)； 根据上述位置指令生成部(24)生成的位置指令值和上述位置检测部(22)检测出的位置检测值，生成上述伺服电动机(14)的速度指令值的速度指令生成部(26)； 检测上述伺服电动机(14)的速度的速度检测部(22)； 根据上述速度指令生成部(26)生成的速度指令值和上述速度检测部(22)检测出的速度检测值，生成上述伺服电动机(14)的转矩指令值的转矩指令生成部(28);和 根据上述滚珠丝杠(12)的伸缩量计算在上述滚珠丝杠上螺合的移动体(18)的位置修正量的位置修正量计算部(32)， 上述位置修正量计算部(32)，根据从上述伺服电动机(14)到上述移动体(18)的距离和上述转矩指令生成部(28)生成的转矩指令值，计算上述滚珠丝杠(12)的伸缩量，根据计算出的上述滚珠丝杠(12)的伸缩量计算上述位置修正量。
2.根据权利要求1所述的伺服控制装置，其特征在于， 还具有:距离计算部(30)，其使用上述伺服电动机(14)的角度位置计算从上述伺服电动机(14)到在上述滚珠丝杠(12)上螺合的移动体(18)的距离。
3.根据权利要求2所述的伺服控制装置，其特征在于， 上述距离计算部(30)，通过使用基于各结构元件的尺寸预先规定上述移动体(18)和上述伺服电动机(14)之间的距离、与上述滚珠丝杠(12)的旋转角度位置的关系的参数，实时计算上述位置检测部(22)检测出的上述伺服电动机(14)的角度位置处的上述移动体(18)与上述伺服电动机(14)之间的距离。
4.根据权利要求1?3中任何一项所述的伺服控制装置，其特征在于， 上述位置修正量计算部(32)，在从上述伺服电动机(14)到上述移动体(18)的距离上乘以上述转矩指令值，进而乘以关于上述滚珠丝杠(12)的第一系数，求出位置修正量。
5.根据权利要求1?3中任何一项所述的伺服控制装置，其特征在于， 上述位置修正量计算部(32)，对将从上述伺服电动机(14)到上述移动体(18)的距离乘以关于上述滚珠丝杠(12)的第一系数而得的积相加关于连结上述伺服电动机(14)和上述滚珠丝杠(12)的联接器(16)的第二系数，进而在得到的和上乘以转矩指令值，求出位置修正量。
【文档编号】G05B19/18GK103454961SQ201310217502
【公开日】2013年12月18日 申请日期:2013年6月3日 优先权日:2012年6月4日
【发明者】岩下平辅, 高山贤一, 猪饲聪史 申请人:发那科株式会社