循迹小车算法

① 循迹小车可以走规划路线吗

可以的，但是需要你会写程序。
1. 小车控制及驱动单元的选择 此部分是整个小车的大脑，是整个小车运行的核心部件，起着控制小车所有运行状态的作用。通常选用单片机作为小车的核心控制单元，在这里用台湾凌阳公司的SPCE061A单片机来做小车的控制单元。SPCE061是一款拥有2K RAM、32KFlash、32 个I/O 口，并集成了AD/DA功能强大的16位微处理器，它还拥有丰富的语音处理功能，为小车的功能扩展提供了相当大的空间。只要按照该单片机的要求对其编制程序就可以实现很多不同的功能。小车驱动电机一般利用现成的玩具小车上的配套直流电机。考虑到小车必须能够前进、倒退、停止，并能灵活转向，在左右两轮各装一个电机分别进行驱动。当左轮电机转速高于右轮电机转速时小车向右转，反之则向左转。为了能控制车轮的转速，可以采取PWM调速法，即由单片机的IOB8、IOB9输出一系列频率固定的方波，再通过功率放大来驱动电机，在单片机中编程改变输出方波的占空比就可以改变加到电机上的平均电压，从而可以改变电机的转速。左右轮两个电机转速的配合就可以实现小车的前进、倒退、转弯等功能。 2. 小车循迹的原理 这里的循迹是指小车在白色地板上循黑线行走，通常采取的方法是红外探测法。红外探测法，即利用红外线在不同颜色的物体表面具有不同的反射性质的特点，在小车行驶过程中不断地向地面发射红外光，当红外光遇到白色纸质地板时发生漫反射，反射光被装在小车上的接收管接收；如果遇到黑线则红外光被吸收，小车上的接收管接收不到红外光。单片机就是否收到反射回来的红外光为依据来确定黑线的位置和小车的行走路线。红外探测器探测距离有限，一般最大不应超过15cm。对于发射和接收红外线的红外探头，可以自己制作或直接采用集成式红外探头。 （1）自制红外探头电路如图1所示，红外光的发送接收选用型号为ST168的对管。当小车在白色地面行驶时，装在车下的红外发射管发射红外线信号，经白色反射后，被接收管接收，一旦接收管接收到信号，那么图中光敏三极管将导通，比较器输出为低电平；当小车行驶到黑色引导线时，红外线信号被黑色吸收后，光敏三极管截止，比较器输出高电平，从而实现了通过红外线检测信号的功能。将检测到的信号送到单片机I/O口，当I/O口检测到的信号为高电平时，表明红外光被地上的黑色引导线吸收了，表明小车处在黑色的引导线上；同理，当I/O口检测到的信号为低电平时，表明小车行驶在白色地面上。此种方法简单，价格便宜，灵敏度可调，但是容易受到周围环境的影响，特别是在图1较强的日光灯下，对检测到的信号有一定的影响。 （2）集成式红外探头可以采用型号为E3F－DS10C4集成断续式光电开关探测器，它具有简单、可靠的工作性能，只要调节探头上的一个旋钮就可以控制探头的灵敏度。该探头输出端只有三根线（电源线、地线、信号线），只要将信号线接在单片机的I/O口，然后不停地对该I/O口进行扫描检测，当其为高电平时则检测到白纸，当为低电平时则检测到黑线。此种探头还能有效地防止普通光源（如日光灯等）的干扰。其缺点则是体积比较大，占用了小车有限的空间。 3.红外探头的安装 在小车具体的循迹行走过程中，为了能精确测定黑线位置并确定小车行走的方向，需要同时在底盘装设4个红外探测头，进行两级方向纠正控制，提高其循迹的可靠性。这4个红外探头的具体位置如图2所示。图中循迹传感器共安装4个，全部在一条直线上。其中InfraredMR与InfraredML 为第一级方向控制传感器，InfraredSR 与InfraredSL 为第二级方向控制传感器。小车行走时，始终保持黑线（如图2 中所示的行走轨迹黑线）在InfraredMR和InfraredML这两个第一级传感器之间，当小车偏离黑线时，第一级探测器一旦探测到有黑线，单片机就会按照预先编定的程序发送指令给小车的控 制系统，控制系统再对小车路径予以纠正。若小车回到了轨道上，即4个探测器都只检测到白纸，则小车会继续行走；若小车由于惯性过大依旧偏离轨道，越出了第一级两个探测器的探测范围，这时第二级动作，再次对小车的运动进行纠正，使之回到正确轨道上去。可以看出，第二级方向探测器实际是第一级的后备保护，从而提高了小车循迹的可靠性。 4.软件控制 其程序控制框图如图3。小车进入循迹模式后，即开始不停地扫描与探测器连接的单片机I/O口，一旦检测到某个I/O口有信号，即进入判断处理程序（switch）,先确定4个探测器中的哪一个探测到了黑线，如果InfraredML(左面第一级传感器)或者InfraredSL(左面第二级传感器)探测到黑线，即小车左半部分压到黑线，车身向右偏出，此时应使小车向左转；如果是InfraredMR(右面第一级传感 器)或InfraredSR(右面第二级传感器)探测到了黑线，即车身右半部压住黑线，小车向左偏出了轨迹，则应使小车向右转。在经过了方向调整后，小车再继续向前行走，并继续探测黑线重复上述动作。 由于第二级方向控制为第一级的后备，则两个等级间的转向力度必须相互配合。 电动循迹小车设计1. 小车控制及驱动单元的选择 此部分是整个小车的大脑，是整个小车运行的核心部件，起着控制小车所有运行状态的作用。通常选用单片机作为小车的核心控制单元，在这里用台湾凌阳公司的SPCE061A单片机来做小车的控制单元。SPCE061是一款拥有2K RAM、32KFlash、32 个I/O 口，并集成了AD/DA功能强大的16位微处理器，它还拥有丰富的语音处理功能，为小车的功能扩展提供了相当大的空间。只要按照该单片机的要求对其编制程序就可以实现很多不同的功能。小车驱动电机一般利用现成的玩具小车上的配套直流电机。考虑到小车必须能够前进、倒退、停止，并能灵活转向，在左右两轮各装一个电机分别进行驱动。当左轮电机转速高于右轮电机转速时小车向右转，反之则向左转。为了能控制车轮的转速，可以采取PWM调速法，即由单片机的IOB8、IOB9输出一系列频率固定的方波，再通过功率放大来驱动电机，在单片机中编程改变输出方波的占空比就可以改变加到电机上的平均电压，从而可以改变电机的转速。左右轮两个电机转速的配合就可以实现小车的前进、倒退、转弯等功能。 2. 小车循迹的原理 这里的循迹是指小车在白色地板上循黑线行走，通常采取的方法是红外探测法。红外探测法，即利用红外线在不同颜色的物体表面具有不同的反射性质的特点，在小车行驶过程中不断地向地面发射红外光，当红外光遇到白色纸质地板时发生漫反射，反射光被装在小车上的接收管接收；如果遇到黑线则红外光被吸收，小车上的接收管接收不到红外光。单片机就是否收到反射回来的红外光为依据来确定黑线的位置和小车的行走路线。红外探测器探测距离有限，一般最大不应超过15cm。对于发射和接收红外线的红外探头，可以自己制作或直接采用集成式红外探头。 （1）自制红外探头电路如图1所示，红外光的发送接收选用型号为ST168的对管。当小车在白色地面行驶时，装在车下的红外发射管发射红外线信号，经白色反射后，被接收管接收，一旦接收管接收到信号，那么图中光敏三极管将导通，比较器输出为低电平；当小车行驶到黑色引导线时，红外线信号被黑色吸收后，光敏三极管截止，比较器输出高电平，从而实现了通过红外线检测信号的功能。将检测到的信号送到单片机I/O口，当I/O口检测到的信号为高电平时，表明红外光被地上的黑色引导线吸收了，表明小车处在黑色的引导线上；同理，当I/O口检测到的信号为低电平时，表明小车行驶在白色地面上。此种方法简单，价格便宜，灵敏度可调，但是容易受到周围环境的影响，特别是在图1较强的日光灯下，对检测到的信号有一定的影响。 （2）集成式红外探头可以采用型号为E3F－DS10C4集成断续式光电开关探测器，它具有简单、可靠的工作性能，只要调节探头上的一个旋钮就可以控制探头的灵敏度。该探头输出端只有三根线（电源线、地线、信号线），只要将信号线接在单片机的I/O口，然后不停地对该I/O口进行扫描检测，当其为高电平时则检测到白纸，当为低电平时则检测到黑线。此种探头还能有效地防止普通光源（如日光灯等）的干扰。其缺点则是体积比较大，占用了小车有限的空间。 3.红外探头的安装 在小车具体的循迹行走过程中，为了能精确测定黑线位置并确定小车行走的方向，需要同时在底盘装设4个红外探测头，进行两级方向纠正控制，提高其循迹的可靠性。这4个红外探头的具体位置如图2所示。图中循迹传感器共安装4个，全部在一条直线上。其中InfraredMR与InfraredML 为第一级方向控制传感器，InfraredSR 与InfraredSL 为第二级方向控制传感器。小车行走时，始终保持黑线（如图2 中所示的行走轨迹黑线）在InfraredMR和InfraredML这两个第一级传感器之间，当小车偏离黑线时，第一级探测器一旦探测到有黑线，单片机就会按照预先编定的程序发送指令给小车的控 制系统，控制系统再对小车路径予以纠正。若小车回到了轨道上，即4个探测器都只检测到白纸，则小车会继续行走；若小车由于惯性过大依旧偏离轨道，越出了第一级两个探测器的探测范围，这时第二级动作，再次对小车的运动进行纠正，使之回到正确轨道上去。可以看出，第二级方向探测器实际是第一级的后备保护，从而提高了小车循迹的可靠性。 4.软件控制 其程序控制框图如图3。小车进入循迹模式后，即开始不停地扫描与探测器连接的单片机I/O口，一旦检测到某个I/O口有信号，即进入判断处理程序（switch）,先确定4个探测器中的哪一个探测到了黑线，如果InfraredML(左面第一级传感器)或者InfraredSL(左面第二级传感器)探测到黑线，即小车左半部分压到黑线，车身向右偏出，此时应使小车向左转；如果是InfraredMR(右面第一级传感 器)或InfraredSR(右面第二级传感器)探测到了黑线，即车身右半部压住黑线，小车向左偏出了轨迹，则应使小车向右转。在经过了方向调整后，小车再继续向前行走，并继续探测黑线重复上述动作。 由于第二级方向控制为第一级的后备，则两个等级间的转向力度必须相互配合。第二级通常是在超出第一级的控制范围的情况下发生作用，它也是最后一层保护，所以它必须要保证小车回到正确轨迹上来，则通常使第二级转向力度大于第一级，即level2>level1(level1、level2为小车转向力度，其大小通过改变单片机输出的占空比的大小来改变)，具体数值在实地实验中得到。根据上面所讲述的方法，我们可以较容易地做出按照一定轨迹行走的智能电动小车。但是按照该方法行走的小车如果是走直线，有可能会是蛇形前进。为了使小车能够按轨迹行走的更流畅，可以在软件编程时运用一些简单的算法。例如，在对小车进行纠偏时，适当提前停止纠偏，而不要等到小车完全不偏时再停止，以防止小车的过冲。 第二级通常是在超出第一级的控制范围的情况下发生作用，它也是最后一层保护，所以它必须要保证小车回到正确轨迹上来，则通常使第二级转向力度大于第一级，即level2>level1(level1、level2为小车转向力度，其大小通过改变单片机输出的占空比的大小来改变)，具体数值在实地实验中得到。 根据上面所讲述的方法，我们可以较容易地做出按照一定轨迹行走的智能电动小车。但是按照该方法行走的小车如果是走直线，有可能会是蛇形前进。为了使小车能够按轨迹行走的更流畅，可以在软件编程时运用一些简单的算法。例如，在对小车进行纠偏时，适当提前停止纠偏，而不要等到小车完全不偏时再停止，以防止小车的过冲

② 一文搞懂PID控制算法

PID算法是工业应用中最广泛算法之一，在闭环系统的控制中，可自动对控制系统进行准确且迅速的校正。PID算法已经有100多年历史，在四轴飞行器，平衡小车、汽车定速巡航、温度控制器等场景均有应用。

之前做过循迹车项目，简单循迹摇摆幅度较大，效果如下所示：

PID算法优化后，循迹稳定性能较大提升，效果如下所示：

PID算法：就是“比例（proportional）、积分（integral）、微分（derivative）”，是一种常见的“保持稳定”控制算法。

常规的模拟PID控制系统原理框图如下所示：

因此可以得出e(t)和u(t)的关系：

其中：

Kp：比例增益，是调适参数；

Ki：积分增益，也是调适参数；

Kd：微分增益，也是调适参数；

e：误差=设定值（SP）- 回授值（PV）；

t：目前时间。

数学公式可能比较枯燥，通过以下例子，了解PID算法的应用。

例如，使用控制器使一锅水的温度保持在50℃，小于50℃就让它加热，大于50度就断电不就行了？

没错，在要求不高的情况下，确实可以这么干，如果换一种说法，你就知道问题出在哪里了。

如果控制对象是一辆汽车呢？要是希望汽车的车速保持在50km/h不动，这种方法就存在问题了。

设想一下，假如汽车的定速巡航电脑在某一时间测到车速是45km/h，它立刻命令发动机：加速！

结果，发动机那边突然来了个100%全油门，嗡的一下汽车急加速到了60km/h，这时电脑又发出命令：刹车！结果乘客吐......

所以，在大多数场合中，用“开关量”来控制一个物理量就显得比较简单粗暴了，有时候是无法保持稳定的，因为单片机、传感器不是无限快的，采集、控制需要时间。

而且，控制对象具有惯性，比如将热水控制器拔掉，它的“余热”即热惯性可能还会使水温继续升高一小会。

此时就需要使用PID控制算法了。

接着咱再来详细了解PID控制算法的三个最基本的参数：Kp比例增益、Ki积分增益、Kd微分增益。

1、Kp比例增益

Kp比例控制考虑当前误差，误差值和一个正值的常数Kp（表示比例）相乘。需要控制的量，比如水温，有它现在的 当前值 ，也有我们期望的 目标值 。

当两者差距不大时，就让加热器“轻轻地”加热一下。

要是因为某些原因，温度降低了很多，就让加热器“稍稍用力”加热一下。

要是当前温度比目标温度低得多，就让加热器“开足马力”加热，尽快让水温到达目标附近。

这就是P的作用，跟开关控制方法相比，是不是“温文尔雅”了很多。

实际写程序时，就让偏差（目标减去当前）与调节装置的“调节力度”，建立一个一次函数的关系，就可以实现最基本的“比例”控制了~

Kp越大，调节作用越激进，Kp调小会让调节作用更保守。

若你正在制作一个平衡车，有了P的作用，你会发现，平衡车在平衡角度附近来回“狂抖”，比较难稳住。

2、Kd微分增益

Kd微分控制考虑将来误差，计算误差的一阶导，并和一个正值的常数Kd相乘。

有了P的作用，不难发现，只有P好像不能让平衡车站起来，水温也控制得晃晃悠悠，好像整个系统不是特别稳定，总是在“抖动”。

设想有一个弹簧：现在在平衡位置上，拉它一下，然后松手，这时它会震荡起来，因为阻力很小，它可能会震荡很长时间，才会重新停在平衡位置。

请想象一下：要是把上图所示的系统浸没在水里，同样拉它一下 ：这种情况下，重新停在平衡位置的时间就短得多。

此时需要一个控制作用，让被控制的物理量的“变化速度”趋于0，即类似于“阻尼”的作用。

因为，当比较接近目标时，P的控制作用就比较小了，越接近目标，P的作用越温柔，有很多内在的或者外部的因素，使控制量发生小范围的摆动。

D的作用就是让物理量的速度趋于0，只要什么时候，这个量具有了速度，D就向相反的方向用力，尽力刹住这个变化。

Kd参数越大，向速度相反方向刹车的力道就越强，如果是平衡小车，加上P和D两种控制作用，如果参数调节合适，它应该可以站起来了。

3、Ki积分增益

Ki积分控制考虑过去误差，将误差值过去一段时间和（误差和）乘以一个正值的常数Ki。

还是以热水为例，假如有个人把加热装置带到了非常冷的地方，开始烧水了，需要烧到50℃。

在P的作用下，水温慢慢升高，直到升高到45℃时，他发现了一个不好的事情：天气太冷，水散热的速度，和P控制的加热的速度相等了。

这可怎么办？

P兄这样想：我和目标已经很近了，只需要轻轻加热就可以了。

D兄这样想：加热和散热相等，温度没有波动，我好像不用调整什么。

于是，水温永远地停留在45℃，永远到不了50℃。

根据常识，我们知道，应该进一步增加加热的功率，可是增加多少该如何计算呢？

前辈科学家们想到的方法是真的巧妙，设置一个积分量，只要偏差存在，就不断地对偏差进行积分（累加），并反应在调节力度上。

这样一来，即使45℃和50℃相差不是太大，但是随着时间的推移，只要没达到目标温度，这个积分量就不断增加，系统就会慢慢意识到：还没有到达目标温度，该增加功率啦！

到了目标温度后，假设温度没有波动，积分值就不会再变动，这时，加热功率仍然等于散热功率，但是，温度是稳稳的50℃。

Ki的值越大，积分时乘的系数就越大，积分效果越明显，所以，I的作用就是，减小静态情况下的误差，让受控物理量尽可能接近目标值。

I在使用时还有个问题：需要设定积分限制，防止在刚开始加热时，就把积分量积得太大，难以控制。

PID算法的参数调试是指通过调整控制参数（比例增益、积分增益/时间、微分增益/时间） 让系统达到最佳的控制效果 。

调试中稳定性（不会有发散性的震荡）是首要条件，此外，不同系统有不同的行为，不同的应用其需求也不同，而且这些需求还可能会互相冲突。

PID算法只有三个参数，在原理上容易说明，但PID算法参数调试是一个困难的工作，因为要符合一些特别的判据，而且PID控制有其限制存在。

1、稳定性

若PID算法控制器的参数未挑选妥当，其控制器输出可能是不稳定的，也就是其输出发散，过程中可能有震荡，也可能没有震荡，且其输出只受饱和或是机械损坏等原因所限制。不稳定一般是因为过大增益造成，特别是针对延迟时间很长的系统。

2、最佳性能

PID控制器的最佳性能可能和针对过程变化或是设定值变化有关，也会随应用而不同。

两个基本的需求是调整能力（regulation，干扰拒绝，使系统维持在设定值）及命令追随 （设定值变化下，控制器输出追随设定值的反应速度）。有关命令追随的一些判据包括有上升时间及整定时间。有些应用可能因为安全考量，不允许输出超过设定值，也有些应用要求在到达设定值过程中的能量可以最小化。

3、各调试方法对比

4、调整PID参数对系统的影响

③ 怎么设计循迹小车

1、循迹小车是一种能够自己寻找轨迹并按轨迹运动的“智能”车。本文简要记录这一电子制作过程，希望大家喜欢。有什么建议和意见，欢迎大家留言。

6、调试后，小车可以再黑色的轨道上自动循迹，制作成功。黑色轨迹可以自己做，用黑色胶布再地板上自定义轨道，小车慢悠悠的在轨道上行走。

④ 智能车 电磁组 循迹算法有哪些

车模，电容，电阻，开关，电感，稳压芯片，二极管，钢件等。

智能车在工业上应用也非常广泛，主要应用于无人搬运方面。被业界人士称为：无人搬运车或是AGV小车，其自动牵引，自动导航无需工与，备受厂商关注。
智能车的特点
1、AGV智能车运行路径和目的地可以由管理程序控制，机动能力强。而且某些导向方式的线路变更十分方便灵活，设置成本低。
2、工位识别能力和定位精度高，具有与各种加工设备协调工作的能力。AGV智能车在通讯系统的支持和管理系统的调度下，可实现物流的柔性控制。
3、AGV智能车载物可以采用不同的安装结构和装卸方式，能满足不同产品运送和加工的需要。因此，物流系统的适应能力强。
4、可装备多种声光报警系统，能通过车载障碍探测系统在碰撞到障碍物之前自动停车。当其列队行驶或在某一区域交叉运行时，具有避免相互碰撞的自控能力，不存在人为差错。因此，AGV智能车比其他物料搬运系统更安全。
5、AGV智能车组成的物流系统不是永久性的，而是在给定的区域内设置。与传统物料输送系统在车间内固定设置且不易变更相比，该物流系统的设置柔性强，并可以充分利用人行通道和叉车通道，从而改善车间地面利用率。
6、与其他物料输送方式相比，初期大，但可以大幅度降低运行费用，特别是在产品类型和工位较多时。AGV智能车在国内限制发展的原因就是价格太贵，一般行业无法接受。