一种基于状态机的轻量级NTRIP客户端方法及车载消费级RTK定位终端与流程

摘要: 本发明涉及卫星导航定位,具体涉及一种基于状态机的轻量级ntrip客户端方法及车载消费级rtk定位终端。背景技术:1、实时动态差分定位(real-timekine...
一种基于状态机的轻量级NTRIP客户端方法及车载消费级RTK定位终端与流程

本发明涉及卫星导航定位,具体涉及一种基于状态机的轻量级ntrip客户端方法及车载消费级rtk定位终端。

背景技术:

1、实时动态差分定位(real-time kinematic, rtk)技术依靠基准站播发的rtcm差分改正数,可使移动端获得厘米级定位精度,已广泛应用于测绘、国土、交通等领域。然而,传统rtk设备多依赖嵌入式linux系统或高性能处理器运行完整网络协议栈,设备成本高昂(早期专业设备单价高达十余万元),难以进入大众消费市场。

2、目前,各省市已建成北斗基准站"一张网"(cors系统),可通过ntrip协议对外播发rtcm数据流,向专业rtk设备提供实时厘米级差分服务。理论上,若能在消费级终端上实现轻量级ntrip客户端,即可借助现有cors基础设施大幅降低rtk应用门槛。然而,在mcu类资源受限终端上实现ntrip客户端面临以下两方面技术矛盾:

3、一方面,cors播发的rtcm电文数据量大、播发频率高,而消费级终端受限于mcu运算能力、串口波特率及有限的内存缓存空间,常规的rtcm解析与校验方式极易导致数据溢出或解析超时,难以保证差分数据的完整接收与实时解算;

4、另一方面,ntrip协议基于http/tcp,涉及认证握手、源列表解析、长连接保活及断线重连等完整网络逻辑,在车载等移动场景下4g网络信号波动频繁,tcp连接易被运营商nat超时机制断开,如何在低功耗、低算力约束下实现连接的健壮保持,同样是本领域亟待解决的技术难题。

5、针对上述问题,本领域普遍认为ntrip客户端需依赖嵌入式linux及高性能处理器方能稳定运行,存在"消费级mcu硬件无法稳定接入专业级cors网络"的技术偏见。因此,亟需一种在资源受限的微控制器上以低功耗、低复杂度实现健壮ntrip客户端的方法及相应终端。

技术实现思路

1、本发明的目的在于提出一种基于状态机的轻量级ntrip客户端方法及车载消费级rtk定位终端,旨在解决传统rtk设备依赖高性能处理器与嵌入式操作系统、成本高昂,难以进入大众消费市场的技术瓶颈。

2、为了实现上述目的,本发明具体采用的技术方案如下:

3、第一方面,本发明提供一种基于状态机的轻量级ntrip客户端方法,应用于资源受限微控制器。所述微控制器无操作系统,采用单线程轮询调度,不依赖多线程与完整tcp/ip协议栈,仅处理应用层数据。

4、所述方法包括以下步骤:

5、s1、在微控制器内搭建有限状态机,以枚举方式定义系统状态,所述状态至少包含:初始化状态、等待网络就绪状态、等待卫星定位状态、获取源列表状态、请求验证状态、数据传输状态、错误状态。

6、具体地,上电后系统进入初始化状态,采用延时等待与轮询检测相结合的方式,检测gnss模块与蜂窝通信模块是否均已稳定就绪;待全部就绪后跳转至等待网络就绪状态。

7、s2、进入等待网络就绪状态,检测蜂窝通信模块的网络注册状态及与cors服务器之间的tcp链路状态;待网络注册完成且tcp连接建立后,跳转至等待卫星定位状态。

8、s3、进入等待卫星定位状态,实时读取gnss模块输出的可见卫星数量;当可见卫星数达到预设阈值后,判定定位条件满足,跳转至获取源列表状态。优选地,所述预设卫星阈值为7~10颗。

9、s4、进入获取源列表状态,向cors服务器发送http get请求获取可用挂载点列表,并对返回的源列表进行解析;若解析得到有效的挂载点,则跳转至请求验证状态;若出现请求超时、tcp连接断开或解析源列表为空中的任一情形,则判定为请求失败,回退至等待网络就绪状态重新建立连接。

10、s5、进入请求验证状态,向cors服务器发送携带认证凭证的ntrip连接请求,并等待服务器响应;若接收到表示认证成功的服务端响应,则跳转至数据传输状态;若认证失败或响应超时,则回退至获取源列表状态重新获取挂载点。其中,所述响应超时由预设定时器阈值界定。

11、优选地,所述认证凭证由账号密码编码后写入http认证头部完成校验,所述编码方式为base64编码,编码内容填入authorization字段。

12、s6、进入数据传输状态,定时上报gnss模块输出的gga定位语句,同时周期性发送心跳保活报文以维持tcp长连接活性;实时接收服务器下发的rtcm差分数据,并透传转发至gnss模块,供其完成rtk本地解算;当差分数据流中断超过预设判定时长或收到服务器明确错误响应时,回退至等待卫星定位状态,重新执行自卫星定位至数据接收的完整流程。优选地,所述心跳保活间隔为30~60秒,所述差分数据流中断判定时长为20~60秒。

13、可选地,在数据传输状态下,本发明还周期性执行健康检查,综合校验rtcm数据活跃度、当前可见卫星数量及gga语句上报状态;若任一检查项异常,即触发状态回退至等待卫星定位状态。同时设有错误计数机制,当同一状态下连续错误次数超过预设上限时触发系统软复位。

14、优选地,所述rtcm差分数据在透传转发过程中,采用双缓冲区交替缓存机制:两块固定大小的缓冲区角色周期切换,一块用于接收串口数据流,另一块用于向gnss模块转发已接收数据,读写角色交替切换,以防止高带宽差分数据流在资源受限微控制器上发生数据溢出或丢包。

15、s7、在非数据传输状态下出现不可恢复故障时,进入错误状态并执行软复位;所述不可恢复故障为以下任一情形:蜂窝通信模块硬复位失败、gnss模块无响应超时、同状态重试次数超过预设上限。

16、需要说明的是,上述s1至s7中,各状态的迁移与回退均由主循环中的状态机调度逻辑统一驱动,无需操作系统任务调度,亦无需多线程同步机制,从而在资源受限mcu上以极低的代码复杂度和运行功耗,完整实现ntrip客户端的全部网络交互逻辑。

17、第二方面,本发明提供一种车载消费级rtk定位终端,该终端用于执行上述第一方面所述的方法。

18、具体地,所述终端包括:gnss定位模块、微控制器、蜂窝通信模块、以及至少一根天线。其中,所述微控制器为资源受限型mcu,其ram容量不大于512kb,cpu主频不高于200mhz。

19、所述微控制器内置状态机调度单元,用于按单线程轮询方式遍历系统状态枚举,根据当前状态执行相应动作并依据预设迁移条件驱动状态跳转或回退;还内置数据缓存单元,用于对rtcm差分数据进行缓存交替存储;还内置状态监控复位单元,用于监测各状态下的系统运行状态并触发状态回退或系统复位。

20、所述蜂窝通信模块以dtu透明传输方式工作,由微控制器经串口发送配置指令完成预配置后,自动建立并维持至cors服务器的tcp连接。所述蜂窝通信模块独立承载tcp/ip协议栈,微控制器仅通过串口收发ntrip应用层数据,无需处理tcp/ip协议解析。

21、优选地,所述终端还包括ble蓝牙模块,用于将系统状态信息拆分为多个数据包并经ble广播发送至手机终端;其中单包数据长度不超过20字节,包间隔不小于30毫秒,以适配消费级手机应用对ble广播接收的兼容性要求。

22、通过上述硬件架构,本发明终端以gnss定位模块、微控制器、蜂窝通信模块及3d打印外壳构建模块化架构,整机物料成本控制在百元级,具备规模化进入大众消费市场的成本竞争力。

23、本发明与现有技术相比,具有以下显著优点:

24、(一)轻量化协议栈,适配资源受限硬件。本发明摒弃传统rtk终端对嵌入式linux或高性能处理器的依赖,在无操作系统的mcu上以单线程轮询状态机实现完整的ntrip客户端逻辑,大幅降低代码复杂度与运行功耗,使得ram容量不大于512kb、主频不高于200mhz的通用mcu即可稳定运行,从根本上解决了专业cors服务与消费级硬件之间的“高精度鸿沟”。

25、(二)网络协议栈卸载,突破数据吞吐瓶颈。本发明将tcp/ip协议栈交由蜂窝通信模块独立承载,mcu仅处理应用层串口数据,配合双缓冲区交替缓存机制,有效解决资源受限mcu在处理高频率rtcm差分数据流时的串口溢出与解析超时问题,确保厘米级差分数据在低算力平台上的完整接收与实时转发。

26、(三)多重可靠性保障机制,适应车载弱网环境。本发明通过心跳保活报文(30~60秒间隔)、差分数据流中断超时回退(20~60秒判定)、健康检查(rtcm活跃度/卫星数/gga状态综合校验)及错误计数超限软复位等多重保护机制,有效应对车载移动场景下4g网络信号波动、运营商nat超时断开等实际工程问题,显著提升了终端的连接连续性与长期运行稳定性。

27、(四)经济性突出,验证了“省级cors网络+百元级消费终端”实现厘米级定位的技术可行性。本发明以国产gnss模组、通用mcu、蜂窝通信模组及3d打印外壳构建模块化终端架构,整机成本较传统专业rtk设备下降两个数量级,为高精度卫星导航定位技术在大众消费市场的规模化应用提供了切实可行的技术路径。