一种判断抱轮牵引车过度转向算法
【技术领域】
[0001]本发明涉及车辆控制技术领域，具体地说是一种判断抱轮牵引车过度转向算法。
【背景技术】
[0002]目前，通常的飞机抱轮牵引车与飞机之间的接触面安装有扭力传感器，通过测量扭力传感器的数据，间接获得转向数据。根据扭力与角度之间的关系，计算出抱轮牵引车与飞机之间的角度，从而发出预警信号。
[0003]该对比技术的不足是:
1、扭力传感器只是通过扭力间接测量出飞机与抱轮牵引车之间的夹角，不够直接，对于需要高可靠性的应用场合，随着传感器使用时间的增加，传感器会出现老化现象，参数会发生变化，这样测得得角度值就不会太准确。
[0004]2、制造传感器材料的材料受温度影响变化大，因此环境温度不同，传感器参数会有变化。
[0005]3、扭力传感器精度普遍不高，因此无法精确地表达角度的变化。
[0006]由于这种测量技术存在上述不足，对车辆的操作者要求高，使用时存在误报及漏报现象，因此需要一种更加直接的、可视的测量抱轮牵引车与飞机之间夹角的方法。
【发明内容】
[0007]一种判断抱轮牵引车过度转向算法，包括驾驶室，所述驾驶室内设有数字处理控制器，其特征在于驾驶室后上方安装有一个激光扫描雷达，所述激光扫描雷达经CAN总线与数字处理控制器相连接，当抱轮牵引车抱起飞机后，激光扫描雷达获取飞机的轮廓数据，通过CAN总线将数据传给总线上的数字处理控制器，通过数字处理控制器内设有的扫描频率、扫描角度分辨率、扫描开始角度、扫描结束角度、CAN总线波特率和扫描雷达的ID地址对数据进行处理及过渡转向识别，在数字处理控制器的显示屏中显示处理，达到直接、可视的测量抱轮牵引车与飞机之间的夹角，
其具体过度转向算法步骤如下:
(I)首先判断数字处理控制器内是否安装有闪存卡，若安装，则将闪存卡中的所有预置飞机机型参数数据文件及车辆参数文件分别加载到数字处理控制器的内存中；
(2 )将加载进内存的数据文件进行处理，解析数据文件，分别读出文件中的各个参数，分门别类将数据保存于一个数组中；
(3)启动扫描雷达开始扫描，扫描雷达扫描飞机外型轮廓，将测量得到的120个点的距离信息通过相应的CAN接口发送到总线上；
(4)数据处理控制器从CAN总线上，接收每个点的距离信息；将所有的距离信息统一放于一个数组中；
(5)解码距离数据，将扫描雷达得到的距离数据转化为实际的公制长度数据(mm);
(6)根据每个点的实际长度数据，以扫描雷达作为坐标原点，逐一计算出每个点的相应的X’ y坐标的数据，分别放于两个数组中；
(7)根据计算出来的y轴坐标数据，判断出飞机轮廓的三个极限点:最左边的扫描点，中间的扫描点及最右边的扫描点；
(8)利用计算出来的x，y坐标数据，逐一计算出飞机上的每个轮廓点的角度，并保存在一个数组中；
(9)根据计算出来的X轴坐标数据，和闪存卡中的机型参数文件中的三个扫描范围参数，分别找出左右各3对范围对应的坐标数组索引号；
(10)分别计算出左右各3对范围，共6对范围，各范围内轮廓点的角度的算术平均值；
(11)利用机型参数文件中的左右修正参数，对计算出来的斜率平均值进行修正处理；
(12)判断车辆的偏向，根据车辆的偏转情况，选择偏转方向的区域，然后在三对区域中选最小的一个区域，作为判断车辆过度转向的依据；
(13)将选定区域内的计算得到的角度平均值，与机型参数文件中的，相对应机型的角度设定值进行比较，从而检测过度转向的情况；
(14)当计算的斜率平均值大于预警值且小于极限值时，系统会发出黄色的预警信号指示；当计算的斜率平均值大于极限值时，系统会发出红色的过渡转向信号指示，相应的过渡转向报警标识会通过CAN总线发出，同时将报警时的坐标信息写入闪存卡的"机型名red.CSV"文件中，对过度转向情况进行记录，文件中记录有日期，时间，偏转情况，过度转向的角度，120个扫描点的坐标。
[0008]本专利的有益效果是:1、提高了抱轮牵引车在抱拖飞机时进行直观有效地过渡转向检测。2、该过渡转向检测算法有效地降低了计算的复杂度，降低了硬件要求，降级了设备的采购成本。3、该专利进一步提升人机对话能力，减小了因车辆元器件本身故障或人为误操作导致的事故的机率，从而提高生产效率。
【附图说明】
[0009]图1是本发明的处理流程示意图。
[0010]图2是本发明数字处理控制器显示的车辆偏转15度的画面。
[0011]图3是本发明数字处理控制器显示的车辆偏转54度的画面。
[0012]附图标记:。
【具体实施方式】
[0013]下面结合附图和实施例对本发明进一步说明:
实施例:如附图所示，一种判断抱轮牵引车过度转向算法，包括驾驶室，所述驾驶室内设有数字处理控制器，其特征在于驾驶室后上方安装有一个激光扫描雷达，所述激光扫描雷达经CAN总线与数字处理控制器相连接，当抱轮牵引车抱起飞机后，激光扫描雷达获取飞机的轮廓数据，通过CAN总线将数据传给总线上的数字处理控制器，通过数字处理控制器内设有的扫描频率、扫描角度分辨率、扫描开始角度、扫描结束角度、CAN总线波特率和扫描雷达的ID地址对数据进行处理及过渡转向识别，在数字处理控制器的显示屏中显示处理，达到直接、可视的测量抱轮牵引车与飞机之间的夹角，
其具体过度转向算法步骤如下:以波音737为例加以说明: (O首先判断数字处理控制器内是否安装有闪存卡(通过调用OPEN_PCMCIA功能来实现，若闪存卡插入控制器内，则返回TRUE)，若安装，则将闪存卡中的所有预置飞机机型参数数据文件及车辆参数文件分别加载到数字处理控制器的内存中(飞机参数文件为B737.1ni,车辆参数文件为FAHRZEUG.1ni,两个文件的内容预先编制好存放在闪存卡中)；
(2 )将加载进内存的数据文件进行处理，解析数据文件，分别读出文件中的各个参数，分门别类将数据保存于一个数组中；(飞机类型编码为6放ACMusterNRD中，要检测的区域数为3放Bereiche []中，检测区域的起始坐标为(3000，2000, 1000)放在VonBereich []中，检测区域的终点坐标为(6500，6500，6500)放BisBereich[]中，报警角度值为60放Winkelgelb []中，判断过度转向的角度值为70放Winkelrot []中，计算角度时使用的修正数值，左侧的修正值为(-10，-10，-10)放ISeiteKor []中，右侧的修正数为(-90，-90，-90)放rSeiteKor []，飞机鼻轮宽度为65放Bugradbreite []中；将读取的牵引车的测量飞机鼻轮宽度的传感器之间的距离为1117放EntfernungsMesserDistanz变量中，抱轮牵引车的车辆类型代码为I放Typ变量中；
(3)启动扫描雷达开始扫描，扫描雷达扫描飞机外型轮廓，将测量得到的120个点的距离信息通过相应的CAN接口发送到总线上；
(4)数据处理控制器从CAN总线上，接收每个点的距离信息；将所有的距离信息统一放于一个数组DISTANZ []中；
(5)解码距离数据，将扫描雷达得到的距离数据转化为实际的公制长度数据(mm)，距离数据放 DISTANZ_M口中。(计算公式为:N_M 从 I 到 120，DISTANZ_M[]= (DISTANZ[N_M*2] +DISTANZ [N_M*2-1]+256) X 1000)；
(6)根据每个点的实际长度数据，以扫描雷达作为坐标原点，逐一计算出每个点的相应的X，y坐标的数据
(计算公式为:
K00RDINATE_Y[]=DISTANZ_M[]XTAB_C0S[]，
K00RDINATE_X[]=DISTANZ_M[]XTAB_SIN[]，
其中TAB_C0S[]和TAB_SIN[]分别为已计算好的余弦及正弦的角度表)，
分别放于三个数组中，X方向坐标数据放K00RDINATE_X