CN103207402A - 导航轨迹推估系统及其推估方法 - Google Patents
导航轨迹推估系统及其推估方法 Download PDFInfo
- Publication number
- CN103207402A CN103207402A CN2012100093952A CN201210009395A CN103207402A CN 103207402 A CN103207402 A CN 103207402A CN 2012100093952 A CN2012100093952 A CN 2012100093952A CN 201210009395 A CN201210009395 A CN 201210009395A CN 103207402 A CN103207402 A CN 103207402A
- Authority
- CN
- China
- Prior art keywords
- time
- real
- several
- latitude
- speed
- 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
Links
Images
Landscapes
- Navigation (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明揭露了一种导航轨迹推估系统及其推估方法。此系统包含一接收模块、一处理模块以及一储存模块。接收模块藉由全球定位系统取得若干个定位经纬度及若干个实时时间。处理模块根据若干个定位经纬度中的若干个实时坐标及相对应于若干个实时坐标的若干个参考坐标计算实时速度和实时角度。处理模块根据相对应于该若干个定位经纬度的行车速度调整校正时间间隔。储存模块根据该校正时间间隔储存若干个参考坐标、若干个实时速度、若干个实时角度或若干个实时时间。
Description
技术领域
本发明有关于一种导航轨迹推估系统及其推估方法,特别有关于一种储存速度与角度以节省储存量,并有效地推估导航轨迹的导航轨迹推估系统及其推估方法。
背景技术
一般而言,全球定位系统定位信息可表示为下式:$GPGGA,01,02,03,04,05,06,07,08,09,M,10,M,11,12*hh。其中,01是代表世界标准时间(Coordinated Universal Time,UTC)时间,格式为hhmmss(时分秒);02是代表纬度,格式为ddmm.mmmm(度分);03是代表纬度半球,N代表北半球、S代表南半球;04是代表经度,格式为dddmm.mmmm(度分);05是代表经度半球,E代表东经、W代表西经;06是代表GPS状态,0为未定位、1为非差分定位、2为差分定位、6为正在估算;07代表正在使用解算位置的卫星数量(00~12);08代表水平精度因子(Horizontal Dilution Of Precision,HDOP),数值约0.5~99.9;09代表海拔高度(-9999.9~99999.9);10代表地球椭球面相对大地水平面的高度;11代表差分时间,也就是从最近一次接收到差分信号开始的秒数;12代表差分站识别编号(0000~1023)。
目前,导航装置可根据全球定位系统信息输出的格式来储存其定位信息,其导航轨迹的单元格式可自行于后制处理而成。然而,无论怎么修改储存量,以美国信息交换标准代码(American Standard Code for InformationInterchange,ASCII)来储存经纬度所需的位(Bit)仍比储存速度、角度所需的位来的大。
另外,为了纪录准确的轨迹,储存的时间可设定1秒储存一个导航点,但若是将经纬度等信息都储存的话,其储存量相当大。又,导航装置若设定每30秒储存一个导航点,则使用者可能于30秒内移动的路径皆未被储存,而造成误差过大。
如此一来,不仅储存量无法得以缩小,其写入内存的时间也得增加,相当耗电。同时,储存较占内存容量的经纬度,则限制了内存可储存的导航点多寡。因此,以需求来说,设计一个导航轨迹推估系统及其推估方法,已成市场应用上的一个刻不容缓的议题。
发明内容
鉴于上述问题,本发明的目的就是在提供一种导航轨迹推估系统及其推估方法,以解决先前储存量较大且可储存的导航点较少的问题。
根据本发明的目的,提出一种导航轨迹推估系统,其包含一接收模块、一处理模块以及一储存模块。其中,接收模块藉由全球定位系统取得若干个定位经纬度,及对应若干个定位经纬度的若干个实时时间。处理模块电性链接于接收模块,根据若干个定位经纬度中的若干个实时坐标及相对应于若干个实时坐标的若干个参考坐标,来计算若干个实时速度及若干个实时角度,并处理模块依据相对应于若干个定位经纬度的行车速度设定校正时间间隔。储存模块储存若干个参考坐标、若干个实时速度、若干个实时角度或若干个实时时间。
其中,处理模块根据若干个实时速度或若干个实时角度计算经纬度移动距离,且根据经纬度移动距离,以计算实时经纬度,并处理模块根据经纬度移动距离及若干个参考坐标推估若干个实时坐标,以显示一轨迹信息。
其中,接收模块设定接收频率或接收周期,且接收模块根据接收频率或接收周期取得若干个定位经纬度。
其中,储存模块根据校正时间间隔储存若干个参考坐标和若干个实时时间,或储存若干个实时时间、若干个实时速度和若干个实时角度其中之一者。
其中,当若干个实时速度小于最小速度时,接收模块藉由全球定位系统取得若干个定位经纬度,以校正取得实时坐标。
其中,处理模块根据校正时间间隔读取若干个定位经纬度,以计算实时速度,当若干个实时速度小于最小速度,且储存模块储存若干个定位经纬度大于最大储存量,则使储存模块停止储存。
根据本发明的目的,再提出一种导航轨迹推估方法,适用于一导航轨迹推估系统中,其包含下列步骤:利用接收模块藉由全球定位系统取得若干个定位经纬度及相对应于若干个定位经纬度的若干个实时时间;藉由处理模块根据若干个定位经纬度中的若干个实时坐标及相对应于若干个实时坐标的若干个参考坐标,以计算若干个实时坐标及若干个实时角度;藉由处理模块依据相对应于若干个定位经纬度的行车速度设定校正时间间隔;以及提供储存模块储存储存若干个参考坐标、若干个实时速度、若干个实时角度或若干个实时时间。
其中,此方法更包含提供处理模块根据若干个实时速度或若干个实时角度,来计算经纬度移动距离;以及利用处理模块根据经纬度移动距离及若干个参考坐标推估若干个实时坐标,以显示一轨迹信息。
其中,此方法更包含利用接收模块设定接收频率或接收周期;以及使用接收模块根据接收频率或接收周期取得若干个定位经纬度。
其中,此方法更包含提供储存模块根据校正时间间隔储存若干个参考坐标和若干个实时时间,或若干个实时时间、若干个实时速度和若干个实时角度其中之一者。
其中,此方法更包含当若干个实时速度小于最小速度时;以及透过接收模块藉由全球定位系统取得若干个定位经纬度,以校正若干个实时坐标。
其中,此方法更包含使用处理模块根据校正时间间隔控制储存模块储存若干个定位经纬度,以处理模块计算实时速度;透过处理模块分析实时速度小于最小速度时;提供储存模块储存若干个定位经纬度大于最大储存量;以及使储存模块停止储存。
综上所述,本发明的导航轨迹推估系统及其推估方法,可缩小储存量,以缩短写入内存的时间,具有省电的功效,并可储存实时速度与实时角度,以延长内存的储存时间,可储存较多的导航点。
为让本发明的上述和其他目的、特征和优点能更明显易懂,下文特举较佳实施例,并配合所附图式,作详细说明如下。
附图说明
图1为本发明的导航轨迹推估系统方块图;
图2为本发明的导航轨迹推估系统的第一实施例的示意图;
图3为本发明的导航轨迹推估方法的第一实施例的流程图;
图4为本发明的导航轨迹推估系统的第二实施例的示意图;
图5为本发明的导航轨迹推估方法的第二实施例的流程图;
图6为本发明的导航轨迹推估系统的第三实施例的示意图;
图7为本发明的导航轨迹推估方法的第三实施例的流程图;以及
图8为导航轨迹推估系统的第四实施例的示意图。
具体实施方式
以下将参照相关图式,说明依本发明的导航轨迹推估系统及其推估方法的实施例,为使便于理解,下述实施例中的相同组件系以相同的符号标示来说明。
请参阅图1,其为本发明的导航轨迹推估系统的方块图。如图所示,导航轨迹推估系统10可包含一接收模块11、一处理模块12及一储存模块13。接收模块11可从全球定位系统取得定位经纬度111,及分别相对应于若干个定位经纬度111的若干个实时时间112。接收模块11可设定接收频率或接收周期,其根据接收频率或接收周期来取得定位经纬度111。处理模块12可为中央处理器(Central Processing Unit,CPU)或微处理器(Micro-Processing Unit),且处理模块12可电性链接于接收模块11及储存模块13。处理模块12可根据定位经纬度111中的若干个实时坐标121及相对应于若干个实时坐标121的若干个参考坐标120,来计算若干个实时速度122及若干个实时角度123,且依据相对应于若干个定位经纬度111的一行车速度设定一校正时间间隔。并且,处理模块12可根据校正时间间隔控制储存模块储存若干个定位经纬度111,以计算实时速度122、实时角度123或若干个实时坐标121以校正坐标。储存模块13可为嵌入式内存、外接式记忆卡或其组合,并可储存参考坐标120、实时坐标121、实时速度122、实时角度123、实时时间112或轨迹信息等数据。
承上所述,处理模块12可根据实时速度122或实时角度123计算经纬度移动距离及若干个参考坐标120推估若干个实时坐标,以显示一轨迹信息。当实时速度122小于最小速度时,储存模块13可储存实时时间112、实时速度122或实时角度123;或接收模块11可藉由全球定位系统取得若干个定位经纬度111以校正实时坐标121;又或者储存模块13可储存若干个定位经纬度111,当定位经纬度111的储存量大于最大储存量时,储存模块13可停止储存。附带一提的是,若当实时速度122大于最大速度时,储存模块13可储存实时速度122或实时角度124。
附带一提的是,校正时间间隔可手动调整设定,亦可依据行车速度自动调整,且处理模块根据校正时间间隔来储存信号。
请参阅图2,其为本发明的导航轨迹推估系统的第一实施例的示意图。如图所示,上图是速度时间图,横轴为时间、纵轴为速度;下图是储存量与时间图,横轴是时间、纵轴是储存量。请一并参阅图1及图2,当开启导航装置后,接收模块11可藉由全球定位系统取得定位经纬度111以及分别相对应于各个定位经纬度111的若干个实时时间112。一般而言,刚定位时飘移现象较严重,故可藉由接收模块11设定接收频率或接收周期,若设定一秒接收一笔,便可于定位时,接收模块11取得m秒的定位经纬度111,以提供处理模块12推估速度与角度。
在图2中,当时间从0至t11其速度为0(m/s),导航装置开始定位,且接收模块11可设定接收频率或接收周期,以取得若干个定位经纬度111。由于储存定位经纬度111所占的内存较大,故其储存量较大。在本实施例中,较佳可设定接收时间频率为一秒接收一笔,因此m秒中可取得m笔定位经纬度111,于定位完成后,储存模块13可储存第1笔至第m笔的定位经纬度111。同时,处理模块12可设定校正时间间隔、最大速度或最小速度,并可根据校正时间间隔、最大速度或最小速度控制储存模块13储存若干个定位经纬度111,以提供处理模块12来计算实时速度122、实时角度123或若干个实时坐标121以校正坐标。当接收模块11接收第1笔数据开始,处理模块12可根据若干个定位经纬度111计算实时坐标121,且根据若干个实时坐标121计算实时速度122或实时角度123。
当接收模块11取得第(m+1)笔数据开始,处理模块12可判断实时速度122是否小于最小速度。在本实施例中,为使更加清楚了解技术特征,是以设定最小速度作为实施例,并不以此为限。当时间从t11开始至t12,速度从0(m/s)开始加速,然后又慢慢减速,当实时速度122大于或等于最小速度时,储存模块13可储存实时时间112、实时速度122或实时角度123,而不需储存定位经纬度111等数据。当实时速度122小于最小速度时,可能是全球定位系统造成的误差,故可重新定位、重新储存定位经纬度111,再由处理模块12开始计算,以作为校正。因此,在t12至t13的这段时间,导航装置可重新定位,并藉由接收模块11来接收全球定位系统的讯号,且其储存模块13可再次定位并储存定位经纬度111,故其储存量较大。
值得一提的是,接收模块11可设定接收频率或接收周期,且接收模块11可根据接收频率或接收周期来取得定位经纬度111。如此一来,处理模块12亦可藉由接收频率或接收周期,再反推计算接收模块11每次接收的时间,进而可得到实时时间112。
在t13至t14的这段时间,速度从0(m/s)开始加速,时间接近t14时速度降低为0(m/s)。因此,若实时速度122没有小于最小速度,储存模块13可只储存实时时间112、实时速度122或实时角度123;若实时速度122小于最小速度,可重新定位、重新储存,如同t14至t15的这段时间,储存量较大。而从t15开始,实时速度122加速后维持一个稳定的速度,且实时速度122大于最小速度,储存模块13可只储存实时时间112、实时速度122或实时角度123,故可降低储存模块13的储存量。
如此一来,本发明的导航轨迹推估系统10可利用储存模块13储存其实时速度122和实时角度123,以提供处理模块12推估每一点移动的经纬度,来记录轨迹信息。
尽管前述在说明本发明的导航轨迹推估系统10的过程中,亦已同时说明本发明的推估方法的概念,但为求清楚起见,以下仍另绘示流程图详细说明。
图3为本发明的导航轨迹推估方法的第一实施例的流程图,如图所示,导航轨迹推估系统的推估方法包含下列步骤:
在步骤S11中,接收模块接收全球定位系统讯号。
在步骤S12中,定位完成。
在步骤S13中,接收模块是否接收≥(m+1)笔。若接收模块接收小于(m+1)笔数据的话,可进行步骤S142,在步骤S142中,储存第1笔至第m笔的全球定位系统讯号。
若否,则可进行步骤S141,在步骤S141中,速度是否小于最小速度。
若在步骤S141中,实时速度112小于最小速度,则回到步骤S12前,再次进行定位,直到定位完成始进行步骤S12。若否,则可进行步骤S15。
在步骤S15中,储存时间信息、实时速度、实时角度。
本发明的导航轨迹推估系统的推估方法的详细说明以及实施方式已于前面叙述本发明的导航轨迹推估系统时描述过,在此为了简略说明便不再叙述。
请一并参阅图2及图3,当接收模块接收全球定位系统讯号时,可取得定位经纬度,并由处理模块计算其实时坐标(x0,y0)为(121.00,25.00),并藉由若干个实时坐标计算一实时速度或一实时角度。值得注意的是,处理模块可根据实时速度及实时角度计算一经纬度移动距离,且根据经纬度移动距离,以计算一实时经纬度,并处理模块可根据实时经纬度推估若干个实时坐标,以纪录一轨迹信息。在本实施例中,实时角度GPS_COG可为325°及实时速度GPS_SOG可为20(m/s)。处理模块可根据第一点的实时坐标、实时速度及实时角度推估计算若干个实时坐标,并满足下式:
EW_cal=cos(y/180*π)*11.1(1)
course=-1*(GPS_COG-90)(2)
EW_fix=cos(course/180*π)*GPS_SOG (3)
NS_fix=sin(course/180*π)*GPS_SOG (4)
EW_fix1=EW_fix/EW_cal (5)
NS_fix1=NS_fix/11.1(6)
x1=x0+EW_fix1/10000(7)
y1=y0+NS_fix1/10000(8)
其中,EW_cal为每万分的一经度差,course为方向,EW_fix为经度移动方向与距离,NS_fix为纬度移动方向与距离,EW_fix1为经度坐标移动量,NS_fix1为纬度坐标移动量。
因此,利用上式式(1)至式(8)可藉由前一点的实时坐标(x0,y0)推估下一点的实时坐标(x1,y1)为(120.999886,25.0001476)。更进一步地,利用本发明的导航轨迹推估系统,可在移动的间储存实时速度及实时角度,并可透过处理模块根据若干个实时坐标,将其合并以纪录一轨迹信息。
换句话说,本发明的导航轨迹推估系统可透过图2及图3所表述的方法和流程及上述的推估方法,可以使导航轨迹的储存量缩小,并可利用储存速度和角度以延长内存的储存时间,同时提供简易的运算方式,可提高运算的效率及具有省电的功效。
依据第一实施例,本发明更提出第二实施例作更进一步的举例说明。
请参阅图4,其为本发明的导航轨迹推估系统的第二实施例的示意图,如图所示,上图是速度时间图,横轴为时间、纵轴为速度;下图是储存量与时间图,横轴是时间、纵轴是储存量。请一并参阅图1及图4,导航装置开启后,接收模块11可接收全球定位系统的讯号取得定位经纬度111。导航装置刚定位时飘移现象较严重,故可藉由接收模块11设定接收频率或接收周期,若设定一秒接收一笔,便可于定位时,接收模块11取得m秒的定位经纬度111,以提供处理模块12推估速度与角度。同时,处理模块12亦可根据接收频率或接收周期再推估实时时间112。
在图4中,当时间从0至t21其速度为0(m/s),导航装置开始定位,且接收模块11可设定接收频率或接收周期,以取得若干个定位经纬度111。由于定位经纬度111所占的内存较大,故其储存量较大。在本实施例中,较佳可设定接收时间频率为一秒接收一笔,因此m秒中可取得m笔定位经纬度111,于定位完成后,储存模块13可储存第1笔至第m笔的定位经纬度111。同时,处理模块12可设定校正时间间隔、最大速度或最小速度,并可根据校正时间间隔、最大速度或最小速度控制储存模块储存若干个定位经纬度111,以提供处理模块计算实时速度122、实时角度123或若干个实时坐标121以校正坐标。当接收模块11取得第1笔数据开始,处理模块12可根据若干个定位经纬度111计算实时坐标121,且根据若干个实时坐标121计算实时速度122或实时角度123。当接收模块11接收第(m+1)笔数据开始,处理模块12可判断实时速度122是否小于最小速度。在本实施例中,为使更加清楚了解技术特征,是以设定最小速度作为实施例,并不以此为限。
当时间从t21开始至t22,速度从0(m/s)开始加速,然后又慢慢减速,当实时速度122大于或等于最小速度时,储存模块13可储存实时时间112、实时速度122或实时角度123,而不需储存定位经纬度111等数据。当实时速度122小于最小速度时,储存模块13可储存若干个定位经纬度111,当若干个定位经纬度111的数据量大于最大储存量时,储存模块13可停止储存。因此从t22开始,当实时速度122小于最小速度的这段时间,导航装置藉由接收模块11来接收全球定位系统的讯号,且储存模块13可储存接收模块11取得的定位经纬度111,故当实时速度122小于最小速度的这段时间储存量较大。在t22至t23这段时间,由于储存模块13储存全球定位系统讯号于达t23这时间点达最大储存量,可暂停储存,使储存量降低。
特别注意的是,接收模块11可设定接收频率或接收周期,且接收模块11可根据接收频率或接收周期来取得定位经纬度111。如此一来,储存模块13亦可不储存时间信息,处理模块14可藉由接收频率或接收周期,来计算接收模块11每次接收的时间,进而可推估实时时间112。
在t24至t25的这段时间,速度从0(m/s)开始加速,时间接近t25时速度降低为0(m/s)。因此,若实时速度122没有小于最小速度,储存模块13可储存实时时间112、实时速度122或实时角度123。从t25开始至t26的这段时间,由于实时速度122小于最小速度,所以储存模块13便开始储存接收模块11取得的定位经纬度111。换句话说,当实时速度122小于最小速度的这段时间,导航装置藉由接收模块11来接收全球定位系统的讯号,且储存模块13可储存接收模块11取得的定位经纬度111,故当实时速度122小于最小速度的这段时间储存量较大。在t26至t27这段时间,由于储存模块13储存全球定位系统讯号于达t26这时间点达最大储存量,可暂停储存,使储存量降低。从t27开始,实时速度122加速后维持一个稳定的速度,且实时速度122大于最小速度,储存模块13可只储存实时时间112、实时速度122或实时角度123,故可降低储存模块13的储存量。
尽管前述在说明本发明的导航轨迹推估系统10的过程中,亦已同时说明本发明的推估方法的概念,但为求清楚起见,以下仍另绘示流程图详细说明。
图5为本发明的导航轨迹推估方法的第二实施例的流程图,如图所示,导航轨迹推估系统的推估方法包含下列步骤:
在步骤S21中,接收模块接收全球定位系统讯号。
在步骤S22中,定位完成。
在步骤S23中,接收模块是否接收≥(m+1)笔。若接收模块接收小于(m+1)笔数据的话,可进行步骤S242,在步骤S242中,储存第1笔至第m笔的全球定位系统讯号。
若否,则可进行步骤S241,在步骤S241中,速度是否小于最小速度。
若在步骤S241中,实时速度小于最小速度,则进行步骤S252,在步骤S252中,储存全球定位系统讯号达最大储存量。接着,在步骤S2521中,停止储存。
若在步骤S241中,实时速度并不小于最小速度,则进行步骤S251,在步骤S251中,储存时间信息、实时速度、实时角度。
本发明的导航轨迹推估系统的推估方法的详细说明以及实施方式已于前面叙述本发明的导航轨迹推估系统时描述过,在此为了简略说明便不再叙述。
请一并参阅图4及图5,当接收模块接收全球定位系统讯号时,可取得定位经纬度,并由处理模块转换为实时坐标(x0,y0),并藉由若干个实时坐标计算实时角度GPS_COG及实时速度GPS_SOG。处理模块可根据实时速度及实时角度推估若干个实时坐标,并利用式(1)至式(8)根据前一点的实时坐标推估下一点实时坐标(x1,y1)。更进一步地,利用本发明的导航轨迹推估系统,可在移动的间储存实时速度及实时角度,并可透过处理模块根据若干个实时坐标,将其合并以纪录一轨迹信息。
换句话说,本发明的导航轨迹推估系统可透过图4及图5所表述的方法和流程及上述的推估方法,可以使导航轨迹的储存量缩小,并且储存速度和角度可延长内存的储存时间,同时提供简易的运算方式,以提高运算的效率及具有省电的功效。
依据第一实施例及第二实施例,本发明更提出第三实施例作更进一步的举例说明。
请参阅图6,其为本发明的导航轨迹推估系统的第三实施例的示意图,如图所示,上图是速度时间图,横轴为时间、纵轴为速度;下图是储存量与时间图,横轴是时间、纵轴是储存量。请一并参阅图1及图6,当开启导航装置后,接收模块11可接收全球定位系统的讯号,以取得定位经纬度111。刚定位时飘移现象较严重,故可藉由接收模块11设定接收频率或接收周期,若设定一秒接收一笔,便可于定位时,接收模块11取得m秒的定位经纬度111,以提供处理模块12推估速度与角度。
在图6中,当时间从0至t31,导航装置开始定位,且接收模块11可设定接收频率或接收周期,以取得若干个定位经纬度111。由于定位经纬度111所占的内存较大,故其储存量较大。在本实施例中,较佳可设定接收时间频率为一秒接收一笔,因此m秒中可取得m笔定位经纬度111,于定位完成后,储存模块13可储存第1笔至第m笔的定位经纬度111。同时,处理模块12可设定校正时间间隔、最大速度或最小速度,并可根据校正时间间隔、最大速度或最小速度控制储存模块储存若干个定位经纬度111,以提供处理模块计算实时速度122、实时角度123或若干个实时坐标121以校正坐标。当接收模块11取得第1笔数据开始,处理模块12可根据若干个定位经纬度111计算实时坐标121,且根据若干个实时坐标121计算实时速度122或实时角度123。当接收模块11取得第(m+1)笔数据开始,处理模块12可判断实时速度122是否小于最小速度。在本实施例中,为使更加清楚了解技术特征,是以设定最小速度作为实施例,并不以此为限。
当时间从t301开始至t302,速度从0(m/s)开始加速,然后又慢慢减速,当实时速度122大于或等于最小速度时,储存模块13可储存实时时间112、实时速度122或实时角度123,而不需储存定位经纬度111等数据。当实时速度122小于最小速度时,储存模块13可储存若干个定位经纬度111,当若干个定位经纬度111的数据量大于最大储存量时,储存模块13可停止储存。在t302至t303这段时间,由于储存模块13储存全球定位系统讯号于达t303这时间点达最大储存量,可暂停储存,使储存量降低。
在t304至t305的这段时间,速度从0(m/s)开始加速,此时实时速度122大于最小速度,储存模块13可储存时间、实时速度122或实时角度123。于t305时速度开始大于最大速度,在t305至t306的这段时间,实时速度122大于最大速度,储存模块13可只储存实时速度122或实时角度123,储存量可降至最低。在t306至t307的这段时间,实时速度122大于最小速度,储存模块13可只储存时间、实时速度122或实时角度123。于t307时速度开始大于最大速度,在t307至t308的这段时间,实时速度122大于最大速度,储存模块13可只储存实时速度122或实时角度123,储存量可降至最低。在t308至t309的这段时间,实时速度122大于最小速度,储存模块13可只储存时间、实时速度122或实时角度123。
值得一提的是,接收模块11可设定接收频率或接收周期,且接收模块11可根据接收频率或接收周期来取得定位经纬度111。从t309开始至t310的这段时间,由于实时速度122小于最小速度,所以储存模块13便开始储存接收模块11取得的定位经纬度111。换句话说,当实时速度122小于最小速度的这段时间,导航装置藉由接收模块11来接收全球定位系统的讯号,且储存模块13储存接收模块11取得的定位经纬度111,故当实时速度122小于最小速度的这段时间储存量较大。在t310至t311这段时间,由于储存模块13储存全球定位系统讯号于达t310这时间点达最大储存量,可暂停储存,使储存量降低。从t311开始,实时速度122加速后维持一个稳定的速度,且实时速度122大于最小速度,储存模块13可只储存时间信息、实时速度122或实时角度123,故可降低储存模块13的储存量。
因此,本发明的导航轨迹推估系统10的储存模块13可仅储存其实时速度122和实时角度123,以提供处理模块12计算每一点移动的坐标,来记录轨迹信息。
尽管前述在说明本发明的导航轨迹推估系统10的过程中,亦已同时说明本发明的推估方法的概念,但为求清楚起见,以下仍另绘示流程图详细说明。
图7为本发明的导航轨迹推估方法的第三实施例的流程图,如图所示,导航轨迹推估系统的推估方法包含下列步骤:
在步骤S31中,接收模块接收全球定位系统讯号。
在步骤S32中,定位完成。
在步骤S33中,接收模块是否接收≥(m+1)笔。若接收模块接收小于(m+1)笔数据的话,可进行步骤S342,在步骤S342中,储存第1笔至第m笔的全球定位系统讯号。
若否,则可进行步骤S341,在步骤S341中,速度是否小于最小速度。
若在步骤S341中,实时速度小于最小速度,则进行步骤S351,在步骤S351中,储存全球定位系统讯号达最大储存量。接着,在步骤S3511中,停止储存。
若在步骤S341中,实时速度并不小于最小速度,则进行步骤S352及步骤S353。
在步骤S352中,储存时间信息、实时速度、实时角度。
在步骤S353中,速度大于最大速度。若速度大于最大速度,则接着在步骤S36中,储存实时速度、实时角度。
本发明的导航轨迹推估系统的推估方法的详细说明以及实施方式已于前面叙述本发明的导航轨迹推估系统时描述过,在此为了简略说明便不再叙述。
请一并参阅图6及图7,当接收模块接收全球定位系统讯号时,可取得到定位经纬度,并由处理模块转换为实时坐标(x0,y0),并藉由若干个实时坐标计算实时角度GPS_COG及实时速度GPS_SOG。处理模块可根据实时坐标、实时速度及实时角度推估若干个实时坐标,并利用式(1)至式(8)根据前一点的实时坐标推估下一点实时坐标(x1,y1)。更进一步地,利用本发明的导航轨迹推估系统,可在移动的间储存实时速度及实时角度,并可透过处理模块根据若干个实时坐标,将其合并以纪录一轨迹信息。
换句话说,本发明的导航轨迹推估系统可透过图6及图7所表述的方法和流程及上述的推估方法,可以使导航轨迹的储存量缩小,并且利用储存速度和角度能延长内存的储存时间,同时提供简易的运算方式,可提高运算的效率及具有省电的功效。
依据上述实施例,本发明更提出第四实施例作更进一步的举例说明。
请参阅图8,其为导航轨迹推估系统的第四实施例的示意图。利用接收模块设定接收频率或接收周期,并根据接收频率或接收周期取得若干个定位经纬度。举例来说,一般储存模块储存的轨迹纪录如下表一:
表一:
但是,储存模块若每秒储存经纬度的话,其占用的储存量较大。因此,藉由本发明的导航轨迹推估系统,储存模块储存的轨迹纪录如下表二:
表二:
值得一提的是,为了更暸解本发明的导航轨迹推估系统的技术特征,可以每两秒储存一次速度与角度作为实施例,但不以此为限。如图8所示,储存模块较佳可设定每两秒储存一次角度与速度,储存模块可储存第1秒、第3秒、第5秒,其中第3秒的角度、速度为原本的第2秒以及第3秒的向量和,第5秒的角度、速度为原本的第4秒以及第5秒的向量和。
综上所述,依本发明的导航轨迹推估系统及其推估方法,其可具有一或多个下述优点:
(1)此发明的导航轨迹推估系统及其推估方法可缩小储存量,以缩短写入内存的时间,具有省电的功效。
(2)此发明的导航轨迹推估系统及其推估方法可储存实时速度与实时角度,以延长内存的储存时间,可储存较多的导航点。
以上所述仅为举例性,而非为限制性者。任何熟习此技艺者,在不脱离本发明的精神和范围内,当可作些许的更动与润饰,因此本发明的保护范围当视后附的申请专利范围所界定者为准。
Claims (12)
1.一种导航轨迹推估系统,其特征在于,其包含:
一接收模块,藉由一全球定位系统取得若干个定位经纬度,及分别相对应于该若干个定位经纬度的若干个实时时间;
一处理模块,电性链接于该接收模块,根据该若干个定位经纬度中的若干个实时坐标及相对应于该若干个实时坐标的若干个参考坐标,来计算若干个实时速度及若干个实时角度,并该处理模块依据相对应于该若干个定位经纬度的一行车速度设定一校正时间间隔;以及
一储存模块,储存该若干个参考坐标、该实时速度、该若干个实时角度或该若干个实时时间。
2.根据权利要求1所述的导航轨迹推估系统,其特征在于,该处理模块根据该若干个实时速度和该若干个实时角度计算一经纬度移动距离,且根据该经纬度移动距离及该若干个参考坐标推估该若干个实时坐标,以显示一轨迹信息。
3.根据权利要求1所述的导航轨迹推估系统,其特征在于,该接收模块设定一接收频率或一接收周期,该接收模块根据该接收频率或该接收周期,来取得该若干个定位经纬度。
4.根据权利要求1所述的导航轨迹推估系统,其特征在于,该储存模块根据该校正时间间隔储存该若干个参考坐标和该若干个实时时间,或储存该若干个实时时间、该若干个实时速度和该若干个实时角度其中之一者。
5.根据权利要求1所述的导航轨迹推估系统,其特征在于,当该若干个实时速度小于一最小速度时,该接收模块藉由该全球定位系统取得该若干个定位经纬度,以校正该若干个实时坐标。
6.根据权利要求5所述的导航轨迹推估系统,其特征在于,该处理模块根据该校正时间间隔控制该储存模块储存该若干个定位经纬度,以该处理模块计算该实时速度,当该若干个实时速度小于该最小速度,且该储存模块储存该若干个定位经纬度大于一最大储存量,则使该储存模块停止储存。
7.一种导航轨迹推估方法,适用于一导航轨迹推估系统,其特征在于,该推估方法包含下列步骤:
利用一接收模块藉由一全球定位系统取得若干个定位经纬度及相对应于该若干个定位经纬度的若干个实时时间;
藉由一处理模块根据该若干个定位经纬度中的若干个实时坐标及相对应于该若干个实时坐标的若干个参考坐标,以计算若干个实时速度及若干个实时角度;
藉由该处理模块依据相对应于该若干个定位经纬度的一行车速度设定一校正时间间隔;以及
提供一储存模块储存该若干个参考坐标及其相对应的该若干个实时时间,或该若干个实时速度、该若干个实时角度及其相对应的该若干个实时时间其中之一者。
8.根据权利要求7所述的导航轨迹推估方法,其特征在于,更包含下列步骤:
提供该处理模块根据该若干个实时速度和该若干个实时角度,来计算一经纬度移动距离;以及
利用该处理模块根据该经纬度移动距离及该若干个参考坐标推估该若干个实时坐标,以显示一轨迹信息。
9.根据权利要求7所述的导航轨迹推估方法,其特征在于,更包含下列步骤:
利用该接收模块设定一接收频率或一接收周期;以及
使用该接收模块根据该接收频率或该接收周期,来取得该若干个定位经纬度。
10.根据权利要求7所述的导航轨迹推估方法,其特征在于,更包含下列步骤:
提供该储存模块根据该校正时间间隔储存该若干个参考坐标和该若干个实时时间,或储存该若干个实时时间、该若干个实时速度和该若干个实时角度其中之一者。
11.根据权利要求7所述的导航轨迹推估方法,其特征在于,更包含下列步骤:
当该若干个实时速度小于一最小速度时;以及
透过该接收模块藉由该全球定位系统取得该若干个定位经纬度,以校正该若干个实时坐标。
12.根据权利要求11所述的导航轨迹推估方法,其特征在于,更包含下列步骤:
使用该处理模块根据该校正时间间隔控制该储存模块储存该若干个定位经纬度;
以该处理模块计算该实时速度;
透过该处理模块分析该实时速度小于该最小速度时;
提供该储存模块储存该若干个定位经纬度大于一最大储存量;以及
则使该储存模块停止储存。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210009395.2A CN103207402B (zh) | 2012-01-13 | 2012-01-13 | 导航轨迹推估系统及其推估方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210009395.2A CN103207402B (zh) | 2012-01-13 | 2012-01-13 | 导航轨迹推估系统及其推估方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103207402A true CN103207402A (zh) | 2013-07-17 |
CN103207402B CN103207402B (zh) | 2015-04-15 |
Family
ID=48754678
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201210009395.2A Expired - Fee Related CN103207402B (zh) | 2012-01-13 | 2012-01-13 | 导航轨迹推估系统及其推估方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103207402B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104661305A (zh) * | 2015-02-16 | 2015-05-27 | 百度在线网络技术(北京)有限公司 | 用于用户终端定位的方法、装置及服务端 |
CN109765597A (zh) * | 2019-03-01 | 2019-05-17 | 广州达安临床检验中心有限公司 | 医学冷链定位方法、装置、设备和存储介质 |
CN110319851A (zh) * | 2018-03-30 | 2019-10-11 | 北京百度网讯科技有限公司 | 传感器的校正方法、装置、设备及存储介质 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101097136A (zh) * | 2006-06-30 | 2008-01-02 | 佛山市顺德区顺达电脑厂有限公司 | 地理定位轨迹推算方法及系统 |
US20090043495A1 (en) * | 2007-08-07 | 2009-02-12 | Denso Corporation | Position correction apparatus |
TW201129817A (en) * | 2009-06-15 | 2011-09-01 | Qualcomm Inc | Real-time data with post-processing |
-
2012
- 2012-01-13 CN CN201210009395.2A patent/CN103207402B/zh not_active Expired - Fee Related
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101097136A (zh) * | 2006-06-30 | 2008-01-02 | 佛山市顺德区顺达电脑厂有限公司 | 地理定位轨迹推算方法及系统 |
US20090043495A1 (en) * | 2007-08-07 | 2009-02-12 | Denso Corporation | Position correction apparatus |
TW201129817A (en) * | 2009-06-15 | 2011-09-01 | Qualcomm Inc | Real-time data with post-processing |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104661305A (zh) * | 2015-02-16 | 2015-05-27 | 百度在线网络技术(北京)有限公司 | 用于用户终端定位的方法、装置及服务端 |
CN104661305B (zh) * | 2015-02-16 | 2019-01-01 | 百度在线网络技术(北京)有限公司 | 用于用户终端定位的方法、装置及服务端 |
CN110319851A (zh) * | 2018-03-30 | 2019-10-11 | 北京百度网讯科技有限公司 | 传感器的校正方法、装置、设备及存储介质 |
CN109765597A (zh) * | 2019-03-01 | 2019-05-17 | 广州达安临床检验中心有限公司 | 医学冷链定位方法、装置、设备和存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN103207402B (zh) | 2015-04-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103557876B (zh) | 一种用于天线跟踪稳定平台的捷联惯导初始对准方法 | |
US7855683B2 (en) | Methods and apparatuses for GPS coordinates extrapolation when GPS signals are not available | |
CN102933937B (zh) | 移动站及使用惯性传感器数据来改善移动站定位的方法 | |
EP2876463B1 (en) | Method for determining location of vehicle | |
CN104121905A (zh) | 一种基于惯性传感器的航向角获取方法 | |
US20100138147A1 (en) | Positioning device and method to determine a position using an absolute positioning system and a relative positioning system, computer program and a data carrier | |
CN105424041A (zh) | 一种基于bd/ins紧耦合的行人定位算法 | |
WO2012118207A1 (ja) | 局所地図生成装置、局所地図生成システム、グローバル地図生成装置、グローバル地図生成システム、及びプログラム | |
CN103379619A (zh) | 一种定位方法和系统 | |
CN104749588A (zh) | 一种与北斗系统实时同步生成伪卫星信号的方法 | |
CN104931995A (zh) | 一种基于矢量跟踪的gnss/sins深组合导航方法 | |
CN110319850B (zh) | 一种获取陀螺仪的零点偏移的方法及装置 | |
US20130044025A1 (en) | Satellite-based positioning method | |
CN207318731U (zh) | 一种具有北斗定位定向功能的车辆监控装置 | |
CN104884895B (zh) | 电子罗盘校准方法和终端 | |
CN103389115A (zh) | Sins/dvl组合导航系统一体化误差标定方法 | |
CN104697536A (zh) | 一种车辆定位的方法和装置 | |
CN106093992A (zh) | 一种基于cors的亚米级组合定位导航系统及导航方法 | |
Long et al. | Single UWB anchor aided PDR heading and step length correcting indoor localization system | |
CN103454662A (zh) | 一种基于ckf的sins/北斗/dvl组合对准方法 | |
CN102997918B (zh) | 一种惯性/卫星姿态融合方法 | |
CN103033822A (zh) | 移动信息确定装置、方法以及接收机 | |
CN103207402A (zh) | 导航轨迹推估系统及其推估方法 | |
AU2022204823A1 (en) | Reliability determination of location updates in multipath environments | |
CN102944888B (zh) | 一种基于二阶扩展卡尔曼的低运算量gps定位方法 |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20150415 Termination date: 20200113 |