位置控制器

申请号 CN201410167494.2 申请日 2014-04-24 公开(公告)号 CN104158446B 公开(公告)日 2017-11-24
申请人 大隈株式会社; 发明人 前田将宏; 江口悟司;
摘要 一种 位置 控制器 ,其通过提供可变的摩擦补偿值计算单元根据滑动特性的变化而设置可变的摩擦补偿值,该摩擦补偿值计算单元包括:滑动 力 矩标准化计算单元1,标准化预定速度下的滑动力矩;补偿值放大比率计算单元2,基于标准化速度下的滑动力矩计算补偿值放大比率;以及乘法器3、4。
权利要求

1.一种位置控制器,其通过根据来自高层次控制器的位置命令值向控制目标系统的驱动电机提供命令来控制控制目标的位置,包括:
摩擦补偿计算单元,其基于速度命令值,计算摩擦补偿参考值,该摩擦补偿参考值为补偿由于摩擦而引起的位置偏差的摩擦补偿值的参考值;
滑动力矩标准化计算单元,其用表示速度和预先存储的滑动力矩之间的关系的特性信息,基于速度命令值、力矩命令值和所述特性信息,计算在当前状态的预定标准速度下的滑动力矩;
补偿值放大比率计算单元,其基于在当前状态的标准化速度下的滑动力矩和在初始状态的标准化速度下的滑动力矩,计算补偿值放大比率,该补偿值放大比率为摩擦补偿参考值的放大比率;
乘法器,其将所述补偿值放大比率乘上所述摩擦补偿参考值,以输出摩擦补偿值,该摩擦补偿值补偿由于摩擦力而产生的位置偏差。
2.根据权利要求1所述的位置控制器,其特征在于,所述滑动力矩标准化计算单元包括:
滑动力矩识别单元,其基于所述速度命令值和所述力矩命令值,输出由速度命令值表示的速度下的滑动力矩;
滑动力矩比率计算单元,其基于所述特性信息和速度命令值,计算滑动力矩比率,该滑动力矩比率表示在由所述速度命令值表示的速度下的滑动力矩和在当前状态的标准化速度下的滑动力矩之间的比率;
速度权重计算单元,其基于所述滑动力矩比率和由所述速度命令值表示的速度的滑动力矩,计算在当前状态的标准化速度下的滑动力矩。

说明书全文

位置控制器

[0001] 优先权信息
[0002] 本发明申请要求2013年4月24日提交的日本专利申请No. 2013-091600的优先权,其以引用的方式并入本文中。

技术领域

[0003] 本发明涉及位置控制器,其根据来自高层次控制器的命令控制驱动目标的位置。

背景技术

[0004] 图4为传统的全封闭式位置控制器(以下简称为“位置控制器”)的一个示例的框图,该位置控制器控制可移动形成的目标系统112,该系统包括可移动部件,如桌子,并且该系统通过连接或诸如此类的方式连接到用作驱动电动的伺服电机(未显示)。
[0005] 该位置控制器的配置和操作如下所述。该位置控制器从高层次控制器(未显示)接收位置命令值X的输入。减法器101通过从位置命令值X减去位置检测值xL来计算位置偏差X – xL。该位置检测值xL是通过线性标尺或类似的方式(未显示)直接检测目标系统112的控制目标的位置获得的位置检测信号
[0006] 进一步地,位置命令值X的时间导数通过微分器104、109获得,这些微分器分别输出获得的值作为速度命令值V和加速度命令值A。该加速度命令值A由放大器110通过加速矩转换常数Ca放大用作加速力矩命令值τca,引起目标系统112移动在加速速率下。该速度命令值A和加速力矩命令值τca分别加进所述速度命令和力矩命令。这样一系列过程形成众所周知的前馈用以将恒量的位置偏差X–xL减少到零。
[0007] 放大器102以位置环增益的放大系数Gp成比率地放大位置偏差X–xL。放大器102的输出在通过加法器103加上速度命令值V后成为最终的速度命令值Vc。减法器105通过从速度命令值Vc减去电机速度vm来计算速度偏差Vc–vm。该电机速度vm为通过微分器107获得的与伺服电机相连接的位置检测器(未显示)的旋转位置xm或者与伺服电机相连接的速度检测器(未显示)的输出的时间导数值。放大器106以速度环路增益的放大系数Gy放大速度偏差Vc-vm。
[0008] 放大器106的输出通过加法器108加上加速力矩命令值τca后成为力矩命令值τc。该力矩命令值τc通过功率放大单元111功率放大后成为该目标系统112生成的力矩τ。由功率放大器和伺服电机组成的该功率放大单元111放大力矩命令值τc以输出生成的力矩τ。该放大比率用力矩转换常数Ct表示。该生成的力矩τ提供给该目标系统112,并用于驱动该目标系统112。应该注意的是,图4中的微分器的参考符号“S”表示表明微分运算的拉普拉斯变换算子。
[0009] 在传统的位置控制器中,通过摩擦补偿计算单元113将摩擦补偿计算单元113计算得到的补偿值Vsfc、τsfc分别加到速度命令和力矩命令上,可最小化由摩擦力造成的位置跟踪偏差。
[0010] 然而,当目标系统的滑动特性,由于随着时间的推移恶化、温度变化、滑动表面的润滑状态变化或类似的,而改变,理想的摩擦补偿变得不可能,引起位置跟踪错误和加工精度的降低。为了避免这种情况,摩擦补偿计算单元113的控制参数应该重置(重新调整)。因为重置会消耗大量时间,并且在每次特性改变的时候都需要,所有,重置是麻烦的。
[0011] 进一步地,虽然可以考虑根据滑动特性的变化改变摩擦补偿计算单元的控制参数,但是由于滑动力矩根据目标系统的运行速度而改变,需要在相同速度下比较滑动力矩以便定量处理滑动力矩。因此,通过提供专用的操作方式来获得滑动力矩成为必要的,这将导致辅助时间的增加。
[0012] 提供的本发明的用以克服上述问题。本发明的一个目的在于提供一种位置控制器,即便当由于时间的推移恶化、温度变化、滑动表面的润滑状态变化或类似的原因造成滑动特性的改变,其仍可以保持所需的摩擦补偿而无需提供专用的操作方式。

发明内容

[0013] 根据本发明的位置控制器通过根据来自高层次控制器的位置命令值向控制目标系统的驱动电机提供命令来控制控制目标的位置。该位置控制器包括:摩擦补偿计算单元,其基于速度命令值,计算摩擦补偿参考值,该摩擦补偿参考值为补偿由于摩擦力而引起的位置偏差的摩擦补偿值的参考值;滑动力矩标准化计算单元,其用表示速度和预先存储的滑动力矩之间的关系的特性信息,基于速度命令值、力矩命令值和所述特性信息,计算在当前状态的预定标准速度下的滑动力矩;补偿值放大比率计算单元,其基于在当前状态的标准化速度下的滑动力矩和在初始状态的标准化速度下的滑动力矩,计算补偿值放大比率,该补偿值放大比率为摩擦补偿参考值的放大比率;乘法器,其将所述补偿值放大比率乘上所述摩擦补偿参考值,以输出摩擦补偿值,该摩擦补偿值补偿由于摩擦力而产生的位置偏差。
[0014] 在优选的实施例中,所述滑动力矩标准化计算单元包括:滑动力矩识别单元,其基于所述速度命令值和所述力矩命令值,输出由速度命令值表示的速度下的滑动力矩;滑动力矩比率计算单元,其基于所述特性信息和速度命令值,计算滑动力矩比率,该滑动力矩比率表示在由所述速度命令值表示的速度下的滑动力矩和在当前状态的标准化速度下的滑动力矩之间的比率;速度权重计算单元,其基于所述滑动力矩比率和由所述速度命令值表示的速度的滑动力矩,计算在当前状态的标准化速度下的滑动力矩。
[0015] 根据本发明,当由于时间的推移恶化、温度变化、滑动表面的润滑状态变化或类似的原因造成目标系统的滑动阻力特性变化时,根据滑动特性的变化通过使用标准化的滑动力矩改变摩擦补偿是可能的,因此,可以无需重置(重新调整)摩擦补偿计算单元的控制参数而保持加工精度。附图说明
[0016] 本发明的优选实施例将参照以下附图进行详细的描述。
[0017] 图1为根据本发明的位置控制器的一个示例框图;
[0018] 图2为根据本发明的滑动力矩标准化计算单元的一个实施例框图;
[0019] 图3为根据本发明的滑动力矩比率计算单元的操作示例曲线图;
[0020] 图4为传统位置控制器的一个示例框图。

具体实施方式

[0021] 图1为根据本发明的位置控制器的一个示例框图。应该注意的是,相同的参考号被分配给如图4所示的常规技术的例子中相同的部件,并且省略对这些部件的重复描述。一种可变的摩擦补偿值计算单元,包括滑动力矩标准化计算单元1、补偿值放大比率计算单元2和乘法器3、4。首先,对滑动力矩标准化计算单元1进行描述。
[0022] 图2为滑动力矩标准化计算单元1的结构框图。当驱动与速度命令值V正相关时目标系统的滑动力矩,可以通过比较在相对速度下的滑动力矩得到滑动特性的改变。因此,预设速度命令值V和滑动力矩间的特性信息,例如,预先设置近似于速度命令值V和滑动力矩间的关系的滑动特性模型,通过使用该模型将特定的滑动力矩转变为在相同速度(标准化速度)下的滑动力矩。
[0023] 滑动力矩识别单元11接收输入的速度命令值V和力矩命令值τc;确定作为滑动力矩的力矩命令值τc,通过该力矩命令值,目标系统112运行在一定的速度下;进一步从速度命令值V的极性确定运行方向;当在正方向上运行时输出滑动力矩τc_p,在负方向上运行时输出滑动力矩τc_n(在下文中,下标“p”表示正方向,而下标“n”表示负方向)。滑动力矩比率计算单元12接收输入的速度命令值V,并输出通过以下描述的操作获得的滑动力矩比率G。
[0024] 图3为上述滑动力矩比率计算单元12的示例操作的曲线图。图3(a)显示了横坐标为速度命令值V、纵坐标为该滑动力矩比率计算单元12输出的滑动力矩比率G的滑动特性模型。滑动力矩比率G为在特定速度Vn下的滑动力矩相对标准化速度Va下的滑动力矩的比率值。最大速度Vb是目标系统112的最大速度。标准化速度Va和滑动力矩最大值Gh为基于在选择摩擦补偿计算单元113的控制参数时得到的目标系统112的滑动特性(初始滑动特性)确定的参数。以下描述确定标准化速度Va和滑动力矩比率最大值Gh的方法。
[0025] 图3(b)显示了目标系统112的初始化滑动特性(在随着时间的推移恶化前的滑动特性,当选择摩擦补偿计算单元113时获得)。该标准化速度Va为当用单点折线近似表示初始滑动特性时的断点。在图3(b)中,τa_p和τa_n表示标准化速度滑动力矩初始值,而τb_p和τb_n表示最大速度滑动力矩初始值。应该注意的是,标准化速度滑动力矩初始值指示在初始状态中的标准化速度Va下的滑动力矩。
[0026] 该滑动力矩比率最大值Gh通过以下使用τma和τmb的等式确定,其中,τma通过从标准化速度滑动力矩初始值τa_p中减去重力矩获得,τmb通过从最大速度滑动力矩初始值τb_p中减去重力矩获得。
[0027] Gh = τmb/τma  (等式1)
[0028] 滑动力矩比率计算单元12从使用上述参数的以下等式确定表示在当前状态下的标准化速度Va下的的滑动力矩和由速度命令值V指示的速度下的滑动力矩间的比率的滑动力矩比率G,其中,速度命令绝对值|V|作为输入,确定的滑动力矩比率G作为输出。
[0029] G = 1 (where |V| ≤ Va)
[0030] G = (Gh - 1) / (Vb - Va) (|V| - Va) + 1 (where Va < |V| ≤ Vb)  (等式2)[0031] 速度权重计算单元13,通过使用滑动力矩比率G、滑动力矩τc_p和τc_n,以及在标准速度下的滑动力矩τnor_p和τnor_n的先前值,根据以下等式,计算标准化滑动力矩τnor_p和τnor_n作为输出。标准化滑动力矩τnor_p和τnor_n表明在当前状态下(即,在随着时间的推移恶化、温度变化、滑动表面的润滑状态变化后发生的)的标准速度Va下进行驱动产生的滑动力矩。
[0032] τnor_p = {τc_p - (τnor_p[n - 1] + τnor_n [n - 1]) / 2} / G[0033] +(τnor_p[n - 1] + τnor_n [n - 1]) / 2
[0034] τnor_n = {τc_n - (τnor_p[n - 1] + τnor_n [n - 1]) / 2} / G[0035] +(τnor_p[n - 1] + τnor_n [n - 1]) / 2            (等式3)[0036] 如上所述,由于标准化滑动力矩通过对在各速度命令下得到的滑动力矩进行标准化获得,因此在相同速度(标准化速度Va)下无需提供固定速度的操作方式而比较滑动力矩成为可能。
[0037] 接着,对补偿值放大比例计算单元2进行描述。该补偿值放大比率计算单元2,使用标准化速度滑动力矩初始值τa_p、τa_n和在当前状态下的标准速度下的滑动力矩τnor_p、τnor_n,根据以下等式确定要输出的补偿值放大比率R。
[0038] R = (τnor_p - τnor_n) / (τa_p - τa_n)  (等式 4)
[0039] 应当注意的是,虽然补偿值放大比率R通过使用在标准化速度下的滑动力矩τnor_p、τnor_n获得,但是低通滤波器可用于在标准化速度下的这些滑动力矩τnor_p、τnor_n,以使得补偿值放大比例R变得平滑。
[0040] 乘法器3、4通过将摩擦补偿计算单元113输出的摩擦补偿值Vsfc0、τsfc0乘上补偿值放大比例R,输出摩擦补偿值Vsfc、τsfc。在这种方式下,根据滑动特性的变化改变摩擦补偿值成为可能。
QQ群二维码
意见反馈