1.一种基于电压控制的轨迹跟踪方法,其特征在于,包括如下步骤:建立移动机器人在未知纵滑和侧滑下的运动学模型和第一动力学模型;
建立所述移动机器人驱动电机的第二动力学模型;根据所述第一动力学模型和第二动力学模型,得到总动力学模型;
根据所述运动学模型和预先建立的运动学控制模块,得到外环控制回路;基于所述外环控制回路以实现所述移动机器人的位姿跟踪;
根据所述预先建立的动力学控制模块和所述总动力学模型,得到以电压为总动力学模型控制输入的内环控制回路;基于所述内环控制回路采用线性扩张状态观测器对引入的集总扰动进行估计和补偿,并设计自抗扰控制器使移动机器人的当前速度收敛到所述运动学控制模块生成的期望速度,以实现所述移动机器人的轨迹跟踪;
其中,所述基于所述内环控制回路并采用电压控制方式对引入的集总扰动进行估计和补偿的步骤包括:
设计线性扩张状态观测器,通过所述线性扩张状态观测器对引入所述总动力学模型的集总扰动进行估计和补偿;其中,所述集总扰动包括以下信息的任意一种或任意组合:移动机器人未知纵滑和侧滑扰动信息、建模不确定及未知输入扰动信息;
其中,所述线性扩张状态观测器为通过以下函数得到:其中, 分别为状态向量x1、x2、x3的估计值,x1=z, x3=ds,z为移动机器人的实际速度, 为系统集总扰动,且
ΔMs为Ms的变化量,τd为未知有界可导力矩扰动, 为移动机器人发生侧滑时引起的非匹配扰动向量,μ为移T
动机器人侧滑速度,θ为移动机器人的方向角,η=[ηv ηω] ,ηv=r(ξr+ξl)/2为纵滑速度,ηω=r(ξr‑ξl)/(2b)为纵滑引起的横摆率扰动,r为移动机器人驱动轮半径,2b为两驱动轮之间的距离,ξl、ξr分别为移动机器人左右驱动轮纵滑引起的干扰角速度,m、J分别为移动机器人的质量和转动惯量,La、Ra、kt、kb分别为驱动电机的电枢电感、电枢电阻、转矩常数和反电动势常数,N为机械齿轮减速比;β1、β2、β3分别为线性扩张状态观测器的第一增益、第二增益、第三增益,分别取值为:ωo>0为观测器带宽;
T
ua=[uar ual] 表示
移动机器人右、左驱动轮控制电压;
其中,所述使移动机器人的当前速度收敛到所述运动学控制模块生成的期望速度的步骤包括:
设计自抗扰控制器,通过所述自抗扰控制器对所述移动机器人的当前速度进行控制,以使移动机器人的当前速度收敛到所述运动学控制模块生成的期望速度;
其中,所述自抗扰控制器为通过以下函数得到:其中, 分别为状态向量x1、x2、x3的估计值,x1=z, x3=ds,z为移动机器人的实际速度, 为系统集总扰动,且
ΔMs为Ms的变化量,τd为未知有界可导力矩扰动, 为移动机器人发生侧滑时引起的非匹配扰动向量,μ为移动T
机器人侧滑速度,θ为移动机器人的方向角,η=[ηv ηω],ηv=r(ξr+ξl)/2为纵滑速度,ηω=r(ξr‑ξl)/(2b)为纵滑引起的横摆率扰动,r为移动机器人驱动轮半径,2b为两驱动轮之间的距离,ξl、ξr分别为移动机器人左右驱动轮纵滑引起的干扰角速度,m、J分别为移动机器人的质量和转动惯量,La、Ra、kt、kb分别为驱动电机的电枢电感、电枢电阻、转矩常数和反电动势常数,N为机械齿轮减速比;zc为移动机器人的辅助速度,为控制器增益,ωc>0为控制器带宽;
其中,所述总动力学模型为通过以下函数得到:T
其中,ua=[uar ual]表示移动机器人右、左驱动轮控制电压,ΔMs为Ms的变化量,τd为未知有界可导力矩扰动, 为移动机器人发生侧滑时引起的非匹配扰动向量,μ为移动机器人侧滑速度,θ为移动机器人的方T向角,η=[ηv ηω],ηv=r(ξr+ξl)/2为纵滑速度,ηω=r(ξr‑ξl)/(2b)为纵滑引起的横摆率扰动,r为移动机器人驱动轮半径,2b为两驱动轮之间的距离,ξl、ξr分别为移动机器人左右驱动轮纵滑引起的干扰角速度,m、J分别为移动机器人的质量和转动惯量,La、Ra、kt、kb分别为驱动电机的电枢电感、电枢电阻、转矩常数和反电动势常数,N为机械齿轮减速比。
2.根据权利要求1所述的基于电压控制的轨迹跟踪方法,其特征在于,所述预先建立的运动学控制模块包括通过反步法设计得到的辅助运动学控制器。
3.根据权利要求2所述的基于电压控制的轨迹跟踪方法,其特征在于,所述辅助运动学控制器为通过以下函数得到:
其中vc、ωc分别为设计的移动机器人辅助线速度和辅助角速度,vr、ωr分别为移动机器人参考线速度和参考角速度,k1、k2、k3为辅助运动学控制器控制参数,且均为正常数,ex为移动机器人纵向误差,ey为移动机器人侧向误差,eθ为移动机器人方向误差。
4.一种基于电压控制的轨迹跟踪装置,用于实现上述权利要求1‑3任意一项所述的基于电压控制的轨迹跟踪方法,其特征在于,包括:第一模型建立单元,用于建立移动机器人在未知纵滑和侧滑下的运动学模型和第一动力学模型;
第二模型建立单元,用于建立所述移动机器人驱动电机的第二动力学模型;根据所述第一动力学模型和第二动力学模型,得到总动力学模型;
位姿跟踪单元,用于根据所述运动学模型和预先建立的运动学控制模块,得到外环控制回路;基于所述外环控制回路以实现所述移动机器人的位姿跟踪;
轨迹跟踪单元,用于根据所述预先建立的动力学控制模块和所述总动力学模型,得到以电压为总动力学模型控制输入的内环控制回路;基于所述内环控制回路采用线性扩张状态观测器对引入的集总扰动进行估计和补偿,并设计自抗扰控制器使移动机器人的当前速度收敛到所述运动学控制模块生成的期望速度,以实现所述移动机器人的轨迹跟踪。
5.一种移动机器人,其特征在于,包括移动机器人主体及设置在所述移动机器人主体上的控制器;所述控制器用于执行权利要求1至3任意一项所述的基于电压控制的轨迹跟踪方法。