Accurate INS position solution during GPS outages or degraded GPS

Temporary degraded GPS (DGPS) position loss, in circumstances such as an overhead bridge, can be alleviated by an inertial navigation system (INS) that uses onboard sensors, such as yaw and speed sensors, to determine vehicle position. This paper introduces a post-processing DGPS/INS integration approach based on using the INS solution during DGPS outages or periods of low accuracy DGPS position solutions. In this approach, the INS solution initialization is performed using the DGPS solution before DGPS position solution loss, and measurements from the Inertial Measurement Unit (IMU). The final post-processed INS solution is a weighted average of the INS forward and backward solutions. This work constitutes two parts: the INS initialization methods for different degrees of freedom vehicle positioning models, and the developed weighting model necessary to combine the forward and the backward solutions. The former part is essential in obtaining acceptable INS initial states for both the stand-alone INS or any post-processing or real time INS/GPS integrated system. The latter part is based on the use of the complementary error behaviours of the backward and the forward solutions, and can be used as a survey method with acceptable position solutions accuracies. Applying the forward/backward INS combined solution method on real data shows that the resultant INS solution accuracy is 35 cm or less over a 1000 m road segment. This method is used to survey freeways interchange road segments where 50% of the surveyed distance has no DGPS solution or has a degraded DGPS solution. The average achieved accuracy over the whole freeways interchange is around 40 cm over a 23 km distance.     

高速公路相机自动标定及道路坐标系构建

为解决高速公路场景下利用视频监控系统正确描述车辆相对于道路的空间位置问题，通过引入Frenet坐标系概念，提出一种基于相机自动标定的道路坐标系模型。在相机自动标定阶段，利用线分段拟合方法从曲线车辆轨迹中提取平行于直线路段的轨迹点，并通过级联霍夫变换精确估计道路方向的消失点。然后,根据多车辆三维模型约束，对相机参数进行迭代优化。基于标定结果，将车辆轨迹映射到世界坐标系平面上，并用3次样条插值进行拟合。根据大量运动车辆在道路平面内形成的轨迹域分布特征，综合边界约束估计道路中心点。最后，结合道路中心线在各点处的法线向量与车道宽度信息确定平移量，并利用点平移运动拟合车道线，实现道路坐标系的自动建立。使用真实高速公路视频数据，在多种道路条件下进行试验。研究结果表明:在标定阶段，构建方法对不同高速公路场景的最大标定误差不超过11.55%;与最新的方法相比，直线道路平均标定误差分别降低6.68%和3.58%，弯曲道路平均标定误差分别降低7.43%和2.61%;在道路坐标系构建阶段，构建方法的平均投影距离为0.077 m，接近最新方法的0.069 5 m；而其平均精度为0.916，显著优于最新方法的0.663；所提道路坐标系能够自适应道路形态的变化，有效解决了从监控视频中描述车辆与道路之间相对位置关系的问题。     

自动驾驶汽车基础测试场景构建研究（双语出版）

针对L2/L3级自动驾驶汽车的仿真测试和封闭场地测试认证需求，结合现有L2/L3级自动驾驶汽车量产车型的主要功能特点，提出自动驾驶汽车基础测试场景群的构建方法。首先针对指定的道路交通环境，分析主车和周围交通参与者可能的相对位置和运动方向的组合，确定复杂场景群。其次分别以主车功能所确定的各个可能运动方向，依此与各干扰车辆的可能运动方向（包括任一干扰车辆不存在的情形）进行组合，组合时采用PICT组合测试工具，并添加必要的运动约束条件，选择参数组合覆盖标准自动生成全部的组合场景群。最后结合场景筛选规则，筛选出具有测试价值的覆盖各个层级及功能的基础测试场景群。采用场景构建方法，对于主车处于三车道中间车道的路段场景和无红绿灯的十字路口场景，分别构建62种和33种基础测试场景。根据驾驶人行为特性、交通规则、汽车在城市、郊区和高速公路工况下的典型车速、加减速度、横向加速度、交通事故和自然驾驶数据库的有关场景数据等，设计主车换道工况的测试用例。采用模型预测控制框架建立主车局部路径规划和控制仿真模型，并对主车危险换道场景进行仿真。研究结果表明：主车在邻车道前车大减速的情况下实现了减速换道并避免了与本车道前车和邻车道前后车的碰撞，同时跟踪到期望跟车间距，验证了该换道测试用例的有效性。     

Road characteristics and environment factors associated with motorcycle fatal crashes in Malaysia

This study aims to determine risk factors contributing to traffic crashes in 9,176 fatal cases involving motorcycle in Malaysia between 2010 and 2012. For this purpose, both multinomial and mixed models of motorcycle fatal crash outcome based on the number of vehicle involved are estimated. The corresponding model predicts the probability of three fatal crash outcomes: motorcycle single-vehicle fatal crash, motorcycle fatal crash involving another vehicle and motorcycle fatal crash involving two or more vehicles. Several road characteristic and environmental factors are considered including type of road in the hierarchy, location, road geometry, posted speed limit, road marking type, lighting, time of day and weather conditions during the fatal crash. The estimation results suggest that curve road sections, no road marking, smooth, rut and corrugation of road surface and wee hours, i.e. between 00.00 am to 6 am, increase the probability of motorcycle single-vehicle fatal crashes. As for the motorcycle fatal crashes involving multiple vehicles, factors such as expressway, primary and secondary roads, speed limit more than 70 km/h, roads with non-permissible marking, i.e. double lane line and daylight condition are found to cause an increase the probability of their occurrence. The estimation results also suggest that time of day (between 7 pm to 12 pm) has an increasing impact on the probability of motorcycle single-vehicle fatal crashes and motorcycle fatal crashes involving two or more vehicles. Whilst the multinomial logit model was found as more parsimonious, the mixed logit model is likely to capture the unobserved heterogeneity in fatal motorcycle crashes based on the number of vehicles involved due to the underreporting data with two random effect parameters including 70 km/h speed limit and double lane line road marking.     

Development of a path planning system using mean shift algorithm for driver assistance

The longitudinal and lateral vehicle control techniques have been widely used in several active driver assistance systems. The adaptive cruise control, lane keeping assistant control, vehicle platooning and stop-and-go control are typical examples of the most important applications. In this study, a novel path planning method is proposed considering the driving environment such as road shape, ego vehicle and surrounding vehicles’ movement. The relative distance and velocity between the ego vehicle and surrounding vehicles are identified with respect to the predicted lane shape in front of the ego vehicle. Based on the identified information, the road shape and surrounding vehicles are mapped into the intensity image and the desired vector for the ego vehicle’s movement is determined by the maximum intensity density tracing method. The desired vehicle path is followed by the acceleration/deceleration control and the steering assist control, respectively. In order to evaluate the performance of the proposed system, simulations are conducted and compared with ACC systems.     

Accurate INS position solution during GPS outages or degraded GPS

Temporary degraded GPS (DGPS) position loss, in circumstances such as an overhead bridge, can be alleviated by an inertial navigation system (INS) that uses onboard sensors, such as yaw and speed sensors, to determine vehicle position. This paper introduces a post-processing DGPS/INS integration approach based on using the INS solution during DGPS outages or periods of low accuracy DGPS position solutions. In this approach, the INS solution initialization is performed using the DGPS solution before DGPS position solution loss, and measurements from the Inertial Measurement Unit (IMU). The final post-processed INS solution is a weighted average of the INS forward and backward solutions. This work constitutes two parts: the INS initialization methods for different degrees of freedom vehicle positioning models, and the developed weighting model necessary to combine the forward and the backward solutions. The former part is essential in obtaining acceptable INS initial states for both the stand-alone INS or any post-processing or real time INS/GPS integrated system. The latter part is based on the use of the complementary error behaviours of the backward and the forward solutions, and can be used as a survey method with acceptable position solutions accuracies. Applying the forward/backward INS combined solution method on real data shows that the resultant INS solution accuracy is 35 cm or less over a 1000 m road segment. This method is used to survey freeways interchange road segments where 50% of the surveyed distance has no DGPS solution or has a degraded DGPS solution. The average achieved accuracy over the whole freeways interchange is around 40 cm over a 23 km distance.     

Towards lane-level traffic monitoring in urban environment using precise probe vehicle data derived from three-dimensional map aided differential GNSS

Today's urban road transport systems experience increasing congestion that threatens the environment and transport efficiency. Global Navigation Satellite System (GNSS)-based vehicle probe technology has been proposed as an effective means for monitoring the traffic situation and can be used for future city development. More specifically, lane-level traffic analysis is expected to provide an effective solution for traffic control. However, GNSS positioning technologies suffer from multipath and Non-Line-Of-Sight (NLOS) propagations in urban environments. The multipath and NLOS propagations severely degrade the accuracy of probe vehicle data. Recently, a three-dimensional (3D) city map became available on the market. We propose to use the 3D building map and differential correction information to simulate the reflecting path of satellite signal transmission and improve the results of the commercial GNSS single-frequency receiver, technically named 3D map-aided Differential GNSS (3D-DGNSS). In this paper, the innovative 3D-DGNSS is employed for the acquisition of precise probe vehicle data. In addition, this paper also utilizes accelerometer-based lane change detection to improve the positioning accuracy of probe vehicle data. By benefitting from the proposed method, the lane-level position, vehicle speed, and stop state of vehicles were estimated. Finally, a series of experiments and evaluations were conducted on probe data collected in one of the most challenging urban cities, Tokyo. The experimental results show that the proposed method has a correct lane localization rate of 87% and achieves sub-meter accuracy with respect to the position and speed error means. The accurate positioning data provided by the 3D-DGNSS result in a correct detection rate of the stop state of vehicles of 92%.     

制动与转向协调动作的车辆避撞控制研究（双语出版）

为了弥补现有汽车避撞控制策略以及碰撞风险评价指标单一的不足，提出转向和制动协调的主动避撞控制系统。首先规划了五次多项式换道路径，在对其理论分析的基础上得到转向临界避撞距离和与目标车道车辆的安全距离约束。其次，考虑道路附着系数和系统延迟的影响，基于制动过程给出制动临界避撞距离，并以纵向行驶安全系数ξ和碰撞时间倒数T^-1_TC划分安全行驶区域，利用驾驶人实车跟车数据标定稳态跟随/定速巡航区域的阈值。随后，通过转向/制动临界避撞距离的对比给出2种避撞方式的安全收益范围。最后搭建Simulink/CarSim联合仿真模型，并对其进行不同初始条件下的避撞仿真试验。研究结果表明：转向操作在制动距离不足时仍是有效的；当主车高速近距离接近静止前车时，主车可以顺利采取转向换道动作，而常规ACC系统在2.5 s处的车间相对距离为-0.76 m，事实上已经发生了碰撞；当相邻车道前车与主车纵向间距不满足换道安全距离约束时，避撞控制系统进入紧急制动模式，最大制动减速度达到-0.8g（g为重力加速度），实际最小车间距为5.1 m；通过转向和制动的协调动作，充分发挥了车辆的避撞潜力；ξ和T^-1_TC指标的融合，可以更好地评估碰撞风险并实现不同控制模式的转换，在保证行车安全的同时可避免过分制动给乘客造成的紧张感。     

基于无人机视频拍摄的高速公路小型车换道行为特性

为了研究高速公路小型车的换道行为特性,采用2台无人机同时在200 m的高空对交通流进行拍摄,获取交通流运行状态。构建拍摄路段的高精度地图,获取每一时刻车辆的精确运行状态数据,在此基础上对2个视频进行拼接,最终获得车道位置、速度、车辆编号等8项关键指标,共提取换道行为1 520条,筛选后得到完整的自由换道数据942条。采用车辆轨迹是否持续偏移作为判断换道行为起终点的依据,在此基础上分析换道的时间长度、空间长度、与周边车辆的相互状态以及换道行为的安全性等16个特征参数。得出平均换道时间长度为6.09 s,平均换道空间距离为148.08 m,换道时间与空间长度均符合对数正态分布。换道车辆与目标车道后方车辆的平均距离最小（34.29 m）,其相对距离在10 m以内的占28.24%,驾驶人为了加快行驶,在与目标车道后方车辆相对距离较小的情况下,依然采取换道措施。与正前方车辆的相对速度差最大,平均值为10.2 km·h^-1,并且在83%的情况下,本车的速度大于前车,说明车辆自由换道是由于前方车辆行驶速度较慢所引起。采用TTC,MTC分别对换道起始时刻的安全性进行分析,并将安全状态划分为4种类型：严重-紧急状态、严重-非紧急状态、非严重-紧急状态、非严重-非紧急状态。其中严重-非紧急,非严重-非紧急这2种状态占比最高。该研究成果对了解中国驾驶人在高速公路上的换道行为特性,以及对建立适用于中国实际交通环境特征的换道行为模型具有一定参考意义。     

面向智能网联汽车定位的协同地图匹配算法

为实现智能网联环境下低成本、高精度的车辆定位, 研究了基于自适应遗传Rao-Blackwellized粒子滤波的协同地图匹配算法。利用联网车辆的定位信息和道路约束条件消除公共偏差, 提高车辆定位精度。将自适应遗传算法引入到粒子滤波的重采样过程中, 增加粒子的多样性, 解决传统粒子滤波算法中容易出现的“粒子退化”和“粒子耗尽”问题。通过仿真实验与传统粒子滤波以及卡尔曼平滑粒子滤波下的定位结果进行了对比, 同时分析了不同联网车辆数目对定位精度的影响。通过实际测试验证了算法在实际应用中的定位效果。实测结果表明: 以典型十字路口为例, 在联网车辆数目为4的情况下, 协同地图匹配算法的定位误差范围为1.67 m, 分别为原始GNSS定位以及单车地图匹配定位结果的41.03%和56.80%。同时, 该算法的统计定位精度(CEP)达到1.06 m, 比GNSS原始定位精度提高了2.52 m, 具有较好的定位效果。      

基于车辆位置与速度特征的驾驶行为模式分类方法

精细车辆轨迹中包含连续的时间戳、位置,以及速度等信息。通过对车辆轨迹数据进行量化表达与挖掘分析,可以实现对车辆行为模式的分类。现有研究大多关注对位置的聚类,很少对车速、加速度等特征进行研究分析,而车速等是反映驾驶行为模式的重要特征。为了将轨迹多维信息纳入分析框架,研究了基于位置与速度特征的车辆轨迹行为模式分类方法。为克服现有行为模式分类方法的维度单一性,运用豪斯多夫轨迹距离算法计算出位置和速度特征的综合距离矩阵,针对豪斯多夫距离算法鲁棒性差的缺点,采用单向豪斯多夫距离90%分位值对算法进行了改进,降低噪声影响。同时,引入了车辆位置和速度来进一步提高分类的准确性,运用多次分层聚类算法依次对位置与速度轨迹图进行分类,得到车辆位置和速度上的行为模式。以HighD数据集为样本,提取了三车道上的行车轨迹,验证了基于速度与位置特征的车辆行为模式分类方法。结果表明：(1)本方法可以得到位置和速度的综合行为模式,聚类平均准确率达到94.8%,优于DBTCAN准确率89.3%和t-Cluster准确率86.4%;(2)基于换道模式轨迹偏移率曲线的分析,得到了4种互异的典型车辆换道模式。该方法可利用多维轨...     

面向动态避障的智能汽车滚动时域路径规划

为解决城市低速条件下智能汽车在避障过程中的路径规划问题，提出面向动态避障的智能汽车滚动时域路径规划方法。首先，划分车道可行区域，利用3次拉格朗日插值法拟合车道边界，并根据"车-路"的相对位置关系将车道区域进一步划分为车道间区域与车道内区域两部分。其次，以区域虚拟力场进行动态交通场景模拟，包括在障碍车周身沿车道方向的虚拟矩形区域斥力场，行驶目标位置的虚拟引力场和车道保持虚拟区域引力场3个部分，然后结合划分的车道区域确定各虚拟力场的作用区域。再次，建立主车动力学与运动学模型，障碍车运动学预测模型，把主车与障碍车无碰撞，主车行驶在车道内区域，趋向目标位置以及保证车辆稳定性作为优化目标，综合车辆模型的控制输入、状态变量等动力学约束条件，构建多目标的滚动时域控制器用于车辆避障路径规划，求解获得前轮转角作为控制量。最后，利用MATLAB和veDYNA软件对提出的路径规划控制系统分别在静态障碍和动态障碍工况下进行联合仿真。研究结果表明：该方法能够很好地解决躲避静态障碍和低速动态障碍车的问题，控制车辆驶向目标位置，并且在避障过程中满足车辆的动力学约束，同时又不会与道路边界发生碰撞，保证了车辆的安全性和稳定性。     

Automated Vehicle Merging Maneuver Implementation for AHS

Summary This paper presents a real-time implementation of a general merging algorithm for automated highway systems. A merging control problem is proposed first. A real-time algorithm is then presented, which is used to calculate a smooth reference speed trajectory for the merging vehicle based on the speed of the main lane vehicle. This algorithm can also be applied even when the main lane vehicles change speed. To make the algorithm adapt to different road layouts and to increase safety, a concept of virtual platooning is proposed. It effectively shifts the time of platoon formation forward prior to the start of real merging. Aspects closely related to real-time implementation are discussed, such as the controller adopted, the use of magnetometer based distance measurement and information passing by communication from main lane vehicles. Test results are presented and briefly analyzed.     

驾驶仿真模型实验验证及参数初步标定

为了验证适用实际道路输入的最优加速度模型并标定相应的参数,选取有代表性的路段进行实车观测实验。实验的结果表明:该模型的仿真结果与实际车辆在弯道上行驶规律相吻合,驾驶员的前视时间在不同的视野下有所变化,并且不同的驾驶员其前视时间存在一定的差异。     

车路协同下避让紧急车辆协同换道策略

为加快紧急车辆抵达事故现场的速度，同时减少紧急车辆优先权对其他车辆的影响，运用车路协同系统，提出避让紧急车辆协同换道策略，通过调整紧急车辆下游车辆位置，实现紧急车辆高效通过路段。以紧急车辆前车（DV）及其相邻目标车道车辆为控制对象，根据相邻车道车辆间距与车车通信范围，搜索DV可换道空间间隙集。以交通流整体恢复稳定时间最小为目标，确定DV换道轨迹和相邻车道协作车辆的速度变化，引导车辆完成协同合流，既能保障车辆安全换道，还能降低换道造成的速度振荡传递。同时，为快速恢复DV换道造成的目标车道车辆速度波动，对上游车辆（UV）采取先进先出规则的换道控制策略。所提协同避让紧急车辆的策略考虑了车辆协同换道对交通流的整体影响，并在原有换道策略的基础上提出了减少速度波动传递的控制方法。案例分析结果表明:采用上下游协同换道策略最短换道时间为6s，此时紧急车辆距前车78.66 m时发送避让信号。同时研究发现，恢复交通流速度稳定所需的时间为29 s，比未采用上下游协同换道策略降低了34%。      

A two-stage-training support vector machine approach to predicting unintentional vehicle lane departure

Advanced driver assistance systems, such as unintentional lane departure warning systems, have recently drawn much attention and efforts. In this study, we explored utilizing the nonlinear binary support vector machine (SVM) technique to predict unintentional lane departure, which is innovative, as the SVM methodology has not previously been attempted for this purpose in the literature. Furthermore, we developed a two-stage training scheme to improve SVM's prediction performance in terms of minimization of the number of false positive prediction errors. Experiment data generated by VIRTTEX, a hydraulically powered, 6-degrees-of-freedom moving base driving simulator at Ford Motor Company, were used. All the vehicle variables were sampled at 50 Hz and there were 16 drowsy drivers (about 3 hours of driving per subject) and six control drivers (approximately 20 minutes f driving each). In total, 3,508 unintentional lane departures occurred for the drowsy drivers and 23 for the control drivers. Our study involving these 22 drivers with a total of more than 7.5 million prediction decisions demonstrates that (a) excellent SVM prediction performance, measured by numbers of false positives (i.e., falsely predicted lane departures) and false negatives (i.e., lane departures failed to be predicted), was achieved when the prediction horizon was 0.6 seconds or less, (b) lateral position and lateral velocity worked the best as SVM input variables among the nine variable sets that we explored, and (c) the radial basis function performed the best as the SVM kernel function.     

基于单目视觉的区域交通智能车辆道路边界检测方法研究

基于单目视觉的道路边界检测由于其在车辆辅助驾驶系统中的重要应用价值成为当前计算机视觉和智能车辆领域最为活跃的研究课题之一。指出图像边缘检测现有算法的不足,采用领域平均法对图像进行平滑处理,根据图像的边缘特征运用Prewitt算子实现边缘增强,以获取精确的边缘信息。使用最大熵算法分割二值化图像进一步减少噪声,从而得到良好的道路特征图像数据。利用道路约束条件,建立视觉系统动态感兴趣区域(DAOI),运用改进的Hough变换最终识别道路边界。试验结果表明:本文所述算法不仅能准确、实时检测出道路板边界,而且能有效地抑制噪声,为区域交通智能车辆的换道和超车提供研究基础。     

1种基于平行直线对模型的车道检测方法

针对智能车辆安全辅助驾驶系统中利用单目视觉进行车道识别的问题,提出了1种基于平行直线对模型的车道检测方法。该方法根据高速公路图像特征构建平行直线对模型,在此基础上先利用 Hough变换提取直线,再由改进的级联 Hough变换检测出平行直线对的消失点,最后通过消失点和先验信息来提取当前车道线。使用M atlab对高速公路上不同路段、不同光照情况、不同车辆干扰下共150幅道路图像进行实验,检测精度达88.6%,平均检测时间为0.24 s。实验结果表明,这一方法在高速公路行驶环境下能较准确地检测出当前车道线,具有很好的光照适应性、抗车辆干扰性和一定的实时性。      

智能交通系统中基于机器视觉的数字车辆控制

在描述成像模型与视觉坐标系的基础上，给出了基于计算机视觉的车道与障碍物辨识检测算法，应用预瞄转向以及车辆控制等技术手段来实现数字车辆的道路跟踪。     

Vehicle dynamics and road curvature estimation for lane departure warning system using robust fuzzy observers: experimental validation

This paper describes a new approach to estimate vehicle dynamics and the road curvature in order to detect vehicle lane departures. This method has been evaluated through an experimental set-up using a real test vehicle equipped with the RT2500 inertial measurement unit. Based on a robust unknown input fuzzy observer, the road curvature is estimated and compared to the vehicle trajectory curvature. The difference between the two curvatures is used by the proposed lane departure detection algorithm as the first driving risk indicator. To reduce false alarms and take into account driver corrections, a second driving risk indicator based on the steering dynamics is considered. The vehicle nonlinear model is deduced from the vehicle lateral dynamics and road geometry and then represented by an uncertain Takagi–Sugeno fuzzy model. Taking into account the unmeasured variables, an unknown input fuzzy observer is proposed. Synthesis conditions of the proposed fuzzy observer are formulated in terms of linear matrix inequalities using the Lyapunov method.