
基本信息:
- 专利标题: 一种基于部分已知参数的两轮自平衡机器人控制方法
- 专利标题(英):Two-wheeled self-balance robot control method based on part of known parameters
- 申请号:CN201610530428.6 申请日:2016-06-30
- 公开(公告)号:CN106182000A 公开(公告)日:2016-12-07
- 发明人: 陈龙 , 胡华 , 满志红 , 黄明 , 马学条
- 申请人: 杭州电子科技大学
- 申请人地址: 浙江省杭州市下沙高教园区二号大街1号
- 专利权人: 杭州电子科技大学
- 当前专利权人: 杭州电子科技大学
- 当前专利权人地址: 浙江省杭州市下沙高教园区二号大街1号
- 代理机构: 北京中政联科专利代理事务所
- 代理人: 吴建锋
- 主分类号: B25J9/16
- IPC分类号: B25J9/16 ; B25J5/00
The invention discloses a two-wheeled self-balance robot control method based on part of known parameters. The two-wheeled self-balance robot control method comprises the following steps of: arranging a controller in a maser control chip; obtaining motion parameters of a self-balance robot; obtaining an expected angle Theta r by taking speed errors ev of expected speed with FORMULA as shown in the specification and practical speed with FORMULA as shown in the specification as an input signal of a speed robust controller and a speed sliding mode controller; and controlling output voltage U to drive a motor system to move by taking angle errors eTheta of an expected angle Theta r and a practical angle Theta and angular speed with FORMULA as shown in the specification as an input signal of an angle robust controller and an angle sliding mode controller. With the adoption of the technical scheme provided by the invention, output control on the angle robust controller, the angle sliding mode controller, the speed robust controller and the speed sliding mode controller is realized by taking differential as feedback, so that the controller still can keep good performance of the two-wheeled self-balance robot when some parameters in the practical two-wheeled self-balance robot have deviation.
公开/授权文献:
- CN106182000B 一种基于部分已知参数的两轮自平衡机器人控制方法 公开/授权日:2018-07-20
IPC结构图谱:
B | 作业;运输 |
--B25 | 手动工具;轻便机动工具;手动器械的手柄;车间设备;机械手 |
----B25J | 机械手;装有操纵装置的容器 |
------B25J9/00 | 程序控制机械手 |
--------B25J9/16 | .程序控制 |