[发明专利]一种微惯性测量系统的汽车档位信息采集装置及采集方法

权利要求书

1.一种微惯性测量系统的汽车档位信息采集方法，其特征在于：包括顺序执行的以下步骤：

步骤1、事先学习和存储好汽车档位操纵杆档位位置信息；

步骤2、采集当前汽车车体运动的三轴加速度和三轴角速度，并解算出在大地坐标系下当前汽车车体姿态角，采集当前汽车档位操纵杆的三轴加速度和三轴角速度，并解算出大地坐标系下当前汽车档位操纵杆姿态角，以汽车档位操纵杆姿态角减去相应的汽车车体姿态角获得当前汽车档位操纵杆相对于汽车车体的姿态角；

步骤3、结合当前汽车档位操纵杆相对于汽车车体的姿态角与汽车档位操纵杆上已知点的初始位置，获得当前上述已知点相对于汽车车体的位置；

步骤4、将当前上述已知点相对于汽车车体的位置与事先存储好的档位操纵杆档位位置信息做对比，获得当前汽车档位操纵杆的档位信息。

2.一种微惯性测量系统的汽车档位信息采集装置，其特征在于：包括第一陀螺仪模块、第二陀螺仪模块、微处理器MCU以及自学习和校准电路模块；

所述第一陀螺仪模块安装在车体内并测量当前汽车车体运动的三轴加速度和三轴角速度，由第一陀螺仪模块进行DMP解算并得到相对于大地坐标系的汽车车体姿态角，包括横滚角φ、俯仰角θ和偏航角ψ，并将汽车车体姿态角传递给微处理器MCU；

所述第二陀螺仪模块固定在汽车档位操纵杆上并测量当前汽车档位操纵杆的三轴加速度和三轴角速度，由第二陀螺仪模块进行DMP解算并得到相对于大地坐标系的汽车档位操纵杆姿态角，包括横滚角φ'、俯仰角θ'和偏航角ψ'，并将汽车档位操纵杆姿态角传递给微处理器MCU；

所述自学习和校准电路模块与微处理器MCU连接，通过自学习和校准过程，确认和存储不同汽车车型及对应的档位信息的特征值；所述微处理器MCU根据接收到的汽车车体姿态角和汽车档位操纵杆姿态角进行姿态算法判定得出当前汽车档位操纵杆的位置信息；结合当前汽车档位操纵杆的位置信息与自学习和校准电路模块中存储的档位信息的特征值，对比获得当前汽车档位操纵杆的档位信息。

3.根据权利要求2所述的微惯性测量系统的汽车档位信息采集装置，其特征在于：所述第二陀螺仪模块通过线缆(4)与微处理器MCU连接。

4.根据权利要求2或3中所述的微惯性测量系统的汽车档位信息采集装置，其特征在于：还包括接口电路，所述微处理器MCU与接口电路相连并将当前汽车档位操纵杆的档位信息输出。