专利名称: |
一种感知拨杆位置的方法和系统 |
摘要: |
一种感知拨杆位置的方法。利用两个独立的加速度传感器可以有效过滤噪声,提高检测精度,同时支持多挡位检测。本发明是档位的状态检测,不依赖于拨杆运动瞬间,可以根据实际需求控制检测频率,实现低功耗和高性能的平衡。 |
专利类型: |
发明专利 |
国家地区组织代码: |
北京;11 |
申请人: |
元橡科技(北京)有限公司 |
发明人: |
郑继川 |
专利状态: |
有效 |
申请日期: |
2019-08-01T00:00:00+0800 |
发布日期: |
2019-11-01T00:00:00+0800 |
申请号: |
CN201910708801.6 |
公开号: |
CN110395175A |
分类号: |
B60Q1/34(2006.01);B;B60;B60Q;B60Q1 |
申请人地址: |
100085 北京市海淀区上地十街1号院6号楼2层208-609 |
主权项: |
1.一种感知拨杆位置的方法,包括: 步骤1:将第一模块安装到拨杆上,第一模块包括第一加速度传感器和第一通信模块,所述第一加速度传感器用来测量加速度方向,所述第一通信模块用于将所述第一加速度传感器监测的加速度方向发送给处理器; 步骤2:将第二模块安装到车身上,第二模块包括第二加速度传感器和第二通信模块,所述第二加速度传感器用来测量加速度方向,所述第二通信模块用于将所述第二加速度传感器监测的加速度方向发送给处理器; 步骤3:安装完第一模块和第二模块后,在汽车静止的状态下进行第一模块和第二模块的标定,具体为:记录第一加速度传感器的加速度方向和第一模块的水平夹角θ01,记录第二加速度传感器的加速度方向和第一模块的水平夹角θ02; 步骤4:当监测周期到来时,在同一时刻,测量第一加速度传感器的加速度方向和第一模块的水平夹角θ1和测量第二加速度传感器的加速度方向和第一模块的水平夹角θ2; 步骤5:通过以下公式计算第一模块相对于第二模块的运动夹角: θ1-θ2-(θ01–θ02); 步骤6:通过平滑滤波方法去掉加速度传感器的测量噪声; 步骤 7:当第一模块相对于第二模块的运动夹角大于预定值且超过一段时间后即可判断拨杆移动到一个位置了。 2.如权利要求1所述的方法,步骤4中:监测周期的设置可以与第一模块和第二模块的电量容量相关,电量容量较多则可以设置较小的监测周期。 3.如权利要求1所述的方法,步骤4中:监测周期的设置可以与拨杆档位数量相关,拨杆档位数量多,则每一次的位置变动幅度小,最好是设置更小的监测周期。 4.如权利要求1所述的方法,步骤6中:平滑滤波方法可以从下面现有的方法中选择:盒式滤波、均值滤波、高斯滤波、中值滤波、双边滤波、导向滤波。 5.一种感知拨杆位置的系统,包括: 第一模块,该第一模块被安装到拨杆上,第一模块包括第一加速度传感器和第一通信模块,所述第一加速度传感器用来测量加速度方向,所述第一通信模块用于将所述第一加速度传感器监测的加速度方向发送给处理器; 第二模块,该第二模块被安装到车身上,第二模块包括第二加速度传感器和第二通信模块,所述第二加速度传感器用来测量加速度方向,所述第二通信模块用于将所述第二加速度传感器监测的加速度方向发送给处理器; 标定部件,用于在安装完第一模块和第二模块后,在汽车静止的状态下进行第一模块和第二模块的标定,具体为:记录第一加速度传感器的加速度方向和第一模块的水平夹角θ01,记录第二加速度传感器的加速度方向和第一模块的水平夹角θ02; 检测部件,用于当监测周期到来时,在同一时刻,测量第一加速度传感器的加速度方向和第一模块的水平夹角θ1和测量第二加速度传感器的加速度方向和第一模块的水平夹角θ2; 计算部件,用于通过以下公式计算第一模块相对于第二模块的运动夹角: θ1-θ2-(θ01–θ02); 去噪部件,用于通过平滑滤波方法去掉加速度传感器的测量噪声; 判定部件,用于当第一模块相对于第二模块的运动夹角大于预定值且超过一段时间后即可判断拨杆移动到一个位置了。 6.如权利要求5所述的系统,监测周期的设置可以与第一模块和第二模块的电量容量相关,电量容量较多则可以设置较小的监测周期。 7.如权利要求5所述的系统,监测周期的设置可以与拨杆档位数量相关,拨杆档位数量多,则每一次的位置变动幅度小,最好是设置更小的监测周期。 8.如权利要求5所述的系统,平滑滤波方法可以从下面现有的方法中选择:盒式滤波、均值滤波、高斯滤波、中值滤波、双边滤波、导向滤波。 9.一种计算机可读介质,包括了计算机程序,处理器执行该程序来实现如下方法: 步骤1:将第一模块安装到拨杆上,第一模块包括第一加速度传感器和第一通信模块,所述第一加速度传感器用来测量加速度方向,所述第一通信模块用于将所述第一加速度传感器监测的加速度方向发送给处理器; 步骤2:将第二模块安装到车身上,第二模块包括第二加速度传感器和第二通信模块,所述第二加速度传感器用来测量加速度方向,所述第二通信模块用于将所述第二加速度传感器监测的加速度方向发送给处理器; 步骤3:安装完第一模块和第二模块后,在汽车静止的状态下进行第一模块和第二模块的标定,具体为:记录第一加速度传感器的加速度方向和第一模块的水平夹角θ01,记录第二加速度传感器的加速度方向和第一模块的水平夹角θ02; 步骤4:当监测周期到来时,在同一时刻,测量第一加速度传感器的加速度方向和第一模块的水平夹角θ1和测量第二加速度传感器的加速度方向和第一模块的水平夹角θ2; 步骤5:通过以下公式计算第一模块相对于第二模块的运动夹角: θ1-θ2-(θ01–θ02); 步骤6:通过平滑滤波方法去掉加速度传感器的测量噪声; 步骤 7:当第一模块相对于第二模块的运动夹角大于预定值且超过一段时间后即可判断拨杆移动到一个位置了。 10.一种计算机程序,包括指令来执行如下方法: 步骤1:将第一模块安装到拨杆上,第一模块包括第一加速度传感器和第一通信模块,所述第一加速度传感器用来测量加速度方向,所述第一通信模块用于将所述第一加速度传感器监测的加速度方向发送给处理器; 步骤2:将第二模块安装到车身上,第二模块包括第二加速度传感器和第二通信模块,所述第二加速度传感器用来测量加速度方向,所述第二通信模块用于将所述第二加速度传感器监测的加速度方向发送给处理器; 步骤3:安装完第一模块和第二模块后,在汽车静止的状态下进行第一模块和第二模块的标定,具体为:记录第一加速度传感器的加速度方向和第一模块的水平夹角θ01,记录第二加速度传感器的加速度方向和第一模块的水平夹角θ02; 步骤4:当监测周期到来时,在同一时刻,测量第一加速度传感器的加速度方向和第一模块的水平夹角θ1和测量第二加速度传感器的加速度方向和第一模块的水平夹角θ2; 步骤5:通过以下公式计算第一模块相对于第二模块的运动夹角: θ1-θ2-(θ01–θ02); 步骤6:通过平滑滤波方法去掉加速度传感器的测量噪声; 步骤 7:当第一模块相对于第二模块的运动夹角大于预定值且超过一段时间后即可判断拨杆移动到一个位置了。 |
所属类别: |
发明专利 |