专利名称：一种船舶姿态显示装置的控制方法
技术领域：
本发明涉及船舶安全航行技术领域，尤其是涉及一种可以实时显示船舶姿态，能够为船舶海上安全作业提供可靠数据支持的船舶姿态显示装置的控制方法。
背景技术：
近年来，由于我国改革开放的不断深入和对外经济交流的加强，船舶运输业作为国际贸易货物流通的主要渠道，得到了迅猛的发展。由于船舶运输业对大型船舰的需求，伴随着造船技术的不断进步，船舶大型化已经成为船舶发展的趋势。大型船舶载重大、吃水深、尺度长、冲程大、惯性大,受海风、海浪等因素干扰较大，其干扰反应较小型船舶来的更为强烈。受海风、海浪等环境因素干扰，大型船舶的操纵性能下降，航行姿态发生变化，稳定性变差，不可避免地产生摇摆，尤其在恶劣的海况条件下，对船舶的海上作业造成很大的安全隐患。大量的海损事故显示，大型船舶在波浪水域航行，船舶摇摆是发生事故的主要原因。最近几年，我国发生多起大型 船舶在大风浪中船沉人亡的恶性事故。发生沉船事故不仅使国家财产遭受到损失，而且，造成大量人员伤亡；另一方面，大型船舶在海面上受到大风浪影响产生各种摇荡运动，会对船上设备的使用、适居性、适航性及安全性等带来不利影响。为了保证大型船舶的航行安全，了解当前船舶的姿态，目前国内常用一种倾斜仪设备来显示船舶横摇姿态，而纵摇姿态则没有专门显示设备。倾斜仪结构简单，精度较低，特别是在恶劣海况下作业时，倾斜仪无法为用户提供精准的摇摆信息，难以用于人员作业指导，甚至会让航海人员产生误判。因此，目前迫切需要一款能够对船舶当前姿态进行快速、全面、准确的测量的船舶姿态显示装置方法。中国专利授权公开号CN202511787U，授权
公开日2012年10月31日公开了一种船舶水平姿态仪，包括单片机、液晶显示器、按键、通信电平转换模块、重力加速度传感器、蜂鸣器和稳压电源模块，单片机引脚上的信号线分别与液晶显示器、按键、通信电平转换模块、重力加速度传感器、蜂鸣器相连接；稳压电源模块通过导线与单片机、液晶显示器、通信电平转换模块、重力加速度传感器、蜂鸣器相连接，并对其供电。该实用新型只用加速度传感器采集数据，具有采集的数据参数单一，显示的船舶水平姿态精度低、可靠性差的缺点。
发明内容
本发明是为了克服现有技术中的倾斜仪精度低，特别是在恶劣海况下作业时，倾斜仪无法为用户提供精准的摇摆信息，难以用于人员作业指导，甚至会让航海人员产生误判的不足，提供了一种可以实时显示船舶姿态，能够为船舶海上安全作业提供可靠数据支持的船舶姿态显示装置的控制方法。为了实现上述目的，本发明采用以下技术方案:
一种船舶姿态显示装置的控制方法，所述船舶姿态显示装置包括第一微处理器和分别与第一微处理器相连接的卫星定位仪、三轴地磁传感器、三轴陀螺仪、三轴加速度传感器、计算机和与计算机电连接的触摸屏；第一微处理器与计算机电连接；包括如下步骤:
(1-1)在计算机中预先构建船舶透视模型，并根据横摇角度和纵摇角度及船舶透视模型得到若干个船舶透视图像；将每种船舶姿态透视图像及与其相对应的一组由纵摇角及横摇角构成的查询参数存储至计算机的硬盘中；在计算机中预设纵摇角及横摇角的范围；(1-2)第一微处理器、卫星定位仪、三轴地磁传感器、陀螺仪、加速度传感器、计算机和触摸屏开始工作；
(1-3)卫星定位仪获得当前位置的定位数据信息，并将定位数据信息传输到第一微处理器内，第一微处理器将接收到的定位数据信息存储至第一微处理器的第一寄存器中；(1-4)第一微处理器接收到定位数据信息后，第一微处理器开始处理三轴地磁传感器、三轴陀螺仪和三轴加速度传感器检测的地磁场强度、角速度和线加速度的数据，得到船体的航向角、纵摇角及横摇角数据；
(1-5)第一微处理器进行真北航向角的计算，第一微处理器将船体的真北航向角、纵摇角及横摇角数据传输至计算机中；
(1-6)用户通过触摸屏向计算机提交读取船舶透视图像的请求；计算机根据当前的纵摇角及横摇角数据查询相应的船舶透视图像；船舶图像在触摸屏中显示；
(1-7)触摸屏上设有·存储键、读取键或数据输出键，
当在一定的时间内，计算机没接收到任何请求，卫星定位仪重新获取定位数据，系统重新开始新一轮航向角、纵·摇角及横摇角的计算；
当用户提交了存储请求，计算机将当前的航向角、纵摇角及横摇角数据存入计算机的硬盘内；
当用户提交了读取请求，计算机读取存储在硬盘内的航向角、纵摇角及横摇角数据，并通过触摸屏显示；
当用户提交了数据输出请求，计算机通过设于计算机上的数据输出端口进行数据输
出；
(1-8)船舶位置变化后，计算机根据接收到的新横摇角和纵摇角及用户的请求，查询相应的船舶透视图像，并将图像通过触摸屏显示出来。本发明的船舶姿态的显示方法不仅要测量船舶横摇姿态，还要对当前船舶的纵摇、航向等船舶姿态数据进行测量，并能将测得的姿态数据直观显示出来，为船舶姿态的控制操作提供参考，保证船舶海上作业的安全性。并且，本发明的船舶姿态的显示方法还可以在船舶进行货物装载时提供安全支持。大型货轮进行货物装载时，保证货轮的平衡对货轮的安全具有极大意义。大型货轮载重大，吃水深，货物装载量大，在货物装载过程中，需要保证货轮的平稳，若货物装载过程中未能保证船舶的平稳，易造成货轮失去平衡，发生事故。本方法可实时监测船舶姿态，快速了解当前船舶姿态，便于船舶工作人员制定工作安排；利于工作人员展开作业；易于工作人员及时对作业过程作出调整，保证船舶的平稳，大大增加了作业的安全性。
作为优选，所述步骤(1-1)还包括如下步骤:
所述步骤(1-1)还包括如下步骤:
将船舶透视模型分为6个部分，分别为左前部、右前部、左中部、右中部、左后部和右后部，根据船舶的纵摇角度和横摇角度构建透视图像；
当横摇角度为0°并且-29° (纵摇角度〈0°时，将船舶透视模型的左前部、右前部填充红色，得到船舶前倾姿态透视图像；
当横摇角度为0°并且0° <纵摇角度(29°时，将船舶透视模型的左后部和右后部填充红色，得到船舶后倾姿态透视图像；
当纵摇角度为0°并且-29° (横摇角度〈0°时，将船舶透视模型的右前部、右中部和右后部填充红色，得到船舶右倾姿态透视图像；
当纵摇角度为0°并且0° <横摇角度(29°时，将船舶透视模型的左前部、左中部和左后部填充红色，得到船舶左倾姿态透视图像；
当-29° (横摇角度〈0°并且-29° (纵摇角度〈0°时，将船舶透视模型的右前部填充红色，得到船舶右前倾姿态透视图像；
当-29° <横摇角度〈0°并且0° <纵摇角度(29°时，将船舶透视模型的右后部填充红色，得到船舶右后倾姿态透视图像；
当0° <横摇角度(29°并且-29° (纵摇角度〈0°时，将船舶透视模型的左前部填充红色，得到船舶左前倾姿态透视图像；
当0° <横摇角度(29°并且0° <纵摇角度(29°时，将船舶透视模型的左后部填充红色，得到船舶左后倾姿态透视图像。
`
作为优选，所述船舶透视图像为当前船舶按一定比例缩小构成的图像。作为优选，还包括如下步骤:
(4-1)预先在计算机中构建一个罗盘背景图像，将其存储至计算机的硬盘中；
(4-2)计算机读取船舶透视图像，根据触摸屏的屏幕尺寸调整图像比例，将船舶图像中心与屏幕中心重合，将罗盘背景图像在屏幕中进行显示；
(4-3)以罗盘背景图像中心处为原点构建局部平面坐标系(X-Y)，沿屏幕从左到右方向为Y轴，沿屏眷从下往上方向为X轴；
(4-4)根据真北航向角，将船舶透视图像向Y轴旋转相应角度，同时在船舶透视图像上方显示真北航向角数据；
(4-5)接收到新的真北航向角数据时，根据新的真北航向角数据，重新将船舶透视图像向Y轴旋转相应角度，同时在船舶透视图像上方显示真北航向角数据。作为优选，还包括如下步骤:
计算机根据当前船舶姿态数据，判断船舶是否超过预设的纵摇角及横摇角范围；当船舶的纵摇角及横摇角中的至少I个不在预设范围内时，触摸屏中显示报警信息。作为优选，纵摇角的范围为-29°至29°。作为优选，横摇角的范围-29°至29°。因此，本发明具有如下有益效果:(1)测量的数据更准确；(2)测量的数据更全面；
(3)可实时显示船舶姿态，为船舶航行、装卸货物和进港等提供安全支持；(4)电子罗盘可用于航向显示，当装置发生倾斜时也可正常工作，进一步提高了船舶航行的安全性和可靠性。
图1是本发明的一种原理框 图2是本发明的实施例的一种流程 图3是本发明的一种船舶透视模型示意图。图中:第一微处理器1、卫星定位仪2、三轴地磁传感器3、陀螺仪4、加速度传感器
5、计算机6、触摸屏7。
具体实施例方式下面结合附图和具体实施方式
对本发明做进一步的描述。如图1所示的实施例是一种船舶姿态显示装置的控制方法，所述船舶姿态显示装置包括第一微处理器I和分别与第一微处理器相连接的卫星定位仪2、三轴地磁传感器3、三轴陀螺仪4、三轴加速度传感器5、计算机6和与计算机电连接的触摸屏7 ;第一微处理器与计算机电连接；
如图2、图3所示，包括如下步骤:
步骤100，在计算机中预先构建船舶透视模型，将船舶透视模型分为6个部分，分别为左前部、右前部、左中部、右中部、左后部和右后部，根据船舶的纵摇角度和横摇角度构建船舶透视图像；
当横摇角度为0°并且-29·° (纵摇角度〈0°时，将船舶透视模型的左前部、右前部填充红色，得到船舶前倾姿态透视图像；
当横摇角度为0°并且0° <纵摇角度(29°时，将船舶透视模型的左后部和右后部填充红色，得到船舶后倾姿态透视图像；
当纵摇角度为0°并且-29° (横摇角度〈0°时，将船舶透视模型的右前部、右中部和右后部填充红色，得到船舶右倾姿态透视图像；
当纵摇角度为0°并且0° <横摇角度(29°时，将船舶透视模型的左前部、左中部和左后部填充红色，得到船舶左倾姿态透视图像；
当-29° (横摇角度〈0°并且-29° (纵摇角度〈0°时，将船舶透视模型的右前部填充红色，得到船舶右前倾姿态透视图像；
当-29° <横摇角度〈0°并且0° <纵摇角度(29°时，将船舶透视模型的右后部填充红色，得到船舶右后倾姿态透视图像；
当0° <横摇角度(29°并且-29° (纵摇角度〈0°时，将船舶透视模型的左前部填充红色，得到船舶左前倾姿态透视图像；
当0° <横摇角度(29°并且0° <纵摇角度(29°时，将船舶透视模型的左后部填充红色，得到船舶左后倾姿态透视图像。将8种船舶姿态透视图像及与其相对应一组由纵摇角及横摇角构成的查询参数存储至计算机的第二寄存器中；预先在计算机中设定纵摇角及横摇角的范围为-29°至29° ;当纵摇角及横摇角中的一个或两个角度值不在-29°至29°的范围内时，触摸屏显示报警信息；预先在计算机中构建一个罗盘背景图像，将其存储至计算机内的硬盘中；步骤200，第一微处理器、卫星定位仪、三轴地磁传感器、陀螺仪、加速度传感器、计算机和触摸屏开始工作；
步骤300，假设，卫星定位仪得到当前位置A的经纬度数据:经度:120.1997纬度:
30.2176。将定位数据信息传输到第一微处理器内，第一微处理器将接收到的定位数据信息存储至第一微处理器的第一寄存器中；
步骤400，第一微处理器接收到定位数据信息后，第一微处理器开始处理地磁传感器、三轴陀螺仪和三轴加速度传感器检测的地磁场强度(Hx、Hy、Hz)，角速度(gx、gy、gz)和线加速度(ax、ay、az)的数据，得到船体的航向角、纵摇角及横摇角数据；
此处使用三轴陀螺仪和三轴加速度传感器测量数据时，加速度计测量三维坐标中三轴的加速度值；陀螺仪测量沿三轴旋转的角速度值，将二者坐标系进行合并；
在测量船舶姿态角度过程中，准确而实时地获得船舶的姿态角度，是整个系统的关键。尽管电系统传感器就可以单独进行姿态角度测量，但是其准确性主要取决于惯性器件的精度，单从改善硬件结构设计和工艺方面很难有大幅度的提高，并且系统误差会随时间积累，不适用于长时间载体姿态的确定。所以，使用单一传感器难以得到相对真实的姿态角度。出于对姿态角度测量准确性的考虑，采用对多传感器信号进行融合处理的方法，来获得最优姿态角度。此处采用一阶互补滤波的方法进行信号融合处理，获得最优姿态角度。其优势在于计算量较小，可以运行在小型微处理器中，同时保证数据的实时性。首先测得陀螺仪X轴的静态飘移值Gry_0fTSet_X，测量方法是:将陀螺仪敏感轴水平放置静止时的读数，此处将零点偏移值是水平、垂直、倒置，分别取1024次，作平均值得到结果: Gry_offset_X = 45。同理，测得陀螺仪X轴的静态飘移值Gry_offset_Y:
Gry—offset—Y = 271。通过查询官方数据手册计算陀螺仪比例值Gyr_Gain:
Gyr_Gain = 1/131 = 0.00763。通过查询官方数据手册计算加速度计比例值ACC_Gain:
ACC_Gain = 1/16384 = 0.000061。设定一阶互补滤波权重取值K_x = 0.715 ；K_y = 1.3。读取六轴读数；角速度数据(陀螺仪数据)读数分别为:7、62、80 ;加速度数据读数分别为:8497,4554,13233 ；
根据加速度计读数，将Y轴的测量值转换为加速度(g):
Y_Accelerometer = ay * ACC_Gain;
故 Y_Accelerometer = 0.277794
根据加速度计读数，将Z轴的测量值转换为加速度(g):
Z_Accelerometer = az * ACC_Gain;
故 Z_Accelerometer =0.807213
根据加速度计读数，将X轴的测量值转换为加速度(g):
X_Accelerometer = ax * ACC_Gain;故 X—Accelerometer = 0.518317
通过加速度仪获得相对于Z-X面的角度值angleA—X:
angleA_X= arctan(Y—Accelerometer/ Z—Accelerometer)木(180)/ π ;
故 angleA—X = 1088.068°
通过加速度仪获得相对于Z-Y面的角度值angleA—Y:
angleA—Y= arctan(X—Accelerometer/ Z—Accelerometer)木(180)/ π ;
故 angleA—Y= 1873.848。
陀螺仪X轴通过静态误差修正后的角速度读数: gx —revised = gx + Gry_offset_X;
故 gx —revised = 52 ；
陀螺仪Y轴通过静态误差修正后的角速度读数: gy —revised = gy + Gry_offset_Y;
故 gy —revised = 333
陀螺仪X轴修正后的角速度读数转换为向前的角速度(° /s): omega—X= Gyr—Gain* gx —revised;
故 omega—X= 0.39676 (° /s)
陀螺仪Y轴修正后的角速度读数转换为向前的角速度(° /s): omega—Y= Gyr—Gain* gy —revised; 2.54079 故 omega—Υ=2.54079 (° /s)
计算时间的微分值dt:
dt =当前时间-上一次采样时间；(单位:秒)
设置陀螺仪、加速度计的更新率为50hz，采样间隔为0.02s。dt = 0.02s。通过陀螺仪X轴算得的计算角度:
陀螺仪X轴在采样时间内的角度: angle_dt—X = omega—X * dt;
故 angle—dt—X = 0.0079352°
通过陀螺仪Y轴算得的角速度计算角度:
陀螺仪Y轴在采样时间内的角度: angle—dt—Y = omega—Y * dt; 0.0508158 故 angle—dt—Y = 0.0508158°
开始进行融合滤波: angle_Xn = angle_Xn_1 + (Gyr_Gain 氺(gx + Gry_offset_X))氺 dt; angle_Y n =angle_Y + (Gyr_Gain 氺(gy + Gry_offset_Y)) * dt;
由于初始 angle+Xd、angle_Y ^ 为 0,此处 angle_Xn、angle_Y n 等于0.0079352。与 0.0508158。。计算陀螺仪的权值-X轴角度值:A_X= K_x/ (K_x+ dt);
Α_Χ=0.986
计算陀螺仪的权值:Υ轴角度值:A_Y= K_y/ (K_y+ dt);Α_Υ=0.985
进行一阶互补滤波，输出值为角度(单位:° ):
angle_X= A_X* (angle_X+ omega_X* dt)+ (1_A_X)* angleA_X;
angle_Y= A_Y*(angle_Y+omega_Y*dt)+(1_A_Y)*angleA_Y;
得到的纵摇角与横摇角的值:
纵摇角:angle_X = 15.24。，横摇角:angle_Y = 28.16。。地磁数据Hx、Hy、Hz 读数分别为:30、-236, -447 ；
使用下式将磁阻传感器的测量值从载体投影至地平面，
权利要求
1.一种船舶姿态显示装置的控制方法，所述船舶姿态显示装置包括第一微处理器(I)和分别与第一微处理器相连接的卫星定位仪(2)、三轴地磁传感器(3)、三轴陀螺仪(4)、三轴加速度传感器(5)、计算机(6)和与计算机电连接的触摸屏(7);第一微处理器与计算机电连接；其特征是，包括如下步骤 (1-1)在计算机中预先构建船舶透视模型，并根据横摇角度和纵摇角度及船舶透视模型得到若干个船舶透视图像；将每种船舶姿态透视图像及与其相对应的一组由纵摇角及横摇角构成的查询参数存储至计算机的硬盘中；在计算机中预设纵摇角及横摇角的范围；(1-2)第一微处理器、卫星定位仪、三轴地磁传感器、陀螺仪、加速度传感器、计算机和触摸屏开始工作； (1-3)卫星定位仪获得当前位置的定位数据信息，并将定位数据信息传输到第一微处理器内，第一微处理器将接收到的定位数据信息存储至第一微处理器的第一寄存器中；(1-4)第一微处理器接收到定位数据信息后，第一微处理器开始处理三轴地磁传感器、三轴陀螺仪和三轴加速度传感器检测的地磁场强度、角速度和线加速度的数据，得到船体的航向角、纵摇角及横摇角数据； (1-5)第一微处理器进行真北航向角的计算，第一微处理器将船体的真北航向角、纵摇角及横摇角数据传输至计算机中； (1-6)用户通过触摸屏向计算机提交读取船舶透视图像的请求；计算机根据当前的纵摇角及横摇角数据查询相应的船舶透视图像；船舶图像在触摸屏中显示； (1-7)触摸屏上设有存储键、读取键或数据输出键， 当在一定的时间内，计算机没接收到任何请求，卫星定位仪重新获取定位数据，系统重新开始新一轮航向角、纵摇角及横摇角的计算； 当用户提交了存储请求，计算机将当前的航向角、纵摇角及横摇角数据存入计算机的硬盘内； 当用户提交了读取请求，计算机读取存储在硬盘内的航向角、纵摇角及横摇角数据，并通过触摸屏显示； 当用户提交了数据输出请求，计算机通过设于计算机上的数据输出端口进行数据输出； (1-8)船舶位置变化后，计算机根据接收到的新横摇角和纵摇角及用户的请求，查询相应的船舶透视图像，并将图像通过触摸屏显示出来。
2.根据权利要求I所述的一种船舶姿态显示装置的控制方法，其特征是，所述步骤(1-1)还包括如下步骤 将船舶透视模型分为6个部分，分别为左前部、右前部、左中部、右中部、左后部和右后部，根据船舶的纵摇角度和横摇角度构建透视图像； 当横摇角度为0°并且-29° (纵摇角度〈0°时，将船舶透视模型的左前部、右前部填充红色，得到船舶前倾姿态透视图像； 当横摇角度为0°并且0° <纵摇角度(29°时，将船舶透视模型的左后部和右后部填充红色，得到船舶后倾姿态透视图像； 当纵摇角度为0°并且-29° (横摇角度〈0°时，将船舶透视模型的右前部、右中部和右后部填充红色，得到船舶右倾姿态透视图像；当纵摇角度为0°并且0° <横摇角度(29°时，将船舶透视模型的左前部、左中部和左后部填充红色，得到船舶左倾姿态透视图像； 当-29° (横摇角度〈0°并且-29° (纵摇角度〈0°时，将船舶透视模型的右前部填充红色，得到船舶右前倾姿态透视图像； 当-29° <横摇角度〈0°并且0° <纵摇角度(29°时，将船舶透视模型的右后部填充红色，得到船舶右后倾姿态透视图像； 当0° <横摇角度(29°并且-29° (纵摇角度〈0°时，将船舶透视模型的左前部填充红色，得到船舶左前倾姿态透视图像； 当0° <横摇角度(29°并且0° <纵摇角度(29°时，将船舶透视模型的左后部填充红色，得到船舶左后倾姿态透视图像。
3.根据权利要求I所述的一种船舶姿态显示装置的控制方法，其特征是，所述船舶透视图像为当前船舶按一定比例缩小构成的图像。
4.根据权利要求I所述的一种船舶姿态显示装置的控制方法，其特征是，还包括如下步骤 (4-1)预先在计算机中构建一个罗盘背景图像，将其存储至计算机的硬盘中； (4-2)计算机读取船舶透视图像，根据触摸屏的屏幕尺寸调整图像比例，将船舶图像中心与屏幕中心重合，将罗盘背景图像在屏幕中进行显示； (4-3)以罗盘背景图像中心处为原点构建局部平面坐标系(X-Y)，沿屏幕从左到右方向为Y轴，沿屏眷从下往上方向为X轴； (4-4)根据真北航向角，将船舶透视图像向Y轴旋转相应角度，同时在船舶透视图像上方显示真北航向角数据； (4-5)接收到新的真北航向角数据时，根据新的真北航向角数据，重新将船舶透视图像向Y轴旋转相应角度，同时在船舶透视图像上方显示真北航向角数据。
5.根据权利要求4所述的一种船舶姿态显示装置的控制方法，其特征是，还包括如下步骤 计算机根据当前船舶姿态数据，判断船舶是否超过预设的纵摇角及横摇角范围；当船舶的纵摇角及横摇角中的至少I个不在预设范围内时，触摸屏中显示报警信息。
6.根据权利要求I或2或3或4或5所述的一种船舶姿态显示装置的控制方法，纵摇角的范围为-29°至29°。
7.根据权利要求I或2或3或4或5所述的一种船舶姿态显示装置的控制方法，其特征是，横摇角的范围-29°至29°。
全文摘要
本发明公开了一种船舶姿态显示装置的控制方法，所述船舶姿态显示装置包括第一微处理器和分别与第一微处理器相连接的卫星定位仪、三轴地磁传感器、三轴陀螺仪、三轴加速度传感器、计算机和与计算机电连接的触摸屏；第一微处理器与计算机电连接；包括如下步骤在计算机中预先构建船舶透视模型，并根据横摇角度和纵摇角度及船舶透视模型得到若干个船舶透视图像。本发明具有测量的数据更准确；测量的数据更全面；可实时显示船舶姿态，为船舶航行、装卸货物和进港等提供安全支持；电子罗盘可用于航向显示，当装置发生倾斜时也可正常工作，进一步提高了船舶航行的安全性和可靠性的特点。
文档编号B63B39/00GK103253357SQ20131004143
公开日2013年8月21日 申请日期2013年2月4日 优先权日2013年2月4日
发明者周海锋, 王若愚, 白植湖, 韩工, 倪旭辉, 杨超 申请人:中国科学院自动化研究所北仑科学艺术实验中心