采用STM32和MPU6050，蓝牙遥控，文件包括源程序，原理图和PCB文件。

主要利用陀螺仪以及请教传感器来实现小车的站立

包含matlab源文件、部分参考文献、课题报告文件、汇报PPT模板。 有需要的可以查看我发布的博客——https://blog.csdn.net/WSNDDM/article/details/112573449

两轮寻迹小车程序

摘 要: 两轮自平衡小车被各种竞赛所喜爱，在很多大型比赛中都有涉及此方向的题目。阐述了基于飞思卡尔系列单片机为核心控制器，配合陀螺仪、角度传感器实现两轮小车的自平衡。着重介绍了两轮自平 衡小车的结构、平衡原理、控制算法，通过反复调试最终实现了小车的自平衡。

STM32F103C8T6蓝牙遥控两轮小车代码+超声波检测 自己学习用的 注释较详细 使用L298N驱动电机 支持定时器输出PWM调速 两轮差速控制转向 超声波检测30cm停车

绍了一种MENS加速度计、陀螺仪与嵌入式微控制器相结合的两轮自平衡代步车姿态检测系统。针对加速度计和陀螺仪测量分别存在噪声干扰和随机漂移误差，采用卡尔曼滤波实现传感器数据融合，补偿传感器测量误差，得到车体姿态的最优估计。

自己做的自平衡小车，基本达到预期效果。制作资料在压缩包里面，供参考。 该两轮自平衡小车硬件设计概述: 控制器:ATmega16；8MHz； 加速度传感器:MMA2260；陀螺仪:EWTS82； 传感器的融合:卡尔曼滤波； 马达:EN_2342CR（速比64）+双路12脉冲编码器+CD40106对信号整形； 驱动板芯片:CD4001+IR2111+IRF1404（驱动电流可以很大）； 图片（拍摄效果不佳），视频如下: 小车实物图展示: 设计分析: 其实控制很简单，利用定时器产生10ms中断，每次中断进行如下工作: 1:AD采样加速度传感器和陀螺仪，然后卡尔曼滤波得出角度与角速度；（滤波模块借鉴老外的）（互补滤波效果感觉不是很好）； 2:计算车轮的速度，积分得出位置； 3:利用PD算法得出PWM值=K1*angle + K2*angle_dot + K3*speed + K4 * position； 4:前进后退给定参考速度计算即可； 注意: 增量式轮速传感器A相中断，读取B相电位判断前进还是后退，在10ms的时间内累加，计算车轮的速度； 由于10ms累加的轮速信号不多，直接计算车体会发抖，所以增加了低通滤波，解决问题； 我在外面增加4个电位器可以手动调节4个K值，方便调试； 附件的文件夹里面有matlab建模的资料，可以求出所需的4个K的值，（参考NXT的），大家可自行调试K值看看对车辆的影响； 电机选取建议: 由于考虑到减速器，而且带传感器。其实后面实践得知可以不要位置传感器，这样选择电机的空间就很大了，买便宜的； 电机扭矩要大；说白了，功率要大；转动惯量大似乎的更稳定，所以不用空心杯的也许更好； 减速比可以大一点，用较大的轮子； 重心越靠下，抗扰性越强；但是可能会影响稳定性； 购买的电机型号参考: 算法: 常用计算方法有两种:互补滤波和卡尔曼滤波；都可以输出校正后的角度与角速度；我采用的是卡尔曼滤波，考虑到单片机的运算能力，是经过精简的，当然这些都是老外做的，关于卡尔曼滤波，我找了很多资料，详见附件内容。

在准备搭建此两轮自平衡小车前需准备如下:一个UNO和一个自平衡扩展板，再加上小车底盘就行了。 两轮自平衡小车的硬件分为三个部分，分别是主控部分、小车姿态获取部分以及电机驱动部分。主控板采用目前常用的arduino UNO，同时也可以使用其他arduino通用控制板做主控。 两轮自平衡车演示视频: 源代码解压后放到arduino的libraries文件夹里面，只需打开并烧写Self_balancing.ino这个代码例程 附件包含自平衡小车的原理和硬件设计、代码

为解决两轮自平衡车因不同用户身高体重的差异造成系统模型不准确而带来控制器对系统控制稳定性能差的问题，将自抗扰控制技术运用到两轮自平衡车运动平衡控制中。首先采用拉格朗日方法建立两轮自平衡车动力学模型，然后针对系统的特性推导出实现两轮平衡车自平衡控制的自抗扰控制器控制律。最后，搭建两轮自平衡车控制系统的Simulink仿真平台，分别采用线性自抗扰控制和经典自抗扰控制方法进行了试验比较。试验结果表明：与经典自抗扰控制器相比，新的自抗扰控制器能够较好地适应身高体重变化的环境，较好地自主达到稳定运行状态。