一种改进的三角函数切换算法制造技术

本发明专利技术公开了一种改进的三角函数切换算法，与现有技术相比，本发明专利技术在多个输入同时作用下的复合运动分解为单个控制输入下的简单运动，同时以三角函数作为控制输入，结合时间尺度变换技术可使速度输入曲线变得平缓，克服了bang‑bang和分段常数法中输入切换处路径不光滑和过高波动的问题。

【技术实现步骤摘要】

本专利技术涉及一种三角函数，尤其涉及一种改进的三角函数切换算法。
技术介绍
现有技术中，三角函数分段切换法基本思想是把链式系统的多个输入在时间轴上进行分时处理——即在每一时间段上仅允许一个输入有效而其他输入全部为零，使链式系统在多个输入同时作用下的复合运动分解为单个控制输入下的简单运动，同时以三角函数作为控制输入，结合时间尺度变换技术可使速度输入曲线变得平缓，克服了bang-bang和分段常数法中输入切换处路径不光滑和过高波动的问题。
技术实现思路
本专利技术的目的就在于为了解决上述问题而提供一种改进的三角函数切换算法。本专利技术通过以下技术方案来实现上述目的：本专利技术由链式系统数学模型的三角结构形式知，在控制输入[0,aisinωt][ai+1sinωt,0]的二次切换作用下，链式变量的运动在时间τ∈[(k+(i+1)/s)δ,(k+(i-1)/s)δ]上被分解为两部分，即[0,Δz2,0,…,0]，[Δz1,0,Δz3,…,Δzn]，其中要使包含链式变量{z3,z4,…,zn

【技术保护点】
一种改进的三角函数切换算法，其特征在于：由链式系统数学模型的三角结构形式知，在控制输入[0,ai sinωt][ai+1sinωt,0]的二次切换作用下，链式变量的运动在时间τ∈[(k+(i+1)/s)δ,(k+(i‑1)/s)δ]上被分解为两部分，即[0,Δz2,0,…,0]，[Δz1,0,Δz3,…,Δzn]，其中要使包含链式变量{z3,z4,…,zn}的n‑2个线性无关的方程有解，v1必然最少经过n‑2次切换输入，v2最少需要n‑1次切换输入，因此三角函数控制输入的切换次数最少为2n‑3次，故链式系统路径规划的运动时间被等分的次数不低于2n‑3，下面给出具体的证明：定理1在控制输入v=[v1,v2]=[0,b1(1-cosωt)]t∈[kδ,(k+1/s)δ][b2(1-cosωt),0]t∈[(k+1/s)δ,(k+2/s)δ][0,b3(1-cosωt)]t∈[(k+2/s)δ,(k+3/s)δ][b4(1-cosωt),0]t∈[(k+3/s)δ,(k+4/s)δ]...---(4)]]>的作用下，两输入n维链式系统可以从初始位形z0运动到邻域内的目标位形zf，其中系统的运动控制时间T最少等分2n‑3次；式(4)仍然是将链式系统运动的时间等分为s段，但在每一段上用一个周期的余弦曲线作为控制输入，这样做的好处是同时保证了位移曲线和速度曲线都是光滑的；下面给出算法定理1的数学证明；证明：时间T被等分为2n‑3次，每一个时间段长度为η＝T/(2n‑3)，在奇数时间段上t∈[t2i,t2i+1]上(i∈{0,1,2,…,n‑2})，等分的时间间隔表示为η＝t2i+1‑t2i,，因此在奇数时间段上的式(4)可以表示为v1=0v2=b2i+1(1-cosωt),t∈[t2i,t2i+1]---(5)]]>式(5)中b2i+1是待定系数，角频率ω＝2π/η，代入到式(21)逐步积分，z1(t2i+1)=z1(t2i)z2(t2i+1)=b2i+1η+z2(t2i)z3(t2i+1)=z3(t2i)...zn(t2i+1)=zn(t2i)---(6)]]>类似的，在偶数时间段上t∈[t2j+1,t2j+2](j∈{0,1,2,…,n‑3})，等分的时间间隔表示为η＝t2j+2‑t2j+1，因此算法式(4)在偶数段上有，v1=b2j+2(1-cosωt)v2=0---(7)]]>将式(7)代入到链式系统在时间t∈[t2i+1,t2i+2]上积分，得：z1(t2j+2)=b2j+2η+z1(t2j+1)z2(t2j+2)=z2(t2j+1)...zn(t2j+2)=Σk=1n-2(b2j+2η)kzn-k(t2j+1)k!+zn(t2j+1)---(8)]]>通过迭代计算式(6)和式(8)，得到系统运动到时间T的目标位形zf，z1f=Σj=0n-3b2j+2η+z10z2f=Σi=0n-2b2i+1η+z20...znf=Σi=0n-3(Σj=in-3b2j+2η)n-2(n-2)!b2i+1η+Σk=1n-2(Σj=0n-3b2j+2η)kk!zn-k0+zn0---(9)]]>式(9)中含有n个方程和2n‑3个待定系数，将所有待定系数重新表示为两个系数矢量BO＝[b1,b3,…,b2n‑3]T和BE＝[b2,b4,…,b2n‑4]T，其中BO和BE分别称为奇数时间段系数矢量和偶数时间段系数矢量；由式(9)知BE中n‑2个元素满足，Σj=0n-3b2j+2=z1f-z10η---(10)]]>任意给定一组满足式(10)的BE，当时，BO中n‑1个系数可以由式(9)中剩余的n‑1个方程唯一确定；证毕；当时，有由式(9)知奇数时间段的系数矢量BO无解；解决的办法是设置一个中间位形且满足系统的路径规划问题分为两个步骤，第一步先控制系统从初始位形z0运动到中间位形zc，然后将中间位形zc看成一个新的初始位形，控制系统运动到目标位形zf；故当时，系统的路径就是以zc为中间位形、首尾连接的两段路径组成。...

【技术特征摘要】
1.一种改进的三角函数切换算法，其特征在于：由链式系统数学模型的三角结构形式知，在控制输入[0,ai sinωt][ai+1sinωt,0]的二次切换作用下，链式变量的运动在时间τ∈...

【专利技术属性】
技术研发人员：李亮，
申请(专利权)人：宝鸡文理学院，
类型：发明
国别省市：陕西;61