1.一种用于微夹持器系统的最优轨迹规划方法,其特征在于,所述的微夹持器系统包括电机、基底、宏运动平台、柔性微夹持器,所述的电机驱动所述的宏运动平台转动,所述的柔性微夹持器一端固定在所述的宏运动平台上,另一端即执行器端为自由端,所述的宏运动平台在所述电机的驱动下从0时刻起带动所述的柔性微夹持器在T时刻将所述的柔性微夹持器从起始点送至目标点,所述的最优轨迹规划方法被用于所述的微夹持器系统以使得在所述T时刻位于所述目标点的所述柔性微夹持器的残余振动为最小,所述的最优轨迹规划方法包括如下步骤:
(1)根据所述微夹持器系统的动能、势能和虚功,得到所述的微夹持器系统的分布参数模型:
(2)通过假设模态法,得到所述动能的常微分方程和所述势能的常微分方程,结合阻尼效应,得到所述的微夹持器系统的状态空间模型,确定目标函数;
(3)通过分段五次多项式对所述柔性微夹持器的运动轨迹进行近似,确定控制量的初始约束和终端约束,确定控制量的连续性约束和四阶导数的连续性约束;
(4)通过灵敏度分析方法,得到灵敏度方程,初始条件以及梯度方程;
(5)根据初始条件计算所述的状态空间模型和所述灵敏度方程;确定最优参数序列并输出。
2.如权利要求1所述的用于微夹持器系统的最优轨迹规划方法,其中,步骤(1)中所述的动能为:
式中θ(t)表示所述宏运动平台的旋转角度,L为所述柔性微夹持器的总长度,l∈[0,L]为空间变量;t∈[0,T]为时间变量;P(l,t)表示所述柔性微夹持器上的点;me表示所述执行器的等效质量;TM表示电机转子、宏运动平台和基底相对于旋转中心O的总惯性矩;ρ表示密度;h为所述柔性微夹持器的厚度;b(l)为所述柔性微夹持器的高度函数;
式中P(l,t)点的速度有
式中r表示旋转半径;表示r和所述柔性微夹持器之间的角度;w(l,t)表示所述柔性微夹持器的弯曲变形;
所述的势能为:
式中E为弹性模量;I(l)=b(l)h3/12为面积惯性矩;
所述的虚功为:
δW=τδθ(t),
式中,τ为电机转矩;δθ(t)为所述宏运动平台的虚角位移所述的分布参数模型为:
式中,TE为所述微夹持器系统的动能,VE为所述微夹持器系统的势能,W为所述电机的虚功。
3.如权利要求2所述的用于微夹持器系统的最优轨迹规划方法,其中,步骤(2)中所述的动能的常微分方程为:
式中,
Φi(l)为所述柔性微夹持器的第i阶振型函数;qi(t)为第i阶广义机械位移;N是一个整数;且
所述的势能的常微分方程为:
式中,
所述状态空间模型为:
式中, 是正交矩阵,由
mqq,mθq和Kq的线性组合构成;
确定控制量为θ(t),则所述的目标函数为:式中,λ1和λ2分别为权重系数。
4.如权利要求3所述的用于微夹持器系统的最优轨迹规划方法,其中,步骤(3)中将整个时间域T分为p个时间子区间,[tk-1,tk),k=1,2,...,p,其中t0=0,tp=T;则在每个所述的时间子区间上近似运动轨迹为:θ(t)≈θk(t)=C5,kt5+C4,kt4+C3,kt3+C2,kt2+C1,kt+C0,k式中,C5,k,C4,k,C3,k,C2,k,C1,k,C0,k,k=1,...,p,是需要优化的参数;
所述的控制量θ(t)的初始约束为:对于角位移θ1(t0)有
对于角速度 有
对于角加速度 有
所述的控制量θ(t)的终端约束为:对于角位移θp(T)有
θp(T)=C5,pT5+C4,pT4+C3,pT3+C2,pT2+C1,pT+C0,p=Θf式中,Θf为终端角位移;
对于角速度 有
对于角加速度 有
所述的控制量θ(t)的连续性约束为:C5,k+1tk5+C4,k+1tk4+C3,k+1tk3+C2,k+1tk2+C1,k+1tk+C0,k+1=C5,ktk5+C4,ktk4+C3,ktk3+C2,ktk2+C1,ktk+C0,k,k=1,...,p-1所述的四阶导数的连续性约束为:
5C5,k+1tk4+4C4,k+1tk3+3C3,k+1tk2+2C2,k+1tk+C1,k+1=5C5,ktk4+4C4,ktk3+3C3,ktk2+2C2,ktk+C1,k,
20C5,k+1tk3+12C4,k+1tk2+6C3,k+1tk+2C2,k+1=20C5,ktk3+12C4,ktk2+6C3,ktk+2C2,k,60C5,k+1tk2+
24C4,k+1tk+6C3,k+1=60C5,ktk2+24C4,ktk+6C3,k,120C5,k+1tk+24C4,k+1=120C5,ktk+24C4,k,k=
1,...,p-1。
5.如权利要求4所述的用于微夹持器系统的最优轨迹规划方法,其中,步骤(4)中所述的状态空间模型变为:
式中, 是指标函数,且有
则所述的目标函数G对于C5,k,k=1,...,p,其所述的灵敏度方程和梯度方程为:t∈[tm-1,tm),m=1,2,...,p,k=1,2,...,p;
式中,
且有
同理得到所述的目标函数对于C4,k,C3,k,C2,k,C1,k,C0,k,k=1,2,...,p的所述的灵敏度方程和所述的梯度方程。
6.如权利要求5所述的用于微夹持器系统的最优轨迹规划方法,其中,步骤(5)包括如下子步骤:
(5A)将常规五次多项式前面各阶次的系数赋给C5,k,C4,k,C3,k,C2,k,C1,k,C0,k,k=1,...,p作为初始值;
(5B)验证所述初始值是否满足各约束条件;如不满足,则利用MATLAB的非线性优化求解的方式在参数有限的范围内改动,直到满足为止;
(5C)利用MATLAB的微分方程求解器,根据各初始条件并行计算分段五次多项式逼近后的所述状态空间模型和所述的灵敏度方程;
(5D)得到目标函数值和梯度值,如所述目标函数值与上一步的目标函数值相差10-13或梯度值达到10-8,程序运行结束,输出最优的参数序列;否则,根据当前的梯度信息,利用MATLAB的非线性优化求解器,得到新的初始值,并保持此步的目标函数值,返回步骤(5A);
(5E)得到C5,k,C4,k,C3,k,C2,k,C1,k,C0,k,k=1,...,p,的最优参数序列,完成所述的最优轨迹规划。
7.一种微夹持器系统,其特征在于,包括电机、基底、宏运动平台、柔性微夹持器,所述的电机驱动所述的宏运动平台转动,所述的柔性微夹持器一端固定在所述的宏运动平台上,另一端即执行器端为自由端,所述的宏运动平台在所述电机的驱动下从0时刻起带动所述的柔性微夹持器在T时刻将所述的柔性微夹持器从起始点送至目标点。
8.如权利要求7所述的微夹持器系统,其中,还包括运动轨迹控制模块,所述运行轨迹控制模块被设置为根据权利要求1-6中任意一项中所述的用于微夹持器系统的最优轨迹规划方法规划而得的最优轨迹对所述的柔性微夹持器的运动轨迹进行控制。