基于mems传感器的驾驶姿态检测系统的制作方法
【技术领域】
[0001] 本发明属于汽车驾驶行为检测分析领域，具体为一种基于MEMS传感器的驾驶姿 态检测系统。
【背景技术】
[0002] 目前，很多驾驶行为检测研宄是通过传感器采集车辆的实时位置、操纵装置状态 (如方向盘、踏板、操纵杆）和车辆状态信息来监测驾驶员的驾驶行为，同时通过固定的判 断方法评判驾驶员驾驶姿态。传感器信息获取则比较简单、自由且受外界影响较小，算法也 相对简便，实时性好。但是此方法并没有对驾驶员的驾驶姿态进行直接监测研宄，而是通 过方向盘、踏板、操纵杆的状态反向推导出驾驶员的驾驶姿态，从而导致检测结果不够直接 精确。申请号为CN201120567056的中国专利申请"一种疲劳驾驶预警装置"以及申请号为 CN201110029010的中国专利申请"不安全驾驶行为的识别与监控系统及方法"都属于上述 情况。而申请号为CN201110211193的中国专利"一种基于手部姿态跟踪的违规驾驶行为检 测方法"以及申请号为CN201010244609的中国专利"驾驶员踏板操作行为的测量装置及其 监测方法"是基于视频图像分析法对驾驶姿态进行检测，虽然这类方法可以直观检测驾驶 员的驾驶姿态，但是易受环境、光线的影响，且视角单一，算法复杂，实时性差。
【发明内容】
[0003] 本发明是针对现有技术中的不足之处，提出一种基于MEMS传感器的驾驶姿态检 测系统，以期能直接、稳定地检测驾驶员驾驶姿态并实时显示驾驶员驾驶姿态，从而提高驾 驶员驾驶姿态检测的抗干扰性和准确性。
[0004] 本发明为解决技术问题采用如下技术方案：
[0005] 本发明一种基于MEMS传感器的驾驶姿态检测系统的特点是包括：驾驶姿态信息 采集模块、驾驶姿态信息处理模块和驾驶姿态显示模块；
[0006] 所述驾驶姿态信息采集模块包括η个MEMS传感器，用于对驾驶员的驾驶姿态进 行实时采样，获得η个传感器数据组，记为Data = Wata1, data2，…，(Iatai,…，dataj ; I i n ;data^ ^ M i ^ B Z Μ? Μ ? ^ data, ,d^; 1彡m i;m i表示第i个传感器数据组共有m if传感器数据；表示所述第i个传感 器数据组Clatai中第j if传感器数据；
[0007] 对所述第i个传感器数据以数据帧格式进行封装；获得包含第i个帧头和第 Ji个数据的第j i帧传感器数据后发送给所述驾驶姿态信息处理模块；所述第j i个帧头包含 第Ji帧传感器数据的控制信息，用以表明所述第j 4贞传感器数据的来源；从而获得m i个传 η 感器数据的11^帧传感器数据；进而获得η个传感器数据组的Σ"ζ,帧传感器数据并分别发 1=1 送给所述驾驶姿态信息处理模块； η η
[0008] 所述驾驶姿态信息处理模块接收所述Σ叫帧传感器数据进行预处理后获得Σ叫 i:l ?:1 η 帧校准数据，并对所述Σ%帧校准数据进行多传感器数据同步处理，获得同步数据后传输 至所述驾驶姿态显示模块；
[0009] 所述驾驶姿态显示模块根据所接收到的同步数据进行驾驶员驾驶动作的实时显 不O
[0010] 本发明所述的基于MEMS传感器的驾驶姿态检测系统的特点也在于：
[0011] 所述MEMS传感器包括三轴陀螺仪和三轴加速度计；所述三轴陀螺仪用于实时检 测驾驶员驾驶动作的角速度值；所述三轴加速度计用于实时检测驾驶员驾驶动作的加速度 值。
[0012] 所述多传感器数据同步方法是按如下步骤进行： η
[0013] 步骤1、所述驾驶姿态信息处理模块根据所述Σ叫帧校准数据中每帧校准数据的 /-1 η η 接收时间点，依次获得Σ%个时间点数据；将所述Σ叫个时间点数据分别添加到相应的 r^l η Σ"〖帧校准数据的帧头中； i=l η
[0014] 步骤2、对所述Σ"~帧校准数据的帧头中的控制信息和时间点数据进行读取，获 得每帧校准数据的来源，从而将同一来源的校准数据归为一个数组，分别形成η个数组，记 为Z = (Z1, Z2，…，Zi,…，ZJ A表示第i个传感器数据组所对应的第i个数组；
[0015] 步骤3、根据所述时间点数据对第i个数组Zi中的所有元素进行升序排序，从而获 得排序后的数组Z,' …表示所述第Ji个传感器数据 <所对应的 第」\帧校准数据；从而排序后的数组Z' ={Ζ/，ζ2'，···，ζ/，···，ζη' };
[0016] 步骤4、设置同步时刻t和同步周期T ;
[0017] 步骤5、在所述排序后的数组Z'的每个数组中分别选取在所述同步时刻t之后的 第一帧校准数据；从而获得η帧预同步数据；
[0018] 步骤6、获得所述η帧预同步数据中每帧预同步数据的时间点数据，从而获得η个 时间点数据；
[0019] 步骤7、选取所述η个时间点数据中的最大值作为参考值；
[0020] 步骤8、将其余η-I个时间点数据分别与所述参考值进行求差和绝对值运算，获得 η-I个时间差；
[0021] 步骤9、设定一个指针1 ;1彡1彡η-I ;初始化I = 1 ;
[0022] 步骤10、判断第1个时间差是否小于所设定的同步阈值，若小于，则将1+1赋值给 1，并执行步骤11 ;若不小于，则执行步骤12 ;
[0023] 步骤11、判断I = η是否成立，若成立，则表示完成多传感器数据同步处理，从而获 得同步数据；并将T+t赋值给t后，返回步骤5执行，否则，返回步骤10 ;
[0024] 步骤12、第1个时间差来源于第1帧预同步数据与参考值之间的求差和绝对值运 算，从第1帧预同步数据所在的数组中，选取第1帧预同步数据的下一帧校准数据替换所述 第1帧预同步数据，从而得到新的第1帧预同步数据的时间点数据；并返回步骤8执行。
[0025] 与已有技术相比，本发明有益效果体现在：
[0026] 1、本发明通过驾驶姿态信息采集模块和驾驶姿态信息处理模块能够直接、稳定地 检测驾驶过程中驾驶员驾驶姿态，从而提高驾驶员驾驶姿态检测的抗干扰性和准确性；通 过驾驶姿态显示模块实时动态显示驾驶员驾驶姿态，从而提高驾驶员驾驶姿态显示的实时 性和稳定性。
[0027] 2、本发明通过运用驾驶姿态信息采集模块中的多个MEMS传感器，直接检测驾驶 员驾驶姿态变化的角速度值和加速度值，具有便携化、集成化的特点，受环境影响小，抗干 扰性强，适用于车载狭小复杂的空间环境，提高了驾驶员驾驶姿态检测的准确性。
[0028] 3、本发明通过运用多传感器同步方法对多传感器数据进行同步运算，解决了多传 感器数据传输过程中的不同步问题，从而有效避免信号延迟、误差累计问题，提高了多传感 器数据的准确性和同步性，为驾驶姿态的实时显示提供稳定有效的数据支持。
[0029] 4、本发明通过驾驶姿态显示模块，根据多传感器同步处理后的数据，实时显示与 之相对应的驾驶员驾驶姿态，从而能够实时、动态、直观的观察到驾驶员的驾驶姿态。
【附图说明】
[0030] 图1为本发明驾驶姿态检测系统结构图；
[0031] 图2为本发明驾驶姿态检测系统的实施例图；
[0032] 图3为本发明中多传感器数据同步方法流程图；
[0033] 附图标号：1任务主机、2第一显不器、3第二显不器、4 MEMS传感器、5方向盘、6座 椅、7操纵杆、8踏板。
【具体实施方式】
[0034] 如图1所示，本实施例中，一种基于MEMS传感器的驾驶姿态检测系统，包括：驾驶 姿态信息采集模块、驾驶姿态信息处理模块和驾驶姿态显示模块；
[0035] 具体实施中，在模拟驾驶平台进行实施试验，如图2所示，该平台提供仿真的驾驶 室环境用于进行模拟驾驶实验。模拟驾驶平台包含1任务主机、2第一显示器、3第二显示 器、4MEMS传感器、5方向盘、6座椅、7操纵杆、8踏板。其中，第一显示器2用于显示模拟驾 驶路况，多个MEMS传感器4即驾驶姿态信息采集模块，驾驶姿态信息处理模块运行于任务 主机1，第二显示器3用于显示驾驶姿态即驾驶姿态显示模块。方向盘5、座椅6、操纵杆7、 踏板位置8可实现自由调节。实验过程中，驾驶员佩戴多个MEMS传感器，坐于模拟驾驶平 台，调整座椅6、方向盘5、换挡杆7、踏板8至舒适位置后，按照驾驶姿态，根据第一显示器2 显示的模拟驾驶环境，进行模拟转向实验。
[0036] MEMS传感器包括三轴陀螺仪和三轴加速度计；三轴陀螺仪用于实时检测驾驶员 驾驶动作的角速度值；三轴加速度计用于实时检测驾驶员驾驶动作的加速度值。
[0037] 驾驶姿态信息采集模块包括η个采样频率为H的MEMS传感器，用于对驾驶员的驾 驶姿态进行实时采样，本实施例中，对驾驶员转向操纵过程中右手臂姿态进行检测，采用三 个采样频率为20ΗΖ的MEMS传感器，分别佩戴在驾驶员右臂的腕关节部、肘关节部和肩关节 部，如图2中驾驶员腕关节部、肘关节部和肩关节部黑色圆点所示，采集驾驶过程中右手臂 三个关节部位运动的加速度值和角速度值。
[0038] 通过η个传感器采样获得η个传感器数据组，记为Data = Wata1, (Iata2,…，(Iatai,… ，dataj ;1 < i < n Matai表示第i个传感器数据组；并有办叫; 1彡m i;m i表示第i个传感器数据组共有m i个传感器数据；表示第i个传感器数 据组Clatai中第j if传感器数据；
[0039] 对第Ji个传感器数据以十六进制数据帧格式进行封装；获得包含第Ji个帧头 和第Ji个数据的第j i帧传感器数据后发送给驾驶姿态信息处理模块；第j i个帧头包含第 Ji帧传感器数据的控制信息，用以表明第j力贞传感器数据的来源和类别；数据帧类别包含 加速度值数据帧及角速度值数据帧；数据为加速度数据或角速度数据；从而获得％个传感 η 器数据的叫帧传感器数据；进而获得η个传感器数据组的Σ"2/帧传感器数据并分别通过蓝 ?.:1 牙无线传输至发送给驾驶姿态信息处理模块；
[0040] 驾驶姿态信息处理模块接收?%帧传感器数据进行预处理后获得?%帧校准 i=l /-1 η 数据，并对Σ"(帧校准数据进行多传感器数据同步处理，获得同步数据后传输至驾驶姿态 i=l 显示模块；
[0041] 驾驶姿态信息采集过程中，由于传感器的灵敏度过高，容易受到外界信号干扰，进 而影响测量数据准确性，通过卡尔曼滤波对传感器数据进行预处理，能够有效滤除外界干 扰信号，提高传感器数据的准确度和可靠性。
[0042] 同时，MEMS传感器打开后立即开始采集并发送数据，驾驶姿态信息采集模块采用 多个MEMS传感器，各MEMS传感器打开时间不同，导致不同传感器发送给驾驶姿态信息处理 模块的数据存在时间差，造成各传感器数据不同步，进而导致驾驶姿态显示的不准确性，而 且，数据传输的不同步会使不准确性积累，可能造成驾驶姿态显示出现延迟和失真。因此， 需要对多传感器数据进行同步处理，将同步