[发明专利]一种手动挡机动车档位的自动检测方法及装置

摘要

本发明提供一种手动挡机动车档位的自动检测方法及装置，包括对机动车档位相对空间姿态最大分布范围进行标定及档位检测，先采集机动车的空间姿态，再采集操纵杆的空间姿态；进行条件滑窗滤波处理后相减得到此时档位的初步空间姿态数值；与步骤标定的操纵杆在各档位内的相对空间姿态最大分布范围进行比较，得到档位状态的检测值；进行评估得到档位状态评估值；显示并同时送到上位机中，则完成一次档位状态的检测。本发明通过算法对可能出现的干扰和噪声进行剔除和滤波处理，提高档位检测结果的可靠性；在检测时把操纵杆的自由行程考虑在内，并对档位检测值进行二次评估，提高档位检测的准确性，使之不受机动车新旧磨损的影响。

主权项

1.一种手动挡机动车档位的自动检测方法，其特征在于：包括以下步骤：(1)对机动车档位相对空间姿态最大分布范围进行标定：分别采集操纵杆在1档、2档、3档、4档、5档、倒档或空档内，操纵杆处于该档位的前、后、左、右四个方向的最大自由行程时的空间姿态；同时采集此时机动车的空间姿态；然后将操纵杆的空间姿态减去机动车的空间姿态，从而计算出操纵杆在此档位的前、后、左、右四个方向的最大自由行程时的相对空间姿态；则以其为边界而标定出操纵杆在该档位内的相对空间姿态最大分布范围；根据此方法，依次标出操纵杆在各档位的相对空间姿态最大分布范围；(2)档位检测：a.先采集机动车的空间姿态，再采集操纵杆的空间姿态；b.将步骤a中采集到的机动车的空间姿态和操纵杆的空间姿态数值分别进行条件滑窗滤波处理，以消除采集过程中外部干扰和噪声的影响；c.将经步骤b处理后的操纵杆的空间姿态数值减去处理后的机动车空间姿态数值，得到此时档位的初步空间姿态数值；d.把档位的初步空间姿态数值与步骤(1)标定的操纵杆在各档位内的相对空间姿态最大分布范围进行比较，得到档位状态的检测值；e.对步骤d得出的档位状态的检测值进行评估，以消除相邻档位之间重叠范围的影响，得到档位状态评估值；f.把档位状态评估值作为实际状态显示出来，并同时送到上位机中，则完成一次档位状态的检测。