CN114499310A - 一种基于卡尔曼滤波器的摇臂伺服控制方法 - Google Patents
一种基于卡尔曼滤波器的摇臂伺服控制方法 Download PDFInfo
- Publication number
- CN114499310A CN114499310A CN202210131189.2A CN202210131189A CN114499310A CN 114499310 A CN114499310 A CN 114499310A CN 202210131189 A CN202210131189 A CN 202210131189A CN 114499310 A CN114499310 A CN 114499310A
- Authority
- CN
- China
- Prior art keywords
- speed
- value
- predicted
- loop
- rocker arm
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 19
- 238000005070 sampling Methods 0.000 claims abstract description 26
- 230000004044 response Effects 0.000 claims abstract description 6
- 239000011159 matrix material Substances 0.000 claims description 23
- 238000004364 calculation method Methods 0.000 claims description 5
- 238000005259 measurement Methods 0.000 claims description 4
- 230000008569 process Effects 0.000 claims description 3
- 239000007983 Tris buffer Substances 0.000 claims 1
- 238000001914 filtration Methods 0.000 abstract 1
- 230000004927 fusion Effects 0.000 description 2
- 239000000463 material Substances 0.000 description 2
- 230000007246 mechanism Effects 0.000 description 2
- 230000004075 alteration Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000001360 synchronised effect Effects 0.000 description 1
Images
Classifications
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P21/00—Arrangements or methods for the control of electric machines by vector control, e.g. by control of field orientation
- H02P21/13—Observer control, e.g. using Luenberger observers or Kalman filters
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P21/00—Arrangements or methods for the control of electric machines by vector control, e.g. by control of field orientation
- H02P21/14—Estimation or adaptation of machine parameters, e.g. flux, current or voltage
- H02P21/18—Estimation of position or speed
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P27/00—Arrangements or methods for the control of AC motors characterised by the kind of supply voltage
- H02P27/04—Arrangements or methods for the control of AC motors characterised by the kind of supply voltage using variable-frequency supply voltage, e.g. inverter or converter supply voltage
- H02P27/06—Arrangements or methods for the control of AC motors characterised by the kind of supply voltage using variable-frequency supply voltage, e.g. inverter or converter supply voltage using DC to AC converters or inverters
- H02P27/08—Arrangements or methods for the control of AC motors characterised by the kind of supply voltage using variable-frequency supply voltage, e.g. inverter or converter supply voltage using DC to AC converters or inverters with pulse width modulation
Landscapes
- Engineering & Computer Science (AREA)
- Power Engineering (AREA)
- Control Of Electric Motors In General (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开了一种基于抗扰卡尔曼滤波的摇臂伺服控制方法。基于摇臂的运动方程,利用卡尔曼滤波器辨识出摇臂的位置和速度,卡尔曼滤波器得到的速度信号比锁相环计算得出的速度信号拥有更高的响应速度,采用卡尔曼观测器的观测值作为速度环速度反馈,根据速度环速度反馈与参考转速计算未来N个采样周期参考转速轨迹,通过模型预测算法预测未来N个采样周期的转速预测值,并建立基于规划转速与预测转速差值的损失函数,通过搜索损失函数极值计算电流参考值。本发明利用卡尔曼滤波器代替锁相环,通过位置信号这个表征量,得到了更高精度的摇臂伺服控制方法。
Description
技术领域
本发明属于伺服控制技术,具体为一种基于卡尔曼滤波器的摇臂伺服控制方法。
背景技术
摇臂机构是伺服电机的一种典型应用,现在广泛应用于各种机器人关节。通常其到位精度由位置环、速度环、电流环决定,其中速度环的反馈一般由数字锁相环计算得出,由于经过数字锁相环计算得出的速度信号噪声大,运用低通滤波器将速度信号滤波,但是却降低了速度环的响应速度,影响了摇臂到位精度。因此,对于高精度摇臂机构,速度环的反馈尤为关键。摇臂由于受负载转矩影响,运动情况复杂,降低速度环的误差具有重要意义。
发明内容
本发明的目的在于提供一种基于卡尔曼滤波器的摇臂伺服控制方法。
实现本发明目的的技术方案为:一种基于卡尔曼滤波器摇臂伺服控制方法,,包括如下步骤:
步骤1,基于卡尔曼状态观测器的位置和速度观测:基于摇臂运动方程采用卡尔曼状态观测器,观测摇臂位置和速度,卡尔曼状态观测器包括预测方程和更新方程两部分,具体为:
预测方程:
更新方程:
其中,yk为传感器测量值,为模型预测值,Kk是卡尔曼增益矩阵,A是运动方程的状态矩阵,B是n×1的输入矩阵,P是协方差矩阵,C是观测矩阵,Q和R分别是过程噪声协方差矩阵与测量噪声协方差矩阵,n为自然数,uk-1为修正量,I为单位矩阵,为观测值;
步骤2,速度环模型预测控制器:采用卡尔曼观测器的观测值作为速度环速度反馈,根据速度环速度反馈与参考转速计算未来N个采样周期参考转速轨迹,通过模型预测算法预测未来N个采样周期的转速预测值,并建立基于规划转速与预测转速差值的损失函数,通过搜索损失函数极值计算电流参考值iq *。
式中,J是系统机械惯量,,Kt是转矩系数,iq是q轴电流。
优选地,步骤2中,未来N个采样周期参考转速轨迹的计算方法为:
优选地,步骤2中,未来N个采样周期的转速预测值计算方法为:
优选地,步骤2中,建立的基于规划转速与预测转速差值的损失函数为:
本发明与现有技术相比,其显著优点为:
本发明在特定位置下利用速度环位置估计弥补了永磁伺服电机低速过载情况下位置估计不精度的缺点,提高了速度环控制精度,提高了摇臂伺服到位精度。
附图说明
图1是本申请实施例的基于卡尔曼数据融合的无位置传感器摇臂伺服控制的流程图。
图2是本申请实施例的无位置传感器伺服摇臂控制原理框图。
具体实施方式
如图1所示,一种基于卡尔曼滤波器的摇臂伺服控制方法,具体步骤为:
步骤1,基于卡尔曼状态观测器的位置和速度观测:基于摇臂运动方程采用卡尔曼状态观测器,观测摇臂位置和速度。
首先,基于摇臂运动方程进行预测:
其中,J是折算到电机轴上的总转动惯量,θrm是电机轴机械角位置,θre是电机轴电角度位置,有Pθrm=θre,其中P是电机极对数,Te是电磁转矩mgLarm是重力矩幅值,B是摩擦系数。上式写成状态空间形式有:
然而,在卡尔曼观测器中,包括J、B、Kt等在内的参数有可能发生变化,即参数的时变非线性特征导致的不准确,从而产生误差项,为了抵消这些参数误差项造成的模型估计误差,引入修正量,构造新的uk:
本发明中,卡尔曼状态观测器包括预测方程和更新方程两部分,其形式为:
预测方程:
更新方程:
其中,yk为测量值,为模型预测值,Kk是卡尔曼增益矩阵,Ak是运动方程的状态矩阵,B是n×1的输入矩阵,P是协方差矩阵,C是观测矩阵,Q和R分别是过程噪声协方差矩阵与测量噪声协方差矩阵,卡尔曼数据融合正是通过式将测量值yk和模型预测值相互融合,获得观测值
步骤2,速度环模型预测控制器:速度环速度反馈采用卡尔曼滤波器的速度输出值,根据转速反馈与参考转速计算规划未来N个采样周期参考转速轨迹ωr(1)...ωr(N),通过模型预测算法预测未来N个采样周期的转速预测值ωp(1)...ωp(N),并建立基于规划转速与预测转速差值的损失函数,通过搜索损失函数极值计算电流参考值iMPC。
进一步的实施例中,未来N步参考转速轨迹ωref(1)...ωref(N)计算方法为:
进一步的实施例中,未来N个采样周期的转速预测值ωp(1)...ωp(N)计算方法为:
基于规划转速与预测转速差值的损失函数为:
基于上述损失函数的模型预测电流参考值iMPC *计算方法为:
下面结合附图对本发明作更进一步的说明。以一台永磁同步电机拖动摇臂负载的伺服系统为例,如图2所示,整个控制系统采用位置环、速度环和电流环组成的三环系统,电流环计算出电压参考值(u* α,u* β),通过PWM调制后,以驱动器驱动永磁电机拖动摇臂。三环控制分别需要位置信息都是传感器的输出。特别需要指出的是,由于锁相环计算得出的信号响应速度低,速度环的速度反馈是卡尔曼滤波器的输出
步骤1,基于卡尔曼观测器的位置和速度观测:基于摇臂运动方程采用卡尔曼状态观测器,观测摇臂的位置与速度,卡尔曼状态观测器包括预测方程和更新方程两部分,如图2中卡尔曼状态观测器模块所示。
将卡尔曼滤波器得到的速度信号作为速度环的输入,通过卡尔曼滤波器输出的位置信号与传感器得到的实际位置信号判断速度的精确性。将卡尔曼滤波器输出的位置信号和传感器得到的实际位置信号的误差做PI控制,引入到卡尔曼观测器中,补偿掉因参数不确定产生的误差,获得精度更高的摇臂估计量。
步骤2,速度环速度反馈采用卡尔曼滤波器的速度输出值,根据转速反馈与参考转速ω*计算规划未来N个采样周期参考转速轨迹ωr(1)...ωr(N),参考转速由位置环计算得出,通过模型预测算法预测未来N个采样周期的转速预测值ωp(1)...ωp(N),并建立基于规划转速与预测转速差值的损失函数,通过搜索损失函数极值计算电流参考值iMPC。
在本说明书的描述中,参考术语“一个实施例”、“一些实施例”、“示意性实施例”、“示例”、“具体示例”、或“一些示例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点包含于本发明的至少一个实施例或示例中。在本说明书中,对上述术语的示意性表述不一定指的是相同的实施例或示例。而且,描述的具体特征、结构、材料或者特点可以在任何的一个或多个实施例或示例中以合适的方式结合。
尽管已经示出和描述了本发明的实施例,本领域的普通技术人员可以理解:在不脱离本发明的原理和宗旨的情况下可以对这些实施例进行多种变化、修改、替换和变型,本发明的范围由权利要求及其等同物限定。
Claims (7)
1.一种基于卡尔曼滤波器摇臂伺服控制方法,其特征在于,包括如下步骤:
步骤1,基于卡尔曼状态观测器的位置和速度观测:基于摇臂运动方程采用卡尔曼状态观测器,观测摇臂位置和速度,卡尔曼状态观测器包括预测方程和更新方程两部分,具体为:
预测方程:
更新方程:
其中,yk为传感器测量值,为模型预测值,Kk是卡尔曼增益矩阵,A是运动方程的状态矩阵,B是n×1的输入矩阵,P是协方差矩阵,C是观测矩阵,Q和R分别是过程噪声协方差矩阵与测量噪声协方差矩阵,n为自然数,uk-1为修正量,I为单位矩阵,为观测值;
步骤2,速度环模型预测控制器:采用卡尔曼观测器的观测值作为速度环速度反馈,根据速度环速度反馈与参考转速计算未来N个采样周期参考转速轨迹,通过模型预测算法预测未来N个采样周期的转速预测值,并建立基于规划转速与预测转速差值的损失函数,通过搜索损失函数极值计算电流参考值。
7.根据权利要求1所述的方法,其特征在于,预测转速误差具体为:
e(i)=ωref(i)-ωp(i)。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210131189.2A CN114499310B (zh) | 2022-02-14 | 2022-02-14 | 一种基于卡尔曼滤波器的摇臂伺服控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210131189.2A CN114499310B (zh) | 2022-02-14 | 2022-02-14 | 一种基于卡尔曼滤波器的摇臂伺服控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114499310A true CN114499310A (zh) | 2022-05-13 |
CN114499310B CN114499310B (zh) | 2023-01-24 |
Family
ID=81480356
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210131189.2A Active CN114499310B (zh) | 2022-02-14 | 2022-02-14 | 一种基于卡尔曼滤波器的摇臂伺服控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114499310B (zh) |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102064799A (zh) * | 2010-12-31 | 2011-05-18 | 南京理工大学 | 基于fpga的去偏转换量测卡尔曼滤波器的设计方法 |
CN104833851A (zh) * | 2015-04-24 | 2015-08-12 | 合肥工业大学 | 基于分布式相关卡尔曼滤波的电力系统谐波估计方法 |
CN105372987A (zh) * | 2014-08-29 | 2016-03-02 | 石岩峰 | 一种位置伺服闭环控制系统及其使用方法 |
CN108134549A (zh) * | 2017-12-25 | 2018-06-08 | 西安理工大学 | 一种提高永磁同步电机转速估计稳定性的方法 |
US20180287536A1 (en) * | 2014-11-18 | 2018-10-04 | Renault S.A.S. | Method for controlling a synchronous electric machine with a wound rotor |
CN112896494A (zh) * | 2021-04-12 | 2021-06-04 | 中南大学 | 基于模型预测控制的飞机防滑刹车控制方法 |
CN113037163A (zh) * | 2021-03-08 | 2021-06-25 | 上海工程技术大学 | 一种新型具有动态误差补偿的永磁同步电机位置观测方法 |
CN113067520A (zh) * | 2021-03-02 | 2021-07-02 | 南京理工大学 | 基于优化残差的无传感器响应自适应电机控制方法 |
CN113630055A (zh) * | 2021-07-15 | 2021-11-09 | 南京理工大学 | 基于卡尔曼数据融合的无位置传感器摇臂伺服控制方法 |
-
2022
- 2022-02-14 CN CN202210131189.2A patent/CN114499310B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102064799A (zh) * | 2010-12-31 | 2011-05-18 | 南京理工大学 | 基于fpga的去偏转换量测卡尔曼滤波器的设计方法 |
CN105372987A (zh) * | 2014-08-29 | 2016-03-02 | 石岩峰 | 一种位置伺服闭环控制系统及其使用方法 |
US20180287536A1 (en) * | 2014-11-18 | 2018-10-04 | Renault S.A.S. | Method for controlling a synchronous electric machine with a wound rotor |
CN104833851A (zh) * | 2015-04-24 | 2015-08-12 | 合肥工业大学 | 基于分布式相关卡尔曼滤波的电力系统谐波估计方法 |
CN108134549A (zh) * | 2017-12-25 | 2018-06-08 | 西安理工大学 | 一种提高永磁同步电机转速估计稳定性的方法 |
CN113067520A (zh) * | 2021-03-02 | 2021-07-02 | 南京理工大学 | 基于优化残差的无传感器响应自适应电机控制方法 |
CN113037163A (zh) * | 2021-03-08 | 2021-06-25 | 上海工程技术大学 | 一种新型具有动态误差补偿的永磁同步电机位置观测方法 |
CN112896494A (zh) * | 2021-04-12 | 2021-06-04 | 中南大学 | 基于模型预测控制的飞机防滑刹车控制方法 |
CN113630055A (zh) * | 2021-07-15 | 2021-11-09 | 南京理工大学 | 基于卡尔曼数据融合的无位置传感器摇臂伺服控制方法 |
Non-Patent Citations (1)
Title |
---|
彭志专等: "基于修正扩展卡尔曼序贯滤波的信息融合算法", 《空军工程大学学报(自然科学版)》 * |
Also Published As
Publication number | Publication date |
---|---|
CN114499310B (zh) | 2023-01-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6485644B2 (ja) | 誘導モーターの角速度を制御する方法およびモータードライブ | |
JP5198514B2 (ja) | ロボット制御装置 | |
CN113805611B (zh) | 一种基于三轴云台的视频稳像方法 | |
CN109521454A (zh) | 一种基于自学习容积卡尔曼滤波的gps/ins组合导航方法 | |
CN105928514A (zh) | 基于图像与惯性技术的agv复合导引系统 | |
CN113406895B (zh) | 一种智能阀门电动执行机构的控制系统构建方法 | |
JP7272112B2 (ja) | サーボシステムのパラメータ同定方法 | |
CN109347391A (zh) | 一种考虑系统噪声的朗道自适应转动惯量辨识方法 | |
ES2369404T3 (es) | Procedimiento y dispositivo de rechazo robusto de perturbaciones periódicas en un bucle de control de posición de un eje. | |
CN112398397A (zh) | 一种基于模型辅助的线性自抗扰永磁同步电机控制方法 | |
CN112549030A (zh) | 一种基于抗干扰滤波的空间机械臂柔性关节位姿估计方法 | |
CN113203429B (zh) | 一种陀螺仪温度漂移误差的在线估计及补偿方法 | |
CN110941285A (zh) | 一种基于双ip核的无人机飞行控制系统 | |
CN110504880A (zh) | 一种磁通切换永磁直线电机干扰观测前馈补偿控制方法 | |
CN104779873B (zh) | 一种用于pmsm伺服系统的预测函数控制方法 | |
CN114966629A (zh) | 一种基于ekf算法框架的车体激光雷达外参标定方法 | |
CN113630055A (zh) | 基于卡尔曼数据融合的无位置传感器摇臂伺服控制方法 | |
CN110647105B (zh) | 一种适用于双轴或三轴进给驱动系统的有限控制集模型预测轮廓控制方法 | |
CN114499310B (zh) | 一种基于卡尔曼滤波器的摇臂伺服控制方法 | |
CN111679644A (zh) | 一种考虑系统延迟的不确定工业机器人运动控制方法 | |
CN112859612B (zh) | 一种超低速控制力矩陀螺框架伺服系统高精度控制器 | |
CN110445448A (zh) | 修正方法、装置、望远镜控制系统及计算机可读存储介质 | |
CN117997177B (zh) | 永磁同步电机的控制方法、电流环及永磁同步电机控制系统、可读存储介质 | |
Zhu et al. | Double vibration suppression of pmsm servo system based on strong tracking of reference trajectory | |
Sehili et al. | Ultra-local model design based on real-time algebraic and derivative estimators for position control of a DC motor |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |