智能扫雪机器人直线行走控制方法与流程

文档序号:12277565阅读:来源:国知局

技术特征:

1.智能扫雪机器人直线行走控制方法,其特征在于:包括以下步骤:

1)根据:获得电枢电压ua,其中:ia为电枢电流,Ra为电枢回路电阻,la为电枢回路电感,e1为电机电枢反电动势;其中e1=cen,ce为电机的电势常数,n为电机转速;

再结合方程:

TL=Cmial,Te=Cmia,其中:J为电机的转动惯量,λ为电机的粘滞摩擦系数,TL为电机的负载转矩,Te为电机的电磁转矩,Cm为电机的转矩常数,ial为对应于负载转矩的负载电流;

得到:

其中:J,Cm,Ra是已知参数;因为是有界的,所以令D(*)是一个干扰项,由于电机的粘滞摩擦系数λ和电势常数ce的值未知,所以令F(*)为未知项,进而得到:其中,

2)通过霍尔传感器测量电机的转速n,得到转速n与设定转速的误差:e=n-n*,其中:n*是设定转速。

3)根据自适应算法得到并假设一个辅助函数:其中ε是设定的参数,令则有L(*)≤aφ,其中:φ=|n|+1,a=max{F,|H|};

根据自适应算法得到输出电压的值:ua=-(kp1+Δkp1)E,其中,kp1是自己设定的常数,取其中:的估计值,C1是设定的常数,r是设定的常数;

4)根据输出电压的值:ua=-(kp1+Δkp1)E控制电机的电枢电压,改变电机的转速n,使驱动扫雪机器人两边履带的电机的转速相同。

当前第2页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1