CN106681134A - 一种高精度舵机位置控制方法 - Google Patents
一种高精度舵机位置控制方法 Download PDFInfo
- Publication number
- CN106681134A CN106681134A CN201710018701.1A CN201710018701A CN106681134A CN 106681134 A CN106681134 A CN 106681134A CN 201710018701 A CN201710018701 A CN 201710018701A CN 106681134 A CN106681134 A CN 106681134A
- Authority
- CN
- China
- Prior art keywords
- speed
- out1
- steering wheel
- control
- value
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 33
- 238000001914 filtration Methods 0.000 claims abstract description 23
- 238000005070 sampling Methods 0.000 claims abstract description 21
- 238000006243 chemical reaction Methods 0.000 claims description 5
- 238000000079 presaturation Methods 0.000 claims description 5
- 238000004364 calculation method Methods 0.000 claims description 2
- 238000013178 mathematical model Methods 0.000 abstract 1
- 238000010586 diagram Methods 0.000 description 11
- 230000001276 controlling effect Effects 0.000 description 4
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 description 2
- 238000010276 construction Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000002360 preparation method Methods 0.000 description 1
- 230000001105 regulatory effect Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B11/00—Automatic controllers
- G05B11/01—Automatic controllers electric
- G05B11/36—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential
- G05B11/42—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential for obtaining a characteristic which is both proportional and time-dependent, e.g. P. I., P. I. D.
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
Abstract
本发明公开了一种高精度舵机位置控制方法,对当前的电位器电压进行ADC采样,采样的电压值记为当前的舵机位置值;对舵机位置值进行线性插值算法处理,对非线性区间进行线性校准,将校准后的位置线,采用一阶惯性滤波算法,对输出最终ADC采集结果做滤波处理;对位置曲线进行滤波处理,经过线性插值和滤波算法处理,校准后的位置曲线;基于舵机的物理数学模型,构建串级PID控制器,实现以位置控制为外环,速度控制为内环的高精度舵机位置控制算法。本发明可以解决电位器采样非线性和控制不稳定、不精准等问题,通过线性插值和滤波算法对电位器采样进行线性校准,构建串级PID伺服控制系统,实现舵机速度和位置的精准控制。
Description
技术领域
本发明涉及舵机控制技术领域,具体是一种用于舵机伺服控制系统的高精度舵机位置控制方法。
背景技术
在舵机伺服控制系统中,舵机的速度和位置精准控制是研究的主要方向,当前舵机的速度控制算法多为单回路PID控制。
该算法主要利用了实际速度与设定速度的偏差进行单回路PID调节,这种控制方式受电压、负载变化及器件物理误差等影响,导致反馈非线性误差大,从而存在调节时间长、抗干扰能力差、控制精度低等问题。
因此,如何提供一种既能消除反馈非线性,又抗干扰能力强、能实现速度和位置的高精度控制方法是本领域技术人员目前需要解决的问题。
发明内容
本发明的目的在于提供一种高精度舵机位置控制方法,以解决上述背景技术中提出的电位器采样非线性和控制不稳定、不精准等问题,通过线性插值和滤波算法对电位器采样进行线性校准,参考舵机机械结构图,如图1所示,构建串级PID伺服控制系统,实现舵机速度和位置的精准控制。
为解决上述技术问题,本发明提供了一种高精度舵机位置控制方法,包括如下步骤:
(1)对当前的电位器电压进行ADC采样,采样的电压值记为当前的舵机位置值;
根据当前电位器的反馈值所反映的位置线总体是线性的,但部分区间存在非线性,如图2;
(2)对舵机位置值进行线性插值算法处理,对非线性区间进行线性校准,如图3,
在区间[y0,y1]中,进行定点采样取值:第一个点(x0,y0)和最后一个点(x1,y1),则在区间内的任意点y(i),其坐标(x,y)可求出:
(3)将校准后的位置线,采用一阶惯性滤波算法,对输出最终ADC采集结果做滤波处理;
基本原理公式如下:y(n)=a*x(n)+(1-a)*y(n-1)......(2)
,(其中a为滤波系数,0≤a≤1);
(4)对所述位置曲线进行滤波处理,即
其中,f为滤波截止频率,T为采样周期,Ave_Value为当前速度的理想增值;
经过线性插值和滤波算法处理,校准后的位置曲线如图3;
(5)基于舵机的物理数学模型(图4),构建串级PID控制器,实现以位置控制为外环(位置式PID),速度控制为内环(增量式PID)的高精度舵机位置控制算法,控制系统框图如图5。
在位置控制器中,根据舵机设定的运动完成时间T和预先设定的目标位置R1(S)计算出当前时刻Tn的参考位置R1n(S),
计算公式:其中,0≤n≤N,
将当前经过线性插值和滤波处理后的位置值作为位置PID的当前位置输入作为位置控制器的输入H1n(S)。
当前采样位置H1n(S)和参考位置R1n(S)做偏差E1(S),位置控制器进行PID处理,其位置PID控制原理如图6。
在时域里基本公式:
设S(k)为第k次采样时刻位置控制器的输出值,进行PID离散化,令
计算公式:
Sout1(k)=Sp(k)+Si(k-1)+KiSp(k)+Kc(Sout2(k)-Sout1(k))+Kd(Sp(k)-Sp(k-1))......(7)
输出结果Sout1进行预饱和限幅输出得到Sout2。
在速度控制器中,预饱和输出Sout2将作为当前速度控制器的参考速度R2n(S),
参考速度R2n(S)计算公式:
当前速度检测H2n(S)计算公式:
当前采样位置H2n(S)和参考位置R2n(S)做偏差E2(S),速度控制器进行PID(增量式)处理,其速度PID控制原理如图7,令
速度控制器输出量是速度增量ΔVout1,由式(10)可得
ΔVout1(k)=Vout1(k)-Vout1(k-1)=Kp[e(k)-e(k-1)]+KIe(k)+KD[e(k)-2e(k-1)+e(k-2)]......(11)
根据速度增量,对当前速度进行修正,计算公式:
Vout1(k)=Vout1(k-1)+ΔVout1(k)......(12)
对修正速度Vout1进行限幅输出,输出为最终速度Vout2;
对最终速度Vout2进行PWM转换,转换计算公式:
其中,Pwm_Value为用于速度控制的占空比值,
K的比例值由当前电压下,速度与PWM的对应线性关系线求出。
与现有技术相比,本发明的有益效果是:
本发明的方法可以解决电位器采样非线性和控制不稳定、不精准等问题,通过线性插值和滤波算法对电位器采样进行线性校准,构建串级PID伺服控制系统,实现舵机速度和位置的精准控制。
附图说明
图1为本发明提供的舵机伺服系统的硬件结构图。
图2为本发明提供的线性插值和滤波算法处理前的位置曲线图。
图3为本发明提供的非线性区间线性插值示意图。
图4为本发明提供的线性插值和滤波算法处理后的位置曲线图。
图5为本发明提供的一种舵机伺服系统串级PID控制原理框图。
图6为本发明提供的一种位置PID控制框图。
图7为本发明提供的一种速度PID控制框图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的
实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
本发明的目的是提供一种高精度舵机位置控制方法,可以解决电位器采样非线性和控制不稳定、不精准等问题,通过线性插值和滤波算法对电位器采样进行线性校准,构建串级PID伺服控制系统,实现舵机速度和位置的精准控制。
为使本专利实施目的、技术方案和优点更加清楚,下面将结合实施例对本发明进行完整、清楚地描述。
请参考图1,根据硬件结构图进行串级PID伺服控制系统的初步构建,图1为本发明提供的舵机伺服系统的硬件结构图。
请参考图2和图3,其中,图2为本发明提供的线性插值和滤波算法处理前的位置曲线图,图3为本发明提供的非线性区间线性插值示意图,进行区间确定和插值处理,该方法包括:
步骤S101:在初步确定的伺服控制系统中,进行舵机从起始零位置到给定目标位置的位置曲线采集测试;
步骤S102:根据步骤S001得到的位置曲线确定非线性区间;
步骤S103:对非线性区间的起始点(x0,y0)和终止点(x1,y2)坐标值的确定;
步骤S104:对非线性区间内的位置点(x,y)通过计算公式(1)进行线性校准;
进一步,对于线性插值校准后的位置值进行数字滤波,滤波原理参考计算公式(2);
步骤S105:确定滤波截止频率f,采样周期T后,将线性插值校准后的位置值经过计算公式(3)得到滤波后的位置值。
对比图2和图4可知,经过线性插值和滤波算法后,位置曲线的非线性问题基本可以消除,至此,已完成舵机位置曲线的线性校准。
参考图6,位置PID控制框图,进行位置PID控制,该方法包括:
步骤S201:根据舵机设定的运动完成时间T和预先设定的目标位置R1(S),根据计算公式(4)计算出当前时刻Tn的参考位置R1n(S);
步骤S202:将当前经过线性插值和滤波处理后的位置值作为位置控制器的输入H1n(S);
步骤S203:当前采样位置H1n(S)和参考位置R1n(S)做偏差E1(S),位置控制器进行PID处理,控制原理参考公式(5);
进一步,设S(k)为第k次采样时刻位置控制器的输出值,进行PID离散化计算;
步骤S204:根据计算公式(7),进行位置PID控制,输出新的位置结果为Sout1;
步骤S205:将输出结果Sout1进行预饱和限幅输出得到最后输出位置Sout2。
参考图7,速度PID控制框图,进行速度PID控制,该方法包括:
步骤S301:根据计算公式(8)计算出当前时刻Tn的参考速度R2n(S);
步骤S302:根据计算公式(9)计算出当前速度检测H2n(S);
当前采样位置H2n(S)和参考位置R2n(S)做偏差E2(S),速度控制器进行PID控制,控制原理推算本参考公式(10);
步骤S303:根据计算公式(11),进行PID离散化计算,输出量是速度增量Vout1;
步骤S:304:根据计算公式(12)出新的速度值,对当前速度进行修正;
步骤S305:根据计算公式(13),将Vout1进行限幅输出,输出为Vout2;
步骤S306:根据计算公式(14),将Vout2进行PWM转换。
其中,公式(14)中K的比例值由当前电压下,速度与PWM的对应线性关系线求出。
上述实施例只是本发明一部分实施例,而不是全部实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性改进前提下所获得的所有其他实施例,都属于本发明保护的范围。
Claims (6)
1.一种高精度舵机位置控制方法,其特征在于,包括以下步骤
(1)对当前的电位器电压进行ADC采样,采样的电压值记为当前的舵机位置值;
(2)对舵机位置值进行线性插值算法处理,对非线性区间进行线性校准;
(3)将校准后的位置线,采用一阶惯性滤波算法,对输出最终ADC采集结果做滤波处理;
(4)对位置曲线进行滤波处理,经过线性插值和滤波算法处理,校准后的位置曲线;
(5)基于舵机的物理数学模型,构建串级PID控制器,实现以位置控制为外环,速度控制为内环的高精度舵机位置控制算法。
2.根据权利要求1所述的高精度舵机位置控制方法,其特征在于,所示步骤(2)具体为,在区间[y0,y1]中,进行定点采样取值:第一个点(x0,y0)和最后一个点(x1,y1),则在区间内的任意点y(i),其坐标(x,y)可求出:
3.根据权利要求1所述的高精度舵机位置控制方法,其特征在于,所示步骤(3)中,一阶惯性滤波算法具体为,y(n)=a*x(n)+(1-a)*y(n-1),其中a为滤波系数,0≤a≤1。
4.根据权利要求1所述的高精度舵机位置控制方法,其特征在于,所示步骤(4)中,滤波处理具体为,
其中,f为滤波截止频率,T为采样周期,Ave_Value为当前速度的理想增值。
5.根据权利要求1所述的高精度舵机位置控制方法,其特征在于,所示步骤(5)中,在位置控制中,根据舵机设定的运动完成时间T和预先设定的目标位置R1(S)计算出当前时刻Tn的参考位置R1n(S),计算公式:其中,0≤n≤N,
将当前经过线性插值和滤波处理后的位置值作为位置PID的当前位置输入作为位置控制器的输入H1n(S);
当前采样位置H1n(S)和参考位置R1n(S)做偏差E1(S),位置控制器进行PID处理,在时域里基本公式:
设S(k)为第k次采样时刻位置控制器的输出值,进行PID离散化,令
计算公式:
Sout1(k)=Sp(k)+Si(k-1)+KiSp(k)+Kc(Sout2(k)-Sout1(k))+Kd(Sp(k)-Sp(k-1))
输出结果Sout1进行预饱和限幅输出得到Sout2。
6.根据权利要求1所述的高精度舵机位置控制方法,其特征在于,所示步骤(5)中,在速度控制中,预饱和输出Sout2将作为当前速度控制器的参考速度R2n(S),
参考速度R2n(S)的计算公式:
当前速度检测H2n(S)的计算公式:
当前采样位置H2n(S)和参考位置R2n(S)做偏差E2(S),速度控制器进行PID处理,令
速度控制器输出量是速度增量ΔVout1,由上式可得
ΔVout1(k)=Vout1(k)-Vout1(k-1)=Kp[e(k)-e(k-1)]+KIe(k)+KD[e(k)-2e(k-1)+e(k-2)],
根据速度增量,对当前速度进行修正,计算公式:Vout1(k)=Vout1(k-1)+ΔVout1(k)
对修正速度Vout1进行限幅输出,输出为最终速度Vout2;
对最终速度Vout2进行PWM转换,转换计算公式:
其中,Pwm_Value为用于速度控制的占空比值,
K的比例值由当前电压下,速度与PWM的对应线性关系线求出。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710018701.1A CN106681134A (zh) | 2017-01-10 | 2017-01-10 | 一种高精度舵机位置控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710018701.1A CN106681134A (zh) | 2017-01-10 | 2017-01-10 | 一种高精度舵机位置控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN106681134A true CN106681134A (zh) | 2017-05-17 |
Family
ID=58850501
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710018701.1A Pending CN106681134A (zh) | 2017-01-10 | 2017-01-10 | 一种高精度舵机位置控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106681134A (zh) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109839932A (zh) * | 2019-02-20 | 2019-06-04 | 南通大学 | 基于惯性测量单元与gps的自动导航方法 |
CN109960290A (zh) * | 2017-12-14 | 2019-07-02 | 深圳市优必选科技有限公司 | 舵机输出控制方法、系统及装置 |
CN111290262A (zh) * | 2020-03-12 | 2020-06-16 | 江苏酷卡德工智能科技有限公司 | 电动舵机的控制方法及装置 |
CN113431925A (zh) * | 2021-07-12 | 2021-09-24 | 南京工程学院 | 电液比例阀及其位置控制系统、控制方法与故障预测方法 |
CN113431926A (zh) * | 2021-07-12 | 2021-09-24 | 南京工程学院 | 一种电液比例阀及其高精度位置控制系统 |
CN116147698A (zh) * | 2023-01-04 | 2023-05-23 | 广东工业大学 | 一种水陆空多栖侦查的监测系统 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1519673A (zh) * | 2003-01-21 | 2004-08-11 | 发那科株式会社 | 伺服控制装置 |
US20150009259A1 (en) * | 2008-03-31 | 2015-01-08 | Seiko Epson Corporation | Motor control device, fluid ejection device, and motor control method |
CN105093927A (zh) * | 2015-07-28 | 2015-11-25 | 中国科学院长春光学精密机械与物理研究所 | 电动舵机死区换向替代补偿方法 |
-
2017
- 2017-01-10 CN CN201710018701.1A patent/CN106681134A/zh active Pending
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1519673A (zh) * | 2003-01-21 | 2004-08-11 | 发那科株式会社 | 伺服控制装置 |
US20150009259A1 (en) * | 2008-03-31 | 2015-01-08 | Seiko Epson Corporation | Motor control device, fluid ejection device, and motor control method |
CN105093927A (zh) * | 2015-07-28 | 2015-11-25 | 中国科学院长春光学精密机械与物理研究所 | 电动舵机死区换向替代补偿方法 |
Non-Patent Citations (2)
Title |
---|
吴笑天: "基于DDS技术的超声波电机驱动控制研究", 《中国优秀硕士学位论文全文数据库(电子期刊)》 * |
徐科军 等: "传感器动态非线性的一种补偿方法", 《仪器仪表学报》 * |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109960290A (zh) * | 2017-12-14 | 2019-07-02 | 深圳市优必选科技有限公司 | 舵机输出控制方法、系统及装置 |
CN109839932A (zh) * | 2019-02-20 | 2019-06-04 | 南通大学 | 基于惯性测量单元与gps的自动导航方法 |
CN111290262A (zh) * | 2020-03-12 | 2020-06-16 | 江苏酷卡德工智能科技有限公司 | 电动舵机的控制方法及装置 |
CN113431925A (zh) * | 2021-07-12 | 2021-09-24 | 南京工程学院 | 电液比例阀及其位置控制系统、控制方法与故障预测方法 |
CN113431926A (zh) * | 2021-07-12 | 2021-09-24 | 南京工程学院 | 一种电液比例阀及其高精度位置控制系统 |
CN116147698A (zh) * | 2023-01-04 | 2023-05-23 | 广东工业大学 | 一种水陆空多栖侦查的监测系统 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106681134A (zh) | 一种高精度舵机位置控制方法 | |
CN110531707B (zh) | Scara机器人的摩擦模型改进以及动力学参数辨识方法 | |
CN106444372B (zh) | 用于电机伺服系统的滑模重复控制器 | |
Su et al. | A simple improved velocity estimation for low-speed regions based on position measurements only | |
CN104260107B (zh) | 一种实现空间机械臂柔性关节齿隙补偿的方法 | |
CN102280572B (zh) | 压电陶瓷执行器迟滞特性的复合线性化控制方法及其实现电路 | |
CN110086400B (zh) | 一种机电伺服系统非线性变增益控制方法和系统 | |
EP1956447A2 (en) | Apparatus and method for proportional-integral-derivative control | |
CN107121932B (zh) | 电机伺服系统误差符号积分鲁棒自适应控制方法 | |
CN113241973B (zh) | S型滤波器迭代学习控制直线电机轨迹跟踪控制方法 | |
CN105549381B (zh) | 一种基于吸引律的离散重复控制方法 | |
CN103984234A (zh) | 一种电液伺服系统自修正模糊pid控制的方法 | |
CN104360635A (zh) | 一种电机位置伺服系统的抗干扰控制方法 | |
CN108958041B (zh) | 一种基于双曲正割吸引律的离散双周期重复控制方法 | |
CN104536297B (zh) | 一种串级自抗扰的多闭环控制方法 | |
CN103472730A (zh) | 一种基于谐波减速器扭转刚度迟滞模型的双框架控制力矩陀螺高精度框架速率伺服系统 | |
CN110134014B (zh) | 周期伺服系统幂次吸引重复控制的等效扰动补偿方法 | |
Precup et al. | Model-free tuning solution for sliding mode control of servo systems | |
US6310456B1 (en) | Control system and method | |
Andrieu et al. | Continuous discrete observer with updated sampling period | |
CN102270007A (zh) | 压电陶瓷执行器迟滞特性的前馈开环线性化控制方法及其实现电路 | |
CN111880483B (zh) | 一种雷达天线四电机驱动伺服系统预定性能控制方法 | |
CN111030503B (zh) | 一种压电陶瓷的抗迟滞方法、装置、设备和介质 | |
CN109388063A (zh) | 自适应卡尔曼滤波复合控制方法 | |
CN104731019A (zh) | 基于Cycle to Cycle反馈控制的数控凸轮磨削轮廓误差补偿控制方法 |
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 | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20170517 |
|
RJ01 | Rejection of invention patent application after publication |