[发明专利]一种在Android内核层实现GNSS/INS组合导航的方法

权利要求书

1.一种在Android内核层实现GNSS/INS组合导航的方法，其特征在于，包括：

一个增加跨硬件HAL的传感器数据访问代理模块的步骤：基于Android操作系统公开架构，通过修改标准Android系统的GPS HAL内核及Sensor HAL内核，实现Android底层的组合导航算法，并扩展了Android系统的GPS接口，包括：

一个增加接口函数的步骤：配合传感器数据访问代理模块工作，增加的接口函数是在标准Android系统中从Java本地调用层开始扩充和修改，以实现数据在HAL内核、Linux内核驱动以及传感器数据访问代理模块之间的交互；其中，接口函数具体包括：

接口函数一：在hardware/libhardware/include/hardware/gps.h中，添加一组IMUGpsInterface接口函数，由标准Andorid内核中GpsInterface接口的get_extension()函数引出，用以满足组合导航定位中的相关设置（如传感器的类型、传感器的采样率等）需求；在标准Andorid内核中GpsInterface接口的set_position_mode()中，扩展了GPS_POSITION_MODE_IMU；

接口函数二：在GPS应用框架层的JNI中也相应扩展相关接口函数，在：

frameworks/base/services/jni/com_android_server_location_GpsLocationProvider.cpp中，添加对应于IMUGpsInterface接口的函数供GpsLocationProvider调用，

在：

frameworks/base/services/java/com/android/server/location/GpsLocationProvider.java中，添加native函数来调用JNI中的IMUGpsInterface接口函数，在GpsLocationProvider添加与GPS HAL层相对应的定位模式GPS_POSITION_MODE_IMU，根据系统设置中的设置将用户选择的定位模式传递到HAL层。

2.根据权利要求1所述的一种在Android内核层实现GNSS/INS组合导航的方法，其特征在于，重新实现标准Android的Sensor HAL内核中的相关接口和数据访问函数，使其通过新设置的传感器数据代理（Sensor Data Agent, SDA）与惯性传感器硬件进行交互；扩展标准Android的GPS HAL内核，使其也能够通过SDA与惯性传感器硬件进行交互；通过SDA，可以将GNSS硬件数据与Sensor硬件数据引导到任意一个HAL内核中，从而实现组合导航算法；具体包括对标准Android的Sensor HAL和GPS HAL进行修改的过程：

过程一：对标准Android的Sensor HAL进行修改，将标准Android中各种惯性传感器统一为的SensorBase模块定义为IMUProxySensor，由SensorBase派生；从面向应用程序的SensorService基本服务到传感器硬件驱动的调用逻辑如下：

调用1：Sensor应用框架层的SensorService从Sensor HAL驱动文件加载获取sensor_poll_device_t后，会初始化IMUProxySensor；在初始化IMUProxySensor时，通过socket连接到SDA模块上；

调用2：SensorService通过sensor_moudle_t提供的getSensorList函数来获取Sensor HAL驱动支持的传感器列表；IMUProxySensor向SDA模块发送SDA_GET_SENSOR_LIST消息，SDA模块调用内部数据读取模块的getSensorList()接口获取IMUSensor支持的传感器列表并通过SDA_SENSOR_LIST消息返回给IMUProxySensor；

调用3：当应用程序向SensorService请求惯性传感器数据的时候，SensorService通过调用IMUProxySensor的setDelay()和enable()接口设置需要打开传感器及对应的采样率；IMUProxySensor发送SDA_SENSOR_LIST以及SDA_ACTIVE消息给SDA模块，SDA模块调用数据读取模块中IMUSensor的相应接口将参数设置到惯性传感器硬件模块中；

调用4：SDA模块通过数据读取模块读取到IMU数据之后发送SDA_MESSAGE消息给IMUProxySensor，IMUProxySensor将收到的消息中的IMU数据上传给SensorService，SensorService将结果提供给应用程序；

过程二：对标准Android的GPS HAL实现方法所做的修改，GPS HAL层的IMU模块访问子层与SDA模块的交互符合下述调用逻辑：

调用1：在标准Andorid的GPS HAL中新增加一个“IMU模块访问子层”，其作用是与SDA通信获得惯性传感器的数据；与之对应的，是标准Andorid的GPS HAL内核通常设置有的“GNSS模块访问子层”，用以获得GNSS硬件数据；

调用2：根据标准Andorid的GPS HAL的通常实现方法，在初始化GPS HAL时候会调用其基本接口GpsInterface::init()（对应本专利的实现称为iwise_loc_int()），本专利在该接口函数的实现中增加对“IMU模块访问子层”的初始化，并使其通过socket连接到SDA模块；

调用3：在初始化GPS HAL时，GpsLocationProvider从系统设置中获取定位模式、打开的传感器、传感器的采样率及扩展数据，通过调用set_position_mode接口和本专利添加的IMUGpsInterface中的一组接口将设置信息保存到组合导航定位实现子层的共享数据iwise_data_t（见本专利权利要求点4中表18）中；

调用4：当上层应用请求GPS导航定位的时候，GPS应用框架层会调用标准Andorid的GPS HAL的GpsInterface::start()（对应本专利的实现称为iwise_loc_start_fix()）接口；如果此时的定位模式为GPS_POSITION_MODE_IMU，IMU模块访问子层从共享数据iwise_data_t中获取需要打开的传感器及传感器的采样率，通过SDA_ACTIVE和SDA_SET_DELAY消息发送给SDA模块；SDA模块内部的数据读取模块读取到IMU数据之后会发送SDA_MESSAGE消息给IMU模块访问子层，并继而返回给组合导航定位实现子层进行组合导航定位解算；

调用5：当应用程序停止GPS导航定位的时候，GPS应用框架层会会调用标准Andorid的GPS HAL的GpsInterface::stop()（对应本专利的实现称为iwise_loc_stop_fix()）接口，IMU模块访问子层发送SDA_STOP消息给SDA模块以停止IMU数据请求。