专利名称：船舶综合控制系统传感器输出数据的优化处理方法
技术领域：
本发明属于船舶显示控制技术领域，尤其是一种船舶综合控制系统传感器输出数据的优化处理方法。
背景技术：
船舶综合控制系统控制船舶的进、出港及安全行驶，该系统包括信息综合显示单元和传感器，传感器中包括GPS/DGPS、罗经、测深仪、计程仪、风速风向仪和气象仪等，各传感器输出的数据包括位置、时间、速度、深度、航向、转弯速率、风速风向、温度和湿度等，各数据通过LAN总线传送至信息综合显示单元，信息综合显示单元将收到的数据进行综合处理后显示在显示�？樯希蛘叽椭亮釉贚AN总线的其它终端。在这些数据中，信息综合显示单元主要采集的导航数据类型是经纬度、速度、航向、深度和气象信息，而其它如流速、流向和航迹向等均可以通过数学解算得到。在实际工作过程中，LAN总线中传输的数据存在无效或者不合理的数值，同时各传感器输出数据的数制和量纲不同，这些问题都加重了信息综合显示单元的负担，也降低了导航的精度，同时还存在两个相同设备由于测量精度的不同而导致的数据差异较大的问题。为了确保船舶的航行安全，除了采取对传感器进行冗余配备的措施外，还要对上述问题进行优化处理，以提高信息综合显示单元所接收的导航信息的精确度和可信度。目前常用的传感器输出数据的处理方法功能较单一，无法对各种导航数据进行综合优化处理，数据处理精度低，工作效率差，不能适应于吨位越来越大、航速越来越快的现代化船舶安全航行的需要。
发明内容
本发明的目的在于克服现有技术的不足，提供一种传感器输出数据优化处理效果好、处理后的导航信息更加精确的船舶综合控制系统传感器输出数据的优化处理方法。本发明采取的技术方案是一种船舶综合控制系统传感器输出数据的优化处理方法，其特征在于包括以下步骤(1)信息综合显示单元接收传感器输出的数据；(2)信息综合显示单元对所接收的数据进行有效性处理；(3)信息综合显示单元对所接收的数据进行合理性处理；(4)信息综合显示单元对所接收的数据进行一致性处理；(5)信息综合显示单元对所接收的位置数据进行统一集成处理；(6)信息综合显示单元将经过步骤(1) ( 处理后的数据进行卡尔曼滤波处理；(7)重复步骤(1) (6)，完成传感器输出数据的优化处理。而且，所述步骤O)中的有效性处理的方法是将每个信息帧中的各字节进行异或操作后，再将结果求和，将求和后的结果与校验位中存储的内容比较。
而且，所述步骤(3)中的合理性处理的方法是将除气象信息外的其它数据与相应的野值门限值进行比较，超出野值门限值范围的数据丢弃，其余为合理数据，所述野值门限值的定义是两个数据发送时刻之间的间隔内设备移动的最大距离加上设备出厂误差后再乘以一系数M。而且，所述步骤中一致性处理包括角度单位换算为弧度，位置统一到经纬度并用弧度描述，速度单位换算为节，时间单位换算为小时，航程和偏航距单位换算为海里， 使GPS系统每经过一个时区后的北京时和世界协调时一致，以上换算后的所有数据均被转换为双精度浮点数。而且，所述步骤(5)中的统一集成处理是位置数据由GPS设备输出，当主GPS设备故障无输出时，使用备用GPS设备数据；当主GPS设备输出数据超出正常范围时，将主GPS设备和备用GPS设备的两个输出数据进行融合运算，得到修正后的位置数据，融合运算的公式为Pb = ΦΒΧPde+(ι-ΦB) X (WF1 XPGPS1+WF2XPgps2) 公式(1)φ β = EXP (- (TOVbcueeent-TOVbpeevius)/IOsec)公式 O)其中(1-φΒ)是权值，分别表示对前一时刻的位置信息和当前GPS位置信息的加权值；Pde是从上一时刻位置外推得到当前时刻的推算船位；Pgpsi是自船基准点(OSRP)相关修正后的GPSl位置推算到当前时刻的船位；Pgps2是自船基准点(OSRP)相关修正后的GPS2位置推算到当前时刻的船位；WFl和WF2是权因子，其取值范围是0 ^ WFl ^ 1,0 ^ WF2 ^ 1,同时满足 WF1+WF2 = 1，TOVbcurrent为接收当前数据对应的时刻，TOVbprevius为接收上一次数据对应的时刻。6、根据权利要求1所述的船舶综合控制系统传感器输出数据的优化处理方法，其特征在于所述步骤(6)中的卡尔曼滤波处理是将传感器输出的若干数据作为卡尔曼滤波状态方程中的测量数据，通过卡尔曼滤波状态方程估计偏差，再将接收到的测量数据与偏差运算后得到精确的测量数据，该处理过程包括以下步骤(1)系统状态方程和系统测量方程系统状态方程X(k) = B(k) XX(k-l)+ff(k)公式(3)系统测量方程Y(k) = H(k) XX(k)+V(k)公式 ；(2)无测量数据时的系统初值设定系统状态初值X(O)，滤波协方差阵初值P(O)，系统噪声方差初值Q(O)，量测噪声方差初值R (0)，转移矩阵B (0)，测量矩阵H (0)，量测量初值Z (0)；(3)预测当前时刻至下一时刻的状态X(k+l/k) = B(k+l)X(k/k)+Mff(k)公式(5)；(4)计算新息Z (k+1) = Y (k+1) - [H (k+1) X (k+l/k) +Mv (k)]公式(6)；
(5)计算预测协方差
P (k+1/k) = B (k+1) P (k/k) Bz (k+1) +Q (k) 公式(7)；
(6)计算增益
K (k+1) = P (k+l/k) Hz (k+1) [H (k+1) P (k+l/k) Hz (k+1) +R (k)]公式⑶；
(7)计算估值
X(k+l/k+l) = X (k+l/k)+K(k+1)Z(k+1)公式(9)；
(8)计算验后协方差
P(k+l/k+l) = [I-K(k+1)H(k+1)]P(k+l/k)公式(10)；
(9)根据公式(11) (14)计算
系统噪声均值
Mff(k+1) = (l-α )Mff(k) + a X [X(k+l/k+1)-B (k+1)X(k/k)]公式(11)
系统噪声方差
Q (k+1) = (1- a ) X Q (k) + a X [K (k+1) Z (k+1) Zt (k+1) Kt (k+1) 4-公式(12)
P(k+l/k+1)-B(k+1)P (k/k)Bt (k+1)]
量测噪声均值
Mv(k+1) = (1-a ) XMv(k) + a X [Y(k+1)-H(k+1)X(k+l/k)]公式(13)
量测噪声方差
R (k+1) = (1- a ) X R (k) + a X [Ζ (k+1) Zt (k+1) -H (k+1) P (k+l/k) Ht (k+1)]
公式(14)；
(10)将公式(7)的计算结果带入公式0)，得到测量数据的偏差，再将该偏差和公式(10)、(11) (14)的结果带入到公式(3) (9)中，计算出下一时刻的测量数据的偏
差，再用该时刻接收到的测量数据与该偏差相减得到当前时刻的精确的测量数据；各方程中的k = 0,1,2,3,4,5……，其它函数定义如下X(k)为k时刻的η维状态矢量，B (k)为由k_l时刻到k时刻的一步nXn阶转移矩阵，W(k)为k时刻的r维系统噪声，Y (k)为k时刻的m维测量矢量；H(k)为k时刻的mXn 阶测量矩阵；V(k)为k时刻的m维测量噪声，Mw是系统噪声均值，E{W(k)} =Mff, IffJ和{VJ 是互不相关的白噪声序列，且它们的方差阵分别为Q和R。本发明的优点和积极效果是本发明将使用信息综合显示单元对所接收的数据进行优化处理，处理过程包括所有数据的有效性处理、除气象信息外的其它数据的合理性处理、所有数据的一致性处理、位置数据进行统一集成处理和经过前面处理的数据进行卡尔曼滤波处理。上述处理过程完成了信号异常识别、野值剔除等处理，形成完好可信的导航测量数据，再进一步采用自适应卡尔曼滤波，求解出精度更高、一致可信的船位、航向、对地速度、流速、流向和航迹向等导航参数，是一种数据处理精度高，工作效率高，适应于吨位越来越大、航速越来越快的现代化船舶安全航行需要的方法。
图1是本发明的方框图。图2是信息综合显示单元的方框图。
具体实施例方式下面结合实施例，对本发明进一步说明，下述实施例是说明性的，不是限定性的， 不能以下述实施例来限定本发明的保护范围。本发明所涉及的硬件如图2所示，信息综合显示单元通过LAN总线连接多个传感器的输出，这些传感器主要包括GPS/DGPS、计程仪、罗经、测深仪、风速风向仪等，各传感器的输出端通过LAN总线连接信息综合显示单元的LAN端口，其中信息综合显示单元使用计算机即可，各传感器的输出由信息综合显示单元接收后需要进行优化处理才可显示在显示模块上，或者传送至连接在LAN总线的其它终端设备上，该优化处理的方法如图1所示，包括以下步骤1.信息综合显示单元接收传感器输出的数据；2.信息综合显示单元对所接收的数据进行有效性处理；有效性处理的方法是将每个信息帧中除去起始标识位和校验位以外的字节进行异或操作后，再将结果求和，将求和后的结果与校验位中存储的内容比较，相同的时候，该信息帧有效，不同时，该信息帧丢弃。还可以提高采集率，比如在一秒内取样点为800点，统计相应通道信息的均值和方差，再采用数学上的无偏估计，借助通道统计量，判断信息帧的正确性。3.信息综合显示单元对所接收的除气象信息外的其它数据进行合理性处理；合理性处理的方法是将除气象信息外的其它数据与相应的野值门限值进行比较，超出野值门限值范围的数据丢弃，其余为合理数据，所述野值门限值的定义是两个数据发送时刻之间的间隔内设备移动的最大距离加上设备出厂误差后再乘以一系数M。如GPS输出经、纬度的野值门限值为GPS 纬度野值门限=3*(50 节 *T+50/1852)/；3443· 9173------(弧度)= 2. 137e"5(Τ = Is 时)GPS 经度野值门限=3*(50 节钉+50/1852)/；3443.9173处08<35-(弧度)= 2. 75e-5(Φ = 39° , T = Is)4.信息综合显示单元对所接收的数据进行一致性处理；
一致性处理包括角度单位换算为弧度，位置统一到经纬度并用弧度描述，速度单位换算为节，时间单位换算为小时，航程和偏航距单位换算为海里，使GPS系统每经过一个时区后的北京时和世界协调时一致，以上换算后的所有数据均被转换为双精度浮点数。5.信息综合显示单元对所接收的位置数据进行统一集成处理；统一集成处理是位置数据由GPS设备输出，当主GPS设备故障无输出时，使用备用GPS设备数据；当主GPS设备输出数据超出正常范围时，将主GPS设备和备用GPS设备的两个输出数据进行融合运算，得到修正后的位置数据，融合运算的公式为
Pb = Φ β X Pde+(1- Φ Β) X (WF1 X PGPS1+WF2 X Pgps2) 公式(1)
φ β = EXP (- (TOVbcueeent-TOVbpeevius)/IOsec)公式 O)其中(1-φΒ)是权值，分别表示对前一时刻的位置信息和当前GPS位置信息的加权值；Pde是从上一时刻位置外推得到当前时刻的推算船位；Pgpsi是自船基准点(OSRP)相关修正后的GPSl位置推算到当前时刻的船位；Pgps2是自船基准点(OSRP)相关修正后的GPS2位置推算到当前时刻的船位；WFl和WF2是权因子，其取值范围是0 ^ WFl ^ 1,0 ^ WF2 ^ 1,同时满足 WF1+WF2 = 1，TOVbcurrent为接收当前数据对应的时刻，TOVbprevius为接收上一次数据对应的时刻。6.信息综合显示单元将经过步骤(1) ( 处理后的数据进行卡尔曼滤波处理；卡尔曼滤波处理是将设备输出的若干数据作为卡尔曼滤波状态方程中的测量数据，通过卡尔曼滤波状态方程估计偏差，再将接收到的测量数据与偏差运算后得到精确的测量数据。设置kalman滤波器系统状态向量包括航向角误差、东速误差、北速误差、经度误差和纬度误差，对系统状态向量各误差项设置初始误差值，如航向初始误差1'，东北速误差0. 2Kn/s，经纬度误差为0. Inmile0设置系统量测噪声方差阵和状态初始值，即设置GPS速度量测噪声和位置量测噪声方差值，如分别设置为0. 2Kn/s和0. Inmile,计程仪速度量测噪声方差值，如设置为 0.04Kn/so设置kalman滤波器常值增益阵K(k)初始值，一股设置为I阵。设置kalman滤波器滤波周期为，一股为Is。将电罗经、GPS和计程仪采集信息中的同类信息进行做差，得到的航向、速度和经纬度的差值即为kalman滤波器的量测输入。将上述设置和得到的参数代入kalman滤波递推方程，对各状态量进行递推运算， 当kalman滤波器状态协方差阵Pk(k)为稳定常值阵时，kalman滤波器进入稳定状态，此时利用递推计算得到的系统状态向量中的各误差估计值对相关导航信息数据进行修正，即可得到精确地导航信息。处理过程包括以下步骤(1)系统状态方程和系统测量方程系统状态方程X (k) = B (k) X X (k-1) +W (k) 公式(3)系统测量方程Y (k) = H (k) X X (k) +V (k)公式(4)；(2)无测量数据时的系统初值设定系统状态初值X(O)，滤波协方差阵初值P(O)，系统噪声方差初值Q(O)，量测噪声方差初值R (0)，转移矩阵B (0)，测量矩阵H (0)，量测量初值Z (0)；(3)预测当前时刻至下一时刻的状态0117]X(k+l/k) = B(k+l)X(k/k)+Mff(k)公式(5)；
0118](4)计算新息
0119]Z (k+1) = Y (k+1) - [H (k+1) X (k+l/k) +Mv (k)]
0120](5)计算预测协方差
0121]P (k+1/k) = B (k+1) P (k/k) Bz (k+1) +Q (k)
公式(6)；
公式(7)；
0122](6)计算增益
0123]K (k+1) = P (k+l/k) Hz (k+1) [H (k+1) P (k+l/k) Hz (k+1) +R (k)] 公式(8)；
0124](7)计算估值(9)根据公式(11) (14)计算系统噪声均值Mff(k+1) = (l-α )Mff(k) + a X [X(k+l/k+1) -B (k+1)X(k/k)] 公式(11)系统噪声方差Q (k+1) = (1- a ) X Q (k) + a X [K (k+1) Z (k+1) Zt (k+1) Kt (k+1) + 公式(12)P (k+ 1/k+l) -B (k+1) P (k/k) Bt (k+1)]量测噪声均值Mv (k+1) = (1-a ) XMv(k) + a X [Y (k+1)-H(k+1) X (k+l/k)] 公式(13)量测噪声方差R (k+1) = (1- a ) X R (k) + a X [z (k+1) Zt (k+1) -H (k+1) P (k+l/k) Ht (k+1)]公式(14)；(10)将公式(7)的计算结果带入公式O)，得到测量数据的偏差，再将该偏差和公式(10)、(11) (14)的结果带入到公式(3) (9)中，计算出下一时刻的测量数据的偏差，再用该时刻接收到的测量数据与该偏差相减得到当前时刻的精确的测量数据；各方程中的k = 0,1,2,3,4,5……，其它函数定义如下X(k)为k时刻的η维状态矢量，B(k)为由k-Ι时刻到k时刻的一步nXn阶转移矩阵，W(k)为k时刻的r维系统噪声，Y (k)为k时刻的m维测量矢量；H(k)为k时刻的mXn 阶测量矩阵；V(k)为k时刻的m维测量噪声，Mw是系统噪声均值，E{W(k)} =Mff, IffJ和{VJ 是互不相关的白噪声序列，且它们的方差阵分别为Q和R。7.重复步骤1 6，完成传感器输出数据的优化处理。
0125]X(k+1/k+1) = X(k+l/k)+K(k+1)Z (k+1)
0126](8)计算验后协方差
0127]P(k+l/k+1) = [I-K(k+1)H(k+1)]P(k+l/k)
公式(9)；
公式(10)；
权利要求
1.一种船舶综合控制系统传感器输出数据的优化处理方法，其特征在于包括以下步骤(1)信息综合显示单元接收传感器输出的数据；(2)信息综合显示单元对所接收的数据进行有效性处理；(3)信息综合显示单元对所接收的数据进行合理性处理；(4)信息综合显示单元对所接收的数据进行一致性处理；(5)信息综合显示单元对所接收的位置数据进行统一集成处理；(6)信息综合显示单元将经过步骤(1) ( 处理后的数据进行卡尔曼滤波处理；(7)重复步骤(1) (6)，完成传感器输出数据的优化处理。
2.根据权利要求1所述的船舶综合控制系统传感器输出数据的优化处理方法，其特征在于所述步骤O)中的有效性处理的方法是将每个信息帧中的各字节进行异或操作后， 再将结果求和，将求和后的结果与校验位中存储的内容比较。
3.根据权利要求1所述的船舶综合控制系统传感器输出数据的优化处理方法，其特征在于所述步骤(3)中的合理性处理的方法是将除气象信息外的其它数据与相应的野值门限值进行比较，超出野值门限值范围的数据丢弃，其余为合理数据，所述野值门限值的定义是两个数据发送时刻之间的间隔内设备移动的最大距离加上设备出厂误差后再乘以一系数M。
4.根据权利要求1所述的船舶综合控制系统传感器输出数据的优化处理方法，其特征在于所述步骤中一致性处理包括角度单位换算为弧度，位置统一到经纬度并用弧度描述，速度单位换算为节，时间单位换算为小时，航程和偏航距单位换算为海里，使GPS系统每经过一个时区后的北京时和世界协调时一致，以上换算后的所有数据均被转换为双精度浮点数。
5.根据权利要求1所述的船舶综合控制系统传感器输出数据的优化处理方法，其特征在于所述步骤(5)中的统一集成处理是位置数据由GPS设备输出，当主GPS设备故障无输出时，使用备用GPS设备数据；当主GPS设备输出数据超出正常范围时，将主GPS设备和备用GPS设备的两个输出数据进行融合运算，得到修正后的位置数据，融合运算的公式为Pb = ΦΒΧΡΜ+(1_ΦΒ) X (ffFlXPGPS1+ffF2XPGPS2)公式(1)Φ β = EXP (- (TOVbcueeent-TOVbpeevius)/IOsec)公式 O)其中(1_ΦΒ)是权值，分别表示对前一时刻的位置信息和当前GPS位置信息的加权值；Pde是从上一时刻位置外推得到当前时刻的推算船位；Pepsi是自船基准点(OSRP)相关修正后的GPSl位置推算到当前时刻的船位；Pere2是自船基准点(OSRP)相关修正后的GPS2位置推算到当前时刻的船位；WFl和WF2是权因子，其取值范围是0 ^ WFl ^ 1,0 ^ WF2 彡 1，同时满足 WF1+WF2 = 1，TOVbcurrent为接收当前数据对应的时刻，TOVbprevius为接收上一次数据对应的时刻。
6.根据权利要求1所述的船舶综合控制系统传感器输出数据的优化处理方法，其特征在于所述步骤(6)中的卡尔曼滤波处理是将传感器输出的若干数据作为卡尔曼滤波状态方程中的测量数据，通过卡尔曼滤波状态方程估计偏差，再将接收到的测量数据与偏差运算后得到精确的测量数据，该处理过程包括以下步骤(1)系统状态方程和系统测量方程系统状态方程X (k) =B (k) X X (k-1) +W (k)公式(3)系统测量方程Y (k) =H (k) X X (k) +V (k)公式 ；(2)无测量数据时的系统初值设定系统状态初值X(O)，滤波协方差阵初值P(O)，系统噪声方差初值Q(O)，量测噪声方差初值R (0)，转移矩阵B (0)，测量矩阵H (0)，量测量初值Z (0)；(3)预测当前时刻至下一时刻的状态X(k+l/k) = B(k+l)X(k/k)+Mff(k)公式(5)；(4)计算新息Z(k+1) = Y (k+1) - [H (k+1) X (k+l/k) +Mv (k)]公式(6)；(5)计算预测协方差P (k+1/k) = B (k+1) P (k/k) Bz (k+1) +Q (k) 公式(7)；(6)计算增益K (k+1) = P (k+l/k) Hz (k+1) [H (k+1) P (k+l/k) Hz (k+1) +R (k) ]3 公式(8)；(7)计算估值X(k+l/k+l) = X (k+l/k)+K (k+1) Z (k+1) 公式(9)；(8)计算验后协方差P(k+l/k+l) = [I-K(k+l)H(k+l)]P(k+l/k)公式(10)；(9)根据公式(11) (14)计算系统噪声均值Mff (k+1) = (l-a)Mff(k) + a X [X(k+l/k+1)-B (k+1)X(k/k)]公式(11) 系统噪声方差Q (k+1) = (1- a ) X Q (k) + a X [K (k+1) Z (k+1) Zt (k+1) Kt (k+1) +公式(12)P(k+l/k+1)-B(k+1)P(k/k)Bt (k+1)] 量测噪声均值Mv (k+1) = (1-a ) XMv (k) +a X [Y (k+1)-H(k+1) X (k+l/k)] 公式(13)量测噪声方差R (k+1) = (1- a ) X R (k) + a X [Ζ (k+1) Zt (k+1) -H (k+1) P (k+l/k) Ht (k+1)]公式(14)；(10)将公式(7)的计算结果带入公式O)，得到测量数据的偏差，再将该偏差和公式 (10)、(11) (14)的结果带入到公式(3) (9)中，计算出下一时刻的测量数据的偏差， 再用该时刻接收到的测量数据与该偏差相减得到当前时刻的精确的测量数据；各方程中的k = 0，1,2,3,4,5……，其它函数定义如下X(k)为k时刻的η维状态矢量，B(k)为由k-Ι时刻到k时刻的一步nXn阶转移矩阵， W(k)为k时刻的r维系统噪声，Y(k)为k时刻的m维测量矢量；H(k)为k时刻的mXn阶测量矩阵；V(k)为k时刻的m维测量噪声，Mw是系统噪声均值，E{W(k)} =Mff, {ffk}和IVJ 是互不相关的白噪声序列，且它们的方差阵分别为Q和R。
全文摘要
本发明涉及一种船舶综合控制系统传感器输出数据的优化处理方法，包括以下步骤(1)信息综合显示单元接收传感器输出的数据；(2)信息综合显示单元对所接收的数据进行有效性处理；(3)信息综合显示单元对所接收的数据进行合理性处理；(4)信息综合显示单元对所接收的数据进行一致性处理；(5)信息综合显示单元对所接收的位置数据进行统一集成处理；(6)信息综合显示单元将经过步骤(1)～(5)处理后的数据进行卡尔曼滤波处理；(7)重复步骤(1)～(6)，完成传感器输出数据的优化处理。本发明是一种数据处理方法，精度高，工作效率高，适应于吨位越来越大、航速越来越快的现代化船舶安全航行需要的方法。
文档编号G01C21/00GK102192736SQ20101011704
公开日2011年9月21日 申请日期2010年3月3日 优先权日2010年3月3日
发明者张崇猛, 舒东亮, 郑荣才, 陈刚 申请人:中国船舶重工集团公司第七○七研究所
专业数控铣床产品供应商
20年生产经验，实力工厂，精工品质，质量有保障
