专利名称：一种船舶姿态显示装置及控制方法
技术领域：
本发明涉及船舶安全航行技术领域，尤其是涉及一种可以实时显示船舶姿态以确保船舶安全的船舶姿态显示装置及控制方法。
背景技术：
近年来，由于我国改革开放的不断深入和对外经济交流的加强，船舶运输业作为国际贸易货物流通的主要渠道，得到了迅猛的发展。由于船舶运输业对大型船舰的需求，伴随着造船技术的不断进步，船舶大型化已经成为船舶发展的趋势。大型船舶载重大、吃水深、尺度长、冲程大、惯性大,受海风、海浪等因素干扰较大，其干扰反应较小型船舶来的更为强烈。受海风、海浪等环境因素干扰，大型船舶的操纵性能下降，航行姿态发生变化，稳定性变差，不可避免地产生摇摆，尤其在恶劣的海况条件下，对船舶的海上作业造成很大的安全隐患。大量的海损事故显示，大型船舶在波浪水域航行，船舶摇摆是发生事故的主要原因。最近几年，我国发生多起大型船舶在大风浪中船沉人亡的恶性事故。发生沉船事故不仅使国家财产遭受到损失，而且，造成大量人员伤亡；另一方面，大型船舶在海面上受到大风浪影响产生各种摇荡运动，会对船上设备的使用、适居性、适航性及安全性等带来不利影响。为了保证大型船舶的航行安全，了解当前船舶的姿态，目前国内常用一种倾斜仪设备来显示船舶横摇姿态，而纵摇姿态则没有专门显示设备。倾斜仪结构简单，精度较低，特别是在恶劣海况下作业时，倾斜仪无法为用户提供精准的摇摆信息，难以用于人员作业指导，甚至会让航海人员产生误判。因此，目前迫切需要一款能够对船舶当前姿态进行快速、全面、准确的测量的姿态
测量装置。中国专利授权公开号CN202511787U，授权
公开日2012年10月31日公开了一种船舶水平姿态仪，包括单片机、液晶显示器、按键、通信电平转换模块、重力加速度传感器、蜂鸣器和稳压电源模块，单片机引脚上的信号线分别与液晶显示器、按键、通信电平转换模块、重力加速度传感器、蜂鸣器相连接；稳压电源模块通过导线与单片机、液晶显示器、通信电平转换模块、重力加速度传感器、蜂鸣器相连接，并对其供电。该实用新型只用加速度传感器采集数据，具有采集的数据参数单一，显示的船舶水平姿态精度低、可靠性差的缺点。
发明内容
本发明是为了克服现有技术中的倾斜仪精度低，特别是在恶劣海况下作业时，倾斜仪无法为用户提供精准的摇摆信息，难以用于人员作业指导，甚至会让航海人员产生误判的不足，提供了 一种可以实时显示船舶姿态以确保船舶安全的船舶姿态显示装置及控制方法。
为了实现上述目的，本发明采用以下技术方案:
一种船舶姿态显示装置，包括数据采集终端和与数据采集终端电连接的显示终端，所述数据采集终端包括第一微处理器和分别与第一微处理器相连接的卫星定位仪、三轴地磁传感器、三轴陀螺仪和三轴加速度传感器；所述接收终端包括计算机和设于计算机上的触摸屏和报警器。本发明的姿态显示装置不仅要测量船舶横摇姿态，还要对当前船舶的纵摇、航向等船舶姿态数据进行测量，并能根据测得的姿态数据将船舶的姿态直观显示出来，为船舶姿态的控制操作提供参考，保证船舶航行的安全性。作为优选，所述数据采集终端和显示终端采用有线方式电连接。作为优选，所述数据采集终端和显示终端采用无线方式电连接。作为优选，所述三轴地磁传感器设于船体的甲板中部。作为优选，计算机上设有至少一个数据输出端口。一种船舶姿态显示装置的控制方法，包括如下步骤:
(6-1)根据船舶体积，预先在计算机中构建若干个三维船舶图像，每一张三维船舶图像中的船舶姿态对应一组由纵摇角及横摇角构成的查询参数；并将三维船舶图像及其所对应的查询参数存储至计算机的硬盘内；在计算机中预设纵摇角及横摇角的范围；
(6-2)数据采集终端和显示终端开始工作；
(6-3)卫星定位仪获得当前位置的定位数据信息，并将定位数据信息传输到第一微处理器内，第一微处理器将接收到的定位数据信息存储至数据采集终端的第一微处理器的第一寄存器中；
(6-4)第一微处理器接收到定位数据信息后，第一微处理器开始处理三轴地磁传感器、三轴陀螺仪和三轴加速度传感器检测的地磁场强度、角速度和线加速度的数据，得到船体的航向角、纵摇角及横摇角数据；
(6-5)第一微处理器进行真北航向角的计算，第一微处理器将船体的真北航向角、纵摇角及横摇角数据传输至显示终端，数据传输结束后，数据采集终端重新开始新一次数据采集;
(6-6)触摸屏上设有存储键、读取键或数据输出键，
当在一定的时间内，计算机没接收到任何请求，卫星定位仪重新获取定位数据，系统重新开始新一轮航向角、纵摇角及横摇角数据的计算；
当用户提交了存储请求，计算机将当前的航向角、纵摇角及横摇角数据存入计算机的硬盘内；
当用户提交了读取请求，计算机读取存储在硬盘内的航向角、纵摇角及横摇角数据，并通过触摸屏显示；
当用户提交了数据输出请求，计算机通过数据输出端口进行数据输出；
(6-7)用户通过触摸屏向计算机提交读取三维船舶图像的请求；计算机根据当前的纵摇角及横摇角数据查询相应的三维船舶图像；船舶图像在触摸屏中显示；
船舶位置变换后，计算机根据接收到新的纵摇角及横摇角数据及用户的请求，查询相应的三维船舶图像，并将三维船舶图像通过触摸屏显示出来。本发明的船舶姿态显示装置可以对船舶的当前姿态(横摇姿态、纵摇姿态、航向等)信息进行实时监测，为船舶的安全行驶提供可靠数据支持。并且，本发明的船舶姿态显示装置还可以在船舶进行货物装载时提供安全支持。大型货轮进行货物装载时，保证货轮的平衡对货轮的安全具有极大意义。大型货轮载重大，吃水深，货物装载量大，在货物装载过程中，需要保证货轮的平稳，若货物装载过程中未能保证船舶的平稳，易造成货轮失去平衡，发生事故。本装置可实时监测船舶姿态，快速了解当前船舶姿态，便于船舶工作人员制定工作安排；利于工作人员展开作业；易于工作人员及时对作业过程做出调整，保证船舶的平稳，大大增加了作业的安全性。作为优选，还包括如下步骤:
(7-1)预先在计算机中构建一个罗盘背景图像，将其存储至硬盘中；
(7-2)计算机读取三维船舶图像，根据触摸屏的屏幕尺寸调整图像比例，将船舶图像中心与屏幕中心重合，将罗盘背景图像在屏幕中进行显示；
(7-3)以罗盘背景图像中心处为原点构建局部平面坐标系(X-Y)，其中，沿屏幕从左到右方向为Y轴，沿屏幕从下往上方向为X轴；
(7-4)根据真北航向角，将三维船舶图像向Y轴旋转相应角度，同时在三维船舶图像上方显示航向角数据；
(7-5)接收到新的真北航向角，根据新的真北航向角，重新将三维船舶图像向Y轴旋转相应角度，同时在三维船舶图像上方显示真北航向角数据。作为优选，还包括如下步骤:
计算机根据当前船舶姿态数据，判断船舶是否超过预设的纵摇角及横摇角的范围；当船舶的纵摇角及横摇角中的至少一个不在预设范围内时，报警器发出报警信息。作为优选，纵摇角的范围为-30°至30°。作为优选，横摇角的范围-30°至30°。因此，本发明具有如下有益效果:(1)测量的数据更准确；(2)测量的数据更全面；
(3)可实时显示船舶姿态，为船舶航行、装卸货物和进港等提供安全支持；(4)电子罗盘可用于航向显示，当装置发生倾斜时也可正常工作，进一步提高了船舶航行的安全性和可靠性。
图1是本发明的一种原理框 图2是本发明的实施例的一种流程图。图中:第一微处理器1、卫星定位仪2、三轴地磁传感器3、三轴陀螺仪4、三轴加速度传感器5、计算机6、触摸屏7、报警器8。
具体实施例方式下面结合附图和具体实施方式
对本发明做进一步的描述。如图1所示的实施例是一种船舶姿态显示装置，包括数据采集终端和与数据采集终端电连接的显示终端，数据采集终端包括第一微处理器I和分别与第一微处理器相连接的卫星定位仪2、三轴地磁传感器3、三轴陀螺仪4和三轴加速度传感器5 ;接收终端包括计算机6和设于计算机上的触摸屏7和报警器8。数据采集终端和显示终端采用有线方式电连接。三轴地磁传感器设于船体的甲板中部。计算机上设有2个数据输出端口。如图2所示是一种船舶姿态显示装置的控制方法，包括如下步骤:
步骤100，根据船舶体积，预先在计算机中构建三维船舶图像，每一张三维船舶图像中的船舶姿态对应一组由纵摇角及横摇角构成的查询参数，纵摇角及横摇角以I度为间隔进行排列组合构建三维船舶图像；并将三维船舶图像及其所对应的查询参数存储至计算机的硬盘内；预先在计算机中构建一个罗盘背景图像，将其存储至硬盘内；预先在计算机中设定纵摇角及横摇角的范围为-30°至30° ;当纵摇角及横摇角中的一个或两个角度值不在-30°至30°的范围内时，报警器发出声、光报警信息；
步骤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。设定一阶互补滤波权重取值Kx = 0.715 ；Ky = 1.3。读取六轴读数；角速度数据(陀螺仪数据)读数分别为:7、62、80 ;加速度数据读数分别为:8497.4554.13233 ；
根据加速度计读数，将Y轴的测量值转换为加速度(g):
YAccelerometer = ay * ACC—Gain ；
故 YAccelerometer = 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= arct an(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，采样间隔dt为0.02s。dt = 0.02s。通过陀螺仪X轴算得的角速度计算角度angle_dt_X: angle_dt—X = omega—X * dt ；
故 angle—dt—X = 0.0079352°
通过陀螺仪Y轴算得的角速度计算角度angle_dt_Y: angle—dt—Y = omega—Y * dt ; 0.0508158 故 angle—dt—Y = 0.0508158°
开始进行融合滤波:
权利要求
1.一种船舶姿态显示装置，其特征是，包括数据采集终端和与数据采集终端电连接的显示终端，所述数据采集终端包括第一微处理器(I)和分别与第一微处理器相连接的卫星定位仪(2)、三轴地磁传感器(3)、三轴陀螺仪(4)和三轴加速度传感器(5);所述接收终端包括计算机(6 )和设于计算机上的触摸屏(7 )和报警器(8 )。
2.根据权利要求1所述的船舶姿态显示装置，其特征是，所述数据采集终端和显示终端采用有线方式电连接。
3.根据权利要求1所述的船舶姿态显示装置，其特征是，所述数据采集终端和显示终端采用无线方式电连接。
4.根据权利要求1所述的船舶姿态显示装置，其特征是，所述三轴地磁传感器设于船体的甲板中部。
5.根据权利要求1或2或3或4所述的船舶姿态显示装置，其特征是，计算机上设有至少一个数据输出端口。
6.一种根据权利要求1所述的一种船舶姿态显示装置的控制方法，其特征是，包括如下步骤: (6-1)根据船舶体积，预先在计算机中构建若干个三维船舶图像，每一张三维船舶图像中的船舶姿态对应一组由纵摇角及横摇角构成的查询参数；并将三维船舶图像及其所对应的查询参数存储至计算机的硬盘内；在计算机中预设纵摇角及横摇角的范围； (6-2)数据采集终端和显示终端开始工作； (6-3)卫星定位仪 获得当前位置的定位数据信息，并将定位数据信息传输到第一微处理器内，第一微处理器将接收到的定位数据信息存储至数据采集终端的第一微处理器的第一寄存器中； (6-4)第一微处理器接收到定位数据信息后，第一微处理器开始处理三轴地磁传感器、三轴陀螺仪和三轴加速度传感器检测的地磁场强度、角速度和线加速度的数据，得到船体的航向角、纵摇角及横摇角数据； (6-5)第一微处理器进行真北航向角的计算，第一微处理器将船体的真北航向角、纵摇角及横摇角数据传输至显示终端，数据传输结束后，数据采集终端重新开始新一次数据采集; (6-6)触摸屏上设有存储键、读取键或数据输出键， 当在一定的时间内，计算机没接收到任何请求，卫星定位仪重新获取定位数据，系统重新开始新一轮航向角、纵摇角及横摇角数据的计算； 当用户提交了存储请求，计算机将当前的航向角、纵摇角及横摇角数据存入计算机的硬盘内； 当用户提交了读取请求，计算机读取存储在硬盘内的航向角、纵摇角及横摇角数据，并通过触摸屏显示； 当用户提交了数据输出请求，计算机通过数据输出端口进行数据输出； (6-7)用户通过触摸屏向计算机提交读取三维船舶图像的请求；计算机根据当前的纵摇角及横摇角数据查询相应的三维船舶图像；船舶图像在触摸屏中显示； 船舶位置变换后，计算机根据接收到新的纵摇角及横摇角数据及用户的请求，查询相应的三维船舶图像，并将三维船舶图像通过触摸屏显示出来。
7.根据权利要求6所述的一种船舶姿态显示装置的控制方法，其特征是，还包括如下步骤:(7-1)预先在计算机中构建一个罗盘背景图像，将其存储至硬盘中； (7-2)计算机读取三维船舶图像，根据触摸屏的屏幕尺寸调整图像比例，将船舶图像中心与屏幕中心重合，将罗盘背景图像在屏幕中进行显示； (7-3)以罗盘背景图像中心处为原点构建局部平面坐标系(X-Y)，其中，沿屏幕从左到右方向为Y轴，沿屏幕从下往上方向为X轴； (7-4)根据真北航向角，将三维船舶图像向Y轴旋转相应角度，同时在三维船舶图像上方显示航向角数据； (7-5)接收到新的真北航向角，根据新的真北航向角，重新将三维船舶图像向Y轴旋转相应角度，同时在三维船舶图像上方显示真北航向角数据。
8.根据权利要求7所述的一种船舶姿态显示装置的控制方法，其特征是，还包括如下步骤: 计算机根据当前船舶姿态数据，判断船舶是否超过预设的纵摇角及横摇角的范围；当船舶的纵摇角及横摇角中的至少一个不在预设范围内时，报警器发出报警信息。
9.根据权利要求6或7或8所述的一种船舶姿态显示装置的控制方法，纵摇角的范围为-30° 至 30°。
10.根据权利要求6或7或8所述的一种船舶姿态显示装置的控制方法，其特征是，横摇角的范围-30°至 30°。
全文摘要
本发明公开了一种船舶姿态显示装置及控制方法，包括数据采集终端和与数据采集终端电连接的显示终端，所述数据采集终端包括第一微处理器和分别与第一微处理器相连接的卫星定位仪、三轴地磁传感器、三轴陀螺仪和三轴加速度传感器；所述接收终端包括计算机和设于计算机上的触摸屏和报警器。数据采集终端和显示终端采用有线方式电连接。本发明具有测量的数据更准确；测量的数据更全面；可实时显示船舶姿态，为船舶航行、装卸货物和进港等提供安全支持；电子罗盘可用于航向显示，当装置发生倾斜时也可正常工作，进一步提高了船舶航行的安全性和可靠性的特点。
文档编号B63B39/00GK103192957SQ20131004140
公开日2013年7月10日 申请日期2013年2月4日 优先权日2013年2月4日
发明者周海锋, 王若愚, 白植湖, 范振华, 韩工, 倪旭辉 申请人:中国科学院自动化研究所北仑科学艺术实验中心