[]中，Y方向坐标数据放K00RDINATE_Y[]中，X、Y 坐标数据放 K00RDINATE_X_Y □口中；
(7)根据计算出来的I轴坐标数据及数据的顺序，利用比较法，判断出飞机轮廓的三个极限点:最左边的扫描点(左侧距尚最远的点)，中间的扫描点(距尚最近的点)及最右边的扫描点(右侧距离最远的点)；
(8)利用上面计算出来的X，y坐标数据，已最近点为界，分为左右两部分，逐一计算出飞机上的每个轮廓点的角度，并保存在一个数组中WINKEL[]；
(算法为:
N_P 从 10 到 100，
DELTA_X=|K00RDINATE_X[N_P]-K00RDINATE_X[N_P-5]|，DELTA_Y=|K00RDINATE_Y[N_P]-K00RDINATE_Y[N_P-5]|，
WINKEL [] =90-TANGENS_TABELLE (DELTA_Y+ DELTA_X)，
其中，TANGENS_TABELLE为计算正切角度的函数)
(9)根据计算出来的X轴坐标数据，和闪存卡中的机型参数文件中的三个扫描范围参数(范围:3000-6500, 2000-6500, 1000-6500)，分别找出左右各3对范围对应的坐标数组索引号；
右边:Von_PUNKT_lR，BisPUNKT_lR; Von_PUNKT_2R, BisPUNKT_2R; Von_PUNKT_3R,BisPUNKT_3R;
左边:Von_PUNKT_lL，BisPUNKT_lL; Von_PUNKT_2L, BisPUNKT_2L; Von_PUNKT_3L,BisPUNKT_3L ；
(10)利用索引号及已计算好的角度值WINKEL[]，分别计算出左右各3对范围，共6对范围(范围:3000-6500, 2000-6500, 1000-6500)，各范围内轮廓点的角度的算术平均值；
角度值放如下变量中:
WINKEL_BEREICH_1L, WINKEL_BEREICH_2L, WINKEL_BEREICH_3L, WINKEL_BEREICH_1R,WINKEL_BEREICH_2R, WINKEL_BEREICH_3R
(11)利用机型参数文件中的左右修正参数(左边为:_10，-10，-10;右边为:-90，-90，-90)，对计算出来的斜率平均值进行修正处理，根据具体机型灵活处理；
修正后的数值放如下变量中:
WINKEL_ABS0LUT_1R, WINKEL_ABSOLUT_2R, WINKEL_ABSOLUT_3R, WINKEL_ABS0LUT_1L, WINKEL_ABSOLUT_2L, WINKEL_ABSOLUT_3L
(12)判断车辆的偏向，根据车辆的偏转情况，选择偏转方向的区域，然后在上步中的三对区域中选最小的一个区域(即优先选择3000-6000的区域)，作为判断车辆过度转向的依据；将选定的区域角度放如下变量中:
右边的角度放WINKEI_ABSOLUT_R中；
左边的角度放WINKEI_ABSOLUT_L中
(13)将选定区域内的计算得到的角度平均值WINKEL
_ABSOLUT ；
左偏时:WINKEL_ABSOLUT=WINKEI_ABSOLUT_L ;右偏时:WINKEL
_ABSOLUT=WINKEI_ABSOLUT_R ；
与机型参数文件中的，相对应机型的角度设定值进行比较(Winkelgelb=60,Winkelgelb=70)，从而检测过度转向的情况；
(14)当计算的斜率平均值大于预警值(Winkelgelb=60)且小于极限值(ffinkelgelb=70)时，系统会发出黄色的预警信号指示；当计算的斜率平均值大于极限值时，系统会发出红色的过渡转向信号指示，相应的过渡转向报警标识会通过CAN总线发出，同时将报警时的坐标信息写入闪存卡的〃737red.csv"文件中，对过度转向情况进行记录，文件中记录有日期，时间，偏转情况，过度转向的角度，120个扫描点的坐标。
[0014]本专利的有益效果是:1、提高了抱轮牵引车在抱拖飞机时进行直观有效地过渡转向检测。2、该过渡转向检测算法有效地降低了计算的复杂度，降低了硬件要求，降级了设备的采购成本。3、该专利进一步提升人机对话能力，减小了因车辆元器件本身故障或人为误操作导致的事故的机率，从而提高生产效率。
【主权项】
1.一种判断抱轮牵引车过度转向算法，包括驾驶室，所述驾驶室内设有数字处理控制器，其特征在于驾驶室后上方安装有一个激光扫描雷达，所述激光扫描雷达经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对范围，各范围内轮廓点的斜率的算术平均值； (II)利用机型参数文件中的左右修正参数，对计算出来的斜率平均值进行修正处理； (12)判断车辆的偏向，根据车辆的偏转情况，选择偏转方向的区域，然后在三对区域中选最小的一个区域，作为判断车辆过度转向的依据； (13)将选定区域内的计算得到的斜率平均值，与机型参数文件中的，相对应机型的角度设定值进行比较，从而检测过度转向的情况； (14)当计算的斜率平均值大于预警值且小于极限值时，系统会发出黄色的预警信号指示；当计算的斜率平均值大于极限值时，系统会发出红色的过渡转向信号指示，相应的过渡转向报警标识会通过CAN总线发出，同时将报警时的坐标信息写入闪存卡文件中，对过度转向情况进行记录，文件中记录有日期，时间，偏转情况，过度转向的角度，120个扫描点的坐标。
【专利摘要】本发明公开了一种判断抱轮牵引车过度转向算法，包括驾驶室，所述驾驶室内设有数字处理控制器，其特征在于驾驶室后上方安装有一个激光扫描雷达，所述激光扫描雷达经CAN总线与数字处理控制器相连接，当抱轮牵引车抱起飞机后，激光扫描雷达获取飞机的轮廓数据，通过CAN总线将数据传给总线上的数字处理控制器，大大提高了抱轮牵引车在抱拖飞机时进行直观有效地过渡转向检测、显著降低了计算的复杂度和硬件要求，减小了因车辆元器件本身故障或人为误操作导致的事故的机率，从而提高生产效率。
【IPC分类】G05D1/02
【公开号】CN104932498
【申请号】CN201510246391
【发明人】宋强, 高正, 于新平, 王晓, 钟韬
【申请人】威海广泰空港设备股份有限公司
【公开日】2015年9月23日
【申请日】2015年5月15日