新手入门超声自平衡小车最佳方案

回有点摆动即可进入调整Kd参数阶段。

　　g、Kd参数整定

　　在调整完Kp后，逐渐增大Kd，使得摆动消失，如果继续增大Kd，小车会出现明显的抖动，此时将Kd往回调整，使得抖动消失即可。

　　h、平衡点PB的进一步调整

　　在上述参数调整完毕后，小车一般就能保持平衡了，如果出现小车往一边跑的现象，可通过调整PB电位器加以修正。如果小车往前跑（超声波模块一端为前），调整PB使得平衡点设定值增大；如果小车往后跑，调整PB使得平衡点设定值减小，直到小车能够长时间稳定为止。

　　6、总结与展望

　　超声自平衡小车的基本版已经完成，在制作过程中与我之前用MPU6050制作的小平衡车相比有以下几点体会：

　　a、在用TT马达的情况下，如果系统使用同一组电池供电，电机一启动Arduino与MPU6050立即死机，或者MPU6050的数据受干扰极为严重，不可使用。解决办法是用另一组电池单独给L298N供电，并且L298N要选择带光耦隔离的。但同样的使用TT马达的情况下，用超声波测距方案，系统仅用一组电池即可，而且L298N也无需光耦隔离，系统很稳定。

　　b、超声波传感器的选择要选择最小测量周期短的模块，第一次我使用的是US-015 超声波测距模块，US-015是目前市场上分辨率最高，重复测量一致性最好的超声波测距模块，US-015的分辨率高于1mm，可达0.5mm，测距精度高，重复测量一致性好，测距稳定可靠。但他的最小测量周期大于10ms，而且对输出数据经常有跳动（这是由于它的灵敏度很高，在近距离时超声波在模块与地面之间的来回反射的二次信号都能被检测到），为此在地面垫上一个地毯吸收了部分能量的超声波，才能稳定工作。在第二版中更换了HC-SR04超声波模块，这个模块的测距精度虽然只有3mm，但它的最小测量周期仅略大于3ms。但这种模块市场上有两种，一种没有晶体，一种是带晶体的，带晶体的很不稳定，建议大家不要选择。

　　c、小车的平衡稳定性与多种因素有关，建议在结构上，重心越低越好。

　　d、另外，我还做了一个对比测试，数据见下表：

　　误差绝对值是指小车在一段时间内，实测距离与设定平衡点距离误差绝对值的平均值；滤波是指程序中对超声波测量的距离滤波或不滤波直接使用；循环周期是程序中的延时时间，超声波测量需要大约704us，一个周期大约为3.84ms，程序处理时间大约为136us