目的
介绍自动导引车（AGV）实现控制系统的过程分为硬件构建和软件设计两部分。
1 车载控制器
1.1 车载控制器的类型
车载控制器是电气控制系统，甚至是整个 AGV 车载控制器的核心是什么？国家标准GBT 30030-2013《 自动导引车(AGV)定义术语AGV车载控制器本质上是一种由计算机控制的运输工具。但是计算机也可以细分为很多种。根据作者的经验，从硬件的角度来看，AGV目前使用的车载控制器基本分为以下三种:
2 工控机:代表产品如倍福公司 CX5130、CX5020，使用的厂家有昆船、新松、艾吉威、罗伯特木牛流马、成都航发。工控机本质上是个人电脑，但经过特殊设计，具有很强的抗干扰能力，可用于振动、电磁辐射等恶劣的工业环境。工业控制机结构紧凑，体积小，可一般操作系统，如 Windows、Linux。以倍福为例，安装它 TwinCAT 控制软件后，会在 Windows 将实时内核插入操作系统，将计算机转换为适合工业控制的实时控制系统。工控机灵活性好，因为采用了一般的硬件和操作系统(比如新松买了倍福的软件)PLC研华工控机用于核硬件，开发难度小。倍福工控机价格昂贵，一般在5万台~3万元左右，收费项目很多，比如你用的软件功能小(比如TCP/IP通信)必须额外支付。 3 单片机：一般基于ARM、X86等芯片或核心板自行开发外围电路，包括海通、艾吉威、机科。PLC和工控机的价格昂贵，仅仅一个CAN总线通信模块可能要几千元。相比之下，单片机要便宜得多，使用最好的芯片，加上外围设备的硬件成本最多只有几百元左右。但单片机嵌入式开发对人员要求较高，需要一定的时间和资金投入。PLC梯形图一般用于编程，软件可以安装在工控机上PLC梯形图采用梯形图开发C 当然，单片机也可以安装高级语言开发的软件PLC直接用C语言开发系统或系统。而且你要花很多精力去设计和调试各种底层通信程序，开发起来最难。 上述分类并不意味着三者是完全不同的，例如 PLC 内部核心是嵌入式单片机；工的编程语言也可以使用 PLC 梯形图等常用语言；嵌入式实时操作系统也可以装载在单片机上，从而形成强大的多任务计算机。所以，虽然他们各有各的适用领域，但他们也会互相学习，演变成你有我有你的局面。 当然，现在市场上有专门的AGV瑞典等控制器NDC的CVC600，瑞士BlueBotics的ANT、浙江科聪智能 MRC上海仙知机器人5000SRC。与通用工业运动控制器或PLC相比之下，该控制器集成了成熟的导航和运动控制算法（如激光定位算法和麦克纳姆轮控制算法），为用户节省了大量工作，稳定性和保护水平较高，但价格也较高（1000~6万元）。 有实力的AGV厂家可以自己从头研发AGV根据作者的经验，目前的控制器AGV厂家会选择自己开发低端控制器进行简单的应用，只需要在嵌入式开发板上编程即可。然而，这种控制器只能用于简单的项目。如果用于功能复杂的项目，开发成本会很高，因为经验丰富的嵌入式软件和硬件工程师的工资并不低AGV这是一个定制性很强的行业。如果每次都修改不同项目的C语言代码，改造和维护的成本非常高。反观PLC编程很容易理解，PLC制造商已经完成了大多数基本程序的开发，用户只需要呼叫，不需要记住很多指令，熟能生巧，聪明的高中生可以掌握，支持他们的成本相对较低，所以很多制造商会选择成熟PLC作为控制器。 但如果只有这样的开发能力，仍然不能满足高端客户的需求。因为对于复杂的项目，可能些算法，如激光定位、运动学、路径规划等机器人算法，这对编程师有很高的要求，硕士生很难完全掌握。这些复杂的算法很难通过简单地拖动梯形图来实现。它们必须熟悉算法的每一个细节，自然对控制器的计算能力和灵活性有很高的要求PLC（不管欧美系还是日系）开放性非常差很难实现，厂家是不可能把底层开放给你的。 假设你想开发一个先进的机器人控制器，第一个困难是核心算法的设计。移动机器人的理论相对成熟，但项目实现仍面临许多问题。由于没有成熟的参考方案，需要长时间的试错；其次，实现上层软PLC的功能，因为你不能指望现场工程师都有C语言编程能力，也不能让研发人员每次陪客户修改程序，要完成PLC语言解释器设计、编程GUI更底层的技术问题，如多进程调度的开发和处理，还需要编写底层总线通信库函数，设计驱动程序。国产AGV制造商的研发实力较弱，很难独立开发这样的高端控制器，所以他们会选择购买国外产品，即使是像新松昆船这样强大的制造商。在这种情况下，一些国内初创公司开始涉足这一领域，他们通常选择ROS在这样的开源平台上搭建控制系统，尽量选择开源库，以节约成本。也有一些厂家另辟蹊径。由于软件开发难度大，直接选择成熟的开放式软件PLC，然后在此基础上开发形成集成自己独特算法的控制器产品。
1.2 西门子 S7-1200 PLC
作者选择西门子 S7-1215C 型 PLC 作为 AGV 车载控制器(以后简称S1200)，如下图所示。由于西门子的产品型号非常丰富，每种型号在接口类型和性能上都有细微的差异。为了准确描述具体的型号，最好使用订单号。每种西门子产品都有一个唯一的订单号，购买时只需要提供这个号码。也可以根据订单号在西门子的编程软件中找到相应的型号。当然，使用西门子产品也有一些缺点，比如PLC它是用产品，不是专门为车辆控制设计的。都有低端开发板RS485、CAN、以太网等通信接口，西门子PLC但要付出代价。而且西门子的产品开放性很差，基本没有门可以实现函数重用和第三方库调用，可视界面定制设计。因此，西门子PLC不适合作为车载控制器，也可以说西门子PLC它不是为机器人控制而生的，而是在未来AGV也将逐步淘汰西门子PLC，本文仅以其稳定可靠的性能和适中的价格作为功能验证。笔者将在实际工程项目中选择Codesys的PLC或者从底层开发，这样你就可以实现你想要的许多功能。Codesys缺点是学习资料和例子很少，可能很难入门。
| 名称 | 订货号 | 价格 |
|---|---|---|
| 西门子1200 CPU | 6ES7215-1AG40-0XB0 | 3400元 |
想了解 S1200 可以阅读书籍的功能特征和参数设置《S7-1200 PLC 编程和应用程序或官方文档《S7-1200可编程控制器系统手册。令我惊讶的是，这本手册的完整版本（全长1862页）在互联网上找不到，所以我上传了它供您免费下载。单击此处下载。 想对PLC下载或配置程序时，需要使用网线 S1200 与上位机连接。上位机只需要 IP 地址设置为和 PLC 可以使用相同的网段。S1200 一般默认出厂 IP 地址是 192.168.0.1.所以你可以使用你的电脑 IP 设置为 192.168.0.2。
什么是上位机和下位机？ 有些设备可以访问其他设备，如阅读其他设备内存中的数据，并将数据写入内存中。这些设备具有较高的权限和地位，因此被称为上位机。有些设备只能被其他设备访问，而不能访问其他设备。这种设备被称为下位机。在本文中，PLC是下位机，你写的PLC程序计算机是上位机。
| 名称 | 型号 | 价格 |
|---|---|---|
| MOXA 无线通讯模块 | AWK-3131A-US | 5200元 |
| 菲尼克斯 无线通讯模块 | FL WLAN 1010 | 3000元 |
2 驱动器
如果说车载控制器是 AGV 的大脑，那么 AGV 还要有心脏和肌肉才能运动起来，驱动器给车轮的电机提供电流，相当于心脏。
2.1 低压驱动器品牌
由于 AGV 普遍采用蓄电池供电，其电压一般在 12V~72V 左右。因此 AGV 使用的驱动器属于低压直流型伺服驱动器。国外的低压驱动器品牌有：AMC、RoboteQ、ZAPI（萨牌）、Curtis（柯蒂斯）、Elmo（埃莫）等，中国国内的低压驱动器品牌有：步科、森创、英博尔、凯利。
2.2 PLC与驱动器通信
PLC 要想控制驱动器就要向它发送指令数据。低端驱动器可以用模拟量或者脉冲信号传递数据，高端驱动器则采用规范的通信协议传递数据，这样的通信可以借助 RS232、RS485、CAN、以太网等现场总线或者工业网络实现。因为 S1200 的 CPU 模块没有这些通讯接口，所以要想连接驱动器，需要购买额外的通信模块（CM：Communication Module）。上面提到的几种协议西门子都有对应的通信模块支持，比如西门子的 232 、485 和 CANopen 通信模块如下图所示（这三种模块外形完全一样），注意 232 和 CANopen 模块的插头是公头，而485的则是母头。
对于移动设备来说，CAN总线是最常用的通讯方式，像汽车、挖掘机、AGV一般都采用CAN总线通讯。CAN 总线的速度快（最高可达1Mb/s）、稳定性高（采用差分信号，抗干扰），更“智能”（有优先级和仲裁机制），因此应该优先选择 CAN 总线。但是考虑到西门子本身没有 CAN通信模块（如果想使用CAN，要购买第三方公司HMS提供的CANopen模块），本文使用的驱动器采用 485 协议，所以我们选择485模块。随之而来的一个问题是：S1200能外扩几个通信模块？答案是：3个。不管是哪种通信模块，数量最多只能是3个，种类不限可以混用。如果你的驱动器是总线型（485和CAN都属于总线型）的，那么只要一个485模块或者 CANopen 模块就行了。注意232不是总线型的，所以用两个驱动器就要添加两个通信模块。如果你的 AGV 还有其它走通信协议的传感器（例如磁导航传感器、RFID传感器），那么3个通信模块很有可能就显得捉襟见肘。
| 名称 | 订货号 | 价格 |
|---|---|---|
| 西门子485通信模块 | 6ES7 241-1CH30-0XB0 | 500元 |
| 西门子232通信模块 | 6ES7 241-1AH32-0XB0 | 500元 |
| 瑞典HMS公司的CAN通信模块 | 021620-B | 3100元 |
西门子485模块的接头采用了标准9 针D型插孔式连接器。为了将驱动器和PLC连接起来，我们要购买DB9接头，并用信号线将两个头连接起来。这里我们只利用两个信号线即可。值得注意的是，西门子的485接口定义和常规的485不一样，常规485的信号收发是1、2头，而西门子的485则是3、8头（参考手册的第1769页）。所以在连线时，要按照 3-2、8-1的对应顺序焊接，如下图所示。
3 移动机构
AGV要想实现搬运、移载就要有移动机构，通常采用的移动机构有舵轮、差速轮和麦克纳姆轮。它们各自有什么特点呢？什么场合又该使用哪种轮子呢？ 麦克纳姆轮的优点是运动精度高，但是结构复杂，磨损严重，对地面挑剔。虽然麦克纳姆轮问世超过30年了，但是实际应用并不多，实际中我们看不到太多，这也说明它不是一个非常实用的产品。所以下面我们主要讲解舵轮。 舵轮是个高度集成的移动机构，由车轮、回转支撑、齿轮箱、驱动电机、转向电机、编码器、限位开关、制动器等部件组成，它既能提供牵引力，也可以主动转向，因此一个舵轮有两个自由度。AGV 使用一个或以上的舵轮就可以实现全向移动：原地旋转、斜行、横移等等。舵轮一般用于室内环境，所以轮面的材料多为聚氨酯。根据电机的安装位置可以将舵轮分为两种：卧式和立式，分别如下两图所示。卧式舵轮的驱动电机横向安装，因此整体高度很低，有些AGV对高度有要求（例如潜入式的AGV要很矮才能钻到货物底下），这时就适合使用卧式舵轮；立式舵轮的驱动电机竖着安装，其整体高度偏高，它的优点是方便将电机隔离起来，在有些场合（例如危险品工厂），要求舵轮电机与外部环境隔离，这时就适合使用立式舵轮。国外主要的舵轮生产厂家有：意大利的 CFR 和德国的 schabmuller（夏伯穆勒），后来从CFR中又独立出来了一个厂家——马路达。这些舵轮生产厂家一般只卖舵轮，不提供驱动器，驱动器则由代理商提供。一台AGV上最贵的部件就是舵轮，以一台成本10万元左右的AGV为例，如果配备两个舵轮，就需要4~5万元，占整车成本将近一半。不过好消息是，国内的舵轮厂家开始参与竞争，这将降低AGV的成本。
4 磁导航
4.1 磁条
AGV被称为自动导引车，因此自动沿导引路径运动是其最基本的功能。目前，磁条导航是 AGV 使用最多的导引方式之一，其采用磁条作为导引路径。只需要预先在地面铺设好磁条，AGV 就会沿着磁条形成的路径运动。磁条一般宽3~5cm，它像胶带一样，一面光滑、一面带有粘性，将粘性的一面粘贴在地面即可完成铺设。磁条具有极性，在购买时注意是N极还是S极，磁条的极性对应磁导航传感器的极性，但有些传感器两种都兼容。磁条质地较软、不抗压，所以如果被轮子反复碾压可能会压扁或挤脱落。多数 AGV 为了避免压坏磁条会将驱动轮布置在车体的两侧（差速形式）或者斜对称的位置上。
| 名称 | 型号 | 价格 |
|---|---|---|
| 磁条 | 任意 | 3~5元/米 |
4.2 磁导航传感器
磁导航传感器也叫磁循迹传感器，它用来帮助AGV巡线行走。磁导航传感器一般安装在AGV车体或者驱动轮组上，在AGV运动时始终保持在磁条上方一定高度内。磁导航传感器相对于车体的安装位置一般在对称中轴线上，通常对称安装，例如前后各一个或者左右各一个。磁导航传感器的原理很简单，传感器上有若干个探头，每个探头都能检测磁场，位于磁条上方（一定高度内）的探头有信号输出，超出磁条的探头则没有信号。探头通常俗称为“点”，点越多表示传感器的分辨率越高，当然价格也越贵。传感器通常的点数有：6点、8点、16点几种。磁导航传感器并不是什么神秘的东西，笔者曾经拆解过一款磁导航传感器，这里所说的探头无非有两种，一种是霍尔元件、还有一种是地磁传感器。霍尔元件的特点大家大学的时候应该都学过，它能感应磁场，价格低但是精度通常不高；地磁传感器基本都采用美国 PNI 公司的产品，例如 SEN-XY [ 1 ] ^{[1]} [1]，它要搭配专用的驱动芯片 PNI-12927，这个芯片是3.3V供电，所以传感器内部要设计3.3V稳压电路，而且这个驱动芯片采用 SPI 总线，要对其信号进行处理和电压变换，这通常由单片机来完成。磁导航传感器的输出方式有DI纯数字量输出的，也有总线型数据帧输出的。对于点数多的传感器来说一般用总线型，因为如果使用数字量需要很多根信号线。假设一个 AGV 使用4个传感器，每个传感器的分辨率是16点，那就要有 4 × 16 = 64 4\times16=64 4×16=64个输出，相应的 PLC 应该有 64 个数字量输入口，其接线将非常繁琐，也容易出故障（例如某根线连接不牢固）。 磁导航方式实现简单，价格便宜，但是缺点也不少，其中一个严重的问题是干扰。笔者在调试 AGV时发现，即使传感器并不在磁条上方（有时甚至周围根本没有磁条），传感器依然有输出。经过一番思考，笔者发现了问题所在。AGV 前方有一条铁轨，而铁是容易被磁化的。不仅是铁制品，通电的导线也可能会使传感器误报。所以，使用磁条导航要排除这些干扰。 磁导航传感器的输出可以是IO，也可以是数值（代表传感器偏离磁条中心的距离值）。 磁导航传感器如何与 PLC 连接？如上所述，如果传感器采用总线（例如485）传递数据，直接将总线连接到相应的（485）通信模块即可。如果传感器采用数字量接口，那么就要连接到 PLC 的数字量输入口。这里有个很重要的问题：你要清楚传感器输出的信号是 PNP 型还是 NPN 型，它对应了三极管的类型，它们的区别在于有信号时 PNP 输出高电平（例如24V），而 NPN 输出低电平（例如0V）。在 S1200 上每组输入输出口旁边都有一个 COM 口，它的作用就是选择输入是 PNP 型还是 NPN 型。如果是 PNP 型，COM 口就要接 24V ，如果是 NPN 型就要接 0V。你可以找个磁条用万用表测试一下，如果放到磁条上输出显示是24V那说明是 PNP 型。以后你会知道，很多传感器都分 PNP 型和 NPN 型，它们的接法是一样的。
| 名称 | 型号 | 价格 |
|---|---|---|
| 曼普拉斯磁导航传感器 | MPMGS200-F01 | 2000元 |
5 供电系统
5.1 电池
AGV启动时需要的电流大，因此需要使用动力电池，使用最多的动力电池有铅酸电池和锂电池。铅酸电池寿命短、能量密度低，而锂电池密度高、但是成本也高。还有一种电池叫做超级电容，它的寿命很长，但是能量密度非常低，所以用的不多。 知名的电池厂家有霍克（HAWKER）、荷贝克（HOPPECKE）等。下图是霍克 AGV 专用电池标签。铅酸电池的额定放电电流一般是0.5C，例如80Ah的电池，额定放电电流是 0.5 × 80 = 40 A 0.5\times80=40A 0.5×80=40A。铅酸电池的最大放电电流一般是3C，即 3 × 80 = 240 A 3\times80=240A 3×80=240A。电池的电压会随着电量消耗逐渐降低，开始降低得很慢，当电量很少时会急剧下降。根据这个关系，通过检测电压就能知道电池还剩余多少电，是否应该充电。
| 名称 | 型号 | 价格 |
|---|---|---|
| 霍克电池 | EV24-100 | 12800元 |
我们如何估计一个 AGV 该选用多大容量的电池呢？ AGV 上最耗电的器件就是电机了。一般来说，电机的额定功率 P P P会写在电机铭牌上。根据初中物理知识，功率等于电压和电流的乘积，即 P = U I P=UI P=UI 驱动电机的额定电压一般容易得到，所以通过上式可以计算出电流。当然，实际工作的功率一般会比额定功率小，所以这里要乘以一个系数，具体要看 AGV 的负重、工作路面等。求出电流乘以工作时间就是电池的容量了。注意，电池的容量和能量是两个不同的概念，前者是电流乘以时间（单位是“安时”（Ah））、而后者是电流乘以电压乘以时间（单位是“千瓦时”（KWh））。
5.2 电压变换
如果传感器、控制器等器件和电池的输出电压不同，就需要使用电压变换模块，它还可以起到稳压的作用。一般传感器常用的电压是12V、控制器常用的电压是24V，因此需要有相应的模块。可以选择广州金升阳的电压变换模块，可选配散热片和导轨，便于散热和固定，如下图所示的48V转24V的模块。选择模块时主要关心的是功率，即它能提供的最大电流。
6 开关
6.1 电源开关
选择电源总开关时要注意它是“自锁的”还是“自动复位的”。自锁的意思就是按下后即使手指松开，开关依然保持闭合使供电畅通；而自动复位的开关按下按钮后如果松开手指，电路就会被切断，如下图所示。一般机箱上的电源总开关应该选择自锁型的，否则你要一直按着按钮才能使电路畅通，因此不要购买下图右所示的自复位型开关（代号：XB2-BA31C，价格在22元左右）。假如你买错了也不要紧，你可以再买一个自锁模块ZB2-BZ21 C，将这个模块添加到XB2-BA31C开关上就能将它变成一个自锁开关。
6.2 急停开关
在所有AGV 车体上都能找到的一个东西就是急停开关。根据国家标准GBT 20721-2006 《自动导引车 通用技术条件》中第4.2.6项的规定：“AGV 应配备紧急停车按钮，该按钮的安装位置在紧急情况下应便于操作。应采用红色按钮，急停按钮按下应关闭 AGV 驱动电源”。在AGV失去控制的情况下，按下急停开关能让它立即停止运动，从而防止伤害到人。因此急停开关构成了最后的安全屏障。为了保证使用可靠，可以购买施耐德的XB2-BS542C。急停开关的按钮一般设计得很大，方便按下，因此又被俗称为蘑菇头，它一般都是自锁的，按下后需要旋转才能松开。购买时唯一要注意的是它的安装直径，一般选择 22mm 即可。
7 电气元件
AGV上既有强电也有弱电，例如舵轮的驱动器需要的电流通常很大，而控制器和一些传感器只需要很小的电流。我们要合理设计电路，防止它们相互干扰，更主要的是包含弱电器件。根据国家标准GBT 30029-2013 《自动导引车(AGV)设计通则》中第6.7.7.4项的规定，控制器应该具有过压保护、欠压保护、过流保护功能。 我们要在电路中加入以下器件： ■ \blacksquare ■ 接触器：用小电流控制大电流。上面的电源开关只允许通过较小的电流，但有时设备里有些组件需要大电流才能启动，例如舵轮驱动器。我们不能用一个开关既控制小电流也控制大电流，这时就需要借助接触器。接触器内部有个电磁铁，我们用小电流控制电磁铁的吸合，电磁铁带动另一组开关闭合使大电流通过。在AGV上使用的是直流接触器，注意接触器的线圈会发出一定热量，安装应当注意散热和对附近器件的影响。
| 名称 | 型号 | 价格 |
|---|---|---|
| Albright直流接触器 | SW180B-108 | 200元 |
■ \blacksquare ■ 断路器：起到过流、欠压保护的作用。断路器也相当于一个开关，在短路等电流过大时断开，保护设备； ■ \blacksquare ■ 继电器：也相当于一个开关，它是用小电压控制触点开闭的，但是注意触点不能流过太大电流。 AGV 采用电池作为能源，而电池的电压通常不是很稳定，在使用时电压会波动。虽然西门子的 PLC 对输入电压具有一定的适应能力，但是我们最好用一个24V到 24V 的稳压模块将电池的电压稳定后再供给 PLC。对于使用24V供电的其它器件，例如磁导航传感器，也是这样。
8 激光避障传感器
AGV的安全防护方式有接触式和非接触式之分。触边属于接触式的，而激光传感器和超声波传感器属于非接触式。当然非接触式的传感器更加安全，因为不需要直接接触即可监测障碍物。 常用的国外激光传感器品牌有SICK和HOKUYO。以SICK的Tim310为例，它的监测距离可达3米，可以设置不同的监测区域形状。Tim310的输出是I/O信号，用以判断是不是监测到了障碍物。
| 名称 | 型号 | 订货号 | 价格 |
|---|---|---|---|
| SICK避障激光雷达 | Tim310-0130000S02 | 1069932 | 5500元 |
9 触摸屏
现在的 AGV 越来越多地开始配备触摸屏了。使用触摸屏可以方便地设置AGV的参数，例如运动速度、充电电压等等，而不需要每次都将程序下载到 PLC。既然我们选择了西门子的PLC，当然触摸屏选择西门子是最配对的，但是考虑到西门子的触摸屏有点贵，我们选择国产的品牌。国产触摸屏的质量也很可靠，而且价格合理，代表厂家有：威纶通、昆仑通态。由于西门子的知名度，大多数触摸屏都会支持。但是如果你用其它品牌的PLC，那最好向触摸屏厂家询问是否支持你的PLC，否则是无法通讯的。
| 名称 | 型号 | 价格 |
|---|---|---|
| 昆仑通态 触摸屏 | TPC1561Hi | 3500元 |
我选择昆仑通态的触摸屏，它采用24V直流供电，并配有网口，用普通网线将触摸屏和 S1200 连接，并将触摸屏的 IP 地址设置为与 PLC 所在同一网段（例如192.168.0.3）即可实现和 PLC 的互联。设置 IP 的方法是上电后在进入正式界面之前，在屏幕的任意位置点击一下即可进入设置界面。 我们如何使用触摸屏呢？我们需要对触摸屏进行编程，或者说“组态”。编程需要使用昆仑通态自己的组态软件：MCGS，可以在它的官方网站免费下载。
10 程序设计
10.1 编程工具
购买了S1200 并不意味着你能免费使用它的开发软件。但是没关系，网上有很多破解软件。有意思的是，其中有些资源就是西门子公司的人故意释放出来的，他们可能想占有更多的市场。要对西门子的 PLC 编程必须使用专用的软件：STEP 7 ，下图是 STEP 7 的安装过程。
10.2 PLC的硬件资源
要想用好PLC，就要熟悉它的一些特点，下面我们就了解一下 S1215C 的特点。 1215C的内存有多大呢？ 我们用电脑连接上PLC，然后在STEP 7软件左侧栏双击“在线和诊断”，然后在打开窗口中点击“存储器”，如下图所示。
1. 装载存储器： 4194304 4194304 4194304 Byte ÷ 1024 ÷ 1024 = 4 \div 1024 \div 1024= 4 ÷1024÷1024=4MB 2. 工作存储器： 128000 128000 128000 Byte ÷ 1024 = 125 \div 1024= 125 ÷1024=125KB 3. 保持存储器： 10240 10240 10240 Byte ÷ 1024 = 10 \div 1024= 10 ÷1024=10KB 这和系统手册中给出的数值是一样的，如下：
你看完是不是都哭了，10年前的手机存储器都比这要大。这三个存储器各有什么作用呢？ 1 装载存储器：用于存储用户项目文件（例如：用户程序、组态信息），相当于硬盘； 2 工作存储器：CPU在执行用户程序时会将一些项目内容从装载存储区复制到工作存储区，相当于电脑的内存； 3 保持存储器：掉电后数据仍然保持。如果你希望一些数据能在断电后一直保持就要使用这个存储器。但遗憾的是，小气的西门子公司只给了我们10KB。 PLC 扫描一次程序需要多长时间呢？ PLC会自动记录时间，在同一页面，打开“循环时间”，就能看到PLC完整执行一遍程序需要的时间，如下图所示。这个时间不是固定的，取决于你的程序长短，一般的执行时间在3毫秒以内。
10.3 PLC的软件资源
西门子提供哪些函数功能呢？工业控制编程语言唯一的国际标准——IEC61131-3 规定了46个基本函数，西门子都支持。除此以外，我们常用的还有定时器计数器等功能。AGV 属于移动机器人，而机器人的控制本质是数学计算，所以我重点说说其中的数学函数，共有18个： 数字运算： ABS、SQRT、LOG、LN、EXP、SIN、COS、TAN、ASIN、ACOS、ATAN； 算术运算：ADD、SUB、MUL、DIV、MOD、EXPT、MOVE； 当然还有：>、< 比较运算符。 翻开另一款控制器品牌——倍福的手册，你会发现它同样支持这几个初级函数。 在组态界面，双击 CPU 模块能看到这款 PLC 的其它功能介绍，例如周期定时器，如下图所示。
10.4 西门子PLC的编程方式
西门子PLC 的编程符合国际工业编程语言标准 IEC-611313，因此跟倍福等厂家的差不多。 10.4.1 定义常量
有些量我们要经常使用（例如圆周率 π \pi π），如果每次都用数值来做运算一方面输入很容易出错，而且如果想对其进行更改那要改很多处，非常繁琐。一个方便的做法是将其定义为一个全局的“常数”。使用 PLC 和 C 语言等高级语言相同的一点是，你需要为变量分配内存地址。分配好地址后如何对其赋值呢？因为常量只需要赋一次值即可，所以我们选择在 Startup 块中对其赋值。Startup 块与其它块的区别是在每次 PLC 上电后只执行一次。西门子中有些块的序号是系统预留的，比如 Startup 就是 OB100。我们注意到，在博图软件中，全局变量用双引号表示（例如"PI"），而局部变量前面带个井号#（下面会碰到）。
10.4.2 定义函数
西门子自带的几个可怜的函数只能完成简单的功能，为了实现更高级的机器人控制我们还要自己写一些函数。笔者在使用和分析机器人控制器的过程中发现，网上公开的PLC函数库极少，目前笔者只知道OSCAT库。我们在实现移动机器人运动学时常用的反正切函数、角度归一化函数等等常见的函数可以参考这个库，笔者不再详细讨论它们的实现。 下面以一个很简单的角度弧度转换函数为例来说明如何在博图中自定义函数。 (1) 首先，我们新建一个函数FC（这个函数比较简单，不需要背景数据，所以不用 FB），实现的语言选择 SCL 语言。函数名为“DegreeToRad”。 (2) 然后，我们要明确这个函数的输入，在上面的变量定义栏中的 Input 项目中输入 angleInDegree，类型选择为 Real，如下图所示。在Return 项目中将 DegreeToRad 变量的类型改为 Real，这里注意不要修改 DegreeToRad 变量的名字。
(3) 在下面的输入框输入变换公式。
这里要用 := 对变量进行赋值。你会注意到，变量 PI 是用双引号括起来的，而其它的变量（例如 angleInDegree）前面则带一个井号#。这是西门子PLC用来区分局部变量和全局变量的，局部变量以#开头，而全局变量用引号表示。
10.4.3 定时器
定时器是我们会经常使用的一个功能，想输出随时间变化的量、想延时触发、想输出周期信号都要借助定时器。西门子的每个定时器都对应一个背景数据块。笔者早期经常犯的一个错误是，为了节省时间直接复制粘贴定时器块。其错误是不管你复制多少次，其实最终还是同一个定时器，而且后面的会覆盖前面的值。这个错误导致很多匪夷所思的错误，让笔者头疼了相当长的时间。各位一定要注意，每使用一个定时器都要重新拖进来新建。
10.4.4 循迹算法
为了让 AGV 始终沿着磁条行走，我们需要编程实现循迹功能（也可以叫路径跟踪或者巡线纠偏）。通过专利检索可以发现，AGV循迹算法也是各大企业的核心技术。
循迹程序的逻辑可以非常简单，我们的输入是磁导航传感器的读数，输出则是舵轮转向的速度（或差速轮的转速差）。采用简单的PI（比例-积分）控制策略，磁条如果在传感器零位的左侧，我们就往左偏转，反之在右侧就往右偏转，偏离距离越大那么舵轮转的角度越大。当AGV从直线进入圆弧曲线时，由于积分项的存在，即使传感器读数为零，舵轮也不会回到零位。下面的仿真动画展示了这种控制策略的效果，每个舵轮上都固定了一个传感器跟随舵轮一起偏转，该方法也在实际运行中得到了验证。差速轮的控制则略微复杂，需要根据旋转中心（红色点）计算每个轮子的速度。
引用文献
[1] 一种AGV用磁导航传感器，专利号：CN201710010589.