CN102486378A - 一种行车轨迹警示方法与导航装置 - Google Patents

一种行车轨迹警示方法与导航装置 Download PDF

Info

Publication number
CN102486378A
CN102486378A CN2010105715229A CN201010571522A CN102486378A CN 102486378 A CN102486378 A CN 102486378A CN 2010105715229 A CN2010105715229 A CN 2010105715229A CN 201010571522 A CN201010571522 A CN 201010571522A CN 102486378 A CN102486378 A CN 102486378A
Authority
CN
China
Prior art keywords
data points
fix data
theta
abs
calculating
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN2010105715229A
Other languages
English (en)
Other versions
CN102486378B (zh
Inventor
李东明
滕玮
吕启明
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Ambit Microsystems Shanghai Ltd
Original Assignee
Ambit Microsystems Shanghai Ltd
Hon Hai Precision Industry Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Ambit Microsystems Shanghai Ltd, Hon Hai Precision Industry Co Ltd filed Critical Ambit Microsystems Shanghai Ltd
Priority to CN201010571522.9A priority Critical patent/CN102486378B/zh
Priority to US12/979,367 priority patent/US8538690B2/en
Publication of CN102486378A publication Critical patent/CN102486378A/zh
Application granted granted Critical
Publication of CN102486378B publication Critical patent/CN102486378B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/52Determining velocity
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/34Route searching; Route guidance
    • G01C21/3407Route searching; Route guidance specially adapted for specific applications
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/34Route searching; Route guidance
    • G01C21/36Input/output arrangements for on-board computers
    • G01C21/3697Output of additional, non-guidance related information, e.g. low fuel level

Abstract

一种行车轨迹警示方法,适用于导航装置,所述方法包括:经由所述导航装置中的导航模块取得多个定位数据点;计算取得对应所述多个定位数据点之多个偏角与多个平均速度;根据所述多个平均速度计算取得所述多个定位数据点的多个最大偏角;当其中一个定位数据点的最大偏角大于其偏角时,将异常驾驶次数加1;以及当所述异常驾驶次数大于预设临界值时,发出驾驶异常警示。上述的行车轨迹警示方法自动发出安全驾驶提示给驾驶员,从而减少交通事故的发生,并提高汽车行驶安全。

Description

一种行车轨迹警示方法与导航装置
技术领域
本发明涉及一种导航装置,尤其涉及一种导航装置的行车轨迹警示方法。
背景技术
当汽车行驶在弯道上时,对弯道最小半径的界限实质是汽车行驶在公路曲线部分时,所产生的离心力等横向力不超过轮胎与路面的摩阻力所允许的上限。当拐弯(包括直道拐弯和弯道拐弯)时,拐弯的弯曲半径都不能小于弯道最小半径的上限,否则车辆将发生滑移或者倾覆而造成交通事故。
驾驶员在饮酒后或疲劳等不安全状态下驾车时,汽车的行驶轨迹通常会是S型,即车辆在行驶中会频繁地出现拐弯的状况,如何通过一种安全辅助系统来避免或减少意外事故的发生,将是一门重要的课题。
现有技术揭示了一种红外眼球扫描仪,当镜头对准驾驶员的眼球时,扫描仪就会连续发出红外线来扫描眼球中的眼白部分,从而判断驾驶员的疲劳程度。然而,红外线照射人眼会导致眼球损伤。
现有技术又揭示了一种影像辨别装置,利用视讯影像处理技术对驾驶员的人眼进行定位,并对眼皮的张开与闭合进行判断。但所述技术很容易受环境干扰而出现误差。
现有技术更揭示了一种血压辨别装置,用于侦测驾驶员的血压是否有不正常来判断司机的身体状况。然而,由于佩戴麻烦,且有时驾驶员的生理现象会因为许多不明因素而有误判的状况。
发明内容
有鉴于此,需提供一种行车轨迹警示方法。
同时,还需提供一种使用所述行车轨迹警示方法的导航装置。
一种行车轨迹警示方法,适用于导航装置,包括经由所述导航装置中的导航模块取得多个定位数据点;计算取得对应所述多个定位数据点之多个偏角与多个平均速度;根据所述多个平均速度计算取得所述多个定位数据点的多个最大偏角;当其中一个定位数据点的最大偏角大于其偏角时,将异常驾驶次数加1;以及当所述异常驾驶次数大于预设临界值时,发出驾驶异常警示。
在上述的行车轨迹警示方法中,取得所述多个定位数据点之步骤更包括自所述多个定位数据点取得多个地面速度与多个地面方向,用于计算取得所述多个偏角与所述多个平均速度。
一种行车轨迹警示方法,适用于导航装置,包括利用所述导航装置中的导航模块执行定位操作;经由所述导航模块取得第一定位数据点与第二定位数据点;根据所述第一与第二定位数据点计算取得所述第二定位数据点之第二平均速度与第二偏角;根据所述第二平均速度计算所述第二定位数据点之第二最大偏角;当所述第二最大偏角大于所述第二偏角时,将异常驾驶次数加1;以及当所述异常驾驶次数大于预设临界值时,发出驾驶异常警示。
上述的行车轨迹警示方法中更包括自所述第一定位数据点撷取第一地面速度;自所述第二定位数据点撷取第二地面速度;以及根据所述第一与第二地面速度计算取得所述第二平均速度。
上述的行车轨迹警示方法中更包括自所述第一定位数据点撷取第一地面方向;自所述第二定位数据点撷取第二地面方向;以及根据所述第一与第二地面方向计算取得所述第二偏角。
上述的行车轨迹警示方法中更包括利用下列公式计算所述第二最大偏角:
α = 127 × ( μ + i ) × 180 V ‾ × π ,
其中,α表示所述第二最大偏角,
Figure BDA0000035879270000022
表示所述第二平均速度,μ表示横向力系数、i表示横向坡度,而π表示圆周率。
上述的行车轨迹警示方法中更包括利用下列公式计算所述第二偏角:
&alpha; k = ABS ( &theta; k - &theta; k - 1 ) ABS ( &theta; k - &theta; k - 1 ) < 90 ABS ( ABS ( &theta; k - &theta; k - 1 ) - 360 ) ABS ( &theta; k - &theta; k - 1 ) > 90 ,
其中,αk表示所述第二偏角,ABS表示绝对值函数,θk-1与θk分别表示所述第一与第二地面方向,而k=2、3、...、N。
本发明实施方式中的导航装置包括导航模块、导航系统、计算模块、判断模块以及输出装置。所述导航模块用于产生多个定位数据点。所述导航系统用于自所述导航模块取得所述多个定位数据点。所述计算模块用于计算取得对应所述多个定位数据点之多个偏角与多个平均速度。所述判断模块用于根据所述多个平均速度计算取得所述多个定位数据点的多个最大偏角,当其中一个定位数据点的最大偏角大于其偏角时,将异常驾驶次数加1,以及当所述异常驾驶次数大于预设临界值时,发出驾驶异常警示。输出装置用于显示所述驾驶异常警示。
上述的导航装置更包括解析模块,用于自所述多个定位数据点取得多个地面速度与多个地面方向,并且计算取得所述多个偏角与所述多个平均速度。
本发明实施方式中的导航装置包括导航模块、导航系统、计算模块、判断模块以及输出装置。所述导航模块用于执行一定位操作并产生第一定位数据点与第二定位数据点。所述导航系统用于自所述导航模块取得所述第一与第二定位数据点。所述计算模块用于根据所述第一与第二定位数据点计算取得所述第二定位数据点之第二平均速度与第二偏角。所述判断模块用于根据所述第二平均速度计算所述第二定位数据点之第二最大偏角,当所述第二最大偏角大于所述第二偏角时,将异常驾驶次数加1,以及当所述异常驾驶次数大于预设临界值时,发出驾驶异常警示。输出装置用于显示所述驾驶异常警示。
上述的导航装置更包括解析模块,所述解析模块自所述第一定位数据点撷取第一地面速度,以及自所述第二定位数据点撷取第二地面速度,其中所述计算模块根据所述第一与第二地面速度计算取得所述第二平均速度。
上述的导航装置更包括解析模块,其中所述解析模块自所述第一定位数据点撷取一第一地面方向,以及自所述第二定位数据点撷取一第二地面方向;所述计算模块根据所述第一与第二地面方向计算取得所述第二偏角。
上述的导航装置更包括所述判断模块利用下列公式计算所述第二最大偏角:
&alpha; = 127 &times; ( &mu; + i ) &times; 180 V &OverBar; &times; &pi; ,
其中,α表示所述第二最大偏角,
Figure BDA0000035879270000041
表示所述第二平均速度,μ表示横向力系数、i表示横向坡度,而π表示圆周率。
上述的导航装置更包括所述计算模块利用下列公式计算所述第二偏角:
&alpha; k = ABS ( &theta; k - &theta; k - 1 ) ABS ( &theta; k - &theta; k - 1 ) < 90 ABS ( ABS ( &theta; k - &theta; k - 1 ) - 360 ) ABS ( &theta; k - &theta; k - 1 ) > 90 ,
其中,αk表示所述第二偏角,ABS表示绝对值函数,θk-1与θk分别表示所述第一与第二地面方向,而k=2、3、...、N。
上述的行车轨迹警示方法与使用所述行车轨迹警示方法的导航装置,通过分析全球定位系统(Global Positioning System,以下简称为GPS)产生的数据来计算经纬度数值、地面速度(Speed over Ground)和地面方向(Courseover Ground)来分析汽车行驶的轨迹路线。当出现拐弯半径小于规定值时,自动发出安全驾驶提示给驾驶员,从而减少交通事故的发生,提高汽车行驶安全。
附图说明
图1是包括本发明之一种实施方式之计算偏角和平均速度以产生角度速度表的方法流程图。
图2是包括本发明之一种实施方式之行车轨迹警示方法的方法流程图。
图3是汽车行驶的轨迹曲线示意图。
图4是本发明之一种实施方式之导航装置的模块架构示意图。
主要元件符号说明
导航装置        400
GPS导航系统     410
GPS模块         420
存储装置        430
解析模块        440
计算模块        450
判断模块        460
输出装置            470
具体实施方式
本发明一种实施方式之行车轨迹警示方法系克服现有技术的不足,提供一种能根据汽车行驶之地面方向偏移的大小,对疲劳驾驶进行智能提醒。本发明方法可以应用在现有的导航装置上,所述方法可以软件方式来实现,而不需增加额外的硬件成本。
本发明一种实施方式之行车轨迹警示方法包括:(1)对GPS定位信息的读取和解析,以计算GPS数据点的偏角和平均速度;以及(2)根据汽车行驶中之地面方向偏移的大小来判断驾驶员是否有疲劳驾驶。
图1是包括本发明之一种实施方式之计算偏角和平均速度以产生角度速度表的方法流程图。
首先,启动并初始化导航装置中的GPS导航系统(k=1,表示指向角度速度表L的第1条记录),并且通过所述导航装置中的GPS模块进行定位(步骤S101)。GPS导航系统的启动方式包括热启动、冷启动或暖启动。GPS导航系统每隔固定间隔时间,例如1秒,或固定距离,例如100公尺,自GPS模块取得美国国家海洋电子学会(National Marine Electronics Association,以下简称为NMEA)数据点。预设在所述固定间隔时间/距离内,总共要取得N个NMEA数据点。
需注意到,N的大小跟行车速度与路况有关。因此,根据不同的行车速度与路况,GPS导航系统会自动设定N的值,其操作细节不在本文中赘述,且不用于限定本发明。
当接收第k个NMEA数据点时(步骤S102),对所述NMEA数据点进行解析,以判断第k个NMEA数据点是否有效(步骤S103),k=1、2、...、N。
所述解析操作系读取第k个NMEA数据点的GPS建议最小传输数据(Global Position Recommended Minimum Specific,以下简称为GPRMC)语句(Sentence)来判断第k个NMEA数据点是否有效。GPRMC语句分为12个字段(Field),如下所示:
  <1>  世界标准时间(Coordinated Universal Time,UTC):格式=
  hhmmss.sss(时时分分秒秒.秒秒秒)
  <2>   定位状态:A=有效定位;V=无效定位
  <3>   纬度:格式=ddmm.mmmm(度度分分.分分分)
  <4>   纬度区分:N=北半球;S=南半球
  <5>   经度:格式=dddmm.mmmm(度度分分.分分分)
  <6>   经度区分:E=东经;W=西经
  <7>   地面速度:0.0~1851.8节(knots)
  <8>   地面方向:000.0~359.9度
  <9>   UTC日期:格式=ddmmyy(日日月月年年)
  <10>   磁极变量(磁偏角):000.0~180.0度
  <11>   磁方位角:E(东)或W(西)
  <12>   模式指示
其中,GPRMC语句中的第<2>字段用于判断读取到的NMEA数据点是否有效。
若所述NMEA数据点有效,则从GPRMC语句中的第<7>、<8>字段撷取第k个NMEA数据点的地面速度Vk与地面方向θk(步骤S104)。若无效,则回到步骤S12,继续取得下一个NMEA数据点。将第k个NMEA数据点中记录的的地面速度Vk与地面方向θk记录到角度速度表L中(步骤S105)。
判断角度速度表L中是否已记录了N个NMEA数据点(k=N?)(步骤S106)。若否,则令k=k+1(步骤S107)以继续读取下一个NMEA数据点,并重复执行步骤S102~S106,以取得和记录剩余NMEA数据点的地面速度Vk与地面方向θk到角度速度表L中。
当角度速度表L中已记录了N个NMEA数据点时,开始计算从第2个点到第N个点的实际偏角和平均速度,故设定k=2(表示指向角度速度表L中的第2条纪录)(步骤S108),并且计算第k个NMEA数据点的偏角αk(步骤S109)。第k个NMEA数据点的实际偏角等于第k个NMEA数据点的地面方向与第k-1个NMEA数据点的地面方向的夹角,可利用下文中的夹角公式(7)计算。接着,计算第k个NMEA数据点的平均速度
Figure BDA0000035879270000061
(步骤S110)。第k个NMEA数据点的平均速度等于第k个NMEA数据点之地面速度和第k-1个NMEA数据点之地面速度的平均值。把第k个NMEA数据点的实际偏角αk和平均速度
Figure BDA0000035879270000071
记录到角度速度表L中的第k条记录中(步骤S111)。判断是否已对所有NMEA数据点完成计算(即,k=N?)(步骤S112)。
若还有NMEA数据点未完成计算,则令k=k+1(步骤S113),并重复执行步骤S109~S111,以计算剩下NMEA数据点的实际偏角和平均速度,并且记录到角度速度表L中(总共有N-1条记录)。若所有NMEA数据点都已完成计算,则结束本流程,并且接着执行图2的方法流程。
图2是包括本发明之一种实施方式之行车轨迹警示方法的方法流程图,用于判断是否发生驾驶异常。
初始设定包括设定驾驶异常次数S=0且k=2。读取第k个NMEA数据点的偏角αk和平均速度(步骤S201),并且根据第k个NMEA数据点的平均速度来计算其最大偏角(步骤S202)。判断第k个NMEA数据点的实际偏角αk是否大于其最大偏角α(步骤S203)。若实际偏角αk大于其最大偏角α,则将异常驾驶次数加1(S=S+1)(步骤S204)。
不论第k个NMEA数据点的实际偏角是否大于其最大偏角,下一步骤都要判断是否已对所有NMEA数据点完成计算,即判断k是否等于N(步骤S205)。若还有NMEA数据点未完成计算,则令k=k+1(步骤S206),并重复执行步骤S201~S205。
当N个NMEA数据点完成计算之后,判断异常驾驶次数S是否大于预设界限值M(步骤S207)。在本发明一种实施方式中,界限值M预设为3。若异常驾驶次数S大于界限值M,则发出驾驶异常警示(步骤S208),以提醒驾驶员注意安全。
当已发出驾驶异常警示,或者未发生驾驶异常,即S<M,则重复第1、2图的操作步骤,以继续收集下一轮的N个NMEA数据点,并且进行分析与判断操作(步骤S209)。
下文说明公路工程技术标准的弯道半径界限公式。
参考中华人民共和国交通部2004年01月29日发布的「公路工程技术标准」(JTGB01-2003),车辆在弯道上行驶的受力状况可根据公式(1)得到:
R = V &OverBar; 2 127 &times; ( &mu; + i ) . . . . . . ( 1 ) ,
其中,R为弯曲半径(m),为车辆平均速度(km/h),μ为横向力系数,而i为路面的横向坡度。此外,界限值为路面与轮胎之间的横向摩擦阻力系数。
当汽车的拐弯半径小于界限值时,可能发生滑移或者倾覆,造成交通事故。所以,在直道或弯道上行驶时,汽车的拐弯半径小于这个界限值将被判定为不安全的拐弯。
下文说明由GPS数据分析车辆拐弯是否安全。
如图3所示,在汽车行驶的轨迹曲线中,每隔一秒标记一个分析点,也就是GPS数据点(即,NMEA数据点)。连续两个GPS数据点上,如果地面方向值有变化,则在这1秒内汽车的轨迹一定是曲线,也就是汽车有拐弯。因此,可通过分析这段曲线的弯曲程度来判定这个拐弯是否安全。
根据研究数据,行驶中的汽车其重心的轨迹在几何性质上有以下特征:
(1)轨迹是连续且圆滑的;
(2)曲率是连续的,任一点不出现两个曲率值;以及
(3)曲率变化是连续的,任一点不出现两个曲率变化率值。
在短距离内,汽车的行驶轨迹线可以被认为是平面线,其是由直线、圆曲线和缓和曲线组成。缓和曲线定义为“『设置在直线和圆曲线之间』或『半径相差较大的两个转向相同的圆曲线之间』的一种曲率连续变化的曲线”。通过分析圆曲线的弯曲程度,就可以分析平面线的弯曲程度。所以,在短距离内,经由分析轨迹曲线中的圆曲线弯曲程度,来分析汽车行驶的轨迹曲线的弯曲程度。
在2个GPS数据点之间,例如,在车辆行驶1秒,因为汽车的惯性作用,可以假设在1秒之内车辆的轨迹是一个恒定半径的弧线。
在几何数学中,圆曲线的弧长公式为:
l = &theta; &times; &pi; &times; r 180 . . . . . . ( 2 ) ,
其中,θ为圆心角(度),而r为圆半径(m)。
根据公式(2),在已知弧长时,可得圆半径公式如下:
r = l &times; 180 &theta; &times; &pi; . . . . . . ( 3 ) .
汽车行驶1秒所得弧长为其中
Figure BDA0000035879270000093
是相邻两个GPS数据点之间的地面速度平均值。将弧长带入公式(3)可得如下公式:
r = V &OverBar; &times; 180 &theta; &times; &pi; . . . . . . ( 4 ) .
根据几何数学定理,弧线AB的圆心角为θ,弧线上的A、B两点的切线方向夹角是αk,故可得到θ=αk。因此,公式(4)可改写成如下公式:
r = V &OverBar; &times; 180 &alpha; k &times; &pi; . . . . . . ( 5 ) ,
其中,αk是相邻两个GPS数据点的地面方向夹角。
汽车在拐弯时,如果r<R,则有可能发生滑移或者倾覆。因此,根据公式(1)和(5)可得下列公式:
V &OverBar; &times; 180 &alpha; k &times; &pi; < V &OverBar; 2 127 &times; ( &mu; + i ) &RightArrow; &alpha; k > 127 &times; ( &mu; + i ) &times; 180 V &OverBar; &times; &pi; . . . . . . ( 6 ) .
因此,如果相邻两GPS数据点的地面方向夹角大于
Figure BDA0000035879270000097
则所述拐弯为不安全拐弯,否则为安全拐弯。
下文说明对横向力系数(μ)和路面的横向坡度(i)的数值分析。
在公路工程技术标准中,针对不同的要求定义公式(1)中的系数μ和i的值。
要求1:极限最小半径(Limited Minimum Radius)
极限最小半径是路线设计中各级公路所能允许的极限值。极限最小半径之横向力系数μ及横向坡度i的设置如下所示:
  汽车速度(km/h)   120   100   80   60   40   30   20
  μ   0.10   0.11   0.12   0.13   0.14   0.15   0.16
  i(%)   8   8   8   8   8   8   8
要求2:最小曲线半径(Minimum Radius of Curve)
公路工程技术标准中又规定了最小曲线半径,其横向力系数μ及横向坡度i的设置如下所示:
  汽车速度(km/h)  120   100   80   60   40   30   20
  μ   0.05   0.05   0.06   0.06   0.06   0.05   0.05
  i(%)   6   6   7   8   7   6   6
要求3:不设超高的最小圆曲线半径
当弯道路线某一半径大于一定值时,即使汽车在圆曲线外侧行驶也能获得足够的安全性和很好的舒适性。在此种情况下,在弯道路面不设超高,路拱为双向横坡度。又,二级及以上等级公路之路拱的横向坡度设置为i=-0.02~-0.01,二级以下公路之路拱的横向坡度设置为i=-0.04~-0.03,而横向力系数μ的设置为μ=0.035~0.06。此外,直线段公路的路拱亦为双向横坡度,其坡度值与不设超高的弯道横向坡度值相同。
公路工程的弯道设计一般参照上述最小曲线半径,同时为了保证算法的灵敏度,利用表(3)来确定公式(6)中的系数μ和i。
下文说明相邻两个GPS数据点之地面方向夹角的计算。
汽车在持续前行中,1秒之内拐弯角度只可能小于90度。假设θk-1和θk是相邻两个GPS数据点的地面方向值,则GPS数据点k的地面方向夹角αk可利用如下公式计算:
&alpha; k = ABS ( &theta; k - &theta; k - 1 ) ABS ( &theta; k - &theta; k - 1 ) < 90 ABS ( ABS ( &theta; k - &theta; k - 1 ) - 360 ) ABS ( &theta; k - &theta; k - 1 ) > 90 . . . . . . ( 7 ) ,
其中,ABS是绝对值函数,k=2、3、...、N。
图4是本发明之一种实施方式之导航装置的模块架构示意图。
本发明一种实施方式之导航装置400包括GPS导航系统410、GPS模块420、存储装置430、解析模块440、计算模块450、判断模块460以及输出装置470。
在启动导航装置400时,GPS导航系统410执行初始化操作,并且令GPS模块420进行定位。GPS导航系统410每隔固定间隔时间或距离,自GPS模块420取得N个GPS(NMEA)数据点,并且将所述些数据点存储在存储装置430的角速度表L中。
解析模块440对每一个GPS数据点进行解析,并且根据某一个GPS数据点中的GPRMC数据判断其有效时,自所述GPRMC数据撷取地面速度Vk与地面方向θk。解析模块440将自每一个GPS数据点取得的地面速度Vk与地面方向θk都存放在存储装置430的角速度表L中。
当已记录N个GPS数据点的GPRMC数据时,计算模块450分别计算所有GPS数据点的实际偏角αk和平均速度Vk,并且记录到存储装置430的角速度表L中。
判断模块460依序自角速度表L读取每一个GPS数据点的实际偏角αk和平均速度Vk,以计算每一个GPS数据点的最大偏角,并且记录到存储装置430的角速度表L中。接着,判断模块460对每一个GPS数据点判断其实际偏角是否大于其最大偏角,若是,则异常驾驶次数S加1。当对每一个GPS数据点都执行完判断操作后,判断模块460将累计的异常驾驶次数S与预设界限值M,例如,M=3相比,并且在异常驾驶次数S大于界限值M时,传送驾驶异常警示至输出装置470,以提醒驾驶员注意安全。
需注意到,输出装置470可为导航装置400的屏幕或扬声器,而所述驾驶异常警示可为影像、文字或语音。
本发明一种实施方式的行车轨迹警示方法的优点包括:(1)结合现有的GPS导航装置,其可以软件的方式实现,不需要添加任何额外的硬件成本;(2)算法不会复杂,不影响系统效能,非常适合在嵌入式设备上运行;以及(3)不需要驾驶员的主动配合。

Claims (16)

1.一种行车轨迹警示方法,适用于导航装置,其特征在于,所述行车轨迹警示方法包括:
经由所述导航装置中的导航模块取得多个定位数据点;
计算取得对应所述多个定位数据点之多个偏角与多个平均速度;
根据所述多个平均速度计算取得所述多个定位数据点的多个最大偏角;
当其中一个定位数据点的最大偏角大于其偏角时,将异常驾驶次数加1;以及
当所述异常驾驶次数大于预设临界值时,发出驾驶异常警示。
2.如权利要求1所述之行车轨迹警示方法,其特征在于,取得所述多个定位数据点之步骤更包括自所述多个定位数据点取得多个地面速度与多个地面方向,用于计算取得所述多个偏角与所述多个平均速度。
3.一种行车轨迹警示方法,适用于导航装置,其特征在于,所述行车轨迹警示方法包括:
利用所述导航装置中的导航模块执行定位操作;
经由所述导航模块取得第一定位数据点与第二定位数据点;
根据所述第一与第二定位数据点计算取得所述第二定位数据点之第二平均速度与第二偏角;
根据所述第二平均速度计算所述第二定位数据点之第二最大偏角;
当所述第二最大偏角大于所述第二偏角时,将异常驾驶次数加1;以及
当所述异常驾驶次数大于预设临界值时,发出驾驶异常警示。
4.如权利要求3所述之行车轨迹警示方法,其特征在于,更包括下列步骤:
自所述第一定位数据点撷取第一地面速度;
自所述第二定位数据点撷取第二地面速度;以及
根据所述第一与第二地面速度计算取得所述第二平均速度。
5.如权利要求3所述之行车轨迹警示方法,其特征在于,更包括下列步骤:
自所述第一定位数据点撷取第一地面方向;
自所述第二定位数据点撷取第二地面方向;以及
根据所述第一与第二地面方向计算取得所述第二偏角。
6.如权利要求3所述之行车轨迹警示方法,其特征在于,更包括当取得其中一个定位数据点时,根据定位状态判断所述取得之定位数据点是否有效。
7.如权利要求3所述之行车轨迹警示方法,其特征在于,利用下列公式计算所述第二最大偏角:
&alpha; = 127 &times; ( &mu; + i ) &times; 180 V &OverBar; &times; &pi; ,
其中,α表示所述第二最大偏角,
Figure FDA0000035879260000022
表示所述第二平均速度,μ表示一横向力系数、i表示一横向坡度,π表示圆周率。
8.如权利要求3所述之行车轨迹警示方法,其特征在于,利用下列公式计算所述第二偏角:
&alpha; k = ABS ( &theta; k - &theta; k - 1 ) ABS ( &theta; k - &theta; k - 1 ) < 90 ABS ( ABS ( &theta; k - &theta; k - 1 ) - 360 ) ABS ( &theta; k - &theta; k - 1 ) > 90 ,
其中,αk表示所述第二偏角,ABS表示绝对值函数,θk-1与θk分别表示所述第一与第二地面方向,k=2、3、...、N。
9.一种导航装置,其特征在于包括:
导航模块,其用于产生多个定位数据点;
导航系统,其用于自所述导航模块取得所述多个定位数据点;
计算模块,其用于计算取得对应所述多个定位数据点之多个偏角与多个平均速度;
判断模块,其用于根据所述多个平均速度计算取得所述多个定位数据点的多个最大偏角,当其中一个定位数据点的最大偏角大于其偏角时,将异常驾驶次数加1,以及当所述异常驾驶次数大于预设临界值时,发出驾驶异常警示;以及
输出装置,其用于显示所述驾驶异常警示。
10.如权利要求9所述之导航装置,其特征在于,更包括一解析模块,用于自所述多个定位数据点取得多个地面速度与多个地面方向,并且计算取得所述多个偏角与所述多个平均速度。
11.一种导航装置,其特征在于,包括:
导航模块,其用于执行一定位操作并产生第一定位数据点与第二定位数据点;
导航系统,其用于自所述导航模块取得所述第一与第二定位数据点;
计算模块,其用于根据所述第一与第二定位数据点计算取得所述第二定位数据点之第二平均速度与第二偏角;
判断模块,其用于根据所述第二平均速度计算所述第二定位数据点之第二最大偏角,当所述第二最大偏角大于所述第二偏角时,将异常驾驶次数加1,以及当所述异常驾驶次数大于预设临界值时,发出驾驶异常警示;以及
输出装置,其用于显示所述驾驶异常警示。
12.如权利要求11所述之导航装置,其特征在于,更包括一解析模块,所述解析模块自所述第一定位数据点撷取第一地面速度,以及自所述第二定位数据点撷取第二地面速度,其中所述计算模块根据所述第一与第二地面速度计算取得所述第二平均速度。
13.如权利要求11所述之导航装置,其特征在于,更包括一解析模块,其中所述解析模块自所述第一定位数据点撷取一第一地面方向,以及自所述第二定位数据点撷取一第二地面方向;所述计算模块根据所述第一与第二地面方向计算取得所述第二偏角。
14.如权利要求11所述之导航装置,其特征在于,当取得其中定位数据点时,所述导航系统根据定位状态判断所述取得之定位数据点是否有效。
15.如权利要求11所述之导航装置,其特征在于,所述判断模块利用下列公式计算所述第二最大偏角:
&alpha; = 127 &times; ( &mu; + i ) &times; 180 V &OverBar; &times; &pi; ,
其中,α表示所述第二最大偏角,
Figure FDA0000035879260000042
表示所述第二平均速度,μ表示一横向力系数、i表示一横向坡度,而π表示圆周率。
16.如权利要求11所述之导航装置,其特征在于,所述计算模块利用下列公式计算所述第二偏角:
&alpha; k = ABS ( &theta; k - &theta; k - 1 ) ABS ( &theta; k - &theta; k - 1 ) < 90 ABS ( ABS ( &theta; k - &theta; k - 1 ) - 360 ) ABS ( &theta; k - &theta; k - 1 ) > 90 ,
其中,αk表示所述第二偏角,ABS表示绝对值函数,θk-1与θk分别表示所述第一与第二地面方向,而k=2、3、...、N。
CN201010571522.9A 2010-12-03 2010-12-03 一种行车轨迹警示方法与导航装置 Active CN102486378B (zh)

Priority Applications (2)

Application Number Priority Date Filing Date Title
CN201010571522.9A CN102486378B (zh) 2010-12-03 2010-12-03 一种行车轨迹警示方法与导航装置
US12/979,367 US8538690B2 (en) 2010-12-03 2010-12-28 Vehicle tracking detection and alarm method and navigation device using the method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201010571522.9A CN102486378B (zh) 2010-12-03 2010-12-03 一种行车轨迹警示方法与导航装置

Publications (2)

Publication Number Publication Date
CN102486378A true CN102486378A (zh) 2012-06-06
CN102486378B CN102486378B (zh) 2014-08-20

Family

ID=46151901

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201010571522.9A Active CN102486378B (zh) 2010-12-03 2010-12-03 一种行车轨迹警示方法与导航装置

Country Status (2)

Country Link
US (1) US8538690B2 (zh)
CN (1) CN102486378B (zh)

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104992554A (zh) * 2015-07-18 2015-10-21 成都生辉电子科技有限公司 一种拼车系统异常信息监控方法
CN105070038A (zh) * 2015-07-18 2015-11-18 成都生辉电子科技有限公司 一种公共交通运营监控方法
CN105491531A (zh) * 2014-09-16 2016-04-13 钛马信息网络技术有限公司 基于Hadoop的车主行车轨迹获取系统及方法
CN106094823A (zh) * 2016-06-29 2016-11-09 北京奇虎科技有限公司 汽车危险驾驶行为的处理方法及系统
CN108133317A (zh) * 2017-12-20 2018-06-08 长安大学 一种山区高速公路平纵组合安全水平的评价方法
CN110487285A (zh) * 2019-08-27 2019-11-22 湖北亿咖通科技有限公司 一种车辆低速转弯时的路径规划控制方法和电子设备
CN111260167A (zh) * 2018-11-30 2020-06-09 北京嘀嘀无限科技发展有限公司 订单服务安全性检测方法、装置、电子设备及存储介质

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4463347A (en) * 1980-09-22 1984-07-31 Nissan Motor Company, Ltd. Drowsiness alarm system for a vehicle
US5925082A (en) * 1996-02-12 1999-07-20 Honda Giken Kogyo Kabushiki Kaisha Vehicle steering control system with driver alertness determination
US20050206562A1 (en) * 2004-03-17 2005-09-22 Willson Corey M GPS interface for locating device
US20090326809A1 (en) * 2003-10-06 2009-12-31 Colley Jaime B System and method for augmenting a satellite-based navigation solution

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5798695A (en) * 1997-04-02 1998-08-25 Northrop Grumman Corporation Impaired operator detection and warning system employing analysis of operator control actions
WO2007047414A2 (en) * 2005-10-12 2007-04-26 The Penn State Research Foundation Vigilance monitoring technique for vehicle operators

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4463347A (en) * 1980-09-22 1984-07-31 Nissan Motor Company, Ltd. Drowsiness alarm system for a vehicle
US5925082A (en) * 1996-02-12 1999-07-20 Honda Giken Kogyo Kabushiki Kaisha Vehicle steering control system with driver alertness determination
US20090326809A1 (en) * 2003-10-06 2009-12-31 Colley Jaime B System and method for augmenting a satellite-based navigation solution
US20050206562A1 (en) * 2004-03-17 2005-09-22 Willson Corey M GPS interface for locating device

Cited By (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105491531A (zh) * 2014-09-16 2016-04-13 钛马信息网络技术有限公司 基于Hadoop的车主行车轨迹获取系统及方法
CN105491531B (zh) * 2014-09-16 2019-04-12 钛马信息网络技术有限公司 基于Hadoop的车主行车轨迹获取系统及方法
CN104992554A (zh) * 2015-07-18 2015-10-21 成都生辉电子科技有限公司 一种拼车系统异常信息监控方法
CN105070038A (zh) * 2015-07-18 2015-11-18 成都生辉电子科技有限公司 一种公共交通运营监控方法
CN104992554B (zh) * 2015-07-18 2020-11-20 太仓市简汇信息技术有限公司 一种拼车系统异常信息监控方法
CN105070038B (zh) * 2015-07-18 2020-11-24 太仓市简汇信息技术有限公司 一种公共交通运营监控方法
CN106094823A (zh) * 2016-06-29 2016-11-09 北京奇虎科技有限公司 汽车危险驾驶行为的处理方法及系统
CN108133317A (zh) * 2017-12-20 2018-06-08 长安大学 一种山区高速公路平纵组合安全水平的评价方法
CN111260167A (zh) * 2018-11-30 2020-06-09 北京嘀嘀无限科技发展有限公司 订单服务安全性检测方法、装置、电子设备及存储介质
CN111260167B (zh) * 2018-11-30 2022-08-30 北京嘀嘀无限科技发展有限公司 订单服务安全性检测方法、装置、电子设备及存储介质
CN110487285A (zh) * 2019-08-27 2019-11-22 湖北亿咖通科技有限公司 一种车辆低速转弯时的路径规划控制方法和电子设备

Also Published As

Publication number Publication date
CN102486378B (zh) 2014-08-20
US8538690B2 (en) 2013-09-17
US20120143494A1 (en) 2012-06-07

Similar Documents

Publication Publication Date Title
CN102486378A (zh) 一种行车轨迹警示方法与导航装置
EP2926330B1 (en) Vehicle location estimation apparatus and vehicle location estimation method
CN105799512B (zh) 车辆超速提醒方法及系统
JP4888761B2 (ja) 仮想車線表示装置
JP2009140008A (ja) 危険走行情報提供装置、危険走行判定プログラム及び危険走行判定方法
EP2511891A1 (en) Driving behavior detecting method and device
JP2019091412A5 (zh)
JP4877773B2 (ja) 車両の走行制御システム
WO2012129418A2 (en) Driver assistance system
KR20170101758A (ko) 증강현실 헤드 업 디스플레이 내비게이션
US8718906B2 (en) Method for analyzing traffic flow at an intersection
JP4961934B2 (ja) 運転支援装置
CN107230389A (zh) 一种山区多弯路段安全预警系统及方法
CN107564296A (zh) 一种基于道路状况的车辆速度预警系统
JP2006343904A (ja) 運転支援装置
JP4985450B2 (ja) 情報提供装置、情報提供システム、車両及び情報提供方法
CN104424808A (zh) 一种导航提示方法及装置、导航系统
CN100510637C (zh) 导航系统的弯道安全预警及行车纪录方法
CN108195385A (zh) 一种结合地理特征的危险识别系统及方法
CN114523846A (zh) 驾驶员疲劳警报系统
CN111497870A (zh) 一种车辆越车道线行驶提醒装置及方法
CN111731314A (zh) 一种车辆驾驶许用速度确定方法、车载设备及存储介质
Chowdhury et al. Advanced Curve Speed Warning System using Standard GPS Technology and Road-level Mapping Information.
JP6260186B2 (ja) 安全運転度判定装置
JP2009294812A (ja) 危険走行情報提供システム及び危険走行判定方法

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant
TR01 Transfer of patent right

Effective date of registration: 20180226

Address after: Shanghai City, Songjiang Export Processing Zone South Road No. 1925

Patentee after: Ambit Microsystems (Shanghai) Co., Ltd.

Address before: 201613 Shanghai City, Songjiang District Songjiang Export Processing Zone South Road No. 1925

Co-patentee before: Hon Hai Precision Industry Co., Ltd.

Patentee before: Ambit Microsystems (Shanghai) Co., Ltd.

TR01 Transfer of patent right