具有修正滚珠丝杠的伸缩量的功能的伺服控制装置制造方法及图纸

本发明专利技术提供一种具有修正滚珠丝杠的伸缩量的功能的伺服控制装置。即使在滚珠丝杠上移动的移动体位于任何位置，都能够高精度地控制该移动体的移动。伺服控制装置具有：生成伺服电动机的位置指令值的位置指令生成部；根据该位置指令值和编码器检测出的位置检测值生成伺服电动机的速度指令值的速度指令生成部；根据该速度指令值和编码器检测出的速度检测值生成伺服电动机的转矩指令值的转矩指令生成部；以及根据从伺服电动机到在滚珠丝杠上螺合的螺母的距离和转矩指令生成部生成的转矩指令值，求出滚珠丝杠的伸缩量，根据该伸缩量计算螺母的位置修正量的位置修正量计算部。

【技术实现步骤摘要】
【专利摘要】本专利技术提供一种具有修正滚珠丝杠的伸缩量的功能的伺服控制装置。即使在滚珠丝杠上移动的移动体位于任何位置，都能够高精度地控制该移动体的移动。伺服控制装置具有：生成伺服电动机的位置指令值的位置指令生成部；根据该位置指令值和编码器检测出的位置检测值生成伺服电动机的速度指令值的速度指令生成部；根据该速度指令值和编码器检测出的速度检测值生成伺服电动机的转矩指令值的转矩指令生成部；以及根据从伺服电动机到在滚珠丝杠上螺合的螺母的距离和转矩指令生成部生成的转矩指令值，求出滚珠丝杠的伸缩量，根据该伸缩量计算螺母的位置修正量的位置修正量计算部。【专利说明】具有修正滚珠丝杠的伸缩量的功能的伺服控制装置
本专利技术涉及伺服控制装置，特别涉及控制使用滚珠丝杠把伺服电动机的旋转运动变换为直线运动的进给轴的伺服控制装置。
技术介绍
—般，在使用滚珠丝杠的进给轴中，在使安装在该进给轴上的移动体的移动方向反转时,通过齿隙(机械的间隙)或者摩擦产生反转动作的延迟。为修正该反转时的延迟,通过对位置指令值给予与齿隙的量相当的位置修正量、对速度指令值给予用于补偿通过该摩擦产生的延迟的速度修正量，能够分别进行修正。另外，可以根据反转方向(从+方向向一方向或者反之)适宜变更这些修正量。使用滚珠丝杠的进给轴中的精度降低的原因，除了上述齿隙之外，还可以举出滚珠丝杠向轴方向的伸缩，为进行考虑这点的修正而提倡利用转矩的技术。例如在日本特开2000 - 172341号公报中，记载有“在根据从位置指令生成部输出的位置指令值，进行反馈控制以及前馈控制，由此控制电动机发生的转矩的控制系统中，因为构成为在电动机发生的转矩上或者在与该转矩相当的信号上乘以预定的常数后与位置指令值相加，所以通过对转矩进行常数倍这样简单的操作，能够通过电动机发生的转矩以相当于机械的刚性的弹簧伸缩的量修正对电动机的位置指令”。另外在日本特开2004 - 187432号公报中，记载有“根据通过负荷模型推定出的轴扭曲量或者伸缩量，修正应该减少轴扭曲量或者伸缩量的位置指令值”。再有在日本特开2003 - 058213号公报中，记载有“在上述方式I到8中，负荷修正部9把弹簧常数(刚性)设为固定值K0，但是在弹簧常数依存负荷I的位置Θ I而变动的情况下，也可以构成负荷修正部9把弹簧常数设为变量计算负荷转矩修正值27的数值控制盤晋” 目.ο滚珠丝杠，通过来自在滚珠丝杠上螺合的螺母等移动体的反力在轴方向伸缩。在需要移动体的高精度的定位精度的情况下，也需要考虑该伸缩量，但是因为该伸缩量根据从伺服电动机到移动体的距离变化，所以根据移动体加减速(特别是反转)的位置而产生精度恶化的问题。例如，在把比较接近伺服电动机的位置作为基准来求出位置修正量的情况下，在其附近能够进行高精度的控制，但是在离伺服电动机比较远的位置精度恶化。反之，在把离伺服电动机比较远的位置作为基准来求出位置修正量的情况下，在其附近能够进行高精度的控制，但是在比较接近伺服电动机的位置精度恶化。在日本特开2000 - 172341号公报中，在以与机械的刚性相当的弹簧伸缩的量来修正对电动机的位置指令时，暗示把常数倍的转矩加在位置指令值上的想法，但是不是进行考虑滚珠丝杠上的移动体的位置的修正。另外，在日本特开2004 — 187432号公报中，向负荷模型输入位置检测值和速度检测值而得到位置推定值，但是在求出位置推定值时未考虑转矩。进而在日本特开2003 - 058213号公报中，记载了考虑弹簧常数依存负荷的位置变动的情况，把弹簧常数作为变量计算负荷转矩的想法，但是未记载根据负荷的位置求出适当的位置修正量在反馈中利用的想法。
技术实现思路
因此，本专利技术的目的是提供一种伺服控制装置，即使在滚珠丝杠上移动的移动体位于任何位置，都能够高精度地控制该移动体的移动。为实现上述目的，本申请专利技术提供一种伺服控制装置，其使用在滚珠丝杠上连接的伺服电动机控制机床的进给轴，其中，具有:生成进给轴的位置指令值的位置指令生成部；检测上述伺服电动机的角度位置的位置检测部；根据上述位置指令生成部生成的位置指令值和上述位置检测部检测出的位置检测值生成上述伺服电动机的速度指令值的速度指令生成部；检测上述伺服电动机的速度的速度检测部；根据上述速度指令生成部生成的速度指令值和上述速度检测部检测出的速度检测值生成上述伺服电动机的转矩指令值的转矩指令生成部；根据上述滚珠丝杠的伸缩量计算在上述滚珠丝杠上螺合的移动体的位置修正量的位置修正量计算部，上述位置修正量计算部，根据从上述伺服电动机到上述移动体的距离和上述转矩指令生成部生成的转矩指令值，计算上述滚珠丝杠的伸缩量，根据计算出的上述滚珠丝杠的伸缩量计算上述位置修正量。在优选的实施方式中，伺服控制装置还具有距离计算部，其使用上述伺服电动机的角度位置计算从上述伺服电动机到在上述滚珠丝杠上螺合的移动体的距离。此外，距离计算部，也可以把从伺服电动机到在滚珠丝杠上螺合的移动体的距离作为从滚珠丝杠的伺服电动机侧的固定部到在上述滚珠丝杠上螺合的移动体的距离来计算。在优选的实施方式中，上述距离计算部，通过使用基于各结构元件的尺寸预先规定上述移动体和上述伺服电动机之间的距离、与上述滚珠丝杠的旋转角度位置的关系的参数，实时计算上述位置检测部检测出的上述伺服电动机的角度位置处的上述移动体与上述伺服电动机之间的距离。作为基于各结构元件的尺寸预先规定的参数，可以设定滚珠丝杠的直径、横截面面积或者杨氏模量。在优选的实施方式中，上述位置修正量计算部，在从上述伺服电动机到上述移动体的距离上乘以上述转矩指令值，进而乘以关于上述滚珠丝杠的第一系数，求出上述位置修正量。在优选的实施方式中，上述位置修正量计算部，对在从上述伺服电动机到上述移动体的距离上乘以关于上述滚珠丝杠的第一系数而得的积，相加关于连结上述伺服电动机和上述滚珠丝杠的联接器的第二系数，进而在得到的和上乘以转矩指令值，求出位置修正量。【专利附图】【附图说明】通过以下参照附图对于优选的实施方式的说明进一步明了本专利技术的上述或者其他的目的、特征以及优点。图1是与用伺服电动机驱动的进给轴一起表示本专利技术的实施方式的伺服控制装置的概要结构的图，图2是表示伺服控制装置的处理的一例的流程图，图3是表示未应用本申请专利技术以及齿隙修正的情况下的移动体的轨迹的一例的图表，图4是表示不应用本申请专利技术但是应用齿隙修正的情况下的移动体的轨迹的一例的图表，图5是表示应用本申请专利技术以及齿隙修正的情况下的移动体的轨迹的一例的图表，图6是表示螺母位于比较接近伺服电动机的位置的状态的图，图7是表示螺母位于比较远离伺服电动机的位置的状态的图，图8是表示在工作台上连结两个螺母的例子的图。【具体实施方式】图1表示本专利技术的伺服控制装置的基本结构。伺服控制装置10是使用与滚珠丝杠12连接的伺服电动机14控制机床的进给轴的控制装置。在图示的例子中，滚珠丝杠12经由联接器16与伺服电动机14连结，通过伺服电动机14的旋转驱动，使在滚珠丝杠12上螺合的螺母18等移动体在滚珠丝杠12上沿其轴方向移动。另外，假定在螺母18上连接工作台20。伺服电动机14的旋转角度位置以及旋转角度，可以通过与伺服电动机14关联的编码器22等位置/速度检测部检测，检测出本文档来自技高网...

【技术保护点】
一种伺服控制装置（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）的伸缩量计算上述位置修正量。

【技术特征摘要】
...

【专利技术属性】
技术研发人员：岩下平辅，高山贤一，猪饲聪史，
申请(专利权)人：发那科株式会社，
类型：发明
国别省市：