[发明专利]一种无人机舵系统位置检测方法

权利要求书

1.一种无人机舵系统位置检测方法，其特征在于：该方法具体包括如下步骤：

步骤1、通过无人机舵系统微型控制器发出固定频率与占空比的方波信号，驱动并控制LVDT原边线圈的电源通断；

步骤2、利用模数转换器来采集LVDT副边线圈的电压输出信号值；

步骤3、对采集到的电压信号进行解调处理，并根据LVDT的特性进行非线性补偿，从而获得LVDT拉杆的位置信息；

步骤4、利用温度传感器检测LVDT内部温度，根据LVDT的温度特性采用分段线性差值的方法对位置信号进行温度补偿；

步骤5、将获得的位置信号通过微型控制器的通信外设输出。

2.根据权利要求1所述的一种无人机舵系统位置检测方法，其特征在于：所述的步骤1具体包括：

无人机舵系统微型控制器通过PWM发送固定频率与占空比的方波信号，频率在在2kHz～8kHz之间，占空比为50％；利用该方波信号控制PNP三极管的开通与关断，从而实现对LVDT原边线圈供电的控制。

3.根据权利要求1所述的一种无人机舵系统位置检测方法，其特征在于：所述的步骤2具体包括：LVDT中的2组副边线圈感应出原边线圈的电压信号，经过滤波后由微信控制器中的模数转换器采集，分别获得两组信号A和B。

4.根据权利要求3所述的一种无人机舵系统位置检测方法，其特征在于：所述的步骤3具体包括：

将步骤2获得的两组信号A和B进行数学处理，获得LVDT拉杆位移

x成近似线性关系的位置信息，用y表示：

在理想情况下：y＝k·x，其中k为比例系数；

受工艺以及磁场空间变化的影响，x与y并非绝对线性关系，线性度指标要求越高，LVDt的有效量程越短；为提高LVDT有效量程，必须对y进行非线性补偿；

假设LVDT的非线性特性可以用函数y＝f(x)表示，则补偿函数为其反函数f^-1(y)。对LVDT输出信号y进行补偿完成后得到函数值即为LVDT拉杆的实际位置x；

对LVDT进行测试标定，获得一组输入输出数据，其中，输入x(LVDT拉杆位移)：x₁,x₂,x₃,…,x_N；输出y(传感器输出)：y₁,y₂,y₃,…,y_N；

利用多项式对y＝f(x)的反函数进行拟合为：

x＝a_nyⁿ+a_n-1y^n-1+…+a₁y+a₀

根据最小二乘法确定系数a₀,a₁,a₂,…,a_n；令函数F(y)

将函数F(y)对各个变量求偏导，并令其等于零，获得一组方程为：

…

将上式进行简化，利用矩阵表示为：

将上述范德蒙矩阵简化可得：

定义

则Y·A＝X，那么A＝Y’·X，求得系数矩阵A，即系数a₀,a₁,a₂,…,a_n的值，同时也得到了拟合曲线函数。

5.根据权利要求1所述的一种无人机舵系统位置检测方法，其特征在于：所述的步骤4具体包括：

步骤4.1、通过温度循环试验，分别在不同的温度下，测试传感器的输入输出特性，获得一组标定数据；

通过温度循环试验，分别在不同的温度下获得一组标定数据为：

T₁:(x₁₀,y₁₀),(x₁₁,y₁₁),…,(x₁₉,y₁₉)

T₂:(x₂₀,y₂₀),(x₂₁,y₂₁),…,(x₂₉,y₂₉)

…

T_m:(x_m0,y_m0),(x_m1,y_m1),…,(x_m9,y_m9)

步骤4.2、对步骤4.1获得的标定数据进行非线性补偿，获得m个补偿函数；

分别对步骤4.1获得的标定数据中的m组数据进行非线性补偿，获得m各补偿函数为即获得m条补偿曲线；

步骤4.3、根据实际温度和传感器输出计算获得输出位移量；

根据实际温度T和传感器输出y计算输出位移量；假设y_T为传感器输出，T₁、T₂为最接近T的两个标定温度点，则补偿算法为：