发明名称 |
一种两轮自平衡机器人滑模自适应控制系统 |
摘要 |
本发明公开了一种两轮自平衡机器人滑模自适应控制系统,包括传感器测量模块、主控芯片和电机系统,其中,传感器测量模块用于采集自平衡机器人运动参数,电机系统用于驱动两轮自平衡机器人运动;主控芯片与传感器测量模块和电机系统相连接,用于根据传感器测量模块采集的运动参数控制电机系统的运动;主控芯片中设置滑模自适应控制器,滑模自适应控制器的输出方程为:U=‑(K+φ)X。采用本发明的技术方案,能够对外界环境进行自适应同时能够最大程度降低外界环境中各种干扰对两轮自平衡机器人的影响并且不损失鲁棒性,同时本发明还会利用机器学对一些长期积累因素进行磨合使两轮自平衡机器人具有最优的性能,从而保证了安全性与稳定性。 |
申请公布号 |
CN106078744A |
申请公布日期 |
2016.11.09 |
申请号 |
CN201610532075.3 |
申请日期 |
2016.06.30 |
申请人 |
杭州电子科技大学 |
发明人 |
陈龙;胡华;满志红;黄明;马学条 |
分类号 |
B25J9/16(2006.01)I;B25J5/00(2006.01)I |
主分类号 |
B25J9/16(2006.01)I |
代理机构 |
北京中政联科专利代理事务所(普通合伙) 11489 |
代理人 |
吴建锋 |
主权项 |
一种两轮自平衡机器人滑模自适应控制系统,其特征在于,包括传感器测量模块、主控芯片和电机系统,其中,所述传感器测量模块用于采集自平衡机器人运动参数,该运动参数至少包括角速度信号和加速度信号;所述主控芯片根据角速度信号和加速度信号能够获取角度参量θ和角速度<img file="FDA0001037441710000011.GIF" wi="60" he="76" />所述电机系统用于驱动两轮自平衡机器人运动;所述主控芯片与所述传感器测量模块和所述电机系统相连接,用于根据所述传感器测量模块采集的运动参数控制所述电机系统的运动;所述主控芯片中设置滑模自适应控制器,所述滑模自适应控制器根据实时输入的角度参量θ和角速度<img file="FDA0001037441710000012.GIF" wi="35" he="55" />控制输出电压U从而驱动电机系统运动;所述滑模自适应控制器的输出方程为:U=‑(K+φ)X;其中,X为角度参量θ和角速度<img file="FDA0001037441710000013.GIF" wi="35" he="55" />的集合,K是通过极点计算出来的参数矩阵;φ取值是根据以下公式决定:<img file="FDA0001037441710000014.GIF" wi="478" he="95" />γ是自适应速率,e为角度误差参数,C取[0 0 1 1]。 |
地址 |
310018 浙江省杭州市下沙高教园区二号大街1号 |