一种位置闭环控制方法及装置制造方法及图纸

本发明专利技术提供了一种位置闭环控制方法及装置，该方法包括：在当前伺服周期内，按照预设时间间隔依次采集控制对象的位置值并记录采集时间点；根据当前位置值与目标位置值判断控制对象是否运动到位，当前位置值为当前伺服周期内最后一次采集的位置值；若未运动到位，根据当前位置值与目标位置值的差值、采集的各个位置值及其对应的采集时间点，计算当前速度输出值；根据速度阈值对当前速度输出值进行阈值限定，得到实际速度输出值；依据当前位置值与目标位置值的差值、实际速度输出值和预设加速度值，控制控制对象运动。基于上述公开的方法，实现了提前规划控制对象的运动路径，从而有效降低出现控制对象超调甚至飞车现象的可能性。

Position closed loop control method and device

The invention provides a closed-loop position control method and device. The method includes: in the current servo cycle, according to a preset time interval in order to control the position of the object value acquisition and record collection time points; according to the current position of value judgment whether the object motion control in place and target position value, current value is the current position of the servoperiods finally a collection of the location value; if no movement in place, according to the current position value of each position and the target position values, acquisition value of the acquisition time point and its corresponding output current value, calculation speed; according to the speed threshold limit of output current speed value, get the actual speed of the output value; according to the current position of value the difference between the actual value of the target position, and the speed of the output value and the preset value of acceleration, object motion control. Based on the above open method, the motion path of the object is planned ahead of schedule, thus reducing the possibility of the overshoot of the control object and even the phenomenon of speeding.

【技术实现步骤摘要】
一种位置闭环控制方法及装置
本专利技术涉及位置闭环控制领域，更具体地说，涉及一种位置闭环控制方法及装置。
技术介绍
位置闭环控制是一种使控制对象按照预设规律或轨迹运动到目标位置处的方法。如图1所示为现有的位置闭环控制框图，主要包括位置控制器101、速度控制器102、执行机构103和控制对象104。目前位置闭环控制方法主要包括：在一个伺服周期内，位置控制器通过对比控制对象的目标位置值与采集到的位置值计算控制对象的位置偏差量，速度控制器根据位置偏差量和采集到的速度量计算当前速度输出量，以使执行机构按照当前输出速度量驱动控制对象运动到目标位置处。但是，经研究发现，利用目前这种位置闭环控制方法驱动控制对象运动的过程中容易出现控制对象超调甚至飞车。因此，如何有效降低出现控制对象超调甚至飞车现象的可能性，是本领域技术人员亟需解决的问题。
技术实现思路
有鉴于此，本专利技术提供一种位置闭环控制方法及装置，以解决现有的技术方案驱动控制对象运动的过程中容易出现控制对象超调甚至飞车的问题。技术方案如下：一种位置闭环控制方法，包括：在当前伺服周期内，按照预设时间间隔依次采集控制对象的位置值并记录采集时间点；根本文档来自技高网...

【技术保护点】
一种位置闭环控制方法，其特征在于，包括：在当前伺服周期内，按照预设时间间隔依次采集控制对象的位置值并记录采集时间点；根据当前位置值与目标位置值判断所述控制对象是否运动到位，所述当前位置值为所述当前伺服周期内最后一次采集的位置值；若未运动到位，根据所述当前位置值与所述目标位置值的差值、采集的各个所述位置值及其对应的所述采集时间点，计算当前速度输出值；根据速度阈值对所述当前速度输出值进行阈值限定，得到实际速度输出值；依据所述当前位置值与所述目标位置值的差值、所述实际速度输出值和预设加速度值，控制所述控制对象运动。

【技术特征摘要】
1.一种位置闭环控制方法，其特征在于，包括：在当前伺服周期内，按照预设时间间隔依次采集控制对象的位置值并记录采集时间点；根据当前位置值与目标位置值判断所述控制对象是否运动到位，所述当前位置值为所述当前伺服周期内最后一次采集的位置值；若未运动到位，根据所述当前位置值与所述目标位置值的差值、采集的各个所述位置值及其对应的所述采集时间点，计算当前速度输出值；根据速度阈值对所述当前速度输出值进行阈值限定，得到实际速度输出值；依据所述当前位置值与所述目标位置值的差值、所述实际速度输出值和预设加速度值，控制所述控制对象运动。2.根据权利要求1所述的方法，其特征在于，所述根据所述当前位置值与所述目标位置值的差值、采集的各个所述位置值及其对应的所述采集时间点，计算当前速度输出值，包括：依据所述当前位置值与所述目标位置值的差值和预设比例-积分-微分算法计算调节速率；根据最小二乘法对采集的各个所述位置值及其对应的所述采集时间点进行拟合计算，得到拟合速率；基于所述调节速率、所述拟合速率及其各自对应的权重值计算当前速度输出值。3.根据权利要求2所述的方法，其特征在于，所述根据最小二乘法对采集的各个所述位置值及其对应的所述采集时间点进行拟合计算，得到拟合速率，包括：根据采集的各个所述位置值及其对应的所述采集时间点，绘制相应的坐标点；对各个所述坐标点进行拟合处理，得到拟合曲线；计算所述拟合曲线的斜率；根据所述斜率和预设拟合系数计算拟合速率。4.根据权利要求1所述的方法，其特征在于，所述根据速度阈值对所述当前速度输出值进行阈值限定，得到实际速度输出值，包括：比较所述当前速度输出值与速度阈值；当所述当前速度输出值大于等于所述速度阈值时，将所述速度阈值确定为实际速度输出值；当所述当前速度输出值小于所述速度阈值时，将所述当前速度输出值确定为实际速度输出值。5.根据权利要求1所述的方法，其特征在于，所述依据所述当前位置值与所述目标位置值的差值、所述实际速度输出值和预设加速度值，控制所述控制对象运动，包括：根据所述实际速度输出值和预设加速度值计算减速位移值，所述减速位移值是当所述控制对象以所述实际速度输出值为初始速率，并以所述预设加速度值为减速运动到停止的位移值；比较所述当前位置值与所述目标位置值的差值与所述减速位移值；当所述当前位置值与所述目标位置值的差值大于所述减速位移值时，判断所述实际速度输出值是否为所述速度阈值；若是，控制所述控制对象按照所述实际速度输出值匀速运动；若否，控制所述控制对象以所述实际速度输出值为初始速率，并以所述预设加速度值加速运动；当所述当前位置值与所述目标位置值的差值小于等于所述减速位移值时，控制所述控制对象以所述实际速度输出值为初始速率，并以所述预设加速度值减速运动。6.一种位置闭环控制装置，其特征...

【专利技术属性】
技术研发人员：李佼，
申请(专利权)人：北京润科通用技术有限公司，
类型：发明
国别省市：北京,11