舵机建模仿真
卓老师好,对于比赛我有个小小建议或者说是请求。官方提供的样片tc264d芯片他的内部ram太小了,而且也没有硬件fft,有没有可能申请一批价格稍低一点的tc264da型号的芯片让我们购买呢如果同学们不在乎费用的话,可以考虑使用TC275, 这款芯片性能上来讲应该更高,在国内的一些线上代理商平台也能买到,就是价格更贵些...
卓大大 您能发篇推文讲解一下舵机控制的传递函数如何求解吗 在做智能车仿真时卡在这里了。
▲ 舵机的传递函数如何建立
的确,宅在家里手里没有实际的智能车模,也无法实际调试。利用所学习的理论知识来对智能车建模仿真也是一种锻炼的方法。这更能够将课内课外结合起来。
在仿真智能车控制中,有很多环节需要建模,其中的舵机环节是影响车模运行性能的重要环节。你提到如何对舵机进行建模的问题非常重要,回答这个问题需要从以下这几个方面来讨论。
什么是传递函数?
在分析和设计任何系统的时候,最重要的一个环节就是对系统进行建模。有很多数学模型可以用于控制系统的描述。比如:微分方程、传递函数、状态方程等。
▲ 线性时不变系统的输入输出信号
传递函数是用来刻画线性时不变(LTI:Linear Time Invariant)系统零状态下输入输出信号之间的关系。针对控制问题来说,系统函数可以定义为系统输出信号的拉普拉斯变换与输入信号拉普拉斯变换的比值。
下面微分方程描述了线性时不变系统输入输出时域关系:
d n y ( t ) d t n + a 1 d n − 1 y ( t ) d t n − 1 + ⋯ + a n y ( t ) = b 0 d m x ( t ) d t m + b 1 d m − 1 x ( t ) d t m − 1 + ⋯ + b m x ( t ) {{d^n y\left( t \right)} \over {dt^n }} + a_1 {{d^{n - 1} y\left( t \right)} \over {dt^{n - 1} }} + \cdots + a_n y\left( t \right) = b_0 {{d^m x\left( t \right)} \over {dt^m }} + b_1 {{d^{m - 1} x\left( t \right)} \over {dt^{m - 1} }} + \cdots + b_m x\left( t \right) dtndny(t)+a1dtn−1dn−1y(t)+⋯+any(t)=b0dtmdmx(t)+b1dtm−1dm−1x(t)+⋯+bmx(t)
如果系统是零状态,那么对方程两边做Laplace变换,可得:
(
s
n
+
a
1
s
n
−
1
+
⋯
+
a
n
)
Y
(
s
)
=
(
b
0
s
m
+
b
1
s
m
−
1
+
⋯
+
b
m
)
X
(
s
)
\left( {s^n + a_1 s^{n - 1} + \cdots + a_n } \right)Y\left( s \right) = \left( {b_0 s^m + b_1 s^{m - 1} + \cdots + b_m } \right)X\left( s \right)
(sn+a1sn−1+⋯+an)Y(s)=(b0sm+b1sm−1+⋯+bm)X(s)
系统函数定义为:
H
(
s
)
=
Y
(
s
)
X
(
s
)
=
s
n
+
a
1
s
n
−
1
+
⋯
+
a
n
b
0
s
m
+
b
1
s
m
−
1
+
.
⋯
+
b
m
H\left( s \right) = {{Y\left( s \right)} \over {X\left( s \right)}} = {{s^n + a_1 s^{n - 1} + \cdots + a_n } \over {b_0 s^m + b_1 s^{m - 1} + . \cdots + b_m }}
H(s)=X(s)Y(s)=b0sm+b1sm−1+.⋯+bmsn+a1sn−1+⋯+an
讲到这儿,只是定义了什么是可以用于控制研究的传导函数。在具体建立舵机的系统函数之前,需要判断一下舵机是否满足建立传递函数的条件:线性时不变特性。
▲ 舵机输出与控制之间之间的关系
舵机是线性时不变系统吗?
线性时不变特性是描述了系统的输入输出之间的两个特性,线性性和时不变特性。
时不变特性描述了系统的由系统输入信号 x ( t ) x\left( t \right) x(t)所引起的系统输出 y ( t ) y\left( t \right) y(t),是否随着输入信号的时间变化 x ( t − t 0 ) x\left( {t - t_0 } \right) x(t−t0)而产生相同的时间变化 y ( t − t 0 ) y\left( {t - t_0 } \right) y(t−t0)。舵机的输入输出之间的关系基本上满足时不变特性。
线性特性是指系统输入输出之间满足齐次性和叠加性,如果限定系统是实数系统,那么满足叠加性也就满足齐次性了。
下图显示了舵机在给定的指令 x ( t ) x\left( t \right) x(t)之后,实际测量输出角度 y 1 ( t ) y_1 \left( t \right) y1(t)变化的情况。基本上是按照一个恒定的转速转动到指定角度便停止了。
▲ 舵机的单位阶跃相应
那么,如果将指令 x ( t ) x\left( t \right) x(t)放大两倍,变成 2 x ( t ) 2x\left( t \right) 2x(t),舵机大约经过两倍的时间,到达两倍的角度,角度信号为 y 2 ( t ) y_2 \left( t \right) y2(t)。如果仅仅是从最终输出角度数值 y 2 ( ∞ ) y_2 \left( \infty \right) y2(∞)来看,它与输入信号 x ( t ) x\left( t \right) x(t)之间是线性(比例)关系。但从动态过程 y 2 ( t ) y_2 \left( t \right) y2(t)来看,输出信号并不是放大两倍: y 2 ( t ) ≠ 2 y 1 ( t ) y_2 \left( t \right) \ne 2y_1 \left( t \right) y2(t)=2y1(t)
所以,舵机不是一个线性系统。
▲ 舵机输出信号示意图
由于实际舵机不满足线性时不变特性,所以本质上讲,它无法使用传递函数了描述。
实际系统的线性近似
的确,很多实际系统不满足线性时不变特性。这就使得应用系统函数进行描述遇到困难。在一定条件下,可以将系统进行线性近似。
比如,只研究系统输入输出之间变化量的关系,可以引入增量线性系统的概念。如果系统是分段线性的,可以在每一阶段内建立对应的传递函数。
▲ 分段线性化
如果系统输入输出之间的关系足够平滑,而系统运行时变化范围小,这样可以使用局部线性化来近似该系统。
▲ 小型号线性化
那么对于舵机来讲,它是否满足上面的线性近似呢?很遗憾,至少对控制车模转向的小型舵机来讲,在它的工作范围内很难获得比较好用的线性化后的模型了,主要的原因是舵机工作在大的动态范围内。
▲ 舵机控制前轮转向
为什么舵机不是线性的?
舵机内部包括有小型直流电机、减速齿轮、驱动电路以及位置传感器等,是一个机电一体化的位置闭环负反馈系统。其中的小型电机、位置传感器以及直流电机都可以近似看成线性系统,非线性主要来自于驱动电路。
由于受到工作电压以及功率的限制,驱动电路输出具有饱和特性。这样就决定了电机转速被限制在一定的范围之内。当电路输出进行饱和之后,电机的转速就是恒定值,驱动输出角度按照恒定角速度转动,从而与输入信号之间就不再保持线性关系了。
▲ 舵机内部结构示意图
所以,你可能看到网络上很多对舵机进行建模分析的,大部分都是针对于大型的伺服舵机,它的输出能力大于实际负载,或者说特别关注于小范围的动态过程,此时可以使用传递函数建立相对精确的模型。
如何近似建立舵机数学模型?
根据上面分析,如何来对舵机建立可以用于仿真的数学模型呢?
1. 修改舵级的驱动
前面分析了小型舵机的非线性主要来自于内部驱动电路板输出饱和造成的,因此如果更换外部强劲的驱动电路,就可以减少这方面的限制了。
在推文五线接口舵机中给出了是所有A4950作为舵机功率驱动的设计方法,在一定程度上可以扩大舵机工作的线性范围。
由于舵机的特性关系到车模运行的速度,所以在比赛规则中除了特殊的组别(节能组、大型L型车模)之外,是不允许修改舵机内部电路的。
2. 使用纯延时环节替代舵机
由于舵机基本上工作在饱和恒速状态,在实际建模分析的时候,可以将它的传递函数近似以下的方式:
(1)比例环节: 就是输入输出之间就是一个比例放大环节。传递函数为: H ( s ) = k H\left( s \right) = k H(s)=k。
(2)纯延时环节: 根据舵机的工作参数,将舵机近似成一个纯延时环节:
H
(
s
)
=
e
−
s
t
0
H\left( s \right) = e^{ - st_0 }
H(s)=e−st0。其中
t
0
t_0
t0可以根据舵机参数来确定。
(3)一阶惯性关节:
H
(
s
)
=
e
−
s
t
0
=
e
−
t
0
2
s
e
t
0
2
s
≈
1
−
t
0
s
2
+
t
0
2
s
2
8
+
⋯
+
(
−
t
0
s
2
)
k
k
!
1
+
t
0
s
2
+
t
0
2
s
2
8
+
⋯
+
(
t
0
s
2
)
k
k
!
≈
1
t
0
s
+
1
H\left( s \right) = e^{ - st_0 } = {{e^{ - {{t_0 } \over 2}s} } \over {e^{{{t_0 } \over 2}s} }} \approx {{1 - {{t_0 s} \over 2} + {{t_0^2 s^2 } \over 8} + \cdots + {{\left( { - {{t_0 s} \over 2}} \right)^k } \over {k!}}} \over {1 + {{t_0 s} \over 2} + {{t_0^2 s^2 } \over 8} + \cdots + {{\left( {{{t_0 s} \over 2}} \right)^k } \over {k!}}}} \approx {1 \over {t_0 s + 1}}
H(s)=e−st0=e2t0se−2t0s≈1+2t0s+8t02s2+⋯+k!(2t0s)k1−2t0s+8t02s2+⋯+k!(−2t0s)k≈t0s+11
下面是使用纯延迟环节仿真车模在转弯时的运行情况:
▲ 车模实际运行情况
▲ 使用纯延时环节仿真车模转向控制
3. 建立舵机的非线性模型
不再使用传递函数来描述舵机的输入输出关系,而是直接建立它的输入输出之间的非线性动态关系。这一点可以通过普通的状态机、查表方法、人工神经网络建立。或者通过测量舵机的输入输出关系来进行数值描述等。
4. 硬件在环
如论数学描述多么精确,实际上都很难对舵机在实际上工作状态下完整的描述。因此,将来在做仿真的时候,也可以建立起硬件在环的仿真机制。将整个的仿真环节回归到时间域来进行。舵机模型则利用它的非线性时间模型来给出动态特性。
▲ 硬件在环仿真示意图
小结
对于智能车仿真来讲,建议你可以使用简单的比例、纯延时、一阶惯性环节来对车模上的舵机进行建模。虽然这只是近似,但在给出车模控制基本参数之后,在实际的车模运行中再进行参数调整。
如果一切都能够通过仿真搞定,那么还需要现场比赛干什么呢?
开放原子开发者工作坊旨在鼓励更多人参与开源活动,与志同道合的开发者们相互交流开发经验、分享开发心得、获取前沿技术趋势。工作坊有多种形式的开发者活动,如meetup、训练营等,主打技术交流,干货满满,真诚地邀请各位开发者共同参与!
更多推荐
所有评论(0)