[
  {
    "path": "README.md",
    "content": "# The-Little-Embedded-System\n\n嵌入式系统学习小书\n\n本小书，希望介绍自己对嵌入式系统软硬件方面的理解，将通过大学生智能汽车竞赛的实际案例展开，试图讲解嵌入式系统的一些基础，毕竟自己工作经验有限，所以如果不妥，还望斧正！\n\n还记得大学学的自动化专业，当初学了一学期单片机居然从没摸过51单片机，也从来没做过实验，后来在大三2017年参加飞思卡尔杯全国大学生智能汽车竞赛，才慢慢对单片机以及嵌入式方面的开发算是有了入门，因为做这个比赛需要对车速进行闭环控制，所以开始学PID控制器相关的知识，这时候发现其实《自动控制原理》那门课理论学术味太浓，距离解决实际问题还相差甚远，一点都不接地气。\n\n大学毕业后，去了无锡一家小公司做电动自行车控制器相关的开发，主要用NEC单片机（因为便宜呀！！），工作后这才发现当时消费市场上的产品多数就是一简单的开环控制，PWM调节占空比调压调速，再做一个限流保护就可以了。那时候，总觉得，日了狗了，早知这样，还上啥学学那些艰深晦涩的理论呀。现在不一样了，像小米平衡车，DJI无人机，还有电动自行车都玩起了SVPWM矢量控制。\n\n2009年，辞去工作开始读研，日子过得不要太潇洒，后来玩的不行了，觉得该搞点论文混毕业呀，于是恶补了一月，刷了PID控制相关的论文，写下了人生中的唯一一篇论文《A Multiple Tuning Method for PID Controllers Using Constrained Particle Swarm Optimization 》，这时候，才发现，原来控制理论不是那么枯燥无味，也可以深入研究很好玩。\n\n内心里其实一直想做实时控制和嵌入式系统方面的工作，于是研究生一毕业，就去风电公司搞变频器开发了，在那里遇到了好多高手和大拿，学了很多控制，硬件，信号，还有嵌入式方面知识，也真的看到了Matlab/Simulink仿真真的可以验证系统，不是像大学在那凑数据糊弄实验报告，说实话，那段时间，真的开阔了自己在技术上的视野，与最优秀的一群人，一起工作和学习讨论问题真的是一种享受。\n\n14年，回到廊坊，大学任教，开始认真做教育，接管创新实验室，给学生开公开课，和学生一起准备飞思卡尔杯大学生智能车竞赛，一切都是从零开始，做过了很多新的尝试，跟学生一起搭智能车比赛的整个软硬件平台，这中间也不断重新梳理自己所学的知识，同时也能看到学生们的不断成长，看着孩子们激动地调车，我自己也是开心得像个孩子一样。\n\n比赛的中间，出现了很多问题，学生们码代码不规范，完全没有版本控制，都是Ctrl C+Ctrl V，采集摄像头图像耗时严重，算法测试和验证极度效率低下，拖累整个开发进程。于是2016年，自己重新梳理了一下，针对比赛中的摄像头组，做一个相对完备的开发平台，在山外K60库和硬件核心板的基础上完成，中间大量的核心工作都基于最简单的工具软件IAR，Maltab和串口完成，虽然是针对智能车比赛，但是里面的很多尝试和想法，在嵌入式系统和控制方面都是通用的，可以给大家做做一个借鉴和学习参考。\n\n本书适合有一些嵌入式入门基础的学习者阅读。希望阅读完本小书，能够解答大家这些问题\n\n* 硬件布线最基本的准则\n* 不带RTOS的嵌入式系统如何更好地开发\n* 嵌入式软件的分层设计怎么做\n* 在设计控制器时，被控系统的简化动态模型怎么获得\n* 传统的PID控制器设计在工程上到底怎么实施，如何仿真测试和写代码\n* Matlab/Simulink怎么可以帮助提高嵌入式控制器的开发和测试效率\n* 如何简单快速地做嵌入式控制器故障分析和错误排查，等等\n\n如果对小书中有问题，请邮件联系chenxiannn\\#gmail.com\n\n相约：[Github](https://github.com/chenxiannn)\n\n\n[觅知圈博客](https://blog.mizhiquan.com/)\n\n"
  },
  {
    "path": "SUMMARY.md",
    "content": "# Summary\n\n* [Introduction](README.md)\n* [ch0-智能车系统介绍](ch0-embedded-system-inctruction.md)\n* [ch1-系统分层设计](ch1-system-hierarchical-design.md)\n* [ch2-机械与硬件设计部分](ch2-hardware-design.md)\n* [ch3-嵌入式平台软件搭建](ch3-embedded-system-platform.md)\n* [ch4-Matlab处理和验证图像算法](ch4-matlab-for-image-processing.md)\n* [ch5-转速和转向控制器设计](ch5-controller-design.md)\n* [ch6-系统测试与分析](ch6-system-test-and-analysis.md)\n\n"
  },
  {
    "path": "ch0-embedded-system-inctruction.md",
    "content": "#### 1.从智能车说起\n\n本小书是以全国大学生智能车比赛作为案例来展开，这是我大学时候的最爱，也是目前自己带的学生创新实验室主要的比赛项目，所以站在这个角度给大家简单说一下如何构建一个基本的嵌入式系统，不求实现的多么完美，但求简洁而明白。\n\n智能车比赛主要任务是做赛道寻线跟踪处理，用摄像头采集前方赛道图像，实现车速和转向的控制，达到跟踪赛道行驶的效果，如果类比人开车的话，摄像头就相当于司机的眼睛，图像处理和控制相当于老司机，转速控制相当于加减油门和刹车，转向控制相当于方向盘，这样对应理解了吧。\n\n智能车整体结构的俯视图和侧视图如图1所示，后轮电机驱动，电池后放，摄像头中间放置，舵机改造为立式。\n\n![](/assets/EmbeddedSystem_S0_P0.png)图1.智能车结构图\n\n整个智能车系统里面涉及几部分：机械设计，硬件设计，嵌入式平台软件，控制算法软件与图像处理软件，本小书将会重点对后三部分详细展开介绍。这里要说一点，虽然本小书不探讨机械，但是整个智能车机械部分是非常重要的部分，或者可以这样说，机械调教决定了车的理论最高车速，而控制软件部分只决定实际车速，由于受限于自己自动化的专业背景，机械这方面不能过多展开。如果想深入学习机械，请大家阅读相关的专业书籍。\n\n#### 2.整体系统结构\n\n智能车的整体结构如图2所示，上面是软件部分，主要包括图像处理，转速控制和转向控制，下面是硬件机械部分，主要包括电机，驱动，编码器，舵机，摄像头。整个系统的信号流和控制结构都可以从图中看出来，获取图像进行处理得到加减速指令和转向指令，下发给转速控制器和转向控制器，转向控制器负责控制舵机实现路径跟踪，转速控制器负责两个后轮的转速闭环控制。\n\n* 机械与硬件设计（电源，编码器，电机驱动，摄像头）\n\n* 嵌入式平台软件（系统结构，分层设计，模块设计）\n\n* 控制算法软件（转速PI控制器，Matlab仿真，转向控制器设计）\n\n* 图像处理软件（Matlab与C语言混合编程，图像处理与验证）\n\n* 系统测试与分析（串口辅助调试，IO辅助测试，Matlab可视化数据分析） ![](/assets/EmbeddedSystem_S0_P1.png)图2.智能车总体结构图\n\n#### 3.经验之谈\n\n一个嵌入式产品都会涉及到机械，硬件和软件，需要三部分的协作才能够完成，如果把做这个比赛看成一个项目的话，那就要考虑时间上的安排，这里要注意三者时间上的关系，机械如果有定制件的话，迭代周期会是1-2个月，硬件的迭代周期一般是1-2周，软件的迭代周期是1-2天，务必要清楚这一点，用到的机械上大部件（电机，舵机，摄像头等），必须提前采购好，做好充分的备料，这玩意如果出了问题，妥妥地托一个星期没商量，所以在满足性能和可用性的前提下，尽量简化机械与硬件的设计，做好保护措施。同时也要提前安排好时间，比如PCB发出去之前，最好所有用到的元器件要买齐，不然PCB板回来了，根本焊不出一个完整板子。\n\n"
  },
  {
    "path": "ch1-system-hierarchical-design.md",
    "content": "#### 1.分层与模块化\n\n说起分层，让我想起了大学刚毕业去的那家小公司，当时自己维护空调控制板，代码是前辈做的，功能相当棒，但是当我看到代码的那一刻，差点吐血，因为整个代码就两个文件shuikongtiao.c和shuikongtiao.h，里面的变量和函数定义全部用汉语拼音，哈哈哈，一万只草泥马从心中飞过。我擦，终于见识到了国产一线小厂的实力水平。看到代码的那一刻，就在想，这玩意居然好使，写代码的人是爽了，维护者怎么搞呀，一个.c文件上万行。当然这些都是内心戏，说出来，前辈肯定把我废了。\n\n我大学时学C语言，刚开始码代码就是一个main.c然后用一个main函数搞定所有的事，比如下面：\n\n```\n#include<stdio.h>\n#include<stdlib.h>\n\nint main(int argc,char**argv)\n{\n    //定义变量，balabala\n    int a,b;\n    int sum;\n    //输入数据或者读取文件\n    scanf(\"%d %d\",&a,&b);\n    //处理逻辑\n    sum=a+b;\n    //打印输出\n    printf(\"%d+%d=%d\",a,b,sum);\n    return 0;\n}\n```\n\n这样的单文件单函数处理一些比如简单计算，文件读写，代码行不超过两个屏还不错，当代码超过2屏（大概150行），就要开始切分模块分割函数了，于是main.c变成了下面的样子。\n\n```\n#include<stdio.h>\n#include<stdlib.h>\nstruct data{\n    int a;\n    int b;\n}\nint read_data(char*filename,struct data*d)\n{\n    //读取数据\n}\nint process_data(struct data*d)\n{\n    //处理数据和逻辑\n}\nint print_data(struct data*d)\n{\n    //输出数据\n}\n\nint main(int argc,char**argv)\n{\n    //定义变量，balabala\n    struct data d;\n\n    read_data(\"input.dat\",&d)\n    process_data(&d);\n    print_data(&d);\n\n    return 0;\n}\n```\n\n通过将部分功能模块化抽离出函数，原本上千行的代码被切割为几个50-200行的代码，既方便阅读，又方便处理，随着功能继续完善，我们会产生不同的数据处理方式，比如添加，删除，修改，查看，查找，排序等，这时候我们就需要把处理数据的部分单独拿出来成为一个独立的模块，于是我们产生了新的模块process\\_data.c和process\\_data.h，其中.c文件负责模块的代码实现，.h负责模块的对外接口声明，其他的模块也类似，于是我们的代码变成了下面几个文件main.h，process\\_data.c和process\\_data.h，read\\_data.c和read\\_data.h，print\\_data.c和print\\_data.h。\n\n```\n//process_data.h\n#ifndef __PROCESS_DATA_DEF__\n#def __PROCESS_DATA_DEF__\n\n//数据元素\nstruct data{\n    int a;\n    int b;\n}\ntypedef struct data* dat;\n\n//数据链表\nstruct data_list{\n    struct data d;\n    dat    next;\n}\ntypedef struct data_list* dat_list;\nextern int new_list   (dat_list dl);\nextern int add_data   (dat_list dl,dat d);\nextern int update_data(dat_list dl,int index,dat d);\nextern int delete_data(dat_list dl,int index);\nextern dat select_data(dat_list dl,char* cmd);\nextern int sort_data  (dat_list dl);\nextern int search_data(dat_list dl,dat d);\n\n#endif\n```\n\n```\n//process_data.c\n#include \"process_data.h\"\n\n\nint new_list   (dat_list dl)\n{\n}\n\nint add_data   (dat_list dl,dat d)\n{\n    //添加数据\n}\nint update_data(dat_list dl,int index,dat d)\n{\n    //更新数据\n}\nint delete_data(dat_list dl,int index)\n{\n    //删除数据\n}\ndat select_data(dat_list dl,char* cmd)\n{\n    //查找数据\n}\nint sort_data  (dat_list dl)\n{\n    //排序数据\n}\nint search_data(dat_list dl,dat d)\n{\n    //查找数据\n}\n\n#endif\n```\n\n这时候的main.c就把process\\_data，read\\_data，print\\_data包含进来，即可以使用该模块，main.c的代码进一步缩减，框架和结构更清晰明了。\n\n```\n#include <stdio.h>\n#include <stdlib.h>\n#include \"process_data.h\"\n#include \"read_data.h\"\n#include \"print_data.h\"\n\nint main(int argc,char**argv)\n{\n    //定义变量，balabala\n    struct data d;\n    dat_list dl;\n    //输入数据\n    new_list(dl);\n    while(read_data(\"input.dat\",&d) != 0)\n         add_data(&d);\n\n    //一系列的数据处理过程\n    select_data(dl,d);\n\n    //个性化显示数据\n    print_data(&d);\n\n    return 0;\n}\n```\n\n随着系统功能进一步复杂，输入设备会有各种各样，输出设备与模式也会有各种各样的适配，为了控制系统的复杂度，会进一步进行分层，整体的进化流程就如图1所示。\n\n![](/assets/EmbeddedSystem_S1_P0.png)图1.模块与分层进化图\n\n其实说到底，最初其分成几个函数，到后面的模块化，再到最后的分层设计，都是在简化系统的复杂度，做到局部可控，这样才能hold住全场，让我们同一时刻只关注有限的信息量，毕竟都是人类，谁能一下子接受那么多code，更何况是凌乱的呢。善待code，善待自己，请从模块和分层开始。其实分层不是绝对的完美，所有的分层都会带来效率的降低，比如额外增加的函数调用时间损耗，但是为了可读性和可维护性，牺牲一点效率又能怎么样呢。不过千万不要过度分层，那是在装逼，不是在设计。\n\n#### 2.整个系统的总体设计\n\n智能车系统的模块与分层划分，总体上分为三层，如图2所示。\n\n* 控制与图像层（转速与转向控制器，图像处理）\n* 嵌入式平台层（信号采集，器件驱动，任务调度）\n* 硬件与机械层（舵机，电机，硬件驱动，编码器，电源，摄像头，巴拉巴拉）\n\n这三层划分，在一般的项目中正好对应四类工程师，控制与图像层对应控制与算法工程师，嵌入式平台层对应嵌入式软件工程师，硬件与机械层，对应嵌入式硬件工程师和机械设计工程师。如果要想实现一个完备的嵌入式系统产品，需要凑齐这四类人才才能够有备无患。\n\n![](/assets/EmbeddedSystem_S1_P1.png)\n\n图2.整体系统模块结构图\n\n##### 控制与图像层\n\n系统中图像处理模块图如图3所示，主要实现图像的处理，寻找中线，以及与Matlab2011a和VS2010配合实现对算法的快速仿真验证，大大提高开发效率，后文会重点介绍这里。\n\n* imCom：图像处理的公用模块\n* imProc：图像处理找中线和计算方向偏差的算法实现\n* imType：自定义数据类型\n* imCar：与Matlab的接口模块，用来快速批量验证算法\n\n![](/assets/EmbeddedSystem_S1_P2.png)\n\n图3.图像处理模块图\n\n系统中控制算法部分的模块图如图4所示，主要负责实现转速和转向控制，其中转速控制会结合Matlab/Simulink 进行仿真，寻找合理的PI控制参数，后面会详细展开如何设计PI控制器。\n\n* ControlVar：所有的共享全局变量\n* ControlParam：所有的全局配置参数\n* ControlGraphTask：图像和方向控制任务模块\n* ControlSpeedTask：速度控制任务模块\n\nControl子模块介绍：\n\n* EIT\\_PID：PID控制器模块\n* EIT\\_SpeedL：左轮速度控制器\n* EIT\\_SpeedR：右轮速度控制器\n\n![](/assets/EmbeddedSystem_S1_P3.png)\n\n图4.控制算法模块图\n\n##### 嵌入式平台层\n\n嵌入式平台层，负责整个嵌入式软件系统的初始化，信号采集以及驱动执行，模块结构如图5所示，其中本小书会详细介绍EITLIb库中的电机驱动与编码器和摄像头采集部分。\n\n* CarDisplay：显示模块\n* CarSystem：系统初始化模块\n* CarTest：主循环模块\n* IntHandler：中断处理模块\n* Board：Vcan山外的K60核心板库\n* EITLib：自定义的硬件驱动库\n* Chip：Vcan山外实现的 K60的部件库\n* CMSIS：CMSIS支持库\n\n![](/assets/EmbeddedSystem_S1_P4.png)\n\n图5.嵌入式平台模块结构图\n\n**硬件与机械层**\n\n硬件采用山外的K60核心板，其他部分，控制核心板和驱动电源板都是自制。模块结构如图6所示，其中主要的是Power，Camera，Motor，Sensor，LCD和Key模块图。\n\n![](/assets/EmbeddedSystem_S1_P5.png)图6.系统硬件结构图\n\n机械部分在ch2再做介绍。\n\n到现在为止，对整个智能车系统有了一个总体的了解，下面我们会分模块进行详细的介绍。\n\n"
  },
  {
    "path": "ch2-hardware-design.md",
    "content": "#### \n\n#### 1.硬件布线\n\n当初大学画电路板的时候，啥玩意都不懂，记得当初直接用面包板焊接，虽然好使，但其丑无比。后来工作也画过一些PCB，但是始终不得要领，以为能把线连上连对就万事大吉了。后来阅读了一些电子电路和硬件的书籍，有了自己的一点点体会，虽然不多，但是应付一般场合足够了。很简单的物理知识就可以理解，至于高手搞通信高频布线，要考虑群延时，分布电感电容，信号完整性分析，我觉得大家以后真的玩高级硬件的话，可以再深入，这里就算是一个简单入门吧。\n\n这里我就先画一个非常简单的电路图，做一个简单的计算，大家就会明白。\n\n比如一个电源给两个器件供电，一个工作电流10mA，一个工作电流10A，我们看下面图1中两种接线方式有啥区别？？？？？\n\n![](/assets/EmbeddedSystem_S2_P1.png)\n\n图1.两种接线方式理想电路图（红色为正，蓝色为负）\n\n很多同学会说，不都是两个器件并联吗，不都是电源电压吗？？？电路原理的课上说啦，并联电压相等，所以上面的两张图，完全一个样子嘛，能有啥区别？？？！！！！\n\n这里我要提醒大家啦，注意连线，那都是铜线，不是超导体，拿起小本子要记住啦，铜线也有阻抗，PCB布线也有阻抗。考虑进来，之后的图就是下面这样子图2所示。\n\n![](/assets/EmbeddedSystem_S2_P2.png)\n\n图2.考虑线路阻抗的等效电路图\n\n有的同学看到图2，会说，才20m欧，能有啥大事嘛。。。。大家要记住，我们这里还没说电源电压多少V呢，如果是1000V的话，那当然没事，但是如果电源是7V电压呢？？？你想想两种布局方式，1A器件与10A器件的静态工作电压有什么差别？？\n\n| 左侧布局 | 右侧布局 |\n| :--- | :--- |\n| **1A器件**电压：7-\\(1+10\\)\\*\\(0.02\\*2\\)=**6.56V** | **1A器件**电压：7-10\\*0.02\\*2-1\\*0.02\\*4=**6.52V** |\n| **10A器件**电压：7-10\\*0.02\\*4-1\\*0.02\\*2=**6.16V** | **10A器件**电压：7-10\\*0.02\\*2-1\\*0.02\\*2=**6.56V** |\n\n只通过一个简单的计算，我们就发现，右侧布局明显好于左侧布局，就因为10A电流在线路上产生了更大的线损，所以越靠近电源越好。这时候我们就得到这个结论，**功率越大的器件，越靠近电源供电的话，那对整个系统工作的影响就越小。**\n\n于是我们的电路布局图就成为这个样子图3所示，大功率和小功率分布布局，大功率的地和电源尽可能从靠近电源的正负极直接引线，这样大功率器件对其他小功率器件的影响能够降到最小。\n\n![](/assets/EmbeddedSystem_S2_P3.png)\n\n图3.大功率与小功率分开布局\n\n下面我的电路继续升级，加入了PWM数字开关器件，还有一些小的器件，大家有没有想过，这样玩，会不会有啥问题。。。\n\n![](/assets/EmbeddedSystem_S2_P4.png)\n\n图4.添加小器件和数字开关PWM部件\n\n如果说第一条只用到了电路的欧姆定律，那这一条就要用到电磁感应原理，大家跟我的思路想哈，PWM要不停地开关，那0.5A电流就是交变的电流，交变的电流线圈会在整个线路环里产生交变的磁场，那是不是说所有包含在电源到0.5APWM器件的环路里的所有器件信号都会被这个交变磁场影响，因为交变的磁场会在其内部线路里又产生感性电动势和感应电流。这里只是0.5A，那如果10A电流也是开关器件呢，那简直瞬间干扰死那些线路里的小信号器件。于是我们就有了**第二条定律，大功率器件的电源和地最好贴着走，不要包含小功率的器件。**\n\n于是图4就会进化到图5，虽然丑了点，是效果好呀！！！\n\n![](/assets/EmbeddedSystem_S2_P5.png)\n\n图5.电源和地贴着走布局图\n\n所以最终结论就是如下：\n\n* 尽可能大功率的器件靠近电源接线\n* 尽可能开关功率器件尤其是大功率的开关器件，电源和地包络器件越少越好。\n\n铭记上面两条法则，应该能应付一般的PCB布线了。\n\n智能车电路为例，整体电路分为三部分，电机驱动，舵机，控制电路，总体布线如图6所示，三大部分彻底分开，尤其是电机驱动这块，流大电流。\n\n![](/assets/EmbeddedSystem_S2_P0.png)图6.智能车PCB布线图\n\n电机驱动阻抗分析：\n\nB车电机内阻150m欧，电池内阻80m欧，电源线，保险和开关20-30m欧，PCB布线电阻20m欧，整体线路内阻大概是250-300m欧，如果按照电池工作电压7-8V计算的话，那短路电流有20-30A\n\nC车模相对好一些，电机内阻900m欧，加上电池内阻，电源线，开关，保险丝，PCB布线100-150m欧，总阻抗1欧，即使考虑到双电机并联，最大电流不超过15A左右。\n\n#### 2.电机H桥\n\n聊完硬件布线，我们再聊聊直流电机，说简单点就是给它加直流电压，那它就转，比如图1的电路，一个开关K就可以控制电机转动和停止。\n\n![](/assets/EmbeddedSystem_S2_P6.png)\n\n图7.开关控制电机转和停\n\n如果我们想让既能让电机正转，又能反转，那该怎么设计呢，如图8所示，为了简化，图中未画出续流二极管。K1和K2通的时候，电机正转，K3和K4通的时候，电机反转，这个电路结构称为H桥电路。\n\n![](/assets/EmbeddedSystem_S2_P7.png)\n\n图8.H桥正反转\n\nH桥可以让电机工作于四个状态，如下表所示。\n\n| 开关状态 | 电机状态 |\n| :--- | :--- |\n| K1和K2闭合 | 正转 |\n| K3和K4闭合 | 反转 |\n| K2和K4闭合 | 刹车状态 |\n| 四个开关都断开 | 滑行状态 |\n\n截至目前，电机的工作电压，要么是电池电压，要么电压为0，要么是反向电池电压，如果想调压调速的时候，那怎么办呢？？？  \n搞电力电子的兄弟们发明了一种简单方法，比如现在电池只有7V电压，那可以这样玩，加个电子开关，给电机通电5ms7V，再断开5ms，然后依次循环，只要频率足够快就没啥事，这样等效下来是不是就相当于3.5V电压呀，然后通过调节开通关断时间比例，来连续调节电压，这就叫做PWM控制。简单点说，**有了PWM调节，我们的电机就可以调压调速了**。\n\nH桥调压调速具体玩法如图9所示。比如正向，下桥K2长通，然后给K1加PWM控制，K1导通的时候，电池电压加到电机上正向电流，如果图9的左边，K1关闭的时候，电池电机的电流通过K4的续流二极管进行续流，图9的右边。反转的话，依次类推即可。\n\n![](/assets/EmbeddedSystem_S2_P8.png)图9.H桥调压调速图\n\n电机控制的示例代码：\n\n```\n//初始化代码\nvoid MotorR_Init(void)\n{\n   /*Motor Drive*/\n   gpio_init (MOTORR_EN, GPO,0);\n   FTM_PWM_init(MOTORR_FTM, MOTORR_PWMA, MOTORR_PWM_FREQ,0);\n   FTM_PWM_init(MOTORR_FTM, MOTORR_PWMB, MOTORR_PWM_FREQ,0);\n\n   /*Speed Measure*/\n   FTM_QUAD_Init(MOTORR_ENCODE_FTM);\n}\n//PWM控制正反转\nvoid MotorR_Run(int32 pwm)\n{\n   uint32 PWM_A =0;\n   uint32 PWM_B =0;\n\n   if(pwm>MOTORR_PWM_MAX)\n       pwm=MOTORR_PWM_MAX;\n   else if(pwm<MOTORR_PWM_MIN)\n       pwm=MOTORR_PWM_MIN;\n\n   if ( pwm >0 )\n   {\n      PWM_A = pwm;\n   }\n   else if ( pwm <0 )\n   {\n      PWM_B = -pwm;\n   }\n   FTM_PWM_Duty(MOTORR_FTM, MOTORR_PWMA,PWM_A);\n   FTM_PWM_Duty(MOTORR_FTM, MOTORR_PWMB,PWM_B);\n   gpio_set ( MOTORR_EN,1);\n}\n//刹车\nvoid MotorR_Brake(void)\n{   \n   FTM_PWM_Duty(MOTORR_FTM, MOTORR_PWMA,0);\n   FTM_PWM_Duty(MOTORR_FTM, MOTORR_PWMB,0);\n   gpio_set  ( MOTORR_EN,1);\n}\n//滑行\nvoid MotorR_Slip(void)\n{\n   gpio_set  (MOTORR_EN,0);\n   FTM_PWM_Duty(MOTORR_FTM, MOTORR_PWMA,0);\n   FTM_PWM_Duty(MOTORR_FTM, MOTORR_PWMB,0);\n}\n```\n\n至于其他的硬件问题，我这里就不过多赘述，比如电源线正反要接对，稳压芯片前要加TVS管，抑制直流电机换向的尖峰脉冲电压，稳压电源的散热面积要大一些，尽量加保险丝保护，摄像头这块，我觉得山外的文档《ov7725数字摄像头编程基本知识笔记》已经解释的很清楚了，就不多赘述了。\n\n#### 3.机械这块简单说几句吧\n\n首先有几点我一定要提醒大家：\n\n* 车前的防档杆必须加，否则你的舵机一撞墙齿轮就会被挤坏\n* 车底盘变形问题一定要注意\n* 轮胎务必加胎水，否则轮胎一上赛道滑的要命\n\n其实，机械这块的改造，经过这十来年基本成型了，每年智能车比赛这块，大家差不多都一个模子。但是有个点，一定要强调，就是前轮定位的机械调教。\n\n前轮定位的作用是保障汽车直线行驶的稳定性，转向轻便和减少轮胎的磨 损。前轮是转向轮，它的安装位置由主销内倾、主销后倾、前轮外倾和前轮前 束等 4 个项目决定，反映了转向轮、主销和前轴等三者在车架上的位置关系。 下面这几个角度的介绍摘自《第十届“飞思卡尔”杯全国大学生 智能汽车竞赛-北京科技大学电磁组一队》的技术报告，感谢他们做的这么好的总结。后续我仔细研究过汽车理论之后，再为大家详细画图详细介绍这几个角度对车辆的影响。\n\n**主销后倾角   \n**\n\n所谓主销后倾，是将主销（即转向轴线）的上端略向后倾斜。从汽车的侧面看去，主销轴线与通过前轮中心的垂线之间形成一个夹角，即主销后倾角。主销后倾的作用是增加汽车直线行驶时的稳定性和在转向后使前轮自动回正。由于主销后倾，主销（即转向轴线）与地面的交点位于车轮接地点的前面。这时，车轮所受到的阻力的作用点总是在主销轴线之后，相当于主销拖着车轮前进。这样，就能保持行驶方向的稳定性。当车转弯时，由于车轮所受阻力作用线，不通过主销轴线，这样，车轮所受阻力在主销方向有力矩  \n作用产生，迫使车轮自动偏转直到到车轮所受阻力作用线通过主销轴线，此时，车轮已回正，这就是转向车轮的自动回正功能。\n\n主销后倾角越大，方向稳定性越好，自动回正作用也越强，但转向越沉重。汽车主销后倾角一般不超过3°，由前悬架在车架上的安装位置来保证。现代轿车由于采用低压宽幅子午线轮胎，高速行驶时轮胎的变形加大，接地点后移，因此主销后倾角可以减小，甚至为负值（变成主销前倾），以避免由于回正力矩过大而造成前轮摆振。\n\n模型车通过增减黄色垫片的数量来改变主销后倾角的，由于竞赛所用的转向舵机力矩不大，过大的主销后倾角会使转向变得沉重，转弯反应迟滞，所以设置为0°，以便增加其转向的灵活性。\n\n**主销内倾角**\n\n所谓主销内倾，是将主销（即转向轴线）的上端向内倾斜。从汽车的前面看去，主销轴线与通过前轮中心的垂线之间形成一个夹角，即主销内倾角。主销内倾的作用是使车轮转向后能及时自动回正和转向轻便。对于模型车，通过调整前桥的螺杆的长度可以改变主销内倾角的大小，由于过大的内倾角也会增大转向阻力，增加轮胎磨损，所以在调整时可以近似调整为0°~3°左右，不宜太大。\n\n主销内倾和主销后倾都有使汽车转向自动回正，保持直线行驶的功能。不同之处是主销内倾的回正与车速无关，主销后倾的回正与车速有关，因此高速时主销后倾的回正作用大，低速时主销内倾的回正作用大。\n\n**车轮外倾角   \n**\n\n前轮外倾角是指通过车轮中心的汽车横向平面与车轮平面的交线与地面垂 线之间的夹角，对汽车的转向性能有直接影响，它的作用是提高前轮的转向安 全性和转向操纵的轻便性。在汽车的横向平面内，轮胎呈“八”字型时称为“负 外倾”，而呈现“V”字形张开时称为正外倾。如果车轮垂直地面一旦满载就易 产生变形，可能引起车轮上部向内倾侧，导致车轮联接件损坏。所以事先将车 轮校偏一个正外倾角度，一般这个角度约在 1°左右，以减少承载轴承负荷，增 加零件使用寿命，提高汽车的安全性能。\n\n模型车提供了专门的外倾角调整配件，近似调节其外倾角。由于竞赛中模 型主要用于竞速，所以要求尽量减轻重量，其底盘和前桥上承受的载荷不大， 所以外倾角调整为 0°即可，并且要与前轮前束匹配。\n\n**前轮前束   \n**\n\n所谓前束是指两轮之间的后距离数值与前距离数值之差，也指前轮中心线 与纵向中心线的夹角。前轮前束的作用是保证汽车的行驶性能，减少轮胎的磨 损。前轮在滚动时，其惯性力自然将轮胎向内偏斜，如果前束适当，轮胎滚动 时的偏斜方向就会抵消，轮胎内外侧磨损的现象会减少。像内八字那样前端小 后端大的称为“前束”，反之则称为“后束”或“负前束”。在实际的汽车中， 一般前束为 012mm。\n\n在模型车中，前轮前束是通过调整伺服电机带动的左右横拉杆实现的。主 销在垂直方向的位置确定后，改变左右横拉杆的长度即可以改变前轮前束的大 小。在实际的调整过程中，我们发现较小的前束，约束 02mm 可以减小转向阻力， 使模型车转向更为轻便，但实际效果不是十分明显。\n\n虽然模型车的主销后倾角、主销内倾角、车轮外倾角和前束等均可以调整， 但是由于车模加工和制造精度的问题，在通用的规律中还存在着不少的偶然性， 一切是实际调整的效果为准。\n\n在实际调试中，我们发现适当增大内倾角的确可以增大转弯时车轮和地面的接触面积，从而增大车了地面的摩擦程度，使车转向更灵活，减小因摩擦不够而引起的转向不足的情况。前轮前束为0-1度左右，直线行驶更稳定。\n\n硬件与机械就到此了，这块自己也还需要继续学习。\n\n"
  },
  {
    "path": "ch3-embedded-system-platform.md",
    "content": "#### 1.从任务调度说起\n\n最开始我们在单片机写代码的样子是怎样的呢？在ch1那一章我们对模块和分层进行了讨论，模块是对功能代码的封装，分层是在平台层面封装，都是在解决项目复杂度控制的问题，但是我们拿单片机最主要的目的是来执行任务Task帮我们做事的，比如读取ADC采样数据，读取键盘按键，输出PWM，I2C通讯，运行PID控制，等等。\n\n那在单片机里如何组织任务调度的设计？\n\n##### 大循环调度\n\n最初的最初，我们的任务调度简单直接——也就是大循环方式，示例代码如下：\n\n```\nint main()\n{\n    Dis_Interrupt();\n    System_Init();\n    En_Interrupt();\n\n    while(1)\n    {\n        Task0_Run();\n        Task1_Run();\n        Task2_Run();\n        Task3_Run();\n        Task4_Run();\n    }\n}\n\nvoid Task0_Run(void)\n{\n    Pot1Calc(); //加速器信号计算\n    Pot2Calc(); //制动器信号计算（保留）\n    TempCalc(); //电机及控制器温度计算\n}\n.....\n```\n\n大循环方式的任务调度如图1所示，优点就是简单直接，适合比较简单的系统，带来的不好的地方：\n\n* 每个任务的调度周期和时间是不固定的\\(if else的存在\\)，无法保证确定的周期性执行任务\n* 随着任务数量的增加，系统会越来越慢\n* 如果遇上长时间任务，会拖累整个系统变慢\n\n![](/assets/EmbeddedSystem_S3_P0.png)图1.大循环任务调度图\n\n##### 定时任务调度\n\n为了克服大循环方式的缺点（任务调度周期性无法保证，任务数量增加系统会变慢），提出了定时的任务调度的方式，不过需要使用单片机一个定时器，来实现一个简单的任务调度器，利用定时器将CPU切割为一个等周期的时间片调度单元，然后利用标志位控制在每个时间片只调用一个任务。整个系统代码结构如下所示：\n\n```\n#define TASK_MAX_LENGTH 10\ntypedef struct\n{\n    Int16 Flag[TASK_MAX_LENGTH];\n    Int16 Timer;\n    Int32 Number;\n} USERTASK;\nUSERTASK UserTask0={0,0,0,0,0,0,0,0,0,0,0,TASK_MAX_LENGTH};//任务初始化\n\n//任务调度函数\nvoid TaskScheduler(USERTASK* v)\n{\n    v->Flag[v->Timer++] = 1;\n    if(v->Timer >= v->Number)\n    {\n        v->Timer = 0;\n    }\n}\n//主函数\nint main()\n{\n    Dis_Interrupt();\n    System_Init();\n    En_Interrupt();\n\n    while(1)\n    {\n        Task0_Run();\n        Task1_Run();\n        Task2_Run();\n        Task3_Run();\n        Task4_Run();\n    }\n}\n\n//1ms定时中断\n__interrupt void Timer0_INT_MapedISR(void)\n{\n    TaskScheduler(&UserTask0);\n}\n\n//单个任务示例函数\nvoid Task0_Run(void)\n{\n    if(UserTask0.Flag[0])\n    {\n        Pot1Calc();                    //加速器信号计算\n        Pot2Calc();                    //制动器信号计算（保留）\n        TempCalc();                    //电机及控制器温度计算\n\n        UserTask0.Flag[0] = 0;\n    }\n}\n......\n```\n\n定时任务调度的流程图如图2所示。与大循环调度方式对比，这种方式能够实现周期性的任务调度，同时随着任务的增加，依然能够保证调度的周期性，这种调度能够应对大多数的控制系统，比如TI的PMSM电机控制器，一般小的家电控制器，都可以搞定。但是使用时有几点要注意：\n\n1. 单个任务的最长时间长度务必保证不超过单个时间片，否则会导致周期性延迟\n2. 对于严格实时的控制周期任务，定时调度器不能够保证\n3. 对于长周期任务（比如通讯等待等），定时任务调度器要么把任务切割为小任务，要么安排几个连续的空闲周期来执行\n\n![](/assets/EmbeddedSystem_S3_P1.png)图2.定时任务调度图\n\n针对第1点，需要测试或者预估任务的最长执行时间，这个可以采用IO测试的方式解决（具体参见ch6）。\n\n针对第2点，对于实时性要求高，并且周期控制快的任务（比如PID控制），只能将这个任务放到定时中断里做，示例代码如下：\n\n```\n//1ms定时中断\n__interrupt void Timer0_INT_MapedISR(void)\n{\n    TaskScheduler(&UserTask0);\n    Task_SpeedPID_Control();\n}\n\n//实时性要求高的任务，示例函数，如果控周期慢的话，也可以选择加入if(UserTask0.Flag[0])做判断\nvoid Task_SpeedPID_Control(void)\n{\n   SpeedPID_Input();                    //读取输入指令和反馈信号\n   SpeedPID_Run();                      //运行PID\n   SpeedPID_Output();                   //输出PWM控制\n}\n......\n```\n\n针对第3点，我们可以将长周期任务放在最后面，如图3所示，可以把最后几个空闲周期都留给Task4执行。但是要注意，如果有多个长周期任务，依然会拖慢整个调度周期，于是就出现了基于优先级的任务调度方式，高优先级的任务可以中断低优先级的任务，在保证长周期任务调度的同时，短周期任务的调度依然能够保证，这就是RTOS。\n\n![](/assets/EmdeddedSystem_S3_P2.png)图3.长周期调度方式\n\n##### 实时操作系统RTOS调度\n\n实时操作系统，常用的小型RTOS有uCosII，FreeRTOS，Rt-thread，主要是任务优先级的调度方式不一样，这里感兴趣的同学，可以参见相关的专业书籍，对RTOS内核代码不做详细介绍。RTOS的对任务的调度方式如图4所示。Task0的优先级高，可以中断优先级低的Task1，等Task0执行完，然后RTOS会切换到Task1继续执行。\n\n![](/assets/EmdeddedSystem_S3_P3.png)图4.RTOS任务调度方式图\n\n#### 2.智能车总体任务调度\n\n智能车调度平台总体上只有两个任务SpeedControlTask和ControlGraphTask，考虑到系统简单，没有用RTOS和任务调度器，直接中断配合While实现，代码示例如下，运行时序如图5所示。\n\n```\n//main主循环\nvoid main(void)\n{                                                               \n   DisableInterrupts;  \n   CarSystem_Init();\n   EnableInterrupts;\n   Car_Test();//主循环在这里\n   while(1);                                                  \n}\n\n//主循环\nvoid  Car_Test(void)\n{ \n    while(1)\n    {  \n       if(ImageOver)//图像DMA传输结束\n       {\n           ImageOver=0;\n           img_extract((uint8 *)Image_Data, (uint8 *)imgbuff0, CAMERA_SIZE);//解压图像\n           ControlGraphTask();//图像处理任务\n\n           DataLog_Add();//数据记录\n           if(DataLog_CheckEN())\n              DataLog_Print();\n      }\n    }\n}\n\n//中断\n#define CAM_VSYNC 29\n\nvoid PORTA_handler(void)\n{\n    uint32 flag = PORTA_ISFR;\n    PORTA_ISFR  = ~0; \n   if(flag & (1 << CAM_VSYNC))                                 //PTA29触发摄像头帧中断\n   {\n       ImageOver=0;                                            //清除图像采集标志                                  \n       camera_vsync();\n       gVar.time++;\n   }\n}\n//DMA传输图像数据\nvoid DMA0_IRQHandler()\n{\n    camera_dma();\n    ImageOver=1;\n}\n\n//定时10ms中断，执行速度PID控制任务\nvoid PIT0_IRQHandler(void)\n{\n   SpeedControlTask();\n   PIT_Flag_Clear(PIT0);\n}\n```\n\n![](/assets/EmdeddedSystem_S3_P4.png)图5.系统任务时序图\n\n总体思路就是，每一幅图像的帧中断VSYNC触发PORTA\\_handler\\(PA29\\)中断函数，此时ImageOver清零，同时DMA开始传输图像，当DMA传输结束触发DMA0\\_IRQHandler中断，此时ImageOver=1，如果ControlGraphTask检测到的话，那就开始执行，如果ControlGraphTask在VSYNC到来清零ImageOver之前没有开始执行的话，那只能等待下一次DMA中断。最终测试结果，每两帧触发一次ControlGraphTask执行，控制周期为13.33ms。\n\n#### 3.嵌入式驱动层设计\n\n嵌入式驱动层大部分复用了Vcan山外的板级库，新加入比较重要的库有EITMotorL，EITMotor\\_R，EIT\\_Steer和EIT\\_Log，封装在EITLib文件夹，总体的思路就是，.h负责接口，.c负责功能实现。\n\n这里以Motor库为例，介绍一下嵌入式驱动库的封装。\n\n考虑到速度控制用到Motor和Encode，所以把二者集成放到了一起，整体MotorR代码解析如下所示。\n\n```\n#ifndef __EIT_MOTORR_DEF__\n#define __EIT_MOTORR_DEF__\n#include \"include.h\"\n/*Motor Driver*/\n#define    MOTORR_PWM_MAX   1000                   //PWM范围：-1000到1000\n#define    MOTORR_PWM_MIN   (-1000)\n#define    MOTORR_PWM_FREQ  15000                  //PWM工作频率\n#define    MOTORR_FTM    FTM0\n#define    MOTORR_EN     PTA24\n#define    MOTORR_PWMA   FTM_CH3\n#define    MOTORR_PWMB   FTM_CH4\n#define    MOTORR_PWMAIO PTA6\n#define    MOTORR_PWMBIO PTA7\n\n\n/*Encode */\n#define    MOTORR_ENCODE_FTM             FTM2         //左编码器用FTM1\n#define    MOTORR_GEAR_N                 36           //B车电机自带齿轮齿轮数\n#define    ENCODR_GEAR_N                 40           //B车主动轴齿轮齿轮数\n#define    WHEELR_GEAR_N                 105          //编码器比例系数\n#define    ENCODR_CYCLE                  2000         //编码器一圈触发2000个脉冲\n#define    WHEELR_LENGTH                 18           //17.8cm车轮周长\n\n#define    SPEEDR_FS                     100          //速度采样频率Hz，周期10ms\n\nextern void MotorR_Init(void);                        //电机初始化\nextern void MotorR_Run(int32 pwm);                    //电机PWM控制\nextern void MotorR_Brake(void);                       //电机刹车\nextern void MotorR_Slip(void);                        //电机滑行\n\nextern int32 MotorR_GetWheelSpeed(int32 CntInTs);     //speed单位为cm/s\nextern int32 MotorR_GetTsCount(void);                 //10ms周期内，编码器脉冲计数值\n\n#endif\n```\n\n\n\n"
  },
  {
    "path": "ch4-matlab-for-image-processing.md",
    "content": "#### **1.先聊聊基于模型的设计**\n\n可以先看看知乎这篇文章《[基于模型设计——电力电子的利器](https://zhuanlan.zhihu.com/p/23149544)》\n\n最开始我们做小的系统，自己想怎么码就怎么码，想怎么命名就怎么命名，因为系统小，不管怎么折腾复杂度都可控，但是随着代码量的增加，我们开始切分函数，然后切分模块，（参见ch1），这时候我们开始考虑模块化设计，考虑模块的封装与耦合，尽量高内聚低耦合，随着系统复杂度进一步增加，我们开始几个人协同开发，考虑分层，考虑应用层，系统层，驱动层，数据服务是不是要独立出来，通讯是不是要单独出来，是裸跑，RTOS还是Linux，接口如何划分和设计，这时候就开始系统级地去进行软件设计，实现尽可能正交的系统，减少冗余代码。随着系统进一步复杂，代码量和复杂度都在不断攀升，这时候又有什么应对措施呢？？\n\n还有一个问题，我们始终避免不了，就是嵌入式系统的测试与验证，如果按照瀑布模型走的话，等所有代码都完成了，再进行验证测试的话，如果一旦出现问题，再返工重新设计，那不拖延项目才怪呢，所以我们尽可能的将验证测试提前，越早期发现错误，那风险也就越低。于是尝试喷泉模型，在每一个阶段都能进行验证测试，但是嵌入式系统软件和一般软件系统不太一样，因为要与实物配合才能进行测试验证。往往硬件还没出来，我们都无法进行软件的调试测试，然后整个项目就卡在这里，有没有什么好的解决方案呢？\n\n其实，嵌入式系统里，有一部分是纯逻辑与控制算法，这是系统的核心，大量的精力应该放在这里，但是实际中我们更多的时间被硬件接口，驱动，RTOS所累，最后对控制模型反而有点心有余而力不足。那是不是有让我们更专注于模型设计与控制算法的设计方法呢，以此提高我们的工作效率，更专注于核心。\n\n正是基于以上几点，MBD（Model Based Design-基于模型的设计）闪亮登场，于是Matlab/Simulink进入了我们的工具箱，不过这里面分三种玩法：\n\n* 土鳖的玩法：Simulink搭建模型与算法，验证测试通过后，然后再徒手实现C代码\n* 折中的玩法：利用mexfunction写C的控制算法，Simulink模型配合mex构建的控制算法，仿真验证\n* 高级的玩法：Simulink搭建模型与算法，验证测试通过后，自动生成C代码（高级是高级，但是生成的代码没法看）\n\n考虑到代码的移植以及可读性，我们采用的是折中玩法，下面我以智能车的图像处理来简单介绍一下。\n\n**最低效率的方式（比土鳖还土鳖）**\n\n徒手写图像处理的C代码下载到车里，放到赛道上跑两圈，如果好了一把成，但如果出了问题，只能抱着笔记本，连着J-Link调试，趴在那里，一点点查找程序错误，这中间哪怕一个很小的bug问题，都会消耗极大的体力和脑力，因为不受控的因素太多了。\n\n**改进版的方式（土鳖玩法）**\n\n先大量采集赛道图片，覆盖90%以上路况的情况，然后在Matlab里对这些图片进行处理，实现图像处理算法，等验证通过后，再把Matlab徒手翻译为C代码，然后上赛道测试，依然会出现部分bug，但是80%的低级的原则性的bug在Matlab验证阶段已经被消灭了。\n\n**目前要做的方式（折中玩法）**\n\n在改进版中，matlab中验证的是matlab代码，车上跑的是C代码，由于这中间存在人工转化的过程，意味着依然可能会引入未知的错误。为何不直接在matlab里直接验证我的C代码呢？对了，这就是交叉编译，在matlab里直接调用C语言，OK，这样就能保证最终车里跑的代码，是在matlab里最终验证通过的了，Yeah。下面我们就跟着老司机一起开车喽。\n\n#### 2**.交叉编译环境搭建**\n\nMatlab 的软件版本推荐2011a（我比较钟爱老版本，哈哈，因为占地小）\n\nC&C++编译器，推荐VS2010\n\n第一步，先装好Matlab 2011a和VS2010（大家度娘解决吧）。\n\n第二步，在Matlab下配置C&C++交叉编译器。\n\n1.在matlab的工作台中输入mex–setup命令（mex就是matlab支持交叉编译的工具）\n\n![](/assets/EmbeddedSystem_S4_P0.png)\n\n2.回车后，会输出一段话，最后是“Would you  like mex to locate installed compilers\\[y\\]/n”是问你确定要为mex配置编译器？请输入y表示确定。\n\n![](/assets/EmbeddedSystem_S4_P1.png)\n\n3.此时，会显示matlab搜索到已经安装好的VS2010，你要在Compiler：后面输入相应的选择序号1，回车.\n\n![](/assets/EmbeddedSystem_S4_P2.png)\n\n4.在上图里，显示了你配置的编译器，最后需要输入y确认此配置，这样就OK了。\n\n![](/assets/EmbeddedSystem_S4_P3.png)\n\n比如我们实现最简单的y=a+b这样一个加法操作。\n\n用matlab的函数function如何做呢？看下面：\n\n```\nfunction y=add(a,b)\n    y=a+b;\n```\n\n将上面的代码保存为add.m，这样在matlab的工作台就可以调用这个函数了，比如：\n\n![](/assets/EmbeddedSystem_S4_P4.png)\n\n那这样一个简单的加法，我用C语言怎么实现呢？也很简单\n\n```\ndouble  add(double  a, double  b)\n{\n    return a+b;\n}\n```\n\n既然我实现了C语言函数，那在matlab里怎么样调用这个C函数呢？这时候，我们前面配置好的mex交叉编译工具就上场了。\n\n看下面这段代码，看不懂没关系，后面会一一解释的。\n\n```\nvoid mexFunction ( int nlhs, mxArray *plhs[], int nrhs, const mxArray *prhs[] )\n{\n    double *Y;\n    double A, B;\n\n    //输入接口绑定\n    A = *(mxGetPr(prhs[0]));\n    B = *(mxGetPr(prhs[1]));\n\n    //输出接口绑定\n    plhs[0] = mxCreateDoubleMatrix(1, 1, mxREAL); \n    Y = mxGetPr(plhs[0]);\n\n    //做你该做的事\n    *Y = add(A, B);\n}\n```\n\n将上面的这段代码，创建为了new\\_add.c，然后在工作台上输入mex new\\_add.c命令，编译无错，就可以使用了。\n\n![](/assets/EmbeddedSystem_S4_P5.png)\n\n我们到底做了什么？其实，你只是把这个函数需要的两个参数a和b从matlab倒腾到C语言里面，进行了相应运算之后，再把输出结果从C语言里面倒腾到Matlab里而已。\n\n不要怕麻烦，为了不熬夜调车，为了不做码农，刚开始势必会麻烦一点，等熟练了就好了，等你的代码到2000行或者更多的时候，你依然可以有时间优哉游哉地玩耍。\n\n其实Matlab的大侠们，已经给这个倒腾过程，建立了一个专门的接口函数叫mexFunction，这个函数有四个参数分别为：\n\n```\nint nlhs                  输出变量个数\nmxArray *plhs[]           输出变量指针数组\nint nrhs                  输入变量个数\nconst mxArray *prhs[]     输入变量的指针数组\n```\n\n比如看我们上面的例子，当我调用new\\_add\\(3,4\\)时，\n\n```\nint     nlhs              输出变量个数为1\nmxArray *plhs[]           输出变量指针数组，plhs[0]对应求和结果y的变量地址\nint     nrhs              输入变量个数为2\nconst  mxArray *prhs[]    输入变量的指针数组有两个，prhs[0]为参数a=3对应的地址，prhs[1]为参数b=4对应的地址。\n\n//接下来就是把输入的两个参数读取到C变量里暂存，mxGetPr是获取数组地址，*就是获取地址里的内容。\n//输入接口绑定\nA = *(mxGetPr(prhs[0]));\nB = *(mxGetPr(prhs[1]));\n\n//再下面是输出接口的绑定，输出未分配存储空间，所以必须先申请存储空间，用mxCreateDoubleMatrix，然后用C指针变量指向这个地址。\n//输出接口绑定\nplhs[0] = mxCreateDoubleMatrix(1, 1, mxREAL); \nY = mxGetPr(plhs[0]);\n\n//然后就是你要做的操作，调用add，实现加操作\n*Y = add(A, B);\n```\n\n有几点注意事项：\n\n* matlab默认数据类型为double，如果你直接调用的接口数据的话，你的C语言声明的类型必须与之对应，否则Matlab会挂掉。\n* 像我们图像一般都是0-255单字节的灰度或者二值化图，那应该怎么办呢？你要在matlab下将二维数组转化为uint8类型，然后再传给mexFunction接口，同时C语言中，一定要用uint8\\*类型的指针去操作。\n* Matlab中矩阵的排列与C语言中的排列不太一样，这一点也要注意，matlab的存储是按照列来顺序存储，不是C语言中的按照行顺序存储，如图6所示。\n* C的数组起始是0，matlab的话是1，这点一定要注意。\n\n* 交叉编译不好的地方，就是不能进行单步调试，那出了问题，怎么办呢？用mexPrintf函数，与你用C里面的printf一样。\n\n![](/assets/EmbeddedSystem_S4_P6.png)\n\n图6.Matlab矩阵顺序图\n\n这里附上源代码\n\n```\n#include \"mex.h\"\n\ndouble add(double a,double b)\n{\n    return (a+b);\n}\n\nvoid mexFunction ( int nlhs, mxArray *plhs[], int nrhs, const mxArray *prhs[] )\n{\n    double *Y;\n    double A, B;\n\n    A = *(mxGetPr(prhs[0]));\n    B = *(mxGetPr(prhs[1]));\n\n\n    plhs[0] = mxCreateDoubleMatrix(1, 1, mxREAL); \n    Y = mxGetPr(plhs[0]);\n\n    *Y = add(A, B);\n}\n```\n\n#### 3.智能车比赛图像处理\n\n图像处理模块的结构图如图7所示，其中图像处理部分主要是imProc完成，与Matlab的mex接口由imCar完成。\n\n![](/assets/EmbeddedSystem_S1_P2.png)\n\n图7.图像处理模块结构图\n\n整个图像处理模块imProc的内部结构如图8所示，输入信号为图像数据Image\\_Data（用于寻找中线），Speed和寻找到的中线接合起来用于计算方向偏差，之所以要跟速度相关，因为车速快了的话，需要用更远的图像信息去计算方向偏差，加大提前量，近了则用更近的图像数据去计算，最终计算的中线偏差有三个值：\n\n* gDir\\_Near：近距离方向偏差，暂时未使用\n* gDir\\_Mid：中距离方向偏差，主要用于转向PD控制\n* gDir\\_Far：远距离方向偏差，主要用于识别入弯和出弯，提前进行加减速控制\n\n![](/assets/EmbeddedSystem_S4_P7.png)\n\n图8.imProc模块图\n\n整个代码实现了一个基本的寻线处理和计算中线偏差的思路，具体过程如下：\n\n1. 判断有没有出界，如果出界，则不做处理，保持原来的方向偏差不变，否则开始寻找新的中线\n2. 逐行扫，先寻找中间位置，然后向左右寻找左右边界\n3. 根据左右边界计算左右边界的斜率变化，然后递推得到最终的左右边界值\n4. 根据左右边界，计算中线\n5. 将中线做均值滤波\n6. 滤波后的中线，映射到实际的物理坐标上（单位为cm）\n7. 根据速度，计算三个中线偏差值\n\nimProc的几个函数的功能：\n\n* int Graph\\_JudgeOut\\(void\\)：判断是否出界\n* void Graph\\_FindMidLine\\(void\\)：寻找中线\n* void Graph\\_AverageMBound\\(void\\)：均值滤波函数\n* void Graph\\_Cam2Real\\_BoundM\\(void\\)：将中线映射到真是物理坐标\n* int Graph\\_Real2Cam\\(int D\\)：将真实距离映射到图像位置\n* int Graph\\_Cam2Real\\(int H\\)：将图像位置映射到真实距离\n\n* void Graph\\_Calculate\\_Dir\\(int Speed\\)：计算方向偏差\n\n图像处理好之后，下一步就是实现Matlab结合C编程的接口imCar，代码如下，\n\n```\n#include \"mex.h\"\n#include \"imProc.h\"\n#include \"imType.h\"\n\nimUINT8  Image_Data[CAMERA_H][CAMERA_W];\nextern imUINT8  Image_DataF[CAMERA_H][CAMERA_W];\nextern imINT32  gDir_Near;\nextern imINT32  gDir_Mid;\nextern imINT32  gDir_Far;\nextern imINT16  HBoundL[CAMERA_H];\nextern imINT16  HBoundR[CAMERA_H];\nextern imINT16  HBoundM[CAMERA_H];\nextern imINT16  HBoundM_F[CAMERA_H];\nextern imINT16  HBoundM_REAL[CAM_MAX_LENGTH_CM+1];\n\n\nvoid mexFunction ( int nlhs, mxArray *plhs[], int nrhs, const mxArray *prhs[] )\n{\n    imUINT8 *imIn;\n    imUINT8 *imOut;\n    int H,W;\n    imINT16 *bound;\n    imINT32 *dir;\n    imINT32 CarSpeed;\n\n    imIn=mxGetPr(prhs[0]);\n    for(H=0;H<CAMERA_H;H++)\n    {    \n        for(W=0;W<CAMERA_W;W++)\n        {\n        Image_Data[H][W]=imIn[H*CAMERA_W+W];\n            //mexPrintf(\"%d \",Image_Data[H][W]);\n        }\n    }\n    CarSpeed = *mxGetPr(prhs[1]);\n    ControlParam_Init();\n    Graph_FindMidLine();\n    Graph_Calculate_Dir(CarSpeed);\n    plhs[0]=mxCreateNumericMatrix(CAMERA_H,1,mxINT16_CLASS,mxREAL);\n    plhs[1]=mxCreateNumericMatrix(CAMERA_H,1,mxINT16_CLASS,mxREAL);\n    plhs[2]=mxCreateNumericMatrix(CAMERA_H,1,mxINT16_CLASS,mxREAL);\n    plhs[3]=mxCreateNumericMatrix(3,1,mxINT32_CLASS,mxREAL);\n    plhs[4]=mxCreateNumericMatrix(CAMERA_W,CAMERA_H,mxUINT8_CLASS,mxREAL);\n    plhs[5]=mxCreateNumericMatrix(CAMERA_H,1,mxINT16_CLASS,mxREAL);\n    plhs[6]=mxCreateNumericMatrix(CAM_MAX_LENGTH_CM+1,1,mxINT16_CLASS,mxREAL);\n\n    bound=mxGetPr(plhs[0]);\n    for(H=0;H<CAMERA_H;H++)\n    {    \n        bound[H]=HBoundL[H];\n    }\n    bound=mxGetPr(plhs[1]);\n    for(H=0;H<CAMERA_H;H++)\n    {    \n        bound[H]=HBoundR[H];\n    }\n    bound=mxGetPr(plhs[2]);\n    for(H=0;H<CAMERA_H;H++)\n    {    \n        bound[H]=HBoundM_F[H];\n    }\n    dir=mxGetPr(plhs[3]);\n    dir[0]=gDir_Near;\n    dir[1]=gDir_Mid;\n    dir[2]=gDir_Far;\n    imOut=mxGetPr(plhs[4]);\n    for(H=0;H<CAMERA_H;H++)\n    {\n       for(W=0;W<CAMERA_W;W++)\n       {\n           imOut[H*CAMERA_W+W]=Image_Data[H][W];\n       }\n    }\n\n    bound=mxGetPr(plhs[5]);\n    for(H=0;H<CAMERA_H;H++)\n    {    \n        bound[H]=HBoundM_F[H];\n    }\n    bound=mxGetPr(plhs[6]);\n    for(H=0;H<CAM_MAX_LENGTH_CM;H++)\n    {    \n        bound[H]=HBoundM_REAL[H];\n    }\n}\n```\n\nmatlab代码调用接口函数的代码如下：\n\n```\nclc;\nclear mex\nmex -I\"../ControlLib/Inc\" ...,\n    imCar.c ...,\n    imProc.c ...,\n    imCom.c ...,\n    ../ControlLib/ControlParam.c\nCarSpeed=200;%单位为cm/s\nCAMERA_W=160;\nCAMERA_H=120;\nfor i=1:127\n    try\n        imfilename=strcat('.\\Image_txt\\Imag',int2str(i),'.txt');%输入图片\n        svfilename=strcat('.\\Image_txt\\solve\\Imag',int2str(i),'.bmp');%输出图片\n        %img=uint8(not(imread(imfilename))*255)';%加载BMP格式图片\n        img=uint8(load(imfilename))';      %加载txt文本格式图片\n        [W H]=size(img);\n        if W ~=CAMERA_W && H~= CAMERA_H\n            continue\n        end\n        [L R M  dir imOut M_F M_Real]=imCar(img,CarSpeed);\n        imshow(imOut) \n        hold on\n        plot(1:1:CAMERA_H,[L R M],'-r')\n        saveas(gcf,svfilename)\n        close all\n        clear mex\n    catch e\n        e\n        continue\n    end\nend\n```\n\nimCar一共返回7个变量，分别代表的含义是：\n\n* L：左边界\n* M：中线\n* R：右边界\n* dir：\\[gDir\\_Near gDir\\_Mid  gDir\\_Far\\]\n* imOut:输入图像重新返回\n* M\\_F：中线滤波后的结果\n* M\\_Real：中线滤波后，映射到实际距离\n\n这里要说一下，由于imProc用到了ControParam模块的配置参数，来实现方向偏差的计算，所以mex的命令如下：\n\n```\nmex -I\"../ControlLib/Inc\" ...,%包含ControlParam.h\n    imCar.c ...,\n    imProc.c ...,\n    imCom.c ...,\n    ../ControlLib/ControlParam.c%编译ControlParam.c文件\n```\n\n将matlab的工作目录设置为Graphic，然后运行Compile.m，默认选择的是txt文本图像（Image\\_txt文件夹），1分钟之后，127张图像就全部处理结束啦（在Image\\_txt下的solve文件下），速度是不是很快呀，哈哈哈，如图10所示。然后你就可以针对不同的路况，去优化算法，立刻就可以在Matlab上验证，知道所有的路况全部验证通过之后，再把代码烧到单片机里，进行真实赛道测试。\n\n， ![](/assets/EmbeddedSystem_S4_P10.png)、\n\n图10.处理结果\n\n这里要提一下，Graphic下目前有两个保存图像的文件夹，分别为Image\\__txt_和Image\\_bmp\\_，\\_Image\\_Txt是我们用串口再赛道上每隔10cm采集的部分图像，Image\\_bmp是山外自带的bmp格式图像。大家可以根据自己情况自由选择图片格式。\n\n如果要处理Image\\_bmp文件夹下的图像请将compile文件修改为如下：\n\n```\nclc;\nclear mex\nmex -I\"../ControlLib/Inc\" ...,\n    imCar.c ...,\n    imProc.c ...,\n    imCom.c ...,\n    ../ControlLib/ControlParam.c\nCarSpeed=200;%单位为cm/s\nCAMERA_W=160;\nCAMERA_H=120;\nfor i=1:1000\n    try\n        imfilename=strcat('.\\Image_bmp\\fire',int2str(i),'.bmp');%输入图片\n        svfilename=strcat('.\\Image_bmp\\solve\\fire',int2str(i),'.bmp');%输出图片\n        img=uint8(not(imread(imfilename))*255)';%加载BMP格式图片\n        %img=uint8(load(imfilename))';      %加载txt文本格式图片\n        [W H]=size(img);\n        if W ~=CAMERA_W && H~= CAMERA_H\n            continue\n        end\n        [L R M  dir imOut M_F M_Real]=imCar(img,CarSpeed);\n        imshow(imOut) \n        hold on\n        plot(1:1:CAMERA_H,[L R M],'-r')\n        saveas(gcf,svfilename)\n        close all\n        clear mex\n    catch e\n        e\n        continue\n    end\nend\n```\n\n这一小节，中间略掉了很多细节但是行文依然比较长，希望能够帮助到大家。\n\n相关代码已经上传到[Github](https://github.com/chenxiannn/The-Little-Embedded-System)，如果对你有帮助的话，可以点个赞支持一下在下。\n\n"
  },
  {
    "path": "ch5-controller-design.md",
    "content": "#### 1.转速PID控制\n\n关于PID控制器的解释可以看看知乎的这篇回答[https://www.zhihu.com/question/23088613](https://www.zhihu.com/question/23088613)\n\nPID控制器应该怎么设计，各种玩家各种玩法，\n\n* 土鳖玩法：不停地试凑PID参数，改一次，烧一次程序，然后实际测试，跟着感觉走，老铁\n* 折中玩法：先搞到系统模型，然后Simulink搭建仿真环境，在仿真里试凑，试得差不多了，再放到实际环境进行真实测试\n* 高级玩法：硬件在环或者直接MBD设计（基于模型的设计，频域和时域都有不错的玩法）\n\n下面就用智能车的转速PID控制器举例，来跟大家说一下PID到底怎么玩，这里采用的是折中玩法，首先是测得被控对象的模型，被控对象输入控制量是PWM，输出是车速，那系统模型就是一个PWM占空比与到车速之间的关系，如果要推公式的话，那电压电流，转矩，摩擦系数，叽里呱啦一大堆，有没有什么简单易行的方法呢？？废话，当然有呀，我们要得到系统的模型，无非是想知道给这个系统输入什么，它会输出什么反应。我们可以给系统加不同的激励输入，然后测输出反应，根据输入输出反应，就能反推出系统模型呀。\n\n这里我们车的加速和减速性能，所以我们选择加阶跃输入，就是突然给车加一个电压，看车速怎么变化。具体玩法：\n\n1. 做一条长约10-20m的长直赛道，土豪可以再长点\n2. 智能车方向控制要有，保证车沿长直赛道行驶\n3. 代码设定PWM占空比25%，也就是250（不要太大或者太小），固定不变开环控制，不加入任何速度控制\n4. 系统上电，车开始加速行驶，直到速度稳定\n5. 从系统上电开始，每隔一个时间在Log里记录一下当前速度（可以选定10ms间隔）\n6. 全部跑完之后，将Log记录的数据导出到电脑里，matlab开始画图建模\n\n这里就用到了测试Log模块，会在ch6会详细解释。由于轮胎表面处理对摩擦系数影响比较大，建议测试前适当处理，尽量模拟真实赛况下的轮胎。\n\n测试结束后，我们会在Matlab中画出这样一张车速随时间变化，如图1所示，最后凹下去一大坑又飚起来，是因为车走到终点被抓住速度降了，拿起来空转速度又飚起来了。\n\n![](/assets/EmbeddedSystem_S5_P0.png)\n\n图1.车速开环阶跃响应测试图\n\n根据这张阶跃响应测试图，我们就可以用1阶或者2阶模型去做建模，传递函数形式：\n\n![](/assets/EmbeddedSystem_S5_P1.png)\n\n在这里选的二阶模型建模，Wn=1.5rad/s，zeta=1.6，最终拟合出来的系统模型是：\n\n![](/assets/EmbeddedSystem_S5_P2.png)\n\n在Simulink搭建模型，同样加阶跃响应，可以测试得到实测图与仿真模型的对比结果，如图2所示。\n\n![](/assets/EmbeddedSystem_S5_P3.png)\n\n图2.建模测试对比图（蓝色实测，红色建模）\n\n下一步就是搭建PID控制模块，我们直接来上Simulink仿真模型图，如图3所示，PI控制器的控制效果图如图4所示。\n\n* Test Motor B Car Data：实地测试的B车车速数据\n* Model Motor B Car Data：仿真建模的模型阶跃输出\n* PI Control Data：PI控制器的输出\n* Set PWM：测试设定PWM值（量程-1000至1000）\n* Set Speed：设定速度数据（单位为cm/s）\n\n![](/assets/EmbeddedSystem_S5_P4.png)\n\n图3.控制模型图\n\n这里要简单说一下，在反馈回路加了三个部件，一个是Delay环节，因为我们10ms测一次速度，延时一半5ms，RateTransition ZOH是采样率转换，因为前后两级采样率不一致，必须加一个零阶保持器，FIR Filter是均值滤波器，4阶，把车速的高频抖动滤除掉再进控制器。\n\n![](/assets/EmbeddedSystem_S5_P8.png)\n\n图4.PI控制效果图（浅绿色线就是控制效果图，阶跃响应的上升时间从4s降到0.8s左右，效果还可以）\n\n下面重点介绍一下PI Controller，之所以没有加D微分，因为实测速度抖动太厉害，再加微分不抖死呀，目前PI用着就不错。PI的控制模型用的是：\n\n![](/assets/EmbeddedSystem_S5_P5.png)\n\n离散化后的差分方程（采用欧拉前向差分）是：\n\n![](/assets/EmbeddedSystem_S5_P6.png)\n\n对应到Simulink的PI Controller模块设置，下面图5中的几处设置，务必要注意：\n\n* Controller：选择PI\n* Form：选择Parallel，并型模式\n* Time domain:Discrete-time离散时间域，因为我们是要仿真10ms控制一次\n* Integrator method：积分的差分方法，前向欧拉\n* Sample time：采样时间Ts=10ms\n* Proportional\\(P\\)：比例系数=4\n* Integral\\(I\\)：积分系数=2.5\n* Compensator formula：模块公式与我们上面的差分公式一模一样，**Kp=P，Ki=I**\n\n![](/assets/EmbeddedSystem_S5_P7.png)\n\n图5.PI Controller设置\n\n下面我们就看看代码吧：\n\n```\n//EIT_PID.h接口文件\ntypedef struct _PID\n{\n    /*In*/\n    int32   spVal;\n    int32   spValRamp;\n    int32   spUpRate;\n    int32   spDnRate;\n    int32   fbValFilterLast;\n    int32   fbValFilter;\n    int32   fbValFilterDiff;\n    int32   fbVal_k0;\n    int32   fbVal_k1;\n    int32   fbVal_k2;\n    int32   fbVal_k3;\n    /*Out*/\n    int32   outVal;\n    /*Var*/\n    int32   err;\n    int32   P;\n    float   I;\n    int32   D;\n\n    /*Param*/\n    int32   MAX_Val;\n    int32   MIN_Val;\n\n    float   Kp;\n    float   Ki;\n    float   Kd;\n}PID;\ntypedef  PID*   PID_t;\nextern void   PID_InitFbVal(PID_t tPID,int32 fbVal);\nextern void   PID_SetFbVal(PID_t tPID,int32 fbVal);\nextern void   PID_Run_STD(PID_t tPID);\nextern void   PID_Run_PID(PID_t tPID);\n\n\n//EIT_PID.c模块代码文件\nvoid   PID_SetFbVal(PID_t tPID,int32 fbVal)\n{\n        tPID->fbVal_k3 =tPID->fbVal_k2;\n        tPID->fbVal_k2 =tPID->fbVal_k1;\n        tPID->fbVal_k1 =tPID->fbVal_k0;\n        tPID->fbVal_k0 =fbVal;\n        tPID->fbValFilterLast=tPID->fbValFilter;\n        tPID->fbValFilter    =(fbVal+tPID->fbVal_k1+tPID->fbVal_k2+tPID->fbVal_k3)/4;//FIR滤波器\n        tPID->fbValFilterDiff=tPID->fbValFilter-tPID->fbValFilterLast;\n}\n\n//采用只对反馈值进行微分的PID控制器，本文采用的这种方法，将Kd设置为0，去掉微分\nvoid  PID_Run_PID(PID_t tPID)\n{\n    int32 err;\n    //指令加了Ramp平滑处理\n    if(tPID->spVal-tPID->spValRamp > tPID->spUpRate)\n        tPID->spValRamp+= tPID->spUpRate;\n    if(tPID->spVal-tPID->spValRamp < tPID->spDnRate)\n        tPID->spValRamp+= tPID->spDnRate;\n\n    //计算error偏差\n    err=tPID->spValRamp-tPID->fbValFilter;\n    tPID->err = err; \n\n    tPID->P =   (int32)(tPID->Kp*err);//比例计算\n\n    tPID->D =  (int32)(tPID->Kd*tPID->fbValFilterDiff);//微分计算\n\n    tPID->outVal = tPID->P + (int32)(tPID->I)+tPID->D;//控制量计算\n    tPID->outVal = PID_MaxMin(tPID,tPID->outVal);\n\n    tPID->I =   (int32)(tPID->I  +  tPID->Ki*err);    //前向差分计算积分\n    tPID->I =  PID_MaxMinFloat(tPID,tPID->I);  \n}\n//标准PID控制器\nvoid  PID_Run_STD(PID_t tPID)\n{\n    int32 err;\n    if(tPID->spVal-tPID->spValRamp > tPID->spUpRate)\n        tPID->spValRamp+= tPID->spUpRate;\n    if(tPID->spVal-tPID->spValRamp < tPID->spDnRate)\n        tPID->spValRamp+= tPID->spDnRate;\n\n    err=tPID->spValRamp-tPID->fbValFilter;\n    tPID->err = err;\n\n    tPID->P =  (int32)(tPID->Kp*err);\n\n    tPID->D =  (int32)(tPID->Kd*(tPID->fbVal_k0-tPID->fbVal_k1));\n\n    tPID->outVal = (int32)(tPID->P + tPID->I+tPID->D);\n    tPID->outVal = PID_MaxMin(tPID,tPID->outVal);\n\n    tPID->I =  (int32)(tPID->I  +  tPID->Ki*err);\n    tPID->I =  PID_MaxMinFloat(tPID,tPID->I);\n}\n\n\nControlparam设置\n/*B car just one Motor-Right Motor*/    \ngParam.MotorR_PID_KP=4.0;    \ngParam.MotorR_PID_KI=2.5;        \ngParam.MotorR_PID_KD=0.0;          \ngParam.MotorR_PID_Ts=MOTOR_PID_TS; /*Unit: s   */\ngParam.MOtroR_PID_UpRate = 1000;/*指令最大m/s^2*/\ngParam.MOtroR_PID_DnRate = -2000;/*指令最大m/s^2*/\n```\n\n整个速度控制的Simulink模型和C代码已经上传到[github](https://github.com/chenxiannn/SmartCarSpeedControl-PI)。\n\n#### 2.转向PD控制器\n\n没有用什么高大上的算法，就是用最基本的，好使够用。之前在ch4节中，我们通过对赛道图像处理得到了3个gDir的偏差值，分别为gDir\\_Near，\\_gDir\\_Mid和gDir\\_Far，大概含义如图6所示。分别选择不同远近区域的中线偏差做平均得到。\n\n* gDir\\_Far：用于识别入弯和出弯，因为Far距离远，可以入弯提前减速\n* gDir\\_Mid：用于方向PD跟踪控制\n* gDir\\_Near：暂时未使用\n\n![](/assets/EmbeddedSystem_S5_P9.png)\n\n图6.三个gDir的计算区域\n\n整体控制，就将所有赛道路况就分为2种，一种就是直道，另一种就是弯道，根据gDir\\_Far以及它的变化率进行识别，具体代码如下：\n\n```\n//gDir的滤波处理，这个必须做，因为图像识别算法没处理好的话，很容易出现突变，再一微分，那分分钟搞死\nvoid gDir_Filter(void)\n{\n   static int MidDir[5];\n   static int FarDir[15];\n   //gDir_Mid滤波\n   MidDir[4]=MidDir[3];\n   MidDir[3]=MidDir[2];\n   MidDir[2]=MidDir[1];\n   MidDir[1]=MidDir[0];\n   MidDir[0]=gDir_Mid;\n\n   gDir_MidFilterLast=gDir_MidFilter;\n   gDir_MidFilter=(MidDir[0]+MidDir[1]+MidDir[2]+MidDir[3]+MidDir[4])/5;\n   gDir_MidFilterDiff=gDir_MidFilter-gDir_MidFilterLast;\n\n   //gDir_Far滤波\n   FarDir[9]=FarDir[8];\n   FarDir[8]=FarDir[7];\n   FarDir[7]=FarDir[6];\n   FarDir[6]=FarDir[5];\n   FarDir[5]=FarDir[4];\n   FarDir[4]=FarDir[3];\n   FarDir[3]=FarDir[2];\n   FarDir[2]=FarDir[1];\n   FarDir[1]=FarDir[0];\n   FarDir[0]=gDir_Far;\n\n   //普通滤波5次加权\n   gDir_FarFilterLast=gDir_FarFilter;\n   gDir_FarFilter=(FarDir[0]+FarDir[1]+FarDir[2]+FarDir[3]+FarDir[4])/5;\n   gDir_FarFilterDiff=gDir_FarFilter-gDir_FarFilterLast;\n\n   //慢速滤波5次加权，更慢也更平滑\n   gDir_FarFilterSlowLast=gDir_FarFilterSlow;\n   gDir_FarFilterSlow=gDir_FarFilter/2+(FarDir[9]+FarDir[8]+FarDir[7]+FarDir[6]+FarDir[5])/10;\n   gDir_FarFilterSlowDiff=gDir_FarFilterSlow-gDir_FarFilterSlowLast;\n\n   //入弯和出弯识别\n   switch(gVar.InAngle)\n   {\n       case 0:\n          //长直道，如果gDir_far大于某正阀值，并且还在增加，那就是右入弯\n          if(gDir_FarFilterDiff>0 && gDir_FarFilter>gParam.InAngle_FarDir )\n             gVar.InAngle=1;\n\n          //长直道，如果gDir_far小于某负阀值，并且还在减小，那就是左入弯\n          if(gDir_FarFilterDiff<0 && gDir_FarFilter<-gParam.InAngle_FarDir)\n             gVar.InAngle=1;\n          if(gVar.InAngle == 1)\n             MotorR_PID.I = MotorR_PID.I/3;\n       break;\n       case 1:\n           //出弯，可以根据入弯类推\n          if(gDir_FarFilterDiff<0 && gDir_FarFilter<gParam.OutAngle_FarDir && gDir_FarFilter>0)\n             gVar.InAngle=0;\n          if(gDir_FarFilterDiff>0 && gDir_FarFilter>-gParam.OutAngle_FarDir && gDir_FarFilter<0)\n             gVar.InAngle=0;\n          if(gVar.InAngle == 0)\n             MotorR_PID.I = MotorR_PID.I*3;\n     break;\n   }\n\n}\n```\n\n根据gDir\\_Far识别出直道和弯道的标志位InAngle，然后根据这个标志来确定车速和方向PD控制参数：\n\n* 车速指令：直道一个速度，弯道一个速度，就两个速度设置参数，简单直接有效\n* 转向控制：直道一套PD控制参数，弯道一套PD控制参数，一样简单直接\n\n首先我们看车速指令代码，就两个参数设置gParam.MinSpeed和gParam.MaxSpeed：\n\n```\nvoid GetSetPointMaxSpeed(void)\n{\n    int MidSpeed;\n\n    if( gVar.InAngle)\n    {\n        MidSpeed = gParam.MinSpeed;//是不是太简单直接了\n    }\n    else\n    {\n        MidSpeed =gParam.MaxSpeed;\n\n    }\n    spSpeedL = CarSpeed2LSpeed(MidSpeed,angle);//考虑到转弯半径问题，左右轮速度和车速必须折算一下\n    spSpeedR = CarSpeed2RSpeed(MidSpeed,angle);\n\n    //MotorLPID_SetSpeed(spSpeedL);\n    MotorRPID_SetSpeed(spSpeedR);\n}\n```\n\n然后我们转向控制代码，死区控制必须加，否则长直道容易抖，具体大小要实验测试，直道和弯道两套控制参数很有必要，弯道Kp大点更有助于转弯，直道Kp小点，行驶会更平滑：\n\n```\nvoid SteerDirControl(void)\n{   \n    int MidDir;\n\n    MidDir=gDir_Mid;\n    //必须加入死区，大大减少直道抖动\n    if(int_abs(MidDir)>=gParam.DIR_Dead)\n    {\n        if(MidDir>0)\n           MidDir-=gParam.DIR_Dead;\n        else\n           MidDir+=gParam.DIR_Dead;\n    }\n    else\n    {\n        MidDir=0;\n    }\n    //直道和弯道两套控制参数，其中微分参数一致，比例参数是两个参数设置值\n    if(gVar.InAngle)\n       angle =(int32)((float)(MidDir)*gParam.DIR_KpInAngle+ (float)(gDir_MidFilterDiff)*gParam.DIR_Kd);\n    else\n       angle =(int32)((float)(MidDir)*gParam.DIR_Kp+ (float)(gDir_MidFilterDiff)*gParam.DIR_Kd);\n\n    //角度限幅操作，防止舵机转角过大，转弯卡死\n    if (angle >gParam.AngleMax)\n       angle =gParam.AngleMax;\n    else if (angle <-gParam.AngleMax)\n       angle =-gParam.AngleMax;\n\n    //角度变化率限幅操作，指令必须能够有效执行，不能乱下指令\n    angle=int_delta_Limit(angle,angleLast, gParam.AngleDeltaMax);\n    angleLast=angle;\n\n    //输出给舵机\n    Steer_Run(gParam.SteerMid,angle*gParam.SteerDeltaMax/gParam.AngleMax);//新车需要加负号\n}\n```\n\n整体的控制思路如图7所示，没有什么过于复杂的地方，都是简单不能再简单的最小系统实现，基本的PID控制配合滤波器，简单的找中线处理，配合上Matlab/Simulink后，工作效率会大大提高。\n\n![](/assets/EmbeddedSystem_S5_P10.png)图7.整体控制思路图\n\n"
  },
  {
    "path": "ch6-system-test-and-analysis.md",
    "content": "国内的技术环境，重开发，轻测试，其实吧，两者都重要，而且我个人是不认同将开发与测试解耦开来，全周期交付最终的产品是所有工程师的职责，不是开发好代码就结束了，测试用例只有最懂这个系统的人设计才最好的，所以开发测试本就是一家。\n\n下面聊聊，嵌入式中的测试，这个跟软件系统最大的不同，就是需要软硬件协同，比如马达控制器，比如锂电池均衡，等等，尤其是涉及到闭环控制的场合，必须要保证测试占用的CPU资源不能影响正常的控制任务执行周期，也就是说，测试消耗的系统资源越少越好。好的测试手段，能够帮助提高整个系统的开发效率。\n\n下面就介绍目前我用到比较便利的三种嵌入式辅助软件测试手段：\n\n* IO测试：直接用IO口表示状态，需要用到示波器观察IO电平变化，测试非常快，但是不足就是信息量有限\n* 内存缓冲：内存中开二维数组用于存放测试数据，每个控制周期将测试变量保存到数组，测试结束后串口输出，不足就是受内存限制\n* 串口打印：串口实时printf打印输出测试数据，测试速度会受串口速度限制，速度虽然慢一些，但是可以记录大量信息，数据量不受限制\n\n#### 1.IO测试\n\n比如ch3中，我们要估算每个Task的时间长度，用来去平衡调度周期优化，那就可以用这种IO测试方法来玩，简单直接，不妨来看。\n\n假设我们测Task0的执行时间，首先选一个备用IO口比如PORTA0，在测试前务必将IO口输出模式配置好，然后只要在Task0调用前，将PORTA0拉高，结束后，再将PORTA0拉低，然后上电后，将示波器探头测试PORTA0这个口，查看示波器的波形图，其中高电平的持续时间，就是Task0的执行时间，这个信号的周期时间，就是我们While循环的调度周期。\n\n这种IO测试方法需要示波器配合，简单有效，而且IO翻转的时间一般与主频一致，都在10-100ns级别，对于一些简单的要求精确测量时间的场合，这个妥妥地够用了。\n\n示例代码如下：\n\n```\nint main()\n{\n    Dis_Interrupt();\n    System_Init();\n    En_Interrupt();\n\n    while(1)\n    {\n        //IO测试辅助代码\n        PORTA0=1;//先把IO拉高\n        Task0_Run();\n        PORTA0=0;//任务结束后再把IO拉低\n        Task1_Run();\n        Task2_Run();\n        Task3_Run();\n        Task4_Run();\n    }\n}\n\nvoid Task0_Run(void)\n{\n    Pot1Calc(); //加速器信号计算\n    Pot2Calc(); //制动器信号计算（保留）\n    TempCalc(); //电机及控制器温度计算\n}\n.....\n```\n\n#### 2.内存缓冲\n\nIO测试可以做简单快速的时间测量，然而我们软件逻辑中，存在大量的控制变量，系统一旦出现问题，我们需要排查整个控制链条上哪个环节的控制变量逻辑或者计算出问题了，这个时候IO测试就玩不转了，因为涉及到软件变量实时记录，尤其是在做电机等闭环控制的场合，还要求测试不能影响正常的闭环控制，也就是说，测试代码最好不要占用CPU时间。其实如果玩MBD-基于模型的设计，也是想把大部分控制上的逻辑或者计算错误直接消灭掉设计阶段。下面就简单介绍这个测试手段的玩法，因为智能车里面的主要测试手段就是这个玩法。\n\n首先我们开辟一个二维数组DataLog，数组的大小要考虑到内存大小（这种方法适合内存比较大的场合），需要记录数据的时候，执行一下DataLog\\_Add函数即可，在DataLog\\_Add里我们添加好需要记录的变量个数和具体变量，DataLog\\_Add的执行时间可以控制到1us左右，等所有二维数组数据填满了之后，我们就可以通过调用DataLog\\_Print把测试的所有数据串口输出出来。\n\n```\n#include  \"EIT_Log.h\"             //header用户应用程序\n\nstatic int32 DataLog[LOG_COUNT][LOG_NUM_EACH];\nstatic volatile int32 cnt=0;\nvoid DataLog_Init(void)\n{\n   cnt=0;\n}\n//记录单条测试数据\nvoid DataLog_Add(void)\n{\n   if(cnt>=LOG_COUNT)\n     return;\n   else\n   {\n       DataLog[cnt][0]=MotorR_PID.fbValFilter;\n       DataLog[cnt][1]=MotorR_PID.spVal;\n       DataLog[cnt][2]=MotorR_PID.spValRamp;\n       DataLog[cnt][3]=MotorR_PID.I;\n       DataLog[cnt][4]=MotorR_PID.outVal;\n       DataLog[cnt][5]=gVar.InAngle*100;\n       DataLog[cnt][6]=gDir_FarFilter;\n       DataLog[cnt][7]=gDir_MidFilter;\n       DataLog[cnt][8]=angle;\n       cnt++;\n   }\n}\n//技术后，串口打印输出\nvoid DataLog_Print(void)\n{\n    int i,j;\n\n    for(i=0;i<LOG_COUNT;i++)\n    {\n        for(j=0;j<LOG_NUM_EACH;j++)\n            printf(\"%d \",DataLog[i][j]);\n        printf(\"\\n\");\n    }\n}\n```\n\n串口输出数据格式的时候要注意一点，最好是一行代表一条数据记录，用空格隔开，像下面这样的格式，好处是什么呢，就是这样的数据直接保存为txt，matlab一拖动就可以成为二维数组，直接就可以plot画图看测试效果了，比如图1所示，整个加减速过程，都可以进行分析。\n\n```\n309 180 5 5 5 1\n311 178 5 5 5 1\n313 181 5 5 4 1\n315 177 4 4 4 1\n317 185 4 4 4 1\n319 184 4 4 4 1\n321 186 4 4 4 1\n323 176 3 4 3 1\n325 181 3 3 3 0\n327 185 4 3 3 0\n329 183 4 4 4 1\n331 186 4 5 4 1\n333 176 4 4 4 1\n335 187 3 3 3 0\n337 188 3 3 2 0\n339 193 4 3 4 0\n341 199 3 3 3 0\n343 178 2 1 2 0\n```\n\n![](/assets/EmbeddedSystem_S5_P11.png)\n\n图1.测试数据Matlab图\n\n#### 3.串口打印\n\n有时候，我们的单片机内存有限，又想分析控制变量，那怎么办，能有啥办法，实时串口打印呗。不过这里要注意，有的串口支持DMA方式，也就是说串口传输不占用CPU资源，这方式比较爽。对于没有DMA方式单片机，只能使用Printf同步打印数据，这里要注意，printf是阻塞的，也就是说在打印数据的时候，CPU啥事都不能干，所以在使用这种玩法的时候，一定要预估一下打印数据占用CPU资源的比例，不要搞得重要任务卡死，一直在打印数据就好。测试的时候，大家尽量是串口波特率设高点。\n\n这种玩法和第二种缓冲的玩法，后面数据处理其实差不多，唯一不足就是串口打印数据会占用CPU资源，这里务必要权衡好。我得建议是，想简单直接一点，就直接将标准C库的printf函数重定向到对应的串口就可以，然后直接调用printf实时打印测试数据，其实也挺简单的。\n\n```\n/*!Vcan山外的代码MK60_conf.c\n *  @brief      重定义printf 到串口\n *  @param      ch      需要打印的字节\n *  @param      stream  数据流\n *  @since      v5.0\n *  @note       此函数由编译器自带库里的printf所调用\n */\nint fputc(int ch, FILE *stream)\n{\n    uart_putchar(VCAN_PORT, (char)ch);\n    return(ch);\n}\n```\n\n这三种嵌入式辅助测试手段，足够应付山寨还是正规的大部分测试和故障分析玩法了。\n\n"
  }
]