2
目 录
一、前言 .................................................................................................................................... 4
二、原理篇 ................................................................................................................................ 6
2.1 直立行走任务分解 .............................................................................................................. 6
2.2 车模直立控制 ...................................................................................................................... 7
2.3 车模速度控制 .................................................................................................................... 11
2.4 车模方向控制 .................................................................................................................... 14
2.5 车模倾角测量 .................................................................................................................... 15
2.6 车模直立行走控制算法总图 ............................................................................................ 19
三、电路设计篇 ...................................................................................................................... 21
3.1 整体电路框图 .................................................................................................................... 21
3.2 DSC 介绍与单片机最小系统 ........................................................................................... 22
3.3 倾角传感器电路 ................................................................................................................ 25
3.4 电机驱动电路 .................................................................................................................... 27
3.5 速度传感器 ........................................................................................................................ 28
3.6 电磁线检测电路 ................................................................................................................ 29
四、机械设计篇 ...................................................................................................................... 30
4.1 车模简化改装 .................................................................................................................... 30
4.2 传感器安装 ........................................................................................................................ 31
4.3 注意事项 ............................................................................................................................ 33
五、软件编写与调试篇 .......................................................................................................... 34
5.1 软件功能与框架 ................................................................................................................ 34
5.2 DSC 的资源配置 ............................................................................................................... 37
5.3 主要算法及其实现 ............................................................................................................ 38
5.4 程序调试与参数整定 ........................................................................................................ 46
5.5 现场运行测试 .................................................................................................................... 47
六、结束语 .............................................................................................................................. 47
附录: ...................................................................................................................................... 48