【《智能汽车车模控制系统设计》9700字】

智能汽车车模控制系统设计目录TOC\o"1-3"\h\u29344智能汽车车模控制系统设计 I288791绪论 I108141.1引言 II116301.2国内外智能汽车的发展状况 II294662智能汽车整体架构设计 IV233752.1车模机械系统的组成 IV169492.2车模底盘及转向机构调校 VI34292.3各电路模块的安装 VII207053硬件电路设计 IX269383.1硬件电路整体架构 IX168883.2图像采集模块 IX132663.3主控模块 X14663.4电机驱动模块 XI16783.5电源管理模块 XII65574软件系统设计 XIV297614.1软件系统设计方案 XIV275384.2车模行驶信号获取与处理 XV265814.3车模行驶状态控制 XX93634.4程序流程图 XXIII44055系统调试与运行 XXV318565.1IAREmbeddedWorkbenchIDE调试软件 XXV67335.2COMS摄像头上位机 XXV23586结论 XXVII1绪论1.1引言随着高新技术的不断发展和我国科研技术的显著提升，在21世纪的今天，尖端技术的发展日新月异，其中无人驾驶技术由人们眼中可望而不可即逐步转变为普及寻常百姓家，现在的普通家用轿车大多数都配备了L2级智能辅助驾驶系统，而这一变化只用了短短四年。科技力量已经成为评价一个国家综合国力的重要指标，由此，中央十四五规划纲要提出，要重点提高科研建设投入，解决一系列“卡脖子”的高精尖技术，使尖端技术真正的掌握在中国人手里。1.2国内外智能汽车的发展状况1.2.1国外智能汽车的发展状况国外的智能汽车研究要早于我国数十年，其发展历史可以分为三个阶段：第一阶段：20世纪50年代初世界上的第一台AGVS车辆系统在美国BarrettElectronics公司研制成功，起初该系统只是用在超市送货的遥控车上，后来经过设计改良，在各类加工厂的流水线上有了他的身影。毋庸置疑，它的出现为汽车零部件的制造、后期设备的装配立下了汗马功劳，它的出现标志着世界智能汽车控制系统的研究正式开始。第二阶段：1980年，智能汽车控制系统的研究已经在全球各地初见成效，从开始时的一国主导发展到现在的多国并驾齐驱的局势。在以英、法、德牵头的欧盟国家也相继启动了智能汽车控制系统的研发；在亚洲，公路辅助驾驶研究会在日本成立。第三阶段：在进入二十一世纪后，世界各国的智能汽车控制系统均取得了很多成果，其中以美国特斯拉公司为代表生产的电动汽车使用的智能汽车控制技术尤为突出。1.2.2国内智能汽车的发展状况我国的智能汽车控制系统研发较国外相比起步较晚，但近年来政府大力支持，科技人才的引进，使这种差距在逐渐缩小，国产汽车中如小鹏、蔚来、吉利等厂家都取得了较多的成果。随着我国自主研发的火星探测器“祝融”成功着陆、中国空间站的搭建，运用在智能汽车控制上的技术在各个领域也得到了充分的普及和应用，我国的控制技术已走在世界前列。

2智能汽车整体架构设计2.1车模机械系统的组成智能车机械系统包含了车模底盘、驱动机构、转向机构、以及电路模块四个部分。车模机械系统如图2.1所示。图2.1车模机械系统车模底盘是构成整个车模的基础，其材料由玻璃纤维构成。底盘上搭载着各个模块及零件，是整个车模最为重要的部件之一，底盘的质量直接影响着车模的质量。底盘上承载了车模的驱动机构，C车模采用后轮驱动的形式，驱动电机和传动机构以及驱动轮通过机械连接的方式固定在底盘上。底盘前部承载着车模的转向机构，通过机械连接固定在底盘上。同时底盘起着支撑整个车体的作用，是整个车模系统的主要承力机构,各电路模块均安装在底盘之上。C车模底盘结构如图2.2所示。图2.2C车模底盘结构驱动机构由一组RS380电机以及驱动齿轮构成，C车模采用后轮两驱设计，大功率电机能更好的使车辆在过弯时有更好的差速性能。驱动电机参数如图2.3所示。额定电压：7.2V空载电流<630mA最大功率>20W空载转速15000±3000rpm图2.3驱动电机参数转向机构包含了轮鞘、转向杯、轴承几个部分。转向机构安装在底盘的前部，驱动前轮运动，并控制车模的运动方向。其安装角度很有讲究，科学的安装角度直接影响着小车拐弯时的流畅性和车模整体的运行效率。机械上的问题往往都出现在转向机构上，这部分也是车模最脆弱的一部分。电路模块主要包括了OV7725摄像头采集电路模块、MK60主控模块、电机驱动模块以及电源管理模块四个部分。摄像头是整个车模获取赛道信息的唯一器件，摄像头的性能一定程度上决定了车模运行的稳定性，好的摄像头能够获取更加准确的信息，使得车模精准的运行。主控模块是整个车辆的核心控制，MCU通过处理摄像头采集的数据来调节PWM，进而控制电机驱动以及舵机转向。电机驱动模块采用经典的H桥电路控制后轮转速。电源管理模块通过LDO线性稳压器将锂电池的电源进行分配，供给各电路模块使用。2.2车模底盘及转向机构调校我们选用博斯威龙公司生产的C车模作为本次设计车模，为了更好的提高智能汽车在赛道的通过性以及稳定性，我们通过调节前叉臂的高度来降低车身高度，使其在过弯时有更稳定的车身姿态。舵机的安装方式和安装位置直接关系到舵机在接到动作指令后能否可以迅速灵敏地控制前轮打角转向，若舵机的调整没有到位或者安装有问题，将会在很大程度上限制其转向的角度以及转向反馈响应的速度。舵机的安装形式大体分为两种，一种采用卧式的安装方法，将舵机横放在底盘上，通过舵机输出轴驱动转向机构。但是卧式安装舵机的高度过低，需要增加一个机械连杆，这样稳定性会有所下降。而且舵机卧式安装的话，由于舵机宽度较大，会比较占空间，并且不好固定。另一种采用立式安装，将舵机站立着安装在底盘上。这种安装方式方便固定，舵机输出轴的转动方向和转向机构的运动方向在同一轴线上，这样减少了传动机构，增大了前轮转向的力矩。转向会更加灵敏，所以我们采用立式安装。安装转向器后，为了使车型运行更加平稳，有必要对车型前轮进行调整。为实现智能车辆在轨道上保持有效的线加速度，转弯时的行驶稳定性，转向机构响应的及时性，减少轮胎和零件、前轮的磨损，智能车的转向节和前桥横拉杆需要与模型车底盘安装固定在一定的相对位置，这种安装方式具有一定相对位置的特点。我们称为前轮定位。前轮定位的内容主要包括：前轮前束、虚拟调整、前轮外倾角、主销内倾角以及主销后倾角。舵机安装方式如图2.4所示。图2.4舵机安装方式2.3各电路模块的安装2.3.1摄像头的安装该车模所安装的摄像头采用的是龙邱科技公司二次开发生产的OV7725型彩色摄像头，该摄像头拥有30W像素并且具有硬件二值化功能，最高支持150HZ的帧频率，可以提供稳定的画面。为了保证摄像头拥有足够的视野，我们将摄像头在符合比赛要求的前提下尽可能的调高，这样就可以保证以一定的角度俯视地面，一定程度上可以解决反光的影响。小车运行过程中会产生明显的震动，会引起摄像头的震动，摄像头一震动小车图像也会跟着震动，小车也会更加剧烈的震动，如此就会形成正反馈，造成不好的后果。因此需要减轻摄像头的震动，所以摄像头的安装支架采用三角形结构，大大增强了稳定性。2.3.2编码器的安装为了实现智能车的闭环控制，我们选用编码器来实时采集后轮转速，再由单片机进行调节，本车模采用的磁电式编码器，型号为龙邱科技公司生产1024线mini编码器。由于编码器为磁电式编码器，所以在安装使用时需要尽可能的远离电机，防止磁场对编码器产生干扰。该款编码器具有强大的兼容性，可以直接输出方向和脉冲并且同时兼容正交解码。编码器安装如图2.5所示。图2.5编码器安装2.3.3锂电池的安装我们选用锂离子电池代替普通镍铬电池，并将电池安装在了车模的中前部，并用扎带固定好。其目的是既能提高车模在高速行驶时的稳定性，又能增强前轮对地面的压力。在增强转向能力和减轻车身重量之间做出平衡，电池和车模底盘之间的缝隙要尽可能的小，以降低车模的整体重心，同时需要注意在调试过程中，车速过快时需要及时调整电池位置，否则容易出现甩尾现象，在这里，电池既充当能源供给又扮演着配重的角色。

3硬件电路设计3.1硬件电路整体架构硬件电路包含了采集模块、主控模块、驱动模块和电源管理四个模块。硬件电路架构如图3.1所示图3.1硬件电路架构图3.2图像采集模块由于COMS制作工艺较为复杂，摄像头数据采集模块我们直接选用龙邱科技公司研发生产的OV7725摄像头组模块采集赛道图像，该模块集成了基础的COMS以及图像二值化电路，可以进一步减轻MCU的数据处理压力，提高程序执行速度。摄像头接口和单片机之间以并口的方式传送数据，为了尽可能的加快数据传输速率，我们将图像数据设置为单片机的直接存储器访问接口传输。图像采集模块电路如图3.2所示。图3.2图像采集模块电路3.3主控模块主控模块由恩智浦公司生产的Cortex-M4为内核的MK60DN512ZVLQ10控制芯片及外围电路构成，该芯片带DSP的高达100MHzARMCortex-M4核，最多128KBRAM，32kHz晶体振荡器，能更迅速的处理所需信息。主控模块如图3.3所示。图3.3主控模块电路3.4电机驱动模块本次我们选用博斯威龙公司生产的C车模附带的380电机为动力电机，该电机具有功率较大、工作电流强，工作电压最低值为12V的特征，由于直接使用电池并不能正常的驱动电机，而且还容易损坏电池，为此，我们选用了经典的电机驱动电路——H桥电路，使用该电路可以由MCU产生的PWM来控制MOSFET的导通和关断，选取MC34063做升压电路，将电源电压升至12V，选用IRLR7843MOS芯片作为MOSFET的驱动芯片。为了防止电机驱动电路对单片机造成干扰，在驱动电路的输入级接入了逻辑门电路74LVC245进行隔离。电机驱动模块电路如图3.4所示。图3.4电机驱动模块因为C车有两个驱动轮，所以我们使用八个MOS管构成两组H桥式电路驱动电机。桥式电路分为双极性和单极性，其中双极性电机驱动电路输出的电流中有较多的交流成分，在电机激烈运转的过程中，交流电的混入很容易使电机发热并且容易使电机消磁。所以我们最后设计了直流电动机可逆单极型桥式驱动器，其功率元件由大功率N沟道场效应管构成，额定工作电流可以很轻松的突破50A，极大地保证了380电机在大电流以及瞬时逆转的情况下能可靠工作。电机驱动PCB板如图3.5所示。图3.5电机驱动模块PCB板3.5电源管理模块由于整个智能车系统各个外接设备的额定电压不同，而电源供给只有7.2V一种，这就需要我们利用LDO来将电源合理升/降压来供给各个模块，其中主要电路为7.2V转3.3V,7.2V转5V以及7.2V转6V。其中3.3V主要给MCU、OLED、拨码开关供电，5V主要给OV7725摄像头模块、编码器模块、蜂鸣器供电；6V专为舵机供电。由于整个电路系统中5V使用最多，电路功耗最大，电流峰值可达2A,为了降低电源纹波干扰，我们选用现在市场普遍的电路方案——线性稳压电路，分别选用TPS7333、TPS7350以及AMS1117系列作为稳压芯片。TPS-7333是德州仪器公司生产的超低压差LDO。该芯片属于TPS-73xx系列。最后两个序列号XX表示芯片的输出电压值。例如，TPS-7333表示固定输出3.3V，TPS-7350表示固定输出5V，该系列还具有可调输出电压版本，后缀为01，采用电阻调压，可按转向器要求调出6V使用。图3.6是TPS7350的最小系统原理图。图3.6TPS7350的最小系统原理图

4软件系统设计4.1软件系统设计方案一套结构清晰简洁的算法程序是智能车平稳的高速行驶，快速低容错寻线的基础。基于mk60的智能小车自动控制系统是我们自行设计开发的，它依靠CMOS摄像头采集并准确识别轨道上的各种元素。因此，图像采集、二值化后处理和图像畸变校正成为整个软件算法的核心内容。我们充分利用一种具有良好鲁棒性的经典PID控制算法来控制智能车辆的转向和速度。通过理论计算和实际参数补偿的方法，使智能车能够稳定、快速地完成比赛。软件系统结构如图4.1所示：图4.1软件系统结构图像获取与处理包含了图像的采集、图像的处理以及图像偏差提取三个部分。赛道元素的采集是将OV7725采集的每一帧图像通过调整合适的阈值将灰度图像转为二值化的黑白图像，图像由此变为0—255个数值，将其采集到内存中，并转化为坐标的形式。经过二值化的图像在编写的图像处理程序中将采集到的图像保存在一个二维数组中，这样就可以将图像问题转换成数学问题进行处理。图像的处理主要是通过赛道边线的提取来进行赛道中线的计算与补线的，赛道元素的识别，赛道弯曲程度的计算。图像处理算法是整个软件系统的核心。偏差提取是根据图像处理的结果提取车模对应于赛道的偏差，智能车根据计算得到偏差要及时调整舵机，使其能够以最理想的路径行驶。车模控制主要包含有车模的高速运动速度控制和前轮转向控制两大部分。速度自动化控制系统是利用自动控制理论最经典的PID算法实现控制，智能车根据路况通过调整MCU输出的PWM波占空比来随时调整速度，即在直道加速以获取最短通过时间；在弯道匹配后轮差速，在不冲出赛道的前提下快速通过。前轮转向控制是根据图像处理的结果提取智能车的行驶偏差，目标中线与实际中线对比，控制智能车在赛道上根据赛道的曲率进行转向，并且保证智能车转向与速度匹配，使其运行流畅，无剧烈抖动或反应迟缓现象发生。4.2车模行驶信号获取与处理4.2.1原始赛道图像获取在摄像头采集模块将图像信息传给MCU后需要首先进行预处理，因为赛道元素多种多样，有圆环、十字、障碍、坡道以及起跑线，而且在比赛现场还要考虑各种干扰，如光照、反光、人影等，同时，为了尽可能多的采集到更多有效信息，我们的摄像头配备了120°广角镜头，为此还要考虑到采集的原始图像的畸变，因此，只能在图像算法上进行优化，来排除干扰因素，最大限度的对赛道进行有效识别，并提供尽可能多的赛道信息供MCU判断使用。在图像信号处理中，提取的轨道信息主要包括：轨道两侧边缘点的位置、校正后计算出的轨道中心位置、中心点的规划面积、轨道的变化范围、轨道类型的判别。由于摄像机本身的特点，图像会产生梯形变形，使得摄像机看到的信息不真实。因此，我们利用轨迹来测量并创建一个函数来还原真实的轨迹信息。原始图像是由模拟图像经模拟电路转换而成的二维数据矩阵。矩阵的每个元素对应一个像素。图像的第一行对应于最远的约220cm，图像的底线对应于最近的约5cm。远处图像小，近处图像大，黑线呈阶梯状。为了提取轨道的偏差，首先要得到轨道的中心线。单片机通过比较器电路记录每一行的黑白跳变点（跳变点按从右到左的顺序排列），并将它们保存在两个二维数组中（分别代表上升沿和下降沿）。通过遍历上升沿和下降沿，提取出轨迹的边缘。在综合分析后，我们采用了从两侧向中间扫描的策略。当我们发现图像从黑色变为白色时，我们记录下此时的坐标。最后，我们将右边界和左边界除以2，这是轨迹的中心线。原始赛道提取图像如图4.2所示。图4.2原始赛道提取图像4.2.2赛道边线的提取边沿提取算法的基本思想如下：直接逐行扫描原始图像，根据设定的阈值提取黑白跳跃点；有一个轨道宽度范围。在确定的轨道宽度范围内提取有效的轨道边缘，滤除不在宽度范围内的干扰。利用轨迹的连续性，根据白块在前一条直线上的位置和边缘的位置确定直线的边缘点；在寻找边缘点时，由于近像稳定，远像不稳定，采用由近到远的方法；进出交叉口时，可通过修正计算出边缘角，滤除交叉口，补齐直线；根据点迹边缘不连续的特点，对点迹边缘点进行预测拟合。4.2.3车模行驶偏差获取与处理偏差提取过程中，智能车行驶在弯道上，车辆要拐弯，这就要提取车辆对于赛道的偏差。为了使智能车速度更快，智能车理想情况下要切内线走，这样可以以最短的路径走完全程。但是想走内切并不容易，首先得使小车沿着中间线走，这时我们选取某一行对应于中间线的偏差，调试小车直到能稳定沿着中间线走，至于选哪一行是经过多次试验总结得来的。如果小车能沿着中间线走了，我们在把中线偏差加上一个这一段中线上两点间的斜率，偏差和斜率都乘以一个权重，就是实际偏差了。至于斜率选哪两点的斜率实验出来的，对应的加权代码为：my_deviation=(int)(1.1*current_median_Line_lk-0.9*B)。加权的结果为1.1倍的点的偏差加上0.9倍的斜率，由于线性回归方程计算的斜率得到的值时反的，用减代替加，负负得正。斜率的计算方面，传统的两点法虽然计算斜率非常简单，但由于图像是运动的，因此不可靠。如果任何一点偏离，斜率就错了。利用线性回归方程计算斜率，将图像中的每个点都纳入计算范围。为了使汽车模型在最短的时间内跑完全程，要求汽车模型走最短的路径。因此，在偏差提取中，取距车身约50cm处的一点偏差和摄像机视场中线一段坡度，加上一定的权重，求出总偏差，然后对偏差进行PID运算，控制转向角。求斜率最简单的方法是取两点，根据两点的横坐标直接求斜率。然而，这种计算方法并不可靠。最经典的边坡计算方法是最小二乘法。在本程序中最小二乘法的函数是根据数学中的函数公式演化而来，其作用效果和数学公式是一样的。最小二乘法数学公式如式4-1,式4-2：a=b=在程序中累加我们使用的是循环的方式实现的，为了降低单片机执行的压力，我们没有采用浮点型计算数据,一旦遇到需要进行浮点运算的时候，就使用除法代替。以下是小车最小二乘法计算斜率的C语言函数：intregression(intstartline,intendline){if(endline>55)endline=55;inti;intsumX=0,sumY=0,avrX=0,avrY=0;intnum=0,B_up1=0,B_up2=0,B_up,B_down;for(i=startline;i<=endline;i++){num++;sumX+=i;sumY+=currentzhongjian[i];}avrX=sumX/num;avrY=sumY/num;B_up=0;B_down=0;for(i=startline;i<=endline;i++){B_up1=(int)(currentzhongjian[i]-avrY);B_up2=i-avrX;B_up+=(int)(10*(B_up1*B_up2));B_up=B_up/100*100;B_down+=(int)(10*((i-avrX)*(i-avrX)));}if(B_down==0)B=0;elseB=B_up*10/B_down;returnB;}4.2.4起跑线的识别赛道中存在起跑线，需要根据图像识别出起跑线，起跑线检测的思想用跳变沿的思想。检测的方法是从底部几行的中间位置开始，各往左和往右推13个像素点，然后从这个像素点的坐标开始，横坐标不变，纵坐标逐次减小，向上扫描，当发现像素点颜色出现从白变成黑的情况则记录下变化的状态，继续向上扫描，再次出现从黑变成白的跳变，且两边同时跳变，为了增大可靠性，允许两边跳变的出线一定的先后顺序，但是不允许出线较大时间间隔，则此时必然是起跑线。当检测到起跑线后会置位一个标志位，电机控制函数会控制电机反转刹车然后停车。由于车辆跑完一圈需要一定的时间，程序不需要每时每刻都检测起跑线，所以当车辆发车后10S才开始检测起跑线。这样可以降低在行驶过程中误判的几率，提高程序执行的效率。实现的方法是在定时器里增加变量，每隔5ms变量增加1，直到增加2000次，就开始执行起跑线检测程序。起跑线的图像如图4.3所示。图4.3起跑线图像4.3车模行驶状态控制4.3.1车模速度控制为了让车模整体上行驶速度更快，需要使用变速行驶的策略，既直道加速弯道减速。轨道的曲率是汽车模型判断是直线还是曲线的基础。曲率越大，轨迹越弯曲。根据不同的曲率给出不同的速度。由于数学中曲率计算方法的复杂性和单片机的耗时性，我们简化了处理算法，即中线上的一点相对于上一点每向右移动一次，曲率就增加一次，每向左移动一次，它减少了一。最后，通过判断一次整幅图像的中线，得到当前图像的曲率。根据曲率，我们可以判断轨道的紧急程度。紧急程度不同，速度也不同。为了使速度控制精准，我们采用了PID控制车速。由于车模目标速度是连续变化的，是一个动态的系统，在这种情况下PID控制首先要保证的是跟随能力，所以静差的影响可以忽略，从而可以去除积分项，采用PD控制。速度PID控制的架构图如图4.4所示。图4.4PID控制的架构图PID控制器数学公式如式4-3：u(t)=kp×e(t)+ki在工程实践中，应用最广泛的调节器控制律是比例、积分、微分控制，简称PID控制，又称PID调节。PID控制器已经发展了近70年。它以其结构简单、稳定性好、运行可靠、调整方便等优点成为工业控制的主要技术之一。当被控对象的结构和参数不能完全掌握，或无法得到精确的数学模型，以及其它控制理论技术难以采用时，系统控制器的结构和参数必须通过经验和现场调试来确定。此时，PID控制技术的应用最为方便。也就是说，当我们对一个系统和被控对象没有充分的了解，或者不能通过有效的测量手段获得系统参数时，PID控制技术是最合适的。PID控制，实践中也有PI和PD控制。PID控制器是一种线性控制器，它根据给定值和实际输出值形成控制偏差。偏差的比例（P）、积分（I）和微分（D）通过线性组合构成控制量，对被控对象进行控制，称为PID控制器。智能汽车在运行过程中，速度静态误差非常小，往往不会对小车的运行产生影响，并且小车目标速度是不断不断变化的，因此在PID算法中我们将积分项系数设为0，只使用了PD控制。经过调试后发现小车能够很流畅的在道路上运行，精准的实现速度的切换。以下是PID控制车速的程序代码：Voidspeedcontrol(){piancha_speed=maichongshu-speed_now;speed_wucha=speed_now-maichongshu;dwucha=speed_wucha-lastspeed_wucha2;zhankongbi=last_zhankongbi+speed_kp*speed_wucha-speed_ki*lastspeed_wucha+speed_kd*dwucha;//调速if(zhankongbi>7000)zhankongbi=7000;if(zhankongbi<0)zhankongbi=0;if(piancha_speed>menkan){fanzhuan(dut);}elsezhengzhuan(zhankongbi);last_zhankongbi=zhankongbi;lastspeed_wucha3=lastspeed_wucha2;lastspeed_wucha2=lastspeed_wucha1;lastspeed_wucha1=lastspeed_wucha;lastspeed_wucha=speed_wucha;}4.3.2车模转向控制车模转向控制是根据摄像头拍摄的赛道图像，处理得到车模相对于赛道中间位置的偏差。偏差是将车模图像的中间坐标减去给定值39得到的,因为车模摄像头拍摄的图像横轴是有80个坐标点,其坐标从0到79中间值为39.5由于在程序中不允许出现浮点数据，所以采用39作为中间坐标,得到的偏差经过PID算法计算最终输出到舵机，控制舵机转向。最终小车的位置将通过摄像头反馈回来，进行下一周期的运算。车模的转向控制我们采用了PD控制算法。同样由于小车转向是个不断变化的过程，是个动态的模型，主要保证控制的跟随性，无需考虑静态误差。既不需要积分项来消除静态误差，所以同样采用PD控制算法，不采用积分项。为了补偿C模型的转向抖动，我们采用了前四阶偏差和电流偏差的差值作为微分项，使抖动现象得到了很大的改善。为了防止转向机失速，必须限制转向机的角度。赛道情况是非常复杂的，同一组参数并不一定能够完全适应不同的赛道形式，比如KP过大，车模会出现抖动的现象，过小的话拐弯力度不够。所以我们引入了模糊PID算法的概念，就是根据赛道的弯曲程度给定不同的KP值，在直道上以小一点的KP系数运行，提高稳定性，弯道上以较大的KP运行，增大拐弯力度。具体的分段方式是根据偏差大小来分的，偏差变大说明小车正在进入弯道，变小说明进入直道。以下是方向控制的代码：voidservo()//舵机控制函数{if(abs(my_piancha)<5)//直道上，偏差绝对值小于5{kp1=18;//直道上的P，小一点，防止直道抖动}elsekp1=20;//不是直道P就要大一点。以增大拐弯力度，切赛道内侧。jiao=(int)(kp1*duojijiaodu-kd*(lastpiancha_4-duojijiaodu));if(jiao>