[发明专利]一种应用于驾考考试的桩杆检测装置及方法

权利要求书

1.一种应用于驾考考试的桩杆检测装置，其特征在于，包括桩杆本体和检测电路；所述检测电路设置于桩杆本体上，所述检测电路包括加速度计、陀螺仪和微处理器，所述加速度计和陀螺仪均与微处理器电性连接；

所述加速度计用于将测量得到的桩杆本体的加速度传输至微处理器；

所述陀螺仪用于将测量得到的桩杆本体的角速度传输至微处理器；

所述微处理器根据接收到的加速度和角速度以得姿态角。

2.如权利要求1所述的应用于驾考考试的桩杆检测装置，其特征在于，还包括与微处理器电性连接的通信模块，所述通信模块用于接收微处理器传输的姿态角，并将该姿态角传输至上位机以判断桩杆本体的状态。

3.如权利要求1或2所述的应用于驾考考试的桩杆检测装置，其特征在于，还包括探头管连接件，所述检测电路设置于该探头管连接件内，所述探头管连接件与桩杆本体可拆卸连接。

4.如权利要求3所述的应用于驾考考试的桩杆检测装置，其特征在于，所述检测电路安装于PCB板上，所述PCB板设置于探头管连接件内。

5.如权利要求4所述的应用于驾考考试的桩杆检测装置，其特征在于，所述探头管连接件的中部设置有一腔体，所述PCB板设置于该腔体内，且所述腔体内填充有防水胶。

6.一种应用于驾考考试的桩杆检测方法，其特征在于，包括以下步骤：

加速度获取步骤：通过加速度计获取桩杆本体处于载体水平坐标系的第一加速度和处于载体坐标系中的第二加速度；

第一计算步骤：根据第一加速度和第二加速度计算得到该桩杆本体的第一姿态角；

第二计算步骤：通过陀螺仪得到所述桩杆本体的角速度，并对该角速度进行积分以得到该桩杆本体的第二姿态角；

第三计算步骤：根据第一姿态角和第二姿态角进行插值以得到该桩杆本体的输出姿态角。

7.如权利要求6所述的应用于驾考考试的桩杆检测方法，其特征在于，在第三计算步骤中：所述第一姿态角和第二姿态角采用四元数的形式进行插值计算以得到该桩杆本体的输出姿态角。

8.如权利要求6或7所述的应用于驾考考试的桩杆检测方法，其特征在于，在第三计算步骤之后还包括第一判断步骤：将所述桩杆本体的输出姿态角传输至一上位机以判断是否擦碰桩杆。

9.如权利要求6或7所述的应用于驾考考试的桩杆检测方法，其特征在于，在第三计算步骤之后还包括以下步骤：

归一化步骤：将对该桩杆本体的输出姿态角进行角度归一化后以得到该桩杆本体的加速度和垂偏角；

第二判断步骤：根据该加速度和垂偏角来判断是否擦碰桩杆本体。

10.如权利要求9所述的应用于驾考考试的桩杆检测方法，其特征在于，在判断步骤中，当满足加速度大于5m/s²或者垂偏角大于3m/s²的时候，则判断擦碰到桩杆本体。