第7期
胡立,等:一种简易的电梯速度曲线生成方法
当#I<f<£:时,口=—知。矸+%(£一t1)
(5)
当£2<f<b时,F=屹。;一{p2(t3一£)2
(6)
切点速度%为:%=—知.L
2
(7)
切点速度K为:K=L。一n,咒+—知。t2(8)
其中各段运行时间为:£。=r,,f:=t+(,。一
咒)/2,r,=F。+(r1+t)/2
同理,可得到减速段EFGH的连续数学模型及
其相关的切点速度和运行时间。
下面建立离散数学模型。
1.2
离散系统中的数学模型
按常规的离散化方法,得到几个十分复杂的递
推式。因此,增加一个加速度的递推公式,采用增量
法将各段速度皓线离散化,即可得到以下几个简单
的递推式。
在抛物线AB段内,有
Ⅱ‘…=∥’+p
L
口(‘+”
2口‘‘’+。‘‘+1’
f91
式中
。‘“、。‘““一第^次和第☆+1次的加速度;
口¨’、口¨+1’一第^次和第^+1次的速度;
在直线段Bc段内,加速度为恒定值o。,有
口‘‘+1’2
F‘‘’+n。
(10)
在抛物线cD段内,有
o(^+¨2Ⅱ(¨一01
F(‘+“2口(‘’+n(‘+1’
f111
有了递推公式,还需计算加速段两个切点速度,有
y。:岛,r。2:÷。。n
(12)
1
K=y…一÷。。L
(13)
同理,减速段离散化公式为:
在抛物线EF内,有
Ⅱ(I+”=Ⅱ(‘)+p2
_(川):F‘“一Ⅱ‘‘+。’
n41
在直线段FG内,加速度为恒定值,有
口‘“”=F‘“一o。
(15)
在抛物线GH内,有
Ⅱ(^+L)2
d(¨一D,
口‘‘+”2
F‘“一。(‘+1’
“61
减速段两个切点速度
yG=K+÷口。r,
(17)
L
1
K=P。。一÷n。t
(18)
‘
1.3
离散数学模型的说明
为便于说明,定义一些变量:n一电梯单层运
行时的速度;LL_一以最大加速度。。从0加速到K
所需要的时间,s。则:
V.
t’=≯咒
(19)
y…
(1)通过l ms定时器周期中断获得离散化的单
位时间,则图l中每段曲线的递推次数为该曲线段
时长/1 ms。用户可以灵活的设定曲线各段的时间
长度。
注意,r。是上升到最大给定速度所需的时间
k。当给定的最大速度n小于k。时,连续模型中
各段运行时间中的L必须由L 7代替。这样设置的
目的是为了方便的实现电梯的分速运行。
设多层运行速度的给定值为P…,单层运行速
度的给定值为K。当集选控制器判断出为单层运行
时,只要根据具体的楼层间距,合理的设置咒、r。、
t、K和k。,即可满足单层和多层的不同运行距离
要求,从而实现分速运行。
(2)如图1所示,过B点的速度曲线切线的斜率
即为该点对应的加速度,按如上离散化方法,可保证
在B点前后的加速度近似相等,从而AB和Bc相切
于B点,即曲线在B点是平滑的。同理,按此算法也
可保证c、F、G三点处曲线的平滑,实现曲线的平滑
性就能够很好的满足乘梯舒适性的要求。
2
软件实现
在主程序中,通过键盘显示程序设置运行参数
t、r,、t、K、k。和K等,并写人EEPRoM中,然后
根据这些参数及式(1)~(18)计算p。、p:、n。、P。、
p;,蚱,%。
在1 ms定时器中断程序中,当接收到运行信号
时,根据集选控制器给定的最大速度,程序首先判断
是加速段ABcD还是减速段EFGH,然后判断具体
是哪一段,选择对应段的递推式即可得到实时的给
定速度。其流程图,如图2、图3、图4所示。
采用MT法测得电机实际转速,然后与实时给
定速度比较,通过PID调节器,经过一定的变换产生
6路PwM波,从而驱动电机按给定速度运行。
万方数据