CN112556570A - 用于工程机械的旋转角度数据处理方法、装置以及介质 - Google Patents

Abstract

本公开提供了一种用于工程机械的旋转角度数据处理方法、装置、控制器以及存储介质，涉及工程机械技术领域，其中方法包括：获取角度传感器磁感应装置发送的第一电压信号和第二电压信号；对第一电压信号和第二电压信号进行滤波处理，获得第一滤波数据和第二滤波数据；获得分别与第一滤波数据和第二滤波数据相对应的第一角度数据和第二角度数据，基于第一角度数据和第二角度数据获取旋转角度数据。本公开的方法、装置、控制器以及介质，可以快速灵敏地测量出车体旋转角度数据；采用磁感应角度传感器测量车身旋转角度，安装方便，实施成本投入少，信号反应灵敏，能够提高机械控制精度和操控舒适性。

Description

用于工程机械的旋转角度数据处理方法、装置以及介质

技术领域

本公开涉及工程机械技术领域，尤其涉及一种用于工程机械的旋转角度数据处理方法、装置、控制器以及存储介质。

背景技术

随着科技的进步，工程机械领域的发展也进入了加速期，特别是具备自动功能、远程控制功能的智能挖掘机在施工项目中发挥着重要的作用。为了满足智能挖掘机使用要求，需要实时检测挖掘机旋转过程中的角度，并保证整机按预定旋转角度停止，满足整机控制要求。为完成对挖掘机旋转角度的精准控制，需要在挖掘机转台上安装旋转角度测量装置。

在现有技术中，测量挖掘机旋转角度的方法一般采用惯性测量单元(IMU),或者是在车身旋转中心体上安装旋转角度编码器。惯性测量单元用于测量动态状态下的倾角与加速度等诸多信息，具有陀螺仪和加速度仪等融合功能，是一种集成度较高的动态信息测量装置，但是其成本过高，且集成的大部分功能在实际使用中并非硬性需求，没有体现出最优性价比；在车身旋转体上安装旋转角度编码器，需要对挖掘机中心旋转体部分进行结构改制，安装方式复杂；如果安装定位不准确，所检测的编码信号误码率较高。

发明内容

有鉴于此，本发明要解决的一个技术问题是提供一种用于工程机械的旋转角度数据处理方法、装置、控制器以及存储介质。

根据本公开的第一方面，提供一种用于工程机械的旋转角度数据处理方法，包括：在工程机械的下车转台和上车转台之间产生相对角度位移的过程中，获取角度传感器磁感应装置发送的第一电压信号和第二电压信号；其中，角度传感器组件包括：角度传感器磁芯和所述角度传感器磁感应装置，所述角度传感器磁芯与下车中心轴固定连接，所述角度传感器磁感应装置与上车转台中心轴固定连接；对所述第一电压信号和所述第二电压信号进行滤波处理，获得第一滤波数据和第二滤波数据；根据所述角度传感器磁感应装置产生的电压信号与角度之间的线性关系，获得分别与所述第一滤波数据和所述第二滤波数据相对应的第一角度数据和第二角度数据；基于所述第一角度数据和所述第二角度数据获取旋转角度数据。

可选地，在获得所述第一电压信号和所述第二电压信号之后，所述方法还包括：将所述第一电压信号和所述第二电压信号进行限幅处理，获得第一限幅电压数据和第二限幅电压数据。

可选地，其中，所述第一电压信号为U1(t)，所述第二电压信号为U2(t)，t为采样点；所述将所述第一角度数据和所述第二角度数据进行限幅处理包括：对于所述第一电压信号设置第一有效检测区间；其中，与所述第一有效检测区间相对应的第一电压范围为第一电压值-第二电压值；所述第一电压值为电压信号量程下限，所述第二电压值为电压信号量程上限；对于所述第二电压信号设置有第二有效检测区间；其中，与所述第二有效检测区间相对应的第二电压范围为所述第一电压值-所述第二电压值；当所述U1(t)或所述U2(t)的值小于所述第一电压值时，将所述U1(t)或所述U2(t)的值设置为所述第一电压值；当所述U1(t)或所述U2(t)的值大于所述第二电压值时，则将所述U1(t)或所述U2(t)的值设置为所述第二电压值。

可选地，所述获得第一滤波数据和第二滤波数据包括：连续采集所述U1(t)的N个电压数据，获得所述第一滤波数据为：

其中，此N个电压数据为U1(t),U1(t-1),U1(t-2),U1(t-3)…U1(t-N-1)，此N个电压数据中的最大值和最小值分别为U_Max1和U_Min1；N＝4,5…n；

连续采集所述U2(t)的N个电压数据，获得所述第二滤波数据为：

其中，此N个电压数据为U2(t),U2(t-1),U2(t-2),U2(t-3)…U2(t-N-1)，此N个电压数据中的最大值和最小值分别为U_Max2和U_Min2。

可选地，所述获得分别与所述第一滤波数据和所述第二滤波数据相对应的第一角度数据和第二角度数据包括：对所述第一滤波数据进行线性换算处理，获得所述第一角度数据为：

其中，F1_Min为所述第一电压值，F1_Max为所述第二电压值，A1_Max为进行线性换算处理后的数据最大值，A1_Min为进行线性换算处理后的数据最小值；t＝1,2,3…N；

对所述第二滤波数据进行线性换算处理，获得所述第二角度数据为：

其中，F2_Min为所述第一电压值，F2_Max为所述第二电压值；A2_Max为进行线性换算处理后的数据最大值，A2_Min为进行线性换算处理后的数据最小值。

可选地，所述U1(t)和所述U2(t)对应的有效角度范围为θ1-θ2，所述A1(t)和所述A2(t)的相位差为180.0°；所述基于所述第一角度数据和所述第二角度数据获得旋转角度数据包括：将与所述U1(t)和所述U2(t)对应的坐标系的、用于表征角度的横坐标平移，使此横坐标的原点与所述θ1重合，形成新的虚拟坐标系；确定所述A2(t)的最小有效角度与所述虚拟坐标系的原点重合，对应的所述A1(t)的有效曲线相对于所述虚拟坐标系的原点相位差为180-θ1；获得所述旋转角度数据为：

可选地，所述工程机械包括：挖掘机。

根据本公开的第二方面，提供一种用于工程机械的旋转角度数据处理装置，包括：电压信号采集模块，用于在工程机械的下车转台和上车转台之间产生相对角度位移的过程中，获取角度传感器磁感应装置发送的第一电压信号和第二电压信号；其中，角度传感器组件包括：角度传感器磁芯和所述角度传感器磁感应装置，所述角度传感器磁芯与下车中心轴固定连接，所述角度传感器磁感应装置与上车转台中心轴固定连接；电压信号滤波模块，用于对所述第一电压信号和所述第二电压信号进行滤波处理，获得第一滤波数据和第二滤波数据；角度数据转换模块，用于根据所述角度传感器磁感应装置产生的电压信号与角度之间的线性关系，获得分别与所述第一滤波数据和所述第二滤波数据相对应的第一角度数据和第二角度数据；角度数据获取模块，用于基于所述第一角度数据和所述第二角度数据获取旋转角度数据。

可选地，电压限幅处理模块，用于将所述第一电压信号和所述第二电压信号进行限幅处理，获得第一限幅电压数据和第二限幅电压数据。

可选地，所述第一电压信号为U1(t)，所述第二电压信号为U2(t)，t为采样点；所述电压限幅处理模块，用于对于所述第一电压信号设置第一有效检测区间；其中，与所述第一有效检测区间相对应的第一电压范围为第一电压值-第二电压值；所述第一电压值为电压信号量程下限，所述第二电压值为电压信号量程上限；对于所述第二电压信号设置有第二有效检测区间；其中，与所述第二有效检测区间相对应的第二电压范围为所述第一电压值-所述第二电压值；所述电压限幅处理模块，还用于当所述U1(t)或所述U2(t)的值小于所述第一电压值时，将所述U1(t)或所述U2(t)的值设置为所述第一电压值；当所述U1(t)或所述U2(t)的值大于所述第二电压值时，则将所述U1(t)或所述U2(t)的值设置为所述第二电压值。

可选地，所述电压信号滤波模块，还用于连续采集所述U1(t)的N个电压数据，获得所述第一滤波数据为：

其中，此N个电压数据为U1(t),U1(t-1),U1(t-2),U1(t-3)…U1(t-N-1)，此N个电压数据中的最大值和最小值分别为U_Max1和U_Min1；N＝4,5…n；

所述电压信号滤波模块，还用于连续采集所述U2(t)的N个电压数据，获得所述第二滤波数据为：

其中，此N个电压数据为U2(t),U2(t-1),U2(t-2),U2(t-3)…U2(t-N-1)，此N个电压数据中的最大值和最小值分别为U_Max2和U_Min2。

可选地，所述角度数据转换模块，还用于对所述第一滤波数据进行线性换算处理，获得所述第一角度数据为：

其中，F1_Min为所述第一电压值，F1_Max为所述第二电压值，A1_Max为进行线性换算处理后的数据最大值，A1_Min为进行线性换算处理后的数据最小值；t＝1,2,3…N；

所述角度数据转换模块，还用于对所述第二滤波数据进行线性换算处理，获得所述第二角度数据为：

其中，F2_Min为所述第一电压值，F2_Max为所述第二电压值；A2_Max为进行线性换算处理后的数据最大值，A2_Min为进行线性换算处理后的数据最小值。

可选地，所述U1(t)和所述U2(t)对应的有效角度范围为θ1-θ2，所述A1(t)和所述A2(t)的相位差为180.0°；所述角度数据获取模块，用于将与所述U1(t)和所述U2(t)对应的坐标系的、用于表征角度的横坐标平移，使此横坐标的原点与所述θ1重合，形成新的虚拟坐标系；确定所述A2(t)的最小有效角度与所述虚拟坐标系的原点重合，对应的所述A1(t)的有效曲线相对于所述虚拟坐标系的原点相位差为180-θ1；

所述角度数据获取模块，还用于获得所述旋转角度数据为：

根据本公开的第三方面，提供一种用于工程机械的旋转角度数据处理装置，包括：存储器；以及耦接至所述存储器的处理器，所述处理器被配置为基于存储在所述存储器中的指令，执行如上所述的方法。

根据本公开的第四方面，提供一种控制器，包括：如上所述的用于工程机械的旋转角度数据处理装置。

根据本公开的第五方面，提供一种计算机可读存储介质，所述计算机可读存储介质存储有计算机指令，所述指令被处理器执行如上的方法。

本公开的用于工程机械的旋转角度数据处理方法、装置、控制器以及存储介质，可以标定角度传感器电磁感应电压信号和车体旋转角度之间的线性关系，能够快速灵敏地测量出车体旋转角度数据；采用磁感应角度传感器测量车身旋转角度，安装方便，实施成本投入少，信号反应灵敏；可以完成旋转角度的检测和调试工作，成本投入降低显著，大幅缩短整车生产和调试周期，有效提升了工程机械的智能化控制水平；通过实时检测挖掘机旋转过程中的角度，保证了整机按预定旋转角度停止，可以有效提高机械控制精度和操控舒适性。

附图说明

为了更清楚地说明本公开实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作一简单地介绍，显而易见地，下面描述中的附图仅仅是本公开的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动性的前提下，还可以根据这些附图获得其它的附图。

图1为根据本公开的用于工程机械的旋转角度数据处理方法的一个实施例的流程示意图；

图2为角度传感器组件的安装示意图；

图3为角度传感器组件检测的电压信号对应的角度曲线图；

图4为对电压信号进行限幅处理的曲线示意图；

图5为进行中位值平均滤波处理的曲线示意图；

图6为进行解析换算处理的曲线示意图；

图7为根据本公开的用于工程机械的旋转角度数据处理方法的另一个实施例的流程示意图；

图8为根据本公开的用于工程机械的旋转角度数据处理装置的一个实施例的模块示意图；

图9为根据本公开的用于工程机械的旋转角度数据处理装置的另一个实施例的模块示意图；

图10为根据本公开的用于工程机械的旋转角度数据处理装置的又一个实施例的模块示意图。

具体实施方式

下面参照附图对本公开进行更全面的描述，其中说明本公开的示例性实施例。下面将结合本公开实施例中的附图，对本公开实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本公开一部分实施例，而不是全部的实施例。基于本公开中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其它实施例，都属于本公开保护的范围。下面结合各个图和实施例对本公开的技术方案进行多方面的描述。

下文中的“第一”、“第二”等仅用于描述上相区别，并没有其它特殊的含义。

图1为根据本公开的用于工程机械的旋转角度数据处理方法的一个实施例的流程示意图，如图1所示：

步骤101，在工程机械的下车转台和上车转台之间产生相对角度位移的过程中，获取角度传感器磁感应装置发送的第一电压信号和第二电压信号。

在一个实施例中，角度传感器组件包括角度传感器磁芯和角度传感器磁感应装置，角度传感器磁芯与下车中心轴固定连接，角度传感器磁感应装置与上车转台中心轴固定连接。工程机械可以为多种，例如为挖掘机等。

如图2所示，角度传感器组件包括角度传感器磁芯02和角度传感器磁感应装置04。控制器05与角度传感器组件采用信号线相连接。角度传感器磁芯02与挖掘机下车转台01的中心轴采用机械螺纹连接，角度传感器磁感应装置04与挖掘机上车转台03的中心轴采用机械螺纹连接。

通过在挖掘机旋转中心轴上安装磁感应式角度传感器，角度传感器磁芯固定安装在挖掘机下车中心轴上，角度传感器磁感应装置固定安装在挖掘机上车转台中心体上；当挖掘机旋转时，下车和上车转台之间产生相对角度位移，连带着角度传感器旋转，角度传感器磁感应装置产生两路磁感应电压信号并发送给车载控制器；车载控制器经过运算，完成电压信号处理，即可得出挖掘机实时旋转角度信息；采用磁感应角度传感器测量车身旋转角度，安装方便，信号反应灵敏，角度换算方法简单。

步骤102，对第一电压信号和第二电压信号进行滤波处理，获得第一滤波数据和第二滤波数据。

步骤103，根据角度传感器磁感应装置产生的电压信号与角度之间的线性关系，获得分别与第一滤波数据和第二滤波数据相对应的第一角度数据和第二角度数据。

步骤104，基于第一角度数据和第二角度数据获取旋转角度数据。

本公开的用于工程机械的旋转角度数据处理方法采取信号限幅、中位值平均滤波、分段线性标定以及输出信号综合解析相结合的信号处理方法，对第一电压信号和第二电压信号进行处理，能够精确的计算出车身实时连续、完整稳定的旋转角度数据。

在一个实施例中，在获得第一电压信号和第二电压信号之后，将第一电压信号和第二电压信号进行限幅处理，获得第一限幅电压数据和第二限幅电压数据。

如图3所示，角度传感器磁感应装置发送的第一电压信号和第二电压信号分别为中的电压信号1和电压信号2。电压信号1有效取值范围为0.5V～4.5V,并且两端电压信号存在死区数据；电压信号1对应的有效角度范围为45.0°～315.0°。

电压信号2有效取值范围为0.5V～4.5V,并且两端电压信号存在死区数据；电压信号2对应的有效角度范围为45.0°～315.0°；电压信号1与电压信号2对应的有效角度存在180°的相位差，且角度数据不完整。

采集完第一路电压信号对应的有效角度范围45.0°～225.0°之后，及时切换到第二路电压信号对应的有效角度范围45.0°～225.0°内进行数据采集，可以有效避免两路死区信号对输出角度数据的影响，得到连续完整的旋转角度数据。

在一个实施例中，第一电压信号为U1(t)，第二电压信号为U2(t)，t为采样点，对于第一电压信号设置第一有效检测区间，与第一有效检测区间相对应的第一电压范围为第一电压值-第二电压值；第一电压值为电压信号量程下限，第二电压值为电压信号量程上限，第一电压值可以为0.5V等，第二电压值可以为4.5V等。对于第二电压信号设置有第二有效检测区间，与第三有效检测区间相对应的第三电压范围为第一电压值-第二电压值。

当U1(t)或U2(t)的值小于第一电压值时，将U1(t)或U2(t)的值设置为第一电压值。当U1(t)或U2(t)的值大于第二电压值时，则将U1(t)或U2(t)的值设置为第二电压值。

连续采集U1(t)的N个电压数据，获得第一滤波数据为：

其中，此N个电压数据为U1(t),U1(t-1),U1(t-2),U1(t-3)…U1(t-N-1)，此N个电压数据中的最大值和最小值分别为U_Max1和U_Min1；N＝4,5…n。

连续采集U2(t)的N个电压数据，获得第二滤波数据为：

此N个电压数据为U2(t),U2(t-1),U2(t-2),U2(t-3)…U2(t-N-1)，此N个电压数据中的最大值和最小值分别为U_Max2和U_Min2。

对第一滤波数据进行线性换算处理，获得第一角度数据为：

其中，F1_Min为第一电压值，F1_Max为第二电压值，A1_Max为进行线性换算处理后的数据最大值，A1_Min为进行线性换算处理后的数据最小值；t＝1,2,3…N。

对第二滤波数据进行线性换算处理，获得第二角度数据为：

其中，F2_Min为第一电压值，F2_Max为第二电压值；A2_Max为进行线性换算处理后的数据最大值，A2_Min为进行线性换算处理后的数据最小值。

U1(t)和U2(t)对应的有效角度范围为θ1-θ2，A1(t)和A2(t)的相位差为180.0°，θ1可以为45°等，θ2可以为315.0°等，θ3可以为135.0°等。将与U1(t)和U2(t)对应的坐标系的、用于表征角度的横坐标平移，使此横坐标的原点与θ1重合，形成新的虚拟坐标系；确定A2(t)的最小有效角度与虚拟坐标系的原点重合，对应的A1(t)的有效曲线相对于虚拟坐标系的原点相位差为180-θ1；获得旋转角度数据为：

图7为根据本公开的用于工程机械的旋转角度数据处理方法的另一个实施例的流程示意图，如图7所示：

步骤701,上车转台与下车转台产生相对角度。

步骤702，控制器分别采集两路电压信号数据。例如，控制器通过角度传感器磁感应装置采集第一电压信号和第二电压信号。

步骤703，控制器对两路电压信号进行限幅方法处理。

例如，采集的第一电压信号和第二电压信号分别为U1(t)和U2(t)，t为采样点，U1(t)和U2(t)分别对应于图2中的电压信号1和电压信号2。以采集的电压信号1为例，对电压信号1进行号限幅处理：

其中，4500mV为电压信号1量程幅值上限，500mV为电压信号1量程幅值下限,t＝1,2…N。针对第一电压信号进行限幅处理后，获得的第一电压信号如图3所示，在采集到的电压信号1中，超出幅值上限和下限的数据均不予采用。对于电压信号2采用与对电压信号1进行号限幅处理的相同方法进行处理。

步骤704，控制器对电压信号进行中位值平均滤波方法处理。

例如，对电压信号1和电压信号2分别进行中位值平均滤波处理，以电压信号1为例进行说明：

连续采集N个电压数据，记录为

U1(t),U1(t-1),U1(t-2),U1(t-3)…U1(t-N-1)；对N个数据进行排序筛选，取出并记录其中一个最大值U_Max和一个最小值U_Min；将余下的数进行求和后再计算平均值，即得到所需的滤波数据F1(t)；

其中，F1(t)为滤波后数据，t为采样点，N＝4,5…n为需要连续采集的数据量；连续采集数据量N取值越大，滤波响应越慢，但是滤波处理后信号平滑度较高；连续采集数据量N取值越小，滤波响应越快，但是滤波处理后信号平滑度较差。

针对电压信号1进行中位值平均滤波处理后，数据变化关系如图5所示，滤波前信号频率和幅值存在较大的波动，经过中位值平均滤波处理后得到了稳定且平滑的数据。对于电压信号2采用与对电压信号1进行中位值平均滤波的相同方法进行处理。

步骤705，控制器完成线性换算输出两路角度数据。控制器可以将滤波后的数据按照角度传感器磁感应装置产生的电压信号与相应角度之间的相关线性关系进行换算处理，得到两路角度数据。下面以电压信号1为例进行说明。

电压信号1的有效电压范围为500mV～4500mV，对应有效旋转角度数据为45.0°～315.0°，相应线性换算处理方法如下：

其中，A1(t)为线性换算后的电压信号1的角度输出数据，F1(t)为经过滤波后的电压信号1数据，F1_Min为滤波后的数据最小值＝500mV(运算精度选取为0.001V)，F1_Max为滤波后的数据最大值4500mV(运算精度选取为0.001V)；A1_Min为线性换算后的数据最小值＝450(运算精度选取为0.1°)，A1_Max为线性换算后的数据最大值＝3150(运算精度选取为0.1°)；t＝1,2,3…N。

对于电压信号2采用与对电压信号1进行线性换算的相同方法进行处理，对于采集信号U2(t)得到旋转角度数据A2(t)，针对第一电压信号和第二电压信号进行线性换算处理后，电压采样数据与角度输出变化关系如图2所示。

步骤706,控制器解析输出连续的旋转角度数据。

例如，控制器对线性换算后的角度数据A1(t)和A2(t)进行有效数据解析，得到连续完整的旋转角度数据，数据范围为0°～359.9°。基于图2所描述的连续有效角度区间关系，A1(t)和A2(t)的相位差为180.0°，如果将电压坐标轴向右平移45.0°，使坐标原点与信号2对应的A2(t)最小有效角度重合，则对应的A1(t)有效曲线相对于虚拟坐标原点相位差为135.0°；相应的解析换算处理方法如下：

其中，A1(t)为线性换算后的电压信号1的有效角度数据，A2(t)为线性换算后的电信信号2的有效角度数据；A(t)为线性换算后的连续完整的旋转角度数据，旋转角度数据范围为0～3599，数据处理运算精度为0.1°。

相应的解析换算处理后，针对两路原始电压信号与连续完整的旋转角度输出结果如图6所示，电压信号1数据范围为500mV～4500mV，电压信号2数据范围为500mV～4500mV，换算后的连续完整的旋转角度数据范围为0～3599。

控制器对旋转角度两路电压信号经过限幅、滤波、线性换算以及解析处理后，明显地效果，解析换算后的连续完整的旋转角度数据与两路原始电压信号时序同步，实际波形与理论波形吻合，处理后的车身旋转信号稳定，维持了旋转角度连续性。

在一个实施例中，如图8所示，本公开提供一种用于工程机械的旋转角度数据处理装置80，包括：电压信号采集模块81、电压信号滤波模块82、角度数据转换模块83和角度数据获取模块84。电压信号采集模块81在工程机械的下车转台和上车转台之间产生相对角度位移的过程中，获取角度传感器磁感应装置发送的第一电压信号和第二电压信号；角度传感器组件包括：角度传感器磁芯和角度传感器磁感应装置，角度传感器磁芯与下车中心轴固定连接，角度传感器磁感应装置与上车转台中心轴固定连接。

电压信号滤波模块82对第一电压信号和第二电压信号进行滤波处理，获得第一滤波数据和第二滤波数据。角度数据转换模块83根据角度传感器磁感应装置产生的电压信号与角度之间的线性关系，获得分别与第一滤波数据和第二滤波数据相对应的第一角度数据和第二角度数据。角度数据获取模块84基于第一角度数据和第二角度数据获取旋转角度数据。

在一个实施例中，如图9所示，本公开的用于工程机械的旋转角度数据处理装置80还包括电压限幅处理模块85，电压限幅处理模块85将第一电压信号和第二电压信号进行限幅处理，获得第一限幅电压数据和第二限幅电压数据。

例如，第一电压信号为U1(t)，第二电压信号为U2(t)，t为采样点；电压限幅处理模块85对于第一电压信号设置第一有效检测区间，与第一有效检测区间相对应的第一电压范围为第一电压值-第二电压值；第一电压值为电压信号量程下限，第二电压值为电压信号量程上限。

电压限幅处理模块85对于第二电压信号设置有第二有效检测区间，与第三有效检测区间相对应的第三电压范围为第一电压值-第二电压值。当U1(t)或U2(t)的值小于第一电压值时，电压限幅处理模块85将U1(t)或U2(t)的值设置为第一电压值；当U1(t)或U2(t)的值大于第二电压值时，电压限幅处理模块85将U1(t)或U2(t)的值设置为第二电压值。

在一个实施例中，电压信号滤波模块82连续采集U1(t)的N个电压数据，获得第一滤波数据为：

其中，此N个电压数据为U1(t),U1(t-1),U1(t-2),U1(t-3)…U1(t-N-1)，此N个电压数据中的最大值和最小值分别为U_Max1和U_Min1；N＝4,5…n。

电压信号滤波模块82连续采集U2(t)的N个电压数据，获得第二滤波数据为：

其中，此N个电压数据为U2(t),U2(t-1),U2(t-2),U2(t-3)…U2(t-N-1)，此N个电压数据中的最大值和最小值分别为U_Max2和U_Min2。

在一个实施例中，角度数据转换模块83对第一滤波数据进行线性换算处理，获得第一角度数据为：

其中，F1_Min为第一电压值，F1_Max为第二电压值，A1_Max为进行线性换算处理后的数据最大值，A1_Min为进行线性换算处理后的数据最小值；t＝1,2,3…N。

角度数据转换模块83对第二滤波数据进行线性换算处理，获得第二角度数据为：

其中，F2_Min为第一电压值，F2_Max为第二电压值；A2_Max为进行线性换算处理后的数据最大值，A2_Min为进行线性换算处理后的数据最小值。

在一个实施例中，U1(t)和U2(t)对应的有效角度范围为θ1-θ2，A1(t)和A2(t)的相位差为180.0°；角度数据获取模块84将与U1(t)和U2(t)对应的坐标系的、用于表征角度的横坐标平移，使此横坐标的原点与θ1重合，形成新的虚拟坐标系。角度数据获取模块84确定A2(t)的最小有效角度与虚拟坐标系的原点重合，对应的A1(t)的有效曲线相对于虚拟坐标系的原点相位差为180-θ1。角度数据获取模块84获得旋转角度数据为：

在一个实施例中，图10为根据本公开的用于工程机械的旋转角度数据处理装置的又一个实施例的模块示意图。如图10所示，该装置可包括存储器1001、处理器1002、通信接口1003以及总线1004。存储器1001用于存储指令，处理器1002耦合到存储器1001，处理器1002被配置为基于存储器1001存储的指令执行实现上述的用于工程机械的旋转角度数据处理方法。

存储器1001可以为高速RAM存储器、非易失性存储器(non-volatile memory)等，存储器1001也可以是存储器阵列。存储器1001还可能被分块，并且块可按一定的规则组合成虚拟卷。处理器1002可以为中央处理器CPU，或专用集成电路ASIC(ApplicationSpecific Integrated Circuit)，或者是被配置成实施本公开的用于工程机械的旋转角度数据处理方法的一个或多个集成电路。

在一个实施例中，本公开提供一种控制器，包括如上任一实施例中的用于工程机械的旋转角度数据处理装置。

在一个实施例中，本公开提供一种计算机可读存储介质，计算机可读存储介质存储有计算机指令，指令被处理器执行时实现如上任一个实施例中的用于工程机械的旋转角度数据处理方法。

上述实施例提供的用于工程机械的旋转角度数据处理方法、装置、控制器以及存储介质，可以标定角度传感器电磁感应电压信号和车体旋转角度之间的线性关系，能够快速灵敏地测量出车体旋转角度数据；采用磁感应角度传感器测量车身旋转角度，无需对中心旋转体做结构性改变，机械安装方便，实施成本投入少，信号反应灵敏，角度换算方法简单；可以完成旋转角度的检测和调试工作，成本投入降低显著，大幅缩短整车生产和调试周期，有效提升了工程机械的智能化控制水平；通过实时检测挖掘机旋转过程中的角度，保证了整机按预定旋转角度停止，可有效提高机械控制精度和操控舒适性，为挖掘机智能化开发创造了基础条件。

可能以许多方式来实现本公开的方法和系统。例如，可通过软件、硬件、固件或者软件、硬件、固件的任何组合来实现本公开的方法和系统。用于方法的步骤的上述顺序仅是为了进行说明，本公开的方法的步骤不限于以上具体描述的顺序，除非以其它方式特别说明。此外，在一些实施例中，还可将本公开实施为记录在记录介质中的程序，这些程序包括用于实现根据本公开的方法的机器可读指令。因而，本公开还覆盖存储用于执行根据本公开的方法的程序的记录介质。

本公开的描述是为了示例和描述起见而给出的，而并不是无遗漏的或者将本公开限于所公开的形式。很多修改和变化对于本领域的普通技术人员而言是显然的。选择和描述实施例是为了更好说明本公开的原理和实际应用，并且使本领域的普通技术人员能够理解本公开从而设计适于特定用途的带有各种修改的各种实施例。

Claims (16)

1.一种用于工程机械的旋转角度数据处理方法，包括：

在工程机械的下车转台和上车转台之间产生相对角度位移的过程中，获取角度传感器磁感应装置发送的第一电压信号和第二电压信号；

其中，角度传感器组件包括：角度传感器磁芯和所述角度传感器磁感应装置，所述角度传感器磁芯与下车中心轴固定连接，所述角度传感器磁感应装置与上车转台中心轴固定连接；

对所述第一电压信号和所述第二电压信号进行滤波处理，获得第一滤波数据和第二滤波数据；

根据所述角度传感器磁感应装置产生的电压信号与角度之间的线性关系，获得分别与所述第一滤波数据和所述第二滤波数据相对应的第一角度数据和第二角度数据；

基于所述第一角度数据和所述第二角度数据获取旋转角度数据。

2.如权利要求1所述的方法，在获得所述第一电压信号和所述第二电压信号之后，所述方法还包括：

将所述第一电压信号和所述第二电压信号进行限幅处理，获得第一限幅电压数据和第二限幅电压数据。

3.如权利要求2所述的方法，其中，所述第一电压信号为U1(t)，所述第二电压信号为U2(t)，t为采样点；所述将所述第一角度数据和所述第二角度数据进行限幅处理包括：

对于所述第一电压信号设置第一有效检测区间；

其中，与所述第一有效检测区间相对应的第一电压范围为第一电压值-第二电压值；所述第一电压值为电压信号量程下限，所述第二电压值为电压信号量程上限；

对于所述第二电压信号设置有第二有效检测区间；

其中，与所述第二有效检测区间相对应的第二电压范围为所述第一电压值-所述第二电压值；

当所述U1(t)或所述U2(t)的值小于所述第一电压值时，将所述U1(t)或所述U2(t)的值设置为所述第一电压值；

当所述U1(t)或所述U2(t)的值大于所述第二电压值时，则将所述U1(t)或所述U2(t)的值设置为所述第二电压值。

4.如权利要求3所示的方法，所述获得第一滤波数据和第二滤波数据包括：

连续采集所述U1(t)的N个电压数据，获得所述第一滤波数据为：

其中，此N个电压数据为U1(t),U1(t-1),U1(t-2),U1(t-3)…U1(t-N-1)，此N个电压数据中的最大值和最小值分别为U_Max1和U_Min1；N＝4,5…n；

连续采集所述U2(t)的N个电压数据，获得所述第二滤波数据为：

其中，此N个电压数据为U2(t),U2(t-1),U2(t-2),U2(t-3)…U2(t-N-1)，此N个电压数据中的最大值和最小值分别为U_Max2和U_Min2。

5.如权利要求4所述的方法，所述获得分别与所述第一滤波数据和所述第二滤波数据相对应的第一角度数据和第二角度数据包括：

对所述第一滤波数据进行线性换算处理，获得所述第一角度数据为：

其中，F1_Min为所述第一电压值，F1_Max为所述第二电压值，A1_Max为进行线性换算处理后的数据最大值，A1_Min为进行线性换算处理后的数据最小值；t＝1,2,3…N；

对所述第二滤波数据进行线性换算处理，获得所述第二角度数据为：

其中，F2_Min为所述第一电压值，F2_Max为所述第二电压值；A2_Max为进行线性换算处理后的数据最大值，A2_Min为进行线性换算处理后的数据最小值。

6.如权利要求5所述的方法，其中，所述U1(t)和所述U2(t)对应的有效角度范围为θ1-θ2，所述A1(t)和所述A2(t)的相位差为180.0°；所述基于所述第一角度数据和所述第二角度数据获得旋转角度数据包括：

将与所述U1(t)和所述U2(t)对应的坐标系的、用于表征角度的横坐标平移，使此横坐标的原点与所述θ1重合，形成新的虚拟坐标系；

确定所述A2(t)的最小有效角度与所述虚拟坐标系的原点重合，对应的所述A1(t)的有效曲线相对于所述虚拟坐标系的原点相位差为180-θ1；

获得所述旋转角度数据为：

7.如权利要求1至6任一项所述的方法，其中，

所述工程机械包括：挖掘机。

8.一种用于工程机械的旋转角度数据处理装置，包括：

电压信号采集模块，用于在工程机械的下车转台和上车转台之间产生相对角度位移的过程中，获取角度传感器磁感应装置发送的第一电压信号和第二电压信号；其中，角度传感器组件包括：角度传感器磁芯和所述角度传感器磁感应装置，所述角度传感器磁芯与下车中心轴固定连接，所述角度传感器磁感应装置与上车转台中心轴固定连接；

电压信号滤波模块，用于对所述第一电压信号和所述第二电压信号进行滤波处理，获得第一滤波数据和第二滤波数据；

角度数据转换模块，用于根据所述角度传感器磁感应装置产生的电压信号与角度之间的线性关系，获得分别与所述第一滤波数据和所述第二滤波数据相对应的第一角度数据和第二角度数据；

角度数据获取模块，用于基于所述第一角度数据和所述第二角度数据获取旋转角度数据。

9.如权利要求8所述的装置，还包括：

电压限幅处理模块，用于将所述第一电压信号和所述第二电压信号进行限幅处理，获得第一限幅电压数据和第二限幅电压数据。

10.如权利要求9所述的装置，其中，所述第一电压信号为U1(t)，所述第二电压信号为U2(t)，t为采样点；

所述电压限幅处理模块，用于对于所述第一电压信号设置第一有效检测区间；其中，与所述第一有效检测区间相对应的第一电压范围为第一电压值-第二电压值；所述第一电压值为电压信号量程下限，所述第二电压值为电压信号量程上限；对于所述第二电压信号设置有第二有效检测区间；其中，与所述第二有效检测区间相对应的第二电压范围为所述第一电压值-所述第二电压值；

所述电压限幅处理模块，还用于当所述U1(t)或所述U2(t)的值小于所述第一电压值时，将所述U1(t)或所述U2(t)的值设置为所述第一电压值；当所述U1(t)或所述U2(t)的值大于所述第二电压值时，则将所述U1(t)或所述U2(t)的值设置为所述第二电压值。

11.如权利要求10所示的装置，其中，

所述电压信号滤波模块，还用于连续采集所述U1(t)的N个电压数据，获得所述第一滤波数据为：

其中，此N个电压数据为U1(t),U1(t-1),U1(t-2),U1(t-3)…U1(t-N-1)，此N个电压数据中的最大值和最小值分别为U_Max1和U_Min1；N＝4,5…n；

所述电压信号滤波模块，还用于连续采集所述U2(t)的N个电压数据，获得所述第二滤波数据为：

其中，此N个电压数据为U2(t),U2(t-1),U2(t-2),U2(t-3)…U2(t-N-1)，此N个电压数据中的最大值和最小值分别为U_Max2和U_Min2。

12.如权利要求11所述的装置，其中，

所述角度数据转换模块，还用于对所述第一滤波数据进行线性换算处理，获得所述第一角度数据为：

其中，F1_Min为所述第一电压值，F1_Max为所述第二电压值，A1_Max为进行线性换算处理后的数据最大值，A1_Min为进行线性换算处理后的数据最小值；t＝1,2,3…N；

所述角度数据转换模块，还用于对所述第二滤波数据进行线性换算处理，获得所述第二角度数据为：

其中，F2_Min为所述第一电压值，F2_Max为所述第二电压值；A2_Max为进行线性换算处理后的数据最大值，A2_Min为进行线性换算处理后的数据最小值。

13.如权利要求12所述的装置，其中，所述U1(t)和所述U2(t)对应的有效角度范围为θ1-θ2，所述A1(t)和所述A2(t)的相位差为180.0°；

所述角度数据获取模块，用于将与所述U1(t)和所述U2(t)对应的坐标系的、用于表征角度的横坐标平移，使此横坐标的原点与所述θ1重合，形成新的虚拟坐标系；确定所述A2(t)的最小有效角度与所述虚拟坐标系的原点重合，对应的所述A1(t)的有效曲线相对于所述虚拟坐标系的原点相位差为180-θ1；

所述角度数据获取模块，还用于获得所述旋转角度数据为：

14.一种用于工程机械的旋转角度数据处理装置，包括：

存储器；以及耦接至所述存储器的处理器，所述处理器被配置为基于存储在所述存储器中的指令，执行如权利要求1-7中任一项所述的方法。

15.一种控制器，包括：

如权利要求8至14任一项所述的用于工程机械的旋转角度数据处理装置。

16.一种计算机可读存储介质，所述计算机可读存储介质非暂时性地存储有计算机指令，所述指令被处理器执行如权利要求1至7中任一项所述的方法。

Images